diff --git a/drivers/net/wireless/rockchip_wlan/Kconfig b/drivers/net/wireless/rockchip_wlan/Kconfig index 575b3566d8e3..10cdfc654818 100644 --- a/drivers/net/wireless/rockchip_wlan/Kconfig +++ b/drivers/net/wireless/rockchip_wlan/Kconfig @@ -41,6 +41,8 @@ menuconfig RTL_WIRELESS_SOLUTION default y if RTL_WIRELESS_SOLUTION +source "drivers/net/wireless/rockchip_wlan/rtl8188eu/Kconfig" +source "drivers/net/wireless/rockchip_wlan/rtl8188fu/Kconfig" source "drivers/net/wireless/rockchip_wlan/rtl8189fs/Kconfig" source "drivers/net/wireless/rockchip_wlan/rtl8723cs/Kconfig" source "drivers/net/wireless/rockchip_wlan/rtl8723ds/Kconfig" diff --git a/drivers/net/wireless/rockchip_wlan/Makefile b/drivers/net/wireless/rockchip_wlan/Makefile index a9ac8ba3cc7e..15b6ce2e862f 100644 --- a/drivers/net/wireless/rockchip_wlan/Makefile +++ b/drivers/net/wireless/rockchip_wlan/Makefile @@ -1,5 +1,7 @@ # SPDX-License-Identifier: GPL-2.0 obj-$(CONFIG_BCMDHD) += rkwifi/ +obj-$(CONFIG_RTL8188EU) += rtl8188eu/ +obj-$(CONFIG_RTL8188FU) += rtl8188fu/ obj-$(CONFIG_RTL8189FS) += rtl8189fs/ obj-$(CONFIG_RTL8723CS) += rtl8723cs/ obj-$(CONFIG_RTL8723DS) += rtl8723ds/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/Makefile b/drivers/net/wireless/rockchip_wlan/rtl8188eu/Makefile index d3a60ea47ed9..d382759017bf 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/Makefile +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/Makefile @@ -9,9 +9,9 @@ EXTRA_CFLAGS += -O1 #EXTRA_CFLAGS += -Wshadow -Wpointer-arith -Wcast-qual -Wstrict-prototypes -Wmissing-prototypes EXTRA_CFLAGS += -Wno-unused-variable -EXTRA_CFLAGS += -Wno-unused-value -EXTRA_CFLAGS += -Wno-unused-label -EXTRA_CFLAGS += -Wno-unused-parameter +#EXTRA_CFLAGS += -Wno-unused-value +#EXTRA_CFLAGS += -Wno-unused-label +#EXTRA_CFLAGS += -Wno-unused-parameter EXTRA_CFLAGS += -Wno-unused-function EXTRA_CFLAGS += -Wno-unused #EXTRA_CFLAGS += -Wno-uninitialized @@ -22,7 +22,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 @@ -38,9 +37,13 @@ CONFIG_RTL8723B = n CONFIG_RTL8814A = n CONFIG_RTL8723C = n CONFIG_RTL8188F = n +CONFIG_RTL8188GTV = n CONFIG_RTL8822B = n CONFIG_RTL8723D = n CONFIG_RTL8821C = n +CONFIG_RTL8710B = n +CONFIG_RTL8192F = n +CONFIG_RTL8822C = n ######################### Interface ########################### CONFIG_USB_HCI = y CONFIG_PCI_HCI = n @@ -49,22 +52,25 @@ CONFIG_GSPI_HCI = n ########################## Features ########################### CONFIG_MP_INCLUDED = y CONFIG_POWER_SAVING = y +CONFIG_IPS_MODE = default +CONFIG_LPS_MODE = default CONFIG_USB_AUTOSUSPEND = n CONFIG_HW_PWRP_DETECTION = n -CONFIG_WIFI_TEST = n CONFIG_BT_COEXIST = n -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 = y CONFIG_TXPWR_BY_RATE_EN = n +CONFIG_TXPWR_LIMIT = 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 -CONFIG_80211W = n +CONFIG_80211W = y CONFIG_REDUCE_TX_CPU_LOADING = n CONFIG_BR_EXT = y CONFIG_TDLS = n @@ -73,20 +79,34 @@ CONFIG_MCC_MODE = n CONFIG_APPEND_VENDOR_IE_ENABLE = n CONFIG_RTW_NAPI = y CONFIG_RTW_GRO = y +CONFIG_RTW_NETIF_SG = y +CONFIG_RTW_IPCAM_APPLICATION = n +CONFIG_RTW_REPEATER_SON = n +CONFIG_RTW_WIFI_HAL = n +CONFIG_ICMP_VOQ = n +CONFIG_IP_R_MONITOR = n #arp VOQ and high rate ########################## Debug ########################### 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 = 2 ######################## Wake On Lan ########################## -CONFIG_WOWLAN = y -CONFIG_GPIO_WAKEUP = y -CONFIG_DEFAULT_PATTERNS_EN = n +CONFIG_WOWLAN = n +#bit2: deauth, bit1: unicast, bit0: magic pkt. +CONFIG_WAKEUP_TYPE = 0x7 +CONFIG_WOW_LPS_MODE = default +#bit0: disBBRF off, #bit1: Wireless remote controller (WRC) +CONFIG_SUSPEND_TYPE = 0 +CONFIG_WOW_STA_MIX = n +CONFIG_GPIO_WAKEUP = n CONFIG_WAKEUP_GPIO_IDX = default -CONFIG_HIGH_ACTIVE = n +CONFIG_HIGH_ACTIVE_DEV2HST = n +######### only for USB ######### +CONFIG_ONE_PIN_GPIO = n +CONFIG_HIGH_ACTIVE_HST2DEV = n CONFIG_PNO_SUPPORT = n CONFIG_PNO_SET_DEBUG = n -CONFIG_AP_WOWLAN = y +CONFIG_AP_WOWLAN = n ######### Notify SDIO Host Keep Power During Syspend ########## CONFIG_RTW_SDIO_PM_KEEP_POWER = y ###################### MP HW TX MODE FOR VHT ####################### @@ -94,7 +114,6 @@ CONFIG_MP_VHT_HW_TX_MODE = n ###################### Platform Related ####################### CONFIG_PLATFORM_I386_PC = n CONFIG_PLATFORM_ANDROID_X86 = n -CONFIG_PLATFORM_ANDROID_X86_N70 = n CONFIG_PLATFORM_ANDROID_INTEL_X86 = n CONFIG_PLATFORM_JB_X86 = n CONFIG_PLATFORM_ARM_S3C2K4 = n @@ -136,25 +155,30 @@ CONFIG_PLATFORM_ACTIONS_ATV5201 = n CONFIG_PLATFORM_ACTIONS_ATM705X = n CONFIG_PLATFORM_ARM_SUN50IW1P1 = n CONFIG_PLATFORM_ARM_RTD299X = n +CONFIG_PLATFORM_ARM_LGE = n CONFIG_PLATFORM_ARM_SPREADTRUM_6820 = n CONFIG_PLATFORM_ARM_SPREADTRUM_8810 = n CONFIG_PLATFORM_ARM_WMT = n CONFIG_PLATFORM_TI_DM365 = n CONFIG_PLATFORM_MOZART = n CONFIG_PLATFORM_RTK119X = n +CONFIG_PLATFORM_RTK119X_AM = n CONFIG_PLATFORM_RTK129X = n +CONFIG_PLATFORM_RTK390X = n CONFIG_PLATFORM_NOVATEK_NT72668 = n CONFIG_PLATFORM_HISILICON = n +CONFIG_PLATFORM_HISILICON_HI3798 = n CONFIG_PLATFORM_NV_TK1 = n -############################################################### +CONFIG_PLATFORM_NV_TK1_UBUNTU = n +CONFIG_PLATFORM_RTL8197D = n +CONFIG_PLATFORM_AML_S905 = n +CONFIG_PLATFORM_ZTE_ZX296716 = n +########### CUSTOMER ################################ +CONFIG_CUSTOMER_HUAWEI_GENERAL = n CONFIG_DRVEXT_MODULE = n -ifeq ($(CONFIG_PLATFORM_ANDROID_X86_N70), y) -export TopDIR := $(shell pwd)/../../../../../../kernel/drivers/net/wireless/rtl8188ee/ -endif - -export TopDIR ?= $(shell pwd)/drivers/net/wireless/rockchip_wlan/rtl8188eu/ +export TopDIR ?= $(shell pwd) ########### COMMON ################################# ifeq ($(CONFIG_GSPI_HCI), y) @@ -186,7 +210,8 @@ _OS_INTFS_FILES := os_dep/osdep_service.o \ os_dep/linux/rtw_cfgvendor.o \ os_dep/linux/wifi_regd.o \ os_dep/linux/rtw_android.o \ - os_dep/linux/rtw_proc.o + os_dep/linux/rtw_proc.o \ + os_dep/linux/rtw_rhashtable.o ifeq ($(CONFIG_MP_INCLUDED), y) _OS_INTFS_FILES += os_dep/linux/ioctl_mp.o @@ -208,67 +233,20 @@ _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_led.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_adc_sampling.o\ - hal/phydm/phydm_kfree.o\ - hal/phydm/phydm_ccx.o - EXTRA_CFLAGS += -I$(src)/platform _PLATFORM_FILES := platform/platform_ops.o EXTRA_CFLAGS += -I$(src)/hal/btc -_OUTSRC_FILES += hal/btc/halbtc8723bwifionly.o \ - hal/btc/halbtc8822bwifionly.o \ - hal/btc/halbtc8821cwifionly.o -ifeq ($(CONFIG_BT_COEXIST), y) -_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/halbtc8703b1ant.o \ - hal/btc/halbtc8723d1ant.o \ - hal/btc/halbtc8723d2ant.o \ - hal/btc/halbtc8822b1ant.o \ - hal/btc/halbtc8822b2ant.o \ - hal/btc/halbtc8821c1ant.o \ - hal/btc/halbtc8821c2ant.o -endif - ########### HAL_RTL8188E ################################# ifeq ($(CONFIG_RTL8188E), y) @@ -329,15 +307,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)/halphyrf_8188e_ce.o\ - hal/phydm/$(RTL871X)/phydm_regconfig8188e.o\ - hal/phydm/$(RTL871X)/hal8188erateadaptive.o\ - hal/phydm/$(RTL871X)/phydm_rtl8188e.o - endif ########### HAL_RTL8192E ################################# @@ -389,14 +358,14 @@ endif ifeq ($(CONFIG_PCI_HCI), y) _HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8192E_PCIE.o endif +ifeq ($(CONFIG_SDIO_HCI), y) +_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8192E_SDIO.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)/halphyrf_8192e_ce.o\ - hal/phydm/$(RTL871X)/phydm_regconfig8192e.o\ - hal/phydm/$(RTL871X)/phydm_rtl8192e.o +ifeq ($(CONFIG_BT_COEXIST), y) +_BTC_FILES += hal/btc/halbtc8192e1ant.o \ + hal/btc/halbtc8192e2ant.o +endif endif @@ -457,19 +426,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_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) @@ -496,18 +460,20 @@ endif EXTRA_CFLAGS += -DCONFIG_RTL8821A _HAL_INTFS_FILES += hal/rtl8812a/hal8821a_fw.o -_OUTSRC_FILES += 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 +ifeq ($(CONFIG_BT_COEXIST), y) +ifeq ($(CONFIG_RTL8812A), y) +_BTC_FILES += hal/btc/halbtc8812a1ant.o \ + hal/btc/halbtc8812a2ant.o +endif +ifeq ($(CONFIG_RTL8821A), y) +_BTC_FILES += hal/btc/halbtc8821a1ant.o \ + hal/btc/halbtc8821a2ant.o +endif +endif + endif ########### HAL_RTL8723B ################################# @@ -556,14 +522,15 @@ endif ifeq ($(CONFIG_PCI_HCI), y) _HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8723B_PCIE.o endif +ifeq ($(CONFIG_SDIO_HCI), y) +_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8723B_SDIO.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_mp.o\ - hal/phydm/$(RTL871X)/phydm_regconfig8723b.o\ - hal/phydm/$(RTL871X)/halphyrf_8723b_ce.o\ - hal/phydm/$(RTL871X)/phydm_rtl8723b.o +_BTC_FILES += hal/btc/halbtc8723bwifionly.o +ifeq ($(CONFIG_BT_COEXIST), y) +_BTC_FILES += hal/btc/halbtc8723b1ant.o \ + hal/btc/halbtc8723b2ant.o +endif endif @@ -623,15 +590,9 @@ 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)/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 - +ifeq ($(CONFIG_BT_COEXIST), y) +_BTC_FILES += hal/btc/halbtc8814a2ant.o +endif endif ########### HAL_RTL8723C ################################# @@ -684,11 +645,10 @@ 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)/phydm_regconfig8703b.o\ - hal/phydm/$(RTL871X)/halphyrf_8703b.o +ifeq ($(CONFIG_BT_COEXIST), y) +_BTC_FILES += hal/btc/halbtc8703b1ant.o +endif + endif ########### HAL_RTL8723D ################################# @@ -743,12 +703,11 @@ 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)/phydm_regconfig8723d.o\ - hal/phydm/$(RTL871X)/phydm_rtl8723d.o\ - hal/phydm/$(RTL871X)/halphyrf_8723d.o +ifeq ($(CONFIG_BT_COEXIST), y) +_BTC_FILES += hal/btc/halbtc8723d1ant.o \ + hal/btc/halbtc8723d2ant.o +endif + endif ########### HAL_RTL8188F ################################# @@ -799,31 +758,203 @@ 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)/phydm_regconfig8188f.o\ - hal/phydm/$(RTL871X)/halphyrf_8188f.o \ - hal/phydm/$(RTL871X)/phydm_rtl8188f.o +endif + +########### HAL_RTL8188GTV ################################# +ifeq ($(CONFIG_RTL8188GTV), y) + +RTL871X = rtl8188gtv +ifeq ($(CONFIG_USB_HCI), y) +MODULE_NAME = 8188gtvu +endif +ifeq ($(CONFIG_SDIO_HCI), y) +MODULE_NAME = 8189gtvs +endif + +EXTRA_CFLAGS += -DCONFIG_RTL8188GTV + +_HAL_INTFS_FILES += hal/HalPwrSeqCmd.o \ + hal/$(RTL871X)/Hal8188GTVPwrSeq.o\ + hal/$(RTL871X)/$(RTL871X)_sreset.o + +_HAL_INTFS_FILES += hal/$(RTL871X)/$(RTL871X)_hal_init.o \ + hal/$(RTL871X)/$(RTL871X)_phycfg.o \ + hal/$(RTL871X)/$(RTL871X)_rf6052.o \ + hal/$(RTL871X)/$(RTL871X)_dm.o \ + hal/$(RTL871X)/$(RTL871X)_rxdesc.o \ + hal/$(RTL871X)/$(RTL871X)_cmd.o \ + hal/$(RTL871X)/hal8188gtv_fw.o + +_HAL_INTFS_FILES += \ + hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_halinit.o \ + hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_led.o \ + hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_xmit.o \ + hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_NAME)_recv.o + +ifeq ($(CONFIG_PCI_HCI), y) +_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops_linux.o +else +_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o +endif + +ifeq ($(CONFIG_USB_HCI), y) +_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8188GTV_USB.o +endif + +ifeq ($(CONFIG_SDIO_HCI), y) +_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8188GTV_SDIO.o +endif endif ########### HAL_RTL8822B ################################# ifeq ($(CONFIG_RTL8822B), y) -include $(TopDIR)/rtl8822b.mk +RTL871X := rtl8822b +ifeq ($(CONFIG_USB_HCI), y) +ifeq ($(CONFIG_BT_COEXIST), n) +MODULE_NAME = 8812bu +else +MODULE_NAME = 88x2bu +endif +endif +ifeq ($(CONFIG_PCI_HCI), y) +MODULE_NAME = 88x2be +endif +ifeq ($(CONFIG_SDIO_HCI), y) +MODULE_NAME = 88x2bs endif +endif ########### HAL_RTL8821C ################################# ifeq ($(CONFIG_RTL8821C), y) -include $(TopDIR)/rtl8821c.mk +RTL871X := rtl8821c +ifeq ($(CONFIG_USB_HCI), y) +MODULE_NAME = 8821cu +endif +ifeq ($(CONFIG_PCI_HCI), y) +MODULE_NAME = 8821ce +endif +ifeq ($(CONFIG_SDIO_HCI), y) +MODULE_NAME = 8821cs +endif + +endif + +########### HAL_RTL8710B ################################# +ifeq ($(CONFIG_RTL8710B), y) + +RTL871X = rtl8710b +ifeq ($(CONFIG_USB_HCI), y) +MODULE_NAME = 8710bu +MODULE_SUB_NAME = 8710bu +endif + +EXTRA_CFLAGS += -DCONFIG_RTL8710B + +_HAL_INTFS_FILES += hal/HalPwrSeqCmd.o \ + hal/$(RTL871X)/Hal8710BPwrSeq.o\ + hal/$(RTL871X)/$(RTL871X)_sreset.o + +_HAL_INTFS_FILES += hal/$(RTL871X)/$(RTL871X)_hal_init.o \ + hal/$(RTL871X)/$(RTL871X)_phycfg.o \ + hal/$(RTL871X)/$(RTL871X)_rf6052.o \ + hal/$(RTL871X)/$(RTL871X)_dm.o \ + hal/$(RTL871X)/$(RTL871X)_rxdesc.o \ + hal/$(RTL871X)/$(RTL871X)_cmd.o \ + hal/$(RTL871X)/hal8710b_fw.o \ + hal/$(RTL871X)/$(RTL871X)_lps_poff.o + + +_HAL_INTFS_FILES += \ + hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_halinit.o \ + hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_SUB_NAME)_led.o \ + hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_SUB_NAME)_xmit.o \ + hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_SUB_NAME)_recv.o + +_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o + +ifeq ($(CONFIG_USB_HCI), y) +_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8710B_USB.o +endif + +endif + +########### HAL_RTL8192F ################################# +ifeq ($(CONFIG_RTL8192F), y) + +RTL871X = rtl8192f +ifeq ($(CONFIG_USB_HCI), y) +MODULE_NAME = 8192fu +MODULE_SUB_NAME = 8192fu +endif +ifeq ($(CONFIG_PCI_HCI), y) +MODULE_NAME = 8192fe +MODULE_SUB_NAME = 8192fe +endif +ifeq ($(CONFIG_SDIO_HCI), y) +MODULE_NAME = 8192fs +MODULE_SUB_NAME = 8192fs +endif + +EXTRA_CFLAGS += -DCONFIG_RTL8192F + +_HAL_INTFS_FILES += hal/HalPwrSeqCmd.o \ + hal/$(RTL871X)/Hal8192FPwrSeq.o\ + hal/$(RTL871X)/$(RTL871X)_sreset.o + +_HAL_INTFS_FILES += hal/$(RTL871X)/$(RTL871X)_hal_init.o \ + hal/$(RTL871X)/$(RTL871X)_phycfg.o \ + hal/$(RTL871X)/$(RTL871X)_rf6052.o \ + hal/$(RTL871X)/$(RTL871X)_dm.o \ + hal/$(RTL871X)/$(RTL871X)_rxdesc.o \ + hal/$(RTL871X)/$(RTL871X)_cmd.o \ + hal/$(RTL871X)/hal8192f_fw.o \ + hal/$(RTL871X)/$(RTL871X)_lps_poff.o + + +_HAL_INTFS_FILES += \ + hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_halinit.o \ + hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_SUB_NAME)_led.o \ + hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_SUB_NAME)_xmit.o \ + hal/$(RTL871X)/$(HCI_NAME)/rtl$(MODULE_SUB_NAME)_recv.o + +ifeq ($(CONFIG_PCI_HCI), y) +_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops_linux.o +else +_HAL_INTFS_FILES += hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_ops.o +endif + +ifeq ($(CONFIG_SDIO_HCI), y) +_HAL_INTFS_FILES += hal/efuse/$(RTL871X)/HalEfuseMask8192F_SDIO.o +endif + +ifeq ($(CONFIG_USB_HCI), y) +_HAL_INTFS_FILES += hal/efuse/$(RTL871X)/HalEfuseMask8192F_USB.o +endif + +ifeq ($(CONFIG_PCI_HCI), y) +_HAL_INTFS_FILES += hal/efuse/$(RTL871X)/HalEfuseMask8192F_PCIE.o +endif + +endif + +########### HAL_RTL8822C ################################# +ifeq ($(CONFIG_RTL8822C), y) +RTL871X := rtl8822c +ifeq ($(CONFIG_USB_HCI), y) +ifeq ($(CONFIG_BT_COEXIST), n) +MODULE_NAME = 8812cu +else +MODULE_NAME = 88x2cu +endif +endif +ifeq ($(CONFIG_PCI_HCI), y) +MODULE_NAME = 88x2ce +endif +ifeq ($(CONFIG_SDIO_HCI), y) +MODULE_NAME = 88x2cs +endif -_OUTSRC_FILES += hal/phydm/rtl8821c/halhwimg8821c_bb.o \ - hal/phydm/rtl8821c/halhwimg8821c_mac.o \ - hal/phydm/rtl8821c/halhwimg8821c_rf.o \ - hal/phydm/rtl8821c/phydm_hal_api8821c.o \ - hal/phydm/rtl8821c/phydm_regconfig8821c.o\ - hal/phydm/rtl8821c/halphyrf_8821c.o\ - hal/phydm/rtl8821c/phydm_iqk_8821c.o endif ########### AUTO_CFG ################################# @@ -860,6 +991,15 @@ EXTRA_CFLAGS += -DCONFIG_MP_INCLUDED endif ifeq ($(CONFIG_POWER_SAVING), y) +ifneq ($(CONFIG_IPS_MODE), default) +EXTRA_CFLAGS += -DRTW_IPS_MODE=$(CONFIG_IPS_MODE) +endif +ifneq ($(CONFIG_LPS_MODE), default) +EXTRA_CFLAGS += -DRTW_LPS_MODE=$(CONFIG_LPS_MODE) +endif +ifneq ($(CONFIG_WOW_LPS_MODE), default) +EXTRA_CFLAGS += -DRTW_WOW_LPS_MODE=$(CONFIG_WOW_LPS_MODE) +endif EXTRA_CFLAGS += -DCONFIG_POWER_SAVING endif @@ -867,18 +1007,10 @@ ifeq ($(CONFIG_HW_PWRP_DETECTION), y) EXTRA_CFLAGS += -DCONFIG_HW_PWRP_DETECTION endif -ifeq ($(CONFIG_WIFI_TEST), y) -EXTRA_CFLAGS += -DCONFIG_WIFI_TEST -endif - ifeq ($(CONFIG_BT_COEXIST), y) EXTRA_CFLAGS += -DCONFIG_BT_COEXIST endif -ifeq ($(CONFIG_INTEL_WIDI), y) -EXTRA_CFLAGS += -DCONFIG_INTEL_WIDI -endif - ifeq ($(CONFIG_WAPI_SUPPORT), y) EXTRA_CFLAGS += -DCONFIG_WAPI_SUPPORT endif @@ -920,10 +1052,14 @@ 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), n) +EXTRA_CFLAGS += -DCONFIG_TXPWR_BY_RATE=0 +else ifeq ($(CONFIG_TXPWR_BY_RATE), y) +EXTRA_CFLAGS += -DCONFIG_TXPWR_BY_RATE=1 +endif ifeq ($(CONFIG_TXPWR_BY_RATE_EN), n) EXTRA_CFLAGS += -DCONFIG_TXPWR_BY_RATE_EN=0 else ifeq ($(CONFIG_TXPWR_BY_RATE_EN), y) @@ -932,6 +1068,11 @@ else ifeq ($(CONFIG_TXPWR_BY_RATE_EN), auto) EXTRA_CFLAGS += -DCONFIG_TXPWR_BY_RATE_EN=2 endif +ifeq ($(CONFIG_TXPWR_LIMIT), n) +EXTRA_CFLAGS += -DCONFIG_TXPWR_LIMIT=0 +else ifeq ($(CONFIG_TXPWR_LIMIT), y) +EXTRA_CFLAGS += -DCONFIG_TXPWR_LIMIT=1 +endif ifeq ($(CONFIG_TXPWR_LIMIT_EN), n) EXTRA_CFLAGS += -DCONFIG_TXPWR_LIMIT_EN=0 else ifeq ($(CONFIG_TXPWR_LIMIT_EN), y) @@ -940,6 +1081,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 @@ -969,13 +1114,14 @@ EXTRA_CFLAGS += -DCONFIG_IEEE80211W endif ifeq ($(CONFIG_WOWLAN), y) -EXTRA_CFLAGS += -DCONFIG_WOWLAN +EXTRA_CFLAGS += -DCONFIG_WOWLAN -DRTW_WAKEUP_EVENT=$(CONFIG_WAKEUP_TYPE) +EXTRA_CFLAGS += -DRTW_SUSPEND_TYPE=$(CONFIG_SUSPEND_TYPE) +ifeq ($(CONFIG_WOW_STA_MIX), y) +EXTRA_CFLAGS += -DRTW_WOW_STA_MIX +endif 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) @@ -994,11 +1140,20 @@ endif ifeq ($(CONFIG_GPIO_WAKEUP), y) EXTRA_CFLAGS += -DCONFIG_GPIO_WAKEUP -ifeq ($(CONFIG_HIGH_ACTIVE), y) -EXTRA_CFLAGS += -DHIGH_ACTIVE=1 -else -EXTRA_CFLAGS += -DHIGH_ACTIVE=0 +ifeq ($(CONFIG_ONE_PIN_GPIO), y) +EXTRA_CFLAGS += -DCONFIG_RTW_ONE_PIN_GPIO endif +ifeq ($(CONFIG_HIGH_ACTIVE_DEV2HST), y) +EXTRA_CFLAGS += -DHIGH_ACTIVE_DEV2HST=1 +else +EXTRA_CFLAGS += -DHIGH_ACTIVE_DEV2HST=0 +endif +endif + +ifeq ($(CONFIG_HIGH_ACTIVE_HST2DEV), y) +EXTRA_CFLAGS += -DHIGH_ACTIVE_HST2DEV=1 +else +EXTRA_CFLAGS += -DHIGH_ACTIVE_HST2DEV=0 endif ifneq ($(CONFIG_WAKEUP_GPIO_IDX), default) @@ -1042,6 +1197,38 @@ 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_RTW_NETIF_SG), y) +EXTRA_CFLAGS += -DCONFIG_RTW_NETIF_SG +endif + +ifeq ($(CONFIG_ICMP_VOQ), y) +EXTRA_CFLAGS += -DCONFIG_ICMP_VOQ +endif + +ifeq ($(CONFIG_IP_R_MONITOR), y) +EXTRA_CFLAGS += -DCONFIG_IP_R_MONITOR +endif + +ifeq ($(CONFIG_RTW_WIFI_HAL), y) +#EXTRA_CFLAGS += -DCONFIG_RTW_WIFI_HAL_DEBUG +EXTRA_CFLAGS += -DCONFIG_RTW_WIFI_HAL +EXTRA_CFLAGS += -DCONFIG_RTW_CFGVEDNOR_LLSTATS +EXTRA_CFLAGS += -DCONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI +EXTRA_CFLAGS += -DCONFIG_RTW_CFGVEDNOR_RSSIMONITOR +EXTRA_CFLAGS += -DCONFIG_RTW_CFGVENDOR_WIFI_LOGGER +endif + ifeq ($(CONFIG_MP_VHT_HW_TX_MODE), y) EXTRA_CFLAGS += -DCONFIG_MP_VHT_HW_TX_MODE ifeq ($(CONFIG_PLATFORM_I386_PC), y) @@ -1074,14 +1261,34 @@ 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 + +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_NV_TK1_UBUNTU), y) +EXTRA_CFLAGS += -DCONFIG_PLATFORM_NV_TK1 +EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN +EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT + +ARCH ?= arm + CROSS_COMPILE ?= KVER := $(shell uname -r) KSRC := /lib/modules/$(KVER)/build @@ -1168,8 +1375,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 +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 @@ -1185,21 +1396,6 @@ KSRC := /media/DATA-2/android-x86/ics-x86_20120130/out/target/product/generic_x8 MODULE_NAME :=wlan endif -ifeq ($(CONFIG_PLATFORM_ANDROID_X86_N70), y) -EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -EXTRA_CFLAGS += -DCONFIG_RADIO_WORK -EXTRA_CFLAGS += -DCONFIG_PLATFORM_ANDROID -ARCH := x86 -#CROSS_COMPILE := /work/android-x86/android-x86/prebuilts/gcc/linux-x86/x86/i686-linux-android-4.7/bin/i686-linux-android- -CROSS_COMPILE := /home/work/android-N/prebuilts/gcc/linux-x86/x86/x86_64-linux-android-4.9/bin/x86_64-linux-android- -#CROSS_COMPILE := /work/78/android-x86/prebuilts/gcc/linux-x86/x86/x86_64-linux-android-4.9/bin/x86_64-linux-android- -KSRC := /home/work/android-N/out/target/product/x86/obj/kernel/ -#KSRC := /work/78/android-x86/out/target/product/x86/obj/kernel/ -MODULE_NAME :=wlan-8188ee -endif - ifeq ($(CONFIG_PLATFORM_ANDROID_INTEL_X86), y) EXTRA_CFLAGS += -DCONFIG_PLATFORM_ANDROID_INTEL_X86 EXTRA_CFLAGS += -DCONFIG_PLATFORM_INTEL_BYT @@ -1425,10 +1621,9 @@ EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_ANDROID -DCONFIG_PLATFO # default setting for Android 4.1, 4.2, 4.3, 4.4 EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -EXTRA_CFLAGS += -DCONFIG_RESUME_IN_WORKQUEUE # default setting for Power control -#EXTRA_CFLAGS += -DRTW_ENABLE_WIFI_CONTROL_FUNC -#EXTRA_CFLAGS += -DRTW_SUPPORT_PLATFORM_SHUTDOWN +# EXTRA_CFLAGS += -DRTW_ENABLE_WIFI_CONTROL_FUNC +EXTRA_CFLAGS += -DRTW_SUPPORT_PLATFORM_SHUTDOWN # default setting for Special function ARCH := arm CROSS_COMPILE := /home/android_sdk/Rockchip/Rk3188/prebuilts/gcc/linux-x86/arm/arm-eabi-4.6/bin/arm-eabi- @@ -1486,17 +1681,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 @@ -1650,10 +1834,9 @@ endif ifeq ($(CONFIG_PLATFORM_ARM_RTD299X), y) EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -EXTRA_CFLAGS += -DUSB_XMITBUF_ALIGN_SZ=1024 -DUSB_PACKET_OFFSET_SZ=0 EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -ifeq ($(CONFIG_ANDROID), y) EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT +ifeq ($(CONFIG_ANDROID), y) # Enable this for Android 5.0 EXTRA_CFLAGS += -DCONFIG_RADIO_WORK endif @@ -1661,6 +1844,32 @@ endif INSTALL_PREFIX := endif +ifeq ($(CONFIG_PLATFORM_ARM_RTD299X_LG), y) +EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN +EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT +EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE +EXTRA_CFLAGS += -DRTW_P2P_GROUP_INTERFACE=1 +EXTRA_CFLAGS += -DCONFIG_IFACE_NUMBER=3 +#EXTRA_CFLAGS += -DCONFIG_FIX_HWPORT +EXTRA_CFLAGS += -DLGE_PRIVATE +EXTRA_CFLAGS += -DPURE_SUPPLICANT +EXTRA_CFLAGS += -DCONFIG_CUSTOMIZED_COUNTRY_CHPLAN_MAP -DCONFIG_RTW_IOCTL_SET_COUNTRY +EXTRA_CFLAGS += -DDBG_RX_DFRAME_RAW_DATA +EXTRA_CFLAGS += -DRTW_REDUCE_SCAN_SWITCH_CH_TIME +ARCH ?= arm +KVER ?= + +ifneq ($(PLATFORM), WEBOS) +$(info PLATFORM is empty) +CROSS_COMPILE ?= /mnt/newdisk/LGE/arm-lg115x-linux-gnueabi-4.8-2016.03-x86_64/bin/arm-lg115x-linux-gnueabi- +KSRC ?= /mnt/newdisk/LGE/linux-rockhopper_k3lp_drd4tv_423 +endif + +CROSS_COMPILE ?= +KSRC ?= $(LINUX_SRC) +INSTALL_PREFIX ?= +endif + ifeq ($(CONFIG_PLATFORM_HISILICON), y) EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_HISILICON ifeq ($(SUPPORT_CONCURRENT),y) @@ -1677,6 +1886,42 @@ ifeq ($(KSRC),) endif endif +ifeq ($(CONFIG_PLATFORM_HISILICON_HI3798), y) +EXTRA_CFLAGS += -DCONFIG_PLATFORM_HISILICON +EXTRA_CFLAGS += -DCONFIG_PLATFORM_HISILICON_HI3798 +#EXTRA_CFLAGS += -DCONFIG_PLATFORM_HISILICON_HI3798_MV200_HDMI_DONGLE +EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN +# default setting for Android +EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE +EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 +EXTRA_CFLAGS += -DRTW_USE_CFG80211_STA_EVENT +# default setting for Android 5.x and later +#EXTRA_CFLAGS += -DCONFIG_RADIO_WORK + +# If system could power on and recognize Wi-Fi SDIO automatically, +# platfrom operations are not necessary. +#ifeq ($(CONFIG_SDIO_HCI), y) +#EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS +#_PLATFORM_FILES += platform/platform_hisilicon_hi3798_sdio.o +#EXTRA_CFLAGS += -DCONFIG_HISI_SDIO_ID=1 +#endif + +ARCH ?= arm +CROSS_COMPILE ?= /HiSTBAndroidV600R003C00SPC021_git_0512/device/hisilicon/bigfish/sdk/tools/linux/toolchains/arm-histbv310-linux/bin/arm-histbv310-linux- +ifndef KSRC +KSRC := /HiSTBAndroidV600R003C00SPC021_git_0512/device/hisilicon/bigfish/sdk/source/kernel/linux-3.18.y +KSRC += O=/HiSTBAndroidV600R003C00SPC021_git_0512/out/target/product/Hi3798MV200/obj/KERNEL_OBJ +endif + +ifeq ($(CONFIG_RTL8822B), y) +ifeq ($(CONFIG_SDIO_HCI), y) +CONFIG_RTL8822BS ?= m +USER_MODULE_NAME := rtl8822bs +endif +endif + +endif + # Platform setting ifeq ($(CONFIG_PLATFORM_ARM_SPREADTRUM_6820), y) ifeq ($(CONFIG_ANDROID_2X), y) @@ -1730,7 +1975,6 @@ 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_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT #EXTRA_CFLAGS += -DCONFIG_QOS_OPTIMIZATION EXTRA_CFLAGS += -DCONFIG_QOS_OPTIMIZATION @@ -1756,17 +2000,42 @@ MODULE_NAME := 8192eu endif +ifeq ($(CONFIG_PLATFORM_RTK119X_AM), y) +EXTRA_CFLAGS += -DCONFIG_PLATFORM_RTK119X_AM +EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN +EXTRA_CFLAGS += -DCONFIG_TRAFFIC_PROTECT +EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -DCONFIG_FULL_CH_IN_P2P_HANDSHAKE +EXTRA_CFLAGS += -DCONFIG_IFACE_NUMBER=3 +EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT + +ifeq ($(CONFIG_USB_HCI), y) +EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX +endif + +ARCH := arm + +#CROSS_COMPILE := arm-linux-gnueabihf- +KVER := 3.10.24 +#KSRC := +CROSS_COMPILE := +endif + ifeq ($(CONFIG_PLATFORM_RTK129X), y) EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN EXTRA_CFLAGS += -DRTK_129X_PLATFORM EXTRA_CFLAGS += -DCONFIG_TRAFFIC_PROTECT # default setting for Android 4.1, 4.2 -#EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE +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 @@ -1774,20 +2043,33 @@ 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 -ifeq ($(CONFIG_SDIO_HCI), y) -_PLATFORM_FILES += platform/platform_ARM_SUNnI_sdio.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_RTK390X), y) +EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN +EXTRA_CFLAGS += -DCONFIG_PLATFORM_RTK390X +EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT +EXTRA_CFLAGS += -DCONFIG_RTW_NETIF_SG +ifeq ($(CONFIG_USB_HCI), y) +EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX +endif + +ARCH:=rlx + +CROSS_COMPILE:=mips-linux- +KSRC:= /home/realtek/share/Develop/IPCAM_SDK/RealSil/rts3901_sdk_v1.2_vanilla/linux-3.10 + endif ifeq ($(CONFIG_PLATFORM_NOVATEK_NT72668), y) @@ -1815,6 +2097,85 @@ 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_PLATFORM_AML_S905), y) +EXTRA_CFLAGS += -DCONFIG_PLATFORM_AML_S905 +EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -fno-pic +# default setting for Android +EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE +EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 +EXTRA_CFLAGS += -DRTW_USE_CFG80211_STA_EVENT +# default setting for Android 5.x and later +EXTRA_CFLAGS += -DCONFIG_RADIO_WORK + +ifeq ($(CONFIG_SDIO_HCI), y) +EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS +_PLATFORM_FILES += platform/platform_aml_s905_sdio.o +endif + +ARCH ?= arm64 +CROSS_COMPILE ?= /4.4_S905L_8822bs_compile/gcc-linaro-aarch64-linux-gnu-4.9-2014.09_linux/bin/aarch64-linux-gnu- +ifndef KSRC +KSRC := /4.4_S905L_8822bs_compile/common +# To locate output files in a separate directory. +KSRC += O=/4.4_S905L_8822bs_compile/KERNEL_OBJ +endif + +ifeq ($(CONFIG_RTL8822B), y) +ifeq ($(CONFIG_SDIO_HCI), y) +CONFIG_RTL8822BS ?= m +USER_MODULE_NAME := 8822bs +endif +endif + +endif + +ifeq ($(CONFIG_PLATFORM_ZTE_ZX296716), y) +EXTRA_CFLAGS += -Wno-error=date-time +EXTRA_CFLAGS += -DCONFIG_PLATFORM_ZTE_ZX296716 +EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN +# default setting for Android +EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE +EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 +EXTRA_CFLAGS += -DRTW_USE_CFG80211_STA_EVENT +# default setting for Android 5.x and later +#EXTRA_CFLAGS += -DCONFIG_RADIO_WORK + +ifeq ($(CONFIG_SDIO_HCI), y) +# mark this temporarily +#EXTRA_CFLAGS += -DCONFIG_PLATFORM_OPS +#_PLATFORM_FILES += platform/platform_zte_zx296716_sdio.o +endif + +ARCH ?= arm64 +CROSS_COMPILE ?= +KSRC ?= + +ifeq ($(CONFIG_RTL8822B), y) +ifeq ($(CONFIG_SDIO_HCI), y) +CONFIG_RTL8822BS ?= m +USER_MODULE_NAME := 8822bs +endif +endif + +endif + +########### CUSTOMER ################################ +ifeq ($(CONFIG_CUSTOMER_HUAWEI_GENERAL), y) +CONFIG_CUSTOMER_HUAWEI = y +endif + +ifeq ($(CONFIG_CUSTOMER_HUAWEI), y) +EXTRA_CFLAGS += -DCONFIG_HUAWEI_PROC +endif + ifeq ($(CONFIG_MULTIDRV), y) ifeq ($(CONFIG_SDIO_HCI), y) @@ -1839,6 +2200,24 @@ endif ifneq ($(KERNELRELEASE),) +########### this part for *.mk ############################ +include $(src)/hal/phydm/phydm.mk + +########### HAL_RTL8822B ################################# +ifeq ($(CONFIG_RTL8822B), y) +include $(src)/rtl8822b.mk +endif + +########### HAL_RTL8821C ################################# +ifeq ($(CONFIG_RTL8821C), y) +include $(src)/rtl8821c.mk +endif + +########### HAL_RTL8822C ################################# +ifeq ($(CONFIG_RTL8822C), y) +include $(src)/rtl8822c.mk +endif + rtk_core := core/rtw_cmd.o \ core/rtw_security.o \ core/rtw_debug.o \ @@ -1853,11 +2232,16 @@ rtk_core := core/rtw_cmd.o \ core/rtw_vht.o \ core/rtw_pwrctrl.o \ core/rtw_rf.o \ + core/rtw_chplan.o \ core/rtw_recv.o \ core/rtw_sta_mgt.o \ core/rtw_ap.o \ + core/mesh/rtw_mesh.o \ + core/mesh/rtw_mesh_pathtbl.o \ + core/mesh/rtw_mesh_hwmp.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 \ @@ -1866,6 +2250,8 @@ rtk_core := core/rtw_cmd.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) @@ -1874,14 +2260,13 @@ endif $(MODULE_NAME)-y += $(rtk_core) -$(MODULE_NAME)-$(CONFIG_INTEL_WIDI) += core/rtw_intel_widi.o - $(MODULE_NAME)-$(CONFIG_WAPI_SUPPORT) += core/rtw_wapi.o \ core/rtw_wapi_sms4.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 @@ -1912,6 +2297,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 @@ -1925,7 +2344,7 @@ clean: cd hal ; rm -fr */*/*.mod.c */*/*.mod */*/*.o */*/.*.cmd */*/*.ko cd hal ; rm -fr */*.mod.c */*.mod */*.o */.*.cmd */*.ko cd hal ; rm -fr *.mod.c *.mod *.o .*.cmd *.ko - cd core/efuse ; rm -fr *.mod.c *.mod *.o .*.cmd *.ko + cd core ; rm -fr */*.mod.c */*.mod */*.o */.*.cmd */*.ko cd core ; rm -fr *.mod.c *.mod *.o .*.cmd *.ko cd os_dep/linux ; rm -fr *.mod.c *.mod *.o .*.cmd *.ko cd os_dep ; rm -fr *.mod.c *.mod *.o .*.cmd *.ko diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/efuse/rtw_efuse.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/efuse/rtw_efuse.c index cef3fea3d0e7..ba28219340c9 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/efuse/rtw_efuse.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/efuse/rtw_efuse.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 @@ -67,7 +63,7 @@ BOOLEAN efuse_IsMasked(PADAPTER pAdapter, u16 Offset) if (pAdapter->registrypriv.boffefusemask) return FALSE; -#if DEV_BUS_TYPE == RT_USB_INTERFACE +#ifdef CONFIG_USB_HCI #if defined(CONFIG_RTL8188E) if (IS_HARDWARE_TYPE_8188E(pAdapter)) return (IS_MASKED(8188E, _MUSB, Offset)) ? TRUE : FALSE; @@ -104,6 +100,10 @@ BOOLEAN efuse_IsMasked(PADAPTER pAdapter, u16 Offset) if (IS_HARDWARE_TYPE_8188F(pAdapter)) return (IS_MASKED(8188F, _MUSB, Offset)) ? TRUE : FALSE; #endif +#if defined(CONFIG_RTL8188GTV) + if (IS_HARDWARE_TYPE_8188GTV(pAdapter)) + return (IS_MASKED(8188GTV, _MUSB, Offset)) ? TRUE : FALSE; +#endif #if defined(CONFIG_RTL8822B) if (IS_HARDWARE_TYPE_8822B(pAdapter)) return (IS_MASKED(8822B, _MUSB, Offset)) ? TRUE : FALSE; @@ -112,13 +112,26 @@ BOOLEAN efuse_IsMasked(PADAPTER pAdapter, u16 Offset) if (IS_HARDWARE_TYPE_8723D(pAdapter)) return (IS_MASKED(8723D, _MUSB, Offset)) ? TRUE : FALSE; #endif +#if defined(CONFIG_RTL8710B) + if (IS_HARDWARE_TYPE_8710B(pAdapter)) + return (IS_MASKED(8710B, _MUSB, Offset)) ? TRUE : FALSE; +#endif +#if defined(CONFIG_RTL8821C) + if (IS_HARDWARE_TYPE_8821CU(pAdapter)) + return (IS_MASKED(8821C, _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_RTL8192F) + if (IS_HARDWARE_TYPE_8192FU(pAdapter)) + return (IS_MASKED(8192F, _MUSB, Offset)) ? TRUE : FALSE; +#endif +#if defined(CONFIG_RTL8822C) + if (IS_HARDWARE_TYPE_8822C(pAdapter)) + return (IS_MASKED(8822C, _MUSB, Offset)) ? TRUE : FALSE; +#endif +#endif /*CONFIG_USB_HCI*/ -#elif DEV_BUS_TYPE == RT_PCI_INTERFACE +#ifdef CONFIG_PCI_HCI #if defined(CONFIG_RTL8188E) if (IS_HARDWARE_TYPE_8188E(pAdapter)) return (IS_MASKED(8188E, _MPCIE, Offset)) ? TRUE : FALSE; @@ -147,25 +160,63 @@ 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 +#if defined(CONFIG_RTL8192F) + if (IS_HARDWARE_TYPE_8192FE(pAdapter)) + return (IS_MASKED(8192F, _MPCIE, Offset)) ? TRUE : FALSE; +#endif +#if defined(CONFIG_RTL8822C) + if (IS_HARDWARE_TYPE_8822C(pAdapter)) + return (IS_MASKED(8822C, _MPCIE, Offset)) ? TRUE : FALSE; +#endif +#endif /*CONFIG_PCI_HCI*/ + +#ifdef CONFIG_SDIO_HCI #ifdef CONFIG_RTL8188E_SDIO if (IS_HARDWARE_TYPE_8188E(pAdapter)) return (IS_MASKED(8188E, _MSDIO, Offset)) ? TRUE : FALSE; #endif -#ifdef CONFIG_RTL8188F_SDIO +#ifdef CONFIG_RTL8723B + if (IS_HARDWARE_TYPE_8723BS(pAdapter)) + return (IS_MASKED(8723B, _MSDIO, Offset)) ? TRUE : FALSE; +#endif +#ifdef CONFIG_RTL8188F if (IS_HARDWARE_TYPE_8188F(pAdapter)) return (IS_MASKED(8188F, _MSDIO, Offset)) ? TRUE : FALSE; #endif +#ifdef CONFIG_RTL8188GTV + if (IS_HARDWARE_TYPE_8188GTV(pAdapter)) + return (IS_MASKED(8188GTV, _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_8821C(pAdapter)) + 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 +#if defined(CONFIG_RTL8192F) + if (IS_HARDWARE_TYPE_8192FS(pAdapter)) + return (IS_MASKED(8192F, _MSDIO, Offset)) ? TRUE : FALSE; #endif +#if defined(CONFIG_RTL8822C) + if (IS_HARDWARE_TYPE_8822C(pAdapter)) + return (IS_MASKED(8822C, _MSDIO, Offset)) ? TRUE : FALSE; +#endif +#endif /*CONFIG_SDIO_HCI*/ return FALSE; } @@ -174,7 +225,7 @@ void rtw_efuse_mask_array(PADAPTER pAdapter, u8 *pArray) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); -#if DEV_BUS_TYPE == RT_USB_INTERFACE +#ifdef CONFIG_USB_HCI #if defined(CONFIG_RTL8188E) if (IS_HARDWARE_TYPE_8188E(pAdapter)) GET_MASK_ARRAY(8188E, _MUSB, pArray); @@ -203,6 +254,10 @@ void rtw_efuse_mask_array(PADAPTER pAdapter, u8 *pArray) if (IS_HARDWARE_TYPE_8188F(pAdapter)) GET_MASK_ARRAY(8188F, _MUSB, pArray); #endif +#if defined(CONFIG_RTL8188GTV) + if (IS_HARDWARE_TYPE_8188GTV(pAdapter)) + GET_MASK_ARRAY(8188GTV, _MUSB, pArray); +#endif #if defined(CONFIG_RTL8814A) if (IS_HARDWARE_TYPE_8814A(pAdapter)) GET_MASK_ARRAY(8814A, _MUSB, pArray); @@ -211,11 +266,21 @@ 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*/ -#elif DEV_BUS_TYPE == RT_PCI_INTERFACE +#if defined(CONFIG_RTL8821C) + if (IS_HARDWARE_TYPE_8821CU(pAdapter)) + GET_MASK_ARRAY(8821C, _MUSB, pArray); +#endif +#if defined(CONFIG_RTL8192F) + if (IS_HARDWARE_TYPE_8192FU(pAdapter)) + GET_MASK_ARRAY(8192F, _MUSB, pArray); +#endif +#if defined(CONFIG_RTL8822C) + if (IS_HARDWARE_TYPE_8822C(pAdapter)) + GET_MASK_ARRAY(8822C, _MUSB, pArray); +#endif +#endif /*CONFIG_USB_HCI*/ + +#ifdef CONFIG_PCI_HCI #if defined(CONFIG_RTL8188E) if (IS_HARDWARE_TYPE_8188E(pAdapter)) GET_MASK_ARRAY(8188E, _MPCIE, pArray); @@ -244,31 +309,69 @@ void rtw_efuse_mask_array(PADAPTER pAdapter, u8 *pArray) if (IS_HARDWARE_TYPE_8822B(pAdapter)) GET_MASK_ARRAY(8822B, _MPCIE, pArray); #endif -#elif DEV_BUS_TYPE == RT_SDIO_INTERFACE +#if defined(CONFIG_RTL8821C) + if (IS_HARDWARE_TYPE_8821CE(pAdapter)) + GET_MASK_ARRAY(8821C, _MPCIE, pArray); +#endif +#if defined(CONFIG_RTL8192F) + if (IS_HARDWARE_TYPE_8192FE(pAdapter)) + GET_MASK_ARRAY(8192F, _MPCIE, pArray); +#endif +#if defined(CONFIG_RTL8822C) + if (IS_HARDWARE_TYPE_8822C(pAdapter)) + GET_MASK_ARRAY(8822C, _MPCIE, pArray); +#endif +#endif /*CONFIG_PCI_HCI*/ + +#ifdef CONFIG_SDIO_HCI #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_RTL8188GTV) + if (IS_HARDWARE_TYPE_8188GTV(pAdapter)) + GET_MASK_ARRAY(8188GTV, _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_8821C(pAdapter)) + 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*/ +#if defined(CONFIG_RTL8192F) + if (IS_HARDWARE_TYPE_8192FS(pAdapter)) + GET_MASK_ARRAY(8192F, _MSDIO, pArray); +#endif +#if defined(CONFIG_RTL8822C) + if (IS_HARDWARE_TYPE_8822C(pAdapter)) + GET_MASK_ARRAY(8822C , _MSDIO, pArray); +#endif +#endif /*CONFIG_SDIO_HCI*/ } u16 rtw_get_efuse_mask_arraylen(PADAPTER pAdapter) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -#if DEV_BUS_TYPE == RT_USB_INTERFACE +#ifdef CONFIG_USB_HCI #if defined(CONFIG_RTL8188E) if (IS_HARDWARE_TYPE_8188E(pAdapter)) return GET_MASK_ARRAY_LEN(8188E, _MUSB); @@ -297,6 +400,10 @@ u16 rtw_get_efuse_mask_arraylen(PADAPTER pAdapter) if (IS_HARDWARE_TYPE_8188F(pAdapter)) return GET_MASK_ARRAY_LEN(8188F, _MUSB); #endif +#if defined(CONFIG_RTL8188GTV) + if (IS_HARDWARE_TYPE_8188GTV(pAdapter)) + return GET_MASK_ARRAY_LEN(8188GTV, _MUSB); +#endif #if defined(CONFIG_RTL8814A) if (IS_HARDWARE_TYPE_8814A(pAdapter)) return GET_MASK_ARRAY_LEN(8814A, _MUSB); @@ -305,11 +412,21 @@ 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*/ -#elif DEV_BUS_TYPE == RT_PCI_INTERFACE +#if defined(CONFIG_RTL8821C) + if (IS_HARDWARE_TYPE_8821CU(pAdapter)) + return GET_MASK_ARRAY_LEN(8821C, _MUSB); +#endif +#if defined(CONFIG_RTL8192F) + if (IS_HARDWARE_TYPE_8192FU(pAdapter)) + return GET_MASK_ARRAY_LEN(8192F, _MUSB); +#endif +#if defined(CONFIG_RTL8822C) + if (IS_HARDWARE_TYPE_8822C(pAdapter)) + return GET_MASK_ARRAY_LEN(8822C, _MUSB); +#endif +#endif /*CONFIG_USB_HCI*/ + +#ifdef CONFIG_PCI_HCI #if defined(CONFIG_RTL8188E) if (IS_HARDWARE_TYPE_8188E(pAdapter)) return GET_MASK_ARRAY_LEN(8188E, _MPCIE); @@ -338,56 +455,425 @@ u16 rtw_get_efuse_mask_arraylen(PADAPTER pAdapter) if (IS_HARDWARE_TYPE_8822B(pAdapter)) return GET_MASK_ARRAY_LEN(8822B, _MPCIE); #endif -#elif DEV_BUS_TYPE == RT_SDIO_INTERFACE +#if defined(CONFIG_RTL8821C) + if (IS_HARDWARE_TYPE_8821CE(pAdapter)) + return GET_MASK_ARRAY_LEN(8821C, _MPCIE); +#endif +#if defined(CONFIG_RTL8192F) + if (IS_HARDWARE_TYPE_8192FE(pAdapter)) + return GET_MASK_ARRAY_LEN(8192F, _MPCIE); +#endif +#if defined(CONFIG_RTL8822C) + if (IS_HARDWARE_TYPE_8822C(pAdapter)) + return GET_MASK_ARRAY_LEN(8822C, _MPCIE); +#endif +#endif /*CONFIG_PCI_HCI*/ + +#ifdef CONFIG_SDIO_HCI #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_RTL8188GTV) + if (IS_HARDWARE_TYPE_8188GTV(pAdapter)) + return GET_MASK_ARRAY_LEN(8188GTV, _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_8821C(pAdapter)) + 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 +#if defined(CONFIG_RTL8192F) + if (IS_HARDWARE_TYPE_8192FS(pAdapter)) + return GET_MASK_ARRAY_LEN(8192F, _MSDIO); #endif +#if defined(CONFIG_RTL8822C) + if (IS_HARDWARE_TYPE_8822C(pAdapter)) + return GET_MASK_ARRAY_LEN(8822C, _MSDIO); +#endif +#endif/*CONFIG_SDIO_HCI*/ 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, i = 0; + u16 mapLen = 0; - EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, _FALSE); + EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (void *)&mapLen, _FALSE); ret = rtw_efuse_map_read(padapter, addr, cnts , data); - if (padapter->registrypriv.boffefusemask == 0) { + rtw_mask_map_read(padapter, addr, cnts , data); - 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; } +/* *********************************************************** + * 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, (void *)&mapLen, bPseudoTest); + EFUSE_GetEfuseDefinition(padapter, efuseType, TYPE_EFUSE_MAX_SECTION, (void *)&max_section, bPseudoTest); + EFUSE_GetEfuseDefinition(padapter, efuseType, TYPE_EFUSE_PROTECT_BYTES_BANK, (void *)&protectBytesBank, bPseudoTest); + EFUSE_GetEfuseDefinition(padapter, efuseType, TYPE_EFUSE_CONTENT_LEN_BANK, (void *)&efuse_max, bPseudoTest); + EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_REAL_CONTENT_LEN, (void *)&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"); + goto out_free_buffer; + } + + 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"); + goto out_free_buffer; + } + 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"); + +out_free_buffer: + if (eFuseWord) + rtw_mfree((u8 *)eFuseWord, EFUSE_MAX_SECTION_NUM * (EFUSE_MAX_WORD_UNIT * 2)); +} + +void efuse_PreUpdateAction( + PADAPTER pAdapter, + u32 *BackupRegs) +{ + if (IS_HARDWARE_TYPE_8812AU(pAdapter) || IS_HARDWARE_TYPE_8822BU(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); +#ifdef CONFIG_RTL8812A + BackupRegs[3] = phy_query_mac_reg(pAdapter, REG_AFE_MISC, bMaskDWord); +#endif + 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); +#ifdef CONFIG_RTL8812A + /* <20140410, Kordan> 0x11 = 0x4E, lower down LX_SPS0 voltage. (Asked by Chunchu)*/ + phy_set_mac_reg(pAdapter, REG_AFE_MISC, bMaskByte1, 0x4E); +#endif + RTW_INFO(" %s , done\n", __func__); + + } +} + + +void efuse_PostUpdateAction( + PADAPTER pAdapter, + u32 *BackupRegs) +{ + if (IS_HARDWARE_TYPE_8812AU(pAdapter) || IS_HARDWARE_TYPE_8822BU(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]); +#ifdef CONFIG_RTL8812A + phy_set_mac_reg(pAdapter, REG_AFE_MISC, bMaskDWord, BackupRegs[3]); +#endif + RTW_INFO(" %s , done\n", __func__); + } +} + #ifdef RTW_HALMAC #include "../../hal/hal_halmac.h" @@ -513,8 +999,10 @@ u8 rtw_efuse_access(PADAPTER adapter, u8 write, u16 addr, u16 cnts, u8 *data) d = adapter_to_dvobj(adapter); err = rtw_halmac_get_physical_efuse_size(d, &size); - if (err) + if (err){ size = EFUSE_MAX_SIZE; + RTW_INFO(" physical_efuse_size err size %d\n", size); + } if ((addr + cnts) > size) return _FAIL; @@ -610,40 +1098,52 @@ u8 rtw_efuse_map_read(PADAPTER adapter, u16 addr, u16 cnts, u8 *data) u8 *efuse = NULL; u32 size, i; int err; + u32 backupRegs[4] = {0}; + u8 status = _SUCCESS; + efuse_PreUpdateAction(adapter, backupRegs); d = adapter_to_dvobj(adapter); err = rtw_halmac_get_logical_efuse_size(d, &size); - if (err) - return _FAIL; - + if (err) { + status = _FAIL; + goto exit; + } /* size error handle */ if ((addr + cnts) > size) { if (addr < size) cnts = size - addr; - else - return _FAIL; + else { + status = _FAIL; + goto exit; + } } if (cnts > 16) 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; + status = _FAIL; + goto exit; } _rtw_memcpy(data, efuse + addr, cnts); rtw_mfree(efuse, size); } else { err = rtw_halmac_read_logical_efuse(d, addr, cnts, data); - if (err) - return _FAIL; + if (err) { + status = _FAIL; + goto exit; + } } + status = _SUCCESS; +exit: + efuse_PostUpdateAction(adapter, backupRegs); - return _SUCCESS; + return status; } u8 rtw_efuse_map_write(PADAPTER adapter, u16 addr, u16 cnts, u8 *data) @@ -654,23 +1154,34 @@ u8 rtw_efuse_map_write(PADAPTER adapter, u16 addr, u16 cnts, u8 *data) int err; u8 mask_buf[64] = ""; u16 mask_len = sizeof(u8) * rtw_get_efuse_mask_arraylen(adapter); + u32 backupRegs[4] = {0}; + u8 status = _SUCCESS;; + + efuse_PreUpdateAction(adapter, backupRegs); d = adapter_to_dvobj(adapter); err = rtw_halmac_get_logical_efuse_size(d, &size); - if (err) - return _FAIL; + if (err) { + status = _FAIL; + goto exit; + } - if ((addr + cnts) > size) - return _FAIL; + if ((addr + cnts) > size) { + status = _FAIL; + goto exit; + } efuse = rtw_zmalloc(size); - if (!efuse) - return _FAIL; + if (!efuse) { + status = _FAIL; + goto exit; + } - 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; + status = _FAIL; + goto exit; } _rtw_memcpy(efuse + addr, data, cnts); @@ -695,12 +1206,16 @@ u8 rtw_efuse_map_write(PADAPTER adapter, u16 addr, u16 cnts, u8 *data) if (err) { rtw_mfree(efuse, size); - return _FAIL; + status = _FAIL; + goto exit; } rtw_mfree(efuse, size); + status = _SUCCESS; +exit : + efuse_PostUpdateAction(adapter, backupRegs); - return _SUCCESS; + return status; } int Efuse_PgPacketRead(PADAPTER adapter, u8 offset, u8 *data, BOOLEAN test) @@ -792,7 +1307,7 @@ u8 rtw_BT_efuse_map_write(PADAPTER adapter, u16 addr, u16 cnts, u8 *data) return _SUCCESS; } -VOID hal_ReadEFuse_BT_logic_map( +void hal_ReadEFuse_BT_logic_map( PADAPTER padapter, u16 _offset, u16 _size_byte, @@ -1190,113 +1705,23 @@ hal_EfusePgPacketWriteData( return _TRUE; } -/* *********************************************************** - * Efuse related code - * *********************************************************** */ -static u8 -hal_EfuseSwitchToBank( - PADAPTER padapter, - u8 bank, - u8 bPseudoTest) +u8 efuse_OneByteRead(struct _ADAPTER *a, u16 addr, u8 *data, 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 + struct dvobj_priv *d; + int err; + u8 ret = _TRUE; - - 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; + d = adapter_to_dvobj(a); + err = rtw_halmac_read_physical_efuse(d, addr, 1, data); + if (err) { + RTW_ERR("%s: addr=0x%x FAIL!!!\n", __FUNCTION__, addr); + ret = _FALSE; } - rtw_write32(padapter, 0x34, value32); - } - return bRet; + return ret; + } - -#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)); - } - - /* -----------------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, @@ -1436,58 +1861,17 @@ 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, - IN u16 Offset, - IN OUT u8 *Value); + PADAPTER pAdapter, + u16 Offset, + u8 *Value); BOOLEAN Efuse_Read1ByteFromFakeContent( - IN PADAPTER pAdapter, - IN u16 Offset, - IN OUT u8 *Value) + PADAPTER pAdapter, + u16 Offset, + u8 *Value) { if (Offset >= EFUSE_MAX_HW_SIZE) return _FALSE; @@ -1501,14 +1885,14 @@ Efuse_Read1ByteFromFakeContent( BOOLEAN Efuse_Write1ByteToFakeContent( - IN PADAPTER pAdapter, - IN u16 Offset, - IN u8 Value); + PADAPTER pAdapter, + u16 Offset, + u8 Value); BOOLEAN Efuse_Write1ByteToFakeContent( - IN PADAPTER pAdapter, - IN u16 Offset, - IN u8 Value) + PADAPTER pAdapter, + u16 Offset, + u8 Value) { if (Offset >= EFUSE_MAX_HW_SIZE) return _FALSE; @@ -1537,20 +1921,20 @@ Efuse_Write1ByteToFakeContent( * 11/17/2008 MHC Create Version 0. * *---------------------------------------------------------------------------*/ -VOID +void Efuse_PowerSwitch( - IN PADAPTER pAdapter, - IN u8 bWrite, - IN u8 PwrState) + PADAPTER pAdapter, + u8 bWrite, + u8 PwrState) { pAdapter->hal_func.EfusePowerSwitch(pAdapter, bWrite, PwrState); } -VOID +void BTEfuse_PowerSwitch( - IN PADAPTER pAdapter, - IN u8 bWrite, - IN u8 PwrState) + PADAPTER pAdapter, + u8 bWrite, + u8 PwrState) { if (pAdapter->hal_func.BTEfusePowerSwitch) pAdapter->hal_func.BTEfusePowerSwitch(pAdapter, bWrite, PwrState); @@ -1574,9 +1958,9 @@ BTEfuse_PowerSwitch( *---------------------------------------------------------------------------*/ u16 Efuse_GetCurrentSize( - IN PADAPTER pAdapter, - IN u8 efuseType, - IN BOOLEAN bPseudoTest) + PADAPTER pAdapter, + u8 efuseType, + BOOLEAN bPseudoTest) { u16 ret = 0; @@ -1596,17 +1980,17 @@ Efuse_GetCurrentSize( * * Created by Roger, 2008.10.21. * */ -VOID +void ReadEFuseByte( PADAPTER Adapter, u16 _offset, u8 *pbuf, - IN BOOLEAN bPseudoTest) + BOOLEAN bPseudoTest) { 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); @@ -1665,35 +2049,35 @@ ReadEFuseByte( * write addr must be after sec5. * */ -VOID +void efuse_ReadEFuse( PADAPTER Adapter, u8 efuseType, u16 _offset, u16 _size_byte, u8 *pbuf, - IN BOOLEAN bPseudoTest + BOOLEAN bPseudoTest ); -VOID +void efuse_ReadEFuse( PADAPTER Adapter, u8 efuseType, u16 _offset, u16 _size_byte, u8 *pbuf, - IN BOOLEAN bPseudoTest + BOOLEAN bPseudoTest ) { Adapter->hal_func.ReadEFuse(Adapter, efuseType, _offset, _size_byte, pbuf, bPseudoTest); } -VOID +void EFUSE_GetEfuseDefinition( - IN PADAPTER pAdapter, - IN u8 efuseType, - IN u8 type, - OUT void *pOut, - IN BOOLEAN bPseudoTest + PADAPTER pAdapter, + u8 efuseType, + u8 type, + void *pOut, + BOOLEAN bPseudoTest ) { pAdapter->hal_func.EFUSEGetEfuseDefinition(pAdapter, efuseType, type, pOut, bPseudoTest); @@ -1703,10 +2087,10 @@ EFUSE_GetEfuseDefinition( /* 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) + PADAPTER pAdapter, + u16 addr, + u8 *data, + BOOLEAN bPseudoTest) { u32 tmpidx = 0; u8 bResult; @@ -1721,6 +2105,14 @@ efuse_OneByteRead( return bResult; } +#ifdef CONFIG_RTL8710B + /* <20171208, Peter>, Dont do the following write16(0x34) */ + if (IS_HARDWARE_TYPE_8710B(pAdapter)) { + bResult = pAdapter->hal_func.efuse_indirect_read4(pAdapter, addr, data); + return bResult; + } +#endif + 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)) @@ -1762,10 +2154,10 @@ efuse_OneByteRead( /* 11/16/2008 MH Write one byte to reald Efuse. */ u8 efuse_OneByteWrite( - IN PADAPTER pAdapter, - IN u16 addr, - IN u8 data, - IN BOOLEAN bPseudoTest) + PADAPTER pAdapter, + u16 addr, + u8 data, + BOOLEAN bPseudoTest) { u8 tmpidx = 0; u8 bResult = _FALSE; @@ -1833,10 +2225,10 @@ efuse_OneByteWrite( } int -Efuse_PgPacketRead(IN PADAPTER pAdapter, - IN u8 offset, - IN u8 *data, - IN BOOLEAN bPseudoTest) +Efuse_PgPacketRead(PADAPTER pAdapter, + u8 offset, + u8 *data, + BOOLEAN bPseudoTest) { int ret = 0; @@ -1846,11 +2238,11 @@ Efuse_PgPacketRead(IN PADAPTER pAdapter, } int -Efuse_PgPacketWrite(IN PADAPTER pAdapter, - IN u8 offset, - IN u8 word_en, - IN u8 *data, - IN BOOLEAN bPseudoTest) +Efuse_PgPacketWrite(PADAPTER pAdapter, + u8 offset, + u8 word_en, + u8 *data, + BOOLEAN bPseudoTest) { int ret; @@ -1861,11 +2253,11 @@ Efuse_PgPacketWrite(IN PADAPTER pAdapter, int -Efuse_PgPacketWrite_BT(IN PADAPTER pAdapter, - IN u8 offset, - IN u8 word_en, - IN u8 *data, - IN BOOLEAN bPseudoTest) +Efuse_PgPacketWrite_BT(PADAPTER pAdapter, + u8 offset, + u8 word_en, + u8 *data, + BOOLEAN bPseudoTest) { int ret; @@ -1876,11 +2268,11 @@ Efuse_PgPacketWrite_BT(IN PADAPTER pAdapter, u8 -Efuse_WordEnableDataWrite(IN PADAPTER pAdapter, - IN u16 efuse_addr, - IN u8 word_en, - IN u8 *data, - IN BOOLEAN bPseudoTest) +Efuse_WordEnableDataWrite(PADAPTER pAdapter, + u16 efuse_addr, + u8 word_en, + u8 *data, + BOOLEAN bPseudoTest) { u8 ret = 0; @@ -1911,8 +2303,8 @@ u8 rtw_efuse_access(PADAPTER padapter, u8 bWrite, u16 start_addr, u16 cnts, 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); + EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_REAL_CONTENT_LEN, (void *)&real_content_len, _FALSE); + EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (void *)&max_available_size, _FALSE); if (start_addr > real_content_len) return _FAIL; @@ -1952,7 +2344,7 @@ u16 efuse_GetMaxSize(PADAPTER padapter) u16 max_size; max_size = 0; - EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI , TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_size, _FALSE); + EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI , TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (void *)&max_size, _FALSE); return max_size; } /* ------------------------------------------------------------------------------ */ @@ -1970,7 +2362,7 @@ u16 efuse_bt_GetMaxSize(PADAPTER padapter) u16 max_size; max_size = 0; - EFUSE_GetEfuseDefinition(padapter, EFUSE_BT , TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_size, _FALSE); + EFUSE_GetEfuseDefinition(padapter, EFUSE_BT , TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (void *)&max_size, _FALSE); return max_size; } @@ -1987,7 +2379,7 @@ u8 rtw_efuse_map_read(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) { u16 mapLen = 0; - EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, _FALSE); + EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (void *)&mapLen, _FALSE); if ((addr + cnts) > mapLen) return _FAIL; @@ -2005,7 +2397,7 @@ u8 rtw_BT_efuse_map_read(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) { u16 mapLen = 0; - EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, _FALSE); + EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_EFUSE_MAP_LEN, (void *)&mapLen, _FALSE); if ((addr + cnts) > mapLen) return _FAIL; @@ -2029,8 +2421,9 @@ 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; @@ -2040,7 +2433,7 @@ u8 rtw_efuse_map_write(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) PEFUSE_HAL pEfuseHal = &pHalData->EfuseHal; - EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, _FALSE); + EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (void *)&mapLen, _FALSE); EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, &efuse_max_available_len, _FALSE); if ((addr + cnts) > mapLen) @@ -2049,26 +2442,36 @@ 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 ,Write data[%d] = %x, map[%d]= %x\n", __func__, addr + i, efuse[ addr + i], addr + i, map[addr + i]); } } /*Efuse_PowerSwitch(padapter, _TRUE, _TRUE);*/ @@ -2081,7 +2484,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); } @@ -2122,9 +2525,9 @@ 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->version_id) || IS_B_CUT(pHalData->version_id)) { @@ -2159,6 +2562,7 @@ u8 rtw_efuse_map_write(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) exit: rtw_mfree(map, mapLen); + rtw_mfree(efuse, mapLen); return ret; } @@ -2180,7 +2584,7 @@ u8 rtw_BT_efuse_map_write(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) u8 ret = _SUCCESS; u16 mapLen = 0; - EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, _FALSE); + EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_EFUSE_MAP_LEN, (void *)&mapLen, _FALSE); if ((addr + cnts) > mapLen) return _FAIL; @@ -2261,91 +2665,30 @@ u8 rtw_BT_efuse_map_write(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) * 11/11/2008 MHC Create Version 0. * *---------------------------------------------------------------------------*/ -VOID +void Efuse_ReadAllMap( - IN PADAPTER pAdapter, - IN u8 efuseType, - IN OUT u8 *Efuse, - IN BOOLEAN bPseudoTest); -VOID + PADAPTER pAdapter, + u8 efuseType, + u8 *Efuse, + BOOLEAN bPseudoTest); +void Efuse_ReadAllMap( - IN PADAPTER pAdapter, - IN u8 efuseType, - IN OUT u8 *Efuse, - IN BOOLEAN bPseudoTest) + PADAPTER pAdapter, + u8 efuseType, + u8 *Efuse, + BOOLEAN bPseudoTest) { u16 mapLen = 0; Efuse_PowerSwitch(pAdapter, _FALSE, _TRUE); - EFUSE_GetEfuseDefinition(pAdapter, efuseType, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, bPseudoTest); + EFUSE_GetEfuseDefinition(pAdapter, efuseType, TYPE_EFUSE_MAP_LEN, (void *)&mapLen, bPseudoTest); efuse_ReadEFuse(pAdapter, efuseType, 0, mapLen, Efuse, bPseudoTest); 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 @@ -2365,17 +2708,17 @@ efuse_ShadowRead4Byte( * *---------------------------------------------------------------------------*/ #ifdef PLATFORM -static VOID +static void efuse_ShadowWrite1Byte( - IN PADAPTER pAdapter, - IN u16 Offset, - IN u8 Value); + PADAPTER pAdapter, + u16 Offset, + u8 Value); #endif /* PLATFORM */ -static VOID +static void efuse_ShadowWrite1Byte( - IN PADAPTER pAdapter, - IN u16 Offset, - IN u8 Value) + PADAPTER pAdapter, + u16 Offset, + u8 Value) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); @@ -2384,11 +2727,11 @@ efuse_ShadowWrite1Byte( } /* efuse_ShadowWrite1Byte */ /* ---------------Write Two Bytes */ -static VOID +static void efuse_ShadowWrite2Byte( - IN PADAPTER pAdapter, - IN u16 Offset, - IN u16 Value) + PADAPTER pAdapter, + u16 Offset, + u16 Value) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); @@ -2400,11 +2743,11 @@ efuse_ShadowWrite2Byte( } /* efuse_ShadowWrite1Byte */ /* ---------------Write Four Bytes */ -static VOID +static void efuse_ShadowWrite4Byte( - IN PADAPTER pAdapter, - IN u16 Offset, - IN u32 Value) + PADAPTER pAdapter, + u16 Offset, + u32 Value) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); @@ -2416,38 +2759,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 * @@ -2464,18 +2775,18 @@ EFUSE_ShadowRead( * 11/12/2008 MHC Create Version 0. * *---------------------------------------------------------------------------*/ -VOID +void EFUSE_ShadowWrite( - IN PADAPTER pAdapter, - IN u8 Type, - IN u16 Offset, - IN OUT u32 Value); -VOID + PADAPTER pAdapter, + u8 Type, + u16 Offset, + u32 Value); +void EFUSE_ShadowWrite( - IN PADAPTER pAdapter, - IN u8 Type, - IN u16 Offset, - IN OUT u32 Value) + PADAPTER pAdapter, + u8 Type, + u16 Offset, + u32 Value) { #if (MP_DRIVER == 0) return; @@ -2493,35 +2804,91 @@ EFUSE_ShadowWrite( } /* EFUSE_ShadowWrite */ -VOID -Efuse_InitSomeVar( - IN PADAPTER pAdapter -); -VOID -Efuse_InitSomeVar( - IN PADAPTER pAdapter -) -{ - u8 i; - - _rtw_memset((PVOID)&fakeEfuseContent[0], 0xff, EFUSE_MAX_HW_SIZE); - _rtw_memset((PVOID)&fakeEfuseInitMap[0], 0xff, EFUSE_MAX_MAP_LEN); - _rtw_memset((PVOID)&fakeEfuseModifiedMap[0], 0xff, EFUSE_MAX_MAP_LEN); - - for (i = 0; i < EFUSE_MAX_BT_BANK; i++) - _rtw_memset((PVOID)&BTEfuseContent[i][0], EFUSE_MAX_HW_SIZE, 0xff); - _rtw_memset((PVOID)&BTEfuseInitMap[0], 0xff, EFUSE_BT_MAX_MAP_LEN); - _rtw_memset((PVOID)&BTEfuseModifiedMap[0], 0xff, EFUSE_BT_MAX_MAP_LEN); - - for (i = 0; i < EFUSE_MAX_BT_BANK; i++) - _rtw_memset((PVOID)&fakeBTEfuseContent[i][0], 0xff, EFUSE_MAX_HW_SIZE); - _rtw_memset((PVOID)&fakeBTEfuseInitMap[0], 0xff, EFUSE_BT_MAX_MAP_LEN); - _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( + PADAPTER pAdapter, + u16 Offset, + 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( + PADAPTER pAdapter, + u16 Offset, + 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( + PADAPTER pAdapter, + u16 Offset, + 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( + PADAPTER pAdapter, + u8 Type, + u16 Offset, + 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) +Efuse_CalculateWordCnts(u8 word_en) { u8 word_cnts = 0; if (!(word_en & BIT(0))) @@ -2553,9 +2920,9 @@ Efuse_CalculateWordCnts(IN u8 word_en) * *---------------------------------------------------------------------------*/ void -efuse_WordEnableDataRead(IN u8 word_en, - IN u8 *sourdata, - IN u8 *targetdata) +efuse_WordEnableDataRead(u8 word_en, + u8 *sourdata, + u8 *targetdata) { if (!(word_en & BIT(0))) { targetdata[0] = sourdata[0]; @@ -2592,9 +2959,9 @@ efuse_WordEnableDataRead(IN u8 word_en, * *---------------------------------------------------------------------------*/ void EFUSE_ShadowMapUpdate( - IN PADAPTER pAdapter, - IN u8 efuseType, - IN BOOLEAN bPseudoTest) + PADAPTER pAdapter, + u8 efuseType, + BOOLEAN bPseudoTest) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); u16 mapLen = 0; @@ -2608,7 +2975,7 @@ void EFUSE_ShadowMapUpdate( /* efuse default content is 0xFF */ _rtw_memset(efuse_map, 0xFF, EEPROM_MAX_SIZE); - EFUSE_GetEfuseDefinition(pAdapter, efuseType, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, bPseudoTest); + EFUSE_GetEfuseDefinition(pAdapter, efuseType, TYPE_EFUSE_MAP_LEN, (void *)&mapLen, bPseudoTest); if (!mapLen) { RTW_WARN("%s: fail to get efuse size!\n", __FUNCTION__); mapLen = EEPROM_MAX_SIZE; @@ -2620,12 +2987,12 @@ 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__); } #else /* !RTW_HALMAC */ - EFUSE_GetEfuseDefinition(pAdapter, efuseType, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, bPseudoTest); + EFUSE_GetEfuseDefinition(pAdapter, efuseType, TYPE_EFUSE_MAP_LEN, (void *)&mapLen, bPseudoTest); if (pHalData->bautoload_fail_flag == _TRUE) _rtw_memset(pHalData->efuse_eeprom_data, 0xFF, mapLen); @@ -2642,10 +3009,12 @@ void EFUSE_ShadowMapUpdate( #endif } - /* PlatformMoveMemory((PVOID)&pHalData->EfuseMap[EFUSE_MODIFY_MAP][0], */ - /* (PVOID)&pHalData->EfuseMap[EFUSE_INIT_MAP][0], mapLen); */ + /* PlatformMoveMemory((void *)&pHalData->EfuseMap[EFUSE_MODIFY_MAP][0], */ + /* (void *)&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 */ @@ -2752,7 +3121,7 @@ u8 rtw_efuse_file_read(PADAPTER padapter, u8 *filepatch, u8 *buf, u32 len) return _FALSE; count = rtw_retrieve_from_file(filepatch, ptmpbuf, bufsize); - if (count <= 100) { + if (count <= 90) { rtw_mfree(ptmpbuf, bufsize); RTW_ERR("%s, filepatch %s, size=%d, FAIL!!\n", __FUNCTION__, filepatch, count); return _FALSE; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/mesh/rtw_mesh.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/mesh/rtw_mesh.c new file mode 100644 index 000000000000..ef192c6a4592 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/mesh/rtw_mesh.c @@ -0,0 +1,4097 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + *****************************************************************************/ +#define _RTW_MESH_C_ + +#ifdef CONFIG_RTW_MESH +#include + +const char *_rtw_mesh_plink_str[] = { + "UNKNOWN", + "LISTEN", + "OPN_SNT", + "OPN_RCVD", + "CNF_RCVD", + "ESTAB", + "HOLDING", + "BLOCKED", +}; + +const char *_rtw_mesh_ps_str[] = { + "UNKNOWN", + "ACTIVE", + "LSLEEP", + "DSLEEP", +}; + +const char *_action_self_protected_str[] = { + "ACT_SELF_PROTECTED_RSVD", + "MESH_OPEN", + "MESH_CONF", + "MESH_CLOSE", + "MESH_GK_INFORM", + "MESH_GK_ACK", +}; + +inline u8 *rtw_set_ie_mesh_id(u8 *buf, u32 *buf_len, const char *mesh_id, u8 id_len) +{ + return rtw_set_ie(buf, WLAN_EID_MESH_ID, id_len, mesh_id, buf_len); +} + +inline u8 *rtw_set_ie_mesh_config(u8 *buf, u32 *buf_len + , u8 path_sel_proto, u8 path_sel_metric, u8 congest_ctl_mode, u8 sync_method, u8 auth_proto + , u8 num_of_peerings, bool cto_mgate, bool cto_as + , bool accept_peerings, bool mcca_sup, bool mcca_en, bool forwarding + , bool mbca_en, bool tbtt_adj, bool ps_level) +{ + + u8 conf[7] = {0}; + + SET_MESH_CONF_ELE_PATH_SEL_PROTO_ID(conf, path_sel_proto); + SET_MESH_CONF_ELE_PATH_SEL_METRIC_ID(conf, path_sel_metric); + SET_MESH_CONF_ELE_CONGEST_CTRL_MODE_ID(conf, congest_ctl_mode); + SET_MESH_CONF_ELE_SYNC_METHOD_ID(conf, sync_method); + SET_MESH_CONF_ELE_AUTH_PROTO_ID(conf, auth_proto); + + SET_MESH_CONF_ELE_CTO_MGATE(conf, cto_mgate); + SET_MESH_CONF_ELE_NUM_OF_PEERINGS(conf, num_of_peerings); + SET_MESH_CONF_ELE_CTO_AS(conf, cto_as); + + SET_MESH_CONF_ELE_ACCEPT_PEERINGS(conf, accept_peerings); + SET_MESH_CONF_ELE_MCCA_SUP(conf, mcca_sup); + SET_MESH_CONF_ELE_MCCA_EN(conf, mcca_en); + SET_MESH_CONF_ELE_FORWARDING(conf, forwarding); + SET_MESH_CONF_ELE_MBCA_EN(conf, mbca_en); + SET_MESH_CONF_ELE_TBTT_ADJ(conf, tbtt_adj); + SET_MESH_CONF_ELE_PS_LEVEL(conf, ps_level); + + return rtw_set_ie(buf, WLAN_EID_MESH_CONFIG, 7, conf, buf_len); +} + +inline u8 *rtw_set_ie_mpm(u8 *buf, u32 *buf_len + , u8 proto_id, u16 llid, u16 *plid, u16 *reason, u8 *chosen_pmk) +{ + u8 data[24] = {0}; + u8 *pos = data; + + RTW_PUT_LE16(pos, proto_id); + pos += 2; + + RTW_PUT_LE16(pos, llid); + pos += 2; + + if (plid) { + RTW_PUT_LE16(pos, *plid); + pos += 2; + } + + if (reason) { + RTW_PUT_LE16(pos, *reason); + pos += 2; + } + + if (chosen_pmk) { + _rtw_memcpy(pos, chosen_pmk, 16); + pos += 16; + } + + return rtw_set_ie(buf, WLAN_EID_MPM, pos - data, data, buf_len); +} + +bool rtw_bss_is_forwarding(WLAN_BSSID_EX *bss) +{ + u8 *ie; + int ie_len; + bool ret = 0; + + ie = rtw_get_ie(BSS_EX_TLV_IES(bss), WLAN_EID_MESH_CONFIG, &ie_len, + BSS_EX_TLV_IES_LEN(bss)); + if (!ie || ie_len != 7) + goto exit; + + ret = GET_MESH_CONF_ELE_FORWARDING(ie + 2); + +exit: + return ret; +} + +bool rtw_bss_is_cto_mgate(WLAN_BSSID_EX *bss) +{ + u8 *ie; + int ie_len; + bool ret = 0; + + ie = rtw_get_ie(BSS_EX_TLV_IES(bss), WLAN_EID_MESH_CONFIG, &ie_len, + BSS_EX_TLV_IES_LEN(bss)); + if (!ie || ie_len != 7) + goto exit; + + ret = GET_MESH_CONF_ELE_CTO_MGATE(ie + 2); + +exit: + return ret; +} + +int rtw_bss_is_same_mbss(WLAN_BSSID_EX *a, WLAN_BSSID_EX *b) +{ + int ret = 0; + u8 *a_mconf_ie, *b_mconf_ie; + sint a_mconf_ie_len, b_mconf_ie_len; + + if (a->InfrastructureMode != Ndis802_11_mesh) + goto exit; + a_mconf_ie = rtw_get_ie(BSS_EX_TLV_IES(a), WLAN_EID_MESH_CONFIG, &a_mconf_ie_len, BSS_EX_TLV_IES_LEN(a)); + if (!a_mconf_ie || a_mconf_ie_len != 7) + goto exit; + if (b->InfrastructureMode != Ndis802_11_mesh) + goto exit; + b_mconf_ie = rtw_get_ie(BSS_EX_TLV_IES(b), WLAN_EID_MESH_CONFIG, &b_mconf_ie_len, BSS_EX_TLV_IES_LEN(b)); + if (!b_mconf_ie || b_mconf_ie_len != 7) + goto exit; + + if (a->mesh_id.SsidLength != b->mesh_id.SsidLength + || _rtw_memcmp(a->mesh_id.Ssid, b->mesh_id.Ssid, a->mesh_id.SsidLength) == _FALSE) + goto exit; + + if (_rtw_memcmp(a_mconf_ie + 2, b_mconf_ie + 2, 5) == _FALSE) + goto exit; + + ret = 1; + +exit: + return ret; +} + +int rtw_bss_is_candidate_mesh_peer(WLAN_BSSID_EX *self, WLAN_BSSID_EX *target, u8 ch, u8 add_peer) +{ + int ret = 0; + u8 *mconf_ie; + sint mconf_ie_len; + int i, j; + + if (!rtw_bss_is_same_mbss(self, target)) + goto exit; + + if (ch && self->Configuration.DSConfig != target->Configuration.DSConfig) + goto exit; + + if (add_peer) { + /* Accept additional mesh peerings */ + mconf_ie = rtw_get_ie(BSS_EX_TLV_IES(target), WLAN_EID_MESH_CONFIG, &mconf_ie_len, BSS_EX_TLV_IES_LEN(target)); + if (!mconf_ie || mconf_ie_len != 7) + goto exit; + if (GET_MESH_CONF_ELE_ACCEPT_PEERINGS(mconf_ie + 2) == 0) + goto exit; + } + + /* BSSBasicRateSet */ + for (i = 0; i < NDIS_802_11_LENGTH_RATES_EX; i++) { + if (target->SupportedRates[i] == 0) + break; + if (target->SupportedRates[i] & 0x80) { + u8 match = 0; + + if (!ch) { + /* off-channel, check target with our hardcode capability */ + if (target->Configuration.DSConfig > 14) + match = rtw_is_basic_rate_ofdm(target->SupportedRates[i]); + else + match = rtw_is_basic_rate_mix(target->SupportedRates[i]); + } else { + for (j = 0; j < NDIS_802_11_LENGTH_RATES_EX; j++) { + if (self->SupportedRates[j] == 0) + break; + if (self->SupportedRates[j] == target->SupportedRates[i]) { + match = 1; + break; + } + } + } + if (!match) + goto exit; + } + } + + + /* BSSBasicMCSSet */ + + /* 802.1X connected to AS ? */ + + ret = 1; + +exit: + return ret; +} + +void rtw_mesh_bss_peering_status(WLAN_BSSID_EX *bss, u8 *nop, u8 *accept) +{ + u8 *ie; + int ie_len; + + if (nop) + *nop = 0; + if (accept) + *accept = 0; + + ie = rtw_get_ie(BSS_EX_TLV_IES(bss), WLAN_EID_MESH_CONFIG, &ie_len, + BSS_EX_TLV_IES_LEN(bss)); + if (!ie || ie_len != 7) + goto exit; + + if (nop) + *nop = GET_MESH_CONF_ELE_NUM_OF_PEERINGS(ie + 2); + if (accept) + *accept = GET_MESH_CONF_ELE_ACCEPT_PEERINGS(ie + 2); + +exit: + return; +} + +#if CONFIG_RTW_MESH_ACNODE_PREVENT +void rtw_mesh_update_scanned_acnode_status(_adapter *adapter, struct wlan_network *scanned) +{ + bool acnode; + u8 nop, accept; + + rtw_mesh_bss_peering_status(&scanned->network, &nop, &accept); + + acnode = !nop && accept; + + if (acnode && scanned->acnode_stime == 0) { + scanned->acnode_stime = rtw_get_current_time(); + if (scanned->acnode_stime == 0) + scanned->acnode_stime++; + } else if (!acnode) { + scanned->acnode_stime = 0; + scanned->acnode_notify_etime = 0; + } +} + +bool rtw_mesh_scanned_is_acnode_confirmed(_adapter *adapter, struct wlan_network *scanned) +{ + return scanned->acnode_stime + && rtw_get_passing_time_ms(scanned->acnode_stime) + > adapter->mesh_cfg.peer_sel_policy.acnode_conf_timeout_ms; +} + +static bool rtw_mesh_scanned_is_acnode_allow_notify(_adapter *adapter, struct wlan_network *scanned) +{ + return scanned->acnode_notify_etime + && rtw_time_after(scanned->acnode_notify_etime, rtw_get_current_time()); +} + +bool rtw_mesh_acnode_prevent_allow_sacrifice(_adapter *adapter) +{ + struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; + struct sta_priv *stapriv = &adapter->stapriv; + bool allow = 0; + + if (!mcfg->peer_sel_policy.acnode_prevent + || mcfg->max_peer_links <= 1 + || stapriv->asoc_list_cnt < mcfg->max_peer_links) + goto exit; + +#if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST + if (rtw_mesh_cto_mgate_required(adapter)) + goto exit; +#endif + + allow = 1; + +exit: + return allow; +} + +static bool rtw_mesh_acnode_candidate_exist(_adapter *adapter) +{ + struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; + struct sta_priv *stapriv = &adapter->stapriv; + struct mlme_priv *mlme = &adapter->mlmepriv; + _queue *queue = &(mlme->scanned_queue); + _list *head, *list; + _irqL irqL; + struct wlan_network *scanned = NULL; + struct sta_info *sta = NULL; + bool need = 0; + + _enter_critical_bh(&(mlme->scanned_queue.lock), &irqL); + + head = get_list_head(queue); + list = get_next(head); + while (!rtw_end_of_queue_search(head, list)) { + scanned = LIST_CONTAINOR(list, struct wlan_network, list); + list = get_next(list); + + if (rtw_get_passing_time_ms(scanned->last_scanned) < mcfg->peer_sel_policy.scanr_exp_ms + && rtw_mesh_scanned_is_acnode_confirmed(adapter, scanned) + && (!mcfg->rssi_threshold || mcfg->rssi_threshold <= scanned->network.Rssi) + #if CONFIG_RTW_MACADDR_ACL + && rtw_access_ctrl(adapter, scanned->network.MacAddress) == _TRUE + #endif + && rtw_bss_is_candidate_mesh_peer(&mlme->cur_network.network, &scanned->network, 1, 1) + #if CONFIG_RTW_MESH_PEER_BLACKLIST + && !rtw_mesh_peer_blacklist_search(adapter, scanned->network.MacAddress) + #endif + #if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST + && rtw_mesh_cto_mgate_network_filter(adapter, scanned) + #endif + ) { + need = 1; + break; + } + } + + _exit_critical_bh(&(mlme->scanned_queue.lock), &irqL); + + return need; +} + +static int rtw_mesh_acnode_prevent_sacrifice_chk(_adapter *adapter, struct sta_info **sac, struct sta_info *com) +{ + struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; + int updated = 0; + + /* + * TODO: compare next_hop reference cnt of forwarding info + * don't sacrifice working next_hop or choose sta with least cnt + */ + + if (*sac == NULL) { + updated = 1; + goto exit; + } + +#if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST + if (mcfg->peer_sel_policy.cto_mgate_require + && !mcfg->dot11MeshGateAnnouncementProtocol + ) { + if (IS_CTO_MGATE_CONF_TIMEOUT(com->plink)) { + if (!IS_CTO_MGATE_CONF_TIMEOUT((*sac)->plink)) { + /* blacklist > not blacklist */ + updated = 1; + goto exit; + } + } else if (!IS_CTO_MGATE_CONF_DISABLED(com->plink)) { + if (IS_CTO_MGATE_CONF_DISABLED((*sac)->plink)) { + /* confirming > disabled */ + updated = 1; + goto exit; + } + } + } +#endif + +exit: + if (updated) + *sac = com; + + return updated; +} + +struct sta_info *_rtw_mesh_acnode_prevent_pick_sacrifice(_adapter *adapter) +{ + struct sta_priv *stapriv = &adapter->stapriv; + _list *head, *list; + struct sta_info *sta, *sacrifice = NULL; + u8 nop; + + head = &stapriv->asoc_list; + list = get_next(head); + while (rtw_end_of_queue_search(head, list) == _FALSE) { + sta = LIST_CONTAINOR(list, struct sta_info, asoc_list); + list = get_next(list); + + if (!sta->plink || !sta->plink->scanned) { + rtw_warn_on(1); + continue; + } + + rtw_mesh_bss_peering_status(&sta->plink->scanned->network, &nop, NULL); + if (nop < 2) + continue; + + rtw_mesh_acnode_prevent_sacrifice_chk(adapter, &sacrifice, sta); + } + + return sacrifice; +} + +struct sta_info *rtw_mesh_acnode_prevent_pick_sacrifice(_adapter *adapter) +{ + struct sta_priv *stapriv = &adapter->stapriv; + struct sta_info *sacrifice = NULL; + + enter_critical_bh(&stapriv->asoc_list_lock); + + sacrifice = _rtw_mesh_acnode_prevent_pick_sacrifice(adapter); + + exit_critical_bh(&stapriv->asoc_list_lock); + + return sacrifice; +} + +static void rtw_mesh_acnode_rsvd_chk(_adapter *adapter) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; + u8 acnode_rsvd = 0; + + if (rtw_mesh_acnode_prevent_allow_sacrifice(adapter) + && rtw_mesh_acnode_prevent_pick_sacrifice(adapter) + && rtw_mesh_acnode_candidate_exist(adapter)) + acnode_rsvd = 1; + + if (plink_ctl->acnode_rsvd != acnode_rsvd) { + plink_ctl->acnode_rsvd = acnode_rsvd; + RTW_INFO(FUNC_ADPT_FMT" acnode_rsvd = %d\n", FUNC_ADPT_ARG(adapter), plink_ctl->acnode_rsvd); + update_beacon(adapter, WLAN_EID_MESH_CONFIG, NULL, 1); + } +} + +static void rtw_mesh_acnode_set_notify_etime(_adapter *adapter, u8 *rframe_whdr) +{ + if (adapter->mesh_info.plink_ctl.acnode_rsvd) { + struct wlan_network *scanned = rtw_find_network(&adapter->mlmepriv.scanned_queue, get_addr2_ptr(rframe_whdr)); + + if (rtw_mesh_scanned_is_acnode_confirmed(adapter, scanned)) { + scanned->acnode_notify_etime = rtw_get_current_time() + + rtw_ms_to_systime(adapter->mesh_cfg.peer_sel_policy.acnode_notify_timeout_ms); + if (scanned->acnode_notify_etime == 0) + scanned->acnode_notify_etime++; + } + } +} + +void dump_mesh_acnode_prevent_settings(void *sel, _adapter *adapter) +{ + struct mesh_peer_sel_policy *peer_sel_policy = &adapter->mesh_cfg.peer_sel_policy; + + RTW_PRINT_SEL(sel, "%-6s %-12s %-14s\n" + , "enable", "conf_timeout", "nofity_timeout"); + RTW_PRINT_SEL(sel, "%6u %12u %14u\n" + , peer_sel_policy->acnode_prevent + , peer_sel_policy->acnode_conf_timeout_ms + , peer_sel_policy->acnode_notify_timeout_ms); +} +#endif /* CONFIG_RTW_MESH_ACNODE_PREVENT */ + +#if CONFIG_RTW_MESH_PEER_BLACKLIST +int rtw_mesh_peer_blacklist_add(_adapter *adapter, const u8 *addr) +{ + struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; + + return rtw_blacklist_add(&plink_ctl->peer_blacklist, addr + , mcfg->peer_sel_policy.peer_blacklist_timeout_ms); +} + +int rtw_mesh_peer_blacklist_del(_adapter *adapter, const u8 *addr) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; + + return rtw_blacklist_del(&plink_ctl->peer_blacklist, addr); +} + +int rtw_mesh_peer_blacklist_search(_adapter *adapter, const u8 *addr) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; + + return rtw_blacklist_search(&plink_ctl->peer_blacklist, addr); +} + +void rtw_mesh_peer_blacklist_flush(_adapter *adapter) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; + + rtw_blacklist_flush(&plink_ctl->peer_blacklist); +} + +void dump_mesh_peer_blacklist(void *sel, _adapter *adapter) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; + + dump_blacklist(sel, &plink_ctl->peer_blacklist, "blacklist"); +} + +void dump_mesh_peer_blacklist_settings(void *sel, _adapter *adapter) +{ + struct mesh_peer_sel_policy *peer_sel_policy = &adapter->mesh_cfg.peer_sel_policy; + + RTW_PRINT_SEL(sel, "%-12s %-17s\n" + , "conf_timeout", "blacklist_timeout"); + RTW_PRINT_SEL(sel, "%12u %17u\n" + , peer_sel_policy->peer_conf_timeout_ms + , peer_sel_policy->peer_blacklist_timeout_ms); +} +#endif /* CONFIG_RTW_MESH_PEER_BLACKLIST */ + +#if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST +u8 rtw_mesh_cto_mgate_required(_adapter *adapter) +{ + struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; + struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; + + return mcfg->peer_sel_policy.cto_mgate_require + && !rtw_bss_is_cto_mgate(&(mlmeext->mlmext_info.network)); +} + +u8 rtw_mesh_cto_mgate_network_filter(_adapter *adapter, struct wlan_network *scanned) +{ + struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; + struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; + + return !rtw_mesh_cto_mgate_required(adapter) + || (rtw_bss_is_cto_mgate(&scanned->network) + && !rtw_mesh_cto_mgate_blacklist_search(adapter, scanned->network.MacAddress)); +} + +int rtw_mesh_cto_mgate_blacklist_add(_adapter *adapter, const u8 *addr) +{ + struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; + + return rtw_blacklist_add(&plink_ctl->cto_mgate_blacklist, addr + , mcfg->peer_sel_policy.cto_mgate_blacklist_timeout_ms); +} + +int rtw_mesh_cto_mgate_blacklist_del(_adapter *adapter, const u8 *addr) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; + + return rtw_blacklist_del(&plink_ctl->cto_mgate_blacklist, addr); +} + +int rtw_mesh_cto_mgate_blacklist_search(_adapter *adapter, const u8 *addr) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; + + return rtw_blacklist_search(&plink_ctl->cto_mgate_blacklist, addr); +} + +void rtw_mesh_cto_mgate_blacklist_flush(_adapter *adapter) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; + + rtw_blacklist_flush(&plink_ctl->cto_mgate_blacklist); +} + +void dump_mesh_cto_mgate_blacklist(void *sel, _adapter *adapter) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; + + dump_blacklist(sel, &plink_ctl->cto_mgate_blacklist, "blacklist"); +} + +void dump_mesh_cto_mgate_blacklist_settings(void *sel, _adapter *adapter) +{ + struct mesh_peer_sel_policy *peer_sel_policy = &adapter->mesh_cfg.peer_sel_policy; + + RTW_PRINT_SEL(sel, "%-12s %-17s\n" + , "conf_timeout", "blacklist_timeout"); + RTW_PRINT_SEL(sel, "%12u %17u\n" + , peer_sel_policy->cto_mgate_conf_timeout_ms + , peer_sel_policy->cto_mgate_blacklist_timeout_ms); +} + +static void rtw_mesh_cto_mgate_blacklist_chk(_adapter *adapter) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; + _queue *blist = &plink_ctl->cto_mgate_blacklist; + _list *list, *head; + struct blacklist_ent *ent = NULL; + struct wlan_network *scanned = NULL; + + enter_critical_bh(&blist->lock); + head = &blist->queue; + list = get_next(head); + while (rtw_end_of_queue_search(head, list) == _FALSE) { + ent = LIST_CONTAINOR(list, struct blacklist_ent, list); + list = get_next(list); + + if (rtw_time_after(rtw_get_current_time(), ent->exp_time)) { + rtw_list_delete(&ent->list); + rtw_mfree(ent, sizeof(struct blacklist_ent)); + continue; + } + + scanned = rtw_find_network(&adapter->mlmepriv.scanned_queue, ent->addr); + if (!scanned) + continue; + + if (rtw_bss_is_forwarding(&scanned->network)) { + rtw_list_delete(&ent->list); + rtw_mfree(ent, sizeof(struct blacklist_ent)); + } + } + + exit_critical_bh(&blist->lock); +} +#endif /* CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST */ + +void rtw_chk_candidate_peer_notify(_adapter *adapter, struct wlan_network *scanned) +{ + struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); + struct mlme_priv *mlme = &adapter->mlmepriv; + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; + struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; + bool acnode = 0; + + if (IS_CH_WAITING(rfctl) && !IS_UNDER_CAC(rfctl)) + goto exit; + + if (plink_ctl->num >= RTW_MESH_MAX_PEER_CANDIDATES) + goto exit; + +#if CONFIG_RTW_MESH_ACNODE_PREVENT + if (plink_ctl->acnode_rsvd) { + acnode = rtw_mesh_scanned_is_acnode_confirmed(adapter, scanned); + if (acnode && !rtw_mesh_scanned_is_acnode_allow_notify(adapter, scanned)) + goto exit; + } +#endif + + /* wpa_supplicant's auto peer will initiate peering when candidate peer is reported without max_peer_links consideration */ + if (plink_ctl->num >= mcfg->max_peer_links + acnode ? 1 : 0) + goto exit; + + if (rtw_get_passing_time_ms(scanned->last_scanned) >= mcfg->peer_sel_policy.scanr_exp_ms + || (mcfg->rssi_threshold && mcfg->rssi_threshold > scanned->network.Rssi) + || !rtw_bss_is_candidate_mesh_peer(&mlme->cur_network.network, &scanned->network, 1, 1) + #if CONFIG_RTW_MACADDR_ACL + || rtw_access_ctrl(adapter, scanned->network.MacAddress) == _FALSE + #endif + || rtw_mesh_plink_get(adapter, scanned->network.MacAddress) + #if CONFIG_RTW_MESH_PEER_BLACKLIST + || rtw_mesh_peer_blacklist_search(adapter, scanned->network.MacAddress) + #endif + #if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST + || !rtw_mesh_cto_mgate_network_filter(adapter, scanned) + #endif + ) + goto exit; + +#if CONFIG_RTW_MESH_ACNODE_PREVENT + if (acnode) { + scanned->acnode_notify_etime = 0; + RTW_INFO(FUNC_ADPT_FMT" acnode "MAC_FMT"\n" + , FUNC_ADPT_ARG(adapter), MAC_ARG(scanned->network.MacAddress)); + } +#endif + +#ifdef CONFIG_IOCTL_CFG80211 + rtw_cfg80211_notify_new_peer_candidate(adapter->rtw_wdev + , scanned->network.MacAddress + , BSS_EX_TLV_IES(&scanned->network) + , BSS_EX_TLV_IES_LEN(&scanned->network) + , scanned->network.Rssi + , GFP_ATOMIC + ); +#endif + +exit: + return; +} + +void rtw_mesh_peer_status_chk(_adapter *adapter) +{ + struct mlme_priv *mlme = &adapter->mlmepriv; + struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; + struct mesh_plink_ent *plink; + _list *head, *list; + struct sta_info *sta = NULL; + struct sta_priv *stapriv = &adapter->stapriv; + int stainfo_offset; +#if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST + u8 cto_mgate, forwarding, mgate; +#endif + u8 flush; + s8 flush_list[NUM_STA]; + u8 flush_num = 0; + int i; + +#if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST + if (rtw_mesh_cto_mgate_required(adapter)) { + /* active scan on operating channel */ + issue_probereq_ex(adapter, &adapter->mlmepriv.cur_network.network.mesh_id, NULL, 0, 0, 0, 0); + } +#endif + + enter_critical_bh(&(plink_ctl->lock)); + + /* check established peers */ + enter_critical_bh(&stapriv->asoc_list_lock); + + head = &stapriv->asoc_list; + list = get_next(head); + while (rtw_end_of_queue_search(head, list) == _FALSE) { + sta = LIST_CONTAINOR(list, struct sta_info, asoc_list); + list = get_next(list); + + if (!sta->plink || !sta->plink->scanned) { + rtw_warn_on(1); + continue; + } + plink = sta->plink; + flush = 0; + + /* remove unsuitable peer */ + if (!rtw_bss_is_candidate_mesh_peer(&mlme->cur_network.network, &plink->scanned->network, 1, 0) + #if CONFIG_RTW_MACADDR_ACL + || rtw_access_ctrl(adapter, plink->addr) == _FALSE + #endif + ) { + flush = 1; + goto flush_add; + } + + #if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST + cto_mgate = rtw_bss_is_cto_mgate(&(plink->scanned->network)); + forwarding = rtw_bss_is_forwarding(&(plink->scanned->network)); + mgate = rtw_mesh_gate_search(minfo->mesh_paths, sta->cmn.mac_addr); + + /* CTO_MGATE required, remove peer without CTO_MGATE */ + if (rtw_mesh_cto_mgate_required(adapter) && !cto_mgate) { + flush = 1; + goto flush_add; + } + + /* cto_mgate_conf status update */ + if (IS_CTO_MGATE_CONF_DISABLED(plink)) { + if (cto_mgate && !forwarding && !mgate) + SET_CTO_MGATE_CONF_END_TIME(plink, mcfg->peer_sel_policy.cto_mgate_conf_timeout_ms); + else + rtw_mesh_cto_mgate_blacklist_del(adapter, sta->cmn.mac_addr); + } else { + /* cto_mgate_conf ongoing */ + if (cto_mgate && !forwarding && !mgate) { + if (IS_CTO_MGATE_CONF_TIMEOUT(plink)) { + rtw_mesh_cto_mgate_blacklist_add(adapter, sta->cmn.mac_addr); + + /* CTO_MGATE required, remove peering can't achieve CTO_MGATE */ + if (rtw_mesh_cto_mgate_required(adapter)) { + flush = 1; + goto flush_add; + } + } + } else { + SET_CTO_MGATE_CONF_DISABLED(plink); + rtw_mesh_cto_mgate_blacklist_del(adapter, sta->cmn.mac_addr); + } + } + #endif /* CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST */ + +flush_add: + if (flush) { + rtw_list_delete(&sta->asoc_list); + stapriv->asoc_list_cnt--; + STA_SET_MESH_PLINK(sta, NULL); + + stainfo_offset = rtw_stainfo_offset(stapriv, sta); + if (stainfo_offset_valid(stainfo_offset)) + flush_list[flush_num++] = stainfo_offset; + else + rtw_warn_on(1); + } + } + + exit_critical_bh(&stapriv->asoc_list_lock); + + /* check non-established peers */ + for (i = 0; i < RTW_MESH_MAX_PEER_CANDIDATES; i++) { + plink = &plink_ctl->ent[i]; + if (plink->valid != _TRUE || plink->plink_state == RTW_MESH_PLINK_ESTAB) + continue; + + /* remove unsuitable peer */ + if (!rtw_bss_is_candidate_mesh_peer(&mlme->cur_network.network, &plink->scanned->network, 1, 1) + #if CONFIG_RTW_MACADDR_ACL + || rtw_access_ctrl(adapter, plink->addr) == _FALSE + #endif + ) { + _rtw_mesh_expire_peer_ent(adapter, plink); + continue; + } + + #if CONFIG_RTW_MESH_PEER_BLACKLIST + /* peer confirm check timeout, add to black list */ + if (IS_PEER_CONF_TIMEOUT(plink)) { + rtw_mesh_peer_blacklist_add(adapter, plink->addr); + _rtw_mesh_expire_peer_ent(adapter, plink); + } + #endif + } + + exit_critical_bh(&(plink_ctl->lock)); + + if (flush_num) { + u8 sta_addr[ETH_ALEN]; + u8 updated = _FALSE; + + for (i = 0; i < flush_num; i++) { + sta = rtw_get_stainfo_by_offset(stapriv, flush_list[i]); + _rtw_memcpy(sta_addr, sta->cmn.mac_addr, ETH_ALEN); + + updated |= ap_free_sta(adapter, sta, _TRUE, WLAN_REASON_DEAUTH_LEAVING, _FALSE); + rtw_mesh_expire_peer(adapter, sta_addr); + } + + associated_clients_update(adapter, updated, STA_INFO_UPDATE_ALL); + } + +#if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST + /* loop cto_mgate_blacklist to remove ent according to scan_r */ + rtw_mesh_cto_mgate_blacklist_chk(adapter); +#endif + +#if CONFIG_RTW_MESH_ACNODE_PREVENT + rtw_mesh_acnode_rsvd_chk(adapter); +#endif + + return; +} + +#if CONFIG_RTW_MESH_OFFCH_CAND +static u8 rtw_mesh_offch_cto_mgate_required(_adapter *adapter) +{ +#if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST + struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; + struct mlme_priv *mlme = &adapter->mlmepriv; + _queue *queue = &(mlme->scanned_queue); + _list *head, *pos; + struct wlan_network *scanned = NULL; + u8 ret = 0; + + if (!rtw_mesh_cto_mgate_required(adapter)) + goto exit; + + enter_critical_bh(&(mlme->scanned_queue.lock)); + + head = get_list_head(queue); + pos = get_next(head); + while (!rtw_end_of_queue_search(head, pos)) { + scanned = LIST_CONTAINOR(pos, struct wlan_network, list); + + if (rtw_get_passing_time_ms(scanned->last_scanned) < mcfg->peer_sel_policy.scanr_exp_ms + && (!mcfg->rssi_threshold || mcfg->rssi_threshold <= scanned->network.Rssi) + #if CONFIG_RTW_MACADDR_ACL + && rtw_access_ctrl(adapter, scanned->network.MacAddress) == _TRUE + #endif + && rtw_bss_is_candidate_mesh_peer(&mlme->cur_network.network, &scanned->network, 1, 1) + && rtw_bss_is_cto_mgate(&scanned->network) + #if CONFIG_RTW_MESH_PEER_BLACKLIST + && !rtw_mesh_peer_blacklist_search(adapter, scanned->network.MacAddress) + #endif + && !rtw_mesh_cto_mgate_blacklist_search(adapter, scanned->network.MacAddress) + ) + break; + + pos = get_next(pos); + } + + if (rtw_end_of_queue_search(head, pos)) + ret = 1; + + exit_critical_bh(&(mlme->scanned_queue.lock)); + +exit: + return ret; +#else + return 0; +#endif /* CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST */ +} + +u8 rtw_mesh_offch_candidate_accepted(_adapter *adapter) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; + u8 ret = 0; + + if (!adapter->mesh_cfg.peer_sel_policy.offch_cand) + goto exit; + + ret = MLME_IS_MESH(adapter) && MLME_IS_ASOC(adapter) + && (!plink_ctl->num || rtw_mesh_offch_cto_mgate_required(adapter)) + ; + +#ifdef CONFIG_CONCURRENT_MODE + if (ret) { + struct mi_state mstate_no_self; + + rtw_mi_status_no_self(adapter, &mstate_no_self); + if (MSTATE_STA_LD_NUM(&mstate_no_self)) + ret = 0; + } +#endif + +exit: + return ret; +} + +/* + * this function is called under off channel candidate is required + * the channel with maximum candidate count is selected +*/ +u8 rtw_mesh_select_operating_ch(_adapter *adapter) +{ + struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); + struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; + struct mlme_priv *mlme = &adapter->mlmepriv; + _queue *queue = &(mlme->scanned_queue); + _list *head, *pos; + _irqL irqL; + struct wlan_network *scanned = NULL; + int i; + /* statistics for candidate accept peering */ + u8 cand_ap_cnt[MAX_CHANNEL_NUM] = {0}; + u8 max_cand_ap_ch = 0; + u8 max_cand_ap_cnt = 0; + /* statistics for candidate including not accept peering */ + u8 cand_cnt[MAX_CHANNEL_NUM] = {0}; + u8 max_cand_ch = 0; + u8 max_cand_cnt = 0; + + _enter_critical_bh(&(mlme->scanned_queue.lock), &irqL); + + head = get_list_head(queue); + pos = get_next(head); + while (!rtw_end_of_queue_search(head, pos)) { + scanned = LIST_CONTAINOR(pos, struct wlan_network, list); + pos = get_next(pos); + + if (rtw_get_passing_time_ms(scanned->last_scanned) < mcfg->peer_sel_policy.scanr_exp_ms + && (!mcfg->rssi_threshold || mcfg->rssi_threshold <= scanned->network.Rssi) + #if CONFIG_RTW_MACADDR_ACL + && rtw_access_ctrl(adapter, scanned->network.MacAddress) == _TRUE + #endif + && rtw_bss_is_candidate_mesh_peer(&mlme->cur_network.network, &scanned->network, 0, 0) + #if CONFIG_RTW_MESH_PEER_BLACKLIST + && !rtw_mesh_peer_blacklist_search(adapter, scanned->network.MacAddress) + #endif + #if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST + && rtw_mesh_cto_mgate_network_filter(adapter, scanned) + #endif + ) { + int ch_set_idx = rtw_chset_search_ch(rfctl->channel_set, scanned->network.Configuration.DSConfig); + + if (ch_set_idx >= 0 + && !CH_IS_NON_OCP(&rfctl->channel_set[ch_set_idx]) + ) { + u8 nop, accept; + + rtw_mesh_bss_peering_status(&scanned->network, &nop, &accept); + cand_cnt[ch_set_idx]++; + if (max_cand_cnt < cand_cnt[ch_set_idx]) { + max_cand_cnt = cand_cnt[ch_set_idx]; + max_cand_ch = rfctl->channel_set[ch_set_idx].ChannelNum; + } + if (accept) { + cand_ap_cnt[ch_set_idx]++; + if (max_cand_ap_cnt < cand_ap_cnt[ch_set_idx]) { + max_cand_ap_cnt = cand_ap_cnt[ch_set_idx]; + max_cand_ap_ch = rfctl->channel_set[ch_set_idx].ChannelNum; + } + } + } + } + } + + _exit_critical_bh(&(mlme->scanned_queue.lock), &irqL); + + return max_cand_ap_ch ? max_cand_ap_ch : max_cand_ch; +} + +void dump_mesh_offch_cand_settings(void *sel, _adapter *adapter) +{ + struct mesh_peer_sel_policy *peer_sel_policy = &adapter->mesh_cfg.peer_sel_policy; + + RTW_PRINT_SEL(sel, "%-6s %-11s\n" + , "enable", "find_int_ms"); + RTW_PRINT_SEL(sel, "%6u %11u\n" + , peer_sel_policy->offch_cand, peer_sel_policy->offch_find_int_ms); +} +#endif /* CONFIG_RTW_MESH_OFFCH_CAND */ + +void dump_mesh_peer_sel_policy(void *sel, _adapter *adapter) +{ + struct mesh_peer_sel_policy *peer_sel_policy = &adapter->mesh_cfg.peer_sel_policy; + + RTW_PRINT_SEL(sel, "%-12s\n", "scanr_exp_ms"); + RTW_PRINT_SEL(sel, "%12u\n", peer_sel_policy->scanr_exp_ms); +} + +void dump_mesh_networks(void *sel, _adapter *adapter) +{ +#if CONFIG_RTW_MESH_ACNODE_PREVENT +#define NSTATE_TITLE_FMT_ACN " %-5s" +#define NSTATE_VALUE_FMT_ACN " %5d" +#define NSTATE_TITLE_ARG_ACN , "acn" +#define NSTATE_VALUE_ARG_ACN , (acn_ms < 99999 ? acn_ms : 99999) +#else +#define NSTATE_TITLE_FMT_ACN "" +#define NSTATE_VALUE_FMT_ACN "" +#define NSTATE_TITLE_ARG_ACN +#define NSTATE_VALUE_ARG_ACN +#endif + + struct mlme_priv *mlme = &(adapter->mlmepriv); + _queue *queue = &(mlme->scanned_queue); + struct wlan_network *network; + _list *list, *head; + u8 same_mbss; + u8 candidate; + struct mesh_plink_ent *plink; + u8 blocked; + u8 established; + s32 age_ms; +#if CONFIG_RTW_MESH_ACNODE_PREVENT + s32 acn_ms; +#endif + u8 *mesh_conf_ie; + sint mesh_conf_ie_len; + struct wlan_network **mesh_networks; + u8 mesh_network_cnt = 0; + int i; + + mesh_networks = rtw_zvmalloc(mlme->max_bss_cnt * sizeof(struct wlan_network *)); + if (!mesh_networks) + return; + + enter_critical_bh(&queue->lock); + head = get_list_head(queue); + list = get_next(head); + + while (rtw_end_of_queue_search(head, list) == _FALSE) { + network = LIST_CONTAINOR(list, struct wlan_network, list); + list = get_next(list); + + if (network->network.InfrastructureMode != Ndis802_11_mesh) + continue; + + mesh_conf_ie = rtw_get_ie(BSS_EX_TLV_IES(&network->network), WLAN_EID_MESH_CONFIG + , &mesh_conf_ie_len, BSS_EX_TLV_IES_LEN(&network->network)); + if (!mesh_conf_ie || mesh_conf_ie_len != 7) + continue; + + mesh_networks[mesh_network_cnt++] = network; + } + + exit_critical_bh(&queue->lock); + + RTW_PRINT_SEL(sel, " %-17s %-3s %-4s %-5s %-32s %-3s %-3s %-3s" + NSTATE_TITLE_FMT_ACN + "\n" + , "bssid", "ch", "rssi", "age", "mesh_id", "nop", "fwd", "cto" + NSTATE_TITLE_ARG_ACN + ); + + for (i = 0; i < mesh_network_cnt; i++) { + network = mesh_networks[i]; + + if (network->network.InfrastructureMode != Ndis802_11_mesh) + continue; + + mesh_conf_ie = rtw_get_ie(BSS_EX_TLV_IES(&network->network), WLAN_EID_MESH_CONFIG + , &mesh_conf_ie_len, BSS_EX_TLV_IES_LEN(&network->network)); + if (!mesh_conf_ie || mesh_conf_ie_len != 7) + continue; + + age_ms = rtw_get_passing_time_ms(network->last_scanned); + #if CONFIG_RTW_MESH_ACNODE_PREVENT + if (network->acnode_stime == 0) + acn_ms = 0; + else + acn_ms = rtw_get_passing_time_ms(network->acnode_stime); + #endif + same_mbss = 0; + candidate = 0; + plink = NULL; + blocked = 0; + established = 0; + + if (MLME_IS_MESH(adapter) && MLME_IS_ASOC(adapter)) { + plink = rtw_mesh_plink_get(adapter, network->network.MacAddress); + if (plink && plink->plink_state == RTW_MESH_PLINK_ESTAB) + established = 1; + else if (plink && plink->plink_state == RTW_MESH_PLINK_BLOCKED) + blocked = 1; + else if (plink) + ; + else if (rtw_bss_is_candidate_mesh_peer(&mlme->cur_network.network, &network->network, 0, 1)) + candidate = 1; + else if (rtw_bss_is_same_mbss(&mlme->cur_network.network, &network->network)) + same_mbss = 1; + } + + RTW_PRINT_SEL(sel, "%c "MAC_FMT" %3d %4ld %5d %-32s %c%2u %3u %c%c " + NSTATE_VALUE_FMT_ACN + "\n" + , established ? 'E' : (blocked ? 'B' : (plink ? 'N' : (candidate ? 'C' : (same_mbss ? 'S' : ' ')))) + , MAC_ARG(network->network.MacAddress) + , network->network.Configuration.DSConfig + , network->network.Rssi + , age_ms < 99999 ? age_ms : 99999 + , network->network.mesh_id.Ssid + , GET_MESH_CONF_ELE_ACCEPT_PEERINGS(mesh_conf_ie + 2) ? '+' : ' ' + , GET_MESH_CONF_ELE_NUM_OF_PEERINGS(mesh_conf_ie + 2) + , GET_MESH_CONF_ELE_FORWARDING(mesh_conf_ie + 2) + , GET_MESH_CONF_ELE_CTO_MGATE(mesh_conf_ie + 2) ? 'G' : ' ' + , GET_MESH_CONF_ELE_CTO_AS(mesh_conf_ie + 2) ? 'A' : ' ' + NSTATE_VALUE_ARG_ACN + ); + } + + rtw_vmfree(mesh_networks, mlme->max_bss_cnt * sizeof(struct wlan_network *)); +} + +void rtw_mesh_adjust_chbw(u8 req_ch, u8 *req_bw, u8 *req_offset) +{ + if (req_ch >= 5 && req_ch <= 9) { + /* prevent secondary channel offset mismatch */ + if (*req_bw > CHANNEL_WIDTH_20) { + *req_bw = CHANNEL_WIDTH_20; + *req_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; + } + } +} + +void rtw_mesh_sae_check_frames(_adapter *adapter, const u8 *buf, u32 len, u8 tx, u16 alg, u16 seq, u16 status) +{ +#if CONFIG_RTW_MESH_PEER_BLACKLIST + if (tx && seq == 1) + rtw_mesh_plink_set_peer_conf_timeout(adapter, GetAddr1Ptr(buf)); +#endif +} + +#if CONFIG_RTW_MPM_TX_IES_SYNC_BSS +#ifdef CONFIG_RTW_MESH_AEK +static int rtw_mpm_ampe_dec(_adapter *adapter, struct mesh_plink_ent *plink + , u8 *fhead, size_t flen, u8* fbody, u8 *mic_ie, u8 *ampe_buf) +{ + int ret = _FAIL, verify_ret; + const u8 *aad[] = {adapter_mac_addr(adapter), plink->addr, fbody}; + const size_t aad_len[] = {ETH_ALEN, ETH_ALEN, mic_ie - fbody}; + u8 *iv_crypt; + size_t iv_crypt_len = flen - (mic_ie + 2 - fhead); + + iv_crypt = rtw_malloc(iv_crypt_len); + if (!iv_crypt) + goto exit; + + _rtw_memcpy(iv_crypt, mic_ie + 2, iv_crypt_len); + + verify_ret = aes_siv_decrypt(plink->aek, iv_crypt, iv_crypt_len + , 3, aad, aad_len, ampe_buf); + + rtw_mfree(iv_crypt, iv_crypt_len); + + if (verify_ret) { + RTW_WARN("verify error, aek_valid=%u\n", plink->aek_valid); + goto exit; + } else if (*ampe_buf != WLAN_EID_AMPE) { + RTW_WARN("plaintext is not AMPE IE\n"); + goto exit; + } else if (AES_BLOCK_SIZE + 2 + *(ampe_buf + 1) > iv_crypt_len) { + RTW_WARN("plaintext AMPE IE length is not valid\n"); + goto exit; + } + + ret = _SUCCESS; + +exit: + return ret; +} + +static int rtw_mpm_ampe_enc(_adapter *adapter, struct mesh_plink_ent *plink + , u8* fbody, u8 *mic_ie, u8 *ampe_buf, bool inverse) +{ + int ret = _FAIL, protect_ret; + const u8 *aad[3]; + const size_t aad_len[3] = {ETH_ALEN, ETH_ALEN, mic_ie - fbody}; + u8 *ampe_ie; + size_t ampe_ie_len = *(ampe_buf + 1) + 2; /* including id & len */ + + if (inverse) { + aad[0] = plink->addr; + aad[1] = adapter_mac_addr(adapter); + } else { + aad[0] = adapter_mac_addr(adapter); + aad[1] = plink->addr; + } + aad[2] = fbody; + + ampe_ie = rtw_malloc(ampe_ie_len); + if (!ampe_ie) + goto exit; + + _rtw_memcpy(ampe_ie, ampe_buf, ampe_ie_len); + + protect_ret = aes_siv_encrypt(plink->aek, ampe_ie, ampe_ie_len + , 3, aad, aad_len, mic_ie + 2); + + rtw_mfree(ampe_ie, ampe_ie_len); + + if (protect_ret) { + RTW_WARN("protect error, aek_valid=%u\n", plink->aek_valid); + goto exit; + } + + ret = _SUCCESS; + +exit: + return ret; +} +#endif /* CONFIG_RTW_MESH_AEK */ + +static int rtw_mpm_tx_ies_sync_bss(_adapter *adapter, struct mesh_plink_ent *plink + , u8 *fhead, size_t flen, u8* fbody, u8 tlv_ies_offset, u8 *mpm_ie, u8 *mic_ie + , u8 **nbuf, size_t *nlen) +{ + int ret = _FAIL; + struct mlme_priv *mlme = &(adapter->mlmepriv); + struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; + struct mlme_ext_info *mlmeinfo = &(mlmeext->mlmext_info); + WLAN_BSSID_EX *network = &(mlmeinfo->network); + uint left; + u8 *pos; + + uint mpm_ielen = *(mpm_ie + 1); + u8 *fpos; + u8 *new_buf = NULL; + size_t new_len = 0; + + u8 *new_fhead; + size_t new_flen; + u8 *new_fbody; + u8 *new_mic_ie; + +#ifdef CONFIG_RTW_MESH_AEK + u8 *ampe_buf = NULL; + size_t ampe_buf_len = 0; + + /* decode */ + if (mic_ie) { + ampe_buf_len = flen - (mic_ie + 2 + AES_BLOCK_SIZE - fhead); + ampe_buf = rtw_malloc(ampe_buf_len); + if (!ampe_buf) + goto exit; + + if (rtw_mpm_ampe_dec(adapter, plink, fhead, flen, fbody, mic_ie, ampe_buf) != _SUCCESS) + goto exit; + + if (*(ampe_buf + 1) >= 68) { + _rtw_memcpy(plink->sel_pcs, ampe_buf + 2, 4); + _rtw_memcpy(plink->l_nonce, ampe_buf + 6, 32); + _rtw_memcpy(plink->p_nonce, ampe_buf + 38, 32); + } + } +#endif + + /* count for new frame length */ + new_len = sizeof(struct rtw_ieee80211_hdr_3addr) + tlv_ies_offset; + left = BSS_EX_TLV_IES_LEN(network); + pos = BSS_EX_TLV_IES(network); + while (left >= 2) { + u8 id, elen; + + id = *pos++; + elen = *pos++; + left -= 2; + + if (elen > left) + break; + + switch (id) { + case WLAN_EID_SSID: + case WLAN_EID_DS_PARAMS: + case WLAN_EID_TIM: + break; + default: + new_len += 2 + elen; + } + + left -= elen; + pos += elen; + } + new_len += mpm_ielen + 2; + if (mic_ie) + new_len += AES_BLOCK_SIZE + 2 + ampe_buf_len; + + /* alloc new frame */ + new_buf = rtw_malloc(new_len); + if (!new_buf) { + rtw_warn_on(1); + goto exit; + } + + /* build new frame */ + _rtw_memcpy(new_buf, fhead, sizeof(struct rtw_ieee80211_hdr_3addr) + tlv_ies_offset); + new_fhead = new_buf; + new_flen = new_len; + new_fbody = new_fhead + sizeof(struct rtw_ieee80211_hdr_3addr); + + fpos = new_fbody + tlv_ies_offset; + left = BSS_EX_TLV_IES_LEN(network); + pos = BSS_EX_TLV_IES(network); + while (left >= 2) { + u8 id, elen; + + id = *pos++; + elen = *pos++; + left -= 2; + + if (elen > left) + break; + + switch (id) { + case WLAN_EID_SSID: + case WLAN_EID_DS_PARAMS: + case WLAN_EID_TIM: + break; + default: + fpos = rtw_set_ie(fpos, id, elen, pos, NULL); + if (id == WLAN_EID_MESH_CONFIG) + fpos = rtw_set_ie(fpos, WLAN_EID_MPM, mpm_ielen, mpm_ie + 2, NULL); + } + + left -= elen; + pos += elen; + } + if (mic_ie) { + new_mic_ie = fpos; + *fpos++ = WLAN_EID_MIC; + *fpos++ = AES_BLOCK_SIZE; + } + +#ifdef CONFIG_RTW_MESH_AEK + /* encode */ + if (mic_ie) { + int enc_ret = rtw_mpm_ampe_enc(adapter, plink, new_fbody, new_mic_ie, ampe_buf, 0); + if (enc_ret != _SUCCESS) + goto exit; + } +#endif + + *nlen = new_len; + *nbuf = new_buf; + + ret = _SUCCESS; + +exit: + if (ret != _SUCCESS && new_buf) + rtw_mfree(new_buf, new_len); + +#ifdef CONFIG_RTW_MESH_AEK + if (ampe_buf) + rtw_mfree(ampe_buf, ampe_buf_len); +#endif + + return ret; +} +#endif /* CONFIG_RTW_MPM_TX_IES_SYNC_BSS */ + +struct mpm_frame_info { + u8 *aid; + u16 aid_v; + u8 *pid; + u16 pid_v; + u8 *llid; + u16 llid_v; + u8 *plid; + u16 plid_v; + u8 *reason; + u16 reason_v; + u8 *chosen_pmk; +}; + +/* +* pid:00000 llid:00000 chosen_pmk:0x00000000000000000000000000000000 +* aid:00000 pid:00000 llid:00000 plid:00000 chosen_pmk:0x00000000000000000000000000000000 +* pid:00000 llid:00000 plid:00000 reason:00000 chosen_pmk:0x00000000000000000000000000000000 +*/ +#define MPM_LOG_BUF_LEN 92 /* this length is limited for legal combination */ +static void rtw_mpm_info_msg(struct mpm_frame_info *mpm_info, u8 *mpm_log_buf) +{ + int cnt = 0; + + if (mpm_info->aid) { + cnt += snprintf(mpm_log_buf + cnt, MPM_LOG_BUF_LEN - cnt - 1, "aid:%u ", mpm_info->aid_v); + if (cnt >= MPM_LOG_BUF_LEN - 1) + goto exit; + } + if (mpm_info->pid) { + cnt += snprintf(mpm_log_buf + cnt, MPM_LOG_BUF_LEN - cnt - 1, "pid:%u ", mpm_info->pid_v); + if (cnt >= MPM_LOG_BUF_LEN - 1) + goto exit; + } + if (mpm_info->llid) { + cnt += snprintf(mpm_log_buf + cnt, MPM_LOG_BUF_LEN - cnt - 1, "llid:%u ", mpm_info->llid_v); + if (cnt >= MPM_LOG_BUF_LEN - 1) + goto exit; + } + if (mpm_info->plid) { + cnt += snprintf(mpm_log_buf + cnt, MPM_LOG_BUF_LEN - cnt - 1, "plid:%u ", mpm_info->plid_v); + if (cnt >= MPM_LOG_BUF_LEN - 1) + goto exit; + } + if (mpm_info->reason) { + cnt += snprintf(mpm_log_buf + cnt, MPM_LOG_BUF_LEN - cnt - 1, "reason:%u ", mpm_info->reason_v); + if (cnt >= MPM_LOG_BUF_LEN - 1) + goto exit; + } + if (mpm_info->chosen_pmk) { + cnt += snprintf(mpm_log_buf + cnt, MPM_LOG_BUF_LEN - cnt - 1, "chosen_pmk:0x"KEY_FMT, KEY_ARG(mpm_info->chosen_pmk)); + if (cnt >= MPM_LOG_BUF_LEN - 1) + goto exit; + } + +exit: + return; +} + +static int rtw_mpm_check_frames(_adapter *adapter, u8 action, const u8 **buf, size_t *len, u8 tx) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; + struct mesh_plink_ent *plink = NULL; + u8 *nbuf = NULL; + size_t nlen = 0; + u8 *fhead = (u8 *)*buf; + size_t flen = *len; + u8 *peer_addr = tx ? GetAddr1Ptr(fhead) : get_addr2_ptr(fhead); + u8 *frame_body = fhead + sizeof(struct rtw_ieee80211_hdr_3addr); + struct mpm_frame_info mpm_info; + u8 tlv_ies_offset; + u8 *mpm_ie = NULL; + uint mpm_ielen = 0; + u8 *mic_ie = NULL; + uint mic_ielen = 0; + int ret = 0; + u8 mpm_log_buf[MPM_LOG_BUF_LEN] = {0}; + + if (action == RTW_ACT_SELF_PROTECTED_MESH_OPEN) + tlv_ies_offset = 4; + else if (action == RTW_ACT_SELF_PROTECTED_MESH_CONF) + tlv_ies_offset = 6; + else if (action == RTW_ACT_SELF_PROTECTED_MESH_CLOSE) + tlv_ies_offset = 2; + else { + rtw_warn_on(1); + goto exit; + } + + plink = rtw_mesh_plink_get(adapter, peer_addr); + if (!plink && (tx == _TRUE || action == RTW_ACT_SELF_PROTECTED_MESH_CONF)) { + /* warning message if no plink when: 1.TX all MPM or 2.RX CONF */ + RTW_WARN("RTW_%s:%s without plink of "MAC_FMT"\n" + , (tx == _TRUE) ? "Tx" : "Rx", action_self_protected_str(action), MAC_ARG(peer_addr)); + goto exit; + } + + _rtw_memset(&mpm_info, 0, sizeof(struct mpm_frame_info)); + + if (action == RTW_ACT_SELF_PROTECTED_MESH_CONF) { + mpm_info.aid = (u8 *)frame_body + 4; + mpm_info.aid_v = RTW_GET_LE16(mpm_info.aid); + } + + mpm_ie = rtw_get_ie(fhead + sizeof(struct rtw_ieee80211_hdr_3addr) + tlv_ies_offset + , WLAN_EID_MPM, &mpm_ielen + , flen - sizeof(struct rtw_ieee80211_hdr_3addr) - tlv_ies_offset); + if (!mpm_ie || mpm_ielen < 2 + 2) + goto exit; + + mpm_info.pid = mpm_ie + 2; + mpm_info.pid_v = RTW_GET_LE16(mpm_info.pid); + mpm_info.llid = mpm_info.pid + 2; + mpm_info.llid_v = RTW_GET_LE16(mpm_info.llid); + + switch (action) { + case RTW_ACT_SELF_PROTECTED_MESH_OPEN: + /* pid:2, llid:2, (chosen_pmk:16) */ + if (mpm_info.pid_v == 0 && mpm_ielen == 4) + ; + else if (mpm_info.pid_v == 1 && mpm_ielen == 20) + mpm_info.chosen_pmk = mpm_info.llid + 2; + else + goto exit; + break; + case RTW_ACT_SELF_PROTECTED_MESH_CONF: + /* pid:2, llid:2, plid:2, (chosen_pmk:16) */ + mpm_info.plid = mpm_info.llid + 2; + mpm_info.plid_v = RTW_GET_LE16(mpm_info.plid); + if (mpm_info.pid_v == 0 && mpm_ielen == 6) + ; + else if (mpm_info.pid_v == 1 && mpm_ielen == 22) + mpm_info.chosen_pmk = mpm_info.plid + 2; + else + goto exit; + break; + case RTW_ACT_SELF_PROTECTED_MESH_CLOSE: + /* pid:2, llid:2, (plid:2), reason:2, (chosen_pmk:16) */ + if (mpm_info.pid_v == 0 && mpm_ielen == 6) { + /* MPM, without plid */ + mpm_info.reason = mpm_info.llid + 2; + mpm_info.reason_v = RTW_GET_LE16(mpm_info.reason); + } else if (mpm_info.pid_v == 0 && mpm_ielen == 8) { + /* MPM, with plid */ + mpm_info.plid = mpm_info.llid + 2; + mpm_info.plid_v = RTW_GET_LE16(mpm_info.plid); + mpm_info.reason = mpm_info.plid + 2; + mpm_info.reason_v = RTW_GET_LE16(mpm_info.reason); + } else if (mpm_info.pid_v == 1 && mpm_ielen == 22) { + /* AMPE, without plid */ + mpm_info.reason = mpm_info.llid + 2; + mpm_info.reason_v = RTW_GET_LE16(mpm_info.reason); + mpm_info.chosen_pmk = mpm_info.reason + 2; + } else if (mpm_info.pid_v == 1 && mpm_ielen == 24) { + /* AMPE, with plid */ + mpm_info.plid = mpm_info.llid + 2; + mpm_info.plid_v = RTW_GET_LE16(mpm_info.plid); + mpm_info.reason = mpm_info.plid + 2; + mpm_info.reason_v = RTW_GET_LE16(mpm_info.reason); + mpm_info.chosen_pmk = mpm_info.reason + 2; + } else + goto exit; + break; + }; + + if (mpm_info.pid_v == 1) { + mic_ie = rtw_get_ie(fhead + sizeof(struct rtw_ieee80211_hdr_3addr) + tlv_ies_offset + , WLAN_EID_MIC, &mic_ielen + , flen - sizeof(struct rtw_ieee80211_hdr_3addr) - tlv_ies_offset); + if (!mic_ie || mic_ielen != AES_BLOCK_SIZE) + goto exit; + } + +#if CONFIG_RTW_MPM_TX_IES_SYNC_BSS + if ((action == RTW_ACT_SELF_PROTECTED_MESH_OPEN || action == RTW_ACT_SELF_PROTECTED_MESH_CONF) + && tx == _TRUE + ) { +#define DBG_RTW_MPM_TX_IES_SYNC_BSS 0 + + if (mpm_info.pid_v == 1 && (!plink || !MESH_PLINK_AEK_VALID(plink))) { + RTW_WARN("AEK not ready, IEs can't sync with BSS\n"); + goto bypass_sync_bss; + } + + if (DBG_RTW_MPM_TX_IES_SYNC_BSS) { + RTW_INFO(FUNC_ADPT_FMT" before:\n", FUNC_ADPT_ARG(adapter)); + dump_ies(RTW_DBGDUMP + , fhead + sizeof(struct rtw_ieee80211_hdr_3addr) + tlv_ies_offset + , flen - sizeof(struct rtw_ieee80211_hdr_3addr) - tlv_ies_offset); + } + + rtw_mpm_tx_ies_sync_bss(adapter, plink + , fhead, flen, frame_body, tlv_ies_offset, mpm_ie, mic_ie + , &nbuf, &nlen); + if (!nbuf) + goto exit; + + /* update pointer & len for new frame */ + fhead = nbuf; + flen = nlen; + frame_body = fhead + sizeof(struct rtw_ieee80211_hdr_3addr); + if (mpm_info.pid_v == 1) { + mic_ie = rtw_get_ie(fhead + sizeof(struct rtw_ieee80211_hdr_3addr) + tlv_ies_offset + , WLAN_EID_MIC, &mic_ielen + , flen - sizeof(struct rtw_ieee80211_hdr_3addr) - tlv_ies_offset); + } + + if (DBG_RTW_MPM_TX_IES_SYNC_BSS) { + RTW_INFO(FUNC_ADPT_FMT" after:\n", FUNC_ADPT_ARG(adapter)); + dump_ies(RTW_DBGDUMP + , fhead + sizeof(struct rtw_ieee80211_hdr_3addr) + tlv_ies_offset + , flen - sizeof(struct rtw_ieee80211_hdr_3addr) - tlv_ies_offset); + } + } +bypass_sync_bss: +#endif /* CONFIG_RTW_MPM_TX_IES_SYNC_BSS */ + + if (!plink) + goto mpm_log; + +#if CONFIG_RTW_MESH_PEER_BLACKLIST + if (action == RTW_ACT_SELF_PROTECTED_MESH_OPEN) { + if (tx) + rtw_mesh_plink_set_peer_conf_timeout(adapter, peer_addr); + + } else +#endif +#if CONFIG_RTW_MESH_ACNODE_PREVENT + if (action == RTW_ACT_SELF_PROTECTED_MESH_CLOSE) { + if (tx && mpm_info.reason && mpm_info.reason_v == WLAN_REASON_MESH_MAX_PEERS) { + if (rtw_mesh_scanned_is_acnode_confirmed(adapter, plink->scanned) + && rtw_mesh_acnode_prevent_allow_sacrifice(adapter) + ) { + struct sta_info *sac = rtw_mesh_acnode_prevent_pick_sacrifice(adapter); + + if (sac) { + struct sta_priv *stapriv = &adapter->stapriv; + _irqL irqL; + u8 sta_addr[ETH_ALEN]; + u8 updated = _FALSE; + + _enter_critical_bh(&stapriv->asoc_list_lock, &irqL); + if (!rtw_is_list_empty(&sac->asoc_list)) { + rtw_list_delete(&sac->asoc_list); + stapriv->asoc_list_cnt--; + STA_SET_MESH_PLINK(sac, NULL); + } + _exit_critical_bh(&stapriv->asoc_list_lock, &irqL); + RTW_INFO(FUNC_ADPT_FMT" sacrifice "MAC_FMT" for acnode\n" + , FUNC_ADPT_ARG(adapter), MAC_ARG(sac->cmn.mac_addr)); + + _rtw_memcpy(sta_addr, sac->cmn.mac_addr, ETH_ALEN); + updated = ap_free_sta(adapter, sac, 0, 0, 1); + rtw_mesh_expire_peer(stapriv->padapter, sta_addr); + + associated_clients_update(adapter, updated, STA_INFO_UPDATE_ALL); + } + } + } + } else +#endif + if (action == RTW_ACT_SELF_PROTECTED_MESH_CONF) { + _irqL irqL; + u8 *ies = NULL; + u16 ies_len = 0; + + _enter_critical_bh(&(plink_ctl->lock), &irqL); + + plink = _rtw_mesh_plink_get(adapter, peer_addr); + if (!plink) + goto release_plink_ctl; + + if (tx == _FALSE) { + ies = plink->rx_conf_ies; + ies_len = plink->rx_conf_ies_len; + plink->rx_conf_ies = NULL; + plink->rx_conf_ies_len = 0; + + plink->llid = mpm_info.plid_v; + plink->plid = mpm_info.llid_v; + plink->peer_aid = mpm_info.aid_v; + if (mpm_info.pid_v == 1) + _rtw_memcpy(plink->chosen_pmk, mpm_info.chosen_pmk, 16); + } + #ifdef CONFIG_RTW_MESH_DRIVER_AID + else { + ies = plink->tx_conf_ies; + ies_len = plink->tx_conf_ies_len; + plink->tx_conf_ies = NULL; + plink->tx_conf_ies_len = 0; + } + #endif + + if (ies && ies_len) + rtw_mfree(ies, ies_len); + + #ifndef CONFIG_RTW_MESH_DRIVER_AID + if (tx == _TRUE) + goto release_plink_ctl; /* no need to copy tx conf ies */ + #endif + + /* copy mesh confirm IEs */ + if (mpm_info.pid_v == 1) /* not include MIC & encrypted AMPE */ + ies_len = (mic_ie - fhead) - sizeof(struct rtw_ieee80211_hdr_3addr) - 2; + else + ies_len = flen - sizeof(struct rtw_ieee80211_hdr_3addr) - 2; + + ies = rtw_zmalloc(ies_len); + if (ies) { + _rtw_memcpy(ies, fhead + sizeof(struct rtw_ieee80211_hdr_3addr) + 2, ies_len); + if (tx == _FALSE) { + plink->rx_conf_ies = ies; + plink->rx_conf_ies_len = ies_len; + } + #ifdef CONFIG_RTW_MESH_DRIVER_AID + else { + plink->tx_conf_ies = ies; + plink->tx_conf_ies_len = ies_len; + } + #endif + } + +release_plink_ctl: + _exit_critical_bh(&(plink_ctl->lock), &irqL); + } + +mpm_log: + rtw_mpm_info_msg(&mpm_info, mpm_log_buf); + RTW_INFO("RTW_%s:%s %s\n" + , (tx == _TRUE) ? "Tx" : "Rx" + , action_self_protected_str(action) + , mpm_log_buf + ); + + ret = 1; + +exit: + if (nbuf) { + if (ret == 1) { + *buf = nbuf; + *len = nlen; + } else + rtw_mfree(nbuf, nlen); + } + + return ret; +} + +static int rtw_mesh_check_frames(_adapter *adapter, const u8 **buf, size_t *len, u8 tx) +{ + int is_mesh_frame = -1; + const u8 *frame_body; + u8 category, action; + + frame_body = *buf + sizeof(struct rtw_ieee80211_hdr_3addr); + category = frame_body[0]; + + if (category == RTW_WLAN_CATEGORY_SELF_PROTECTED) { + action = frame_body[1]; + switch (action) { + case RTW_ACT_SELF_PROTECTED_MESH_OPEN: + case RTW_ACT_SELF_PROTECTED_MESH_CONF: + case RTW_ACT_SELF_PROTECTED_MESH_CLOSE: + rtw_mpm_check_frames(adapter, action, buf, len, tx); + is_mesh_frame = action; + break; + case RTW_ACT_SELF_PROTECTED_MESH_GK_INFORM: + case RTW_ACT_SELF_PROTECTED_MESH_GK_ACK: + RTW_INFO("RTW_%s:%s\n", (tx == _TRUE) ? "Tx" : "Rx", action_self_protected_str(action)); + is_mesh_frame = action; + break; + default: + break; + }; + } + + return is_mesh_frame; +} + +int rtw_mesh_check_frames_tx(_adapter *adapter, const u8 **buf, size_t *len) +{ + return rtw_mesh_check_frames(adapter, buf, len, _TRUE); +} + +int rtw_mesh_check_frames_rx(_adapter *adapter, const u8 *buf, size_t len) +{ + return rtw_mesh_check_frames(adapter, &buf, &len, _FALSE); +} + +int rtw_mesh_on_auth(_adapter *adapter, union recv_frame *rframe) +{ + u8 *whdr = rframe->u.hdr.rx_data; + +#if CONFIG_RTW_MACADDR_ACL + if (rtw_access_ctrl(adapter, get_addr2_ptr(whdr)) == _FALSE) + return _SUCCESS; +#endif + + if (!rtw_mesh_plink_get(adapter, get_addr2_ptr(whdr))) { + #if CONFIG_RTW_MESH_ACNODE_PREVENT + rtw_mesh_acnode_set_notify_etime(adapter, whdr); + #endif + + if (adapter_to_rfctl(adapter)->offch_state == OFFCHS_NONE) + issue_probereq(adapter, &adapter->mlmepriv.cur_network.network.mesh_id, get_addr2_ptr(whdr)); + + /* only peer being added (checked by notify conditions) is allowed */ + return _SUCCESS; + } + + rtw_cfg80211_rx_mframe(adapter, rframe, NULL); + return _SUCCESS; +} + +unsigned int on_action_self_protected(_adapter *adapter, union recv_frame *rframe) +{ + unsigned int ret = _FAIL; + struct sta_info *sta = NULL; + u8 *pframe = rframe->u.hdr.rx_data; + uint frame_len = rframe->u.hdr.len; + u8 *frame_body = (u8 *)(pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); + u8 category; + u8 action; + + /* check RA matches or not */ + if (!_rtw_memcmp(adapter_mac_addr(adapter), GetAddr1Ptr(pframe), ETH_ALEN)) + goto exit; + + category = frame_body[0]; + if (category != RTW_WLAN_CATEGORY_SELF_PROTECTED) + goto exit; + + action = frame_body[1]; + switch (action) { + case RTW_ACT_SELF_PROTECTED_MESH_OPEN: + case RTW_ACT_SELF_PROTECTED_MESH_CONF: + case RTW_ACT_SELF_PROTECTED_MESH_CLOSE: + case RTW_ACT_SELF_PROTECTED_MESH_GK_INFORM: + case RTW_ACT_SELF_PROTECTED_MESH_GK_ACK: + if (!(MLME_IS_MESH(adapter) && MLME_IS_ASOC(adapter))) + goto exit; +#ifdef CONFIG_IOCTL_CFG80211 + #if CONFIG_RTW_MACADDR_ACL + if (rtw_access_ctrl(adapter, get_addr2_ptr(pframe)) == _FALSE) + goto exit; + #endif + #if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST + if (rtw_mesh_cto_mgate_required(adapter) + /* only peer being added (checked by notify conditions) is allowed */ + && !rtw_mesh_plink_get(adapter, get_addr2_ptr(pframe))) + goto exit; + #endif + rtw_cfg80211_rx_action(adapter, rframe, NULL); + ret = _SUCCESS; +#endif /* CONFIG_IOCTL_CFG80211 */ + break; + default: + break; + } + +exit: + return ret; +} + +const u8 ae_to_mesh_ctrl_len[] = { + 6, + 12, /* MESH_FLAGS_AE_A4 */ + 18, /* MESH_FLAGS_AE_A5_A6 */ + 0, +}; + +unsigned int on_action_mesh(_adapter *adapter, union recv_frame *rframe) +{ + unsigned int ret = _FAIL; + struct sta_info *sta = NULL; + struct sta_priv *stapriv = &adapter->stapriv; + u8 *pframe = rframe->u.hdr.rx_data; + uint frame_len = rframe->u.hdr.len; + u8 *frame_body = (u8 *)(pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); + u8 category; + u8 action; + + if (!MLME_IS_MESH(adapter)) + goto exit; + + /* check stainfo exist? */ + + category = frame_body[0]; + if (category != RTW_WLAN_CATEGORY_MESH) + goto exit; + + action = frame_body[1]; + switch (action) { + case RTW_ACT_MESH_HWMP_PATH_SELECTION: + rtw_mesh_rx_path_sel_frame(adapter, rframe); + ret = _SUCCESS; + break; + default: + break; + } + +exit: + return ret; +} + +bool rtw_mesh_update_bss_peering_status(_adapter *adapter, WLAN_BSSID_EX *bss) +{ + struct sta_priv *stapriv = &adapter->stapriv; + struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; + u8 num_of_peerings = stapriv->asoc_list_cnt; + bool accept_peerings = stapriv->asoc_list_cnt < mcfg->max_peer_links; + u8 *ie; + int ie_len; + bool updated = 0; + +#if CONFIG_RTW_MESH_ACNODE_PREVENT + accept_peerings |= plink_ctl->acnode_rsvd; +#endif + + ie = rtw_get_ie(BSS_EX_TLV_IES(bss), WLAN_EID_MESH_CONFIG, &ie_len, BSS_EX_TLV_IES_LEN(bss)); + if (!ie || ie_len != 7) { + rtw_warn_on(1); + goto exit; + } + + if (GET_MESH_CONF_ELE_NUM_OF_PEERINGS(ie + 2) != num_of_peerings) { + SET_MESH_CONF_ELE_NUM_OF_PEERINGS(ie + 2, num_of_peerings); + updated = 1; + } + + if (GET_MESH_CONF_ELE_ACCEPT_PEERINGS(ie + 2) != accept_peerings) { + SET_MESH_CONF_ELE_ACCEPT_PEERINGS(ie + 2, accept_peerings); + updated = 1; + } + +exit: + return updated; +} + +bool rtw_mesh_update_bss_formation_info(_adapter *adapter, WLAN_BSSID_EX *bss) +{ + struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; + struct rtw_mesh_info *minfo = &adapter->mesh_info; + u8 cto_mgate = (minfo->num_gates || mcfg->dot11MeshGateAnnouncementProtocol); + u8 cto_as = 0; + u8 *ie; + int ie_len; + bool updated = 0; + + ie = rtw_get_ie(BSS_EX_TLV_IES(bss), WLAN_EID_MESH_CONFIG, &ie_len, + BSS_EX_TLV_IES_LEN(bss)); + if (!ie || ie_len != 7) { + rtw_warn_on(1); + goto exit; + } + + if (GET_MESH_CONF_ELE_CTO_MGATE(ie + 2) != cto_mgate) { + SET_MESH_CONF_ELE_CTO_MGATE(ie + 2, cto_mgate); + updated = 1; + } + + if (GET_MESH_CONF_ELE_CTO_AS(ie + 2) != cto_as) { + SET_MESH_CONF_ELE_CTO_AS(ie + 2, cto_as); + updated = 1; + } + +exit: + return updated; +} + +bool rtw_mesh_update_bss_forwarding_state(_adapter *adapter, WLAN_BSSID_EX *bss) +{ + struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; + u8 forward = mcfg->dot11MeshForwarding; + u8 *ie; + int ie_len; + bool updated = 0; + + ie = rtw_get_ie(BSS_EX_TLV_IES(bss), WLAN_EID_MESH_CONFIG, &ie_len, + BSS_EX_TLV_IES_LEN(bss)); + if (!ie || ie_len != 7) { + rtw_warn_on(1); + goto exit; + } + + if (GET_MESH_CONF_ELE_FORWARDING(ie + 2) != forward) { + SET_MESH_CONF_ELE_FORWARDING(ie + 2, forward); + updated = 1; + } + +exit: + return updated; +} + +struct mesh_plink_ent *_rtw_mesh_plink_get(_adapter *adapter, const u8 *hwaddr) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; + struct mesh_plink_ent *ent = NULL; + int i; + + for (i = 0; i < RTW_MESH_MAX_PEER_CANDIDATES; i++) { + if (plink_ctl->ent[i].valid == _TRUE + && _rtw_memcmp(plink_ctl->ent[i].addr, hwaddr, ETH_ALEN) == _TRUE + ) { + ent = &plink_ctl->ent[i]; + break; + } + } + + return ent; +} + +struct mesh_plink_ent *rtw_mesh_plink_get(_adapter *adapter, const u8 *hwaddr) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; + struct mesh_plink_ent *ent = NULL; + _irqL irqL; + + _enter_critical_bh(&(plink_ctl->lock), &irqL); + ent = _rtw_mesh_plink_get(adapter, hwaddr); + _exit_critical_bh(&(plink_ctl->lock), &irqL); + + return ent; +} + +struct mesh_plink_ent *rtw_mesh_plink_get_no_estab_by_idx(_adapter *adapter, u8 idx) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; + struct mesh_plink_ent *ent = NULL; + int i, j = 0; + _irqL irqL; + + _enter_critical_bh(&(plink_ctl->lock), &irqL); + for (i = 0; i < RTW_MESH_MAX_PEER_CANDIDATES; i++) { + if (plink_ctl->ent[i].valid == _TRUE + && plink_ctl->ent[i].plink_state != RTW_MESH_PLINK_ESTAB + ) { + if (j == idx) { + ent = &plink_ctl->ent[i]; + break; + } + j++; + } + } + _exit_critical_bh(&(plink_ctl->lock), &irqL); + + return ent; +} + +int _rtw_mesh_plink_add(_adapter *adapter, const u8 *hwaddr) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; + struct mesh_plink_ent *ent = NULL; + u8 exist = _FALSE; + int i; + + for (i = 0; i < RTW_MESH_MAX_PEER_CANDIDATES; i++) { + if (plink_ctl->ent[i].valid == _TRUE + && _rtw_memcmp(plink_ctl->ent[i].addr, hwaddr, ETH_ALEN) == _TRUE + ) { + ent = &plink_ctl->ent[i]; + exist = _TRUE; + break; + } + + if (ent == NULL && plink_ctl->ent[i].valid == _FALSE) + ent = &plink_ctl->ent[i]; + } + + if (exist == _FALSE && ent) { + _rtw_memcpy(ent->addr, hwaddr, ETH_ALEN); + ent->valid = _TRUE; + #ifdef CONFIG_RTW_MESH_AEK + ent->aek_valid = 0; + #endif + ent->llid = 0; + ent->plid = 0; + _rtw_memset(ent->chosen_pmk, 0, 16); + #ifdef CONFIG_RTW_MESH_AEK + _rtw_memset(ent->sel_pcs, 0, 4); + _rtw_memset(ent->l_nonce, 0, 32); + _rtw_memset(ent->p_nonce, 0, 32); + #endif + ent->plink_state = RTW_MESH_PLINK_LISTEN; + #ifndef CONFIG_RTW_MESH_DRIVER_AID + ent->aid = 0; + #endif + ent->peer_aid = 0; + SET_PEER_CONF_DISABLED(ent); + SET_CTO_MGATE_CONF_DISABLED(ent); + plink_ctl->num++; + } + + return exist == _TRUE ? RTW_ALREADY : (ent ? _SUCCESS : _FAIL); +} + +int rtw_mesh_plink_add(_adapter *adapter, const u8 *hwaddr) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; + _irqL irqL; + int ret; + + _enter_critical_bh(&(plink_ctl->lock), &irqL); + ret = _rtw_mesh_plink_add(adapter, hwaddr); + _exit_critical_bh(&(plink_ctl->lock), &irqL); + + return ret; +} + +int rtw_mesh_plink_set_state(_adapter *adapter, const u8 *hwaddr, u8 state) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; + struct mesh_plink_ent *ent = NULL; + _irqL irqL; + + _enter_critical_bh(&(plink_ctl->lock), &irqL); + ent = _rtw_mesh_plink_get(adapter, hwaddr); + if (ent) + ent->plink_state = state; + _exit_critical_bh(&(plink_ctl->lock), &irqL); + + return ent ? _SUCCESS : _FAIL; +} + +#ifdef CONFIG_RTW_MESH_AEK +int rtw_mesh_plink_set_aek(_adapter *adapter, const u8 *hwaddr, const u8 *aek) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; + struct mesh_plink_ent *ent = NULL; + _irqL irqL; + + _enter_critical_bh(&(plink_ctl->lock), &irqL); + ent = _rtw_mesh_plink_get(adapter, hwaddr); + if (ent) { + _rtw_memcpy(ent->aek, aek, 32); + ent->aek_valid = 1; + } + _exit_critical_bh(&(plink_ctl->lock), &irqL); + + return ent ? _SUCCESS : _FAIL; +} +#endif + +#if CONFIG_RTW_MESH_PEER_BLACKLIST +int rtw_mesh_plink_set_peer_conf_timeout(_adapter *adapter, const u8 *hwaddr) +{ + struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; + struct mesh_plink_ent *ent = NULL; + _irqL irqL; + + _enter_critical_bh(&(plink_ctl->lock), &irqL); + ent = _rtw_mesh_plink_get(adapter, hwaddr); + if (ent) { + if (IS_PEER_CONF_DISABLED(ent)) + SET_PEER_CONF_END_TIME(ent, mcfg->peer_sel_policy.peer_conf_timeout_ms); + } + _exit_critical_bh(&(plink_ctl->lock), &irqL); + + return ent ? _SUCCESS : _FAIL; +} +#endif + +void _rtw_mesh_plink_del_ent(_adapter *adapter, struct mesh_plink_ent *ent) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; + + ent->valid = _FALSE; + #ifdef CONFIG_RTW_MESH_DRIVER_AID + if (ent->tx_conf_ies && ent->tx_conf_ies_len) + rtw_mfree(ent->tx_conf_ies, ent->tx_conf_ies_len); + ent->tx_conf_ies = NULL; + ent->tx_conf_ies_len = 0; + #endif + if (ent->rx_conf_ies && ent->rx_conf_ies_len) + rtw_mfree(ent->rx_conf_ies, ent->rx_conf_ies_len); + ent->rx_conf_ies = NULL; + ent->rx_conf_ies_len = 0; + if (ent->scanned) + ent->scanned = NULL; + plink_ctl->num--; +} + +int rtw_mesh_plink_del(_adapter *adapter, const u8 *hwaddr) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; + struct mesh_plink_ent *ent = NULL; + u8 exist = _FALSE; + int i; + _irqL irqL; + + _enter_critical_bh(&(plink_ctl->lock), &irqL); + for (i = 0; i < RTW_MESH_MAX_PEER_CANDIDATES; i++) { + if (plink_ctl->ent[i].valid == _TRUE + && _rtw_memcmp(plink_ctl->ent[i].addr, hwaddr, ETH_ALEN) == _TRUE + ) { + ent = &plink_ctl->ent[i]; + exist = _TRUE; + break; + } + } + + if (exist == _TRUE) + _rtw_mesh_plink_del_ent(adapter, ent); + + _exit_critical_bh(&(plink_ctl->lock), &irqL); + + return exist == _TRUE ? _SUCCESS : RTW_ALREADY; +} + +void rtw_mesh_plink_ctl_init(_adapter *adapter) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; + int i; + + _rtw_spinlock_init(&plink_ctl->lock); + plink_ctl->num = 0; + for (i = 0; i < RTW_MESH_MAX_PEER_CANDIDATES; i++) + plink_ctl->ent[i].valid = _FALSE; + +#if CONFIG_RTW_MESH_PEER_BLACKLIST + _rtw_init_queue(&plink_ctl->peer_blacklist); +#endif +#if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST + _rtw_init_queue(&plink_ctl->cto_mgate_blacklist); +#endif +} + +void rtw_mesh_plink_ctl_deinit(_adapter *adapter) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; + struct mesh_plink_ent *ent; + int i; + _irqL irqL; + + _enter_critical_bh(&(plink_ctl->lock), &irqL); + for (i = 0; i < RTW_MESH_MAX_PEER_CANDIDATES; i++) { + ent = &plink_ctl->ent[i]; + #ifdef CONFIG_RTW_MESH_DRIVER_AID + if (ent->tx_conf_ies && ent->tx_conf_ies_len) + rtw_mfree(ent->tx_conf_ies, ent->tx_conf_ies_len); + #endif + if (ent->rx_conf_ies && ent->rx_conf_ies_len) + rtw_mfree(ent->rx_conf_ies, ent->rx_conf_ies_len); + } + _exit_critical_bh(&(plink_ctl->lock), &irqL); + + _rtw_spinlock_free(&plink_ctl->lock); + +#if CONFIG_RTW_MESH_PEER_BLACKLIST + rtw_mesh_peer_blacklist_flush(adapter); + _rtw_deinit_queue(&plink_ctl->peer_blacklist); +#endif +#if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST + rtw_mesh_cto_mgate_blacklist_flush(adapter); + _rtw_deinit_queue(&plink_ctl->cto_mgate_blacklist); +#endif +} + +void dump_mesh_plink_ctl(void *sel, _adapter *adapter) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; + struct mesh_plink_ent *ent; + int i; + + RTW_PRINT_SEL(sel, "num:%u\n", plink_ctl->num); + #if CONFIG_RTW_MESH_ACNODE_PREVENT + RTW_PRINT_SEL(sel, "acnode_rsvd:%u\n", plink_ctl->acnode_rsvd); + #endif + + for (i = 0; i < RTW_MESH_MAX_PEER_CANDIDATES; i++) { + ent = &plink_ctl->ent[i]; + if (!ent->valid) + continue; + + RTW_PRINT_SEL(sel, "\n"); + RTW_PRINT_SEL(sel, "peer:"MAC_FMT"\n", MAC_ARG(ent->addr)); + RTW_PRINT_SEL(sel, "plink_state:%s\n", rtw_mesh_plink_str(ent->plink_state)); + + #ifdef CONFIG_RTW_MESH_AEK + if (ent->aek_valid) + RTW_PRINT_SEL(sel, "aek:"KEY_FMT KEY_FMT"\n", KEY_ARG(ent->aek), KEY_ARG(ent->aek + 16)); + #endif + + RTW_PRINT_SEL(sel, "llid:%u, plid:%u\n", ent->llid, ent->plid); + #ifndef CONFIG_RTW_MESH_DRIVER_AID + RTW_PRINT_SEL(sel, "aid:%u\n", ent->aid); + #endif + RTW_PRINT_SEL(sel, "peer_aid:%u\n", ent->peer_aid); + + RTW_PRINT_SEL(sel, "chosen_pmk:"KEY_FMT"\n", KEY_ARG(ent->chosen_pmk)); + + #ifdef CONFIG_RTW_MESH_AEK + RTW_PRINT_SEL(sel, "sel_pcs:%02x%02x%02x%02x\n" + , ent->sel_pcs[0], ent->sel_pcs[1], ent->sel_pcs[2], ent->sel_pcs[3]); + RTW_PRINT_SEL(sel, "l_nonce:"KEY_FMT KEY_FMT"\n", KEY_ARG(ent->l_nonce), KEY_ARG(ent->l_nonce + 16)); + RTW_PRINT_SEL(sel, "p_nonce:"KEY_FMT KEY_FMT"\n", KEY_ARG(ent->p_nonce), KEY_ARG(ent->p_nonce + 16)); + #endif + + #ifdef CONFIG_RTW_MESH_DRIVER_AID + RTW_PRINT_SEL(sel, "tx_conf_ies:%p, len:%u\n", ent->tx_conf_ies, ent->tx_conf_ies_len); + #endif + RTW_PRINT_SEL(sel, "rx_conf_ies:%p, len:%u\n", ent->rx_conf_ies, ent->rx_conf_ies_len); + RTW_PRINT_SEL(sel, "scanned:%p\n", ent->scanned); + + #if CONFIG_RTW_MESH_PEER_BLACKLIST + if (!IS_PEER_CONF_DISABLED(ent)) { + if (!IS_PEER_CONF_TIMEOUT(ent)) + RTW_PRINT_SEL(sel, "peer_conf:%d\n", rtw_systime_to_ms(ent->peer_conf_end_time - rtw_get_current_time())); + else + RTW_PRINT_SEL(sel, "peer_conf:TIMEOUT\n"); + } + #endif + + #if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST + if (!IS_CTO_MGATE_CONF_DISABLED(ent)) { + if (!IS_CTO_MGATE_CONF_TIMEOUT(ent)) + RTW_PRINT_SEL(sel, "cto_mgate_conf:%d\n", rtw_systime_to_ms(ent->cto_mgate_conf_end_time - rtw_get_current_time())); + else + RTW_PRINT_SEL(sel, "cto_mgate_conf:TIMEOUT\n"); + } + #endif + } +} + +/* this function is called with plink_ctl being locked */ +int rtw_mesh_peer_establish(_adapter *adapter, struct mesh_plink_ent *plink, struct sta_info *sta) +{ +#ifndef DBG_RTW_MESH_PEER_ESTABLISH +#define DBG_RTW_MESH_PEER_ESTABLISH 0 +#endif + + struct sta_priv *stapriv = &adapter->stapriv; + struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; + u8 *tlv_ies; + u16 tlv_ieslen; + struct rtw_ieee802_11_elems elems; + _irqL irqL; + int i; + int ret = _FAIL; + + if (!plink->rx_conf_ies || !plink->rx_conf_ies_len) { + RTW_INFO(FUNC_ADPT_FMT" no rx confirm from sta "MAC_FMT"\n" + , FUNC_ADPT_ARG(adapter), MAC_ARG(sta->cmn.mac_addr)); + goto exit; + } + + if (plink->rx_conf_ies_len < 4) { + RTW_INFO(FUNC_ADPT_FMT" confirm from sta "MAC_FMT" too short\n" + , FUNC_ADPT_ARG(adapter), MAC_ARG(sta->cmn.mac_addr)); + goto exit; + } + +#ifdef CONFIG_RTW_MESH_DRIVER_AID + if (!plink->tx_conf_ies || !plink->tx_conf_ies_len) { + RTW_INFO(FUNC_ADPT_FMT" no tx confirm to sta "MAC_FMT"\n" + , FUNC_ADPT_ARG(adapter), MAC_ARG(sta->cmn.mac_addr)); + goto exit; + } + + if (plink->tx_conf_ies_len < 4) { + RTW_INFO(FUNC_ADPT_FMT" confirm to sta "MAC_FMT" too short\n" + , FUNC_ADPT_ARG(adapter), MAC_ARG(sta->cmn.mac_addr)); + goto exit; + } +#endif + + tlv_ies = plink->rx_conf_ies + 4; + tlv_ieslen = plink->rx_conf_ies_len - 4; + + if (DBG_RTW_MESH_PEER_ESTABLISH) + dump_ies(RTW_DBGDUMP, tlv_ies, tlv_ieslen); + + if (rtw_ieee802_11_parse_elems(tlv_ies, tlv_ieslen, &elems, 1) == ParseFailed) { + RTW_INFO(FUNC_ADPT_FMT" sta "MAC_FMT" sent invalid confirm\n" + , FUNC_ADPT_ARG(adapter), MAC_ARG(sta->cmn.mac_addr)); + goto exit; + } + + SET_PEER_CONF_DISABLED(plink); + if (rtw_bss_is_cto_mgate(&plink->scanned->network) + && !rtw_bss_is_forwarding(&plink->scanned->network)) + SET_CTO_MGATE_CONF_END_TIME(plink, mcfg->peer_sel_policy.cto_mgate_conf_timeout_ms); + else + SET_CTO_MGATE_CONF_DISABLED(plink); + + sta->state &= (~WIFI_FW_AUTH_SUCCESS); + sta->state |= WIFI_FW_ASSOC_STATE; + + rtw_ap_parse_sta_capability(adapter, sta, plink->rx_conf_ies); + + if (rtw_ap_parse_sta_supported_rates(adapter, sta, tlv_ies, tlv_ieslen) != _STATS_SUCCESSFUL_) + goto exit; + + if (rtw_ap_parse_sta_security_ie(adapter, sta, &elems) != _STATS_SUCCESSFUL_) + goto exit; + + rtw_ap_parse_sta_wmm_ie(adapter, sta, tlv_ies, tlv_ieslen); +#ifdef CONFIG_RTS_FULL_BW + /*check vendor IE*/ + rtw_parse_sta_vendor_ie_8812(adapter, sta, tlv_ies, tlv_ieslen); +#endif/*CONFIG_RTS_FULL_BW*/ + + rtw_ap_parse_sta_ht_ie(adapter, sta, &elems); + rtw_ap_parse_sta_vht_ie(adapter, sta, &elems); + + /* AID */ +#ifdef CONFIG_RTW_MESH_DRIVER_AID + sta->cmn.aid = RTW_GET_LE16(plink->tx_conf_ies + 2); +#else + sta->cmn.aid = plink->aid; +#endif + stapriv->sta_aid[sta->cmn.aid - 1] = sta; + RTW_INFO(FUNC_ADPT_FMT" sta "MAC_FMT" aid:%u\n" + , FUNC_ADPT_ARG(adapter), MAC_ARG(sta->cmn.mac_addr), sta->cmn.aid); + + sta->state &= (~WIFI_FW_ASSOC_STATE); + sta->state |= WIFI_FW_ASSOC_SUCCESS; + + sta->local_mps = RTW_MESH_PS_ACTIVE; + + rtw_ewma_err_rate_init(&sta->metrics.err_rate); + rtw_ewma_err_rate_add(&sta->metrics.err_rate, 1); + /* init data_rate to 1M */ + sta->metrics.data_rate = 10; + sta->alive = _TRUE; + + _enter_critical_bh(&stapriv->asoc_list_lock, &irqL); + if (rtw_is_list_empty(&sta->asoc_list)) { + STA_SET_MESH_PLINK(sta, plink); + /* TBD: up layer timeout mechanism */ + /* sta->expire_to = mcfg->plink_timeout / 2; */ + rtw_list_insert_tail(&sta->asoc_list, &stapriv->asoc_list); + stapriv->asoc_list_cnt++; + } + _exit_critical_bh(&stapriv->asoc_list_lock, &irqL); + + bss_cap_update_on_sta_join(adapter, sta); + sta_info_update(adapter, sta); + report_add_sta_event(adapter, sta->cmn.mac_addr); + + ret = _SUCCESS; + +exit: + return ret; +} + +void rtw_mesh_expire_peer_notify(_adapter *adapter, const u8 *peer_addr) +{ + u8 null_ssid[2] = {0, 0}; + +#ifdef CONFIG_IOCTL_CFG80211 + rtw_cfg80211_notify_new_peer_candidate(adapter->rtw_wdev + , peer_addr + , null_ssid + , 2 + , 0 + , GFP_ATOMIC + ); +#endif + + return; +} + +static u8 *rtw_mesh_construct_peer_mesh_close(_adapter *adapter, struct mesh_plink_ent *plink, u16 reason, u32 *len) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + u8 *frame = NULL, *pos; + u32 flen; + struct rtw_ieee80211_hdr *whdr; + + if (minfo->mesh_auth_id && !MESH_PLINK_AEK_VALID(plink)) + goto exit; + + flen = sizeof(struct rtw_ieee80211_hdr_3addr) + + 2 /* category, action */ + + 2 + minfo->mesh_id_len /* mesh id */ + + 2 + 8 + (minfo->mesh_auth_id ? 16 : 0) /* mpm */ + + (minfo->mesh_auth_id ? 2 + AES_BLOCK_SIZE : 0) /* mic */ + + (minfo->mesh_auth_id ? 70 : 0) /* ampe */ + ; + + pos = frame = rtw_zmalloc(flen); + if (!frame) + goto exit; + + whdr = (struct rtw_ieee80211_hdr *)frame; + _rtw_memcpy(whdr->addr1, adapter_mac_addr(adapter), ETH_ALEN); + _rtw_memcpy(whdr->addr2, plink->addr, ETH_ALEN); + _rtw_memcpy(whdr->addr3, adapter_mac_addr(adapter), ETH_ALEN); + + set_frame_sub_type(frame, WIFI_ACTION); + + pos += sizeof(struct rtw_ieee80211_hdr_3addr); + *(pos++) = RTW_WLAN_CATEGORY_SELF_PROTECTED; + *(pos++) = RTW_ACT_SELF_PROTECTED_MESH_CLOSE; + + pos = rtw_set_ie_mesh_id(pos, NULL, minfo->mesh_id, minfo->mesh_id_len); + + pos = rtw_set_ie_mpm(pos, NULL + , minfo->mesh_auth_id ? 1 : 0 + , plink->plid + , &plink->llid + , &reason + , minfo->mesh_auth_id ? plink->chosen_pmk : NULL); + +#ifdef CONFIG_RTW_MESH_AEK + if (minfo->mesh_auth_id) { + u8 ampe_buf[70]; + int enc_ret; + + *pos = WLAN_EID_MIC; + *(pos + 1) = AES_BLOCK_SIZE; + + ampe_buf[0] = WLAN_EID_AMPE; + ampe_buf[1] = 68; + _rtw_memcpy(ampe_buf + 2, plink->sel_pcs, 4); + _rtw_memcpy(ampe_buf + 6, plink->p_nonce, 32); + _rtw_memcpy(ampe_buf + 38, plink->l_nonce, 32); + + enc_ret = rtw_mpm_ampe_enc(adapter, plink + , frame + sizeof(struct rtw_ieee80211_hdr_3addr) + , pos, ampe_buf, 1); + if (enc_ret != _SUCCESS) { + rtw_mfree(frame, flen); + frame = NULL; + goto exit; + } + } +#endif + + *len = flen; + +exit: + return frame; +} + +void _rtw_mesh_expire_peer_ent(_adapter *adapter, struct mesh_plink_ent *plink) +{ +#if defined(CONFIG_RTW_MESH_STA_DEL_DISASOC) + _rtw_mesh_plink_del_ent(adapter, plink); + rtw_cfg80211_indicate_sta_disassoc(adapter, plink->addr, 0); +#else + u8 *frame = NULL; + u32 flen; + + if (plink->plink_state == RTW_MESH_PLINK_ESTAB) + frame = rtw_mesh_construct_peer_mesh_close(adapter, plink, WLAN_REASON_MESH_CLOSE, &flen); + + if (frame) { + struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; + struct wireless_dev *wdev = adapter->rtw_wdev; + s32 freq = rtw_ch2freq(mlmeext->cur_channel); + + #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) + rtw_cfg80211_rx_mgmt(wdev, freq, 0, frame, flen, GFP_ATOMIC); + #else + cfg80211_rx_action(adapter->pnetdev, freq, frame, flen, GFP_ATOMIC); + #endif + + rtw_mfree(frame, flen); + } else { + rtw_mesh_expire_peer_notify(adapter, plink->addr); + RTW_INFO(FUNC_ADPT_FMT" set "MAC_FMT" plink unknown\n" + , FUNC_ADPT_ARG(adapter), MAC_ARG(plink->addr)); + plink->plink_state = RTW_MESH_PLINK_UNKNOWN; + } +#endif +} + +void rtw_mesh_expire_peer(_adapter *adapter, const u8 *peer_addr) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; + struct mesh_plink_ent *plink; + _irqL irqL; + + _enter_critical_bh(&(plink_ctl->lock), &irqL); + + plink = _rtw_mesh_plink_get(adapter, peer_addr); + if (!plink) + goto exit; + + _rtw_mesh_expire_peer_ent(adapter, plink); + +exit: + _exit_critical_bh(&(plink_ctl->lock), &irqL); +} + +u8 rtw_mesh_ps_annc(_adapter *adapter, u8 ps) +{ + _irqL irqL; + _list *head, *list; + struct sta_info *sta; + struct sta_priv *stapriv = &adapter->stapriv; + u8 sta_alive_num = 0, i; + char sta_alive_list[NUM_STA]; + u8 annc_cnt = 0; + + if (rtw_linked_check(adapter) == _FALSE) + goto exit; + + _enter_critical_bh(&stapriv->asoc_list_lock, &irqL); + + head = &stapriv->asoc_list; + list = get_next(head); + while ((rtw_end_of_queue_search(head, list)) == _FALSE) { + int stainfo_offset; + + sta = LIST_CONTAINOR(list, struct sta_info, asoc_list); + list = get_next(list); + + stainfo_offset = rtw_stainfo_offset(stapriv, sta); + if (stainfo_offset_valid(stainfo_offset)) + sta_alive_list[sta_alive_num++] = stainfo_offset; + } + _exit_critical_bh(&stapriv->asoc_list_lock, &irqL); + + for (i = 0; i < sta_alive_num; i++) { + sta = rtw_get_stainfo_by_offset(stapriv, sta_alive_list[i]); + if (!sta) + continue; + + issue_qos_nulldata(adapter, sta->cmn.mac_addr, 7, ps, 3, 500); + annc_cnt++; + } + +exit: + return annc_cnt; +} + +static void mpath_tx_tasklet_hdl(void *priv) +{ + _adapter *adapter = (_adapter *)priv; + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct xmit_frame *xframe; + _list *list, *head; + _list tmp; + u32 tmp_len; + s32 res; + + _rtw_init_listhead(&tmp); + + while (1) { + tmp_len = 0; + enter_critical_bh(&minfo->mpath_tx_queue.lock); + if (minfo->mpath_tx_queue_len) { + rtw_list_splice_init(&minfo->mpath_tx_queue.queue, &tmp); + tmp_len = minfo->mpath_tx_queue_len; + minfo->mpath_tx_queue_len = 0; + } + exit_critical_bh(&minfo->mpath_tx_queue.lock); + + if (!tmp_len) + break; + + head = &tmp; + list = get_next(head); + while (rtw_end_of_queue_search(head, list) == _FALSE) { + xframe = LIST_CONTAINOR(list, struct xmit_frame, list); + list = get_next(list); + rtw_list_delete(&xframe->list); + res = rtw_xmit_posthandle(adapter, xframe, xframe->pkt); + if (res < 0) { + #ifdef DBG_TX_DROP_FRAME + RTW_INFO("DBG_TX_DROP_FRAME %s rtw_xmit fail\n", __FUNCTION__); + #endif + adapter->xmitpriv.tx_drop++; + } + } + } +} + +static void rtw_mpath_tx_queue_flush(_adapter *adapter) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct xmit_frame *xframe; + _list *list, *head; + _list tmp; + + _rtw_init_listhead(&tmp); + + enter_critical_bh(&minfo->mpath_tx_queue.lock); + rtw_list_splice_init(&minfo->mpath_tx_queue.queue, &tmp); + minfo->mpath_tx_queue_len = 0; + exit_critical_bh(&minfo->mpath_tx_queue.lock); + + head = &tmp; + list = get_next(head); + while (rtw_end_of_queue_search(head, list) == _FALSE) { + xframe = LIST_CONTAINOR(list, struct xmit_frame, list); + list = get_next(list); + rtw_list_delete(&xframe->list); + rtw_free_xmitframe(&adapter->xmitpriv, xframe); + } +} + +#ifdef PLATFORM_LINUX /* 3.10 ~ 4.13 checked */ +#if defined(CONFIG_SLUB) +#include +#elif defined(CONFIG_SLAB) +#include +#endif +typedef struct kmem_cache rtw_mcache; +#endif + +rtw_mcache *rtw_mcache_create(const char *name, size_t size) +{ +#ifdef PLATFORM_LINUX /* 3.10 ~ 4.13 checked */ + return kmem_cache_create(name, size, 0, 0, NULL); +#else + #error "TBD\n"; +#endif +} + +void rtw_mcache_destroy(rtw_mcache *s) +{ +#ifdef PLATFORM_LINUX /* 3.10 ~ 4.13 checked */ + kmem_cache_destroy(s); +#else + #error "TBD\n"; +#endif +} + +void *_rtw_mcache_alloc(rtw_mcache *cachep) +{ +#ifdef PLATFORM_LINUX /* 3.10 ~ 4.13 checked */ + return kmem_cache_alloc(cachep, GFP_ATOMIC); +#else + #error "TBD\n"; +#endif +} + +void _rtw_mcache_free(rtw_mcache *cachep, void *objp) +{ +#ifdef PLATFORM_LINUX /* 3.10 ~ 4.13 checked */ + kmem_cache_free(cachep, objp); +#else + #error "TBD\n"; +#endif +} + +#ifdef DBG_MEM_ALLOC +inline void *dbg_rtw_mcache_alloc(rtw_mcache *cachep, const enum mstat_f flags, const char *func, const int line) +{ + void *p; + u32 sz = cachep->size; + + if (match_mstat_sniff_rules(flags, sz)) + RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%u)\n", func, line, __func__, sz); + + p = _rtw_mcache_alloc(cachep); + + rtw_mstat_update( + flags + , p ? MSTAT_ALLOC_SUCCESS : MSTAT_ALLOC_FAIL + , sz + ); + + return p; +} + +inline void dbg_rtw_mcache_free(rtw_mcache *cachep, void *pbuf, const enum mstat_f flags, const char *func, const int line) +{ + u32 sz = cachep->size; + + if (match_mstat_sniff_rules(flags, sz)) + RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%u)\n", func, line, __func__, sz); + + _rtw_mcache_free(cachep, pbuf); + + rtw_mstat_update( + flags + , MSTAT_FREE + , sz + ); +} + +#define rtw_mcache_alloc(cachep) dbg_rtw_mcache_alloc(cachep, MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) +#define rtw_mcache_free(cachep, objp) dbg_rtw_mcache_free(cachep, objp, MSTAT_TYPE_PHY, __FUNCTION__, __LINE__) +#else +#define rtw_mcache_alloc(cachep) _rtw_mcache_alloc(cachep) +#define rtw_mcache_free(cachep, objp) _rtw_mcache_free(cachep, objp) +#endif /* DBG_MEM_ALLOC */ + +/* Mesh Received Cache */ +#define RTW_MRC_BUCKETS 256 /* must be a power of 2 */ +#define RTW_MRC_QUEUE_MAX_LEN 4 +#define RTW_MRC_TIMEOUT_MS (3 * 1000) + +/** + * struct rtw_mrc_entry - entry in the Mesh Received Cache + * + * @seqnum: mesh sequence number of the frame + * @exp_time: expiration time of the entry + * @msa: mesh source address of the frame + * @list: hashtable list pointer + * + * The Mesh Received Cache keeps track of the latest received frames that + * have been received by a mesh interface and discards received frames + * that are found in the cache. + */ +struct rtw_mrc_entry { + rtw_hlist_node list; + systime exp_time; + u32 seqnum; + u8 msa[ETH_ALEN]; +}; + +struct rtw_mrc { + rtw_hlist_head bucket[RTW_MRC_BUCKETS]; + u32 idx_mask; + rtw_mcache *cache; +}; + +static int rtw_mrc_init(_adapter *adapter) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + char cache_name[IFNAMSIZ + 8 + 1]; + int i; + + minfo->mrc = rtw_malloc(sizeof(struct rtw_mrc)); + if (!minfo->mrc) + return -ENOMEM; + minfo->mrc->idx_mask = RTW_MRC_BUCKETS - 1; + for (i = 0; i < RTW_MRC_BUCKETS; i++) + rtw_hlist_head_init(&minfo->mrc->bucket[i]); + + sprintf(cache_name, "rtw_mrc_%s", ADPT_ARG(adapter)); + minfo->mrc->cache = rtw_mcache_create(cache_name, sizeof(struct rtw_mrc_entry)); + + return 0; +} + +static void rtw_mrc_free(_adapter *adapter) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct rtw_mrc *mrc = minfo->mrc; + struct rtw_mrc_entry *p; + rtw_hlist_node *np, *n; + int i; + + if (!mrc) + return; + + for (i = 0; i < RTW_MRC_BUCKETS; i++) { + rtw_hlist_for_each_entry_safe(p, np, n, &mrc->bucket[i], list) { + rtw_hlist_del(&p->list); + rtw_mcache_free(mrc->cache, p); + } + } + + rtw_mcache_destroy(mrc->cache); + + rtw_mfree(mrc, sizeof(struct rtw_mrc)); + minfo->mrc = NULL; +} + +/** + * rtw_mrc_check - Check frame in mesh received cache and add if absent. + * + * @adapter: interface + * @msa: mesh source address + * @seq: mesh seq number + * + * Returns: 0 if the frame is not in the cache, nonzero otherwise. + * + * Checks using the mesh source address and the mesh sequence number if we have + * received this frame lately. If the frame is not in the cache, it is added to + * it. + */ +static int rtw_mrc_check(_adapter *adapter, const u8 *msa, u32 seq) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct rtw_mrc *mrc = minfo->mrc; + int entries = 0; + u8 idx; + struct rtw_mrc_entry *p; + rtw_hlist_node *np, *n; + u8 timeout; + + if (!mrc) + return -1; + + idx = seq & mrc->idx_mask; + rtw_hlist_for_each_entry_safe(p, np, n, &mrc->bucket[idx], list) { + ++entries; + timeout = rtw_time_after(rtw_get_current_time(), p->exp_time); + if (timeout || entries == RTW_MRC_QUEUE_MAX_LEN) { + if (!timeout) + minfo->mshstats.mrc_del_qlen++; + + rtw_hlist_del(&p->list); + rtw_mcache_free(mrc->cache, p); + --entries; + } else if ((seq == p->seqnum) && _rtw_memcmp(msa, p->msa, ETH_ALEN) == _TRUE) + return -1; + } + + p = rtw_mcache_alloc(mrc->cache); + if (!p) + return 0; + + p->seqnum = seq; + p->exp_time = rtw_get_current_time() + rtw_ms_to_systime(RTW_MRC_TIMEOUT_MS); + _rtw_memcpy(p->msa, msa, ETH_ALEN); + rtw_hlist_add_head(&p->list, &mrc->bucket[idx]); + return 0; +} + +static int rtw_mesh_decache(_adapter *adapter, const u8 *msa, u32 seq) +{ + return rtw_mrc_check(adapter, msa, seq); +} + +#ifndef RTW_MESH_SCAN_RESULT_EXP_MS +#define RTW_MESH_SCAN_RESULT_EXP_MS (10 * 1000) +#endif + +#ifndef RTW_MESH_ACNODE_PREVENT +#define RTW_MESH_ACNODE_PREVENT 0 +#endif +#ifndef RTW_MESH_ACNODE_CONF_TIMEOUT_MS +#define RTW_MESH_ACNODE_CONF_TIMEOUT_MS (20 * 1000) +#endif +#ifndef RTW_MESH_ACNODE_NOTIFY_TIMEOUT_MS +#define RTW_MESH_ACNODE_NOTIFY_TIMEOUT_MS (2 * 1000) +#endif + +#ifndef RTW_MESH_OFFCH_CAND +#define RTW_MESH_OFFCH_CAND 1 +#endif +#ifndef RTW_MESH_OFFCH_CAND_FIND_INT_MS +#define RTW_MESH_OFFCH_CAND_FIND_INT_MS (10 * 1000) +#endif + +#ifndef RTW_MESH_PEER_CONF_TIMEOUT_MS +#define RTW_MESH_PEER_CONF_TIMEOUT_MS (20 * 1000) +#endif +#ifndef RTW_MESH_PEER_BLACKLIST_TIMEOUT_MS +#define RTW_MESH_PEER_BLACKLIST_TIMEOUT_MS (20 * 1000) +#endif + +#ifndef RTW_MESH_CTO_MGATE_REQUIRE +#define RTW_MESH_CTO_MGATE_REQUIRE 0 +#endif +#ifndef RTW_MESH_CTO_MGATE_CONF_TIMEOUT_MS +#define RTW_MESH_CTO_MGATE_CONF_TIMEOUT_MS (20 * 1000) +#endif +#ifndef RTW_MESH_CTO_MGATE_BLACKLIST_TIMEOUT_MS +#define RTW_MESH_CTO_MGATE_BLACKLIST_TIMEOUT_MS (20 * 1000) +#endif + +void rtw_mesh_cfg_init_peer_sel_policy(struct rtw_mesh_cfg *mcfg) +{ + struct mesh_peer_sel_policy *sel_policy = &mcfg->peer_sel_policy; + + sel_policy->scanr_exp_ms = RTW_MESH_SCAN_RESULT_EXP_MS; + +#if CONFIG_RTW_MESH_ACNODE_PREVENT + sel_policy->acnode_prevent = RTW_MESH_ACNODE_PREVENT; + sel_policy->acnode_conf_timeout_ms = RTW_MESH_ACNODE_CONF_TIMEOUT_MS; + sel_policy->acnode_notify_timeout_ms = RTW_MESH_ACNODE_NOTIFY_TIMEOUT_MS; +#endif + +#if CONFIG_RTW_MESH_OFFCH_CAND + sel_policy->offch_cand = RTW_MESH_OFFCH_CAND; + sel_policy->offch_find_int_ms = RTW_MESH_OFFCH_CAND_FIND_INT_MS; +#endif + +#if CONFIG_RTW_MESH_PEER_BLACKLIST + sel_policy->peer_conf_timeout_ms = RTW_MESH_PEER_CONF_TIMEOUT_MS; + sel_policy->peer_blacklist_timeout_ms = RTW_MESH_PEER_BLACKLIST_TIMEOUT_MS; +#endif + +#if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST + sel_policy->cto_mgate_require = RTW_MESH_CTO_MGATE_REQUIRE; + sel_policy->cto_mgate_conf_timeout_ms = RTW_MESH_CTO_MGATE_CONF_TIMEOUT_MS; + sel_policy->cto_mgate_blacklist_timeout_ms = RTW_MESH_CTO_MGATE_BLACKLIST_TIMEOUT_MS; +#endif +} + +void rtw_mesh_cfg_init(_adapter *adapter) +{ + struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; + + mcfg->max_peer_links = RTW_MESH_MAX_PEER_LINKS; + mcfg->plink_timeout = RTW_MESH_PEER_LINK_TIMEOUT; + + mcfg->dot11MeshTTL = RTW_MESH_TTL; + mcfg->element_ttl = RTW_MESH_DEFAULT_ELEMENT_TTL; + mcfg->dot11MeshHWMPmaxPREQretries = RTW_MESH_MAX_PREQ_RETRIES; + mcfg->path_refresh_time = RTW_MESH_PATH_REFRESH_TIME; + mcfg->min_discovery_timeout = RTW_MESH_MIN_DISCOVERY_TIMEOUT; + mcfg->dot11MeshHWMPactivePathTimeout = RTW_MESH_PATH_TIMEOUT; + mcfg->dot11MeshHWMPpreqMinInterval = RTW_MESH_PREQ_MIN_INT; + mcfg->dot11MeshHWMPperrMinInterval = RTW_MESH_PERR_MIN_INT; + mcfg->dot11MeshHWMPnetDiameterTraversalTime = RTW_MESH_DIAM_TRAVERSAL_TIME; + mcfg->dot11MeshHWMPRootMode = RTW_IEEE80211_ROOTMODE_NO_ROOT; + mcfg->dot11MeshHWMPRannInterval = RTW_MESH_RANN_INTERVAL; + mcfg->dot11MeshGateAnnouncementProtocol = _FALSE; + mcfg->dot11MeshForwarding = _TRUE; + mcfg->rssi_threshold = 0; + mcfg->dot11MeshHWMPactivePathToRootTimeout = RTW_MESH_PATH_TO_ROOT_TIMEOUT; + mcfg->dot11MeshHWMProotInterval = RTW_MESH_ROOT_INTERVAL; + mcfg->dot11MeshHWMPconfirmationInterval = RTW_MESH_ROOT_CONFIRMATION_INTERVAL; + mcfg->path_gate_timeout_factor = 3; + rtw_mesh_cfg_init_peer_sel_policy(mcfg); +#ifdef CONFIG_RTW_MESH_ADD_ROOT_CHK + mcfg->sane_metric_delta = RTW_MESH_SANE_METRIC_DELTA; + mcfg->max_root_add_chk_cnt = RTW_MESH_MAX_ROOT_ADD_CHK_CNT; +#endif + +#if CONFIG_RTW_MESH_DATA_BMC_TO_UC + mcfg->b2u_flags_msrc = 0; + mcfg->b2u_flags_mfwd = RTW_MESH_B2U_GA_UCAST; +#endif +} + +void rtw_mesh_cfg_init_max_peer_links(_adapter *adapter, u8 stack_conf) +{ + struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; + + mcfg->max_peer_links = RTW_MESH_MAX_PEER_LINKS; + + if (mcfg->max_peer_links > stack_conf) + mcfg->max_peer_links = stack_conf; +} + +void rtw_mesh_cfg_init_plink_timeout(_adapter *adapter, u32 stack_conf) +{ + struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; + + mcfg->plink_timeout = stack_conf; +} + +void rtw_mesh_init_mesh_info(_adapter *adapter) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + + _rtw_memset(minfo, 0, sizeof(struct rtw_mesh_info)); + + rtw_mesh_plink_ctl_init(adapter); + + minfo->last_preq = rtw_get_current_time(); + /* minfo->last_sn_update = rtw_get_current_time(); */ + minfo->next_perr = rtw_get_current_time(); + + ATOMIC_SET(&minfo->mpaths, 0); + rtw_mesh_pathtbl_init(adapter); + + _rtw_init_queue(&minfo->mpath_tx_queue); + tasklet_init(&minfo->mpath_tx_tasklet + , (void(*)(unsigned long))mpath_tx_tasklet_hdl + , (unsigned long)adapter); + + rtw_mrc_init(adapter); + + _rtw_init_listhead(&minfo->preq_queue.list); + _rtw_spinlock_init(&minfo->mesh_preq_queue_lock); + + rtw_init_timer(&adapter->mesh_path_timer, adapter, rtw_ieee80211_mesh_path_timer, adapter); + rtw_init_timer(&adapter->mesh_path_root_timer, adapter, rtw_ieee80211_mesh_path_root_timer, adapter); + rtw_init_timer(&adapter->mesh_atlm_param_req_timer, adapter, rtw_mesh_atlm_param_req_timer, adapter); + _init_workitem(&adapter->mesh_work, rtw_mesh_work_hdl, NULL); +} + +void rtw_mesh_deinit_mesh_info(_adapter *adapter) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + + tasklet_kill(&minfo->mpath_tx_tasklet); + rtw_mpath_tx_queue_flush(adapter); + _rtw_deinit_queue(&adapter->mesh_info.mpath_tx_queue); + + rtw_mrc_free(adapter); + + rtw_mesh_pathtbl_unregister(adapter); + + rtw_mesh_plink_ctl_deinit(adapter); + + _cancel_workitem_sync(&adapter->mesh_work); + _cancel_timer_ex(&adapter->mesh_path_timer); + _cancel_timer_ex(&adapter->mesh_path_root_timer); + _cancel_timer_ex(&adapter->mesh_atlm_param_req_timer); +} + +/** + * rtw_mesh_nexthop_resolve - lookup next hop; conditionally start path discovery + * + * @skb: 802.11 frame to be sent + * @sdata: network subif the frame will be sent through + * + * Lookup next hop for given skb and start path discovery if no + * forwarding information is found. + * + * Returns: 0 if the next hop was found and -ENOENT if the frame was queued. + * skb is freeed here if no mpath could be allocated. + */ +int rtw_mesh_nexthop_resolve(_adapter *adapter, + struct xmit_frame *xframe) +{ + struct pkt_attrib *attrib = &xframe->attrib; + struct rtw_mesh_path *mpath; + struct xmit_frame *xframe_to_free = NULL; + u8 *target_addr = attrib->mda; + int err = 0; + int ret = _SUCCESS; + + rtw_rcu_read_lock(); + err = rtw_mesh_nexthop_lookup(adapter, target_addr, attrib->msa, attrib->ra); + if (!err) + goto endlookup; + + /* no nexthop found, start resolving */ + mpath = rtw_mesh_path_lookup(adapter, target_addr); + if (!mpath) { + mpath = rtw_mesh_path_add(adapter, target_addr); + if (IS_ERR(mpath)) { + xframe->pkt = NULL; /* free pkt outside */ + rtw_mesh_path_discard_frame(adapter, xframe); + err = PTR_ERR(mpath); + ret = _FAIL; + goto endlookup; + } + } + + if (!(mpath->flags & RTW_MESH_PATH_RESOLVING)) + rtw_mesh_queue_preq(mpath, RTW_PREQ_Q_F_START); + + enter_critical_bh(&mpath->frame_queue.lock); + + if (mpath->frame_queue_len >= RTW_MESH_FRAME_QUEUE_LEN) { + xframe_to_free = LIST_CONTAINOR(get_next(get_list_head(&mpath->frame_queue)), struct xmit_frame, list); + rtw_list_delete(&(xframe_to_free->list)); + mpath->frame_queue_len--; + } + + rtw_list_insert_tail(&xframe->list, get_list_head(&mpath->frame_queue)); + mpath->frame_queue_len++; + + exit_critical_bh(&mpath->frame_queue.lock); + + ret = RTW_RA_RESOLVING; + if (xframe_to_free) + rtw_mesh_path_discard_frame(adapter, xframe_to_free); + +endlookup: + rtw_rcu_read_unlock(); + return ret; +} + +/** + * rtw_mesh_nexthop_lookup - put the appropriate next hop on a mesh frame. Calling + * this function is considered "using" the associated mpath, so preempt a path + * refresh if this mpath expires soon. + * + * @skb: 802.11 frame to be sent + * @sdata: network subif the frame will be sent through + * + * Returns: 0 if the next hop was found. Nonzero otherwise. + */ +int rtw_mesh_nexthop_lookup(_adapter *adapter, + const u8 *mda, const u8 *msa, u8 *ra) +{ + struct rtw_mesh_path *mpath; + struct sta_info *next_hop; + const u8 *target_addr = mda; + int err = -ENOENT; + struct registry_priv *registry_par = &adapter->registrypriv; + u8 peer_alive_based_preq = registry_par->peer_alive_based_preq; + BOOLEAN nexthop_alive = _TRUE; + + rtw_rcu_read_lock(); + mpath = rtw_mesh_path_lookup(adapter, target_addr); + + if (!mpath || !(mpath->flags & RTW_MESH_PATH_ACTIVE)) + goto endlookup; + + next_hop = rtw_rcu_dereference(mpath->next_hop); + if (next_hop) { + _rtw_memcpy(ra, next_hop->cmn.mac_addr, ETH_ALEN); + err = 0; + } + + if (peer_alive_based_preq && next_hop) + nexthop_alive = next_hop->alive; + + if (_rtw_memcmp(adapter_mac_addr(adapter), msa, ETH_ALEN) == _TRUE && + !(mpath->flags & RTW_MESH_PATH_RESOLVING) && + !(mpath->flags & RTW_MESH_PATH_FIXED)) { + u8 flags = RTW_PREQ_Q_F_START | RTW_PREQ_Q_F_REFRESH; + + if (peer_alive_based_preq && nexthop_alive == _FALSE) { + flags |= RTW_PREQ_Q_F_BCAST_PREQ; + rtw_mesh_queue_preq(mpath, flags); + } else if (rtw_time_after(rtw_get_current_time(), + mpath->exp_time - + rtw_ms_to_systime(adapter->mesh_cfg.path_refresh_time))) { + rtw_mesh_queue_preq(mpath, flags); + } + /* Avoid keeping trying unicast PREQ toward root, + when next_hop leaves */ + } else if (peer_alive_based_preq && + _rtw_memcmp(adapter_mac_addr(adapter), msa, ETH_ALEN) == _TRUE && + (mpath->flags & RTW_MESH_PATH_RESOLVING) && + !(mpath->flags & RTW_MESH_PATH_FIXED) && + !(mpath->flags & RTW_MESH_PATH_BCAST_PREQ) && + mpath->is_root && nexthop_alive == _FALSE) { + enter_critical_bh(&mpath->state_lock); + mpath->flags |= RTW_MESH_PATH_BCAST_PREQ; + exit_critical_bh(&mpath->state_lock); + } + +endlookup: + rtw_rcu_read_unlock(); + return err; +} + +#if CONFIG_RTW_MESH_DATA_BMC_TO_UC +static bool rtw_mesh_data_bmc_to_uc(_adapter *adapter + , const u8 *da, const u8 *sa, const u8 *mda, const u8 *msa + , u8 ae_need, const u8 *ori_ta, u8 mfwd_ttl + , _list *b2u_list, u8 *b2u_num, u32 *b2u_mseq) +{ + struct sta_priv *stapriv = &adapter->stapriv; + struct xmit_priv *xmitpriv = &adapter->xmitpriv; + _irqL irqL; + _list *head, *list; + struct sta_info *sta; + char b2u_sta_id[NUM_STA]; + u8 b2u_sta_num = 0; + bool bmc_need = _FALSE; + int i; + + _enter_critical_bh(&stapriv->asoc_list_lock, &irqL); + head = &stapriv->asoc_list; + list = get_next(head); + + while ((rtw_end_of_queue_search(head, list)) == _FALSE) { + int stainfo_offset; + + sta = LIST_CONTAINOR(list, struct sta_info, asoc_list); + list = get_next(list); + + stainfo_offset = rtw_stainfo_offset(stapriv, sta); + if (stainfo_offset_valid(stainfo_offset)) + b2u_sta_id[b2u_sta_num++] = stainfo_offset; + } + _exit_critical_bh(&stapriv->asoc_list_lock, &irqL); + + if (!b2u_sta_num) + goto exit; + + for (i = 0; i < b2u_sta_num; i++) { + struct xmit_frame *b2uframe; + struct pkt_attrib *attrib; + + sta = rtw_get_stainfo_by_offset(stapriv, b2u_sta_id[i]); + if (!(sta->state & _FW_LINKED) + || _rtw_memcmp(sta->cmn.mac_addr, msa, ETH_ALEN) == _TRUE + || (ori_ta && _rtw_memcmp(sta->cmn.mac_addr, ori_ta, ETH_ALEN) == _TRUE) + || is_broadcast_mac_addr(sta->cmn.mac_addr) + || is_zero_mac_addr(sta->cmn.mac_addr)) + continue; + + b2uframe = rtw_alloc_xmitframe(xmitpriv); + if (!b2uframe) { + bmc_need = _TRUE; + break; + } + + if ((*b2u_num)++ == 0 && !ori_ta) { + *b2u_mseq = (cpu_to_le32(adapter->mesh_info.mesh_seqnum)); + adapter->mesh_info.mesh_seqnum++; + } + + attrib = &b2uframe->attrib; + + attrib->mb2u = 1; + attrib->mseq = *b2u_mseq; + attrib->mfwd_ttl = ori_ta ? mfwd_ttl : 0; + _rtw_memcpy(attrib->ra, sta->cmn.mac_addr, ETH_ALEN); + _rtw_memcpy(attrib->ta, adapter_mac_addr(adapter), ETH_ALEN); + _rtw_memcpy(attrib->mda, mda, ETH_ALEN); + _rtw_memcpy(attrib->msa, msa, ETH_ALEN); + _rtw_memcpy(attrib->dst, da, ETH_ALEN); + _rtw_memcpy(attrib->src, sa, ETH_ALEN); + attrib->mesh_frame_mode = ae_need ? MESH_UCAST_PX_DATA : MESH_UCAST_DATA; + + rtw_list_insert_tail(&b2uframe->list, b2u_list); + } + +exit: + return bmc_need; +} + +void dump_mesh_b2u_flags(void *sel, _adapter *adapter) +{ + struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; + + RTW_PRINT_SEL(sel, "%4s %4s\n", "msrc", "mfwd"); + RTW_PRINT_SEL(sel, "0x%02x 0x%02x\n", mcfg->b2u_flags_msrc, mcfg->b2u_flags_mfwd); +} +#endif /* CONFIG_RTW_MESH_DATA_BMC_TO_UC */ + +int rtw_mesh_addr_resolve(_adapter *adapter, struct xmit_frame *xframe, _pkt *pkt, _list *b2u_list) +{ + struct pkt_file pktfile; + struct ethhdr etherhdr; + struct pkt_attrib *attrib; + struct rtw_mesh_path *mpath = NULL, *mppath = NULL; + u8 is_da_mcast; + u8 ae_need; +#if CONFIG_RTW_MESH_DATA_BMC_TO_UC + bool bmc_need = _TRUE; + u8 b2u_num = 0; + u32 b2u_mseq = 0; +#endif + int res = _SUCCESS; + + _rtw_open_pktfile(pkt, &pktfile); + if (_rtw_pktfile_read(&pktfile, (u8 *)ðerhdr, ETH_HLEN) != ETH_HLEN) { + res = _FAIL; + goto exit; + } + + xframe->pkt = pkt; +#if CONFIG_RTW_MESH_DATA_BMC_TO_UC + _rtw_init_listhead(b2u_list); +#endif + + is_da_mcast = IS_MCAST(etherhdr.h_dest); + if (!is_da_mcast) { + struct sta_info *next_hop; + bool mpp_lookup = 1; + + mpath = rtw_mesh_path_lookup(adapter, etherhdr.h_dest); + if (mpath) { + mpp_lookup = 0; + next_hop = rtw_rcu_dereference(mpath->next_hop); + if (!next_hop + || !(mpath->flags & (RTW_MESH_PATH_ACTIVE | RTW_MESH_PATH_RESOLVING)) + ) { + /* mpath is not valid, search mppath */ + mpp_lookup = 1; + } + } + + if (mpp_lookup) { + mppath = rtw_mpp_path_lookup(adapter, etherhdr.h_dest); + if (mppath) + mppath->exp_time = rtw_get_current_time(); + } + + if (mppath && mpath) + rtw_mesh_path_del(adapter, mpath->dst); + + ae_need = _rtw_memcmp(adapter_mac_addr(adapter), etherhdr.h_source, ETH_ALEN) == _FALSE + || (mppath && _rtw_memcmp(mppath->mpp, etherhdr.h_dest, ETH_ALEN) == _FALSE); + } else { + ae_need = _rtw_memcmp(adapter_mac_addr(adapter), etherhdr.h_source, ETH_ALEN) == _FALSE; + + #if CONFIG_RTW_MESH_DATA_BMC_TO_UC + if (rtw_msrc_b2u_policy_chk(adapter->mesh_cfg.b2u_flags_msrc, etherhdr.h_dest)) { + bmc_need = rtw_mesh_data_bmc_to_uc(adapter + , etherhdr.h_dest, etherhdr.h_source + , etherhdr.h_dest, adapter_mac_addr(adapter), ae_need, NULL, 0 + , b2u_list, &b2u_num, &b2u_mseq); + if (bmc_need == _FALSE) { + res = RTW_BMC_NO_NEED; + goto exit; + } + } + #endif + } + + attrib = &xframe->attrib; + +#if CONFIG_RTW_MESH_DATA_BMC_TO_UC + if (b2u_num) { + attrib->mb2u = 1; + attrib->mseq = b2u_mseq; + } else + attrib->mb2u = 0; +#endif + + attrib->mfwd_ttl = 0; + _rtw_memcpy(attrib->dst, etherhdr.h_dest, ETH_ALEN); + _rtw_memcpy(attrib->src, etherhdr.h_source, ETH_ALEN); + _rtw_memcpy(attrib->ta, adapter_mac_addr(adapter), ETH_ALEN); + + if (is_da_mcast) { + attrib->mesh_frame_mode = ae_need ? MESH_BMCAST_PX_DATA : MESH_BMCAST_DATA; + _rtw_memcpy(attrib->ra, attrib->dst, ETH_ALEN); + _rtw_memcpy(attrib->msa, adapter_mac_addr(adapter), ETH_ALEN); + } else { + attrib->mesh_frame_mode = ae_need ? MESH_UCAST_PX_DATA : MESH_UCAST_DATA; + _rtw_memcpy(attrib->mda, (mppath && ae_need) ? mppath->mpp : attrib->dst, ETH_ALEN); + _rtw_memcpy(attrib->msa, adapter_mac_addr(adapter), ETH_ALEN); + /* RA needs to be resolved */ + res = rtw_mesh_nexthop_resolve(adapter, xframe); + } + +exit: + return res; +} + +s8 rtw_mesh_tx_set_whdr_mctrl_len(u8 mesh_frame_mode, struct pkt_attrib *attrib) +{ + u8 ret = 0; + switch (mesh_frame_mode) { + case MESH_UCAST_DATA: + attrib->hdrlen = WLAN_HDR_A4_QOS_LEN; + /* mesh flag + mesh TTL + Mesh SN. no ext addr. */ + attrib->meshctrl_len = 6; + break; + case MESH_BMCAST_DATA: + attrib->hdrlen = WLAN_HDR_A3_QOS_LEN; + /* mesh flag + mesh TTL + Mesh SN. no ext addr. */ + attrib->meshctrl_len = 6; + break; + case MESH_UCAST_PX_DATA: + attrib->hdrlen = WLAN_HDR_A4_QOS_LEN; + /* mesh flag + mesh TTL + Mesh SN + extaddr1 + extaddr2. */ + attrib->meshctrl_len = 18; + break; + case MESH_BMCAST_PX_DATA: + attrib->hdrlen = WLAN_HDR_A3_QOS_LEN; + /* mesh flag + mesh TTL + Mesh SN + extaddr1 */ + attrib->meshctrl_len = 12; + break; + default: + RTW_WARN("Invalid mesh frame mode:%u\n", mesh_frame_mode); + ret = -1; + break; + } + + return ret; +} + +void rtw_mesh_tx_build_mctrl(_adapter *adapter, struct pkt_attrib *attrib, u8 *buf) +{ + struct rtw_ieee80211s_hdr *mctrl = (struct rtw_ieee80211s_hdr *)buf; + + _rtw_memset(mctrl, 0, XATTRIB_GET_MCTRL_LEN(attrib)); + + if (attrib->mfwd_ttl + #if CONFIG_RTW_MESH_DATA_BMC_TO_UC + || attrib->mb2u + #endif + ) { + #if CONFIG_RTW_MESH_DATA_BMC_TO_UC + if (!attrib->mfwd_ttl) + mctrl->ttl = adapter->mesh_cfg.dot11MeshTTL; + else + #endif + mctrl->ttl = attrib->mfwd_ttl; + + mctrl->seqnum = (cpu_to_le32(attrib->mseq)); + } else { + mctrl->ttl = adapter->mesh_cfg.dot11MeshTTL; + mctrl->seqnum = (cpu_to_le32(adapter->mesh_info.mesh_seqnum)); + adapter->mesh_info.mesh_seqnum++; + } + + switch (attrib->mesh_frame_mode){ + case MESH_UCAST_DATA: + case MESH_BMCAST_DATA: + break; + case MESH_UCAST_PX_DATA: + mctrl->flags |= MESH_FLAGS_AE_A5_A6; + _rtw_memcpy(mctrl->eaddr1, attrib->dst, ETH_ALEN); + _rtw_memcpy(mctrl->eaddr2, attrib->src, ETH_ALEN); + break; + case MESH_BMCAST_PX_DATA: + mctrl->flags |= MESH_FLAGS_AE_A4; + _rtw_memcpy(mctrl->eaddr1, attrib->src, ETH_ALEN); + break; + case MESH_MHOP_UCAST_ACT: + /* TBD */ + break; + case MESH_MHOP_BMCAST_ACT: + /* TBD */ + break; + default: + break; + } +} + +u8 rtw_mesh_tx_build_whdr(_adapter *adapter, struct pkt_attrib *attrib + , u16 *fctrl, struct rtw_ieee80211_hdr *whdr) +{ + switch (attrib->mesh_frame_mode) { + case MESH_UCAST_DATA: /* 1, 1, RA, TA, mDA(=DA), mSA(=SA) */ + case MESH_UCAST_PX_DATA: /* 1, 1, RA, TA, mDA, mSA, [DA, SA] */ + SetToDs(fctrl); + SetFrDs(fctrl); + _rtw_memcpy(whdr->addr1, attrib->ra, ETH_ALEN); + _rtw_memcpy(whdr->addr2, attrib->ta, ETH_ALEN); + _rtw_memcpy(whdr->addr3, attrib->mda, ETH_ALEN); + _rtw_memcpy(whdr->addr4, attrib->msa, ETH_ALEN); + break; + case MESH_BMCAST_DATA: /* 0, 1, RA(DA), TA, mSA(SA) */ + case MESH_BMCAST_PX_DATA: /* 0, 1, RA(DA), TA, mSA, [SA] */ + SetFrDs(fctrl); + _rtw_memcpy(whdr->addr1, attrib->ra, ETH_ALEN); + _rtw_memcpy(whdr->addr2, attrib->ta, ETH_ALEN); + _rtw_memcpy(whdr->addr3, attrib->msa, ETH_ALEN); + break; + case MESH_MHOP_UCAST_ACT: + /* TBD */ + RTW_INFO("MESH_MHOP_UCAST_ACT\n"); + break; + case MESH_MHOP_BMCAST_ACT: + /* TBD */ + RTW_INFO("MESH_MHOP_BMCAST_ACT\n"); + break; + default: + RTW_WARN("Invalid mesh frame mode\n"); + break; + } + + return 0; +} + +int rtw_mesh_rx_data_validate_hdr(_adapter *adapter, union recv_frame *rframe, struct sta_info **sta) +{ + struct sta_priv *stapriv = &adapter->stapriv; + struct rx_pkt_attrib *rattrib = &rframe->u.hdr.attrib; + u8 *whdr = get_recvframe_data(rframe); + u8 is_ra_bmc = 0; + u8 a4_shift = 0; + u8 ps; + u8 *qc; + u8 mps_mode = RTW_MESH_PS_UNKNOWN; + sint ret = _FAIL; + + if (!(MLME_STATE(adapter) & WIFI_ASOC_STATE)) + goto exit; + + if (!rattrib->qos) + goto exit; + + switch (rattrib->to_fr_ds) { + case 1: + if (!IS_MCAST(GetAddr1Ptr(whdr))) + goto exit; + *sta = rtw_get_stainfo(stapriv, get_addr2_ptr(whdr)); + if (*sta == NULL) { + ret = _SUCCESS; /* return _SUCCESS to drop at sta checking */ + goto exit; + } + _rtw_memcpy(rattrib->ra, GetAddr1Ptr(whdr), ETH_ALEN); + _rtw_memcpy(rattrib->ta, get_addr2_ptr(whdr), ETH_ALEN); + _rtw_memcpy(rattrib->mda, GetAddr1Ptr(whdr), ETH_ALEN); + _rtw_memcpy(rattrib->msa, GetAddr3Ptr(whdr), ETH_ALEN); /* may change after checking AMSDU subframe header */ + _rtw_memcpy(rattrib->dst, GetAddr1Ptr(whdr), ETH_ALEN); + _rtw_memcpy(rattrib->src, GetAddr3Ptr(whdr), ETH_ALEN); /* may change after checking mesh ctrl field */ + _rtw_memcpy(rattrib->bssid, get_addr2_ptr(whdr), ETH_ALEN); + is_ra_bmc = 1; + break; + case 3: + if (IS_MCAST(GetAddr1Ptr(whdr))) + goto exit; + *sta = rtw_get_stainfo(stapriv, get_addr2_ptr(whdr)); + if (*sta == NULL) { + ret = _SUCCESS; /* return _SUCCESS to drop at sta checking */ + goto exit; + } + _rtw_memcpy(rattrib->ra, GetAddr1Ptr(whdr), ETH_ALEN); + _rtw_memcpy(rattrib->ta, get_addr2_ptr(whdr), ETH_ALEN); + _rtw_memcpy(rattrib->mda, GetAddr3Ptr(whdr), ETH_ALEN); /* may change after checking AMSDU subframe header */ + _rtw_memcpy(rattrib->msa, GetAddr4Ptr(whdr), ETH_ALEN); /* may change after checking AMSDU subframe header */ + _rtw_memcpy(rattrib->dst, GetAddr3Ptr(whdr), ETH_ALEN); /* may change after checking mesh ctrl field */ + _rtw_memcpy(rattrib->src, GetAddr4Ptr(whdr), ETH_ALEN); /* may change after checking mesh ctrl field */ + _rtw_memcpy(rattrib->bssid, get_addr2_ptr(whdr), ETH_ALEN); + a4_shift = ETH_ALEN; + break; + default: + goto exit; + } + + qc = whdr + WLAN_HDR_A3_LEN + a4_shift; + ps = GetPwrMgt(whdr); + mps_mode = ps ? (is_ra_bmc || (get_mps_lv(qc)) ? RTW_MESH_PS_DSLEEP : RTW_MESH_PS_LSLEEP) : RTW_MESH_PS_ACTIVE; + + if (ps) { + if (!((*sta)->state & WIFI_SLEEP_STATE)) + stop_sta_xmit(adapter, *sta); + } else { + if ((*sta)->state & WIFI_SLEEP_STATE) + wakeup_sta_to_xmit(adapter, *sta); + } + + if (is_ra_bmc) + (*sta)->nonpeer_mps = mps_mode; + else { + (*sta)->peer_mps = mps_mode; + if (mps_mode != RTW_MESH_PS_ACTIVE && (*sta)->nonpeer_mps == RTW_MESH_PS_ACTIVE) + (*sta)->nonpeer_mps = RTW_MESH_PS_DSLEEP; + } + + if (get_frame_sub_type(whdr) & BIT(6)) { + /* No data, will not indicate to upper layer, temporily count it here */ + count_rx_stats(adapter, rframe, *sta); + ret = RTW_RX_HANDLED; + goto exit; + } + + rattrib->mesh_ctrl_present = get_mctrl_present(qc) ? 1 : 0; + if (!rattrib->mesh_ctrl_present) + goto exit; + + ret = _SUCCESS; + +exit: + return ret; +} + +int rtw_mesh_rx_data_validate_mctrl(_adapter *adapter, union recv_frame *rframe + , const struct rtw_ieee80211s_hdr *mctrl, const u8 *mda, const u8 *msa + , u8 *mctrl_len + , const u8 **da, const u8 **sa) +{ + struct rx_pkt_attrib *rattrib = &rframe->u.hdr.attrib; + u8 mlen; + u8 ae; + int ret = _SUCCESS; + + ae = mctrl->flags & MESH_FLAGS_AE; + mlen = ae_to_mesh_ctrl_len[ae]; + switch (rattrib->to_fr_ds) { + case 1: + *da = mda; + if (ae == MESH_FLAGS_AE_A4) + *sa = mctrl->eaddr1; + else if (ae == 0) + *sa = msa; + else + ret = _FAIL; + break; + case 3: + if (ae == MESH_FLAGS_AE_A5_A6) { + *da = mctrl->eaddr1; + *sa = mctrl->eaddr2; + } else if (ae == 0) { + *da = mda; + *sa = msa; + } else + ret = _FAIL; + break; + default: + ret = _FAIL; + } + + if (ret == _FAIL) { + #ifdef DBG_RX_DROP_FRAME + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" invalid tfDS:%u AE:%u combination ra="MAC_FMT" ta="MAC_FMT"\n" + , FUNC_ADPT_ARG(adapter), rattrib->to_fr_ds, ae, MAC_ARG(rattrib->ra), MAC_ARG(rattrib->ta)); + #endif + *mctrl_len = 0; + } else + *mctrl_len = mlen; + + return ret; +} + +inline int rtw_mesh_rx_validate_mctrl_non_amsdu(_adapter *adapter, union recv_frame *rframe) +{ + struct rx_pkt_attrib *rattrib = &rframe->u.hdr.attrib; + const u8 *da, *sa; + int ret; + + ret = rtw_mesh_rx_data_validate_mctrl(adapter, rframe + , (struct rtw_ieee80211s_hdr *)(get_recvframe_data(rframe) + rattrib->hdrlen + rattrib->iv_len) + , rattrib->mda, rattrib->msa + , &rattrib->mesh_ctrl_len + , &da, &sa); + + if (ret == _SUCCESS) { + _rtw_memcpy(rattrib->dst, da, ETH_ALEN); + _rtw_memcpy(rattrib->src, sa, ETH_ALEN); + } + + return ret; +} + +/** + * rtw_mesh_rx_nexthop_resolve - lookup next hop; conditionally start path discovery + * + * @skb: 802.11 frame to be sent + * @sdata: network subif the frame will be sent through + * + * Lookup next hop for given skb and start path discovery if no + * forwarding information is found. + * + * Returns: 0 if the next hop was found and -ENOENT if the frame was queued. + * skb is freeed here if no mpath could be allocated. + */ +static int rtw_mesh_rx_nexthop_resolve(_adapter *adapter, + const u8 *mda, const u8 *msa, u8 *ra) +{ + struct rtw_mesh_path *mpath; + struct xmit_frame *xframe_to_free = NULL; + int err = 0; + int ret = _SUCCESS; + + rtw_rcu_read_lock(); + err = rtw_mesh_nexthop_lookup(adapter, mda, msa, ra); + if (!err) + goto endlookup; + + /* no nexthop found, start resolving */ + mpath = rtw_mesh_path_lookup(adapter, mda); + if (!mpath) { + mpath = rtw_mesh_path_add(adapter, mda); + if (IS_ERR(mpath)) { + err = PTR_ERR(mpath); + ret = _FAIL; + goto endlookup; + } + } + + if (!(mpath->flags & RTW_MESH_PATH_RESOLVING)) + rtw_mesh_queue_preq(mpath, RTW_PREQ_Q_F_START); + + ret = _FAIL; + +endlookup: + rtw_rcu_read_unlock(); + return ret; +} + +#define RTW_MESH_DECACHE_BMC 1 +#define RTW_MESH_DECACHE_UC 0 + +#define RTW_MESH_FORWARD_MDA_SELF_COND 0 +#define DBG_RTW_MESH_FORWARD_MDA_SELF_COND 0 +int rtw_mesh_rx_msdu_act_check(union recv_frame *rframe + , const u8 *mda, const u8 *msa + , const u8 *da, const u8 *sa + , struct rtw_ieee80211s_hdr *mctrl + , struct xmit_frame **fwd_frame, _list *b2u_list) +{ + _adapter *adapter = rframe->u.hdr.adapter; + struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct rx_pkt_attrib *rattrib = &rframe->u.hdr.attrib; + struct rtw_mesh_path *mppath; + u8 is_mda_bmc = IS_MCAST(mda); + u8 is_mda_self = !is_mda_bmc && _rtw_memcmp(mda, adapter_mac_addr(adapter), ETH_ALEN); + struct xmit_frame *xframe; + struct pkt_attrib *xattrib; + u8 fwd_ra[ETH_ALEN] = {0}; + u8 fwd_mpp[ETH_ALEN] = {0}; /* forward to other gate */ + u32 fwd_mseq; + int act = 0; + u8 ae_need; +#if CONFIG_RTW_MESH_DATA_BMC_TO_UC + bool bmc_need = _TRUE; + u8 b2u_num = 0; +#endif + + /* fwd info lifetime update */ + #if 0 + if (!is_mda_self) + mDA(A3) fwinfo.lifetime + mSA(A4) fwinfo.lifetime + Precursor-to-mDA(A2) fwinfo.lifetime + #endif + + /* update/create pxoxy info for SA, mSA */ + if ((mctrl->flags & MESH_FLAGS_AE) + && sa != msa && _rtw_memcmp(sa, msa, ETH_ALEN) == _FALSE + ) { + const u8 *proxied_addr = sa; + const u8 *mpp_addr = msa; + + rtw_rcu_read_lock(); + mppath = rtw_mpp_path_lookup(adapter, proxied_addr); + if (!mppath) + rtw_mpp_path_add(adapter, proxied_addr, mpp_addr); + else { + enter_critical_bh(&mppath->state_lock); + if (_rtw_memcmp(mppath->mpp, mpp_addr, ETH_ALEN) == _FALSE) + _rtw_memcpy(mppath->mpp, mpp_addr, ETH_ALEN); + mppath->exp_time = rtw_get_current_time(); + exit_critical_bh(&mppath->state_lock); + } + rtw_rcu_read_unlock(); + } + + /* mSA is self, need no further process */ + if (_rtw_memcmp(msa, adapter_mac_addr(adapter), ETH_ALEN) == _TRUE) + goto exit; + + fwd_mseq = le32_to_cpu(mctrl->seqnum); + + /* check duplicate MSDU from mSA */ + if (((RTW_MESH_DECACHE_BMC && is_mda_bmc) + || (RTW_MESH_DECACHE_UC && !is_mda_bmc)) + && rtw_mesh_decache(adapter, msa, fwd_mseq) + ) { + minfo->mshstats.dropped_frames_duplicate++; + goto exit; + } + + if (is_mda_bmc) { + /* mDA is bmc addr */ + act |= RTW_RX_MSDU_ACT_INDICATE; + if (!mcfg->dot11MeshForwarding) + goto exit; + goto fwd_chk; + + } else if (!is_mda_self) { + /* mDA is unicast but not self */ + if (!mcfg->dot11MeshForwarding) { + rtw_mesh_path_error_tx(adapter + , adapter->mesh_cfg.element_ttl + , mda, 0 + , WLAN_REASON_MESH_PATH_NOFORWARD + , rattrib->ta + ); + #ifdef DBG_RX_DROP_FRAME + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" mDA("MAC_FMT") not self, !dot11MeshForwarding\n" + , FUNC_ADPT_ARG(adapter), MAC_ARG(mda)); + #endif + goto exit; + } + + if (rtw_mesh_rx_nexthop_resolve(adapter, mda, msa, fwd_ra) != _SUCCESS) { + /* mDA is unknown */ + rtw_mesh_path_error_tx(adapter + , adapter->mesh_cfg.element_ttl + , mda, 0 + , WLAN_REASON_MESH_PATH_NOFORWARD + , rattrib->ta + ); + #ifdef DBG_RX_DROP_FRAME + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" mDA("MAC_FMT") unknown\n" + , FUNC_ADPT_ARG(adapter), MAC_ARG(mda)); + #endif + minfo->mshstats.dropped_frames_no_route++; + goto exit; + + } else { + /* mDA is known in fwd info */ + #if 0 + if (TA is not in precursors) + goto exit; + #endif + goto fwd_chk; + } + + } else { + /* mDA is self */ + #if RTW_MESH_FORWARD_MDA_SELF_COND + if (da == mda + || _rtw_memcmp(da, adapter_mac_addr(adapter), ETH_ALEN) + ) { + /* DA is self, indicate */ + act |= RTW_RX_MSDU_ACT_INDICATE; + goto exit; + } + + if (rtw_get_iface_by_macddr(adapter, da)) { + /* DA is buddy, indicate */ + act |= RTW_RX_MSDU_ACT_INDICATE; + #if DBG_RTW_MESH_FORWARD_MDA_SELF_COND + RTW_INFO(FUNC_ADPT_FMT" DA("MAC_FMT") is buddy("ADPT_FMT")\n" + , FUNC_ADPT_ARG(adapter), MAC_ARG(da), ADPT_ARG(rtw_get_iface_by_macddr(adapter, da))); + #endif + goto exit; + } + + /* DA is not self or buddy */ + if (rtw_mesh_nexthop_lookup(adapter, da, msa, fwd_ra) == 0) { + /* DA is known in fwd info */ + if (!mcfg->dot11MeshForwarding) { + /* path error to? */ + #if defined(DBG_RX_DROP_FRAME) || DBG_RTW_MESH_FORWARD_MDA_SELF_COND + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" DA("MAC_FMT") not self, !dot11MeshForwarding\n" + , FUNC_ADPT_ARG(adapter), MAC_ARG(da)); + #endif + goto exit; + } + mda = da; + #if DBG_RTW_MESH_FORWARD_MDA_SELF_COND + RTW_INFO(FUNC_ADPT_FMT" fwd to DA("MAC_FMT"), fwd_RA("MAC_FMT")\n" + , FUNC_ADPT_ARG(adapter), MAC_ARG(da), MAC_ARG(fwd_ra)); + #endif + goto fwd_chk; + } + + rtw_rcu_read_lock(); + mppath = rtw_mpp_path_lookup(adapter, da); + if (mppath) { + if (_rtw_memcmp(mppath->mpp, adapter_mac_addr(adapter), ETH_ALEN) == _FALSE) { + /* DA is proxied by others */ + if (!mcfg->dot11MeshForwarding) { + /* path error to? */ + #if defined(DBG_RX_DROP_FRAME) || DBG_RTW_MESH_FORWARD_MDA_SELF_COND + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" DA("MAC_FMT") is proxied by ("MAC_FMT"), !dot11MeshForwarding\n" + , FUNC_ADPT_ARG(adapter), MAC_ARG(da), MAC_ARG(mppath->mpp)); + #endif + rtw_rcu_read_unlock(); + goto exit; + } + _rtw_memcpy(fwd_mpp, mppath->mpp, ETH_ALEN); + mda = fwd_mpp; + msa = adapter_mac_addr(adapter); + rtw_rcu_read_unlock(); + + /* resolve RA */ + if (rtw_mesh_nexthop_lookup(adapter, mda, msa, fwd_ra) != 0) { + minfo->mshstats.dropped_frames_no_route++; + #if defined(DBG_RX_DROP_FRAME) || DBG_RTW_MESH_FORWARD_MDA_SELF_COND + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" DA("MAC_FMT") is proxied by ("MAC_FMT"), RA resolve fail\n" + , FUNC_ADPT_ARG(adapter), MAC_ARG(da), MAC_ARG(mppath->mpp)); + #endif + goto exit; + } + #if DBG_RTW_MESH_FORWARD_MDA_SELF_COND + RTW_INFO(FUNC_ADPT_FMT" DA("MAC_FMT") is proxied by ("MAC_FMT"), fwd_RA("MAC_FMT")\n" + , FUNC_ADPT_ARG(adapter), MAC_ARG(da), MAC_ARG(mppath->mpp), MAC_ARG(fwd_ra)); + #endif + goto fwd_chk; /* forward to other gate */ + } else { + #if DBG_RTW_MESH_FORWARD_MDA_SELF_COND + RTW_INFO(FUNC_ADPT_FMT" DA("MAC_FMT") is proxied by self\n" + , FUNC_ADPT_ARG(adapter), MAC_ARG(da)); + #endif + } + } + rtw_rcu_read_unlock(); + + if (!mppath) { + #if DBG_RTW_MESH_FORWARD_MDA_SELF_COND + RTW_INFO(FUNC_ADPT_FMT" DA("MAC_FMT") unknown\n" + , FUNC_ADPT_ARG(adapter), MAC_ARG(da)); + #endif + /* DA is unknown */ + #if 0 /* TODO: flags with AE bit */ + rtw_mesh_path_error_tx(adapter + , adapter->mesh_cfg.element_ttl + , mda, adapter->mesh_info.last_sn_update + , WLAN_REASON_MESH_PATH_NOPROXY + , msa + ); + #endif + } + + /* + * indicate to DS for both cases: + * 1.) DA is proxied by self + * 2.) DA is unknown + */ + #endif /* RTW_MESH_FORWARD_MDA_SELF_COND */ + act |= RTW_RX_MSDU_ACT_INDICATE; + goto exit; + } + +fwd_chk: + + if (adapter->stapriv.asoc_list_cnt <= 1) + goto exit; + + if (mctrl->ttl == 1) { + minfo->mshstats.dropped_frames_ttl++; + if (!act) { + #ifdef DBG_RX_DROP_FRAME + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" ttl reaches 0, not forwarding\n" + , FUNC_ADPT_ARG(adapter)); + #endif + } + goto exit; + } + +#if CONFIG_RTW_MESH_DATA_BMC_TO_UC + _rtw_init_listhead(b2u_list); +#endif + + ae_need = _rtw_memcmp(da , mda, ETH_ALEN) == _FALSE + || _rtw_memcmp(sa , msa, ETH_ALEN) == _FALSE; + +#if CONFIG_RTW_MESH_DATA_BMC_TO_UC + if (is_mda_bmc + && rtw_mfwd_b2u_policy_chk(mcfg->b2u_flags_mfwd, mda, rattrib->to_fr_ds == 3) + ) { + bmc_need = rtw_mesh_data_bmc_to_uc(adapter + , da, sa, mda, msa, ae_need, rframe->u.hdr.psta->cmn.mac_addr, mctrl->ttl - 1 + , b2u_list, &b2u_num, &fwd_mseq); + } + + if (bmc_need == _TRUE) +#endif + { + xframe = rtw_alloc_xmitframe(&adapter->xmitpriv); + if (!xframe) { + #ifdef DBG_TX_DROP_FRAME + RTW_INFO("DBG_TX_DROP_FRAME "FUNC_ADPT_FMT" rtw_alloc_xmitframe fail\n" + , FUNC_ADPT_ARG(adapter)); + #endif + goto exit; + } + + xattrib = &xframe->attrib; + +#if CONFIG_RTW_MESH_DATA_BMC_TO_UC + if (b2u_num) + xattrib->mb2u = 1; + else + xattrib->mb2u = 0; +#endif + xattrib->mfwd_ttl = mctrl->ttl - 1; + xattrib->mseq = fwd_mseq; + _rtw_memcpy(xattrib->dst, da, ETH_ALEN); + _rtw_memcpy(xattrib->src, sa, ETH_ALEN); + _rtw_memcpy(xattrib->mda, mda, ETH_ALEN); + _rtw_memcpy(xattrib->msa, msa, ETH_ALEN); + _rtw_memcpy(xattrib->ta, adapter_mac_addr(adapter), ETH_ALEN); + + if (is_mda_bmc) { + xattrib->mesh_frame_mode = ae_need ? MESH_BMCAST_PX_DATA : MESH_BMCAST_DATA; + _rtw_memcpy(xattrib->ra, mda, ETH_ALEN); + } else { + xattrib->mesh_frame_mode = ae_need ? MESH_UCAST_PX_DATA : MESH_UCAST_DATA; + _rtw_memcpy(xattrib->ra, fwd_ra, ETH_ALEN); + } + + *fwd_frame = xframe; + } + + act |= RTW_RX_MSDU_ACT_FORWARD; + if (is_mda_bmc) + minfo->mshstats.fwded_mcast++; + else + minfo->mshstats.fwded_unicast++; + minfo->mshstats.fwded_frames++; + +exit: + return act; +} + +void dump_mesh_stats(void *sel, _adapter *adapter) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct rtw_mesh_stats *stats = &minfo->mshstats; + + RTW_PRINT_SEL(sel, "fwd_bmc:%u\n", stats->fwded_mcast); + RTW_PRINT_SEL(sel, "fwd_uc:%u\n", stats->fwded_unicast); + + RTW_PRINT_SEL(sel, "drop_ttl:%u\n", stats->dropped_frames_ttl); + RTW_PRINT_SEL(sel, "drop_no_route:%u\n", stats->dropped_frames_no_route); + RTW_PRINT_SEL(sel, "drop_congestion:%u\n", stats->dropped_frames_congestion); + RTW_PRINT_SEL(sel, "drop_dup:%u\n", stats->dropped_frames_duplicate); + + RTW_PRINT_SEL(sel, "mrc_del_qlen:%u\n", stats->mrc_del_qlen); +} +#endif /* CONFIG_RTW_MESH */ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/mesh/rtw_mesh.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/mesh/rtw_mesh.h new file mode 100644 index 000000000000..840fc23a05e4 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/mesh/rtw_mesh.h @@ -0,0 +1,536 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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_MESH_H_ +#define __RTW_MESH_H_ + +#ifndef CONFIG_AP_MODE + #error "CONFIG_RTW_MESH can't be enabled when CONFIG_AP_MODE is not defined\n" +#endif + +#define RTW_MESH_TTL 31 +#define RTW_MESH_PERR_MIN_INT 100 +#define RTW_MESH_DEFAULT_ELEMENT_TTL 31 +#define RTW_MESH_RANN_INTERVAL 5000 +#define RTW_MESH_PATH_TO_ROOT_TIMEOUT 6000 +#define RTW_MESH_DIAM_TRAVERSAL_TIME 50 +#define RTW_MESH_PATH_TIMEOUT 5000 +#define RTW_MESH_PREQ_MIN_INT 10 +#define RTW_MESH_MAX_PREQ_RETRIES 4 +#define RTW_MESH_MIN_DISCOVERY_TIMEOUT (2 * RTW_MESH_DIAM_TRAVERSAL_TIME) +#define RTW_MESH_ROOT_CONFIRMATION_INTERVAL 2000 +#define RTW_MESH_PATH_REFRESH_TIME 1000 +#define RTW_MESH_ROOT_INTERVAL 5000 + +#define RTW_MESH_SANE_METRIC_DELTA 100 +#define RTW_MESH_MAX_ROOT_ADD_CHK_CNT 2 + +#define RTW_MESH_PLINK_UNKNOWN 0 +#define RTW_MESH_PLINK_LISTEN 1 +#define RTW_MESH_PLINK_OPN_SNT 2 +#define RTW_MESH_PLINK_OPN_RCVD 3 +#define RTW_MESH_PLINK_CNF_RCVD 4 +#define RTW_MESH_PLINK_ESTAB 5 +#define RTW_MESH_PLINK_HOLDING 6 +#define RTW_MESH_PLINK_BLOCKED 7 + +extern const char *_rtw_mesh_plink_str[]; +#define rtw_mesh_plink_str(s) ((s <= RTW_MESH_PLINK_BLOCKED) ? _rtw_mesh_plink_str[s] : _rtw_mesh_plink_str[RTW_MESH_PLINK_UNKNOWN]) + +#define RTW_MESH_PS_UNKNOWN 0 +#define RTW_MESH_PS_ACTIVE 1 +#define RTW_MESH_PS_LSLEEP 2 +#define RTW_MESH_PS_DSLEEP 3 + +extern const char *_rtw_mesh_ps_str[]; +#define rtw_mesh_ps_str(mps) ((mps <= RTW_MESH_PS_DSLEEP) ? _rtw_mesh_ps_str[mps] : _rtw_mesh_ps_str[RTW_MESH_PS_UNKNOWN]) + +#define GET_MESH_CONF_ELE_PATH_SEL_PROTO_ID(_iec) LE_BITS_TO_1BYTE(((u8 *)(_iec)) + 0, 0, 8) +#define GET_MESH_CONF_ELE_PATH_SEL_METRIC_ID(_iec) LE_BITS_TO_1BYTE(((u8 *)(_iec)) + 1, 0, 8) +#define GET_MESH_CONF_ELE_CONGEST_CTRL_MODE_ID(_iec) LE_BITS_TO_1BYTE(((u8 *)(_iec)) + 2, 0, 8) +#define GET_MESH_CONF_ELE_SYNC_METHOD_ID(_iec) LE_BITS_TO_1BYTE(((u8 *)(_iec)) + 3, 0, 8) +#define GET_MESH_CONF_ELE_AUTH_PROTO_ID(_iec) LE_BITS_TO_1BYTE(((u8 *)(_iec)) + 4, 0, 8) + +#define GET_MESH_CONF_ELE_MESH_FORMATION(_iec) LE_BITS_TO_1BYTE(((u8 *)(_iec)) + 5, 0, 8) +#define GET_MESH_CONF_ELE_CTO_MGATE(_iec) LE_BITS_TO_1BYTE(((u8 *)(_iec)) + 5, 0, 1) +#define GET_MESH_CONF_ELE_NUM_OF_PEERINGS(_iec) LE_BITS_TO_1BYTE(((u8 *)(_iec)) + 5, 1, 6) +#define GET_MESH_CONF_ELE_CTO_AS(_iec) LE_BITS_TO_1BYTE(((u8 *)(_iec)) + 5, 7, 1) + +#define GET_MESH_CONF_ELE_MESH_CAP(_iec) LE_BITS_TO_1BYTE(((u8 *)(_iec)) + 6, 0, 8) +#define GET_MESH_CONF_ELE_ACCEPT_PEERINGS(_iec) LE_BITS_TO_1BYTE(((u8 *)(_iec)) + 6, 0, 1) +#define GET_MESH_CONF_ELE_MCCA_SUP(_iec) LE_BITS_TO_1BYTE(((u8 *)(_iec)) + 6, 1, 1) +#define GET_MESH_CONF_ELE_MCCA_EN(_iec) LE_BITS_TO_1BYTE(((u8 *)(_iec)) + 6, 2, 1) +#define GET_MESH_CONF_ELE_FORWARDING(_iec) LE_BITS_TO_1BYTE(((u8 *)(_iec)) + 6, 3, 1) +#define GET_MESH_CONF_ELE_MBCA_EN(_iec) LE_BITS_TO_1BYTE(((u8 *)(_iec)) + 6, 4, 1) +#define GET_MESH_CONF_ELE_TBTT_ADJ(_iec) LE_BITS_TO_1BYTE(((u8 *)(_iec)) + 6, 5, 1) +#define GET_MESH_CONF_ELE_PS_LEVEL(_iec) LE_BITS_TO_1BYTE(((u8 *)(_iec)) + 6, 6, 1) + +#define SET_MESH_CONF_ELE_PATH_SEL_PROTO_ID(_iec, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_iec)) + 0, 0, 8, _val) +#define SET_MESH_CONF_ELE_PATH_SEL_METRIC_ID(_iec, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_iec)) + 1, 0, 8, _val) +#define SET_MESH_CONF_ELE_CONGEST_CTRL_MODE_ID(_iec, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_iec)) + 2, 0, 8, _val) +#define SET_MESH_CONF_ELE_SYNC_METHOD_ID(_iec, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_iec)) + 3, 0, 8, _val) +#define SET_MESH_CONF_ELE_AUTH_PROTO_ID(_iec, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_iec)) + 4, 0, 8, _val) + +#define SET_MESH_CONF_ELE_CTO_MGATE(_iec, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_iec)) + 5, 0, 1, _val) +#define SET_MESH_CONF_ELE_NUM_OF_PEERINGS(_iec, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_iec)) + 5, 1, 6, _val) +#define SET_MESH_CONF_ELE_CTO_AS(_iec, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_iec)) + 5, 7, 1, _val) + +#define SET_MESH_CONF_ELE_ACCEPT_PEERINGS(_iec, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_iec)) + 6, 0, 1, _val) +#define SET_MESH_CONF_ELE_MCCA_SUP(_iec, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_iec)) + 6, 1, 1, _val) +#define SET_MESH_CONF_ELE_MCCA_EN(_iec, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_iec)) + 6, 2, 1, _val) +#define SET_MESH_CONF_ELE_FORWARDING(_iec, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_iec)) + 6, 3, 1, _val) +#define SET_MESH_CONF_ELE_MBCA_EN(_iec, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_iec)) + 6, 4, 1, _val) +#define SET_MESH_CONF_ELE_TBTT_ADJ(_iec, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_iec)) + 6, 5, 1, _val) +#define SET_MESH_CONF_ELE_PS_LEVEL(_iec, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_iec)) + 6, 6, 1, _val) + +/* Mesh flags */ +#define MESH_FLAGS_AE 0x3 /* mask */ +#define MESH_FLAGS_AE_A4 0x1 +#define MESH_FLAGS_AE_A5_A6 0x2 + +/* Max number of paths */ +#define RTW_MESH_MAX_PATHS 1024 + +#define RTW_PREQ_Q_F_START 0x1 +#define RTW_PREQ_Q_F_REFRESH 0x2 +#define RTW_PREQ_Q_F_CHK 0x4 +#define RTW_PREQ_Q_F_PEER_AKA 0x8 +#define RTW_PREQ_Q_F_BCAST_PREQ 0x10 /* force path_dicover using broadcast */ +struct rtw_mesh_preq_queue { + _list list; + u8 dst[ETH_ALEN]; + u8 flags; +}; + +extern const u8 ae_to_mesh_ctrl_len[]; + +enum mesh_frame_type { + MESH_UCAST_DATA = 0x0, + MESH_BMCAST_DATA = 0x1, + MESH_UCAST_PX_DATA = 0x2, + MESH_BMCAST_PX_DATA = 0x3, + MESH_MHOP_UCAST_ACT = 0x4, + MESH_MHOP_BMCAST_ACT = 0x5, +}; + +enum mpath_sel_frame_type { + MPATH_PREQ = 0, + MPATH_PREP, + MPATH_PERR, + MPATH_RANN +}; + +/** + * enum rtw_mesh_deferred_task_flags - mesh deferred tasks + * + * + * + * @RTW_MESH_WORK_HOUSEKEEPING: run the periodic mesh housekeeping tasks + * @RTW_MESH_WORK_ROOT: the mesh root station needs to send a frame + * @RTW_MESH_WORK_DRIFT_ADJUST: time to compensate for clock drift relative to other + * mesh nodes + * @RTW_MESH_WORK_MBSS_CHANGED: rebuild beacon and notify driver of BSS changes + */ +enum rtw_mesh_deferred_task_flags { + RTW_MESH_WORK_HOUSEKEEPING, + RTW_MESH_WORK_ROOT, + RTW_MESH_WORK_DRIFT_ADJUST, + RTW_MESH_WORK_MBSS_CHANGED, +}; + +#define RTW_MESH_MAX_PEER_CANDIDATES 15 /* aid consideration */ +#define RTW_MESH_MAX_PEER_LINKS 8 +#define RTW_MESH_PEER_LINK_TIMEOUT 20 + +#define RTW_MESH_PEER_CONF_DISABLED 0 /* special time value means no confirmation ongoing */ +#if CONFIG_RTW_MESH_PEER_BLACKLIST +#define IS_PEER_CONF_DISABLED(plink) ((plink)->peer_conf_end_time == RTW_MESH_PEER_CONF_DISABLED) +#define IS_PEER_CONF_TIMEOUT(plink)(!IS_PEER_CONF_DISABLED(plink) && rtw_time_after(rtw_get_current_time(), (plink)->peer_conf_end_time)) +#define SET_PEER_CONF_DISABLED(plink) (plink)->peer_conf_end_time = RTW_MESH_PEER_CONF_DISABLED +#define SET_PEER_CONF_END_TIME(plink, timeout_ms) \ + do { \ + (plink)->peer_conf_end_time = rtw_get_current_time() + rtw_ms_to_systime(timeout_ms); \ + if ((plink)->peer_conf_end_time == RTW_MESH_PEER_CONF_DISABLED) \ + (plink)->peer_conf_end_time++; \ + } while (0) +#else +#define IS_PEER_CONF_DISABLED(plink) 1 +#define IS_PEER_CONF_TIMEOUT(plink) 0 +#define SET_PEER_CONF_DISABLED(plink) do {} while (0) +#define SET_PEER_CONF_END_TIME(plink, timeout_ms) do {} while (0) +#endif /* CONFIG_RTW_MESH_PEER_BLACKLIST */ + +#define RTW_MESH_CTO_MGATE_CONF_DISABLED 0 /* special time value means no confirmation ongoing */ +#if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST +#define IS_CTO_MGATE_CONF_DISABLED(plink) ((plink)->cto_mgate_conf_end_time == RTW_MESH_CTO_MGATE_CONF_DISABLED) +#define IS_CTO_MGATE_CONF_TIMEOUT(plink)(!IS_CTO_MGATE_CONF_DISABLED(plink) && rtw_time_after(rtw_get_current_time(), (plink)->cto_mgate_conf_end_time)) +#define SET_CTO_MGATE_CONF_DISABLED(plink) (plink)->cto_mgate_conf_end_time = RTW_MESH_CTO_MGATE_CONF_DISABLED +#define SET_CTO_MGATE_CONF_END_TIME(plink, timeout_ms) \ + do { \ + (plink)->cto_mgate_conf_end_time = rtw_get_current_time() + rtw_ms_to_systime(timeout_ms); \ + if ((plink)->cto_mgate_conf_end_time == RTW_MESH_CTO_MGATE_CONF_DISABLED) \ + (plink)->cto_mgate_conf_end_time++; \ + } while (0) +#else +#define IS_CTO_MGATE_CONF_DISABLED(plink) 1 +#define IS_CTO_MGATE_CONF_TIMEOUT(plink) 0 +#define SET_CTO_MGATE_CONF_DISABLED(plink) do {} while (0) +#define SET_CTO_MGATE_CONF_END_TIME(plink, timeout_ms) do {} while (0) +#endif /* CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST */ + +struct mesh_plink_ent { + u8 valid; + u8 addr[ETH_ALEN]; + u8 plink_state; + +#ifdef CONFIG_RTW_MESH_AEK + u8 aek_valid; + u8 aek[32]; +#endif + + u16 llid; + u16 plid; +#ifndef CONFIG_RTW_MESH_DRIVER_AID + u16 aid; /* aid assigned from upper layer */ +#endif + u16 peer_aid; /* aid assigned from peer */ + + u8 chosen_pmk[16]; + +#ifdef CONFIG_RTW_MESH_AEK + u8 sel_pcs[4]; + u8 l_nonce[32]; + u8 p_nonce[32]; +#endif + +#ifdef CONFIG_RTW_MESH_DRIVER_AID + u8 *tx_conf_ies; + u16 tx_conf_ies_len; +#endif + u8 *rx_conf_ies; + u16 rx_conf_ies_len; + + struct wlan_network *scanned; + +#if CONFIG_RTW_MESH_PEER_BLACKLIST + systime peer_conf_end_time; +#endif +#if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST + systime cto_mgate_conf_end_time; +#endif +}; + +#ifdef CONFIG_RTW_MESH_AEK +#define MESH_PLINK_AEK_VALID(ent) ent->aek_valid +#else +#define MESH_PLINK_AEK_VALID(ent) 0 +#endif + +struct mesh_plink_pool { + _lock lock; + u8 num; /* current ent being used */ + struct mesh_plink_ent ent[RTW_MESH_MAX_PEER_CANDIDATES]; + +#if CONFIG_RTW_MESH_ACNODE_PREVENT + u8 acnode_rsvd; +#endif + +#if CONFIG_RTW_MESH_PEER_BLACKLIST + _queue peer_blacklist; +#endif +#if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST + _queue cto_mgate_blacklist; +#endif +}; + +struct mesh_peer_sel_policy { + u32 scanr_exp_ms; + +#if CONFIG_RTW_MESH_ACNODE_PREVENT + u8 acnode_prevent; + u32 acnode_conf_timeout_ms; + u32 acnode_notify_timeout_ms; +#endif + +#if CONFIG_RTW_MESH_OFFCH_CAND + u8 offch_cand; + u32 offch_find_int_ms; /* 0 means no offch find triggerred by driver self*/ +#endif + +#if CONFIG_RTW_MESH_PEER_BLACKLIST + u32 peer_conf_timeout_ms; + u32 peer_blacklist_timeout_ms; +#endif + +#if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST + u8 cto_mgate_require; + u32 cto_mgate_conf_timeout_ms; + u32 cto_mgate_blacklist_timeout_ms; +#endif +}; + +/* b2u flags */ +#define RTW_MESH_B2U_ALL BIT0 +#define RTW_MESH_B2U_GA_UCAST BIT1 /* Group addressed unicast frame, forward only */ +#define RTW_MESH_B2U_BCAST BIT2 +#define RTW_MESH_B2U_IP_MCAST BIT3 + +#define rtw_msrc_b2u_policy_chk(flags, mda) ( \ + (flags & RTW_MESH_B2U_ALL) \ + || ((flags & RTW_MESH_B2U_BCAST) && is_broadcast_mac_addr(mda)) \ + || ((flags & RTW_MESH_B2U_IP_MCAST) && (IP_MCAST_MAC(mda) || ICMPV6_MCAST_MAC(mda))) \ + ) + +#define rtw_mfwd_b2u_policy_chk(flags, mda, ucst) ( \ + (flags & RTW_MESH_B2U_ALL) \ + || ((flags & RTW_MESH_B2U_GA_UCAST) && ucst) \ + || ((flags & RTW_MESH_B2U_BCAST) && is_broadcast_mac_addr(mda)) \ + || ((flags & RTW_MESH_B2U_IP_MCAST) && (IP_MCAST_MAC(mda) || ICMPV6_MCAST_MAC(mda))) \ + ) + +/** + * @sane_metric_delta: Controlling if trigger additional path check mechanism + * @max_root_add_chk_cnt: The retry cnt to send additional root confirmation + * PREQ through old(last) path + */ +struct rtw_mesh_cfg { + u8 max_peer_links; /* peering limit */ + u32 plink_timeout; /* seconds */ + + u8 dot11MeshTTL; + u8 element_ttl; + u32 path_refresh_time; + u16 dot11MeshHWMPpreqMinInterval; + u16 dot11MeshHWMPnetDiameterTraversalTime; + u32 dot11MeshHWMPactivePathTimeout; + u8 dot11MeshHWMPmaxPREQretries; + u16 min_discovery_timeout; + u16 dot11MeshHWMPconfirmationInterval; + u16 dot11MeshHWMPperrMinInterval; + u8 dot11MeshHWMPRootMode; + BOOLEAN dot11MeshForwarding; + s32 rssi_threshold; /* in dBm, 0: no specified */ + u16 dot11MeshHWMPRannInterval; + BOOLEAN dot11MeshGateAnnouncementProtocol; + u32 dot11MeshHWMPactivePathToRootTimeout; + u16 dot11MeshHWMProotInterval; + u8 path_gate_timeout_factor; +#ifdef CONFIG_RTW_MESH_ADD_ROOT_CHK + u16 sane_metric_delta; + u8 max_root_add_chk_cnt; +#endif + + struct mesh_peer_sel_policy peer_sel_policy; + +#if CONFIG_RTW_MESH_DATA_BMC_TO_UC + u8 b2u_flags_msrc; + u8 b2u_flags_mfwd; +#endif +}; + +struct rtw_mesh_stats { + u32 fwded_mcast; /* Mesh forwarded multicast frames */ + u32 fwded_unicast; /* Mesh forwarded unicast frames */ + u32 fwded_frames; /* Mesh total forwarded frames */ + u32 dropped_frames_ttl; /* Not transmitted since mesh_ttl == 0*/ + u32 dropped_frames_no_route; /* Not transmitted, no route found */ + u32 dropped_frames_congestion;/* Not forwarded due to congestion */ + u32 dropped_frames_duplicate; + + u32 mrc_del_qlen; /* MRC entry deleted cause by queue length limit */ +}; + +struct rtw_mrc; + +struct rtw_mesh_info { + u8 mesh_id[NDIS_802_11_LENGTH_SSID]; + size_t mesh_id_len; + /* Active Path Selection Protocol Identifier */ + u8 mesh_pp_id; + /* Active Path Selection Metric Identifier */ + u8 mesh_pm_id; + /* Congestion Control Mode Identifier */ + u8 mesh_cc_id; + /* Synchronization Protocol Identifier */ + u8 mesh_sp_id; + /* Authentication Protocol Identifier */ + u8 mesh_auth_id; + + struct mesh_plink_pool plink_ctl; + + u32 mesh_seqnum; + /* MSTA's own hwmp sequence number */ + u32 sn; + systime last_preq; + systime last_sn_update; + systime next_perr; + /* Last used Path Discovery ID */ + u32 preq_id; + + ATOMIC_T mpaths; + struct rtw_mesh_table *mesh_paths; + struct rtw_mesh_table *mpp_paths; + int mesh_paths_generation; + int mpp_paths_generation; + + int num_gates; + struct rtw_mesh_path *max_addr_gate; + bool max_addr_gate_is_larger_than_self; + + struct rtw_mesh_stats mshstats; + + _queue mpath_tx_queue; + u32 mpath_tx_queue_len; + _tasklet mpath_tx_tasklet; + + struct rtw_mrc *mrc; + + _lock mesh_preq_queue_lock; + struct rtw_mesh_preq_queue preq_queue; + int preq_queue_len; +}; + +extern const char *_action_self_protected_str[]; +#define action_self_protected_str(action) ((action < RTW_ACT_SELF_PROTECTED_NUM) ? _action_self_protected_str[action] : _action_self_protected_str[0]) + +u8 *rtw_set_ie_mesh_id(u8 *buf, u32 *buf_len, const char *mesh_id, u8 id_len); +u8 *rtw_set_ie_mesh_config(u8 *buf, u32 *buf_len + , u8 path_sel_proto, u8 path_sel_metric, u8 congest_ctl_mode, u8 sync_method, u8 auth_proto + , u8 num_of_peerings, bool cto_mgate, bool cto_as + , bool accept_peerings, bool mcca_sup, bool mcca_en, bool forwarding + , bool mbca_en, bool tbtt_adj, bool ps_level); + +int rtw_bss_is_same_mbss(WLAN_BSSID_EX *a, WLAN_BSSID_EX *b); +int rtw_bss_is_candidate_mesh_peer(WLAN_BSSID_EX *self, WLAN_BSSID_EX *target, u8 ch, u8 add_peer); + +void rtw_chk_candidate_peer_notify(_adapter *adapter, struct wlan_network *scanned); + +void rtw_mesh_peer_status_chk(_adapter *adapter); + +#if CONFIG_RTW_MESH_ACNODE_PREVENT +void rtw_mesh_update_scanned_acnode_status(_adapter *adapter, struct wlan_network *scanned); +bool rtw_mesh_scanned_is_acnode_confirmed(_adapter *adapter, struct wlan_network *scanned); +bool rtw_mesh_acnode_prevent_allow_sacrifice(_adapter *adapter); +struct sta_info *rtw_mesh_acnode_prevent_pick_sacrifice(_adapter *adapter); +void dump_mesh_acnode_prevent_settings(void *sel, _adapter *adapter); +#endif + +#if CONFIG_RTW_MESH_OFFCH_CAND +u8 rtw_mesh_offch_candidate_accepted(_adapter *adapter); +u8 rtw_mesh_select_operating_ch(_adapter *adapter); +void dump_mesh_offch_cand_settings(void *sel, _adapter *adapter); +#endif + +#if CONFIG_RTW_MESH_PEER_BLACKLIST +int rtw_mesh_peer_blacklist_add(_adapter *adapter, const u8 *addr); +int rtw_mesh_peer_blacklist_del(_adapter *adapter, const u8 *addr); +int rtw_mesh_peer_blacklist_search(_adapter *adapter, const u8 *addr); +void rtw_mesh_peer_blacklist_flush(_adapter *adapter); +void dump_mesh_peer_blacklist(void *sel, _adapter *adapter); +void dump_mesh_peer_blacklist_settings(void *sel, _adapter *adapter); +#endif +#if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST +u8 rtw_mesh_cto_mgate_required(_adapter *adapter); +u8 rtw_mesh_cto_mgate_network_filter(_adapter *adapter, struct wlan_network *scanned); +int rtw_mesh_cto_mgate_blacklist_add(_adapter *adapter, const u8 *addr); +int rtw_mesh_cto_mgate_blacklist_del(_adapter *adapter, const u8 *addr); +int rtw_mesh_cto_mgate_blacklist_search(_adapter *adapter, const u8 *addr); +void rtw_mesh_cto_mgate_blacklist_flush(_adapter *adapter); +void dump_mesh_cto_mgate_blacklist(void *sel, _adapter *adapter); +void dump_mesh_cto_mgate_blacklist_settings(void *sel, _adapter *adapter); +#endif +void dump_mesh_peer_sel_policy(void *sel, _adapter *adapter); +void dump_mesh_networks(void *sel, _adapter *adapter); + +void rtw_mesh_adjust_chbw(u8 req_ch, u8 *req_bw, u8 *req_offset); + +void rtw_mesh_sae_check_frames(_adapter *adapter, const u8 *buf, u32 len, u8 tx, u16 alg, u16 seq, u16 status); +int rtw_mesh_check_frames_tx(_adapter *adapter, const u8 **buf, size_t *len); +int rtw_mesh_check_frames_rx(_adapter *adapter, const u8 *buf, size_t len); + +int rtw_mesh_on_auth(_adapter *adapter, union recv_frame *rframe); +unsigned int on_action_self_protected(_adapter *adapter, union recv_frame *rframe); + +bool rtw_mesh_update_bss_peering_status(_adapter *adapter, WLAN_BSSID_EX *bss); +bool rtw_mesh_update_bss_formation_info(_adapter *adapter, WLAN_BSSID_EX *bss); +bool rtw_mesh_update_bss_forwarding_state(_adapter *adapter, WLAN_BSSID_EX *bss); + +struct mesh_plink_ent *_rtw_mesh_plink_get(_adapter *adapter, const u8 *hwaddr); +struct mesh_plink_ent *rtw_mesh_plink_get(_adapter *adapter, const u8 *hwaddr); +struct mesh_plink_ent *rtw_mesh_plink_get_no_estab_by_idx(_adapter *adapter, u8 idx); +int _rtw_mesh_plink_add(_adapter *adapter, const u8 *hwaddr); +int rtw_mesh_plink_add(_adapter *adapter, const u8 *hwaddr); +int rtw_mesh_plink_set_state(_adapter *adapter, const u8 *hwaddr, u8 state); +#ifdef CONFIG_RTW_MESH_AEK +int rtw_mesh_plink_set_aek(_adapter *adapter, const u8 *hwaddr, const u8 *aek); +#endif +#if CONFIG_RTW_MESH_PEER_BLACKLIST +int rtw_mesh_plink_set_peer_conf_timeout(_adapter *adapter, const u8 *hwaddr); +#endif +void _rtw_mesh_plink_del_ent(_adapter *adapter, struct mesh_plink_ent *ent); +int rtw_mesh_plink_del(_adapter *adapter, const u8 *hwaddr); +void rtw_mesh_plink_ctl_init(_adapter *adapter); +void rtw_mesh_plink_ctl_deinit(_adapter *adapter); +void dump_mesh_plink_ctl(void *sel, _adapter *adapter); + +int rtw_mesh_peer_establish(_adapter *adapter, struct mesh_plink_ent *plink, struct sta_info *sta); +void _rtw_mesh_expire_peer_ent(_adapter *adapter, struct mesh_plink_ent *plink); +void rtw_mesh_expire_peer(_adapter *adapter, const u8 *peer_addr); +u8 rtw_mesh_ps_annc(_adapter *adapter, u8 ps); + +unsigned int on_action_mesh(_adapter *adapter, union recv_frame *rframe); + +void rtw_mesh_cfg_init(_adapter *adapter); +void rtw_mesh_cfg_init_max_peer_links(_adapter *adapter, u8 stack_conf); +void rtw_mesh_cfg_init_plink_timeout(_adapter *adapter, u32 stack_conf); +void rtw_mesh_init_mesh_info(_adapter *adapter); +void rtw_mesh_deinit_mesh_info(_adapter *adapter); + +#if CONFIG_RTW_MESH_DATA_BMC_TO_UC +void dump_mesh_b2u_flags(void *sel, _adapter *adapter); +#endif + +int rtw_mesh_addr_resolve(_adapter *adapter, struct xmit_frame *xframe, _pkt *pkt, _list *b2u_list); + +s8 rtw_mesh_tx_set_whdr_mctrl_len(u8 mesh_frame_mode, struct pkt_attrib *attrib); +void rtw_mesh_tx_build_mctrl(_adapter *adapter, struct pkt_attrib *attrib, u8 *buf); +u8 rtw_mesh_tx_build_whdr(_adapter *adapter, struct pkt_attrib *attrib + , u16 *fctrl, struct rtw_ieee80211_hdr *whdr); + +int rtw_mesh_rx_data_validate_hdr(_adapter *adapter, union recv_frame *rframe, struct sta_info **sta); +int rtw_mesh_rx_data_validate_mctrl(_adapter *adapter, union recv_frame *rframe + , const struct rtw_ieee80211s_hdr *mctrl, const u8 *mda, const u8 *msa + , u8 *mctrl_len, const u8 **da, const u8 **sa); +int rtw_mesh_rx_validate_mctrl_non_amsdu(_adapter *adapter, union recv_frame *rframe); + +int rtw_mesh_rx_msdu_act_check(union recv_frame *rframe + , const u8 *mda, const u8 *msa + , const u8 *da, const u8 *sa + , struct rtw_ieee80211s_hdr *mctrl + , struct xmit_frame **fwd_frame, _list *b2u_list); + +void dump_mesh_stats(void *sel, _adapter *adapter); + +#if defined(PLATFORM_LINUX) && (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 32)) +#define rtw_lockdep_assert_held(l) lockdep_assert_held(l) +#define rtw_lockdep_is_held(l) lockdep_is_held(l) +#else +#error "TBD\n" +#endif + +#include "rtw_mesh_pathtbl.h" +#include "rtw_mesh_hwmp.h" +#endif /* __RTW_MESH_H_ */ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/mesh/rtw_mesh_hwmp.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/mesh/rtw_mesh_hwmp.c new file mode 100644 index 000000000000..ab7694ac9034 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/mesh/rtw_mesh_hwmp.c @@ -0,0 +1,1675 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + *****************************************************************************/ +#define _RTW_HWMP_C_ + +#ifdef CONFIG_RTW_MESH +#include +#include + +#define RTW_TEST_FRAME_LEN 8192 +#define RTW_MAX_METRIC 0xffffffff +#define RTW_ARITH_SHIFT 8 +#define RTW_LINK_FAIL_THRESH 95 +#define RTW_MAX_PREQ_QUEUE_LEN 64 +#define RTW_ATLM_REQ_CYCLE 1000 + +#define rtw_ilog2(n) \ +( \ + (n) < 2 ? 0 : \ + (n) & (1ULL << 63) ? 63 : \ + (n) & (1ULL << 62) ? 62 : \ + (n) & (1ULL << 61) ? 61 : \ + (n) & (1ULL << 60) ? 60 : \ + (n) & (1ULL << 59) ? 59 : \ + (n) & (1ULL << 58) ? 58 : \ + (n) & (1ULL << 57) ? 57 : \ + (n) & (1ULL << 56) ? 56 : \ + (n) & (1ULL << 55) ? 55 : \ + (n) & (1ULL << 54) ? 54 : \ + (n) & (1ULL << 53) ? 53 : \ + (n) & (1ULL << 52) ? 52 : \ + (n) & (1ULL << 51) ? 51 : \ + (n) & (1ULL << 50) ? 50 : \ + (n) & (1ULL << 49) ? 49 : \ + (n) & (1ULL << 48) ? 48 : \ + (n) & (1ULL << 47) ? 47 : \ + (n) & (1ULL << 46) ? 46 : \ + (n) & (1ULL << 45) ? 45 : \ + (n) & (1ULL << 44) ? 44 : \ + (n) & (1ULL << 43) ? 43 : \ + (n) & (1ULL << 42) ? 42 : \ + (n) & (1ULL << 41) ? 41 : \ + (n) & (1ULL << 40) ? 40 : \ + (n) & (1ULL << 39) ? 39 : \ + (n) & (1ULL << 38) ? 38 : \ + (n) & (1ULL << 37) ? 37 : \ + (n) & (1ULL << 36) ? 36 : \ + (n) & (1ULL << 35) ? 35 : \ + (n) & (1ULL << 34) ? 34 : \ + (n) & (1ULL << 33) ? 33 : \ + (n) & (1ULL << 32) ? 32 : \ + (n) & (1ULL << 31) ? 31 : \ + (n) & (1ULL << 30) ? 30 : \ + (n) & (1ULL << 29) ? 29 : \ + (n) & (1ULL << 28) ? 28 : \ + (n) & (1ULL << 27) ? 27 : \ + (n) & (1ULL << 26) ? 26 : \ + (n) & (1ULL << 25) ? 25 : \ + (n) & (1ULL << 24) ? 24 : \ + (n) & (1ULL << 23) ? 23 : \ + (n) & (1ULL << 22) ? 22 : \ + (n) & (1ULL << 21) ? 21 : \ + (n) & (1ULL << 20) ? 20 : \ + (n) & (1ULL << 19) ? 19 : \ + (n) & (1ULL << 18) ? 18 : \ + (n) & (1ULL << 17) ? 17 : \ + (n) & (1ULL << 16) ? 16 : \ + (n) & (1ULL << 15) ? 15 : \ + (n) & (1ULL << 14) ? 14 : \ + (n) & (1ULL << 13) ? 13 : \ + (n) & (1ULL << 12) ? 12 : \ + (n) & (1ULL << 11) ? 11 : \ + (n) & (1ULL << 10) ? 10 : \ + (n) & (1ULL << 9) ? 9 : \ + (n) & (1ULL << 8) ? 8 : \ + (n) & (1ULL << 7) ? 7 : \ + (n) & (1ULL << 6) ? 6 : \ + (n) & (1ULL << 5) ? 5 : \ + (n) & (1ULL << 4) ? 4 : \ + (n) & (1ULL << 3) ? 3 : \ + (n) & (1ULL << 2) ? 2 : \ + 1 \ +) + +enum rtw_mpath_frame_type { + RTW_MPATH_PREQ = 0, + RTW_MPATH_PREP, + RTW_MPATH_PERR, + RTW_MPATH_RANN +}; + +static inline u32 rtw_u32_field_get(const u8 *preq_elem, int shift, BOOLEAN ae) +{ + if (ae) + shift += 6; + return LE_BITS_TO_4BYTE(preq_elem + shift, 0, 32); +} + +static inline u16 rtw_u16_field_get(const u8 *preq_elem, int shift, BOOLEAN ae) +{ + if (ae) + shift += 6; + return LE_BITS_TO_2BYTE(preq_elem + shift, 0, 16); +} + +/* HWMP IE processing macros */ +#define RTW_AE_F (1<<6) +#define RTW_AE_F_SET(x) (*x & RTW_AE_F) +#define RTW_PREQ_IE_FLAGS(x) (*(x)) +#define RTW_PREQ_IE_HOPCOUNT(x) (*(x + 1)) +#define RTW_PREQ_IE_TTL(x) (*(x + 2)) +#define RTW_PREQ_IE_PREQ_ID(x) rtw_u32_field_get(x, 3, 0) +#define RTW_PREQ_IE_ORIG_ADDR(x) (x + 7) +#define RTW_PREQ_IE_ORIG_SN(x) rtw_u32_field_get(x, 13, 0) +#define RTW_PREQ_IE_LIFETIME(x) rtw_u32_field_get(x, 17, RTW_AE_F_SET(x)) +#define RTW_PREQ_IE_METRIC(x) rtw_u32_field_get(x, 21, RTW_AE_F_SET(x)) +#define RTW_PREQ_IE_TARGET_F(x) (*(RTW_AE_F_SET(x) ? x + 32 : x + 26)) +#define RTW_PREQ_IE_TARGET_ADDR(x) (RTW_AE_F_SET(x) ? x + 33 : x + 27) +#define RTW_PREQ_IE_TARGET_SN(x) rtw_u32_field_get(x, 33, RTW_AE_F_SET(x)) + +#define RTW_PREP_IE_FLAGS(x) RTW_PREQ_IE_FLAGS(x) +#define RTW_PREP_IE_HOPCOUNT(x) RTW_PREQ_IE_HOPCOUNT(x) +#define RTW_PREP_IE_TTL(x) RTW_PREQ_IE_TTL(x) +#define RTW_PREP_IE_ORIG_ADDR(x) (RTW_AE_F_SET(x) ? x + 27 : x + 21) +#define RTW_PREP_IE_ORIG_SN(x) rtw_u32_field_get(x, 27, RTW_AE_F_SET(x)) +#define RTW_PREP_IE_LIFETIME(x) rtw_u32_field_get(x, 13, RTW_AE_F_SET(x)) +#define RTW_PREP_IE_METRIC(x) rtw_u32_field_get(x, 17, RTW_AE_F_SET(x)) +#define RTW_PREP_IE_TARGET_ADDR(x) (x + 3) +#define RTW_PREP_IE_TARGET_SN(x) rtw_u32_field_get(x, 9, 0) + +#define RTW_PERR_IE_TTL(x) (*(x)) +#define RTW_PERR_IE_TARGET_FLAGS(x) (*(x + 2)) +#define RTW_PERR_IE_TARGET_ADDR(x) (x + 3) +#define RTW_PERR_IE_TARGET_SN(x) rtw_u32_field_get(x, 9, 0) +#define RTW_PERR_IE_TARGET_RCODE(x) rtw_u16_field_get(x, 13, 0) + +#define RTW_TU_TO_SYSTIME(x) (rtw_us_to_systime((x) * 1024)) +#define RTW_TU_TO_EXP_TIME(x) (rtw_get_current_time() + RTW_TU_TO_SYSTIME(x)) +#define RTW_MSEC_TO_TU(x) (x*1000/1024) +#define RTW_SN_GT(x, y) ((s32)(y - x) < 0) +#define RTW_SN_LT(x, y) ((s32)(x - y) < 0) +#define RTW_MAX_SANE_SN_DELTA 32 + +static inline u32 RTW_SN_DELTA(u32 x, u32 y) +{ + return x >= y ? x - y : y - x; +} + +#define rtw_net_traversal_jiffies(adapter) \ + rtw_ms_to_systime(adapter->mesh_cfg.dot11MeshHWMPnetDiameterTraversalTime) +#define rtw_default_lifetime(adapter) \ + RTW_MSEC_TO_TU(adapter->mesh_cfg.dot11MeshHWMPactivePathTimeout) +#define rtw_min_preq_int_jiff(adapter) \ + (rtw_ms_to_systime(adapter->mesh_cfg.dot11MeshHWMPpreqMinInterval)) +#define rtw_max_preq_retries(adapter) (adapter->mesh_cfg.dot11MeshHWMPmaxPREQretries) +#define rtw_disc_timeout_jiff(adapter) \ + rtw_ms_to_systime(adapter->mesh_cfg.min_discovery_timeout) +#define rtw_root_path_confirmation_jiffies(adapter) \ + rtw_ms_to_systime(adapter->mesh_cfg.dot11MeshHWMPconfirmationInterval) + +static inline BOOLEAN rtw_ether_addr_equal(const u8 *addr1, const u8 *addr2) +{ + return _rtw_memcmp(addr1, addr2, ETH_ALEN); +} + +#ifdef PLATFORM_LINUX +#define rtw_print_ratelimit() printk_ratelimit() +#define rtw_mod_timer(ptimer, expires) mod_timer(&(ptimer)->timer, expires) +#else + +#endif + +#define RTW_MESH_EWMA_PRECISION 20 +#define RTW_MESH_EWMA_WEIGHT_RCP 8 +#define RTW_TOTAL_PKT_MIN_THRESHOLD 1 +inline void rtw_ewma_err_rate_init(struct rtw_ewma_err_rate *e) +{ + e->internal = 0; +} +inline unsigned long rtw_ewma_err_rate_read(struct rtw_ewma_err_rate *e) +{ + return e->internal >> (RTW_MESH_EWMA_PRECISION); +} +inline void rtw_ewma_err_rate_add(struct rtw_ewma_err_rate *e, + unsigned long val) +{ + unsigned long internal = e->internal; + unsigned long weight_rcp = rtw_ilog2(RTW_MESH_EWMA_WEIGHT_RCP); + unsigned long precision = RTW_MESH_EWMA_PRECISION; + + (e->internal) = internal ? (((internal << weight_rcp) - internal) + + (val << precision)) >> weight_rcp : + (val << precision); +} + +static const u8 bcast_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; + +static int rtw_mesh_path_sel_frame_tx(enum rtw_mpath_frame_type mpath_action, u8 flags, + const u8 *originator_addr, u32 originator_sn, + u8 target_flags, const u8 *target, + u32 target_sn, const u8 *da, u8 hopcount, u8 ttl, + u32 lifetime, u32 metric, u32 preq_id, + _adapter *adapter) +{ + struct xmit_priv *pxmitpriv = &(adapter->xmitpriv); + struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); + struct xmit_frame *pmgntframe = NULL; + struct rtw_ieee80211_hdr *pwlanhdr = NULL; + struct pkt_attrib *pattrib = NULL; + u8 category = RTW_WLAN_CATEGORY_MESH; + u8 action = RTW_ACT_MESH_HWMP_PATH_SELECTION; + u16 *fctrl = NULL; + u8 *pos, ie_len; + + + pmgntframe = alloc_mgtxmitframe(pxmitpriv); + if (pmgntframe == NULL) + return -1; + + pattrib = &pmgntframe->attrib; + update_mgntframe_attrib(adapter, pattrib); + _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); + + pos = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; + pwlanhdr = (struct rtw_ieee80211_hdr *)pos; + + + fctrl = &(pwlanhdr->frame_ctl); + *(fctrl) = 0; + + _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(adapter), ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(adapter), ETH_ALEN); + + SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); + pmlmeext->mgnt_seq++; + set_frame_sub_type(pos, WIFI_ACTION); + + pos += sizeof(struct rtw_ieee80211_hdr_3addr); + pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); + + pos = rtw_set_fixed_ie(pos, 1, &(category), &(pattrib->pktlen)); + pos = rtw_set_fixed_ie(pos, 1, &(action), &(pattrib->pktlen)); + + switch (mpath_action) { + case RTW_MPATH_PREQ: + RTW_HWMP_DBG("sending PREQ to "MAC_FMT"\n", MAC_ARG(target)); + ie_len = 37; + pattrib->pktlen += (ie_len + 2); + *pos++ = WLAN_EID_PREQ; + break; + case RTW_MPATH_PREP: + RTW_HWMP_DBG("sending PREP to "MAC_FMT"\n", MAC_ARG(originator_addr)); + ie_len = 31; + pattrib->pktlen += (ie_len + 2); + *pos++ = WLAN_EID_PREP; + break; + case RTW_MPATH_RANN: + RTW_HWMP_DBG("sending RANN from "MAC_FMT"\n", MAC_ARG(originator_addr)); + ie_len = sizeof(struct rtw_ieee80211_rann_ie); + pattrib->pktlen += (ie_len + 2); + *pos++ = WLAN_EID_RANN; + break; + default: + rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); + rtw_free_xmitframe(pxmitpriv, pmgntframe); + return _FAIL; + } + *pos++ = ie_len; + *pos++ = flags; + *pos++ = hopcount; + *pos++ = ttl; + if (mpath_action == RTW_MPATH_PREP) { + _rtw_memcpy(pos, target, ETH_ALEN); + pos += ETH_ALEN; + *(u32 *)pos = cpu_to_le32(target_sn); + pos += 4; + } else { + if (mpath_action == RTW_MPATH_PREQ) { + *(u32 *)pos = cpu_to_le32(preq_id); + pos += 4; + } + _rtw_memcpy(pos, originator_addr, ETH_ALEN); + pos += ETH_ALEN; + *(u32 *)pos = cpu_to_le32(originator_sn); + pos += 4; + } + *(u32 *)pos = cpu_to_le32(lifetime); + pos += 4; + *(u32 *)pos = cpu_to_le32(metric); + pos += 4; + if (mpath_action == RTW_MPATH_PREQ) { + *pos++ = 1; /* support only 1 destination now */ + *pos++ = target_flags; + _rtw_memcpy(pos, target, ETH_ALEN); + pos += ETH_ALEN; + *(u32 *)pos = cpu_to_le32(target_sn); + pos += 4; + } else if (mpath_action == RTW_MPATH_PREP) { + _rtw_memcpy(pos, originator_addr, ETH_ALEN); + pos += ETH_ALEN; + *(u32 *)pos = cpu_to_le32(originator_sn); + pos += 4; + } + + pattrib->last_txcmdsz = pattrib->pktlen; + dump_mgntframe(adapter, pmgntframe); + return 0; +} + +int rtw_mesh_path_error_tx(_adapter *adapter, + u8 ttl, const u8 *target, u32 target_sn, + u16 perr_reason_code, const u8 *ra) +{ + + struct xmit_priv *pxmitpriv = &(adapter->xmitpriv); + struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); + struct xmit_frame *pmgntframe = NULL; + struct rtw_ieee80211_hdr *pwlanhdr = NULL; + struct pkt_attrib *pattrib = NULL; + struct rtw_mesh_info *minfo = &adapter->mesh_info; + u8 category = RTW_WLAN_CATEGORY_MESH; + u8 action = RTW_ACT_MESH_HWMP_PATH_SELECTION; + u8 *pos, ie_len; + u16 *fctrl = NULL; + + if (rtw_time_before(rtw_get_current_time(), minfo->next_perr)) + return -1; + + pmgntframe = alloc_mgtxmitframe(pxmitpriv); + if (pmgntframe == NULL) + return -1; + + pattrib = &pmgntframe->attrib; + update_mgntframe_attrib(adapter, pattrib); + _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); + + pos = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; + pwlanhdr = (struct rtw_ieee80211_hdr *)pos; + + fctrl = &(pwlanhdr->frame_ctl); + *(fctrl) = 0; + + _rtw_memcpy(pwlanhdr->addr1, ra, ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(adapter), ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(adapter), ETH_ALEN); + + SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); + pmlmeext->mgnt_seq++; + set_frame_sub_type(pos, WIFI_ACTION); + + pos += sizeof(struct rtw_ieee80211_hdr_3addr); + pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); + + pos = rtw_set_fixed_ie(pos, 1, &(category), &(pattrib->pktlen)); + pos = rtw_set_fixed_ie(pos, 1, &(action), &(pattrib->pktlen)); + + ie_len = 15; + pattrib->pktlen += (2 + ie_len); + *pos++ = WLAN_EID_PERR; + *pos++ = ie_len; + /* ttl */ + *pos++ = ttl; + /* The Number of Destinations N */ + *pos++ = 1; + /* Flags format | B7 | B6 | B5:B0 | = | rsvd | AE | rsvd | */ + *pos = 0; + pos++; + _rtw_memcpy(pos, target, ETH_ALEN); + pos += ETH_ALEN; + *(u32 *)pos = cpu_to_le32(target_sn); + pos += 4; + *(u16 *)pos = cpu_to_le16(perr_reason_code); + + adapter->mesh_info.next_perr = RTW_TU_TO_EXP_TIME( + adapter->mesh_cfg.dot11MeshHWMPperrMinInterval); + pattrib->last_txcmdsz = pattrib->pktlen; + /* Send directly. Rewrite it if deferred tx is needed */ + dump_mgntframe(adapter, pmgntframe); + + RTW_HWMP_DBG("TX PERR toward "MAC_FMT", ra = "MAC_FMT"\n", MAC_ARG(target), MAC_ARG(ra)); + + return 0; +} + +static u32 rtw_get_vht_bitrate(u8 mcs, u8 bw, u8 nss, u8 sgi) +{ + static const u32 base[4][10] = { + { 6500000, + 13000000, + 19500000, + 26000000, + 39000000, + 52000000, + 58500000, + 65000000, + 78000000, + /* not in the spec, but some devices use this: */ + 86500000, + }, + { 13500000, + 27000000, + 40500000, + 54000000, + 81000000, + 108000000, + 121500000, + 135000000, + 162000000, + 180000000, + }, + { 29300000, + 58500000, + 87800000, + 117000000, + 175500000, + 234000000, + 263300000, + 292500000, + 351000000, + 390000000, + }, + { 58500000, + 117000000, + 175500000, + 234000000, + 351000000, + 468000000, + 526500000, + 585000000, + 702000000, + 780000000, + }, + }; + u32 bitrate; + int bw_idx; + + if (mcs > 9) { + RTW_HWMP_INFO("Invalid mcs = %d\n", mcs); + return 0; + } + + if (nss > 4 || nss < 1) { + RTW_HWMP_INFO("Now only support nss = 1, 2, 3, 4\n"); + } + + switch (bw) { + case CHANNEL_WIDTH_160: + bw_idx = 3; + break; + case CHANNEL_WIDTH_80: + bw_idx = 2; + break; + case CHANNEL_WIDTH_40: + bw_idx = 1; + break; + case CHANNEL_WIDTH_20: + bw_idx = 0; + break; + default: + RTW_HWMP_INFO("bw = %d currently not supported\n", bw); + return 0; + } + + bitrate = base[bw_idx][mcs]; + bitrate *= nss; + + if (sgi) + bitrate = (bitrate / 9) * 10; + + /* do NOT round down here */ + return (bitrate + 50000) / 100000; +} + +static u32 rtw_get_ht_bitrate(u8 mcs, u8 bw, u8 sgi) +{ + int modulation, streams, bitrate; + + /* the formula below does only work for MCS values smaller than 32 */ + if (mcs >= 32) { + RTW_HWMP_INFO("Invalid mcs = %d\n", mcs); + return 0; + } + + if (bw > 1) { + RTW_HWMP_INFO("Now HT only support bw = 0(20Mhz), 1(40Mhz)\n"); + return 0; + } + + modulation = mcs & 7; + streams = (mcs >> 3) + 1; + + bitrate = (bw == 1) ? 13500000 : 6500000; + + if (modulation < 4) + bitrate *= (modulation + 1); + else if (modulation == 4) + bitrate *= (modulation + 2); + else + bitrate *= (modulation + 3); + + bitrate *= streams; + + if (sgi) + bitrate = (bitrate / 9) * 10; + + /* do NOT round down here */ + return (bitrate + 50000) / 100000; +} + +/** + * @bw: 0(20Mhz), 1(40Mhz), 2(80Mhz), 3(160Mhz) + * @rate_idx: DESC_RATEXXXX & 0x7f + * @sgi: DESC_RATEXXXX >> 7 + * Returns: bitrate in 100kbps + */ +static u32 rtw_desc_rate_to_bitrate(u8 bw, u8 rate_idx, u8 sgi) +{ + u32 bitrate; + + if (rate_idx <= DESC_RATE54M){ + u16 ofdm_rate[12] = {10, 20, 55, 110, + 60, 90, 120, 180, 240, 360, 480, 540}; + bitrate = ofdm_rate[rate_idx]; + } else if ((DESC_RATEMCS0 <= rate_idx) && + (rate_idx <= DESC_RATEMCS31)) { + u8 mcs = rate_idx - DESC_RATEMCS0; + bitrate = rtw_get_ht_bitrate(mcs, bw, sgi); + } else if ((DESC_RATEVHTSS1MCS0 <= rate_idx) && + (rate_idx <= DESC_RATEVHTSS4MCS9)) { + u8 mcs = (rate_idx - DESC_RATEVHTSS1MCS0) % 10; + u8 nss = ((rate_idx - DESC_RATEVHTSS1MCS0) / 10) + 1; + bitrate = rtw_get_vht_bitrate(mcs, bw, nss, sgi); + } else { + /* 60Ghz ??? */ + bitrate = 1; + } + + return bitrate; +} + +static u32 rtw_airtime_link_metric_get(_adapter *adapter, struct sta_info *sta) +{ + struct dm_struct *dm = adapter_to_phydm(adapter); + int device_constant = phydm_get_plcp(dm, sta->cmn.mac_id) << RTW_ARITH_SHIFT; + u32 test_frame_len = RTW_TEST_FRAME_LEN << RTW_ARITH_SHIFT; + u32 s_unit = 1 << RTW_ARITH_SHIFT; + u32 err; + u16 rate; + u32 tx_time, estimated_retx; + u64 result; + /* The fail_avg should <= 100 here */ + u32 fail_avg = (u32)rtw_ewma_err_rate_read(&sta->metrics.err_rate); + + if (fail_avg > RTW_LINK_FAIL_THRESH) + return RTW_MAX_METRIC; + + rate = sta->metrics.data_rate; + /* rate unit is 100Kbps, min rate = 10 */ + if (rate < 10) { + RTW_HWMP_INFO("rate = %d\n", rate); + return RTW_MAX_METRIC; + } + + err = (fail_avg << RTW_ARITH_SHIFT) / 100; + + /* test_frame_len*10 to adjust the unit of rate(100kbps/unit) */ + tx_time = (device_constant + 10 * test_frame_len / rate); + estimated_retx = ((1 << (2 * RTW_ARITH_SHIFT)) / (s_unit - err)); + result = (tx_time * estimated_retx) >> (2 * RTW_ARITH_SHIFT); + /* Convert us to 0.01 TU(10.24us). x/10.24 = x*100/1024 */ + result = (result * 100) >> 10; + + return (u32)result; +} + +void rtw_ieee80211s_update_metric(_adapter *adapter, u8 mac_id, + u8 per, u8 rate, + u8 bw, u8 total_pkt) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); + struct sta_info *sta; + u8 rate_idx; + u8 sgi; + + sta = macid_ctl->sta[mac_id]; + if (!sta) + return; + + /* if RA, use reported rate */ + if (adapter->fix_rate == 0xff) { + rate_idx = rate & 0x7f; + sgi = rate >> 7; + } else { + rate_idx = adapter->fix_rate & 0x7f; + sgi = adapter->fix_rate >> 7; + } + sta->metrics.data_rate = rtw_desc_rate_to_bitrate(bw, rate_idx, sgi); + + if (total_pkt < RTW_TOTAL_PKT_MIN_THRESHOLD) + return; + + /* TBD: sta->metrics.overhead = phydm_get_plcp(void *dm_void, u16 macid); */ + sta->metrics.total_pkt = total_pkt; + + rtw_ewma_err_rate_add(&sta->metrics.err_rate, per); + if (rtw_ewma_err_rate_read(&sta->metrics.err_rate) > + RTW_LINK_FAIL_THRESH) + rtw_mesh_plink_broken(sta); +} + +static void rtw_hwmp_preq_frame_process(_adapter *adapter, + struct rtw_ieee80211_hdr_3addr *mgmt, + const u8 *preq_elem, u32 originator_metric) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct rtw_mesh_cfg *mshcfg = &adapter->mesh_cfg; + struct rtw_mesh_path *path = NULL; + const u8 *target_addr, *originator_addr; + const u8 *da; + u8 target_flags, ttl, flags, to_gate_ask = 0; + u32 originator_sn, target_sn, lifetime, target_metric = 0; + BOOLEAN reply = _FALSE; + BOOLEAN forward = _TRUE; + BOOLEAN preq_is_gate; + + /* Update target SN, if present */ + target_addr = RTW_PREQ_IE_TARGET_ADDR(preq_elem); + originator_addr = RTW_PREQ_IE_ORIG_ADDR(preq_elem); + target_sn = RTW_PREQ_IE_TARGET_SN(preq_elem); + originator_sn = RTW_PREQ_IE_ORIG_SN(preq_elem); + target_flags = RTW_PREQ_IE_TARGET_F(preq_elem); + /* PREQ gate announcements */ + flags = RTW_PREQ_IE_FLAGS(preq_elem); + preq_is_gate = !!(flags & RTW_IEEE80211_PREQ_IS_GATE_FLAG); + + RTW_HWMP_DBG("received PREQ from "MAC_FMT"\n", MAC_ARG(originator_addr)); + + if (rtw_ether_addr_equal(target_addr, adapter_mac_addr(adapter))) { + RTW_HWMP_DBG("PREQ is for us\n"); +#ifdef CONFIG_RTW_MESH_ON_DMD_GANN + rtw_rcu_read_lock(); + path = rtw_mesh_path_lookup(adapter, originator_addr); + if (path) { + if (preq_is_gate) + rtw_mesh_path_add_gate(path); + else if (path->is_gate) { + enter_critical_bh(&path->state_lock); + rtw_mesh_gate_del(adapter->mesh_info.mesh_paths, path); + exit_critical_bh(&path->state_lock); + } + } + path = NULL; + rtw_rcu_read_unlock(); +#endif + forward = _FALSE; + reply = _TRUE; + to_gate_ask = 1; + target_metric = 0; + if (rtw_time_after(rtw_get_current_time(), minfo->last_sn_update + + rtw_net_traversal_jiffies(adapter)) || + rtw_time_before(rtw_get_current_time(), minfo->last_sn_update)) { + ++minfo->sn; + minfo->last_sn_update = rtw_get_current_time(); + } + target_sn = minfo->sn; + } else if (is_broadcast_mac_addr(target_addr) && + (target_flags & RTW_IEEE80211_PREQ_TO_FLAG)) { + rtw_rcu_read_lock(); + path = rtw_mesh_path_lookup(adapter, originator_addr); + if (path) { + if (flags & RTW_IEEE80211_PREQ_PROACTIVE_PREP_FLAG) { + reply = _TRUE; + target_addr = adapter_mac_addr(adapter); + target_sn = ++minfo->sn; + target_metric = 0; + minfo->last_sn_update = rtw_get_current_time(); + } + + if (preq_is_gate) { + lifetime = RTW_PREQ_IE_LIFETIME(preq_elem); + path->gate_ann_int = lifetime; + path->gate_asked = false; + rtw_mesh_path_add_gate(path); + } else if (path->is_gate) { + enter_critical_bh(&path->state_lock); + rtw_mesh_gate_del(adapter->mesh_info.mesh_paths, path); + exit_critical_bh(&path->state_lock); + } + } + rtw_rcu_read_unlock(); + } else { + rtw_rcu_read_lock(); +#ifdef CONFIG_RTW_MESH_ON_DMD_GANN + path = rtw_mesh_path_lookup(adapter, originator_addr); + if (path) { + if (preq_is_gate) + rtw_mesh_path_add_gate(path); + else if (path->is_gate) { + enter_critical_bh(&path->state_lock); + rtw_mesh_gate_del(adapter->mesh_info.mesh_paths, path); + exit_critical_bh(&path->state_lock); + } + } + path = NULL; +#endif + path = rtw_mesh_path_lookup(adapter, target_addr); + if (path) { + if ((!(path->flags & RTW_MESH_PATH_SN_VALID)) || + RTW_SN_LT(path->sn, target_sn)) { + path->sn = target_sn; + path->flags |= RTW_MESH_PATH_SN_VALID; + } else if ((!(target_flags & RTW_IEEE80211_PREQ_TO_FLAG)) && + (path->flags & RTW_MESH_PATH_ACTIVE)) { + reply = _TRUE; + target_metric = path->metric; + target_sn = path->sn; + /* Case E2 of sec 13.10.9.3 IEEE 802.11-2012*/ + target_flags |= RTW_IEEE80211_PREQ_TO_FLAG; + } + } + rtw_rcu_read_unlock(); + } + + if (reply) { + lifetime = RTW_PREQ_IE_LIFETIME(preq_elem); + ttl = mshcfg->element_ttl; + if (ttl != 0 && !to_gate_ask) { + RTW_HWMP_DBG("replying to the PREQ\n"); + rtw_mesh_path_sel_frame_tx(RTW_MPATH_PREP, 0, originator_addr, + originator_sn, 0, target_addr, + target_sn, mgmt->addr2, 0, ttl, + lifetime, target_metric, 0, + adapter); + } else if (ttl != 0 && to_gate_ask) { + RTW_HWMP_DBG("replying to the PREQ (PREQ for us)\n"); + if (mshcfg->dot11MeshGateAnnouncementProtocol) { + /* BIT 7 is used to identify the prep is from mesh gate */ + to_gate_ask = RTW_IEEE80211_PREQ_IS_GATE_FLAG | BIT(7); + } else { + to_gate_ask = 0; + } + + rtw_mesh_path_sel_frame_tx(RTW_MPATH_PREP, to_gate_ask, originator_addr, + originator_sn, 0, target_addr, + target_sn, mgmt->addr2, 0, ttl, + lifetime, target_metric, 0, + adapter); + } else { + minfo->mshstats.dropped_frames_ttl++; + } + } + + if (forward && mshcfg->dot11MeshForwarding) { + u32 preq_id; + u8 hopcount; + + ttl = RTW_PREQ_IE_TTL(preq_elem); + lifetime = RTW_PREQ_IE_LIFETIME(preq_elem); + if (ttl <= 1) { + minfo->mshstats.dropped_frames_ttl++; + return; + } + RTW_HWMP_DBG("forwarding the PREQ from "MAC_FMT"\n", MAC_ARG(originator_addr)); + --ttl; + preq_id = RTW_PREQ_IE_PREQ_ID(preq_elem); + hopcount = RTW_PREQ_IE_HOPCOUNT(preq_elem) + 1; + da = (path && path->is_root) ? + path->rann_snd_addr : bcast_addr; + + if (flags & RTW_IEEE80211_PREQ_PROACTIVE_PREP_FLAG) { + target_addr = RTW_PREQ_IE_TARGET_ADDR(preq_elem); + target_sn = RTW_PREQ_IE_TARGET_SN(preq_elem); + } + + rtw_mesh_path_sel_frame_tx(RTW_MPATH_PREQ, flags, originator_addr, + originator_sn, target_flags, target_addr, + target_sn, da, hopcount, ttl, lifetime, + originator_metric, preq_id, adapter); + if (!is_multicast_mac_addr(da)) + minfo->mshstats.fwded_unicast++; + else + minfo->mshstats.fwded_mcast++; + minfo->mshstats.fwded_frames++; + } +} + +static inline struct sta_info * +rtw_next_hop_deref_protected(struct rtw_mesh_path *path) +{ + return rtw_rcu_dereference_protected(path->next_hop, + rtw_lockdep_is_held(&path->state_lock)); +} + +static void rtw_hwmp_prep_frame_process(_adapter *adapter, + struct rtw_ieee80211_hdr_3addr *mgmt, + const u8 *prep_elem, u32 metric) +{ + struct rtw_mesh_cfg *mshcfg = &adapter->mesh_cfg; + struct rtw_mesh_stats *mshstats = &adapter->mesh_info.mshstats; + struct rtw_mesh_path *path; + const u8 *target_addr, *originator_addr; + u8 ttl, hopcount, flags; + u8 next_hop[ETH_ALEN]; + u32 target_sn, originator_sn, lifetime; + + RTW_HWMP_DBG("received PREP from "MAC_FMT"\n", + MAC_ARG(RTW_PREP_IE_TARGET_ADDR(prep_elem))); + + originator_addr = RTW_PREP_IE_ORIG_ADDR(prep_elem); + if (rtw_ether_addr_equal(originator_addr, adapter_mac_addr(adapter))) { + /* destination, no forwarding required */ + rtw_rcu_read_lock(); + target_addr = RTW_PREP_IE_TARGET_ADDR(prep_elem); + path = rtw_mesh_path_lookup(adapter, target_addr); + if (path && path->gate_asked) { + flags = RTW_PREP_IE_FLAGS(prep_elem); + if (flags & BIT(7)) { + enter_critical_bh(&path->state_lock); + path->gate_asked = false; + exit_critical_bh(&path->state_lock); + if (!(flags & RTW_IEEE80211_PREQ_IS_GATE_FLAG)) { + enter_critical_bh(&path->state_lock); + rtw_mesh_gate_del(adapter->mesh_info.mesh_paths, path); + exit_critical_bh(&path->state_lock); + } + } + } + + rtw_rcu_read_unlock(); + return; + } + + if (!mshcfg->dot11MeshForwarding) + return; + + ttl = RTW_PREP_IE_TTL(prep_elem); + if (ttl <= 1) { + mshstats->dropped_frames_ttl++; + return; + } + + rtw_rcu_read_lock(); + path = rtw_mesh_path_lookup(adapter, originator_addr); + if (path) + enter_critical_bh(&path->state_lock); + else + goto fail; + if (!(path->flags & RTW_MESH_PATH_ACTIVE)) { + exit_critical_bh(&path->state_lock); + goto fail; + } + _rtw_memcpy(next_hop, rtw_next_hop_deref_protected(path)->cmn.mac_addr, ETH_ALEN); + exit_critical_bh(&path->state_lock); + --ttl; + flags = RTW_PREP_IE_FLAGS(prep_elem); + lifetime = RTW_PREP_IE_LIFETIME(prep_elem); + hopcount = RTW_PREP_IE_HOPCOUNT(prep_elem) + 1; + target_addr = RTW_PREP_IE_TARGET_ADDR(prep_elem); + target_sn = RTW_PREP_IE_TARGET_SN(prep_elem); + originator_sn = RTW_PREP_IE_ORIG_SN(prep_elem); + + rtw_mesh_path_sel_frame_tx(RTW_MPATH_PREP, flags, originator_addr, originator_sn, 0, + target_addr, target_sn, next_hop, hopcount, + ttl, lifetime, metric, 0, adapter); + rtw_rcu_read_unlock(); + + mshstats->fwded_unicast++; + mshstats->fwded_frames++; + return; + +fail: + rtw_rcu_read_unlock(); + mshstats->dropped_frames_no_route++; +} + +static void rtw_hwmp_perr_frame_process(_adapter *adapter, + struct rtw_ieee80211_hdr_3addr *mgmt, + const u8 *perr_elem) +{ + struct rtw_mesh_cfg *mshcfg = &adapter->mesh_cfg; + struct rtw_mesh_stats *mshstats = &adapter->mesh_info.mshstats; + struct rtw_mesh_path *path; + u8 ttl; + const u8 *ta, *target_addr; + u32 target_sn; + u16 perr_reason_code; + + ta = mgmt->addr2; + ttl = RTW_PERR_IE_TTL(perr_elem); + if (ttl <= 1) { + mshstats->dropped_frames_ttl++; + return; + } + ttl--; + target_addr = RTW_PERR_IE_TARGET_ADDR(perr_elem); + target_sn = RTW_PERR_IE_TARGET_SN(perr_elem); + perr_reason_code = RTW_PERR_IE_TARGET_RCODE(perr_elem); + + RTW_HWMP_DBG("received PERR toward target "MAC_FMT"\n", MAC_ARG(target_addr)); + + rtw_rcu_read_lock(); + path = rtw_mesh_path_lookup(adapter, target_addr); + if (path) { + struct sta_info *sta; + + enter_critical_bh(&path->state_lock); + sta = rtw_next_hop_deref_protected(path); + if (path->flags & RTW_MESH_PATH_ACTIVE && + rtw_ether_addr_equal(ta, sta->cmn.mac_addr) && + !(path->flags & RTW_MESH_PATH_FIXED) && + (!(path->flags & RTW_MESH_PATH_SN_VALID) || + RTW_SN_GT(target_sn, path->sn) || target_sn == 0)) { + path->flags &= ~RTW_MESH_PATH_ACTIVE; + if (target_sn != 0) + path->sn = target_sn; + else + path->sn += 1; + exit_critical_bh(&path->state_lock); + if (!mshcfg->dot11MeshForwarding) + goto endperr; + rtw_mesh_path_error_tx(adapter, ttl, target_addr, + target_sn, perr_reason_code, + bcast_addr); + } else + exit_critical_bh(&path->state_lock); + } +endperr: + rtw_rcu_read_unlock(); +} + +static void rtw_hwmp_rann_frame_process(_adapter *adapter, + struct rtw_ieee80211_hdr_3addr *mgmt, + const struct rtw_ieee80211_rann_ie *rann) +{ + struct sta_info *sta; + struct sta_priv *pstapriv = &adapter->stapriv; + struct rtw_mesh_cfg *mshcfg = &adapter->mesh_cfg; + struct rtw_mesh_stats *mshstats = &adapter->mesh_info.mshstats; + struct rtw_mesh_path *path; + u8 ttl, flags, hopcount; + const u8 *originator_addr; + u32 originator_sn, metric, metric_txsta, interval; + BOOLEAN root_is_gate; + + ttl = rann->rann_ttl; + flags = rann->rann_flags; + root_is_gate = !!(flags & RTW_RANN_FLAG_IS_GATE); + originator_addr = rann->rann_addr; + originator_sn = le32_to_cpu(rann->rann_seq); + interval = le32_to_cpu(rann->rann_interval); + hopcount = rann->rann_hopcount; + hopcount++; + metric = le32_to_cpu(rann->rann_metric); + + /* Ignore our own RANNs */ + if (rtw_ether_addr_equal(originator_addr, adapter_mac_addr(adapter))) + return; + + RTW_HWMP_DBG("received RANN from "MAC_FMT" via neighbour "MAC_FMT" (is_gate=%d)\n", + MAC_ARG(originator_addr), MAC_ARG(mgmt->addr2), root_is_gate); + + rtw_rcu_read_lock(); + sta = rtw_get_stainfo(pstapriv, mgmt->addr2); + if (!sta) { + rtw_rcu_read_unlock(); + return; + } + + metric_txsta = rtw_airtime_link_metric_get(adapter, sta); + + path = rtw_mesh_path_lookup(adapter, originator_addr); + if (!path) { + path = rtw_mesh_path_add(adapter, originator_addr); + if (IS_ERR(path)) { + rtw_rcu_read_unlock(); + mshstats->dropped_frames_no_route++; + return; + } + } + + if (!(RTW_SN_LT(path->sn, originator_sn)) && + !(path->sn == originator_sn && metric < path->rann_metric)) { + rtw_rcu_read_unlock(); + return; + } + + if ((!(path->flags & (RTW_MESH_PATH_ACTIVE | RTW_MESH_PATH_RESOLVING)) || + (rtw_time_after(rtw_get_current_time(), path->last_preq_to_root + + rtw_root_path_confirmation_jiffies(adapter)) || + rtw_time_before(rtw_get_current_time(), path->last_preq_to_root))) && + !(path->flags & RTW_MESH_PATH_FIXED) && (ttl != 0)) { + u8 preq_node_flag = RTW_PREQ_Q_F_START | RTW_PREQ_Q_F_REFRESH; + + RTW_HWMP_DBG("time to refresh root path "MAC_FMT"\n", + MAC_ARG(originator_addr)); +#ifdef CONFIG_RTW_MESH_ADD_ROOT_CHK + if (RTW_SN_LT(path->sn, originator_sn) && + (path->rann_metric + mshcfg->sane_metric_delta < metric) && + _rtw_memcmp(bcast_addr, path->rann_snd_addr, ETH_ALEN) == _FALSE) { + RTW_HWMP_DBG("Trigger additional check for root " + "confirm PREQ. rann_snd_addr = "MAC_FMT + "add_chk_rann_snd_addr= "MAC_FMT"\n", + MAC_ARG(mgmt->addr2), + MAC_ARG(path->rann_snd_addr)); + _rtw_memcpy(path->add_chk_rann_snd_addr, + path->rann_snd_addr, ETH_ALEN); + preq_node_flag |= RTW_PREQ_Q_F_CHK; + + } +#endif + rtw_mesh_queue_preq(path, preq_node_flag); + path->last_preq_to_root = rtw_get_current_time(); + } + + path->sn = originator_sn; + path->rann_metric = metric + metric_txsta; + path->is_root = _TRUE; + /* Recording RANNs sender address to send individually + * addressed PREQs destined for root mesh STA */ + _rtw_memcpy(path->rann_snd_addr, mgmt->addr2, ETH_ALEN); + + if (root_is_gate) { + path->gate_ann_int = interval; + path->gate_asked = false; + rtw_mesh_path_add_gate(path); + } else if (path->is_gate) { + enter_critical_bh(&path->state_lock); + rtw_mesh_gate_del(adapter->mesh_info.mesh_paths, path); + exit_critical_bh(&path->state_lock); + } + + if (ttl <= 1) { + mshstats->dropped_frames_ttl++; + rtw_rcu_read_unlock(); + return; + } + ttl--; + + if (mshcfg->dot11MeshForwarding) { + rtw_mesh_path_sel_frame_tx(RTW_MPATH_RANN, flags, originator_addr, + originator_sn, 0, NULL, 0, bcast_addr, + hopcount, ttl, interval, + metric + metric_txsta, 0, adapter); + } + + rtw_rcu_read_unlock(); +} + +static u32 rtw_hwmp_route_info_get(_adapter *adapter, + struct rtw_ieee80211_hdr_3addr *mgmt, + const u8 *hwmp_ie, enum rtw_mpath_frame_type action) +{ + struct rtw_mesh_path *path; + struct sta_priv *pstapriv = &adapter->stapriv; + struct sta_info *sta; + BOOLEAN fresh_info; + const u8 *originator_addr, *ta; + u32 originator_sn, originator_metric; + unsigned long originator_lifetime, exp_time; + u32 last_hop_metric, new_metric; + BOOLEAN process = _TRUE; + + rtw_rcu_read_lock(); + sta = rtw_get_stainfo(pstapriv, mgmt->addr2); + if (!sta) { + rtw_rcu_read_unlock(); + return 0; + } + + last_hop_metric = rtw_airtime_link_metric_get(adapter, sta); + /* Update and check originator routing info */ + fresh_info = _TRUE; + + switch (action) { + case RTW_MPATH_PREQ: + originator_addr = RTW_PREQ_IE_ORIG_ADDR(hwmp_ie); + originator_sn = RTW_PREQ_IE_ORIG_SN(hwmp_ie); + originator_lifetime = RTW_PREQ_IE_LIFETIME(hwmp_ie); + originator_metric = RTW_PREQ_IE_METRIC(hwmp_ie); + break; + case RTW_MPATH_PREP: + /* Note: For coding, the naming is not consist with spec */ + originator_addr = RTW_PREP_IE_TARGET_ADDR(hwmp_ie); + originator_sn = RTW_PREP_IE_TARGET_SN(hwmp_ie); + originator_lifetime = RTW_PREP_IE_LIFETIME(hwmp_ie); + originator_metric = RTW_PREP_IE_METRIC(hwmp_ie); + break; + default: + rtw_rcu_read_unlock(); + return 0; + } + new_metric = originator_metric + last_hop_metric; + if (new_metric < originator_metric) + new_metric = RTW_MAX_METRIC; + exp_time = RTW_TU_TO_EXP_TIME(originator_lifetime); + + if (rtw_ether_addr_equal(originator_addr, adapter_mac_addr(adapter))) { + process = _FALSE; + fresh_info = _FALSE; + } else { + path = rtw_mesh_path_lookup(adapter, originator_addr); + if (path) { + enter_critical_bh(&path->state_lock); + if (path->flags & RTW_MESH_PATH_FIXED) + fresh_info = _FALSE; + else if ((path->flags & RTW_MESH_PATH_ACTIVE) && + (path->flags & RTW_MESH_PATH_SN_VALID)) { + if (RTW_SN_GT(path->sn, originator_sn) || + (path->sn == originator_sn && + new_metric >= path->metric)) { + process = _FALSE; + fresh_info = _FALSE; + } + } else if (!(path->flags & RTW_MESH_PATH_ACTIVE)) { + BOOLEAN have_sn, newer_sn, bounced; + + have_sn = path->flags & RTW_MESH_PATH_SN_VALID; + newer_sn = have_sn && RTW_SN_GT(originator_sn, path->sn); + bounced = have_sn && + (RTW_SN_DELTA(originator_sn, path->sn) > + RTW_MAX_SANE_SN_DELTA); + + if (!have_sn || newer_sn) { + } else if (bounced) { + } else { + process = _FALSE; + fresh_info = _FALSE; + } + } + } else { + path = rtw_mesh_path_add(adapter, originator_addr); + if (IS_ERR(path)) { + rtw_rcu_read_unlock(); + return 0; + } + enter_critical_bh(&path->state_lock); + } + + if (fresh_info) { + rtw_mesh_path_assign_nexthop(path, sta); + path->flags |= RTW_MESH_PATH_SN_VALID; + path->metric = new_metric; + path->sn = originator_sn; + path->exp_time = rtw_time_after(path->exp_time, exp_time) + ? path->exp_time : exp_time; + rtw_mesh_path_activate(path); +#ifdef CONFIG_RTW_MESH_ADD_ROOT_CHK + if (path->is_root && (action == RTW_MPATH_PREP)) { + _rtw_memcpy(path->rann_snd_addr, + mgmt->addr2, ETH_ALEN); + path->rann_metric = new_metric; + } +#endif + exit_critical_bh(&path->state_lock); + rtw_mesh_path_tx_pending(path); + } else + exit_critical_bh(&path->state_lock); + } + + /* Update and check transmitter routing info */ + ta = mgmt->addr2; + if (rtw_ether_addr_equal(originator_addr, ta)) + fresh_info = _FALSE; + else { + fresh_info = _TRUE; + + path = rtw_mesh_path_lookup(adapter, ta); + if (path) { + enter_critical_bh(&path->state_lock); + if ((path->flags & RTW_MESH_PATH_FIXED) || + ((path->flags & RTW_MESH_PATH_ACTIVE) && + (last_hop_metric > path->metric))) + fresh_info = _FALSE; + } else { + path = rtw_mesh_path_add(adapter, ta); + if (IS_ERR(path)) { + rtw_rcu_read_unlock(); + return 0; + } + enter_critical_bh(&path->state_lock); + } + + if (fresh_info) { + rtw_mesh_path_assign_nexthop(path, sta); + path->metric = last_hop_metric; + path->exp_time = rtw_time_after(path->exp_time, exp_time) + ? path->exp_time : exp_time; + rtw_mesh_path_activate(path); + exit_critical_bh(&path->state_lock); + rtw_mesh_path_tx_pending(path); + } else + exit_critical_bh(&path->state_lock); + } + + rtw_rcu_read_unlock(); + + return process ? new_metric : 0; +} + +static void rtw_mesh_rx_hwmp_frame_cnts(_adapter *adapter, u8 *addr) +{ + struct sta_info *sta; + + sta = rtw_get_stainfo(&adapter->stapriv, addr); + if (sta) + sta->sta_stats.rx_hwmp_pkts++; +} + +void rtw_mesh_rx_path_sel_frame(_adapter *adapter, union recv_frame *rframe) +{ + struct mesh_plink_ent *plink = NULL; + struct rtw_ieee802_11_elems elems; + u32 path_metric; + struct rx_pkt_attrib *attrib = &rframe->u.hdr.attrib; + u8 *pframe = rframe->u.hdr.rx_data, *start; + uint frame_len = rframe->u.hdr.len, left; + struct rtw_ieee80211_hdr_3addr *frame_hdr = (struct rtw_ieee80211_hdr_3addr *)pframe; + u8 *frame_body = (u8 *)(pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); + ParseRes parse_res; + + plink = rtw_mesh_plink_get(adapter, get_addr2_ptr(pframe)); + if (!plink || plink->plink_state != RTW_MESH_PLINK_ESTAB) + return; + + rtw_mesh_rx_hwmp_frame_cnts(adapter, get_addr2_ptr(pframe)); + + /* Mesh action frame IE offset = 2 */ + attrib->hdrlen = sizeof(struct rtw_ieee80211_hdr_3addr); + left = frame_len - attrib->hdrlen - attrib->iv_len - attrib->icv_len - 2; + start = pframe + attrib->hdrlen + 2; + + parse_res = rtw_ieee802_11_parse_elems(start, left, &elems, 1); + if (parse_res == ParseFailed) + RTW_HWMP_INFO(FUNC_ADPT_FMT" Path Select Frame ParseFailed\n" + , FUNC_ADPT_ARG(adapter)); + else if (parse_res == ParseUnknown) + RTW_HWMP_INFO(FUNC_ADPT_FMT" Path Select Frame ParseUnknown\n" + , FUNC_ADPT_ARG(adapter)); + + if (elems.preq) { + if (elems.preq_len != 37) + /* Right now we support just 1 destination and no AE */ + return; + path_metric = rtw_hwmp_route_info_get(adapter, frame_hdr, elems.preq, + MPATH_PREQ); + if (path_metric) + rtw_hwmp_preq_frame_process(adapter, frame_hdr, elems.preq, + path_metric); + } + if (elems.prep) { + if (elems.prep_len != 31) + /* Right now we support no AE */ + return; + path_metric = rtw_hwmp_route_info_get(adapter, frame_hdr, elems.prep, + MPATH_PREP); + if (path_metric) + rtw_hwmp_prep_frame_process(adapter, frame_hdr, elems.prep, + path_metric); + } + if (elems.perr) { + if (elems.perr_len != 15) + /* Right now we support only one destination per PERR */ + return; + rtw_hwmp_perr_frame_process(adapter, frame_hdr, elems.perr); + } + if (elems.rann) + rtw_hwmp_rann_frame_process(adapter, frame_hdr, (struct rtw_ieee80211_rann_ie *)elems.rann); +} + +void rtw_mesh_queue_preq(struct rtw_mesh_path *path, u8 flags) +{ + _adapter *adapter = path->adapter; + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct rtw_mesh_preq_queue *preq_node; + + preq_node = rtw_malloc(sizeof(struct rtw_mesh_preq_queue)); + if (!preq_node) { + RTW_HWMP_INFO("could not allocate PREQ node\n"); + return; + } + + enter_critical_bh(&minfo->mesh_preq_queue_lock); + if (minfo->preq_queue_len == RTW_MAX_PREQ_QUEUE_LEN) { + exit_critical_bh(&minfo->mesh_preq_queue_lock); + rtw_mfree(preq_node, sizeof(struct rtw_mesh_preq_queue)); + if (rtw_print_ratelimit()) + RTW_HWMP_INFO("PREQ node queue full\n"); + return; + } + + _rtw_spinlock(&path->state_lock); + if (path->flags & RTW_MESH_PATH_REQ_QUEUED) { + _rtw_spinunlock(&path->state_lock); + exit_critical_bh(&minfo->mesh_preq_queue_lock); + rtw_mfree(preq_node, sizeof(struct rtw_mesh_preq_queue)); + return; + } + + _rtw_memcpy(preq_node->dst, path->dst, ETH_ALEN); + preq_node->flags = flags; + + path->flags |= RTW_MESH_PATH_REQ_QUEUED; +#ifdef CONFIG_RTW_MESH_ADD_ROOT_CHK + if (flags & RTW_PREQ_Q_F_CHK) + path->flags |= RTW_MESH_PATH_ROOT_ADD_CHK; +#endif + if (flags & RTW_PREQ_Q_F_PEER_AKA) + path->flags |= RTW_MESH_PATH_PEER_AKA; + if (flags & RTW_PREQ_Q_F_BCAST_PREQ) + path->flags |= RTW_MESH_PATH_BCAST_PREQ; + _rtw_spinunlock(&path->state_lock); + + rtw_list_insert_tail(&preq_node->list, &minfo->preq_queue.list); + ++minfo->preq_queue_len; + exit_critical_bh(&minfo->mesh_preq_queue_lock); + + if (rtw_time_after(rtw_get_current_time(), minfo->last_preq + rtw_min_preq_int_jiff(adapter))) + rtw_mesh_work(&adapter->mesh_work); + + else if (rtw_time_before(rtw_get_current_time(), minfo->last_preq)) { + /* systime wrapped around issue */ + minfo->last_preq = rtw_get_current_time() - rtw_min_preq_int_jiff(adapter) - 1; + rtw_mesh_work(&adapter->mesh_work); + } else + rtw_mod_timer(&adapter->mesh_path_timer, minfo->last_preq + + rtw_min_preq_int_jiff(adapter) + 1); +} + +static const u8 *rtw_hwmp_preq_da(struct rtw_mesh_path *path, + BOOLEAN is_root_add_chk, BOOLEAN da_is_peer, + BOOLEAN force_preq_bcast) +{ + const u8 *da; + + if (da_is_peer) + da = path->dst; + else if (force_preq_bcast) + da = bcast_addr; + else if (path->is_root) +#ifdef CONFIG_RTW_MESH_ADD_ROOT_CHK + da = is_root_add_chk ? path->add_chk_rann_snd_addr: + path->rann_snd_addr; +#else + da = path->rann_snd_addr; +#endif + else + da = bcast_addr; + + return da; +} + +void rtw_mesh_path_start_discovery(_adapter *adapter) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct rtw_mesh_cfg *mshcfg = &adapter->mesh_cfg; + struct rtw_mesh_preq_queue *preq_node; + struct rtw_mesh_path *path; + u8 ttl, target_flags = 0; + const u8 *da; + u32 lifetime; + u8 flags = 0; + BOOLEAN is_root_add_chk = _FALSE; + BOOLEAN da_is_peer, force_preq_bcast; + + enter_critical_bh(&minfo->mesh_preq_queue_lock); + if (!minfo->preq_queue_len || + rtw_time_before(rtw_get_current_time(), minfo->last_preq + + rtw_min_preq_int_jiff(adapter))) { + exit_critical_bh(&minfo->mesh_preq_queue_lock); + return; + } + + preq_node = rtw_list_first_entry(&minfo->preq_queue.list, + struct rtw_mesh_preq_queue, list); + rtw_list_delete(&preq_node->list); /* list_del_init(&preq_node->list); */ + --minfo->preq_queue_len; + exit_critical_bh(&minfo->mesh_preq_queue_lock); + + rtw_rcu_read_lock(); + path = rtw_mesh_path_lookup(adapter, preq_node->dst); + if (!path) + goto enddiscovery; + + enter_critical_bh(&path->state_lock); + if (path->flags & (RTW_MESH_PATH_DELETED | RTW_MESH_PATH_FIXED)) { + exit_critical_bh(&path->state_lock); + goto enddiscovery; + } + path->flags &= ~RTW_MESH_PATH_REQ_QUEUED; + if (preq_node->flags & RTW_PREQ_Q_F_START) { + if (path->flags & RTW_MESH_PATH_RESOLVING) { + exit_critical_bh(&path->state_lock); + goto enddiscovery; + } else { + path->flags &= ~RTW_MESH_PATH_RESOLVED; + path->flags |= RTW_MESH_PATH_RESOLVING; + path->discovery_retries = 0; + path->discovery_timeout = rtw_disc_timeout_jiff(adapter); + } + } else if (!(path->flags & RTW_MESH_PATH_RESOLVING) || + path->flags & RTW_MESH_PATH_RESOLVED) { + path->flags &= ~RTW_MESH_PATH_RESOLVING; + exit_critical_bh(&path->state_lock); + goto enddiscovery; + } + + minfo->last_preq = rtw_get_current_time(); + + if (rtw_time_after(rtw_get_current_time(), minfo->last_sn_update + + rtw_net_traversal_jiffies(adapter)) || + rtw_time_before(rtw_get_current_time(), minfo->last_sn_update)) { + ++minfo->sn; + minfo->last_sn_update = rtw_get_current_time(); + } + lifetime = rtw_default_lifetime(adapter); + ttl = mshcfg->element_ttl; + if (ttl == 0) { + minfo->mshstats.dropped_frames_ttl++; + exit_critical_bh(&path->state_lock); + goto enddiscovery; + } + + if (preq_node->flags & RTW_PREQ_Q_F_REFRESH) + target_flags |= RTW_IEEE80211_PREQ_TO_FLAG; + else + target_flags &= ~RTW_IEEE80211_PREQ_TO_FLAG; + +#ifdef CONFIG_RTW_MESH_ADD_ROOT_CHK + is_root_add_chk = !!(path->flags & RTW_MESH_PATH_ROOT_ADD_CHK); +#endif + da_is_peer = !!(path->flags & RTW_MESH_PATH_PEER_AKA); + force_preq_bcast = !!(path->flags & RTW_MESH_PATH_BCAST_PREQ); + exit_critical_bh(&path->state_lock); + + da = rtw_hwmp_preq_da(path, is_root_add_chk, + da_is_peer, force_preq_bcast); + +#ifdef CONFIG_RTW_MESH_ON_DMD_GANN + flags = (mshcfg->dot11MeshGateAnnouncementProtocol) + ? RTW_IEEE80211_PREQ_IS_GATE_FLAG : 0; +#endif + rtw_mesh_path_sel_frame_tx(RTW_MPATH_PREQ, flags, adapter_mac_addr(adapter), minfo->sn, + target_flags, path->dst, path->sn, da, 0, + ttl, lifetime, 0, minfo->preq_id++, adapter); + rtw_mod_timer(&path->timer, rtw_get_current_time() + path->discovery_timeout); + +enddiscovery: + rtw_rcu_read_unlock(); + rtw_mfree(preq_node, sizeof(struct rtw_mesh_preq_queue)); +} + +void rtw_mesh_path_timer(void *ctx) +{ + struct rtw_mesh_path *path = (void *) ctx; + _adapter *adapter = path->adapter; + int ret; + u8 retry = 0; +#ifdef CONFIG_RTW_MESH_ADD_ROOT_CHK + struct rtw_mesh_cfg *mshcfg = &adapter->mesh_cfg; +#endif + /* TBD: Proctect for suspend */ +#if 0 + if (suspending) + return; +#endif + enter_critical_bh(&path->state_lock); + if (path->flags & RTW_MESH_PATH_RESOLVED || + (!(path->flags & RTW_MESH_PATH_RESOLVING))) { + path->flags &= ~(RTW_MESH_PATH_RESOLVING | + RTW_MESH_PATH_RESOLVED | + RTW_MESH_PATH_ROOT_ADD_CHK | + RTW_MESH_PATH_PEER_AKA | + RTW_MESH_PATH_BCAST_PREQ); + exit_critical_bh(&path->state_lock); + } else if (path->discovery_retries < rtw_max_preq_retries(adapter)) { + ++path->discovery_retries; + path->discovery_timeout *= 2; + path->flags &= ~RTW_MESH_PATH_REQ_QUEUED; +#ifdef CONFIG_RTW_MESH_ADD_ROOT_CHK + if (path->discovery_retries > mshcfg->max_root_add_chk_cnt) + path->flags &= ~RTW_MESH_PATH_ROOT_ADD_CHK; +#endif + if (path->gate_asked) + retry |= RTW_PREQ_Q_F_REFRESH; + + exit_critical_bh(&path->state_lock); + rtw_mesh_queue_preq(path, retry); + } else { + path->flags &= ~(RTW_MESH_PATH_RESOLVING | + RTW_MESH_PATH_RESOLVED | + RTW_MESH_PATH_REQ_QUEUED | + RTW_MESH_PATH_ROOT_ADD_CHK | + RTW_MESH_PATH_PEER_AKA | + RTW_MESH_PATH_BCAST_PREQ); + path->exp_time = rtw_get_current_time(); + exit_critical_bh(&path->state_lock); + if (!path->is_gate && rtw_mesh_gate_num(adapter) > 0) { + ret = rtw_mesh_path_send_to_gates(path); + if (ret) + RTW_HWMP_DBG("no gate was reachable\n"); + } else + rtw_mesh_path_flush_pending(path); + } +} + + +void rtw_mesh_path_tx_root_frame(_adapter *adapter) +{ + struct rtw_mesh_cfg *mshcfg = &adapter->mesh_cfg; + struct rtw_mesh_info *minfo = &adapter->mesh_info; + u32 interval = mshcfg->dot11MeshHWMPRannInterval; + u8 flags, target_flags = 0; + + flags = (mshcfg->dot11MeshGateAnnouncementProtocol) + ? RTW_RANN_FLAG_IS_GATE : 0; + + switch (mshcfg->dot11MeshHWMPRootMode) { + case RTW_IEEE80211_PROACTIVE_RANN: + rtw_mesh_path_sel_frame_tx(RTW_MPATH_RANN, flags, adapter_mac_addr(adapter), + ++minfo->sn, 0, NULL, 0, bcast_addr, + 0, mshcfg->element_ttl, + interval, 0, 0, adapter); + break; + case RTW_IEEE80211_PROACTIVE_PREQ_WITH_PREP: + flags |= RTW_IEEE80211_PREQ_PROACTIVE_PREP_FLAG; + case RTW_IEEE80211_PROACTIVE_PREQ_NO_PREP: + interval = mshcfg->dot11MeshHWMPactivePathToRootTimeout; + target_flags |= RTW_IEEE80211_PREQ_TO_FLAG | + RTW_IEEE80211_PREQ_USN_FLAG; + rtw_mesh_path_sel_frame_tx(RTW_MPATH_PREQ, flags, adapter_mac_addr(adapter), + ++minfo->sn, target_flags, + (u8 *) bcast_addr, 0, bcast_addr, + 0, mshcfg->element_ttl, interval, + 0, minfo->preq_id++, adapter); + break; + default: + RTW_HWMP_INFO("Proactive mechanism not supported\n"); + return; + } +} + +void rtw_mesh_work(_workitem *work) +{ + /* use kernel global workqueue */ + _set_workitem(work); +} + +void rtw_ieee80211_mesh_path_timer(void *ctx) +{ + _adapter *adapter = (_adapter *)ctx; + rtw_mesh_work(&adapter->mesh_work); +} + +void rtw_ieee80211_mesh_path_root_timer(void *ctx) +{ + _adapter *adapter = (_adapter *)ctx; + + rtw_set_bit(RTW_MESH_WORK_ROOT, &adapter->wrkq_flags); + + rtw_mesh_work(&adapter->mesh_work); +} + +static void rtw_ieee80211_mesh_rootpath(_adapter *adapter) +{ + u32 interval; + + rtw_mesh_path_tx_root_frame(adapter); + + if (adapter->mesh_cfg.dot11MeshHWMPRootMode == RTW_IEEE80211_PROACTIVE_RANN) + interval = adapter->mesh_cfg.dot11MeshHWMPRannInterval; + else + interval = adapter->mesh_cfg.dot11MeshHWMProotInterval; + + rtw_mod_timer(&adapter->mesh_path_root_timer, + RTW_TU_TO_EXP_TIME(interval)); +} + +BOOLEAN rtw_ieee80211_mesh_root_setup(_adapter *adapter) +{ + BOOLEAN root_enabled = _FALSE; + + if (adapter->mesh_cfg.dot11MeshHWMPRootMode > RTW_IEEE80211_ROOTMODE_ROOT) { + rtw_set_bit(RTW_MESH_WORK_ROOT, &adapter->wrkq_flags); + root_enabled = _TRUE; + } + else { + rtw_clear_bit(RTW_MESH_WORK_ROOT, &adapter->wrkq_flags); + /* stop running timer */ + _cancel_timer_ex(&adapter->mesh_path_root_timer); + root_enabled = _FALSE; + } + + return root_enabled; +} + +void rtw_mesh_work_hdl(_workitem *work) +{ + _adapter *adapter = container_of(work, _adapter, mesh_work); + + while(adapter->mesh_info.preq_queue_len) { + if (rtw_time_after(rtw_get_current_time(), + adapter->mesh_info.last_preq + rtw_min_preq_int_jiff(adapter))) + /* It will consume preq_queue_len */ + rtw_mesh_path_start_discovery(adapter); + else { + struct rtw_mesh_info *minfo = &adapter->mesh_info; + + rtw_mod_timer(&adapter->mesh_path_timer, + minfo->last_preq + rtw_min_preq_int_jiff(adapter) + 1); + break; + } + } + + if (rtw_test_and_clear_bit(RTW_MESH_WORK_ROOT, &adapter->wrkq_flags)) + rtw_ieee80211_mesh_rootpath(adapter); +} + +#ifndef RTW_PER_CMD_SUPPORT_FW +static void rtw_update_metric_directly(_adapter *adapter) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); + u8 i; + + for (i = 0; i < macid_ctl->num; i++) { + u8 role; + role = GET_H2CCMD_MSRRPT_PARM_ROLE(&macid_ctl->h2c_msr[i]); + if (role == H2C_MSR_ROLE_MESH) { + struct sta_info *sta = macid_ctl->sta[i]; + u8 rate_idx, sgi, bw; + u32 rate; + + if (!sta) + continue; + rate_idx = rtw_get_current_tx_rate(adapter, sta); + sgi = rtw_get_current_tx_sgi(adapter, sta); + bw = sta->cmn.bw_mode; + rate = rtw_desc_rate_to_bitrate(bw, rate_idx, sgi); + sta->metrics.data_rate = rate; + } + } +} +#endif + +void rtw_mesh_atlm_param_req_timer(void *ctx) +{ + _adapter *adapter = (_adapter *)ctx; + u8 ret = _FAIL; + +#ifdef RTW_PER_CMD_SUPPORT_FW + ret = rtw_req_per_cmd(adapter); + if (ret == _FAIL) + RTW_HWMP_INFO("rtw_req_per_cmd fail\n"); +#else + rtw_update_metric_directly(adapter); +#endif + _set_timer(&adapter->mesh_atlm_param_req_timer, RTW_ATLM_REQ_CYCLE); +} + +#endif /* CONFIG_RTW_MESH */ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/mesh/rtw_mesh_hwmp.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/mesh/rtw_mesh_hwmp.h new file mode 100644 index 000000000000..1702bf22f4df --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/mesh/rtw_mesh_hwmp.h @@ -0,0 +1,61 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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_MESH_HWMP_H_ +#define __RTW_MESH_HWMP_H_ + +#ifndef DBG_RTW_HWMP +#define DBG_RTW_HWMP 0 +#endif +#if DBG_RTW_HWMP +#define RTW_HWMP_DBG(fmt, arg...) RTW_PRINT(fmt, ##arg) +#else +#define RTW_HWMP_DBG(fmt, arg...) RTW_DBG(fmt, ##arg) +#endif + +#ifndef INFO_RTW_HWMP +#define INFO_RTW_HWMP 0 +#endif +#if INFO_RTW_HWMP +#define RTW_HWMP_INFO(fmt, arg...) RTW_PRINT(fmt, ##arg) +#else +#define RTW_HWMP_INFO(fmt, arg...) RTW_INFO(fmt, ##arg) +#endif + + +void rtw_ewma_err_rate_init(struct rtw_ewma_err_rate *e); +unsigned long rtw_ewma_err_rate_read(struct rtw_ewma_err_rate *e); +void rtw_ewma_err_rate_add(struct rtw_ewma_err_rate *e, unsigned long val); +int rtw_mesh_path_error_tx(_adapter *adapter, + u8 ttl, const u8 *target, u32 target_sn, + u16 target_rcode, const u8 *ra); +void rtw_ieee80211s_update_metric(_adapter *adapter, u8 mac_id, + u8 per, u8 rate, + u8 bw, u8 total_pkt); +void rtw_mesh_rx_path_sel_frame(_adapter *adapter, union recv_frame *rframe); +void rtw_mesh_queue_preq(struct rtw_mesh_path *mpath, u8 flags); +void rtw_mesh_path_start_discovery(_adapter *adapter); +void rtw_mesh_path_timer(void *ctx); +void rtw_mesh_path_tx_root_frame(_adapter *adapter); +void rtw_mesh_work_hdl(_workitem *work); +void rtw_ieee80211_mesh_path_timer(void *ctx); +void rtw_ieee80211_mesh_path_root_timer(void *ctx); +BOOLEAN rtw_ieee80211_mesh_root_setup(_adapter *adapter); +void rtw_mesh_work(_workitem *work); +void rtw_mesh_atlm_param_req_timer(void *ctx); + +#endif /* __RTW_MESH_HWMP_H_ */ + + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/mesh/rtw_mesh_pathtbl.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/mesh/rtw_mesh_pathtbl.c new file mode 100644 index 000000000000..930de2e42eec --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/mesh/rtw_mesh_pathtbl.c @@ -0,0 +1,1243 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + *****************************************************************************/ +#define _RTW_MESH_PATHTBL_C_ + +#ifdef CONFIG_RTW_MESH +#include +#include + +#ifdef PLATFORM_LINUX +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) +static void rtw_mpath_free_rcu(struct rtw_mesh_path *mpath) +{ + kfree_rcu(mpath, rcu); + rtw_mstat_update(MSTAT_TYPE_PHY, MSTAT_FREE, sizeof(struct rtw_mesh_path)); +} +#else +static void rtw_mpath_free_rcu_callback(rtw_rcu_head *head) +{ + struct rtw_mesh_path *mpath; + + mpath = container_of(head, struct rtw_mesh_path, rcu); + rtw_mfree(mpath, sizeof(struct rtw_mesh_path)); +} + +static void rtw_mpath_free_rcu(struct rtw_mesh_path *mpath) +{ + call_rcu(&mpath->rcu, rtw_mpath_free_rcu_callback); +} +#endif +#endif /* PLATFORM_LINUX */ + +static void rtw_mesh_path_free_rcu(struct rtw_mesh_table *tbl, struct rtw_mesh_path *mpath); + +static u32 rtw_mesh_table_hash(const void *addr, u32 len, u32 seed) +{ + /* Use last four bytes of hw addr as hash index */ + return jhash_1word(*(u32 *)(addr+2), seed); +} + +static const rtw_rhashtable_params rtw_mesh_rht_params = { + .nelem_hint = 2, + .automatic_shrinking = true, + .key_len = ETH_ALEN, + .key_offset = offsetof(struct rtw_mesh_path, dst), + .head_offset = offsetof(struct rtw_mesh_path, rhash), + .hashfn = rtw_mesh_table_hash, +}; + +static inline bool rtw_mpath_expired(struct rtw_mesh_path *mpath) +{ + return (mpath->flags & RTW_MESH_PATH_ACTIVE) && + rtw_time_after(rtw_get_current_time(), mpath->exp_time) && + !(mpath->flags & RTW_MESH_PATH_FIXED); +} + +static void rtw_mesh_path_rht_free(void *ptr, void *tblptr) +{ + struct rtw_mesh_path *mpath = ptr; + struct rtw_mesh_table *tbl = tblptr; + + rtw_mesh_path_free_rcu(tbl, mpath); +} + +static struct rtw_mesh_table *rtw_mesh_table_alloc(void) +{ + struct rtw_mesh_table *newtbl; + + newtbl = rtw_malloc(sizeof(struct rtw_mesh_table)); + if (!newtbl) + return NULL; + + rtw_hlist_head_init(&newtbl->known_gates); + ATOMIC_SET(&newtbl->entries, 0); + _rtw_spinlock_init(&newtbl->gates_lock); + + return newtbl; +} + +static void rtw_mesh_table_free(struct rtw_mesh_table *tbl) +{ + rtw_rhashtable_free_and_destroy(&tbl->rhead, + rtw_mesh_path_rht_free, tbl); + rtw_mfree(tbl, sizeof(struct rtw_mesh_table)); +} + +/** + * + * rtw_mesh_path_assign_nexthop - update mesh path next hop + * + * @mpath: mesh path to update + * @sta: next hop to assign + * + * Locking: mpath->state_lock must be held when calling this function + */ +void rtw_mesh_path_assign_nexthop(struct rtw_mesh_path *mpath, struct sta_info *sta) +{ + struct xmit_frame *xframe; + _list *list, *head; + + rtw_rcu_assign_pointer(mpath->next_hop, sta); + + enter_critical_bh(&mpath->frame_queue.lock); + head = &mpath->frame_queue.queue; + list = get_next(head); + while (rtw_end_of_queue_search(head, list) == _FALSE) { + xframe = LIST_CONTAINOR(list, struct xmit_frame, list); + list = get_next(list); + _rtw_memcpy(xframe->attrib.ra, sta->cmn.mac_addr, ETH_ALEN); + } + + exit_critical_bh(&mpath->frame_queue.lock); +} + +static void rtw_prepare_for_gate(struct xmit_frame *xframe, char *dst_addr, + struct rtw_mesh_path *gate_mpath) +{ + struct pkt_attrib *attrib = &xframe->attrib; + char *next_hop; + + if (attrib->mesh_frame_mode == MESH_UCAST_DATA) + attrib->mesh_frame_mode = MESH_UCAST_PX_DATA; + + /* update next hop */ + rtw_rcu_read_lock(); + next_hop = rtw_rcu_dereference(gate_mpath->next_hop)->cmn.mac_addr; + _rtw_memcpy(attrib->ra, next_hop, ETH_ALEN); + rtw_rcu_read_unlock(); + _rtw_memcpy(attrib->mda, dst_addr, ETH_ALEN); +} + +/** + * + * rtw_mesh_path_move_to_queue - Move or copy frames from one mpath queue to another + * + * This function is used to transfer or copy frames from an unresolved mpath to + * a gate mpath. The function also adds the Address Extension field and + * updates the next hop. + * + * If a frame already has an Address Extension field, only the next hop and + * destination addresses are updated. + * + * The gate mpath must be an active mpath with a valid mpath->next_hop. + * + * @mpath: An active mpath the frames will be sent to (i.e. the gate) + * @from_mpath: The failed mpath + * @copy: When true, copy all the frames to the new mpath queue. When false, + * move them. + */ +static void rtw_mesh_path_move_to_queue(struct rtw_mesh_path *gate_mpath, + struct rtw_mesh_path *from_mpath, + bool copy) +{ + struct xmit_frame *fskb; + _list *list, *head; + _list failq; + u32 failq_len; + _irqL flags; + + if (rtw_warn_on(gate_mpath == from_mpath)) + return; + if (rtw_warn_on(!gate_mpath->next_hop)) + return; + + _rtw_init_listhead(&failq); + + _enter_critical_bh(&from_mpath->frame_queue.lock, &flags); + rtw_list_splice_init(&from_mpath->frame_queue.queue, &failq); + failq_len = from_mpath->frame_queue_len; + from_mpath->frame_queue_len = 0; + _exit_critical_bh(&from_mpath->frame_queue.lock, &flags); + + head = &failq; + list = get_next(head); + while (rtw_end_of_queue_search(head, list) == _FALSE) { + if (gate_mpath->frame_queue_len >= RTW_MESH_FRAME_QUEUE_LEN) { + RTW_MPATH_DBG(FUNC_ADPT_FMT" mpath queue for gate %pM is full!\n" + , FUNC_ADPT_ARG(gate_mpath->adapter), gate_mpath->dst); + break; + } + + fskb = LIST_CONTAINOR(list, struct xmit_frame, list); + list = get_next(list); + + rtw_list_delete(&fskb->list); + failq_len--; + rtw_prepare_for_gate(fskb, gate_mpath->dst, gate_mpath); + _enter_critical_bh(&gate_mpath->frame_queue.lock, &flags); + rtw_list_insert_tail(&fskb->list, get_list_head(&gate_mpath->frame_queue)); + gate_mpath->frame_queue_len++; + _exit_critical_bh(&gate_mpath->frame_queue.lock, &flags); + + #if 0 /* TODO: copy */ + skb = rtw_skb_copy(fskb); + if (rtw_warn_on(!skb)) + break; + + rtw_prepare_for_gate(skb, gate_mpath->dst, gate_mpath); + skb_queue_tail(&gate_mpath->frame_queue, skb); + + if (copy) + continue; + + __skb_unlink(fskb, &failq); + rtw_skb_free(fskb); + #endif + } + + RTW_MPATH_DBG(FUNC_ADPT_FMT" mpath queue for gate %pM has %d frames\n" + , FUNC_ADPT_ARG(gate_mpath->adapter), gate_mpath->dst, gate_mpath->frame_queue_len); + + if (!copy) + return; + + _enter_critical_bh(&from_mpath->frame_queue.lock, &flags); + rtw_list_splice(&failq, &from_mpath->frame_queue.queue); + from_mpath->frame_queue_len += failq_len; + _exit_critical_bh(&from_mpath->frame_queue.lock, &flags); +} + + +static struct rtw_mesh_path *rtw_mpath_lookup(struct rtw_mesh_table *tbl, const u8 *dst) +{ + struct rtw_mesh_path *mpath; + + if (!tbl) + return NULL; + + mpath = rtw_rhashtable_lookup_fast(&tbl->rhead, dst, rtw_mesh_rht_params); + + if (mpath && rtw_mpath_expired(mpath)) { + enter_critical_bh(&mpath->state_lock); + mpath->flags &= ~RTW_MESH_PATH_ACTIVE; + exit_critical_bh(&mpath->state_lock); + } + return mpath; +} + +/** + * rtw_mesh_path_lookup - look up a path in the mesh path table + * @sdata: local subif + * @dst: hardware address (ETH_ALEN length) of destination + * + * Returns: pointer to the mesh path structure, or NULL if not found + * + * Locking: must be called within a read rcu section. + */ +struct rtw_mesh_path * +rtw_mesh_path_lookup(_adapter *adapter, const u8 *dst) +{ + return rtw_mpath_lookup(adapter->mesh_info.mesh_paths, dst); +} + +struct rtw_mesh_path * +rtw_mpp_path_lookup(_adapter *adapter, const u8 *dst) +{ + return rtw_mpath_lookup(adapter->mesh_info.mpp_paths, dst); +} + +static struct rtw_mesh_path * +__rtw_mesh_path_lookup_by_idx(struct rtw_mesh_table *tbl, int idx) +{ + int i = 0, ret; + struct rtw_mesh_path *mpath = NULL; + rtw_rhashtable_iter iter; + + if (!tbl) + return NULL; + + ret = rtw_rhashtable_walk_enter(&tbl->rhead, &iter); + if (ret) + return NULL; + + ret = rtw_rhashtable_walk_start(&iter); + if (ret && ret != -EAGAIN) + goto err; + + while ((mpath = rtw_rhashtable_walk_next(&iter))) { + if (IS_ERR(mpath) && PTR_ERR(mpath) == -EAGAIN) + continue; + if (IS_ERR(mpath)) + break; + if (i++ == idx) + break; + } +err: + rtw_rhashtable_walk_stop(&iter); + rtw_rhashtable_walk_exit(&iter); + + if (IS_ERR(mpath) || !mpath) + return NULL; + + if (rtw_mpath_expired(mpath)) { + enter_critical_bh(&mpath->state_lock); + mpath->flags &= ~RTW_MESH_PATH_ACTIVE; + exit_critical_bh(&mpath->state_lock); + } + return mpath; +} + +/** + * rtw_mesh_path_lookup_by_idx - look up a path in the mesh path table by its index + * @idx: index + * @sdata: local subif, or NULL for all entries + * + * Returns: pointer to the mesh path structure, or NULL if not found. + * + * Locking: must be called within a read rcu section. + */ +struct rtw_mesh_path * +rtw_mesh_path_lookup_by_idx(_adapter *adapter, int idx) +{ + return __rtw_mesh_path_lookup_by_idx(adapter->mesh_info.mesh_paths, idx); +} + +void dump_mpath(void *sel, _adapter *adapter) +{ + struct rtw_mesh_path *mpath; + int idx = 0; + char dst[ETH_ALEN]; + char next_hop[ETH_ALEN]; + u32 sn, metric, qlen; + u32 exp_ms = 0, dto_ms; + u8 drty; + enum rtw_mesh_path_flags flags; + + RTW_PRINT_SEL(sel, "%-17s %-17s %-10s %-10s %-4s %-6s %-6s %-4s flags\n" + , "dst", "next_hop", "sn", "metric", "qlen", "exp_ms", "dto_ms", "drty" + ); + + do { + rtw_rcu_read_lock(); + + mpath = rtw_mesh_path_lookup_by_idx(adapter, idx); + if (mpath) { + _rtw_memcpy(dst, mpath->dst, ETH_ALEN); + _rtw_memcpy(next_hop, mpath->next_hop->cmn.mac_addr, ETH_ALEN); + sn = mpath->sn; + metric = mpath->metric; + qlen = mpath->frame_queue_len; + if (rtw_time_after(mpath->exp_time, rtw_get_current_time())) + exp_ms = rtw_get_remaining_time_ms(mpath->exp_time); + dto_ms = rtw_systime_to_ms(mpath->discovery_timeout); + drty = mpath->discovery_retries; + flags = mpath->flags; + } + + rtw_rcu_read_unlock(); + + if (mpath) { + RTW_PRINT_SEL(sel, MAC_FMT" "MAC_FMT" %10u %10u %4u %6u %6u %4u%s%s%s%s%s%s%s%s%s%s\n" + , MAC_ARG(dst), MAC_ARG(next_hop), sn, metric, qlen + , exp_ms < 999999 ? exp_ms : 999999 + , dto_ms < 999999 ? dto_ms : 999999 + , drty + , (flags & RTW_MESH_PATH_ACTIVE) ? " ACT" : "" + , (flags & RTW_MESH_PATH_RESOLVING) ? " RSVING" : "" + , (flags & RTW_MESH_PATH_SN_VALID) ? " SN_VALID" : "" + , (flags & RTW_MESH_PATH_FIXED) ? " FIXED" : "" + , (flags & RTW_MESH_PATH_RESOLVED) ? " RSVED" : "" + , (flags & RTW_MESH_PATH_REQ_QUEUED) ? " REQ_IN_Q" : "" + , (flags & RTW_MESH_PATH_DELETED) ? " DELETED" : "" + , (flags & RTW_MESH_PATH_ROOT_ADD_CHK) ? " R_ADD_CHK" : "" + , (flags & RTW_MESH_PATH_PEER_AKA) ? " PEER_AKA" : "" + , (flags & RTW_MESH_PATH_BCAST_PREQ) ? " BC_PREQ" : "" + ); + } + + idx++; + } while (mpath); +} + +/** + * rtw_mpp_path_lookup_by_idx - look up a path in the proxy path table by its index + * @idx: index + * @sdata: local subif, or NULL for all entries + * + * Returns: pointer to the proxy path structure, or NULL if not found. + * + * Locking: must be called within a read rcu section. + */ +struct rtw_mesh_path * +rtw_mpp_path_lookup_by_idx(_adapter *adapter, int idx) +{ + return __rtw_mesh_path_lookup_by_idx(adapter->mesh_info.mpp_paths, idx); +} + +/** + * rtw_mesh_path_add_gate - add the given mpath to a mesh gate to our path table + * @mpath: gate path to add to table + */ +int rtw_mesh_path_add_gate(struct rtw_mesh_path *mpath) +{ + struct rtw_mesh_cfg *mcfg; + struct rtw_mesh_info *minfo; + struct rtw_mesh_table *tbl; + int err, ori_num_gates; + + rtw_rcu_read_lock(); + tbl = mpath->adapter->mesh_info.mesh_paths; + if (!tbl) { + err = -ENOENT; + goto err_rcu; + } + + enter_critical_bh(&mpath->state_lock); + mcfg = &mpath->adapter->mesh_cfg; + mpath->gate_timeout = rtw_get_current_time() + + rtw_ms_to_systime(mcfg->path_gate_timeout_factor * + mpath->gate_ann_int); + if (mpath->is_gate) { + err = -EEXIST; + exit_critical_bh(&mpath->state_lock); + goto err_rcu; + } + + minfo = &mpath->adapter->mesh_info; + mpath->is_gate = true; + _rtw_spinlock(&tbl->gates_lock); + ori_num_gates = minfo->num_gates; + minfo->num_gates++; + rtw_hlist_add_head_rcu(&mpath->gate_list, &tbl->known_gates); + + if (ori_num_gates == 0 + || rtw_macaddr_is_larger(mpath->dst, minfo->max_addr_gate->dst) + ) { + minfo->max_addr_gate = mpath; + minfo->max_addr_gate_is_larger_than_self = + rtw_macaddr_is_larger(mpath->dst, adapter_mac_addr(mpath->adapter)); + } + + _rtw_spinunlock(&tbl->gates_lock); + + exit_critical_bh(&mpath->state_lock); + + if (ori_num_gates == 0) { + update_beacon(mpath->adapter, WLAN_EID_MESH_CONFIG, NULL, _TRUE); + #if CONFIG_RTW_MESH_CTO_MGATE_CARRIER + if (!rtw_mesh_cto_mgate_required(mpath->adapter)) + rtw_netif_carrier_on(mpath->adapter->pnetdev); + #endif + } + + RTW_MPATH_DBG( + FUNC_ADPT_FMT" Mesh path: Recorded new gate: %pM. %d known gates\n", + FUNC_ADPT_ARG(mpath->adapter), + mpath->dst, mpath->adapter->mesh_info.num_gates); + err = 0; +err_rcu: + rtw_rcu_read_unlock(); + return err; +} + +/** + * rtw_mesh_gate_del - remove a mesh gate from the list of known gates + * @tbl: table which holds our list of known gates + * @mpath: gate mpath + */ +void rtw_mesh_gate_del(struct rtw_mesh_table *tbl, struct rtw_mesh_path *mpath) +{ + struct rtw_mesh_cfg *mcfg; + struct rtw_mesh_info *minfo; + int ori_num_gates; + + rtw_lockdep_assert_held(&mpath->state_lock); + if (!mpath->is_gate) + return; + + mcfg = &mpath->adapter->mesh_cfg; + minfo = &mpath->adapter->mesh_info; + + mpath->is_gate = false; + enter_critical_bh(&tbl->gates_lock); + rtw_hlist_del_rcu(&mpath->gate_list); + ori_num_gates = minfo->num_gates; + minfo->num_gates--; + + if (ori_num_gates == 1) { + minfo->max_addr_gate = NULL; + minfo->max_addr_gate_is_larger_than_self = 0; + } else if (minfo->max_addr_gate == mpath) { + struct rtw_mesh_path *gate, *max_addr_gate = NULL; + rtw_hlist_node *node; + + rtw_hlist_for_each_entry_rcu(gate, node, &tbl->known_gates, gate_list) { + if (!max_addr_gate || rtw_macaddr_is_larger(gate->dst, max_addr_gate->dst)) + max_addr_gate = gate; + } + minfo->max_addr_gate = max_addr_gate; + minfo->max_addr_gate_is_larger_than_self = + rtw_macaddr_is_larger(max_addr_gate->dst, adapter_mac_addr(mpath->adapter)); + } + + exit_critical_bh(&tbl->gates_lock); + + if (ori_num_gates == 1) { + update_beacon(mpath->adapter, WLAN_EID_MESH_CONFIG, NULL, _TRUE); + #if CONFIG_RTW_MESH_CTO_MGATE_CARRIER + if (rtw_mesh_cto_mgate_required(mpath->adapter)) + rtw_netif_carrier_off(mpath->adapter->pnetdev); + #endif + } + + RTW_MPATH_DBG( + FUNC_ADPT_FMT" Mesh path: Deleted gate: %pM. %d known gates\n", + FUNC_ADPT_ARG(mpath->adapter), + mpath->dst, mpath->adapter->mesh_info.num_gates); +} + +/** + * rtw_mesh_gate_search - search a mesh gate from the list of known gates + * @tbl: table which holds our list of known gates + * @addr: address of gate + */ +bool rtw_mesh_gate_search(struct rtw_mesh_table *tbl, const u8 *addr) +{ + struct rtw_mesh_path *gate; + rtw_hlist_node *node; + bool exist = 0; + + rtw_rcu_read_lock(); + rtw_hlist_for_each_entry_rcu(gate, node, &tbl->known_gates, gate_list) { + if (_rtw_memcmp(gate->dst, addr, ETH_ALEN) == _TRUE) { + exist = 1; + break; + } + } + + rtw_rcu_read_unlock(); + + return exist; +} + +/** + * rtw_mesh_gate_num - number of gates known to this interface + * @sdata: subif data + */ +int rtw_mesh_gate_num(_adapter *adapter) +{ + return adapter->mesh_info.num_gates; +} + +bool rtw_mesh_is_primary_gate(_adapter *adapter) +{ + struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; + struct rtw_mesh_info *minfo = &adapter->mesh_info; + + return mcfg->dot11MeshGateAnnouncementProtocol + && !minfo->max_addr_gate_is_larger_than_self; +} + +void dump_known_gates(void *sel, _adapter *adapter) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct rtw_mesh_table *tbl; + struct rtw_mesh_path *gate; + rtw_hlist_node *node; + + if (!rtw_mesh_gate_num(adapter)) + goto exit; + + rtw_rcu_read_lock(); + + tbl = minfo->mesh_paths; + if (!tbl) + goto unlock; + + RTW_PRINT_SEL(sel, "num:%d\n", rtw_mesh_gate_num(adapter)); + + rtw_hlist_for_each_entry_rcu(gate, node, &tbl->known_gates, gate_list) { + RTW_PRINT_SEL(sel, "%c"MAC_FMT"\n" + , gate == minfo->max_addr_gate ? '*' : ' ' + , MAC_ARG(gate->dst)); + } + +unlock: + rtw_rcu_read_unlock(); +exit: + return; +} + +static +struct rtw_mesh_path *rtw_mesh_path_new(_adapter *adapter, + const u8 *dst) +{ + struct rtw_mesh_path *new_mpath; + + new_mpath = rtw_zmalloc(sizeof(struct rtw_mesh_path)); + if (!new_mpath) + return NULL; + + _rtw_memcpy(new_mpath->dst, dst, ETH_ALEN); + _rtw_memset(new_mpath->rann_snd_addr, 0xFF, ETH_ALEN); + new_mpath->is_root = false; + new_mpath->adapter = adapter; + new_mpath->flags = 0; + new_mpath->gate_asked = false; + _rtw_init_queue(&new_mpath->frame_queue); + new_mpath->frame_queue_len = 0; + new_mpath->exp_time = rtw_get_current_time(); + _rtw_spinlock_init(&new_mpath->state_lock); + rtw_init_timer(&new_mpath->timer, adapter, rtw_mesh_path_timer, new_mpath); + + return new_mpath; +} + +/** + * rtw_mesh_path_add - allocate and add a new path to the mesh path table + * @dst: destination address of the path (ETH_ALEN length) + * @sdata: local subif + * + * Returns: 0 on success + * + * State: the initial state of the new path is set to 0 + */ +struct rtw_mesh_path *rtw_mesh_path_add(_adapter *adapter, + const u8 *dst) +{ + struct rtw_mesh_table *tbl = adapter->mesh_info.mesh_paths; + struct rtw_mesh_path *mpath, *new_mpath; + int ret; + + if (!tbl) + return ERR_PTR(-ENOTSUPP); + + if (_rtw_memcmp(dst, adapter_mac_addr(adapter), ETH_ALEN) == _TRUE) + /* never add ourselves as neighbours */ + return ERR_PTR(-ENOTSUPP); + + if (is_multicast_mac_addr(dst)) + return ERR_PTR(-ENOTSUPP); + + if (ATOMIC_INC_UNLESS(&adapter->mesh_info.mpaths, RTW_MESH_MAX_MPATHS) == 0) + return ERR_PTR(-ENOSPC); + + new_mpath = rtw_mesh_path_new(adapter, dst); + if (!new_mpath) + return ERR_PTR(-ENOMEM); + + do { + ret = rtw_rhashtable_lookup_insert_fast(&tbl->rhead, + &new_mpath->rhash, + rtw_mesh_rht_params); + + if (ret == -EEXIST) + mpath = rtw_rhashtable_lookup_fast(&tbl->rhead, + dst, + rtw_mesh_rht_params); + + } while (unlikely(ret == -EEXIST && !mpath)); + + if (ret && ret != -EEXIST) + return ERR_PTR(ret); + + /* At this point either new_mpath was added, or we found a + * matching entry already in the table; in the latter case + * free the unnecessary new entry. + */ + if (ret == -EEXIST) { + rtw_mfree(new_mpath, sizeof(struct rtw_mesh_path)); + new_mpath = mpath; + } + adapter->mesh_info.mesh_paths_generation++; + return new_mpath; +} + +int rtw_mpp_path_add(_adapter *adapter, + const u8 *dst, const u8 *mpp) +{ + struct rtw_mesh_table *tbl = adapter->mesh_info.mpp_paths; + struct rtw_mesh_path *new_mpath; + int ret; + + if (!tbl) + return -ENOTSUPP; + + if (_rtw_memcmp(dst, adapter_mac_addr(adapter), ETH_ALEN) == _TRUE) + /* never add ourselves as neighbours */ + return -ENOTSUPP; + + if (is_multicast_mac_addr(dst)) + return -ENOTSUPP; + + new_mpath = rtw_mesh_path_new(adapter, dst); + + if (!new_mpath) + return -ENOMEM; + + _rtw_memcpy(new_mpath->mpp, mpp, ETH_ALEN); + ret = rtw_rhashtable_lookup_insert_fast(&tbl->rhead, + &new_mpath->rhash, + rtw_mesh_rht_params); + + adapter->mesh_info.mpp_paths_generation++; + return ret; +} + +void dump_mpp(void *sel, _adapter *adapter) +{ + struct rtw_mesh_path *mpath; + int idx = 0; + char dst[ETH_ALEN]; + char mpp[ETH_ALEN]; + + RTW_PRINT_SEL(sel, "%-17s %-17s\n", "dst", "mpp"); + + do { + rtw_rcu_read_lock(); + + mpath = rtw_mpp_path_lookup_by_idx(adapter, idx); + if (mpath) { + _rtw_memcpy(dst, mpath->dst, ETH_ALEN); + _rtw_memcpy(mpp, mpath->mpp, ETH_ALEN); + } + + rtw_rcu_read_unlock(); + + if (mpath) { + RTW_PRINT_SEL(sel, MAC_FMT" "MAC_FMT"\n" + , MAC_ARG(dst), MAC_ARG(mpp)); + } + + idx++; + } while (mpath); +} + +/** + * rtw_mesh_plink_broken - deactivates paths and sends perr when a link breaks + * + * @sta: broken peer link + * + * This function must be called from the rate control algorithm if enough + * delivery errors suggest that a peer link is no longer usable. + */ +void rtw_mesh_plink_broken(struct sta_info *sta) +{ + _adapter *adapter = sta->padapter; + struct rtw_mesh_table *tbl = adapter->mesh_info.mesh_paths; + static const u8 bcast[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; + struct rtw_mesh_path *mpath; + rtw_rhashtable_iter iter; + int ret; + + if (!tbl) + return; + + ret = rtw_rhashtable_walk_enter(&tbl->rhead, &iter); + if (ret) + return; + + ret = rtw_rhashtable_walk_start(&iter); + if (ret && ret != -EAGAIN) + goto out; + + while ((mpath = rtw_rhashtable_walk_next(&iter))) { + if (IS_ERR(mpath) && PTR_ERR(mpath) == -EAGAIN) + continue; + if (IS_ERR(mpath)) + break; + if (rtw_rcu_access_pointer(mpath->next_hop) == sta && + mpath->flags & RTW_MESH_PATH_ACTIVE && + !(mpath->flags & RTW_MESH_PATH_FIXED)) { + enter_critical_bh(&mpath->state_lock); + mpath->flags &= ~RTW_MESH_PATH_ACTIVE; + ++mpath->sn; + exit_critical_bh(&mpath->state_lock); + rtw_mesh_path_error_tx(adapter, + adapter->mesh_cfg.element_ttl, + mpath->dst, mpath->sn, + WLAN_REASON_MESH_PATH_DEST_UNREACHABLE, bcast); + } + } +out: + rtw_rhashtable_walk_stop(&iter); + rtw_rhashtable_walk_exit(&iter); +} + +static void rtw_mesh_path_free_rcu(struct rtw_mesh_table *tbl, + struct rtw_mesh_path *mpath) +{ + _adapter *adapter = mpath->adapter; + + enter_critical_bh(&mpath->state_lock); + mpath->flags |= RTW_MESH_PATH_RESOLVING | RTW_MESH_PATH_DELETED; + rtw_mesh_gate_del(tbl, mpath); + exit_critical_bh(&mpath->state_lock); + _cancel_timer_ex(&mpath->timer); + ATOMIC_DEC(&adapter->mesh_info.mpaths); + ATOMIC_DEC(&tbl->entries); + _rtw_spinlock_free(&mpath->state_lock); + + rtw_mesh_path_flush_pending(mpath); + + rtw_mpath_free_rcu(mpath); +} + +static void __rtw_mesh_path_del(struct rtw_mesh_table *tbl, struct rtw_mesh_path *mpath) +{ + rtw_rhashtable_remove_fast(&tbl->rhead, &mpath->rhash, rtw_mesh_rht_params); + rtw_mesh_path_free_rcu(tbl, mpath); +} + +/** + * rtw_mesh_path_flush_by_nexthop - Deletes mesh paths if their next hop matches + * + * @sta: mesh peer to match + * + * RCU notes: this function is called when a mesh plink transitions from + * PLINK_ESTAB to any other state, since PLINK_ESTAB state is the only one that + * allows path creation. This will happen before the sta can be freed (because + * sta_info_destroy() calls this) so any reader in a rcu read block will be + * protected against the plink disappearing. + */ +void rtw_mesh_path_flush_by_nexthop(struct sta_info *sta) +{ + _adapter *adapter = sta->padapter; + struct rtw_mesh_table *tbl = adapter->mesh_info.mesh_paths; + struct rtw_mesh_path *mpath; + rtw_rhashtable_iter iter; + int ret; + + if (!tbl) + return; + + ret = rtw_rhashtable_walk_enter(&tbl->rhead, &iter); + if (ret) + return; + + ret = rtw_rhashtable_walk_start(&iter); + if (ret && ret != -EAGAIN) + goto out; + + while ((mpath = rtw_rhashtable_walk_next(&iter))) { + if (IS_ERR(mpath) && PTR_ERR(mpath) == -EAGAIN) + continue; + if (IS_ERR(mpath)) + break; + + if (rtw_rcu_access_pointer(mpath->next_hop) == sta) + __rtw_mesh_path_del(tbl, mpath); + } +out: + rtw_rhashtable_walk_stop(&iter); + rtw_rhashtable_walk_exit(&iter); +} + +static void rtw_mpp_flush_by_proxy(_adapter *adapter, + const u8 *proxy) +{ + struct rtw_mesh_table *tbl = adapter->mesh_info.mpp_paths; + struct rtw_mesh_path *mpath; + rtw_rhashtable_iter iter; + int ret; + + if (!tbl) + return; + + ret = rtw_rhashtable_walk_enter(&tbl->rhead, &iter); + if (ret) + return; + + ret = rtw_rhashtable_walk_start(&iter); + if (ret && ret != -EAGAIN) + goto out; + + while ((mpath = rtw_rhashtable_walk_next(&iter))) { + if (IS_ERR(mpath) && PTR_ERR(mpath) == -EAGAIN) + continue; + if (IS_ERR(mpath)) + break; + + if (_rtw_memcmp(mpath->mpp, proxy, ETH_ALEN) == _TRUE) + __rtw_mesh_path_del(tbl, mpath); + } +out: + rtw_rhashtable_walk_stop(&iter); + rtw_rhashtable_walk_exit(&iter); +} + +static void rtw_table_flush_by_iface(struct rtw_mesh_table *tbl) +{ + struct rtw_mesh_path *mpath; + rtw_rhashtable_iter iter; + int ret; + + if (!tbl) + return; + + ret = rtw_rhashtable_walk_enter(&tbl->rhead, &iter); + if (ret) + return; + + ret = rtw_rhashtable_walk_start(&iter); + if (ret && ret != -EAGAIN) + goto out; + + while ((mpath = rtw_rhashtable_walk_next(&iter))) { + if (IS_ERR(mpath) && PTR_ERR(mpath) == -EAGAIN) + continue; + if (IS_ERR(mpath)) + break; + __rtw_mesh_path_del(tbl, mpath); + } +out: + rtw_rhashtable_walk_stop(&iter); + rtw_rhashtable_walk_exit(&iter); +} + +/** + * rtw_mesh_path_flush_by_iface - Deletes all mesh paths associated with a given iface + * + * This function deletes both mesh paths as well as mesh portal paths. + * + * @sdata: interface data to match + * + */ +void rtw_mesh_path_flush_by_iface(_adapter *adapter) +{ + rtw_table_flush_by_iface(adapter->mesh_info.mesh_paths); + rtw_table_flush_by_iface(adapter->mesh_info.mpp_paths); +} + +/** + * rtw_table_path_del - delete a path from the mesh or mpp table + * + * @tbl: mesh or mpp path table + * @sdata: local subif + * @addr: dst address (ETH_ALEN length) + * + * Returns: 0 if successful + */ +static int rtw_table_path_del(struct rtw_mesh_table *tbl, + const u8 *addr) +{ + struct rtw_mesh_path *mpath; + + if (!tbl) + return -ENXIO; + + rtw_rcu_read_lock(); + mpath = rtw_rhashtable_lookup_fast(&tbl->rhead, addr, rtw_mesh_rht_params); + if (!mpath) { + rtw_rcu_read_unlock(); + return -ENXIO; + } + + __rtw_mesh_path_del(tbl, mpath); + rtw_rcu_read_unlock(); + return 0; +} + + +/** + * rtw_mesh_path_del - delete a mesh path from the table + * + * @addr: dst address (ETH_ALEN length) + * @sdata: local subif + * + * Returns: 0 if successful + */ +int rtw_mesh_path_del(_adapter *adapter, const u8 *addr) +{ + int err; + + /* flush relevant mpp entries first */ + rtw_mpp_flush_by_proxy(adapter, addr); + + err = rtw_table_path_del(adapter->mesh_info.mesh_paths, addr); + adapter->mesh_info.mesh_paths_generation++; + return err; +} + +/** + * rtw_mesh_path_tx_pending - sends pending frames in a mesh path queue + * + * @mpath: mesh path to activate + * + * Locking: the state_lock of the mpath structure must NOT be held when calling + * this function. + */ +void rtw_mesh_path_tx_pending(struct rtw_mesh_path *mpath) +{ + if (mpath->flags & RTW_MESH_PATH_ACTIVE) { + struct rtw_mesh_info *minfo = &mpath->adapter->mesh_info; + _list q; + u32 q_len = 0; + + _rtw_init_listhead(&q); + + /* move to local queue */ + enter_critical_bh(&mpath->frame_queue.lock); + if (mpath->frame_queue_len) { + rtw_list_splice_init(&mpath->frame_queue.queue, &q); + q_len = mpath->frame_queue_len; + mpath->frame_queue_len = 0; + } + exit_critical_bh(&mpath->frame_queue.lock); + + if (q_len) { + /* move to mpath_tx_queue */ + enter_critical_bh(&minfo->mpath_tx_queue.lock); + rtw_list_splice_tail(&q, &minfo->mpath_tx_queue.queue); + minfo->mpath_tx_queue_len += q_len; + exit_critical_bh(&minfo->mpath_tx_queue.lock); + + /* schedule mpath_tx_tasklet */ + tasklet_hi_schedule(&minfo->mpath_tx_tasklet); + } + } +} + +/** + * rtw_mesh_path_send_to_gates - sends pending frames to all known mesh gates + * + * @mpath: mesh path whose queue will be emptied + * + * If there is only one gate, the frames are transferred from the failed mpath + * queue to that gate's queue. If there are more than one gates, the frames + * are copied from each gate to the next. After frames are copied, the + * mpath queues are emptied onto the transmission queue. + */ +int rtw_mesh_path_send_to_gates(struct rtw_mesh_path *mpath) +{ + _adapter *adapter = mpath->adapter; + struct rtw_mesh_table *tbl; + struct rtw_mesh_path *from_mpath = mpath; + struct rtw_mesh_path *gate; + bool copy = false; + rtw_hlist_node *node; + + tbl = adapter->mesh_info.mesh_paths; + if (!tbl) + return 0; + + rtw_rcu_read_lock(); + rtw_hlist_for_each_entry_rcu(gate, node, &tbl->known_gates, gate_list) { + if (gate->flags & RTW_MESH_PATH_ACTIVE) { + RTW_MPATH_DBG(FUNC_ADPT_FMT" Forwarding to %pM\n", + FUNC_ADPT_ARG(adapter), gate->dst); + rtw_mesh_path_move_to_queue(gate, from_mpath, copy); + from_mpath = gate; + copy = true; + } else { + RTW_MPATH_DBG( + FUNC_ADPT_FMT" Not forwarding to %pM (flags %#x)\n", + FUNC_ADPT_ARG(adapter), gate->dst, gate->flags); + } + } + + rtw_hlist_for_each_entry_rcu(gate, node, &tbl->known_gates, gate_list) { + RTW_MPATH_DBG(FUNC_ADPT_FMT" Sending to %pM\n", + FUNC_ADPT_ARG(adapter), gate->dst); + rtw_mesh_path_tx_pending(gate); + } + rtw_rcu_read_unlock(); + + return (from_mpath == mpath) ? -EHOSTUNREACH : 0; +} + +/** + * rtw_mesh_path_discard_frame - discard a frame whose path could not be resolved + * + * @skb: frame to discard + * @sdata: network subif the frame was to be sent through + * + * Locking: the function must me called within a rcu_read_lock region + */ +void rtw_mesh_path_discard_frame(_adapter *adapter, + struct xmit_frame *xframe) +{ + rtw_free_xmitframe(&adapter->xmitpriv, xframe); + adapter->mesh_info.mshstats.dropped_frames_no_route++; +} + +/** + * rtw_mesh_path_flush_pending - free the pending queue of a mesh path + * + * @mpath: mesh path whose queue has to be freed + * + * Locking: the function must me called within a rcu_read_lock region + */ +void rtw_mesh_path_flush_pending(struct rtw_mesh_path *mpath) +{ + struct xmit_frame *xframe; + _list *list, *head; + _list tmp; + + _rtw_init_listhead(&tmp); + + enter_critical_bh(&mpath->frame_queue.lock); + rtw_list_splice_init(&mpath->frame_queue.queue, &tmp); + mpath->frame_queue_len = 0; + exit_critical_bh(&mpath->frame_queue.lock); + + head = &tmp; + list = get_next(head); + while (rtw_end_of_queue_search(head, list) == _FALSE) { + xframe = LIST_CONTAINOR(list, struct xmit_frame, list); + list = get_next(list); + rtw_list_delete(&xframe->list); + rtw_mesh_path_discard_frame(mpath->adapter, xframe); + } +} + +/** + * rtw_mesh_path_fix_nexthop - force a specific next hop for a mesh path + * + * @mpath: the mesh path to modify + * @next_hop: the next hop to force + * + * Locking: this function must be called holding mpath->state_lock + */ +void rtw_mesh_path_fix_nexthop(struct rtw_mesh_path *mpath, struct sta_info *next_hop) +{ + enter_critical_bh(&mpath->state_lock); + rtw_mesh_path_assign_nexthop(mpath, next_hop); + mpath->sn = 0xffff; + mpath->metric = 0; + mpath->hop_count = 0; + mpath->exp_time = 0; + mpath->flags = RTW_MESH_PATH_FIXED | RTW_MESH_PATH_SN_VALID; + rtw_mesh_path_activate(mpath); + exit_critical_bh(&mpath->state_lock); + rtw_ewma_err_rate_init(&next_hop->metrics.err_rate); + /* init it at a low value - 0 start is tricky */ + rtw_ewma_err_rate_add(&next_hop->metrics.err_rate, 1); + rtw_mesh_path_tx_pending(mpath); +} + +int rtw_mesh_pathtbl_init(_adapter *adapter) +{ + struct rtw_mesh_table *tbl_path, *tbl_mpp; + int ret; + + tbl_path = rtw_mesh_table_alloc(); + if (!tbl_path) + return -ENOMEM; + + tbl_mpp = rtw_mesh_table_alloc(); + if (!tbl_mpp) { + ret = -ENOMEM; + goto free_path; + } + + rtw_rhashtable_init(&tbl_path->rhead, &rtw_mesh_rht_params); + rtw_rhashtable_init(&tbl_mpp->rhead, &rtw_mesh_rht_params); + + adapter->mesh_info.mesh_paths = tbl_path; + adapter->mesh_info.mpp_paths = tbl_mpp; + + return 0; + +free_path: + rtw_mesh_table_free(tbl_path); + return ret; +} + +static +void rtw_mesh_path_tbl_expire(_adapter *adapter, + struct rtw_mesh_table *tbl) +{ + struct rtw_mesh_path *mpath; + rtw_rhashtable_iter iter; + int ret; + + if (!tbl) + return; + + ret = rtw_rhashtable_walk_enter(&tbl->rhead, &iter); + if (ret) + return; + + ret = rtw_rhashtable_walk_start(&iter); + if (ret && ret != -EAGAIN) + goto out; + + while ((mpath = rtw_rhashtable_walk_next(&iter))) { + if (IS_ERR(mpath) && PTR_ERR(mpath) == -EAGAIN) + continue; + if (IS_ERR(mpath)) + break; + if ((!(mpath->flags & RTW_MESH_PATH_RESOLVING)) && + (!(mpath->flags & RTW_MESH_PATH_FIXED)) && + rtw_time_after(rtw_get_current_time(), mpath->exp_time + RTW_MESH_PATH_EXPIRE)) + __rtw_mesh_path_del(tbl, mpath); + + if (mpath->is_gate && /* need not to deal with non-gate case */ + rtw_time_after(rtw_get_current_time(), mpath->gate_timeout)) { + RTW_MPATH_DBG(FUNC_ADPT_FMT"mpath [%pM] expired systime is %lu systime is %lu\n", + FUNC_ADPT_ARG(adapter), mpath->dst, + mpath->gate_timeout, rtw_get_current_time()); + enter_critical_bh(&mpath->state_lock); + if (mpath->gate_asked) { /* asked gate before */ + rtw_mesh_gate_del(tbl, mpath); + exit_critical_bh(&mpath->state_lock); + } else { + mpath->gate_asked = true; + mpath->gate_timeout = rtw_get_current_time() + rtw_ms_to_systime(mpath->gate_ann_int); + exit_critical_bh(&mpath->state_lock); + rtw_mesh_queue_preq(mpath, RTW_PREQ_Q_F_START | RTW_PREQ_Q_F_REFRESH); + RTW_MPATH_DBG(FUNC_ADPT_FMT"mpath [%pM] ask mesh gate existence (is_root=%d)\n", + FUNC_ADPT_ARG(adapter), mpath->dst, mpath->is_root); + } + } + } + +out: + rtw_rhashtable_walk_stop(&iter); + rtw_rhashtable_walk_exit(&iter); +} + +void rtw_mesh_path_expire(_adapter *adapter) +{ + rtw_mesh_path_tbl_expire(adapter, adapter->mesh_info.mesh_paths); + rtw_mesh_path_tbl_expire(adapter, adapter->mesh_info.mpp_paths); +} + +void rtw_mesh_pathtbl_unregister(_adapter *adapter) +{ + if (adapter->mesh_info.mesh_paths) { + rtw_mesh_table_free(adapter->mesh_info.mesh_paths); + adapter->mesh_info.mesh_paths = NULL; + } + + if (adapter->mesh_info.mpp_paths) { + rtw_mesh_table_free(adapter->mesh_info.mpp_paths); + adapter->mesh_info.mpp_paths = NULL; + } +} +#endif /* CONFIG_RTW_MESH */ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/mesh/rtw_mesh_pathtbl.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/mesh/rtw_mesh_pathtbl.h new file mode 100644 index 000000000000..0d494cddc192 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/mesh/rtw_mesh_pathtbl.h @@ -0,0 +1,212 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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_MESH_PATHTBL_H_ +#define __RTW_MESH_PATHTBL_H_ + +#ifndef DBG_RTW_MPATH +#define DBG_RTW_MPATH 1 +#endif +#if DBG_RTW_MPATH +#define RTW_MPATH_DBG(fmt, arg...) RTW_PRINT(fmt, ##arg) +#else +#define RTW_MPATH_DBG(fmt, arg...) do {} while (0) +#endif + +/** + * enum rtw_mesh_path_flags - mesh path flags + * + * @RTW_MESH_PATH_ACTIVE: the mesh path can be used for forwarding + * @RTW_MESH_PATH_RESOLVING: the discovery process is running for this mesh path + * @RTW_MESH_PATH_SN_VALID: the mesh path contains a valid destination sequence + * number + * @RTW_MESH_PATH_FIXED: the mesh path has been manually set and should not be + * modified + * @RTW_MESH_PATH_RESOLVED: the mesh path can has been resolved + * @RTW_MESH_PATH_REQ_QUEUED: there is an unsent path request for this destination + * already queued up, waiting for the discovery process to start. + * @RTW_MESH_PATH_DELETED: the mesh path has been deleted and should no longer + * be used + * @RTW_MESH_PATH_ROOT_ADD_CHK: root additional check in root mode. + * With this flag, It will try the last used rann_snd_addr + * @RTW_MESH_PATH_PEER_AKA: only used toward a peer, only used in active keep + * alive mechanism. PREQ's da = path dst + * @RTW_MESH_PATH_BCAST_PREQ: for re-checking next hop resolve toward root. + * Use it to force path_discover sending broadcast PREQ for root. + * + * RTW_MESH_PATH_RESOLVED is used by the mesh path timer to + * decide when to stop or cancel the mesh path discovery. + */ +enum rtw_mesh_path_flags { + RTW_MESH_PATH_ACTIVE = BIT(0), + RTW_MESH_PATH_RESOLVING = BIT(1), + RTW_MESH_PATH_SN_VALID = BIT(2), + RTW_MESH_PATH_FIXED = BIT(3), + RTW_MESH_PATH_RESOLVED = BIT(4), + RTW_MESH_PATH_REQ_QUEUED = BIT(5), + RTW_MESH_PATH_DELETED = BIT(6), + RTW_MESH_PATH_ROOT_ADD_CHK = BIT(7), + RTW_MESH_PATH_PEER_AKA = BIT(8), + RTW_MESH_PATH_BCAST_PREQ = BIT(9), +}; + +/** + * struct rtw_mesh_path - mesh path structure + * + * @dst: mesh path destination mac address + * @mpp: mesh proxy mac address + * @rhash: rhashtable list pointer + * @gate_list: list pointer for known gates list + * @sdata: mesh subif + * @next_hop: mesh neighbor to which frames for this destination will be + * forwarded + * @timer: mesh path discovery timer + * @frame_queue: pending queue for frames sent to this destination while the + * path is unresolved + * @rcu: rcu head for freeing mesh path + * @sn: target sequence number + * @metric: current metric to this destination + * @hop_count: hops to destination + * @exp_time: in jiffies, when the path will expire or when it expired + * @discovery_timeout: timeout (lapse in jiffies) used for the last discovery + * retry + * @discovery_retries: number of discovery retries + * @flags: mesh path flags, as specified on &enum rtw_mesh_path_flags + * @state_lock: mesh path state lock used to protect changes to the + * mpath itself. No need to take this lock when adding or removing + * an mpath to a hash bucket on a path table. + * @rann_snd_addr: the RANN sender address + * @rann_metric: the aggregated path metric towards the root node + * @last_preq_to_root: Timestamp of last PREQ sent to root + * @is_root: the destination station of this path is a root node + * @is_gate: the destination station of this path is a mesh gate + * + * + * The dst address is unique in the mesh path table. Since the mesh_path is + * protected by RCU, deleting the next_hop STA must remove / substitute the + * mesh_path structure and wait until that is no longer reachable before + * destroying the STA completely. + */ +struct rtw_mesh_path { + u8 dst[ETH_ALEN]; + u8 mpp[ETH_ALEN]; /* used for MPP or MAP */ + rtw_rhash_head rhash; + rtw_hlist_node gate_list; + _adapter *adapter; + struct sta_info __rcu *next_hop; + _timer timer; + _queue frame_queue; + u32 frame_queue_len; + rtw_rcu_head rcu; + u32 sn; + u32 metric; + u8 hop_count; + systime exp_time; + systime discovery_timeout; + systime gate_timeout; + u32 gate_ann_int; /* gate announce interval */ + u8 discovery_retries; + enum rtw_mesh_path_flags flags; + _lock state_lock; + u8 rann_snd_addr[ETH_ALEN]; +#ifdef CONFIG_RTW_MESH_ADD_ROOT_CHK + u8 add_chk_rann_snd_addr[ETH_ALEN]; +#endif + u32 rann_metric; + unsigned long last_preq_to_root; + bool is_root; + bool is_gate; + bool gate_asked; +}; + +/** + * struct rtw_mesh_table + * + * @known_gates: list of known mesh gates and their mpaths by the station. The + * gate's mpath may or may not be resolved and active. + * @gates_lock: protects updates to known_gates + * @rhead: the rhashtable containing struct mesh_paths, keyed by dest addr + * @entries: number of entries in the table + */ +struct rtw_mesh_table { + rtw_hlist_head known_gates; + _lock gates_lock; + rtw_rhashtable rhead; + ATOMIC_T entries; +}; + +#define RTW_MESH_PATH_EXPIRE (600 * HZ) + +/* Maximum number of paths per interface */ +#define RTW_MESH_MAX_MPATHS 1024 + +/* Number of frames buffered per destination for unresolved destinations */ +#define RTW_MESH_FRAME_QUEUE_LEN 10 + +int rtw_mesh_nexthop_lookup(_adapter *adapter, + const u8 *mda, const u8 *msa, u8 *ra); +int rtw_mesh_nexthop_resolve(_adapter *adapter, + struct xmit_frame *xframe); + +struct rtw_mesh_path *rtw_mesh_path_lookup(_adapter *adapter, + const u8 *dst); +struct rtw_mesh_path *rtw_mpp_path_lookup(_adapter *adapter, + const u8 *dst); +int rtw_mpp_path_add(_adapter *adapter, + const u8 *dst, const u8 *mpp); +void dump_mpp(void *sel, _adapter *adapter); + +struct rtw_mesh_path * +rtw_mesh_path_lookup_by_idx(_adapter *adapter, int idx); +void dump_mpath(void *sel, _adapter *adapter); + +struct rtw_mesh_path * +rtw_mpp_path_lookup_by_idx(_adapter *adapter, int idx); +void rtw_mesh_path_fix_nexthop(struct rtw_mesh_path *mpath, struct sta_info *next_hop); +void rtw_mesh_path_expire(_adapter *adapter); + +struct rtw_mesh_path * +rtw_mesh_path_add(_adapter *adapter, const u8 *dst); + +int rtw_mesh_path_add_gate(struct rtw_mesh_path *mpath); +void rtw_mesh_gate_del(struct rtw_mesh_table *tbl, struct rtw_mesh_path *mpath); +bool rtw_mesh_gate_search(struct rtw_mesh_table *tbl, const u8 *addr); +int rtw_mesh_path_send_to_gates(struct rtw_mesh_path *mpath); +int rtw_mesh_gate_num(_adapter *adapter); +bool rtw_mesh_is_primary_gate(_adapter *adapter); +void dump_known_gates(void *sel, _adapter *adapter); + +void rtw_mesh_plink_broken(struct sta_info *sta); + +void rtw_mesh_path_assign_nexthop(struct rtw_mesh_path *mpath, struct sta_info *sta); +void rtw_mesh_path_flush_pending(struct rtw_mesh_path *mpath); +void rtw_mesh_path_tx_pending(struct rtw_mesh_path *mpath); +int rtw_mesh_pathtbl_init(_adapter *adapter); +void rtw_mesh_pathtbl_unregister(_adapter *adapter); +int rtw_mesh_path_del(_adapter *adapter, const u8 *addr); + +void rtw_mesh_path_flush_by_nexthop(struct sta_info *sta); +void rtw_mesh_path_discard_frame(_adapter *adapter, + struct xmit_frame *xframe); + +static inline void rtw_mesh_path_activate(struct rtw_mesh_path *mpath) +{ + mpath->flags |= RTW_MESH_PATH_ACTIVE | RTW_MESH_PATH_RESOLVED; +} + +void rtw_mesh_path_flush_by_iface(_adapter *adapter); + +#endif /* __RTW_MESH_PATHTBL_H_ */ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_ap.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_ap.c index dc5f8d1647be..6b8e79f7d498 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_ap.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_ap.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 @@ -32,13 +28,10 @@ extern unsigned char WFD_OUI[]; void init_mlme_ap_info(_adapter *padapter) { - struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); _rtw_spinlock_init(&pmlmepriv->bcn_update_lock); - /* pmlmeext->bstart_bss = _FALSE; */ - } void free_mlme_ap_info(_adapter *padapter) @@ -50,6 +43,49 @@ void free_mlme_ap_info(_adapter *padapter) } +/* +* Set TIM IE +* return length of total TIM IE +*/ +u8 rtw_set_tim_ie(u8 dtim_cnt, u8 dtim_period + , const u8 *tim_bmp, u8 tim_bmp_len, u8 *tim_ie) +{ + u8 *p = tim_ie; + u8 i, n1, n2; + u8 bmp_len; + + if (rtw_bmp_not_empty(tim_bmp, tim_bmp_len)) { + /* find the first nonzero octet in tim_bitmap */ + for (i = 0; i < tim_bmp_len; i++) + if (tim_bmp[i]) + break; + n1 = i & 0xFE; + + /* find the last nonzero octet in tim_bitmap, except octet 0 */ + for (i = tim_bmp_len - 1; i > 0; i--) + if (tim_bmp[i]) + break; + n2 = i; + bmp_len = n2 - n1 + 1; + } else { + n1 = n2 = 0; + bmp_len = 1; + } + + *p++ = WLAN_EID_TIM; + *p++ = 2 + 1 + bmp_len; + *p++ = dtim_cnt; + *p++ = dtim_period; + *p++ = (rtw_bmp_is_set(tim_bmp, tim_bmp_len, 0) ? BIT0 : 0) | n1; + _rtw_memcpy(p, tim_bmp + n1, bmp_len); + +#if 0 + RTW_INFO("n1:%u, n2:%u, bmp_offset:%u, bmp_len:%u\n", n1, n2, n1 / 2, bmp_len); + RTW_INFO_DUMP("tim_ie: ", tim_ie + 2, 2 + 1 + bmp_len); +#endif + return 2 + 2 + 1 + bmp_len; +} + static void update_BCNTIM(_adapter *padapter) { struct sta_priv *pstapriv = &padapter->stapriv; @@ -62,15 +98,12 @@ static void update_BCNTIM(_adapter *padapter) /* update TIM IE */ - /* if(pstapriv->tim_bitmap) */ + /* if(rtw_tim_map_anyone_be_set(padapter, pstapriv->tim_bitmap)) */ #endif if (_TRUE) { u8 *p, *dst_ie, *premainder_ie = NULL, *pbackup_remainder_ie = NULL; - u16 tim_bitmap_le; uint offset, tmp_len, tim_ielen, tim_ie_offset, remainder_ielen; - tim_bitmap_le = cpu_to_le16(pstapriv->tim_bitmap); - p = rtw_get_ie(pie + _FIXED_IE_LENGTH_, _TIM_IE_, &tim_ielen, pnetwork_mlmeext->IELength - _FIXED_IE_LENGTH_); if (p != NULL && tim_ielen > 0) { tim_ielen += 2; @@ -117,39 +150,8 @@ static void update_BCNTIM(_adapter *padapter) _rtw_memcpy(pbackup_remainder_ie, premainder_ie, remainder_ielen); } - *dst_ie++ = _TIM_IE_; - - if ((pstapriv->tim_bitmap & 0xff00) && (pstapriv->tim_bitmap & 0x00fe)) - tim_ielen = 5; - else - tim_ielen = 4; - - *dst_ie++ = tim_ielen; - - *dst_ie++ = 0;/*DTIM count*/ - *dst_ie++ = 1;/*DTIM period*/ - - if (pstapriv->tim_bitmap & BIT(0))/*for bc/mc frames*/ - *dst_ie++ = BIT(0);/*bitmap ctrl */ - else - *dst_ie++ = 0; - - if (tim_ielen == 4) { - u8 pvb = 0; - - if (pstapriv->tim_bitmap & 0x00fe) - pvb = (u8)tim_bitmap_le; - else if (pstapriv->tim_bitmap & 0xff00) - pvb = (u8)(tim_bitmap_le >> 8); - else - pvb = (u8)tim_bitmap_le; - - *dst_ie++ = pvb; - - } else if (tim_ielen == 5) { - _rtw_memcpy(dst_ie, &tim_bitmap_le, 2); - dst_ie += 2; - } + /* append TIM IE */ + dst_ie += rtw_set_tim_ie(0, 1, pstapriv->tim_bitmap, pstapriv->aid_bmp_len, dst_ie); /*copy remainder IE*/ if (pbackup_remainder_ie) { @@ -274,8 +276,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.undecorated_smoothed_pwdb + , 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 @@ -294,11 +296,107 @@ u8 chk_sta_is_alive(struct sta_info *psta) } else ret = _TRUE; +#ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(psta->padapter)) { + u8 bcn_alive, hwmp_alive; + + hwmp_alive = (psta->sta_stats.rx_hwmp_pkts != + psta->sta_stats.last_rx_hwmp_pkts); + bcn_alive = (psta->sta_stats.rx_beacon_pkts != + psta->sta_stats.last_rx_beacon_pkts); + /* The reference for nexthop_lookup */ + psta->alive = ret || hwmp_alive || bcn_alive; + /* The reference for expire_timeout_chk */ + /* Exclude bcn_alive to avoid a misjudge condition + that a peer unexpectedly leave and restart quickly*/ + ret = ret || hwmp_alive; + } +#endif + sta_update_last_rx_pkts(psta); return ret; } +/** + * issue_aka_chk_frame - issue active keep alive check frame + * aka = active keep alive + */ +#ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK +static int issue_aka_chk_frame(_adapter *adapter, struct sta_info *psta) +{ + int ret = _FAIL; + u8 *target_addr = psta->cmn.mac_addr; + + if (MLME_IS_AP(adapter)) { + /* issue null data to check sta alive */ + if (psta->state & WIFI_SLEEP_STATE) + ret = issue_nulldata(adapter, target_addr, 0, 1, 50); + else + ret = issue_nulldata(adapter, target_addr, 0, 3, 50); + } + +#ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(adapter)) { + struct rtw_mesh_path *mpath; + + rtw_rcu_read_lock(); + mpath = rtw_mesh_path_lookup(adapter, target_addr); + if (!mpath) { + mpath = rtw_mesh_path_add(adapter, target_addr); + if (IS_ERR(mpath)) { + rtw_rcu_read_unlock(); + RTW_ERR(FUNC_ADPT_FMT" rtw_mesh_path_add for "MAC_FMT" fail.\n", + FUNC_ADPT_ARG(adapter), MAC_ARG(target_addr)); + return _FAIL; + } + } + if (mpath->flags & RTW_MESH_PATH_ACTIVE) + ret = _SUCCESS; + else { + u8 flags = RTW_PREQ_Q_F_START | RTW_PREQ_Q_F_PEER_AKA; + /* issue PREQ to check peer alive */ + rtw_mesh_queue_preq(mpath, flags); + ret = _FALSE; + } + rtw_rcu_read_unlock(); + } +#endif + return ret; +} +#endif + +#ifdef RTW_CONFIG_RFREG18_WA +static void rtw_check_restore_rf18(_adapter *padapter) +{ + PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + u32 reg; + u8 union_ch = 0, union_bw = 0, union_offset = 0, setchbw = _FALSE; + + reg = rtw_hal_read_rfreg(padapter, 0, 0x18, 0x3FF); + if ((reg & 0xFF) == 0) + setchbw = _TRUE; + reg = rtw_hal_read_rfreg(padapter, 1, 0x18, 0x3FF); + if ((reg & 0xFF) == 0) + setchbw = _TRUE; + + if (setchbw) { + if (!rtw_mi_get_ch_setting_union(padapter, &union_ch, &union_bw, &union_offset)) { + RTW_INFO("Hit RF(0x18)=0!! restore original channel setting.\n"); + union_ch = pmlmeext->cur_channel; + union_offset = pmlmeext->cur_ch_offset ; + union_bw = pmlmeext->cur_bwmode; + } else { + RTW_INFO("Hit RF(0x18)=0!! set ch(%x) offset(%x) bwmode(%x)\n", union_ch, union_offset, union_bw); + } + /* Initial the channel_bw setting procedure. */ + pHalData->current_channel = 0; + set_channel_bwmode(padapter, union_ch, union_offset, union_bw); + } +} +#endif + void expire_timeout_chk(_adapter *padapter) { _irqL irqL; @@ -310,6 +408,22 @@ void expire_timeout_chk(_adapter *padapter) char chk_alive_list[NUM_STA]; int i; +#ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(padapter) + && check_fwstate(&padapter->mlmepriv, WIFI_ASOC_STATE) + ) { + struct rtw_mesh_cfg *mcfg = &padapter->mesh_cfg; + + rtw_mesh_path_expire(padapter); + + /* TBD: up layer timeout mechanism */ + /* if (!mcfg->plink_timeout) + return; */ +#ifndef CONFIG_ACTIVE_KEEP_ALIVE_CHECK + return; +#endif + } +#endif #ifdef CONFIG_MCC_MODE /* then driver may check fail due to not recv client's frame under sitesurvey, @@ -327,8 +441,8 @@ void expire_timeout_chk(_adapter *padapter) /* check auth_queue */ #ifdef DBG_EXPIRATION_CHK if (rtw_end_of_queue_search(phead, plist) == _FALSE) { - RTW_INFO(FUNC_NDEV_FMT" auth_list, cnt:%u\n" - , FUNC_NDEV_ARG(padapter->pnetdev), pstapriv->auth_list_cnt); + RTW_INFO(FUNC_ADPT_FMT" auth_list, cnt:%u\n" + , FUNC_ADPT_ARG(padapter), pstapriv->auth_list_cnt); } #endif while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { @@ -338,7 +452,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; @@ -349,8 +463,8 @@ void expire_timeout_chk(_adapter *padapter) rtw_list_delete(&psta->auth_list); 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]); + RTW_INFO(FUNC_ADPT_FMT" auth expire "MAC_FMT"\n" + , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr)); _exit_critical_bh(&pstapriv->auth_list_lock, &irqL); @@ -376,8 +490,8 @@ void expire_timeout_chk(_adapter *padapter) /* check asoc_queue */ #ifdef DBG_EXPIRATION_CHK if (rtw_end_of_queue_search(phead, plist) == _FALSE) { - RTW_INFO(FUNC_NDEV_FMT" asoc_list, cnt:%u\n" - , FUNC_NDEV_ARG(padapter->pnetdev), pstapriv->asoc_list_cnt); + RTW_INFO(FUNC_ADPT_FMT" asoc_list, cnt:%u\n" + , FUNC_ADPT_ARG(padapter), pstapriv->asoc_list_cnt); } #endif while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { @@ -385,8 +499,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 +535,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 +587,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,38 +611,32 @@ 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); + rtw_tim_map_set(padapter, pstapriv->tim_bitmap, psta->cmn.aid); update_beacon(padapter, _TIM_IE_, NULL, _TRUE); if (!pmlmeext->active_keep_alive_check) continue; } } -#ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK - if (pmlmeext->active_keep_alive_check) { + + { int stainfo_offset; stainfo_offset = rtw_stainfo_offset(pstapriv, psta); if (stainfo_offset_valid(stainfo_offset)) chk_alive_list[chk_alive_num++] = stainfo_offset; - continue; } -#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); - 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 */ if (psta->sleepq_len > (NR_XMITFRAME / pstapriv->asoc_list_cnt) && 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) + RTW_INFO(FUNC_ADPT_FMT" sta:"MAC_FMT", sleepq_len:%u, free_xmitframe_cnt:%u, asoc_list_cnt:%u, clear sleep_q\n" + , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr) , psta->sleepq_len, padapter->xmitpriv.free_xmitframe_cnt, pstapriv->asoc_list_cnt); wakeup_sta_to_xmit(padapter, psta); } @@ -537,115 +645,145 @@ void expire_timeout_chk(_adapter *padapter) _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); -#ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK if (chk_alive_num) { - - u8 backup_ch = 0, backup_bw, backup_offset; - u8 union_ch = 0, union_bw, union_offset; - u8 switch_channel = _TRUE; +#if defined(CONFIG_ACTIVE_KEEP_ALIVE_CHECK) + u8 backup_ch = 0, backup_bw = 0, backup_offset = 0; + u8 union_ch = 0, union_bw = 0, union_offset = 0; + u8 switch_channel_by_drv = _TRUE; struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - - if (!rtw_mi_get_ch_setting_union(padapter, &union_ch, &union_bw, &union_offset) - || pmlmeext->cur_channel != union_ch) - goto bypass_active_keep_alive; - -#ifdef CONFIG_MCC_MODE - if (MCC_EN(padapter)) { - /* driver doesn't switch channel under MCC */ - if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) - switch_channel = _FALSE; - } #endif - /* switch to correct channel of current network before issue keep-alive frames */ - if (switch_channel == _TRUE && rtw_get_oper_ch(padapter) != pmlmeext->cur_channel) { - backup_ch = rtw_get_oper_ch(padapter); - backup_bw = rtw_get_oper_bw(padapter); - backup_offset = rtw_get_oper_choffset(padapter); - set_channel_bwmode(padapter, union_ch, union_offset, union_bw); - } + char del_asoc_list[NUM_STA]; - /* issue null data to check sta alive*/ + _rtw_memset(del_asoc_list, NUM_STA, NUM_STA); + + #ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK + if (pmlmeext->active_keep_alive_check) { + #ifdef CONFIG_MCC_MODE + if (MCC_EN(padapter)) { + /* driver doesn't switch channel under MCC */ + if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) + switch_channel_by_drv = _FALSE; + } + #endif + + if (!rtw_mi_get_ch_setting_union(padapter, &union_ch, &union_bw, &union_offset) + || pmlmeext->cur_channel != union_ch) + switch_channel_by_drv = _FALSE; + + /* switch to correct channel of current network before issue keep-alive frames */ + if (switch_channel_by_drv == _TRUE && rtw_get_oper_ch(padapter) != pmlmeext->cur_channel) { + backup_ch = rtw_get_oper_ch(padapter); + backup_bw = rtw_get_oper_bw(padapter); + backup_offset = rtw_get_oper_choffset(padapter); + set_channel_bwmode(padapter, union_ch, union_offset, union_bw); + } + } + #endif /* CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ + + /* check loop */ for (i = 0; i < chk_alive_num; i++) { + #ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK int ret = _FAIL; + #endif 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)) + + #ifdef CONFIG_ATMEL_RC_PATCH + if (_rtw_memcmp(pstapriv->atmel_rc_pattern, psta->cmn.mac_addr, ETH_ALEN) == _TRUE) continue; if (psta->flag_atmel_rc) continue; -#endif + #endif + if (!(psta->state & _FW_LINKED)) continue; - if (psta->state & WIFI_SLEEP_STATE) - ret = issue_nulldata(padapter, psta->hwaddr, 0, 1, 50); - else - ret = issue_nulldata(padapter, psta->hwaddr, 0, 3, 50); + #ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK + if (pmlmeext->active_keep_alive_check) { + /* issue active keep alive frame to check */ + ret = issue_aka_chk_frame(padapter, psta); - psta->keep_alive_trycnt++; - if (ret == _SUCCESS) { - RTW_INFO("asoc check, sta(" MAC_FMT ") is alive\n", MAC_ARG(psta->hwaddr)); - psta->expire_to = pstapriv->expire_to; - psta->keep_alive_trycnt = 0; - continue; - } else if (psta->keep_alive_trycnt <= 3) { - RTW_INFO("ack check for asoc expire, keep_alive_trycnt=%d\n", psta->keep_alive_trycnt); - psta->expire_to = 1; - continue; + psta->keep_alive_trycnt++; + if (ret == _SUCCESS) { + RTW_INFO(FUNC_ADPT_FMT" asoc check, "MAC_FMT" is alive\n" + , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr)); + psta->expire_to = pstapriv->expire_to; + psta->keep_alive_trycnt = 0; + continue; + } else if (psta->keep_alive_trycnt <= 3) { + RTW_INFO(FUNC_ADPT_FMT" asoc check, "MAC_FMT" keep_alive_trycnt=%d\n" + , FUNC_ADPT_ARG(padapter) , MAC_ARG(psta->cmn.mac_addr), psta->keep_alive_trycnt); + psta->expire_to = 1; + continue; + } } + #endif /* CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ psta->keep_alive_trycnt = 0; - RTW_INFO("asoc expire "MAC_FMT", state=0x%x\n", MAC_ARG(psta->hwaddr), psta->state); + del_asoc_list[i] = chk_alive_list[i]; _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); if (rtw_is_list_empty(&psta->asoc_list) == _FALSE) { rtw_list_delete(&psta->asoc_list); pstapriv->asoc_list_cnt--; - updated = ap_free_sta(padapter, psta, _FALSE, WLAN_REASON_DEAUTH_LEAVING, _TRUE); + STA_SET_MESH_PLINK(psta, NULL); } _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); - } - /* back to the original operation channel */ - if (switch_channel && backup_ch > 0) - set_channel_bwmode(padapter, backup_ch, backup_offset, backup_bw); + /* delete loop */ + for (i = 0; i < chk_alive_num; i++) { + u8 sta_addr[ETH_ALEN]; -bypass_active_keep_alive: - ; + if (del_asoc_list[i] >= NUM_STA) + continue; + + psta = rtw_get_stainfo_by_offset(pstapriv, del_asoc_list[i]); + _rtw_memcpy(sta_addr, psta->cmn.mac_addr, ETH_ALEN); + + RTW_INFO(FUNC_ADPT_FMT" asoc expire "MAC_FMT", state=0x%x\n" + , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr), psta->state); + updated |= ap_free_sta(padapter, psta, _FALSE, WLAN_REASON_DEAUTH_LEAVING, _FALSE); + #ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(padapter)) + rtw_mesh_expire_peer(padapter, sta_addr); + #endif + } + + #ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK + if (pmlmeext->active_keep_alive_check) { + /* back to the original operation channel */ + if (switch_channel_by_drv == _TRUE && backup_ch > 0) + set_channel_bwmode(padapter, backup_ch, backup_offset, backup_bw); + } + #endif } -#endif /* CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ +#ifdef RTW_CONFIG_RFREG18_WA + rtw_check_restore_rf18(padapter); +#endif associated_clients_update(padapter, updated, STA_INFO_UPDATE_ALL); } -void add_RATid(_adapter *padapter, struct sta_info *psta, u8 rssi_level, u8 is_update_bw) +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 +793,6 @@ void add_RATid(_adapter *padapter, struct sta_info *psta, u8 rssi_level, u8 is_u if (psta->vhtpriv.vht_option) sta_band = WIRELESS_11_5AC; #endif - } else { if (tx_ra_bitmap & 0xffff000) sta_band |= WIRELESS_11_24N; @@ -668,16 +805,181 @@ void add_RATid(_adapter *padapter, struct sta_info *psta, u8 rssi_level, u8 is_u } 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, is_update_bw); - } 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) +{ +#ifdef CONFIG_BMC_TX_LOW_RATE + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); +#endif + 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,8 +992,13 @@ 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->qos_option = 0; + psta->cmn.aid = 0;/* default set to 0 */ +#ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(padapter)) + psta->qos_option = 1; + else +#endif + psta->qos_option = 0; #ifdef CONFIG_80211N_HT psta->htpriv.ht_option = _FALSE; #endif /* CONFIG_80211N_HT */ @@ -702,7 +1009,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 +1022,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, psta->rssi_level, _TRUE); + 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 +1080,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,10 +1088,7 @@ 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) + if (!MLME_IS_MESH(padapter) && psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) psta->ieee8021x_blocked = _TRUE; else psta->ieee8021x_blocked = _FALSE; @@ -774,15 +1108,19 @@ 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 (phtpriv_sta->op_present + && !GET_HT_OP_ELE_STA_CHL_WIDTH(phtpriv_sta->ht_op)) + 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 +1131,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 +1143,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 +1180,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,19 +1191,24 @@ 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); + + /* Check encryption */ + if (!MLME_IS_MESH(padapter) && psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) + psta->state |= WIFI_UNDER_KEY_HANDSHAKE; + psta->state |= _FW_LINKED; + _exit_critical_bh(&psta->lock, &irqL); - - } static void update_ap_info(_adapter *padapter, struct sta_info *psta) { struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; - struct security_priv *psecuritypriv = &padapter->securitypriv; struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); #ifdef CONFIG_80211N_HT struct ht_priv *phtpriv_ap = &pmlmepriv->htpriv; @@ -913,7 +1240,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 */ @@ -932,7 +1259,7 @@ static void update_ap_info(_adapter *padapter, struct sta_info *psta) static void rtw_set_hw_wmm_param(_adapter *padapter) { - u8 ACI, ACM, AIFS, ECWMin, ECWMax, aSifsTime; + u8 AIFS, ECWMin, ECWMax, aSifsTime; u8 acm_mask; u16 TXOP; u32 acParm, i; @@ -943,11 +1270,13 @@ static void rtw_set_hw_wmm_param(_adapter *padapter) struct registry_priv *pregpriv = &padapter->registrypriv; acm_mask = 0; - - if (is_supported_5g(pmlmeext->cur_wireless_mode) || - (pmlmeext->cur_wireless_mode & WIRELESS_11_24N)) +#ifdef CONFIG_80211N_HT + if (pregpriv->ht_enable && + (is_supported_5g(pmlmeext->cur_wireless_mode) || + (pmlmeext->cur_wireless_mode & WIRELESS_11_24N))) aSifsTime = 16; else +#endif /* CONFIG_80211N_HT */ aSifsTime = 10; if (pmlmeinfo->WMM_enable == 0) { @@ -1077,12 +1406,11 @@ static void rtw_set_hw_wmm_param(_adapter *padapter) } } - +#ifdef CONFIG_80211N_HT static void update_hw_ht_param(_adapter *padapter) { unsigned char max_AMPDU_len; unsigned char min_MPDU_spacing; - struct registry_priv *pregpriv = &padapter->registrypriv; struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); @@ -1122,7 +1450,7 @@ static void update_hw_ht_param(_adapter *padapter) /* pmlmeinfo->HT_protection = pmlmeinfo->HT_info.infos[1] & 0x3; */ } - +#endif /* CONFIG_80211N_HT */ static void rtw_ap_check_scan(_adapter *padapter) { _irqL irqL; @@ -1146,13 +1474,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 +1488,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 +1505,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); @@ -1212,9 +1541,9 @@ 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 } void rtw_start_bss_hdl_after_chbw_decided(_adapter *adapter) @@ -1246,10 +1575,58 @@ void rtw_start_bss_hdl_after_chbw_decided(_adapter *adapter) update_ap_info(adapter, sta); } +#ifdef CONFIG_FW_HANDLE_TXBCN +bool rtw_ap_nums_check(_adapter *adapter) +{ + if (rtw_ap_get_nums(adapter) < CONFIG_LIMITED_AP_NUM) + return _TRUE; + return _FALSE; +} +u8 rtw_ap_allocate_vapid(struct dvobj_priv *dvobj) +{ + u8 vap_id; + + for (vap_id = 0; vap_id < CONFIG_LIMITED_AP_NUM; vap_id++) { + if (!(dvobj->vap_map & BIT(vap_id))) + break; + } + + if (vap_id < CONFIG_LIMITED_AP_NUM) + dvobj->vap_map |= BIT(vap_id); + + return vap_id; +} +u8 rtw_ap_release_vapid(struct dvobj_priv *dvobj, u8 vap_id) +{ + if (vap_id >= CONFIG_LIMITED_AP_NUM) { + RTW_ERR("%s - vapid(%d) failed\n", __func__, vap_id); + rtw_warn_on(1); + return _FAIL; + } + dvobj->vap_map &= ~ BIT(vap_id); + return _SUCCESS; +} +#endif +static void _rtw_iface_undersurvey_chk(const char *func, _adapter *adapter) +{ + int i; + _adapter *iface; + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + struct mlme_priv *pmlmepriv; + + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + if ((iface) && rtw_is_adapter_up(iface)) { + pmlmepriv = &iface->mlmepriv; + if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY)) + RTW_ERR("%s ("ADPT_FMT") under survey\n", func, ADPT_ARG(iface)); + } + } +} void start_bss_network(_adapter *padapter, struct createbss_parm *parm) { #define DUMP_ADAPTERS_STATUS 0 - + u8 mlme_act = MLME_ACTION_UNKNOWN; u8 val8; u16 bcn_interval; u32 acparm; @@ -1261,22 +1638,31 @@ void start_bss_network(_adapter *padapter, struct createbss_parm *parm) struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); WLAN_BSSID_EX *pnetwork_mlmeext = &(pmlmeinfo->network); struct dvobj_priv *pdvobj = padapter->dvobj; - s16 req_ch = -1, req_bw = -1, req_offset = -1; - bool ch_setting_changed = _FALSE; + s16 req_ch = REQ_CH_NONE, req_bw = REQ_BW_NONE, req_offset = REQ_OFFSET_NONE; u8 ch_to_set = 0, bw_to_set, offset_to_set; u8 doiqk = _FALSE; /* use for check ch bw offset can be allowed or not */ u8 chbw_allow = _TRUE; + int i; + u8 ifbmp_ch_changed = 0; if (parm->req_ch != 0) { /* bypass other setting, go checking ch, bw, offset */ + mlme_act = MLME_OPCH_SWITCH; 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 */ + /* request comes from upper layer */ + if (MLME_IS_AP(padapter)) + mlme_act = MLME_AP_STARTED; + else if (MLME_IS_MESH(padapter)) + mlme_act = MLME_MESH_STARTED; + else + rtw_warn_on(1); req_ch = 0; + _rtw_memcpy(pnetwork_mlmeext, pnetwork, pnetwork->Length); } bcn_interval = (u16)pnetwork->Configuration.BeaconPeriod; @@ -1312,7 +1698,9 @@ void start_bss_network(_adapter *padapter, struct createbss_parm *parm) if (pmlmepriv->cur_network.join_res != _TRUE) { /* setting only at first time */ /* WEP Key will be set before this function, do not clear CAM. */ - if ((psecuritypriv->dot11PrivacyAlgrthm != _WEP40_) && (psecuritypriv->dot11PrivacyAlgrthm != _WEP104_)) + if ((psecuritypriv->dot11PrivacyAlgrthm != _WEP40_) && (psecuritypriv->dot11PrivacyAlgrthm != _WEP104_) + && !MLME_IS_MESH(padapter) /* mesh group key is set before this function */ + ) flush_all_cam_entry(padapter); /* clear CAM */ } @@ -1322,21 +1710,6 @@ void start_bss_network(_adapter *padapter, struct createbss_parm *parm) /* Set BSSID REG */ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, pnetwork->MacAddress); - /* Set EDCA param reg */ -#ifdef CONFIG_CONCURRENT_MODE - acparm = 0x005ea42b; -#else - acparm = 0x002F3217; /* VO */ -#endif - rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VO, (u8 *)(&acparm)); - acparm = 0x005E4317; /* VI */ - rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VI, (u8 *)(&acparm)); - /* acparm = 0x00105320; */ /* BE */ - acparm = 0x005ea42b; - rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acparm)); - acparm = 0x0000A444; /* BK */ - rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BK, (u8 *)(&acparm)); - /* Set Security */ val8 = (psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) ? 0xcc : 0xcf; rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, (u8 *)(&val8)); @@ -1344,17 +1717,31 @@ void start_bss_network(_adapter *padapter, struct createbss_parm *parm) /* Beacon Control related register */ rtw_hal_set_hwreg(padapter, HW_VAR_BEACON_INTERVAL, (u8 *)(&bcn_interval)); + rtw_hal_rcr_set_chk_bssid(padapter, mlme_act); + chbw_decision: - 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); + ifbmp_ch_changed = rtw_ap_chbw_decision(padapter, parm->ifbmp, parm->excl_ifbmp + , 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); + for (i = 0; i < pdvobj->iface_nums; i++) { + if (!(parm->ifbmp & BIT(i)) || !pdvobj->padapters[i]) + continue; - rtw_start_bss_hdl_after_chbw_decided(padapter); + /* let pnetwork_mlme == pnetwork_mlmeext */ + _rtw_memcpy(&(pdvobj->padapters[i]->mlmepriv.cur_network.network) + , &(pdvobj->padapters[i]->mlmeextpriv.mlmext_info.network) + , pdvobj->padapters[i]->mlmeextpriv.mlmext_info.network.Length); + + rtw_start_bss_hdl_after_chbw_decided(pdvobj->padapters[i]); + + /* Set EDCA param reg after update cur_wireless_mode & update_capinfo */ + if (pregpriv->wifi_spec == 1) + rtw_set_hw_wmm_param(pdvobj->padapters[i]); + } #if defined(CONFIG_DFS_MASTER) - rtw_dfs_master_status_apply(padapter, MLME_AP_STARTED); + rtw_dfs_rd_en_decision(padapter, mlme_act, parm->excl_ifbmp); #endif #ifdef CONFIG_MCC_MODE @@ -1377,8 +1764,10 @@ void start_bss_network(_adapter *padapter, struct createbss_parm *parm) rtw_hal_mcc_issue_null_data(padapter, chbw_allow, 1); #endif /* CONFIG_MCC_MODE */ - doiqk = _TRUE; - rtw_hal_set_hwreg(padapter , HW_VAR_DO_IQK , &doiqk); + if (!IS_CH_WAITING(adapter_to_rfctl(padapter))) { + doiqk = _TRUE; + rtw_hal_set_hwreg(padapter , HW_VAR_DO_IQK , &doiqk); + } if (ch_to_set != 0) { set_channel_bwmode(padapter, ch_to_set, offset_to_set, bw_to_set); @@ -1393,72 +1782,124 @@ void start_bss_network(_adapter *padapter, struct createbss_parm *parm) rtw_hal_set_mcc_setting_start_bss_network(padapter, chbw_allow); #endif +#if defined(CONFIG_IOCTL_CFG80211) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 5, 0)) + for (i = 0; i < pdvobj->iface_nums; i++) { + if (!(ifbmp_ch_changed & BIT(i)) || !pdvobj->padapters[i]) + continue; + + /* pure AP is not needed*/ + if (MLME_IS_GO(pdvobj->padapters[i]) + || MLME_IS_MESH(pdvobj->padapters[i]) + ) { + u8 ht_option = 0; + + #ifdef CONFIG_80211N_HT + ht_option = pdvobj->padapters[i]->mlmepriv.htpriv.ht_option; + #endif + + rtw_cfg80211_ch_switch_notify(pdvobj->padapters[i] + , pdvobj->padapters[i]->mlmeextpriv.cur_channel + , pdvobj->padapters[i]->mlmeextpriv.cur_bwmode + , pdvobj->padapters[i]->mlmeextpriv.cur_ch_offset + , ht_option); + } + } +#endif /* defined(CONFIG_IOCTL_CFG80211) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 5, 0)) */ + if (DUMP_ADAPTERS_STATUS) { RTW_INFO(FUNC_ADPT_FMT" done\n", FUNC_ADPT_ARG(padapter)); dump_adapters_status(RTW_DBGDUMP , adapter_to_dvobj(padapter)); } +#ifdef CONFIG_MCC_MODE update_beacon: - /* update beacon content only if bstart_bss is _TRUE */ - if (_TRUE == pmlmeext->bstart_bss) { +#endif + for (i = 0; i < pdvobj->iface_nums; i++) { + struct mlme_priv *mlme; + + if (!(parm->ifbmp & BIT(i)) || !pdvobj->padapters[i]) + continue; + + /* update beacon content only if bstart_bss is _TRUE */ + if (pdvobj->padapters[i]->mlmeextpriv.bstart_bss != _TRUE) + continue; + + mlme = &(pdvobj->padapters[i]->mlmepriv); + + #ifdef CONFIG_80211N_HT + if ((ATOMIC_READ(&mlme->olbc) == _TRUE) || (ATOMIC_READ(&mlme->olbc_ht) == _TRUE)) { + /* AP is not starting a 40 MHz BSS in presence of an 802.11g BSS. */ + mlme->ht_op_mode &= (~HT_INFO_OPERATION_MODE_OP_MODE_MASK); + mlme->ht_op_mode |= OP_MODE_MAY_BE_LEGACY_STAS; + update_beacon(pdvobj->padapters[i], _HT_ADD_INFO_IE_, NULL, _FALSE); + } + #endif + + update_beacon(pdvobj->padapters[i], _TIM_IE_, NULL, _FALSE); + } + + if (mlme_act != MLME_OPCH_SWITCH + && pmlmeext->bstart_bss == _TRUE + ) { +#ifdef CONFIG_SUPPORT_MULTI_BCN _irqL irqL; - 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); - } - - update_beacon(padapter, _TIM_IE_, NULL, _FALSE); - -#ifdef CONFIG_SWTIMER_BASED_TXBCN _enter_critical_bh(&pdvobj->ap_if_q.lock, &irqL); if (rtw_is_list_empty(&padapter->list)) { + #ifdef CONFIG_FW_HANDLE_TXBCN + padapter->vap_id = rtw_ap_allocate_vapid(pdvobj); + #endif rtw_list_insert_tail(&padapter->list, get_list_head(&pdvobj->ap_if_q)); pdvobj->nr_ap_if++; pdvobj->inter_bcn_space = DEFAULT_BCN_INTERVAL / pdvobj->nr_ap_if; } _exit_critical_bh(&pdvobj->ap_if_q.lock, &irqL); + #ifdef CONFIG_SWTIMER_BASED_TXBCN + rtw_ap_set_mbid_num(padapter, pdvobj->nr_ap_if); rtw_hal_set_hwreg(padapter, HW_VAR_BEACON_INTERVAL, (u8 *)(&pdvobj->inter_bcn_space)); + #endif /*CONFIG_SWTIMER_BASED_TXBCN*/ -#endif /*CONFIG_SWTIMER_BASED_TXBCN*/ +#endif /*CONFIG_SUPPORT_MULTI_BCN*/ + #ifdef CONFIG_HW_P0_TSF_SYNC + correct_TSF(padapter, mlme_act); + #endif } rtw_scan_wait_completed(padapter); + _rtw_iface_undersurvey_chk(__func__, padapter); /* send beacon */ - if ((0 == rtw_mi_check_fwstate(padapter, _FW_UNDER_SURVEY)) - && (0 == rtw_mi_check_fwstate(padapter, WIFI_OP_CH_SWITCHING)) - ) { - - /*update_beacon(padapter, _TIM_IE_, NULL, _TRUE);*/ - + ResumeTxBeacon(padapter); + { #if !defined(CONFIG_INTERRUPT_BASED_TXBCN) -#if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) +#if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) || defined(CONFIG_PCI_BCN_POLLING) #ifdef CONFIG_SWTIMER_BASED_TXBCN - if (pdvobj->nr_ap_if == 1) { + if (pdvobj->nr_ap_if == 1 + && mlme_act != MLME_OPCH_SWITCH + ) { RTW_INFO("start SW BCN TIMER!\n"); _set_timer(&pdvobj->txbcn_timer, bcn_interval); } #else - /* other case will tx beacon when bcn interrupt coming in. */ - if (send_beacon(padapter) == _FAIL) - RTW_INFO("issue_beacon, fail!\n"); + for (i = 0; i < pdvobj->iface_nums; i++) { + if (!(parm->ifbmp & BIT(i)) || !pdvobj->padapters[i]) + continue; + + if (send_beacon(pdvobj->padapters[i]) == _FAIL) + RTW_INFO(ADPT_FMT" issue_beacon, fail!\n", ADPT_ARG(pdvobj->padapters[i])); + } #endif #endif #endif /* !defined(CONFIG_INTERRUPT_BASED_TXBCN) */ + +#ifdef CONFIG_FW_HANDLE_TXBCN + if (mlme_act != MLME_OPCH_SWITCH) + rtw_ap_mbid_bcn_en(padapter, padapter->vap_id); +#endif } - - /*Set EDCA param reg after update cur_wireless_mode & update_capinfo*/ - if (pregpriv->wifi_spec == 1) - rtw_set_hw_wmm_param(padapter); - - /*pmlmeext->bstart_bss = _TRUE;*/ } int rtw_check_beacon_data(_adapter *padapter, u8 *pbuf, int len) @@ -1470,22 +1911,23 @@ int rtw_check_beacon_data(_adapter *padapter, u8 *pbuf, int len) u16 cap, ht_cap = _FALSE; uint ie_len = 0; int group_cipher, pairwise_cipher; - u8 channel, network_type, supportRate[NDIS_802_11_LENGTH_RATES_EX]; - int supportRateNum = 0; + u32 akm; + u8 mfp_opt = MFP_NO; + u8 channel, network_type; u8 OUI1[] = {0x00, 0x50, 0xf2, 0x01}; - u8 wps_oui[4] = {0x0, 0x50, 0xf2, 0x04}; u8 WMM_PARA_IE[] = {0x00, 0x50, 0xf2, 0x02, 0x01, 0x01}; + HT_CAP_AMPDU_DENSITY best_ampdu_density; struct registry_priv *pregistrypriv = &padapter->registrypriv; struct security_priv *psecuritypriv = &padapter->securitypriv; struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); WLAN_BSSID_EX *pbss_network = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; - struct sta_priv *pstapriv = &padapter->stapriv; u8 *ie = pbss_network->IEs; 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; - + int ret_rm; /* SSID */ /* Supported rates */ /* DS Params */ @@ -1499,7 +1941,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; @@ -1513,8 +1955,12 @@ 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 + && pbss_network->InfrastructureMode != Ndis802_11_mesh + ) { + rtw_warn_on(1); return _FAIL; + } rtw_ap_check_scan(padapter); @@ -1546,6 +1992,18 @@ int rtw_check_beacon_data(_adapter *padapter, u8 *pbuf, int len) #endif } +#ifdef CONFIG_RTW_MESH + /* Mesh ID */ + if (MLME_IS_MESH(padapter)) { + p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, WLAN_EID_MESH_ID, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); + if (p && ie_len > 0) { + _rtw_memset(&pbss_network->mesh_id, 0, sizeof(NDIS_802_11_SSID)); + _rtw_memcpy(pbss_network->mesh_id.Ssid, (p + 2), ie_len); + pbss_network->mesh_id.SsidLength = ie_len; + } + } +#endif + /* chnnel */ channel = 0; pbss_network->Configuration.Length = 0; @@ -1555,32 +2013,21 @@ int rtw_check_beacon_data(_adapter *padapter, u8 *pbuf, int len) pbss_network->Configuration.DSConfig = channel; - - _rtw_memset(supportRate, 0, NDIS_802_11_LENGTH_RATES_EX); - /* get supported rates */ - p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _SUPPORTEDRATES_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); - if (p != NULL) { - _rtw_memcpy(supportRate, p + 2, ie_len); - supportRateNum = ie_len; - } - - /* get ext_supported rates */ - p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _EXT_SUPPORTEDRATES_IE_, &ie_len, pbss_network->IELength - _BEACON_IE_OFFSET_); - if (p != NULL) { - _rtw_memcpy(supportRate + supportRateNum, p + 2, ie_len); - supportRateNum += ie_len; - - } - - network_type = rtw_check_network_type(supportRate, supportRateNum, channel); - - rtw_set_supported_rate(pbss_network->SupportedRates, network_type); - + /* support rate ie & ext support ie & IElen & SupportedRates */ + network_type = rtw_update_rate_bymode(pbss_network, pregistrypriv->wireless_mode); /* parsing ERP_IE */ p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _ERPINFO_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); - if (p && ie_len > 0) - ERP_IE_handler(padapter, (PNDIS_802_11_VARIABLE_IEs)p); + if (p && ie_len > 0) { + if(padapter->registrypriv.wireless_mode == WIRELESS_11B ) { + + pbss_network->IELength = pbss_network->IELength - *(p+1) - 2; + ret_rm = rtw_ies_remove_ie(ie , &len, _BEACON_IE_OFFSET_, _ERPINFO_IE_,NULL,0); + RTW_DBG("%s, remove_ie of ERP_IE=%d\n", __FUNCTION__, ret_rm); + } else + ERP_IE_handler(padapter, (PNDIS_802_11_VARIABLE_IEs)p); + + } /* update privacy/security */ if (cap & BIT(4)) @@ -1591,20 +2038,30 @@ int rtw_check_beacon_data(_adapter *padapter, u8 *pbuf, int len) psecuritypriv->wpa_psk = 0; /* wpa2 */ + akm = 0; group_cipher = 0; pairwise_cipher = 0; psecuritypriv->wpa2_group_cipher = _NO_PRIVACY_; psecuritypriv->wpa2_pairwise_cipher = _NO_PRIVACY_; p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _RSN_IE_2_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); if (p && ie_len > 0) { - if (rtw_parse_wpa2_ie(p, ie_len + 2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) { + if (rtw_parse_wpa2_ie(p, ie_len + 2, &group_cipher, &pairwise_cipher, &akm, &mfp_opt) == _SUCCESS) { psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; - + psecuritypriv->ndisauthtype = Ndis802_11AuthModeWPA2PSK; psecuritypriv->dot8021xalg = 1;/* psk, todo:802.1x */ psecuritypriv->wpa_psk |= BIT(1); psecuritypriv->wpa2_group_cipher = group_cipher; psecuritypriv->wpa2_pairwise_cipher = pairwise_cipher; + + /* + Kernel < v5.1, the auth_type set as NL80211_AUTHTYPE_AUTOMATIC + in cfg80211_rtw_start_ap(). + if the AKM SAE in the RSN IE, we have to update the auth_type for SAE + in rtw_check_beacon_data(). + */ + if (CHECK_BIT(WLAN_AKM_TYPE_SAE, akm)) + psecuritypriv->auth_type = NL80211_AUTHTYPE_SAE; #if 0 switch (group_cipher) { case WPA_CIPHER_NONE: @@ -1657,7 +2114,7 @@ int rtw_check_beacon_data(_adapter *padapter, u8 *pbuf, int len) if ((p) && (_rtw_memcmp(p + 2, OUI1, 4))) { if (rtw_parse_wpa_ie(p, ie_len + 2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) { psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; - + psecuritypriv->ndisauthtype = Ndis802_11AuthModeWPAPSK; psecuritypriv->dot8021xalg = 1;/* psk, todo:802.1x */ psecuritypriv->wpa_psk |= BIT(0); @@ -1713,9 +2170,26 @@ int rtw_check_beacon_data(_adapter *padapter, u8 *pbuf, int len) } +#ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(padapter)) { + /* MFP is mandatory for secure mesh */ + if (padapter->mesh_info.mesh_auth_id) + mfp_opt = MFP_REQUIRED; + } else +#endif + if (mfp_opt == MFP_INVALID) { + RTW_INFO(FUNC_ADPT_FMT" invalid MFP setting\n", FUNC_ADPT_ARG(padapter)); + return _FAIL; + } + psecuritypriv->mfp_opt = mfp_opt; + /* wmm */ ie_len = 0; pmlmepriv->qospriv.qos_option = 0; +#ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(padapter)) + pmlmepriv->qospriv.qos_option = 1; +#endif if (pregistrypriv->wmm_enable) { for (p = ie + _BEACON_IE_OFFSET_; ; p += (ie_len + 2)) { p = rtw_get_ie(p, _VENDOR_SPECIFIC_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_ - (ie_len + 2))); @@ -1730,6 +2204,8 @@ int rtw_check_beacon_data(_adapter *padapter, u8 *pbuf, int len) *(p + 18) &= ~BIT(4); /* VI */ *(p + 22) &= ~BIT(4); /* VO */ + WMM_param_handler(padapter, (PNDIS_802_11_VARIABLE_IEs)p); + break; } @@ -1738,144 +2214,137 @@ int rtw_check_beacon_data(_adapter *padapter, u8 *pbuf, int len) } } #ifdef CONFIG_80211N_HT - /* parsing HT_CAP_IE */ - p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _HT_CAPABILITY_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); - if (p && ie_len > 0) { - u8 rf_type = 0; - HT_CAP_AMPDU_FACTOR max_rx_ampdu_factor = MAX_AMPDU_FACTOR_64K; - struct rtw_ieee80211_ht_cap *pht_cap = (struct rtw_ieee80211_ht_cap *)(p + 2); + if(padapter->registrypriv.ht_enable && + is_supported_ht(padapter->registrypriv.wireless_mode)) { + /* parsing HT_CAP_IE */ + p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _HT_CAPABILITY_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); + if (p && ie_len > 0) { + u8 rf_type = 0; + HT_CAP_AMPDU_FACTOR max_rx_ampdu_factor = MAX_AMPDU_FACTOR_64K; + struct rtw_ieee80211_ht_cap *pht_cap = (struct rtw_ieee80211_ht_cap *)(p + 2); - if (0) { - RTW_INFO(FUNC_ADPT_FMT" HT_CAP_IE from upper layer:\n", FUNC_ADPT_ARG(padapter)); - dump_ht_cap_ie_content(RTW_DBGDUMP, p + 2, ie_len); - } - - pHT_caps_ie = p; - - ht_cap = _TRUE; - network_type |= WIRELESS_11_24N; - - rtw_ht_use_default_setting(padapter); - - /* Update HT Capabilities Info field */ - if (pmlmepriv->htpriv.sgi_20m == _FALSE) - pht_cap->cap_info &= ~(IEEE80211_HT_CAP_SGI_20); - - if (pmlmepriv->htpriv.sgi_40m == _FALSE) - pht_cap->cap_info &= ~(IEEE80211_HT_CAP_SGI_40); - - if (!TEST_FLAG(pmlmepriv->htpriv.ldpc_cap, LDPC_HT_ENABLE_RX)) - pht_cap->cap_info &= ~(IEEE80211_HT_CAP_LDPC_CODING); - - if (!TEST_FLAG(pmlmepriv->htpriv.stbc_cap, STBC_HT_ENABLE_TX)) - pht_cap->cap_info &= ~(IEEE80211_HT_CAP_TX_STBC); - - if (!TEST_FLAG(pmlmepriv->htpriv.stbc_cap, STBC_HT_ENABLE_RX)) - pht_cap->cap_info &= ~(IEEE80211_HT_CAP_RX_STBC_3R); - - /* Update A-MPDU Parameters field */ - pht_cap->ampdu_params_info &= ~(IEEE80211_HT_CAP_AMPDU_FACTOR | IEEE80211_HT_CAP_AMPDU_DENSITY); - - if ((psecuritypriv->wpa_pairwise_cipher & WPA_CIPHER_CCMP) || - (psecuritypriv->wpa2_pairwise_cipher & WPA_CIPHER_CCMP)) - pht_cap->ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_DENSITY & (0x07 << 2)); - else - pht_cap->ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_DENSITY & 0x00); - - rtw_hal_get_def_var(padapter, HW_VAR_MAX_RX_AMPDU_FACTOR, &max_rx_ampdu_factor); - pht_cap->ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_FACTOR & max_rx_ampdu_factor); /* set Max Rx AMPDU size to 64K */ - - _rtw_memcpy(&(pmlmeinfo->HT_caps), pht_cap, sizeof(struct HT_caps_element)); - - /* 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 (rx_nss) { - case 1: - set_mcs_rate_by_mask(HT_CAP_ELE_RX_MCS_MAP(pht_cap), MCS_RATE_1R); - break; - case 2: - set_mcs_rate_by_mask(HT_CAP_ELE_RX_MCS_MAP(pht_cap), MCS_RATE_2R); - break; - 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_WARN("rf_type:%d or rx_nss:%u is not expected\n", rf_type, hal_spec->rx_nss_num); + if (0) { + RTW_INFO(FUNC_ADPT_FMT" HT_CAP_IE from upper layer:\n", FUNC_ADPT_ARG(padapter)); + dump_ht_cap_ie_content(RTW_DBGDUMP, p + 2, ie_len); + } + + pHT_caps_ie = p; + + ht_cap = _TRUE; + network_type |= WIRELESS_11_24N; + + rtw_ht_use_default_setting(padapter); + + /* Update HT Capabilities Info field */ + if (pmlmepriv->htpriv.sgi_20m == _FALSE) + pht_cap->cap_info &= ~(IEEE80211_HT_CAP_SGI_20); + + if (pmlmepriv->htpriv.sgi_40m == _FALSE) + pht_cap->cap_info &= ~(IEEE80211_HT_CAP_SGI_40); + + if (!TEST_FLAG(pmlmepriv->htpriv.ldpc_cap, LDPC_HT_ENABLE_RX)) + pht_cap->cap_info &= ~(IEEE80211_HT_CAP_LDPC_CODING); + + if (!TEST_FLAG(pmlmepriv->htpriv.stbc_cap, STBC_HT_ENABLE_TX)) + pht_cap->cap_info &= ~(IEEE80211_HT_CAP_TX_STBC); + + if (!TEST_FLAG(pmlmepriv->htpriv.stbc_cap, STBC_HT_ENABLE_RX)) + pht_cap->cap_info &= ~(IEEE80211_HT_CAP_RX_STBC_3R); + + /* Update A-MPDU Parameters field */ + pht_cap->ampdu_params_info &= ~(IEEE80211_HT_CAP_AMPDU_FACTOR | IEEE80211_HT_CAP_AMPDU_DENSITY); + + if ((psecuritypriv->wpa_pairwise_cipher & WPA_CIPHER_CCMP) || + (psecuritypriv->wpa2_pairwise_cipher & WPA_CIPHER_CCMP)) { + rtw_hal_get_def_var(padapter, HW_VAR_BEST_AMPDU_DENSITY, &best_ampdu_density); + pht_cap->ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_DENSITY & (best_ampdu_density << 2)); + } else + pht_cap->ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_DENSITY & 0x00); + + rtw_hal_get_def_var(padapter, HW_VAR_MAX_RX_AMPDU_FACTOR, &max_rx_ampdu_factor); + pht_cap->ampdu_params_info |= (IEEE80211_HT_CAP_AMPDU_FACTOR & max_rx_ampdu_factor); /* set Max Rx AMPDU size to 64K */ + + _rtw_memcpy(&(pmlmeinfo->HT_caps), pht_cap, sizeof(struct HT_caps_element)); + + /* 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 (rx_nss) { + case 1: + set_mcs_rate_by_mask(HT_CAP_ELE_RX_MCS_MAP(pht_cap), MCS_RATE_1R); + break; + case 2: + set_mcs_rate_by_mask(HT_CAP_ELE_RX_MCS_MAP(pht_cap), MCS_RATE_2R); + break; + 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_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]; } - for (i = 0; i < 10; i++) - *(HT_CAP_ELE_RX_MCS_MAP(pht_cap) + i) &= padapter->mlmeextpriv.default_supported_mcs_set[i]; - } #ifdef CONFIG_BEAMFORMING - /* Use registry value to enable HT Beamforming. */ - /* ToDo: use configure file to set these capability. */ - pht_cap->tx_BF_cap_info = 0; + /* Use registry value to enable HT Beamforming. */ + /* ToDo: use configure file to set these capability. */ + pht_cap->tx_BF_cap_info = 0; - /* HT Beamformer */ - if (TEST_FLAG(pmlmepriv->htpriv.beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE)) { - /* Transmit NDP Capable */ - SET_HT_CAP_TXBF_TRANSMIT_NDP_CAP(pht_cap, 1); - /* Explicit Compressed Steering Capable */ - SET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP(pht_cap, 1); - /* Compressed Steering Number Antennas */ - SET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(pht_cap, 1); - rtw_hal_get_def_var(padapter, HAL_DEF_BEAMFORMER_CAP, (u8 *)&rf_num); - SET_HT_CAP_TXBF_CHNL_ESTIMATION_NUM_ANTENNAS(pht_cap, rf_num); - } + /* HT Beamformer */ + if (TEST_FLAG(pmlmepriv->htpriv.beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE)) { + /* Transmit NDP Capable */ + SET_HT_CAP_TXBF_TRANSMIT_NDP_CAP(pht_cap, 1); + /* Explicit Compressed Steering Capable */ + SET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP(pht_cap, 1); + /* Compressed Steering Number Antennas */ + SET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(pht_cap, 1); + rtw_hal_get_def_var(padapter, HAL_DEF_BEAMFORMER_CAP, (u8 *)&rf_num); + SET_HT_CAP_TXBF_CHNL_ESTIMATION_NUM_ANTENNAS(pht_cap, rf_num); + } - /* HT Beamformee */ - if (TEST_FLAG(pmlmepriv->htpriv.beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE)) { - /* Receive NDP Capable */ - SET_HT_CAP_TXBF_RECEIVE_NDP_CAP(pht_cap, 1); - /* Explicit Compressed Beamforming Feedback Capable */ - SET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP(pht_cap, 2); - rtw_hal_get_def_var(padapter, HAL_DEF_BEAMFORMEE_CAP, (u8 *)&rf_num); - SET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(pht_cap, rf_num); - } + /* HT Beamformee */ + if (TEST_FLAG(pmlmepriv->htpriv.beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE)) { + /* Receive NDP Capable */ + SET_HT_CAP_TXBF_RECEIVE_NDP_CAP(pht_cap, 1); + /* Explicit Compressed Beamforming Feedback Capable */ + SET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP(pht_cap, 2); + rtw_hal_get_def_var(padapter, HAL_DEF_BEAMFORMEE_CAP, (u8 *)&rf_num); + SET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(pht_cap, rf_num); + } #endif /* CONFIG_BEAMFORMING */ - _rtw_memcpy(&pmlmepriv->htpriv.ht_cap, p + 2, ie_len); + _rtw_memcpy(&pmlmepriv->htpriv.ht_cap, p + 2, ie_len); - if (0) { - RTW_INFO(FUNC_ADPT_FMT" HT_CAP_IE driver masked:\n", FUNC_ADPT_ARG(padapter)); - dump_ht_cap_ie_content(RTW_DBGDUMP, p + 2, ie_len); + if (0) { + RTW_INFO(FUNC_ADPT_FMT" HT_CAP_IE driver masked:\n", FUNC_ADPT_ARG(padapter)); + dump_ht_cap_ie_content(RTW_DBGDUMP, p + 2, ie_len); + } + } + + /* parsing HT_INFO_IE */ + p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _HT_ADD_INFO_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); + if (p && ie_len > 0) { + pHT_info_ie = p; + if (channel == 0) + pbss_network->Configuration.DSConfig = GET_HT_OP_ELE_PRI_CHL(pHT_info_ie + 2); + else if (channel != GET_HT_OP_ELE_PRI_CHL(pHT_info_ie + 2)) { + RTW_INFO(FUNC_ADPT_FMT" ch inconsistent, DSSS:%u, HT primary:%u\n" + , FUNC_ADPT_ARG(padapter), channel, GET_HT_OP_ELE_PRI_CHL(pHT_info_ie + 2)); + } } } - - /* parsing HT_INFO_IE */ - p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _HT_ADD_INFO_IE_, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); - if (p && ie_len > 0) - pHT_info_ie = p; #endif /* CONFIG_80211N_HT */ - switch (network_type) { - case WIRELESS_11B: - pbss_network->NetworkTypeInUse = Ndis802_11DS; - break; - case WIRELESS_11G: - case WIRELESS_11BG: - case WIRELESS_11G_24N: - case WIRELESS_11BG_24N: - pbss_network->NetworkTypeInUse = Ndis802_11OFDM24; - break; - case WIRELESS_11A: - pbss_network->NetworkTypeInUse = Ndis802_11OFDM5; - break; - default: - pbss_network->NetworkTypeInUse = Ndis802_11OFDM24; - break; - } - pmlmepriv->cur_network.network_type = network_type; #ifdef CONFIG_80211N_HT @@ -1888,7 +2357,9 @@ int rtw_check_beacon_data(_adapter *padapter, u8 *pbuf, int len) } /* ht_cap */ - if (pregistrypriv->ht_enable && ht_cap == _TRUE) { + if (padapter->registrypriv.ht_enable && + is_supported_ht(padapter->registrypriv.wireless_mode) && ht_cap == _TRUE) { + pmlmepriv->htpriv.ht_option = _TRUE; pmlmepriv->qospriv.qos_option = 1; @@ -1901,53 +2372,43 @@ int rtw_check_beacon_data(_adapter *padapter, u8 *pbuf, int len) #endif #ifdef CONFIG_80211AC_VHT - - /* Parsing VHT CAP IE */ - p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, EID_VHTCapability, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); - if (p && ie_len > 0) - vht_cap = _TRUE; - /* Parsing VHT OPERATION IE */ - - + pmlmepriv->ori_vht_en = 0; pmlmepriv->vhtpriv.vht_option = _FALSE; - /* if channel in 5G band, then add vht ie . */ - if ((pbss_network->Configuration.DSConfig > 14) - && (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)) - ) { - 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; - + + if (pmlmepriv->htpriv.ht_option == _TRUE + && pbss_network->Configuration.DSConfig > 14 + && REGSTY_IS_11AC_ENABLE(pregistrypriv) + && is_supported_vht(pregistrypriv->wireless_mode) + && (!rfctl->country_ent || COUNTRY_CHPLAN_EN_11AC(rfctl->country_ent)) + ) { + /* Parsing VHT CAP IE */ + p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, EID_VHTCapability, &ie_len, (pbss_network->IELength - _BEACON_IE_OFFSET_)); + if (p && ie_len > 0) + vht_cap = _TRUE; + + /* Parsing VHT OPERATION IE */ + + if (vht_cap == _TRUE + && MLME_IS_MESH(padapter) /* allow only mesh temporarily before VHT IE checking is ready */ + ) { + rtw_check_for_vht20(padapter, ie + _BEACON_IE_OFFSET_, pbss_network->IELength - _BEACON_IE_OFFSET_); + pmlmepriv->ori_vht_en = 1; pmlmepriv->vhtpriv.vht_option = _TRUE; + } else if (REGSTY_IS_11AC_AUTO(pregistrypriv)) { + rtw_vht_ies_detach(padapter, pbss_network); + rtw_vht_ies_attach(padapter, pbss_network); } } + + if (pmlmepriv->vhtpriv.vht_option == _FALSE) + rtw_vht_ies_detach(padapter, pbss_network); #endif /* CONFIG_80211AC_VHT */ - if(pbss_network->Configuration.DSConfig <= 14 && padapter->registrypriv.wifi_spec == 1) { +#ifdef CONFIG_80211N_HT + if(padapter->registrypriv.ht_enable && + is_supported_ht(padapter->registrypriv.wireless_mode) && + pbss_network->Configuration.DSConfig <= 14 && padapter->registrypriv.wifi_spec == 1 && + pbss_network->IELength + 10 <= MAX_IE_SZ) { uint len = 0; SET_EXT_CAPABILITY_ELE_BSS_COEXIST(pmlmepriv->ext_capab_ie_data, 1); @@ -1955,11 +2416,12 @@ int rtw_check_beacon_data(_adapter *padapter, u8 *pbuf, int len) 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; } +#endif /* CONFIG_80211N_HT */ pbss_network->Length = get_WLAN_BSSID_EX_sz((WLAN_BSSID_EX *)pbss_network); rtw_ies_get_chbw(pbss_network->IEs + _BEACON_IE_OFFSET_, pbss_network->IELength - _BEACON_IE_OFFSET_ - , &pmlmepriv->ori_ch, &pmlmepriv->ori_bw, &pmlmepriv->ori_offset); + , &pmlmepriv->ori_ch, &pmlmepriv->ori_bw, &pmlmepriv->ori_offset, 1, 1); rtw_warn_on(pmlmepriv->ori_ch == 0); { @@ -1995,14 +2457,24 @@ int rtw_check_beacon_data(_adapter *padapter, u8 *pbuf, int len) } #if CONFIG_RTW_MACADDR_ACL -void rtw_macaddr_acl_init(_adapter *adapter) +void rtw_macaddr_acl_init(_adapter *adapter, u8 period) { struct sta_priv *stapriv = &adapter->stapriv; - struct wlan_acl_pool *acl = &stapriv->acl_list; - _queue *acl_node_q = &acl->acl_node_q; + struct wlan_acl_pool *acl; + _queue *acl_node_q; int i; _irqL irqL; + if (period >= RTW_ACL_PERIOD_NUM) { + rtw_warn_on(1); + return; + } + + acl = &stapriv->acl_list[period]; + acl_node_q = &acl->acl_node_q; + + _rtw_spinlock_init(&(acl_node_q->lock)); + _enter_critical_bh(&(acl_node_q->lock), &irqL); _rtw_init_listhead(&(acl_node_q->queue)); acl->num = 0; @@ -2014,15 +2486,23 @@ void rtw_macaddr_acl_init(_adapter *adapter) _exit_critical_bh(&(acl_node_q->lock), &irqL); } -void rtw_macaddr_acl_deinit(_adapter *adapter) +static void _rtw_macaddr_acl_deinit(_adapter *adapter, u8 period, bool clear_only) { struct sta_priv *stapriv = &adapter->stapriv; - struct wlan_acl_pool *acl = &stapriv->acl_list; - _queue *acl_node_q = &acl->acl_node_q; + struct wlan_acl_pool *acl; + _queue *acl_node_q; _irqL irqL; _list *head, *list; struct rtw_wlan_acl_node *acl_node; + if (period >= RTW_ACL_PERIOD_NUM) { + rtw_warn_on(1); + return; + } + + acl = &stapriv->acl_list[period]; + acl_node_q = &acl->acl_node_q; + _enter_critical_bh(&(acl_node_q->lock), &irqL); head = get_list_head(acl_node_q); list = get_next(head); @@ -2038,24 +2518,42 @@ void rtw_macaddr_acl_deinit(_adapter *adapter) } _exit_critical_bh(&(acl_node_q->lock), &irqL); + if (!clear_only) + _rtw_spinlock_free(&(acl_node_q->lock)); + rtw_warn_on(acl->num); acl->mode = RTW_ACL_MODE_DISABLED; } -void rtw_set_macaddr_acl(_adapter *adapter, int mode) +void rtw_macaddr_acl_deinit(_adapter *adapter, u8 period) { - struct sta_priv *stapriv = &adapter->stapriv; - struct wlan_acl_pool *acl = &stapriv->acl_list; - - RTW_INFO(FUNC_ADPT_FMT" mode=%d\n", FUNC_ADPT_ARG(adapter), mode); - - acl->mode = mode; - - if (mode == RTW_ACL_MODE_DISABLED) - rtw_macaddr_acl_deinit(adapter); + _rtw_macaddr_acl_deinit(adapter, period, 0); } -int rtw_acl_add_sta(_adapter *adapter, const u8 *addr) +void rtw_macaddr_acl_clear(_adapter *adapter, u8 period) +{ + _rtw_macaddr_acl_deinit(adapter, period, 1); +} + +void rtw_set_macaddr_acl(_adapter *adapter, u8 period, int mode) +{ + struct sta_priv *stapriv = &adapter->stapriv; + struct wlan_acl_pool *acl; + + if (period >= RTW_ACL_PERIOD_NUM) { + rtw_warn_on(1); + return; + } + + acl = &stapriv->acl_list[period]; + + RTW_INFO(FUNC_ADPT_FMT" p=%u, mode=%d\n" + , FUNC_ADPT_ARG(adapter), period, mode); + + acl->mode = mode; +} + +int rtw_acl_add_sta(_adapter *adapter, u8 period, const u8 *addr) { _irqL irqL; _list *list, *head; @@ -2063,8 +2561,17 @@ int rtw_acl_add_sta(_adapter *adapter, const u8 *addr) int i = -1, ret = 0; struct rtw_wlan_acl_node *acl_node; struct sta_priv *stapriv = &adapter->stapriv; - struct wlan_acl_pool *acl = &stapriv->acl_list; - _queue *acl_node_q = &acl->acl_node_q; + struct wlan_acl_pool *acl; + _queue *acl_node_q; + + if (period >= RTW_ACL_PERIOD_NUM) { + rtw_warn_on(1); + ret = -1; + goto exit; + } + + acl = &stapriv->acl_list[period]; + acl_node_q = &acl->acl_node_q; _enter_critical_bh(&(acl_node_q->lock), &irqL); @@ -2111,26 +2618,34 @@ int rtw_acl_add_sta(_adapter *adapter, const u8 *addr) if (!existed && (i < 0 || i >= NUM_ACL)) ret = -1; - RTW_INFO(FUNC_ADPT_FMT" "MAC_FMT" %s (acl_num=%d)\n" - , FUNC_ADPT_ARG(adapter), MAC_ARG(addr) + RTW_INFO(FUNC_ADPT_FMT" p=%u "MAC_FMT" %s (acl_num=%d)\n" + , FUNC_ADPT_ARG(adapter), period, MAC_ARG(addr) , (existed ? "existed" : ((i < 0 || i >= NUM_ACL) ? "no room" : "added")) , acl->num); - +exit: return ret; } -int rtw_acl_remove_sta(_adapter *adapter, const u8 *addr) +int rtw_acl_remove_sta(_adapter *adapter, u8 period, const u8 *addr) { _irqL irqL; _list *list, *head; int ret = 0; struct rtw_wlan_acl_node *acl_node; struct sta_priv *stapriv = &adapter->stapriv; - struct wlan_acl_pool *acl = &stapriv->acl_list; - _queue *acl_node_q = &acl->acl_node_q; + struct wlan_acl_pool *acl; + _queue *acl_node_q; u8 is_baddr = is_broadcast_mac_addr(addr); u8 match = 0; + if (period >= RTW_ACL_PERIOD_NUM) { + rtw_warn_on(1); + goto exit; + } + + acl = &stapriv->acl_list[period]; + acl_node_q = &acl->acl_node_q; + _enter_critical_bh(&(acl_node_q->lock), &irqL); head = get_list_head(acl_node_q); @@ -2152,51 +2667,59 @@ int rtw_acl_remove_sta(_adapter *adapter, const u8 *addr) _exit_critical_bh(&(acl_node_q->lock), &irqL); - RTW_INFO(FUNC_ADPT_FMT" "MAC_FMT" %s (acl_num=%d)\n" - , FUNC_ADPT_ARG(adapter), MAC_ARG(addr) + RTW_INFO(FUNC_ADPT_FMT" p=%u "MAC_FMT" %s (acl_num=%d)\n" + , FUNC_ADPT_ARG(adapter), period, MAC_ARG(addr) , is_baddr ? "clear all" : (match ? "match" : "no found") , acl->num); +exit: return ret; } #endif /* CONFIG_RTW_MACADDR_ACL */ -u8 rtw_ap_set_pairwise_key(_adapter *padapter, struct sta_info *psta) +u8 rtw_ap_set_sta_key(_adapter *adapter, const u8 *addr, u8 alg, const u8 *key, u8 keyid, u8 gk) { - struct cmd_obj *ph2c; - struct set_stakey_parm *psetstakey_para; - struct cmd_priv *pcmdpriv = &padapter->cmdpriv; + struct cmd_priv *cmdpriv = &adapter->cmdpriv; + struct cmd_obj *cmd; + struct set_stakey_parm *param; u8 res = _SUCCESS; - ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); - if (ph2c == NULL) { + cmd = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); + if (cmd == NULL) { res = _FAIL; goto exit; } - psetstakey_para = (struct set_stakey_parm *)rtw_zmalloc(sizeof(struct set_stakey_parm)); - if (psetstakey_para == NULL) { - rtw_mfree((u8 *) ph2c, sizeof(struct cmd_obj)); + param = (struct set_stakey_parm *)rtw_zmalloc(sizeof(struct set_stakey_parm)); + if (param == NULL) { + rtw_mfree((u8 *) cmd, sizeof(struct cmd_obj)); res = _FAIL; goto exit; } - init_h2fwcmd_w_parm_no_rsp(ph2c, psetstakey_para, _SetStaKey_CMD_); + init_h2fwcmd_w_parm_no_rsp(cmd, param, _SetStaKey_CMD_); + _rtw_memcpy(param->addr, addr, ETH_ALEN); + param->algorithm = alg; + param->keyid = keyid; + _rtw_memcpy(param->key, key, 16); + param->gk = gk; - psetstakey_para->algorithm = (u8)psta->dot118021XPrivacy; - - _rtw_memcpy(psetstakey_para->addr, psta->hwaddr, ETH_ALEN); - - _rtw_memcpy(psetstakey_para->key, &psta->dot118021x_UncstKey, 16); - - - res = rtw_enqueue_cmd(pcmdpriv, ph2c); + res = rtw_enqueue_cmd(cmdpriv, cmd); exit: - return res; +} +u8 rtw_ap_set_pairwise_key(_adapter *padapter, struct sta_info *psta) +{ + return rtw_ap_set_sta_key(padapter + , psta->cmn.mac_addr + , psta->dot118021XPrivacy + , psta->dot118021x_UncstKey.skey + , 0 + , 0 + ); } static int rtw_ap_set_key(_adapter *padapter, u8 *key, u8 alg, int keyid, u8 set_tx) @@ -2313,7 +2836,7 @@ u8 rtw_ap_bmc_frames_hdl(_adapter *padapter) _enter_critical_bh(&pxmitpriv->lock, &irqL); - if ((pstapriv->tim_bitmap & BIT(0)) && (psta_bmc->sleepq_len > 0)) { + if ((rtw_tim_map_is_set(padapter, pstapriv->tim_bitmap, 0)) && (psta_bmc->sleepq_len > 0)) { int tx_counts = 0; _update_beacon(padapter, _TIM_IE_, NULL, _FALSE, "update TIM with TIB=1"); @@ -2358,11 +2881,11 @@ u8 rtw_ap_bmc_frames_hdl(_adapter *padapter) /*RTW_INFO("sleepq_len of bmc_sta = %d\n", psta_bmc->sleepq_len);*/ - if (pstapriv->tim_bitmap & BIT(0)) + if (rtw_tim_map_is_set(padapter, pstapriv->tim_bitmap, 0)) update_tim = _TRUE; - pstapriv->tim_bitmap &= ~BIT(0); - pstapriv->sta_dz_bitmap &= ~BIT(0); + rtw_tim_map_clear(padapter, pstapriv->tim_bitmap, 0); + rtw_tim_map_clear(padapter, pstapriv->sta_dz_bitmap, 0); if (update_tim == _TRUE) { RTW_INFO("clear TIB\n"); @@ -2395,13 +2918,13 @@ 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); +#ifdef CONFIG_80211N_HT if (sta_info_type & STA_INFO_UPDATE_BW) { 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 { @@ -2409,7 +2932,7 @@ static void associated_stainfo_update(_adapter *padapter, struct sta_info *psta, } } } - +#endif /* CONFIG_80211N_HT */ /* if (sta_info_type & STA_INFO_UPDATE_RATE) { @@ -2456,12 +2979,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); @@ -2504,6 +3021,7 @@ static void update_bcn_htcap_ie(_adapter *padapter) static void update_bcn_htinfo_ie(_adapter *padapter) { +#ifdef CONFIG_80211N_HT /* u8 beacon_updated = _FALSE; u32 sta_info_update_type = STA_INFO_UPDATE_NONE; @@ -2582,7 +3100,7 @@ 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) @@ -2697,83 +3215,70 @@ 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; + bool updated = 1; /* treat as upadated by default */ 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_: - update_bcn_htcap_ie(padapter); - break; case _RSN_IE_2_: - update_bcn_rsn_ie(padapter); - break; case _HT_ADD_INFO_IE_: - update_bcn_htinfo_ie(padapter); - break; case _EXT_CAP_IE_: - update_bcn_ext_capab_ie(padapter); - break; +#ifdef CONFIG_RTW_MESH + case WLAN_EID_MESH_CONFIG: + updated = rtw_mesh_update_bss_peering_status(padapter, &(pmlmeext->mlmext_info.network)); + updated |= rtw_mesh_update_bss_formation_info(padapter, &(pmlmeext->mlmext_info.network)); + updated |= rtw_mesh_update_bss_forwarding_state(padapter, &(pmlmeext->mlmext_info.network)); + break; +#endif + case _VENDOR_SPECIFIC_IE_: - update_bcn_vendor_spec_ie(padapter, oui); - break; + case 0xFF: default: break; } - pmlmepriv->update_bcn = _TRUE; + if (updated) + pmlmepriv->update_bcn = _TRUE; _exit_critical_bh(&pmlmepriv->bcn_update_lock, &irqL); #ifndef CONFIG_INTERRUPT_BASED_TXBCN -#if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) - if (tx) { +#if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) || defined(CONFIG_PCI_BCN_POLLING) + if (tx && updated) { /* send_beacon(padapter); */ /* send_beacon must execute on TSR level */ if (0) RTW_INFO(FUNC_ADPT_FMT" ie_id:%u - %s\n", FUNC_ADPT_ARG(padapter), ie_id, tag); @@ -2785,7 +3290,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 @@ -2860,25 +3364,23 @@ void rtw_process_ht_action_smps(_adapter *padapter, u8 *ta, u8 ctrl_field) if (psta == NULL) return; - e_field = (ctrl_field & BIT(0)) ? 1 : 0; - m_field = (ctrl_field & BIT(1)) ? 1 : 0; + e_field = (ctrl_field & BIT(0)) ? 1 : 0; /*SM Power Save Enabled*/ + m_field = (ctrl_field & BIT(1)) ? 1 : 0; /*SM Mode, 0:static SMPS, 1:dynamic SMPS*/ if (e_field) { - - /* enable */ - /* 0:static SMPS, 1:dynamic SMPS, 3:SMPS disabled, 2:reserved*/ - - if (m_field) /*mode*/ - psta->htpriv.smps_cap = 1; + if (m_field) { /*mode*/ + psta->htpriv.smps_cap = WLAN_HT_CAP_SM_PS_DYNAMIC; + RTW_ERR("Don't support dynamic SMPS\n"); + } else - psta->htpriv.smps_cap = 0; + psta->htpriv.smps_cap = WLAN_HT_CAP_SM_PS_STATIC; } else { /*disable*/ - psta->htpriv.smps_cap = 3; + psta->htpriv.smps_cap = WLAN_HT_CAP_SM_PS_DISABLED; } - rtw_dm_ra_mask_wk_cmd(padapter, (u8 *)psta); - + if (psta->htpriv.smps_cap != WLAN_HT_CAP_SM_PS_DYNAMIC) + rtw_ssmps_wk_cmd(padapter, psta, e_field, 1); } /* @@ -3022,11 +3524,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) { @@ -3035,11 +3534,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); - } - } } @@ -3060,7 +3556,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); } } @@ -3072,7 +3568,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); } } @@ -3097,11 +3593,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) { @@ -3110,69 +3603,90 @@ 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(padapter->registrypriv.ht_enable && + is_supported_ht(padapter->registrypriv.wireless_mode)) { + if (psta->flags & WLAN_STA_HT) { + u16 ht_capab = le16_to_cpu(psta->htpriv.ht_cap.cap_info); - 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->cmn.mac_addr), ht_capab); - RTW_INFO("HT: STA " MAC_FMT " HT Capabilities " - "Info: 0x%04x\n", MAC_ARG(psta->hwaddr), ht_capab); - - if (psta->no_ht_set) { - psta->no_ht_set = 0; - pmlmepriv->num_sta_no_ht--; - } - - if ((ht_capab & IEEE80211_HT_CAP_GRN_FLD) == 0) { - if (!psta->no_ht_gf_set) { - psta->no_ht_gf_set = 1; - pmlmepriv->num_sta_ht_no_gf++; + if (psta->no_ht_set) { + psta->no_ht_set = 0; + pmlmepriv->num_sta_no_ht--; } - RTW_INFO("%s STA " MAC_FMT " - no " - "greenfield, num of non-gf stations %d\n", - __FUNCTION__, MAC_ARG(psta->hwaddr), - pmlmepriv->num_sta_ht_no_gf); - } - if ((ht_capab & IEEE80211_HT_CAP_SUP_WIDTH) == 0) { - if (!psta->ht_20mhz_set) { - psta->ht_20mhz_set = 1; - pmlmepriv->num_sta_ht_20mhz++; + if ((ht_capab & IEEE80211_HT_CAP_GRN_FLD) == 0) { + if (!psta->no_ht_gf_set) { + psta->no_ht_gf_set = 1; + pmlmepriv->num_sta_ht_no_gf++; + } + RTW_INFO("%s STA " MAC_FMT " - no " + "greenfield, num of non-gf stations %d\n", + __FUNCTION__, MAC_ARG(psta->cmn.mac_addr), + pmlmepriv->num_sta_ht_no_gf); + } + + if ((ht_capab & IEEE80211_HT_CAP_SUP_WIDTH) == 0) { + if (!psta->ht_20mhz_set) { + psta->ht_20mhz_set = 1; + pmlmepriv->num_sta_ht_20mhz++; + } + RTW_INFO("%s STA " MAC_FMT " - 20 MHz HT, " + "num of 20MHz HT STAs %d\n", + __FUNCTION__, MAC_ARG(psta->cmn.mac_addr), + pmlmepriv->num_sta_ht_20mhz); + } + + if (((ht_capab & RTW_IEEE80211_HT_CAP_40MHZ_INTOLERANT) != 0) && + (psta->ht_40mhz_intolerant == 0)) { + psta->ht_40mhz_intolerant = 1; + pmlmepriv->num_sta_40mhz_intolerant++; + RTW_INFO("%s STA " MAC_FMT " - 40MHZ_INTOLERANT, ", + __FUNCTION__, MAC_ARG(psta->cmn.mac_addr)); + } + + } else { + if (!psta->no_ht_set) { + psta->no_ht_set = 1; + pmlmepriv->num_sta_no_ht++; + } + 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->cmn.mac_addr), + pmlmepriv->num_sta_no_ht); } - RTW_INFO("%s STA " MAC_FMT " - 20 MHz HT, " - "num of 20MHz HT STAs %d\n", - __FUNCTION__, MAC_ARG(psta->hwaddr), - pmlmepriv->num_sta_ht_20mhz); } - } else { - if (!psta->no_ht_set) { - psta->no_ht_set = 1; - pmlmepriv->num_sta_no_ht++; - } - 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), - 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, _FALSE); + beacon_updated = _TRUE; } } - - 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;*/ - } - #endif /* CONFIG_80211N_HT */ +#ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(padapter)) { + struct sta_priv *pstapriv = &padapter->stapriv; + + update_beacon(padapter, WLAN_EID_MESH_CONFIG, NULL, _FALSE); + if (pstapriv->asoc_list_cnt == 1) + _set_timer(&padapter->mesh_atlm_param_req_timer, 0); + beacon_updated = _TRUE; + } +#endif + + if (beacon_updated) + update_beacon(padapter, 0xFF, NULL, _TRUE); + /* update associcated stations cap. */ associated_clients_update(padapter, beacon_updated, STA_INFO_UPDATE_ALL); @@ -3183,20 +3697,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 (rtw_tim_map_is_set(padapter, pstapriv->tim_bitmap, psta->cmn.aid)) { + rtw_tim_map_clear(padapter, pstapriv->tim_bitmap, 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) { @@ -3204,7 +3723,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); } } @@ -3212,14 +3731,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--; @@ -3235,15 +3751,32 @@ u8 bss_cap_update_on_sta_leave(_adapter *padapter, struct sta_info *psta) pmlmepriv->num_sta_ht_20mhz--; } - + if (psta->ht_40mhz_intolerant) { + psta->ht_40mhz_intolerant = 0; + if (pmlmepriv->num_sta_40mhz_intolerant > 0) + pmlmepriv->num_sta_40mhz_intolerant--; + else + rtw_warn_on(1); + } 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 */ +#ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(padapter)) { + update_beacon(padapter, WLAN_EID_MESH_CONFIG, NULL, _FALSE); + if (pstapriv->asoc_list_cnt == 0) + _cancel_timer_ex(&padapter->mesh_atlm_param_req_timer); + beacon_updated = _TRUE; + } +#endif + + 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 */ @@ -3259,9 +3792,6 @@ u8 ap_free_sta(_adapter *padapter, struct sta_info *psta, bool active, u16 reaso { _irqL irqL; u8 beacon_updated = _FALSE; - struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); - struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); - struct sta_priv *pstapriv = &padapter->stapriv; if (!psta) return beacon_updated; @@ -3269,55 +3799,64 @@ 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); + if (!MLME_IS_MESH(padapter)) + issue_deauth(padapter, psta->cmn.mac_addr, reason); } -#ifdef CONFIG_BEAMFORMING - beamforming_wk_cmd(padapter, BEAMFORMING_CTRL_LEAVE, psta->hwaddr, ETH_ALEN, 1); +#ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(padapter)) + rtw_mesh_path_flush_by_nexthop(psta); #endif +#ifdef CONFIG_BEAMFORMING + 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 - /* clear cam entry / key */ - rtw_clearstakey_cmd(padapter, psta, enqueue); _enter_critical_bh(&psta->lock, &irqL); - psta->state &= ~_FW_LINKED; + psta->state &= ~(_FW_LINKED | WIFI_UNDER_KEY_HANDSHAKE); + + if ((psta->auth_len != 0) && (psta->pauth_frame != NULL)) { + rtw_mfree(psta->pauth_frame, psta->auth_len); + psta->pauth_frame = NULL; + psta->auth_len = 0; + } _exit_critical_bh(&psta->lock, &irqL); + if (!MLME_IS_MESH(padapter)) { #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) */ + #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 -#endif /* CONFIG_IOCTL_CFG80211 */ - { + #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); - beacon_updated = bss_cap_update_on_sta_leave(padapter, psta); - /* _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ - rtw_free_stainfo(padapter, psta); - /* _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ - - + report_del_sta_event(padapter, psta->cmn.mac_addr, reason, enqueue, _FALSE); + + /* clear cam entry / key */ + rtw_clearstakey_cmd(padapter, psta, enqueue); + return beacon_updated; } @@ -3348,7 +3887,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); @@ -3365,14 +3904,12 @@ int rtw_sta_flush(_adapter *padapter, bool enqueue) int ret = 0; struct sta_info *psta = NULL; struct sta_priv *pstapriv = &padapter->stapriv; - struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; u8 flush_num = 0; 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)); @@ -3389,6 +3926,7 @@ int rtw_sta_flush(_adapter *padapter, bool enqueue) rtw_list_delete(&psta->asoc_list); pstapriv->asoc_list_cnt--; + STA_SET_MESH_PLINK(psta, NULL); stainfo_offset = rtw_stainfo_offset(pstapriv, psta); if (stainfo_offset_valid(stainfo_offset)) @@ -3400,11 +3938,20 @@ int rtw_sta_flush(_adapter *padapter, bool enqueue) /* call ap_free_sta() for each sta picked */ for (i = 0; i < flush_num; i++) { + u8 sta_addr[ETH_ALEN]; + psta = rtw_get_stainfo_by_offset(pstapriv, flush_list[i]); + _rtw_memcpy(sta_addr, psta->cmn.mac_addr, ETH_ALEN); + ap_free_sta(padapter, psta, _TRUE, WLAN_REASON_DEAUTH_LEAVING, enqueue); + #ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(padapter)) + rtw_mesh_expire_peer(padapter, sta_addr); + #endif } - issue_deauth(padapter, bc_addr, WLAN_REASON_DEAUTH_LEAVING); + if (!MLME_IS_MESH(padapter)) + issue_deauth(padapter, bc_addr, WLAN_REASON_DEAUTH_LEAVING); associated_clients_update(padapter, _TRUE, STA_INFO_UPDATE_ALL); @@ -3460,14 +4007,12 @@ 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, psta->rssi_level, _TRUE); /* 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) { - struct mlme_priv *mlmepriv = &padapter->mlmepriv; struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); struct sta_priv *pstapriv = &padapter->stapriv; struct sta_info *psta; struct security_priv *psecuritypriv = &(padapter->securitypriv); @@ -3477,7 +4022,10 @@ void rtw_ap_restore_network(_adapter *padapter) char chk_alive_list[NUM_STA]; int i; - rtw_setopmode_cmd(padapter, Ndis802_11APMode, _FALSE); + rtw_setopmode_cmd(padapter + , MLME_IS_AP(padapter) ? Ndis802_11APMode : Ndis802_11_mesh + , RTW_CMDF_DIRECTLY + ); set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); @@ -3533,7 +4081,9 @@ void start_ap_mode(_adapter *padapter) struct sta_priv *pstapriv = &padapter->stapriv; struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); +#ifdef CONFIG_CONCURRENT_MODE struct security_priv *psecuritypriv = &padapter->securitypriv; +#endif pmlmepriv->update_bcn = _FALSE; @@ -3574,13 +4124,9 @@ void start_ap_mode(_adapter *padapter) psecuritypriv->dot118021x_bmc_cam_id = INVALID_SEC_MAC_CAM_ID; #endif - for (i = 0 ; i < NUM_STA ; i++) + for (i = 0 ; i < pstapriv->max_aid; i++) pstapriv->sta_aid[i] = NULL; -#if CONFIG_RTW_MACADDR_ACL - rtw_macaddr_acl_init(padapter); -#endif - psta = rtw_get_bcmc_stainfo(padapter); /*_enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL);*/ if (psta) @@ -3594,16 +4140,45 @@ 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) { - _irqL irqL; + u8 self_action = MLME_ACTION_UNKNOWN; struct sta_info *psta = NULL; struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; +#ifdef CONFIG_SUPPORT_MULTI_BCN struct dvobj_priv *pdvobj = padapter->dvobj; + _irqL irqL; +#endif 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; @@ -3615,49 +4190,72 @@ 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_rd_en_decision(padapter, self_action, 0); #endif /* free scan queue */ rtw_free_network_queue(padapter, _TRUE); #if CONFIG_RTW_MACADDR_ACL - rtw_macaddr_acl_deinit(padapter); + rtw_macaddr_acl_clear(padapter, RTW_ACL_PERIOD_BSS); #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); -#ifdef CONFIG_SWTIMER_BASED_TXBCN +#ifdef CONFIG_SUPPORT_MULTI_BCN if (pmlmeext->bstart_bss == _TRUE) { + #ifdef CONFIG_FW_HANDLE_TXBCN + u8 free_apid = CONFIG_LIMITED_AP_NUM; + #endif + _enter_critical_bh(&pdvobj->ap_if_q.lock, &irqL); pdvobj->nr_ap_if--; if (pdvobj->nr_ap_if > 0) pdvobj->inter_bcn_space = DEFAULT_BCN_INTERVAL / pdvobj->nr_ap_if; else pdvobj->inter_bcn_space = DEFAULT_BCN_INTERVAL; - + #ifdef CONFIG_FW_HANDLE_TXBCN + rtw_ap_release_vapid(pdvobj, padapter->vap_id); + free_apid = padapter->vap_id; + padapter->vap_id = CONFIG_LIMITED_AP_NUM; + #endif rtw_list_delete(&padapter->list); _exit_critical_bh(&pdvobj->ap_if_q.lock, &irqL); + #ifdef CONFIG_FW_HANDLE_TXBCN + rtw_ap_mbid_bcn_dis(padapter, free_apid); + #endif + #ifdef CONFIG_SWTIMER_BASED_TXBCN rtw_hal_set_hwreg(padapter, HW_VAR_BEACON_INTERVAL, (u8 *)(&pdvobj->inter_bcn_space)); if (pdvobj->nr_ap_if == 0) _cancel_timer_ex(&pdvobj->txbcn_timer); + #endif } #endif pmlmeext->bstart_bss = _FALSE; + rtw_hal_rcr_set_chk_bssid(padapter, self_action); + +#ifdef CONFIG_HW_P0_TSF_SYNC + correct_TSF(padapter, self_action); +#endif + #ifdef CONFIG_BT_COEXIST rtw_btcoex_MediaStatusNotify(padapter, 0); /* disconnect */ #endif @@ -3670,10 +4268,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; @@ -3766,65 +4386,284 @@ 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 - , u8 *ch, u8 *bw, u8 *offset, u8 *chbw_allow) +static u8 rtw_ap_update_chbw_by_ifbmp(struct dvobj_priv *dvobj, u8 ifbmp + , u8 cur_ie_ch[], u8 cur_ie_bw[], u8 cur_ie_offset[] + , u8 dec_ch[], u8 dec_bw[], u8 dec_offset[] + , const char *caller) { - u8 cur_ie_ch, cur_ie_bw, cur_ie_offset; - u8 dec_ch, dec_bw, dec_offset; - 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); - struct mi_state mstate; - bool set_u_ch = _FALSE, set_dec_ch = _FALSE; + _adapter *iface; + struct mlme_ext_priv *mlmeext; + WLAN_BSSID_EX *network; + u8 ifbmp_ch_changed = 0; + int i; - 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); + for (i = 0; i < dvobj->iface_nums; i++) { + if (!(ifbmp & BIT(i)) || !dvobj->padapters) + continue; + + iface = dvobj->padapters[i]; + mlmeext = &(iface->mlmeextpriv); + + if (MLME_IS_ASOC(iface)) { + RTW_INFO(FUNC_ADPT_FMT" %u,%u,%u => %u,%u,%u%s\n", caller, ADPT_ARG(iface) + , mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset + , dec_ch[i], dec_bw[i], dec_offset[i] + , MLME_IS_OPCH_SW(iface) ? " OPCH_SW" : ""); + } else { + RTW_INFO(FUNC_ADPT_FMT" %u,%u,%u => %u,%u,%u%s\n", caller, ADPT_ARG(iface) + , cur_ie_ch[i], cur_ie_bw[i], cur_ie_offset[i] + , dec_ch[i], dec_bw[i], dec_offset[i] + , MLME_IS_OPCH_SW(iface) ? " OPCH_SW" : ""); + } + } + + for (i = 0; i < dvobj->iface_nums; i++) { + if (!(ifbmp & BIT(i)) || !dvobj->padapters) + continue; + + iface = dvobj->padapters[i]; + mlmeext = &(iface->mlmeextpriv); + network = &(mlmeext->mlmext_info.network); + + /* ch setting differs from mlmeext.network IE */ + if (cur_ie_ch[i] != dec_ch[i] + || cur_ie_bw[i] != dec_bw[i] + || cur_ie_offset[i] != dec_offset[i]) + ifbmp_ch_changed |= BIT(i); + + /* ch setting differs from existing one */ + if (MLME_IS_ASOC(iface) + && (mlmeext->cur_channel != dec_ch[i] + || mlmeext->cur_bwmode != dec_bw[i] + || mlmeext->cur_ch_offset != dec_offset[i]) + ) { + if (rtw_linked_check(iface) == _TRUE) { + #ifdef CONFIG_SPCT_CH_SWITCH + if (1) + rtw_ap_inform_ch_switch(iface, dec_ch[i], dec_offset[i]); + else + #endif + rtw_sta_flush(iface, _FALSE); + } + } + + mlmeext->cur_channel = dec_ch[i]; + mlmeext->cur_bwmode = dec_bw[i]; + mlmeext->cur_ch_offset = dec_offset[i]; + + rtw_ap_update_bss_chbw(iface, network, dec_ch[i], dec_bw[i], dec_offset[i]); + } + + return ifbmp_ch_changed; +} + +static u8 rtw_ap_ch_specific_chk(_adapter *adapter, u8 ch, u8 *bw, u8 *offset, const char *caller) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + RT_CHANNEL_INFO *chset = adapter_to_chset(adapter); + u8 ret = _SUCCESS; + + if (rtw_chset_search_ch(chset, ch) < 0) { + RTW_WARN("%s ch:%u doesn't fit in chplan\n", caller, ch); + ret = _FAIL; + goto exit; + } + + rtw_adjust_chbw(adapter, ch, bw, offset); + + if (!rtw_get_offset_by_chbw(ch, *bw, offset)) { + RTW_WARN("%s %u,%u has no valid offset\n", caller, ch, *bw); + ret = _FAIL; + goto exit; + } + + while (!rtw_chset_is_chbw_valid(chset, ch, *bw, *offset) + || (rtw_odm_dfs_domain_unknown(dvobj) && rtw_is_dfs_chbw(ch, *bw, *offset)) + ) { + if (*bw > CHANNEL_WIDTH_20) + (*bw)--; + if (*bw == CHANNEL_WIDTH_20) { + *offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; + break; + } + } + + if (rtw_odm_dfs_domain_unknown(dvobj) && rtw_is_dfs_chbw(ch, *bw, *offset)) { + RTW_WARN("%s DFS channel %u can't be used\n", caller, ch); + ret = _FAIL; + goto exit; + } + +exit: + return ret; +} + +static bool rtw_ap_choose_chbw(_adapter *adapter, u8 sel_ch, u8 max_bw, u8 cur_ch + , u8 *ch, u8 *bw, u8 *offset, u8 mesh_only, const char *caller) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); + bool ch_avail = _FALSE; + +#if defined(CONFIG_DFS_MASTER) + if (!rtw_odm_dfs_domain_unknown(dvobj)) { + if (rfctl->radar_detected + && rfctl->dbg_dfs_choose_dfs_ch_first + ) { + ch_avail = rtw_choose_shortest_waiting_ch(rfctl, sel_ch, max_bw + , ch, bw, offset + , RTW_CHF_2G | RTW_CHF_NON_DFS + , cur_ch + , rfctl->ch_sel_same_band_prefer, mesh_only); + if (ch_avail == _TRUE) { + RTW_INFO("%s choose 5G DFS channel for debug\n", caller); + goto exit; + } + } + + if (rfctl->radar_detected + && rfctl->dfs_ch_sel_d_flags + ) { + ch_avail = rtw_choose_shortest_waiting_ch(rfctl, sel_ch, max_bw + , ch, bw, offset + , rfctl->dfs_ch_sel_d_flags + , cur_ch + , rfctl->ch_sel_same_band_prefer, mesh_only); + if (ch_avail == _TRUE) { + RTW_INFO("%s choose with dfs_ch_sel_d_flags:0x%02x for debug\n" + , caller, rfctl->dfs_ch_sel_d_flags); + goto exit; + } + } + + ch_avail = rtw_choose_shortest_waiting_ch(rfctl, sel_ch, max_bw + , ch, bw, offset + , 0 + , cur_ch + , rfctl->ch_sel_same_band_prefer, mesh_only); + } else +#endif /* defined(CONFIG_DFS_MASTER) */ + { + ch_avail = rtw_choose_shortest_waiting_ch(rfctl, sel_ch, max_bw + , ch, bw, offset + , RTW_CHF_DFS + , cur_ch + , rfctl->ch_sel_same_band_prefer, mesh_only); + } +#if defined(CONFIG_DFS_MASTER) +exit: +#endif + if (ch_avail == _FALSE) + RTW_WARN("%s no available channel\n", caller); + + return ch_avail; +} + +u8 rtw_ap_chbw_decision(_adapter *adapter, u8 ifbmp, u8 excl_ifbmp + , s16 req_ch, s8 req_bw, s8 req_offset + , u8 *ch, u8 *bw, u8 *offset, u8 *chbw_allow) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + RT_CHANNEL_INFO *chset = adapter_to_chset(adapter); + struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); + bool ch_avail = _FALSE; + u8 cur_ie_ch[CONFIG_IFACE_NUMBER] = {0}; + u8 cur_ie_bw[CONFIG_IFACE_NUMBER] = {0}; + u8 cur_ie_offset[CONFIG_IFACE_NUMBER] = {0}; + u8 dec_ch[CONFIG_IFACE_NUMBER] = {0}; + u8 dec_bw[CONFIG_IFACE_NUMBER] = {0}; + u8 dec_offset[CONFIG_IFACE_NUMBER] = {0}; + u8 u_ch = 0, u_bw = 0, u_offset = 0; + struct mlme_ext_priv *mlmeext; + WLAN_BSSID_EX *network; + struct mi_state mstate; + struct mi_state mstate_others; + bool set_u_ch = _FALSE; + u8 ifbmp_others = 0xFF & ~ifbmp & ~excl_ifbmp; + u8 ifbmp_ch_changed = 0; + bool ifbmp_all_mesh = 0; + _adapter *iface; + int i; + +#ifdef CONFIG_RTW_MESH + for (i = 0; i < dvobj->iface_nums; i++) + if ((ifbmp & BIT(i)) && dvobj->padapters) + if (!MLME_IS_MESH(dvobj->padapters[i])) + break; + ifbmp_all_mesh = i >= dvobj->iface_nums ? 1 : 0; +#endif + + RTW_INFO("%s ifbmp:0x%02x excl_ifbmp:0x%02x req:%d,%d,%d\n", __func__ + , ifbmp, excl_ifbmp, req_ch, req_bw, req_offset); + rtw_mi_status_by_ifbmp(dvobj, ifbmp, &mstate); + rtw_mi_status_by_ifbmp(dvobj, ifbmp_others, &mstate_others); + RTW_INFO("%s others ld_sta_num:%u, lg_sta_num:%u, ap_num:%u, mesh_num:%u\n" + , __func__, MSTATE_STA_LD_NUM(&mstate_others), MSTATE_STA_LG_NUM(&mstate_others) + , MSTATE_AP_NUM(&mstate_others), MSTATE_MESH_NUM(&mstate_others)); + + for (i = 0; i < dvobj->iface_nums; i++) { + if (!(ifbmp & BIT(i)) || !dvobj->padapters[i]) + continue; + iface = dvobj->padapters[i]; + mlmeext = &(iface->mlmeextpriv); + network = &(mlmeext->mlmext_info.network); + + /* get current IE channel settings */ + rtw_ies_get_chbw(BSS_EX_TLV_IES(network), BSS_EX_TLV_IES_LEN(network) + , &cur_ie_ch[i], &cur_ie_bw[i], &cur_ie_offset[i], 1, 1); + + /* prepare temporary channel setting decision */ + if (req_ch == 0) { + /* request comes from upper layer, use cur_ie values */ + dec_ch[i] = cur_ie_ch[i]; + dec_bw[i] = cur_ie_bw[i]; + dec_offset[i] = cur_ie_offset[i]; + } else { + /* use chbw of cur_ie updated with specifying req as temporary decision */ + dec_ch[i] = (req_ch <= REQ_CH_NONE) ? cur_ie_ch[i] : req_ch; + if (req_bw <= REQ_BW_NONE) { + if (req_bw == REQ_BW_ORI) + dec_bw[i] = iface->mlmepriv.ori_bw; + else + dec_bw[i] = cur_ie_bw[i]; + } else + dec_bw[i] = req_bw; + dec_offset[i] = (req_offset <= REQ_OFFSET_NONE) ? cur_ie_offset[i] : req_offset; + } + } + + if (MSTATE_STA_LD_NUM(&mstate_others) || MSTATE_STA_LG_NUM(&mstate_others) + || MSTATE_AP_NUM(&mstate_others) || MSTATE_MESH_NUM(&mstate_others) + ) { + /* has linked/linking STA or has AP/Mesh mode */ + rtw_warn_on(!rtw_mi_get_ch_setting_union_by_ifbmp(dvobj, ifbmp_others, &u_ch, &u_bw, &u_offset)); + RTW_INFO("%s others union:%u,%u,%u\n", __func__, u_ch, u_bw, u_offset); + } #ifdef CONFIG_MCC_MODE - if (MCC_EN(adapter)) { + if (MCC_EN(adapter) && req_ch == 0) { if (rtw_hal_check_mcc_status(adapter, MCC_STATUS_DOING_MCC)) { + u8 if_id = adapter->iface_id; + + mlmeext = &(adapter->mlmeextpriv); + /* 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) { + if (cur_ie_ch[if_id] == mlmeext->cur_channel + && cur_ie_bw[if_id] == mlmeext->cur_bwmode + && cur_ie_offset[if_id] == 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)); - 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; + *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_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[if_id], cur_ie_bw[if_id], cur_ie_offset[if_id] + , mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset); rtw_hal_set_mcc_setting_disconnect(adapter); } @@ -3832,201 +4671,278 @@ bool rtw_ap_chbw_decision(_adapter *adapter, s16 req_ch, s8 req_bw, s8 req_offse } #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; - dec_bw = (req_bw < 0) ? cur_ie_bw : req_bw; - dec_offset = (req_offset < 0) ? cur_ie_offset : req_offset; + if (MSTATE_STA_LG_NUM(&mstate_others) && !MSTATE_STA_LD_NUM(&mstate_others)) { + /* has linking STA but no linked STA */ - 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)); + for (i = 0; i < dvobj->iface_nums; i++) { + if (!(ifbmp & BIT(i)) || !dvobj->padapters[i]) + continue; + iface = dvobj->padapters[i]; - if (MSTATE_STA_LD_NUM(&mstate) || MSTATE_AP_NUM(&mstate)) { - /* has linked STA or AP mode, follow */ + rtw_adjust_chbw(iface, dec_ch[i], &dec_bw[i], &dec_offset[i]); + #ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(iface)) + rtw_mesh_adjust_chbw(dec_ch[i], &dec_bw[i], &dec_offset[i]); + #endif - rtw_warn_on(!rtw_mi_get_ch_setting_union_no_self(adapter, &u_ch, &u_bw, &u_offset)); + if (rtw_is_chbw_grouped(u_ch, u_bw, u_offset, dec_ch[i], dec_bw[i], dec_offset[i])) { + rtw_chset_sync_chbw(chset + , &dec_ch[i], &dec_bw[i], &dec_offset[i] + , &u_ch, &u_bw, &u_offset); + set_u_ch = _TRUE; - 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); - - rtw_adjust_chbw(adapter, u_ch, &dec_bw, &dec_offset); -#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)) { - mlmeext->cur_channel = *ch = dec_ch; - mlmeext->cur_bwmode = *bw = dec_bw; - mlmeext->cur_ch_offset = *offset = dec_offset; - /* channel bw offset can not be allowed, need MCC */ - *chbw_allow = _FALSE; - RTW_INFO(FUNC_ADPT_FMT" enable mcc: %u,%u,%u\n", FUNC_ADPT_ARG(adapter) - , *ch, *bw, *offset); - goto exit; - } else /* channel bw offset can be allowed, not need MCC */ *chbw_allow = _TRUE; - } -#endif /* CONFIG_MCC_MODE */ - rtw_sync_chbw(&dec_ch, &dec_bw, &dec_offset - , &u_ch, &u_bw, &u_offset); + } else { + #ifdef CONFIG_MCC_MODE + if (MCC_EN(iface)) { + mlmeext = &(iface->mlmeextpriv); + mlmeext->cur_channel = *ch = dec_ch[i]; + mlmeext->cur_bwmode = *bw = dec_bw[i]; + mlmeext->cur_ch_offset = *offset = dec_offset[i]; - rtw_ap_update_bss_chbw(adapter, &(adapter->mlmepriv.cur_network.network) - , dec_ch, dec_bw, dec_offset); + /* channel bw offset can not be allowed, need MCC */ + *chbw_allow = _FALSE; + RTW_INFO(FUNC_ADPT_FMT" enable mcc: %u,%u,%u\n", FUNC_ADPT_ARG(iface) + , *ch, *bw, *offset); + goto exit; + } + #endif /* CONFIG_MCC_MODE */ + + /* set this for possible ch change when join down*/ + set_fwstate(&iface->mlmepriv, WIFI_OP_CH_SWITCHING); + } + } + + } else if (MSTATE_STA_LD_NUM(&mstate_others) + || MSTATE_AP_NUM(&mstate_others) || MSTATE_MESH_NUM(&mstate_others) + ) { + /* has linked STA mode or AP/Mesh mode */ + + for (i = 0; i < dvobj->iface_nums; i++) { + if (!(ifbmp & BIT(i)) || !dvobj->padapters[i]) + continue; + iface = dvobj->padapters[i]; + + rtw_adjust_chbw(iface, u_ch, &dec_bw[i], &dec_offset[i]); + #ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(iface)) + rtw_mesh_adjust_chbw(u_ch, &dec_bw[i], &dec_offset[i]); + #endif + + #ifdef CONFIG_MCC_MODE + if (MCC_EN(iface)) { + if (!rtw_is_chbw_grouped(u_ch, u_bw, u_offset, dec_ch[i], dec_bw[i], dec_offset[i])) { + mlmeext = &(iface->mlmeextpriv); + mlmeext->cur_channel = *ch = dec_ch[i] = cur_ie_ch[i]; + mlmeext->cur_bwmode = *bw = dec_bw[i] = cur_ie_bw[i]; + mlmeext->cur_ch_offset = *offset = dec_offset[i] = cur_ie_offset[i]; + /* channel bw offset can not be allowed, need MCC */ + *chbw_allow = _FALSE; + RTW_INFO(FUNC_ADPT_FMT" enable mcc: %u,%u,%u\n", FUNC_ADPT_ARG(iface) + , *ch, *bw, *offset); + goto exit; + } else + /* channel bw offset can be allowed, not need MCC */ + *chbw_allow = _TRUE; + } + #endif /* CONFIG_MCC_MODE */ + + if (req_ch == 0 && dec_bw[i] > u_bw + && rtw_is_dfs_chbw(u_ch, u_bw, u_offset) + ) { + /* request comes from upper layer, prevent from additional channel waiting */ + dec_bw[i] = u_bw; + if (dec_bw[i] == CHANNEL_WIDTH_20) + dec_offset[i] = HAL_PRIME_CHNL_OFFSET_DONT_CARE; + } + + /* follow */ + rtw_chset_sync_chbw(chset + , &dec_ch[i], &dec_bw[i], &dec_offset[i] + , &u_ch, &u_bw, &u_offset); + } set_u_ch = _TRUE; - } else if (MSTATE_STA_LG_NUM(&mstate)) { - /* has linking STA */ - 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); - - rtw_adjust_chbw(adapter, dec_ch, &dec_bw, &dec_offset); - - 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); - - set_u_ch = _TRUE; - - /* channel bw offset can be allowed, not need MCC */ - *chbw_allow = _TRUE; - } else { -#ifdef CONFIG_MCC_MODE - if (MCC_EN(adapter)) { - mlmeext->cur_channel = *ch = dec_ch; - mlmeext->cur_bwmode = *bw = dec_bw; - mlmeext->cur_ch_offset = *offset = dec_offset; - - /* channel bw offset can not be allowed, need MCC */ - *chbw_allow = _FALSE; - RTW_INFO(FUNC_ADPT_FMT" enable mcc: %u,%u,%u\n", FUNC_ADPT_ARG(adapter) - , *ch, *bw, *offset); - goto exit; - } -#endif /* CONFIG_MCC_MODE */ - /* set this for possible ch change when join down*/ - set_fwstate(&adapter->mlmepriv, WIFI_OP_CH_SWITCHING); - } } else { - /* single AP mode */ + /* autonomous decision */ + u8 ori_ch = 0; + u8 max_bw; - RTW_INFO(FUNC_ADPT_FMT" req: %d,%d,%d\n", FUNC_ADPT_ARG(adapter), req_ch, req_bw, req_offset); + /* autonomous decision, not need MCC */ + *chbw_allow = _TRUE; - /* check temporary decision first */ - rtw_adjust_chbw(adapter, dec_ch, &dec_bw, &dec_offset); - if (!rtw_get_offset_by_chbw(dec_ch, dec_bw, &dec_offset)) { - if (req_ch == -1 || req_bw == -1) - goto choose_chbw; - 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 (req_ch <= REQ_CH_NONE) /* channel is not specified */ + goto choose_chbw; + + /* get tmp dec union of ifbmp */ + for (i = 0; i < dvobj->iface_nums; i++) { + if (!(ifbmp & BIT(i)) || !dvobj->padapters[i]) + continue; + if (u_ch == 0) { + u_ch = dec_ch[i]; + u_bw = dec_bw[i]; + u_offset = dec_offset[i]; + rtw_adjust_chbw(adapter, u_ch, &u_bw, &u_offset); + rtw_get_offset_by_chbw(u_ch, u_bw, &u_offset); + } else { + u8 tmp_ch = dec_ch[i]; + u8 tmp_bw = dec_bw[i]; + u8 tmp_offset = dec_offset[i]; + + rtw_adjust_chbw(adapter, tmp_ch, &tmp_bw, &tmp_offset); + rtw_get_offset_by_chbw(tmp_ch, tmp_bw, &tmp_offset); + + rtw_warn_on(!rtw_is_chbw_grouped(u_ch, u_bw, u_offset, tmp_ch, tmp_bw, tmp_offset)); + rtw_sync_chbw(&tmp_ch, &tmp_bw, &tmp_offset, &u_ch, &u_bw, &u_offset); + } } - if (!rtw_chset_is_chbw_valid(mlmeext->channel_set, dec_ch, dec_bw, dec_offset)) { - if (req_ch == -1 || req_bw == -1) - goto choose_chbw; - 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; - } + #ifdef CONFIG_RTW_MESH + /* if ifbmp are all mesh, apply bw restriction */ + if (ifbmp_all_mesh) + rtw_mesh_adjust_chbw(u_ch, &u_bw, &u_offset); + #endif - if (rtw_odm_dfs_domain_unknown(adapter) && rtw_is_dfs_ch(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); + RTW_INFO("%s ifbmp:0x%02x tmp union:%u,%u,%u\n", __func__, ifbmp, u_ch, u_bw, u_offset); + + /* check if tmp dec union is usable */ + if (rtw_ap_ch_specific_chk(adapter, u_ch, &u_bw, &u_offset, __func__) == _FAIL) { + /* channel can't be used */ 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(mlmeext->channel_set, dec_ch, dec_bw, dec_offset) == _FALSE) + } else if (rtw_chset_is_chbw_non_ocp(chset, u_ch, u_bw, u_offset)) { + RTW_WARN("%s DFS channel %u,%u under non ocp\n", __func__, u_ch, u_bw); + if (req_ch > 0 && req_bw > REQ_BW_NONE) { + /* change_chbw with specific channel and specific bw, goto update_bss_chbw directly */ + goto update_bss_chbw; + } + } else goto update_bss_chbw; choose_chbw: - if (req_bw < 0) - req_bw = cur_ie_bw; + req_ch = req_ch > 0 ? req_ch : 0; + max_bw = req_bw > REQ_BW_NONE ? req_bw : CHANNEL_WIDTH_20; + for (i = 0; i < dvobj->iface_nums; i++) { + if (!(ifbmp & BIT(i)) || !dvobj->padapters[i]) + continue; + iface = dvobj->padapters[i]; + mlmeext = &(iface->mlmeextpriv); -#if defined(CONFIG_DFS_MASTER) - 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; + if (req_bw <= REQ_BW_NONE) { + if (req_bw == REQ_BW_ORI) { + if (max_bw < iface->mlmepriv.ori_bw) + max_bw = iface->mlmepriv.ori_bw; + } else { + if (max_bw < cur_ie_bw[i]) + max_bw = cur_ie_bw[i]; + } + } + + if (MSTATE_AP_NUM(&mstate) || MSTATE_MESH_NUM(&mstate)) { + if (ori_ch == 0) + ori_ch = mlmeext->cur_channel; + else if (ori_ch != mlmeext->cur_channel) + rtw_warn_on(1); + } else { + if (ori_ch == 0) + ori_ch = cur_ie_ch[i]; + else if (ori_ch != cur_ie_ch[i]) + rtw_warn_on(1); } - } 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; } -update_bss_chbw: - rtw_ap_update_bss_chbw(adapter, &(adapter->mlmepriv.cur_network.network) - , dec_ch, dec_bw, dec_offset); + ch_avail = rtw_ap_choose_chbw(adapter, req_ch, max_bw + , ori_ch, &u_ch, &u_bw, &u_offset, ifbmp_all_mesh, __func__); + if (ch_avail == _FALSE) + goto exit; - /* channel bw offset can be allowed for single AP, not need MCC */ - *chbw_allow = _TRUE; - set_dec_ch = _TRUE; +update_bss_chbw: + for (i = 0; i < dvobj->iface_nums; i++) { + if (!(ifbmp & BIT(i)) || !dvobj->padapters[i]) + continue; + iface = dvobj->padapters[i]; + + dec_ch[i] = u_ch; + if (dec_bw[i] > u_bw) + dec_bw[i] = u_bw; + if (dec_bw[i] == CHANNEL_WIDTH_20) + dec_offset[i] = HAL_PRIME_CHNL_OFFSET_DONT_CARE; + else + dec_offset[i] = u_offset; + + #ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(iface)) + rtw_mesh_adjust_chbw(dec_ch[i], &dec_bw[i], &dec_offset[i]); + #endif + } + + set_u_ch = _TRUE; } + ifbmp_ch_changed = rtw_ap_update_chbw_by_ifbmp(dvobj, ifbmp + , cur_ie_ch, cur_ie_bw, cur_ie_offset + , dec_ch, dec_bw, dec_offset + , __func__); + + if (u_ch != 0) + RTW_INFO("%s union:%u,%u,%u\n", __func__, u_ch, u_bw, u_offset); + if (rtw_mi_check_fwstate(adapter, _FW_UNDER_SURVEY)) { /* scanning, leave ch setting to scan state machine */ - set_u_ch = set_dec_ch = _FALSE; + set_u_ch = _FALSE; } - if (mlmeext->cur_channel != dec_ch - || mlmeext->cur_bwmode != dec_bw - || mlmeext->cur_ch_offset != dec_offset) - changed = _TRUE; - - if (changed == _TRUE && rtw_linked_check(adapter) == _TRUE) { -#ifdef CONFIG_SPCT_CH_SWITCH - if (1) - rtw_ap_inform_ch_switch(adapter, dec_ch, dec_offset); - else -#endif - rtw_sta_flush(adapter, _FALSE); - } - - mlmeext->cur_channel = dec_ch; - mlmeext->cur_bwmode = dec_bw; - mlmeext->cur_ch_offset = dec_offset; - - if (u_ch != 0) - RTW_INFO(FUNC_ADPT_FMT" union: %u,%u,%u\n", FUNC_ADPT_ARG(adapter), u_ch, u_bw, u_offset); - - RTW_INFO(FUNC_ADPT_FMT" dec: %u,%u,%u\n", FUNC_ADPT_ARG(adapter), dec_ch, dec_bw, dec_offset); - if (set_u_ch == _TRUE) { *ch = u_ch; *bw = u_bw; *offset = u_offset; - } else if (set_dec_ch == _TRUE) { - *ch = dec_ch; - *bw = dec_bw; - *offset = dec_offset; } exit: - return changed; + return ifbmp_ch_changed; +} + +u8 rtw_ap_sta_states_check(_adapter *adapter) +{ + struct sta_info *psta; + struct sta_priv *pstapriv = &adapter->stapriv; + _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)) { + RTW_INFO(ADPT_FMT"- SoftAP/Mesh - sta under linking, its state = 0x%x\n", ADPT_ARG(adapter), psta->state); + rst = _TRUE; + break; + } else if (psta->state & WIFI_UNDER_KEY_HANDSHAKE) { + RTW_INFO(ADPT_FMT"- SoftAP/Mesh - sta under key handshaking, its state = 0x%x\n", ADPT_ARG(adapter), psta->state); + 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) { @@ -4038,6 +4954,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; @@ -4137,14 +5054,29 @@ 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) + && !IS_CH_WAITING(adapter_to_rfctl(padapter)) + ) { + /*update_beacon(padapter, _TIM_IE_, NULL, _FALSE);*/ + /*issue_beacon(padapter, 0);*/ + send_beacon(padapter); + } } #if 0 @@ -4159,8 +5091,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) @@ -4168,4 +5101,336 @@ 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[12]; + 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; + u32 akm = 0; + u8 mfp_opt = MFP_NO; + 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, &akm, &mfp_opt) == _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; + + sta->akm_suite_type = akm; + if (MLME_IS_AP(adapter) && (CHECK_BIT(WLAN_AKM_TYPE_SAE, akm)) && (MFP_NO == mfp_opt)) + status = WLAN_STATUS_ROBUST_MGMT_FRAME_POLICY_VIOLATION; + + 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; + } + +#ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(adapter)) { + /* MFP is mandatory for secure mesh */ + if (adapter->mesh_info.mesh_auth_id) + sta->flags |= WLAN_STA_MFP; + } else +#endif + if ((sec->mfp_opt == MFP_REQUIRED && mfp_opt == MFP_NO) || mfp_opt == MFP_INVALID) + status = WLAN_STATUS_ROBUST_MGMT_FRAME_POLICY_VIOLATION; + else if (sec->mfp_opt >= MFP_OPTIONAL && mfp_opt >= MFP_OPTIONAL) + sta->flags |= WLAN_STA_MFP; + + if (MLME_IS_AP(adapter) && + (sec->auth_type == NL80211_AUTHTYPE_SAE) && + (CHECK_BIT(WLAN_AKM_TYPE_SAE, sta->akm_suite_type)) && + (WLAN_AUTH_OPEN == sta->authalg)) { + /* WPA3-SAE, PMK caching */ + if (rtw_cached_pmkid(adapter, sta->cmn.mac_addr) == -1) { + RTW_INFO("SAE: No PMKSA cache entry found\n"); + status = WLAN_STATUS_INVALID_PMKID; + } else { + RTW_INFO("SAE: PMKSA cache entry found\n"); + } + } + + 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; + +#ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(adapter)) { + /* QoS is mandatory in mesh */ + sta->flags |= WLAN_STA_WME; + } +#endif + + 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)); + + if (elems->ht_operation && elems->ht_operation_len == HT_OP_IE_LEN) { + _rtw_memcpy(sta->htpriv.ht_op, elems->ht_operation, HT_OP_IE_LEN); + sta->htpriv.op_present = 1; + } + } +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 == VHT_CAP_IE_LEN) { + sta->flags |= WLAN_STA_VHT; + _rtw_memcpy(sta->vhtpriv.vht_cap, elems->vht_capabilities, VHT_CAP_IE_LEN); + + if (elems->vht_operation && elems->vht_operation_len== VHT_OP_IE_LEN) { + _rtw_memcpy(sta->vhtpriv.vht_op, elems->vht_operation, VHT_OP_IE_LEN); + sta->vhtpriv.op_present = 1; + } + + 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); + sta->vhtpriv.notify_present = 1; + } + } +exit: +#endif + + return; +} #endif /* CONFIG_AP_MODE */ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_beamforming.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_beamforming.c index 28a7899c6f24..c1c82160b664 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_beamforming.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_beamforming.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 @@ -50,10 +46,10 @@ static void _get_txvector_parameter(PADAPTER adapter, struct sta_info *sta, u8 * * a DLS or TDLS peer STA */ - aid = sta->aid; + aid = sta->cmn.aid; bssid = adapter_mac_addr(adapter); RTW_INFO("%s: AID=0x%x BSSID=" MAC_FMT "\n", - __FUNCTION__, sta->aid, MAC_ARG(bssid)); + __FUNCTION__, sta->cmn.aid, MAC_ARG(bssid)); /* AID[0:8] */ aid &= 0x1FF; @@ -75,7 +71,7 @@ static void _get_txvector_parameter(PADAPTER adapter, struct sta_info *sta, u8 * *g_id = 63; } else { /* Addressed to AP */ - bssid = sta->hwaddr; + bssid = sta->cmn.mac_addr; RTW_INFO("%s: BSSID=" MAC_FMT "\n", __FUNCTION__, MAC_ARG(bssid)); /* BSSID[39:47] */ @@ -167,7 +163,7 @@ static void _get_sta_beamform_cap(PADAPTER adapter, struct sta_info *sta, #endif /* CONFIG_80211AC_VHT */ } -static u8 _send_ht_ndpa_packet(PADAPTER adapter, u8 *ra, CHANNEL_WIDTH bw) +static u8 _send_ht_ndpa_packet(PADAPTER adapter, u8 *ra, enum channel_width bw) { /* General */ struct xmit_priv *pxmitpriv; @@ -265,7 +261,7 @@ static u8 _send_ht_ndpa_packet(PADAPTER adapter, u8 *ra, CHANNEL_WIDTH bw) return _TRUE; } -static u8 _send_vht_ndpa_packet(PADAPTER adapter, u8 *ra, u16 aid, CHANNEL_WIDTH bw) +static u8 _send_vht_ndpa_packet(PADAPTER adapter, u8 *ra, u16 aid, enum channel_width bw) { /* General */ struct xmit_priv *pxmitpriv; @@ -371,7 +367,7 @@ static u8 _send_vht_ndpa_packet(PADAPTER adapter, u8 *ra, u16 aid, CHANNEL_WIDTH return _TRUE; } -static u8 _send_vht_mu_ndpa_packet(PADAPTER adapter, CHANNEL_WIDTH bw) +static u8 _send_vht_mu_ndpa_packet(PADAPTER adapter, enum channel_width bw) { /* General */ struct xmit_priv *pxmitpriv; @@ -867,8 +863,6 @@ static void _sounding_force_stop(PADAPTER adapter) { struct beamforming_info *info; struct sounding_info *sounding; - u8 cancelled; - info = GET_BEAMFORM_INFO(adapter); sounding = &info->sounding_info; @@ -876,7 +870,7 @@ static void _sounding_force_stop(PADAPTER adapter) if ((sounding->state == SOUNDING_STATE_SU_START) || (sounding->state == SOUNDING_STATE_MU_START)) { u8 res = _FALSE; - _cancel_timer(&info->sounding_timeout_timer, &cancelled); + _cancel_timer_ex(&info->sounding_timeout_timer); rtw_bf_cmd(adapter, BEAMFORMING_CTRL_END_PERIOD, &res, 1, 1); return; } @@ -1015,7 +1009,7 @@ static struct beamformer_entry *_bfer_add_entry(PADAPTER adapter, mlme = &adapter->mlmepriv; info = GET_BEAMFORM_INFO(adapter); - bfer = _bfer_get_entry_by_addr(adapter, sta->hwaddr); + bfer = _bfer_get_entry_by_addr(adapter, sta->cmn.mac_addr); if (!bfer) { bfer = _bfer_get_free_entry(adapter); if (!bfer) @@ -1024,14 +1018,14 @@ static struct beamformer_entry *_bfer_add_entry(PADAPTER adapter, bfer->used = _TRUE; _get_txvector_parameter(adapter, sta, &bfer->g_id, &bfer->p_aid); - _rtw_memcpy(bfer->mac_addr, sta->hwaddr, ETH_ALEN); + _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->aid; + bfer->aid = sta->cmn.aid; } else if (TEST_FLAG(bf_cap, BEAMFORMER_CAP_VHT_SU|BEAMFORMER_CAP_HT_EXPLICIT)) { info->beamformer_su_cnt += 1; @@ -1075,22 +1069,20 @@ static void _bfer_remove_entry(PADAPTER adapter, struct beamformer_entry *entry) static u8 _bfer_set_entry_gid(PADAPTER adapter, u8 *addr, u8 *gid, u8 *position) { - struct beamformer_entry *bfer = NULL; + struct beamformer_entry bfer; - - bfer = _bfer_get_entry_by_addr(adapter, addr); - if (!bfer) { - RTW_INFO("%s: Cannot find BFer entry!!\n", __FUNCTION__); - return _FAIL; - } + memset(&bfer, 0, sizeof(bfer)); + memcpy(bfer.mac_addr, addr, ETH_ALEN); /* Parsing Membership Status Array */ - _rtw_memcpy(bfer->gid_valid, gid, 8); + memcpy(bfer.gid_valid, gid, 8); + /* Parsing User Position Array */ - _rtw_memcpy(bfer->user_position, position, 16); + 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); + rtw_bf_cmd(adapter, BEAMFORMING_CTRL_SET_GID_TABLE, (u8 *) &bfer, + sizeof(bfer), 1); return _SUCCESS; } @@ -1202,7 +1194,7 @@ static struct beamformee_entry *_bfee_add_entry(PADAPTER adapter, mlme = &adapter->mlmepriv; info = GET_BEAMFORM_INFO(adapter); - bfee = _bfee_get_entry_by_addr(adapter, sta->hwaddr); + bfee = _bfee_get_entry_by_addr(adapter, sta->cmn.mac_addr); if (!bfee) { bfee = _bfee_get_free_entry(adapter); if (!bfee) @@ -1210,15 +1202,15 @@ static struct beamformee_entry *_bfee_add_entry(PADAPTER adapter, } bfee->used = _TRUE; - bfee->aid = sta->aid; - bfee->mac_id = sta->mac_id; - bfee->sound_bw = sta->bw_mode; + 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->txbf_gid = bfee->g_id; - sta->txbf_paid = 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->hwaddr, ETH_ALEN); + _rtw_memcpy(bfee->mac_addr, sta->cmn.mac_addr, ETH_ALEN); bfee->txbf = _FALSE; bfee->sounding = _FALSE; bfee->sound_period = 40; @@ -1389,15 +1381,15 @@ static void _beamforming_enter(PADAPTER adapter, void *p) info = GET_BEAMFORM_INFO(adapter); sta_copy = (struct sta_info *)p; - sta = rtw_get_stainfo(&adapter->stapriv, sta_copy->hwaddr); + 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->hwaddr)); + __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->hwaddr)); + __FUNCTION__, sta_copy, sta, MAC_ARG(sta_copy->cmn.mac_addr)); } /* The current setting does not support Beaforming */ @@ -1495,8 +1487,7 @@ static void _beamforming_leave(PADAPTER adapter, u8 *ra) /* Stop sounding if there is no any BFee */ if ((info->beamformee_su_cnt == 0) && (info->beamformee_mu_cnt == 0)) { - u8 cancelled; - _cancel_timer(&info->sounding_timer, &cancelled); + _cancel_timer_ex(&info->sounding_timer); _sounding_init(&info->sounding_info); } @@ -1567,13 +1558,11 @@ static void _beamforming_sounding_down(PADAPTER adapter, u8 status) static void _c2h_snd_txbf(PADAPTER adapter, u8 *buf, u8 buf_len) { struct beamforming_info *info; - u8 cancelled; u8 res; - info = GET_BEAMFORM_INFO(adapter); - _cancel_timer(&info->sounding_timeout_timer, &cancelled); + _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!"); @@ -1804,10 +1793,11 @@ void rtw_bf_init(PADAPTER adapter) info->beamformee_mu_reg_maping = 0; info->first_mu_bfee_index = 0xFF; info->mu_bfer_curidx = 0xFF; + info->cur_csi_rpt_rate = HALMAC_OFDM24; _sounding_init(&info->sounding_info); - _init_timer(&info->sounding_timer, adapter->pnetdev, _sounding_timer_handler, adapter); - _init_timer(&info->sounding_timeout_timer, adapter->pnetdev, _sounding_timeout_timer_handler, adapter); + 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; @@ -1842,7 +1832,7 @@ void rtw_bf_cmd_hdl(PADAPTER adapter, u8 type, u8 *pbuf) break; case BEAMFORMING_CTRL_SET_GID_TABLE: - rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_SET_GID_TABLE, *(void**)pbuf); + rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_SET_GID_TABLE, pbuf); break; case BEAMFORMING_CTRL_SET_CSI_REPORT: @@ -1912,8 +1902,8 @@ u8 rtw_bf_cmd(PADAPTER adapter, s32 type, u8 *pbuf, s32 size, u8 enqueue) void rtw_bf_update_attrib(PADAPTER adapter, struct pkt_attrib *attrib, struct sta_info *sta) { if (sta) { - attrib->txbf_g_id = sta->txbf_gid; - attrib->txbf_p_aid = sta->txbf_paid; + attrib->txbf_g_id = sta->cmn.bf_info.g_id; + attrib->txbf_p_aid = sta->cmn.bf_info.p_aid; } } @@ -1937,7 +1927,8 @@ void rtw_bf_update_traffic(PADAPTER adapter) u16 tp[MAX_BEAMFORMEE_ENTRY_NUM] = {0}; u8 tx_rate[MAX_BEAMFORMEE_ENTRY_NUM] = {0}; u64 tx_bytes, last_bytes; - u32 time, last_timestamp; + u32 time; + systime last_timestamp; u8 set_timer = _FALSE; @@ -1972,7 +1963,7 @@ void rtw_bf_update_traffic(PADAPTER adapter) 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, bfee->mac_id); + 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]); } @@ -2014,1048 +2005,38 @@ void rtw_bf_update_traffic(PADAPTER adapter) #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; - struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); - - for (i = 0; i < BEAMFORMING_ENTRY_NUM; i++) { - if (pBeamInfo->beamforming_entry[i].bUsed && - (_rtw_memcmp(ra, pBeamInfo->beamforming_entry[i].mac_addr, ETH_ALEN))) { - *idx = i; - return &(pBeamInfo->beamforming_entry[i]); - } - } - - return NULL; -} - -BEAMFORMING_CAP beamforming_get_entry_beam_cap_by_mac_id(PVOID pmlmepriv , u8 mac_id) -{ - u8 i = 0; - struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO((struct mlme_priv *)pmlmepriv); - BEAMFORMING_CAP BeamformEntryCap = BEAMFORMING_CAP_NONE; - - for (i = 0; i < BEAMFORMING_ENTRY_NUM; i++) { - if (pBeamInfo->beamforming_entry[i].bUsed && - (mac_id == pBeamInfo->beamforming_entry[i].mac_id)) { - BeamformEntryCap = pBeamInfo->beamforming_entry[i].beamforming_entry_cap; - i = BEAMFORMING_ENTRY_NUM; - } - } - - return BeamformEntryCap; -} - -struct beamforming_entry *beamforming_get_free_entry(struct mlme_priv *pmlmepriv, u8 *idx) -{ - u8 i = 0; - struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); - - for (i = 0; i < BEAMFORMING_ENTRY_NUM; i++) { - if (pBeamInfo->beamforming_entry[i].bUsed == _FALSE) { - *idx = i; - return &(pBeamInfo->beamforming_entry[i]); - } - } - return NULL; -} - - -struct beamforming_entry *beamforming_add_entry(PADAPTER adapter, u8 *ra, u16 aid, - u16 mac_id, 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); - - if (pEntry != NULL) { - pEntry->bUsed = _TRUE; - pEntry->aid = aid; - pEntry->mac_id = mac_id; - pEntry->sound_bw = bw; - if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { - u16 BSSID = ((*(adapter_mac_addr(adapter) + 5) & 0xf0) >> 4) ^ - (*(adapter_mac_addr(adapter) + 5) & 0xf); /* BSSID[44:47] xor BSSID[40:43] */ - pEntry->p_aid = (aid + BSSID * 32) & 0x1ff; /* (dec(A) + dec(B)*32) mod 512 */ - pEntry->g_id = 63; - } else if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) { - pEntry->p_aid = 0; - pEntry->g_id = 63; - } else { - pEntry->p_aid = ra[5]; /* BSSID[39:47] */ - pEntry->p_aid = (pEntry->p_aid << 1) | (ra[4] >> 7); - pEntry->g_id = 0; - } - _rtw_memcpy(pEntry->mac_addr, ra, ETH_ALEN); - pEntry->bSound = _FALSE; - - /* 3 TODO SW/FW sound period */ - pEntry->sound_period = 200; - pEntry->beamforming_entry_cap = beamfrom_cap; - pEntry->beamforming_entry_state = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; - - - 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->LogStatusFailCnt = 0; - - return pEntry; - } else - return NULL; -} - -BOOLEAN beamforming_remove_entry(struct mlme_priv *pmlmepriv, u8 *ra, u8 *idx) -{ - struct beamforming_entry *pEntry = beamforming_get_entry_by_addr(pmlmepriv, ra, idx); - - if (pEntry != NULL) { - pEntry->bUsed = _FALSE; - pEntry->beamforming_entry_cap = BEAMFORMING_CAP_NONE; - pEntry->beamforming_entry_state = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; - return _TRUE; - } else - return _FALSE; -} - -/* Used for BeamformingStart_V1 */ -void beamforming_dym_ndpa_rate(PADAPTER adapter) -{ - u16 NDPARate = MGN_6M; - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(adapter); - - if (pHalData->min_undecorated_pwdb_for_dm > 30) /* link RSSI > 30% */ - NDPARate = MGN_24M; - else - NDPARate = MGN_6M; - - /* BW = CHANNEL_WIDTH_20; */ - NDPARate = NDPARate << 8; - rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_RATE, (u8 *)&NDPARate); -} - -void beamforming_dym_period(PADAPTER Adapter) -{ - u8 Idx; - BOOLEAN bChangePeriod = _FALSE; - u16 SoundPeriod_SW, SoundPeriod_FW; - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(Adapter); - struct beamforming_entry *pBeamformEntry; - struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO((&Adapter->mlmepriv)); - struct sounding_info *pSoundInfo = &(pBeamInfo->sounding_info); - - /* 3 TODO per-client throughput caculation. */ - - if (pdvobjpriv->traffic_stat.cur_tx_tp + pdvobjpriv->traffic_stat.cur_rx_tp > 2) { - SoundPeriod_SW = 32 * 20; - SoundPeriod_FW = 2; - } else { - SoundPeriod_SW = 32 * 2000; - SoundPeriod_FW = 200; - } - - for (Idx = 0; Idx < BEAMFORMING_ENTRY_NUM; Idx++) { - pBeamformEntry = pBeamInfo->beamforming_entry + Idx; - if (pBeamformEntry->bDefaultCSI) { - SoundPeriod_SW = 32 * 2000; - SoundPeriod_FW = 200; - } - - if (pBeamformEntry->beamforming_entry_cap & (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP_VHT_SU)) { - if (pSoundInfo->sound_mode == SOUNDING_FW_VHT_TIMER || pSoundInfo->sound_mode == SOUNDING_FW_HT_TIMER) { - if (pBeamformEntry->sound_period != SoundPeriod_FW) { - pBeamformEntry->sound_period = SoundPeriod_FW; - bChangePeriod = _TRUE; /* Only FW sounding need to send H2C packet to change sound period. */ - } - } else if (pBeamformEntry->sound_period != SoundPeriod_SW) - pBeamformEntry->sound_period = SoundPeriod_SW; - } - } - - if (bChangePeriod) - 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) -{ - 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 ActionHdr[4] = {ACT_CAT_VENDOR, 0x00, 0xe0, 0x4c}; - u8 *pframe; - u16 *fctrl; - u16 duration = 0; - u8 aSifsTime = 0; - u8 NDPTxRate = 0; - - RTW_INFO("%s: issue_ht_sw_ndpa_packet!\n", __func__); - - NDPTxRate = MGN_MCS8; - RTW_INFO("%s: NDPTxRate =%d\n", __func__, NDPTxRate); - pmgntframe = alloc_mgtxmitframe(pxmitpriv); - - if (pmgntframe == NULL) - 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; - - 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); - _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; - - 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, ActionHdr, 4); - - pattrib->pktlen = 32; - - pattrib->last_txcmdsz = pattrib->pktlen; - - dump_mgntframe(Adapter, pmgntframe); - - return _TRUE; - - -} -BOOLEAN issue_ht_ndpa_packet(PADAPTER Adapter, u8 *ra, CHANNEL_WIDTH bw, u8 qidx) -{ - 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 ActionHdr[4] = {ACT_CAT_VENDOR, 0x00, 0xe0, 0x4c}; - u8 *pframe; - u16 *fctrl; - u16 duration = 0; - u8 aSifsTime = 0; - - pmgntframe = alloc_mgtxmitframe(pxmitpriv); - - if (pmgntframe == NULL) - return _FALSE; - - /*update attribute*/ - pattrib = &pmgntframe->attrib; - update_mgntframe_attrib(Adapter, pattrib); - - if (qidx == BCN_QUEUE_INX) - pattrib->qsel = QSLT_BEACON; - pattrib->rate = MGN_MCS8; - 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, adapter_mac_addr(Adapter), 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; - - 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, ActionHdr, 4); - - pattrib->pktlen = 32; - - pattrib->last_txcmdsz = pattrib->pktlen; - - dump_mgntframe(Adapter, pmgntframe); - - return _TRUE; -} - -BOOLEAN beamforming_send_ht_ndpa_packet(PADAPTER Adapter, u8 *ra, 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) -{ - 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 beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); - struct rtw_ndpa_sta_info sta_info; - u8 NDPTxRate = 0; - - u8 *pframe; - u16 *fctrl; - u16 duration = 0; - u8 sequence = 0, aSifsTime = 0; - - RTW_INFO("%s: issue_vht_sw_ndpa_packet!\n", __func__); - - - NDPTxRate = MGN_VHT2SS_MCS0; - RTW_INFO("%s: NDPTxRate =%d\n", __func__, NDPTxRate); - pmgntframe = alloc_mgtxmitframe(pxmitpriv); - - if (pmgntframe == NULL) { - RTW_INFO("%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->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, adapter_mac_addr(Adapter), ETH_ALEN); - - 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); - - sequence = pBeamInfo->sounding_sequence << 2; - if (pBeamInfo->sounding_sequence >= 0x3f) - pBeamInfo->sounding_sequence = 0; - else - pBeamInfo->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 issue_vht_ndpa_packet(PADAPTER Adapter, u8 *ra, u16 aid, CHANNEL_WIDTH bw, u8 qidx) -{ - 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 beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); - struct rtw_ndpa_sta_info sta_info; - u8 *pframe; - u16 *fctrl; - u16 duration = 0; - u8 sequence = 0, aSifsTime = 0; - - pmgntframe = alloc_mgtxmitframe(pxmitpriv); - if (pmgntframe == NULL) - return _FALSE; - - /*update attribute*/ - pattrib = &pmgntframe->attrib; - update_mgntframe_attrib(Adapter, pattrib); - - if (qidx == BCN_QUEUE_INX) - pattrib->qsel = QSLT_BEACON; - pattrib->rate = MGN_VHT2SS_MCS0; - 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, adapter_mac_addr(Adapter), ETH_ALEN); - - 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); - - sequence = pBeamInfo->sounding_sequence << 2; - if (pBeamInfo->sounding_sequence >= 0x3f) - pBeamInfo->sounding_sequence = 0; - else - pBeamInfo->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 beamforming_send_vht_ndpa_packet(PADAPTER Adapter, u8 *ra, u16 aid, CHANNEL_WIDTH bw, u8 qidx) -{ - return issue_vht_ndpa_packet(Adapter, ra, aid, bw, qidx); -} - -BOOLEAN beamfomring_bSounding(struct beamforming_info *pBeamInfo) -{ - BOOLEAN bSounding = _FALSE; - - if ((beamforming_get_beamform_cap(pBeamInfo) & BEAMFORMER_CAP) == 0) - bSounding = _FALSE; - else - bSounding = _TRUE; - - return bSounding; -} - -u8 beamforming_sounding_idx(struct beamforming_info *pBeamInfo) -{ - u8 idx = 0; - u8 i; - - for (i = 0; i < BEAMFORMING_ENTRY_NUM; i++) { - if (pBeamInfo->beamforming_entry[i].bUsed && - (_FALSE == pBeamInfo->beamforming_entry[i].bSound)) { - idx = i; - break; - } - } - - return idx; -} - -SOUNDING_MODE beamforming_sounding_mode(struct beamforming_info *pBeamInfo, u8 idx) -{ - struct beamforming_entry BeamEntry = pBeamInfo->beamforming_entry[idx]; - SOUNDING_MODE mode; - - if (BeamEntry.beamforming_entry_cap & BEAMFORMER_CAP_VHT_SU) - mode = SOUNDING_FW_VHT_TIMER; - else if (BeamEntry.beamforming_entry_cap & BEAMFORMER_CAP_HT_EXPLICIT) - mode = SOUNDING_FW_HT_TIMER; - else - mode = SOUNDING_STOP_All_TIMER; - - return mode; -} - -u16 beamforming_sounding_time(struct beamforming_info *pBeamInfo, SOUNDING_MODE mode, u8 idx) -{ - u16 sounding_time = 0xffff; - struct beamforming_entry BeamEntry = pBeamInfo->beamforming_entry[idx]; - - sounding_time = BeamEntry.sound_period; - - return sounding_time; -} - -CHANNEL_WIDTH beamforming_sounding_bw(struct beamforming_info *pBeamInfo, SOUNDING_MODE mode, u8 idx) -{ - CHANNEL_WIDTH sounding_bw = CHANNEL_WIDTH_20; - struct beamforming_entry BeamEntry = pBeamInfo->beamforming_entry[idx]; - - sounding_bw = BeamEntry.sound_bw; - - return sounding_bw; -} - -BOOLEAN beamforming_select_beam_entry(struct beamforming_info *pBeamInfo) -{ - struct sounding_info *pSoundInfo = &(pBeamInfo->sounding_info); - - pSoundInfo->sound_idx = beamforming_sounding_idx(pBeamInfo); - - if (pSoundInfo->sound_idx < BEAMFORMING_ENTRY_NUM) - pSoundInfo->sound_mode = beamforming_sounding_mode(pBeamInfo, pSoundInfo->sound_idx); - else - pSoundInfo->sound_mode = SOUNDING_STOP_All_TIMER; - - if (SOUNDING_STOP_All_TIMER == pSoundInfo->sound_mode) - return _FALSE; - else { - pSoundInfo->sound_bw = beamforming_sounding_bw(pBeamInfo, pSoundInfo->sound_mode, pSoundInfo->sound_idx); - pSoundInfo->sound_period = beamforming_sounding_time(pBeamInfo, pSoundInfo->sound_mode, pSoundInfo->sound_idx); - return _TRUE; - } -} - -BOOLEAN beamforming_start_fw(PADAPTER adapter, u8 idx) -{ - u8 *RA = NULL; - struct beamforming_entry *pEntry; - BOOLEAN ret = _TRUE; - struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); - struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); - - pEntry = &(pBeamInfo->beamforming_entry[idx]); - if (pEntry->bUsed == _FALSE) { - RTW_INFO("Skip Beamforming, no entry for Idx =%d\n", idx); - return _FALSE; - } - - pEntry->beamforming_entry_state = BEAMFORMING_ENTRY_STATE_PROGRESSING; - pEntry->bSound = _TRUE; - rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_FW_NDPA, (u8 *)&idx); - - return _TRUE; -} - -void beamforming_end_fw(PADAPTER adapter) -{ - u8 idx = 0; - - rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_FW_NDPA, (u8 *)&idx); - - RTW_INFO("%s\n", __FUNCTION__); -} - -BOOLEAN beamforming_start_period(PADAPTER adapter) -{ - BOOLEAN ret = _TRUE; - struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); - struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); - struct sounding_info *pSoundInfo = &(pBeamInfo->sounding_info); - - beamforming_dym_ndpa_rate(adapter); - - beamforming_select_beam_entry(pBeamInfo); - - if (pSoundInfo->sound_mode == SOUNDING_FW_VHT_TIMER || pSoundInfo->sound_mode == SOUNDING_FW_HT_TIMER) - ret = beamforming_start_fw(adapter, pSoundInfo->sound_idx); - else - ret = _FALSE; - - RTW_INFO("%s Idx %d Mode %d BW %d Period %d\n", __FUNCTION__, - pSoundInfo->sound_idx, pSoundInfo->sound_mode, pSoundInfo->sound_bw, pSoundInfo->sound_period); - - return ret; -} - -void beamforming_end_period(PADAPTER adapter) -{ - u8 idx = 0; - struct beamforming_entry *pBeamformEntry; - struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); - struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); - struct sounding_info *pSoundInfo = &(pBeamInfo->sounding_info); - - - if (pSoundInfo->sound_mode == SOUNDING_FW_VHT_TIMER || pSoundInfo->sound_mode == SOUNDING_FW_HT_TIMER) - beamforming_end_fw(adapter); -} - -void beamforming_notify(PADAPTER adapter) -{ - BOOLEAN bSounding = _FALSE; - struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(&(adapter->mlmepriv)); - - bSounding = beamfomring_bSounding(pBeamInfo); - - if (pBeamInfo->beamforming_state == BEAMFORMING_STATE_IDLE) { - if (bSounding) { - if (beamforming_start_period(adapter) == _TRUE) - pBeamInfo->beamforming_state = BEAMFORMING_STATE_START; - } - } else if (pBeamInfo->beamforming_state == BEAMFORMING_STATE_START) { - if (bSounding) { - if (beamforming_start_period(adapter) == _FALSE) - pBeamInfo->beamforming_state = BEAMFORMING_STATE_END; - } else { - beamforming_end_period(adapter); - pBeamInfo->beamforming_state = BEAMFORMING_STATE_END; - } - } else if (pBeamInfo->beamforming_state == BEAMFORMING_STATE_END) { - if (bSounding) { - if (beamforming_start_period(adapter) == _TRUE) - pBeamInfo->beamforming_state = BEAMFORMING_STATE_START; - } - } else - RTW_INFO("%s BeamformState %d\n", __FUNCTION__, pBeamInfo->beamforming_state); - - RTW_INFO("%s BeamformState %d bSounding %d\n", __FUNCTION__, pBeamInfo->beamforming_state, bSounding); -} - -BOOLEAN beamforming_init_entry(PADAPTER adapter, struct sta_info *psta, u8 *idx) -{ - struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); - struct ht_priv *phtpriv = &(pmlmepriv->htpriv); -#ifdef CONFIG_80211AC_VHT - struct vht_priv *pvhtpriv = &(pmlmepriv->vhtpriv); -#endif - struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); - struct beamforming_entry *pBeamformEntry = NULL; - u8 *ra; - u16 aid, mac_id; - u8 wireless_mode; - CHANNEL_WIDTH bw = CHANNEL_WIDTH_20; - BEAMFORMING_CAP beamform_cap = BEAMFORMING_CAP_NONE; - - /* The current setting does not support Beaforming */ - if (0 == phtpriv->beamform_cap -#ifdef CONFIG_80211AC_VHT - && 0 == pvhtpriv->beamform_cap -#endif - ) { - RTW_INFO("The configuration disabled Beamforming! Skip...\n"); - return _FALSE; - } - - aid = psta->aid; - ra = psta->hwaddr; - mac_id = psta->mac_id; - wireless_mode = psta->wireless_mode; - bw = psta->bw_mode; - - if (is_supported_ht(wireless_mode) || is_supported_vht(wireless_mode)) { - /* 3 */ /* HT */ - u8 cur_beamform; - - cur_beamform = psta->htpriv.beamform_cap; - - /* We are Beamformee because the STA is Beamformer */ - if (TEST_FLAG(cur_beamform, BEAMFORMING_HT_BEAMFORMER_ENABLE)) - beamform_cap = (BEAMFORMING_CAP)(beamform_cap | BEAMFORMEE_CAP_HT_EXPLICIT); - - /* We are Beamformer because the STA is Beamformee */ - if (TEST_FLAG(cur_beamform, BEAMFORMING_HT_BEAMFORMEE_ENABLE)) - beamform_cap = (BEAMFORMING_CAP)(beamform_cap | BEAMFORMER_CAP_HT_EXPLICIT); -#ifdef CONFIG_80211AC_VHT - if (is_supported_vht(wireless_mode)) { - /* 3 */ /* VHT */ - cur_beamform = psta->vhtpriv.beamform_cap; - - /* We are Beamformee because the STA is Beamformer */ - if (TEST_FLAG(cur_beamform, BEAMFORMING_VHT_BEAMFORMER_ENABLE)) - beamform_cap = (BEAMFORMING_CAP)(beamform_cap | BEAMFORMEE_CAP_VHT_SU); - /* We are Beamformer because the STA is Beamformee */ - if (TEST_FLAG(cur_beamform, BEAMFORMING_VHT_BEAMFORMEE_ENABLE)) - beamform_cap = (BEAMFORMING_CAP)(beamform_cap | BEAMFORMER_CAP_VHT_SU); - } -#endif /* CONFIG_80211AC_VHT */ - - if (beamform_cap == BEAMFORMING_CAP_NONE) - return _FALSE; - - RTW_INFO("Beamforming Config Capability = 0x%02X\n", beamform_cap); - - pBeamformEntry = beamforming_get_entry_by_addr(pmlmepriv, ra, idx); - if (pBeamformEntry == NULL) { - pBeamformEntry = beamforming_add_entry(adapter, ra, aid, mac_id, bw, beamform_cap, idx); - if (pBeamformEntry == NULL) - return _FALSE; - else - pBeamformEntry->beamforming_entry_state = BEAMFORMING_ENTRY_STATE_INITIALIZEING; - } else { - /* Entry has been created. If entry is initialing or progressing then errors occur. */ - if (pBeamformEntry->beamforming_entry_state != BEAMFORMING_ENTRY_STATE_INITIALIZED && - pBeamformEntry->beamforming_entry_state != BEAMFORMING_ENTRY_STATE_PROGRESSED) { - RTW_INFO("Error State of Beamforming"); - return _FALSE; - } else - pBeamformEntry->beamforming_entry_state = BEAMFORMING_ENTRY_STATE_INITIALIZEING; - } - - pBeamformEntry->beamforming_entry_state = BEAMFORMING_ENTRY_STATE_INITIALIZED; - psta->txbf_paid = pBeamformEntry->p_aid; - psta->txbf_gid = pBeamformEntry->g_id; - - RTW_INFO("%s Idx %d\n", __FUNCTION__, *idx); - } else - return _FALSE; - - return _SUCCESS; -} - -void beamforming_deinit_entry(PADAPTER adapter, u8 *ra) -{ - u8 idx = 0; - struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); - - if (beamforming_remove_entry(pmlmepriv, ra, &idx) == _TRUE) - rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_LEAVE, (u8 *)&idx); - - RTW_INFO("%s Idx %d\n", __FUNCTION__, idx); -} - -void beamforming_reset(PADAPTER adapter) -{ - u8 idx = 0; - struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); - struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); - - for (idx = 0; idx < BEAMFORMING_ENTRY_NUM; idx++) { - if (pBeamInfo->beamforming_entry[idx].bUsed == _TRUE) { - pBeamInfo->beamforming_entry[idx].bUsed = _FALSE; - pBeamInfo->beamforming_entry[idx].beamforming_entry_cap = BEAMFORMING_CAP_NONE; - pBeamInfo->beamforming_entry[idx].beamforming_entry_state = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; - rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_LEAVE, (u8 *)&idx); - } - } - - RTW_INFO("%s\n", __FUNCTION__); -} - -void beamforming_sounding_fail(PADAPTER Adapter) -{ - struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); - struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); - struct beamforming_entry *pEntry = &(pBeamInfo->beamforming_entry[pBeamInfo->beamforming_cur_idx]); - - pEntry->bSound = _FALSE; - rtw_hal_set_hwreg(Adapter, HW_VAR_SOUNDING_FW_NDPA, (u8 *)&pBeamInfo->beamforming_cur_idx); - beamforming_deinit_entry(Adapter, pEntry->mac_addr); -} - -void beamforming_check_sounding_success(PADAPTER Adapter, BOOLEAN status) -{ - struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); - struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO(pmlmepriv); - struct beamforming_entry *pEntry = &(pBeamInfo->beamforming_entry[pBeamInfo->beamforming_cur_idx]); - - if (status == 1) - pEntry->LogStatusFailCnt = 0; - else { - pEntry->LogStatusFailCnt++; - RTW_INFO("%s LogStatusFailCnt %d\n", __FUNCTION__, pEntry->LogStatusFailCnt); - } - if (pEntry->LogStatusFailCnt > 20) { - RTW_INFO("%s LogStatusFailCnt > 20, Stop SOUNDING\n", __FUNCTION__); - /* pEntry->bSound = _FALSE; */ - /* rtw_hal_set_hwreg(Adapter, HW_VAR_SOUNDING_FW_NDPA, (u8 *)&pBeamInfo->beamforming_cur_idx); */ - /* beamforming_deinit_entry(Adapter, pEntry->mac_addr); */ - beamforming_wk_cmd(Adapter, BEAMFORMING_CTRL_SOUNDING_FAIL, NULL, 0, 1); - } -} - -void beamforming_enter(PADAPTER adapter, PVOID psta) -{ - u8 idx = 0xff; - - if (beamforming_init_entry(adapter, (struct sta_info *)psta, &idx)) - rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_ENTER, (u8 *)&idx); - - /* RTW_INFO("%s Idx %d\n", __FUNCTION__, idx); */ -} - -void beamforming_leave(PADAPTER adapter, u8 *ra) -{ - if (ra == NULL) - beamforming_reset(adapter); - else - beamforming_deinit_entry(adapter, ra); - - beamforming_notify(adapter); -} - -BEAMFORMING_CAP beamforming_get_beamform_cap(struct beamforming_info *pBeamInfo) -{ - u8 i; - BOOLEAN bSelfBeamformer = _FALSE; - BOOLEAN bSelfBeamformee = _FALSE; - struct beamforming_entry beamforming_entry; - BEAMFORMING_CAP beamform_cap = BEAMFORMING_CAP_NONE; - - for (i = 0; i < BEAMFORMING_ENTRY_NUM; i++) { - beamforming_entry = pBeamInfo->beamforming_entry[i]; - - if (beamforming_entry.bUsed) { - if ((beamforming_entry.beamforming_entry_cap & BEAMFORMEE_CAP_VHT_SU) || - (beamforming_entry.beamforming_entry_cap & BEAMFORMEE_CAP_HT_EXPLICIT)) - bSelfBeamformee = _TRUE; - if ((beamforming_entry.beamforming_entry_cap & BEAMFORMER_CAP_VHT_SU) || - (beamforming_entry.beamforming_entry_cap & BEAMFORMER_CAP_HT_EXPLICIT)) - bSelfBeamformer = _TRUE; - } - - if (bSelfBeamformer && bSelfBeamformee) - i = BEAMFORMING_ENTRY_NUM; - } - - if (bSelfBeamformer) - beamform_cap |= BEAMFORMER_CAP; - if (bSelfBeamformee) - beamform_cap |= BEAMFORMEE_CAP; - - return beamform_cap; -} - -void beamforming_watchdog(PADAPTER Adapter) -{ - struct beamforming_info *pBeamInfo = GET_BEAMFORM_INFO((&(Adapter->mlmepriv))); - - if (pBeamInfo->beamforming_state != BEAMFORMING_STATE_START) - return; - - beamforming_dym_period(Adapter); - beamforming_dym_ndpa_rate(Adapter); -} -#endif/* #if (BEAMFORMING_SUPPORT ==0) - for diver defined beamforming*/ - +/*PHYDM_BF - (BEAMFORMING_SUPPORT == 1)*/ 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); - struct PHY_DM_STRUCT *pDM_Odm = &(pHalData->odmpriv); + struct dm_struct *pDM_Odm = &(pHalData->odmpriv); ret = beamforming_get_report_frame(pDM_Odm, precv_frame); - -#else /*(BEAMFORMING_SUPPORT == 0)- for drv beamfoming*/ - struct beamforming_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 idx, offset; - - /*RTW_INFO("rtw_beamforming_get_report_frame\n");*/ - - /*Memory comparison to see if CSI report is the same with previous one*/ - 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)*/ - else if (pBeamformEntry->beamforming_entry_cap & BEAMFORMER_CAP_HT_EXPLICIT) - offset = 34; /*24+(1+1+6)+2 MAC header+(Category+ActionCode+MIMOControlField)+SNR(Nc=2)*/ - else - return ret; - - /*RTW_INFO("%s MacId %d offset=%d\n", __FUNCTION__, pBeamformEntry->mac_id, offset);*/ - - if (_rtw_memcmp(pBeamformEntry->PreCsiReport + offset, pframe + offset, frame_len - offset) == _FALSE) - pBeamformEntry->DefaultCsiCnt = 0; - else - pBeamformEntry->DefaultCsiCnt++; - - _rtw_memcpy(&pBeamformEntry->PreCsiReport, pframe, frame_len); - - pBeamformEntry->bDefaultCSI = _FALSE; - - if (pBeamformEntry->DefaultCsiCnt > 20) - pBeamformEntry->bDefaultCSI = _TRUE; - else - pBeamformEntry->bDefaultCSI = _FALSE; -#endif return ret; } 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); - struct PHY_DM_STRUCT *pDM_Odm = &(pHalData->odmpriv); + struct dm_struct *pDM_Odm = &(pHalData->odmpriv); beamforming_get_ndpa_frame(pDM_Odm, precv_frame); - -#else /*(BEAMFORMING_SUPPORT == 0)- for drv beamfoming*/ - 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("rtw_beamforming_get_ndpa_frame\n");*/ - - if (IS_HARDWARE_TYPE_8812(Adapter) == _FALSE) - return; - else if (get_frame_sub_type(pframe) != WIFI_NDPA) - return; - - ta = get_addr2_ptr(pframe); - /*Remove signaling TA. */ - ta[0] = ta[0] & 0xFE; - - pBeamformEntry = beamforming_get_entry_by_addr(pmlmepriv, ta, &idx); - - if (pBeamformEntry == NULL) - return; - else if (!(pBeamformEntry->beamforming_entry_cap & 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 ((pBeamformEntry->LogSuccess == 1) || (pBeamformEntry->ClockResetTimes == 5)) { - RTW_INFO("[%s] LogSeq=%d, PreLogSeq=%d\n", __func__, pBeamformEntry->LogSeq, pBeamformEntry->PreLogSeq); - return; - } - - Sequence = (pframe[16]) >> 2; - RTW_INFO("[%s] Start, Sequence=%d, LogSeq=%d, PreLogSeq=%d, LogRetryCnt=%d, ClockResetTimes=%d, LogSuccess=%d\n", - __func__, Sequence, pBeamformEntry->LogSeq, pBeamformEntry->PreLogSeq, pBeamformEntry->LogRetryCnt, pBeamformEntry->ClockResetTimes, pBeamformEntry->LogSuccess); - - if ((pBeamformEntry->LogSeq != 0) && (pBeamformEntry->PreLogSeq != 0)) { - /*Success condition*/ - if ((pBeamformEntry->LogSeq != Sequence) && (pBeamformEntry->PreLogSeq != pBeamformEntry->LogSeq)) { - /* break option for clcok reset, 2015-03-30, Jeffery */ - pBeamformEntry->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*/ - pBeamformEntry->LogSuccess = 1; - - } else {/*Fail condition*/ - - if (pBeamformEntry->LogRetryCnt == 5) { - pBeamformEntry->ClockResetTimes++; - pBeamformEntry->LogRetryCnt = 0; - - RTW_INFO("[%s] Clock Reset!!! ClockResetTimes=%d\n", __func__, pBeamformEntry->ClockResetTimes); - beamforming_wk_cmd(Adapter, BEAMFORMING_CTRL_SOUNDING_CLK, NULL, 0, 1); - - } else - pBeamformEntry->LogRetryCnt++; - } - } - - /*Update LogSeq & PreLogSeq*/ - pBeamformEntry->PreLogSeq = pBeamformEntry->LogSeq; - pBeamformEntry->LogSeq = Sequence; - -#endif - } - - - void beamforming_wk_hdl(_adapter *padapter, u8 type, u8 *pbuf) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); - struct PHY_DM_STRUCT *pDM_Odm = &(pHalData->odmpriv); + struct dm_struct *pDM_Odm = &(pHalData->odmpriv); -#if (BEAMFORMING_SUPPORT == 1) /*(BEAMFORMING_SUPPORT == 1)- for PHYDM beamfoming*/ + /*(BEAMFORMING_SUPPORT == 1)- for PHYDM beamfoming*/ switch (type) { case BEAMFORMING_CTRL_ENTER: { - struct sta_info *psta = (PVOID)pbuf; - u16 staIdx = psta->mac_id; + struct sta_info *psta = (void *)pbuf; + u16 staIdx = psta->cmn.mac_id; - beamforming_enter(pDM_Odm, staIdx); + beamforming_enter(pDM_Odm, staIdx, adapter_mac_addr(psta->padapter)); break; } case BEAMFORMING_CTRL_LEAVE: @@ -3065,28 +2046,6 @@ void beamforming_wk_hdl(_adapter *padapter, u8 type, u8 *pbuf) break; } -#else /*(BEAMFORMING_SUPPORT == 0)- for drv beamfoming*/ - switch (type) { - case BEAMFORMING_CTRL_ENTER: - beamforming_enter(padapter, (PVOID)pbuf); - break; - - case BEAMFORMING_CTRL_LEAVE: - beamforming_leave(padapter, pbuf); - break; - - case BEAMFORMING_CTRL_SOUNDING_FAIL: - beamforming_sounding_fail(padapter); - break; - - case BEAMFORMING_CTRL_SOUNDING_CLK: - rtw_hal_set_hwreg(padapter, HW_VAR_SOUNDING_CLK, NULL); - break; - - default: - break; - } -#endif } u8 beamforming_wk_cmd(_adapter *padapter, s32 type, u8 *pbuf, s32 size, u8 enqueue) @@ -3094,8 +2053,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; @@ -3148,8 +2113,8 @@ 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 */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_br_ext.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_br_ext.c index b330edf9e81a..5e64a8f3edac 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_br_ext.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_br_ext.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -306,7 +302,7 @@ static int update_nd_link_layer_addr(unsigned char *data, int len, unsigned char return 0; } - +#ifdef SUPPORT_RX_UNI2MCAST static void convert_ipv6_mac_to_mc(struct sk_buff *skb) { struct ipv6hdr *iph = (struct ipv6hdr *)(skb->data + ETH_HLEN); @@ -324,6 +320,7 @@ static void convert_ipv6_mac_to_mc(struct sk_buff *skb) #endif } #endif /* CL_IPV6_PASS */ +#endif /* SUPPORT_RX_UNI2MCAST */ static __inline__ int __nat25_network_hash(unsigned char *networkAddr) diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_bt_mp.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_bt_mp.c index a0597d869f04..aa889bd45575 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_bt_mp.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_bt_mp.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 @@ -102,13 +98,13 @@ BT_CTRL_STATUS mptbt_SendH2c( PADAPTER Adapter, PBT_H2C pH2c, - u2Byte h2cCmdLen + u16 h2cCmdLen ) { /* KIRQL OldIrql = KeGetCurrentIrql(); */ BT_CTRL_STATUS h2cStatus = BT_STATUS_H2C_SUCCESS; PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.mpt_ctx); - u1Byte i; + u8 i; RTW_INFO("[MPT], mptbt_SendH2c()=========>\n"); @@ -197,17 +193,17 @@ mptbt_CheckBtRspStatus( BT_CTRL_STATUS mptbt_BtFwOpCodeProcess( PADAPTER Adapter, - u1Byte btFwOpCode, - u1Byte opCodeVer, - pu1Byte pH2cPar, - u1Byte h2cParaLen + u8 btFwOpCode, + u8 opCodeVer, + u8 *pH2cPar, + u8 h2cParaLen ) { - u1Byte H2C_Parameter[6] = {0}; + u8 H2C_Parameter[6] = {0}; PBT_H2C pH2c = (PBT_H2C)&H2C_Parameter[0]; PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.mpt_ctx); PBT_EXT_C2H pExtC2h = (PBT_EXT_C2H)&pMptCtx->c2hBuf[0]; - u2Byte paraLen = 0, i; + u16 paraLen = 0, i; BT_CTRL_STATUS h2cStatus = BT_STATUS_H2C_SUCCESS, c2hStatus = BT_STATUS_C2H_SUCCESS; BT_CTRL_STATUS retStatus = BT_STATUS_H2C_BT_NO_RSP; @@ -253,25 +249,25 @@ mptbt_BtFwOpCodeProcess( -u2Byte +u16 mptbt_BtReady( PADAPTER Adapter, PBT_REQ_CMD pBtReq, PBT_RSP_CMD pBtRsp ) { - u1Byte h2cParaBuf[6] = {0}; - u1Byte h2cParaLen = 0; - u2Byte paraLen = 0; - u1Byte retStatus = BT_STATUS_BT_OP_SUCCESS; - u1Byte btOpcode; - u1Byte btOpcodeVer = 0; + u8 h2cParaBuf[6] = {0}; + u8 h2cParaLen = 0; + u16 paraLen = 0; + u8 retStatus = BT_STATUS_BT_OP_SUCCESS; + u8 btOpcode; + u8 btOpcodeVer = 0; 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}; - u2Byte btRealFwVer = 0; - pu2Byte pu2Tmp = NULL; + u8 i; + u8 btFwVer = 0, bdAddr[6] = {0}; + u16 btRealFwVer = 0; + u16 *pu2Tmp = NULL; /* */ /* check upper layer parameters */ @@ -301,7 +297,7 @@ mptbt_BtReady( RTW_INFO("[MPT], Error!! status code=0x%x\n", pBtRsp->status); return paraLen; } else { - pu2Tmp = (pu2Byte)&pExtC2h->buf[0]; + pu2Tmp = (u16 *)&pExtC2h->buf[0]; btRealFwVer = *pu2Tmp; btFwVer = pExtC2h->buf[1]; RTW_INFO("[MPT], btRealFwVer=0x%x, btFwVer=0x%x\n", btRealFwVer, btFwVer); @@ -342,7 +338,7 @@ mptbt_BtReady( RTW_INFO(" 0x%x ", bdAddr[i]); pBtRsp->status = BT_STATUS_SUCCESS; pBtRsp->pParamStart[0] = MP_BT_READY; - pu2Tmp = (pu2Byte)&pBtRsp->pParamStart[1]; + pu2Tmp = (u16 *)&pBtRsp->pParamStart[1]; *pu2Tmp = btRealFwVer; pBtRsp->pParamStart[3] = btFwVer; for (i = 0; i < 6; i++) @@ -365,9 +361,9 @@ void mptbt_open_WiFiRF(PADAPTER Adapter) phy_set_rf_reg(Adapter, RF_PATH_A, 0x0, 0xF0000, 0x3); } -u4Byte mptbt_switch_RF(PADAPTER Adapter, u1Byte Enter) +u32 mptbt_switch_RF(PADAPTER Adapter, u8 Enter) { - u2Byte tmp_2byte = 0; + u16 tmp_2byte = 0; /* Enter test mode */ if (Enter) { @@ -395,20 +391,20 @@ u4Byte mptbt_switch_RF(PADAPTER Adapter, u1Byte Enter) return 0; } -u2Byte +u16 mptbt_BtSetMode( PADAPTER Adapter, PBT_REQ_CMD pBtReq, PBT_RSP_CMD pBtRsp ) { - u1Byte h2cParaBuf[6] = {0}; - u1Byte h2cParaLen = 0; - u2Byte paraLen = 0; - u1Byte retStatus = BT_STATUS_BT_OP_SUCCESS; - u1Byte btOpcode; - u1Byte btOpcodeVer = 0; - u1Byte btModeToSet = 0; + u8 h2cParaBuf[6] = {0}; + u8 h2cParaLen = 0; + u16 paraLen = 0; + u8 retStatus = BT_STATUS_BT_OP_SUCCESS; + u8 btOpcode; + u8 btOpcodeVer = 0; + u8 btModeToSet = 0; /* */ /* check upper layer parameters */ @@ -460,18 +456,18 @@ mptbt_BtSetMode( } -VOID +void MPTBT_FwC2hBtMpCtrl( PADAPTER Adapter, - pu1Byte tmpBuf, - u1Byte length + u8 *tmpBuf, + u8 length ) { u32 i; 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; } @@ -530,28 +526,28 @@ MPTBT_FwC2hBtMpCtrl( } -u2Byte +u16 mptbt_BtGetGeneral( - IN PADAPTER Adapter, - IN PBT_REQ_CMD pBtReq, - IN PBT_RSP_CMD pBtRsp + PADAPTER Adapter, + PBT_REQ_CMD pBtReq, + PBT_RSP_CMD pBtRsp ) { PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.mpt_ctx); PBT_EXT_C2H pExtC2h = (PBT_EXT_C2H)&pMptCtx->c2hBuf[0]; - u1Byte h2cParaBuf[6] = {0}; - u1Byte h2cParaLen = 0; - u2Byte paraLen = 0; - u1Byte retStatus = BT_STATUS_BT_OP_SUCCESS; - u1Byte btOpcode, bdAddr[6] = {0}; - u1Byte btOpcodeVer = 0; - u1Byte getType = 0, i; - u2Byte getParaLen = 0, validParaLen = 0; - u1Byte regType = 0, reportType = 0; - u4Byte regAddr = 0, regValue = 0; - pu4Byte pu4Tmp; - pu2Byte pu2Tmp; - pu1Byte pu1Tmp; + u8 h2cParaBuf[6] = {0}; + u8 h2cParaLen = 0; + u16 paraLen = 0; + u8 retStatus = BT_STATUS_BT_OP_SUCCESS; + u8 btOpcode, bdAddr[6] = {0}; + u8 btOpcodeVer = 0; + u8 getType = 0, i; + u16 getParaLen = 0, validParaLen = 0; + u8 regType = 0, reportType = 0; + u32 regAddr = 0, regValue = 0; + u32 *pu4Tmp; + u16 *pu2Tmp; + u8 *pu1Tmp; /* */ /* check upper layer parameters */ @@ -582,7 +578,7 @@ mptbt_BtGetGeneral( if (getParaLen == validParaLen) { btOpcode = BT_LO_OP_READ_REG; regType = pBtReq->pParamStart[1]; - pu4Tmp = (pu4Byte)&pBtReq->pParamStart[2]; + pu4Tmp = (u32 *)&pBtReq->pParamStart[2]; regAddr = *pu4Tmp; RTW_INFO("[MPT], BT_GGET_REG regType=0x%02x, regAddr=0x%08x!!\n", regType, regAddr); @@ -651,12 +647,12 @@ mptbt_BtGetGeneral( return paraLen; } - pu2Tmp = (pu2Byte)&pExtC2h->buf[0]; + pu2Tmp = (u16 *)&pExtC2h->buf[0]; regValue = *pu2Tmp; RTW_INFO("[MPT], read reg regType=0x%02x, regAddr=0x%08x, regValue=0x%04x\n", regType, regAddr, regValue); - pu4Tmp = (pu4Byte)&pBtRsp->pParamStart[0]; + pu4Tmp = (u32 *)&pBtRsp->pParamStart[0]; *pu4Tmp = regValue; paraLen = 4; } else if (BT_GGET_STATUS == getType) { @@ -834,26 +830,26 @@ mptbt_BtGetGeneral( -u2Byte +u16 mptbt_BtSetGeneral( - IN PADAPTER Adapter, - IN PBT_REQ_CMD pBtReq, - IN PBT_RSP_CMD pBtRsp + PADAPTER Adapter, + PBT_REQ_CMD pBtReq, + PBT_RSP_CMD pBtRsp ) { - u1Byte h2cParaBuf[6] = {0}; - u1Byte h2cParaLen = 0; - u2Byte paraLen = 0; - u1Byte retStatus = BT_STATUS_BT_OP_SUCCESS; - u1Byte btOpcode; - u1Byte btOpcodeVer = 0; - u1Byte setType = 0; - u2Byte setParaLen = 0, validParaLen = 0; - u1Byte regType = 0, bdAddr[6] = {0}, calVal = 0; - u4Byte regAddr = 0, regValue = 0; - pu4Byte pu4Tmp; - pu2Byte pu2Tmp; - pu1Byte pu1Tmp; + u8 h2cParaBuf[6] = {0}; + u8 h2cParaLen = 0; + u16 paraLen = 0; + u8 retStatus = BT_STATUS_BT_OP_SUCCESS; + u8 btOpcode; + u8 btOpcodeVer = 0; + u8 setType = 0; + u16 setParaLen = 0, validParaLen = 0; + u8 regType = 0, bdAddr[6] = {0}, calVal = 0; + u32 regAddr = 0, regValue = 0; + u32 *pu4Tmp; + u16 *pu2Tmp; + u8 *pu1Tmp; /* */ /* check upper layer parameters */ @@ -884,9 +880,9 @@ mptbt_BtSetGeneral( if (setParaLen == validParaLen) { btOpcode = BT_LO_OP_WRITE_REG_VALUE; regType = pBtReq->pParamStart[1]; - pu4Tmp = (pu4Byte)&pBtReq->pParamStart[2]; + pu4Tmp = (u32 *)&pBtReq->pParamStart[2]; regAddr = *pu4Tmp; - pu4Tmp = (pu4Byte)&pBtReq->pParamStart[6]; + pu4Tmp = (u32 *)&pBtReq->pParamStart[6]; regValue = *pu4Tmp; RTW_INFO("[MPT], BT_GSET_REG regType=0x%x, regAddr=0x%x, regValue=0x%x!!\n", regType, regAddr, regValue); @@ -1121,23 +1117,23 @@ mptbt_BtSetGeneral( -u2Byte +u16 mptbt_BtSetTxRxPars( - IN PADAPTER Adapter, - IN PBT_REQ_CMD pBtReq, - IN PBT_RSP_CMD pBtRsp + PADAPTER Adapter, + PBT_REQ_CMD pBtReq, + PBT_RSP_CMD pBtRsp ) { - u1Byte h2cParaBuf[6] = {0}; - u1Byte h2cParaLen = 0; - u2Byte paraLen = 0; - u1Byte retStatus = BT_STATUS_BT_OP_SUCCESS; - u1Byte btOpcode; - u1Byte btOpcodeVer = 0; + u8 h2cParaBuf[6] = {0}; + u8 h2cParaLen = 0; + u16 paraLen = 0; + u8 retStatus = BT_STATUS_BT_OP_SUCCESS; + u8 btOpcode; + u8 btOpcodeVer = 0; PBT_TXRX_PARAMETERS pTxRxPars = (PBT_TXRX_PARAMETERS)&pBtReq->pParamStart[0]; - u2Byte lenTxRx = sizeof(BT_TXRX_PARAMETERS); - u1Byte i; - u1Byte bdAddr[6] = {0}; + u16 lenTxRx = sizeof(BT_TXRX_PARAMETERS); + u8 i; + u8 bdAddr[6] = {0}; /* */ /* check upper layer parameters */ @@ -1184,9 +1180,9 @@ mptbt_BtSetTxRxPars( pBtRsp->status = (btOpcode << 8) | BT_STATUS_PARAMETER_OUT_OF_RANGE_U; return paraLen; } else { - h2cParaBuf[0] = (u1Byte)(pTxRxPars->txrxPktHeader & 0xff); - h2cParaBuf[1] = (u1Byte)((pTxRxPars->txrxPktHeader & 0xff00) >> 8); - h2cParaBuf[2] = (u1Byte)((pTxRxPars->txrxPktHeader & 0xff0000) >> 16); + h2cParaBuf[0] = (u8)(pTxRxPars->txrxPktHeader & 0xff); + h2cParaBuf[1] = (u8)((pTxRxPars->txrxPktHeader & 0xff00) >> 8); + h2cParaBuf[2] = (u8)((pTxRxPars->txrxPktHeader & 0xff0000) >> 16); h2cParaLen = 3; retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); } @@ -1201,7 +1197,7 @@ mptbt_BtSetTxRxPars( /* fill h2c parameters */ btOpcode = BT_LO_OP_SET_PKT_TYPE_LEN; { - u2Byte payloadLenLimit = 0; + u16 payloadLenLimit = 0; switch (pTxRxPars->txrxPktType) { case MP_BT_PKT_DH1: payloadLenLimit = 27 * 8; @@ -1249,8 +1245,8 @@ mptbt_BtSetTxRxPars( } h2cParaBuf[0] = pTxRxPars->txrxPktType; - h2cParaBuf[1] = (u1Byte)((pTxRxPars->txrxPayloadLen & 0xff)); - h2cParaBuf[2] = (u1Byte)((pTxRxPars->txrxPayloadLen & 0xff00) >> 8); + h2cParaBuf[1] = (u8)((pTxRxPars->txrxPayloadLen & 0xff)); + h2cParaBuf[2] = (u8)((pTxRxPars->txrxPayloadLen & 0xff00) >> 8); h2cParaLen = 3; retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); } @@ -1269,8 +1265,8 @@ mptbt_BtSetTxRxPars( pBtRsp->status = (btOpcode << 8) | BT_STATUS_PARAMETER_OUT_OF_RANGE_U; return paraLen; } else { - h2cParaBuf[0] = (u1Byte)((pTxRxPars->txrxTxPktCnt & 0xff)); - h2cParaBuf[1] = (u1Byte)((pTxRxPars->txrxTxPktCnt & 0xff00) >> 8); + h2cParaBuf[0] = (u8)((pTxRxPars->txrxTxPktCnt & 0xff)); + h2cParaBuf[1] = (u8)((pTxRxPars->txrxTxPktCnt & 0xff00) >> 8); h2cParaBuf[2] = pTxRxPars->txrxPayloadType; h2cParaLen = 3; retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); @@ -1290,8 +1286,8 @@ mptbt_BtSetTxRxPars( pBtRsp->status = (btOpcode << 8) | BT_STATUS_PARAMETER_OUT_OF_RANGE_U; return paraLen; } else { - h2cParaBuf[0] = (u1Byte)((pTxRxPars->txrxTxPktCnt & 0xff0000) >> 16); - h2cParaBuf[1] = (u1Byte)((pTxRxPars->txrxTxPktCnt & 0xff000000) >> 24); + h2cParaBuf[0] = (u8)((pTxRxPars->txrxTxPktCnt & 0xff0000) >> 16); + h2cParaBuf[1] = (u8)((pTxRxPars->txrxTxPktCnt & 0xff000000) >> 24); h2cParaBuf[2] = pTxRxPars->txrxTxPktInterval; h2cParaLen = 3; retStatus = mptbt_BtFwOpCodeProcess(Adapter, btOpcode, btOpcodeVer, &h2cParaBuf[0], h2cParaLen); @@ -1400,20 +1396,20 @@ mptbt_BtSetTxRxPars( -u2Byte +u16 mptbt_BtTestCtrl( - IN PADAPTER Adapter, - IN PBT_REQ_CMD pBtReq, - IN PBT_RSP_CMD pBtRsp + PADAPTER Adapter, + PBT_REQ_CMD pBtReq, + PBT_RSP_CMD pBtRsp ) { - u1Byte h2cParaBuf[6] = {0}; - u1Byte h2cParaLen = 0; - u2Byte paraLen = 0; - u1Byte retStatus = BT_STATUS_BT_OP_SUCCESS; - u1Byte btOpcode; - u1Byte btOpcodeVer = 0; - u1Byte testCtrl = 0; + u8 h2cParaBuf[6] = {0}; + u8 h2cParaLen = 0; + u16 paraLen = 0; + u8 retStatus = BT_STATUS_BT_OP_SUCCESS; + u8 btOpcode; + u8 btOpcodeVer = 0; + u8 testCtrl = 0; /* */ /* check upper layer parameters */ @@ -1465,21 +1461,21 @@ mptbt_BtTestCtrl( } -u2Byte +u16 mptbt_TestBT( - IN PADAPTER Adapter, - IN PBT_REQ_CMD pBtReq, - IN PBT_RSP_CMD pBtRsp + PADAPTER Adapter, + PBT_REQ_CMD pBtReq, + PBT_RSP_CMD pBtRsp ) { - u1Byte h2cParaBuf[6] = {0}; - u1Byte h2cParaLen = 0; - u2Byte paraLen = 0; - u1Byte retStatus = BT_STATUS_BT_OP_SUCCESS; - u1Byte btOpcode; - u1Byte btOpcodeVer = 0; - u1Byte testCtrl = 0; + u8 h2cParaBuf[6] = {0}; + u8 h2cParaLen = 0; + u16 paraLen = 0; + u8 retStatus = BT_STATUS_BT_OP_SUCCESS; + u8 btOpcode; + u8 btOpcodeVer = 0; + u8 testCtrl = 0; /* 1. fill h2c parameters */ btOpcode = 0x11; @@ -1504,18 +1500,18 @@ mptbt_TestBT( return paraLen; } -VOID +void mptbt_BtControlProcess( PADAPTER Adapter, - PVOID pInBuf + void *pInBuf ) { - u1Byte H2C_Parameter[6] = {0}; + u8 H2C_Parameter[6] = {0}; PBT_H2C pH2c = (PBT_H2C)&H2C_Parameter[0]; PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.mpt_ctx); PBT_REQ_CMD pBtReq = (PBT_REQ_CMD)pInBuf; PBT_RSP_CMD pBtRsp; - u1Byte i; + u8 i; RTW_INFO("[MPT], mptbt_BtControlProcess()=========>\n"); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_btcoex.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_btcoex.c index 7f37ff1c2595..ffbb752cec50 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_btcoex.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_btcoex.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,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 +28,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 +244,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); @@ -332,6 +346,21 @@ u32 rtw_btcoex_GetRaMask(PADAPTER padapter) return hal_btcoex_GetRaMask(padapter); } +u8 rtw_btcoex_query_reduced_wl_pwr_lvl(PADAPTER padapter) +{ + return hal_btcoex_query_reduced_wl_pwr_lvl(padapter); +} + +void rtw_btcoex_set_reduced_wl_pwr_lvl(PADAPTER padapter, u8 val) +{ + hal_btcoex_set_reduced_wl_pwr_lvl(padapter, val); +} + +void rtw_btcoex_do_reduce_wl_pwr_lvl(PADAPTER padapter) +{ + hal_btcoex_do_reduce_wl_pwr_lvl(padapter); +} + void rtw_btcoex_RecordPwrMode(PADAPTER padapter, u8 *pCmdBuf, u8 cmdLen) { hal_btcoex_RecordPwrMode(padapter, pCmdBuf, cmdLen); @@ -382,6 +411,18 @@ void rtw_btcoex_pta_off_on_notify(PADAPTER padapter, u8 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 +444,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; @@ -412,9 +453,10 @@ void rtw_btcoex_LPS_Leave(PADAPTER padapter) if (pwrpriv->pwr_mode != PS_MODE_ACTIVE) { rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, "BTCOEX"); - 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) @@ -427,6 +469,16 @@ u16 rtw_btcoex_btreg_write(PADAPTER padapter, u8 type, u16 addr, u16 val) return hal_btcoex_btreg_write(padapter, type, addr, val); } +u16 rtw_btcoex_btset_testmode(PADAPTER padapter, u8 type) +{ + return hal_btcoex_btset_testode(padapter, type); +} + +u8 rtw_btcoex_get_reduce_wl_txpwr(PADAPTER padapter) +{ + return rtw_btcoex_query_reduced_wl_pwr_lvl(padapter); +} + u8 rtw_btcoex_get_bt_coexist(PADAPTER padapter) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); @@ -839,7 +891,7 @@ u8 rtw_btcoex_parse_HCI_link_status_notify_cmd(_adapter *padapter, u8 *pcmd, u16 RTW_INFO("Connection_Handle=0x%x, BTProfile=%d, BTSpec=%d\n", conHandle, btProfile, btCoreSpec); pTriple += 4; } else if (pBtMgnt->ExtConfig.HCIExtensionVer >= 1) { - conHandle = *((pu2Byte)&pTriple[0]); + conHandle = *((u16 *)&pTriple[0]); btProfile = pTriple[2]; btCoreSpec = pTriple[3]; linkRole = pTriple[4]; @@ -1600,7 +1652,7 @@ void rtw_btcoex_SendEventExtBtCoexControl(PADAPTER padapter, u8 bNeedDbgRsp, u8 u8 localBuf[32] = ""; u8 *pRetPar; u8 opCode = 0; - u8 *pInBuf = (pu1Byte)pData; + u8 *pInBuf = (u8 *)pData; u8 *pOpCodeContent; rtw_HCI_event *pEvent; @@ -1715,3 +1767,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/rtl8188eu/core/rtw_btcoex_wifionly.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_btcoex_wifionly.c index f61ad2b0307a..ed3cfc750240 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_btcoex_wifionly.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_btcoex_wifionly.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 @@ -31,6 +27,11 @@ void rtw_btcoex_wifionly_scan_notify(PADAPTER padapter) hal_btcoex_wifionly_scan_notify(padapter); } +void rtw_btcoex_wifionly_connect_notify(PADAPTER padapter) +{ + hal_btcoex_wifionly_connect_notify(padapter); +} + void rtw_btcoex_wifionly_hw_config(PADAPTER padapter) { hal_btcoex_wifionly_hw_config(padapter); @@ -40,3 +41,8 @@ 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/rtl8188eu/core/rtw_chplan.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_chplan.c new file mode 100644 index 000000000000..3a7799ba85e9 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_chplan.c @@ -0,0 +1,1205 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2018 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + *****************************************************************************/ +#define _RTW_CHPLAN_C_ + +#include + +#define RTW_DOMAIN_MAP_VER "40e" +#define RTW_COUNTRY_MAP_VER "23" + +#ifdef LEGACY_CHANNEL_PLAN_REF +/******************************************************** +ChannelPlan definitions +*********************************************************/ +static RT_CHANNEL_PLAN legacy_channel_plan[] = { + /* 0x00, RTW_CHPLAN_FCC */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165}, 32}, + /* 0x01, RTW_CHPLAN_IC */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 136, 140, 149, 153, 157, 161, 165}, 31}, + /* 0x02, RTW_CHPLAN_ETSI */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140}, 32}, + /* 0x03, RTW_CHPLAN_SPAIN */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13}, + /* 0x04, RTW_CHPLAN_FRANCE */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13}, + /* 0x05, RTW_CHPLAN_MKK */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13}, + /* 0x06, RTW_CHPLAN_MKK1 */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13}, + /* 0x07, RTW_CHPLAN_ISRAEL */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48, 52, 56, 60, 64}, 21}, + /* 0x08, RTW_CHPLAN_TELEC */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 36, 40, 44, 48, 52, 56, 60, 64}, 22}, + /* 0x09, RTW_CHPLAN_GLOBAL_DOAMIN */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14}, 14}, + /* 0x0A, RTW_CHPLAN_WORLD_WIDE_13 */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13}, + /* 0x0B, RTW_CHPLAN_TAIWAN */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 56, 60, 64, 100, 104, 108, 112, 116, 136, 140, 149, 153, 157, 161, 165}, 26}, + /* 0x0C, RTW_CHPLAN_CHINA */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 149, 153, 157, 161, 165}, 18}, + /* 0x0D, RTW_CHPLAN_SINGAPORE_INDIA_MEXICO */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 52, 56, 60, 64, 149, 153, 157, 161, 165}, 24}, + /* 0x0E, RTW_CHPLAN_KOREA */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 149, 153, 157, 161, 165}, 31}, + /* 0x0F, RTW_CHPLAN_TURKEY */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 52, 56, 60, 64}, 19}, + /* 0x10, RTW_CHPLAN_JAPAN */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140}, 32}, + /* 0x11, RTW_CHPLAN_FCC_NO_DFS */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 149, 153, 157, 161, 165}, 20}, + /* 0x12, RTW_CHPLAN_JAPAN_NO_DFS */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48}, 17}, + /* 0x13, RTW_CHPLAN_WORLD_WIDE_5G */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 149, 153, 157, 161, 165}, 37}, + /* 0x14, RTW_CHPLAN_TAIWAN_NO_DFS */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 56, 60, 64, 149, 153, 157, 161, 165}, 19}, +}; +#endif + +enum rtw_rd_2g { + RTW_RD_2G_NULL = 0, + RTW_RD_2G_WORLD = 1, /* Worldwird 13 */ + RTW_RD_2G_ETSI1 = 2, /* Europe */ + RTW_RD_2G_FCC1 = 3, /* US */ + RTW_RD_2G_MKK1 = 4, /* Japan */ + RTW_RD_2G_ETSI2 = 5, /* France */ + 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_WORLD1 = 10, /* Worldwide 11 */ + RTW_RD_2G_KCC1 = 11, /* Korea */ + RTW_RD_2G_IC2 = 12, /* Canada */ + + RTW_RD_2G_MAX, +}; + +enum rtw_rd_5g { + RTW_RD_5G_NULL = 0, /* */ + RTW_RD_5G_ETSI1 = 1, /* Europe */ + RTW_RD_5G_ETSI2 = 2, /* Australia, New Zealand */ + RTW_RD_5G_ETSI3 = 3, /* Russia */ + RTW_RD_5G_FCC1 = 4, /* US */ + RTW_RD_5G_FCC2 = 5, /* FCC w/o DFS Channels */ + RTW_RD_5G_FCC3 = 6, /* Bolivia, Chile, El Salvador, Venezuela */ + RTW_RD_5G_FCC4 = 7, /* Venezuela */ + RTW_RD_5G_FCC5 = 8, /* China */ + RTW_RD_5G_FCC6 = 9, /* */ + 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 */ + RTW_RD_5G_CHILE1 = 53, /* Chile */ + RTW_RD_5G_ACMA1 = 54, /* Australia, New Zealand (w/o Weather radar) (w/o Ch120~Ch128) */ + RTW_RD_5G_WORLD1 = 55, /* 5G Worldwide Band1&2 */ + RTW_RD_5G_CHILE2 = 56, /* Chile (Band2,Band3) */ + RTW_RD_5G_KCC2 = 57, /* Korea (New standard) */ + RTW_RD_5G_KCC3 = 58, /* Korea (2018 Dec 05 New standard, include ch144) */ + RTW_RD_5G_MKK6 = 59, /* Japan */ + RTW_RD_5G_MKK7 = 60, /* Japan */ + RTW_RD_5G_MKK8 = 61, /* Japan */ + + /* === Below are driver defined for legacy channel plan compatible, DON'T assign index ==== */ + RTW_RD_5G_OLD_FCC1, + RTW_RD_5G_OLD_NCC1, + RTW_RD_5G_OLD_KCC1, + + RTW_RD_5G_MAX, +}; + +struct ch_list_t { + u8 *len_ch; +}; + +#define CH_LIST_ENT(_len, arg...) \ + {.len_ch = (u8[_len + 1]) {_len, ##arg}, } + +#define CH_LIST_LEN(_ch_list) (_ch_list.len_ch[0]) +#define CH_LIST_CH(_ch_list, _i) (_ch_list.len_ch[_i + 1]) + +struct chplan_ent_t { + u8 rd_2g; +#ifdef CONFIG_IEEE80211_BAND_5GHZ + u8 rd_5g; +#endif + u8 regd; /* value of REGULATION_TXPWR_LMT */ +}; + +#ifdef CONFIG_IEEE80211_BAND_5GHZ +#define CHPLAN_ENT(i2g, i5g, regd) {i2g, i5g, regd} +#else +#define CHPLAN_ENT(i2g, i5g, regd) {i2g, regd} +#endif + +static struct ch_list_t RTW_ChannelPlan2G[] = { + /* 0, RTW_RD_2G_NULL */ CH_LIST_ENT(0), + /* 1, RTW_RD_2G_WORLD */ CH_LIST_ENT(13, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13), + /* 2, RTW_RD_2G_ETSI1 */ CH_LIST_ENT(13, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13), + /* 3, RTW_RD_2G_FCC1 */ CH_LIST_ENT(11, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11), + /* 4, RTW_RD_2G_MKK1 */ CH_LIST_ENT(14, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14), + /* 5, RTW_RD_2G_ETSI2 */ CH_LIST_ENT(4, 10, 11, 12, 13), + /* 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), + /* 10, RTW_RD_2G_WORLD1 */ CH_LIST_ENT(11, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11), + /* 11, RTW_RD_2G_KCC1 */ CH_LIST_ENT(13, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13), + /* 12, RTW_RD_2G_IC2 */ CH_LIST_ENT(11, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11), +}; + +#ifdef CONFIG_IEEE80211_BAND_5GHZ +static struct ch_list_t RTW_ChannelPlan5G[] = { + /* 0, RTW_RD_5G_NULL */ CH_LIST_ENT(0), + /* 1, RTW_RD_5G_ETSI1 */ CH_LIST_ENT(19, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140), + /* 2, RTW_RD_5G_ETSI2 */ 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), + /* 3, RTW_RD_5G_ETSI3 */ CH_LIST_ENT(22, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 149, 153, 157, 161, 165), + /* 4, RTW_RD_5G_FCC1 */ 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), + /* 5, RTW_RD_5G_FCC2 */ CH_LIST_ENT(9, 36, 40, 44, 48, 149, 153, 157, 161, 165), + /* 6, RTW_RD_5G_FCC3 */ CH_LIST_ENT(13, 36, 40, 44, 48, 52, 56, 60, 64, 149, 153, 157, 161, 165), + /* 7, RTW_RD_5G_FCC4 */ CH_LIST_ENT(12, 36, 40, 44, 48, 52, 56, 60, 64, 149, 153, 157, 161), + /* 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_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), + /* 53, RTW_RD_5G_CHILE1 */ 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), + /* 54, RTW_RD_5G_ACMA1 */ 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), + /* 55, RTW_RD_5G_WORLD1 */ CH_LIST_ENT(8, 36, 40, 44, 48, 52, 56, 60, 64), + /* 56, RTW_RD_5G_CHILE2 */ CH_LIST_ENT(16, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 144), + /* 57, RTW_RD_5G_KCC2 */ 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), + /* 58, RTW_RD_5G_KCC3 */ 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), + /* 59, RTW_RD_5G_MKK6 */ 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), + /* 60, RTW_RD_5G_MKK7 */ 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), + /* 61, RTW_RD_5G_MKK8 */ CH_LIST_ENT(23, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 136, 140, 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), + /* RTW_RD_5G_OLD_NCC1 */ CH_LIST_ENT(15, 56, 60, 64, 100, 104, 108, 112, 116, 136, 140, 149, 153, 157, 161, 165), + /* RTW_RD_5G_OLD_KCC1 */ CH_LIST_ENT(20, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 149, 153, 157, 161, 165), +}; +#endif /* CONFIG_IEEE80211_BAND_5GHZ */ + +static struct chplan_ent_t RTW_ChannelPlanMap[RTW_CHPLAN_MAX] = { + /* ===== 0x00 ~ 0x1F, legacy channel plan ===== */ + CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_KCC1, TXPWR_LMT_FCC), /* 0x00, RTW_CHPLAN_FCC */ + CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_OLD_FCC1, TXPWR_LMT_FCC), /* 0x01, RTW_CHPLAN_IC */ + CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_ETSI1, TXPWR_LMT_ETSI), /* 0x02, RTW_CHPLAN_ETSI */ + CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_NULL, TXPWR_LMT_ETSI), /* 0x03, RTW_CHPLAN_SPAIN */ + CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_NULL, TXPWR_LMT_ETSI), /* 0x04, RTW_CHPLAN_FRANCE */ + CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_NULL, TXPWR_LMT_MKK), /* 0x05, RTW_CHPLAN_MKK */ + CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_NULL, TXPWR_LMT_MKK), /* 0x06, RTW_CHPLAN_MKK1 */ + CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_FCC6, TXPWR_LMT_ETSI), /* 0x07, RTW_CHPLAN_ISRAEL */ + CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_FCC6, TXPWR_LMT_MKK), /* 0x08, RTW_CHPLAN_TELEC */ + CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x09, RTW_CHPLAN_GLOBAL_DOAMIN */ + CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x0A, RTW_CHPLAN_WORLD_WIDE_13 */ + CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_OLD_NCC1, TXPWR_LMT_FCC), /* 0x0B, RTW_CHPLAN_TAIWAN */ + CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_FCC5, TXPWR_LMT_ETSI), /* 0x0C, RTW_CHPLAN_CHINA */ + CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC3, TXPWR_LMT_WW), /* 0x0D, RTW_CHPLAN_SINGAPORE_INDIA_MEXICO */ /* ETSI:Singapore, India. FCC:Mexico => WW */ + CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_OLD_KCC1, TXPWR_LMT_ETSI), /* 0x0E, RTW_CHPLAN_KOREA */ + CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC6, TXPWR_LMT_ETSI), /* 0x0F, RTW_CHPLAN_TURKEY */ + CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_ETSI1, TXPWR_LMT_MKK), /* 0x10, RTW_CHPLAN_JAPAN */ + CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC2, TXPWR_LMT_FCC), /* 0x11, RTW_CHPLAN_FCC_NO_DFS */ + CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_FCC7, TXPWR_LMT_MKK), /* 0x12, RTW_CHPLAN_JAPAN_NO_DFS */ + CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC1, TXPWR_LMT_WW), /* 0x13, RTW_CHPLAN_WORLD_WIDE_5G */ + CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_NCC2, TXPWR_LMT_FCC), /* 0x14, RTW_CHPLAN_TAIWAN_NO_DFS */ + CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC7, TXPWR_LMT_ETSI), /* 0x15, RTW_CHPLAN_ETSI_NO_DFS */ + CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_NCC1, TXPWR_LMT_ETSI), /* 0x16, RTW_CHPLAN_KOREA_NO_DFS */ + CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_FCC7, TXPWR_LMT_MKK), /* 0x17, RTW_CHPLAN_JAPAN_NO_DFS */ + CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_FCC5, TXPWR_LMT_ETSI), /* 0x18, RTW_CHPLAN_PAKISTAN_NO_DFS */ + CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC5, TXPWR_LMT_FCC), /* 0x19, RTW_CHPLAN_TAIWAN2_NO_DFS */ + CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x1A, */ + CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x1B, */ + CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x1C, */ + CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x1D, */ + CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x1E, */ + CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_FCC1, TXPWR_LMT_WW), /* 0x1F, RTW_CHPLAN_WORLD_WIDE_ONLY_5G */ + + /* ===== 0x20 ~ 0x7F, new channel plan ===== */ + CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x20, RTW_CHPLAN_WORLD_NULL */ + CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_NULL, TXPWR_LMT_ETSI), /* 0x21, RTW_CHPLAN_ETSI1_NULL */ + CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_NULL, TXPWR_LMT_FCC), /* 0x22, RTW_CHPLAN_FCC1_NULL */ + CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_NULL, TXPWR_LMT_MKK), /* 0x23, RTW_CHPLAN_MKK1_NULL */ + CHPLAN_ENT(RTW_RD_2G_ETSI2, RTW_RD_5G_NULL, TXPWR_LMT_ETSI), /* 0x24, RTW_CHPLAN_ETSI2_NULL */ + 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_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_IC1, RTW_RD_5G_IC2, TXPWR_LMT_IC), /* 0x2B, RTW_CHPLAN_IC1_IC2 */ + CHPLAN_ENT(RTW_RD_2G_MKK2, RTW_RD_5G_NULL, TXPWR_LMT_MKK), /* 0x2C, RTW_CHPLAN_MKK2_NULL */ + CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_CHILE1, TXPWR_LMT_CHILE), /* 0x2D, RTW_CHPLAN_WORLD_CHILE1 */ + CHPLAN_ENT(RTW_RD_2G_WORLD1, RTW_RD_5G_WORLD1, TXPWR_LMT_WW), /* 0x2E, RTW_CHPLAN_WORLD1_WORLD1 */ + CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_CHILE2, TXPWR_LMT_CHILE), /* 0x2F, RTW_CHPLAN_WORLD_CHILE2 */ + CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC3, TXPWR_LMT_FCC), /* 0x30, RTW_CHPLAN_WORLD_FCC3 */ + CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC4, TXPWR_LMT_FCC), /* 0x31, RTW_CHPLAN_WORLD_FCC4 */ + CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC5, TXPWR_LMT_FCC), /* 0x32, RTW_CHPLAN_WORLD_FCC5 */ + CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC6, TXPWR_LMT_FCC), /* 0x33, RTW_CHPLAN_WORLD_FCC6 */ + CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC7, TXPWR_LMT_FCC), /* 0x34, RTW_CHPLAN_FCC1_FCC7 */ + CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI2, TXPWR_LMT_ETSI), /* 0x35, RTW_CHPLAN_WORLD_ETSI2 */ + CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI3, TXPWR_LMT_ETSI), /* 0x36, RTW_CHPLAN_WORLD_ETSI3 */ + CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_MKK2, TXPWR_LMT_MKK), /* 0x37, RTW_CHPLAN_MKK1_MKK2 */ + CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_MKK3, TXPWR_LMT_MKK), /* 0x38, RTW_CHPLAN_MKK1_MKK3 */ + CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_NCC1, TXPWR_LMT_FCC), /* 0x39, RTW_CHPLAN_FCC1_NCC1 */ + CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_ETSI1, TXPWR_LMT_ETSI), /* 0x3A, RTW_CHPLAN_ETSI1_ETSI1 */ + CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_ACMA1, TXPWR_LMT_ACMA), /* 0x3B, RTW_CHPLAN_ETSI1_ACMA1 */ + CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_ETSI6, TXPWR_LMT_ETSI), /* 0x3C, RTW_CHPLAN_ETSI1_ETSI6 */ + CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_ETSI12, TXPWR_LMT_ETSI), /* 0x3D, RTW_CHPLAN_ETSI1_ETSI12 */ + CHPLAN_ENT(RTW_RD_2G_KCC1, RTW_RD_5G_KCC2, TXPWR_LMT_KCC), /* 0x3E, RTW_CHPLAN_KCC1_KCC2 */ + CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC11, TXPWR_LMT_FCC), /* 0x3F, RTW_CHPLAN_FCC1_FCC11*/ + CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_NCC2, TXPWR_LMT_FCC), /* 0x40, RTW_CHPLAN_FCC1_NCC2 */ + CHPLAN_ENT(RTW_RD_2G_GLOBAL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x41, RTW_CHPLAN_GLOBAL_NULL */ + CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_ETSI4, TXPWR_LMT_ETSI), /* 0x42, RTW_CHPLAN_ETSI1_ETSI4 */ + CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC2, TXPWR_LMT_FCC), /* 0x43, RTW_CHPLAN_FCC1_FCC2 */ + CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_NCC3, TXPWR_LMT_FCC), /* 0x44, RTW_CHPLAN_FCC1_NCC3 */ + CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ACMA1, TXPWR_LMT_ACMA), /* 0x45, RTW_CHPLAN_WORLD_ACMA1 */ + CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC8, TXPWR_LMT_FCC), /* 0x46, RTW_CHPLAN_FCC1_FCC8 */ + CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI6, TXPWR_LMT_ETSI), /* 0x47, RTW_CHPLAN_WORLD_ETSI6 */ + CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI7, TXPWR_LMT_ETSI), /* 0x48, RTW_CHPLAN_WORLD_ETSI7 */ + CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI8, TXPWR_LMT_ETSI), /* 0x49, RTW_CHPLAN_WORLD_ETSI8 */ + CHPLAN_ENT(RTW_RD_2G_IC2, RTW_RD_5G_IC2, TXPWR_LMT_IC), /* 0x4A, RTW_CHPLAN_IC2_IC2 */ + CHPLAN_ENT(RTW_RD_2G_KCC1, RTW_RD_5G_KCC3, TXPWR_LMT_KCC), /* 0x4B, RTW_CHPLAN_KCC1_KCC3 */ + CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC15, TXPWR_LMT_FCC), /* 0x4C, RTW_CHPLAN_FCC1_FCC15*/ + CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x4D, */ + CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x4E, */ + CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x4F, */ + CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI9, TXPWR_LMT_ETSI), /* 0x50, RTW_CHPLAN_WORLD_ETSI9 */ + CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI10, TXPWR_LMT_ETSI), /* 0x51, RTW_CHPLAN_WORLD_ETSI10 */ + CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI11, TXPWR_LMT_ETSI), /* 0x52, RTW_CHPLAN_WORLD_ETSI11 */ + CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_NCC4, TXPWR_LMT_FCC), /* 0x53, RTW_CHPLAN_FCC1_NCC4 */ + CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI12, TXPWR_LMT_ETSI), /* 0x54, RTW_CHPLAN_WORLD_ETSI12 */ + CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC9, TXPWR_LMT_FCC), /* 0x55, RTW_CHPLAN_FCC1_FCC9 */ + CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI13, TXPWR_LMT_ETSI), /* 0x56, RTW_CHPLAN_WORLD_ETSI13 */ + CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC10, TXPWR_LMT_FCC), /* 0x57, RTW_CHPLAN_FCC1_FCC10 */ + CHPLAN_ENT(RTW_RD_2G_MKK2, RTW_RD_5G_MKK4, TXPWR_LMT_MKK), /* 0x58, RTW_CHPLAN_MKK2_MKK4 */ + CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI14, TXPWR_LMT_ETSI), /* 0x59, RTW_CHPLAN_WORLD_ETSI14 */ + CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x5A, */ + CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x5B, */ + CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x5C, */ + CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x5D, */ + CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x5E, */ + CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x5F, */ + 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 struct chplan_ent_t RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE = + CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC1, TXPWR_LMT_FCC); /* 0x7F, Realtek Define */ + +u8 rtw_chplan_get_default_regd(u8 id) +{ + u8 regd; + + if (id == RTW_CHPLAN_REALTEK_DEFINE) + regd = RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE.regd; + else + regd = RTW_ChannelPlanMap[id].regd; + + return regd; +} + +bool rtw_chplan_is_empty(u8 id) +{ + struct chplan_ent_t *chplan_map; + + if (id == RTW_CHPLAN_REALTEK_DEFINE) + chplan_map = &RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE; + else + chplan_map = &RTW_ChannelPlanMap[id]; + + if (chplan_map->rd_2g == RTW_RD_2G_NULL + #ifdef CONFIG_IEEE80211_BAND_5GHZ + && chplan_map->rd_5g == RTW_RD_5G_NULL + #endif + ) + return _TRUE; + + 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 static 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: + case RTW_RD_5G_WORLD1: + case RTW_RD_5G_MKK6: + case RTW_RD_5G_MKK7: + passive = 1; + }; + + return passive; +} + +inline static 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: + case RTW_RD_5G_MKK8: + passive = 1; + }; + + return passive; +} + +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 rd_2g = 0, rd_5g = 0; +#ifdef CONFIG_DFS_MASTER + int i; +#endif + + 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) + rd_2g = RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE.rd_2g; + else + rd_2g = RTW_ChannelPlanMap[ChannelPlan].rd_2g; + + for (index = 0; index < CH_LIST_LEN(RTW_ChannelPlan2G[rd_2g]); index++) { + if (rtw_regsty_is_excl_chs(regsty, CH_LIST_CH(RTW_ChannelPlan2G[rd_2g], 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[rd_2g], index); + + if (ChannelPlan == RTW_CHPLAN_GLOBAL_DOAMIN + || rd_2g == 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 + || rd_2g == 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) + rd_5g = RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE.rd_5g; + else + rd_5g = RTW_ChannelPlanMap[ChannelPlan].rd_5g; + + for (index = 0; index < CH_LIST_LEN(RTW_ChannelPlan5G[rd_5g]); index++) { + if (rtw_regsty_is_excl_chs(regsty, CH_LIST_CH(RTW_ChannelPlan5G[rd_5g], index)) == _TRUE) + continue; + #ifndef CONFIG_DFS + if (rtw_is_dfs_ch(CH_LIST_CH(RTW_ChannelPlan5G[rd_5g], 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[rd_5g], 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(rd_5g)) /* band1 passive */ + || (rtw_is_5g_band4(channel_set[chanset_size].ChannelNum) + && rtw_rd_5g_band4_passive(rd_5g)) /* 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_80211AC_VHT +#define COUNTRY_CHPLAN_ASSIGN_EN_11AC(_val) , .en_11ac = (_val) +#else +#define COUNTRY_CHPLAN_ASSIGN_EN_11AC(_val) +#endif + +#if RTW_DEF_MODULE_REGULATORY_CERT +#define COUNTRY_CHPLAN_ASSIGN_DEF_MODULE_FLAGS(_val) , .def_module_flags = (_val) +#else +#define COUNTRY_CHPLAN_ASSIGN_DEF_MODULE_FLAGS(_val) +#endif + +/* has def_module_flags specified, used by common map and HAL dfference map */ +#define COUNTRY_CHPLAN_ENT(_alpha2, _chplan, _en_11ac, _def_module_flags) \ + {.alpha2 = (_alpha2), .chplan = (_chplan) \ + COUNTRY_CHPLAN_ASSIGN_EN_11AC(_en_11ac) \ + COUNTRY_CHPLAN_ASSIGN_DEF_MODULE_FLAGS(_def_module_flags) \ + } + +#ifdef CONFIG_CUSTOMIZED_COUNTRY_CHPLAN_MAP + +#include "../platform/custom_country_chplan.h" + +#elif RTW_DEF_MODULE_REGULATORY_CERT + +/* leave def_module_flags empty, def_module_flags check is done on country_chplan_map */ +#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, 0), /* Canada */ + COUNTRY_CHPLAN_ENT("CL", 0x30, 1, 0), /* Chile */ + COUNTRY_CHPLAN_ENT("CN", 0x51, 1, 0), /* China */ + COUNTRY_CHPLAN_ENT("CO", 0x34, 1, 0), /* Colombia */ + COUNTRY_CHPLAN_ENT("CR", 0x34, 1, 0), /* Costa Rica */ + COUNTRY_CHPLAN_ENT("DO", 0x34, 1, 0), /* Dominican Republic */ + COUNTRY_CHPLAN_ENT("EC", 0x34, 1, 0), /* Ecuador */ + COUNTRY_CHPLAN_ENT("GT", 0x34, 1, 0), /* Guatemala */ + COUNTRY_CHPLAN_ENT("KR", 0x28, 1, 0), /* South Korea */ + COUNTRY_CHPLAN_ENT("MX", 0x34, 1, 0), /* Mexico */ + COUNTRY_CHPLAN_ENT("MY", 0x47, 1, 0), /* Malaysia */ + COUNTRY_CHPLAN_ENT("NI", 0x34, 1, 0), /* Nicaragua */ + COUNTRY_CHPLAN_ENT("PA", 0x34, 1, 0), /* Panama */ + COUNTRY_CHPLAN_ENT("PE", 0x34, 1, 0), /* Peru */ + COUNTRY_CHPLAN_ENT("PR", 0x34, 1, 0), /* Puerto Rico */ + COUNTRY_CHPLAN_ENT("PY", 0x34, 1, 0), /* Paraguay */ + COUNTRY_CHPLAN_ENT("TW", 0x39, 1, 0), /* Taiwan */ + COUNTRY_CHPLAN_ENT("UA", 0x36, 0, 0), /* Ukraine */ + COUNTRY_CHPLAN_ENT("US", 0x34, 1, 0), /* United States of America (USA) */ +}; +#endif + +#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, 0), /* Canada */ + COUNTRY_CHPLAN_ENT("KR", 0x28, 1, 0), /* South Korea */ + COUNTRY_CHPLAN_ENT("RU", 0x59, 0, 0), /* Russia(fac/gost), Kaliningrad */ + COUNTRY_CHPLAN_ENT("TW", 0x39, 1, 0), /* Taiwan */ + COUNTRY_CHPLAN_ENT("UA", 0x36, 0, 0), /* Ukraine */ + COUNTRY_CHPLAN_ENT("US", 0x34, 1, 0), /* United States of America (USA) */ +}; +#endif + +#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, 0), /* Taiwan */ + COUNTRY_CHPLAN_ENT("US", 0x34, 1, 0), /* United States of America (USA) */ +}; +#endif + +#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, 0), /* Canada */ + COUNTRY_CHPLAN_ENT("KR", 0x28, 1, 0), /* South Korea */ + COUNTRY_CHPLAN_ENT("RU", 0x59, 0, 0), /* Russia(fac/gost), Kaliningrad */ + COUNTRY_CHPLAN_ENT("TW", 0x39, 1, 0), /* Taiwan */ + COUNTRY_CHPLAN_ENT("UA", 0x36, 0, 0), /* Ukraine */ + COUNTRY_CHPLAN_ENT("US", 0x34, 1, 0), /* United States of America (USA) */ +}; +#endif + +#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("AW", 0x34, 1, 0), /* Aruba */ + COUNTRY_CHPLAN_ENT("BB", 0x34, 1, 0), /* Barbados */ + COUNTRY_CHPLAN_ENT("CA", 0x20, 1, 0), /* Canada */ + COUNTRY_CHPLAN_ENT("CO", 0x34, 1, 0), /* Colombia */ + COUNTRY_CHPLAN_ENT("CR", 0x34, 1, 0), /* Costa Rica */ + COUNTRY_CHPLAN_ENT("DO", 0x34, 1, 0), /* Dominican Republic */ + COUNTRY_CHPLAN_ENT("EC", 0x34, 1, 0), /* Ecuador */ + COUNTRY_CHPLAN_ENT("GT", 0x34, 1, 0), /* Guatemala */ + COUNTRY_CHPLAN_ENT("HT", 0x34, 1, 0), /* Haiti */ + COUNTRY_CHPLAN_ENT("KR", 0x28, 1, 0), /* South Korea */ + COUNTRY_CHPLAN_ENT("MX", 0x34, 1, 0), /* Mexico */ + COUNTRY_CHPLAN_ENT("NI", 0x34, 1, 0), /* Nicaragua */ + COUNTRY_CHPLAN_ENT("PA", 0x34, 1, 0), /* Panama */ + COUNTRY_CHPLAN_ENT("PE", 0x34, 1, 0), /* Peru */ + COUNTRY_CHPLAN_ENT("PR", 0x34, 1, 0), /* Puerto Rico */ + COUNTRY_CHPLAN_ENT("PY", 0x34, 1, 0), /* Paraguay */ + COUNTRY_CHPLAN_ENT("SC", 0x34, 1, 0), /* Seychelles */ + COUNTRY_CHPLAN_ENT("TW", 0x39, 1, 0), /* Taiwan */ + COUNTRY_CHPLAN_ENT("US", 0x34, 1, 0), /* United States of America (USA) */ + COUNTRY_CHPLAN_ENT("VC", 0x34, 1, 0), /* Saint Vincent and the Grenadines */ +}; +#endif + +#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("AW", 0x34, 1, 0), /* Aruba */ + COUNTRY_CHPLAN_ENT("BS", 0x34, 1, 0), /* Bahamas */ + COUNTRY_CHPLAN_ENT("CA", 0x20, 1, 0), /* Canada */ + COUNTRY_CHPLAN_ENT("CO", 0x34, 1, 0), /* Colombia */ + COUNTRY_CHPLAN_ENT("CR", 0x34, 1, 0), /* Costa Rica */ + COUNTRY_CHPLAN_ENT("DO", 0x34, 1, 0), /* Dominican Republic */ + COUNTRY_CHPLAN_ENT("EC", 0x34, 1, 0), /* Ecuador */ + COUNTRY_CHPLAN_ENT("GT", 0x34, 1, 0), /* Guatemala */ + COUNTRY_CHPLAN_ENT("KR", 0x28, 1, 0), /* South Korea */ + COUNTRY_CHPLAN_ENT("MX", 0x34, 1, 0), /* Mexico */ + COUNTRY_CHPLAN_ENT("NI", 0x34, 1, 0), /* Nicaragua */ + COUNTRY_CHPLAN_ENT("PA", 0x34, 1, 0), /* Panama */ + COUNTRY_CHPLAN_ENT("PE", 0x34, 1, 0), /* Peru */ + COUNTRY_CHPLAN_ENT("PR", 0x34, 1, 0), /* Puerto Rico */ + COUNTRY_CHPLAN_ENT("PY", 0x34, 1, 0), /* Paraguay */ + COUNTRY_CHPLAN_ENT("TW", 0x39, 1, 0), /* Taiwan */ + COUNTRY_CHPLAN_ENT("US", 0x34, 1, 0), /* United States of America (USA) */ +}; +#endif + +#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("BB", 0x34, 1, 0), /* Barbados */ + COUNTRY_CHPLAN_ENT("CA", 0x20, 1, 0), /* Canada */ + COUNTRY_CHPLAN_ENT("CO", 0x34, 1, 0), /* Colombia */ + COUNTRY_CHPLAN_ENT("CR", 0x34, 1, 0), /* Costa Rica */ + COUNTRY_CHPLAN_ENT("DO", 0x34, 1, 0), /* Dominican Republic */ + COUNTRY_CHPLAN_ENT("EC", 0x34, 1, 0), /* Ecuador */ + COUNTRY_CHPLAN_ENT("GT", 0x34, 1, 0), /* Guatemala */ + COUNTRY_CHPLAN_ENT("HT", 0x34, 1, 0), /* Haiti */ + COUNTRY_CHPLAN_ENT("KR", 0x28, 1, 0), /* South Korea */ + COUNTRY_CHPLAN_ENT("MX", 0x34, 1, 0), /* Mexico */ + COUNTRY_CHPLAN_ENT("NI", 0x34, 1, 0), /* Nicaragua */ + COUNTRY_CHPLAN_ENT("PA", 0x34, 1, 0), /* Panama */ + COUNTRY_CHPLAN_ENT("PE", 0x34, 1, 0), /* Peru */ + COUNTRY_CHPLAN_ENT("PR", 0x34, 1, 0), /* Puerto Rico */ + COUNTRY_CHPLAN_ENT("PY", 0x34, 1, 0), /* Paraguay */ + COUNTRY_CHPLAN_ENT("TW", 0x39, 1, 0), /* Taiwan */ + COUNTRY_CHPLAN_ENT("US", 0x34, 1, 0), /* United States of America (USA) */ +}; +#endif + +#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("AW", 0x34, 1, 0), /* Aruba */ + COUNTRY_CHPLAN_ENT("CA", 0x20, 1, 0), /* Canada */ + COUNTRY_CHPLAN_ENT("CO", 0x34, 1, 0), /* Colombia */ + COUNTRY_CHPLAN_ENT("CR", 0x34, 1, 0), /* Costa Rica */ + COUNTRY_CHPLAN_ENT("DO", 0x34, 1, 0), /* Dominican Republic */ + COUNTRY_CHPLAN_ENT("EC", 0x34, 1, 0), /* Ecuador */ + COUNTRY_CHPLAN_ENT("GT", 0x34, 1, 0), /* Guatemala */ + COUNTRY_CHPLAN_ENT("KR", 0x28, 1, 0), /* South Korea */ + COUNTRY_CHPLAN_ENT("MX", 0x34, 1, 0), /* Mexico */ + COUNTRY_CHPLAN_ENT("NI", 0x34, 1, 0), /* Nicaragua */ + COUNTRY_CHPLAN_ENT("PA", 0x34, 1, 0), /* Panama */ + COUNTRY_CHPLAN_ENT("PE", 0x34, 1, 0), /* Peru */ + COUNTRY_CHPLAN_ENT("PR", 0x34, 1, 0), /* Puerto Rico */ + COUNTRY_CHPLAN_ENT("PY", 0x34, 1, 0), /* Paraguay */ + COUNTRY_CHPLAN_ENT("SC", 0x34, 1, 0), /* Seychelles */ + COUNTRY_CHPLAN_ENT("ST", 0x34, 1, 0), /* Sao Tome and Principe */ + COUNTRY_CHPLAN_ENT("TW", 0x39, 1, 0), /* Taiwan */ + COUNTRY_CHPLAN_ENT("US", 0x34, 1, 0), /* 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, 0), /* Canada */ + COUNTRY_CHPLAN_ENT("KR", 0x28, 1, 0), /* South Korea */ + COUNTRY_CHPLAN_ENT("MX", 0x34, 1, 0), /* 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("KR", 0x28, 1, 0), /* South Korea */ +}; +#endif + +#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8821CE) /* 2016 certify */ +static const struct country_chplan RTL8821CE_country_chplan_exc_map[] = { + COUNTRY_CHPLAN_ENT("KR", 0x28, 1, 0), /* South Korea */ +}; +#endif + +/** + * rtw_def_module_get_chplan_from_country - + * @country_code: string of country code + * @return: + * Return NULL for case referring to common map + */ +static const struct country_chplan *rtw_def_module_get_chplan_from_country(const char *country_code) +{ + const struct country_chplan *ent = NULL; + const struct country_chplan *hal_map = NULL; + u16 hal_map_sz = 0; + int i; + + /* TODO: runtime selection for multi driver */ +#if (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8821AE_HMC_M2) + 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_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_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_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_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_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_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_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); +#elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8821CE) + hal_map = RTL8821CE_country_chplan_exc_map; + hal_map_sz = sizeof(RTL8821CE_country_chplan_exc_map) / sizeof(struct country_chplan); +#endif + + if (hal_map == NULL || hal_map_sz == 0) + goto exit; + + for (i = 0; i < hal_map_sz; i++) { + if (strncmp(country_code, hal_map[i].alpha2, 2) == 0) { + ent = &hal_map[i]; + break; + } + } + +exit: + return ent; +} +#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, 0x000), /* Andorra */ + COUNTRY_CHPLAN_ENT("AE", 0x35, 1, 0x7FB), /* United Arab Emirates */ + COUNTRY_CHPLAN_ENT("AF", 0x42, 1, 0x000), /* Afghanistan */ + COUNTRY_CHPLAN_ENT("AG", 0x76, 1, 0x000), /* Antigua & Barbuda */ + COUNTRY_CHPLAN_ENT("AI", 0x26, 1, 0x000), /* Anguilla(UK) */ + COUNTRY_CHPLAN_ENT("AL", 0x26, 1, 0x7F1), /* Albania */ + COUNTRY_CHPLAN_ENT("AM", 0x26, 1, 0x6B0), /* Armenia */ + COUNTRY_CHPLAN_ENT("AN", 0x76, 1, 0x7F1), /* Netherlands Antilles */ + COUNTRY_CHPLAN_ENT("AO", 0x47, 1, 0x6E0), /* Angola */ + COUNTRY_CHPLAN_ENT("AQ", 0x26, 1, 0x000), /* Antarctica */ + COUNTRY_CHPLAN_ENT("AR", 0x61, 1, 0x7F3), /* Argentina */ + COUNTRY_CHPLAN_ENT("AS", 0x76, 1, 0x000), /* American Samoa */ + COUNTRY_CHPLAN_ENT("AT", 0x26, 1, 0x7FB), /* Austria */ + COUNTRY_CHPLAN_ENT("AU", 0x45, 1, 0x7FB), /* Australia */ + COUNTRY_CHPLAN_ENT("AW", 0x76, 1, 0x0B0), /* Aruba */ + COUNTRY_CHPLAN_ENT("AZ", 0x26, 1, 0x7F1), /* Azerbaijan */ + COUNTRY_CHPLAN_ENT("BA", 0x26, 1, 0x7F1), /* Bosnia & Herzegovina */ + COUNTRY_CHPLAN_ENT("BB", 0x76, 1, 0x650), /* Barbados */ + COUNTRY_CHPLAN_ENT("BD", 0x26, 1, 0x7F1), /* Bangladesh */ + COUNTRY_CHPLAN_ENT("BE", 0x26, 1, 0x7FB), /* Belgium */ + COUNTRY_CHPLAN_ENT("BF", 0x26, 1, 0x6B0), /* Burkina Faso */ + COUNTRY_CHPLAN_ENT("BG", 0x26, 1, 0x7F1), /* Bulgaria */ + COUNTRY_CHPLAN_ENT("BH", 0x48, 1, 0x7F1), /* Bahrain */ + COUNTRY_CHPLAN_ENT("BI", 0x26, 1, 0x6B0), /* Burundi */ + COUNTRY_CHPLAN_ENT("BJ", 0x26, 1, 0x6B0), /* Benin */ + COUNTRY_CHPLAN_ENT("BM", 0x76, 1, 0x600), /* Bermuda (UK) */ + COUNTRY_CHPLAN_ENT("BN", 0x47, 1, 0x610), /* Brunei */ + COUNTRY_CHPLAN_ENT("BO", 0x73, 1, 0x7F1), /* Bolivia */ + COUNTRY_CHPLAN_ENT("BR", 0x62, 1, 0x7F1), /* Brazil */ + COUNTRY_CHPLAN_ENT("BS", 0x76, 1, 0x620), /* Bahamas */ + COUNTRY_CHPLAN_ENT("BT", 0x26, 1, 0x000), /* Bhutan */ + COUNTRY_CHPLAN_ENT("BV", 0x26, 1, 0x000), /* Bouvet Island (Norway) */ + COUNTRY_CHPLAN_ENT("BW", 0x35, 1, 0x6F1), /* Botswana */ + COUNTRY_CHPLAN_ENT("BY", 0x26, 1, 0x7F1), /* Belarus */ + COUNTRY_CHPLAN_ENT("BZ", 0x76, 1, 0x000), /* Belize */ + COUNTRY_CHPLAN_ENT("CA", 0x2B, 1, 0x7FB), /* Canada */ + COUNTRY_CHPLAN_ENT("CC", 0x26, 1, 0x000), /* Cocos (Keeling) Islands (Australia) */ + COUNTRY_CHPLAN_ENT("CD", 0x26, 1, 0x6B0), /* Congo, Republic of the */ + COUNTRY_CHPLAN_ENT("CF", 0x26, 1, 0x6B0), /* Central African Republic */ + COUNTRY_CHPLAN_ENT("CG", 0x26, 1, 0x6B0), /* Congo, Democratic Republic of the. Zaire */ + COUNTRY_CHPLAN_ENT("CH", 0x26, 1, 0x7FB), /* Switzerland */ + COUNTRY_CHPLAN_ENT("CI", 0x42, 1, 0x7F1), /* Cote d'Ivoire */ + COUNTRY_CHPLAN_ENT("CK", 0x26, 1, 0x000), /* Cook Islands */ + COUNTRY_CHPLAN_ENT("CL", 0x2D, 1, 0x7F1), /* Chile */ + COUNTRY_CHPLAN_ENT("CM", 0x26, 1, 0x6B0), /* Cameroon */ + COUNTRY_CHPLAN_ENT("CN", 0x48, 1, 0x7FB), /* China */ + COUNTRY_CHPLAN_ENT("CO", 0x76, 1, 0x7F1), /* Colombia */ + COUNTRY_CHPLAN_ENT("CR", 0x76, 1, 0x7F1), /* Costa Rica */ + COUNTRY_CHPLAN_ENT("CV", 0x26, 1, 0x6B0), /* Cape Verde */ + COUNTRY_CHPLAN_ENT("CX", 0x45, 1, 0x000), /* Christmas Island (Australia) */ + COUNTRY_CHPLAN_ENT("CY", 0x26, 1, 0x7FB), /* Cyprus */ + COUNTRY_CHPLAN_ENT("CZ", 0x26, 1, 0x7FB), /* Czech Republic */ + COUNTRY_CHPLAN_ENT("DE", 0x26, 1, 0x7FB), /* Germany */ + COUNTRY_CHPLAN_ENT("DJ", 0x26, 1, 0x680), /* Djibouti */ + COUNTRY_CHPLAN_ENT("DK", 0x26, 1, 0x7FB), /* Denmark */ + COUNTRY_CHPLAN_ENT("DM", 0x76, 1, 0x000), /* Dominica */ + COUNTRY_CHPLAN_ENT("DO", 0x76, 1, 0x7F1), /* Dominican Republic */ + COUNTRY_CHPLAN_ENT("DZ", 0x26, 1, 0x7F1), /* Algeria */ + COUNTRY_CHPLAN_ENT("EC", 0x76, 1, 0x7F1), /* Ecuador */ + COUNTRY_CHPLAN_ENT("EE", 0x26, 1, 0x7FB), /* Estonia */ + COUNTRY_CHPLAN_ENT("EG", 0x47, 1, 0x7F1), /* Egypt */ + COUNTRY_CHPLAN_ENT("EH", 0x47, 1, 0x680), /* Western Sahara */ + COUNTRY_CHPLAN_ENT("ER", 0x26, 1, 0x000), /* Eritrea */ + COUNTRY_CHPLAN_ENT("ES", 0x26, 1, 0x7FB), /* Spain, Canary Islands, Ceuta, Melilla */ + COUNTRY_CHPLAN_ENT("ET", 0x26, 1, 0x4B0), /* Ethiopia */ + COUNTRY_CHPLAN_ENT("FI", 0x26, 1, 0x7FB), /* Finland */ + COUNTRY_CHPLAN_ENT("FJ", 0x76, 1, 0x600), /* Fiji */ + COUNTRY_CHPLAN_ENT("FK", 0x26, 1, 0x000), /* Falkland Islands (Islas Malvinas) (UK) */ + COUNTRY_CHPLAN_ENT("FM", 0x76, 1, 0x000), /* Micronesia, Federated States of (USA) */ + COUNTRY_CHPLAN_ENT("FO", 0x26, 1, 0x000), /* Faroe Islands (Denmark) */ + COUNTRY_CHPLAN_ENT("FR", 0x26, 1, 0x7FB), /* France */ + COUNTRY_CHPLAN_ENT("GA", 0x26, 1, 0x6B0), /* Gabon */ + COUNTRY_CHPLAN_ENT("GB", 0x26, 1, 0x7FB), /* Great Britain (United Kingdom; England) */ + COUNTRY_CHPLAN_ENT("GD", 0x76, 1, 0x0B0), /* Grenada */ + COUNTRY_CHPLAN_ENT("GE", 0x26, 1, 0x600), /* 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, 0x7F1), /* Ghana */ + COUNTRY_CHPLAN_ENT("GI", 0x26, 1, 0x600), /* Gibraltar (UK) */ + COUNTRY_CHPLAN_ENT("GL", 0x26, 1, 0x600), /* Greenland (Denmark) */ + COUNTRY_CHPLAN_ENT("GM", 0x26, 1, 0x6B0), /* Gambia */ + COUNTRY_CHPLAN_ENT("GN", 0x26, 1, 0x610), /* Guinea */ + COUNTRY_CHPLAN_ENT("GP", 0x26, 1, 0x600), /* Guadeloupe (France) */ + COUNTRY_CHPLAN_ENT("GQ", 0x26, 1, 0x6B0), /* Equatorial Guinea */ + COUNTRY_CHPLAN_ENT("GR", 0x26, 1, 0x7FB), /* Greece */ + COUNTRY_CHPLAN_ENT("GS", 0x26, 1, 0x000), /* South Georgia and the Sandwich Islands (UK) */ + COUNTRY_CHPLAN_ENT("GT", 0x61, 1, 0x7F1), /* Guatemala */ + COUNTRY_CHPLAN_ENT("GU", 0x76, 1, 0x600), /* Guam (USA) */ + COUNTRY_CHPLAN_ENT("GW", 0x26, 1, 0x6B0), /* Guinea-Bissau */ + COUNTRY_CHPLAN_ENT("GY", 0x44, 1, 0x000), /* Guyana */ + COUNTRY_CHPLAN_ENT("HK", 0x35, 1, 0x7FB), /* Hong Kong */ + COUNTRY_CHPLAN_ENT("HM", 0x45, 1, 0x000), /* Heard and McDonald Islands (Australia) */ + COUNTRY_CHPLAN_ENT("HN", 0x32, 1, 0x7F1), /* Honduras */ + COUNTRY_CHPLAN_ENT("HR", 0x26, 1, 0x7F9), /* Croatia */ + COUNTRY_CHPLAN_ENT("HT", 0x76, 1, 0x650), /* Haiti */ + COUNTRY_CHPLAN_ENT("HU", 0x26, 1, 0x7FB), /* Hungary */ + COUNTRY_CHPLAN_ENT("ID", 0x3D, 0, 0x7F3), /* Indonesia */ + COUNTRY_CHPLAN_ENT("IE", 0x26, 1, 0x7FB), /* Ireland */ + COUNTRY_CHPLAN_ENT("IL", 0x47, 1, 0x7F1), /* Israel */ + COUNTRY_CHPLAN_ENT("IM", 0x26, 1, 0x000), /* Isle of Man (UK) */ + COUNTRY_CHPLAN_ENT("IN", 0x48, 1, 0x7F1), /* India */ + COUNTRY_CHPLAN_ENT("IO", 0x26, 1, 0x000), /* British Indian Ocean Territory (UK) */ + COUNTRY_CHPLAN_ENT("IQ", 0x26, 1, 0x000), /* Iraq */ + COUNTRY_CHPLAN_ENT("IR", 0x26, 0, 0x000), /* Iran */ + COUNTRY_CHPLAN_ENT("IS", 0x26, 1, 0x7FB), /* Iceland */ + COUNTRY_CHPLAN_ENT("IT", 0x26, 1, 0x7FB), /* Italy */ + COUNTRY_CHPLAN_ENT("JE", 0x26, 1, 0x000), /* Jersey (UK) */ + COUNTRY_CHPLAN_ENT("JM", 0x32, 1, 0x7F1), /* Jamaica */ + COUNTRY_CHPLAN_ENT("JO", 0x49, 1, 0x7FB), /* Jordan */ + COUNTRY_CHPLAN_ENT("JP", 0x27, 1, 0x7FF), /* Japan- Telec */ + COUNTRY_CHPLAN_ENT("KE", 0x47, 1, 0x7F9), /* Kenya */ + COUNTRY_CHPLAN_ENT("KG", 0x26, 1, 0x7F1), /* Kyrgyzstan */ + COUNTRY_CHPLAN_ENT("KH", 0x26, 1, 0x7F1), /* Cambodia */ + COUNTRY_CHPLAN_ENT("KI", 0x26, 1, 0x000), /* Kiribati */ + COUNTRY_CHPLAN_ENT("KM", 0x26, 1, 0x000), /* Comoros */ + COUNTRY_CHPLAN_ENT("KN", 0x76, 1, 0x000), /* Saint Kitts and Nevis */ + COUNTRY_CHPLAN_ENT("KR", 0x4B, 1, 0x7FB), /* South Korea */ + COUNTRY_CHPLAN_ENT("KW", 0x47, 1, 0x7FB), /* Kuwait */ + COUNTRY_CHPLAN_ENT("KY", 0x76, 1, 0x000), /* Cayman Islands (UK) */ + COUNTRY_CHPLAN_ENT("KZ", 0x26, 1, 0x700), /* Kazakhstan */ + COUNTRY_CHPLAN_ENT("LA", 0x26, 1, 0x000), /* Laos */ + COUNTRY_CHPLAN_ENT("LB", 0x26, 1, 0x7F1), /* Lebanon */ + COUNTRY_CHPLAN_ENT("LC", 0x76, 1, 0x000), /* Saint Lucia */ + COUNTRY_CHPLAN_ENT("LI", 0x26, 1, 0x7FB), /* Liechtenstein */ + COUNTRY_CHPLAN_ENT("LK", 0x26, 1, 0x7F1), /* Sri Lanka */ + COUNTRY_CHPLAN_ENT("LR", 0x26, 1, 0x6B0), /* Liberia */ + COUNTRY_CHPLAN_ENT("LS", 0x26, 1, 0x7F1), /* Lesotho */ + COUNTRY_CHPLAN_ENT("LT", 0x26, 1, 0x7FB), /* Lithuania */ + COUNTRY_CHPLAN_ENT("LU", 0x26, 1, 0x7FB), /* Luxembourg */ + COUNTRY_CHPLAN_ENT("LV", 0x26, 1, 0x7FB), /* Latvia */ + COUNTRY_CHPLAN_ENT("LY", 0x26, 1, 0x000), /* Libya */ + COUNTRY_CHPLAN_ENT("MA", 0x47, 1, 0x7F1), /* Morocco */ + COUNTRY_CHPLAN_ENT("MC", 0x26, 1, 0x7FB), /* Monaco */ + COUNTRY_CHPLAN_ENT("MD", 0x26, 1, 0x7F1), /* Moldova */ + COUNTRY_CHPLAN_ENT("ME", 0x26, 1, 0x7F1), /* Montenegro */ + COUNTRY_CHPLAN_ENT("MF", 0x76, 1, 0x000), /* Saint Martin */ + COUNTRY_CHPLAN_ENT("MG", 0x26, 1, 0x620), /* Madagascar */ + COUNTRY_CHPLAN_ENT("MH", 0x76, 1, 0x000), /* Marshall Islands (USA) */ + COUNTRY_CHPLAN_ENT("MK", 0x26, 1, 0x7F1), /* Republic of Macedonia (FYROM) */ + COUNTRY_CHPLAN_ENT("ML", 0x26, 1, 0x6B0), /* Mali */ + COUNTRY_CHPLAN_ENT("MM", 0x26, 1, 0x000), /* Burma (Myanmar) */ + COUNTRY_CHPLAN_ENT("MN", 0x26, 1, 0x000), /* Mongolia */ + COUNTRY_CHPLAN_ENT("MO", 0x35, 1, 0x600), /* Macau */ + COUNTRY_CHPLAN_ENT("MP", 0x76, 1, 0x000), /* Northern Mariana Islands (USA) */ + COUNTRY_CHPLAN_ENT("MQ", 0x26, 1, 0x640), /* Martinique (France) */ + COUNTRY_CHPLAN_ENT("MR", 0x26, 1, 0x6A0), /* Mauritania */ + COUNTRY_CHPLAN_ENT("MS", 0x26, 1, 0x000), /* Montserrat (UK) */ + COUNTRY_CHPLAN_ENT("MT", 0x26, 1, 0x7FB), /* Malta */ + COUNTRY_CHPLAN_ENT("MU", 0x26, 1, 0x6B0), /* Mauritius */ + COUNTRY_CHPLAN_ENT("MV", 0x47, 1, 0x000), /* Maldives */ + COUNTRY_CHPLAN_ENT("MW", 0x26, 1, 0x6B0), /* Malawi */ + COUNTRY_CHPLAN_ENT("MX", 0x61, 1, 0x7F1), /* Mexico */ + COUNTRY_CHPLAN_ENT("MY", 0x63, 1, 0x7F1), /* Malaysia */ + COUNTRY_CHPLAN_ENT("MZ", 0x26, 1, 0x7F1), /* Mozambique */ + COUNTRY_CHPLAN_ENT("NA", 0x26, 1, 0x700), /* Namibia */ + COUNTRY_CHPLAN_ENT("NC", 0x26, 1, 0x000), /* New Caledonia */ + COUNTRY_CHPLAN_ENT("NE", 0x26, 1, 0x6B0), /* Niger */ + COUNTRY_CHPLAN_ENT("NF", 0x45, 1, 0x000), /* Norfolk Island (Australia) */ + COUNTRY_CHPLAN_ENT("NG", 0x75, 1, 0x7F9), /* Nigeria */ + COUNTRY_CHPLAN_ENT("NI", 0x76, 1, 0x7F1), /* Nicaragua */ + COUNTRY_CHPLAN_ENT("NL", 0x26, 1, 0x7FB), /* Netherlands */ + COUNTRY_CHPLAN_ENT("NO", 0x26, 1, 0x7FB), /* Norway */ + COUNTRY_CHPLAN_ENT("NP", 0x48, 1, 0x6F0), /* Nepal */ + COUNTRY_CHPLAN_ENT("NR", 0x26, 1, 0x000), /* Nauru */ + COUNTRY_CHPLAN_ENT("NU", 0x45, 1, 0x000), /* Niue */ + COUNTRY_CHPLAN_ENT("NZ", 0x45, 1, 0x7FB), /* New Zealand */ + COUNTRY_CHPLAN_ENT("OM", 0x26, 1, 0x7F9), /* Oman */ + COUNTRY_CHPLAN_ENT("PA", 0x76, 1, 0x7F1), /* Panama */ + COUNTRY_CHPLAN_ENT("PE", 0x76, 1, 0x7F1), /* Peru */ + COUNTRY_CHPLAN_ENT("PF", 0x26, 1, 0x000), /* French Polynesia (France) */ + COUNTRY_CHPLAN_ENT("PG", 0x35, 1, 0x7F1), /* Papua New Guinea */ + COUNTRY_CHPLAN_ENT("PH", 0x35, 1, 0x7F1), /* Philippines */ + COUNTRY_CHPLAN_ENT("PK", 0x51, 1, 0x7F1), /* Pakistan */ + COUNTRY_CHPLAN_ENT("PL", 0x26, 1, 0x7FB), /* Poland */ + COUNTRY_CHPLAN_ENT("PM", 0x26, 1, 0x000), /* Saint Pierre and Miquelon (France) */ + COUNTRY_CHPLAN_ENT("PR", 0x76, 1, 0x7F1), /* Puerto Rico */ + COUNTRY_CHPLAN_ENT("PT", 0x26, 1, 0x7FB), /* Portugal */ + COUNTRY_CHPLAN_ENT("PW", 0x76, 1, 0x000), /* Palau */ + COUNTRY_CHPLAN_ENT("PY", 0x76, 1, 0x7F1), /* Paraguay */ + COUNTRY_CHPLAN_ENT("QA", 0x35, 1, 0x7F9), /* Qatar */ + COUNTRY_CHPLAN_ENT("RE", 0x26, 1, 0x000), /* Reunion (France) */ + COUNTRY_CHPLAN_ENT("RO", 0x26, 1, 0x7F1), /* Romania */ + COUNTRY_CHPLAN_ENT("RS", 0x26, 1, 0x7F1), /* Serbia, Kosovo */ + COUNTRY_CHPLAN_ENT("RU", 0x59, 1, 0x7FB), /* Russia(fac/gost), Kaliningrad */ + COUNTRY_CHPLAN_ENT("RW", 0x26, 1, 0x0B0), /* Rwanda */ + COUNTRY_CHPLAN_ENT("SA", 0x35, 1, 0x7FB), /* Saudi Arabia */ + COUNTRY_CHPLAN_ENT("SB", 0x26, 1, 0x000), /* Solomon Islands */ + COUNTRY_CHPLAN_ENT("SC", 0x76, 1, 0x690), /* Seychelles */ + COUNTRY_CHPLAN_ENT("SE", 0x26, 1, 0x7FB), /* Sweden */ + COUNTRY_CHPLAN_ENT("SG", 0x35, 1, 0x7FB), /* Singapore */ + COUNTRY_CHPLAN_ENT("SH", 0x26, 1, 0x000), /* Saint Helena (UK) */ + COUNTRY_CHPLAN_ENT("SI", 0x26, 1, 0x7FB), /* Slovenia */ + COUNTRY_CHPLAN_ENT("SJ", 0x26, 1, 0x000), /* Svalbard (Norway) */ + COUNTRY_CHPLAN_ENT("SK", 0x26, 1, 0x7FB), /* Slovakia */ + COUNTRY_CHPLAN_ENT("SL", 0x26, 1, 0x6B0), /* Sierra Leone */ + COUNTRY_CHPLAN_ENT("SM", 0x26, 1, 0x000), /* San Marino */ + COUNTRY_CHPLAN_ENT("SN", 0x26, 1, 0x7F1), /* Senegal */ + COUNTRY_CHPLAN_ENT("SO", 0x26, 1, 0x000), /* Somalia */ + COUNTRY_CHPLAN_ENT("SR", 0x74, 1, 0x000), /* Suriname */ + COUNTRY_CHPLAN_ENT("ST", 0x76, 1, 0x680), /* Sao Tome and Principe */ + COUNTRY_CHPLAN_ENT("SV", 0x30, 1, 0x7F1), /* El Salvador */ + COUNTRY_CHPLAN_ENT("SX", 0x76, 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, 0x6B0), /* Chad */ + COUNTRY_CHPLAN_ENT("TF", 0x26, 1, 0x680), /* French Southern and Antarctic Lands (FR Southern Territories) */ + COUNTRY_CHPLAN_ENT("TG", 0x26, 1, 0x6B0), /* Togo */ + COUNTRY_CHPLAN_ENT("TH", 0x35, 1, 0x7F1), /* Thailand */ + COUNTRY_CHPLAN_ENT("TJ", 0x26, 1, 0x640), /* Tajikistan */ + COUNTRY_CHPLAN_ENT("TK", 0x45, 1, 0x000), /* Tokelau */ + COUNTRY_CHPLAN_ENT("TM", 0x26, 1, 0x000), /* Turkmenistan */ + COUNTRY_CHPLAN_ENT("TN", 0x47, 1, 0x7F1), /* Tunisia */ + COUNTRY_CHPLAN_ENT("TO", 0x26, 1, 0x000), /* Tonga */ + COUNTRY_CHPLAN_ENT("TR", 0x26, 1, 0x7F1), /* Turkey, Northern Cyprus */ + COUNTRY_CHPLAN_ENT("TT", 0x76, 1, 0x3F1), /* Trinidad & Tobago */ + COUNTRY_CHPLAN_ENT("TV", 0x21, 0, 0x000), /* Tuvalu */ + COUNTRY_CHPLAN_ENT("TW", 0x76, 1, 0x7FF), /* Taiwan */ + COUNTRY_CHPLAN_ENT("TZ", 0x26, 1, 0x6F0), /* Tanzania */ + COUNTRY_CHPLAN_ENT("UA", 0x36, 1, 0x7FB), /* Ukraine */ + COUNTRY_CHPLAN_ENT("UG", 0x26, 1, 0x6F1), /* Uganda */ + COUNTRY_CHPLAN_ENT("US", 0x76, 1, 0x7FF), /* United States of America (USA) */ + COUNTRY_CHPLAN_ENT("UY", 0x30, 1, 0x7F1), /* Uruguay */ + COUNTRY_CHPLAN_ENT("UZ", 0x47, 1, 0x6F0), /* Uzbekistan */ + COUNTRY_CHPLAN_ENT("VA", 0x26, 1, 0x000), /* Holy See (Vatican City) */ + COUNTRY_CHPLAN_ENT("VC", 0x76, 1, 0x010), /* Saint Vincent and the Grenadines */ + COUNTRY_CHPLAN_ENT("VE", 0x30, 1, 0x7F1), /* Venezuela */ + COUNTRY_CHPLAN_ENT("VG", 0x76, 1, 0x000), /* British Virgin Islands (UK) */ + COUNTRY_CHPLAN_ENT("VI", 0x76, 1, 0x000), /* United States Virgin Islands (USA) */ + COUNTRY_CHPLAN_ENT("VN", 0x35, 1, 0x7F1), /* Vietnam */ + COUNTRY_CHPLAN_ENT("VU", 0x26, 1, 0x000), /* Vanuatu */ + COUNTRY_CHPLAN_ENT("WF", 0x26, 1, 0x000), /* Wallis and Futuna (France) */ + COUNTRY_CHPLAN_ENT("WS", 0x76, 1, 0x000), /* Samoa */ + COUNTRY_CHPLAN_ENT("YE", 0x26, 1, 0x040), /* Yemen */ + COUNTRY_CHPLAN_ENT("YT", 0x26, 1, 0x680), /* Mayotte (France) */ + COUNTRY_CHPLAN_ENT("ZA", 0x35, 1, 0x7F1), /* South Africa */ + COUNTRY_CHPLAN_ENT("ZM", 0x26, 1, 0x6B0), /* Zambia */ + COUNTRY_CHPLAN_ENT("ZW", 0x26, 1, 0x7F1), /* Zimbabwe */ +}; + +/* +* rtw_get_chplan_from_country - +* @country_code: string of country code +* +* Return pointer of struct country_chplan entry or NULL when unsupported country_code is given +*/ +const struct country_chplan *rtw_get_chplan_from_country(const char *country_code) +{ +#if RTW_DEF_MODULE_REGULATORY_CERT + const struct country_chplan *exc_ent = NULL; +#endif + const struct country_chplan *ent = NULL; + const struct country_chplan *map = NULL; + u16 map_sz = 0; + char code[2]; + int i; + + code[0] = alpha_to_upper(country_code[0]); + code[1] = alpha_to_upper(country_code[1]); + +#ifdef CONFIG_CUSTOMIZED_COUNTRY_CHPLAN_MAP + map = CUSTOMIZED_country_chplan_map; + map_sz = sizeof(CUSTOMIZED_country_chplan_map) / sizeof(struct country_chplan); +#else + #if RTW_DEF_MODULE_REGULATORY_CERT + exc_ent = rtw_def_module_get_chplan_from_country(code); + #endif + map = country_chplan_map; + map_sz = sizeof(country_chplan_map) / sizeof(struct country_chplan); +#endif + + for (i = 0; i < map_sz; i++) { + if (strncmp(code, map[i].alpha2, 2) == 0) { + ent = &map[i]; + break; + } + } + + #if RTW_DEF_MODULE_REGULATORY_CERT + if (!ent || !(COUNTRY_CHPLAN_DEF_MODULE_FALGS(ent) & RTW_DEF_MODULE_REGULATORY_CERT)) + exc_ent = ent = NULL; + if (exc_ent) + ent = exc_ent; + #endif + + return ent; +} + +void dump_country_chplan(void *sel, const struct country_chplan *ent) +{ + RTW_PRINT_SEL(sel, "\"%c%c\", 0x%02X%s\n" + , ent->alpha2[0], ent->alpha2[1], ent->chplan + , COUNTRY_CHPLAN_EN_11AC(ent) ? " ac" : "" + ); +} + +void dump_country_chplan_map(void *sel) +{ + const struct country_chplan *ent; + u8 code[2]; + +#if RTW_DEF_MODULE_REGULATORY_CERT + RTW_PRINT_SEL(sel, "RTW_DEF_MODULE_REGULATORY_CERT:0x%x\n", RTW_DEF_MODULE_REGULATORY_CERT); +#endif +#ifdef CONFIG_CUSTOMIZED_COUNTRY_CHPLAN_MAP + RTW_PRINT_SEL(sel, "CONFIG_CUSTOMIZED_COUNTRY_CHPLAN_MAP\n"); +#endif + + for (code[0] = 'A'; code[0] <= 'Z'; code[0]++) { + for (code[1] = 'A'; code[1] <= 'Z'; code[1]++) { + ent = rtw_get_chplan_from_country(code); + if (!ent) + continue; + + dump_country_chplan(sel, ent); + } + } +} + +void dump_chplan_id_list(void *sel) +{ + u8 first = 1; + int i; + + for (i = 0; i < RTW_CHPLAN_MAX; i++) { + if (!rtw_is_channel_plan_valid(i)) + continue; + + if (first) { + RTW_PRINT_SEL(sel, "0x%02X ", i); + first = 0; + } else + _RTW_PRINT_SEL(sel, "0x%02X ", i); + } + + _RTW_PRINT_SEL(sel, "0x7F\n"); +} + +void dump_chplan_test(void *sel) +{ + int i, j; + + /* check invalid channel */ + for (i = 0; i < RTW_RD_2G_MAX; i++) { + for (j = 0; j < CH_LIST_LEN(RTW_ChannelPlan2G[i]); j++) { + if (rtw_ch2freq(CH_LIST_CH(RTW_ChannelPlan2G[i], j)) == 0) + RTW_PRINT_SEL(sel, "invalid ch:%u at (%d,%d)\n", CH_LIST_CH(RTW_ChannelPlan2G[i], j), i, j); + } + } + +#ifdef CONFIG_IEEE80211_BAND_5GHZ + for (i = 0; i < RTW_RD_5G_MAX; i++) { + for (j = 0; j < CH_LIST_LEN(RTW_ChannelPlan5G[i]); j++) { + if (rtw_ch2freq(CH_LIST_CH(RTW_ChannelPlan5G[i], j)) == 0) + RTW_PRINT_SEL(sel, "invalid ch:%u at (%d,%d)\n", CH_LIST_CH(RTW_ChannelPlan5G[i], j), i, j); + } + } +#endif +} + +void dump_chplan_ver(void *sel) +{ + RTW_PRINT_SEL(sel, "%s-%s\n", RTW_DOMAIN_MAP_VER, RTW_COUNTRY_MAP_VER); +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_chplan.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_chplan.h new file mode 100644 index 000000000000..ba201b971f84 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_chplan.h @@ -0,0 +1,184 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2018 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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_CHPLAN_H__ +#define __RTW_CHPLAN_H__ + +enum rtw_chplan_id { + /* ===== 0x00 ~ 0x1F, legacy channel plan ===== */ + RTW_CHPLAN_FCC = 0x00, + RTW_CHPLAN_IC = 0x01, + RTW_CHPLAN_ETSI = 0x02, + RTW_CHPLAN_SPAIN = 0x03, + RTW_CHPLAN_FRANCE = 0x04, + RTW_CHPLAN_MKK = 0x05, + RTW_CHPLAN_MKK1 = 0x06, + RTW_CHPLAN_ISRAEL = 0x07, + RTW_CHPLAN_TELEC = 0x08, + RTW_CHPLAN_GLOBAL_DOAMIN = 0x09, + RTW_CHPLAN_WORLD_WIDE_13 = 0x0A, + RTW_CHPLAN_TAIWAN = 0x0B, + RTW_CHPLAN_CHINA = 0x0C, + RTW_CHPLAN_SINGAPORE_INDIA_MEXICO = 0x0D, + RTW_CHPLAN_KOREA = 0x0E, + RTW_CHPLAN_TURKEY = 0x0F, + RTW_CHPLAN_JAPAN = 0x10, + RTW_CHPLAN_FCC_NO_DFS = 0x11, + RTW_CHPLAN_JAPAN_NO_DFS = 0x12, + RTW_CHPLAN_WORLD_WIDE_5G = 0x13, + RTW_CHPLAN_TAIWAN_NO_DFS = 0x14, + + /* ===== 0x20 ~ 0x7F, new channel plan ===== */ + RTW_CHPLAN_WORLD_NULL = 0x20, + RTW_CHPLAN_ETSI1_NULL = 0x21, + RTW_CHPLAN_FCC1_NULL = 0x22, + RTW_CHPLAN_MKK1_NULL = 0x23, + RTW_CHPLAN_ETSI2_NULL = 0x24, + RTW_CHPLAN_FCC1_FCC1 = 0x25, + RTW_CHPLAN_WORLD_ETSI1 = 0x26, + RTW_CHPLAN_MKK1_MKK1 = 0x27, + RTW_CHPLAN_WORLD_KCC1 = 0x28, + RTW_CHPLAN_WORLD_FCC2 = 0x29, + RTW_CHPLAN_FCC2_NULL = 0x2A, + RTW_CHPLAN_IC1_IC2 = 0x2B, + RTW_CHPLAN_MKK2_NULL = 0x2C, + RTW_CHPLAN_WORLD_CHILE1= 0x2D, + RTW_CHPLAN_WORLD1_WORLD1 = 0x2E, + RTW_CHPLAN_WORLD_CHILE2 = 0x2F, + RTW_CHPLAN_WORLD_FCC3 = 0x30, + RTW_CHPLAN_WORLD_FCC4 = 0x31, + RTW_CHPLAN_WORLD_FCC5 = 0x32, + RTW_CHPLAN_WORLD_FCC6 = 0x33, + RTW_CHPLAN_FCC1_FCC7 = 0x34, + RTW_CHPLAN_WORLD_ETSI2 = 0x35, + RTW_CHPLAN_WORLD_ETSI3 = 0x36, + RTW_CHPLAN_MKK1_MKK2 = 0x37, + RTW_CHPLAN_MKK1_MKK3 = 0x38, + RTW_CHPLAN_FCC1_NCC1 = 0x39, + RTW_CHPLAN_ETSI1_ETSI1 = 0x3A, + RTW_CHPLAN_ETSI1_ACMA1 = 0x3B, + RTW_CHPLAN_ETSI1_ETSI6 = 0x3C, + RTW_CHPLAN_ETSI1_ETSI12 = 0x3D, + RTW_CHPLAN_KCC1_KCC2 = 0x3E, + RTW_CHPLAN_FCC1_FCC11 = 0x3F, + RTW_CHPLAN_FCC1_NCC2 = 0x40, + RTW_CHPLAN_GLOBAL_NULL = 0x41, + RTW_CHPLAN_ETSI1_ETSI4 = 0x42, + RTW_CHPLAN_FCC1_FCC2 = 0x43, + RTW_CHPLAN_FCC1_NCC3 = 0x44, + RTW_CHPLAN_WORLD_ACMA1 = 0x45, + RTW_CHPLAN_FCC1_FCC8 = 0x46, + RTW_CHPLAN_WORLD_ETSI6 = 0x47, + RTW_CHPLAN_WORLD_ETSI7 = 0x48, + RTW_CHPLAN_WORLD_ETSI8 = 0x49, + RTW_CHPLAN_IC2_IC2 = 0x4A, + RTW_CHPLAN_KCC1_KCC3 = 0x4B, + RTW_CHPLAN_FCC1_FCC15 = 0x4C, + RTW_CHPLAN_WORLD_ETSI9 = 0x50, + RTW_CHPLAN_WORLD_ETSI10 = 0x51, + RTW_CHPLAN_WORLD_ETSI11 = 0x52, + RTW_CHPLAN_FCC1_NCC4 = 0x53, + RTW_CHPLAN_WORLD_ETSI12 = 0x54, + RTW_CHPLAN_FCC1_FCC9 = 0x55, + RTW_CHPLAN_WORLD_ETSI13 = 0x56, + RTW_CHPLAN_FCC1_FCC10 = 0x57, + RTW_CHPLAN_MKK2_MKK4 = 0x58, + RTW_CHPLAN_WORLD_ETSI14 = 0x59, + 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, +}; + +u8 rtw_chplan_get_default_regd(u8 id); +bool rtw_chplan_is_empty(u8 id); +#define rtw_is_channel_plan_valid(chplan) (((chplan) < RTW_CHPLAN_MAX || (chplan) == RTW_CHPLAN_REALTEK_DEFINE) && !rtw_chplan_is_empty(chplan)) +#define rtw_is_legacy_channel_plan(chplan) ((chplan) < 0x20) + +struct _RT_CHANNEL_INFO; +u8 init_channel_set(_adapter *padapter, u8 ChannelPlan, struct _RT_CHANNEL_INFO *channel_set); + +#define IS_ALPHA2_NO_SPECIFIED(_alpha2) ((*((u16 *)(_alpha2))) == 0xFFFF) + +#define RTW_MODULE_RTL8821AE_HMC_M2 BIT0 /* RTL8821AE(HMC + M.2) */ +#define RTW_MODULE_RTL8821AU BIT1 /* RTL8821AU */ +#define RTW_MODULE_RTL8812AENF_NGFF BIT2 /* RTL8812AENF(8812AE+8761)_NGFF */ +#define RTW_MODULE_RTL8812AEBT_HMC BIT3 /* RTL8812AEBT(8812AE+8761)_HMC */ +#define RTW_MODULE_RTL8188EE_HMC_M2 BIT4 /* RTL8188EE(HMC + M.2) */ +#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 RTW_MODULE_RTL8821CE BIT10 /* RTL8821CE */ + +struct country_chplan { + char alpha2[2]; + u8 chplan; +#ifdef CONFIG_80211AC_VHT + u8 en_11ac; +#endif +#if RTW_DEF_MODULE_REGULATORY_CERT + u16 def_module_flags; /* RTW_MODULE_RTLXXX */ +#endif +}; + +#ifdef CONFIG_80211AC_VHT +#define COUNTRY_CHPLAN_EN_11AC(_ent) ((_ent)->en_11ac) +#else +#define COUNTRY_CHPLAN_EN_11AC(_ent) 0 +#endif + +#if RTW_DEF_MODULE_REGULATORY_CERT +#define COUNTRY_CHPLAN_DEF_MODULE_FALGS(_ent) ((_ent)->def_module_flags) +#else +#define COUNTRY_CHPLAN_DEF_MODULE_FALGS(_ent) 0 +#endif + +const struct country_chplan *rtw_get_chplan_from_country(const char *country_code); + +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); +void dump_chplan_test(void *sel); +void dump_chplan_ver(void *sel); + +#endif /* __RTW_CHPLAN_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_cmd.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_cmd.c index bb2bcf83779c..a98076b32200 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_cmd.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_cmd.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +34,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 +146,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) { @@ -171,15 +165,6 @@ sint _rtw_init_evt_priv(struct evt_priv *pevtpriv) pevtpriv->c2h_mem = pevtpriv->allocated_c2h_mem + 4\ - ((u32)(pevtpriv->allocated_c2h_mem) & 3); -#ifdef PLATFORM_OS_XP - pevtpriv->pc2h_mdl = IoAllocateMdl((u8 *)pevtpriv->c2h_mem, C2H_MEM_SZ , FALSE, FALSE, NULL); - - if (pevtpriv->pc2h_mdl == NULL) { - res = _FAIL; - goto exit; - } - MmBuildMdlForNonPagedPool(pevtpriv->pc2h_mdl); -#endif #endif /* end of CONFIG_SDIO_HCI */ _rtw_init_queue(&(pevtpriv->evt_queue)); @@ -204,8 +189,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 +219,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); @@ -461,7 +444,7 @@ u32 rtw_enqueue_cmd(struct cmd_priv *pcmdpriv, struct cmd_obj *cmd_obj) #ifdef CONFIG_CONCURRENT_MODE /* change pcmdpriv to primary's pcmdpriv */ - if (padapter->adapter_type != PRIMARY_ADAPTER) + if (!is_primary_adapter(padapter)) pcmdpriv = &(GET_PRIMARY_ADAPTER(padapter)->cmdpriv); #endif @@ -511,8 +494,6 @@ void rtw_cmd_clr_isr(struct cmd_priv *pcmdpriv) void rtw_free_cmd_obj(struct cmd_obj *pcmd) { - struct drvextra_cmd_parm *extra_parm = NULL; - if (pcmd->parmbuf != NULL) { /* free parmbuf in cmd_obj */ rtw_mfree((unsigned char *)pcmd->parmbuf, pcmd->cmdsz); @@ -526,18 +507,15 @@ void rtw_free_cmd_obj(struct cmd_obj *pcmd) /* free cmd_obj */ rtw_mfree((unsigned char *)pcmd, sizeof(struct cmd_obj)); - } 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 +524,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 +537,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 +548,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; } @@ -640,6 +610,10 @@ thread_return rtw_cmd_thread(thread_context context) if (extra_parm && extra_parm->pbuf && extra_parm->size > 0) rtw_mfree(extra_parm->pbuf, extra_parm->size); } + #ifdef CONFIG_DFS + else if (pcmd->cmdcode == GEN_CMD_CODE(_SetChannelSwitch)) + adapter_to_rfctl(padapter)->csa_ch = 0; + #endif goto post_process; } @@ -681,8 +655,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 @@ -737,15 +710,27 @@ thread_return rtw_cmd_thread(thread_context context) if (extra_parm->pbuf && extra_parm->size > 0) rtw_mfree(extra_parm->pbuf, extra_parm->size); } + #ifdef CONFIG_DFS + else if (pcmd->cmdcode == GEN_CMD_CODE(_SetChannelSwitch)) + adapter_to_rfctl(padapter)->csa_ch = 0; + #endif + + _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,27 +839,31 @@ 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; struct sitesurvey_parm *psurveyPara; struct cmd_priv *pcmdpriv = &padapter->cmdpriv; struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -#ifdef CONFIG_P2P - 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); + rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_SCAN, 0); #endif #ifdef CONFIG_P2P_PS @@ -892,60 +881,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 (is_supported_5g(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 @@ -1258,17 +1212,16 @@ void rtw_readtssi_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd) } static u8 rtw_createbss_cmd(_adapter *adapter, int flags, bool adhoc - , s16 req_ch, s8 req_bw, s8 req_offset) + , u8 ifbmp, u8 excl_ifbmp, s16 req_ch, s8 req_bw, s8 req_offset) { struct cmd_obj *cmdobj; struct createbss_parm *parm; struct cmd_priv *pcmdpriv = &adapter->cmdpriv; - struct mlme_priv *pmlmepriv = &adapter->mlmepriv; struct submit_ctx sctx; 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; } @@ -1286,6 +1239,8 @@ static u8 rtw_createbss_cmd(_adapter *adapter, int flags, bool adhoc parm->adhoc = 1; } else { parm->adhoc = 0; + parm->ifbmp = ifbmp; + parm->excl_ifbmp = excl_ifbmp; parm->req_ch = req_ch; parm->req_bw = req_bw; parm->req_offset = req_offset; @@ -1331,7 +1286,8 @@ inline u8 rtw_create_ibss_cmd(_adapter *adapter, int flags) { return rtw_createbss_cmd(adapter, flags , 1 - , 0, -1, -1 /* for now, adhoc doesn't support ch,bw,offset request */ + , 0, 0 + , 0, REQ_BW_NONE, REQ_OFFSET_NONE /* for now, adhoc doesn't support ch,bw,offset request */ ); } @@ -1339,18 +1295,57 @@ inline u8 rtw_startbss_cmd(_adapter *adapter, int flags) { return rtw_createbss_cmd(adapter, flags , 0 - , 0, -1, -1 /* excute entire AP setup cmd */ + , BIT(adapter->iface_id), 0 + , 0, REQ_BW_NONE, REQ_OFFSET_NONE /* excute entire AP setup cmd */ ); } -inline u8 rtw_change_bss_chbw_cmd(_adapter *adapter, int flags, s16 req_ch, s8 req_bw, s8 req_offset) +inline u8 rtw_change_bss_chbw_cmd(_adapter *adapter, int flags + , u8 ifbmp, u8 excl_ifbmp, s16 req_ch, s8 req_bw, s8 req_offset) { return rtw_createbss_cmd(adapter, flags , 0 + , ifbmp, excl_ifbmp , req_ch, req_bw, req_offset ); } +#ifdef CONFIG_RTW_80211R +static void rtw_ft_validate_akm_type(_adapter *padapter, + struct wlan_network *pnetwork) +{ + struct security_priv *psecuritypriv = &(padapter->securitypriv); + struct ft_roam_info *pft_roam = &(padapter->mlmepriv.ft_roam); + u32 tmp_len; + u8 *ptmp; + + /*IEEE802.11-2012 Std. Table 8-101-AKM suite selectors*/ + if (rtw_ft_valid_akm(padapter, psecuritypriv->rsn_akm_suite_type)) { + ptmp = rtw_get_ie(&pnetwork->network.IEs[12], + _MDIE_, &tmp_len, (pnetwork->network.IELength-12)); + if (ptmp) { + pft_roam->mdid = *(u16 *)(ptmp+2); + pft_roam->ft_cap = *(ptmp+4); + + RTW_INFO("FT: target " MAC_FMT " mdid=(0x%2x), capacity=(0x%2x)\n", + MAC_ARG(pnetwork->network.MacAddress), pft_roam->mdid, pft_roam->ft_cap); + rtw_ft_set_flags(padapter, RTW_FT_PEER_EN); + + if (rtw_ft_otd_roam_en(padapter)) + rtw_ft_set_flags(padapter, RTW_FT_PEER_OTD_EN); + } else { + /* Don't use FT roaming if target AP cannot support FT */ + rtw_ft_clr_flags(padapter, (RTW_FT_PEER_EN|RTW_FT_PEER_OTD_EN)); + rtw_ft_reset_status(padapter); + } + } else { + /* It could be a non-FT connection */ + rtw_ft_clr_flags(padapter, (RTW_FT_PEER_EN|RTW_FT_PEER_OTD_EN)); + rtw_ft_reset_status(padapter); + } +} +#endif + u8 rtw_joinbss_cmd(_adapter *padapter, struct wlan_network *pnetwork) { u8 *auth, res = _SUCCESS; @@ -1371,11 +1366,9 @@ 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 - struct _ft_priv *pftpriv = &pmlmepriv->ftpriv; -#endif rtw_led_control(padapter, LED_CTL_START_TO_LINK); @@ -1386,12 +1379,12 @@ u8 rtw_joinbss_cmd(_adapter *padapter, struct wlan_network *pnetwork) } #if 0 /* for IEs is pointer */ - t_len = sizeof(ULONG) + sizeof(NDIS_802_11_MAC_ADDRESS) + 2 + - sizeof(NDIS_802_11_SSID) + sizeof(ULONG) + + t_len = sizeof(u32) + sizeof(NDIS_802_11_MAC_ADDRESS) + 2 + + sizeof(NDIS_802_11_SSID) + sizeof(u32) + sizeof(NDIS_802_11_RSSI) + sizeof(NDIS_802_11_NETWORK_TYPE) + sizeof(NDIS_802_11_CONFIGURATION) + sizeof(NDIS_802_11_NETWORK_INFRASTRUCTURE) + - sizeof(NDIS_802_11_RATES_EX) + sizeof(WLAN_PHY_INFO) + sizeof(ULONG) + MAX_IE_SZ; + sizeof(NDIS_802_11_RATES_EX) + sizeof(WLAN_PHY_INFO) + sizeof(u32) + MAX_IE_SZ; #endif /* for IEs is fix buf size */ t_len = sizeof(WLAN_BSSID_EX); @@ -1408,17 +1401,21 @@ 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; - } } pmlmeinfo->assoc_AP_vendor = check_assoc_AP(pnetwork->network.IEs, pnetwork->network.IELength); +#ifdef CONFIG_80211AC_VHT + /* save AP beamform_cap info for BCM IOT issue */ + if (pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_BROADCOM) + pvhtpriv->ap_is_mu_bfer = + get_vht_mu_bfer_cap(pnetwork->network.IEs, + pnetwork->network.IELength); +#endif /* Modified by Arvin 2015/05/13 Solution for allocating a new WLAN_BSSID_EX to avoid race condition issue between disconnect and joinbss @@ -1455,12 +1452,19 @@ u8 rtw_joinbss_cmd(_adapter *padapter, struct wlan_network *pnetwork) if (pmlmepriv->assoc_by_bssid == _FALSE) _rtw_memcpy(&pmlmepriv->assoc_bssid[0], &pnetwork->network.MacAddress[0], ETH_ALEN); - psecnetwork->IELength = rtw_restruct_sec_ie(padapter, &pnetwork->network.IEs[0], &psecnetwork->IEs[0], pnetwork->network.IELength); + /* copy fixed ie */ + _rtw_memcpy(psecnetwork->IEs, pnetwork->network.IEs, 12); + psecnetwork->IELength = 12; + + psecnetwork->IELength += rtw_restruct_sec_ie(padapter, psecnetwork->IEs + psecnetwork->IELength); 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) { @@ -1473,67 +1477,42 @@ u8 rtw_joinbss_cmd(_adapter *padapter, struct wlan_network *pnetwork) #ifdef CONFIG_80211N_HT phtpriv->ht_option = _FALSE; - ptmp = rtw_get_ie(&pnetwork->network.IEs[12], _HT_CAPABILITY_IE_, &tmp_len, pnetwork->network.IELength - 12); - if (pregistrypriv->ht_enable && ptmp && tmp_len > 0) { - /* Added by Albert 2010/06/23 */ - /* For the WEP mode, we will use the bg mode to do the connection to avoid some IOT issue. */ - /* Especially for Realtek 8192u SoftAP. */ - if ((padapter->securitypriv.dot11PrivacyAlgrthm != _WEP40_) && - (padapter->securitypriv.dot11PrivacyAlgrthm != _WEP104_) && - (padapter->securitypriv.dot11PrivacyAlgrthm != _TKIP_)) { - rtw_ht_use_default_setting(padapter); + if (pregistrypriv->ht_enable && is_supported_ht(pregistrypriv->wireless_mode)) { + ptmp = rtw_get_ie(&pnetwork->network.IEs[12], _HT_CAPABILITY_IE_, &tmp_len, pnetwork->network.IELength - 12); + if (ptmp && tmp_len > 0) { + /* Added by Albert 2010/06/23 */ + /* For the WEP mode, we will use the bg mode to do the connection to avoid some IOT issue. */ + /* Especially for Realtek 8192u SoftAP. */ + if ((padapter->securitypriv.dot11PrivacyAlgrthm != _WEP40_) && + (padapter->securitypriv.dot11PrivacyAlgrthm != _WEP104_) && + (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, - pnetwork->network.Configuration.DSConfig); + /* rtw_restructure_ht_ie */ + rtw_restructure_ht_ie(padapter, &pnetwork->network.IEs[12], &psecnetwork->IEs[0], + pnetwork->network.IELength - 12, &psecnetwork->IELength, + pnetwork->network.Configuration.DSConfig); + } } } #ifdef CONFIG_80211AC_VHT pvhtpriv->vht_option = _FALSE; 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)) - ) { + && REGSTY_IS_11AC_ENABLE(pregistrypriv) + && is_supported_vht(pregistrypriv->wireless_mode) + && (!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); } #endif +#endif /* CONFIG_80211N_HT */ rtw_append_exented_cap(padapter, &psecnetwork->IEs[0], &psecnetwork->IELength); -#endif /* CONFIG_80211N_HT */ - #ifdef CONFIG_RTW_80211R - /*IEEE802.11-2012 Std. Table 8-101¡XAKM suite selectors*/ - if ((rtw_chk_ft_flags(padapter, RTW_FT_STA_SUPPORTED)) && - ((psecuritypriv->rsn_akm_suite_type == 3) || (psecuritypriv->rsn_akm_suite_type == 4)) - ) { - ptmp = rtw_get_ie(&pnetwork->network.IEs[12], _MDIE_, &tmp_len, pnetwork->network.IELength-12); - if (ptmp) { - _rtw_memcpy(&pftpriv->mdid, ptmp+2, 2); - pftpriv->ft_cap = *(ptmp+4); - - RTW_INFO("FT: Target AP "MAC_FMT" MDID=(0x%2x), capacity=(0x%2x)\n", MAC_ARG(pnetwork->network.MacAddress), pftpriv->mdid, pftpriv->ft_cap); - rtw_set_ft_flags(padapter, RTW_FT_SUPPORTED); - if ((rtw_chk_ft_flags(padapter, RTW_FT_STA_OVER_DS_SUPPORTED)) && (pftpriv->ft_roam_on_expired == _FALSE) && (pftpriv->ft_cap & 0x01)) - rtw_set_ft_flags(padapter, RTW_FT_OVER_DS_SUPPORTED); - } else { - /*Don't use FT roaming if Target AP cannot support FT*/ - RTW_INFO("FT: Target AP "MAC_FMT" could not support FT\n", MAC_ARG(pnetwork->network.MacAddress)); - rtw_clr_ft_flags(padapter, RTW_FT_SUPPORTED|RTW_FT_OVER_DS_SUPPORTED); - rtw_reset_ft_status(padapter); - } - } else { - /*It could be a non-FT connection*/ - RTW_INFO("FT: non-FT rtw_joinbss_cmd\n"); - rtw_clr_ft_flags(padapter, RTW_FT_SUPPORTED|RTW_FT_OVER_DS_SUPPORTED); - rtw_reset_ft_status(padapter); - } + rtw_ft_validate_akm_type(padapter, pnetwork); #endif #if 0 @@ -1547,25 +1526,6 @@ u8 rtw_joinbss_cmd(_adapter *padapter, struct wlan_network *pnetwork) pcmd->cmdsz = sizeof(WLAN_BSSID_EX); -#ifdef CONFIG_RTL8712 - /* wlan_network endian conversion */ - psecnetwork->Length = cpu_to_le32(psecnetwork->Length); - psecnetwork->Ssid.SsidLength = cpu_to_le32(psecnetwork->Ssid.SsidLength); - psecnetwork->Privacy = cpu_to_le32(psecnetwork->Privacy); - psecnetwork->Rssi = cpu_to_le32(psecnetwork->Rssi); - psecnetwork->NetworkTypeInUse = cpu_to_le32(psecnetwork->NetworkTypeInUse); - psecnetwork->Configuration.ATIMWindow = cpu_to_le32(psecnetwork->Configuration.ATIMWindow); - psecnetwork->Configuration.BeaconPeriod = cpu_to_le32(psecnetwork->Configuration.BeaconPeriod); - psecnetwork->Configuration.DSConfig = cpu_to_le32(psecnetwork->Configuration.DSConfig); - psecnetwork->Configuration.FHConfig.DwellTime = cpu_to_le32(psecnetwork->Configuration.FHConfig.DwellTime); - psecnetwork->Configuration.FHConfig.HopPattern = cpu_to_le32(psecnetwork->Configuration.FHConfig.HopPattern); - psecnetwork->Configuration.FHConfig.HopSet = cpu_to_le32(psecnetwork->Configuration.FHConfig.HopSet); - psecnetwork->Configuration.FHConfig.Length = cpu_to_le32(psecnetwork->Configuration.FHConfig.Length); - psecnetwork->Configuration.Length = cpu_to_le32(psecnetwork->Configuration.Length); - psecnetwork->InfrastructureMode = cpu_to_le32(psecnetwork->InfrastructureMode); - psecnetwork->IELength = cpu_to_le32(psecnetwork->IELength); -#endif - _rtw_init_listhead(&pcmd->list); pcmd->cmdcode = _JoinBss_CMD_;/* GEN_CMD_CODE(_JoinBss) */ pcmd->parmbuf = (unsigned char *)psecnetwork; @@ -1580,15 +1540,15 @@ 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; - - /* prepare cmd parameter */ param = (struct disconnect_parm *)rtw_zmalloc(sizeof(*param)); if (param == NULL) { @@ -1597,8 +1557,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 +1571,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: @@ -1620,39 +1591,55 @@ u8 rtw_disassoc_cmd(_adapter *padapter, u32 deauth_timeout_ms, bool enqueue) /* return res; } -u8 rtw_setopmode_cmd(_adapter *padapter, NDIS_802_11_NETWORK_INFRASTRUCTURE networktype, bool enqueue) +u8 rtw_setopmode_cmd(_adapter *adapter, NDIS_802_11_NETWORK_INFRASTRUCTURE networktype, u8 flags) { - struct cmd_obj *ph2c; - struct setopmode_parm *psetop; + struct cmd_obj *cmdobj; + struct setopmode_parm *parm; + struct cmd_priv *pcmdpriv = &adapter->cmdpriv; + struct submit_ctx sctx; + u8 res = _SUCCESS; - struct cmd_priv *pcmdpriv = &padapter->cmdpriv; - u8 res = _SUCCESS; - - psetop = (struct setopmode_parm *)rtw_zmalloc(sizeof(struct setopmode_parm)); - - if (psetop == NULL) { + /* prepare cmd parameter */ + parm = (struct setopmode_parm *)rtw_zmalloc(sizeof(*parm)); + if (parm == NULL) { res = _FAIL; goto exit; } - psetop->mode = (u8)networktype; + parm->mode = (u8)networktype; - if (enqueue) { - ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); - if (ph2c == NULL) { - rtw_mfree((u8 *)psetop, sizeof(*psetop)); + if (flags & RTW_CMDF_DIRECTLY) { + /* no need to enqueue, do the cmd hdl directly and free cmd parameter */ + if (H2C_SUCCESS != setopmode_hdl(adapter, (u8 *)parm)) 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(ph2c, psetop, _SetOpMode_CMD_); - res = rtw_enqueue_cmd(pcmdpriv, ph2c); - } else { - setopmode_hdl(padapter, (u8 *)psetop); - rtw_mfree((u8 *)psetop, sizeof(*psetop)); + init_h2fwcmd_w_parm_no_rsp(cmdobj, parm, _SetOpMode_CMD_); + + if (flags & RTW_CMDF_WAIT_ACK) { + cmdobj->sctx = &sctx; + rtw_sctx_init(&sctx, 2000); + } + + 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); + } } + exit: - - return res; } @@ -1674,16 +1661,17 @@ 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; else GET_ENCRY_ALGO(psecuritypriv, sta, psetstakey_para->algorithm, _FALSE); - if (key_type == GROUP_KEY) + if (key_type == GROUP_KEY) { _rtw_memcpy(&psetstakey_para->key, &psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].skey, 16); - else if (key_type == UNICAST_KEY) + psetstakey_para->gk = 1; + } else if (key_type == UNICAST_KEY) _rtw_memcpy(&psetstakey_para->key, &sta->dot118021x_UncstKey, 16); #ifdef CONFIG_TDLS else if (key_type == TDLS_KEY) { @@ -1731,15 +1719,17 @@ u8 rtw_clearstakey_cmd(_adapter *padapter, struct sta_info *sta, u8 enqueue) struct set_stakey_parm *psetstakey_para; struct cmd_priv *pcmdpriv = &padapter->cmdpriv; struct set_stakey_rsp *psetstakey_rsp = NULL; - struct mlme_priv *pmlmepriv = &padapter->mlmepriv; - struct security_priv *psecuritypriv = &padapter->securitypriv; 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 +1759,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_; @@ -2009,41 +1999,58 @@ u8 rtw_reset_securitypriv_cmd(_adapter *padapter) } -u8 rtw_free_assoc_resources_cmd(_adapter *padapter) +void free_assoc_resources_hdl(_adapter *padapter, u8 lock_scanned_queue) { - struct cmd_obj *ph2c; + rtw_free_assoc_resources(padapter, lock_scanned_queue); +} + +u8 rtw_free_assoc_resources_cmd(_adapter *padapter, u8 lock_scanned_queue, int flags) +{ + struct cmd_obj *cmd; struct drvextra_cmd_parm *pdrvextra_cmd_parm; struct cmd_priv *pcmdpriv = &padapter->cmdpriv; + struct submit_ctx sctx; u8 res = _SUCCESS; - - ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); - if (ph2c == NULL) { - res = _FAIL; - goto exit; + if (flags & RTW_CMDF_DIRECTLY) { + free_assoc_resources_hdl(padapter, lock_scanned_queue); } + else { + cmd = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); + if (cmd == 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; + pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); + if (pdrvextra_cmd_parm == NULL) { + rtw_mfree((unsigned char *)cmd, sizeof(struct cmd_obj)); + res = _FAIL; + goto exit; + } + + pdrvextra_cmd_parm->ec_id = FREE_ASSOC_RESOURCES; + pdrvextra_cmd_parm->type = lock_scanned_queue; + pdrvextra_cmd_parm->size = 0; + pdrvextra_cmd_parm->pbuf = NULL; + + init_h2fwcmd_w_parm_no_rsp(cmd, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); + if (flags & RTW_CMDF_WAIT_ACK) { + cmd->sctx = &sctx; + rtw_sctx_init(&sctx, 2000); + } + + res = rtw_enqueue_cmd(pcmdpriv, cmd); + + 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) + cmd->sctx = NULL; + _exit_critical_mutex(&pcmdpriv->sctx_mutex, NULL); + } } - - pdrvextra_cmd_parm->ec_id = FREE_ASSOC_RESOURCES; - pdrvextra_cmd_parm->type = 0; - 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)); - - - /* rtw_enqueue_cmd(pcmdpriv, ph2c); */ - res = rtw_enqueue_cmd(pcmdpriv, ph2c); - exit: - - return res; } @@ -2088,12 +2095,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 +2119,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 +2135,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... */ @@ -2146,7 +2167,6 @@ u8 _rtw_set_chplan_cmd(_adapter *adapter, int flags, u8 chplan, const struct cou struct cmd_obj *cmdobj; struct SetChannelPlan_param *parm; struct cmd_priv *pcmdpriv = &adapter->cmdpriv; - struct mlme_priv *pmlmepriv = &adapter->mlmepriv; struct submit_ctx sctx; u8 res = _SUCCESS; @@ -2205,12 +2225,29 @@ u8 _rtw_set_chplan_cmd(_adapter *adapter, int flags, u8 chplan, const struct cou 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; + } + + /* allow set channel plan when cmd_thread is not running */ + if (res != _SUCCESS && (flags & RTW_CMDF_WAIT_ACK)) { + parm = (struct SetChannelPlan_param *)rtw_zmalloc(sizeof(*parm)); + if (parm == NULL) { + res = _FAIL; + goto exit; + } + parm->country_ent = country_ent; + parm->channel_plan = chplan; + + if (H2C_SUCCESS != set_chplan_hdl(adapter, (u8 *)parm)) + res = _FAIL; + else + res = _SUCCESS; + rtw_mfree((u8 *)parm, sizeof(*parm)); } } exit: - - return res; } @@ -2239,10 +2276,10 @@ 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) +u8 rtw_led_blink_cmd(_adapter *padapter, void *pLed) { struct cmd_obj *pcmdobj; struct LedBlink_param *ledBlink_param; @@ -2276,54 +2313,34 @@ u8 rtw_led_blink_cmd(_adapter *padapter, PVOID pLed) return res; } -u8 rtw_set_csa_cmd(_adapter *padapter, u8 new_ch_no) +u8 rtw_set_csa_cmd(_adapter *adapter) { - struct cmd_obj *pcmdobj; - struct SetChannelSwitch_param *setChannelSwitch_param; - struct mlme_priv *pmlmepriv = &padapter->mlmepriv; - struct cmd_priv *pcmdpriv = &padapter->cmdpriv; - + struct cmd_obj *cmdobj; + struct cmd_priv *cmdpriv = &adapter->cmdpriv; u8 res = _SUCCESS; - - - pcmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); - if (pcmdobj == NULL) { + cmdobj = rtw_zmalloc(sizeof(struct cmd_obj)); + if (cmdobj == NULL) { res = _FAIL; goto exit; } - setChannelSwitch_param = (struct SetChannelSwitch_param *)rtw_zmalloc(sizeof(struct SetChannelSwitch_param)); - if (setChannelSwitch_param == NULL) { - rtw_mfree((u8 *)pcmdobj, sizeof(struct cmd_obj)); - res = _FAIL; - goto exit; - } - - setChannelSwitch_param->new_ch_no = new_ch_no; - - init_h2fwcmd_w_parm_no_rsp(pcmdobj, setChannelSwitch_param, GEN_CMD_CODE(_SetChannelSwitch)); - res = rtw_enqueue_cmd(pcmdpriv, pcmdobj); + init_h2fwcmd_w_parm_no_parm_rsp(cmdobj, GEN_CMD_CODE(_SetChannelSwitch)); + res = rtw_enqueue_cmd(cmdpriv, cmdobj); exit: - - return res; } u8 rtw_tdls_cmd(_adapter *padapter, u8 *addr, u8 option) { + u8 res = _SUCCESS; +#ifdef CONFIG_TDLS struct cmd_obj *pcmdobj; struct TDLSoption_param *TDLSoption; struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct cmd_priv *pcmdpriv = &padapter->cmdpriv; - u8 res = _SUCCESS; - - -#ifdef CONFIG_TDLS - - pcmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); if (pcmdobj == NULL) { res = _FAIL; @@ -2345,11 +2362,8 @@ u8 rtw_tdls_cmd(_adapter *padapter, u8 *addr, u8 option) init_h2fwcmd_w_parm_no_rsp(pcmdobj, TDLSoption, GEN_CMD_CODE(_TDLS)); res = rtw_enqueue_cmd(pcmdpriv, pcmdobj); -#endif /* CONFIG_TDLS */ - exit: - - +#endif /* CONFIG_TDLS */ return res; } @@ -2388,6 +2402,593 @@ u8 rtw_enable_hw_update_tsf_cmd(_adapter *padapter) return res; } +u8 rtw_periodic_tsf_update_end_cmd(_adapter *adapter) +{ + struct cmd_obj *cmdobj; + struct drvextra_cmd_parm *parm; + struct cmd_priv *cmdpriv = &adapter->cmdpriv; + u8 res = _SUCCESS; + + cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); + if (cmdobj == NULL) { + res = _FAIL; + goto exit; + } + + parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); + if (parm == NULL) { + rtw_mfree((unsigned char *)cmdobj, sizeof(struct cmd_obj)); + res = _FAIL; + goto exit; + } + + parm->ec_id = PERIOD_TSF_UPDATE_END_WK_CID; + parm->type = 0; + parm->size = 0; + parm->pbuf = NULL; + + init_h2fwcmd_w_parm_no_rsp(cmdobj, parm, GEN_CMD_CODE(_Set_Drv_Extra)); + + res = rtw_enqueue_cmd(cmdpriv, cmdobj); + +exit: + return res; +} +u8 rtw_ssmps_wk_hdl(_adapter *adapter, struct ssmps_cmd_parm *ssmp_param) +{ + u8 res = _SUCCESS; + struct sta_info *sta = ssmp_param->sta; + u8 smps = ssmp_param->smps; + + if (sta == NULL) + return _FALSE; + + if (smps) + rtw_ssmps_enter(adapter, sta); + else + rtw_ssmps_leave(adapter, sta); + return res; +} + +u8 rtw_ssmps_wk_cmd(_adapter *adapter, struct sta_info *sta, u8 smps, u8 enqueue) +{ + struct cmd_obj *cmdobj; + struct drvextra_cmd_parm *cmd_parm; + struct ssmps_cmd_parm *ssmp_param; + struct cmd_priv *pcmdpriv = &adapter->cmdpriv; + u8 res = _SUCCESS; + + if (enqueue) { + cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); + if (cmdobj == NULL) { + res = _FAIL; + goto exit; + } + + cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); + if (cmd_parm == NULL) { + rtw_mfree((unsigned char *)cmdobj, sizeof(struct cmd_obj)); + res = _FAIL; + goto exit; + } + + ssmp_param = (struct ssmps_cmd_parm *)rtw_zmalloc(sizeof(struct ssmps_cmd_parm)); + if (ssmp_param == NULL) { + rtw_mfree((u8 *)cmdobj, sizeof(struct cmd_obj)); + rtw_mfree((u8 *)cmd_parm, sizeof(struct drvextra_cmd_parm)); + res = _FAIL; + goto exit; + } + + ssmp_param->smps = smps; + ssmp_param->sta = sta; + + cmd_parm->ec_id = SSMPS_WK_CID; + cmd_parm->type = 0; + cmd_parm->size = sizeof(struct ssmps_cmd_parm); + cmd_parm->pbuf = (u8 *)ssmp_param; + + init_h2fwcmd_w_parm_no_rsp(cmdobj, cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); + + res = rtw_enqueue_cmd(pcmdpriv, cmdobj); + } else { + struct ssmps_cmd_parm tmp_ssmp_param; + + tmp_ssmp_param.smps = smps; + tmp_ssmp_param.sta = sta; + rtw_ssmps_wk_hdl(adapter, &tmp_ssmp_param); + } + +exit: + return res; +} + +#ifdef CONFIG_SUPPORT_STATIC_SMPS +u8 _ssmps_chk_by_tp(_adapter *adapter, u8 from_timer) +{ + u8 enter_smps = _FALSE; + struct mlme_priv *pmlmepriv = &adapter->mlmepriv; + struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); + struct sta_priv *pstapriv = &adapter->stapriv; + struct sta_info *psta; + u32 tx_tp_mbits, rx_tp_mbits; + + if (!MLME_IS_STA(adapter) || + !hal_is_mimo_support(adapter) || + !pmlmeext->ssmps_en || + (pmlmeext->cur_channel > 14) + ) + return enter_smps; + + psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); + if (psta == NULL) { + RTW_ERR(ADPT_FMT" sta == NULL\n", ADPT_ARG(adapter)); + rtw_warn_on(1); + return enter_smps; + } + + if (psta->cmn.mimo_type == RF_1T1R) + return enter_smps; + + tx_tp_mbits = psta->sta_stats.tx_tp_kbits >> 10; + rx_tp_mbits = psta->sta_stats.rx_tp_kbits >> 10; + + #ifdef DBG_STATIC_SMPS + if (pmlmeext->ssmps_test) { + enter_smps = (pmlmeext->ssmps_test_en == 1) ? _TRUE : _FALSE; + } + else + #endif + { + if ((tx_tp_mbits <= pmlmeext->ssmps_tx_tp_th) && + (rx_tp_mbits <= pmlmeext->ssmps_rx_tp_th)) + enter_smps = _TRUE; + else + enter_smps = _FALSE; + } + + if (1) { + RTW_INFO(FUNC_ADPT_FMT" tx_tp:%d [%d], rx_tp:%d [%d] , SSMPS enter :%s\n", + FUNC_ADPT_ARG(adapter), + tx_tp_mbits, pmlmeext->ssmps_tx_tp_th, + rx_tp_mbits, pmlmeext->ssmps_rx_tp_th, + (enter_smps == _TRUE) ? "True" : "False"); + #ifdef DBG_STATIC_SMPS + RTW_INFO(FUNC_ADPT_FMT" test:%d test_en:%d\n", + FUNC_ADPT_ARG(adapter), + pmlmeext->ssmps_test, + pmlmeext->ssmps_test_en); + #endif + } + + if (enter_smps) { + if (!from_timer && psta->cmn.sm_ps != SM_PS_STATIC) + rtw_ssmps_enter(adapter, psta); + } else { + if (!from_timer && psta->cmn.sm_ps != SM_PS_DISABLE) + rtw_ssmps_leave(adapter, psta); + else { + u8 ps_change = _FALSE; + + if (enter_smps && psta->cmn.sm_ps != SM_PS_STATIC) + ps_change = _TRUE; + else if (!enter_smps && psta->cmn.sm_ps != SM_PS_DISABLE) + ps_change = _TRUE; + + if (ps_change) + rtw_ssmps_wk_cmd(adapter, psta, enter_smps, 1); + } + } + + return enter_smps; +} +#endif /*CONFIG_SUPPORT_STATIC_SMPS*/ + +#ifdef CONFIG_CTRL_TXSS_BY_TP +void rtw_ctrl_txss_update_mimo_type(_adapter *adapter, struct sta_info *sta) +{ + struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); + + pmlmeext->txss_momi_type_bk = sta->cmn.mimo_type; +} + +u8 rtw_ctrl_txss(_adapter *adapter, struct sta_info *sta, bool tx_1ss) +{ + struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); + struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); + u8 lps_changed = _FALSE; + u8 rst = _SUCCESS; + + if (pmlmeext->txss_1ss == tx_1ss) + return _FALSE; + + if (pwrpriv->bLeisurePs && pwrpriv->pwr_mode != PS_MODE_ACTIVE) { + lps_changed = _TRUE; + LPS_Leave(adapter, "LPS_CTRL_TXSS"); + } + + RTW_INFO(ADPT_FMT" STA [" MAC_FMT "] set tx to %d ss\n", + ADPT_ARG(adapter), MAC_ARG(sta->cmn.mac_addr), + (tx_1ss) ? 1 : rtw_get_sta_tx_nss(adapter, sta)); + + /*ra re-registed*/ + sta->cmn.mimo_type = (tx_1ss) ? RF_1T1R : pmlmeext->txss_momi_type_bk; + rtw_phydm_ra_registed(adapter, sta); + + /*configure trx mode*/ + rtw_phydm_trx_cfg(adapter, tx_1ss); + pmlmeext->txss_1ss = tx_1ss; + + if (lps_changed) + LPS_Enter(adapter, "LPS_CTRL_TXSS"); + + return rst; +} + +u8 rtw_ctrl_txss_wk_hdl(_adapter *adapter, struct txss_cmd_parm *txss_param) +{ + if (!txss_param->sta) + return _FALSE; + + return rtw_ctrl_txss(adapter, txss_param->sta, txss_param->tx_1ss); +} + +u8 rtw_ctrl_txss_wk_cmd(_adapter *adapter, struct sta_info *sta, bool tx_1ss, u8 flag) +{ + struct cmd_obj *cmdobj; + struct drvextra_cmd_parm *cmd_parm; + struct txss_cmd_parm *txss_param; + struct cmd_priv *pcmdpriv = &adapter->cmdpriv; + struct submit_ctx sctx; + u8 res = _SUCCESS; + + txss_param = (struct txss_cmd_parm *)rtw_zmalloc(sizeof(struct txss_cmd_parm)); + if (txss_param == NULL) { + res = _FAIL; + goto exit; + } + + txss_param->tx_1ss = tx_1ss; + txss_param->sta = sta; + + if (flag & RTW_CMDF_DIRECTLY) { + res = rtw_ctrl_txss_wk_hdl(adapter, txss_param); + rtw_mfree((u8 *)txss_param, sizeof(*txss_param)); + } else { + cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); + if (cmdobj == NULL) { + res = _FAIL; + goto exit; + } + + cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); + if (cmd_parm == NULL) { + rtw_mfree((u8 *)cmdobj, sizeof(struct cmd_obj)); + res = _FAIL; + goto exit; + } + + cmd_parm->ec_id = TXSS_WK_CID; + cmd_parm->type = 0; + cmd_parm->size = sizeof(struct txss_cmd_parm); + cmd_parm->pbuf = (u8 *)txss_param; + + init_h2fwcmd_w_parm_no_rsp(cmdobj, cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); + + if (flag & RTW_CMDF_WAIT_ACK) { + cmdobj->sctx = &sctx; + rtw_sctx_init(&sctx, 10 * 1000); + } + + res = rtw_enqueue_cmd(pcmdpriv, cmdobj); + if (res == _SUCCESS && (flag & 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; +} + +void rtw_ctrl_tx_ss_by_tp(_adapter *adapter, u8 from_timer) +{ + bool tx_1ss = _FALSE; /*change tx from 2ss to 1ss*/ + struct mlme_priv *pmlmepriv = &adapter->mlmepriv; + struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); + struct sta_priv *pstapriv = &adapter->stapriv; + struct sta_info *psta; + u32 tx_tp_mbits; + + if (!MLME_IS_STA(adapter) || + !hal_is_mimo_support(adapter) || + !pmlmeext->txss_ctrl_en + ) + return; + + psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); + if (psta == NULL) { + RTW_ERR(ADPT_FMT" sta == NULL\n", ADPT_ARG(adapter)); + rtw_warn_on(1); + return; + } + + tx_tp_mbits = psta->sta_stats.tx_tp_kbits >> 10; + if (tx_tp_mbits >= pmlmeext->txss_tp_th) { + tx_1ss = _FALSE; + } else { + if (pmlmeext->txss_tp_chk_cnt && --pmlmeext->txss_tp_chk_cnt) + tx_1ss = _FALSE; + else + tx_1ss = _TRUE; + } + + if (1) { + RTW_INFO(FUNC_ADPT_FMT" tx_tp:%d [%d] tx_1ss(%d):%s\n", + FUNC_ADPT_ARG(adapter), + tx_tp_mbits, pmlmeext->txss_tp_th, + pmlmeext->txss_tp_chk_cnt, + (tx_1ss == _TRUE) ? "True" : "False"); + } + + if (pmlmeext->txss_1ss != tx_1ss) { + if (from_timer) + rtw_ctrl_txss_wk_cmd(adapter, psta, tx_1ss, 0); + else + rtw_ctrl_txss(adapter, psta, tx_1ss); + } +} +#ifdef DBG_CTRL_TXSS +void dbg_ctrl_txss(_adapter *adapter, bool tx_1ss) +{ + struct mlme_priv *pmlmepriv = &adapter->mlmepriv; + struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); + struct sta_priv *pstapriv = &adapter->stapriv; + struct sta_info *psta; + + if (!MLME_IS_STA(adapter) || + !hal_is_mimo_support(adapter) + ) + return; + + psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); + if (psta == NULL) { + RTW_ERR(ADPT_FMT" sta == NULL\n", ADPT_ARG(adapter)); + rtw_warn_on(1); + return; + } + + rtw_ctrl_txss(adapter, psta, tx_1ss); +} +#endif +#endif /*CONFIG_CTRL_TXSS_BY_TP*/ + +#ifdef CONFIG_LPS +#ifdef CONFIG_LPS_CHK_BY_TP +#ifdef LPS_BCN_CNT_MONITOR +static u8 _bcn_cnt_expected(struct sta_info *psta) +{ + _adapter *adapter = psta->padapter; + struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + u8 dtim = rtw_get_bcn_dtim_period(adapter); + u8 bcn_cnt = 0; + + if ((pmlmeinfo->bcn_interval !=0) && (dtim != 0)) + bcn_cnt = 2000 / pmlmeinfo->bcn_interval / dtim * 4 / 5; /*2s*/ + if (0) + RTW_INFO("%s bcn_cnt:%d\n", __func__, bcn_cnt); + + if (bcn_cnt == 0) { + RTW_ERR(FUNC_ADPT_FMT" bcn_cnt == 0\n", FUNC_ADPT_ARG(adapter)); + rtw_warn_on(1); + } + + return bcn_cnt; +} +#endif +u8 _lps_chk_by_tp(_adapter *adapter, u8 from_timer) +{ + u8 enter_ps = _FALSE; + struct mlme_priv *pmlmepriv = &adapter->mlmepriv; + struct sta_priv *pstapriv = &adapter->stapriv; + struct sta_info *psta; + struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); + u32 tx_tp_mbits, rx_tp_mbits, bi_tp_mbits; + u8 rx_bcn_cnt; + + psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); + if (psta == NULL) { + RTW_ERR(ADPT_FMT" sta == NULL\n", ADPT_ARG(adapter)); + rtw_warn_on(1); + return enter_ps; + } + + rx_bcn_cnt = rtw_get_bcn_cnt(psta->padapter); + psta->sta_stats.acc_tx_bytes = psta->sta_stats.tx_bytes; + psta->sta_stats.acc_rx_bytes = psta->sta_stats.rx_bytes; + +#if 1 + tx_tp_mbits = psta->sta_stats.tx_tp_kbits >> 10; + rx_tp_mbits = psta->sta_stats.rx_tp_kbits >> 10; + bi_tp_mbits = tx_tp_mbits + rx_tp_mbits; +#else + tx_tp_mbits = psta->sta_stats.smooth_tx_tp_kbits >> 10; + rx_tp_mbits = psta->sta_stats.smooth_rx_tp_kbits >> 10; + bi_tp_mbits = tx_tp_mbits + rx_tp_mbits; +#endif + + if ((bi_tp_mbits >= pwrpriv->lps_bi_tp_th) || + (tx_tp_mbits >= pwrpriv->lps_tx_tp_th) || + (rx_tp_mbits >= pwrpriv->lps_rx_tp_th)) { + enter_ps = _FALSE; + pwrpriv->lps_chk_cnt = pwrpriv->lps_chk_cnt_th; + } + else { +#ifdef LPS_BCN_CNT_MONITOR + u8 bcn_cnt = _bcn_cnt_expected(psta); + + if (bcn_cnt && (rx_bcn_cnt < bcn_cnt)) { + pwrpriv->lps_chk_cnt = 2; + RTW_ERR(FUNC_ADPT_FMT" BCN_CNT:%d(%d) invalid\n", + FUNC_ADPT_ARG(adapter), rx_bcn_cnt, bcn_cnt); + } +#endif + + if (pwrpriv->lps_chk_cnt && --pwrpriv->lps_chk_cnt) + enter_ps = _FALSE; + else + enter_ps = _TRUE; + } + + if (1) { + RTW_INFO(FUNC_ADPT_FMT" tx_tp:%d [%d], rx_tp:%d [%d], bi_tp:%d [%d], enter_ps(%d):%s\n", + FUNC_ADPT_ARG(adapter), + tx_tp_mbits, pwrpriv->lps_tx_tp_th, + rx_tp_mbits, pwrpriv->lps_rx_tp_th, + bi_tp_mbits, pwrpriv->lps_bi_tp_th, + pwrpriv->lps_chk_cnt, + (enter_ps == _TRUE) ? "True" : "False"); + RTW_INFO(FUNC_ADPT_FMT" tx_pkt_cnt :%d [%d], rx_pkt_cnt :%d [%d]\n", + FUNC_ADPT_ARG(adapter), + pmlmepriv->LinkDetectInfo.NumTxOkInPeriod, + pwrpriv->lps_tx_pkts, + pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod, + pwrpriv->lps_rx_pkts); + if (!adapter->bsta_tp_dump) + RTW_INFO(FUNC_ADPT_FMT" bcn_cnt:%d (per-%d second)\n", + FUNC_ADPT_ARG(adapter), + rx_bcn_cnt, + 2); + } + + if (enter_ps) { + if (!from_timer) + LPS_Enter(adapter, "TRAFFIC_IDLE"); + } else { + if (!from_timer) + LPS_Leave(adapter, "TRAFFIC_BUSY"); + else { + #ifdef CONFIG_CONCURRENT_MODE + #ifndef CONFIG_FW_MULTI_PORT_SUPPORT + if (adapter->hw_port == HW_PORT0) + #endif + #endif + rtw_lps_ctrl_wk_cmd(adapter, LPS_CTRL_TRAFFIC_BUSY, 0); + } + } + + return enter_ps; +} +#endif + +static u8 _lps_chk_by_pkt_cnts(_adapter *padapter, u8 from_timer, u8 bBusyTraffic) +{ + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + u8 bEnterPS = _FALSE; + + /* check traffic for powersaving. */ + if (((pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod + pmlmepriv->LinkDetectInfo.NumTxOkInPeriod) > 8) || + #ifdef CONFIG_LPS_SLOW_TRANSITION + (pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod > 2) + #else /* CONFIG_LPS_SLOW_TRANSITION */ + (pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod > 4) + #endif /* CONFIG_LPS_SLOW_TRANSITION */ + ) { + #ifdef DBG_RX_COUNTER_DUMP + if (padapter->dump_rx_cnt_mode & DUMP_DRV_TRX_COUNTER_DATA) + RTW_INFO("(-)Tx = %d, Rx = %d\n", pmlmepriv->LinkDetectInfo.NumTxOkInPeriod, pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod); + #endif + + bEnterPS = _FALSE; + #ifdef CONFIG_LPS_SLOW_TRANSITION + if (bBusyTraffic == _TRUE) { + if (pmlmepriv->LinkDetectInfo.TrafficTransitionCount <= 4) + pmlmepriv->LinkDetectInfo.TrafficTransitionCount = 4; + + pmlmepriv->LinkDetectInfo.TrafficTransitionCount++; + + /* RTW_INFO("Set TrafficTransitionCount to %d\n", pmlmepriv->LinkDetectInfo.TrafficTransitionCount); */ + + if (pmlmepriv->LinkDetectInfo.TrafficTransitionCount > 30/*TrafficTransitionLevel*/) + pmlmepriv->LinkDetectInfo.TrafficTransitionCount = 30; + } + #endif /* CONFIG_LPS_SLOW_TRANSITION */ + } else { + #ifdef DBG_RX_COUNTER_DUMP + if (padapter->dump_rx_cnt_mode & DUMP_DRV_TRX_COUNTER_DATA) + RTW_INFO("(+)Tx = %d, Rx = %d\n", pmlmepriv->LinkDetectInfo.NumTxOkInPeriod, pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod); + #endif + + #ifdef CONFIG_LPS_SLOW_TRANSITION + if (pmlmepriv->LinkDetectInfo.TrafficTransitionCount >= 2) + pmlmepriv->LinkDetectInfo.TrafficTransitionCount -= 2; + else + pmlmepriv->LinkDetectInfo.TrafficTransitionCount = 0; + + if (pmlmepriv->LinkDetectInfo.TrafficTransitionCount == 0) + bEnterPS = _TRUE; + #else /* CONFIG_LPS_SLOW_TRANSITION */ + bEnterPS = _TRUE; + #endif /* CONFIG_LPS_SLOW_TRANSITION */ + } + + #ifdef CONFIG_DYNAMIC_DTIM + if (pmlmepriv->LinkDetectInfo.LowPowerTransitionCount == 8) + bEnterPS = _FALSE; + + RTW_INFO("LowPowerTransitionCount=%d\n", pmlmepriv->LinkDetectInfo.LowPowerTransitionCount); + #endif /* CONFIG_DYNAMIC_DTIM */ + + /* LeisurePS only work in infra mode. */ + if (bEnterPS) { + if (!from_timer) { + #ifdef CONFIG_DYNAMIC_DTIM + if (pmlmepriv->LinkDetectInfo.LowPowerTransitionCount < 8) + adapter_to_pwrctl(padapter)->dtim = 1; + else + adapter_to_pwrctl(padapter)->dtim = 3; + #endif /* CONFIG_DYNAMIC_DTIM */ + LPS_Enter(padapter, "TRAFFIC_IDLE"); + } else { + /* do this at caller */ + /* rtw_lps_ctrl_wk_cmd(adapter, LPS_CTRL_ENTER, 0); */ + /* rtw_hal_dm_watchdog_in_lps(padapter); */ + } + + #ifdef CONFIG_DYNAMIC_DTIM + if (adapter_to_pwrctl(padapter)->bFwCurrentInPSMode == _TRUE) + pmlmepriv->LinkDetectInfo.LowPowerTransitionCount++; + #endif /* CONFIG_DYNAMIC_DTIM */ + } else { + #ifdef CONFIG_DYNAMIC_DTIM + if (pmlmepriv->LinkDetectInfo.LowPowerTransitionCount != 8) + pmlmepriv->LinkDetectInfo.LowPowerTransitionCount = 0; + else + pmlmepriv->LinkDetectInfo.LowPowerTransitionCount++; + #endif /* CONFIG_DYNAMIC_DTIM */ + + if (!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, 0); + } + } + + return bEnterPS; +} +#endif /* CONFIG_LPS */ + /* from_timer == 1 means driver is in LPS */ u8 traffic_status_watchdog(_adapter *padapter, u8 from_timer) { @@ -2404,8 +3005,9 @@ u8 traffic_status_watchdog(_adapter *padapter, u8 from_timer) struct tdls_txmgmt txmgmt; u8 baddr[ETH_ALEN] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff }; #endif /* CONFIG_TDLS */ - +#ifdef CONFIG_TRAFFIC_PROTECT RT_LINK_DETECT_T *link_detect = &pmlmepriv->LinkDetectInfo; +#endif #ifdef CONFIG_BT_COEXIST if (padapter->registrypriv.wifi_spec != 1) { @@ -2481,110 +3083,27 @@ u8 traffic_status_watchdog(_adapter *padapter, u8 from_timer) #endif /* CONFIG_TDLS_AUTOSETUP */ #endif /* CONFIG_TDLS */ +#ifdef CONFIG_SUPPORT_STATIC_SMPS + _ssmps_chk_by_tp(padapter, from_timer); +#endif +#ifdef CONFIG_CTRL_TXSS_BY_TP + rtw_ctrl_tx_ss_by_tp(padapter, from_timer); +#endif + #ifdef CONFIG_LPS - /* check traffic for powersaving. */ - if (((pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod + pmlmepriv->LinkDetectInfo.NumTxOkInPeriod) > 8) || -#ifdef CONFIG_LPS_SLOW_TRANSITION - (pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod > 2) -#else /* CONFIG_LPS_SLOW_TRANSITION */ - (pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod > 4) -#endif /* CONFIG_LPS_SLOW_TRANSITION */ - ) { -#ifdef DBG_RX_COUNTER_DUMP - if (padapter->dump_rx_cnt_mode & DUMP_DRV_TRX_COUNTER_DATA) - RTW_INFO("(-)Tx = %d, Rx = %d\n", pmlmepriv->LinkDetectInfo.NumTxOkInPeriod, pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod); -#endif - bEnterPS = _FALSE; -#ifdef CONFIG_LPS_SLOW_TRANSITION - if (bBusyTraffic == _TRUE) { - if (pmlmepriv->LinkDetectInfo.TrafficTransitionCount <= 4) - pmlmepriv->LinkDetectInfo.TrafficTransitionCount = 4; - - pmlmepriv->LinkDetectInfo.TrafficTransitionCount++; - - /* RTW_INFO("Set TrafficTransitionCount to %d\n", pmlmepriv->LinkDetectInfo.TrafficTransitionCount); */ - - if (pmlmepriv->LinkDetectInfo.TrafficTransitionCount > 30/*TrafficTransitionLevel*/) - pmlmepriv->LinkDetectInfo.TrafficTransitionCount = 30; - } -#endif /* CONFIG_LPS_SLOW_TRANSITION */ - - } else { -#ifdef DBG_RX_COUNTER_DUMP - if (padapter->dump_rx_cnt_mode & DUMP_DRV_TRX_COUNTER_DATA) - RTW_INFO("(+)Tx = %d, Rx = %d\n", pmlmepriv->LinkDetectInfo.NumTxOkInPeriod, pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod); -#endif -#ifdef CONFIG_LPS_SLOW_TRANSITION - if (pmlmepriv->LinkDetectInfo.TrafficTransitionCount >= 2) - pmlmepriv->LinkDetectInfo.TrafficTransitionCount -= 2; + if (adapter_to_pwrctl(padapter)->bLeisurePs && MLME_IS_STA(padapter)) { + #ifdef CONFIG_LPS_CHK_BY_TP + if (adapter_to_pwrctl(padapter)->lps_chk_by_tp) + bEnterPS = _lps_chk_by_tp(padapter, from_timer); else - pmlmepriv->LinkDetectInfo.TrafficTransitionCount = 0; - - if (pmlmepriv->LinkDetectInfo.TrafficTransitionCount == 0) - bEnterPS = _TRUE; -#else /* CONFIG_LPS_SLOW_TRANSITION */ - bEnterPS = _TRUE; -#endif /* CONFIG_LPS_SLOW_TRANSITION */ + #endif /*CONFIG_LPS_CHK_BY_TP*/ + bEnterPS = _lps_chk_by_pkt_cnts(padapter, from_timer, bBusyTraffic); } - -#ifdef CONFIG_DYNAMIC_DTIM - if (pmlmepriv->LinkDetectInfo.LowPowerTransitionCount == 8) - bEnterPS = _FALSE; - - RTW_INFO("LowPowerTransitionCount=%d\n", pmlmepriv->LinkDetectInfo.LowPowerTransitionCount); -#endif /* CONFIG_DYNAMIC_DTIM */ - - /* LeisurePS only work in infra mode. */ - if (bEnterPS) { - if (!from_timer) { -#ifdef CONFIG_DYNAMIC_DTIM - if (pmlmepriv->LinkDetectInfo.LowPowerTransitionCount < 8) - adapter_to_pwrctl(padapter)->dtim = 1; - else - adapter_to_pwrctl(padapter)->dtim = 3; -#endif /* CONFIG_DYNAMIC_DTIM */ - LPS_Enter(padapter, "TRAFFIC_IDLE"); - } else { - /* do this at caller */ - /* rtw_lps_ctrl_wk_cmd(adapter, LPS_CTRL_ENTER, 1); */ - /* rtw_hal_dm_watchdog_in_lps(padapter); */ - } -#ifdef CONFIG_DYNAMIC_DTIM - if (adapter_to_pwrctl(padapter)->bFwCurrentInPSMode == _TRUE) - pmlmepriv->LinkDetectInfo.LowPowerTransitionCount++; -#endif /* CONFIG_DYNAMIC_DTIM */ - } else { -#ifdef CONFIG_DYNAMIC_DTIM - if (pmlmepriv->LinkDetectInfo.LowPowerTransitionCount != 8) - pmlmepriv->LinkDetectInfo.LowPowerTransitionCount = 0; - else - pmlmepriv->LinkDetectInfo.LowPowerTransitionCount++; -#endif /* CONFIG_DYNAMIC_DTIM */ - if (!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); - } - } - #endif /* CONFIG_LPS */ + } else { #ifdef CONFIG_LPS - struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); - int n_assoc_iface = 0; - int i; - - for (i = 0; i < dvobj->iface_nums; i++) { - if (check_fwstate(&(dvobj->padapters[i]->mlmepriv), WIFI_ASOC_STATE)) - n_assoc_iface++; - } - - if (!from_timer && n_assoc_iface == 0) + if (!from_timer && rtw_mi_get_assoc_if_num(padapter) == 0) LPS_Leave(padapter, "NON_LINKED"); #endif } @@ -2621,6 +3140,9 @@ static void dynamic_update_bcn_check(_adapter *padapter) if (!padapter->registrypriv.wifi_spec) return; + if (!padapter->registrypriv.ht_enable || !is_supported_ht(padapter->registrypriv.wireless_mode)) + return; + if (!MLME_IS_AP(padapter)) return; @@ -2630,7 +3152,7 @@ static void dynamic_update_bcn_check(_adapter *padapter) if (count % 10 == 0) { count = 1; - +#ifdef CONFIG_80211N_HT if (_FALSE == ATOMIC_READ(&pmlmepriv->olbc) && _FALSE == ATOMIC_READ(&pmlmepriv->olbc_ht)) { @@ -2639,8 +3161,10 @@ static void dynamic_update_bcn_check(_adapter *padapter) update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, _TRUE); } } +#endif /* CONFIG_80211N_HT */ } +#ifdef CONFIG_80211N_HT /* In 2s, there are any legacy AP, update HT info, and then reset count */ if (_FALSE != ATOMIC_READ(&pmlmepriv->olbc) @@ -2655,18 +3179,21 @@ static void dynamic_update_bcn_check(_adapter *padapter) ATOMIC_SET(&pmlmepriv->olbc_ht, _FALSE); count = 0; } - +#endif /* CONFIG_80211N_HT */ count ++; } } void rtw_iface_dynamic_chk_wk_hdl(_adapter *padapter) { - struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); - #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); + #ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(padapter) && MLME_IS_ASOC(padapter)) + rtw_mesh_peer_status_chk(padapter); + #endif + } #endif #endif /* CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ dynamic_update_bcn_check(padapter); @@ -2677,13 +3204,10 @@ void rtw_iface_dynamic_chk_wk_hdl(_adapter *padapter) /* for debug purpose */ _linked_info_dump(padapter); - #ifdef CONFIG_BEAMFORMING - #ifndef RTW_BEAMFORMING_VERSION_2 - #if (BEAMFORMING_SUPPORT == 0) /*for diver defined beamforming*/ - beamforming_watchdog(padapter); - #endif - #endif /* !RTW_BEAMFORMING_VERSION_2 */ - #endif +#ifdef CONFIG_RTW_CFGVEDNOR_RSSIMONITOR + rtw_cfgvendor_rssi_monitor_evt(padapter); +#endif + } void rtw_dynamic_chk_wk_hdl(_adapter *padapter) @@ -2720,18 +3244,21 @@ void rtw_dynamic_chk_wk_hdl(_adapter *padapter) rtw_hal_mcc_sw_status_check(padapter); #endif /* CONFIG_MCC_MODE */ + rtw_hal_periodic_tsf_update_chk(padapter); } #ifdef CONFIG_LPS +struct lps_ctrl_wk_parm { + u8 lps_level; +}; -void lps_ctrl_wk_hdl(_adapter *padapter, u8 lps_ctrl_type); -void lps_ctrl_wk_hdl(_adapter *padapter, u8 lps_ctrl_type) +void lps_ctrl_wk_hdl(_adapter *padapter, u8 lps_ctrl_type, u8 *buf) { struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct lps_ctrl_wk_parm *parm = (struct lps_ctrl_wk_parm *)buf; u8 mstatus; - if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE) || (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE)) return; @@ -2781,6 +3308,11 @@ void lps_ctrl_wk_hdl(_adapter *padapter, u8 lps_ctrl_type) case LPS_CTRL_LEAVE: LPS_Leave(padapter, "LPS_CTRL_LEAVE"); break; + case LPS_CTRL_LEAVE_SET_LEVEL: + LPS_Leave(padapter, "LPS_CTRL_LEAVE_SET_LEVEL"); + if (parm) + pwrpriv->lps_level = parm->lps_level; + break; case LPS_CTRL_LEAVE_CFG80211_PWRMGMT: LPS_Leave(padapter, "CFG80211_PWRMGMT"); break; @@ -2802,53 +3334,90 @@ void lps_ctrl_wk_hdl(_adapter *padapter, u8 lps_ctrl_type) } -u8 rtw_lps_ctrl_wk_cmd(_adapter *padapter, u8 lps_ctrl_type, u8 enqueue) +static u8 _rtw_lps_ctrl_wk_cmd(_adapter *adapter, u8 lps_ctrl_type, u8 lps_level, u8 flags) { - struct cmd_obj *ph2c; - struct drvextra_cmd_parm *pdrvextra_cmd_parm; - struct cmd_priv *pcmdpriv = &padapter->cmdpriv; - /* struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); */ + struct cmd_obj *cmdobj; + struct drvextra_cmd_parm *parm; + struct lps_ctrl_wk_parm *wk_parm = NULL; + struct cmd_priv *pcmdpriv = &adapter->cmdpriv; + struct submit_ctx sctx; u8 res = _SUCCESS; + if (lps_ctrl_type == LPS_CTRL_LEAVE_SET_LEVEL) { + wk_parm = rtw_zmalloc(sizeof(*wk_parm)); + if (wk_parm == NULL) { + res = _FAIL; + goto exit; + } + wk_parm->lps_level = lps_level; + } - /* if(!pwrctrlpriv->bLeisurePs) */ - /* return res; */ - - if (enqueue) { - ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); - if (ph2c == NULL) { + if (flags & RTW_CMDF_DIRECTLY) { + /* no need to enqueue, do the cmd hdl directly */ + lps_ctrl_wk_hdl(adapter, lps_ctrl_type, (u8 *)wk_parm); + if (wk_parm) + rtw_mfree(wk_parm, sizeof(*wk_parm)); + } else { + /* need enqueue, prepare cmd_obj and enqueue */ + parm = rtw_zmalloc(sizeof(*parm)); + if (parm == NULL) { + if (wk_parm) + rtw_mfree(wk_parm, sizeof(*wk_parm)); 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)); + parm->ec_id = LPS_CTRL_WK_CID; + parm->type = lps_ctrl_type; + parm->size = wk_parm ? sizeof(*wk_parm) : 0; + parm->pbuf = (u8 *)wk_parm; + + cmdobj = rtw_zmalloc(sizeof(*cmdobj)); + if (cmdobj == NULL) { + rtw_mfree(parm, sizeof(*parm)); + if (wk_parm) + rtw_mfree(wk_parm, sizeof(*wk_parm)); res = _FAIL; goto exit; } - pdrvextra_cmd_parm->ec_id = LPS_CTRL_WK_CID; - pdrvextra_cmd_parm->type = lps_ctrl_type; - pdrvextra_cmd_parm->size = 0; - pdrvextra_cmd_parm->pbuf = NULL; + init_h2fwcmd_w_parm_no_rsp(cmdobj, parm, GEN_CMD_CODE(_Set_Drv_Extra)); - init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); + if (flags & RTW_CMDF_WAIT_ACK) { + cmdobj->sctx = &sctx; + rtw_sctx_init(&sctx, 2000); + } - res = rtw_enqueue_cmd(pcmdpriv, ph2c); - } else - lps_ctrl_wk_hdl(padapter, lps_ctrl_type); + 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; +} +u8 rtw_lps_ctrl_wk_cmd(_adapter *adapter, u8 lps_ctrl_type, u8 flags) +{ + return _rtw_lps_ctrl_wk_cmd(adapter, lps_ctrl_type, 0, flags); +} + +u8 rtw_lps_ctrl_leave_set_level_cmd(_adapter *adapter, u8 lps_level, u8 flags) +{ + return _rtw_lps_ctrl_wk_cmd(adapter, LPS_CTRL_LEAVE_SET_LEVEL, lps_level, flags); } 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) @@ -3119,11 +3688,6 @@ void reset_securitypriv_hdl(_adapter *padapter) rtw_reset_securitypriv(padapter); } -void free_assoc_resources_hdl(_adapter *padapter) -{ - rtw_free_assoc_resources(padapter, 1); -} - #ifdef CONFIG_P2P u8 p2p_protocol_wk_cmd(_adapter *padapter, int intCmdType) { @@ -3261,9 +3825,84 @@ inline u8 p2p_cancel_roch_cmd(_adapter *adapter, u64 cookie, struct wireless_dev { return _p2p_roch_cmd(adapter, cookie, wdev, NULL, 0, 0, flags); } + #endif /* CONFIG_IOCTL_CFG80211 */ #endif /* CONFIG_P2P */ +#ifdef CONFIG_IOCTL_CFG80211 +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 + u8 rtw_ps_cmd(_adapter *padapter) { struct cmd_obj *ppscmd; @@ -3273,7 +3912,7 @@ u8 rtw_ps_cmd(_adapter *padapter) u8 res = _SUCCESS; #ifdef CONFIG_CONCURRENT_MODE - if (padapter->adapter_type != PRIMARY_ADAPTER) + if (!is_primary_adapter(padapter)) goto exit; #endif @@ -3305,13 +3944,103 @@ u8 rtw_ps_cmd(_adapter *padapter) } +#ifdef CONFIG_DFS +void rtw_dfs_ch_switch_hdl(struct dvobj_priv *dvobj) +{ + struct rf_ctl_t *rfctl = dvobj_to_rfctl(dvobj); + _adapter *pri_adapter = dvobj_get_primary_adapter(dvobj); + u8 ifbmp_m = rtw_mi_get_ap_mesh_ifbmp(pri_adapter); + u8 ifbmp_s = rtw_mi_get_ld_sta_ifbmp(pri_adapter); + s16 req_ch; + + rtw_hal_macid_sleep_all_used(pri_adapter); + + if (rtw_chset_search_ch(rfctl->channel_set, rfctl->csa_ch) >= 0 + && !rtw_chset_is_ch_non_ocp(rfctl->channel_set, rfctl->csa_ch) + ) { + /* CSA channel available and valid */ + req_ch = rfctl->csa_ch; + RTW_INFO("%s valid CSA ch%u\n", __func__, rfctl->csa_ch); + } else if (ifbmp_m) { + /* no available or valid CSA channel, having AP/MESH ifaces */ + req_ch = REQ_CH_NONE; + RTW_INFO("%s ch sel by AP/MESH ifaces\n", __func__); + } else { + /* no available or valid CSA channel and no AP/MESH ifaces */ + if (!IsSupported24G(dvobj_to_regsty(dvobj)->wireless_mode) + #ifdef CONFIG_DFS_MASTER + || rfctl->radar_detected + #endif + ) + req_ch = 36; + else + req_ch = 1; + RTW_INFO("%s switch to ch%d\n", __func__, req_ch); + } + + /* issue deauth for all asoc STA ifaces */ + if (ifbmp_s) { + _adapter *iface; + int i; + + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + if (!iface || !(ifbmp_s & BIT(iface->iface_id))) + continue; + set_fwstate(&iface->mlmepriv, WIFI_OP_CH_SWITCHING); + + /* TODO: true op ch switching */ + issue_deauth(iface, get_bssid(&iface->mlmepriv), WLAN_REASON_DEAUTH_LEAVING); + } + } + +#ifdef CONFIG_AP_MODE + if (ifbmp_m) { + /* trigger channel selection without consideraton of asoc STA ifaces */ + rtw_change_bss_chbw_cmd(dvobj_get_primary_adapter(dvobj), RTW_CMDF_DIRECTLY + , ifbmp_m, ifbmp_s, req_ch, REQ_BW_ORI, REQ_OFFSET_NONE); + } else +#endif + { + /* no AP/MESH iface, switch DFS status and channel directly */ + rtw_warn_on(req_ch <= 0); + #ifdef CONFIG_DFS_MASTER + rtw_dfs_rd_en_decision(pri_adapter, MLME_OPCH_SWITCH, ifbmp_s); + #endif + set_channel_bwmode(pri_adapter, req_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); + } + + /* make asoc STA ifaces disconnect */ + /* TODO: true op ch switching */ + if (ifbmp_s) { + _adapter *iface; + int i; + + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + if (!iface || !(ifbmp_s & BIT(iface->iface_id))) + continue; + rtw_disassoc_cmd(iface, 0, RTW_CMDF_DIRECTLY); + rtw_indicate_disconnect(iface, 0, _FALSE); + rtw_free_assoc_resources(iface, _TRUE); + rtw_free_network_queue(iface, _TRUE); + } + } + + rfctl->csa_ch = 0; + + rtw_hal_macid_wakeup_all_used(pri_adapter); + rtw_mi_os_xmit_schedule(pri_adapter); +} +#endif /* CONFIG_DFS */ + #ifdef CONFIG_AP_MODE 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); @@ -3329,11 +4058,11 @@ static void rtw_chk_hi_queue_hdl(_adapter *padapter) if (empty == _SUCCESS) { bool update_tim = _FALSE; - if (pstapriv->tim_bitmap & BIT(0)) + if (rtw_tim_map_is_set(padapter, pstapriv->tim_bitmap, 0)) update_tim = _TRUE; - pstapriv->tim_bitmap &= ~BIT(0); - pstapriv->sta_dz_bitmap &= ~BIT(0); + rtw_tim_map_clear(padapter, pstapriv->tim_bitmap, 0); + rtw_tim_map_clear(padapter, pstapriv->sta_dz_bitmap, 0); if (update_tim == _TRUE) _update_beacon(padapter, _TIM_IE_, NULL, _TRUE, "bmc sleepq and HIQ empty"); @@ -3380,18 +4109,18 @@ u8 rtw_chk_hi_queue_cmd(_adapter *padapter) } #ifdef CONFIG_DFS_MASTER -u8 rtw_dfs_master_hdl(_adapter *adapter) +u8 rtw_dfs_rd_hdl(_adapter *adapter) { + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); - struct mlme_priv *mlme = &adapter->mlmepriv; - if (!rfctl->dfs_master_enabled) + if (!rfctl->radar_detect_enabled) goto exit; - if (rtw_get_on_cur_ch_time(adapter) == 0 - || rtw_get_passing_time_ms(rtw_get_on_cur_ch_time(adapter)) < 300 + if (dvobj->oper_channel != rfctl->radar_detect_ch + || rtw_get_passing_time_ms(rtw_get_on_oper_ch_time(adapter)) < 300 ) { - /* offchannel , bypass radar detect */ + /* offchannel, bypass radar detect */ goto cac_status_chk; } @@ -3400,93 +4129,102 @@ u8 rtw_dfs_master_hdl(_adapter *adapter) goto cac_status_chk; } - if (!rfctl->dbg_dfs_master_fake_radar_detect_cnt + if (!rfctl->dbg_dfs_fake_radar_detect_cnt && rtw_odm_radar_detect(adapter) != _TRUE) goto cac_status_chk; - if (rfctl->dbg_dfs_master_fake_radar_detect_cnt != 0) { - RTW_INFO(FUNC_ADPT_FMT" fake radar detect, cnt:%d\n", FUNC_ADPT_ARG(adapter) - , rfctl->dbg_dfs_master_fake_radar_detect_cnt); - rfctl->dbg_dfs_master_fake_radar_detect_cnt--; - } - - if (rfctl->dbg_dfs_master_radar_detect_trigger_non) { + if (!rfctl->dbg_dfs_fake_radar_detect_cnt + && rfctl->dbg_dfs_radar_detect_trigger_non + ) { /* radar detect debug mode, trigger no mlme flow */ - if (0) - RTW_INFO(FUNC_ADPT_FMT" radar detected, trigger no mlme flow for debug\n", FUNC_ADPT_ARG(adapter)); - } else { - /* TODO: move timer to rfctl */ - struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); - int i; - - 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) { - /* what? */ - rtw_warn_on(1); - } else { - rtw_chset_update_non_ocp(dvobj->padapters[i]->mlmeextpriv.channel_set - , rfctl->radar_detect_ch, rfctl->radar_detect_bw, rfctl->radar_detect_offset); - rfctl->radar_detected = 1; - - /* trigger channel selection */ - rtw_change_bss_chbw_cmd(dvobj->padapters[i], RTW_CMDF_DIRECTLY, -1, dvobj->padapters[i]->mlmepriv.ori_bw, -1); - } - - if (rfctl->dfs_master_enabled) - goto set_timer; - goto exit; + RTW_INFO("%s radar detected on test mode, trigger no mlme flow\n", __func__); + goto cac_status_chk; } + if (rfctl->dbg_dfs_fake_radar_detect_cnt != 0) { + RTW_INFO("%s fake radar detected, cnt:%d\n", __func__ + , rfctl->dbg_dfs_fake_radar_detect_cnt); + rfctl->dbg_dfs_fake_radar_detect_cnt--; + } else + RTW_INFO("%s radar detected\n", __func__); + + rfctl->radar_detected = 1; + + rtw_chset_update_non_ocp(rfctl->channel_set + , rfctl->radar_detect_ch, rfctl->radar_detect_bw, rfctl->radar_detect_offset); + + rtw_dfs_ch_switch_hdl(dvobj); + + if (rfctl->radar_detect_enabled) + goto set_timer; + goto exit; + cac_status_chk: - if (!IS_CH_WAITING(rfctl) && !IS_CAC_STOPPED(rfctl)) { + if (!IS_CAC_STOPPED(rfctl) + && ((IS_UNDER_CAC(rfctl) && rfctl->cac_force_stop) + || !IS_CH_WAITING(rfctl) + ) + ) { u8 pause = 0x00; 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) { + u8 doiqk = _TRUE; + u8 u_ch, u_bw, u_offset; + + rtw_hal_set_hwreg(adapter , HW_VAR_DO_IQK , &doiqk); + + if (rtw_mi_get_ch_setting_union(adapter, &u_ch, &u_bw, &u_offset)) + set_channel_bwmode(adapter, u_ch, u_offset, u_bw); + else + rtw_warn_on(1); + + doiqk = _FALSE; + rtw_hal_set_hwreg(adapter , HW_VAR_DO_IQK , &doiqk); + + ResumeTxBeacon(adapter); + rtw_mi_tx_beacon_hdl(adapter); + } } set_timer: - _set_timer(&mlme->dfs_master_timer, DFS_MASTER_TIMER_MS); + _set_timer(&rfctl->radar_detect_timer + , rtw_odm_radar_detect_polling_int_ms(dvobj)); exit: return H2C_SUCCESS; } -u8 rtw_dfs_master_cmd(_adapter *adapter, bool enqueue) +u8 rtw_dfs_rd_cmd(_adapter *adapter, bool enqueue) { struct cmd_obj *cmdobj; - struct drvextra_cmd_parm *pdrvextra_cmd_parm; - struct cmd_priv *pcmdpriv = &adapter->cmdpriv; + struct drvextra_cmd_parm *parm; + struct cmd_priv *cmdpriv = &adapter->cmdpriv; u8 res = _FAIL; if (enqueue) { - cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); + cmdobj = rtw_zmalloc(sizeof(struct cmd_obj)); if (cmdobj == NULL) goto exit; - pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); - if (pdrvextra_cmd_parm == NULL) { - rtw_mfree((u8 *)cmdobj, sizeof(struct cmd_obj)); + parm = rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); + if (parm == NULL) { + rtw_mfree(cmdobj, sizeof(struct cmd_obj)); goto exit; } - pdrvextra_cmd_parm->ec_id = DFS_MASTER_WK_CID; - pdrvextra_cmd_parm->type = 0; - pdrvextra_cmd_parm->size = 0; - pdrvextra_cmd_parm->pbuf = NULL; + parm->ec_id = DFS_RADAR_DETECT_WK_CID; + parm->type = 0; + parm->size = 0; + parm->pbuf = NULL; - init_h2fwcmd_w_parm_no_rsp(cmdobj, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); - res = rtw_enqueue_cmd(pcmdpriv, cmdobj); + init_h2fwcmd_w_parm_no_rsp(cmdobj, parm, GEN_CMD_CODE(_Set_Drv_Extra)); + res = rtw_enqueue_cmd(cmdpriv, cmdobj); } else { - rtw_dfs_master_hdl(adapter); + rtw_dfs_rd_hdl(adapter); res = _SUCCESS; } @@ -3494,24 +4232,25 @@ u8 rtw_dfs_master_cmd(_adapter *adapter, bool enqueue) return res; } -void rtw_dfs_master_timer_hdl(RTW_TIMER_HDL_ARGS) +void rtw_dfs_rd_timer_hdl(void *ctx) { - _adapter *adapter = (_adapter *)FunctionContext; + struct rf_ctl_t *rfctl = (struct rf_ctl_t *)ctx; + struct dvobj_priv *dvobj = rfctl_to_dvobj(rfctl); - rtw_dfs_master_cmd(adapter, _TRUE); + rtw_dfs_rd_cmd(dvobj_get_primary_adapter(dvobj), _TRUE); } -void rtw_dfs_master_enable(_adapter *adapter, u8 ch, u8 bw, u8 offset) +static void rtw_dfs_rd_enable(struct rf_ctl_t *rfctl, u8 ch, u8 bw, u8 offset, bool bypass_cac) { - struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); + struct dvobj_priv *dvobj = rfctl_to_dvobj(rfctl); + _adapter *adapter = dvobj_get_primary_adapter(dvobj); - /* TODO: move timer to rfctl */ - adapter = GET_PRIMARY_ADAPTER(adapter); + RTW_INFO("%s on %u,%u,%u\n", __func__, ch, bw, offset); - RTW_INFO(FUNC_ADPT_FMT" on %u,%u,%u\n", FUNC_ADPT_ARG(adapter), ch, bw, offset); - - if (rtw_is_cac_reset_needed(adapter, ch, bw, offset) == _TRUE) - rtw_reset_cac(adapter, ch, bw, offset); + if (bypass_cac) + rfctl->cac_start_time = rfctl->cac_end_time = RTW_CAC_STOPPED; + else if (rtw_is_cac_reset_needed(rfctl, ch, bw, offset) == _TRUE) + rtw_reset_cac(rfctl, ch, bw, offset); rfctl->radar_detect_by_others = _FALSE; rfctl->radar_detect_ch = ch; @@ -3520,10 +4259,17 @@ void rtw_dfs_master_enable(_adapter *adapter, u8 ch, u8 bw, u8 offset) rfctl->radar_detected = 0; - if (!rfctl->dfs_master_enabled) { - RTW_INFO(FUNC_ADPT_FMT" set dfs_master_enabled\n", FUNC_ADPT_ARG(adapter)); - rfctl->dfs_master_enabled = 1; - _set_timer(&adapter->mlmepriv.dfs_master_timer, DFS_MASTER_TIMER_MS); + if (IS_CH_WAITING(rfctl)) + StopTxBeacon(adapter); + + if (!rfctl->radar_detect_enabled) { + RTW_INFO("%s set radar_detect_enabled\n", __func__); + rfctl->radar_detect_enabled = 1; + #ifdef CONFIG_LPS + LPS_Leave(adapter, "RADAR_DETECT_EN"); + #endif + _set_timer(&rfctl->radar_detect_timer + , rtw_odm_radar_detect_polling_int_ms(dvobj)); if (rtw_rfctl_overlap_radar_detect_ch(rfctl)) { if (IS_CH_WAITING(rfctl)) { @@ -3536,27 +4282,29 @@ 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) +static void rtw_dfs_rd_disable(struct rf_ctl_t *rfctl, u8 ch, u8 bw, u8 offset, bool by_others) { - struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); - - /* TODO: move timer to rfctl */ - adapter = GET_PRIMARY_ADAPTER(adapter); + _adapter *adapter = dvobj_get_primary_adapter(rfctl_to_dvobj(rfctl)); rfctl->radar_detect_by_others = by_others; - if (rfctl->dfs_master_enabled) { + if (rfctl->radar_detect_enabled) { bool overlap_radar_detect_ch = rtw_rfctl_overlap_radar_detect_ch(rfctl); - RTW_INFO(FUNC_ADPT_FMT" clear dfs_master_enabled\n", FUNC_ADPT_ARG(adapter)); + RTW_INFO("%s clear radar_detect_enabled\n", __func__); - rfctl->dfs_master_enabled = 0; + rfctl->radar_detect_enabled = 0; rfctl->radar_detected = 0; rfctl->radar_detect_ch = 0; rfctl->radar_detect_bw = 0; rfctl->radar_detect_offset = 0; rfctl->cac_start_time = rfctl->cac_end_time = RTW_CAC_STOPPED; - _cancel_timer_ex(&adapter->mlmepriv.dfs_master_timer); + _cancel_timer_ex(&rfctl->radar_detect_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; @@ -3573,56 +4321,75 @@ void rtw_dfs_master_disable(_adapter *adapter, u8 ch, u8 bw, u8 offset, bool by_ } } -void rtw_dfs_master_status_apply(_adapter *adapter, u8 self_action) +void rtw_dfs_rd_en_decision(_adapter *adapter, u8 mlme_act, u8 excl_ifbmp) { + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; struct mi_state mstate; + u8 ifbmp; u8 u_ch, u_bw, u_offset; bool ld_sta_in_dfs = _FALSE; bool sync_ch = _FALSE; /* _FALSE: asign channel directly */ bool needed = _FALSE; - rtw_mi_status_no_self(adapter, &mstate); - rtw_mi_get_ch_setting_union_no_self(adapter, &u_ch, &u_bw, &u_offset); - if (u_ch != 0) - sync_ch = _TRUE; + if (mlme_act == MLME_OPCH_SWITCH + || mlme_act == MLME_ACTION_NONE + ) { + ifbmp = ~excl_ifbmp; + rtw_mi_status_by_ifbmp(dvobj, ifbmp, &mstate); + rtw_mi_get_ch_setting_union_by_ifbmp(dvobj, ifbmp, &u_ch, &u_bw, &u_offset); + } else { + ifbmp = ~excl_ifbmp & ~BIT(adapter->iface_id); + rtw_mi_status_by_ifbmp(dvobj, ifbmp, &mstate); + rtw_mi_get_ch_setting_union_by_ifbmp(dvobj, ifbmp, &u_ch, &u_bw, &u_offset); + if (u_ch != 0) + sync_ch = _TRUE; - switch (self_action) { - case MLME_STA_CONNECTING: - MSTATE_STA_LG_NUM(&mstate)++; - break; - case MLME_STA_CONNECTED: - MSTATE_STA_LD_NUM(&mstate)++; - break; - case MLME_AP_STARTED: - MSTATE_AP_NUM(&mstate)++; - break; - case MLME_AP_STOPPED: - case MLME_STA_DISCONNECTED: - default: - break; - } - - if (sync_ch == _TRUE) { - if (!rtw_is_chbw_grouped(mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset, u_ch, u_bw, u_offset)) { - RTW_INFO(FUNC_ADPT_FMT" can't sync %u,%u,%u with %u,%u,%u\n", FUNC_ADPT_ARG(adapter) - , mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset, u_ch, u_bw, u_offset); - goto apply; + switch (mlme_act) { + case MLME_STA_CONNECTING: + MSTATE_STA_LG_NUM(&mstate)++; + break; + 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: + break; +#endif +#ifdef CONFIG_RTW_MESH + case MLME_MESH_STARTED: + MSTATE_MESH_NUM(&mstate)++; + break; + case MLME_MESH_STOPPED: + break; +#endif + default: + rtw_warn_on(1); + break; } - rtw_sync_chbw(&mlmeext->cur_channel, &mlmeext->cur_bwmode, &mlmeext->cur_ch_offset - , &u_ch, &u_bw, &u_offset); - } else { - u_ch = mlmeext->cur_channel; - u_bw = mlmeext->cur_bwmode; - u_offset = mlmeext->cur_ch_offset; - } + if (sync_ch == _TRUE) { + if (!MLME_IS_OPCH_SW(adapter)) { + if (!rtw_is_chbw_grouped(mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset, u_ch, u_bw, u_offset)) { + RTW_INFO(FUNC_ADPT_FMT" can't sync %u,%u,%u with %u,%u,%u\n", FUNC_ADPT_ARG(adapter) + , mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset, u_ch, u_bw, u_offset); + goto apply; + } - 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)) - ld_sta_in_dfs = _TRUE; - goto apply; + rtw_sync_chbw(&mlmeext->cur_channel, &mlmeext->cur_bwmode, &mlmeext->cur_ch_offset + , &u_ch, &u_bw, &u_offset); + } + } else { + u_ch = mlmeext->cur_channel; + u_bw = mlmeext->cur_bwmode; + u_offset = mlmeext->cur_ch_offset; + } } if (MSTATE_STA_LG_NUM(&mstate) > 0) { @@ -3630,26 +4397,69 @@ 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_STA_LD_NUM(&mstate) > 0) { + if (rtw_is_dfs_chbw(u_ch, u_bw, u_offset)) { + /* + * if operate as slave w/o radar detect, + * rely on AP on which STA mode connects + */ + if (IS_DFS_SLAVE_WITH_RD(rfctl) && !rtw_odm_dfs_domain_unknown(dvobj)) + needed = _TRUE; + ld_sta_in_dfs = _TRUE; + } goto apply; } - if (rtw_is_dfs_ch(u_ch, u_bw, u_offset)) + if (!MSTATE_AP_NUM(&mstate) && !MSTATE_MESH_NUM(&mstate)) { + /* No working AP/Mesh mode */ + goto apply; + } + + 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" needed:%d, mlme_act:%u, excl_ifbmp:0x%02x\n" + , FUNC_ADPT_ARG(adapter), needed, mlme_act, excl_ifbmp); + 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) - rtw_dfs_master_enable(adapter, u_ch, u_bw, u_offset); + rtw_dfs_rd_enable(rfctl, u_ch, u_bw, u_offset, ld_sta_in_dfs); else - rtw_dfs_master_disable(adapter, u_ch, u_bw, u_offset, ld_sta_in_dfs); + rtw_dfs_rd_disable(rfctl, u_ch, u_bw, u_offset, ld_sta_in_dfs); +} + +u8 rtw_dfs_rd_en_decision_cmd(_adapter *adapter) +{ + struct cmd_obj *cmdobj; + struct drvextra_cmd_parm *parm; + struct cmd_priv *cmdpriv = &adapter->cmdpriv; + u8 res = _FAIL; + + cmdobj = rtw_zmalloc(sizeof(struct cmd_obj)); + if (cmdobj == NULL) + goto exit; + + parm = rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); + if (parm == NULL) { + rtw_mfree(cmdobj, sizeof(struct cmd_obj)); + goto exit; + } + + parm->ec_id = DFS_RADAR_DETECT_EN_DEC_WK_CID; + parm->type = 0; + parm->size = 0; + parm->pbuf = NULL; + + init_h2fwcmd_w_parm_no_rsp(cmdobj, parm, GEN_CMD_CODE(_Set_Drv_Extra)); + res = rtw_enqueue_cmd(cmdpriv, cmdobj); + +exit: + return res; } #endif /* CONFIG_DFS_MASTER */ @@ -3803,6 +4613,48 @@ u8 rtw_btinfo_cmd(_adapter *adapter, u8 *buf, u16 len) res = rtw_enqueue_cmd(pcmdpriv, ph2c); +exit: + return res; +} + +static void rtw_btc_reduce_wl_txpwr_hdl(_adapter *adapter, u32 pwr_lvl) +{ + rtw_btcoex_set_reduced_wl_pwr_lvl(adapter, pwr_lvl); + rtw_btcoex_do_reduce_wl_pwr_lvl(adapter); + + RTW_INFO(FUNC_ADPT_FMT ": BTC reduce WL TxPwr %d dB!\n", + FUNC_ADPT_ARG(adapter), pwr_lvl); +} + +u8 rtw_btc_reduce_wl_txpwr_cmd(_adapter *adapter, u32 val) +{ + struct cmd_obj *pcmdobj; + struct drvextra_cmd_parm *pdrvextra_cmd_parm; + struct cmd_priv *pcmdpriv = &adapter->cmdpriv; + u8 res = _SUCCESS; + + pcmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); + if (pcmdobj == 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 *)pcmdobj, sizeof(struct cmd_obj)); + res = _FAIL; + goto exit; + } + + pdrvextra_cmd_parm->ec_id = BTC_REDUCE_WL_TXPWR_CID; + pdrvextra_cmd_parm->type = val; + pdrvextra_cmd_parm->size = 0; + pdrvextra_cmd_parm->pbuf = NULL; + + init_h2fwcmd_w_parm_no_rsp(pcmdobj, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); + + res = rtw_enqueue_cmd(pcmdpriv, pcmdobj); + exit: return res; } @@ -3852,23 +4704,48 @@ 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; - u8 rfreg0; + uint status = _SUCCESS; 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; +#if (CONFIG_BTCOEX_SUPPORT_WIFI_ONLY_CFG == 1) + padapter->mppriv.CureFuseBTCoex = pHalData->EEPROMBluetoothCoexist; + pHalData->EEPROMBluetoothCoexist = _FALSE; +#endif #ifdef CONFIG_RF_POWER_TRIM - if (!IS_HARDWARE_TYPE_8814A(padapter) && !IS_HARDWARE_TYPE_8822B(padapter)) { + if (!IS_HARDWARE_TYPE_8814A(padapter) && !IS_HARDWARE_TYPE_8822B(padapter) && !IS_HARDWARE_TYPE_8822C(padapter)) { padapter->registrypriv.RegPwrTrimEnable = 1; rtw_hal_read_chip_info(padapter); } #endif /*CONFIG_RF_POWER_TRIM*/ - rtw_hal_init(padapter); + rtw_reset_drv_sw(padapter); +#ifdef CONFIG_NEW_NETDEV_HDL + if (!rtw_is_hw_init_completed(padapter)) { + status = rtw_hal_init(padapter); + if (status == _FAIL) { + ret = H2C_REJECTED; + goto exit; + } + rtw_hal_iface_init(padapter); + } +#else + status = rtw_hal_init(padapter); + if (status == _FAIL) { + ret = H2C_REJECTED; + goto exit; + } +#endif /*CONFIG_NEW_NETDEV_HDL*/ +#ifndef RTW_HALMAC + rtw_intf_start(padapter); +#endif /* !RTW_HALMAC */ #ifdef RTW_HALMAC /*for New IC*/ MPT_InitializeAdapter(padapter, 1); #endif /* CONFIG_MP_INCLUDED */ @@ -3903,27 +4780,37 @@ static s32 rtw_mp_cmd_hdl(_adapter *padapter, u8 mp_cmd_id) rtw_write8(padapter, 0x66, 0x27); /*Open BT uart Log*/ rtw_write8(padapter, 0xc50, 0x20); /*for RX init Gain*/ #endif -#ifdef CONFIG_RTL8188F - RTW_INFO("Set reg 0x88c, 0x58, 0x00\n"); - rfreg0 = phy_query_rf_reg(padapter, RF_PATH_A, 0x0, 0x1f); - phy_set_bb_reg(padapter, 0x88c, BIT21|BIT20, 0x3); - phy_set_rf_reg(padapter, RF_PATH_A, 0x58, BIT1, 0x1); - phy_set_rf_reg(padapter, RF_PATH_A, 0x0, 0xF001f, 0x2001f); - rtw_msleep_os(200); - phy_set_rf_reg(padapter, RF_PATH_A, 0x0, 0xF001f, 0x30000 | rfreg0); - phy_set_rf_reg(padapter, RF_PATH_A, 0x58, BIT1, 0x0); - phy_set_bb_reg(padapter, 0x88c, BIT21|BIT20, 0x0); - rtw_msleep_os(1000); -#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_hal_init(padapter); +#if (CONFIG_BTCOEX_SUPPORT_WIFI_ONLY_CFG == 1) + pHalData->EEPROMBluetoothCoexist = padapter->mppriv.CureFuseBTCoex; +#endif + rtw_reset_drv_sw(padapter); +#ifdef CONFIG_NEW_NETDEV_HDL + if (!rtw_is_hw_init_completed(padapter)) { + status = rtw_hal_init(padapter); + if (status == _FAIL) { + ret = H2C_REJECTED; + goto exit; + } + rtw_hal_iface_init(padapter); + } +#else + status = rtw_hal_init(padapter); + if (status == _FAIL) { + ret = H2C_REJECTED; + goto exit; + } +#endif /*CONFIG_NEW_NETDEV_HDL*/ +#ifndef RTW_HALMAC + rtw_intf_start(padapter); +#endif /* !RTW_HALMAC */ } if (padapter->mppriv.mode != MP_OFF) { @@ -3997,6 +4884,7 @@ u8 rtw_mp_cmd(_adapter *adapter, u8 mp_cmd_id, u8 flags) 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) @@ -4481,6 +5369,69 @@ void session_tracker_cmd_hdl(_adapter *adapter, struct st_cmd_parm *parm) return; } +#if defined(CONFIG_RTW_MESH) && defined(RTW_PER_CMD_SUPPORT_FW) +static s32 rtw_req_per_cmd_hdl(_adapter *adapter) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); + struct macid_bmp req_macid_bmp, *macid_bmp; + u8 i, ret = _FAIL; + + macid_bmp = &macid_ctl->if_g[adapter->iface_id]; + _rtw_memcpy(&req_macid_bmp, macid_bmp, sizeof(struct macid_bmp)); + + /* Clear none mesh's macid */ + for (i = 0; i < macid_ctl->num; i++) { + u8 role; + role = GET_H2CCMD_MSRRPT_PARM_ROLE(&macid_ctl->h2c_msr[i]); + if (role != H2C_MSR_ROLE_MESH) + rtw_macid_map_clr(&req_macid_bmp, i); + } + + /* group_macid: always be 0 in NIC, so only pass macid_bitmap.m0 + * rpt_type: 0 includes all info in 1, use 0 for now + * macid_bitmap: pass m0 only for NIC + */ + ret = rtw_hal_set_req_per_rpt_cmd(adapter, 0, 0, req_macid_bmp.m0); + + return ret; +} + +u8 rtw_req_per_cmd(_adapter *adapter) +{ + 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 = REQ_PER_CMD_WK_CID; + parm->type = 0; + parm->size = 0; + parm->pbuf = NULL; + + 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)); + + res = rtw_enqueue_cmd(pcmdpriv, cmdobj); + +exit: + return res; +} +#endif + u8 rtw_drvextra_cmd_hdl(_adapter *padapter, unsigned char *pbuf) { int ret = H2C_SUCCESS; @@ -4504,7 +5455,7 @@ u8 rtw_drvextra_cmd_hdl(_adapter *padapter, unsigned char *pbuf) break; #ifdef CONFIG_LPS case LPS_CTRL_WK_CID: - lps_ctrl_wk_hdl(padapter, (u8)pdrvextra_cmd->type); + lps_ctrl_wk_hdl(padapter, (u8)pdrvextra_cmd->type, pdrvextra_cmd->pbuf); break; case DM_IN_LPS_WK_CID: rtw_dm_in_lps_hdl(padapter); @@ -4541,18 +5492,13 @@ u8 rtw_drvextra_cmd_hdl(_adapter *padapter, unsigned char *pbuf) case CHECK_HIQ_WK_CID: rtw_chk_hi_queue_hdl(padapter); break; -#endif -#ifdef CONFIG_INTEL_WIDI - case INTEl_WIDI_WK_CID: - intel_widi_wk_hdl(padapter, pdrvextra_cmd->type, pdrvextra_cmd->pbuf); - break; #endif /* add for CONFIG_IEEE80211W, none 11w can use it */ case RESET_SECURITYPRIV: reset_securitypriv_hdl(padapter); break; case FREE_ASSOC_RESOURCES: - free_assoc_resources_hdl(padapter); + free_assoc_resources_hdl(padapter, (u8)pdrvextra_cmd->type); break; case C2H_WK_CID: switch (pdrvextra_cmd->type) { @@ -4584,10 +5530,16 @@ u8 rtw_drvextra_cmd_hdl(_adapter *padapter, unsigned char *pbuf) case BTINFO_WK_CID: rtw_btinfo_hdl(padapter, pdrvextra_cmd->pbuf, pdrvextra_cmd->size); break; + case BTC_REDUCE_WL_TXPWR_CID: + rtw_btc_reduce_wl_txpwr_hdl(padapter, pdrvextra_cmd->type); + break; #endif #ifdef CONFIG_DFS_MASTER - case DFS_MASTER_WK_CID: - rtw_dfs_master_hdl(padapter); + case DFS_RADAR_DETECT_WK_CID: + rtw_dfs_rd_hdl(padapter); + break; + case DFS_RADAR_DETECT_EN_DEC_WK_CID: + rtw_dfs_rd_en_decision(padapter, MLME_ACTION_NONE, 0); break; #endif case SESSION_TRACKER_WK_CID: @@ -4596,17 +5548,55 @@ u8 rtw_drvextra_cmd_hdl(_adapter *padapter, unsigned char *pbuf) case EN_HW_UPDATE_TSF_WK_CID: rtw_hal_set_hwreg(padapter, HW_VAR_EN_HW_UPDATE_TSF, NULL); break; + case PERIOD_TSF_UPDATE_END_WK_CID: + rtw_hal_periodic_tsf_update_chk(padapter); + break; 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 */ +#ifdef CONFIG_MCC_MODE + case MCC_CMD_WK_CID: + ret = rtw_mcc_cmd_hdl(padapter, pdrvextra_cmd->type, pdrvextra_cmd->pbuf); + break; +#endif /* CONFIG_MCC_MODE */ +#if defined(CONFIG_RTW_MESH) && defined(RTW_PER_CMD_SUPPORT_FW) + case REQ_PER_CMD_WK_CID: + ret = rtw_req_per_cmd_hdl(padapter); + break; +#endif +#ifdef CONFIG_SUPPORT_STATIC_SMPS + case SSMPS_WK_CID : + rtw_ssmps_wk_hdl(padapter, (struct ssmps_cmd_parm *)pdrvextra_cmd->pbuf); + break; +#endif +#ifdef CONFIG_CTRL_TXSS_BY_TP + case TXSS_WK_CID : + rtw_ctrl_txss_wk_hdl(padapter, (struct txss_cmd_parm *)pdrvextra_cmd->pbuf); + break; +#endif + default: break; } @@ -4686,8 +5676,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; WLAN_BSSID_EX *pdev_network = &padapter->registrypriv.dev_network; @@ -4696,7 +5684,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); @@ -4734,7 +5722,6 @@ void rtw_create_ibss_post_hdl(_adapter *padapter, int status) createbss_cmd_fail: _exit_critical_bh(&pmlmepriv->lock, &irqL); -exit: return; } @@ -4752,7 +5739,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: @@ -4774,7 +5761,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/rtl8188eu/core/rtw_debug.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_debug.c index 281d136773ee..7eaddf22ef7b 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_debug.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_debug.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 @@ -47,7 +43,7 @@ const char *rtw_log_level_str[] = { void dump_drv_version(void *sel) { RTW_PRINT_SEL(sel, "%s %s\n", DRV_NAME, DRIVERVERSION); - //RTW_PRINT_SEL(sel, "build time: %s %s\n", __DATE__, __TIME__); + RTW_PRINT_SEL(sel, "build time: %s %s\n", __DATE__, __TIME__); } void dump_drv_cfg(void *sel) @@ -101,7 +97,9 @@ void dump_drv_cfg(void *sel) #endif RTW_PRINT_SEL(sel, "RTW_DEF_MODULE_REGULATORY_CERT=0x%02x\n", RTW_DEF_MODULE_REGULATORY_CERT); + RTW_PRINT_SEL(sel, "CONFIG_TXPWR_BY_RATE=%d\n", CONFIG_TXPWR_BY_RATE); RTW_PRINT_SEL(sel, "CONFIG_TXPWR_BY_RATE_EN=%d\n", CONFIG_TXPWR_BY_RATE_EN); + RTW_PRINT_SEL(sel, "CONFIG_TXPWR_LIMIT=%d\n", CONFIG_TXPWR_LIMIT); RTW_PRINT_SEL(sel, "CONFIG_TXPWR_LIMIT_EN=%d\n", CONFIG_TXPWR_LIMIT_EN); @@ -134,6 +132,18 @@ void dump_drv_cfg(void *sel) RTW_PRINT_SEL(sel, "CONFIG_RTW_80211R\n"); #endif +#ifdef CONFIG_RTW_NETIF_SG + RTW_PRINT_SEL(sel, "CONFIG_RTW_NETIF_SG\n"); +#endif + +#ifdef CONFIG_RTW_WIFI_HAL + RTW_PRINT_SEL(sel, "CONFIG_RTW_WIFI_HAL\n"); +#endif + +#ifdef CONFIG_RTW_TPT_MODE + RTW_PRINT_SEL(sel, "CONFIG_RTW_TPT_MODE\n"); +#endif + #ifdef CONFIG_USB_HCI #ifdef CONFIG_SUPPORT_USB_INT RTW_PRINT_SEL(sel, "CONFIG_SUPPORT_USB_INT\n"); @@ -168,12 +178,46 @@ void dump_drv_cfg(void *sel) #ifdef CONFIG_RX_AGGREGATION RTW_PRINT_SEL(sel, "CONFIG_RX_AGGREGATION\n"); #endif +#ifdef RTW_XMIT_THREAD_HIGH_PRIORITY + RTW_PRINT_SEL(sel, "RTW_XMIT_THREAD_HIGH_PRIORITY\n"); +#endif +#ifdef RTW_XMIT_THREAD_HIGH_PRIORITY_AGG + RTW_PRINT_SEL(sel, "RTW_XMIT_THREAD_HIGH_PRIORITY_AGG\n"); +#endif #endif /*CONFIG_SDIO_HCI*/ #ifdef CONFIG_PCI_HCI #endif + RTW_PRINT_SEL(sel, "CONFIG_IFACE_NUMBER = %d\n", CONFIG_IFACE_NUMBER); +#ifdef CONFIG_MI_WITH_MBSSID_CAM + RTW_PRINT_SEL(sel, "CONFIG_MI_WITH_MBSSID_CAM\n"); +#endif +#ifdef CONFIG_SWTIMER_BASED_TXBCN + RTW_PRINT_SEL(sel, "CONFIG_SWTIMER_BASED_TXBCN\n"); +#endif +#ifdef CONFIG_FW_HANDLE_TXBCN + RTW_PRINT_SEL(sel, "CONFIG_FW_HANDLE_TXBCN\n"); + RTW_PRINT_SEL(sel, "CONFIG_LIMITED_AP_NUM = %d\n", CONFIG_LIMITED_AP_NUM); +#endif +#ifdef CONFIG_CLIENT_PORT_CFG + RTW_PRINT_SEL(sel, "CONFIG_CLIENT_PORT_CFG\n"); +#endif +#ifdef CONFIG_PCI_TX_POLLING + RTW_PRINT_SEL(sel, "CONFIG_PCI_TX_POLLING\n"); +#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); } @@ -252,8 +296,7 @@ void mac_reg_dump(void *sel, _adapter *adapter) } #endif /* CONFIG_RTL8814A */ - -#if defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) +#if defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) ||defined(CONFIG_RTL8192F) || defined(CONFIG_RTL8822C) for (i = 0x1000; i < 0x1800; i += 4) { if (j % 4 == 1) RTW_PRINT_SEL(sel, "0x%04x", i); @@ -261,7 +304,8 @@ void mac_reg_dump(void *sel, _adapter *adapter) if ((j++) % 4 == 0) _RTW_PRINT_SEL(sel, "\n"); } -#endif /* CONFIG_RTL8822B */ +#endif /* CONFIG_RTL8822B or 8821c or 8192f*/ + } void bb_reg_dump(void *sel, _adapter *adapter) @@ -277,7 +321,7 @@ void bb_reg_dump(void *sel, _adapter *adapter) _RTW_PRINT_SEL(sel, "\n"); } -#if defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) +#if defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822C) for (i = 0x1800; i < 0x2000; i += 4) { if (j % 4 == 1) RTW_PRINT_SEL(sel, "0x%04x", i); @@ -286,11 +330,47 @@ void bb_reg_dump(void *sel, _adapter *adapter) _RTW_PRINT_SEL(sel, "\n"); } #endif /* CONFIG_RTL8822B */ + +#if defined(CONFIG_RTL8822C) + for (i = 0x2c00; i < 0x2c60; i += 4) { + if (j % 4 == 1) + 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"); + } + + for (i = 0x2d00; i < 0x2df0; i += 4) { + if (j % 4 == 1) + 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"); + } + + for (i = 0x4000; i < 0x4060; i += 4) { + if (j % 4 == 1) + 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"); + } + + for (i = 0x4100; i < 0x4200; i += 4) { + if (j % 4 == 1) + 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"); + } + +#endif /* CONFIG_RTL8822C */ + } void bb_reg_dump_ex(void *sel, _adapter *adapter) { - int i, j = 1; + int i; RTW_PRINT_SEL(sel, "======= BB REG =======\n"); for (i = 0x800; i < 0x1000; i += 4) { @@ -299,7 +379,7 @@ void bb_reg_dump_ex(void *sel, _adapter *adapter) _RTW_PRINT_SEL(sel, "\n"); } -#if defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) +#if defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822C) for (i = 0x1800; i < 0x2000; i += 4) { RTW_PRINT_SEL(sel, "0x%04x", i); _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); @@ -310,16 +390,11 @@ void bb_reg_dump_ex(void *sel, _adapter *adapter) void rf_reg_dump(void *sel, _adapter *adapter) { + HAL_DATA_TYPE *hal = GET_HAL_DATA(adapter); int i, j = 1, path; u32 value; u8 rf_type = 0; - u8 path_nums = 0; - - rtw_hal_get_hwreg(adapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); - if ((RF_1T2R == rf_type) || (RF_1T1R == rf_type)) - path_nums = 1; - else - path_nums = 2; + u8 path_nums = hal->NumTotalRFPath; RTW_PRINT_SEL(sel, "======= RF REG =======\n"); @@ -336,55 +411,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); } @@ -451,11 +484,25 @@ void dump_adapters_status(void *sel, struct dvobj_priv *dvobj) int i; _adapter *iface; u8 u_ch, u_bw, u_offset; - +#if (defined(CONFIG_SUPPORT_MULTI_BCN) && defined(CONFIG_FW_HANDLE_TXBCN)) || defined(CONFIG_CLIENT_PORT_CFG) + char str_val[64] = {'\0'}; +#endif dump_mi_status(sel, dvobj); +#if defined(CONFIG_SUPPORT_MULTI_BCN) && defined(CONFIG_FW_HANDLE_TXBCN) + RTW_PRINT_SEL(sel, "[AP] LIMITED_AP_NUM:%d\n", CONFIG_LIMITED_AP_NUM); + RTW_PRINT_SEL(sel, "[AP] vap_map:0x%02x\n", dvobj->vap_map); +#endif +#ifdef CONFIG_HW_P0_TSF_SYNC + RTW_PRINT_SEL(sel, "[AP] p0 tsf sync port = %d\n", dvobj->p0_tsf.sync_port); + RTW_PRINT_SEL(sel, "[AP] p0 tsf timer offset = %d\n", dvobj->p0_tsf.offset); +#endif +#ifdef CONFIG_CLIENT_PORT_CFG + RTW_PRINT_SEL(sel, "[CLT] clt_num = %d\n", dvobj->clt_port.num); + RTW_PRINT_SEL(sel, "[CLT] clt_map = 0x%02x\n", dvobj->clt_port.bmp); +#endif #ifdef CONFIG_FW_MULTI_PORT_SUPPORT - RTW_PRINT_SEL(sel, "default port id:%d\n\n", dvobj->default_port_id); + RTW_PRINT_SEL(sel, "[MI] default port id:%d\n\n", dvobj->dft.port_id); #endif /* CONFIG_FW_MULTI_PORT_SUPPORT */ RTW_PRINT_SEL(sel, "dev status:%s%s\n\n" @@ -480,14 +527,40 @@ void dump_adapters_status(void *sel, struct dvobj_priv *dvobj) #define P2P_INFO_VALUE_FMT "" #define P2P_INFO_VALUE_ARG #define P2P_INFO_DASH +#endif + +#ifdef DBG_TSF_UPDATE +#define TSF_PAUSE_TIME_TITLE_FMT " %-5s" +#define TSF_PAUSE_TIME_TITLE_ARG , "tsfup" +#define TSF_PAUSE_TIME_VALUE_FMT " %5d" +#define TSF_PAUSE_TIME_VALUE_ARG , ((iface->mlmeextpriv.tsf_update_required && iface->mlmeextpriv.tsf_update_pause_stime) ? (rtw_get_passing_time_ms(iface->mlmeextpriv.tsf_update_pause_stime) > 99999 ? 99999 : rtw_get_passing_time_ms(iface->mlmeextpriv.tsf_update_pause_stime)) : 0) +#else +#define TSF_PAUSE_TIME_TITLE_FMT "" +#define TSF_PAUSE_TIME_TITLE_ARG +#define TSF_PAUSE_TIME_VALUE_FMT "" +#define TSF_PAUSE_TIME_VALUE_ARG +#endif + +#if (defined(CONFIG_SUPPORT_MULTI_BCN) && defined(CONFIG_FW_HANDLE_TXBCN)) || defined(CONFIG_CLIENT_PORT_CFG) +#define INFO_FMT " %-4s" +#define INFO_ARG , "info" +#define INFO_CNT_FMT " %-20s" +#define INFO_CNT_ARG , str_val +#else +#define INFO_FMT "" +#define INFO_ARG +#define INFO_CNT_FMT "" +#define INFO_CNT_ARG #endif RTW_PRINT_SEL(sel, "%-2s %-15s %c %-3s %-3s %-3s %-17s %-4s %-7s" P2P_INFO_TITLE_FMT - " %s\n" + TSF_PAUSE_TIME_TITLE_FMT + " %s"INFO_FMT"\n" , "id", "ifname", ' ', "bup", "nup", "ncd", "macaddr", "port", "ch" P2P_INFO_TITLE_ARG - , "status"); + TSF_PAUSE_TIME_TITLE_ARG + , "status"INFO_ARG); RTW_PRINT_SEL(sel, "---------------------------------------------------------------" P2P_INFO_DASH @@ -496,21 +569,64 @@ void dump_adapters_status(void *sel, struct dvobj_priv *dvobj) for (i = 0; i < dvobj->iface_nums; i++) { iface = dvobj->padapters[i]; if (iface) { + #if (defined(CONFIG_SUPPORT_MULTI_BCN) && defined(CONFIG_FW_HANDLE_TXBCN)) || defined(CONFIG_CLIENT_PORT_CFG) + _rtw_memset(&str_val, '\0', sizeof(str_val)); + #endif + #if defined(CONFIG_SUPPORT_MULTI_BCN) && defined(CONFIG_FW_HANDLE_TXBCN) + if (MLME_IS_AP(iface) || MLME_IS_MESH(iface)) { + u8 len; + char *p = str_val; + char tmp_str[10] = {'\0'}; + + len = snprintf(tmp_str, sizeof(tmp_str), "%s", "ap_id:"); + strncpy(p, tmp_str, len); + p += len; + _rtw_memset(&tmp_str, '\0', sizeof(tmp_str)); + #ifdef DBG_HW_PORT + len = snprintf(tmp_str, sizeof(tmp_str), "%d (%d,%d)", iface->vap_id, iface->hw_port, iface->client_port); + #else + len = snprintf(tmp_str, sizeof(tmp_str), "%d", iface->vap_id); + #endif + strncpy(p, tmp_str, len); + } + #endif + #ifdef CONFIG_CLIENT_PORT_CFG + if (MLME_IS_STA(iface)) { + u8 len; + char *p = str_val; + char tmp_str[10] = {'\0'}; + + len = snprintf(tmp_str, sizeof(tmp_str), "%s", "c_pid:"); + strncpy(p, tmp_str, len); + p += len; + _rtw_memset(&tmp_str, '\0', sizeof(tmp_str)); + #ifdef DBG_HW_PORT + len = snprintf(tmp_str, sizeof(tmp_str), "%d (%d,%d)", iface->client_port, iface->hw_port, iface->client_port); + #else + len = snprintf(tmp_str, sizeof(tmp_str), "%d", iface->client_port); + #endif + strncpy(p, tmp_str, len); + } + #endif + RTW_PRINT_SEL(sel, "%2d %-15s %c %3u %3u %3u "MAC_FMT" %4hhu %3u,%u,%u" P2P_INFO_VALUE_FMT - " "MLME_STATE_FMT"\n" + TSF_PAUSE_TIME_VALUE_FMT + " "MLME_STATE_FMT" " INFO_CNT_FMT"\n" , i, iface->registered ? ADPT_ARG(iface) : NULL , iface->registered ? 'R' : ' ' , iface->bup , iface->netif_up , iface->net_closed , MAC_ARG(adapter_mac_addr(iface)) - , get_hw_port(iface) + , rtw_hal_get_port(iface) , iface->mlmeextpriv.cur_channel , iface->mlmeextpriv.cur_bwmode , iface->mlmeextpriv.cur_ch_offset P2P_INFO_VALUE_ARG + TSF_PAUSE_TIME_VALUE_ARG , MLME_STATE_ARG(iface) + INFO_CNT_ARG ); } } @@ -525,31 +641,16 @@ void dump_adapters_status(void *sel, struct dvobj_priv *dvobj) , u_ch, u_bw, u_offset ); - RTW_PRINT_SEL(sel, "%55s %3u,%u,%u\n" + RTW_PRINT_SEL(sel, "%55s %3u,%u,%u offch_state:%d\n" , "oper:" , dvobj->oper_channel , dvobj->oper_bwmode , dvobj->oper_ch_offset + , rfctl->offch_state ); #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 @@ -557,21 +658,29 @@ 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); - 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); + + rtw_get_ch_waiting_ms(rfctl + , 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"); } #endif /* CONFIG_DFS_MASTER */ @@ -724,7 +833,6 @@ int proc_get_read_reg(struct seq_file *m, void *v) ssize_t proc_set_read_reg(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) { - struct net_device *dev = data; char tmp[16]; u32 addr, len; @@ -780,12 +888,12 @@ int proc_get_rx_stat(struct seq_file *m, void *v) if (pstats == NULL) continue; - if ((_rtw_memcmp(psta->hwaddr, bc_addr, 6) != _TRUE) - && (_rtw_memcmp(psta->hwaddr, null_addr, 6) != _TRUE) - && (_rtw_memcmp(psta->hwaddr, adapter_mac_addr(adapter), 6) != _TRUE)) { - RTW_PRINT_SEL(m, "MAC :\t\t"MAC_FMT "\n", MAC_ARG(psta->hwaddr)); - RTW_PRINT_SEL(m, "data_rx_cnt :\t%llu\n", pstats->rx_data_pkts - pstats->rx_data_last_pkts); - pstats->rx_data_last_pkts = pstats->rx_data_pkts; + if ((_rtw_memcmp(psta->cmn.mac_addr, bc_addr, ETH_ALEN) != _TRUE) + && (_rtw_memcmp(psta->cmn.mac_addr, null_addr, ETH_ALEN) != _TRUE) + && (_rtw_memcmp(psta->cmn.mac_addr, adapter_mac_addr(adapter), ETH_ALEN) != _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"); @@ -810,9 +918,12 @@ int proc_get_tx_stat(struct seq_file *m, void *v) _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 sta_info *psta = NULL; + u8 sta_mac[NUM_STA][ETH_ALEN] = {{0}}; + uint mac_id[NUM_STA]; struct stainfo_stats *pstats = NULL; struct sta_priv *pstapriv = &(adapter->stapriv); + struct sta_priv *pstapriv_primary = &(GET_PRIMARY_ADAPTER(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}; @@ -820,39 +931,54 @@ int proc_get_tx_stat(struct seq_file *m, void *v) _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->hwaddr, bc_addr, 6) != _TRUE) - && (_rtw_memcmp(psta->hwaddr, null_addr, 6) != _TRUE) - && (_rtw_memcmp(psta->hwaddr, adapter_mac_addr(adapter), 6) != _TRUE)) { - sta_rec[macid_rec_idx++] = psta; + if ((_rtw_memcmp(psta->cmn.mac_addr, bc_addr, ETH_ALEN) != _TRUE) + && (_rtw_memcmp(psta->cmn.mac_addr, null_addr, ETH_ALEN) != _TRUE) + && (_rtw_memcmp(psta->cmn.mac_addr, adapter_mac_addr(adapter), ETH_ALEN) != _TRUE)) { + _rtw_memcpy(&sta_mac[macid_rec_idx][0], psta->cmn.mac_addr, ETH_ALEN); + mac_id[macid_rec_idx] = psta->cmn.mac_id; + macid_rec_idx++; } } } _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]->mac_id); + _rtw_memcpy(pstapriv_primary->c2h_sta_mac, &sta_mac[i][0], ETH_ALEN); + pstapriv_primary->c2h_adapter_id = adapter->iface_id; rtw_sctx_init(&gotc2h, 60); - pstapriv->gotc2h = &gotc2h; + pstapriv_primary->gotc2h = &gotc2h; + rtw_hal_reqtxrpt(adapter, mac_id[i]); if (rtw_sctx_wait(&gotc2h, __func__)) { - RTW_PRINT_SEL(m, "MAC :\t\t"MAC_FMT "\n", MAC_ARG(sta_rec[i]->hwaddr)); - 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); + psta = rtw_get_stainfo(pstapriv, &sta_mac[i][0]); + if(psta) { + pstats = &psta->sta_stats; +#ifndef ROKU_PRIVATE + 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, "MAC: " MAC_FMT " sent: %u fail: %u retry: %u\n", + MAC_ARG(&sta_mac[i][0]), pstats->tx_ok_cnt, pstats->tx_fail_cnt, pstats->tx_retry_cnt); +#endif /* ROKU_PRIVATE */ + + } else + RTW_PRINT_SEL(m, "STA is gone\n"); } else { + //to avoid c2h modify counters + pstapriv_primary->gotc2h = NULL; + _rtw_memset(pstapriv_primary->c2h_sta_mac, 0, ETH_ALEN); + pstapriv_primary->c2h_adapter_id = CONFIG_IFACE_NUMBER; RTW_PRINT_SEL(m, "Warming : Query timeout, operation abort!!\n"); - RTW_PRINT_SEL(m, "\n"); break; } + pstapriv_primary->gotc2h = NULL; + _rtw_memset(pstapriv_primary->c2h_sta_mac, 0, ETH_ALEN); + pstapriv_primary->c2h_adapter_id = CONFIG_IFACE_NUMBER; } return 0; } @@ -957,11 +1083,11 @@ int proc_get_roam_param(struct seq_file *m, void *v) _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); struct mlme_priv *mlme = &adapter->mlmepriv; - RTW_PRINT_SEL(m, "%12s %12s %11s %14s\n", "rssi_diff_th", "scanr_exp_ms", "scan_int_ms", "rssi_threshold"); - RTW_PRINT_SEL(m, "%-12u %-12u %-11u %-14u\n" + RTW_PRINT_SEL(m, "%12s %15s %26s %16s\n", "rssi_diff_th", "scanr_exp_ms", "scan_interval(unit:2 sec)", "rssi_threshold"); + RTW_PRINT_SEL(m, "%-15u %-13u %-27u %-11u\n" , mlme->roam_rssi_diff_th , mlme->roam_scanr_exp_ms - , mlme->roam_scan_int_ms + , mlme->roam_scan_int , mlme->roam_rssi_threshold ); @@ -977,7 +1103,7 @@ ssize_t proc_set_roam_param(struct file *file, const char __user *buffer, size_t char tmp[32]; u8 rssi_diff_th; u32 scanr_exp_ms; - u32 scan_int_ms; + u32 scan_int; u8 rssi_threshold; if (count < 1) @@ -990,14 +1116,14 @@ ssize_t proc_set_roam_param(struct file *file, const char __user *buffer, size_t if (buffer && !copy_from_user(tmp, buffer, count)) { - int num = sscanf(tmp, "%hhu %u %u %hhu", &rssi_diff_th, &scanr_exp_ms, &scan_int_ms, &rssi_threshold); + int num = sscanf(tmp, "%hhu %u %u %hhu", &rssi_diff_th, &scanr_exp_ms, &scan_int, &rssi_threshold); if (num >= 1) mlme->roam_rssi_diff_th = rssi_diff_th; if (num >= 2) mlme->roam_scanr_exp_ms = scanr_exp_ms; if (num >= 3) - mlme->roam_scan_int_ms = scan_int_ms; + mlme->roam_scan_int = scan_int; if (num >= 4) mlme->roam_rssi_threshold = rssi_threshold; } @@ -1056,7 +1182,7 @@ ssize_t proc_set_ft_flags(struct file *file, const char __user *buffer, size_t c int num = sscanf(tmp, "%hhx", &flags); if (num == 1) - adapter->mlmepriv.ftpriv.ft_flags = flags; + adapter->mlmepriv.ft_roam.ft_flags = flags; } return count; @@ -1068,7 +1194,7 @@ int proc_get_ft_flags(struct seq_file *m, void *v) struct net_device *dev = m->private; _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); - RTW_PRINT_SEL(m, "0x%02x\n", adapter->mlmepriv.ftpriv.ft_flags); + RTW_PRINT_SEL(m, "0x%02x\n", adapter->mlmepriv.ft_roam.ft_flags); return 0; } @@ -1252,26 +1378,26 @@ int proc_get_scan_abort(struct seq_file *m, void *v) return 0; } -#ifdef CONFIG_SCAN_BACKOP -int proc_get_backop_flags_sta(struct seq_file *m, void *v) +#ifdef CONFIG_RTW_REPEATER_SON +int proc_get_rson_data(struct seq_file *m, void *v) { struct net_device *dev = m->private; - _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); - struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; - - RTW_PRINT_SEL(m, "0x%02x\n", mlmeext_scan_backop_flags_sta(mlmeext)); + _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_backop_flags_sta(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +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 *adapter = (_adapter *)rtw_netdev_priv(dev); - struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; - - char tmp[32]; - u8 flags; + _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; @@ -1282,56 +1408,21 @@ ssize_t proc_set_backop_flags_sta(struct file *file, const char __user *buffer, } if (buffer && !copy_from_user(tmp, buffer, count)) { - - int num = sscanf(tmp, "%hhx", &flags); - - if (num == 1) - mlmeext_assign_scan_backop_flags_sta(mlmeext, flags); + 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; } - -int proc_get_backop_flags_ap(struct seq_file *m, void *v) -{ - struct net_device *dev = m->private; - _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); - struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; - - RTW_PRINT_SEL(m, "0x%02x\n", mlmeext_scan_backop_flags_ap(mlmeext)); - - return 0; -} - -ssize_t proc_set_backop_flags_ap(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_ext_priv *mlmeext = &adapter->mlmeextpriv; - - char tmp[32]; - u8 flags; - - 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", &flags); - - if (num == 1) - mlmeext_assign_scan_backop_flags_ap(mlmeext, flags); - } - - return count; -} - -#endif /* CONFIG_SCAN_BACKOP */ +#endif /*CONFIG_RTW_REPEATER_SON*/ int proc_get_survey_info(struct seq_file *m, void *v) { @@ -1350,16 +1441,25 @@ int proc_get_survey_info(struct seq_file *m, void *v) char flag_str[64]; int ielen = 0; u32 wpsielen = 0; +#ifdef CONFIG_RTW_MESH + const char *ssid_title_str = "ssid/mesh_id"; +#else + const char *ssid_title_str = "ssid"; +#endif _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; - RTW_PRINT_SEL(m, "%5s %-17s %3s %-3s %-4s %-4s %5s %32s %32s\n", "index", "bssid", "ch", "RSSI", "SdBm", "Noise", "age", "flag", "ssid"); +#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_title_str); while (1) { if (rtw_end_of_queue_search(phead, plist) == _TRUE) break; @@ -1375,8 +1475,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); @@ -1390,21 +1491,25 @@ int proc_get_survey_info(struct seq_file *m, void *v) (ie_wpa2) ? "[WPA2]" : "", (!ie_wpa && !ie_wpa && ie_cap & BIT(4)) ? "[WEP]" : "", (ie_wps) ? "[WPS]" : "", - (pnetwork->network.InfrastructureMode == Ndis802_11IBSS) ? "[IBSS]" : "", + (pnetwork->network.InfrastructureMode == Ndis802_11IBSS) ? "[IBSS]" : + (pnetwork->network.InfrastructureMode == Ndis802_11_mesh) ? "[MESH]" : "", (ie_cap & BIT(0)) ? "[ESS]" : "", (ie_p2p) ? "[P2P]" : ""); RTW_PRINT_SEL(m, "%5d "MAC_FMT" %3d %3d %4d %4d %5d %32s %32s\n", - ++index, - MAC_ARG(pnetwork->network.MacAddress), - pnetwork->network.Configuration.DSConfig, - (int)pnetwork->network.Rssi, - notify_signal, - notify_noise, - rtw_get_passing_time_ms((u32)pnetwork->last_scanned), - flag_str, - pnetwork->network.Ssid.Ssid); + ++index, + MAC_ARG(pnetwork->network.MacAddress), + pnetwork->network.Configuration.DSConfig, + (int)pnetwork->network.Rssi, + notify_signal, + notify_noise, + rtw_get_passing_time_ms(pnetwork->last_scanned), + flag_str, + pnetwork->network.InfrastructureMode == Ndis802_11_mesh ? pnetwork->network.mesh_id.Ssid : pnetwork->network.Ssid.Ssid + ); plist = get_next(plist); } +#endif +_exit: _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); return 0; @@ -1412,19 +1517,28 @@ 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) { - _irqL irqL; struct net_device *dev = data; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); - bool need_indicate_scan_done = _FALSE; u8 _status = _FALSE; - NDIS_802_11_SSID ssid[RTW_SSID_SCAN_AMOUNT]; - + u8 ssc_chk; if (count < 1) return -EFAULT; +#if 1 + ssc_chk = rtw_sitesurvey_condition_check(padapter, _FALSE); + if (ssc_chk != SS_ALLOW) + goto exit; + + rtw_ps_deny(padapter, PS_DENY_SCAN); + if (_FAIL == rtw_pwr_wakeup(padapter)) + goto cancel_ps_deny; + if (!rtw_is_adapter_up(padapter)) { + RTW_INFO("scan abort!! adapter cannot use\n"); + goto cancel_ps_deny; + } +#else #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; } @@ -1464,13 +1578,76 @@ 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); +#endif + _status = rtw_set_802_11_bssid_list_scan(padapter, NULL); cancel_ps_deny: rtw_ps_deny_cancel(padapter, PS_DENY_SCAN); exit: return count; } +#ifdef ROKU_PRIVATE +int proc_get_infra_ap(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + struct sta_info *psta; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct ht_priv_infra_ap *phtpriv = &pmlmepriv->htpriv_infra_ap; +#ifdef CONFIG_80211AC_VHT + struct vht_priv_infra_ap *pvhtpriv = &pmlmepriv->vhtpriv_infra_ap; +#endif + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + struct wlan_network *cur_network = &(pmlmepriv->cur_network); + struct sta_priv *pstapriv = &padapter->stapriv; + + if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { + psta = rtw_get_stainfo(pstapriv, cur_network->network.MacAddress); + if (psta) { + unsigned int i, j; + unsigned int Rx_ss = 0, Tx_ss = 0; + struct recv_reorder_ctrl *preorder_ctrl; + + RTW_PRINT_SEL(m, "SSID=%s\n", pmlmeinfo->network.Ssid.Ssid); + RTW_PRINT_SEL(m, "sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->cmn.mac_addr)); + RTW_PRINT_SEL(m, "Supported rate="); + for (i = 0; i < NDIS_802_11_LENGTH_RATES_EX; i++) { + if (pmlmeinfo->SupportedRates_infra_ap[i] == 0) + break; + RTW_PRINT_SEL(m, " 0x%x", pmlmeinfo->SupportedRates_infra_ap[i]); + } + RTW_PRINT_SEL(m, "\n"); +#ifdef CONFIG_80211N_HT + if (pmlmeinfo->ht_vht_received & BIT(0)) { + RTW_PRINT_SEL(m, "Supported MCS set="); + for (i = 0; i < 16 ; i++) + RTW_PRINT_SEL(m, " 0x%02x", phtpriv->MCS_set_infra_ap[i]); + RTW_PRINT_SEL(m, "\n"); + RTW_PRINT_SEL(m, "highest supported data rate=0x%x\n", phtpriv->rx_highest_data_rate_infra_ap); + RTW_PRINT_SEL(m, "HT_supported_channel_width_set=0x%x\n", phtpriv->channel_width_infra_ap); + RTW_PRINT_SEL(m, "sgi_20m=%d, sgi_40m=%d\n", phtpriv->sgi_20m_infra_ap, phtpriv->sgi_40m_infra_ap); + RTW_PRINT_SEL(m, "ldpc_cap=0x%x, stbc_cap=0x%x\n", phtpriv->ldpc_cap_infra_ap, phtpriv->stbc_cap_infra_ap); + RTW_PRINT_SEL(m, "HT_number_of_stream=%d\n", phtpriv->Rx_ss_infra_ap); + } +#endif + +#ifdef CONFIG_80211AC_VHT + if (pmlmeinfo->ht_vht_received & BIT(1)) { + RTW_PRINT_SEL(m, "VHT_supported_channel_width_set=0x%x\n", pvhtpriv->channel_width_infra_ap); + RTW_PRINT_SEL(m, "vht_ldpc_cap=0x%x, vht_stbc_cap=0x%x, vht_beamform_cap=0x%x\n", pvhtpriv->ldpc_cap_infra_ap, pvhtpriv->stbc_cap_infra_ap, pvhtpriv->beamform_cap_infra_ap); + RTW_PRINT_SEL(m, "Rx_vht_mcs_map=0x%x, Tx_vht_mcs_map=0x%x\n", *(u16 *)pvhtpriv->vht_mcs_map_infra_ap, *(u16 *)pvhtpriv->vht_mcs_map_tx_infra_ap); + RTW_PRINT_SEL(m, "VHT_number_of_stream=%d\n", pvhtpriv->number_of_streams_infra_ap); + } +#endif + } else + RTW_PRINT_SEL(m, "can't get sta's macaddr, cur_network's macaddr:" MAC_FMT "\n", MAC_ARG(cur_network->network.MacAddress)); + } else + RTW_PRINT_SEL(m, "this only applies to STA mode\n"); + return 0; +} + +#endif /* ROKU_PRIVATE */ int proc_get_ap_info(struct seq_file *m, void *v) { @@ -1480,21 +1657,26 @@ int proc_get_ap_info(struct seq_file *m, void *v) struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; struct wlan_network *cur_network = &(pmlmepriv->cur_network); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); struct sta_priv *pstapriv = &padapter->stapriv; + /* ap vendor */ + char vendor[VENDOR_NAME_LEN] = {0}; + get_assoc_AP_Vendor(vendor,pmlmeinfo->assoc_AP_vendor); + RTW_PRINT_SEL(m,"AP Vendor %s\n", vendor); + 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); @@ -1504,7 +1686,6 @@ int proc_get_ap_info(struct seq_file *m, void *v) RTW_PRINT_SEL(m, "vht_ldpc_cap=0x%x, vht_stbc_cap=0x%x, vht_beamform_cap=0x%x\n", psta->vhtpriv.ldpc_cap, psta->vhtpriv.stbc_cap, psta->vhtpriv.beamform_cap); RTW_PRINT_SEL(m, "vht_mcs_map=0x%x, vht_highest_rate=0x%x, vht_ampdu_len=%d\n", *(u16 *)psta->vhtpriv.vht_mcs_map, psta->vhtpriv.vht_highest_rate, psta->vhtpriv.ampdu_len); #endif - sta_rx_reorder_ctl_dump(m, psta); } else RTW_PRINT_SEL(m, "can't get sta's macaddr, cur_network's macaddr:" MAC_FMT "\n", MAC_ARG(cur_network->network.MacAddress)); @@ -1516,8 +1697,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; @@ -1529,13 +1709,14 @@ ssize_t proc_reset_trx_info(struct file *file, const char __user *buffer, size_t if (buffer && !copy_from_user(cmd, buffer, count)) { 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; + if (num == 1 && 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; } } @@ -1549,9 +1730,15 @@ 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; + u16 vo_params[4], vi_params[4], be_params[4], bk_params[4]; + + padapter->hal_func.read_wmmedca_reg(padapter, vo_params, vi_params, be_params, bk_params); + + RTW_PRINT_SEL(m, "wmm_edca_vo, aifs = %u us, cw_min = %u, cw_max = %u, txop_limit = %u us\n", vo_params[0], vo_params[1], vo_params[2], vo_params[3]); + RTW_PRINT_SEL(m, "wmm_edca_vi, aifs = %u us, cw_min = %u, cw_max = %u, txop_limit = %u us\n", vi_params[0], vi_params[1], vi_params[2], vi_params[3]); + RTW_PRINT_SEL(m, "wmm_edca_be, aifs = %u us, cw_min = %u, cw_max = %u, txop_limit = %u us\n", be_params[0], be_params[1], be_params[2], be_params[3]); + RTW_PRINT_SEL(m, "wmm_edca_bk, aifs = %u us, cw_min = %u, cw_max = %u, txop_limit = %u us\n", bk_params[0], bk_params[1], bk_params[2], bk_params[3]); dump_os_queue(m, padapter); @@ -1567,65 +1754,32 @@ 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; } -int proc_get_dis_pwt(struct seq_file *m, void *v) -{ - struct net_device *dev = m->private; - _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - u8 dis_pwt = 0; - rtw_hal_get_def_var(padapter, HAL_DEF_DBG_DIS_PWT, &(dis_pwt)); - RTW_PRINT_SEL(m, " Tx Power training mode:%s\n", (dis_pwt == _TRUE) ? "Disable" : "Enable"); - return 0; -} -ssize_t proc_set_dis_pwt(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[4] = {0}; - u8 dis_pwt = 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, "%hhx", &dis_pwt); - RTW_INFO("Set Tx Power training mode:%s\n", (dis_pwt == _TRUE) ? "Disable" : "Enable"); - - if (num >= 1) - rtw_hal_set_def_var(padapter, HAL_DEF_DBG_DIS_PWT, &(dis_pwt)); - } - - return count; - -} - 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; @@ -1645,13 +1799,124 @@ int proc_get_rate_ctl(struct seq_file *m, void *v) return 0; } +#ifdef CONFIG_PHDYM_FW_FIXRATE +void phydm_fw_fix_rate(void *dm_void, u8 en, u8 macid, u8 bw, u8 rate); +#endif ssize_t proc_set_rate_ctl(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 fix_rate; - u8 data_fb; + u8 fix_rate = 0xFF; +#ifdef CONFIG_PHDYM_FW_FIXRATE + u8 bw = 0; +#else + u8 data_fb = 0; +#endif + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (buffer && !copy_from_user(tmp, buffer, count)) { +#ifdef CONFIG_PHDYM_FW_FIXRATE + struct dm_struct *dm = adapter_to_phydm(adapter); + u8 en = 1, macid = 255; + _irqL irqL; + _list *plist, *phead; + struct sta_info *psta = NULL; + struct sta_priv *pstapriv = &(adapter->stapriv); + u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; + u8 null_addr[ETH_ALEN] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; + uint mac_id[NUM_STA]; + int i, macid_rec_idx = 0; + int num = sscanf(tmp, "%hhx %hhu %hhu", &fix_rate, &bw, &macid); + + if (num < 1) { + RTW_INFO("Invalid input!! \"ex: echo > /proc/.../rate_ctl\"\n"); + return count; + } + + if ((fix_rate == 0) || (fix_rate == 0xFF)) + en = 0; + + if (macid != 255) { + RTW_INFO("Call phydm_fw_fix_rate()--en[%d] mac_id[%d] bw[%d] fix_rate[%d]\n", en, macid, bw, fix_rate); + phydm_fw_fix_rate(dm, en, macid, bw, fix_rate); + return count; + } + + /* no specific macid, apply to all macids except bc/mc macid */ + _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 ((_rtw_memcmp(psta->cmn.mac_addr, bc_addr, ETH_ALEN) != _TRUE) + && (_rtw_memcmp(psta->cmn.mac_addr, null_addr, ETH_ALEN) != _TRUE) + && (_rtw_memcmp(psta->cmn.mac_addr, adapter_mac_addr(adapter), ETH_ALEN) != _TRUE)) { + mac_id[macid_rec_idx] = psta->cmn.mac_id; + macid_rec_idx++; + } + } + } + _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); + + for (i = 0; i < macid_rec_idx; i++) { + RTW_INFO("Call phydm_fw_fix_rate()--en[%d] mac_id[%d] bw[%d] fix_rate[%d]\n", en, mac_id[i], bw, fix_rate); + phydm_fw_fix_rate(dm, en, mac_id[i], bw, fix_rate); + } +#else + int num = sscanf(tmp, "%hhx %hhu", &fix_rate, &data_fb); + + if (num >= 1) { + 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)); + } + if (num >= 2) + adapter->data_fb = data_fb ? 1 : 0; +#endif + } + + 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); + + 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); + char tmp[32]; + u8 bmc_tx_rate; if (count < 1) return -EFAULT; @@ -1663,26 +1928,21 @@ ssize_t proc_set_rate_ctl(struct file *file, const char __user *buffer, size_t c if (buffer && !copy_from_user(tmp, buffer, count)) { - int num = sscanf(tmp, "%hhx %hhu", &fix_rate, &data_fb); + int num = sscanf(tmp, "%hhx", &bmc_tx_rate); - if (num >= 1) { - u8 fix_rate_ori = adapter->fix_rate; - - adapter->fix_rate = fix_rate; - if (adapter->fix_bw != 0xFF && fix_rate_ori != fix_rate) - rtw_update_tx_rate_bmp(adapter_to_dvobj(adapter)); - } - if (num >= 2) - adapter->data_fb = data_fb ? 1 : 0; + 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); @@ -1799,20 +2059,42 @@ ssize_t proc_set_rx_cnt_dump(struct file *file, const char __user *buffer, size_ int num = sscanf(tmp, "%hhx", &dump_rx_cnt_mode); - rtw_dump_phy_rxcnts_preprocess(adapter, dump_rx_cnt_mode); - adapter->dump_rx_cnt_mode = dump_rx_cnt_mode; - + if (num == 1) { + rtw_dump_phy_rxcnts_preprocess(adapter, dump_rx_cnt_mode); + adapter->dump_rx_cnt_mode = dump_rx_cnt_mode; + } } 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; - _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); char tmp[32]; - int num; if (count < 1) return -EFAULT; @@ -1823,17 +2105,26 @@ ssize_t proc_set_fwdl_test_case(struct file *file, const char __user *buffer, si } if (buffer && !copy_from_user(tmp, buffer, count)) - num = sscanf(tmp, "%hhu %hhu", &fwdl_test_chksum_fail, &fwdl_test_wintint_rdy_fail); + sscanf(tmp, "%hhu %hhu", &fwdl_test_chksum_fail, &fwdl_test_wintint_rdy_fail); 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; - _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); char tmp[32]; - int num; if (count < 1) return -EFAULT; @@ -1844,35 +2135,58 @@ ssize_t proc_set_del_rx_ampdu_test_case(struct file *file, const char __user *bu } if (buffer && !copy_from_user(tmp, buffer, count)) - num = sscanf(tmp, "%hhu", &del_rx_ampdu_test_no_tx_fail); + sscanf(tmp, "%hhu", &del_rx_ampdu_test_no_tx_fail); return count; } -#ifdef CONFIG_DFS_MASTER -int proc_get_dfs_master_test_case(struct seq_file *m, void *v) +static u32 g_wait_hiq_empty_ms = 0; + +u32 rtw_get_wait_hiq_empty_ms(void) { - struct net_device *dev = m->private; - _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); - struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); - - RTW_PRINT_SEL(m, "%-24s %-19s\n", "radar_detect_trigger_non", "choose_dfs_ch_first"); - RTW_PRINT_SEL(m, "%24hhu %19hhu\n" - , rfctl->dbg_dfs_master_radar_detect_trigger_non - , rfctl->dbg_dfs_master_choose_dfs_ch_first - ); - - return 0; + return g_wait_hiq_empty_ms; } -ssize_t proc_set_dfs_master_test_case(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +ssize_t proc_set_wait_hiq_empty(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + 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)) + sscanf(tmp, "%u", &g_wait_hiq_empty_ms); + + return count; +} + +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 *adapter = (_adapter *)rtw_netdev_priv(dev); - struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); char tmp[32]; - u8 radar_detect_trigger_non; - u8 choose_dfs_ch_first; if (count < 1) return -EFAULT; @@ -1883,24 +2197,36 @@ ssize_t proc_set_dfs_master_test_case(struct file *file, const char __user *buff } if (buffer && !copy_from_user(tmp, buffer, count)) { - int num = sscanf(tmp, "%hhu %hhu", &radar_detect_trigger_non, &choose_dfs_ch_first); + u32 wait_ms = 0; + u8 force_fail = 0; + int num = sscanf(tmp, "%u %hhu", &wait_ms, &force_fail); if (num >= 1) - rfctl->dbg_dfs_master_radar_detect_trigger_non = radar_detect_trigger_non; + sta_linking_test_wait_ms = wait_ms; if (num >= 2) - rfctl->dbg_dfs_master_choose_dfs_ch_first = choose_dfs_ch_first; + sta_linking_test_force_fail = force_fail; } return count; } -#endif /* CONFIG_DFS_MASTER */ -ssize_t proc_set_wait_hiq_empty(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +#ifdef CONFIG_AP_MODE +static u16 ap_linking_test_force_auth_fail = 0; +static u16 ap_linking_test_force_asoc_fail = 0; + +u16 rtw_ap_linking_test_force_auth_fail(void) +{ + return ap_linking_test_force_auth_fail; +} + +u16 rtw_ap_linking_test_force_asoc_fail(void) +{ + return ap_linking_test_force_asoc_fail; +} + +ssize_t proc_set_ap_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]; - int num; if (count < 1) return -EFAULT; @@ -1910,13 +2236,22 @@ ssize_t proc_set_wait_hiq_empty(struct file *file, const char __user *buffer, si return -EFAULT; } - if (buffer && !copy_from_user(tmp, buffer, count)) - num = sscanf(tmp, "%u", &g_wait_hiq_empty_ms); + if (buffer && !copy_from_user(tmp, buffer, count)) { + u16 force_auth_fail = 0; + u16 force_asoc_fail = 0; + int num = sscanf(tmp, "%hu %hu", &force_auth_fail, &force_asoc_fail); + + if (num >= 1) + ap_linking_test_force_auth_fail = force_auth_fail; + if (num >= 2) + ap_linking_test_force_asoc_fail = force_asoc_fail; + } return count; } +#endif /* CONFIG_AP_MODE */ -int proc_get_suspend_resume_info(struct seq_file *m, void *v) +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); @@ -1951,9 +2286,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 (num == 1 && ps_dbg_cmd_id == 1) /*Clean all*/ + _rtw_memset(pdbgpriv, 0, sizeof(struct debug_priv)); + + } + + return count; +} + #ifdef CONFIG_DBG_COUNTER @@ -2262,7 +2627,7 @@ ssize_t proc_set_hw_status(struct file *file, const char __user *buffer, size_t int num = sscanf(tmp, "%d ", &enable); - if (regsty && enable <= 1) { + if (num == 1 && regsty && enable <= 1) { regsty->check_hw_status = enable; RTW_INFO("check_hw_status=%d\n", regsty->check_hw_status); } @@ -2271,14 +2636,68 @@ ssize_t proc_set_hw_status(struct file *file, const char __user *buffer, size_t return count; } +#ifdef CONFIG_HUAWEI_PROC +int proc_get_huawei_trx_info(struct seq_file *sel, void *v) +{ + struct net_device *dev = sel->private; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct dm_struct *dm = adapter_to_phydm(padapter); + struct sta_info *psta; + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); + struct ra_sta_info *ra_info; + u8 curr_tx_sgi = _FALSE; + u8 curr_tx_rate = 0; + u8 mac_id; +#ifdef DBG_RX_SIGNAL_DISPLAY_RAW_DATA + u8 isCCKrate, rf_path; + PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); + struct rx_raw_rssi *psample_pkt_rssi = &padapter->recvpriv.raw_rssi_info; +#endif + + if (!dm->is_linked) { + RTW_PRINT_SEL(sel, "NO link\n\n"); + return 0; + } + + /*============ tx info ============ */ + for (mac_id = 0; mac_id < macid_ctl->num; mac_id++) { + if (rtw_macid_is_used(macid_ctl, mac_id) && !rtw_macid_is_bmc(macid_ctl, mac_id)) { + psta = macid_ctl->sta[mac_id]; + if (!psta) + continue; + + RTW_PRINT_SEL(sel, "STA [" MAC_FMT "]\n", MAC_ARG(psta->cmn.mac_addr)); + + ra_info = &psta->cmn.ra_info; + curr_tx_sgi = rtw_get_current_tx_sgi(padapter, psta); + curr_tx_rate = rtw_get_current_tx_rate(padapter, psta); + 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)); + } + } + + /*============ rx info ============ */ + RTW_PRINT_SEL(sel, "rx_rate : %s\n", HDATA_RATE(dm->rx_rate)); +#ifdef DBG_RX_SIGNAL_DISPLAY_RAW_DATA + isCCKrate = (psample_pkt_rssi->data_rate <= DESC_RATE11M) ? TRUE : FALSE; + + for (rf_path = 0; rf_path < pHalData->NumTotalRFPath; rf_path++) { + if (!isCCKrate) + _RTW_PRINT_SEL(sel , "RF_PATH_%d : rx_ofdm_pwr:%d(dBm), rx_ofdm_snr:%d(dB)\n", + rf_path, psample_pkt_rssi->ofdm_pwr[rf_path], psample_pkt_rssi->ofdm_snr[rf_path]); + } +#endif + RTW_PRINT_SEL(sel, "\n"); + return 0; +} +#endif /* CONFIG_HUAWEI_PROC */ + int proc_get_trx_info_debug(struct seq_file *m, void *v) { struct net_device *dev = m->private; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); - - int i; - /*============ tx info ============ */ rtw_hal_get_def_var(padapter, HW_DEF_RA_INFO_DUMP, m); @@ -2286,7 +2705,6 @@ int proc_get_trx_info_debug(struct seq_file *m, void *v) /*============ rx info ============ */ rtw_hal_set_odm_var(padapter, HAL_ODM_RX_INFO_DUMP, m, _FALSE); - return 0; } @@ -2294,13 +2712,11 @@ int proc_get_rx_signal(struct seq_file *m, void *v) { struct net_device *dev = m->private; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); RTW_PRINT_SEL(m, "rssi:%d\n", padapter->recvpriv.rssi); - /* 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) { + struct dm_struct *odm = adapter_to_phydm(padapter); if (padapter->mppriv.antenna_rx == ANTENNA_A) RTW_PRINT_SEL(m, "Antenna: A\n"); else if (padapter->mppriv.antenna_rx == ANTENNA_B) @@ -2317,11 +2733,16 @@ int proc_get_rx_signal(struct seq_file *m, void *v) RTW_PRINT_SEL(m, "Antenna: CD\n"); else RTW_PRINT_SEL(m, "Antenna: __\n"); - return 0; - } - rtw_get_noise(padapter); - RTW_PRINT_SEL(m, "noise:%d\n", padapter->recvpriv.noise); + RTW_PRINT_SEL(m, "rx_rate = %s\n", HDATA_RATE(odm->rx_rate)); + return 0; + } else +#endif + { + /* 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 DBG_RX_SIGNAL_DISPLAY_RAW_DATA rtw_odm_get_perpkt_rssi(m, padapter); rtw_get_raw_rssi_info(m, padapter); @@ -2348,9 +2769,12 @@ ssize_t proc_set_rx_signal(struct file *file, const char __user *buffer, size_t int num = sscanf(tmp, "%u %u", &is_signal_dbg, &signal_strength); + if (num < 1) + return count; + is_signal_dbg = is_signal_dbg == 0 ? 0 : 1; - if (is_signal_dbg && num != 2) + if (is_signal_dbg && num < 2) return count; signal_strength = signal_strength > 100 ? 100 : signal_strength; @@ -2368,6 +2792,36 @@ ssize_t proc_set_rx_signal(struct file *file, const char __user *buffer, size_t return count; } + +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; +} + #ifdef CONFIG_80211N_HT int proc_get_ht_enable(struct seq_file *m, void *v) @@ -2402,7 +2856,7 @@ ssize_t proc_set_ht_enable(struct file *file, const char __user *buffer, size_t int num = sscanf(tmp, "%d ", &mode); - if (pregpriv && mode < 2) { + if ( num == 1 && pregpriv && mode < 2) { pregpriv->ht_enable = mode; RTW_INFO("ht_enable=%d\n", pregpriv->ht_enable); } @@ -2448,11 +2902,9 @@ ssize_t proc_set_bw_mode(struct file *file, const char __user *buffer, size_t co bw_5g = mode >> 4; bw_2g = mode & 0x0f; - if (pregpriv && bw_2g <= 4 && bw_5g <= 4) { - + if (num == 1 && pregpriv && bw_2g <= 4 && bw_5g <= 4) { pregpriv->bw_mode = mode; printk("bw_mode=0x%x\n", mode); - } } @@ -2492,7 +2944,7 @@ ssize_t proc_set_ampdu_enable(struct file *file, const char __user *buffer, size int num = sscanf(tmp, "%d ", &mode); - if (pregpriv && mode < 2) { + if (num == 1 && pregpriv && mode < 2) { pregpriv->ampdu_enable = mode; printk("ampdu_enable=%d\n", mode); } @@ -2503,35 +2955,21 @@ 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) { @@ -2545,10 +2983,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"); @@ -2563,9 +3003,6 @@ ssize_t proc_set_rx_ampdu(struct file *file, const char __user *buffer, size_t c { struct net_device *dev = data; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - struct registry_priv *pregpriv = &padapter->registrypriv; - struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); char tmp[32]; u8 accept; u8 size; @@ -2590,9 +3027,9 @@ ssize_t proc_set_rx_ampdu(struct file *file, const char __user *buffer, size_t c rtw_rx_ampdu_apply(padapter); } -exit: return count; } + int proc_get_rx_ampdu_factor(struct seq_file *m, void *v) { struct net_device *dev = m->private; @@ -2638,6 +3075,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; @@ -2831,8 +3310,6 @@ int proc_get_en_fwps(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; - struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); if (pregpriv) RTW_PRINT_SEL(m, "check_fw_ps = %d , 1:enable get FW PS state , 0: disable get FW PS state\n" @@ -2846,8 +3323,6 @@ ssize_t proc_set_en_fwps(struct file *file, const char __user *buffer, size_t co struct net_device *dev = data; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); struct registry_priv *pregpriv = &padapter->registrypriv; - struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); char tmp[32]; u32 mode; @@ -2863,7 +3338,7 @@ ssize_t proc_set_en_fwps(struct file *file, const char __user *buffer, size_t co int num = sscanf(tmp, "%d ", &mode); - if (pregpriv && mode < 2) { + if (num == 1 && pregpriv && mode < 2) { pregpriv->check_fw_ps = mode; RTW_INFO("pregpriv->check_fw_ps=%d\n", pregpriv->check_fw_ps); } @@ -2928,7 +3403,9 @@ void rtw_get_dft_phy_cap(void *sel, _adapter *adapter) #ifdef CONFIG_80211AC_VHT rtw_vht_use_default_setting(adapter); #endif + #ifdef CONFIG_80211N_HT rtw_dump_dft_phy_cap(sel, adapter); + #endif } void rtw_dump_drv_phy_cap(void *sel, _adapter *adapter) @@ -2943,7 +3420,7 @@ void rtw_dump_drv_phy_cap(void *sel, _adapter *adapter) 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 - + #ifdef CONFIG_80211N_HT 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*/ @@ -2955,6 +3432,7 @@ void rtw_dump_drv_phy_cap(void *sel, _adapter *adapter) 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*/ + #endif /* CONFIG_80211N_HT */ #ifdef CONFIG_BEAMFORMING #if 0 RTW_PRINT_SEL(sel, "[DRV CAP] TxBF parameter : 0x%08x\n", phy_spec->txbf_param); @@ -3017,7 +3495,7 @@ ssize_t proc_set_stbc_cap(struct file *file, const char __user *buffer, size_t c int num = sscanf(tmp, "%d ", &mode); - if (pregpriv) { + if (num == 1 && pregpriv) { pregpriv->stbc_cap = mode; RTW_INFO("stbc_cap = 0x%02x\n", mode); } @@ -3057,7 +3535,7 @@ ssize_t proc_set_rx_stbc(struct file *file, const char __user *buffer, size_t co int num = sscanf(tmp, "%d ", &mode); - if (pregpriv && (mode == 0 || mode == 1 || mode == 2 || mode == 3)) { + if (num == 1 && pregpriv && (mode == 0 || mode == 1 || mode == 2 || mode == 3)) { pregpriv->rx_stbc = mode; printk("rx_stbc=%d\n", mode); } @@ -3098,7 +3576,7 @@ ssize_t proc_set_ldpc_cap(struct file *file, const char __user *buffer, size_t c int num = sscanf(tmp, "%d ", &mode); - if (pregpriv) { + if (num == 1 && pregpriv) { pregpriv->ldpc_cap = mode; RTW_INFO("ldpc_cap = 0x%02x\n", mode); } @@ -3139,7 +3617,7 @@ ssize_t proc_set_txbf_cap(struct file *file, const char __user *buffer, size_t c int num = sscanf(tmp, "%d ", &mode); - if (pregpriv) { + if (num == 1 && pregpriv) { pregpriv->beamform_cap = mode; RTW_INFO("beamform_cap = 0x%02x\n", mode); } @@ -3214,7 +3692,8 @@ int proc_get_all_sta_info(struct seq_file *m, void *v) int i; _list *plist, *phead; - RTW_PRINT_SEL(m, "sta_dz_bitmap=0x%x, tim_bitmap=0x%x\n", pstapriv->sta_dz_bitmap, pstapriv->tim_bitmap); + RTW_MAP_DUMP_SEL(m, "sta_dz_bitmap=", pstapriv->sta_dz_bitmap, pstapriv->aid_bmp_len); + RTW_MAP_DUMP_SEL(m, "tim_bitmap=", pstapriv->tim_bitmap, pstapriv->aid_bmp_len); _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); @@ -3227,19 +3706,30 @@ 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_RTS_FULL_BW + if(psta->vendor_8812) + RTW_PRINT_SEL(m,"Vendor Realtek 8812\n"); +#endif/*CONFIG_RTS_FULL_BW*/ #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 */ +#ifdef CONFIG_80211AC_VHT + RTW_PRINT_SEL(m, "vht_en=%d, vht_sgi_80m=%d\n", psta->vhtpriv.vht_option, psta->vhtpriv.sgi_80m); + RTW_PRINT_SEL(m, "vht_ldpc_cap=0x%x, vht_stbc_cap=0x%x, vht_beamform_cap=0x%x\n", psta->vhtpriv.ldpc_cap, psta->vhtpriv.stbc_cap, psta->vhtpriv.beamform_cap); + RTW_PRINT_SEL(m, "vht_mcs_map=0x%x, vht_highest_rate=0x%x, vht_ampdu_len=%d\n", *(u16 *)psta->vhtpriv.vht_mcs_map, psta->vhtpriv.vht_highest_rate, psta->vhtpriv.ampdu_len); +#endif RTW_PRINT_SEL(m, "sleepq_len=%d\n", psta->sleepq_len); RTW_PRINT_SEL(m, "sta_xmitpriv.vo_q_qcnt=%d\n", psta->sta_xmitpriv.vo_q.qcnt); RTW_PRINT_SEL(m, "sta_xmitpriv.vi_q_qcnt=%d\n", psta->sta_xmitpriv.vi_q.qcnt); @@ -3259,12 +3749,27 @@ 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); + if (psta->sta_stats.rx_tp_kbits >> 10) + RTW_PRINT_SEL(m, "rx_tp =%d (Mbps)\n", psta->sta_stats.rx_tp_kbits >> 10); + else + RTW_PRINT_SEL(m, "rx_tp =%d (Kbps)\n", psta->sta_stats.rx_tp_kbits); + 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 */ - + if (psta->sta_stats.tx_tp_kbits >> 10) + RTW_PRINT_SEL(m, "tx_tp =%d (Mbps)\n", psta->sta_stats.tx_tp_kbits >> 10); + else + RTW_PRINT_SEL(m, "tx_tp =%d (Kbps)\n", psta->sta_stats.tx_tp_kbits); +#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)) @@ -3325,48 +3830,48 @@ 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 mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); 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 } @@ -3380,7 +3885,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 mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); char tmp[32]; if (count < 1) @@ -3393,8 +3898,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"); } @@ -3497,6 +4002,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) @@ -3504,8 +4058,20 @@ int proc_get_sreset(struct seq_file *m, void *v) { struct net_device *dev = m->private; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + 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; + 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, "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; } @@ -3513,6 +4079,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; @@ -3528,8 +4096,13 @@ ssize_t proc_set_sreset(struct file *file, const char __user *buffer, size_t cou int num = sscanf(tmp, "%d", &trigger_point); + if (num < 1) + return count; + if (trigger_point == SRESET_TGP_NULL) rtw_hal_sreset_reset(padapter); + else if (trigger_point == SRESET_TGP_INFO) + psrtpriv->dbg_sreset_ctrl = _TRUE; else sreset_set_trigger_point(padapter, trigger_point); } @@ -3541,6 +4114,217 @@ ssize_t proc_set_sreset(struct file *file, const char __user *buffer, size_t cou #ifdef CONFIG_PCI_HCI +ssize_t proc_set_pci_bridge_conf_space(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 *pdvobjpriv = adapter_to_dvobj(padapter); + struct pci_dev *pdev = pdvobjpriv->ppcidev; + struct pci_dev *bridge_pdev = pdev->bus->self; + + char tmp[32] = { 0 }; + int num; + + u32 reg = 0, value = 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, "%x %x", ®, &value); + if (num != 2) { + RTW_INFO("invalid parameter!\n"); + return count; + } + + if (reg >= 0x1000) { + RTW_INFO("invalid register!\n"); + return count; + } + + if (value > 0xFF) { + RTW_INFO("invalid value! Only one byte\n"); + return count; + } + + RTW_INFO(FUNC_ADPT_FMT ": register 0x%x value 0x%x\n", + FUNC_ADPT_ARG(padapter), reg, value); + + pci_write_config_byte(bridge_pdev, reg, value); + } + return count; +} + + +int proc_get_pci_bridge_conf_space(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); + struct pci_dev *pdev = pdvobjpriv->ppcidev; + struct pci_dev *bridge_pdev = pdev->bus->self; + + u32 tmp[4] = { 0 }; + u32 i, j; + + RTW_PRINT_SEL(m, "\n***** PCI Host Device Configuration Space*****\n\n"); + + for (i = 0; i < 0x1000; i += 0x10) { + for (j = 0 ; j < 4 ; j++) + pci_read_config_dword(bridge_pdev, i + j * 4, tmp+j); + + RTW_PRINT_SEL(m, "%03x: %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x\n", + i, tmp[0] & 0xFF, (tmp[0] >> 8) & 0xFF, (tmp[0] >> 16) & 0xFF, (tmp[0] >> 24) & 0xFF, + tmp[1] & 0xFF, (tmp[1] >> 8) & 0xFF, (tmp[1] >> 16) & 0xFF, (tmp[1] >> 24) & 0xFF, + tmp[2] & 0xFF, (tmp[2] >> 8) & 0xFF, (tmp[2] >> 16) & 0xFF, (tmp[2] >> 24) & 0xFF, + tmp[3] & 0xFF, (tmp[3] >> 8) & 0xFF, (tmp[3] >> 16) & 0xFF, (tmp[3] >> 24) & 0xFF); + } + return 0; +} + + +ssize_t proc_set_pci_conf_space(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 *pdvobjpriv = adapter_to_dvobj(padapter); + struct pci_dev *pdev = pdvobjpriv->ppcidev; + + char tmp[32] = { 0 }; + int num; + + u32 reg = 0, value = 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, "%x %x", ®, &value); + + if (num != 2) { + RTW_INFO("invalid parameter!\n"); + return count; + } + + + if (reg >= 0x1000) { + RTW_INFO("invalid register!\n"); + return count; + } + + if (value > 0xFF) { + RTW_INFO("invalid value! Only one byte\n"); + return count; + } + + RTW_INFO(FUNC_ADPT_FMT ": register 0x%x value 0x%x\n", + FUNC_ADPT_ARG(padapter), reg, value); + + pci_write_config_byte(pdev, reg, value); + + + } + return count; +} + + +int proc_get_pci_conf_space(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); + struct pci_dev *pdev = pdvobjpriv->ppcidev; + struct pci_dev *bridge_pdev = pdev->bus->self; + + u32 tmp[4] = { 0 }; + u32 i, j; + + RTW_PRINT_SEL(m, "\n***** PCI Device Configuration Space *****\n\n"); + + for (i = 0; i < 0x1000; i += 0x10) { + for (j = 0 ; j < 4 ; j++) + pci_read_config_dword(pdev, i + j * 4, tmp+j); + + RTW_PRINT_SEL(m, "%03x: %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x\n", + i, tmp[0] & 0xFF, (tmp[0] >> 8) & 0xFF, (tmp[0] >> 16) & 0xFF, (tmp[0] >> 24) & 0xFF, + tmp[1] & 0xFF, (tmp[1] >> 8) & 0xFF, (tmp[1] >> 16) & 0xFF, (tmp[1] >> 24) & 0xFF, + tmp[2] & 0xFF, (tmp[2] >> 8) & 0xFF, (tmp[2] >> 16) & 0xFF, (tmp[2] >> 24) & 0xFF, + tmp[3] & 0xFF, (tmp[3] >> 8) & 0xFF, (tmp[3] >> 16) & 0xFF, (tmp[3] >> 24) & 0xFF); + } + + return 0; +} + + +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; @@ -3605,11 +4389,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); @@ -3625,6 +4410,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 @@ -3651,7 +4582,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); @@ -3688,6 +4619,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) { @@ -3735,6 +4667,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 (num == 1 && 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; @@ -3784,14 +4772,28 @@ ssize_t proc_set_wowlan_gpio_info(struct file *file, const char __user *buffer, num = sscanf(tmp, "%u", &is_high_active); + if (num != 1) { + RTW_INFO("Invalid format\n"); + return count; + } + is_high_active = is_high_active == 0 ? 0 : 1; pwrpriv->is_high_active = is_high_active; 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_switch_gpio_wl_ctrl(padapter, WAKEUP_GPIO_IDX, _TRUE); 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", @@ -3835,7 +4837,7 @@ int proc_get_p2p_wowlan_info(struct seq_file *m, void *v) return 0; } #endif /* CONFIG_P2P_WOWLAN */ - +#ifdef CONFIG_BCN_CNT_CONFIRM_HDL int proc_get_new_bcn_max(struct seq_file *m, void *v) { extern int new_bcn_max; @@ -3862,15 +4864,20 @@ ssize_t proc_set_new_bcn_max(struct file *file, const char __user *buffer, size_ return count; } - +#endif #ifdef CONFIG_POWER_SAVING int proc_get_ps_info(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); - u8 ips_mode = pwrpriv->ips_mode; + u8 ips_mode = pwrpriv->ips_mode_req; u8 lps_mode = pwrpriv->power_mgnt; + u8 lps_level = pwrpriv->lps_level; +#ifdef CONFIG_WOWLAN + u8 wow_lps_mode = pwrpriv->wowlan_power_mgmt; + u8 wow_lps_level = pwrpriv->wowlan_lps_level; +#endif /* CONFIG_WOWLAN */ char *str = ""; RTW_PRINT_SEL(m, "======Power Saving Info:======\n"); @@ -3912,12 +4919,236 @@ 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); + +#ifdef CONFIG_WOWLAN + RTW_PRINT_SEL(m, "------------------------------\n"); + RTW_PRINT_SEL(m, "*WOW LPS:\n"); + + if (wow_lps_mode == PS_MODE_ACTIVE) + str = "NO LPS"; + else if (wow_lps_mode == PS_MODE_MIN) + str = "MIN"; + else if (wow_lps_mode == PS_MODE_MAX) + str = "MAX"; + else if (wow_lps_mode == PS_MODE_DTIM) + str = "DTIM"; + else + sprintf(str, "%d", wow_lps_mode); + + RTW_PRINT_SEL(m, " WOW LPS mode: %s\n", str); + + if (wow_lps_level == LPS_LCLK) + str = "LPS_LCLK"; + else if (wow_lps_level == LPS_PG) + str = "LPS_PG"; + else + str = "LPS_NORMAL"; + RTW_PRINT_SEL(m, " WOW LPS level: %s\n", str); +#endif /* CONFIG_WOWLAN */ + RTW_PRINT_SEL(m, "=============================\n"); return 0; } + +ssize_t proc_set_ps_info(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + struct _ADAPTER *adapter = (_adapter *)rtw_netdev_priv(dev); + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + char tmp[8]; + int num = 0; + int mode = 0; + int en = 0; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (!buffer || copy_from_user(tmp, buffer, count)) + goto exit; + + num = sscanf(tmp, "%d %d", &mode, &en); + if (num > 2) { + RTW_ERR("%s: invalid parameter!\n", __FUNCTION__); + goto exit; + } + + if (num == 1 && mode == 0) { + /* back to original LPS/IPS Mode */ + RTW_INFO("%s: back to original LPS/IPS Mode\n", __FUNCTION__); + + rtw_pm_set_lps(adapter, adapter->registrypriv.power_mgnt); + + rtw_pm_set_ips(adapter, adapter->registrypriv.ips_mode); + +#ifdef CONFIG_WOWLAN + RTW_INFO("%s: back to original WOW LPS Mode\n", __FUNCTION__); + + rtw_pm_set_wow_lps(adapter, adapter->registrypriv.wow_power_mgnt); +#endif /* CONFIG_WOWLAN */ + + goto exit; + } + + if (mode == 1) { + /* LPS */ + RTW_INFO("%s: LPS: %s, en=%d\n", __FUNCTION__, (en == 0) ? "disable":"enable", en); + if (rtw_pm_set_lps(adapter, en) != 0 ) + RTW_ERR("%s: invalid parameter, mode=%d, level=%d\n", __FUNCTION__, mode, en); + + } else if (mode == 2) { + /* IPS */ + RTW_INFO("%s: IPS: %s, en=%d\n", __FUNCTION__, (en == 0) ? "disable":"enable", en); + if (rtw_pm_set_ips(adapter, en) != 0 ) + RTW_ERR("%s: invalid parameter, mode=%d, level=%d\n", __FUNCTION__, mode, en); + } +#ifdef CONFIG_WOWLAN + else if (mode == 3) { + /* WOW LPS */ + RTW_INFO("%s: WOW LPS: %s, en=%d\n", __FUNCTION__, (en == 0) ? "disable":"enable", en); + if (rtw_pm_set_wow_lps(adapter, en) != 0 ) + RTW_ERR("%s: invalid parameter, mode=%d, level=%d\n", __FUNCTION__, mode, en); + } +#endif /* CONFIG_WOWLAN */ + else + RTW_ERR("%s: invalid parameter, mode = %d!\n", __FUNCTION__, mode); + +exit: + return count; +} + +#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 (num == 1 && pregpriv) { + if (en_tdls > 0) + rtw_enable_tdls_func(padapter); + else + rtw_disable_tdls_func(padapter, _TRUE); + } + } + + return count; +} + static int proc_tdls_display_tdls_function_info(struct seq_file *m) { struct net_device *dev = m->private; @@ -3929,6 +5160,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"); @@ -3992,8 +5225,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; } @@ -4142,7 +5373,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; @@ -4219,7 +5450,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; @@ -4235,6 +5466,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"); @@ -4321,7 +5561,6 @@ int proc_get_monitor(struct seq_file *m, void *v) struct net_device *dev = m->private; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); - struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; if (WIFI_MONITOR_STATE == get_fwstate(pmlmepriv)) { RTW_PRINT_SEL(m, "Monitor mode : Enable\n"); @@ -4365,6 +5604,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) @@ -4508,11 +5793,11 @@ ssize_t proc_set_tx_sa_query(struct file *file, const char __user *buffer, size_ } if ((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) - && (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) && padapter->securitypriv.binstallBIPkey == _TRUE) { + && (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) && SEC_IS_BIP_KEY_INSTALLED(&padapter->securitypriv) == _TRUE) { RTW_INFO("STA:"MAC_FMT"\n", MAC_ARG(get_my_bssid(&(pmlmeinfo->network)))); /* TX unicast sa_query to AP */ issue_action_SA_Query(padapter, get_my_bssid(&(pmlmeinfo->network)), 0, 0, (u8)key_type); - } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE && padapter->securitypriv.binstallBIPkey == _TRUE) { + } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE && SEC_IS_BIP_KEY_INSTALLED(&padapter->securitypriv) == _TRUE) { /* TX unicast sa_query to every client STA */ _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); for (index = 0; index < NUM_STA; index++) { @@ -4524,7 +5809,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); @@ -4597,6 +5882,7 @@ ssize_t proc_set_tx_deauth(struct file *file, const char __user *buffer, size_t /* TX unicast deauth to AP */ issue_deauth_11w(padapter, get_my_bssid(&(pmlmeinfo->network)), 0, (u8)key_type); } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { + u8 updated = _FALSE; if (key_type == 3) issue_deauth_11w(padapter, bc_addr, 0, IEEE80211W_RIGHT_KEY); @@ -4612,7 +5898,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); @@ -4625,24 +5911,22 @@ ssize_t proc_set_tx_deauth(struct file *file, const char __user *buffer, size_t psta = rtw_get_stainfo(pstapriv, &mac_addr[index][0]); if (psta && key_type != IEEE80211W_WRONG_KEY && key_type != IEEE80211W_NO_KEY) { - u8 updated = _FALSE; - _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); if (rtw_is_list_empty(&psta->asoc_list) == _FALSE) { rtw_list_delete(&psta->asoc_list); pstapriv->asoc_list_cnt--; - updated = ap_free_sta(padapter, psta, _FALSE, WLAN_REASON_PREV_AUTH_NOT_VALID, _TRUE); + updated |= ap_free_sta(padapter, psta, _FALSE, WLAN_REASON_PREV_AUTH_NOT_VALID, _TRUE); } _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); - - associated_clients_update(padapter, updated, STA_INFO_UPDATE_ALL); } RTW_INFO("STA[%u]:"MAC_FMT"\n", index , MAC_ARG(&mac_addr[index][0])); } } } + + associated_clients_update(padapter, updated, STA_INFO_UPDATE_ALL); } return count; @@ -4717,6 +6001,48 @@ int proc_get_tx_auth(struct seq_file *m, void *v) } #endif /* CONFIG_IEEE80211W */ +#ifdef CONFIG_CUSTOMER01_SMART_ANTENNA +static u32 phase_idx; +int proc_get_pathb_phase(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + + RTW_PRINT_SEL(m, "PathB phase index =%d\n", phase_idx); + return 0; +} + +ssize_t proc_set_pathb_phase(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]; + int num; + u32 tmp_idx; + + 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 (buffer && !copy_from_user(tmp, buffer, count)) { + num = sscanf(tmp, "%u", &tmp_idx); + if ((tmp_idx < 0) || (tmp_idx > 11)) { + RTW_INFO(FUNC_ADPT_FMT "Invalid input value\n", FUNC_ADPT_ARG(padapter)); + return count; + } + phase_idx = tmp_idx; + rtw_hal_set_pathb_phase(padapter, phase_idx); + } + return count; +} +#endif + #ifdef CONFIG_MCC_MODE int proc_get_mcc_info(struct seq_file *m, void *v) { @@ -4737,77 +6063,6 @@ int proc_get_mcc_policy_table(struct seq_file *m, void *v) 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; @@ -4855,6 +6110,103 @@ ssize_t proc_set_mcc_enable(struct file *file, const char __user *buffer, size_t return count; } +ssize_t proc_set_mcc_duration(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]; + u32 enable_runtime_duration = 0, mcc_duration = 0, type = 0; + + 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)) { + int num = sscanf(tmp, "%u %u %u", &enable_runtime_duration, &type, &mcc_duration); + + if (num < 1) { + RTW_INFO(FUNC_ADPT_FMT ": input parameters < 1\n", FUNC_ADPT_ARG(padapter)); + return -EINVAL; + } + + if (num > 3) { + RTW_INFO(FUNC_ADPT_FMT ": input parameters > 2\n", FUNC_ADPT_ARG(padapter)); + return -EINVAL; + } + + if (num == 2) { + RTW_INFO(FUNC_ADPT_FMT ": input parameters > 2\n", FUNC_ADPT_ARG(padapter)); + return -EINVAL; + } + + if (num >= 1) { + SET_MCC_RUNTIME_DURATION(padapter, enable_runtime_duration); + RTW_INFO("runtime duration:%s\n", enable_runtime_duration ? "enable":"disable"); + } + + if (num == 3) { + RTW_INFO("type:%d, mcc duration:%d\n", type, mcc_duration); + rtw_set_mcc_duration_cmd(padapter, type, mcc_duration); + } + } + + return count; +} + +#ifdef CONFIG_MCC_PHYDM_OFFLOAD +ssize_t proc_set_mcc_phydm_offload_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[255]; + u32 mcc_phydm_enable = 0; + + 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)) { + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + u8 i = 0; + int num = sscanf(tmp, "%u", &mcc_phydm_enable); + + if (num < 1) { + RTW_INFO(FUNC_ADPT_FMT ": input parameters < 1\n", FUNC_ADPT_ARG(padapter)); + return -EINVAL; + } + + RTW_INFO("%s: mcc phydm enable = %d\n", __func__, mcc_phydm_enable); + rtw_set_mcc_phydm_offload_enable_cmd(padapter, mcc_phydm_enable, _TRUE); + } + + return count; +} +#endif + ssize_t proc_set_mcc_single_tx_criteria(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) { struct net_device *dev = data; @@ -5156,7 +6508,10 @@ 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; + u8 ack_timeout_val; +#ifdef CONFIG_RTL8821C + u8 ack_timeout_val_cck; +#endif ack_timeout_val = rtw_read8(padapter, REG_ACKTO); @@ -5213,4 +6568,596 @@ ssize_t proc_set_ack_timeout(struct file *file, const char __user *buffer, size_ return count; } +ssize_t proc_set_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 iqk_offload_enable = 0, ch_switch_offload_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 %d", &iqk_offload_enable, &ch_switch_offload_enable); + + if (num < 2) { + RTW_INFO("input parameters < 1\n"); + return -EINVAL; + } + + if (hal->RegIQKFWOffload != iqk_offload_enable) { + hal->RegIQKFWOffload = iqk_offload_enable; + rtw_run_in_thread_cmd(pri_adapter, ((void *)(rtw_hal_update_iqk_fw_offload_cap)), pri_adapter); + } + + if (hal->ch_switch_offload != ch_switch_offload_enable) + hal->ch_switch_offload = ch_switch_offload_enable; + } + + return count; +} + +int proc_get_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"); + RTW_PRINT_SEL(m, "Channel switch FW offload:%s\n", hal->ch_switch_offload?"enable":"disable"); + return 0; +} +#ifdef CONFIG_FW_HANDLE_TXBCN +extern void rtw_hal_set_fw_ap_bcn_offload_cmd(_adapter *adapter, bool fw_bcn_en, u8 tbtt_rpt_map); +ssize_t proc_set_fw_tbtt_rpt(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 fw_tbtt_rpt, fw_bcn_offload; + + + 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 %x",&fw_bcn_offload, &fw_tbtt_rpt); + + if (num < 2) { + RTW_INFO("input parameters < 2\n"); + return -EINVAL; + } + rtw_hal_set_fw_ap_bcn_offload_cmd(adapter, fw_bcn_offload, fw_tbtt_rpt); + } + + return count; +} + +int proc_get_fw_tbtt_rpt(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + + RTW_PRINT_SEL(m, "FW BCN offload:%s\n", dvobj->fw_bcn_offload ? "enable" : "disable"); + RTW_PRINT_SEL(m, "FW TBTT RPT:%x\n", dvobj->vap_tbtt_rpt_map); + return 0; +} + +#endif + +#ifdef CONFIG_CTRL_TXSS_BY_TP +ssize_t proc_set_txss_tp(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_ext_priv *pmlmeext = &(adapter->mlmeextpriv); + + char tmp[32]; + u32 enable = 0; + u32 txss_tx_tp = 0; + int txss_chk_cnt = 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, "%u %u %d", + &enable, &txss_tx_tp, &txss_chk_cnt); + + if (num < 1) { + RTW_INFO("input parameters < 1\n"); + return -EINVAL; + } + pmlmeext->txss_ctrl_en = enable; + + if (txss_tx_tp) + pmlmeext->txss_tp_th = txss_tx_tp; + if (txss_chk_cnt) + pmlmeext->txss_tp_chk_cnt = txss_chk_cnt; + + RTW_INFO("%s txss_ctl_en :%s , txss_tp_th:%d, tp_chk_cnt:%d\n", + __func__, pmlmeext->txss_tp_th ? "Y" : "N", + pmlmeext->txss_tp_th, pmlmeext->txss_tp_chk_cnt); + + } + + return count; +} + +int proc_get_txss_tp(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); + + RTW_PRINT_SEL(m, "TXSS Control - %s\n", pmlmeext->txss_ctrl_en ? "enable" : "disable"); + RTW_PRINT_SEL(m, "TXSS Tx TP TH - %d\n", pmlmeext->txss_tp_th); + RTW_PRINT_SEL(m, "TXSS check cnt - %d\n", pmlmeext->txss_tp_chk_cnt); + + return 0; +} +#ifdef DBG_CTRL_TXSS +ssize_t proc_set_txss_ctrl(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_ext_priv *pmlmeext = &(adapter->mlmeextpriv); + + char tmp[32]; + u32 tx_1ss = 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, "%u", &tx_1ss); + + if (num < 1) { + RTW_INFO("input parameters < 1\n"); + return -EINVAL; + } + + pmlmeext->txss_ctrl_en = _FALSE; + + dbg_ctrl_txss(adapter, tx_1ss); + + RTW_INFO("%s set tx to 1ss :%s\n", __func__, tx_1ss ? "Y" : "N"); + } + + return count; +} + +int proc_get_txss_ctrl(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); + + RTW_PRINT_SEL(m, "TXSS 1ss - %s\n", pmlmeext->txss_1ss ? "Y" : "N"); + + return 0; +} +#endif +#endif + +#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); + + if (num != 3) { + RTW_INFO("Invalid format\n"); + return count; + } + + 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); + + if (num != 1) { + RTW_INFO("Invalid format\n"); + return count; + } + + rtw_hal_lck_test(padapter); + } + + return count; +} +#endif /* CONFIG_DBG_RF_CAL */ + +#ifdef CONFIG_LPS_CHK_BY_TP +ssize_t proc_set_lps_chk_tp(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 pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); + char tmp[32]; + u32 enable = 0; + u32 lps_tx_tp = 0, lps_rx_tp = 0, lps_bi_tp = 0; + int lps_chk_cnt_th = 0; + u32 lps_tx_pkts = 0, lps_rx_pkts = 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, "%u %u %u %u %d %u %u", + &enable, &lps_tx_tp, &lps_rx_tp, &lps_bi_tp, + &lps_chk_cnt_th, &lps_tx_pkts, &lps_rx_pkts); + + if (num < 1) { + RTW_INFO("input parameters < 1\n"); + return -EINVAL; + } + pwrpriv->lps_chk_by_tp = enable; + + if (lps_tx_tp) { + pwrpriv->lps_tx_tp_th = lps_tx_tp; + pwrpriv->lps_rx_tp_th = lps_tx_tp; + pwrpriv->lps_bi_tp_th = lps_tx_tp; + } + if (lps_rx_tp) + pwrpriv->lps_rx_tp_th = lps_rx_tp; + if (lps_bi_tp) + pwrpriv->lps_bi_tp_th = lps_bi_tp; + + if (lps_chk_cnt_th) + pwrpriv->lps_chk_cnt_th = lps_chk_cnt_th; + + if (lps_tx_pkts) + pwrpriv->lps_tx_pkts = lps_tx_pkts; + + if (lps_rx_pkts) + pwrpriv->lps_rx_pkts = lps_rx_pkts; + + RTW_INFO("%s lps_chk_by_tp:%s , lps_tx_tp_th:%d, lps_tx_tp_th:%d, lps_bi_tp:%d\n", + __func__, pwrpriv->lps_chk_by_tp ? "Y" : "N", + pwrpriv->lps_tx_tp_th, pwrpriv->lps_tx_tp_th, pwrpriv->lps_bi_tp_th); + RTW_INFO("%s lps_chk_cnt_th:%d , lps_tx_pkts:%d, lps_rx_pkts:%d\n", + __func__, pwrpriv->lps_chk_cnt_th, pwrpriv->lps_tx_pkts, pwrpriv->lps_rx_pkts); + } + + return count; +} + +int proc_get_lps_chk_tp(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); + + RTW_PRINT_SEL(m, "LPS chk by tp - %s\n", pwrpriv->lps_chk_by_tp ? "enable" : "disable"); + RTW_PRINT_SEL(m, "LPS Tx TP TH - %d(Mbps)\n", pwrpriv->lps_tx_tp_th); + RTW_PRINT_SEL(m, "LPS Rx TP TH - %d(Mbps)\n", pwrpriv->lps_rx_tp_th); + RTW_PRINT_SEL(m, "LPS BI TP TH - %d(Mbps)\n", pwrpriv->lps_bi_tp_th); + + RTW_PRINT_SEL(m, "LPS CHK CNT - %d\n", pwrpriv->lps_chk_cnt_th); + RTW_PRINT_SEL(m, "LPS Tx PKTs - %d\n", pwrpriv->lps_tx_pkts); + RTW_PRINT_SEL(m, "LPS Rx PKTs - %d\n", pwrpriv->lps_rx_pkts); + return 0; +} +#endif /*CONFIG_LPS_CHK_BY_TP*/ +#ifdef CONFIG_SUPPORT_STATIC_SMPS +ssize_t proc_set_smps(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_ext_priv *pmlmeext = &(adapter->mlmeextpriv); + char tmp[32]; + u32 enable = 0; + u32 smps_en, smps_tx_tp = 0, smps_rx_tp = 0; + u32 smps_test = 0, smps_test_en = 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, "%u %u %u %u %u", &smps_en, &smps_tx_tp, &smps_rx_tp, + &smps_test, &smps_test_en); + + if (num < 1) { + RTW_INFO("input parameters < 1\n"); + return -EINVAL; + } + + pmlmeext->ssmps_en = smps_en; + if (smps_tx_tp) { + pmlmeext->ssmps_tx_tp_th= smps_tx_tp; + pmlmeext->ssmps_rx_tp_th= smps_tx_tp; + } + if (smps_rx_tp) + pmlmeext->ssmps_rx_tp_th = smps_rx_tp; + + #ifdef DBG_STATIC_SMPS + if (num > 3) { + pmlmeext->ssmps_test = smps_test; + pmlmeext->ssmps_test_en = smps_test_en; + } + #endif + RTW_INFO("SM PS : %s tx_tp_th:%d, rx_tp_th:%d\n", + (smps_en) ? "Enable" : "Disable", + pmlmeext->ssmps_tx_tp_th, + pmlmeext->ssmps_rx_tp_th); + #ifdef DBG_STATIC_SMPS + RTW_INFO("SM PS : %s ssmps_test_en:%d\n", + (smps_test) ? "Enable" : "Disable", + pmlmeext->ssmps_test_en); + #endif + } + + return count; +} + +int proc_get_smps(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); + + RTW_PRINT_SEL(m, "Static SMPS %s\n", pmlmeext->ssmps_en ? "enable" : "disable"); + RTW_PRINT_SEL(m, "Tx TP TH %d\n", pmlmeext->ssmps_tx_tp_th); + RTW_PRINT_SEL(m, "Rx TP TH %d\n", pmlmeext->ssmps_rx_tp_th); + #ifdef DBG_STATIC_SMPS + RTW_PRINT_SEL(m, "test %d, test_en:%d\n", pmlmeext->ssmps_test, pmlmeext->ssmps_test_en); + #endif + return 0; +} +#endif /*CONFIG_SUPPORT_STATIC_SMPS*/ + #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) +{ +#ifdef CONFIG_RTW_DEBUG + int __i; + u8 *ptr = (u8 *)_hexdata; + + if (_loglevel <= rtw_drv_log_level) { + if (_titlestring) { + if (sel == RTW_DBGDUMP) + RTW_PRINT(""); + _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(""); + 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 < _hexdatalen) && ((__i + 1) % RTW_BUFDUMP_BSIZE) == 0) + _RTW_PRINT_SEL(sel, "\n"); + } + _RTW_PRINT_SEL(sel, "\n"); + } +#endif +} +#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/rtl8188eu/core/rtw_eeprom.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_eeprom.c index d7bca033fee1..3a7857b4ef48 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_eeprom.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_eeprom.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 @@ -161,20 +157,6 @@ void eeprom_clean(_adapter *padapter) void eeprom_write16(_adapter *padapter, u16 reg, u16 data) { u8 x; -#ifdef CONFIG_RTL8712 - u8 tmp8_ori, tmp8_new, tmp8_clk_ori, tmp8_clk_new; - tmp8_ori = rtw_read8(padapter, 0x102502f1); - tmp8_new = tmp8_ori & 0xf7; - if (tmp8_ori != tmp8_new) { - rtw_write8(padapter, 0x102502f1, tmp8_new); - } - tmp8_clk_ori = rtw_read8(padapter, 0x10250003); - tmp8_clk_new = tmp8_clk_ori | 0x20; - if (tmp8_clk_new != tmp8_clk_ori) { - rtw_write8(padapter, 0x10250003, tmp8_clk_new); - } -#endif - x = rtw_read8(padapter, EE_9346CR); x &= ~(_EEDI | _EEDO | _EESK | _EEM0); @@ -226,13 +208,6 @@ void eeprom_write16(_adapter *padapter, u16 reg, u16 data) eeprom_clean(padapter); exit: -#ifdef CONFIG_RTL8712 - if (tmp8_clk_new != tmp8_clk_ori) - rtw_write8(padapter, 0x10250003, tmp8_clk_ori); - if (tmp8_new != tmp8_ori) - rtw_write8(padapter, 0x102502f1, tmp8_ori); - -#endif return; } @@ -241,19 +216,6 @@ u16 eeprom_read16(_adapter *padapter, u16 reg) /* ReadEEprom */ u16 x; u16 data = 0; -#ifdef CONFIG_RTL8712 - u8 tmp8_ori, tmp8_new, tmp8_clk_ori, tmp8_clk_new; - tmp8_ori = rtw_read8(padapter, 0x102502f1); - tmp8_new = tmp8_ori & 0xf7; - if (tmp8_ori != tmp8_new) { - rtw_write8(padapter, 0x102502f1, tmp8_new); - } - tmp8_clk_ori = rtw_read8(padapter, 0x10250003); - tmp8_clk_new = tmp8_clk_ori | 0x20; - if (tmp8_clk_new != tmp8_clk_ori) { - rtw_write8(padapter, 0x10250003, tmp8_clk_new); - } -#endif if (rtw_is_surprise_removed(padapter)) { goto out; @@ -279,13 +241,7 @@ u16 eeprom_read16(_adapter *padapter, u16 reg) /* ReadEEprom */ eeprom_clean(padapter); out: -#ifdef CONFIG_RTL8712 - if (tmp8_clk_new != tmp8_clk_ori) - rtw_write8(padapter, 0x10250003, tmp8_clk_ori); - if (tmp8_new != tmp8_ori) - rtw_write8(padapter, 0x102502f1, tmp8_ori); -#endif return data; @@ -366,7 +322,7 @@ u8 eeprom_read(_adapter *padapter, u32 addr_off, u8 sz, u8 *rbuf) -VOID read_eeprom_content(_adapter *padapter) +void read_eeprom_content(_adapter *padapter) { diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_ieee80211.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_ieee80211.c index 0bb8bdb94483..9e674cc8fe96 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_ieee80211.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_ieee80211.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,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 _IEEE80211_C #ifdef CONFIG_PLATFORM_INTEL_BYT #include #endif #include -#include + u8 RTW_WPA_OUI_TYPE[] = { 0x00, 0x50, 0xf2, 1 }; u16 RTW_WPA_VERSION = 1; @@ -38,26 +34,40 @@ u8 WPA_CIPHER_SUITE_CCMP[] = { 0x00, 0x50, 0xf2, 4 }; u8 WPA_CIPHER_SUITE_WEP104[] = { 0x00, 0x50, 0xf2, 5 }; u16 RSN_VERSION_BSD = 1; -u8 RSN_AUTH_KEY_MGMT_UNSPEC_802_1X[] = { 0x00, 0x0f, 0xac, 1 }; -u8 RSN_AUTH_KEY_MGMT_PSK_OVER_802_1X[] = { 0x00, 0x0f, 0xac, 2 }; u8 RSN_CIPHER_SUITE_NONE[] = { 0x00, 0x0f, 0xac, 0 }; u8 RSN_CIPHER_SUITE_WEP40[] = { 0x00, 0x0f, 0xac, 1 }; u8 RSN_CIPHER_SUITE_TKIP[] = { 0x00, 0x0f, 0xac, 2 }; u8 RSN_CIPHER_SUITE_WRAP[] = { 0x00, 0x0f, 0xac, 3 }; u8 RSN_CIPHER_SUITE_CCMP[] = { 0x00, 0x0f, 0xac, 4 }; u8 RSN_CIPHER_SUITE_WEP104[] = { 0x00, 0x0f, 0xac, 5 }; + +u8 WLAN_AKM_8021X[] = {0x00, 0x0f, 0xac, 1}; +u8 WLAN_AKM_PSK[] = {0x00, 0x0f, 0xac, 2}; +u8 WLAN_AKM_FT_8021X[] = {0x00, 0x0f, 0xac, 3}; +u8 WLAN_AKM_FT_PSK[] = {0x00, 0x0f, 0xac, 4}; +u8 WLAN_AKM_8021X_SHA256[] = {0x00, 0x0f, 0xac, 5}; +u8 WLAN_AKM_PSK_SHA256[] = {0x00, 0x0f, 0xac, 6}; +u8 WLAN_AKM_TDLS[] = {0x00, 0x0f, 0xac, 7}; +u8 WLAN_AKM_SAE[] = {0x00, 0x0f, 0xac, 8}; +u8 WLAN_AKM_FT_OVER_SAE[] = {0x00, 0x0f, 0xac, 9}; +u8 WLAN_AKM_8021X_SUITE_B[] = {0x00, 0x0f, 0xac, 11}; +u8 WLAN_AKM_8021X_SUITE_B_192[] = {0x00, 0x0f, 0xac, 12}; +u8 WLAN_AKM_FILS_SHA256[] = {0x00, 0x0f, 0xac, 14}; +u8 WLAN_AKM_FILS_SHA384[] = {0x00, 0x0f, 0xac, 15}; +u8 WLAN_AKM_FT_FILS_SHA256[] = {0x00, 0x0f, 0xac, 16}; +u8 WLAN_AKM_FT_FILS_SHA384[] = {0x00, 0x0f, 0xac, 17}; /* ----------------------------------------------------------- * for adhoc-master to generate ie and provide supported-rate to fw * ----------------------------------------------------------- */ -static u8 WIFI_CCKRATES[] = { +u8 WIFI_CCKRATES[] = { (IEEE80211_CCK_RATE_1MB | IEEE80211_BASIC_RATE_MASK), (IEEE80211_CCK_RATE_2MB | IEEE80211_BASIC_RATE_MASK), (IEEE80211_CCK_RATE_5MB | IEEE80211_BASIC_RATE_MASK), (IEEE80211_CCK_RATE_11MB | IEEE80211_BASIC_RATE_MASK) }; -static u8 WIFI_OFDMRATES[] = { +u8 WIFI_OFDMRATES[] = { (IEEE80211_OFDM_RATE_6MB), (IEEE80211_OFDM_RATE_9MB), (IEEE80211_OFDM_RATE_12MB), @@ -132,6 +142,19 @@ int rtw_get_bit_value_from_ieee_value(u8 val) } return 0; } +uint rtw_get_cckrate_size(u8 *rate, u32 rate_length) +{ + int i = 0; + while(i < rate_length){ + RTW_DBG("%s, rate[%d]=%u\n", __FUNCTION__, i, rate[i]); + if (((rate[i] & 0x7f) == 2) || ((rate[i] & 0x7f) == 4) || + ((rate[i] & 0x7f) == 11) || ((rate[i] & 0x7f) == 22)) + i++; + else + break; + } + return i; +} uint rtw_is_cckrates_included(u8 *rate) { @@ -196,7 +219,7 @@ u8 *rtw_set_ie u8 *pbuf, sint index, uint len, - u8 *source, + const u8 *source, uint *frlen /* frame length */ ) { @@ -207,7 +230,8 @@ u8 *rtw_set_ie if (len > 0) _rtw_memcpy((void *)(pbuf + 2), (void *)source, len); - *frlen = *frlen + (len + 2); + if (frlen) + *frlen = *frlen + (len + 2); return pbuf + len + 2; } @@ -228,9 +252,9 @@ inline u8 secondary_ch_offset_to_hal_ch_offset(u8 ch_offset) if (ch_offset == SCN) return HAL_PRIME_CHNL_OFFSET_DONT_CARE; else if (ch_offset == SCA) - return HAL_PRIME_CHNL_OFFSET_UPPER; - else if (ch_offset == SCB) return HAL_PRIME_CHNL_OFFSET_LOWER; + else if (ch_offset == SCB) + return HAL_PRIME_CHNL_OFFSET_UPPER; return HAL_PRIME_CHNL_OFFSET_DONT_CARE; } @@ -240,9 +264,9 @@ inline u8 hal_ch_offset_to_secondary_ch_offset(u8 ch_offset) if (ch_offset == HAL_PRIME_CHNL_OFFSET_DONT_CARE) return SCN; else if (ch_offset == HAL_PRIME_CHNL_OFFSET_LOWER) - return SCB; - else if (ch_offset == HAL_PRIME_CHNL_OFFSET_UPPER) return SCA; + else if (ch_offset == HAL_PRIME_CHNL_OFFSET_UPPER) + return SCB; return SCN; } @@ -268,10 +292,10 @@ inline u8 *rtw_set_ie_mesh_ch_switch_parm(u8 *buf, u32 *buf_len, u8 ttl, /*---------------------------------------------------------------------------- index: the information element id index, limit is the limit for search -----------------------------------------------------------------------------*/ -u8 *rtw_get_ie(u8 *pbuf, sint index, sint *len, sint limit) +u8 *rtw_get_ie(const u8 *pbuf, sint index, sint *len, sint limit) { sint tmp, i; - u8 *p; + const u8 *p; if (limit < 1) { return NULL; } @@ -282,7 +306,7 @@ u8 *rtw_get_ie(u8 *pbuf, sint index, sint *len, sint limit) while (1) { if (*p == index) { *len = *(p + 1); - return p; + return (u8 *)p; } else { tmp = *(p + 1); p += (tmp + 2); @@ -306,17 +330,17 @@ u8 *rtw_get_ie(u8 *pbuf, sint index, sint *len, sint limit) * * Returns: The address of the specific IE found, or NULL */ -u8 *rtw_get_ie_ex(u8 *in_ie, uint in_len, u8 eid, u8 *oui, u8 oui_len, u8 *ie, uint *ielen) +u8 *rtw_get_ie_ex(const u8 *in_ie, uint in_len, u8 eid, const u8 *oui, u8 oui_len, u8 *ie, uint *ielen) { uint cnt; - u8 *target_ie = NULL; + const u8 *target_ie = NULL; if (ielen) *ielen = 0; if (!in_ie || in_len <= 0) - return target_ie; + return (u8 *)target_ie; cnt = 0; @@ -338,7 +362,7 @@ u8 *rtw_get_ie_ex(u8 *in_ie, uint in_len, u8 eid, u8 *oui, u8 oui_len, u8 *ie, u } - return target_ie; + return (u8 *)target_ie; } /** @@ -414,6 +438,72 @@ void rtw_set_supported_rate(u8 *SupportedRates, uint mode) } } +void rtw_filter_suppport_rateie(WLAN_BSSID_EX *pbss_network, u8 keep) +{ + u8 i, idx = 0, new_rate[NDIS_802_11_LENGTH_RATES_EX], *p; + int ret = 0; + uint iscck, isofdm, ie_orilen = 0, remain_len; + u8 *remain_ies; + + p = rtw_get_ie(pbss_network->IEs + _BEACON_IE_OFFSET_, _SUPPORTEDRATES_IE_, &ie_orilen, (pbss_network->IELength - _BEACON_IE_OFFSET_)); + if (!p) + return; + + _rtw_memset(new_rate, 0, NDIS_802_11_LENGTH_RATES_EX); + for (i=0; i < ie_orilen; i++) { + iscck = rtw_is_cck_rate(p[i+2]); + isofdm= rtw_is_ofdm_rate(p[i+2]); + if (((keep == CCK) && iscck) + || ((keep == OFDM) && isofdm)) + new_rate[idx++]= rtw_is_basic_rate_ofdm(p[i+2]) ? p[i+2]|IEEE80211_BASIC_RATE_MASK : p[i+2]; + } + /* update rate ie */ + p[1] = idx; + _rtw_memcpy(p+2, new_rate, idx); + /* update remain ie & IELength*/ + remain_ies = p + 2 + ie_orilen; + remain_len = pbss_network->IELength - (remain_ies - pbss_network->IEs); + _rtw_memmove(p+2+idx, remain_ies, remain_len); + pbss_network->IELength -= (ie_orilen - idx); +} + + +/* + Adjust those items by given wireless_mode + 1. pbss_network->IELength + 2. pbss_network->IE (SUPPORTRATE & EXT_SUPPORTRATE) + 3. pbss_network->SupportedRates +*/ + +u8 rtw_update_rate_bymode(WLAN_BSSID_EX *pbss_network, u32 mode) +{ + u8 network_type, *p, *ie = pbss_network->IEs; + sint ie_len; + uint network_ielen = pbss_network->IELength; + + if (mode == WIRELESS_11B) { + /*only keep CCK in support_rate IE and remove whole ext_support_rate IE*/ + rtw_filter_suppport_rateie(pbss_network, CCK); + p = rtw_get_ie(ie + _BEACON_IE_OFFSET_, _EXT_SUPPORTEDRATES_IE_, &ie_len, pbss_network->IELength - _BEACON_IE_OFFSET_); + if (p) { + rtw_ies_remove_ie(ie , &network_ielen, _BEACON_IE_OFFSET_, _EXT_SUPPORTEDRATES_IE_, NULL, 0); + pbss_network->IELength -= ie_len; + } + network_type = WIRELESS_11B; + } else if ((mode & WIRELESS_11B) == 0) { + /* Remove CCK in support_rate IE */ + rtw_filter_suppport_rateie(pbss_network, OFDM); + if (pbss_network->Configuration.DSConfig > 14) + network_type = WIRELESS_11A; + else + network_type = WIRELESS_11G; + } else + network_type = WIRELESS_11BG; /* do nothing */ + + rtw_set_supported_rate(pbss_network->SupportedRates, network_type); + return network_type; +} + uint rtw_get_rateset_len(u8 *rateset) { uint i = 0; @@ -500,7 +590,7 @@ int rtw_generate_ie(struct registry_priv *pregistrypriv) #ifdef CONFIG_80211N_HT /* HT Cap. */ - if (((pregistrypriv->wireless_mode & WIRELESS_11_5N) || (pregistrypriv->wireless_mode & WIRELESS_11_24N)) + if (is_supported_ht(pregistrypriv->wireless_mode) && (pregistrypriv->ht_enable == _TRUE)) { /* todo: */ } @@ -606,8 +696,44 @@ int rtw_get_wpa2_cipher_suite(u8 *s) return 0; } +u32 rtw_get_akm_suite_bitmap(u8 *s) +{ + if (_rtw_memcmp(s, WLAN_AKM_8021X, RSN_SELECTOR_LEN) == _TRUE) + return WLAN_AKM_TYPE_8021X; + if (_rtw_memcmp(s, WLAN_AKM_PSK, RSN_SELECTOR_LEN) == _TRUE) + return WLAN_AKM_TYPE_PSK; + if (_rtw_memcmp(s, WLAN_AKM_FT_8021X, RSN_SELECTOR_LEN) == _TRUE) + return WLAN_AKM_TYPE_FT_8021X; + if (_rtw_memcmp(s, WLAN_AKM_FT_PSK, RSN_SELECTOR_LEN) == _TRUE) + return WLAN_AKM_TYPE_FT_PSK; + if (_rtw_memcmp(s, WLAN_AKM_8021X_SHA256, RSN_SELECTOR_LEN) == _TRUE) + return WLAN_AKM_TYPE_8021X_SHA256; + if (_rtw_memcmp(s, WLAN_AKM_PSK_SHA256, RSN_SELECTOR_LEN) == _TRUE) + return WLAN_AKM_TYPE_PSK_SHA256; + if (_rtw_memcmp(s, WLAN_AKM_TDLS, RSN_SELECTOR_LEN) == _TRUE) + return WLAN_AKM_TYPE_TDLS; + if (_rtw_memcmp(s, WLAN_AKM_SAE, RSN_SELECTOR_LEN) == _TRUE) + return WLAN_AKM_TYPE_SAE; + if (_rtw_memcmp(s, WLAN_AKM_FT_OVER_SAE, RSN_SELECTOR_LEN) == _TRUE) + return WLAN_AKM_TYPE_FT_OVER_SAE; + if (_rtw_memcmp(s, WLAN_AKM_8021X_SUITE_B, RSN_SELECTOR_LEN) == _TRUE) + return WLAN_AKM_TYPE_8021X_SUITE_B; + if (_rtw_memcmp(s, WLAN_AKM_8021X_SUITE_B_192, RSN_SELECTOR_LEN) == _TRUE) + return WLAN_AKM_TYPE_8021X_SUITE_B_192; + if (_rtw_memcmp(s, WLAN_AKM_FILS_SHA256, RSN_SELECTOR_LEN) == _TRUE) + return WLAN_AKM_TYPE_FILS_SHA256; + if (_rtw_memcmp(s, WLAN_AKM_FILS_SHA384, RSN_SELECTOR_LEN) == _TRUE) + return WLAN_AKM_TYPE_FILS_SHA384; + if (_rtw_memcmp(s, WLAN_AKM_FT_FILS_SHA256, RSN_SELECTOR_LEN) == _TRUE) + return WLAN_AKM_TYPE_FT_FILS_SHA256; + if (_rtw_memcmp(s, WLAN_AKM_FT_FILS_SHA384, RSN_SELECTOR_LEN) == _TRUE) + return WLAN_AKM_TYPE_FT_FILS_SHA384; -int rtw_parse_wpa_ie(u8 *wpa_ie, int wpa_ie_len, int *group_cipher, int *pairwise_cipher, int *is_8021x) + return 0; +} + +int rtw_parse_wpa_ie(u8 *wpa_ie, int wpa_ie_len, int *group_cipher, + int *pairwise_cipher, u32 *akm) { int i, ret = _SUCCESS; int left, count; @@ -666,11 +792,11 @@ int rtw_parse_wpa_ie(u8 *wpa_ie, int wpa_ie_len, int *group_cipher, int *pairwis return _FAIL; } - if (is_8021x) { + if (akm) { if (left >= 6) { pos += 2; if (_rtw_memcmp(pos, SUITE_1X, 4) == 1) { - *is_8021x = 1; + *akm = WLAN_AKM_TYPE_8021X; } } } @@ -679,79 +805,149 @@ int rtw_parse_wpa_ie(u8 *wpa_ie, int wpa_ie_len, int *group_cipher, int *pairwis } -int rtw_parse_wpa2_ie(u8 *rsn_ie, int rsn_ie_len, int *group_cipher, int *pairwise_cipher, int *is_8021x) +int rtw_rsne_info_parse(const u8 *ie, uint ie_len, struct rsne_info *info) { - int i, ret = _SUCCESS; - int left, count; - u8 *pos; - u8 SUITE_1X[4] = {0x00, 0x0f, 0xac, 0x01}; + const u8 *pos = ie; + u16 cnt; - if (rsn_ie_len <= 0) { - /* No RSN IE - fail silently */ - return _FAIL; + _rtw_memset(info, 0, sizeof(struct rsne_info)); + + if (ie + ie_len < pos + 4) + goto err; + + if (*ie != WLAN_EID_RSN || *(ie + 1) != ie_len - 2) + goto err; + pos += 2 + 2; + + /* Group CS */ + if (ie + ie_len < pos + 4) { + if (ie + ie_len != pos) + goto err; + goto exit; } - - - if ((*rsn_ie != _WPA2_IE_ID_) || (*(rsn_ie + 1) != (u8)(rsn_ie_len - 2))) - return _FAIL; - - pos = rsn_ie; + info->gcs = (u8 *)pos; pos += 4; - left = rsn_ie_len - 4; - /* group_cipher */ - if (left >= RSN_SELECTOR_LEN) { + /* Pairwise CS */ + if (ie + ie_len < pos + 2) { + if (ie + ie_len != pos) + goto err; + goto exit; + } + cnt = RTW_GET_LE16(pos); + pos += 2; + if (ie + ie_len < pos + 4 * cnt) { + if (ie + ie_len != pos) + goto err; + goto exit; + } + info->pcs_cnt = cnt; + info->pcs_list = (u8 *)pos; + pos += 4 * cnt; - *group_cipher = rtw_get_wpa2_cipher_suite(pos); + /* AKM */ + if (ie + ie_len < pos + 2) { + if (ie + ie_len != pos) + goto err; + goto exit; + } + cnt = RTW_GET_LE16(pos); + pos += 2; + if (ie + ie_len < pos + 4 * cnt) { + if (ie + ie_len != pos) + goto err; + goto exit; + } + info->akm_cnt = cnt; + info->akm_list = (u8 *)pos; + pos += 4 * cnt; - pos += RSN_SELECTOR_LEN; - left -= RSN_SELECTOR_LEN; + /* RSN cap */ + if (ie + ie_len < pos + 2) { + if (ie + ie_len != pos) + goto err; + goto exit; + } + info->cap = (u8 *)pos; + pos += 2; - } else if (left > 0) { - return _FAIL; + /* PMKID */ + if (ie + ie_len < pos + 2) { + if (ie + ie_len != pos) + goto err; + goto exit; + } + cnt = RTW_GET_LE16(pos); + pos += 2; + if (ie + ie_len < pos + 16 * cnt) { + if (ie + ie_len != pos) + goto err; + goto exit; + } + info->pmkid_cnt = cnt; + info->pmkid_list = (u8 *)pos; + pos += 16 * cnt; + + /* Group Mgmt CS */ + if (ie + ie_len < pos + 4) { + if (ie + ie_len != pos) + goto err; + goto exit; + } + info->gmcs = (u8 *)pos; + +exit: + return _SUCCESS; + +err: + info->err = 1; + return _FAIL; +} + +int rtw_parse_wpa2_ie(u8 *rsn_ie, int rsn_ie_len, int *group_cipher, + int *pairwise_cipher, u32 *akm, u8 *mfp_opt) +{ + struct rsne_info info; + int i, ret = _SUCCESS; + + ret = rtw_rsne_info_parse(rsn_ie, rsn_ie_len, &info); + if (ret != _SUCCESS) + goto exit; + + if (group_cipher) { + if (info.gcs) + *group_cipher = rtw_get_wpa2_cipher_suite(info.gcs); + else + *group_cipher = 0; } - /* pairwise_cipher */ - if (left >= 2) { - /* count = le16_to_cpu(*(u16*)pos); */ - count = RTW_GET_LE16(pos); - pos += 2; - left -= 2; - - if (count == 0 || left < count * RSN_SELECTOR_LEN) { - return _FAIL; - } - - for (i = 0; i < count; i++) { - *pairwise_cipher |= rtw_get_wpa2_cipher_suite(pos); - - pos += RSN_SELECTOR_LEN; - left -= RSN_SELECTOR_LEN; - } - - } else if (left == 1) { - - return _FAIL; + if (pairwise_cipher) { + *pairwise_cipher = 0; + for (i = 0; i < info.pcs_cnt; i++) + *pairwise_cipher |= rtw_get_wpa2_cipher_suite(info.pcs_list + 4 * i); } - if (is_8021x) { - if (left >= 6) { - pos += 2; - if (_rtw_memcmp(pos, SUITE_1X, 4) == 1) { - *is_8021x = 1; - } - } + if (akm) { + *akm = 0; + for (i = 0; i < info.akm_cnt; i++) + *akm |= rtw_get_akm_suite_bitmap(info.akm_list + 4 * i); } + if (mfp_opt) { + *mfp_opt = MFP_NO; + if (info.cap) + *mfp_opt = GET_RSN_CAP_MFP_OPTION(info.cap); + } + +exit: return ret; - } /* #ifdef CONFIG_WAPI_SUPPORT */ int rtw_get_wapi_ie(u8 *in_ie, uint in_len, u8 *wapi_ie, u16 *wapi_len) { int len = 0; - u8 authmode, i; + u8 authmode; uint cnt; u8 wapi_oui1[4] = {0x0, 0x14, 0x72, 0x01}; u8 wapi_oui2[4] = {0x0, 0x14, 0x72, 0x02}; @@ -794,7 +990,7 @@ int rtw_get_wapi_ie(u8 *in_ie, uint in_len, u8 *wapi_ie, u16 *wapi_len) int rtw_get_sec_ie(u8 *in_ie, uint in_len, u8 *rsn_ie, u16 *rsn_len, u8 *wpa_ie, u16 *wpa_len) { - u8 authmode, sec_idx, i; + u8 authmode, sec_idx; u8 wpa_oui[4] = {0x0, 0x50, 0xf2, 0x01}; uint cnt; @@ -853,23 +1049,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; } @@ -883,10 +1082,10 @@ u8 *rtw_get_wps_ie_from_scan_queue(u8 *in_ie, uint in_len, u8 *wps_ie, uint *wps * * Returns: The address of the WPS IE found, or NULL */ -u8 *rtw_get_wps_ie(u8 *in_ie, uint in_len, u8 *wps_ie, uint *wps_ielen) +u8 *rtw_get_wps_ie(const u8 *in_ie, uint in_len, u8 *wps_ie, uint *wps_ielen) { uint cnt; - u8 *wpsie_ptr = NULL; + const u8 *wpsie_ptr = NULL; u8 eid, wps_oui[4] = {0x00, 0x50, 0xf2, 0x04}; if (wps_ielen) @@ -894,11 +1093,11 @@ u8 *rtw_get_wps_ie(u8 *in_ie, uint in_len, u8 *wps_ie, uint *wps_ielen) if (!in_ie) { rtw_warn_on(1); - return wpsie_ptr; + return (u8 *)wpsie_ptr; } if (in_len <= 0) - return wpsie_ptr; + return (u8 *)wpsie_ptr; cnt = 0; @@ -925,7 +1124,7 @@ u8 *rtw_get_wps_ie(u8 *in_ie, uint in_len, u8 *wps_ie, uint *wps_ielen) } - return wpsie_ptr; + return (u8 *)wpsie_ptr; } /** @@ -1236,6 +1435,28 @@ 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; +#ifdef CONFIG_RTW_MESH + case WLAN_EID_PREQ: + elems->preq = pos; + elems->preq_len = elen; + break; + case WLAN_EID_PREP: + elems->prep = pos; + elems->prep_len = elen; + break; + case WLAN_EID_PERR: + elems->perr = pos; + elems->perr_len = elen; + break; + case WLAN_EID_RANN: + elems->rann = pos; + elems->rann_len = elen; + break; +#endif default: unknown++; if (!show_errors) @@ -1397,13 +1618,6 @@ void rtw_macaddr_cfg(u8 *out, const u8 *hw_mac_addr) goto err_chk; } - if (!rockchip_wifi_mac_addr(mac)) { - printk("=========> get mac address from flash=[%02x:%02x:%02x:%02x:%02x:%02x]\n", mac[0], mac[1], - mac[2], mac[3], mac[4], mac[5]); - //_rtw_memcpy(mac_addr, mac, ETH_ALEN); - goto err_chk; - } - /* platform specified */ #ifdef CONFIG_PLATFORM_INTEL_BYT if (rtw_get_mac_addr_intel(mac) == 0) @@ -1440,40 +1654,70 @@ void rtw_macaddr_cfg(u8 *out, const u8 *hw_mac_addr) } #ifdef CONFIG_80211N_HT -void dump_ht_cap_ie_content(void *sel, u8 *buf, u32 buf_len) +void dump_ht_cap_ie_content(void *sel, const u8 *buf, u32 buf_len) { - if (buf_len != 26) { - RTW_PRINT_SEL(sel, "Invalid HT capability IE len:%d != %d\n", buf_len, 26); + if (buf_len != HT_CAP_IE_LEN) { + RTW_PRINT_SEL(sel, "Invalid HT capability IE len:%d != %d\n", buf_len, HT_CAP_IE_LEN); return; } - RTW_PRINT_SEL(sel, "HT Capabilities Info:%02x%02x\n", *(buf), *(buf + 1)); + RTW_PRINT_SEL(sel, "cap_info:%02x%02x:%s\n", *(buf), *(buf + 1) + , GET_HT_CAP_ELE_CHL_WIDTH(buf) ? " 40MHz" : " 20MHz"); RTW_PRINT_SEL(sel, "A-MPDU Parameters:"HT_AMPDU_PARA_FMT"\n" , HT_AMPDU_PARA_ARG(HT_CAP_ELE_AMPDU_PARA(buf))); RTW_PRINT_SEL(sel, "Supported MCS Set:"HT_SUP_MCS_SET_FMT"\n" , HT_SUP_MCS_SET_ARG(HT_CAP_ELE_SUP_MCS_SET(buf))); } -void dump_ht_cap_ie(void *sel, u8 *ie, u32 ie_len) +void dump_ht_cap_ie(void *sel, const u8 *ie, u32 ie_len) { - u8 *pos = (u8 *)ie; - u16 id; - u16 len; - - u8 *ht_cap_ie; + const u8 *ht_cap_ie; sint ht_cap_ielen; - ht_cap_ie = rtw_get_ie(ie, _HT_CAPABILITY_IE_, &ht_cap_ielen, ie_len); + ht_cap_ie = rtw_get_ie(ie, WLAN_EID_HT_CAP, &ht_cap_ielen, ie_len); if (!ie || ht_cap_ie != ie) return; dump_ht_cap_ie_content(sel, ht_cap_ie + 2, ht_cap_ielen); } + +const char *const _ht_sc_offset_str[] = { + "SCN", + "SCA", + "SC-RSVD", + "SCB", +}; + +void dump_ht_op_ie_content(void *sel, const u8 *buf, u32 buf_len) +{ + if (buf_len != HT_OP_IE_LEN) { + RTW_PRINT_SEL(sel, "Invalid HT operation IE len:%d != %d\n", buf_len, HT_OP_IE_LEN); + return; + } + + RTW_PRINT_SEL(sel, "ch:%u%s %s\n" + , GET_HT_OP_ELE_PRI_CHL(buf) + , GET_HT_OP_ELE_STA_CHL_WIDTH(buf) ? "" : " 20MHz only" + , ht_sc_offset_str(GET_HT_OP_ELE_2ND_CHL_OFFSET(buf)) + ); +} + +void dump_ht_op_ie(void *sel, const u8 *ie, u32 ie_len) +{ + const u8 *ht_op_ie; + sint ht_op_ielen; + + ht_op_ie = rtw_get_ie(ie, WLAN_EID_HT_OPERATION, &ht_op_ielen, ie_len); + if (!ie || ht_op_ie != ie) + return; + + dump_ht_op_ie_content(sel, ht_op_ie + 2, ht_op_ielen); +} #endif /* CONFIG_80211N_HT */ -void dump_ies(void *sel, u8 *buf, u32 buf_len) +void dump_ies(void *sel, const u8 *buf, u32 buf_len) { - u8 *pos = (u8 *)buf; + const u8 *pos = buf; u8 id, len; while (pos - buf + 1 < buf_len) { @@ -1483,6 +1727,11 @@ void dump_ies(void *sel, u8 *buf, u32 buf_len) RTW_PRINT_SEL(sel, "%s ID:%u, LEN:%u\n", __FUNCTION__, id, len); #ifdef CONFIG_80211N_HT dump_ht_cap_ie(sel, pos, len + 2); + dump_ht_op_ie(sel, pos, len + 2); +#endif +#ifdef CONFIG_80211AC_VHT + dump_vht_cap_ie(sel, pos, len + 2); + dump_vht_op_ie(sel, pos, len + 2); #endif dump_wps_ie(sel, pos, len + 2); #ifdef CONFIG_P2P @@ -1496,13 +1745,13 @@ void dump_ies(void *sel, u8 *buf, u32 buf_len) } } -void dump_wps_ie(void *sel, u8 *ie, u32 ie_len) +void dump_wps_ie(void *sel, const u8 *ie, u32 ie_len) { - u8 *pos = (u8 *)ie; + const u8 *pos = ie; u16 id; u16 len; - u8 *wps_ie; + const u8 *wps_ie; uint wps_ielen; wps_ie = rtw_get_wps_ie(ie, ie_len, NULL, &wps_ielen); @@ -1528,8 +1777,10 @@ void dump_wps_ie(void *sel, u8 *ie, u32 ie_len) * @ch: pointer of ch, used as output * @bw: pointer of bw, used as output * @offset: pointer of offset, used as output + * @ht: check HT IEs + * @vht: check VHT IEs, if true imply ht is true */ -void rtw_ies_get_chbw(u8 *ies, int ies_len, u8 *ch, u8 *bw, u8 *offset) +void rtw_ies_get_chbw(u8 *ies, int ies_len, u8 *ch, u8 *bw, u8 *offset, u8 ht, u8 vht) { u8 *p; int ie_len; @@ -1543,7 +1794,7 @@ void rtw_ies_get_chbw(u8 *ies, int ies_len, u8 *ch, u8 *bw, u8 *offset) *ch = *(p + 2); #ifdef CONFIG_80211N_HT - { + if (ht || vht) { u8 *ht_cap_ie, *ht_op_ie; int ht_cap_ielen, ht_op_ielen; @@ -1576,44 +1827,29 @@ void rtw_ies_get_chbw(u8 *ies, int ies_len, u8 *ch, u8 *bw, u8 *offset) } } } - } -#endif /* CONFIG_80211N_HT */ -#ifdef CONFIG_80211AC_VHT - { - u8 *vht_op_ie; - int vht_op_ielen; - vht_op_ie = rtw_get_ie(ies, EID_VHTOperation, &vht_op_ielen, ies_len); - if (vht_op_ie && vht_op_ielen) { - /* enable VHT 80 before check enable HT40 or not */ - if (GET_VHT_OPERATION_ELE_CHL_WIDTH(vht_op_ie + 2) >= 1) { - /* for HT40, enable VHT80 */ - if (*bw == CHANNEL_WIDTH_40) +#ifdef CONFIG_80211AC_VHT + if (vht) { + u8 *vht_op_ie; + int vht_op_ielen; + + vht_op_ie = rtw_get_ie(ies, EID_VHTOperation, &vht_op_ielen, ies_len); + if (vht_op_ie && vht_op_ielen) { + if (GET_VHT_OPERATION_ELE_CHL_WIDTH(vht_op_ie + 2) >= 1) *bw = CHANNEL_WIDTH_80; - /* for HT20, enable VHT20 */ - else if (*bw == CHANNEL_WIDTH_20) { - /* modify VHT OP IE */ - SET_VHT_OPERATION_ELE_CHL_WIDTH(vht_op_ie + 2, 0); - /* reset to 0 for VHT20 */ - SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ1(vht_op_ie + 2, 0); - SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ2(vht_op_ie + 2, 0); - } - } else { - /* - VHT OP WIDTH = 0 under HT20/HT40 - if REGSTY_BW_5G(pregistrypriv) < CHANNEL_WIDTH_80 in rtw_build_vht_operation_ie - */ } } +#endif /* CONFIG_80211AC_VHT */ + } -#endif +#endif /* CONFIG_80211N_HT */ } -void rtw_bss_get_chbw(WLAN_BSSID_EX *bss, u8 *ch, u8 *bw, u8 *offset) +void rtw_bss_get_chbw(WLAN_BSSID_EX *bss, u8 *ch, u8 *bw, u8 *offset, u8 ht, u8 vht) { rtw_ies_get_chbw(bss->IEs + sizeof(NDIS_802_11_FIXED_IEs) , bss->IELength - sizeof(NDIS_802_11_FIXED_IEs) - , ch, bw, offset); + , ch, bw, offset, ht, vht); if (*ch == 0) *ch = bss->Configuration.DSConfig; @@ -1680,7 +1916,7 @@ void rtw_sync_chbw(u8 *req_ch, u8 *req_bw, u8 *req_offset if (*g_bw == CHANNEL_WIDTH_40 || *g_bw == CHANNEL_WIDTH_80) *req_offset = *g_offset; else if (*g_bw == CHANNEL_WIDTH_20) - *req_offset = rtw_get_offset_by_ch(*req_ch); + rtw_get_offset_by_chbw(*req_ch, *req_bw, req_offset); if (*req_offset == HAL_PRIME_CHNL_OFFSET_DONT_CARE) { RTW_ERR("%s req 80MHz BW without offset, down to 20MHz\n", __func__); @@ -1692,7 +1928,7 @@ void rtw_sync_chbw(u8 *req_ch, u8 *req_bw, u8 *req_offset if (*g_bw == CHANNEL_WIDTH_40 || *g_bw == CHANNEL_WIDTH_80) *req_offset = *g_offset; else if (*g_bw == CHANNEL_WIDTH_20) - *req_offset = rtw_get_offset_by_ch(*req_ch); + rtw_get_offset_by_chbw(*req_ch, *req_bw, req_offset); if (*req_offset == HAL_PRIME_CHNL_OFFSET_DONT_CARE) { RTW_ERR("%s req 40MHz BW without offset, down to 20MHz\n", __func__); @@ -1725,7 +1961,7 @@ u32 rtw_get_p2p_merged_ies_len(u8 *in_ie, u32 in_len) PNDIS_802_11_VARIABLE_IEs pIE; u8 OUI[4] = { 0x50, 0x6f, 0x9a, 0x09 }; int i = 0; - int j = 0, len = 0; + int len = 0; while (i < in_len) { pIE = (PNDIS_802_11_VARIABLE_IEs)(in_ie + i); @@ -1780,13 +2016,13 @@ int rtw_p2p_merge_ies(u8 *in_ie, u32 in_len, u8 *merge_ie) return 0; } -void dump_p2p_ie(void *sel, u8 *ie, u32 ie_len) +void dump_p2p_ie(void *sel, const u8 *ie, u32 ie_len) { - u8 *pos = (u8 *)ie; + const u8 *pos = ie; u8 id; u16 len; - u8 *p2p_ie; + const u8 *p2p_ie; uint p2p_ielen; p2p_ie = rtw_get_p2p_ie(ie, ie_len, NULL, &p2p_ielen); @@ -1814,10 +2050,10 @@ void dump_p2p_ie(void *sel, u8 *ie, u32 ie_len) * * Returns: The address of the P2P IE found, or NULL */ -u8 *rtw_get_p2p_ie(u8 *in_ie, int in_len, u8 *p2p_ie, uint *p2p_ielen) +u8 *rtw_get_p2p_ie(const u8 *in_ie, int in_len, u8 *p2p_ie, uint *p2p_ielen) { uint cnt; - u8 *p2p_ie_ptr = NULL; + const u8 *p2p_ie_ptr = NULL; u8 eid, p2p_oui[4] = {0x50, 0x6F, 0x9A, 0x09}; if (p2p_ielen) @@ -1825,11 +2061,11 @@ u8 *rtw_get_p2p_ie(u8 *in_ie, int in_len, u8 *p2p_ie, uint *p2p_ielen) if (!in_ie || in_len < 0) { rtw_warn_on(1); - return p2p_ie_ptr; + return (u8 *)p2p_ie_ptr; } if (in_len <= 0) - return p2p_ie_ptr; + return (u8 *)p2p_ie_ptr; cnt = 0; @@ -1856,7 +2092,7 @@ u8 *rtw_get_p2p_ie(u8 *in_ie, int in_len, u8 *p2p_ie, uint *p2p_ielen) } - return p2p_ie_ptr; + return (u8 *)p2p_ie_ptr; } /** @@ -2124,13 +2360,13 @@ void rtw_bss_ex_del_p2p_attr(WLAN_BSSID_EX *bss_ex, u8 attr_id) } } -void dump_wfd_ie(void *sel, u8 *ie, u32 ie_len) +void dump_wfd_ie(void *sel, const u8 *ie, u32 ie_len) { - u8 *pos = (u8 *)ie; + const u8 *pos = ie; u8 id; u16 len; - u8 *wfd_ie; + const u8 *wfd_ie; uint wfd_ielen; wfd_ie = rtw_get_wfd_ie(ie, ie_len, NULL, &wfd_ielen); @@ -2158,10 +2394,10 @@ void dump_wfd_ie(void *sel, u8 *ie, u32 ie_len) * * Returns: The address of the P2P IE found, or NULL */ -u8 *rtw_get_wfd_ie(u8 *in_ie, int in_len, u8 *wfd_ie, uint *wfd_ielen) +u8 *rtw_get_wfd_ie(const u8 *in_ie, int in_len, u8 *wfd_ie, uint *wfd_ielen) { uint cnt; - u8 *wfd_ie_ptr = NULL; + const u8 *wfd_ie_ptr = NULL; u8 eid, wfd_oui[4] = {0x50, 0x6F, 0x9A, 0x0A}; if (wfd_ielen) @@ -2169,11 +2405,11 @@ u8 *rtw_get_wfd_ie(u8 *in_ie, int in_len, u8 *wfd_ie, uint *wfd_ielen) if (!in_ie || in_len < 0) { rtw_warn_on(1); - return wfd_ie_ptr; + return (u8 *)wfd_ie_ptr; } if (in_len <= 0) - return wfd_ie_ptr; + return (u8 *)wfd_ie_ptr; cnt = 0; @@ -2200,7 +2436,7 @@ u8 *rtw_get_wfd_ie(u8 *in_ie, int in_len, u8 *wfd_ie, uint *wfd_ielen) } - return wfd_ie_ptr; + return (u8 *)wfd_ie_ptr; } /** @@ -2515,7 +2751,7 @@ int rtw_get_cipher_info(struct wlan_network *pnetwork) pbuf = rtw_get_wpa2_ie(&pnetwork->network.IEs[12], &wpa_ielen, pnetwork->network.IELength - 12); if (pbuf && (wpa_ielen > 0)) { - if (_SUCCESS == rtw_parse_wpa2_ie(pbuf, wpa_ielen + 2, &group_cipher, &pairwise_cipher, &is8021x)) { + if (_SUCCESS == rtw_parse_wpa2_ie(pbuf, wpa_ielen + 2, &group_cipher, &pairwise_cipher, &is8021x, NULL)) { pnetwork->BcnInfo.pairwise_cipher = pairwise_cipher; pnetwork->BcnInfo.group_cipher = group_cipher; pnetwork->BcnInfo.is_8021x = is8021x; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_io.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_io.c index 683da1694754..d6ea33ce4db0 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_io.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_io.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 @@ -52,11 +48,7 @@ jackson@realtek.com.tw #include #include -#if defined(PLATFORM_LINUX) && defined (PLATFORM_WINDOWS) - #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 @@ -424,9 +416,13 @@ u32 _rtw_write_port_and_wait(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem, int ret = _rtw_write_port(adapter, addr, cnt, pmem); - if (ret == _SUCCESS) + if (ret == _SUCCESS) { ret = rtw_sctx_wait(&sctx, __func__); + if (ret != _SUCCESS) + pxmitbuf->sctx = NULL; + } + return ret; } @@ -489,39 +485,209 @@ void rtw_reset_continual_io_error(struct dvobj_priv *dvobj) } #ifdef DBG_IO +#define RTW_IO_SNIFF_TYPE_RANGE 0 /* specific address range is accessed */ +#define RTW_IO_SNIFF_TYPE_VALUE 1 /* value match for sniffed range */ -u32 read_sniff_ranges[][2] = { - /* {0x520, 0x523}, */ +struct rtw_io_sniff_ent { + u8 chip; + u8 hci; + u32 addr; + u8 type; + union { + u32 end_addr; + struct { + u32 mask; + u32 val; + bool equal; + } vm; /* value match */ + } u; + bool trace; + char *tag; }; -u32 write_sniff_ranges[][2] = { - /* {0x520, 0x523}, */ - /* {0x4c, 0x4c}, */ +#define RTW_IO_SNIFF_RANGE_ENT(_chip, _hci, _addr, _end_addr, _trace, _tag) \ + {.chip = _chip, .hci = _hci, .addr = _addr, .u.end_addr = _end_addr, .trace = _trace, .tag = _tag, .type = RTW_IO_SNIFF_TYPE_RANGE,} + +#define RTW_IO_SNIFF_VALUE_ENT(_chip, _hci, _addr, _mask, _val, _equal, _trace, _tag) \ + {.chip = _chip, .hci = _hci, .addr = _addr, .u.vm.mask = _mask, .u.vm.val = _val, .u.vm.equal = _equal, .trace = _trace, .tag = _tag, .type = RTW_IO_SNIFF_TYPE_VALUE,} + +/* part or all sniffed range is enabled (not all 0) */ +#define RTW_IO_SNIFF_EN_ENT(_chip, _hci, _addr, _mask, _trace, _tag) \ + {.chip = _chip, .hci = _hci, .addr = _addr, .u.vm.mask = _mask, .u.vm.val = 0, .u.vm.equal = 0, .trace = _trace, .tag = _tag, .type = RTW_IO_SNIFF_TYPE_VALUE,} + +/* part or all sniffed range is disabled (not all 1) */ +#define RTW_IO_SNIFF_DIS_ENT(_chip, _hci, _addr, _mask, _trace, _tag) \ + {.chip = _chip, .hci = _hci, .addr = _addr, .u.vm.mask = _mask, .u.vm.val = 0xFFFFFFFF, .u.vm.equal = 0, .trace = _trace, .tag = _tag, .type = RTW_IO_SNIFF_TYPE_VALUE,} + +const struct rtw_io_sniff_ent read_sniff[] = { +#ifdef DBG_IO_HCI_EN_CHK + RTW_IO_SNIFF_EN_ENT(MAX_CHIP_TYPE, RTW_SDIO, 0x02, 0x1FC, 1, "SDIO 0x02[8:2] not all 0"), + RTW_IO_SNIFF_EN_ENT(MAX_CHIP_TYPE, RTW_USB, 0x02, 0x1E0, 1, "USB 0x02[8:5] not all 0"), + RTW_IO_SNIFF_EN_ENT(MAX_CHIP_TYPE, RTW_PCIE, 0x02, 0x01C, 1, "PCI 0x02[4:2] not all 0"), +#endif +#ifdef DBG_IO_SNIFF_EXAMPLE + RTW_IO_SNIFF_RANGE_ENT(MAX_CHIP_TYPE, 0, 0x522, 0x522, 0, "read TXPAUSE"), + RTW_IO_SNIFF_DIS_ENT(MAX_CHIP_TYPE, 0, 0x02, 0x3, 0, "0x02[1:0] not all 1"), +#endif }; -int read_sniff_num = sizeof(read_sniff_ranges) / sizeof(u32) / 2; -int write_sniff_num = sizeof(write_sniff_ranges) / sizeof(u32) / 2; +const int read_sniff_num = sizeof(read_sniff) / sizeof(struct rtw_io_sniff_ent); -bool match_read_sniff_ranges(u32 addr, u16 len) +const struct rtw_io_sniff_ent write_sniff[] = { +#ifdef DBG_IO_HCI_EN_CHK + RTW_IO_SNIFF_EN_ENT(MAX_CHIP_TYPE, RTW_SDIO, 0x02, 0x1FC, 1, "SDIO 0x02[8:2] not all 0"), + RTW_IO_SNIFF_EN_ENT(MAX_CHIP_TYPE, RTW_USB, 0x02, 0x1E0, 1, "USB 0x02[8:5] not all 0"), + RTW_IO_SNIFF_EN_ENT(MAX_CHIP_TYPE, RTW_PCIE, 0x02, 0x01C, 1, "PCI 0x02[4:2] not all 0"), +#endif +#ifdef DBG_IO_8822C_1TX_PATH_EN + RTW_IO_SNIFF_VALUE_ENT(RTL8822C, 0, 0x1a04, 0xc0000000, 0x02, 1, 0, "write tx_path_en_cck A enabled"), + RTW_IO_SNIFF_VALUE_ENT(RTL8822C, 0, 0x1a04, 0xc0000000, 0x01, 1, 0, "write tx_path_en_cck B enabled"), + RTW_IO_SNIFF_VALUE_ENT(RTL8822C, 0, 0x1a04, 0xc0000000, 0x03, 1, 1, "write tx_path_en_cck AB enabled"), + RTW_IO_SNIFF_VALUE_ENT(RTL8822C, 0, 0x820, 0x03, 0x01, 1, 0, "write tx_path_en_ofdm_1sts A enabled"), + RTW_IO_SNIFF_VALUE_ENT(RTL8822C, 0, 0x820, 0x03, 0x02, 1, 0, "write tx_path_en_ofdm_1sts B enabled"), + RTW_IO_SNIFF_VALUE_ENT(RTL8822C, 0, 0x820, 0x03, 0x03, 1, 1, "write tx_path_en_ofdm_1sts AB enabled"), + RTW_IO_SNIFF_VALUE_ENT(RTL8822C, 0, 0x820, 0x30, 0x01, 1, 0, "write tx_path_en_ofdm_2sts A enabled"), + RTW_IO_SNIFF_VALUE_ENT(RTL8822C, 0, 0x820, 0x30, 0x02, 1, 0, "write tx_path_en_ofdm_2sts B enabled"), + RTW_IO_SNIFF_VALUE_ENT(RTL8822C, 0, 0x820, 0x30, 0x03, 1, 1, "write tx_path_en_ofdm_2sts AB enabled"), +#endif +#ifdef DBG_IO_SNIFF_EXAMPLE + RTW_IO_SNIFF_RANGE_ENT(MAX_CHIP_TYPE, 0, 0x522, 0x522, 0, "write TXPAUSE"), + RTW_IO_SNIFF_DIS_ENT(MAX_CHIP_TYPE, 0, 0x02, 0x3, 0, "0x02[1:0] not all 1"), +#endif +}; + +const int write_sniff_num = sizeof(write_sniff) / sizeof(struct rtw_io_sniff_ent); + +static bool match_io_sniff_ranges(_adapter *adapter + , const struct rtw_io_sniff_ent *sniff, int i, u32 addr, u16 len) { - int i; - for (i = 0; i < read_sniff_num; i++) { - if (addr + len > read_sniff_ranges[i][0] && addr <= read_sniff_ranges[i][1]) - return _TRUE; - } - return _FALSE; + /* check if IO range after sniff end address */ + if (addr > sniff->u.end_addr) + return 0; + + return 1; } -bool match_write_sniff_ranges(u32 addr, u16 len) +static bool match_io_sniff_value(_adapter *adapter + , const struct rtw_io_sniff_ent *sniff, int i, u32 addr, u8 len, u32 val) { - int i; - for (i = 0; i < write_sniff_num; i++) { - if (addr + len > write_sniff_ranges[i][0] && addr <= write_sniff_ranges[i][1]) - return _TRUE; + u8 sniff_len; + s8 mask_shift; + u32 mask; + s8 value_shift; + u32 value; + bool ret = 0; + + /* check if IO range after sniff end address */ + sniff_len = 4; + while (!(sniff->u.vm.mask & (0xFF << ((sniff_len - 1) * 8)))) { + sniff_len--; + if (sniff_len == 0) + goto exit; + } + if (sniff->addr + sniff_len <= addr) + goto exit; + + /* align to IO addr */ + mask_shift = (sniff->addr - addr) * 8; + value_shift = mask_shift + bitshift(sniff->u.vm.mask); + if (mask_shift > 0) + mask = sniff->u.vm.mask << mask_shift; + else if (mask_shift < 0) + mask = sniff->u.vm.mask >> -mask_shift; + else + mask = sniff->u.vm.mask; + + if (value_shift > 0) + value = sniff->u.vm.val << value_shift; + else if (mask_shift < 0) + value = sniff->u.vm.val >> -value_shift; + else + value = sniff->u.vm.val; + + if ((sniff->u.vm.equal && (mask & val) == (mask & value)) + || (!sniff->u.vm.equal && (mask & val) != (mask & value)) + ) { + ret = 1; + if (0) + RTW_INFO(FUNC_ADPT_FMT" addr:0x%x len:%u val:0x%x (i:%d sniff_len:%u m_shift:%d mask:0x%x v_shifd:%d value:0x%x equal:%d)\n" + , FUNC_ADPT_ARG(adapter), addr, len, val, i, sniff_len, mask_shift, mask, value_shift, value, sniff->u.vm.equal); } - return _FALSE; +exit: + return ret; +} + +static bool match_io_sniff(_adapter *adapter + , const struct rtw_io_sniff_ent *sniff, int i, u32 addr, u8 len, u32 val) +{ + bool ret = 0; + + if (sniff->chip != MAX_CHIP_TYPE + && sniff->chip != rtw_get_chip_type(adapter)) + goto exit; + if (sniff->hci + && !(sniff->hci & rtw_get_intf_type(adapter))) + goto exit; + if (sniff->addr >= addr + len) /* IO range below sniff start address */ + goto exit; + + switch (sniff->type) { + case RTW_IO_SNIFF_TYPE_RANGE: + ret = match_io_sniff_ranges(adapter, sniff, i, addr, len); + break; + case RTW_IO_SNIFF_TYPE_VALUE: + if (len == 1 || len == 2 || len == 4) + ret = match_io_sniff_value(adapter, sniff, i, addr, len, val); + break; + default: + rtw_warn_on(1); + break; + } + +exit: + return ret; +} + +u32 match_read_sniff(_adapter *adapter, u32 addr, u16 len, u32 val) +{ + int i; + bool trace = 0; + u32 match = 0; + + for (i = 0; i < read_sniff_num; i++) { + if (match_io_sniff(adapter, &read_sniff[i], i, addr, len, val)) { + match++; + trace |= read_sniff[i].trace; + if (read_sniff[i].tag) + RTW_INFO("DBG_IO TAG %s\n", read_sniff[i].tag); + } + } + + rtw_warn_on(trace); + + return match; +} + +u32 match_write_sniff(_adapter *adapter, u32 addr, u16 len, u32 val) +{ + int i; + bool trace = 0; + u32 match = 0; + + for (i = 0; i < write_sniff_num; i++) { + if (match_io_sniff(adapter, &write_sniff[i], i, addr, len, val)) { + match++; + trace |= write_sniff[i].trace; + if (write_sniff[i].tag) + RTW_INFO("DBG_IO TAG %s\n", write_sniff[i].tag); + } + } + + rtw_warn_on(trace); + + return match; } struct rf_sniff_ent { @@ -543,7 +709,7 @@ struct rf_sniff_ent rf_write_sniff_ranges[] = { int rf_read_sniff_num = sizeof(rf_read_sniff_ranges) / sizeof(struct rf_sniff_ent); int rf_write_sniff_num = sizeof(rf_write_sniff_ranges) / sizeof(struct rf_sniff_ent); -bool match_rf_read_sniff_ranges(u8 path, u32 addr, u32 mask) +bool match_rf_read_sniff_ranges(_adapter *adapter, u8 path, u32 addr, u32 mask) { int i; @@ -556,7 +722,7 @@ bool match_rf_read_sniff_ranges(u8 path, u32 addr, u32 mask) return _FALSE; } -bool match_rf_write_sniff_ranges(u8 path, u32 addr, u32 mask) +bool match_rf_write_sniff_ranges(_adapter *adapter, u8 path, u32 addr, u32 mask) { int i; @@ -573,8 +739,10 @@ u8 dbg_rtw_read8(_adapter *adapter, u32 addr, const char *caller, const int line { u8 val = _rtw_read8(adapter, addr); - if (match_read_sniff_ranges(addr, 1)) - RTW_INFO("DBG_IO %s:%d rtw_read8(0x%04x) return 0x%02x\n", caller, line, addr, val); + if (match_read_sniff(adapter, addr, 1, val)) { + RTW_INFO("DBG_IO %s:%d rtw_read8(0x%04x) return 0x%02x\n" + , caller, line, addr, val); + } return val; } @@ -583,8 +751,10 @@ u16 dbg_rtw_read16(_adapter *adapter, u32 addr, const char *caller, const int li { u16 val = _rtw_read16(adapter, addr); - if (match_read_sniff_ranges(addr, 2)) - RTW_INFO("DBG_IO %s:%d rtw_read16(0x%04x) return 0x%04x\n", caller, line, addr, val); + if (match_read_sniff(adapter, addr, 2, val)) { + RTW_INFO("DBG_IO %s:%d rtw_read16(0x%04x) return 0x%04x\n" + , caller, line, addr, val); + } return val; } @@ -593,37 +763,47 @@ u32 dbg_rtw_read32(_adapter *adapter, u32 addr, const char *caller, const int li { u32 val = _rtw_read32(adapter, addr); - if (match_read_sniff_ranges(addr, 4)) - RTW_INFO("DBG_IO %s:%d rtw_read32(0x%04x) return 0x%08x\n", caller, line, addr, val); + if (match_read_sniff(adapter, addr, 4, val)) { + RTW_INFO("DBG_IO %s:%d rtw_read32(0x%04x) return 0x%08x\n" + , caller, line, addr, val); + } return val; } int dbg_rtw_write8(_adapter *adapter, u32 addr, u8 val, const char *caller, const int line) { - if (match_write_sniff_ranges(addr, 1)) - RTW_INFO("DBG_IO %s:%d rtw_write8(0x%04x, 0x%02x)\n", caller, line, addr, val); + if (match_write_sniff(adapter, addr, 1, val)) { + RTW_INFO("DBG_IO %s:%d rtw_write8(0x%04x, 0x%02x)\n" + , caller, line, addr, val); + } return _rtw_write8(adapter, addr, val); } int dbg_rtw_write16(_adapter *adapter, u32 addr, u16 val, const char *caller, const int line) { - if (match_write_sniff_ranges(addr, 2)) - RTW_INFO("DBG_IO %s:%d rtw_write16(0x%04x, 0x%04x)\n", caller, line, addr, val); + if (match_write_sniff(adapter, addr, 2, val)) { + RTW_INFO("DBG_IO %s:%d rtw_write16(0x%04x, 0x%04x)\n" + , caller, line, addr, val); + } return _rtw_write16(adapter, addr, val); } int dbg_rtw_write32(_adapter *adapter, u32 addr, u32 val, const char *caller, const int line) { - if (match_write_sniff_ranges(addr, 4)) - RTW_INFO("DBG_IO %s:%d rtw_write32(0x%04x, 0x%08x)\n", caller, line, addr, val); + if (match_write_sniff(adapter, addr, 4, val)) { + RTW_INFO("DBG_IO %s:%d rtw_write32(0x%04x, 0x%08x)\n" + , caller, line, addr, val); + } return _rtw_write32(adapter, addr, val); } int dbg_rtw_writeN(_adapter *adapter, u32 addr , u32 length , u8 *data, const char *caller, const int line) { - if (match_write_sniff_ranges(addr, length)) - RTW_INFO("DBG_IO %s:%d rtw_writeN(0x%04x, %u)\n", caller, line, addr, length); + if (match_write_sniff(adapter, addr, length, 0)) { + RTW_INFO("DBG_IO %s:%d rtw_writeN(0x%04x, %u)\n" + , caller, line, addr, length); + } return _rtw_writeN(adapter, addr, length, data); } @@ -634,8 +814,10 @@ u8 dbg_rtw_sd_f0_read8(_adapter *adapter, u32 addr, const char *caller, const in u8 val = _rtw_sd_f0_read8(adapter, addr); #if 0 - if (match_read_sniff_ranges(addr, 1)) - RTW_INFO("DBG_IO %s:%d rtw_sd_f0_read8(0x%04x) return 0x%02x\n", caller, line, addr, val); + if (match_read_sniff(adapter, addr, 1, val)) { + RTW_INFO("DBG_IO %s:%d rtw_sd_f0_read8(0x%04x) return 0x%02x\n" + , caller, line, addr, val); + } #endif return val; @@ -646,8 +828,10 @@ u8 dbg_rtw_sd_iread8(_adapter *adapter, u32 addr, const char *caller, const int { u8 val = rtw_sd_iread8(adapter, addr); - if (match_read_sniff_ranges(addr, 1)) - RTW_INFO("DBG_IO %s:%d rtw_sd_iread8(0x%04x) return 0x%02x\n", caller, line, addr, val); + if (match_read_sniff(adapter, addr, 1, val)) { + RTW_INFO("DBG_IO %s:%d rtw_sd_iread8(0x%04x) return 0x%02x\n" + , caller, line, addr, val); + } return val; } @@ -656,8 +840,10 @@ u16 dbg_rtw_sd_iread16(_adapter *adapter, u32 addr, const char *caller, const in { u16 val = _rtw_sd_iread16(adapter, addr); - if (match_read_sniff_ranges(addr, 2)) - RTW_INFO("DBG_IO %s:%d rtw_sd_iread16(0x%04x) return 0x%04x\n", caller, line, addr, val); + if (match_read_sniff(adapter, addr, 2, val)) { + RTW_INFO("DBG_IO %s:%d rtw_sd_iread16(0x%04x) return 0x%04x\n" + , caller, line, addr, val); + } return val; } @@ -666,30 +852,38 @@ u32 dbg_rtw_sd_iread32(_adapter *adapter, u32 addr, const char *caller, const in { u32 val = _rtw_sd_iread32(adapter, addr); - if (match_read_sniff_ranges(addr, 4)) - RTW_INFO("DBG_IO %s:%d rtw_sd_iread32(0x%04x) return 0x%08x\n", caller, line, addr, val); + if (match_read_sniff(adapter, addr, 4, val)) { + RTW_INFO("DBG_IO %s:%d rtw_sd_iread32(0x%04x) return 0x%08x\n" + , caller, line, addr, val); + } return val; } int dbg_rtw_sd_iwrite8(_adapter *adapter, u32 addr, u8 val, const char *caller, const int line) { - if (match_write_sniff_ranges(addr, 1)) - RTW_INFO("DBG_IO %s:%d rtw_sd_iwrite8(0x%04x, 0x%02x)\n", caller, line, addr, val); + if (match_write_sniff(adapter, addr, 1, val)) { + RTW_INFO("DBG_IO %s:%d rtw_sd_iwrite8(0x%04x, 0x%02x)\n" + , caller, line, addr, val); + } return _rtw_sd_iwrite8(adapter, addr, val); } int dbg_rtw_sd_iwrite16(_adapter *adapter, u32 addr, u16 val, const char *caller, const int line) { - if (match_write_sniff_ranges(addr, 2)) - RTW_INFO("DBG_IO %s:%d rtw_sd_iwrite16(0x%04x, 0x%04x)\n", caller, line, addr, val); + if (match_write_sniff(adapter, addr, 2, val)) { + RTW_INFO("DBG_IO %s:%d rtw_sd_iwrite16(0x%04x, 0x%04x)\n" + , caller, line, addr, val); + } return _rtw_sd_iwrite16(adapter, addr, val); } int dbg_rtw_sd_iwrite32(_adapter *adapter, u32 addr, u32 val, const char *caller, const int line) { - if (match_write_sniff_ranges(addr, 4)) - RTW_INFO("DBG_IO %s:%d rtw_sd_iwrite32(0x%04x, 0x%08x)\n", caller, line, addr, val); + if (match_write_sniff(adapter, addr, 4, val)) { + RTW_INFO("DBG_IO %s:%d rtw_sd_iwrite32(0x%04x, 0x%08x)\n" + , caller, line, addr, val); + } return _rtw_sd_iwrite32(adapter, addr, val); } diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_ioctl_query.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_ioctl_query.c index 4f8232dfaf80..e608273c7de9 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_ioctl_query.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_ioctl_query.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,161 +12,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 _RTW_IOCTL_QUERY_C_ #include -#ifdef PLATFORM_WINDOWS -/* - * Added for WPA2-PSK, by Annie, 2005-09-20. - * */ -u8 -query_802_11_capability( - _adapter *Adapter, - u8 *pucBuf, - u32 *pulOutLen -) -{ - static NDIS_802_11_AUTHENTICATION_ENCRYPTION szAuthEnc[] = { - {Ndis802_11AuthModeOpen, Ndis802_11EncryptionDisabled}, - {Ndis802_11AuthModeOpen, Ndis802_11Encryption1Enabled}, - {Ndis802_11AuthModeShared, Ndis802_11EncryptionDisabled}, - {Ndis802_11AuthModeShared, Ndis802_11Encryption1Enabled}, - {Ndis802_11AuthModeWPA, Ndis802_11Encryption2Enabled}, - {Ndis802_11AuthModeWPA, Ndis802_11Encryption3Enabled}, - {Ndis802_11AuthModeWPAPSK, Ndis802_11Encryption2Enabled}, - {Ndis802_11AuthModeWPAPSK, Ndis802_11Encryption3Enabled}, - {Ndis802_11AuthModeWPANone, Ndis802_11Encryption2Enabled}, - {Ndis802_11AuthModeWPANone, Ndis802_11Encryption3Enabled}, - {Ndis802_11AuthModeWPA2, Ndis802_11Encryption2Enabled}, - {Ndis802_11AuthModeWPA2, Ndis802_11Encryption3Enabled}, - {Ndis802_11AuthModeWPA2PSK, Ndis802_11Encryption2Enabled}, - {Ndis802_11AuthModeWPA2PSK, Ndis802_11Encryption3Enabled} - }; - static ULONG ulNumOfPairSupported = sizeof(szAuthEnc) / sizeof(NDIS_802_11_AUTHENTICATION_ENCRYPTION); - NDIS_802_11_CAPABILITY *pCap = (NDIS_802_11_CAPABILITY *)pucBuf; - u8 *pucAuthEncryptionSupported = (u8 *) pCap->AuthenticationEncryptionSupported; - - - pCap->Length = sizeof(NDIS_802_11_CAPABILITY); - if (ulNumOfPairSupported > 1) - pCap->Length += (ulNumOfPairSupported - 1) * sizeof(NDIS_802_11_AUTHENTICATION_ENCRYPTION); - - pCap->Version = 2; - pCap->NoOfPMKIDs = NUM_PMKID_CACHE; - pCap->NoOfAuthEncryptPairsSupported = ulNumOfPairSupported; - - if (sizeof(szAuthEnc) <= 240) /* 240 = 256 - 4*4 */ { /* SecurityInfo.szCapability: only 256 bytes in size. */ - _rtw_memcpy(pucAuthEncryptionSupported, (u8 *)szAuthEnc, sizeof(szAuthEnc)); - *pulOutLen = pCap->Length; - return _TRUE; - } else { - *pulOutLen = 0; - return _FALSE; - } -} - -u8 query_802_11_association_information(_adapter *padapter, PNDIS_802_11_ASSOCIATION_INFORMATION pAssocInfo) -{ - struct wlan_network *tgt_network; - struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); - struct security_priv *psecuritypriv = &(padapter->securitypriv); - WLAN_BSSID_EX *psecnetwork = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; - u8 *pDest = (u8 *)pAssocInfo + sizeof(NDIS_802_11_ASSOCIATION_INFORMATION); - unsigned char i, *auth_ie, *supp_ie; - - /* NdisZeroMemory(pAssocInfo, sizeof(NDIS_802_11_ASSOCIATION_INFORMATION)); */ - _rtw_memset(pAssocInfo, 0, sizeof(NDIS_802_11_ASSOCIATION_INFORMATION)); - /* pAssocInfo->Length = sizeof(NDIS_802_11_ASSOCIATION_INFORMATION); */ - - /* ------------------------------------------------------ */ - /* Association Request related information */ - /* ------------------------------------------------------ */ - /* Req_1. AvailableRequestFixedIEs */ - if (psecnetwork != NULL) { - - pAssocInfo->AvailableRequestFixedIEs |= NDIS_802_11_AI_REQFI_CAPABILITIES | NDIS_802_11_AI_REQFI_CURRENTAPADDRESS; - pAssocInfo->RequestFixedIEs.Capabilities = (unsigned short) *&psecnetwork->IEs[10]; - _rtw_memcpy(pAssocInfo->RequestFixedIEs.CurrentAPAddress, - &psecnetwork->MacAddress, 6); - - pAssocInfo->OffsetRequestIEs = sizeof(NDIS_802_11_ASSOCIATION_INFORMATION); - - if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING | _FW_LINKED) == _TRUE) { - - if (psecuritypriv->ndisauthtype >= Ndis802_11AuthModeWPA2) - pDest[0] = 48; /* RSN Information Element */ - else - pDest[0] = 221; /* WPA(SSN) Information Element */ - - supp_ie = &psecuritypriv->supplicant_ie[0]; - - i = 13; /* 0~11 is fixed information element */ - while ((i < supp_ie[0]) && (i < 256)) { - if ((unsigned char)supp_ie[i] == pDest[0]) { - _rtw_memcpy((u8 *)(pDest), - &supp_ie[i], - supp_ie[1 + i] + 2); - - break; - } - - i = i + supp_ie[i + 1] + 2; - if (supp_ie[1 + i] == 0) - i = i + 1; - - } - - - pAssocInfo->RequestIELength += (2 + supp_ie[1 + i]); /* (2 + psecnetwork->IEs[1+i]+4); */ - - } - - - - } - - - /* ------------------------------------------------------ */ - /* Association Response related information */ - /* ------------------------------------------------------ */ - - if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { - tgt_network = &(pmlmepriv->cur_network); - if (tgt_network != NULL) { - pAssocInfo->AvailableResponseFixedIEs = - NDIS_802_11_AI_RESFI_CAPABILITIES - | NDIS_802_11_AI_RESFI_ASSOCIATIONID - ; - - pAssocInfo->ResponseFixedIEs.Capabilities = (unsigned short) *&tgt_network->network.IEs[10]; - pAssocInfo->ResponseFixedIEs.StatusCode = 0; - pAssocInfo->ResponseFixedIEs.AssociationId = (unsigned short) tgt_network->aid; - - pDest = (u8 *)pAssocInfo + sizeof(NDIS_802_11_ASSOCIATION_INFORMATION) + pAssocInfo->RequestIELength; - auth_ie = &psecuritypriv->authenticator_ie[0]; - - - i = auth_ie[0] - 12; - if (i > 0) { - _rtw_memcpy((u8 *)&pDest[0], &auth_ie[1], i); - pAssocInfo->ResponseIELength = i; - } - - - pAssocInfo->OffsetResponseIEs = sizeof(NDIS_802_11_ASSOCIATION_INFORMATION) + pAssocInfo->RequestIELength; - - - } - } - - return _TRUE; -} -#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_ioctl_rtl.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_ioctl_rtl.c deleted file mode 100644 index ab4a3871c935..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_ioctl_rtl.c +++ /dev/null @@ -1,904 +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 - * - * - ******************************************************************************/ -#define _RTW_IOCTL_RTL_C_ - -#include - -#ifdef CONFIG_MP_INCLUDED - #include -#endif - -struct oid_obj_priv oid_rtl_seg_01_01[] = { - {1, &oid_null_function}, /* 0x80 */ - {1, &oid_null_function}, /* 0x81 */ - {1, &oid_null_function}, /* 0x82 */ - {1, &oid_null_function}, /* 0x83 */ /* OID_RT_SET_SNIFFER_MODE */ - {1, &oid_rt_get_signal_quality_hdl}, /* 0x84 */ - {1, &oid_rt_get_small_packet_crc_hdl}, /* 0x85 */ - {1, &oid_rt_get_middle_packet_crc_hdl}, /* 0x86 */ - {1, &oid_rt_get_large_packet_crc_hdl}, /* 0x87 */ - {1, &oid_rt_get_tx_retry_hdl}, /* 0x88 */ - {1, &oid_rt_get_rx_retry_hdl}, /* 0x89 */ - {1, &oid_rt_pro_set_fw_dig_state_hdl}, /* 0x8A */ - {1, &oid_rt_pro_set_fw_ra_state_hdl} , /* 0x8B */ - {1, &oid_null_function}, /* 0x8C */ - {1, &oid_null_function}, /* 0x8D */ - {1, &oid_null_function}, /* 0x8E */ - {1, &oid_null_function}, /* 0x8F */ - {1, &oid_rt_get_rx_total_packet_hdl}, /* 0x90 */ - {1, &oid_rt_get_tx_beacon_ok_hdl}, /* 0x91 */ - {1, &oid_rt_get_tx_beacon_err_hdl}, /* 0x92 */ - {1, &oid_rt_get_rx_icv_err_hdl}, /* 0x93 */ - {1, &oid_rt_set_encryption_algorithm_hdl}, /* 0x94 */ - {1, &oid_null_function}, /* 0x95 */ - {1, &oid_rt_get_preamble_mode_hdl}, /* 0x96 */ - {1, &oid_null_function}, /* 0x97 */ - {1, &oid_rt_get_ap_ip_hdl}, /* 0x98 */ - {1, &oid_rt_get_channelplan_hdl}, /* 0x99 */ - {1, &oid_rt_set_preamble_mode_hdl}, /* 0x9A */ - {1, &oid_rt_set_bcn_intvl_hdl}, /* 0x9B */ - {1, &oid_null_function}, /* 0x9C */ - {1, &oid_rt_dedicate_probe_hdl}, /* 0x9D */ - {1, &oid_null_function}, /* 0x9E */ - {1, &oid_null_function}, /* 0x9F */ - {1, &oid_null_function}, /* 0xA0 */ - {1, &oid_null_function}, /* 0xA1 */ - {1, &oid_null_function}, /* 0xA2 */ - {1, &oid_null_function}, /* 0xA3 */ - {1, &oid_null_function}, /* 0xA4 */ - {1, &oid_null_function}, /* 0xA5 */ - {1, &oid_null_function}, /* 0xA6 */ - {1, &oid_rt_get_total_tx_bytes_hdl}, /* 0xA7 */ - {1, &oid_rt_get_total_rx_bytes_hdl}, /* 0xA8 */ - {1, &oid_rt_current_tx_power_level_hdl}, /* 0xA9 */ - {1, &oid_rt_get_enc_key_mismatch_count_hdl}, /* 0xAA */ - {1, &oid_rt_get_enc_key_match_count_hdl}, /* 0xAB */ - {1, &oid_rt_get_channel_hdl}, /* 0xAC */ - {1, &oid_rt_set_channelplan_hdl}, /* 0xAD */ - {1, &oid_rt_get_hardware_radio_off_hdl}, /* 0xAE */ - {1, &oid_null_function}, /* 0xAF */ - {1, &oid_null_function}, /* 0xB0 */ - {1, &oid_null_function}, /* 0xB1 */ - {1, &oid_null_function}, /* 0xB2 */ - {1, &oid_null_function}, /* 0xB3 */ - {1, &oid_rt_get_key_mismatch_hdl}, /* 0xB4 */ - {1, &oid_null_function}, /* 0xB5 */ - {1, &oid_null_function}, /* 0xB6 */ - {1, &oid_null_function}, /* 0xB7 */ - {1, &oid_null_function}, /* 0xB8 */ - {1, &oid_null_function}, /* 0xB9 */ - {1, &oid_null_function}, /* 0xBA */ - {1, &oid_rt_supported_wireless_mode_hdl}, /* 0xBB */ - {1, &oid_rt_get_channel_list_hdl}, /* 0xBC */ - {1, &oid_rt_get_scan_in_progress_hdl}, /* 0xBD */ - {1, &oid_null_function}, /* 0xBE */ - {1, &oid_null_function}, /* 0xBF */ - {1, &oid_null_function}, /* 0xC0 */ - {1, &oid_rt_forced_data_rate_hdl}, /* 0xC1 */ - {1, &oid_rt_wireless_mode_for_scan_list_hdl}, /* 0xC2 */ - {1, &oid_rt_get_bss_wireless_mode_hdl}, /* 0xC3 */ - {1, &oid_rt_scan_with_magic_packet_hdl}, /* 0xC4 */ - {1, &oid_null_function}, /* 0xC5 */ - {1, &oid_null_function}, /* 0xC6 */ - {1, &oid_null_function}, /* 0xC7 */ - {1, &oid_null_function}, /* 0xC8 */ - {1, &oid_null_function}, /* 0xC9 */ - {1, &oid_null_function}, /* 0xCA */ - {1, &oid_null_function}, /* 0xCB */ - {1, &oid_null_function}, /* 0xCC */ - {1, &oid_null_function}, /* 0xCD */ - {1, &oid_null_function}, /* 0xCE */ - {1, &oid_null_function}, /* 0xCF */ - -}; - -struct oid_obj_priv oid_rtl_seg_01_03[] = { - {1, &oid_rt_ap_get_associated_station_list_hdl}, /* 0x00 */ - {1, &oid_null_function}, /* 0x01 */ - {1, &oid_rt_ap_switch_into_ap_mode_hdl}, /* 0x02 */ - {1, &oid_null_function}, /* 0x03 */ - {1, &oid_rt_ap_supported_hdl}, /* 0x04 */ - {1, &oid_rt_ap_set_passphrase_hdl}, /* 0x05 */ - -}; - -struct oid_obj_priv oid_rtl_seg_01_11[] = { - {1, &oid_null_function}, /* 0xC0 OID_RT_PRO_RX_FILTER */ - {1, &oid_null_function}, /* 0xC1 OID_CE_USB_WRITE_REGISTRY */ - {1, &oid_null_function}, /* 0xC2 OID_CE_USB_READ_REGISTRY */ - {1, &oid_null_function}, /* 0xC3 OID_RT_PRO_SET_INITIAL_GAIN */ - {1, &oid_null_function}, /* 0xC4 OID_RT_PRO_SET_BB_RF_STANDBY_MODE */ - {1, &oid_null_function}, /* 0xC5 OID_RT_PRO_SET_BB_RF_SHUTDOWN_MODE */ - {1, &oid_null_function}, /* 0xC6 OID_RT_PRO_SET_TX_CHARGE_PUMP */ - {1, &oid_null_function}, /* 0xC7 OID_RT_PRO_SET_RX_CHARGE_PUMP */ - {1, &oid_rt_pro_rf_write_registry_hdl}, /* 0xC8 */ - {1, &oid_rt_pro_rf_read_registry_hdl}, /* 0xC9 */ - {1, &oid_null_function} /* 0xCA OID_RT_PRO_QUERY_RF_TYPE */ - -}; - -struct oid_obj_priv oid_rtl_seg_03_00[] = { - {1, &oid_null_function}, /* 0x00 */ - {1, &oid_rt_get_connect_state_hdl}, /* 0x01 */ - {1, &oid_null_function}, /* 0x02 */ - {1, &oid_null_function}, /* 0x03 */ - {1, &oid_rt_set_default_key_id_hdl}, /* 0x04 */ - - -}; - - -/* ************** oid_rtl_seg_01_01 section start ************** */ - -NDIS_STATUS oid_rt_pro_set_fw_dig_state_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; -#if 0 - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - _irqL oldirql; - - - if (poid_par_priv->type_of_oid != SET_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - - _irqlevel_changed_(&oldirql, LOWER); - if (poid_par_priv->information_buf_len >= sizeof(struct setdig_parm)) { - /* DEBUG_ERR(("===> oid_rt_pro_set_fw_dig_state_hdl. type:0x%02x.\n",*((unsigned char*)poid_par_priv->information_buf ))); */ - if (!rtw_setfwdig_cmd(Adapter, *((unsigned char *)poid_par_priv->information_buf))) - status = NDIS_STATUS_NOT_ACCEPTED; - - } else - status = NDIS_STATUS_NOT_ACCEPTED; - _irqlevel_changed_(&oldirql, RAISE); -#endif - return status; -} -/* ----------------------------------------------------------------------------- */ -NDIS_STATUS oid_rt_pro_set_fw_ra_state_hdl(struct oid_par_priv *poid_par_priv) -{ - - NDIS_STATUS status = NDIS_STATUS_SUCCESS; -#if 0 - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - _irqL oldirql; - - if (poid_par_priv->type_of_oid != SET_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - - - _irqlevel_changed_(&oldirql, LOWER); - - if (poid_par_priv->information_buf_len >= sizeof(struct setra_parm)) { - /* DEBUG_ERR(("===> oid_rt_pro_set_fw_ra_state_hdl. type:0x%02x.\n",*((unsigned char*)poid_par_priv->information_buf ))); */ - if (!rtw_setfwra_cmd(Adapter, *((unsigned char *)poid_par_priv->information_buf))) - status = NDIS_STATUS_NOT_ACCEPTED; - - } else - status = NDIS_STATUS_NOT_ACCEPTED; - _irqlevel_changed_(&oldirql, RAISE); -#endif - return status; -} -/* ----------------------------------------------------------------------------- */ -NDIS_STATUS oid_rt_get_signal_quality_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - /* DEBUG_ERR(("<**********************oid_rt_get_signal_quality_hdl\n")); */ - if (poid_par_priv->type_of_oid != QUERY_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - -#if 0 - if (pMgntInfo->mAssoc || pMgntInfo->mIbss) { - ulInfo = pAdapter->RxStats.SignalQuality; - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - } else { - ulInfo = 0xffffffff; /* It stands for -1 in 4-byte integer. */ - } - break; -#endif - - return status; -} - -/* ------------------------------------------------------------------------------ */ - -NDIS_STATUS oid_rt_get_small_packet_crc_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - if (poid_par_priv->type_of_oid != QUERY_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - - if (poid_par_priv->information_buf_len >= sizeof(ULONG)) { - *(ULONG *)poid_par_priv->information_buf = padapter->recvpriv.rx_smallpacket_crcerr; - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - } else - status = NDIS_STATUS_INVALID_LENGTH; - - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_get_middle_packet_crc_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - if (poid_par_priv->type_of_oid != QUERY_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - - if (poid_par_priv->information_buf_len >= sizeof(ULONG)) { - *(ULONG *)poid_par_priv->information_buf = padapter->recvpriv.rx_middlepacket_crcerr; - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - } else - status = NDIS_STATUS_INVALID_LENGTH; - - - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_get_large_packet_crc_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - if (poid_par_priv->type_of_oid != QUERY_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - - if (poid_par_priv->information_buf_len >= sizeof(ULONG)) { - *(ULONG *)poid_par_priv->information_buf = padapter->recvpriv.rx_largepacket_crcerr; - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - } else - status = NDIS_STATUS_INVALID_LENGTH; - - - return status; -} - -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_get_tx_retry_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - if (poid_par_priv->type_of_oid != QUERY_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - - return status; -} -NDIS_STATUS oid_rt_get_rx_retry_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - 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; - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_get_rx_total_packet_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - if (poid_par_priv->type_of_oid != QUERY_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - if (poid_par_priv->information_buf_len >= sizeof(ULONG)) { - *(u64 *)poid_par_priv->information_buf = padapter->recvpriv.rx_pkts + padapter->recvpriv.rx_drop; - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - } else - status = NDIS_STATUS_INVALID_LENGTH; - - - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_get_tx_beacon_ok_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - if (poid_par_priv->type_of_oid != QUERY_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - - return status; -} -NDIS_STATUS oid_rt_get_tx_beacon_err_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - if (poid_par_priv->type_of_oid != QUERY_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_get_rx_icv_err_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - if (poid_par_priv->type_of_oid != QUERY_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - if (poid_par_priv->information_buf_len >= sizeof(u32)) { - /* _rtw_memcpy(*(uint *)poid_par_priv->information_buf,padapter->recvpriv.rx_icv_err,sizeof(u32)); */ - *(uint *)poid_par_priv->information_buf = padapter->recvpriv.rx_icv_err; - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - } else - status = NDIS_STATUS_INVALID_LENGTH ; - - - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_set_encryption_algorithm_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - if (poid_par_priv->type_of_oid != SET_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_get_preamble_mode_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - ULONG preamblemode = 0 ; - - if (poid_par_priv->type_of_oid != QUERY_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - if (poid_par_priv->information_buf_len >= sizeof(ULONG)) { - if (padapter->registrypriv.preamble == PREAMBLE_LONG) - preamblemode = 0; - else if (padapter->registrypriv.preamble == PREAMBLE_AUTO) - preamblemode = 1; - else if (padapter->registrypriv.preamble == PREAMBLE_SHORT) - preamblemode = 2; - - - *(ULONG *)poid_par_priv->information_buf = preamblemode ; - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - } else - status = NDIS_STATUS_INVALID_LENGTH ; - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_get_ap_ip_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - if (poid_par_priv->type_of_oid != QUERY_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - - return status; -} - -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); - - 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 ; - - return status; -} -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); - - 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 ; - - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_set_preamble_mode_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - ULONG preamblemode = 0; - if (poid_par_priv->type_of_oid != SET_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - - if (poid_par_priv->information_buf_len >= sizeof(ULONG)) { - preamblemode = *(ULONG *)poid_par_priv->information_buf ; - if (preamblemode == 0) - padapter->registrypriv.preamble = PREAMBLE_LONG; - else if (preamblemode == 1) - padapter->registrypriv.preamble = PREAMBLE_AUTO; - else if (preamblemode == 2) - padapter->registrypriv.preamble = PREAMBLE_SHORT; - - *(ULONG *)poid_par_priv->information_buf = preamblemode ; - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - } else - status = NDIS_STATUS_INVALID_LENGTH ; - - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_set_bcn_intvl_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - if (poid_par_priv->type_of_oid != SET_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - - return status; -} -NDIS_STATUS oid_rt_dedicate_probe_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_get_total_tx_bytes_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - if (poid_par_priv->type_of_oid != QUERY_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - if (poid_par_priv->information_buf_len >= sizeof(ULONG)) { - *(u64 *)poid_par_priv->information_buf = padapter->xmitpriv.tx_bytes; - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - } else - status = NDIS_STATUS_INVALID_LENGTH ; - - - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_get_total_rx_bytes_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - if (poid_par_priv->type_of_oid != QUERY_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - if (poid_par_priv->information_buf_len >= sizeof(ULONG)) { - /* _rtw_memcpy(*(uint *)poid_par_priv->information_buf,padapter->recvpriv.rx_icv_err,sizeof(u32)); */ - *(u64 *)poid_par_priv->information_buf = padapter->recvpriv.rx_bytes; - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - } else - status = NDIS_STATUS_INVALID_LENGTH ; - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_current_tx_power_level_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - return status; -} -NDIS_STATUS oid_rt_get_enc_key_mismatch_count_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - if (poid_par_priv->type_of_oid != QUERY_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - - return status; -} -NDIS_STATUS oid_rt_get_enc_key_match_count_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - if (poid_par_priv->type_of_oid != QUERY_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - - return status; -} -NDIS_STATUS oid_rt_get_channel_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - struct mlme_priv *pmlmepriv = &padapter->mlmepriv; - NDIS_802_11_CONFIGURATION *pnic_Config; - - ULONG channelnum; - - if (poid_par_priv->type_of_oid != QUERY_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - - if ((check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) || - (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE)) - pnic_Config = &pmlmepriv->cur_network.network.Configuration; - else - pnic_Config = &padapter->registrypriv.dev_network.Configuration; - - channelnum = pnic_Config->DSConfig; - *(ULONG *)poid_par_priv->information_buf = channelnum; - - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - - - - - return status; -} -NDIS_STATUS oid_rt_get_hardware_radio_off_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - if (poid_par_priv->type_of_oid != QUERY_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - - return status; -} -NDIS_STATUS oid_rt_get_key_mismatch_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - if (poid_par_priv->type_of_oid != QUERY_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - - return status; -} -NDIS_STATUS oid_rt_supported_wireless_mode_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - ULONG ulInfo = 0 ; - /* DEBUG_ERR(("<**********************oid_rt_supported_wireless_mode_hdl\n")); */ - if (poid_par_priv->type_of_oid != QUERY_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - if (poid_par_priv->information_buf_len >= sizeof(ULONG)) { - ulInfo |= 0x0100; /* WIRELESS_MODE_B */ - ulInfo |= 0x0200; /* WIRELESS_MODE_G */ - ulInfo |= 0x0400; /* WIRELESS_MODE_A */ - - *(ULONG *) poid_par_priv->information_buf = ulInfo; - /* DEBUG_ERR(("<===oid_rt_supported_wireless_mode %x\n",ulInfo)); */ - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - } else - status = NDIS_STATUS_INVALID_LENGTH; - - return status; -} -NDIS_STATUS oid_rt_get_channel_list_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - if (poid_par_priv->type_of_oid != QUERY_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - - return status; -} -NDIS_STATUS oid_rt_get_scan_in_progress_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - if (poid_par_priv->type_of_oid != QUERY_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - - return status; -} - - -NDIS_STATUS oid_rt_forced_data_rate_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - return status; -} -NDIS_STATUS oid_rt_wireless_mode_for_scan_list_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - return status; -} -NDIS_STATUS oid_rt_get_bss_wireless_mode_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - if (poid_par_priv->type_of_oid != QUERY_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - - return status; -} - -NDIS_STATUS oid_rt_scan_with_magic_packet_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - return status; -} -/* ************** oid_rtl_seg_01_01 section end ************** */ - -/* ************** oid_rtl_seg_01_03 section start ************** */ -NDIS_STATUS oid_rt_ap_get_associated_station_list_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - if (poid_par_priv->type_of_oid != QUERY_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - - return status; -} -NDIS_STATUS oid_rt_ap_switch_into_ap_mode_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - return status; -} -NDIS_STATUS oid_rt_ap_supported_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - return status; -} -NDIS_STATUS oid_rt_ap_set_passphrase_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - if (poid_par_priv->type_of_oid != SET_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - - return status; -} - -/* ************** oid_rtl_seg_01_03 section end ************** */ - -/* **************** oid_rtl_seg_01_11 section start **************** */ -NDIS_STATUS oid_rt_pro_rf_write_registry_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - _irqL oldirql; - /* DEBUG_ERR(("<**********************oid_rt_pro_rf_write_registry_hdl\n")); */ - if (poid_par_priv->type_of_oid != SET_OID) { /* QUERY_OID */ - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - - _irqlevel_changed_(&oldirql, LOWER); - if (poid_par_priv->information_buf_len == (sizeof(unsigned long) * 3)) { - /* RegOffsetValue - The offset of RF register to write. */ - /* RegDataWidth - The data width of RF register to write. */ - /* RegDataValue - The value to write. */ - /* RegOffsetValue = *((unsigned long*)InformationBuffer); */ - /* RegDataWidth = *((unsigned long*)InformationBuffer+1); */ - /* RegDataValue = *((unsigned long*)InformationBuffer+2); */ - if (!rtw_setrfreg_cmd(Adapter, - *(unsigned char *)poid_par_priv->information_buf, - (unsigned long)(*((unsigned long *)poid_par_priv->information_buf + 2)))) - status = NDIS_STATUS_NOT_ACCEPTED; - - } else - status = NDIS_STATUS_INVALID_LENGTH; - _irqlevel_changed_(&oldirql, RAISE); - - return status; -} - -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_rf_read_registry_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; -#if 0 - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - _irqL oldirql; - - /* DEBUG_ERR(("<**********************oid_rt_pro_rf_read_registry_hdl\n")); */ - if (poid_par_priv->type_of_oid != SET_OID) { /* QUERY_OID */ - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - - _irqlevel_changed_(&oldirql, LOWER); - if (poid_par_priv->information_buf_len == (sizeof(unsigned long) * 3)) { - if (Adapter->mppriv.act_in_progress == _TRUE) - status = NDIS_STATUS_NOT_ACCEPTED; - else { - /* init workparam */ - Adapter->mppriv.act_in_progress = _TRUE; - Adapter->mppriv.workparam.bcompleted = _FALSE; - Adapter->mppriv.workparam.act_type = MPT_READ_RF; - Adapter->mppriv.workparam.io_offset = *(unsigned long *)poid_par_priv->information_buf; - Adapter->mppriv.workparam.io_value = 0xcccccccc; - - /* RegOffsetValue - The offset of RF register to read. */ - /* RegDataWidth - The data width of RF register to read. */ - /* RegDataValue - The value to read. */ - /* RegOffsetValue = *((unsigned long*)InformationBuffer); */ - /* RegDataWidth = *((unsigned long*)InformationBuffer+1); */ - /* RegDataValue = *((unsigned long*)InformationBuffer+2); */ - if (!rtw_getrfreg_cmd(Adapter, - *(unsigned char *)poid_par_priv->information_buf, - (unsigned char *)&Adapter->mppriv.workparam.io_value)) - status = NDIS_STATUS_NOT_ACCEPTED; - } - - - } else - status = NDIS_STATUS_INVALID_LENGTH; - _irqlevel_changed_(&oldirql, RAISE); -#endif - return status; -} - -/* **************** oid_rtl_seg_01_11 section end**************** */ - - -/* ************** oid_rtl_seg_03_00 section start ************** */ -enum _CONNECT_STATE_ { - CHECKINGSTATUS, - ASSOCIATED, - ADHOCMODE, - NOTASSOCIATED -}; - -NDIS_STATUS oid_rt_get_connect_state_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); - - ULONG ulInfo; - - if (poid_par_priv->type_of_oid != QUERY_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - - /* nStatus==0 CheckingStatus */ - /* nStatus==1 Associated */ - /* nStatus==2 AdHocMode */ - /* nStatus==3 NotAssociated */ - - if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE) - ulInfo = CHECKINGSTATUS; - else if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) - ulInfo = ASSOCIATED; - else if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE) - ulInfo = ADHOCMODE; - else - ulInfo = NOTASSOCIATED ; - - *(ULONG *)poid_par_priv->information_buf = ulInfo; - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - -#if 0 - /* Rearrange the order to let the UI still shows connection when scan is in progress */ - if (pMgntInfo->mAssoc) - ulInfo = 1; - else if (pMgntInfo->mIbss) - ulInfo = 2; - else if (pMgntInfo->bScanInProgress) - ulInfo = 0; - else - ulInfo = 3; - ulInfoLen = sizeof(ULONG); -#endif - - return status; -} - -NDIS_STATUS oid_rt_set_default_key_id_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - if (poid_par_priv->type_of_oid != SET_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - - return status; -} -/* ************** oid_rtl_seg_03_00 section end ************** */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_ioctl_set.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_ioctl_set.c index 45bb5e42b818..ab3caa9fc08b 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_ioctl_set.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_ioctl_set.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 @@ -47,7 +43,9 @@ u8 rtw_validate_bssid(u8 *bssid) u8 rtw_validate_ssid(NDIS_802_11_SSID *ssid) { +#ifdef CONFIG_VALIDATE_SSID u8 i; +#endif u8 ret = _TRUE; @@ -79,6 +77,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 +95,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); @@ -106,10 +109,17 @@ u8 rtw_do_join(_adapter *padapter) if (pmlmepriv->LinkDetectInfo.bBusyTraffic == _FALSE || rtw_to_roam(padapter) > 0 ) { - /* submit site_survey_cmd */ - ret = rtw_sitesurvey_cmd(padapter, &pmlmepriv->assoc_ssid, 1, NULL, 0); - if (_SUCCESS != ret) { + u8 ssc_chk = rtw_sitesurvey_condition_check(padapter, _FALSE); + + if ((ssc_chk == SS_ALLOW) || (ssc_chk == SS_DENY_BUSY_TRAFFIC) ){ + /* submit site_survey_cmd */ + ret = rtw_sitesurvey_cmd(padapter, &parm); + if (_SUCCESS != ret) + pmlmepriv->to_join = _FALSE; + } else { + /*if (ssc_chk == SS_DENY_BUDDY_UNDER_SURVEY)*/ pmlmepriv->to_join = _FALSE; + ret = _FAIL; } } else { pmlmepriv->to_join = _FALSE; @@ -155,26 +165,22 @@ u8 rtw_do_join(_adapter *padapter) /* can't associate ; reset under-linking */ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); -#if 0 - if ((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE)) { - if (_rtw_memcmp(pmlmepriv->cur_network.network.Ssid.Ssid, pmlmepriv->assoc_ssid.Ssid, pmlmepriv->assoc_ssid.SsidLength)) { - /* 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); - } - - } -#endif - /* when set_ssid/set_bssid for rtw_do_join(), but there are no desired bss in scanning queue */ /* we try to issue sitesurvey firstly */ if (pmlmepriv->LinkDetectInfo.bBusyTraffic == _FALSE || 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); - if (_SUCCESS != ret) { + u8 ssc_chk = rtw_sitesurvey_condition_check(padapter, _FALSE); + + if ((ssc_chk == SS_ALLOW) || (ssc_chk == SS_DENY_BUSY_TRAFFIC)){ + /* RTW_INFO(("rtw_do_join() when no desired bss in scanning queue\n"); */ + ret = rtw_sitesurvey_cmd(padapter, &parm); + if (_SUCCESS != ret) + pmlmepriv->to_join = _FALSE; + } else { + /*if (ssc_chk == SS_DENY_BUDDY_UNDER_SURVEY) { + } else {*/ + ret = _FAIL; pmlmepriv->to_join = _FALSE; } } else { @@ -192,84 +198,6 @@ u8 rtw_do_join(_adapter *padapter) return ret; } -#ifdef PLATFORM_WINDOWS -u8 rtw_pnp_set_power_wakeup(_adapter *padapter) -{ - u8 res = _SUCCESS; - - - - res = rtw_setstandby_cmd(padapter, 0); - - - - return res; -} - -u8 rtw_pnp_set_power_sleep(_adapter *padapter) -{ - u8 res = _SUCCESS; - - - /* DbgPrint("+rtw_pnp_set_power_sleep\n"); */ - - res = rtw_setstandby_cmd(padapter, 1); - - - - return res; -} - -u8 rtw_set_802_11_reload_defaults(_adapter *padapter, NDIS_802_11_RELOAD_DEFAULTS reloadDefaults) -{ - - - - /* SecClearAllKeys(Adapter); */ - /* 8711 CAM was not for En/Decrypt only */ - /* so, we can't clear all keys. */ - /* should we disable WPAcfg (ox0088) bit 1-2, instead of clear all CAM */ - - /* TO DO... */ - - - return _TRUE; -} - -u8 set_802_11_test(_adapter *padapter, NDIS_802_11_TEST *test) -{ - u8 ret = _TRUE; - - - switch (test->Type) { - case 1: - NdisMIndicateStatus(padapter->hndis_adapter, NDIS_STATUS_MEDIA_SPECIFIC_INDICATION, (PVOID)&test->AuthenticationEvent, test->Length - 8); - NdisMIndicateStatusComplete(padapter->hndis_adapter); - break; - - case 2: - NdisMIndicateStatus(padapter->hndis_adapter, NDIS_STATUS_MEDIA_SPECIFIC_INDICATION, (PVOID)&test->RssiTrigger, sizeof(NDIS_802_11_RSSI)); - NdisMIndicateStatusComplete(padapter->hndis_adapter); - break; - - default: - ret = _FALSE; - break; - } - - - return ret; -} - -u8 rtw_set_802_11_pmkid(_adapter *padapter, NDIS_802_11_PMKID *pmkid) -{ - u8 ret = _SUCCESS; - - return ret; -} - -#endif - u8 rtw_set_802_11_bssid(_adapter *padapter, u8 *bssid) { _irqL irqL; @@ -302,12 +230,12 @@ 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); - rtw_free_assoc_resources(padapter, 1); + rtw_free_assoc_resources_cmd(padapter, _TRUE, 0); if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE)) { _clr_fwstate_(pmlmepriv, WIFI_ADHOC_MASTER_STATE); @@ -344,7 +272,6 @@ u8 rtw_set_802_11_ssid(_adapter *padapter, NDIS_802_11_SSID *ssid) { _irqL irqL; u8 status = _SUCCESS; - u32 cur_time = 0; struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct wlan_network *pnetwork = &pmlmepriv->cur_network; @@ -374,12 +301,12 @@ 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); - rtw_free_assoc_resources(padapter, 1); + rtw_free_assoc_resources_cmd(padapter, _TRUE, 0); if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE) { _clr_fwstate_(pmlmepriv, WIFI_ADHOC_MASTER_STATE); @@ -391,16 +318,16 @@ u8 rtw_set_802_11_ssid(_adapter *padapter, NDIS_802_11_SSID *ssid) } #ifdef CONFIG_LPS else - rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_JOINBSS, 1); + rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_JOINBSS, 0); #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); - rtw_free_assoc_resources(padapter, 1); + rtw_free_assoc_resources_cmd(padapter, _TRUE, 0); if (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE) { _clr_fwstate_(pmlmepriv, WIFI_ADHOC_MASTER_STATE); @@ -442,7 +369,6 @@ u8 rtw_set_802_11_connect(_adapter *padapter, u8 *bssid, NDIS_802_11_SSID *ssid) { _irqL irqL; u8 status = _SUCCESS; - u32 cur_time = 0; bool bssid_valid = _TRUE; bool ssid_valid = _TRUE; struct mlme_priv *pmlmepriv = &padapter->mlmepriv; @@ -515,14 +441,15 @@ u8 rtw_set_802_11_infrastructure_mode(_adapter *padapter, 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)); */ - if (*pold_state == Ndis802_11APMode) { - /* change to other mode from Ndis802_11APMode */ + if (*pold_state == Ndis802_11APMode + || *pold_state == Ndis802_11_mesh + ) { + /* change to other mode from Ndis802_11APMode/Ndis802_11_mesh */ cur_network->join_res = -1; ap2sta_mode = _TRUE; #ifdef CONFIG_NATIVEAP_MLME @@ -533,11 +460,11 @@ 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)) - rtw_free_assoc_resources(padapter, 1); + rtw_free_assoc_resources_cmd(padapter, _TRUE, 0); if ((*pold_state == Ndis802_11Infrastructure) || (*pold_state == Ndis802_11IBSS)) { if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { @@ -570,12 +497,22 @@ u8 rtw_set_802_11_infrastructure_mode(_adapter *padapter, break; +#ifdef CONFIG_RTW_MESH + case Ndis802_11_mesh: + set_fwstate(pmlmepriv, WIFI_MESH_STATE); + start_ap_mode(padapter); + break; +#endif + case Ndis802_11AutoUnknown: case Ndis802_11InfrastructureMax: break; case Ndis802_11Monitor: set_fwstate(pmlmepriv, WIFI_MONITOR_STATE); break; + default: + ret = _FALSE; + rtw_warn_on(1); } /* SecClearAllKeys(adapter); */ @@ -584,8 +521,7 @@ u8 rtw_set_802_11_infrastructure_mode(_adapter *padapter, _exit_critical_bh(&pmlmepriv->lock, &irqL); } - - return _TRUE; + return ret; } @@ -599,10 +535,10 @@ 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); + rtw_free_assoc_resources_cmd(padapter, _TRUE, 0); if (_FAIL == rtw_pwr_wakeup(padapter)) RTW_INFO("%s(): rtw_pwr_wakeup fail !!!\n", __FUNCTION__); } @@ -614,21 +550,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; @@ -660,7 +596,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); } @@ -750,377 +686,6 @@ u8 rtw_set_802_11_add_wep(_adapter *padapter, NDIS_802_11_WEP *wep) } -u8 rtw_set_802_11_remove_wep(_adapter *padapter, u32 keyindex) -{ - - u8 ret = _SUCCESS; - - - if (keyindex >= 0x80000000 || padapter == NULL) { - - ret = _FALSE; - goto exit; - - } else { - int res; - struct security_priv *psecuritypriv = &(padapter->securitypriv); - if (keyindex < 4) { - - _rtw_memset(&psecuritypriv->dot11DefKey[keyindex], 0, 16); - - res = rtw_set_key(padapter, psecuritypriv, keyindex, 0, _TRUE); - - psecuritypriv->dot11DefKeylen[keyindex] = 0; - - if (res == _FAIL) - ret = _FAIL; - - } else - ret = _FAIL; - - } - -exit: - - - return ret; - -} - -u8 rtw_set_802_11_add_key(_adapter *padapter, NDIS_802_11_KEY *key) -{ - - uint encryptionalgo; - u8 *pbssid; - struct sta_info *stainfo; - u8 bgroup = _FALSE; - u8 bgrouptkey = _FALSE;/* can be remove later */ - u8 ret = _SUCCESS; - - - if (((key->KeyIndex & 0x80000000) == 0) && ((key->KeyIndex & 0x40000000) > 0)) { - - /* It is invalid to clear bit 31 and set bit 30. If the miniport driver encounters this combination, */ - /* it must fail the request and return NDIS_STATUS_INVALID_DATA. */ - ret = _FAIL; - goto exit; - } - - if (key->KeyIndex & 0x40000000) { - /* Pairwise key */ - - - pbssid = get_bssid(&padapter->mlmepriv); - stainfo = rtw_get_stainfo(&padapter->stapriv, pbssid); - - if ((stainfo != NULL) && (padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X)) { - encryptionalgo = stainfo->dot118021XPrivacy; - } else { - encryptionalgo = padapter->securitypriv.dot11PrivacyAlgrthm; - } - - - - - if (key->KeyIndex & 0x000000FF) { - /* The key index is specified in the lower 8 bits by values of zero to 255. */ - /* The key index should be set to zero for a Pairwise key, and the driver should fail with */ - /* NDIS_STATUS_INVALID_DATA if the lower 8 bits is not zero */ - ret = _FAIL; - goto exit; - } - - /* check BSSID */ - if (IS_MAC_ADDRESS_BROADCAST(key->BSSID) == _TRUE) { - - ret = _FALSE; - goto exit; - } - - /* Check key length for TKIP. */ - /* if(encryptionAlgorithm == RT_ENC_TKIP_ENCRYPTION && key->KeyLength != 32) */ - if ((encryptionalgo == _TKIP_) && (key->KeyLength != 32)) { - ret = _FAIL; - goto exit; - - } - - /* Check key length for AES. */ - if ((encryptionalgo == _AES_) && (key->KeyLength != 16)) { - /* For our supplicant, EAPPkt9x.vxd, cannot differentiate TKIP and AES case. */ - if (key->KeyLength == 32) - key->KeyLength = 16; - else { - ret = _FAIL; - goto exit; - } - } - - /* Check key length for WEP. For NDTEST, 2005.01.27, by rcnjko. -> modify checking condition*/ - if (((encryptionalgo == _WEP40_) && (key->KeyLength != 5)) || ((encryptionalgo == _WEP104_) && (key->KeyLength != 13))) { - ret = _FAIL; - goto exit; - } - - bgroup = _FALSE; - - /* Check the pairwise key. Added by Annie, 2005-07-06. */ - - } else { - /* Group key - KeyIndex(BIT30==0) */ - - - /* when add wep key through add key and didn't assigned encryption type before */ - if ((padapter->securitypriv.ndisauthtype <= 3) && (padapter->securitypriv.dot118021XGrpPrivacy == 0)) { - - switch (key->KeyLength) { - case 5: - padapter->securitypriv.dot11PrivacyAlgrthm = _WEP40_; - break; - case 13: - padapter->securitypriv.dot11PrivacyAlgrthm = _WEP104_; - break; - default: - padapter->securitypriv.dot11PrivacyAlgrthm = _NO_PRIVACY_; - break; - } - - encryptionalgo = padapter->securitypriv.dot11PrivacyAlgrthm; - - - } else { - encryptionalgo = padapter->securitypriv.dot118021XGrpPrivacy; - - } - - if ((check_fwstate(&padapter->mlmepriv, WIFI_ADHOC_STATE) == _TRUE) && (IS_MAC_ADDRESS_BROADCAST(key->BSSID) == _FALSE)) { - ret = _FAIL; - goto exit; - } - - /* Check key length for TKIP */ - if ((encryptionalgo == _TKIP_) && (key->KeyLength != 32)) { - - ret = _FAIL; - goto exit; - - } else if (encryptionalgo == _AES_ && (key->KeyLength != 16 && key->KeyLength != 32)) { - - /* Check key length for AES */ - /* For NDTEST, we allow keylen=32 in this case. 2005.01.27, by rcnjko. */ - ret = _FAIL; - goto exit; - } - - /* Change the key length for EAPPkt9x.vxd. Added by Annie, 2005-11-03. */ - if ((encryptionalgo == _AES_) && (key->KeyLength == 32)) { - key->KeyLength = 16; - } - - if (key->KeyIndex & 0x8000000) /* error ??? 0x8000_0000 */ - bgrouptkey = _TRUE; - - if ((check_fwstate(&padapter->mlmepriv, WIFI_ADHOC_STATE) == _TRUE) && (check_fwstate(&padapter->mlmepriv, _FW_LINKED) == _TRUE)) - bgrouptkey = _TRUE; - - bgroup = _TRUE; - - - } - - /* If WEP encryption algorithm, just call rtw_set_802_11_add_wep(). */ - if ((padapter->securitypriv.dot11AuthAlgrthm != dot11AuthAlgrthm_8021X) && (encryptionalgo == _WEP40_ || encryptionalgo == _WEP104_)) { - u8 ret; - u32 keyindex; - u32 len = FIELD_OFFSET(NDIS_802_11_KEY, KeyMaterial) + key->KeyLength; - NDIS_802_11_WEP *wep = &padapter->securitypriv.ndiswep; - - - wep->Length = len; - keyindex = key->KeyIndex & 0x7fffffff; - wep->KeyIndex = keyindex ; - wep->KeyLength = key->KeyLength; - - - _rtw_memcpy(wep->KeyMaterial, key->KeyMaterial, key->KeyLength); - _rtw_memcpy(&(padapter->securitypriv.dot11DefKey[keyindex].skey[0]), key->KeyMaterial, key->KeyLength); - - padapter->securitypriv.dot11DefKeylen[keyindex] = key->KeyLength; - padapter->securitypriv.dot11PrivacyKeyIndex = keyindex; - - ret = rtw_set_802_11_add_wep(padapter, wep); - - goto exit; - - } - - if (key->KeyIndex & 0x20000000) { - /* SetRSC */ - if (bgroup == _TRUE) { - NDIS_802_11_KEY_RSC keysrc = key->KeyRSC & 0x00FFFFFFFFFFFFULL; - _rtw_memcpy(&padapter->securitypriv.dot11Grprxpn, &keysrc, 8); - } else { - NDIS_802_11_KEY_RSC keysrc = key->KeyRSC & 0x00FFFFFFFFFFFFULL; - _rtw_memcpy(&padapter->securitypriv.dot11Grptxpn, &keysrc, 8); - } - - } - - /* Indicate this key idx is used for TX */ - /* Save the key in KeyMaterial */ - if (bgroup == _TRUE) { /* Group transmit key */ - int res; - - if (bgrouptkey == _TRUE) - padapter->securitypriv.dot118021XGrpKeyid = (u8)key->KeyIndex; - - if ((key->KeyIndex & 0x3) == 0) { - ret = _FAIL; - goto exit; - } - - _rtw_memset(&padapter->securitypriv.dot118021XGrpKey[(u8)((key->KeyIndex) & 0x03)], 0, 16); - _rtw_memset(&padapter->securitypriv.dot118021XGrptxmickey[(u8)((key->KeyIndex) & 0x03)], 0, 16); - _rtw_memset(&padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)], 0, 16); - - if ((key->KeyIndex & 0x10000000)) { - _rtw_memcpy(&padapter->securitypriv.dot118021XGrptxmickey[(u8)((key->KeyIndex) & 0x03)], key->KeyMaterial + 16, 8); - _rtw_memcpy(&padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)], key->KeyMaterial + 24, 8); - - - } else { - _rtw_memcpy(&padapter->securitypriv.dot118021XGrptxmickey[(u8)((key->KeyIndex) & 0x03)], key->KeyMaterial + 24, 8); - _rtw_memcpy(&padapter->securitypriv.dot118021XGrprxmickey[(u8)((key->KeyIndex) & 0x03)], key->KeyMaterial + 16, 8); - - - } - - /* set group key by index */ - _rtw_memcpy(&padapter->securitypriv.dot118021XGrpKey[(u8)((key->KeyIndex) & 0x03)], key->KeyMaterial, key->KeyLength); - - key->KeyIndex = key->KeyIndex & 0x03; - - padapter->securitypriv.binstallGrpkey = _TRUE; - - padapter->securitypriv.bcheck_grpkey = _FALSE; - - - res = rtw_set_key(padapter, &padapter->securitypriv, key->KeyIndex, 1, _TRUE); - - if (res == _FAIL) - ret = _FAIL; - - goto exit; - - } else { /* Pairwise Key */ - u8 res; - - pbssid = get_bssid(&padapter->mlmepriv); - stainfo = rtw_get_stainfo(&padapter->stapriv , pbssid); - - if (stainfo != NULL) { - _rtw_memset(&stainfo->dot118021x_UncstKey, 0, 16); /* clear keybuffer */ - - _rtw_memcpy(&stainfo->dot118021x_UncstKey, key->KeyMaterial, 16); - - 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); - _rtw_memcpy(&stainfo->dot11tkiprxmickey, key->KeyMaterial + 24, 8); - - } else { - _rtw_memcpy(&stainfo->dot11tkiptxmickey, key->KeyMaterial + 24, 8); - _rtw_memcpy(&stainfo->dot11tkiprxmickey, key->KeyMaterial + 16, 8); - - } - - } else if (encryptionalgo == _AES_) { - - } - - - /* Set key to CAM through H2C command */ -#if 0 - if (bgrouptkey) { /* never go to here */ - res = rtw_setstakey_cmd(padapter, stainfo, GROUP_KEY, _TRUE); - } else { - res = rtw_setstakey_cmd(padapter, stainfo, UNICAST_KEY, _TRUE); - } -#else - - res = rtw_setstakey_cmd(padapter, stainfo, UNICAST_KEY, _TRUE); -#endif - - if (res == _FALSE) - ret = _FAIL; - - } - - } - -exit: - - - return ret; -} - -u8 rtw_set_802_11_remove_key(_adapter *padapter, NDIS_802_11_REMOVE_KEY *key) -{ - - uint encryptionalgo; - u8 *pbssid; - struct sta_info *stainfo; - u8 bgroup = (key->KeyIndex & 0x4000000) > 0 ? _FALSE : _TRUE; - u8 keyIndex = (u8)key->KeyIndex & 0x03; - u8 ret = _SUCCESS; - - - if ((key->KeyIndex & 0xbffffffc) > 0) { - ret = _FAIL; - goto exit; - } - - if (bgroup == _TRUE) { - encryptionalgo = padapter->securitypriv.dot118021XGrpPrivacy; - /* clear group key by index */ - /* NdisZeroMemory(Adapter->MgntInfo.SecurityInfo.KeyBuf[keyIndex], MAX_WEP_KEY_LEN); */ - /* Adapter->MgntInfo.SecurityInfo.KeyLen[keyIndex] = 0; */ - - _rtw_memset(&padapter->securitypriv.dot118021XGrpKey[keyIndex], 0, 16); - - /* ! \todo Send a H2C Command to Firmware for removing this Key in CAM Entry. */ - - } else { - - pbssid = get_bssid(&padapter->mlmepriv); - stainfo = rtw_get_stainfo(&padapter->stapriv , pbssid); - if (stainfo != NULL) { - encryptionalgo = stainfo->dot118021XPrivacy; - - /* clear key by BSSID */ - _rtw_memset(&stainfo->dot118021x_UncstKey, 0, 16); - - /* ! \todo Send a H2C Command to Firmware for disable this Key in CAM Entry. */ - - } else { - ret = _FAIL; - goto exit; - } - } - -exit: - - - return _TRUE; - -} - /* * rtw_get_cur_max_rate - * @adapter: pointer to _adapter structure @@ -1129,10 +694,13 @@ u8 rtw_set_802_11_remove_key(_adapter *padapter, NDIS_802_11_REMOVE_KEY *key) */ u16 rtw_get_cur_max_rate(_adapter *adapter) { + int j; int i = 0; u16 rate = 0, max_rate = 0; struct mlme_priv *pmlmepriv = &adapter->mlmepriv; WLAN_BSSID_EX *pcur_bss = &pmlmepriv->cur_network.network; + int sta_bssrate_len = 0; + unsigned char sta_bssrate[NumRates]; struct sta_info *psta = NULL; u8 short_GI = 0; #ifdef CONFIG_80211N_HT @@ -1154,34 +722,56 @@ 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 (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 + , (psta->cmn.bw_mode == CHANNEL_WIDTH_40) ? 1 : 0 , short_GI , psta->htpriv.ht_cap.supp_mcs_set ); } #ifdef CONFIG_80211AC_VHT else if (is_supported_vht(psta->wireless_mode)) - max_rate = ((rtw_vht_mcs_to_data_rate(psta->bw_mode, short_GI, pmlmepriv->vhtpriv.vht_highest_rate) + 1) >> 1) * 10; + 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 */ { + /*station mode show :station && ap support rate; softap :show ap support rate*/ + if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) + get_rate_set(adapter, sta_bssrate, &sta_bssrate_len);/*get sta rate and length*/ + + while ((pcur_bss->SupportedRates[i] != 0) && (pcur_bss->SupportedRates[i] != 0xFF)) { - rate = pcur_bss->SupportedRates[i] & 0x7F; - if (rate > max_rate) - max_rate = rate; + rate = pcur_bss->SupportedRates[i] & 0x7F;/*AP support rates*/ + /*RTW_INFO("%s rate=%02X \n", __func__, rate);*/ + + /*check STA support rate or not */ + if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) { + for (j = 0; j < sta_bssrate_len; j++) { + /* Avoid the proprietary data rate (22Mbps) of Handlink WSG-4000 AP */ + if ((rate | IEEE80211_BASIC_RATE_MASK) + == (sta_bssrate[j] | IEEE80211_BASIC_RATE_MASK)) { + if (rate > max_rate) { + max_rate = rate; + } + break; + } + } + } else { + + if (rate > max_rate) + max_rate = rate; + + } i++; } max_rate = max_rate * 10 / 2; } - return max_rate; } @@ -1211,9 +801,6 @@ int rtw_set_scan_mode(_adapter *adapter, RT_SCAN_TYPE scan_mode) */ int rtw_set_channel_plan(_adapter *adapter, u8 channel_plan) { - struct registry_priv *pregistrypriv = &adapter->registrypriv; - struct mlme_priv *pmlmepriv = &adapter->mlmepriv; - /* handle by cmd_thread to sync with scan operation */ return rtw_set_chplan_cmd(adapter, RTW_CMDF_WAIT_ACK, channel_plan, 1); } @@ -1230,7 +817,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/rtl8188eu/core/rtw_iol.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_iol.c index 42d0b6beec40..07c419f15571 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_iol.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_iol.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 @@ -306,24 +302,30 @@ int _rtw_IOL_append_WD_cmd(struct xmit_frame *xmit_frame, u16 addr, u32 value) #ifdef DBG_IO int dbg_rtw_IOL_append_WB_cmd(struct xmit_frame *xmit_frame, u16 addr, u8 value, const char *caller, const int line) { - if (match_write_sniff_ranges(addr, 1)) - RTW_INFO("DBG_IO %s:%d IOL_WB(0x%04x, 0x%02x)\n", caller, line, addr, value); + if (match_write_sniff(xmit_frame->padapter, addr, 1, value)) { + RTW_INFO("DBG_IO %s:%d IOL_WB(0x%04x, 0x%02x)\n" + , caller, line, addr, value); + } return _rtw_IOL_append_WB_cmd(xmit_frame, addr, value); } int dbg_rtw_IOL_append_WW_cmd(struct xmit_frame *xmit_frame, u16 addr, u16 value, const char *caller, const int line) { - if (match_write_sniff_ranges(addr, 2)) - RTW_INFO("DBG_IO %s:%d IOL_WW(0x%04x, 0x%04x)\n", caller, line, addr, value); + if (match_write_sniff(xmit_frame->padapter, addr, 2, value)) { + RTW_INFO("DBG_IO %s:%d IOL_WW(0x%04x, 0x%04x)\n" + , caller, line, addr, value); + } return _rtw_IOL_append_WW_cmd(xmit_frame, addr, value); } int dbg_rtw_IOL_append_WD_cmd(struct xmit_frame *xmit_frame, u16 addr, u32 value, const char *caller, const int line) { - if (match_write_sniff_ranges(addr, 4)) - RTW_INFO("DBG_IO %s:%d IOL_WD(0x%04x, 0x%08x)\n", caller, line, addr, value); + if (match_write_sniff(xmit_frame->padapter, addr, 4, value)) { + RTW_INFO("DBG_IO %s:%d IOL_WD(0x%04x, 0x%08x)\n" + , caller, line, addr, value); + } return _rtw_IOL_append_WD_cmd(xmit_frame, addr, value); } diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_mem.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_mem.c index b68a456177de..4f241751050e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_mem.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_mem.c @@ -1,3 +1,18 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * 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/rtl8188eu/core/rtw_mi.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_mi.c index 6038e5732420..0fc33336c099 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_mi.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_mi.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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,10 +28,88 @@ void rtw_mi_update_union_chan_inf(_adapter *adapter, u8 ch, u8 offset , u8 bw) iface_state->union_offset = offset; } -/* 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) +#ifdef DBG_IFACE_STATUS +#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 +#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_by_ifbmp(struct dvobj_priv *dvobj, u8 ifbmp, u8 *ch, u8 *bw, u8 *offset) +{ _adapter *iface; struct mlme_ext_priv *mlmeext; int i; @@ -53,6 +127,9 @@ int _rtw_mi_get_ch_setting_union(_adapter *adapter, u8 *ch, u8 *bw, u8 *offset, for (i = 0; i < dvobj->iface_nums; i++) { iface = dvobj->padapters[i]; + if (!iface || !(ifbmp & BIT(iface->iface_id))) + continue; + mlmeext = &iface->mlmeextpriv; if (!check_fwstate(&iface->mlmepriv, _FW_LINKED | _FW_UNDER_LINKING)) @@ -61,9 +138,6 @@ int _rtw_mi_get_ch_setting_union(_adapter *adapter, u8 *ch, u8 *bw, u8 *offset, if (check_fwstate(&iface->mlmepriv, WIFI_OP_CH_SWITCHING)) continue; - if (include_self == _FALSE && adapter == iface) - continue; - if (num == 0) { ch_ret = mlmeext->cur_channel; bw_ret = mlmeext->cur_bwmode; @@ -102,18 +176,17 @@ int _rtw_mi_get_ch_setting_union(_adapter *adapter, u8 *ch, u8 *bw, u8 *offset, inline int rtw_mi_get_ch_setting_union(_adapter *adapter, u8 *ch, u8 *bw, u8 *offset) { - return _rtw_mi_get_ch_setting_union(adapter, ch, bw, offset, 1); + return rtw_mi_get_ch_setting_union_by_ifbmp(adapter_to_dvobj(adapter), 0xFF, ch, bw, offset); } inline int rtw_mi_get_ch_setting_union_no_self(_adapter *adapter, u8 *ch, u8 *bw, u8 *offset) { - return _rtw_mi_get_ch_setting_union(adapter, ch, bw, offset, 0); + return rtw_mi_get_ch_setting_union_by_ifbmp(adapter_to_dvobj(adapter), 0xFF & ~BIT(adapter->iface_id), ch, bw, offset); } /* 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_by_ifbmp(struct dvobj_priv *dvobj, u8 ifbmp, struct mi_state *mstate) { - struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); _adapter *iface; int i; @@ -121,24 +194,39 @@ 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 (!iface || !(ifbmp & BIT(iface->iface_id))) 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 + #ifdef CONFIG_P2P + if (MLME_IS_GC(iface)) + MSTATE_P2P_GC_NUM(mstate)++; + #endif + } if (check_fwstate(&iface->mlmepriv, _FW_UNDER_LINKING) == _TRUE) MSTATE_STA_LG_NUM(mstate)++; - } 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)++; +#ifdef CONFIG_AP_MODE + } else if (check_fwstate(&iface->mlmepriv, WIFI_AP_STATE) == _TRUE ) { + if (check_fwstate(&iface->mlmepriv, _FW_LINKED) == _TRUE) { + MSTATE_AP_NUM(mstate)++; + if (iface->stapriv.asoc_sta_count > 2) + MSTATE_AP_LD_NUM(mstate)++; + #ifdef CONFIG_P2P + if (MLME_IS_GO(iface)) + MSTATE_P2P_GO_NUM(mstate)++; + #endif + } else + MSTATE_AP_STARTING_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 +234,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)++; @@ -159,38 +265,91 @@ void _rtw_mi_status(_adapter *adapter, struct mi_state *mstate, bool include_sel MSTATE_ROCH_NUM(mstate)++; #endif #endif /* CONFIG_IOCTL_CFG80211 */ - +#ifdef CONFIG_P2P + if (MLME_IS_PD(iface)) + MSTATE_P2P_DV_NUM(mstate)++; +#endif } } inline void rtw_mi_status(_adapter *adapter, struct mi_state *mstate) { - return _rtw_mi_status(adapter, mstate, 1); + return rtw_mi_status_by_ifbmp(adapter_to_dvobj(adapter), 0xFF, mstate); } + inline void rtw_mi_status_no_self(_adapter *adapter, struct mi_state *mstate) { - return _rtw_mi_status(adapter, mstate, 0); + return rtw_mi_status_by_ifbmp(adapter_to_dvobj(adapter), 0xFF & ~BIT(adapter->iface_id), mstate); } + +inline void rtw_mi_status_no_others(_adapter *adapter, struct mi_state *mstate) +{ + return rtw_mi_status_by_ifbmp(adapter_to_dvobj(adapter), BIT(adapter->iface_id), mstate); +} + +/* 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, "starting_ap_num:%d\n", DEV_AP_STARTING_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_P2P - RTW_PRINT_SEL(sel, "p2p_device_num:%d\n", rtw_mi_stay_in_p2p_mode(dvobj->padapters[IFACE_ID0])); +#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", DEV_P2P_DV_NUM(dvobj)); + RTW_PRINT_SEL(sel, "p2p_gc_num:%d\n", DEV_P2P_GC_NUM(dvobj)); + RTW_PRINT_SEL(sel, "p2p_go_num:%d\n", DEV_P2P_GO_NUM(dvobj)); +#endif + RTW_PRINT_SEL(sel, "scan_num:%d\n", DEV_SCAN_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)); @@ -209,12 +368,9 @@ inline void rtw_mi_update_iface_status(struct mlme_priv *pmlmepriv, sint state) struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); struct mi_state *iface_state = &dvobj->iface_state; struct mi_state tmp_mstate; - u8 i; u8 u_ch, u_offset, u_bw; - _adapter *iface; if (state == WIFI_MONITOR_STATE - || state == WIFI_SITE_MONITOR || state == 0xFFFFFFFF ) return; @@ -252,11 +408,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 +438,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 +468,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 +496,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 +603,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; @@ -433,32 +645,57 @@ void rtw_mi_buddy_scan_abort(_adapter *adapter, bool bwait) _rtw_mi_process(adapter, _TRUE, &in_data, _rtw_mi_scan_abort); } -static u8 _rtw_mi_start_drv_threads(_adapter *adapter, void *data) +static u32 _rtw_mi_start_drv_threads(_adapter *adapter, bool exclude_self) { - rtw_start_drv_threads(adapter); - return _TRUE; + int i; + _adapter *iface = NULL; + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + u32 _status = _SUCCESS; + + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + if (iface) { + if ((exclude_self) && (iface == adapter)) + continue; + if (rtw_start_drv_threads(iface) == _FAIL) { + _status = _FAIL; + break; + } + } + } + return _status; } -void rtw_mi_start_drv_threads(_adapter *adapter) +u32 rtw_mi_start_drv_threads(_adapter *adapter) { - _rtw_mi_process(adapter, _FALSE, NULL, _rtw_mi_start_drv_threads); + return _rtw_mi_start_drv_threads(adapter, _FALSE); } -void rtw_mi_buddy_start_drv_threads(_adapter *adapter) +u32 rtw_mi_buddy_start_drv_threads(_adapter *adapter) { - _rtw_mi_process(adapter, _TRUE, NULL, _rtw_mi_start_drv_threads); + return _rtw_mi_start_drv_threads(adapter, _TRUE); } -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) { + 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 +719,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) @@ -517,6 +754,24 @@ void rtw_mi_buddy_intf_stop(_adapter *adapter) _rtw_mi_process(adapter, _TRUE, NULL, _rtw_mi_intf_stop); } +#ifdef CONFIG_NEW_NETDEV_HDL +u8 rtw_mi_hal_iface_init(_adapter *padapter) +{ + int i; + _adapter *iface; + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + + u8 ret = _TRUE; + + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + if (iface && iface->netif_up) + rtw_hal_iface_init(padapter); + } + return ret; +} +#endif + static u8 _rtw_mi_suspend_free_assoc_resource(_adapter *padapter, void *data) { return rtw_suspend_free_assoc_resource(padapter); @@ -565,58 +820,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 +846,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; } @@ -677,7 +888,6 @@ u8 _rtw_mi_busy_traffic_check(_adapter *padapter, void *data) if (check_sc_interval) { /* Miracast can't do AP scan*/ passtime = rtw_get_passing_time_ms(pmlmepriv->lastscantime); - pmlmepriv->lastscantime = rtw_get_current_time(); if (passtime > BUSY_TRAFFIC_SCAN_DENY_PERIOD) { RTW_INFO(ADPT_FMT" bBusyTraffic == _TRUE\n", ADPT_ARG(padapter)); return _TRUE; @@ -902,20 +1112,6 @@ u8 rtw_mi_buddy_dynamic_check_timer_handlder(_adapter *padapter) return _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_dynamic_check_timer_handlder); } -static u8 _rtw_mi_dev_unload(_adapter *adapter, void *data) -{ - rtw_dev_unload(adapter); - return _TRUE; -} -u8 rtw_mi_dev_unload(_adapter *padapter) -{ - return _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_dev_unload); -} -u8 rtw_mi_buddy_dev_unload(_adapter *padapter) -{ - return _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_dev_unload); -} - static u8 _rtw_mi_dynamic_chk_wk_hdl(_adapter *adapter, void *data) { rtw_iface_dynamic_chk_wk_hdl(adapter); @@ -984,12 +1180,12 @@ 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) +#if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) || defined(CONFIG_PCI_BCN_POLLING) tx_beacon_hdl(adapter, NULL); #endif #endif @@ -1009,7 +1205,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); } @@ -1075,7 +1271,7 @@ _adapter *rtw_get_iface_by_id(_adapter *padapter, u8 iface_id) return dvobj->padapters[iface_id]; } -_adapter *rtw_get_iface_by_macddr(_adapter *padapter, u8 *mac_addr) +_adapter *rtw_get_iface_by_macddr(_adapter *padapter, const u8 *mac_addr) { int i; _adapter *iface = NULL; @@ -1167,9 +1363,10 @@ void rtw_dbg_skb_process(_adapter *padapter, union recv_frame *precvframe, union static s32 _rtw_mi_buddy_clone_bcmc_packet(_adapter *adapter, union recv_frame *precvframe, u8 *pphy_status, union recv_frame *pcloneframe) { s32 ret = _SUCCESS; +#ifdef CONFIG_SKB_ALLOCATED u8 *pbuf = precvframe->u.hdr.rx_data; +#endif struct rx_pkt_attrib *pattrib = NULL; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); if (pcloneframe) { pcloneframe->u.hdr.adapter = adapter; @@ -1195,7 +1392,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 +1414,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 +1423,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) { @@ -1260,6 +1461,45 @@ _adapter *rtw_mi_get_ap_adapter(_adapter *padapter) } #endif +u8 rtw_mi_get_ld_sta_ifbmp(_adapter *adapter) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + int i; + _adapter *iface = NULL; + u8 ifbmp = 0; + + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + if (!iface) + continue; + + if (MLME_IS_STA(iface) && MLME_IS_ASOC(iface)) + ifbmp |= BIT(i); + } + + return ifbmp; +} + +u8 rtw_mi_get_ap_mesh_ifbmp(_adapter *adapter) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + int i; + _adapter *iface = NULL; + u8 ifbmp = 0; + + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + if (!iface) + continue; + + if (CHK_MLME_STATE(iface, WIFI_AP_STATE | WIFI_MESH_STATE) + && MLME_IS_ASOC(iface)) + ifbmp |= BIT(i); + } + + return ifbmp; +} + void rtw_mi_update_ap_bmc_camid(_adapter *padapter, u8 camid_a, u8 camid_b) { #ifdef CONFIG_CONCURRENT_MODE @@ -1284,3 +1524,20 @@ void rtw_mi_update_ap_bmc_camid(_adapter *padapter, u8 camid_a, u8 camid_b) } #endif } + +u8 rtw_mi_get_assoc_if_num(_adapter *adapter) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + u8 n_assoc_iface = 0; +#if 1 + u8 i; + + for (i = 0; i < dvobj->iface_nums; i++) { + if (check_fwstate(&(dvobj->padapters[i]->mlmepriv), WIFI_ASOC_STATE)) + n_assoc_iface++; + } +#else + n_assoc_iface = DEV_STA_LD_NUM(dvobj) + DEV_AP_NUM(dvobj) + DEV_ADHOC_NUM(dvobj) + DEV_MESH_NUM(dvobj); +#endif + return n_assoc_iface; +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_mlme.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_mlme.c index e261acb86740..150ad869b2e1 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_mlme.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_mlme.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2019 Realtek Corporation. * * This program is 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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,12 +21,30 @@ 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_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; u8 *pbuf; struct wlan_network *pnetwork; struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); sint res = _SUCCESS; @@ -49,11 +63,7 @@ sint _rtw_init_mlme_priv(_adapter *padapter) pmlmepriv->nic_hdl = (u8 *)padapter; pmlmepriv->pscanned = NULL; - /*pmlmepriv->fw_state = WIFI_STATION_STATE; */ /*Must sync with rtw_wdev_alloc()*/ - /*init_fwstate(pmlmepriv, WIFI_STATION_STATE);*/ - init_fwstate(pmlmepriv, WIFI_NULL_STATE);/*assigned interface role(STA/AP) must after execute set_opmode*/ - - /* wdev->iftype = NL80211_IFTYPE_STATION*/ + init_fwstate(pmlmepriv, WIFI_STATION_STATE); pmlmepriv->cur_network.network.InfrastructureMode = Ndis802_11AutoUnknown; pmlmepriv->scan_mode = SCAN_ACTIVE; /* 1: active, 0: pasive. Maybe someday we should rename this varable to "active_mode" (Jeff) */ @@ -65,7 +75,15 @@ sint _rtw_init_mlme_priv(_adapter *padapter) _rtw_memset(&pmlmepriv->assoc_ssid, 0, sizeof(NDIS_802_11_SSID)); - pbuf = rtw_zvmalloc(MAX_BSS_CNT * (sizeof(struct wlan_network))); + if (padapter->registrypriv.max_bss_cnt != 0) + pmlmepriv->max_bss_cnt = padapter->registrypriv.max_bss_cnt; + else if (rfctl->max_chan_nums <= MAX_CHANNEL_NUM_2G) + pmlmepriv->max_bss_cnt = MAX_BSS_CNT; + else + pmlmepriv->max_bss_cnt = MAX_BSS_CNT + MAX_BSS_CNT; + + + pbuf = rtw_zvmalloc(pmlmepriv->max_bss_cnt * (sizeof(struct wlan_network))); if (pbuf == NULL) { res = _FAIL; @@ -75,7 +93,7 @@ sint _rtw_init_mlme_priv(_adapter *padapter) pnetwork = (struct wlan_network *)pbuf; - for (i = 0; i < MAX_BSS_CNT; i++) { + for (i = 0; i < pmlmepriv->max_bss_cnt; i++) { _rtw_init_listhead(&(pnetwork->list)); rtw_list_insert_tail(&(pnetwork->list), &(pmlmepriv->free_bss_pool.queue)); @@ -94,7 +112,7 @@ sint _rtw_init_mlme_priv(_adapter *padapter) #ifdef CONFIG_LAYER2_ROAMING #define RTW_ROAM_SCAN_RESULT_EXP_MS (5*1000) #define RTW_ROAM_RSSI_DIFF_TH 10 -#define RTW_ROAM_SCAN_INTERVAL_MS (10*1000) +#define RTW_ROAM_SCAN_INTERVAL (5) /* 5*(2 second)*/ #define RTW_ROAM_RSSI_THRESHOLD 70 pmlmepriv->roam_flags = 0 @@ -109,16 +127,20 @@ sint _rtw_init_mlme_priv(_adapter *padapter) pmlmepriv->roam_scanr_exp_ms = RTW_ROAM_SCAN_RESULT_EXP_MS; pmlmepriv->roam_rssi_diff_th = RTW_ROAM_RSSI_DIFF_TH; - pmlmepriv->roam_scan_int_ms = RTW_ROAM_SCAN_INTERVAL_MS; + pmlmepriv->roam_scan_int = RTW_ROAM_SCAN_INTERVAL; pmlmepriv->roam_rssi_threshold = RTW_ROAM_RSSI_THRESHOLD; + pmlmepriv->need_to_roam = _FALSE; + pmlmepriv->last_roaming = rtw_get_current_time(); #endif /* CONFIG_LAYER2_ROAMING */ #ifdef CONFIG_RTW_80211R - memset(&pmlmepriv->ftpriv, 0, sizeof(ft_priv)); - pmlmepriv->ftpriv.ft_flags = 0 - | RTW_FT_STA_SUPPORTED - | RTW_FT_STA_OVER_DS_SUPPORTED - ; + rtw_ft_info_init(&pmlmepriv->ft_roam); +#endif +#ifdef CONFIG_LAYER2_ROAMING +#if defined(CONFIG_RTW_WNM) || defined(CONFIG_RTW_80211K) + rtw_roam_nb_info_init(padapter); + pmlmepriv->ch_cnt = 0; +#endif #endif rtw_init_mlme_timer(padapter); @@ -276,6 +298,7 @@ int rtw_mlme_update_wfd_ie_data(struct mlme_priv *mlme, u8 type, u8 *ie, u32 ie_ void _rtw_free_mlme_priv(struct mlme_priv *pmlmepriv) { + _adapter *adapter = mlme_to_adapter(pmlmepriv); if (NULL == pmlmepriv) { rtw_warn_on(1); goto exit; @@ -286,7 +309,7 @@ void _rtw_free_mlme_priv(struct mlme_priv *pmlmepriv) rtw_mfree_mlme_priv_lock(pmlmepriv); if (pmlmepriv->free_bss_buf) - rtw_vmfree(pmlmepriv->free_bss_buf, MAX_BSS_CNT * sizeof(struct wlan_network)); + rtw_vmfree(pmlmepriv->free_bss_buf, pmlmepriv->max_bss_cnt * sizeof(struct wlan_network)); } exit: return; @@ -363,6 +386,11 @@ struct wlan_network *_rtw_alloc_network(struct mlme_priv *pmlmepriv) /* (_queue pnetwork->network_type = 0; pnetwork->fixed = _FALSE; pnetwork->last_scanned = rtw_get_current_time(); +#if defined(CONFIG_RTW_MESH) && CONFIG_RTW_MESH_ACNODE_PREVENT + pnetwork->acnode_stime = 0; + pnetwork->acnode_notify_etime = 0; +#endif + pnetwork->aid = 0; pnetwork->join_res = 0; @@ -442,53 +470,6 @@ void _rtw_free_network_nolock(struct mlme_priv *pmlmepriv, struct wlan_network * return; } - -/* - return the wlan_network with the matching addr - - Shall be calle under atomic context... to avoid possible racing condition... -*/ -struct wlan_network *_rtw_find_network(_queue *scanned_queue, u8 *addr) -{ - - /* _irqL irqL; */ - _list *phead, *plist; - struct wlan_network *pnetwork = NULL; - u8 zero_addr[ETH_ALEN] = {0, 0, 0, 0, 0, 0}; - - - if (_rtw_memcmp(zero_addr, addr, ETH_ALEN)) { - pnetwork = NULL; - goto exit; - } - - /* _enter_critical_bh(&scanned_queue->lock, &irqL); */ - - phead = get_list_head(scanned_queue); - plist = get_next(phead); - - while (plist != phead) { - pnetwork = LIST_CONTAINOR(plist, struct wlan_network , list); - - if (_rtw_memcmp(addr, pnetwork->network.MacAddress, ETH_ALEN) == _TRUE) - break; - - plist = get_next(plist); - } - - if (plist == phead) - pnetwork = NULL; - - /* _exit_critical_bh(&scanned_queue->lock, &irqL); */ - -exit: - - - return pnetwork; - -} - - void _rtw_free_network_queue(_adapter *padapter, u8 isfreeall) { _irqL irqL; @@ -629,14 +610,44 @@ void rtw_free_network_queue(_adapter *dev, u8 isfreeall) _rtw_free_network_queue(dev, isfreeall); } -/* - return the wlan_network with the matching addr - - Shall be calle under atomic context... to avoid possible racing condition... -*/ -struct wlan_network *rtw_find_network(_queue *scanned_queue, u8 *addr) +struct wlan_network *_rtw_find_network(_queue *scanned_queue, const u8 *addr) { - struct wlan_network *pnetwork = _rtw_find_network(scanned_queue, addr); + _list *phead, *plist; + struct wlan_network *pnetwork = NULL; + u8 zero_addr[ETH_ALEN] = {0, 0, 0, 0, 0, 0}; + + if (_rtw_memcmp(zero_addr, addr, ETH_ALEN)) { + pnetwork = NULL; + goto exit; + } + + phead = get_list_head(scanned_queue); + plist = get_next(phead); + + while (plist != phead) { + pnetwork = LIST_CONTAINOR(plist, struct wlan_network , list); + + if (_rtw_memcmp(addr, pnetwork->network.MacAddress, ETH_ALEN) == _TRUE) + break; + + plist = get_next(plist); + } + + if (plist == phead) + pnetwork = NULL; + +exit: + return pnetwork; +} + +struct wlan_network *rtw_find_network(_queue *scanned_queue, const u8 *addr) +{ + struct wlan_network *pnetwork; + _irqL irqL; + + _enter_critical_bh(&scanned_queue->lock, &irqL); + pnetwork = _rtw_find_network(scanned_queue, addr); + _exit_critical_bh(&scanned_queue->lock, &irqL); return pnetwork; } @@ -688,15 +699,35 @@ int is_same_network(WLAN_BSSID_EX *src, WLAN_BSSID_EX *dst, u8 feature) return _TRUE; #endif - return ((src->Ssid.SsidLength == dst->Ssid.SsidLength) && - /* (src->Configuration.DSConfig == dst->Configuration.DSConfig) && */ - ((_rtw_memcmp(src->MacAddress, dst->MacAddress, ETH_ALEN)) == _TRUE) && - ((_rtw_memcmp(src->Ssid.Ssid, dst->Ssid.Ssid, src->Ssid.SsidLength)) == _TRUE) && - ((s_cap & WLAN_CAPABILITY_IBSS) == - (d_cap & WLAN_CAPABILITY_IBSS)) && - ((s_cap & WLAN_CAPABILITY_BSS) == - (d_cap & WLAN_CAPABILITY_BSS))); - + /* Wi-Fi driver doesn't consider the situation of BCN and ProbRsp sent from the same hidden AP, + * it considers these two packets are sent from different AP. + * Therefore, the scan queue may store two scan results of the same hidden AP, likes below. + * + * index bssid ch RSSI SdBm Noise age flag ssid + * 1 00:e0:4c:55:50:01 153 -73 -73 0 7044 [WPS][ESS] RTK5G + * 3 00:e0:4c:55:50:01 153 -73 -73 0 7044 [WPS][ESS] + * + * Original rules will compare Ssid, SsidLength, MacAddress, s_cap, d_cap at the same time. + * Wi-Fi driver will assume that the BCN and ProbRsp sent from the same hidden AP are the same network + * after we add an additional rule to compare SsidLength and Ssid. + * It means the scan queue will not store two scan results of the same hidden AP, it only store ProbRsp. + * For customer request. + */ + + if (((_rtw_memcmp(src->MacAddress, dst->MacAddress, ETH_ALEN)) == _TRUE) && + ((s_cap & WLAN_CAPABILITY_IBSS) == (d_cap & WLAN_CAPABILITY_IBSS)) && + ((s_cap & WLAN_CAPABILITY_BSS) == (d_cap & WLAN_CAPABILITY_BSS))) { + if ((src->Ssid.SsidLength == dst->Ssid.SsidLength) && + (((_rtw_memcmp(src->Ssid.Ssid, dst->Ssid.Ssid, src->Ssid.SsidLength)) == _TRUE) || //Case of normal AP + (is_all_null(src->Ssid.Ssid, src->Ssid.SsidLength) == _TRUE || is_all_null(dst->Ssid.Ssid, dst->Ssid.SsidLength) == _TRUE))) //Case of hidden AP + return _TRUE; + else if ((src->Ssid.SsidLength == 0 || dst->Ssid.SsidLength == 0)) //Case of hidden AP + return _TRUE; + else + return _FALSE; + } else { + return _FALSE; + } } struct wlan_network *_rtw_find_same_network(_queue *scanned_queue, struct wlan_network *network) @@ -718,7 +749,7 @@ struct wlan_network *_rtw_find_same_network(_queue *scanned_queue, struct wlan_n if (plist == phead) found = NULL; -exit: + return found; } @@ -757,7 +788,7 @@ struct wlan_network *rtw_get_oldest_wlan_network(_queue *scanned_queue) pwlan = LIST_CONTAINOR(plist, struct wlan_network, list); if (pwlan->fixed != _TRUE) { - if (oldest == NULL || time_after(oldest->last_scanned, pwlan->last_scanned)) + if (oldest == NULL || rtw_time_after(oldest->last_scanned, pwlan->last_scanned)) oldest = pwlan; } @@ -770,14 +801,15 @@ struct wlan_network *rtw_get_oldest_wlan_network(_queue *scanned_queue) void update_network(WLAN_BSSID_EX *dst, WLAN_BSSID_EX *src, _adapter *padapter, bool update_ie) { +#if defined(DBG_RX_SIGNAL_DISPLAY_SSID_MONITORED) && 1 u8 ss_ori = dst->PhyInfo.SignalStrength; u8 sq_ori = dst->PhyInfo.SignalQuality; + u8 ss_smp = src->PhyInfo.SignalStrength; + long rssi_smp = src->Rssi; +#endif long rssi_ori = dst->Rssi; - u8 ss_smp = src->PhyInfo.SignalStrength; u8 sq_smp = src->PhyInfo.SignalQuality; - long rssi_smp = src->Rssi; - u8 ss_final; u8 sq_final; long rssi_final; @@ -904,27 +936,31 @@ Caller must hold pmlmepriv->lock first. */ -void rtw_update_scanned_network(_adapter *adapter, WLAN_BSSID_EX *target) +bool rtw_update_scanned_network(_adapter *adapter, WLAN_BSSID_EX *target) { _irqL irqL; _list *plist, *phead; - ULONG bssid_ex_sz; + u32 bssid_ex_sz; struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); - struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); #ifdef CONFIG_P2P struct wifidirect_info *pwdinfo = &(adapter->wdinfo); #endif /* CONFIG_P2P */ _queue *queue = &(pmlmepriv->scanned_queue); struct wlan_network *pnetwork = NULL; - struct wlan_network *oldest = NULL; + struct wlan_network *choice = NULL; int target_find = 0; u8 feature = 0; - + bool update_ie = _FALSE; _enter_critical_bh(&queue->lock, &irqL); 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 */ @@ -952,12 +988,28 @@ 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*/ + /* TODO: don't select netowrk in the same ess as choice if it's new enough*/ } - - if (oldest == NULL || time_after(oldest->last_scanned, pnetwork->last_scanned)) - oldest = pnetwork; - + if (pnetwork->fixed) { + plist = get_next(plist); + continue; + } + +#ifdef CONFIG_RSSI_PRIORITY + if ((choice == NULL) || (pnetwork->network.PhyInfo.SignalStrength < choice->network.PhyInfo.SignalStrength)) + #ifdef CONFIG_RTW_MESH + if (!MLME_IS_MESH(adapter) || !MLME_IS_ASOC(adapter) + || !rtw_bss_is_same_mbss(&pmlmepriv->cur_network.network, &pnetwork->network)) + #endif + choice = pnetwork; +#else + if (choice == NULL || rtw_time_after(choice->last_scanned, pnetwork->last_scanned)) + #ifdef CONFIG_RTW_MESH + if (!MLME_IS_MESH(adapter) || !MLME_IS_ASOC(adapter) + || !rtw_bss_is_same_mbss(&pmlmepriv->cur_network.network, &pnetwork->network)) + #endif + choice = pnetwork; +#endif plist = get_next(plist); } @@ -968,12 +1020,20 @@ void rtw_update_scanned_network(_adapter *adapter, WLAN_BSSID_EX *target) /* if (rtw_end_of_queue_search(phead,plist)== _TRUE) { */ if (!target_find) { if (_rtw_queue_empty(&(pmlmepriv->free_bss_pool)) == _TRUE) { - /* If there are no more slots, expire the oldest */ - /* list_del_init(&oldest->list); */ - pnetwork = oldest; - if (pnetwork == NULL) { - goto exit; - } + /* If there are no more slots, expire the choice */ + /* list_del_init(&choice->list); */ + pnetwork = choice; + if (pnetwork == NULL) + goto unlock_scan_queue; + +#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 @@ -982,6 +1042,10 @@ void rtw_update_scanned_network(_adapter *adapter, WLAN_BSSID_EX *target) /* variable initialize */ pnetwork->fixed = _FALSE; pnetwork->last_scanned = rtw_get_current_time(); + #if defined(CONFIG_RTW_MESH) && CONFIG_RTW_MESH_ACNODE_PREVENT + pnetwork->acnode_stime = 0; + pnetwork->acnode_notify_etime = 0; + #endif pnetwork->network_type = 0; pnetwork->aid = 0; @@ -994,10 +1058,8 @@ void rtw_update_scanned_network(_adapter *adapter, WLAN_BSSID_EX *target) /* Otherwise just pull from the free list */ pnetwork = rtw_alloc_network(pmlmepriv); /* will update scan_time */ - - if (pnetwork == NULL) { - goto exit; - } + if (pnetwork == NULL) + goto unlock_scan_queue; bssid_ex_sz = get_WLAN_BSSID_EX_sz(target); target->Length = bssid_ex_sz; @@ -1020,38 +1082,63 @@ void rtw_update_scanned_network(_adapter *adapter, WLAN_BSSID_EX *target) * be already expired. In this case we do the same as we found a new * net and call the new_net handler */ - bool update_ie = _TRUE; + #if defined(CONFIG_RTW_MESH) && CONFIG_RTW_MESH_ACNODE_PREVENT + systime last_scanned = pnetwork->last_scanned; + #endif 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) && - (target->Reserved[0] >= pnetwork->network.Reserved[0]) - ) + if (MLME_IS_MESH(adapter) + /* probe resp(3) > beacon(1) > probe req(2) */ + || (target->Reserved[0] != BSS_TYPE_PROB_REQ + && target->Reserved[0] >= pnetwork->network.Reserved[0]) + ) update_ie = _TRUE; else update_ie = _FALSE; + #if defined(CONFIG_RTW_MESH) && CONFIG_RTW_MESH_ACNODE_PREVENT + if (!MLME_IS_MESH(adapter) || !MLME_IS_ASOC(adapter) + || pnetwork->network.Configuration.DSConfig != target->Configuration.DSConfig + || rtw_get_passing_time_ms(last_scanned) > adapter->mesh_cfg.peer_sel_policy.scanr_exp_ms + || !rtw_bss_is_same_mbss(&pnetwork->network, target) + ) { + pnetwork->acnode_stime = 0; + pnetwork->acnode_notify_etime = 0; + } + #endif update_network(&(pnetwork->network), target, adapter, update_ie); } -exit: + #if defined(CONFIG_RTW_MESH) && CONFIG_RTW_MESH_ACNODE_PREVENT + if (MLME_IS_MESH(adapter) && MLME_IS_ASOC(adapter)) + rtw_mesh_update_scanned_acnode_status(adapter, pnetwork); + #endif + +unlock_scan_queue: _exit_critical_bh(&queue->lock, &irqL); +#ifdef CONFIG_RTW_MESH + if (pnetwork && MLME_IS_MESH(adapter) + && check_fwstate(pmlmepriv, WIFI_ASOC_STATE) + && !check_fwstate(pmlmepriv, WIFI_SITE_MONITOR) + ) + rtw_chk_candidate_peer_notify(adapter, pnetwork); +#endif + + return update_ie; } void rtw_add_network(_adapter *adapter, WLAN_BSSID_EX *pnetwork); void rtw_add_network(_adapter *adapter, WLAN_BSSID_EX *pnetwork) { - _irqL irqL; - struct mlme_priv *pmlmepriv = &(((_adapter *)adapter)->mlmepriv); + bool update_ie; /* _queue *queue = &(pmlmepriv->scanned_queue); */ - /* _enter_critical_bh(&queue->lock, &irqL); */ #if defined(CONFIG_P2P) && defined(CONFIG_P2P_REMOVE_GROUP_INFO) @@ -1062,9 +1149,11 @@ void rtw_add_network(_adapter *adapter, WLAN_BSSID_EX *pnetwork) if (!hal_chk_wl_func(adapter, WL_FUNC_MIRACAST)) rtw_bss_ex_del_wfd_ie(pnetwork); - update_current_network(adapter, pnetwork); + /* Wi-Fi driver will update the current network if the scan result of the connected AP be updated by scan. */ + update_ie = rtw_update_scanned_network(adapter, pnetwork); - rtw_update_scanned_network(adapter, pnetwork); + if (update_ie) + update_current_network(adapter, pnetwork); /* _exit_critical_bh(&queue->lock, &irqL); */ @@ -1147,26 +1236,6 @@ void rtw_survey_event_callback(_adapter *adapter, u8 *pbuf) pnetwork = (WLAN_BSSID_EX *)pbuf; - -#ifdef CONFIG_RTL8712 - /* endian_convert */ - pnetwork->Length = le32_to_cpu(pnetwork->Length); - pnetwork->Ssid.SsidLength = le32_to_cpu(pnetwork->Ssid.SsidLength); - pnetwork->Privacy = le32_to_cpu(pnetwork->Privacy); - pnetwork->Rssi = le32_to_cpu(pnetwork->Rssi); - pnetwork->NetworkTypeInUse = le32_to_cpu(pnetwork->NetworkTypeInUse); - pnetwork->Configuration.ATIMWindow = le32_to_cpu(pnetwork->Configuration.ATIMWindow); - pnetwork->Configuration.BeaconPeriod = le32_to_cpu(pnetwork->Configuration.BeaconPeriod); - pnetwork->Configuration.DSConfig = le32_to_cpu(pnetwork->Configuration.DSConfig); - pnetwork->Configuration.FHConfig.DwellTime = le32_to_cpu(pnetwork->Configuration.FHConfig.DwellTime); - pnetwork->Configuration.FHConfig.HopPattern = le32_to_cpu(pnetwork->Configuration.FHConfig.HopPattern); - pnetwork->Configuration.FHConfig.HopSet = le32_to_cpu(pnetwork->Configuration.FHConfig.HopSet); - pnetwork->Configuration.FHConfig.Length = le32_to_cpu(pnetwork->Configuration.FHConfig.Length); - pnetwork->Configuration.Length = le32_to_cpu(pnetwork->Configuration.Length); - pnetwork->InfrastructureMode = le32_to_cpu(pnetwork->InfrastructureMode); - pnetwork->IELength = le32_to_cpu(pnetwork->IELength); -#endif - len = get_WLAN_BSSID_EX_sz(pnetwork); if (len > (sizeof(WLAN_BSSID_EX))) { return; @@ -1183,7 +1252,7 @@ void rtw_survey_event_callback(_adapter *adapter, u8 *pbuf) _rtw_memcpy(pmlmepriv->cur_network.network.IEs, pnetwork->IEs, 8); _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); - ibss_wlan = rtw_find_network(&pmlmepriv->scanned_queue, pnetwork->MacAddress); + ibss_wlan = _rtw_find_network(&pmlmepriv->scanned_queue, pnetwork->MacAddress); if (ibss_wlan) { _rtw_memcpy(ibss_wlan->network.IEs , pnetwork->IEs, 8); _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); @@ -1211,7 +1280,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 +1308,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,18 +1360,18 @@ 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) { + u8 ssc_chk = rtw_sitesurvey_condition_check(adapter, _FALSE); + + 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) + || (ssc_chk != SS_ALLOW && ssc_chk != SS_DENY_BUSY_TRAFFIC) + || _SUCCESS != rtw_sitesurvey_cmd(adapter, &parm) ) { rtw_set_to_roam(adapter, 0); -#ifdef CONFIG_INTEL_WIDI - if (adapter->mlmepriv.widi_state == INTEL_WIDI_STATE_ROAMING) { - _rtw_memset(pmlmepriv->sa_ext, 0x00, L2SDTA_SERVICE_VE_LEN); - intel_widi_wk_cmd(adapter, INTEL_WIDI_LISTEN_WK, NULL, 0); - RTW_INFO("change to widi listen\n"); - } -#endif /* CONFIG_INTEL_WIDI */ - rtw_free_assoc_resources(adapter, 1); + rtw_free_assoc_resources(adapter, _TRUE); rtw_indicate_disconnect(adapter, 0, _FALSE); } else pmlmepriv->to_join = _TRUE; @@ -1317,12 +1386,8 @@ void rtw_surveydone_event_callback(_adapter *adapter, u8 *pbuf) && check_fwstate(pmlmepriv, _FW_LINKED)) { if (rtw_select_roaming_candidate(pmlmepriv) == _SUCCESS) { #ifdef CONFIG_RTW_80211R - if (rtw_chk_ft_flags(adapter, 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); - } + rtw_ft_start_roam(adapter, + (u8 *)pmlmepriv->roam_network->network.MacAddress); #else receive_disconnect(adapter, pmlmepriv->cur_network.network.MacAddress , WLAN_REASON_ACTIVE_ROAM, _FALSE); @@ -1366,6 +1431,143 @@ void rtw_surveydone_event_callback(_adapter *adapter, u8 *pbuf) rtw_cfg80211_indicate_scan_done_for_buddy(adapter, _FALSE); #endif +#ifdef CONFIG_RTW_MESH + #if CONFIG_RTW_MESH_OFFCH_CAND + if (rtw_mesh_offch_candidate_accepted(adapter)) { + u8 ch; + + ch = rtw_mesh_select_operating_ch(adapter); + if (ch && pmlmepriv->cur_network.network.Configuration.DSConfig != ch) { + u8 ifbmp = rtw_mi_get_ap_mesh_ifbmp(adapter); + + if (ifbmp) { + /* switch to selected channel */ + rtw_change_bss_chbw_cmd(adapter, RTW_CMDF_DIRECTLY, ifbmp, 0, ch, REQ_BW_ORI, REQ_OFFSET_NONE); + issue_probereq_ex(adapter, &pmlmepriv->cur_network.network.mesh_id, NULL, 0, 0, 0, 0); + } else + rtw_warn_on(1); + } + } + #endif +#endif /* CONFIG_RTW_MESH */ +} + +u8 _rtw_sitesurvey_condition_check(const char *caller, _adapter *adapter, bool check_sc_interval) +{ + u8 ss_condition = SS_ALLOW; + struct mlme_priv *pmlmepriv = &adapter->mlmepriv; +#ifdef DBG_LA_MODE + struct registry_priv *registry_par = &adapter->registrypriv; +#endif + +#ifdef CONFIG_MP_INCLUDED + if (rtw_mp_mode_check(adapter)) { + RTW_INFO("%s ("ADPT_FMT") MP mode block Scan request\n", caller, ADPT_ARG(adapter)); + ss_condition = SS_DENY_MP_MODE; + goto _exit; + } +#endif + +#ifdef DBG_LA_MODE + if(registry_par->la_mode_en == 1 && MLME_IS_ASOC(adapter)) { + RTW_INFO("%s ("ADPT_FMT") LA debug mode block Scan request\n", caller, ADPT_ARG(adapter)); + ss_condition = SS_DENY_LA_MODE; + goto _exit; + } +#endif + +#ifdef CONFIG_RTW_REPEATER_SON + if (adapter->rtw_rson_scanstage == RSON_SCAN_PROCESS) { + RTW_INFO("%s ("ADPT_FMT") blocking scan for under rson scanning process\n", caller, ADPT_ARG(adapter)); + ss_condition = SS_DENY_RSON_SCANING; + goto _exit; + } +#endif +#ifdef CONFIG_IOCTL_CFG80211 + if (adapter_wdev_data(adapter)->block_scan == _TRUE) { + RTW_INFO("%s ("ADPT_FMT") wdev_priv.block_scan is set\n", caller, ADPT_ARG(adapter)); + ss_condition = SS_DENY_BLOCK_SCAN; + goto _exit; + } +#endif + + if (adapter_to_dvobj(adapter)->scan_deny == _TRUE) { + RTW_INFO("%s ("ADPT_FMT") tpt mode, scan deny!\n", caller, ADPT_ARG(adapter)); + ss_condition = SS_DENY_BLOCK_SCAN; + goto _exit; + } + + if (rtw_is_scan_deny(adapter)) { + RTW_INFO("%s ("ADPT_FMT") : scan deny\n", caller, ADPT_ARG(adapter)); + ss_condition = SS_DENY_BY_DRV; + goto _exit; + } + + if (check_fwstate(pmlmepriv, WIFI_AP_STATE)){ + if(check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) { + RTW_INFO("%s ("ADPT_FMT") : scan abort!! AP mode process WPS\n", caller, ADPT_ARG(adapter)); + ss_condition = SS_DENY_SELF_AP_UNDER_WPS; + goto _exit; + } else if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE) { + RTW_INFO("%s ("ADPT_FMT") : scan abort!!AP mode under linking (fwstate=0x%x)\n", + caller, ADPT_ARG(adapter), pmlmepriv->fw_state); + ss_condition = SS_DENY_SELF_AP_UNDER_LINKING; + goto _exit; + } else if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) { + RTW_INFO("%s ("ADPT_FMT") : scan abort!!AP mode under survey (fwstate=0x%x)\n", + caller, ADPT_ARG(adapter), pmlmepriv->fw_state); + ss_condition = SS_DENY_SELF_AP_UNDER_SURVEY; + goto _exit; + } + } else { + if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE) { + RTW_INFO("%s ("ADPT_FMT") : scan abort!!STA mode under linking (fwstate=0x%x)\n", + caller, ADPT_ARG(adapter), pmlmepriv->fw_state); + ss_condition = SS_DENY_SELF_STA_UNDER_LINKING; + goto _exit; + } else if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) { + RTW_INFO("%s ("ADPT_FMT") : scan abort!!STA mode under survey (fwstate=0x%x)\n", + caller, ADPT_ARG(adapter), pmlmepriv->fw_state); + ss_condition = SS_DENY_SELF_STA_UNDER_SURVEY; + goto _exit; + } + } + +#ifdef CONFIG_CONCURRENT_MODE + if (rtw_mi_buddy_check_fwstate(adapter, _FW_UNDER_LINKING | WIFI_UNDER_WPS)) { + RTW_INFO("%s ("ADPT_FMT") : scan abort!! buddy_intf under linking or wps\n", caller, ADPT_ARG(adapter)); + ss_condition = SS_DENY_BUDDY_UNDER_LINK_WPS; + goto _exit; + + } else if (rtw_mi_buddy_check_fwstate(adapter, _FW_UNDER_SURVEY)) { + RTW_INFO("%s ("ADPT_FMT") : scan abort!! buddy_intf under survey\n", caller, ADPT_ARG(adapter)); + ss_condition = SS_DENY_BUDDY_UNDER_SURVEY; + goto _exit; + } +#endif /* CONFIG_CONCURRENT_MODE */ + + if (pmlmepriv->LinkDetectInfo.bBusyTraffic == _TRUE) { + RTW_INFO("%s ("ADPT_FMT") : scan abort!! BusyTraffic\n", + caller, ADPT_ARG(adapter)); + ss_condition = SS_DENY_BUSY_TRAFFIC; + goto _exit; + } + /* + * Rule for Android. + * If scan interval > BUSY_TRAFFIC_SCAN_DENY_PERIOD, + * it is a periodical background scan. + * Skip background scan when other interface is busy. + */ + if ((rtw_get_passing_time_ms(pmlmepriv->lastscantime) > BUSY_TRAFFIC_SCAN_DENY_PERIOD) + && rtw_mi_buddy_busy_traffic_check(adapter, _FALSE)) { + RTW_INFO("%s ("ADPT_FMT") : scan abort!! others BusyTraffic\n", + caller, ADPT_ARG(adapter)); + ss_condition = SS_DENY_BUSY_TRAFFIC; + goto _exit; + } + +_exit : + return ss_condition; } void rtw_dummy_event_callback(_adapter *adapter , u8 *pbuf) @@ -1405,27 +1607,28 @@ 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; } /* *rtw_free_assoc_resources: the caller has to lock pmlmepriv->lock */ -void rtw_free_assoc_resources(_adapter *adapter, int lock_scanned_queue) +void rtw_free_assoc_resources(_adapter *adapter, u8 lock_scanned_queue) { _irqL irqL; struct wlan_network *pwlan = NULL; 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 +1636,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)) { @@ -1442,18 +1645,15 @@ void rtw_free_assoc_resources(_adapter *adapter, int lock_scanned_queue) psta = rtw_get_stainfo(&adapter->stapriv, tgt_network->network.MacAddress); #ifdef CONFIG_TDLS - if (ptdlsinfo->link_established == _TRUE) { - rtw_tdls_cmd(adapter, NULL, TDLS_RS_RCR); - rtw_reset_tdls_info(adapter); - rtw_free_all_stainfo(adapter); - /* _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ - } else -#endif /* CONFIG_TDLS */ - { - /* _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ - rtw_free_stainfo(adapter, psta); - } + rtw_free_all_tdls_sta(adapter, _TRUE); + rtw_reset_tdls_info(adapter); + if (ptdlsinfo->link_established == _TRUE) + rtw_tdls_cmd(adapter, NULL, TDLS_RS_RCR); +#endif /* CONFIG_TDLS */ + + /* _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ + rtw_free_stainfo(adapter, psta); /* _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ } @@ -1474,25 +1674,26 @@ void rtw_free_assoc_resources(_adapter *adapter, int lock_scanned_queue) if (lock_scanned_queue) _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); - pwlan = _rtw_find_same_network(&pmlmepriv->scanned_queue, tgt_network); - if ((pwlan) && (!check_fwstate(pmlmepriv, WIFI_UNDER_WPS))) { - pwlan->fixed = _FALSE; - - RTW_INFO("free disconnecting network of scanned_queue\n"); - rtw_free_network_nolock(adapter, pwlan); -#ifdef CONFIG_P2P - if (!rtw_p2p_chk_state(&adapter->wdinfo, P2P_STATE_NONE)) { - rtw_mi_set_scan_deny(adapter, 2000); - /* rtw_clear_scan_deny(adapter); */ - } -#endif /* CONFIG_P2P */ + if (check_fwstate(pmlmepriv, WIFI_UNDER_WPS) || (pmlmepriv->wpa_phase == _TRUE)){ + RTW_INFO("Dont free disconnecting network of scanned_queue due to uner %s %s phase\n\n", + check_fwstate(pmlmepriv, WIFI_UNDER_WPS) ? "WPS" : "", + (pmlmepriv->wpa_phase == _TRUE) ? "WPA" : ""); } else { - if (pwlan == NULL) - RTW_INFO("free disconnecting network of scanned_queue failed due to pwlan== NULL\n\n"); - if (check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) - RTW_INFO("donot free disconnecting network of scanned_queue when WIFI_UNDER_WPS\n\n"); - } + pwlan = _rtw_find_same_network(&pmlmepriv->scanned_queue, tgt_network); + if (pwlan) { + pwlan->fixed = _FALSE; + RTW_INFO("Free disconnecting network of scanned_queue\n"); + rtw_free_network_nolock(adapter, pwlan); +#ifdef CONFIG_P2P + if (!rtw_p2p_chk_state(&adapter->wdinfo, P2P_STATE_NONE)) { + rtw_set_scan_deny(adapter, 2000); + /* rtw_clear_scan_deny(adapter); */ + } +#endif /* CONFIG_P2P */ + } else + RTW_ERR("Free disconnecting network of scanned_queue failed due to pwlan == NULL\n\n"); + } if ((check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) && (adapter->stapriv.asoc_sta_count == 1)) /*||check_fwstate(pmlmepriv, WIFI_STATION_STATE)*/) { @@ -1505,7 +1706,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); } @@ -1516,9 +1717,6 @@ void rtw_free_assoc_resources(_adapter *adapter, int lock_scanned_queue) void rtw_indicate_connect(_adapter *padapter) { struct mlme_priv *pmlmepriv = &padapter->mlmepriv; - struct xmit_priv *pxmitpriv = &padapter->xmitpriv; - - pmlmepriv->to_join = _FALSE; @@ -1528,27 +1726,11 @@ 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); -#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 */ - if (!check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE)) + if (!MLME_IS_AP(padapter) && !MLME_IS_MESH(padapter)) rtw_mi_set_scan_deny(padapter, 3000); @@ -1560,18 +1742,21 @@ void rtw_indicate_connect(_adapter *padapter) */ void rtw_indicate_disconnect(_adapter *padapter, u16 reason, u8 locally_generated) { - struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); +#ifdef CONFIG_WAPI_SUPPORT struct sta_info *psta; struct sta_priv *pstapriv = &padapter->stapriv; +#endif u8 *wps_ie = NULL; uint wpsie_len = 0; + if (check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) + pmlmepriv->wpa_phase = _TRUE; - - _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING | WIFI_UNDER_WPS); + _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING | WIFI_UNDER_WPS | WIFI_OP_CH_SWITCHING | WIFI_UNDER_KEY_HANDSHAKE); /* force to clear cur_network_scanned's SELECTED REGISTRAR */ if (pmlmepriv->cur_network_scanned) { @@ -1597,7 +1782,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); @@ -1624,7 +1809,7 @@ void rtw_indicate_disconnect(_adapter *padapter, u16 reason, u8 locally_generate #endif /* CONFIG_P2P_PS */ #ifdef CONFIG_LPS - rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_DISCONNECT, 1); + rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_DISCONNECT, 0); #endif #ifdef CONFIG_BEAMFORMING @@ -1658,7 +1843,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 +1884,10 @@ 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 ss_res *ss = &pmlmeext->sitesurvey_res; -#ifdef CONFIG_SCAN_BACKOP - if (is_supported_5g(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) @@ -1731,13 +1909,66 @@ void rtw_scan_abort(_adapter *adapter) rtw_scan_abort_timeout(adapter, 200); } +static u32 _rtw_wait_join_done(_adapter *adapter, u8 abort, u32 timeout_ms) +{ + systime start; + u32 pass_ms; + struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); + struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); + + start = rtw_get_current_time(); + + pmlmeext->join_abort = abort; + if (abort) + set_link_timer(pmlmeext, 1); + + while (rtw_get_passing_time_ms(start) <= timeout_ms + && (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) + #ifdef CONFIG_IOCTL_CFG80211 + || rtw_cfg80211_is_connect_requested(adapter) + #endif + ) + ) { + if (RTW_CANNOT_RUN(adapter)) + break; + + RTW_INFO(FUNC_ADPT_FMT" linking...\n", FUNC_ADPT_ARG(adapter)); + rtw_msleep_os(20); + } + + if (abort) { + if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) + #ifdef CONFIG_IOCTL_CFG80211 + || rtw_cfg80211_is_connect_requested(adapter) + #endif + ) { + if (!RTW_CANNOT_RUN(adapter)) + RTW_INFO(FUNC_ADPT_FMT" waiting for join_abort time out!\n", FUNC_ADPT_ARG(adapter)); + } + } + + pmlmeext->join_abort = 0; + pass_ms = rtw_get_passing_time_ms(start); + + return pass_ms; +} + +u32 rtw_join_abort_timeout(_adapter *adapter, u32 timeout_ms) +{ + return _rtw_wait_join_done(adapter, _TRUE, timeout_ms); +} + 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; +#ifdef CONFIG_RTS_FULL_BW + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct wlan_network *cur_network = &(pmlmepriv->cur_network); +#endif/*CONFIG_RTS_FULL_BW*/ psta = rtw_get_stainfo(pstapriv, pnetwork->network.MacAddress); if (psta == NULL) @@ -1746,58 +1977,51 @@ 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; - -#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; - else - psta->mac_id = 2; -#else - psta->mac_id = 0; -#endif -#endif /* removed */ + psta->cmn.aid = pnetwork->join_res; update_sta_info(padapter, psta); /* 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); /* security related */ #ifdef CONFIG_RTW_80211R - if ((padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) && (psta->ft_pairwise_key_installed == _FALSE)) { + if ((padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) + && (psta->ft_pairwise_key_installed == _FALSE)) { #else if (padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) { #endif + u8 *ie; + sint ie_len; + u8 mfp_opt = MFP_NO; + padapter->securitypriv.binstallGrpkey = _FALSE; padapter->securitypriv.busetkipkey = _FALSE; padapter->securitypriv.bgrpkey_handshake = _FALSE; + ie = rtw_get_ie(pnetwork->network.IEs + _BEACON_IE_OFFSET_, WLAN_EID_RSN + , &ie_len, (pnetwork->network.IELength - _BEACON_IE_OFFSET_)); + if (ie && ie_len > 0 + && rtw_parse_wpa2_ie(ie, ie_len + 2, NULL, NULL, NULL, &mfp_opt) == _SUCCESS + ) { + if (padapter->securitypriv.mfp_opt >= MFP_OPTIONAL && mfp_opt >= MFP_OPTIONAL) + psta->flags |= WLAN_STA_MFP; + } + psta->ieee8021x_blocked = _TRUE; psta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm; _rtw_memset((u8 *)&psta->dot118021x_UncstKey, 0, sizeof(union Keytype)); - _rtw_memset((u8 *)&psta->dot11tkiprxmickey, 0, sizeof(union Keytype)); _rtw_memset((u8 *)&psta->dot11tkiptxmickey, 0, sizeof(union Keytype)); - - _rtw_memset((u8 *)&psta->dot11txpn, 0, sizeof(union pn48)); - psta->dot11txpn.val = psta->dot11txpn.val + 1; -#ifdef CONFIG_IEEE80211W - _rtw_memset((u8 *)&psta->dot11wtxpn, 0, sizeof(union pn48)); -#endif /* CONFIG_IEEE80211W */ - _rtw_memset((u8 *)&psta->dot11rxpn, 0, sizeof(union pn48)); } /* Commented by Albert 2012/07/21 */ @@ -1809,7 +2033,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 +2041,22 @@ 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 +#ifdef CONFIG_RTS_FULL_BW + rtw_parse_sta_vendor_ie_8812(padapter, psta, BSS_EX_TLV_IES(&cur_network->network), BSS_EX_TLV_IES_LEN(&cur_network->network)); +#endif return psta; } @@ -1854,12 +2066,12 @@ static struct sta_info *rtw_joinbss_update_stainfo(_adapter *padapter, struct wl static void rtw_joinbss_update_network(_adapter *padapter, struct wlan_network *ptarget_wlan, struct wlan_network *pnetwork) { struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct security_priv *psecuritypriv = &padapter->securitypriv; struct wlan_network *cur_network = &(pmlmepriv->cur_network); + sint tmp_fw_state = 0x0; RTW_INFO("%s\n", __FUNCTION__); - - /* why not use ptarget_wlan?? */ _rtw_memcpy(&cur_network->network, &pnetwork->network, pnetwork->network.Length); /* some IEs in pnetwork is wrong, so we should use ptarget_wlan IEs */ @@ -1893,13 +2105,15 @@ static void rtw_joinbss_update_network(_adapter *padapter, struct wlan_network * switch (pnetwork->network.InfrastructureMode) { case Ndis802_11Infrastructure: + /* Check encryption */ + if (psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) + tmp_fw_state = tmp_fw_state | WIFI_UNDER_KEY_HANDSHAKE; + + if (check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) + tmp_fw_state = tmp_fw_state | WIFI_UNDER_WPS; + + init_fwstate(pmlmepriv, WIFI_STATION_STATE | tmp_fw_state); - if (pmlmepriv->fw_state & WIFI_UNDER_WPS) - /*pmlmepriv->fw_state = WIFI_STATION_STATE|WIFI_UNDER_WPS;*/ - init_fwstate(pmlmepriv, WIFI_STATION_STATE | WIFI_UNDER_WPS); - else - /*pmlmepriv->fw_state = WIFI_STATION_STATE;*/ - init_fwstate(pmlmepriv, WIFI_STATION_STATE); break; case Ndis802_11IBSS: /*pmlmepriv->fw_state = WIFI_ADHOC_STATE;*/ @@ -1927,11 +2141,10 @@ static void rtw_joinbss_update_network(_adapter *padapter, struct wlan_network * * if join_res > 0, update "cur_network->network" from "pnetwork->network" if (ptarget_wlan !=NULL). */ /* #define REJOIN */ -void rtw_joinbss_event_prehandle(_adapter *adapter, u8 *pbuf) +void rtw_joinbss_event_prehandle(_adapter *adapter, u8 *pbuf, u16 status) { - _irqL irqL, irqL2; + _irqL irqL; 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); @@ -1940,39 +2153,13 @@ void rtw_joinbss_event_prehandle(_adapter *adapter, u8 *pbuf) struct wlan_network *pcur_wlan = NULL, *ptarget_wlan = NULL; unsigned int the_same_macaddr = _FALSE; - -#ifdef CONFIG_RTL8712 - /* endian_convert */ - pnetwork->join_res = le32_to_cpu(pnetwork->join_res); - pnetwork->network_type = le32_to_cpu(pnetwork->network_type); - pnetwork->network.Length = le32_to_cpu(pnetwork->network.Length); - pnetwork->network.Ssid.SsidLength = le32_to_cpu(pnetwork->network.Ssid.SsidLength); - pnetwork->network.Privacy = le32_to_cpu(pnetwork->network.Privacy); - pnetwork->network.Rssi = le32_to_cpu(pnetwork->network.Rssi); - pnetwork->network.NetworkTypeInUse = le32_to_cpu(pnetwork->network.NetworkTypeInUse) ; - pnetwork->network.Configuration.ATIMWindow = le32_to_cpu(pnetwork->network.Configuration.ATIMWindow); - pnetwork->network.Configuration.BeaconPeriod = le32_to_cpu(pnetwork->network.Configuration.BeaconPeriod); - pnetwork->network.Configuration.DSConfig = le32_to_cpu(pnetwork->network.Configuration.DSConfig); - pnetwork->network.Configuration.FHConfig.DwellTime = le32_to_cpu(pnetwork->network.Configuration.FHConfig.DwellTime); - pnetwork->network.Configuration.FHConfig.HopPattern = le32_to_cpu(pnetwork->network.Configuration.FHConfig.HopPattern); - pnetwork->network.Configuration.FHConfig.HopSet = le32_to_cpu(pnetwork->network.Configuration.FHConfig.HopSet); - pnetwork->network.Configuration.FHConfig.Length = le32_to_cpu(pnetwork->network.Configuration.FHConfig.Length); - pnetwork->network.Configuration.Length = le32_to_cpu(pnetwork->network.Configuration.Length); - pnetwork->network.InfrastructureMode = le32_to_cpu(pnetwork->network.InfrastructureMode); - pnetwork->network.IELength = le32_to_cpu(pnetwork->network.IELength); -#endif - - rtw_get_encrypt_decrypt_from_registrypriv(adapter); - - the_same_macaddr = _rtw_memcmp(pnetwork->network.MacAddress, cur_network->network.MacAddress, ETH_ALEN); pnetwork->network.Length = get_WLAN_BSSID_EX_sz(&pnetwork->network); - if (pnetwork->network.Length > sizeof(WLAN_BSSID_EX)) { - goto ignore_joinbss_callback; - } + if (pnetwork->network.Length > sizeof(WLAN_BSSID_EX)) + goto exit; _enter_critical_bh(&pmlmepriv->lock, &irqL); @@ -1987,9 +2174,9 @@ void rtw_joinbss_event_prehandle(_adapter *adapter, u8 *pbuf) /* s1. find ptarget_wlan */ if (check_fwstate(pmlmepriv, _FW_LINKED)) { if (the_same_macaddr == _TRUE) - ptarget_wlan = rtw_find_network(&pmlmepriv->scanned_queue, cur_network->network.MacAddress); + ptarget_wlan = _rtw_find_network(&pmlmepriv->scanned_queue, cur_network->network.MacAddress); else { - pcur_wlan = rtw_find_network(&pmlmepriv->scanned_queue, cur_network->network.MacAddress); + pcur_wlan = _rtw_find_network(&pmlmepriv->scanned_queue, cur_network->network.MacAddress); if (pcur_wlan) pcur_wlan->fixed = _FALSE; @@ -2000,7 +2187,7 @@ void rtw_joinbss_event_prehandle(_adapter *adapter, u8 *pbuf) /* _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL2); */ } - ptarget_wlan = rtw_find_network(&pmlmepriv->scanned_queue, pnetwork->network.MacAddress); + ptarget_wlan = _rtw_find_network(&pmlmepriv->scanned_queue, pnetwork->network.MacAddress); if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) { if (ptarget_wlan) ptarget_wlan->fixed = _TRUE; @@ -2033,6 +2220,10 @@ void rtw_joinbss_event_prehandle(_adapter *adapter, u8 *pbuf) _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); goto ignore_joinbss_callback; } + + /* Queue TX packets before FW/HW ready */ + /* clear in mlmeext_joinbss_event_callback() */ + rtw_xmit_queue_set(ptarget_sta); } /* s4. indicate connect */ @@ -2042,7 +2233,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 { @@ -2054,9 +2245,10 @@ void rtw_joinbss_event_prehandle(_adapter *adapter, u8 *pbuf) } else if (pnetwork->join_res == -4) { rtw_reset_securitypriv(adapter); + pmlmepriv->join_status = status; _set_timer(&pmlmepriv->assoc_timer, 1); - /* rtw_free_assoc_resources(adapter, 1); */ + /* rtw_free_assoc_resources(adapter, _TRUE); */ if ((check_fwstate(pmlmepriv, _FW_UNDER_LINKING)) == _TRUE) { _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); @@ -2079,9 +2271,9 @@ void rtw_joinbss_event_prehandle(_adapter *adapter, u8 *pbuf) rtw_indicate_connect(adapter); } else { #endif - + pmlmepriv->join_status = status; _set_timer(&pmlmepriv->assoc_timer, 1); - /* rtw_free_assoc_resources(adapter, 1); */ + /* rtw_free_assoc_resources(adapter, _TRUE); */ _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); #ifdef REJOIN @@ -2092,6 +2284,9 @@ void rtw_joinbss_event_prehandle(_adapter *adapter, u8 *pbuf) ignore_joinbss_callback: _exit_critical_bh(&pmlmepriv->lock, &irqL); + +exit: + return; } void rtw_joinbss_event_callback(_adapter *adapter, u8 *pbuf) @@ -2119,21 +2314,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 +2337,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 +2439,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; @@ -2250,35 +2447,39 @@ void rtw_stassoc_event_callback(_adapter *adapter, u8 *pbuf) rtw_sta_media_status_rpt(adapter, psta, 1); -#ifndef CONFIG_AUTO_AP_MODE +#ifdef CONFIG_MCC_MODE + rtw_hal_mcc_update_macid_bitmap(adapter, psta->cmn.mac_id, _TRUE); +#endif /* CONFIG_MCC_MODE */ +#ifndef CONFIG_AUTO_AP_MODE ap_sta_info_defer_update(adapter, psta); - /* report to upper layer */ - RTW_INFO("indicate_sta_assoc_event to upper layer - hostapd\n"); -#ifdef CONFIG_IOCTL_CFG80211 - _enter_critical_bh(&psta->lock, &irqL); - if (psta->passoc_req && psta->assoc_req_len > 0) { - passoc_req = rtw_zmalloc(psta->assoc_req_len); - if (passoc_req) { - assoc_req_len = psta->assoc_req_len; - _rtw_memcpy(passoc_req, psta->passoc_req, assoc_req_len); + if (!MLME_IS_MESH(adapter)) { + /* report to upper layer */ + RTW_INFO("indicate_sta_assoc_event to upper layer - hostapd\n"); + #ifdef CONFIG_IOCTL_CFG80211 + _enter_critical_bh(&psta->lock, &irqL); + if (psta->passoc_req && psta->assoc_req_len > 0) { + passoc_req = rtw_zmalloc(psta->assoc_req_len); + if (passoc_req) { + assoc_req_len = psta->assoc_req_len; + _rtw_memcpy(passoc_req, psta->passoc_req, assoc_req_len); - rtw_mfree(psta->passoc_req , psta->assoc_req_len); - psta->passoc_req = NULL; - psta->assoc_req_len = 0; + rtw_mfree(psta->passoc_req , psta->assoc_req_len); + psta->passoc_req = NULL; + psta->assoc_req_len = 0; + } } - } - _exit_critical_bh(&psta->lock, &irqL); + _exit_critical_bh(&psta->lock, &irqL); - if (passoc_req && assoc_req_len > 0) { - rtw_cfg80211_indicate_sta_assoc(adapter, passoc_req, assoc_req_len); - - rtw_mfree(passoc_req, assoc_req_len); + if (passoc_req && assoc_req_len > 0) { + rtw_cfg80211_indicate_sta_assoc(adapter, passoc_req, assoc_req_len); + rtw_mfree(passoc_req, assoc_req_len); + } + #else /* !CONFIG_IOCTL_CFG80211 */ + rtw_indicate_sta_assoc_event(adapter, psta); + #endif /* !CONFIG_IOCTL_CFG80211 */ } -#else /* !CONFIG_IOCTL_CFG80211 */ - rtw_indicate_sta_assoc_event(adapter, psta); -#endif /* !CONFIG_IOCTL_CFG80211 */ #endif /* !CONFIG_AUTO_AP_MODE */ #ifdef CONFIG_BEAMFORMING @@ -2300,8 +2501,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) @@ -2316,7 +2515,7 @@ void rtw_stassoc_event_callback(_adapter *adapter, u8 *pbuf) (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE)) { if (adapter->stapriv.asoc_sta_count == 2) { _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); - ptarget_wlan = rtw_find_network(&pmlmepriv->scanned_queue, cur_network->network.MacAddress); + ptarget_wlan = _rtw_find_network(&pmlmepriv->scanned_queue, cur_network->network.MacAddress); pmlmepriv->cur_network_scanned = ptarget_wlan; if (ptarget_wlan) ptarget_wlan->fixed = _TRUE; @@ -2337,6 +2536,9 @@ void rtw_stassoc_event_callback(_adapter *adapter, u8 *pbuf) #endif exit: +#ifdef CONFIG_RTS_FULL_BW + rtw_set_rts_bw(adapter); +#endif/*CONFIG_RTS_FULL_BW*/ return; } @@ -2371,7 +2573,46 @@ void rtw_sta_timeout_event_callback(_adapter *adapter, u8 *pbuf) #endif /* CONFIG_IEEE80211W */ #ifdef CONFIG_RTW_80211R -void rtw_update_ft_stainfo(_adapter *padapter, WLAN_BSSID_EX *pnetwork) +void rtw_ft_info_init(struct ft_roam_info *pft) +{ + _rtw_memset(pft, 0, sizeof(struct ft_roam_info)); + pft->ft_flags = 0 + | RTW_FT_EN + | RTW_FT_OTD_EN +#ifdef CONFIG_RTW_BTM_ROAM + | RTW_FT_BTM_ROAM +#endif + ; + pft->ft_updated_bcn = _FALSE; +} + +u8 rtw_ft_chk_roaming_candidate( + _adapter *padapter, struct wlan_network *competitor) +{ + u8 *pmdie; + u32 mdie_len = 0; + struct ft_roam_info *pft_roam = &(padapter->mlmepriv.ft_roam); + + if (!(pmdie = rtw_get_ie(&competitor->network.IEs[12], + _MDIE_, &mdie_len, competitor->network.IELength-12))) + return _FALSE; + + if (!_rtw_memcmp(&pft_roam->mdid, (pmdie+2), 2)) + return _FALSE; + + /*The candidate don't support over-the-DS*/ + if (rtw_ft_valid_otd_candidate(padapter, pmdie)) { + RTW_INFO("FT: ignore the candidate(" + MAC_FMT ") for over-the-DS\n", + MAC_ARG(competitor->network.MacAddress)); + rtw_ft_clr_flags(padapter, RTW_FT_PEER_OTD_EN); + return _FALSE; + } + + return _TRUE; +} + +void rtw_ft_update_stainfo(_adapter *padapter, WLAN_BSSID_EX *pnetwork) { struct sta_priv *pstapriv = &padapter->stapriv; struct sta_info *psta = NULL; @@ -2388,37 +2629,31 @@ void rtw_update_ft_stainfo(_adapter *padapter, WLAN_BSSID_EX *pnetwork) psta->ieee8021x_blocked = _TRUE; psta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm; - psta->dot11txpn.val = psta->dot11txpn.val + 1; _rtw_memset((u8 *)&psta->dot118021x_UncstKey, 0, sizeof(union Keytype)); _rtw_memset((u8 *)&psta->dot11tkiprxmickey, 0, sizeof(union Keytype)); _rtw_memset((u8 *)&psta->dot11tkiptxmickey, 0, sizeof(union Keytype)); - _rtw_memset((u8 *)&psta->dot11txpn, 0, sizeof(union pn48)); -#ifdef CONFIG_IEEE80211W - _rtw_memset((u8 *)&psta->dot11wtxpn, 0, sizeof(union pn48)); -#endif - _rtw_memset((u8 *)&psta->dot11rxpn, 0, sizeof(union pn48)); } } void rtw_ft_reassoc_event_callback(_adapter *padapter, u8 *pbuf) { - struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); - struct stassoc_event *pstassoc = (struct stassoc_event *)pbuf; - ft_priv *pftpriv = &pmlmepriv->ftpriv; - struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); - WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)(&(pmlmeinfo->network)); + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct stassoc_event *pstassoc = (struct stassoc_event *)pbuf; + struct ft_roam_info *pft_roam = &(pmlmepriv->ft_roam); + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)&(pmlmeinfo->network); struct cfg80211_ft_event_params ft_evt_parms; _irqL irqL; _rtw_memset(&ft_evt_parms, 0, sizeof(ft_evt_parms)); - rtw_update_ft_stainfo(padapter, pnetwork); - ft_evt_parms.ies_len = pftpriv->ft_event.ies_len; + rtw_ft_update_stainfo(padapter, pnetwork); + ft_evt_parms.ies_len = pft_roam->ft_event.ies_len; ft_evt_parms.ies = rtw_zmalloc(ft_evt_parms.ies_len); if (ft_evt_parms.ies) - _rtw_memcpy((void *)ft_evt_parms.ies, pftpriv->ft_event.ies, ft_evt_parms.ies_len); + _rtw_memcpy((void *)ft_evt_parms.ies, pft_roam->ft_event.ies, ft_evt_parms.ies_len); else goto err_2; @@ -2428,17 +2663,14 @@ void rtw_ft_reassoc_event_callback(_adapter *padapter, u8 *pbuf) else goto err_1; - ft_evt_parms.ric_ies = pftpriv->ft_event.ric_ies; - ft_evt_parms.ric_ies_len = pftpriv->ft_event.ric_ies_len; - - _enter_critical_bh(&pmlmepriv->lock, &irqL); - rtw_set_ft_status(padapter, RTW_FT_AUTHENTICATED_STA); - _exit_critical_bh(&pmlmepriv->lock, &irqL); + ft_evt_parms.ric_ies = pft_roam->ft_event.ric_ies; + ft_evt_parms.ric_ies_len = pft_roam->ft_event.ric_ies_len; + rtw_ft_lock_set_status(padapter, RTW_FT_AUTHENTICATED_STA, &irqL); rtw_cfg80211_ft_event(padapter, &ft_evt_parms); RTW_INFO("%s: to "MAC_FMT"\n", __func__, MAC_ARG(ft_evt_parms.target_ap)); - rtw_mfree((u8 *)pftpriv->ft_event.target_ap, ETH_ALEN); + rtw_mfree((u8 *)pft_roam->ft_event.target_ap, ETH_ALEN); err_1: rtw_mfree((u8 *)ft_evt_parms.ies, ft_evt_parms.ies_len); err_2: @@ -2446,23 +2678,100 @@ void rtw_ft_reassoc_event_callback(_adapter *padapter, u8 *pbuf) } #endif +#if defined(CONFIG_RTW_WNM) || defined(CONFIG_RTW_80211K) +void rtw_roam_nb_info_init(_adapter *padapter) +{ + struct roam_nb_info *pnb = &(padapter->mlmepriv.nb_info); + + _rtw_memset(&pnb->nb_rpt, 0, sizeof(pnb->nb_rpt)); + _rtw_memset(&pnb->nb_rpt_ch_list, 0, sizeof(pnb->nb_rpt_ch_list)); + _rtw_memset(&pnb->roam_target_addr, 0, ETH_ALEN); + pnb->nb_rpt_valid = _FALSE; + pnb->nb_rpt_ch_list_num = 0; + pnb->preference_en = _FALSE; + pnb->nb_rpt_is_same = _TRUE; + pnb->last_nb_rpt_entries = 0; +#ifdef CONFIG_RTW_WNM + rtw_init_timer(&pnb->roam_scan_timer, + padapter, rtw_wnm_roam_scan_hdl, + padapter); +#endif +} + +u8 rtw_roam_nb_scan_list_set( + _adapter *padapter, struct sitesurvey_parm *pparm) +{ + u8 ret = _FALSE; + u32 i; + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct roam_nb_info *pnb = &(pmlmepriv->nb_info); + + if (!rtw_chk_roam_flags(padapter, RTW_ROAM_ACTIVE)) + return ret; + + if (!pmlmepriv->need_to_roam) + return ret; + + if ((!pmlmepriv->nb_info.nb_rpt_valid) || (!pnb->nb_rpt_ch_list_num)) + return ret; + + if (!pparm) + return ret; + + rtw_init_sitesurvey_parm(padapter, pparm); + if (rtw_roam_busy_scan(padapter, pnb)) { + pparm->ch_num = 1; + pparm->ch[pmlmepriv->ch_cnt].hw_value = + pnb->nb_rpt_ch_list[pmlmepriv->ch_cnt].hw_value; + pmlmepriv->ch_cnt++; + ret = _TRUE; + if (pmlmepriv->ch_cnt == pnb->nb_rpt_ch_list_num) { + pmlmepriv->nb_info.nb_rpt_valid = _FALSE; + pmlmepriv->ch_cnt = 0; + } + goto set_bssid_list; + } + + pparm->ch_num = (pnb->nb_rpt_ch_list_num > RTW_CHANNEL_SCAN_AMOUNT)? + (RTW_CHANNEL_SCAN_AMOUNT):(pnb->nb_rpt_ch_list_num); + for (i=0; ich_num; i++) { + pparm->ch[i].hw_value = pnb->nb_rpt_ch_list[i].hw_value; + pparm->ch[i].flags = RTW_IEEE80211_CHAN_PASSIVE_SCAN; + } + + pmlmepriv->nb_info.nb_rpt_valid = _FALSE; + pmlmepriv->ch_cnt = 0; + ret = _TRUE; + +set_bssid_list: + rtw_set_802_11_bssid_list_scan(padapter, pparm); + return ret; +} +#endif + 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_macid_drop(adapter, mac_id); + 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,10 +2784,10 @@ 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)) { + 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); @@ -2496,15 +2805,15 @@ void rtw_stadel_event_callback(_adapter *adapter, u8 *pbuf) u8 *pibss = NULL; struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); struct stadel_event *pstadel = (struct stadel_event *)pbuf; - struct sta_priv *pstapriv = &adapter->stapriv; struct wlan_network *tgt_network = &(pmlmepriv->cur_network); - struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); - RTW_INFO("%s(mac_id=%d)=" MAC_FMT "\n", __func__, pstadel->mac_id, MAC_ARG(pstadel->macaddr)); rtw_sta_mstatus_disc_rpt(adapter, pstadel->mac_id); +#ifdef CONFIG_MCC_MODE + rtw_hal_mcc_update_macid_bitmap(adapter, pstadel->mac_id, _FALSE); +#endif /* CONFIG_MCC_MODE */ + psta = rtw_get_stainfo(&adapter->stapriv, pstadel->macaddr); if (psta == NULL) { @@ -2515,8 +2824,12 @@ 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_MESH(adapter)) { + rtw_free_stainfo(adapter, psta); + goto exit; + } + + if (MLME_IS_AP(adapter)) { #ifdef CONFIG_IOCTL_CFG80211 #ifdef COMPAT_KERNEL_RELEASE @@ -2525,7 +2838,9 @@ void rtw_stadel_event_callback(_adapter *adapter, u8 *pbuf) #endif /* (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 37)) || defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) */ #endif /* CONFIG_IOCTL_CFG80211 */ - return; + rtw_free_stainfo(adapter, psta); + + goto exit; } mlmeext_sta_del_event_callback(adapter); @@ -2539,10 +2854,10 @@ void rtw_stadel_event_callback(_adapter *adapter, u8 *pbuf) #ifdef CONFIG_LAYER2_ROAMING #ifdef CONFIG_RTW_80211R - if (reason == WLAN_REASON_EXPIRATION_CHK && rtw_chk_roam_flags(adapter, RTW_ROAM_ON_EXPIRED)) - pmlmepriv->ftpriv.ft_roam_on_expired = _TRUE; + if (rtw_ft_roam_expired(adapter, reason)) + pmlmepriv->ft_roam.ft_roam_on_expired = _TRUE; else - pmlmepriv->ftpriv.ft_roam_on_expired = _FALSE; + pmlmepriv->ft_roam.ft_roam_on_expired = _FALSE; #endif if (adapter->registrypriv.wifi_spec == 1) roam = _FALSE; @@ -2552,11 +2867,6 @@ void rtw_stadel_event_callback(_adapter *adapter, u8 *pbuf) roam = _TRUE; roam_target = pmlmepriv->roam_network; } -#ifdef CONFIG_INTEL_WIDI - else if (adapter->mlmepriv.widi_state == INTEL_WIDI_STATE_CONNECTED) - roam = _TRUE; -#endif /* CONFIG_INTEL_WIDI */ - if (roam == _TRUE) { if (rtw_to_roam(adapter) > 0) rtw_dec_to_roam(adapter); /* this stadel_event is caused by roaming, decrease to_roam */ @@ -2568,23 +2878,10 @@ void rtw_stadel_event_callback(_adapter *adapter, u8 *pbuf) rtw_free_uc_swdec_pending_queue(adapter); - rtw_free_assoc_resources(adapter, 1); + rtw_free_assoc_resources(adapter, _TRUE); rtw_free_mlme_priv_ie_data(pmlmepriv); - _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); - /* remove the network entry in scanned_queue */ - pwlan = rtw_find_network(&pmlmepriv->scanned_queue, tgt_network->network.MacAddress); - if ((pwlan) && (!check_fwstate(pmlmepriv, WIFI_UNDER_WPS))) { - pwlan->fixed = _FALSE; - rtw_free_network_nolock(adapter, pwlan); - } - _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); - rtw_indicate_disconnect(adapter, *(u16 *)pstadel->rsvd, pstadel->locally_generated); -#ifdef CONFIG_INTEL_WIDI - if (!rtw_to_roam(adapter)) - process_intel_widi_disconnect(adapter, 1); -#endif /* CONFIG_INTEL_WIDI */ _rtw_roaming(adapter, roam_target); } @@ -2600,8 +2897,8 @@ void rtw_stadel_event_callback(_adapter *adapter, u8 *pbuf) /* rtw_indicate_disconnect(adapter); */ /* removed@20091105 */ _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); /* free old ibss network */ - /* pwlan = rtw_find_network(&pmlmepriv->scanned_queue, pstadel->macaddr); */ - pwlan = rtw_find_network(&pmlmepriv->scanned_queue, tgt_network->network.MacAddress); + /* pwlan = _rtw_find_network(&pmlmepriv->scanned_queue, pstadel->macaddr); */ + pwlan = _rtw_find_network(&pmlmepriv->scanned_queue, tgt_network->network.MacAddress); if (pwlan) { pwlan->fixed = _FALSE; rtw_free_network_nolock(adapter, pwlan); @@ -2633,8 +2930,11 @@ void rtw_stadel_event_callback(_adapter *adapter, u8 *pbuf) } _exit_critical_bh(&pmlmepriv->lock, &irqL2); - - +exit: + #ifdef CONFIG_RTS_FULL_BW + rtw_set_rts_bw(adapter); + #endif/*CONFIG_RTS_FULL_BW*/ + return; } @@ -2664,11 +2964,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; @@ -2703,19 +3003,12 @@ void _rtw_join_timeout_handler(_adapter *adapter) } break; } else { -#ifdef CONFIG_INTEL_WIDI - if (adapter->mlmepriv.widi_state == INTEL_WIDI_STATE_ROAMING) { - _rtw_memset(pmlmepriv->sa_ext, 0x00, L2SDTA_SERVICE_VE_LEN); - intel_widi_wk_cmd(adapter, INTEL_WIDI_LISTEN_WK, NULL, 0); - RTW_INFO("change to widi listen\n"); - } -#endif /* CONFIG_INTEL_WIDI */ RTW_INFO("%s We've try roaming but fail\n", __FUNCTION__); #ifdef CONFIG_RTW_80211R - rtw_clr_ft_flags(adapter, RTW_FT_SUPPORTED|RTW_FT_OVER_DS_SUPPORTED); - rtw_reset_ft_status(adapter); + rtw_ft_clr_flags(adapter, RTW_FT_PEER_EN|RTW_FT_PEER_OTD_EN); + rtw_ft_reset_status(adapter); #endif - rtw_indicate_disconnect(adapter, 0, _FALSE); + rtw_indicate_disconnect(adapter, pmlmepriv->join_status, _FALSE); break; } } @@ -2723,16 +3016,18 @@ void _rtw_join_timeout_handler(_adapter *adapter) } else #endif { - rtw_indicate_disconnect(adapter, 0, _FALSE); + rtw_indicate_disconnect(adapter, pmlmepriv->join_status, _FALSE); free_scanqueue(pmlmepriv);/* ??? */ #ifdef CONFIG_IOCTL_CFG80211 /* indicate disconnect for the case that join_timeout and check_fwstate != FW_LINKED */ - rtw_cfg80211_indicate_disconnect(adapter, 0, _FALSE); + rtw_cfg80211_indicate_disconnect(adapter, pmlmepriv->join_status, _FALSE); #endif /* CONFIG_IOCTL_CFG80211 */ } + pmlmepriv->join_status = 0; /* reset */ + _exit_critical_bh(&pmlmepriv->lock, &irqL); @@ -2748,8 +3043,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)); @@ -2773,9 +3069,11 @@ void rtw_scan_timeout_handler(_adapter *adapter) void rtw_mlme_reset_auto_scan_int(_adapter *adapter, u8 *reason) { - struct mlme_priv *mlme = &adapter->mlmepriv; - struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); +#if defined(CONFIG_RTW_MESH) && defined(CONFIG_DFS_MASTER) +#if CONFIG_RTW_MESH_OFFCH_CAND + struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); +#endif +#endif u8 u_ch; u32 interval_ms = 0xffffffff; /* 0xffffffff: special value to make min() works well, also means no auto scan */ @@ -2783,16 +3081,29 @@ void rtw_mlme_reset_auto_scan_int(_adapter *adapter, u8 *reason) rtw_mi_get_ch_setting_union(adapter, &u_ch, NULL, NULL); if (hal_chk_bw_cap(adapter, BW_CAP_40M) - && is_client_associated_to_ap(adapter) == _TRUE - && u_ch >= 1 && u_ch <= 14 - && adapter->registrypriv.wifi_spec - /* TODO: AP Connected is 40MHz capability? */ - ) { + && is_client_associated_to_ap(adapter) == _TRUE + && u_ch >= 1 && u_ch <= 14 + && adapter->registrypriv.wifi_spec + /* TODO: AP Connected is 40MHz capability? */ + ) { interval_ms = rtw_min(interval_ms, 60 * 1000); *reason |= RTW_AUTO_SCAN_REASON_2040_BSS; } -exit: +#ifdef CONFIG_RTW_MESH + #if CONFIG_RTW_MESH_OFFCH_CAND + if (adapter->mesh_cfg.peer_sel_policy.offch_find_int_ms + && rtw_mesh_offch_candidate_accepted(adapter) + #ifdef CONFIG_DFS_MASTER + && (!rfctl->radar_detect_ch || (IS_CH_WAITING(rfctl) && !IS_UNDER_CAC(rfctl))) + #endif + ) { + interval_ms = rtw_min(interval_ms, adapter->mesh_cfg.peer_sel_policy.offch_find_int_ms); + *reason |= RTW_AUTO_SCAN_REASON_MESH_OFFCH_CAND; + } + #endif +#endif /* CONFIG_RTW_MESH */ + if (interval_ms == 0xffffffff) interval_ms = 0; @@ -2802,26 +3113,28 @@ 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 1 + u8 ssc_chk; + ssc_chk = rtw_sitesurvey_condition_check(padapter, _FALSE); + if( ssc_chk == SS_DENY_BUSY_TRAFFIC) { + #ifdef CONFIG_LAYER2_ROAMING + if (rtw_chk_roam_flags(padapter, RTW_ROAM_ACTIVE) && pmlmepriv->need_to_roam == _TRUE) + RTW_INFO(FUNC_ADPT_FMT" need to roam, don't care BusyTraffic\n", FUNC_ADPT_ARG(padapter)); + else + #endif + RTW_INFO(FUNC_ADPT_FMT" exit BusyTraffic\n", FUNC_ADPT_ARG(padapter)); + goto exit; + } + else if (ssc_chk != SS_ALLOW) + goto exit; + + if (!rtw_is_adapter_up(padapter)) + goto exit; +#else if (rtw_is_scan_deny(padapter)) goto exit; @@ -2853,17 +3166,30 @@ void rtw_drv_scan_by_self(_adapter *padapter, u8 reason) RTW_INFO(FUNC_ADPT_FMT", but buddy_intf is under scanning or linking or wps_phase\n", FUNC_ADPT_ARG(padapter)); goto exit; } +#endif #endif RTW_INFO(FUNC_ADPT_FMT" reason:0x%02x\n", FUNC_ADPT_ARG(padapter), 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); +#if defined(CONFIG_RTW_WNM) || defined(CONFIG_RTW_80211K) + if ((reason == RTW_AUTO_SCAN_REASON_ROAM) + && (rtw_roam_nb_scan_list_set(padapter, &parm))) + goto exit; +#endif + + rtw_set_802_11_bssid_list_scan(padapter, NULL); exit: return; } @@ -2924,10 +3250,10 @@ void rtw_iface_dynamic_check_timer_handlder(_adapter *adapter) bEnterPS = traffic_status_watchdog(adapter, 1); if (bEnterPS) { - /* rtw_lps_ctrl_wk_cmd(adapter, LPS_CTRL_ENTER, 1); */ + /* rtw_lps_ctrl_wk_cmd(adapter, LPS_CTRL_ENTER, 0); */ rtw_hal_dm_watchdog_in_lps(adapter); } else { - /* call rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE, 1) in traffic_status_watchdog() */ + /* call rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE, 0) in traffic_status_watchdog() */ } } #endif /* CONFIG_LPS_LCLK_WD_TIMER */ @@ -2935,12 +3261,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 @@ -2973,6 +3305,70 @@ 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; + u64 curr_tx_bytes = 0, curr_rx_bytes = 0; + u32 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_bytes = sta->sta_stats.tx_bytes - sta->sta_stats.last_tx_bytes; + curr_rx_bytes = sta->sta_stats.rx_bytes - sta->sta_stats.last_rx_bytes; + sta->sta_stats.tx_tp_kbits = (curr_tx_bytes * 8 / 2) >> 10;/*Kbps*/ + sta->sta_stats.rx_tp_kbits = (curr_rx_bytes * 8 / 2) >> 10;/*Kbps*/ + + sta->sta_stats.smooth_tx_tp_kbits = (sta->sta_stats.smooth_tx_tp_kbits * 6 / 10) + (sta->sta_stats.tx_tp_kbits * 4 / 10);/*Kbps*/ + sta->sta_stats.smooth_rx_tp_kbits = (sta->sta_stats.smooth_rx_tp_kbits * 6 / 10) + (sta->sta_stats.rx_tp_kbits * 4 / 10);/*Kbps*/ + + curr_tx_mbytes = (curr_tx_bytes / 2) >> 20;/*MBps*/ + curr_rx_mbytes = (curr_rx_bytes / 2) >> 20;/*MBps*/ + + sta->cmn.tx_moving_average_tp = + (sta->cmn.tx_moving_average_tp / 10) + (curr_tx_mbytes * 9 / 10); /*MBps*/ + + sta->cmn.rx_moving_average_tp = + (sta->cmn.rx_moving_average_tp / 10) + (curr_rx_mbytes * 9 /10); /*MBps*/ + + rtw_collect_bcn_info(sta->padapter); + + 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) { @@ -2998,8 +3394,8 @@ static void collect_traffic_statistics(_adapter *padapter) pdvobjpriv->traffic_stat.last_tx_bytes = pdvobjpriv->traffic_stat.tx_bytes; pdvobjpriv->traffic_stat.last_rx_bytes = pdvobjpriv->traffic_stat.rx_bytes; - pdvobjpriv->traffic_stat.cur_tx_tp = (u32)(pdvobjpriv->traffic_stat.cur_tx_bytes * 8 / 2 / 1024 / 1024); - pdvobjpriv->traffic_stat.cur_rx_tp = (u32)(pdvobjpriv->traffic_stat.cur_rx_bytes * 8 / 2 / 1024 / 1024); + pdvobjpriv->traffic_stat.cur_tx_tp = (u32)(pdvobjpriv->traffic_stat.cur_tx_bytes * 8 / 2 / 1024 / 1024);/*Mbps*/ + pdvobjpriv->traffic_stat.cur_rx_tp = (u32)(pdvobjpriv->traffic_stat.cur_rx_bytes * 8 / 2 / 1024 / 1024);/*Mbps*/ #ifdef DBG_TRAFFIC_STATISTIC RTW_INFO("\n========================\n"); @@ -3009,28 +3405,48 @@ static void collect_traffic_statistics(_adapter *padapter) RTW_INFO("last_tx_bytes:%lld\n", pdvobjpriv->traffic_stat.last_tx_bytes); RTW_INFO("last_rx_bytes:%lld\n", pdvobjpriv->traffic_stat.last_rx_bytes); - RTW_INFO("cur_tx_tp:%d\n", pdvobjpriv->traffic_stat.cur_tx_tp); - RTW_INFO("cur_rx_tp:%d\n", pdvobjpriv->traffic_stat.cur_rx_tp); + RTW_INFO("cur_tx_tp:%d (Mbps)\n", pdvobjpriv->traffic_stat.cur_tx_tp); + RTW_INFO("cur_rx_tp:%d (Mbps)\n", pdvobjpriv->traffic_stat.cur_rx_tp); #endif + +#ifdef CONFIG_RTW_NAPI +#ifdef CONFIG_RTW_NAPI_DYNAMIC + dynamic_napi_th_chk (padapter); +#endif /* CONFIG_RTW_NAPI_DYNAMIC */ +#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); } @@ -3049,8 +3465,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) @@ -3074,12 +3492,22 @@ static int rtw_check_roaming_candidate(struct mlme_priv *mlme { int updated = _FALSE; _adapter *adapter = container_of(mlme, _adapter, mlmepriv); -#ifdef CONFIG_RTW_80211R - ft_priv *pftpriv = &mlme->ftpriv; - u32 mdie_len = 0; - u8 *ptmp = NULL; -#endif + struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); + RT_CHANNEL_INFO *chset = rfctl->channel_set; + u8 ch = competitor->network.Configuration.DSConfig; + if (rtw_chset_search_ch(chset, ch) < 0) + goto exit; + if (IS_DFS_SLAVE_WITH_RD(rfctl) + && !rtw_odm_dfs_domain_unknown(rfctl_to_dvobj(rfctl)) + && rtw_chset_is_ch_non_ocp(chset, ch)) + goto exit; + +#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; @@ -3093,23 +3521,9 @@ static int rtw_check_roaming_candidate(struct mlme_priv *mlme #endif #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; + if (rtw_ft_chk_flags(adapter, RTW_FT_PEER_EN)) { + if (rtw_ft_chk_roaming_candidate(adapter, competitor) == _FALSE) + goto exit; } #endif @@ -3130,9 +3544,16 @@ 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 defined(CONFIG_RTW_80211R) && defined(CONFIG_RTW_WNM) + if (rtw_wnm_btm_diff_bss(adapter) && + rtw_wnm_btm_roam_candidate(adapter, competitor)) { + goto update; + } +#endif + if (competitor->network.Rssi - mlme->cur_network_scanned->network.Rssi < mlme->roam_rssi_diff_th) goto exit; @@ -3159,8 +3580,6 @@ int rtw_select_roaming_candidate(struct mlme_priv *mlme) _queue *queue = &(mlme->scanned_queue); struct wlan_network *pnetwork = NULL; struct wlan_network *candidate = NULL; - u8 bSupportAntDiv = _FALSE; - if (mlme->cur_network_scanned == NULL) { rtw_warn_on(1); @@ -3195,14 +3614,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) @@ -3227,7 +3669,35 @@ static int rtw_check_join_candidate(struct mlme_priv *mlme { int updated = _FALSE; _adapter *adapter = container_of(mlme, _adapter, mlmepriv); + struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); + RT_CHANNEL_INFO *chset = rfctl->channel_set; + u8 ch = competitor->network.Configuration.DSConfig; + if (rtw_chset_search_ch(chset, ch) < 0) + goto exit; + if (IS_DFS_SLAVE_WITH_RD(rfctl) + && !rtw_odm_dfs_domain_unknown(rfctl_to_dvobj(rfctl)) + && rtw_chset_is_ch_non_ocp(chset, ch)) + 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) { @@ -3248,7 +3718,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; @@ -3297,8 +3767,9 @@ int rtw_select_and_join_from_scanned_queue(struct mlme_priv *pmlmepriv) _queue *queue = &(pmlmepriv->scanned_queue); struct wlan_network *pnetwork = NULL; struct wlan_network *candidate = NULL; +#ifdef CONFIG_ANTENNA_DIVERSITY u8 bSupportAntDiv = _FALSE; - +#endif adapter = (_adapter *)pmlmepriv->nic_hdl; @@ -3367,9 +3838,9 @@ 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); + rtw_free_assoc_resources_cmd(adapter, _TRUE, 0); } } @@ -3444,7 +3915,6 @@ sint rtw_set_key(_adapter *adapter, struct security_priv *psecuritypriv, sint ke struct cmd_obj *pcmd; struct setkey_parm *psetkeyparm; struct cmd_priv *pcmdpriv = &(adapter->cmdpriv); - struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); sint res = _SUCCESS; @@ -3481,12 +3951,10 @@ sint rtw_set_key(_adapter *adapter, struct security_priv *psecuritypriv, sint ke case _TKIP_: keylen = 16; _rtw_memcpy(&psetkeyparm->key, &psecuritypriv->dot118021XGrpKey[keyid], keylen); - psetkeyparm->grpkey = 1; break; case _AES_: keylen = 16; _rtw_memcpy(&psetkeyparm->key, &psecuritypriv->dot118021XGrpKey[keyid], keylen); - psetkeyparm->grpkey = 1; break; default: res = _FAIL; @@ -3523,12 +3991,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) { @@ -3551,7 +4118,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; } @@ -3601,108 +4203,95 @@ static int SecIsInPMKIDList(_adapter *Adapter, u8 *bssid) } -/* - * Check the RSN IE length - * If the RSN IE length <= 20, the RSN IE didn't include the PMKID information - * 0-11th element in the array are the fixed IE - * 12th element in the array is the IE - * 13th element in the array is the IE length - * */ - -static int rtw_append_pmkid(_adapter *adapter, int iEntry, u8 *ie, uint ie_len) +int rtw_cached_pmkid(_adapter *Adapter, u8 *bssid) { - struct security_priv *sec = &adapter->securitypriv; - - if (ie[13] > 20) { - int i; - u16 pmkid_cnt = RTW_GET_LE16(ie + 14 + 20); - if (pmkid_cnt == 1 && _rtw_memcmp(ie + 14 + 20 + 2, &sec->PMKIDList[iEntry].PMKID, 16)) { - RTW_INFO(FUNC_ADPT_FMT" has carried the same PMKID:"KEY_FMT"\n" - , FUNC_ADPT_ARG(adapter), KEY_ARG(&sec->PMKIDList[iEntry].PMKID)); - goto exit; - } - - RTW_INFO(FUNC_ADPT_FMT" remove original PMKID, count:%u\n" - , FUNC_ADPT_ARG(adapter), pmkid_cnt); - - for (i = 0; i < pmkid_cnt; i++) - RTW_INFO(" "KEY_FMT"\n", KEY_ARG(ie + 14 + 20 + 2 + i * 16)); - - ie_len -= 2 + pmkid_cnt * 16; - ie[13] = 20; - } - - if (ie[13] <= 20) { - /* The RSN IE didn't include the PMK ID, append the PMK information */ - - RTW_INFO(FUNC_ADPT_FMT" append PMKID:"KEY_FMT"\n" - , FUNC_ADPT_ARG(adapter), KEY_ARG(&sec->PMKIDList[iEntry].PMKID)); - - RTW_PUT_LE16(&ie[ie_len], 1); - ie_len += 2; - - _rtw_memcpy(&ie[ie_len], &sec->PMKIDList[iEntry].PMKID, 16); - ie_len += 16; - - ie[13] += 18;/* PMKID length = 2+16 */ - } - -exit: - return ie_len; + return SecIsInPMKIDList(Adapter, bssid); } -static int rtw_remove_pmkid(_adapter *adapter, u8 *ie, uint ie_len) +int rtw_rsn_sync_pmkid(_adapter *adapter, u8 *ie, uint ie_len, int i_ent) { struct security_priv *sec = &adapter->securitypriv; + struct rsne_info info; + u8 gm_cs[4]; int i; - u16 pmkid_cnt = RTW_GET_LE16(ie + 14 + 20); - if (ie[13] <= 20) + rtw_rsne_info_parse(ie, ie_len, &info); + + if (info.err) { + RTW_WARN(FUNC_ADPT_FMT" rtw_rsne_info_parse error\n" + , FUNC_ADPT_ARG(adapter)); + return 0; + } + + if (i_ent < 0 && info.pmkid_cnt == 0) goto exit; - RTW_INFO(FUNC_ADPT_FMT" remove original PMKID, count:%u\n" - , FUNC_ADPT_ARG(adapter), pmkid_cnt); + if (i_ent >= 0 && info.pmkid_cnt == 1 && _rtw_memcmp(info.pmkid_list, sec->PMKIDList[i_ent].PMKID, 16)) { + RTW_INFO(FUNC_ADPT_FMT" has carried the same PMKID:"KEY_FMT"\n" + , FUNC_ADPT_ARG(adapter), KEY_ARG(&sec->PMKIDList[i_ent].PMKID)); + goto exit; + } - for (i = 0; i < pmkid_cnt; i++) - RTW_INFO(" "KEY_FMT"\n", KEY_ARG(ie + 14 + 20 + 2 + i * 16)); + /* bakcup group mgmt cs */ + if (info.gmcs) + _rtw_memcpy(gm_cs, info.gmcs, 4); - ie_len -= 2 + pmkid_cnt * 16; - ie[13] = 20; + if (info.pmkid_cnt) { + RTW_INFO(FUNC_ADPT_FMT" remove original PMKID, count:%u\n" + , FUNC_ADPT_ARG(adapter), info.pmkid_cnt); + for (i = 0; i < info.pmkid_cnt; i++) + RTW_INFO(" "KEY_FMT"\n", KEY_ARG(info.pmkid_list + i * 16)); + } + + if (i_ent >= 0) { + RTW_INFO(FUNC_ADPT_FMT" append PMKID:"KEY_FMT"\n" + , FUNC_ADPT_ARG(adapter), KEY_ARG(sec->PMKIDList[i_ent].PMKID)); + + info.pmkid_cnt = 1; /* update new pmkid_cnt */ + _rtw_memcpy(info.pmkid_list, sec->PMKIDList[i_ent].PMKID, 16); + } else + info.pmkid_cnt = 0; /* update new pmkid_cnt */ + + RTW_PUT_LE16(info.pmkid_list - 2, info.pmkid_cnt); + if (info.gmcs) + _rtw_memcpy(info.pmkid_list + 16 * info.pmkid_cnt, gm_cs, 4); + + ie_len = 1 + 1 + 2 + 4 + + 2 + 4 * info.pcs_cnt + + 2 + 4 * info.akm_cnt + + 2 + + 2 + 16 * info.pmkid_cnt + + (info.gmcs ? 4 : 0) + ; + + ie[1] = (u8)(ie_len - 2); exit: return ie_len; } -sint rtw_restruct_sec_ie(_adapter *adapter, u8 *in_ie, u8 *out_ie, uint in_len) +sint rtw_restruct_sec_ie(_adapter *adapter, u8 *out_ie) { - u8 authmode = 0x0, securitytype, match; - u8 sec_ie[255], uncst_oui[4], bkup_ie[255]; - u8 wpa_oui[4] = {0x0, 0x50, 0xf2, 0x01}; - uint ielength, cnt, remove_cnt; + u8 authmode = 0x0; + uint ielength = 0; int iEntry; struct mlme_priv *pmlmepriv = &adapter->mlmepriv; struct security_priv *psecuritypriv = &adapter->securitypriv; uint ndisauthmode = psecuritypriv->ndisauthtype; - uint ndissecuritytype = psecuritypriv->ndisencryptstatus; - - - /* copy fixed ie only */ - _rtw_memcpy(out_ie, in_ie, 12); - ielength = 12; if ((ndisauthmode == Ndis802_11AuthModeWPA) || (ndisauthmode == Ndis802_11AuthModeWPAPSK)) authmode = _WPA_IE_ID_; if ((ndisauthmode == Ndis802_11AuthModeWPA2) || (ndisauthmode == Ndis802_11AuthModeWPA2PSK)) authmode = _WPA2_IE_ID_; if (check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) { - _rtw_memcpy(out_ie + ielength, psecuritypriv->wps_ie, psecuritypriv->wps_ie_len); + _rtw_memcpy(out_ie, psecuritypriv->wps_ie, psecuritypriv->wps_ie_len); + ielength = psecuritypriv->wps_ie_len; - ielength += psecuritypriv->wps_ie_len; } else if ((authmode == _WPA_IE_ID_) || (authmode == _WPA2_IE_ID_)) { /* copy RSN or SSN */ - _rtw_memcpy(&out_ie[ielength], &psecuritypriv->supplicant_ie[0], psecuritypriv->supplicant_ie[1] + 2); + _rtw_memcpy(out_ie, psecuritypriv->supplicant_ie, psecuritypriv->supplicant_ie[1] + 2); /* debug for CONFIG_IEEE80211W { int jj; @@ -3711,24 +4300,15 @@ sint rtw_restruct_sec_ie(_adapter *adapter, u8 *in_ie, u8 *out_ie, uint in_len) printk(" %02x ", psecuritypriv->supplicant_ie[jj]); printk("\n"); }*/ - ielength += psecuritypriv->supplicant_ie[1] + 2; + 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); - if (iEntry < 0) { - if (authmode == _WPA2_IE_ID_) - ielength = rtw_remove_pmkid(adapter, out_ie, ielength); - } else { - if (authmode == _WPA2_IE_ID_) - ielength = rtw_append_pmkid(adapter, iEntry, out_ie, ielength); + if (authmode == WLAN_EID_RSN) { + iEntry = SecIsInPMKIDList(adapter, pmlmepriv->assoc_bssid); + ielength = rtw_rsn_sync_pmkid(adapter, out_ie, ielength, iEntry); } - return ielength; } @@ -3745,13 +4325,6 @@ void rtw_init_registrypriv_dev_network(_adapter *adapter) pdev_network->Configuration.Length = sizeof(NDIS_802_11_CONFIGURATION); pdev_network->Configuration.BeaconPeriod = 100; - pdev_network->Configuration.FHConfig.Length = 0; - pdev_network->Configuration.FHConfig.HopPattern = 0; - pdev_network->Configuration.FHConfig.HopSet = 0; - pdev_network->Configuration.FHConfig.DwellTime = 0; - - - } void rtw_update_registrypriv_dev_network(_adapter *adapter) @@ -3779,32 +4352,6 @@ void rtw_update_registrypriv_dev_network(_adapter *adapter) pdev_network->Rssi = 0; - switch (pregistrypriv->wireless_mode) { - case WIRELESS_11B: - pdev_network->NetworkTypeInUse = (Ndis802_11DS); - break; - case WIRELESS_11G: - case WIRELESS_11BG: - case WIRELESS_11_24N: - case WIRELESS_11G_24N: - case WIRELESS_11BG_24N: - pdev_network->NetworkTypeInUse = (Ndis802_11OFDM24); - break; - case WIRELESS_11A: - case WIRELESS_11A_5N: - pdev_network->NetworkTypeInUse = (Ndis802_11OFDM5); - break; - case WIRELESS_11ABGN: - if (pregistrypriv->channel > 14) - pdev_network->NetworkTypeInUse = (Ndis802_11OFDM5); - else - pdev_network->NetworkTypeInUse = (Ndis802_11OFDM24); - break; - default: - /* TODO */ - break; - } - pdev_network->Configuration.DSConfig = (pregistrypriv->channel); if (cur_network->network.InfrastructureMode == Ndis802_11IBSS) { @@ -3929,15 +4476,23 @@ void rtw_ht_use_default_setting(_adapter *padapter) /* Beamforming setting */ CLEAR_FLAGS(phtpriv->beamform_cap); #ifdef CONFIG_BEAMFORMING - rtw_hal_get_def_var(padapter, HAL_DEF_EXPLICIT_BEAMFORMER, (u8 *)&bHwSupportBeamformer); - rtw_hal_get_def_var(padapter, HAL_DEF_EXPLICIT_BEAMFORMEE, (u8 *)&bHwSupportBeamformee); - if (TEST_FLAG(pregistrypriv->beamform_cap, BIT4) && bHwSupportBeamformer) { - SET_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE); - RTW_INFO("[HT] HAL Support Beamformer\n"); - } - if (TEST_FLAG(pregistrypriv->beamform_cap, BIT5) && bHwSupportBeamformee) { - SET_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE); - RTW_INFO("[HT] HAL Support Beamformee\n"); +#ifdef RTW_BEAMFORMING_VERSION_2 + /* only enable beamforming in STA client mode */ + if (MLME_IS_STA(padapter) && !MLME_IS_GC(padapter) + && !MLME_IS_ADHOC(padapter) + && !MLME_IS_MESH(padapter)) +#endif + { + rtw_hal_get_def_var(padapter, HAL_DEF_EXPLICIT_BEAMFORMER, (u8 *)&bHwSupportBeamformer); + rtw_hal_get_def_var(padapter, HAL_DEF_EXPLICIT_BEAMFORMEE, (u8 *)&bHwSupportBeamformee); + if (TEST_FLAG(pregistrypriv->beamform_cap, BIT4) && bHwSupportBeamformer) { + SET_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE); + RTW_INFO("[HT] HAL Support Beamformer\n"); + } + if (TEST_FLAG(pregistrypriv->beamform_cap, BIT5) && bHwSupportBeamformee) { + SET_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE); + RTW_INFO("[HT] HAL Support Beamformee\n"); + } } #endif /* CONFIG_BEAMFORMING */ } @@ -3955,7 +4510,7 @@ void rtw_build_wmm_ie_ht(_adapter *padapter, u8 *out_ie, uint *pout_len) padapter->mlmepriv.qospriv.qos_option = 1; } } - +#if defined(CONFIG_80211N_HT) /* the fucntion is >= passive_level */ unsigned int rtw_restructure_ht_ie(_adapter *padapter, u8 *in_ie, u8 *out_ie, uint in_len, uint *pout_len, u8 channel) { @@ -3965,12 +4520,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, rx_nss = 0; + u8 cbw40_enable = 0, rf_type = 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; @@ -3983,36 +4542,7 @@ unsigned int rtw_restructure_ht_ie(_adapter *padapter, u8 *in_ie, u8 *out_ie, ui if (phtpriv->sgi_20m) ht_capie.cap_info |= IEEE80211_HT_CAP_SGI_20; - /* Get HT BW */ - if (in_ie == NULL) { - /* TDLS: TODO 20/40 issue */ - if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { - operation_bw = padapter->mlmeextpriv.cur_bwmode; - if (operation_bw > CHANNEL_WIDTH_40) - operation_bw = CHANNEL_WIDTH_40; - } else - /* TDLS: TODO 40? */ - operation_bw = CHANNEL_WIDTH_40; - } else { - p = rtw_get_ie(in_ie, _HT_ADD_INFO_IE_, &ielen, in_len); - if (p && (ielen == sizeof(struct ieee80211_ht_addt_info))) { - struct HT_info_element *pht_info = (struct HT_info_element *)(p + 2); - if (pht_info->infos[0] & BIT(2)) { - switch (pht_info->infos[0] & 0x3) { - case 1: - case 3: - operation_bw = CHANNEL_WIDTH_40; - break; - default: - operation_bw = CHANNEL_WIDTH_20; - break; - } - } else - operation_bw = CHANNEL_WIDTH_20; - } - } - - /* to disable 40M Hz support while gd_bw_40MHz_en = 0 */ + /* check if 40MHz is allowed according to hal cap and registry */ if (hal_chk_bw_cap(padapter, BW_CAP_40M)) { if (channel > 14) { if (REGSTY_IS_BW_5G_SUPPORT(pregistrypriv, CHANNEL_WIDTH_40)) @@ -4023,10 +4553,61 @@ unsigned int rtw_restructure_ht_ie(_adapter *padapter, u8 *in_ie, u8 *out_ie, ui } } - if ((cbw40_enable == 1) && (operation_bw == CHANNEL_WIDTH_40)) { - ht_capie.cap_info |= IEEE80211_HT_CAP_SUP_WIDTH; - if (phtpriv->sgi_40m) - ht_capie.cap_info |= IEEE80211_HT_CAP_SGI_40; + if (cbw40_enable) { + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); + RT_CHANNEL_INFO *chset = rfctl->channel_set; + u8 oper_bw = CHANNEL_WIDTH_20, oper_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; + + if (in_ie == NULL) { + /* TDLS: TODO 20/40 issue */ + if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { + oper_bw = padapter->mlmeextpriv.cur_bwmode; + if (oper_bw > CHANNEL_WIDTH_40) + oper_bw = CHANNEL_WIDTH_40; + } else + /* TDLS: TODO 40? */ + oper_bw = CHANNEL_WIDTH_40; + } else { + p = rtw_get_ie(in_ie, WLAN_EID_HT_OPERATION, &ielen, in_len); + if (p && ielen == HT_OP_IE_LEN) { + if (GET_HT_OP_ELE_STA_CHL_WIDTH(p + 2)) { + switch (GET_HT_OP_ELE_2ND_CHL_OFFSET(p + 2)) { + case SCA: + oper_bw = CHANNEL_WIDTH_40; + oper_offset = HAL_PRIME_CHNL_OFFSET_LOWER; + break; + case SCB: + oper_bw = CHANNEL_WIDTH_40; + oper_offset = HAL_PRIME_CHNL_OFFSET_UPPER; + break; + } + } + } + } + + /* adjust bw to fit in channel plan setting */ + if (oper_bw == CHANNEL_WIDTH_40 + && oper_offset != HAL_PRIME_CHNL_OFFSET_DONT_CARE /* check this because TDLS has no info to set offset */ + && (!rtw_chset_is_chbw_valid(chset, channel, oper_bw, oper_offset) + || (IS_DFS_SLAVE_WITH_RD(rfctl) + && !rtw_odm_dfs_domain_unknown(rfctl_to_dvobj(rfctl)) + && rtw_chset_is_chbw_non_ocp(chset, channel, oper_bw, oper_offset)) + ) + ) { + oper_bw = CHANNEL_WIDTH_20; + oper_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; + rtw_warn_on(!rtw_chset_is_chbw_valid(chset, channel, oper_bw, oper_offset)); + if (IS_DFS_SLAVE_WITH_RD(rfctl) && !rtw_odm_dfs_domain_unknown(rfctl_to_dvobj(rfctl))) + rtw_warn_on(rtw_chset_is_chbw_non_ocp(chset, channel, oper_bw, oper_offset)); + } + + if (oper_bw == CHANNEL_WIDTH_40) { + ht_capie.cap_info |= IEEE80211_HT_CAP_SUP_WIDTH; + if (phtpriv->sgi_40m) + ht_capie.cap_info |= IEEE80211_HT_CAP_SGI_40; + } + + cbw40_enable = oper_bw == CHANNEL_WIDTH_40 ? 1 : 0; } /* todo: disable SM power save mode */ @@ -4070,7 +4651,7 @@ unsigned int rtw_restructure_ht_ie(_adapter *padapter, u8 *in_ie, u8 *out_ie, ui break; case 2: #ifdef CONFIG_DISABLE_MCS13TO15 - if (((cbw40_enable == 1) && (operation_bw == CHANNEL_WIDTH_40)) && (pregistrypriv->wifi_spec != 1)) + if (cbw40_enable && pregistrypriv->wifi_spec != 1) set_mcs_rate_by_mask(ht_capie.supp_mcs_set, MCS_RATE_2R_13TO15_OFF); else #endif @@ -4151,7 +4732,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) && + !pvhtpriv->ap_is_mu_bfer) + rf_num = (rf_num >= 2 ? 2 : rf_num); +#endif SET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(&ht_capie, rf_num); } #endif/*CONFIG_BEAMFORMING*/ @@ -4316,47 +4904,8 @@ 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 - } +#endif #ifdef CONFIG_TDLS void rtw_issue_addbareq_cmd_tdls(_adapter *padapter, struct xmit_frame *pxmitframe) @@ -4389,6 +4938,7 @@ void rtw_issue_addbareq_cmd_tdls(_adapter *padapter, struct xmit_frame *pxmitfra } #endif /* CONFIG_TDLS */ +#ifdef CONFIG_80211N_HT void rtw_issue_addbareq_cmd(_adapter *padapter, struct xmit_frame *pxmitframe) { u8 issued; @@ -4439,7 +4989,7 @@ void rtw_issue_addbareq_cmd(_adapter *padapter, struct xmit_frame *pxmitframe) } } - +#endif /* CONFIG_80211N_HT */ void rtw_append_exented_cap(_adapter *padapter, u8 *out_ie, uint *pout_len) { struct mlme_priv *pmlmepriv = &padapter->mlmepriv; @@ -4458,6 +5008,9 @@ void rtw_append_exented_cap(_adapter *padapter, u8 *out_ie, uint *pout_len) if (pvhtpriv->vht_option) SET_EXT_CAPABILITY_ELE_OP_MODE_NOTIF(cap_content, 1); #endif /* CONFIG_80211AC_VHT */ +#ifdef CONFIG_RTW_WNM + rtw_wnm_set_ext_cap_btm(cap_content, 1); +#endif /* From 802.11 specification,if a STA does not support any of capabilities defined in the Extended Capabilities element, then the STA is not required to @@ -4527,8 +5080,8 @@ void _rtw_roaming(_adapter *padapter, struct wlan_network *tgt_network) else { RTW_INFO("%s(%d) -to roaming fail, indicate_disconnect\n", __FUNCTION__, __LINE__); #ifdef CONFIG_RTW_80211R - rtw_clr_ft_flags(padapter, RTW_FT_SUPPORTED|RTW_FT_OVER_DS_SUPPORTED); - rtw_reset_ft_status(padapter); + rtw_ft_clr_flags(padapter, RTW_FT_PEER_EN|RTW_FT_PEER_OTD_EN); + rtw_ft_reset_status(padapter); #endif rtw_indicate_disconnect(padapter, 0, _FALSE); break; @@ -4545,8 +5098,10 @@ bool rtw_adjust_chbw(_adapter *adapter, u8 req_ch, u8 *req_bw, u8 *req_offset) struct registry_priv *regsty = adapter_to_regsty(adapter); u8 allowed_bw; - if (req_ch <= 14) + if (req_ch < 14) allowed_bw = REGSTY_BW_2G(regsty); + else if (req_ch == 14) + allowed_bw = CHANNEL_WIDTH_20; else allowed_bw = REGSTY_BW_5G(regsty); @@ -4567,8 +5122,9 @@ bool rtw_adjust_chbw(_adapter *adapter, u8 req_ch, u8 *req_bw, u8 *req_offset) 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 { @@ -4578,23 +5134,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; } @@ -4667,3 +5233,17 @@ inline void rtw_wfd_st_switch(struct sta_info *sta, bool on) rtw_st_ctl_unregister(&sta->st_ctl, SESSION_TRACKER_REG_ID_WFD); #endif } + +void dump_arp_pkt(void *sel, u8 *da, u8 *sa, u8 *arp, bool tx) +{ + RTW_PRINT_SEL(sel, "%s ARP da="MAC_FMT", sa="MAC_FMT"\n" + , tx ? "send" : "recv", MAC_ARG(da), MAC_ARG(sa)); + RTW_PRINT_SEL(sel, "htype=%u, ptype=0x%04x, hlen=%u, plen=%u, oper=%u\n" + , GET_ARP_HTYPE(arp), GET_ARP_PTYPE(arp), GET_ARP_HLEN(arp) + , GET_ARP_PLEN(arp), GET_ARP_OPER(arp)); + RTW_PRINT_SEL(sel, "sha="MAC_FMT", spa="IP_FMT"\n" + , MAC_ARG(ARP_SENDER_MAC_ADDR(arp)), IP_ARG(ARP_SENDER_IP_ADDR(arp))); + RTW_PRINT_SEL(sel, "tha="MAC_FMT", tpa="IP_FMT"\n" + , MAC_ARG(ARP_TARGET_MAC_ADDR(arp)), IP_ARG(ARP_TARGET_IP_ADDR(arp))); +} + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_mlme_ext.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_mlme_ext.c index f133516adf40..b24936013b7c 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_mlme_ext.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_mlme_ext.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2019 Realtek Corporation. * * This program is 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +74,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 @@ -90,7 +86,10 @@ struct action_handler OnAction_tbl[] = { {RTW_WLAN_CATEGORY_WNM, "ACTION_WNM", &on_action_wnm}, #endif {RTW_WLAN_CATEGORY_UNPROTECTED_WNM, "ACTION_UNPROTECTED_WNM", &DoReserved}, - {RTW_WLAN_CATEGORY_SELF_PROTECTED, "ACTION_SELF_PROTECTED", &DoReserved}, +#ifdef CONFIG_RTW_MESH + {RTW_WLAN_CATEGORY_MESH, "ACTION_MESH", &on_action_mesh}, + {RTW_WLAN_CATEGORY_SELF_PROTECTED, "ACTION_SELF_PROTECTED", &on_action_self_protected}, +#endif {RTW_WLAN_CATEGORY_WMM, "ACTION_WMM", &OnAction_wmm}, {RTW_WLAN_CATEGORY_VHT, "ACTION_VHT", &OnAction_vht}, {RTW_WLAN_CATEGORY_P2P, "ACTION_P2P", &OnAction_p2p}, @@ -116,241 +115,208 @@ unsigned char RSN_TKIP_CIPHER[4] = {0x00, 0x0f, 0xac, 0x02}; extern unsigned char REALTEK_96B_IE[]; -#ifdef LEGACY_CHANNEL_PLAN_REF -/******************************************************** -ChannelPlan definitions -*********************************************************/ -static RT_CHANNEL_PLAN legacy_channel_plan[] = { - /* 0x00, RTW_CHPLAN_FCC */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165}, 32}, - /* 0x01, RTW_CHPLAN_IC */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 136, 140, 149, 153, 157, 161, 165}, 31}, - /* 0x02, RTW_CHPLAN_ETSI */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140}, 32}, - /* 0x03, RTW_CHPLAN_SPAIN */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13}, - /* 0x04, RTW_CHPLAN_FRANCE */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13}, - /* 0x05, RTW_CHPLAN_MKK */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13}, - /* 0x06, RTW_CHPLAN_MKK1 */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13}, - /* 0x07, RTW_CHPLAN_ISRAEL */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48, 52, 56, 60, 64}, 21}, - /* 0x08, RTW_CHPLAN_TELEC */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 36, 40, 44, 48, 52, 56, 60, 64}, 22}, - /* 0x09, RTW_CHPLAN_GLOBAL_DOAMIN */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14}, 14}, - /* 0x0A, RTW_CHPLAN_WORLD_WIDE_13 */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13}, - /* 0x0B, RTW_CHPLAN_TAIWAN */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 56, 60, 64, 100, 104, 108, 112, 116, 136, 140, 149, 153, 157, 161, 165}, 26}, - /* 0x0C, RTW_CHPLAN_CHINA */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 149, 153, 157, 161, 165}, 18}, - /* 0x0D, RTW_CHPLAN_SINGAPORE_INDIA_MEXICO */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 52, 56, 60, 64, 149, 153, 157, 161, 165}, 24}, - /* 0x0E, RTW_CHPLAN_KOREA */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 149, 153, 157, 161, 165}, 31}, - /* 0x0F, RTW_CHPLAN_TURKEY */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 52, 56, 60, 64}, 19}, - /* 0x10, RTW_CHPLAN_JAPAN */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140}, 32}, - /* 0x11, RTW_CHPLAN_FCC_NO_DFS */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 149, 153, 157, 161, 165}, 20}, - /* 0x12, RTW_CHPLAN_JAPAN_NO_DFS */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48}, 17}, - /* 0x13, RTW_CHPLAN_WORLD_WIDE_5G */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 149, 153, 157, 161, 165}, 37}, - /* 0x14, RTW_CHPLAN_TAIWAN_NO_DFS */ {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 56, 60, 64, 149, 153, 157, 161, 165}, 19}, -}; -#endif - -static struct ch_list_t RTW_ChannelPlan2G[] = { - /* 0, RTW_RD_2G_NULL */ CH_LIST_ENT(0), - /* 1, RTW_RD_2G_WORLD */ CH_LIST_ENT(13, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13), - /* 2, RTW_RD_2G_ETSI1 */ CH_LIST_ENT(13, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13), - /* 3, RTW_RD_2G_FCC1 */ CH_LIST_ENT(11, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11), - /* 4, RTW_RD_2G_MKK1 */ CH_LIST_ENT(14, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14), - /* 5, RTW_RD_2G_ETSI2 */ CH_LIST_ENT(4, 10, 11, 12, 13), - /* 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), -}; - -#ifdef CONFIG_IEEE80211_BAND_5GHZ -static struct ch_list_t RTW_ChannelPlan5G[] = { - /* 0, RTW_RD_5G_NULL */ CH_LIST_ENT(0), - /* 1, RTW_RD_5G_ETSI1 */ CH_LIST_ENT(19, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140), - /* 2, RTW_RD_5G_ETSI2 */ 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), - /* 3, RTW_RD_5G_ETSI3 */ CH_LIST_ENT(22, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 149, 153, 157, 161, 165), - /* 4, RTW_RD_5G_FCC1 */ 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), - /* 5, RTW_RD_5G_FCC2 */ CH_LIST_ENT(9, 36, 40, 44, 48, 149, 153, 157, 161, 165), - /* 6, RTW_RD_5G_FCC3 */ CH_LIST_ENT(13, 36, 40, 44, 48, 52, 56, 60, 64, 149, 153, 157, 161, 165), - /* 7, RTW_RD_5G_FCC4 */ CH_LIST_ENT(12, 36, 40, 44, 48, 52, 56, 60, 64, 149, 153, 157, 161), - /* 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), - - /* === 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), - /* RTW_RD_5G_OLD_NCC1 */ CH_LIST_ENT(15, 56, 60, 64, 100, 104, 108, 112, 116, 136, 140, 149, 153, 157, 161, 165), - /* RTW_RD_5G_OLD_KCC1 */ CH_LIST_ENT(20, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 149, 153, 157, 161, 165), -}; -#endif /* CONFIG_IEEE80211_BAND_5GHZ */ - -static RT_CHANNEL_PLAN_MAP RTW_ChannelPlanMap[] = { - /* ===== 0x00 ~ 0x1F, legacy channel plan ===== */ - CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_KCC1, TXPWR_LMT_FCC), /* 0x00, RTW_CHPLAN_FCC */ - CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_OLD_FCC1, TXPWR_LMT_FCC), /* 0x01, RTW_CHPLAN_IC */ - CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_ETSI1, TXPWR_LMT_ETSI), /* 0x02, RTW_CHPLAN_ETSI */ - CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_NULL, TXPWR_LMT_ETSI), /* 0x03, RTW_CHPLAN_SPAIN */ - CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_NULL, TXPWR_LMT_ETSI), /* 0x04, RTW_CHPLAN_FRANCE */ - CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_NULL, TXPWR_LMT_MKK), /* 0x05, RTW_CHPLAN_MKK */ - CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_NULL, TXPWR_LMT_MKK), /* 0x06, RTW_CHPLAN_MKK1 */ - CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_FCC6, TXPWR_LMT_ETSI), /* 0x07, RTW_CHPLAN_ISRAEL */ - CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_FCC6, TXPWR_LMT_MKK), /* 0x08, RTW_CHPLAN_TELEC */ - CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x09, RTW_CHPLAN_GLOBAL_DOAMIN */ - CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x0A, RTW_CHPLAN_WORLD_WIDE_13 */ - CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_OLD_NCC1, TXPWR_LMT_FCC), /* 0x0B, RTW_CHPLAN_TAIWAN */ - CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_FCC5, TXPWR_LMT_ETSI), /* 0x0C, RTW_CHPLAN_CHINA */ - CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC3, TXPWR_LMT_WW), /* 0x0D, RTW_CHPLAN_SINGAPORE_INDIA_MEXICO */ /* ETSI:Singapore, India. FCC:Mexico => WW */ - CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_OLD_KCC1, TXPWR_LMT_ETSI), /* 0x0E, RTW_CHPLAN_KOREA */ - CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC6, TXPWR_LMT_ETSI), /* 0x0F, RTW_CHPLAN_TURKEY */ - CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_ETSI1, TXPWR_LMT_MKK), /* 0x10, RTW_CHPLAN_JAPAN */ - CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC2, TXPWR_LMT_FCC), /* 0x11, RTW_CHPLAN_FCC_NO_DFS */ - CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_FCC7, TXPWR_LMT_MKK), /* 0x12, RTW_CHPLAN_JAPAN_NO_DFS */ - CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC1, TXPWR_LMT_WW), /* 0x13, RTW_CHPLAN_WORLD_WIDE_5G */ - CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_NCC2, TXPWR_LMT_FCC), /* 0x14, RTW_CHPLAN_TAIWAN_NO_DFS */ - CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC7, TXPWR_LMT_ETSI), /* 0x15, RTW_CHPLAN_ETSI_NO_DFS */ - CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_NCC1, TXPWR_LMT_ETSI), /* 0x16, RTW_CHPLAN_KOREA_NO_DFS */ - CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_FCC7, TXPWR_LMT_MKK), /* 0x17, RTW_CHPLAN_JAPAN_NO_DFS */ - CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_FCC5, TXPWR_LMT_ETSI), /* 0x18, RTW_CHPLAN_PAKISTAN_NO_DFS */ - CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC5, TXPWR_LMT_FCC), /* 0x19, RTW_CHPLAN_TAIWAN2_NO_DFS */ - CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x1A, */ - CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x1B, */ - CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x1C, */ - CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x1D, */ - CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x1E, */ - CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_FCC1, TXPWR_LMT_WW), /* 0x1F, RTW_CHPLAN_WORLD_WIDE_ONLY_5G */ - - /* ===== 0x20 ~ 0x7F, new channel plan ===== */ - CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x20, RTW_CHPLAN_WORLD_NULL */ - CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_NULL, TXPWR_LMT_ETSI), /* 0x21, RTW_CHPLAN_ETSI1_NULL */ - CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_NULL, TXPWR_LMT_FCC), /* 0x22, RTW_CHPLAN_FCC1_NULL */ - CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_NULL, TXPWR_LMT_MKK), /* 0x23, RTW_CHPLAN_MKK1_NULL */ - CHPLAN_ENT(RTW_RD_2G_ETSI2, RTW_RD_5G_NULL, TXPWR_LMT_ETSI), /* 0x24, RTW_CHPLAN_ETSI2_NULL */ - 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_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_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, */ - CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x2F, */ - CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC3, TXPWR_LMT_FCC), /* 0x30, RTW_CHPLAN_WORLD_FCC3 */ - CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC4, TXPWR_LMT_FCC), /* 0x31, RTW_CHPLAN_WORLD_FCC4 */ - CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC5, TXPWR_LMT_FCC), /* 0x32, RTW_CHPLAN_WORLD_FCC5 */ - CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC6, TXPWR_LMT_FCC), /* 0x33, RTW_CHPLAN_WORLD_FCC6 */ - CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC7, TXPWR_LMT_FCC), /* 0x34, RTW_CHPLAN_FCC1_FCC7 */ - CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI2, TXPWR_LMT_ETSI), /* 0x35, RTW_CHPLAN_WORLD_ETSI2 */ - CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI3, TXPWR_LMT_ETSI), /* 0x36, RTW_CHPLAN_WORLD_ETSI3 */ - CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_MKK2, TXPWR_LMT_MKK), /* 0x37, RTW_CHPLAN_MKK1_MKK2 */ - CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_MKK3, TXPWR_LMT_MKK), /* 0x38, RTW_CHPLAN_MKK1_MKK3 */ - CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_NCC1, TXPWR_LMT_FCC), /* 0x39, RTW_CHPLAN_FCC1_NCC1 */ - CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x3A, */ - CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x3B, */ - CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x3C, */ - CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x3D, */ - CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x3E, */ - CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x3F, */ - CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_NCC2, TXPWR_LMT_FCC), /* 0x40, RTW_CHPLAN_FCC1_NCC2 */ - CHPLAN_ENT(RTW_RD_2G_GLOBAL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x41, RTW_CHPLAN_GLOBAL_NULL */ - CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_ETSI4, TXPWR_LMT_ETSI), /* 0x42, RTW_CHPLAN_ETSI1_ETSI4 */ - CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC2, TXPWR_LMT_FCC), /* 0x43, RTW_CHPLAN_FCC1_FCC2 */ - CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_NCC3, TXPWR_LMT_FCC), /* 0x44, RTW_CHPLAN_FCC1_NCC3 */ - CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI5, TXPWR_LMT_ETSI), /* 0x45, RTW_CHPLAN_WORLD_ETSI5 */ - CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC8, TXPWR_LMT_FCC), /* 0x46, RTW_CHPLAN_FCC1_FCC8 */ - CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI6, TXPWR_LMT_ETSI), /* 0x47, RTW_CHPLAN_WORLD_ETSI6 */ - CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI7, TXPWR_LMT_ETSI), /* 0x48, RTW_CHPLAN_WORLD_ETSI7 */ - CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI8, TXPWR_LMT_ETSI), /* 0x49, RTW_CHPLAN_WORLD_ETSI8 */ - CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x4A, */ - CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x4B, */ - CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x4C, */ - CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x4D, */ - CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x4E, */ - CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x4F, */ - CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI9, TXPWR_LMT_ETSI), /* 0x50, RTW_CHPLAN_WORLD_ETSI9 */ - CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI10, TXPWR_LMT_ETSI), /* 0x51, RTW_CHPLAN_WORLD_ETSI10 */ - CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI11, TXPWR_LMT_ETSI), /* 0x52, RTW_CHPLAN_WORLD_ETSI11 */ - CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_NCC4, TXPWR_LMT_FCC), /* 0x53, RTW_CHPLAN_FCC1_NCC4 */ - CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI12, TXPWR_LMT_ETSI), /* 0x54, RTW_CHPLAN_WORLD_ETSI12 */ - CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC9, TXPWR_LMT_FCC), /* 0x55, RTW_CHPLAN_FCC1_FCC9 */ - CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI13, TXPWR_LMT_ETSI), /* 0x56, RTW_CHPLAN_WORLD_ETSI13 */ - CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC10, TXPWR_LMT_FCC), /* 0x57, RTW_CHPLAN_FCC1_FCC10 */ - CHPLAN_ENT(RTW_RD_2G_MKK2, RTW_RD_5G_MKK4, TXPWR_LMT_MKK), /* 0x58, RTW_CHPLAN_MKK2_MKK4 */ - CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI14, TXPWR_LMT_ETSI), /* 0x59, RTW_CHPLAN_WORLD_ETSI14 */ - CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x5A, */ - CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x5B, */ - CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x5C, */ - CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x5D, */ - CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x5E, */ - CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x5F, */ - 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 */ -}; - -static RT_CHANNEL_PLAN_MAP RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE = - CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC1, TXPWR_LMT_FCC); /* 0x7F, Realtek Define */ - -bool rtw_chplan_is_empty(u8 id) +static void init_channel_list(_adapter *padapter, RT_CHANNEL_INFO *channel_set + , struct p2p_channels *channel_list) { - RT_CHANNEL_PLAN_MAP *chplan_map; + struct registry_priv *regsty = adapter_to_regsty(padapter); - if (id == RTW_CHPLAN_REALTEK_DEFINE) - chplan_map = &RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE; - else - chplan_map = &RTW_ChannelPlanMap[id]; + 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 } + }; - if (chplan_map->Index2G == RTW_RD_2G_NULL - #ifdef CONFIG_IEEE80211_BAND_5GHZ - && chplan_map->Index5G == RTW_RD_5G_NULL - #endif - ) - return _TRUE; + 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 defined(CONFIG_80211N_HT) || defined(CONFIG_80211AC_VHT) + 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; +#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; - return _FALSE; } +#if CONFIG_TXPWR_LIMIT +void rtw_txpwr_init_regd(struct rf_ctl_t *rfctl) +{ + u8 regd; + 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 */ + regd = rtw_chplan_get_default_regd(rfctl->ChannelPlan); + 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 new predefined regd: + * - use FCC if IC or CHILE not found + * - use ETSI if KCC or ACMA not found + */ + case TXPWR_LMT_IC: + case TXPWR_LMT_KCC: + case TXPWR_LMT_ACMA: + case TXPWR_LMT_CHILE: + if (regd == TXPWR_LMT_IC || regd == TXPWR_LMT_CHILE) + regd = TXPWR_LMT_FCC; + else if (regd == TXPWR_LMT_KCC || regd == TXPWR_LMT_ACMA) + 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); + + _rtw_mutex_init(&rfctl->offch_mutex); + +#if 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 + + rfctl->ch_sel_same_band_prefer = 1; #ifdef CONFIG_DFS_MASTER rfctl->cac_start_time = rfctl->cac_end_time = RTW_CAC_STOPPED; + rtw_init_timer(&(rfctl->radar_detect_timer), adapter, rtw_dfs_rd_timer_hdl, rfctl); +#endif +#ifdef CONFIG_DFS_SLAVE_WITH_RADAR_DETECT + rfctl->dfs_slave_with_rd = 1; +#endif +} - /* TODO: dfs_master_timer */ +void rtw_rfctl_deinit(_adapter *adapter) +{ + struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); + + _rtw_mutex_free(&rfctl->offch_mutex); + +#if 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 /* -* called in rtw_dfs_master_enable() +* called in rtw_dfs_rd_enable() * assume the request channel coverage is DFS range * base on the current status and the request channel coverage to check if need to reset complete CAC time */ -bool rtw_is_cac_reset_needed(_adapter *adapter, u8 ch, u8 bw, u8 offset) +bool rtw_is_cac_reset_needed(struct rf_ctl_t *rfctl, u8 ch, u8 bw, u8 offset) { - struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); bool needed = _FALSE; u32 cur_hi, cur_lo, hi, lo; @@ -447,7 +413,7 @@ bool rtw_rfctl_is_tx_blocked_by_ch_waiting(struct rf_ctl_t *rfctl) return rtw_rfctl_overlap_radar_detect_ch(rfctl) && IS_CH_WAITING(rfctl); } -bool rtw_chset_is_ch_non_ocp(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset) +bool rtw_chset_is_chbw_non_ocp(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset) { bool ret = _FALSE; u32 hi = 0, lo = 0; @@ -456,7 +422,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; @@ -477,10 +443,15 @@ bool rtw_chset_is_ch_non_ocp(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset) return ret; } +bool rtw_chset_is_ch_non_ocp(RT_CHANNEL_INFO *ch_set, u8 ch) +{ + return rtw_chset_is_chbw_non_ocp(ch_set, ch, CHANNEL_WIDTH_20, HAL_PRIME_CHNL_OFFSET_DONT_CARE); +} + 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 +460,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 +497,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; @@ -556,20 +527,19 @@ inline void rtw_chset_update_non_ocp_ms(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u _rtw_chset_update_non_ocp(ch_set, ch, bw, offset, ms); } -u32 rtw_get_ch_waiting_ms(_adapter *adapter, u8 ch, u8 bw, u8 offset, u32 *r_non_ocp_ms, u32 *r_cac_ms) +u32 rtw_get_ch_waiting_ms(struct rf_ctl_t *rfctl, u8 ch, u8 bw, u8 offset, u32 *r_non_ocp_ms, u32 *r_cac_ms) { - struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); - struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; + struct dvobj_priv *dvobj = rfctl_to_dvobj(rfctl); u32 non_ocp_ms; 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_chbw_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; - if (rfctl->dfs_master_enabled) { + if (rfctl->radar_detect_enabled) { u32 cur_hi, cur_lo, hi, lo; if (rtw_chbw_to_freq_range(ch, bw, offset, &hi, &lo) == _FALSE) { @@ -586,14 +556,14 @@ 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)) cac_ms = rtw_systime_to_ms(rfctl->cac_end_time - rtw_get_current_time()); else cac_ms = 0; - } else if (rtw_is_long_cac_ch(ch, bw, offset, rtw_odm_get_dfs_domain(adapter))) + } else if (rtw_is_long_cac_ch(ch, bw, offset, rtw_odm_get_dfs_domain(dvobj))) cac_ms = CAC_TIME_CE_MS; else cac_ms = CAC_TIME_MS; @@ -606,13 +576,12 @@ u32 rtw_get_ch_waiting_ms(_adapter *adapter, u8 ch, u8 bw, u8 offset, u32 *r_non return non_ocp_ms + cac_ms; } -void rtw_reset_cac(_adapter *adapter, u8 ch, u8 bw, u8 offset) +void rtw_reset_cac(struct rf_ctl_t *rfctl, u8 ch, u8 bw, u8 offset) { - struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); u32 non_ocp_ms; u32 cac_ms; - rtw_get_ch_waiting_ms(adapter + rtw_get_ch_waiting_ms(rfctl , ch , bw , offset @@ -631,18 +600,48 @@ void rtw_reset_cac(_adapter *adapter, u8 ch, u8 bw, u8 offset) if (rfctl->cac_end_time == RTW_CAC_STOPPED) rfctl->cac_end_time++; } + +u32 rtw_force_stop_cac(struct rf_ctl_t *rfctl, u32 timeout_ms) +{ + struct dvobj_priv *dvobj = rfctl_to_dvobj(rfctl); + systime start; + u32 pass_ms; + + start = rtw_get_current_time(); + + rfctl->cac_force_stop = 1; + + while (rtw_get_passing_time_ms(start) <= timeout_ms + && IS_UNDER_CAC(rfctl) + ) { + if (dev_is_surprise_removed(dvobj) || dev_is_drv_stopped(dvobj)) + break; + rtw_msleep_os(20); + } + + if (IS_UNDER_CAC(rfctl)) { + if (!dev_is_surprise_removed(dvobj) && !dev_is_drv_stopped(dvobj)) + RTW_INFO("%s waiting for cac stop timeout!\n", __func__); + } + + rfctl->cac_force_stop = 0; + + pass_ms = rtw_get_passing_time_ms(start); + + return pass_ms; +} #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) +bool rtw_choose_shortest_waiting_ch(struct rf_ctl_t *rfctl, u8 sel_ch, u8 max_bw + , u8 *dec_ch, u8 *dec_bw, u8 *dec_offset + , u8 d_flags, u8 cur_ch, u8 same_band_prefer, u8 mesh_only) { #ifndef DBG_CHOOSE_SHORTEST_WAITING_CH #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); + struct dvobj_priv *dvobj = rfctl_to_dvobj(rfctl); + struct registry_priv *regsty = dvobj_to_regsty(dvobj); u8 ch, bw, offset; u8 ch_c = 0, bw_c = 0, offset_c = 0; int i; @@ -654,16 +653,18 @@ bool rtw_choose_shortest_waiting_ch(_adapter *adapter, u8 req_bw, u8 *dec_ch, u8 } /* full search and narrow bw judegement first to avoid potetial judegement timing issue */ - for (bw = CHANNEL_WIDTH_20; bw <= req_bw; bw++) { - if (!hal_is_bw_support(adapter, bw)) + for (bw = CHANNEL_WIDTH_20; bw <= max_bw; bw++) { + if (!hal_is_bw_support(dvobj_get_primary_adapter(dvobj), bw)) continue; - for (i = 0; i < mlmeext->max_chan_nums; i++) { + 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 (sel_ch > 0 && ch != sel_ch) + continue; if ((d_flags & RTW_CHF_2G) && ch <= 14) continue; @@ -679,38 +680,46 @@ bool rtw_choose_shortest_waiting_ch(_adapter *adapter, u8 req_bw, u8 *dec_ch, u8 continue; } + if (mesh_only && ch >= 5 && ch <= 9 && bw > CHANNEL_WIDTH_20) + continue; + 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_chbw_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))) + if ((d_flags & RTW_CHF_LONG_CAC) && rtw_is_long_cac_ch(ch, bw, offset, rtw_odm_get_dfs_domain(dvobj))) 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))) + if ((d_flags & RTW_CHF_NON_LONG_CAC) && !rtw_is_long_cac_ch(ch, bw, offset, rtw_odm_get_dfs_domain(dvobj))) continue; #ifdef CONFIG_DFS_MASTER - waiting_ms = rtw_get_ch_waiting_ms(adapter, ch, bw, offset, &non_ocp_ms, &cac_ms); + waiting_ms = rtw_get_ch_waiting_ms(rfctl, 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" - , FUNC_ADPT_ARG(adapter), ch, bw, offset, waiting_ms, non_ocp_ms, cac_ms); + RTW_INFO("%s:%u,%u,%u %u(non_ocp:%u, cac:%u)\n" + , __func__, ch, bw, offset, waiting_ms, non_ocp_ms, cac_ms); if (ch_c == 0 + /* first: smaller wating time */ || min_waiting_ms > waiting_ms - || (min_waiting_ms == waiting_ms && bw > bw_c) /* wider bw first */ + /* then: wider bw */ + || (min_waiting_ms == waiting_ms && bw > bw_c) + /* then: same band if requested */ + || (same_band_prefer && min_waiting_ms == waiting_ms && bw == bw_c + && !rtw_is_same_band(cur_ch, ch_c) && rtw_is_same_band(cur_ch, ch)) ) { ch_c = ch; bw_c = bw; @@ -721,8 +730,10 @@ bool rtw_choose_shortest_waiting_ch(_adapter *adapter, u8 req_bw, u8 *dec_ch, u8 } if (ch_c != 0) { - RTW_INFO(FUNC_ADPT_FMT": d_flags:0x%02x %u,%u,%u waiting_ms:%u\n" - , FUNC_ADPT_ARG(adapter), d_flags, ch_c, bw_c, offset_c, min_waiting_ms); + RTW_INFO("%s: d_flags:0x%02x cur_ch:%u sb_prefer:%u%s %u,%u,%u waiting_ms:%u\n" + , __func__, d_flags, cur_ch, same_band_prefer + , mesh_only ? " mesh_only" : "" + , ch_c, bw_c, offset_c, min_waiting_ms); *dec_ch = ch_c; *dec_bw = bw_c; @@ -730,84 +741,21 @@ bool rtw_choose_shortest_waiting_ch(_adapter *adapter, u8 req_bw, u8 *dec_ch, u8 return _TRUE; } - if (d_flags == 0) + if (d_flags == 0) { + RTW_INFO("%s: sel_ch:%u max_bw:%u d_flags:0x%02x cur_ch:%u sb_prefer:%u%s\n" + , __func__, sel_ch, max_bw, d_flags, cur_ch, same_band_prefer + , mesh_only ? " mesh_only" : ""); rtw_warn_on(1); + } return _FALSE; } -void dump_country_chplan(void *sel, const struct country_chplan *ent) -{ - _RTW_PRINT_SEL(sel, "\"%c%c\", 0x%02X%s\n" - , ent->alpha2[0], ent->alpha2[1], ent->chplan - , COUNTRY_CHPLAN_EN_11AC(ent) ? " ac" : "" - ); -} - -void dump_country_chplan_map(void *sel) -{ - const struct country_chplan *ent; - u8 code[2]; - -#if RTW_DEF_MODULE_REGULATORY_CERT - _RTW_PRINT_SEL(sel, "RTW_DEF_MODULE_REGULATORY_CERT:0x%x\n", RTW_DEF_MODULE_REGULATORY_CERT); -#endif -#ifdef CONFIG_CUSTOMIZED_COUNTRY_CHPLAN_MAP - _RTW_PRINT_SEL(sel, "CONFIG_CUSTOMIZED_COUNTRY_CHPLAN_MAP\n"); -#endif - - for (code[0] = 'A'; code[0] <= 'Z'; code[0]++) { - for (code[1] = 'A'; code[1] <= 'Z'; code[1]++) { - ent = rtw_get_chplan_from_country(code); - if (!ent) - continue; - - dump_country_chplan(sel, ent); - } - } -} - -void dump_chplan_id_list(void *sel) -{ - int i; - - for (i = 0; i < RTW_CHPLAN_MAX; i++) { - if (!rtw_is_channel_plan_valid(i)) - continue; - - _RTW_PRINT_SEL(sel, "0x%02X ", i); - } - - RTW_PRINT_SEL(sel, "0x7F\n"); -} - -void dump_chplan_test(void *sel) -{ - int i, j; - - /* check invalid channel */ - for (i = 0; i < RTW_RD_2G_MAX; i++) { - for (j = 0; j < CH_LIST_LEN(RTW_ChannelPlan2G[i]); j++) { - if (rtw_ch2freq(CH_LIST_CH(RTW_ChannelPlan2G[i], j)) == 0) - RTW_PRINT_SEL(sel, "invalid ch:%u at (%d,%d)\n", CH_LIST_CH(RTW_ChannelPlan2G[i], j), i, j); - } - } - -#ifdef CONFIG_IEEE80211_BAND_5GHZ - for (i = 0; i < RTW_RD_5G_MAX; i++) { - for (j = 0; j < CH_LIST_LEN(RTW_ChannelPlan5G[i]); j++) { - if (rtw_ch2freq(CH_LIST_CH(RTW_ChannelPlan5G[i], j)) == 0) - RTW_PRINT_SEL(sel, "invalid ch:%u at (%d,%d)\n", CH_LIST_CH(RTW_ChannelPlan5G[i], j), i, j); - } - } -#endif -} - 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); @@ -816,7 +764,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,24 +779,23 @@ void dump_chset(void *sel, RT_CHANNEL_INFO *ch_set) RTW_PRINT_SEL(sel, "total ch number:%d\n", i); } -void dump_cur_chset(void *sel, _adapter *adapter) +void dump_cur_chset(void *sel, struct rf_ctl_t *rfctl) { - struct mlme_priv *mlme = &adapter->mlmepriv; - struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; - struct registry_priv *regsty = adapter_to_regsty(adapter); - HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + struct dvobj_priv *dvobj = rfctl_to_dvobj(rfctl); + struct registry_priv *regsty = dvobj_to_regsty(dvobj); 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); +#if 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)); + RTW_PRINT_SEL(sel, "dfs_domain:%u\n", rtw_odm_get_dfs_domain(dvobj)); #endif for (i = 0; i < MAX_CHANNEL_NUM; i++) @@ -856,16 +803,16 @@ void dump_cur_chset(void *sel, _adapter *adapter) break; if (i < MAX_CHANNEL_NUM) { - _RTW_PRINT_SEL(sel, "excl_chs:"); + RTW_PRINT_SEL(sel, "excl_chs:"); for (i = 0; i < MAX_CHANNEL_NUM; i++) { if (regsty->excl_chs[i] == 0) break; _RTW_PRINT_SEL(sel, "%u ", regsty->excl_chs[i]); } - RTW_PRINT_SEL(sel, "\n"); + _RTW_PRINT_SEL(sel, "\n"); } - dump_chset(sel, mlmeext->channel_set); + dump_chset(sel, rfctl->channel_set); } /* @@ -875,17 +822,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; } /* @@ -913,7 +862,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; } @@ -924,6 +873,50 @@ u8 rtw_chset_is_chbw_valid(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset) return valid; } +/** + * rtw_chset_sync_chbw - obey g_ch, adjust g_bw, g_offset, bw, offset to fit in channel plan + * @ch_set: channel plan to check + * @req_ch: pointer of the request ch, may be modified further + * @req_bw: pointer of the request bw, may be modified further + * @req_offset: pointer of the request offset, may be modified further + * @g_ch: pointer of the ongoing group ch + * @g_bw: pointer of the ongoing group bw, may be modified further + * @g_offset: pointer of the ongoing group offset, may be modified further + */ +void rtw_chset_sync_chbw(RT_CHANNEL_INFO *ch_set, u8 *req_ch, u8 *req_bw, u8 *req_offset + , u8 *g_ch, u8 *g_bw, u8 *g_offset) +{ + u8 r_ch, r_bw, r_offset; + u8 u_ch, u_bw, u_offset; + u8 cur_bw = *req_bw; + + while (1) { + r_ch = *req_ch; + r_bw = cur_bw; + r_offset = *req_offset; + u_ch = *g_ch; + u_bw = *g_bw; + u_offset = *g_offset; + + rtw_sync_chbw(&r_ch, &r_bw, &r_offset, &u_ch, &u_bw, &u_offset); + + if (rtw_chset_is_chbw_valid(ch_set, r_ch, r_bw, r_offset)) + break; + if (cur_bw == CHANNEL_WIDTH_20) { + rtw_warn_on(1); + break; + } + cur_bw--; + }; + + *req_ch = r_ch; + *req_bw = r_bw; + *req_offset = r_offset; + *g_ch = u_ch; + *g_bw = u_bw; + *g_offset = u_offset; +} + /* * Check the @param ch is fit with setband setting of @param adapter * @adapter: the given adapter @@ -982,9 +975,24 @@ Following are the initialization functions for WiFi MLME int init_hw_mlme_ext(_adapter *padapter) { struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); + u8 rx_bar_enble = _TRUE; + + /* + * Sync driver status and hardware setting + */ + + /* Modify to make sure first time change channel(band) would be done properly */ + pHalData->current_channel = 0; + pHalData->current_channel_bw = CHANNEL_WIDTH_MAX; + #ifdef CONFIG_IEEE80211_BAND_5GHZ + pHalData->current_band_type = BAND_MAX; + #else + pHalData->current_band_type = BAND_ON_2_4G; + #endif /* set_opmode_cmd(padapter, infra_client_with_mlme); */ /* removed */ - + rtw_hal_set_hwreg(padapter, HW_VAR_ENABLE_RX_BAR, &rx_bar_enble); set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); return _SUCCESS; @@ -992,16 +1000,40 @@ int init_hw_mlme_ext(_adapter *padapter) void init_mlme_default_rate_set(_adapter *padapter) { - struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - - 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,}; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + unsigned char end_set[1] = {0xff}; + u8 offset_datarate = 0; + u8 offset_basicrate = 0; +#ifdef CONFIG_80211N_HT unsigned char supported_mcs_set[16] = {0xff, 0xff, 0xff, 0x00, 0x00, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}; +#endif - _rtw_memcpy(pmlmeext->datarate, mixed_datarate, NumRates); - _rtw_memcpy(pmlmeext->basicrate, mixed_basicrate, NumRates); + if (IsSupportedTxCCK(padapter->registrypriv.wireless_mode)) { - _rtw_memcpy(pmlmeext->default_supported_mcs_set, supported_mcs_set, sizeof(pmlmeext->default_supported_mcs_set)); + unsigned char datarate_b[B_MODE_RATE_NUM] ={_1M_RATE_, _2M_RATE_, _5M_RATE_, _11M_RATE_}; + _rtw_memcpy(pmlmeext->datarate, datarate_b, B_MODE_RATE_NUM); + _rtw_memcpy(pmlmeext->basicrate, datarate_b, B_MODE_RATE_NUM); + offset_datarate += B_MODE_RATE_NUM; + offset_basicrate += B_MODE_RATE_NUM; + RTW_INFO("%s: support CCK\n", __func__); + } + if(IsSupportedTxOFDM(padapter->registrypriv.wireless_mode)) { + unsigned char datarate_g[G_MODE_RATE_NUM] ={_6M_RATE_, _9M_RATE_, _12M_RATE_, _18M_RATE_,_24M_RATE_, _36M_RATE_, _48M_RATE_, _54M_RATE_}; + unsigned char basicrate_g[G_MODE_BASIC_RATE_NUM] = {_6M_RATE_, _12M_RATE_, _24M_RATE_}; + _rtw_memcpy(pmlmeext->datarate + offset_datarate, datarate_g, G_MODE_RATE_NUM); + _rtw_memcpy(pmlmeext->basicrate + offset_basicrate,basicrate_g, G_MODE_BASIC_RATE_NUM); + offset_datarate += G_MODE_RATE_NUM; + offset_basicrate += G_MODE_BASIC_RATE_NUM; + RTW_INFO("%s: support OFDM\n", __func__); + + } + _rtw_memcpy(pmlmeext->datarate + offset_datarate, end_set, 1); + _rtw_memcpy(pmlmeext->basicrate + offset_basicrate, end_set, 1); + +#ifdef CONFIG_80211N_HT + if( padapter->registrypriv.ht_enable && is_supported_ht(padapter->registrypriv.wireless_mode)) + _rtw_memcpy(pmlmeext->default_supported_mcs_set, supported_mcs_set, sizeof(pmlmeext->default_supported_mcs_set)); +#endif } static void init_mlme_ext_priv_value(_adapter *padapter) @@ -1013,9 +1045,7 @@ static void init_mlme_ext_priv_value(_adapter *padapter) pmlmeext->mgnt_seq = 0;/* reset to zero when disconnect at client mode */ #ifdef CONFIG_IEEE80211W pmlmeext->sa_query_seq = 0; - pmlmeext->mgnt_80211w_IPN = 0; - pmlmeext->mgnt_80211w_IPN_rx = 0; -#endif /* CONFIG_IEEE80211W */ +#endif pmlmeext->cur_channel = padapter->registrypriv.channel; pmlmeext->cur_bwmode = CHANNEL_WIDTH_20; pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; @@ -1023,10 +1053,9 @@ static void init_mlme_ext_priv_value(_adapter *padapter) pmlmeext->retry = 0; pmlmeext->cur_wireless_mode = padapter->registrypriv.wireless_mode; - init_mlme_default_rate_set(padapter); - if (pmlmeext->cur_channel > 14) + if ((pmlmeext->cur_channel > 14) || ((padapter->registrypriv.wireless_mode & WIRELESS_11B) == 0)) pmlmeext->tx_rate = IEEE80211_OFDM_RATE_6MB; else pmlmeext->tx_rate = IEEE80211_CCK_RATE_1MB; @@ -1039,7 +1068,12 @@ static void init_mlme_ext_priv_value(_adapter *padapter) pmlmeext->sitesurvey_res.rx_ampdu_size = RX_AMPDU_SIZE_INVALID; #ifdef CONFIG_SCAN_BACKOP mlmeext_assign_scan_backop_flags_sta(pmlmeext, /*SS_BACKOP_EN|*/SS_BACKOP_PS_ANNC | SS_BACKOP_TX_RESUME); + #ifdef CONFIG_AP_MODE mlmeext_assign_scan_backop_flags_ap(pmlmeext, SS_BACKOP_EN | SS_BACKOP_PS_ANNC | SS_BACKOP_TX_RESUME); + #endif + #ifdef CONFIG_RTW_MESH + mlmeext_assign_scan_backop_flags_mesh(pmlmeext, /*SS_BACKOP_EN | */SS_BACKOP_PS_ANNC | SS_BACKOP_TX_RESUME); + #endif pmlmeext->sitesurvey_res.scan_cnt = 0; pmlmeext->sitesurvey_res.scan_cnt_max = RTW_SCAN_NUM_OF_CH; pmlmeext->sitesurvey_res.backop_ms = RTW_BACK_OP_CH_MS; @@ -1070,205 +1104,27 @@ static void init_mlme_ext_priv_value(_adapter *padapter) pmlmeext->action_public_rxseq = 0xffff; pmlmeext->action_public_dialog_token = 0xff; +#ifdef ROKU_PRIVATE +/*infra mode, used to store AP's info*/ + _rtw_memset(pmlmeinfo->SupportedRates_infra_ap, 0, NDIS_802_11_LENGTH_RATES_EX); + pmlmeinfo->ht_vht_received = 0; +#endif /* ROKU_PRIVATE */ } -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, rtw_ft_link_timer_hdl, padapter); + rtw_init_timer(&pmlmeext->ft_roam_timer, padapter, rtw_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; - - 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; - - 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 (is_supported_5g(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; +#ifdef CONFIG_RTW_REPEATER_SON + rtw_init_timer(&pmlmeext->rson_scan_timer, padapter, rson_timer_hdl, padapter); +#endif } int init_mlme_ext_priv(_adapter *padapter) @@ -1276,7 +1132,6 @@ int init_mlme_ext_priv(_adapter *padapter) int res = _SUCCESS; struct registry_priv *pregistrypriv = &padapter->registrypriv; struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); /* We don't need to memset padapter->XXX to zero, because adapter is allocated by rtw_zvmalloc(). */ @@ -1295,8 +1150,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; @@ -1311,6 +1164,24 @@ int init_mlme_ext_priv(_adapter *padapter) pmlmeext->fixed_chan = 0xFF; #endif + pmlmeext->tsf_update_pause_factor = pregistrypriv->tsf_update_pause_factor; + pmlmeext->tsf_update_restore_factor = pregistrypriv->tsf_update_restore_factor; + +#ifdef CONFIG_SUPPORT_STATIC_SMPS + pmlmeext->ssmps_en = _FALSE; + pmlmeext->ssmps_tx_tp_th = SSMPS_TX_TP_TH;/*Mbps*/ + pmlmeext->ssmps_rx_tp_th = SSMPS_RX_TP_TH;/*Mbps*/ + #ifdef DBG_STATIC_SMPS + pmlmeext->ssmps_test = _FALSE; + #endif +#endif + +#ifdef CONFIG_CTRL_TXSS_BY_TP + pmlmeext->txss_ctrl_en = _TRUE; + pmlmeext->txss_tp_th = TXSS_TP_TH; + pmlmeext->txss_tp_chk_cnt = TXSS_TP_CHK_CNT; +#endif + return res; } @@ -1325,16 +1196,17 @@ 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); */ } } +#ifdef CONFIG_PATCH_JOIN_WRONG_CHANNEL static u8 cmp_pkt_chnl_diff(_adapter *padapter, u8 *pframe, uint packet_len) { /* if the channel is same, return 0. else return channel differential */ uint len; u8 channel; u8 *p; + p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + _BEACON_IE_OFFSET_, _DSSET_IE_, &len, packet_len - _BEACON_IE_OFFSET_); if (p) { channel = *(p + 2); @@ -1345,6 +1217,7 @@ static u8 cmp_pkt_chnl_diff(_adapter *padapter, u8 *pframe, uint packet_len) } else return 0; } +#endif /* CONFIG_PATCH_JOIN_WRONG_CHANNEL */ static void _mgt_dispatcher(_adapter *padapter, struct mlme_handler *ptable, union recv_frame *precv_frame) { @@ -1355,7 +1228,25 @@ static void _mgt_dispatcher(_adapter *padapter, struct mlme_handler *ptable, uni /* receive the frames that ra(a1) is my address or ra(a1) is bc address. */ if (!_rtw_memcmp(GetAddr1Ptr(pframe), adapter_mac_addr(padapter), ETH_ALEN) && !_rtw_memcmp(GetAddr1Ptr(pframe), bc_addr, ETH_ALEN)) +#ifdef CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI + { + struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); + + if (check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE) != _TRUE) + return; + + if (check_fwstate(&padapter->mlmepriv, _FW_LINKED) == _TRUE) + return; + + if ( pwdev_priv->pno_mac_addr[0] == 0xFF) + return; + + if (!_rtw_memcmp(GetAddr1Ptr(pframe), adapter_pno_mac_addr(padapter), ETH_ALEN)) + return; + } +#else return; +#endif ptable->func(padapter, precv_frame); } @@ -1366,14 +1257,10 @@ void mgt_dispatcher(_adapter *padapter, union recv_frame *precv_frame) { int index; struct mlme_handler *ptable; -#ifdef CONFIG_AP_MODE - struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -#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, get_addr2_ptr(pframe)); - struct dvobj_priv *psdpriv = padapter->dvobj; - struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; + struct recv_priv *precvpriv = &padapter->recvpriv; #if 0 @@ -1395,7 +1282,25 @@ void mgt_dispatcher(_adapter *padapter, union recv_frame *precv_frame) /* receive the frames that ra(a1) is my address or ra(a1) is bc address. */ if (!_rtw_memcmp(GetAddr1Ptr(pframe), adapter_mac_addr(padapter), ETH_ALEN) && !_rtw_memcmp(GetAddr1Ptr(pframe), bc_addr, ETH_ALEN)) +#ifdef CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI + { + struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); + + if (check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE) != _TRUE) + return; + + if (check_fwstate(&padapter->mlmepriv, _FW_LINKED) == _TRUE) + return; + + if ( pwdev_priv->pno_mac_addr[0] == 0xFF) + return; + + if (!_rtw_memcmp(GetAddr1Ptr(pframe), adapter_pno_mac_addr(padapter), ETH_ALEN)) + return; + } +#else return; +#endif ptable = mlme_sta_tbl; @@ -1421,7 +1326,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; } @@ -1438,7 +1343,7 @@ void mgt_dispatcher(_adapter *padapter, union recv_frame *precv_frame) #ifdef CONFIG_AP_MODE switch (get_frame_sub_type(pframe)) { case WIFI_AUTH: - if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) + if (MLME_IS_AP(padapter) || MLME_IS_MESH(padapter)) ptable->func = &OnAuth; else ptable->func = &OnAuthClient; @@ -1446,32 +1351,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 @@ -1583,7 +1486,7 @@ unsigned int OnProbeReq(_adapter *padapter, union recv_frame *precv_frame) /* Commented by Kurt 2012/10/16 */ /* IOT issue: Google Nexus7 use 1M rate to send p2p_probe_req after GO nego completed and Nexus7 is client */ if (padapter->registrypriv.wifi_spec == 1) { - if (pattrib->data_rate <= 3) + if (pattrib->data_rate <= DESC_RATE11M) wifi_test_chk_rate = 0; } @@ -1613,7 +1516,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; @@ -1687,41 +1590,37 @@ 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); + /* AID assignment */ + if (psta->cmn.aid > 0) + RTW_INFO(FUNC_ADPT_FMT" old AID=%d\n", FUNC_ADPT_ARG(padapter), psta->cmn.aid); else { - for (psta->aid = 1; psta->aid <= NUM_STA; psta->aid++) - if (pstapriv->sta_aid[psta->aid - 1] == NULL) - break; - - if (psta->aid > pstapriv->max_num_sta) { - psta->aid = 0; - RTW_INFO("no room for more AIDs\n"); + if (!rtw_aid_alloc(padapter, psta)) { + RTW_INFO(FUNC_ADPT_FMT" no room for more AIDs\n", FUNC_ADPT_ARG(padapter)); return _SUCCESS; - } else { - pstapriv->sta_aid[psta->aid - 1] = psta; - RTW_INFO("allocate new AID = (%d)\n", psta->aid); } + RTW_INFO(FUNC_ADPT_FMT" allocate new AID=%d\n", FUNC_ADPT_ARG(padapter), 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; - psta->htpriv.ampdu_enable = _FALSE; - psta->htpriv.sgi_20m = _FALSE; - psta->htpriv.sgi_40m = _FALSE; - psta->htpriv.ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; - psta->htpriv.agg_enable_bitmap = 0x0;/* reset */ - psta->htpriv.candidate_tid_bitmap = 0x0;/* reset */ + if(padapter->registrypriv.ht_enable && + is_supported_ht(padapter->registrypriv.wireless_mode)) { + psta->htpriv.ht_option = _TRUE; + psta->htpriv.ampdu_enable = _FALSE; + psta->htpriv.sgi_20m = _FALSE; + psta->htpriv.sgi_40m = _FALSE; + psta->htpriv.ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; + psta->htpriv.agg_enable_bitmap = 0x0;/* reset */ + psta->htpriv.candidate_tid_bitmap = 0x0;/* reset */ + } #endif rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, psta, _TRUE); @@ -1732,7 +1631,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); } @@ -1767,9 +1666,20 @@ unsigned int OnProbeReq(_adapter *padapter, union recv_frame *precv_frame) goto _issue_probersp; if ((ielen != 0 && _FALSE == _rtw_memcmp((void *)(p + 2), (void *)cur->Ssid.Ssid, cur->Ssid.SsidLength)) - || (ielen == 0 && pmlmeinfo->hidden_ssid_mode) - ) - return _SUCCESS; + || (ielen == 0 && pmlmeinfo->hidden_ssid_mode)) + goto exit; + + #ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(padapter)) { + p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + _PROBEREQ_IE_OFFSET_, WLAN_EID_MESH_ID, (int *)&ielen, + len - WLAN_HDR_A3_LEN - _PROBEREQ_IE_OFFSET_); + + if (!p) + goto exit; + if (ielen != 0 && _rtw_memcmp((void *)(p + 2), (void *)cur->mesh_id.Ssid, cur->mesh_id.SsidLength) == _FALSE) + goto exit; + } + #endif _issue_probersp: if (((check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE && @@ -1780,16 +1690,14 @@ unsigned int OnProbeReq(_adapter *padapter, union recv_frame *precv_frame) } +exit: return _SUCCESS; } unsigned int OnProbeRsp(_adapter *padapter, union recv_frame *precv_frame) { - struct sta_info *psta; struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); - struct sta_priv *pstapriv = &padapter->stapriv; u8 *pframe = precv_frame->u.hdr.rx_data; #ifdef CONFIG_P2P struct wifidirect_info *pwdinfo = &padapter->wdinfo; @@ -1836,7 +1744,12 @@ 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)) + || (MLME_IS_MESH(padapter) && check_fwstate(&padapter->mlmepriv, WIFI_ASOC_STATE)) + #ifdef CONFIG_RTW_REPEATER_SON + || (padapter->rtw_rson_scanstage == RSON_SCAN_PROCESS) + #endif + ) { rtw_mi_report_survey_event(padapter, precv_frame); return _SUCCESS; } @@ -1871,12 +1784,11 @@ static void rtw_check_legacy_ap(_adapter *padapter, u8 *pframe, u32 len) if (pmlmeext->bstart_bss == _TRUE) { int left; - u16 capability; unsigned char *pos; struct rtw_ieee802_11_elems elems; - struct HT_info_element *pht_info = NULL; +#ifdef CONFIG_80211N_HT u16 cur_op_mode; - +#endif /* checking IEs */ left = len - sizeof(struct rtw_ieee80211_hdr_3addr) - _BEACON_IE_OFFSET_; pos = pframe + sizeof(struct rtw_ieee80211_hdr_3addr) + _BEACON_IE_OFFSET_; @@ -1884,9 +1796,9 @@ static void rtw_check_legacy_ap(_adapter *padapter, u8 *pframe, u32 len) RTW_INFO("%s: parse fail for "MAC_FMT"\n", __func__, MAC_ARG(GetAddr3Ptr(pframe))); 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) { @@ -1911,8 +1823,6 @@ unsigned int OnBeacon(_adapter *padapter, union recv_frame *precv_frame) uint len = precv_frame->u.hdr.len; WLAN_BSSID_EX *pbss; int ret = _SUCCESS; - u8 *p = NULL; - u32 ielen = 0; #ifdef CONFIG_TDLS struct sta_info *ptdls_sta; struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; @@ -1923,28 +1833,29 @@ unsigned int OnBeacon(_adapter *padapter, union recv_frame *precv_frame) 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_); - if ((p != NULL) && (ielen > 0)) { - if ((*(p + 1 + ielen) == 0x2D) && (*(p + 2 + ielen) != 0x2D)) { - /* Invalid value 0x2D is detected in Extended Supported Rates (ESR) IE. Try to fix the IE length to avoid failed Beacon parsing. */ - RTW_INFO("[WIFIDBG] Error in ESR IE is detected in Beacon of BSSID:"MAC_FMT". Fix the length of ESR IE to avoid failed Beacon parsing.\n", MAC_ARG(GetAddr3Ptr(pframe))); - *(p + 1) = ielen - 1; - } - } -#endif - if (mlmeext_chk_scan_state(pmlmeext, SCAN_PROCESS)) { + if (mlmeext_chk_scan_state(pmlmeext, SCAN_PROCESS) + || (MLME_IS_MESH(padapter) && check_fwstate(pmlmepriv, WIFI_ASOC_STATE)) + ) { 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() || pmlmeext->join_abort) + ) { + if (rtw_sta_linking_test_force_fail() || pmlmeext->join_abort) { + 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) { @@ -1959,12 +1870,13 @@ unsigned int OnBeacon(_adapter *padapter, union recv_frame *precv_frame) RTW_INFO("%s: beacon keys ready\n", __func__); _rtw_memcpy(&pmlmepriv->cur_beacon_keys, &recv_beacon, sizeof(recv_beacon)); - pmlmepriv->new_beacon_cnts = 0; } else { RTW_ERR("%s: get beacon keys failed\n", __func__); _rtw_memset(&pmlmepriv->cur_beacon_keys, 0, sizeof(recv_beacon)); - pmlmepriv->new_beacon_cnts = 0; } + #ifdef CONFIG_BCN_CNT_CONFIRM_HDL + pmlmepriv->new_beacon_cnts = 0; + #endif } rtw_mfree((u8 *)pbss, sizeof(WLAN_BSSID_EX)); } @@ -1974,17 +1886,12 @@ unsigned int OnBeacon(_adapter *padapter, union recv_frame *precv_frame) /* update TSF Value */ update_TSF(pmlmeext, pframe, len); - - /* reset for adaptive_early_32k */ - pmlmeext->adaptive_tsf_done = _FALSE; - pmlmeext->DrvBcnEarly = 0xff; - pmlmeext->DrvBcnTimeOut = 0xff; pmlmeext->bcn_cnt = 0; - _rtw_memset(pmlmeext->bcn_delay_cnt, 0, sizeof(pmlmeext->bcn_delay_cnt)); - _rtw_memset(pmlmeext->bcn_delay_ratio, 0, sizeof(pmlmeext->bcn_delay_ratio)); + pmlmeext->last_bcn_cnt = 0; #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) @@ -2018,7 +1925,9 @@ unsigned int OnBeacon(_adapter *padapter, union recv_frame *precv_frame) return _SUCCESS; } #endif /* CONFIG_PATCH_JOIN_WRONG_CHANNEL */ - +#ifdef CONFIG_RTW_80211R + rtw_ft_update_bcn(padapter, precv_frame); +#endif ret = rtw_check_bcn_info(padapter, pframe, len); if (!ret) { RTW_PRINT("ap has changed, disconnect now\n "); @@ -2032,10 +1941,11 @@ 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; - - adaptive_early_32k(pmlmeext, pframe, len); - + pmlmepriv->cur_network_scanned->network.Rssi = precv_frame->u.hdr.attrib.phy_info.recv_signal_power; + pmlmeext->bcn_cnt++; +#ifdef CONFIG_BCN_RECV_TIME + rtw_rx_bcn_time_update(padapter, len, precv_frame->u.hdr.attrib.data_rate); +#endif #ifdef CONFIG_TDLS #ifdef CONFIG_TDLS_CH_SW if (rtw_tdls_is_chsw_allowed(padapter) == _TRUE) { @@ -2052,15 +1962,17 @@ unsigned int OnBeacon(_adapter *padapter, union recv_frame *precv_frame) #endif #endif /* CONFIG_TDLS */ -#ifdef CONFIG_DFS - process_csa_ie(padapter, pframe, len); /* channel switch announcement */ -#endif /* CONFIG_DFS */ + #ifdef CONFIG_DFS + process_csa_ie(padapter + , pframe + WLAN_HDR_A3_LEN + _BEACON_IE_OFFSET_ + , len - (WLAN_HDR_A3_LEN + _BEACON_IE_OFFSET_)); + #endif #ifdef CONFIG_P2P_PS process_p2p_ps_ie(padapter, (pframe + WLAN_HDR_A3_LEN), (len - WLAN_HDR_A3_LEN)); #endif /* CONFIG_P2P_PS */ - if (pmlmeext->en_hw_update_tsf) + if (pmlmeext->tsf_update_required && pmlmeext->en_hw_update_tsf) rtw_enable_hw_update_tsf_cmd(padapter); #if 0 /* move to validate_recv_mgnt_frame */ @@ -2069,7 +1981,6 @@ unsigned int OnBeacon(_adapter *padapter, union recv_frame *precv_frame) } } else if ((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE) { - _irqL irqL; u8 rate_set[16]; u8 rate_num = 0; @@ -2082,7 +1993,7 @@ unsigned int OnBeacon(_adapter *padapter, union recv_frame *precv_frame) if ((sta_rx_pkts(psta) & 0xf) == 0) update_beacon_info(padapter, pframe, len, psta); - if (pmlmeext->en_hw_update_tsf) + if (pmlmeext->tsf_update_required && pmlmeext->en_hw_update_tsf) rtw_enable_hw_update_tsf_cmd(padapter); } else { rtw_ies_get_supported_rate(pframe + WLAN_HDR_A3_LEN + _BEACON_IE_OFFSET_, len - WLAN_HDR_A3_LEN - _BEACON_IE_OFFSET_, rate_set, &rate_num); @@ -2147,6 +2058,14 @@ unsigned int OnAuth(_adapter *padapter, union recv_frame *precv_frame) if ((pmlmeinfo->state & 0x03) != WIFI_FW_AP_STATE) return _FAIL; + if (!MLME_IS_ASOC(padapter)) + return _SUCCESS; + +#if defined(CONFIG_IOCTL_CFG80211) && defined(CONFIG_RTW_MESH) + if (MLME_IS_MESH(padapter)) + return rtw_mesh_on_auth(padapter, precv_frame); +#endif + RTW_INFO("+OnAuth\n"); sa = get_addr2_ptr(pframe); @@ -2176,9 +2095,16 @@ unsigned int OnAuth(_adapter *padapter, union recv_frame *precv_frame) RTW_INFO("auth alg=%x, seq=%X\n", algorithm, seq); - if (auth_mode == 2 && - psecuritypriv->dot11PrivacyAlgrthm != _WEP40_ && - psecuritypriv->dot11PrivacyAlgrthm != _WEP104_) + if (rtw_ap_linking_test_force_auth_fail()) { + status = rtw_ap_linking_test_force_auth_fail(); + RTW_INFO(FUNC_ADPT_FMT" force auth fail with status:%u\n" + , FUNC_ADPT_ARG(padapter), status); + goto auth_fail; + } + + if ((auth_mode == 2) && (algorithm != WLAN_AUTH_SAE) && + (psecuritypriv->dot11PrivacyAlgrthm != _WEP40_) && + (psecuritypriv->dot11PrivacyAlgrthm != _WEP104_)) auth_mode = 0; if ((algorithm > 0 && auth_mode == 0) || /* rx a shared-key auth but shared not enabled */ @@ -2252,6 +2178,17 @@ unsigned int OnAuth(_adapter *padapter, union recv_frame *precv_frame) if (pstat->auth_seq == 0) pstat->expire_to = pstapriv->auth_to; +#ifdef CONFIG_IOCTL_CFG80211 + if (GET_CFG80211_REPORT_MGMT(adapter_wdev_data(padapter), IEEE80211_STYPE_AUTH) == _TRUE) { + if ((algorithm == WLAN_AUTH_SAE) && + (auth_mode == dot11AuthAlgrthm_8021X)) { + pstat->authalg = algorithm; + + rtw_cfg80211_rx_mframe(padapter, precv_frame, NULL); + return _SUCCESS; + } + } +#endif /* CONFIG_IOCTL_CFG80211 */ if ((pstat->auth_seq + 1) != seq) { RTW_INFO("(1)auth rejected because out of seq [rx_seq=%d, exp_seq=%d]!\n", @@ -2350,7 +2287,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, ETH_ALEN); #ifdef CONFIG_NATIVEAP_MLME issue_auth(padapter, pstat, (unsigned short)status); @@ -2368,22 +2305,31 @@ unsigned int OnAuthClient(_adapter *padapter, union recv_frame *precv_frame) unsigned int go2asoc = 0; struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -#ifdef CONFIG_RTW_80211R - struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); - ft_priv *pftpriv = &pmlmepriv->ftpriv; - struct sta_priv *pstapriv = &padapter->stapriv; - struct sta_info *psta = NULL; -#endif u8 *pframe = precv_frame->u.hdr.rx_data; uint pkt_len = precv_frame->u.hdr.len; RTW_INFO("%s\n", __FUNCTION__); +#ifdef CONFIG_IOCTL_CFG80211 + if (GET_CFG80211_REPORT_MGMT(adapter_wdev_data(padapter), IEEE80211_STYPE_AUTH) == _TRUE) { + if (rtw_sec_chk_auth_type(padapter, NL80211_AUTHTYPE_SAE)) { + if (rtw_cached_pmkid(padapter, get_my_bssid(&pmlmeinfo->network)) != -1) { + RTW_INFO("SAE: PMKSA cache entry found\n"); + goto normal; + } + rtw_cfg80211_rx_mframe(padapter, precv_frame, NULL); + return _SUCCESS; + } + } + +normal: +#endif /* CONFIG_IOCTL_CFG80211 */ + /* check A1 matches or not */ if (!_rtw_memcmp(adapter_mac_addr(padapter), get_da(pframe), ETH_ALEN)) return _SUCCESS; - if (!(pmlmeinfo->state & WIFI_FW_AUTH_STATE)) + if (!(pmlmeinfo->state & WIFI_FW_AUTH_STATE) || pmlmeext->join_abort) return _SUCCESS; offset = (GetPrivacy(pframe)) ? 4 : 0; @@ -2402,6 +2348,7 @@ unsigned int OnAuthClient(_adapter *padapter, union recv_frame *precv_frame) /* pmlmeinfo->reauth_count = 0; */ } + pmlmeinfo->auth_status = status; set_link_timer(pmlmeext, 1); goto authclnt_fail; } @@ -2440,29 +2387,9 @@ unsigned int OnAuthClient(_adapter *padapter, union recv_frame *precv_frame) if (go2asoc) { #ifdef CONFIG_RTW_80211R - if ((rtw_to_roam(padapter) > 0) && rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) { - u8 target_ap_addr[ETH_ALEN] = {0}; - - if ((rtw_chk_ft_status(padapter, RTW_FT_AUTHENTICATED_STA)) || - (rtw_chk_ft_status(padapter, RTW_FT_ASSOCIATING_STA)) || - (rtw_chk_ft_status(padapter, RTW_FT_ASSOCIATED_STA))) { - /*report_ft_reassoc_event already, and waiting for cfg80211_rtw_update_ft_ies*/ - return _SUCCESS; - } - - rtw_buf_update(&pmlmepriv->auth_rsp, &pmlmepriv->auth_rsp_len, pframe, pkt_len); - pftpriv->ft_event.ies = pmlmepriv->auth_rsp + sizeof(struct rtw_ieee80211_hdr_3addr) + 6; - pftpriv->ft_event.ies_len = pmlmepriv->auth_rsp_len - sizeof(struct rtw_ieee80211_hdr_3addr) - 6; - - /*Not support RIC*/ - pftpriv->ft_event.ric_ies = NULL; - pftpriv->ft_event.ric_ies_len = 0; - _rtw_memcpy(target_ap_addr, pmlmepriv->assoc_bssid, ETH_ALEN); - report_ft_reassoc_event(padapter, target_ap_addr); + if (rtw_ft_update_auth_rsp_ies(padapter, pframe, pkt_len)) return _SUCCESS; - } #endif - RTW_PRINT("auth success, start assoc\n"); start_clnt_assoc(padapter); return _SUCCESS; @@ -2480,18 +2407,13 @@ unsigned int OnAssocReq(_adapter *padapter, union recv_frame *precv_frame) { #ifdef CONFIG_AP_MODE _irqL irqL; - u16 capab_info, listen_interval; + u16 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, *pos; + int 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); @@ -2538,17 +2460,19 @@ unsigned int OnAssocReq(_adapter *padapter, union recv_frame *precv_frame) 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__); + if (pstat->authalg == WLAN_AUTH_SAE) { + /* WPA3-SAE */ + if (((pstat->state) & WIFI_FW_AUTH_NULL)) { + /* TODO: + Queue AssocReq and Proccess + by external auth trigger. */ + RTW_INFO("%s: wait external auth trigger\n", __func__); + return _SUCCESS; + } + } + /* check if this stat has been successfully authenticated/assocated */ if (!((pstat->state) & WIFI_FW_AUTH_SUCCESS)) { if (!((pstat->state) & WIFI_FW_ASSOC_SUCCESS)) { @@ -2563,7 +2487,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; @@ -2571,8 +2494,26 @@ unsigned int OnAssocReq(_adapter *padapter, union recv_frame *precv_frame) } #endif - pstat->capability = capab_info; + if (rtw_ap_linking_test_force_asoc_fail()) { + status = rtw_ap_linking_test_force_asoc_fail(); + RTW_INFO(FUNC_ADPT_FMT" force asoc fail with status:%u\n" + , FUNC_ADPT_ARG(padapter), status); + goto OnAssocReqFail; + } + /* 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) { @@ -2587,290 +2528,46 @@ 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; +#ifdef CONFIG_RTS_FULL_BW + /*check vendor IE*/ + rtw_parse_sta_vendor_ie_8812(padapter, pstat + , pframe + WLAN_HDR_A3_LEN + ie_offset, pkt_len - WLAN_HDR_A3_LEN - ie_offset); +#endif/*CONFIG_RTS_FULL_BW*/ - 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; @@ -2879,24 +2576,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; @@ -2920,44 +2599,37 @@ 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); + /* AID assignment */ + if (pstat->cmn.aid > 0) + RTW_INFO(FUNC_ADPT_FMT" old AID=%d\n", FUNC_ADPT_ARG(padapter), 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; - - RTW_INFO(" no room for more AIDs\n"); - - status = WLAN_STATUS_AP_UNABLE_TO_HANDLE_NEW_STA; - - goto OnAssocReqFail; - - - } else { - pstapriv->sta_aid[pstat->aid - 1] = pstat; - RTW_INFO("allocate new AID = (%d)\n", pstat->aid); - break; - } - } + if (!rtw_aid_alloc(padapter, pstat)) { + RTW_INFO(FUNC_ADPT_FMT" no room for more AIDs\n", FUNC_ADPT_ARG(padapter)); + status = WLAN_STATUS_AP_UNABLE_TO_HANDLE_NEW_STA; + goto OnAssocReqFail; } + RTW_INFO(FUNC_ADPT_FMT" allocate new AID=%d\n", FUNC_ADPT_ARG(padapter), pstat->cmn.aid); } - 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 */ @@ -3019,12 +2691,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); + if (pstat->bpairwise_key_installed == _TRUE && SEC_IS_BIP_KEY_INSTALLED(&padapter->securitypriv) == _TRUE) { + 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 */ @@ -3044,7 +2716,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 @@ -3058,6 +2730,34 @@ unsigned int OnAssocReq(_adapter *padapter, union recv_frame *precv_frame) } +#if defined(CONFIG_LAYER2_ROAMING) && defined(CONFIG_RTW_80211K) +void rtw_roam_nb_discover(_adapter *padapter, u8 bfroce) +{ + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + struct sta_priv *pstapriv = &padapter->stapriv; + struct sta_info *psta; + u8 nb_req_issue = _FALSE; + + if (!check_fwstate(pmlmepriv, _FW_LINKED)) + return; + + if (!rtw_chk_roam_flags(padapter, RTW_ROAM_ACTIVE)) + return; + + psta = rtw_get_stainfo(pstapriv, pmlmeinfo->network.MacAddress); + if (!psta) + return; + + if (bfroce || (!pmlmepriv->nb_info.nb_rpt_is_same)) + nb_req_issue = _TRUE; + + if (nb_req_issue && (psta->rm_en_cap[0] & RTW_RRM_NB_RPT_EN)) + rm_add_nb_req(padapter, psta); +} +#endif + unsigned int OnAssocRsp(_adapter *padapter, union recv_frame *precv_frame) { uint i; @@ -3070,7 +2770,9 @@ unsigned int OnAssocRsp(_adapter *padapter, union recv_frame *precv_frame) /* WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); */ u8 *pframe = precv_frame->u.hdr.rx_data; uint pkt_len = precv_frame->u.hdr.len; +#ifdef CONFIG_WAPI_SUPPORT PNDIS_802_11_VARIABLE_IEs pWapiIE = NULL; +#endif RTW_INFO("%s\n", __FUNCTION__); @@ -3078,7 +2780,7 @@ unsigned int OnAssocRsp(_adapter *padapter, union recv_frame *precv_frame) if (!_rtw_memcmp(adapter_mac_addr(padapter), get_da(pframe), ETH_ALEN)) return _SUCCESS; - if (!(pmlmeinfo->state & (WIFI_FW_AUTH_SUCCESS | WIFI_FW_ASSOC_STATE))) + if (!(pmlmeinfo->state & (WIFI_FW_AUTH_SUCCESS | WIFI_FW_ASSOC_STATE)) || pmlmeext->join_abort) return _SUCCESS; if (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) @@ -3103,6 +2805,14 @@ unsigned int OnAssocRsp(_adapter *padapter, union recv_frame *precv_frame) /* AID */ res = pmlmeinfo->aid = (int)(le16_to_cpu(*(unsigned short *)(pframe + WLAN_HDR_A3_LEN + 4)) & 0x3fff); + + /* check aid value */ + if (res < 1 || res > 2007) { + RTW_INFO("assoc reject, aid: %d\n", res); + pmlmeinfo->state = WIFI_FW_NULL_STATE; + res = -4; + goto report_assoc_result; + } /* following are moved to join event callback function */ /* to handle HT, WMM, rate adaptive, update MAC reg */ @@ -3128,6 +2838,9 @@ unsigned int OnAssocRsp(_adapter *padapter, union recv_frame *precv_frame) case _HT_CAPABILITY_IE_: /* HT caps */ HT_caps_handler(padapter, pIE); +#ifdef ROKU_PRIVATE + HT_caps_handler_infra_ap(padapter, pIE); +#endif /* ROKU_PRIVATE */ break; case _HT_EXTRA_INFO_IE_: /* HT info */ @@ -3137,6 +2850,9 @@ unsigned int OnAssocRsp(_adapter *padapter, union recv_frame *precv_frame) #ifdef CONFIG_80211AC_VHT case EID_VHTCapability: VHT_caps_handler(padapter, pIE); +#ifdef ROKU_PRIVATE + VHT_caps_handler_infra_ap(padapter, pIE); +#endif /* ROKU_PRIVATE */ break; case EID_VHTOperation: @@ -3155,6 +2871,23 @@ 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 + +#ifdef ROKU_PRIVATE + /* Infra mode, used to store AP's info , Parse the supported rates from AssocRsp */ + case _SUPPORTEDRATES_IE_: + Supported_rate_infra_ap(padapter, pIE); + break; + + case _EXT_SUPPORTEDRATES_IE_: + Extended_Supported_rate_infra_ap(padapter, pIE); + break; +#endif /* ROKU_PRIVATE */ default: break; } @@ -3178,8 +2911,11 @@ unsigned int OnAssocRsp(_adapter *padapter, union recv_frame *precv_frame) else rtw_buf_free(&pmlmepriv->assoc_rsp, &pmlmepriv->assoc_rsp_len); - report_join_res(padapter, res); + report_join_res(padapter, res, status); +#if defined(CONFIG_LAYER2_ROAMING) && defined(CONFIG_RTW_80211K) + rtw_roam_nb_discover(padapter, _TRUE); +#endif return _SUCCESS; } @@ -3209,10 +2945,8 @@ unsigned int OnDeAuth(_adapter *padapter, union recv_frame *precv_frame) reason = le16_to_cpu(*(unsigned short *)(pframe + WLAN_HDR_A3_LEN)); - 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; @@ -3244,7 +2978,7 @@ unsigned int OnDeAuth(_adapter *padapter, union recv_frame *precv_frame) return _SUCCESS; } else #endif - { + if (!MLME_IS_MESH(padapter)) { int ignore_received_deauth = 0; /* Commented by Albert 20130604 */ @@ -3299,10 +3033,8 @@ unsigned int OnDisassoc(_adapter *padapter, union recv_frame *precv_frame) reason = le16_to_cpu(*(unsigned short *)(pframe + WLAN_HDR_A3_LEN)); - 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; @@ -3333,7 +3065,7 @@ unsigned int OnDisassoc(_adapter *padapter, union recv_frame *precv_frame) return _SUCCESS; } else #endif - { + if (!MLME_IS_MESH(padapter)) { RTW_PRINT(FUNC_ADPT_FMT" reason=%u, ta=%pM\n" , FUNC_ADPT_ARG(padapter), reason, get_addr2_ptr(pframe)); @@ -3369,7 +3101,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) { @@ -3400,7 +3132,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: @@ -3418,8 +3150,6 @@ unsigned int on_action_spct(_adapter *padapter, union recv_frame *precv_frame) u8 category; u8 action; - RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(padapter->pnetdev)); - psta = rtw_get_stainfo(pstapriv, get_addr2_ptr(pframe)); if (!psta) @@ -3430,6 +3160,9 @@ unsigned int on_action_spct(_adapter *padapter, union recv_frame *precv_frame) goto exit; action = frame_body[1]; + + RTW_INFO(FUNC_ADPT_FMT" action:%u\n", FUNC_ADPT_ARG(padapter), action); + switch (action) { case RTW_WLAN_ACTION_SPCT_MSR_REQ: case RTW_WLAN_ACTION_SPCT_MSR_RPRT: @@ -3438,8 +3171,13 @@ unsigned int on_action_spct(_adapter *padapter, union recv_frame *precv_frame) break; case RTW_WLAN_ACTION_SPCT_CHL_SWITCH: #ifdef CONFIG_SPCT_CH_SWITCH - ret = on_action_spct_ch_switch(padapter, psta, &frame_body[2], - frame_len - (frame_body - pframe) - 2); + ret = on_action_spct_ch_switch(padapter, psta + , frame_body + 2, frame_len - (frame_body - pframe) - 2); +#elif defined(CONFIG_DFS) + if (MLME_IS_STA(padapter) && MLME_IS_ASOC(padapter)) { + process_csa_ie(padapter + , frame_body + 2, frame_len - (frame_body - pframe) - 2); + } #endif break; default: @@ -3465,12 +3203,13 @@ unsigned int on_action_wnm(_adapter *adapter, union recv_frame *rframe) { unsigned int ret = _FAIL; struct sta_info *sta = NULL; - struct sta_priv *stapriv = &adapter->stapriv; + struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); + struct sta_priv *stapriv = &(adapter->stapriv); u8 *frame = rframe->u.hdr.rx_data; - uint frame_len = rframe->u.hdr.len; + u32 frame_len = rframe->u.hdr.len; u8 *frame_body = (u8 *)(frame + sizeof(struct rtw_ieee80211_hdr_3addr)); - u8 category; - u8 action; + u32 frame_body_len = frame_len - sizeof(struct rtw_ieee80211_hdr_3addr); + u8 category, action; int cnt = 0; char msg[16]; @@ -3485,6 +3224,15 @@ unsigned int on_action_wnm(_adapter *adapter, union recv_frame *rframe) action = frame_body[1]; switch (action) { +#ifdef CONFIG_RTW_80211R + case RTW_WLAN_ACTION_WNM_BTM_REQ: + if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) { + RTW_INFO("WNM: RTW_WLAN_ACTION_WNM_BTM_REQ recv.\n"); + rtw_wnm_process_btm_req(adapter, frame_body, frame_body_len); + } + ret = _SUCCESS; + break; +#endif default: #ifdef CONFIG_IOCTL_CFG80211 cnt += sprintf((msg + cnt), "ACT_WNM %u", action); @@ -3510,11 +3258,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); @@ -3712,6 +3455,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 @@ -3745,19 +3517,27 @@ 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 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; @@ -3785,11 +3565,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; } @@ -3805,6 +3592,7 @@ 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 @@ -3866,8 +3654,14 @@ unsigned int OnAction_back(_adapter *padapter, union recv_frame *precv_frame) psta->htpriv.agg_enable_bitmap |= 1 << tid; psta->htpriv.candidate_tid_bitmap &= ~BIT(tid); /* amsdu in ampdu */ - if (frame_body[5] & 1) + 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); @@ -3908,50 +3702,46 @@ unsigned int OnAction_back(_adapter *padapter, union recv_frame *precv_frame) return _SUCCESS; } -#ifdef CONFIG_P2P +#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE +u32 rtw_build_vendor_ie(_adapter *padapter , unsigned char **pframe , u8 mgmt_frame_tyte) +{ + int vendor_ie_num = 0; + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + u32 len = 0; -static int get_reg_classes_full_count(struct p2p_channels channel_list) + for (vendor_ie_num = 0 ; vendor_ie_num < WLAN_MAX_VENDOR_IE_NUM ; vendor_ie_num++) { + if (pmlmepriv->vendor_ielen[vendor_ie_num] > 0 && pmlmepriv->vendor_ie_mask[vendor_ie_num] & mgmt_frame_tyte) { + _rtw_memcpy(*pframe , pmlmepriv->vendor_ie[vendor_ie_num] , pmlmepriv->vendor_ielen[vendor_ie_num]); + *pframe += pmlmepriv->vendor_ielen[vendor_ie_num]; + len += pmlmepriv->vendor_ielen[vendor_ie_num]; + } + } + + return len; +} +#endif + +#ifdef CONFIG_P2P +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); u8 oui_subtype = P2P_GO_NEGO_REQ; u8 wpsie[255] = { 0x00 }, p2pie[255] = { 0x00 }; - u8 wpsielen = 0, p2pielen = 0, i; - u8 channel_cnt_24g = 0, channel_cnt_5gl = 0, channel_cnt_5gh = 0; + u8 wpsielen = 0, p2pielen = 0; u16 len_channellist_attr = 0; #ifdef CONFIG_WFD u32 wfdielen = 0; @@ -3964,7 +3754,6 @@ void issue_p2p_GO_request(_adapter *padapter, u8 *raddr) unsigned short *fctrl; struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); struct wifidirect_info *pwdinfo = &(padapter->wdinfo); @@ -4176,8 +3965,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) @@ -4222,36 +4011,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: */ @@ -4356,17 +4131,16 @@ 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); u8 oui_subtype = P2P_GO_NEGO_RESP; u8 wpsie[255] = { 0x00 }, p2pie[255] = { 0x00 }; - u8 p2pielen = 0, i; + u8 p2pielen = 0; uint wpsielen = 0; u16 wps_devicepassword_id = 0x0000; uint wps_devicepassword_id_len = 0; - u8 channel_cnt_24g = 0, channel_cnt_5gl = 0, channel_cnt_5gh; u16 len_channellist_attr = 0; struct xmit_frame *pmgntframe; @@ -4376,7 +4150,6 @@ void issue_p2p_GO_response(_adapter *padapter, u8 *raddr, u8 *frame_body, uint l unsigned short *fctrl; struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); struct wifidirect_info *pwdinfo = &(padapter->wdinfo); #ifdef CONFIG_WFD @@ -4623,8 +4396,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) @@ -4669,37 +4442,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: */ @@ -4795,8 +4553,8 @@ void issue_p2p_GO_confirm(_adapter *padapter, u8 *raddr, u8 result) u8 action = P2P_PUB_ACTION_ACTION; u32 p2poui = cpu_to_be32(P2POUI); u8 oui_subtype = P2P_GO_NEGO_CONF; - u8 wpsie[255] = { 0x00 }, p2pie[255] = { 0x00 }; - u8 wpsielen = 0, p2pielen = 0; + u8 p2pie[255] = { 0x00 }; + u8 p2pielen = 0; struct xmit_frame *pmgntframe; struct pkt_attrib *pattrib; @@ -4805,7 +4563,6 @@ void issue_p2p_GO_confirm(_adapter *padapter, u8 *raddr, u8 result) unsigned short *fctrl; struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); struct wifidirect_info *pwdinfo = &(padapter->wdinfo); #ifdef CONFIG_WFD u32 wfdielen = 0; @@ -5025,15 +4782,14 @@ 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); u8 oui_subtype = P2P_INVIT_REQ; u8 p2pie[255] = { 0x00 }; - u8 p2pielen = 0, i; + u8 p2pielen = 0; u8 dialogToken = 3; - u8 channel_cnt_24g = 0, channel_cnt_5gl = 0, channel_cnt_5gh = 0; u16 len_channellist_attr = 0; #ifdef CONFIG_WFD u32 wfdielen = 0; @@ -5046,7 +4802,6 @@ void issue_p2p_invitation_request(_adapter *padapter, u8 *raddr) unsigned short *fctrl; struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); struct wifidirect_info *pwdinfo = &(padapter->wdinfo); @@ -5179,8 +4934,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) @@ -5222,36 +4977,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 */ @@ -5339,14 +5080,13 @@ 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); u8 oui_subtype = P2P_INVIT_RESP; u8 p2pie[255] = { 0x00 }; - u8 p2pielen = 0, i; - u8 channel_cnt_24g = 0, channel_cnt_5gl = 0, channel_cnt_5gh = 0; + u8 p2pielen = 0; u16 len_channellist_attr = 0; #ifdef CONFIG_WFD u32 wfdielen = 0; @@ -5359,7 +5099,6 @@ void issue_p2p_invitation_response(_adapter *padapter, u8 *raddr, u8 dialogToken unsigned short *fctrl; struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); struct wifidirect_info *pwdinfo = &(padapter->wdinfo); @@ -5497,8 +5236,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) @@ -5540,36 +5279,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); @@ -5609,7 +5334,6 @@ void issue_p2p_provision_request(_adapter *padapter, u8 *pssid, u8 ussidlen, u8 unsigned short *fctrl; struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); struct wifidirect_info *pwdinfo = &(padapter->wdinfo); @@ -5730,7 +5454,6 @@ void issue_probersp_p2p(_adapter *padapter, unsigned char *da) unsigned char *mac; struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); /* WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); */ u16 beacon_interval = 100; @@ -5741,9 +5464,6 @@ void issue_probersp_p2p(_adapter *padapter, unsigned char *da) #ifdef CONFIG_WFD u32 wfdielen = 0; #endif -#ifdef CONFIG_INTEL_WIDI - u8 zero_array_check[L2SDTA_SERVICE_VE_LEN] = { 0x00 }; -#endif /* CONFIG_INTEL_WIDI */ /* RTW_INFO("%s\n", __FUNCTION__); */ @@ -5851,39 +5571,6 @@ void issue_probersp_p2p(_adapter *padapter, unsigned char *da) /* Value: */ wpsie[wpsielen++] = WPS_VERSION_1; /* Version 1.0 */ -#ifdef CONFIG_INTEL_WIDI - /* Commented by Kurt */ - /* Appended WiDi info. only if we did issued_probereq_widi(), and then we saved ven. ext. in pmlmepriv->sa_ext. */ - if (_rtw_memcmp(pmlmepriv->sa_ext, zero_array_check, L2SDTA_SERVICE_VE_LEN) == _FALSE - || pmlmepriv->num_p2p_sdt != 0) { - /* Sec dev type */ - *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_SEC_DEV_TYPE_LIST); - wpsielen += 2; - - /* Length: */ - *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0008); - wpsielen += 2; - - /* Value: */ - /* Category ID */ - *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_PDT_CID_DISPLAYS); - wpsielen += 2; - - /* OUI */ - *(u32 *)(wpsie + wpsielen) = cpu_to_be32(INTEL_DEV_TYPE_OUI); - wpsielen += 4; - - *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_PDT_SCID_WIDI_CONSUMER_SINK); - wpsielen += 2; - - if (_rtw_memcmp(pmlmepriv->sa_ext, zero_array_check, L2SDTA_SERVICE_VE_LEN) == _FALSE) { - /* Vendor Extension */ - _rtw_memcpy(wpsie + wpsielen, pmlmepriv->sa_ext, L2SDTA_SERVICE_VE_LEN); - wpsielen += L2SDTA_SERVICE_VE_LEN; - } - } -#endif /* CONFIG_INTEL_WIDI */ - /* WiFi Simple Config State */ /* Type: */ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_SIMPLE_CONF_STATE); @@ -6039,6 +5726,11 @@ void issue_probersp_p2p(_adapter *padapter, unsigned char *da) pattrib->pktlen += wfdielen; #endif +/* Vendor Specific IE */ +#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE + pattrib->pktlen += rtw_build_vendor_ie(padapter , &pframe , WIFI_P2P_PROBERESP_VENDOR_IE_BIT); +#endif + pattrib->last_txcmdsz = pattrib->pktlen; @@ -6057,11 +5749,8 @@ int _issue_probereq_p2p(_adapter *padapter, u8 *da, int wait_ack) struct rtw_ieee80211_hdr *pwlanhdr; unsigned short *fctrl; unsigned char *mac; - unsigned char bssrate[NumRates]; struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); - int bssrate_len = 0; u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; struct wifidirect_info *pwdinfo = &(padapter->wdinfo); u8 wpsie[255] = { 0x00 }, p2pie[255] = { 0x00 }; @@ -6357,6 +6046,11 @@ int _issue_probereq_p2p(_adapter *padapter, u8 *da, int wait_ack) pattrib->pktlen += wfdielen; #endif +/* Vendor Specific IE */ +#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE + pattrib->pktlen += rtw_build_vendor_ie(padapter , &pframe , WIFI_P2P_PROBEREQ_VENDOR_IE_BIT); +#endif + pattrib->last_txcmdsz = pattrib->pktlen; @@ -6385,7 +6079,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); @@ -6456,7 +6150,7 @@ unsigned int on_action_public_p2p(union recv_frame *precv_frame) u8 *frame_body; #ifdef CONFIG_P2P u8 *p2p_ie; - u32 p2p_ielen, wps_ielen; + u32 p2p_ielen; struct wifidirect_info *pwdinfo = &(padapter->wdinfo); u8 result = P2P_STATUS_SUCCESS; u8 empty_addr[ETH_ALEN] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }; @@ -6513,13 +6207,6 @@ unsigned int on_action_public_p2p(union recv_frame *precv_frame) result = process_p2p_group_negotation_req(pwdinfo, frame_body, len); 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; - _cancel_timer_ex(&(padapter->mlmepriv.listen_timer)); - intel_widi_wk_cmd(padapter, INTEL_WIDI_LISTEN_STOP_WK, NULL, 0); - } -#endif /* CONFIG_INTEL_WIDI */ /* Commented by Albert 20110718 */ /* No matter negotiating or negotiation failure, the driver should set up the restore P2P state timer. */ @@ -6594,7 +6281,6 @@ unsigned int on_action_public_p2p(union recv_frame *precv_frame) u8 status_code = P2P_STATUS_FAIL_INFO_UNAVAILABLE; struct group_id_info group_id; u8 invitation_flag = 0; - int j = 0; merged_p2p_ielen = rtw_get_p2p_merged_ies_len(frame_body + _PUBLIC_ACTION_IE_OFFSET_, len - _PUBLIC_ACTION_IE_OFFSET_); @@ -6641,7 +6327,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 @@ -6671,11 +6357,6 @@ unsigned int on_action_public_p2p(union recv_frame *precv_frame) } } else { rtw_p2p_set_state(pwdinfo, P2P_STATE_RECV_INVITE_REQ_DISMATCH); -#ifdef CONFIG_INTEL_WIDI - _rtw_memcpy(pwdinfo->p2p_peer_device_addr, group_id.go_device_addr , ETH_ALEN); - rtw_p2p_set_role(pwdinfo, P2P_ROLE_CLIENT); -#endif /* CONFIG_INTEL_WIDI */ - status_code = P2P_STATUS_FAIL_UNKNOWN_P2PGROUP; } } @@ -6721,13 +6402,6 @@ unsigned int on_action_public_p2p(union recv_frame *precv_frame) 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 - if (padapter->mlmepriv.widi_state == INTEL_WIDI_STATE_LISTEN) { - padapter->mlmepriv.widi_state = INTEL_WIDI_STATE_WFD_CONNECTION; - _cancel_timer_ex(&(padapter->mlmepriv.listen_timer)); - intel_widi_wk_cmd(padapter, INTEL_WIDI_LISTEN_STOP_WK, NULL, 0); - } -#endif /* CONFIG_INTEL_WIDI */ break; } case P2P_INVIT_RESP: { @@ -6792,13 +6466,6 @@ unsigned int on_action_public_p2p(union recv_frame *precv_frame) rtw_p2p_set_state(pwdinfo, P2P_STATE_RX_PROVISION_DIS_REQ); _set_timer(&pwdinfo->restore_p2p_state_timer, P2P_PROVISION_TIMEOUT); -#ifdef CONFIG_INTEL_WIDI - if (padapter->mlmepriv.widi_state == INTEL_WIDI_STATE_LISTEN) { - padapter->mlmepriv.widi_state = INTEL_WIDI_STATE_WFD_CONNECTION; - _cancel_timer_ex(&(padapter->mlmepriv.listen_timer)); - intel_widi_wk_cmd(padapter, INTEL_WIDI_LISTEN_STOP_WK, NULL, 0); - } -#endif /* CONFIG_INTEL_WIDI */ break; case P2P_PROVISION_DISC_RESP: @@ -6829,7 +6496,6 @@ unsigned int on_action_public_vendor(union recv_frame *precv_frame) { unsigned int ret = _FAIL; u8 *pframe = precv_frame->u.hdr.rx_data; - uint frame_len = precv_frame->u.hdr.len; u8 *frame_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); if (_rtw_memcmp(frame_body + 2, P2P_OUI, 4) == _TRUE) { @@ -6850,7 +6516,6 @@ unsigned int on_action_public_default(union recv_frame *precv_frame, u8 action) { unsigned int ret = _FAIL; u8 *pframe = precv_frame->u.hdr.rx_data; - uint frame_len = precv_frame->u.hdr.len; u8 *frame_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); u8 token; _adapter *adapter = precv_frame->u.hdr.adapter; @@ -6912,6 +6577,249 @@ unsigned int on_action_public(_adapter *padapter, union recv_frame *precv_frame) return ret; } +#if defined(CONFIG_RTW_WNM) || defined(CONFIG_RTW_80211K) +static u8 rtw_wnm_nb_elem_parsing( + u8* pdata, u32 data_len, u8 from_btm, + u32 *nb_rpt_num, u8 *nb_rpt_is_same, + struct roam_nb_info *pnb, struct wnm_btm_cant *pcandidates) +{ + u8 bfound = _FALSE, ret = _SUCCESS; + u8 *ptr, *pend, *op; + u32 elem_len, subelem_len, op_len; + u32 i, nb_rpt_entries = 0; + struct nb_rpt_hdr *pie; + struct wnm_btm_cant *pcandidate; + + if ((!pdata) || (!pnb)) + return _FAIL; + + if ((from_btm) && (!pcandidates)) + return _FAIL; + + ptr = pdata; + pend = ptr + data_len; + elem_len = data_len; + subelem_len = (u32)*(pdata+1); + + for (i=0; i < RTW_MAX_NB_RPT_NUM; i++) { + if (((ptr + 7) > pend) || (elem_len < subelem_len)) + break; + + if (*ptr != 0x34) { + RTW_ERR("WNM: invalid data(0x%2x)!\n", *ptr); + ret = _FAIL; + break; + } + + pie = (struct nb_rpt_hdr *)ptr; + if (from_btm) { + op = rtw_get_ie((u8 *)(ptr+15), + WNM_BTM_CAND_PREF_SUBEID, + &op_len, (subelem_len - 15)); + } + + ptr = (u8 *)(ptr + subelem_len + 2); + elem_len -= (subelem_len +2); + subelem_len = *(ptr+1); + if (from_btm) { + pcandidate = (pcandidates + i); + _rtw_memcpy(&pcandidate->nb_rpt, pie, sizeof(struct nb_rpt_hdr)); + if (op && (op_len !=0)) { + pcandidate->preference = *(op + 2); + bfound = _TRUE; + } else + pcandidate->preference = 0; + + RTW_DBG("WNM: preference check bssid("MAC_FMT + ") ,bss_info(0x%04X), reg_class(0x%02X), ch(%d)," + " phy_type(0x%02X), preference(0x%02X)\n", + MAC_ARG(pcandidate->nb_rpt.bssid), pcandidate->nb_rpt.bss_info, + pcandidate->nb_rpt.reg_class, pcandidate->nb_rpt.ch_num, + pcandidate->nb_rpt.phy_type, pcandidate->preference); + } else { + if (_rtw_memcmp(&pnb->nb_rpt[i], pie, sizeof(struct nb_rpt_hdr)) == _FALSE) + *nb_rpt_is_same = _FALSE; + _rtw_memcpy(&pnb->nb_rpt[i], pie, sizeof(struct nb_rpt_hdr)); + } + nb_rpt_entries++; + } + + if (from_btm) + pnb->preference_en = (bfound)?_TRUE:_FALSE; + + *nb_rpt_num = nb_rpt_entries; + return ret; +} + +/* selection sorting based on preference value + * : nb_rpt_entries - candidate num + * / : pcandidates - candidate list + * return : TRUE - means pcandidates is updated. + */ +static u8 rtw_wnm_candidates_sorting( + u32 nb_rpt_entries, struct wnm_btm_cant *pcandidates) +{ + u8 updated = _FALSE; + u32 i, j, pos; + struct wnm_btm_cant swap; + struct wnm_btm_cant *pcant_1, *pcant_2; + + if ((!nb_rpt_entries) || (!pcandidates)) + return updated; + + for (i=0; i < (nb_rpt_entries - 1); i++) { + pos = i; + for (j=(i + 1); j < nb_rpt_entries; j++) { + pcant_1 = pcandidates+pos; + pcant_2 = pcandidates+j; + if ((pcant_1->preference) < (pcant_2->preference)) + pos = j; + } + + if (pos != i) { + updated = _TRUE; + _rtw_memcpy(&swap, (pcandidates+i), sizeof(struct wnm_btm_cant)); + _rtw_memcpy((pcandidates+i), (pcandidates+pos), sizeof(struct wnm_btm_cant)); + _rtw_memcpy((pcandidates+pos), &swap, sizeof(struct wnm_btm_cant)); + } + } + return updated; +} + +static void rtw_wnm_nb_info_update( + u32 nb_rpt_entries, u8 from_btm, + struct roam_nb_info *pnb, struct wnm_btm_cant *pcandidates, + u8 *nb_rpt_is_same) +{ + u8 is_found; + u32 i, j; + struct wnm_btm_cant *pcand; + + if (!pnb) + return; + + pnb->nb_rpt_ch_list_num = 0; + for (i=0; inb_rpt[i], &pcand->nb_rpt, + sizeof(struct nb_rpt_hdr)) == _FALSE) + *nb_rpt_is_same = _FALSE; + _rtw_memcpy(&pnb->nb_rpt[i], &pcand->nb_rpt, sizeof(struct nb_rpt_hdr)); + } + + RTW_DBG("WNM: bssid(" MAC_FMT + ") , bss_info(0x%04X), reg_class(0x%02X), ch_num(%d), phy_type(0x%02X)\n", + MAC_ARG(pnb->nb_rpt[i].bssid), pnb->nb_rpt[i].bss_info, + pnb->nb_rpt[i].reg_class, pnb->nb_rpt[i].ch_num, + pnb->nb_rpt[i].phy_type); + + if (pnb->nb_rpt[i].ch_num == 0) + continue; + + for (j=0; jnb_rpt[i].ch_num == pnb->nb_rpt_ch_list[j].hw_value) { + is_found = _TRUE; + break; + } + } + + if (!is_found) { + pnb->nb_rpt_ch_list[pnb->nb_rpt_ch_list_num].hw_value = pnb->nb_rpt[i].ch_num; + pnb->nb_rpt_ch_list_num++; + } + } +} + +static void rtw_wnm_btm_candidate_select(_adapter *padapter) +{ + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct roam_nb_info *pnb = &(padapter->mlmepriv.nb_info); + struct wlan_network *pnetwork; + u8 bfound = _FALSE; + u32 i; + + for (i = 0; i < pnb->last_nb_rpt_entries; i++) { + pnetwork = rtw_find_network( + &(pmlmepriv->scanned_queue), + pnb->nb_rpt[i].bssid); + + if (pnetwork) { + bfound = _TRUE; + break; + } + } + + if (bfound) { + _rtw_memcpy(pnb->roam_target_addr, pnb->nb_rpt[i].bssid, ETH_ALEN); + RTW_INFO("WNM : select btm entry(%d) - %s("MAC_FMT", ch%u) rssi:%d\n" + , i + , pnetwork->network.Ssid.Ssid + , MAC_ARG(pnetwork->network.MacAddress) + , pnetwork->network.Configuration.DSConfig + , (int)pnetwork->network.Rssi); + } else + _rtw_memset(pnb->roam_target_addr,0, ETH_ALEN); +} + +u32 rtw_wnm_btm_candidates_survey( + _adapter *padapter, u8* pframe, u32 elem_len, u8 from_btm) +{ + struct roam_nb_info *pnb = &(padapter->mlmepriv.nb_info); + struct wnm_btm_cant *pcandidate_list = NULL; + u8 nb_rpt_is_same = _TRUE; + u32 ret = _FAIL; + u32 nb_rpt_entries = 0; + + if (from_btm) { + u32 mlen = sizeof(struct wnm_btm_cant) * RTW_MAX_NB_RPT_NUM; + pcandidate_list = (struct wnm_btm_cant *)rtw_malloc(mlen); + if (pcandidate_list == NULL) + goto exit; + } + + /*clean the status set last time*/ + _rtw_memset(&pnb->nb_rpt_ch_list, 0, sizeof(pnb->nb_rpt_ch_list)); + pnb->nb_rpt_valid = _FALSE; + if (!rtw_wnm_nb_elem_parsing( + pframe, elem_len, from_btm, + &nb_rpt_entries, &nb_rpt_is_same, + pnb, pcandidate_list)) + goto exit; + + if (nb_rpt_entries != 0) { + if ((from_btm) && (rtw_wnm_btm_preference_cap(padapter))) + rtw_wnm_candidates_sorting(nb_rpt_entries, pcandidate_list); + + rtw_wnm_nb_info_update( + nb_rpt_entries, from_btm, + pnb, pcandidate_list, &nb_rpt_is_same); + } + + RTW_INFO("nb_rpt_is_same = %d, nb_rpt_entries = %d, last_nb_rpt_entries = %d\n", + nb_rpt_is_same, nb_rpt_entries, pnb->last_nb_rpt_entries); + if ((nb_rpt_is_same == _TRUE) && (nb_rpt_entries == pnb->last_nb_rpt_entries)) + pnb->nb_rpt_is_same = _TRUE; + else { + pnb->nb_rpt_is_same = _FALSE; + pnb->last_nb_rpt_entries = nb_rpt_entries; + } + + if ((from_btm) && (nb_rpt_entries != 0)) + rtw_wnm_btm_candidate_select(padapter); + + pnb->nb_rpt_valid = _TRUE; + ret = _SUCCESS; + +exit: + if (from_btm && pcandidate_list) + rtw_mfree((u8 *)pcandidate_list, sizeof(struct wnm_btm_cant) * RTW_MAX_NB_RPT_NUM); + + return ret; +} +#endif + unsigned int OnAction_ft(_adapter *padapter, union recv_frame *precv_frame) { #ifdef CONFIG_RTW_80211R @@ -6929,13 +6837,13 @@ unsigned int OnAction_ft(_adapter *padapter, union recv_frame *precv_frame) struct mlme_ext_info *pmlmeinfo = NULL; struct mlme_priv *pmlmepriv = NULL; struct wlan_network *proam_target = NULL; - ft_priv *pftpriv = NULL; + struct ft_roam_info *pft_roam = NULL; _irqL irqL; - pmlmeext = &padapter->mlmeextpriv; + pmlmeext = &(padapter->mlmeextpriv); pmlmeinfo = &(pmlmeext->mlmext_info); - pmlmepriv = &padapter->mlmepriv; - pftpriv = &pmlmepriv->ftpriv; + pmlmepriv = &(padapter->mlmepriv); + pft_roam = &(pmlmepriv->ft_roam); pframe = precv_frame->u.hdr.rx_data; frame_len = precv_frame->u.hdr.len; pframe_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); @@ -6946,8 +6854,8 @@ unsigned int OnAction_ft(_adapter *padapter, union recv_frame *precv_frame) action_code = pframe_body[1]; switch (action_code) { - case RTW_WLAN_ACTION_FT_RESPONSE: - RTW_INFO("FT: %s RTW_WLAN_ACTION_FT_RESPONSE\n", __func__); + case RTW_WLAN_ACTION_FT_RSP: + RTW_INFO("FT: RTW_WLAN_ACTION_FT_RSP recv.\n"); if (!_rtw_memcmp(adapter_mac_addr(padapter), &pframe_body[2], ETH_ALEN)) { RTW_ERR("FT: Unmatched STA MAC Address "MAC_FMT"\n", MAC_ARG(&pframe_body[2])); goto exit; @@ -6966,24 +6874,24 @@ unsigned int OnAction_ft(_adapter *padapter, union recv_frame *precv_frame) pie = rtw_get_ie(pframe_body, _MDIE_, &ft_ie_len, frame_len); if (pie) { - if (!_rtw_memcmp(&pftpriv->mdid, pie+2, 2)) { + if (!_rtw_memcmp(&pft_roam->mdid, pie+2, 2)) { RTW_ERR("FT: Invalid MDID\n"); goto exit; } } - rtw_set_ft_status(padapter, RTW_FT_REQUESTED_STA); + rtw_ft_set_status(padapter, RTW_FT_REQUESTED_STA); _cancel_timer_ex(&pmlmeext->ft_link_timer); /*Disconnect current AP*/ receive_disconnect(padapter, pmlmepriv->cur_network.network.MacAddress, WLAN_REASON_ACTIVE_ROAM, _FALSE); - pftpriv->ft_action_len = frame_len; - _rtw_memcpy(pftpriv->ft_action, pframe, rtw_min(frame_len, RTW_MAX_FTIE_SZ)); + pft_roam->ft_action_len = frame_len; + _rtw_memcpy(pft_roam->ft_action, pframe, rtw_min(frame_len, RTW_FT_MAX_IE_SZ)); ret = _SUCCESS; break; - case RTW_WLAN_ACTION_FT_REQUEST: - case RTW_WLAN_ACTION_FT_CONFIRM: + case RTW_WLAN_ACTION_FT_REQ: + case RTW_WLAN_ACTION_FT_CONF: case RTW_WLAN_ACTION_FT_ACK: default: RTW_ERR("FT: Unsupported FT Action!\n"); @@ -6997,10 +6905,241 @@ unsigned int OnAction_ft(_adapter *padapter, union recv_frame *precv_frame) #endif } +#ifdef CONFIG_RTW_WNM +u8 rtw_wmn_btm_rsp_reason_decision(_adapter *padapter, u8* req_mode) +{ + struct recv_priv *precvpriv = &padapter->recvpriv; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + u8 reason = 0; + + if (!rtw_wnm_btm_diff_bss(padapter)) { + /* Reject - No suitable BSS transition candidates */ + reason = 7; + goto candidate_remove; + } + +#ifdef CONFIG_RTW_80211R + if (rtw_ft_chk_flags(padapter, RTW_FT_BTM_ROAM)) { + /* Accept */ + reason = 0; + goto under_survey; + } +#endif + + if (((*req_mode) & DISASSOC_IMMINENT) == 0) { + /* Reject - Unspecified reject reason */ + reason = 1; + goto candidate_remove; + } + + if (precvpriv->signal_strength_data.avg_val >= pmlmepriv->roam_rssi_threshold) { + reason = 1; + goto candidate_remove; + } + +under_survey: + if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY)) { + RTW_INFO("%s reject due to _FW_UNDER_SURVEY\n", __func__); + reason = 1; + } + +candidate_remove: + if (reason !=0) + rtw_wnm_reset_btm_candidate(&padapter->mlmepriv.nb_info); + + return reason; +} + +static u32 rtw_wnm_btm_candidates_offset_get(u8* pframe) +{ + u8 *pos = pframe; + u32 offset = 0; + + if (!pframe) + return 0; + + offset += 7; + pos += offset; + + /* BSS Termination Duration check */ + if (wnm_btm_bss_term_inc(pframe)) { + offset += 12; + pos += offset; + } + + /* Session Information URL check*/ + if (wnm_btm_ess_disassoc_im(pframe)) { + /*URL length field + URL variable length*/ + offset = 1 + *(pframe + offset); + pos += offset; + } + + offset = (pos - pframe); + return offset; +} + +static void rtw_wnm_btm_req_hdr_parsing(u8* pframe, struct btm_req_hdr *phdr) +{ + u8 *pos = pframe; + u32 offset = 0; + + if (!pframe || !phdr) + return; + + _rtw_memset(phdr, 0, sizeof(struct btm_req_hdr)); + phdr->req_mode = wnm_btm_req_mode(pframe); + phdr->disassoc_timer = wnm_btm_disassoc_timer(pframe); + phdr->validity_interval = wnm_btm_valid_interval(pframe); + if (wnm_btm_bss_term_inc(pframe)) { + _rtw_memcpy(&phdr->term_duration, + wnm_btm_term_duration_offset(pframe), + sizeof(struct btm_term_duration)); + } + + RTW_DBG("WNM: req_mode(%1x), disassoc_timer(%02x), interval(%x)\n", + phdr->req_mode, phdr->disassoc_timer, phdr->validity_interval); + if (wnm_btm_bss_term_inc(pframe)) + RTW_INFO("WNM: tsf(%llx), duration(%2x)\n", + phdr->term_duration.tsf, phdr->term_duration.duration); +} + +void rtw_wnm_roam_scan_hdl(void *ctx) +{ + _adapter *padapter = (_adapter *)ctx; + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + + if (rtw_is_scan_deny(padapter)) + RTW_INFO("WNM: roam scan would abort by scan_deny!\n"); + + pmlmepriv->need_to_roam = _TRUE; + rtw_drv_scan_by_self(padapter, RTW_AUTO_SCAN_REASON_ROAM); +} + +static void rtw_wnm_roam_scan(_adapter *padapter) +{ + struct roam_nb_info *pnb = &(padapter->mlmepriv.nb_info); + + if (rtw_is_scan_deny(padapter)) { + _cancel_timer_ex(&pnb->roam_scan_timer); + _set_timer(&pnb->roam_scan_timer, 1000); + } else + rtw_wnm_roam_scan_hdl((void *)padapter); +} + +void rtw_wnm_process_btm_req(_adapter *padapter, u8* pframe, u32 frame_len) +{ + struct roam_nb_info *pnb = &(padapter->mlmepriv.nb_info); + struct btm_req_hdr req_hdr; + u8 *ptr, reason; + u32 elem_len, offset; + + rtw_wnm_btm_req_hdr_parsing(pframe, &req_hdr); + offset = rtw_wnm_btm_candidates_offset_get(pframe); + if ((offset == 0) || ((frame_len - offset) <= 15)) + return; + + ptr = (pframe + offset); + elem_len = (frame_len - offset); + rtw_wnm_btm_candidates_survey(padapter, ptr, elem_len, _TRUE); + reason = rtw_wmn_btm_rsp_reason_decision(padapter, &pframe[3]); + rtw_wnm_issue_action(padapter, + RTW_WLAN_ACTION_WNM_BTM_RSP, reason); + + if (reason == 0) + rtw_wnm_roam_scan(padapter); +} + +void rtw_wnm_reset_btm_candidate(struct roam_nb_info *pnb) +{ + pnb->preference_en = _FALSE; + _rtw_memset(pnb->roam_target_addr, 0, ETH_ALEN); +} + +void rtw_wnm_reset_btm_state(_adapter *padapter) +{ + struct roam_nb_info *pnb = &(padapter->mlmepriv.nb_info); + + pnb->last_nb_rpt_entries = 0; + pnb->nb_rpt_is_same = _TRUE; + pnb->nb_rpt_valid = _FALSE; + pnb->nb_rpt_ch_list_num = 0; + rtw_wnm_reset_btm_candidate(pnb); + _rtw_memset(&pnb->nb_rpt, 0, sizeof(pnb->nb_rpt)); + _rtw_memset(&pnb->nb_rpt_ch_list, 0, sizeof(pnb->nb_rpt_ch_list)); +} + +void rtw_wnm_issue_action(_adapter *padapter, u8 action, u8 reason) +{ + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + struct xmit_frame *pmgntframe; + struct rtw_ieee80211_hdr *pwlanhdr; + struct pkt_attrib *pattrib; + u8 category, dialog_token, termination_delay, *pframe; + u16 *fctrl; + + if ((pmgntframe = alloc_mgtxmitframe(pxmitpriv)) == NULL) + return ; + + pattrib = &(pmgntframe->attrib); + update_mgntframe_attrib(padapter, pattrib); + _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, 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, pmlmeext->mgnt_seq); + pmlmeext->mgnt_seq++; + set_frame_sub_type(pframe, WIFI_ACTION); + + pframe += sizeof(struct rtw_ieee80211_hdr_3addr); + pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); + + category = RTW_WLAN_CATEGORY_WNM; + pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); + pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); + + switch (action) { + case RTW_WLAN_ACTION_WNM_BTM_QUERY: + pframe = rtw_set_fixed_ie(pframe, 1, &(dialog_token), &(pattrib->pktlen)); + pframe = rtw_set_fixed_ie(pframe, 1, &(reason), &(pattrib->pktlen)); + RTW_INFO("WNM: RTW_WLAN_ACTION_WNM_BTM_QUERY sent.\n"); + break; + case RTW_WLAN_ACTION_WNM_BTM_RSP: + termination_delay = 0; + pframe = rtw_set_fixed_ie(pframe, 1, &(dialog_token), &(pattrib->pktlen)); + pframe = rtw_set_fixed_ie(pframe, 1, &(reason), &(pattrib->pktlen)); + pframe = rtw_set_fixed_ie(pframe, 1, &(termination_delay), &(pattrib->pktlen)); + if (!is_zero_mac_addr(pmlmepriv->nb_info.roam_target_addr)) { + pframe = rtw_set_fixed_ie(pframe, 6, + pmlmepriv->nb_info.roam_target_addr, &(pattrib->pktlen)); + } + RTW_INFO("WNM: RTW_WLAN_ACTION_WNM_BTM_RSP sent. reason = %d\n", reason); + break; + default: + goto exit; + } + + pattrib->last_txcmdsz = pattrib->pktlen; + dump_mgntframe(padapter, pmgntframe); + +exit: + return; +} +#endif + unsigned int OnAction_ht(_adapter *padapter, union recv_frame *precv_frame) { u8 *pframe = precv_frame->u.hdr.rx_data; - uint frame_len = precv_frame->u.hdr.len; u8 *frame_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); u8 category, action; @@ -7082,6 +7221,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; @@ -7090,9 +7238,7 @@ unsigned int OnAction_wmm(_adapter *padapter, union recv_frame *precv_frame) unsigned int OnAction_vht(_adapter *padapter, union recv_frame *precv_frame) { #ifdef CONFIG_80211AC_VHT - struct rx_pkt_attrib *prxattrib = &precv_frame->u.hdr.attrib; u8 *pframe = precv_frame->u.hdr.rx_data; - uint frame_len = precv_frame->u.hdr.len; struct rtw_ieee80211_hdr_3addr *whdr = (struct rtw_ieee80211_hdr_3addr *)pframe; u8 *frame_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); u8 category, action; @@ -7301,21 +7447,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; @@ -7367,29 +7505,50 @@ 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 *pbcmc_sta = NULL; - /* _rtw_memset((u8 *)(pattrib), 0, sizeof(struct pkt_attrib)); */ - pbcmc_sta = rtw_get_bcmc_stainfo(padapter); +#ifdef CONFIG_P2P_PS_NOA_USE_MACID_SLEEP + struct wifidirect_info *pwdinfo = &(padapter->wdinfo); +#endif /* CONFIG_P2P_PS_NOA_USE_MACID_SLEEP */ + + /* _rtw_memset((u8 *)(pattrib), 0, sizeof(struct pkt_attrib)); */ 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 update_mcc_mgntframe_attrib(padapter, pattrib); #endif + +#ifdef CONFIG_P2P_PS_NOA_USE_MACID_SLEEP +#ifdef CONFIG_CONCURRENT_MODE + if (rtw_mi_buddy_check_fwstate(padapter, WIFI_ASOC_STATE)) +#endif /* CONFIG_CONCURRENT_MODE */ + if (MLME_IS_GC(padapter)) { + if (pwdinfo->p2p_ps_mode > P2P_PS_NONE) { + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); + struct sta_priv *pstapriv = &padapter->stapriv; + struct sta_info *psta; + + psta = rtw_get_stainfo(pstapriv, cur_network->MacAddress); + if (psta) { + /* use macid sleep during NoA, mgmt frame use ac queue & ap macid */ + pattrib->mac_id = psta->cmn.mac_id; + pattrib->qsel = QSLT_VO; + } else { + if (pwdinfo->p2p_ps_state != P2P_PS_DISABLE) + RTW_ERR("%s , psta was NULL\n", __func__); + } + } + } +#endif /* CONFIG_P2P_PS_NOA_USE_MACID_SLEEP */ + + pattrib->pktlen = 0; if (IS_CCK_RATE(pmlmeext->tx_rate)) @@ -7420,24 +7579,26 @@ void update_mgntframe_attrib_addr(_adapter *padapter, struct xmit_frame *pmgntfr { u8 *pframe; struct pkt_attrib *pattrib = &pmgntframe->attrib; -#ifdef CONFIG_BEAMFORMING +#if defined(CONFIG_BEAMFORMING) || defined(CONFIG_ANTENNA_DIVERSITY) struct sta_info *sta = NULL; -#endif /* CONFIG_BEAMFORMING */ +#endif pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; _rtw_memcpy(pattrib->ra, GetAddr1Ptr(pframe), ETH_ALEN); _rtw_memcpy(pattrib->ta, get_addr2_ptr(pframe), ETH_ALEN); -#ifdef CONFIG_BEAMFORMING +#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 /* CONFIG_BEAMFORMING */ + #endif +#endif /* defined(CONFIG_BEAMFORMING) || defined(CONFIG_ANTENNA_DIVERSITY) */ } void dump_mgntframe(_adapter *padapter, struct xmit_frame *pmgntframe) @@ -7554,25 +7715,6 @@ int update_hidden_ssid(u8 *ies, u32 ies_len, u8 hidden_ssid_mode) return len_diff; } -#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE -u32 rtw_build_vendor_ie(_adapter *padapter , unsigned char *pframe , u8 mgmt_frame_tyte) -{ - int vendor_ie_num = 0; - struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); - u32 len = 0; - - for (vendor_ie_num = 0 ; vendor_ie_num < WLAN_MAX_VENDOR_IE_NUM ; vendor_ie_num++) { - if (pmlmepriv->vendor_ielen[vendor_ie_num] > 0 && pmlmepriv->vendor_ie_mask[vendor_ie_num] & mgmt_frame_tyte) { - _rtw_memcpy(pframe , pmlmepriv->vendor_ie[vendor_ie_num] , pmlmepriv->vendor_ielen[vendor_ie_num]); - pframe += pmlmepriv->vendor_ielen[vendor_ie_num]; - len += pmlmepriv->vendor_ielen[vendor_ie_num]; - } - } - - return len; -} -#endif - void issue_beacon(_adapter *padapter, int timeout_ms) { struct xmit_frame *pmgntframe; @@ -7621,6 +7763,10 @@ void issue_beacon(_adapter *padapter, int timeout_ms) if (padapter->hw_port == HW_PORT1) pattrib->mbssid = 1; #endif +#ifdef CONFIG_FW_HANDLE_TXBCN + if (padapter->vap_id != CONFIG_LIMITED_AP_NUM) + pattrib->mbssid = padapter->vap_id; +#endif _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); @@ -7642,7 +7788,7 @@ void issue_beacon(_adapter *padapter, int timeout_ms) 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 */ @@ -7766,6 +7912,12 @@ void issue_beacon(_adapter *padapter, int timeout_ms) _clr_fwstate_(pmlmepriv, WIFI_UNDER_WPS); } +#ifdef CONFIG_RTW_80211K + pframe = rtw_set_ie(pframe, _EID_RRM_EN_CAP_IE_, + sizeof(padapter->rmpriv.rm_en_cap_def), + padapter->rmpriv.rm_en_cap_def, &pattrib->pktlen); +#endif + #ifdef CONFIG_P2P if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { u32 len; @@ -7794,10 +7946,17 @@ void issue_beacon(_adapter *padapter, int timeout_ms) #endif } #endif /* CONFIG_P2P */ - -#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE - pattrib->pktlen += rtw_build_vendor_ie(padapter , pframe , WIFI_BEACON_VENDOR_IE_BIT); +#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 + +#ifdef CONFIG_RTL8812A + pframe = rtw_hal_set_8812a_vendor_ie(padapter, pframe, &pattrib->pktlen ); +#endif/*CONFIG_RTL8812A*/ + goto _issue_bcn; } @@ -7861,8 +8020,10 @@ void issue_beacon(_adapter *padapter, int timeout_ms) _exit_critical_bh(&pmlmepriv->bcn_update_lock, &irqL); #endif /* #if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) */ - if ((pattrib->pktlen + TXDESC_SIZE) > 512) { - RTW_INFO("beacon frame too large\n"); + if ((pattrib->pktlen + TXDESC_SIZE) > MAX_BEACON_LEN) { + RTW_ERR("beacon frame too large ,len(%d,%d)\n", + (pattrib->pktlen + TXDESC_SIZE), MAX_BEACON_LEN); + rtw_warn_on(1); return; } @@ -7896,9 +8057,6 @@ void issue_probersp(_adapter *padapter, unsigned char *da, u8 is_valid_p2p_probe unsigned int rate_len; #ifdef CONFIG_P2P struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -#ifdef CONFIG_WFD - u32 wfdielen = 0; -#endif #endif /* CONFIG_P2P */ /* RTW_INFO("%s\n", __FUNCTION__); */ @@ -8016,8 +8174,11 @@ 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); + pattrib->pktlen += rtw_build_vendor_ie(padapter , &pframe , WIFI_PROBERESP_VENDOR_IE_BIT); #endif } else #endif @@ -8075,6 +8236,12 @@ void issue_probersp(_adapter *padapter, unsigned char *da, u8 is_valid_p2p_probe } +#ifdef CONFIG_RTW_80211K + pframe = rtw_set_ie(pframe, _EID_RRM_EN_CAP_IE_, + sizeof(padapter->rmpriv.rm_en_cap_def), + padapter->rmpriv.rm_en_cap_def, &pattrib->pktlen); +#endif + #ifdef CONFIG_P2P if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO) /* IOT issue, When wifi_spec is not set, send probe_resp with P2P IE even if probe_req has no P2P IE */ @@ -8124,7 +8291,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)); @@ -8137,6 +8304,9 @@ void issue_probersp(_adapter *padapter, unsigned char *da, u8 is_valid_p2p_probe } #endif /* CONFIG_AUTO_AP_MODE */ +#ifdef CONFIG_RTL8812A + pframe = rtw_hal_set_8812a_vendor_ie(padapter, pframe, &pattrib->pktlen); +#endif/*CONFIG_RTL8812A*/ pattrib->last_txcmdsz = pattrib->pktlen; @@ -8147,7 +8317,7 @@ void issue_probersp(_adapter *padapter, unsigned char *da, u8 is_valid_p2p_probe } -int _issue_probereq(_adapter *padapter, NDIS_802_11_SSID *pssid, u8 *da, u8 ch, bool append_wps, int wait_ack) +int _issue_probereq(_adapter *padapter, const NDIS_802_11_SSID *pssid, const u8 *da, u8 ch, bool append_wps, int wait_ack) { int ret = _FAIL; struct xmit_frame *pmgntframe; @@ -8160,9 +8330,11 @@ int _issue_probereq(_adapter *padapter, NDIS_802_11_SSID *pssid, u8 *da, u8 ch, struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); int bssrate_len = 0; u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; +#ifdef CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI + struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); +#endif if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) goto exit; @@ -8181,6 +8353,13 @@ int _issue_probereq(_adapter *padapter, NDIS_802_11_SSID *pssid, u8 *da, u8 ch, pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; +#ifdef CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI + if ((pwdev_priv->pno_mac_addr[0] != 0xFF) + && (check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE) == _TRUE) + && (check_fwstate(&padapter->mlmepriv, _FW_LINKED) == _FALSE)) + mac = pwdev_priv->pno_mac_addr; + else +#endif mac = adapter_mac_addr(padapter); fctrl = &(pwlanhdr->frame_ctl); @@ -8198,14 +8377,30 @@ int _issue_probereq(_adapter *padapter, NDIS_802_11_SSID *pssid, u8 *da, u8 ch, _rtw_memcpy(pwlanhdr->addr2, mac, ETH_ALEN); - SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); - pmlmeext->mgnt_seq++; +#ifdef CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI + if ((pwdev_priv->pno_mac_addr[0] != 0xFF) + && (check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE) == _TRUE) + && (check_fwstate(&padapter->mlmepriv, _FW_LINKED) == _FALSE)) { +#ifdef CONFIG_RTW_DEBUG + RTW_DBG("%s pno_scan_seq_num: %d\n", __func__, + pwdev_priv->pno_scan_seq_num); +#endif + SetSeqNum(pwlanhdr, pwdev_priv->pno_scan_seq_num); + pattrib->seqnum = pwdev_priv->pno_scan_seq_num; + pattrib->qos_en = 1; + pwdev_priv->pno_scan_seq_num++; + } else +#endif + { + SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); + pmlmeext->mgnt_seq++; + } set_frame_sub_type(pframe, WIFI_PROBEREQ); pframe += sizeof(struct rtw_ieee80211_hdr_3addr); pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); - if (pssid) + if (pssid && !MLME_IS_MESH(padapter)) pframe = rtw_set_ie(pframe, _SSID_IE_, pssid->SsidLength, pssid->Ssid, &(pattrib->pktlen)); else pframe = rtw_set_ie(pframe, _SSID_IE_, 0, NULL, &(pattrib->pktlen)); @@ -8221,6 +8416,15 @@ int _issue_probereq(_adapter *padapter, NDIS_802_11_SSID *pssid, u8 *da, u8 ch, if (ch) pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, &ch, &pattrib->pktlen); +#ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(padapter)) { + if (pssid) + pframe = rtw_set_ie_mesh_id(pframe, &pattrib->pktlen, pssid->Ssid, pssid->SsidLength); + else + pframe = rtw_set_ie_mesh_id(pframe, &pattrib->pktlen, NULL, 0); + } +#endif + if (append_wps) { /* add wps_ie for wps2.0 */ if (pmlmepriv->wps_probe_req_ie_len > 0 && pmlmepriv->wps_probe_req_ie) { @@ -8231,9 +8435,14 @@ int _issue_probereq(_adapter *padapter, NDIS_802_11_SSID *pssid, u8 *da, u8 ch, } } #ifdef CONFIG_APPEND_VENDOR_IE_ENABLE - pattrib->pktlen += rtw_build_vendor_ie(padapter , pframe , WIFI_PROBEREQ_VENDOR_IE_BIT); + pattrib->pktlen += rtw_build_vendor_ie(padapter , &pframe , WIFI_PROBEREQ_VENDOR_IE_BIT); #endif +#ifdef CONFIG_RTL8812A + pframe = rtw_hal_set_8812a_vendor_ie(padapter, pframe, &pattrib->pktlen ); +#endif/*CONFIG_RTL8812A*/ + + pattrib->last_txcmdsz = pattrib->pktlen; @@ -8248,7 +8457,7 @@ int _issue_probereq(_adapter *padapter, NDIS_802_11_SSID *pssid, u8 *da, u8 ch, return ret; } -inline void issue_probereq(_adapter *padapter, NDIS_802_11_SSID *pssid, u8 *da) +inline void issue_probereq(_adapter *padapter, const NDIS_802_11_SSID *pssid, const u8 *da) { _issue_probereq(padapter, pssid, da, 0, 1, _FALSE); } @@ -8258,12 +8467,12 @@ inline void issue_probereq(_adapter *padapter, NDIS_802_11_SSID *pssid, u8 *da) * 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 * try_cnt means the maximal TX count to try */ -int issue_probereq_ex(_adapter *padapter, NDIS_802_11_SSID *pssid, u8 *da, u8 ch, bool append_wps, +int issue_probereq_ex(_adapter *padapter, const NDIS_802_11_SSID *pssid, const u8 *da, u8 ch, bool append_wps, int try_cnt, int wait_ms) { 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; @@ -8316,14 +8525,6 @@ void issue_auth(_adapter *padapter, struct sta_info *psta, unsigned short status struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -#ifdef CONFIG_RTW_80211R - struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); - ft_priv *pftpriv = &pmlmepriv->ftpriv; - u8 is_ft_roaming = _FALSE; - u8 is_ft_roaming_with_rsn_ie = _TRUE; - u8 *pie = NULL; - u32 ft_ie_len = 0; -#endif if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) return; @@ -8355,7 +8556,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); @@ -8393,11 +8594,9 @@ void issue_auth(_adapter *padapter, struct sta_info *psta, unsigned short status _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&pmlmeinfo->network), ETH_ALEN); #ifdef CONFIG_RTW_80211R - /*For Fast BSS Transition */ - if ((rtw_to_roam(padapter) > 0) && rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) { - is_ft_roaming = _TRUE; - val16 = 2; /* 2: 802.11R FTAA */ - val16 = cpu_to_le16(val16); + if (rtw_ft_roam(padapter)) { + /* 2: 802.11R FTAA */ + val16 = cpu_to_le16(2); } else #endif { @@ -8435,21 +8634,7 @@ void issue_auth(_adapter *padapter, struct sta_info *psta, unsigned short status pframe = rtw_set_fixed_ie(pframe, _STATUS_CODE_, (unsigned char *)&val16, &(pattrib->pktlen)); #ifdef CONFIG_RTW_80211R - if (is_ft_roaming == _TRUE) { - pie = rtw_get_ie(pftpriv->updated_ft_ies, EID_WPA2, &ft_ie_len, pftpriv->updated_ft_ies_len); - if (pie) - pframe = rtw_set_ie(pframe, EID_WPA2, ft_ie_len, pie+2, &(pattrib->pktlen)); - else - is_ft_roaming_with_rsn_ie = _FALSE; - - pie = rtw_get_ie(pftpriv->updated_ft_ies, _MDIE_, &ft_ie_len, pftpriv->updated_ft_ies_len); - if (pie) - pframe = rtw_set_ie(pframe, _MDIE_, ft_ie_len , pie+2, &(pattrib->pktlen)); - - pie = rtw_get_ie(pftpriv->updated_ft_ies, _FTIE_, &ft_ie_len, pftpriv->updated_ft_ies_len); - if (pie && is_ft_roaming_with_rsn_ie) - pframe = rtw_set_ie(pframe, _FTIE_, ft_ie_len , pie+2, &(pattrib->pktlen)); - } + rtw_ft_build_auth_req_ies(padapter, pattrib, &pframe); #endif /* then checking to see if sending challenging text... */ @@ -8525,7 +8710,7 @@ 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 *)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); @@ -8549,7 +8734,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) @@ -8691,8 +8876,14 @@ void issue_asocrsp(_adapter *padapter, unsigned short status, struct sta_info *p #endif /* CONFIG_P2P */ #ifdef CONFIG_APPEND_VENDOR_IE_ENABLE - pattrib->pktlen += rtw_build_vendor_ie(padapter , pframe , WIFI_ASSOCRESP_VENDOR_IE_BIT); + pattrib->pktlen += rtw_build_vendor_ie(padapter , &pframe , WIFI_ASSOCRESP_VENDOR_IE_BIT); #endif + +#ifdef CONFIG_RTL8812A + pframe = rtw_hal_set_8812a_vendor_ie(padapter, pframe, &pattrib->pktlen ); +#endif/*CONFIG_RTL8812A*/ + + pattrib->last_txcmdsz = pattrib->pktlen; dump_mgntframe(padapter, pmgntframe); @@ -8705,14 +8896,13 @@ void _issue_assocreq(_adapter *padapter, u8 is_reassoc) int ret = _FAIL; struct xmit_frame *pmgntframe; struct pkt_attrib *pattrib; - unsigned char *pframe, *p; + unsigned char *pframe; struct rtw_ieee80211_hdr *pwlanhdr; unsigned short *fctrl; unsigned short val16; - unsigned int i, j, ie_len, index = 0; - unsigned char rf_type, bssrate[NumRates], sta_bssrate[NumRates]; + unsigned int i, j, index = 0; + unsigned char bssrate[NumRates], sta_bssrate[NumRates]; PNDIS_802_11_VARIABLE_IEs pIE; - struct registry_priv *pregpriv = &padapter->registrypriv; struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); @@ -8729,17 +8919,13 @@ 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 */ u8 pow_cap_ele[2] = { 0x00 }; u8 sup_ch[30 * 2] = {0x00 }, sup_ch_idx = 0, idx_5g = 2; /* For supported channel */ #endif /* CONFIG_DFS */ -#ifdef CONFIG_RTW_80211R - u8 *pie = NULL; - u32 ft_ie_len = 0; - ft_priv *pftpriv = &pmlmepriv->ftpriv; -#endif if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) goto exit; @@ -8812,16 +8998,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 */ @@ -8907,6 +9094,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); @@ -8931,13 +9128,22 @@ void _issue_assocreq(_adapter *padapter, u8 is_reassoc) case EID_WPA2: #ifdef CONFIG_RTW_80211R - if ((is_reassoc == _TRUE) && (rtw_to_roam(padapter) > 0) && rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) { - pie = rtw_get_ie(pftpriv->updated_ft_ies, EID_WPA2, &ft_ie_len, pftpriv->updated_ft_ies_len); - if (pie) - pframe = rtw_set_ie(pframe, EID_WPA2, ft_ie_len, pie+2, &(pattrib->pktlen)); + if ((is_reassoc) && (rtw_ft_roam(padapter))) { + rtw_ft_update_rsnie(padapter, _TRUE, pattrib, &pframe); } else #endif + { +#ifdef CONFIG_IOCTL_CFG80211 + if (rtw_sec_chk_auth_alg(padapter, WLAN_AUTH_OPEN) && + rtw_sec_chk_auth_type(padapter, NL80211_AUTHTYPE_SAE)) { + s32 entry = rtw_cached_pmkid(padapter, pmlmepriv->assoc_bssid); + + rtw_rsn_sync_pmkid(padapter, (u8 *)pIE, (pIE->Length + 2), entry); + } +#endif /* CONFIG_IOCTL_CFG80211 */ + pframe = rtw_set_ie(pframe, EID_WPA2, pIE->Length, pIE->data, &(pattrib->pktlen)); + } break; #ifdef CONFIG_80211N_HT case EID_HTCapability: @@ -9124,38 +9330,26 @@ void _issue_assocreq(_adapter *padapter, u8 is_reassoc) } } -#endif /* CONFIG_P2P */ - #ifdef CONFIG_WFD wfdielen = rtw_append_assoc_req_wfd_ie(padapter, pframe); pframe += wfdielen; pattrib->pktlen += wfdielen; #endif -#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE - pattrib->pktlen += rtw_build_vendor_ie(padapter , pframe , WIFI_ASSOCREQ_VENDOR_IE_BIT); +#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_ASSOCREQ_VENDOR_IE_BIT); +#endif + +#ifdef CONFIG_RTL8812A + pframe = rtw_hal_set_8812a_vendor_ie(padapter, pframe, &pattrib->pktlen ); +#endif/*CONFIG_RTL8812A*/ + #ifdef CONFIG_RTW_80211R - if (rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) { - u8 mdieval[3] = {0}; - - _rtw_memcpy(mdieval, &(pftpriv->mdid), 2); - mdieval[2] = pftpriv->ft_cap; - pframe = rtw_set_ie(pframe, _MDIE_, 3, mdieval, &(pattrib->pktlen)); - } - - if (is_reassoc == _TRUE) { - if ((rtw_to_roam(padapter) > 0) && rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) { - u8 is_ft_roaming_with_rsn_ie = _TRUE; - - pie = rtw_get_ie(pftpriv->updated_ft_ies, EID_WPA2, &ft_ie_len, pftpriv->updated_ft_ies_len); - if (!pie) - is_ft_roaming_with_rsn_ie = _FALSE; - - pie = rtw_get_ie(pftpriv->updated_ft_ies, _FTIE_, &ft_ie_len, pftpriv->updated_ft_ies_len); - if (pie && is_ft_roaming_with_rsn_ie) - pframe = rtw_set_ie(pframe, _FTIE_, ft_ie_len , pie+2, &(pattrib->pktlen)); - } - } + rtw_ft_build_assoc_req_ies(padapter, is_reassoc, pattrib, &pframe); #endif pattrib->last_txcmdsz = pattrib->pktlen; @@ -9194,6 +9388,7 @@ static int _issue_nulldata(_adapter *padapter, unsigned char *da, unsigned int p struct xmit_priv *pxmitpriv; struct mlme_ext_priv *pmlmeext; struct mlme_ext_info *pmlmeinfo; + u8 a4_shift; /* RTW_INFO("%s:%d\n", __FUNCTION__, power_mode); */ @@ -9224,24 +9419,38 @@ 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); + else if (MLME_IS_MESH(padapter)) { + SetToDs(fctrl); + SetFrDs(fctrl); + } if (power_mode) SetPwrMgt(fctrl); - _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); - _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); - _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); + if (get_tofr_ds(fctrl) == 3) { + _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr3, da, ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr4, adapter_mac_addr(padapter), ETH_ALEN); + a4_shift = ETH_ALEN; + pattrib->hdrlen += ETH_ALEN; + } else { + _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); + a4_shift = 0; + } SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); pmlmeext->mgnt_seq++; set_frame_sub_type(pframe, WIFI_DATA_NULL); - pframe += sizeof(struct rtw_ieee80211_hdr_3addr); - pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); + pframe += sizeof(struct rtw_ieee80211_hdr_3addr) + a4_shift; + pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr) + a4_shift; pattrib->last_txcmdsz = pattrib->pktlen; @@ -9257,8 +9466,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 @@ -9269,48 +9476,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 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); @@ -9345,33 +9521,8 @@ 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) +static int _issue_qos_nulldata(_adapter *padapter, unsigned char *da, u16 tid, u8 ps, int wait_ack) { int ret = _FAIL; struct xmit_frame *pmgntframe; @@ -9382,11 +9533,12 @@ static int _issue_qos_nulldata(_adapter *padapter, unsigned char *da, u16 tid, i struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + u8 a4_shift; if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) goto exit; - RTW_INFO("%s\n", __FUNCTION__); + /* RTW_INFO("%s\n", __FUNCTION__); */ pmgntframe = alloc_mgtxmitframe(pxmitpriv); if (pmgntframe == NULL) @@ -9410,14 +9562,35 @@ 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); + else if (MLME_IS_MESH(padapter)) { + SetToDs(fctrl); + SetFrDs(fctrl); + } + + if (ps) + SetPwrMgt(fctrl); if (pattrib->mdata) SetMData(fctrl); + if (get_tofr_ds(fctrl) == 3) { + _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr3, da, ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr4, adapter_mac_addr(padapter), ETH_ALEN); + a4_shift = ETH_ALEN; + pattrib->hdrlen += ETH_ALEN; + } else { + _rtw_memcpy(pwlanhdr->addr1, da, ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); + a4_shift = 0; + } + qc = (unsigned short *)(pframe + pattrib->hdrlen - 2); SetPriority(qc, tid); @@ -9426,16 +9599,12 @@ static int _issue_qos_nulldata(_adapter *padapter, unsigned char *da, u16 tid, i SetAckpolicy(qc, pattrib->ack_policy); - _rtw_memcpy(pwlanhdr->addr1, da, 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, pmlmeext->mgnt_seq); pmlmeext->mgnt_seq++; 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); + pframe += sizeof(struct rtw_ieee80211_hdr_3addr_qos) + a4_shift; + pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr_qos) + a4_shift; pattrib->last_txcmdsz = pattrib->pktlen; @@ -9457,11 +9626,11 @@ static int _issue_qos_nulldata(_adapter *padapter, unsigned char *da, u16 tid, i * try_cnt means the maximal TX count to try * da == NULL for station mode */ -int issue_qos_nulldata(_adapter *padapter, unsigned char *da, u16 tid, int try_cnt, int wait_ms) +int issue_qos_nulldata(_adapter *padapter, unsigned char *da, u16 tid, u8 ps, int try_cnt, int wait_ms) { 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); @@ -9473,7 +9642,7 @@ int issue_qos_nulldata(_adapter *padapter, unsigned char *da, u16 tid, int try_c da = get_my_bssid(&(pmlmeinfo->network)); do { - ret = _issue_qos_nulldata(padapter, da, tid, wait_ms > 0 ? _TRUE : _FALSE); + ret = _issue_qos_nulldata(padapter, da, tid, ps, wait_ms > 0 ? _TRUE : _FALSE); i++; @@ -9602,7 +9771,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; @@ -9643,17 +9812,13 @@ int issue_deauth_ex(_adapter *padapter, u8 *da, unsigned short reason, int try_c void issue_action_spct_ch_switch(_adapter *padapter, u8 *ra, u8 new_ch, u8 ch_offset) { - _irqL irqL; - _list *plist, *phead; - struct xmit_frame *pmgntframe; - struct pkt_attrib *pattrib; + struct xmit_frame *pmgntframe; + struct pkt_attrib *pattrib; unsigned char *pframe; struct rtw_ieee80211_hdr *pwlanhdr; unsigned short *fctrl; struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); - struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) return; @@ -9772,7 +9937,7 @@ void issue_action_SA_Query(_adapter *padapter, unsigned char *raddr, unsigned ch pmlmeext->sa_query_seq++; /* send sa query request to AP, AP should reply sa query response in 1 second */ if (pattrib->key_type == IEEE80211W_RIGHT_KEY) { - psta = rtw_get_stainfo(pstapriv, raddr); + psta = rtw_get_stainfo(pstapriv, pwlanhdr->addr1); if (psta != NULL) { /* RTW_INFO("%s, %d, set dot11w_expire_timer\n", __func__, __LINE__); */ _set_timer(&psta->dot11w_expire_timer, 1000); @@ -9925,9 +10090,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); } @@ -10022,7 +10187,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; @@ -10054,8 +10219,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)); } @@ -10100,7 +10265,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; @@ -10140,7 +10305,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; @@ -10159,7 +10324,7 @@ static void issue_action_BSSCoexistPacket(_adapter *padapter) u8 InfoContent[16] = {0}; u8 ICS[8][15]; #ifdef CONFIG_80211N_HT - if ((pmlmepriv->num_FortyMHzIntolerant == 0) || (pmlmepriv->num_sta_no_ht == 0)) + if ((pmlmepriv->num_FortyMHzIntolerant == 0) && (pmlmepriv->num_sta_no_ht == 0)) return; if (_TRUE == pmlmeinfo->bwmode_updated) @@ -10204,18 +10369,15 @@ static void issue_action_BSSCoexistPacket(_adapter *padapter) pframe = rtw_set_fixed_ie(pframe, 1, &(category), &(pattrib->pktlen)); pframe = rtw_set_fixed_ie(pframe, 1, &(action), &(pattrib->pktlen)); - - /* */ - if (pmlmepriv->num_FortyMHzIntolerant > 0) { + /* TODO calculate 40Mhz intolerant via ch and ch offset */ + /* if (pmlmepriv->num_FortyMHzIntolerant > 0) */ + { u8 iedata = 0; iedata |= BIT(2);/* 20 MHz BSS Width Request */ - pframe = rtw_set_ie(pframe, EID_BSSCoexistence, 1, &iedata, &(pattrib->pktlen)); - } - /* */ _rtw_memset(ICS, 0, sizeof(ICS)); if (pmlmepriv->num_sta_no_ht > 0) { @@ -10381,7 +10543,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; @@ -10462,9 +10624,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; @@ -10475,7 +10637,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 } @@ -10526,54 +10688,115 @@ unsigned int send_delba(_adapter *padapter, u8 initiator, u8 *addr) unsigned int send_beacon(_adapter *padapter) { - u8 bxmitok = _FALSE; - int issue = 0; - int poll = 0; -#if defined(CONFIG_PCI_HCI) && defined(RTL8814AE_SW_BCN) - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); -#endif +#if defined(CONFIG_PCI_HCI) && !defined(CONFIG_PCI_BCN_POLLING) + #ifdef CONFIG_FW_HANDLE_TXBCN + u8 vap_id = padapter->vap_id; + + /* bypass TX BCN because vap_id is invalid*/ + if (vap_id == CONFIG_LIMITED_AP_NUM) + return _SUCCESS; + #endif + + /* bypass TX BCN queue because op ch is switching/waiting */ + if (check_fwstate(&padapter->mlmepriv, WIFI_OP_CH_SWITCHING) + || IS_CH_WAITING(adapter_to_rfctl(padapter)) + ) + return _SUCCESS; -#ifdef CONFIG_PCI_HCI /* RTW_INFO("%s\n", __FUNCTION__); */ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_VALID, NULL); /* 8192EE Port select for Beacon DL */ rtw_hal_set_hwreg(padapter, HW_VAR_DL_BCN_SEL, NULL); + #ifdef CONFIG_FW_HANDLE_TXBCN + rtw_hal_set_hwreg(padapter, HW_VAR_BCN_HEAD_SEL, &vap_id); + #endif issue_beacon(padapter, 0); -#ifdef RTL8814AE_SW_BCN - if (pHalData->bCorrectBCN != 0) + #ifdef CONFIG_FW_HANDLE_TXBCN + vap_id = 0xFF; + rtw_hal_set_hwreg(padapter, HW_VAR_BCN_HEAD_SEL, &vap_id); + #endif + + #ifdef RTL8814AE_SW_BCN + if (GET_HAL_DATA(padapter)->bCorrectBCN != 0) RTW_INFO("%s, line%d, Warnning, pHalData->bCorrectBCN != 0\n", __func__, __LINE__); - pHalData->bCorrectBCN = 1; -#endif + GET_HAL_DATA(padapter)->bCorrectBCN = 1; + #endif return _SUCCESS; #endif -#if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) - u32 start = rtw_get_current_time(); +/* CONFIG_PCI_BCN_POLLING is for pci interface beacon polling mode */ +#if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI)|| defined(CONFIG_PCI_BCN_POLLING) + u8 bxmitok = _FALSE; + int issue = 0; + int poll = 0; + systime start = rtw_get_current_time(); + #ifdef CONFIG_FW_HANDLE_TXBCN + u8 vap_id = padapter->vap_id; - 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 because vap_id is invalid*/ + if (vap_id == CONFIG_LIMITED_AP_NUM) + return _SUCCESS; + #endif + + /* bypass TX BCN queue because op ch is switching/waiting */ + if (check_fwstate(&padapter->mlmepriv, WIFI_OP_CH_SWITCHING) + || IS_CH_WAITING(adapter_to_rfctl(padapter)) + ) + 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); + #ifdef CONFIG_FW_HANDLE_TXBCN + rtw_hal_set_hwreg(padapter, HW_VAR_BCN_HEAD_SEL, &vap_id); + #endif 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)); - + #if defined(CONFIG_PCI_BCN_POLLING) + issue_beacon(padapter, 0); + #else + issue_beacon(padapter, 100); + #endif + issue++; + do { + #if defined(CONFIG_PCI_BCN_POLLING) + rtw_msleep_os(1); + #else + rtw_yield_os(); + #endif + rtw_hal_get_hwreg(padapter, HW_VAR_BCN_VALID, (u8 *)(&bxmitok)); + poll++; + } while ((poll % 10) != 0 && _FALSE == bxmitok && !RTW_CANNOT_RUN(padapter)); + #if defined(CONFIG_PCI_BCN_POLLING) + rtw_hal_unmap_beacon_icf(padapter); + #endif + } while (bxmitok == _FALSE && (issue < 100) && !RTW_CANNOT_RUN(padapter)); + #ifdef CONFIG_FW_HANDLE_TXBCN + vap_id = 0xFF; + rtw_hal_set_hwreg(padapter, HW_VAR_BCN_HEAD_SEL, &vap_id); + #endif + } 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); @@ -10583,12 +10806,13 @@ unsigned int send_beacon(_adapter *padapter) else if (0) RTW_INFO("%s success, issue:%d, poll:%d, %u ms\n", __FUNCTION__, issue, poll, rtw_get_passing_time_ms(start)); + #ifdef CONFIG_FW_CORRECT_BCN rtw_hal_fw_correct_bcn(padapter); - + #endif return _SUCCESS; } -#endif +#endif /*defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI)*/ } @@ -10599,8 +10823,8 @@ Following are some utitity fuctions for WiFi MLME *****************************************************************************/ BOOLEAN IsLegal5GChannel( - IN PADAPTER Adapter, - IN u8 channel) + PADAPTER Adapter, + u8 channel) { int i = 0; @@ -10619,16 +10843,19 @@ BOOLEAN IsLegal5GChannel( u8 collect_bss_info(_adapter *padapter, union recv_frame *precv_frame, WLAN_BSSID_EX *bssid) { int i; - u32 len; + sint 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_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) { @@ -10641,18 +10868,18 @@ u8 collect_bss_info(_adapter *padapter, union recv_frame *precv_frame, WLAN_BSSI 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_; } } @@ -10665,9 +10892,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 @@ -10699,6 +10936,11 @@ u8 collect_bss_info(_adapter *padapter, union recv_frame *precv_frame, WLAN_BSSI RTW_INFO("%s()-%d: IE too long (%d) for survey event\n", __FUNCTION__, __LINE__, len); return _FAIL; } + if (rtw_validate_value(_SUPPORTEDRATES_IE_, p+2, len) == _FALSE) { + rtw_absorb_ssid_ifneed(padapter, bssid, pframe); + RTW_DBG_DUMP("Invalidated Support Rate IE --", p, len+2); + return _FAIL; + } _rtw_memcpy(bssid->SupportedRates, (p + 2), len); i = len; } @@ -10709,19 +10951,14 @@ u8 collect_bss_info(_adapter *padapter, union recv_frame *precv_frame, WLAN_BSSI RTW_INFO("%s()-%d: IE too long (%d) for survey event\n", __FUNCTION__, __LINE__, len); return _FAIL; } + if (rtw_validate_value(_EXT_SUPPORTEDRATES_IE_, p+2, len) == _FALSE) { + rtw_absorb_ssid_ifneed(padapter, bssid, pframe); + RTW_DBG_DUMP("Invalidated EXT Support Rate IE --", p, len+2); + return _FAIL; + } _rtw_memcpy(bssid->SupportedRates + i, (p + 2), len); } - /* todo: */ -#if 0 - if (judge_network_type(bssid->SupportedRates, (len + i)) == WIRELESS_11B) - bssid->NetworkTypeInUse = Ndis802_11DS; - else -#endif - { - bssid->NetworkTypeInUse = Ndis802_11OFDM24; - } - #ifdef CONFIG_P2P if (subtype == WIFI_PROBEREQ) { u8 *p2p_ie; @@ -10777,12 +11014,49 @@ u8 collect_bss_info(_adapter *padapter, union recv_frame *precv_frame, WLAN_BSSI val16 = rtw_get_capability((WLAN_BSSID_EX *)bssid); - if (val16 & BIT(0)) { + if ((val16 & 0x03) == cap_ESS) { bssid->InfrastructureMode = Ndis802_11Infrastructure; _rtw_memcpy(bssid->MacAddress, get_addr2_ptr(pframe), ETH_ALEN); - } else { + } else if ((val16 & 0x03) == cap_IBSS){ bssid->InfrastructureMode = Ndis802_11IBSS; _rtw_memcpy(bssid->MacAddress, GetAddr3Ptr(pframe), ETH_ALEN); + } else if ((val16 & 0x03) == 0x00){ + u8 *mesh_id_ie, *mesh_conf_ie; + sint mesh_id_ie_len, mesh_conf_ie_len; + + mesh_id_ie = rtw_get_ie(bssid->IEs + ie_offset, WLAN_EID_MESH_ID, &mesh_id_ie_len, bssid->IELength - ie_offset); + mesh_conf_ie = rtw_get_ie(bssid->IEs + ie_offset, WLAN_EID_MESH_CONFIG, &mesh_conf_ie_len, bssid->IELength - ie_offset); + if (mesh_id_ie || mesh_conf_ie) { + if (!mesh_id_ie) { + RTW_INFO("cannot find Mesh ID for survey event\n"); + return _FAIL; + } + if (mesh_id_ie_len) { + if (mesh_id_ie_len > NDIS_802_11_LENGTH_SSID) { + RTW_INFO("Mesh ID too long (%d) for survey event\n", mesh_id_ie_len); + return _FAIL; + } + _rtw_memcpy(bssid->mesh_id.Ssid, (mesh_id_ie + 2), mesh_id_ie_len); + bssid->mesh_id.SsidLength = mesh_id_ie_len; + } else + bssid->mesh_id.SsidLength = 0; + + if (!mesh_conf_ie) { + RTW_INFO("cannot find Mesh config for survey event\n"); + return _FAIL; + } + if (mesh_conf_ie_len != 7) { + RTW_INFO("invalid Mesh conf IE len (%d) for survey event\n", mesh_conf_ie_len); + return _FAIL; + } + + bssid->InfrastructureMode = Ndis802_11_mesh; + _rtw_memcpy(bssid->MacAddress, GetAddr3Ptr(pframe), ETH_ALEN); + } else { + /* default cases */ + bssid->InfrastructureMode = Ndis802_11IBSS; + _rtw_memcpy(bssid->MacAddress, GetAddr3Ptr(pframe), ETH_ALEN); + } } if (val16 & BIT(4)) @@ -10809,12 +11083,6 @@ u8 collect_bss_info(_adapter *padapter, union recv_frame *precv_frame, WLAN_BSSI } -#ifdef CONFIG_INTEL_WIDI - /* process_intel_widi_query_or_tigger(padapter, bssid); */ - if (process_intel_widi_query_or_tigger(padapter, bssid)) - return _FAIL; -#endif /* CONFIG_INTEL_WIDI */ - #if defined(DBG_RX_SIGNAL_DISPLAY_SSID_MONITORED) & 1 if (strcmp(bssid->Ssid.Ssid, DBG_RX_SIGNAL_DISPLAY_SSID_MONITORED) == 0) { RTW_INFO("Receiving %s("MAC_FMT", DSConfig:%u) from ch%u with ss:%3u, sq:%3u, RawRSSI:%3ld\n" @@ -10829,6 +11097,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; } @@ -10874,14 +11150,15 @@ void start_create_ibss(_adapter *padapter) /* issue beacon */ if (send_beacon(padapter) == _FAIL) { - report_join_res(padapter, -1); + report_join_res(padapter, -1, WLAN_STATUS_UNSPECIFIED_FAILURE); pmlmeinfo->state = WIFI_FW_NULL_STATE; } else { rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, padapter->registrypriv.dev_network.MacAddress); + rtw_hal_rcr_set_chk_bssid(padapter, MLME_ADHOC_STARTED); join_type = 0; rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); - report_join_res(padapter, 1); + report_join_res(padapter, 1, WLAN_STATUS_SUCCESS); pmlmeinfo->state |= WIFI_FW_ASSOC_SUCCESS; rtw_indicate_connect(padapter); } @@ -10956,7 +11233,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; @@ -10980,26 +11257,14 @@ void start_clnt_join(_adapter *padapter) (REAUTH_TO * REAUTH_LIMIT) + (REASSOC_TO * REASSOC_LIMIT) + beacon_timeout); #ifdef CONFIG_RTW_80211R - if ((rtw_to_roam(padapter) > 0) && rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) { - if (rtw_chk_ft_flags(padapter, RTW_FT_OVER_DS_SUPPORTED)) { - struct mlme_priv *pmlmepriv = &padapter->mlmepriv; - ft_priv *pftpriv = &pmlmepriv->ftpriv; - - pmlmeinfo->state = WIFI_FW_AUTH_SUCCESS | WIFI_FW_STATION_STATE; - pftpriv->ft_event.ies = pftpriv->ft_action + sizeof(struct rtw_ieee80211_hdr_3addr) + 16; - pftpriv->ft_event.ies_len = pftpriv->ft_action_len - sizeof(struct rtw_ieee80211_hdr_3addr); - - /*Not support RIC*/ - pftpriv->ft_event.ric_ies = NULL; - pftpriv->ft_event.ric_ies_len = 0; - report_ft_event(padapter); - } else { - pmlmeinfo->state = WIFI_FW_AUTH_NULL | WIFI_FW_STATION_STATE; - start_clnt_auth(padapter); - } + if (rtw_ft_roam(padapter)) { + rtw_ft_start_clnt_join(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); @@ -11010,7 +11275,7 @@ void start_clnt_join(_adapter *padapter) pmlmeinfo->state = WIFI_FW_ADHOC_STATE; - report_join_res(padapter, 1); + report_join_res(padapter, 1, WLAN_STATUS_SUCCESS); } else { /* RTW_INFO("marc: invalid cap:%x\n", caps); */ return; @@ -11022,6 +11287,7 @@ void start_clnt_auth(_adapter *padapter) { struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + struct wifidirect_info *pwdinfo = &(padapter->wdinfo); _cancel_timer_ex(&pmlmeext->link_timer); @@ -11035,12 +11301,28 @@ void start_clnt_auth(_adapter *padapter) pmlmeext->retry = 0; #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_AUTHENTICATING_STA); + if (rtw_ft_roam(padapter)) { + rtw_ft_set_status(padapter, RTW_FT_AUTHENTICATING_STA); RTW_PRINT("start ft auth\n"); } else #endif RTW_PRINT("start auth\n"); + +#ifdef CONFIG_IOCTL_CFG80211 + if (rtw_sec_chk_auth_type(padapter, NL80211_AUTHTYPE_SAE)) { + if (rtw_cached_pmkid(padapter, get_my_bssid(&pmlmeinfo->network)) != -1) { + RTW_INFO("SAE: PMKSA cache entry found\n"); + padapter->securitypriv.auth_alg = WLAN_AUTH_OPEN; + goto no_external_auth; + } + + RTW_PRINT("SAE: start external auth\n"); + rtw_cfg80211_external_auth_request(padapter, NULL); + return; + } +no_external_auth: +#endif /* CONFIG_IOCTL_CFG80211 */ + issue_auth(padapter, NULL, 0); set_link_timer(pmlmeext, REAUTH_TO); @@ -11059,7 +11341,7 @@ void start_clnt_assoc(_adapter *padapter) pmlmeinfo->state |= (WIFI_FW_AUTH_SUCCESS | WIFI_FW_ASSOC_STATE); #ifdef CONFIG_RTW_80211R - if ((rtw_to_roam(padapter) > 0) && rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) + if (rtw_ft_roam(padapter)) issue_reassocreq(padapter); else #endif @@ -11078,18 +11360,23 @@ 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) pmlmeinfo->state = WIFI_FW_NULL_STATE; } else if (pmlmeinfo->state & WIFI_FW_LINKING_STATE) { - if (report_join_res(padapter, -2) != _FAIL) + if (report_join_res(padapter, -2, reason) != _FAIL) pmlmeinfo->state = WIFI_FW_NULL_STATE; } else RTW_INFO(FUNC_ADPT_FMT" - End to Disconnect\n", FUNC_ADPT_ARG(padapter)); #ifdef CONFIG_RTW_80211R - if ((rtw_to_roam(padapter) > 0) && !rtw_chk_ft_status(padapter, RTW_FT_REQUESTED_STA)) - rtw_reset_ft_status(padapter); + rtw_ft_roam_status_reset(padapter); +#endif +#ifdef CONFIG_RTW_WNM + rtw_wnm_reset_btm_state(padapter); #endif } @@ -11099,6 +11386,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; @@ -11115,7 +11403,7 @@ static void process_80211d(PADAPTER padapter, WLAN_BSSID_EX *bssid) u8 *ie, *p; u32 len; RT_CHANNEL_PLAN chplan_ap; - RT_CHANNEL_INFO chplan_sta[MAX_CHANNEL_NUM]; + RT_CHANNEL_INFO *chplan_sta = NULL; u8 country[4]; u8 fcn; /* first channel number */ u8 noc; /* number of channel */ @@ -11163,7 +11451,11 @@ static void process_80211d(PADAPTER padapter, WLAN_BSSID_EX *bssid) _RTW_INFO("}\n"); #endif - _rtw_memcpy(chplan_sta, pmlmeext->channel_set, sizeof(chplan_sta)); + chplan_sta = rtw_malloc(sizeof(RT_CHANNEL_INFO) * MAX_CHANNEL_NUM); + if (!chplan_sta) + goto done_update_chplan_from_ap; + + _rtw_memcpy(chplan_sta, rfctl->channel_set, sizeof(RT_CHANNEL_INFO) * MAX_CHANNEL_NUM); #ifdef CONFIG_RTW_DEBUG i = 0; RTW_INFO("%s: STA channel plan {", __FUNCTION__); @@ -11174,8 +11466,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) { @@ -11335,26 +11627,10 @@ static void process_80211d(PADAPTER padapter, WLAN_BSSID_EX *bssid) k++; } #endif - } - /* If channel is used by AP, set channel scan type to active */ - channel = bssid->Configuration.DSConfig; - chplan_new = pmlmeext->channel_set; - i = 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) - break; - - chplan_new[i].ScanType = SCAN_ACTIVE; - RTW_INFO("%s: change channel %d scan type from passive to active\n", - __FUNCTION__, channel); - } - break; - } - i++; +done_update_chplan_from_ap: + if (chplan_sta) + rtw_mfree(chplan_sta, sizeof(RT_CHANNEL_INFO) * MAX_CHANNEL_NUM); } } #endif @@ -11376,6 +11652,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; @@ -11421,6 +11699,22 @@ void report_survey_event(_adapter *padapter, union recv_frame *precv_frame) process_80211d(padapter, &psurvey_evt->bss); #endif + 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) { + if (chset[ch_set_idx].ScanType == SCAN_PASSIVE + && !rtw_is_dfs_ch(psurvey_evt->bss.Configuration.DSConfig) + ) { + RTW_INFO("%s: change ch:%d to active\n", __func__, psurvey_evt->bss.Configuration.DSConfig); + chset[ch_set_idx].ScanType = SCAN_ACTIVE; + } + #ifdef CONFIG_DFS + if (hidden_ssid_ap(&psurvey_evt->bss)) + chset[ch_set_idx].hidden_bss_cnt++; + #endif + } + } + rtw_enqueue_cmd(pcmdpriv, pcmd_obj); pmlmeext->sitesurvey_res.bss_cnt++; @@ -11475,7 +11769,7 @@ void report_surveydone_event(_adapter *padapter) } -u32 report_join_res(_adapter *padapter, int res) +u32 report_join_res(_adapter *padapter, int aid_res, u16 status) { struct cmd_obj *pcmd_obj; u8 *pevtcmd; @@ -11514,12 +11808,12 @@ u32 report_join_res(_adapter *padapter, int res) pjoinbss_evt = (struct joinbss_event *)(pevtcmd + sizeof(struct C2HEvent_Header)); _rtw_memcpy((unsigned char *)(&(pjoinbss_evt->network.network)), &(pmlmeinfo->network), sizeof(WLAN_BSSID_EX)); - pjoinbss_evt->network.join_res = pjoinbss_evt->network.aid = res; + pjoinbss_evt->network.join_res = pjoinbss_evt->network.aid = aid_res; - RTW_INFO("report_join_res(%d)\n", res); + RTW_INFO("report_join_res(%d, %u)\n", aid_res, status); - rtw_joinbss_event_prehandle(padapter, (u8 *)&pjoinbss_evt->network); + rtw_joinbss_event_prehandle(padapter, (u8 *)&pjoinbss_evt->network, status); ret = rtw_enqueue_cmd(pcmdpriv, pcmd_obj); @@ -11536,7 +11830,6 @@ void report_wmm_edca_update(_adapter *padapter) struct wmm_event *pwmm_event; struct C2HEvent_Header *pc2h_evt_hdr; struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); struct cmd_priv *pcmdpriv = &padapter->cmdpriv; pcmd_obj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); @@ -11604,7 +11897,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; @@ -11740,9 +12033,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; } @@ -11818,6 +12111,10 @@ 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 */ { @@ -11839,7 +12136,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) @@ -11847,8 +12144,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); @@ -11862,14 +12166,32 @@ static void rtw_mlmeext_disconnect(_adapter *padapter) struct mlme_priv *pmlmepriv = &padapter->mlmepriv; 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}; - /* set_opmode_cmd(padapter, infra_client_with_mlme); */ + 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 { + RTW_INFO("state:0x%x\n", MLME_STATE(padapter)); + rtw_warn_on(1); + } + /* set_opmode_cmd(padapter, infra_client_with_mlme); */ +#ifdef CONFIG_HW_P0_TSF_SYNC + if (self_action == MLME_STA_DISCONNECTED) + correct_TSF(padapter, self_action); +#endif rtw_hal_set_hwreg(padapter, HW_VAR_MLME_DISCONNECT, 0); rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, null_addr); + if (self_action == MLME_STA_DISCONNECTED) + rtw_hal_rcr_set_chk_bssid(padapter, self_action); /* set MSR to no link state->infra. mode */ Set_MSR(padapter, _HW_STATE_STATION_); @@ -11893,7 +12215,7 @@ static void rtw_mlmeext_disconnect(_adapter *padapter) { _adapter *port0_iface = dvobj_get_port0_adapter(adapter_to_dvobj(padapter)); if (port0_iface) - rtw_lps_ctrl_wk_cmd(port0_iface, LPS_CTRL_CONNECT, 0); + rtw_lps_ctrl_wk_cmd(port0_iface, LPS_CTRL_CONNECT, RTW_CMDF_DIRECTLY); } #endif } @@ -11902,22 +12224,23 @@ static void rtw_mlmeext_disconnect(_adapter *padapter) /* switch to the 20M Hz mode after disconnect */ pmlmeext->cur_bwmode = CHANNEL_WIDTH_20; pmlmeext->cur_ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; +#ifdef CONFIG_CTRL_TXSS_BY_TP + pmlmeext->txss_1ss = _FALSE; +#endif #ifdef CONFIG_FCS_MODE if (EN_FCS(padapter)) rtw_hal_set_hwreg(padapter, HW_VAR_STOP_FCS_MODE, NULL); #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); -#endif - - { + if (!(MLME_IS_STA(padapter) && MLME_IS_OPCH_SW(padapter))) { + /* DFS and channel status no need to check here for STA under OPCH_SW */ u8 ch, bw, offset; + #ifdef CONFIG_DFS_MASTER + rtw_dfs_rd_en_decision(padapter, self_action, 0); + #endif + if (rtw_mi_get_ch_setting_union_no_self(padapter, &ch, &bw, &offset) != 0) { set_channel_bwmode(padapter, ch, offset, bw); rtw_mi_update_union_chan_inf(padapter, ch, offset, bw); @@ -11940,28 +12263,49 @@ 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 */ +#ifdef CONFIG_RTS_FULL_BW + rtw_set_rts_bw(padapter); +#endif/*CONFIG_RTS_FULL_BW*/ + } void mlmeext_joinbss_event_callback(_adapter *padapter, int join_res) { - struct sta_info *psta, *psta_bmc; + struct sta_info *psta; struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); struct sta_priv *pstapriv = &padapter->stapriv; u8 join_type; -#ifdef CONFIG_ARP_KEEP_ALIVE struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -#endif + +#ifndef CONFIG_IOCTL_CFG80211 struct security_priv *psecuritypriv = &padapter->securitypriv; +#endif + + if (pmlmepriv->wpa_phase == _TRUE) + pmlmepriv->wpa_phase = _FALSE; if (join_res < 0) { join_type = 1; rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, null_addr); + if ((pmlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE) + rtw_hal_rcr_set_chk_bssid(padapter, MLME_STA_DISCONNECTED); goto exit_mlmeext_joinbss_event_callback; } + #ifdef CONFIG_ARP_KEEP_ALIVE pmlmepriv->bGetGateway = 1; pmlmepriv->GetGatewayTryCnt = 0; @@ -11979,6 +12323,10 @@ void mlmeext_joinbss_event_callback(_adapter *padapter, int join_res) /* update IOT-releated issue */ update_IOT_info(padapter); + #ifdef CONFIG_RTS_FULL_BW + rtw_set_rts_bw(padapter); + #endif/*CONFIG_RTS_FULL_BW*/ + rtw_hal_set_hwreg(padapter, HW_VAR_BASIC_RATE, cur_network->SupportedRates); /* BCN interval */ @@ -11989,10 +12337,10 @@ void mlmeext_joinbss_event_callback(_adapter *padapter, int join_res) /* WMM, Update EDCA param */ WMMOnAssocRsp(padapter); - +#ifdef CONFIG_80211N_HT /* HT */ HTOnAssocRsp(padapter); - +#endif /* CONFIG_80211N_HT */ #ifdef CONFIG_80211AC_VHT /* VHT */ VHTOnAssocRsp(padapter); @@ -12000,14 +12348,8 @@ 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->mac_id); -#endif - /* set per sta rate after updating HT cap. */ set_sta_rate(padapter, psta); @@ -12015,7 +12357,9 @@ 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); + + rtw_xmit_queue_clear(psta); } #ifndef CONFIG_IOCTL_CFG80211 @@ -12030,8 +12374,10 @@ void mlmeext_joinbss_event_callback(_adapter *padapter, int join_res) rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); if ((pmlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE) { + rtw_hal_rcr_set_chk_bssid(padapter, MLME_STA_CONNECTED); + /* correcting TSF */ - correct_TSF(padapter, pmlmeext); + correct_TSF(padapter, MLME_STA_CONNECTED); /* set_link_timer(pmlmeext, DISCONNECT_TO); */ } @@ -12040,7 +12386,7 @@ void mlmeext_joinbss_event_callback(_adapter *padapter, int join_res) #ifndef CONFIG_FW_MULTI_PORT_SUPPORT if (get_hw_port(padapter) == HW_PORT0) #endif - rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_CONNECT, 0); + rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_CONNECT, RTW_CMDF_DIRECTLY); #endif #ifdef CONFIG_BEAMFORMING @@ -12051,7 +12397,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__); } @@ -12072,7 +12420,7 @@ void mlmeext_sta_add_event_callback(_adapter *padapter, struct sta_info *psta) /* update_TSF(pmlmeext, pframe, len); */ /* correcting TSF */ - correct_TSF(padapter, pmlmeext); + correct_TSF(padapter, MLME_ADHOC_STARTED); /* start beacon */ if (send_beacon(padapter) == _FAIL) @@ -12088,11 +12436,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); @@ -12100,12 +12448,8 @@ void mlmeext_sta_add_event_callback(_adapter *padapter, struct sta_info *psta) void mlmeext_sta_del_event_callback(_adapter *padapter) { - struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); - if (is_client_associated_to_ap(padapter) || is_IBSS_empty(padapter)) rtw_mlmeext_disconnect(padapter); - } /**************************************************************************** @@ -12115,50 +12459,10 @@ 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 undecorated_smoothed_pwdb = 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, &undecorated_smoothed_pwdb); - - RTW_INFO("AP[" MAC_FMT "] - undecorated_smoothed_pwdb:%d\n", - MAC_ARG(padapter->mlmepriv.cur_network.network.MacAddress), undecorated_smoothed_pwdb); - } 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 "]:undecorated_smoothed_pwdb:%d\n", - MAC_ARG(psta->hwaddr), psta->rssi_stat.undecorated_smoothed_pwdb); - } - _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); - } - - } /******************************************************************** @@ -12188,9 +12492,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; @@ -12207,11 +12511,10 @@ 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; +#ifdef DBG_EXPIRATION_CHK struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); -#ifdef DBG_EXPIRATION_CHK RTW_INFO(FUNC_ADPT_FMT" rx:"STA_PKTS_FMT", beacon:%llu, probersp_to_self:%llu" /*", probersp_bm:%llu, probersp_uo:%llu, probereq:%llu, BI:%u"*/ ", retry:%u\n" @@ -12227,7 +12530,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 @@ -12242,12 +12545,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; } @@ -12259,8 +12556,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.undecorated_smoothed_pwdb + , 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 @@ -12331,11 +12628,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++; } @@ -12379,12 +12676,21 @@ void linked_status_chk_tdls(_adapter *padapter) } #endif /* CONFIG_TDLS */ +inline int rtw_get_rx_chk_limit(_adapter *adapter) +{ + return adapter->stapriv.rx_chk_limit; +} + +inline void rtw_set_rx_chk_limit(_adapter *adapter, int limit) +{ + adapter->stapriv.rx_chk_limit = limit; +} + /* from_timer == 1 means driver is in LPS */ void linked_status_chk(_adapter *padapter, u8 from_timer) { u32 i; struct sta_info *psta; - struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); struct sta_priv *pstapriv = &padapter->stapriv; @@ -12405,15 +12711,21 @@ 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) { + if ((precvpriv->signal_strength_data.avg_val < pmlmepriv->roam_rssi_threshold) + && (rtw_get_passing_time_ms(pmlmepriv->last_roaming) >= pmlmepriv->roam_scan_int*2000)) { +#ifdef CONFIG_RTW_80211K + rtw_roam_nb_discover(padapter, _FALSE); +#endif pmlmepriv->need_to_roam = _TRUE; rtw_drv_scan_by_self(padapter, RTW_AUTO_SCAN_REASON_ROAM); - } else { + pmlmepriv->last_roaming = rtw_get_current_time(); + } else pmlmepriv->need_to_roam = _FALSE; - } } #endif #ifdef CONFIG_MCC_MODE @@ -12426,13 +12738,8 @@ void linked_status_chk(_adapter *padapter, u8 from_timer) return; #endif -#if defined(DBG_ROAMING_TEST) - rx_chk_limit = 1; -#elif defined(CONFIG_ACTIVE_KEEP_ALIVE_CHECK) && !defined(CONFIG_LPS_LCLK_WD_TIMER) - rx_chk_limit = 4; -#else - rx_chk_limit = 8; -#endif + rx_chk_limit = rtw_get_rx_chk_limit(padapter); + #ifdef CONFIG_ARP_KEEP_ALIVE if (!from_timer && pmlmepriv->bGetGateway == 1 && pmlmepriv->GetGatewayTryCnt < 3) { RTW_INFO("do rtw_gw_addr_query() : %d\n", pmlmepriv->GetGatewayTryCnt); @@ -12441,7 +12748,7 @@ void linked_status_chk(_adapter *padapter, u8 from_timer) pmlmepriv->bGetGateway = 0; else { _rtw_memset(pmlmepriv->gw_ip, 0, 4); - _rtw_memset(pmlmepriv->gw_mac_addr, 0, 6); + _rtw_memset(pmlmepriv->gw_mac_addr, 0, ETH_ALEN); } } #endif @@ -12485,44 +12792,53 @@ void linked_status_chk(_adapter *padapter, u8 from_timer) 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) - if (pmlmeext->active_keep_alive_check && (rx_chk == _FAIL || tx_chk == _FAIL) - #ifdef CONFIG_MCC_MODE - /* Driver don't know operation channel under MCC*/ - /* So driver don't do KEEP_ALIVE_CHECK */ - && (!rtw_hal_check_mcc_status(padapter, MCC_STATUS_NEED_MCC)) - #endif +#ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK + if (!from_timer && pmlmeext->active_keep_alive_check && (rx_chk == _FAIL || tx_chk == _FAIL) ) { - u8 backup_ch = 0, backup_bw, backup_offset; - u8 union_ch = 0, union_bw, union_offset; + u8 backup_ch = 0, backup_bw = 0, backup_offset = 0; + u8 union_ch = 0, union_bw = 0, union_offset = 0; + u8 switch_channel_by_drv = _TRUE; - if (!rtw_mi_get_ch_setting_union(padapter, &union_ch, &union_bw, &union_offset) - || pmlmeext->cur_channel != union_ch) - goto bypass_active_keep_alive; + +#ifdef CONFIG_MCC_MODE + if (MCC_EN(padapter)) { + /* driver doesn't switch channel under MCC */ + if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) + switch_channel_by_drv = _FALSE; + } +#endif + if (switch_channel_by_drv) { + if (!rtw_mi_get_ch_setting_union(padapter, &union_ch, &union_bw, &union_offset) + || pmlmeext->cur_channel != union_ch) + goto bypass_active_keep_alive; - /* switch to correct channel of current network before issue keep-alive frames */ - if (rtw_get_oper_ch(padapter) != pmlmeext->cur_channel) { - backup_ch = rtw_get_oper_ch(padapter); - backup_bw = rtw_get_oper_bw(padapter); - backup_offset = rtw_get_oper_choffset(padapter); - set_channel_bwmode(padapter, union_ch, union_offset, union_bw); + /* switch to correct channel of current network before issue keep-alive frames */ + if (rtw_get_oper_ch(padapter) != pmlmeext->cur_channel) { + backup_ch = rtw_get_oper_ch(padapter); + backup_bw = rtw_get_oper_bw(padapter); + backup_offset = rtw_get_oper_choffset(padapter); + set_channel_bwmode(padapter, union_ch, union_offset, union_bw); + } } 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); + if (rtw_mi_check_fwstate(padapter, _FW_UNDER_SURVEY)) + tx_chk = issue_nulldata(padapter, psta->cmn.mac_addr, 1, 3, 1); + else + 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; } /* back to the original operation channel */ - if (backup_ch > 0) + if (backup_ch > 0 && switch_channel_by_drv) set_channel_bwmode(padapter, backup_ch, backup_offset, backup_bw); bypass_active_keep_alive: @@ -12535,9 +12851,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)); } } @@ -12546,11 +12862,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 || rtw_mi_check_fwstate(padapter, _FW_UNDER_SURVEY)) + tx_chk = issue_nulldata(padapter, NULL, 1, 0, 0); + else + tx_chk = issue_nulldata(padapter, NULL, 0, 1, 1); } } @@ -12569,7 +12888,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; } @@ -12591,7 +12910,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) @@ -12614,22 +12933,20 @@ 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; struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; -#ifdef CONFIG_P2P - struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -#endif if (mlmeext_scan_state(pmlmeext) > SCAN_DISABLE) { cmd = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); @@ -12653,8 +12970,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); */ @@ -12667,17 +12996,37 @@ 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 (pmlmeext->join_abort && pmlmeinfo->state != WIFI_FW_NULL_STATE) { + RTW_INFO(FUNC_ADPT_FMT" join abort\n", FUNC_ADPT_ARG(padapter)); + pmlmeinfo->state = WIFI_FW_NULL_STATE; + report_join_res(padapter, -4, WLAN_STATUS_UNSPECIFIED_FAILURE); + goto exit; + } + if (pmlmeinfo->state & WIFI_FW_AUTH_NULL) { RTW_INFO("link_timer_hdl:no beacon while connecting\n"); pmlmeinfo->state = WIFI_FW_NULL_STATE; - report_join_res(padapter, -3); + report_join_res(padapter, -3, WLAN_STATUS_UNSPECIFIED_FAILURE); } else if (pmlmeinfo->state & WIFI_FW_AUTH_STATE) { + +#ifdef CONFIG_IOCTL_CFG80211 + if (rtw_sec_chk_auth_type(padapter, NL80211_AUTHTYPE_SAE)) + return; +#endif /* CONFIG_IOCTL_CFG80211 */ + /* re-auth timer */ if (++pmlmeinfo->reauth_count > REAUTH_LIMIT) { /* if (pmlmeinfo->auth_algo != dot11AuthAlgrthm_Auto) */ /* { */ pmlmeinfo->state = 0; - report_join_res(padapter, -1); + if (pmlmeinfo->auth_status) { + report_join_res(padapter, -1, pmlmeinfo->auth_status); + pmlmeinfo->auth_status = 0; /* reset */ + } else + report_join_res(padapter, -1, WLAN_STATUS_UNSPECIFIED_FAILURE); return; /* } */ /* else */ @@ -12696,18 +13045,18 @@ void link_timer_hdl(_adapter *padapter) if (++pmlmeinfo->reassoc_count > REASSOC_LIMIT) { pmlmeinfo->state = WIFI_FW_NULL_STATE; #ifdef CONFIG_RTW_80211R - if ((rtw_to_roam(padapter) > 0) && rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) { + if (rtw_ft_roam(padapter)) { psta = rtw_get_stainfo(pstapriv, pmlmeinfo->network.MacAddress); if (psta) rtw_free_stainfo(padapter, psta); } #endif - report_join_res(padapter, -2); + report_join_res(padapter, -2, WLAN_STATUS_UNSPECIFIED_FAILURE); return; } #ifdef CONFIG_RTW_80211R - if ((rtw_to_roam(padapter) > 0) && rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) { + if (rtw_ft_roam(padapter)) { RTW_INFO("link_timer_hdl: reassoc timeout and try again\n"); issue_reassocreq(padapter); } else @@ -12720,11 +13069,14 @@ void link_timer_hdl(_adapter *padapter) set_link_timer(pmlmeext, REASSOC_TO); } +exit: 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; @@ -12786,7 +13138,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); @@ -12801,16 +13153,16 @@ void report_sta_timeout_event(_adapter *padapter, u8 *MacAddr, unsigned short re void clnt_sa_query_timeout(_adapter *padapter) { + struct mlme_ext_priv *mlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *mlmeinfo = &(mlmeext->mlmext_info); - rtw_disassoc_cmd(padapter, 0, _TRUE); - rtw_indicate_disconnect(padapter, 0, _FALSE); - rtw_free_assoc_resources(padapter, 1); - - RTW_INFO("SA query timeout client disconnect\n"); + RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); + receive_disconnect(padapter, get_my_bssid(&(mlmeinfo->network)), WLAN_REASON_SA_QUERY_TIMEOUT, _FALSE); } -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; @@ -12820,70 +13172,248 @@ 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 */ #ifdef CONFIG_RTW_80211R -void start_clnt_ft_action(_adapter *padapter, u8 *pTargetAddr) +void rtw_ft_update_bcn(_adapter *padapter, union recv_frame *precv_frame) { - struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + u8 *pframe = precv_frame->u.hdr.rx_data; + uint len = precv_frame->u.hdr.len; + WLAN_BSSID_EX *pbss; - rtw_set_ft_status(padapter, RTW_FT_REQUESTING_STA); - issue_action_ft_request(padapter, pTargetAddr); - _set_timer(&pmlmeext->ft_link_timer, REASSOC_TO); -} + if (rtw_ft_chk_status(padapter,RTW_FT_ASSOCIATED_STA) + && (pmlmepriv->ft_roam.ft_updated_bcn == _FALSE)) { + pbss = (WLAN_BSSID_EX*)rtw_malloc(sizeof(WLAN_BSSID_EX)); + if (pbss) { + if (collect_bss_info(padapter, precv_frame, pbss) == _SUCCESS) { + struct beacon_keys recv_beacon; -void ft_link_timer_hdl(_adapter *padapter) -{ - struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); - struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); - ft_priv *pftpriv = &pmlmepriv->ftpriv; - - if (rtw_chk_ft_status(padapter, RTW_FT_REQUESTING_STA)) { - if (pftpriv->ft_req_retry_cnt < FT_ACTION_REQ_LIMIT) { - pftpriv->ft_req_retry_cnt++; - issue_action_ft_request(padapter, (u8 *)pmlmepriv->roam_network->network.MacAddress); - _set_timer(&pmlmeext->ft_link_timer, REASSOC_TO); - } else { - pftpriv->ft_req_retry_cnt = 0; - - if (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) - rtw_set_ft_status(padapter, RTW_FT_ASSOCIATED_STA); - else - rtw_reset_ft_status(padapter); + update_network(&(pmlmepriv->cur_network.network), pbss, padapter, _TRUE); + rtw_get_bcn_info(&(pmlmepriv->cur_network)); + + /* update bcn keys */ + if (rtw_get_bcn_keys(padapter, pframe, len, &recv_beacon) == _TRUE) { + RTW_INFO("%s: beacon keys ready\n", __func__); + _rtw_memcpy(&pmlmepriv->cur_beacon_keys, + &recv_beacon, sizeof(recv_beacon)); + } else { + RTW_ERR("%s: get beacon keys failed\n", __func__); + _rtw_memset(&pmlmepriv->cur_beacon_keys, 0, sizeof(recv_beacon)); + } + #ifdef CONFIG_BCN_CNT_CONFIRM_HDL + pmlmepriv->new_beacon_cnts = 0; + #endif + } + rtw_mfree((u8*)pbss, sizeof(WLAN_BSSID_EX)); } + + /* check the vendor of the assoc AP */ + pmlmeinfo->assoc_AP_vendor = + check_assoc_AP(pframe+sizeof(struct rtw_ieee80211_hdr_3addr), + (len - sizeof(struct rtw_ieee80211_hdr_3addr))); + + /* update TSF Value */ + update_TSF(pmlmeext, pframe, len); + pmlmeext->bcn_cnt = 0; + pmlmeext->last_bcn_cnt = 0; + pmlmepriv->ft_roam.ft_updated_bcn = _TRUE; } } -void ft_roam_timer_hdl(_adapter *padapter) +void rtw_ft_start_clnt_join(_adapter *padapter) { - struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct ft_roam_info *pft_roam = &(pmlmepriv->ft_roam); - receive_disconnect(padapter, pmlmepriv->cur_network.network.MacAddress - , WLAN_REASON_ACTIVE_ROAM, _FALSE); + if (rtw_ft_otd_roam(padapter)) { + pmlmeinfo->state = WIFI_FW_AUTH_SUCCESS | WIFI_FW_STATION_STATE; + pft_roam->ft_event.ies = + (pft_roam->ft_action + sizeof(struct rtw_ieee80211_hdr_3addr) + 16); + pft_roam->ft_event.ies_len = + (pft_roam->ft_action_len - sizeof(struct rtw_ieee80211_hdr_3addr)); + + /*Not support RIC*/ + pft_roam->ft_event.ric_ies = NULL; + pft_roam->ft_event.ric_ies_len = 0; + rtw_ft_report_evt(padapter); + return; + } + + pmlmeinfo->state = WIFI_FW_AUTH_NULL | WIFI_FW_STATION_STATE; + start_clnt_auth(padapter); } -void issue_action_ft_request(_adapter *padapter, u8 *pTargetAddr) +u8 rtw_ft_update_rsnie( + _adapter *padapter, u8 bwrite, + struct pkt_attrib *pattrib, u8 **pframe) { - struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct ft_roam_info *pft_roam = &(padapter->mlmepriv.ft_roam); + u8 *pie; + u32 len; + + pie = rtw_get_ie(pft_roam->updated_ft_ies, EID_WPA2, &len, + pft_roam->updated_ft_ies_len); + + if (!bwrite) + return (pie)?_SUCCESS:_FAIL; + + if (pie) { + *pframe = rtw_set_ie(((u8 *)*pframe), EID_WPA2, len, + pie+2, &(pattrib->pktlen)); + } else + return _FAIL; + + return _SUCCESS; +} + +static u8 rtw_ft_update_mdie( + _adapter *padapter, struct pkt_attrib *pattrib, u8 **pframe) +{ + struct ft_roam_info *pft_roam = &(padapter->mlmepriv.ft_roam); + u8 *pie, mdie[3]; + u32 len = 3; + + if (rtw_ft_roam(padapter)) { + if ((pie = rtw_get_ie(pft_roam->updated_ft_ies, _MDIE_, + &len, pft_roam->updated_ft_ies_len))) { + pie = (pie + 2); /* ignore md-id & length */ + } else + return _FAIL; + } else { + *((u16 *)&mdie[0]) = pft_roam->mdid; + mdie[2] = pft_roam->ft_cap; + pie = &mdie[0]; + } + + *pframe = rtw_set_ie(((u8 *)*pframe), _MDIE_, len , pie, &(pattrib->pktlen)); + return _SUCCESS; +} + +static u8 rtw_ft_update_ftie( + _adapter *padapter, struct pkt_attrib *pattrib, u8 **pframe) +{ + struct ft_roam_info *pft_roam = &(padapter->mlmepriv.ft_roam); + u8 *pie; + u32 len; + + if ((pie = rtw_get_ie(pft_roam->updated_ft_ies, _FTIE_, &len, + pft_roam->updated_ft_ies_len)) != NULL) { + *pframe = rtw_set_ie(*pframe, _FTIE_, len , + (pie+2), &(pattrib->pktlen)); + } else + return _FAIL; + + return _SUCCESS; +} + +void rtw_ft_build_auth_req_ies(_adapter *padapter, + struct pkt_attrib *pattrib, u8 **pframe) +{ + u8 ftie_append = _TRUE; + + if (!pattrib || !(*pframe)) + return; + + if (!rtw_ft_roam(padapter)) + return; + + ftie_append = rtw_ft_update_rsnie(padapter, _TRUE, pattrib, pframe); + rtw_ft_update_mdie(padapter, pattrib, pframe); + if (ftie_append) + rtw_ft_update_ftie(padapter, pattrib, pframe); +} + +void rtw_ft_build_assoc_req_ies(_adapter *padapter, + u8 is_reassoc, struct pkt_attrib *pattrib, u8 **pframe) +{ + if (!pattrib || !(*pframe)) + return; + + if (rtw_ft_chk_flags(padapter, RTW_FT_PEER_EN)) + rtw_ft_update_mdie(padapter, pattrib, pframe); + + if ((!is_reassoc) || (!rtw_ft_roam(padapter))) + return; + + if (rtw_ft_update_rsnie(padapter, _FALSE, pattrib, pframe)) + rtw_ft_update_ftie(padapter, pattrib, pframe); +} + +u8 rtw_ft_update_auth_rsp_ies(_adapter *padapter, u8 *pframe, u32 len) +{ + u8 ret = _SUCCESS; + u8 target_ap_addr[ETH_ALEN] = {0}; + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct ft_roam_info *pft_roam = &(pmlmepriv->ft_roam); + + if (!rtw_ft_roam(padapter)) + return _FAIL; + + /*rtw_ft_report_reassoc_evt already, + * and waiting for cfg80211_rtw_update_ft_ies */ + if (rtw_ft_authed_sta(padapter)) + return ret; + + if (!pframe || !len) + return _FAIL; + + rtw_buf_update(&pmlmepriv->auth_rsp, + &pmlmepriv->auth_rsp_len, pframe, len); + pft_roam->ft_event.ies = + (pmlmepriv->auth_rsp + sizeof(struct rtw_ieee80211_hdr_3addr) + 6); + pft_roam->ft_event.ies_len = + (pmlmepriv->auth_rsp_len - sizeof(struct rtw_ieee80211_hdr_3addr) - 6); + + /*Not support RIC*/ + pft_roam->ft_event.ric_ies = NULL; + pft_roam->ft_event.ric_ies_len = 0; + _rtw_memcpy(target_ap_addr, pmlmepriv->assoc_bssid, ETH_ALEN); + rtw_ft_report_reassoc_evt(padapter, target_ap_addr); + + return ret; +} + +static void rtw_ft_start_clnt_action(_adapter *padapter, u8 *pTargetAddr) +{ + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + + rtw_ft_set_status(padapter, RTW_FT_REQUESTING_STA); + rtw_ft_issue_action_req(padapter, pTargetAddr); + _set_timer(&pmlmeext->ft_link_timer, REASSOC_TO); +} + +void rtw_ft_start_roam(_adapter *padapter, u8 *pTargetAddr) +{ + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + + if (rtw_ft_otd_roam(padapter)) { + rtw_ft_start_clnt_action(padapter, pTargetAddr); + } else { + /*wait a little time to retrieve packets buffered in the current ap while scan*/ + _set_timer(&pmlmeext->ft_roam_timer, 30); + } +} + +void rtw_ft_issue_action_req(_adapter *padapter, u8 *pTargetAddr) +{ + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); - struct xmit_frame *pmgntframe = NULL; - struct rtw_ieee80211_hdr *pwlanhdr = NULL; - struct pkt_attrib *pattrib = NULL; - ft_priv *pftpriv = NULL; - u8 *pframe = NULL; + struct xmit_frame *pmgntframe; + struct rtw_ieee80211_hdr *pwlanhdr; + struct pkt_attrib *pattrib; + u8 *pframe; u8 category = RTW_WLAN_CATEGORY_FT; - u8 action = RTW_WLAN_ACTION_FT_REQUEST; - u8 is_ft_roaming_with_rsn_ie = _TRUE; - u8 *pie = NULL; - u16 *fctrl = NULL; - u32 ft_ie_len = 0; + u8 action = RTW_WLAN_ACTION_FT_REQ; pmgntframe = alloc_mgtxmitframe(pxmitpriv); if (pmgntframe == NULL) @@ -12895,9 +13425,7 @@ void issue_action_ft_request(_adapter *padapter, u8 *pTargetAddr) pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; - - fctrl = &(pwlanhdr->frame_ctl); - *(fctrl) = 0; + pwlanhdr->frame_ctl = 0; _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&pmlmeinfo->network), ETH_ALEN); _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); @@ -12921,45 +13449,34 @@ void issue_action_ft_request(_adapter *padapter, u8 *pTargetAddr) pframe += ETH_ALEN; pattrib->pktlen += ETH_ALEN; - pftpriv = &pmlmepriv->ftpriv; - pie = rtw_get_ie(pftpriv->updated_ft_ies, EID_WPA2, &ft_ie_len, pftpriv->updated_ft_ies_len); - if (pie) - pframe = rtw_set_ie(pframe, EID_WPA2, ft_ie_len, pie+2, &(pattrib->pktlen)); - else - is_ft_roaming_with_rsn_ie = _FALSE; - - pie = rtw_get_ie(pftpriv->updated_ft_ies, _MDIE_, &ft_ie_len, pftpriv->updated_ft_ies_len); - if (pie) - pframe = rtw_set_ie(pframe, _MDIE_, ft_ie_len , pie+2, &(pattrib->pktlen)); - - pie = rtw_get_ie(pftpriv->updated_ft_ies, _FTIE_, &ft_ie_len, pftpriv->updated_ft_ies_len); - if (pie && is_ft_roaming_with_rsn_ie) - pframe = rtw_set_ie(pframe, _FTIE_, ft_ie_len , pie+2, &(pattrib->pktlen)); + rtw_ft_update_mdie(padapter, pattrib, &pframe); + if (rtw_ft_update_rsnie(padapter, _TRUE, pattrib, &pframe)) + rtw_ft_update_ftie(padapter, pattrib, &pframe); pattrib->last_txcmdsz = pattrib->pktlen; dump_mgntframe(padapter, pmgntframe); } -void report_ft_event(_adapter *padapter) +void rtw_ft_report_evt(_adapter *padapter) { - struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); - ft_priv *pftpriv = &pmlmepriv->ftpriv; - struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); - WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)(&(pmlmeinfo->network)); + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct ft_roam_info *pft_roam = &(pmlmepriv->ft_roam); + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)&(pmlmeinfo->network); struct cfg80211_ft_event_params ft_evt_parms; _irqL irqL; _rtw_memset(&ft_evt_parms, 0, sizeof(ft_evt_parms)); - rtw_update_ft_stainfo(padapter, pnetwork); + rtw_ft_update_stainfo(padapter, pnetwork); if (!pnetwork) goto err_2; - ft_evt_parms.ies_len = pftpriv->ft_event.ies_len; + ft_evt_parms.ies_len = pft_roam->ft_event.ies_len; ft_evt_parms.ies = rtw_zmalloc(ft_evt_parms.ies_len); if (ft_evt_parms.ies) - _rtw_memcpy((void *)ft_evt_parms.ies, pftpriv->ft_event.ies, ft_evt_parms.ies_len); + _rtw_memcpy((void *)ft_evt_parms.ies, pft_roam->ft_event.ies, ft_evt_parms.ies_len); else goto err_2; @@ -12969,31 +13486,28 @@ void report_ft_event(_adapter *padapter) else goto err_1; - ft_evt_parms.ric_ies = pftpriv->ft_event.ric_ies; - ft_evt_parms.ric_ies_len = pftpriv->ft_event.ric_ies_len; - - _enter_critical_bh(&pmlmepriv->lock, &irqL); - rtw_set_ft_status(padapter, RTW_FT_AUTHENTICATED_STA); - _exit_critical_bh(&pmlmepriv->lock, &irqL); + ft_evt_parms.ric_ies = pft_roam->ft_event.ric_ies; + ft_evt_parms.ric_ies_len = pft_roam->ft_event.ric_ies_len; + rtw_ft_lock_set_status(padapter, RTW_FT_AUTHENTICATED_STA, &irqL); rtw_cfg80211_ft_event(padapter, &ft_evt_parms); - RTW_INFO("FT: report_ft_event\n"); - rtw_mfree((u8 *)pftpriv->ft_event.target_ap, ETH_ALEN); + RTW_INFO("FT: rtw_ft_report_evt\n"); + rtw_mfree((u8 *)pft_roam->ft_event.target_ap, ETH_ALEN); err_1: rtw_mfree((u8 *)ft_evt_parms.ies, ft_evt_parms.ies_len); err_2: return; } -void report_ft_reassoc_event(_adapter *padapter, u8 *pMacAddr) +void rtw_ft_report_reassoc_evt(_adapter *padapter, u8 *pMacAddr) { - struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - struct cmd_priv *pcmdpriv = &padapter->cmdpriv; - struct cmd_obj *pcmd_obj = NULL; - struct stassoc_event *passoc_sta_evt = NULL; - struct C2HEvent_Header *pc2h_evt_hdr = NULL; - u8 *pevtcmd = NULL; - u32 cmdsz = 0; + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct cmd_priv *pcmdpriv = &(padapter->cmdpriv); + struct cmd_obj *pcmd_obj = NULL; + struct stassoc_event *passoc_sta_evt = NULL; + struct C2HEvent_Header *pc2h_evt_hdr = NULL; + u8 *pevtcmd = NULL; + u32 cmdsz = 0; pcmd_obj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); if (pcmd_obj == NULL) @@ -13022,6 +13536,50 @@ void report_ft_reassoc_event(_adapter *padapter, u8 *pMacAddr) _rtw_memcpy((unsigned char *)(&(passoc_sta_evt->macaddr)), pMacAddr, ETH_ALEN); rtw_enqueue_cmd(pcmdpriv, pcmd_obj); } + +void rtw_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); + struct ft_roam_info *pft_roam = &(pmlmepriv->ft_roam); + + if (rtw_ft_chk_status(padapter, RTW_FT_REQUESTING_STA)) { + if (pft_roam->ft_req_retry_cnt < RTW_FT_ACTION_REQ_LMT) { + pft_roam->ft_req_retry_cnt++; + rtw_ft_issue_action_req(padapter, (u8 *)pmlmepriv->roam_network->network.MacAddress); + _set_timer(&pmlmeext->ft_link_timer, REASSOC_TO); + } else { + pft_roam->ft_req_retry_cnt = 0; + if (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) + rtw_ft_set_status(padapter, RTW_FT_ASSOCIATED_STA); + else + rtw_ft_reset_status(padapter); + } + } +} + +void rtw_ft_roam_timer_hdl(void *ctx) +{ + _adapter *padapter = (_adapter *)ctx; + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + + receive_disconnect(padapter, pmlmepriv->cur_network.network.MacAddress + , WLAN_REASON_ACTIVE_ROAM, _FALSE); +} + +void rtw_ft_roam_status_reset(_adapter *padapter) +{ + struct ft_roam_info *pft_roam = &(padapter->mlmepriv.ft_roam); + + if ((rtw_to_roam(padapter) > 0) && + (!rtw_ft_chk_status(padapter, RTW_FT_REQUESTED_STA))) { + rtw_ft_reset_status(padapter); + } + + padapter->mlmepriv.ft_roam.ft_updated_bcn = _FALSE; +} #endif u8 NULL_hdl(_adapter *padapter, u8 *pbuf) @@ -13030,13 +13588,47 @@ 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__); rtw_set_802_11_infrastructure_mode(adapter, Ndis802_11APMode); - rtw_setopmode_cmd(adapter, Ndis802_11APMode, _TRUE); + rtw_setopmode_cmd(adapter, Ndis802_11APMode, RTW_CMDF_WAIT_ACK); } static int rtw_auto_ap_start_beacon(_adapter *adapter) @@ -13052,7 +13644,6 @@ static int rtw_auto_ap_start_beacon(_adapter *adapter) u32 ssid_len = sizeof(ssid); struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); - if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) return -EINVAL; @@ -13087,8 +13678,8 @@ static int rtw_auto_ap_start_beacon(_adapter *adapter) ie = rtw_set_ie(ie, _SSID_IE_, ssid_len, ssid, &sz); /* supported rates */ - wireless_mode = WIRELESS_11BG_24N; - rtw_set_supported_rate(supportRate, wireless_mode) ; + wireless_mode = (WIRELESS_11BG_24N & padapter->registrypriv.wireless_mode); + rtw_set_supported_rate(supportRate, wireless_mode); rateLen = rtw_get_rateset_len(supportRate); if (rateLen > 8) ie = rtw_set_ie(ie, _SUPPORTEDRATES_IE_, 8, supportRate, &sz); @@ -13131,12 +13722,11 @@ u8 setopmode_hdl(_adapter *padapter, u8 *pbuf) struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); struct setopmode_parm *psetop = (struct setopmode_parm *)pbuf; - if (psetop->mode == Ndis802_11APMode) { + if (psetop->mode == Ndis802_11APMode + || psetop->mode == Ndis802_11_mesh + ) { 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 */ @@ -13168,14 +13758,16 @@ u8 setopmode_hdl(_adapter *padapter, u8 *pbuf) #ifdef CONFIG_LPS _adapter *port0_iface = dvobj_get_port0_adapter(adapter_to_dvobj(padapter)); if (port0_iface) - rtw_lps_ctrl_wk_cmd(port0_iface, LPS_CTRL_CONNECT, 0); + rtw_lps_ctrl_wk_cmd(port0_iface, LPS_CTRL_CONNECT, RTW_CMDF_DIRECTLY); #endif } } #ifdef CONFIG_BT_COEXIST - if (psetop->mode == Ndis802_11APMode || - psetop->mode == Ndis802_11Monitor) { + if (psetop->mode == Ndis802_11APMode + || psetop->mode == Ndis802_11_mesh + || psetop->mode == Ndis802_11Monitor + ) { /* Do this after port switch to */ /* prevent from downloading rsvd page to wrong port */ rtw_btcoex_MediaStatusNotify(padapter, 1); /* connect */ @@ -13197,7 +13789,9 @@ u8 createbss_hdl(_adapter *padapter, u8 *pbuf) /* u8 initialgain; */ #ifdef CONFIG_AP_MODE - if (pmlmeinfo->state == WIFI_FW_AP_STATE) { + if ((parm->req_ch == 0 && pmlmeinfo->state == WIFI_FW_AP_STATE) + || parm->req_ch != 0 + ) { start_bss_network(padapter, parm); goto exit; } @@ -13218,14 +13812,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); @@ -13259,7 +13845,6 @@ u8 join_cmd_hdl(_adapter *padapter, u8 *pbuf) { u8 join_type; PNDIS_802_11_VARIABLE_IEs pIE; - struct registry_priv *pregpriv = &padapter->registrypriv; struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)(&(pmlmeinfo->network)); @@ -13289,6 +13874,8 @@ u8 join_cmd_hdl(_adapter *padapter, u8 *pbuf) rtw_hal_set_hwreg(padapter, HW_VAR_MLME_DISCONNECT, 0); + if (pmlmeinfo->state & WIFI_FW_STATION_STATE) + rtw_hal_rcr_set_chk_bssid(padapter, MLME_STA_DISCONNECTED); } #ifdef CONFIG_ANTENNA_DIVERSITY @@ -13311,7 +13898,10 @@ u8 join_cmd_hdl(_adapter *padapter, u8 *pbuf) pmlmeinfo->bwmode_updated = _FALSE; /* pmlmeinfo->assoc_AP_vendor = HT_IOT_PEER_MAX; */ pmlmeinfo->VHT_enable = 0; - +#ifdef ROKU_PRIVATE + pmlmeinfo->ht_vht_received = 0; + _rtw_memset(pmlmeinfo->SupportedRates_infra_ap, 0, NDIS_802_11_LENGTH_RATES_EX); +#endif /* ROKU_PRIVATE */ _rtw_memcpy(pnetwork, pbuf, FIELD_OFFSET(WLAN_BSSID_EX, IELength)); pnetwork->IELength = ((WLAN_BSSID_EX *)pbuf)->IELength; @@ -13319,7 +13909,7 @@ u8 join_cmd_hdl(_adapter *padapter, u8 *pbuf) return H2C_PARAMETERS_ERROR; if (pnetwork->IELength < 2) { - report_join_res(padapter, (-4)); + report_join_res(padapter, (-4), WLAN_STATUS_UNSPECIFIED_FAILURE); return H2C_SUCCESS; } _rtw_memcpy(pnetwork->IEs, ((WLAN_BSSID_EX *)pbuf)->IEs, pnetwork->IELength); @@ -13365,7 +13955,7 @@ u8 join_cmd_hdl(_adapter *padapter, u8 *pbuf) } rtw_bss_get_chbw(pnetwork - , &pmlmeext->cur_channel, &pmlmeext->cur_bwmode, &pmlmeext->cur_ch_offset); + , &pmlmeext->cur_channel, &pmlmeext->cur_bwmode, &pmlmeext->cur_ch_offset, 1, 1); rtw_adjust_chbw(padapter, pmlmeext->cur_channel, &pmlmeext->cur_bwmode, &pmlmeext->cur_ch_offset); @@ -13400,7 +13990,7 @@ u8 join_cmd_hdl(_adapter *padapter, u8 *pbuf) /* check channel, bandwidth, offset and switch */ if (rtw_chk_start_clnt_join(padapter, &u_ch, &u_bw, &u_offset) == _FAIL) { - report_join_res(padapter, (-4)); + report_join_res(padapter, (-4), WLAN_STATUS_UNSPECIFIED_FAILURE); return H2C_SUCCESS; } @@ -13412,8 +14002,14 @@ u8 join_cmd_hdl(_adapter *padapter, u8 *pbuf) /*rtw_hal_set_odm_var(padapter, HAL_ODM_INITIAL_GAIN, &initialgain, _FALSE);*/ rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, pmlmeinfo->network.MacAddress); + if (MLME_IS_STA(padapter)) + rtw_hal_rcr_set_chk_bssid(padapter, MLME_STA_CONNECTING); + else + rtw_hal_rcr_set_chk_bssid(padapter, MLME_ADHOC_STARTED); + join_type = 0; rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); + doiqk = _TRUE; rtw_hal_set_hwreg(padapter , HW_VAR_DO_IQK , &doiqk); @@ -13434,35 +14030,38 @@ u8 join_cmd_hdl(_adapter *padapter, u8 *pbuf) u8 disconnect_hdl(_adapter *padapter, unsigned char *pbuf) { +#ifdef CONFIG_DFS + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); +#endif struct disconnect_parm *param = (struct disconnect_parm *)pbuf; 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 val8; - if (is_client_associated_to_ap(padapter)) { -#ifdef CONFIG_DFS - if (padapter->mlmepriv.handle_dfs == _FALSE) -#endif /* CONFIG_DFS */ -#ifdef CONFIG_PLATFORM_ROCKCHIPS - /* To avoid connecting to AP fail during resume process, change retry count from 5 to 1 */ - issue_deauth_ex(padapter, pnetwork->MacAddress, WLAN_REASON_DEAUTH_LEAVING, 1, 100); -#else - issue_deauth_ex(padapter, pnetwork->MacAddress, WLAN_REASON_DEAUTH_LEAVING, param->deauth_timeout_ms / 100, 100); -#endif /* CONFIG_PLATFORM_ROCKCHIPS */ + if (is_client_associated_to_ap(padapter) + #ifdef CONFIG_DFS + && !IS_RADAR_DETECTED(rfctl) && !rfctl->csa_ch + #endif + ) { + #ifdef CONFIG_PLATFORM_ROCKCHIPS + /* To avoid connecting to AP fail during resume process, change retry count from 5 to 1 */ + issue_deauth_ex(padapter, pnetwork->MacAddress, WLAN_REASON_DEAUTH_LEAVING, 1, 100); + #else + issue_deauth_ex(padapter, pnetwork->MacAddress, WLAN_REASON_DEAUTH_LEAVING, param->deauth_timeout_ms / 100, 100); + #endif /* CONFIG_PLATFORM_ROCKCHIPS */ } -#ifdef CONFIG_DFS - if (padapter->mlmepriv.handle_dfs == _TRUE) - padapter->mlmepriv.handle_dfs = _FALSE; -#endif /* CONFIG_DFS */ - +#ifndef CONFIG_SUPPORT_MULTI_BCN if (((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE)) { /* Stop BCN */ val8 = 0; rtw_hal_set_hwreg(padapter, HW_VAR_BCN_FUNC, (u8 *)(&val8)); } +#endif + rtw_sta_mstatus_report(padapter); + rtw_mlmeext_disconnect(padapter); rtw_free_uc_swdec_pending_queue(padapter); @@ -13496,7 +14095,6 @@ const char *scan_state_str(u8 state) static bool scan_abort_hdl(_adapter *adapter) { struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); struct ss_res *ss = &pmlmeext->sitesurvey_res; #ifdef CONFIG_P2P struct wifidirect_info *pwdinfo = &adapter->wdinfo; @@ -13630,14 +14228,79 @@ u8 rtw_scan_sparse(_adapter *adapter, struct rtw_ieee80211_channel *ch, u8 ch_nu return ret_num; } +#ifdef CONFIG_SCAN_BACKOP +u8 rtw_scan_backop_decision(_adapter *adapter) +{ + struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; + struct mi_state mstate; + u8 backop_flags = 0; + + rtw_mi_status(adapter, &mstate); + + if ((MSTATE_STA_LD_NUM(&mstate) && mlmeext_chk_scan_backop_flags_sta(mlmeext, SS_BACKOP_EN)) + || (MSTATE_STA_NUM(&mstate) && mlmeext_chk_scan_backop_flags_sta(mlmeext, SS_BACKOP_EN_NL))) + backop_flags |= mlmeext_scan_backop_flags_sta(mlmeext); + +#ifdef CONFIG_AP_MODE + if ((MSTATE_AP_LD_NUM(&mstate) && mlmeext_chk_scan_backop_flags_ap(mlmeext, SS_BACKOP_EN)) + || (MSTATE_AP_NUM(&mstate) && mlmeext_chk_scan_backop_flags_ap(mlmeext, SS_BACKOP_EN_NL))) + backop_flags |= mlmeext_scan_backop_flags_ap(mlmeext); +#endif + +#ifdef CONFIG_RTW_MESH + if ((MSTATE_MESH_LD_NUM(&mstate) && mlmeext_chk_scan_backop_flags_mesh(mlmeext, SS_BACKOP_EN)) + || (MSTATE_MESH_NUM(&mstate) && mlmeext_chk_scan_backop_flags_mesh(mlmeext, SS_BACKOP_EN_NL))) + backop_flags |= mlmeext_scan_backop_flags_mesh(mlmeext); +#endif + + return backop_flags; +} +#endif + +#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 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_scan_backop_decision(padapter)) + 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) { int i, j; - 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); @@ -13654,7 +14317,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", @@ -13664,7 +14327,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++; @@ -13675,8 +14338,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; @@ -13692,7 +14355,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++; @@ -13709,10 +14372,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 @@ -13721,11 +14388,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; } @@ -13735,7 +14403,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) @@ -13744,12 +14422,15 @@ static u8 sitesurvey_pick_ch_behavior(_adapter *padapter, u8 *ch, RT_SCAN_TYPE * u8 scan_ch = 0; RT_SCAN_TYPE scan_type = SCAN_PASSIVE; 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 +#ifdef CONFIG_SCAN_BACKOP + u8 backop_flags = 0; +#endif /* handle scan abort request */ scan_abort_hdl(padapter); @@ -13766,12 +14447,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 @@ -13779,40 +14458,66 @@ static u8 sitesurvey_pick_ch_behavior(_adapter *padapter, u8 *ch, RT_SCAN_TYPE * { struct rtw_ieee80211_channel *ch; + #ifdef CONFIG_SCAN_BACKOP + backop_flags = rtw_scan_backop_decision(padapter); + #endif + +#ifdef CONFIG_DFS + #ifdef CONFIG_SCAN_BACKOP + if (!(backop_flags && ss->scan_cnt >= ss->scan_cnt_max)) + #endif + { + #ifdef CONFIG_RTW_WIFI_HAL + if (adapter_to_dvobj(padapter)->nodfs) { + while ( ss->channel_idx < ss->ch_num && rtw_is_dfs_ch(ss->ch[ss->channel_idx].hw_value)) + ss->channel_idx++; + } else + #endif + 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 + && (!IS_DFS_SLAVE_WITH_RD(rfctl) + || rtw_odm_dfs_domain_unknown(rfctl_to_dvobj(rfctl)) + || !CH_IS_NON_OCP(&rfctl->channel_set[ch_set_idx])) + ) { + 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; } } if (scan_ch != 0) { next_state = SCAN_PROCESS; -#ifdef CONFIG_SCAN_BACKOP - { - struct mi_state mstate; - u8 backop_flags = 0; - rtw_mi_status(padapter, &mstate); - - if ((MSTATE_STA_LD_NUM(&mstate) && mlmeext_chk_scan_backop_flags_sta(pmlmeext, SS_BACKOP_EN)) - || (MSTATE_STA_NUM(&mstate) && mlmeext_chk_scan_backop_flags_sta(pmlmeext, SS_BACKOP_EN_NL))) - backop_flags |= mlmeext_scan_backop_flags_sta(pmlmeext); - - if ((MSTATE_AP_LD_NUM(&mstate) && mlmeext_chk_scan_backop_flags_ap(pmlmeext, SS_BACKOP_EN)) - || (MSTATE_AP_NUM(&mstate) && mlmeext_chk_scan_backop_flags_ap(pmlmeext, SS_BACKOP_EN_NL))) - backop_flags |= mlmeext_scan_backop_flags_ap(pmlmeext); - - if (backop_flags) { - if (ss->scan_cnt < ss->scan_cnt_max) - ss->scan_cnt++; - else { - mlmeext_assign_scan_backop_flags(pmlmeext, backop_flags); - next_state = SCAN_BACKING_OP; - } + #ifdef CONFIG_SCAN_BACKOP + if (backop_flags) { + if (ss->scan_cnt < ss->scan_cnt_max) + ss->scan_cnt++; + else { + mlmeext_assign_scan_backop_flags(pmlmeext, backop_flags); + next_state = SCAN_BACKING_OP; } } -#endif /* CONFIG_SCAN_BACKOP */ + #endif + } else if (rtw_p2p_findphase_ex_is_needed(pwdinfo)) { /* go p2p listen */ next_state = SCAN_TO_P2P_LISTEN; @@ -13872,28 +14577,23 @@ static u8 sitesurvey_pick_ch_behavior(_adapter *padapter, u8 *ch, RT_SCAN_TYPE * 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 +#ifndef CONFIG_IOCTL_CFG80211 struct wifidirect_info *pwdinfo = &(padapter->wdinfo); +#endif #endif 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 @@ -13909,19 +14609,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) @@ -13930,6 +14617,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 { @@ -13997,65 +14701,108 @@ void survey_done_set_ch_bw(_adapter *padapter) FUNC_ADPT_ARG(padapter), cur_channel, cur_bwmode, cur_ch_offset); } } +#ifdef CONFIG_MCC_MODE exit: +#endif 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); + #ifdef CONFIG_MCC_MODE + /* for two station case */ + if (MCC_EN(adapter) && rtw_hal_check_mcc_status(adapter, MCC_STATUS_NEED_MCC)) { + u8 ch = iface->mlmeextpriv.cur_channel; + u8 offset = iface->mlmeextpriv.cur_ch_offset; + u8 bw = iface->mlmeextpriv.cur_bwmode; + + set_channel_bwmode(iface, ch, offset, bw); + } + #endif /* CONFIG_MCC_MODE */ + issue_nulldata(iface, NULL, ps, 3, 500); ps_anc = 1; } - } else { - if (is_client_associated_to_ap(adapter) == _TRUE) { - /* TODO: TDLS peers */ - issue_nulldata(adapter, NULL, 0, 3, 500); + #ifdef CONFIG_RTW_MESH + } else if (MLME_IS_MESH(iface)) { + if (rtw_mesh_ps_annc(iface, ps)) ps_anc = 1; - } + #endif } } return ps_anc; } + +void rtw_leave_opch(_adapter *adapter) +{ + struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); + +#ifdef CONFIG_MCC_MODE + if (MCC_EN(adapter) && rtw_hal_check_mcc_status(adapter, MCC_STATUS_DOING_MCC)) + return; #endif + _enter_critical_mutex(&rfctl->offch_mutex, NULL); + + if (rfctl->offch_state == OFFCHS_NONE) { + /* prepare to leave operating channel */ + rfctl->offch_state = OFFCHS_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); + + rfctl->offch_state = OFFCHS_LEAVE_OP; + } + + _exit_critical_mutex(&rfctl->offch_mutex, NULL); +} + +void rtw_back_opch(_adapter *adapter) +{ + struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); + +#ifdef CONFIG_MCC_MODE + if (MCC_EN(adapter) && rtw_hal_check_mcc_status(adapter, MCC_STATUS_DOING_MCC)) + return; +#endif + + _enter_critical_mutex(&rfctl->offch_mutex, NULL); + + if (rfctl->offch_state != OFFCHS_NONE) { + rfctl->offch_state = OFFCHS_BACKING_OP; + rtw_hal_macid_wakeup_all_used(adapter); + rtw_ps_annc(adapter, 0); + + rfctl->offch_state = OFFCHS_NONE; + rtw_mi_os_xmit_schedule(adapter); + } + + _exit_critical_mutex(&rfctl->offch_mutex, NULL); +} + void sitesurvey_set_igi(_adapter *adapter) { struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; @@ -14069,7 +14816,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 */ @@ -14077,6 +14824,15 @@ 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 */ @@ -14095,11 +14851,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: @@ -14128,14 +14884,49 @@ void sitesurvey_set_msr(_adapter *adapter, bool enter) } Set_MSR(adapter, network_type); } + +void sitesurvey_set_offch_state(_adapter *adapter, u8 scan_state) +{ + struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); + + _enter_critical_mutex(&rfctl->offch_mutex, NULL); + + switch (scan_state) { + case SCAN_DISABLE: + case SCAN_BACK_OP: + rfctl->offch_state = OFFCHS_NONE; + break; + case SCAN_START: + case SCAN_LEAVING_OP: + rfctl->offch_state = OFFCHS_LEAVING_OP; + break; + case SCAN_ENTER: + case SCAN_LEAVE_OP: + rfctl->offch_state = OFFCHS_LEAVE_OP; + break; + case SCAN_COMPLETE: + case SCAN_BACKING_OP: + rfctl->offch_state = OFFCHS_BACKING_OP; + break; + default: + break; + } + + _exit_critical_mutex(&rfctl->offch_mutex, NULL); +} + u8 sitesurvey_cmd_hdl(_adapter *padapter, u8 *pbuf) { struct sitesurvey_parm *pparm = (struct sitesurvey_parm *)pbuf; +#ifdef DBG_CHECK_FW_PS_STATE struct dvobj_priv *dvobj = padapter->dvobj; struct debug_priv *pdbgpriv = &dvobj->drv_dbg; +#endif struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); struct ss_res *ss = &pmlmeext->sitesurvey_res; +#ifdef CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI + struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); +#endif u8 val8; #ifdef CONFIG_P2P @@ -14170,6 +14961,21 @@ u8 sitesurvey_cmd_hdl(_adapter *padapter, u8 *pbuf) goto operation_by_state; case SCAN_START: +#ifdef CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI + if ((pwdev_priv->pno_mac_addr[0] != 0xFF) + && (check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE) == _TRUE) + && (check_fwstate(&padapter->mlmepriv, _FW_LINKED) == _FALSE)) { + u16 seq_num; + + rtw_hal_pno_random_gen_mac_addr(padapter); + rtw_hal_set_hw_mac_addr(padapter, pwdev_priv->pno_mac_addr); + get_random_bytes(&seq_num, 2); + pwdev_priv->pno_scan_seq_num = seq_num & 0xFFF; + RTW_INFO("%s pno_scan_seq_num %d\n", __func__, + pwdev_priv->pno_scan_seq_num); + } +#endif + /* * prepare to leave operating channel */ @@ -14186,8 +14992,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) */ @@ -14224,53 +15032,44 @@ 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 CONFIG_P2P - RTW_INFO(FUNC_ADPT_FMT" %s ch:%u (cnt:%u,idx:%d) at %dms, %c%c%c\n" - , FUNC_ADPT_ARG(padapter) - , mlmeext_scan_state_str(pmlmeext) - , scan_ch + #ifdef DBG_SITESURVEY + #ifdef CONFIG_P2P + RTW_INFO(FUNC_ADPT_FMT" %s ch:%u (cnt:%u,idx:%d) at %dms, %c%c%c%c\n" + , FUNC_ADPT_ARG(padapter) + , mlmeext_scan_state_str(pmlmeext) + , scan_ch , pwdinfo->find_phase_state_exchange_cnt, ss->channel_idx , rtw_get_passing_time_ms(padapter->mlmepriv.scan_start_time) , scan_type ? 'A' : 'P', ss->scan_mode ? 'A' : 'P' - , ss->ssid[0].SsidLength ? 'S' : ' ' - ); -#else - RTW_INFO(FUNC_ADPT_FMT" %s ch:%u (idx:%d) at %dms, %c%c%c\n" - , FUNC_ADPT_ARG(padapter) - , mlmeext_scan_state_str(pmlmeext) - , scan_ch - , ss->channel_idx + , ss->ssid[0].SsidLength ? 'S' : ' ' + , ss->dfs_ch_ssid_scan ? 'D' : ' ' + ); + #else + RTW_INFO(FUNC_ADPT_FMT" %s ch:%u (idx:%d) at %dms, %c%c%c%c\n" + , FUNC_ADPT_ARG(padapter) + , mlmeext_scan_state_str(pmlmeext) + , scan_ch + , ss->channel_idx , rtw_get_passing_time_ms(padapter->mlmepriv.scan_start_time) , scan_type ? 'A' : 'P', ss->scan_mode ? 'A' : 'P' - , ss->ssid[0].SsidLength ? 'S' : ' ' - ); -#endif /* CONFIG_P2P */ - + , ss->ssid[0].SsidLength ? 'S' : ' ' + , ss->dfs_ch_ssid_scan ? 'D' : ' ' + ); + #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); @@ -14284,7 +15083,12 @@ u8 sitesurvey_cmd_hdl(_adapter *padapter, u8 *pbuf) else scan_ms = 40; #else - scan_ms = ss->scan_ch_ms; + #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; #endif #if defined(CONFIG_ANTENNA_DIVERSITY) || defined(DBG_SCAN_SW_ANTDIV_BL) @@ -14292,18 +15096,19 @@ 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)) { + if (pparm->token) + rtw_acs_trigger(padapter, scan_ms, scan_ch, NHM_PID_IEEE_11K_HIGH); + else + rtw_acs_trigger(padapter, scan_ms, scan_ch, NHM_PID_ACS); } #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; } @@ -14323,14 +15128,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); @@ -14340,7 +15145,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); @@ -14365,15 +15171,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) */ @@ -14443,6 +15250,9 @@ u8 sitesurvey_cmd_hdl(_adapter *padapter, u8 *pbuf) #endif /* CONFIG_P2P */ case SCAN_COMPLETE: +#ifdef CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI + rtw_hal_set_hw_mac_addr(padapter, adapter_mac_addr(padapter)); +#endif #ifdef CONFIG_P2P if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_SCAN) || rtw_p2p_chk_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH) @@ -14475,8 +15285,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); @@ -14484,10 +15297,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; @@ -14539,25 +15367,33 @@ u8 setkey_hdl(_adapter *padapter, u8 *pbuf) cam_id = rtw_iface_bcmc_id_get(padapter); else #endif - cam_id = rtw_camid_alloc(padapter, NULL, pparm->keyid, &used); + cam_id = rtw_camid_alloc(padapter, NULL, pparm->keyid, 1, &used); if (cam_id < 0) goto enable_mc; #ifndef CONFIG_CONCURRENT_MODE - if (cam_id >= 0 && cam_id <= 3) + if (cam_id >= 0 && cam_id <= 3) { + /* default key camid */ addr = null_addr; - else + } else #endif { - if (((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) || ((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE)) - /* for AP mode ,we will force sec cam entry_id so hw dont search cam when tx*/ + /* not default key camid */ + if (((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) || ((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE)) { + /* group TX, force sec cam entry_id */ addr = adapter_mac_addr(padapter); - else - /* not default key, searched by A2 */ + } else { + /* group RX, searched by A2 (TA) */ addr = get_bssid(&padapter->mlmepriv); + } } +#ifdef CONFIG_LPS_PG + if (adapter_to_pwrctl(padapter)->lps_level == LPS_PG) + LPS_Leave(padapter, "SET_KEY"); +#endif + /* cam entry searched is pairwise key */ if (used == _TRUE && rtw_camid_is_gk(padapter, cam_id) == _FALSE) { s16 camid_clr; @@ -14622,6 +15458,7 @@ u8 setkey_hdl(_adapter *padapter, u8 *pbuf) _rtw_camctl_chk_cap(padapter, SEC_CAP_CHK_BMC)) { struct set_stakey_parm sta_pparm; + _rtw_memset(&sta_pparm, 0, sizeof(struct set_stakey_parm)); sta_pparm.algorithm = pparm->algorithm; sta_pparm.keyid = pparm->keyid; _rtw_memcpy(sta_pparm.key, pparm->key, 16); @@ -14649,11 +15486,12 @@ void rtw_ap_wep_pk_setting(_adapter *adapter, struct sta_info *psta) if ((psecuritypriv->key_mask & BIT(keyid)) && (keyid == psecuritypriv->dot11PrivacyKeyIndex)) { sta_pparm.algorithm = psecuritypriv->dot11PrivacyAlgrthm; sta_pparm.keyid = keyid; + sta_pparm.gk = 0; _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); } @@ -14665,7 +15503,6 @@ u8 set_stakey_hdl(_adapter *padapter, u8 *pbuf) u16 ctrl = 0; s16 cam_id = 0; bool used; - u8 kid = 0; u8 ret = H2C_SUCCESS; struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); @@ -14684,14 +15521,18 @@ u8 set_stakey_hdl(_adapter *padapter, u8 *pbuf) } pmlmeinfo->enc_algo = pparm->algorithm; - if (is_wep_enc(pparm->algorithm)) - kid = pparm->keyid; - cam_id = rtw_camid_alloc(padapter, psta, kid, &used); + + cam_id = rtw_camid_alloc(padapter, psta, pparm->keyid, pparm->gk, &used); if (cam_id < 0) goto exit; - /* cam entry searched is group key */ - if (used == _TRUE && rtw_camid_is_gk(padapter, cam_id) == _TRUE) { +#ifdef CONFIG_LPS_PG + if (adapter_to_pwrctl(padapter)->lps_level == LPS_PG) + LPS_Leave(padapter, "SET_KEY"); +#endif + + /* cam entry searched is group key when setting pariwise key */ + if (!pparm->gk && used == _TRUE && rtw_camid_is_gk(padapter, cam_id) == _TRUE) { s16 camid_clr; RTW_PRINT(FUNC_ADPT_FMT" pairwise key with "MAC_FMT" id:%u the same key id as group key\n" @@ -14717,9 +15558,12 @@ u8 set_stakey_hdl(_adapter *padapter, u8 *pbuf) rtw_camid_free(padapter, cam_id); } } else { - RTW_PRINT("set pairwise key camid:%d, addr:"MAC_FMT", kid:%d, type:%s\n", - cam_id, MAC_ARG(pparm->addr), pparm->keyid, security_type_str(pparm->algorithm)); + RTW_PRINT("set %s key camid:%d, addr:"MAC_FMT", kid:%d, type:%s\n" + , pparm->gk ? "group" : "pairwise" + , cam_id, MAC_ARG(pparm->addr), pparm->keyid, security_type_str(pparm->algorithm)); ctrl = BIT(15) | ((pparm->algorithm) << 2) | pparm->keyid; + if (pparm->gk) + ctrl |= BIT(6); write_cam(padapter, cam_id, ctrl, pparm->addr, pparm->key); } ret = H2C_SUCCESS_RSP; @@ -14746,7 +15590,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 @@ -14767,10 +15610,10 @@ u8 add_ba_hdl(_adapter *padapter, unsigned char *pbuf) u8 add_ba_rsp_hdl(_adapter *padapter, unsigned char *pbuf) { struct addBaRsp_parm *pparm = (struct addBaRsp_parm *)pbuf; - u8 ret = _TRUE, i = 0, try_cnt = 3, wait_ms = 50; struct recv_reorder_ctrl *preorder_ctrl; struct sta_priv *pstapriv = &padapter->stapriv; struct sta_info *psta; + u8 ret = _TRUE; psta = rtw_get_stainfo(pstapriv, pparm->addr); if (!psta) @@ -14783,13 +15626,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 /* @@ -14956,7 +15803,7 @@ u8 chk_bmc_sleepq_hdl(_adapter *padapter, unsigned char *pbuf) if (!psta_bmc) return H2C_SUCCESS; - if ((pstapriv->tim_bitmap & BIT(0)) && (psta_bmc->sleepq_len > 0)) { + if ((rtw_tim_map_is_set(padapter, pstapriv->tim_bitmap, 0)) && (psta_bmc->sleepq_len > 0)) { #ifndef CONFIG_PCI_HCI rtw_msleep_os(10);/* 10ms, ATIM(HIQ) Windows */ #endif @@ -15008,7 +15855,7 @@ u8 chk_bmc_sleepq_hdl(_adapter *padapter, unsigned char *pbuf) u8 tx_beacon_hdl(_adapter *padapter, unsigned char *pbuf) { - + /*RTW_INFO(FUNC_ADPT_FMT, FUNC_ADPT_ARG(padapter));*/ #ifdef CONFIG_SWTIMER_BASED_TXBCN tx_beacon_handlder(padapter->dvobj); @@ -15036,18 +15883,41 @@ u8 tx_beacon_hdl(_adapter *padapter, unsigned char *pbuf) 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) + && is_supported_vht(padapter->registrypriv.wireless_mode) + && (!rfctl->country_ent || COUNTRY_CHPLAN_EN_11AC(rfctl->country_ent)) + ) { + if (REGSTY_IS_11AC_AUTO(&padapter->registrypriv) + || pmlmepriv->ori_vht_en) + rtw_vht_ies_attach(padapter, pnetwork); + } + #endif } else { - network_type = WIRELESS_11BG; - total_rate_len = IEEE80211_CCK_RATE_LEN + IEEE80211_NUM_OFDM_RATESLEN; + network_type = 0; + total_rate_len = 0; + if (padapter->registrypriv.wireless_mode & WIRELESS_11B) { + network_type |= WIRELESS_11B; + total_rate_len += IEEE80211_CCK_RATE_LEN; + } + if (padapter->registrypriv.wireless_mode & WIRELESS_11G) { + network_type |= WIRELESS_11G; + total_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); @@ -15111,40 +15981,66 @@ 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) + ) { + u8 ori_ch, ori_bw, ori_offset; bool is_grouped = rtw_is_chbw_grouped(u_ch, u_bw, u_offset , mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset); if (is_grouped == _FALSE) { /* handle AP which need to switch ch setting */ + ori_ch = mlmeext->cur_channel; + ori_bw = mlmeext->cur_bwmode; + ori_offset = mlmeext->cur_ch_offset; + /* restore original bw, adjust bw by registry setting on target ch */ mlmeext->cur_bwmode = mlme->ori_bw; mlmeext->cur_channel = u_ch; - rtw_adjust_chbw(iface - , mlmeext->cur_channel, &mlmeext->cur_bwmode, &mlmeext->cur_ch_offset); + rtw_adjust_chbw(iface, mlmeext->cur_channel, &mlmeext->cur_bwmode, &mlmeext->cur_ch_offset); + #ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(iface)) + rtw_mesh_adjust_chbw(mlmeext->cur_channel, &mlmeext->cur_bwmode, &mlmeext->cur_ch_offset); + #endif - rtw_sync_chbw(&mlmeext->cur_channel, &mlmeext->cur_bwmode, &mlmeext->cur_ch_offset + rtw_chset_sync_chbw(adapter_to_chset(adapter) + , &mlmeext->cur_channel, &mlmeext->cur_bwmode, &mlmeext->cur_ch_offset , &u_ch, &u_bw, &u_offset); + RTW_INFO(FUNC_ADPT_FMT" %u,%u,%u => %u,%u,%u\n", FUNC_ADPT_ARG(iface) + , ori_ch, ori_bw, ori_offset + , mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset); + rtw_ap_update_bss_chbw(iface, &(mlmeext->mlmext_info.network) , mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset); _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)) + u8 ht_option = 0; + + #ifdef CONFIG_80211N_HT + ht_option = mlme->htpriv.ht_option; + #endif + + rtw_cfg80211_ch_switch_notify(iface + , mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset + , 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 - rtw_dfs_master_status_apply(adapter, MLME_STA_CONNECTED); + rtw_dfs_rd_en_decision(adapter, MLME_STA_CONNECTED, 0); #endif } else { for (i = 0; i < dvobj->iface_nums; i++) { @@ -15155,18 +16051,20 @@ 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); + rtw_dfs_rd_en_decision(adapter, MLME_STA_DISCONNECTED, 0); #endif } if (rtw_mi_get_ch_setting_union(adapter, &u_ch, &u_bw, &u_offset)) { + RTW_INFO(FUNC_ADPT_FMT" union:%u,%u,%u\n", FUNC_ADPT_ARG(adapter), u_ch, u_bw, u_offset); set_channel_bwmode(adapter, u_ch, u_offset, u_bw); rtw_mi_update_union_chan_inf(adapter, u_ch, u_offset, u_bw); } @@ -15179,7 +16077,9 @@ void rtw_join_done_chk_ch(_adapter *adapter, int join_res) int rtw_chk_start_clnt_join(_adapter *adapter, u8 *ch, u8 *bw, u8 *offset) { +#ifdef CONFIG_CONCURRENT_MODE bool chbw_allow = _TRUE; +#endif bool connect_allow = _TRUE; struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; u8 cur_ch, cur_bw, cur_ch_offset; @@ -15216,10 +16116,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" others 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; } @@ -15228,7 +16129,7 @@ int rtw_chk_start_clnt_join(_adapter *adapter, u8 *ch, u8 *bw, u8 *offset) dump_adapters_status(RTW_DBGDUMP , dvobj); rtw_warn_on(1); } - RTW_INFO(FUNC_ADPT_FMT" union no self: %u,%u,%u\n" + RTW_INFO(FUNC_ADPT_FMT" others union:%u,%u,%u\n" , FUNC_ADPT_ARG(adapter), u_ch, u_bw, u_offset); /* chbw_allow? */ @@ -15271,7 +16172,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) >= 4) connect_allow = _FALSE; RTW_INFO(FUNC_ADPT_FMT" connect_allow:%d\n" @@ -15283,10 +16184,6 @@ int rtw_chk_start_clnt_join(_adapter *adapter, u8 *ch, u8 *bw, u8 *offset) connect_allow_hdl: /* connect_allow == _TRUE */ -#ifdef CONFIG_DFS_MASTER - rtw_dfs_master_status_apply(adapter, MLME_STA_CONNECTING); -#endif - if (chbw_allow == _FALSE) { u_ch = cur_ch; u_bw = cur_bw; @@ -15300,27 +16197,32 @@ 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); + rtw_free_assoc_resources(iface, _TRUE); } } } + + #ifdef CONFIG_DFS_MASTER + rtw_dfs_rd_en_decision(adapter, MLME_STA_CONNECTING, 0); + #endif } #endif /* CONFIG_CONCURRENT_MODE */ @@ -15331,16 +16233,52 @@ int rtw_chk_start_clnt_join(_adapter *adapter, u8 *ch, u8 *bw, u8 *offset) *ch = u_ch; *bw = u_bw; *offset = u_offset; + +#if defined(CONFIG_IOCTL_CFG80211) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 5, 0)) + { + u8 ht_option = 0; + +#ifdef CONFIG_80211N_HT + ht_option = adapter->mlmepriv.htpriv.ht_option; +#endif /* CONFIG_80211N_HT */ + + /* + when supplicant send the mlme frame, + the bss freq is updated by channel switch event. + */ + rtw_cfg80211_ch_switch_notify(adapter, + cur_ch, cur_bw, cur_ch_offset, ht_option); + } +#endif } return connect_allow == _TRUE ? _SUCCESS : _FAIL; } +void rtw_set_external_auth_status(_adapter *padapter, + const void *data, int len) +{ +#ifdef CONFIG_IOCTL_CFG80211 + struct net_device *dev = padapter->pnetdev; + struct wiphy *wiphy = adapter_to_wiphy(padapter); + struct rtw_external_auth_params params; -u8 set_ch_hdl(_adapter *padapter, u8 *pbuf) + /* convert data to external_auth_params */ + params.action = RTW_GET_BE32((u8 *)data); + _rtw_memcpy(¶ms.bssid, (u8 *)data + 4, ETH_ALEN); + _rtw_memcpy(¶ms.ssid.ssid, (u8 *)data + 10, WLAN_SSID_MAXLEN); + params.ssid.ssid_len = RTW_GET_BE64((u8 *)data + 42); + params.key_mgmt_suite = RTW_GET_BE32((u8 *)data + 58); + params.status = RTW_GET_BE16((u8 *)data + 62); + _rtw_memcpy(¶ms.pmkid, (u8 *)data + 64, PMKID_LEN); + + rtw_cfg80211_external_auth_status(wiphy, dev, ¶ms); +#endif /* CONFIG_IOCTL_CFG80211 */ +} + +u8 rtw_set_chbw_hdl(_adapter *padapter, u8 *pbuf) { struct set_ch_parm *set_ch_parm; - struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; if (!pbuf) @@ -15364,8 +16302,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 mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); if (!pbuf) return H2C_PARAMETERS_ERROR; @@ -15375,17 +16312,20 @@ 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); +#if CONFIG_TXPWR_LIMIT + rtw_txpwr_init_regd(rfctl); +#endif rtw_hal_set_odm_var(padapter, HAL_ODM_REGULATION, NULL, _TRUE); #ifdef CONFIG_IOCTL_CFG80211 - rtw_reg_notify_by_driver(padapter); -#endif /* CONFIG_IOCTL_CFG80211 */ + rtw_regd_apply_flags(adapter_to_wiphy(padapter)); +#endif return H2C_SUCCESS; } @@ -15399,48 +16339,22 @@ 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 return H2C_SUCCESS; } -u8 set_csa_hdl(_adapter *padapter, unsigned char *pbuf) +u8 set_csa_hdl(_adapter *adapter, unsigned char *pbuf) { #ifdef CONFIG_DFS - struct SetChannelSwitch_param *setChannelSwitch_param; - u8 new_ch_no; - u8 gval8 = 0x00, sval8 = 0xff; - - if (!pbuf) - return H2C_PARAMETERS_ERROR; - - setChannelSwitch_param = (struct SetChannelSwitch_param *)pbuf; - new_ch_no = setChannelSwitch_param->new_ch_no; - - rtw_hal_get_hwreg(padapter, HW_VAR_TXPAUSE, &gval8); - - rtw_hal_set_hwreg(padapter, HW_VAR_TXPAUSE, &sval8); - - RTW_INFO("DFS detected! Swiching channel to %d!\n", new_ch_no); - set_channel_bwmode(padapter, new_ch_no, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); - - rtw_hal_set_hwreg(padapter, HW_VAR_TXPAUSE, &gval8); - - rtw_disassoc_cmd(padapter, 0, _FALSE); - 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); + struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); + if (rfctl->csa_ch) + rtw_dfs_ch_switch_hdl(adapter_to_dvobj(adapter)); +#endif return H2C_SUCCESS; -#else - return H2C_REJECTED; -#endif /* CONFIG_DFS */ - } u8 tdls_hdl(_adapter *padapter, unsigned char *pbuf) @@ -15456,12 +16370,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; @@ -15490,17 +16406,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 */ @@ -15510,21 +16428,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: @@ -15536,8 +16455,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"); @@ -15546,12 +16467,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"); @@ -15569,7 +16490,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); @@ -15578,23 +16499,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); } @@ -15611,7 +16535,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: @@ -15623,13 +16547,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)) @@ -15639,17 +16565,19 @@ 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: + case TDLS_TEARDOWN_STA_NO_WAIT: _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, (option == TDLS_TEARDOWN_STA) ? _TRUE : _FALSE); - issue_tdls_teardown(padapter, &txmgmt, _TRUE); break; case TDLS_TEARDOWN_STA_LOCALLY: + case TDLS_TEARDOWN_STA_LOCALLY_POST: #ifdef CONFIG_TDLS_CH_SW if (_rtw_memcmp(TDLSoption->addr, pchsw_info->addr, ETH_ALEN) == _TRUE) { pchsw_info->ch_sw_state &= ~(TDLS_CH_SW_INITIATOR_STATE | @@ -15659,8 +16587,15 @@ u8 tdls_hdl(_adapter *padapter, unsigned char *pbuf) _rtw_memset(pchsw_info->addr, 0x00, ETH_ALEN); } #endif - rtw_sta_media_status_rpt(padapter, ptdls_sta, 0); - free_tdls_sta(padapter, ptdls_sta); + + if (option == TDLS_TEARDOWN_STA_LOCALLY) + rtw_tdls_teardown_pre_hdl(padapter, ptdls_sta); + + rtw_tdls_teardown_post_hdl(padapter, ptdls_sta, _FALSE); + + if (ptdlsinfo->tdls_sctx != NULL) + rtw_sctx_done(&(ptdlsinfo->tdls_sctx)); + break; } @@ -15722,3 +16657,65 @@ u8 rtw_getmacreg_hdl(_adapter *padapter, u8 *pbuf) return H2C_SUCCESS; } + +int rtw_sae_preprocess(_adapter *adapter, const u8 *buf, u32 len, u8 tx) +{ +#ifdef CONFIG_IOCTL_CFG80211 + const u8 *frame_body = buf + sizeof(struct rtw_ieee80211_hdr_3addr); + u16 alg; + u16 seq; + u16 status; + int ret = _FAIL; + + alg = RTW_GET_LE16(frame_body); + if (alg != WLAN_AUTH_SAE) + goto exit; + + seq = RTW_GET_LE16(frame_body + 2); + status = RTW_GET_LE16(frame_body + 4); + + RTW_INFO("RTW_%s:AUTH alg:0x%04x, seq:0x%04x, status:0x%04x, mesg:%s\n", + (tx == _TRUE) ? "Tx" : "Rx", alg, seq, status, + (seq == 1) ? "Commit" : "Confirm"); + + ret = _SUCCESS; + +#ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(adapter)) { + rtw_mesh_sae_check_frames(adapter, buf, len, tx, alg, seq, status); + goto exit; + } +#endif + + if (tx && (seq == 2) && (status == 0)) { + /* quere commit frame until external auth statue update */ + struct sta_priv *pstapriv = &adapter->stapriv; + struct sta_info *psta = NULL; + _irqL irqL; + + psta = rtw_get_stainfo(pstapriv, GetAddr1Ptr(buf)); + if (psta) { + _enter_critical_bh(&psta->lock, &irqL); + if (psta->pauth_frame) { + rtw_mfree(psta->pauth_frame, psta->auth_len); + psta->pauth_frame = NULL; + psta->auth_len = 0; + } + + psta->pauth_frame = rtw_zmalloc(len); + if (psta->pauth_frame) { + _rtw_memcpy(psta->pauth_frame, buf, len); + psta->auth_len = len; + } + _exit_critical_bh(&psta->lock, &irqL); + + ret = 2; + } + } +exit: + return ret; +#else + return _SUCCESS; +#endif /* CONFIG_IOCTL_CFG80211 */ +} + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_mp.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_mp.c index ec39412959b0..9c9d15ecd00e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_mp.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_mp.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 @@ -152,6 +148,8 @@ static void _init_mp_priv_(struct mp_priv *pmp_priv) pmp_priv->bloopback = _FALSE; pmp_priv->bloadefusemap = _FALSE; + pmp_priv->brx_filter_beacon = _FALSE; + pmp_priv->mplink_brx = _FALSE; pnetwork = &pmp_priv->mp_network.network; _rtw_memcpy(pnetwork->MacAddress, pmp_priv->network_macaddr, ETH_ALEN); @@ -164,108 +162,10 @@ static void _init_mp_priv_(struct mp_priv *pmp_priv) pmp_priv->tx.attrib.ht_en = 1; #endif -} - -#ifdef PLATFORM_WINDOWS -#if 0 -void mp_wi_callback( - IN NDIS_WORK_ITEM *pwk_item, - IN PVOID cntx -) -{ - _adapter *padapter = (_adapter *)cntx; - struct mp_priv *pmppriv = &padapter->mppriv; - struct mp_wi_cntx *pmp_wi_cntx = &pmppriv->wi_cntx; - - /* Execute specified action. */ - if (pmp_wi_cntx->curractfunc != NULL) { - LARGE_INTEGER cur_time; - ULONGLONG start_time, end_time; - NdisGetCurrentSystemTime(&cur_time); /* driver version */ - start_time = cur_time.QuadPart / 10; /* The return value is in microsecond */ - - pmp_wi_cntx->curractfunc(padapter); - - NdisGetCurrentSystemTime(&cur_time); /* driver version */ - end_time = cur_time.QuadPart / 10; /* The return value is in microsecond */ - - } - - NdisAcquireSpinLock(&(pmp_wi_cntx->mp_wi_lock)); - pmp_wi_cntx->bmp_wi_progress = _FALSE; - NdisReleaseSpinLock(&(pmp_wi_cntx->mp_wi_lock)); - - if (pmp_wi_cntx->bmpdrv_unload) - NdisSetEvent(&(pmp_wi_cntx->mp_wi_evt)); + pmp_priv->mpt_ctx.mpt_rate_index = 1; } -#endif -static int init_mp_priv_by_os(struct mp_priv *pmp_priv) -{ - struct mp_wi_cntx *pmp_wi_cntx; - - if (pmp_priv == NULL) - return _FAIL; - - pmp_priv->rx_testcnt = 0; - pmp_priv->rx_testcnt1 = 0; - pmp_priv->rx_testcnt2 = 0; - - pmp_priv->tx_testcnt = 0; - pmp_priv->tx_testcnt1 = 0; - - pmp_wi_cntx = &pmp_priv->wi_cntx - pmp_wi_cntx->bmpdrv_unload = _FALSE; - pmp_wi_cntx->bmp_wi_progress = _FALSE; - pmp_wi_cntx->curractfunc = NULL; - - return _SUCCESS; -} -#endif - -#ifdef PLATFORM_LINUX -static int init_mp_priv_by_os(struct mp_priv *pmp_priv) -{ - int i, res; - struct mp_xmit_frame *pmp_xmitframe; - - if (pmp_priv == NULL) - return _FAIL; - - _rtw_init_queue(&pmp_priv->free_mp_xmitqueue); - - pmp_priv->pallocated_mp_xmitframe_buf = NULL; - pmp_priv->pallocated_mp_xmitframe_buf = rtw_zmalloc(NR_MP_XMITFRAME * sizeof(struct mp_xmit_frame) + 4); - if (pmp_priv->pallocated_mp_xmitframe_buf == NULL) { - res = _FAIL; - goto _exit_init_mp_priv; - } - - pmp_priv->pmp_xmtframe_buf = pmp_priv->pallocated_mp_xmitframe_buf + 4 - ((SIZE_PTR)(pmp_priv->pallocated_mp_xmitframe_buf) & 3); - - pmp_xmitframe = (struct mp_xmit_frame *)pmp_priv->pmp_xmtframe_buf; - - for (i = 0; i < NR_MP_XMITFRAME; i++) { - _rtw_init_listhead(&pmp_xmitframe->list); - rtw_list_insert_tail(&pmp_xmitframe->list, &pmp_priv->free_mp_xmitqueue.queue); - - pmp_xmitframe->pkt = NULL; - pmp_xmitframe->frame_tag = MP_FRAMETAG; - pmp_xmitframe->padapter = pmp_priv->papdater; - - pmp_xmitframe++; - } - - pmp_priv->free_mp_xmitframe_cnt = NR_MP_XMITFRAME; - - res = _SUCCESS; - -_exit_init_mp_priv: - - return res; -} -#endif static void mp_init_xmit_attrib(struct mp_tx *pmptx, PADAPTER padapter) { @@ -301,6 +201,11 @@ static void mp_init_xmit_attrib(struct mp_tx *pmptx, PADAPTER padapter) pattrib->pktlen = 1500; + if (pHalData->rf_type == RF_2T2R) + pattrib->raid = RATEID_IDX_BGN_40M_2SS; + else + pattrib->raid = RATEID_IDX_BGN_40M_1SS; + #ifdef CONFIG_80211AC_VHT if (pHalData->rf_type == RF_1T1R) pattrib->raid = RATEID_IDX_VHT_1SS; @@ -322,12 +227,17 @@ s32 init_mp_priv(PADAPTER padapter) _init_mp_priv_(pmppriv); pmppriv->papdater = padapter; - pmppriv->mp_dm = 0; + if (IS_HARDWARE_TYPE_8822C(padapter)) + pmppriv->mp_dm = 1;/* default enable dpk tracking */ + else + pmppriv->mp_dm = 0; + pmppriv->tx.stop = 1; pmppriv->bSetTxPower = 0; /*for manually set tx power*/ pmppriv->bTxBufCkFail = _FALSE; pmppriv->pktInterval = 0; pmppriv->pktLength = 1000; + pmppriv->bprocess_mp_mode = _FALSE; mp_init_xmit_attrib(&pmppriv->tx, padapter); @@ -342,7 +252,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; @@ -367,33 +276,37 @@ void free_mp_priv(struct mp_priv *pmp_priv) pmp_priv->pmp_xmtframe_buf = NULL; } - -static VOID PHY_IQCalibrate_default( - IN PADAPTER pAdapter, - IN BOOLEAN bReCovery +#if 0 +static void PHY_IQCalibrate_default( + PADAPTER pAdapter, + BOOLEAN bReCovery ) { RTW_INFO("%s\n", __func__); } -static VOID PHY_LCCalibrate_default( - IN PADAPTER pAdapter +static void PHY_LCCalibrate_default( + PADAPTER pAdapter ) { RTW_INFO("%s\n", __func__); } -static VOID PHY_SetRFPathSwitch_default( - IN PADAPTER pAdapter, - IN BOOLEAN bMain +static void PHY_SetRFPathSwitch_default( + PADAPTER pAdapter, + BOOLEAN bMain ) { RTW_INFO("%s\n", __func__); } - +#endif 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. */ @@ -426,6 +339,15 @@ void mpt_InitHWConfig(PADAPTER Adapter) 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)) { u32 tmp_reg = 0; @@ -444,112 +366,30 @@ void mpt_InitHWConfig(PADAPTER Adapter) else if (IS_HARDWARE_TYPE_8821C(Adapter)) PlatformEFIOWrite2Byte(Adapter, REG_RXFLTMAP1_8821C, 0x2000); #endif /* CONFIG_RTL8821C */ +#if defined(CONFIG_RTL8188F) || defined(CONFIG_RTL8188GTV) + else if (IS_HARDWARE_TYPE_8188F(Adapter) || IS_HARDWARE_TYPE_8188GTV(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 +#if defined(CONFIG_RTL8822C) + else if( IS_HARDWARE_TYPE_8822C(Adapter)) { + rtw_write16(Adapter, REG_RXFLTMAP1_8822C, 0x2000); + } +#endif + } 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 */ - - if (IS_HARDWARE_TYPE_8723B(padapter)) { -#ifdef CONFIG_RTL8723B - pHalData = GET_HAL_DATA(padapter); - b2ant = pHalData->EEPROMBluetoothAntNum == Ant_x2 ? _TRUE : _FALSE; - phy_iq_calibrate_8723b(padapter, bReCovery, _FALSE, b2ant, pHalData->ant_path); -#endif - } else if (IS_HARDWARE_TYPE_8188E(padapter)) { -#ifdef CONFIG_RTL8188E - phy_iq_calibrate_8188e(padapter, bReCovery); -#endif - } else if (IS_HARDWARE_TYPE_8814A(padapter)) { -#ifdef CONFIG_RTL8814A - phy_iq_calibrate_8814a(&(GET_HAL_DATA(padapter)->odmpriv), bReCovery); -#endif - } else if (IS_HARDWARE_TYPE_8812(padapter)) { -#ifdef CONFIG_RTL8812A - phy_iq_calibrate_8812a(padapter, bReCovery); -#endif - } else if (IS_HARDWARE_TYPE_8821(padapter)) { -#ifdef CONFIG_RTL8821A - phy_iq_calibrate_8821a(&(GET_HAL_DATA(padapter)->odmpriv), bReCovery); -#endif - } else if (IS_HARDWARE_TYPE_8192E(padapter)) { -#ifdef CONFIG_RTL8192E - phy_iq_calibrate_8192e(padapter, bReCovery); -#endif - } else if (IS_HARDWARE_TYPE_8703B(padapter)) { -#ifdef CONFIG_RTL8703B - phy_iq_calibrate_8703b(padapter, bReCovery); -#endif - } else if (IS_HARDWARE_TYPE_8188F(padapter)) { -#ifdef CONFIG_RTL8188F - phy_iq_calibrate_8188f(padapter, bReCovery, _FALSE); -#endif - } else if (IS_HARDWARE_TYPE_8822B(padapter)) { -#ifdef CONFIG_RTL8822B - phy_iq_calibrate_8822b(&(GET_HAL_DATA(padapter)->odmpriv), bReCovery); -#endif - } else if (IS_HARDWARE_TYPE_8723D(padapter)) { -#ifdef CONFIG_RTL8723D - phy_iq_calibrate_8723d(padapter, bReCovery); -#endif - } else if (IS_HARDWARE_TYPE_8821C(padapter)) { -#ifdef CONFIG_RTL8821C - phy_iq_calibrate_8821c(&(GET_HAL_DATA(padapter)->odmpriv), bReCovery); -#endif - } - + halrf_iqk_trigger(&(GET_HAL_DATA(padapter)->odmpriv), bReCovery); } static void PHY_LCCalibrate(PADAPTER padapter) { - if (IS_HARDWARE_TYPE_8723B(padapter)) { -#ifdef CONFIG_RTL8723B - phy_lc_calibrate_8723b(&(GET_HAL_DATA(padapter)->odmpriv)); -#endif - } else if (IS_HARDWARE_TYPE_8188E(padapter)) { -#ifdef CONFIG_RTL8188E - phy_lc_calibrate_8188e(&(GET_HAL_DATA(padapter)->odmpriv)); -#endif - } else if (IS_HARDWARE_TYPE_8814A(padapter)) { -#ifdef CONFIG_RTL8814A - phy_lc_calibrate_8814a(&(GET_HAL_DATA(padapter)->odmpriv)); -#endif - } else if (IS_HARDWARE_TYPE_8812(padapter)) { -#ifdef CONFIG_RTL8812A - phy_lc_calibrate_8812a(&(GET_HAL_DATA(padapter)->odmpriv)); -#endif - } else if (IS_HARDWARE_TYPE_8821(padapter)) { -#ifdef CONFIG_RTL8821A - phy_lc_calibrate_8821a(&(GET_HAL_DATA(padapter)->odmpriv)); -#endif - } else if (IS_HARDWARE_TYPE_8192E(padapter)) { -#ifdef CONFIG_RTL8192E - phy_lc_calibrate_8192e(&(GET_HAL_DATA(padapter)->odmpriv)); -#endif - } else if (IS_HARDWARE_TYPE_8703B(padapter)) { -#ifdef CONFIG_RTL8703B - phy_lc_calibrate_8703b(&(GET_HAL_DATA(padapter)->odmpriv)); -#endif - } else if (IS_HARDWARE_TYPE_8188F(padapter)) { -#ifdef CONFIG_RTL8188F - phy_lc_calibrate_8188f(&(GET_HAL_DATA(padapter)->odmpriv)); -#endif - } else if (IS_HARDWARE_TYPE_8822B(padapter)) { -#ifdef CONFIG_RTL8822B - phy_lc_calibrate_8822b(&(GET_HAL_DATA(padapter)->odmpriv)); -#endif - } else if (IS_HARDWARE_TYPE_8723D(padapter)) { -#ifdef CONFIG_RTL8723D - phy_lc_calibrate_8723d(&(GET_HAL_DATA(padapter)->odmpriv)); -#endif - } else if (IS_HARDWARE_TYPE_8821C(padapter)) { -#ifdef CONFIG_RTL8821C - /*phy_iq_calibrate_8821c(&(GET_HAL_DATA(padapter)->odmpriv));*/ -#endif - } - + halrf_lck_trigger(&(GET_HAL_DATA(padapter)->odmpriv)); } static u8 PHY_QueryRFPathSwitch(PADAPTER padapter) @@ -583,6 +423,10 @@ static u8 PHY_QueryRFPathSwitch(PADAPTER padapter) } else if (IS_HARDWARE_TYPE_8188F(padapter)) { #ifdef CONFIG_RTL8188F bmain = PHY_QueryRFPathSwitch_8188F(padapter); +#endif + } else if (IS_HARDWARE_TYPE_8188GTV(padapter)) { +#ifdef CONFIG_RTL8188GTV + bmain = PHY_QueryRFPathSwitch_8188GTV(padapter); #endif } else if (IS_HARDWARE_TYPE_8822B(padapter)) { #ifdef CONFIG_RTL8822B @@ -606,60 +450,107 @@ static u8 PHY_QueryRFPathSwitch(PADAPTER padapter) static void PHY_SetRFPathSwitch(PADAPTER padapter , BOOLEAN bMain) { + PHAL_DATA_TYPE hal = GET_HAL_DATA(padapter); + struct dm_struct *phydm = &hal->odmpriv; + if (IS_HARDWARE_TYPE_8723B(padapter)) { #ifdef CONFIG_RTL8723B - phy_set_rf_path_switch_8723b(padapter, bMain); + phy_set_rf_path_switch_8723b(phydm, bMain); #endif } else if (IS_HARDWARE_TYPE_8188E(padapter)) { #ifdef CONFIG_RTL8188E - phy_set_rf_path_switch_8188e(padapter, bMain); + phy_set_rf_path_switch_8188e(phydm, bMain); #endif - } else if (IS_HARDWARE_TYPE_8814A(padapter)) { + } else if (IS_HARDWARE_TYPE_8814A(padapter)) { #ifdef CONFIG_RTL8814A - phy_set_rf_path_switch_8814a(padapter, bMain); + phy_set_rf_path_switch_8814a(phydm, 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); + phy_set_rf_path_switch_8812a(phydm, bMain); #endif } else if (IS_HARDWARE_TYPE_8192E(padapter)) { #ifdef CONFIG_RTL8192E - phy_set_rf_path_switch_8192e(padapter, bMain); + phy_set_rf_path_switch_8192e(phydm, bMain); #endif } else if (IS_HARDWARE_TYPE_8703B(padapter)) { #ifdef CONFIG_RTL8703B - phy_set_rf_path_switch_8703b(padapter, bMain); + phy_set_rf_path_switch_8703b(phydm, bMain); #endif - } else if (IS_HARDWARE_TYPE_8188F(padapter)) { -#ifdef CONFIG_RTL8188F - phy_set_rf_path_switch_8188f(padapter, bMain); + } else if (IS_HARDWARE_TYPE_8188F(padapter) || IS_HARDWARE_TYPE_8188GTV(padapter)) { +#if defined(CONFIG_RTL8188F) || defined(CONFIG_RTL8188GTV) + phy_set_rf_path_switch_8188f(phydm, bMain); +#endif + } else if (IS_HARDWARE_TYPE_8192F(padapter)) { +#ifdef CONFIG_RTL8192F + phy_set_rf_path_switch_8192f(padapter, bMain); #endif } else if (IS_HARDWARE_TYPE_8822B(padapter)) { #ifdef CONFIG_RTL8822B - phy_set_rf_path_switch_8822b(padapter, bMain); + phy_set_rf_path_switch_8822b(phydm, bMain); #endif } else if (IS_HARDWARE_TYPE_8723D(padapter)) { #ifdef CONFIG_RTL8723D - phy_set_rf_path_switch_8723d(padapter, bMain); + phy_set_rf_path_switch_8723d(phydm, bMain); #endif } else if (IS_HARDWARE_TYPE_8821C(padapter)) { #ifdef CONFIG_RTL8821C - phy_set_rf_path_switch_8821c(padapter, bMain); + phy_set_rf_path_switch_8821c(phydm, bMain); +#endif + } else if (IS_HARDWARE_TYPE_8822C(padapter)) { +#ifdef CONFIG_RTL8822C + /* remove for MP EVM Fail, need to review by willis 20180809 + phy_set_rf_path_switch_8822c(phydm, bMain); + */ #endif } } + +static void phy_switch_rf_path_set(PADAPTER padapter , u8 *prf_set_State) { +#ifdef CONFIG_RTL8821C + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); + struct dm_struct *p_dm = &pHalData->odmpriv; + + if (IS_HARDWARE_TYPE_8821C(padapter)) { + config_phydm_set_ant_path(p_dm, *prf_set_State, p_dm->current_ant_num_8821c); + /* Do IQK when switching to BTG/WLG, requested by RF Binson */ + if (*prf_set_State == SWITCH_TO_BTG || *prf_set_State == SWITCH_TO_WLG) + PHY_IQCalibrate(padapter, FALSE); + } +#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 + s32 MPT_InitializeAdapter( - IN PADAPTER pAdapter, - IN u8 Channel + PADAPTER pAdapter, + u8 Channel ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); s32 rtStatus = _SUCCESS; PMPT_CONTEXT pMptCtx = &pAdapter->mppriv.mpt_ctx; u32 ledsetting; - struct mlme_priv *pmlmepriv = &pAdapter->mlmepriv; pMptCtx->bMptDrvUnload = _FALSE; pMptCtx->bMassProdTest = _FALSE; @@ -671,7 +562,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); @@ -683,11 +574,12 @@ MPT_InitializeAdapter( /* <20130522, Kordan> Turn off equalizer to improve Rx sensitivity. (Asked by EEChou)*/ 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_set_rf_reg(pAdapter, ODM_RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B10E); + + if (pHalData->PackageType == PACKAGE_DEFAULT) + phy_set_rf_reg(pAdapter, RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B04E); else - phy_set_rf_reg(pAdapter, ODM_RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B04E); + phy_set_rf_reg(pAdapter, RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6F10E); + } /*set ant to wifi side in mp mode*/ rtw_write16(pAdapter, 0x870, 0x300); @@ -696,7 +588,7 @@ MPT_InitializeAdapter( pMptCtx->bMptWorkItemInProgress = _FALSE; pMptCtx->CurrMptAct = NULL; - pMptCtx->mpt_rf_path = ODM_RF_PATH_A; + pMptCtx->mpt_rf_path = RF_PATH_A; /* ------------------------------------------------------------------------- */ /* Don't accept any packets */ rtw_write32(pAdapter, REG_RCR, 0); @@ -714,21 +606,21 @@ MPT_InitializeAdapter( PHY_SetRFPathSwitch(pAdapter, 1/*pHalData->bDefaultAntenna*/); /* default use Main */ - 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); + pMptCtx->backup0xc50 = (u8)phy_query_bb_reg(pAdapter, rOFDM0_XAAGCCore1, bMaskByte0); + pMptCtx->backup0xc58 = (u8)phy_query_bb_reg(pAdapter, rOFDM0_XBAGCCore1, bMaskByte0); + pMptCtx->backup0xc30 = (u8)phy_query_bb_reg(pAdapter, rOFDM0_RxDetector1, bMaskByte0); + pMptCtx->backup0x52_RF_A = (u8)phy_query_rf_reg(pAdapter, RF_PATH_A, RF_0x52, 0x000F0); + pMptCtx->backup0x52_RF_B = (u8)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_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); + pHalData->BackUp_IG_REG_4_Chnl_Section[0] = (u8)phy_query_bb_reg(pAdapter, rA_IGI_Jaguar, bMaskByte0); + pHalData->BackUp_IG_REG_4_Chnl_Section[1] = (u8)phy_query_bb_reg(pAdapter, rB_IGI_Jaguar, bMaskByte0); + pHalData->BackUp_IG_REG_4_Chnl_Section[2] = (u8)phy_query_bb_reg(pAdapter, rC_IGI_Jaguar2, bMaskByte0); + pHalData->BackUp_IG_REG_4_Chnl_Section[3] = (u8)phy_query_bb_reg(pAdapter, rD_IGI_Jaguar2, bMaskByte0); } #endif return rtStatus; @@ -751,9 +643,9 @@ MPT_InitializeAdapter( * 05/18/2007 MHC Add normal driver MPHalt code. * *---------------------------------------------------------------------------*/ -VOID +void MPT_DeInitAdapter( - IN PADAPTER pAdapter + PADAPTER pAdapter ) { PMPT_CONTEXT pMptCtx = &pAdapter->mppriv.mpt_ctx; @@ -818,63 +710,71 @@ void rtw_mp_trigger_lck(PADAPTER padapter) PHY_LCCalibrate(padapter); } -static void disable_dm(PADAPTER padapter) +void rtw_mp_trigger_dpk(PADAPTER padapter) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); + struct dm_struct *pDM_Odm = &pHalData->odmpriv; + + halrf_dpk_trigger(pDM_Odm); +} + +static void init_mp_data(PADAPTER padapter) { u8 v8; HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); - struct PHY_DM_STRUCT *pDM_Odm = &pHalData->odmpriv; + struct 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->rf_calibrate_info.txpowertrack_control = _FALSE; - rtw_phydm_func_set(padapter, ODM_RF_CALIBRATION); - - /* #ifdef CONFIG_BT_COEXIST */ - /* rtw_btcoex_Switch(padapter, 0); */ /* remove for BT MP Down. */ - /* #endif */ } - void MPT_PwrCtlDM(PADAPTER padapter, u32 bstart) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); - struct PHY_DM_STRUCT *pDM_Odm = &pHalData->odmpriv; + struct 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); + 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); + halrf_set_pwr_track(pDM_Odm, true); pDM_Odm->rf_calibrate_info.txpowertrack_control = _TRUE; padapter->mppriv.mp_dm = 1; } else { RTW_INFO("in MPT_PwrCtlDM stop\n"); - disable_dm(padapter); + 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); + halrf_set_pwr_track(pDM_Odm, false); pDM_Odm->rf_calibrate_info.txpowertrack_control = _FALSE; - padapter->mppriv.mp_dm = 0; + if (IS_HARDWARE_TYPE_8822C(padapter)) + padapter->mppriv.mp_dm = 1; /* default enable dpk tracking */ + else + padapter->mppriv.mp_dm = 0; { - struct _TXPWRTRACK_CFG c; - u1Byte chnl = 0 ; - _rtw_memset(&c, 0, sizeof(struct _TXPWRTRACK_CFG)); + struct txpwrtrack_cfg c; + u8 chnl = 0 ; + _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, ODM_RF_PATH_A, chnl); + (*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, ODM_RF_PATH_A, chnl); + (*c.odm_tx_pwr_track_set_pwr)(pDM_Odm, BBSWING, RF_PATH_A, chnl); SetTxPower(padapter); + } else if (pDM_Odm->support_ic_type == ODM_RTL8192F) { + (*c.odm_tx_pwr_track_set_pwr)(pDM_Odm, MIX_MODE, RF_PATH_A, chnl); + (*c.odm_tx_pwr_track_set_pwr)(pDM_Odm, MIX_MODE, RF_PATH_B, chnl); } else { - (*c.odm_tx_pwr_track_set_pwr)(pDM_Odm, BBSWING, ODM_RF_PATH_A, chnl); - (*c.odm_tx_pwr_track_set_pwr)(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); } } } @@ -888,7 +788,6 @@ u32 mp_join(PADAPTER padapter, u8 mode) WLAN_BSSID_EX bssid; struct sta_info *psta; u32 length; - u8 val8, join_type; _irqL irqL; s32 res = _SUCCESS; @@ -899,9 +798,6 @@ u32 mp_join(PADAPTER padapter, u8 mode) struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)(&(pmlmeinfo->network)); -#ifdef CONFIG_IOCTL_CFG80211 - struct wireless_dev *pwdev = padapter->rtw_wdev; -#endif /* #ifdef CONFIG_IOCTL_CFG80211 */ /* 1. initialize a new WLAN_BSSID_EX */ _rtw_memset(&bssid, 0, sizeof(WLAN_BSSID_EX)); RTW_INFO("%s ,pmppriv->network_macaddr=%x %x %x %x %x %x\n", __func__, @@ -913,7 +809,6 @@ u32 mp_join(PADAPTER padapter, u8 mode) bssid.Ssid.SsidLength = strlen("mp_pseudo_adhoc"); _rtw_memcpy(bssid.Ssid.Ssid, (u8 *)"mp_pseudo_adhoc", bssid.Ssid.SsidLength); bssid.InfrastructureMode = Ndis802_11IBSS; - bssid.NetworkTypeInUse = Ndis802_11DS; bssid.IELength = 0; bssid.Configuration.DSConfig = pmppriv->channel; @@ -921,7 +816,6 @@ u32 mp_join(PADAPTER padapter, u8 mode) bssid.Ssid.SsidLength = strlen("mp_pseudo_STATION"); _rtw_memcpy(bssid.Ssid.Ssid, (u8 *)"mp_pseudo_STATION", bssid.Ssid.SsidLength); bssid.InfrastructureMode = Ndis802_11Infrastructure; - bssid.NetworkTypeInUse = Ndis802_11DS; bssid.IELength = 0; } @@ -938,9 +832,9 @@ 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); + rtw_free_assoc_resources_cmd(padapter, _TRUE, 0); } pmppriv->prev_fw_state = get_fwstate(pmlmepriv); /*pmlmepriv->fw_state = WIFI_MP_STATE;*/ @@ -967,7 +861,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); @@ -988,12 +882,8 @@ u32 mp_join(PADAPTER padapter, u8 mode) /* set msr to WIFI_FW_ADHOC_STATE */ pmlmeinfo->state = WIFI_FW_ADHOC_STATE; Set_MSR(padapter, (pmlmeinfo->state & 0x3)); - 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)); - - report_join_res(padapter, 1); + rtw_hal_rcr_set_chk_bssid(padapter, MLME_ADHOC_STARTED); pmlmeinfo->state |= WIFI_FW_ASSOC_SUCCESS; } else { Set_MSR(padapter, WIFI_FW_STATION_STATE); @@ -1012,21 +902,17 @@ u32 mp_join(PADAPTER padapter, u8 mode) s32 mp_start_test(PADAPTER padapter) { struct mp_priv *pmppriv = &padapter->mppriv; +#ifdef CONFIG_PCI_HCI + PHAL_DATA_TYPE hal; +#endif s32 res = _SUCCESS; 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 */ @@ -1042,6 +928,9 @@ s32 mp_start_test(PADAPTER padapter) #ifdef CONFIG_RTL8188F rtl8188f_InitHalDm(padapter); #endif +#ifdef CONFIG_RTL8188GTV + rtl8188gtv_InitHalDm(padapter); +#endif #ifdef CONFIG_RTL8188E rtl8188e_InitHalDm(padapter); #endif @@ -1049,6 +938,13 @@ s32 mp_start_test(PADAPTER padapter) rtl8723d_InitHalDm(padapter); #endif /* CONFIG_RTL8723D */ +#ifdef CONFIG_PCI_HCI + hal = GET_HAL_DATA(padapter); + hal->pci_backdoor_ctrl = 0; + rtw_pci_aspm_config(padapter); +#endif + + /* 3 0. update mp_priv */ if (!RF_TYPE_VALID(padapter->registrypriv.rf_config)) { @@ -1064,7 +960,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; @@ -1089,6 +984,10 @@ void mp_stop_test(PADAPTER padapter) struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct wlan_network *tgt_network = &pmlmepriv->cur_network; struct sta_info *psta; +#ifdef CONFIG_PCI_HCI + struct registry_priv *registry_par = &padapter->registrypriv; + PHAL_DATA_TYPE hal; +#endif _irqL irqL; @@ -1102,7 +1001,7 @@ void mp_stop_test(PADAPTER padapter) rtw_indicate_disconnect(padapter, 0, _FALSE); /* 3 2. clear psta used in mp test mode. - * rtw_free_assoc_resources(padapter, 1); */ + * rtw_free_assoc_resources(padapter, _TRUE); */ psta = rtw_get_stainfo(&padapter->stapriv, tgt_network->network.MacAddress); if (psta) rtw_free_stainfo(padapter, psta); @@ -1120,6 +1019,12 @@ void mp_stop_test(PADAPTER padapter) _exit_critical_bh(&pmlmepriv->lock, &irqL); +#ifdef CONFIG_PCI_HCI + hal = GET_HAL_DATA(padapter); + hal->pci_backdoor_ctrl = registry_par->pci_aspm_config; + rtw_pci_aspm_config(padapter); +#endif + #ifdef CONFIG_RTL8812A rtl8812_InitHalDm(padapter); #endif @@ -1135,6 +1040,9 @@ void mp_stop_test(PADAPTER padapter) #ifdef CONFIG_RTL8188F rtl8188f_InitHalDm(padapter); #endif +#ifdef CONFIG_RTL8188GTV + rtl8188gtv_InitHalDm(padapter); +#endif #ifdef CONFIG_RTL8723D rtl8723d_InitHalDm(padapter); #endif @@ -1143,7 +1051,7 @@ void mp_stop_test(PADAPTER padapter) /*---------------------------hal\rtl8192c\MPT_Phy.c---------------------------*/ #if 0 /* #ifdef CONFIG_USB_HCI */ -static VOID mpt_AdjustRFRegByRateByChan92CU(PADAPTER pAdapter, u8 RateIdx, u8 Channel, u8 BandWidthID) +static void mpt_AdjustRFRegByRateByChan92CU(PADAPTER pAdapter, u8 RateIdx, u8 Channel, u8 BandWidthID) { u8 eRFPath; u32 rfReg0x26; @@ -1188,7 +1096,7 @@ static VOID mpt_AdjustRFRegByRateByChan92CU(PADAPTER pAdapter, u8 RateIdx, u8 Ch * * Overview: Change RF Setting when we siwthc channel/rate/BW for MP. * - * Input: IN PADAPTER pAdapter + * Input: PADAPTER pAdapter * * Output: NONE * @@ -1200,6 +1108,7 @@ static VOID mpt_AdjustRFRegByRateByChan92CU(PADAPTER pAdapter, u8 RateIdx, u8 Ch * 01/09/2009 MHC Add CCK modification for 40MHZ. Suggestion from SD3. * *---------------------------------------------------------------------------*/ +#if 0 static void mpt_SwitchRfSetting(PADAPTER pAdapter) { hal_mpt_SwitchRfSetting(pAdapter); @@ -1211,6 +1120,7 @@ static void MPT_CCKTxPowerAdjust(PADAPTER Adapter, BOOLEAN bInCH14) { hal_mpt_CCKTxPowerAdjust(Adapter, bInCH14); } +#endif /*---------------------------hal\rtl8192c\MPT_HelperFunc.c---------------------------*/ @@ -1272,6 +1182,13 @@ void MP_PHY_SetRFPathSwitch(PADAPTER pAdapter , BOOLEAN bMain) } +void mp_phy_switch_rf_path_set(PADAPTER pAdapter , u8 *pstate) +{ + + phy_switch_rf_path_set(pAdapter, pstate); + +} + u8 MP_PHY_QueryRFPathSwitch(PADAPTER pAdapter) { return PHY_QueryRFPathSwitch(pAdapter); @@ -1282,6 +1199,7 @@ s32 SetThermalMeter(PADAPTER pAdapter, u8 target_ther) return hal_mpt_SetThermalMeter(pAdapter, target_ther); } +#if 0 static void TriggerRFThermalMeter(PADAPTER pAdapter) { hal_mpt_TriggerRFThermalMeter(pAdapter); @@ -1291,10 +1209,11 @@ static u8 ReadRFThermalMeter(PADAPTER pAdapter) { return hal_mpt_ReadRFThermalMeter(pAdapter); } +#endif -void GetThermalMeter(PADAPTER pAdapter, u8 *value) +void GetThermalMeter(PADAPTER pAdapter, u8 rfpath ,u8 *value) { - hal_mpt_GetThermalMeter(pAdapter, value); + hal_mpt_GetThermalMeter(pAdapter, rfpath, value); } void SetSingleCarrierTx(PADAPTER pAdapter, u8 bStart) @@ -1364,6 +1283,48 @@ static struct xmit_frame *alloc_mp_xmitframe(struct xmit_priv *pxmitpriv) } +#ifdef CONFIG_PCI_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; @@ -1382,6 +1343,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_PCI_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)) @@ -1417,7 +1384,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) @@ -1489,7 +1457,7 @@ void fill_tx_desc_8814a(PADAPTER padapter) u32 pkt_size = pattrib->last_txcmdsz; s32 bmcast = IS_MCAST(pattrib->ra); - u8 data_rate, pwr_status, offset; + u8 offset; /* SET_TX_DESC_FIRST_SEG_8814A(pDesc, 1); */ SET_TX_DESC_LAST_SEG_8814A(pDesc, 1); @@ -1743,6 +1711,37 @@ void fill_tx_desc_8188f(PADAPTER padapter) } #endif +#if defined(CONFIG_RTL8188GTV) +void fill_tx_desc_8188gtv(PADAPTER padapter) +{ + struct mp_priv *pmp_priv = &padapter->mppriv; + struct pkt_attrib *pattrib = &(pmp_priv->tx.attrib); + u8 *ptxdesc = pmp_priv->tx.desc; + + SET_TX_DESC_AGG_BREAK_8188GTV(ptxdesc, 1); + SET_TX_DESC_MACID_8188GTV(ptxdesc, pattrib->mac_id); + SET_TX_DESC_QUEUE_SEL_8188GTV(ptxdesc, pattrib->qsel); + + SET_TX_DESC_RATE_ID_8188GTV(ptxdesc, pattrib->raid); + SET_TX_DESC_SEQ_8188GTV(ptxdesc, pattrib->seqnum); + SET_TX_DESC_HWSEQ_EN_8188GTV(ptxdesc, 1); + SET_TX_DESC_USE_RATE_8188GTV(ptxdesc, 1); + SET_TX_DESC_DISABLE_FB_8188GTV(ptxdesc, 1); + + if (pmp_priv->preamble) + if (HwRateToMPTRate(pmp_priv->rateidx) <= MPT_RATE_54M) + SET_TX_DESC_DATA_SHORT_8188GTV(ptxdesc, 1); + + if (pmp_priv->bandwidth == CHANNEL_WIDTH_40) + SET_TX_DESC_DATA_BW_8188GTV(ptxdesc, 1); + + SET_TX_DESC_TX_RATE_8188GTV(ptxdesc, pmp_priv->rateidx); + + SET_TX_DESC_DATA_RATE_FB_LIMIT_8188GTV(ptxdesc, 0x1F); + SET_TX_DESC_RTS_RATE_FB_LIMIT_8188GTV(ptxdesc, 0xF); +} +#endif + #if defined(CONFIG_RTL8723D) void fill_tx_desc_8723d(PADAPTER padapter) { @@ -1775,6 +1774,70 @@ void fill_tx_desc_8723d(PADAPTER padapter) } #endif +#if defined(CONFIG_RTL8710B) +void fill_tx_desc_8710b(PADAPTER padapter) +{ + struct mp_priv *pmp_priv = &padapter->mppriv; + struct pkt_attrib *pattrib = &(pmp_priv->tx.attrib); + u8 *ptxdesc = pmp_priv->tx.desc; + + SET_TX_DESC_BK_8710B(ptxdesc, 1); + SET_TX_DESC_MACID_8710B(ptxdesc, pattrib->mac_id); + SET_TX_DESC_QUEUE_SEL_8710B(ptxdesc, pattrib->qsel); + + SET_TX_DESC_RATE_ID_8710B(ptxdesc, pattrib->raid); + SET_TX_DESC_SEQ_8710B(ptxdesc, pattrib->seqnum); + SET_TX_DESC_HWSEQ_EN_8710B(ptxdesc, 1); + SET_TX_DESC_USE_RATE_8710B(ptxdesc, 1); + SET_TX_DESC_DISABLE_FB_8710B(ptxdesc, 1); + + if (pmp_priv->preamble) { + if (HwRateToMPTRate(pmp_priv->rateidx) <= MPT_RATE_54M) + SET_TX_DESC_DATA_SHORT_8710B(ptxdesc, 1); + } + + if (pmp_priv->bandwidth == CHANNEL_WIDTH_40) + SET_TX_DESC_DATA_BW_8710B(ptxdesc, 1); + + SET_TX_DESC_TX_RATE_8710B(ptxdesc, pmp_priv->rateidx); + + SET_TX_DESC_DATA_RATE_FB_LIMIT_8710B(ptxdesc, 0x1F); + SET_TX_DESC_RTS_RATE_FB_LIMIT_8710B(ptxdesc, 0xF); +} +#endif + +#if defined(CONFIG_RTL8192F) +void fill_tx_desc_8192f(PADAPTER padapter) +{ + struct mp_priv *pmp_priv = &padapter->mppriv; + struct pkt_attrib *pattrib = &(pmp_priv->tx.attrib); + u8 *ptxdesc = pmp_priv->tx.desc; + + SET_TX_DESC_BK_8192F(ptxdesc, 1); + SET_TX_DESC_MACID_8192F(ptxdesc, pattrib->mac_id); + SET_TX_DESC_QUEUE_SEL_8192F(ptxdesc, pattrib->qsel); + + SET_TX_DESC_RATE_ID_8192F(ptxdesc, pattrib->raid); + SET_TX_DESC_SEQ_8192F(ptxdesc, pattrib->seqnum); + SET_TX_DESC_HWSEQ_EN_8192F(ptxdesc, 1); + SET_TX_DESC_USE_RATE_8192F(ptxdesc, 1); + SET_TX_DESC_DISABLE_FB_8192F(ptxdesc, 1); + + if (pmp_priv->preamble) { + if (HwRateToMPTRate(pmp_priv->rateidx) <= MPT_RATE_54M) + SET_TX_DESC_DATA_SHORT_8192F(ptxdesc, 1); + } + + if (pmp_priv->bandwidth == CHANNEL_WIDTH_40) + SET_TX_DESC_DATA_BW_8192F(ptxdesc, 1); + + SET_TX_DESC_TX_RATE_8192F(ptxdesc, pmp_priv->rateidx); + + SET_TX_DESC_DATA_RATE_FB_LIMIT_8192F(ptxdesc, 0x1F); + SET_TX_DESC_RTS_RATE_FB_LIMIT_8192F(ptxdesc, 0xF); +} + +#endif static void Rtw_MPSetMacTxEDCA(PADAPTER padapter) { @@ -1792,8 +1855,8 @@ static void Rtw_MPSetMacTxEDCA(PADAPTER padapter) void SetPacketTx(PADAPTER padapter) { - u8 *ptr, *pkt_start, *pkt_end, *fctrl; - u32 pkt_size, offset, startPlace, i; + u8 *ptr, *pkt_start, *pkt_end; + u32 pkt_size, i; struct rtw_ieee80211_hdr *hdr; u8 payload; s32 bmcast; @@ -1814,13 +1877,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; @@ -1860,6 +1922,11 @@ void SetPacketTx(PADAPTER padapter) rtl8822b_prepare_mp_txdesc(padapter, pmp_priv); #endif /* CONFIG_RTL8822B */ +#if defined(CONFIG_RTL8822C) + if (IS_HARDWARE_TYPE_8822C(padapter)) + rtl8822c_prepare_mp_txdesc(padapter, pmp_priv); +#endif /* CONFIG_RTL8822C */ + #if defined(CONFIG_RTL8821C) if (IS_HARDWARE_TYPE_8821C(padapter)) rtl8821c_prepare_mp_txdesc(padapter, pmp_priv); @@ -1888,10 +1955,24 @@ void SetPacketTx(PADAPTER padapter) fill_tx_desc_8188f(padapter); #endif +#if defined(CONFIG_RTL8188GTV) + if (IS_HARDWARE_TYPE_8188GTV(padapter)) + fill_tx_desc_8188gtv(padapter); +#endif + #if defined(CONFIG_RTL8723D) if (IS_HARDWARE_TYPE_8723D(padapter)) fill_tx_desc_8723d(padapter); #endif +#if defined(CONFIG_RTL8192F) + if (IS_HARDWARE_TYPE_8192F(padapter)) + fill_tx_desc_8192f(padapter); +#endif + +#if defined(CONFIG_RTL8710B) + if (IS_HARDWARE_TYPE_8710B(padapter)) + fill_tx_desc_8710b(padapter); +#endif /* 3 4. make wlan header, make_wlanhdr() */ hdr = (struct rtw_ieee80211_hdr *)pkt_start; @@ -1932,15 +2013,20 @@ void SetPacketTx(PADAPTER padapter) pmp_priv->TXradomBuffer[i] = rtw_random32() % 0xFF; /* startPlace = (u32)(rtw_random32() % 3450); */ - _rtw_memcpy(ptr, pmp_priv->TXradomBuffer, pkt_end - ptr); + if (pmp_priv->mplink_btx == _TRUE) + _rtw_memcpy(ptr, pmp_priv->mplink_buf, pkt_end - ptr); + else + _rtw_memcpy(ptr, pmp_priv->TXradomBuffer, pkt_end - ptr); /* _rtw_memset(ptr, payload, pkt_end - ptr); */ rtw_mfree(pmp_priv->TXradomBuffer, 4096); /* 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 { @@ -1979,11 +2065,13 @@ void SetPacketRx(PADAPTER pAdapter, u8 bStartRx, u8 bAB) MAC_ARG(pmppriv->network_macaddr)); pHalData->ReceiveConfig = 0; pHalData->ReceiveConfig |= RCR_CBSSID_DATA | RCR_CBSSID_BCN |RCR_APM | RCR_AM | RCR_AB |RCR_AMF; + pHalData->ReceiveConfig |= RCR_APP_PHYST_RXFF; -#if defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) +#if defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822C) write_bbreg(pAdapter, 0x550, BIT3, bEnable); #endif rtw_write16(pAdapter, REG_RXFLTMAP0, 0xFFEF); /* REG_RXFLTMAP0 (RX Filter Map Group 0) */ + pmppriv->brx_filter_beacon = _TRUE; } else { pHalData->ReceiveConfig |= RCR_ADF; @@ -2053,6 +2141,167 @@ u32 GetPhyRxPktCRC32Error(PADAPTER pAdapter) return OFDM_cnt + CCK_cnt + HT_cnt; } +struct psd_init_regs { + /* 3 wire */ + int reg_88c; + int reg_c00; + int reg_e00; + int reg_1800; + int reg_1a00; + /* cck */ + int reg_800; + int reg_808; +}; + +static int rtw_mp_psd_init(PADAPTER padapter, struct psd_init_regs *regs) +{ + HAL_DATA_TYPE *phal_data = GET_HAL_DATA(padapter); + + switch (phal_data->rf_type) { + /* 1R */ + case RF_1T1R: + if (hal_chk_proto_cap(padapter, PROTO_CAP_11AC)) { + /* 11AC 1R PSD Setting 3wire & cck off */ + regs->reg_c00 = rtw_read32(padapter, 0xC00); + phy_set_bb_reg(padapter, 0xC00, 0x3, 0x00); + regs->reg_808 = rtw_read32(padapter, 0x808); + phy_set_bb_reg(padapter, 0x808, 0x10000000, 0x0); + } else { + /* 11N 3-wire off 1 */ + regs->reg_88c = rtw_read32(padapter, 0x88C); + phy_set_bb_reg(padapter, 0x88C, 0x300000, 0x3); + /* 11N CCK off */ + regs->reg_800 = rtw_read32(padapter, 0x800); + phy_set_bb_reg(padapter, 0x800, 0x1000000, 0x0); + } + break; + + /* 2R */ + case RF_1T2R: + case RF_2T2R: + if (hal_chk_proto_cap(padapter, PROTO_CAP_11AC)) { + /* 11AC 2R PSD Setting 3wire & cck off */ + regs->reg_c00 = rtw_read32(padapter, 0xC00); + regs->reg_e00 = rtw_read32(padapter, 0xE00); + phy_set_bb_reg(padapter, 0xC00, 0x3, 0x00); + phy_set_bb_reg(padapter, 0xE00, 0x3, 0x00); + regs->reg_808 = rtw_read32(padapter, 0x808); + phy_set_bb_reg(padapter, 0x808, 0x10000000, 0x0); + } else { + /* 11N 3-wire off 2 */ + regs->reg_88c = rtw_read32(padapter, 0x88C); + phy_set_bb_reg(padapter, 0x88C, 0xF00000, 0xF); + /* 11N CCK off */ + regs->reg_800 = rtw_read32(padapter, 0x800); + phy_set_bb_reg(padapter, 0x800, 0x1000000, 0x0); + } + break; + + /* 3R */ + case RF_2T3R: + case RF_3T3R: + if (hal_chk_proto_cap(padapter, PROTO_CAP_11AC)) { + /* 11AC 3R PSD Setting 3wire & cck off */ + regs->reg_c00 = rtw_read32(padapter, 0xC00); + regs->reg_e00 = rtw_read32(padapter, 0xE00); + regs->reg_1800 = rtw_read32(padapter, 0x1800); + phy_set_bb_reg(padapter, 0xC00, 0x3, 0x00); + phy_set_bb_reg(padapter, 0xE00, 0x3, 0x00); + phy_set_bb_reg(padapter, 0x1800, 0x3, 0x00); + regs->reg_808 = rtw_read32(padapter, 0x808); + phy_set_bb_reg(padapter, 0x808, 0x10000000, 0x0); + } else { + RTW_ERR("%s: 11n don't support 3R\n", __func__); + return -1; + } + break; + + /* 4R */ + case RF_2T4R: + case RF_3T4R: + case RF_4T4R: + if (hal_chk_proto_cap(padapter, PROTO_CAP_11AC)) { + /* 11AC 4R PSD Setting 3wire & cck off */ + regs->reg_c00 = rtw_read32(padapter, 0xC00); + regs->reg_e00 = rtw_read32(padapter, 0xE00); + regs->reg_1800 = rtw_read32(padapter, 0x1800); + regs->reg_1a00 = rtw_read32(padapter, 0x1A00); + phy_set_bb_reg(padapter, 0xC00, 0x3, 0x00); + phy_set_bb_reg(padapter, 0xE00, 0x3, 0x00); + phy_set_bb_reg(padapter, 0x1800, 0x3, 0x00); + phy_set_bb_reg(padapter, 0x1A00, 0x3, 0x00); + regs->reg_808 = rtw_read32(padapter, 0x808); + phy_set_bb_reg(padapter, 0x808, 0x10000000, 0x0); + } else { + RTW_ERR("%s: 11n don't support 4R\n", __func__); + return -1; + } + break; + + default: + RTW_ERR("%s: unknown %d rf type\n", __func__, phal_data->rf_type); + return -1; + } + + /* Set PSD points, 0=128, 1=256, 2=512, 3=1024 */ + if (hal_chk_proto_cap(padapter, PROTO_CAP_11AC)) + phy_set_bb_reg(padapter, 0x910, 0xC000, 3); + else + phy_set_bb_reg(padapter, 0x808, 0xC000, 3); + + RTW_INFO("%s: set %d rf type done\n", __func__, phal_data->rf_type); + return 0; +} + +static int rtw_mp_psd_close(PADAPTER padapter, struct psd_init_regs *regs) +{ + HAL_DATA_TYPE *phal_data = GET_HAL_DATA(padapter); + + + if (!hal_chk_proto_cap(padapter, PROTO_CAP_11AC)) { + /* 11n 3wire restore */ + rtw_write32(padapter, 0x88C, regs->reg_88c); + /* 11n cck restore */ + rtw_write32(padapter, 0x800, regs->reg_800); + RTW_INFO("%s: restore %d rf type\n", __func__, phal_data->rf_type); + return 0; + } + + /* 11ac 3wire restore */ + switch (phal_data->rf_type) { + case RF_1T1R: + rtw_write32(padapter, 0xC00, regs->reg_c00); + break; + case RF_1T2R: + case RF_2T2R: + rtw_write32(padapter, 0xC00, regs->reg_c00); + rtw_write32(padapter, 0xE00, regs->reg_e00); + break; + case RF_2T3R: + case RF_3T3R: + rtw_write32(padapter, 0xC00, regs->reg_c00); + rtw_write32(padapter, 0xE00, regs->reg_e00); + rtw_write32(padapter, 0x1800, regs->reg_1800); + break; + case RF_2T4R: + case RF_3T4R: + case RF_4T4R: + rtw_write32(padapter, 0xC00, regs->reg_c00); + rtw_write32(padapter, 0xE00, regs->reg_e00); + rtw_write32(padapter, 0x1800, regs->reg_1800); + rtw_write32(padapter, 0x1A00, regs->reg_1a00); + break; + default: + RTW_WARN("%s: unknown %d rf type\n", __func__, phal_data->rf_type); + break; + } + + /* 11ac cck restore */ + rtw_write32(padapter, 0x808, regs->reg_808); + RTW_INFO("%s: restore %d rf type done\n", __func__, phal_data->rf_type); + return 0; +} + /* 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 */ @@ -2060,7 +2309,7 @@ static u32 rtw_GetPSDData(PADAPTER pAdapter, u32 point) { u32 psd_val = 0; -#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) +#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822C) u16 psd_reg = 0x910; u16 psd_regL = 0xF44; #else @@ -2081,7 +2330,11 @@ static u32 rtw_GetPSDData(PADAPTER pAdapter, u32 point) rtw_mdelay_os(1); psd_val = rtw_read32(pAdapter, psd_regL); +#if defined(CONFIG_RTL8821C) + psd_val = (psd_val & 0x00FFFFFF) / 32; +#else psd_val &= 0x0000FFFF; +#endif return psd_val; } @@ -2096,8 +2349,13 @@ static u32 rtw_GetPSDData(PADAPTER pAdapter, u32 point) */ u32 mp_query_psd(PADAPTER pAdapter, u8 *data) { + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); + struct dm_struct *p_dm = adapter_to_phydm(pAdapter); + u32 i, psd_pts = 0, psd_start = 0, psd_stop = 0; u32 psd_data = 0; + struct psd_init_regs regs = {}; + int psd_analysis = 0; #ifdef PLATFORM_LINUX @@ -2114,27 +2372,69 @@ u32 mp_query_psd(PADAPTER pAdapter, u8 *data) psd_pts = 128; psd_start = 64; psd_stop = 128; + } else if (strncmp(data, "analysis,", 9) == 0) { + if (rtw_mp_psd_init(pAdapter, ®s) != 0) + return 0; + psd_analysis = 1; + sscanf(data + 9, "pts=%d,start=%d,stop=%d", &psd_pts, &psd_start, &psd_stop); } else sscanf(data, "pts=%d,start=%d,stop=%d", &psd_pts, &psd_start, &psd_stop); data[0] = '\0'; + if (IS_HARDWARE_TYPE_8822C(pAdapter)) { + u32 *psdbuf = rtw_zmalloc(sizeof(u32)*256); + + if (psdbuf == NULL) { + RTW_INFO("%s: psd buf malloc fail!!\n", __func__); + return 0; + } + + halrf_cmn_info_set(p_dm, HALRF_CMNINFO_MP_PSD_POINT, psd_pts); + halrf_cmn_info_set(p_dm, HALRF_CMNINFO_MP_PSD_START_POINT, psd_start); + halrf_cmn_info_set(p_dm, HALRF_CMNINFO_MP_PSD_STOP_POINT, psd_stop); + halrf_cmn_info_set(p_dm, HALRF_CMNINFO_MP_PSD_AVERAGE, 0x20000); + + halrf_psd_init(p_dm); +#ifdef CONFIG_LONG_DELAY_ISSUE + rtw_msleep_os(100); +#else + rtw_mdelay_os(100); +#endif + halrf_psd_query(p_dm, psdbuf, 256); + + i = 0; + while (i < 256) { + sprintf(data, "%s%x ", data, (psdbuf[i])); + i++; + } + + if (psdbuf) + rtw_mfree(psdbuf, sizeof(u32)*256); + + } else { i = psd_start; while (i < psd_stop) { if (i >= psd_pts) psd_data = rtw_GetPSDData(pAdapter, i - psd_pts); else psd_data = rtw_GetPSDData(pAdapter, i); + sprintf(data, "%s%x ", data, psd_data); i++; } + } + #ifdef CONFIG_LONG_DELAY_ISSUE rtw_msleep_os(100); #else rtw_mdelay_os(100); #endif + if (psd_analysis) + rtw_mp_psd_close(pAdapter, ®s); + return strlen(data) + 1; } @@ -2226,7 +2526,7 @@ void _rtw_mp_xmit_priv(struct xmit_priv *pxmitpriv) u8 mpt_to_mgnt_rate( - IN ULONG MptRateIdx + u32 MptRateIdx ) { /* Mapped to MGN_XXX defined in MgntGen.h */ @@ -2710,7 +3010,18 @@ u8 rtw_mpRateParseFunc(PADAPTER pAdapter, u8 *targetStr) return _FAIL; } -ULONG mpt_ProQueryCalTxPower( +u8 rtw_mp_mode_check(PADAPTER pAdapter) +{ + PADAPTER primary_adapter = GET_PRIMARY_ADAPTER(pAdapter); + + if (primary_adapter->registrypriv.mp_mode == 1 || primary_adapter->mppriv.bprocess_mp_mode == _TRUE) + return _TRUE; + else + return _FALSE; +} + + +u32 mpt_ProQueryCalTxPower( PADAPTER pAdapter, u8 RfPath ) @@ -2719,22 +3030,26 @@ ULONG mpt_ProQueryCalTxPower( HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); - ULONG TxPower = 1; - u1Byte rate = 0; + u32 TxPower = 1; struct txpwr_idx_comp tic; u8 mgn_rate = mpt_to_mgnt_rate(pMptCtx->mpt_rate_index); 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->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); + RTW_INFO("TXPWR: [%c][%s]ch:%u, %s %uT, pwr_idx:%u(0x%02x) = %u + (%d=%d:%d) + (%d) + (%d) + (%d) + (%d)\n" + , rf_path_char(RfPath), ch_width_str(pHalData->current_channel_bw), pHalData->current_channel, MGN_RATE_STR(mgn_rate), tic.ntx_idx + 1 + , TxPower, TxPower, tic.pg, (tic.by_rate > tic.limit ? tic.limit : tic.by_rate), tic.by_rate, tic.limit, tic.tpt + , tic.ebias, tic.btc, tic.dpd); 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; + if (RfPath == RF_PATH_A) + pMptCtx->TxPwrLevel[RF_PATH_A] = (u8)TxPower; + else if (RfPath == RF_PATH_B) + pMptCtx->TxPwrLevel[RF_PATH_B] = (u8)TxPower; + else if (RfPath == RF_PATH_C) + pMptCtx->TxPwrLevel[RF_PATH_C] = (u8)TxPower; + else if (RfPath == RF_PATH_D) + pMptCtx->TxPwrLevel[RF_PATH_D] = (u8)TxPower; hal_mpt_SetTxPower(pAdapter); return TxPower; @@ -2752,11 +3067,11 @@ static inline void dump_buf(u8 *buf, u32 len) } void ByteToBit( - UCHAR *out, + u8 *out, bool *in, - UCHAR in_size) + u8 in_size) { - UCHAR i = 0, j = 0; + u8 i = 0, j = 0; for (i = 0; i < in_size; i++) { for (j = 0; j < 8; j++) { @@ -2770,10 +3085,10 @@ void ByteToBit( void CRC16_generator( bool *out, bool *in, - UCHAR in_size + u8 in_size ) { - UCHAR i = 0; + u8 i = 0; bool temp = 0, reg[] = {1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1, 1}; for (i = 0; i < in_size; i++) {/* take one's complement and bit reverse*/ @@ -2818,8 +3133,8 @@ void CCK_generator( bool LengthExtBit; double LengthExact; double LengthPSDU; - UCHAR i; - UINT PacketLength = pPMacTxInfo->PacketLength; + u8 i; + u32 PacketLength = pPMacTxInfo->PacketLength; if (pPMacTxInfo->bSPreamble) pPMacTxInfo->SFD = 0x05CF; @@ -2863,7 +3178,7 @@ void CCK_generator( LengthExtBit = 0; - pPMacTxInfo->LENGTH = (UINT)LengthPSDU; + pPMacTxInfo->LENGTH = (u32)LengthPSDU; /* CRC16_in(1,16:31) = LengthPSDU[0:15]*/ for (i = 0; i < 16; i++) crc16_in[i + 16] = (pPMacTxInfo->LENGTH >> i) & 0x1; @@ -2890,8 +3205,8 @@ void PMAC_Get_Pkt_Param( PRT_PMAC_PKT_INFO pPMacPktInfo) { - UCHAR TX_RATE_HEX = 0, MCS = 0; - UCHAR TX_RATE = pPMacTxInfo->TX_RATE; + u8 TX_RATE_HEX = 0, MCS = 0; + u8 TX_RATE = pPMacTxInfo->TX_RATE; /* TX_RATE & Nss */ if (MPT_IS_2SS_RATE(TX_RATE)) @@ -2957,13 +3272,13 @@ void PMAC_Get_Pkt_Param( } -UINT LDPC_parameter_generator( - UINT N_pld_int, - UINT N_CBPSS, - UINT N_SS, - UINT R, - UINT m_STBC, - UINT N_TCB_int +u32 LDPC_parameter_generator( + u32 N_pld_int, + u32 N_CBPSS, + u32 N_SS, + u32 R, + u32 m_STBC, + u32 N_TCB_int ) { double CR = 0.; @@ -2973,7 +3288,7 @@ UINT LDPC_parameter_generator( double L_LDPC = 0., K_LDPC = 0., L_LDPC_info = 0.; double N_punc = 0., N_ppcw = 0., N_fpunc = 0., N_rep = 0., N_rpcw = 0., N_frep = 0.; double R_eff = 0.; - UINT VHTSIGA2B3 = 0;/* extra symbol from VHT-SIG-A2 Bit 3*/ + u32 VHTSIGA2B3 = 0;/* extra symbol from VHT-SIG-A2 Bit 3*/ if (R == 0) CR = 0.5; @@ -3041,13 +3356,13 @@ void PMAC_Nsym_generator( PRT_PMAC_TX_INFO pPMacTxInfo, PRT_PMAC_PKT_INFO pPMacPktInfo) { - UINT SIGA2B3 = 0; - UCHAR TX_RATE = pPMacTxInfo->TX_RATE; + u32 SIGA2B3 = 0; + u8 TX_RATE = pPMacTxInfo->TX_RATE; - UINT R, R_list[10] = {0, 0, 2, 0, 2, 1, 2, 3, 2, 3}; + u32 R, R_list[10] = {0, 0, 2, 0, 2, 1, 2, 3, 2, 3}; double CR = 0; - UINT N_SD, N_BPSC_list[10] = {1, 2, 2, 4, 4, 6, 6, 6, 8, 8}; - UINT N_BPSC = 0, N_CBPS = 0, N_DBPS = 0, N_ES = 0, N_SYM = 0, N_pld = 0, N_TCB = 0; + u32 N_SD, N_BPSC_list[10] = {1, 2, 2, 4, 4, 6, 6, 6, 8, 8}; + u32 N_BPSC = 0, N_CBPS = 0, N_DBPS = 0, N_ES = 0, N_SYM = 0, N_pld = 0, N_TCB = 0; int D_R = 0; RTW_INFO("TX_RATE = %d\n", TX_RATE); @@ -3060,7 +3375,7 @@ void PMAC_Nsym_generator( N_SD = 234; if (MPT_IS_HT_RATE(TX_RATE)) { - UCHAR MCS_temp; + u8 MCS_temp; if (pPMacPktInfo->MCS > 23) MCS_temp = pPMacPktInfo->MCS - 24; @@ -3090,14 +3405,14 @@ void PMAC_Nsym_generator( N_BPSC = N_BPSC_list[MCS_temp]; N_CBPS = N_BPSC * N_SD * pPMacPktInfo->Nss; - N_DBPS = (UINT)((double)N_CBPS * CR); + N_DBPS = (u32)((double)N_CBPS * CR); if (pPMacTxInfo->bLDPC == FALSE) { - N_ES = (UINT)ceil((double)(N_DBPS * pPMacPktInfo->Nss) / 4. / 300.); + N_ES = (u32)ceil((double)(N_DBPS * pPMacPktInfo->Nss) / 4. / 300.); RTW_INFO("N_ES = %d\n", N_ES); /* N_SYM = m_STBC* (8*length+16+6*N_ES) / (m_STBC*N_DBPS)*/ - N_SYM = pPMacTxInfo->m_STBC * (UINT)ceil((double)(pPMacTxInfo->PacketLength * 8 + 16 + N_ES * 6) / + N_SYM = pPMacTxInfo->m_STBC * (u32)ceil((double)(pPMacTxInfo->PacketLength * 8 + 16 + N_ES * 6) / (double)(N_DBPS * pPMacTxInfo->m_STBC)); } else { @@ -3105,7 +3420,7 @@ void PMAC_Nsym_generator( /* N_pld = length * 8 + 16*/ N_pld = pPMacTxInfo->PacketLength * 8 + 16; RTW_INFO("N_pld = %d\n", N_pld); - N_SYM = pPMacTxInfo->m_STBC * (UINT)ceil((double)(N_pld) / + N_SYM = pPMacTxInfo->m_STBC * (u32)ceil((double)(N_pld) / (double)(N_DBPS * pPMacTxInfo->m_STBC)); RTW_INFO("N_SYM = %d\n", N_SYM); /* N_avbits = N_CBPS *m_STBC *(N_pld/N_CBPS*R*m_STBC)*/ @@ -3135,19 +3450,19 @@ void PMAC_Nsym_generator( } N_BPSC = N_BPSC_list[pPMacPktInfo->MCS]; N_CBPS = N_BPSC * N_SD * pPMacPktInfo->Nss; - N_DBPS = (UINT)((double)N_CBPS * CR); + N_DBPS = (u32)((double)N_CBPS * CR); if (pPMacTxInfo->bLDPC == FALSE) { if (pPMacTxInfo->bSGI) - N_ES = (UINT)ceil((double)(N_DBPS) / 3.6 / 600.); + N_ES = (u32)ceil((double)(N_DBPS) / 3.6 / 600.); else - N_ES = (UINT)ceil((double)(N_DBPS) / 4. / 600.); + N_ES = (u32)ceil((double)(N_DBPS) / 4. / 600.); /* N_SYM = m_STBC* (8*length+16+6*N_ES) / (m_STBC*N_DBPS)*/ - N_SYM = pPMacTxInfo->m_STBC * (UINT)ceil((double)(pPMacTxInfo->PacketLength * 8 + 16 + N_ES * 6) / (double)(N_DBPS * pPMacTxInfo->m_STBC)); + N_SYM = pPMacTxInfo->m_STBC * (u32)ceil((double)(pPMacTxInfo->PacketLength * 8 + 16 + N_ES * 6) / (double)(N_DBPS * pPMacTxInfo->m_STBC)); SIGA2B3 = 0; } else { N_ES = 1; /* N_SYM = m_STBC* (8*length+N_service) / (m_STBC*N_DBPS)*/ - N_SYM = pPMacTxInfo->m_STBC * (UINT)ceil((double)(pPMacTxInfo->PacketLength * 8 + 16) / (double)(N_DBPS * pPMacTxInfo->m_STBC)); + N_SYM = pPMacTxInfo->m_STBC * (u32)ceil((double)(pPMacTxInfo->PacketLength * 8 + 16) / (double)(N_DBPS * pPMacTxInfo->m_STBC)); /* N_avbits = N_sys_init * N_CBPS*/ N_TCB = N_CBPS * N_SYM; /* N_pld = N_sys_init * N_DBPS*/ @@ -3189,21 +3504,21 @@ void PMAC_Nsym_generator( ========================================*/ void L_SIG_generator( - UINT N_SYM, /* Max: 750*/ + u32 N_SYM, /* Max: 750*/ PRT_PMAC_TX_INFO pPMacTxInfo, PRT_PMAC_PKT_INFO pPMacPktInfo) { u8 sig_bi[24] = {0}; /* 24 BIT*/ - UINT mode, LENGTH; + u32 mode, LENGTH; int i; if (MPT_IS_OFDM_RATE(pPMacTxInfo->TX_RATE)) { mode = pPMacPktInfo->MCS; LENGTH = pPMacTxInfo->PacketLength; } else { - UCHAR N_LTF; + u8 N_LTF; double T_data; - UINT OFDM_symbol; + u32 OFDM_symbol; mode = 0; @@ -3220,9 +3535,9 @@ void L_SIG_generator( /*(L-SIG, HT-SIG, HT-STF, HT-LTF....HT-LTF, Data)*/ if (MPT_IS_VHT_RATE(pPMacTxInfo->TX_RATE)) - OFDM_symbol = (UINT)ceil((double)(8 + 4 + N_LTF * 4 + N_SYM * T_data + 4) / 4.); + OFDM_symbol = (u32)ceil((double)(8 + 4 + N_LTF * 4 + N_SYM * T_data + 4) / 4.); else - OFDM_symbol = (UINT)ceil((double)(8 + 4 + N_LTF * 4 + N_SYM * T_data) / 4.); + OFDM_symbol = (u32)ceil((double)(8 + 4 + N_LTF * 4 + N_SYM * T_data) / 4.); RTW_INFO("%s , OFDM_symbol =%d\n", __func__, OFDM_symbol); LENGTH = OFDM_symbol * 3 - 3; @@ -3307,10 +3622,10 @@ void L_SIG_generator( void CRC8_generator( bool *out, bool *in, - UCHAR in_size + u8 in_size ) { - UCHAR i = 0; + u8 i = 0; bool temp = 0, reg[] = {1, 1, 1, 1, 1, 1, 1, 1}; for (i = 0; i < in_size; i++) { /* take one's complement and bit reverse*/ @@ -3339,7 +3654,7 @@ void HT_SIG_generator( PRT_PMAC_PKT_INFO pPMacPktInfo ) { - UINT i; + u32 i; bool sig_bi[48] = {0}, crc8[8] = {0}; /* MCS Field*/ for (i = 0; i < 7; i++) @@ -3406,7 +3721,7 @@ void VHT_SIG_A_generator( PRT_PMAC_TX_INFO pPMacTxInfo, PRT_PMAC_PKT_INFO pPMacPktInfo) { - UINT i; + u32 i; bool sig_bi[48], crc8[8]; _rtw_memset(sig_bi, 0, 48); @@ -3470,8 +3785,8 @@ void VHT_SIG_B_generator( PRT_PMAC_TX_INFO pPMacTxInfo) { bool sig_bi[32], crc8_bi[8]; - UINT i, len, res, tail = 6, total_len, crc8_in_len; - UINT sigb_len; + u32 i, len, res, tail = 6, total_len, crc8_in_len; + u32 sigb_len; _rtw_memset(sig_bi, 0, 32); _rtw_memset(crc8_bi, 0, 8); @@ -3541,8 +3856,8 @@ void VHT_Delimiter_generator( ) { bool sig_bi[32] = {0}, crc8[8] = {0}; - UINT crc8_in_len = 16; - UINT PacketLength = pPMacTxInfo->PacketLength; + u32 crc8_in_len = 16; + u32 PacketLength = pPMacTxInfo->PacketLength; int j; /* Delimiter[0]: EOF*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_mp_ioctl.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_mp_ioctl.c deleted file mode 100644 index 33bd6d283d7d..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_mp_ioctl.c +++ /dev/null @@ -1,2534 +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 - * - * - ******************************************************************************/ -#define _RTW_MP_IOCTL_C_ - -#include -#include -#include "../hal/phydm/phydm_precomp.h" - -/* **************** oid_rtl_seg_81_85 section start **************** */ -NDIS_STATUS oid_rt_wireless_mode_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - - if (poid_par_priv->information_buf_len < sizeof(u8)) - return NDIS_STATUS_INVALID_LENGTH; - - if (poid_par_priv->type_of_oid == SET_OID) - Adapter->registrypriv.wireless_mode = *(u8 *)poid_par_priv->information_buf; - else if (poid_par_priv->type_of_oid == QUERY_OID) { - *(u8 *)poid_par_priv->information_buf = Adapter->registrypriv.wireless_mode; - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - } else - status = NDIS_STATUS_NOT_ACCEPTED; - - - return status; -} -/* **************** oid_rtl_seg_81_87_80 section start **************** */ -NDIS_STATUS oid_rt_pro_write_bb_reg_hdl(struct oid_par_priv *poid_par_priv) -{ -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - struct bb_reg_param *pbbreg; - u16 offset; - u32 value; - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - - - if (poid_par_priv->type_of_oid != SET_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - if (poid_par_priv->information_buf_len < sizeof(struct bb_reg_param)) - return NDIS_STATUS_INVALID_LENGTH; - - pbbreg = (struct bb_reg_param *)(poid_par_priv->information_buf); - - offset = (u16)(pbbreg->offset) & 0xFFF; /* 0ffset :0x800~0xfff */ - if (offset < BB_REG_BASE_ADDR) - offset |= BB_REG_BASE_ADDR; - - value = pbbreg->value; - - - _irqlevel_changed_(&oldirql, LOWER); - write_bbreg(Adapter, offset, 0xFFFFFFFF, value); - _irqlevel_changed_(&oldirql, RAISE); - - - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_read_bb_reg_hdl(struct oid_par_priv *poid_par_priv) -{ -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - struct bb_reg_param *pbbreg; - u16 offset; - u32 value; - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - - - if (poid_par_priv->type_of_oid != QUERY_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - if (poid_par_priv->information_buf_len < sizeof(struct bb_reg_param)) - return NDIS_STATUS_INVALID_LENGTH; - - pbbreg = (struct bb_reg_param *)(poid_par_priv->information_buf); - - offset = (u16)(pbbreg->offset) & 0xFFF; /* 0ffset :0x800~0xfff */ - if (offset < BB_REG_BASE_ADDR) - offset |= BB_REG_BASE_ADDR; - - _irqlevel_changed_(&oldirql, LOWER); - value = read_bbreg(Adapter, offset, 0xFFFFFFFF); - _irqlevel_changed_(&oldirql, RAISE); - - pbbreg->value = value; - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - - - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_write_rf_reg_hdl(struct oid_par_priv *poid_par_priv) -{ -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - struct rf_reg_param *pbbreg; - u8 path; - u8 offset; - u32 value; - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - - - if (poid_par_priv->type_of_oid != SET_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - if (poid_par_priv->information_buf_len < sizeof(struct rf_reg_param)) - return NDIS_STATUS_INVALID_LENGTH; - - pbbreg = (struct rf_reg_param *)(poid_par_priv->information_buf); - - if (pbbreg->path >= MAX_RF_PATH_NUMS) - return NDIS_STATUS_NOT_ACCEPTED; - if (pbbreg->offset > 0xFF) - return NDIS_STATUS_NOT_ACCEPTED; - if (pbbreg->value > 0xFFFFF) - return NDIS_STATUS_NOT_ACCEPTED; - - path = (u8)pbbreg->path; - offset = (u8)pbbreg->offset; - value = pbbreg->value; - - - _irqlevel_changed_(&oldirql, LOWER); - write_rfreg(Adapter, path, offset, value); - _irqlevel_changed_(&oldirql, RAISE); - - - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_read_rf_reg_hdl(struct oid_par_priv *poid_par_priv) -{ -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - struct rf_reg_param *pbbreg; - u8 path; - u8 offset; - u32 value; - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - - - - if (poid_par_priv->type_of_oid != QUERY_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - if (poid_par_priv->information_buf_len < sizeof(struct rf_reg_param)) - return NDIS_STATUS_INVALID_LENGTH; - - pbbreg = (struct rf_reg_param *)(poid_par_priv->information_buf); - - if (pbbreg->path >= MAX_RF_PATH_NUMS) - return NDIS_STATUS_NOT_ACCEPTED; - if (pbbreg->offset > 0xFF) - return NDIS_STATUS_NOT_ACCEPTED; - - path = (u8)pbbreg->path; - offset = (u8)pbbreg->offset; - - _irqlevel_changed_(&oldirql, LOWER); - value = read_rfreg(Adapter, path, offset); - _irqlevel_changed_(&oldirql, RAISE); - - pbbreg->value = value; - - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - - - - return status; -} -/* **************** oid_rtl_seg_81_87_00 section end**************** - * ------------------------------------------------------------------------------ */ - -/* **************** oid_rtl_seg_81_80_00 section start **************** - * ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_set_data_rate_hdl(struct oid_par_priv *poid_par_priv) -{ -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - u32 ratevalue;/* 4 */ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - - - if (poid_par_priv->type_of_oid != SET_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - if (poid_par_priv->information_buf_len != sizeof(u32)) - return NDIS_STATUS_INVALID_LENGTH; - - ratevalue = *((u32 *)poid_par_priv->information_buf); /* 4 */ - if (ratevalue >= MPT_RATE_LAST) - return NDIS_STATUS_INVALID_DATA; - - Adapter->mppriv.rateidx = ratevalue; - - _irqlevel_changed_(&oldirql, LOWER); - SetDataRate(Adapter); - _irqlevel_changed_(&oldirql, RAISE); - - - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_start_test_hdl(struct oid_par_priv *poid_par_priv) -{ -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - u32 mode; - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - - - if (Adapter->registrypriv.mp_mode == 0) - return NDIS_STATUS_NOT_ACCEPTED; - - if (poid_par_priv->type_of_oid != SET_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - _irqlevel_changed_(&oldirql, LOWER); - - /* IQCalibrateBcut(Adapter); */ - - mode = *((u32 *)poid_par_priv->information_buf); - Adapter->mppriv.mode = mode;/* 1 for loopback */ - - if (mp_start_test(Adapter) == _FAIL) { - status = NDIS_STATUS_NOT_ACCEPTED; - goto exit; - } - -exit: - _irqlevel_changed_(&oldirql, RAISE); - - - - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_stop_test_hdl(struct oid_par_priv *poid_par_priv) -{ -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - - - if (poid_par_priv->type_of_oid != SET_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - _irqlevel_changed_(&oldirql, LOWER); - mp_stop_test(Adapter); - _irqlevel_changed_(&oldirql, RAISE); - - - - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_set_channel_direct_call_hdl(struct oid_par_priv *poid_par_priv) -{ -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - u32 Channel; - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - - - if (poid_par_priv->information_buf_len != sizeof(u32)) - return NDIS_STATUS_INVALID_LENGTH; - - if (poid_par_priv->type_of_oid == QUERY_OID) { - *((u32 *)poid_par_priv->information_buf) = Adapter->mppriv.channel; - return NDIS_STATUS_SUCCESS; - } - - if (poid_par_priv->type_of_oid != SET_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - Channel = *((u32 *)poid_par_priv->information_buf); - if (Channel > 14) - return NDIS_STATUS_NOT_ACCEPTED; - Adapter->mppriv.channel = Channel; - - _irqlevel_changed_(&oldirql, LOWER); - SetChannel(Adapter); - _irqlevel_changed_(&oldirql, RAISE); - - - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_set_bandwidth_hdl(struct oid_par_priv *poid_par_priv) -{ -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - u16 bandwidth; - u16 channel_offset; - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - - - if (poid_par_priv->type_of_oid != SET_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - if (poid_par_priv->information_buf_len < sizeof(u32)) - return NDIS_STATUS_INVALID_LENGTH; - - bandwidth = *((u32 *)poid_par_priv->information_buf); /* 4 */ - channel_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; - - if (bandwidth != CHANNEL_WIDTH_40) - bandwidth = CHANNEL_WIDTH_20; - padapter->mppriv.bandwidth = (u8)bandwidth; - padapter->mppriv.prime_channel_offset = (u8)channel_offset; - - _irqlevel_changed_(&oldirql, LOWER); - SetBandwidth(padapter); - _irqlevel_changed_(&oldirql, RAISE); - - - - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_set_antenna_bb_hdl(struct oid_par_priv *poid_par_priv) -{ -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - u32 antenna; - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - - - if (poid_par_priv->information_buf_len != sizeof(u32)) - return NDIS_STATUS_INVALID_LENGTH; - - if (poid_par_priv->type_of_oid == SET_OID) { - antenna = *(u32 *)poid_par_priv->information_buf; - - Adapter->mppriv.antenna_tx = (u16)((antenna & 0xFFFF0000) >> 16); - Adapter->mppriv.antenna_rx = (u16)(antenna & 0x0000FFFF); - - _irqlevel_changed_(&oldirql, LOWER); - SetAntenna(Adapter); - _irqlevel_changed_(&oldirql, RAISE); - } else { - antenna = (Adapter->mppriv.antenna_tx << 16) | Adapter->mppriv.antenna_rx; - *(u32 *)poid_par_priv->information_buf = antenna; - } - - - return status; -} - -NDIS_STATUS oid_rt_pro_set_tx_power_control_hdl(struct oid_par_priv *poid_par_priv) -{ -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - u32 tx_pwr_idx; - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - - - if (poid_par_priv->type_of_oid != SET_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - if (poid_par_priv->information_buf_len != sizeof(u32)) - return NDIS_STATUS_INVALID_LENGTH; - - tx_pwr_idx = *((u32 *)poid_par_priv->information_buf); - if (tx_pwr_idx > MAX_TX_PWR_INDEX_N_MODE) - return NDIS_STATUS_NOT_ACCEPTED; - - Adapter->mppriv.txpoweridx = (u8)tx_pwr_idx; - - - _irqlevel_changed_(&oldirql, LOWER); - SetTxPower(Adapter); - _irqlevel_changed_(&oldirql, RAISE); - - - return status; -} - -/* ------------------------------------------------------------------------------ - * **************** oid_rtl_seg_81_80_20 section start **************** - * ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_query_tx_packet_sent_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - - if (poid_par_priv->type_of_oid != QUERY_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - - if (poid_par_priv->information_buf_len == sizeof(ULONG)) { - *(ULONG *)poid_par_priv->information_buf = Adapter->mppriv.tx_pktcount; - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - } else - status = NDIS_STATUS_INVALID_LENGTH; - - - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_query_rx_packet_received_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - - if (poid_par_priv->type_of_oid != QUERY_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - if (poid_par_priv->information_buf_len == sizeof(ULONG)) { - *(ULONG *)poid_par_priv->information_buf = Adapter->mppriv.rx_pktcount; - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - } else - status = NDIS_STATUS_INVALID_LENGTH; - - - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_query_rx_packet_crc32_error_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - - if (poid_par_priv->type_of_oid != QUERY_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - if (poid_par_priv->information_buf_len == sizeof(ULONG)) { - *(ULONG *)poid_par_priv->information_buf = Adapter->mppriv.rx_crcerrpktcount; - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - } else - status = NDIS_STATUS_INVALID_LENGTH; - - - return status; -} -/* ------------------------------------------------------------------------------ */ - -NDIS_STATUS oid_rt_pro_reset_tx_packet_sent_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - - if (poid_par_priv->type_of_oid != SET_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - - Adapter->mppriv.tx_pktcount = 0; - - - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_reset_rx_packet_received_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - - if (poid_par_priv->type_of_oid != SET_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - - if (poid_par_priv->information_buf_len == sizeof(ULONG)) { - Adapter->mppriv.rx_pktcount = 0; - Adapter->mppriv.rx_crcerrpktcount = 0; - } else - status = NDIS_STATUS_INVALID_LENGTH; - - - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_reset_phy_rx_packet_count_hdl(struct oid_par_priv *poid_par_priv) -{ -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - - if (poid_par_priv->type_of_oid != SET_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - - _irqlevel_changed_(&oldirql, LOWER); - ResetPhyRxPktCount(Adapter); - _irqlevel_changed_(&oldirql, RAISE); - - - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_get_phy_rx_packet_received_hdl(struct oid_par_priv *poid_par_priv) -{ -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - - - if (poid_par_priv->type_of_oid != QUERY_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - if (poid_par_priv->information_buf_len != sizeof(ULONG)) - return NDIS_STATUS_INVALID_LENGTH; - - _irqlevel_changed_(&oldirql, LOWER); - *(ULONG *)poid_par_priv->information_buf = GetPhyRxPktReceived(Adapter); - _irqlevel_changed_(&oldirql, RAISE); - - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - - - - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_get_phy_rx_packet_crc32_error_hdl(struct oid_par_priv *poid_par_priv) -{ -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - - - if (poid_par_priv->type_of_oid != QUERY_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - - if (poid_par_priv->information_buf_len != sizeof(ULONG)) - return NDIS_STATUS_INVALID_LENGTH; - - _irqlevel_changed_(&oldirql, LOWER); - *(ULONG *)poid_par_priv->information_buf = GetPhyRxPktCRC32Error(Adapter); - _irqlevel_changed_(&oldirql, RAISE); - - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - - - - return status; -} -/* **************** oid_rtl_seg_81_80_20 section end **************** */ -NDIS_STATUS oid_rt_pro_set_continuous_tx_hdl(struct oid_par_priv *poid_par_priv) -{ -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - u32 bStartTest; - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - - - if (poid_par_priv->type_of_oid != SET_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - bStartTest = *((u32 *)poid_par_priv->information_buf); - - _irqlevel_changed_(&oldirql, LOWER); - SetContinuousTx(Adapter, (u8)bStartTest); - if (bStartTest) { - struct mp_priv *pmp_priv = &Adapter->mppriv; - if (pmp_priv->tx.stop == 0) { - pmp_priv->tx.stop = 1; - RTW_INFO("%s: pkt tx is running...\n", __func__); - rtw_msleep_os(5); - } - pmp_priv->tx.stop = 0; - pmp_priv->tx.count = 1; - SetPacketTx(Adapter); - } - _irqlevel_changed_(&oldirql, RAISE); - - - return status; -} - -NDIS_STATUS oid_rt_pro_set_single_carrier_tx_hdl(struct oid_par_priv *poid_par_priv) -{ -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - u32 bStartTest; - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - - - if (poid_par_priv->type_of_oid != SET_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - bStartTest = *((u32 *)poid_par_priv->information_buf); - - _irqlevel_changed_(&oldirql, LOWER); - SetSingleCarrierTx(Adapter, (u8)bStartTest); - if (bStartTest) { - struct mp_priv *pmp_priv = &Adapter->mppriv; - if (pmp_priv->tx.stop == 0) { - pmp_priv->tx.stop = 1; - RTW_INFO("%s: pkt tx is running...\n", __func__); - rtw_msleep_os(5); - } - pmp_priv->tx.stop = 0; - pmp_priv->tx.count = 1; - SetPacketTx(Adapter); - } - _irqlevel_changed_(&oldirql, RAISE); - - - return status; -} - -NDIS_STATUS oid_rt_pro_set_carrier_suppression_tx_hdl(struct oid_par_priv *poid_par_priv) -{ -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - u32 bStartTest; - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - - - if (poid_par_priv->type_of_oid != SET_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - bStartTest = *((u32 *)poid_par_priv->information_buf); - - _irqlevel_changed_(&oldirql, LOWER); - SetCarrierSuppressionTx(Adapter, (u8)bStartTest); - if (bStartTest) { - struct mp_priv *pmp_priv = &Adapter->mppriv; - if (pmp_priv->tx.stop == 0) { - pmp_priv->tx.stop = 1; - RTW_INFO("%s: pkt tx is running...\n", __func__); - rtw_msleep_os(5); - } - pmp_priv->tx.stop = 0; - pmp_priv->tx.count = 1; - SetPacketTx(Adapter); - } - _irqlevel_changed_(&oldirql, RAISE); - - - return status; -} - -NDIS_STATUS oid_rt_pro_set_single_tone_tx_hdl(struct oid_par_priv *poid_par_priv) -{ -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - u32 bStartTest; - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - - - if (poid_par_priv->type_of_oid != SET_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - bStartTest = *((u32 *)poid_par_priv->information_buf); - - _irqlevel_changed_(&oldirql, LOWER); - SetSingleToneTx(Adapter, (u8)bStartTest); - _irqlevel_changed_(&oldirql, RAISE); - - - return status; -} - -NDIS_STATUS oid_rt_pro_set_modulation_hdl(struct oid_par_priv *poid_par_priv) -{ - return 0; -} - -NDIS_STATUS oid_rt_pro_trigger_gpio_hdl(struct oid_par_priv *poid_par_priv) -{ - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - - if (poid_par_priv->type_of_oid != SET_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - _irqlevel_changed_(&oldirql, LOWER); - rtw_hal_set_hwreg(Adapter, HW_VAR_TRIGGER_GPIO_0, 0); - _irqlevel_changed_(&oldirql, RAISE); - - - return status; -} -/* **************** oid_rtl_seg_81_80_00 section end **************** - * ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro8711_join_bss_hdl(struct oid_par_priv *poid_par_priv) -{ -#if 0 - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - - PNDIS_802_11_SSID pssid; - - - if (poid_par_priv->type_of_oid != SET_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - *poid_par_priv->bytes_needed = (u32)sizeof(NDIS_802_11_SSID); - *poid_par_priv->bytes_rw = 0; - if (poid_par_priv->information_buf_len < *poid_par_priv->bytes_needed) - return NDIS_STATUS_INVALID_LENGTH; - - pssid = (PNDIS_802_11_SSID)poid_par_priv->information_buf; - - _irqlevel_changed_(&oldirql, LOWER); - - if (mp_start_joinbss(Adapter, pssid) == _FAIL) - status = NDIS_STATUS_NOT_ACCEPTED; - - _irqlevel_changed_(&oldirql, RAISE); - - *poid_par_priv->bytes_rw = sizeof(NDIS_802_11_SSID); - - - return status; -#else - return 0; -#endif -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_read_register_hdl(struct oid_par_priv *poid_par_priv) -{ -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - pRW_Reg RegRWStruct; - u32 offset, width; - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - - - if (poid_par_priv->type_of_oid != QUERY_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - RegRWStruct = (pRW_Reg)poid_par_priv->information_buf; - offset = RegRWStruct->offset; - width = RegRWStruct->width; - - if (offset > 0xFFF) - return NDIS_STATUS_NOT_ACCEPTED; - - _irqlevel_changed_(&oldirql, LOWER); - - switch (width) { - case 1: - RegRWStruct->value = rtw_read8(Adapter, offset); - break; - case 2: - RegRWStruct->value = rtw_read16(Adapter, offset); - break; - default: - width = 4; - RegRWStruct->value = rtw_read32(Adapter, offset); - break; - } - - _irqlevel_changed_(&oldirql, RAISE); - - *poid_par_priv->bytes_rw = width; - - - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_write_register_hdl(struct oid_par_priv *poid_par_priv) -{ -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - pRW_Reg RegRWStruct; - u32 offset, width, value; - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - - - if (poid_par_priv->type_of_oid != SET_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - RegRWStruct = (pRW_Reg)poid_par_priv->information_buf; - offset = RegRWStruct->offset; - width = RegRWStruct->width; - value = RegRWStruct->value; - - if (offset > 0xFFF) - return NDIS_STATUS_NOT_ACCEPTED; - - _irqlevel_changed_(&oldirql, LOWER); - - switch (RegRWStruct->width) { - case 1: - if (value > 0xFF) { - status = NDIS_STATUS_NOT_ACCEPTED; - break; - } - rtw_write8(padapter, offset, (u8)value); - break; - case 2: - if (value > 0xFFFF) { - status = NDIS_STATUS_NOT_ACCEPTED; - break; - } - rtw_write16(padapter, offset, (u16)value); - break; - case 4: - rtw_write32(padapter, offset, value); - break; - default: - status = NDIS_STATUS_NOT_ACCEPTED; - break; - } - - _irqlevel_changed_(&oldirql, RAISE); - - - - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_burst_read_register_hdl(struct oid_par_priv *poid_par_priv) -{ -#if 0 -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - pBurst_RW_Reg pBstRwReg; - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - - - if (poid_par_priv->type_of_oid != QUERY_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - pBstRwReg = (pBurst_RW_Reg)poid_par_priv->information_buf; - - _irqlevel_changed_(&oldirql, LOWER); - rtw_read_mem(padapter, pBstRwReg->offset, (u32)pBstRwReg->len, pBstRwReg->Data); - _irqlevel_changed_(&oldirql, RAISE); - - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - - - - return status; -#else - return 0; -#endif -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_burst_write_register_hdl(struct oid_par_priv *poid_par_priv) -{ -#if 0 -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - pBurst_RW_Reg pBstRwReg; - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - - - if (poid_par_priv->type_of_oid != SET_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - pBstRwReg = (pBurst_RW_Reg)poid_par_priv->information_buf; - - _irqlevel_changed_(&oldirql, LOWER); - rtw_write_mem(padapter, pBstRwReg->offset, (u32)pBstRwReg->len, pBstRwReg->Data); - _irqlevel_changed_(&oldirql, RAISE); - - - - return status; -#else - return 0; -#endif -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_write_txcmd_hdl(struct oid_par_priv *poid_par_priv) -{ -#if 0 - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - - TX_CMD_Desc *TxCmd_Info; - - - if (poid_par_priv->type_of_oid != SET_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - - TxCmd_Info = (TX_CMD_Desc *)poid_par_priv->information_buf; - - - _irqlevel_changed_(&oldirql, LOWER); - - rtw_write32(Adapter, TxCmd_Info->offset + 0, (unsigned int)TxCmd_Info->TxCMD.value[0]); - rtw_write32(Adapter, TxCmd_Info->offset + 4, (unsigned int)TxCmd_Info->TxCMD.value[1]); - - _irqlevel_changed_(&oldirql, RAISE); - - - - return status; -#else - return 0; -#endif -} - -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_read16_eeprom_hdl(struct oid_par_priv *poid_par_priv) -{ -#if 0 -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - pEEPROM_RWParam pEEPROM; - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - - - if (poid_par_priv->type_of_oid != QUERY_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - pEEPROM = (pEEPROM_RWParam)poid_par_priv->information_buf; - - _irqlevel_changed_(&oldirql, LOWER); - pEEPROM->value = eeprom_read16(padapter, (u16)(pEEPROM->offset >> 1)); - _irqlevel_changed_(&oldirql, RAISE); - - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - - - - return status; -#else - return 0; -#endif -} - -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_write16_eeprom_hdl(struct oid_par_priv *poid_par_priv) -{ -#if 0 -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - pEEPROM_RWParam pEEPROM; - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - - - if (poid_par_priv->type_of_oid != SET_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - pEEPROM = (pEEPROM_RWParam)poid_par_priv->information_buf; - - _irqlevel_changed_(&oldirql, LOWER); - eeprom_write16(padapter, (u16)(pEEPROM->offset >> 1), pEEPROM->value); - _irqlevel_changed_(&oldirql, RAISE); - - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - - - return status; -#else - return 0; -#endif -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro8711_wi_poll_hdl(struct oid_par_priv *poid_par_priv) -{ -#if 0 - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - - struct mp_wiparam *pwi_param; - - - if (poid_par_priv->type_of_oid != QUERY_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - if (poid_par_priv->information_buf_len < sizeof(struct mp_wiparam)) - return NDIS_STATUS_INVALID_LENGTH; - - if (Adapter->mppriv.workparam.bcompleted == _FALSE) - return NDIS_STATUS_NOT_ACCEPTED; - - pwi_param = (struct mp_wiparam *)poid_par_priv->information_buf; - - _rtw_memcpy(pwi_param, &Adapter->mppriv.workparam, sizeof(struct mp_wiparam)); - Adapter->mppriv.act_in_progress = _FALSE; - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - - - return status; -#else - return 0; -#endif -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro8711_pkt_loss_hdl(struct oid_par_priv *poid_par_priv) -{ -#if 0 - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - - - - if (poid_par_priv->type_of_oid != QUERY_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - if (poid_par_priv->information_buf_len < sizeof(uint) * 2) { - return NDIS_STATUS_INVALID_LENGTH; - } - - if (*(uint *)poid_par_priv->information_buf == 1) /* init==1 */ - Adapter->mppriv.rx_pktloss = 0; - - *((uint *)poid_par_priv->information_buf + 1) = Adapter->mppriv.rx_pktloss; - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - - - return status; -#else - return 0; -#endif -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_rd_attrib_mem_hdl(struct oid_par_priv *poid_par_priv) -{ -#if 0 - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - struct io_queue *pio_queue = (struct io_queue *)Adapter->pio_queue; - struct intf_hdl *pintfhdl = &pio_queue->intf; - -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - -#ifdef CONFIG_SDIO_HCI - void (*_attrib_read)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); -#endif - - - - if (poid_par_priv->type_of_oid != QUERY_OID) - return NDIS_STATUS_NOT_ACCEPTED; - -#ifdef CONFIG_SDIO_HCI - _irqlevel_changed_(&oldirql, LOWER); - { - u32 *plmem = (u32 *)poid_par_priv->information_buf + 2; - _attrib_read = pintfhdl->io_ops._attrib_read; - _attrib_read(pintfhdl, *((u32 *)poid_par_priv->information_buf), - *((u32 *)poid_par_priv->information_buf + 1), (u8 *)plmem); - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - } - _irqlevel_changed_(&oldirql, RAISE); -#endif - - - return status; -#else - return 0; -#endif -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_wr_attrib_mem_hdl(struct oid_par_priv *poid_par_priv) -{ -#if 0 - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - struct io_queue *pio_queue = (struct io_queue *)Adapter->pio_queue; - struct intf_hdl *pintfhdl = &pio_queue->intf; - -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - -#ifdef CONFIG_SDIO_HCI - void (*_attrib_write)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem); -#endif - - - if (poid_par_priv->type_of_oid != SET_OID) - return NDIS_STATUS_NOT_ACCEPTED; - -#ifdef CONFIG_SDIO_HCI - _irqlevel_changed_(&oldirql, LOWER); - { - u32 *plmem = (u32 *)poid_par_priv->information_buf + 2; - _attrib_write = pintfhdl->io_ops._attrib_write; - _attrib_write(pintfhdl, *(u32 *)poid_par_priv->information_buf, - *((u32 *)poid_par_priv->information_buf + 1), (u8 *)plmem); - } - _irqlevel_changed_(&oldirql, RAISE); -#endif - - - return status; -#else - return 0; -#endif -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_set_rf_intfs_hdl(struct oid_par_priv *poid_par_priv) -{ -#if 0 - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - - - - if (poid_par_priv->type_of_oid != SET_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - _irqlevel_changed_(&oldirql, LOWER); - - if (rtw_setrfintfs_cmd(Adapter, *(unsigned char *)poid_par_priv->information_buf) == _FAIL) - status = NDIS_STATUS_NOT_ACCEPTED; - - _irqlevel_changed_(&oldirql, RAISE); - - - return status; -#else - return 0; -#endif -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_poll_rx_status_hdl(struct oid_par_priv *poid_par_priv) -{ -#if 0 - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - - - if (poid_par_priv->type_of_oid != QUERY_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - _rtw_memcpy(poid_par_priv->information_buf, (unsigned char *)&Adapter->mppriv.rxstat, sizeof(struct recv_stat)); - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - - - return status; -#else - return 0; -#endif -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_cfg_debug_message_hdl(struct oid_par_priv *poid_par_priv) -{ -#if 0 - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - - PCFG_DBG_MSG_STRUCT pdbg_msg; - - - -#if 0/*#ifdef CONFIG_DEBUG_RTL871X*/ - - pdbg_msg = (PCFG_DBG_MSG_STRUCT)(poid_par_priv->information_buf); - - if (poid_par_priv->type_of_oid == SET_OID) { - - GlobalDebugLevel = pdbg_msg->DebugLevel; - GlobalDebugComponents = (pdbg_msg->DebugComponent_H32 << 32) | pdbg_msg->DebugComponent_L32; - } else { - pdbg_msg->DebugLevel = GlobalDebugLevel; - pdbg_msg->DebugComponent_H32 = (u32)(GlobalDebugComponents >> 32); - pdbg_msg->DebugComponent_L32 = (u32)GlobalDebugComponents; - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - - } - -#endif - - - return status; -#else - return 0; -#endif -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_set_data_rate_ex_hdl(struct oid_par_priv *poid_par_priv) -{ - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - - - - if (poid_par_priv->type_of_oid != SET_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - _irqlevel_changed_(&oldirql, LOWER); - - if (rtw_setdatarate_cmd(Adapter, poid_par_priv->information_buf) != _SUCCESS) - status = NDIS_STATUS_NOT_ACCEPTED; - - _irqlevel_changed_(&oldirql, RAISE); - - - return status; -} -/* ----------------------------------------------------------------------------- */ -NDIS_STATUS oid_rt_get_thermal_meter_hdl(struct oid_par_priv *poid_par_priv) -{ -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - u8 thermal = 0; - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - - - if (poid_par_priv->type_of_oid != QUERY_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - if (poid_par_priv->information_buf_len < sizeof(u32)) - return NDIS_STATUS_INVALID_LENGTH; - - _irqlevel_changed_(&oldirql, LOWER); - GetThermalMeter(Adapter, &thermal); - _irqlevel_changed_(&oldirql, RAISE); - - *(u32 *)poid_par_priv->information_buf = (u32)thermal; - *poid_par_priv->bytes_rw = sizeof(u32); - - - return status; -} -/* ----------------------------------------------------------------------------- */ -NDIS_STATUS oid_rt_pro_read_tssi_hdl(struct oid_par_priv *poid_par_priv) -{ -#if 0 - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - - - - if (poid_par_priv->type_of_oid != SET_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - if (Adapter->mppriv.act_in_progress == _TRUE) - return NDIS_STATUS_NOT_ACCEPTED; - - if (poid_par_priv->information_buf_len < sizeof(u8)) - return NDIS_STATUS_INVALID_LENGTH; - - /* init workparam */ - Adapter->mppriv.act_in_progress = _TRUE; - Adapter->mppriv.workparam.bcompleted = _FALSE; - Adapter->mppriv.workparam.act_type = MPT_READ_TSSI; - Adapter->mppriv.workparam.io_offset = 0; - Adapter->mppriv.workparam.io_value = 0xFFFFFFFF; - - _irqlevel_changed_(&oldirql, LOWER); - - if (!rtw_gettssi_cmd(Adapter, 0, (u8 *)&Adapter->mppriv.workparam.io_value)) - status = NDIS_STATUS_NOT_ACCEPTED; - - _irqlevel_changed_(&oldirql, RAISE); - - - return status; -#else - return 0; -#endif -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_set_power_tracking_hdl(struct oid_par_priv *poid_par_priv) -{ -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - - - /* if (poid_par_priv->type_of_oid != SET_OID) - * return NDIS_STATUS_NOT_ACCEPTED; */ - - if (poid_par_priv->information_buf_len < sizeof(u8)) - return NDIS_STATUS_INVALID_LENGTH; - - _irqlevel_changed_(&oldirql, LOWER); - if (poid_par_priv->type_of_oid == SET_OID) { - u8 enable; - - enable = *(u8 *)poid_par_priv->information_buf; - - SetPowerTracking(Adapter, enable); - } else - GetPowerTracking(Adapter, (u8 *)poid_par_priv->information_buf); - _irqlevel_changed_(&oldirql, RAISE); - - - return status; -} -/* ----------------------------------------------------------------------------- */ -NDIS_STATUS oid_rt_pro_set_basic_rate_hdl(struct oid_par_priv *poid_par_priv) -{ -#if 0 -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - u32 ratevalue; - u8 datarates[NumRates]; - int i; - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); - - - - if (poid_par_priv->type_of_oid != SET_OID) - return NDIS_STATUS_NOT_ACCEPTED; -#if 0 - ratevalue = *((u32 *)poid_par_priv->information_buf); - - for (i = 0; i < NumRates; i++) { - if (ratevalue == mpdatarate[i]) - datarates[i] = mpdatarate[i]; - else - datarates[i] = 0xff; - } - - _irqlevel_changed_(&oldirql, LOWER); - - if (rtw_setbasicrate_cmd(padapter, datarates) != _SUCCESS) - status = NDIS_STATUS_NOT_ACCEPTED; - - _irqlevel_changed_(&oldirql, RAISE); -#endif - - - return status; -#else - return 0; -#endif -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_qry_pwrstate_hdl(struct oid_par_priv *poid_par_priv) -{ -#if 0 - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - - - if (poid_par_priv->type_of_oid != QUERY_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - if (poid_par_priv->information_buf_len < 8) - return NDIS_STATUS_INVALID_LENGTH; - - *poid_par_priv->bytes_rw = 8; - _rtw_memcpy(poid_par_priv->information_buf, &(adapter_to_pwrctl(Adapter)->pwr_mode), 8); - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - - - - return status; -#else - return 0; -#endif -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_set_pwrstate_hdl(struct oid_par_priv *poid_par_priv) -{ -#if 0 - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - - uint pwr_mode, smart_ps; - - - - if (poid_par_priv->type_of_oid != SET_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - *poid_par_priv->bytes_rw = 0; - *poid_par_priv->bytes_needed = 8; - - if (poid_par_priv->information_buf_len < 8) - return NDIS_STATUS_INVALID_LENGTH; - - pwr_mode = *(uint *)(poid_par_priv->information_buf); - smart_ps = *(uint *)((int)poid_par_priv->information_buf + 4); - - *poid_par_priv->bytes_rw = 8; - - - return status; -#else - return 0; -#endif -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_h2c_set_rate_table_hdl(struct oid_par_priv *poid_par_priv) -{ -#if 0 - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - - struct setratable_parm *prate_table; - u8 res; - - - if (poid_par_priv->type_of_oid != SET_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - *poid_par_priv->bytes_needed = sizeof(struct setratable_parm); - if (poid_par_priv->information_buf_len < sizeof(struct setratable_parm)) - return NDIS_STATUS_INVALID_LENGTH; - - prate_table = (struct setratable_parm *)poid_par_priv->information_buf; - - _irqlevel_changed_(&oldirql, LOWER); - res = rtw_setrttbl_cmd(Adapter, prate_table); - _irqlevel_changed_(&oldirql, RAISE); - - if (res == _FAIL) - status = NDIS_STATUS_FAILURE; - - - return status; -#else - return 0; -#endif -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_h2c_get_rate_table_hdl(struct oid_par_priv *poid_par_priv) -{ -#if 0 - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - - - if (poid_par_priv->type_of_oid != QUERY_OID) - return NDIS_STATUS_NOT_ACCEPTED; - -#if 0 - struct mp_wi_cntx *pmp_wi_cntx = &(Adapter->mppriv.wi_cntx); - u8 res = _SUCCESS; - DEBUG_INFO(("===> Set OID_RT_PRO_H2C_GET_RATE_TABLE.\n")); - - if (pmp_wi_cntx->bmp_wi_progress == _TRUE) { - DEBUG_ERR(("\n mp workitem is progressing, not allow to set another workitem right now!!!\n")); - Status = NDIS_STATUS_NOT_ACCEPTED; - break; - } else { - pmp_wi_cntx->bmp_wi_progress = _TRUE; - pmp_wi_cntx->param.bcompleted = _FALSE; - pmp_wi_cntx->param.act_type = MPT_GET_RATE_TABLE; - pmp_wi_cntx->param.io_offset = 0x0; - pmp_wi_cntx->param.bytes_cnt = sizeof(struct getratable_rsp); - pmp_wi_cntx->param.io_value = 0xffffffff; - - res = rtw_getrttbl_cmd(Adapter, (struct getratable_rsp *)pmp_wi_cntx->param.data); - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - if (res != _SUCCESS) - Status = NDIS_STATUS_NOT_ACCEPTED; - } - DEBUG_INFO(("\n <=== Set OID_RT_PRO_H2C_GET_RATE_TABLE.\n")); -#endif - - - return status; -#else - return 0; -#endif -} - -/* **************** oid_rtl_seg_87_12_00 section start **************** */ -NDIS_STATUS oid_rt_pro_encryption_ctrl_hdl(struct oid_par_priv *poid_par_priv) -{ -#if 0 - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - struct security_priv *psecuritypriv = &Adapter->securitypriv; - - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - - ENCRY_CTRL_STATE encry_mode; - - - *poid_par_priv->bytes_needed = sizeof(u8); - if (poid_par_priv->information_buf_len < *poid_par_priv->bytes_needed) - return NDIS_STATUS_INVALID_LENGTH; - - if (poid_par_priv->type_of_oid == SET_OID) { - encry_mode = *((u8 *)poid_par_priv->information_buf); - switch (encry_mode) { - case HW_CONTROL: -#if 0 - Adapter->registrypriv.software_decrypt = _FALSE; - Adapter->registrypriv.software_encrypt = _FALSE; -#else - psecuritypriv->sw_decrypt = _FALSE; - psecuritypriv->sw_encrypt = _FALSE; -#endif - break; - case SW_CONTROL: -#if 0 - Adapter->registrypriv.software_decrypt = _TRUE; - Adapter->registrypriv.software_encrypt = _TRUE; -#else - psecuritypriv->sw_decrypt = _TRUE; - psecuritypriv->sw_encrypt = _TRUE; -#endif - break; - case HW_ENCRY_SW_DECRY: -#if 0 - Adapter->registrypriv.software_decrypt = _TRUE; - Adapter->registrypriv.software_encrypt = _FALSE; -#else - psecuritypriv->sw_decrypt = _TRUE; - psecuritypriv->sw_encrypt = _FALSE; -#endif - break; - case SW_ENCRY_HW_DECRY: -#if 0 - Adapter->registrypriv.software_decrypt = _FALSE; - Adapter->registrypriv.software_encrypt = _TRUE; -#else - psecuritypriv->sw_decrypt = _FALSE; - psecuritypriv->sw_encrypt = _TRUE; -#endif - break; - } - - } else { -#if 0 - if (Adapter->registrypriv.software_encrypt == _FALSE) { - if (Adapter->registrypriv.software_decrypt == _FALSE) - encry_mode = HW_CONTROL; - else - encry_mode = HW_ENCRY_SW_DECRY; - } else { - if (Adapter->registrypriv.software_decrypt == _FALSE) - encry_mode = SW_ENCRY_HW_DECRY; - else - encry_mode = SW_CONTROL; - } -#else - - if ((psecuritypriv->sw_encrypt == _FALSE) && (psecuritypriv->sw_decrypt == _FALSE)) - encry_mode = HW_CONTROL; - else if ((psecuritypriv->sw_encrypt == _FALSE) && (psecuritypriv->sw_decrypt == _TRUE)) - encry_mode = HW_ENCRY_SW_DECRY; - else if ((psecuritypriv->sw_encrypt == _TRUE) && (psecuritypriv->sw_decrypt == _FALSE)) - encry_mode = SW_ENCRY_HW_DECRY; - else if ((psecuritypriv->sw_encrypt == _TRUE) && (psecuritypriv->sw_decrypt == _TRUE)) - encry_mode = SW_CONTROL; - -#endif - - *(u8 *)poid_par_priv->information_buf = encry_mode; - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - - } - - return status; -#else - return 0; -#endif -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_add_sta_info_hdl(struct oid_par_priv *poid_par_priv) -{ -#if 0 - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - - struct sta_info *psta = NULL; - UCHAR *macaddr; - - - if (poid_par_priv->type_of_oid != SET_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - *poid_par_priv->bytes_needed = ETH_ALEN; - if (poid_par_priv->information_buf_len < *poid_par_priv->bytes_needed) - return NDIS_STATUS_INVALID_LENGTH; - - macaddr = (UCHAR *) poid_par_priv->information_buf ; - - - _irqlevel_changed_(&oldirql, LOWER); - - psta = rtw_get_stainfo(&Adapter->stapriv, macaddr); - - if (psta == NULL) { /* the sta have been in sta_info_queue => do nothing */ - psta = rtw_alloc_stainfo(&Adapter->stapriv, macaddr); - - if (psta == NULL) { - status = NDIS_STATUS_FAILURE; - } - } - - _irqlevel_changed_(&oldirql, RAISE); - - return status; -#else - return 0; -#endif -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_dele_sta_info_hdl(struct oid_par_priv *poid_par_priv) -{ -#if 0 - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - - struct sta_info *psta = NULL; - UCHAR *macaddr; - - - if (poid_par_priv->type_of_oid != SET_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - *poid_par_priv->bytes_needed = ETH_ALEN; - if (poid_par_priv->information_buf_len < *poid_par_priv->bytes_needed) - return NDIS_STATUS_INVALID_LENGTH; - - macaddr = (UCHAR *) poid_par_priv->information_buf ; - - psta = rtw_get_stainfo(&Adapter->stapriv, macaddr); - if (psta != NULL) { - /* _enter_critical(&(Adapter->stapriv.sta_hash_lock), &irqL); */ - rtw_free_stainfo(Adapter, psta); - /* _exit_critical(&(Adapter->stapriv.sta_hash_lock), &irqL); */ - } - - return status; -#else - return 0; -#endif -} -/* ------------------------------------------------------------------------------ */ -#if 0 -static u32 mp_query_drv_var(_adapter *padapter, u8 offset, u32 var) -{ -#ifdef CONFIG_SDIO_HCI - - if (offset == 1) { - u16 tmp_blk_num; - tmp_blk_num = rtw_read16(padapter, SDIO_RX0_RDYBLK_NUM); - if (adapter_to_dvobj(padapter)->rxblknum != tmp_blk_num) { - /* sd_recv_rxfifo(padapter); */ - } - } - -#if 0 - if (offset <= 100) { /* For setting data rate and query data rate */ - if (offset == 100) { /* For query data rate */ - var = padapter->registrypriv.tx_rate; - - } else if (offset < 0x1d) { /* For setting data rate */ - padapter->registrypriv.tx_rate = offset; - var = padapter->registrypriv.tx_rate; - padapter->registrypriv.use_rate = _TRUE; - } else { /* not use the data rate */ - padapter->registrypriv.use_rate = _FALSE; - } - } else if (offset <= 110) { /* for setting debug level */ - if (offset == 110) { /* For query data rate */ - padapter->registrypriv.dbg_level = GlobalDebugLevel; - var = padapter->registrypriv.dbg_level; - } else if (offset < 110 && offset > 100) { - padapter->registrypriv.dbg_level = GlobalDebugLevel = offset - 100; - var = padapter->registrypriv.dbg_level; - - } - } else if (offset > 110 && offset < 116) { - if (115 == offset) { - } else { - switch (offset) { - case 111: - adapter_to_dvobj(padapter)->tx_block_mode = 1; - adapter_to_dvobj(padapter)->rx_block_mode = 1; - break; - case 112: - adapter_to_dvobj(padapter)->tx_block_mode = 1; - adapter_to_dvobj(padapter)->rx_block_mode = 0; - break; - case 113: - adapter_to_dvobj(padapter)->tx_block_mode = 0; - adapter_to_dvobj(padapter)->rx_block_mode = 1; - break; - case 114: - adapter_to_dvobj(padapter)->tx_block_mode = 0; - adapter_to_dvobj(padapter)->rx_block_mode = 0; - break; - default: - break; - - } - - } - - } else if (offset >= 127) { - u64 prnt_dbg_comp; - u8 chg_idx; - u64 tmp_dbg_comp; - chg_idx = offset - 0x80; - tmp_dbg_comp = BIT(chg_idx); - prnt_dbg_comp = padapter->registrypriv.dbg_component = GlobalDebugComponents; - if (offset == 127) { - /* prnt_dbg_comp=padapter->registrypriv.dbg_component= GlobalDebugComponents; */ - var = (u32)(padapter->registrypriv.dbg_component); - prnt_dbg_comp = GlobalDebugComponents; - prnt_dbg_comp = GlobalDebugComponents = padapter->registrypriv.dbg_component; - - } else { - prnt_dbg_comp = GlobalDebugComponents; - prnt_dbg_comp = GlobalDebugComponents = padapter->registrypriv.dbg_component; - - if (GlobalDebugComponents & tmp_dbg_comp) { - /* this bit is already set, now clear it */ - GlobalDebugComponents = GlobalDebugComponents & (~tmp_dbg_comp); - } else { - /* this bit is not set, now set it. */ - GlobalDebugComponents = GlobalDebugComponents | tmp_dbg_comp; - } - prnt_dbg_comp = GlobalDebugComponents; - - var = (u32)(GlobalDebugComponents); - /* GlobalDebugComponents=padapter->registrypriv.dbg_component; */ - - } - } -#endif -#endif - - return var; -} -#endif - -NDIS_STATUS oid_rt_pro_query_dr_variable_hdl(struct oid_par_priv *poid_par_priv) -{ -#if 0 - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - - DR_VARIABLE_STRUCT *pdrv_var; - - - if (poid_par_priv->type_of_oid != QUERY_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - *poid_par_priv->bytes_needed = sizeof(DR_VARIABLE_STRUCT); - if (poid_par_priv->information_buf_len < *poid_par_priv->bytes_needed) - return NDIS_STATUS_INVALID_LENGTH; - - - pdrv_var = (struct _DR_VARIABLE_STRUCT_ *)poid_par_priv->information_buf; - - _irqlevel_changed_(&oldirql, LOWER); - pdrv_var->variable = mp_query_drv_var(Adapter, pdrv_var->offset, pdrv_var->variable); - _irqlevel_changed_(&oldirql, RAISE); - - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - - - return status; -#else - return 0; -#endif -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_rx_packet_type_hdl(struct oid_par_priv *poid_par_priv) -{ -#if 0 - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - - - if (poid_par_priv->information_buf_len < sizeof(UCHAR)) { - status = NDIS_STATUS_INVALID_LENGTH; - *poid_par_priv->bytes_needed = sizeof(UCHAR); - return status; - } - - if (poid_par_priv->type_of_oid == SET_OID) { - Adapter->mppriv.rx_with_status = *(UCHAR *) poid_par_priv->information_buf; - - - } else { - *(UCHAR *) poid_par_priv->information_buf = Adapter->mppriv.rx_with_status; - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - - - /* *(u32 *)&Adapter->eeprompriv.mac_addr[0]=rtw_read32(Adapter, 0x10250050); */ - /* *(u16 *)&Adapter->eeprompriv.mac_addr[4]=rtw_read16(Adapter, 0x10250054); */ - } -#endif - - return NDIS_STATUS_SUCCESS; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_read_efuse_hdl(struct oid_par_priv *poid_par_priv) -{ -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - PEFUSE_ACCESS_STRUCT pefuse; - u8 *data; - u16 addr = 0, cnts = 0, max_available_size = 0; - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - - if (poid_par_priv->type_of_oid != QUERY_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - if (poid_par_priv->information_buf_len < sizeof(EFUSE_ACCESS_STRUCT)) - return NDIS_STATUS_INVALID_LENGTH; - - pefuse = (PEFUSE_ACCESS_STRUCT)poid_par_priv->information_buf; - addr = pefuse->start_addr; - cnts = pefuse->cnts; - data = pefuse->data; - - - EFUSE_GetEfuseDefinition(Adapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_available_size, _FALSE); - - if ((addr + cnts) > max_available_size) { - return NDIS_STATUS_NOT_ACCEPTED; - } - - _irqlevel_changed_(&oldirql, LOWER); - if (rtw_efuse_access(Adapter, _FALSE, addr, cnts, data) == _FAIL) { - status = NDIS_STATUS_FAILURE; - } else - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - _irqlevel_changed_(&oldirql, RAISE); - - - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_write_efuse_hdl(struct oid_par_priv *poid_par_priv) -{ -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - PEFUSE_ACCESS_STRUCT pefuse; - u8 *data; - u16 addr = 0, cnts = 0, max_available_size = 0; - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - - - if (poid_par_priv->type_of_oid != SET_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - pefuse = (PEFUSE_ACCESS_STRUCT)poid_par_priv->information_buf; - addr = pefuse->start_addr; - cnts = pefuse->cnts; - data = pefuse->data; - - - EFUSE_GetEfuseDefinition(Adapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_available_size, _FALSE); - - if ((addr + cnts) > max_available_size) { - return NDIS_STATUS_NOT_ACCEPTED; - } - - _irqlevel_changed_(&oldirql, LOWER); - if (rtw_efuse_access(Adapter, _TRUE, addr, cnts, data) == _FAIL) - status = NDIS_STATUS_FAILURE; - _irqlevel_changed_(&oldirql, RAISE); - - - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_rw_efuse_pgpkt_hdl(struct oid_par_priv *poid_par_priv) -{ -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - PPGPKT_STRUCT ppgpkt; - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - - - *poid_par_priv->bytes_rw = 0; - - if (poid_par_priv->information_buf_len < sizeof(PGPKT_STRUCT)) - return NDIS_STATUS_INVALID_LENGTH; - - ppgpkt = (PPGPKT_STRUCT)poid_par_priv->information_buf; - - _irqlevel_changed_(&oldirql, LOWER); - - if (poid_par_priv->type_of_oid == QUERY_OID) { - - Efuse_PowerSwitch(Adapter, _FALSE, _TRUE); - if (Efuse_PgPacketRead(Adapter, ppgpkt->offset, ppgpkt->data, _FALSE) == _TRUE) - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - else - status = NDIS_STATUS_FAILURE; - Efuse_PowerSwitch(Adapter, _FALSE, _FALSE); - } else { - - Efuse_PowerSwitch(Adapter, _TRUE, _TRUE); - if (Efuse_PgPacketWrite(Adapter, ppgpkt->offset, ppgpkt->word_en, ppgpkt->data, _FALSE) == _TRUE) - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - else - status = NDIS_STATUS_FAILURE; - Efuse_PowerSwitch(Adapter, _TRUE, _FALSE); - } - - _irqlevel_changed_(&oldirql, RAISE); - - - - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_get_efuse_current_size_hdl(struct oid_par_priv *poid_par_priv) -{ -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - u16 size; - u8 ret; - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - - if (poid_par_priv->type_of_oid != QUERY_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - if (poid_par_priv->information_buf_len < sizeof(u32)) - return NDIS_STATUS_INVALID_LENGTH; - - _irqlevel_changed_(&oldirql, LOWER); - ret = efuse_GetCurrentSize(Adapter, &size); - _irqlevel_changed_(&oldirql, RAISE); - if (ret == _SUCCESS) { - *(u32 *)poid_par_priv->information_buf = size; - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - } else - status = NDIS_STATUS_FAILURE; - - - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_get_efuse_max_size_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - - if (poid_par_priv->type_of_oid != QUERY_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - if (poid_par_priv->information_buf_len < sizeof(u32)) - return NDIS_STATUS_INVALID_LENGTH; - - *(u32 *)poid_par_priv->information_buf = efuse_GetMaxSize(Adapter); - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - - - - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_efuse_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status; - - - - if (poid_par_priv->type_of_oid == QUERY_OID) - status = oid_rt_pro_read_efuse_hdl(poid_par_priv); - else - status = oid_rt_pro_write_efuse_hdl(poid_par_priv); - - - - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_pro_efuse_map_hdl(struct oid_par_priv *poid_par_priv) -{ -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - u8 *data; - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - u16 mapLen = 0; - - - - EFUSE_GetEfuseDefinition(Adapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, _FALSE); - - *poid_par_priv->bytes_rw = 0; - - if (poid_par_priv->information_buf_len < mapLen) - return NDIS_STATUS_INVALID_LENGTH; - - data = (u8 *)poid_par_priv->information_buf; - - _irqlevel_changed_(&oldirql, LOWER); - - if (poid_par_priv->type_of_oid == QUERY_OID) { - - if (rtw_efuse_map_read(Adapter, 0, mapLen, data) == _SUCCESS) - *poid_par_priv->bytes_rw = mapLen; - else { - status = NDIS_STATUS_FAILURE; - } - } else { - /* SET_OID */ - - if (rtw_efuse_map_write(Adapter, 0, mapLen, data) == _SUCCESS) - *poid_par_priv->bytes_rw = mapLen; - else { - status = NDIS_STATUS_FAILURE; - } - } - - _irqlevel_changed_(&oldirql, RAISE); - - - - return status; -} - -NDIS_STATUS oid_rt_set_crystal_cap_hdl(struct oid_par_priv *poid_par_priv) -{ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; -#if 0 - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - - u32 crystal_cap = 0; - - - if (poid_par_priv->type_of_oid != SET_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - if (poid_par_priv->information_buf_len < sizeof(u32)) - return NDIS_STATUS_INVALID_LENGTH; - - crystal_cap = *((u32 *)poid_par_priv->information_buf); /* 4 */ - if (crystal_cap > 0xf) - return NDIS_STATUS_NOT_ACCEPTED; - - Adapter->mppriv.curr_crystalcap = crystal_cap; - - _irqlevel_changed_(&oldirql, LOWER); - SetCrystalCap(Adapter); - _irqlevel_changed_(&oldirql, RAISE); - - -#endif - return status; -} - -NDIS_STATUS oid_rt_set_rx_packet_type_hdl(struct oid_par_priv *poid_par_priv) -{ -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - u8 rx_pkt_type; - /* u32 rcr_val32; */ - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - /* PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); */ - - - - if (poid_par_priv->type_of_oid != SET_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - if (poid_par_priv->information_buf_len < sizeof(u8)) - return NDIS_STATUS_INVALID_LENGTH; - - rx_pkt_type = *((u8 *)poid_par_priv->information_buf); /* 4 */ - -#if 0 - _irqlevel_changed_(&oldirql, LOWER); -#if 0 - rcr_val8 = rtw_read8(Adapter, 0x10250048);/* RCR */ - rcr_val8 &= ~(RCR_AB | RCR_AM | RCR_APM | RCR_AAP); - - if (rx_pkt_type == RX_PKT_BROADCAST) - rcr_val8 |= (RCR_AB | RCR_ACRC32); - else if (rx_pkt_type == RX_PKT_DEST_ADDR) - rcr_val8 |= (RCR_AAP | RCR_AM | RCR_ACRC32); - else if (rx_pkt_type == RX_PKT_PHY_MATCH) - rcr_val8 |= (RCR_APM | RCR_ACRC32); - else - rcr_val8 &= ~(RCR_AAP | RCR_APM | RCR_AM | RCR_AB | RCR_ACRC32); - rtw_write8(padapter, 0x10250048, rcr_val8); -#else - rcr_val32 = rtw_read32(padapter, RCR);/* RCR = 0x10250048 */ - rcr_val32 &= ~(RCR_CBSSID | RCR_AB | RCR_AM | RCR_APM | RCR_AAP); -#if 0 - if (rx_pkt_type == RX_PKT_BROADCAST) - rcr_val32 |= (RCR_AB | RCR_AM | RCR_APM | RCR_AAP | RCR_ACRC32); - else if (rx_pkt_type == RX_PKT_DEST_ADDR) { - /* rcr_val32 |= (RCR_CBSSID|RCR_AAP|RCR_AM|RCR_ACRC32); */ - rcr_val32 |= (RCR_CBSSID | RCR_APM | RCR_ACRC32); - } else if (rx_pkt_type == RX_PKT_PHY_MATCH) { - rcr_val32 |= (RCR_APM | RCR_ACRC32); - /* rcr_val32 |= (RCR_AAP|RCR_ACRC32); */ - } else - rcr_val32 &= ~(RCR_AAP | RCR_APM | RCR_AM | RCR_AB | RCR_ACRC32); -#else - switch (rx_pkt_type) { - case RX_PKT_BROADCAST: - rcr_val32 |= (RCR_AB | RCR_AM | RCR_APM | RCR_AAP | RCR_ACRC32); - break; - case RX_PKT_DEST_ADDR: - rcr_val32 |= (RCR_AB | RCR_AM | RCR_APM | RCR_AAP | RCR_ACRC32); - break; - case RX_PKT_PHY_MATCH: - rcr_val32 |= (RCR_APM | RCR_ACRC32); - break; - default: - rcr_val32 &= ~(RCR_AAP | RCR_APM | RCR_AM | RCR_AB | RCR_ACRC32); - break; - } - - if (rx_pkt_type == RX_PKT_DEST_ADDR) - padapter->mppriv.check_mp_pkt = 1; - else - padapter->mppriv.check_mp_pkt = 0; -#endif - rtw_write32(padapter, RCR, rcr_val32); - -#endif - _irqlevel_changed_(&oldirql, RAISE); -#endif - - return status; -} - -NDIS_STATUS oid_rt_pro_set_tx_agc_offset_hdl(struct oid_par_priv *poid_par_priv) -{ -#if 0 - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - - u32 txagc; - - - if (poid_par_priv->type_of_oid != SET_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - if (poid_par_priv->information_buf_len < sizeof(u32)) - return NDIS_STATUS_INVALID_LENGTH; - - txagc = *(u32 *)poid_par_priv->information_buf; - - _irqlevel_changed_(&oldirql, LOWER); - SetTxAGCOffset(Adapter, txagc); - _irqlevel_changed_(&oldirql, RAISE); - - - return status; -#else - return 0; -#endif -} - -NDIS_STATUS oid_rt_pro_set_pkt_test_mode_hdl(struct oid_par_priv *poid_par_priv) -{ -#if 0 - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - - struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; - struct mp_priv *pmppriv = &Adapter->mppriv; - u32 type; - - - if (poid_par_priv->type_of_oid != SET_OID) - return NDIS_STATUS_NOT_ACCEPTED; - - if (poid_par_priv->information_buf_len < sizeof(u32)) - return NDIS_STATUS_INVALID_LENGTH; - - type = *(u32 *)poid_par_priv->information_buf; - - if (_LOOPBOOK_MODE_ == type) { - pmppriv->mode = type; - set_fwstate(pmlmepriv, WIFI_MP_LPBK_STATE); /* append txdesc */ - } else if (_2MAC_MODE_ == type) { - pmppriv->mode = type; - _clr_fwstate_(pmlmepriv, WIFI_MP_LPBK_STATE); - } else - status = NDIS_STATUS_NOT_ACCEPTED; - - - return status; -#else - return 0; -#endif -} - -unsigned int mp_ioctl_xmit_packet_hdl(struct oid_par_priv *poid_par_priv) -{ - PMP_XMIT_PARM pparm; - PADAPTER padapter; - struct mp_priv *pmp_priv; - struct pkt_attrib *pattrib; - - - pparm = (PMP_XMIT_PARM)poid_par_priv->information_buf; - padapter = (PADAPTER)poid_par_priv->adapter_context; - pmp_priv = &padapter->mppriv; - - if (poid_par_priv->type_of_oid == QUERY_OID) { - pparm->enable = !pmp_priv->tx.stop; - pparm->count = pmp_priv->tx.sended; - } else { - if (pparm->enable == 0) - pmp_priv->tx.stop = 1; - else if (pmp_priv->tx.stop == 1) { - pmp_priv->tx.stop = 0; - pmp_priv->tx.count = pparm->count; - pmp_priv->tx.payload = pparm->payload_type; - pattrib = &pmp_priv->tx.attrib; - pattrib->pktlen = pparm->length; - _rtw_memcpy(pattrib->dst, pparm->da, ETH_ALEN); - SetPacketTx(padapter); - } else - return NDIS_STATUS_FAILURE; - } - - return NDIS_STATUS_SUCCESS; -} - -#if 0 -unsigned int mp_ioctl_xmit_packet_hdl(struct oid_par_priv *poid_par_priv) -{ - unsigned char *pframe, *pmp_pkt; - struct ethhdr *pethhdr; - struct pkt_attrib *pattrib; - struct rtw_ieee80211_hdr *pwlanhdr; - unsigned short *fctrl; - int llc_sz, payload_len; - struct mp_xmit_frame *pxframe = NULL; - struct mp_xmit_packet *pmp_xmitpkt = (struct mp_xmit_packet *)param; - u8 addr3[] = {0x02, 0xE0, 0x4C, 0x87, 0x66, 0x55}; - - /* RTW_INFO("+mp_ioctl_xmit_packet_hdl\n"); */ - - pxframe = alloc_mp_xmitframe(&padapter->mppriv); - if (pxframe == NULL) { - DEBUG_ERR(("Can't alloc pmpframe %d:%s\n", __LINE__, __FILE__)); - return -1; - } - - /* mp_xmit_pkt */ - payload_len = pmp_xmitpkt->len - 14; - pmp_pkt = (unsigned char *)pmp_xmitpkt->mem; - pethhdr = (struct ethhdr *)pmp_pkt; - - /* RTW_INFO("payload_len=%d, pkt_mem=0x%x\n", pmp_xmitpkt->len, (void*)pmp_xmitpkt->mem); */ - - /* RTW_INFO("pxframe=0x%x\n", (void*)pxframe); */ - /* RTW_INFO("pxframe->mem=0x%x\n", (void*)pxframe->mem); */ - - /* update attribute */ - pattrib = &pxframe->attrib; - memset((u8 *)(pattrib), 0, sizeof(struct pkt_attrib)); - pattrib->pktlen = pmp_xmitpkt->len; - pattrib->ether_type = ntohs(pethhdr->h_proto); - pattrib->hdrlen = 24; - pattrib->nr_frags = 1; - pattrib->priority = 0; -#ifndef CONFIG_MP_LINUX - if (IS_MCAST(pethhdr->h_dest)) - pattrib->mac_id = 4; - else - pattrib->mac_id = 5; -#else - pattrib->mac_id = 5; -#endif - - /* */ - memset(pxframe->mem, 0 , WLANHDR_OFFSET); - pframe = (u8 *)(pxframe->mem) + WLANHDR_OFFSET; - - pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; - - fctrl = &(pwlanhdr->frame_ctl); - *(fctrl) = 0; - 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); - - _rtw_memcpy(pwlanhdr->addr3, addr3, ETH_ALEN); - - pwlanhdr->seq_ctl = 0; - pframe += pattrib->hdrlen; - - llc_sz = rtw_put_snap(pframe, pattrib->ether_type); - pframe += llc_sz; - - _rtw_memcpy(pframe, (void *)(pmp_pkt + 14), payload_len); - - pattrib->last_txcmdsz = pattrib->hdrlen + llc_sz + payload_len; - - DEBUG_INFO(("issuing mp_xmit_frame, tx_len=%d, ether_type=0x%x\n", pattrib->last_txcmdsz, pattrib->ether_type)); - xmit_mp_frame(padapter, pxframe); - - return _SUCCESS; -} -#endif -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_set_power_down_hdl(struct oid_par_priv *poid_par_priv) -{ -#ifdef PLATFORM_OS_XP - _irqL oldirql; -#endif - u8 bpwrup; - NDIS_STATUS status = NDIS_STATUS_SUCCESS; -#ifdef PLATFORM_LINUX -#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) - PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); -#endif -#endif - - - if (poid_par_priv->type_of_oid != SET_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - - - _irqlevel_changed_(&oldirql, LOWER); - - bpwrup = *(u8 *)poid_par_priv->information_buf; - /* CALL the power_down function */ -#ifdef PLATFORM_LINUX -#if defined(CONFIG_RTL8712) /* Linux MP insmod unknown symbol */ - dev_power_down(padapter, bpwrup); -#endif -#endif - _irqlevel_changed_(&oldirql, RAISE); - - /* DEBUG_ERR(("\n <=== Query OID_RT_PRO_READ_REGISTER. */ - /* Add:0x%08x Width:%d Value:0x%08x\n",RegRWStruct->offset,RegRWStruct->width,RegRWStruct->value)); */ - - - return status; -} -/* ------------------------------------------------------------------------------ */ -NDIS_STATUS oid_rt_get_power_mode_hdl(struct oid_par_priv *poid_par_priv) -{ -#if 0 - NDIS_STATUS status = NDIS_STATUS_SUCCESS; - PADAPTER Adapter = (PADAPTER)(poid_par_priv->adapter_context); - /* #ifdef PLATFORM_OS_XP */ - /* _irqL oldirql; - * #endif */ - - - if (poid_par_priv->type_of_oid != QUERY_OID) { - status = NDIS_STATUS_NOT_ACCEPTED; - return status; - } - if (poid_par_priv->information_buf_len < sizeof(u32)) { - status = NDIS_STATUS_INVALID_LENGTH; - return status; - } - - - /* _irqlevel_changed_(&oldirql, LOWER); */ - *(int *)poid_par_priv->information_buf = Adapter->registrypriv.low_power ? POWER_LOW : POWER_NORMAL; - *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - /* _irqlevel_changed_(&oldirql, RAISE); */ - - - return status; -#else - return 0; -#endif -} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_odm.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_odm.c index 95b7b9b2d4b3..d2a018fbf020 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_odm.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_odm.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,44 +12,59 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +u32 rtw_phydm_ability_ops(_adapter *adapter, HAL_PHYDM_OPS ops, u32 ability) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); + struct dm_struct *podmpriv = &pHalData->odmpriv; + u32 result = 0; + 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; + } + 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); - struct PHY_DM_STRUCT *odm = &hal_data->odmpriv; - u4Byte ic_type = chip_type_to_odm_ic_type(rtw_get_chip_type(adapter)); + struct dm_struct *odm = adapter_to_phydm(adapter); + u32 ic_type = chip_type_to_odm_ic_type(rtw_get_chip_type(adapter)); rtw_warn_on(!ic_type); odm_cmn_info_init(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; -} - void rtw_odm_adaptivity_ver_msg(void *sel, _adapter *adapter) { RTW_PRINT_SEL(sel, "ADAPTIVITY_VERSION "ADAPTIVITY_VERSION"\n"); @@ -60,9 +76,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); - struct PHY_DM_STRUCT *odm = &hal_data->odmpriv; RTW_PRINT_SEL(sel, "RTW_ADAPTIVITY_EN_"); @@ -91,43 +104,16 @@ void rtw_odm_adaptivity_mode_msg(void *sel, _adapter *adapter) _RTW_PRINT_SEL(sel, "INVALID\n"); } -#define RTW_ADAPTIVITY_DML_DISABLE 0 -#define RTW_ADAPTIVITY_DML_ENABLE 1 - -void rtw_odm_adaptivity_dml_msg(void *sel, _adapter *adapter) -{ - struct registry_priv *regsty = &adapter->registrypriv; - - RTW_PRINT_SEL(sel, "RTW_ADAPTIVITY_DML_"); - - if (regsty->adaptivity_dml == RTW_ADAPTIVITY_DML_DISABLE) - _RTW_PRINT_SEL(sel, "DISABLE\n"); - else if (regsty->adaptivity_dml == RTW_ADAPTIVITY_DML_ENABLE) - _RTW_PRINT_SEL(sel, "ENABLE\n"); - else - _RTW_PRINT_SEL(sel, "INVALID\n"); -} - -void rtw_odm_adaptivity_dc_backoff_msg(void *sel, _adapter *adapter) -{ - struct registry_priv *regsty = &adapter->registrypriv; - - RTW_PRINT_SEL(sel, "RTW_ADAPTIVITY_DC_BACKOFF:%u\n", regsty->adaptivity_dc_backoff); -} - void rtw_odm_adaptivity_config_msg(void *sel, _adapter *adapter) { rtw_odm_adaptivity_ver_msg(sel, adapter); rtw_odm_adaptivity_en_msg(sel, adapter); rtw_odm_adaptivity_mode_msg(sel, adapter); - rtw_odm_adaptivity_dml_msg(sel, adapter); - rtw_odm_adaptivity_dc_backoff_msg(sel, adapter); } bool rtw_odm_adaptivity_needed(_adapter *adapter) { struct registry_priv *regsty = &adapter->registrypriv; - struct mlme_priv *mlme = &adapter->mlmepriv; bool ret = _FALSE; if (regsty->adaptivity_en == RTW_ADAPTIVITY_EN_ENABLE) @@ -138,47 +124,32 @@ 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); - struct PHY_DM_STRUCT *odm = &pHalData->odmpriv; + struct 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"); - RTW_PRINT_SEL(sel, "0x%-8x %-16d 0x%-14x %-22d %-12d\n" + RTW_PRINT_SEL(sel, "%10s %16s\n" + , "th_l2h_ini", "th_edcca_hl_diff"); + RTW_PRINT_SEL(sel, "0x%-8x %-16d\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 - ); - - RTW_PRINT_SEL(sel, "%15s %9s\n", "AdapEnableState", "Adap_Flag"); - RTW_PRINT_SEL(sel, "%-15x %-9x\n" - , 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) { - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); - struct PHY_DM_STRUCT *odm = &pHalData->odmpriv; + struct 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; } void rtw_odm_get_perpkt_rssi(void *sel, _adapter *adapter) { - HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); - struct PHY_DM_STRUCT *odm = &(hal_data->odmpriv); + struct dm_struct *odm = adapter_to_phydm(adapter); - 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); + 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); } @@ -208,11 +179,10 @@ void rtw_odm_releasespinlock(_adapter *adapter, enum rt_spinlock_type type) } } -inline u8 rtw_odm_get_dfs_domain(_adapter *adapter) +inline u8 rtw_odm_get_dfs_domain(struct dvobj_priv *dvobj) { #ifdef CONFIG_DFS_MASTER - HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); - struct PHY_DM_STRUCT *pDM_Odm = &(hal_data->odmpriv); + struct dm_struct *pDM_Odm = dvobj_to_phydm(dvobj); return pDM_Odm->dfs_region_domain; #else @@ -220,35 +190,40 @@ inline u8 rtw_odm_get_dfs_domain(_adapter *adapter) #endif } -inline u8 rtw_odm_dfs_domain_unknown(_adapter *adapter) +inline u8 rtw_odm_dfs_domain_unknown(struct dvobj_priv *dvobj) { #ifdef CONFIG_DFS_MASTER - return rtw_odm_get_dfs_domain(adapter) == PHYDM_DFS_DOMAIN_UNKNOWN; + return rtw_odm_get_dfs_domain(dvobj) == PHYDM_DFS_DOMAIN_UNKNOWN; #else return 1; #endif } #ifdef CONFIG_DFS_MASTER -inline VOID rtw_odm_radar_detect_reset(_adapter *adapter) +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) +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) +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)); +} + +inline u8 rtw_odm_radar_detect_polling_int_ms(struct dvobj_priv *dvobj) +{ + return phydm_dfs_polling_time(dvobj_to_phydm(dvobj)); } #endif /* CONFIG_DFS_MASTER */ @@ -260,11 +235,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 = GET_ODM(adapter); + struct dm_struct *phydm = adapter_to_phydm(adapter); struct rx_pkt_attrib *attrib = &rframe->u.hdr.attrib; u8 *wlanhdr = get_recvframe_data(rframe); - if (phydm->support_ic_type & ODM_IC_PHY_STATUE_NEW_TYPE) { + if (phydm->support_ic_type & PHYSTS_2ND_TYPE_IC) { /* * 8723D: * type_0(CCK) @@ -293,7 +268,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_sts_rpt_jgr2_type0 *phys_t0 = (struct phy_sts_rpt_jgr2_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" @@ -306,7 +281,7 @@ 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_sts_rpt_jgr2_type1 *phys_t1 = (struct phy_sts_rpt_jgr2_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; @@ -427,7 +402,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_sts_rpt_jgr2_type2 *phys_t2 = (struct phy_sts_rpt_jgr2_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" @@ -444,3 +419,230 @@ void rtw_odm_parse_rx_phy_status_chinfo(union recv_frame *rframe, u8 *phys) } +#if defined(CONFIG_RTL8822C) && defined(CONFIG_LPS_PG) +void odm_iqk_get_cfir2fw_8822c(void *dm_void, u8 *buf, u32 *buf_size) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct dm_iqk_info *iqk_info = &dm->IQK_info; + + if (buf) { + u16 offset = 0; + + odm_move_memory(dm, buf, iqk_info->iqk_channel, sizeof(iqk_info->iqk_channel)); + offset += sizeof(iqk_info->iqk_channel); + odm_move_memory(dm, buf + offset, &iqk_info->iqk_cfir_real[0][0], sizeof(iqk_info->iqk_cfir_real[0][0])); + offset += sizeof(iqk_info->iqk_cfir_real[0][0]); + odm_move_memory(dm, buf + offset, &iqk_info->iqk_cfir_real[0][1], sizeof(iqk_info->iqk_cfir_real[0][1])); + offset += sizeof(iqk_info->iqk_cfir_real[0][1]); + odm_move_memory(dm, buf + offset, &iqk_info->iqk_cfir_real[1][0], sizeof(iqk_info->iqk_cfir_real[1][0])); + offset += sizeof(iqk_info->iqk_cfir_real[1][0]); + odm_move_memory(dm, buf + offset, &iqk_info->iqk_cfir_real[1][1], sizeof(iqk_info->iqk_cfir_real[1][1])); + offset += sizeof(iqk_info->iqk_cfir_real[1][1]); + odm_move_memory(dm, buf + offset, &iqk_info->iqk_cfir_imag[0][0], sizeof(iqk_info->iqk_cfir_imag[0][0])); + offset += sizeof(iqk_info->iqk_cfir_imag[0][0]); + odm_move_memory(dm, buf + offset, &iqk_info->iqk_cfir_imag[0][1], sizeof(iqk_info->iqk_cfir_imag[0][1])); + offset += sizeof(iqk_info->iqk_cfir_imag[0][1]); + odm_move_memory(dm, buf + offset, &iqk_info->iqk_cfir_imag[1][0], sizeof(iqk_info->iqk_cfir_imag[1][0])); + offset += sizeof(iqk_info->iqk_cfir_imag[1][0]); + odm_move_memory(dm, buf + offset, &iqk_info->iqk_cfir_imag[1][1], sizeof(iqk_info->iqk_cfir_imag[1][1])); + offset += sizeof(iqk_info->iqk_cfir_imag[1][1]); + odm_move_memory(dm, buf + offset, &iqk_info->lok_idac[0][0], sizeof(iqk_info->lok_idac[0][0])); + offset += sizeof(iqk_info->lok_idac[0][0]); + odm_move_memory(dm, buf + offset, &iqk_info->lok_idac[0][1], sizeof(iqk_info->lok_idac[0][1])); + offset += sizeof(iqk_info->lok_idac[0][1]); + odm_move_memory(dm, buf + offset, &iqk_info->lok_idac[1][0], sizeof(iqk_info->lok_idac[1][0])); + offset += sizeof(iqk_info->lok_idac[1][0]); + odm_move_memory(dm, buf + offset, &iqk_info->lok_idac[1][1], sizeof(iqk_info->lok_idac[1][1])); + offset += sizeof(iqk_info->lok_idac[1][1]); + } + + if (buf_size) + *buf_size = RSVDPAGE_8822C_LPS_PG_IQK_INFO_LEN; +} + +void +debug_DACK( + struct dm_struct *dm +) +{ + //P_PHYDM_FUNC dm; + //dm = &(SysMib.ODM.Phydm); + //PIQK_OFFLOAD_PARM pIQK_info; + //pIQK_info= &(SysMib.ODM.IQKParm); + u8 i; + u32 temp1, temp2, temp3; + + temp1 = odm_get_bb_reg(dm, 0x1860, bMaskDWord); + temp2 = odm_get_bb_reg(dm, 0x4160, bMaskDWord); + temp3 = odm_get_bb_reg(dm, 0x9b4, bMaskDWord); + + odm_set_bb_reg(dm, 0x9b4, bMaskDWord, 0xdb66db00); + + //pathA + odm_set_bb_reg(dm, 0x1830, BIT(30), 0x0); + odm_set_bb_reg(dm, 0x1860, 0xfc000000, 0x3c); + + RTW_INFO("path A i\n"); + //i + for (i = 0; i < 0xf; i++) { + odm_set_bb_reg(dm, 0x18b0, 0xf0000000, i); + RTW_INFO("[0][0][%d] = 0x%08x\n", i, (u16)odm_get_bb_reg(dm,0x2810,0x7fc0000)); + //pIQK_info->msbk_d[0][0][i] = (u16)odm_get_bb_reg(dm,0x2810,0x7fc0000); + } + RTW_INFO("path A q\n"); + //q + for (i = 0; i < 0xf; i++) { + odm_set_bb_reg(dm, 0x18cc, 0xf0000000, i); + RTW_INFO("[0][1][%d] = 0x%08x\n", i, (u16)odm_get_bb_reg(dm,0x283c,0x7fc0000)); + //pIQK_info->msbk_d[0][1][i] = (u16)odm_get_bb_reg(dm,0x283c,0x7fc0000); + } + //pathB + odm_set_bb_reg(dm, 0x4130, BIT(30), 0x0); + odm_set_bb_reg(dm, 0x4160, 0xfc000000, 0x3c); + + RTW_INFO("\npath B i\n"); + //i + for (i = 0; i < 0xf; i++) { + odm_set_bb_reg(dm, 0x41b0, 0xf0000000, i); + RTW_INFO("[1][0][%d] = 0x%08x\n", i, (u16)odm_get_bb_reg(dm,0x4510,0x7fc0000)); + //pIQK_info->msbk_d[1][0][i] = (u16)odm_get_bb_reg(dm,0x2810,0x7fc0000); + } + RTW_INFO("path B q\n"); + //q + for (i = 0; i < 0xf; i++) { + odm_set_bb_reg(dm, 0x41cc, 0xf0000000, i); + RTW_INFO("[1][1][%d] = 0x%08x\n", i, (u16)odm_get_bb_reg(dm,0x453c,0x7fc0000)); + //pIQK_info->msbk_d[1][1][i] = (u16)odm_get_bb_reg(dm,0x283c,0x7fc0000); + } + + //restore to normal + odm_set_bb_reg(dm, 0x1830, BIT(30), 0x1); + odm_set_bb_reg(dm, 0x4130, BIT(30), 0x1); + odm_set_bb_reg(dm, 0x1860, bMaskDWord, temp1); + odm_set_bb_reg(dm, 0x4160, bMaskDWord, temp2); + odm_set_bb_reg(dm, 0x9b4, bMaskDWord, temp3); + + +} + +void +debug_IQK( + struct dm_struct *dm, + IN u8 idx, + IN u8 path +) +{ + u8 i, ch; + u32 tmp; + u32 bit_mask_20_16 = BIT(20) | BIT(19) | BIT(18) | BIT(17) | BIT(16); + + RTW_INFO("idx = %d, path = %d\n", idx, path); + + odm_set_bb_reg(dm, 0x1b00, MASKDWORD, 0x8 | path << 1); + + if (idx == TX_IQK) {//TXCFIR + odm_set_bb_reg(dm, R_0x1b20, BIT(31) | BIT(30), 0x3); + } else {//RXCFIR + odm_set_bb_reg(dm, R_0x1b20, BIT(31) | BIT(30), 0x1); + } + odm_set_bb_reg(dm, R_0x1bd4, BIT(21), 0x1); + odm_set_bb_reg(dm, R_0x1bd4, bit_mask_20_16, 0x10); + for (i = 0; i <= 16; i++) { + odm_set_bb_reg(dm, R_0x1bd8, MASKDWORD, 0xe0000001 | i << 2); + tmp = odm_get_bb_reg(dm, R_0x1bfc, MASKDWORD); + RTW_INFO("iqk_cfir_real[%d][%d][%d] = 0x%x\n", path, idx, i, ((tmp & 0x0fff0000) >> 16)); + //iqk_info->iqk_cfir_real[ch][path][idx][i] = + // (tmp & 0x0fff0000) >> 16; + RTW_INFO("iqk_cfir_imag[%d][%d][%d] = 0x%x\n", path, idx, i, (tmp & 0x0fff)); + //iqk_info->iqk_cfir_imag[ch][path][idx][i] = tmp & 0x0fff; + } + odm_set_bb_reg(dm, R_0x1b20, BIT(31) | BIT(30), 0x0); + //odm_set_bb_reg(dm, R_0x1bd8, MASKDWORD, 0x0); +} + +__odm_func__ void +debug_information_8822c( + struct dm_struct *dm) +{ + struct dm_dpk_info *dpk_info = &dm->dpk_info; + + u32 reg_rf18; + + if (odm_get_bb_reg(dm, R_0x1e7c, BIT(30))) + dpk_info->is_tssi_mode = true; + else + dpk_info->is_tssi_mode = false; + + reg_rf18 = odm_get_rf_reg(dm, RF_PATH_A, RF_0x18, RFREG_MASK); + + dpk_info->dpk_band = (u8)((reg_rf18 & BIT(16)) >> 16); /*0/1:G/A*/ + dpk_info->dpk_ch = (u8)reg_rf18 & 0xff; + dpk_info->dpk_bw = (u8)((reg_rf18 & 0x3000) >> 12); /*3/2/1:20/40/80*/ + + RTW_INFO("[DPK] TSSI/ Band/ CH/ BW = %d / %s / %d / %s\n", + dpk_info->is_tssi_mode, dpk_info->dpk_band == 0 ? "2G" : "5G", + dpk_info->dpk_ch, + dpk_info->dpk_bw == 3 ? "20M" : (dpk_info->dpk_bw == 2 ? "40M" : "80M")); +} + +extern void _dpk_get_coef_8822c(void *dm_void, u8 path); + +__odm_func__ void +debug_reload_data_8822c( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct dm_dpk_info *dpk_info = &dm->dpk_info; + + u8 path; + u32 u32tmp; + + debug_information_8822c(dm); + + for (path = 0; path < DPK_RF_PATH_NUM_8822C; path++) { + + RTW_INFO("[DPK] Reload path: 0x%x\n", path); + + odm_set_bb_reg(dm, R_0x1b00, MASKDWORD, 0x8 | (path << 1)); + + /*txagc bnd*/ + if (dpk_info->dpk_band == 0x0) + u32tmp = odm_get_bb_reg(dm, R_0x1b60, MASKDWORD); + else + u32tmp = odm_get_bb_reg(dm, R_0x1b60, MASKDWORD); + + RTW_INFO("[DPK] txagc bnd = 0x%08x\n", u32tmp); + + u32tmp = odm_get_bb_reg(dm, R_0x1b64, MASKBYTE3); + RTW_INFO("[DPK] dpk_txagc = 0x%08x\n", u32tmp); + + //debug_coef_write_8822c(dm, path, dpk_info->dpk_path_ok & BIT(path) >> path); + _dpk_get_coef_8822c(dm, path); + + //debug_one_shot_8822c(dm, path, DPK_ON); + + odm_set_bb_reg(dm, R_0x1b00, 0x0000000f, 0xc); + + if (path == RF_PATH_A) + u32tmp = odm_get_bb_reg(dm, R_0x1b04, 0x0fffffff); + else + u32tmp = odm_get_bb_reg(dm, R_0x1b5c, 0x0fffffff); + + RTW_INFO("[DPK] dpk_gs = 0x%08x\n", u32tmp); + + } +} + +void odm_lps_pg_debug_8822c(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + debug_DACK(dm); + debug_IQK(dm, TX_IQK, RF_PATH_A); + debug_IQK(dm, RX_IQK, RF_PATH_A); + debug_IQK(dm, TX_IQK, RF_PATH_B); + debug_IQK(dm, RX_IQK, RF_PATH_B); + debug_reload_data_8822c(dm); +} +#endif /* defined(CONFIG_RTL8822C) && defined(CONFIG_LPS_PG) */ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_p2p.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_p2p.c index 4a7c55aad500..b0b85d255672 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_p2p.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_p2p.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +81,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; @@ -295,7 +291,6 @@ static void issue_p2p_provision_resp(struct wifidirect_info *pwdinfo, u8 *raddr, unsigned short *fctrl; struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); pmgntframe = alloc_mgtxmitframe(pxmitpriv); @@ -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; @@ -1867,16 +1870,6 @@ u32 build_probe_resp_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) { u8 p2pie[MAX_P2P_IE_LEN] = { 0x00 }; u32 len = 0, p2pielen = 0; -#ifdef CONFIG_INTEL_WIDI - struct mlme_priv *pmlmepriv = &(pwdinfo->padapter->mlmepriv); - u8 zero_array_check[L2SDTA_SERVICE_VE_LEN] = { 0x00 }; - u8 widi_version = 0, i = 0; - - if (_rtw_memcmp(pmlmepriv->sa_ext, zero_array_check, L2SDTA_SERVICE_VE_LEN) == _FALSE) - widi_version = 35; - else if (pmlmepriv->num_p2p_sdt != 0) - widi_version = 40; -#endif /* CONFIG_INTEL_WIDI */ /* P2P OUI */ p2pielen = 0; @@ -1959,14 +1952,7 @@ u32 build_probe_resp_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) /* 21->P2P Device Address (6bytes) + Config Methods (2bytes) + Primary Device Type (8bytes) */ /* + NumofSecondDevType (1byte) + WPS Device Name ID field (2bytes) + WPS Device Name Len field (2bytes) */ /* *(u16*) ( p2pie + p2pielen ) = cpu_to_le16( 21 + pwdinfo->device_name_len ); */ -#ifdef CONFIG_INTEL_WIDI - if (widi_version == 35) - RTW_PUT_LE16(p2pie + p2pielen, 21 + 8 + pwdinfo->device_name_len); - else if (widi_version == 40) - RTW_PUT_LE16(p2pie + p2pielen, 21 + 8 * pmlmepriv->num_p2p_sdt + pwdinfo->device_name_len); - else -#endif /* CONFIG_INTEL_WIDI */ - RTW_PUT_LE16(p2pie + p2pielen, 21 + pwdinfo->device_name_len); + RTW_PUT_LE16(p2pie + p2pielen, 21 + pwdinfo->device_name_len); p2pielen += 2; /* Value: */ @@ -1980,25 +1966,6 @@ u32 build_probe_resp_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) RTW_PUT_BE16(p2pie + p2pielen, pwdinfo->supported_wps_cm); p2pielen += 2; -#ifdef CONFIG_INTEL_WIDI - if (widi_version == 40) { - /* Primary Device Type */ - /* Category ID */ - /* *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_CID_MULIT_MEDIA ); */ - RTW_PUT_BE16(p2pie + p2pielen, pmlmepriv->p2p_pdt_cid); - p2pielen += 2; - - /* OUI */ - /* *(u32*) ( p2pie + p2pielen ) = cpu_to_be32( WPSOUI ); */ - RTW_PUT_BE32(p2pie + p2pielen, WPSOUI); - p2pielen += 4; - - /* Sub Category ID */ - /* *(u16*) ( p2pie + p2pielen ) = cpu_to_be16( WPS_PDT_SCID_MEDIA_SERVER ); */ - RTW_PUT_BE16(p2pie + p2pielen, pmlmepriv->p2p_pdt_scid); - p2pielen += 2; - } else -#endif /* CONFIG_INTEL_WIDI */ { /* Primary Device Type */ /* Category ID */ @@ -2018,33 +1985,7 @@ u32 build_probe_resp_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pbuf) } /* Number of Secondary Device Types */ -#ifdef CONFIG_INTEL_WIDI - if (widi_version == 35) { - p2pie[p2pielen++] = 0x01; - - RTW_PUT_BE16(p2pie + p2pielen, WPS_PDT_CID_DISPLAYS); - p2pielen += 2; - - RTW_PUT_BE32(p2pie + p2pielen, INTEL_DEV_TYPE_OUI); - p2pielen += 4; - - RTW_PUT_BE16(p2pie + p2pielen, P2P_SCID_WIDI_CONSUMER_SINK); - p2pielen += 2; - } else if (widi_version == 40) { - p2pie[p2pielen++] = pmlmepriv->num_p2p_sdt; - for (; i < pmlmepriv->num_p2p_sdt; i++) { - RTW_PUT_BE16(p2pie + p2pielen, pmlmepriv->p2p_sdt_cid[i]); - p2pielen += 2; - - RTW_PUT_BE32(p2pie + p2pielen, INTEL_DEV_TYPE_OUI); - p2pielen += 4; - - RTW_PUT_BE16(p2pie + p2pielen, pmlmepriv->p2p_sdt_scid[i]); - p2pielen += 2; - } - } else -#endif /* CONFIG_INTEL_WIDI */ - p2pie[p2pielen++] = 0x00; /* No Secondary Device Type List */ + p2pie[p2pielen++] = 0x00; /* No Secondary Device Type List */ /* Device Name */ /* Type: */ @@ -2467,7 +2408,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; @@ -2571,26 +2512,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 +2645,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__); @@ -2815,8 +2745,6 @@ u8 process_p2p_group_negotation_resp(struct wifidirect_info *pwdinfo, u8 *pframe u8 attr_content = 0x00; u32 attr_contentlen = 0; u8 operatingch_info[5] = { 0x00 }; - uint ch_cnt = 0; - u8 ch_content[100] = { 0x00 }; u8 groupid[38]; u16 cap_attr; u8 peer_ch_list[100] = { 0x00 }; @@ -2910,7 +2838,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__); @@ -2982,7 +2910,9 @@ u8 process_p2p_group_negotation_resp(struct wifidirect_info *pwdinfo, u8 *pframe u8 process_p2p_group_negotation_confirm(struct wifidirect_info *pwdinfo, u8 *pframe, uint len) { +#ifdef CONFIG_CONCURRENT_MODE _adapter *padapter = pwdinfo->padapter; +#endif u8 *ies; u32 ies_len; u8 *p2p_ie; @@ -3004,9 +2934,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. */ @@ -3082,19 +3011,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); @@ -3105,8 +3035,6 @@ void p2p_concurrent_handler(_adapter *padapter); void restore_p2p_state_handler(_adapter *padapter) { struct wifidirect_info *pwdinfo = &padapter->wdinfo; - struct mlme_priv *pmlmepriv = &padapter->mlmepriv; - if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_ING) || rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_FAIL)) rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); @@ -3119,7 +3047,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 @@ -3183,6 +3111,12 @@ void p2p_concurrent_handler(_adapter *padapter) struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); u8 val8; +#ifdef CONFIG_IOCTL_CFG80211 + if (pwdinfo->driver_interface == DRIVER_CFG80211 + && !rtw_cfg80211_get_is_roch(padapter)) + return; +#endif + if (rtw_mi_check_status(padapter, MI_LINKED)) { u8 union_ch = rtw_mi_get_union_chan(padapter); u8 union_bw = rtw_mi_get_union_bw(padapter); @@ -3191,10 +3125,10 @@ void p2p_concurrent_handler(_adapter *padapter) pwdinfo->operating_channel = union_ch; if (pwdinfo->driver_interface == DRIVER_CFG80211) { - RTW_INFO("%s, switch ch back to union_ch=%d\n", __func__, union_ch); + RTW_INFO("%s, switch ch back to union=%u,%u, %u\n" + , __func__, union_ch, union_bw, union_offset); 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 +3138,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 +3151,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 +3171,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 +3218,136 @@ void p2p_concurrent_handler(_adapter *padapter) #endif #ifdef CONFIG_IOCTL_CFG80211 +u8 roch_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 | WIFI_UNDER_KEY_HANDSHAKE) == _TRUE) { + RTW_INFO(ADPT_FMT"- _FW_UNDER_LINKING |WIFI_UNDER_WPS | WIFI_UNDER_KEY_HANDSHAKE (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_states_check(iface) == _TRUE) { + 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; +#ifdef CONFIG_CONCURRENT_MODE + struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; +#ifdef RTW_ROCH_BACK_OP + struct wifidirect_info *pwdinfo = &adapter->wdinfo; +#endif +#endif + 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 (roch_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 (remain_ch != pmlmeext->cur_channel + #ifdef RTW_ROCH_BACK_OP + || ATOMIC_READ(&pwdev_priv->switch_ch_to) == 1 + #endif + ) { + 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) @@ -3317,6 +3379,11 @@ static int cancel_ro_ch_handler(_adapter *padapter, u8 *buf) } } +#if defined(RTW_ROCH_BACK_OP) && defined(CONFIG_CONCURRENT_MODE) + _cancel_timer_ex(&pwdinfo->ap_p2p_switch_timer); + ATOMIC_SET(&pwdev_priv->switch_ch_to, 1); +#endif + if (rtw_mi_get_ch_setting_union(padapter, &ch, &bw, &offset) != 0) { if (0) RTW_INFO(FUNC_ADPT_FMT" back to linked/linking union - ch:%u, bw:%u, offset:%u\n", @@ -3338,6 +3405,7 @@ static int cancel_ro_ch_handler(_adapter *padapter, u8 *buf) } set_channel_bwmode(padapter, ch, offset, bw); + rtw_back_opch(padapter); rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); #ifdef CONFIG_DEBUG_CFG80211 @@ -3348,7 +3416,7 @@ static int cancel_ro_ch_handler(_adapter *padapter, u8 *buf) rtw_cfg80211_set_is_roch(padapter, _FALSE); pcfg80211_wdinfo->ro_ch_wdev = NULL; - pcfg80211_wdinfo->last_ro_ch_time = rtw_get_current_time(); + rtw_cfg80211_set_last_ro_ch_time(padapter); rtw_cfg80211_remain_on_channel_expired(wdev , pcfg80211_wdinfo->remain_on_ch_cookie @@ -3375,6 +3443,7 @@ static void ro_ch_timer_process(void *FunctionContext) p2p_cancel_roch_cmd(adapter, 0, NULL, 0); } +#if 0 static void rtw_change_p2pie_op_ch(_adapter *padapter, const u8 *frame_body, u32 len, u8 ch) { u8 *ies, *p2p_ie; @@ -3405,7 +3474,9 @@ static void rtw_change_p2pie_op_ch(_adapter *padapter, const u8 *frame_body, u32 p2p_ie = rtw_get_p2p_ie(p2p_ie + p2p_ielen, ies_len - (p2p_ie - ies + p2p_ielen), NULL, &p2p_ielen); } } +#endif +#if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT) static void rtw_change_p2pie_ch_list(_adapter *padapter, const u8 *frame_body, u32 len, u8 ch) { u8 *ies, *p2p_ie; @@ -3449,11 +3520,12 @@ static void rtw_change_p2pie_ch_list(_adapter *padapter, const u8 *frame_body, u p2p_ie = rtw_get_p2p_ie(p2p_ie + p2p_ielen, ies_len - (p2p_ie - ies + p2p_ielen), NULL, &p2p_ielen); } } +#endif +#if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT) static bool rtw_chk_p2pie_ch_list_with_buddy(_adapter *padapter, const u8 *frame_body, u32 len) { bool fit = _FALSE; -#ifdef CONFIG_CONCURRENT_MODE u8 *ies, *p2p_ie; u32 ies_len, p2p_ielen; u8 union_ch = rtw_mi_get_union_chan(padapter); @@ -3495,14 +3567,14 @@ static bool rtw_chk_p2pie_ch_list_with_buddy(_adapter *padapter, const u8 *frame /* Get the next P2P IE */ p2p_ie = rtw_get_p2p_ie(p2p_ie + p2p_ielen, ies_len - (p2p_ie - ies + p2p_ielen), NULL, &p2p_ielen); } -#endif + return fit; } +#if defined(CONFIG_P2P_INVITE_IOT) static bool rtw_chk_p2pie_op_ch_with_buddy(_adapter *padapter, const u8 *frame_body, u32 len) { bool fit = _FALSE; -#ifdef CONFIG_CONCURRENT_MODE u8 *ies, *p2p_ie; u32 ies_len, p2p_ielen; u8 union_ch = rtw_mi_get_union_chan(padapter); @@ -3531,13 +3603,13 @@ static bool rtw_chk_p2pie_op_ch_with_buddy(_adapter *padapter, const u8 *frame_b /* Get the next P2P IE */ p2p_ie = rtw_get_p2p_ie(p2p_ie + p2p_ielen, ies_len - (p2p_ie - ies + p2p_ielen), NULL, &p2p_ielen); } -#endif + return fit; } +#endif static void rtw_cfg80211_adjust_p2pie_channel(_adapter *padapter, const u8 *frame_body, u32 len) { -#ifdef CONFIG_CONCURRENT_MODE u8 *ies, *p2p_ie; u32 ies_len, p2p_ielen; u8 union_ch = rtw_mi_get_union_chan(padapter); @@ -3600,8 +3672,8 @@ static void rtw_cfg80211_adjust_p2pie_channel(_adapter *padapter, const u8 *fram } -#endif } +#endif #ifdef CONFIG_WFD u32 rtw_xframe_build_wfd_ie(struct xmit_frame *xframe) @@ -3685,8 +3757,6 @@ u32 rtw_xframe_build_wfd_ie(struct xmit_frame *xframe) bool rtw_xframe_del_wfd_ie(struct xmit_frame *xframe) { #define DBG_XFRAME_DEL_WFD_IE 0 - - _adapter *adapter = xframe->padapter; u8 *frame = xframe->buf_addr + TXDESC_OFFSET; u8 *frame_body = frame + sizeof(struct rtw_ieee80211_hdr_3addr); u8 *frame_tail = frame + xframe->attrib.pktlen; @@ -3733,12 +3803,9 @@ bool rtw_xframe_del_wfd_ie(struct xmit_frame *xframe) void rtw_xframe_chk_wfd_ie(struct xmit_frame *xframe) { _adapter *adapter = xframe->padapter; - u8 *frame = xframe->buf_addr + TXDESC_OFFSET; - u8 *frame_body = frame + sizeof(struct rtw_ieee80211_hdr_3addr); - u8 *frame_tail = frame + xframe->attrib.pktlen; - +#ifdef CONFIG_IOCTL_CFG80211 struct wifidirect_info *wdinfo = &adapter->wdinfo; - struct mlme_priv *mlme = &adapter->mlmepriv; +#endif u8 build = 0; u8 del = 0; @@ -3746,7 +3813,7 @@ void rtw_xframe_chk_wfd_ie(struct xmit_frame *xframe) del = 1; #ifdef CONFIG_IOCTL_CFG80211 - if (_TRUE == wdinfo->wfd_info->wfd_enable) + if (wdinfo->wfd_info->wfd_enable == _TRUE) #endif del = build = 1; @@ -3766,7 +3833,6 @@ u8 *dump_p2p_attr_ch_list(u8 *p2p_ie, uint p2p_ielen, u8 *buf, u32 buf_len) int w_sz = 0; u8 ch_cnt = 0; u8 ch_list[40]; - bool continuous = _FALSE; pattr = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CH_LIST, NULL, &attr_contentlen); if (pattr != NULL) { @@ -4069,10 +4135,13 @@ int rtw_p2p_check_frames(_adapter *padapter, const u8 *buf, u32 len, u8 tx) if (!tx) { #if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT) if (rtw_mi_check_status(padapter, MI_LINKED) && padapter->registrypriv.full_ch_in_p2p_handshake == 0) { + #if defined(CONFIG_P2P_INVITE_IOT) if (op_ch != -1 && rtw_chk_p2pie_op_ch_with_buddy(padapter, frame_body, len - sizeof(struct rtw_ieee80211_hdr_3addr)) == _FALSE) { RTW_INFO(FUNC_ADPT_FMT" op_ch:%u has no intersect with buddy\n", FUNC_ADPT_ARG(padapter), op_ch); rtw_change_p2pie_ch_list(padapter, frame_body, len - sizeof(struct rtw_ieee80211_hdr_3addr), 0); - } else if (rtw_chk_p2pie_ch_list_with_buddy(padapter, frame_body, len - sizeof(struct rtw_ieee80211_hdr_3addr)) == _FALSE) { + } else + #endif + if (rtw_chk_p2pie_ch_list_with_buddy(padapter, frame_body, len - sizeof(struct rtw_ieee80211_hdr_3addr)) == _FALSE) { RTW_INFO(FUNC_ADPT_FMT" ch_list has no intersect with buddy\n", FUNC_ADPT_ARG(padapter)); rtw_change_p2pie_ch_list(padapter, frame_body, len - sizeof(struct rtw_ieee80211_hdr_3addr), 0); } @@ -4188,24 +4257,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; } @@ -4216,14 +4284,13 @@ 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 */ s32 p2p_protocol_wk_hdl(_adapter *padapter, int intCmdType, u8 *buf) { int ret = H2C_SUCCESS; - struct wifidirect_info *pwdinfo = &(padapter->wdinfo); switch (intCmdType) { case P2P_FIND_PHASE_WK: @@ -4300,7 +4367,6 @@ int process_p2p_cross_connect_ie(PADAPTER padapter, u8 *IEs, u32 IELength) u8 p2p_attr[MAX_P2P_IE_LEN] = { 0x00 };/* NoA length should be n*(13) + 2 */ u32 attr_contentlen = 0; - struct wifidirect_info *pwdinfo = &(padapter->wdinfo); if (IELength <= _BEACON_IE_OFFSET_) @@ -4332,7 +4398,7 @@ void process_p2p_ps_ie(PADAPTER padapter, u8 *IEs, u32 IELength) u32 ies_len; u8 *p2p_ie; u32 p2p_ielen = 0; - u8 noa_attr[MAX_P2P_IE_LEN] = { 0x00 };/* NoA length should be n*(13) + 2 */ + u8 *noa_attr; /* NoA length should be n*(13) + 2 */ u32 attr_contentlen = 0; struct wifidirect_info *pwdinfo = &(padapter->wdinfo); @@ -4359,7 +4425,8 @@ void process_p2p_ps_ie(PADAPTER padapter, u8 *IEs, u32 IELength) while (p2p_ie) { find_p2p = _TRUE; /* Get Notice of Absence IE. */ - if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_NOA, noa_attr, &attr_contentlen)) { + noa_attr = rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_NOA, NULL, &attr_contentlen); + if (noa_attr) { find_p2p_ps = _TRUE; noa_index = noa_attr[0]; @@ -4372,8 +4439,8 @@ void process_p2p_ps_ie(PADAPTER padapter, u8 *IEs, u32 IELength) noa_offset = 2; noa_num = 0; /* NoA length should be n*(13) + 2 */ - if (attr_contentlen > 2) { - while (noa_offset < attr_contentlen) { + if (attr_contentlen > 2 && (attr_contentlen - 2) % 13 == 0) { + while (noa_offset < attr_contentlen && noa_num < P2P_MAX_NOA_NUM) { /* _rtw_memcpy(&wifidirect_info->noa_count[noa_num], &noa_attr[noa_offset], 1); */ pwdinfo->noa_count[noa_num] = noa_attr[noa_offset]; noa_offset += 1; @@ -4423,7 +4490,7 @@ 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); - + u32 ps_deny = 0; /* Pre action for p2p state */ switch (p2p_ps_state) { @@ -4445,6 +4512,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)) { @@ -4479,6 +4556,9 @@ void p2p_ps_wk_hdl(_adapter *padapter, u8 p2p_ps_state) break; } +#ifdef CONFIG_MCC_MODE + rtw_hal_mcc_process_noa(padapter); +#endif /* CONFIG_MCC_MODE */ } u8 p2p_ps_wk_cmd(_adapter *padapter, u8 p2p_ps_state, u8 enqueue) @@ -4587,7 +4667,6 @@ static void pre_tx_scan_timer_process(void *FunctionContext) struct wifidirect_info *pwdinfo = &adapter->wdinfo; _irqL irqL; struct mlme_priv *pmlmepriv = &adapter->mlmepriv; - u8 _status = 0; if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) return; @@ -4872,13 +4951,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 } @@ -4901,7 +4980,6 @@ void init_wifidirect_info(_adapter *padapter, enum P2P_ROLE role) #ifdef CONFIG_WFD struct wifi_display_info *pwfd_info = &padapter->wfd_info; #endif - u8 union_ch = 0; pwdinfo = &padapter->wdinfo; pwdinfo->padapter = padapter; @@ -4916,6 +4994,8 @@ void init_wifidirect_info(_adapter *padapter, enum P2P_ROLE role) && pwdinfo->driver_interface != DRIVER_CFG80211 ) { #ifdef CONFIG_CONCURRENT_MODE + u8 union_ch = 0; + if (rtw_mi_check_status(padapter, MI_LINKED)) union_ch = rtw_mi_get_union_chan(padapter); @@ -5051,6 +5131,14 @@ void init_wifidirect_info(_adapter *padapter, enum P2P_ROLE role) pwdinfo->p2p_info.scan_op_ch_only = 0; } +void _rtw_p2p_set_role(struct wifidirect_info *wdinfo, enum P2P_ROLE role) +{ + if (wdinfo->role != role) { + wdinfo->role = role; + rtw_mi_update_iface_status(&(wdinfo->padapter->mlmepriv), 0); + } +} + #ifdef CONFIG_DBG_P2P /** @@ -5199,9 +5287,6 @@ int rtw_p2p_enable(_adapter *padapter, enum P2P_ROLE role) struct wifidirect_info *pwdinfo = &(padapter->wdinfo); if (role == P2P_ROLE_DEVICE || role == P2P_ROLE_CLIENT || role == P2P_ROLE_GO) { - u8 channel, ch_offset; - u16 bwmode; - #if defined(CONFIG_CONCURRENT_MODE) && (!defined(RTW_P2P_GROUP_INTERFACE) || !RTW_P2P_GROUP_INTERFACE) /* Commented by Albert 2011/12/30 */ /* The driver just supports 1 P2P group operation. */ @@ -5242,10 +5327,6 @@ int rtw_p2p_enable(_adapter *padapter, enum P2P_ROLE role) #endif } else if (role == P2P_ROLE_DISABLE) { -#ifdef CONFIG_INTEL_WIDI - if (padapter->mlmepriv.p2p_reject_disable == _TRUE) - return ret; -#endif /* CONFIG_INTEL_WIDI */ #ifdef CONFIG_IOCTL_CFG80211 if (padapter->wdinfo.driver_interface == DRIVER_CFG80211) @@ -5290,10 +5371,6 @@ int rtw_p2p_enable(_adapter *padapter, enum P2P_ROLE role) /* Restore to initial setting. */ update_tx_basic_rate(padapter, padapter->registrypriv.wireless_mode); -#ifdef CONFIG_INTEL_WIDI - rtw_reset_widi_info(padapter); -#endif /* CONFIG_INTEL_WIDI */ - /* For WiDi purpose. */ #ifdef CONFIG_IOCTL_CFG80211 pwdinfo->driver_interface = DRIVER_CFG80211; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_pwrctrl.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_pwrctrl.c index e637c3cfa57d..d7337aff84a6 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_pwrctrl.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_pwrctrl.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,25 +12,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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _RTW_PWRCTRL_C_ #include #include #include +#ifdef DBG_CHECK_FW_PS_STATE int rtw_fw_ps_state(PADAPTER padapter) { struct dvobj_priv *psdpriv = padapter->dvobj; struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; int ret = _FAIL, dont_care = 0; u16 fw_ps_state = 0; - u32 start_time; struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); struct registry_priv *registry_par = &padapter->registrypriv; @@ -45,6 +41,15 @@ int rtw_fw_ps_state(PADAPTER padapter) , rtw_is_drv_stopped(padapter) ? "True" : "False"); goto exit_fw_ps_state; } + #if defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822C) + rtw_hal_get_hwreg(padapter, HW_VAR_FW_PS_STATE, (u8 *)&fw_ps_state); + if ((fw_ps_state & BIT_LPS_STATUS) == 0) + ret = _SUCCESS; + else { + pdbgpriv->dbg_poll_fail_cnt++; + RTW_INFO("%s: fw_ps_state=%04x\n", __FUNCTION__, fw_ps_state); + } + #else rtw_hal_set_hwreg(padapter, HW_VAR_SET_REQ_FW_PS, (u8 *)&dont_care); { /* 4. if 0x88[7]=1, driver set cmd to leave LPS/IPS. */ @@ -63,13 +68,13 @@ int rtw_fw_ps_state(PADAPTER padapter) RTW_INFO("%s: fw_ps_state=%04x\n", __FUNCTION__, fw_ps_state); } } - + #endif exit_fw_ps_state: _exit_pwrlock(&pwrpriv->check_32k_lock); return ret; } - +#endif /*DBG_CHECK_FW_PS_STATE*/ #ifdef CONFIG_IPS void _ips_enter(_adapter *padapter) { @@ -90,6 +95,10 @@ void _ips_enter(_adapter *padapter) if (pwrpriv->ips_mode == IPS_LEVEL_2) pwrpriv->bkeepfwalive = _TRUE; +#ifdef CONFIG_RTW_CFGVEDNOR_LLSTATS + pwrpriv->pwr_saving_start_time = rtw_get_current_time(); +#endif /* CONFIG_RTW_CFGVEDNOR_LLSTATS */ + rtw_ips_pwr_down(padapter); pwrpriv->rf_pwrstate = rf_off; } @@ -125,6 +134,11 @@ int _ips_leave(_adapter *padapter) result = rtw_ips_pwr_up(padapter); if (result == _SUCCESS) pwrpriv->rf_pwrstate = rf_on; + +#ifdef CONFIG_RTW_CFGVEDNOR_LLSTATS + pwrpriv->pwr_saving_time += rtw_get_passing_time_ms(pwrpriv->pwr_saving_start_time); +#endif /* CONFIG_RTW_CFGVEDNOR_LLSTATS */ + RTW_PRINT("nolinked power save leave\n"); RTW_INFO("==> ips_leave.....LED(0x%08x)...\n", rtw_read32(padapter, 0x4c)); @@ -140,8 +154,10 @@ int _ips_leave(_adapter *padapter) int ips_leave(_adapter *padapter) { struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); +#ifdef DBG_CHECK_FW_PS_STATE struct dvobj_priv *psdpriv = padapter->dvobj; struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; +#endif int ret; if (!is_primary_adapter(padapter)) @@ -188,9 +204,6 @@ bool rtw_pwr_unassociated_idle(_adapter *adapter) struct mlme_priv *pmlmepriv; #ifdef CONFIG_P2P struct wifidirect_info *pwdinfo; -#ifdef CONFIG_IOCTL_CFG80211 - struct cfg80211_wifidirect_info *pcfg80211_wdinfo; -#endif #endif bool ret = _FALSE; @@ -200,7 +213,7 @@ bool rtw_pwr_unassociated_idle(_adapter *adapter) goto exit; } - if (adapter_to_pwrctl(adapter)->ips_deny_time >= rtw_get_current_time()) { + if (rtw_time_after(adapter_to_pwrctl(adapter)->ips_deny_time, rtw_get_current_time())) { /* RTW_INFO("%s ips_deny_time\n", __func__); */ goto exit; } @@ -211,24 +224,21 @@ bool rtw_pwr_unassociated_idle(_adapter *adapter) pmlmepriv = &(iface->mlmepriv); #ifdef CONFIG_P2P pwdinfo = &(iface->wdinfo); -#ifdef CONFIG_IOCTL_CFG80211 - pcfg80211_wdinfo = &iface->cfg80211_wdinfo; -#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 + || (rtw_cfg80211_is_ro_ch_once(adapter) + && rtw_cfg80211_get_last_ro_ch_passing_ms(adapter) < 3000) + #elif defined(CONFIG_P2P) + || rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE) + || rtw_p2p_chk_state(pwdinfo, P2P_STATE_LISTEN) + #endif + ) goto exit; } @@ -239,11 +249,6 @@ bool rtw_pwr_unassociated_idle(_adapter *adapter) goto exit; #endif -#ifdef CONFIG_INTEL_PROXIM - if (adapter->proximity.proxim_on == _TRUE) - return; -#endif - if (pxmit_priv->free_xmitbuf_cnt != NR_XMITBUFF || pxmit_priv->free_xmit_extbuf_cnt != NR_XMIT_EXTBUFF) { RTW_PRINT("There are some pkts to transmit\n"); @@ -265,9 +270,6 @@ bool rtw_pwr_unassociated_idle(_adapter *adapter) */ void rtw_ps_processor(_adapter *padapter) { -#ifdef CONFIG_P2P - struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -#endif /* CONFIG_P2P */ struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); struct dvobj_priv *psdpriv = padapter->dvobj; @@ -393,18 +395,77 @@ 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); } #ifdef CONFIG_LPS +#ifdef CONFIG_CHECK_LEAVE_LPS +#ifdef CONFIG_LPS_CHK_BY_TP +void traffic_check_for_leave_lps_by_tp(PADAPTER padapter, u8 tx, struct sta_info *sta) +{ + struct stainfo_stats *pstats = &sta->sta_stats; + u64 cur_acc_tx_bytes = 0, cur_acc_rx_bytes = 0; + u32 tx_tp_kbyte = 0, rx_tp_kbyte = 0; + u32 tx_tp_th = 0, rx_tp_th = 0; + struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); + u8 leave_lps = _FALSE; + + if (tx) { /* from tx */ + cur_acc_tx_bytes = pstats->tx_bytes - pstats->acc_tx_bytes; + tx_tp_kbyte = cur_acc_tx_bytes >> 10; + tx_tp_th = pwrpriv->lps_tx_tp_th * 1024 / 8 * 2; /*KBytes @2s*/ + + if (tx_tp_kbyte >= tx_tp_th || + padapter->mlmepriv.LinkDetectInfo.NumTxOkInPeriod >= pwrpriv->lps_tx_pkts){ + if (pwrpriv->bLeisurePs + && (pwrpriv->pwr_mode != PS_MODE_ACTIVE) + #ifdef CONFIG_BT_COEXIST + && (rtw_btcoex_IsBtControlLps(padapter) == _FALSE) + #endif + ) { + leave_lps = _TRUE; + } + } + + } else { /* from rx path */ + cur_acc_rx_bytes = pstats->rx_bytes - pstats->acc_rx_bytes; + rx_tp_kbyte = cur_acc_rx_bytes >> 10; + rx_tp_th = pwrpriv->lps_rx_tp_th * 1024 / 8 * 2; + + if (rx_tp_kbyte>= rx_tp_th || + padapter->mlmepriv.LinkDetectInfo.NumRxUnicastOkInPeriod >= pwrpriv->lps_rx_pkts) { + if (pwrpriv->bLeisurePs + && (pwrpriv->pwr_mode != PS_MODE_ACTIVE) + #ifdef CONFIG_BT_COEXIST + && (rtw_btcoex_IsBtControlLps(padapter) == _FALSE) + #endif + ) { + leave_lps = _TRUE; + } + } + } + + if (leave_lps) { + #ifdef DBG_LPS_CHK_BY_TP + RTW_INFO("leave lps via %s, ", tx ? "Tx" : "Rx"); + if (tx) + RTW_INFO("Tx = %d [%d] (KB)\n", tx_tp_kbyte, tx_tp_th); + else + RTW_INFO("Rx = %d [%d] (KB)\n", rx_tp_kbyte, rx_tp_th); + #endif + pwrpriv->lps_chk_cnt = pwrpriv->lps_chk_cnt_th; + /* rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE, 0); */ + rtw_lps_ctrl_wk_cmd(padapter, tx ? LPS_CTRL_TX_TRAFFIC_LEAVE : LPS_CTRL_RX_TRAFFIC_LEAVE, 0); + } +} +#endif /*CONFIG_LPS_CHK_BY_TP*/ + 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; @@ -450,12 +511,81 @@ void traffic_check_for_leave_lps(PADAPTER padapter, u8 tx, u32 tx_packets) if (bLeaveLPS) { /* RTW_INFO("leave lps via %s, Tx = %d, Rx = %d\n", tx?"Tx":"Rx", pmlmepriv->LinkDetectInfo.NumTxOkInPeriod,pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod); */ - /* rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE, 1); */ - rtw_lps_ctrl_wk_cmd(padapter, tx ? LPS_CTRL_TX_TRAFFIC_LEAVE : LPS_CTRL_RX_TRAFFIC_LEAVE, tx ? 0 : 1); + /* rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE, 0); */ + rtw_lps_ctrl_wk_cmd(padapter, tx ? LPS_CTRL_TX_TRAFFIC_LEAVE : LPS_CTRL_RX_TRAFFIC_LEAVE, tx ? RTW_CMDF_DIRECTLY : 0); } -#endif /* CONFIG_CHECK_LEAVE_LPS */ } +#endif /* CONFIG_CHECK_LEAVE_LPS */ +#ifdef CONFIG_LPS_LCLK +#define LPS_CPWM_TIMEOUT_MS 10 /*ms*/ +#define LPS_RPWM_RETRY_CNT 3 + +u8 rtw_cpwm_polling(_adapter *adapter, u8 rpwm, u8 cpwm_orig) +{ + u8 rst = _FAIL; + u8 cpwm_now = 0; + systime start_time; + struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); + #ifdef DBG_CHECK_FW_PS_STATE + struct debug_priv *pdbgpriv = &(adapter_to_dvobj(adapter)->drv_dbg); + #endif + + pwrpriv->rpwm_retry = 0; + + do { + start_time = rtw_get_current_time(); + do { + rtw_msleep_os(1); + 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; + rst = _SUCCESS; + break; + } + } while (rtw_get_passing_time_ms(start_time) < LPS_CPWM_TIMEOUT_MS && !RTW_CANNOT_RUN(adapter)); + + if (rst == _SUCCESS) + break; + else { + /* rpwm retry */ + cpwm_orig = cpwm_now; + rpwm &= ~PS_TOGGLE; + rpwm |= pwrpriv->tog; + rtw_hal_set_hwreg(adapter, HW_VAR_SET_RPWM, (u8 *)(&rpwm)); + pwrpriv->tog += 0x80; + } + } while (pwrpriv->rpwm_retry++ < LPS_RPWM_RETRY_CNT && !RTW_CANNOT_RUN(adapter)); + + if (rst == _SUCCESS) { + #ifdef DBG_CHECK_FW_PS_STATE + RTW_INFO("%s: polling cpwm OK! rpwm_retry=%d, cpwm_orig=%02x, cpwm_now=%02x , 0x100=0x%x\n" + , __func__, pwrpriv->rpwm_retry, 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 */ + } else { + RTW_ERR("%s: polling cpwm timeout! rpwm_retry=%d, cpwm_orig=%02x, cpwm_now=%02x\n" + , __func__, pwrpriv->rpwm_retry, 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 */ + } + + return rst; +} +#endif /* * Description: * This function MUST be called under power lock protect @@ -465,15 +595,13 @@ void traffic_check_for_leave_lps(PADAPTER padapter, u8 tx, u32 tx_packets) * pslv power state level, only could be PS_STATE_S0 ~ PS_STATE_S4 * */ -void rtw_set_rpwm(PADAPTER padapter, u8 pslv) +u8 rtw_set_rpwm(PADAPTER padapter, u8 pslv) { - u8 rpwm; + u8 rpwm = 0xFF; 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 */ - struct dvobj_priv *psdpriv = padapter->dvobj; - struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; +#endif pslv = PS_STATE(pslv); @@ -487,8 +615,9 @@ 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; + return rpwm; } } @@ -497,15 +626,12 @@ void rtw_set_rpwm(PADAPTER padapter, u8 pslv) pwrpriv->cpwm = PS_STATE_S4; - return; + return rpwm; } - if (rtw_is_drv_stopped(padapter)) { - - if (pslv < PS_STATE_S2) { - return; - } - } + if (rtw_is_drv_stopped(padapter)) + if (pslv < PS_STATE_S2) + return rpwm; rpwm = pslv | pwrpriv->tog; #ifdef CONFIG_LPS_LCLK @@ -516,16 +642,23 @@ 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); #endif #if defined(CONFIG_LPS_RPWM_TIMER) && !defined(CONFIG_DETECT_CPWM_BY_POLLING) - if (rpwm & PS_ACK) - _set_timer(&pwrpriv->pwr_rpwm_timer, LPS_RPWM_WAIT_MS); + if (rpwm & PS_ACK) { + #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) + #endif + _set_timer(&pwrpriv->pwr_rpwm_timer, LPS_CPWM_TIMEOUT_MS); + } #endif /* CONFIG_LPS_RPWM_TIMER & !CONFIG_DETECT_CPWM_BY_POLLING */ + rtw_hal_set_hwreg(padapter, HW_VAR_SET_RPWM, (u8 *)(&rpwm)); pwrpriv->tog += 0x80; @@ -533,67 +666,30 @@ void rtw_set_rpwm(PADAPTER padapter, u8 pslv) #ifdef CONFIG_LPS_LCLK /* 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 */ + #ifdef CONFIG_DETECT_CPWM_BY_POLLING + rtw_cpwm_polling(padapter, rpwm, 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, rpwm, 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 */ { pwrpriv->cpwm = pslv; } + return rpwm; } 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 - struct wifidirect_info *pwdinfo = &(padapter->wdinfo); -#ifdef CONFIG_IOCTL_CFG80211 - struct cfg80211_wifidirect_info *pcfg80211_wdinfo = &padapter->cfg80211_wdinfo; -#endif /* CONFIG_IOCTL_CFG80211 */ -#endif /* CONFIG_P2P */ #if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) if (_TRUE == pwrpriv->bInSuspend && pwrpriv->wowlan_mode) @@ -607,26 +703,27 @@ 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 */ + #ifdef CONFIG_DFS_MASTER + || adapter_to_rfctl(padapter)->radar_detect_enabled + #endif + ) return _FALSE; if ((padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) && (padapter->securitypriv.binstallGrpkey == _FALSE)) { @@ -647,7 +744,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 +786,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 +819,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; @@ -762,8 +858,14 @@ void rtw_set_fw_in_ips_mode(PADAPTER padapter, u8 enable) void rtw_set_ps_mode(PADAPTER padapter, u8 ps_mode, u8 smart_ps, u8 bcn_ant_mode, const char *msg) { struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); +#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) || defined(CONFIG_P2P_WOWLAN) struct dvobj_priv *psdpriv = padapter->dvobj; struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; +#endif +#ifdef CONFIG_WMMPS_STA + struct registry_priv *pregistrypriv = &padapter->registrypriv; +#endif #ifdef CONFIG_P2P struct wifidirect_info *pwdinfo = &(padapter->wdinfo); #endif /* CONFIG_P2P */ @@ -789,9 +891,12 @@ 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 */ } @@ -803,10 +908,12 @@ void rtw_set_ps_mode(PADAPTER padapter, u8 ps_mode, u8 smart_ps, u8 bcn_ant_mode #endif #ifdef CONFIG_LPS_PG - 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)); + if ((PS_MODE_ACTIVE != ps_mode) && (pwrpriv->lps_level == LPS_PG)) { + if (pwrpriv->wowlan_mode != _TRUE) { + /*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 @@ -848,7 +955,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); } } @@ -861,7 +968,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(); @@ -881,15 +989,26 @@ void rtw_set_ps_mode(PADAPTER padapter, u8 ps_mode, u8 smart_ps, u8 bcn_ant_mode } while (1); } #endif -#if 0 /*def CONFIG_LPS_PG*/ - lps_pg_hdl_id = LPS_PG_REDLEMEM; - rtw_hal_set_hwreg(padapter, HW_VAR_LPS_PG_HANDLE, (u8 *)(&lps_pg_hdl_id)); +#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_WOWLAN + if (pwrpriv->wowlan_mode == _TRUE) + rtw_hal_set_hwreg(padapter, HW_VAR_H2C_INACTIVE_IPS, (u8 *)(&ps_mode)); +#endif /* CONFIG_WOWLAN */ -#if 0 /*def CONFIG_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)); + rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_PWRMODE, (u8 *)(&ps_mode)); + rtw_hal_set_hwreg(padapter, HW_VAR_LPS_STATE_CHK, (u8 *)(&ps_mode)); + + +#ifdef CONFIG_LPS_PG + if (pwrpriv->lps_level == LPS_PG) { + lps_pg_hdl_id = LPS_PG_PHYDM_EN; + rtw_hal_set_hwreg(padapter, HW_VAR_LPS_PG_HANDLE, (u8 *)(&lps_pg_hdl_id)); + } #endif #ifdef CONFIG_LPS_POFF @@ -912,6 +1031,9 @@ void rtw_set_ps_mode(PADAPTER padapter, u8 ps_mode, u8 smart_ps, u8 bcn_ant_mode #ifdef CONFIG_P2P_WOWLAN || (_TRUE == pwrpriv->wowlan_p2p_mode) #endif /* CONFIG_P2P_WOWLAN */ +#ifdef CONFIG_WOWLAN + || WOWLAN_IS_STA_MIX_MODE(padapter) +#endif /* CONFIG_WOWLAN */ ) { u8 pslv; @@ -931,7 +1053,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); } } @@ -950,7 +1072,24 @@ 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; - 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_PHYDM_DIS; + rtw_hal_set_hwreg(padapter, HW_VAR_LPS_PG_HANDLE, (u8 *)(&lps_pg_hdl_id)); + } +#endif + +#ifdef CONFIG_WMMPS_STA + pwrpriv->wmm_smart_ps = pregistrypriv->wmm_smart_ps; +#endif /* CONFIG_WMMPS_STA */ + + + if (check_fwstate(pmlmepriv, _FW_LINKED)) + rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_PWRMODE, (u8 *)(&ps_mode)); +#ifdef CONFIG_WOWLAN + if (pwrpriv->wowlan_mode == _TRUE) + rtw_hal_set_hwreg(padapter, HW_VAR_H2C_INACTIVE_IPS, (u8 *)(&ps_mode)); +#endif /* CONFIG_WOWLAN */ #ifdef CONFIG_P2P_PS /* Set CTWindow after LPS */ @@ -986,42 +1125,6 @@ void rtw_set_ps_mode(PADAPTER padapter, u8 ps_mode, u8 smart_ps, u8 bcn_ant_mode } -/* - * Return: - * 0: Leave OK - * -1: Timeout - * -2: Other error - */ -s32 LPS_RF_ON_check(PADAPTER padapter, u32 delay_ms) -{ - u32 start_time; - u8 bAwake = _FALSE; - s32 err = 0; - - - start_time = rtw_get_current_time(); - while (1) { - rtw_hal_get_hwreg(padapter, HW_VAR_FWLPS_RF_ON, &bAwake); - if (_TRUE == bAwake) - break; - - if (rtw_is_surprise_removed(padapter)) { - err = -2; - RTW_INFO("%s: device surprise removed!!\n", __FUNCTION__); - break; - } - - if (rtw_get_passing_time_ms(start_time) > delay_ms) { - err = -1; - RTW_INFO("%s: Wait for FW LPS leave more than %u ms!!!\n", __FUNCTION__, delay_ms); - break; - } - rtw_usleep_os(100); - } - - return err; -} - /* * Description: * Enter the leisure power save mode. @@ -1030,14 +1133,14 @@ void LPS_Enter(PADAPTER padapter, const char *msg) { struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); - struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); - int n_assoc_iface = 0; int i; char buf[32] = {0}; - +#ifdef DBG_LA_MODE + struct registry_priv *registry_par = &(padapter->registrypriv); +#endif /* RTW_INFO("+LeisurePSEnter\n"); */ - if (_FALSE == padapter->bFWReady) + if (GET_HAL_DATA(padapter)->bFWReady == _FALSE) return; #ifdef CONFIG_BT_COEXIST @@ -1045,12 +1148,14 @@ void LPS_Enter(PADAPTER padapter, const char *msg) return; #endif - /* Skip lps enter request if number of assocated adapters is not 1 */ - for (i = 0; i < dvobj->iface_nums; i++) { - if (check_fwstate(&(dvobj->padapters[i]->mlmepriv), WIFI_ASOC_STATE)) - n_assoc_iface++; +#ifdef DBG_LA_MODE + if(registry_par->la_mode_en == 1) { + RTW_INFO("%s LA debug mode lps_leave \n", __func__); + return; } - if (n_assoc_iface != 1) +#endif + /* Skip lps enter request if number of assocated adapters is not 1 */ + if (rtw_mi_get_assoc_if_num(padapter) != 1) return; #ifndef CONFIG_FW_MULTI_PORT_SUPPORT @@ -1064,6 +1169,14 @@ void LPS_Enter(PADAPTER padapter, const char *msg) return; } +#ifdef CONFIG_CLIENT_PORT_CFG + if ((rtw_hal_get_port(padapter) == CLT_PORT_INVALID) || + get_clt_num(padapter) > MAX_CLIENT_PORT_NUM){ + RTW_ERR(ADPT_FMT" cannot get client port or clt num(%d) over than 4\n", ADPT_ARG(padapter), get_clt_num(padapter)); + return; + } +#endif + #ifdef CONFIG_P2P_PS if (padapter->wdinfo.p2p_ps_mode == P2P_PS_NOA) { return;/* supporting p2p client ps NOA via H2C_8723B_P2P_PS_OFFLOAD */ @@ -1074,8 +1187,19 @@ 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; + +#ifdef CONFIG_RTW_CFGVEDNOR_LLSTATS + pwrpriv->pwr_saving_start_time = rtw_get_current_time(); +#endif /* CONFIG_RTW_CFGVEDNOR_LLSTATS */ + rtw_set_ps_mode(padapter, pwrpriv->power_mgnt, padapter->registrypriv.smart_ps, 0, buf); } } else @@ -1096,10 +1220,10 @@ void LPS_Leave(PADAPTER padapter, const char *msg) struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); - u32 start_time; - u8 bAwake = _FALSE; char buf[32] = {0}; +#ifdef DBG_CHECK_FW_PS_STATE struct debug_priv *pdbgpriv = &dvobj->drv_dbg; +#endif /* RTW_INFO("+LeisurePSLeave\n"); */ @@ -1111,11 +1235,18 @@ 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); - if (pwrpriv->pwr_mode == PS_MODE_ACTIVE) - LPS_RF_ON_check(padapter, LPS_LEAVE_TIMEOUT_MS); +#ifdef CONFIG_RTW_CFGVEDNOR_LLSTATS + pwrpriv->pwr_saving_time += rtw_get_passing_time_ms(pwrpriv->pwr_saving_start_time); +#endif /* CONFIG_RTW_CFGVEDNOR_LLSTATS */ } } @@ -1129,20 +1260,32 @@ void LPS_Leave(PADAPTER padapter, const char *msg) * RTW_INFO("-LeisurePSLeave\n"); */ } + +void rtw_wow_lps_level_decide(_adapter *adapter, u8 wow_en) +{ + 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; +#ifdef CONFIG_WOWLAN + pwrpriv->lps_level = pwrpriv->wowlan_lps_level; +#endif /* CONFIG_WOWLAN */ + } else + pwrpriv->lps_level = pwrpriv->lps_level_bk; +} #endif void LeaveAllPowerSaveModeDirect(PADAPTER Adapter) { PADAPTER pri_padapter = GET_PRIMARY_ADAPTER(Adapter); - struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(Adapter); - struct dvobj_priv *psdpriv = Adapter->dvobj; - struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; +#ifdef CONFIG_LPS_LCLK #ifndef CONFIG_DETECT_CPWM_BY_POLLING - u8 cpwm_orig, cpwm_now; - u32 start_time; + u8 cpwm_orig; #endif /* CONFIG_DETECT_CPWM_BY_POLLING */ - + u8 rpwm; +#endif RTW_INFO("%s.....\n", __FUNCTION__); @@ -1165,53 +1308,22 @@ void LeaveAllPowerSaveModeDirect(PADAPTER Adapter) cpwm_orig = 0; rtw_hal_get_hwreg(Adapter, HW_VAR_CPWM, &cpwm_orig); #endif /* CONFIG_DETECT_CPWM_BY_POLLING */ - rtw_set_rpwm(Adapter, PS_STATE_S4); + rpwm = rtw_set_rpwm(Adapter, PS_STATE_S4); #ifndef CONFIG_DETECT_CPWM_BY_POLLING - - start_time = rtw_get_current_time(); - - /* polling cpwm */ - do { - rtw_mdelay_os(1); - - 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! cpwm_orig=%02x, cpwm_now=%02x, 0x100=0x%x\n" - , __FUNCTION__, cpwm_orig, cpwm_now, rtw_read8(Adapter, REG_CR)); - if (rtw_fw_ps_state(Adapter) == _FAIL) { - RTW_INFO("%s: leave 32k but fw state in 32k\n", __FUNCTION__); - 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! cpwm_orig=%02x, cpwm_now=%02x\n", __FUNCTION__, 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 */ - break; - } - } while (1); + if (rpwm != 0xFF && rpwm & PS_ACK) + rtw_cpwm_polling(Adapter, rpwm, cpwm_orig); #endif /* CONFIG_DETECT_CPWM_BY_POLLING */ _exit_pwrlock(&pwrpriv->lock); -#endif +#endif/*CONFIG_LPS_LCLK*/ #ifdef CONFIG_P2P_PS p2p_ps_wk_cmd(pri_padapter, P2P_PS_DISABLE, 0); #endif /* CONFIG_P2P_PS */ #ifdef CONFIG_LPS - rtw_lps_ctrl_wk_cmd(pri_padapter, LPS_CTRL_LEAVE, 0); + rtw_lps_ctrl_wk_cmd(pri_padapter, LPS_CTRL_LEAVE, RTW_CMDF_DIRECTLY); #endif } else { if (pwrpriv->rf_pwrstate == rf_off) { @@ -1241,45 +1353,45 @@ void LeaveAllPowerSaveModeDirect(PADAPTER Adapter) * Description: Leave all power save mode: LPS, FwLPS, IPS if needed. * Move code to function by tynli. 2010.03.26. * */ -void LeaveAllPowerSaveMode(IN PADAPTER Adapter) +void LeaveAllPowerSaveMode(PADAPTER Adapter) { struct dvobj_priv *dvobj = adapter_to_dvobj(Adapter); - struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); u8 enqueue = 0; - int n_assoc_iface = 0; int i; - - /* RTW_INFO("%s.....\n",__FUNCTION__); */ - + #ifndef CONFIG_NEW_NETDEV_HDL if (_FALSE == Adapter->bup) { RTW_INFO(FUNC_ADPT_FMT ": bup=%d Skip!\n", FUNC_ADPT_ARG(Adapter), Adapter->bup); return; } + #endif + +/* RTW_INFO(FUNC_ADPT_FMT "\n", FUNC_ADPT_ARG(Adapter));*/ if (rtw_is_surprise_removed(Adapter)) { RTW_INFO(FUNC_ADPT_FMT ": bSurpriseRemoved=_TRUE Skip!\n", FUNC_ADPT_ARG(Adapter)); return; } - for (i = 0; i < dvobj->iface_nums; i++) { - if (check_fwstate(&(dvobj->padapters[i]->mlmepriv), WIFI_ASOC_STATE)) - n_assoc_iface++; - } - - if (n_assoc_iface) { + if (rtw_mi_get_assoc_if_num(Adapter)) { /* connect */ #ifdef CONFIG_LPS_LCLK enqueue = 1; #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 - rtw_lps_ctrl_wk_cmd(Adapter, LPS_CTRL_LEAVE, enqueue); + rtw_lps_ctrl_wk_cmd(Adapter, LPS_CTRL_LEAVE, enqueue ? 0 : RTW_CMDF_DIRECTLY); #endif #ifdef CONFIG_LPS_LCLK @@ -1314,7 +1426,7 @@ void LPS_Leave_check( PADAPTER padapter) { struct pwrctrl_priv *pwrpriv; - u32 start_time; + systime start_time; u8 bReady; @@ -1343,7 +1455,7 @@ void LPS_Leave_check( break; if (rtw_get_passing_time_ms(start_time) > 100) { - RTW_INFO("Wait for cpwm event than 100 ms!!!\n"); + RTW_ERR("Wait for cpwm event than 100 ms!!!\n"); break; } rtw_msleep_os(1); @@ -1427,6 +1539,41 @@ static void dma_event_callback(struct work_struct *work) } #ifdef CONFIG_LPS_RPWM_TIMER + +#define DBG_CPWM_CHK_FAIL +#if defined(DBG_CPWM_CHK_FAIL) && (defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822C)) +#define CPU_EXCEPTION_CODE 0xFAFAFAFA +static void rtw_cpwm_chk_fail_debug(_adapter *padapter) +{ + u32 cpu_state; + + cpu_state = rtw_read32(padapter, 0x10FC); + + RTW_INFO("[PS-DBG] Reg_10FC =0x%08x\n", cpu_state); + RTW_INFO("[PS-DBG] Reg_10F8 =0x%08x\n", rtw_read32(padapter, 0x10F8)); + RTW_INFO("[PS-DBG] Reg_11F8 =0x%08x\n", rtw_read32(padapter, 0x11F8)); + RTW_INFO("[PS-DBG] Reg_4A4 =0x%08x\n", rtw_read32(padapter, 0x4A4)); + RTW_INFO("[PS-DBG] Reg_4A8 =0x%08x\n", rtw_read32(padapter, 0x4A8)); + + if (cpu_state == CPU_EXCEPTION_CODE) { + RTW_INFO("[PS-DBG] Reg_48C =0x%08x\n", rtw_read32(padapter, 0x48C)); + RTW_INFO("[PS-DBG] Reg_490 =0x%08x\n", rtw_read32(padapter, 0x490)); + RTW_INFO("[PS-DBG] Reg_494 =0x%08x\n", rtw_read32(padapter, 0x494)); + RTW_INFO("[PS-DBG] Reg_498 =0x%08x\n", rtw_read32(padapter, 0x498)); + RTW_INFO("[PS-DBG] Reg_49C =0x%08x\n", rtw_read32(padapter, 0x49C)); + RTW_INFO("[PS-DBG] Reg_4A0 =0x%08x\n", rtw_read32(padapter, 0x4A0)); + RTW_INFO("[PS-DBG] Reg_1BC =0x%08x\n", rtw_read32(padapter, 0x1BC)); + + RTW_INFO("[PS-DBG] Reg_008 =0x%08x\n", rtw_read32(padapter, 0x08)); + RTW_INFO("[PS-DBG] Reg_2F0 =0x%08x\n", rtw_read32(padapter, 0x2F0)); + RTW_INFO("[PS-DBG] Reg_2F4 =0x%08x\n", rtw_read32(padapter, 0x2F4)); + RTW_INFO("[PS-DBG] Reg_2F8 =0x%08x\n", rtw_read32(padapter, 0x2F8)); + RTW_INFO("[PS-DBG] Reg_2FC =0x%08x\n", rtw_read32(padapter, 0x2FC)); + + rtw_dump_fifo(RTW_DBGDUMP, padapter, 5, 0, 3072); + } +} +#endif static void rpwmtimeout_workitem_callback(struct work_struct *work) { PADAPTER padapter; @@ -1437,7 +1584,6 @@ static void rpwmtimeout_workitem_callback(struct work_struct *work) pwrpriv = container_of(work, struct pwrctrl_priv, rpwmtimeoutwi); dvobj = pwrctl_to_dvobj(pwrpriv); padapter = dvobj_get_primary_adapter(dvobj); - /* RTW_INFO("+%s: rpwm=0x%02X cpwm=0x%02X\n", __func__, pwrpriv->rpwm, pwrpriv->cpwm); */ if (!padapter) return; @@ -1450,8 +1596,25 @@ static void rpwmtimeout_workitem_callback(struct work_struct *work) RTW_INFO("%s: rpwm=0x%02X cpwm=0x%02X CPWM done!\n", __func__, pwrpriv->rpwm, pwrpriv->cpwm); goto exit; } + + if (pwrpriv->rpwm_retry++ < LPS_RPWM_RETRY_CNT) { + u8 rpwm = (pwrpriv->rpwm | pwrpriv->tog | PS_ACK); + + rtw_hal_set_hwreg(padapter, HW_VAR_SET_RPWM, (u8 *)(&rpwm)); + + pwrpriv->tog += 0x80; + _set_timer(&pwrpriv->pwr_rpwm_timer, LPS_CPWM_TIMEOUT_MS); + goto exit; + } + + pwrpriv->rpwm_retry = 0; _exit_pwrlock(&pwrpriv->lock); +#if defined(DBG_CPWM_CHK_FAIL) && (defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822C)) + RTW_INFO("+%s: rpwm=0x%02X cpwm=0x%02X\n", __func__, pwrpriv->rpwm, pwrpriv->cpwm); + rtw_cpwm_chk_fail_debug(padapter); +#endif + if (rtw_read8(padapter, 0x100) != 0xEA) { #if 1 struct reportpwrstate_parm report; @@ -1932,17 +2095,16 @@ void rtw_unregister_evt_alive(PADAPTER padapter) void rtw_init_pwrctrl_priv(PADAPTER padapter) { struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); - +#ifdef CONFIG_WOWLAN + struct registry_priv *registry_par = &padapter->registrypriv; +#endif +#ifdef CONFIG_GPIO_WAKEUP u8 val8 = 0; - -#if defined(CONFIG_CONCURRENT_MODE) - if (padapter->adapter_type != PRIMARY_ADAPTER) - return; #endif - -#ifdef PLATFORM_WINDOWS - pwrctrlpriv->pnp_current_pwr_state = NdisDeviceStateD0; +#if defined(CONFIG_CONCURRENT_MODE) + if (!is_primary_adapter(padapter)) + return; #endif _init_pwrlock(&pwrctrlpriv->lock); @@ -1953,13 +2115,26 @@ void rtw_init_pwrctrl_priv(PADAPTER padapter) pwrctrlpriv->lps_enter_cnts = 0; pwrctrlpriv->lps_leave_cnts = 0; pwrctrlpriv->bips_processing = _FALSE; +#ifdef CONFIG_LPS_CHK_BY_TP + pwrctrlpriv->lps_chk_by_tp = padapter->registrypriv.lps_chk_by_tp; + pwrctrlpriv->lps_tx_tp_th = LPS_TX_TP_TH; + pwrctrlpriv->lps_rx_tp_th = LPS_RX_TP_TH; + pwrctrlpriv->lps_bi_tp_th = LPS_BI_TP_TH; + pwrctrlpriv->lps_chk_cnt = pwrctrlpriv->lps_chk_cnt_th = LPS_TP_CHK_CNT; + pwrctrlpriv->lps_tx_pkts = LPS_CHK_PKTS_TX; + pwrctrlpriv->lps_rx_pkts = LPS_CHK_PKTS_RX; +#endif 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; @@ -1971,10 +2146,6 @@ void rtw_init_pwrctrl_priv(PADAPTER padapter) pwrctrlpriv->LpsIdleCount = 0; -#ifdef CONFIG_LPS_PG - pwrctrlpriv->lpspg_rsvd_page_locate = 0; -#endif - /* pwrctrlpriv->FWCtrlPSMode =padapter->registrypriv.power_mgnt; */ /* PS_MODE_MIN; */ if (padapter->registrypriv.mp_mode == 1) pwrctrlpriv->power_mgnt = PS_MODE_ACTIVE ; @@ -1993,6 +2164,10 @@ void rtw_init_pwrctrl_priv(PADAPTER padapter) pwrctrlpriv->dtim = 0; pwrctrlpriv->tog = 0x80; + pwrctrlpriv->rpwm_retry = 0; + + RTW_INFO("%s: IPS_mode=%d, LPS_mode=%d, LPS_level=%d\n", + __func__, pwrctrlpriv->ips_mode, pwrctrlpriv->power_mgnt, pwrctrlpriv->lps_level); #ifdef CONFIG_LPS_LCLK rtw_hal_set_hwreg(padapter, HW_VAR_SET_RPWM, (u8 *)(&pwrctrlpriv->rpwm)); @@ -2004,15 +2179,24 @@ void rtw_init_pwrctrl_priv(PADAPTER padapter) #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); +#ifdef CONFIG_LPS_PG + pwrctrlpriv->lpspg_info.name = "LPSPG_INFO"; + #ifdef CONFIG_RTL8822C + pwrctrlpriv->lpspg_dpk_info.name = "LPSPG_DPK_INFO"; + pwrctrlpriv->lpspg_iqk_info.name = "LPSPG_IQK_INFO"; + #endif +#endif + + 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 @@ -2027,17 +2211,39 @@ void rtw_init_pwrctrl_priv(PADAPTER padapter) #ifdef CONFIG_GPIO_WAKEUP /*default low active*/ - pwrctrlpriv->is_high_active = HIGH_ACTIVE; - val8 = (pwrctrlpriv->is_high_active == 0) ? 1 : 0; + pwrctrlpriv->is_high_active = HIGH_ACTIVE_DEV2HST; + pwrctrlpriv->hst2dev_high_active = HIGH_ACTIVE_HST2DEV; +#ifdef CONFIG_RTW_ONE_PIN_GPIO rtw_hal_switch_gpio_wl_ctrl(padapter, WAKEUP_GPIO_IDX, _TRUE); + rtw_hal_set_input_gpio(padapter, WAKEUP_GPIO_IDX); +#else + #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_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_RTW_ONE_PIN_GPIO */ #endif /* CONFIG_GPIO_WAKEUP */ #ifdef CONFIG_WOWLAN + pwrctrlpriv->wowlan_power_mgmt = padapter->registrypriv.wow_power_mgnt; + pwrctrlpriv->wowlan_lps_level = padapter->registrypriv.wow_lps_level; + + RTW_INFO("%s: WOW_LPS_mode=%d, WOW_LPS_level=%d\n", + __func__, pwrctrlpriv->wowlan_power_mgmt, pwrctrlpriv->wowlan_lps_level); + + if (registry_par->wakeup_event & BIT(1)) + pwrctrlpriv->default_patterns_en = _TRUE; + else + pwrctrlpriv->default_patterns_en = _FALSE; + rtw_wow_pattern_sw_reset(padapter); - pwrctrlpriv->wowlan_in_resume = _FALSE; #ifdef CONFIG_PNO_SUPPORT pwrctrlpriv->pno_inited = _FALSE; pwrctrlpriv->pnlo_info = NULL; @@ -2063,7 +2269,7 @@ void rtw_free_pwrctrl_priv(PADAPTER adapter) struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(adapter); #if defined(CONFIG_CONCURRENT_MODE) - if (adapter->adapter_type != PRIMARY_ADAPTER) + if (!is_primary_adapter(adapter)) return; #endif @@ -2082,6 +2288,22 @@ void rtw_free_pwrctrl_priv(PADAPTER adapter) rtw_hal_set_hwreg(adapter, HW_VAR_LPS_POFF_DEINIT, 0); #endif +#ifdef CONFIG_LPS_LCLK + _cancel_workitem_sync(&pwrctrlpriv->cpwm_event); + _cancel_workitem_sync(&pwrctrlpriv->dma_event); + #ifdef CONFIG_LPS_RPWM_TIMER + _cancel_workitem_sync(&pwrctrlpriv->rpwmtimeoutwi); + #endif +#endif /* CONFIG_LPS_LCLK */ + +#ifdef CONFIG_LPS_PG + rsvd_page_cache_free(&pwrctrlpriv->lpspg_info); + #ifdef CONFIG_RTL8822C + rsvd_page_cache_free(&pwrctrlpriv->lpspg_dpk_info); + rsvd_page_cache_free(&pwrctrlpriv->lpspg_iqk_info); + #endif +#endif + #ifdef CONFIG_WOWLAN #ifdef CONFIG_PNO_SUPPORT if (pwrctrlpriv->pnlo_info != NULL) @@ -2287,9 +2509,9 @@ int _rtw_pwr_wakeup(_adapter *padapter, u32 ips_deffer_ms, const char *caller) struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); struct mlme_priv *pmlmepriv; int ret = _SUCCESS; - int i; - u32 start = rtw_get_current_time(); + systime start = rtw_get_current_time(); + /*RTW_INFO(FUNC_ADPT_FMT "===>\n", FUNC_ADPT_ARG(padapter));*/ /* for LPS */ LeaveAllPowerSaveMode(padapter); @@ -2297,7 +2519,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 (rtw_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); @@ -2323,7 +2545,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)) @@ -2337,17 +2563,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) @@ -2415,8 +2645,9 @@ 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 (rtw_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); + /*RTW_INFO(FUNC_ADPT_FMT "<===\n", FUNC_ADPT_ARG(padapter));*/ return ret; } @@ -2441,6 +2672,52 @@ 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) { + if (pwrctrlpriv->lps_level != level) { + #ifdef CONFIG_LPS + if (rtw_lps_ctrl_leave_set_level_cmd(padapter, level, RTW_CMDF_WAIT_ACK) != _SUCCESS) + #endif + pwrctrlpriv->lps_level = level; + } + } else + ret = -EINVAL; + + return ret; +} + +#ifdef CONFIG_WOWLAN +int rtw_pm_set_wow_lps(_adapter *padapter, u8 mode) +{ + int ret = 0; + struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); + + if (mode < PS_MODE_NUM) { + if (pwrctrlpriv->wowlan_power_mgmt != mode) + pwrctrlpriv->wowlan_power_mgmt = mode; + } else + ret = -EINVAL; + + return ret; +} +int rtw_pm_set_wow_lps_level(_adapter *padapter, u8 level) +{ + int ret = 0; + struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); + + if (level < LPS_LEVEL_MAX) + pwrctrlpriv->wowlan_lps_level = level; + else + ret = -EINVAL; + + return ret; +} +#endif /* CONFIG_WOWLAN */ + int rtw_pm_set_ips(_adapter *padapter, u8 mode) { struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); @@ -2466,8 +2743,6 @@ int rtw_pm_set_ips(_adapter *padapter, u8 mode) void rtw_ps_deny(PADAPTER padapter, PS_DENY_REASON reason) { struct pwrctrl_priv *pwrpriv; - s32 ret; - /* RTW_INFO("+" FUNC_ADPT_FMT ": Request PS deny for %d (0x%08X)\n", * FUNC_ADPT_ARG(padapter), reason, BIT(reason)); */ @@ -2526,3 +2801,38 @@ u32 rtw_ps_deny_get(PADAPTER padapter) return deny; } + +static void _rtw_ssmps(_adapter *adapter, struct sta_info *sta) +{ + struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + + if (MLME_IS_STA(adapter)) { + issue_action_SM_PS_wait_ack(adapter , get_my_bssid(&(pmlmeinfo->network)), + sta->cmn.sm_ps, 3 , 1); + } + else if (MLME_IS_AP(adapter)) { + + } + rtw_phydm_ra_registed(adapter, sta); +} +void rtw_ssmps_enter(_adapter *adapter, struct sta_info *sta) +{ + if (sta->cmn.sm_ps == SM_PS_STATIC) + return; + + RTW_INFO(ADPT_FMT" STA [" MAC_FMT "]\n", ADPT_ARG(adapter), MAC_ARG(sta->cmn.mac_addr)); + + sta->cmn.sm_ps = SM_PS_STATIC; + _rtw_ssmps(adapter, sta); +} +void rtw_ssmps_leave(_adapter *adapter, struct sta_info *sta) +{ + if (sta->cmn.sm_ps == SM_PS_DISABLE) + return; + + RTW_INFO(ADPT_FMT" STA [" MAC_FMT "] \n", ADPT_ARG(adapter), MAC_ARG(sta->cmn.mac_addr)); + sta->cmn.sm_ps = SM_PS_DISABLE; + _rtw_ssmps(adapter, sta); +} + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_recv.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_recv.c index 6910a41aa0d8..4c35c8dcd070 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_recv.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_recv.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,26 +12,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 _RTW_RECV_C_ #include #include -#if defined(PLATFORM_LINUX) && defined (PLATFORM_WINDOWS) - - #error "Shall be Linux or Windows, but not both!\n" - -#endif - - #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, @@ -49,6 +38,17 @@ u8 signal_stat_calc_profile[SIGNAL_STAT_CALC_PROFILE_MAX][2] = { #endif /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ +u8 rtw_bridge_tunnel_header[] = { 0xaa, 0xaa, 0x03, 0x00, 0x00, 0xf8 }; +u8 rtw_rfc1042_header[] = { 0xaa, 0xaa, 0x03, 0x00, 0x00, 0x00 }; +static u8 SNAP_ETH_TYPE_IPX[2] = {0x81, 0x37}; +static u8 SNAP_ETH_TYPE_APPLETALK_AARP[2] = {0x80, 0xf3}; +#ifdef CONFIG_TDLS +static u8 SNAP_ETH_TYPE_TDLS[2] = {0x89, 0x0d}; +#endif + +#ifdef CONFIG_CUSTOMER_ALIBABA_GENERAL +int recv_frame_monitor(_adapter *padapter, union recv_frame *rframe); +#endif void _rtw_init_sta_recv_priv(struct sta_recv_priv *psta_recvpriv) { @@ -81,7 +81,7 @@ sint _rtw_init_recv_priv(struct recv_priv *precvpriv, _adapter *padapter) #ifdef CONFIG_RECV_THREAD_MODE _rtw_init_sema(&precvpriv->recv_sema, 0); - _rtw_init_sema(&precvpriv->terminate_recvthread_sema, 0); + #endif _rtw_init_queue(&precvpriv->free_recv_queue); @@ -144,7 +144,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 */ @@ -165,7 +165,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); @@ -606,11 +605,12 @@ union recv_frame *decryptor(_adapter *padapter, union recv_frame *precv_frame) } } - if ((prxattrib->encrypt > 0) && ((prxattrib->bdecrypted == 0) || (psecuritypriv->sw_decrypt == _TRUE))) { - -#ifdef CONFIG_CONCURRENT_MODE - if (!IS_MCAST(prxattrib->ra)) /* bc/mc packets use sw decryption for concurrent mode */ -#endif + if (prxattrib->encrypt && !prxattrib->bdecrypted) { + if (GetFrameType(get_recvframe_data(precv_frame)) == WIFI_DATA + #ifdef CONFIG_CONCURRENT_MODE + && !IS_MCAST(prxattrib->ra) /* bc/mc packets may use sw decryption for concurrent mode */ + #endif + ) psecuritypriv->hw_decrypted = _FALSE; #ifdef DBG_RX_SW_DECRYPTOR @@ -691,6 +691,13 @@ union recv_frame *decryptor(_adapter *padapter, union recv_frame *precv_frame) #endif } + #ifdef CONFIG_RTW_MESH + if (res != _FAIL + && !prxattrib->amsdu + && prxattrib->mesh_ctrl_present) + res = rtw_mesh_rx_validate_mctrl_non_amsdu(padapter, precv_frame); + #endif + if (res == _FAIL) { rtw_free_recvframe(return_packet, &padapter->recvpriv.free_recv_queue); return_packet = NULL; @@ -772,48 +779,22 @@ 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 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) { - - return _FAIL; - } - - if (1) { /* if(bretry) */ - if (seq_ctrl == prxcache->tid_rxseq[tid]) { - /* for non-AMPDU case */ - precv_frame->u.hdr.psta->sta_stats.duplicate_cnt++; - - if (precv_frame->u.hdr.psta->sta_stats.duplicate_cnt % 100 == 0) - RTW_INFO("%s: seq=%d\n", __func__, precv_frame->u.hdr.attrib.seq_num); - - return _FAIL; - } - } - - prxcache->tid_rxseq[tid] = seq_ctrl; - - - return _SUCCESS; - -} - +/* 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 PN_EQUAL_CHK(a, b) (a == b) -sint recv_ucast_pn_decache(union recv_frame *precv_frame, struct stainfo_rxcache *prxcache); -sint recv_ucast_pn_decache(union recv_frame *precv_frame, struct stainfo_rxcache *prxcache) +#define VALID_PN_CHK(new, old) (((old) == 0) || PN_LESS_CHK(old, new)) +#define CCMPH_2_KEYID(ch) (((ch) & 0x00000000c0000000) >> 30) +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; @@ -821,29 +802,22 @@ sint recv_ucast_pn_decache(union recv_frame *precv_frame, struct stainfo_rxcache if (tid > 15) return _FAIL; - if (pattrib->encrypt == _AES_) { - _rtw_memcpy(&tmp_iv_hdr, (pdata + pattrib->hdrlen), 8); - tmp_iv_hdr = le64_to_cpu(tmp_iv_hdr); - pkt_pn = (tmp_iv_hdr & 0x000000000000ffff) | - ((tmp_iv_hdr & 0xffffffff00000000) >> 16); - - _rtw_memcpy(&tmp_iv_hdr, prxcache->iv[tid], 8); - tmp_iv_hdr = le64_to_cpu(tmp_iv_hdr); - curr_pn = (tmp_iv_hdr & 0x000000000000ffff) | - ((tmp_iv_hdr & 0xffffffff00000000) >> 16); - - if (curr_pn == 0) { - _rtw_memcpy(prxcache->iv[tid], (pdata + pattrib->hdrlen), sizeof(prxcache->iv[tid])); - goto exit; - } + 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 (PN_LESS_CHK(pkt_pn, curr_pn) || PN_EQUAL_CHK(pkt_pn, curr_pn)) { + if (!VALID_PN_CHK(pkt_pn, curr_pn)) { /* return _FAIL; */ - } else - _rtw_memcpy(prxcache->iv[tid], (pdata + pattrib->hdrlen), sizeof(prxcache->iv[tid])); + } else { + prxcache->last_tid = tid; + _rtw_memcpy(prxcache->iv[tid], + (pdata + pattrib->hdrlen), + sizeof(prxcache->iv[tid])); + } } -exit: return _SUCCESS; } @@ -855,94 +829,116 @@ sint recv_bcast_pn_decache(union recv_frame *precv_frame) 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)) { - _rtw_memcpy(&tmp_iv_hdr, (pdata + pattrib->hdrlen), 8); - tmp_iv_hdr = le64_to_cpu(tmp_iv_hdr); - key_id = ((tmp_iv_hdr & 0x00000000c0000000) >> 30); - pkt_pn = (tmp_iv_hdr & 0x000000000000ffff) | - ((tmp_iv_hdr & 0xffffffff00000000) >> 16); + (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE)) { - if (key_id >= 4 ) + 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; - - _rtw_memcpy(&tmp_iv_hdr, psecuritypriv->iv_seq[key_id], 8); - tmp_iv_hdr = le64_to_cpu(tmp_iv_hdr); - curr_pn = (tmp_iv_hdr & 0x0000ffffffffffff); - if ((curr_pn == 0) && (pkt_pn >= 0)) { - _rtw_memcpy(psecuritypriv->iv_seq[key_id], &pkt_pn, 8); - goto exit; - } - - if (PN_LESS_CHK(pkt_pn, curr_pn) || PN_EQUAL_CHK(pkt_pn, curr_pn)) { - return _FAIL; - } else - - _rtw_memcpy(psecuritypriv->iv_seq[key_id], &pkt_pn, 8); + *(u64*)psecuritypriv->iv_seq[key_id] = cpu_to_le64(pkt_pn); } -exit: return _SUCCESS; } -void process_pwrbit_data(_adapter *padapter, union recv_frame *precv_frame); -void process_pwrbit_data(_adapter *padapter, union recv_frame *precv_frame) +sint recv_decache(union recv_frame *precv_frame) +{ + struct sta_info *psta = precv_frame->u.hdr.psta; + struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; + _adapter *adapter = psta->padapter; + sint tid = pattrib->priority; + u16 seq_ctrl = ((precv_frame->u.hdr.attrib.seq_num & 0xffff) << 4) | + (precv_frame->u.hdr.attrib.frag_num & 0xf); + u16 *prxseq; + + if (tid > 15) + return _FAIL; + + if (pattrib->qos) { + if (IS_MCAST(pattrib->ra)) + prxseq = &psta->sta_recvpriv.bmc_tid_rxseq[tid]; + else + prxseq = &psta->sta_recvpriv.rxcache.tid_rxseq[tid]; + } else { + if (IS_MCAST(pattrib->ra)) { + prxseq = &psta->sta_recvpriv.nonqos_bmc_rxseq; + #ifdef DBG_RX_SEQ + RTW_INFO("DBG_RX_SEQ "FUNC_ADPT_FMT" nonqos bmc seq_num:%d\n" + , FUNC_ADPT_ARG(adapter), pattrib->seq_num); + #endif + + } else { + prxseq = &psta->sta_recvpriv.nonqos_rxseq; + #ifdef DBG_RX_SEQ + RTW_INFO("DBG_RX_SEQ "FUNC_ADPT_FMT" nonqos seq_num:%d\n" + , FUNC_ADPT_ARG(adapter), pattrib->seq_num); + #endif + } + } + + if (seq_ctrl == *prxseq) { + /* for non-AMPDU case */ + psta->sta_stats.duplicate_cnt++; + + if (psta->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); + + #ifdef DBG_RX_DROP_FRAME + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" recv_decache _FAIL for sta="MAC_FMT"\n" + , FUNC_ADPT_ARG(adapter), MAC_ARG(psta->cmn.mac_addr)); + #endif + return _FAIL; + } + *prxseq = seq_ctrl; + + 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; */ + /* rtw_tim_map_set(padapter, pstapriv->sta_dz_bitmap, BIT(psta->cmn.aid)); */ - 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); */ - } + stop_sta_xmit(padapter, psta); + /* RTW_INFO_DUMP("to sleep, sta_dz_bitmap=", pstapriv->sta_dz_bitmap, pstapriv->aid_bmp_len); */ } + } else { + if (psta->state & WIFI_SLEEP_STATE) { + /* psta->state ^= WIFI_SLEEP_STATE; */ + /* rtw_tim_map_clear(padapter, pstapriv->sta_dz_bitmap, BIT(psta->cmn.aid)); */ + wakeup_sta_to_xmit(padapter, psta); + /* RTW_INFO_DUMP("to wakeup, sta_dz_bitmap=", pstapriv->sta_dz_bitmap, pstapriv->aid_bmp_len); */ + } } - #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)) { @@ -987,7 +983,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, 0); } } @@ -1009,6 +1005,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 @@ -1026,41 +1025,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 @@ -1095,7 +1107,6 @@ sint OnTDLS(_adapter *adapter, union recv_frame *precv_frame) } #endif /* CONFIG_TDLS */ -void count_rx_stats(_adapter *padapter, union recv_frame *prframe, struct sta_info *sta); void count_rx_stats(_adapter *padapter, union recv_frame *prframe, struct sta_info *sta) { int sz; @@ -1103,8 +1114,6 @@ void count_rx_stats(_adapter *padapter, union recv_frame *prframe, struct sta_in struct stainfo_stats *pstats = NULL; struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; struct recv_priv *precvpriv = &padapter->recvpriv; - struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); sz = get_recvframe_len(prframe); precvpriv->rx_bytes += sz; @@ -1120,39 +1129,45 @@ 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->last_rx_time = rtw_get_current_time(); pstats->rx_data_pkts++; pstats->rx_bytes += sz; - - pstats->rxratecnt[pattrib->data_rate]++; - /*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; } -#endif /* CONFIG_TDLS */ + + if (!is_ra_bmc) { + pstats->rxratecnt[pattrib->data_rate]++; + /*record rx packets for every tid*/ + pstats->rx_data_qos_pkts[pattrib->priority]++; + } +#ifdef CONFIG_DYNAMIC_SOML + rtw_dyn_soml_byte_update(padapter, pattrib->data_rate, sz); +#endif +#if defined(CONFIG_CHECK_LEAVE_LPS) && defined(CONFIG_LPS_CHK_BY_TP) + if (adapter_to_pwrctl(padapter)->lps_chk_by_tp) + traffic_check_for_leave_lps_by_tp(padapter, _FALSE, psta); +#endif /* CONFIG_LPS */ + } #ifdef CONFIG_CHECK_LEAVE_LPS - traffic_check_for_leave_lps(padapter, _FALSE, 0); -#endif /* CONFIG_LPS */ +#ifdef CONFIG_LPS_CHK_BY_TP + if (!adapter_to_pwrctl(padapter)->lps_chk_by_tp) +#endif + traffic_check_for_leave_lps(padapter, _FALSE, 0); +#endif /* CONFIG_CHECK_LEAVE_LPS */ } -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, @@ -1166,7 +1181,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 @@ -1204,14 +1219,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; @@ -1246,7 +1259,7 @@ 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 ((get_frame_sub_type(ptr) & WIFI_DATA_NULL) == WIFI_DATA_NULL) { @@ -1272,14 +1285,11 @@ sint sta2sta_data_frame( } if ((get_frame_sub_type(ptr) & WIFI_QOS_DATA_TYPE) == WIFI_QOS_DATA_TYPE) - process_wmmps_data(adapter, precv_frame); + 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 */ { @@ -1288,8 +1298,6 @@ sint sta2sta_data_frame( ret = _FAIL; goto exit; } - - sta_addr = pattrib->bssid; } } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { @@ -1305,8 +1313,6 @@ sint sta2sta_data_frame( ret = _FAIL; goto exit; } - - sta_addr = pattrib->src; } } else if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE) { @@ -1320,17 +1326,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 @@ -1348,10 +1347,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, @@ -1374,19 +1369,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; } @@ -1396,29 +1392,28 @@ 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 - - if (!bmcast) { + #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 +#ifndef CONFIG_CUSTOMER_ALIBABA_GENERAL + if (!bmcast + && !IS_RADAR_DETECTED(adapter_to_rfctl(adapter)) + ) { RTW_INFO(ADPT_FMT" -issue_deauth to the nonassociated ap=" MAC_FMT " for the reason(7)\n", ADPT_ARG(adapter), MAC_ARG(pattrib->bssid)); issue_deauth(adapter, pattrib->bssid, WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA); } - +#endif ret = _FAIL; 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; } @@ -1445,9 +1440,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; } @@ -1459,11 +1455,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)); */ @@ -1478,9 +1474,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: @@ -1490,10 +1487,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, @@ -1514,31 +1507,23 @@ 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); - - /* prevent RX tasklet blocks cmd_thread */ - if (rfctl->radar_detected == 1) - goto bypass_deauth7; - #endif - - RTW_INFO("issue_deauth to sta=" MAC_FMT " for the reason(7)\n", MAC_ARG(pattrib->src)); - - issue_deauth(adapter, pattrib->src, WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA); - -#ifdef CONFIG_DFS_MASTER -bypass_deauth7: + if (!IS_RADAR_DETECTED(adapter_to_rfctl(adapter))) { +#ifndef CONFIG_CUSTOMER_ALIBABA_GENERAL + RTW_INFO("issue_deauth to sta=" MAC_FMT " for the reason(7)\n", MAC_ARG(pattrib->src)); + issue_deauth(adapter, pattrib->src, WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA); #endif + } + ret = RTW_RX_HANDLED; goto exit; } - process_pwrbit_data(adapter, precv_frame); + process_pwrbit_data(adapter, precv_frame, *psta); if ((get_frame_sub_type(ptr) & WIFI_QOS_DATA_TYPE) == WIFI_QOS_DATA_TYPE) - process_wmmps_data(adapter, precv_frame); + process_wmmps_data(adapter, precv_frame, *psta); if (get_frame_sub_type(ptr) & BIT(6)) { /* No data, will not indicate to upper layer, temporily count it here */ @@ -1558,9 +1543,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; } @@ -1571,8 +1557,10 @@ sint sta2ap_data_frame( ret = RTW_RX_HANDLED; goto exit; } +#ifndef CONFIG_CUSTOMER_ALIBABA_GENERAL RTW_INFO("issue_deauth to sta=" MAC_FMT " for the reason(7)\n", MAC_ARG(pattrib->src)); issue_deauth(adapter, pattrib->src, WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA); +#endif ret = RTW_RX_HANDLED; goto exit; } @@ -1607,6 +1595,7 @@ sint validate_recv_ctrl_frame(_adapter *padapter, union recv_frame *precv_frame) return _FAIL; /* for rx pkt statistics */ + psta->sta_stats.last_rx_time = rtw_get_current_time(); psta->sta_stats.rx_ctrl_pkts++; /* only handle ps-poll */ @@ -1616,7 +1605,7 @@ sint validate_recv_ctrl_frame(_adapter *padapter, union recv_frame *precv_frame) u8 wmmps_ac = 0; aid = GetAid(pframe); - if (psta->aid != aid) + if (psta->cmn.aid != aid) return _FAIL; switch (pattrib->priority) { @@ -1648,7 +1637,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) && (rtw_tim_map_is_set(padapter, pstapriv->sta_dz_bitmap, psta->cmn.aid))) { _irqL irqL; _list *xmitframe_plist, *xmitframe_phead; struct xmit_frame *pxmitframe = NULL; @@ -1676,7 +1665,8 @@ sint validate_recv_ctrl_frame(_adapter *padapter, union recv_frame *precv_frame) pxmitframe->attrib.triggered = 1; - /* RTW_INFO("handling ps-poll, q_len=%d, tim=%x\n", psta->sleepq_len, pstapriv->tim_bitmap); */ + /* RTW_INFO("handling ps-poll, q_len=%d\n", psta->sleepq_len); */ + /* RTW_INFO_DUMP("handling, tim=", pstapriv->tim_bitmap, pstapriv->aid_bmp_len); */ #if 0 _exit_critical_bh(&psta->sleep_q.lock, &irqL); @@ -1687,9 +1677,10 @@ 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); + rtw_tim_map_clear(padapter, pstapriv->tim_bitmap, psta->cmn.aid); - /* RTW_INFO("after handling ps-poll, tim=%x\n", pstapriv->tim_bitmap); */ + /* RTW_INFO("after handling ps-poll\n"); */ + /* RTW_INFO_DUMP("after handling, tim=", pstapriv->tim_bitmap, pstapriv->aid_bmp_len); */ /* upate BCN for TIM IE */ /* update_BCNTIM(padapter); */ @@ -1704,18 +1695,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 (rtw_tim_map_is_set(padapter, pstapriv->tim_bitmap, 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); + rtw_tim_map_clear(padapter, pstapriv->tim_bitmap, psta->cmn.aid); /* upate BCN for TIM IE */ /* update_BCNTIM(padapter); */ @@ -1726,241 +1717,420 @@ sint validate_recv_ctrl_frame(_adapter *padapter, union recv_frame *precv_frame) #endif /* CONFIG_AP_MODE */ } 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*/ + } else if (get_frame_sub_type(pframe) == WIFI_BAR) { + rtw_process_bar_frame(padapter, precv_frame); } return _FAIL; } +#if defined(CONFIG_IEEE80211W) || defined(CONFIG_RTW_MESH) +static sint validate_mgmt_protect(_adapter *adapter, union recv_frame *precv_frame) +{ +#define DBG_VALIDATE_MGMT_PROTECT 0 +#define DBG_VALIDATE_MGMT_DEC 0 + + struct security_priv *sec = &adapter->securitypriv; + struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; + struct sta_info *psta = precv_frame->u.hdr.psta; + u8 *ptr; + u8 type; + u8 subtype; + u8 is_bmc; + u8 category = 0xFF; + +#ifdef CONFIG_IEEE80211W + const u8 *igtk; + u16 igtk_id; + u64* ipn; +#endif + + u8 *mgmt_DATA; + u32 data_len = 0; + + sint ret; + +#ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(adapter)) { + if (!adapter->mesh_info.mesh_auth_id) + return pattrib->privacy ? _FAIL : _SUCCESS; + } else +#endif + if (SEC_IS_BIP_KEY_INSTALLED(sec) == _FALSE) + return _SUCCESS; + + ptr = precv_frame->u.hdr.rx_data; + type = GetFrameType(ptr); + subtype = get_frame_sub_type(ptr); /* bit(7)~bit(2) */ + is_bmc = IS_MCAST(GetAddr1Ptr(ptr)); + +#if DBG_VALIDATE_MGMT_PROTECT + if (subtype == WIFI_DEAUTH) { + RTW_INFO(FUNC_ADPT_FMT" bmc:%u, deauth, privacy:%u, encrypt:%u, bdecrypted:%u\n" + , FUNC_ADPT_ARG(adapter) + , is_bmc, pattrib->privacy, pattrib->encrypt, pattrib->bdecrypted); + } else if (subtype == WIFI_DISASSOC) { + RTW_INFO(FUNC_ADPT_FMT" bmc:%u, disassoc, privacy:%u, encrypt:%u, bdecrypted:%u\n" + , FUNC_ADPT_ARG(adapter) + , is_bmc, pattrib->privacy, pattrib->encrypt, pattrib->bdecrypted); + } if (subtype == WIFI_ACTION) { + if (pattrib->privacy) { + RTW_INFO(FUNC_ADPT_FMT" bmc:%u, action(?), privacy:%u, encrypt:%u, bdecrypted:%u\n" + , FUNC_ADPT_ARG(adapter) + , is_bmc, pattrib->privacy, pattrib->encrypt, pattrib->bdecrypted); + } else { + RTW_INFO(FUNC_ADPT_FMT" bmc:%u, action(%u), privacy:%u, encrypt:%u, bdecrypted:%u\n" + , FUNC_ADPT_ARG(adapter), is_bmc + , *(ptr + sizeof(struct rtw_ieee80211_hdr_3addr)) + , pattrib->privacy, pattrib->encrypt, pattrib->bdecrypted); + } + } +#endif + + if (!pattrib->privacy) { + if (!psta || !(psta->flags & WLAN_STA_MFP)) { + /* peer is not MFP capable, no need to check */ + goto exit; + } + + if (subtype == WIFI_ACTION) + category = *(ptr + sizeof(struct rtw_ieee80211_hdr_3addr)); + + if (is_bmc) { + /* broadcast cases */ + if (subtype == WIFI_ACTION) { + if (CATEGORY_IS_GROUP_PRIVACY(category)) { + /* drop broadcast group privacy action frame without encryption */ + #if DBG_VALIDATE_MGMT_PROTECT + RTW_INFO(FUNC_ADPT_FMT" broadcast gp action(%u) w/o encrypt\n" + , FUNC_ADPT_ARG(adapter), category); + #endif + goto fail; + } + if (CATEGORY_IS_ROBUST(category)) { + /* broadcast robust action frame need BIP check */ + goto bip_verify; + } + } + if (subtype == WIFI_DEAUTH || subtype == WIFI_DISASSOC) { + /* broadcast deauth or disassoc frame need BIP check */ + goto bip_verify; + } + goto exit; + + } else { + /* unicast cases */ + #ifdef CONFIG_IEEE80211W + if (subtype == WIFI_DEAUTH || subtype == WIFI_DISASSOC) { + if (!MLME_IS_MESH(adapter)) { + unsigned short reason = le16_to_cpu(*(unsigned short *)(ptr + WLAN_HDR_A3_LEN)); + + #if DBG_VALIDATE_MGMT_PROTECT + RTW_INFO(FUNC_ADPT_FMT" unicast %s, reason=%d w/o encrypt\n" + , FUNC_ADPT_ARG(adapter), subtype == WIFI_DEAUTH ? "deauth" : "disassoc", reason); + #endif + if (reason == 6 || reason == 7) { + /* issue sa query request */ + issue_action_SA_Query(adapter, psta->cmn.mac_addr, 0, 0, IEEE80211W_RIGHT_KEY); + } + } + goto fail; + } + #endif + + if (subtype == WIFI_ACTION && CATEGORY_IS_ROBUST(category)) { + if (psta->bpairwise_key_installed == _TRUE) { + #if DBG_VALIDATE_MGMT_PROTECT + RTW_INFO(FUNC_ADPT_FMT" unicast robust action(%d) w/o encrypt\n" + , FUNC_ADPT_ARG(adapter), category); + #endif + goto fail; + } + } + goto exit; + } + +bip_verify: +#ifdef CONFIG_IEEE80211W + #ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(adapter)) { + if (psta->igtk_bmp) { + igtk = psta->igtk.skey; + igtk_id = psta->igtk_id; + ipn = &psta->igtk_pn.val; + } else { + /* mesh MFP without IGTK */ + goto exit; + } + } else + #endif + { + igtk = sec->dot11wBIPKey[sec->dot11wBIPKeyid].skey; + igtk_id = sec->dot11wBIPKeyid; + ipn = &sec->dot11wBIPrxpn.val; + } + + /* verify BIP MME IE */ + ret = rtw_BIP_verify(adapter + , get_recvframe_data(precv_frame) + , get_recvframe_len(precv_frame) + , igtk, igtk_id, ipn); + if (ret == _FAIL) { + /* RTW_INFO("802.11w BIP verify fail\n"); */ + goto fail; + + } else if (ret == RTW_RX_HANDLED) { + #if DBG_VALIDATE_MGMT_PROTECT + RTW_INFO(FUNC_ADPT_FMT" none protected packet\n", FUNC_ADPT_ARG(adapter)); + #endif + goto fail; + } +#endif /* CONFIG_IEEE80211W */ + goto exit; + } + + /* cases to decrypt mgmt frame */ + pattrib->bdecrypted = 0; + pattrib->encrypt = _AES_; + pattrib->hdrlen = sizeof(struct rtw_ieee80211_hdr_3addr); + + /* 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, 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); + if (mgmt_DATA == NULL) { + RTW_INFO(FUNC_ADPT_FMT" mgmt allocate fail !!!!!!!!!\n", FUNC_ADPT_ARG(adapter)); + goto fail; + } + +#if DBG_VALIDATE_MGMT_DEC + /* dump the packet content before decrypt */ + { + int pp; + + printk("pattrib->pktlen = %d =>", pattrib->pkt_len); + for (pp = 0; pp < pattrib->pkt_len; pp++) + printk(" %02x ", ptr[pp]); + printk("\n"); + } +#endif + + precv_frame = decryptor(adapter, precv_frame); + /* save actual management data frame body */ + _rtw_memcpy(mgmt_DATA, ptr + pattrib->hdrlen + pattrib->iv_len, data_len); + /* overwrite the iv field */ + _rtw_memcpy(ptr + pattrib->hdrlen, mgmt_DATA, data_len); + /* remove the iv and icv length */ + pattrib->pkt_len = pattrib->pkt_len - pattrib->iv_len - pattrib->icv_len; + rtw_mfree(mgmt_DATA, data_len); + +#if DBG_VALIDATE_MGMT_DEC + /* print packet content after decryption */ + { + int pp; + + printk("after decryption pattrib->pktlen = %d @@=>", pattrib->pkt_len); + for (pp = 0; pp < pattrib->pkt_len; pp++) + printk(" %02x ", ptr[pp]); + printk("\n"); + } +#endif + + if (!precv_frame) { + #if DBG_VALIDATE_MGMT_PROTECT + RTW_INFO(FUNC_ADPT_FMT" mgmt descrypt fail !!!!!!!!!\n", FUNC_ADPT_ARG(adapter)); + #endif + goto fail; + } + +exit: + return _SUCCESS; + +fail: + return _FAIL; + +} +#endif /* defined(CONFIG_IEEE80211W) || defined(CONFIG_RTW_MESH) */ + union recv_frame *recvframe_chk_defrag(PADAPTER padapter, union recv_frame *precv_frame); -sint validate_recv_mgnt_frame(PADAPTER padapter, union recv_frame *precv_frame); + sint validate_recv_mgnt_frame(PADAPTER padapter, union recv_frame *precv_frame) { - /* struct mlme_priv *pmlmepriv = &adapter->mlmepriv; */ + struct sta_info *psta = precv_frame->u.hdr.psta + = rtw_get_stainfo(&padapter->stapriv, get_addr2_ptr(precv_frame->u.hdr.rx_data)); - -#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); +#if defined(CONFIG_IEEE80211W) || defined(CONFIG_RTW_MESH) + if (validate_mgmt_protect(padapter, precv_frame) == _FAIL) { + DBG_COUNTER(padapter->rx_logs.core_rx_pre_mgmt_err_80211w); + goto exit; + } #endif precv_frame = recvframe_chk_defrag(padapter, precv_frame); - if (precv_frame == NULL) { + if (precv_frame == NULL) return _SUCCESS; - } - { - /* for rx pkt statistics */ - 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 (get_frame_sub_type(precv_frame->u.hdr.rx_data) == WIFI_BEACON) - psta->sta_stats.rx_beacon_pkts++; - else if (get_frame_sub_type(precv_frame->u.hdr.rx_data) == WIFI_PROBEREQ) - psta->sta_stats.rx_probereq_pkts++; - 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)) - || is_multicast_mac_addr(GetAddr1Ptr(precv_frame->u.hdr.rx_data))) - psta->sta_stats.rx_probersp_bm_pkts++; - else - psta->sta_stats.rx_probersp_uo_pkts++; - } + /* for rx pkt statistics */ + if (psta) { + psta->sta_stats.last_rx_time = rtw_get_current_time(); + psta->sta_stats.rx_mgnt_pkts++; + if (get_frame_sub_type(precv_frame->u.hdr.rx_data) == WIFI_BEACON) + psta->sta_stats.rx_beacon_pkts++; + else if (get_frame_sub_type(precv_frame->u.hdr.rx_data) == WIFI_PROBEREQ) + psta->sta_stats.rx_probereq_pkts++; + 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)) + || is_multicast_mac_addr(GetAddr1Ptr(precv_frame->u.hdr.rx_data))) + psta->sta_stats.rx_probersp_bm_pkts++; + else + psta->sta_stats.rx_probersp_uo_pkts++; } } -#ifdef CONFIG_INTEL_PROXIM - if (padapter->proximity.proxim_on == _TRUE) { - struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; - struct recv_stat *prxstat = (struct recv_stat *) precv_frame->u.hdr.rx_head ; - u8 *pda, *psa, *pbssid, *ptr; - ptr = precv_frame->u.hdr.rx_data; - pda = get_da(ptr); - psa = get_sa(ptr); - pbssid = get_hdr_bssid(ptr); - - - _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); - break; - - case 1: - _rtw_memcpy(pattrib->ra, pda, ETH_ALEN); - _rtw_memcpy(pattrib->ta, pbssid, ETH_ALEN); - break; - - case 2: - _rtw_memcpy(pattrib->ra, pbssid, ETH_ALEN); - _rtw_memcpy(pattrib->ta, psa, ETH_ALEN); - break; - - case 3: - _rtw_memcpy(pattrib->ra, GetAddr1Ptr(ptr), ETH_ALEN); - _rtw_memcpy(pattrib->ta, get_addr2_ptr(ptr), ETH_ALEN); - break; - - default: - break; - - } - pattrib->priority = 0; - pattrib->hdrlen = pattrib->to_fr_ds == 3 ? 30 : 24; - - padapter->proximity.proxim_rx(padapter, precv_frame); - } -#endif mgt_dispatcher(padapter, precv_frame); +#if defined(CONFIG_IEEE80211W) || defined(CONFIG_RTW_MESH) +exit: +#endif return _SUCCESS; } -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; + u8 bretry, a4_shift; struct sta_info *psta = NULL; u8 *ptr = precv_frame->u.hdr.rx_data; struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; - struct sta_priv *pstapriv = &adapter->stapriv; 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); + a4_shift = (pattrib->to_fr_ds == 3) ? ETH_ALEN : 0; - if (pbssid == NULL) { -#ifdef DBG_RX_DROP_FRAME - RTW_INFO("DBG_RX_DROP_FRAME %s pbssid == NULL\n", __func__); -#endif - ret = _FAIL; - goto exit; + /* some address fields are different when using AMSDU */ + if (pattrib->qos) + pattrib->amsdu = GetAMsdu(ptr + WLAN_HDR_A3_LEN + a4_shift); + else + pattrib->amsdu = 0; + +#ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(adapter)) { + ret = rtw_mesh_rx_data_validate_hdr(adapter, precv_frame, &psta); + goto pre_validate_status_chk; } - - _rtw_memcpy(pattrib->dst, pda, ETH_ALEN); - _rtw_memcpy(pattrib->src, psa, ETH_ALEN); - - _rtw_memcpy(pattrib->bssid, pbssid, ETH_ALEN); +#endif 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, get_addr2_ptr(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); +#ifdef CONFIG_RTW_MESH +pre_validate_status_chk: #endif + if (ret == _FAIL) { + #ifdef DBG_RX_DROP_FRAME + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" case:%d, res:%d, ra="MAC_FMT", ta="MAC_FMT"\n" + , FUNC_ADPT_ARG(adapter), pattrib->to_fr_ds, ret, MAC_ARG(GetAddr1Ptr(ptr)), MAC_ARG(get_addr2_ptr(ptr))); + #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(GetAddr1Ptr(ptr)), MAC_ARG(get_addr2_ptr(ptr))); + #endif ret = _FAIL; goto exit; } - /* psta->rssi = prxcmd->rssi; */ - /* psta->signal_quality= prxcmd->sq; */ precv_frame->u.hdr.psta = psta; - - - pattrib->amsdu = 0; + precv_frame->u.hdr.preorder_ctrl = NULL; pattrib->ack_policy = 0; + /* parsing QC field */ if (pattrib->qos == 1) { - pattrib->priority = GetPriority((ptr + 24)); - pattrib->ack_policy = GetAckpolicy((ptr + 24)); - pattrib->amsdu = GetAMsdu((ptr + 24)); - pattrib->hdrlen = pattrib->to_fr_ds == 3 ? 32 : 26; - + pattrib->priority = GetPriority((ptr + WLAN_HDR_A3_LEN + a4_shift)); /* point to Qos field*/ + pattrib->ack_policy = GetAckpolicy((ptr + WLAN_HDR_A3_LEN + a4_shift)); + pattrib->hdrlen = WLAN_HDR_A3_QOS_LEN + a4_shift; if (pattrib->priority != 0 && pattrib->priority != 3) adapter->recvpriv.is_any_non_be_pkts = _TRUE; else adapter->recvpriv.is_any_non_be_pkts = _FALSE; } else { pattrib->priority = 0; - pattrib->hdrlen = pattrib->to_fr_ds == 3 ? 30 : 24; + pattrib->hdrlen = WLAN_HDR_A3_LEN + a4_shift; } - if (pattrib->order) /* HT-CTRL 11n */ pattrib->hdrlen += 4; - 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; + ret = recv_decache(precv_frame); + if (ret == _FAIL) goto exit; - } if (!IS_MCAST(pattrib->ra)) { - if (recv_ucast_pn_decache(precv_frame, &psta->sta_recvpriv.rxcache) == _FAIL) { + + if (pattrib->qos) + precv_frame->u.hdr.preorder_ctrl = &psta->recvreorder_ctrl[pattrib->priority]; + + if (recv_ucast_pn_decache(precv_frame) == _FAIL) { #ifdef DBG_RX_DROP_FRAME - RTW_INFO("DBG_RX_DROP_FRAME %s recv_decache return _FAIL\n", __func__); + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" recv_ucast_pn_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)); + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" recv_bcast_pn_decache return _FAIL for sta="MAC_FMT"\n" + , FUNC_ADPT_ARG(adapter), MAC_ARG(psta->cmn.mac_addr)); #endif ret = _FAIL; goto exit; @@ -1968,8 +2138,6 @@ sint validate_recv_data_frame(_adapter *adapter, union recv_frame *precv_frame) } if (pattrib->privacy) { - - #ifdef CONFIG_TDLS if ((psta->tdls_sta_state & TDLS_LINKED_STATE) && (psta->dot118021XPrivacy == _AES_)) pattrib->encrypt = psta->dot118021XPrivacy; @@ -1984,129 +2152,17 @@ sint validate_recv_data_frame(_adapter *adapter, union recv_frame *precv_frame) pattrib->iv_len = pattrib->icv_len = 0; } +#ifdef CONFIG_RTW_MESH + if (!pattrib->amsdu + && pattrib->mesh_ctrl_present + && (!pattrib->encrypt || pattrib->bdecrypted)) + ret = rtw_mesh_rx_validate_mctrl_non_amsdu(adapter, precv_frame); +#endif + exit: - - return ret; } -#ifdef CONFIG_IEEE80211W -static sint validate_80211w_mgmt(_adapter *adapter, union recv_frame *precv_frame) -{ - struct mlme_priv *pmlmepriv = &adapter->mlmepriv; - struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; - u8 *ptr = precv_frame->u.hdr.rx_data; - struct sta_info *psta; - struct sta_priv *pstapriv = &adapter->stapriv; - u8 type; - u8 subtype; - - type = GetFrameType(ptr); - subtype = get_frame_sub_type(ptr); /* bit(7)~bit(2) */ - - if (adapter->securitypriv.binstallBIPkey == _TRUE) { - /* unicast management frame decrypt */ - if (pattrib->privacy && !(IS_MCAST(GetAddr1Ptr(ptr))) && - (subtype == WIFI_DEAUTH || subtype == WIFI_DISASSOC || subtype == WIFI_ACTION)) { - u8 *ppp, *mgmt_DATA; - u32 data_len = 0; - ppp = get_addr2_ptr(ptr); - - pattrib->bdecrypted = 0; - pattrib->encrypt = _AES_; - pattrib->hdrlen = sizeof(struct rtw_ieee80211_hdr_3addr); - /* 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, 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); - if (mgmt_DATA == NULL) { - RTW_INFO("%s mgmt allocate fail !!!!!!!!!\n", __FUNCTION__); - goto validate_80211w_fail; - } -#if 0 - /* dump the packet content before decrypt */ - { - int pp; - printk("pattrib->pktlen = %d =>", pattrib->pkt_len); - for (pp = 0; pp < pattrib->pkt_len; pp++) - printk(" %02x ", ptr[pp]); - printk("\n"); - } -#endif - - precv_frame = decryptor(adapter, precv_frame); - /* save actual management data frame body */ - _rtw_memcpy(mgmt_DATA, ptr + pattrib->hdrlen + pattrib->iv_len, data_len); - /* overwrite the iv field */ - _rtw_memcpy(ptr + pattrib->hdrlen, mgmt_DATA, data_len); - /* remove the iv and icv length */ - pattrib->pkt_len = pattrib->pkt_len - pattrib->iv_len - pattrib->icv_len; - rtw_mfree(mgmt_DATA, data_len); -#if 0 - /* print packet content after decryption */ - { - int pp; - printk("after decryption pattrib->pktlen = %d @@=>", pattrib->pkt_len); - for (pp = 0; pp < pattrib->pkt_len; pp++) - printk(" %02x ", ptr[pp]); - printk("\n"); - } -#endif - if (!precv_frame) { - RTW_INFO("%s mgmt descrypt fail !!!!!!!!!\n", __FUNCTION__); - goto validate_80211w_fail; - } - } else if (IS_MCAST(GetAddr1Ptr(ptr)) && - (subtype == WIFI_DEAUTH || subtype == WIFI_DISASSOC)) { - sint BIP_ret = _SUCCESS; - /* verify BIP MME IE of broadcast/multicast de-auth/disassoc packet */ - BIP_ret = rtw_BIP_verify(adapter, (u8 *)precv_frame); - if (BIP_ret == _FAIL) { - /* RTW_INFO("802.11w BIP verify fail\n"); */ - goto validate_80211w_fail; - } else if (BIP_ret == RTW_RX_HANDLED) { - RTW_INFO("802.11w recv none protected packet\n"); - /* drop pkt, don't issue sa query request */ - /* issue_action_SA_Query(adapter, NULL, 0, 0, 0); */ - goto validate_80211w_fail; - } - } /* 802.11w protect */ - else { - 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 */ - if (ptr[WLAN_HDR_A3_LEN] != RTW_WLAN_CATEGORY_PUBLIC && - ptr[WLAN_HDR_A3_LEN] != RTW_WLAN_CATEGORY_HT && - ptr[WLAN_HDR_A3_LEN] != RTW_WLAN_CATEGORY_UNPROTECTED_WNM && - ptr[WLAN_HDR_A3_LEN] != RTW_WLAN_CATEGORY_SELF_PROTECTED && - ptr[WLAN_HDR_A3_LEN] != RTW_WLAN_CATEGORY_P2P) { - RTW_INFO("action frame category=%d should robust\n", ptr[WLAN_HDR_A3_LEN]); - goto validate_80211w_fail; - } - } else if (subtype == WIFI_DEAUTH || subtype == WIFI_DISASSOC) { - unsigned short reason; - reason = le16_to_cpu(*(unsigned short *)(ptr + WLAN_HDR_A3_LEN)); - RTW_INFO("802.11w recv none protected packet, reason=%d\n", reason); - if (reason == 6 || reason == 7) { - /* issue sa query request */ - issue_action_SA_Query(adapter, NULL, 0, 0, IEEE80211W_RIGHT_KEY); - } - goto validate_80211w_fail; - } - } - } - return _SUCCESS; - -validate_80211w_fail: - return _FAIL; - -} -#endif /* CONFIG_IEEE80211W */ - static inline void dump_rx_packet(u8 *ptr) { int i; @@ -2130,10 +2186,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 @@ -2151,9 +2209,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 @@ -2216,14 +2274,6 @@ sint validate_recv_frame(_adapter *adapter, union recv_frame *precv_frame) switch (type) { case WIFI_MGT_TYPE: /* mgnt */ DBG_COUNTER(adapter->rx_logs.core_rx_pre_mgmt); -#ifdef CONFIG_IEEE80211W - if (validate_80211w_mgmt(adapter, precv_frame) == _FAIL) { - retval = _FAIL; - DBG_COUNTER(adapter->rx_logs.core_rx_pre_mgmt_err_80211w); - break; - } -#endif /* CONFIG_IEEE80211W */ - retval = validate_recv_mgnt_frame(adapter, precv_frame); if (retval == _FAIL) { DBG_COUNTER(adapter->rx_logs.core_rx_pre_mgmt_err); @@ -2273,30 +2323,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 + RATTRIB_GET_MCTRL_LEN(pattrib) + 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; } @@ -2309,9 +2361,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; @@ -2331,8 +2380,8 @@ sint wlanhdr_to_ethhdr(union recv_frame *precvframe) if (pattrib->encrypt) recvframe_pull_tail(precvframe, pattrib->icv_len); - psnap = (struct ieee80211_snap_hdr *)(ptr + pattrib->hdrlen + pattrib->iv_len); - psnap_type = ptr + pattrib->hdrlen + pattrib->iv_len + SNAP_SIZE; + psnap = (struct ieee80211_snap_hdr *)(ptr + pattrib->hdrlen + pattrib->iv_len + RATTRIB_GET_MCTRL_LEN(pattrib)); + psnap_type = ptr + pattrib->hdrlen + pattrib->iv_len + RATTRIB_GET_MCTRL_LEN(pattrib) + SNAP_SIZE; /* convert hdr + possible LLC headers into Ethernet header */ /* eth_type = (psnap_type[0] << 8) | psnap_type[1]; */ if ((_rtw_memcmp(psnap, rtw_rfc1042_header, SNAP_SIZE) && @@ -2347,7 +2396,7 @@ sint wlanhdr_to_ethhdr(union recv_frame *precvframe) bsnaphdr = _FALSE; } - rmv_len = pattrib->hdrlen + pattrib->iv_len + (bsnaphdr ? SNAP_SIZE : 0); + rmv_len = pattrib->hdrlen + pattrib->iv_len + RATTRIB_GET_MCTRL_LEN(pattrib) + (bsnaphdr ? SNAP_SIZE : 0); len = precvframe->u.hdr.len - rmv_len; @@ -2355,37 +2404,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 ; @@ -2417,6 +2435,8 @@ sint wlanhdr_to_ethhdr(union recv_frame *precvframe) len = htons(len); _rtw_memcpy(ptr + 12, &len, 2); } + + rtw_rframe_set_os_pkt(precvframe); } exiting: @@ -2424,121 +2444,8 @@ sint wlanhdr_to_ethhdr(union recv_frame *precvframe) } -#else - -sint wlanhdr_to_ethhdr(union recv_frame *precvframe) -{ - sint rmv_len; - u16 eth_type; - u8 bsnaphdr; - u8 *psnap_type; - struct ieee80211_snap_hdr *psnap; - - sint ret = _SUCCESS; - _adapter *adapter = precvframe->u.hdr.adapter; - struct mlme_priv *pmlmepriv = &adapter->mlmepriv; - - u8 *ptr = get_recvframe_data(precvframe) ; /* point to frame_ctrl field */ - struct rx_pkt_attrib *pattrib = &precvframe->u.hdr.attrib; - struct _vlan *pvlan = NULL; - - - psnap = (struct ieee80211_snap_hdr *)(ptr + pattrib->hdrlen + pattrib->iv_len); - psnap_type = ptr + pattrib->hdrlen + pattrib->iv_len + SNAP_SIZE; - if (psnap->dsap == 0xaa && psnap->ssap == 0xaa && psnap->ctrl == 0x03) { - if (_rtw_memcmp(psnap->oui, oui_rfc1042, WLAN_IEEE_OUI_LEN)) - bsnaphdr = _TRUE; /* wlan_pkt_format = WLAN_PKT_FORMAT_SNAP_RFC1042; */ - else if (_rtw_memcmp(psnap->oui, SNAP_HDR_APPLETALK_DDP, WLAN_IEEE_OUI_LEN) && - _rtw_memcmp(psnap_type, SNAP_ETH_TYPE_APPLETALK_DDP, 2)) - bsnaphdr = _TRUE; /* wlan_pkt_format = WLAN_PKT_FORMAT_APPLETALK; */ - else if (_rtw_memcmp(psnap->oui, oui_8021h, WLAN_IEEE_OUI_LEN)) - bsnaphdr = _TRUE; /* wlan_pkt_format = WLAN_PKT_FORMAT_SNAP_TUNNEL; */ - else { - ret = _FAIL; - goto exit; - } - - } else - bsnaphdr = _FALSE; /* wlan_pkt_format = WLAN_PKT_FORMAT_OTHERS; */ - - rmv_len = pattrib->hdrlen + pattrib->iv_len + (bsnaphdr ? SNAP_SIZE : 0); - - if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE) { - ptr += rmv_len ; - *ptr = 0x87; - *(ptr + 1) = 0x12; - - /* back to original pointer */ - ptr -= rmv_len; - } - - ptr += rmv_len ; - - _rtw_memcpy(ð_type, ptr, 2); - eth_type = ntohs((unsigned short)eth_type); /* pattrib->ether_type */ - ptr += 2; - - if (pattrib->encrypt) - recvframe_pull_tail(precvframe, pattrib->icv_len); - - if (eth_type == 0x8100) { /* vlan */ - pvlan = (struct _vlan *) ptr; - - /* eth_type = get_vlan_encap_proto(pvlan); */ - /* eth_type = pvlan->h_vlan_encapsulated_proto; */ /* ? */ - rmv_len += 4; - ptr += 4; - } - - if (eth_type == 0x0800) { /* ip */ - /* struct iphdr* piphdr = (struct iphdr*) ptr; */ - /* __u8 tos = (unsigned char)(pattrib->priority & 0xff); */ - - /* piphdr->tos = tos; */ - - } else if (eth_type == 0x8712) { /* append rx status for mp test packets */ - /* ptr -= 16; */ - /* _rtw_memcpy(ptr, get_rxmem(precvframe), 16); */ - } else { -#ifdef PLATFORM_OS_XP - NDIS_PACKET_8021Q_INFO VlanPriInfo; - UINT32 UserPriority = precvframe->u.hdr.attrib.priority; - UINT32 VlanID = (pvlan != NULL ? get_vlan_id(pvlan) : 0); - - VlanPriInfo.Value = /* Get current value. */ - NDIS_PER_PACKET_INFO_FROM_PACKET(precvframe->u.hdr.pkt, Ieee8021QInfo); - - VlanPriInfo.TagHeader.UserPriority = UserPriority; - VlanPriInfo.TagHeader.VlanId = VlanID ; - - VlanPriInfo.TagHeader.CanonicalFormatId = 0; /* Should be zero. */ - VlanPriInfo.TagHeader.Reserved = 0; /* Should be zero. */ - NDIS_PER_PACKET_INFO_FROM_PACKET(precvframe->u.hdr.pkt, Ieee8021QInfo) = VlanPriInfo.Value; -#endif - } - - if (eth_type == 0x8712) { /* append rx status for mp test packets */ - ptr = recvframe_pull(precvframe, (rmv_len - sizeof(struct ethhdr) + 2) - 24); - _rtw_memcpy(ptr, get_rxmem(precvframe), 24); - ptr += 24; - } else - ptr = recvframe_pull(precvframe, (rmv_len - sizeof(struct ethhdr) + 2)); - - _rtw_memcpy(ptr, pattrib->dst, ETH_ALEN); - _rtw_memcpy(ptr + ETH_ALEN, pattrib->src, ETH_ALEN); - - eth_type = htons((unsigned short)eth_type) ; - _rtw_memcpy(ptr + 12, ð_type, 2); - -exit: - - - return ret; -} -#endif - - #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) +#ifndef CONFIG_SDIO_RX_COPY #ifdef PLATFORM_LINUX static void recvframe_expand_pkt( PADAPTER padapter, @@ -2592,9 +2499,10 @@ static void recvframe_expand_pkt( pfhdr->rx_tail = skb_tail_pointer(ppkt); pfhdr->rx_end = skb_end_pointer(ppkt); } -#else +#else /*!= PLATFORM_LINUX*/ #warning "recvframe_expand_pkt not implement, defrag may crash system" #endif +#endif /*#ifndef CONFIG_SDIO_RX_COPY*/ #endif /* perform defrag */ @@ -2697,7 +2605,7 @@ union recv_frame *recvframe_chk_defrag(PADAPTER padapter, union recv_frame *prec struct sta_priv *pstapriv; _list *phead; union recv_frame *prtnframe = NULL; - _queue *pfree_recv_queue, *pdefrag_q; + _queue *pfree_recv_queue, *pdefrag_q = NULL; pstapriv = &padapter->stapriv; @@ -2716,7 +2624,8 @@ union recv_frame *recvframe_chk_defrag(PADAPTER padapter, union recv_frame *prec u8 type = GetFrameType(pfhdr->rx_data); if (type != WIFI_DATA_TYPE) { psta = rtw_get_bcmc_stainfo(padapter); - pdefrag_q = &psta->sta_recvpriv.defrag_q; + if (psta) + pdefrag_q = &psta->sta_recvpriv.defrag_q; } else pdefrag_q = NULL; } else @@ -2792,8 +2701,174 @@ 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; +#ifdef DBG_IP_R_MONITOR + int i; + struct rx_pkt_attrib *pattrib = &rframe->u.hdr.attrib; + struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; + struct mlme_priv *pmlmepriv = &adapter->mlmepriv; + struct wlan_network *cur_network = &(pmlmepriv->cur_network); +#endif/*DBG_IP_R_MONITOR*/ + 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) + parsing_eapol_packet(adapter, ehdr_pos + ETH_HLEN, rframe->u.hdr.psta, 0); +#ifdef DBG_ARP_DUMP + else if (ntohs(ehdr->h_proto) == ETH_P_ARP) + dump_arp_pkt(RTW_DBGDUMP, ehdr->h_dest, ehdr->h_source, ehdr_pos + ETH_HLEN, 0); +#endif + + 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 DBG_IP_R_MONITOR + #define LEN_ARP_OP_HDR 7 /*ARP OERATION */ + if (ntohs(ehdr->h_proto) == ETH_P_ARP) { + + if(check_fwstate(pmlmepriv, WIFI_ASOC_STATE) == _TRUE){ + if(ehdr_pos[ETHERNET_HEADER_SIZE+LEN_ARP_OP_HDR] == 2) { + + RTW_INFO("%s,[DBG_ARP] Rx ARP RSP Packet;SeqNum = %d !\n", + __FUNCTION__, pattrib->seq_num); + + dump_arp_pkt(RTW_DBGDUMP, ehdr->h_dest, ehdr->h_source, ehdr_pos + ETH_HLEN, 0); + + } + } + } +#endif/*DBG_IP_R_MONITOR*/ + +#ifdef CONFIG_AUTO_AP_MODE + if (ntohs(ehdr->h_proto) == 0x8899) + rtw_auto_ap_rx_msg_dump(adapter, rframe, ehdr_pos); +#endif + + ret = _SUCCESS; + +#ifdef CONFIG_WAPI_SUPPORT +exit: +#endif + return ret; +} + +static void recv_free_fwd_resource(_adapter *adapter, struct xmit_frame *fwd_frame, _list *b2u_list) +{ + struct xmit_priv *xmitpriv = &adapter->xmitpriv; + + if (fwd_frame) + rtw_free_xmitframe(xmitpriv, fwd_frame); + +#ifdef CONFIG_RTW_MESH +#if CONFIG_RTW_MESH_DATA_BMC_TO_UC + if (!rtw_is_list_empty(b2u_list)) { + struct xmit_frame *b2uframe; + _list *list; + + list = get_next(b2u_list); + while (rtw_end_of_queue_search(b2u_list, list) == _FALSE) { + b2uframe = LIST_CONTAINOR(list, struct xmit_frame, list); + list = get_next(list); + rtw_list_delete(&b2uframe->list); + rtw_free_xmitframe(xmitpriv, b2uframe); + } + } +#endif +#endif /* CONFIG_RTW_MESH */ +} + +#ifdef CONFIG_RTW_MESH +static void recv_fwd_pkt_hdl(_adapter *adapter, _pkt *pkt + , u8 act, struct xmit_frame *fwd_frame, _list *b2u_list) +{ + struct xmit_priv *xmitpriv = &adapter->xmitpriv; + _pkt *fwd_pkt = pkt; + + if (act & RTW_RX_MSDU_ACT_INDICATE) { + fwd_pkt = rtw_os_pkt_copy(pkt); + if (!fwd_pkt) { + #ifdef DBG_TX_DROP_FRAME + RTW_INFO("DBG_TX_DROP_FRAME %s rtw_os_pkt_copy fail\n", __func__); + #endif + recv_free_fwd_resource(adapter, fwd_frame, b2u_list); + goto exit; + } + } + +#if CONFIG_RTW_MESH_DATA_BMC_TO_UC + if (!rtw_is_list_empty(b2u_list)) { + _list *list = get_next(b2u_list); + struct xmit_frame *b2uframe; + + while (rtw_end_of_queue_search(b2u_list, list) == _FALSE) { + b2uframe = LIST_CONTAINOR(list, struct xmit_frame, list); + list = get_next(list); + rtw_list_delete(&b2uframe->list); + + if (!fwd_frame && rtw_is_list_empty(b2u_list)) /* the last fwd_pkt */ + b2uframe->pkt = fwd_pkt; + else + b2uframe->pkt = rtw_os_pkt_copy(fwd_pkt); + if (!b2uframe->pkt) { + rtw_free_xmitframe(xmitpriv, b2uframe); + continue; + } + + rtw_xmit_posthandle(adapter, b2uframe, b2uframe->pkt); + } + } +#endif + + if (fwd_frame) { + fwd_frame->pkt = fwd_pkt; + if (rtw_xmit_posthandle(adapter, fwd_frame, fwd_pkt) < 0) { + #ifdef DBG_TX_DROP_FRAME + RTW_INFO("DBG_TX_DROP_FRAME %s rtw_xmit_posthandle fail\n", __func__); + #endif + xmitpriv->tx_drop++; + } + } + +exit: + return; +} +#endif /* CONFIG_RTW_MESH */ + 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; @@ -2801,43 +2876,96 @@ int amsdu_to_msdu(_adapter *padapter, union recv_frame *prframe) _pkt *sub_pkt, *subframes[MAX_SUBFRAME_COUNT]; struct recv_priv *precvpriv = &padapter->recvpriv; _queue *pfree_recv_queue = &(precvpriv->free_recv_queue); + const u8 *da, *sa; + int act; + struct xmit_frame *fwd_frame; + _list b2u_list; + u8 mctrl_len = 0; int ret = _SUCCESS; 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) { - /* Offset 12 denote 2 mac address */ nSubframe_Length = RTW_GET_BE16(pdata + 12); - if (a_len < (ETHERNET_HEADER_SIZE + nSubframe_Length)) { RTW_INFO("nRemain_Length is %d and nSubframe_Length is : %d\n", a_len, nSubframe_Length); break; } - sub_pkt = rtw_os_alloc_msdu_pkt(prframe, nSubframe_Length, pdata); + act = RTW_RX_MSDU_ACT_INDICATE; + fwd_frame = NULL; + + #ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(padapter)) { + u8 *mda = pdata, *msa = pdata + ETH_ALEN; + struct rtw_ieee80211s_hdr *mctrl = (struct rtw_ieee80211s_hdr *)(pdata + ETH_HLEN); + int v_ret; + + v_ret = rtw_mesh_rx_data_validate_mctrl(padapter, prframe + , mctrl, mda, msa, &mctrl_len, &da, &sa); + if (v_ret != _SUCCESS) + goto move_to_next; + + act = rtw_mesh_rx_msdu_act_check(prframe + , mda, msa, da, sa, mctrl, &fwd_frame, &b2u_list); + } else + #endif + { + da = pdata; + sa = pdata + ETH_ALEN; + } + + if (!act) + goto move_to_next; + + rtw_led_rx_control(padapter, da); + + sub_pkt = rtw_os_alloc_msdu_pkt(prframe, da, sa + , pdata + ETH_HLEN + mctrl_len, nSubframe_Length - mctrl_len); if (sub_pkt == NULL) { - RTW_INFO("%s(): allocate sub packet fail !!!\n", __FUNCTION__); + if (act & RTW_RX_MSDU_ACT_INDICATE) { + #ifdef DBG_RX_DROP_FRAME + RTW_INFO("DBG_RX_DROP_FRAME %s rtw_os_alloc_msdu_pkt fail\n", __func__); + #endif + } + if (act & RTW_RX_MSDU_ACT_FORWARD) { + #ifdef DBG_TX_DROP_FRAME + RTW_INFO("DBG_TX_DROP_FRAME %s rtw_os_alloc_msdu_pkt fail\n", __func__); + #endif + recv_free_fwd_resource(padapter, fwd_frame, &b2u_list); + } break; } + #ifdef CONFIG_RTW_MESH + if (act & RTW_RX_MSDU_ACT_FORWARD) { + recv_fwd_pkt_hdl(padapter, sub_pkt, act, fwd_frame, &b2u_list); + if (!(act & RTW_RX_MSDU_ACT_INDICATE)) + goto move_to_next; + } + #endif + + 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_to_next: /* 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; } @@ -2862,7 +2990,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; @@ -2871,75 +2999,163 @@ 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) +{ + _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 { + int act = RTW_RX_MSDU_ACT_INDICATE; + struct xmit_frame *fwd_frame = NULL; + _list b2u_list; + + #ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(padapter) && pattrib->mesh_ctrl_present) { + act = rtw_mesh_rx_msdu_act_check(prframe + , pattrib->mda, pattrib->msa + , pattrib->dst, pattrib->src + , (struct rtw_ieee80211s_hdr *)(get_recvframe_data(prframe) + pattrib->hdrlen + pattrib->iv_len) + , &fwd_frame, &b2u_list); + } + #endif + + if (!act) { + rtw_free_recvframe(prframe, pfree_recv_queue); + ret = _FAIL; + goto exit; + } + + rtw_led_rx_control(padapter, pattrib->dst); + + ret = wlanhdr_to_ethhdr(prframe); + if (ret != _SUCCESS) { + if (act & RTW_RX_MSDU_ACT_INDICATE) { + #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 + } + if (act & RTW_RX_MSDU_ACT_FORWARD) { + #ifdef DBG_TX_DROP_FRAME + RTW_INFO("DBG_TX_DROP_FRAME %s wlanhdr_to_ethhdr fail\n", __func__); + #endif + recv_free_fwd_resource(padapter, fwd_frame, &b2u_list); + } + rtw_free_recvframe(prframe, pfree_recv_queue); + goto exit; + } + + #ifdef CONFIG_RTW_MESH + if (act & RTW_RX_MSDU_ACT_FORWARD) { + recv_fwd_pkt_hdl(padapter, prframe->u.hdr.pkt, act, fwd_frame, &b2u_list); + if (!(act & RTW_RX_MSDU_ACT_INDICATE)) { + prframe->u.hdr.pkt = NULL; + rtw_free_recvframe(prframe, pfree_recv_queue); + goto exit; + } + } + #endif + + 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; @@ -2991,20 +3207,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; @@ -3012,8 +3230,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); @@ -3033,7 +3249,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); */ @@ -3043,13 +3259,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. */ @@ -3075,10 +3290,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 @@ -3087,8 +3302,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 @@ -3102,19 +3317,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; @@ -3150,114 +3354,33 @@ 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); @@ -3275,9 +3398,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; } @@ -3305,6 +3429,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: @@ -3342,69 +3467,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 @@ -3416,27 +3510,50 @@ int validate_mp_recv_frame(_adapter *adapter, union recv_frame *precv_frame) struct mp_priv *pmppriv = &adapter->mppriv; struct mp_tx *pmptx; unsigned char *sa , *da, *bs; - + struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; + u32 i = 0; + u8 rtk_prefix[]={0x52, 0x65, 0x61, 0x6C, 0x4C, 0x6F, 0x76, 0x65, 0x54, 0x65, 0x6B}; + u8 *prx_data; pmptx = &pmppriv->tx; -#if 0 - if (1) { - u8 bDumpRxPkt; + + if (pmppriv->mplink_brx == _FALSE) { + + u8 bDumpRxPkt = 0; type = GetFrameType(ptr); subtype = get_frame_sub_type(ptr); /* bit(7)~bit(2) */ - rtw_hal_get_def_var(adapter, HAL_DEF_DBG_DUMP_RXPKT, &(bDumpRxPkt)); + RTW_INFO("hdr len = %d iv_len=%d \n", pattrib->hdrlen , pattrib->iv_len); + prx_data = ptr + pattrib->hdrlen + pattrib->iv_len; + + for (i = 0; i < precv_frame->u.hdr.len; i++) { + if (precv_frame->u.hdr.len < (11 + i)) + break; + + if (_rtw_memcmp(prx_data + i, (void *)&rtk_prefix, 11) == _FALSE) { + bDumpRxPkt = 0; + RTW_DBG("prx_data = %02X != rtk_prefix[%d] = %02X \n", *(prx_data + i), i , rtk_prefix[i]); + } else { + bDumpRxPkt = 1; + RTW_DBG("prx_data = %02X = rtk_prefix[%d] = %02X \n", *(prx_data + i), i , rtk_prefix[i]); + break; + } + } + if (bDumpRxPkt == 1) { /* dump all rx packets */ int i; RTW_INFO("############ type:0x%02x subtype:0x%02x #################\n", type, subtype); - for (i = 0; i < 64; i = i + 8) + for (i = 0; i < precv_frame->u.hdr.len; i = i + 8) RTW_INFO("%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:\n", *(ptr + i), *(ptr + i + 1), *(ptr + i + 2) , *(ptr + i + 3) , *(ptr + i + 4), *(ptr + i + 5), *(ptr + i + 6), *(ptr + i + 7)); - RTW_INFO("#############################\n"); + RTW_INFO("#############################\n"); + _rtw_memset(pmppriv->mplink_buf, '\0' , sizeof(pmppriv->mplink_buf)); + _rtw_memcpy(pmppriv->mplink_buf, ptr, precv_frame->u.hdr.len); + pmppriv->mplink_rx_len = precv_frame->u.hdr.len; + pmppriv->mplink_brx =_TRUE; } } -#endif if (pmppriv->bloopback) { if (_rtw_memcmp(ptr + 24, pmptx->buf + 24, precv_frame->u.hdr.len - 24) == _FALSE) { RTW_INFO("Compare payload content Fail !!!\n"); @@ -3481,7 +3598,6 @@ static sint MPwlanhdr_to_ethhdr(union recv_frame *precvframe) sint ret = _SUCCESS; _adapter *adapter = precvframe->u.hdr.adapter; - struct mlme_priv *pmlmepriv = &adapter->mlmepriv; u8 *ptr = get_recvframe_data(precvframe) ; /* point to frame_ctrl field */ struct rx_pkt_attrib *pattrib = &precvframe->u.hdr.attrib; @@ -3549,7 +3665,6 @@ int mp_recv_frame(_adapter *padapter, union recv_frame *rframe) { int ret = _SUCCESS; struct rx_pkt_attrib *pattrib = &rframe->u.hdr.attrib; - struct recv_priv *precvpriv = &padapter->recvpriv; _queue *pfree_recv_queue = &padapter->recvpriv.free_recv_queue; #ifdef CONFIG_MP_INCLUDED struct mlme_priv *pmlmepriv = &padapter->mlmepriv; @@ -3630,9 +3745,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; @@ -3641,20 +3757,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; @@ -3724,8 +3842,6 @@ static sint fill_radiotap_hdr(_adapter *padapter, union recv_frame *precvframe, #endif sint ret = _SUCCESS; - _adapter *adapter = precvframe->u.hdr.adapter; - struct mlme_priv *pmlmepriv = &adapter->mlmepriv; struct rx_pkt_attrib *pattrib = &precvframe->u.hdr.attrib; HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); @@ -3796,9 +3912,9 @@ static sint fill_radiotap_hdr(_adapter *padapter, union recv_frame *precvframe, rt_len += 1; /* rate */ - if (pattrib->data_rate < 12) { + if (pattrib->data_rate <= DESC_RATE54M) { rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_RATE); - if (pattrib->data_rate < 4) { + if (pattrib->data_rate <= DESC_RATE11M) { /* CCK */ hdr_buf[rt_len] = data_rate[pattrib->data_rate]; } else { @@ -3818,13 +3934,13 @@ static sint fill_radiotap_hdr(_adapter *padapter, union recv_frame *precvframe, /* channel flags */ tmp_16bit = 0; - if (pHalData->current_band_type == 0) + if (pHalData->current_band_type == BAND_ON_2_4G) tmp_16bit |= cpu_to_le16(IEEE80211_CHAN_2GHZ); - else + else /*BAND_ON_5G*/ tmp_16bit |= cpu_to_le16(IEEE80211_CHAN_5GHZ); - if (pattrib->data_rate < 12) { - if (pattrib->data_rate < 4) { + if (pattrib->data_rate <= DESC_RATE54M) { + if (pattrib->data_rate <= DESC_RATE11M) { /* CCK */ tmp_16bit |= cpu_to_le16(IEEE80211_CHAN_CCK); } else { @@ -3838,7 +3954,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 @@ -3849,7 +3965,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 @@ -3867,7 +3983,7 @@ static sint fill_radiotap_hdr(_adapter *padapter, union recv_frame *precvframe, rt_len += 2; /* MCS information */ - if (pattrib->data_rate >= 12 && pattrib->data_rate < 44) { + if (pattrib->data_rate >= DESC_RATEMCS0 && pattrib->data_rate <= DESC_RATEMCS31) { rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_MCS); /* known, flag */ hdr_buf[rt_len] |= BIT1; /* MCS index known */ @@ -3892,7 +4008,7 @@ static sint fill_radiotap_hdr(_adapter *padapter, union recv_frame *precvframe, } /* VHT */ - if (pattrib->data_rate >= 44 && pattrib->data_rate < 84) { + if (pattrib->data_rate >= DESC_RATEVHTSS1MCS0 && pattrib->data_rate <= DESC_RATEVHTSS4MCS9) { rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_VHT); /* known 16 bit, flag 8 bit */ @@ -3934,16 +4050,16 @@ static sint fill_radiotap_hdr(_adapter *padapter, union recv_frame *precvframe, rt_len += 1; /* mcs_nss */ - if (pattrib->data_rate >= 44 && pattrib->data_rate < 54) { + if (pattrib->data_rate >= DESC_RATEVHTSS1MCS0 && pattrib->data_rate <= DESC_RATEVHTSS1MCS9) { hdr_buf[rt_len] |= 1; hdr_buf[rt_len] |= data_rate[pattrib->data_rate] << 4; - } else if (pattrib->data_rate >= 54 && pattrib->data_rate < 64) { + } else if (pattrib->data_rate >= DESC_RATEVHTSS2MCS0 && pattrib->data_rate <= DESC_RATEVHTSS2MCS9) { hdr_buf[rt_len + 1] |= 2; hdr_buf[rt_len + 1] |= data_rate[pattrib->data_rate] << 4; - } else if (pattrib->data_rate >= 64 && pattrib->data_rate < 74) { + } else if (pattrib->data_rate >= DESC_RATEVHTSS3MCS0 && pattrib->data_rate <= DESC_RATEVHTSS3MCS9) { hdr_buf[rt_len + 2] |= 3; hdr_buf[rt_len + 2] |= data_rate[pattrib->data_rate] << 4; - } else if (pattrib->data_rate >= 74 && pattrib->data_rate < 84) { + } else if (pattrib->data_rate >= DESC_RATEVHTSS4MCS0 && pattrib->data_rate <= DESC_RATEVHTSS4MCS9) { hdr_buf[rt_len + 3] |= 4; hdr_buf[rt_len + 3] |= data_rate[pattrib->data_rate] << 4; } @@ -3974,6 +4090,7 @@ static sint fill_radiotap_hdr(_adapter *padapter, union recv_frame *precvframe, ptr = skb_push(pskb, rt_len); if (ptr) { rtap_hdr->it_len = cpu_to_le16(rt_len); + rtap_hdr->it_present = cpu_to_le32(rtap_hdr->it_present); memcpy(ptr, rtap_hdr, rt_len); } else ret = _FAIL; @@ -3985,8 +4102,6 @@ static sint fill_radiotap_hdr(_adapter *padapter, union recv_frame *precvframe, int recv_frame_monitor(_adapter *padapter, union recv_frame *rframe) { int ret = _SUCCESS; - struct rx_pkt_attrib *pattrib = &rframe->u.hdr.attrib; - struct recv_priv *precvpriv = &padapter->recvpriv; _queue *pfree_recv_queue = &padapter->recvpriv.free_recv_queue; _pkt *pskb = NULL; @@ -3996,13 +4111,14 @@ int recv_frame_monitor(_adapter *padapter, union recv_frame *rframe) pskb->data = rframe->u.hdr.rx_data; skb_set_tail_pointer(pskb, rframe->u.hdr.len); +#ifndef CONFIG_CUSTOMER_ALIBABA_GENERAL /* fill radiotap header */ if (fill_radiotap_hdr(padapter, rframe, (u8 *)pskb) == _FAIL) { ret = _FAIL; rtw_free_recvframe(rframe, pfree_recv_queue); /* free this recv_frame */ goto exit; } - +#endif /* write skb information to recv frame */ skb_reset_mac_header(pskb); rframe->u.hdr.len = pskb->len; @@ -4032,8 +4148,9 @@ int recv_frame_monitor(_adapter *padapter, union recv_frame *rframe) int recv_func_prehandle(_adapter *padapter, union recv_frame *rframe) { int ret = _SUCCESS; +#ifdef DBG_RX_COUNTER_DUMP struct rx_pkt_attrib *pattrib = &rframe->u.hdr.attrib; - struct recv_priv *precvpriv = &padapter->recvpriv; +#endif _queue *pfree_recv_queue = &padapter->recvpriv.free_recv_queue; #ifdef DBG_RX_COUNTER_DUMP @@ -4078,30 +4195,24 @@ int recv_func_posthandle(_adapter *padapter, union recv_frame *prframe) DBG_COUNTER(padapter->rx_logs.core_rx_post); - /* DATA FRAME */ - rtw_led_control(padapter, LED_CTL_RX); - 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 - if (padapter->adapter_type == PRIMARY_ADAPTER) { + if (is_primary_adapter(padapter)) { RTW_INFO("+++\n"); { int i; @@ -4130,18 +4241,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; @@ -4153,75 +4266,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; @@ -4229,7 +4297,10 @@ int recv_func(_adapter *padapter, union recv_frame *rframe) struct recv_priv *recvpriv = &padapter->recvpriv; struct security_priv *psecuritypriv = &padapter->securitypriv; struct mlme_priv *mlmepriv = &padapter->mlmepriv; - +#ifdef CONFIG_CUSTOMER_ALIBABA_GENERAL + u8 type; + u8 *ptr = rframe->u.hdr.rx_data; +#endif if (check_fwstate(mlmepriv, WIFI_MONITOR_STATE)) { /* monitor mode */ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 24)) @@ -4238,7 +4309,18 @@ int recv_func(_adapter *padapter, union recv_frame *rframe) ret = _SUCCESS; goto exit; } else - + {} +#ifdef CONFIG_CUSTOMER_ALIBABA_GENERAL + type = GetFrameType(ptr); + if ((type == WIFI_DATA_TYPE)&& check_fwstate(mlmepriv, WIFI_STATION_STATE)) { + struct wlan_network *cur_network = &(mlmepriv->cur_network); + if ( _rtw_memcmp(get_addr2_ptr(ptr), cur_network->network.MacAddress, ETH_ALEN)==0) { + recv_frame_monitor(padapter, rframe); + ret = _SUCCESS; + goto exit; + } + } +#endif /* check if need to handle uc_swdec_pending_queue*/ if (check_fwstate(mlmepriv, WIFI_STATION_STATE) && psecuritypriv->busetkipkey) { union recv_frame *pending_frame; @@ -4325,9 +4407,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; @@ -4425,13 +4507,14 @@ void rtw_signal_stat_timer_hdl(RTW_TIMER_HDL_ARGS) static void rx_process_rssi(_adapter *padapter, union recv_frame *prframe) { - u32 last_rssi, tmp_val; struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; #ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS struct signal_stat *signal_stat = &padapter->recvpriv.signal_strength_data; +#else /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ + u32 last_rssi, tmp_val; #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 @@ -4442,7 +4525,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 */ @@ -4452,9 +4535,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; @@ -4475,10 +4558,11 @@ static void rx_process_rssi(_adapter *padapter, union recv_frame *prframe) static void rx_process_link_qual(_adapter *padapter, union recv_frame *prframe) { - u32 last_evm = 0, tmpVal; struct rx_pkt_attrib *pattrib; #ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS struct signal_stat *signal_stat; +#else /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ + u32 last_evm = 0, tmpVal; #endif /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ if (prframe == NULL || padapter == NULL) @@ -4499,11 +4583,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. */ /* */ @@ -4512,9 +4596,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; @@ -4549,41 +4633,30 @@ 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); - struct _odm_phy_status_info_ *pPHYInfo = (struct _odm_phy_status_info_ *)(&pattrib->phy_info); + struct phydm_phyinfo_struct *p_phy_info = &pattrib->phy_info; u8 *wlanhdr; - struct _odm_per_pkt_info_ 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.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.is_packet_match_bssid = (!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.is_to_self = (!pattrib->icv_err) && (!pattrib->crc_err) - && _rtw_memcmp(get_ra(wlanhdr), adapter_mac_addr(padapter), ETH_ALEN); - - pkt_info.is_packet_to_self = pkt_info.is_packet_match_bssid - && _rtw_memcmp(get_ra(wlanhdr), adapter_mac_addr(padapter), ETH_ALEN); - - pkt_info.is_packet_beacon = pkt_info.is_packet_match_bssid - && (get_frame_sub_type(wlanhdr) == WIFI_BEACON); - - sa = get_ta(wlanhdr); - - pkt_info.station_id = 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)) { @@ -4605,36 +4678,72 @@ 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.station_id = psta->mac_id; + pkt_info.station_id = psta->cmn.mac_id; } + pkt_info.is_packet_match_bssid = (!IsFrameTypeCtrl(wlanhdr)) + && (!pattrib->icv_err) && (!pattrib->crc_err) + && ((!MLME_IS_MESH(padapter) && _rtw_memcmp(get_hdr_bssid(wlanhdr), get_bssid(&padapter->mlmepriv), ETH_ALEN)) + || (MLME_IS_MESH(padapter) && psta)); + + 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; - /* _enter_critical_bh(&pHalData->odm_stainfo_lock, &irqL); */ - odm_phy_status_query(&pHalData->odmpriv, pPHYInfo, pphy_status, &pkt_info); - if (psta) - psta->rssi = pattrib->phy_info.RecvSignalPower; - /* _exit_critical_bh(&pHalData->odm_stainfo_lock, &irqL); */ + odm_phy_status_query(&pHalData->odmpriv, p_phy_info, pphy_status, &pkt_info); + + /* If bw is initial value, get from phy status */ + if (pattrib->bw == CHANNEL_WIDTH_MAX) + pattrib->bw = p_phy_info->band_width; { precvframe->u.hdr.psta = NULL; - if (pkt_info.is_packet_match_bssid - && (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) - ) { - if (psta) { - precvframe->u.hdr.psta = psta; + if (padapter->registrypriv.mp_mode != 1) { + if ((!MLME_IS_MESH(padapter) && pkt_info.is_packet_match_bssid) + || (MLME_IS_MESH(padapter) && psta)) { + if (psta) { + precvframe->u.hdr.psta = psta; + rx_process_phy_info(padapter, precvframe); + } + } else if (pkt_info.is_packet_to_self || pkt_info.is_packet_beacon) { + if (psta) + precvframe->u.hdr.psta = psta; rx_process_phy_info(padapter, precvframe); } - } else if (pkt_info.is_packet_to_self || pkt_info.is_packet_beacon) { - - if (psta) - precvframe->u.hdr.psta = psta; - rx_process_phy_info(padapter, precvframe); + } else { +#ifdef CONFIG_MP_INCLUDED + if (padapter->mppriv.brx_filter_beacon == _TRUE) { + if (pkt_info.is_packet_beacon) { + RTW_INFO("in MP Rx is_packet_beacon\n"); + if (psta) + precvframe->u.hdr.psta = psta; + rx_process_phy_info(padapter, precvframe); + } + } else +#endif + { + if (psta) + precvframe->u.hdr.psta = psta; + rx_process_phy_info(padapter, precvframe); + } } } @@ -4665,29 +4774,65 @@ 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; - _adapter *iface = NULL; + u8 *pda = get_ra(pbuf); + u8 ra_is_bmc = IS_MCAST(pda); _adapter *primary_padapter = precvframe->u.hdr.adapter; +#ifdef CONFIG_CONCURRENT_MODE + _adapter *iface = NULL; - 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) { + #ifdef CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI + if (_rtw_memcmp(pda, adapter_pno_mac_addr(primary_padapter), + ETH_ALEN) != _TRUE) + #endif RTW_INFO("%s [WARN] Cannot find appropriate adapter - mac_addr : "MAC_FMT"\n", __func__, MAC_ARG(pda)); /*rtw_warn_on(1);*/ } else 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 */ + if (primary_padapter->registrypriv.mp_mode != 1) { + /* 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; } @@ -4697,7 +4842,13 @@ thread_return rtw_recv_thread(thread_context context) _adapter *adapter = (_adapter *)context; struct recv_priv *recvpriv = &adapter->recvpriv; s32 err = _SUCCESS; +#ifdef RTW_RECV_THREAD_HIGH_PRIORITY +#ifdef PLATFORM_LINUX + struct sched_param param = { .sched_priority = 1 }; + sched_setscheduler(current, SCHED_FIFO, ¶m); +#endif /* PLATFORM_LINUX */ +#endif /*RTW_RECV_THREAD_HIGH_PRIORITY*/ thread_enter("RTW_RECV_THREAD"); RTW_INFO(FUNC_ADPT_FMT" enter\n", FUNC_ADPT_ARG(adapter)); @@ -4710,8 +4861,10 @@ thread_return rtw_recv_thread(thread_context context) } if (RTW_CANNOT_RUN(adapter)) { - RTW_INFO(FUNC_ADPT_FMT" DS:%d, SR:%d\n", FUNC_ADPT_ARG(adapter) - , rtw_is_drv_stopped(adapter), rtw_is_surprise_removed(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; } @@ -4729,9 +4882,62 @@ thread_return rtw_recv_thread(thread_context context) } while (err != _FAIL); exit: - _rtw_up_sema(&adapter->recvpriv.terminate_recvthread_sema); - RTW_INFO(FUNC_ADPT_FMT" exit\n", FUNC_ADPT_ARG(adapter)); - thread_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/rtl8188eu/core/rtw_rf.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_rf.c index 38ea85ebff17..597a6d7e8a12 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_rf.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_rf.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 @@ -209,7 +205,6 @@ struct center_chs_ent_t center_chs_5g_by_bw[] = { */ u8 rtw_get_scch_by_cch_offset(u8 cch, u8 bw, u8 offset) { - int i; u8 t_cch = 0; if (bw == CHANNEL_WIDTH_20) { @@ -475,7 +470,6 @@ bool rtw_chbw_to_freq_range(u8 ch, u8 bw, u8 offset, u32 *hi, u32 *lo) u8 c_ch; u32 freq; u32 hi_ret = 0, lo_ret = 0; - int i; bool valid = _FALSE; if (hi) @@ -514,22 +508,24 @@ bool rtw_chbw_to_freq_range(u8 ch, u8 bw, u8 offset, u32 *hi, u32 *lo) return valid; } -const char *const _ch_width_str[] = { +const char *const _ch_width_str[CHANNEL_WIDTH_MAX] = { "20MHz", "40MHz", "80MHz", "160MHz", "80_80MHz", - "CHANNEL_WIDTH_MAX", + "5MHz", + "10MHz", }; -const u8 _ch_width_to_bw_cap[] = { +const u8 _ch_width_to_bw_cap[CHANNEL_WIDTH_MAX] = { BW_CAP_20M, BW_CAP_40M, BW_CAP_80M, BW_CAP_160M, BW_CAP_80_80M, - 0, + BW_CAP_5M, + BW_CAP_10M, }; const char *const _band_str[] = { @@ -547,443 +543,651 @@ const u8 _band_to_band_cap[] = { }; const u8 _rf_type_to_rf_tx_cnt[] = { - 1, - 2, - 2, - 1, - 2, - 2, - 3, - 3, - 4, + 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[] = { - 2, - 4, - 2, - 1, - 2, - 3, - 3, - 4, - 4, + 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 -#define COUNTRY_CHPLAN_ASSIGN_EN_11AC(_val) -#endif - -#if RTW_DEF_MODULE_REGULATORY_CERT -#define COUNTRY_CHPLAN_ASSIGN_DEF_MODULE_FLAGS(_val) , .def_module_flags = (_val) -#else -#define COUNTRY_CHPLAN_ASSIGN_DEF_MODULE_FLAGS(_val) -#endif - -/* has def_module_flags specified, used by common map and HAL dfference map */ -#define COUNTRY_CHPLAN_ENT(_alpha2, _chplan, _en_11ac, _def_module_flags) \ - {.alpha2 = (_alpha2), .chplan = (_chplan) \ - COUNTRY_CHPLAN_ASSIGN_EN_11AC(_en_11ac) \ - COUNTRY_CHPLAN_ASSIGN_DEF_MODULE_FLAGS(_def_module_flags) \ - } - -#ifdef CONFIG_CUSTOMIZED_COUNTRY_CHPLAN_MAP - -#include "../platform/custom_country_chplan.h" - -#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 */ +const char *const _regd_str[] = { + "NONE", + "FCC", + "MKK", + "ETSI", + "IC", + "KCC", + "ACMA", + "CHILE", + "WW", }; -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 */ -}; -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[] = { -}; -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[] = { -}; -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[] = { -}; -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[] = { -}; -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[] = { -}; -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[] = { -}; -static const u16 RTL8192EEBT_HMC_M2_country_chplan_map_sz = sizeof(RTL8192EEBT_HMC_M2_country_chplan_map) / sizeof(struct country_chplan); -#endif - -/** - * rtw_def_module_get_chplan_from_country - - * @country_code: string of country code - * @return: - * Return NULL for case referring to common map - */ -static const struct country_chplan *rtw_def_module_get_chplan_from_country(const char *country_code) +#if CONFIG_TXPWR_LIMIT +void _dump_regd_exc_list(void *sel, struct rf_ctl_t *rfctl) { - const struct country_chplan *ent = NULL; - const struct country_chplan *hal_map = NULL; - u16 hal_map_sz = 0; - int i; + struct regd_exc_ent *ent; + _list *cur, *head; - /* 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; -#elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8821AU) - hal_map = RTL8821AU_country_chplan_map; - hal_map_sz = RTL8821AU_country_chplan_map_sz; -#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; -#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; -#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; -#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; -#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; -#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; -#endif + RTW_PRINT_SEL(sel, "regd_exc_num:%u\n", rfctl->regd_exc_num); - if (hal_map == NULL || hal_map_sz == 0) + if (!rfctl->regd_exc_num) goto exit; - for (i = 0; i < hal_map_sz; i++) { - if (strncmp(country_code, hal_map[i].alpha2, 2) == 0) { - ent = &hal_map[i]; - break; - } + 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; + } + + 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; } -#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 */ -}; - -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 -* -* Return pointer of struct country_chplan entry or NULL when unsupported country_code is given -*/ -const struct country_chplan *rtw_get_chplan_from_country(const char *country_code) +void rtw_regd_exc_list_free(struct rf_ctl_t *rfctl) { - const struct country_chplan *ent = NULL; - const struct country_chplan *map = NULL; - u16 map_sz = 0; - char code[2]; - int i; + struct regd_exc_ent *ent; + _irqL irqL; + _list *cur, *head; - code[0] = alpha_to_upper(country_code[0]); - code[1] = alpha_to_upper(country_code[1]); + _enter_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); -#if !defined(CONFIG_CUSTOMIZED_COUNTRY_CHPLAN_MAP) && RTW_DEF_MODULE_REGULATORY_CERT - ent = rtw_def_module_get_chplan_from_country(code); - if (ent != NULL) - goto exit; -#endif + head = &rfctl->reg_exc_list; + cur = get_next(head); -#ifdef CONFIG_CUSTOMIZED_COUNTRY_CHPLAN_MAP - map = CUSTOMIZED_country_chplan_map; - map_sz = CUSTOMIZED_country_chplan_map_sz; -#else - map = country_chplan_map; - map_sz = country_chplan_map_sz; -#endif + 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; - for (i = 0; i < map_sz; i++) { - if (strncmp(code, map[i].alpha2, 2) == 0) { - ent = &map[i]; - break; - } + _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; } -exit: - #if RTW_DEF_MODULE_REGULATORY_CERT - if (ent && !(COUNTRY_CHPLAN_DEF_MODULE_FALGS(ent) & RTW_DEF_MODULE_REGULATORY_CERT)) - ent = NULL; + 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_ALL(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_ALL(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) >= 6 ? 1 : 6 - strlen(ent->regd_name)); + 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)) >= 6 ? 1 : 6 - strlen(regd_str(TXPWR_LMT_WW))); + 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 == hal_spec->txgi_max) { + sprintf(fmt, "%%%zus ", strlen(ent->regd_name) >= 6 ? strlen(ent->regd_name) + 1 : 6); + snprintf(tmp_str, TMP_STR_LEN, fmt, "NA"); + _RTW_PRINT_SEL(sel, "%s", tmp_str); + } else if (lmt > -hal_spec->txgi_pdbm && lmt < 0) { /* -0.xx */ + sprintf(fmt, "%%%zus-0.%%d ", strlen(ent->regd_name) >= 6 ? strlen(ent->regd_name) - 4 : 1); + snprintf(tmp_str, TMP_STR_LEN, fmt, "", (rtw_abs(lmt) % hal_spec->txgi_pdbm) * 100 / hal_spec->txgi_pdbm); + _RTW_PRINT_SEL(sel, "%s", tmp_str); + } else if (lmt % hal_spec->txgi_pdbm) { /* d.xx */ + sprintf(fmt, "%%%zud.%%d ", strlen(ent->regd_name) >= 6 ? strlen(ent->regd_name) - 2 : 3); + snprintf(tmp_str, TMP_STR_LEN, fmt, lmt / hal_spec->txgi_pdbm, (rtw_abs(lmt) % hal_spec->txgi_pdbm) * 100 / hal_spec->txgi_pdbm); + _RTW_PRINT_SEL(sel, "%s", tmp_str); + } else { /* d */ + sprintf(fmt, "%%%zud ", strlen(ent->regd_name) >= 6 ? strlen(ent->regd_name) + 1 : 6); + snprintf(tmp_str, TMP_STR_LEN, fmt, lmt / hal_spec->txgi_pdbm); + _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 == hal_spec->txgi_max) { + sprintf(fmt, "%%%zus ", strlen(regd_str(TXPWR_LMT_WW)) >= 6 ? strlen(regd_str(TXPWR_LMT_WW)) + 1 : 6); + snprintf(tmp_str, TMP_STR_LEN, fmt, "NA"); + _RTW_PRINT_SEL(sel, "%s", tmp_str); + } else if (lmt > -hal_spec->txgi_pdbm && lmt < 0) { /* -0.xx */ + sprintf(fmt, "%%%zus-0.%%d ", strlen(regd_str(TXPWR_LMT_WW)) >= 6 ? strlen(regd_str(TXPWR_LMT_WW)) - 4 : 1); + snprintf(tmp_str, TMP_STR_LEN, fmt, "", (rtw_abs(lmt) % hal_spec->txgi_pdbm) * 100 / hal_spec->txgi_pdbm); + _RTW_PRINT_SEL(sel, "%s", tmp_str); + } else if (lmt % hal_spec->txgi_pdbm) { /* d.xx */ + sprintf(fmt, "%%%zud.%%d ", strlen(regd_str(TXPWR_LMT_WW)) >= 6 ? strlen(regd_str(TXPWR_LMT_WW)) - 2 : 3); + snprintf(tmp_str, TMP_STR_LEN, fmt, lmt / hal_spec->txgi_pdbm, (rtw_abs(lmt) % hal_spec->txgi_pdbm) * 100 / hal_spec->txgi_pdbm); + _RTW_PRINT_SEL(sel, "%s", tmp_str); + } else { /* d */ + sprintf(fmt, "%%%zud ", strlen(regd_str(TXPWR_LMT_WW)) >= 6 ? strlen(regd_str(TXPWR_LMT_WW)) + 1 : 6); + snprintf(tmp_str, TMP_STR_LEN, fmt, lmt / hal_spec->txgi_pdbm); + _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 == hal_spec->txgi_max) { + *(lmt_idx + i * RF_PATH_MAX + path) = hal_spec->txgi_max; + _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 == hal_spec->txgi_max) + _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 hal_spec_t *hal_spec = GET_HAL_SPEC(dvobj_get_primary_adapter(rfctl_to_dvobj(rfctl))); + 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] = hal_spec->txgi_max; + #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] = hal_spec->txgi_max; + #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 != hal_spec->txgi_max) + 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; @@ -1011,7 +1215,6 @@ s8 rtw_rf_get_kfree_tx_gain_offset(_adapter *padapter, u8 path, u8 ch) s8 kfree_offset = 0; #ifdef CONFIG_RF_POWER_TRIM - HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); struct kfree_data_t *kfree_data = GET_KFREE_DATA(padapter); s8 bb_gain_sel = rtw_ch_to_bb_gain_sel(ch); @@ -1037,7 +1240,9 @@ s8 rtw_rf_get_kfree_tx_gain_offset(_adapter *padapter, u8 path, u8 ch) void rtw_rf_set_tx_gain_offset(_adapter *adapter, u8 path, s8 offset) { +#if !defined(CONFIG_RTL8814A) && !defined(CONFIG_RTL8822B) && !defined(CONFIG_RTL8821C) && !defined(CONFIG_RTL8822C) u8 write_value; +#endif u8 target_path = 0; u32 val32 = 0; @@ -1076,6 +1281,12 @@ void rtw_rf_set_tx_gain_offset(_adapter *adapter, u8 path, s8 offset) rtw_hal_write_rfreg(adapter, target_path, 0x55, 0x0fc000, write_value); break; #endif /* CONFIG_RTL8188F */ +#ifdef CONFIG_RTL8188GTV + case RTL8188GTV: + write_value = RF_TX_GAIN_OFFSET_8188GTV(offset); + rtw_hal_write_rfreg(adapter, target_path, 0x55, 0x0fc000, write_value); + break; +#endif /* CONFIG_RTL8188GTV */ #ifdef CONFIG_RTL8192E case RTL8192E: write_value = RF_TX_GAIN_OFFSET_8192E(offset); @@ -1089,10 +1300,12 @@ void rtw_rf_set_tx_gain_offset(_adapter *adapter, u8 path, s8 offset) rtw_hal_write_rfreg(adapter, target_path, 0x55, 0x0f8000, write_value); break; #endif /* CONFIG_RTL8821A */ -#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) +#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8192F) || defined(CONFIG_RTL8822C) case RTL8814A: case RTL8822B: + case RTL8822C: case RTL8821C: + case RTL8192F: RTW_INFO("\nkfree by PhyDM on the sw CH. path %d\n", path); break; #endif /* CONFIG_RTL8814A || CONFIG_RTL8822B || CONFIG_RTL8821C */ @@ -1133,24 +1346,34 @@ void rtw_rf_apply_tx_gain_offset(_adapter *adapter, u8 ch) } } -bool rtw_is_dfs_range(u32 hi, u32 lo) +inline u8 rtw_is_dfs_range(u32 hi, u32 lo) { - return rtw_is_range_overlap(hi, lo, 5720 + 10, 5260 - 10) ? _TRUE : _FALSE; + return rtw_is_range_overlap(hi, lo, 5720 + 10, 5260 - 10); } -bool rtw_is_dfs_ch(u8 ch, u8 bw, u8 offset) +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/rtl8188eu/core/rtw_rm.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_rm.c new file mode 100644 index 000000000000..0a8d0b981cae --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_rm.c @@ -0,0 +1,2471 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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; +} + +/* for caller outside rm */ +u8 rm_add_nb_req(_adapter *padapter, struct sta_info *psta) +{ + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; + struct rm_obj *prm; + + + 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.category = RTW_WLAN_CATEGORY_RADIO_MEAS; + prm->q.diag_token = pmlmeinfo->dialogToken++; + prm->q.m_token = 1; + + prm->rmid = psta->cmn.aid << 16 + | prm->q.diag_token << 8 + | RM_MASTER; + + prm->q.action_code = RM_ACT_NB_REP_REQ; + + #if 0 + 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); + } + #endif + + /* enquee rmobj */ + rm_enqueue_rmobj(padapter, prm, _FALSE); + + RTW_INFO("RM: rmid=%x add req to " MAC_FMT "\n", + prm->rmid, MAC_ARG(psta->cmn.mac_addr)); + + return _SUCCESS; +} + + +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; + u8 ssc_chk; + + if (!rtw_is_adapter_up(padapter)) + return _FALSE; + + ssc_chk = rtw_sitesurvey_condition_check(padapter, _FALSE); + + if (ssc_chk == SS_ALLOW) + return _SUCCESS; + + return _FALSE; +} + +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_LAYER2_ROAMING + if (rtw_wnm_btm_candidates_survey(padapter + ,(pdiag_body + 3) + ,(len - sizeof(struct rtw_ieee80211_hdr_3addr)) + ,_FALSE) == _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) +{ + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(prm->psta->padapter); + int i, ch = -1; + u8 val8; + + + ch = rtw_chset_search_ch(adapter_to_chset(prm->psta->padapter), + prm->q.ch_num); + + if ((ch == -1) || (ch >= MAX_CHANNEL_NUM)) { + RTW_ERR("RM: get ch(CH:%d) fail\n", prm->q.ch_num); + ch = 0; + } + + switch (prm->q.m_type) { + case ch_load_req: +#ifdef CONFIG_RTW_ACS + val8 = hal_data->acs.clm_ratio[ch]; +#else + val8 = 0; +#endif + prm->p.ch_load = val8; + break; + case noise_histo_req: +#ifdef CONFIG_RTW_ACS + /* ANPI */ + prm->p.anpi = hal_data->acs.nhm_ratio[ch]; + + /* IPI 0~10 */ + for (i=0;i<11;i++) + prm->p.ipi[i] = hal_data->acs.nhm[ch][i]; + +#else + val8 = 0; + prm->p.anpi = val8; + for (i=0;i<11;i++) + prm->p.ipi[i] = val8; +#endif + 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) +{ + if (elem->rm_en_cap) { + 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) +{ + unsigned val; + char *paid; + struct sta_info *psta=NULL; + +#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 if (_rtw_memcmp(s, "nb", 2)) { + + paid = strstr(s, "aid="); + + 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); + + if (psta) + rm_add_nb_req(padapter, psta); + } + } +#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/rtl8188eu/core/rtw_rm_fsm.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_rm_fsm.c new file mode 100644 index 000000000000..d24173a5bf9a --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_rm_fsm.c @@ -0,0 +1,999 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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 */ + prm->meas_start_time = rtw_hal_get_tsftr_by_port(padapter + , rtw_hal_get_port(padapter)); + + 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 */ + prm->meas_end_time = rtw_hal_get_tsftr_by_port(padapter + , rtw_hal_get_port(padapter)); + + 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/rtl8188eu/core/rtw_rson.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_rson.c new file mode 100644 index 000000000000..e638f988d4e1 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_rson.c @@ -0,0 +1,589 @@ +/* SPDX-License-Identifier: GPL-2.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 + * + * + ******************************************************************************/ +#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 (is_match_bssid(competitor->network.MacAddress, rtw_rson_block_bssid, rtw_rson_block_bssid_idx) == _TRUE) + 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) != _TRUE) + 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); + rtw_free_assoc_resources(padapter, _TRUE); + 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/rtl8188eu/core/rtw_sdio.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_sdio.c index 817d60b9ccfb..328a2284c6aa 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_sdio.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_sdio.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +36,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 +124,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/rtl8188eu/core/rtw_security.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_security.c index df88f53d0b27..d5de17dfa50a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_security.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_security.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +822,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; @@ -987,13 +983,6 @@ static void next_key(u8 *key, sint round); static void byte_sub(u8 *in, u8 *out); static void shift_row(u8 *in, u8 *out); static void mix_column(u8 *in, u8 *out); -#ifndef PLATFORM_FREEBSD -static void add_round_key(u8 *shiftrow_in, - u8 *mcol_in, - u8 *block_in, - sint round, - u8 *out); -#endif /* PLATFORM_FREEBSD */ static void aes128k128d(u8 *key, u8 *data, u8 *ciphertext); @@ -1190,11 +1179,11 @@ static void construct_mic_iv( mic_iv[1] = mpdu[24] & 0x0f; /* mute bits 7-4 */ if (!qc_exists) mic_iv[1] = 0x00; -#ifdef CONFIG_IEEE80211W +#if defined(CONFIG_IEEE80211W) || defined(CONFIG_RTW_MESH) /* 802.11w management frame should set management bit(4) */ if (frtype == WIFI_MGT_TYPE) mic_iv[1] |= BIT(4); -#endif /* CONFIG_IEEE80211W */ +#endif for (i = 2; i < 8; i++) mic_iv[i] = mpdu[i + 8]; /* mic_iv[2:7] = A2[0:5] = mpdu[10:15] */ #ifdef CONSISTENT_PN_ORDER @@ -1224,12 +1213,12 @@ static void construct_mic_header1( { mic_header1[0] = (u8)((header_length - 2) / 256); mic_header1[1] = (u8)((header_length - 2) % 256); -#ifdef CONFIG_IEEE80211W +#if defined(CONFIG_IEEE80211W) || defined(CONFIG_RTW_MESH) /* 802.11w management frame don't AND subtype bits 4,5,6 of frame control field */ if (frtype == WIFI_MGT_TYPE) mic_header1[2] = mpdu[0]; else -#endif /* CONFIG_IEEE80211W */ +#endif mic_header1[2] = mpdu[0] & 0xcf; /* Mute CF poll & CF ack bits */ mic_header1[3] = mpdu[1] & 0xc7; /* Mute retry, more data and pwr mgt bits */ @@ -1325,11 +1314,11 @@ static void construct_ctr_preload( ctr_preload[1] = mpdu[30] & 0x0f; /* QoC_Control */ if (qc_exists && !a4_exists) ctr_preload[1] = mpdu[24] & 0x0f; -#ifdef CONFIG_IEEE80211W +#if defined(CONFIG_IEEE80211W) || defined(CONFIG_RTW_MESH) /* 802.11w management frame should set management bit(4) */ if (frtype == WIFI_MGT_TYPE) ctr_preload[1] |= BIT(4); -#endif /* CONFIG_IEEE80211W */ +#endif for (i = 2; i < 8; i++) ctr_preload[i] = mpdu[i + 8]; /* ctr_preload[2:7] = A2[0:5] = mpdu[10:15] */ #ifdef CONSISTENT_PN_ORDER @@ -1399,8 +1388,7 @@ static sint aes_cipher(u8 *key, uint hdrlen, ((frtype | frsubtype) == WIFI_DATA_CFPOLL) || ((frtype | frsubtype) == WIFI_DATA_CFACKPOLL)) { qc_exists = 1; - if (hdrlen != WLAN_HDR_A3_QOS_LEN) - + if (hdrlen != WLAN_HDR_A3_QOS_LEN && hdrlen != WLAN_HDR_A4_QOS_LEN) hdrlen += 2; } /* add for CONFIG_IEEE80211W, none 11w also can use */ @@ -1409,8 +1397,7 @@ static sint aes_cipher(u8 *key, uint hdrlen, (frsubtype == 0x09) || (frsubtype == 0x0a) || (frsubtype == 0x0b))) { - if (hdrlen != WLAN_HDR_A3_QOS_LEN) - + if (hdrlen != WLAN_HDR_A3_QOS_LEN && hdrlen != WLAN_HDR_A4_QOS_LEN) hdrlen += 2; qc_exists = 1; } else @@ -1720,8 +1707,7 @@ static sint aes_decipher(u8 *key, uint hdrlen, ((frtype | frsubtype) == WIFI_DATA_CFPOLL) || ((frtype | frsubtype) == WIFI_DATA_CFACKPOLL)) { qc_exists = 1; - if (hdrlen != WLAN_HDR_A3_QOS_LEN) - + if (hdrlen != WLAN_HDR_A3_QOS_LEN && hdrlen != WLAN_HDR_A4_QOS_LEN) hdrlen += 2; } /* only for data packet . add for CONFIG_IEEE80211W, none 11w also can use */ else if ((frtype == WIFI_DATA) && @@ -1729,8 +1715,7 @@ static sint aes_decipher(u8 *key, uint hdrlen, (frsubtype == 0x09) || (frsubtype == 0x0a) || (frsubtype == 0x0b))) { - if (hdrlen != WLAN_HDR_A3_QOS_LEN) - + if (hdrlen != WLAN_HDR_A3_QOS_LEN && hdrlen != WLAN_HDR_A4_QOS_LEN) hdrlen += 2; qc_exists = 1; } else @@ -1938,7 +1923,6 @@ u32 rtw_aes_decrypt(_adapter *padapter, u8 *precvframe) sint length; - u32 prwskeylen; u8 *pframe, *prwskey; /* , *payload,*iv */ struct sta_info *stainfo; struct rx_pkt_attrib *prxattrib = &((union recv_frame *)precvframe)->u.hdr.attrib; @@ -1953,13 +1937,17 @@ 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; /* RTW_INFO("rx bc/mc packets, to perform sw rtw_aes_decrypt\n"); */ /* prwskey = psecuritypriv->dot118021XGrpKey[psecuritypriv->dot118021XGrpKeyid].skey; */ - if (psecuritypriv->binstallGrpkey == _FALSE) { + if ((!MLME_IS_MESH(padapter) && psecuritypriv->binstallGrpkey == _FALSE) + #ifdef CONFIG_RTW_MESH + || !(stainfo->gtk_bmp | BIT(prxattrib->key_index)) + #endif + ) { res = _FAIL; if (start == 0) @@ -1991,12 +1979,20 @@ u32 rtw_aes_decrypt(_adapter *padapter, u8 *precvframe) no_gkey_bc_cnt = 0; no_gkey_mc_cnt = 0; - prwskey = psecuritypriv->dot118021XGrpKey[prxattrib->key_index].skey; - if (psecuritypriv->dot118021XGrpKeyid != prxattrib->key_index) { - RTW_DBG("not match packet_index=%d, install_index=%d\n" - , prxattrib->key_index, psecuritypriv->dot118021XGrpKeyid); - res = _FAIL; - goto exit; + #ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(padapter)) { + /* TODO: multiple GK? */ + prwskey = &stainfo->gtk.skey[0]; + } else + #endif + { + prwskey = psecuritypriv->dot118021XGrpKey[prxattrib->key_index].skey; + if (psecuritypriv->dot118021XGrpKeyid != prxattrib->key_index) { + RTW_DBG("not match packet_index=%d, install_index=%d\n" + , prxattrib->key_index, psecuritypriv->dot118021XGrpKeyid); + res = _FAIL; + goto exit; + } } } else prwskey = &stainfo->dot118021x_UncstKey.skey[0]; @@ -2038,94 +2034,96 @@ u32 rtw_aes_decrypt(_adapter *padapter, u8 *precvframe) } #ifdef CONFIG_IEEE80211W -u32 rtw_BIP_verify(_adapter *padapter, u8 *precvframe) +u32 rtw_BIP_verify(_adapter *padapter, u8 *whdr_pos, sint flen + , const u8 *key, u16 keyid, u64* ipn) { - struct rx_pkt_attrib *pattrib = &((union recv_frame *)precvframe)->u.hdr.attrib; - u8 *pframe; - u8 *BIP_AAD, *p; + u8 *BIP_AAD, *mme; u32 res = _FAIL; uint len, ori_len; + u16 pkt_keyid = 0; + u64 pkt_ipn = 0; struct rtw_ieee80211_hdr *pwlanhdr; u8 mic[16]; - struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - ori_len = pattrib->pkt_len - WLAN_HDR_A3_LEN + BIP_AAD_SIZE; - BIP_AAD = rtw_zmalloc(ori_len); + mme = whdr_pos + flen - 18; + if (*mme != _MME_IE_) + return RTW_RX_HANDLED; + + /* copy key index */ + _rtw_memcpy(&pkt_keyid, mme + 2, 2); + pkt_keyid = le16_to_cpu(pkt_keyid); + if (pkt_keyid != keyid) { + RTW_INFO("BIP key index error!\n"); + return _FAIL; + } + + /* save packet number */ + _rtw_memcpy(&pkt_ipn, mme + 4, 6); + pkt_ipn = le64_to_cpu(pkt_ipn); + /* BIP packet number should bigger than previous BIP packet */ + if (pkt_ipn <= *ipn) { /* wrap around? */ + RTW_INFO("replay BIP packet\n"); + return _FAIL; + } + + ori_len = flen - WLAN_HDR_A3_LEN + BIP_AAD_SIZE; + BIP_AAD = rtw_zmalloc(ori_len); if (BIP_AAD == NULL) { RTW_INFO("BIP AAD allocate fail\n"); return _FAIL; } - /* PKT start */ - pframe = (unsigned char *)((union recv_frame *)precvframe)->u.hdr.rx_data; + /* mapping to wlan header */ - pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; + pwlanhdr = (struct rtw_ieee80211_hdr *)whdr_pos; + /* save the frame body + MME */ - _rtw_memcpy(BIP_AAD + BIP_AAD_SIZE, pframe + WLAN_HDR_A3_LEN, pattrib->pkt_len - WLAN_HDR_A3_LEN); - /* find MME IE pointer */ - p = rtw_get_ie(BIP_AAD + BIP_AAD_SIZE, _MME_IE_, &len, pattrib->pkt_len - WLAN_HDR_A3_LEN); - /* Baron */ - if (p) { - u16 keyid = 0; - u64 temp_ipn = 0; - /* save packet number */ - _rtw_memcpy(&temp_ipn, p + 4, 6); - temp_ipn = le64_to_cpu(temp_ipn); - /* BIP packet number should bigger than previous BIP packet */ - if (temp_ipn < pmlmeext->mgnt_80211w_IPN_rx) { - RTW_INFO("replay BIP packet\n"); - goto BIP_exit; - } - /* copy key index */ - _rtw_memcpy(&keyid, p + 2, 2); - keyid = le16_to_cpu(keyid); - if (keyid != padapter->securitypriv.dot11wBIPKeyid) { - RTW_INFO("BIP key index error!\n"); - goto BIP_exit; - } - /* clear the MIC field of MME to zero */ - _rtw_memset(p + 2 + len - 8, 0, 8); + _rtw_memcpy(BIP_AAD + BIP_AAD_SIZE, whdr_pos + WLAN_HDR_A3_LEN, flen - WLAN_HDR_A3_LEN); - /* conscruct AAD, copy frame control field */ - _rtw_memcpy(BIP_AAD, &pwlanhdr->frame_ctl, 2); - ClearRetry(BIP_AAD); - ClearPwrMgt(BIP_AAD); - ClearMData(BIP_AAD); - /* conscruct AAD, copy address 1 to address 3 */ - _rtw_memcpy(BIP_AAD + 2, pwlanhdr->addr1, 18); + /* point mme to the copy */ + mme = BIP_AAD + ori_len - 18; - if (omac1_aes_128(padapter->securitypriv.dot11wBIPKey[padapter->securitypriv.dot11wBIPKeyid].skey - , BIP_AAD, ori_len, mic)) - goto BIP_exit; + /* clear the MIC field of MME to zero */ + _rtw_memset(mme + 10, 0, 8); + + /* conscruct AAD, copy frame control field */ + _rtw_memcpy(BIP_AAD, &pwlanhdr->frame_ctl, 2); + ClearRetry(BIP_AAD); + ClearPwrMgt(BIP_AAD); + ClearMData(BIP_AAD); + /* conscruct AAD, copy address 1 to address 3 */ + _rtw_memcpy(BIP_AAD + 2, pwlanhdr->addr1, 18); + + if (omac1_aes_128(key, BIP_AAD, ori_len, mic)) + goto BIP_exit; #if 0 - /* management packet content */ - { - int pp; - RTW_INFO("pkt: "); - for (pp = 0; pp < pattrib->pkt_len; pp++) - printk(" %02x ", pframe[pp]); - RTW_INFO("\n"); - /* BIP AAD + management frame body + MME(MIC is zero) */ - RTW_INFO("AAD+PKT: "); - for (pp = 0; pp < ori_len; pp++) - RTW_INFO(" %02x ", BIP_AAD[pp]); - RTW_INFO("\n"); - /* show the MIC result */ - RTW_INFO("mic: "); - for (pp = 0; pp < 16; pp++) - RTW_INFO(" %02x ", mic[pp]); - RTW_INFO("\n"); - } + /* management packet content */ + { + int pp; + RTW_INFO("pkt: "); + for (pp = 0; pp < flen; pp++) + printk(" %02x ", whdr_pos[pp]); + RTW_INFO("\n"); + /* BIP AAD + management frame body + MME(MIC is zero) */ + RTW_INFO("AAD+PKT: "); + for (pp = 0; pp < ori_len; pp++) + RTW_INFO(" %02x ", BIP_AAD[pp]); + RTW_INFO("\n"); + /* show the MIC result */ + RTW_INFO("mic: "); + for (pp = 0; pp < 16; pp++) + RTW_INFO(" %02x ", mic[pp]); + RTW_INFO("\n"); + } #endif - /* MIC field should be last 8 bytes of packet (packet without FCS) */ - if (_rtw_memcmp(mic, pframe + pattrib->pkt_len - 8, 8)) { - pmlmeext->mgnt_80211w_IPN_rx = temp_ipn; - res = _SUCCESS; - } else - RTW_INFO("BIP MIC error!\n"); + /* MIC field should be last 8 bytes of packet (packet without FCS) */ + if (_rtw_memcmp(mic, whdr_pos + flen - 8, 8)) { + *ipn = pkt_ipn; + res = _SUCCESS; } else - res = RTW_RX_HANDLED; + RTW_INFO("BIP MIC error!\n"); + BIP_exit: rtw_mfree(BIP_AAD, ori_len); @@ -2134,6 +2132,7 @@ u32 rtw_BIP_verify(_adapter *padapter, u8 *precvframe) #endif /* CONFIG_IEEE80211W */ #ifndef PLATFORM_FREEBSD +#if defined(CONFIG_TDLS) /* compress 512-bits */ static int sha256_compress(struct sha256_state *md, unsigned char *buf) { @@ -2210,7 +2209,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) { @@ -2314,10 +2313,12 @@ static u8 os_strlen(const char *s) p++; return p - s; } +#endif -static int os_memcmp(void *s1, void *s2, u8 n) +#if defined(CONFIG_TDLS) || defined(CONFIG_RTW_MESH_AEK) +static int os_memcmp(const void *s1, const void *s2, u8 n) { - unsigned char *p1 = s1, *p2 = s2; + const unsigned char *p1 = s1, *p2 = s2; if (n == 0) return 0; @@ -2332,6 +2333,7 @@ static int os_memcmp(void *s1, void *s2, u8 n) return *p1 - *p2; } +#endif /** * hmac_sha256_vector - HMAC-SHA256 over data vector (RFC 2104) @@ -2342,6 +2344,7 @@ static int os_memcmp(void *s1, void *s2, u8 n) * @len: Lengths of the data blocks * @mac: Buffer for the hash (32 bytes) */ +#if defined(CONFIG_TDLS) static void hmac_sha256_vector(u8 *key, size_t key_len, size_t num_elem, u8 *addr[], size_t *len, u8 *mac) { @@ -2403,6 +2406,7 @@ static void hmac_sha256_vector(u8 *key, size_t key_len, size_t num_elem, _len[1] = 32; sha256_vector(2, _addr, _len, mac); } +#endif /* CONFIG_TDLS */ #endif /* PLATFORM_FREEBSD */ /** * sha256_prf - SHA256-based Pseudo-Random Function (IEEE 802.11r, 8.5.1.5.2) @@ -2418,6 +2422,7 @@ static void hmac_sha256_vector(u8 *key, size_t key_len, size_t num_elem, * given key. */ #ifndef PLATFORM_FREEBSD /* Baron */ +#if defined(CONFIG_TDLS) static void sha256_prf(u8 *key, size_t key_len, char *label, u8 *data, size_t data_len, u8 *buf, size_t buf_len) { @@ -2454,6 +2459,7 @@ static void sha256_prf(u8 *key, size_t key_len, char *label, counter++; } } +#endif #endif /* PLATFORM_FREEBSD Baron */ /* AES tables*/ @@ -2723,7 +2729,7 @@ static void rijndaelEncrypt(u32 rk[/*44*/], u8 pt[16], u8 ct[16]) PUTU32(ct + 12, s3); } -static void *aes_encrypt_init(u8 *key, size_t len) +static void *aes_encrypt_init(const u8 *key, size_t len) { u32 *rk; if (len != 16) @@ -2773,12 +2779,12 @@ static void aes_encrypt_deinit(void *ctx) * OMAC1 was standardized with the name CMAC by NIST in a Special Publication * (SP) 800-38B. */ -static int omac1_aes_128_vector(u8 *key, size_t num_elem, - u8 *addr[], size_t *len, u8 *mac) +static int omac1_aes_128_vector(const u8 *key, size_t num_elem, + const u8 *addr[], const size_t *len, u8 *mac) { void *ctx; u8 cbc[AES_BLOCK_SIZE], pad[AES_BLOCK_SIZE]; - u8 *pos, *end; + const u8 *pos, *end; size_t i, e, left, total_len; ctx = aes_encrypt_init(key, 16); @@ -2846,14 +2852,239 @@ static int omac1_aes_128_vector(u8 *key, size_t num_elem, * OMAC1 was standardized with the name CMAC by NIST in a Special Publication * (SP) 800-38B. */ /* modify for CONFIG_IEEE80211W */ -int omac1_aes_128(u8 *key, u8 *data, size_t data_len, u8 *mac) +int omac1_aes_128(const u8 *key, const u8 *data, size_t data_len, u8 *mac) { return omac1_aes_128_vector(key, 1, &data, &data_len, mac); } #endif /* PLATFORM_FREEBSD Baron */ +#ifdef CONFIG_RTW_MESH_AEK +/* for AES-SIV */ +#define os_memset _rtw_memset +#define os_memcpy _rtw_memcpy +#define os_malloc rtw_malloc +#define bin_clear_free(bin, len) \ + do { \ + if (bin) { \ + os_memset(bin, 0, len); \ + rtw_mfree(bin, len); \ + } \ + } while (0) + +static const u8 zero[AES_BLOCK_SIZE]; + +static void dbl(u8 *pad) +{ + int i, carry; + + carry = pad[0] & 0x80; + for (i = 0; i < AES_BLOCK_SIZE - 1; i++) + pad[i] = (pad[i] << 1) | (pad[i + 1] >> 7); + pad[AES_BLOCK_SIZE - 1] <<= 1; + if (carry) + pad[AES_BLOCK_SIZE - 1] ^= 0x87; +} + +static void xor(u8 *a, const u8 *b) +{ + int i; + + for (i = 0; i < AES_BLOCK_SIZE; i++) + *a++ ^= *b++; +} + +static void xorend(u8 *a, int alen, const u8 *b, int blen) +{ + int i; + + if (alen < blen) + return; + + for (i = 0; i < blen; i++) + a[alen - blen + i] ^= b[i]; +} + +static void pad_block(u8 *pad, const u8 *addr, size_t len) +{ + os_memset(pad, 0, AES_BLOCK_SIZE); + os_memcpy(pad, addr, len); + + if (len < AES_BLOCK_SIZE) + pad[len] = 0x80; +} + +static int aes_s2v(const u8 *key, size_t num_elem, const u8 *addr[], + size_t *len, u8 *mac) +{ + u8 tmp[AES_BLOCK_SIZE], tmp2[AES_BLOCK_SIZE]; + u8 *buf = NULL; + int ret; + size_t i; + + if (!num_elem) { + os_memcpy(tmp, zero, sizeof(zero)); + tmp[AES_BLOCK_SIZE - 1] = 1; + return omac1_aes_128(key, tmp, sizeof(tmp), mac); + } + + ret = omac1_aes_128(key, zero, sizeof(zero), tmp); + if (ret) + return ret; + + for (i = 0; i < num_elem - 1; i++) { + ret = omac1_aes_128(key, addr[i], len[i], tmp2); + if (ret) + return ret; + + dbl(tmp); + xor(tmp, tmp2); + } + if (len[i] >= AES_BLOCK_SIZE) { + buf = os_malloc(len[i]); + if (!buf) + return -ENOMEM; + + os_memcpy(buf, addr[i], len[i]); + xorend(buf, len[i], tmp, AES_BLOCK_SIZE); + ret = omac1_aes_128(key, buf, len[i], mac); + bin_clear_free(buf, len[i]); + return ret; + } + + dbl(tmp); + pad_block(tmp2, addr[i], len[i]); + xor(tmp, tmp2); + + return omac1_aes_128(key, tmp, sizeof(tmp), mac); +} + +/** + * aes_128_ctr_encrypt - AES-128 CTR mode encryption + * @key: Key for encryption (16 bytes) + * @nonce: Nonce for counter mode (16 bytes) + * @data: Data to encrypt in-place + * @data_len: Length of data in bytes + * Returns: 0 on success, -1 on failure + */ +int aes_128_ctr_encrypt(const u8 *key, const u8 *nonce, + u8 *data, size_t data_len) +{ + void *ctx; + size_t j, len, left = data_len; + int i; + u8 *pos = data; + u8 counter[AES_BLOCK_SIZE], buf[AES_BLOCK_SIZE]; + + ctx = aes_encrypt_init(key, 16); + if (ctx == NULL) + return -1; + os_memcpy(counter, nonce, AES_BLOCK_SIZE); + + while (left > 0) { + #if 0 + aes_encrypt(ctx, counter, buf); + #else + aes_128_encrypt(ctx, counter, buf); + #endif + + len = (left < AES_BLOCK_SIZE) ? left : AES_BLOCK_SIZE; + for (j = 0; j < len; j++) + pos[j] ^= buf[j]; + pos += len; + left -= len; + + for (i = AES_BLOCK_SIZE - 1; i >= 0; i--) { + counter[i]++; + if (counter[i]) + break; + } + } + aes_encrypt_deinit(ctx); + return 0; +} + +int aes_siv_encrypt(const u8 *key, const u8 *pw, + size_t pwlen, size_t num_elem, + const u8 *addr[], const size_t *len, u8 *out) +{ + const u8 *_addr[6]; + size_t _len[6]; + const u8 *k1 = key, *k2 = key + 16; + u8 v[AES_BLOCK_SIZE]; + size_t i; + u8 *iv, *crypt_pw; + + if (num_elem > ARRAY_SIZE(_addr) - 1) + return -1; + + for (i = 0; i < num_elem; i++) { + _addr[i] = addr[i]; + _len[i] = len[i]; + } + _addr[num_elem] = pw; + _len[num_elem] = pwlen; + + if (aes_s2v(k1, num_elem + 1, _addr, _len, v)) + return -1; + + iv = out; + crypt_pw = out + AES_BLOCK_SIZE; + + os_memcpy(iv, v, AES_BLOCK_SIZE); + os_memcpy(crypt_pw, pw, pwlen); + + /* zero out 63rd and 31st bits of ctr (from right) */ + v[8] &= 0x7f; + v[12] &= 0x7f; + return aes_128_ctr_encrypt(k2, v, crypt_pw, pwlen); +} + +int aes_siv_decrypt(const u8 *key, const u8 *iv_crypt, size_t iv_c_len, + size_t num_elem, const u8 *addr[], const size_t *len, + u8 *out) +{ + const u8 *_addr[6]; + size_t _len[6]; + const u8 *k1 = key, *k2 = key + 16; + size_t crypt_len; + size_t i; + int ret; + u8 iv[AES_BLOCK_SIZE]; + u8 check[AES_BLOCK_SIZE]; + + if (iv_c_len < AES_BLOCK_SIZE || num_elem > ARRAY_SIZE(_addr) - 1) + return -1; + crypt_len = iv_c_len - AES_BLOCK_SIZE; + + for (i = 0; i < num_elem; i++) { + _addr[i] = addr[i]; + _len[i] = len[i]; + } + _addr[num_elem] = out; + _len[num_elem] = crypt_len; + + os_memcpy(iv, iv_crypt, AES_BLOCK_SIZE); + os_memcpy(out, iv_crypt + AES_BLOCK_SIZE, crypt_len); + + iv[8] &= 0x7f; + iv[12] &= 0x7f; + + ret = aes_128_ctr_encrypt(k2, iv, out, crypt_len); + if (ret) + return ret; + + ret = aes_s2v(k1, num_elem + 1, _addr, _len, check); + if (ret) + return ret; + if (os_memcmp(check, iv_crypt, AES_BLOCK_SIZE) == 0) + return 0; + + return -1; +} +#endif /* CONFIG_RTW_MESH_AEK */ + #ifdef CONFIG_TDLS -void wpa_tdls_generate_tpk(_adapter *padapter, PVOID sta) +void wpa_tdls_generate_tpk(_adapter *padapter, void *sta) { struct sta_info *psta = (struct sta_info *)sta; struct mlme_priv *pmlmepriv = &padapter->mlmepriv; @@ -2888,11 +3119,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 +3302,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/rtl8188eu/core/rtw_sreset.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_sreset.c index 6d241ca41b87..65d7b8fbc53a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_sreset.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_sreset.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 @@ -52,10 +48,9 @@ u8 sreset_get_wifi_status(_adapter *padapter) #if defined(DBG_CONFIG_ERROR_DETECT) HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); struct sreset_priv *psrtpriv = &pHalData->srestpriv; - u8 status = WIFI_STATUS_SUCCESS; u32 val32 = 0; - _irqL irqL; + if (psrtpriv->silent_reset_inprogress == _TRUE) return status; val32 = rtw_read32(padapter, REG_TXDMA_STATUS); @@ -109,11 +104,9 @@ bool sreset_inprogress(_adapter *padapter) void sreset_restore_security_station(_adapter *padapter) { - u8 EntryId = 0; struct mlme_priv *mlmepriv = &padapter->mlmepriv; struct sta_priv *pstapriv = &padapter->stapriv; struct sta_info *psta; - struct security_priv *psecuritypriv = &(padapter->securitypriv); struct mlme_ext_info *pmlmeinfo = &padapter->mlmeextpriv.mlmext_info; { @@ -131,31 +124,18 @@ void sreset_restore_security_station(_adapter *padapter) rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, (u8 *)(&val8)); } -#if 0 - if ((padapter->securitypriv.dot11PrivacyAlgrthm == _WEP40_) || - (padapter->securitypriv.dot11PrivacyAlgrthm == _WEP104_)) { - - for (EntryId = 0; EntryId < 4; EntryId++) { - if (EntryId == psecuritypriv->dot11PrivacyKeyIndex) - rtw_set_key(padapter, &padapter->securitypriv, EntryId, 1, _FALSE); - else - rtw_set_key(padapter, &padapter->securitypriv, EntryId, 0, _FALSE); - } - - } else -#endif - if ((padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_) || - (padapter->securitypriv.dot11PrivacyAlgrthm == _AES_)) { - psta = rtw_get_stainfo(pstapriv, get_bssid(mlmepriv)); - if (psta == NULL) { - /* DEBUG_ERR( ("Set wpa_set_encryption: Obtain Sta_info fail\n")); */ - } else { - /* pairwise key */ - rtw_setstakey_cmd(padapter, psta, UNICAST_KEY, _FALSE); - /* group key */ - rtw_set_key(padapter, &padapter->securitypriv, padapter->securitypriv.dot118021XGrpKeyid, 0, _FALSE); - } + if ((padapter->securitypriv.dot11PrivacyAlgrthm == _TKIP_) || + (padapter->securitypriv.dot11PrivacyAlgrthm == _AES_)) { + psta = rtw_get_stainfo(pstapriv, get_bssid(mlmepriv)); + if (psta == NULL) { + /* DEBUG_ERR( ("Set wpa_set_encryption: Obtain Sta_info fail\n")); */ + } else { + /* pairwise key */ + rtw_setstakey_cmd(padapter, psta, UNICAST_KEY, _FALSE); + /* group key */ + rtw_set_key(padapter, &padapter->securitypriv, padapter->securitypriv.dot118021XGrpKeyid, 0, _FALSE); } + } } void sreset_restore_network_station(_adapter *padapter) @@ -165,32 +145,14 @@ void sreset_restore_network_station(_adapter *padapter) struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); u8 doiqk = _FALSE; -#if 0 - { - /* ======================================================= */ - /* reset related register of Beacon control */ - - /* set MSR to nolink */ - Set_MSR(padapter, _HW_STATE_NOLINK_); - /* reject all data frame */ - rtw_write16(padapter, REG_RXFLTMAP2, 0x00); - /* reset TSF */ - rtw_write8(padapter, REG_DUAL_TSF_RST, (BIT(0) | BIT(1))); - - /* disable update TSF */ - SetBcnCtrlReg(padapter, BIT(4), 0); - - /* ======================================================= */ - } -#endif - - rtw_setopmode_cmd(padapter, Ndis802_11Infrastructure, _FALSE); + rtw_setopmode_cmd(padapter, Ndis802_11Infrastructure, RTW_CMDF_DIRECTLY); { u8 threshold; #ifdef CONFIG_USB_HCI /* TH=1 => means that invalidate usb rx aggregation */ /* TH=0 => means that validate usb rx aggregation, use init value. */ +#ifdef CONFIG_80211N_HT if (mlmepriv->htpriv.ht_option) { if (padapter->registrypriv.wifi_spec == 1) threshold = 1; @@ -201,6 +163,7 @@ void sreset_restore_network_station(_adapter *padapter) threshold = 1; rtw_hal_set_hwreg(padapter, HW_VAR_RXDMA_AGG_PG_TH, (u8 *)(&threshold)); } +#endif /* CONFIG_80211N_HT */ #endif } @@ -218,6 +181,8 @@ void sreset_restore_network_station(_adapter *padapter) { u8 join_type = 0; + + rtw_hal_rcr_set_chk_bssid(padapter, MLME_STA_CONNECTING); rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); } @@ -234,14 +199,12 @@ void sreset_restore_network_station(_adapter *padapter) void sreset_restore_network_status(_adapter *padapter) { struct mlme_priv *mlmepriv = &padapter->mlmepriv; - struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); 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 +236,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 +274,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; @@ -342,5 +305,8 @@ void sreset_reset(_adapter *padapter) RTW_INFO("%s done in %d ms\n", __FUNCTION__, rtw_get_passing_time_ms(start)); pdbgpriv->dbg_sreset_cnt++; + + psrtpriv->self_dect_fw = _FALSE; + psrtpriv->rx_cnt = 0; #endif } diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_sta_mgt.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_sta_mgt.c index 818b9e34e231..43652943dfc6 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_sta_mgt.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_sta_mgt.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2019 Realtek Corporation. * * This program is free software; you can redistribute it and/or modify it * under the terms of version 2 of the GNU General Public License as @@ -11,23 +12,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_STA_MGT_C_ #include -#if defined(PLATFORM_LINUX) && defined (PLATFORM_WINDOWS) - - #error "Shall be Linux or Windows, but not both!\n" - -#endif - - bool test_st_match_rule(_adapter *adapter, u8 *local_naddr, u8 *local_port, u8 *remote_naddr, u8 *remote_port) { if (ntohs(*((u16 *)local_port)) == 5001 || ntohs(*((u16 *)remote_port)) == 5001) @@ -133,6 +122,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 +194,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,65 +204,42 @@ 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) { + _adapter *adapter = container_of(pstapriv, _adapter, stapriv); + struct macid_ctl_t *macid_ctl = adapter_to_macidctl(adapter); struct sta_info *psta; s32 i; + u32 ret = _FAIL; + pstapriv->padapter = adapter; - pstapriv->pallocated_stainfo_buf = rtw_zvmalloc(sizeof(struct sta_info) * NUM_STA + 4); - + pstapriv->pallocated_stainfo_buf = rtw_zvmalloc( + sizeof(struct sta_info) * NUM_STA + MEM_ALIGNMENT_OFFSET); if (!pstapriv->pallocated_stainfo_buf) - return _FAIL; + goto exit; - pstapriv->pstainfo_buf = pstapriv->pallocated_stainfo_buf + 4 - - ((SIZE_PTR)(pstapriv->pallocated_stainfo_buf) & 3); + pstapriv->pstainfo_buf = pstapriv->pallocated_stainfo_buf; + if ((SIZE_PTR)pstapriv->pstainfo_buf & MEM_ALIGNMENT_PADDING) + pstapriv->pstainfo_buf += MEM_ALIGNMENT_OFFSET - + ((SIZE_PTR)pstapriv->pstainfo_buf & MEM_ALIGNMENT_PADDING); _rtw_init_queue(&pstapriv->free_sta_queue); @@ -262,9 +266,19 @@ u32 _rtw_init_sta_priv(struct sta_priv *pstapriv) pstapriv->adhoc_expire_to = 4; /* 4 * 2 = 8 sec */ #ifdef CONFIG_AP_MODE - - pstapriv->sta_dz_bitmap = 0; - pstapriv->tim_bitmap = 0; + pstapriv->max_aid = macid_ctl->num; + pstapriv->rr_aid = 0; + pstapriv->started_aid = 1; + pstapriv->sta_aid = rtw_zmalloc(pstapriv->max_aid * sizeof(struct sta_info *)); + if (!pstapriv->sta_aid) + goto exit; + pstapriv->aid_bmp_len = AID_BMP_LEN(pstapriv->max_aid); + pstapriv->sta_dz_bitmap = rtw_zmalloc(pstapriv->aid_bmp_len); + if (!pstapriv->sta_dz_bitmap) + goto exit; + pstapriv->tim_bitmap = rtw_zmalloc(pstapriv->aid_bmp_len); + if (!pstapriv->tim_bitmap) + goto exit; _rtw_init_listhead(&pstapriv->asoc_list); _rtw_init_listhead(&pstapriv->auth_list); @@ -290,15 +304,38 @@ u32 _rtw_init_sta_priv(struct sta_priv *pstapriv) #endif #if CONFIG_RTW_MACADDR_ACL - _rtw_init_queue(&(pstapriv->acl_list.acl_node_q)); + for (i = 0; i < RTW_ACL_PERIOD_NUM; i++) + rtw_macaddr_acl_init(adapter, i); #endif #if CONFIG_RTW_PRE_LINK_STA rtw_pre_link_sta_ctl_init(pstapriv); #endif - return _SUCCESS; +#if defined(DBG_ROAMING_TEST) || defined(CONFIG_RTW_REPEATER_SON) + rtw_set_rx_chk_limit(adapter,1); +#elif defined(CONFIG_ACTIVE_KEEP_ALIVE_CHECK) && !defined(CONFIG_LPS_LCLK_WD_TIMER) + rtw_set_rx_chk_limit(adapter,4); +#else + rtw_set_rx_chk_limit(adapter,8); +#endif + ret = _SUCCESS; + +exit: + if (ret != _SUCCESS) { + if (pstapriv->pallocated_stainfo_buf) + rtw_vmfree(pstapriv->pallocated_stainfo_buf, + sizeof(struct sta_info) * NUM_STA + MEM_ALIGNMENT_OFFSET); + #ifdef CONFIG_AP_MODE + if (pstapriv->sta_aid) + rtw_mfree(pstapriv->sta_aid, pstapriv->max_aid * sizeof(struct sta_info *)); + if (pstapriv->sta_dz_bitmap) + rtw_mfree(pstapriv->sta_dz_bitmap, pstapriv->aid_bmp_len); + #endif + } + + return ret; } inline int rtw_stainfo_offset(struct sta_priv *stapriv, struct sta_info *sta) @@ -431,7 +468,8 @@ u32 _rtw_free_sta_priv(struct sta_priv *pstapriv) rtw_mfree_sta_priv_lock(pstapriv); #if CONFIG_RTW_MACADDR_ACL - _rtw_deinit_queue(&(pstapriv->acl_list.acl_node_q)); + for (index = 0; index < RTW_ACL_PERIOD_NUM; index++) + rtw_macaddr_acl_deinit(pstapriv->padapter, index); #endif #if CONFIG_RTW_PRE_LINK_STA @@ -439,18 +477,35 @@ u32 _rtw_free_sta_priv(struct sta_priv *pstapriv) #endif if (pstapriv->pallocated_stainfo_buf) - rtw_vmfree(pstapriv->pallocated_stainfo_buf, sizeof(struct sta_info) * NUM_STA + 4); + rtw_vmfree(pstapriv->pallocated_stainfo_buf, + sizeof(struct sta_info) * NUM_STA + MEM_ALIGNMENT_OFFSET); + #ifdef CONFIG_AP_MODE + if (pstapriv->sta_aid) + rtw_mfree(pstapriv->sta_aid, pstapriv->max_aid * sizeof(struct sta_info *)); + if (pstapriv->sta_dz_bitmap) + rtw_mfree(pstapriv->sta_dz_bitmap, pstapriv->aid_bmp_len); + if (pstapriv->tim_bitmap) + rtw_mfree(pstapriv->tim_bitmap, pstapriv->aid_bmp_len); + #endif } return _SUCCESS; } -/* 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) +static void rtw_init_recv_timer(struct recv_reorder_ctrl *preorder_ctrl) { - _irqL irqL, irqL2; - uint tmp_aid; + _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, const u8 *hwaddr) +{ + _irqL irqL2; s32 index; _list *phash_list; struct sta_info *psta; @@ -474,14 +529,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); @@ -507,12 +559,13 @@ struct sta_info *rtw_alloc_stainfo(struct sta_priv *pstapriv, u8 *hwaddr) for (i = 0; i < 16; i++) { _rtw_memcpy(&psta->sta_recvpriv.rxcache.tid_rxseq[i], &wRxSeqInitialValue, 2); + _rtw_memcpy(&psta->sta_recvpriv.bmc_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); @@ -521,16 +574,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; */ @@ -543,17 +594,21 @@ struct sta_info *rtw_alloc_stainfo(struct sta_priv *pstapriv, u8 *hwaddr) /* init for DM */ - psta->rssi_stat.undecorated_smoothed_pwdb = (-1); - psta->rssi_stat.undecorated_smoothed_cck = (-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_memset(&psta->sta_stats, 0, sizeof(struct stainfo_stats)); rtw_alloc_macid(pstapriv->padapter, psta); + psta->tx_q_enable = 0; + _rtw_init_queue(&psta->tx_queue); + _init_workitem(&psta->tx_q_work, rtw_xmit_dequeue_callback, NULL); } exit: @@ -579,13 +634,20 @@ 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; + 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; - is_pre_link_sta = rtw_is_pre_link_sta(pstapriv, psta->hwaddr); +#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); @@ -612,6 +674,9 @@ u32 rtw_free_stainfo(_adapter *padapter , struct sta_info *psta) /* rtw_list_delete(&psta->wakeup_list); */ + rtw_free_xmitframe_queue(pxmitpriv, &psta->tx_queue); + _rtw_deinit_queue(&psta->tx_queue); + _enter_critical_bh(&pxmitpriv->lock, &irqL0); rtw_free_xmitframe_queue(pxmitpriv, &psta->sleep_q); @@ -672,7 +737,6 @@ u32 rtw_free_stainfo(_adapter *padapter , struct sta_info *psta) #ifdef CONFIG_TDLS psta->tdls_sta_state = TDLS_STATE_NONE; - rtw_free_tdls_timer(psta); #endif /* CONFIG_TDLS */ /* for A-MPDU Rx reordering buffer control, cancel reordering_ctrl_timer */ @@ -709,7 +773,7 @@ u32 rtw_free_stainfo(_adapter *padapter , struct sta_info *psta) } - if (!((psta->state & WIFI_AP_STATE) || MacAddr_isBcst(psta->hwaddr)) && is_pre_link_sta == _FALSE) + 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); @@ -748,14 +812,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_) { + rtw_tim_map_clear(padapter, pstapriv->sta_dz_bitmap, psta->cmn.aid); + rtw_tim_map_clear(padapter, pstapriv->tim_bitmap, 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 */ @@ -811,7 +877,7 @@ void rtw_free_all_stainfo(_adapter *padapter) plist = get_next(plist); if (pbcmc_stainfo != psta) { - if (rtw_is_pre_link_sta(pstapriv, psta->hwaddr) == _FALSE) + 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); @@ -835,7 +901,7 @@ void rtw_free_all_stainfo(_adapter *padapter) } /* any station allocated can be searched by hash list */ -struct sta_info *rtw_get_stainfo(struct sta_priv *pstapriv, u8 *hwaddr) +struct sta_info *rtw_get_stainfo(struct sta_priv *pstapriv, const u8 *hwaddr) { _irqL irqL; @@ -846,7 +912,7 @@ struct sta_info *rtw_get_stainfo(struct sta_priv *pstapriv, u8 *hwaddr) u32 index; - u8 *addr; + const u8 *addr; u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; @@ -871,7 +937,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; } @@ -903,9 +969,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); /* @@ -933,14 +1000,75 @@ struct sta_info *rtw_get_bcmc_stainfo(_adapter *padapter) } +#ifdef CONFIG_AP_MODE +u16 rtw_aid_alloc(_adapter *adapter, struct sta_info *sta) +{ + struct sta_priv *stapriv = &adapter->stapriv; + u16 aid, i, used_cnt = 0; + + for (i = 0; i < stapriv->max_aid; i++) { + aid = ((i + stapriv->started_aid - 1) % stapriv->max_aid) + 1; + if (stapriv->sta_aid[aid - 1] == NULL) + break; + if (++used_cnt >= stapriv->max_num_sta) + break; + } + + /* check for aid limit and assoc limit */ + if (i >= stapriv->max_aid || used_cnt >= stapriv->max_num_sta) + aid = 0; + + sta->cmn.aid = aid; + if (aid) { + stapriv->sta_aid[aid - 1] = sta; + if (stapriv->rr_aid) + stapriv->started_aid = (aid % stapriv->max_aid) + 1; + } + + return aid; +} + +void dump_aid_status(void *sel, _adapter *adapter) +{ + struct sta_priv *stapriv = &adapter->stapriv; + u8 *aid_bmp; + u16 i, used_cnt = 0; + + aid_bmp = rtw_zmalloc(stapriv->aid_bmp_len); + if (!aid_bmp) + return; + + for (i = 1; i <= stapriv->max_aid; i++) { + if (stapriv->sta_aid[i - 1]) { + aid_bmp[i / 8] |= BIT(i % 8); + ++used_cnt; + } + } + + RTW_PRINT_SEL(sel, "used_cnt:%u/%u\n", used_cnt, stapriv->max_aid); + RTW_MAP_DUMP_SEL(sel, "aid_map:", aid_bmp, stapriv->aid_bmp_len); + RTW_PRINT_SEL(sel, "\n"); + + RTW_PRINT_SEL(sel, "%-2s %-11s\n", "rr", "started_aid"); + RTW_PRINT_SEL(sel, "%2d %11d\n", stapriv->rr_aid, stapriv->started_aid); + + rtw_mfree(aid_bmp, stapriv->aid_bmp_len); +} +#endif /* CONFIG_AP_MODE */ + #if CONFIG_RTW_MACADDR_ACL -const char *const _acl_mode_str[] = { +const char *const _acl_period_str[RTW_ACL_PERIOD_NUM] = { + "DEV", + "BSS", +}; + +const char *const _acl_mode_str[RTW_ACL_MODE_MAX] = { "DISABLED", "ACCEPT_UNLESS_LISTED", "DENY_UNLESS_LISTED", }; -u8 rtw_access_ctrl(_adapter *adapter, u8 *mac_addr) +u8 _rtw_access_ctrl(_adapter *adapter, u8 period, const u8 *mac_addr) { u8 res = _TRUE; _irqL irqL; @@ -948,8 +1076,20 @@ u8 rtw_access_ctrl(_adapter *adapter, u8 *mac_addr) struct rtw_wlan_acl_node *acl_node; u8 match = _FALSE; struct sta_priv *stapriv = &adapter->stapriv; - struct wlan_acl_pool *acl = &stapriv->acl_list; - _queue *acl_node_q = &acl->acl_node_q; + struct wlan_acl_pool *acl; + _queue *acl_node_q; + + if (period >= RTW_ACL_PERIOD_NUM) { + rtw_warn_on(1); + goto exit; + } + + acl = &stapriv->acl_list[period]; + acl_node_q = &acl->acl_node_q; + + if (acl->mode != RTW_ACL_MODE_ACCEPT_UNLESS_LISTED + && acl->mode != RTW_ACL_MODE_DENY_UNLESS_LISTED) + goto exit; _enter_critical_bh(&(acl_node_q->lock), &irqL); head = get_list_head(acl_node_q); @@ -969,26 +1109,42 @@ u8 rtw_access_ctrl(_adapter *adapter, u8 *mac_addr) if (acl->mode == RTW_ACL_MODE_ACCEPT_UNLESS_LISTED) res = (match == _TRUE) ? _FALSE : _TRUE; - else if (acl->mode == RTW_ACL_MODE_DENY_UNLESS_LISTED) + else /* RTW_ACL_MODE_DENY_UNLESS_LISTED */ res = (match == _TRUE) ? _TRUE : _FALSE; - else - res = _TRUE; +exit: return res; } +u8 rtw_access_ctrl(_adapter *adapter, const u8 *mac_addr) +{ + int i; + + for (i = 0; i < RTW_ACL_PERIOD_NUM; i++) + if (_rtw_access_ctrl(adapter, i, mac_addr) == _FALSE) + return _FALSE; + + return _TRUE; +} + void dump_macaddr_acl(void *sel, _adapter *adapter) { struct sta_priv *stapriv = &adapter->stapriv; - struct wlan_acl_pool *acl = &stapriv->acl_list; - int i; + struct wlan_acl_pool *acl; + int i, j; - RTW_PRINT_SEL(sel, "mode:%s(%d)\n", acl_mode_str(acl->mode), acl->mode); - RTW_PRINT_SEL(sel, "num:%d/%d\n", acl->num, NUM_ACL); - for (i = 0; i < NUM_ACL; i++) { - if (acl->aclnode[i].valid == _FALSE) - continue; - RTW_PRINT_SEL(sel, MAC_FMT"\n", MAC_ARG(acl->aclnode[i].addr)); + for (j = 0; j < RTW_ACL_PERIOD_NUM; j++) { + RTW_PRINT_SEL(sel, "period:%s(%d)\n", acl_period_str(j), j); + + acl = &stapriv->acl_list[j]; + RTW_PRINT_SEL(sel, "mode:%s(%d)\n", acl_mode_str(acl->mode), acl->mode); + RTW_PRINT_SEL(sel, "num:%d/%d\n", acl->num, NUM_ACL); + for (i = 0; i < NUM_ACL; i++) { + if (acl->aclnode[i].valid == _FALSE) + continue; + RTW_PRINT_SEL(sel, MAC_FMT"\n", MAC_ARG(acl->aclnode[i].addr)); + } + RTW_PRINT_SEL(sel, "\n"); } } #endif /* CONFIG_RTW_MACADDR_ACL */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_tdls.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_tdls.c index 20af92bcc07c..b46d6bfea2d5 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_tdls.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_tdls.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +23,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 +42,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 +63,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 +74,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 +96,60 @@ void rtw_free_tdls_info(struct tdls_info *ptdlsinfo) } +void rtw_free_all_tdls_sta(_adapter *padapter, u8 enqueue_cmd) +{ + struct sta_priv *pstapriv = &padapter->stapriv; + struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; + _irqL irqL; + _list *plist, *phead; + s32 index; + struct sta_info *psta = NULL; + struct sta_info *ptdls_sta[NUM_STA]; + u8 empty_hwaddr[ETH_ALEN] = { 0x00 }; + + _rtw_memset(ptdls_sta, 0x00, sizeof(ptdls_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) + ptdls_sta[index] = psta; + } + } + _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); + + for (index = 0; index < NUM_STA; index++) { + if (ptdls_sta[index]) { + struct TDLSoption_param tdls_param; + + psta = ptdls_sta[index]; + + RTW_INFO("Do tear down to "MAC_FMT" by enqueue_cmd = %d\n", MAC_ARG(psta->cmn.mac_addr), enqueue_cmd); + + _rtw_memcpy(&(tdls_param.addr), psta->cmn.mac_addr, ETH_ALEN); + tdls_param.option = TDLS_TEARDOWN_STA_NO_WAIT; + tdls_hdl(padapter, (unsigned char *)&(tdls_param)); + + rtw_tdls_teardown_pre_hdl(padapter, psta); + + if (enqueue_cmd == _TRUE) + rtw_tdls_cmd(padapter, psta->cmn.mac_addr, TDLS_TEARDOWN_STA_LOCALLY_POST); + else + { + tdls_param.option = TDLS_TEARDOWN_STA_LOCALLY_POST; + tdls_hdl(padapter, (unsigned char *)&(tdls_param)); + } + } + } +} + int check_ap_tdls_prohibited(u8 *pframe, u8 pkt_len) { u8 tdls_prohibited_bit = 0x40; /* bit(38); TDLS_prohibited */ @@ -122,10 +178,86 @@ 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 enqueue_cmd) +{ + if (rtw_is_tdls_enabled(padapter) == _FALSE) + return; + + rtw_free_all_tdls_sta(padapter, enqueue_cmd); + 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; + if (is_client_associated_to_ap(padapter) == _FALSE) + return _FALSE; + if (ptdlsinfo->ap_prohibited == _TRUE) return _FALSE; @@ -147,7 +279,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; @@ -205,8 +337,8 @@ int _issue_nulldata_to_TDLS_peer_STA(_adapter *padapter, unsigned char *da, unsi 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 +358,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 +366,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 +377,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++; @@ -278,37 +410,6 @@ int issue_nulldata_to_TDLS_peer_STA(_adapter *padapter, unsigned char *da, unsig return ret; } -void free_tdls_sta(_adapter *padapter, struct sta_info *ptdls_sta) -{ - struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; - struct sta_priv *pstapriv = &padapter->stapriv; - _irqL irqL; - - /* free peer sta_info */ - _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); - if (ptdlsinfo->sta_cnt != 0) - ptdlsinfo->sta_cnt--; - _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); - /* -2: AP + BC/MC sta, -4: default key */ - if (ptdlsinfo->sta_cnt < MAX_ALLOWED_TDLS_STA_NUM) { - ptdlsinfo->sta_maximum = _FALSE; - _rtw_memset(&ptdlsinfo->ss_record, 0x00, sizeof(struct tdls_ss_record)); - } - - /* clear cam */ - rtw_clearstakey_cmd(padapter, ptdls_sta, _TRUE); - - if (ptdlsinfo->sta_cnt == 0) { - rtw_tdls_cmd(padapter, NULL, TDLS_RS_RCR); - ptdlsinfo->link_established = _FALSE; - } else - RTW_INFO("Remain tdls sta:%02x\n", ptdlsinfo->sta_cnt); - - rtw_free_stainfo(padapter, ptdls_sta); - -} - - /* TDLS encryption(if needed) will always be CCMP */ void rtw_tdls_set_key(_adapter *padapter, struct sta_info *ptdls_sta) { @@ -333,11 +434,13 @@ 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) { + if (padapter->registrypriv.ht_enable == _TRUE && is_supported_ht(padapter->registrypriv.wireless_mode) ) { ptdls_sta->htpriv.ht_option = _TRUE; ptdls_sta->qos_option = _TRUE; } else { @@ -366,17 +469,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 +518,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,10 +532,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, tx_nss = 0; + u8 cur_ldpc_cap = 0, cur_stbc_cap = 0, rf_type = RF_1T1R, tx_nss = 0; + u16 cur_beamform_cap = 0; u8 *pcap_mcs; _rtw_memset(&ptdls_sta->vhtpriv, 0, sizeof(struct vht_priv)); @@ -444,14 +554,18 @@ 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))) + && is_supported_vht(padapter->registrypriv.wireless_mode) + && (!rfctl->country_ent || COUNTRY_CHPLAN_EN_11AC(rfctl->country_ent))) { ptdls_sta->vhtpriv.vht_option = _TRUE; + ptdls_sta->cmn.ra_info.is_vht_enable = _TRUE; + } else ptdls_sta->vhtpriv.vht_option = _FALSE; } @@ -475,6 +589,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)) @@ -485,8 +600,10 @@ void rtw_tdls_process_vht_cap(_adapter *padapter, struct sta_info *ptdls_sta, u8 GET_VHT_CAPABILITY_ELE_SU_BFER(data)) SET_FLAG(cur_beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE); ptdls_sta->vhtpriv.beamform_cap = cur_beamform_cap; + ptdls_sta->cmn.bf_info.vht_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); @@ -498,6 +615,56 @@ void rtw_tdls_process_vht_cap(_adapter *padapter, struct sta_info *ptdls_sta, u8 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)); @@ -537,20 +704,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)); } @@ -597,7 +766,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)); } } @@ -716,15 +887,19 @@ u8 *rtw_tdls_set_sup_reg_class(u8 *pframe, struct pkt_attrib *pattrib) return rtw_set_ie(pframe, _SRC_IE_ , sizeof(TDLS_SRC), TDLS_SRC, &(pattrib->pktlen)); } -u8 *rtw_tdls_set_linkid(u8 *pframe, struct pkt_attrib *pattrib, u8 init) +u8 *rtw_tdls_set_linkid(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib, u8 init) { + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + u8 link_id_addr[18] = {0}; + + _rtw_memcpy(link_id_addr, get_my_bssid(&(pmlmeinfo->network)), 6); + if (init == _TRUE) { - _rtw_memcpy(link_id_addr, pattrib->ra, 6); _rtw_memcpy((link_id_addr + 6), pattrib->src, 6); _rtw_memcpy((link_id_addr + 12), pattrib->dst, 6); } else { - _rtw_memcpy(link_id_addr, pattrib->ra, 6); _rtw_memcpy((link_id_addr + 6), pattrib->dst, 6); _rtw_memcpy((link_id_addr + 12), pattrib->src, 6); } @@ -757,6 +932,20 @@ u8 *rtw_tdls_set_ch_sw(u8 *pframe, struct pkt_attrib *pattrib, struct sta_info * void rtw_tdls_set_ch_sw_oper_control(_adapter *padapter, u8 enable) { + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); + + if (enable == _TRUE) { +#ifdef CONFIG_TDLS_CH_SW_V2 + pHalData->ch_switch_offload = _TRUE; +#endif + +#ifdef CONFIG_TDLS_CH_SW_BY_DRV + pHalData->ch_switch_offload = _FALSE; +#endif + } + else + pHalData->ch_switch_offload = _FALSE; + if (ATOMIC_READ(&padapter->tdlsinfo.chsw_info.chsw_on) != enable) ATOMIC_SET(&padapter->tdlsinfo.chsw_info.chsw_on, enable); @@ -807,10 +996,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); + +#if defined(CONFIG_TDLS_CH_SW_BY_DRV) || defined(CONFIG_TDLS_CH_SW_V2) + 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) { @@ -846,25 +1039,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; } @@ -1026,14 +1221,37 @@ 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; + } + ptdlsinfo->sta_cnt++; + } + + ptxmgmt->action_code = TDLS_SETUP_REQUEST; + pattrib = &pmgntframe->attrib; pmgntframe->frame_tag = DATA_FRAMETAG; pattrib->ether_type = 0x890d; @@ -1045,21 +1263,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++; - if (ptdlsinfo->sta_cnt == MAX_ALLOWED_TDLS_STA_NUM) ptdlsinfo->sta_maximum = _TRUE; @@ -1090,25 +1293,19 @@ int issue_tdls_setup_req(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, int wa return ret; } -int _issue_tdls_teardown(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, u8 wait_ack) +int _issue_tdls_teardown(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, struct sta_info *ptdls_sta, u8 wait_ack) { struct xmit_frame *pmgntframe; struct pkt_attrib *pattrib; struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); struct sta_priv *pstapriv = &padapter->stapriv; - struct sta_info *ptdls_sta = NULL; _irqL irqL; int ret = _FAIL; RTW_INFO("[TDLS] %s\n", __FUNCTION__); ptxmgmt->action_code = TDLS_TEARDOWN; - ptdls_sta = rtw_get_stainfo(pstapriv, ptxmgmt->peer); - if (ptdls_sta == NULL) { - RTW_INFO("Np tdls_sta for tearing down\n"); - goto exit; - } pmgntframe = alloc_mgtxmitframe(pxmitpriv); if (pmgntframe == NULL) @@ -1124,7 +1321,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); @@ -1147,9 +1349,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; @@ -1157,15 +1356,28 @@ int _issue_tdls_teardown(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, u8 wai int issue_tdls_teardown(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, u8 wait_ack) { + struct sta_info *ptdls_sta = NULL; int ret = _FAIL; - ret = _issue_tdls_teardown(padapter, ptxmgmt, wait_ack); + ptdls_sta = rtw_get_stainfo(&(padapter->stapriv), ptxmgmt->peer); + if (ptdls_sta == NULL) { + RTW_INFO("No tdls_sta for tearing down\n"); + goto exit; + } + + ret = _issue_tdls_teardown(padapter, ptxmgmt, ptdls_sta, wait_ack); if ((ptxmgmt->status_code == _RSON_TDLS_TEAR_UN_RSN_) && (ret == _FAIL)) { /* Change status code and send teardown again via AP */ ptxmgmt->status_code = _RSON_TDLS_TEAR_TOOFAR_; - ret = _issue_tdls_teardown(padapter, ptxmgmt, wait_ack); + ret = _issue_tdls_teardown(padapter, ptxmgmt, ptdls_sta, wait_ack); } + if (rtw_tdls_is_driver_setup(padapter)) { + rtw_tdls_teardown_pre_hdl(padapter, ptdls_sta); + rtw_tdls_cmd(padapter, ptxmgmt->peer, TDLS_TEARDOWN_STA_LOCALLY_POST); + } + +exit: return ret; } @@ -1367,9 +1579,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); @@ -1412,7 +1624,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); @@ -1465,9 +1677,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); @@ -1551,10 +1763,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 undecorated_smoothed_pwdb; + 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; @@ -1570,11 +1785,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; } } } @@ -1585,7 +1800,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 { @@ -1595,10 +1810,9 @@ int On_TDLS_Dis_Rsp(_adapter *padapter, union recv_frame *precv_frame) } } - rtw_hal_get_def_var(padapter, HAL_DEF_UNDERCORATEDSMOOTHEDPWDB, &undecorated_smoothed_pwdb); - if (pattrib->phy_info.RxPWDBAll + TDLS_SIGNAL_THRESH >= undecorated_smoothed_pwdb) { - RTW_INFO("pattrib->RxPWDBAll=%d, pdmpriv->undecorated_smoothed_pwdb=%d\n", pattrib->phy_info.RxPWDBAll, undecorated_smoothed_pwdb); + 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); } @@ -1610,11 +1824,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); @@ -1639,7 +1852,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; @@ -1649,11 +1868,15 @@ 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) + if (ptdls_sta == NULL) { ptdls_sta = rtw_alloc_stainfo(pstapriv, psa); + if (ptdls_sta == NULL) + goto exit; + + ptdlsinfo->sta_cnt++; + } else { if (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) { /* If the direct link is already set up */ @@ -1697,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; } @@ -1791,8 +2014,6 @@ sint On_TDLS_Setup_Req(_adapter *padapter, union recv_frame *precv_frame) ptdls_sta->bssratelen = supportRateNum; _rtw_memcpy(ptdls_sta->bssrateset, supportRate, supportRateNum); - if (!(ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE)) - ptdlsinfo->sta_cnt++; /* -2: AP + BC/MC sta, -4: default key */ if (ptdlsinfo->sta_cnt == MAX_ALLOWED_TDLS_STA_NUM) ptdlsinfo->sta_maximum = _TRUE; @@ -1811,8 +2032,10 @@ sint On_TDLS_Setup_Req(_adapter *padapter, union recv_frame *precv_frame) if (txmgmt.status_code == _STATS_SUCCESSFUL_) _set_timer(&ptdls_sta->handshake_timer, TDLS_HANDSHAKE_TIME); - else - free_tdls_sta(padapter, ptdls_sta); + else { + rtw_tdls_teardown_pre_hdl(padapter, ptdls_sta); + rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_TEARDOWN_STA_LOCALLY_POST); + } } exit: @@ -1820,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; @@ -1846,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 @@ -1861,14 +2076,14 @@ 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); if (status_code != 0) { RTW_INFO("[TDLS] %s status_code = %d, free_tdls_sta\n", __FUNCTION__, status_code); - free_tdls_sta(padapter, ptdls_sta); + rtw_tdls_teardown_pre_hdl(padapter, ptdls_sta); + rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_TEARDOWN_STA_LOCALLY_POST); ret = _FAIL; goto exit; } @@ -1887,7 +2102,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; } @@ -1935,7 +2150,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: @@ -1959,35 +2174,31 @@ 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__); + rtw_tdls_teardown_pre_hdl(padapter, ptdls_sta); + rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_TEARDOWN_STA_LOCALLY_POST); + 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; @@ -1998,7 +2209,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); } } @@ -2011,10 +2222,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; @@ -2029,13 +2239,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 @@ -2044,14 +2247,14 @@ 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); if (status_code != 0) { RTW_INFO("[%s] status_code = %d\n, free_tdls_sta", __FUNCTION__, status_code); - free_tdls_sta(padapter, ptdls_sta); + rtw_tdls_teardown_pre_hdl(padapter, ptdls_sta); + rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_TEARDOWN_STA_LOCALLY_POST); ret = _FAIL; goto exit; } @@ -2083,9 +2286,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_: @@ -2103,14 +2307,15 @@ int On_TDLS_Setup_Cfm(_adapter *padapter, union recv_frame *precv_frame) /* Verify mic in FTIE MIC field */ if (rtw_tdls_is_driver_setup(padapter) && (tdls_verify_mic(ptdls_sta->tpk.kck, 3, plinkid_ie, prsnie, ptimeout_ie, pftie) == _FAIL)) { - free_tdls_sta(padapter, ptdls_sta); + rtw_tdls_teardown_pre_hdl(padapter, ptdls_sta); + rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_TEARDOWN_STA_LOCALLY_POST); ret = _FAIL; goto exit; } } 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; @@ -2126,7 +2331,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: @@ -2161,8 +2366,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;) { @@ -2175,7 +2379,7 @@ int On_TDLS_Dis_Req(_adapter *padapter, union recv_frame *precv_frame) if (psta_ap == NULL) goto exit; dst = pIE->data + 12; - if (MacAddr_isBcst(dst) == _FALSE && (_rtw_memcmp(adapter_mac_addr(padapter), dst, 6) == _FALSE)) + if (MacAddr_isBcst(dst) == _FALSE && (_rtw_memcmp(adapter_mac_addr(padapter), dst, ETH_ALEN) == _FALSE)) goto exit; break; default: @@ -2193,27 +2397,22 @@ 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_teardown_pre_hdl(padapter, ptdls_sta); + rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_TEARDOWN_STA_LOCALLY_POST); } return _SUCCESS; @@ -2234,36 +2433,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; @@ -2325,20 +2517,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; @@ -2348,15 +2537,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; @@ -2367,8 +2547,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); @@ -2423,7 +2602,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; } @@ -2433,29 +2612,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; @@ -2468,20 +2641,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; } } @@ -2493,15 +2658,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; } @@ -2532,7 +2696,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: @@ -2547,6 +2711,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; @@ -2578,8 +2743,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: */ @@ -2631,13 +2797,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; @@ -2659,7 +2824,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) @@ -2685,7 +2850,7 @@ void rtw_build_tdls_setup_req_ies(_adapter *padapter, struct xmit_frame *pxmitfr pframe = rtw_tdls_set_bss_coexist(padapter, pframe, pattrib); - pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE); + pframe = rtw_tdls_set_linkid(padapter, pframe, pattrib, _TRUE); if ((pregistrypriv->wmm_enable == _TRUE) || (padapter->mlmepriv.htpriv.ht_option == _TRUE)) pframe = rtw_tdls_set_qos_cap(pframe, pattrib); @@ -2693,8 +2858,8 @@ void rtw_build_tdls_setup_req_ies(_adapter *padapter, struct xmit_frame *pxmitfr #ifdef CONFIG_80211AC_VHT 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)) + && is_supported_vht(pregistrypriv->wireless_mode) + && (!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); @@ -2708,23 +2873,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); @@ -2746,7 +2906,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) { @@ -2781,7 +2941,7 @@ void rtw_build_tdls_setup_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitfr pframe = rtw_tdls_set_bss_coexist(padapter, pframe, pattrib); plinkid_ie = pframe; - pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE); + pframe = rtw_tdls_set_linkid(padapter, pframe, pattrib, _FALSE); /* Fill FTIE mic */ if (pattrib->encrypt && rtw_tdls_is_driver_setup(padapter) == _TRUE) @@ -2793,8 +2953,8 @@ void rtw_build_tdls_setup_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitfr #ifdef CONFIG_80211AC_VHT 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)) + && is_supported_vht(pregistrypriv->wireless_mode) + && (!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); @@ -2809,13 +2969,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; @@ -2858,7 +3018,7 @@ void rtw_build_tdls_setup_cfm_ies(_adapter *padapter, struct xmit_frame *pxmitfr /* HT operation; todo */ plinkid_ie = pframe; - pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE); + pframe = rtw_tdls_set_linkid(padapter, pframe, pattrib, _TRUE); if (pattrib->encrypt && (rtw_tdls_is_driver_setup(padapter) == _TRUE)) wpa_tdls_ftie_mic(ptdls_sta->tpk.kck, 3, plinkid_ie, prsnie, ptimeout_ie, pftie, pftie_mic); @@ -2870,8 +3030,8 @@ void rtw_build_tdls_setup_cfm_ies(_adapter *padapter, struct xmit_frame *pxmitfr if ((padapter->mlmepriv.htpriv.ht_option == _TRUE) && (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)) + && is_supported_vht(pregistrypriv->wireless_mode) + && (!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); @@ -2879,10 +3039,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); @@ -2902,9 +3061,9 @@ void rtw_build_tdls_teardown_ies(_adapter *padapter, struct xmit_frame *pxmitfra plinkid_ie = pframe; if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE) - pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE); + pframe = rtw_tdls_set_linkid(padapter, pframe, pattrib, _FALSE); else if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) - pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE); + pframe = rtw_tdls_set_linkid(padapter, pframe, pattrib, _TRUE); if (pattrib->encrypt && (rtw_tdls_is_driver_setup(padapter) == _TRUE)) wpa_tdls_teardown_ftie_mic(ptdls_sta->tpk.kck, plinkid_ie, ptxmgmt->status_code, 1, 4, pftie, pftie_mic); @@ -2918,7 +3077,7 @@ void rtw_build_tdls_dis_req_ies(_adapter *padapter, struct xmit_frame *pxmitfram pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS); pframe = rtw_tdls_set_action(pframe, pattrib, ptxmgmt); pframe = rtw_tdls_set_dialog(pframe, pattrib, ptxmgmt); - pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE); + pframe = rtw_tdls_set_linkid(padapter, pframe, pattrib, _TRUE); } @@ -2939,7 +3098,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); @@ -2957,17 +3116,16 @@ void rtw_build_tdls_dis_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitfram #endif pframe = rtw_tdls_set_bss_coexist(padapter, pframe, pattrib); - pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE); + pframe = rtw_tdls_set_linkid(padapter, pframe, pattrib, _FALSE); } -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); @@ -2975,9 +3133,9 @@ void rtw_build_tdls_peer_traffic_indication_ies(_adapter *padapter, struct xmit_ pframe = rtw_tdls_set_dialog(pframe, pattrib, ptxmgmt); if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE) - pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE); + pframe = rtw_tdls_set_linkid(padapter, pframe, pattrib, _FALSE); else if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) - pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE); + pframe = rtw_tdls_set_linkid(padapter, pframe, pattrib, _TRUE); /* PTI control */ /* PU buffer status */ @@ -2993,11 +3151,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); @@ -3005,18 +3162,17 @@ void rtw_build_tdls_peer_traffic_rsp_ies(_adapter *padapter, struct xmit_frame * pframe = rtw_tdls_set_dialog(pframe, pattrib, ptxmgmt); if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE) - pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE); + pframe = rtw_tdls_set_linkid(padapter, pframe, pattrib, _FALSE); else if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) - pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE); + pframe = rtw_tdls_set_linkid(padapter, pframe, pattrib, _TRUE); } #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; @@ -3040,20 +3196,19 @@ void rtw_build_tdls_ch_switch_req_ies(_adapter *padapter, struct xmit_frame *pxm } if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE) - pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE); + pframe = rtw_tdls_set_linkid(padapter, pframe, pattrib, _FALSE); else if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) - pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE); + pframe = rtw_tdls_set_linkid(padapter, pframe, pattrib, _TRUE); pframe = rtw_tdls_set_ch_sw(pframe, pattrib, ptdls_sta); } -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); @@ -3061,9 +3216,9 @@ void rtw_build_tdls_ch_switch_rsp_ies(_adapter *padapter, struct xmit_frame *pxm pframe = rtw_tdls_set_status_code(pframe, pattrib, ptxmgmt); if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE) - pframe = rtw_tdls_set_linkid(pframe, pattrib, _FALSE); + pframe = rtw_tdls_set_linkid(padapter, pframe, pattrib, _FALSE); else if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) - pframe = rtw_tdls_set_linkid(pframe, pattrib, _TRUE); + pframe = rtw_tdls_set_linkid(padapter, pframe, pattrib, _TRUE); pframe = rtw_tdls_set_ch_sw(pframe, pattrib, ptdls_sta); } @@ -3142,9 +3297,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); } @@ -3158,7 +3314,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)); } @@ -3190,7 +3346,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__); } @@ -3199,37 +3355,41 @@ 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)); - issue_tdls_teardown(padapter, &txmgmt, _FALSE); + "Send TDLS Tear Down\n", MAC_ARG(ptdls_sta->cmn.mac_addr)); + rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_TEARDOWN_STA); } } } @@ -3237,18 +3397,18 @@ 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) +void rtw_cancel_tdls_timer(struct sta_info *psta) { _cancel_timer_ex(&psta->TPK_timer); #ifdef CONFIG_TDLS_CH_SW @@ -3261,35 +3421,53 @@ 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) +void rtw_tdls_teardown_pre_hdl(_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; + struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; + struct sta_priv *pstapriv = &padapter->stapriv; + _irqL irqL; - rtw_hal_update_sta_rate_mask(padapter, psta); - tx_ra_bitmap = psta->ra_mask; + rtw_cancel_tdls_timer(psta); - 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; + _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); + if (ptdlsinfo->sta_cnt != 0) + ptdlsinfo->sta_cnt--; + _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); + + if (ptdlsinfo->sta_cnt < MAX_ALLOWED_TDLS_STA_NUM) { + ptdlsinfo->sta_maximum = _FALSE; + _rtw_memset(&ptdlsinfo->ss_record, 0x00, sizeof(struct tdls_ss_record)); } - psta->wireless_mode = sta_band; + if (ptdlsinfo->sta_cnt == 0) + rtw_tdls_set_link_established(padapter, _FALSE); + else + RTW_INFO("Remain tdls sta:%02x\n", ptdlsinfo->sta_cnt); +} - psta->raid = rtw_hal_networktype_to_raid(padapter, psta); - tx_ra_bitmap |= ((psta->raid << 28) & 0xf0000000); - return tx_ra_bitmap; +void rtw_tdls_teardown_post_hdl(_adapter *padapter, struct sta_info *psta, u8 enqueue_cmd) +{ + struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; + + /* Clear cam */ + rtw_clearstakey_cmd(padapter, psta, enqueue_cmd); + + /* Update sta media status */ + if (enqueue_cmd) + rtw_sta_media_status_rpt_cmd(padapter, psta, 0); + else + rtw_sta_media_status_rpt(padapter, psta, 0); + + /* Set RCR if necessary */ + if (ptdlsinfo->sta_cnt == 0) { + if (enqueue_cmd) + rtw_tdls_cmd(padapter, NULL, TDLS_RS_RCR); + else + rtw_hal_rcr_set_chk_bssid(padapter, MLME_TDLS_NOLINK); + } + + /* Free tdls sta info */ + rtw_free_stainfo(padapter, psta); } int rtw_tdls_is_driver_setup(_adapter *padapter) diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_vht.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_vht.c index fbb26f8ee694..f4e1ad6c93ec 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_vht.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_vht.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,18 +12,100 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +const u16 _vht_max_mpdu_len[] = { + 3895, + 7991, + 11454, + 0, +}; + +const u8 _vht_sup_ch_width_set_to_bw_cap[] = { + BW_CAP_80M, + BW_CAP_80M | BW_CAP_160M, + BW_CAP_80M | BW_CAP_160M | BW_CAP_80_80M, + 0, +}; + +const char *const _vht_sup_ch_width_set_str[] = { + "80MHz", + "160MHz", + "160MHz & 80+80MHz", + "BW-RSVD", +}; + +void dump_vht_cap_ie_content(void *sel, const u8 *buf, u32 buf_len) +{ + if (buf_len != VHT_CAP_IE_LEN) { + RTW_PRINT_SEL(sel, "Invalid VHT capability IE len:%d != %d\n", buf_len, VHT_CAP_IE_LEN); + return; + } + + RTW_PRINT_SEL(sel, "cap_info:%02x %02x %02x %02x: MAX_MPDU_LEN:%u %s%s%s%s%s RX-STBC:%u MAX_AMPDU_LEN:%u\n" + , *(buf), *(buf + 1), *(buf + 2), *(buf + 3) + , vht_max_mpdu_len(GET_VHT_CAPABILITY_ELE_MAX_MPDU_LENGTH(buf)) + , vht_sup_ch_width_set_str(GET_VHT_CAPABILITY_ELE_CHL_WIDTH(buf)) + , GET_VHT_CAPABILITY_ELE_RX_LDPC(buf) ? " RX-LDPC" : "" + , GET_VHT_CAPABILITY_ELE_SHORT_GI80M(buf) ? " SGI-80" : "" + , GET_VHT_CAPABILITY_ELE_SHORT_GI160M(buf) ? " SGI-160" : "" + , GET_VHT_CAPABILITY_ELE_TX_STBC(buf) ? " TX-STBC" : "" + , GET_VHT_CAPABILITY_ELE_RX_STBC(buf) + , VHT_MAX_AMPDU_LEN(GET_VHT_CAPABILITY_ELE_MAX_RXAMPDU_FACTOR(buf)) + ); +} + +void dump_vht_cap_ie(void *sel, const u8 *ie, u32 ie_len) +{ + const u8 *vht_cap_ie; + sint vht_cap_ielen; + + vht_cap_ie = rtw_get_ie(ie, WLAN_EID_VHT_CAPABILITY, &vht_cap_ielen, ie_len); + if (!ie || vht_cap_ie != ie) + return; + + dump_vht_cap_ie_content(sel, vht_cap_ie + 2, vht_cap_ielen); +} + +const char *const _vht_op_ch_width_str[] = { + "20 or 40MHz", + "80MHz", + "160MHz", + "80+80MHz", + "BW-RSVD", +}; + +void dump_vht_op_ie_content(void *sel, const u8 *buf, u32 buf_len) +{ + if (buf_len != VHT_OP_IE_LEN) { + RTW_PRINT_SEL(sel, "Invalid VHT operation IE len:%d != %d\n", buf_len, VHT_OP_IE_LEN); + return; + } + + RTW_PRINT_SEL(sel, "%s, ch0:%u, ch1:%u\n" + , vht_op_ch_width_str(GET_VHT_OPERATION_ELE_CHL_WIDTH(buf)) + , GET_VHT_OPERATION_ELE_CENTER_FREQ1(buf) + , GET_VHT_OPERATION_ELE_CENTER_FREQ2(buf) + ); +} + +void dump_vht_op_ie(void *sel, const u8 *ie, u32 ie_len) +{ + const u8 *vht_op_ie; + sint vht_op_ielen; + + vht_op_ie = rtw_get_ie(ie, WLAN_EID_VHT_OPERATION, &vht_op_ielen, ie_len); + if (!ie || vht_op_ie != ie) + return; + + dump_vht_op_ie_content(sel, vht_op_ie + 2, vht_op_ielen); +} + /* 20/40/80, ShortGI, MCS Rate */ const u16 VHT_MCS_DATA_RATE[3][2][30] = { { { @@ -183,43 +266,53 @@ void rtw_vht_use_default_setting(_adapter *padapter) /* Beamforming setting */ CLEAR_FLAGS(pvhtpriv->beamform_cap); #ifdef CONFIG_BEAMFORMING - rtw_hal_get_def_var(padapter, HAL_DEF_EXPLICIT_BEAMFORMER, (u8 *)&bHwSupportBeamformer); - rtw_hal_get_def_var(padapter, HAL_DEF_EXPLICIT_BEAMFORMEE, (u8 *)&bHwSupportBeamformee); - mu_bfer = _FALSE; - mu_bfee = _FALSE; - rtw_hal_get_def_var(padapter, HAL_DEF_VHT_MU_BEAMFORMER, &mu_bfer); - rtw_hal_get_def_var(padapter, HAL_DEF_VHT_MU_BEAMFORMEE, &mu_bfee); - if (TEST_FLAG(pregistrypriv->beamform_cap, BIT0) && bHwSupportBeamformer) { +#ifdef RTW_BEAMFORMING_VERSION_2 + /* only enable beamforming in STA client mode */ + if (MLME_IS_STA(padapter) && !MLME_IS_GC(padapter) + && !MLME_IS_ADHOC(padapter) + && !MLME_IS_MESH(padapter)) +#endif + { + rtw_hal_get_def_var(padapter, HAL_DEF_EXPLICIT_BEAMFORMER, + (u8 *)&bHwSupportBeamformer); + rtw_hal_get_def_var(padapter, HAL_DEF_EXPLICIT_BEAMFORMEE, + (u8 *)&bHwSupportBeamformee); + mu_bfer = _FALSE; + mu_bfee = _FALSE; + rtw_hal_get_def_var(padapter, HAL_DEF_VHT_MU_BEAMFORMER, &mu_bfer); + rtw_hal_get_def_var(padapter, HAL_DEF_VHT_MU_BEAMFORMEE, &mu_bfee); + if (TEST_FLAG(pregistrypriv->beamform_cap, BIT0) && bHwSupportBeamformer) { #ifdef CONFIG_CONCURRENT_MODE - if ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) { + if ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) { + SET_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE); + RTW_INFO("[VHT] CONCURRENT AP Support Beamformer\n"); + if (TEST_FLAG(pregistrypriv->beamform_cap, BIT(2)) + && (_TRUE == mu_bfer)) { + SET_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE); + RTW_INFO("[VHT] Support MU-MIMO AP\n"); + } + } else + RTW_INFO("[VHT] CONCURRENT not AP ;not allow Support Beamformer\n"); +#else SET_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE); - RTW_INFO("[VHT] CONCURRENT AP Support Beamformer\n"); + RTW_INFO("[VHT] Support Beamformer\n"); if (TEST_FLAG(pregistrypriv->beamform_cap, BIT(2)) - && (_TRUE == mu_bfer)) { + && (_TRUE == mu_bfer) + && ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE)) { SET_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE); RTW_INFO("[VHT] Support MU-MIMO AP\n"); } - } else - RTW_INFO("[VHT] CONCURRENT not AP ;not allow Support Beamformer\n"); -#else - SET_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE); - RTW_INFO("[VHT] Support Beamformer\n"); - if (TEST_FLAG(pregistrypriv->beamform_cap, BIT(2)) - && (_TRUE == mu_bfer) - && ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE)) { - SET_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE); - RTW_INFO("[VHT] Support MU-MIMO AP\n"); - } #endif - } - if (TEST_FLAG(pregistrypriv->beamform_cap, BIT1) && bHwSupportBeamformee) { - SET_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE); - RTW_INFO("[VHT] Support Beamformee\n"); - if (TEST_FLAG(pregistrypriv->beamform_cap, BIT(3)) - && (_TRUE == mu_bfee) - && ((pmlmeinfo->state & 0x03) != WIFI_FW_AP_STATE)) { - SET_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_MU_MIMO_STA_ENABLE); - RTW_INFO("[VHT] Support MU-MIMO STA\n"); + } + if (TEST_FLAG(pregistrypriv->beamform_cap, BIT1) && bHwSupportBeamformee) { + SET_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE); + RTW_INFO("[VHT] Support Beamformee\n"); + if (TEST_FLAG(pregistrypriv->beamform_cap, BIT(3)) + && (_TRUE == mu_bfee) + && ((pmlmeinfo->state & 0x03) != WIFI_FW_AP_STATE)) { + SET_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_MU_MIMO_STA_ENABLE); + RTW_INFO("[VHT] Support MU-MIMO STA\n"); + } } } #endif /* CONFIG_BEAMFORMING */ @@ -266,56 +359,14 @@ u64 rtw_vht_mcs_map_to_bitmap(u8 *mcs_map, u8 nss) 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)) { @@ -331,9 +382,83 @@ 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, void *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; + s8 bw_mode = -1; + u8 *pcap_mcs; + + if (pvhtpriv_sta->vht_option == _FALSE) + return; + + if (pvhtpriv_sta->op_present) { + switch (GET_VHT_OPERATION_ELE_CHL_WIDTH(pvhtpriv_sta->vht_op)) { + case 1: /* 80MHz */ + case 2: /* 160MHz */ + case 3: /* 80+80 */ + bw_mode = CHANNEL_WIDTH_80; /* only support up to 80MHz for now */ + break; + } + } + + if (pvhtpriv_sta->notify_present) + bw_mode = GET_VHT_OPERATING_MODE_FIELD_CHNL_WIDTH(&pvhtpriv_sta->vht_op_mode_notify); + else if (MLME_IS_AP(padapter)) { + /* for VHT client without Operating Mode Notify IE; minimal 80MHz */ + if (bw_mode < CHANNEL_WIDTH_80) + bw_mode = CHANNEL_WIDTH_80; + } + + if (bw_mode != -1) + psta->cmn.bw_mode = bw_mode; /* update bw_mode only if get value from VHT IEs */ + + 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 */ @@ -358,6 +483,83 @@ void update_hw_vht_param(_adapter *padapter) rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_FACTOR, (u8 *)(&pvhtpriv->ampdu_len)); } +#ifdef ROKU_PRIVATE +u8 VHT_get_ss_from_map(u8 *vht_mcs_map) +{ + u8 i, j; + u8 ss = 0; + + for (i = 0; i < 2; i++) { + if (vht_mcs_map[i] != 0xff) { + for (j = 0; j < 8; j += 2) { + if (((vht_mcs_map[i] >> j) & 0x03) == 0x03) + break; + ss++; + } + } + + } + +return ss; +} + +void VHT_caps_handler_infra_ap(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) +{ + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct vht_priv_infra_ap *pvhtpriv = &pmlmepriv->vhtpriv_infra_ap; + u8 cur_stbc_cap_infra_ap = 0; + u16 cur_beamform_cap_infra_ap = 0; + u8 *pcap_mcs; + u8 *pcap_mcs_tx; + u8 Rx_ss = 0, Tx_ss = 0; + + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + + if (pIE == NULL) + return; + + pmlmeinfo->ht_vht_received |= BIT(1); + + pvhtpriv->ldpc_cap_infra_ap = GET_VHT_CAPABILITY_ELE_RX_LDPC(pIE->data); + + if (GET_VHT_CAPABILITY_ELE_RX_STBC(pIE->data)) + SET_FLAG(cur_stbc_cap_infra_ap, STBC_VHT_ENABLE_RX); + if (GET_VHT_CAPABILITY_ELE_TX_STBC(pIE->data)) + SET_FLAG(cur_stbc_cap_infra_ap, STBC_VHT_ENABLE_TX); + pvhtpriv->stbc_cap_infra_ap = cur_stbc_cap_infra_ap; + + /*store ap info for channel bandwidth*/ + pvhtpriv->channel_width_infra_ap = GET_VHT_CAPABILITY_ELE_CHL_WIDTH(pIE->data); + + /*check B11: SU Beamformer Capable and B12: SU Beamformee B19: MU Beamformer B20:MU Beamformee*/ + if (GET_VHT_CAPABILITY_ELE_SU_BFER(pIE->data)) + SET_FLAG(cur_beamform_cap_infra_ap, BEAMFORMING_VHT_BEAMFORMER_ENABLE); + if (GET_VHT_CAPABILITY_ELE_SU_BFEE(pIE->data)) + SET_FLAG(cur_beamform_cap_infra_ap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE); + if (GET_VHT_CAPABILITY_ELE_MU_BFER(pIE->data)) + SET_FLAG(cur_beamform_cap_infra_ap, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE); + if (GET_VHT_CAPABILITY_ELE_MU_BFEE(pIE->data)) + SET_FLAG(cur_beamform_cap_infra_ap, BEAMFORMING_VHT_MU_MIMO_STA_ENABLE); + pvhtpriv->beamform_cap_infra_ap = cur_beamform_cap_infra_ap; + + /*store information about vht_mcs_set*/ + pcap_mcs = GET_VHT_CAPABILITY_ELE_RX_MCS(pIE->data); + pcap_mcs_tx = GET_VHT_CAPABILITY_ELE_TX_MCS(pIE->data); + _rtw_memcpy(pvhtpriv->vht_mcs_map_infra_ap, pcap_mcs, 2); + _rtw_memcpy(pvhtpriv->vht_mcs_map_tx_infra_ap, pcap_mcs_tx, 2); + + Rx_ss = VHT_get_ss_from_map(pvhtpriv->vht_mcs_map_infra_ap); + Tx_ss = VHT_get_ss_from_map(pvhtpriv->vht_mcs_map_tx_infra_ap); + if (Rx_ss >= Tx_ss) { + pvhtpriv->number_of_streams_infra_ap = Rx_ss; + } else{ + pvhtpriv->number_of_streams_infra_ap = Tx_ss; + } + +} +#endif /* ROKU_PRIVATE */ + void VHT_caps_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) { struct hal_spec_t *hal_spec = GET_HAL_SPEC(padapter); @@ -484,29 +686,33 @@ void VHT_operation_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) return; } -void rtw_process_vht_op_mode_notify(_adapter *padapter, u8 *pframe, PVOID sta) +void rtw_process_vht_op_mode_notify(_adapter *padapter, u8 *pframe, void *sta) { struct sta_info *psta = (struct sta_info *)sta; 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; u8 update_ra = _FALSE; + u8 tx_nss = 0, rf_type = RF_1T1R; + struct hal_spec_t *hal_spec = GET_HAL_SPEC(padapter); if (pvhtpriv->vht_option == _FALSE) return; 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) { + 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); + target_rxss = rtw_min(tx_nss, (GET_VHT_OPERATING_MODE_FIELD_RX_NSS(pframe) + 1)); + + 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; } } @@ -519,7 +725,7 @@ void rtw_process_vht_op_mode_notify(_adapter *padapter, u8 *pframe, PVOID sta) 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) @@ -588,7 +794,7 @@ u32 rtw_build_vht_op_mode_notify_ie(_adapter *padapter, u8 *pbuf, u8 bw) u32 rtw_build_vht_cap_ie(_adapter *padapter, u8 *pbuf) { - u8 bw, rf_type, rf_num, rx_stbc_nss = 0; + u8 bw, rf_num, rx_stbc_nss = 0; u16 HighestRate; u8 *pcap, *pcap_mcs; u32 len = 0; @@ -596,6 +802,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); @@ -604,19 +812,19 @@ u32 rtw_build_vht_cap_ie(_adapter *padapter, u8 *pbuf) rtw_hal_get_def_var(padapter, HAL_DEF_RX_PACKET_OFFSET, &rx_packet_offset); rtw_hal_get_def_var(padapter, HAL_DEF_MAX_RECVBUF_SZ, &max_recvbuf_sz); - RTW_DBG("%s, line%d, Available RX buf size = %d bytes\n.", __FUNCTION__, __LINE__, max_recvbuf_sz - rx_packet_offset); + RTW_DBG("%s, line%d, Available RX buf size = %d bytes\n", __FUNCTION__, __LINE__, max_recvbuf_sz - rx_packet_offset); if ((max_recvbuf_sz - rx_packet_offset) >= 11454) { SET_VHT_CAPABILITY_ELE_MAX_MPDU_LENGTH(pcap, 2); - RTW_INFO("%s, line%d, Set MAX MPDU len = 11454 bytes\n.", __FUNCTION__, __LINE__); + RTW_INFO("%s, line%d, Set MAX MPDU len = 11454 bytes\n", __FUNCTION__, __LINE__); } else if ((max_recvbuf_sz - rx_packet_offset) >= 7991) { SET_VHT_CAPABILITY_ELE_MAX_MPDU_LENGTH(pcap, 1); - RTW_INFO("%s, line%d, Set MAX MPDU len = 7991 bytes\n.", __FUNCTION__, __LINE__); + RTW_INFO("%s, line%d, Set MAX MPDU len = 7991 bytes\n", __FUNCTION__, __LINE__); } else if ((max_recvbuf_sz - rx_packet_offset) >= 3895) { SET_VHT_CAPABILITY_ELE_MAX_MPDU_LENGTH(pcap, 0); - RTW_INFO("%s, line%d, Set MAX MPDU len = 3895 bytes\n.", __FUNCTION__, __LINE__); + RTW_INFO("%s, line%d, Set MAX MPDU len = 3895 bytes\n", __FUNCTION__, __LINE__); } else - RTW_ERR("%s, line%d, Error!! Available RX buf size < 3895 bytes\n.", __FUNCTION__, __LINE__); + RTW_ERR("%s, line%d, Error!! Available RX buf size < 3895 bytes\n", __FUNCTION__, __LINE__); /* B2 B3 Supported Channel Width Set */ if (hal_chk_bw_cap(padapter, BW_CAP_160M) && REGSTY_IS_BW_5G_SUPPORT(pregistrypriv, CHANNEL_WIDTH_160)) { @@ -654,7 +862,7 @@ u32 rtw_build_vht_cap_ie(_adapter *padapter, u8 *pbuf) 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); @@ -673,8 +881,16 @@ u32 rtw_build_vht_cap_ie(_adapter *padapter, u8 *pbuf) if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE)) { SET_VHT_CAPABILITY_ELE_SU_BFEE(pcap, 1); RTW_INFO("[VHT] Declare supporting SU Bfee\n"); - /* B13 14 15 Compressed Steering Number of Beamformer Antennas Supported */ + rtw_hal_get_def_var(padapter, HAL_DEF_BEAMFORMEE_CAP, (u8 *)&rf_num); + + /* IOT action suggested by Yu Chen 2017/3/3 */ +#ifdef CONFIG_80211AC_VHT + if ((pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_BROADCOM) && + !pvhtpriv->ap_is_mu_bfer) + rf_num = (rf_num >= 2 ? 2 : rf_num); +#endif + /* 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)) { @@ -682,6 +898,7 @@ u32 rtw_build_vht_cap_ie(_adapter *padapter, u8 *pbuf) RTW_INFO("[VHT] Declare supporting MU Bfee\n"); } } + #endif/*CONFIG_BEAMFORMING*/ /* B21 VHT TXOP PS */ SET_VHT_CAPABILITY_ELE_TXOP_PS(pcap, 0); @@ -717,61 +934,109 @@ u32 rtw_build_vht_cap_ie(_adapter *padapter, u8 *pbuf) u32 rtw_restructure_vht_ie(_adapter *padapter, u8 *in_ie, u8 *out_ie, uint in_len, uint *pout_len) { - u32 ielen = 0, out_len = 0; - u8 cap_len = 0, notify_len = 0, notify_bw = 0, operation_bw = 0, supported_chnl_width = 0; - u8 *p, *pframe; + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); + RT_CHANNEL_INFO *chset = rfctl->channel_set; + u32 ielen; + u8 max_bw; + u8 oper_ch, oper_bw = CHANNEL_WIDTH_20, oper_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; + u8 *out_vht_op_ie, *ht_op_ie, *vht_cap_ie, *vht_op_ie; struct registry_priv *pregistrypriv = &padapter->registrypriv; struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; rtw_vht_use_default_setting(padapter); - p = rtw_get_ie(in_ie + 12, EID_VHTCapability, &ielen, in_len - 12); - if (p && ielen > 0) { - supported_chnl_width = GET_VHT_CAPABILITY_ELE_CHL_WIDTH(p + 2); + ht_op_ie = rtw_get_ie(in_ie + 12, WLAN_EID_HT_OPERATION, &ielen, in_len - 12); + if (!ht_op_ie || ielen != HT_OP_IE_LEN) + goto exit; + vht_cap_ie = rtw_get_ie(in_ie + 12, EID_VHTCapability, &ielen, in_len - 12); + if (!vht_cap_ie || ielen != VHT_CAP_IE_LEN) + goto exit; + vht_op_ie = rtw_get_ie(in_ie + 12, EID_VHTOperation, &ielen, in_len - 12); + if (!vht_op_ie || ielen != VHT_OP_IE_LEN) + goto exit; - /* VHT Capabilities element */ - cap_len = rtw_build_vht_cap_ie(padapter, out_ie + *pout_len); - *pout_len += cap_len; + /* VHT Capabilities element */ + *pout_len += rtw_build_vht_cap_ie(padapter, out_ie + *pout_len); - /* Get HT BW */ - p = rtw_get_ie(in_ie + 12, _HT_EXTRA_INFO_IE_, &ielen, in_len - 12); - if (p && ielen > 0) { - struct HT_info_element *pht_info = (struct HT_info_element *)(p + 2); - if (pht_info->infos[0] & BIT(2)) - operation_bw = CHANNEL_WIDTH_40; - else - operation_bw = CHANNEL_WIDTH_20; - } - /* VHT Operation element */ - p = rtw_get_ie(in_ie + 12, EID_VHTOperation, &ielen, in_len - 12); - if (p && ielen > 0) { - out_len = *pout_len; - if (GET_VHT_OPERATION_ELE_CHL_WIDTH(p + 2) >= 1) { - if (supported_chnl_width == 2) - operation_bw = CHANNEL_WIDTH_80_80; - else if (supported_chnl_width == 1) - operation_bw = CHANNEL_WIDTH_160; - else - operation_bw = CHANNEL_WIDTH_80; + /* VHT Operation element */ + out_vht_op_ie = out_ie + *pout_len; + rtw_set_ie(out_vht_op_ie, EID_VHTOperation, VHT_OP_IE_LEN, vht_op_ie + 2 , pout_len); + + /* get primary channel from HT_OP_IE */ + oper_ch = GET_HT_OP_ELE_PRI_CHL(ht_op_ie + 2); + + /* find the largest bw supported by both registry and hal */ + max_bw = hal_largest_bw(padapter, REGSTY_BW_5G(pregistrypriv)); + + if (max_bw >= CHANNEL_WIDTH_40) { + /* get bw offset form HT_OP_IE */ + if (GET_HT_OP_ELE_STA_CHL_WIDTH(ht_op_ie + 2)) { + switch (GET_HT_OP_ELE_2ND_CHL_OFFSET(ht_op_ie + 2)) { + case SCA: + oper_bw = CHANNEL_WIDTH_40; + oper_offset = HAL_PRIME_CHNL_OFFSET_LOWER; + break; + case SCB: + oper_bw = CHANNEL_WIDTH_40; + oper_offset = HAL_PRIME_CHNL_OFFSET_UPPER; + break; } - pframe = rtw_set_ie(out_ie + out_len, EID_VHTOperation, ielen, p + 2 , pout_len); } - /* find the largest bw supported by both registry and hal */ - notify_bw = hal_largest_bw(padapter, REGSTY_BW_5G(pregistrypriv)); + if (oper_bw == CHANNEL_WIDTH_40) { + switch (GET_VHT_OPERATION_ELE_CHL_WIDTH(vht_op_ie + 2)) { + case 1: /* 80MHz */ + case 2: /* 160MHz */ + case 3: /* 80+80 */ + oper_bw = CHANNEL_WIDTH_80; /* only support up to 80MHz for now */ + break; + } - if (notify_bw > operation_bw) - notify_bw = operation_bw; + oper_bw = rtw_min(oper_bw, max_bw); - /* Operating Mode Notification element */ - notify_len = rtw_build_vht_op_mode_notify_ie(padapter, out_ie + *pout_len, notify_bw); - *pout_len += notify_len; - - pvhtpriv->vht_option = _TRUE; + /* try downgrage bw to fit in channel plan setting */ + while (!rtw_chset_is_chbw_valid(chset, oper_ch, oper_bw, oper_offset) + || (IS_DFS_SLAVE_WITH_RD(rfctl) + && !rtw_odm_dfs_domain_unknown(rfctl_to_dvobj(rfctl)) + && rtw_chset_is_chbw_non_ocp(chset, oper_ch, oper_bw, oper_offset)) + ) { + oper_bw--; + if (oper_bw == CHANNEL_WIDTH_20) { + oper_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; + break; + } + } + } } + rtw_warn_on(!rtw_chset_is_chbw_valid(chset, oper_ch, oper_bw, oper_offset)); + if (IS_DFS_SLAVE_WITH_RD(rfctl) && !rtw_odm_dfs_domain_unknown(rfctl_to_dvobj(rfctl))) + rtw_warn_on(rtw_chset_is_chbw_non_ocp(chset, oper_ch, oper_bw, oper_offset)); + + /* update VHT_OP_IE */ + if (oper_bw < CHANNEL_WIDTH_80) { + SET_VHT_OPERATION_ELE_CHL_WIDTH(out_vht_op_ie + 2, 0); + SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ1(out_vht_op_ie + 2, 0); + SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ2(out_vht_op_ie + 2, 0); + } else if (oper_bw == CHANNEL_WIDTH_80) { + u8 cch = rtw_get_center_ch(oper_ch, oper_bw, oper_offset); + + SET_VHT_OPERATION_ELE_CHL_WIDTH(out_vht_op_ie + 2, 1); + SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ1(out_vht_op_ie + 2, cch); + SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ2(out_vht_op_ie + 2, 0); + } else { + RTW_ERR(FUNC_ADPT_FMT" unsupported BW:%u\n", FUNC_ADPT_ARG(padapter), oper_bw); + rtw_warn_on(1); + } + + /* Operating Mode Notification element */ + *pout_len += rtw_build_vht_op_mode_notify_ie(padapter, out_ie + *pout_len, oper_bw); + + pvhtpriv->vht_option = _TRUE; + +exit: return pvhtpriv->vht_option; } @@ -800,4 +1065,72 @@ 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; + + rtw_check_for_vht20(padapter, pnetwork->IEs + _BEACON_IE_OFFSET_, pnetwork->IELength - _BEACON_IE_OFFSET_); + + 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; +} + +void rtw_check_for_vht20(_adapter *adapter, u8 *ies, int ies_len) +{ + u8 ht_ch, ht_bw, ht_offset; + u8 vht_ch, vht_bw, vht_offset; + + rtw_ies_get_chbw(ies, ies_len, &ht_ch, &ht_bw, &ht_offset, 1, 0); + rtw_ies_get_chbw(ies, ies_len, &vht_ch, &vht_bw, &vht_offset, 1, 1); + + if (ht_bw == CHANNEL_WIDTH_20 && vht_bw >= CHANNEL_WIDTH_80) { + u8 *vht_op_ie; + int vht_op_ielen; + + RTW_INFO(FUNC_ADPT_FMT" vht80 is not allowed without ht40\n", FUNC_ADPT_ARG(adapter)); + vht_op_ie = rtw_get_ie(ies, EID_VHTOperation, &vht_op_ielen, ies_len); + if (vht_op_ie && vht_op_ielen) { + RTW_INFO(FUNC_ADPT_FMT" switch to vht20\n", FUNC_ADPT_ARG(adapter)); + SET_VHT_OPERATION_ELE_CHL_WIDTH(vht_op_ie + 2, 0); + SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ1(vht_op_ie + 2, 0); + SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ2(vht_op_ie + 2, 0); + } + } +} #endif /* CONFIG_80211AC_VHT */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_wapi.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_wapi.c index 186c4206efe2..dd95bbcf09e4 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_wapi.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_wapi.c @@ -1,4 +1,18 @@ /* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * 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 @@ -439,7 +453,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); @@ -450,7 +465,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__); @@ -778,6 +793,14 @@ void rtw_wapi_return_all_sta_info(_adapter *padapter) WAPI_TRACE(WAPI_API, "<========== %s\n", __FUNCTION__); } +void CAM_empty_entry( + PADAPTER Adapter, + u8 ucIndex +) +{ + rtw_hal_set_hwreg(Adapter, HW_VAR_CAM_EMPTY_ENTRY, (u8 *)(&ucIndex)); +} + void rtw_wapi_clear_cam_entry(_adapter *padapter, u8 *pMacAddr) { u8 UcIndex = 0; @@ -1051,7 +1074,7 @@ void wapi_test_set_key(struct _adapter *padapter, u8 *buf) void wapi_test_init(struct _adapter *padapter) { u8 keybuf[100]; - u8 mac_addr[6] = {0x00, 0xe0, 0x4c, 0x72, 0x04, 0x70}; + u8 mac_addr[ETH_ALEN] = {0x00, 0xe0, 0x4c, 0x72, 0x04, 0x70}; u8 UskDataKey[16] = {0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x09, 0x0a, 0x0b, 0x0c, 0x0d, 0x0e, 0x0f}; u8 UskMicKey[16] = {0x10, 0x11, 0x12, 0x13, 0x14, 0x15, 0x16, 0x17, 0x18, 0x19, 0x1a, 0x1b, 0x1c, 0x1d, 0x1e, 0x1f}; u8 UskId = 0; @@ -1077,7 +1100,7 @@ void wapi_test_init(struct _adapter *padapter) keybuf[2] = 1; /* AE */ keybuf[3] = 0; /* not update */ - memcpy(keybuf + 4, mac_addr, 6); + memcpy(keybuf + 4, mac_addr, ETH_ALEN); memcpy(keybuf + 10, UskDataKey, 16); memcpy(keybuf + 26, UskMicKey, 16); keybuf[42] = UskId; @@ -1089,7 +1112,7 @@ void wapi_test_init(struct _adapter *padapter) keybuf[2] = 0; /* AE */ keybuf[3] = 0; /* not update */ - memcpy(keybuf + 4, mac_addr, 6); + memcpy(keybuf + 4, mac_addr, ETH_ALEN); memcpy(keybuf + 10, UskDataKey, 16); memcpy(keybuf + 26, UskMicKey, 16); keybuf[42] = UskId; @@ -1102,7 +1125,7 @@ void wapi_test_init(struct _adapter *padapter) keybuf[1] = 1; /* Enable TX */ keybuf[2] = 1; /* AE */ keybuf[3] = 0; /* not update */ - memcpy(keybuf + 4, mac_addr, 6); + memcpy(keybuf + 4, mac_addr, ETH_ALEN); memcpy(keybuf + 10, MskDataKey, 16); memcpy(keybuf + 26, MskMicKey, 16); keybuf[42] = MskId; @@ -1113,7 +1136,7 @@ void wapi_test_init(struct _adapter *padapter) keybuf[1] = 1; /* Enable TX */ keybuf[2] = 0; /* AE */ keybuf[3] = 0; /* not update */ - memcpy(keybuf + 4, mac_addr, 6); + memcpy(keybuf + 4, mac_addr, ETH_ALEN); memcpy(keybuf + 10, MskDataKey, 16); memcpy(keybuf + 26, MskMicKey, 16); keybuf[42] = MskId; @@ -1238,4 +1261,61 @@ bool rtw_wapi_drop_for_key_absent(_adapter *padapter, u8 *pRA) return bDrop; } +void rtw_wapi_set_set_encryption(_adapter *padapter, struct ieee_param *param) +{ + struct security_priv *psecuritypriv = &padapter->securitypriv; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; + PRT_WAPI_STA_INFO pWapiSta; + u8 WapiASUEPNInitialValueSrc[16] = {0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C} ; + 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} ; + + if (param->u.crypt.set_tx == 1) { + list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { + if (_rtw_memcmp(pWapiSta->PeerMacAddr, param->sta_addr, 6)) { + _rtw_memcpy(pWapiSta->lastTxUnicastPN, WapiASUEPNInitialValueSrc, 16); + + pWapiSta->wapiUsk.bSet = true; + _rtw_memcpy(pWapiSta->wapiUsk.dataKey, param->u.crypt.key, 16); + _rtw_memcpy(pWapiSta->wapiUsk.micKey, param->u.crypt.key + 16, 16); + pWapiSta->wapiUsk.keyId = param->u.crypt.idx ; + pWapiSta->wapiUsk.bTxEnable = true; + + _rtw_memcpy(pWapiSta->lastRxUnicastPNBEQueue, WapiAEPNInitialValueSrc, 16); + _rtw_memcpy(pWapiSta->lastRxUnicastPNBKQueue, WapiAEPNInitialValueSrc, 16); + _rtw_memcpy(pWapiSta->lastRxUnicastPNVIQueue, WapiAEPNInitialValueSrc, 16); + _rtw_memcpy(pWapiSta->lastRxUnicastPNVOQueue, WapiAEPNInitialValueSrc, 16); + _rtw_memcpy(pWapiSta->lastRxUnicastPN, WapiAEPNInitialValueSrc, 16); + pWapiSta->wapiUskUpdate.bTxEnable = false; + pWapiSta->wapiUskUpdate.bSet = false; + + if (psecuritypriv->sw_encrypt == false || psecuritypriv->sw_decrypt == false) { + /* set unicast key for ASUE */ + rtw_wapi_set_key(padapter, &pWapiSta->wapiUsk, pWapiSta, false, false); + } + } + } + } else { + list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { + if (_rtw_memcmp(pWapiSta->PeerMacAddr, get_bssid(pmlmepriv), 6)) { + pWapiSta->wapiMsk.bSet = true; + _rtw_memcpy(pWapiSta->wapiMsk.dataKey, param->u.crypt.key, 16); + _rtw_memcpy(pWapiSta->wapiMsk.micKey, param->u.crypt.key + 16, 16); + pWapiSta->wapiMsk.keyId = param->u.crypt.idx ; + pWapiSta->wapiMsk.bTxEnable = false; + if (!pWapiSta->bSetkeyOk) + pWapiSta->bSetkeyOk = true; + pWapiSta->bAuthenticateInProgress = false; + + _rtw_memcpy(pWapiSta->lastRxMulticastPN, WapiAEMultiCastPNInitialValueSrc, 16); + + if (psecuritypriv->sw_decrypt == false) { + /* set rx broadcast key for ASUE */ + rtw_wapi_set_key(padapter, &pWapiSta->wapiMsk, pWapiSta, true, false); + } + } + } + } +} #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_wapi_sms4.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_wapi_sms4.c index 01762acc22b9..5eaa5be44c91 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_wapi_sms4.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_wapi_sms4.c @@ -1,4 +1,18 @@ /* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * 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/rtl8188eu/core/rtw_wlan_util.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_wlan_util.c index 808e6178f6a1..a234ccbf0c2a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_wlan_util.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_wlan_util.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 @@ -27,6 +23,8 @@ #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}; @@ -55,9 +53,6 @@ extern unsigned char RSN_TKIP_CIPHER[4]; #define WAIT_FOR_BCN_TO_MIN (6000) #define WAIT_FOR_BCN_TO_MAX (20000) -#define DISCONNECT_BY_CHK_BCN_FAIL_OBSERV_PERIOD_IN_MS 1000 -#define DISCONNECT_BY_CHK_BCN_FAIL_THRESHOLD 3 - static u8 rtw_basic_rate_cck[4] = { IEEE80211_CCK_RATE_1MB | IEEE80211_BASIC_RATE_MASK, IEEE80211_CCK_RATE_2MB | IEEE80211_BASIC_RATE_MASK, IEEE80211_CCK_RATE_5MB | IEEE80211_BASIC_RATE_MASK, IEEE80211_CCK_RATE_11MB | IEEE80211_BASIC_RATE_MASK @@ -75,8 +70,63 @@ static u8 rtw_basic_rate_mix[7] = { IEEE80211_OFDM_RATE_24MB | IEEE80211_BASIC_RATE_MASK }; -int new_bcn_max = 3; +extern u8 WIFI_CCKRATES[]; +bool rtw_is_cck_rate(u8 rate) +{ + int i; + for (i = 0; i < 4; i++) + if ((WIFI_CCKRATES[i] & 0x7F) == (rate & 0x7F)) + return 1; + return 0; +} + +extern u8 WIFI_OFDMRATES[]; +bool rtw_is_ofdm_rate(u8 rate) +{ + int i; + + for (i = 0; i < 8; i++) + if ((WIFI_OFDMRATES[i] & 0x7F) == (rate & 0x7F)) + return 1; + return 0; +} + +/* test if rate is defined in rtw_basic_rate_cck */ +bool rtw_is_basic_rate_cck(u8 rate) +{ + int i; + + for (i = 0; i < 4; i++) + if ((rtw_basic_rate_cck[i] & 0x7F) == (rate & 0x7F)) + return 1; + return 0; +} + +/* test if rate is defined in rtw_basic_rate_ofdm */ +bool rtw_is_basic_rate_ofdm(u8 rate) +{ + int i; + + for (i = 0; i < 3; i++) + if ((rtw_basic_rate_ofdm[i] & 0x7F) == (rate & 0x7F)) + return 1; + return 0; +} + +/* test if rate is defined in rtw_basic_rate_mix */ +bool rtw_is_basic_rate_mix(u8 rate) +{ + int i; + + for (i = 0; i < 7; i++) + if ((rtw_basic_rate_mix[i] & 0x7F) == (rate & 0x7F)) + return 1; + return 0; +} +#ifdef CONFIG_BCN_CNT_CONFIRM_HDL +int new_bcn_max = 3; +#endif int cckrates_included(unsigned char *rate, int ratelen) { int i; @@ -104,8 +154,7 @@ 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) { struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); u8 rf_type = RF_1T1R, custom_rf_type; @@ -119,154 +168,50 @@ s8 rtw_get_tx_nss(_adapter *adapter, struct sta_info *psta) if (RF_TYPE_VALID(custom_rf_type)) rf_type = custom_rf_type; -#ifdef CONFIG_80211AC_VHT - if (psta->vhtpriv.vht_option) { - nss = rtw_min(rf_type_to_rf_tx_cnt(rf_type), hal_spec->tx_nss_num); - 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(rf_type_to_rf_tx_cnt(rf_type), hal_spec->tx_nss_num); - nss = rtw_min(nss, rtw_ht_mcsset_to_nss(psta->htpriv.ht_cap.supp_mcs_set)); - } + nss = rtw_min(rf_type_to_rf_rx_cnt(rf_type), hal_spec->rx_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(_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,8 +378,8 @@ void set_mcs_rate_by_mask(u8 *mcs_set, u32 mask) } void UpdateBrateTbl( - IN PADAPTER Adapter, - IN u8 *mBratesOS + PADAPTER Adapter, + u8 *mBratesOS ) { u8 i; @@ -615,53 +560,6 @@ u8 rtw_get_offset_by_chbw(u8 ch, u8 bw, u8 *r_offset) return valid; } -u8 rtw_get_offset_by_ch(u8 channel) -{ - u8 offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; - - if (channel >= 1 && channel <= 4) - offset = HAL_PRIME_CHNL_OFFSET_LOWER; - else if (channel >= 5 && channel <= 14) - offset = HAL_PRIME_CHNL_OFFSET_UPPER; - else { - switch (channel) { - case 36: - case 44: - case 52: - case 60: - case 100: - case 108: - case 116: - case 124: - case 132: - case 149: - case 157: - offset = HAL_PRIME_CHNL_OFFSET_LOWER; - break; - case 40: - case 48: - case 56: - case 64: - case 104: - case 112: - case 120: - case 128: - case 136: - case 153: - case 161: - offset = HAL_PRIME_CHNL_OFFSET_UPPER; - break; - default: - offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; - break; - } - - } - - return offset; - -} - u8 rtw_get_center_ch(u8 channel, u8 chnl_bw, u8 chnl_offset) { u8 center_ch = channel; @@ -696,12 +594,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; @@ -712,7 +610,6 @@ inline u32 rtw_get_on_cur_ch_time(_adapter *adapter) void set_channel_bwmode(_adapter *padapter, unsigned char channel, unsigned char channel_offset, unsigned short bwmode) { u8 center_ch, chnl_offset80 = HAL_PRIME_CHNL_OFFSET_DONT_CARE; - struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; #if (defined(CONFIG_TDLS) && defined(CONFIG_TDLS_CH_SW)) || defined(CONFIG_MCC_MODE) u8 iqk_info_backup = _FALSE; #endif @@ -735,10 +632,8 @@ void set_channel_bwmode(_adapter *padapter, unsigned char channel, unsigned char #ifdef CONFIG_MCC_MODE if (MCC_EN(padapter)) { /* driver doesn't set channel setting reg under MCC */ - if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) { + if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) RTW_INFO("Warning: Do not set channel setting reg MCC mode\n"); - rtw_warn_on(1); - } } #endif @@ -748,9 +643,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; @@ -784,7 +676,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); @@ -796,16 +690,6 @@ void set_channel_bwmode(_adapter *padapter, unsigned char channel, unsigned char _exit_critical_mutex(&(adapter_to_dvobj(padapter)->setch_mutex), NULL); } -int get_bsstype(unsigned short capability) -{ - if (capability & BIT(0)) - return WIFI_FW_AP_STATE; - else if (capability & BIT(1)) - return WIFI_FW_ADHOC_STATE; - else - return 0; -} - __inline u8 *get_my_bssid(WLAN_BSSID_EX *pnetwork) { return pnetwork->MacAddress; @@ -856,7 +740,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; @@ -877,14 +761,6 @@ unsigned int decide_wait_for_beacon_timeout(unsigned int bcn_interval) return bcn_interval << 2; } -void CAM_empty_entry( - PADAPTER Adapter, - u8 ucIndex -) -{ - rtw_hal_set_hwreg(Adapter, HW_VAR_CAM_EMPTY_ENTRY, (u8 *)(&ucIndex)); -} - void invalidate_cam_all(_adapter *padapter) { struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); @@ -1297,7 +1173,7 @@ s16 rtw_camid_search(_adapter *adapter, u8 *addr, s16 kid, s8 gk) return cam_id; } -s16 rtw_get_camid(_adapter *adapter, struct sta_info *sta, u8 *addr, s16 kid) +s16 rtw_get_camid(_adapter *adapter, u8 *addr, s16 kid, u8 gk) { struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; @@ -1318,7 +1194,7 @@ s16 rtw_get_camid(_adapter *adapter, struct sta_info *sta, u8 *addr, s16 kid) /* find cam entry which has the same addr, kid (, gk bit) */ if (_rtw_camctl_chk_cap(adapter, SEC_CAP_CHK_BMC) == _TRUE) - i = _rtw_camid_search(adapter, addr, kid, sta ? _FALSE : _TRUE); + i = _rtw_camid_search(adapter, addr, kid, gk); else i = _rtw_camid_search(adapter, addr, kid, -1); @@ -1338,12 +1214,8 @@ s16 rtw_get_camid(_adapter *adapter, struct sta_info *sta, u8 *addr, s16 kid) } if (i == cam_ctl->num) { - if (sta) - RTW_PRINT(FUNC_ADPT_FMT" pairwise key with "MAC_FMT" id:%u no room\n" - , FUNC_ADPT_ARG(adapter), MAC_ARG(addr), kid); - else - RTW_PRINT(FUNC_ADPT_FMT" group key with "MAC_FMT" id:%u no room\n" - , FUNC_ADPT_ARG(adapter), MAC_ARG(addr), kid); + RTW_PRINT(FUNC_ADPT_FMT" %s key with "MAC_FMT" id:%u no room\n" + , FUNC_ADPT_ARG(adapter), gk ? "group" : "pairwise", MAC_ARG(addr), kid); rtw_warn_on(1); goto _exit; } @@ -1355,7 +1227,7 @@ s16 rtw_get_camid(_adapter *adapter, struct sta_info *sta, u8 *addr, s16 kid) return cam_id; } -s16 rtw_camid_alloc(_adapter *adapter, struct sta_info *sta, u8 kid, bool *used) +s16 rtw_camid_alloc(_adapter *adapter, struct sta_info *sta, u8 kid, u8 gk, bool *used) { struct mlme_ext_info *mlmeinfo = &adapter->mlmeextpriv.mlmext_info; struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); @@ -1369,8 +1241,12 @@ s16 rtw_camid_alloc(_adapter *adapter, struct sta_info *sta, u8 kid, bool *used) if ((((mlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) || ((mlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE)) && !sta) { + /* + * 1. non-STA mode WEP key + * 2. group TX key + */ #ifndef CONFIG_CONCURRENT_MODE - /* AP/Ad-hoc mode group key static alloction to default key by key ID on Non-concurrent*/ + /* static alloction to default key by key ID when concurrent is not defined */ if (kid > 3) { RTW_PRINT(FUNC_ADPT_FMT" group key with invalid key id:%u\n" , FUNC_ADPT_ARG(adapter), kid); @@ -1381,13 +1257,18 @@ s16 rtw_camid_alloc(_adapter *adapter, struct sta_info *sta, u8 kid, bool *used) #else u8 *addr = adapter_mac_addr(adapter); - cam_id = rtw_get_camid(adapter, sta, addr, kid); + cam_id = rtw_get_camid(adapter, addr, kid, gk); if (1) RTW_PRINT(FUNC_ADPT_FMT" group key with "MAC_FMT" assigned cam_id:%u\n" , FUNC_ADPT_ARG(adapter), MAC_ARG(addr), cam_id); #endif } else { - u8 *addr = sta ? sta->hwaddr : NULL; + /* + * 1. STA mode WEP key + * 2. STA mode group RX key + * 3. sta key (pairwise, group RX) + */ + u8 *addr = sta ? sta->cmn.mac_addr : NULL; if (!sta) { if (!(mlmeinfo->state & WIFI_FW_ASSOC_SUCCESS)) { @@ -1396,7 +1277,7 @@ s16 rtw_camid_alloc(_adapter *adapter, struct sta_info *sta, u8 kid, bool *used) } addr = get_bssid(&adapter->mlmepriv);/*A2*/ } - cam_id = rtw_get_camid(adapter, sta, addr, kid); + cam_id = rtw_get_camid(adapter, addr, kid, gk); } @@ -1539,12 +1420,12 @@ void rtw_clean_hw_dk_cam(_adapter *adapter) void flush_all_cam_entry(_adapter *padapter) { +#ifdef CONFIG_CONCURRENT_MODE struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); struct security_priv *psecpriv = &padapter->securitypriv; -#ifdef CONFIG_CONCURRENT_MODE if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { struct sta_priv *pstapriv = &padapter->stapriv; struct sta_info *psta; @@ -1556,7 +1437,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); @@ -1674,6 +1555,10 @@ 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; @@ -1799,10 +1684,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 - if (pmlmeinfo->WMM_param.QoS_info & BIT(7)) + +#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 + } +#endif /* CONFIG_WMMPS_STA */ } } @@ -1895,10 +1784,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; } @@ -1910,6 +1799,97 @@ static void bwmode_update_check(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pI #endif /* CONFIG_80211N_HT */ } +#ifdef ROKU_PRIVATE +void Supported_rate_infra_ap(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) +{ + unsigned int i; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + + if (pIE == NULL) + return; + + for (i = 0 ; i < pIE->Length; i++) + pmlmeinfo->SupportedRates_infra_ap[i] = (pIE->data[i]); + +} + +void Extended_Supported_rate_infra_ap(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) +{ + unsigned int i, j; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + + if (pIE == NULL) + return; + + if (pIE->Length > 0) { + for (i = 0; i < NDIS_802_11_LENGTH_RATES_EX; i++) { + if (pmlmeinfo->SupportedRates_infra_ap[i] == 0) + break; + } + for (j = 0; j < pIE->Length; j++) + pmlmeinfo->SupportedRates_infra_ap[i+j] = (pIE->data[j]); + } + +} + +void HT_get_ss_from_mcs_set(u8 *mcs_set, u8 *Rx_ss) +{ + u8 i, j; + u8 r_ss = 0, t_ss = 0; + + for (i = 0; i < 4; i++) { + if ((mcs_set[3-i] & 0xff) != 0x00) { + r_ss = 4-i; + break; + } + } + + *Rx_ss = r_ss; +} + +void HT_caps_handler_infra_ap(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) +{ + unsigned int i; + u8 cur_stbc_cap_infra_ap = 0; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct ht_priv_infra_ap *phtpriv = &pmlmepriv->htpriv_infra_ap; + + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + + if (pIE == NULL) + return; + + pmlmeinfo->ht_vht_received |= BIT(0); + + /*copy MCS_SET*/ + for (i = 3; i < 19; i++) + phtpriv->MCS_set_infra_ap[i-3] = (pIE->data[i]); + + /*get number of stream from mcs set*/ + HT_get_ss_from_mcs_set(phtpriv->MCS_set_infra_ap, &phtpriv->Rx_ss_infra_ap); + + phtpriv->rx_highest_data_rate_infra_ap = le16_to_cpu(GET_HT_CAP_ELE_RX_HIGHEST_DATA_RATE(pIE->data)); + + phtpriv->ldpc_cap_infra_ap = GET_HT_CAP_ELE_LDPC_CAP(pIE->data); + + if (GET_HT_CAP_ELE_RX_STBC(pIE->data)) + SET_FLAG(cur_stbc_cap_infra_ap, STBC_HT_ENABLE_RX); + if (GET_HT_CAP_ELE_TX_STBC(pIE->data)) + SET_FLAG(cur_stbc_cap_infra_ap, STBC_HT_ENABLE_TX); + phtpriv->stbc_cap_infra_ap = cur_stbc_cap_infra_ap; + + /*store ap info SGI 20m 40m*/ + phtpriv->sgi_20m_infra_ap = GET_HT_CAP_ELE_SHORT_GI20M(pIE->data); + phtpriv->sgi_40m_infra_ap = GET_HT_CAP_ELE_SHORT_GI40M(pIE->data); + + /*store ap info for supported channel bandwidth*/ + phtpriv->channel_width_infra_ap = GET_HT_CAP_ELE_CHL_WIDTH(pIE->data); +} +#endif /* ROKU_PRIVATE */ + void HT_caps_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) { #ifdef CONFIG_80211N_HT @@ -1921,7 +1901,9 @@ void HT_caps_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct ht_priv *phtpriv = &pmlmepriv->htpriv; +#ifdef CONFIG_DISABLE_MCS13TO15 struct registry_priv *pregistrypriv = &padapter->registrypriv; +#endif struct hal_spec_t *hal_spec = GET_HAL_SPEC(padapter); if (pIE == NULL) @@ -2127,9 +2109,9 @@ void HTOnAssocRsp(_adapter *padapter) min_MPDU_spacing = (pmlmeinfo->HT_caps.u.HT_cap_element.AMPDU_para & 0x1c) >> 2; rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_MIN_SPACE, (u8 *)(&min_MPDU_spacing)); - +#ifdef CONFIG_80211N_HT rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_FACTOR, (u8 *)(&max_AMPDU_len)); - +#endif /* CONFIG_80211N_HT */ #if 0 /* move to rtw_update_ht_cap() */ if ((pregpriv->bw_mode > 0) && (pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info & BIT(1)) && @@ -2192,7 +2174,6 @@ void ERP_IE_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) void VCS_update(_adapter *padapter, struct sta_info *psta) { struct registry_priv *pregpriv = &padapter->registrypriv; - struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); @@ -2239,21 +2220,29 @@ 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 */ @@ -2263,7 +2252,6 @@ int check_ielen(u8 *start, uint len) { int left = len; u8 *pos = start; - int unknown = 0; u8 id, elen; while (left >= 2) { @@ -2276,7 +2264,7 @@ int check_ielen(u8 *start, uint len) id, elen, (unsigned long) left); return _FALSE; } - if ((id == WLAN_EID_VENDOR_SPECIFIC) && (elen < 4)) + if ((id == WLAN_EID_VENDOR_SPECIFIC) && (elen < 3)) return _FALSE; left -= elen; @@ -2303,6 +2291,175 @@ int validate_beacon_len(u8 *pframe, u32 len) return _TRUE; } + +u8 support_rate_ranges[] = { + IEEE80211_CCK_RATE_1MB, + IEEE80211_CCK_RATE_2MB, + IEEE80211_CCK_RATE_5MB, + IEEE80211_CCK_RATE_11MB, + IEEE80211_OFDM_RATE_6MB, + IEEE80211_OFDM_RATE_9MB, + IEEE80211_OFDM_RATE_12MB, + IEEE80211_OFDM_RATE_18MB, + IEEE80211_OFDM_RATE_24MB, + IEEE80211_OFDM_RATE_36MB, + IEEE80211_OFDM_RATE_48MB, + IEEE80211_OFDM_RATE_54MB, +}; + +inline bool match_ranges(u16 EID, u32 value) +{ + int i; + int nr_range; + + switch (EID) { + case _EXT_SUPPORTEDRATES_IE_: + case _SUPPORTEDRATES_IE_: + nr_range = sizeof(support_rate_ranges)/sizeof(u8); + for (i = 0; i < nr_range; i++) { + /* clear bit7 before searching. */ + value &= ~BIT(7); + if (value == support_rate_ranges[i]) + return _TRUE; + } + break; + default: + break; + }; + return _FALSE; +} + +/* + * rtw_validate_value: validate the IE contain. + * + * Input : + * EID : Element ID + * p : IE buffer (without EID & length) + * len : IE length + * return: + * _TRUE : All Values are validated. + * _FALSE : At least one value is NOT validated. + */ +bool rtw_validate_value(u16 EID, u8 *p, u16 len) +{ + u8 rate; + u32 i, nr_val; + + switch (EID) { + case _EXT_SUPPORTEDRATES_IE_: + case _SUPPORTEDRATES_IE_: + nr_val = len; + for (i=0; iSsid.SsidLength == 0) || + is_all_null(snetwork->Ssid.Ssid, snetwork->Ssid.SsidLength) == _TRUE); +} + +/* + Get SSID if this ilegal frame(probe resp) comes from a hidden SSID AP. + Update the SSID to the corresponding pnetwork in scan queue. +*/ +void rtw_absorb_ssid_ifneed(_adapter *padapter, WLAN_BSSID_EX *bssid, u8 *pframe) +{ + struct wlan_network *scanned = NULL; + WLAN_BSSID_EX *snetwork; + u8 ie_offset, *p=NULL, *next_ie=NULL, *mac = get_addr2_ptr(pframe); + sint len, ssid_len_ori; + u32 remain_len = 0; + u8 backupIE[MAX_IE_SZ]; + u16 subtype = get_frame_sub_type(pframe); + _irqL irqL; + + if ((!bssid) || (!pframe)) + return; + + if (subtype == WIFI_BEACON) { + 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] = BSS_TYPE_PROB_RSP; + } else if (subtype == WIFI_PROBEREQ) { + ie_offset = _PROBEREQ_IE_OFFSET_; + bssid->Reserved[0] = BSS_TYPE_PROB_REQ; + } else { + bssid->Reserved[0] = BSS_TYPE_UNDEF; + ie_offset = _FIXED_IE_LENGTH_; + } + } + + _enter_critical_bh(&padapter->mlmepriv.scanned_queue.lock, &irqL); + scanned = _rtw_find_network(&padapter->mlmepriv.scanned_queue, mac); + if (!scanned) { + _exit_critical_bh(&padapter->mlmepriv.scanned_queue.lock, &irqL); + return; + } + + snetwork = &(scanned->network); + /* scan queue records as Hidden SSID && Input frame is NOT Hidden SSID */ + if (hidden_ssid_ap(snetwork) && !hidden_ssid_ap(bssid)) { + p = rtw_get_ie(snetwork->IEs+ie_offset, _SSID_IE_, &ssid_len_ori, snetwork->IELength-ie_offset); + if (!p) { + _exit_critical_bh(&padapter->mlmepriv.scanned_queue.lock, &irqL); + return; + } + next_ie = p + 2 + ssid_len_ori; + remain_len = snetwork->IELength - (next_ie - snetwork->IEs); + scanned->network.Ssid.SsidLength = bssid->Ssid.SsidLength; + _rtw_memcpy(scanned->network.Ssid.Ssid, bssid->Ssid.Ssid, bssid->Ssid.SsidLength); + + //update pnetwork->ssid, pnetwork->ssidlen + _rtw_memcpy(backupIE, next_ie, remain_len); + *(p+1) = bssid->Ssid.SsidLength; + _rtw_memcpy(p+2, bssid->Ssid.Ssid, bssid->Ssid.SsidLength); + _rtw_memcpy(p+2+bssid->Ssid.SsidLength, backupIE, remain_len); + snetwork->IELength += bssid->Ssid.SsidLength; + } + _exit_critical_bh(&padapter->mlmepriv.scanned_queue.lock, &irqL); +} + +#ifdef DBG_RX_BCN +void rtw_debug_rx_bcn(_adapter *adapter, u8 *pframe, u32 packet_len) +{ + struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; + struct mlme_ext_info *mlmeinfo = &(pmlmeext->mlmext_info); + u16 sn = ((struct rtw_ieee80211_hdr_3addr *)pframe)->seq_ctl >> 4; + u64 tsf, tsf_offset; + u8 dtim_cnt, dtim_period, tim_bmap, tim_pvbit; + + update_TSF(pmlmeext, pframe, packet_len); + tsf = pmlmeext->TSFValue; + tsf_offset = rtw_modular64(pmlmeext->TSFValue, (mlmeinfo->bcn_interval * 1024)); + + /*get TIM IE*/ + /*DTIM Count*/ + dtim_cnt = pmlmeext->tim[0]; + /*DTIM Period*/ + dtim_period = pmlmeext->tim[1]; + /*Bitmap*/ + tim_bmap = pmlmeext->tim[2]; + /*Partial VBitmap AID 0 ~ 7*/ + tim_pvbit = pmlmeext->tim[3]; + + RTW_INFO("[BCN] SN-%d, TSF-%lld(us), offset-%lld, bcn_interval-%d DTIM-%d[%d] bitmap-0x%02x-0x%02x\n", + sn, tsf, tsf_offset, mlmeinfo->bcn_interval, dtim_period, dtim_cnt, tim_bmap, tim_pvbit); +} +#endif + /* * rtw_get_bcn_keys: get beacon keys from recv frame * @@ -2378,61 +2535,47 @@ int rtw_get_bcn_keys(ADAPTER *Adapter, u8 *pframe, u32 packet_len, recv_beacon->encryp_protocol = ENCRYP_PROTOCOL_WPA2; rtw_parse_wpa2_ie(elems.rsn_ie - 2, elems.rsn_ie_len + 2, &recv_beacon->group_cipher, &recv_beacon->pairwise_cipher, - &recv_beacon->is_8021x); + &recv_beacon->akm, NULL); } /* checking WPA secon */ else if (elems.wpa_ie && elems.wpa_ie_len) { recv_beacon->encryp_protocol = ENCRYP_PROTOCOL_WPA; rtw_parse_wpa_ie(elems.wpa_ie - 2, elems.wpa_ie_len + 2, &recv_beacon->group_cipher, &recv_beacon->pairwise_cipher, - &recv_beacon->is_8021x); + &recv_beacon->akm); } else if (capability & BIT(4)) recv_beacon->encryp_protocol = ENCRYP_PROTOCOL_WEP; + if (elems.tim && elems.tim_len) { + struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; + + #ifdef DBG_RX_BCN + _rtw_memcpy(pmlmeext->tim, elems.tim, 4); + #endif + pmlmeext->dtim = elems.tim[1]; + } + return _TRUE; } void rtw_dump_bcn_keys(struct beacon_keys *recv_beacon) { - int i; - char *p; u8 ssid[IW_ESSID_MAX_SIZE + 1]; _rtw_memcpy(ssid, recv_beacon->ssid, recv_beacon->ssid_len); ssid[recv_beacon->ssid_len] = '\0'; RTW_INFO("%s: ssid = %s\n", __func__, ssid); - RTW_INFO("%s: channel = %x\n", __func__, recv_beacon->bcn_channel); - RTW_INFO("%s: ht_cap = %x\n", __func__, recv_beacon->ht_cap_info); - RTW_INFO("%s: ht_info_infos_0_sco = %x\n", __func__, recv_beacon->ht_info_infos_0_sco); - RTW_INFO("%s: sec=%d, group = %x, pair = %x, 8021X = %x\n", __func__, + RTW_INFO("%s: channel = %d\n", __func__, recv_beacon->bcn_channel); + RTW_INFO("%s: ht_cap = 0x%04x\n", __func__, recv_beacon->ht_cap_info); + RTW_INFO("%s: ht_info_infos_0_sco = 0x%02x\n", __func__, recv_beacon->ht_info_infos_0_sco); + RTW_INFO("%s: sec=%d, group = %x, pair = %x, akm = %x\n", __func__, recv_beacon->encryp_protocol, recv_beacon->group_cipher, - recv_beacon->pairwise_cipher, recv_beacon->is_8021x); + recv_beacon->pairwise_cipher, recv_beacon->akm); } - +#define DBG_BCN_CNT int rtw_check_bcn_info(ADAPTER *Adapter, u8 *pframe, u32 packet_len) { -#if 0 - unsigned int len; - unsigned char *p; - unsigned short val16, subtype; - struct wlan_network *cur_network = &(Adapter->mlmepriv.cur_network); - /* u8 wpa_ie[255],rsn_ie[255]; */ - u16 wpa_len = 0, rsn_len = 0; - u8 encryp_protocol = 0; - WLAN_BSSID_EX *bssid; - int group_cipher = 0, pairwise_cipher = 0, is_8021x = 0; - unsigned char *pbuf; - u32 wpa_ielen = 0; - u8 *pbssid = GetAddr3Ptr(pframe); - u32 hidden_ssid = 0; - u8 cur_network_type, network_type = 0; - struct HT_info_element *pht_info = NULL; - struct rtw_ieee80211_ht_cap *pht_cap = NULL; - u32 bcn_channel; - unsigned short ht_cap_info; - unsigned char ht_info_infos_0; -#endif unsigned int len; u8 *pbssid = GetAddr3Ptr(pframe); struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; @@ -2458,13 +2601,17 @@ int rtw_check_bcn_info(ADAPTER *Adapter, u8 *pframe, u32 packet_len) if (rtw_get_bcn_keys(Adapter, pframe, packet_len, &recv_beacon) == _FALSE) return _TRUE; /* parsing failed => broken IE */ +#ifdef DBG_RX_BCN + rtw_debug_bcn(Adapter, pframe, packet_len); +#endif + /* don't care hidden ssid, use current beacon ssid directly */ if (recv_beacon.ssid_len == 0) { _rtw_memcpy(recv_beacon.ssid, pmlmepriv->cur_beacon_keys.ssid, pmlmepriv->cur_beacon_keys.ssid_len); recv_beacon.ssid_len = pmlmepriv->cur_beacon_keys.ssid_len; } - +#ifdef CONFIG_BCN_CNT_CONFIRM_HDL if (_rtw_memcmp(&recv_beacon, &pmlmepriv->cur_beacon_keys, sizeof(recv_beacon)) == _TRUE) pmlmepriv->new_beacon_cnts = 0; else if ((pmlmepriv->new_beacon_cnts == 0) || @@ -2479,7 +2626,7 @@ int rtw_check_bcn_info(ADAPTER *Adapter, u8 *pframe, u32 packet_len) 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)); + _rtw_memcpy(&pmlmepriv->new_beacon_keys, &recv_beacon, sizeof(recv_beacon)); pmlmepriv->new_beacon_cnts = 1; } else { RTW_DBG("%s: new beacon again (seq=%d)\n", __func__, GetSequence(pframe)); @@ -2487,7 +2634,11 @@ int rtw_check_bcn_info(ADAPTER *Adapter, u8 *pframe, u32 packet_len) } /* if counter >= max, it means beacon is changed really */ - if (pmlmepriv->new_beacon_cnts >= new_bcn_max) { + if (pmlmepriv->new_beacon_cnts >= new_bcn_max) +#else + if (_rtw_memcmp(&recv_beacon, &pmlmepriv->cur_beacon_keys, sizeof(recv_beacon)) == _FALSE) +#endif + { /* 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; @@ -2495,204 +2646,35 @@ int rtw_check_bcn_info(ADAPTER *Adapter, u8 *pframe, u32 packet_len) sizeof(recv_beacon)) == _FALSE) { /* beacon is changed, have to do disconnect/connect */ RTW_WARN("%s: new beacon occur!!\n", __func__); + #ifdef DBG_BCN_CNT + rtw_dump_bcn_keys(&recv_beacon); + #endif return _FAIL; } - + #ifdef DBG_BCN_CNT RTW_INFO("%s bw mode change\n", __func__); RTW_INFO("%s bcn now: ht_cap_info:%x ht_info_infos_0:%x\n", __func__, cur_network->BcnInfo.ht_cap_info, cur_network->BcnInfo.ht_info_infos_0); + #endif cur_network->BcnInfo.ht_cap_info = recv_beacon.ht_cap_info; cur_network->BcnInfo.ht_info_infos_0 = (cur_network->BcnInfo.ht_info_infos_0 & (~0x03)) | recv_beacon.ht_info_infos_0_sco; + #ifdef DBG_BCN_CNT RTW_INFO("%s bcn link: ht_cap_info:%x ht_info_infos_0:%x\n", __func__, cur_network->BcnInfo.ht_cap_info, cur_network->BcnInfo.ht_info_infos_0); - - memcpy(&pmlmepriv->cur_beacon_keys, &recv_beacon, sizeof(recv_beacon)); + #endif + _rtw_memcpy(&pmlmepriv->cur_beacon_keys, &recv_beacon, sizeof(recv_beacon)); + #ifdef CONFIG_BCN_CNT_CONFIRM_HDL pmlmepriv->new_beacon_cnts = 0; + #endif } return _SUCCESS; - -#if 0 - bssid = (WLAN_BSSID_EX *)rtw_zmalloc(sizeof(WLAN_BSSID_EX)); - if (bssid == NULL) { - RTW_INFO("%s rtw_zmalloc fail !!!\n", __func__); - return _TRUE; - } - - if ((pmlmepriv->timeBcnInfoChkStart != 0) && (rtw_get_passing_time_ms(pmlmepriv->timeBcnInfoChkStart) > DISCONNECT_BY_CHK_BCN_FAIL_OBSERV_PERIOD_IN_MS)) { - pmlmepriv->timeBcnInfoChkStart = 0; - pmlmepriv->NumOfBcnInfoChkFail = 0; - } - - subtype = get_frame_sub_type(pframe) >> 4; - - if (subtype == WIFI_BEACON) - bssid->Reserved[0] = 1; - - bssid->Length = sizeof(WLAN_BSSID_EX) - MAX_IE_SZ + len; - - /* below is to copy the information element */ - bssid->IELength = len; - _rtw_memcpy(bssid->IEs, (pframe + sizeof(struct rtw_ieee80211_hdr_3addr)), bssid->IELength); - - /* check bw and channel offset */ - /* parsing HT_CAP_IE */ - p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _HT_CAPABILITY_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); - if (p && len > 0) { - pht_cap = (struct rtw_ieee80211_ht_cap *)(p + 2); - ht_cap_info = pht_cap->cap_info; - } else - ht_cap_info = 0; - /* parsing HT_INFO_IE */ - p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _HT_ADD_INFO_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); - if (p && len > 0) { - pht_info = (struct HT_info_element *)(p + 2); - ht_info_infos_0 = pht_info->infos[0]; - } else - ht_info_infos_0 = 0; - if (ht_cap_info != cur_network->BcnInfo.ht_cap_info || - ((ht_info_infos_0 & 0x03) != (cur_network->BcnInfo.ht_info_infos_0 & 0x03))) { - RTW_INFO("%s bcn now: ht_cap_info:%x ht_info_infos_0:%x\n", __func__, - ht_cap_info, ht_info_infos_0); - RTW_INFO("%s bcn link: ht_cap_info:%x ht_info_infos_0:%x\n", __func__, - cur_network->BcnInfo.ht_cap_info, cur_network->BcnInfo.ht_info_infos_0); - RTW_INFO("%s bw mode change\n", __func__); - { - /* bcn_info_update */ - cur_network->BcnInfo.ht_cap_info = ht_cap_info; - cur_network->BcnInfo.ht_info_infos_0 = ht_info_infos_0; - /* to do : need to check that whether modify related register of BB or not */ - } - /* goto _mismatch; */ - } - - /* Checking for channel */ - p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _DSSET_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); - if (p) - bcn_channel = *(p + 2); - else {/* In 5G, some ap do not have DSSET IE checking HT info for channel */ - rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _HT_ADD_INFO_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); - if (pht_info) - bcn_channel = pht_info->primary_channel; - else { /* we don't find channel IE, so don't check it */ - /* RTW_INFO("Oops: %s we don't find channel IE, so don't check it\n", __func__); */ - bcn_channel = Adapter->mlmeextpriv.cur_channel; - } - } - if (bcn_channel != Adapter->mlmeextpriv.cur_channel) { - RTW_INFO("%s beacon channel:%d cur channel:%d disconnect\n", __func__, - bcn_channel, Adapter->mlmeextpriv.cur_channel); - goto _mismatch; - } - - /* checking SSID */ - p = rtw_get_ie(bssid->IEs + _FIXED_IE_LENGTH_, _SSID_IE_, &len, bssid->IELength - _FIXED_IE_LENGTH_); - if (p == NULL) { - RTW_INFO("%s marc: cannot find SSID for survey event\n", __func__); - hidden_ssid = _TRUE; - } else - hidden_ssid = _FALSE; - - if ((NULL != p) && (_FALSE == hidden_ssid && (*(p + 1)))) { - _rtw_memcpy(bssid->Ssid.Ssid, (p + 2), *(p + 1)); - bssid->Ssid.SsidLength = *(p + 1); - } else { - bssid->Ssid.SsidLength = 0; - bssid->Ssid.Ssid[0] = '\0'; - } - - - if (_rtw_memcmp(bssid->Ssid.Ssid, cur_network->network.Ssid.Ssid, 32) == _FALSE || - bssid->Ssid.SsidLength != cur_network->network.Ssid.SsidLength) { - if (bssid->Ssid.Ssid[0] != '\0' && bssid->Ssid.SsidLength != 0) { /* not hidden ssid */ - RTW_INFO("%s(), SSID is not match\n", __func__); - goto _mismatch; - } - } - - /* check encryption info */ - val16 = rtw_get_capability((WLAN_BSSID_EX *)bssid); - - if (val16 & BIT(4)) - bssid->Privacy = 1; - else - bssid->Privacy = 0; - - if (cur_network->network.Privacy != bssid->Privacy) { - RTW_INFO("%s(), privacy is not match\n", __func__); - goto _mismatch; - } - - rtw_get_sec_ie(bssid->IEs, bssid->IELength, NULL, &rsn_len, NULL, &wpa_len); - - if (rsn_len > 0) - encryp_protocol = ENCRYP_PROTOCOL_WPA2; - else if (wpa_len > 0) - encryp_protocol = ENCRYP_PROTOCOL_WPA; - else { - if (bssid->Privacy) - encryp_protocol = ENCRYP_PROTOCOL_WEP; - } - - if (cur_network->BcnInfo.encryp_protocol != encryp_protocol) { - RTW_INFO("%s(): enctyp is not match\n", __func__); - goto _mismatch; - } - - if (encryp_protocol == ENCRYP_PROTOCOL_WPA || encryp_protocol == ENCRYP_PROTOCOL_WPA2) { - pbuf = rtw_get_wpa_ie(&bssid->IEs[12], &wpa_ielen, bssid->IELength - 12); - if (pbuf && (wpa_ielen > 0)) { - rtw_parse_wpa_ie(pbuf, wpa_ielen + 2, &group_cipher, &pairwise_cipher, &is_8021x); - } else { - pbuf = rtw_get_wpa2_ie(&bssid->IEs[12], &wpa_ielen, bssid->IELength - 12); - - if (pbuf && (wpa_ielen > 0)) { - rtw_parse_wpa2_ie(pbuf, wpa_ielen + 2, &group_cipher, &pairwise_cipher, &is_8021x); - } - } - - if (pairwise_cipher != cur_network->BcnInfo.pairwise_cipher || group_cipher != cur_network->BcnInfo.group_cipher) { - RTW_INFO("%s pairwise_cipher(%x:%x) or group_cipher(%x:%x) is not match\n", __func__, - pairwise_cipher, cur_network->BcnInfo.pairwise_cipher, - group_cipher, cur_network->BcnInfo.group_cipher); - goto _mismatch; - } - - if (is_8021x != cur_network->BcnInfo.is_8021x) { - RTW_INFO("%s authentication is not match\n", __func__); - goto _mismatch; - } - } - - rtw_mfree((u8 *)bssid, sizeof(WLAN_BSSID_EX)); - return _SUCCESS; - -_mismatch: - rtw_mfree((u8 *)bssid, sizeof(WLAN_BSSID_EX)); - - if (pmlmepriv->NumOfBcnInfoChkFail == 0) - pmlmepriv->timeBcnInfoChkStart = rtw_get_current_time(); - - pmlmepriv->NumOfBcnInfoChkFail++; - RTW_INFO("%s by "ADPT_FMT" - NumOfChkFail = %d (SeqNum of this Beacon frame = %d).\n", __func__, ADPT_ARG(Adapter), pmlmepriv->NumOfBcnInfoChkFail, GetSequence(pframe)); - - if ((pmlmepriv->timeBcnInfoChkStart != 0) && (rtw_get_passing_time_ms(pmlmepriv->timeBcnInfoChkStart) <= DISCONNECT_BY_CHK_BCN_FAIL_OBSERV_PERIOD_IN_MS) - && (pmlmepriv->NumOfBcnInfoChkFail >= DISCONNECT_BY_CHK_BCN_FAIL_THRESHOLD)) { - RTW_INFO("%s by "ADPT_FMT" - NumOfChkFail = %d >= threshold : %d (in %d ms), return FAIL.\n", __func__, ADPT_ARG(Adapter), pmlmepriv->NumOfBcnInfoChkFail, - DISCONNECT_BY_CHK_BCN_FAIL_THRESHOLD, rtw_get_passing_time_ms(pmlmepriv->timeBcnInfoChkStart)); - pmlmepriv->timeBcnInfoChkStart = 0; - pmlmepriv->NumOfBcnInfoChkFail = 0; - return _FAIL; - } - - return _SUCCESS; -#endif } void update_beacon_info(_adapter *padapter, u8 *pframe, uint pkt_len, struct sta_info *psta) @@ -2750,26 +2732,23 @@ void update_beacon_info(_adapter *padapter, u8 *pframe, uint pkt_len, struct sta } #ifdef CONFIG_DFS -void process_csa_ie(_adapter *padapter, u8 *pframe, uint pkt_len) +void process_csa_ie(_adapter *padapter, u8 *ies, uint ies_len) { + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); unsigned int i; - unsigned int len; PNDIS_802_11_VARIABLE_IEs pIE; - u8 new_ch_no = 0; + u8 ch = 0; - if (padapter->mlmepriv.handle_dfs == _TRUE) + /* TODO: compare with scheduling CSA */ + if (rfctl->csa_ch) return; - len = pkt_len - (_BEACON_IE_OFFSET_ + WLAN_HDR_A3_LEN); - - for (i = 0; i < len;) { - pIE = (PNDIS_802_11_VARIABLE_IEs)(pframe + (_BEACON_IE_OFFSET_ + WLAN_HDR_A3_LEN) + i); + for (i = 0; i + 1 < ies_len;) { + pIE = (PNDIS_802_11_VARIABLE_IEs)(ies + i); switch (pIE->ElementID) { case _CH_SWTICH_ANNOUNCE_: - padapter->mlmepriv.handle_dfs = _TRUE; - _rtw_memcpy(&new_ch_no, pIE->data + 1, 1); - rtw_set_csa_cmd(padapter, new_ch_no); + ch = *(pIE->data + 1); break; default: break; @@ -2777,9 +2756,65 @@ void process_csa_ie(_adapter *padapter, u8 *pframe, uint pkt_len) i += (pIE->Length + 2); } + + if (ch != 0) { + rfctl->csa_ch = ch; + if (rtw_set_csa_cmd(padapter) != _SUCCESS) + rfctl->csa_ch = 0; + } } #endif /* CONFIG_DFS */ +void parsing_eapol_packet(_adapter *padapter, u8 *key_payload, struct sta_info *psta, u8 trx_type) +{ + struct security_priv *psecuritypriv = &(padapter->securitypriv); + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct sta_priv *pstapriv = &(padapter->stapriv); + struct ieee802_1x_hdr *hdr; + struct wpa_eapol_key *key; + u16 key_info, key_data_length; + char *trx_msg = trx_type ? "send" : "recv"; + + hdr = (struct ieee802_1x_hdr *) key_payload; + + /* WPS - eapol start packet */ + if (hdr->type == 1 && hdr->length == 0) { + RTW_INFO("%s eapol start packet\n", trx_msg); + return; + } + + if (hdr->type == 0) { /* WPS - eapol packet */ + RTW_INFO("%s eapol packet\n", trx_msg); + return; + } + + key = (struct wpa_eapol_key *) (hdr + 1); + key_info = be16_to_cpu(*((u16 *)(key->key_info))); + key_data_length = be16_to_cpu(*((u16 *)(key->key_data_length))); + + if (!(key_info & WPA_KEY_INFO_KEY_TYPE)) { /* WPA group key handshake */ + if (key_info & WPA_KEY_INFO_ACK) { + RTW_PRINT("%s eapol packet - WPA Group Key 1/2\n", trx_msg); + } else { + RTW_PRINT("%s eapol packet - WPA Group Key 2/2\n", trx_msg); + + /* WPA key-handshake has completed */ + if (psecuritypriv->ndisauthtype == Ndis802_11AuthModeWPAPSK) + psta->state &= (~WIFI_UNDER_KEY_HANDSHAKE); + } + } else if (key_info & WPA_KEY_INFO_MIC) { + if (key_data_length == 0) + RTW_PRINT("%s eapol packet 4/4\n", trx_msg); + else if (key_info & WPA_KEY_INFO_ACK) + RTW_PRINT("%s eapol packet 3/4\n", trx_msg); + else + RTW_PRINT("%s eapol packet 2/4\n", trx_msg); + } else { + RTW_PRINT("%s eapol packet 1/4\n", trx_msg); + } + +} + unsigned int is_ap_in_tkip(_adapter *padapter) { u32 i; @@ -2989,13 +3024,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; } @@ -3006,13 +3055,13 @@ unsigned char get_highest_rate_idx(u32 mask) void Update_RA_Entry(_adapter *padapter, struct sta_info *psta) { - rtw_hal_update_ra_mask(psta, psta->rssi_level, _TRUE); + 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, _TRUE); + rtw_hal_update_ra_mask(psta); } /* Update RRSR and Rate for USERATE */ @@ -3029,10 +3078,6 @@ void update_tx_basic_rate(_adapter *padapter, u8 wirelessmode) if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) return; #endif /* CONFIG_P2P */ -#ifdef CONFIG_INTEL_WIDI - if (padapter->mlmepriv.widi_state != INTEL_WIDI_STATE_NONE) - return; -#endif /* CONFIG_INTEL_WIDI */ _rtw_memset(supported_rates, 0, NDIS_802_11_LENGTH_RATES_EX); @@ -3130,6 +3175,105 @@ unsigned char check_assoc_AP(u8 *pframe, uint len) return HT_IOT_PEER_UNKNOWN; } +void get_assoc_AP_Vendor(char *vendor, u8 assoc_AP_vendor) +{ + switch (assoc_AP_vendor) { + + case HT_IOT_PEER_UNKNOWN: + sprintf(vendor, "%s", "unknown"); + break; + + case HT_IOT_PEER_REALTEK: + case HT_IOT_PEER_REALTEK_92SE: + case HT_IOT_PEER_REALTEK_SOFTAP: + case HT_IOT_PEER_REALTEK_JAGUAR_BCUTAP: + case HT_IOT_PEER_REALTEK_JAGUAR_CCUTAP: + + sprintf(vendor, "%s", "Realtek"); + break; + + case HT_IOT_PEER_BROADCOM: + sprintf(vendor, "%s", "Broadcom"); + break; + + case HT_IOT_PEER_MARVELL: + sprintf(vendor, "%s", "Marvell"); + break; + + case HT_IOT_PEER_RALINK: + sprintf(vendor, "%s", "Ralink"); + break; + + case HT_IOT_PEER_CISCO: + sprintf(vendor, "%s", "Cisco"); + break; + + case HT_IOT_PEER_AIRGO: + sprintf(vendor, "%s", "Airgo"); + break; + + case HT_IOT_PEER_ATHEROS: + sprintf(vendor, "%s", "Atheros"); + break; + + default: + sprintf(vendor, "%s", "unkown"); + break; + } + +} +#ifdef CONFIG_RTS_FULL_BW +void rtw_parse_sta_vendor_ie_8812(_adapter *adapter, struct sta_info *sta, u8 *tlv_ies, u16 tlv_ies_len) +{ + struct mlme_priv *mlme = &adapter->mlmepriv; + unsigned char REALTEK_OUI[] = {0x00,0xe0, 0x4c}; + u8 *p; + int i; + + p = rtw_get_ie_ex(tlv_ies, tlv_ies_len, WLAN_EID_VENDOR_SPECIFIC, REALTEK_OUI, 3, NULL, NULL); + if (!p) + goto exit; + else { + if(*(p+1) > 6 ) { + + if(*(p+6) != 2) + goto exit; + + if(*(p+8) == RT_HT_CAP_USE_JAGUAR_BCUT) + sta->vendor_8812 = TRUE; + else if (*(p+8) == RT_HT_CAP_USE_JAGUAR_CCUT) + sta->vendor_8812 = TRUE; + } + } +exit: + return; +} +#endif/*CONFIG_RTS_FULL_BW*/ + +#ifdef CONFIG_80211AC_VHT +unsigned char get_vht_mu_bfer_cap(u8 *pframe, uint len) +{ + unsigned int i; + unsigned int mu_bfer=0; + PNDIS_802_11_VARIABLE_IEs pIE; + + for (i = sizeof(NDIS_802_11_FIXED_IEs); i < len;) { + pIE = (PNDIS_802_11_VARIABLE_IEs)(pframe + i); + + switch (pIE->ElementID) { + + case EID_VHTCapability: + mu_bfer = GET_VHT_CAPABILITY_ELE_MU_BFER(pIE->data); + break; + default: + break; + } + i += (pIE->Length + 2); + } + return mu_bfer; +} +#endif + void update_capinfo(PADAPTER Adapter, u16 updateCap) { struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; @@ -3229,6 +3373,9 @@ void update_wireless_mode(_adapter *padapter) pmlmeext->cur_wireless_mode = network_type & padapter->registrypriv.wireless_mode; /* RTW_INFO("network_type=%02x, padapter->registrypriv.wireless_mode=%02x\n", network_type, padapter->registrypriv.wireless_mode); */ + +#ifndef RTW_HALMAC + /* HALMAC IC do not set HW_VAR_RESP_SIFS here */ #if 0 if ((pmlmeext->cur_wireless_mode == WIRELESS_11G) || (pmlmeext->cur_wireless_mode == WIRELESS_11BG)) /* WIRELESS_MODE_G) */ @@ -3241,6 +3388,7 @@ void update_wireless_mode(_adapter *padapter) * change this value if having IOT issues. */ rtw_hal_set_hwreg(padapter, HW_VAR_RESP_SIFS, (u8 *)&SIFS_Timer); +#endif rtw_hal_set_hwreg(padapter, HW_VAR_WIRELESS_MODE, (u8 *)&(pmlmeext->cur_wireless_mode)); @@ -3299,26 +3447,71 @@ void update_sta_basic_rate(struct sta_info *psta, u8 wireless_mode) int rtw_ies_get_supported_rate(u8 *ies, uint ies_len, u8 *rate_set, u8 *rate_num) { - u8 *ie; + u8 *ie, *p; unsigned int ie_len; + int i, j; + struct support_rate_handler support_rate_tbl[] = { + {IEEE80211_CCK_RATE_1MB, _FALSE, _FALSE}, + {IEEE80211_CCK_RATE_2MB, _FALSE, _FALSE}, + {IEEE80211_CCK_RATE_5MB, _FALSE, _FALSE}, + {IEEE80211_CCK_RATE_11MB, _FALSE, _FALSE}, + {IEEE80211_OFDM_RATE_6MB, _FALSE, _FALSE}, + {IEEE80211_OFDM_RATE_9MB, _FALSE, _FALSE}, + {IEEE80211_OFDM_RATE_12MB, _FALSE, _FALSE}, + {IEEE80211_OFDM_RATE_18MB, _FALSE, _FALSE}, + {IEEE80211_OFDM_RATE_24MB, _FALSE, _FALSE}, + {IEEE80211_OFDM_RATE_36MB, _FALSE, _FALSE}, + {IEEE80211_OFDM_RATE_48MB, _FALSE, _FALSE}, + {IEEE80211_OFDM_RATE_54MB, _FALSE, _FALSE}, + }; + if (!rate_set || !rate_num) return _FALSE; *rate_num = 0; - ie = rtw_get_ie(ies, _SUPPORTEDRATES_IE_, &ie_len, ies_len); if (ie == NULL) goto ext_rate; - _rtw_memcpy(rate_set, ie + 2, ie_len); - *rate_num = ie_len; + /* get valid supported rates */ + for (i = 0; i < 12; i++) { + p = ie + 2; + for (j = 0; j < ie_len; j++) { + if ((*p & ~BIT(7)) == support_rate_tbl[i].rate){ + support_rate_tbl[i].existence = _TRUE; + if ((*p) & BIT(7)) + support_rate_tbl[i].basic = _TRUE; + } + p++; + } + } ext_rate: ie = rtw_get_ie(ies, _EXT_SUPPORTEDRATES_IE_, &ie_len, ies_len); if (ie) { - _rtw_memcpy(rate_set + *rate_num, ie + 2, ie_len); - *rate_num += ie_len; + /* get valid extended supported rates */ + for (i = 0; i < 12; i++) { + p = ie + 2; + for (j = 0; j < ie_len; j++) { + if ((*p & ~BIT(7)) == support_rate_tbl[i].rate){ + support_rate_tbl[i].existence = _TRUE; + if ((*p) & BIT(7)) + support_rate_tbl[i].basic = _TRUE; + } + p++; + } + } + } + + for (i = 0; i < 12; i++){ + if (support_rate_tbl[i].existence){ + if (support_rate_tbl[i].basic) + rate_set[*rate_num] = support_rate_tbl[i].rate | IEEE80211_BASIC_RATE_MASK; + else + rate_set[*rate_num] = support_rate_tbl[i].rate; + *rate_num += 1; + } } if (*rate_num == 0) @@ -3340,8 +3533,6 @@ void process_addba_req(_adapter *padapter, u8 *paddba_req, u8 *addr) u16 tid, start_seq, param; struct sta_priv *pstapriv = &padapter->stapriv; struct ADDBA_request *preq = (struct ADDBA_request *)paddba_req; - struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); u8 size, accept = _FALSE; psta = rtw_get_stainfo(pstapriv, addr); @@ -3355,7 +3546,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); @@ -3366,6 +3562,32 @@ void process_addba_req(_adapter *padapter, u8 *paddba_req, u8 *addr) return; } +void rtw_process_bar_frame(_adapter *padapter, union recv_frame *precv_frame) +{ + struct sta_priv *pstapriv = &padapter->stapriv; + u8 *pframe = precv_frame->u.hdr.rx_data; + struct sta_info *psta = NULL; + struct recv_reorder_ctrl *preorder_ctrl = NULL; + u8 tid = 0; + u16 start_seq=0; + + psta = rtw_get_stainfo(pstapriv, get_addr2_ptr(pframe)); + if (psta == NULL) + goto exit; + + tid = ((cpu_to_le16((*(u16 *)(pframe + 16))) & 0xf000) >> 12); + preorder_ctrl = &psta->recvreorder_ctrl[tid]; + start_seq = ((cpu_to_le16(*(u16 *)(pframe + 18))) >> 4); + preorder_ctrl->indicate_seq = start_seq; + + /* for Debug use */ + if (0) + RTW_INFO(FUNC_ADPT_FMT" tid=%d, start_seq=%d\n", FUNC_ADPT_ARG(padapter), tid, start_seq); + +exit: + return; +} + void update_TSF(struct mlme_ext_priv *pmlmeext, u8 *pframe, uint len) { u8 *pIE; @@ -3381,108 +3603,54 @@ void update_TSF(struct mlme_ext_priv *pmlmeext, u8 *pframe, uint len) pmlmeext->TSFValue |= le32_to_cpu(*pbuf); } -void correct_TSF(_adapter *padapter, struct mlme_ext_priv *pmlmeext) +void correct_TSF(_adapter *padapter, u8 mlme_state) { - rtw_hal_set_hwreg(padapter, HW_VAR_CORRECT_TSF, 0); + u8 m_state = mlme_state; + + rtw_hal_set_hwreg(padapter, HW_VAR_CORRECT_TSF, (u8 *)&m_state); } -void adaptive_early_32k(struct mlme_ext_priv *pmlmeext, u8 *pframe, uint len) +#ifdef CONFIG_BCN_RECV_TIME +/* calculate beacon receiving time + 1.RxBCNTime(CCK_1M) = [192us(preamble)] + [length of beacon(byte)*8us] + [10us] + 2.RxBCNTime(OFDM_6M) = [8us(S) + 8us(L) + 4us(L-SIG)] + [(length of beacon(byte)/3 + 1] *4us] + [10us] +*/ +inline u16 _rx_bcn_time_calculate(uint bcn_len, u8 data_rate) { - int i; - u8 *pIE; - u32 *pbuf; - u64 tsf = 0; - u32 delay_ms; - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); - - - pmlmeext->bcn_cnt++; - - pIE = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); - pbuf = (u32 *)pIE; - - tsf = le32_to_cpu(*(pbuf + 1)); - tsf = tsf << 32; - tsf |= le32_to_cpu(*pbuf); - - /* RTW_INFO("%s(): tsf_upper= 0x%08x, tsf_lower=0x%08x\n", __func__, (u32)(tsf>>32), (u32)tsf); */ - - /* delay = (timestamp mod 1024*100)/1000 (unit: ms) */ - /* delay_ms = do_div(tsf, (pmlmeinfo->bcn_interval*1024))/1000; */ - delay_ms = rtw_modular64(tsf, (pmlmeinfo->bcn_interval * 1024)); - delay_ms = delay_ms / 1000; - - if (delay_ms >= 8) { - pmlmeext->bcn_delay_cnt[8]++; - /* pmlmeext->bcn_delay_ratio[8] = (pmlmeext->bcn_delay_cnt[8] * 100) /pmlmeext->bcn_cnt; */ - } else { - pmlmeext->bcn_delay_cnt[delay_ms]++; - /* pmlmeext->bcn_delay_ratio[delay_ms] = (pmlmeext->bcn_delay_cnt[delay_ms] * 100) /pmlmeext->bcn_cnt; */ - } - - /* - RTW_INFO("%s(): (a)bcn_cnt = %d\n", __func__, pmlmeext->bcn_cnt); - - - for(i=0; i<9; i++) - { - RTW_INFO("%s():bcn_delay_cnt[%d]=%d, bcn_delay_ratio[%d]=%d\n", __func__, i, - pmlmeext->bcn_delay_cnt[i] , i, pmlmeext->bcn_delay_ratio[i]); - } - */ - - /* dump for adaptive_early_32k */ - if (pmlmeext->bcn_cnt > 100 && (pmlmeext->adaptive_tsf_done == _TRUE)) { - u8 ratio_20_delay, ratio_80_delay; - u8 DrvBcnEarly, DrvBcnTimeOut; - - ratio_20_delay = 0; - ratio_80_delay = 0; - DrvBcnEarly = 0xff; - DrvBcnTimeOut = 0xff; - - RTW_INFO("%s(): bcn_cnt = %d\n", __func__, pmlmeext->bcn_cnt); - - for (i = 0; i < 9; i++) { - pmlmeext->bcn_delay_ratio[i] = (pmlmeext->bcn_delay_cnt[i] * 100) / pmlmeext->bcn_cnt; - - - /* RTW_INFO("%s():bcn_delay_cnt[%d]=%d, bcn_delay_ratio[%d]=%d\n", __func__, i, */ - /* pmlmeext->bcn_delay_cnt[i] , i, pmlmeext->bcn_delay_ratio[i]); */ - - ratio_20_delay += pmlmeext->bcn_delay_ratio[i]; - ratio_80_delay += pmlmeext->bcn_delay_ratio[i]; - - if (ratio_20_delay > 20 && DrvBcnEarly == 0xff) { - DrvBcnEarly = i; - /* RTW_INFO("%s(): DrvBcnEarly = %d\n", __func__, DrvBcnEarly); */ - } - - if (ratio_80_delay > 80 && DrvBcnTimeOut == 0xff) { - DrvBcnTimeOut = i; - /* RTW_INFO("%s(): DrvBcnTimeOut = %d\n", __func__, DrvBcnTimeOut); */ - } - - /* reset adaptive_early_32k cnt */ - pmlmeext->bcn_delay_cnt[i] = 0; - pmlmeext->bcn_delay_ratio[i] = 0; - } - - pmlmeext->DrvBcnEarly = DrvBcnEarly; - pmlmeext->DrvBcnTimeOut = DrvBcnTimeOut; - - pmlmeext->bcn_cnt = 0; - } + u16 rx_bcn_time = 0;/*us*/ + if (data_rate == DESC_RATE1M) + rx_bcn_time = 192 + bcn_len * 8 + 10; + else if(data_rate == DESC_RATE6M) + rx_bcn_time = 8 + 8 + 4 + (bcn_len /3 + 1) * 4 + 10; +/* + else + RTW_ERR("%s invalid data rate(0x%02x)\n", __func__, data_rate); +*/ + return rx_bcn_time; } +void rtw_rx_bcn_time_update(_adapter *adapter, uint bcn_len, u8 data_rate) +{ + struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; + pmlmeext->bcn_rx_time = _rx_bcn_time_calculate(bcn_len, data_rate); +} +#endif void beacon_timing_control(_adapter *padapter) { rtw_hal_bcn_related_reg_setting(padapter); } -#define CONFIG_SHARED_BMC_MACID +inline bool _rtw_macid_ctl_chk_cap(_adapter *adapter, u8 cap) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + struct macid_ctl_t *macid_ctl = &dvobj->macid_ctl; + + if (macid_ctl->macid_cap & cap) + return _TRUE; + return _FALSE; +} void dump_macid_map(void *sel, struct macid_bmp *map, u8 max_num) { @@ -3543,22 +3711,6 @@ inline void rtw_macid_map_set(struct macid_bmp *map, u8 id) rtw_warn_on(1); } -/*Record bc's mac-id and sec-cam-id*/ -inline void rtw_iface_bcmc_id_set(_adapter *padapter, u8 mac_id) -{ - struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); - struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); - - macid_ctl->iface_bmc[padapter->iface_id] = mac_id; -} -inline u8 rtw_iface_bcmc_id_get(_adapter *padapter) -{ - struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); - struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); - - return macid_ctl->iface_bmc[padapter->iface_id]; -} - inline void rtw_macid_map_clr(struct macid_bmp *map, u8 id) { if (id < 32) @@ -3589,24 +3741,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) @@ -3620,6 +3796,22 @@ inline s8 rtw_macid_get_ch_g(struct macid_ctl_t *macid_ctl, u8 id) return -1; } +/*Record bc's mac-id and sec-cam-id*/ +inline void rtw_iface_bcmc_id_set(_adapter *padapter, u8 mac_id) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); + + macid_ctl->iface_bmc[padapter->iface_id] = mac_id; +} +inline u8 rtw_iface_bcmc_id_get(_adapter *padapter) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); + + return macid_ctl->iface_bmc[padapter->iface_id]; +} + void rtw_alloc_macid(_adapter *padapter, struct sta_info *psta) { int i; @@ -3632,51 +3824,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)) - /* GO/AP assign client macid from 8 */ - last_id = 8; - } -#endif /* CONFIG_MCC_MODE */ _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)) { @@ -3687,8 +3859,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))) @@ -3723,18 +3894,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; @@ -3746,65 +3917,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 */ @@ -3829,16 +4010,41 @@ u8 rtw_search_max_mac_id(_adapter *padapter) return max_mac_id; } -inline void rtw_macid_ctl_set_h2c_msr(struct macid_ctl_t *macid_ctl, u8 id, u8 h2c_msr) +inline u8 rtw_macid_ctl_set_h2c_msr(struct macid_ctl_t *macid_ctl, u8 id, u8 h2c_msr) { + u8 op_num_change_bmp = 0; + if (id >= macid_ctl->num) { rtw_warn_on(1); - return; + goto exit; + } + + if (GET_H2CCMD_MSRRPT_PARM_OPMODE(&macid_ctl->h2c_msr[id]) + && !GET_H2CCMD_MSRRPT_PARM_OPMODE(&h2c_msr) + ) { + u8 role = GET_H2CCMD_MSRRPT_PARM_ROLE(&macid_ctl->h2c_msr[id]); + + if (role < H2C_MSR_ROLE_MAX) { + macid_ctl->op_num[role]--; + op_num_change_bmp |= BIT(role); + } + } else if (!GET_H2CCMD_MSRRPT_PARM_OPMODE(&macid_ctl->h2c_msr[id]) + && GET_H2CCMD_MSRRPT_PARM_OPMODE(&h2c_msr) + ) { + u8 role = GET_H2CCMD_MSRRPT_PARM_ROLE(&h2c_msr); + + if (role < H2C_MSR_ROLE_MAX) { + macid_ctl->op_num[role]++; + op_num_change_bmp |= BIT(role); + } } macid_ctl->h2c_msr[id] = h2c_msr; if (0) RTW_INFO("macid:%u, h2c_msr:"H2C_MSR_FMT"\n", id, H2C_MSR_ARG(&macid_ctl->h2c_msr[id])); + +exit: + return op_num_change_bmp; } inline void rtw_macid_ctl_set_bw(struct macid_ctl_t *macid_ctl, u8 id, u8 bw) @@ -3889,8 +4095,45 @@ 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_drop_reg(struct macid_ctl_t *macid_ctl, u16 m0, u16 m1, u16 m2, u16 m3) +{ + macid_ctl->reg_drop_m0 = m0; +#if (MACID_NUM_SW_LIMIT > 32) + macid_ctl->reg_drop_m1 = m1; +#endif +#if (MACID_NUM_SW_LIMIT > 64) + macid_ctl->reg_drop_m2 = m2; +#endif +#if (MACID_NUM_SW_LIMIT > 96) + macid_ctl->reg_drop_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); } @@ -3899,6 +4142,87 @@ inline void rtw_macid_ctl_deinit(struct macid_ctl_t *macid_ctl) _rtw_spinlock_free(&macid_ctl->lock); } +inline bool rtw_bmp_is_set(const u8 *bmp, u8 bmp_len, u8 id) +{ + if (id / 8 >= bmp_len) + return 0; + + return bmp[id / 8] & BIT(id % 8); +} + +inline void rtw_bmp_set(u8 *bmp, u8 bmp_len, u8 id) +{ + if (id / 8 < bmp_len) + bmp[id / 8] |= BIT(id % 8); +} + +inline void rtw_bmp_clear(u8 *bmp, u8 bmp_len, u8 id) +{ + if (id / 8 < bmp_len) + bmp[id / 8] &= ~BIT(id % 8); +} + +inline bool rtw_bmp_not_empty(const u8 *bmp, u8 bmp_len) +{ + int i; + + for (i = 0; i < bmp_len; i++) { + if (bmp[i]) + return 1; + } + + return 0; +} + +inline bool rtw_bmp_not_empty_exclude_bit0(const u8 *bmp, u8 bmp_len) +{ + int i; + + for (i = 0; i < bmp_len; i++) { + if (i == 0) { + if (bmp[i] & 0xFE) + return 1; + } else { + if (bmp[i]) + return 1; + } + } + + return 0; +} + +#ifdef CONFIG_AP_MODE +/* Check the id be set or not in map , if yes , return a none zero value*/ +bool rtw_tim_map_is_set(_adapter *padapter, const u8 *map, u8 id) +{ + return rtw_bmp_is_set(map, padapter->stapriv.aid_bmp_len, id); +} + +/* Set the id into map array*/ +void rtw_tim_map_set(_adapter *padapter, u8 *map, u8 id) +{ + rtw_bmp_set(map, padapter->stapriv.aid_bmp_len, id); +} + +/* Clear the id from map array*/ +void rtw_tim_map_clear(_adapter *padapter, u8 *map, u8 id) +{ + rtw_bmp_clear(map, padapter->stapriv.aid_bmp_len, id); +} + +/* Check have anyone bit be set , if yes return true*/ +bool rtw_tim_map_anyone_be_set(_adapter *padapter, const u8 *map) +{ + return rtw_bmp_not_empty(map, padapter->stapriv.aid_bmp_len); +} + +/* Check have anyone bit be set exclude bit0 , if yes return true*/ +bool rtw_tim_map_anyone_be_set_exclude_aid0(_adapter *padapter, const u8 *map) +{ + return rtw_bmp_not_empty_exclude_bit0(map, padapter->stapriv.aid_bmp_len); +} +#endif /* CONFIG_AP_MODE */ + #if 0 unsigned int setup_beacon_frame(_adapter *padapter, unsigned char *beacon_frame) { @@ -4047,31 +4371,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) @@ -4154,7 +4453,10 @@ void rtw_wow_pattern_sw_reset(_adapter *adapter) int i; struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(adapter); - pwrctrlpriv->wowlan_pattern_idx = DEFAULT_PATTERN_NUM; + 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)); @@ -4166,19 +4468,22 @@ void rtw_wow_pattern_sw_reset(_adapter *adapter) 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++) { @@ -4189,61 +4494,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; } - - void rtw_dump_priv_pattern(_adapter *adapter, u8 idx) { struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); @@ -4650,3 +5003,16 @@ void rtw_dev_pno_debug(struct net_device *net) } #endif /* CONFIG_PNO_SET_DEBUG */ #endif /* CONFIG_PNO_SUPPORT */ + +inline void rtw_collect_bcn_info(_adapter *adapter) +{ + struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; + + if (!is_client_associated_to_ap(adapter)) + return; + + pmlmeext->cur_bcn_cnt = pmlmeext->bcn_cnt - pmlmeext->last_bcn_cnt; + pmlmeext->last_bcn_cnt = pmlmeext->bcn_cnt; + /*TODO get offset of bcn's timestamp*/ + /*pmlmeext->bcn_timestamp;*/ +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_xmit.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_xmit.c index fb3d3f9d7e6e..45bec3ffb864 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_xmit.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/core/rtw_xmit.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2019 Realtek Corporation. * * This program is free software; you can redistribute it and/or modify it * under the terms of version 2 of the GNU General Public License as @@ -11,22 +12,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 _RTW_XMIT_C_ #include #include -#if defined(PLATFORM_LINUX) && defined (PLATFORM_WINDOWS) - #error "Shall be Linux or Windows, but not both!\n" -#endif - - static u8 P802_1H_OUI[P80211_OUI_LEN] = { 0x00, 0x00, 0xf8 }; static u8 RFC1042_OUI[P80211_OUI_LEN] = { 0x00, 0x00, 0x00 }; @@ -59,6 +50,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 +79,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 @@ -315,19 +320,19 @@ s32 _rtw_init_xmit_priv(struct xmit_priv *pxmitpriv, _adapter *padapter) #endif #ifdef CONFIG_TX_AMSDU - _init_timer(&(pxmitpriv->amsdu_vo_timer), padapter->pnetdev, + rtw_init_timer(&(pxmitpriv->amsdu_vo_timer), padapter, rtw_amsdu_vo_timeout_handler, padapter); pxmitpriv->amsdu_vo_timeout = RTW_AMSDU_TIMER_UNSET; - _init_timer(&(pxmitpriv->amsdu_vi_timer), padapter->pnetdev, + rtw_init_timer(&(pxmitpriv->amsdu_vi_timer), padapter, rtw_amsdu_vi_timeout_handler, padapter); pxmitpriv->amsdu_vi_timeout = RTW_AMSDU_TIMER_UNSET; - _init_timer(&(pxmitpriv->amsdu_be_timer), padapter->pnetdev, + rtw_init_timer(&(pxmitpriv->amsdu_be_timer), padapter, rtw_amsdu_be_timeout_handler, padapter); pxmitpriv->amsdu_be_timeout = RTW_AMSDU_TIMER_UNSET; - _init_timer(&(pxmitpriv->amsdu_bk_timer), padapter->pnetdev, + rtw_init_timer(&(pxmitpriv->amsdu_bk_timer), padapter, rtw_amsdu_bk_timeout_handler, padapter); pxmitpriv->amsdu_bk_timeout = RTW_AMSDU_TIMER_UNSET; @@ -336,6 +341,10 @@ s32 _rtw_init_xmit_priv(struct xmit_priv *pxmitpriv, _adapter *padapter) 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: @@ -349,7 +358,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); @@ -435,7 +443,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; } @@ -444,7 +452,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)); @@ -459,7 +467,6 @@ void rtw_get_adapter_tx_rate_bmp_by_bw(_adapter *adapter, u8 bw, u16 *r_bmp_cck_ { struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); - struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; u8 fix_bw = 0xFF; u16 bmp_cck_ofdm = 0; u32 bmp_ht = 0; @@ -474,7 +481,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 */ @@ -492,7 +499,6 @@ void rtw_get_adapter_tx_rate_bmp_by_bw(_adapter *adapter, u8 bw, u16 *r_bmp_cck_ /* TODO: mlmeext->tx_rate*/ -exit: if (r_bmp_cck_ofdm) *r_bmp_cck_ofdm = bmp_cck_ofdm; if (r_bmp_ht) @@ -512,7 +518,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 */ @@ -868,6 +874,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; @@ -881,36 +919,38 @@ static void update_attrib_phy_info(_adapter *padapter, struct pkt_attrib *pattri pattrib->triggered = 0; pattrib->ampdu_spacing = 0; - /* qos_en, ht_en, init rate, ,bw, ch_offset, sgi */ - pattrib->qos_en = psta->qos_option; + /* ht_en, init rate, ,bw, ch_offset, sgi */ - 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; - pattrib->ch_offset = psta->htpriv.ch_offset; - pattrib->ampdu_en = _FALSE; + if(padapter->registrypriv.ht_enable && + is_supported_ht(padapter->registrypriv.wireless_mode)) { + pattrib->ht_en = psta->htpriv.ht_option; + pattrib->ch_offset = psta->htpriv.ch_offset; + pattrib->ampdu_en = _FALSE; - if (padapter->driver_ampdu_spacing != 0xFF) /* driver control AMPDU Density for peer sta's rx */ - pattrib->ampdu_spacing = padapter->driver_ampdu_spacing; - else - pattrib->ampdu_spacing = psta->htpriv.rx_ampdu_min_spacing; + if (padapter->driver_ampdu_spacing != 0xFF) /* driver control AMPDU Density for peer sta's rx */ + 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; + /* 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 */ @@ -924,23 +964,20 @@ 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; - pattrib->ch_offset = psta->htpriv.ch_offset; - pattrib->sgi = query_ra_short_GI(psta, pattrib->bwmode); + if(padapter->registrypriv.ht_enable && + is_supported_ht(padapter->registrypriv.wireless_mode)) { + pattrib->bwmode = rtw_get_tx_bw_mode(padapter, psta); + pattrib->ht_en = psta->htpriv.ht_option; + pattrib->ch_offset = psta->htpriv.ch_offset; + pattrib->sgi = query_ra_short_GI(psta, pattrib->bwmode); + } #endif /* CONFIG_80211N_HT */ } #endif /* CONFIG_TDLS */ pattrib->retry_ctrl = _FALSE; - -#ifdef CONFIG_AUTO_AP_MODE - if (psta->isrc && psta->pid > 0) - pattrib->pctrl = _TRUE; -#endif - } static s32 update_attrib_sec_info(_adapter *padapter, struct pkt_attrib *pattrib, struct sta_info *psta) @@ -952,7 +989,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) { @@ -1118,6 +1155,36 @@ u8 qos_acm(u8 acm_mask, u8 priority) return change_priority; } +#ifdef CONFIG_USER_PRIORITY_COMPLY_RFC4594_DSCP +/* refer to IEEE802.11-2016 Table R-3; Comply with Table R-2 (IETF RFC4594) */ +static u8 dscp_to_up_ac(u8 tos) +{ + u8 up = 0; + u8 dscp; + + dscp = (tos >> 2); + + if ( dscp == 0 ) + up = 0; + else if ( dscp >= 1 && dscp <= 9) + up = 1; + else if ( dscp >= 10 && dscp <= 16) + up = 2; + else if ( dscp >= 17 && dscp <= 23) + up = 3; + else if ( dscp >= 24 && dscp <= 31) + up = 4; + else if ( dscp >= 33 && dscp <= 40) + up = 5; + else if ((dscp >= 41 && dscp <= 47) || (dscp == 32)) + up = 6; + else if ( dscp >= 48 && dscp <= 63) + up = 7; + + return up; +} +#endif + static void set_qos(struct pkt_file *ppktfile, struct pkt_attrib *pattrib) { struct ethhdr etherhdr; @@ -1132,7 +1199,11 @@ static void set_qos(struct pkt_file *ppktfile, struct pkt_attrib *pattrib) if (pattrib->ether_type == 0x0800) { _rtw_pktfile_read(ppktfile, (u8 *)&ip_hdr, sizeof(ip_hdr)); /* UserPriority = (ntohs(ip_hdr.tos) >> 5) & 0x3; */ +#ifdef CONFIG_USER_PRIORITY_COMPLY_RFC4594_DSCP + UserPriority = dscp_to_up_ac(ip_hdr.tos); +#else UserPriority = ip_hdr.tos >> 5; +#endif } /* else if (pattrib->ether_type == 0x888e) { @@ -1141,6 +1212,15 @@ static void set_qos(struct pkt_file *ppktfile, struct pkt_attrib *pattrib) UserPriority = 7; } */ + + #ifdef CONFIG_ICMP_VOQ + if(pattrib->icmp_pkt==1)/*use VO queue to send icmp packet*/ + UserPriority = 7; + #endif + #ifdef CONFIG_IP_R_MONITOR + if (pattrib->ether_type == ETH_P_ARP) + UserPriority = 7; + #endif/*CONFIG_IP_R_MONITOR*/ pattrib->priority = UserPriority; pattrib->hdrlen = WLAN_HDR_A3_QOS_LEN; pattrib->subtype = WIFI_QOS_DATA_TYPE; @@ -1196,12 +1276,14 @@ 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 */ pattrib->pkt_hdrlen = ETH_HLEN; + pattrib->qos_en = psta->qos_option; + /* [TDLS] TODO: setup req/rsp should be AC_BK */ if (pqospriv->qos_option && psta->qos_option) { pattrib->priority = 4; /* tdls management frame should be AC_VI */ @@ -1229,18 +1311,49 @@ s32 update_tdls_attrib(_adapter *padapter, struct pkt_attrib *pattrib) #endif /* CONFIG_TDLS */ -/*get non-qos hw_ssn control register,mapping to REG_HW_SEQ0,1,2,3*/ +/*get non-qos hw_ssn control register,mapping to REG_HW_SEQ 0,1,2,3*/ inline u8 rtw_get_hwseq_no(_adapter *padapter) { u8 hwseq_num = 0; + #ifdef CONFIG_CONCURRENT_MODE - if (padapter->adapter_type != PRIMARY_ADAPTER) + #if defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822C) + hwseq_num = padapter->iface_id; + if (hwseq_num > 3) + hwseq_num = 3; + #else + if (!is_primary_adapter(padapter)) hwseq_num = 1; - /* else */ - /* hwseq_num = 2; */ + #endif #endif /* CONFIG_CONCURRENT_MODE */ return hwseq_num; } +#ifdef CONFIG_LPS +#define LPS_PT_NORMAL 0 +#define LPS_PT_SP 1/* only DHCP packets is as SPECIAL_PACKET*/ +#define LPS_PT_ICMP 2 + +/*If EAPOL , ARP , OR DHCP packet, driver must be in active mode.*/ +static u8 _rtw_lps_chk_packet_type(struct pkt_attrib *pattrib) +{ + u8 pkt_type = LPS_PT_NORMAL; /*normal data frame*/ + + #ifdef CONFIG_WAPI_SUPPORT + if ((pattrib->ether_type == 0x88B4) || (pattrib->ether_type == 0x0806) || (pattrib->ether_type == 0x888e) || (pattrib->dhcp_pkt == 1)) + pkt_type = LPS_PT_SP; + #else /* !CONFIG_WAPI_SUPPORT */ + + #ifndef CONFIG_LPS_NOT_LEAVE_FOR_ICMP + if (pattrib->icmp_pkt == 1) + pkt_type = LPS_PT_ICMP; + else + #endif + if (pattrib->dhcp_pkt == 1) + pkt_type = LPS_PT_SP; + #endif + return pkt_type; +} +#endif static s32 update_attrib(_adapter *padapter, _pkt *pkt, struct pkt_attrib *pattrib) { uint i; @@ -1250,12 +1363,13 @@ static s32 update_attrib(_adapter *padapter, _pkt *pkt, struct pkt_attrib *pattr sint bmcast; struct sta_priv *pstapriv = &padapter->stapriv; - struct security_priv *psecuritypriv = &padapter->securitypriv; struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct qos_priv *pqospriv = &pmlmepriv->qospriv; struct xmit_priv *pxmitpriv = &padapter->xmitpriv; sint res = _SUCCESS; - +#ifdef CONFIG_LPS + u8 pkt_type = 0; +#endif DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib); @@ -1264,11 +1378,12 @@ static s32 update_attrib(_adapter *padapter, _pkt *pkt, struct pkt_attrib *pattr pattrib->ether_type = ntohs(etherhdr.h_proto); + if (MLME_IS_MESH(padapter)) /* address resolve is done for mesh */ + goto get_sta_info; _rtw_memcpy(pattrib->dst, ðerhdr.h_dest, ETH_ALEN); _rtw_memcpy(pattrib->src, ðerhdr.h_source, ETH_ALEN); - if ((check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE) || (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE)) { _rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); @@ -1290,14 +1405,15 @@ static s32 update_attrib(_adapter *padapter, _pkt *pkt, struct pkt_attrib *pattr } else DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_unknown); +get_sta_info: bmcast = IS_MCAST(pattrib->ra); if (bmcast) { psta = rtw_get_bcmc_stainfo(padapter); if (psta == NULL) { /* if we cannot get psta => drop the pkt */ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_err_sta); -#ifdef DBG_TX_DROP_FRAME + #ifdef DBG_TX_DROP_FRAME RTW_INFO("DBG_TX_DROP_FRAME %s get sta_info fail, ra:" MAC_FMT"\n", __func__, MAC_ARG(pattrib->ra)); -#endif + #endif res = _FAIL; goto exit; } @@ -1305,9 +1421,9 @@ static s32 update_attrib(_adapter *padapter, _pkt *pkt, struct pkt_attrib *pattr psta = rtw_get_stainfo(pstapriv, pattrib->ra); if (psta == NULL) { /* if we cannot get psta => drop the pkt */ DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_err_ucast_sta); -#ifdef DBG_TX_DROP_FRAME + #ifdef DBG_TX_DROP_FRAME RTW_INFO("DBG_TX_DROP_FRAME %s get sta_info fail, ra:" MAC_FMT"\n", __func__, MAC_ARG(pattrib->ra)); -#endif + #endif res = _FAIL; goto exit; } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE && !(psta->state & _FW_LINKED)) { @@ -1319,7 +1435,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; } @@ -1393,29 +1510,34 @@ static s32 update_attrib(_adapter *padapter, _pkt *pkt, struct pkt_attrib *pattr } } else if (0x888e == pattrib->ether_type) - RTW_PRINT("send eapol packet\n"); + parsing_eapol_packet(padapter, pktfile.cur_addr, psta, 1); +#if defined (DBG_ARP_DUMP) || defined (DBG_IP_R_MONITOR) + else if (pattrib->ether_type == ETH_P_ARP) { + u8 arp[28] = {0}; + + _rtw_pktfile_read(&pktfile, arp, 28); + dump_arp_pkt(RTW_DBGDUMP, etherhdr.h_dest, etherhdr.h_source, arp, 1); + } +#endif if ((pattrib->ether_type == 0x888e) || (pattrib->dhcp_pkt == 1)) rtw_mi_set_scan_deny(padapter, 3000); -#ifdef CONFIG_LPS - /* If EAPOL , ARP , OR DHCP packet, driver must be in active mode. */ -#ifdef CONFIG_WAPI_SUPPORT - if ((pattrib->ether_type == 0x88B4) || (pattrib->ether_type == 0x0806) || (pattrib->ether_type == 0x888e) || (pattrib->dhcp_pkt == 1)) -#else /* !CONFIG_WAPI_SUPPORT */ -#if 0 - if ((pattrib->ether_type == 0x0806) || (pattrib->ether_type == 0x888e) || (pattrib->dhcp_pkt == 1)) -#else /* only ICMP/DHCP packets is as SPECIAL_PACKET, and leave LPS when tx IMCP/DHCP packets. */ - /* if ((pattrib->ether_type == 0x888e) || (pattrib->dhcp_pkt == 1) ) */ - if (pattrib->icmp_pkt == 1) - rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE, 1); - else if (pattrib->dhcp_pkt == 1) -#endif -#endif - { - DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_active); - rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_SPECIAL_PACKET, 1); + if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) && + pattrib->ether_type == ETH_P_ARP && + !IS_MCAST(pattrib->dst)) { + rtw_mi_set_scan_deny(padapter, 1000); + rtw_mi_scan_abort(padapter, _FALSE); /*rtw_scan_abort_no_wait*/ } + +#ifdef CONFIG_LPS + pkt_type = _rtw_lps_chk_packet_type(pattrib); + + if (pkt_type == LPS_PT_SP) {/*packet is as SPECIAL_PACKET*/ + DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_active); + rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_SPECIAL_PACKET, 0); + } else if (pkt_type == LPS_PT_ICMP) + rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE, 0); #endif /* CONFIG_LPS */ #ifdef CONFIG_BEAMFORMING @@ -1429,26 +1551,24 @@ static s32 update_attrib(_adapter *padapter, _pkt *pkt, struct pkt_attrib *pattr goto exit; } - update_attrib_phy_info(padapter, pattrib, psta); - - /* RTW_INFO("%s ==> mac_id(%d)\n",__FUNCTION__,pattrib->mac_id ); */ - - pattrib->psta = psta; - /* TODO:_unlock */ - - pattrib->pctrl = 0; - - pattrib->ack_policy = 0; /* get ether_hdr_len */ pattrib->pkt_hdrlen = ETH_HLEN;/* (pattrib->ether_type == 0x8100) ? (14 + 4 ): 14; */ /* vlan tag */ pattrib->hdrlen = WLAN_HDR_A3_LEN; pattrib->subtype = WIFI_DATA_TYPE; + pattrib->qos_en = psta->qos_option; pattrib->priority = 0; - if (check_fwstate(pmlmepriv, WIFI_AP_STATE | WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE)) { - if (pattrib->qos_en) + if (check_fwstate(pmlmepriv, WIFI_AP_STATE | WIFI_MESH_STATE + | WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE) + ) { + if (pattrib->qos_en) { set_qos(&pktfile, pattrib); + #ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(padapter)) + rtw_mesh_tx_set_whdr_mctrl_len(pattrib->mesh_frame_mode, pattrib); + #endif + } } else { #ifdef CONFIG_TDLS if (pattrib->direct_link == _TRUE) { @@ -1465,6 +1585,30 @@ static s32 update_attrib(_adapter *padapter, _pkt *pkt, struct pkt_attrib *pattr } } } + + update_attrib_phy_info(padapter, pattrib, psta); + + /* RTW_INFO("%s ==> mac_id(%d)\n",__FUNCTION__,pattrib->mac_id ); */ + + pattrib->psta = psta; + /* TODO:_unlock */ + +#ifdef CONFIG_AUTO_AP_MODE + if (psta->isrc && psta->pid > 0) + pattrib->pctrl = _TRUE; + else +#endif + pattrib->pctrl = 0; + + pattrib->ack_policy = 0; + + if (bmcast) + pattrib->rate = psta->init_rate; + + +#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; @@ -1482,7 +1626,6 @@ static s32 xmitframe_addmic(_adapter *padapter, struct xmit_frame *pxmitframe) u8 *pframe, *payload, mic[8]; struct mic_data micdata; /* struct sta_info *stainfo; */ - struct qos_priv *pqospriv = &(padapter->mlmepriv.qospriv); struct pkt_attrib *pattrib = &pxmitframe->attrib; struct security_priv *psecuritypriv = &padapter->securitypriv; struct xmit_priv *pxmitpriv = &padapter->xmitpriv; @@ -1566,7 +1709,6 @@ static s32 xmitframe_addmic(_adapter *padapter, struct xmit_frame *pxmitframe) } - /* if(pqospriv->qos_option==1) */ if (pattrib->qos_en) priority[0] = (u8)pxmitframe->attrib.priority; @@ -1727,6 +1869,17 @@ s32 rtw_make_wlanhdr(_adapter *padapter , u8 *hdr, struct pkt_attrib *pattrib) if (pattrib->qos_en) qos_option = _TRUE; +#ifdef CONFIG_RTW_MESH + } else if (check_fwstate(pmlmepriv, WIFI_MESH_STATE) == _TRUE) { + rtw_mesh_tx_build_whdr(padapter, pattrib, fctrl, pwlanhdr); + if (pattrib->qos_en) + qos_option = _TRUE; + else { + RTW_WARN("[%s] !qos_en in Mesh\n", __FUNCTION__); + res = _FAIL; + goto exit; + } +#endif } else { res = _FAIL; goto exit; @@ -1750,6 +1903,18 @@ s32 rtw_make_wlanhdr(_adapter *padapter , u8 *hdr, struct pkt_attrib *pattrib) if(pattrib->amsdu) SetAMsdu(qc, pattrib->amsdu); +#ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(padapter)) { + /* active: don't care, light sleep: 0, deep sleep: 1*/ + set_mps_lv(qc, 0); //TBD + + /* TBD: temporary set (rspi, eosp) = (0, 1) which means End MPSP */ + set_rspi(qc, 0); + SetEOSP(qc, 1); + + set_mctrl_present(qc, 1); + } +#endif } /* TODO: fill HT Control Field */ @@ -1894,37 +2059,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: @@ -1939,6 +2120,7 @@ int rtw_build_tdls_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pf break; } +exit: return res; } @@ -2029,7 +2211,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; @@ -2163,12 +2345,14 @@ 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 */ + + XATTRIB_GET_MCTRL_LEN(pattrib) + + SNAP_SIZE + sizeof(u16) /* LLC */ + + pattrib->pktlen + + (pattrib->encrypt == _TKIP_ ? 8 : 0) /* MIC */ + + (pattrib->bswenc ? pattrib->icv_len : 0) /* ICV */ + ; return len; } @@ -2201,6 +2385,9 @@ s32 check_amsdu(struct xmit_frame *pxmitframe) if (!pattrib->qos_en) ret = _FALSE; + if (IS_AMSDU_AMPDU_NOT_VALID(pattrib)) + ret = _FALSE; + return ret; } @@ -2274,7 +2461,6 @@ s32 rtw_xmitframe_coalesce_amsdu(_adapter *padapter, struct xmit_frame *pxmitfra 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; @@ -2293,9 +2479,8 @@ s32 rtw_xmitframe_coalesce_amsdu(_adapter *padapter, struct xmit_frame *pxmitfra 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))); + RTW_DBG("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; } @@ -2310,16 +2495,28 @@ s32 rtw_xmitframe_coalesce_amsdu(_adapter *padapter, struct xmit_frame *pxmitfra _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; + #ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(padapter)) { + /* mDA(6), mSA(6), len(2), mctrl */ + _rtw_memcpy(pframe, pattrib_queue->mda, ETH_ALEN); + pframe += ETH_ALEN; + _rtw_memcpy(pframe, pattrib_queue->msa, ETH_ALEN); + pframe += ETH_ALEN; + len = (u16*)pframe; + pframe += 2; + rtw_mesh_tx_build_mctrl(padapter, pattrib_queue, pframe); + pframe += XATTRIB_GET_MCTRL_LEN(pattrib_queue); + } else + #endif + { + /* 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; @@ -2327,17 +2524,17 @@ s32 rtw_xmitframe_coalesce_amsdu(_adapter *padapter, struct xmit_frame *pxmitfra mem_sz = _rtw_pktfile_read(&pktfile_queue, pframe, pattrib_queue->pktlen); pframe += mem_sz; - *len = htons(llc_sz + mem_sz); + *len = htons(XATTRIB_GET_MCTRL_LEN(pattrib_queue) + llc_sz + mem_sz); //calc padding - padding = 4 - ((ETH_HLEN + llc_sz + mem_sz) & (4-1)); + padding = 4 - ((ETH_HLEN + XATTRIB_GET_MCTRL_LEN(pattrib_queue) + 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 ; + pattrib->last_txcmdsz += ETH_HLEN + XATTRIB_GET_MCTRL_LEN(pattrib_queue) + llc_sz + mem_sz + padding ; } //2nd mpdu @@ -2346,16 +2543,28 @@ s32 rtw_xmitframe_coalesce_amsdu(_adapter *padapter, struct xmit_frame *pxmitfra _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; +#ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(padapter)) { + /* mDA(6), mSA(6), len(2), mctrl */ + _rtw_memcpy(pframe, pattrib->mda, ETH_ALEN); + pframe += ETH_ALEN; + _rtw_memcpy(pframe, pattrib->msa, ETH_ALEN); + pframe += ETH_ALEN; + len = (u16*)pframe; + pframe += 2; + rtw_mesh_tx_build_mctrl(padapter, pattrib, pframe); + pframe += XATTRIB_GET_MCTRL_LEN(pattrib); + } else +#endif + { + /* 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; @@ -2364,14 +2573,14 @@ s32 rtw_xmitframe_coalesce_amsdu(_adapter *padapter, struct xmit_frame *pxmitfra pframe += mem_sz; - *len = htons(llc_sz + mem_sz); + *len = htons(XATTRIB_GET_MCTRL_LEN(pattrib) + 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->last_txcmdsz += ETH_HLEN + XATTRIB_GET_MCTRL_LEN(pattrib) + llc_sz + mem_sz + padding + ((pattrib->bswenc) ? pattrib->icv_len : 0) ; if ((pattrib->icv_len > 0) && (pattrib->bswenc)) { @@ -2380,7 +2589,6 @@ s32 rtw_xmitframe_coalesce_amsdu(_adapter *padapter, struct xmit_frame *pxmitfra } 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; @@ -2388,7 +2596,7 @@ s32 rtw_xmitframe_coalesce_amsdu(_adapter *padapter, struct xmit_frame *pxmitfra xmitframe_swencrypt(padapter, pxmitframe); - pattrib->vcs_mode = NONE_VCS; + update_attrib_vcs_info(padapter, pxmitframe); exit: return res; @@ -2541,6 +2749,14 @@ s32 rtw_xmitframe_coalesce(_adapter *padapter, _pkt *pkt, struct xmit_frame *pxm } if (frg_inx == 0) { + #ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(padapter)) { + rtw_mesh_tx_build_mctrl(padapter, pattrib, pframe); + pframe += XATTRIB_GET_MCTRL_LEN(pattrib); + mpdu_len -= XATTRIB_GET_MCTRL_LEN(pattrib); + } + #endif + llc_sz = rtw_put_snap(pframe, pattrib->ether_type); pframe += llc_sz; mpdu_len -= llc_sz; @@ -2568,7 +2784,8 @@ s32 rtw_xmitframe_coalesce(_adapter *padapter, _pkt *pkt, struct xmit_frame *pxm if (bmcst || (rtw_endofpktfile(&pktfile) == _TRUE)) { pattrib->nr_frags = frg_inx; - pattrib->last_txcmdsz = pattrib->hdrlen + pattrib->iv_len + ((pattrib->nr_frags == 1) ? llc_sz : 0) + + pattrib->last_txcmdsz = pattrib->hdrlen + pattrib->iv_len + + ((pattrib->nr_frags == 1) ? (XATTRIB_GET_MCTRL_LEN(pattrib) + llc_sz) : 0) + ((pattrib->bswenc) ? pattrib->icv_len : 0) + mem_sz; ClearMFrag(mem_start); @@ -2602,15 +2819,23 @@ s32 rtw_xmitframe_coalesce(_adapter *padapter, _pkt *pkt, struct xmit_frame *pxm return res; } -#ifdef CONFIG_IEEE80211W -/* broadcast or multicast management pkt use BIP, unicast management pkt use CCMP encryption */ +#if defined(CONFIG_IEEE80211W) || defined(CONFIG_RTW_MESH) +/* + * CCMP encryption for unicast robust mgmt frame and broadcast group privicy action + * BIP for broadcast robust mgmt frame + */ s32 rtw_mgmt_xmitframe_coalesce(_adapter *padapter, _pkt *pkt, struct xmit_frame *pxmitframe) { +#define DBG_MGMT_XMIT_COALESEC_DUMP 0 +#define DBG_MGMT_XMIT_BIP_DUMP 0 +#define DBG_MGMT_XMIT_ENC_DUMP 0 + struct pkt_file pktfile; s32 frg_inx, frg_len, mpdu_len, llc_sz, mem_sz; SIZE_PTR addr; u8 *pframe, *mem_start = NULL, *tmp_buf = NULL; u8 hw_hdr_offset, subtype ; + u8 category = 0xFF; struct sta_info *psta = NULL; struct xmit_priv *pxmitpriv = &padapter->xmitpriv; struct pkt_attrib *pattrib = &pxmitframe->attrib; @@ -2627,204 +2852,281 @@ s32 rtw_mgmt_xmitframe_coalesce(_adapter *padapter, _pkt *pkt, struct xmit_frame _irqL irqL; u32 ori_len; + union pn48 *pn = NULL; + u8 kid; + + if (pxmitframe->buf_addr == NULL) { + RTW_WARN(FUNC_ADPT_FMT" pxmitframe->buf_addr\n" + , FUNC_ADPT_ARG(padapter)); + return _FAIL; + } + mem_start = pframe = (u8 *)(pxmitframe->buf_addr) + TXDESC_OFFSET; pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; + subtype = get_frame_sub_type(pframe); /* bit(7)~bit(2) */ + + /* check if robust mgmt frame */ + if (subtype != WIFI_DEAUTH && subtype != WIFI_DISASSOC && subtype != WIFI_ACTION) + return _SUCCESS; + if (subtype == WIFI_ACTION) { + category = *(pframe + sizeof(struct rtw_ieee80211_hdr_3addr)); + if (CATEGORY_IS_NON_ROBUST(category)) + return _SUCCESS; + } + if (!bmcst) { + if (pattrib->psta) + psta = pattrib->psta; + else + pattrib->psta = psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); + if (psta == NULL) { + RTW_INFO(FUNC_ADPT_FMT" unicast sta == NULL\n", FUNC_ADPT_ARG(padapter)); + return _FAIL; + } + if (!(psta->flags & WLAN_STA_MFP)) { + /* peer is not MFP capable, no need to encrypt */ + return _SUCCESS; + } + if (psta->bpairwise_key_installed != _TRUE) { + RTW_INFO(FUNC_ADPT_FMT" PTK is not installed\n" + , FUNC_ADPT_ARG(padapter)); + return _FAIL; + } + } ori_len = BIP_AAD_SIZE + pattrib->pktlen; tmp_buf = BIP_AAD = rtw_zmalloc(ori_len); - subtype = get_frame_sub_type(pframe); /* bit(7)~bit(2) */ - if (BIP_AAD == NULL) return _FAIL; _enter_critical_bh(&padapter->security_key_mutex, &irqL); - - /* IGTK key is not install, it may not support 802.11w */ - if (padapter->securitypriv.binstallBIPkey != _TRUE) { - RTW_INFO("no instll BIP key\n"); - goto xmitframe_coalesce_success; - } - /* station mode doesn't need TX BIP, just ready the code */ if (bmcst) { - int frame_body_len; - u8 mic[16]; + if (subtype == WIFI_ACTION && CATEGORY_IS_GROUP_PRIVACY(category)) { + /* broadcast group privacy action frame */ + #if DBG_MGMT_XMIT_COALESEC_DUMP + RTW_INFO(FUNC_ADPT_FMT" broadcast gp action(%u)\n" + , FUNC_ADPT_ARG(padapter), category); + #endif - _rtw_memset(MME, 0, _MME_IE_LENGTH_); - - /* other types doesn't need the BIP */ - 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); - pframe += pattrib->pktlen; - - /* octent 0 and 1 is key index ,BIP keyid is 4 or 5, LSB only need octent 0 */ - MME[0] = padapter->securitypriv.dot11wBIPKeyid; - /* copy packet number */ - _rtw_memcpy(&MME[2], &pmlmeext->mgnt_80211w_IPN, 6); - /* increase the packet number */ - pmlmeext->mgnt_80211w_IPN++; - - /* add MME IE with MIC all zero, MME string doesn't include element id and length */ - pframe = rtw_set_ie(pframe, _MME_IE_ , 16 , MME, &(pattrib->pktlen)); - pattrib->last_txcmdsz = pattrib->pktlen; - /* total frame length - header length */ - frame_body_len = pattrib->pktlen - sizeof(struct rtw_ieee80211_hdr_3addr); - - /* conscruct AAD, copy frame control field */ - _rtw_memcpy(BIP_AAD, &pwlanhdr->frame_ctl, 2); - ClearRetry(BIP_AAD); - ClearPwrMgt(BIP_AAD); - ClearMData(BIP_AAD); - /* conscruct AAD, copy address 1 to address 3 */ - _rtw_memcpy(BIP_AAD + 2, pwlanhdr->addr1, 18); - /* copy management fram body */ - _rtw_memcpy(BIP_AAD + BIP_AAD_SIZE, MGMT_body, frame_body_len); -#if 0 - /* dump total packet include MME with zero MIC */ - { - int i; - printk("Total packet: "); - for (i = 0; i < BIP_AAD_SIZE + frame_body_len; i++) - printk(" %02x ", BIP_AAD[i]); - printk("\n"); - } -#endif - /* calculate mic */ - if (omac1_aes_128(padapter->securitypriv.dot11wBIPKey[padapter->securitypriv.dot11wBIPKeyid].skey - , BIP_AAD, BIP_AAD_SIZE + frame_body_len, mic)) - goto xmitframe_coalesce_fail; - -#if 0 - /* dump calculated mic result */ - { - int i; - printk("Calculated mic result: "); - for (i = 0; i < 16; i++) - printk(" %02x ", mic[i]); - printk("\n"); - } -#endif - /* copy right BIP mic value, total is 128bits, we use the 0~63 bits */ - _rtw_memcpy(pframe - 8, mic, 8); - /*/dump all packet after mic ok - { - int pp; - printk("pattrib->pktlen = %d\n", pattrib->pktlen); - for(pp=0;pp< pattrib->pktlen; pp++) - printk(" %02x ", mem_start[pp]); - printk("\n"); - }*/ - } else { /* unicast mgmt frame TX */ - /* start to encrypt mgmt frame */ - if (subtype == WIFI_DEAUTH || subtype == WIFI_DISASSOC || - subtype == WIFI_REASSOCREQ || subtype == WIFI_ACTION) { if (pattrib->psta) psta = pattrib->psta; else - psta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); - + pattrib->psta = psta = rtw_get_bcmc_stainfo(padapter); if (psta == NULL) { - - RTW_INFO("%s, psta==NUL\n", __func__); + RTW_INFO(FUNC_ADPT_FMT" broadcast sta == NULL\n" + , FUNC_ADPT_ARG(padapter)); + goto xmitframe_coalesce_fail; + } + if (padapter->securitypriv.binstallGrpkey != _TRUE) { + RTW_INFO(FUNC_ADPT_FMT" GTK is not installed\n" + , FUNC_ADPT_ARG(padapter)); goto xmitframe_coalesce_fail; } - if (pxmitframe->buf_addr == NULL) { - RTW_INFO("%s, pxmitframe->buf_addr\n", __func__); - goto xmitframe_coalesce_fail; + pn = &psta->dot11txpn; + kid = padapter->securitypriv.dot118021XGrpKeyid; + } else { + #ifdef CONFIG_IEEE80211W + /* broadcast robust mgmt frame, using BIP */ + int frame_body_len; + u8 mic[16]; + + /* IGTK key is not install ex: mesh MFP without IGTK */ + if (SEC_IS_BIP_KEY_INSTALLED(&padapter->securitypriv) != _TRUE) + goto xmitframe_coalesce_success; + + #if DBG_MGMT_XMIT_COALESEC_DUMP + if (subtype == WIFI_DEAUTH) + RTW_INFO(FUNC_ADPT_FMT" braodcast deauth\n", FUNC_ADPT_ARG(padapter)); + else if (subtype == WIFI_DISASSOC) + RTW_INFO(FUNC_ADPT_FMT" braodcast disassoc\n", FUNC_ADPT_ARG(padapter)); + else if (subtype == WIFI_ACTION) { + RTW_INFO(FUNC_ADPT_FMT" braodcast action(%u)\n" + , FUNC_ADPT_ARG(padapter), category); } + #endif - /* RTW_INFO("%s, action frame category=%d\n", __func__, pframe[WLAN_HDR_A3_LEN]); */ - /* according 802.11-2012 standard, these five types are not robust types */ - if (subtype == WIFI_ACTION && - (pframe[WLAN_HDR_A3_LEN] == RTW_WLAN_CATEGORY_PUBLIC || - pframe[WLAN_HDR_A3_LEN] == RTW_WLAN_CATEGORY_HT || - pframe[WLAN_HDR_A3_LEN] == RTW_WLAN_CATEGORY_UNPROTECTED_WNM || - pframe[WLAN_HDR_A3_LEN] == RTW_WLAN_CATEGORY_SELF_PROTECTED || - pframe[WLAN_HDR_A3_LEN] == RTW_WLAN_CATEGORY_P2P)) - goto xmitframe_coalesce_fail; - /* before encrypt dump the management packet content */ - /*{ - int i; - printk("Management pkt: "); - for(i=0; ipktlen; i++) - printk(" %02x ", pframe[i]); - printk("=======\n"); - }*/ - if (pattrib->encrypt > 0) - _rtw_memcpy(pattrib->dot118021x_UncstKey.skey, psta->dot118021x_UncstKey.skey, 16); + _rtw_memset(MME, 0, _MME_IE_LENGTH_); - /* To use wrong key */ - if (pattrib->key_type == IEEE80211W_WRONG_KEY) { - RTW_INFO("use wrong key\n"); - pattrib->dot118021x_UncstKey.skey[0] = 0xff; - } + MGMT_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); + pframe += pattrib->pktlen; - /* bakeup original management packet */ - _rtw_memcpy(tmp_buf, pframe, pattrib->pktlen); - /* move to data portion */ - pframe += pattrib->hdrlen; + /* octent 0 and 1 is key index ,BIP keyid is 4 or 5, LSB only need octent 0 */ + MME[0] = padapter->securitypriv.dot11wBIPKeyid; + /* increase PN and apply to packet */ + padapter->securitypriv.dot11wBIPtxpn.val++; + RTW_PUT_LE64(&MME[2], padapter->securitypriv.dot11wBIPtxpn.val); - /* 802.11w unicast management packet must be _AES_ */ - pattrib->iv_len = 8; - /* it's MIC of AES */ - pattrib->icv_len = 8; - - switch (pattrib->encrypt) { - case _AES_: - /* set AES IV header */ - AES_IV(pattrib->iv, psta->dot11wtxpn, 0); - break; - default: - goto xmitframe_coalesce_fail; - } - /* insert iv header into management frame */ - _rtw_memcpy(pframe, pattrib->iv, pattrib->iv_len); - pframe += pattrib->iv_len; - /* copy mgmt data portion after CCMP header */ - _rtw_memcpy(pframe, tmp_buf + pattrib->hdrlen, pattrib->pktlen - pattrib->hdrlen); - /* move pframe to end of mgmt pkt */ - pframe += pattrib->pktlen - pattrib->hdrlen; - /* add 8 bytes CCMP IV header to length */ - pattrib->pktlen += pattrib->iv_len; -#if 0 - /* dump management packet include AES IV header */ - { - int i; - printk("Management pkt + IV: "); - /* for(i=0; ipktlen; i++) */ - - printk("@@@@@@@@@@@@@\n"); - } -#endif - - if ((pattrib->icv_len > 0) && (pattrib->bswenc)) { - _rtw_memcpy(pframe, pattrib->icv, pattrib->icv_len); - pframe += pattrib->icv_len; - } - /* add 8 bytes MIC */ - pattrib->pktlen += pattrib->icv_len; - /* set final tx command size */ + /* add MME IE with MIC all zero, MME string doesn't include element id and length */ + pframe = rtw_set_ie(pframe, _MME_IE_ , 16 , MME, &(pattrib->pktlen)); pattrib->last_txcmdsz = pattrib->pktlen; + /* total frame length - header length */ + frame_body_len = pattrib->pktlen - sizeof(struct rtw_ieee80211_hdr_3addr); - /* set protected bit must be beofre SW encrypt */ - SetPrivacy(mem_start); -#if 0 - /* dump management packet include AES header */ + /* conscruct AAD, copy frame control field */ + _rtw_memcpy(BIP_AAD, &pwlanhdr->frame_ctl, 2); + ClearRetry(BIP_AAD); + ClearPwrMgt(BIP_AAD); + ClearMData(BIP_AAD); + /* conscruct AAD, copy address 1 to address 3 */ + _rtw_memcpy(BIP_AAD + 2, pwlanhdr->addr1, 18); + /* copy management fram body */ + _rtw_memcpy(BIP_AAD + BIP_AAD_SIZE, MGMT_body, frame_body_len); + + #if DBG_MGMT_XMIT_BIP_DUMP + /* dump total packet include MME with zero MIC */ { int i; - printk("prepare to enc Management pkt + IV: "); - for (i = 0; i < pattrib->pktlen; i++) - printk(" %02x ", mem_start[i]); - printk("@@@@@@@@@@@@@\n"); + printk("Total packet: "); + for (i = 0; i < BIP_AAD_SIZE + frame_body_len; i++) + printk(" %02x ", BIP_AAD[i]); + printk("\n"); } -#endif - /* software encrypt */ - xmitframe_swencrypt(padapter, pxmitframe); + #endif + + /* calculate mic */ + if (omac1_aes_128(padapter->securitypriv.dot11wBIPKey[padapter->securitypriv.dot11wBIPKeyid].skey + , BIP_AAD, BIP_AAD_SIZE + frame_body_len, mic)) + goto xmitframe_coalesce_fail; + + #if DBG_MGMT_XMIT_BIP_DUMP + /* dump calculated mic result */ + { + int i; + printk("Calculated mic result: "); + for (i = 0; i < 16; i++) + printk(" %02x ", mic[i]); + printk("\n"); + } + #endif + + /* copy right BIP mic value, total is 128bits, we use the 0~63 bits */ + _rtw_memcpy(pframe - 8, mic, 8); + + #if DBG_MGMT_XMIT_BIP_DUMP + /*dump all packet after mic ok */ + { + int pp; + printk("pattrib->pktlen = %d\n", pattrib->pktlen); + for(pp=0;pp< pattrib->pktlen; pp++) + printk(" %02x ", mem_start[pp]); + printk("\n"); + } + #endif + + #endif /* CONFIG_IEEE80211W */ + + goto xmitframe_coalesce_success; } } + else { + /* unicast robust mgmt frame */ + #if DBG_MGMT_XMIT_COALESEC_DUMP + if (subtype == WIFI_DEAUTH) { + RTW_INFO(FUNC_ADPT_FMT" unicast deauth to "MAC_FMT"\n" + , FUNC_ADPT_ARG(padapter), MAC_ARG(pattrib->ra)); + } else if (subtype == WIFI_DISASSOC) { + RTW_INFO(FUNC_ADPT_FMT" unicast disassoc to "MAC_FMT"\n" + , FUNC_ADPT_ARG(padapter), MAC_ARG(pattrib->ra)); + } else if (subtype == WIFI_ACTION) { + RTW_INFO(FUNC_ADPT_FMT" unicast action(%u) to "MAC_FMT"\n" + , FUNC_ADPT_ARG(padapter), category, MAC_ARG(pattrib->ra)); + } + #endif + + _rtw_memcpy(pattrib->dot118021x_UncstKey.skey, psta->dot118021x_UncstKey.skey, 16); + + /* To use wrong key */ + if (pattrib->key_type == IEEE80211W_WRONG_KEY) { + RTW_INFO("use wrong key\n"); + pattrib->dot118021x_UncstKey.skey[0] = 0xff; + } + + pn = &psta->dot11txpn; + kid = 0; + } + + #if DBG_MGMT_XMIT_ENC_DUMP + /* before encrypt dump the management packet content */ + { + int i; + printk("Management pkt: "); + for(i=0; ipktlen; i++) + printk(" %02x ", pframe[i]); + printk("=======\n"); + } + #endif + + /* bakeup original management packet */ + _rtw_memcpy(tmp_buf, pframe, pattrib->pktlen); + /* move to data portion */ + pframe += pattrib->hdrlen; + + /* 802.11w encrypted management packet must be _AES_ */ + if (pattrib->key_type != IEEE80211W_NO_KEY) { + pattrib->encrypt = _AES_; + pattrib->bswenc = _TRUE; + } + + pattrib->iv_len = 8; + /* it's MIC of AES */ + pattrib->icv_len = 8; + + switch (pattrib->encrypt) { + case _AES_: + /* set AES IV header */ + AES_IV(pattrib->iv, (*pn), kid); + break; + default: + goto xmitframe_coalesce_fail; + } + + /* insert iv header into management frame */ + _rtw_memcpy(pframe, pattrib->iv, pattrib->iv_len); + pframe += pattrib->iv_len; + /* copy mgmt data portion after CCMP header */ + _rtw_memcpy(pframe, tmp_buf + pattrib->hdrlen, pattrib->pktlen - pattrib->hdrlen); + /* move pframe to end of mgmt pkt */ + pframe += pattrib->pktlen - pattrib->hdrlen; + /* add 8 bytes CCMP IV header to length */ + pattrib->pktlen += pattrib->iv_len; + + #if DBG_MGMT_XMIT_ENC_DUMP + /* dump management packet include AES IV header */ + { + int i; + printk("Management pkt + IV: "); + /* for(i=0; ipktlen; i++) */ + + printk("@@@@@@@@@@@@@\n"); + } + #endif + + if ((pattrib->icv_len > 0) && (pattrib->bswenc)) { + _rtw_memcpy(pframe, pattrib->icv, pattrib->icv_len); + pframe += pattrib->icv_len; + } + /* add 8 bytes MIC */ + pattrib->pktlen += pattrib->icv_len; + /* set final tx command size */ + pattrib->last_txcmdsz = pattrib->pktlen; + + /* set protected bit must be beofre SW encrypt */ + SetPrivacy(mem_start); + + #if DBG_MGMT_XMIT_ENC_DUMP + /* dump management packet include AES header */ + { + int i; + printk("prepare to enc Management pkt + IV: "); + for (i = 0; i < pattrib->pktlen; i++) + printk(" %02x ", mem_start[i]); + printk("@@@@@@@@@@@@@\n"); + } + #endif + + /* software encrypt */ + xmitframe_swencrypt(padapter, pxmitframe); xmitframe_coalesce_success: _exit_critical_bh(&padapter->security_key_mutex, &irqL); @@ -2837,7 +3139,7 @@ s32 rtw_mgmt_xmitframe_coalesce(_adapter *padapter, _pkt *pkt, struct xmit_frame return _FAIL; } -#endif /* CONFIG_IEEE80211W */ +#endif /* defined(CONFIG_IEEE80211W) || defined(CONFIG_RTW_MESH) */ /* Logical Link Control(LLC) SubNetwork Attachment Point(SNAP) header * IEEE LLC/SNAP header contains 8 octets @@ -2938,18 +3240,15 @@ 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 */ + #if defined(CONFIG_CHECK_LEAVE_LPS) && defined(CONFIG_LPS_CHK_BY_TP) + if (adapter_to_pwrctl(padapter)->lps_chk_by_tp) + traffic_check_for_leave_lps_by_tp(padapter, _TRUE, psta); + #endif /* CONFIG_LPS */ } #ifdef CONFIG_CHECK_LEAVE_LPS /* traffic_check_for_leave_lps(padapter, _TRUE); */ -#endif /* CONFIG_LPS */ +#endif /* CONFIG_CHECK_LEAVE_LPS */ } } @@ -2986,9 +3285,6 @@ static struct xmit_buf *__rtw_alloc_cmd_xmitbuf(struct xmit_priv *pxmitpriv, } else RTW_INFO("%s fail, no xmitbuf available !!!\n", __func__); -exit: - - return pxmitbuf; } @@ -3018,7 +3314,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; @@ -3519,10 +3815,6 @@ struct xmit_frame *rtw_get_xframe(struct xmit_priv *pxmitpriv, int *num_frame) 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; @@ -3577,10 +3869,6 @@ struct xmit_frame *rtw_dequeue_xframe(struct xmit_priv *pxmitpriv, struct hw_xmi _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; @@ -3588,7 +3876,7 @@ struct xmit_frame *rtw_dequeue_xframe(struct xmit_priv *pxmitpriv, struct hw_xmi inx[3] = 3; if (pregpriv->wifi_spec == 1) { - int j, tmp, acirp_cnt[4]; + int j; #if 0 if (flags < XMIT_QUEUE_ENTRY) { /* priority exchange according to the completed xmitbuf flags. */ @@ -3695,7 +3983,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 @@ -3751,7 +4039,6 @@ s32 rtw_xmit_classifier(_adapter *padapter, struct xmit_frame *pxmitframe) struct sta_info *psta; struct tx_servq *ptxservq; struct pkt_attrib *pattrib = &pxmitframe->attrib; - struct sta_priv *pstapriv = &padapter->stapriv; struct hw_xmit *phwxmits = padapter->xmitpriv.hwxmits; sint res = _SUCCESS; @@ -3899,7 +4186,6 @@ void rtw_init_hwxmits(struct hw_xmit *phwxmit, sint entry) int rtw_br_client_tx(_adapter *padapter, struct sk_buff **pskb) { struct sk_buff *skb = *pskb; - struct xmit_priv *pxmitpriv = &padapter->xmitpriv; _irqL irqL; /* if(check_fwstate(pmlmepriv, WIFI_STATION_STATE|WIFI_ADHOC_STATE) == _TRUE) */ { @@ -4119,14 +4405,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 - if (pattrib->ether_type == 0x888e) { - qsel = QSLT_MGNT; - RTW_INFO("TX EAPOL by QSLT_MGMT\n"); - } #ifdef CONFIG_MCC_MODE if (MCC_EN(padapter)) { /* Under MCC */ @@ -4134,8 +4412,10 @@ static void do_queue_select(_adapter *padapter, struct pkt_attrib *pattrib) if (padapter->mcc_adapterpriv.role == MCC_ROLE_GO || padapter->mcc_adapterpriv.role == MCC_ROLE_AP) { pattrib->qsel = QSLT_VO; /* AP interface VO queue */ + pattrib->priority = QSLT_VO; } else { pattrib->qsel = QSLT_BE; /* STA interface BE queue */ + pattrib->priority = QSLT_BE; } } else /* Not Under MCC */ @@ -4159,30 +4439,32 @@ static void do_queue_select(_adapter *padapter, struct pkt_attrib *pattrib) #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 24)) s32 rtw_monitor_xmit_entry(struct sk_buff *skb, struct net_device *ndev) { - int ret = 0; - int rtap_len; - int qos_len = 0; - int dot11_hdr_len = 24; - int snap_len = 6; - unsigned char *pdata; u16 frame_ctl; - unsigned char src_mac_addr[6]; - unsigned char dst_mac_addr[6]; - struct rtw_ieee80211_hdr *dot11_hdr; - struct ieee80211_radiotap_header *rtap_hdr; + struct ieee80211_radiotap_header rtap_hdr; _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); + struct pkt_file pktfile; + struct rtw_ieee80211_hdr *pwlanhdr; + struct pkt_attrib *pattrib; + struct xmit_frame *pmgntframe; + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); + unsigned char *pframe; + u8 dummybuf[32]; + int len = skb->len, rtap_len; - if (skb) - rtw_mstat_update(MSTAT_TYPE_SKB, MSTAT_ALLOC_SUCCESS, skb->truesize); + rtw_mstat_update(MSTAT_TYPE_SKB, MSTAT_ALLOC_SUCCESS, skb->truesize); + +#ifndef CONFIG_CUSTOMER_ALIBABA_GENERAL if (unlikely(skb->len < sizeof(struct ieee80211_radiotap_header))) goto fail; - rtap_hdr = (struct ieee80211_radiotap_header *)skb->data; - if (unlikely(rtap_hdr->it_version)) + _rtw_open_pktfile((_pkt *)skb, &pktfile); + _rtw_pktfile_read(&pktfile, (u8 *)(&rtap_hdr), sizeof(struct ieee80211_radiotap_header)); + rtap_len = ieee80211_get_radiotap_len((u8 *)(&rtap_hdr)); + if (unlikely(rtap_hdr.it_version)) goto fail; - rtap_len = ieee80211_get_radiotap_len(skb->data); if (unlikely(skb->len < rtap_len)) goto fail; @@ -4190,173 +4472,188 @@ s32 rtw_monitor_xmit_entry(struct sk_buff *skb, struct net_device *ndev) RTW_INFO("radiotap len (should be 14): %d\n", rtap_len); goto fail; } + _rtw_pktfile_read(&pktfile, dummybuf, rtap_len-sizeof(struct ieee80211_radiotap_header)); + len = len - rtap_len; +#endif + pmgntframe = alloc_mgtxmitframe(pxmitpriv); + if (pmgntframe == NULL) { + rtw_udelay_os(500); + goto fail; + } - /* Skip the ratio tap header */ - skb_pull(skb, rtap_len); + _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); + pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; +// _rtw_memcpy(pframe, (void *)checking, len); + _rtw_pktfile_read(&pktfile, pframe, len); - dot11_hdr = (struct rtw_ieee80211_hdr *)skb->data; - frame_ctl = le16_to_cpu(dot11_hdr->frame_ctl); - /* Check if the QoS bit is set */ + /* Check DATA/MGNT frames */ + pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; + frame_ctl = le16_to_cpu(pwlanhdr->frame_ctl); if ((frame_ctl & RTW_IEEE80211_FCTL_FTYPE) == RTW_IEEE80211_FTYPE_DATA) { - struct xmit_frame *pmgntframe; - struct pkt_attrib *pattrib; - unsigned char *pframe; - struct rtw_ieee80211_hdr *pwlanhdr; - struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); - struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); - u8 *buf = skb->data; - u32 len = skb->len; - u8 category, action; - int type = -1; - - pmgntframe = alloc_mgtxmitframe(pxmitpriv); - if (pmgntframe == NULL) { - rtw_udelay_os(500); - goto fail; - } pattrib = &pmgntframe->attrib; - update_monitor_frame_attrib(padapter, pattrib); - pattrib->retry_ctrl = _FALSE; - - _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); - - pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; - - _rtw_memcpy(pframe, (void *)buf, len); - - pattrib->pktlen = len; - - pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; - if (is_broadcast_mac_addr(pwlanhdr->addr3) || is_broadcast_mac_addr(pwlanhdr->addr1)) pattrib->rate = MGN_24M; - pmlmeext->mgnt_seq = GetSequence(pwlanhdr); - pattrib->seqnum = pmlmeext->mgnt_seq; - pmlmeext->mgnt_seq++; - - pattrib->last_txcmdsz = pattrib->pktlen; - - dump_mgntframe(padapter, pmgntframe); - } else { - struct xmit_frame *pmgntframe; - struct pkt_attrib *pattrib; - unsigned char *pframe; - struct rtw_ieee80211_hdr *pwlanhdr; - struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); - struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); - u8 *buf = skb->data; - u32 len = skb->len; - u8 category, action; - int type = -1; - - pmgntframe = alloc_mgtxmitframe(pxmitpriv); - if (pmgntframe == NULL) - goto fail; pattrib = &pmgntframe->attrib; update_mgntframe_attrib(padapter, pattrib); - pattrib->retry_ctrl = _FALSE; - - _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); - - pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; - - _rtw_memcpy(pframe, (void *)buf, len); - - pattrib->pktlen = len; - - pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; - - pmlmeext->mgnt_seq = GetSequence(pwlanhdr); - pattrib->seqnum = pmlmeext->mgnt_seq; - pmlmeext->mgnt_seq++; - - pattrib->last_txcmdsz = pattrib->pktlen; - - dump_mgntframe(padapter, pmgntframe); } + pattrib->retry_ctrl = _FALSE; + pattrib->pktlen = len; + pmlmeext->mgnt_seq = GetSequence(pwlanhdr); + pattrib->seqnum = pmlmeext->mgnt_seq; + pmlmeext->mgnt_seq++; + pattrib->last_txcmdsz = pattrib->pktlen; + + dump_mgntframe(padapter, pmgntframe); fail: - rtw_skb_free(skb); - return 0; } #endif + /* - * The main transmit(tx) entry + * + * Return _TRUE when frame has been put to queue, otherwise return _FALSE. + */ +static u8 xmit_enqueue(struct _ADAPTER *a, struct xmit_frame *frame) +{ + struct sta_info *sta = NULL; + struct pkt_attrib *attrib = NULL; + _irqL irqL; + _list *head; + u8 ret = _TRUE; + + + attrib = &frame->attrib; + sta = attrib->psta; + if (!sta) + return _FALSE; + + _enter_critical_bh(&sta->tx_queue.lock, &irqL); + + head = get_list_head(&sta->tx_queue); + + if ((rtw_is_list_empty(head) == _TRUE) && (!sta->tx_q_enable)) { + ret = _FALSE; + goto exit; + } + + rtw_list_insert_tail(&frame->list, head); + RTW_INFO(FUNC_ADPT_FMT ": en-queue tx pkt for macid=%d\n", + FUNC_ADPT_ARG(a), sta->cmn.mac_id); + +exit: + _exit_critical_bh(&sta->tx_queue.lock, &irqL); + + return ret; +} + +static void xmit_dequeue(struct sta_info *sta) +{ + struct _ADAPTER *a; + _irqL irqL; + _list *head, *list; + struct xmit_frame *frame; + + + a = sta->padapter; + + _enter_critical_bh(&sta->tx_queue.lock, &irqL); + + head = get_list_head(&sta->tx_queue); + + do { + if (rtw_is_list_empty(head) == _TRUE) + break; + + list = get_next(head); + rtw_list_delete(list); + frame = LIST_CONTAINOR(list, struct xmit_frame, list); + RTW_INFO(FUNC_ADPT_FMT ": de-queue tx frame of macid=%d\n", + FUNC_ADPT_ARG(a), sta->cmn.mac_id); + + rtw_hal_xmit(a, frame); + } while (1); + + _exit_critical_bh(&sta->tx_queue.lock, &irqL); +} + +void rtw_xmit_dequeue_callback(_workitem *work) +{ + struct sta_info *sta; + + + sta = container_of(work, struct sta_info, tx_q_work); + xmit_dequeue(sta); +} + +void rtw_xmit_queue_set(struct sta_info *sta) +{ + _irqL irqL; + + _enter_critical_bh(&sta->tx_queue.lock, &irqL); + + if (sta->tx_q_enable) { + RTW_WARN(FUNC_ADPT_FMT ": duplicated set!\n", + FUNC_ADPT_ARG(sta->padapter)); + goto exit; + } + sta->tx_q_enable = 1; + RTW_INFO(FUNC_ADPT_FMT ": enable queue TX for macid=%d\n", + FUNC_ADPT_ARG(sta->padapter), sta->cmn.mac_id); + +exit: + _exit_critical_bh(&sta->tx_queue.lock, &irqL); +} + +void rtw_xmit_queue_clear(struct sta_info *sta) +{ + _irqL irqL; + + _enter_critical_bh(&sta->tx_queue.lock, &irqL); + + if (!sta->tx_q_enable) { + RTW_WARN(FUNC_ADPT_FMT ": tx queue for macid=%d " + "not be enabled!\n", + FUNC_ADPT_ARG(sta->padapter), sta->cmn.mac_id); + goto exit; + } + + sta->tx_q_enable = 0; + RTW_INFO(FUNC_ADPT_FMT ": disable queue TX for macid=%d\n", + FUNC_ADPT_ARG(sta->padapter), sta->cmn.mac_id); + + _set_workitem(&sta->tx_q_work); + +exit: + _exit_critical_bh(&sta->tx_queue.lock, &irqL); +} + +/* + * The main transmit(tx) entry post handle * * Return * 1 enqueue * 0 success, hardware will handle this xmit frame(packet) * <0 fail */ -s32 rtw_xmit(_adapter *padapter, _pkt **ppkt) +s32 rtw_xmit_posthandle(_adapter *padapter, struct xmit_frame *pxmitframe, _pkt *pkt) { - static u32 start = 0; - static u32 drop_cnt = 0; #ifdef CONFIG_AP_MODE _irqL irqL0; #endif struct xmit_priv *pxmitpriv = &padapter->xmitpriv; - struct xmit_frame *pxmitframe = NULL; -#ifdef CONFIG_BR_EXT - struct mlme_priv *pmlmepriv = &padapter->mlmepriv; - void *br_port = NULL; -#endif /* CONFIG_BR_EXT */ - s32 res; - DBG_COUNTER(padapter->tx_logs.core_tx); - - if (start == 0) - start = rtw_get_current_time(); - - pxmitframe = rtw_alloc_xmitframe(pxmitpriv); - - if (rtw_get_passing_time_ms(start) > 2000) { - if (drop_cnt) - RTW_INFO("DBG_TX_DROP_FRAME %s no more pxmitframe, drop_cnt:%u\n", __FUNCTION__, drop_cnt); - start = rtw_get_current_time(); - drop_cnt = 0; - } - - if (pxmitframe == NULL) { - drop_cnt++; - /*RTW_INFO("%s-"ADPT_FMT" no more xmitframe\n", __func__, ADPT_ARG(padapter));*/ - DBG_COUNTER(padapter->tx_logs.core_tx_err_pxmitframe); - return -1; - } - -#ifdef CONFIG_BR_EXT - -#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 (br_port && check_fwstate(pmlmepriv, WIFI_STATION_STATE | WIFI_ADHOC_STATE) == _TRUE) { - res = rtw_br_client_tx(padapter, ppkt); - if (res == -1) { - rtw_free_xmitframe(pxmitpriv, pxmitframe); - DBG_COUNTER(padapter->tx_logs.core_tx_err_brtx); - return -1; - } - } - -#endif /* CONFIG_BR_EXT */ - - res = update_attrib(padapter, *ppkt, &pxmitframe->attrib); + res = update_attrib(padapter, pkt, &pxmitframe->attrib); #ifdef CONFIG_MCC_MODE /* record data kernel TX to driver to check MCC concurrent TX */ @@ -4379,9 +4676,9 @@ s32 rtw_xmit(_adapter *padapter, _pkt **ppkt) rtw_free_xmitframe(pxmitpriv, pxmitframe); return -1; } - pxmitframe->pkt = *ppkt; + pxmitframe->pkt = pkt; - rtw_led_control(padapter, LED_CTL_TX); + rtw_led_tx_control(padapter, pxmitframe->attrib.dst); do_queue_select(padapter, &pxmitframe->attrib); @@ -4395,6 +4692,9 @@ s32 rtw_xmit(_adapter *padapter, _pkt **ppkt) _exit_critical_bh(&pxmitpriv->lock, &irqL0); #endif + if (xmit_enqueue(padapter, pxmitframe) == _TRUE) + return 1; + /* pre_xmitframe */ if (rtw_hal_xmit(padapter, pxmitframe) == _FALSE) return 1; @@ -4402,6 +4702,118 @@ s32 rtw_xmit(_adapter *padapter, _pkt **ppkt) return 0; } +/* + * The main transmit(tx) entry + * + * Return + * 1 enqueue + * 0 success, hardware will handle this xmit frame(packet) + * <0 fail + */ +s32 rtw_xmit(_adapter *padapter, _pkt **ppkt) +{ + static systime start = 0; + static u32 drop_cnt = 0; + struct xmit_priv *pxmitpriv = &padapter->xmitpriv; + struct xmit_frame *pxmitframe = NULL; + s32 res; + + DBG_COUNTER(padapter->tx_logs.core_tx); + + if (IS_CH_WAITING(adapter_to_rfctl(padapter))) + return -1; + + if (rtw_linked_check(padapter) == _FALSE) + return -1; + + if (start == 0) + start = rtw_get_current_time(); + + pxmitframe = rtw_alloc_xmitframe(pxmitpriv); + + if (rtw_get_passing_time_ms(start) > 2000) { + if (drop_cnt) + RTW_INFO("DBG_TX_DROP_FRAME %s no more pxmitframe, drop_cnt:%u\n", __FUNCTION__, drop_cnt); + start = rtw_get_current_time(); + drop_cnt = 0; + } + + if (pxmitframe == NULL) { + drop_cnt++; + /*RTW_INFO("%s-"ADPT_FMT" no more xmitframe\n", __func__, ADPT_ARG(padapter));*/ + DBG_COUNTER(padapter->tx_logs.core_tx_err_pxmitframe); + return -1; + } + +#ifdef CONFIG_BR_EXT + if (check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE | WIFI_ADHOC_STATE) == _TRUE) { + void *br_port = NULL; + + #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) { + res = rtw_br_client_tx(padapter, ppkt); + if (res == -1) { + rtw_free_xmitframe(pxmitpriv, pxmitframe); + DBG_COUNTER(padapter->tx_logs.core_tx_err_brtx); + return -1; + } + } + } +#endif /* CONFIG_BR_EXT */ + +#ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(padapter)) { + _list b2u_list; + + res = rtw_mesh_addr_resolve(padapter, pxmitframe, *ppkt, &b2u_list); + if (res == RTW_RA_RESOLVING) + return 1; + if (res == _FAIL) + return -1; + + #if CONFIG_RTW_MESH_DATA_BMC_TO_UC + if (!rtw_is_list_empty(&b2u_list)) { + _list *list = get_next(&b2u_list); + struct xmit_frame *b2uframe; + + while ((rtw_end_of_queue_search(&b2u_list, list)) == _FALSE) { + b2uframe = LIST_CONTAINOR(list, struct xmit_frame, list); + list = get_next(list); + rtw_list_delete(&b2uframe->list); + + b2uframe->pkt = rtw_os_pkt_copy(*ppkt); + if (!b2uframe->pkt) { + if (res == RTW_BMC_NO_NEED) + res = _SUCCESS; + rtw_free_xmitframe(pxmitpriv, b2uframe); + continue; + } + + rtw_xmit_posthandle(padapter, b2uframe, b2uframe->pkt); + } + } + #endif /* CONFIG_RTW_MESH_DATA_BMC_TO_UC */ + + if (res == RTW_BMC_NO_NEED) { + rtw_free_xmitframe(&padapter->xmitpriv, pxmitframe); + return 0; + } + } +#endif /* CONFIG_RTW_MESH */ + + pxmitframe->pkt = NULL; /* let rtw_xmit_posthandle not to free pkt inside */ + res = rtw_xmit_posthandle(padapter, pxmitframe, *ppkt); + + return res; +} + #ifdef CONFIG_TDLS sint xmitframe_enqueue_for_tdls_sleeping_sta(_adapter *padapter, struct xmit_frame *pxmitframe) { @@ -4459,7 +4871,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; } @@ -4482,32 +4894,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; } @@ -4520,7 +4931,6 @@ sint xmitframe_enqueue_for_sleeping_sta(_adapter *padapter, struct xmit_frame *p struct sta_info *psta = NULL; struct sta_priv *pstapriv = &padapter->stapriv; struct pkt_attrib *pattrib = &pxmitframe->attrib; - struct mlme_priv *pmlmepriv = &padapter->mlmepriv; sint bmcst = IS_MCAST(pattrib->ra); bool update_tim = _FALSE; #ifdef CONFIG_TDLS @@ -4529,7 +4939,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; } @@ -4578,7 +4988,7 @@ sint xmitframe_enqueue_for_sleeping_sta(_adapter *padapter, struct xmit_frame *p if (bmcst) { _enter_critical_bh(&psta->sleep_q.lock, &irqL); - if (pstapriv->sta_dz_bitmap) { /* if anyone sta is in ps mode */ + if (rtw_tim_map_anyone_be_set(padapter, pstapriv->sta_dz_bitmap)) { /* if anyone sta is in ps mode */ /* pattrib->qsel = QSLT_HIGH; */ /* HIQ */ rtw_list_delete(&pxmitframe->list); @@ -4589,13 +4999,14 @@ sint xmitframe_enqueue_for_sleeping_sta(_adapter *padapter, struct xmit_frame *p psta->sleepq_len++; - if (!(pstapriv->tim_bitmap & BIT(0))) + if (!(rtw_tim_map_is_set(padapter, pstapriv->tim_bitmap, 0))) update_tim = _TRUE; - pstapriv->tim_bitmap |= BIT(0); - pstapriv->sta_dz_bitmap |= BIT(0); + rtw_tim_map_set(padapter, pstapriv->tim_bitmap, 0); + rtw_tim_map_set(padapter, pstapriv->sta_dz_bitmap, 0); - /* RTW_INFO("enqueue, sq_len=%d, tim=%x\n", psta->sleepq_len, pstapriv->tim_bitmap); */ + /* RTW_INFO("enqueue, sq_len=%d\n", psta->sleepq_len); */ + /* RTW_INFO_DUMP("enqueue, tim=", pstapriv->tim_bitmap, pstapriv->aid_bmp_len); */ if (update_tim == _TRUE) { if (is_broadcast_mac_addr(pattrib->ra)) _update_beacon(padapter, _TIM_IE_, NULL, _TRUE, "buffer BC"); @@ -4609,7 +5020,6 @@ sint xmitframe_enqueue_for_sleeping_sta(_adapter *padapter, struct xmit_frame *p ret = _TRUE; DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue_mcast); - } _exit_critical_bh(&psta->sleep_q.lock, &irqL); @@ -4624,7 +5034,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 (rtw_tim_map_is_set(padapter, pstapriv->sta_dz_bitmap, psta->cmn.aid)) { rtw_list_delete(&pxmitframe->list); /* _enter_critical_bh(&psta->sleep_q.lock, &irqL); */ @@ -4657,12 +5067,13 @@ 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 (!(rtw_tim_map_is_set(padapter, pstapriv->tim_bitmap, psta->cmn.aid))) update_tim = _TRUE; - pstapriv->tim_bitmap |= BIT(psta->aid); + rtw_tim_map_set(padapter, pstapriv->tim_bitmap, psta->cmn.aid); - /* RTW_INFO("enqueue, sq_len=%d, tim=%x\n", psta->sleepq_len, pstapriv->tim_bitmap); */ + /* RTW_INFO("enqueue, sq_len=%d\n", psta->sleepq_len); */ + /* RTW_INFO_DUMP("enqueue, tim=", pstapriv->tim_bitmap, pstapriv->aid_bmp_len); */ if (update_tim == _TRUE) { /* RTW_INFO("sleepq_len==1, update BCNTIM\n"); */ @@ -4749,22 +5160,14 @@ 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); - - + rtw_tim_map_set(padapter, pstapriv->sta_dz_bitmap, psta->cmn.aid); dequeue_xmitframes_to_sleeping_queue(padapter, psta, &pstaxmitpriv->vo_q.sta_pending); rtw_list_delete(&(pstaxmitpriv->vo_q.tx_pending)); - - dequeue_xmitframes_to_sleeping_queue(padapter, psta, &pstaxmitpriv->vi_q.sta_pending); rtw_list_delete(&(pstaxmitpriv->vi_q.tx_pending)); - - dequeue_xmitframes_to_sleeping_queue(padapter, psta, &pstaxmitpriv->be_q.sta_pending); rtw_list_delete(&(pstaxmitpriv->be_q.tx_pending)); - - dequeue_xmitframes_to_sleeping_queue(padapter, psta, &pstaxmitpriv->bk_q.sta_pending); rtw_list_delete(&(pstaxmitpriv->bk_q.tx_pending)); @@ -4772,12 +5175,16 @@ void stop_sta_xmit(_adapter *padapter, struct sta_info *psta) if (!(psta->tdls_sta_state & TDLS_LINKED_STATE) && (psta_bmc != NULL)) { #endif /* CONFIG_TDLS */ - /* for BC/MC Frames */ pstaxmitpriv = &psta_bmc->sta_xmitpriv; + dequeue_xmitframes_to_sleeping_queue(padapter, psta_bmc, &pstaxmitpriv->vo_q.sta_pending); + rtw_list_delete(&(pstaxmitpriv->vo_q.tx_pending)); + dequeue_xmitframes_to_sleeping_queue(padapter, psta_bmc, &pstaxmitpriv->vi_q.sta_pending); + rtw_list_delete(&(pstaxmitpriv->vi_q.tx_pending)); dequeue_xmitframes_to_sleeping_queue(padapter, psta_bmc, &pstaxmitpriv->be_q.sta_pending); rtw_list_delete(&(pstaxmitpriv->be_q.tx_pending)); - + dequeue_xmitframes_to_sleeping_queue(padapter, psta_bmc, &pstaxmitpriv->bk_q.sta_pending); + rtw_list_delete(&(pstaxmitpriv->bk_q.tx_pending)); #ifdef CONFIG_TDLS } @@ -4876,14 +5283,15 @@ void wakeup_sta_to_xmit(_adapter *padapter, struct sta_info *psta) } #endif /* CONFIG_TDLS */ - if (pstapriv->tim_bitmap & BIT(psta->aid)) { - /* RTW_INFO("wakeup to xmit, qlen==0, update_BCNTIM, tim=%x\n", pstapriv->tim_bitmap); */ + if (rtw_tim_map_is_set(padapter, pstapriv->tim_bitmap, psta->cmn.aid)) { + /* RTW_INFO("wakeup to xmit, qlen==0\n"); */ + /* RTW_INFO_DUMP("update_BCNTIM, tim=", pstapriv->tim_bitmap, pstapriv->aid_bmp_len); */ /* upate BCN for TIM IE */ /* update_BCNTIM(padapter); */ update_mask = BIT(0); } - pstapriv->tim_bitmap &= ~BIT(psta->aid); + rtw_tim_map_clear(padapter, pstapriv->tim_bitmap, psta->cmn.aid); if (psta->state & WIFI_SLEEP_STATE) psta->state ^= WIFI_SLEEP_STATE; @@ -4894,14 +5302,14 @@ 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); + rtw_tim_map_clear(padapter, pstapriv->sta_dz_bitmap, psta->cmn.aid); } /* for BC/MC Frames */ if (!psta_bmc) goto _exit; - if ((pstapriv->sta_dz_bitmap & 0xfffe) == 0x0) { /* no any sta in ps mode */ + if (!(rtw_tim_map_anyone_be_set_exclude_aid0(padapter, pstapriv->sta_dz_bitmap))) { /* no any sta in ps mode */ xmitframe_phead = get_list_head(&psta_bmc->sleep_q); xmitframe_plist = get_next(xmitframe_phead); @@ -4934,14 +5342,15 @@ void wakeup_sta_to_xmit(_adapter *padapter, struct sta_info *psta) } if (psta_bmc->sleepq_len == 0) { - if (pstapriv->tim_bitmap & BIT(0)) { - /* RTW_INFO("wakeup to xmit, qlen==0, update_BCNTIM, tim=%x\n", pstapriv->tim_bitmap); */ + if (rtw_tim_map_is_set(padapter, pstapriv->tim_bitmap, 0)) { + /* RTW_INFO("wakeup to xmit, qlen==0\n"); */ + /* RTW_INFO_DUMP("update_BCNTIM, tim=", pstapriv->tim_bitmap, pstapriv->aid_bmp_len); */ /* upate BCN for TIM IE */ /* update_BCNTIM(padapter); */ update_mask |= BIT(1); } - pstapriv->tim_bitmap &= ~BIT(0); - pstapriv->sta_dz_bitmap &= ~BIT(0); + rtw_tim_map_clear(padapter, pstapriv->tim_bitmap, 0); + rtw_tim_map_clear(padapter, pstapriv->sta_dz_bitmap, 0); } } @@ -5030,9 +5439,10 @@ void xmit_delivery_enabled_frames(_adapter *padapter, struct sta_info *psta) goto exit; } #endif /* CONFIG_TDLS */ - pstapriv->tim_bitmap &= ~BIT(psta->aid); + rtw_tim_map_clear(padapter, pstapriv->tim_bitmap, psta->cmn.aid); - /* RTW_INFO("wakeup to xmit, qlen==0, update_BCNTIM, tim=%x\n", pstapriv->tim_bitmap); */ + /* RTW_INFO("wakeup to xmit, qlen==0\n"); */ + /* RTW_INFO_DUMP("update_BCNTIM, tim=", pstapriv->tim_bitmap, pstapriv->aid_bmp_len); */ /* upate BCN for TIM IE */ /* update_BCNTIM(padapter); */ update_beacon(padapter, _TIM_IE_, NULL, _TRUE); @@ -5041,7 +5451,9 @@ void xmit_delivery_enabled_frames(_adapter *padapter, struct sta_info *psta) } +#ifdef CONFIG_TDLS exit: +#endif /* _exit_critical_bh(&psta->sleep_q.lock, &irqL); */ _exit_critical_bh(&pxmitpriv->lock, &irqL); @@ -5112,60 +5524,6 @@ struct xmit_buf *dequeue_pending_xmitbuf( return pxmitbuf; } -static struct xmit_buf *dequeue_pending_xmitbuf_under_survey( - struct xmit_priv *pxmitpriv) -{ - _irqL irql; - struct xmit_buf *pxmitbuf; -#ifdef CONFIG_USB_HCI - struct xmit_frame *pxmitframe; -#endif - _queue *pqueue; - - - pxmitbuf = NULL; - pqueue = &pxmitpriv->pending_xmitbuf_queue; - - _enter_critical_bh(&pqueue->lock, &irql); - - if (_rtw_queue_empty(pqueue) == _FALSE) { - _list *plist, *phead; - u8 type = 0; - - phead = get_list_head(pqueue); - plist = phead; - do { - plist = get_next(plist); - if (plist == phead) - break; - - pxmitbuf = LIST_CONTAINOR(plist, struct xmit_buf, list); - -#ifdef CONFIG_USB_HCI - pxmitframe = (struct xmit_frame *)pxmitbuf->priv_data; - if (pxmitframe) - 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 = get_frame_sub_type(pxmitbuf->pbuf + TXDESC_OFFSET); -#endif - - if ((type == WIFI_PROBEREQ) || - (type == WIFI_DATA_NULL) || - (type == WIFI_QOS_DATA_NULL)) { - rtw_list_delete(&pxmitbuf->list); - break; - } - pxmitbuf = NULL; - } while (1); - } - - _exit_critical_bh(&pqueue->lock, &irql); - - return pxmitbuf; -} - static struct xmit_buf *dequeue_pending_xmitbuf_ext( struct xmit_priv *pxmitpriv) { @@ -5209,13 +5567,12 @@ struct xmit_buf *select_and_dequeue_pending_xmitbuf(_adapter *padapter) struct xmit_priv *pxmitpriv = &padapter->xmitpriv; struct xmit_buf *pxmitbuf = NULL; - if (rtw_xmit_ac_blocked(padapter) == _TRUE) - pxmitbuf = dequeue_pending_xmitbuf_under_survey(pxmitpriv); - else { - pxmitbuf = dequeue_pending_xmitbuf_ext(pxmitpriv); - if (pxmitbuf == NULL) - pxmitbuf = dequeue_pending_xmitbuf(pxmitpriv); - } + if (_TRUE == rtw_is_xmit_blocked(padapter)) + return pxmitbuf; + + pxmitbuf = dequeue_pending_xmitbuf_ext(pxmitpriv); + if (pxmitbuf == NULL && rtw_xmit_ac_blocked(padapter) != _TRUE) + pxmitbuf = dequeue_pending_xmitbuf(pxmitpriv); return pxmitbuf; } @@ -5243,7 +5600,13 @@ thread_return rtw_xmit_thread(thread_context context) { s32 err; PADAPTER padapter; +#ifdef RTW_XMIT_THREAD_HIGH_PRIORITY +#ifdef PLATFORM_LINUX + struct sched_param param = { .sched_priority = 1 }; + sched_setscheduler(current, SCHED_FIFO, ¶m); +#endif /* PLATFORM_LINUX */ +#endif /* RTW_XMIT_THREAD_HIGH_PRIORITY */ err = _SUCCESS; padapter = (PADAPTER)context; @@ -5255,20 +5618,101 @@ 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); + struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); _adapter *iface; struct mlme_ext_priv *mlmeext; - 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 */ + + if (rfctl->offch_state != OFFCHS_NONE + #ifdef CONFIG_DFS + || IS_RADAR_DETECTED(rfctl) || rfctl->csa_ch + #endif + ) { + blocked = _TRUE; + goto exit; + } for (i = 0; i < dvobj->iface_nums; i++) { iface = dvobj->padapters[i]; @@ -5331,7 +5775,7 @@ void rtw_amsdu_be_timeout_handler(void *FunctionContext) adapter->xmitpriv.amsdu_be_timeout = RTW_AMSDU_TIMER_TIMEOUT; if (printk_ratelimit()) - RTW_INFO("%s Timeout!\n",__FUNCTION__); + RTW_DBG("%s Timeout!\n",__FUNCTION__); tasklet_hi_schedule(&adapter->xmitpriv.xmit_tasklet); } @@ -5433,7 +5877,6 @@ void rtw_amsdu_cancel_timer(_adapter *padapter, u8 priority) { struct xmit_priv *pxmitpriv = &padapter->xmitpriv; _timer* amsdu_timer = NULL; - u8 cancel; switch(priority) { @@ -5455,10 +5898,106 @@ void rtw_amsdu_cancel_timer(_adapter *padapter, u8 priority) amsdu_timer = &pxmitpriv->amsdu_be_timer; break; } - _cancel_timer(amsdu_timer, &cancel); + _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) +{ + 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 + +#ifdef CONFIG_PCI_TX_POLLING +void rtw_tx_poll_init(_adapter *padapter) +{ + struct xmit_priv *pxmitpriv = &padapter->xmitpriv; + + if (!is_primary_adapter(padapter)) + return; + + rtw_init_timer(&(pxmitpriv->tx_poll_timer), padapter, + rtw_tx_poll_timeout_handler, padapter); + rtw_tx_poll_timer_set(padapter, 1); + RTW_INFO("Tx poll timer init!\n"); +} + +void rtw_tx_poll_timeout_handler(void *FunctionContext) +{ + _adapter *adapter = (_adapter *)FunctionContext; + + rtw_tx_poll_timer_set(adapter, 1); + + if (adapter->hal_func.tx_poll_handler) + adapter->hal_func.tx_poll_handler(adapter); + else + RTW_WARN("hal ops: tx_poll_handler is NULL\n"); +} + +void rtw_tx_poll_timer_set(_adapter *padapter, u32 delay) +{ + struct xmit_priv *pxmitpriv = &padapter->xmitpriv; + _timer* timer = NULL; + + timer = &pxmitpriv->tx_poll_timer; + _set_timer(timer, delay); +} + +void rtw_tx_poll_timer_cancel(_adapter *padapter) +{ + struct xmit_priv *pxmitpriv = &padapter->xmitpriv; + _timer* timer = NULL; + + if (!is_primary_adapter(padapter)) + return; + + timer = &pxmitpriv->tx_poll_timer; + _cancel_timer_ex(timer); + RTW_INFO("Tx poll timer cancel !\n"); +} +#endif /* CONFIG_PCI_TX_POLLING */ + void rtw_sctx_init(struct submit_ctx *sctx, int timeout_ms) { sctx->timeout_ms = timeout_ms; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/HalPwrSeqCmd.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/HalPwrSeqCmd.c index de709b106eec..ae95ca814807 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/HalPwrSeqCmd.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/HalPwrSeqCmd.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +50,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 +109,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 +137,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/rtl8188eu/hal/btc/halbtc8192e1ant.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8192e1ant.c deleted file mode 100644 index 88b68716b9dc..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8192e1ant.c +++ /dev/null @@ -1,3418 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ -/* ************************************************************ - * Description: - * - * This file is for RTL8192E 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 (RTL8192E_SUPPORT == 1) -/* ************************************************************ - * Global variables, these are static variables - * ************************************************************ */ -static u8 *trace_buf = &gl_btc_trace_buf[0]; -static struct coex_dm_8192e_1ant glcoex_dm_8192e_1ant; -static struct coex_dm_8192e_1ant *coex_dm = &glcoex_dm_8192e_1ant; -static struct coex_sta_8192e_1ant glcoex_sta_8192e_1ant; -static struct coex_sta_8192e_1ant *coex_sta = &glcoex_sta_8192e_1ant; - -const char *const glbt_info_src_8192e_1ant[] = { - "BT Info[wifi fw]", - "BT Info[bt rsp]", - "BT Info[bt auto report]", -}; - -u32 glcoex_ver_date_8192e_1ant = 20140527; -u32 glcoex_ver_8192e_1ant = 0x4f; - -/* ************************************************************ - * local function proto type if needed - * ************************************************************ - * ************************************************************ - * local function start with halbtc8192e1ant_ - * ************************************************************ */ -u8 halbtc8192e1ant_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_8192E_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_8192E_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_8192E_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 halbtc8192e1ant_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_8192E_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_8192E_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_8192E_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 halbtc8192e1ant_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 halbtc8192e1ant_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 halbtc8192e1ant_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 halbtc8192e1ant_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 halbtc8192e1ant_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 */ - halbtc8192e1ant_update_ra_mask(btcoexist, force_exec, - 0x0); - break; - case 1: /* disable cck 1/2 */ - halbtc8192e1ant_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 */ - halbtc8192e1ant_update_ra_mask(btcoexist, force_exec, - 0x0001f1f7); - break; - default: - break; - } - - halbtc8192e1ant_auto_rate_fallback_retry(btcoexist, force_exec, - arfr_type); - halbtc8192e1ant_retry_limit(btcoexist, force_exec, retry_limit_type); - halbtc8192e1ant_ampdu_max_time(btcoexist, force_exec, ampdu_time_type); -} - -void halbtc8192e1ant_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 halbtc8192e1ant_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 halbtc8192e1ant_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; - - /* 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; - - if ((coex_sta->low_priority_tx >= 1050) && - (!coex_sta->c2h_bt_inquiry_page)) - coex_sta->pop_event_cnt++; - - 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 ((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) { - halbtc8192e1ant_query_bt_info(btcoexist); - num_of_bt_counter_chk = 0; - } - } -} - - -void halbtc8192e1ant_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; - - 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)) { - if ((coex_dm->bt_status == BT_8192E_1ANT_BT_STATUS_ACL_BUSY) || - (coex_dm->bt_status == - BT_8192E_1ANT_BT_STATUS_ACL_SCO_BUSY) || - (coex_dm->bt_status == - BT_8192E_1ANT_BT_STATUS_SCO_BUSY)) { - if (coex_sta->crc_ok_cck > (coex_sta->crc_ok_11g + - coex_sta->crc_ok_11n + - coex_sta->crc_ok_11n_agg)) { - if (cck_lock_counter < 5) - 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 >= 5) - 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; - } - - coex_sta->pre_ccklock = coex_sta->cck_lock; - - -} - -boolean halbtc8192e1ant_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 halbtc8192e1ant_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 halbtc8192e1ant_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_8192E_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_8192E_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_8192E_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_8192E_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_8192E_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_8192E_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_8192E_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_8192E_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_8192E_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_8192E_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_8192E_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_8192E_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_8192E_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_8192E_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_8192E_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_8192E_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_8192E_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_8192E_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_8192E_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_8192E_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_8192E_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_8192E_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_8192E_1ANT_COEX_ALGO_PANEDR_HID; - } - } - } - } - - return algorithm; -} - -void halbtc8192e1ant_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 halbtc8192e1ant_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; - } - halbtc8192e1ant_set_bt_auto_report(btcoexist, - coex_dm->cur_bt_auto_report); - - coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; -} - -void halbtc8192e1ant_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 halbtc8192e1ant_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; - } - halbtc8192e1ant_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 halbtc8192e1ant_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 halbtc8192e1ant_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; - } - halbtc8192e1ant_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 halbtc8192e1ant_coex_table_with_type(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u8 type) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** CoexTable(%d) **********\n", type); - BTC_TRACE(trace_buf); - - coex_sta->coex_table_type = type; - - switch (type) { - case 0: - halbtc8192e1ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x55555555, 0xffffff, 0x3); - break; - case 1: - halbtc8192e1ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); - break; - case 2: - halbtc8192e1ant_coex_table(btcoexist, force_exec, - 0x5a5a5a5a, 0x5a5a5a5a, 0xffffff, 0x3); - break; - case 3: - halbtc8192e1ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); - break; - case 4: - halbtc8192e1ant_coex_table(btcoexist, force_exec, - 0x55555555, 0xaaaa5a5a, 0xffffff, 0x3); - break; - case 5: - halbtc8192e1ant_coex_table(btcoexist, force_exec, - 0x5a5a5a5a, 0xaa5a5a5a, 0xffffff, 0x3); - break; - case 6: - halbtc8192e1ant_coex_table(btcoexist, force_exec, - 0x55555555, 0xaaaaaaaa, 0xffffff, 0x3); - break; - case 7: - halbtc8192e1ant_coex_table(btcoexist, force_exec, - 0xaaaaaaaa, 0xaaaaaaaa, 0xffffff, 0x3); - break; - default: - break; - } -} - -void halbtc8192e1ant_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 halbtc8192e1ant_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; - } - halbtc8192e1ant_set_fw_ignore_wlan_act(btcoexist, enable); - - coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; -} - -void halbtc8192e1ant_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 halbtc8192e1ant_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; - } - halbtc8192e1ant_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 halbtc8192e1ant_sw_mechanism(IN struct btc_coexist *btcoexist, - IN boolean low_penalty_ra) -{ - halbtc8192e1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); -} - -void halbtc8192e1ant_set_ant_path(IN struct btc_coexist *btcoexist, - IN u8 ant_pos_type, IN boolean init_hwcfg, IN boolean wifi_off) -{ - u32 u32tmp = 0; - - if (init_hwcfg) { - btcoexist->btc_write_1byte(btcoexist, 0x944, 0x24); - btcoexist->btc_write_4byte(btcoexist, 0x930, 0x700700); - if (btcoexist->chip_interface == BTC_INTF_USB) - btcoexist->btc_write_4byte(btcoexist, 0x64, 0x30430004); - else - btcoexist->btc_write_4byte(btcoexist, 0x64, 0x30030004); - - /* 0x4c[27][24]='00', Set Antenna to BB */ - u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); - u32tmp &= ~BIT(24); - u32tmp &= ~BIT(27); - btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); - } else if (wifi_off) { - if (btcoexist->chip_interface == BTC_INTF_USB) - btcoexist->btc_write_4byte(btcoexist, 0x64, 0x30430004); - else - btcoexist->btc_write_4byte(btcoexist, 0x64, 0x30030004); - - /* 0x4c[27][24]='11', Set Antenna to BT, 0x64[8:7]=0, 0x64[2]=1 */ - u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); - u32tmp |= BIT(24); - u32tmp |= BIT(27); - btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); - } - - /* ext switch setting */ - switch (ant_pos_type) { - case BTC_ANT_PATH_WIFI: - btcoexist->btc_write_1byte(btcoexist, 0x92c, 0x4); - break; - case BTC_ANT_PATH_BT: - btcoexist->btc_write_1byte(btcoexist, 0x92c, 0x20); - break; - default: - case BTC_ANT_PATH_PTA: - btcoexist->btc_write_1byte(btcoexist, 0x92c, 0x4); - break; - } -} - -void halbtc8192e1ant_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 halbtc8192e1ant_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; - 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; - - 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 (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)) - return; - } - - if (coex_sta->scan_ap_num <= 5) - wifi_duration_adjust = 5; - else 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) { /* 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 */ - } - - if ((type == 3) || (type == 13) || (type == 14)) - ps_tdma_byte4_val = ps_tdma_byte4_val & - 0xbf; /* no dynamic slot for multi-profile */ - - if (bt_link_info->slave_role == true) - ps_tdma_byte4_val = ps_tdma_byte4_val | - 0x1; /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ - - if (turn_on) { - switch (type) { - default: - halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x51, - 0x1a, 0x1a, 0x0, ps_tdma_byte4_val); - break; - case 1: - halbtc8192e1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x3a + - wifi_duration_adjust, 0x03, - ps_tdma_byte3_val, ps_tdma_byte4_val); - break; - case 2: - halbtc8192e1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x2d + - wifi_duration_adjust, 0x03, - ps_tdma_byte3_val, ps_tdma_byte4_val); - break; - case 3: - halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x51, - 0x1d, 0x1d, 0x0, ps_tdma_byte4_val); - break; - case 4: - halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x93, - 0x15, 0x3, 0x14, 0x0); - break; - case 5: - halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x61, - 0x15, 0x3, 0x11, 0x11); - break; - case 6: - halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x61, - 0x20, 0x3, 0x11, 0x11); - break; - case 7: - halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x13, - 0xc, 0x5, 0x0, 0x0); - break; - case 8: - halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x93, - 0x25, 0x3, 0x10, 0x0); - break; - case 9: - halbtc8192e1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x21, 0x3, - ps_tdma_byte3_val, ps_tdma_byte4_val); - break; - case 10: - halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x13, - 0xa, 0xa, 0x0, 0x40); - break; - case 11: - halbtc8192e1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x21, 0x03, - ps_tdma_byte3_val, ps_tdma_byte4_val); - break; - case 12: - halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x51, - 0x0a, 0x0a, 0x0, 0x50); - break; - case 13: - halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x51, - 0x12, 0x12, 0x0, ps_tdma_byte4_val); - break; - case 14: - halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x51, - 0x21, 0x3, 0x10, ps_tdma_byte4_val); - break; - case 15: - halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x13, - 0xa, 0x3, 0x8, 0x0); - break; - case 16: - halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x93, - 0x15, 0x3, 0x10, 0x0); - break; - case 18: - halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x93, - 0x25, 0x3, 0x10, 0x0); - break; - case 20: - halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x61, - 0x3f, 0x03, 0x11, 0x10); - break; - case 21: - halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x61, - 0x25, 0x03, 0x11, 0x11); - break; - case 22: - halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x61, - 0x25, 0x03, 0x11, 0x10); - break; - case 23: - halbtc8192e1ant_set_fw_pstdma(btcoexist, 0xe3, - 0x25, 0x3, 0x31, 0x18); - break; - case 24: - halbtc8192e1ant_set_fw_pstdma(btcoexist, 0xe3, - 0x15, 0x3, 0x31, 0x18); - break; - case 25: - halbtc8192e1ant_set_fw_pstdma(btcoexist, 0xe3, - 0xa, 0x3, 0x31, 0x18); - break; - case 26: - halbtc8192e1ant_set_fw_pstdma(btcoexist, 0xe3, - 0xa, 0x3, 0x31, 0x18); - break; - case 27: - halbtc8192e1ant_set_fw_pstdma(btcoexist, 0xe3, - 0x25, 0x3, 0x31, 0x98); - break; - case 28: - halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x69, - 0x25, 0x3, 0x31, 0x0); - break; - case 29: - halbtc8192e1ant_set_fw_pstdma(btcoexist, 0xab, - 0x1a, 0x1a, 0x1, 0x10); - break; - case 30: - halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x51, - 0x30, 0x3, 0x10, 0x10); - break; - case 31: - halbtc8192e1ant_set_fw_pstdma(btcoexist, 0xd3, - 0x1a, 0x1a, 0, 0x58); - break; - case 32: - halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x61, - 0x35, 0x3, 0x11, 0x11); - break; - case 33: - halbtc8192e1ant_set_fw_pstdma(btcoexist, 0xa3, - 0x25, 0x3, 0x30, 0x90); - break; - case 34: - halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x53, - 0x1a, 0x1a, 0x0, 0x10); - break; - case 35: - halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x63, - 0x1a, 0x1a, 0x0, 0x10); - break; - case 36: - halbtc8192e1ant_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 */ - halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x23, - 0x18, 0x00, 0x10, 0x24); - break; - } - } else { - - /* disable PS tdma */ - switch (type) { - case 8: /* PTA Control */ - halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x8, - 0x0, 0x0, 0x0, 0x0); - halbtc8192e1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_PTA, false, false); - break; - case 0: - default: /* Software control, Antenna at BT side */ - halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x0, - 0x0, 0x0, 0x0, 0x0); - halbtc8192e1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_BT, false, false); - break; - case 9: /* Software control, Antenna at WiFi side */ - halbtc8192e1ant_set_fw_pstdma(btcoexist, 0x0, - 0x0, 0x0, 0x0, 0x0); - halbtc8192e1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_WIFI, false, false); - 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 halbtc8192e1ant_coex_all_off(IN struct btc_coexist *btcoexist) -{ - /* sw all off */ - halbtc8192e1ant_sw_mechanism(btcoexist, false); - - /* hw all off */ - halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -} - -boolean halbtc8192e1ant_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_8192E_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); - /* halbtc8192e1ant_sw_mechanism(btcoexist, false); */ - - common = true; - } else if (wifi_connected && - (BT_8192E_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); - /* halbtc8192e1ant_sw_mechanism(btcoexist, false); */ - - common = true; - } else if (!wifi_connected && - (BT_8192E_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); - /* halbtc8192e1ant_sw_mechanism(btcoexist, false); */ - - common = true; - } else if (wifi_connected && - (BT_8192E_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); - /* halbtc8192e1ant_sw_mechanism(btcoexist, false); */ - - common = true; - } else if (!wifi_connected && - (BT_8192E_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); - /* halbtc8192e1ant_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 halbtc8192e1ant_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; - /*static boolean pre_wifi_busy = false;*/ - - if (BT_8192E_1ANT_WIFI_STATUS_CONNECTED_BUSY == wifi_status) - wifi_busy = true; - else - wifi_busy = false; - - if ((BT_8192E_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN == - wifi_status) || - (BT_8192E_1ANT_WIFI_STATUS_CONNECTED_SCAN == wifi_status) || - (BT_8192E_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) { - halbtc8192e1ant_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; - - halbtc8192e1ant_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_8192E_1ANT_A2DP_BASIC_RATE(bt_info_ext)) && - ((coex_dm->cur_ps_tdma == 1) || - (coex_dm->cur_ps_tdma == 2))) { - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 9); - coex_dm->ps_tdma_du_adj_type = 9; - } else if (coex_dm->cur_ps_tdma == 1) { - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = 2; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 9); - coex_dm->ps_tdma_du_adj_type = 9; - } else if (coex_dm->cur_ps_tdma == 9) { - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = 11; - } - } else if (result == 1) { - if ((BT_INFO_8192E_1ANT_A2DP_BASIC_RATE(bt_info_ext)) && - ((coex_dm->cur_ps_tdma == 1) || - (coex_dm->cur_ps_tdma == 2))) { - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 9); - coex_dm->ps_tdma_du_adj_type = 9; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 9); - coex_dm->ps_tdma_du_adj_type = 9; - } else if (coex_dm->cur_ps_tdma == 9) { - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = 2; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8192e1ant_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; - halbtc8192e1ant_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 */ - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - coex_dm->ps_tdma_du_adj_type); - } - } -} - -void halbtc8192e1ant_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 */ - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 0); - } - } else { /* NO PS state */ - if (new_ps_state) { - /* will enter LPS state, turn off psTdma first */ - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 0); - } else { - /* keep state under NO PS state, do nothing. */ - } - } -} - -void halbtc8192e1ant_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: - halbtc8192e1ant_ps_tdma_check_for_power_save_state( - btcoexist, true); - halbtc8192e1ant_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: - halbtc8192e1ant_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 halbtc8192e1ant_action_wifi_only(IN struct btc_coexist *btcoexist) -{ - halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 9); -} - -void halbtc8192e1ant_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); - halbtc8192e1ant_action_wifi_only(btcoexist); - } - } - 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 { - btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, - NULL); - btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, - NULL); - } - } -} - -/* ********************************************* - * - * Software Coex Mechanism start - * - * ********************************************* */ - -/* SCO only or SCO+PAN(HS) */ - -/* -void halbtc8192e1ant_action_sco(IN struct btc_coexist* btcoexist) -{ - halbtc8192e1ant_sw_mechanism(btcoexist, true); -} - - -void halbtc8192e1ant_action_hid(IN struct btc_coexist* btcoexist) -{ - halbtc8192e1ant_sw_mechanism(btcoexist, true); -} - - -void halbtc8192e1ant_action_a2dp(IN struct btc_coexist* btcoexist) -{ - halbtc8192e1ant_sw_mechanism(btcoexist, false); -} - -void halbtc8192e1ant_action_a2dp_pan_hs(IN struct btc_coexist* btcoexist) -{ - halbtc8192e1ant_sw_mechanism(btcoexist, false); -} - -void halbtc8192e1ant_action_pan_edr(IN struct btc_coexist* btcoexist) -{ - halbtc8192e1ant_sw_mechanism(btcoexist, false); -} - - -void halbtc8192e1ant_action_pan_hs(IN struct btc_coexist* btcoexist) -{ - halbtc8192e1ant_sw_mechanism(btcoexist, false); -} - - -void halbtc8192e1ant_action_pan_edr_a2dp(IN struct btc_coexist* btcoexist) -{ - halbtc8192e1ant_sw_mechanism(btcoexist, false); -} - -void halbtc8192e1ant_action_pan_edr_hid(IN struct btc_coexist* btcoexist) -{ - halbtc8192e1ant_sw_mechanism(btcoexist, true); -} - - -void halbtc8192e1ant_action_hid_a2dp_pan_edr(IN struct btc_coexist* btcoexist) -{ - halbtc8192e1ant_sw_mechanism(btcoexist, true); -} - -void halbtc8192e1ant_action_hid_a2dp(IN struct btc_coexist* btcoexist) -{ - halbtc8192e1ant_sw_mechanism(btcoexist, true); -} - -*/ - -/* ********************************************* - * - * Non-Software Coex Mechanism start - * - * ********************************************* */ -void halbtc8192e1ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) -{ - halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -} - -void halbtc8192e1ant_action_hs(IN struct btc_coexist *btcoexist) -{ - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); - halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -} - -void halbtc8192e1ant_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)) { - halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - - halbtc8192e1ant_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 */ - halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); - - halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } else if ((bt_link_info->pan_exist) || (wifi_busy)) { - halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); - - halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } else { - halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - - halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); - } -} - -void halbtc8192e1ant_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) { - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); - halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); - } else { /* HID */ - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6); - halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); - } -} - -void halbtc8192e1ant_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 = halbtc8192e1ant_bt_rssi_state(2, 28, 0); - - if ((coex_sta->low_priority_rx >= 1000) && - (coex_sta->low_priority_rx != 65535)) - bt_link_info->slave_role = true; - else - bt_link_info->slave_role = false; - - if (bt_link_info->hid_only) { /* HID */ - halbtc8192e1ant_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_8192E_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifi_status) { - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 32); - halbtc8192e1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - coex_dm->auto_tdma_adjust = false; - } else { - halbtc8192e1ant_tdma_duration_adjust_for_acl(btcoexist, - wifi_status); -#if 0 - if (coex_sta->cck_lock) - halbtc8192e1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 3); - else -#endif - halbtc8192e1ant_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) */ - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); - halbtc8192e1ant_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 */ - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); - coex_dm->auto_tdma_adjust = false; - - halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); - } else if ((bt_link_info->pan_only) || (bt_link_info->hid_exist && - bt_link_info->pan_exist)) { /* PAN(OPP,FTP), HID+PAN(OPP,FTP) */ - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); - halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - coex_dm->auto_tdma_adjust = false; - } else { - /* BT no-profile busy (0x9) */ - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); - halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - coex_dm->auto_tdma_adjust = false; - } -} - -void halbtc8192e1ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist) -{ - /* power save state */ - halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - - /* tdma and coex table */ - halbtc8192e1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); - halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -} - -void halbtc8192e1ant_action_wifi_not_connected_scan(IN struct btc_coexist - *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - - halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - - /* tdma and coex table */ - if (BT_8192E_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { - if (bt_link_info->a2dp_exist) { - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 32); - halbtc8192e1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } else if (bt_link_info->a2dp_exist && - bt_link_info->pan_exist) { - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 22); - halbtc8192e1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } else { - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 20); - halbtc8192e1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } - } else if ((BT_8192E_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || - (BT_8192E_1ANT_BT_STATUS_ACL_SCO_BUSY == - coex_dm->bt_status)) { - halbtc8192e1ant_action_bt_sco_hid_only_busy(btcoexist, - BT_8192E_1ANT_WIFI_STATUS_CONNECTED_SCAN); - } else { - /* Bryant Add */ - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - } -} - -void halbtc8192e1ant_action_wifi_not_connected_asso_auth( - IN struct btc_coexist *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - - halbtc8192e1ant_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)) { - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); - halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } else if (bt_link_info->pan_exist) { - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); - halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } else { - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - } -} - -void halbtc8192e1ant_action_wifi_connected_scan(IN struct btc_coexist - *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - - halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - - /* tdma and coex table */ - if (BT_8192E_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { - if (bt_link_info->a2dp_exist) { - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 32); - halbtc8192e1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } else if (bt_link_info->a2dp_exist && - bt_link_info->pan_exist) { - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 22); - halbtc8192e1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } else { - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 20); - halbtc8192e1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } - } else if ((BT_8192E_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || - (BT_8192E_1ANT_BT_STATUS_ACL_SCO_BUSY == - coex_dm->bt_status)) { - halbtc8192e1ant_action_bt_sco_hid_only_busy(btcoexist, - BT_8192E_1ANT_WIFI_STATUS_CONNECTED_SCAN); - } else { - /* Bryant Add */ - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - } -} - -void halbtc8192e1ant_action_wifi_connected_specific_packet( - IN struct btc_coexist *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - - halbtc8192e1ant_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)) { - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); - halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } else if (bt_link_info->pan_exist) { - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); - halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } else { - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - } -} - -void halbtc8192e1ant_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) { - halbtc8192e1ant_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) - halbtc8192e1ant_action_wifi_connected_scan(btcoexist); - else - halbtc8192e1ant_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_8192E_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) - halbtc8192e1ant_power_save_state(btcoexist, - BTC_PS_WIFI_NATIVE, 0x0, 0x0); - else { /* busy */ - if (coex_sta->scan_ap_num >= - BT_8192E_1ANT_WIFI_NOISY_THRESH) /* no force LPS, no PS-TDMA, use pure TDMA */ - halbtc8192e1ant_power_save_state( - btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - else - halbtc8192e1ant_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)) - halbtc8192e1ant_power_save_state(btcoexist, - BTC_PS_WIFI_NATIVE, 0x0, 0x0); - else - halbtc8192e1ant_power_save_state(btcoexist, - BTC_PS_LPS_ON, 0x50, 0x4); - } else - halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - - /* tdma and coex table */ - if (!wifi_busy) { - if (BT_8192E_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { - halbtc8192e1ant_action_wifi_connected_bt_acl_busy( - btcoexist, - BT_8192E_1ANT_WIFI_STATUS_CONNECTED_IDLE); - } else if ((BT_8192E_1ANT_BT_STATUS_SCO_BUSY == - coex_dm->bt_status) || - (BT_8192E_1ANT_BT_STATUS_ACL_SCO_BUSY == - coex_dm->bt_status)) { - halbtc8192e1ant_action_bt_sco_hid_only_busy(btcoexist, - BT_8192E_1ANT_WIFI_STATUS_CONNECTED_IDLE); - } else { - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 8); - - if ((coex_sta->high_priority_tx) + - (coex_sta->high_priority_rx) <= 60) - halbtc8192e1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 2); - else - halbtc8192e1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 7); - } - } else { - if (BT_8192E_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { - halbtc8192e1ant_action_wifi_connected_bt_acl_busy( - btcoexist, - BT_8192E_1ANT_WIFI_STATUS_CONNECTED_BUSY); - } else if ((BT_8192E_1ANT_BT_STATUS_SCO_BUSY == - coex_dm->bt_status) || - (BT_8192E_1ANT_BT_STATUS_ACL_SCO_BUSY == - coex_dm->bt_status)) { - halbtc8192e1ant_action_bt_sco_hid_only_busy(btcoexist, - BT_8192E_1ANT_WIFI_STATUS_CONNECTED_BUSY); - } else { - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 8); - - if ((coex_sta->high_priority_tx) + - (coex_sta->high_priority_rx) <= 60) - halbtc8192e1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 2); - else - halbtc8192e1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 7); - } - } -} - -void halbtc8192e1ant_run_sw_coexist_mechanism(IN struct btc_coexist *btcoexist) -{ - u8 algorithm = 0; - - algorithm = halbtc8192e1ant_action_algorithm(btcoexist); - coex_dm->cur_algorithm = algorithm; - - if (halbtc8192e1ant_is_common_action(btcoexist)) { - - } else { - switch (coex_dm->cur_algorithm) { - case BT_8192E_1ANT_COEX_ALGO_SCO: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = SCO.\n"); - BTC_TRACE(trace_buf); - /* halbtc8192e1ant_action_sco(btcoexist); */ - break; - case BT_8192E_1ANT_COEX_ALGO_HID: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = HID.\n"); - BTC_TRACE(trace_buf); - /* halbtc8192e1ant_action_hid(btcoexist); */ - break; - case BT_8192E_1ANT_COEX_ALGO_A2DP: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = A2DP.\n"); - BTC_TRACE(trace_buf); - /* halbtc8192e1ant_action_a2dp(btcoexist); */ - break; - case BT_8192E_1ANT_COEX_ALGO_A2DP_PANHS: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = A2DP+PAN(HS).\n"); - BTC_TRACE(trace_buf); - /* halbtc8192e1ant_action_a2dp_pan_hs(btcoexist); */ - break; - case BT_8192E_1ANT_COEX_ALGO_PANEDR: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = PAN(EDR).\n"); - BTC_TRACE(trace_buf); - /* halbtc8192e1ant_action_pan_edr(btcoexist); */ - break; - case BT_8192E_1ANT_COEX_ALGO_PANHS: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = HS mode.\n"); - BTC_TRACE(trace_buf); - /* halbtc8192e1ant_action_pan_hs(btcoexist); */ - break; - case BT_8192E_1ANT_COEX_ALGO_PANEDR_A2DP: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = PAN+A2DP.\n"); - BTC_TRACE(trace_buf); - /* halbtc8192e1ant_action_pan_edr_a2dp(btcoexist); */ - break; - case BT_8192E_1ANT_COEX_ALGO_PANEDR_HID: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = PAN(EDR)+HID.\n"); - BTC_TRACE(trace_buf); - /* halbtc8192e1ant_action_pan_edr_hid(btcoexist); */ - break; - case BT_8192E_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); - /* halbtc8192e1ant_action_hid_a2dp_pan_edr(btcoexist); */ - break; - case BT_8192E_1ANT_COEX_ALGO_HID_A2DP: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = HID+A2DP.\n"); - BTC_TRACE(trace_buf); - /* halbtc8192e1ant_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); - /* halbtc8192e1ant_coex_all_off(btcoexist); */ - break; - } - coex_dm->pre_algorithm = coex_dm->cur_algorithm; - } -} - -void halbtc8192e1ant_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; - - 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 ((BT_8192E_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || - (BT_8192E_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || - (BT_8192E_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) { - halbtc8192e1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, - 0, 1); - miracast_plus_bt = true; - } else { - halbtc8192e1ant_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); - halbtc8192e1ant_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); - halbtc8192e1ant_action_bt_inquiry(btcoexist); - } else - halbtc8192e1ant_action_wifi_multi_port(btcoexist); - - return; - } - - 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); - - if (bt_link_info->sco_exist) - halbtc8192e1ant_limited_rx(btcoexist, NORMAL_EXEC, - false, true, 0x5); - else - halbtc8192e1ant_limited_rx(btcoexist, NORMAL_EXEC, - false, true, 0x8); - - halbtc8192e1ant_sw_mechanism(btcoexist, true); - halbtc8192e1ant_run_sw_coexist_mechanism( - btcoexist); /* just print debug message */ - } else { - halbtc8192e1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - - halbtc8192e1ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, - 0x5); - - halbtc8192e1ant_sw_mechanism(btcoexist, false); - halbtc8192e1ant_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); - halbtc8192e1ant_action_bt_inquiry(btcoexist); - return; - } else if (bt_hs_on) { - halbtc8192e1ant_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) - halbtc8192e1ant_action_wifi_not_connected_scan( - btcoexist); - else - halbtc8192e1ant_action_wifi_not_connected_asso_auth( - btcoexist); - } else - halbtc8192e1ant_action_wifi_not_connected(btcoexist); - } else /* wifi LPS/Busy */ - halbtc8192e1ant_action_wifi_connected(btcoexist); -} - -void halbtc8192e1ant_init_coex_dm(IN struct btc_coexist *btcoexist) -{ - /* force to reset coex mechanism */ - - /* sw all off */ - halbtc8192e1ant_sw_mechanism(btcoexist, false); - - /* halbtc8192e1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); */ - halbtc8192e1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); - - coex_sta->pop_event_cnt = 0; -} - -void halbtc8192e1ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean wifi_only) -{ - u16 u16tmp = 0; - u8 u8tmp = 0; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], 1Ant Init HW Config!!\n"); - BTC_TRACE(trace_buf); - - /* antenna sw ctrl to bt */ - halbtc8192e1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, true, false); - - halbtc8192e1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); - - /* antenna switch control parameter */ - btcoexist->btc_write_4byte(btcoexist, 0x858, 0x55555555); - - /* coex parameters */ - btcoexist->btc_write_1byte(btcoexist, 0x778, 0x1); - /* 0x790[5:0]=0x5 */ - u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x790); - u8tmp &= 0xc0; - u8tmp |= 0x5; - btcoexist->btc_write_1byte(btcoexist, 0x790, u8tmp); - - /* enable counter statistics */ - btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); - - /* enable PTA */ - btcoexist->btc_write_1byte(btcoexist, 0x40, 0x20); - /* enable mailbox interface */ - u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x40); - u16tmp |= BIT(9); - btcoexist->btc_write_2byte(btcoexist, 0x40, u16tmp); - - /* enable PTA I2C mailbox */ - u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x101); - u8tmp |= BIT(4); - btcoexist->btc_write_1byte(btcoexist, 0x101, u8tmp); - - /* enable bt clock when wifi is disabled. */ - u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x93); - u8tmp |= BIT(0); - btcoexist->btc_write_1byte(btcoexist, 0x93, u8tmp); - /* enable bt clock when suspend. */ - u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x7); - u8tmp |= BIT(0); - btcoexist->btc_write_1byte(btcoexist, 0x7, u8tmp); -} - - -/* -void halbtc8192e1ant_wifi_off_hw_cfg(IN struct btc_coexist* btcoexist) -{ - - -} -*/ - -/* ************************************************************ - * work around function start with wa_halbtc8192e1ant_ - * ************************************************************ - * ************************************************************ - * extern function start with ex_halbtc8192e1ant_ - * ************************************************************ */ -void ex_halbtc8192e1ant_power_on_setting(IN struct btc_coexist *btcoexist) -{ -#if 0 - struct btc_board_info *board_info = &btcoexist->board_info; - u8 u8tmp = 0x0; - u16 u16tmp = 0x0; - - 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; - } 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; - } - - 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); - } -#endif -} - -void ex_halbtc8192e1ant_pre_load_firmware(IN struct btc_coexist *btcoexist) -{ -} - -void ex_halbtc8192e1ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean wifi_only) -{ - halbtc8192e1ant_init_hw_config(btcoexist, wifi_only); - btcoexist->stop_coex_dm = false; -} - -void ex_halbtc8192e1ant_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; - - halbtc8192e1ant_init_coex_dm(btcoexist); - - halbtc8192e1ant_query_bt_info(btcoexist); -} - -void ex_halbtc8192e1ant_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 fw_ver = 0, bt_patch_ver = 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); - } - - 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_%d/ 0x%x/ 0x%x(%d)", - "CoexVer/ FwVer/ PatchVer", - glcoex_ver_date_8192e_1ant, glcoex_ver_8192e_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); - - /* 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->bt_disabled) ? ("disabled") : (( - coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") - : ((BT_8192E_1ANT_BT_STATUS_NON_CONNECTED_IDLE == - coex_dm->bt_status) ? "non-connected idle" : - ((BT_8192E_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) - ? "connected-idle" : "busy")))), - coex_sta->bt_rssi, coex_sta->bt_retry_cnt); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", - "SCO/HID/PAN/A2DP", - bt_link_info->sco_exist, bt_link_info->hid_exist, - bt_link_info->pan_exist, bt_link_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_8192E_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_8192e_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]============"); - 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 (auto:%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); - 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); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ", - "IgnWlanAct", - 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); - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xc04); - u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xd04); - u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x90c); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", - "0xc04/ 0xd04/ 0x90c", - u32tmp[0], u32tmp[1], u32tmp[2]); - 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]); - CL_PRINTF(cli_buf); - - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x92c); - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x930); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", - "0x92c/ 0x930", - (u8tmp[0]), u32tmp[0]); - CL_PRINTF(cli_buf); - - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x40); - u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x4f); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", - "0x40/ 0x4f", - u8tmp[0], u8tmp[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); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0xc50(dig)", - u32tmp[0]); - 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(hp rx[31:16]/tx[15:0])", - 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(lp rx[31:16]/tx[15:0])", - coex_sta->low_priority_rx, coex_sta->low_priority_tx); - CL_PRINTF(cli_buf); -#if (BT_AUTO_REPORT_ONLY_8192E_1ANT == 1) - halbtc8192e1ant_monitor_bt_ctr(btcoexist); -#endif - - btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); -} - -void ex_halbtc8192e1ant_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; - - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8192e1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, false, - true); - } 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; - - halbtc8192e1ant_init_hw_config(btcoexist, false); - halbtc8192e1ant_init_coex_dm(btcoexist); - halbtc8192e1ant_query_bt_info(btcoexist); - } -} - -void ex_halbtc8192e1ant_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_halbtc8192e1ant_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); - - halbtc8192e1ant_ps_tdma(btcoexist, FORCE_EXEC, false, - 8); /* Force antenna setup for no scan result issue */ - 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); - - halbtc8192e1ant_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) { - halbtc8192e1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - halbtc8192e1ant_limited_rx(btcoexist, NORMAL_EXEC, false, - bt_ctrl_agg_buf_size, agg_buf_size); - halbtc8192e1ant_action_wifi_multi_port(btcoexist); - return; - } - - if (coex_sta->c2h_bt_inquiry_page) { - halbtc8192e1ant_action_bt_inquiry(btcoexist); - return; - } else if (bt_hs_on) { - halbtc8192e1ant_action_hs(btcoexist); - return; - } - - if (BTC_SCAN_START == type) { - if (!wifi_connected) /* non-connected scan */ - halbtc8192e1ant_action_wifi_not_connected_scan( - btcoexist); - else /* wifi is connected */ - halbtc8192e1ant_action_wifi_connected_scan(btcoexist); - } else if (BTC_SCAN_FINISH == type) { - if (!wifi_connected) /* non-connected scan */ - halbtc8192e1ant_action_wifi_not_connected(btcoexist); - else - halbtc8192e1ant_action_wifi_connected(btcoexist); - } -} - -void ex_halbtc8192e1ant_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; - 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) { - halbtc8192e1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - halbtc8192e1ant_limited_rx(btcoexist, NORMAL_EXEC, false, - bt_ctrl_agg_buf_size, agg_buf_size); - halbtc8192e1ant_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) { - halbtc8192e1ant_action_bt_inquiry(btcoexist); - return; - } else if (bt_hs_on) { - halbtc8192e1ant_action_hs(btcoexist); - return; - } - - if (BTC_ASSOCIATE_START == type) - halbtc8192e1ant_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 */ - halbtc8192e1ant_action_wifi_not_connected(btcoexist); - else - halbtc8192e1ant_action_wifi_connected(btcoexist); - } -} - -void ex_halbtc8192e1ant_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); - - 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 */ - } - - 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 */ - } - - /* 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_halbtc8192e1ant_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; - u8 agg_buf_size = 5; - - 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) /* 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) { - halbtc8192e1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - halbtc8192e1ant_limited_rx(btcoexist, NORMAL_EXEC, false, - bt_ctrl_agg_buf_size, agg_buf_size); - halbtc8192e1ant_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) { - halbtc8192e1ant_action_bt_inquiry(btcoexist); - return; - } else if (bt_hs_on) { - halbtc8192e1ant_action_hs(btcoexist); - return; - } - - if (BTC_PACKET_DHCP == type || - BTC_PACKET_EAPOL == type || - ((BTC_PACKET_ARP == type) && (coex_sta->wifi_is_high_pri_task))) - halbtc8192e1ant_action_wifi_connected_specific_packet(btcoexist); -} - -void ex_halbtc8192e1ant_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_8192E_1ANT_MAX) - rsp_source = BT_INFO_SRC_8192E_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_8192E_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_page = true; - else - coex_sta->c2h_bt_page = 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]; - - 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 != 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); - } - - /* 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_halbtc8192e1ant_media_status_notify( - btcoexist, BTC_MEDIA_CONNECT); - else - ex_halbtc8192e1ant_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); - halbtc8192e1ant_ignore_wlan_act(btcoexist, - FORCE_EXEC, false); - } - } else { - /* BT already NOT ignore Wlan active, do nothing here. */ - } -#if (BT_AUTO_REPORT_ONLY_8192E_1ANT == 0) - if ((coex_sta->bt_info_ext & BIT(4))) { - /* BT auto report already enabled, do nothing */ - } else - halbtc8192e1ant_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_8192E_1ANT_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_8192E_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 (bt_info & BT_INFO_8192E_1ANT_B_FTP) - coex_sta->pan_exist = true; - else - coex_sta->pan_exist = false; - if (bt_info & BT_INFO_8192E_1ANT_B_A2DP) - coex_sta->a2dp_exist = true; - else - coex_sta->a2dp_exist = false; - if (bt_info & BT_INFO_8192E_1ANT_B_HID) - coex_sta->hid_exist = true; - else - coex_sta->hid_exist = false; - if (bt_info & BT_INFO_8192E_1ANT_B_SCO_ESCO) - coex_sta->sco_exist = true; - else - coex_sta->sco_exist = false; - } - - halbtc8192e1ant_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_8192E_1ANT_B_CONNECTION)) { - coex_dm->bt_status = BT_8192E_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_8192E_1ANT_B_CONNECTION) { /* connection exists but no busy */ - coex_dm->bt_status = BT_8192E_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_8192E_1ANT_B_SCO_ESCO) || - (bt_info & BT_INFO_8192E_1ANT_B_SCO_BUSY)) { - coex_dm->bt_status = BT_8192E_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_8192E_1ANT_B_ACL_BUSY) { - if (BT_8192E_1ANT_BT_STATUS_ACL_BUSY != coex_dm->bt_status) - coex_dm->auto_tdma_adjust = false; - coex_dm->bt_status = BT_8192E_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_8192E_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_8192E_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || - (BT_8192E_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || - (BT_8192E_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); - - halbtc8192e1ant_run_coexist_mechanism(btcoexist); -} - -void ex_halbtc8192e1ant_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); - - halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - halbtc8192e1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); - halbtc8192e1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, false, - true); - - halbtc8192e1ant_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_halbtc8192e1ant_halt_notify(IN struct btc_coexist *btcoexist) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); - BTC_TRACE(trace_buf); - - halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - halbtc8192e1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); - halbtc8192e1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, false, true); - - halbtc8192e1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); - - ex_halbtc8192e1ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); - - btcoexist->stop_coex_dm = true; -} - -void ex_halbtc8192e1ant_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); - - halbtc8192e1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - halbtc8192e1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - halbtc8192e1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, false, - 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; - 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; - halbtc8192e1ant_init_hw_config(btcoexist, false); - halbtc8192e1ant_init_coex_dm(btcoexist); - halbtc8192e1ant_query_bt_info(btcoexist); - } -} - -void ex_halbtc8192e1ant_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); - - halbtc8192e1ant_init_hw_config(btcoexist, 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); */ - halbtc8192e1ant_init_coex_dm(btcoexist); -} - -void ex_halbtc8192e1ant_periodical(IN struct btc_coexist *btcoexist) -{ -#if (BT_AUTO_REPORT_ONLY_8192E_1ANT == 0) - halbtc8192e1ant_query_bt_info(btcoexist); - halbtc8192e1ant_monitor_bt_enable_disable(btcoexist); -#else - halbtc8192e1ant_monitor_bt_ctr(btcoexist); - halbtc8192e1ant_monitor_wifi_ctr(btcoexist); - - if (halbtc8192e1ant_is_wifi_status_changed(btcoexist) || - coex_dm->auto_tdma_adjust) - - halbtc8192e1ant_run_coexist_mechanism(btcoexist); - - coex_sta->specific_pkt_period_cnt++; -#endif -} - - -void ex_halbtc8192e1ant_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_NORMAL: - btcoexist->manual_control = false; - halbtc8192e1ant_init_coex_dm(btcoexist); - break; - case BTC_DBG_SET_COEX_WIFI_ONLY: - btcoexist->manual_control = true; - halbtc8192e1ant_power_save_state(btcoexist, - BTC_PS_WIFI_NATIVE, 0x0, 0x0); - halbtc8192e1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 9); - break; - case BTC_DBG_SET_COEX_BT_ONLY: - /* todo */ - break; - default: - break; - } -} - -#endif /* #if (RTL8192E_SUPPORT == 1) */ - -#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8192e1ant.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8192e1ant.h deleted file mode 100644 index cddf396840da..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8192e1ant.h +++ /dev/null @@ -1,227 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ - -#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) - -#if (RTL8192E_SUPPORT == 1) - -/* ******************************************* - * The following is for 8192E 1ANT BT Co-exist definition - * ******************************************* */ -#define BT_AUTO_REPORT_ONLY_8192E_1ANT 1 - -#define BT_INFO_8192E_1ANT_B_FTP BIT(7) -#define BT_INFO_8192E_1ANT_B_A2DP BIT(6) -#define BT_INFO_8192E_1ANT_B_HID BIT(5) -#define BT_INFO_8192E_1ANT_B_SCO_BUSY BIT(4) -#define BT_INFO_8192E_1ANT_B_ACL_BUSY BIT(3) -#define BT_INFO_8192E_1ANT_B_INQ_PAGE BIT(2) -#define BT_INFO_8192E_1ANT_B_SCO_ESCO BIT(1) -#define BT_INFO_8192E_1ANT_B_CONNECTION BIT(0) - -#define BT_INFO_8192E_1ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ - (((_BT_INFO_EXT_&BIT(0))) ? true : false) - -#define BTC_RSSI_COEX_THRESH_TOL_8192E_1ANT 2 - -#define BT_8192E_1ANT_WIFI_NOISY_THRESH 30 /* max: 255 */ - -enum bt_info_src_8192e_1ant { - BT_INFO_SRC_8192E_1ANT_WIFI_FW = 0x0, - BT_INFO_SRC_8192E_1ANT_BT_RSP = 0x1, - BT_INFO_SRC_8192E_1ANT_BT_ACTIVE_SEND = 0x2, - BT_INFO_SRC_8192E_1ANT_MAX -}; - -enum bt_8192e_1ant_bt_status { - BT_8192E_1ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, - BT_8192E_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, - BT_8192E_1ANT_BT_STATUS_INQ_PAGE = 0x2, - BT_8192E_1ANT_BT_STATUS_ACL_BUSY = 0x3, - BT_8192E_1ANT_BT_STATUS_SCO_BUSY = 0x4, - BT_8192E_1ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, - BT_8192E_1ANT_BT_STATUS_MAX -}; - -enum bt_8192e_1ant_wifi_status { - BT_8192E_1ANT_WIFI_STATUS_NON_CONNECTED_IDLE = 0x0, - BT_8192E_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN = 0x1, - BT_8192E_1ANT_WIFI_STATUS_CONNECTED_SCAN = 0x2, - BT_8192E_1ANT_WIFI_STATUS_CONNECTED_SPECIFIC_PKT = 0x3, - BT_8192E_1ANT_WIFI_STATUS_CONNECTED_IDLE = 0x4, - BT_8192E_1ANT_WIFI_STATUS_CONNECTED_BUSY = 0x5, - BT_8192E_1ANT_WIFI_STATUS_MAX -}; - -enum bt_8192e_1ant_coex_algo { - BT_8192E_1ANT_COEX_ALGO_UNDEFINED = 0x0, - BT_8192E_1ANT_COEX_ALGO_SCO = 0x1, - BT_8192E_1ANT_COEX_ALGO_HID = 0x2, - BT_8192E_1ANT_COEX_ALGO_A2DP = 0x3, - BT_8192E_1ANT_COEX_ALGO_A2DP_PANHS = 0x4, - BT_8192E_1ANT_COEX_ALGO_PANEDR = 0x5, - BT_8192E_1ANT_COEX_ALGO_PANHS = 0x6, - BT_8192E_1ANT_COEX_ALGO_PANEDR_A2DP = 0x7, - BT_8192E_1ANT_COEX_ALGO_PANEDR_HID = 0x8, - BT_8192E_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, - BT_8192E_1ANT_COEX_ALGO_HID_A2DP = 0xa, - BT_8192E_1ANT_COEX_ALGO_MAX = 0xb, -}; - -struct coex_dm_8192e_1ant { - /* 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; - boolean limited_dig; - - 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 pre_algorithm; - u8 cur_algorithm; - 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_8192e_1ant { - 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 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; - u8 pre_bt_rssi_state; - u8 pre_wifi_rssi_state[4]; - boolean c2h_bt_info_req_sent; - u8 bt_info_c2h[BT_INFO_SRC_8192E_1ANT_MAX][10]; - u32 bt_info_c2h_cnt[BT_INFO_SRC_8192E_1ANT_MAX]; - 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; - 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; - u8 coex_table_type; - - boolean force_lps_on; -}; - -/* ******************************************* - * The following is interface which will notify coex module. - * ******************************************* */ -void ex_halbtc8192e1ant_power_on_setting(IN struct btc_coexist *btcoexist); -void ex_halbtc8192e1ant_pre_load_firmware(IN struct btc_coexist *btcoexist); -void ex_halbtc8192e1ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean wifi_only); -void ex_halbtc8192e1ant_init_coex_dm(IN struct btc_coexist *btcoexist); -void ex_halbtc8192e1ant_ips_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8192e1ant_lps_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8192e1ant_scan_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8192e1ant_connect_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8192e1ant_media_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8192e1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8192e1ant_bt_info_notify(IN struct btc_coexist *btcoexist, - IN u8 *tmp_buf, IN u8 length); -void ex_halbtc8192e1ant_rf_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8192e1ant_halt_notify(IN struct btc_coexist *btcoexist); -void ex_halbtc8192e1ant_pnp_notify(IN struct btc_coexist *btcoexist, - IN u8 pnp_state); -void ex_halbtc8192e1ant_coex_dm_reset(IN struct btc_coexist *btcoexist); -void ex_halbtc8192e1ant_periodical(IN struct btc_coexist *btcoexist); -void ex_halbtc8192e1ant_display_coex_info(IN struct btc_coexist *btcoexist); -void ex_halbtc8192e1ant_dbg_control(IN struct btc_coexist *btcoexist, - IN u8 op_code, IN u8 op_len, IN u8 *pdata); - -#else /* #if (RTL8192E_SUPPORT == 1) */ -#define ex_halbtc8192e1ant_power_on_setting(btcoexist) -#define ex_halbtc8192e1ant_pre_load_firmware(btcoexist) -#define ex_halbtc8192e1ant_init_hw_config(btcoexist, wifi_only) -#define ex_halbtc8192e1ant_init_coex_dm(btcoexist) -#define ex_halbtc8192e1ant_ips_notify(btcoexist, type) -#define ex_halbtc8192e1ant_lps_notify(btcoexist, type) -#define ex_halbtc8192e1ant_scan_notify(btcoexist, type) -#define ex_halbtc8192e1ant_connect_notify(btcoexist, type) -#define ex_halbtc8192e1ant_media_status_notify(btcoexist, type) -#define ex_halbtc8192e1ant_specific_packet_notify(btcoexist, type) -#define ex_halbtc8192e1ant_bt_info_notify(btcoexist, tmp_buf, length) -#define ex_halbtc8192e1ant_rf_status_notify(btcoexist, type) -#define ex_halbtc8192e1ant_halt_notify(btcoexist) -#define ex_halbtc8192e1ant_pnp_notify(btcoexist, pnp_state) -#define ex_halbtc8192e1ant_coex_dm_reset(btcoexist) -#define ex_halbtc8192e1ant_periodical(btcoexist) -#define ex_halbtc8192e1ant_display_coex_info(btcoexist) -#define ex_halbtc8192e1ant_dbg_control(btcoexist, op_code, op_len, pdata) - -#endif - -#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8192e2ant.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8192e2ant.c deleted file mode 100644 index 4e80a00858f1..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8192e2ant.c +++ /dev/null @@ -1,4378 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ -/* ************************************************************ - * Description: - * - * This file is for RTL8192E 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 (RTL8192E_SUPPORT == 1) -/* ************************************************************ - * Global variables, these are static variables - * ************************************************************ */ -static u8 *trace_buf = &gl_btc_trace_buf[0]; -static struct coex_dm_8192e_2ant glcoex_dm_8192e_2ant; -static struct coex_dm_8192e_2ant *coex_dm = &glcoex_dm_8192e_2ant; -static struct coex_sta_8192e_2ant glcoex_sta_8192e_2ant; -static struct coex_sta_8192e_2ant *coex_sta = &glcoex_sta_8192e_2ant; - -const char *const glbt_info_src_8192e_2ant[] = { - "BT Info[wifi fw]", - "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_8192e_2ant = 20160818; -u32 glcoex_ver_8192e_2ant = 0x44; -u32 glcoex_ver_btdesired_8192e_2ant = 0x44; -/*1. add coex. log for wifi/BT coex. version*/ -/* ************************************************************ - * local function proto type if needed - * ************************************************************ - * ************************************************************ - * local function start with halbtc8192e2ant_ - * ************************************************************ */ -u8 halbtc8192e2ant_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_8192E_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_8192E_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_8192E_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 halbtc8192e2ant_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_8192E_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_8192E_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_8192E_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 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) -{ - u32 dis_ra_mask = 0x0; - - switch (ra_mask_type) { - case 0: /* normal mode */ - if (ss_type == 2) - dis_ra_mask = 0x0; /* enable 2ss */ - else - dis_ra_mask = 0xfff00000; /* disable 2ss */ - break; - case 1: /* disable cck 1/2 */ - if (ss_type == 2) - dis_ra_mask = 0x00000003; /* enable 2ss */ - else - dis_ra_mask = 0xfff00003; /* disable 2ss */ - break; - case 2: /* disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */ - if (ss_type == 2) - dis_ra_mask = 0x0001f1f7; /* enable 2ss */ - else - dis_ra_mask = 0xfff1f1f7; /* disable 2ss */ - break; - default: - break; - } - - return dis_ra_mask; -} - -void halbtc8192e2ant_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 halbtc8192e2ant_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 halbtc8192e2ant_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 halbtc8192e2ant_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 halbtc8192e2ant_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) -{ - u32 dis_ra_mask = 0x0; - - coex_dm->cur_ra_mask_type = ra_mask_type; - dis_ra_mask = halbtc8192e2ant_decide_ra_mask(btcoexist, - coex_dm->cur_ss_type, ra_mask_type); - halbtc8192e2ant_update_ra_mask(btcoexist, force_exec, dis_ra_mask); - - halbtc8192e2ant_auto_rate_fallback_retry(btcoexist, force_exec, - arfr_type); - halbtc8192e2ant_retry_limit(btcoexist, force_exec, retry_limit_type); - halbtc8192e2ant_ampdu_max_time(btcoexist, force_exec, ampdu_time_type); -} - -void halbtc8192e2ant_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 halbtc8192e2ant_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, 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}; - - 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],Query BT info!!!! H2C 0x61 = 0x1\n"); - BTC_TRACE(trace_buf); -} - -boolean halbtc8192e2ant_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; - 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 = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, - 2, 34, 0); - - if ((BTC_RSSI_STATE_HIGH == wifi_rssi_state) || - (BTC_RSSI_STATE_LOW == wifi_rssi_state)) - return true; - } - - return false; -} - -void halbtc8192e2ant_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 halbtc8192e2ant_action_algorithm(IN struct btc_coexist *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - struct btc_stack_info *stack_info = &btcoexist->stack_info; - boolean bt_hs_on = false; - u8 algorithm = BT_8192E_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_8192E_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_8192E_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_8192E_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_8192E_2ANT_COEX_ALGO_PANHS; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], PAN(EDR) only\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8192E_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_8192E_2ANT_COEX_ALGO_SCO; - } 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_8192E_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_8192E_2ANT_COEX_ALGO_SCO; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCO + PAN(EDR)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8192E_2ANT_COEX_ALGO_SCO_PAN; - } - } - } else { - if (bt_link_info->hid_exist && - bt_link_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_8192E_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_8192E_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_8192E_2ANT_COEX_ALGO_HID; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], HID + PAN(EDR)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8192E_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_8192E_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_8192E_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_8192E_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_8192E_2ANT_COEX_ALGO_SCO; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCO + HID + PAN(EDR)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8192E_2ANT_COEX_ALGO_SCO_PAN; - } - } 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_8192E_2ANT_COEX_ALGO_SCO; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8192E_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_8192E_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_8192E_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_8192E_2ANT_COEX_ALGO_PANEDR_HID; - } - } - } - } - - return algorithm; -} - -void halbtc8192e2ant_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 halbtc8192e2ant_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 halbtc8192e2ant_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 0 /* work around, avoid h2c command fail. */ - if (coex_dm->pre_bt_dec_pwr_lvl == coex_dm->cur_bt_dec_pwr_lvl) - return; -#endif - } - halbtc8192e2ant_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 halbtc8192e2ant_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 halbtc8192e2ant_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; - } - halbtc8192e2ant_set_bt_auto_report(btcoexist, - coex_dm->cur_bt_auto_report); - - coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; -} - -void halbtc8192e2ant_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; - } - - halbtc8192e2ant_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 halbtc8192e2ant_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 halbtc8192e2ant_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; - } - halbtc8192e2ant_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 halbtc8192e2ant_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 halbtc8192e2ant_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; - } - halbtc8192e2ant_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 halbtc8192e2ant_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 halbtc8192e2ant_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) - halbtc8192e2ant_set_dac_swing_reg(btcoexist, sw_dac_swing_lvl); - else - halbtc8192e2ant_set_dac_swing_reg(btcoexist, 0x18); -} - - -void halbtc8192e2ant_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); - halbtc8192e2ant_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 halbtc8192e2ant_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 halbtc8192e2ant_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; - } - halbtc8192e2ant_set_adc_back_off(btcoexist, coex_dm->cur_adc_back_off); - - coex_dm->pre_adc_back_off = coex_dm->cur_adc_back_off; -} - -void halbtc8192e2ant_set_agc_table(IN struct btc_coexist *btcoexist, - IN boolean agc_table_en) -{ - /* =================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, 0x0a1A0001); - btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x091B0001); - btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x081C0001); - btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x071D0001); - btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x061E0001); - btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x051F0001); - } 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); - } -} - -void halbtc8192e2ant_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; - } - halbtc8192e2ant_set_agc_table(btcoexist, agc_table_en); - - coex_dm->pre_agc_table_en = coex_dm->cur_agc_table_en; -} - -void halbtc8192e2ant_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 halbtc8192e2ant_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; - } - halbtc8192e2ant_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 halbtc8192e2ant_coex_table_with_type(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u8 type) -{ - switch (type) { - case 0: - halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x55555555, - 0x5a5a5a5a, 0xffffff, 0x3); - break; - case 1: - halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x5a5a5a5a, - 0x5a5a5a5a, 0xffffff, 0x3); - break; - case 2: - halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x55dd55dd, - 0x5ada5ada, 0xffffff, 0x3); - break; - case 3: - halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x5fdf5fdf, - 0x5fdb5fdb, 0xffffff, 0x3); - break; - case 4: - halbtc8192e2ant_coex_table(btcoexist, force_exec, 0xdfffdfff, - 0x5ffb5ffb, 0xffffff, 0x3); - break; - case 5: - halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x5ddd5ddd, - 0x5fdb5fdb, 0xffffff, 0x3); - break; - case 6: - 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); - 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; - default: - break; - } -} - -void halbtc8192e2ant_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 halbtc8192e2ant_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; - } - halbtc8192e2ant_set_fw_ignore_wlan_act(btcoexist, enable); - - coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; -} - -void halbtc8192e2ant_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 halbtc8192e2ant_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; - } - halbtc8192e2ant_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 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 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"); - real_byte1 &= ~BIT(4); - real_byte1 |= BIT(5); - - real_byte5 |= BIT(5); - real_byte5 &= ~BIT(6); - } - } - - 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 halbtc8192e2ant_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; - } - */ - - halbtc8192e2ant_rf_shrink(btcoexist, NORMAL_EXEC, shrink_rx_lpf); - /* halbtc8192e2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); */ -} - -void halbtc8192e2ant_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) -{ - halbtc8192e2ant_agc_table(btcoexist, NORMAL_EXEC, agc_table_shift); - /* halbtc8192e2ant_adc_back_off(btcoexist, NORMAL_EXEC, adc_back_off); */ - halbtc8192e2ant_dac_swing(btcoexist, NORMAL_EXEC, sw_dac_swing, - dac_swing_lvl); -} - -void halbtc8192e2ant_set_ant_path(IN struct btc_coexist *btcoexist, - IN u8 ant_pos_type, IN boolean init_hwcfg, IN boolean wifi_off) -{ - u32 u32tmp = 0; - - if (init_hwcfg) { - btcoexist->btc_write_1byte(btcoexist, 0x944, 0x24); - btcoexist->btc_write_4byte(btcoexist, 0x930, 0x700700); - if (btcoexist->chip_interface == BTC_INTF_USB) - btcoexist->btc_write_4byte(btcoexist, 0x64, 0x30430004); - else - btcoexist->btc_write_4byte(btcoexist, 0x64, 0x30030004); - - /* 0x4c[27][24]='00', Set Antenna to BB */ - u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); - u32tmp &= ~BIT(24); - u32tmp &= ~BIT(27); - btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); - } else if (wifi_off) { - if (btcoexist->chip_interface == BTC_INTF_USB) - btcoexist->btc_write_4byte(btcoexist, 0x64, 0x30430004); - else - btcoexist->btc_write_4byte(btcoexist, 0x64, 0x30030004); - - /* 0x4c[27][24]='11', Set Antenna to BT, 0x64[8:7]=0, 0x64[2]=1 */ - u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); - u32tmp |= BIT(24); - u32tmp |= BIT(27); - btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); - } - - /* ext switch setting */ - switch (ant_pos_type) { - case BTC_ANT_PATH_WIFI: - btcoexist->btc_write_1byte(btcoexist, 0x92c, 0x4); - break; - case BTC_ANT_PATH_BT: - btcoexist->btc_write_1byte(btcoexist, 0x92c, 0x20); - break; - default: - case BTC_ANT_PATH_PTA: - btcoexist->btc_write_1byte(btcoexist, 0x92c, 0x4); - break; - } -} - -void halbtc8192e2ant_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) { - 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 (turn_on) { - switch (type) { - case 1: - default: /*d1,wb*/ - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x3c, - 0x03, 0x11, 0x10); - break; - case 2: - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x32, - 0x03, 0x11, 0x10); - break; - case 3: - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x28, - 0x03, 0x11, 0x10); - break; - case 4: - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x1e, - 0x03, 0x11, 0x10); - break; - case 5: /*d1,pb,TXpause*/ - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x63, 0x3c, - 0x03, 0x90, 0x10); - break; - case 6: - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x63, 0x32, - 0x03, 0x90, 0x10); - break; - case 7: - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x63, 0x28, - 0x03, 0x90, 0x10); - break; - case 8: - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x63, 0x1e, - 0x03, 0x90, 0x10); - break; - case 9: /*d1,bb*/ - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x3c, - 0x03, 0x31, 0x10); - break; - case 10: - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x32, - 0x03, 0x31, 0x10); - break; - case 11: - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x28, - 0x03, 0x31, 0x10); - break; - case 12: - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x1e, - 0x03, 0x31, 0x10); - break; - case 13: /*d1,bb,TXpause*/ - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x3c, - 0x03, 0x30, 0x10); - break; - case 14: - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x32, - 0x03, 0x30, 0x10); - break; - case 15: - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x28, - 0x03, 0x30, 0x10); - break; - case 16: - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x1e, - 0x03, 0x30, 0x10); - break; - case 17: - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x61, 0x20, - 0x03, 0x10, 0x10); - break; - case 18: - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x5, 0x5, - 0xe1, 0x90); - break; - case 19: - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x25, - 0x25, 0xe1, 0x90); - break; - case 20: - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x25, - 0x25, 0x60, 0x90); - break; - case 21: - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x61, 0x35, - 0x03, 0x11, 0x11); - break; - case 22: /* d1,wb */ - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x14, - 0x03, 0x11, 0x14); - break; - case 23: /* d1,pb,TXpause */ - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x63, 0x14, - 0x03, 0x90, 0x14); - break; - case 24: /* d1,bb */ - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x14, - 0x03, 0x31, 0x14); - break; - case 25: /* d1,bb,TXpause */ - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x14, - 0x03, 0x30, 0x14); - 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 + wifi_duration_adjust, 0x3, 0x10, 0x50); - break; - case 82: - 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); - break; - case 84: - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x51, 0x15, - 0x3, 0x10, 0x50); - break; - case 85: - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x51, 0x3a, - 0x03, 0x10, 0x50); - break; - case 86: - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x51, 0x21, - 0x03, 0x10, 0x50); - break; - case 87: - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x51, 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); - break; - case 1: /* ANT2BT, 0x778=3 */ - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x0, - 0x0, 0x0, 0x8, 0x0); - delay_ms(5); - halbtc8192e2ant_set_ant_path(btcoexist, - BTC_ANT_PATH_BT, 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 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_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. */ - } - } -} - -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 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: - 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; - } -} - - -void halbtc8192e2ant_coex_all_off(IN struct btc_coexist *btcoexist) -{ - /* fw all off */ - 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); - - /* sw all off */ - halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); - halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); - - /* hw all off */ - halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -} - -void halbtc8192e2ant_init_coex_dm(IN struct btc_coexist *btcoexist) -{ - /* force to reset coex mechanism */ - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - 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); - - halbtc8192e2ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); - halbtc8192e2ant_switch_ss_type(btcoexist, FORCE_EXEC, 2); - - halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); - halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -} - -void halbtc8192e2ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) -{ - - - /* 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); - - halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); - halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -} - -boolean halbtc8192e2ant_is_common_action(IN struct btc_coexist *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean common = false, wifi_connected = false, wifi_busy = false; - boolean bt_hs_on = false, low_pwr_disable = 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 (bt_link_info->sco_exist || bt_link_info->hid_exist) - halbtc8192e2ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 0, 0, 0); - else - halbtc8192e2ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - - 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);*/ - 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_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_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); - - 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) { - - 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; - } else { - - if (wifi_busy) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi Connected-Busy + BT Busy!!\n"); - BTC_TRACE(trace_buf); - common = false; - } else { - 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); - 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) -{ - 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) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 13); - coex_dm->ps_tdma_du_adj_type = - 13; - } else if (max_interval == 2) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 14); - coex_dm->ps_tdma_du_adj_type = - 14; - } else if (max_interval == 3) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } - } else { - if (max_interval == 1) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 9); - coex_dm->ps_tdma_du_adj_type = - 9; - } else if (max_interval == 2) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 10); - coex_dm->ps_tdma_du_adj_type = - 10; - } else if (max_interval == 3) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } - } - } else { - if (tx_pause) { - if (max_interval == 1) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 5); - coex_dm->ps_tdma_du_adj_type = - 5; - } else if (max_interval == 2) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 6); - coex_dm->ps_tdma_du_adj_type = - 6; - } else if (max_interval == 3) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } - } else { - if (max_interval == 1) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 1); - coex_dm->ps_tdma_du_adj_type = - 1; - } else if (max_interval == 2) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = - 2; - } else if (max_interval == 3) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else { - halbtc8192e2ant_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; - 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 == 1) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 5); - coex_dm->ps_tdma_du_adj_type = 5; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 6); - coex_dm->ps_tdma_du_adj_type = 6; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 7); - coex_dm->ps_tdma_du_adj_type = 7; - } else if (coex_dm->cur_ps_tdma == 4) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 8); - coex_dm->ps_tdma_du_adj_type = 8; - } - if (coex_dm->cur_ps_tdma == 9) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 13); - coex_dm->ps_tdma_du_adj_type = 13; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 14); - coex_dm->ps_tdma_du_adj_type = 14; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 15); - coex_dm->ps_tdma_du_adj_type = 15; - } else if (coex_dm->cur_ps_tdma == 12) { - halbtc8192e2ant_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) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 6); - coex_dm->ps_tdma_du_adj_type = - 6; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 8); - coex_dm->ps_tdma_du_adj_type = - 8; - } else if (coex_dm->cur_ps_tdma == 13) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 14); - coex_dm->ps_tdma_du_adj_type = - 14; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8192e2ant_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) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 6); - coex_dm->ps_tdma_du_adj_type = - 6; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 5); - coex_dm->ps_tdma_du_adj_type = - 5; - } else if (coex_dm->cur_ps_tdma == 16) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 14); - coex_dm->ps_tdma_du_adj_type = - 14; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 13); - coex_dm->ps_tdma_du_adj_type = - 13; - } - } - } else { - if (coex_dm->cur_ps_tdma == 5) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 1); - coex_dm->ps_tdma_du_adj_type = 1; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 2); - coex_dm->ps_tdma_du_adj_type = 2; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 3); - coex_dm->ps_tdma_du_adj_type = 3; - } else if (coex_dm->cur_ps_tdma == 8) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 4); - coex_dm->ps_tdma_du_adj_type = 4; - } - if (coex_dm->cur_ps_tdma == 13) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 9); - coex_dm->ps_tdma_du_adj_type = 9; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 10); - coex_dm->ps_tdma_du_adj_type = 10; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 11); - coex_dm->ps_tdma_du_adj_type = 11; - } else if (coex_dm->cur_ps_tdma == 16) { - halbtc8192e2ant_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) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = - 2; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 4); - coex_dm->ps_tdma_du_adj_type = - 4; - } else if (coex_dm->cur_ps_tdma == 9) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 10); - coex_dm->ps_tdma_du_adj_type = - 10; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8192e2ant_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) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = - 2; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 1); - coex_dm->ps_tdma_du_adj_type = - 1; - } else if (coex_dm->cur_ps_tdma == 1) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 71); - coex_dm->ps_tdma_du_adj_type = - 71; - } else if (coex_dm->cur_ps_tdma == 12) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 10); - coex_dm->ps_tdma_du_adj_type = - 10; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8192e2ant_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) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 6); - coex_dm->ps_tdma_du_adj_type = 6; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 6); - coex_dm->ps_tdma_du_adj_type = 6; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 7); - coex_dm->ps_tdma_du_adj_type = 7; - } else if (coex_dm->cur_ps_tdma == 4) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 8); - coex_dm->ps_tdma_du_adj_type = 8; - } - if (coex_dm->cur_ps_tdma == 9) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 14); - coex_dm->ps_tdma_du_adj_type = 14; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 14); - coex_dm->ps_tdma_du_adj_type = 14; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 15); - coex_dm->ps_tdma_du_adj_type = 15; - } else if (coex_dm->cur_ps_tdma == 12) { - halbtc8192e2ant_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) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 6); - coex_dm->ps_tdma_du_adj_type = - 6; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 8); - coex_dm->ps_tdma_du_adj_type = - 8; - } else if (coex_dm->cur_ps_tdma == 13) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 14); - coex_dm->ps_tdma_du_adj_type = - 14; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8192e2ant_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) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 6); - coex_dm->ps_tdma_du_adj_type = - 6; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 6); - coex_dm->ps_tdma_du_adj_type = - 6; - } else if (coex_dm->cur_ps_tdma == 16) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 14); - coex_dm->ps_tdma_du_adj_type = - 14; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 14); - coex_dm->ps_tdma_du_adj_type = - 14; - } - } - } else { - if (coex_dm->cur_ps_tdma == 5) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 2); - coex_dm->ps_tdma_du_adj_type = 2; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 2); - coex_dm->ps_tdma_du_adj_type = 2; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 3); - coex_dm->ps_tdma_du_adj_type = 3; - } else if (coex_dm->cur_ps_tdma == 8) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 4); - coex_dm->ps_tdma_du_adj_type = 4; - } - if (coex_dm->cur_ps_tdma == 13) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 10); - coex_dm->ps_tdma_du_adj_type = 10; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 10); - coex_dm->ps_tdma_du_adj_type = 10; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 11); - coex_dm->ps_tdma_du_adj_type = 11; - } else if (coex_dm->cur_ps_tdma == 16) { - halbtc8192e2ant_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) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = - 2; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 4); - coex_dm->ps_tdma_du_adj_type = - 4; - } else if (coex_dm->cur_ps_tdma == 9) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 10); - coex_dm->ps_tdma_du_adj_type = - 10; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8192e2ant_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) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = - 2; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = - 2; - } else if (coex_dm->cur_ps_tdma == 12) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 10); - coex_dm->ps_tdma_du_adj_type = - 10; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8192e2ant_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) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 7); - coex_dm->ps_tdma_du_adj_type = 7; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 7); - coex_dm->ps_tdma_du_adj_type = 7; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 7); - coex_dm->ps_tdma_du_adj_type = 7; - } else if (coex_dm->cur_ps_tdma == 4) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 8); - coex_dm->ps_tdma_du_adj_type = 8; - } - if (coex_dm->cur_ps_tdma == 9) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 15); - coex_dm->ps_tdma_du_adj_type = 15; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 15); - coex_dm->ps_tdma_du_adj_type = 15; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 15); - coex_dm->ps_tdma_du_adj_type = 15; - } else if (coex_dm->cur_ps_tdma == 12) { - halbtc8192e2ant_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) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 8); - coex_dm->ps_tdma_du_adj_type = - 8; - } else if (coex_dm->cur_ps_tdma == 13) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8192e2ant_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) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 16) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } - } - } else { - if (coex_dm->cur_ps_tdma == 5) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 3); - coex_dm->ps_tdma_du_adj_type = 3; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 3); - coex_dm->ps_tdma_du_adj_type = 3; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 3); - coex_dm->ps_tdma_du_adj_type = 3; - } else if (coex_dm->cur_ps_tdma == 8) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 4); - coex_dm->ps_tdma_du_adj_type = 4; - } - if (coex_dm->cur_ps_tdma == 13) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 11); - coex_dm->ps_tdma_du_adj_type = 11; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 11); - coex_dm->ps_tdma_du_adj_type = 11; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8192e2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 11); - coex_dm->ps_tdma_du_adj_type = 11; - } else if (coex_dm->cur_ps_tdma == 16) { - halbtc8192e2ant_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) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 4); - coex_dm->ps_tdma_du_adj_type = - 4; - } else if (coex_dm->cur_ps_tdma == 9) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8192e2ant_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) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 12) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8192e2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8192e2ant_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) - halbtc8192e2ant_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); - } - } -} - -/* ****************** - * pstdma for wifi rssi low - * ****************** */ -void halbtc8192e2ant_tdma_duration_adjust_for_wifi_rssi_low( - 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; - - coex_dm->auto_tdma_adjust = false; - - retry_count = coex_sta->bt_retry_cnt; - bt_info_ext = coex_sta->bt_info_ext; - - if (!coex_dm->auto_tdma_adjust_low_rssi) { - coex_dm->auto_tdma_adjust_low_rssi = true; - halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 81); - coex_dm->ps_tdma_du_adj_type = 81; - /* ============ */ - 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; */ - result = 0; - wait_count++; - - if ((coex_sta->low_priority_tx) > 1050 || - (coex_sta->low_priority_rx) > 1250) - retry_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 (coex_dm->cur_ps_tdma == 80) { - halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 81); - coex_dm->ps_tdma_du_adj_type = 81; - } else if (coex_dm->cur_ps_tdma == 81) { - halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 82); - coex_dm->ps_tdma_du_adj_type = 82; - } else if (coex_dm->cur_ps_tdma == 82) { - halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 83); - coex_dm->ps_tdma_du_adj_type = 83; - } else if (coex_dm->cur_ps_tdma == 83) { - halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 84); - coex_dm->ps_tdma_du_adj_type = 84; - } - } else if (result == 1) { - if (coex_dm->cur_ps_tdma == 84) { - halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 83); - coex_dm->ps_tdma_du_adj_type = 83; - } else if (coex_dm->cur_ps_tdma == 83) { - halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 82); - coex_dm->ps_tdma_du_adj_type = 82; - } else if (coex_dm->cur_ps_tdma == 82) { - 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); - 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 != 82 && - coex_dm->cur_ps_tdma != 83 && - coex_dm->cur_ps_tdma != 84) { - /* recover to previous adjust type */ - halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - coex_dm->ps_tdma_du_adj_type); - } - } -} - - -void halbtc8192e2ant_get_bt_rssi_threshold(IN struct btc_coexist *btcoexist, - IN u8 *pThres0, IN u8 *pThres1) -{ - u8 ant_type; - - struct btc_board_info *board_info = &btcoexist->board_info; - - ant_type = board_info->ant_type; - - switch (ant_type) { - case BTC_ANT_TYPE_0: - *pThres0 = 100; - *pThres1 = 100; - break; - case BTC_ANT_TYPE_1: - *pThres0 = 34; - *pThres1 = 42; - break; - case BTC_ANT_TYPE_2: - *pThres0 = 34; - *pThres1 = 42; - break; - case BTC_ANT_TYPE_3: - *pThres0 = 34; - *pThres1 = 42; - break; - case BTC_ANT_TYPE_4: - *pThres0 = 34; - *pThres1 = 42; - break; - default: - break; - } -} - - - - -/* SCO only or SCO+PAN(HS) */ -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 bt_thresh0 = 0, bt_thresh1 = 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); - - 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); - - - 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); -} - -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 bt_thresh0 = 0, bt_thresh1 = 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); - - 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, 4); - 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, 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); -} - - -void halbtc8192e2ant_action_hid(IN struct btc_coexist *btcoexist) -{ - u8 wifi_rssi_state, bt_rssi_state = BTC_RSSI_STATE_HIGH; - u32 wifi_bw; - u8 anttype = 0; - - btcoexist->btc_get(btcoexist, BTC_GET_U1_ANT_TYPE, &anttype); - - wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, - 0); - 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); - 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); - 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*/ - 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*/ - 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); -} - -/* A2DP only / PAN(EDR) only/ A2DP+PAN(HS) */ -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; - - btcoexist->btc_get(btcoexist, BTC_GET_U1_ANT_TYPE, &anttype); - - wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, - 0); - 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); - } else if (anttype == 1) { - /*92E 2ant with coupler and bad ant. isolation, 92E 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_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); - 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_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); - 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); -} - -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); - bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, 34, 42); - - halbtc8192e2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); - - halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - - if ((bt_rssi_state == BTC_RSSI_STATE_LOW) || - (bt_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { - halbtc8192e2ant_tdma_duration_adjust(btcoexist, false, true, 2); - 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_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_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); - } - - /* 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)) { - 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); - } - } 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); - } else { - halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, - true, 0x6); - } - } -} - -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 bt_thresh0 = 0, bt_thresh1 = 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 - 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, true, 1); - else - halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 85); - - 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); -} - -/* PAN(HS) only */ -void halbtc8192e2ant_action_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); - 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); - - halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - - if ((bt_rssi_state == BTC_RSSI_STATE_LOW) || - (bt_rssi_state == BTC_RSSI_STATE_STAY_LOW)) - 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_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_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); - halbtc8192e2ant_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)) { - halbtc8192e2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8192e2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8192e2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } 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, - false, 0x18); - } else { - halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } -} - -/* PAN(EDR)+A2DP */ -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 bt_thresh0 = 0, bt_thresh1 = 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 - 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, true, 4); - 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); - -} - -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 bt_thresh0 = 0, bt_thresh1 = 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); - - 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, 3); - 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, 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); - - -} - -/* HID+A2DP+PAN(EDR) */ -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 bt_thresh0 = 0, bt_thresh1 = 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); - - 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, 3); - 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, true, 4); - 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); -} - -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 bt_thresh0 = 0, bt_thresh1 = 0, anttype = 0; - - btcoexist->btc_get(btcoexist, BTC_GET_U1_ANT_TYPE, &anttype); - - wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, - 0); - 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); - - } else if (anttype == 1) { - /*92E 2ant with coupler and bad ant. isolation, 92E 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*/ - 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); - 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); -} - -void halbtc8192e2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) -{ - u8 algorithm = 0; - - 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; - } - - algorithm = halbtc8192e2ant_action_algorithm(btcoexist); - if (coex_sta->c2h_bt_inquiry_page && - (BT_8192E_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); - halbtc8192e2ant_action_bt_inquiry(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 (halbtc8192e2ant_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; - coex_dm->auto_tdma_adjust_low_rssi = 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; - coex_dm->auto_tdma_adjust_low_rssi = false; - - } - switch (coex_dm->cur_algorithm) { - case BT_8192E_2ANT_COEX_ALGO_SCO: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = SCO.\n"); - BTC_TRACE(trace_buf); - halbtc8192e2ant_action_sco(btcoexist); - break; - case BT_8192E_2ANT_COEX_ALGO_SCO_PAN: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = SCO+PAN(EDR).\n"); - BTC_TRACE(trace_buf); - halbtc8192e2ant_action_sco_pan(btcoexist); - break; - case BT_8192E_2ANT_COEX_ALGO_HID: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = HID.\n"); - BTC_TRACE(trace_buf); - halbtc8192e2ant_action_hid(btcoexist); - break; - case BT_8192E_2ANT_COEX_ALGO_A2DP: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = A2DP.\n"); - BTC_TRACE(trace_buf); - halbtc8192e2ant_action_a2dp(btcoexist); - break; - case BT_8192E_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); - halbtc8192e2ant_action_a2dp_pan_hs(btcoexist); - break; - case BT_8192E_2ANT_COEX_ALGO_PANEDR: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n"); - BTC_TRACE(trace_buf); - halbtc8192e2ant_action_pan_edr(btcoexist); - break; - case BT_8192E_2ANT_COEX_ALGO_PANHS: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = HS mode.\n"); - BTC_TRACE(trace_buf); - halbtc8192e2ant_action_pan_hs(btcoexist); - break; - case BT_8192E_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); - halbtc8192e2ant_action_pan_edr_a2dp(btcoexist); - break; - case BT_8192E_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); - halbtc8192e2ant_action_pan_edr_hid(btcoexist); - break; - case BT_8192E_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); - halbtc8192e2ant_action_hid_a2dp_pan_edr( - btcoexist); - break; - case BT_8192E_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); - halbtc8192e2ant_action_hid_a2dp(btcoexist); - break; - default: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = unknown!!\n"); - BTC_TRACE(trace_buf); - halbtc8192e2ant_coex_all_off(btcoexist); - break; - } - coex_dm->pre_algorithm = coex_dm->cur_algorithm; - } -} - -void halbtc8192e2ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean back_up) -{ - u16 u16tmp = 0; - u8 u8tmp = 0; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], 2Ant Init HW Config!!\n"); - BTC_TRACE(trace_buf); - - 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); - } - - /* antenna sw ctrl to bt */ - halbtc8192e2ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, true, false); - - halbtc8192e2ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); - - /* antenna switch control parameter */ - /* btcoexist->btc_write_4byte(btcoexist, 0x858, 0x55555555); */ - - /* coex parameters */ - btcoexist->btc_write_1byte(btcoexist, 0x778, 0x3); - /* 0x790[5:0]=0x5 */ - u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x790); - u8tmp &= 0xc0; - u8tmp |= 0x5; - btcoexist->btc_write_1byte(btcoexist, 0x790, u8tmp); - - /* enable counter statistics */ - btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); - - /* enable PTA */ - btcoexist->btc_write_1byte(btcoexist, 0x40, 0x20); - /* enable mailbox interface */ - u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x40); - u16tmp |= BIT(9); - btcoexist->btc_write_2byte(btcoexist, 0x40, u16tmp); - - /* enable PTA I2C mailbox */ - u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x101); - u8tmp |= BIT(4); - btcoexist->btc_write_1byte(btcoexist, 0x101, u8tmp); - - /* enable bt clock when wifi is disabled. */ - u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x93); - u8tmp |= BIT(0); - btcoexist->btc_write_1byte(btcoexist, 0x93, u8tmp); - /* enable bt clock when suspend. */ - 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; -} - -/* ************************************************************ - * work around function start with wa_halbtc8192e2ant_ - * ************************************************************ - * ************************************************************ - * extern function start with ex_halbtc8192e2ant_ - * ************************************************************ */ -void ex_halbtc8192e2ant_power_on_setting(IN struct btc_coexist *btcoexist) -{ -} - -void ex_halbtc8192e2ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean wifi_only) -{ - halbtc8192e2ant_init_hw_config(btcoexist, true); -} - -void ex_halbtc8192e2ant_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); - - halbtc8192e2ant_init_coex_dm(btcoexist); -} - -void ex_halbtc8192e2ant_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; - 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; - 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); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "Antenna type:", - board_info->ant_type); - 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); - 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_8192e_2ant, glcoex_ver_8192e_2ant, - glcoex_ver_btdesired_8192e_2ant, bt_coex_ver, - (bt_coex_ver == 0xff ? "Unknown" : (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 ", - "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->bt_disabled) ? ("disabled") : (( - coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") - : ((BT_8192E_2ANT_BT_STATUS_NON_CONNECTED_IDLE == - coex_dm->bt_status) ? "non-connected idle" : - ((BT_8192E_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); - - 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_8192E_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_8192e_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); - } - } - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x ", "SS Type", - coex_dm->cur_ss_type); - 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); - - 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)", - "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); - 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); - - 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); - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xc04); - u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xd04); - u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x90c); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", - "0xc04/ 0xd04/ 0x90c", - u32tmp[0], u32tmp[1], u32tmp[2]); - 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]); - CL_PRINTF(cli_buf); - - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x92c); - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x930); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", - "0x92c/ 0x930", - (u8tmp[0]), u32tmp[0]); - CL_PRINTF(cli_buf); - - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x40); - u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x4f); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", - "0x40/ 0x4f", - u8tmp[0], u8tmp[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); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0xc50(dig)", - 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); - 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(hp rx[31:16]/tx[15:0])", - 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(lp rx[31:16]/tx[15:0])", - coex_sta->low_priority_rx, coex_sta->low_priority_tx); - CL_PRINTF(cli_buf); -#if (BT_AUTO_REPORT_ONLY_8192E_2ANT == 1) - halbtc8192e2ant_monitor_bt_ctr(btcoexist); -#endif - btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); -} - - -void ex_halbtc8192e2ant_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; - halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - halbtc8192e2ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, false, - true); - halbtc8192e2ant_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); - coex_sta->under_ips = false; - halbtc8192e2ant_init_hw_config(btcoexist, false); - halbtc8192e2ant_init_coex_dm(btcoexist); - halbtc8192e2ant_query_bt_info(btcoexist); - } -} - -void ex_halbtc8192e2ant_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_halbtc8192e2ant_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); - btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, - &coex_sta->scan_ap_num); - - } -} - -void ex_halbtc8192e2ant_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_halbtc8192e2ant_media_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - u8 h2c_parameter[3] = {0}; - u32 wifi_bw; - u8 wifi_central_chnl; - - 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); - } 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; - } - - 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_halbtc8192e2ant_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_halbtc8192e2ant_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_8192E_2ANT_MAX) - rsp_source = BT_INFO_SRC_8192E_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 (BT_INFO_SRC_8192E_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]; - - /* 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_halbtc8192e2ant_media_status_notify( - btcoexist, BTC_MEDIA_CONNECT); - else - ex_halbtc8192e2ant_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); - halbtc8192e2ant_ignore_wlan_act(btcoexist, - FORCE_EXEC, false); - } - } else { - /* BT already NOT ignore Wlan active, do nothing here. */ - } - -#if (BT_AUTO_REPORT_ONLY_8192E_2ANT == 0) - if ((coex_sta->bt_info_ext & BIT(4))) { - /* BT auto report already enabled, do nothing */ - } else - halbtc8192e2ant_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_8192E_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_8192E_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_8192E_2ANT_B_FTP) - coex_sta->pan_exist = true; - else - coex_sta->pan_exist = false; - if (bt_info & BT_INFO_8192E_2ANT_B_A2DP) - coex_sta->a2dp_exist = true; - else - coex_sta->a2dp_exist = false; - if (bt_info & BT_INFO_8192E_2ANT_B_HID) - coex_sta->hid_exist = true; - else - coex_sta->hid_exist = false; - if (bt_info & BT_INFO_8192E_2ANT_B_SCO_ESCO) - coex_sta->sco_exist = true; - else - coex_sta->sco_exist = false; - } - - halbtc8192e2ant_update_bt_link_info(btcoexist); - - if (!(bt_info & BT_INFO_8192E_2ANT_B_CONNECTION)) { - coex_dm->bt_status = BT_8192E_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_8192E_2ANT_B_CONNECTION) { /* connection exists but no busy */ - coex_dm->bt_status = BT_8192E_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_8192E_2ANT_B_SCO_ESCO) || - (bt_info & BT_INFO_8192E_2ANT_B_SCO_BUSY)) { - coex_dm->bt_status = BT_8192E_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_8192E_2ANT_B_ACL_BUSY) { - coex_dm->bt_status = BT_8192E_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_8192E_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_8192E_2ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || - (BT_8192E_2ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || - (BT_8192E_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); - - halbtc8192e2ant_run_coexist_mechanism(btcoexist); -} - -void ex_halbtc8192e2ant_halt_notify(IN struct btc_coexist *btcoexist) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); - BTC_TRACE(trace_buf); - - 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); -} - -void ex_halbtc8192e2ant_periodical(IN struct btc_coexist *btcoexist) -{ - - 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_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); -#endif -} - -#endif - -#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ - - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8192e2ant.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8192e2ant.h deleted file mode 100644 index 30aa455ccb3f..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8192e2ant.h +++ /dev/null @@ -1,212 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ - -#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) - -#if (RTL8192E_SUPPORT == 1) -/* ******************************************* - * The following is for 8192E 2Ant BT Co-exist definition - * ******************************************* */ -#define BT_AUTO_REPORT_ONLY_8192E_2ANT 0 - -#define BT_INFO_8192E_2ANT_B_FTP BIT(7) -#define BT_INFO_8192E_2ANT_B_A2DP BIT(6) -#define BT_INFO_8192E_2ANT_B_HID BIT(5) -#define BT_INFO_8192E_2ANT_B_SCO_BUSY BIT(4) -#define BT_INFO_8192E_2ANT_B_ACL_BUSY BIT(3) -#define BT_INFO_8192E_2ANT_B_INQ_PAGE BIT(2) -#define BT_INFO_8192E_2ANT_B_SCO_ESCO BIT(1) -#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 - -enum bt_info_src_8192e_2ant { - BT_INFO_SRC_8192E_2ANT_WIFI_FW = 0x0, - BT_INFO_SRC_8192E_2ANT_BT_RSP = 0x1, - BT_INFO_SRC_8192E_2ANT_BT_ACTIVE_SEND = 0x2, - BT_INFO_SRC_8192E_2ANT_MAX -}; - -enum bt_8192e_2ant_bt_status { - BT_8192E_2ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, - BT_8192E_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, - BT_8192E_2ANT_BT_STATUS_INQ_PAGE = 0x2, - BT_8192E_2ANT_BT_STATUS_ACL_BUSY = 0x3, - BT_8192E_2ANT_BT_STATUS_SCO_BUSY = 0x4, - BT_8192E_2ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, - BT_8192E_2ANT_BT_STATUS_MAX -}; - -enum bt_8192e_2ant_coex_algo { - BT_8192E_2ANT_COEX_ALGO_UNDEFINED = 0x0, - BT_8192E_2ANT_COEX_ALGO_SCO = 0x1, - BT_8192E_2ANT_COEX_ALGO_SCO_PAN = 0x2, - BT_8192E_2ANT_COEX_ALGO_HID = 0x3, - BT_8192E_2ANT_COEX_ALGO_A2DP = 0x4, - BT_8192E_2ANT_COEX_ALGO_A2DP_PANHS = 0x5, - BT_8192E_2ANT_COEX_ALGO_PANEDR = 0x6, - BT_8192E_2ANT_COEX_ALGO_PANHS = 0x7, - BT_8192E_2ANT_COEX_ALGO_PANEDR_A2DP = 0x8, - BT_8192E_2ANT_COEX_ALGO_PANEDR_HID = 0x9, - BT_8192E_2ANT_COEX_ALGO_HID_A2DP_PANEDR = 0xa, - BT_8192E_2ANT_COEX_ALGO_HID_A2DP = 0xb, - BT_8192E_2ANT_COEX_ALGO_MAX = 0xc -}; - -struct coex_dm_8192e_2ant { - /* 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 auto_tdma_adjust; - boolean auto_tdma_adjust_low_rssi; - 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 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 pre_algorithm; - u8 cur_algorithm; - u8 bt_status; - u8 wifi_chnl_info[3]; - - u8 pre_ss_type; - u8 cur_ss_type; - - u8 pre_lps; - u8 cur_lps; - u8 pre_rpwm; - u8 cur_rpwm; - - - u32 pre_ra_mask; - u32 cur_ra_mask; - u8 cur_ra_mask_type; - 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; -}; - -struct coex_sta_8192e_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; - 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_8192E_2ANT_MAX][10]; - u32 bt_info_c2h_cnt[BT_INFO_SRC_8192E_2ANT_MAX]; - boolean c2h_bt_inquiry_page; - u8 bt_retry_cnt; - u8 bt_info_ext; - u8 scan_ap_num; - 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; -}; - -/* ******************************************* - * The following is interface which will notify coex module. - * ******************************************* */ -void ex_halbtc8192e2ant_power_on_setting(IN struct btc_coexist *btcoexist); -void ex_halbtc8192e2ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean wifi_only); -void ex_halbtc8192e2ant_init_coex_dm(IN struct btc_coexist *btcoexist); -void ex_halbtc8192e2ant_ips_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8192e2ant_lps_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8192e2ant_scan_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8192e2ant_connect_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8192e2ant_media_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8192e2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8192e2ant_bt_info_notify(IN struct btc_coexist *btcoexist, - IN u8 *tmp_buf, IN u8 length); -void ex_halbtc8192e2ant_halt_notify(IN struct btc_coexist *btcoexist); -void ex_halbtc8192e2ant_periodical(IN struct btc_coexist *btcoexist); -void ex_halbtc8192e2ant_display_coex_info(IN struct btc_coexist *btcoexist); - -#else /* #if (RTL8192E_SUPPORT == 1) */ -#define ex_halbtc8192e2ant_power_on_setting(btcoexist) -#define ex_halbtc8192e2ant_init_hw_config(btcoexist, wifi_only) -#define ex_halbtc8192e2ant_init_coex_dm(btcoexist) -#define ex_halbtc8192e2ant_ips_notify(btcoexist, type) -#define ex_halbtc8192e2ant_lps_notify(btcoexist, type) -#define ex_halbtc8192e2ant_scan_notify(btcoexist, type) -#define ex_halbtc8192e2ant_connect_notify(btcoexist, type) -#define ex_halbtc8192e2ant_media_status_notify(btcoexist, type) -#define ex_halbtc8192e2ant_specific_packet_notify(btcoexist, type) -#define ex_halbtc8192e2ant_bt_info_notify(btcoexist, tmp_buf, length) -#define ex_halbtc8192e2ant_halt_notify(btcoexist) -#define ex_halbtc8192e2ant_periodical(btcoexist) -#define ex_halbtc8192e2ant_display_coex_info(btcoexist) - -#endif - -#endif - - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8703b1ant.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8703b1ant.c deleted file mode 100644 index bf811a9e2a51..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8703b1ant.c +++ /dev/null @@ -1,4294 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ -/* ************************************************************ - * Description: - * - * This file is for RTL8703B 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 (RTL8703B_SUPPORT == 1) -/* ************************************************************ - * Global variables, these are static variables - * ************************************************************ */ -static u8 *trace_buf = &gl_btc_trace_buf[0]; -static struct coex_dm_8703b_1ant glcoex_dm_8703b_1ant; -static struct coex_dm_8703b_1ant *coex_dm = &glcoex_dm_8703b_1ant; -static struct coex_sta_8703b_1ant glcoex_sta_8703b_1ant; -static struct coex_sta_8703b_1ant *coex_sta = &glcoex_sta_8703b_1ant; -static struct psdscan_sta_8703b_1ant gl_psd_scan_8703b_1ant; -static struct psdscan_sta_8703b_1ant *psd_scan = &gl_psd_scan_8703b_1ant; - - -const char *const glbt_info_src_8703b_1ant[] = { - "BT Info[wifi fw]", - "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 = 20161027; -u32 glcoex_ver_8703b_1ant = 0x0f; -u32 glcoex_ver_btdesired_8703b_1ant = 0x0d; - - -/* ************************************************************ - * local function proto type if needed - * ************************************************************ - * ************************************************************ - * local function start with halbtc8703b1ant_ - * ************************************************************ */ -u8 halbtc8703b1ant_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_8703B_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_8703B_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_8703B_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 halbtc8703b1ant_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_8703B_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_8703B_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_8703B_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 halbtc8703b1ant_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 halbtc8703b1ant_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 halbtc8703b1ant_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 halbtc8703b1ant_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 halbtc8703b1ant_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 */ - halbtc8703b1ant_update_ra_mask(btcoexist, force_exec, - 0x0); - break; - case 1: /* disable cck 1/2 */ - halbtc8703b1ant_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 */ - halbtc8703b1ant_update_ra_mask(btcoexist, force_exec, - 0x0001f1f7); - break; - default: - break; - } - - halbtc8703b1ant_auto_rate_fallback_retry(btcoexist, force_exec, - arfr_type); - halbtc8703b1ant_retry_limit(btcoexist, force_exec, retry_limit_type); - halbtc8703b1ant_ampdu_max_time(btcoexist, force_exec, ampdu_time_type); -} - -void halbtc8703b1ant_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 halbtc8703b1ant_query_bt_info(IN struct btc_coexist *btcoexist) -{ - u8 h2c_parameter[1] = {0}; - - - h2c_parameter[0] |= BIT(0); /* trigger */ - - btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); -} - -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, 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; - - 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; - } - } - - 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 >= 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->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; - } - } - } - -} - - -void halbtc8703b1ant_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; - - 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_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 (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 -} - - - -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; - 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; - - 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->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; - } - - 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_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); - - 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_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) -{ - 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 8703b 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); - -} - -void halbtc8703b1ant_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 halbtc8703b1ant_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; - } - halbtc8703b1ant_set_bt_auto_report(btcoexist, - coex_dm->cur_bt_auto_report); - - coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; -} - -void halbtc8703b1ant_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 halbtc8703b1ant_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; - } - - halbtc8703b1ant_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 halbtc8703b1ant_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); -#if 0 - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "\n [BTCoex], ********** Write Scoreboard = %x**********\n", - originalval); - BTC_TRACE(trace_buf); -#endif - -} - -void halbtc8703b1ant_read_score_board( - IN struct btc_coexist *btcoexist, - IN u16 *score_board_val -) -{ - - *score_board_val = (btcoexist->btc_read_2byte(btcoexist, - 0xaa)) & 0x7fff; -} - -void halbtc8703b1ant_post_state_to_bt( - IN struct btc_coexist *btcoexist, - IN u16 type, - IN boolean state -) -{ - halbtc8703b1ant_write_score_board(btcoexist, (u16) type, state); -} - -void halbtc8703b1ant_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 /* 8703b BT can't show correct on/off status in scoreboard[1] 2015/11/26 */ - - halbtc8703b1ant_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 (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, - "[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 halbtc8703b1ant_enable_gnt_to_gpio(IN struct btc_coexist *btcoexist, - IN boolean isenable) -{ - -#if (BT_8703B_1ANT_ENABLE_GNTBT_TO_GPIO14 == 1) - if (isenable) { - /* enable GNT_WL/GNT_BT debug signal to GPIO14/15 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x1); - - /* enable GNT_BT debug to GPIO */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x40, 0x0); - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x1, 0x0); - } else { - /* enable GNT_WL/GNT_BT debug signal to GPIO14/15 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x0); - - /* Disable GNT_BT debug to GPIO, and enable chip_wakeup_host */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x40, 0x1); - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x1, 0x1); - } -#endif -} - -u32 halbtc8703b1ant_ltecoex_indirect_read_reg(IN struct btc_coexist *btcoexist, - IN u16 reg_addr) -{ - u32 j = 0; - - - /* 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, - 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, 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 { - for (i = 0; i <= 31; i++) { - if (((bit_mask >> i) & 0x1) == 0x1) { - bitpos = i; - break; - } - } - - /* read back register value before write */ - val = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, - reg_addr); - val = (val & (~bit_mask)) | (reg_value << bitpos); - - 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); - - } - -} - -void halbtc8703b1ant_ltecoex_enable(IN struct btc_coexist *btcoexist, - IN boolean enable) -{ - u8 val; - - val = (enable) ? 1 : 0; - halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, 0x38, 0x80, - val); /* 0x38[7] */ - -} - -void halbtc8703b1ant_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 halbtc8703b1ant_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 = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, - 0x38); - - switch (control_block) { - case BT_8703B_1ANT_GNT_BLOCK_RFC_BB: - default: - val = ((val << 14) | (val << 10)) | (val_orig & 0xffff33ff); - break; - case BT_8703B_1ANT_GNT_BLOCK_RFC: - val = (val << 14) | (val_orig & 0xffff3fff); - break; - case BT_8703B_1ANT_GNT_BLOCK_BB: - 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, val_orig = 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: - val = ((val << 12) | (val << 8)) | (val_orig & 0xffffccff); - break; - case BT_8703B_1ANT_GNT_BLOCK_RFC: - val = (val << 12) | (val_orig & 0xffffcfff); - break; - case BT_8703B_1ANT_GNT_BLOCK_BB: - 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) -{ - u16 reg_addr = 0x0000; - - switch (table_type) { - case BT_8703B_1ANT_CTT_WL_VS_LTE: - reg_addr = 0xa0; - break; - case BT_8703B_1ANT_CTT_BT_VS_LTE: - reg_addr = 0xa4; - break; - } - - if (reg_addr != 0x0000) - halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, - 0xffff, table_content); /* 0xa0[15:0] or 0xa4[15:0] */ - - -} - - -void halbtc8703b1ant_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_8703B_1ANT_LBTT_WL_BREAK_LTE: - reg_addr = 0xa8; - break; - case BT_8703B_1ANT_LBTT_BT_BREAK_LTE: - reg_addr = 0xac; - break; - case BT_8703B_1ANT_LBTT_LTE_BREAK_WL: - reg_addr = 0xb0; - break; - case BT_8703B_1ANT_LBTT_LTE_BREAK_BT: - reg_addr = 0xb4; - break; - } - - if (reg_addr != 0x0000) - halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, - 0xff, table_content); /* 0xa8[15:0] or 0xb4[15:0] */ - - -} - -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) -{ - 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 halbtc8703b1ant_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; - } - halbtc8703b1ant_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 halbtc8703b1ant_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: - halbtc8703b1ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x55555555, break_table, - select_table); - break; - case 1: - halbtc8703b1ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x5a5a5a5a, break_table, - select_table); - break; - case 2: - halbtc8703b1ant_coex_table(btcoexist, force_exec, - 0xaa5a5a5a, 0xaa5a5a5a, break_table, - select_table); - break; - case 3: - halbtc8703b1ant_coex_table(btcoexist, force_exec, - 0xaa555555, 0xaa5a5a5a, break_table, - select_table); - break; - case 4: - halbtc8703b1ant_coex_table(btcoexist, force_exec, - 0xa5555555, 0x5a5a5a5a, break_table, - select_table); - break; - case 5: - halbtc8703b1ant_coex_table(btcoexist, force_exec, - 0x5a5a5a5a, 0x5a5a5a5a, break_table, - select_table); - break; - case 6: - halbtc8703b1ant_coex_table(btcoexist, force_exec, - 0xa5555555, 0x5a5a5a5a, break_table, - select_table); - break; - case 7: - halbtc8703b1ant_coex_table(btcoexist, force_exec, - 0xaaaaaaaa, 0xaaaaaaaa, break_table, - select_table); - break; - case 8: - halbtc8703b1ant_coex_table(btcoexist, force_exec, - 0xa5555555, 0xaaaaaaaa, break_table, - select_table); - break; - case 9: - halbtc8703b1ant_coex_table(btcoexist, force_exec, - 0x5a5a5a5a, 0xaaaa5aaa, break_table, - select_table); - break; - default: - break; - } -} - -void halbtc8703b1ant_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 halbtc8703b1ant_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; - } - halbtc8703b1ant_set_fw_ignore_wlan_act(btcoexist, enable); - - coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; -} - -void halbtc8703b1ant_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 halbtc8703b1ant_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; - } - halbtc8703b1ant_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 halbtc8703b1ant_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 */ - /*halbtc8703b1ant_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 */ - /*halbtc8703b1ant_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 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; - - 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; - halbtc8703b1ant_ps_tdma_check_for_power_save_state( - 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; - 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; - halbtc8703b1ant_ps_tdma_check_for_power_save_state( - btcoexist, false); - btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, - NULL); - - break; - default: - break; - } -} - - - -void halbtc8703b1ant_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; - 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) { - 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); - - halbtc8703b1ant_power_save_state(btcoexist, - BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - } - } else if (byte1 & BIT(4) && !(byte1 & BIT(5))) { - - halbtc8703b1ant_power_save_state( - btcoexist, BTC_PS_LPS_ON, 0x50, - 0x4); - } else { - halbtc8703b1ant_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 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; - u8 rssi_adjust_val = 0; - 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)) - 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 */ - } - - - if (turn_on) { - switch (type) { - default: - halbtc8703b1ant_set_fw_pstdma(btcoexist, - 0x61, 0x35, 0x03, 0x11, 0x11); - break; - - case 3: - halbtc8703b1ant_set_fw_pstdma(btcoexist, - 0x51, 0x3a, 0x03, 0x10, 0x50); - break; - case 4: - halbtc8703b1ant_set_fw_pstdma(btcoexist, - 0x51, 0x21, 0x03, 0x10, 0x50); - break; - case 5: - halbtc8703b1ant_set_fw_pstdma(btcoexist, - 0x61, 0x15, 0x03, 0x11, 0x11); - break; - case 6: - halbtc8703b1ant_set_fw_pstdma(btcoexist, - 0x61, 0x20, 0x03, 0x11, 0x11); - break; - case 7: - halbtc8703b1ant_set_fw_pstdma(btcoexist, - 0x51, 0x10, 0x03, 0x10, 0x54 | - psTdmaByte4Modify); - break; - case 8: - halbtc8703b1ant_set_fw_pstdma(btcoexist, - 0x51, 0x10, 0x03, 0x10, 0x54 | - psTdmaByte4Modify); - break; - case 9: - halbtc8703b1ant_set_fw_pstdma(btcoexist, - 0x55, 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, - 0x65, 0x25, 0x03, 0x11, 0x11 | - psTdmaByte4Modify); - break; - case 12: - halbtc8703b1ant_set_fw_pstdma(btcoexist, - 0x55, 0x30, 0x03, 0x10, 0x50 | - psTdmaByte4Modify); - break; - case 13: - halbtc8703b1ant_set_fw_pstdma(btcoexist, - 0x51, 0x25, 0x03, 0x10, 0x50 | - psTdmaByte4Modify); - break; - case 14: - halbtc8703b1ant_set_fw_pstdma(btcoexist, - 0x51, 0x15, 0x03, 0x10, 0x50 | - psTdmaByte4Modify); - break; - case 15: - halbtc8703b1ant_set_fw_pstdma(btcoexist, - 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); - 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); - break; - case 20: - halbtc8703b1ant_set_fw_pstdma(btcoexist, - 0x61, 0x30, 0x03, 0x11, 0x10); - break; - case 21: - halbtc8703b1ant_set_fw_pstdma(btcoexist, - 0x61, 0x30, 0x03, 0x11, 0x10); - break; - case 22: - halbtc8703b1ant_set_fw_pstdma(btcoexist, - 0x61, 0x25, 0x03, 0x11, 0x10); - break; - case 23: - halbtc8703b1ant_set_fw_pstdma(btcoexist, - 0x61, 0x10, 0x03, 0x11, 0x10); - break; - case 32: - halbtc8703b1ant_set_fw_pstdma(btcoexist, - 0x61, 0x35, 0x03, 0x11, 0x11); - break; - case 33: - halbtc8703b1ant_set_fw_pstdma(btcoexist, - 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 { - - /* disable PS tdma */ - switch (type) { - case 8: /* PTA Control */ - halbtc8703b1ant_set_fw_pstdma(btcoexist, 0x8, - 0x0, 0x0, 0x0, 0x0); - break; - case 0: - default: /* Software control, Antenna at BT side */ - halbtc8703b1ant_set_fw_pstdma(btcoexist, 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); - 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 u8 phase) -{ - u32 cnt_bt_cal_chk = 0; - boolean is_in_mp_mode = false; - u8 u8tmp = 0; - u32 u32tmp1 = 0, u32tmp2 = 0; - - - 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 - u32tmp2 = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, - 0x54); - u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x73); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (Before Ant Setup) 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", - u8tmp, u32tmp1, u32tmp2); - BTC_TRACE(trace_buf); -#endif - - 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); - - /* 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); - - /* 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 */ - halbtc8703b1ant_ltecoex_pathcontrol_owner( - btcoexist, - BT_8703B_1ANT_PCO_WLSIDE); - - /* set GNT_BT to SW 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 SW 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; - 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); - - if (BTC_ANT_PATH_AUTO == ant_pos_type) - ant_pos_type = BTC_ANT_PATH_BT; - - coex_sta->run_time_state = false; - break; - case BT_8703B_1ANT_PHASE_2G_RUNTIME: - halbtc8703b1ant_ltecoex_pathcontrol_owner( - btcoexist, - BT_8703B_1ANT_PCO_WLSIDE); - - /* 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, - BT_8703B_1ANT_GNT_BLOCK_RFC_BB, - BT_8703B_1ANT_GNT_TYPE_CTRL_BY_PTA, - BT_8703B_1ANT_SIG_STA_SET_BY_HW); - - 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); - - - 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; - - 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_8703B_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_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); - common = true; - } else if (!wifi_connected && - (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); - common = true; - } else if (wifi_connected && - (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); - common = true; - } else if (!wifi_connected && - (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); - 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; -} - - -/* ********************************************* - * - * Non-Software Coex Mechanism start - * - * ********************************************* */ -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; - - 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_8703B_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_8703B_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_8703B_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_8703B_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_8703B_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_8703B_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_8703B_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_8703B_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_8703B_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_8703B_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_8703B_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_8703B_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_8703B_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_8703B_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_8703B_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_8703B_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_8703B_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_8703B_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_8703B_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_8703B_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_8703B_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_8703B_1ANT_COEX_ALGO_PANEDR_HID; - } - } - } - } - - return algorithm; -} - -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_AUTO, NORMAL_EXEC, - BT_8703B_1ANT_PHASE_2G_RUNTIME); - halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -} - -void halbtc8703b1ant_action_bt_hs(IN struct btc_coexist *btcoexist) -{ - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); - halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -} - -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, 1); - coex_sta->bt_relink_downcount = 2; -} - -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_ps_tdma(btcoexist, NORMAL_EXEC, false, - 8); - halbtc8703b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 2); - } 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, 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); - - halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); - - if ((bt_link_info->a2dp_exist) && (!bt_link_info->pan_exist)) - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 17); - else - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); - } else if ((!wifi_connected) && (!wifi_scan)) { - - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - - halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - } else if (bt_link_info->pan_exist) { - - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); - - halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } else if (bt_link_info->a2dp_exist) { - - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 16); - - halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } else { - - if ((wifi_link) || (wifi_roam) || (wifi_scan) || (wifi_busy) - || (coex_sta->wifi_is_high_pri_task)) - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 21); - else - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 23); - - halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } -} - - -void halbtc8703b1ant_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); - - - if (bt_link_info->sco_exist) { - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); - halbtc8703b1ant_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) { - - halbtc8703b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 6); - halbtc8703b1ant_set_wltoggle_coex_table(btcoexist, - NORMAL_EXEC, - 0x1, 0xaa, - 0x5a, 0xaa, - 0xaa); - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 11); - } else { - - if (wifi_busy) { - - halbtc8703b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 6); - halbtc8703b1ant_set_wltoggle_coex_table(btcoexist, - NORMAL_EXEC, - 0x2, 0xaa, - 0x5a, 0xaa, - 0xaa); - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 11); - } else { - - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6); - halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); - } - } - } else { - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 6); - halbtc8703b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 3); - } -} - - -void halbtc8703b1ant_action_wifi_only(IN struct btc_coexist *btcoexist) -{ - halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); - 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, 0); -} - -void halbtc8703b1ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, - BT_8703B_1ANT_PHASE_2G_RUNTIME); - - 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); -} - -void halbtc8703b1ant_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) { - - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); - - halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - - } else if (bt_link_info->a2dp_exist) { - - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 17); - - halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } else { - - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 21); - - halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } -} - -void halbtc8703b1ant_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; - - 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); - -#if 1 - if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) - wifi_turbo = true; -#endif - - 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); - - /*halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32);*/ - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - - } else if (bt_link_info->a2dp_only) { /* A2DP */ - if (!wifi_busy) { - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 32); - halbtc8703b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } else { - - if (coex_sta->wl_noisy_level == 2) - halbtc8703b1ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 17); - else - halbtc8703b1ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 7); - - if (wifi_turbo) - halbtc8703b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 8); - else - halbtc8703b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } - } 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 ((bt_link_info->hid_exist) && (coex_sta->hid_busy_num >= 2)) { - halbtc8703b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 6); - halbtc8703b1ant_set_wltoggle_coex_table(btcoexist, - NORMAL_EXEC, - 0x2, 0xaa, - 0x5a, 0xaa, - 0xaa); - halbtc8703b1ant_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)) - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 15); - else if (wifi_turbo) - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 18); - else - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 13); - } else - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 14); - - 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); - } 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 */ - halbtc8703b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 6); - halbtc8703b1ant_set_wltoggle_coex_table(btcoexist, - NORMAL_EXEC, - 0x2, 0xaa, - 0x5a, 0xaa, - 0xaa); - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 9); - } else { - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 8); - 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_link_info->hid_exist) && (bt_link_info->pan_exist) && - (coex_sta->hid_busy_num >= 2)) { - - halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); - halbtc8703b1ant_set_wltoggle_coex_table(btcoexist, - NORMAL_EXEC, - 0x2, 0xaa, - 0x5a, 0xaa, - 0xaa); - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 12); - } else { - - if (!wifi_busy) - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 4); - else - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 3); - - 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); - } - } else { - /* BT no-profile busy (0x9) */ - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); - halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } -} - -void halbtc8703b1ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist) -{ - /* tdma and coex table */ - halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); - halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -} - -void halbtc8703b1ant_action_wifi_connected(IN struct btc_coexist *btcoexist) -{ - 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"); - BTC_TRACE(trace_buf); - - halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, - NORMAL_EXEC, - BT_8703B_1ANT_PHASE_2G_RUNTIME); - - 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_bt_acl_busy(btcoexist); - - } 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); - } else - halbtc8703b1ant_action_bt_idle(btcoexist); -} - - -void halbtc8703b1ant_run_sw_coexist_mechanism(IN struct btc_coexist *btcoexist) -{ - u8 algorithm = 0; - - algorithm = halbtc8703b1ant_action_algorithm(btcoexist); - coex_dm->cur_algorithm = algorithm; - - if (halbtc8703b1ant_is_common_action(btcoexist)) { - - } else { - switch (coex_dm->cur_algorithm) { - case BT_8703B_1ANT_COEX_ALGO_SCO: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = SCO.\n"); - BTC_TRACE(trace_buf); - 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); - 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); - 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); - 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); - 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); - 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); - 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); - 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); - 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); - 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 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, 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); - - 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; - } - - 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"); - BTC_TRACE(trace_buf); - 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"); - halbtc8703b1ant_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); - halbtc8703b1ant_action_bt_inquiry(btcoexist); - return; - } - - if (coex_sta->is_setupLink) { - 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; - - 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); - - halbtc8703b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, - false, 0x5); - - 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); - - halbtc8703b1ant_action_wifi_linkscan_process(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); - 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_limited_rx(btcoexist, - NORMAL_EXEC, false, true, 0x8); - } else - halbtc8703b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, - 0x5); - } - - halbtc8703b1ant_run_sw_coexist_mechanism( - btcoexist); /* just print debug message */ - - 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); - halbtc8703b1ant_action_bt_hs(btcoexist); - return; - } - - 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 (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); - - 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 */ - - halbtc8703b1ant_low_penalty_ra(btcoexist, NORMAL_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; -} - -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); - u32tmp2 = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "\n [BTCoex], ********** 0x70/ 0x38/ 0x54 (Before Init HW config) = 0x%x/ 0x%x/ 0x%x**********\n", - u32tmp0, - 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->gnt_error_cnt = 0; - coex_sta->bt_relink_downcount = 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; - - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, - 0x1); /* enable TBTT nterrupt */ - - /* BT report packet sample rate */ - btcoexist->btc_write_1byte(btcoexist, 0x790, 0x5); - - /* 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); - - halbtc8703b1ant_enable_gnt_to_gpio(btcoexist, false); - - if (btcoexist->btc_read_1byte(btcoexist, 0x80) == 0xc6) - halbtc8703b1ant_post_state_to_bt(btcoexist, - BT_8703B_1ANT_SCOREBOARD_ONOFF, true); - - halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); - - /* Antenna config */ - if (wifi_only) { - coex_sta->concurrent_rx_mode_on = false; - halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI, - FORCE_EXEC, - BT_8703B_1ANT_PHASE_WLANONLY_INIT); - } else { - 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_AUTO, - FORCE_EXEC, - BT_8703B_1ANT_PHASE_COEX_INIT); - } - - /* PTA parameter */ - halbtc8703b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); - - u32tmp0 = btcoexist->btc_read_4byte(btcoexist, 0x70), - u32tmp1 = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); - u32tmp2 = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** 0x70/ 0x38/ 0x54 (After Init HW config) = 0x%x/ 0x%x/ 0x%x**********\n", - u32tmp0, - u32tmp1, u32tmp2); - BTC_TRACE(trace_buf); - -} - - - -/* ************************************************************ - * work around function start with wa_halbtc8703b1ant_ - * ************************************************************ - * ************************************************************ - * extern function start with ex_halbtc8703b1ant_ - * ************************************************************ */ -void ex_halbtc8703b1ant_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 8703b 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 BB/MAC reg 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 */ - 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); - - /* set WLAN_ACT = 0 */ - btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); - - halbtc8703b1ant_enable_gnt_to_gpio(btcoexist, false); - - /* */ - /* 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_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** 0x70(MAC)/0x38/0x54 (Power-On) =0x%x/ 0x%x/ 0x%x**********\n", - btcoexist->btc_read_4byte(btcoexist, 0x70), - halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38), - halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, 0x54)); - BTC_TRACE(trace_buf); - - -} - -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; -} - -void ex_halbtc8703b1ant_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); - - halbtc8703b1ant_init_coex_dm(btcoexist); -} - -void ex_halbtc8703b1ant_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/ %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); - } - } - - - /*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); - - 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); - - 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_8703B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == - coex_dm->bt_status) ? "non-connected idle" : - ((BT_8703B_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", - "Role/IgnWlanAct/Feature", - ((bt_link_info->slave_role) ? "Slave" : "Master"), - ((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]) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", - glbt_info_src_8703b_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] = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); - lte_coex_on = ((u32tmp[0] & BIT(7)) >> 7) ? true : false; - - 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] = 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")); - 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 = %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(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); - - 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/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); -#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 %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); -} - - -void ex_halbtc8703b1ant_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; - - /* Write WL "Active" in Score-board for LPS off */ - halbtc8703b1ant_post_state_to_bt(btcoexist, - BT_8703B_1ANT_SCOREBOARD_ACTIVE, false); - - halbtc8703b1ant_post_state_to_bt(btcoexist, - BT_8703B_1ANT_SCOREBOARD_ONOFF, false); - - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - - halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8703B_1ANT_PHASE_WLAN_OFF); - - halbtc8703b1ant_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); - halbtc8703b1ant_post_state_to_bt(btcoexist, - BT_8703B_1ANT_SCOREBOARD_ACTIVE, true); - - halbtc8703b1ant_post_state_to_bt(btcoexist, - BT_8703B_1ANT_SCOREBOARD_ONOFF, true); - - halbtc8703b1ant_init_hw_config(btcoexist, false, false); - halbtc8703b1ant_init_coex_dm(btcoexist); - halbtc8703b1ant_query_bt_info(btcoexist); - - coex_sta->under_ips = false; - } -} - -void ex_halbtc8703b1ant_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; - coex_sta->under_ips = false; - - if (coex_sta->force_lps_on == true) { /* LPS No-32K */ - /* Write WL "Active" in Score-board for PS-TDMA */ - 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_state_to_bt(btcoexist, - BT_8703B_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 */ - halbtc8703b1ant_post_state_to_bt(btcoexist, - BT_8703B_1ANT_SCOREBOARD_ACTIVE, true); - } -} - -void ex_halbtc8703b1ant_scan_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - boolean wifi_connected = false; - - if (btcoexist->manual_control || - btcoexist->stop_coex_dm) - return; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - - halbtc8703b1ant_query_bt_info(btcoexist); - - 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); - - halbtc8703b1ant_post_state_to_bt(btcoexist, - BT_8703B_1ANT_SCOREBOARD_SCAN, true); - halbtc8703b1ant_post_state_to_bt(btcoexist, - BT_8703B_1ANT_SCOREBOARD_ACTIVE, true); - - halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, - 8); - - /* Force antenna setup for no scan result issue */ - halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8703B_1ANT_PHASE_2G_RUNTIME); - - halbtc8703b1ant_run_coexist_mechanism(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); - - halbtc8703b1ant_run_coexist_mechanism(btcoexist); - } - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCAN START Notify() end\n"); - BTC_TRACE(trace_buf); - -} - -void ex_halbtc8703b1ant_connect_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - boolean wifi_connected = false; - - if (btcoexist->manual_control || - btcoexist->stop_coex_dm) - return; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - - if (BTC_ASSOCIATE_START == type) { - coex_sta->wifi_is_high_pri_task = true; - - halbtc8703b1ant_post_state_to_bt(btcoexist, - BT_8703B_1ANT_SCOREBOARD_SCAN, true); - halbtc8703b1ant_post_state_to_bt(btcoexist, - BT_8703B_1ANT_SCOREBOARD_ACTIVE, true); - - halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, - 8); - - /* Force antenna setup for no scan result issue */ - 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_run_coexist_mechanism(btcoexist); - } 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); - - halbtc8703b1ant_run_coexist_mechanism(btcoexist); - } - -} - -void ex_halbtc8703b1ant_media_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - 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); - - halbtc8703b1ant_post_state_to_bt(btcoexist, - BT_8703B_1ANT_SCOREBOARD_ACTIVE, true); - halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, - 8); - - /* Force antenna setup for no scan result issue */ - 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); - - /* 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); - - 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; - } - - halbtc8703b1ant_update_wifi_channel_info(btcoexist, type); - -} - -void ex_halbtc8703b1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - boolean under_4way = false; - - if (btcoexist->manual_control || - btcoexist->stop_coex_dm) - 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) { - 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 i, rsp_source = 0; - boolean wifi_connected = false; - boolean wifi_scan = false, wifi_link = false, wifi_roam = false, - wifi_busy = false; - - - rsp_source = tmp_buf[0] & 0xf; - if (rsp_source >= BT_INFO_SRC_8703B_1ANT_MAX) - rsp_source = BT_INFO_SRC_8703B_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_8703B_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_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->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; - } else - coex_sta->is_setupLink = false; - - if (coex_sta->bt_info_ext & BIT(3)) - coex_sta->cnt_IgnWlanAct++; - - 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)) { - - halbtc8703b1ant_post_state_to_bt(btcoexist, - BT_8703B_1ANT_SCOREBOARD_SCAN, true); - - } else { - - halbtc8703b1ant_post_state_to_bt(btcoexist, - BT_8703B_1ANT_SCOREBOARD_SCAN, false); - } - } else - halbtc8703b1ant_post_state_to_bt(btcoexist, - BT_8703B_1ANT_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) - halbtc8703b1ant_update_wifi_channel_info( - btcoexist, BTC_MEDIA_CONNECT); - else - 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))) && - (!(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); - halbtc8703b1ant_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); - } - - halbtc8703b1ant_update_bt_link_info(btcoexist); - - halbtc8703b1ant_run_coexist_mechanism(btcoexist); -} - - -void ex_halbtc8703b1ant_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; - - halbtc8703b1ant_post_state_to_bt(btcoexist, - BT_8703B_1ANT_SCOREBOARD_ACTIVE, true); - halbtc8703b1ant_post_state_to_bt(btcoexist, - BT_8703B_1ANT_SCOREBOARD_ONOFF, true); - - /* 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_state_to_bt(btcoexist, - BT_8703B_1ANT_SCOREBOARD_ACTIVE, false); - halbtc8703b1ant_post_state_to_bt(btcoexist, - BT_8703B_1ANT_SCOREBOARD_ONOFF, false); - - halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); - halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8703B_1ANT_PHASE_WLAN_OFF); - - btcoexist->stop_coex_dm = true; - - } -} - -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_state_to_bt(btcoexist, - BT_8703B_1ANT_SCOREBOARD_ACTIVE, false); - halbtc8703b1ant_post_state_to_bt(btcoexist, - BT_8703B_1ANT_SCOREBOARD_ONOFF, false); - - halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); - 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; -} - -void ex_halbtc8703b1ant_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_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_state_to_bt(btcoexist, - BT_8703B_1ANT_SCOREBOARD_ACTIVE, false); - halbtc8703b1ant_post_state_to_bt(btcoexist, - BT_8703B_1ANT_SCOREBOARD_ONOFF, false); - - if (BTC_WIFI_PNP_SLEEP_KEEP_ANT == pnp_state) { - - 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_state_to_bt(btcoexist, - BT_8703B_1ANT_SCOREBOARD_ACTIVE, true); - halbtc8703b1ant_post_state_to_bt(btcoexist, - BT_8703B_1ANT_SCOREBOARD_ONOFF, true); - - btcoexist->stop_coex_dm = false; - } -} - -void ex_halbtc8703b1ant_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); - - 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; - static u8 cnt = 0; - boolean bt_relink_finish = false; - -#if (BT_AUTO_REPORT_ONLY_8703B_1ANT == 0) - halbtc8703b1ant_query_bt_info(btcoexist); -#endif - - halbtc8703b1ant_monitor_bt_ctr(btcoexist); - halbtc8703b1ant_monitor_wifi_ctr(btcoexist); - - halbtc8703b1ant_monitor_bt_enable_disable(btcoexist); - -# if 1 - 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) - 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 (!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 (halbtc8703b1ant_is_wifibt_status_changed(btcoexist)) - halbtc8703b1ant_run_coexist_mechanism(btcoexist); -} - -void ex_halbtc8703b1ant_antenna_detection(IN struct btc_coexist *btcoexist, - IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) -{ - /* No Antenna Detection required because 8730b is only 1-Ant */ -} - -void ex_halbtc8703b1ant_antenna_isolation(IN struct btc_coexist *btcoexist, - IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) -{ - - -} - -void ex_halbtc8703b1ant_psd_scan(IN struct btc_coexist *btcoexist, - IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) -{ - - -} - -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/rtl8188eu/hal/btc/halbtc8703b1ant.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8703b1ant.h deleted file mode 100644 index eb06cffd3651..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8703b1ant.h +++ /dev/null @@ -1,405 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ - -#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) - -#if (RTL8703B_SUPPORT == 1) -/* ******************************************* - * The following is for 8703B 1ANT BT Co-exist definition - * ******************************************* */ -#define BT_AUTO_REPORT_ONLY_8703B_1ANT 1 -#define BT_8703B_1ANT_ENABLE_GNTBT_TO_GPIO14 0 - -#define BT_INFO_8703B_1ANT_B_FTP BIT(7) -#define BT_INFO_8703B_1ANT_B_A2DP BIT(6) -#define BT_INFO_8703B_1ANT_B_HID BIT(5) -#define BT_INFO_8703B_1ANT_B_SCO_BUSY BIT(4) -#define BT_INFO_8703B_1ANT_B_ACL_BUSY BIT(3) -#define BT_INFO_8703B_1ANT_B_INQ_PAGE BIT(2) -#define BT_INFO_8703B_1ANT_B_SCO_ESCO BIT(1) -#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) - -#define BTC_RSSI_COEX_THRESH_TOL_8703B_1ANT 2 - -#define BT_8703B_1ANT_WIFI_NOISY_THRESH 50 /* max: 255 */ - -/* for Antenna detection */ -#define BT_8703B_1ANT_ANTDET_PSDTHRES_BACKGROUND 50 -#define BT_8703B_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION 70 -#define BT_8703B_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION 55 -#define BT_8703B_1ANT_ANTDET_PSDTHRES_1ANT 35 -#define BT_8703B_1ANT_ANTDET_RETRY_INTERVAL 10 /* retry timer if ant det is fail, unit: second */ -#define BT_8703B_1ANT_ANTDET_SWEEPPOINT_DELAY 40000 -#define BT_8703B_1ANT_ANTDET_ENABLE 0 -#define BT_8703B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE 0 - -#define BT_8703B_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT 30000 - -enum bt_8703b_1ant_signal_state { - BT_8703B_1ANT_SIG_STA_SET_TO_LOW = 0x0, - BT_8703B_1ANT_SIG_STA_SET_BY_HW = 0x0, - BT_8703B_1ANT_SIG_STA_SET_TO_HIGH = 0x1, - BT_8703B_1ANT_SIG_STA_MAX -}; - -enum bt_8703b_1ant_path_ctrl_owner { - BT_8703B_1ANT_PCO_BTSIDE = 0x0, - BT_8703B_1ANT_PCO_WLSIDE = 0x1, - BT_8703B_1ANT_PCO_MAX -}; - -enum bt_8703b_1ant_gnt_ctrl_type { - BT_8703B_1ANT_GNT_TYPE_CTRL_BY_PTA = 0x0, - BT_8703B_1ANT_GNT_TYPE_CTRL_BY_SW = 0x1, - BT_8703B_1ANT_GNT_TYPE_MAX -}; - -enum bt_8703b_1ant_gnt_ctrl_block { - BT_8703B_1ANT_GNT_BLOCK_RFC_BB = 0x0, - BT_8703B_1ANT_GNT_BLOCK_RFC = 0x1, - BT_8703B_1ANT_GNT_BLOCK_BB = 0x2, - BT_8703B_1ANT_GNT_BLOCK_MAX -}; - -enum bt_8703b_1ant_lte_coex_table_type { - BT_8703B_1ANT_CTT_WL_VS_LTE = 0x0, - BT_8703B_1ANT_CTT_BT_VS_LTE = 0x1, - BT_8703B_1ANT_CTT_MAX -}; - -enum bt_8703b_1ant_lte_break_table_type { - BT_8703B_1ANT_LBTT_WL_BREAK_LTE = 0x0, - BT_8703B_1ANT_LBTT_BT_BREAK_LTE = 0x1, - BT_8703B_1ANT_LBTT_LTE_BREAK_WL = 0x2, - BT_8703B_1ANT_LBTT_LTE_BREAK_BT = 0x3, - BT_8703B_1ANT_LBTT_MAX -}; - -enum bt_info_src_8703b_1ant { - BT_INFO_SRC_8703B_1ANT_WIFI_FW = 0x0, - BT_INFO_SRC_8703B_1ANT_BT_RSP = 0x1, - BT_INFO_SRC_8703B_1ANT_BT_ACTIVE_SEND = 0x2, - BT_INFO_SRC_8703B_1ANT_MAX -}; - -enum bt_8703b_1ant_bt_status { - BT_8703B_1ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, - BT_8703B_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, - BT_8703B_1ANT_BT_STATUS_INQ_PAGE = 0x2, - BT_8703B_1ANT_BT_STATUS_ACL_BUSY = 0x3, - BT_8703B_1ANT_BT_STATUS_SCO_BUSY = 0x4, - BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, - BT_8703B_1ANT_BT_STATUS_MAX -}; - -enum bt_8703b_1ant_wifi_status { - BT_8703B_1ANT_WIFI_STATUS_NON_CONNECTED_IDLE = 0x0, - BT_8703B_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN = 0x1, - BT_8703B_1ANT_WIFI_STATUS_CONNECTED_SCAN = 0x2, - BT_8703B_1ANT_WIFI_STATUS_CONNECTED_SPECIFIC_PKT = 0x3, - BT_8703B_1ANT_WIFI_STATUS_CONNECTED_IDLE = 0x4, - BT_8703B_1ANT_WIFI_STATUS_CONNECTED_BUSY = 0x5, - BT_8703B_1ANT_WIFI_STATUS_MAX -}; - -enum bt_8703b_1ant_coex_algo { - BT_8703B_1ANT_COEX_ALGO_UNDEFINED = 0x0, - BT_8703B_1ANT_COEX_ALGO_SCO = 0x1, - BT_8703B_1ANT_COEX_ALGO_HID = 0x2, - BT_8703B_1ANT_COEX_ALGO_A2DP = 0x3, - BT_8703B_1ANT_COEX_ALGO_A2DP_PANHS = 0x4, - BT_8703B_1ANT_COEX_ALGO_PANEDR = 0x5, - BT_8703B_1ANT_COEX_ALGO_PANHS = 0x6, - BT_8703B_1ANT_COEX_ALGO_PANEDR_A2DP = 0x7, - BT_8703B_1ANT_COEX_ALGO_PANEDR_HID = 0x8, - BT_8703B_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, - BT_8703B_1ANT_COEX_ALGO_HID_A2DP = 0xa, - 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; - 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; - boolean limited_dig; - - 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 pre_algorithm; - u8 cur_algorithm; - 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_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; - u8 num_of_profile; - - 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]; - 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_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_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; - - 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 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; - - 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; -}; - -#define BT_8703B_1ANT_ANTDET_PSD_POINTS 256 /* MAX:1024 */ -#define BT_8703B_1ANT_ANTDET_PSD_AVGNUM 1 /* MAX:3 */ -#define BT_8703B_1ANT_ANTDET_BUF_LEN 16 - -struct psdscan_sta_8703b_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_8703B_1ANT_ANTDET_BUF_LEN]; - u8 ant_det_peak_freq[BT_8703B_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_halbtc8703b1ant_power_on_setting(IN struct btc_coexist *btcoexist); -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); -void ex_halbtc8703b1ant_init_coex_dm(IN struct btc_coexist *btcoexist); -void ex_halbtc8703b1ant_ips_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8703b1ant_lps_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8703b1ant_scan_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8703b1ant_connect_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8703b1ant_media_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -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_rf_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8703b1ant_halt_notify(IN struct btc_coexist *btcoexist); -void ex_halbtc8703b1ant_pnp_notify(IN struct btc_coexist *btcoexist, - IN u8 pnp_state); -void ex_halbtc8703b1ant_coex_dm_reset(IN struct btc_coexist *btcoexist); -void ex_halbtc8703b1ant_periodical(IN struct btc_coexist *btcoexist); -void ex_halbtc8703b1ant_display_coex_info(IN struct btc_coexist *btcoexist); -void ex_halbtc8703b1ant_antenna_detection(IN struct btc_coexist *btcoexist, - IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); -void ex_halbtc8703b1ant_antenna_isolation(IN struct btc_coexist *btcoexist, - IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); - -void ex_halbtc8703b1ant_psd_scan(IN struct btc_coexist *btcoexist, - IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); -void ex_halbtc8703b1ant_display_ant_detection(IN struct btc_coexist *btcoexist); - -#else -#define ex_halbtc8703b1ant_power_on_setting(btcoexist) -#define ex_halbtc8703b1ant_pre_load_firmware(btcoexist) -#define ex_halbtc8703b1ant_init_hw_config(btcoexist, wifi_only) -#define ex_halbtc8703b1ant_init_coex_dm(btcoexist) -#define ex_halbtc8703b1ant_ips_notify(btcoexist, type) -#define ex_halbtc8703b1ant_lps_notify(btcoexist, type) -#define ex_halbtc8703b1ant_scan_notify(btcoexist, type) -#define ex_halbtc8703b1ant_connect_notify(btcoexist, type) -#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_rf_status_notify(btcoexist, type) -#define ex_halbtc8703b1ant_halt_notify(btcoexist) -#define ex_halbtc8703b1ant_pnp_notify(btcoexist, pnp_state) -#define ex_halbtc8703b1ant_coex_dm_reset(btcoexist) -#define ex_halbtc8703b1ant_periodical(btcoexist) -#define ex_halbtc8703b1ant_display_coex_info(btcoexist) -#define ex_halbtc8703b1ant_antenna_detection(btcoexist, cent_freq, offset, span, seconds) -#define ex_halbtc8703b1ant_antenna_isolation(btcoexist, cent_freq, offset, span, seconds) -#define ex_halbtc8703b1ant_psd_scan(btcoexist, cent_freq, offset, span, seconds) -#define ex_halbtc8703b1ant_display_ant_detection(btcoexist) - -#endif - - -#endif - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8723b1ant.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8723b1ant.c deleted file mode 100644 index c3de3d31ae87..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8723b1ant.c +++ /dev/null @@ -1,5114 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ -/* ************************************************************ - * 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 = 20161007; -u32 glcoex_ver_8723b_1ant = 0x69; -u32 glcoex_ver_btdesired_8723b_1ant = 0x69; - -/* ************************************************************ - * 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; - 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_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 (!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 { - /* 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; - - 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) */ - - 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, 0x3); - 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) { - 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 (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/rtl8188eu/hal/btc/halbtc8723b1ant.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8723b1ant.h deleted file mode 100644 index 9d610124b767..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8723b1ant.h +++ /dev/null @@ -1,294 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ - -#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/rtl8188eu/hal/btc/halbtc8723b2ant.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8723b2ant.c deleted file mode 100644 index f4f9a99f7b8b..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8723b2ant.c +++ /dev/null @@ -1,4959 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ -/* ************************************************************ - * 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 = 20161007; -u32 glcoex_ver_8723b_2ant = 0x4c; -u32 glcoex_ver_btdesired_8723b_2ant = 0x4c; - -/* ************************************************************ - * 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; - 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 ((coex_sta->a2dp_exist) && (coex_sta->hid_exist)) - byte5 = byte5 | 0x1; - - - 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 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 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 (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); - } - - /* 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/rtl8188eu/hal/btc/halbtc8723b2ant.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8723b2ant.h deleted file mode 100644 index 4b7da302fa34..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8723b2ant.h +++ /dev/null @@ -1,218 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ - -#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) - -#if (RTL8723B_SUPPORT == 1) -/* ******************************************* - * The following is for 8723B 2Ant BT Co-exist definition - * ******************************************* */ -#define BT_AUTO_REPORT_ONLY_8723B_2ANT 1 - - -#define BT_INFO_8723B_2ANT_B_FTP BIT(7) -#define BT_INFO_8723B_2ANT_B_A2DP BIT(6) -#define BT_INFO_8723B_2ANT_B_HID BIT(5) -#define BT_INFO_8723B_2ANT_B_SCO_BUSY BIT(4) -#define BT_INFO_8723B_2ANT_B_ACL_BUSY BIT(3) -#define BT_INFO_8723B_2ANT_B_INQ_PAGE BIT(2) -#define BT_INFO_8723B_2ANT_B_SCO_ESCO BIT(1) -#define BT_INFO_8723B_2ANT_B_CONNECTION BIT(0) - -#define BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT 2 - - -#define BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES 42 /* WiFi RSSI Threshold for 2-Ant TDMA/1-Ant PS-TDMA translation */ -#define BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES 46 /* BT RSSI Threshold for 2-Ant TDMA/1-Ant PS-TDMA translation */ - -enum bt_info_src_8723b_2ant { - BT_INFO_SRC_8723B_2ANT_WIFI_FW = 0x0, - BT_INFO_SRC_8723B_2ANT_BT_RSP = 0x1, - BT_INFO_SRC_8723B_2ANT_BT_ACTIVE_SEND = 0x2, - BT_INFO_SRC_8723B_2ANT_MAX -}; - -enum bt_8723b_2ant_bt_status { - BT_8723B_2ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, - BT_8723B_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, - BT_8723B_2ANT_BT_STATUS_INQ_PAGE = 0x2, - BT_8723B_2ANT_BT_STATUS_ACL_BUSY = 0x3, - BT_8723B_2ANT_BT_STATUS_SCO_BUSY = 0x4, - BT_8723B_2ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, - BT_8723B_2ANT_BT_STATUS_MAX -}; - -enum bt_8723b_2ant_coex_algo { - BT_8723B_2ANT_COEX_ALGO_UNDEFINED = 0x0, - BT_8723B_2ANT_COEX_ALGO_SCO = 0x1, - BT_8723B_2ANT_COEX_ALGO_HID = 0x2, - BT_8723B_2ANT_COEX_ALGO_A2DP = 0x3, - BT_8723B_2ANT_COEX_ALGO_A2DP_PANHS = 0x4, - BT_8723B_2ANT_COEX_ALGO_PANEDR = 0x5, - BT_8723B_2ANT_COEX_ALGO_PANHS = 0x6, - BT_8723B_2ANT_COEX_ALGO_PANEDR_A2DP = 0x7, - BT_8723B_2ANT_COEX_ALGO_PANEDR_HID = 0x8, - BT_8723B_2ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, - BT_8723B_2ANT_COEX_ALGO_HID_A2DP = 0xa, - BT_8723B_2ANT_COEX_ALGO_MAX = 0xb, -}; - -struct coex_dm_8723b_2ant { - /* 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 auto_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; -}; - -struct coex_sta_8723b_2ant { - boolean bt_disabled; - boolean bt_link_exist; - boolean sco_exist; - boolean a2dp_exist; - boolean hid_exist; - boolean pan_exist; - boolean bt_abnormal_scan; - 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; - 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_8723B_2ANT_MAX][10]; - u32 bt_info_c2h_cnt[BT_INFO_SRC_8723B_2ANT_MAX]; - boolean bt_whck_test; - boolean c2h_bt_inquiry_page; - boolean c2h_bt_remote_name_req; - 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; - - u32 bt_coex_supported_version; - - u8 coex_table_type; - boolean force_lps_on; - - u8 dis_ver_info_cnt; - - u8 a2dp_bit_pool; - u8 cut_version; -}; - -/* ******************************************* - * The following is interface which will notify coex module. - * ******************************************* */ -void ex_halbtc8723b2ant_power_on_setting(IN struct btc_coexist *btcoexist); -void ex_halbtc8723b2ant_pre_load_firmware(IN struct btc_coexist *btcoexist); -void ex_halbtc8723b2ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean wifi_only); -void ex_halbtc8723b2ant_init_coex_dm(IN struct btc_coexist *btcoexist); -void ex_halbtc8723b2ant_ips_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8723b2ant_lps_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8723b2ant_scan_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8723b2ant_connect_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8723b2ant_media_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8723b2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8723b2ant_bt_info_notify(IN struct btc_coexist *btcoexist, - IN u8 *tmp_buf, IN u8 length); -void ex_halbtc8723b2ant_halt_notify(IN struct btc_coexist *btcoexist); -void ex_halbtc8723b2ant_pnp_notify(IN struct btc_coexist *btcoexist, - IN u8 pnp_state); -void ex_halbtc8723b2ant_periodical(IN struct btc_coexist *btcoexist); -void ex_halbtc8723b2ant_display_coex_info(IN struct btc_coexist *btcoexist); - -#else -#define ex_halbtc8723b2ant_power_on_setting(btcoexist) -#define ex_halbtc8723b2ant_pre_load_firmware(btcoexist) -#define ex_halbtc8723b2ant_init_hw_config(btcoexist, wifi_only) -#define ex_halbtc8723b2ant_init_coex_dm(btcoexist) -#define ex_halbtc8723b2ant_ips_notify(btcoexist, type) -#define ex_halbtc8723b2ant_lps_notify(btcoexist, type) -#define ex_halbtc8723b2ant_scan_notify(btcoexist, type) -#define ex_halbtc8723b2ant_connect_notify(btcoexist, type) -#define ex_halbtc8723b2ant_media_status_notify(btcoexist, type) -#define ex_halbtc8723b2ant_specific_packet_notify(btcoexist, type) -#define ex_halbtc8723b2ant_bt_info_notify(btcoexist, tmp_buf, length) -#define ex_halbtc8723b2ant_halt_notify(btcoexist) -#define ex_halbtc8723b2ant_pnp_notify(btcoexist, pnp_state) -#define ex_halbtc8723b2ant_periodical(btcoexist) -#define ex_halbtc8723b2ant_display_coex_info(btcoexist) - -#endif - -#endif - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8723bwifionly.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8723bwifionly.c deleted file mode 100644 index 87989e1eb48c..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8723bwifionly.c +++ /dev/null @@ -1,69 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ -#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/rtl8188eu/hal/btc/halbtc8723bwifionly.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8723bwifionly.h deleted file mode 100644 index 8e5cf17a93d9..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8723bwifionly.h +++ /dev/null @@ -1,9 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ -#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/rtl8188eu/hal/btc/halbtc8723d1ant.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8723d1ant.c deleted file mode 100644 index 7af3c87d1719..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8723d1ant.c +++ /dev/null @@ -1,6226 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ -/* ************************************************************ - * Description: - * - * This file is for RTL8723D 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 (RTL8723D_SUPPORT == 1) -/* ************************************************************ - * Global variables, these are static variables - * ************************************************************ */ -static u8 *trace_buf = &gl_btc_trace_buf[0]; -static struct coex_dm_8723d_1ant glcoex_dm_8723d_1ant; -static struct coex_dm_8723d_1ant *coex_dm = &glcoex_dm_8723d_1ant; -static struct coex_sta_8723d_1ant glcoex_sta_8723d_1ant; -static struct coex_sta_8723d_1ant *coex_sta = &glcoex_sta_8723d_1ant; -static struct psdscan_sta_8723d_1ant gl_psd_scan_8723d_1ant; -static struct psdscan_sta_8723d_1ant *psd_scan = &gl_psd_scan_8723d_1ant; - - -const char *const glbt_info_src_8723d_1ant[] = { - "BT Info[wifi fw]", - "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_8723d_1ant = 20161027; -u32 glcoex_ver_8723d_1ant = 0x0f; -u32 glcoex_ver_btdesired_8723d_1ant = 0x0d; - - -/* ************************************************************ - * local function proto type if needed - * ************************************************************ - * ************************************************************ - * local function start with halbtc8723d1ant_ - * ************************************************************ */ -u8 halbtc8723d1ant_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_8723D_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_8723D_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_8723D_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 halbtc8723d1ant_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_8723D_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_8723D_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_8723D_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 halbtc8723d1ant_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 halbtc8723d1ant_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 halbtc8723d1ant_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 halbtc8723d1ant_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 halbtc8723d1ant_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 */ - halbtc8723d1ant_update_ra_mask(btcoexist, force_exec, - 0x0); - break; - case 1: /* disable cck 1/2 */ - halbtc8723d1ant_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 */ - halbtc8723d1ant_update_ra_mask(btcoexist, force_exec, - 0x0001f1f7); - break; - default: - break; - } - - halbtc8723d1ant_auto_rate_fallback_retry(btcoexist, force_exec, - arfr_type); - halbtc8723d1ant_retry_limit(btcoexist, force_exec, retry_limit_type); - halbtc8723d1ant_ampdu_max_time(btcoexist, force_exec, ampdu_time_type); -} - -void halbtc8723d1ant_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 halbtc8723d1ant_query_bt_info(IN struct btc_coexist *btcoexist) -{ - u8 h2c_parameter[1] = {0}; - - 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 halbtc8723d1ant_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; - - if (BT_8723D_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; - } - } - - 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 >= 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->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) { - halbtc8723d1ant_query_bt_info(btcoexist); - num_of_bt_counter_chk = 0; - } - } - } - -} - -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; - - 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_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 -} - - - -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 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->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; - } - - return false; -} - -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; - - - 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; - } else { /* connection exists */ - coex_sta->bt_link_exist = true; - if (coex_sta->bt_info & BT_INFO_8723D_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_8723D_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_8723D_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_8723D_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_8723D_1ANT_B_INQ_PAGE) { - coex_dm->bt_status = BT_8723D_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_8723D_1ANT_B_CONNECTION)) { - coex_dm->bt_status = BT_8723D_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_8723D_1ANT_B_CONNECTION) { - /* connection exists but no busy */ - coex_dm->bt_status = BT_8723D_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_8723D_1ANT_B_SCO_ESCO) || - (coex_sta->bt_info & BT_INFO_8723D_1ANT_B_SCO_BUSY)) && - (coex_sta->bt_info & BT_INFO_8723D_1ANT_B_ACL_BUSY)) { - coex_dm->bt_status = BT_8723D_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_8723D_1ANT_B_SCO_ESCO) || - (coex_sta->bt_info & BT_INFO_8723D_1ANT_B_SCO_BUSY)) { - coex_dm->bt_status = BT_8723D_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_8723D_1ANT_B_ACL_BUSY) { - coex_dm->bt_status = BT_8723D_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_8723D_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_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; - else - bt_busy = false; - - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); -} - - -void halbtc8723d1ant_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 8723d 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 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; - u8 algorithm = BT_8723D_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_8723D_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_8723D_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_8723D_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_8723D_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_8723D_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_8723D_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_8723D_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_8723D_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_8723D_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_8723D_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_8723D_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_8723D_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_8723D_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_8723D_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_8723D_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_8723D_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_8723D_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_8723D_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_8723D_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_8723D_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_8723D_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_8723D_1ANT_COEX_ALGO_PANEDR_HID; - } - } - } - } - - return algorithm; -} - -void halbtc8723d1ant_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 halbtc8723d1ant_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; - } - halbtc8723d1ant_set_bt_auto_report(btcoexist, - coex_dm->cur_bt_auto_report); - - coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; -} - -void halbtc8723d1ant_set_fw_low_penalty_ra(IN struct btc_coexist - *btcoexist, IN boolean low_penalty_ra) -{ -#if 1 - 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); -#endif -} - -void halbtc8723d1ant_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; - } - - halbtc8723d1ant_set_fw_low_penalty_ra(btcoexist, - coex_dm->cur_low_penalty_ra); - -#if 0 - 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); -#endif - coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; - -#endif - -} - -void halbtc8723d1ant_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 halbtc8723d1ant_read_score_board( - IN struct btc_coexist *btcoexist, - IN u16 *score_board_val -) -{ - - *score_board_val = (btcoexist->btc_read_2byte(btcoexist, - 0xaa)) & 0x7fff; -} - -void halbtc8723d1ant_post_state_to_bt( - IN struct btc_coexist *btcoexist, - IN u16 type, - IN boolean state -) -{ - halbtc8723d1ant_write_score_board(btcoexist, (u16) type, state); -} - -void halbtc8723d1ant_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 */ - halbtc8723d1ant_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 (bt_disabled) - halbtc8723d1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, false); - else - halbtc8723d1ant_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 halbtc8723d1ant_enable_gnt_to_gpio(IN struct btc_coexist *btcoexist, - boolean isenable) -{ -#if BT_8723D_1ANT_COEX_DBG - if (isenable) { - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x1); - - /* enable GNT_BT to GPIO debug */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x40, 0x0); - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x1, 0x0); - - /* 0x48[20] = 0 for GPIO14 = GNT_WL*/ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4a, 0x10, 0x0); - /* 0x40[17] = 0 for GPIO14 = GNT_WL*/ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, 0x02, 0x0); - - /* 0x66[9] = 0 for GPIO15 = GNT_B T*/ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x02, 0x0); - /* 0x66[7] = 0 - for GPIO15 = GNT_BT*/ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, 0x80, 0x0); - /* 0x8[8] = 0 for GPIO15 = GNT_BT*/ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x9, 0x1, 0x0); - - /* BT Vendor Reg 0x76[0] = 0 for GPIO15 = GNT_BT, this is not set here*/ - } else { - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x0); - - /* Disable GNT_BT debug to GPIO, and enable chip_wakeup_host */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x40, 0x1); - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x1, 0x1); - - /* 0x48[20] = 0 for GPIO14 = GNT_WL*/ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4a, 0x10, 0x1); - } - -#endif -} - -u32 halbtc8723d1ant_ltecoex_indirect_read_reg(IN struct btc_coexist *btcoexist, - IN u16 reg_addr) -{ - u32 j = 0; - - - /* 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_8723D_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); - - - return btcoexist->btc_read_4byte(btcoexist, - 0x7c8); /* get read data */ - -} - -void halbtc8723d1ant_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, 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_8723D_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); - - - btcoexist->btc_write_4byte(btcoexist, 0x7c0, - 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 = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, - reg_addr); - val = (val & (~bit_mask)) | (reg_value << bitpos); - - 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_8723D_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); - - - btcoexist->btc_write_4byte(btcoexist, 0x7c0, - 0xc00F0000 | reg_addr); - - } - -} - -void halbtc8723d1ant_ltecoex_enable(IN struct btc_coexist *btcoexist, - IN boolean enable) -{ - u8 val; - - val = (enable) ? 1 : 0; - halbtc8723d1ant_ltecoex_indirect_write_reg(btcoexist, 0x38, 0x80, - val); /* 0x38[7] */ - -} - -void halbtc8723d1ant_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 halbtc8723d1ant_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 = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, - 0x38); - - switch (control_block) { - case BT_8723D_1ANT_GNT_BLOCK_RFC_BB: - default: - val = ((val << 14) | (val << 10)) | (val_orig & 0xffff33ff); - break; - case BT_8723D_1ANT_GNT_BLOCK_RFC: - val = (val << 14) | (val_orig & 0xffff3fff); - break; - case BT_8723D_1ANT_GNT_BLOCK_BB: - val = (val << 10) | (val_orig & 0xfffff3ff); - break; - } - - halbtc8723d1ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, 0xffffffff, val); -} - - -void halbtc8723d1ant_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 = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, - 0x38); - - switch (control_block) { - case BT_8723D_1ANT_GNT_BLOCK_RFC_BB: - default: - val = ((val << 12) | (val << 8)) | (val_orig & 0xffffccff); - break; - case BT_8723D_1ANT_GNT_BLOCK_RFC: - val = (val << 12) | (val_orig & 0xffffcfff); - break; - case BT_8723D_1ANT_GNT_BLOCK_BB: - val = (val << 8) | (val_orig & 0xfffffcff); - break; - } - - halbtc8723d1ant_ltecoex_indirect_write_reg(btcoexist, 0x38, - 0xffffffff, val); -} - - -void halbtc8723d1ant_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_8723D_1ANT_CTT_WL_VS_LTE: - reg_addr = 0xa0; - break; - case BT_8723D_1ANT_CTT_BT_VS_LTE: - reg_addr = 0xa4; - break; - } - - if (reg_addr != 0x0000) - halbtc8723d1ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, - 0xffff, table_content); /* 0xa0[15:0] or 0xa4[15:0] */ - - -} - - -void halbtc8723d1ant_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_8723D_1ANT_LBTT_WL_BREAK_LTE: - reg_addr = 0xa8; - break; - case BT_8723D_1ANT_LBTT_BT_BREAK_LTE: - reg_addr = 0xac; - break; - case BT_8723D_1ANT_LBTT_LTE_BREAK_WL: - reg_addr = 0xb0; - break; - case BT_8723D_1ANT_LBTT_LTE_BREAK_BT: - reg_addr = 0xb4; - break; - } - - if (reg_addr != 0x0000) - halbtc8723d1ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, - 0xff, table_content); /* 0xa8[15:0] or 0xb4[15:0] */ - -} - -void halbtc8723d1ant_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 halbtc8723d1ant_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 halbtc8723d1ant_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; - } - - halbtc8723d1ant_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 halbtc8723d1ant_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: - 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, - 0xaa555555, 0xaa5a5a5a, 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, - 0xaaaaaaaa, 0xaaaaaaaa, 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; - } -} - -void halbtc8723d1ant_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 halbtc8723d1ant_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; - } - halbtc8723d1ant_set_fw_ignore_wlan_act(btcoexist, enable); - - coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; -} - -void halbtc8723d1ant_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 halbtc8723d1ant_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; - } - halbtc8723d1ant_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 halbtc8723d1ant_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 */ - /*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 { - /* keep state under NO PS state, do nothing. */ - } - } -} - -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; - - 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; - halbtc8723d1ant_ps_tdma_check_for_power_save_state( - 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; - 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; - halbtc8723d1ant_ps_tdma_check_for_power_save_state( - btcoexist, false); - btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, - NULL); - - break; - default: - break; - } -} - - -void halbtc8723d1ant_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; - 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) { - 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); - - real_byte5 |= BIT(5); - real_byte5 &= ~BIT(6); - - halbtc8723d1ant_power_save_state(btcoexist, - BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - } - } else if (byte1 & BIT(4) && !(byte1 & BIT(5))) { - - halbtc8723d1ant_power_save_state( - btcoexist, BTC_PS_LPS_ON, 0x50, - 0x4); - } else { - halbtc8723d1ant_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 halbtc8723d1ant_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_8723D_1ANT_ANTDET_ENABLE - - if (board_info->btdm_ant_num_by_ant_det == 2) { -#if 0 - if (turn_on) - type = type + - 100; -#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); - - 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: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0x61, 0x35, 0x03, 0x11, 0x11); - break; - case 3: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0x51, 0x3a, 0x03, 0x10, 0x50); - break; - case 4: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0x51, 0x21, 0x03, 0x10, 0x50); - break; - case 5: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0x61, 0x15, 0x03, 0x11, 0x11); - break; - case 6: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0x61, 0x20, 0x03, 0x11, 0x11); - break; - case 7: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0x51, 0x10, 0x03, 0x10, 0x54 | - psTdmaByte4Modify); - break; - case 8: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0x51, 0x10, 0x03, 0x10, 0x54 | - psTdmaByte4Modify); - break; - case 9: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0x55, 0x10, 0x03, 0x10, 0x54 | - psTdmaByte4Modify); - break; - case 10: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0x61, 0x30, 0x03, 0x11, 0x10); - break; - case 11: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0x65, 0x25, 0x03, 0x11, 0x11 | - psTdmaByte4Modify); - break; - case 12: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0x55, 0x30, 0x03, 0x10, 0x50 | - psTdmaByte4Modify); - break; - case 13: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0x51, 0x25, 0x03, 0x10, 0x50 | - psTdmaByte4Modify); - break; - case 14: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0x51, 0x15, 0x03, 0x10, 0x50 | - psTdmaByte4Modify); - break; - case 15: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0x51, 0x20, 0x03, 0x10, 0x50 | - psTdmaByte4Modify); - break; - case 16: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0x61, 0x10, 0x03, 0x11, 0x15 | - psTdmaByte4Modify); - break; - case 17: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0x61, 0x10, 0x03, 0x11, 0x14); - break; - case 18: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0x51, 0x30, 0x03, 0x10, 0x50 | - psTdmaByte4Modify); - break; - case 19: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0x61, 0x15, 0x03, 0x11, 0x10); - break; - case 20: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0x61, 0x30, 0x03, 0x11, 0x10); - break; - case 21: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0x61, 0x30, 0x03, 0x11, 0x10); - break; - case 22: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0x61, 0x25, 0x03, 0x11, 0x10); - break; - case 23: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0x61, 0x10, 0x03, 0x11, 0x10); - break; - case 32: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0x61, 0x35, 0x03, 0x11, 0x11); - break; - case 33: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0x61, 0x35, 0x03, 0x11, 0x10); - break; - case 57: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0x51, 0x10, 0x03, 0x10, 0x50 | - psTdmaByte4Modify); - break; - case 58: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0x51, 0x10, 0x03, 0x10, 0x50 | - psTdmaByte4Modify); - break; - case 67: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0x61, 0x10, 0x03, 0x11, 0x10 | - psTdmaByte4Modify); - break; - /* 1-Ant to 2-Ant TDMA case */ - case 103: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0xd3, 0x3a, 0x03, 0x70, 0x10); - break; - case 104: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0xd3, 0x21, 0x03, 0x70, 0x10); - break; - case 105: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0xe3, 0x15, 0x03, 0x71, 0x11); - break; - case 106: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0xe3, 0x20, 0x03, 0x71, 0x11); - break; - case 107: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0xd3, 0x10, 0x03, 0x70, 0x14 | - psTdmaByte4Modify); - break; - case 108: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0xd3, 0x10, 0x03, 0x70, 0x14 | - psTdmaByte4Modify); - break; - case 113: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0xd3, 0x25, 0x03, 0x70, 0x10 | - psTdmaByte4Modify); - break; - case 114: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0xd3, 0x15, 0x03, 0x70, 0x10 | - psTdmaByte4Modify); - break; - case 115: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0xd3, 0x20, 0x03, 0x70, 0x10 | - psTdmaByte4Modify); - break; - case 117: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0xe3, 0x10, 0x03, 0x71, 0x14 | - psTdmaByte4Modify); - break; - case 119: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0xe3, 0x15, 0x03, 0x71, 0x10); - break; - case 120: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0xe3, 0x30, 0x03, 0x71, 0x10); - break; - case 121: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0xe3, 0x30, 0x03, 0x71, 0x10); - break; - case 122: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0xe3, 0x25, 0x03, 0x71, 0x10); - break; - case 132: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0xe3, 0x35, 0x03, 0x71, 0x11); - break; - case 133: - halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0xe3, 0x35, 0x03, 0x71, 0x10); - break; - } - } else { - - /* disable PS tdma */ - switch (type) { - case 8: /* PTA Control */ - halbtc8723d1ant_set_fw_pstdma(btcoexist, 0x8, - 0x0, 0x0, 0x0, 0x0); - break; - case 0: - default: /* Software control, Antenna at BT side */ - halbtc8723d1ant_set_fw_pstdma(btcoexist, 0x0, - 0x0, 0x0, 0x0, 0x0); - break; - case 1: /* 2-Ant, 0x778=3, antenna control by antenna diversity */ - halbtc8723d1ant_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 halbtc8723d1ant_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, is_hw_ant_div_on = false; - u8 u8tmp0 = 0, u8tmp1 = 0; - u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; - u16 u16tmp0, u16tmp1 = 0; - -#if BT_8723D_1ANT_ANTDET_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 - - u32tmp1 = halbtc8723d1ant_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_8723D_1ANT_COEX_DBG - u32tmp2 = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); - u16tmp0 = btcoexist->btc_read_2byte(btcoexist, 0xaa); - u16tmp1 = btcoexist->btc_read_2byte(btcoexist, 0x948); - u8tmp1 = btcoexist->btc_read_1byte(btcoexist, 0x73); - u8tmp0 = btcoexist->btc_read_1byte(btcoexist, 0x67); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** 0x67 = 0x%x, 0x948 = 0x%x, 0x73 = 0x%x(Before Set Ant Pat)\n", - u8tmp0, u16tmp1, u8tmp1); - BTC_TRACE(trace_buf); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], **********0x38= 0x%x, 0x54= 0x%x, 0xaa = 0x%x(Before Set Ant Path)\n", - u32tmp1, u32tmp2, u16tmp0); - BTC_TRACE(trace_buf); -#endif - - 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_8723D_1ANT_PHASE_COEX_POWERON: - /* Set Path control to WL */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, - 0x80, 0x0); - - /* set Path control owner to WL at initial step */ - halbtc8723d1ant_ltecoex_pathcontrol_owner(btcoexist, - BT_8723D_1ANT_PCO_BTSIDE); - - /* set GNT_BT to SW high */ - halbtc8723d1ant_ltecoex_set_gnt_bt(btcoexist, - BT_8723D_1ANT_GNT_BLOCK_RFC_BB, - BT_8723D_1ANT_GNT_TYPE_CTRL_BY_SW, - BT_8723D_1ANT_SIG_STA_SET_TO_HIGH); - /* Set GNT_WL to SW low */ - halbtc8723d1ant_ltecoex_set_gnt_wl(btcoexist, - BT_8723D_1ANT_GNT_BLOCK_RFC_BB, - BT_8723D_1ANT_GNT_TYPE_CTRL_BY_SW, - BT_8723D_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_8723D_1ANT_PHASE_COEX_INIT: - /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ - halbtc8723d1ant_ltecoex_enable(btcoexist, 0x0); - - /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ - halbtc8723d1ant_ltecoex_set_coex_table(btcoexist, - BT_8723D_1ANT_CTT_WL_VS_LTE, 0xffff); - - /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ - halbtc8723d1ant_ltecoex_set_coex_table(btcoexist, - BT_8723D_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) { - u8tmp0 = btcoexist->btc_read_1byte(btcoexist, - 0x49d); - cnt_bt_cal_chk++; - if (u8tmp0 & 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], ********** WL is NOT calibrating (wait cnt=%d)**********\n", - cnt_bt_cal_chk); - BTC_TRACE(trace_buf); - break; - } - } - - /* Set Path control to WL */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, - 0x80, 0x1); - - /* set Path control owner to WL at initial step */ - halbtc8723d1ant_ltecoex_pathcontrol_owner(btcoexist, - BT_8723D_1ANT_PCO_WLSIDE); - - /* set GNT_BT to SW high */ - halbtc8723d1ant_ltecoex_set_gnt_bt(btcoexist, - BT_8723D_1ANT_GNT_BLOCK_RFC_BB, - BT_8723D_1ANT_GNT_TYPE_CTRL_BY_SW, - BT_8723D_1ANT_SIG_STA_SET_TO_HIGH); - /* Set GNT_WL to SW low */ - halbtc8723d1ant_ltecoex_set_gnt_wl(btcoexist, - BT_8723D_1ANT_GNT_BLOCK_RFC_BB, - BT_8723D_1ANT_GNT_TYPE_CTRL_BY_SW, - BT_8723D_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_8723D_1ANT_PHASE_WLANONLY_INIT: - /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ - halbtc8723d1ant_ltecoex_enable(btcoexist, 0x0); - - /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ - halbtc8723d1ant_ltecoex_set_coex_table(btcoexist, - BT_8723D_1ANT_CTT_WL_VS_LTE, 0xffff); - - /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ - halbtc8723d1ant_ltecoex_set_coex_table(btcoexist, - BT_8723D_1ANT_CTT_BT_VS_LTE, 0xffff); - - /* Set Path control to WL */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, - 0x80, 0x1); - - /* set Path control owner to WL at initial step */ - halbtc8723d1ant_ltecoex_pathcontrol_owner(btcoexist, - BT_8723D_1ANT_PCO_WLSIDE); - - /* set GNT_BT to SW low */ - halbtc8723d1ant_ltecoex_set_gnt_bt(btcoexist, - BT_8723D_1ANT_GNT_BLOCK_RFC_BB, - BT_8723D_1ANT_GNT_TYPE_CTRL_BY_SW, - BT_8723D_1ANT_SIG_STA_SET_TO_LOW); - /* Set GNT_WL to SW high */ - halbtc8723d1ant_ltecoex_set_gnt_wl(btcoexist, - BT_8723D_1ANT_GNT_BLOCK_RFC_BB, - BT_8723D_1ANT_GNT_TYPE_CTRL_BY_SW, - BT_8723D_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_8723D_1ANT_PHASE_WLAN_OFF: - /* Disable LTE Coex Function in WiFi side */ - halbtc8723d1ant_ltecoex_enable(btcoexist, 0x0); - - /* Set Path control to BT */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, - 0x80, 0x0); - - /* set Path control owner to BT */ - halbtc8723d1ant_ltecoex_pathcontrol_owner(btcoexist, - BT_8723D_1ANT_PCO_BTSIDE); - - if (BTC_ANT_PATH_AUTO == ant_pos_type) - ant_pos_type = BTC_ANT_PATH_BT; - - coex_sta->run_time_state = false; - break; - case BT_8723D_1ANT_PHASE_2G_RUNTIME: - - /* wait for WL/BT IQK finish, keep 0x38 = 0xff00 for WL IQK */ - while (cnt_bt_cal_chk <= 20) { - u8tmp0 = btcoexist->btc_read_1byte(btcoexist, - 0x1e6); - - u8tmp1 = btcoexist->btc_read_1byte(btcoexist, - 0x49d); - - cnt_bt_cal_chk++; - if ((u8tmp0 & BIT(0)) || (u8tmp1 & BIT(0))) { - BTC_SPRINTF(trace_buf, - BT_TMP_BUF_SIZE, - "[BTCoex], ########### WL or 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 to WL */ - /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x80, 0x1); */ - - halbtc8723d1ant_ltecoex_pathcontrol_owner(btcoexist, - BT_8723D_1ANT_PCO_WLSIDE); - - /* set GNT_BT to PTA */ - halbtc8723d1ant_ltecoex_set_gnt_bt(btcoexist, - BT_8723D_1ANT_GNT_BLOCK_RFC_BB, - BT_8723D_1ANT_GNT_TYPE_CTRL_BY_PTA, - BT_8723D_1ANT_SIG_STA_SET_BY_HW); - /* Set GNT_WL to PTA */ - halbtc8723d1ant_ltecoex_set_gnt_wl(btcoexist, - BT_8723D_1ANT_GNT_BLOCK_RFC_BB, - BT_8723D_1ANT_GNT_TYPE_CTRL_BY_PTA, - BT_8723D_1ANT_SIG_STA_SET_BY_HW); - - if (BTC_ANT_PATH_AUTO == ant_pos_type) - ant_pos_type = BTC_ANT_PATH_PTA; - - coex_sta->run_time_state = true; - break; - case BT_8723D_1ANT_PHASE_BTMPMODE: - halbtc8723d1ant_ltecoex_pathcontrol_owner(btcoexist, - BT_8723D_1ANT_PCO_WLSIDE); - - /* Set Path control to WL */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, - 0x80, 0x1); - - /* set GNT_BT to high */ - halbtc8723d1ant_ltecoex_set_gnt_bt(btcoexist, - BT_8723D_1ANT_GNT_BLOCK_RFC_BB, - BT_8723D_1ANT_GNT_TYPE_CTRL_BY_SW, - BT_8723D_1ANT_SIG_STA_SET_TO_HIGH); - /* Set GNT_WL to low */ - halbtc8723d1ant_ltecoex_set_gnt_wl(btcoexist, - BT_8723D_1ANT_GNT_BLOCK_RFC_BB, - BT_8723D_1ANT_GNT_TYPE_CTRL_BY_SW, - BT_8723D_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; - case BT_8723D_1ANT_PHASE_ANTENNA_DET: - halbtc8723d1ant_ltecoex_pathcontrol_owner(btcoexist, - BT_8723D_1ANT_PCO_WLSIDE); - - /* Set Path control to WL */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, - 0x80, 0x1); - - /* set GNT_BT to high */ - halbtc8723d1ant_ltecoex_set_gnt_bt(btcoexist, - BT_8723D_1ANT_GNT_BLOCK_RFC_BB, - BT_8723D_1ANT_GNT_TYPE_CTRL_BY_SW, - BT_8723D_1ANT_SIG_STA_SET_TO_HIGH); - /* Set GNT_WL to high */ - halbtc8723d1ant_ltecoex_set_gnt_wl(btcoexist, - BT_8723D_1ANT_GNT_BLOCK_RFC_BB, - BT_8723D_1ANT_GNT_TYPE_CTRL_BY_SW, - BT_8723D_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; - } - - - is_hw_ant_div_on = board_info->ant_div_cfg; - - if ((is_hw_ant_div_on) && (phase != BT_8723D_1ANT_PHASE_ANTENNA_DET)) - - if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) - /* 0x948 = 0x200, 0x0 while antenna diversity */ - btcoexist->btc_write_2byte(btcoexist, 0x948, 0x100); - else /* 0x948 = 0x80, 0x0 while antenna diversity */ - btcoexist->btc_write_2byte(btcoexist, 0x948, 0x40); - - else if ((is_hw_ant_div_on == false) && - (phase != BT_8723D_1ANT_PHASE_WLAN_OFF)) { /* 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_2byte( - btcoexist, 0x948, 0x0); - else - btcoexist->btc_write_2byte( - btcoexist, 0x948, 0x280); - - break; - case BTC_ANT_PATH_BT: - if (board_info->btdm_ant_pos == - BTC_ANTENNA_AT_MAIN_PORT) - - btcoexist->btc_write_2byte( - btcoexist, 0x948, 0x280); - else - btcoexist->btc_write_2byte( - btcoexist, 0x948, 0x0); - - break; - default: - case BTC_ANT_PATH_PTA: - if (board_info->btdm_ant_pos == - BTC_ANTENNA_AT_MAIN_PORT) - btcoexist->btc_write_2byte( - btcoexist, 0x948, - 0x200); - else - btcoexist->btc_write_2byte( - btcoexist, 0x948, 0x80); - break; - } - } - - -#if BT_8723D_1ANT_COEX_DBG - u32tmp1 = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); - u32tmp2 = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); - u16tmp0 = btcoexist->btc_read_2byte(btcoexist, 0xaa); - u16tmp1 = btcoexist->btc_read_2byte(btcoexist, 0x948); - u8tmp1 = btcoexist->btc_read_1byte(btcoexist, 0x73); - u8tmp0 = btcoexist->btc_read_1byte(btcoexist, 0x67); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** 0x67 = 0x%x, 0x948 = 0x%x, 0x73 = 0x%x(After Set Ant Pat)\n", - u8tmp0, u16tmp1, u8tmp1); - BTC_TRACE(trace_buf); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], **********0x38= 0x%x, 0x54= 0x%x, 0xaa = 0x%x(After Set Ant Path)\n", - u32tmp1, u32tmp2, u16tmp0); - BTC_TRACE(trace_buf); -#endif - -} - - -boolean halbtc8723d1ant_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_8723D_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_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; - } 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; - } 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; - } 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; - } 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; -} - - -/* ********************************************* - * - * Non-Software Coex Mechanism start - * - * ********************************************* */ -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); -} - -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); -} - -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; -} - -void halbtc8723d1ant_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) { - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - } else { - /* if wl busy */ - if (BT_8723D_1ANT_BT_STATUS_NON_CONNECTED_IDLE == - coex_dm->bt_status) { - halbtc8723d1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 8); - - 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); - } -} - -} - -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; - - 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); - - 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); - else - 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); - } else if (bt_link_info->pan_exist) { - - 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, 16); - - halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } 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); - } -} - - -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; - 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); - - - 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); - } 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); - - } - } - } else { - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 6); - halbtc8723d1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 3); - } -} - - -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); -} - -void halbtc8723d1ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - - 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_link_info->pan_exist) - halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - else - halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -} - -void halbtc8723d1ant_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) { - - 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, 17); - - 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); - } -} - -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; - - 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); - -#if 1 - if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) - wifi_turbo = true; -#endif - - 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); - - /*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); - - } else if (bt_link_info->a2dp_only) { /* A2DP */ - if (!wifi_busy) { - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 32); - 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_turbo) - halbtc8723d1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 8); - else - halbtc8723d1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } - } 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 ((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); - 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); - 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 - halbtc8723d1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } 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); - } - - } 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_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); - 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); - else - halbtc8723d1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } - } else { - /* BT no-profile busy (0x9) */ - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); - halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } -} - -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); - halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -} - - -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; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], CoexForWifiConnect()===>\n"); - BTC_TRACE(trace_buf); - - halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, - NORMAL_EXEC, - BT_8723D_1ANT_PHASE_2G_RUNTIME); - - if (BT_8723D_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { - - 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); -} - - -void halbtc8723d1ant_run_sw_coexist_mechanism(IN struct btc_coexist *btcoexist) -{ - u8 algorithm = 0; - - algorithm = halbtc8723d1ant_action_algorithm(btcoexist); - coex_dm->cur_algorithm = algorithm; - - if (halbtc8723d1ant_is_common_action(btcoexist)) { - - } else { - switch (coex_dm->cur_algorithm) { - case BT_8723D_1ANT_COEX_ALGO_SCO: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = SCO.\n"); - BTC_TRACE(trace_buf); - break; - case BT_8723D_1ANT_COEX_ALGO_HID: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = HID.\n"); - BTC_TRACE(trace_buf); - break; - case BT_8723D_1ANT_COEX_ALGO_A2DP: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = A2DP.\n"); - BTC_TRACE(trace_buf); - break; - case BT_8723D_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_8723D_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_8723D_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_8723D_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_8723D_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_8723D_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_8723D_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 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; - 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); - - 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; - } - - 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"); - BTC_TRACE(trace_buf); - halbtc8723d1ant_action_bt_whql_test(btcoexist); - return; - } - - if (coex_sta->bt_disabled) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is disabled !!!\n"); - halbtc8723d1ant_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); - halbtc8723d1ant_action_bt_inquiry(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 ((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; - - 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); - - halbtc8723d1ant_limited_rx(btcoexist, NORMAL_EXEC, false, - false, 0x5); - - 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); - - halbtc8723d1ant_action_wifi_linkscan_process(btcoexist); - } else - 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); - 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) - halbtc8723d1ant_limited_rx(btcoexist, - 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); - } - - halbtc8723d1ant_run_sw_coexist_mechanism( - btcoexist); /* just print debug message */ - - 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); - halbtc8723d1ant_action_bt_hs(btcoexist); - return; - } - - if ((BT_8723D_1ANT_BT_STATUS_NON_CONNECTED_IDLE == - coex_dm->bt_status) || - (BT_8723D_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); - halbtc8723d1ant_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); - - halbtc8723d1ant_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); - - halbtc8723d1ant_action_wifi_connected(btcoexist); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], wifi is under not-connected!!\n"); - BTC_TRACE(trace_buf); - - halbtc8723d1ant_action_wifi_not_connected(btcoexist); - } -} - - -void halbtc8723d1ant_init_coex_dm(IN struct btc_coexist *btcoexist) -{ - /* force to reset coex mechanism */ - halbtc8723d1ant_low_penalty_ra(btcoexist, NORMAL_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; - - halbtc8723d1ant_query_bt_info(btcoexist); -} - -void halbtc8723d1ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean back_up, IN boolean wifi_only) -{ - u32 u32tmp1 = 0, u32tmp2 = 0; - u16 u16tmp1 = 0; - u8 u8tmp0 = 0, u8tmp1 = 0; - struct btc_board_info *board_info = &btcoexist->board_info; - u8 i = 0; - - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], 1Ant Init HW Config!!\n"); - BTC_TRACE(trace_buf); - -#if BT_8723D_1ANT_COEX_DBG - u32tmp1 = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, - 0x38); - u32tmp2 = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, - 0x54); - u16tmp1 = btcoexist->btc_read_2byte(btcoexist, 0x948); - u8tmp1 = btcoexist->btc_read_1byte(btcoexist, 0x73); - u8tmp0 = btcoexist->btc_read_1byte(btcoexist, 0x67); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** 0x67 = 0x%x, 0x948 = 0x%x, 0x73 = 0x%x(Before init_hw_config)\n", - u8tmp0, u16tmp1, u8tmp1); - BTC_TRACE(trace_buf); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], **********0x38= 0x%x, 0x54= 0x%x (Before init_hw_config)\n", - u32tmp1, u32tmp2); - BTC_TRACE(trace_buf); -#endif - - - 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_8723D_1ANT_DEFAULT_ISOLATION; - coex_sta->gnt_error_cnt = 0; - coex_sta->bt_relink_downcount = 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; - - 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); - - halbtc8723d1ant_enable_gnt_to_gpio(btcoexist, true); - - /* 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); - - /* 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; - - /* Antenna config */ - 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; - } 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_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); - halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8723D_1ANT_PHASE_COEX_INIT); - - btcoexist->stop_coex_dm = false; - } - - if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** Single Antenna, Antenna at Main Port: S1**********\n"); - BTC_TRACE(trace_buf); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** Single Antenna, Antenna at Aux Port: S0**********\n"); - BTC_TRACE(trace_buf); - } - -} - -u32 halbtc8723d1ant_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 halbtc8723d1ant_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 == 12) { /* Get Ant Det from BT */ - - if (board_info->btdm_ant_num_by_ant_det == 1) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %s (%d~%d)", - "Ant Det Result", "1-Antenna", - BT_8723D_1ANT_ANTDET_PSDTHRES_1ANT, - BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION); - else { - - if (psd_scan->ant_det_psd_scan_peak_val > - (BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION) - * 100) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %s (>%d)", - "Ant Det Result", "2-Antenna (Bad-Isolation)", - BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %s (%d~%d)", - "Ant Det Result", "2-Antenna (Good-Isolation)", - BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION, - BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); - } - } else 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_8723D_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_8723D_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION - + psd_scan->ant_det_thres_offset, - BT_8723D_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_8723D_1ANT_ANTDET_PSDTHRES_1ANT, - BT_8723D_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)"); - case 12: - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(BT is available, result from BT"); - break; - } - CL_PRINTF(cli_buf); - - if (psd_scan->ant_det_result == 12) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d dB", - "PSD Scan Peak Value", - psd_scan->ant_det_psd_scan_peak_val / 100); - CL_PRINTF(cli_buf); - return; - } - - 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_8723D_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 halbtc8723d1ant_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; - - if (psd_scan->ant_det_result == 12) - return; - - 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; - } - - } - } - - -} - - -#ifdef PLATFORM_WINDOWS -#pragma optimize("", off) -#endif -void halbtc8723d1ant_psd_maxholddata(IN struct btc_coexist *btcoexist, - IN u32 gen_count) -{ - u32 i = 0; - u32 loop_i_max = 0, loop_val_max = 0; - - if (gen_count == 1) { - memcpy(psd_scan->psd_report_max_hold, - psd_scan->psd_report, - BT_8723D_1ANT_ANTDET_PSD_POINTS * sizeof(u32)); - } - - for (i = psd_scan->psd_start_point; - i <= psd_scan->psd_stop_point; i++) { - - /* update max-hold value at each freq point */ - 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 the max value in this seep */ - if (psd_scan->psd_report[i] > loop_val_max) { - loop_val_max = psd_scan->psd_report[i]; - loop_i_max = i; - } - } - - if (gen_count <= BT_8723D_1ANT_ANTDET_PSD_SWWEEPCOUNT) - psd_scan->psd_loop_max_value[gen_count - 1] = loop_val_max; -} - -#ifdef PLATFORM_WINDOWS -#pragma optimize("", off) -#endif -u32 halbtc8723d1ant_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_8723D_1ANT_ANTDET_SWEEPPOINT_DELAY) - break; - } - - val = btcoexist->btc_read_4byte(btcoexist, 0x8b4); - - psd_report = val & 0x0000ffff; - - return psd_report; -} - -#ifdef PLATFORM_WINDOWS -#pragma optimize("", off) -#endif -boolean halbtc8723d1ant_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; - u32 psd_sum = 0, avg_cnt = 0; - u32 i_max = 0, val_max = 0, val_max2 = 0; - - 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_8723D_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 = - halbtc8723d1ant_psd_getdata( - btcoexist, i - points1); - else - psd_report = - halbtc8723d1ant_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 * halbtc8723d1ant_psd_log2base( - btcoexist, psd_report); - - n = i - psd_scan->psd_start_base; - psd_scan->psd_report[n] = tmp; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "Point=%d, psd_dB_data = %d\n", - i, psd_scan->psd_report[n]); - BTC_TRACE(trace_buf); - - i++; - - } - - halbtc8723d1ant_psd_maxholddata(btcoexist, j); - - psd_scan->psd_gen_count = j; - - /*Accumulate Max PSD value in this loop if the value > threshold */ - if (psd_scan->psd_loop_max_value[j - 1] >= - 4000) { - psd_sum = psd_sum + - psd_scan->psd_loop_max_value[j - - 1]; - avg_cnt++; - } - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "Loop=%d, Max_dB_data = %d\n", - j, psd_scan->psd_loop_max_value[j - - 1]); - BTC_TRACE(trace_buf); - - } - - if (loopcnt == BT_8723D_1ANT_ANTDET_PSD_SWWEEPCOUNT) { - - /* search the Max Value between each-freq-point-max-hold value of all sweep*/ - for (i = 1; - i <= BT_8723D_1ANT_ANTDET_PSD_SWWEEPCOUNT; - i++) { - - if (i == 1) { - i_max = i; - val_max = psd_scan->psd_loop_max_value[i - - 1]; - val_max2 = - psd_scan->psd_loop_max_value[i - - 1]; - } else if ( - psd_scan->psd_loop_max_value[i - - 1] > val_max) { - val_max2 = val_max; - i_max = i; - val_max = psd_scan->psd_loop_max_value[i - - 1]; - } else if ( - psd_scan->psd_loop_max_value[i - - 1] > val_max2) - val_max2 = - psd_scan->psd_loop_max_value[i - - 1]; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "i = %d, val_hold= %d, val_max = %d, val_max2 = %d\n", - i, psd_scan->psd_loop_max_value[i - - 1], - val_max, val_max2); - - BTC_TRACE(trace_buf); - } - - psd_scan->psd_max_value_point = i_max; - psd_scan->psd_max_value = val_max; - psd_scan->psd_max_value2 = val_max2; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "val_max = %d, val_max2 = %d\n", - psd_scan->psd_max_value, - psd_scan->psd_max_value2); - BTC_TRACE(trace_buf); - } - - if (avg_cnt != 0) { - psd_scan->psd_avg_value = (psd_sum / avg_cnt); - if ((psd_sum % avg_cnt) >= (avg_cnt / 2)) - psd_scan->psd_avg_value++; - } else - psd_scan->psd_avg_value = 0; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "AvgLoop=%d, Avg_dB_data = %d\n", - avg_cnt, psd_scan->psd_avg_value); - 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); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx PSD Sweep Stop!!\n"); - BTC_TRACE(trace_buf); - return is_sweep_ok; - -} - -#ifdef PLATFORM_WINDOWS -#pragma optimize("", off) -#endif -boolean halbtc8723d1ant_psd_antenna_detection(IN struct btc_coexist - *btcoexist) -{ - u32 i = 0; - u32 wlpsd_cent_freq = 2484, wlpsd_span = 2; - s32 wlpsd_offset = -4; - u32 bt_tx_time, bt_le_channel; - 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, 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; - - memset(psd_scan->ant_det_peak_val, 0, 16 * sizeof(u8)); - memset(psd_scan->ant_det_peak_freq, 0, 16 * sizeof(u8)); - - psd_scan->ant_det_bt_tx_time = - BT_8723D_1ANT_ANTDET_BTTXTIME; /* 0.42ms*50 = 20ms (0.42ms = 1 PSD sweep) */ - psd_scan->ant_det_bt_le_channel = BT_8723D_1ANT_ANTDET_BTTXCHANNEL; - - bt_tx_time = psd_scan->ant_det_bt_tx_time; - bt_le_channel = psd_scan->ant_det_bt_le_channel; - - 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; - } - } -#if 0 - 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; -#endif - 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, - BT_8723D_1ANT_ANTDET_PSD_SWWEEPCOUNT); - 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, */ - halbtc8723d1ant_ps_tdma(btcoexist, FORCE_EXEC, - false, 0); - - /* Set coex table */ - halbtc8723d1ant_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 */ - /* Set Antenna Path, both GNT_WL/GNT_BT = 1, and control by SW */ - halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, - FORCE_EXEC, - BT_8723D_1ANT_PHASE_ANTENNA_DET); - - 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_2byte(btcoexist, 0x948); - u32tmp0 = btcoexist->btc_read_4byte(btcoexist, 0x70); - u32tmp1 = halbtc8723d1ant_ltecoex_indirect_read_reg( - btcoexist, 0x38); - u32tmp2 = halbtc8723d1ant_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 (!halbtc8723d1ant_psd_sweep_point(btcoexist, - wlpsd_cent_freq, wlpsd_offset, wlpsd_span, - BT_8723D_1ANT_ANTDET_PSD_POINTS, - BT_8723D_1ANT_ANTDET_PSD_AVGNUM, 3)) { - 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->ant_det_pre_psdscan_peak_val > - (BT_8723D_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->ant_det_pre_psdscan_peak_val / - 100, - BT_8723D_1ANT_ANTDET_PSDTHRES_BACKGROUND - + psd_scan->ant_det_thres_offset); - BTC_TRACE(trace_buf); - 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->ant_det_pre_psdscan_peak_val / - 100, - BT_8723D_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)); - - /* Sync WL Rx PSD with BT Tx time because H2C->Mailbox delay */ - delay_ms(20); - - if (!halbtc8723d1ant_psd_sweep_point(btcoexist, - wlpsd_cent_freq, wlpsd_offset, - wlpsd_span, - BT_8723D_1ANT_ANTDET_PSD_POINTS, - BT_8723D_1ANT_ANTDET_PSD_AVGNUM, - BT_8723D_1ANT_ANTDET_PSD_SWWEEPCOUNT)) { - ant_det_finish = false; - board_info->btdm_ant_num_by_ant_det = 1; - psd_scan->ant_det_result = 8; - state = 99; - break; - } - -#if 1 - psd_scan->ant_det_psd_scan_peak_val = - psd_scan->psd_max_value; -#endif -#if 0 - psd_scan->ant_det_psd_scan_peak_val = - ((psd_scan->psd_max_value - psd_scan->psd_avg_value) < - 800) ? - psd_scan->psd_max_value : (( - psd_scan->psd_max_value - - psd_scan->psd_max_value2 <= 300) ? - psd_scan->psd_avg_value : - psd_scan->psd_max_value2); -#endif - 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->ant_det_psd_scan_peak_val / 100; - psd_rep2 = psd_scan->ant_det_psd_scan_peak_val - - 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_8723D_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_8723D_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_8723D_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_8723D_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; - 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->ant_det_psd_scan_peak_val > - (BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION) - * 100) { - psd_scan->ant_det_result = 1; - 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 / - 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->ant_det_psd_scan_peak_val > - (BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION - + psd_scan->ant_det_thres_offset) * 100) { - psd_scan->ant_det_result = 2; - 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 / - 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->ant_det_psd_scan_peak_val > - (BT_8723D_1ANT_ANTDET_PSDTHRES_1ANT) * - 100) { - psd_scan->ant_det_result = 3; - 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 / - 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; - 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 */ - halbtc8723d1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, FORCE_EXEC, - BT_8723D_1ANT_PHASE_2G_RUNTIME); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to PTA\n!!"); - BTC_TRACE(trace_buf); - - 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; - break; - } - - } while (!outloop); - - return ant_det_finish; - -} - -#ifdef PLATFORM_WINDOWS -#pragma optimize("", off) -#endif -boolean halbtc8723d1ant_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, ant_det_finish = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); - - ant_det_count++; - - psd_scan->ant_det_try_count = ant_det_count; - - if (scan || roam) { - ant_det_finish = false; - psd_scan->ant_det_result = 6; - } else if (coex_sta->bt_disabled) { - ant_det_finish = false; - psd_scan->ant_det_result = 11; - } else if (coex_sta->num_of_profile >= 1) { - 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; - psd_scan->ant_det_result = 9; - } else if (coex_sta->c2h_bt_inquiry_page) { - ant_det_finish = false; - psd_scan->ant_det_result = 10; - } else { - - ant_det_finish = halbtc8723d1ant_psd_antenna_detection( - btcoexist); - - delay_ms(psd_scan->ant_det_bt_tx_time); - } - - /* board_info->ant_det_result = psd_scan->ant_det_result; */ - - if (!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, - ant_det_finish == true ? "Yes" : "No"); - BTC_TRACE(trace_buf); - - return ant_det_finish; - -} - - - -/* ************************************************************ - * work around function start with wa_halbtc8723d1ant_ - * ************************************************************ - * ************************************************************ - * extern function start with ex_halbtc8723d1ant_ - * ************************************************************ */ -void ex_halbtc8723d1ant_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 8723d 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 */ - - /* Set Antenna Path to BT side */ - /* Check efuse 0xc3[6] for Single Antenna Path */ - if (board_info->single_ant_path == 0) { - /* set to S1 */ - board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; - u8tmp = 0; - value = 1; - } else if (board_info->single_ant_path == 1) { - /* set to S0 */ - board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; - u8tmp = 1; - value = 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); - - /* Set Antenna Path to BT side */ - halbtc8723d1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8723D_1ANT_PHASE_COEX_POWERON); - - /* Write Single Antenna Position to Registry to tell BT for 8723d. This line can be removed - since BT EFuse also add "single antenna position" in EFuse for 8723d*/ - btcoexist->btc_set(btcoexist, BTC_SET_ACT_ANTPOSREGRISTRY_CTRL, - &value); - - /* 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 */ - 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", - halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, 0x38)); - BTC_TRACE(trace_buf); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** MAC Reg 0x70/ BB Reg 0x948 (Power-On) = 0x%x / 0x%x**********\n", - btcoexist->btc_read_4byte(btcoexist, 0x70), - btcoexist->btc_read_2byte(btcoexist, 0x948)); - BTC_TRACE(trace_buf); - -} - -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); -} - -void ex_halbtc8723d1ant_init_coex_dm(IN struct btc_coexist *btcoexist) -{ - halbtc8723d1ant_init_coex_dm(btcoexist); -} - -void ex_halbtc8723d1ant_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, 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", - "Ant PG Num/ Mech/ Pos", - board_info->pg_ant_num, board_info->btdm_ant_num, - (board_info->btdm_ant_pos == 1 ? "S1" : "S0")); - CL_PRINTF(cli_buf); - } else { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %d/ %d/ %s (%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 == 1 ? "S1" : "S0"), - 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); - } - } - - if (board_info->ant_det_result_five_complete) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %d/ %d", - "AntDet(Registry) Num/PSD Value", - board_info->btdm_ant_num_by_ant_det, - (board_info->antdetval & 0x7f)); - 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_8723d_1ant, glcoex_ver_8723d_1ant, - glcoex_ver_btdesired_8723d_1ant, - bt_coex_ver, - (bt_coex_ver == 0xff ? "Unknown" : - (coex_sta->bt_disabled ? "BT-disable" : - (bt_coex_ver >= glcoex_ver_btdesired_8723d_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); - - /* 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_8723D_1ANT_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, - 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/ %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); - - halbtc8723d1ant_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); - - 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_8723D_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_8723d_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", - "AntDiv/ ForceLPS", - ((board_info->ant_div_cfg) ? "On" : "Off"), - ((coex_sta->force_lps_on) ? "On" : "Off")); - CL_PRINTF(cli_buf); - - u32tmp[0] = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); - lte_coex_on = ((u32tmp[0] & BIT(7)) >> 7) ? true : false; - - if (lte_coex_on) { - - u32tmp[0] = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, - 0xa0); - u32tmp[1] = halbtc8723d1ant_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] = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, - 0xa8); - u32tmp[1] = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, - 0xac); - u32tmp[2] = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, - 0xb0); - u32tmp[3] = halbtc8723d1ant_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] = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); - u32tmp[1] = halbtc8723d1ant_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); - - u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x948); - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x67); - - 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_PRINTF(cli_buf); - - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x964); - u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x864); - u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0xab7); - u8tmp[3] = btcoexist->btc_read_1byte(btcoexist, 0xa01); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", - "0x964[1]/0x864[0]/0xab7[5]/0xa01[7]", - (int)((u8tmp[0] & BIT(1)) >> 1), (int)((u8tmp[1] & BIT(0))), - (int)((u8tmp[2] & BIT(3)) >> 3), - (int)((u8tmp[3] & BIT(7)) >> 7)); - CL_PRINTF(cli_buf); - - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x4c6); - u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40); - u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0x45e); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", - "0x4c6[4]/0x40[5]/0x45e[3](TxRetry)", - (int)((u8tmp[0] & BIT(4)) >> 4), - (int)((u8tmp[1] & BIT(5)) >> 5), - (int)((u8tmp[2] & BIT(3)) >> 3)); - 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/0x522/4-RxAGC", - u32tmp[0], u8tmp[0], (u8tmp[1] & 0x2) ? "On" : "Off"); - 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/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); -#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 %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); -} - - -void ex_halbtc8723d1ant_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 */ - halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_ACTIVE, false); - - halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_ONOFF, false); - - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - - 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); - } else if (BTC_IPS_LEAVE == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], IPS LEAVE notify\n"); - BTC_TRACE(trace_buf); - halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_ACTIVE, true); - - halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_ONOFF, true); - - halbtc8723d1ant_init_hw_config(btcoexist, false, false); - halbtc8723d1ant_init_coex_dm(btcoexist);; - - coex_sta->under_ips = false; - } -} - -void ex_halbtc8723d1ant_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 */ - halbtc8723d1ant_post_state_to_bt(btcoexist, - 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 */ - halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_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 */ - halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_ACTIVE, true); - - } -} - -void ex_halbtc8723d1ant_scan_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - boolean wifi_connected = 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); - - halbtc8723d1ant_query_bt_info(btcoexist); - - if (BTC_SCAN_START == type) { - - if (!wifi_connected) - 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); - - halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_SCAN, true); - halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_ACTIVE, true); - - /* Force antenna setup for no scan result issue */ - halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8723D_1ANT_PHASE_2G_RUNTIME); - - halbtc8723d1ant_run_coexist_mechanism(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); - - halbtc8723d1ant_run_coexist_mechanism(btcoexist); - } - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCAN Notify() end\n"); - BTC_TRACE(trace_buf); - -} - -void ex_halbtc8723d1ant_connect_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - boolean wifi_connected = false; - - if (btcoexist->manual_control || - btcoexist->stop_coex_dm) - return; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - - if (BTC_ASSOCIATE_START == type) { - - coex_sta->wifi_is_high_pri_task = true; - - halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_ACTIVE, true); - - halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_SCAN, true); - - /* Force antenna setup for no scan result issue */ - halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8723D_1ANT_PHASE_2G_RUNTIME); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], CONNECT START notify\n"); - BTC_TRACE(trace_buf); - - coex_dm->arp_cnt = 0; - - halbtc8723d1ant_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\n"); - BTC_TRACE(trace_buf); - - halbtc8723d1ant_run_coexist_mechanism(btcoexist); - } - -} - -void ex_halbtc8723d1ant_media_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - 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); - - halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_ACTIVE, true); - - /* Force antenna setup for no scan result issue */ - halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8723D_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); - - halbtc8723d1ant_post_state_to_bt(btcoexist, - 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; - } - - halbtc8723d1ant_update_wifi_channel_info(btcoexist, type); - -} - -void ex_halbtc8723d1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - boolean under_4way = false; - - if (btcoexist->manual_control || - btcoexist->stop_coex_dm) - 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) { - halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_SCAN, true); - halbtc8723d1ant_run_coexist_mechanism(btcoexist); - } -} - -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; - - 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_8723D_1ANT_MAX) - rsp_source = BT_INFO_SRC_8723D_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_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_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_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_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; - } else - coex_sta->is_setupLink = false; - - 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_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)) { - - halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_SCAN, true); - - } else { - - halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_SCAN, false); - } - } else - halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_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) - halbtc8723d1ant_update_wifi_channel_info( - btcoexist, BTC_MEDIA_CONNECT); - else - halbtc8723d1ant_update_wifi_channel_info( - btcoexist, - BTC_MEDIA_DISCONNECT); - } - - - /* If Ignore_WLanAct && not SetUp_Link or Role_Switch */ - 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); - halbtc8723d1ant_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); - } - - halbtc8723d1ant_update_bt_link_info(btcoexist); - - halbtc8723d1ant_run_coexist_mechanism(btcoexist); -} - - - -void ex_halbtc8723d1ant_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; - - halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_ACTIVE, true); - halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_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); - - halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_ACTIVE, false); - halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_ONOFF, false); - - halbtc8723d1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); - - halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8723D_1ANT_PHASE_WLAN_OFF); - - btcoexist->stop_coex_dm = true; - } -} - -void ex_halbtc8723d1ant_halt_notify(IN struct btc_coexist *btcoexist) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); - BTC_TRACE(trace_buf); - - halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_ACTIVE, false); - halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_ONOFF, false); - - halbtc8723d1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); - - 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); - - ex_halbtc8723d1ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); - - btcoexist->stop_coex_dm = true; -} - -void ex_halbtc8723d1ant_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_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); - - halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_ACTIVE, false); - halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_ONOFF, false); - - if (BTC_WIFI_PNP_SLEEP_KEEP_ANT == pnp_state) { - - halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8723D_1ANT_PHASE_2G_RUNTIME); - } else { - - halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8723D_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); - - halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_ACTIVE, true); - halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_ONOFF, true); - - btcoexist->stop_coex_dm = false; - } -} - - -void ex_halbtc8723d1ant_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); - - halbtc8723d1ant_init_hw_config(btcoexist, false, false); - halbtc8723d1ant_init_coex_dm(btcoexist); -} - -void ex_halbtc8723d1ant_periodical(IN struct btc_coexist *btcoexist) -{ - - struct btc_board_info *board_info = &btcoexist->board_info; - boolean wifi_busy = false; - u4Byte value = 0; - u32 bt_patch_ver; - static u8 cnt = 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_8723D_1ANT == 0) - halbtc8723d1ant_query_bt_info(btcoexist); - -#endif - - halbtc8723d1ant_monitor_bt_ctr(btcoexist); - halbtc8723d1ant_monitor_wifi_ctr(btcoexist); - - halbtc8723d1ant_monitor_bt_enable_disable(btcoexist); - -# if 1 - 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; - } - - /* 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_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 - - if (board_info->btdm_ant_det_finish) { - if ((psd_scan->ant_det_result == 12) && - (psd_scan->ant_det_psd_scan_peak_val == 0) - && (!psd_scan->is_AntDet_running)) { - psd_scan->ant_det_psd_scan_peak_val = - btcoexist->btc_get_ant_det_val_from_bt( - btcoexist) * 100; - - board_info->antdetval = psd_scan->ant_det_psd_scan_peak_val/100; - value = board_info->antdetval; - -#ifdef PLATFORM_WINDOWS - { - PWCHAR registryName; - - registryName = L"antdetval"; - PlatformWriteCommonDwordRegistry(registryName, &value); - } -#endif - } - } - -#endif - } - - if (halbtc8723d1ant_is_wifibt_status_changed(btcoexist)) - halbtc8723d1ant_run_coexist_mechanism(btcoexist); - - -} - -void ex_halbtc8723d1ant_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 */ - board_info->ant_div_cfg = true; - halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI, - FORCE_EXEC, - BT_8723D_1ANT_PHASE_2G_RUNTIME); - } else { /* one antenna */ - halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8723D_1ANT_PHASE_2G_RUNTIME); - } -} - -#ifdef PLATFORM_WINDOWS -#pragma optimize("", off) -#endif -void ex_halbtc8723d1ant_antenna_detection(IN struct btc_coexist *btcoexist, - IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) -{ - - static u32 ant_det_count = 0, ant_det_fail_count = 0; - struct btc_board_info *board_info = &btcoexist->board_info; - u16 u16tmp; - u8 AntDetval = 0; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx Ext Call AntennaDetect()!!\n"); - BTC_TRACE(trace_buf); - -#if BT_8723D_1ANT_ANTDET_ENABLE - - 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_8723D_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); - - 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; - psd_scan->ant_det_try_count = 1; - psd_scan->ant_det_fail_count = 0; - board_info->btdm_ant_num_by_ant_det = (u16tmp & - BIT(3)) ? 1 : 2; - psd_scan->ant_det_result = 12; - - psd_scan->ant_det_psd_scan_peak_val = - btcoexist->btc_get_ant_det_val_from_bt( - btcoexist) * 100; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Result from BT (%d-Ant)\n", - board_info->btdm_ant_num_by_ant_det); - BTC_TRACE(trace_buf); - } else - board_info->btdm_ant_det_finish = - halbtc8723d1ant_psd_antenna_detection_check( - btcoexist); - - board_info->ant_det_result = psd_scan->ant_det_result; - btcoexist->bdontenterLPS = false; - - 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 (board_info->btdm_ant_num_by_ant_det == 2) { - board_info->ant_div_cfg = true; - halbtc8723d1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_WIFI, FORCE_EXEC, - BT_8723D_1ANT_PHASE_2G_RUNTIME); - } else - halbtc8723d1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, FORCE_EXEC, - BT_8723D_1ANT_PHASE_2G_RUNTIME); - - /*for 8723d, btc_set_bt_trx_mask is just used to - notify BT stop le tx and Ant Det Result , not set BT RF TRx Mask */ - if (psd_scan->ant_det_result != 12) { - - AntDetval = (u8)( - psd_scan->ant_det_psd_scan_peak_val - / 100) & 0x7f; - - AntDetval = - (board_info->btdm_ant_num_by_ant_det - == 1) ? (AntDetval | 0x80) : - AntDetval; - board_info->antdetval = AntDetval; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxx AntennaDetect(), Ant Count = %d, PSD Val = %d\n", - ((AntDetval & - 0x80) ? 1 - : 2), AntDetval - & 0x7f); - BTC_TRACE(trace_buf); - - if (btcoexist->btc_set_bt_trx_mask( - btcoexist, AntDetval)) - BTC_SPRINTF(trace_buf, - BT_TMP_BUF_SIZE, - "xxxxxx AntennaDetect(), Notify BT stop le tx by set_bt_trx_mask ok!\n"); - else - BTC_SPRINTF(trace_buf, - BT_TMP_BUF_SIZE, - "xxxxxx AntennaDetect(), Notify BT stop le tx by set_bt_trx_mask fail!\n"); - - BTC_TRACE(trace_buf); - } else - board_info->antdetval = - psd_scan->ant_det_psd_scan_peak_val/100; - - 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; - psd_scan->is_AntDet_running = false; - /* stimulate coex running */ - halbtc8723d1ant_run_coexist_mechanism( - btcoexist); - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Stimulate Coex running\n!!"); - BTC_TRACE(trace_buf); - - } 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); - - if (psd_scan->ant_det_inteval_count == 8) - btcoexist->bdontenterLPS = true; - else - btcoexist->bdontenterLPS = false; - } - - } -#endif - - -} - - -void ex_halbtc8723d1ant_display_ant_detection(IN struct btc_coexist *btcoexist) -{ -#if BT_8723D_1ANT_ANTDET_ENABLE - struct btc_board_info *board_info = &btcoexist->board_info; - - if (psd_scan->ant_det_try_count != 0) { - halbtc8723d1ant_psd_show_antenna_detect_result(btcoexist); - - if (board_info->btdm_ant_det_finish) - halbtc8723d1ant_psd_showdata(btcoexist); - } -#endif - -} - -void ex_halbtc8723d1ant_antenna_isolation(IN struct btc_coexist *btcoexist, - IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) -{ - - -} - -void ex_halbtc8723d1ant_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/rtl8188eu/hal/btc/halbtc8723d1ant.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8723d1ant.h deleted file mode 100644 index 2408e1f68c24..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8723d1ant.h +++ /dev/null @@ -1,414 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ - -#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) - -#if (RTL8723D_SUPPORT == 1) - -/* ******************************************* - * The following is for 8723D 1ANT BT Co-exist definition - * ******************************************* */ -#define BT_8723D_1ANT_COEX_DBG 0 -#define BT_AUTO_REPORT_ONLY_8723D_1ANT 1 - -#define BT_INFO_8723D_1ANT_B_FTP BIT(7) -#define BT_INFO_8723D_1ANT_B_A2DP BIT(6) -#define BT_INFO_8723D_1ANT_B_HID BIT(5) -#define BT_INFO_8723D_1ANT_B_SCO_BUSY BIT(4) -#define BT_INFO_8723D_1ANT_B_ACL_BUSY BIT(3) -#define BT_INFO_8723D_1ANT_B_INQ_PAGE BIT(2) -#define BT_INFO_8723D_1ANT_B_SCO_ESCO BIT(1) -#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) - -#define BTC_RSSI_COEX_THRESH_TOL_8723D_1ANT 2 - -#define BT_8723D_1ANT_WIFI_NOISY_THRESH 30 /* max: 255 */ -#define BT_8723D_1ANT_DEFAULT_ISOLATION 15 /* unit: dB */ - - -/* for Antenna detection */ -#define BT_8723D_1ANT_ANTDET_PSDTHRES_BACKGROUND 50 -#define BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION 70 -#define BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION 55 -#define BT_8723D_1ANT_ANTDET_PSDTHRES_1ANT 35 -#define BT_8723D_1ANT_ANTDET_RETRY_INTERVAL 10 /* retry timer if ant det is fail, unit: second */ -#define BT_8723D_1ANT_ANTDET_SWEEPPOINT_DELAY 60000 -#define BT_8723D_1ANT_ANTDET_ENABLE 1 -#define BT_8723D_1ANT_ANTDET_BTTXTIME 100 -#define BT_8723D_1ANT_ANTDET_BTTXCHANNEL 39 -#define BT_8723D_1ANT_ANTDET_PSD_SWWEEPCOUNT 50 - -#define BT_8723D_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT 30000 - -enum bt_8723d_1ant_signal_state { - BT_8723D_1ANT_SIG_STA_SET_TO_LOW = 0x0, - BT_8723D_1ANT_SIG_STA_SET_BY_HW = 0x0, - BT_8723D_1ANT_SIG_STA_SET_TO_HIGH = 0x1, - BT_8723D_1ANT_SIG_STA_MAX -}; - -enum bt_8723d_1ant_path_ctrl_owner { - BT_8723D_1ANT_PCO_BTSIDE = 0x0, - BT_8723D_1ANT_PCO_WLSIDE = 0x1, - BT_8723D_1ANT_PCO_MAX -}; - -enum bt_8723d_1ant_gnt_ctrl_type { - BT_8723D_1ANT_GNT_TYPE_CTRL_BY_PTA = 0x0, - BT_8723D_1ANT_GNT_TYPE_CTRL_BY_SW = 0x1, - BT_8723D_1ANT_GNT_TYPE_MAX -}; - -enum bt_8723d_1ant_gnt_ctrl_block { - BT_8723D_1ANT_GNT_BLOCK_RFC_BB = 0x0, - BT_8723D_1ANT_GNT_BLOCK_RFC = 0x1, - BT_8723D_1ANT_GNT_BLOCK_BB = 0x2, - BT_8723D_1ANT_GNT_BLOCK_MAX -}; - -enum bt_8723d_1ant_lte_coex_table_type { - BT_8723D_1ANT_CTT_WL_VS_LTE = 0x0, - BT_8723D_1ANT_CTT_BT_VS_LTE = 0x1, - BT_8723D_1ANT_CTT_MAX -}; - -enum bt_8723d_1ant_lte_break_table_type { - BT_8723D_1ANT_LBTT_WL_BREAK_LTE = 0x0, - BT_8723D_1ANT_LBTT_BT_BREAK_LTE = 0x1, - BT_8723D_1ANT_LBTT_LTE_BREAK_WL = 0x2, - BT_8723D_1ANT_LBTT_LTE_BREAK_BT = 0x3, - BT_8723D_1ANT_LBTT_MAX -}; - -enum bt_info_src_8723d_1ant { - BT_INFO_SRC_8723D_1ANT_WIFI_FW = 0x0, - BT_INFO_SRC_8723D_1ANT_BT_RSP = 0x1, - BT_INFO_SRC_8723D_1ANT_BT_ACTIVE_SEND = 0x2, - BT_INFO_SRC_8723D_1ANT_MAX -}; - -enum bt_8723d_1ant_bt_status { - BT_8723D_1ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, - BT_8723D_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, - BT_8723D_1ANT_BT_STATUS_INQ_PAGE = 0x2, - BT_8723D_1ANT_BT_STATUS_ACL_BUSY = 0x3, - BT_8723D_1ANT_BT_STATUS_SCO_BUSY = 0x4, - BT_8723D_1ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, - BT_8723D_1ANT_BT_STATUS_MAX -}; - -enum bt_8723d_1ant_wifi_status { - BT_8723D_1ANT_WIFI_STATUS_NON_CONNECTED_IDLE = 0x0, - BT_8723D_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN = 0x1, - BT_8723D_1ANT_WIFI_STATUS_CONNECTED_SCAN = 0x2, - BT_8723D_1ANT_WIFI_STATUS_CONNECTED_SPECIFIC_PKT = 0x3, - BT_8723D_1ANT_WIFI_STATUS_CONNECTED_IDLE = 0x4, - BT_8723D_1ANT_WIFI_STATUS_CONNECTED_BUSY = 0x5, - BT_8723D_1ANT_WIFI_STATUS_MAX -}; - -enum bt_8723d_1ant_coex_algo { - BT_8723D_1ANT_COEX_ALGO_UNDEFINED = 0x0, - BT_8723D_1ANT_COEX_ALGO_SCO = 0x1, - BT_8723D_1ANT_COEX_ALGO_HID = 0x2, - BT_8723D_1ANT_COEX_ALGO_A2DP = 0x3, - BT_8723D_1ANT_COEX_ALGO_A2DP_PANHS = 0x4, - BT_8723D_1ANT_COEX_ALGO_PANEDR = 0x5, - BT_8723D_1ANT_COEX_ALGO_PANHS = 0x6, - BT_8723D_1ANT_COEX_ALGO_PANEDR_A2DP = 0x7, - BT_8723D_1ANT_COEX_ALGO_PANEDR_HID = 0x8, - BT_8723D_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, - BT_8723D_1ANT_COEX_ALGO_HID_A2DP = 0xa, - BT_8723D_1ANT_COEX_ALGO_MAX = 0xb, -}; - -enum bt_8723d_1ant_phase { - BT_8723D_1ANT_PHASE_COEX_INIT = 0x0, - BT_8723D_1ANT_PHASE_WLANONLY_INIT = 0x1, - BT_8723D_1ANT_PHASE_WLAN_OFF = 0x2, - BT_8723D_1ANT_PHASE_2G_RUNTIME = 0x3, - BT_8723D_1ANT_PHASE_5G_RUNTIME = 0x4, - BT_8723D_1ANT_PHASE_BTMPMODE = 0x5, - BT_8723D_1ANT_PHASE_ANTENNA_DET = 0x6, - BT_8723D_1ANT_PHASE_COEX_POWERON = 0x7, - BT_8723D_1ANT_PHASE_MAX -}; - -enum bt_8723d_1ant_Scoreboard { - BT_8723D_1ANT_SCOREBOARD_ACTIVE = BIT(0), - 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_WLBUSY = BIT(6) -}; - -struct coex_dm_8723d_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 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; - boolean limited_dig; - - 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 pre_algorithm; - u8 cur_algorithm; - 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_8723d_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 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]; - u8 bt_info_c2h[BT_INFO_SRC_8723D_1ANT_MAX][10]; - u32 bt_info_c2h_cnt[BT_INFO_SRC_8723D_1ANT_MAX]; - 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_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; - - 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 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; -}; - -#define BT_8723D_1ANT_ANTDET_PSD_POINTS 256 /* MAX:1024 */ -#define BT_8723D_1ANT_ANTDET_PSD_AVGNUM 1 /* MAX:3 */ -#define BT_8723D_1ANT_ANTDET_BUF_LEN 16 - -struct psdscan_sta_8723d_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_8723D_1ANT_ANTDET_BUF_LEN]; - u8 ant_det_peak_freq[BT_8723D_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_max_value2; - u32 psd_avg_value; /* filter loop_max_value that below BT_8723D_1ANT_ANTDET_PSDTHRES_1ANT, and average the rest*/ - u32 psd_loop_max_value[BT_8723D_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_AntDet_running; - boolean is_psd_show_max_only; -}; - -/* ******************************************* - * The following is interface which will notify coex module. - * ******************************************* */ -void ex_halbtc8723d1ant_power_on_setting(IN struct btc_coexist *btcoexist); -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); -void ex_halbtc8723d1ant_init_coex_dm(IN struct btc_coexist *btcoexist); -void ex_halbtc8723d1ant_ips_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8723d1ant_lps_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8723d1ant_scan_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8723d1ant_connect_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8723d1ant_media_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -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_rf_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8723d1ant_halt_notify(IN struct btc_coexist *btcoexist); -void ex_halbtc8723d1ant_pnp_notify(IN struct btc_coexist *btcoexist, - IN u8 pnp_state); -void ex_halbtc8723d1ant_coex_dm_reset(IN struct btc_coexist *btcoexist); -void ex_halbtc8723d1ant_periodical(IN struct btc_coexist *btcoexist); -void ex_halbtc8723d1ant_set_antenna_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8723d1ant_display_coex_info(IN struct btc_coexist *btcoexist); -void ex_halbtc8723d1ant_antenna_detection(IN struct btc_coexist *btcoexist, - IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); -void ex_halbtc8723d1ant_antenna_isolation(IN struct btc_coexist *btcoexist, - IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); - -void ex_halbtc8723d1ant_psd_scan(IN struct btc_coexist *btcoexist, - IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); -void ex_halbtc8723d1ant_display_ant_detection(IN struct btc_coexist *btcoexist); - -#else -#define ex_halbtc8723d1ant_power_on_setting(btcoexist) -#define ex_halbtc8723d1ant_pre_load_firmware(btcoexist) -#define ex_halbtc8723d1ant_init_hw_config(btcoexist, wifi_only) -#define ex_halbtc8723d1ant_init_coex_dm(btcoexist) -#define ex_halbtc8723d1ant_ips_notify(btcoexist, type) -#define ex_halbtc8723d1ant_lps_notify(btcoexist, type) -#define ex_halbtc8723d1ant_scan_notify(btcoexist, type) -#define ex_halbtc8723d1ant_connect_notify(btcoexist, type) -#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_rf_status_notify(btcoexist, type) -#define ex_halbtc8723d1ant_halt_notify(btcoexist) -#define ex_halbtc8723d1ant_pnp_notify(btcoexist, pnp_state) -#define ex_halbtc8723d1ant_coex_dm_reset(btcoexist) -#define ex_halbtc8723d1ant_periodical(btcoexist) -#define ex_halbtc8723d1ant_display_coex_info(btcoexist) -#define ex_halbtc8723d1ant_set_antenna_notify(btcoexist, type) -#define ex_halbtc8723d1ant_antenna_detection(btcoexist, cent_freq, offset, span, seconds) -#define ex_halbtc8723d1ant_antenna_isolation(btcoexist, cent_freq, offset, span, seconds) -#define ex_halbtc8723d1ant_psd_scan(btcoexist, cent_freq, offset, span, seconds) -#define ex_halbtc8723d1ant_display_ant_detection(btcoexist) -#endif - -#endif - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8723d2ant.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8723d2ant.c deleted file mode 100644 index c489b52bc49e..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8723d2ant.c +++ /dev/null @@ -1,6775 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ -/* ************************************************************ - * Description: - * - * This file is for RTL8723D 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 (RTL8723D_SUPPORT == 1) -/* ************************************************************ - * Global variables, these are static variables - * ************************************************************ */ -static u8 *trace_buf = &gl_btc_trace_buf[0]; -static struct coex_dm_8723d_2ant glcoex_dm_8723d_2ant; -static struct coex_dm_8723d_2ant *coex_dm = &glcoex_dm_8723d_2ant; -static struct coex_sta_8723d_2ant glcoex_sta_8723d_2ant; -static struct coex_sta_8723d_2ant *coex_sta = &glcoex_sta_8723d_2ant; -static struct psdscan_sta_8723d_2ant gl_psd_scan_8723d_2ant; -static struct psdscan_sta_8723d_2ant *psd_scan = &gl_psd_scan_8723d_2ant; - -const char *const glbt_info_src_8723d_2ant[] = { - "BT Info[wifi fw]", - "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_8723d_2ant = 20161027; -u32 glcoex_ver_8723d_2ant = 0x0f; -u32 glcoex_ver_btdesired_8723d_2ant = 0x0d; - - -/* ************************************************************ - * local function proto type if needed - * ************************************************************ - * ************************************************************ - * local function start with halbtc8723d2ant_ - * ************************************************************ */ -u8 halbtc8723d2ant_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_8723D_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_8723D_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_8723D_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 halbtc8723d2ant_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_8723D_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_8723D_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_8723D_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 halbtc8723d2ant_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_8723D_2ANT_WIFI_MAX_TX_POWER - - isolation_measuared; - interference_bt_tx = BT_8723D_2ANT_BT_MAX_TX_POWER - - isolation_measuared; - - - - coex_sta->wifi_coex_thres = BT_8723D_2ANT_WIFI_RSSI_COEXSWITCH_THRES1; - coex_sta->wifi_coex_thres2 = BT_8723D_2ANT_WIFI_RSSI_COEXSWITCH_THRES2; - - coex_sta->bt_coex_thres = BT_8723D_2ANT_BT_RSSI_COEXSWITCH_THRES1; - coex_sta->bt_coex_thres2 = BT_8723D_2ANT_BT_RSSI_COEXSWITCH_THRES2; - - - /* - coex_sta->wifi_coex_thres = interference_wl_tx + BT_8723D_2ANT_WIFI_SIR_THRES1; - coex_sta->wifi_coex_thres2 = interference_wl_tx + BT_8723D_2ANT_WIFI_SIR_THRES2; - - coex_sta->bt_coex_thres = interference_bt_tx + BT_8723D_2ANT_BT_SIR_THRES1; - coex_sta->bt_coex_thres2 = interference_bt_tx + BT_8723D_2ANT_BT_SIR_THRES2; - */ - - - - - - /* - if ( BT_8723D_2ANT_WIFI_RSSI_COEXSWITCH_THRES1 < (isolation_measuared - - BT_8723D_2ANT_DEFAULT_ISOLATION) ) - coex_sta->wifi_coex_thres = BT_8723D_2ANT_WIFI_RSSI_COEXSWITCH_THRES1; - else - coex_sta->wifi_coex_thres = BT_8723D_2ANT_WIFI_RSSI_COEXSWITCH_THRES1 - (isolation_measuared - - BT_8723D_2ANT_DEFAULT_ISOLATION); - - if ( BT_8723D_2ANT_BT_RSSI_COEXSWITCH_THRES1 < (isolation_measuared - - BT_8723D_2ANT_DEFAULT_ISOLATION) ) - coex_sta->bt_coex_thres = BT_8723D_2ANT_BT_RSSI_COEXSWITCH_THRES1; - else - coex_sta->bt_coex_thres = BT_8723D_2ANT_BT_RSSI_COEXSWITCH_THRES1 - (isolation_measuared - - BT_8723D_2ANT_DEFAULT_ISOLATION); - - */ -} - - -void halbtc8723d2ant_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 halbtc8723d2ant_query_bt_info(IN struct btc_coexist *btcoexist) -{ - u8 h2c_parameter[1] = {0}; - - - h2c_parameter[0] |= BIT(0); /* trigger */ - - btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); -} - -void halbtc8723d2ant_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; - - 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 (BT_8723D_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; - } - } - - /* 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->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) { - halbtc8723d2ant_query_bt_info(btcoexist); - num_of_bt_counter_chk = 0; - } - } - } - -} - -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; - - 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); - - 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_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 -} - - - -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 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->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; - } - - return false; -} - -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; - - - 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; - } else { /* connection exists */ - coex_sta->bt_link_exist = true; - if (coex_sta->bt_info & BT_INFO_8723D_2ANT_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_8723D_2ANT_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_8723D_2ANT_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_8723D_2ANT_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_8723D_2ANT_B_INQ_PAGE) { - coex_dm->bt_status = BT_8723D_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_8723D_2ANT_B_CONNECTION)) { - coex_dm->bt_status = BT_8723D_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_8723D_2ANT_B_CONNECTION) { - /* connection exists but no busy */ - coex_dm->bt_status = BT_8723D_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_8723D_2ANT_B_SCO_ESCO) || - (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_SCO_BUSY)) && - (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_ACL_BUSY)) { - coex_dm->bt_status = BT_8723D_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_8723D_2ANT_B_SCO_ESCO) || - (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_SCO_BUSY)) { - coex_dm->bt_status = BT_8723D_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_8723D_2ANT_B_ACL_BUSY) { - coex_dm->bt_status = BT_8723D_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_8723D_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_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; - else - bt_busy = false; - - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); -} - -void halbtc8723d2ant_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 8723d 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); - -} - -void halbtc8723d2ant_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 halbtc8723d2ant_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; - } - - halbtc8723d2ant_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 halbtc8723d2ant_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 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); - - coex_dm->pre_bt_dec_pwr_lvl = coex_dm->cur_bt_dec_pwr_lvl; -} - -void halbtc8723d2ant_set_fw_low_penalty_ra(IN struct btc_coexist - *btcoexist, IN boolean low_penalty_ra) -{ -#if 1 - 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); -#endif -} - -void halbtc8723d2ant_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; - } - - halbtc8723d2ant_set_fw_low_penalty_ra(btcoexist, - coex_dm->cur_low_penalty_ra); - -#if 0 - 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); -#endif - coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; - -#endif -} - -void halbtc8723d2ant_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 halbtc8723d2ant_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; - } - halbtc8723d2ant_set_bt_auto_report(btcoexist, - coex_dm->cur_bt_auto_report); - - 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 -) -{ - - halbtc8723d2ant_write_score_board(btcoexist, (u16) type, state); - -} - -void halbtc8723d2ant_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 */ - halbtc8723d2ant_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 (bt_disabled) - halbtc8723d2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, false); - else - halbtc8723d2ant_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 halbtc8723d2ant_enable_gnt_to_gpio(IN struct btc_coexist *btcoexist, - boolean isenable) -{ -#if BT_8723D_2ANT_COEX_DBG - if (isenable) { - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x1); - - /* enable GNT_BT to GPIO debug */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x40, 0x0); - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x1, 0x0); - - /* 0x48[20] = 0 for GPIO14 = GNT_WL*/ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4a, 0x10, 0x0); - /* 0x40[17] = 0 for GPIO14 = GNT_WL*/ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, 0x02, 0x0); - - /* 0x66[9] = 0 for GPIO15 = GNT_BT*/ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x02, 0x0); - /* 0x66[7] = 0 - for GPIO15 = GNT_BT*/ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, 0x80, 0x0); - /* 0x8[8] = 0 for GPIO15 = GNT_BT*/ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x9, 0x1, 0x0); - - /* BT Vendor Reg 0x76[0] = 0 for GPIO15 = GNT_BT, this is not set here*/ - } else { - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x0); - - /* Disable GNT_BT debug to GPIO, and enable chip_wakeup_host */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x40, 0x1); - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x1, 0x1); - - /* 0x48[20] = 0 for GPIO14 = GNT_WL*/ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4a, 0x10, 0x1); - } - -#endif -} - -u32 halbtc8723d2ant_ltecoex_indirect_read_reg(IN struct btc_coexist *btcoexist, - IN u16 reg_addr) -{ - u32 j = 0; - - - /* 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_8723D_2ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); - - - return btcoexist->btc_read_4byte(btcoexist, - 0x7c8); /* get read data */ - -} - -void halbtc8723d2ant_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, 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_8723D_2ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); - - - btcoexist->btc_write_4byte(btcoexist, 0x7c0, - 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 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, - reg_addr); - val = (val & (~bit_mask)) | (reg_value << bitpos); - - 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_8723D_2ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); - - - btcoexist->btc_write_4byte(btcoexist, 0x7c0, - 0xc00F0000 | reg_addr); - - } - -} - -void halbtc8723d2ant_ltecoex_enable(IN struct btc_coexist *btcoexist, - IN boolean enable) -{ - u8 val; - - val = (enable) ? 1 : 0; - halbtc8723d2ant_ltecoex_indirect_write_reg(btcoexist, 0x38, 0x80, - val); /* 0x38[7] */ - -} - -void halbtc8723d2ant_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 halbtc8723d2ant_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 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, - 0x38); - - switch (control_block) { - case BT_8723D_2ANT_GNT_BLOCK_RFC_BB: - default: - val = ((val << 14) | (val << 10)) | (val_orig & 0xffff33ff); - break; - case BT_8723D_2ANT_GNT_BLOCK_RFC: - val = (val << 14) | (val_orig & 0xffff3fff); - break; - case BT_8723D_2ANT_GNT_BLOCK_BB: - val = (val << 10) | (val_orig & 0xfffff3ff); - break; - } - - halbtc8723d2ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, 0xffffffff, val); -} - - -void halbtc8723d2ant_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 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, - 0x38); - - switch (control_block) { - case BT_8723D_2ANT_GNT_BLOCK_RFC_BB: - default: - val = ((val << 12) | (val << 8)) | (val_orig & 0xffffccff); - break; - case BT_8723D_2ANT_GNT_BLOCK_RFC: - val = (val << 12) | (val_orig & 0xffffcfff); - break; - case BT_8723D_2ANT_GNT_BLOCK_BB: - val = (val << 8) | (val_orig & 0xfffffcff); - break; - } - - halbtc8723d2ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, 0xffffffff, val); -} - -void halbtc8723d2ant_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_8723D_2ANT_CTT_WL_VS_LTE: - reg_addr = 0xa0; - break; - case BT_8723D_2ANT_CTT_BT_VS_LTE: - reg_addr = 0xa4; - break; - } - - if (reg_addr != 0x0000) - halbtc8723d2ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, - 0xffff, table_content); /* 0xa0[15:0] or 0xa4[15:0] */ - - -} - - -void halbtc8723d2ant_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_8723D_2ANT_LBTT_WL_BREAK_LTE: - reg_addr = 0xa8; - break; - case BT_8723D_2ANT_LBTT_BT_BREAK_LTE: - reg_addr = 0xac; - break; - case BT_8723D_2ANT_LBTT_LTE_BREAK_WL: - reg_addr = 0xb0; - break; - case BT_8723D_2ANT_LBTT_LTE_BREAK_BT: - reg_addr = 0xb4; - break; - } - - if (reg_addr != 0x0000) - halbtc8723d2ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, - 0xff, table_content); /* 0xa8[15:0] or 0xb4[15:0] */ - - -} - -void halbtc8723d2ant_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 halbtc8723d2ant_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 halbtc8723d2ant_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; - } - halbtc8723d2ant_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 halbtc8723d2ant_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: - 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; - } -} - -void halbtc8723d2ant_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 halbtc8723d2ant_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; - } - halbtc8723d2ant_set_fw_ignore_wlan_act(btcoexist, enable); - - coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; -} - -void halbtc8723d2ant_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 halbtc8723d2ant_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; - } - halbtc8723d2ant_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 halbtc8723d2ant_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}; - - 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 */ - /*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 { - /* keep state under NO PS state, do nothing. */ - } - } -} - -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; - - 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: - halbtc8723d2ant_ps_tdma_check_for_power_save_state( - 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; - 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: - halbtc8723d2ant_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 halbtc8723d2ant_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; - 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) { - 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); - - real_byte5 |= BIT(5); - real_byte5 &= ~BIT(6); - - halbtc8723d2ant_power_save_state(btcoexist, - BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - } - } else if (byte1 & BIT(4) && !(byte1 & BIT(5))) { - - halbtc8723d2ant_power_save_state( - btcoexist, BTC_PS_LPS_ON, 0x50, - 0x4); - } else { - halbtc8723d2ant_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 halbtc8723d2ant_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) && (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); - - 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: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, - 0x10, 0x03, 0x91, - 0x54 | psTdmaByte4Modify); - break; - case 2: - default: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, - 0x35, 0x03, 0x11, - 0x11 | psTdmaByte4Modify); - break; - case 3: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, - 0x3a, 0x3, 0x91, - 0x10 | psTdmaByte4Modify); - break; - case 4: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, - 0x21, 0x3, 0x91, - 0x10 | psTdmaByte4Modify); - break; - case 5: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, - 0x25, 0x3, 0x91, - 0x10 | psTdmaByte4Modify); - break; - case 6: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, - 0x10, 0x3, 0x91, - 0x10 | psTdmaByte4Modify); - break; - case 7: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, - 0x20, 0x3, 0x91, - 0x10 | psTdmaByte4Modify); - break; - case 8: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, - 0x15, 0x03, 0x11, - 0x11); - break; - case 10: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, - 0x30, 0x03, 0x11, - 0x10); - break; - case 11: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, - 0x35, 0x03, 0x11, - 0x10 | psTdmaByte4Modify); - break; - case 12: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, - 0x35, 0x03, 0x11, 0x11); - break; - case 13: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, - 0x1c, 0x03, 0x11, - 0x10 | psTdmaByte4Modify); - break; - case 14: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, - 0x20, 0x03, 0x11, - 0x11); - break; - case 15: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, - 0x10, 0x03, 0x11, - 0x14); - break; - case 16: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, - 0x10, 0x03, 0x11, - 0x15); - break; - case 21: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, - 0x30, 0x03, 0x11, - 0x10); - break; - case 22: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, - 0x25, 0x03, 0x11, - 0x10); - break; - case 23: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, - 0x10, 0x03, 0x11, - 0x10); - break; - case 51: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, - 0x10, 0x03, 0x91, - 0x10 | psTdmaByte4Modify); - break; - case 101: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51, - 0x10, 0x03, 0x10, - 0x54 | psTdmaByte4Modify); - break; - case 102: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, - 0x35, 0x03, 0x11, - 0x11 | psTdmaByte4Modify); - break; - case 103: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51, - 0x3a, 0x3, 0x10, - 0x50 | psTdmaByte4Modify); - break; - case 104: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51, - 0x21, 0x3, 0x10, - 0x50 | psTdmaByte4Modify); - break; - case 105: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51, - 0x25, 0x3, 0x10, - 0x50 | psTdmaByte4Modify); - break; - case 106: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51, - 0x10, 0x3, 0x10, - 0x50 | psTdmaByte4Modify); - break; - case 107: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51, - 0x20, 0x3, 0x10, - 0x50 | psTdmaByte4Modify); - break; - case 108: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51, - 0x30, 0x3, 0x10, - 0x50 | psTdmaByte4Modify); - break; - case 109: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x55, - 0x10, 0x03, 0x10, - 0x54 | psTdmaByte4Modify); - break; - case 110: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x55, - 0x30, 0x03, 0x10, - 0x50 | psTdmaByte4Modify); - break; - case 111: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x65, - 0x25, 0x03, 0x11, - 0x11 | psTdmaByte4Modify); - break; - case 151: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51, - 0x10, 0x03, 0x10, - 0x50 | psTdmaByte4Modify); - break; - } - } else { - /* disable PS tdma */ - switch (type) { - case 0: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x0, - 0x0, 0x0, 0x40, 0x0); - break; - case 1: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x0, - 0x0, 0x0, 0x48, 0x0); - break; - default: - halbtc8723d2ant_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 halbtc8723d2ant_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 u32tmp = 0; - 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; - u32 u32tmp0 = 0, u32tmp1 = 0, u32tmp2 = 0; - u16 u16tmp0 = 0, u16tmp1 = 0; - - - u32tmp1 = halbtc8723d2ant_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_8723D_2ANT_COEX_DBG - u32tmp2 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x54); - u16tmp0 = btcoexist->btc_read_2byte(btcoexist, 0xaa); - u16tmp1 = btcoexist->btc_read_2byte(btcoexist, 0x948); - u8tmp1 = btcoexist->btc_read_1byte(btcoexist, 0x73); - u8tmp0 = btcoexist->btc_read_1byte(btcoexist, 0x67); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** 0x67 = 0x%x, 0x948 = 0x%x, 0x73 = 0x%x(Before Set Ant Pat)\n", - u8tmp0, u16tmp1, u8tmp1); - BTC_TRACE(trace_buf); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], **********0x38= 0x%x, 0x54= 0x%x, 0xaa = 0x%x (Before Set Ant Path)\n", - u32tmp1, u32tmp2, u16tmp0); - BTC_TRACE(trace_buf); -#endif - - 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_8723D_2ANT_PHASE_COEX_POWERON: - /* Set Path control to WL */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, - 0x80, 0x0); - - /* set Path control owner to WL at initial step */ - halbtc8723d2ant_ltecoex_pathcontrol_owner(btcoexist, - BT_8723D_2ANT_PCO_BTSIDE); - - /* set GNT_BT to SW high */ - 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 low */ - 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); - - if (BTC_ANT_PATH_AUTO == ant_pos_type) - ant_pos_type = BTC_ANT_PATH_WIFI; - - coex_sta->run_time_state = false; - - break; - case BT_8723D_2ANT_PHASE_COEX_INIT: - /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ - halbtc8723d2ant_ltecoex_enable(btcoexist, 0x0); - - /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ - halbtc8723d2ant_ltecoex_set_coex_table( - btcoexist, - BT_8723D_2ANT_CTT_WL_VS_LTE, - 0xffff); - - /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ - halbtc8723d2ant_ltecoex_set_coex_table( - btcoexist, - BT_8723D_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) { - u8tmp0 = btcoexist->btc_read_1byte( - btcoexist, - 0x49d); - cnt_bt_cal_chk++; - if (u8tmp0 & 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 to WL */ - btcoexist->btc_write_1byte_bitmask(btcoexist, - 0x67, 0x80, 0x1); - - /* set Path control owner to WL at initial step */ - halbtc8723d2ant_ltecoex_pathcontrol_owner( - btcoexist, - BT_8723D_2ANT_PCO_WLSIDE); - - /* set GNT_BT to SW high */ - 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 high */ - 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 = 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_8723D_2ANT_PHASE_WLANONLY_INIT: - /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ - halbtc8723d2ant_ltecoex_enable(btcoexist, 0x0); - - /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ - halbtc8723d2ant_ltecoex_set_coex_table( - btcoexist, - BT_8723D_2ANT_CTT_WL_VS_LTE, - 0xffff); - - /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ - halbtc8723d2ant_ltecoex_set_coex_table( - btcoexist, - BT_8723D_2ANT_CTT_BT_VS_LTE, - 0xffff); - - /* Set Path control to WL */ - btcoexist->btc_write_1byte_bitmask(btcoexist, - 0x67, 0x80, 0x1); - - /* set Path control owner to WL at initial step */ - halbtc8723d2ant_ltecoex_pathcontrol_owner( - btcoexist, - BT_8723D_2ANT_PCO_WLSIDE); - - /* set GNT_BT to SW Low */ - 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_LOW); - /* Set GNT_WL to SW high */ - 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 = 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_8723D_2ANT_PHASE_WLAN_OFF: - /* Disable LTE Coex Function in WiFi side */ - halbtc8723d2ant_ltecoex_enable(btcoexist, 0x0); - - /* Set Path control to BT */ - btcoexist->btc_write_1byte_bitmask(btcoexist, - 0x67, 0x80, 0x0); - - /* set Path control owner to BT */ - halbtc8723d2ant_ltecoex_pathcontrol_owner( - btcoexist, - BT_8723D_2ANT_PCO_BTSIDE); - - coex_sta->run_time_state = false; - break; - case BT_8723D_2ANT_PHASE_2G_RUNTIME: - - /* wait for WL/BT IQK finish, keep 0x38 = 0xff00 for WL IQK */ - while (cnt_bt_cal_chk <= 20) { - u8tmp0 = btcoexist->btc_read_1byte( - btcoexist, - 0x1e6); - - u8tmp1 = btcoexist->btc_read_1byte( - btcoexist, - 0x49d); - - cnt_bt_cal_chk++; - if ((u8tmp0 & BIT(0)) || - (u8tmp1 & BIT(0))) { - BTC_SPRINTF(trace_buf, - BT_TMP_BUF_SIZE, - "[BTCoex], ########### WL or 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 to WL */ - /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x80, 0x1);*/ - - /* set Path control owner to WL at runtime step */ - halbtc8723d2ant_ltecoex_pathcontrol_owner( - btcoexist, - BT_8723D_2ANT_PCO_WLSIDE); - - - halbtc8723d2ant_ltecoex_set_gnt_bt(btcoexist, - BT_8723D_2ANT_GNT_BLOCK_RFC_BB, - BT_8723D_2ANT_GNT_TYPE_CTRL_BY_PTA, - BT_8723D_2ANT_SIG_STA_SET_TO_HIGH); - - /* Set GNT_WL to PTA */ - halbtc8723d2ant_ltecoex_set_gnt_wl(btcoexist, - BT_8723D_2ANT_GNT_BLOCK_RFC_BB, - BT_8723D_2ANT_GNT_TYPE_CTRL_BY_PTA, - BT_8723D_2ANT_SIG_STA_SET_BY_HW); - - coex_sta->run_time_state = true; - - 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_8723D_2ANT_PHASE_BTMPMODE: - /* Disable LTE Coex Function in WiFi side */ - halbtc8723d2ant_ltecoex_enable(btcoexist, 0x0); - - /* Set Path control to WL */ - btcoexist->btc_write_1byte_bitmask(btcoexist, - 0x67, 0x80, 0x1); - - /* set Path control owner to WL */ - 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 Lo */ - 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_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_8723D_2ANT_PHASE_ANTENNA_DET: - - /* Set Path control to WL */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, - 0x80, 0x1); - - /* set Path control owner to WL */ - halbtc8723d2ant_ltecoex_pathcontrol_owner(btcoexist, - BT_8723D_2ANT_PCO_WLSIDE); - - /* Set Antenna Path, both GNT_WL/GNT_BT = 1, and control by SW */ - /* set GNT_BT to SW high */ - 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 high */ - 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); - - if (BTC_ANT_PATH_AUTO == ant_pos_type) - ant_pos_type = BTC_ANT_WIFI_AT_AUX; - - coex_sta->run_time_state = false; - - break; - } - - is_hw_ant_div_on = board_info->ant_div_cfg; - - 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) && - (phase != BT_8723D_2ANT_PHASE_WLAN_OFF)) { - - switch (ant_pos_type) { - case BTC_ANT_WIFI_AT_MAIN: - - btcoexist->btc_write_2byte(btcoexist, - 0x948, 0x0); - break; - case BTC_ANT_WIFI_AT_AUX: - - btcoexist->btc_write_2byte(btcoexist, - 0x948, 0x280); - break; - } - } - - -#if BT_8723D_2ANT_COEX_DBG - u32tmp1 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x38); - u32tmp2 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x54); - u16tmp0 = btcoexist->btc_read_2byte(btcoexist, 0xaa); - u16tmp1 = btcoexist->btc_read_2byte(btcoexist, 0x948); - u8tmp1 = btcoexist->btc_read_1byte(btcoexist, 0x73); - u8tmp0 = btcoexist->btc_read_1byte(btcoexist, 0x67); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** 0x67 = 0x%x, 0x948 = 0x%x, 0x73 = 0x%x(After Set Ant Pat)\n", - u8tmp0, u16tmp1, u8tmp1); - BTC_TRACE(trace_buf); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], **********0x38= 0x%x, 0x54= 0x%x, 0xaa= 0x%x (After Set Ant Path)\n", - u32tmp1, u32tmp2, u16tmp0); - BTC_TRACE(trace_buf); -#endif - -} - -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; - u8 algorithm = BT_8723D_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_8723D_2ANT_COEX_ALGO_NOPROFILEBUSY; - } - } 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_8723D_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_8723D_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_8723D_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_8723D_2ANT_COEX_ALGO_PANHS; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], PAN(EDR) only\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8723D_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_8723D_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_8723D_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_8723D_2ANT_COEX_ALGO_SCO; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCO + PAN(EDR)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8723D_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_8723D_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_8723D_2ANT_COEX_ALGO_HID; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], HID + PAN(EDR)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8723D_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_8723D_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_8723D_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_8723D_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_8723D_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_8723D_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_8723D_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_8723D_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_8723D_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_8723D_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_8723D_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_8723D_2ANT_COEX_ALGO_HID_A2DP_PANEDR; - } - } - } - } - - return algorithm; -} - - - -void halbtc8723d2ant_action_coex_all_off(IN struct btc_coexist *btcoexist) -{ - - 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); -} - -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_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -} - -void halbtc8723d2ant_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 = 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(&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); - - 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); - - 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_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - - 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 { - - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - 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); - } - -} - - -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; - 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); - - halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 8); - - if ((bt_link_info->a2dp_exist) && (!bt_link_info->pan_exist)) - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 15); - else - halbtc8723d2ant_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); - - halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 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); - - } 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 { - - 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); - } - - 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); - - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - coex_sta->bt_relink_downcount = 2; -} - -void halbtc8723d2ant_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) { - - halbtc8723d2ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 2); - - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - } else { /* if wl busy */ - - if (BT_8723D_1ANT_BT_STATUS_NON_CONNECTED_IDLE == - coex_dm->bt_status) { - - halbtc8723d2ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 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, - 12); - } - } - - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - -} - - - -/* SCO only or SCO+PAN(HS) */ -void halbtc8723d2ant_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 = 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(&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); - - - 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); - - 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 { - - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - coex_dm->is_switch_to_1dot5_ant = false; - - halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 1); - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 8); - } - -} - - -void halbtc8723d2ant_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 = 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(&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); - - - 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); - - 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 { - - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - 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 */ - - 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 { - - 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, - 3); - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); - } - } - } else { - - halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 3); - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); - } - } - -} - - -/* A2DP only / PAN(EDR) only/ A2DP+PAN(HS) */ -void halbtc8723d2ant_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); - -#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(&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); - - - 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); - - 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_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - - 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, - 2); - } else { - - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8723d2ant_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); - - 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, - 102); - } - - } - -} - - -void halbtc8723d2ant_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 = 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(&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); - -#if 0 - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - 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); -#endif - - -#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); - - 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_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - - 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); - else - 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); - - 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); - - if (wifi_busy) - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 103); - else - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 104); - - } - -#endif - -} - -void halbtc8723d2ant_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 = 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(&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); - - - 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); - - 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_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - - 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, - 2); - } else { - - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8723d2ant_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); - - 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); - } - } else { - halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 1); - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 102); - } - - } - -} - - -void halbtc8723d2ant_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 = 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(&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); - - - 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); - - 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_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - - coex_dm->is_switch_to_1dot5_ant = false; - - halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - - if (wifi_busy) { - - if ((coex_sta->a2dp_bit_pool > 40) && - (coex_sta->a2dp_bit_pool < 255)) - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 7); - else - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 5); - } else - 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); - - 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); - - 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); - - } - -} - - -/* PAN(EDR)+A2DP */ -void halbtc8723d2ant_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 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(&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); - - 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); - - 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_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - - coex_dm->is_switch_to_1dot5_ant = false; - - halbtc8723d2ant_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)) - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 7); - else - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 5); - } else - 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); - - 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); - - 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 if (wifi_turbo) - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 108); - else - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 105); - } else - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 106); - - } - -} - - -void halbtc8723d2ant_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 = 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(&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); - - - 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); - - 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_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - - 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); - else - 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); - - 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); - } - - } - -} - - -/* HID+A2DP+PAN(EDR) */ -void halbtc8723d2ant_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 = 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(&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); - - - 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); - - 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_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - - coex_dm->is_switch_to_1dot5_ant = false; - - halbtc8723d2ant_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)) - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 7); - else - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 5); - } else - 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); - - 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) { - - 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); - } - } - -} - - -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); - - /* hw all off */ - halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 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_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, 15); - - 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); - } - -} - -void halbtc8723d2ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist) -{ - 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); -} - -void halbtc8723d2ant_action_wifi_connected(IN struct btc_coexist *btcoexist) -{ - switch (coex_dm->cur_algorithm) { - - case BT_8723D_2ANT_COEX_ALGO_SCO: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = SCO.\n"); - BTC_TRACE(trace_buf); - halbtc8723d2ant_action_sco(btcoexist); - break; - case BT_8723D_2ANT_COEX_ALGO_HID: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = HID.\n"); - BTC_TRACE(trace_buf); - halbtc8723d2ant_action_hid(btcoexist); - break; - case BT_8723D_2ANT_COEX_ALGO_A2DP: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = A2DP.\n"); - BTC_TRACE(trace_buf); - halbtc8723d2ant_action_a2dp(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"); - BTC_TRACE(trace_buf); - halbtc8723d2ant_action_a2dp_pan_hs(btcoexist); - break; - case BT_8723D_2ANT_COEX_ALGO_PANEDR: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n"); - BTC_TRACE(trace_buf); - halbtc8723d2ant_action_pan_edr(btcoexist); - break; - case BT_8723D_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); - halbtc8723d2ant_action_pan_edr_a2dp(btcoexist); - break; - case BT_8723D_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); - halbtc8723d2ant_action_pan_edr_hid(btcoexist); - break; - case BT_8723D_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); - halbtc8723d2ant_action_hid_a2dp_pan_edr( - btcoexist); - break; - case BT_8723D_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); - halbtc8723d2ant_action_hid_a2dp(btcoexist); - break; - case BT_8723D_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); - halbtc8723d2ant_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); - halbtc8723d2ant_action_coex_all_off(btcoexist); - break; - } - - coex_dm->pre_algorithm = coex_dm->cur_algorithm; - -} - - -void halbtc8723d2ant_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->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"); - BTC_TRACE(trace_buf); - halbtc8723d2ant_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); - halbtc8723d2ant_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); - halbtc8723d2ant_action_bt_inquiry(btcoexist); - return; - } - - if (coex_sta->is_setupLink) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is re-link !!!\n"); - halbtc8723d2ant_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); - - halbtc8723d2ant_action_wifi_linkscan_process(btcoexist); - } else - 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); - - if (bt_hs_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "############# [BTCoex], BT Is hs\n"); - BTC_TRACE(trace_buf); - halbtc8723d2ant_action_bt_hs(btcoexist); - return; - } - - if ((BT_8723D_2ANT_BT_STATUS_NON_CONNECTED_IDLE == - coex_dm->bt_status) || - (BT_8723D_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); - - halbtc8723d2ant_action_bt_idle(btcoexist); - return; - } - - algorithm = halbtc8723d2ant_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); - halbtc8723d2ant_action_wifi_linkscan_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); - halbtc8723d2ant_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); - halbtc8723d2ant_action_wifi_not_connected(btcoexist); - } -} - - -void halbtc8723d2ant_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); - - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - /* sw all off */ - halbtc8723d2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, false); - - 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; - - halbtc8723d2ant_query_bt_info(btcoexist); -} - - -void halbtc8723d2ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean wifi_only) -{ - u8 u8tmp0 = 0, u8tmp1 = 0; - u32 vendor; - u32 u32tmp0 = 0, u32tmp1 = 0, u32tmp2 = 0; - u16 u16tmp1 = 0; - u8 i = 0; - - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], 2Ant Init HW Config!!\n"); - BTC_TRACE(trace_buf); - -#if BT_8723D_2ANT_COEX_DBG - u32tmp1 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, - 0x38); - u32tmp2 = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, - 0x54); - u16tmp1 = btcoexist->btc_read_2byte(btcoexist, 0x948); - u8tmp1 = btcoexist->btc_read_1byte(btcoexist, 0x73); - u8tmp0 = btcoexist->btc_read_1byte(btcoexist, 0x67); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** 0x67 = 0x%x, 0x948 = 0x%x, 0x73 = 0x%x(Before init_hw_config)\n", - u8tmp0, u16tmp1, u8tmp1); - BTC_TRACE(trace_buf); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], **********0x38= 0x%x, 0x54= 0x%x (Before init_hw_config)\n", - u32tmp1, u32tmp2); - BTC_TRACE(trace_buf); -#endif - - - 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->gnt_error_cnt = 0; - coex_sta->bt_relink_downcount = 0; - - for (i = 0; i <= 9; i++) - coex_sta->bt_afh_map[i] = 0; - -#if 0 - btcoexist->btc_get(btcoexist, BTC_GET_U4_VENDOR, &vendor); - if (vendor == BTC_VENDOR_LENOVO) - coex_dm->switch_thres_offset = 0; - else - coex_dm->switch_thres_offset = 20; -#endif - /* 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; - - /* default isolation = 15dB */ - coex_sta->isolation_btween_wb = BT_8723D_2ANT_DEFAULT_ISOLATION; - halbtc8723d2ant_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); - - halbtc8723d2ant_enable_gnt_to_gpio(btcoexist, true); - - /* 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); - - /* Enable counter statistics */ - btcoexist->btc_write_1byte(btcoexist, 0x76e, - 0x4); /* 0x76e[3] =1, WLAN_Act control by PTA */ - - /* 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); - - halbtc8723d2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); - - psd_scan->ant_det_is_ant_det_available = true; - - if (wifi_only) { - coex_sta->concurrent_rx_mode_on = false; - /* Path config */ - /* Set Antenna Path */ - halbtc8723d2ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8723D_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; - /* 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); - - /* Path config */ - halbtc8723d2ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8723D_2ANT_PHASE_COEX_INIT); - - btcoexist->stop_coex_dm = false; - } - - -} - -u32 halbtc8723d2ant_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 halbtc8723d2ant_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 == 12) { /* Get Ant Det from BT */ - - if (board_info->btdm_ant_num_by_ant_det == 1) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %s (%d~%d)", - "Ant Det Result", "1-Antenna", - BT_8723D_2ANT_ANTDET_PSDTHRES_1ANT, - BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION); - else { - - if (psd_scan->ant_det_psd_scan_peak_val > - (BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION) - * 100) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %s (>%d)", - "Ant Det Result", "2-Antenna (Bad-Isolation)", - BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %s (%d~%d)", - "Ant Det Result", "2-Antenna (Good-Isolation)", - BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION - + psd_scan->ant_det_thres_offset, - BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); - } - - } else 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_8723D_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_8723D_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION - + psd_scan->ant_det_thres_offset, - BT_8723D_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_8723D_2ANT_ANTDET_PSDTHRES_1ANT, - BT_8723D_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)"); - case 12: - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(BT is available, result from BT"); - break; - } - CL_PRINTF(cli_buf); - - if (psd_scan->ant_det_result == 12) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d dB", - "PSD Scan Peak Value", - psd_scan->ant_det_psd_scan_peak_val / 100); - CL_PRINTF(cli_buf); - return; - } - - 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_8723D_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 halbtc8723d2ant_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; - - if (psd_scan->ant_det_result == 12) - return; - - 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; - } - - } - } - - -} - -#ifdef PLATFORM_WINDOWS -#pragma optimize("", off) -#endif -void halbtc8723d2ant_psd_maxholddata(IN struct btc_coexist *btcoexist, - IN u32 gen_count) -{ - u32 i = 0; - u32 loop_i_max = 0, loop_val_max = 0; - - if (gen_count == 1) { - memcpy(psd_scan->psd_report_max_hold, - psd_scan->psd_report, - BT_8723D_2ANT_ANTDET_PSD_POINTS * sizeof(u32)); - } - - for (i = psd_scan->psd_start_point; - i <= psd_scan->psd_stop_point; i++) { - - /* update max-hold value at each freq point */ - 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 the max value in this seep */ - if (psd_scan->psd_report[i] > loop_val_max) { - loop_val_max = psd_scan->psd_report[i]; - loop_i_max = i; - } - } - - if (gen_count <= BT_8723D_2ANT_ANTDET_PSD_SWWEEPCOUNT) - psd_scan->psd_loop_max_value[gen_count - 1] = loop_val_max; - -} - - -#ifdef PLATFORM_WINDOWS -#pragma optimize("", off) -#endif -u32 halbtc8723d2ant_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_8723D_2ANT_ANTDET_SWEEPPOINT_DELAY) - break; - } - - val = btcoexist->btc_read_4byte(btcoexist, 0x8b4); - - psd_report = val & 0x0000ffff; - - return psd_report; -} - -#ifdef PLATFORM_WINDOWS -#pragma optimize("", off) -#endif -boolean halbtc8723d2ant_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; - u32 psd_sum = 0, avg_cnt = 0; - u32 i_max = 0, val_max = 0, val_max2 = 0; - - 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_8723D_2ANT_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 = - halbtc8723d2ant_psd_getdata( - btcoexist, i - points1); - else - psd_report = - halbtc8723d2ant_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 * halbtc8723d2ant_psd_log2base( - btcoexist, psd_report); - - n = i - psd_scan->psd_start_base; - psd_scan->psd_report[n] = tmp; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "Point=%d, psd_dB_data = %d\n", - i, psd_scan->psd_report[n]); - BTC_TRACE(trace_buf); - - i++; - - } - - halbtc8723d2ant_psd_maxholddata(btcoexist, j); - - psd_scan->psd_gen_count = j; - - /*Accumulate Max PSD value in this loop if the value > threshold */ - if (psd_scan->psd_loop_max_value[j - 1] >= - 4000) { - psd_sum = psd_sum + - psd_scan->psd_loop_max_value[j - - 1]; - avg_cnt++; - } - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "Loop=%d, Max_dB_data = %d\n", - j, psd_scan->psd_loop_max_value[j - - 1]); - BTC_TRACE(trace_buf); - - } - - if (loopcnt == BT_8723D_2ANT_ANTDET_PSD_SWWEEPCOUNT) { - - /* search the Max Value between each-freq-point-max-hold value of all sweep*/ - for (i = 1; - i <= BT_8723D_2ANT_ANTDET_PSD_SWWEEPCOUNT; - i++) { - - if (i == 1) { - i_max = i; - val_max = psd_scan->psd_loop_max_value[i - - 1]; - val_max2 = - psd_scan->psd_loop_max_value[i - - 1]; - } else if ( - psd_scan->psd_loop_max_value[i - - 1] > val_max) { - val_max2 = val_max; - i_max = i; - val_max = psd_scan->psd_loop_max_value[i - - 1]; - } else if ( - psd_scan->psd_loop_max_value[i - - 1] > val_max2) - val_max2 = - psd_scan->psd_loop_max_value[i - - 1]; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "i = %d, val_hold= %d, val_max = %d, val_max2 = %d\n", - i, psd_scan->psd_loop_max_value[i - - 1], - val_max, val_max2); - - BTC_TRACE(trace_buf); - } - - psd_scan->psd_max_value_point = i_max; - psd_scan->psd_max_value = val_max; - psd_scan->psd_max_value2 = val_max2; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "val_max = %d, val_max2 = %d\n", - psd_scan->psd_max_value, - psd_scan->psd_max_value2); - BTC_TRACE(trace_buf); - } - - if (avg_cnt != 0) { - psd_scan->psd_avg_value = (psd_sum / avg_cnt); - if ((psd_sum % avg_cnt) >= (avg_cnt / 2)) - psd_scan->psd_avg_value++; - } else - psd_scan->psd_avg_value = 0; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "AvgLoop=%d, Avg_dB_data = %d\n", - avg_cnt, psd_scan->psd_avg_value); - 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); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx PSD Sweep Stop!!\n"); - BTC_TRACE(trace_buf); - return is_sweep_ok; - -} - -#ifdef PLATFORM_WINDOWS -#pragma optimize("", off) -#endif -boolean halbtc8723d2ant_psd_antenna_detection(IN struct btc_coexist - *btcoexist) -{ - u32 i = 0; - u32 wlpsd_cent_freq = 2484, wlpsd_span = 2; - s32 wlpsd_offset = -4; - u32 bt_tx_time, bt_le_channel; - 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, 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; - - memset(psd_scan->ant_det_peak_val, 0, 16 * sizeof(u8)); - memset(psd_scan->ant_det_peak_freq, 0, 16 * sizeof(u8)); - - psd_scan->ant_det_bt_tx_time = - BT_8723D_2ANT_ANTDET_BTTXTIME; /* 0.42ms*50 = 20ms (0.42ms = 1 PSD sweep) */ - psd_scan->ant_det_bt_le_channel = BT_8723D_2ANT_ANTDET_BTTXCHANNEL; - - bt_tx_time = psd_scan->ant_det_bt_tx_time; - bt_le_channel = psd_scan->ant_det_bt_le_channel; - - 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; - } - } -#if 0 - 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; -#endif - 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, - BT_8723D_2ANT_ANTDET_PSD_SWWEEPCOUNT); - 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, */ - halbtc8723d2ant_ps_tdma(btcoexist, FORCE_EXEC, - false, 0); - - /* Set coex table */ - halbtc8723d2ant_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 */ - /* Set Antenna Path, both GNT_WL/GNT_BT = 1, and control by SW */ - halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, - FORCE_EXEC, - BT_8723D_2ANT_PHASE_ANTENNA_DET); - - 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_2byte(btcoexist, 0x948); - u32tmp0 = btcoexist->btc_read_4byte(btcoexist, 0x70); - u32tmp1 = halbtc8723d2ant_ltecoex_indirect_read_reg( - btcoexist, 0x38); - u32tmp2 = halbtc8723d2ant_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 (!halbtc8723d2ant_psd_sweep_point(btcoexist, - wlpsd_cent_freq, wlpsd_offset, wlpsd_span, - BT_8723D_2ANT_ANTDET_PSD_POINTS, - BT_8723D_2ANT_ANTDET_PSD_AVGNUM, 3)) { - 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->ant_det_pre_psdscan_peak_val > - (BT_8723D_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->ant_det_pre_psdscan_peak_val / - 100, - BT_8723D_2ANT_ANTDET_PSDTHRES_BACKGROUND - + psd_scan->ant_det_thres_offset); - BTC_TRACE(trace_buf); - 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->ant_det_pre_psdscan_peak_val / - 100, - BT_8723D_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)); - - /* Sync WL Rx PSD with BT Tx time because H2C->Mailbox delay */ - delay_ms(20); - - if (!halbtc8723d2ant_psd_sweep_point(btcoexist, - wlpsd_cent_freq, wlpsd_offset, - wlpsd_span, - BT_8723D_2ANT_ANTDET_PSD_POINTS, - BT_8723D_2ANT_ANTDET_PSD_AVGNUM, - BT_8723D_2ANT_ANTDET_PSD_SWWEEPCOUNT)) { - ant_det_finish = false; - board_info->btdm_ant_num_by_ant_det = 1; - psd_scan->ant_det_result = 8; - state = 99; - break; - } - -#if 1 - psd_scan->ant_det_psd_scan_peak_val = - psd_scan->psd_max_value; -#endif -#if 0 - psd_scan->ant_det_psd_scan_peak_val = - ((psd_scan->psd_max_value - psd_scan->psd_avg_value) < - 800) ? - psd_scan->psd_max_value : (( - psd_scan->psd_max_value - - psd_scan->psd_max_value2 <= 300) ? - psd_scan->psd_avg_value : - psd_scan->psd_max_value2); -#endif - 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->ant_det_psd_scan_peak_val / 100; - psd_rep2 = psd_scan->ant_det_psd_scan_peak_val - - 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_8723D_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_8723D_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_8723D_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_8723D_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; - 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->ant_det_psd_scan_peak_val > - (BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION) - * 100) { - psd_scan->ant_det_result = 1; - 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 / - 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->ant_det_psd_scan_peak_val > - (BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION - + psd_scan->ant_det_thres_offset) * 100) { - psd_scan->ant_det_result = 2; - 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 / - 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->ant_det_psd_scan_peak_val > - (BT_8723D_2ANT_ANTDET_PSDTHRES_1ANT) * - 100) { - psd_scan->ant_det_result = 3; - 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 / - 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; - 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 */ - halbtc8723d2ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, FORCE_EXEC, - BT_8723D_2ANT_PHASE_2G_RUNTIME); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to PTA\n!!"); - BTC_TRACE(trace_buf); - - 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; - break; - } - - } while (!outloop); - - return ant_det_finish; - -} - -#ifdef PLATFORM_WINDOWS -#pragma optimize("", off) -#endif -boolean halbtc8723d2ant_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, ant_det_finish = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); - - ant_det_count++; - - psd_scan->ant_det_try_count = ant_det_count; - - if (scan || roam) { - ant_det_finish = false; - psd_scan->ant_det_result = 6; - } else if (coex_sta->bt_disabled) { - ant_det_finish = false; - psd_scan->ant_det_result = 11; - } else if (coex_sta->num_of_profile >= 1) { - 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; - psd_scan->ant_det_result = 9; - } else if (coex_sta->c2h_bt_inquiry_page) { - ant_det_finish = false; - psd_scan->ant_det_result = 10; - } else { - - ant_det_finish = halbtc8723d2ant_psd_antenna_detection( - btcoexist); - - delay_ms(psd_scan->ant_det_bt_tx_time); - } - - - if (!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, - ant_det_finish == true ? "Yes" : "No"); - BTC_TRACE(trace_buf); - - return ant_det_finish; - -} - - -/* ************************************************************ - * work around function start with wa_halbtc8723d2ant_ - * ************************************************************ - * ************************************************************ - * extern function start with ex_halbtc8723d2ant_ - * ************************************************************ */ -void ex_halbtc8723d2ant_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 8723d 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 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 path control to WL */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x80, 0x1); - btcoexist->btc_write_2byte(btcoexist, 0x948, 0x0); - - /* Check efuse 0xc3[6] for Single Antenna Path */ - if (board_info->single_ant_path == 0) { - /* set to S1 */ - board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; - u8tmp = 4; - value = 1; - } else if (board_info->single_ant_path == 1) { - /* set to S0 */ - board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; - u8tmp = 5; - value = 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); - - /* Set Antenna Path to BT side */ - halbtc8723d2ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8723D_1ANT_PHASE_COEX_POWERON); - - /* Write Single Antenna Position to Registry to tell BT for 872db. This line can be removed - since BT EFuse also add "single antenna position" in EFuse for 8723d*/ - btcoexist->btc_set(btcoexist, BTC_SET_ACT_ANTPOSREGRISTRY_CTRL, - &value); - - /* 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 */ - 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", - halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x38)); - BTC_TRACE(trace_buf); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** MAC Reg 0x70/ BB Reg 0x948 (Power-On) = 0x%x / 0x%x**********\n", - btcoexist->btc_read_4byte(btcoexist, 0x70), - btcoexist->btc_read_2byte(btcoexist, 0x948)); - BTC_TRACE(trace_buf); -} - -void ex_halbtc8723d2ant_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_halbtc8723d2ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean wifi_only) -{ - halbtc8723d2ant_init_hw_config(btcoexist, wifi_only); -} - -void ex_halbtc8723d2ant_init_coex_dm(IN struct btc_coexist *btcoexist) -{ - - halbtc8723d2ant_init_coex_dm(btcoexist); -} - -void ex_halbtc8723d2ant_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, bt_coex_ver = 0; - u32 fw_ver = 0, bt_patch_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 (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", - board_info->pg_ant_num, board_info->btdm_ant_num, - (board_info->btdm_ant_pos == 1 ? "S1" : "S0")); - CL_PRINTF(cli_buf); - } else { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %d/ %d/ %s (retry=%d/fail=%d/result=%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 == 1 ? "S1" : "S0"), - 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); - } - } - - if (board_info->ant_det_result_five_complete) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %d/ %d", - "AntDet(Registry) Num/PSD Value", - board_info->btdm_ant_num_by_ant_det, - (board_info->antdetval & 0x7f)); - 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_8723d_2ant, glcoex_ver_8723d_2ant, - glcoex_ver_btdesired_8723d_2ant, - bt_coex_ver, - (bt_coex_ver == 0xff ? "Unknown" : - (coex_sta->bt_disabled ? "BT-disable" : - (bt_coex_ver >= glcoex_ver_btdesired_8723d_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); - - 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_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) - ? "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); - - 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", - (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); - - halbtc8723d2ant_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); - - 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_8723D_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_8723d_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", - "AntDiv/ ForceLPS", - ((board_info->ant_div_cfg) ? "On" : "Off"), - ((coex_sta->force_lps_on) ? "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, - coex_dm->cur_bt_dec_pwr_lvl); - CL_PRINTF(cli_buf); - - u32tmp[0] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x38); - lte_coex_on = ((u32tmp[0] & BIT(7)) >> 7) ? true : false; - - if (lte_coex_on) { - - u32tmp[0] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, - 0xa0); - u32tmp[1] = halbtc8723d2ant_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] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, - 0xa8); - u32tmp[1] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, - 0xac); - u32tmp[2] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, - 0xb0); - u32tmp[3] = halbtc8723d2ant_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] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x38); - u32tmp[1] = halbtc8723d2ant_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); - - u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x948); - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x67); - - 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_PRINTF(cli_buf); - - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x964); - u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x864); - u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0xab7); - u8tmp[3] = btcoexist->btc_read_1byte(btcoexist, 0xa01); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", - "0x964[1]/0x864[0]/0xab7[5]/0xa01[7]", - (int)((u8tmp[0] & BIT(1)) >> 1), (int)((u8tmp[1] & BIT(0))), - (int)((u8tmp[2] & BIT(3)) >> 3), - (int)((u8tmp[3] & BIT(7)) >> 7)); - CL_PRINTF(cli_buf); - - - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x4c6); - u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40); - u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0x45e); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", - "0x4c6[4]/0x40[5]/0x45e[3](TxRetry)", - (int)((u8tmp[0] & BIT(4)) >> 4), - (int)((u8tmp[1] & BIT(5)) >> 5), - (int)((u8tmp[2] & BIT(3)) >> 3)); - 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/0x522/4-RxAGC", - u32tmp[0], u8tmp[0], (u8tmp[1] & 0x2) ? "On" : "Off"); - 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/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); -#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 %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); -} - - -void ex_halbtc8723d2ant_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; - - halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_ACTIVE, false); - - halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_ONOFF, false); - - halbtc8723d2ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8723D_2ANT_PHASE_WLAN_OFF); - - halbtc8723d2ant_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; - - halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_ACTIVE, true); - - halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_ONOFF, true); - - halbtc8723d2ant_init_hw_config(btcoexist, false); - halbtc8723d2ant_init_coex_dm(btcoexist); - halbtc8723d2ant_query_bt_info(btcoexist); - } -} - -void ex_halbtc8723d2ant_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; - coex_sta->under_ips = false; - - if (coex_sta->force_lps_on == true) { /* LPS No-32K */ - /* Write WL "Active" in Score-board for PS-TDMA */ - halbtc8723d2ant_post_state_to_bt(btcoexist, - 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 */ - halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_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; - - halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_ACTIVE, true); - } -} - -void ex_halbtc8723d2ant_scan_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - u32 u32tmp; - u8 u8tmpa, u8tmpb; - boolean wifi_connected = false; - - - 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 */ - halbtc8723d2ant_query_bt_info(btcoexist); - - if (BTC_SCAN_START == type) { - - if (!wifi_connected) - 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); - - halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_SCAN, true); - halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_ACTIVE, true); - - halbtc8723d2ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8723D_2ANT_PHASE_2G_RUNTIME); - - halbtc8723d2ant_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); - - halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_SCAN, false); - - halbtc8723d2ant_run_coexist_mechanism(btcoexist); - } - -} - -void ex_halbtc8723d2ant_connect_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - if (btcoexist->manual_control || - btcoexist->stop_coex_dm) - 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\n"); - BTC_TRACE(trace_buf); - - halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_ACTIVE, true); - halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_ACTIVE, true); - - halbtc8723d2ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8723D_2ANT_PHASE_2G_RUNTIME); - - 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_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\n"); - BTC_TRACE(trace_buf); - - halbtc8723d2ant_run_coexist_mechanism(btcoexist); - } -} - -void ex_halbtc8723d2ant_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; - 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); - - halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_ACTIVE, true); - - halbtc8723d2ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8723D_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 */ - - halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_ACTIVE, false); - } - - - halbtc8723d2ant_update_wifi_channel_info(btcoexist, type); -} - -void ex_halbtc8723d2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - boolean under_4way = false; - - if (btcoexist->manual_control || - btcoexist->stop_coex_dm) - 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) { - halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_ACTIVE, true); - halbtc8723d2ant_run_coexist_mechanism(btcoexist); - } - -} - -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; - - 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_8723D_2ANT_MAX) - rsp_source = BT_INFO_SRC_8723D_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_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_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_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_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; - } else - coex_sta->is_setupLink = false; - - if (coex_sta->bt_info_ext & BIT(3)) - coex_sta->cnt_IgnWlanAct++; - - 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)) { - - halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_SCAN, true); - - } else { - - halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_SCAN, false); - } - } else - halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_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) - halbtc8723d2ant_update_wifi_channel_info( - btcoexist, BTC_MEDIA_CONNECT); - else - halbtc8723d2ant_update_wifi_channel_info( - btcoexist, - BTC_MEDIA_DISCONNECT); - } - - - /* If Ignore_WLanAct && not SetUp_Link or Role_Switch */ - 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); - halbtc8723d2ant_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); - } - - halbtc8723d2ant_update_bt_link_info(btcoexist); - - halbtc8723d2ant_run_coexist_mechanism(btcoexist); -} - -void ex_halbtc8723d2ant_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; - - halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_ACTIVE, true); - halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_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); - - halbtc8723d2ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8723D_2ANT_PHASE_WLAN_OFF); - - halbtc8723d2ant_action_coex_all_off(btcoexist); - - halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_ACTIVE, false); - halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_ONOFF, false); - btcoexist->stop_coex_dm = true; - - } -} - -void ex_halbtc8723d2ant_halt_notify(IN struct btc_coexist *btcoexist) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); - BTC_TRACE(trace_buf); - - halbtc8723d2ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8723D_2ANT_PHASE_WLAN_OFF); - - ex_halbtc8723d2ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); - - halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_ACTIVE, false); - halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_ONOFF, false); -} - -void ex_halbtc8723d2ant_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_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; - - - halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_ACTIVE, false); - halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_ONOFF, false); - - if (BTC_WIFI_PNP_SLEEP_KEEP_ANT == pnp_state) { - - halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8723D_2ANT_PHASE_2G_RUNTIME); - } else { - - halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8723D_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); - - halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_ACTIVE, true); - halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_ONOFF, true); - } -} - -void ex_halbtc8723d2ant_periodical(IN struct btc_coexist *btcoexist) -{ - struct btc_board_info *board_info = &btcoexist->board_info; - boolean wifi_busy = false; - u32 bt_patch_ver; - static u8 cnt = 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_8723D_2ANT == 0) - halbtc8723d2ant_query_bt_info(btcoexist); -#endif - - halbtc8723d2ant_monitor_bt_ctr(btcoexist); - halbtc8723d2ant_monitor_wifi_ctr(btcoexist); - halbtc8723d2ant_monitor_bt_enable_disable(btcoexist); - -# if 1 - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - - /* halbtc8723d2ant_read_score_board(btcoexist, &bt_scoreboard_val); */ - - if (wifi_busy) { - halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_UNDERTEST, true); - /* - halbtc8723d2ant_post_state_to_bt(btcoexist, - 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); - /* - halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_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; - } - - /* 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_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 - - if (board_info->btdm_ant_det_finish) { - if ((psd_scan->ant_det_result == 12) && - (psd_scan->ant_det_psd_scan_peak_val == 0) - && (!psd_scan->is_AntDet_running)) - psd_scan->ant_det_psd_scan_peak_val = - btcoexist->btc_get_ant_det_val_from_bt( - btcoexist) * 100; - } - -#endif - } - - - if (halbtc8723d2ant_is_wifibt_status_changed(btcoexist)) - halbtc8723d2ant_run_coexist_mechanism(btcoexist); -} - -void ex_halbtc8723d2ant_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 */ - board_info->ant_div_cfg = true; - - halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI, - FORCE_EXEC, - BT_8723D_2ANT_PHASE_2G_RUNTIME); - - } else { /* one antenna */ - - halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8723D_2ANT_PHASE_2G_RUNTIME); - - } -} - -#ifdef PLATFORM_WINDOWS -#pragma optimize("", off) -#endif -void ex_halbtc8723d2ant_antenna_detection(IN struct btc_coexist *btcoexist, - IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) -{ - - static u32 ant_det_count = 0, ant_det_fail_count = 0; - struct btc_board_info *board_info = &btcoexist->board_info; - u16 u16tmp; - u8 AntDetval = 0; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx Ext Call AntennaDetect()!!\n"); - BTC_TRACE(trace_buf); - -#if BT_8723D_2ANT_ANTDET_ENABLE - - 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_8723D_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); - - 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; - psd_scan->ant_det_try_count = 1; - psd_scan->ant_det_fail_count = 0; - board_info->btdm_ant_num_by_ant_det = (u16tmp & - BIT(3)) ? 1 : 2; - psd_scan->ant_det_result = 12; - - psd_scan->ant_det_psd_scan_peak_val = - btcoexist->btc_get_ant_det_val_from_bt( - btcoexist) * 100; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Result from BT (%d-Ant)\n", - board_info->btdm_ant_num_by_ant_det); - BTC_TRACE(trace_buf); - } else - board_info->btdm_ant_det_finish = - halbtc8723d2ant_psd_antenna_detection_check( - btcoexist); - - btcoexist->bdontenterLPS = false; - - 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); - - /*for 8723d, btc_set_bt_trx_mask is just used to - notify BT stop le tx and Ant Det Result , not set BT RF TRx Mask */ - if (psd_scan->ant_det_result != 12) { - - AntDetval = (u8)( - psd_scan->ant_det_psd_scan_peak_val - / 100) & 0x7f; - - AntDetval = - (board_info->btdm_ant_num_by_ant_det - == 1) ? (AntDetval | 0x80) : - AntDetval; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxx AntennaDetect(), Ant Count = %d, PSD Val = %d\n", - ((AntDetval & - 0x80) ? 1 - : 2), AntDetval - & 0x7f); - BTC_TRACE(trace_buf); - - if (btcoexist->btc_set_bt_trx_mask( - btcoexist, AntDetval)) - BTC_SPRINTF(trace_buf, - BT_TMP_BUF_SIZE, - "xxxxxx AntennaDetect(), Notify BT stop le tx by set_bt_trx_mask ok!\n"); - else - BTC_SPRINTF(trace_buf, - BT_TMP_BUF_SIZE, - "xxxxxx AntennaDetect(), Notify BT stop le tx by set_bt_trx_mask fail!\n"); - - BTC_TRACE(trace_buf); - } else - board_info->antdetval = - psd_scan->ant_det_psd_scan_peak_val/100; - - 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); - } - - psd_scan->ant_det_inteval_count = 0; - psd_scan->is_AntDet_running = false; - - /* stimulate coex running */ - halbtc8723d2ant_run_coexist_mechanism( - btcoexist); - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Stimulate Coex running\n!!"); - BTC_TRACE(trace_buf); - } 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); - - if (psd_scan->ant_det_inteval_count == 8) - btcoexist->bdontenterLPS = true; - else - btcoexist->bdontenterLPS = false; - } - - } -#endif - - -} - - -void ex_halbtc8723d2ant_display_ant_detection(IN struct btc_coexist *btcoexist) -{ - -#if BT_8723D_2ANT_ANTDET_ENABLE - struct btc_board_info *board_info = &btcoexist->board_info; - - if (psd_scan->ant_det_try_count != 0) { - halbtc8723d2ant_psd_show_antenna_detect_result(btcoexist); - - if (board_info->btdm_ant_det_finish) - halbtc8723d2ant_psd_showdata(btcoexist); - } -#endif - -} - - -#endif - -#endif /* #if (RTL8723D_SUPPORT == 1) */ - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8723d2ant.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8723d2ant.h deleted file mode 100644 index b0fe6f8013fd..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8723d2ant.h +++ /dev/null @@ -1,419 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ - -#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) - -#if (RTL8723D_SUPPORT == 1) - -/* ******************************************* - * The following is for 8723D 2Ant BT Co-exist definition - * ******************************************* */ -#define BT_8723D_2ANT_COEX_DBG 0 -#define BT_AUTO_REPORT_ONLY_8723D_2ANT 1 - - -#define BT_INFO_8723D_2ANT_B_FTP BIT(7) -#define BT_INFO_8723D_2ANT_B_A2DP BIT(6) -#define BT_INFO_8723D_2ANT_B_HID BIT(5) -#define BT_INFO_8723D_2ANT_B_SCO_BUSY BIT(4) -#define BT_INFO_8723D_2ANT_B_ACL_BUSY BIT(3) -#define BT_INFO_8723D_2ANT_B_INQ_PAGE BIT(2) -#define BT_INFO_8723D_2ANT_B_SCO_ESCO BIT(1) -#define BT_INFO_8723D_2ANT_B_CONNECTION BIT(0) - -#define BTC_RSSI_COEX_THRESH_TOL_8723D_2ANT 2 - - -#define BT_8723D_2ANT_WIFI_RSSI_COEXSWITCH_THRES1 80 /* unit: % WiFi RSSI Threshold for 2-Ant free-run/2-Ant TDMA translation, default = 42 */ -#define BT_8723D_2ANT_BT_RSSI_COEXSWITCH_THRES1 80 /* unit: % BT RSSI Threshold for 2-Ant free-run/2-Ant TDMA translation, default = 46 */ -#define BT_8723D_2ANT_WIFI_RSSI_COEXSWITCH_THRES2 80 /* unit: % WiFi RSSI Threshold for 1-Ant TDMA/1-Ant PS-TDMA translation, default = 42 */ -#define BT_8723D_2ANT_BT_RSSI_COEXSWITCH_THRES2 80 /* unit: % BT RSSI Threshold for 1-Ant TDMA/1-Ant PS-TDMA translation, default = 46 */ -#define BT_8723D_2ANT_DEFAULT_ISOLATION 15 /* unit: dB */ -#define BT_8723D_2ANT_WIFI_MAX_TX_POWER 15 /* unit: dBm */ -#define BT_8723D_2ANT_BT_MAX_TX_POWER 3 /* unit: dBm */ -#define BT_8723D_2ANT_WIFI_SIR_THRES1 -15 /* unit: dB */ -#define BT_8723D_2ANT_WIFI_SIR_THRES2 -30 /* unit: dB */ -#define BT_8723D_2ANT_BT_SIR_THRES1 -15 /* unit: dB */ -#define BT_8723D_2ANT_BT_SIR_THRES2 -30 /* unit: dB */ - - -/* for Antenna detection */ -#define BT_8723D_2ANT_ANTDET_PSDTHRES_BACKGROUND 50 -#define BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION 70 -#define BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION 52 -#define BT_8723D_2ANT_ANTDET_PSDTHRES_1ANT 40 -#define BT_8723D_2ANT_ANTDET_RETRY_INTERVAL 10 /* retry timer if ant det is fail, unit: second */ -#define BT_8723D_2ANT_ANTDET_SWEEPPOINT_DELAY 60000 -#define BT_8723D_2ANT_ANTDET_ENABLE 1 -#define BT_8723D_2ANT_ANTDET_BTTXTIME 100 -#define BT_8723D_2ANT_ANTDET_BTTXCHANNEL 39 -#define BT_8723D_2ANT_ANTDET_PSD_SWWEEPCOUNT 50 - - -#define BT_8723D_2ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT 30000 - -enum bt_8723d_2ant_signal_state { - BT_8723D_2ANT_SIG_STA_SET_TO_LOW = 0x0, - BT_8723D_2ANT_SIG_STA_SET_BY_HW = 0x0, - BT_8723D_2ANT_SIG_STA_SET_TO_HIGH = 0x1, - BT_8723D_2ANT_SIG_STA_MAX -}; - -enum bt_8723d_2ant_path_ctrl_owner { - BT_8723D_2ANT_PCO_BTSIDE = 0x0, - BT_8723D_2ANT_PCO_WLSIDE = 0x1, - BT_8723D_2ANT_PCO_MAX -}; - -enum bt_8723d_2ant_gnt_ctrl_type { - BT_8723D_2ANT_GNT_TYPE_CTRL_BY_PTA = 0x0, - BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW = 0x1, - BT_8723D_2ANT_GNT_TYPE_MAX -}; - -enum bt_8723d_2ant_gnt_ctrl_block { - BT_8723D_2ANT_GNT_BLOCK_RFC_BB = 0x0, - BT_8723D_2ANT_GNT_BLOCK_RFC = 0x1, - BT_8723D_2ANT_GNT_BLOCK_BB = 0x2, - BT_8723D_2ANT_GNT_BLOCK_MAX -}; - -enum bt_8723d_2ant_lte_coex_table_type { - BT_8723D_2ANT_CTT_WL_VS_LTE = 0x0, - BT_8723D_2ANT_CTT_BT_VS_LTE = 0x1, - BT_8723D_2ANT_CTT_MAX -}; - -enum bt_8723d_2ant_lte_break_table_type { - BT_8723D_2ANT_LBTT_WL_BREAK_LTE = 0x0, - BT_8723D_2ANT_LBTT_BT_BREAK_LTE = 0x1, - BT_8723D_2ANT_LBTT_LTE_BREAK_WL = 0x2, - BT_8723D_2ANT_LBTT_LTE_BREAK_BT = 0x3, - BT_8723D_2ANT_LBTT_MAX -}; - -enum bt_info_src_8723d_2ant { - BT_INFO_SRC_8723D_2ANT_WIFI_FW = 0x0, - BT_INFO_SRC_8723D_2ANT_BT_RSP = 0x1, - BT_INFO_SRC_8723D_2ANT_BT_ACTIVE_SEND = 0x2, - BT_INFO_SRC_8723D_2ANT_MAX -}; - -enum bt_8723d_2ant_bt_status { - BT_8723D_2ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, - BT_8723D_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, - BT_8723D_2ANT_BT_STATUS_INQ_PAGE = 0x2, - BT_8723D_2ANT_BT_STATUS_ACL_BUSY = 0x3, - BT_8723D_2ANT_BT_STATUS_SCO_BUSY = 0x4, - BT_8723D_2ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, - BT_8723D_2ANT_BT_STATUS_MAX -}; - -enum bt_8723d_2ant_coex_algo { - BT_8723D_2ANT_COEX_ALGO_UNDEFINED = 0x0, - BT_8723D_2ANT_COEX_ALGO_SCO = 0x1, - BT_8723D_2ANT_COEX_ALGO_HID = 0x2, - BT_8723D_2ANT_COEX_ALGO_A2DP = 0x3, - BT_8723D_2ANT_COEX_ALGO_A2DP_PANHS = 0x4, - BT_8723D_2ANT_COEX_ALGO_PANEDR = 0x5, - BT_8723D_2ANT_COEX_ALGO_PANHS = 0x6, - BT_8723D_2ANT_COEX_ALGO_PANEDR_A2DP = 0x7, - BT_8723D_2ANT_COEX_ALGO_PANEDR_HID = 0x8, - 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_MAX -}; - -enum bt_8723d_2ant_phase { - BT_8723D_2ANT_PHASE_COEX_INIT = 0x0, - BT_8723D_2ANT_PHASE_WLANONLY_INIT = 0x1, - BT_8723D_2ANT_PHASE_WLAN_OFF = 0x2, - BT_8723D_2ANT_PHASE_2G_RUNTIME = 0x3, - BT_8723D_2ANT_PHASE_5G_RUNTIME = 0x4, - BT_8723D_2ANT_PHASE_BTMPMODE = 0x5, - BT_8723D_2ANT_PHASE_ANTENNA_DET = 0x6, - BT_8723D_2ANT_PHASE_COEX_POWERON = 0x7, - BT_8723D_2ANT_PHASE_MAX -}; - -enum bt_8723d_2ant_Scoreboard { - BT_8723D_2ANT_SCOREBOARD_ACTIVE = BIT(0), - 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_WLBUSY = BIT(6) -}; - - - -struct coex_dm_8723d_2ant { - /* 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; - - u8 pre_ant_pos_type; - u8 cur_ant_pos_type; -}; - -struct coex_sta_8723d_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; - boolean bt_tx_rx_mask; - u8 pre_bt_rssi_state; - u8 pre_wifi_rssi_state[4]; - u8 bt_info_c2h[BT_INFO_SRC_8723D_2ANT_MAX][10]; - u32 bt_info_c2h_cnt[BT_INFO_SRC_8723D_2ANT_MAX]; - boolean bt_whck_test; - boolean c2h_bt_inquiry_page; - boolean c2h_bt_remote_name_req; - 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_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; - - 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; - boolean 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; -}; - -#define BT_8723D_2ANT_ANTDET_PSD_POINTS 256 /* MAX:1024 */ -#define BT_8723D_2ANT_ANTDET_PSD_AVGNUM 1 /* MAX:3 */ -#define BT_8723D_2ANT_ANTDET_BUF_LEN 16 - -struct psdscan_sta_8723d_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_8723D_2ANT_ANTDET_BUF_LEN]; - u8 ant_det_peak_freq[BT_8723D_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; - u32 psd_avg_value; /* filter loop_max_value that below BT_8723D_1ANT_ANTDET_PSDTHRES_1ANT, and average the rest*/ - u32 psd_loop_max_value[BT_8723D_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_AntDet_running; - boolean is_psd_show_max_only; -}; - - -/* ******************************************* - * The following is interface which will notify coex module. - * ******************************************* */ -void ex_halbtc8723d2ant_power_on_setting(IN struct btc_coexist *btcoexist); -void ex_halbtc8723d2ant_pre_load_firmware(IN struct btc_coexist *btcoexist); -void ex_halbtc8723d2ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean wifi_only); -void ex_halbtc8723d2ant_init_coex_dm(IN struct btc_coexist *btcoexist); -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); -void ex_halbtc8723d2ant_scan_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8723d2ant_connect_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8723d2ant_media_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -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_rf_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8723d2ant_halt_notify(IN struct btc_coexist *btcoexist); -void ex_halbtc8723d2ant_pnp_notify(IN struct btc_coexist *btcoexist, - IN u8 pnp_state); -void ex_halbtc8723d2ant_set_antenna_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8723d2ant_periodical(IN struct btc_coexist *btcoexist); -void ex_halbtc8723d2ant_display_coex_info(IN struct btc_coexist *btcoexist); -void ex_halbtc8723d2ant_antenna_detection(IN struct btc_coexist *btcoexist, - IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); -void ex_halbtc8723d2ant_display_ant_detection(IN struct btc_coexist *btcoexist); - - -#else -#define ex_halbtc8723d2ant_power_on_setting(btcoexist) -#define ex_halbtc8723d2ant_pre_load_firmware(btcoexist) -#define ex_halbtc8723d2ant_init_hw_config(btcoexist, wifi_only) -#define ex_halbtc8723d2ant_init_coex_dm(btcoexist) -#define ex_halbtc8723d2ant_ips_notify(btcoexist, type) -#define ex_halbtc8723d2ant_lps_notify(btcoexist, type) -#define ex_halbtc8723d2ant_scan_notify(btcoexist, type) -#define ex_halbtc8723d2ant_connect_notify(btcoexist, type) -#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_rf_status_notify(btcoexist, type) -#define ex_halbtc8723d2ant_halt_notify(btcoexist) -#define ex_halbtc8723d2ant_pnp_notify(btcoexist, pnp_state) -#define ex_halbtc8723d2ant_periodical(btcoexist) -#define ex_halbtc8723d2ant_display_coex_info(btcoexist) -#define ex_halbtc8723d2ant_set_antenna_notify(btcoexist, type) -#define ex_halbtc8723d2ant_display_ant_detection(btcoexist) -#define ex_halbtc8723d2ant_antenna_detection(btcoexist, cent_freq, offset, span, seconds) -#endif - -#endif - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8812a1ant.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8812a1ant.c deleted file mode 100644 index dfe2c6558177..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8812a1ant.c +++ /dev/null @@ -1,3462 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ -/* ************************************************************ - * Description: - * - * This file is for RTL8812A 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 (RTL8812A_SUPPORT == 1) -/* ************************************************************ - * Global variables, these are static variables - * ************************************************************ */ -static u8 *trace_buf = &gl_btc_trace_buf[0]; -static struct coex_dm_8812a_1ant glcoex_dm_8812a_1ant; -static struct coex_dm_8812a_1ant *coex_dm = &glcoex_dm_8812a_1ant; -static struct coex_sta_8812a_1ant glcoex_sta_8812a_1ant; -static struct coex_sta_8812a_1ant *coex_sta = &glcoex_sta_8812a_1ant; - -const char *const glbt_info_src_8812a_1ant[] = { - "BT Info[wifi fw]", - "BT Info[bt rsp]", - "BT Info[bt auto report]", -}; - -u32 glcoex_ver_date_8812a_1ant = 20140708; -u32 glcoex_ver_8812a_1ant = 0x52; - -/* ************************************************************ - * local function proto type if needed - * ************************************************************ - * ************************************************************ - * local function start with halbtc8812a1ant_ - * ************************************************************ */ -u8 halbtc8812a1ant_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_8812A_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_8812A_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_8812A_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 halbtc8812a1ant_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_8812A_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_8812A_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_8812A_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 halbtc8812a1ant_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; -} - -/* to check 0x430/0x434 is correct?? */ -void halbtc8812a1ant_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; -} - -/* to check 0x42a ?? */ -void halbtc8812a1ant_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; -} - -/* to check 0x456?? */ -void halbtc8812a1ant_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 halbtc8812a1ant_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 */ - halbtc8812a1ant_update_ra_mask(btcoexist, force_exec, - 0x0); - break; - case 1: /* disable cck 1/2 */ - halbtc8812a1ant_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 */ - halbtc8812a1ant_update_ra_mask(btcoexist, force_exec, - 0x0001f1f7); - break; - default: - break; - } - - halbtc8812a1ant_auto_rate_fallback_retry(btcoexist, force_exec, - arfr_type); - halbtc8812a1ant_retry_limit(btcoexist, force_exec, retry_limit_type); - halbtc8812a1ant_ampdu_max_time(btcoexist, force_exec, ampdu_time_type); -} - -void halbtc8812a1ant_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 halbtc8812a1ant_query_bt_info(IN struct btc_coexist *btcoexist) -{ - u8 data_len = 3; - u8 buf[5] = {0}; - - if (!coex_sta->bt_disabled) { - if (!coex_sta->bt_info_query_cnt || - (coex_sta->bt_info_c2h_cnt[BT_INFO_SRC_8812A_1ANT_BT_RSP] - - coex_sta->bt_info_query_cnt) > 2) { - buf[0] = data_len; - buf[1] = 0x1; /* polling enable, 1=enable, 0=disable */ - buf[2] = 0x2; /* polling time in seconds */ - buf[3] = 0x1; /* auto report enable, 1=enable, 0=disable */ - - btcoexist->btc_set(btcoexist, BTC_SET_ACT_CTRL_BT_INFO, - (void *)&buf[0]); - } - } - coex_sta->bt_info_query_cnt++; -} - -void halbtc8812a1ant_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; - - 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 > 1150) && - (!coex_sta->c2h_bt_inquiry_page)) - coex_sta->pop_event_cnt++; - - 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 ((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) { - halbtc8812a1ant_query_bt_info(btcoexist); - num_of_bt_counter_chk = 0; - } - } -} - -/* to check registers */ -void halbtc8812a1ant_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; - - 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, - 0xf40); - - coex_sta->crc_err_cck = 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, - 0xf42); - } - - - /* 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)) { - if ((coex_dm->bt_status == BT_8812A_1ANT_BT_STATUS_ACL_BUSY) || - (coex_dm->bt_status == - BT_8812A_1ANT_BT_STATUS_ACL_SCO_BUSY) || - (coex_dm->bt_status == - BT_8812A_1ANT_BT_STATUS_SCO_BUSY)) { - if (coex_sta->crc_ok_cck > (coex_sta->crc_ok_11g + - coex_sta->crc_ok_11n + - coex_sta->crc_ok_11n_agg)) { - if (cck_lock_counter < 5) - 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 >= 5) - 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; - } - - coex_sta->pre_ccklock = coex_sta->cck_lock; - - -} - -boolean halbtc8812a1ant_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 halbtc8812a1ant_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 halbtc8812a1ant_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_8812A_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_8812A_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_8812A_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_8812A_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_8812A_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_8812A_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_8812A_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_8812A_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_8812A_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_8812A_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_8812A_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_8812A_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_8812A_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_8812A_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_8812A_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_8812A_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_8812A_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_8812A_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_8812A_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_8812A_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_8812A_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_8812A_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_8812A_1ANT_COEX_ALGO_PANEDR_HID; - } - } - } - } - - return algorithm; -} - -void halbtc8812a1ant_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 halbtc8812a1ant_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; - } - halbtc8812a1ant_set_bt_auto_report(btcoexist, - coex_dm->cur_bt_auto_report); - - coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; -} - -/* to check */ -void halbtc8812a1ant_set_sw_penalty_tx_rate_adaptive(IN struct btc_coexist - *btcoexist, IN boolean low_penalty_ra) -{ - u8 tmp_u1; - - tmp_u1 = btcoexist->btc_read_1byte(btcoexist, 0x4fd); - tmp_u1 |= BIT(0); - if (low_penalty_ra) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Tx rate adaptive, set low penalty!!\n"); - BTC_TRACE(trace_buf); - tmp_u1 &= ~BIT(2); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Tx rate adaptive, set normal!!\n"); - BTC_TRACE(trace_buf); - tmp_u1 |= BIT(2); - } - - btcoexist->btc_write_1byte(btcoexist, 0x4fd, tmp_u1); -} - -void halbtc8812a1ant_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; - } - halbtc8812a1ant_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 halbtc8812a1ant_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 halbtc8812a1ant_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; - } - halbtc8812a1ant_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 halbtc8812a1ant_coex_table_with_type(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u8 type) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** CoexTable(%d) **********\n", type); - BTC_TRACE(trace_buf); - - coex_sta->coex_table_type = type; - - switch (type) { - case 0: - halbtc8812a1ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x55555555, 0xffffff, 0x3); - break; - case 1: - halbtc8812a1ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); - break; - case 2: - halbtc8812a1ant_coex_table(btcoexist, force_exec, - 0x5a5a5a5a, 0x5a5a5a5a, 0xffffff, 0x3); - break; - case 3: - halbtc8812a1ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); - break; - case 4: - halbtc8812a1ant_coex_table(btcoexist, force_exec, - 0x55555555, 0xaaaa5a5a, 0xffffff, 0x3); - break; - case 5: - halbtc8812a1ant_coex_table(btcoexist, force_exec, - 0x5a5a5a5a, 0xaa5a5a5a, 0xffffff, 0x3); - break; - case 6: - halbtc8812a1ant_coex_table(btcoexist, force_exec, - 0x55555555, 0xaaaaaaaa, 0xffffff, 0x3); - break; - case 7: - halbtc8812a1ant_coex_table(btcoexist, force_exec, - 0xaaaaaaaa, 0xaaaaaaaa, 0xffffff, 0x3); - break; - default: - break; - } -} - -void halbtc8812a1ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, - IN boolean enable) -{ - u8 data_len = 3; - u8 buf[5] = {0}; - - buf[0] = data_len; - buf[1] = 0x1; /* OP_Code */ - buf[2] = 0x1; /* OP_Code_Length */ - if (enable) - buf[3] = 0x1; /* OP_Code_Content */ - else - buf[3] = 0x0; - - btcoexist->btc_set(btcoexist, BTC_SET_ACT_CTRL_BT_COEX, - (void *)&buf[0]); -} - -void halbtc8812a1ant_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; - } - halbtc8812a1ant_set_fw_ignore_wlan_act(btcoexist, enable); - - coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; -} - -void halbtc8812a1ant_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 halbtc8812a1ant_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; - } - halbtc8812a1ant_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 halbtc8812a1ant_sw_mechanism(IN struct btc_coexist *btcoexist, - IN boolean low_penalty_ra) -{ - halbtc8812a1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); -} - -/* to check force_exec */ -void halbtc8812a1ant_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) -{ - u8 u8tmp = 0; - - coex_dm->cur_ant_pos_type = ant_pos_type; - - if (init_hwcfg) { - btcoexist->btc_write_1byte(btcoexist, 0xcb3, 0x77); - btcoexist->btc_write_4byte(btcoexist, 0x900, 0x00000400); - btcoexist->btc_write_1byte(btcoexist, 0x76d, 0x1); - } else if (wifi_off) { - btcoexist->btc_write_1byte(btcoexist, 0xcb3, 0x77); - u8tmp = btcoexist->btc_read_1byte(btcoexist, 0xcb7); - u8tmp &= ~BIT(3); - u8tmp |= BIT(2); - btcoexist->btc_write_1byte(btcoexist, 0xcb7, u8tmp); - } - - 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: - u8tmp = btcoexist->btc_read_1byte(btcoexist, - 0xcb7); - u8tmp |= BIT(3); - u8tmp &= ~BIT(2); - btcoexist->btc_write_1byte(btcoexist, 0xcb7, - u8tmp); - break; - case BTC_ANT_PATH_BT: - u8tmp = btcoexist->btc_read_1byte(btcoexist, - 0xcb7); - u8tmp &= ~BIT(3); - u8tmp |= BIT(2); - btcoexist->btc_write_1byte(btcoexist, 0xcb7, - u8tmp); - break; - default: - case BTC_ANT_PATH_PTA: - u8tmp = btcoexist->btc_read_1byte(btcoexist, - 0xcb7); - u8tmp |= BIT(3); - u8tmp &= ~BIT(2); - btcoexist->btc_write_1byte(btcoexist, 0xcb7, - u8tmp); - break; - } - } - - coex_dm->pre_ant_pos_type = coex_dm->cur_ant_pos_type; -} - -void halbtc8812a1ant_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 halbtc8812a1ant_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; - 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; - - 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 (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)) - return; - } - - if (coex_sta->scan_ap_num <= 5) - wifi_duration_adjust = 2; - else 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) { /* 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 */ - } - - if ((type == 3) || (type == 13) || (type == 14)) { - ps_tdma_byte4_val = ps_tdma_byte4_val & - 0xbf; /* no dynamic slot for multi-profile */ - - if (!wifi_busy) - ps_tdma_byte4_val = ps_tdma_byte4_val | - 0x1; /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ - } - - if (bt_link_info->slave_role == true) - ps_tdma_byte4_val = ps_tdma_byte4_val | - 0x1; /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ - - if (turn_on) { - switch (type) { - default: - halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x51, - 0x1a, 0x1a, 0x0, ps_tdma_byte4_val); - break; - case 1: - halbtc8812a1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x3a + - wifi_duration_adjust, 0x03, - ps_tdma_byte3_val, ps_tdma_byte4_val); - break; - case 2: - halbtc8812a1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x2d + - wifi_duration_adjust, 0x03, - ps_tdma_byte3_val, ps_tdma_byte4_val); - break; - case 3: - halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x51, - 0x1d, 0x1d, 0x0, ps_tdma_byte4_val); - break; - case 4: - halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x93, - 0x15, 0x3, 0x14, 0x0); - break; - case 5: - halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x61, - 0x15, 0x3, 0x11, 0x11); - break; - case 6: - halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x61, - 0x20, 0x3, 0x11, 0x11); - break; - case 7: - halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x13, - 0xc, 0x5, 0x0, 0x0); - break; - case 8: - halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x93, - 0x25, 0x3, 0x10, 0x0); - break; - case 9: - halbtc8812a1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x21, 0x3, - ps_tdma_byte3_val, ps_tdma_byte4_val); - break; - case 10: - halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x13, - 0xa, 0xa, 0x0, 0x40); - break; - case 11: - halbtc8812a1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x21, 0x03, - ps_tdma_byte3_val, ps_tdma_byte4_val); - break; - case 12: - halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x51, - 0x0a, 0x0a, 0x0, 0x50); - break; - case 13: - halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x51, - 0x12, 0x12, 0x0, ps_tdma_byte4_val); - break; - case 14: - halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x51, - 0x21, 0x3, 0x10, ps_tdma_byte4_val); - break; - case 15: - halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x13, - 0xa, 0x3, 0x8, 0x0); - break; - case 16: - halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x93, - 0x15, 0x3, 0x10, 0x0); - break; - case 18: - halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x93, - 0x25, 0x3, 0x10, 0x0); - break; - case 20: - halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x61, - 0x3f, 0x03, 0x11, 0x10); - break; - case 21: - halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x61, - 0x25, 0x03, 0x11, 0x11); - break; - case 22: - halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x61, - 0x25, 0x03, 0x11, 0x10); - break; - case 23: - halbtc8812a1ant_set_fw_pstdma(btcoexist, 0xe3, - 0x25, 0x3, 0x31, 0x18); - break; - case 24: - halbtc8812a1ant_set_fw_pstdma(btcoexist, 0xe3, - 0x15, 0x3, 0x31, 0x18); - break; - case 25: - halbtc8812a1ant_set_fw_pstdma(btcoexist, 0xe3, - 0xa, 0x3, 0x31, 0x18); - break; - case 26: - halbtc8812a1ant_set_fw_pstdma(btcoexist, 0xe3, - 0xa, 0x3, 0x31, 0x18); - break; - case 27: - halbtc8812a1ant_set_fw_pstdma(btcoexist, 0xe3, - 0x25, 0x3, 0x31, 0x98); - break; - case 28: - halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x69, - 0x25, 0x3, 0x31, 0x0); - break; - case 29: - halbtc8812a1ant_set_fw_pstdma(btcoexist, 0xab, - 0x1a, 0x1a, 0x1, 0x10); - break; - case 30: - halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x51, - 0x30, 0x3, 0x10, 0x10); - break; - case 31: - halbtc8812a1ant_set_fw_pstdma(btcoexist, 0xd3, - 0x1a, 0x1a, 0, 0x58); - break; - case 32: - halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x61, - 0x35, 0x3, 0x11, 0x11); - break; - case 33: - halbtc8812a1ant_set_fw_pstdma(btcoexist, 0xa3, - 0x25, 0x3, 0x30, 0x90); - break; - case 34: - halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x53, - 0x1a, 0x1a, 0x0, 0x10); - break; - case 35: - halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x63, - 0x1a, 0x1a, 0x0, 0x10); - break; - case 36: - halbtc8812a1ant_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 */ - halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x23, - 0x18, 0x00, 0x10, 0x24); - break; - } - } else { - - /* disable PS tdma */ - switch (type) { - case 8: /* PTA Control */ - halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x8, - 0x0, 0x0, 0x0, 0x0); - break; - case 0: - default: /* Software control, Antenna at BT side */ - halbtc8812a1ant_set_fw_pstdma(btcoexist, 0x0, - 0x0, 0x0, 0x0, 0x0); - break; - } - } - rssi_adjust_val = 0; - btcoexist->btc_set(btcoexist, - BTC_SET_U1_RSSI_ADJ_VAL_FOR_1ANT_COEX_TYPE, &rssi_adjust_val); - - - /* 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; -} - -boolean halbtc8812a1ant_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_8812A_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); - - /* halbtc8812a1ant_sw_mechanism(btcoexist, false); */ - - common = true; - } else if (wifi_connected && - (BT_8812A_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); - - /* halbtc8812a1ant_sw_mechanism(btcoexist, false); */ - - common = true; - } else if (!wifi_connected && - (BT_8812A_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); - - /* halbtc8812a1ant_sw_mechanism(btcoexist, false); */ - - common = true; - } else if (wifi_connected && - (BT_8812A_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); - - /* halbtc8812a1ant_sw_mechanism(btcoexist, false); */ - - common = true; - } else if (!wifi_connected && - (BT_8812A_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); - - /* halbtc8812a1ant_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 halbtc8812a1ant_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_8812A_1ANT_WIFI_STATUS_CONNECTED_BUSY == wifi_status) - wifi_busy = true; - else - wifi_busy = false; - - if ((BT_8812A_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN == - wifi_status) || - (BT_8812A_1ANT_WIFI_STATUS_CONNECTED_SCAN == wifi_status) || - (BT_8812A_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) { - halbtc8812a1ant_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; - - halbtc8812a1ant_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) > 1150 || - (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_8812A_1ANT_A2DP_BASIC_RATE(bt_info_ext)) && - ((coex_dm->cur_ps_tdma == 1) || - (coex_dm->cur_ps_tdma == 2))) { - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 9); - coex_dm->ps_tdma_du_adj_type = 9; - } else if (coex_dm->cur_ps_tdma == 1) { - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = 2; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 9); - coex_dm->ps_tdma_du_adj_type = 9; - } else if (coex_dm->cur_ps_tdma == 9) { - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = 11; - } - } else if (result == 1) { - if ((BT_INFO_8812A_1ANT_A2DP_BASIC_RATE(bt_info_ext)) && - ((coex_dm->cur_ps_tdma == 1) || - (coex_dm->cur_ps_tdma == 2))) { - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 9); - coex_dm->ps_tdma_du_adj_type = 9; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 9); - coex_dm->ps_tdma_du_adj_type = 9; - } else if (coex_dm->cur_ps_tdma == 9) { - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = 2; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8812a1ant_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; - halbtc8812a1ant_ps_tdma(btcoexist, FORCE_EXEC, true, coex_dm->cur_ps_tdma); - } - */ - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** TDMA(on, %d) **********\n", - coex_dm->cur_ps_tdma); - BTC_TRACE(trace_buf); - } - - 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 */ - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - coex_dm->ps_tdma_du_adj_type); - } - } -} - -void halbtc8812a1ant_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 */ - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 8); - } - } else { /* NO PS state */ - if (new_ps_state) { - /* will enter LPS state, turn off psTdma first */ - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 8); - } else { - /* keep state under NO PS state, do nothing. */ - } - } -} - -void halbtc8812a1ant_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: - halbtc8812a1ant_ps_tdma_check_for_power_save_state( - btcoexist, true); - halbtc8812a1ant_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: - halbtc8812a1ant_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 halbtc8812a1ant_action_wifi_only(IN struct btc_coexist *btcoexist) -{ - halbtc8812a1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); - halbtc8812a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); - halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, FORCE_EXEC, - false, false); -} - -void halbtc8812a1ant_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); - halbtc8812a1ant_action_wifi_only(btcoexist); - } - } - 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 { - btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, - NULL); - btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, - NULL); - } - } -} - -/* ********************************************* - * - * Software Coex Mechanism start - * - * ********************************************* */ - -/* SCO only or SCO+PAN(HS) */ - -/* -void halbtc8812a1ant_action_sco(IN struct btc_coexist* btcoexist) -{ - halbtc8812a1ant_sw_mechanism(btcoexist, true); -} - - -void halbtc8812a1ant_action_hid(IN struct btc_coexist* btcoexist) -{ - halbtc8812a1ant_sw_mechanism(btcoexist, true); -} - - -void halbtc8812a1ant_action_a2dp(IN struct btc_coexist* btcoexist) -{ - halbtc8812a1ant_sw_mechanism(btcoexist, false); -} - -void halbtc8812a1ant_action_a2dp_pan_hs(IN struct btc_coexist* btcoexist) -{ - halbtc8812a1ant_sw_mechanism(btcoexist, false); -} - -void halbtc8812a1ant_action_pan_edr(IN struct btc_coexist* btcoexist) -{ - halbtc8812a1ant_sw_mechanism(btcoexist, false); -} - - -void halbtc8812a1ant_action_pan_hs(IN struct btc_coexist* btcoexist) -{ - halbtc8812a1ant_sw_mechanism(btcoexist, false); -} - - -void halbtc8812a1ant_action_pan_edr_a2dp(IN struct btc_coexist* btcoexist) -{ - halbtc8812a1ant_sw_mechanism(btcoexist, false); -} - -void halbtc8812a1ant_action_pan_edr_hid(IN struct btc_coexist* btcoexist) -{ - halbtc8812a1ant_sw_mechanism(btcoexist, true); -} - - -void halbtc8812a1ant_action_hid_a2dp_pan_edr(IN struct btc_coexist* btcoexist) -{ - halbtc8812a1ant_sw_mechanism(btcoexist, true); -} - -void halbtc8812a1ant_action_hid_a2dp(IN struct btc_coexist* btcoexist) -{ - halbtc8812a1ant_sw_mechanism(btcoexist, true); -} - -*/ - -/* ********************************************* - * - * Non-Software Coex Mechanism start - * - * ********************************************* */ -void halbtc8812a1ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) -{ - halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, - false, false); - halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -} - -void halbtc8812a1ant_action_hs(IN struct btc_coexist *btcoexist) -{ - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); - halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -} - -void halbtc8812a1ant_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)) { - halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, - NORMAL_EXEC, false, false); - halbtc8812a1ant_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 */ - halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); - - halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } else if ((bt_link_info->pan_exist) || (wifi_busy)) { - halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); - - halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } else { - halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, - NORMAL_EXEC, false, false); - halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); - } -} - -void halbtc8812a1ant_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) { - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); - halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); - } else { /* HID */ - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6); - halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); - } -} - -void halbtc8812a1ant_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 = halbtc8812a1ant_bt_rssi_state(2, 28, 0); - - 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 */ - halbtc8812a1ant_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_8812A_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifi_status) { - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 32); - halbtc8812a1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - coex_dm->auto_tdma_adjust = false; - } else { - halbtc8812a1ant_tdma_duration_adjust_for_acl(btcoexist, - wifi_status); - halbtc8812a1ant_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) */ - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); - halbtc8812a1ant_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 */ - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); - coex_dm->auto_tdma_adjust = false; - - halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); - } else if ((bt_link_info->pan_only) || (bt_link_info->hid_exist && - bt_link_info->pan_exist)) { /* PAN(OPP,FTP), HID+PAN(OPP,FTP) */ - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); - halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - coex_dm->auto_tdma_adjust = false; - } else { - /* BT no-profile busy (0x9) */ - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); - halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - coex_dm->auto_tdma_adjust = false; - } -} - -void halbtc8812a1ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist) -{ - /* power save state */ - halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - - /* tdma and coex table */ - halbtc8812a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); - halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, - false, false); - halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -} - -void halbtc8812a1ant_action_wifi_not_connected_scan(IN struct btc_coexist - *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - - halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - - /* tdma and coex table */ - if (BT_8812A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { - if (bt_link_info->a2dp_exist) { - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 32); - halbtc8812a1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } else if (bt_link_info->a2dp_exist && - bt_link_info->pan_exist) { - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 22); - halbtc8812a1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } else { - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 20); - halbtc8812a1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } - } else if ((BT_8812A_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || - (BT_8812A_1ANT_BT_STATUS_ACL_SCO_BUSY == - coex_dm->bt_status)) { - halbtc8812a1ant_action_bt_sco_hid_only_busy(btcoexist, - BT_8812A_1ANT_WIFI_STATUS_CONNECTED_SCAN); - } else { - /* Bryant Add */ - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, - NORMAL_EXEC, false, false); - halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - } -} - -void halbtc8812a1ant_action_wifi_not_connected_asso_auth( - IN struct btc_coexist *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - - halbtc8812a1ant_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)) { - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); - halbtc8812a1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4); - } else if (bt_link_info->pan_exist) { - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); - halbtc8812a1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4); - } else { - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, - NORMAL_EXEC, false, false); - halbtc8812a1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 2); - } -} - -void halbtc8812a1ant_action_wifi_connected_scan(IN struct btc_coexist - *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - - halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - - /* tdma and coex table */ - if (BT_8812A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { - if (bt_link_info->a2dp_exist) { - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 32); - halbtc8812a1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } else if (bt_link_info->a2dp_exist && - bt_link_info->pan_exist) { - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 22); - halbtc8812a1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } else { - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 20); - halbtc8812a1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } - } else if ((BT_8812A_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || - (BT_8812A_1ANT_BT_STATUS_ACL_SCO_BUSY == - coex_dm->bt_status)) { - halbtc8812a1ant_action_bt_sco_hid_only_busy(btcoexist, - BT_8812A_1ANT_WIFI_STATUS_CONNECTED_SCAN); - } else { - /* Bryant Add */ - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, - NORMAL_EXEC, false, false); - halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - } -} - -void halbtc8812a1ant_action_wifi_connected_specific_packet( - IN struct btc_coexist *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - - halbtc8812a1ant_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)) { - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); - halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } else if (bt_link_info->pan_exist) { - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); - halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } else { - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, - NORMAL_EXEC, false, false); - halbtc8812a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - } -} - -void halbtc8812a1ant_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) { - halbtc8812a1ant_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) - halbtc8812a1ant_action_wifi_connected_scan(btcoexist); - else - halbtc8812a1ant_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_8812A_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) - halbtc8812a1ant_power_save_state(btcoexist, - BTC_PS_WIFI_NATIVE, 0x0, 0x0); - else { /* busy */ - if (coex_sta->scan_ap_num >= - BT_8812A_1ANT_WIFI_NOISY_THRESH) /* no force LPS, no PS-TDMA, use pure TDMA */ - halbtc8812a1ant_power_save_state( - btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - else - halbtc8812a1ant_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)) - halbtc8812a1ant_power_save_state(btcoexist, - BTC_PS_WIFI_NATIVE, 0x0, 0x0); - else - halbtc8812a1ant_power_save_state(btcoexist, - BTC_PS_LPS_ON, 0x50, 0x4); - } else - halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - - /* tdma and coex table */ - if (!wifi_busy) { - if (BT_8812A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { - halbtc8812a1ant_action_wifi_connected_bt_acl_busy( - btcoexist, - BT_8812A_1ANT_WIFI_STATUS_CONNECTED_IDLE); - } else if ((BT_8812A_1ANT_BT_STATUS_SCO_BUSY == - coex_dm->bt_status) || - (BT_8812A_1ANT_BT_STATUS_ACL_SCO_BUSY == - coex_dm->bt_status)) { - halbtc8812a1ant_action_bt_sco_hid_only_busy(btcoexist, - BT_8812A_1ANT_WIFI_STATUS_CONNECTED_IDLE); - } else { - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 8); - halbtc8812a1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_PTA, NORMAL_EXEC, false, false); - if ((coex_sta->high_priority_tx) + - (coex_sta->high_priority_rx) <= 60) - halbtc8812a1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 2); - else - halbtc8812a1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 7); - } - } else { - if (BT_8812A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { - halbtc8812a1ant_action_wifi_connected_bt_acl_busy( - btcoexist, - BT_8812A_1ANT_WIFI_STATUS_CONNECTED_BUSY); - } else if ((BT_8812A_1ANT_BT_STATUS_SCO_BUSY == - coex_dm->bt_status) || - (BT_8812A_1ANT_BT_STATUS_ACL_SCO_BUSY == - coex_dm->bt_status)) { - halbtc8812a1ant_action_bt_sco_hid_only_busy(btcoexist, - BT_8812A_1ANT_WIFI_STATUS_CONNECTED_BUSY); - } else { - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 8); - halbtc8812a1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_PTA, NORMAL_EXEC, false, false); - if ((coex_sta->high_priority_tx) + - (coex_sta->high_priority_rx) <= 60) - halbtc8812a1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 2); - else - halbtc8812a1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 7); - } - } -} - -void halbtc8812a1ant_run_sw_coexist_mechanism(IN struct btc_coexist *btcoexist) -{ - u8 algorithm = 0; - - algorithm = halbtc8812a1ant_action_algorithm(btcoexist); - coex_dm->cur_algorithm = algorithm; - - if (halbtc8812a1ant_is_common_action(btcoexist)) { - - } else { - switch (coex_dm->cur_algorithm) { - case BT_8812A_1ANT_COEX_ALGO_SCO: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = SCO.\n"); - BTC_TRACE(trace_buf); - /* halbtc8812a1ant_action_sco(btcoexist); */ - break; - case BT_8812A_1ANT_COEX_ALGO_HID: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = HID.\n"); - BTC_TRACE(trace_buf); - /* halbtc8812a1ant_action_hid(btcoexist); */ - break; - case BT_8812A_1ANT_COEX_ALGO_A2DP: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = A2DP.\n"); - BTC_TRACE(trace_buf); - /* halbtc8812a1ant_action_a2dp(btcoexist); */ - break; - case BT_8812A_1ANT_COEX_ALGO_A2DP_PANHS: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = A2DP+PAN(HS).\n"); - BTC_TRACE(trace_buf); - /* halbtc8812a1ant_action_a2dp_pan_hs(btcoexist); */ - break; - case BT_8812A_1ANT_COEX_ALGO_PANEDR: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = PAN(EDR).\n"); - BTC_TRACE(trace_buf); - /* halbtc8812a1ant_action_pan_edr(btcoexist); */ - break; - case BT_8812A_1ANT_COEX_ALGO_PANHS: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = HS mode.\n"); - BTC_TRACE(trace_buf); - /* halbtc8812a1ant_action_pan_hs(btcoexist); */ - break; - case BT_8812A_1ANT_COEX_ALGO_PANEDR_A2DP: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = PAN+A2DP.\n"); - BTC_TRACE(trace_buf); - /* halbtc8812a1ant_action_pan_edr_a2dp(btcoexist); */ - break; - case BT_8812A_1ANT_COEX_ALGO_PANEDR_HID: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = PAN(EDR)+HID.\n"); - BTC_TRACE(trace_buf); - /* halbtc8812a1ant_action_pan_edr_hid(btcoexist); */ - break; - case BT_8812A_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); - /* halbtc8812a1ant_action_hid_a2dp_pan_edr(btcoexist); */ - break; - case BT_8812A_1ANT_COEX_ALGO_HID_A2DP: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = HID+A2DP.\n"); - BTC_TRACE(trace_buf); - /* halbtc8812a1ant_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); - /* halbtc8812a1ant_coex_all_off(btcoexist); */ - break; - } - coex_dm->pre_algorithm = coex_dm->cur_algorithm; - } -} - -void halbtc8812a1ant_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; - - 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 ((BT_8812A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || - (BT_8812A_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || - (BT_8812A_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) { - halbtc8812a1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, - 0, 1); - miracast_plus_bt = true; - } else { - halbtc8812a1ant_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); - halbtc8812a1ant_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); - halbtc8812a1ant_action_bt_inquiry(btcoexist); - } else - halbtc8812a1ant_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)) { - halbtc8812a1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, 0, 1); - - if (bt_link_info->sco_exist) - halbtc8812a1ant_limited_rx(btcoexist, NORMAL_EXEC, true, - false, 0x5); - else { - if (BTC_WIFI_BW_HT40 == wifi_bw) - halbtc8812a1ant_limited_rx(btcoexist, NORMAL_EXEC, - false, true, 0x10); - else - halbtc8812a1ant_limited_rx(btcoexist, NORMAL_EXEC, - false, true, 0x8); - } - - halbtc8812a1ant_sw_mechanism(btcoexist, true); - halbtc8812a1ant_run_sw_coexist_mechanism( - btcoexist); /* just print debug message */ - } else { - halbtc8812a1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - - halbtc8812a1ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, - 0x5); - - halbtc8812a1ant_sw_mechanism(btcoexist, false); - halbtc8812a1ant_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); - halbtc8812a1ant_action_bt_inquiry(btcoexist); - return; - } else if (bt_hs_on) { - halbtc8812a1ant_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) - halbtc8812a1ant_action_wifi_not_connected_scan( - btcoexist); - else - halbtc8812a1ant_action_wifi_not_connected_asso_auth( - btcoexist); - } else - halbtc8812a1ant_action_wifi_not_connected(btcoexist); - } else /* wifi LPS/Busy */ - halbtc8812a1ant_action_wifi_connected(btcoexist); -} - -void halbtc8812a1ant_init_coex_dm(IN struct btc_coexist *btcoexist) -{ - /* force to reset coex mechanism */ - - /* sw all off */ - halbtc8812a1ant_sw_mechanism(btcoexist, false); - - /* halbtc8812a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); */ - /* halbtc8812a1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); */ - - coex_sta->pop_event_cnt = 0; -} - -void halbtc8812a1ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean back_up, IN boolean wifi_only) -{ - u8 u8tmp = 0; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], 1Ant Init HW Config!!\n"); - BTC_TRACE(trace_buf); - - /* ant sw control to BT */ - halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, FORCE_EXEC, - true, false); - - /* 0x790[5:0]=0x5 */ - u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x790); - u8tmp &= 0xc0; - u8tmp |= 0x5; - btcoexist->btc_write_1byte(btcoexist, 0x790, u8tmp); - - /* PTA parameter */ - btcoexist->btc_write_1byte(btcoexist, 0x6cc, 0x0); - btcoexist->btc_write_4byte(btcoexist, 0x6c8, 0xffff); - btcoexist->btc_write_4byte(btcoexist, 0x6c4, 0x55555555); - btcoexist->btc_write_4byte(btcoexist, 0x6c0, 0x55555555); - - /* coex parameters */ - btcoexist->btc_write_1byte(btcoexist, 0x778, 0x1); - - /* enable counter statistics */ - btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); - - /* enable PTA */ - btcoexist->btc_write_1byte(btcoexist, 0x40, 0x20); - - /* bt clock related */ - u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x4); - u8tmp |= BIT(7); - btcoexist->btc_write_1byte(btcoexist, 0x4, u8tmp); - - /* bt clock related */ - u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x7); - u8tmp |= BIT(1); - btcoexist->btc_write_1byte(btcoexist, 0x7, u8tmp); -} - -/* ************************************************************ - * work around function start with wa_halbtc8812a1ant_ - * ************************************************************ - * ************************************************************ - * extern function start with ex_halbtc8812a1ant_ - * ************************************************************ */ -void ex_halbtc8812a1ant_power_on_setting(IN struct btc_coexist *btcoexist) -{ -} - -void ex_halbtc8812a1ant_pre_load_firmware(IN struct btc_coexist *btcoexist) -{ -} - -void ex_halbtc8812a1ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean wifi_only) -{ - halbtc8812a1ant_init_hw_config(btcoexist, true, wifi_only); - btcoexist->stop_coex_dm = false; -} - -void ex_halbtc8812a1ant_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; - - halbtc8812a1ant_init_coex_dm(btcoexist); - - halbtc8812a1ant_query_bt_info(btcoexist); -} - -void ex_halbtc8812a1ant_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 fw_ver = 0, bt_patch_ver = 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); - } - - 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_%d/ 0x%x/ 0x%x(%d)", - "CoexVer/ FwVer/ PatchVer", - glcoex_ver_date_8812a_1ant, glcoex_ver_8812a_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); - - /* 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->bt_disabled) ? ("disabled") : (( - coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") - : ((BT_8812A_1ANT_BT_STATUS_NON_CONNECTED_IDLE == - coex_dm->bt_status) ? "non-connected idle" : - ((BT_8812A_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) - ? "connected-idle" : "busy")))), - coex_sta->bt_rssi, coex_sta->bt_retry_cnt); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", - "SCO/HID/PAN/A2DP", - bt_link_info->sco_exist, bt_link_info->hid_exist, - bt_link_info->pan_exist, bt_link_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_8812A_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_8812a_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]============"); - 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", - "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 = 0x%x ", - "Latest error condition(should be 0)", - coex_dm->error_condition); - 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); - } - - /* Hw setting */ - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[Hw setting]============"); - 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]); - CL_PRINTF(cli_buf); - - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xcb3); - u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xcb7); - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x900); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", - "0xcb3/0xcb7/0x900", - u8tmp[0], u8tmp[1], u32tmp[0]); - CL_PRINTF(cli_buf); - - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x40); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x40", - u8tmp[0]); - 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); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0xc50(dig)", - u32tmp[0]); - 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(hp rx[31:16]/tx[15:0])", - 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(lp rx[31:16]/tx[15:0])", - 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_halbtc8812a1ant_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; - - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, - FORCE_EXEC, false, true); - halbtc8812a1ant_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); - - halbtc8812a1ant_init_hw_config(btcoexist, false, false); - halbtc8812a1ant_init_coex_dm(btcoexist); - halbtc8812a1ant_query_bt_info(btcoexist); - - coex_sta->under_ips = false; - } -} - -void ex_halbtc8812a1ant_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_halbtc8812a1ant_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; - - 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); - - halbtc8812a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, - 8); /* Force antenna setup for no scan result issue */ - halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, - FORCE_EXEC, false, false); - } 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); - - halbtc8812a1ant_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) { - halbtc8812a1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - halbtc8812a1ant_limited_rx(btcoexist, NORMAL_EXEC, false, - bt_ctrl_agg_buf_size, agg_buf_size); - halbtc8812a1ant_action_wifi_multi_port(btcoexist); - return; - } - - if (coex_sta->c2h_bt_inquiry_page) { - halbtc8812a1ant_action_bt_inquiry(btcoexist); - return; - } else if (bt_hs_on) { - halbtc8812a1ant_action_hs(btcoexist); - return; - } - - if (BTC_SCAN_START == type) { - if (!wifi_connected) /* non-connected scan */ - halbtc8812a1ant_action_wifi_not_connected_scan( - btcoexist); - else /* wifi is connected */ - halbtc8812a1ant_action_wifi_connected_scan(btcoexist); - } else if (BTC_SCAN_FINISH == type) { - if (!wifi_connected) /* non-connected scan */ - halbtc8812a1ant_action_wifi_not_connected(btcoexist); - else - halbtc8812a1ant_action_wifi_connected(btcoexist); - } -} - -void ex_halbtc8812a1ant_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; - halbtc8812a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, - 8); /* Force antenna setup for no scan result issue */ - halbtc8812a1ant_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) { - halbtc8812a1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - halbtc8812a1ant_limited_rx(btcoexist, NORMAL_EXEC, false, - bt_ctrl_agg_buf_size, agg_buf_size); - halbtc8812a1ant_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) { - halbtc8812a1ant_action_bt_inquiry(btcoexist); - return; - } else if (bt_hs_on) { - halbtc8812a1ant_action_hs(btcoexist); - return; - } - - if (BTC_ASSOCIATE_START == type) - halbtc8812a1ant_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 */ - halbtc8812a1ant_action_wifi_not_connected(btcoexist); - else - halbtc8812a1ant_action_wifi_connected(btcoexist); - } -} - -/* to check registers... */ -void ex_halbtc8812a1ant_media_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - u8 data_len = 5; - u8 buf[6] = {0}; - 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); - halbtc8812a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, - 8); /* Force antenna setup for no scan result issue */ - halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, - FORCE_EXEC, false, false); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, - &wifi_under_b_mode); -#if 0 - /* 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 */ - } -#endif - 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 */ - } - - /* 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]; - - buf[0] = data_len; - buf[1] = 0x5; /* OP_Code */ - buf[2] = 0x3; /* OP_Code_Length */ - buf[3] = h2c_parameter[0]; /* OP_Code_Content */ - buf[4] = h2c_parameter[1]; - buf[5] = h2c_parameter[2]; - - btcoexist->btc_set(btcoexist, BTC_SET_ACT_CTRL_BT_COEX, - (void *)&buf[0]); -} - -void ex_halbtc8812a1ant_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; - u8 agg_buf_size = 5; - - 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) /* 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) { - halbtc8812a1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - halbtc8812a1ant_limited_rx(btcoexist, NORMAL_EXEC, false, - bt_ctrl_agg_buf_size, agg_buf_size); - halbtc8812a1ant_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) { - halbtc8812a1ant_action_bt_inquiry(btcoexist); - return; - } else if (bt_hs_on) { - halbtc8812a1ant_action_hs(btcoexist); - return; - } - - if (BTC_PACKET_DHCP == type || - BTC_PACKET_EAPOL == type || - ((BTC_PACKET_ARP == type) && (coex_sta->wifi_is_high_pri_task))) - halbtc8812a1ant_action_wifi_connected_specific_packet(btcoexist); -} - -void ex_halbtc8812a1ant_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_8812A_1ANT_MAX) - rsp_source = BT_INFO_SRC_8812A_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_8812A_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_page = true; - else - coex_sta->c2h_bt_page = 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]; - - 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 != 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); - } - - /* 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_halbtc8812a1ant_media_status_notify( - btcoexist, BTC_MEDIA_CONNECT); - else - ex_halbtc8812a1ant_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); - halbtc8812a1ant_ignore_wlan_act(btcoexist, - FORCE_EXEC, false); - } - } else { - /* BT already NOT ignore Wlan active, do nothing here. */ - } -#if (BT_AUTO_REPORT_ONLY_8812A_1ANT == 0) - if ((coex_sta->bt_info_ext & BIT(4))) { - /* BT auto report already enabled, do nothing */ - } else - halbtc8812a1ant_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_8812A_1ANT_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_8812A_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 (bt_info & BT_INFO_8812A_1ANT_B_FTP) - coex_sta->pan_exist = true; - else - coex_sta->pan_exist = false; - if (bt_info & BT_INFO_8812A_1ANT_B_A2DP) - coex_sta->a2dp_exist = true; - else - coex_sta->a2dp_exist = false; - if (bt_info & BT_INFO_8812A_1ANT_B_HID) - coex_sta->hid_exist = true; - else - coex_sta->hid_exist = false; - if (bt_info & BT_INFO_8812A_1ANT_B_SCO_ESCO) - coex_sta->sco_exist = true; - else - coex_sta->sco_exist = false; - } - - halbtc8812a1ant_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_8812A_1ANT_B_CONNECTION)) { - coex_dm->bt_status = BT_8812A_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_8812A_1ANT_B_CONNECTION) { /* connection exists but no busy */ - coex_dm->bt_status = BT_8812A_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_8812A_1ANT_B_SCO_ESCO) || - (bt_info & BT_INFO_8812A_1ANT_B_SCO_BUSY)) { - coex_dm->bt_status = BT_8812A_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_8812A_1ANT_B_ACL_BUSY) { - if (BT_8812A_1ANT_BT_STATUS_ACL_BUSY != coex_dm->bt_status) - coex_dm->auto_tdma_adjust = false; - coex_dm->bt_status = BT_8812A_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_8812A_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_8812A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || - (BT_8812A_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || - (BT_8812A_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); - - halbtc8812a1ant_run_coexist_mechanism(btcoexist); -} - -void ex_halbtc8812a1ant_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; - } else if (BTC_RF_OFF == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], RF is turned OFF!!\n"); - BTC_TRACE(trace_buf); - - halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - halbtc8812a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); - halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, - FORCE_EXEC, false, true); - - halbtc8812a1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); - btcoexist->stop_coex_dm = true; - } -} - -void ex_halbtc8812a1ant_halt_notify(IN struct btc_coexist *btcoexist) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); - BTC_TRACE(trace_buf); - - halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - halbtc8812a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); - halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, FORCE_EXEC, - false, true); - - halbtc8812a1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); - - ex_halbtc8812a1ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); - - btcoexist->stop_coex_dm = true; -} - -void ex_halbtc8812a1ant_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); - - halbtc8812a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - halbtc8812a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, - FORCE_EXEC, false, true); - halbtc8812a1ant_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; - halbtc8812a1ant_init_hw_config(btcoexist, false, false); - halbtc8812a1ant_init_coex_dm(btcoexist); - halbtc8812a1ant_query_bt_info(btcoexist); - } -} - -void ex_halbtc8812a1ant_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); - - halbtc8812a1ant_init_hw_config(btcoexist, false, false); - halbtc8812a1ant_init_coex_dm(btcoexist); -} - -void ex_halbtc8812a1ant_periodical(IN struct btc_coexist *btcoexist) -{ -#if (BT_AUTO_REPORT_ONLY_8812A_1ANT == 0) - halbtc8812a1ant_query_bt_info(btcoexist); - halbtc8812a1ant_monitor_bt_enable_disable(btcoexist); -#else - halbtc8812a1ant_monitor_bt_ctr(btcoexist); - halbtc8812a1ant_monitor_wifi_ctr(btcoexist); - - if (halbtc8812a1ant_is_wifi_status_changed(btcoexist) || - coex_dm->auto_tdma_adjust) - halbtc8812a1ant_run_coexist_mechanism(btcoexist); - - coex_sta->specific_pkt_period_cnt++; -#endif -} - -void ex_halbtc8812a1ant_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_NORMAL: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Set CoexMode to Normal\n"); - BTC_TRACE(trace_buf); - btcoexist->manual_control = false; - halbtc8812a1ant_init_coex_dm(btcoexist); - break; - case BTC_DBG_SET_COEX_WIFI_ONLY: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Set CoexMode to Wifi Only\n"); - BTC_TRACE(trace_buf); - btcoexist->manual_control = true; - halbtc8812a1ant_power_save_state(btcoexist, - BTC_PS_WIFI_NATIVE, 0x0, 0x0); - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 9); - break; - case BTC_DBG_SET_COEX_BT_ONLY: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Set CoexMode to BT only\n"); - BTC_TRACE(trace_buf); - btcoexist->manual_control = true; - halbtc8812a1ant_power_save_state(btcoexist, - BTC_PS_WIFI_NATIVE, 0x0, 0x0); - halbtc8812a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 0); - break; - case BTC_DBG_SET_COEX_DEC_BT_PWR: - 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]; - - buf[0] = data_len; - buf[1] = 0x3; /* OP_Code */ - buf[2] = 0x2; /* OP_Code_Length */ - - buf[3] = dec_bt_pwr; /* OP_Code_Content */ - buf[4] = pwr_level; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[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]); - } - } - break; - - case BTC_DBG_SET_COEX_BT_AFH_MAP: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Set BT AFH Map\n"); - BTC_TRACE(trace_buf); - { - u8 data_len = 5; - u8 buf[6] = {0}; - - if (op_len == 3) { - buf[0] = data_len; - buf[1] = 0x5; /* OP_Code */ - buf[2] = 0x3; /* OP_Code_Length */ - - buf[3] = pdata[0]; /* OP_Code_Content */ - buf[4] = pdata[1]; - buf[5] = pdata[2]; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Set BT AFH Map = %02x %02x %02x\n", - pdata[0], pdata[1], pdata[2]); - BTC_TRACE(trace_buf); - btcoexist->btc_set(btcoexist, - BTC_SET_ACT_CTRL_BT_COEX, - (void *)&buf[0]); - } - } - break; - - case BTC_DBG_SET_COEX_BT_IGNORE_WLAN_ACT: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Set BT Ignore Wlan Active\n"); - BTC_TRACE(trace_buf); - { - u8 data_len = 3; - u8 buf[6] = {0}; - - if (op_len == 1) { - buf[0] = data_len; - buf[1] = 0x1; /* OP_Code */ - buf[2] = 0x1; /* OP_Code_Length */ - - buf[3] = pdata[0]; /* OP_Code_Content */ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Set BT Ignore Wlan Active = 0x%x\n", - pdata[0]); - BTC_TRACE(trace_buf); - - btcoexist->btc_set(btcoexist, - BTC_SET_ACT_CTRL_BT_COEX, - (void *)&buf[0]); - } - } - break; - default: - break; - } -} - -#endif - -#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8812a1ant.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8812a1ant.h deleted file mode 100644 index 7fbf445e0efb..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8812a1ant.h +++ /dev/null @@ -1,231 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ - -#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) - -#if (RTL8812A_SUPPORT == 1) - -/* ******************************************* - * The following is for 8812A 1ANT BT Co-exist definition - * ******************************************* */ -#define BT_AUTO_REPORT_ONLY_8812A_1ANT 1 - -#define BT_INFO_8812A_1ANT_B_FTP BIT(7) -#define BT_INFO_8812A_1ANT_B_A2DP BIT(6) -#define BT_INFO_8812A_1ANT_B_HID BIT(5) -#define BT_INFO_8812A_1ANT_B_SCO_BUSY BIT(4) -#define BT_INFO_8812A_1ANT_B_ACL_BUSY BIT(3) -#define BT_INFO_8812A_1ANT_B_INQ_PAGE BIT(2) -#define BT_INFO_8812A_1ANT_B_SCO_ESCO BIT(1) -#define BT_INFO_8812A_1ANT_B_CONNECTION BIT(0) - -#define BT_INFO_8812A_1ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ - (((_BT_INFO_EXT_&BIT(0))) ? true : false) - -#define BTC_RSSI_COEX_THRESH_TOL_8812A_1ANT 2 - -#define BT_8812A_1ANT_WIFI_NOISY_THRESH 30 /* max: 255 */ - -enum bt_info_src_8812a_1ant { - BT_INFO_SRC_8812A_1ANT_WIFI_FW = 0x0, - BT_INFO_SRC_8812A_1ANT_BT_RSP = 0x1, - BT_INFO_SRC_8812A_1ANT_BT_ACTIVE_SEND = 0x2, - BT_INFO_SRC_8812A_1ANT_MAX -}; - -enum bt_8812a_1ant_bt_status { - BT_8812A_1ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, - BT_8812A_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, - BT_8812A_1ANT_BT_STATUS_INQ_PAGE = 0x2, - BT_8812A_1ANT_BT_STATUS_ACL_BUSY = 0x3, - BT_8812A_1ANT_BT_STATUS_SCO_BUSY = 0x4, - BT_8812A_1ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, - BT_8812A_1ANT_BT_STATUS_MAX -}; - -enum bt_8812a_1ant_wifi_status { - BT_8812A_1ANT_WIFI_STATUS_NON_CONNECTED_IDLE = 0x0, - BT_8812A_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN = 0x1, - BT_8812A_1ANT_WIFI_STATUS_CONNECTED_SCAN = 0x2, - BT_8812A_1ANT_WIFI_STATUS_CONNECTED_SPECIFIC_PKT = 0x3, - BT_8812A_1ANT_WIFI_STATUS_CONNECTED_IDLE = 0x4, - BT_8812A_1ANT_WIFI_STATUS_CONNECTED_BUSY = 0x5, - BT_8812A_1ANT_WIFI_STATUS_MAX -}; - -enum bt_8812a_1ant_coex_algo { - BT_8812A_1ANT_COEX_ALGO_UNDEFINED = 0x0, - BT_8812A_1ANT_COEX_ALGO_SCO = 0x1, - BT_8812A_1ANT_COEX_ALGO_HID = 0x2, - BT_8812A_1ANT_COEX_ALGO_A2DP = 0x3, - BT_8812A_1ANT_COEX_ALGO_A2DP_PANHS = 0x4, - BT_8812A_1ANT_COEX_ALGO_PANEDR = 0x5, - BT_8812A_1ANT_COEX_ALGO_PANHS = 0x6, - BT_8812A_1ANT_COEX_ALGO_PANEDR_A2DP = 0x7, - BT_8812A_1ANT_COEX_ALGO_PANEDR_HID = 0x8, - BT_8812A_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, - BT_8812A_1ANT_COEX_ALGO_HID_A2DP = 0xa, - BT_8812A_1ANT_COEX_ALGO_MAX = 0xb, -}; - -struct coex_dm_8812a_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; - boolean limited_dig; - - 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 pre_algorithm; - u8 cur_algorithm; - 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_8812a_1ant { - 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 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; - u8 pre_bt_rssi_state; - u8 pre_wifi_rssi_state[4]; - boolean c2h_bt_info_req_sent; - u8 bt_info_c2h[BT_INFO_SRC_8812A_1ANT_MAX][10]; - u32 bt_info_c2h_cnt[BT_INFO_SRC_8812A_1ANT_MAX]; - u32 bt_info_query_cnt; - 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; - 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; - u8 coex_table_type; - - boolean force_lps_on; -}; - -/* ******************************************* - * The following is interface which will notify coex module. - * ******************************************* */ -void ex_halbtc8812a1ant_power_on_setting(IN struct btc_coexist *btcoexist); -void ex_halbtc8812a1ant_pre_load_firmware(IN struct btc_coexist *btcoexist); -void ex_halbtc8812a1ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean wifi_only); -void ex_halbtc8812a1ant_init_coex_dm(IN struct btc_coexist *btcoexist); -void ex_halbtc8812a1ant_ips_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8812a1ant_lps_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8812a1ant_scan_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8812a1ant_connect_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8812a1ant_media_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8812a1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8812a1ant_bt_info_notify(IN struct btc_coexist *btcoexist, - IN u8 *tmp_buf, IN u8 length); -void ex_halbtc8812a1ant_rf_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8812a1ant_halt_notify(IN struct btc_coexist *btcoexist); -void ex_halbtc8812a1ant_pnp_notify(IN struct btc_coexist *btcoexist, - IN u8 pnp_state); -void ex_halbtc8812a1ant_coex_dm_reset(IN struct btc_coexist *btcoexist); -void ex_halbtc8812a1ant_periodical(IN struct btc_coexist *btcoexist); -void ex_halbtc8812a1ant_dbg_control(IN struct btc_coexist *btcoexist, - IN u8 op_code, IN u8 op_len, IN u8 *pdata); -void ex_halbtc8812a1ant_display_coex_info(IN struct btc_coexist *btcoexist); - -#else -#define ex_halbtc8812a1ant_power_on_setting(btcoexist) -#define ex_halbtc8812a1ant_pre_load_firmware(btcoexist) -#define ex_halbtc8812a1ant_init_hw_config(btcoexist, wifi_only) -#define ex_halbtc8812a1ant_init_coex_dm(btcoexist) -#define ex_halbtc8812a1ant_ips_notify(btcoexist, type) -#define ex_halbtc8812a1ant_lps_notify(btcoexist, type) -#define ex_halbtc8812a1ant_scan_notify(btcoexist, type) -#define ex_halbtc8812a1ant_connect_notify(btcoexist, type) -#define ex_halbtc8812a1ant_media_status_notify(btcoexist, type) -#define ex_halbtc8812a1ant_specific_packet_notify(btcoexist, type) -#define ex_halbtc8812a1ant_bt_info_notify(btcoexist, tmp_buf, length) -#define ex_halbtc8812a1ant_rf_status_notify(btcoexist, type) -#define ex_halbtc8812a1ant_halt_notify(btcoexist) -#define ex_halbtc8812a1ant_pnp_notify(btcoexist, pnp_state) -#define ex_halbtc8812a1ant_coex_dm_reset(btcoexist) -#define ex_halbtc8812a1ant_periodical(btcoexist) -#define ex_halbtc8812a1ant_dbg_control(btcoexist, op_code, op_len, pdata) -#define ex_halbtc8812a1ant_display_coex_info(btcoexist) - -#endif - -#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8812a2ant.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8812a2ant.c deleted file mode 100644 index 96a412ef8fd1..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8812a2ant.c +++ /dev/null @@ -1,5625 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ -/* ************************************************************ - * Description: - * - * This file is for RTL8812A Co-exist mechanism - * - * History - * 2012/08/22 Cosa first check in. - * 2012/11/14 Cosa Revise for 8812A 2Ant out sourcing. - * - * ************************************************************ */ - -/* ************************************************************ - * include files - * ************************************************************ */ -#include "mp_precomp.h" - -#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) - - -#if (RTL8812A_SUPPORT == 1) -/* ************************************************************ - * Global variables, these are static variables - * ************************************************************ */ -static u8 *trace_buf = &gl_btc_trace_buf[0]; -static struct coex_dm_8812a_2ant glcoex_dm_8812a_2ant; -static struct coex_dm_8812a_2ant *coex_dm = &glcoex_dm_8812a_2ant; -static struct coex_sta_8812a_2ant glcoex_sta_8812a_2ant; -static struct coex_sta_8812a_2ant *coex_sta = &glcoex_sta_8812a_2ant; - -const char *const glbt_info_src_8812a_2ant[] = { - "BT Info[wifi fw]", - "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_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_ -* ************************************************************ */ -u8 halbtc8812a2ant_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_8812A_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_8812A_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_8812A_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 halbtc8812a2ant_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_8812A_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_8812A_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_8812A_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 halbtc8812a2ant_set_enable_pta(IN struct btc_coexist *btcoexist, - IN boolean enablePTA) -{ - if (enablePTA) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], PTA is enable!\n"); - BTC_TRACE(trace_buf); - btcoexist->btc_write_1byte(btcoexist, 0x40, 0x20); - - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], PTA is disable!\n"); - BTC_TRACE(trace_buf); - btcoexist->btc_write_1byte(btcoexist, 0x40, 0x00); - - } -} - -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], pre_enable_pta = %d, cur_enable_pta = %d!!\n", - coex_dm->pre_enable_pta, coex_dm->cur_enable_pta); - BTC_TRACE(trace_buf); - - 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, - IN u32 ra_mask_type) -{ - u32 dis_ra_mask = 0x0; - - switch (ra_mask_type) { - case 0: /* normal mode */ - dis_ra_mask = 0x0; - break; - case 1: /* disable cck 1/2 */ - dis_ra_mask = 0x00000003; - break; - case 2: /* disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */ - dis_ra_mask = 0x0001f1f7; - break; - default: - break; - } - - return dis_ra_mask; -} - -void halbtc8812a2ant_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 halbtc8812a2ant_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 halbtc8812a2ant_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 halbtc8812a2ant_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 halbtc8812a2ant_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) -{ - u32 dis_ra_mask = 0x0; - - coex_dm->cur_ra_mask_type = ra_mask_type; - dis_ra_mask = halbtc8812a2ant_decide_ra_mask(btcoexist, ra_mask_type); - halbtc8812a2ant_update_ra_mask(btcoexist, force_exec, dis_ra_mask); - - halbtc8812a2ant_auto_rate_fallback_retry(btcoexist, force_exec, - arfr_type); - halbtc8812a2ant_retry_limit(btcoexist, force_exec, retry_limit_type); - halbtc8812a2ant_ampdu_max_time(btcoexist, force_exec, ampdu_time_type); -} - -void halbtc8812a2ant_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 halbtc8812a2ant_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, 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}; - /* 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) { - buf[0] = data_len; - buf[1] = 0x1; /* polling enable, 1=enable, 0=disable */ - buf[2] = 0x2; /* polling time in seconds */ - buf[3] = 0x1; /* auto report enable, 1=enable, 0=disable */ - - btcoexist->btc_set(btcoexist, BTC_SET_ACT_CTRL_BT_INFO, - (void *)&buf[0]); - } - } - coex_sta->bt_info_query_cnt++; -} - -boolean halbtc8812a2ant_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 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; - 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; - } -#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 && - !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 halbtc8812a2ant_action_algorithm(IN struct btc_coexist *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - struct btc_stack_info *stack_info = &btcoexist->stack_info; - boolean bt_hs_on = false; - u8 algorithm = BT_8812A_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], ACL Busy only\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8812A_2ANT_COEX_ALGO_PANEDR; - } - } 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_8812A_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_8812A_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_8812A_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_8812A_2ANT_COEX_ALGO_PANHS; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], PAN(EDR) only\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8812A_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_8812A_2ANT_COEX_ALGO_SCO_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_8812A_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_8812A_2ANT_COEX_ALGO_SCO; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCO + PAN(EDR)\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8812A_2ANT_COEX_ALGO_SCO; - } - } - } else { - if (bt_link_info->hid_exist && - bt_link_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_8812A_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_8812A_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_8812A_2ANT_COEX_ALGO_HID; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], HID + PAN(EDR)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8812A_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_8812A_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_8812A_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_8812A_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_8812A_2ANT_COEX_ALGO_SCO_HID; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCO + HID + PAN(EDR)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8812A_2ANT_COEX_ALGO_SCO_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_8812A_2ANT_COEX_ALGO_SCO; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8812A_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_8812A_2ANT_COEX_ALGO_HID_A2DP_PANHS; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], HID + A2DP + PAN(EDR)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8812A_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_8812A_2ANT_COEX_ALGO_PANEDR_HID; - } - } - } - } - - return algorithm; -} - -void halbtc8812a2ant_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; - - 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); -} - -void halbtc8812a2ant_set_fw_dec_bt_pwr(IN struct btc_coexist *btcoexist, - IN u8 dec_bt_pwr_lvl) -{ - 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 */ - if (dec_bt_pwr_lvl) - buf[3] = 0x1; /* OP_Code_Content */ - else - buf[3] = 0x0; - buf[4] = dec_bt_pwr_lvl;/* pwr_level */ - - btcoexist->btc_set(btcoexist, BTC_SET_ACT_CTRL_BT_COEX, - (void *)&buf[0]); -} - -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) { - if (coex_dm->pre_bt_dec_pwr_lvl == coex_dm->cur_bt_dec_pwr_lvl) - return; - } - halbtc8812a2ant_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 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) { - if (coex_dm->pre_fw_dac_swing_lvl == - coex_dm->cur_fw_dac_swing_lvl) - return; - } - - halbtc8812a2ant_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 halbtc8812a2ant_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 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) { - if (coex_dm->pre_rf_rx_lpf_shrink == - coex_dm->cur_rf_rx_lpf_shrink) - return; - } - halbtc8812a2ant_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 halbtc8812a2ant_set_sw_penalty_tx_rate_adaptive(IN struct btc_coexist - *btcoexist, IN boolean low_penalty_ra) -{ - u8 tmp_u1; - - tmp_u1 = btcoexist->btc_read_1byte(btcoexist, 0x4fd); - tmp_u1 |= BIT(0); - if (low_penalty_ra) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Tx rate adaptive, set low penalty!!\n"); - BTC_TRACE(trace_buf); - tmp_u1 &= ~BIT(2); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Tx rate adaptive, set normal!!\n"); - BTC_TRACE(trace_buf); - tmp_u1 |= BIT(2); - } - - btcoexist->btc_write_1byte(btcoexist, 0x4fd, tmp_u1); -} - -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) { - if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) - return; - } - halbtc8812a2ant_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 halbtc8812a2ant_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 halbtc8812a2ant_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) - halbtc8812a2ant_set_dac_swing_reg(btcoexist, sw_dac_swing_lvl); - else - halbtc8812a2ant_set_dac_swing_reg(btcoexist, 0x18); -} - - -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; - - 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); - halbtc8812a2ant_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 halbtc8812a2ant_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 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) { - if (coex_dm->pre_adc_back_off == coex_dm->cur_adc_back_off) - return; - } - halbtc8812a2ant_set_adc_back_off(btcoexist, coex_dm->cur_adc_back_off); - - coex_dm->pre_adc_back_off = coex_dm->cur_adc_back_off; -} - -void halbtc8812a2ant_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 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) { - if (coex_dm->pre_agc_table_en == coex_dm->cur_agc_table_en) - return; - } - halbtc8812a2ant_set_agc_table(btcoexist, agc_table_en); - - coex_dm->pre_agc_table_en = coex_dm->cur_agc_table_en; -} - -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); -} - -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; - 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; - } - halbtc8812a2ant_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 halbtc8812a2ant_coex_table_with_type(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u8 type) -{ - switch (type) { - case 0: - halbtc8812a2ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); - break; - case 1: - halbtc8812a2ant_coex_table(btcoexist, force_exec, - 0x5a5a5a5a, 0x5a5a5a5a, 0xffffff, 0x3); - break; - case 2: - halbtc8812a2ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x5ffb5ffb, 0xffffff, 0x3); - break; - case 3: - halbtc8812a2ant_coex_table(btcoexist, force_exec, - 0x5fdf5fdf, 0x5fdb5fdb, 0xffffff, 0x3); - break; - case 4: - halbtc8812a2ant_coex_table(btcoexist, force_exec, - 0xdfffdfff, 0x5fdb5fdb, 0xffffff, 0x3); - break; - case 5: - 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; - } -} - -void halbtc8812a2ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, - IN boolean enable) -{ - 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 */ - if (enable) - buf[3] = 0x1; /* OP_Code_Content */ - else - buf[3] = 0x0; - - btcoexist->btc_set(btcoexist, BTC_SET_ACT_CTRL_BT_COEX, - (void *)&buf[0]); -} - -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) { - if (coex_dm->pre_ignore_wlan_act == - coex_dm->cur_ignore_wlan_act) - return; - } - halbtc8812a2ant_set_fw_ignore_wlan_act(btcoexist, enable); - - coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; -} - -void halbtc8812a2ant_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; - - 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); -} - -void halbtc8812a2ant_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 halbtc8812a2ant_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; - } - halbtc8812a2ant_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 halbtc8812a2ant_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; - } - */ - - halbtc8812a2ant_rf_shrink(btcoexist, NORMAL_EXEC, shrink_rx_lpf); - /* halbtc8812a2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); */ -} - -void halbtc8812a2ant_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) -{ - /* halbtc8812a2ant_agc_table(btcoexist, NORMAL_EXEC, agc_table_shift); */ - halbtc8812a2ant_adc_back_off(btcoexist, NORMAL_EXEC, adc_back_off); - halbtc8812a2ant_dac_swing(btcoexist, NORMAL_EXEC, sw_dac_swing, - dac_swing_lvl); -} - -void halbtc8812a2ant_set_ant_path(IN struct btc_coexist *btcoexist, - IN u8 ant_pos_type, IN boolean init_hwcfg, IN boolean wifi_off) -{ - u8 u8tmp = 0; - - if (init_hwcfg) { - btcoexist->btc_write_4byte(btcoexist, 0x900, 0x00000400); - 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); - u8tmp &= ~BIT(3); - u8tmp |= BIT(2); - btcoexist->btc_write_1byte(btcoexist, 0xcb7, u8tmp); - break; - default: - break; - } -} - -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: /* d1,wb */ - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x3c, 0x03, 0x11, 0x10); - break; - case 2: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x32, 0x03, 0x11, 0x10); - break; - case 3: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x28, 0x03, 0x11, 0x10); - break; - case 4: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x1e, 0x03, 0x11, 0x10); - break; - case 5: /* d1,pb,TXpause */ - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0x63, - 0x3c, 0x03, 0x90, 0x10); - break; - case 6: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0x63, - 0x32, 0x03, 0x90, 0x10); - break; - case 7: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0x63, - 0x28, 0x03, 0x90, 0x10); - break; - case 8: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0x63, - 0x1e, 0x03, 0x90, 0x10); - break; - case 9: /* d1,bb */ - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x3c, 0x03, 0x31, 0x10); - break; - case 10: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x32, 0x03, 0x31, 0x10); - break; - case 11: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x28, 0x03, 0x31, 0x10); - break; - case 12: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x1e, 0x03, 0x31, 0x10); - break; - case 13: /* d1,bb,TXpause */ - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x3c, 0x03, 0x30, 0x10); - break; - case 14: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x32, 0x03, 0x30, 0x10); - break; - case 15: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x28, 0x03, 0x30, 0x10); - break; - case 16: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x1e, 0x03, 0x30, 0x10); - break; - case 17: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0x61, - 0x35, 0x3, 0x11, 0x11); - break; - case 18: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x5, 0x5, 0xe1, 0x90); - break; - case 19: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x25, 0x25, 0xe1, 0x90); - break; - case 20: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x25, 0x25, 0x60, 0x90); - break; - case 21: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x15, 0x3, 0x70, 0x90); - break; - case 22: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0x61, - 0x1a, 0x1a, 0x21, 0x10); - break; - case 23: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x1c, 0x03, 0x31, 0x10); - break; - - case 71: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x1a, 0x1a, 0xe1, 0x90); - 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, 0x53, - 0x3a + wifi_duration_adjust, 0x3, 0x90, - 0x50); - break; - case 82: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0x53, - 0x30 + wifi_duration_adjust, 0x03, 0x90, - 0x50); - break; - case 83: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0x53, - 0x21, 0x03, 0x90, 0x50); - break; - case 84: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0x53, - 0x15, 0x3, 0x90, 0x50); - break; - case 85: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0x53, - 0x1d, 0x1d, 0x80, 0x50); - break; - case 86: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0x53, - 0x15, 0x15, 0x80, 0x50); - break; - } - } else { - /* disable PS tdma */ - switch (type) { - case 0: /* ANT2PTA, 0x778=0x1 */ - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0x8, - 0x0, 0x0, 0x0, 0x0); - break; - case 1: /* 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_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); - 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 halbtc8812a2ant_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 */ - halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 0); - } - } else { /* NO PS state */ - if (new_ps_state) { - /* will enter LPS state, turn off psTdma first */ - halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 0); - } else { - /* keep state under NO PS state, do nothing. */ - } - } -} - - -void halbtc8812a2ant_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 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, 0x0, - 0x0); - - halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); - halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, false, false); - 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; - boolean common = false, wifi_connected = false, wifi_busy = false; - boolean bt_hs_on = 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 (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); - halbtc8812a2ant_action_bt_inquiry(btcoexist); - return true; - } - - if (bt_link_info->sco_exist || bt_link_info->hid_exist) - halbtc8812a2ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 0, 0, 0); - else - halbtc8812a2ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - - if (!wifi_connected) { - halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - halbtc8812a2ant_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); - - if ((BT_8812A_2ANT_BT_STATUS_NON_CONNECTED_IDLE == - coex_dm->bt_status) || - (BT_8812A_2ANT_BT_STATUS_CONNECTED_IDLE == - coex_dm->bt_status)) { - halbtc8812a2ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 1); - halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 0); - } else { - halbtc8812a2ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 0); - 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); - - halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, false, - false); - halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, false, - 0x18); - - common = true; - } else { - if (BT_8812A_2ANT_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); - halbtc8812a2ant_power_save_state(btcoexist, - BTC_PS_WIFI_NATIVE, 0x0, 0x0); - halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, - false, false, 0x8); - - halbtc8812a2ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 0); - halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 0); - halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, - 6); - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - - common = true; - } else if (BT_8812A_2ANT_BT_STATUS_CONNECTED_IDLE == - coex_dm->bt_status) { - 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); - halbtc8812a2ant_power_save_state(btcoexist, - BTC_PS_WIFI_NATIVE, 0x0, 0x0); - halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, - false, false, 0x8); - - halbtc8812a2ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 0); - halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 0); - halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, - 6); - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - halbtc8812a2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - - 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); - common = false; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi Connected-Idle + BT Busy!!\n"); - BTC_TRACE(trace_buf); - - halbtc8812a2ant_power_save_state(btcoexist, - BTC_PS_WIFI_NATIVE, 0x0, 0x0); - - halbtc8812a2ant_limited_rx(btcoexist, - NORMAL_EXEC, false, false, 0x8); - - halbtc8812a2ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 0); - - halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 17); - - halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, - NORMAL_EXEC, 6); - halbtc8812a2ant_dec_bt_pwr(btcoexist, - NORMAL_EXEC, 0); - halbtc8812a2ant_sw_mechanism1(btcoexist, false, - false, false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, false, - false, false, 0x18); - common = true; - } - } - } - - return common; -} - -void halbtc8812a2ant_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; - - 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) { - if (max_interval == 1) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 13); - coex_dm->ps_tdma_du_adj_type = - 13; - } else if (max_interval == 2) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 14); - coex_dm->ps_tdma_du_adj_type = - 14; - } else if (max_interval == 3) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } - } else { - if (max_interval == 1) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 9); - coex_dm->ps_tdma_du_adj_type = - 9; - } else if (max_interval == 2) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 10); - coex_dm->ps_tdma_du_adj_type = - 10; - } else if (max_interval == 3) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } - } - } else { - if (tx_pause) { - if (max_interval == 1) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 5); - coex_dm->ps_tdma_du_adj_type = - 5; - } else if (max_interval == 2) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 6); - coex_dm->ps_tdma_du_adj_type = - 6; - } else if (max_interval == 3) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } - } else { - if (max_interval == 1) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 1); - coex_dm->ps_tdma_du_adj_type = - 1; - } else if (max_interval == 2) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = - 2; - } else if (max_interval == 3) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else { - halbtc8812a2ant_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; - 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 (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; - 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 */ - 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; - 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) - 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; - 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) { - 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; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 6); - coex_dm->ps_tdma_du_adj_type = 6; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 7); - coex_dm->ps_tdma_du_adj_type = 7; - } else if (coex_dm->cur_ps_tdma == 4) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 8); - coex_dm->ps_tdma_du_adj_type = 8; - } - if (coex_dm->cur_ps_tdma == 9) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 13); - coex_dm->ps_tdma_du_adj_type = 13; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 14); - coex_dm->ps_tdma_du_adj_type = 14; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 15); - coex_dm->ps_tdma_du_adj_type = 15; - } else if (coex_dm->cur_ps_tdma == 12) { - halbtc8812a2ant_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) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 6); - coex_dm->ps_tdma_du_adj_type = - 6; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 8); - coex_dm->ps_tdma_du_adj_type = - 8; - } else if (coex_dm->cur_ps_tdma == 13) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 14); - coex_dm->ps_tdma_du_adj_type = - 14; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8812a2ant_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) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 6); - coex_dm->ps_tdma_du_adj_type = - 6; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 5); - coex_dm->ps_tdma_du_adj_type = - 5; - } else if (coex_dm->cur_ps_tdma == 16) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 14); - coex_dm->ps_tdma_du_adj_type = - 14; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 13); - coex_dm->ps_tdma_du_adj_type = - 13; - } - } - } 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, 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); - coex_dm->ps_tdma_du_adj_type = 2; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 3); - coex_dm->ps_tdma_du_adj_type = 3; - } else if (coex_dm->cur_ps_tdma == 8) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 4); - coex_dm->ps_tdma_du_adj_type = 4; - } - if (coex_dm->cur_ps_tdma == 13) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 9); - coex_dm->ps_tdma_du_adj_type = 9; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 10); - coex_dm->ps_tdma_du_adj_type = 10; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 11); - coex_dm->ps_tdma_du_adj_type = 11; - } else if (coex_dm->cur_ps_tdma == 16) { - halbtc8812a2ant_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) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = - 2; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 4); - coex_dm->ps_tdma_du_adj_type = - 4; - } else if (coex_dm->cur_ps_tdma == 9) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 10); - coex_dm->ps_tdma_du_adj_type = - 10; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8812a2ant_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) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = - 2; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 1); - coex_dm->ps_tdma_du_adj_type = - 1; - } else if (coex_dm->cur_ps_tdma == 12) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 10); - coex_dm->ps_tdma_du_adj_type = - 10; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 9); - coex_dm->ps_tdma_du_adj_type = - 9; - } - } - } - } 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); - coex_dm->ps_tdma_du_adj_type = 6; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 6); - coex_dm->ps_tdma_du_adj_type = 6; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 7); - coex_dm->ps_tdma_du_adj_type = 7; - } else if (coex_dm->cur_ps_tdma == 4) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 8); - coex_dm->ps_tdma_du_adj_type = 8; - } - if (coex_dm->cur_ps_tdma == 9) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 14); - coex_dm->ps_tdma_du_adj_type = 14; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 14); - coex_dm->ps_tdma_du_adj_type = 14; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 15); - coex_dm->ps_tdma_du_adj_type = 15; - } else if (coex_dm->cur_ps_tdma == 12) { - halbtc8812a2ant_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) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 6); - coex_dm->ps_tdma_du_adj_type = - 6; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 8); - coex_dm->ps_tdma_du_adj_type = - 8; - } else if (coex_dm->cur_ps_tdma == 13) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 14); - coex_dm->ps_tdma_du_adj_type = - 14; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8812a2ant_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) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 6); - coex_dm->ps_tdma_du_adj_type = - 6; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 6); - coex_dm->ps_tdma_du_adj_type = - 6; - } else if (coex_dm->cur_ps_tdma == 16) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 14); - coex_dm->ps_tdma_du_adj_type = - 14; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 14); - coex_dm->ps_tdma_du_adj_type = - 14; - } - } - } 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); - coex_dm->ps_tdma_du_adj_type = 2; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 2); - coex_dm->ps_tdma_du_adj_type = 2; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 3); - coex_dm->ps_tdma_du_adj_type = 3; - } else if (coex_dm->cur_ps_tdma == 8) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 4); - coex_dm->ps_tdma_du_adj_type = 4; - } - if (coex_dm->cur_ps_tdma == 13) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 10); - coex_dm->ps_tdma_du_adj_type = 10; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 10); - coex_dm->ps_tdma_du_adj_type = 10; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 11); - coex_dm->ps_tdma_du_adj_type = 11; - } else if (coex_dm->cur_ps_tdma == 16) { - halbtc8812a2ant_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) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = - 2; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 4); - coex_dm->ps_tdma_du_adj_type = - 4; - } else if (coex_dm->cur_ps_tdma == 9) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 10); - coex_dm->ps_tdma_du_adj_type = - 10; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8812a2ant_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) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = - 2; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = - 2; - } else if (coex_dm->cur_ps_tdma == 12) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 10); - coex_dm->ps_tdma_du_adj_type = - 10; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 10); - coex_dm->ps_tdma_du_adj_type = - 10; - } - } - } - } 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); - coex_dm->ps_tdma_du_adj_type = 7; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 7); - coex_dm->ps_tdma_du_adj_type = 7; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 7); - coex_dm->ps_tdma_du_adj_type = 7; - } else if (coex_dm->cur_ps_tdma == 4) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 8); - coex_dm->ps_tdma_du_adj_type = 8; - } - if (coex_dm->cur_ps_tdma == 9) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 15); - coex_dm->ps_tdma_du_adj_type = 15; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 15); - coex_dm->ps_tdma_du_adj_type = 15; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 15); - coex_dm->ps_tdma_du_adj_type = 15; - } else if (coex_dm->cur_ps_tdma == 12) { - halbtc8812a2ant_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) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 8); - coex_dm->ps_tdma_du_adj_type = - 8; - } else if (coex_dm->cur_ps_tdma == 13) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8812a2ant_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) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 16) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } - } - } 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); - coex_dm->ps_tdma_du_adj_type = 3; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 3); - coex_dm->ps_tdma_du_adj_type = 3; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 3); - coex_dm->ps_tdma_du_adj_type = 3; - } else if (coex_dm->cur_ps_tdma == 8) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 4); - coex_dm->ps_tdma_du_adj_type = 4; - } - if (coex_dm->cur_ps_tdma == 13) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 11); - coex_dm->ps_tdma_du_adj_type = 11; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 11); - coex_dm->ps_tdma_du_adj_type = 11; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 11); - coex_dm->ps_tdma_du_adj_type = 11; - } else if (coex_dm->cur_ps_tdma == 16) { - halbtc8812a2ant_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) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 4); - coex_dm->ps_tdma_du_adj_type = - 4; - } else if (coex_dm->cur_ps_tdma == 9) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8812a2ant_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) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 12) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8812a2ant_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) - halbtc8812a2ant_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); - } - } -} - -/* ****************** - * pstdma for wifi rssi low - * ****************** */ -void halbtc8812a2ant_tdma_duration_adjust_for_wifi_rssi_low( - 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; - - 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; - bt_info_ext = coex_sta->bt_info_ext; - - 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); - coex_dm->ps_tdma_du_adj_type = 82; - } - /* ============ */ - 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; */ - 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) > 1050 || - (coex_sta->low_priority_rx) > 1250) - retry_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; - 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 */ - 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; - 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) - 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; - 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)) ) - { - 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, 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); - coex_dm->ps_tdma_du_adj_type = 82; - } else if (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 == 83) { - halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 84); - 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; - } - */ - if (coex_dm->cur_ps_tdma == 84) { - halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 83); - coex_dm->ps_tdma_du_adj_type = 83; - } else if (coex_dm->cur_ps_tdma == 83) { - halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 82); - coex_dm->ps_tdma_du_adj_type = 82; - } else if (coex_dm->cur_ps_tdma == 82) { - 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 != 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) { - /* recover to previous adjust type */ - halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - coex_dm->ps_tdma_du_adj_type); - } - } -} - -void halbtc8812a2ant_get_bt_rssi_threshold(IN struct btc_coexist *btcoexist, - IN u8 *pThres0, IN u8 *pThres1) -{ - u8 ant_type; - - btcoexist->btc_get(btcoexist, BTC_GET_U1_ANT_TYPE, &ant_type); - - - switch (ant_type) { - case BTC_ANT_TYPE_0: - *pThres0 = 100; - *pThres1 = 100; - break; - case BTC_ANT_TYPE_1: - *pThres0 = 34; - *pThres1 = 42; - break; - case BTC_ANT_TYPE_2: - *pThres0 = 34; - *pThres1 = 42; - break; - case BTC_ANT_TYPE_3: - *pThres0 = 34; - *pThres1 = 42; - break; - case BTC_ANT_TYPE_4: - *pThres0 = 34; - *pThres1 = 42; - break; - default: - break; - } -} - - - -void halbtc8812a2ant_action_sco(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; - - - /* 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 */ - halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - - /* coex table */ - if (BTC_RSSI_LOW(bt_rssi_state)) - halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); - else - halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - - /* pstdma */ - if (BTC_RSSI_LOW(bt_rssi_state)) - halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); - else - halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 9); - - /* 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); - - /* limited Rx */ - halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); - - /* 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 */ - if (BTC_WIFI_BW_HT40 == wifi_bw) { - if (BTC_RSSI_HIGH(wifi_rssi_state)) { - halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, - true, 0x6); - } else { - halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, - true, 0x6); - } - } else { - if (BTC_RSSI_HIGH(wifi_rssi_state)) { - halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, - true, 0x6); - } else { - halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, - true, 0x6); - } - } -} - -void halbtc8812a2ant_action_sco_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; - - /* 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 */ - halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - - /* coex table */ - halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - - /* pstdma */ - if (BTC_RSSI_LOW(bt_rssi_state)) - halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); - else - halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 9); - - /* 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); - - /* limited Rx */ - halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, true, 0x8); - - /* 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 */ - if (BTC_WIFI_BW_HT40 == wifi_bw) { - if (BTC_RSSI_HIGH(wifi_rssi_state)) { - halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x6); - } else { - halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x6); - } - } else { - if (BTC_RSSI_HIGH(wifi_rssi_state)) { - halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x6); - } else { - halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x6); - } - } -} - -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 anttype = 0; - - - 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); - - - 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, 0x0, - 0x0); - - /* coex table */ - halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - - /* pstdma */ - halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - - /* decrease BT power */ - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - /* limited Rx */ - halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); - - /* 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 */ - if (BTC_WIFI_BW_HT40 == wifi_bw) { - if (BTC_RSSI_HIGH(wifi_rssi_state)) { - halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } else { - if (BTC_RSSI_HIGH(wifi_rssi_state)) { - halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } -} - -/* A2DP only / PAN(EDR) only/ A2DP+PAN(HS) */ -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 anttype = 0; - boolean ap_enable = false; - - 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); */ - - wifi_rssi_state = halbtc8812a2ant_wifi_rssi_state(btcoexist, 0, 2, 34, - 0); - bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); - - /* anttype = 4; */ - - if (anttype == 0) { /* ANTTYPE = 0 92E 2ant with SPDT */ - - 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 */ - 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); - - /* fw dac swing level */ - halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - - - /* sw mechanism */ - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - if (BTC_WIFI_BW_HT40 == wifi_bw) { - if (BTC_RSSI_HIGH(wifi_rssi_state)) { - halbtc8812a2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8812a2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } else { - if (BTC_RSSI_HIGH(wifi_rssi_state)) { - halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } -} - -void halbtc8812a2ant_action_a2dp_pan_hs(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; - - /* 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 */ - 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, 2); - else - halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); - - /* pstdma */ - if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) - halbtc8812a2ant_tdma_duration_adjust(btcoexist, false, false, - 2); - else - halbtc8812a2ant_tdma_duration_adjust(btcoexist, false, true, 2); - - /* decrease BT power */ - 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); - - /* fw dac swing level */ - halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - - - /* sw mechanism */ - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - if (BTC_WIFI_BW_HT40 == wifi_bw) { - if (BTC_RSSI_HIGH(wifi_rssi_state)) { - halbtc8812a2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, - true, 0x6); - } else { - halbtc8812a2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, - true, 0x6); - } - } else { - if (BTC_RSSI_HIGH(wifi_rssi_state)) { - halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, - true, 0x6); - } else { - halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, - true, 0x6); - } - } -} - -void halbtc8812a2ant_action_pan_edr(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; - - - - 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 (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) - halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - else - 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))) - halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - else - 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, 1); - else - halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 85); - - /* decrease BT power */ - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - /* limited Rx */ - halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); - - /* fw dac swing level */ - halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - - - /* sw mechanism */ - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - if (BTC_WIFI_BW_HT40 == wifi_bw) { - if (BTC_RSSI_HIGH(wifi_rssi_state)) { - halbtc8812a2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8812a2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } else { - if (BTC_RSSI_HIGH(wifi_rssi_state)) { - halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } -} - -/* PAN(HS) only */ -void halbtc8812a2ant_action_pan_hs(IN struct btc_coexist *btcoexist) -{ - u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH, - bt_rssi_state = BTC_RSSI_STATE_HIGH; - u32 wifi_bw; - - 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 */ - halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - - /* coex table */ - halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - - /* pstdma */ - halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); - - /* decrease BT power */ - 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); - - /* fw dac swing level */ - halbtc8812a2ant_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) { - if (BTC_RSSI_HIGH(wifi_rssi_state)) { - halbtc8812a2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8812a2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } else { - if (BTC_RSSI_HIGH(wifi_rssi_state)) { - halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } -} - -/* PAN(EDR)+A2DP */ -void halbtc8812a2ant_action_pan_edr_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; - - 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 (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) - halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - else - 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))) - halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - else - 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, false, false, - 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 */ - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - /* limited Rx */ - halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); - - /* 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 */ - if (BTC_WIFI_BW_HT40 == wifi_bw) { - if (BTC_RSSI_HIGH(wifi_rssi_state)) { - halbtc8812a2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8812a2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } else { - if (BTC_RSSI_HIGH(wifi_rssi_state)) { - halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } -} - - -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; - - - 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 (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) - halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 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, - 0x0, 0x0); - else - 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))) - 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); - - /* pstdma */ - if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) - halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 10); - else if (BTC_RSSI_LOW(wifi_rssi_state) && - (!BTC_RSSI_LOW(bt_rssi_state))) - halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); - else - halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 85); - - /* decrease BT power */ - 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, - 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); - - /* 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 */ - if (BTC_WIFI_BW_HT40 == wifi_bw) { - if (BTC_RSSI_HIGH(wifi_rssi_state)) { - halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } else { - if (BTC_RSSI_HIGH(wifi_rssi_state)) { - halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } -} - -/* HID+A2DP+PAN(EDR) */ -void halbtc8812a2ant_action_hid_a2dp_pan_edr(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; - - 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 (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) - halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 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, - 0x0, 0x0); - else - 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))) - 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); - - /* pstdma */ - if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) - halbtc8812a2ant_tdma_duration_adjust(btcoexist, true, false, 3); - else if (BTC_RSSI_LOW(wifi_rssi_state) && - (!BTC_RSSI_LOW(bt_rssi_state))) - halbtc8812a2ant_tdma_duration_adjust(btcoexist, true, true, 3); - else { - coex_dm->auto_tdma_adjust = false; - halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 86); - } - - /* decrease BT power */ - 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, - 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); - - - /* 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 */ - if (BTC_WIFI_BW_HT40 == wifi_bw) { - if (BTC_RSSI_HIGH(wifi_rssi_state)) { - halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } else { - if (BTC_RSSI_HIGH(wifi_rssi_state)) { - halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } -} - -void halbtc8812a2ant_action_hid_a2dp_pan_hs(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; - - 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 */ - 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 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))) - 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 - halbtc8812a2ant_tdma_duration_adjust(btcoexist, true, true, 2); - - /* decrease BT power */ - 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, - 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); - - /* 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 */ - if (BTC_WIFI_BW_HT40 == wifi_bw) { - if (BTC_RSSI_HIGH(wifi_rssi_state)) { - halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } else { - if (BTC_RSSI_HIGH(wifi_rssi_state)) { - halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } -} - -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 anttype = 0; - - 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); - - 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); - - } 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); - - } 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 */ - 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 */ - halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); - - /* 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 */ - if (BTC_WIFI_BW_HT40 == wifi_bw) { - if (BTC_RSSI_HIGH(wifi_rssi_state)) { - halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8812a2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } else { - if (BTC_RSSI_HIGH(wifi_rssi_state)) { - halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8812a2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } -} - -void halbtc8812a2ant_coex_under_5g(IN struct btc_coexist *btcoexist) -{ - halbtc8812a2ant_coex_all_off(btcoexist); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Under 5G, force set BT to ignore Wlan active!!\n"); - BTC_TRACE(trace_buf); - halbtc8812a2ant_ignore_wlan_act(btcoexist, NORMAL_EXEC, true); -} -/* **************************************************** */ -void halbtc8812a2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) -{ - boolean wifi_under_5g = false; - u8 algorithm = 0; - - 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; - } - - 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); - halbtc8812a2ant_coex_under_5g(btcoexist); - return; - } - - - algorithm = halbtc8812a2ant_action_algorithm(btcoexist); - if (coex_sta->c2h_bt_inquiry_page && - (BT_8812A_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); - halbtc8812a2ant_action_bt_inquiry(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 (halbtc8812a2ant_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; - coex_dm->auto_tdma_adjust_low_rssi = 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; - coex_dm->auto_tdma_adjust_low_rssi = false; - } - switch (coex_dm->cur_algorithm) { - case BT_8812A_2ANT_COEX_ALGO_SCO: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = SCO.\n"); - BTC_TRACE(trace_buf); - halbtc8812a2ant_action_sco(btcoexist); - break; - case BT_8812A_2ANT_COEX_ALGO_SCO_HID: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = SCO+HID.\n"); - BTC_TRACE(trace_buf); - halbtc8812a2ant_action_sco_hid(btcoexist); - break; - case BT_8812A_2ANT_COEX_ALGO_HID: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = HID.\n"); - BTC_TRACE(trace_buf); - halbtc8812a2ant_action_hid(btcoexist); - break; - case BT_8812A_2ANT_COEX_ALGO_A2DP: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = A2DP.\n"); - BTC_TRACE(trace_buf); - halbtc8812a2ant_action_a2dp(btcoexist); - break; - case BT_8812A_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); - halbtc8812a2ant_action_a2dp_pan_hs(btcoexist); - break; - case BT_8812A_2ANT_COEX_ALGO_PANEDR: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n"); - BTC_TRACE(trace_buf); - halbtc8812a2ant_action_pan_edr(btcoexist); - break; - case BT_8812A_2ANT_COEX_ALGO_PANHS: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = HS mode.\n"); - BTC_TRACE(trace_buf); - halbtc8812a2ant_action_pan_hs(btcoexist); - break; - case BT_8812A_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); - halbtc8812a2ant_action_pan_edr_a2dp(btcoexist); - break; - case BT_8812A_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); - halbtc8812a2ant_action_pan_edr_hid(btcoexist); - break; - case BT_8812A_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); - halbtc8812a2ant_action_hid_a2dp_pan_edr( - btcoexist); - break; - case BT_8812A_2ANT_COEX_ALGO_HID_A2DP_PANHS: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN(HS).\n"); - BTC_TRACE(trace_buf); - halbtc8812a2ant_action_hid_a2dp_pan_hs( - btcoexist); - break; - case BT_8812A_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); - halbtc8812a2ant_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); - halbtc8812a2ant_coex_all_off(btcoexist); - break; - } - coex_dm->pre_algorithm = coex_dm->cur_algorithm; - } - -} - -void halbtc8812a2ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean back_up) -{ - u8 u8tmp = 0; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], 2Ant Init HW Config!!\n"); - BTC_TRACE(trace_buf); - - 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); - } - - /* ant sw control to BT */ - halbtc8812a2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_CPL_AUX, true, - false); - - /* 0x790[5:0]=0x5 */ - u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x790); - u8tmp &= 0xc0; - u8tmp |= 0x5; - btcoexist->btc_write_1byte(btcoexist, 0x790, u8tmp); - - /* PTA parameter */ - btcoexist->btc_write_1byte(btcoexist, 0x6cc, 0x0); - btcoexist->btc_write_4byte(btcoexist, 0x6c8, 0xffff); - btcoexist->btc_write_4byte(btcoexist, 0x6c4, 0x55555555); - btcoexist->btc_write_4byte(btcoexist, 0x6c0, 0x55555555); - - /* coex parameters */ - btcoexist->btc_write_1byte(btcoexist, 0x778, 0x1); - - /* enable counter statistics */ - btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); - - /* 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); - u8tmp |= BIT(7); - btcoexist->btc_write_1byte(btcoexist, 0x4, u8tmp); - - /* bt clock related */ - 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; - -} - -/* ************************************************************ - * work around function start with wa_halbtc8812a2ant_ - * ************************************************************ - * ************************************************************ - * extern function start with ex_halbtc8812a2ant_ - * ************************************************************ */ -void ex_halbtc8812a2ant_power_on_setting(IN struct btc_coexist *btcoexist) -{ -} - -void ex_halbtc8812a2ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean wifi_only) -{ - halbtc8812a2ant_init_hw_config(btcoexist, true); -} - -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); - - 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 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]============"); - 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); - -#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_%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 ", - "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]", - ((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" : - ((BT_8812A_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); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", - "SCO/HID/PAN/A2DP", - bt_link_info->sco_exist, bt_link_info->hid_exist, - bt_link_info->pan_exist, bt_link_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_8812A_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_8812a_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); - - 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]============"); - 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 (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->auto_tdma_adjust_low_rssi); - 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); - - 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); - 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); - - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xcb3); - u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xcb7); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", - "0xcb3/ 0xcb7", - u8tmp[0], u8tmp[1]); - 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); - - 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_8812A_2ANT == 1) - halbtc8812a2ant_monitor_bt_ctr(btcoexist); -#endif - btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); -} - - -void ex_halbtc8812a2ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) -{ - boolean wifi_under_5g = false; - - 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, - false, true); - - 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); - } 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; - - 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], IPS notify, force set BT NOT to ignore Wlan active!!\n"); - BTC_TRACE(trace_buf); - - halbtc8812a2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, - false); - } - } -} - -void ex_halbtc8812a2ant_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_halbtc8812a2ant_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); - - btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, - &coex_sta->scan_ap_num); - } -} - -void ex_halbtc8812a2ant_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_halbtc8812a2ant_media_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - u8 data_len = 5; - u8 buf[6] = {0}; - u8 h2c_parameter[3] = {0}; - u32 wifi_bw; - u8 wifi_central_chnl; - - if (btcoexist->manual_control || - btcoexist->stop_coex_dm || - btcoexist->bt_info.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); - } 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; - } - - 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]; - - buf[0] = data_len; - buf[1] = 0x5; /* OP_Code */ - buf[2] = 0x3; /* OP_Code_Length */ - buf[3] = h2c_parameter[0]; /* OP_Code_Content */ - buf[4] = h2c_parameter[1]; - buf[5] = h2c_parameter[2]; - - btcoexist->btc_set(btcoexist, BTC_SET_ACT_CTRL_BT_COEX, - (void *)&buf[0]); -} - -void ex_halbtc8812a2ant_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_halbtc8812a2ant_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, 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_8812A_2ANT_MAX) - rsp_source = BT_INFO_SRC_8812A_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 (BT_INFO_SRC_8812A_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]; - - /* 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_halbtc8812a2ant_media_status_notify( - btcoexist, BTC_MEDIA_CONNECT); - else - ex_halbtc8812a2ant_media_status_notify( - btcoexist, BTC_MEDIA_DISCONNECT); - } - - if ((coex_sta->bt_info_ext & BIT(3)) && !wifi_under_5g) { - /* BT already ignored WlanAct */ - if (!btcoexist->manual_control && - !btcoexist->stop_coex_dm) { - if (!coex_sta->under_ips) { - 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); - halbtc8812a2ant_ignore_wlan_act( - btcoexist, FORCE_EXEC, false); - } - } - } else { - /* BT already NOT ignore Wlan active, do nothing here. */ - - if (coex_sta->under_ips) { - /* work around for 8812a combo hw bug => when IPS, wlanAct is always high. */ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], wifi is under IPS, set BT to ignore Wlan active!!\n"); - BTC_TRACE(trace_buf); - halbtc8812a2ant_ignore_wlan_act(btcoexist, - FORCE_EXEC, true); - } - } - } - - /* check BIT2 first ==> check if bt is under inquiry or page scan */ - if (bt_info & BT_INFO_8812A_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_8812A_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->acl_busy = false; - } else { /* connection exists */ - coex_sta->bt_link_exist = true; - if (bt_info & BT_INFO_8812A_2ANT_B_FTP) - coex_sta->pan_exist = true; - else - coex_sta->pan_exist = false; - if (bt_info & BT_INFO_8812A_2ANT_B_A2DP) - coex_sta->a2dp_exist = true; - else - coex_sta->a2dp_exist = false; - if (bt_info & BT_INFO_8812A_2ANT_B_HID) - coex_sta->hid_exist = true; - else - coex_sta->hid_exist = false; - if (bt_info & BT_INFO_8812A_2ANT_B_SCO_ESCO) - coex_sta->sco_exist = true; - else - coex_sta->sco_exist = false; - if (bt_info & BT_INFO_8812A_2ANT_B_ACL_BUSY) - coex_sta->acl_busy = true; - else - coex_sta->acl_busy = false; - - } - - halbtc8812a2ant_update_bt_link_info(btcoexist); - - if (!(bt_info & BT_INFO_8812A_2ANT_B_CONNECTION)) { - coex_dm->bt_status = BT_8812A_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_8812A_2ANT_B_CONNECTION) { /* connection exists but no busy */ - coex_dm->bt_status = BT_8812A_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_8812A_2ANT_B_SCO_ESCO) || - (bt_info & BT_INFO_8812A_2ANT_B_SCO_BUSY)) { - coex_dm->bt_status = BT_8812A_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_8812A_2ANT_B_ACL_BUSY) { - coex_dm->bt_status = BT_8812A_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_8812A_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_8812A_2ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || - (BT_8812A_2ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || - (BT_8812A_2ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) { - bt_busy = true; - if (!wifi_under_5g) - 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); - - halbtc8812a2ant_run_coexist_mechanism(btcoexist); -} - -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); - - halbtc8812a2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_CPL_AUX, false, - true); - 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); - - /* 0x522=0xff, pause tx */ - btcoexist->btc_write_1byte(btcoexist, 0x522, 0xff); - /* 0x40[7:6]=2'b01, modify BT mode. */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0xc0, 0x2); - /* 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) - halbtc8812a2ant_run_coexist_mechanism(btcoexist); -#endif -} - -void ex_halbtc8812a2ant_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_DEC_BT_PWR: - 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]; - - buf[0] = data_len; - buf[1] = 0x3; /* OP_Code */ - buf[2] = 0x2; /* OP_Code_Length */ - - buf[3] = dec_bt_pwr; /* OP_Code_Content */ - buf[4] = pwr_level; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[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]); - } - } - break; - - case BTC_DBG_SET_COEX_BT_AFH_MAP: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Set BT AFH Map\n"); - BTC_TRACE(trace_buf); - { - u8 data_len = 5; - u8 buf[6] = {0}; - - if (op_len == 3) { - buf[0] = data_len; - buf[1] = 0x5; /* OP_Code */ - buf[2] = 0x3; /* OP_Code_Length */ - - buf[3] = pdata[0]; /* OP_Code_Content */ - buf[4] = pdata[1]; - buf[5] = pdata[2]; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Set BT AFH Map = %02x %02x %02x\n", - pdata[0], pdata[1], pdata[2]); - BTC_TRACE(trace_buf); - btcoexist->btc_set(btcoexist, - BTC_SET_ACT_CTRL_BT_COEX, - (void *)&buf[0]); - } - } - break; - - case BTC_DBG_SET_COEX_BT_IGNORE_WLAN_ACT: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Set BT Ignore Wlan Active\n"); - BTC_TRACE(trace_buf); - { - u8 data_len = 3; - u8 buf[6] = {0}; - - if (op_len == 1) { - buf[0] = data_len; - buf[1] = 0x1; /* OP_Code */ - buf[2] = 0x1; /* OP_Code_Length */ - - buf[3] = pdata[0]; /* OP_Code_Content */ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Set BT Ignore Wlan Active = 0x%x\n", - pdata[0]); - BTC_TRACE(trace_buf); - - btcoexist->btc_set(btcoexist, - BTC_SET_ACT_CTRL_BT_COEX, - (void *)&buf[0]); - } - } - break; - - default: - break; - } -} - -#endif - -#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8812a2ant.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8812a2ant.h deleted file mode 100644 index 26db0e85bd0f..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8812a2ant.h +++ /dev/null @@ -1,228 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ - -#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) - -#if (RTL8812A_SUPPORT == 1) - -/* ******************************************* - * The following is for 8812A 2Ant BT Co-exist definition - * ******************************************* */ -#define BT_AUTO_REPORT_ONLY_8812A_2ANT 0 - -#define BT_INFO_8812A_2ANT_B_FTP BIT(7) -#define BT_INFO_8812A_2ANT_B_A2DP BIT(6) -#define BT_INFO_8812A_2ANT_B_HID BIT(5) -#define BT_INFO_8812A_2ANT_B_SCO_BUSY BIT(4) -#define BT_INFO_8812A_2ANT_B_ACL_BUSY BIT(3) -#define BT_INFO_8812A_2ANT_B_INQ_PAGE BIT(2) -#define BT_INFO_8812A_2ANT_B_SCO_ESCO BIT(1) -#define BT_INFO_8812A_2ANT_B_CONNECTION BIT(0) - -#define BT_INFO_8812A_2ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ - (((_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, - BT_INFO_SRC_8812A_2ANT_BT_RSP = 0x1, - BT_INFO_SRC_8812A_2ANT_BT_ACTIVE_SEND = 0x2, - BT_INFO_SRC_8812A_2ANT_MAX -}; - -enum bt_8812a_2ant_bt_status { - BT_8812A_2ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, - BT_8812A_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, - BT_8812A_2ANT_BT_STATUS_INQ_PAGE = 0x2, - BT_8812A_2ANT_BT_STATUS_ACL_BUSY = 0x3, - BT_8812A_2ANT_BT_STATUS_SCO_BUSY = 0x4, - BT_8812A_2ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, - BT_8812A_2ANT_BT_STATUS_MAX -}; - -enum bt_8812a_2ant_coex_algo { - BT_8812A_2ANT_COEX_ALGO_UNDEFINED = 0x0, - BT_8812A_2ANT_COEX_ALGO_SCO = 0x1, - BT_8812A_2ANT_COEX_ALGO_SCO_HID = 0x2, - BT_8812A_2ANT_COEX_ALGO_HID = 0x3, - BT_8812A_2ANT_COEX_ALGO_A2DP = 0x4, - BT_8812A_2ANT_COEX_ALGO_A2DP_PANHS = 0x5, - BT_8812A_2ANT_COEX_ALGO_PANEDR = 0x6, - BT_8812A_2ANT_COEX_ALGO_PANHS = 0x7, - BT_8812A_2ANT_COEX_ALGO_PANEDR_A2DP = 0x8, - BT_8812A_2ANT_COEX_ALGO_PANEDR_HID = 0x9, - BT_8812A_2ANT_COEX_ALGO_HID_A2DP_PANEDR = 0xa, - BT_8812A_2ANT_COEX_ALGO_HID_A2DP_PANHS = 0xb, - BT_8812A_2ANT_COEX_ALGO_HID_A2DP = 0xc, - BT_8812A_2ANT_COEX_ALGO_MAX = 0xd -}; - -struct coex_dm_8812a_2ant { - /* 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 auto_tdma_adjust; - boolean auto_tdma_adjust_low_rssi; - 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_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 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 pre_algorithm; - u8 cur_algorithm; - u8 bt_status; - u8 wifi_chnl_info[3]; - - u32 pre_ra_mask; - u32 cur_ra_mask; - u8 cur_ra_mask_type; - 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; - - boolean cur_enable_pta; - boolean pre_enable_pta; -}; - -struct coex_sta_8812a_2ant { - boolean bt_disabled; - boolean bt_link_exist; - boolean sco_exist; - boolean a2dp_exist; - boolean hid_exist; - boolean pan_exist; - boolean acl_busy; - - 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_8812A_2ANT_MAX][10]; - u32 bt_info_c2h_cnt[BT_INFO_SRC_8812A_2ANT_MAX]; - u32 bt_info_query_cnt; - 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; -}; - -/* ******************************************* - * The following is interface which will notify coex module. - * ******************************************* */ -void ex_halbtc8812a2ant_power_on_setting(IN struct btc_coexist *btcoexist); -void ex_halbtc8812a2ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean wifi_only); -void ex_halbtc8812a2ant_init_coex_dm(IN struct btc_coexist *btcoexist); -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); -void ex_halbtc8812a2ant_scan_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8812a2ant_connect_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8812a2ant_media_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8812a2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8812a2ant_bt_info_notify(IN struct btc_coexist *btcoexist, - IN u8 *tmp_buf, IN u8 length); -void ex_halbtc8812a2ant_rf_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type); - -void ex_halbtc8812a2ant_halt_notify(IN struct btc_coexist *btcoexist); -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) -#define ex_halbtc8812a2ant_init_hw_config(btcoexist, wifi_only) -#define ex_halbtc8812a2ant_init_coex_dm(btcoexist) -#define ex_halbtc8812a2ant_ips_notify(btcoexist, type) -#define ex_halbtc8812a2ant_lps_notify(btcoexist, type) -#define ex_halbtc8812a2ant_scan_notify(btcoexist, type) -#define ex_halbtc8812a2ant_connect_notify(btcoexist, type) -#define ex_halbtc8812a2ant_media_status_notify(btcoexist, type) -#define ex_halbtc8812a2ant_specific_packet_notify(btcoexist, type) -#define ex_halbtc8812a2ant_bt_info_notify(btcoexist, tmp_buf, length) -#define ex_halbtc8812a2ant_rf_status_notify(btcoexist, type) -#define ex_halbtc8812a2ant_halt_notify(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/rtl8188eu/hal/btc/halbtc8821a1ant.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8821a1ant.c deleted file mode 100644 index 3451a5185023..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8821a1ant.c +++ /dev/null @@ -1,3290 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ -/* ************************************************************ - * Description: - * - * This file is for 8821A_1ANT Co-exist mechanism - * - * History - * 2012/11/15 Cosa first check in. - * - * ************************************************************ - * SY modify 2015/04/27 - * ************************************************************ - * include files - * ************************************************************ */ -#include "mp_precomp.h" - -#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) - -#if (RTL8821A_SUPPORT == 1) -/* ************************************************************ - * Global variables, these are static variables - * ************************************************************ */ -static u8 *trace_buf = &gl_btc_trace_buf[0]; -static struct coex_dm_8821a_1ant glcoex_dm_8821a_1ant; -static struct coex_dm_8821a_1ant *coex_dm = &glcoex_dm_8821a_1ant; -static struct coex_sta_8821a_1ant glcoex_sta_8821a_1ant; -static struct coex_sta_8821a_1ant *coex_sta = &glcoex_sta_8821a_1ant; - -const char *const glbt_info_src_8821a_1ant[] = { - "BT Info[wifi fw]", - "BT Info[bt rsp]", - "BT Info[bt auto report]", -}; - -u32 glcoex_ver_date_8821a_1ant = 20160816; -u32 glcoex_ver_8821a_1ant = 0x63; -u32 glcoex_ver_btdesired_8821a_1ant = 0x62; - -/* ************************************************************ - * local function proto type if needed - * ************************************************************ - * ************************************************************ - * local function start with halbtc8821a1ant_ - * ************************************************************ */ -u8 halbtc8821a1ant_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_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_8821A_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_8821A_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 halbtc8821a1ant_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_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_8821A_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_8821A_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 halbtc8821a1ant_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 halbtc8821a1ant_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 halbtc8821a1ant_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 halbtc8821a1ant_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 halbtc8821a1ant_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 */ - halbtc8821a1ant_update_ra_mask(btcoexist, force_exec, - 0x0); - break; - case 1: /* disable cck 1/2 */ - halbtc8821a1ant_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 */ - halbtc8821a1ant_update_ra_mask(btcoexist, force_exec, - 0x0001f1f7); - break; - default: - break; - } - - halbtc8821a1ant_auto_rate_fallback_retry(btcoexist, force_exec, - arfr_type); - halbtc8821a1ant_retry_limit(btcoexist, force_exec, retry_limit_type); - halbtc8821a1ant_ampdu_max_time(btcoexist, force_exec, ampdu_time_type); -} - - -/* true/xxxx/x:1 - * false/false/x: 64 - * 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) -{ - 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 halbtc8821a1ant_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; -#if 0 - /* to avoid 0x76e[3] = 1 (WLAN_Act control by PTA) during IPS */ - if (!(btcoexist->btc_read_1byte(btcoexist, 0x76e) & 0x8)) { - 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; - - /* reset counter */ - 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}; - - coex_sta->c2h_bt_info_req_sent = true; - - h2c_parameter[0] |= BIT(0); /* trigger */ - - btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); -} - -boolean halbtc8821a1ant_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 halbtc8821a1ant_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 halbtc8821a1ant_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_8821A_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_8821A_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_8821A_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_8821A_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_8821A_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_8821A_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_8821A_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_8821A_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_8821A_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_8821A_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_8821A_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_8821A_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_8821A_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_8821A_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_8821A_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_8821A_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_8821A_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_8821A_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_8821A_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_8821A_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_8821A_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_8821A_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_8821A_1ANT_COEX_ALGO_PANEDR_HID; - } - } - } - } - - return algorithm; -} - -void halbtc8821a1ant_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 halbtc8821a1ant_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; - } - halbtc8821a1ant_set_bt_auto_report(btcoexist, - coex_dm->cur_bt_auto_report); - - coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; -} - -void halbtc8821a1ant_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] = 0xf5; /* MCS7 or OFDM54 */ - h2c_parameter[4] = 0xa0; /* MCS6 or OFDM48 */ - h2c_parameter[5] = 0xa0; /* MCS5 or OFDM36 */ - } - - btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); -} - -void halbtc8821a1ant_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; - } - halbtc8821a1ant_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 halbtc8821a1ant_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 halbtc8821a1ant_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; - } - halbtc8821a1ant_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 halbtc8821a1ant_coex_table_with_type(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u8 type) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** CoexTable(%d) **********\n", type); - BTC_TRACE(trace_buf); - - switch (type) { - case 0: - halbtc8821a1ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x55555555, 0xffffff, 0x3); - break; - case 1: - halbtc8821a1ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); - break; - case 2: - halbtc8821a1ant_coex_table(btcoexist, force_exec, - 0x5a5a5a5a, 0x5a5a5a5a, 0xffffff, 0x3); - break; - case 3: - halbtc8821a1ant_coex_table(btcoexist, force_exec, - 0x5a5a5a5a, 0xaaaaaaaa, 0xffffff, 0x3); - break; - case 4: - halbtc8821a1ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); - break; - case 5: - halbtc8821a1ant_coex_table(btcoexist, force_exec, - 0x5a5a5a5a, 0xaaaa5a5a, 0xffffff, 0x3); - break; - case 6: - halbtc8821a1ant_coex_table(btcoexist, force_exec, - 0x55555555, 0xaaaa5a5a, 0xffffff, 0x3); - break; - case 7: - halbtc8821a1ant_coex_table(btcoexist, force_exec, - 0xaaaaaaaa, 0xaaaaaaaa, 0xffffff, 0x3); - break; - default: - break; - } -} - -void halbtc8821a1ant_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 halbtc8821a1ant_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; - } - halbtc8821a1ant_set_fw_ignore_wlan_act(btcoexist, enable); - - 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) -{ - 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 halbtc8821a1ant_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; - } - halbtc8821a1ant_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 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) -{ - 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); - - /* 0x765 = 0x18 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x765, 0x18, 0x3); - - 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); - - /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x64, 0x1, 0x1); */ /*Main Ant to BT for IPS case 0x4c[23]=1 */ - } 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); - - /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x64, 0x1, 0x0); */ /*Aux Ant to BT for IPS case 0x4c[23]=1 */ - } - } else if (wifi_off) { - /* 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); - - /* 0x765 = 0x18 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x765, 0x18, 0x3); - } else { - /* 0x765 = 0x0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x765, 0x18, 0x0); - } - - /* ext switch setting */ - switch (ant_pos_type) { - case BTC_ANT_PATH_WIFI: - btcoexist->btc_write_1byte(btcoexist, 0xcb4, 0x77); - if (board_info->btdm_ant_pos == - BTC_ANTENNA_AT_MAIN_PORT) - btcoexist->btc_write_1byte_bitmask(btcoexist, - 0xcb7, 0x30, 0x1); - else - btcoexist->btc_write_1byte_bitmask(btcoexist, - 0xcb7, 0x30, 0x2); - break; - case BTC_ANT_PATH_BT: - btcoexist->btc_write_1byte(btcoexist, 0xcb4, 0x77); - if (board_info->btdm_ant_pos == - BTC_ANTENNA_AT_MAIN_PORT) - btcoexist->btc_write_1byte_bitmask(btcoexist, - 0xcb7, 0x30, 0x2); - else - btcoexist->btc_write_1byte_bitmask(btcoexist, - 0xcb7, 0x30, 0x1); - break; - default: - case BTC_ANT_PATH_PTA: - btcoexist->btc_write_1byte(btcoexist, 0xcb4, 0x66); - if (board_info->btdm_ant_pos == - BTC_ANTENNA_AT_MAIN_PORT) - btcoexist->btc_write_1byte_bitmask(btcoexist, - 0xcb7, 0x30, 0x1); - else - btcoexist->btc_write_1byte_bitmask(btcoexist, - 0xcb7, 0x30, 0x2); - break; - } -} - -void halbtc8821a1ant_ps_tdma(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean turn_on, IN u8 type) -{ - u8 rssi_adjust_val = 0; - /* u32 fw_ver=0; */ - - coex_dm->cur_ps_tdma_on = turn_on; - coex_dm->cur_ps_tdma = type; - - 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)) - return; - } - if (turn_on) { - switch (type) { - default: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, - 0x1a, 0x1a, 0x0, 0x50); - break; - case 1: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, - 0x3a, 0x03, 0x10, 0x50); - rssi_adjust_val = 11; - break; - case 2: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, - 0x2b, 0x03, 0x10, 0x50); - rssi_adjust_val = 14; - break; - case 3: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, - 0x1d, 0x1d, 0x0, 0x52); - break; - case 4: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x93, - 0x15, 0x3, 0x14, 0x0); - rssi_adjust_val = 17; - break; - case 5: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x61, - 0x15, 0x3, 0x11, 0x10); - break; - case 6: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x61, - 0x20, 0x3, 0x11, 0x13); - break; - case 7: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x13, - 0xc, 0x5, 0x0, 0x0); - break; - case 8: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x93, - 0x25, 0x3, 0x10, 0x0); - break; - case 9: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, - 0x21, 0x3, 0x10, 0x50); - rssi_adjust_val = 18; - break; - case 10: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x13, - 0xa, 0xa, 0x0, 0x40); - break; - case 11: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, - 0x15, 0x03, 0x10, 0x50); - rssi_adjust_val = 20; - break; - case 12: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, - 0x0a, 0x0a, 0x0, 0x50); - break; - case 13: - if (coex_sta->scan_ap_num <= 5) - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, - 0x40, 0x3, 0x10, 0x50); - else - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, - 0x12, 0x12, 0x0, 0x50); - break; - case 14: - if (coex_sta->scan_ap_num <= 5) - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, - 0x30, 0x3, 0x10, 0x50); - else - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, - 0x1e, 0x3, 0x10, 0x14); - break; - case 15: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x13, - 0xa, 0x3, 0x8, 0x0); - break; - case 16: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x93, - 0x15, 0x3, 0x10, 0x0); - rssi_adjust_val = 18; - break; - case 18: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x93, - 0x25, 0x3, 0x10, 0x0); - rssi_adjust_val = 14; - break; - case 20: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x61, - 0x35, 0x03, 0x11, 0x10); - break; - case 21: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x61, - 0x25, 0x03, 0x11, 0x11); - break; - case 22: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x61, - 0x25, 0x03, 0x11, 0x10); - break; - case 23: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0xe3, - 0x25, 0x3, 0x31, 0x18); - rssi_adjust_val = 22; - break; - case 24: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0xe3, - 0x15, 0x3, 0x31, 0x18); - rssi_adjust_val = 22; - break; - case 25: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0xe3, - 0xa, 0x3, 0x31, 0x18); - rssi_adjust_val = 22; - break; - case 26: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0xe3, - 0xa, 0x3, 0x31, 0x18); - rssi_adjust_val = 22; - break; - case 27: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0xe3, - 0x25, 0x3, 0x31, 0x98); - rssi_adjust_val = 22; - break; - case 28: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x69, - 0x25, 0x3, 0x31, 0x0); - break; - case 29: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0xab, - 0x1a, 0x1a, 0x1, 0x10); - break; - case 30: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, - 0x30, 0x3, 0x10, 0x10); - break; - case 31: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0xd3, - 0x1a, 0x1a, 0, 0x58); - break; - case 32: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x61, - 0x35, 0x3, 0x11, 0x11); - break; - case 33: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0xa3, - 0x25, 0x3, 0x30, 0x90); - break; - case 34: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x53, - 0x1a, 0x1a, 0x0, 0x10); - break; - case 35: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x63, - 0x1a, 0x1a, 0x0, 0x10); - break; - case 36: - halbtc8821a1ant_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 */ - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x23, - 0x18, 0x00, 0x10, 0x24); - break; - case 41: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, - 0x15, 0x3, 0x11, 0x11); - break; - case 42: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, - 0x20, 0x3, 0x11, 0x11); - break; - case 43: - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, - 0x30, 0x3, 0x10, 0x11); - break; - } - } else { - /* disable PS tdma */ - switch (type) { - case 8: /* PTA Control */ - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x8, - 0x0, 0x0, 0x0, 0x0); - halbtc8821a1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_PTA, false, false); - break; - case 0: - default: /* Software control, Antenna at BT side */ - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x0, - 0x0, 0x0, 0x0, 0x0); - halbtc8821a1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_BT, false, false); - break; - case 9: /* Software control, Antenna at WiFi side */ - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x0, - 0x0, 0x0, 0x0, 0x0); - halbtc8821a1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_WIFI, false, false); - break; - case 10: /* under 5G */ - halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x0, - 0x0, 0x0, 0x8, 0x0); - halbtc8821a1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_BT, false, false); - break; - } - } - rssi_adjust_val = 0; - btcoexist->btc_set(btcoexist, - BTC_SET_U1_RSSI_ADJ_VAL_FOR_1ANT_COEX_TYPE, &rssi_adjust_val); - - /* 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 halbtc8821a1ant_coex_all_off(IN struct btc_coexist *btcoexist) -{ - /* sw all off */ - halbtc8821a1ant_sw_mechanism(btcoexist, false); - - /* hw all off */ - halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -} - -boolean halbtc8821a1ant_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_8821A_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); - halbtc8821a1ant_sw_mechanism(btcoexist, false); - - common = true; - } else if (wifi_connected && - (BT_8821A_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); - halbtc8821a1ant_sw_mechanism(btcoexist, false); - - common = true; - } else if (!wifi_connected && - (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); - halbtc8821a1ant_sw_mechanism(btcoexist, false); - - common = true; - } else if (wifi_connected && - (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); - halbtc8821a1ant_sw_mechanism(btcoexist, false); - - common = true; - } else if (!wifi_connected && - (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); - halbtc8821a1ant_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 halbtc8821a1ant_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 */ - 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. */ - } - } -} - -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_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); - - halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 10); - - halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - - halbtc8821a1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - - halbtc8821a1ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 5); -} - -void halbtc8821a1ant_action_wifi_only(IN struct btc_coexist *btcoexist) -{ - halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 9); -} - -void halbtc8821a1ant_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); - halbtc8821a1ant_action_wifi_only(btcoexist); - } - } - 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 { - btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, - NULL); - btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, - NULL); - } - } -} - -/* ********************************************* - * - * 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) -{ - 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 */ - halbtc8821a1ant_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_8821A_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifi_status) { - /* halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); */ - /* halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); */ - halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 32); - halbtc8821a1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 1); - coex_dm->auto_tdma_adjust = false; - } else if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || - (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - /* halbtc8821a1ant_tdma_duration_adjust_for_acl(btcoexist, wifi_status); */ - halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 14); - halbtc8821a1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 1); - } else { /* for low BT RSSI */ - halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 14); - halbtc8821a1ant_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 */ - if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || - (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 14); - coex_dm->auto_tdma_adjust = false; - } else { /* for low BT RSSI */ - halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 14); - coex_dm->auto_tdma_adjust = false; - } - - halbtc8821a1ant_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) */ - halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); - halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); - 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) */ - halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 43); - halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); - coex_dm->auto_tdma_adjust = false; - } else { - halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 11); - halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); - coex_dm->auto_tdma_adjust = false; - } -} - -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); - halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -} - -void halbtc8821a1ant_action_wifi_not_connected_scan(IN struct btc_coexist - *btcoexist) -{ - 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) { - halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 22); - halbtc8821a1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } else { - halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 20); - halbtc8821a1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } - } else if ((BT_8821A_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || - (BT_8821A_1ANT_BT_STATUS_ACL_SCO_BUSY == - coex_dm->bt_status)) { - halbtc8821a1ant_action_bt_sco_hid_only_busy(btcoexist, - BT_8821A_1ANT_WIFI_STATUS_CONNECTED_SCAN); - } else { - /* halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); */ - /* halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); */ - - /* Bryant Add */ - halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - } -} - -void halbtc8821a1ant_action_wifi_not_connected_asso_auth( - IN struct btc_coexist *btcoexist) -{ - 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 */ - 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)) { - 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, 2); - } -} - -void halbtc8821a1ant_action_wifi_connected_scan(IN struct btc_coexist - *btcoexist) -{ - 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) { - halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 22); - halbtc8821a1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } else { - halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 20); - halbtc8821a1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } - } else if ((BT_8821A_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || - (BT_8821A_1ANT_BT_STATUS_ACL_SCO_BUSY == - coex_dm->bt_status)) { - halbtc8821a1ant_action_bt_sco_hid_only_busy(btcoexist, - BT_8821A_1ANT_WIFI_STATUS_CONNECTED_SCAN); - } else { - /* halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); */ - /* halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); */ - - /* Bryant Add */ - halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - } -} - -void halbtc8821a1ant_action_wifi_connected_specific_packet( - IN struct btc_coexist *btcoexist) -{ - 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) || - (bt_link_info->a2dp_exist)) { - halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); - halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } - - if ((bt_link_info->hid_exist) && (bt_link_info->a2dp_exist)) { - halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 14); - halbtc8821a1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 1); - } - - - else if (bt_link_info->pan_exist) { - 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, 2); - } -} - -void halbtc8821a1ant_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) { - 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); - 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) - halbtc8821a1ant_action_wifi_connected_scan(btcoexist); - else - halbtc8821a1ant_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_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) { - if (BT_8821A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { - halbtc8821a1ant_action_wifi_connected_bt_acl_busy( - btcoexist, - BT_8821A_1ANT_WIFI_STATUS_CONNECTED_IDLE); - } else if ((BT_8821A_1ANT_BT_STATUS_SCO_BUSY == - coex_dm->bt_status) || - (BT_8821A_1ANT_BT_STATUS_ACL_SCO_BUSY == - coex_dm->bt_status)) { - halbtc8821a1ant_action_bt_sco_hid_only_busy(btcoexist, - BT_8821A_1ANT_WIFI_STATUS_CONNECTED_IDLE); - } else { - halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 8); - halbtc8821a1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 2); - } - } else { - if (BT_8821A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { - halbtc8821a1ant_action_wifi_connected_bt_acl_busy( - btcoexist, - BT_8821A_1ANT_WIFI_STATUS_CONNECTED_BUSY); - } else if ((BT_8821A_1ANT_BT_STATUS_SCO_BUSY == - coex_dm->bt_status) || - (BT_8821A_1ANT_BT_STATUS_ACL_SCO_BUSY == - coex_dm->bt_status)) { - halbtc8821a1ant_action_bt_sco_hid_only_busy(btcoexist, - BT_8821A_1ANT_WIFI_STATUS_CONNECTED_BUSY); - } else { - halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 8); - halbtc8821a1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 2); - } - } -} - -void halbtc8821a1ant_run_sw_coexist_mechanism(IN struct btc_coexist *btcoexist) -{ - u8 algorithm = 0; - - algorithm = halbtc8821a1ant_action_algorithm(btcoexist); - coex_dm->cur_algorithm = algorithm; - - if (halbtc8821a1ant_is_common_action(btcoexist)) { - - } else { - switch (coex_dm->cur_algorithm) { - case BT_8821A_1ANT_COEX_ALGO_SCO: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = SCO.\n"); - BTC_TRACE(trace_buf); - halbtc8821a1ant_action_sco(btcoexist); - break; - case BT_8821A_1ANT_COEX_ALGO_HID: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = HID.\n"); - BTC_TRACE(trace_buf); - halbtc8821a1ant_action_hid(btcoexist); - break; - case BT_8821A_1ANT_COEX_ALGO_A2DP: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = A2DP.\n"); - BTC_TRACE(trace_buf); - halbtc8821a1ant_action_a2dp(btcoexist); - break; - case BT_8821A_1ANT_COEX_ALGO_A2DP_PANHS: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = A2DP+PAN(HS).\n"); - BTC_TRACE(trace_buf); - halbtc8821a1ant_action_a2dp_pan_hs(btcoexist); - break; - case BT_8821A_1ANT_COEX_ALGO_PANEDR: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = PAN(EDR).\n"); - BTC_TRACE(trace_buf); - halbtc8821a1ant_action_pan_edr(btcoexist); - break; - case BT_8821A_1ANT_COEX_ALGO_PANHS: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = HS mode.\n"); - BTC_TRACE(trace_buf); - halbtc8821a1ant_action_pan_hs(btcoexist); - break; - case BT_8821A_1ANT_COEX_ALGO_PANEDR_A2DP: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = PAN+A2DP.\n"); - BTC_TRACE(trace_buf); - halbtc8821a1ant_action_pan_edr_a2dp(btcoexist); - break; - case BT_8821A_1ANT_COEX_ALGO_PANEDR_HID: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = PAN(EDR)+HID.\n"); - BTC_TRACE(trace_buf); - halbtc8821a1ant_action_pan_edr_hid(btcoexist); - break; - case BT_8821A_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); - halbtc8821a1ant_action_hid_a2dp_pan_edr( - btcoexist); - break; - case BT_8821A_1ANT_COEX_ALGO_HID_A2DP: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = HID+A2DP.\n"); - BTC_TRACE(trace_buf); - halbtc8821a1ant_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); - /* halbtc8821a1ant_coex_all_off(btcoexist); */ - break; - } - coex_dm->pre_algorithm = coex_dm->cur_algorithm; - } -} - -void halbtc8821a1ant_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; - u8 agg_buf_size = 5; - u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH; - u32 wifi_link_status = 0; - u32 num_of_wifi_link = 0; - 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; - } - - 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 (coex_sta->bt_whck_test) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is under WHCK TEST!!!\n"); - BTC_TRACE(trace_buf); - halbtc8821a1ant_action_bt_whck_test(btcoexist); - return; - } - - if ((BT_8821A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || - (BT_8821A_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || - (BT_8821A_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)) { - 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 (!bt_link_info->sco_exist && !bt_link_info->hid_exist) - halbtc8821a1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - else { - if (wifi_connected) { - wifi_rssi_state = halbtc8821a1ant_wifi_rssi_state( - btcoexist, 1, 2, 30, 0); - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - /* halbtc8821a1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, 1, 1); */ - halbtc8821a1ant_limited_tx(btcoexist, - NORMAL_EXEC, 1, 1, 0, 1); - } else { - /* halbtc8821a1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, 1, 1); */ - halbtc8821a1ant_limited_tx(btcoexist, - NORMAL_EXEC, 1, 1, 0, 1); - } - } else - halbtc8821a1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, - 0, 0); - - } - - if (bt_link_info->sco_exist) { - bt_ctrl_agg_buf_size = true; - agg_buf_size = 0x3; - } else if (bt_link_info->hid_exist) { - bt_ctrl_agg_buf_size = true; - agg_buf_size = 0x5; - } else if (bt_link_info->a2dp_exist || bt_link_info->pan_exist) { - bt_ctrl_agg_buf_size = true; - agg_buf_size = 0x8; - } - halbtc8821a1ant_limited_rx(btcoexist, NORMAL_EXEC, false, - bt_ctrl_agg_buf_size, agg_buf_size); - - 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); - return; - } else if (bt_hs_on) { - halbtc8821a1ant_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) - halbtc8821a1ant_action_wifi_not_connected_scan( - btcoexist); - else - halbtc8821a1ant_action_wifi_not_connected_asso_auth( - btcoexist); - } else - halbtc8821a1ant_action_wifi_not_connected(btcoexist); - } else /* wifi LPS/Busy */ - halbtc8821a1ant_action_wifi_connected(btcoexist); -} - -void halbtc8821a1ant_init_coex_dm(IN struct btc_coexist *btcoexist) -{ - /* force to reset coex mechanism */ - /* sw all off */ - halbtc8821a1ant_sw_mechanism(btcoexist, false); - - /* halbtc8821a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); */ - halbtc8821a1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); -} - -void halbtc8821a1ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean back_up, IN boolean wifi_only) -{ - u8 u8tmp = 0; - boolean wifi_under_5g = false; - - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], 1Ant Init HW Config!!\n"); - BTC_TRACE(trace_buf); - - if (wifi_only) - return; - - if (back_up) { - 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); - } - - /* 0x790[5:0]=0x5 */ - u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x790); - u8tmp &= 0xc0; - u8tmp |= 0x5; - btcoexist->btc_write_1byte(btcoexist, 0x790, u8tmp); - - 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, - false); - else - halbtc8821a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, true, - false); - - /* PTA parameter */ - halbtc8821a1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); - - /* 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); - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1); -} - -/* ************************************************************ - * work around function start with wa_halbtc8821a1ant_ - * ************************************************************ - * ************************************************************ - * extern function start with ex_halbtc8821a1ant_ - * ************************************************************ */ -void ex_halbtc8821a1ant_power_on_setting(IN struct btc_coexist *btcoexist) -{ -} - -void ex_halbtc8821a1ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean wifi_only) -{ - halbtc8821a1ant_init_hw_config(btcoexist, true, wifi_only); -} - -void ex_halbtc8821a1ant_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; - - halbtc8821a1ant_init_coex_dm(btcoexist); - - halbtc8821a1ant_query_bt_info(btcoexist); -} - -void ex_halbtc8821a1ant_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 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]============"); - 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); - } - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", - "Ant PG Num/ Ant Mech/ Ant Pos:", - board_info->pg_ant_num, board_info->btdm_ant_num, - board_info->btdm_ant_pos); - 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_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 ", - "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->bt_disabled) ? ("disabled") : (( - coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") - : ((BT_8821A_1ANT_BT_STATUS_NON_CONNECTED_IDLE == - coex_dm->bt_status) ? "non-connected idle" : - ((BT_8821A_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) - ? "connected-idle" : "busy")))), - coex_sta->bt_rssi, coex_sta->bt_retry_cnt); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", - "SCO/HID/PAN/A2DP", - bt_link_info->sco_exist, bt_link_info->hid_exist, - bt_link_info->pan_exist, bt_link_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_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_8821a_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 = %d", - "SM[LowPenaltyRA]", - coex_dm->cur_low_penalty_ra); - CL_PRINTF(cli_buf); - - 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 (auto:%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); - 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, 0xc58); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", - "0x778/ 0xc58[29:25]", - u8tmp[0], (u32tmp[0] & 0x3e000000) >> 25); - CL_PRINTF(cli_buf); - - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x8db); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x8db[6:5]", - ((u8tmp[0] & 0x60) >> 5)); - CL_PRINTF(cli_buf); - - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x975); - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xcb4); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", - "0xcb4[29:28]/0xcb4[7:0]/0x974[9:8]", - (u32tmp[0] & 0x30000000) >> 28, u32tmp[0] & 0xff, - u8tmp[0] & 0x3); - CL_PRINTF(cli_buf); - - - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x40); - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x4c); - 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", - "0x40/0x4c[24:23]/0x64[0]", - u8tmp[0], ((u32tmp[0] & 0x01800000) >> 23), u8tmp[1] & 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); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0xc50(dig)", - u32tmp[0] & 0xff); - 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_8821A_1ANT == 1) - halbtc8821a1ant_monitor_bt_ctr(btcoexist); -#endif - btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); -} - - -void ex_halbtc8821a1ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) -{ - 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_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; - - halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 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); */ - } 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; - - halbtc8821a1ant_init_hw_config(btcoexist, false, false); - halbtc8821a1ant_init_coex_dm(btcoexist); - halbtc8821a1ant_query_bt_info(btcoexist); - } -} - -void ex_halbtc8821a1ant_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_halbtc8821a1ant_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; - 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); - } -} - -/* 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) -{ - 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 || - 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], RunCoexistMechanism(), return for 5G <===\n"); - BTC_TRACE(trace_buf); - halbtc8821a1ant_coex_under_5g(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\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) { - 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; - } - - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - 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_ASSOCIATE_START == type) - halbtc8821a1ant_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 */ - halbtc8821a1ant_action_wifi_not_connected(btcoexist); - else - halbtc8821a1ant_action_wifi_connected(btcoexist); - } -} - -void ex_halbtc8821a1ant_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_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], RunCoexistMechanism(), return for 5G <===\n"); - BTC_TRACE(trace_buf); - halbtc8821a1ant_coex_under_5g(btcoexist); - return; - } - - 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); - coex_dm->arp_cnt = 0; - } - - /* 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_halbtc8821a1ant_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; - u8 agg_buf_size = 5; - boolean 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], RunCoexistMechanism(), return for 5G <===\n"); - BTC_TRACE(trace_buf); - halbtc8821a1ant_coex_under_5g(btcoexist); - return; - } - - if (BTC_PACKET_DHCP == type || - BTC_PACKET_EAPOL == type || - BTC_PACKET_ARP == type) { - coex_sta->wifi_is_high_pri_task = true; - - if (BTC_PACKET_ARP == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], specific Packet ARP notify\n"); - BTC_TRACE(trace_buf); - } else { - 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) { - 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; - } - - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - 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_PACKET_DHCP == type || - BTC_PACKET_EAPOL == type || - BTC_PACKET_ARP == type) { - if (BTC_PACKET_ARP == type) { - 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) /* if APR PKT > 10 after connect, do not go to ActionWifiConnectedSpecificPacket(btcoexist) */ - return; - } - - halbtc8821a1ant_action_wifi_connected_specific_packet( - btcoexist); - } -} - -void ex_halbtc8821a1ant_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_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_1ANT_MAX) - rsp_source = BT_INFO_SRC_8821A_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_8821A_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_info_c2h[rsp_source][2] & 0x20) - coex_sta->c2h_bt_page = true; - else - coex_sta->c2h_bt_page = false; - - 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]; - - 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 != 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); - } - - /* 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_halbtc8821a1ant_media_status_notify( - btcoexist, BTC_MEDIA_CONNECT); - else - ex_halbtc8821a1ant_media_status_notify( - btcoexist, BTC_MEDIA_DISCONNECT); - } - - if ((coex_sta->bt_info_ext & BIT(3)) && !wifi_under_5g) { - 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); - halbtc8821a1ant_ignore_wlan_act(btcoexist, - FORCE_EXEC, false); - } - } else { - /* BT already NOT ignore Wlan active, do nothing here. */ - } -#if (BT_AUTO_REPORT_ONLY_8821A_1ANT == 0) - if ((coex_sta->bt_info_ext & BIT(4))) { - /* BT auto report already enabled, do nothing */ - } else - halbtc8821a1ant_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_8821A_1ANT_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_8821A_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 (bt_info & BT_INFO_8821A_1ANT_B_FTP) - coex_sta->pan_exist = true; - else - coex_sta->pan_exist = false; - if (bt_info & BT_INFO_8821A_1ANT_B_A2DP) - coex_sta->a2dp_exist = true; - else - coex_sta->a2dp_exist = false; - if (bt_info & BT_INFO_8821A_1ANT_B_HID) - coex_sta->hid_exist = true; - else - coex_sta->hid_exist = false; - if (bt_info & BT_INFO_8821A_1ANT_B_SCO_ESCO) - coex_sta->sco_exist = true; - else - coex_sta->sco_exist = false; - } - - halbtc8821a1ant_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_8821A_1ANT_B_CONNECTION)) { - coex_dm->bt_status = BT_8821A_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_8821A_1ANT_B_CONNECTION) { /* connection exists but no busy */ - coex_dm->bt_status = BT_8821A_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_8821A_1ANT_B_SCO_ESCO) || - (bt_info & BT_INFO_8821A_1ANT_B_SCO_BUSY)) { - coex_dm->bt_status = BT_8821A_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_8821A_1ANT_B_ACL_BUSY) { - if (BT_8821A_1ANT_BT_STATUS_ACL_BUSY != coex_dm->bt_status) - coex_dm->auto_tdma_adjust = false; - coex_dm->bt_status = BT_8821A_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_8821A_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_8821A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || - (BT_8821A_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || - (BT_8821A_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); - - halbtc8821a1ant_run_coexist_mechanism(btcoexist); -} - -void ex_halbtc8821a1ant_halt_notify(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) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], RunCoexistMechanism(), return for 5G <===\n"); - BTC_TRACE(trace_buf); - halbtc8821a1ant_coex_under_5g(btcoexist); - return; - } - - 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); */ - - halbtc8821a1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); - - ex_halbtc8821a1ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); - - btcoexist->stop_coex_dm = true; -} - -void ex_halbtc8821a1ant_pnp_notify(IN struct btc_coexist *btcoexist, - IN u8 pnp_state) -{ - boolean wifi_under_5g = false; - - 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; - } - 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); - - 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, - true); - /* halbtc8821a1ant_set_ant_path_d_cut(btcoexist, false, false, false, BTC_ANT_PATH_BT, BTC_WIFI_STAT_NORMAL_OFF); */ - - /* 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; - halbtc8821a1ant_init_hw_config(btcoexist, false, false); - halbtc8821a1ant_init_coex_dm(btcoexist); - halbtc8821a1ant_query_bt_info(btcoexist); - } -} - -void ex_halbtc8821a1ant_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)) - coex_sta->bt_coex_supported_version = - btcoexist->btc_get_bt_coex_supported_version(btcoexist); - -#if (BT_AUTO_REPORT_ONLY_8821A_1ANT == 0) - halbtc8821a1ant_query_bt_info(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) */ - /* { */ - halbtc8821a1ant_run_coexist_mechanism(btcoexist); - /* } */ - } - - coex_sta->specific_pkt_period_cnt++; -#endif -} - -#endif - -#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ - - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8821a1ant.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8821a1ant.h deleted file mode 100644 index 75e6f708047f..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8821a1ant.h +++ /dev/null @@ -1,215 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ - -#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) - -#if (RTL8821A_SUPPORT == 1) - -/* ******************************************* - * The following is for 8821A 1ANT BT Co-exist definition - * ******************************************* */ -#define BT_AUTO_REPORT_ONLY_8821A_1ANT 1 - -#define BT_INFO_8821A_1ANT_B_FTP BIT(7) -#define BT_INFO_8821A_1ANT_B_A2DP BIT(6) -#define BT_INFO_8821A_1ANT_B_HID BIT(5) -#define BT_INFO_8821A_1ANT_B_SCO_BUSY BIT(4) -#define BT_INFO_8821A_1ANT_B_ACL_BUSY BIT(3) -#define BT_INFO_8821A_1ANT_B_INQ_PAGE BIT(2) -#define BT_INFO_8821A_1ANT_B_SCO_ESCO BIT(1) -#define BT_INFO_8821A_1ANT_B_CONNECTION BIT(0) - -#define BT_INFO_8821A_1ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ - (((_BT_INFO_EXT_&BIT(0))) ? true : false) - -#define BTC_RSSI_COEX_THRESH_TOL_8821A_1ANT 2 - -enum bt_info_src_8821a_1ant { - BT_INFO_SRC_8821A_1ANT_WIFI_FW = 0x0, - BT_INFO_SRC_8821A_1ANT_BT_RSP = 0x1, - BT_INFO_SRC_8821A_1ANT_BT_ACTIVE_SEND = 0x2, - BT_INFO_SRC_8821A_1ANT_MAX -}; - -enum bt_8821a_1ant_bt_status { - BT_8821A_1ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, - BT_8821A_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, - BT_8821A_1ANT_BT_STATUS_INQ_PAGE = 0x2, - BT_8821A_1ANT_BT_STATUS_ACL_BUSY = 0x3, - BT_8821A_1ANT_BT_STATUS_SCO_BUSY = 0x4, - BT_8821A_1ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, - BT_8821A_1ANT_BT_STATUS_MAX -}; - -enum bt_8821a_1ant_wifi_status { - BT_8821A_1ANT_WIFI_STATUS_NON_CONNECTED_IDLE = 0x0, - BT_8821A_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN = 0x1, - BT_8821A_1ANT_WIFI_STATUS_CONNECTED_SCAN = 0x2, - BT_8821A_1ANT_WIFI_STATUS_CONNECTED_SPECIFIC_PKT = 0x3, - BT_8821A_1ANT_WIFI_STATUS_CONNECTED_IDLE = 0x4, - BT_8821A_1ANT_WIFI_STATUS_CONNECTED_BUSY = 0x5, - BT_8821A_1ANT_WIFI_STATUS_MAX -}; - -enum bt_8821a_1ant_coex_algo { - BT_8821A_1ANT_COEX_ALGO_UNDEFINED = 0x0, - BT_8821A_1ANT_COEX_ALGO_SCO = 0x1, - BT_8821A_1ANT_COEX_ALGO_HID = 0x2, - BT_8821A_1ANT_COEX_ALGO_A2DP = 0x3, - BT_8821A_1ANT_COEX_ALGO_A2DP_PANHS = 0x4, - BT_8821A_1ANT_COEX_ALGO_PANEDR = 0x5, - BT_8821A_1ANT_COEX_ALGO_PANHS = 0x6, - BT_8821A_1ANT_COEX_ALGO_PANEDR_A2DP = 0x7, - BT_8821A_1ANT_COEX_ALGO_PANEDR_HID = 0x8, - BT_8821A_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, - BT_8821A_1ANT_COEX_ALGO_HID_A2DP = 0xa, - BT_8821A_1ANT_COEX_ALGO_MAX = 0xb, -}; - -struct coex_dm_8821a_1ant { - /* 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 pre_algorithm; - u8 cur_algorithm; - 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_8821a_1ant { - 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 specific_pkt_period_cnt; - u32 high_priority_tx; - 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]; - boolean c2h_bt_info_req_sent; - u8 bt_info_c2h[BT_INFO_SRC_8821A_1ANT_MAX][10]; - u32 bt_info_c2h_cnt[BT_INFO_SRC_8821A_1ANT_MAX]; - 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; - u8 bt_info_ext; - boolean bt_whck_test; /* Add for ASUS WHQL TEST that enable wifi test bt */ -}; - -/* ******************************************* - * The following is interface which will notify coex module. - * ******************************************* */ -void ex_halbtc8821a1ant_power_on_setting(IN struct btc_coexist *btcoexist); -void ex_halbtc8821a1ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean wifi_only); -void ex_halbtc8821a1ant_init_coex_dm(IN struct btc_coexist *btcoexist); -void ex_halbtc8821a1ant_ips_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -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, - IN u8 type); -void ex_halbtc8821a1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8821a1ant_bt_info_notify(IN struct btc_coexist *btcoexist, - IN u8 *tmp_buf, IN u8 length); -void ex_halbtc8821a1ant_halt_notify(IN struct btc_coexist *btcoexist); -void ex_halbtc8821a1ant_pnp_notify(IN struct btc_coexist *btcoexist, - IN u8 pnp_state); -void ex_halbtc8821a1ant_periodical(IN struct btc_coexist *btcoexist); -void ex_halbtc8821a1ant_display_coex_info(IN struct btc_coexist *btcoexist); - -#else -#define ex_halbtc8821a1ant_power_on_setting(btcoexist) -#define ex_halbtc8821a1ant_init_hw_config(btcoexist, wifi_only) -#define ex_halbtc8821a1ant_init_coex_dm(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) -#define ex_halbtc8821a1ant_bt_info_notify(btcoexist, tmp_buf, length) -#define ex_halbtc8821a1ant_halt_notify(btcoexist) -#define ex_halbtc8821a1ant_pnp_notify(btcoexist, pnp_state) -#define ex_halbtc8821a1ant_periodical(btcoexist) -#define ex_halbtc8821a1ant_display_coex_info(btcoexist) - -#endif - -#endif - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8821a2ant.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8821a2ant.c deleted file mode 100644 index 0ca35add2367..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8821a2ant.c +++ /dev/null @@ -1,4638 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ -/* ************************************************************ - * Description: - * - * This file is for RTL8821A 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 (RTL8821A_SUPPORT == 1) -/* ************************************************************ - * Global variables, these are static variables - * ************************************************************ */ -static u8 *trace_buf = &gl_btc_trace_buf[0]; -static struct coex_dm_8821a_2ant glcoex_dm_8821a_2ant; -static struct coex_dm_8821a_2ant *coex_dm = &glcoex_dm_8821a_2ant; -static struct coex_sta_8821a_2ant glcoex_sta_8821a_2ant; -static struct coex_sta_8821a_2ant *coex_sta = &glcoex_sta_8821a_2ant; - -const char *const glbt_info_src_8821a_2ant[] = { - "BT Info[wifi fw]", - "BT Info[bt rsp]", - "BT Info[bt auto report]", -}; - -u32 glcoex_ver_date_8821a_2ant = 20160816; -u32 glcoex_ver_8821a_2ant = 0x5d; -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_ - * ************************************************************ - * local function proto type if needed - * ************************************************************ - * ************************************************************ - * local function start with halbtc8821a2ant_ - * ************************************************************ */ -u8 halbtc8821a2ant_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_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_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_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 halbtc8821a2ant_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_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_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_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 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_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 halbtc8821a2ant_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_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 halbtc8821a2ant_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 halbtc8821a2ant_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 halbtc8821a2ant_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; - 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 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 3, - 2, BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); - - if ((BTC_RSSI_STATE_HIGH == wifi_rssi_state) || - (BTC_RSSI_STATE_LOW == wifi_rssi_state)) - return true; - - } - - return false; -} - -void halbtc8821a2ant_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 halbtc8821a2ant_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_8821A_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_8821A_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_8821A_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_8821A_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_8821A_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_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_8821A_2ANT_COEX_ALGO_SCO; - } 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_8821A_2ANT_COEX_ALGO_SCO; - } 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_8821A_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_2ANT_COEX_ALGO_SCO; - } - } - } 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_8821A_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_8821A_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_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_8821A_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_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 ==> SCO\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; - } 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) ==> SCO\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCO + HID + PAN(EDR) ==> SCO\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; - } - } 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_8821A_2ANT_COEX_ALGO_SCO; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8821A_2ANT_COEX_ALGO_SCO; - } - } - } 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_8821A_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_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_8821A_2ANT_COEX_ALGO_SCO; - } - } - } - } - - return algorithm; -} - -void halbtc8821a2ant_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 halbtc8821a2ant_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 halbtc8821a2ant_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; - } - halbtc8821a2ant_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 halbtc8821a2ant_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 halbtc8821a2ant_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; - } - halbtc8821a2ant_set_bt_auto_report(btcoexist, - coex_dm->cur_bt_auto_report); - - coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; -} - -void halbtc8821a2ant_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; - } - - halbtc8821a2ant_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 halbtc8821a2ant_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 halbtc8821a2ant_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; - } - halbtc8821a2ant_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 halbtc8821a2ant_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] = 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 */ - } - - btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); -} - -void halbtc8821a2ant_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; - } - halbtc8821a2ant_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 halbtc8821a2ant_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 halbtc8821a2ant_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) - halbtc8821a2ant_set_dac_swing_reg(btcoexist, sw_dac_swing_lvl); - else - halbtc8821a2ant_set_dac_swing_reg(btcoexist, 0x18); -} - - -void halbtc8821a2ant_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); - halbtc8821a2ant_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 halbtc8821a2ant_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 halbtc8821a2ant_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; - } - halbtc8821a2ant_set_adc_back_off(btcoexist, coex_dm->cur_adc_back_off); - - coex_dm->pre_adc_back_off = coex_dm->cur_adc_back_off; -} - -void halbtc8821a2ant_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 halbtc8821a2ant_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; - } - halbtc8821a2ant_set_agc_table(btcoexist, agc_table_en); - - coex_dm->pre_agc_table_en = coex_dm->cur_agc_table_en; -} - -void halbtc8821a2ant_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 halbtc8821a2ant_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; - } - halbtc8821a2ant_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 halbtc8821a2ant_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: - halbtc8821a2ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x55555555, 0xffffff, 0x3); - break; - case 1: - halbtc8821a2ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x5afa5afa, 0xffffff, 0x3); - break; - case 2: - halbtc8821a2ant_coex_table(btcoexist, force_exec, - 0x5ada5ada, 0x5ada5ada, 0xffffff, 0x3); - break; - case 3: - halbtc8821a2ant_coex_table(btcoexist, force_exec, - 0xaaaaaaaa, 0xaaaaaaaa, 0xffffff, 0x3); - break; - case 4: - halbtc8821a2ant_coex_table(btcoexist, force_exec, - 0xffffffff, 0xffffffff, 0xffffff, 0x3); - break; - case 5: - halbtc8821a2ant_coex_table(btcoexist, force_exec, - 0x5fff5fff, 0x5fff5fff, 0xffffff, 0x3); - break; - case 6: - halbtc8821a2ant_coex_table(btcoexist, force_exec, - 0x55ff55ff, 0x5a5a5a5a, 0xffffff, 0x3); - break; - case 7: - halbtc8821a2ant_coex_table(btcoexist, force_exec, - 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); - break; - case 8: - halbtc8821a2ant_coex_table(btcoexist, force_exec, - 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); - break; - case 9: - halbtc8821a2ant_coex_table(btcoexist, force_exec, - 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); - break; - case 10: - halbtc8821a2ant_coex_table(btcoexist, force_exec, - 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); - break; - case 11: - halbtc8821a2ant_coex_table(btcoexist, force_exec, - 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); - break; - case 12: - halbtc8821a2ant_coex_table(btcoexist, force_exec, - 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); - break; - case 13: - halbtc8821a2ant_coex_table(btcoexist, force_exec, - 0x5fff5fff, 0xaaaaaaaa, 0xffffff, 0x3); - break; - case 14: - halbtc8821a2ant_coex_table(btcoexist, force_exec, - 0x5fff5fff, 0x5ada5ada, 0xffffff, 0x3); - break; - case 15: - halbtc8821a2ant_coex_table(btcoexist, force_exec, - 0x55dd55dd, 0xaaaaaaaa, 0xffffff, 0x3); - break; - case 16: - halbtc8821a2ant_coex_table(btcoexist, force_exec, - 0x5fdf5fdf, 0x5fdb5fdb, 0xffffff, 0x3); - break; - case 17: - 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; - } -} - -void halbtc8821a2ant_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 halbtc8821a2ant_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 halbtc8821a2ant_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; - } - halbtc8821a2ant_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 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_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}; - - 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 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) -{ - u8 wifi_rssi_state1, bt_rssi_state; - - - wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, - BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); - bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, - BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); - - if (!(BTC_RSSI_HIGH(wifi_rssi_state1) && - BTC_RSSI_HIGH(bt_rssi_state)) && turn_on) { - type = type + 100; /* for WiFi RSSI low or BT RSSI low */ - } - - 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: - /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x90); */ - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x3c, 0x03, 0xf1, 0x90); - break; - case 2: - /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x12, 0x12, 0xe1, 0x90); */ - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x2d, 0x03, 0xf1, 0x90); - break; - case 3: - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x1c, 0x3, 0xf1, 0x90); - break; - case 4: - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x10, 0x03, 0xf1, 0x90); - break; - case 5: - /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x1a, 0x1a, 0x60, 0x90); */ - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x3c, 0x3, 0x70, 0x90); - break; - case 6: - /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x12, 0x12, 0x60, 0x90); */ - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x2d, 0x3, 0x70, 0x90); - break; - case 7: - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x1c, 0x3, 0x70, 0x90); - break; - case 8: - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xa3, - 0x10, 0x3, 0x70, 0x90); - break; - case 9: - /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x90); */ - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x3c, 0x03, 0xf1, 0x90); - break; - case 10: - /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x12, 0x12, 0xe1, 0x90); */ - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x2d, 0x03, 0xf1, 0x90); - break; - case 11: - /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0xa, 0xa, 0xe1, 0x90); */ - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x1c, 0x3, 0xf1, 0x90); - break; - case 12: - /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x5, 0x5, 0xe1, 0x90); */ - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x10, 0x3, 0xf1, 0x90); - break; - case 13: - /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x1a, 0x1a, 0x60, 0x90); */ - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x3c, 0x3, 0x70, 0x90); - break; - case 14: - /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x12, 0x12, 0x60, 0x90); */ - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x2d, 0x3, 0x70, 0x90); - break; - case 15: - /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0xa, 0xa, 0x60, 0x90); */ - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x1c, 0x3, 0x70, 0x90); - break; - case 16: - /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x5, 0x5, 0x60, 0x90); */ - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x10, 0x3, 0x70, 0x90); - break; - case 17: - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xa3, - 0x2f, 0x2f, 0x60, 0x90); - break; - case 18: - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x5, 0x5, 0xe1, 0x90); - break; - case 19: - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x25, 0x25, 0xe1, 0x90); - break; - case 20: - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x25, 0x25, 0x60, 0x90); - break; - case 21: - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x15, 0x03, 0x70, 0x90); - break; - case 23: - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x1e, 0x03, 0xf0, 0x14); - break; - case 24: - case 124: - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x3c, 0x03, 0x70, 0x50); - break; - /* case25/case125 : for lenovo bt pan tp degrade<30% while wifi downlink */ - case 25: - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x14, 0x03, 0xf1, 0x90); - break; - case 26: - 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, 0xd3, - 0x1e, 0x03, 0x70, 0x50); - break; - case 71: - /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x90); */ - - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x3c, 0x03, 0xf1, 0x90); - break; - case 101: - case 105: - case 171: - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x3a, 0x03, 0x70, 0x50); - break; - case 102: - case 106: - case 110: - case 114: - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x2d, 0x03, 0x70, 0x50); - break; - case 103: - case 107: - case 111: - case 115: - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x1c, 0x03, 0x70, 0x50); - break; - case 104: - case 108: - case 112: - case 116: - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x10, 0x03, 0x70, 0x50); - break; - case 109: - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x3c, 0x03, 0xf1, 0x90); - break; - case 113: - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x3c, 0x03, 0x70, 0x90); - break; - case 121: - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x15, 0x03, 0x70, 0x90); - break; - case 22: - case 122: - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x35, 0x03, 0x71, 0x11); - break; - case 123: - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x1c, 0x03, 0x70, 0x54); - break; - /* case25/case125 : for lenovo bt pan tp degrade<30% while wifi downlink */ - case 125: - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x14, 0x03, 0x70, 0x50); - break; - case 126: - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x30, 0x03, 0x70, 0x50); - break; - case 127: - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x28, 0x03, 0x70, 0x50); - break; - } - } else { - /* disable PS tdma */ - switch (type) { - case 0: - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0x0, - 0x0, 0x0, 0x40, 0x0); - break; - case 1: - halbtc8821a2ant_set_fw_pstdma(btcoexist, 0x0, - 0x0, 0x0, 0x48, 0x0); - break; - default: - halbtc8821a2ant_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 halbtc8821a2ant_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 */ - 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. */ - } - } -} - -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_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); - - /* sw all off */ - halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); - - /* hw all off */ - /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); */ - halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -} - -void halbtc8821a2ant_coex_under_5g(IN struct btc_coexist *btcoexist) -{ - halbtc8821a2ant_coex_all_off(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; - boolean wifi_connected = false; - boolean low_pwr_disable = true; - boolean scan = false, link = false, roam = false; - - - wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, - 0); - wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, - BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); - bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, - BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 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); - - - 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, - 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, - 7); - halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi no-link + BT Inq/Page!!\n"); - BTC_TRACE(trace_buf); - halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); - } - - halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 6); - halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); - -} - - -void halbtc8821a2ant_action_wifi_link_process(IN struct btc_coexist *btcoexist) -{ - u8 u8tmpa, u8tmpb; - - 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); - halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); - - - - u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765); - u8tmpb = btcoexist->btc_read_1byte(btcoexist, 0x76e); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "############# [BTCoex], 0x765=0x%x, 0x76e=0x%x\n", u8tmpa, - u8tmpb); - BTC_TRACE(trace_buf); -} - -boolean halbtc8821a2ant_action_wifi_idle_process(IN struct btc_coexist - *btcoexist) -{ - u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; - u8 ap_num = 0; - - wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, - 0); - /* wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); */ - wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, - BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES - 20, 0); - bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, - BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 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); - - halbtc8821a2ant_dac_swing(btcoexist, NORMAL_EXEC, true, 0x6); - halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - /* sw all off */ - halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, false, - false); - halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, false, - 0x18); - - 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, - "[BTCoex], Wifi idle process for BT PAN exist!!\n"); - BTC_TRACE(trace_buf); - - halbtc8821a2ant_dac_swing(btcoexist, NORMAL_EXEC, true, 0x6); - halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - /* sw all off */ - halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, false, - false); - halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, false, - 0x18); - - 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 { - halbtc8821a2ant_dac_swing(btcoexist, NORMAL_EXEC, true, 0x18); - return false; - } - - -} - - - -boolean halbtc8821a2ant_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; - - 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); - halbtc8821a2ant_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); - 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); - - halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, false, - false); - halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, false, - 0x18); - - common = true; - } else { - if (BT_8821A_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); - halbtc8821a2ant_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); - 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, - false); - halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - - common = true; - } else if (BT_8821A_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); - halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, - false, false, 0x8); - - 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); - halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, - 0xb); - halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8821a2ant_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); - common = false; - /* common = halbtc8821a2ant_action_wifi_idle_process(btcoexist); */ - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi Connected-Idle + BT Busy!!\n"); - BTC_TRACE(trace_buf); - /* common = false; */ - common = halbtc8821a2ant_action_wifi_idle_process( - btcoexist); - } - } - } - - return common; -} -void halbtc8821a2ant_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) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 13); - coex_dm->ps_tdma_du_adj_type = - 13; - } else if (max_interval == 2) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 14); - coex_dm->ps_tdma_du_adj_type = - 14; - } else if (max_interval == 3) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } - } else { - if (max_interval == 1) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 9); - coex_dm->ps_tdma_du_adj_type = - 9; - } else if (max_interval == 2) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 10); - coex_dm->ps_tdma_du_adj_type = - 10; - } else if (max_interval == 3) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } - } - } else { - if (tx_pause) { - if (max_interval == 1) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 5); - coex_dm->ps_tdma_du_adj_type = - 5; - } else if (max_interval == 2) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 6); - coex_dm->ps_tdma_du_adj_type = - 6; - } else if (max_interval == 3) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } - } else { - if (max_interval == 1) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 1); - coex_dm->ps_tdma_du_adj_type = - 1; - } else if (max_interval == 2) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = - 2; - } else if (max_interval == 3) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else { - halbtc8821a2ant_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; - 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) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 5); - coex_dm->ps_tdma_du_adj_type = 5; - } else if (coex_dm->cur_ps_tdma == 1) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 5); - coex_dm->ps_tdma_du_adj_type = 5; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 6); - coex_dm->ps_tdma_du_adj_type = 6; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 7); - coex_dm->ps_tdma_du_adj_type = 7; - } else if (coex_dm->cur_ps_tdma == 4) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 8); - coex_dm->ps_tdma_du_adj_type = 8; - } - if (coex_dm->cur_ps_tdma == 9) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 13); - coex_dm->ps_tdma_du_adj_type = 13; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 14); - coex_dm->ps_tdma_du_adj_type = 14; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 15); - coex_dm->ps_tdma_du_adj_type = 15; - } else if (coex_dm->cur_ps_tdma == 12) { - halbtc8821a2ant_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) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 6); - coex_dm->ps_tdma_du_adj_type = - 6; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 8); - coex_dm->ps_tdma_du_adj_type = - 8; - } else if (coex_dm->cur_ps_tdma == 13) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 14); - coex_dm->ps_tdma_du_adj_type = - 14; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8821a2ant_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) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 6); - coex_dm->ps_tdma_du_adj_type = - 6; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 5); - coex_dm->ps_tdma_du_adj_type = - 5; - } else if (coex_dm->cur_ps_tdma == 16) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 14); - coex_dm->ps_tdma_du_adj_type = - 14; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 13); - coex_dm->ps_tdma_du_adj_type = - 13; - } - } - } else { - if (coex_dm->cur_ps_tdma == 5) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 71); - coex_dm->ps_tdma_du_adj_type = 71; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 2); - coex_dm->ps_tdma_du_adj_type = 2; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 3); - coex_dm->ps_tdma_du_adj_type = 3; - } else if (coex_dm->cur_ps_tdma == 8) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 4); - coex_dm->ps_tdma_du_adj_type = 4; - } - if (coex_dm->cur_ps_tdma == 13) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 9); - coex_dm->ps_tdma_du_adj_type = 9; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 10); - coex_dm->ps_tdma_du_adj_type = 10; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 11); - coex_dm->ps_tdma_du_adj_type = 11; - } else if (coex_dm->cur_ps_tdma == 16) { - halbtc8821a2ant_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) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 1); - coex_dm->ps_tdma_du_adj_type = - 1; - } else if (coex_dm->cur_ps_tdma == 1) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = - 2; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 4); - coex_dm->ps_tdma_du_adj_type = - 4; - } else if (coex_dm->cur_ps_tdma == 9) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 10); - coex_dm->ps_tdma_du_adj_type = - 10; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8821a2ant_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) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = - 2; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 1); - coex_dm->ps_tdma_du_adj_type = - 1; - } else if (coex_dm->cur_ps_tdma == 1) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 71); - coex_dm->ps_tdma_du_adj_type = - 71; - } else if (coex_dm->cur_ps_tdma == 12) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 10); - coex_dm->ps_tdma_du_adj_type = - 10; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8821a2ant_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) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 6); - coex_dm->ps_tdma_du_adj_type = 6; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 6); - coex_dm->ps_tdma_du_adj_type = 6; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 7); - coex_dm->ps_tdma_du_adj_type = 7; - } else if (coex_dm->cur_ps_tdma == 4) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 8); - coex_dm->ps_tdma_du_adj_type = 8; - } - if (coex_dm->cur_ps_tdma == 9) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 14); - coex_dm->ps_tdma_du_adj_type = 14; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 14); - coex_dm->ps_tdma_du_adj_type = 14; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 15); - coex_dm->ps_tdma_du_adj_type = 15; - } else if (coex_dm->cur_ps_tdma == 12) { - halbtc8821a2ant_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) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 6); - coex_dm->ps_tdma_du_adj_type = - 6; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 8); - coex_dm->ps_tdma_du_adj_type = - 8; - } else if (coex_dm->cur_ps_tdma == 13) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 14); - coex_dm->ps_tdma_du_adj_type = - 14; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8821a2ant_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) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 6); - coex_dm->ps_tdma_du_adj_type = - 6; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 6); - coex_dm->ps_tdma_du_adj_type = - 6; - } else if (coex_dm->cur_ps_tdma == 16) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 14); - coex_dm->ps_tdma_du_adj_type = - 14; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 14); - coex_dm->ps_tdma_du_adj_type = - 14; - } - } - } else { - if (coex_dm->cur_ps_tdma == 5) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 2); - coex_dm->ps_tdma_du_adj_type = 2; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 2); - coex_dm->ps_tdma_du_adj_type = 2; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 3); - coex_dm->ps_tdma_du_adj_type = 3; - } else if (coex_dm->cur_ps_tdma == 8) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 4); - coex_dm->ps_tdma_du_adj_type = 4; - } - if (coex_dm->cur_ps_tdma == 13) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 10); - coex_dm->ps_tdma_du_adj_type = 10; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 10); - coex_dm->ps_tdma_du_adj_type = 10; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 11); - coex_dm->ps_tdma_du_adj_type = 11; - } else if (coex_dm->cur_ps_tdma == 16) { - halbtc8821a2ant_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) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = - 2; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 4); - coex_dm->ps_tdma_du_adj_type = - 4; - } else if (coex_dm->cur_ps_tdma == 9) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 10); - coex_dm->ps_tdma_du_adj_type = - 10; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8821a2ant_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) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = - 2; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = - 2; - } else if (coex_dm->cur_ps_tdma == 12) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 10); - coex_dm->ps_tdma_du_adj_type = - 10; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8821a2ant_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) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 7); - coex_dm->ps_tdma_du_adj_type = 7; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 7); - coex_dm->ps_tdma_du_adj_type = 7; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 7); - coex_dm->ps_tdma_du_adj_type = 7; - } else if (coex_dm->cur_ps_tdma == 4) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 8); - coex_dm->ps_tdma_du_adj_type = 8; - } - if (coex_dm->cur_ps_tdma == 9) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 15); - coex_dm->ps_tdma_du_adj_type = 15; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 15); - coex_dm->ps_tdma_du_adj_type = 15; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 15); - coex_dm->ps_tdma_du_adj_type = 15; - } else if (coex_dm->cur_ps_tdma == 12) { - halbtc8821a2ant_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) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 8); - coex_dm->ps_tdma_du_adj_type = - 8; - } else if (coex_dm->cur_ps_tdma == 13) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8821a2ant_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) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 16) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } - } - } else { - if (coex_dm->cur_ps_tdma == 5) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 3); - coex_dm->ps_tdma_du_adj_type = 3; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 3); - coex_dm->ps_tdma_du_adj_type = 3; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 3); - coex_dm->ps_tdma_du_adj_type = 3; - } else if (coex_dm->cur_ps_tdma == 8) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 4); - coex_dm->ps_tdma_du_adj_type = 4; - } - if (coex_dm->cur_ps_tdma == 13) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 11); - coex_dm->ps_tdma_du_adj_type = 11; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 11); - coex_dm->ps_tdma_du_adj_type = 11; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8821a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 11); - coex_dm->ps_tdma_du_adj_type = 11; - } else if (coex_dm->cur_ps_tdma == 16) { - halbtc8821a2ant_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) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 4); - coex_dm->ps_tdma_du_adj_type = - 4; - } else if (coex_dm->cur_ps_tdma == 9) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8821a2ant_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) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 12) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8821a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8821a2ant_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) - halbtc8821a2ant_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 halbtc8821a2ant_action_sco(IN struct btc_coexist *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - u8 wifi_rssi_state, bt_rssi_state; - u32 wifi_bw; - - wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, - 0); - bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, - BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); - - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); - - halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); - - halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 4); - - if (BTC_RSSI_HIGH(bt_rssi_state)) - halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - else - halbtc8821a2ant_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 */ - halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - else { /* for SCO quality & wifi performance balance at 11n mode */ - if (BTC_WIFI_BW_HT40 == wifi_bw) - halbtc8821a2ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 8); - else { - if (bt_link_info->sco_only) - halbtc8821a2ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 17); - else - halbtc8821a2ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 12); - } - } - - halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - halbtc8821a2ant_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)) { - halbtc8821a2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, - true, 0x18); - } else { - halbtc8821a2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, - true, 0x18); - } - } else { - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8821a2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, - true, 0x18); - } else { - halbtc8821a2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, - true, 0x18); - } - } -} - - -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, - BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); - - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); - - halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); - - halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - - if (BTC_RSSI_HIGH(bt_rssi_state)) - halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - else - halbtc8821a2ant_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 */ - halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); - 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 */ - if (BTC_WIFI_BW_HT40 == wifi_bw) { - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8821a2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8821a2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } else { - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8821a2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8821a2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } -} - -/* A2DP only / PAN(EDR) only/ A2DP+PAN(HS) */ -void halbtc8821a2ant_action_a2dp(IN struct btc_coexist *btcoexist) -{ - u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; - u32 wifi_bw; - u8 ap_num = 0; - - wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, - 0); - wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, - BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); - bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, - BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 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); */ - halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, - 0x0); - halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, - 0x8); - halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - - 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); - - /* sw mechanism */ - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - if (BTC_WIFI_BW_HT40 == wifi_bw) { - halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, - true, 0x6); - } else { - halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, - true, 0x6); - } - return; - - } - - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); - halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); - - halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - - if (BTC_RSSI_HIGH(bt_rssi_state)) - halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - 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); */ - halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 23); - } else { - /* halbtc8821a2ant_tdma_duration_adjust(btcoexist, false, true, 1); */ - halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 23); - } - - /* 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)) { - halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } else { - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } -} - -void halbtc8821a2ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) -{ - u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; - u32 wifi_bw; - - wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, - 0); - wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, - BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); - bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, - BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); - - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); - - halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); - - halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - - if (BTC_RSSI_HIGH(bt_rssi_state)) - halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - 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); - } - - halbtc8821a2ant_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)) { - halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } else { - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } -} - -void halbtc8821a2ant_action_pan_edr(IN struct btc_coexist *btcoexist) -{ - u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; - u32 wifi_bw; - - wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, - 0); - wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, - BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); - bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, - BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); - - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); - - halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); - - halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - - if (BTC_RSSI_HIGH(bt_rssi_state)) - halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - 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, - 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) || - (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) - halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 26); - else - halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 26); - - /* 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)) { - halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } else { - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } -} - - -/* PAN(HS) only */ -void halbtc8821a2ant_action_pan_hs(IN struct btc_coexist *btcoexist) -{ - u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; - u32 wifi_bw; - - wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, - 0); - wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, - BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); - bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, - BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); - - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); - - halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); - - halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - - if (BTC_RSSI_HIGH(bt_rssi_state)) - halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - else - halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - 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); - if (BTC_WIFI_BW_HT40 == wifi_bw) { - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } else { - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } -} - -/* PAN(EDR)+A2DP */ -void halbtc8821a2ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist) -{ - u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; - u32 wifi_bw; - - wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, - 0); - wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, - BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); - bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, - BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); - - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); - - halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); - - halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - - if (BTC_RSSI_HIGH(bt_rssi_state)) - halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - 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) || - (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 12); - - if (BTC_WIFI_BW_HT40 == wifi_bw) - halbtc8821a2ant_tdma_duration_adjust(btcoexist, false, - true, 3); - else - halbtc8821a2ant_tdma_duration_adjust(btcoexist, false, - false, 3); - } else { - halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 13); - halbtc8821a2ant_tdma_duration_adjust(btcoexist, false, 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)) { - halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8821a2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } else { - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } -} - -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, - BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); - bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, - BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - - halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); - - if (BTC_RSSI_HIGH(bt_rssi_state)) - halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - 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, - 14); - 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)) { - if (BTC_WIFI_BW_HT40 == wifi_bw) { - halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, - 3); - /* halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 11); */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, - 0xfffff, 0x780); - } else { - halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, - 6); - /* halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, - 0xfffff, 0x0); - } - halbtc8821a2ant_tdma_duration_adjust(btcoexist, true, false, 2); - } else { - halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - /* halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 14); */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, - 0x0); - halbtc8821a2ant_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)) { - halbtc8821a2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8821a2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } else { - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8821a2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8821a2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } -} - -/* HID+A2DP+PAN(EDR) */ -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, - BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); - bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, - BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 0); - - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); - - halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); - - halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - - if (BTC_RSSI_HIGH(bt_rssi_state)) - halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - 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, - 14); - 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) || - (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - if (BTC_WIFI_BW_HT40 == wifi_bw) - halbtc8821a2ant_tdma_duration_adjust(btcoexist, true, - true, 3); - else - halbtc8821a2ant_tdma_duration_adjust(btcoexist, true, - false, 3); - } else - halbtc8821a2ant_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)) { - halbtc8821a2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8821a2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } else { - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8821a2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8821a2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } -} - -void halbtc8821a2ant_action_hid_a2dp(IN struct btc_coexist *btcoexist) -{ - 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, 25); - - wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, - 0); - /* bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, 29, 0); */ - wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, - BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES, 0); - bt_rssi_state = halbtc8821a2ant_bt_rssi_state(3, - BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES, 37); - - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); - - halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, true, 0x6); - - halbtc8821a2ant_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)) - halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - else if (BTC_RSSI_MEDIUM(bt_rssi_state)) - halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - else - halbtc8821a2ant_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)) { - btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, - &ap_num); - /* need to check ap Number of Not */ - if (ap_num < 10) - halbtc8821a2ant_dec_bt_pwr(btcoexist, - NORMAL_EXEC, 4); - else - halbtc8821a2ant_dec_bt_pwr(btcoexist, - NORMAL_EXEC, 2); - } else if (BTC_RSSI_MEDIUM(bt_rssi_state)) - halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - 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, - 18); - halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - } else { - halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 18); - 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, true, false, 3); */ - halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 28); - } else { - /* halbtc8821a2ant_tdma_duration_adjust(btcoexist, true, true, 3); */ - halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 28); - } - - /* 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)) { - halbtc8821a2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8821a2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } else { - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8821a2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8821a2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } -} - -void halbtc8821a2ant_action_bt_whck_test(IN struct btc_coexist *btcoexist) -{ - halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - /* sw all off */ - 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); -} - -void halbtc8821a2ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) -{ - halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - /* sw all off */ - halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); - - /* hw all off */ - /* 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); -} - -void halbtc8821a2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) -{ - boolean wifi_under_5g = false; - 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; - } - - 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); - halbtc8821a2ant_coex_under_5g(btcoexist); - 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); - halbtc8821a2ant_action_bt_whck_test(btcoexist); - return; - } - - algorithm = halbtc8821a2ant_action_algorithm(btcoexist); - if (coex_sta->c2h_bt_inquiry_page && - (BT_8821A_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); - halbtc8821a2ant_action_bt_inquiry(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) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], WiFi is under Link Process !!\n"); - BTC_TRACE(trace_buf); - halbtc8821a2ant_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); - halbtc8821a2ant_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 (halbtc8821a2ant_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_8821A_2ANT_COEX_ALGO_SCO: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = SCO.\n"); - BTC_TRACE(trace_buf); - halbtc8821a2ant_action_sco(btcoexist); - break; - case BT_8821A_2ANT_COEX_ALGO_HID: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = HID.\n"); - BTC_TRACE(trace_buf); - halbtc8821a2ant_action_hid(btcoexist); - break; - case BT_8821A_2ANT_COEX_ALGO_A2DP: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = A2DP.\n"); - BTC_TRACE(trace_buf); - halbtc8821a2ant_action_a2dp(btcoexist); - break; - case BT_8821A_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); - halbtc8821a2ant_action_a2dp_pan_hs(btcoexist); - break; - case BT_8821A_2ANT_COEX_ALGO_PANEDR: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n"); - BTC_TRACE(trace_buf); - halbtc8821a2ant_action_pan_edr(btcoexist); - break; - case BT_8821A_2ANT_COEX_ALGO_PANHS: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = HS mode.\n"); - BTC_TRACE(trace_buf); - halbtc8821a2ant_action_pan_hs(btcoexist); - break; - case BT_8821A_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); - halbtc8821a2ant_action_pan_edr_a2dp(btcoexist); - break; - case BT_8821A_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); - halbtc8821a2ant_action_pan_edr_hid(btcoexist); - break; - case BT_8821A_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); - halbtc8821a2ant_action_hid_a2dp_pan_edr( - btcoexist); - break; - case BT_8821A_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); - halbtc8821a2ant_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); - halbtc8821a2ant_coex_all_off(btcoexist); - break; - } - coex_dm->pre_algorithm = coex_dm->cur_algorithm; - } -} - -void halbtc8821a2ant_wifi_off_hw_cfg(IN struct btc_coexist *btcoexist) -{ - 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); -} - -void halbtc8821a2ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean back_up) -{ - u8 u8tmp = 0; - - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[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); - - /* 0x790[5:0]=0x5 */ - u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x790); - u8tmp &= 0xc0; - u8tmp |= 0x5; - btcoexist->btc_write_1byte(btcoexist, 0x790, u8tmp); - - /* Antenna config */ - halbtc8821a2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_MAIN, true, - false); - coex_sta->dis_ver_info_cnt = 0; - - /* PTA parameter */ - halbtc8821a2ant_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_halbtc8821a2ant_ - * ************************************************************ - * ************************************************************ - * extern function start with ex_halbtc8821a2ant_ - * ************************************************************ */ -void ex_halbtc8821a2ant_power_on_setting(IN struct btc_coexist *btcoexist) -{ - -} - -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 */ - /* 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_halbtc8821a2ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean wifi_only) -{ - halbtc8821a2ant_init_hw_config(btcoexist, true); -} - -void ex_halbtc8821a2ant_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); - - halbtc8821a2ant_init_coex_dm(btcoexist); -} - -void ex_halbtc8821a2ant_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 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]============"); - 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_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 ", - "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/ %ddBm/ %d] ", - "BT [status/ rssi/ retryCnt]", - ((coex_sta->bt_disabled) ? ("disabled") : (( - coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") - : ((BT_8821A_2ANT_BT_STATUS_NON_CONNECTED_IDLE == - coex_dm->bt_status) ? "non-connected idle" : - ((BT_8821A_2ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) - ? "connected-idle" : "busy")))), - coex_sta->bt_rssi - 100, coex_sta->bt_retry_cnt); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", - "SCO/HID/PAN/A2DP", - bt_link_info->sco_exist, bt_link_info->hid_exist, - bt_link_info->pan_exist, bt_link_info->a2dp_exist); - 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", - "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_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_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); - - 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)", - "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); - 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); - u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xc5b); - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x880); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", - "0x778/0x880[29:25]/0xc58[29:25]", - u8tmp[0], (u32tmp[0] & 0x3e000000) >> 25, - ((u8tmp[1] & 0x3e) >> 1)); - CL_PRINTF(cli_buf); - - u32tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x764); - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x76e); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", - "0x764/ 0x765/ 0x76e", - (u32tmp[0] & 0xff), (u32tmp[0] & 0xff00) >> 8, u8tmp[0]); - 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, 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_8821A_2ANT == 1) - /* halbtc8821a2ant_monitor_bt_ctr(btcoexist); */ -#endif - btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); -} - - -void ex_halbtc8821a2ant_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; - halbtc8821a2ant_wifi_off_hw_cfg(btcoexist); - halbtc8821a2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); - halbtc8821a2ant_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; - halbtc8821a2ant_init_hw_config(btcoexist, false); - halbtc8821a2ant_init_coex_dm(btcoexist); - halbtc8821a2ant_query_bt_info(btcoexist); - } -} - -void ex_halbtc8821a2ant_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_halbtc8821a2ant_scan_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); -} - -/* 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) -{ - 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_halbtc8821a2ant_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); - } 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_halbtc8821a2ant_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_halbtc8821a2ant_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, 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); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - - rsp_source = tmp_buf[0] & 0xf; - if (rsp_source >= BT_INFO_SRC_8821A_2ANT_MAX) - rsp_source = BT_INFO_SRC_8821A_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_8821A_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]; - - 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); - if (wifi_connected) - ex_halbtc8821a2ant_media_status_notify( - btcoexist, BTC_MEDIA_CONNECT); - else - ex_halbtc8821a2ant_media_status_notify( - btcoexist, BTC_MEDIA_DISCONNECT); - } - - - if (!btcoexist->manual_control && !wifi_under_5g) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT ext info = 0x%x!!\n", - coex_sta->bt_info_ext); - BTC_TRACE(trace_buf); - if ((coex_sta->bt_info_ext & BIT(3))) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT ext info bit3=1, wifi_connected=%d\n", - wifi_connected); - BTC_TRACE(trace_buf); - if (wifi_connected) { - 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); - halbtc8821a2ant_ignore_wlan_act( - btcoexist, FORCE_EXEC, false); - } - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT ext info bit3=0, wifi_connected=%d\n", - wifi_connected); - BTC_TRACE(trace_buf); - /* BT already NOT ignore Wlan active, do nothing here. */ - if (!wifi_connected) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT ext info bit3 check, set BT to ignore Wlan active!!\n"); - BTC_TRACE(trace_buf); - halbtc8821a2ant_ignore_wlan_act( - btcoexist, FORCE_EXEC, true); - } - } - } - -#if (BT_AUTO_REPORT_ONLY_8821A_2ANT == 0) - if ((coex_sta->bt_info_ext & BIT(4))) { - /* BT auto report already enabled, do nothing */ - } else - halbtc8821a2ant_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_8821A_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_8821A_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_8821A_2ANT_B_FTP) - coex_sta->pan_exist = true; - else - coex_sta->pan_exist = false; - if (bt_info & BT_INFO_8821A_2ANT_B_A2DP) - coex_sta->a2dp_exist = true; - else - coex_sta->a2dp_exist = false; - if (bt_info & BT_INFO_8821A_2ANT_B_HID) - coex_sta->hid_exist = true; - else - coex_sta->hid_exist = false; - if (bt_info & BT_INFO_8821A_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; - } - } - - halbtc8821a2ant_update_bt_link_info(btcoexist); - - if (!(bt_info & BT_INFO_8821A_2ANT_B_CONNECTION)) { - coex_dm->bt_status = BT_8821A_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_8821A_2ANT_B_CONNECTION) { /* connection exists but no busy */ - coex_dm->bt_status = BT_8821A_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_8821A_2ANT_B_SCO_ESCO) || - (bt_info & BT_INFO_8821A_2ANT_B_SCO_BUSY)) { - coex_dm->bt_status = BT_8821A_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_8821A_2ANT_B_ACL_BUSY) { - coex_dm->bt_status = BT_8821A_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_8821A_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_8821A_2ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || - (BT_8821A_2ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || - (BT_8821A_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); - - halbtc8821a2ant_run_coexist_mechanism(btcoexist); -} - -void ex_halbtc8821a2ant_halt_notify(IN struct btc_coexist *btcoexist) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); - BTC_TRACE(trace_buf); - - 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 */ - halbtc8821a2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); - - ex_halbtc8821a2ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); -} - -void ex_halbtc8821a2ant_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); - } 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); - halbtc8821a2ant_init_hw_config(btcoexist, false); - halbtc8821a2ant_init_coex_dm(btcoexist); - halbtc8821a2ant_query_bt_info(btcoexist); - } -} - -void ex_halbtc8821a2ant_periodical(IN struct btc_coexist *btcoexist) -{ - 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); - halbtc8821a2ant_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)) - coex_sta->bt_coex_supported_version = - btcoexist->btc_get_bt_coex_supported_version(btcoexist); - - -#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) - halbtc8821a2ant_run_coexist_mechanism(btcoexist); -#endif -} - -#endif - -#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8821a2ant.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8821a2ant.h deleted file mode 100644 index a4997fe58cde..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8821a2ant.h +++ /dev/null @@ -1,212 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ - -#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) - -#if (RTL8821A_SUPPORT == 1) - -/* ******************************************* - * The following is for 8821A 2Ant BT Co-exist definition - * ******************************************* */ -#define BT_AUTO_REPORT_ONLY_8821A_2ANT 1 - - -#define BT_INFO_8821A_2ANT_B_FTP BIT(7) -#define BT_INFO_8821A_2ANT_B_A2DP BIT(6) -#define BT_INFO_8821A_2ANT_B_HID BIT(5) -#define BT_INFO_8821A_2ANT_B_SCO_BUSY BIT(4) -#define BT_INFO_8821A_2ANT_B_ACL_BUSY BIT(3) -#define BT_INFO_8821A_2ANT_B_INQ_PAGE BIT(2) -#define BT_INFO_8821A_2ANT_B_SCO_ESCO BIT(1) -#define BT_INFO_8821A_2ANT_B_CONNECTION BIT(0) - -#define BTC_RSSI_COEX_THRESH_TOL_8821A_2ANT 2 - - -#define BT_8821A_2ANT_WIFI_RSSI_COEXSWITCH_THRES 42 /* WiFi RSSI Threshold for 2-Ant TDMA/1-Ant PS-TDMA translation */ -#define BT_8821A_2ANT_BT_RSSI_COEXSWITCH_THRES 46 /* BT RSSI Threshold for 2-Ant TDMA/1-Ant PS-TDMA translation */ - -enum bt_info_src_8821a_2ant { - BT_INFO_SRC_8821A_2ANT_WIFI_FW = 0x0, - BT_INFO_SRC_8821A_2ANT_BT_RSP = 0x1, - BT_INFO_SRC_8821A_2ANT_BT_ACTIVE_SEND = 0x2, - BT_INFO_SRC_8821A_2ANT_MAX -}; - -enum bt_8821a_2ant_bt_status { - BT_8821A_2ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, - BT_8821A_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, - BT_8821A_2ANT_BT_STATUS_INQ_PAGE = 0x2, - BT_8821A_2ANT_BT_STATUS_ACL_BUSY = 0x3, - BT_8821A_2ANT_BT_STATUS_SCO_BUSY = 0x4, - BT_8821A_2ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, - BT_8821A_2ANT_BT_STATUS_MAX -}; - -enum bt_8821a_2ant_coex_algo { - BT_8821A_2ANT_COEX_ALGO_UNDEFINED = 0x0, - BT_8821A_2ANT_COEX_ALGO_SCO = 0x1, - BT_8821A_2ANT_COEX_ALGO_HID = 0x2, - BT_8821A_2ANT_COEX_ALGO_A2DP = 0x3, - BT_8821A_2ANT_COEX_ALGO_A2DP_PANHS = 0x4, - BT_8821A_2ANT_COEX_ALGO_PANEDR = 0x5, - BT_8821A_2ANT_COEX_ALGO_PANHS = 0x6, - BT_8821A_2ANT_COEX_ALGO_PANEDR_A2DP = 0x7, - BT_8821A_2ANT_COEX_ALGO_PANEDR_HID = 0x8, - BT_8821A_2ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, - BT_8821A_2ANT_COEX_ALGO_HID_A2DP = 0xa, - BT_8821A_2ANT_COEX_ALGO_MAX = 0xb, -}; - -struct coex_dm_8821a_2ant { - /* 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 auto_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; -}; - -struct coex_sta_8821a_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; - 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_8821A_2ANT_MAX][10]; - u32 bt_info_c2h_cnt[BT_INFO_SRC_8821A_2ANT_MAX]; - boolean bt_whck_test; - 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_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 coex_table_type; - boolean force_lps_on; - - u8 dis_ver_info_cnt; -}; - -/* ******************************************* - * The following is interface which will notify coex module. - * ******************************************* */ -void ex_halbtc8821a2ant_power_on_setting(IN struct btc_coexist *btcoexist); -void ex_halbtc8821a2ant_pre_load_firmware(IN struct btc_coexist *btcoexist); -void ex_halbtc8821a2ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean wifi_only); -void ex_halbtc8821a2ant_init_coex_dm(IN struct btc_coexist *btcoexist); -void ex_halbtc8821a2ant_ips_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -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, - IN u8 type); -void ex_halbtc8821a2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8821a2ant_bt_info_notify(IN struct btc_coexist *btcoexist, - IN u8 *tmp_buf, IN u8 length); -void ex_halbtc8821a2ant_halt_notify(IN struct btc_coexist *btcoexist); -void ex_halbtc8821a2ant_pnp_notify(IN struct btc_coexist *btcoexist, - IN u8 pnp_state); -void ex_halbtc8821a2ant_periodical(IN struct btc_coexist *btcoexist); -void ex_halbtc8821a2ant_display_coex_info(IN struct btc_coexist *btcoexist); - -#else -#define ex_halbtc8821a2ant_power_on_setting(btcoexist) -#define ex_halbtc8821a2ant_pre_load_firmware(btcoexist) -#define ex_halbtc8821a2ant_init_hw_config(btcoexist, wifi_only) -#define ex_halbtc8821a2ant_init_coex_dm(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) -#define ex_halbtc8821a2ant_bt_info_notify(btcoexist, tmp_buf, length) -#define ex_halbtc8821a2ant_halt_notify(btcoexist) -#define ex_halbtc8821a2ant_pnp_notify(btcoexist, pnp_state) -#define ex_halbtc8821a2ant_periodical(btcoexist) -#define ex_halbtc8821a2ant_display_coex_info(btcoexist) -#endif - -#endif - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8821c1ant.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8821c1ant.c deleted file mode 100644 index 7377db9b3f43..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8821c1ant.c +++ /dev/null @@ -1,6675 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ -/* ************************************************************ - * 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 = 20160805; -u32 glcoex_ver_8821c_1ant = 0x04; -u32 glcoex_ver_btdesired_8821c_1ant = 0x04; - - -/* ************************************************************ - * 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; - } - } - - -} - - - -void halbtc8821c1ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) -{ -#if 1 - s32 wifi_rssi = 0; - boolean wifi_busy = false, wifi_under_b_mode = false; - static u8 cck_lock_counter = 0; - u32 total_cnt, reg_val1, reg_val2; - - 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); - - 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 ((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_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; - -#endif -} - -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; - static u8 pre_hid_busy_num = 0; - 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; - 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->bt_disabled) { - - if (coex_sta->hid_busy_num != pre_hid_busy_num) { - pre_hid_busy_num = coex_sta->hid_busy_num; - 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; - 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_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}; - 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_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; - - 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_state_to_bt( - IN struct btc_coexist *btcoexist, - IN u16 type, - IN boolean state -) -{ - - halbtc8821c1ant_write_score_board(btcoexist, (u16) type, state); - -} - -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 >= 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)) - 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; - - - /* 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_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) { - 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; - } - - 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, - 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, - 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, 0x5a5a5a5a, 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, - 0xa5555555, 0xaaaaaaaa, break_table, - select_table); - break; - case 9: - halbtc8821c1ant_coex_table(btcoexist, force_exec, - 0x5a5a5a5a, 0xaaaa5aaa, 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 (board_info->btdm_ant_num_by_ant_det == 2) { -#if 0 - if (turn_on) - type = type + - 100; -#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); - - 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, 0x3a, 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, 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, 0x54 | - psTdmaByte4Modify); - break; - case 8: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0x51, 0x10, 0x03, 0x10, 0x54 | - psTdmaByte4Modify); - break; - case 9: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0x55, 0x10, 0x03, 0x10, 0x54 | - psTdmaByte4Modify); - break; - case 10: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0x61, 0x30, 0x03, 0x11, 0x10); - break; - case 13: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0x51, 0x25, 0x03, 0x10, 0x50 | - 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 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 32: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0x61, 0x35, 0x03, 0x11, 0x10); - 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; - - /* 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) -{ -#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 */ - 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; - } - - 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; - -#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 & 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_1ANT_EXT_ANT_SWITCH_USE_DPDT; /*2-Ant, DPDT, WLG*/ - rfe_type->wlg_Locate_at_btg = false; - 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->ext_ant_switch_type = - BT_8821C_1ANT_EXT_ANT_SWITCH_NONE; - rfe_type->wlg_Locate_at_btg = false; - break; - case 6: - 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; - break; - case 7: - 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; - break; - } - - - 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 (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 - -#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 - - 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 WL at initial 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); - - 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 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); - - 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_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, NORMAL_EXEC, false, 8); - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - - halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, - BT_8821C_1ANT_PHASE_5G_RUNTIME); -} - - -void halbtc8821c1ant_action_wifi_only(IN struct btc_coexist *btcoexist) -{ - 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, 7); -} - -void halbtc8821c1ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - - 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); - - 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); -} - -void halbtc8821c1ant_action_hs(IN struct btc_coexist *btcoexist) -{ - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); - 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, 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 ((wifi_link) || (wifi_roam) || (coex_sta->wifi_is_high_pri_task)) { - - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); - - if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist)) - halbtc8821c1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 1); - else - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); - - } else if (((wifi_scan) || (wifi_busy)) && - (coex_sta->bt_create_connection)) { - - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); - - if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist)) - halbtc8821c1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 1); - else - 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->sco_exist) || (bt_link_info->hid_exist)) { - - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6); - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); - - } 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; - 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); - - if ((wifi_bw == 0) && - ((coex_sta->hid_busy_num >= 2) || - (bt_link_info->sco_exist))) { /* if 11bg mode */ - /*for 4/18 hid or SCO/eSCo */ - halbtc8821c1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 9); - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 10); - } else { - 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, 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\n", - coex_sta->scan_ap_num); - BTC_TRACE(trace_buf); -#if 1 - if ((wifi_busy) && (coex_sta->scan_ap_num <= 4)) - wifi_turbo = true; -#endif - if (bt_link_info->hid_only) { /* HID */ - halbtc8821c1ant_action_bt_sco_hid_only_busy(btcoexist, - wifi_status); - 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); - } else { - - if (coex_sta->scan_ap_num >= - BT_8821C_1ANT_WIFI_NOISY_THRESH) { - - if (coex_sta->is_setupLink) - halbtc8821c1ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 67); - else - halbtc8821c1ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 17); - } else { - if (coex_sta->is_setupLink) - halbtc8821c1ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 57); - else - halbtc8821c1ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 7); - } - - if (wifi_turbo) - halbtc8821c1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 8); - else - halbtc8821c1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } - } 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)) || - (!coex_sta->is_A2DP_3M)) - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 15); - else if (wifi_turbo) - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 18); - else - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 13); - } else - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 14); - - if (bt_link_info->hid_exist) - 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); - } else if (bt_link_info->hid_exist && - bt_link_info->a2dp_exist) { /* HID+A2DP */ - - if (coex_sta->is_setupLink) { - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 1); - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 58); - } else { - - if ((wifi_busy) && (coex_sta->hid_busy_num >= 2)) { /*for 4/18 hid */ - halbtc8821c1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 6); - halbtc8821c1ant_set_wltoggle_coex_table(btcoexist, - NORMAL_EXEC, - 0x2, 0xaa, - 0x5a, 0xaa, - 0xaa); - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 9); - } else { - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 8); - 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); - - if (bt_link_info->hid_exist) - 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); - } else { - /* BT no-profile busy (0x9) */ - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } -} - -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_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_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_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_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, 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; - } - - 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_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_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_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)) { - 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; - } - - 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) { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], WiFi is under 5G!!!\n"); - BTC_TRACE(trace_buf); - - halbtc8821c1ant_action_wifi_under5g(btcoexist); - return; - } - - 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; - } - - 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_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_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) { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], scan = %d, link = %d, roam = %d !!!\n", - scan, link, roam); - BTC_TRACE(trace_buf); - - 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 */ - 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; - - 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; - 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; - - - /* 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); - - /* 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); - - /* PTA parameter */ - halbtc8821c1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); - - halbtc8821c1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); - - psd_scan->ant_det_is_ant_det_available = true; - - /* 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); - - 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_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); - - 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); - -} - -#if 0 -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; - - 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 == 12) { /* Get Ant Det from BT */ - - if (board_info->btdm_ant_num_by_ant_det == 1) - 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); - else { - - if (psd_scan->ant_det_psd_scan_peak_val > - (BT_8821C_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION) - * 100) - 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 - 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, - BT_8821C_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); - } - } else 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)"); - case 12: - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(BT is available, result from BT"); - break; - } - CL_PRINTF(cli_buf); - - if (psd_scan->ant_det_result == 12) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d dB", - "PSD Scan Peak Value", - psd_scan->ant_det_psd_scan_peak_val / 100); - CL_PRINTF(cli_buf); - return; - } - - 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; - - if (psd_scan->ant_det_result == 12) - return; - - 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; - - } - } - - -} - -#pragma optimize("", off) -void halbtc8821c1ant_psd_maxholddata(IN struct btc_coexist *btcoexist, - IN u32 gen_count) -{ - u32 i = 0; - u32 loop_i_max = 0, loop_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++) { - - /* update max-hold value at each freq point */ - 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 the max value in this seep */ - if (psd_scan->psd_report[i] > loop_val_max) { - loop_val_max = psd_scan->psd_report[i]; - loop_i_max = i; - } - } - - if (gen_count <= BT_8821C_1ANT_ANTDET_PSD_SWWEEPCOUNT) - psd_scan->psd_loop_max_value[gen_count - 1] = loop_val_max; -} - -#pragma optimize("", off) -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; - 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_1ANT_ANTDET_SWEEPPOINT_DELAY) - break; - } - - val = btcoexist->btc_read_4byte(btcoexist, 0x8b4); - - psd_report = val & 0x0000ffff; - - return psd_report; -} - -#pragma optimize("", off) -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; - u32 psd_sum = 0, avg_cnt = 0; - u32 i_max = 0, val_max = 0, val_max2 = 0; - - 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); - - 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; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "Point=%d, psd_dB_data = %d\n", - i, psd_scan->psd_report[n]); - BTC_TRACE(trace_buf); - - i++; - - } - - halbtc8821c1ant_psd_maxholddata(btcoexist, j); - - psd_scan->psd_gen_count = j; - - /*Accumulate Max PSD value in this loop if the value > threshold */ - if (psd_scan->psd_loop_max_value[j - 1] >= - 4000) { - psd_sum = psd_sum + - psd_scan->psd_loop_max_value[j - - 1]; - avg_cnt++; - } - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "Loop=%d, Max_dB_data = %d\n", - j, psd_scan->psd_loop_max_value[j - - 1]); - BTC_TRACE(trace_buf); - - } - - if (loopcnt == BT_8821C_1ANT_ANTDET_PSD_SWWEEPCOUNT) { - - /* search the Max Value between each-freq-point-max-hold value of all sweep*/ - for (i = 1; - i <= BT_8821C_1ANT_ANTDET_PSD_SWWEEPCOUNT; - i++) { - - if (i == 1) { - i_max = i; - val_max = psd_scan->psd_loop_max_value[i - - 1]; - val_max2 = - psd_scan->psd_loop_max_value[i - - 1]; - } else if ( - psd_scan->psd_loop_max_value[i - - 1] > val_max) { - val_max2 = val_max; - i_max = i; - val_max = psd_scan->psd_loop_max_value[i - - 1]; - } else if ( - psd_scan->psd_loop_max_value[i - - 1] > val_max2) - val_max2 = - psd_scan->psd_loop_max_value[i - - 1]; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "i = %d, val_hold= %d, val_max = %d, val_max2 = %d\n", - i, psd_scan->psd_loop_max_value[i - - 1], - val_max, val_max2); - - BTC_TRACE(trace_buf); - } - - psd_scan->psd_max_value_point = i_max; - psd_scan->psd_max_value = val_max; - psd_scan->psd_max_value2 = val_max2; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "val_max = %d, val_max2 = %d\n", - psd_scan->psd_max_value, - psd_scan->psd_max_value2); - BTC_TRACE(trace_buf); - } - - if (avg_cnt != 0) { - psd_scan->psd_avg_value = (psd_sum / avg_cnt); - if ((psd_sum % avg_cnt) >= (avg_cnt / 2)) - psd_scan->psd_avg_value++; - } else - psd_scan->psd_avg_value = 0; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "AvgLoop=%d, Avg_dB_data = %d\n", - avg_cnt, psd_scan->psd_avg_value); - 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); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx PSD Sweep Stop!!\n"); - BTC_TRACE(trace_buf); - return is_sweep_ok; - -} - -#pragma optimize("", off) -boolean halbtc8821c1ant_psd_antenna_detection(IN struct btc_coexist - *btcoexist) -{ - u32 i = 0; - u32 wlpsd_cent_freq = 2484, wlpsd_span = 2; - s32 wlpsd_offset = -4; - u32 bt_tx_time, bt_le_channel; - 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, 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; - - memset(psd_scan->ant_det_peak_val, 0, 16 * sizeof(u8)); - memset(psd_scan->ant_det_peak_freq, 0, 16 * sizeof(u8)); - - 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; - - bt_tx_time = psd_scan->ant_det_bt_tx_time; - bt_le_channel = psd_scan->ant_det_bt_le_channel; - - 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; - } - } -#if 0 - 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; -#endif - 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, - BT_8821C_1ANT_ANTDET_PSD_SWWEEPCOUNT); - 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); - } - - /* Set Antenna path, switch WiFi to un-certain antenna port */ - /* Set Antenna Path, both GNT_WL/GNT_BT = 1, and control by SW */ - halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, - FORCE_EXEC, - BT_8821C_1ANT_PHASE_ANTENNA_DET); - - 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)) { - 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->ant_det_pre_psdscan_peak_val > - (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->ant_det_pre_psdscan_peak_val / - 100, - BT_8821C_1ANT_ANTDET_PSDTHRES_BACKGROUND - + psd_scan->ant_det_thres_offset); - BTC_TRACE(trace_buf); - 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->ant_det_pre_psdscan_peak_val / - 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)); - - /* Sync WL Rx PSD with BT Tx time because H2C->Mailbox delay */ - delay_ms(20); - - 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, - BT_8821C_1ANT_ANTDET_PSD_SWWEEPCOUNT)) { - ant_det_finish = false; - board_info->btdm_ant_num_by_ant_det = 1; - psd_scan->ant_det_result = 8; - state = 99; - break; - } - -#if 1 - psd_scan->ant_det_psd_scan_peak_val = - psd_scan->psd_max_value; -#endif -#if 0 - psd_scan->ant_det_psd_scan_peak_val = - ((psd_scan->psd_max_value - psd_scan->psd_avg_value) < - 800) ? - psd_scan->psd_max_value : (( - psd_scan->psd_max_value - - psd_scan->psd_max_value2 <= 300) ? - psd_scan->psd_avg_value : - psd_scan->psd_max_value2); -#endif - 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->ant_det_psd_scan_peak_val / 100; - psd_rep2 = psd_scan->ant_det_psd_scan_peak_val - - 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; - 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->ant_det_psd_scan_peak_val > - (BT_8821C_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION) - * 100) { - psd_scan->ant_det_result = 1; - 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 / - 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->ant_det_psd_scan_peak_val > - (BT_8821C_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION - + psd_scan->ant_det_thres_offset) * 100) { - psd_scan->ant_det_result = 2; - 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 / - 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->ant_det_psd_scan_peak_val > - (BT_8821C_1ANT_ANTDET_PSDTHRES_1ANT) * - 100) { - psd_scan->ant_det_result = 3; - 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 / - 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; - 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 */ - 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); - - 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; - break; - } - - } while (!outloop); - - return ant_det_finish; - -} - -#pragma optimize("", off) -boolean 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, ant_det_finish = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); - - ant_det_count++; - - psd_scan->ant_det_try_count = ant_det_count; - - if (scan || roam) { - ant_det_finish = false; - psd_scan->ant_det_result = 6; - } else if (coex_sta->bt_disabled) { - ant_det_finish = false; - psd_scan->ant_det_result = 11; - } else if (coex_sta->num_of_profile >= 1) { - 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; - psd_scan->ant_det_result = 9; - } else if (coex_sta->c2h_bt_inquiry_page) { - ant_det_finish = false; - psd_scan->ant_det_result = 10; - } else { - - ant_det_finish = halbtc8821c1ant_psd_antenna_detection( - btcoexist); - - delay_ms(psd_scan->ant_det_bt_tx_time); - } - - - if (!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, - ant_det_finish == true ? "Yes" : "No"); - BTC_TRACE(trace_buf); - - return ant_det_finish; - -} - -#endif - -/* ************************************************************ - * 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 */ - - /* 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_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); - } - } - - 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" : - (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 ", - "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_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) ? "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); - - 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", 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_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", - "0x778/0x6cc", - u8tmp[0], u32tmp[0]); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s", - "AntDiv/ForceLPS/LPRA", - ((board_info->ant_div_cfg) ? "On" : "Off"), - ((coex_sta->force_lps_on) ? "On" : "Off"), - ((coex_dm->cur_low_penalty_ra) ? "On" : "Off")); - 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] = 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); - 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", - "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")); - 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", - "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); - - 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", - "Wifi-HiPri/ 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); - - 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(Lo-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_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_state_to_bt(btcoexist, - BT_8821C_1ANT_SCOREBOARD_ACTIVE, 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_state_to_bt(btcoexist, - BT_8821C_1ANT_SCOREBOARD_ACTIVE, 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_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 */ - halbtc8821c1ant_post_state_to_bt(btcoexist, - BT_8821C_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 */ - halbtc8821c1ant_post_state_to_bt(btcoexist, - BT_8821C_1ANT_SCOREBOARD_ACTIVE, true); - - } -} - -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); - - halbtc8821c1ant_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); - - halbtc8821c1ant_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); - - /* 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); - - 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); - - halbtc8821c1ant_post_state_to_bt(btcoexist, - BT_8821C_1ANT_SCOREBOARD_SCAN, true); - halbtc8821c1ant_post_state_to_bt(btcoexist, - BT_8821C_1ANT_SCOREBOARD_ACTIVE, 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); - - 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); - - halbtc8821c1ant_post_state_to_bt(btcoexist, - BT_8821C_1ANT_SCOREBOARD_SCAN, false); - - 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 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); - } -} - - -void ex_halbtc8821c1ant_connect_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - boolean wifi_connected = false; - - - halbtc8821c1ant_post_state_to_bt(btcoexist, - BT_8821C_1ANT_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); - - 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); - - /* 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); - - 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); - - if (BTC_MEDIA_CONNECT == type) { - - 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, 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); - return; - } - - /* 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_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_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) - 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 (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) - 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 i, rsp_source = 0; - boolean wifi_connected = 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] & - 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_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] : 0); - - 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; - } else - coex_sta->is_setupLink = false; - - if (coex_sta->bt_info_ext & BIT(3)) - coex_sta->cnt_IgnWlanAct++; - - if (coex_sta->bt_create_connection) - coex_sta->cnt_Page++; - - /* 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); - } - } - - } - - - halbtc8821c1ant_update_bt_link_info(btcoexist); - - if (btcoexist->manual_control) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), No run_coexist_mechanism 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 for Stop Coex DM\n"); - BTC_TRACE(trace_buf); - return; - } - - coex_sta->c2h_bt_info_req_sent = false; - - 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_state_to_bt(btcoexist, - BT_8821C_1ANT_SCOREBOARD_ACTIVE, true); - halbtc8821c1ant_post_state_to_bt(btcoexist, - BT_8821C_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); - - halbtc8821c1ant_post_state_to_bt(btcoexist, - BT_8821C_1ANT_SCOREBOARD_ACTIVE, false); - halbtc8821c1ant_post_state_to_bt(btcoexist, - BT_8821C_1ANT_SCOREBOARD_ONOFF, 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); - - halbtc8821c1ant_post_state_to_bt(btcoexist, - BT_8821C_1ANT_SCOREBOARD_ACTIVE, false); - halbtc8821c1ant_post_state_to_bt(btcoexist, - BT_8821C_1ANT_SCOREBOARD_ONOFF, 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) -{ - 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, false); - halbtc8821c1ant_post_state_to_bt(btcoexist, - BT_8821C_1ANT_SCOREBOARD_ONOFF, 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); - - halbtc8821c1ant_post_state_to_bt(btcoexist, - BT_8821C_1ANT_SCOREBOARD_ACTIVE, true); - halbtc8821c1ant_post_state_to_bt(btcoexist, - BT_8821C_1ANT_SCOREBOARD_ONOFF, 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) -{ - - struct btc_board_info *board_info = &btcoexist->board_info; - - 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_disabled) { - 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_coex_supported_version == 0xffff)) - coex_sta->bt_coex_supported_version = - btcoexist->btc_get_bt_coex_supported_version( - btcoexist); - - /*coex_sta->bt_ble_scan_type = btcoexist->btc_get_ble_scan_type_from_bt(btcoexist); */ - - 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); - -#if BT_8821C_1ANT_ANTDET_ENABLE - - if (board_info->btdm_ant_det_finish) { - if ((psd_scan->ant_det_result == 12) && - (psd_scan->ant_det_psd_scan_peak_val == 0) - && (!psd_scan->is_AntDet_running)) - psd_scan->ant_det_psd_scan_peak_val = - btcoexist->btc_get_ant_det_val_from_bt( - btcoexist) * 100; - } - -#endif - } - - if (halbtc8821c1ant_is_wifibt_status_changed(btcoexist)) - 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) -{ -#if 0 - - static u32 ant_det_count = 0, ant_det_fail_count = 0; - struct btc_board_info *board_info = &btcoexist->board_info; - u16 u16tmp; - u8 AntDetval = 0; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx Ext Call AntennaDetect()!!\n"); - BTC_TRACE(trace_buf); - -#if BT_8821C_1ANT_ANTDET_ENABLE - - 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); - - psd_scan->is_AntDet_running = true; - - halbtc8821c1ant_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; - psd_scan->ant_det_try_count = 1; - psd_scan->ant_det_fail_count = 0; - board_info->btdm_ant_num_by_ant_det = (u16tmp & - BIT(3)) ? 1 : 2; - psd_scan->ant_det_result = 12; - - psd_scan->ant_det_psd_scan_peak_val = - btcoexist->btc_get_ant_det_val_from_bt( - btcoexist) * 100; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Result from BT (%d-Ant)\n", - board_info->btdm_ant_num_by_ant_det); - BTC_TRACE(trace_buf); - } else - board_info->btdm_ant_det_finish = - halbtc8821c1ant_psd_antenna_detection_check( - btcoexist); - - btcoexist->bdontenterLPS = false; - - 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 (board_info->btdm_ant_num_by_ant_det == 2) { - board_info->ant_div_cfg = true; - 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_AUTO, FORCE_EXEC, - BT_8821C_1ANT_PHASE_2G_RUNTIME); - - /*for 8821c, btc_set_bt_trx_mask is just used to - notify BT stop le tx and Ant Det Result , not set BT RF TRx Mask */ - if (psd_scan->ant_det_result != 12) { - - AntDetval = (u8)(( - psd_scan->ant_det_psd_scan_peak_val - / 100) & 0x7f); - - AntDetval = - (board_info->btdm_ant_num_by_ant_det - == 1) ? (AntDetval | 0x80) : - AntDetval; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxx AntennaDetect(), Ant Count = %d, PSD Val = %d\n", - ((AntDetval & - 0x80) ? 1 - : 2), AntDetval - & 0x7f); - BTC_TRACE(trace_buf); - - if (btcoexist->btc_set_bt_trx_mask( - btcoexist, AntDetval)) - BTC_SPRINTF(trace_buf, - BT_TMP_BUF_SIZE, - "xxxxxx AntennaDetect(), Notify BT stop le tx by set_bt_trx_mask ok!\n"); - else - BTC_SPRINTF(trace_buf, - BT_TMP_BUF_SIZE, - "xxxxxx AntennaDetect(), Notify BT stop le tx by set_bt_trx_mask fail!\n"); - - BTC_TRACE(trace_buf); - } - - } 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; - psd_scan->is_AntDet_running = false; - /* 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); - - } 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); - - if (psd_scan->ant_det_inteval_count == 8) - btcoexist->bdontenterLPS = true; - else - btcoexist->bdontenterLPS = false; - } - - } -#endif - -#endif -} - - -void ex_halbtc8821c1ant_display_ant_detection(IN struct btc_coexist *btcoexist) -{ - -#if 0 -#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); - } -#endif -#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) */ - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8821c1ant.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8821c1ant.h deleted file mode 100644 index 24c7835781b0..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8821c1ant.h +++ /dev/null @@ -1,474 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ - -#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) - -#if (RTL8821C_SUPPORT == 1) - -/* ******************************************* - * 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) -#define BT_INFO_8821C_1ANT_B_A2DP BIT(6) -#define BT_INFO_8821C_1ANT_B_HID BIT(5) -#define BT_INFO_8821C_1ANT_B_SCO_BUSY BIT(4) -#define BT_INFO_8821C_1ANT_B_ACL_BUSY BIT(3) -#define BT_INFO_8821C_1ANT_B_INQ_PAGE BIT(2) -#define BT_INFO_8821C_1ANT_B_SCO_ESCO BIT(1) -#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) - -#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 -#define BT_8821C_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION 70 -#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 60000 -#define BT_8821C_1ANT_ANTDET_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 - -enum bt_8821c_1ant_signal_state { - BT_8821C_1ANT_SIG_STA_SET_TO_LOW = 0x0, - BT_8821C_1ANT_SIG_STA_SET_BY_HW = 0x0, - BT_8821C_1ANT_SIG_STA_SET_TO_HIGH = 0x1, - BT_8821C_1ANT_SIG_STA_MAX -}; - -enum bt_8821c_1ant_path_ctrl_owner { - BT_8821C_1ANT_PCO_BTSIDE = 0x0, - BT_8821C_1ANT_PCO_WLSIDE = 0x1, - BT_8821C_1ANT_PCO_MAX -}; - -enum bt_8821c_1ant_gnt_ctrl_type { - BT_8821C_1ANT_GNT_TYPE_CTRL_BY_PTA = 0x0, - BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW = 0x1, - BT_8821C_1ANT_GNT_TYPE_MAX -}; - -enum bt_8821c_1ant_gnt_ctrl_block { - BT_8821C_1ANT_GNT_BLOCK_RFC_BB = 0x0, - BT_8821C_1ANT_GNT_BLOCK_RFC = 0x1, - BT_8821C_1ANT_GNT_BLOCK_BB = 0x2, - BT_8821C_1ANT_GNT_BLOCK_MAX -}; - -enum bt_8821c_1ant_lte_coex_table_type { - BT_8821C_1ANT_CTT_WL_VS_LTE = 0x0, - BT_8821C_1ANT_CTT_BT_VS_LTE = 0x1, - BT_8821C_1ANT_CTT_MAX -}; - -enum bt_8821c_1ant_lte_break_table_type { - BT_8821C_1ANT_LBTT_WL_BREAK_LTE = 0x0, - BT_8821C_1ANT_LBTT_BT_BREAK_LTE = 0x1, - BT_8821C_1ANT_LBTT_LTE_BREAK_WL = 0x2, - BT_8821C_1ANT_LBTT_LTE_BREAK_BT = 0x3, - BT_8821C_1ANT_LBTT_MAX -}; - -enum bt_info_src_8821c_1ant { - BT_INFO_SRC_8821C_1ANT_WIFI_FW = 0x0, - BT_INFO_SRC_8821C_1ANT_BT_RSP = 0x1, - BT_INFO_SRC_8821C_1ANT_BT_ACTIVE_SEND = 0x2, - BT_INFO_SRC_8821C_1ANT_MAX -}; - -enum bt_8821c_1ant_bt_status { - BT_8821C_1ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, - BT_8821C_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, - BT_8821C_1ANT_BT_STATUS_INQ_PAGE = 0x2, - BT_8821C_1ANT_BT_STATUS_ACL_BUSY = 0x3, - BT_8821C_1ANT_BT_STATUS_SCO_BUSY = 0x4, - BT_8821C_1ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, - BT_8821C_1ANT_BT_STATUS_MAX -}; - -enum bt_8821c_1ant_wifi_status { - BT_8821C_1ANT_WIFI_STATUS_NON_CONNECTED_IDLE = 0x0, - BT_8821C_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN = 0x1, - BT_8821C_1ANT_WIFI_STATUS_CONNECTED_SCAN = 0x2, - BT_8821C_1ANT_WIFI_STATUS_CONNECTED_SPECIFIC_PKT = 0x3, - BT_8821C_1ANT_WIFI_STATUS_CONNECTED_IDLE = 0x4, - BT_8821C_1ANT_WIFI_STATUS_CONNECTED_BUSY = 0x5, - BT_8821C_1ANT_WIFI_STATUS_MAX -}; - -enum bt_8821c_1ant_coex_algo { - BT_8821C_1ANT_COEX_ALGO_UNDEFINED = 0x0, - BT_8821C_1ANT_COEX_ALGO_SCO = 0x1, - BT_8821C_1ANT_COEX_ALGO_HID = 0x2, - BT_8821C_1ANT_COEX_ALGO_A2DP = 0x3, - BT_8821C_1ANT_COEX_ALGO_A2DP_PANHS = 0x4, - BT_8821C_1ANT_COEX_ALGO_PANEDR = 0x5, - BT_8821C_1ANT_COEX_ALGO_PANHS = 0x6, - BT_8821C_1ANT_COEX_ALGO_PANEDR_A2DP = 0x7, - BT_8821C_1ANT_COEX_ALGO_PANEDR_HID = 0x8, - BT_8821C_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, - BT_8821C_1ANT_COEX_ALGO_HID_A2DP = 0xa, - BT_8821C_1ANT_COEX_ALGO_MAX = 0xb, -}; - -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 -}; - - -enum bt_8821c_1ant_ext_ant_switch_ctrl_type { - BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW = 0x0, - BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_PTA = 0x1, - BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_ANTDIV = 0x2, - BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_MAC = 0x3, - BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_BT = 0x4, - BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_MAX -}; - -enum bt_8821c_1ant_ext_ant_switch_pos_type { - BT_8821C_1ANT_EXT_ANT_SWITCH_TO_BT = 0x0, - BT_8821C_1ANT_EXT_ANT_SWITCH_TO_WLG = 0x1, - BT_8821C_1ANT_EXT_ANT_SWITCH_TO_WLA = 0x2, - BT_8821C_1ANT_EXT_ANT_SWITCH_TO_NOCARE = 0x3, - BT_8821C_1ANT_EXT_ANT_SWITCH_TO_MAX -}; - -enum bt_8821c_1ant_ext_band_switch_pos_type { - BT_8821C_1ANT_EXT_BAND_SWITCH_TO_WLG = 0x0, - BT_8821C_1ANT_EXT_BAND_SWITCH_TO_WLA = 0x1, - BT_8821C_1ANT_EXT_BAND_SWITCH_TO_MAX -}; - -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 { - BT_8821C_1ANT_PHASE_COEX_INIT = 0x0, - 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) -}; - -struct coex_dm_8821c_1ant { - /* hw setting */ - u32 pre_ant_pos_type; - u32 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 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; - boolean limited_dig; - - 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 pre_algorithm; - u8 cur_algorithm; - 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; - - 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; - - u8 error_condition; -}; - -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; - u8 num_of_profile; - - 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; - 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_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_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; - - 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; - - u32 bt_coex_supported_feature; - u32 bt_coex_supported_version; - - u8 bt_ble_scan_type; - u8 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; - - u16 bt_reg_vendor_ac; - u16 bt_reg_vendor_ae; - - boolean is_setupLink; -}; - - -#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 { - - 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 ext_ant_switch_diversity; /* If diversity on */ -}; - -#define BT_8821C_1ANT_ANTDET_PSD_POINTS 256 /* MAX:1024 */ -#define BT_8821C_1ANT_ANTDET_PSD_AVGNUM 1 /* MAX:3 */ -#define BT_8821C_1ANT_ANTDET_BUF_LEN 16 - -struct psdscan_sta_8821c_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_8821C_1ANT_ANTDET_BUF_LEN]; - u8 ant_det_peak_freq[BT_8821C_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_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_AntDet_running; - boolean is_psd_show_max_only; -}; - -/* ******************************************* - * The following is interface which will notify coex module. - * ******************************************* */ -void ex_halbtc8821c1ant_power_on_setting(IN struct btc_coexist *btcoexist); -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); -void ex_halbtc8821c1ant_init_coex_dm(IN struct btc_coexist *btcoexist); -void ex_halbtc8821c1ant_ips_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8821c1ant_lps_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -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); -void ex_halbtc8821c1ant_connect_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8821c1ant_media_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -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_rf_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8821c1ant_halt_notify(IN struct btc_coexist *btcoexist); -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_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); -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); -void ex_halbtc8821c1ant_display_ant_detection(IN struct btc_coexist *btcoexist); - -#else -#define ex_halbtc8821c1ant_power_on_setting(btcoexist) -#define ex_halbtc8821c1ant_pre_load_firmware(btcoexist) -#define ex_halbtc8821c1ant_init_hw_config(btcoexist, wifi_only) -#define ex_halbtc8821c1ant_init_coex_dm(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_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_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_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) -#define ex_halbtc8821c1ant_psd_scan(btcoexist, cent_freq, offset, span, seconds) -#define ex_halbtc8821c1ant_display_ant_detection(btcoexist) -#endif - -#endif - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8821c2ant.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8821c2ant.c deleted file mode 100644 index 984f0692bbcc..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8821c2ant.c +++ /dev/null @@ -1,6937 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ -/* ************************************************************ - * 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_2ant glcoex_dm_8821c_2ant; -static struct coex_dm_8821c_2ant *coex_dm = &glcoex_dm_8821c_2ant; -static struct coex_sta_8821c_2ant glcoex_sta_8821c_2ant; -static struct coex_sta_8821c_2ant *coex_sta = &glcoex_sta_8821c_2ant; -static struct psdscan_sta_8821c_2ant gl_psd_scan_8821c_2ant; -static struct psdscan_sta_8821c_2ant *psd_scan = &gl_psd_scan_8821c_2ant; -static struct rfe_type_8821c_2ant gl_rfe_type_8821c_2ant; -static struct rfe_type_8821c_2ant *rfe_type = &gl_rfe_type_8821c_2ant; - -const char *const glbt_info_src_8821c_2ant[] = { - "BT Info[wifi fw]", - "BT Info[bt rsp]", - "BT Info[bt auto report]", -}; - -u32 glcoex_ver_date_8821c_2ant = 20160805; -u32 glcoex_ver_8821c_2ant = 0x04; -u32 glcoex_ver_btdesired_8821c_2ant = 0x04; - - -/* ************************************************************ - * local function proto type if needed - * ************************************************************ - * ************************************************************ - * local function start with halbtc8821c2ant_ - * ************************************************************ */ -u8 halbtc8821c2ant_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_8821C_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_8821C_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_8821C_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 halbtc8821c2ant_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_8821C_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_8821C_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_8821C_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 halbtc8821c2ant_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_8821C_2ANT_WIFI_MAX_TX_POWER - - isolation_measuared; - interference_bt_tx = BT_8821C_2ANT_BT_MAX_TX_POWER - - isolation_measuared; - - - - coex_sta->wifi_coex_thres = BT_8821C_2ANT_WIFI_RSSI_COEXSWITCH_THRES1; - coex_sta->wifi_coex_thres2 = BT_8821C_2ANT_WIFI_RSSI_COEXSWITCH_THRES2; - - coex_sta->bt_coex_thres = BT_8821C_2ANT_BT_RSSI_COEXSWITCH_THRES1; - coex_sta->bt_coex_thres2 = BT_8821C_2ANT_BT_RSSI_COEXSWITCH_THRES2; - - - /* - coex_sta->wifi_coex_thres = interference_wl_tx + BT_8821C_2ANT_WIFI_SIR_THRES1; - coex_sta->wifi_coex_thres2 = interference_wl_tx + BT_8821C_2ANT_WIFI_SIR_THRES2; - - coex_sta->bt_coex_thres = interference_bt_tx + BT_8821C_2ANT_BT_SIR_THRES1; - coex_sta->bt_coex_thres2 = interference_bt_tx + BT_8821C_2ANT_BT_SIR_THRES2; - */ - - - - - - /* - if ( BT_8821C_2ANT_WIFI_RSSI_COEXSWITCH_THRES1 < (isolation_measuared - - BT_8821C_2ANT_DEFAULT_ISOLATION) ) - coex_sta->wifi_coex_thres = BT_8821C_2ANT_WIFI_RSSI_COEXSWITCH_THRES1; - else - coex_sta->wifi_coex_thres = BT_8821C_2ANT_WIFI_RSSI_COEXSWITCH_THRES1 - (isolation_measuared - - BT_8821C_2ANT_DEFAULT_ISOLATION); - - if ( BT_8821C_2ANT_BT_RSSI_COEXSWITCH_THRES1 < (isolation_measuared - - BT_8821C_2ANT_DEFAULT_ISOLATION) ) - coex_sta->bt_coex_thres = BT_8821C_2ANT_BT_RSSI_COEXSWITCH_THRES1; - else - coex_sta->bt_coex_thres = BT_8821C_2ANT_BT_RSSI_COEXSWITCH_THRES1 - (isolation_measuared - - BT_8821C_2ANT_DEFAULT_ISOLATION); - - */ -} - - -void halbtc8821c2ant_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 halbtc8821c2ant_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 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; - - 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->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) -{ -#if 1 - s32 wifi_rssi = 0; - boolean wifi_busy = false, wifi_under_b_mode = false; - static u8 cck_lock_counter = 0; - u32 total_cnt, reg_val1, reg_val2; - - 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); - - 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 ((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_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; - -#endif -} - -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 pre_hid_busy_num = 0; - 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; - 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->bt_disabled) { - - if (coex_sta->hid_busy_num != pre_hid_busy_num) { - pre_hid_busy_num = coex_sta->hid_busy_num; - return true; - } - } - } - - return false; -} - - -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; - 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_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}; - 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); - -} - -void halbtc8821c2ant_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 halbtc8821c2ant_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; - } - - halbtc8821c2ant_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 halbtc8821c2ant_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 halbtc8821c2ant_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; - } - halbtc8821c2ant_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 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) - 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 halbtc8821c2ant_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 halbtc8821c2ant_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; - } - halbtc8821c2ant_set_bt_auto_report(btcoexist, - coex_dm->cur_bt_auto_report); - - coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; -} - -void halbtc8821c2ant_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 halbtc8821c2ant_read_score_board( - IN struct btc_coexist *btcoexist, - IN u16 *score_board_val -) -{ - - *score_board_val = (btcoexist->btc_read_2byte(btcoexist, - 0xaa)) & 0x7fff; -} - - -void halbtc8821c2ant_post_state_to_bt( - IN struct btc_coexist *btcoexist, - IN u16 type, - IN boolean state -) -{ - - halbtc8821c2ant_write_score_board(btcoexist, (u16) type, state); - -} - -void halbtc8821c2ant_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 */ - halbtc8821c2ant_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)) - 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, - "[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 halbtc8821c2ant_enable_gnt_to_gpio(IN struct btc_coexist *btcoexist, - boolean 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) { - - 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 -} - -u32 halbtc8821c2ant_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_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, - 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_2ANT_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 = halbtc8821c2ant_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 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); - - } - -} - -void halbtc8821c2ant_ltecoex_enable(IN struct btc_coexist *btcoexist, - IN boolean enable) -{ - u8 val; - - val = (enable) ? 1 : 0; - halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, 0x38, 0x80, - val); /* 0x38[7] */ - -} - -void halbtc8821c2ant_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 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; - - state = state & 0x1; - val = (sw_control) ? ((state << 1) | 0x1) : 0; - - 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] */ - break; - case BT_8821C_2ANT_GNT_BLOCK_RFC: - bit_mask = 0xc000; - halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[15:14] */ - break; - case BT_8821C_2ANT_GNT_BLOCK_BB: - bit_mask = 0x0c00; - halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[11:10] */ - break; - - } - -} - -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; - - state = state & 0x1; - val = (sw_control) ? ((state << 1) | 0x1) : 0; - - 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] */ - break; - case BT_8821C_2ANT_GNT_BLOCK_RFC: - bit_mask = 0x3000; - halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[13:12] */ - break; - case BT_8821C_2ANT_GNT_BLOCK_BB: - bit_mask = 0x0300; - halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[9:8] */ - break; - - } - -} - -void halbtc8821c2ant_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_2ANT_CTT_WL_VS_LTE: - reg_addr = 0xa0; - break; - case BT_8821C_2ANT_CTT_BT_VS_LTE: - reg_addr = 0xa4; - break; - } - - if (reg_addr != 0x0000) - halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, - 0xffff, table_content); /* 0xa0[15:0] or 0xa4[15:0] */ - - -} - - -void halbtc8821c2ant_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_2ANT_LBTT_WL_BREAK_LTE: - reg_addr = 0xa8; - break; - case BT_8821C_2ANT_LBTT_BT_BREAK_LTE: - reg_addr = 0xac; - break; - case BT_8821C_2ANT_LBTT_LTE_BREAK_WL: - reg_addr = 0xb0; - break; - case BT_8821C_2ANT_LBTT_LTE_BREAK_BT: - reg_addr = 0xb4; - break; - } - - if (reg_addr != 0x0000) - halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, - 0xff, table_content); /* 0xa8[15:0] or 0xb4[15:0] */ - - -} - -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) -{ - 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 halbtc8821c2ant_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; - } - halbtc8821c2ant_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 halbtc8821c2ant_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: - halbtc8821c2ant_coex_table(btcoexist, force_exec, - 0xffffffff, 0xffffffff, break_table, select_table); - break; - case 1: - halbtc8821c2ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x5a5a5a5a, break_table, select_table); - break; - case 2: - halbtc8821c2ant_coex_table(btcoexist, force_exec, - 0x5a5a5a5a, 0x5a5a5a5a, break_table, select_table); - break; - case 3: - halbtc8821c2ant_coex_table(btcoexist, force_exec, - 0x5a5a5a5a, 0x5a5a5a5a, break_table, select_table); - break; - case 4: - halbtc8821c2ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x5a5a5a5a, break_table, select_table); - break; - case 5: - halbtc8821c2ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x55555555, break_table, select_table); - break; - case 6: - halbtc8821c2ant_coex_table(btcoexist, force_exec, - 0xa5555555, 0xaaaaaaaa, break_table, select_table); - break; - case 7: - halbtc8821c2ant_coex_table(btcoexist, force_exec, - 0xa5555555, 0xaa5a5a5a, break_table, select_table); - break; - case 8: - halbtc8821c2ant_coex_table(btcoexist, force_exec, - 0xa5555555, 0x5a5a5a5a, break_table, select_table); - break; - case 9: - halbtc8821c2ant_coex_table(btcoexist, force_exec, - 0x5a5a5a5a, 0xaaaa5aaa, break_table, select_table); - break; - default: - break; - } -} - -void halbtc8821c2ant_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 halbtc8821c2ant_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; - } - halbtc8821c2ant_set_fw_ignore_wlan_act(btcoexist, enable); - - coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; -} - -void halbtc8821c2ant_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 halbtc8821c2ant_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; - } - halbtc8821c2ant_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 halbtc8821c2ant_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}; - - 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 */ - /*halbtc8821c2ant_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 */ - /*halbtc8821c2ant_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 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; - - 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: - halbtc8821c2ant_ps_tdma_check_for_power_save_state( - 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; - 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: - halbtc8821c2ant_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 halbtc8821c2ant_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 AP mode\n"); - BTC_TRACE(trace_buf); - real_byte1 &= ~BIT(4); - real_byte1 |= BIT(5); - - real_byte5 |= BIT(5); - real_byte5 &= ~BIT(6); - - halbtc8821c2ant_power_save_state(btcoexist, - BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - } - } else if (byte1 & BIT(4) && !(byte1 & BIT(5))) { - - halbtc8821c2ant_power_save_state( - btcoexist, BTC_PS_LPS_ON, 0x50, - 0x4); - } else { - halbtc8821c2ant_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 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; - - /* 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); - - 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: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x10, 0x03, 0xf1, - 0x54 | psTdmaByte4Modify); - break; - case 2: - default: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x35, 0x03, 0x71, - 0x11 | psTdmaByte4Modify); - break; - case 3: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x3a, 0x3, 0xf1, - 0x10 | psTdmaByte4Modify); - break; - case 4: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x21, 0x3, 0xf1, - 0x10 | psTdmaByte4Modify); - break; - case 5: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x25, 0x3, 0xf1, - 0x10 | psTdmaByte4Modify); - break; - case 6: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x10, 0x3, 0xf1, - 0x10 | psTdmaByte4Modify); - break; - case 7: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x20, 0x3, 0xf1, - 0x10 | psTdmaByte4Modify); - 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, - 0x10 | psTdmaByte4Modify); - break; - case 12: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x21, 0x03, 0x71, - 0x11 | psTdmaByte4Modify); - break; - case 13: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x1c, 0x03, 0x71, - 0x10 | psTdmaByte4Modify); - break; - case 14: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x30, 0x03, 0x71, - 0x11); - break; - case 51: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x10, 0x03, 0xf1, - 0x10 | psTdmaByte4Modify); - break; - case 101: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x10, 0x03, 0x70, - 0x54 | psTdmaByte4Modify); - break; - case 102: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x35, 0x03, 0x71, - 0x11 | psTdmaByte4Modify); - break; - case 103: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x3a, 0x3, 0x70, - 0x50 | psTdmaByte4Modify); - break; - case 104: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x21, 0x3, 0x70, - 0x50 | psTdmaByte4Modify); - break; - case 105: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x25, 0x3, 0x70, - 0x50 | psTdmaByte4Modify); - break; - case 106: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x10, 0x3, 0x70, - 0x50 | psTdmaByte4Modify); - break; - case 107: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x20, 0x3, 0x70, - 0x50 | psTdmaByte4Modify); - break; - case 108: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x30, 0x3, 0x70, - 0x50 | psTdmaByte4Modify); - break; - case 109: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xd7, - 0x10, 0x03, 0x10, - 0x54 | psTdmaByte4Modify); - break; - case 151: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x10, 0x03, 0x70, - 0x50 | psTdmaByte4Modify); - break; - } - } else { - /* disable PS tdma */ - switch (type) { - case 0: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x0, - 0x0, 0x0, 0x40, 0x0); - break; - case 1: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x0, - 0x0, 0x0, 0x48, 0x0); - break; - default: - halbtc8821c2ant_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 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; - - 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 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; - 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_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); - - 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 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; - 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); - - 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: - - break; - } - - 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); -#endif - -} - -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 & 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_2ANT_EXT_ANT_SWITCH_USE_DPDT; /*2-Ant, DPDT, WLG*/ - rfe_type->wlg_Locate_at_btg = false; - break; - case 1: - rfe_type->ext_ant_switch_exist = true; - rfe_type->ext_ant_switch_type = - BT_8821C_2ANT_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_2ANT_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_2ANT_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_2ANT_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->ext_ant_switch_type = - BT_8821C_2ANT_EXT_ANT_SWITCH_NONE; - rfe_type->wlg_Locate_at_btg = false; - break; - case 6: - rfe_type->ext_ant_switch_exist = - false; /*2-Ant, no antenna switch, WLG*/ - rfe_type->ext_ant_switch_type = - BT_8821C_2ANT_EXT_ANT_SWITCH_NONE; - rfe_type->wlg_Locate_at_btg = false; - break; - case 7: - rfe_type->ext_ant_switch_exist = true; - rfe_type->ext_ant_switch_type = - BT_8821C_2ANT_EXT_ANT_SWITCH_USE_DPDT; /*2-Ant, DPDT, BTG*/ - rfe_type->wlg_Locate_at_btg = 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); - else - halbtc8821c2ant_set_int_block(btcoexist, FORCE_EXEC, - BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG); - - -} - - -void halbtc8821c2ant_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_2ANT_ANTDET_ENABLE - - if (ant_pos_type == BTC_ANT_PATH_AUTO) { - 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 - - 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_8821C_2ANT_COEX_DBG - u32tmp1 = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, - 0x38); - u32tmp2 = halbtc8821c2ant_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_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; - } - } - - /* 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: - 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); -#endif - -} - - -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; - u8 algorithm = BT_8821C_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_8821C_2ANT_COEX_ALGO_NOPROFILEBUSY; - } - } 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_8821C_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_8821C_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_8821C_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_8821C_2ANT_COEX_ALGO_PANHS; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], PAN(EDR) only\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821C_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_8821C_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_8821C_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_8821C_2ANT_COEX_ALGO_SCO; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCO + PAN(EDR)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821C_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_8821C_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_8821C_2ANT_COEX_ALGO_HID; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], HID + PAN(EDR)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821C_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_8821C_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_8821C_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_8821C_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_8821C_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_8821C_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_8821C_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_8821C_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_8821C_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_8821C_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_8821C_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_8821C_2ANT_COEX_ALGO_HID_A2DP_PANEDR; - } - } - } - } - - return algorithm; -} - - - -void halbtc8821c2ant_action_coex_all_off(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_under5g(IN struct btc_coexist *btcoexist) -{ - - /* 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, 0xd8); - halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - halbtc8821c2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, - BT_8821C_2ANT_PHASE_5G_RUNTIME); -} - - -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, - 8); - - 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, 0xd8); - halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -} - -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, 0xd8); - 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, 14); - else - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 11); - -} - - -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, 0xd8); - halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -} - -void halbtc8821c2ant_action_bt_idle(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_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); - - 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); - - - 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 (scan || link || roam) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi link process + BT Idle!!\n"); - BTC_TRACE(trace_buf); - - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 7); - - 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"); - BTC_TRACE(trace_buf); - - if (wifi_busy) - halbtc8821c2ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 0); - - else - halbtc8821c2ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 0); - - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - - } 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_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0xd8); - halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - -} - - -/* SCO only or SCO+PAN(HS) */ -void halbtc8821c2ant_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 = 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, 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 { - - 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; - - if (wifi_bw == 0) { /* if 11bg mode */ - /*for 4/18 hid */ - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 9); - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 10); - } else { - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 3); - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - } - } - -} - - -void halbtc8821c2ant_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 = 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, 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 { - - 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; - - if ((wifi_bw == 0) && - (coex_sta->hid_busy_num >= 2)) { /* if 11bg mode */ - /*for 4/18 hid */ - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 9); - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 10); - - } else { - - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 3); - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - } - } - -} - -/* A2DP only / PAN(EDR) only/ A2DP+PAN(HS) */ -void halbtc8821c2ant_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\n", - coex_sta->scan_ap_num); - BTC_TRACE(trace_buf); - -#if 1 - if ((wifi_busy) && (coex_sta->scan_ap_num <= 4)) - 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(&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, 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) { - if (coex_sta->is_setupLink) - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 51); - else - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 1); - } else - - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 2); - } 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; - - if (wifi_turbo) - halbtc8821c2ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 6); - else - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 7); - - if (wifi_busy) { - if (coex_sta->is_setupLink) - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 151); - else - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 101); - } else - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 102); - - } - -} - -void halbtc8821c2ant_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\n", - coex_sta->scan_ap_num); - BTC_TRACE(trace_buf); - -#if 1 - if ((wifi_busy) && (coex_sta->scan_ap_num <= 4)) - 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(&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 0 - 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); -#endif - - -#if 1 - 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, - 3); - else - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 4); - } 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; - - if (wifi_turbo) - halbtc8821c2ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 6); - 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 - -} - - -/* 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, 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\n", - coex_sta->scan_ap_num); - BTC_TRACE(trace_buf); - -#if 1 - if ((wifi_busy) && (coex_sta->scan_ap_num <= 4)) - 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(&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, 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_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; - - - 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, 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) { - if (coex_sta->is_setupLink) - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 51); - else - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 1); - } else - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 2); - } 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; - - - if (wifi_busy) { - if (coex_sta->hid_busy_num >= 2) { - halbtc8821c2ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 8); - halbtc8821c2ant_set_wltoggle_coex_table(btcoexist, - NORMAL_EXEC, - 0x2, 0xaa, - 0x5a, 0xaa, - 0xaa); - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 109); - } else if (coex_sta->is_setupLink) { - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 151); - } else { - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 101); - } - } else { - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 1); - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 102); - } - - } - -} - - -void halbtc8821c2ant_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\n", - coex_sta->scan_ap_num); - BTC_TRACE(trace_buf); - -#if 1 - if ((wifi_busy) && (coex_sta->scan_ap_num <= 4)) - 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(&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, 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) { - - 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); - } else - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 6); - - } 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; - - if (wifi_turbo) - halbtc8821c2ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 6); - else - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 7); - - 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); - - } - -} - - - -/* PAN(EDR)+A2DP */ -void halbtc8821c2ant_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\n", - coex_sta->scan_ap_num); - BTC_TRACE(trace_buf); - -#if 1 - if ((wifi_busy) && (coex_sta->scan_ap_num <= 4)) - 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(&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, 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) { - - 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); - } else - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 6); - } 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; - - if (wifi_turbo) - halbtc8821c2ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 6); - else - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 7); - - 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 if (wifi_turbo) - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 108); - else - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 105); - } else - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 106); - - } - -} - -void halbtc8821c2ant_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; - - - 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, 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, - 3); - else - - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 4); - - - } 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, 1); - - if (wifi_busy) - - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 103); - else - - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 104); - - } - -} - -/* HID+A2DP+PAN(EDR) */ -void halbtc8821c2ant_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; - - - 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, 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) { - - 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); - } else - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 6); - } 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, 1); - - 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); - } - -} - - - -void halbtc8821c2ant_action_bt_whck_test(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); - 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, 0xd8); - halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - /* hw all off */ - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); -} - -void halbtc8821c2ant_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, - wifi_connected = false, 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; - } - - 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) { - - 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 { - - 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); - } - - - 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); - return; - } - - if (coex_sta->bt_disabled) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is disabled!!!\n"); - BTC_TRACE(trace_buf); - halbtc8821c2ant_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); - halbtc8821c2ant_action_bt_inquiry(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) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], WiFi is under Link Process !!\n"); - BTC_TRACE(trace_buf); - halbtc8821c2ant_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); - halbtc8821c2ant_action_wifi_multi_port(btcoexist); - - return; - } else { - miracast_plus_bt = false; - btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, - &miracast_plus_bt); - } - - - 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) { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, wifi non-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); - - } 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; - } -} - -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_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); - - 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; - - 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; - - - 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);; - - 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_8821C_2ANT_DEFAULT_ISOLATION; - - - /* 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; - - halbtc8821c2ant_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); - - /* 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); - - /* check if WL firmware download ok */ - /*if (btcoexist->btc_read_1byte(btcoexist, 0x80) == 0xc6)*/ - halbtc8821c2ant_post_state_to_bt(btcoexist, - BT_8821C_2ANT_SCOREBOARD_ONOFF, true); - - /* Enable counter statistics */ - btcoexist->btc_write_1byte(btcoexist, 0x76e, - 0x4); /* 0x76e[3] =1, WLAN_Act control by PTA */ - - /* WLAN_Tx by GNT_WL 0x950[29] = 0 */ - /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x953, 0x20, 0x0); */ - - 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; - - 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); - - 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_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); - - btcoexist->stop_coex_dm = false; - } - - -} - -#if 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 == 12) { /* Get Ant Det from BT */ - - if (board_info->btdm_ant_num_by_ant_det == 1) - 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); - else { - - if (psd_scan->ant_det_psd_scan_peak_val > - (BT_8821C_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION) - * 100) - 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 - 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 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; - case 12: - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(BT is available, result from BT"); - break; - } - CL_PRINTF(cli_buf); - - if (psd_scan->ant_det_result == 12) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d dB", - "PSD Scan Peak Value", - psd_scan->ant_det_psd_scan_peak_val / 100); - CL_PRINTF(cli_buf); - return; - } - - 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; - - if (psd_scan->ant_det_result == 12) - return; - - 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; - } - - } - } - - -} - -#pragma optimize("", off) -void halbtc8821c2ant_psd_maxholddata(IN struct btc_coexist *btcoexist, - IN u32 gen_count) -{ - u32 i = 0; - u32 loop_i_max = 0, loop_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)); - } - - for (i = psd_scan->psd_start_point; - i <= psd_scan->psd_stop_point; i++) { - - /* update max-hold value at each freq point */ - 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 the max value in this seep */ - if (psd_scan->psd_report[i] > loop_val_max) { - loop_val_max = psd_scan->psd_report[i]; - loop_i_max = i; - } - } - - if (gen_count <= BT_8821C_2ANT_ANTDET_PSD_SWWEEPCOUNT) - psd_scan->psd_loop_max_value[gen_count - 1] = loop_val_max; - -} - - -#pragma optimize("", off) -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; -} - -#pragma optimize("", off) -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; - u32 psd_sum = 0, avg_cnt = 0; - u32 i_max = 0, val_max = 0, val_max2 = 0; - - 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_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); - - 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; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "Point=%d, psd_dB_data = %d\n", - i, psd_scan->psd_report[n]); - BTC_TRACE(trace_buf); - - i++; - - } - - halbtc8821c2ant_psd_maxholddata(btcoexist, j); - - psd_scan->psd_gen_count = j; - - /*Accumulate Max PSD value in this loop if the value > threshold */ - if (psd_scan->psd_loop_max_value[j - 1] >= - 4000) { - psd_sum = psd_sum + - psd_scan->psd_loop_max_value[j - - 1]; - avg_cnt++; - } - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "Loop=%d, Max_dB_data = %d\n", - j, psd_scan->psd_loop_max_value[j - - 1]); - BTC_TRACE(trace_buf); - - } - - if (loopcnt == BT_8821C_2ANT_ANTDET_PSD_SWWEEPCOUNT) { - - /* search the Max Value between each-freq-point-max-hold value of all sweep*/ - for (i = 1; - i <= BT_8821C_2ANT_ANTDET_PSD_SWWEEPCOUNT; - i++) { - - if (i == 1) { - i_max = i; - val_max = psd_scan->psd_loop_max_value[i - - 1]; - val_max2 = - psd_scan->psd_loop_max_value[i - - 1]; - } else if ( - psd_scan->psd_loop_max_value[i - - 1] > val_max) { - val_max2 = val_max; - i_max = i; - val_max = psd_scan->psd_loop_max_value[i - - 1]; - } else if ( - psd_scan->psd_loop_max_value[i - - 1] > val_max2) - val_max2 = - psd_scan->psd_loop_max_value[i - - 1]; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "i = %d, val_hold= %d, val_max = %d, val_max2 = %d\n", - i, psd_scan->psd_loop_max_value[i - - 1], - val_max, val_max2); - - BTC_TRACE(trace_buf); - } - - psd_scan->psd_max_value_point = i_max; - psd_scan->psd_max_value = val_max; - psd_scan->psd_max_value2 = val_max2; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "val_max = %d, val_max2 = %d\n", - psd_scan->psd_max_value, - psd_scan->psd_max_value2); - BTC_TRACE(trace_buf); - } - - if (avg_cnt != 0) { - psd_scan->psd_avg_value = (psd_sum / avg_cnt); - if ((psd_sum % avg_cnt) >= (avg_cnt / 2)) - psd_scan->psd_avg_value++; - } else - psd_scan->psd_avg_value = 0; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "AvgLoop=%d, Avg_dB_data = %d\n", - avg_cnt, psd_scan->psd_avg_value); - 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); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx PSD Sweep Stop!!\n"); - BTC_TRACE(trace_buf); - return is_sweep_ok; - -} - -#pragma optimize("", off) -boolean halbtc8821c2ant_psd_antenna_detection(IN struct btc_coexist - *btcoexist) -{ - u32 i = 0; - u32 wlpsd_cent_freq = 2484, wlpsd_span = 2; - s32 wlpsd_offset = -4; - u32 bt_tx_time, bt_le_channel; - 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, 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; - - memset(psd_scan->ant_det_peak_val, 0, 16 * sizeof(u8)); - memset(psd_scan->ant_det_peak_freq, 0, 16 * sizeof(u8)); - - 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; - - bt_tx_time = psd_scan->ant_det_bt_tx_time; - bt_le_channel = psd_scan->ant_det_bt_le_channel; - - 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; - } - } -#if 0 - 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; -#endif - 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, - BT_8821C_2ANT_ANTDET_PSD_SWWEEPCOUNT); - 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); - } - - /* Set Antenna path, switch WiFi to un-certain antenna port */ - /* Set Antenna Path, both GNT_WL/GNT_BT = 1, and control by SW */ - halbtc8821c2ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, FORCE_EXEC, - BT_8821C_2ANT_PHASE_ANTENNA_DET); - - 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 = halbtc8821c2ant_ltecoex_indirect_read_reg( - btcoexist, 0x38); - u32tmp2 = halbtc8821c2ant_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 (!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)) { - 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->ant_det_pre_psdscan_peak_val > - (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->ant_det_pre_psdscan_peak_val / - 100, - BT_8821C_2ANT_ANTDET_PSDTHRES_BACKGROUND - + psd_scan->ant_det_thres_offset); - BTC_TRACE(trace_buf); - 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->ant_det_pre_psdscan_peak_val / - 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)); - - /* Sync WL Rx PSD with BT Tx time because H2C->Mailbox delay */ - delay_ms(20); - - 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, - BT_8821C_2ANT_ANTDET_PSD_SWWEEPCOUNT)) { - ant_det_finish = false; - board_info->btdm_ant_num_by_ant_det = 1; - psd_scan->ant_det_result = 8; - state = 99; - break; - } - -#if 1 - psd_scan->ant_det_psd_scan_peak_val = - psd_scan->psd_max_value; -#endif -#if 0 - psd_scan->ant_det_psd_scan_peak_val = - ((psd_scan->psd_max_value - psd_scan->psd_avg_value) < - 800) ? - psd_scan->psd_max_value : (( - psd_scan->psd_max_value - - psd_scan->psd_max_value2 <= 300) ? - psd_scan->psd_avg_value : - psd_scan->psd_max_value2); -#endif - 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->ant_det_psd_scan_peak_val / 100; - psd_rep2 = psd_scan->ant_det_psd_scan_peak_val - - 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; - 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->ant_det_psd_scan_peak_val > - (BT_8821C_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION) - * 100) { - psd_scan->ant_det_result = 1; - 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 / - 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->ant_det_psd_scan_peak_val > - (BT_8821C_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION - + psd_scan->ant_det_thres_offset) * 100) { - psd_scan->ant_det_result = 2; - 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 / - 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->ant_det_psd_scan_peak_val > - (BT_8821C_2ANT_ANTDET_PSDTHRES_1ANT) * - 100) { - psd_scan->ant_det_result = 3; - 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 / - 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; - 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); - - 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; - break; - } - - } while (!outloop); - - return ant_det_finish; - -} - -#pragma optimize("", off) -boolean 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, ant_det_finish = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); - - ant_det_count++; - - psd_scan->ant_det_try_count = ant_det_count; - - if (scan || roam) { - ant_det_finish = false; - psd_scan->ant_det_result = 6; - } else if (coex_sta->bt_disabled) { - ant_det_finish = false; - psd_scan->ant_det_result = 11; - } else if (coex_sta->num_of_profile >= 1) { - 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; - psd_scan->ant_det_result = 9; - } else if (coex_sta->c2h_bt_inquiry_page) { - ant_det_finish = false; - psd_scan->ant_det_result = 10; - } else { - - ant_det_finish = halbtc8821c2ant_psd_antenna_detection( - btcoexist); - - delay_ms(psd_scan->ant_det_bt_tx_time); - } - - - if (!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, - ant_det_finish == true ? "Yes" : "No"); - BTC_TRACE(trace_buf); - - return ant_det_finish; - -} -#endif - -/* ************************************************************ - * work around function start with wa_halbtc8821c2ant_ - * ************************************************************ - * ************************************************************ - * extern function start with ex_halbtc8821c2ant_ - * ************************************************************ */ -void ex_halbtc8821c2ant_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 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 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 = 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); - - /* 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); - 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 */ - halbtc8821c2ant_enable_gnt_to_gpio(btcoexist, true); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** LTE coex Reg 0x38 (Power-On) = 0x%x**********\n", - halbtc8821c2ant_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_halbtc8821c2ant_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_halbtc8821c2ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean wifi_only) -{ - halbtc8821c2ant_init_hw_config(btcoexist, wifi_only); -} - -void ex_halbtc8821c2ant_init_coex_dm(IN struct btc_coexist *btcoexist) -{ - - halbtc8821c2ant_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_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; - 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 (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_8821c_2ant, glcoex_ver_8821c_2ant, - glcoex_ver_btdesired_8821c_2ant, - bt_coex_ver, - (bt_coex_ver == 0xff ? "Unknown" : - (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 = 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_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")))), - 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", - "Role/IgnWlanAct/Feature", - ((bt_link_info->slave_role) ? "Slave" : "Master"), - ((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); - - 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", - ((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_8821C_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_8821c_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", - "AntDiv/ForceLPS/LPRA", - ((board_info->ant_div_cfg) ? "On" : "Off"), - ((coex_sta->force_lps_on) ? "On" : "Off"), - ((coex_dm->cur_low_penalty_ra) ? "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, - coex_dm->cur_bt_dec_pwr_lvl); - 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 = %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", - "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")); - 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", - "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); - - 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 = %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(Lo-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_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) { - 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; - - halbtc8821c2ant_post_state_to_bt(btcoexist, - BT_8821C_2ANT_SCOREBOARD_ACTIVE, 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) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], IPS LEAVE notify\n"); - BTC_TRACE(trace_buf); - coex_sta->under_ips = false; - - halbtc8821c2ant_post_state_to_bt(btcoexist, - BT_8821C_2ANT_SCOREBOARD_ACTIVE, true); - 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) -{ - 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_on == true) { /* LPS No-32K */ - /* Write WL "Active" in Score-board for PS-TDMA */ - 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_state_to_bt(btcoexist, - BT_8821C_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; - - halbtc8821c2ant_post_state_to_bt(btcoexist, - BT_8821C_2ANT_SCOREBOARD_ACTIVE, true); - } -} - -void ex_halbtc8821c2ant_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); - - halbtc8821c2ant_post_state_to_bt(btcoexist, - BT_8821C_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 */ - halbtc8821c2ant_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); - - halbtc8821c2ant_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); - - halbtc8821c2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8821C_2ANT_PHASE_2G_RUNTIME); - - halbtc8821c2ant_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); - - halbtc8821c2ant_post_state_to_bt(btcoexist, - BT_8821C_2ANT_SCOREBOARD_SCAN, true); - halbtc8821c2ant_post_state_to_bt(btcoexist, - BT_8821C_2ANT_SCOREBOARD_ACTIVE, 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; - - 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); - - halbtc8821c2ant_post_state_to_bt(btcoexist, - BT_8821C_2ANT_SCOREBOARD_SCAN, false); - - halbtc8821c2ant_run_coexist_mechanism(btcoexist); - } - -} - -void ex_halbtc8821c2ant_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); - - 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); - } -} - - -void ex_halbtc8821c2ant_connect_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - - halbtc8821c2ant_post_state_to_bt(btcoexist, - BT_8821C_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); - - halbtc8821c2ant_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); - - halbtc8821c2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8821C_2ANT_PHASE_2G_RUNTIME); - - halbtc8821c2ant_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); - - halbtc8821c2ant_run_coexist_mechanism(btcoexist); - } -} - -void ex_halbtc8821c2ant_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; - 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); - - halbtc8821c2ant_post_state_to_bt(btcoexist, - BT_8821C_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); - - halbtc8821c2ant_action_wifi_under5g(btcoexist); - return; - } - - 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); - - 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); - } - - - halbtc8821c2ant_update_wifi_channel_info(btcoexist, type); -} - -void ex_halbtc8821c2ant_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); - - halbtc8821c2ant_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) - halbtc8821c2ant_run_coexist_mechanism(btcoexist); - -} - -void ex_halbtc8821c2ant_bt_info_notify(IN struct btc_coexist *btcoexist, - IN u8 *tmp_buf, IN u8 length) -{ - u8 i, rsp_source = 0; - boolean wifi_connected = 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_2ANT_MAX) - rsp_source = BT_INFO_SRC_8821C_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_8821C_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_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] : 0); - - 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; - } else - coex_sta->is_setupLink = false; - - if (coex_sta->bt_info_ext & BIT(3)) - coex_sta->cnt_IgnWlanAct++; - - if (coex_sta->bt_create_connection) - coex_sta->cnt_Page++; - - /* 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) - halbtc8821c2ant_update_wifi_channel_info( - btcoexist, BTC_MEDIA_CONNECT); - else - 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)))) { - - 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); - } - } - - } - - - halbtc8821c2ant_update_bt_link_info(btcoexist); - - if (btcoexist->manual_control) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), No run_coexist_mechanism 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 for Stop Coex DM\n"); - BTC_TRACE(trace_buf); - return; - } - - coex_sta->c2h_bt_info_req_sent = false; - - halbtc8821c2ant_run_coexist_mechanism(btcoexist); -} - -void ex_halbtc8821c2ant_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; - - halbtc8821c2ant_post_state_to_bt(btcoexist, - BT_8821C_2ANT_SCOREBOARD_ACTIVE, true); - halbtc8821c2ant_post_state_to_bt(btcoexist, - BT_8821C_2ANT_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); - - 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_state_to_bt(btcoexist, - BT_8821C_2ANT_SCOREBOARD_ACTIVE, false); - halbtc8821c2ant_post_state_to_bt(btcoexist, - BT_8821C_2ANT_SCOREBOARD_ONOFF, false); - btcoexist->stop_coex_dm = true; - coex_sta->wl_rf_off_on_event = false; - - } -} - -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); - - ex_halbtc8821c2ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); - - halbtc8821c2ant_post_state_to_bt(btcoexist, - BT_8821C_2ANT_SCOREBOARD_ACTIVE, false); - halbtc8821c2ant_post_state_to_bt(btcoexist, - BT_8821C_2ANT_SCOREBOARD_ONOFF, 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); - - 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; - - halbtc8821c2ant_post_state_to_bt(btcoexist, - BT_8821C_2ANT_SCOREBOARD_ACTIVE, false); - halbtc8821c2ant_post_state_to_bt(btcoexist, - BT_8821C_2ANT_SCOREBOARD_ONOFF, 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_state_to_bt(btcoexist, - BT_8821C_2ANT_SCOREBOARD_ACTIVE, true); - halbtc8821c2ant_post_state_to_bt(btcoexist, - BT_8821C_2ANT_SCOREBOARD_ONOFF, true); - } -} - -void ex_halbtc8821c2ant_periodical(IN struct btc_coexist *btcoexist) -{ - struct btc_board_info *board_info = &btcoexist->board_info; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ************* Periodical *************\n"); - BTC_TRACE(trace_buf); - -#if (BT_AUTO_REPORT_ONLY_8821C_2ANT == 0) - halbtc8821c2ant_query_bt_info(btcoexist); -#endif - - halbtc8821c2ant_monitor_bt_ctr(btcoexist); - halbtc8821c2ant_monitor_wifi_ctr(btcoexist); - halbtc8821c2ant_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_disabled) { - 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_coex_supported_version == 0xffff)) - coex_sta->bt_coex_supported_version = - btcoexist->btc_get_bt_coex_supported_version( - btcoexist); - - /*coex_sta->bt_ble_scan_type = btcoexist->btc_get_ble_scan_type_from_bt(btcoexist);*/ - - 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); - -#if BT_8821C_2ANT_ANTDET_ENABLE - - if (board_info->btdm_ant_det_finish) { - if ((psd_scan->ant_det_result == 12) && - (psd_scan->ant_det_psd_scan_peak_val == 0) - && (!psd_scan->is_AntDet_running)) - psd_scan->ant_det_psd_scan_peak_val = - btcoexist->btc_get_ant_det_val_from_bt( - btcoexist) * 100; - } - -#endif - } - - - if (halbtc8821c2ant_is_wifibt_status_changed(btcoexist)) - 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) -{ -#if 0 - static u32 ant_det_count = 0, ant_det_fail_count = 0; - struct btc_board_info *board_info = &btcoexist->board_info; - u16 u16tmp; - u8 AntDetval = 0; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx Ext Call AntennaDetect()!!\n"); - BTC_TRACE(trace_buf); - -#if BT_8821C_2ANT_ANTDET_ENABLE - - 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); - - psd_scan->is_AntDet_running = true; - - halbtc8821c2ant_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; - psd_scan->ant_det_try_count = 1; - psd_scan->ant_det_fail_count = 0; - board_info->btdm_ant_num_by_ant_det = (u16tmp & - BIT(3)) ? 1 : 2; - psd_scan->ant_det_result = 12; - - psd_scan->ant_det_psd_scan_peak_val = - btcoexist->btc_get_ant_det_val_from_bt( - btcoexist) * 100; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Result from BT (%d-Ant)\n", - board_info->btdm_ant_num_by_ant_det); - BTC_TRACE(trace_buf); - } else - board_info->btdm_ant_det_finish = - halbtc8821c2ant_psd_antenna_detection_check( - btcoexist); - - btcoexist->bdontenterLPS = false; - - 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); - - /*for 8821c, btc_set_bt_trx_mask is just used to - notify BT stop le tx and Ant Det Result , not set BT RF TRx Mask */ - if (psd_scan->ant_det_result != 12) { - - AntDetval = (u8)(( - psd_scan->ant_det_psd_scan_peak_val - / 100) & 0x7f); - - AntDetval = - (board_info->btdm_ant_num_by_ant_det - == 1) ? (AntDetval | 0x80) : - AntDetval; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxx AntennaDetect(), Ant Count = %d, PSD Val = %d\n", - ((AntDetval & - 0x80) ? 1 - : 2), AntDetval - & 0x7f); - BTC_TRACE(trace_buf); - - if (btcoexist->btc_set_bt_trx_mask( - btcoexist, AntDetval)) - BTC_SPRINTF(trace_buf, - BT_TMP_BUF_SIZE, - "xxxxxx AntennaDetect(), Notify BT stop le tx by set_bt_trx_mask ok!\n"); - else - BTC_SPRINTF(trace_buf, - BT_TMP_BUF_SIZE, - "xxxxxx AntennaDetect(), Notify BT stop le tx by set_bt_trx_mask fail!\n"); - - BTC_TRACE(trace_buf); - } - - } 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; - psd_scan->is_AntDet_running = false; - - /* 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); - } 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); - - if (psd_scan->ant_det_inteval_count == 8) - btcoexist->bdontenterLPS = true; - else - btcoexist->bdontenterLPS = false; - } - - } -#endif -#endif - -} - - -void ex_halbtc8821c2ant_display_ant_detection(IN struct btc_coexist *btcoexist) -{ -#if 0 -#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); - } -#endif -#endif -} - - -#endif - -#endif /* #if (RTL8821C_SUPPORT == 1) */ - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8821c2ant.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8821c2ant.h deleted file mode 100644 index 94a40078ab3d..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8821c2ant.h +++ /dev/null @@ -1,479 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ - -#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) - -#if (RTL8821C_SUPPORT == 1) - -/* ******************************************* - * 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 - - -#define BT_INFO_8821C_2ANT_B_FTP BIT(7) -#define BT_INFO_8821C_2ANT_B_A2DP BIT(6) -#define BT_INFO_8821C_2ANT_B_HID BIT(5) -#define BT_INFO_8821C_2ANT_B_SCO_BUSY BIT(4) -#define BT_INFO_8821C_2ANT_B_ACL_BUSY BIT(3) -#define BT_INFO_8821C_2ANT_B_INQ_PAGE BIT(2) -#define BT_INFO_8821C_2ANT_B_SCO_ESCO BIT(1) -#define BT_INFO_8821C_2ANT_B_CONNECTION BIT(0) - -#define BTC_RSSI_COEX_THRESH_TOL_8821C_2ANT 2 - - -#define BT_8821C_2ANT_WIFI_RSSI_COEXSWITCH_THRES1 80 /* unit: % WiFi RSSI Threshold for 2-Ant free-run/2-Ant TDMA translation, default = 42 */ -#define BT_8821C_2ANT_BT_RSSI_COEXSWITCH_THRES1 80 /* unit: % BT RSSI Threshold for 2-Ant free-run/2-Ant TDMA translation, default = 46 */ -#define BT_8821C_2ANT_WIFI_RSSI_COEXSWITCH_THRES2 80 /* unit: % WiFi RSSI Threshold for 1-Ant TDMA/1-Ant PS-TDMA translation, default = 42 */ -#define BT_8821C_2ANT_BT_RSSI_COEXSWITCH_THRES2 80 /* unit: % BT RSSI Threshold for 1-Ant TDMA/1-Ant PS-TDMA translation, default = 46 */ -#define BT_8821C_2ANT_DEFAULT_ISOLATION 15 /* unit: dB */ -#define BT_8821C_2ANT_WIFI_MAX_TX_POWER 15 /* unit: dBm */ -#define BT_8821C_2ANT_BT_MAX_TX_POWER 3 /* unit: dBm */ -#define BT_8821C_2ANT_WIFI_SIR_THRES1 -15 /* unit: dB */ -#define BT_8821C_2ANT_WIFI_SIR_THRES2 -30 /* unit: dB */ -#define BT_8821C_2ANT_BT_SIR_THRES1 -15 /* unit: dB */ -#define BT_8821C_2ANT_BT_SIR_THRES2 -30 /* unit: dB */ - - -/* for Antenna detection */ -#define BT_8821C_2ANT_ANTDET_PSDTHRES_BACKGROUND 50 -#define BT_8821C_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION 70 -#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 60000 -#define BT_8821C_2ANT_ANTDET_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 - -enum bt_8821c_2ant_signal_state { - BT_8821C_2ANT_SIG_STA_SET_TO_LOW = 0x0, - BT_8821C_2ANT_SIG_STA_SET_BY_HW = 0x0, - BT_8821C_2ANT_SIG_STA_SET_TO_HIGH = 0x1, - BT_8821C_2ANT_SIG_STA_MAX -}; - -enum bt_8821c_2ant_path_ctrl_owner { - BT_8821C_2ANT_PCO_BTSIDE = 0x0, - BT_8821C_2ANT_PCO_WLSIDE = 0x1, - BT_8821C_2ANT_PCO_MAX -}; - -enum bt_8821c_2ant_gnt_ctrl_type { - BT_8821C_2ANT_GNT_TYPE_CTRL_BY_PTA = 0x0, - BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW = 0x1, - BT_8821C_2ANT_GNT_TYPE_MAX -}; - -enum bt_8821c_2ant_gnt_ctrl_block { - BT_8821C_2ANT_GNT_BLOCK_RFC_BB = 0x0, - BT_8821C_2ANT_GNT_BLOCK_RFC = 0x1, - BT_8821C_2ANT_GNT_BLOCK_BB = 0x2, - BT_8821C_2ANT_GNT_BLOCK_MAX -}; - -enum bt_8821c_2ant_lte_coex_table_type { - BT_8821C_2ANT_CTT_WL_VS_LTE = 0x0, - BT_8821C_2ANT_CTT_BT_VS_LTE = 0x1, - BT_8821C_2ANT_CTT_MAX -}; - -enum bt_8821c_2ant_lte_break_table_type { - BT_8821C_2ANT_LBTT_WL_BREAK_LTE = 0x0, - BT_8821C_2ANT_LBTT_BT_BREAK_LTE = 0x1, - BT_8821C_2ANT_LBTT_LTE_BREAK_WL = 0x2, - BT_8821C_2ANT_LBTT_LTE_BREAK_BT = 0x3, - BT_8821C_2ANT_LBTT_MAX -}; - -enum bt_info_src_8821c_2ant { - BT_INFO_SRC_8821C_2ANT_WIFI_FW = 0x0, - BT_INFO_SRC_8821C_2ANT_BT_RSP = 0x1, - BT_INFO_SRC_8821C_2ANT_BT_ACTIVE_SEND = 0x2, - BT_INFO_SRC_8821C_2ANT_MAX -}; - -enum bt_8821c_2ant_bt_status { - BT_8821C_2ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, - BT_8821C_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, - BT_8821C_2ANT_BT_STATUS_INQ_PAGE = 0x2, - BT_8821C_2ANT_BT_STATUS_ACL_BUSY = 0x3, - BT_8821C_2ANT_BT_STATUS_SCO_BUSY = 0x4, - BT_8821C_2ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, - BT_8821C_2ANT_BT_STATUS_MAX -}; - -enum bt_8821c_2ant_coex_algo { - BT_8821C_2ANT_COEX_ALGO_UNDEFINED = 0x0, - BT_8821C_2ANT_COEX_ALGO_SCO = 0x1, - BT_8821C_2ANT_COEX_ALGO_HID = 0x2, - BT_8821C_2ANT_COEX_ALGO_A2DP = 0x3, - BT_8821C_2ANT_COEX_ALGO_A2DP_PANHS = 0x4, - BT_8821C_2ANT_COEX_ALGO_PANEDR = 0x5, - BT_8821C_2ANT_COEX_ALGO_PANHS = 0x6, - BT_8821C_2ANT_COEX_ALGO_PANEDR_A2DP = 0x7, - BT_8821C_2ANT_COEX_ALGO_PANEDR_HID = 0x8, - 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_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, - BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_ANTDIV = 0x2, - BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_MAC = 0x3, - BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_BT = 0x4, - BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_MAX -}; - -enum bt_8821c_2ant_ext_ant_switch_pos_type { - BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_BT = 0x0, - BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_WLG = 0x1, - BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_WLA = 0x2, - BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_NOCARE = 0x3, - BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_MAX -}; - -enum bt_8821c_2ant_ext_band_switch_pos_type { - BT_8821C_2ANT_EXT_BAND_SWITCH_TO_WLG = 0x0, - BT_8821C_2ANT_EXT_BAND_SWITCH_TO_WLA = 0x1, - BT_8821C_2ANT_EXT_BAND_SWITCH_TO_MAX -}; - -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 { - BT_8821C_2ANT_PHASE_COEX_INIT = 0x0, - 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_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) -}; - - - -struct coex_dm_8821c_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_8821c_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; - 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; - 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_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; - - 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 wl_rf_off_on_event; - 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; - u8 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; - - u16 bt_reg_vendor_ac; - u16 bt_reg_vendor_ae; - - boolean is_setupLink; -}; - - -#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 { - - 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 ext_ant_switch_diversity; /* If diversity on */ -}; - -#define BT_8821C_2ANT_ANTDET_PSD_POINTS 256 /* MAX:1024 */ -#define BT_8821C_2ANT_ANTDET_PSD_AVGNUM 1 /* MAX:3 */ -#define BT_8821C_2ANT_ANTDET_BUF_LEN 16 - -struct psdscan_sta_8821c_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_8821C_2ANT_ANTDET_BUF_LEN]; - u8 ant_det_peak_freq[BT_8821C_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; - 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_AntDet_running; - boolean is_psd_show_max_only; -}; - - -/* ******************************************* - * The following is interface which will notify coex module. - * ******************************************* */ -void ex_halbtc8821c2ant_power_on_setting(IN struct btc_coexist *btcoexist); -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); -void ex_halbtc8821c2ant_init_coex_dm(IN struct btc_coexist *btcoexist); -void ex_halbtc8821c2ant_ips_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8821c2ant_lps_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -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); -void ex_halbtc8821c2ant_connect_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8821c2ant_media_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -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_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_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); -void ex_halbtc8821c2ant_display_ant_detection(IN struct btc_coexist *btcoexist); - - -#else -#define ex_halbtc8821c2ant_power_on_setting(btcoexist) -#define ex_halbtc8821c2ant_pre_load_firmware(btcoexist) -#define ex_halbtc8821c2ant_init_hw_config(btcoexist, wifi_only) -#define ex_halbtc8821c2ant_init_coex_dm(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_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_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_coex_info(btcoexist) -#define ex_halbtc8821c2ant_display_ant_detection(btcoexist) -#define ex_halbtc8821c2ant_antenna_detection(btcoexist, cent_freq, offset, span, seconds) -#endif - -#endif - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8821cwifionly.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8821cwifionly.c deleted file mode 100644 index 0291a2f9a4b7..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8821cwifionly.c +++ /dev/null @@ -1,187 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ -#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/rtl8188eu/hal/btc/halbtc8821cwifionly.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8821cwifionly.h deleted file mode 100644 index 65c57c641616..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8821cwifionly.h +++ /dev/null @@ -1,71 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ -#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/rtl8188eu/hal/btc/halbtc8822b1ant.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8822b1ant.c deleted file mode 100644 index 167c9930c4e7..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8822b1ant.c +++ /dev/null @@ -1,6841 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.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 = 20161026; -u32 glcoex_ver_8822b_1ant = 0x34; -u32 glcoex_ver_btdesired_8822b_1ant = 0x28; - - -/* ************************************************************ - * 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); -} - -/* -rx agg size setting : -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) -{ -#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 -} - -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_state_to_bt( - IN struct btc_coexist *btcoexist, - IN u16 type, - IN boolean state -) -{ - - halbtc8822b1ant_write_score_board(btcoexist, (u16) type, state); - -} - - -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; - } - -} - - - -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; - - 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_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 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 = 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; - - 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; - 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 (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 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, 0x1e, 0x3, 0x10, 0x54); - 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); -} -/*rf4 type by efuse , and for ant at main aux inverse use , because is 2x2 ,and control types are the same ,does not need */ - -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_SP3T; /* SP3T */; - break; - } - - -} - -/*anttenna control by bb mac bt antdiv pta to write 0x4c 0xcb4,0xcbd*/ - -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; - /* 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: - 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 conctrol 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 conctrol 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, 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*/ - -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; - /* 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 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); - /* for test : s3 bt disappear , fail rate 1/600*/ -/* - halbtc8822b1ant_ignore_wlan_act(btcoexist, NORMAL_EXEC, true); -*/ -/*set sw gnt wl bt high*/ - halbtc8822b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, - BT_8822B_1ANT_PHASE_5G_RUNTIME); - - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -/* - 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, 1); -} - -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, 3); - } 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, - 6); - } 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, - 4); - } - - /* - 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); - } - */ -} - -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; - - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x45e, 0x8, 0x1); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (bt sco hid only busy) **********\n"); - BTC_TRACE(trace_buf); - - /*SCO + wifi connected idle or busy / 0x778=1@wifi slot*/ - if (bt_link_info->sco_exist) { - - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x45e, 0x8, 0x1); - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); - /*case16 for connect SCO first then connect a2sp fail issue*/ - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 16); - - } else { /* HID + wifi connected idle or busy / 0x778=1@wifi slot */ - - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x45e, 0x8, 0x1); - - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); - /*case16 for connect HID first then connect a2sp fail issue*/ - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 16); - - } -} - -/*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; - 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); - 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 connected idle or busy / 0x778=1@wifi slot */ - - - - - btcoexist->btc_write_1byte_bitmask( - btcoexist, 0x45e, 0x8, 0x1); - - - - halbtc8822b1ant_action_bt_sco_hid_only_busy(btcoexist, - wifi_status); - return; - } else if ( - bt_link_info->a2dp_only) { /* A2DP + wifi connected idle or busy */ - if (BT_8822B_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifi_status) { - - - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x45e, - 0x8, 0x1); - - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 32); - halbtc8822b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 0); - } else { - if (coex_sta->scan_ap_num >= - BT_8822B_1ANT_WIFI_NOISY_THRESH) { - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, - 17); - } else { - - - - - btcoexist->btc_write_1byte_bitmask( - btcoexist, 0x45e, 0x8, 0x1); - - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, - 42); - - halbtc8822b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 1); - } -/* - 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) */ - - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x45e, 0x8, 0x1); - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 47); - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 6); - } else if (bt_link_info->hid_exist && - bt_link_info->a2dp_exist) { /* HID+A2DP */ - - btcoexist->btc_write_1byte_bitmask( - btcoexist, 0x45e, 0x8, 0x1); - if (!wifi_busy) { -/*a2dp glitch while wl idle , change the 0x6c0=5a5a5a5a->5555or aaaa55aa*/ - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, - 32); - } else if (wifi_bw == 0) { /* 11bg mode */ - halbtc8822b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 1); - halbtc8822b1ant_set_wltoggle_coex_table( - btcoexist, - NORMAL_EXEC, - 0x3, 0xaa, - 0x5a, 0xaa, - 0xaa); - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, - 49); - } else { - /*if in open space , and ask wl tp , 0x60=6135031111,55555555,aaaa55aa*/ - halbtc8822b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 1); - halbtc8822b1ant_set_wltoggle_coex_table(btcoexist, NORMAL_EXEC, 0x2, 0xaa, 0x5a, 0xaa, 0xaa); - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 49); -} - /* - 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 - */ - - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x45e, 0x8, 0x1); - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 47); - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 1); - } else { - /* BT no-profile busy (0x9) */ - - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x45e, 0x8, 0x1); - 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, - 6); - } -} - -/*""""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); - /*for a2dp glitch,change from 1 to 15*/ - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 15); - } 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; - 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_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, 1); - } - } 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); - - /* - - 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); - */ - - - - 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 ((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)) { -*/ - if (BT_8822B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == - coex_dm->bt_status) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** scan ap <3 coex table=0xaaaaaaaa **********\n"); - BTC_TRACE(trace_buf); - - halbtc8822b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 7); - } else - - halbtc8822b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 1); - - - - /* - 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); - */ - } - } -} - -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; - } - - 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; - } - - 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; - - 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 */ - - halbtc8822b1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, false); - - /* 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); - /*GNT_BT=1 while select both */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x763, 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_state_to_bt(btcoexist, - BT_8822B_1ANT_SCOREBOARD_ONOFF, 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_init_hw_config_without_bt(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; - - - /* 0xf0[15:12] --> Chip Cut information */ - coex_sta->cut_version = (btcoexist->btc_read_1byte(btcoexist, - 0xf1) & 0xf0) >> 4; - - /* enable TBTT interrupt */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, - 0x1); - - /* enable GNT_WL */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x40, 0x0); - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x1, 0x0); - - /* Antenna config */ - 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 conctrol pin */ - - - /* 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); - - /*enable sw control gnt_wl=1 / gnt_bt=1 */ - btcoexist->btc_write_1byte(btcoexist, 0x73, 0x0e); - - btcoexist->btc_write_4byte(btcoexist, 0x1704, 0x0000ff00); - - btcoexist->btc_write_4byte(btcoexist, 0x1700, 0xc00f0038); - - - /* ant switch WL2G or WL5G*/ - 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); - - else - - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbd, - 0x3, 2); - -} - -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; - - 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_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); -/* - 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); - 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_power_on_setting_without_bt(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, - " 8822b 1-Ant PowerOn Setting without bt\n"); - 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)); - - - /* SD1 Chunchu red x issue */ - btcoexist->btc_write_1byte(btcoexist, 0xff1a, 0x0); - - 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); - - - -} - - -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_hw_config_without_bt(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_without_bt(btcoexist, true, wifi_only); - btcoexist->stop_coex_dm = true; -} - -void ex_halbtc8822b1ant_antenna_switch_without_bt(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) - - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbd, - 0x3, 1); - - else - btcoexist->btc_write_1byte_bitmask(btcoexist, - 0xcbd, 0x3, 2); - - -} - -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 fa_ofdm, fa_cck, cca_ofdm, cca_cck; - u32 u32tmp[4]; - u32 fa_of_dm; - u32 fw_ver = 0, bt_patch_ver = 0; - static u8 pop_report_in_10s = 0; - u32 phyver = 0; - /*u32 pnp_wake_cnt=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);*/ - 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); - 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, - ((coex_sta->bt_coex_supported_version & 0xff00) >> - 8), - (((coex_sta->bt_coex_supported_version & 0xff00) >> - 8) >= - 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 ", - "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/ %02x", - "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 & 0xff00) >> 8)); - 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, 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", - "Wifi-HiPri/ 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); - - 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); - /* - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** pnp_wake_cnt = %d\n", pnp_wake_cnt); - 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; - - /* 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_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_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) -{ - 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_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 */ - 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); - - } -} - - -void ex_halbtc8822b1ant_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); - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - - - - if (btcoexist->manual_control || - btcoexist->stop_coex_dm) - return; - - 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_notify_5g_scan_start) **********\n"); - BTC_TRACE(trace_buf); - halbtc8822b1ant_action_wifi_under5g(btcoexist); - return; - } - - /* under 2.4G */ - coex_sta->wifi_is_high_pri_task = true; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (scan_notify_2g_scan_start) **********\n"); - BTC_TRACE(trace_buf); - - if (!wifi_connected) { /* non-connected scan */ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** wifi is not connected scan **********\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 is connected scan **********\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 is not connected **********\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 is connected **********\n"); - BTC_TRACE(trace_buf); - 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) **********\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 wifi is 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) -{ - - 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_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); - - } 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) - 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 { - /* 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_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 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_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); - - 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) -{ - 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_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, false); - halbtc8822b1ant_post_state_to_bt(btcoexist, - BT_8822B_1ANT_SCOREBOARD_ONOFF, 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) { - /*pnp_wake_cnt++;*/ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Pnp notify to WAKE UP\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); - - 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) -{ - - struct btc_board_info *board_info = &btcoexist->board_info; - boolean wifi_busy = false; - u16 bt_scoreboard_val = 0; - u32 bt_patch_ver; - static u8 cnt = 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_1ANT == 0) - halbtc8822b1ant_query_bt_info(btcoexist); -#endif - - halbtc8822b1ant_monitor_bt_ctr(btcoexist); - halbtc8822b1ant_monitor_wifi_ctr(btcoexist); - - halbtc8822b1ant_monitor_bt_enable_disable(btcoexist); - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - halbtc8822b1ant_read_score_board(btcoexist, &bt_scoreboard_val); - - if (wifi_busy) { - halbtc8822b1ant_post_state_to_bt(btcoexist, - BT_8822B_1ANT_SCOREBOARD_WLBUSY, true); - if (bt_scoreboard_val & BIT(6)) - halbtc8822b1ant_query_bt_info(btcoexist); - } else { - halbtc8822b1ant_post_state_to_bt(btcoexist, - BT_8822B_1ANT_SCOREBOARD_WLBUSY, false); - } - - /* 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_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 (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 - -#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); - -} - -void ex_halbtc8822b1ant_init_hw_config_without_bt(IN struct btc_coexist - *btcoexist) -{ - /* enable GNT_WL */ - - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x1, - 0x0); - - /* Antenna config */ - 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 conctrol pin */ - - - /* 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); - - /*enable sw control gnt_wl=1 / gnt_bt=1 */ - btcoexist->btc_write_1byte(btcoexist, 0x73, 0x0e); - - btcoexist->btc_write_4byte(btcoexist, 0x1704, - 0x0000ff00); - - btcoexist->btc_write_4byte(btcoexist, 0x1700, - 0xc00f0038); -} - -#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ - - - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8822b1ant.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8822b1ant.h deleted file mode 100644 index 05f7253530df..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8822b1ant.h +++ /dev/null @@ -1,434 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ - -#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) - -#if (RTL8822B_SUPPORT == 1) - -/* ******************************************* - * The following is for 8822B 1ANT BT Co-exist definition - * ******************************************* */ -#define BT_AUTO_REPORT_ONLY_8822B_1ANT 1 - -#define BT_INFO_8822B_1ANT_B_FTP BIT(7) -#define BT_INFO_8822B_1ANT_B_A2DP BIT(6) -#define BT_INFO_8822B_1ANT_B_HID BIT(5) -#define BT_INFO_8822B_1ANT_B_SCO_BUSY BIT(4) -#define BT_INFO_8822B_1ANT_B_ACL_BUSY BIT(3) -#define BT_INFO_8822B_1ANT_B_INQ_PAGE BIT(2) -#define BT_INFO_8822B_1ANT_B_SCO_ESCO BIT(1) -#define BT_INFO_8822B_1ANT_B_CONNECTION BIT(0) - -#define BT_INFO_8822B_1ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ - (((_BT_INFO_EXT_&BIT(0))) ? true : false) - -#define BTC_RSSI_COEX_THRESH_TOL_8822B_1ANT 2 - -#define BT_8822B_1ANT_WIFI_NOISY_THRESH 150 /* max: 255 */ - -/* for Antenna detection */ -#define BT_8822B_1ANT_ANTDET_PSDTHRES_BACKGROUND 50 -#define BT_8822B_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION 70 -#define BT_8822B_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION 55 -#define BT_8822B_1ANT_ANTDET_PSDTHRES_1ANT 35 -#define BT_8822B_1ANT_ANTDET_RETRY_INTERVAL 10 /* retry timer if ant det is fail, unit: second */ -#define BT_8822B_1ANT_ANTDET_ENABLE 0 -#define BT_8822B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE 0 - -#define BT_8822B_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT 30000 - - - -enum bt_8822b_1ant_signal_state { - BT_8822B_1ANT_SIG_STA_SET_TO_LOW = 0x0, - BT_8822B_1ANT_SIG_STA_SET_BY_HW = 0x0, - BT_8822B_1ANT_SIG_STA_SET_TO_HIGH = 0x1, - BT_8822B_1ANT_SIG_STA_MAX -}; - -enum bt_8822b_1ant_path_ctrl_owner { - BT_8822B_1ANT_PCO_BTSIDE = 0x0, - BT_8822B_1ANT_PCO_WLSIDE = 0x1, - BT_8822B_1ANT_PCO_MAX -}; - -enum bt_8822b_1ant_gnt_ctrl_type { - BT_8822B_1ANT_GNT_CTRL_BY_PTA = 0x0, - BT_8822B_1ANT_GNT_CTRL_BY_SW = 0x1, - BT_8822B_1ANT_GNT_CTRL_MAX -}; - -enum bt_8822b_1ant_gnt_ctrl_block { - BT_8822B_1ANT_GNT_BLOCK_RFC_BB = 0x0, - BT_8822B_1ANT_GNT_BLOCK_RFC = 0x1, - BT_8822B_1ANT_GNT_BLOCK_BB = 0x2, - BT_8822B_1ANT_GNT_BLOCK_MAX -}; - -enum bt_8822b_1ant_lte_coex_table_type { - BT_8822B_1ANT_CTT_WL_VS_LTE = 0x0, - BT_8822B_1ANT_CTT_BT_VS_LTE = 0x1, - BT_8822B_1ANT_CTT_MAX -}; - -enum bt_8822b_1ant_lte_break_table_type { - BT_8822B_1ANT_LBTT_WL_BREAK_LTE = 0x0, - BT_8822B_1ANT_LBTT_BT_BREAK_LTE = 0x1, - BT_8822B_1ANT_LBTT_LTE_BREAK_WL = 0x2, - BT_8822B_1ANT_LBTT_LTE_BREAK_BT = 0x3, - BT_8822B_1ANT_LBTT_MAX -}; - -enum bt_info_src_8822b_1ant { - BT_INFO_SRC_8822B_1ANT_WIFI_FW = 0x0, - BT_INFO_SRC_8822B_1ANT_BT_RSP = 0x1, - BT_INFO_SRC_8822B_1ANT_BT_ACTIVE_SEND = 0x2, - BT_INFO_SRC_8822B_1ANT_MAX -}; - -enum bt_8822b_1ant_bt_status { - BT_8822B_1ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, - BT_8822B_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, - BT_8822B_1ANT_BT_STATUS_INQ_PAGE = 0x2, - BT_8822B_1ANT_BT_STATUS_ACL_BUSY = 0x3, - BT_8822B_1ANT_BT_STATUS_SCO_BUSY = 0x4, - BT_8822B_1ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, - BT_8822B_1ANT_BT_STATUS_MAX -}; - -enum bt_8822b_1ant_wifi_status { - BT_8822B_1ANT_WIFI_STATUS_NON_CONNECTED_IDLE = 0x0, - BT_8822B_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN = 0x1, - BT_8822B_1ANT_WIFI_STATUS_CONNECTED_SCAN = 0x2, - BT_8822B_1ANT_WIFI_STATUS_CONNECTED_SPECIFIC_PKT = 0x3, - BT_8822B_1ANT_WIFI_STATUS_CONNECTED_IDLE = 0x4, - BT_8822B_1ANT_WIFI_STATUS_CONNECTED_BUSY = 0x5, - BT_8822B_1ANT_WIFI_STATUS_MAX -}; - -enum bt_8822b_1ant_coex_algo { - BT_8822B_1ANT_COEX_ALGO_UNDEFINED = 0x0, - BT_8822B_1ANT_COEX_ALGO_SCO = 0x1, - BT_8822B_1ANT_COEX_ALGO_HID = 0x2, - BT_8822B_1ANT_COEX_ALGO_A2DP = 0x3, - BT_8822B_1ANT_COEX_ALGO_A2DP_PANHS = 0x4, - BT_8822B_1ANT_COEX_ALGO_PANEDR = 0x5, - 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, -}; - -enum bt_8822b_1ant_ext_ant_switch_type { - BT_8822B_1ANT_EXT_ANT_SWITCH_USE_SPDT = 0x0, - BT_8822B_1ANT_EXT_ANT_SWITCH_USE_SP3T = 0x1, - BT_8822B_1ANT_EXT_ANT_SWITCH_MAX -}; - -enum bt_8822b_1ant_ext_ant_switch_ctrl_type { - BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW = 0x0, - BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_PTA = 0x1, - BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_ANTDIV = 0x2, - BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_MAC = 0x3, - BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_BT = 0x4, - BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_MAX -}; - -enum bt_8822b_1ant_ext_ant_switch_pos_type { - BT_8822B_1ANT_EXT_ANT_SWITCH_TO_BT = 0x0, - BT_8822B_1ANT_EXT_ANT_SWITCH_TO_WLG = 0x1, - BT_8822B_1ANT_EXT_ANT_SWITCH_TO_WLA = 0x2, - BT_8822B_1ANT_EXT_ANT_SWITCH_TO_NOCARE = 0x3, - BT_8822B_1ANT_EXT_ANT_SWITCH_TO_MAX -}; - -enum bt_8822b_1ant_phase { - BT_8822B_1ANT_PHASE_COEX_INIT = 0x0, - 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, - BT_8822B_1ANT_PHASE_BTMPMODE = 0x5, - 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 */ - u32 pre_ant_pos_type; - u32 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; - boolean limited_dig; - - 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 pre_algorithm; - u8 cur_algorithm; - 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; - - u32 pre_ext_ant_switch_status; - u32 cur_ext_ant_switch_status; - - u8 error_condition; -}; - -struct coex_sta_8822b_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 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; - 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 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_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 concurrent_rx_mode_on; - - u32 special_pkt_period_cnt; - - u16 score_board; - - 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; -}; - -struct rfe_type_8822b_1ant { - - 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 */ -}; - - -#define BT_8822B_1ANT_ANTDET_PSD_POINTS 256 /* MAX:1024 */ -#define BT_8822B_1ANT_ANTDET_PSD_AVGNUM 1 /* MAX:3 */ -#define BT_8822B_1ANT_ANTDET_BUF_LEN 16 - -struct psdscan_sta_8822b_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_8822B_1ANT_ANTDET_BUF_LEN]; - u8 ant_det_peak_freq[BT_8822B_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_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); -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); -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, - IN u8 type); -void ex_halbtc8822b1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -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); -void ex_halbtc8822b1ant_halt_notify(IN struct btc_coexist *btcoexist); -void ex_halbtc8822b1ant_pnp_notify(IN struct btc_coexist *btcoexist, - IN u8 pnp_state); -void ex_halbtc8822b1ant_ScoreBoardStatusNotify(IN struct btc_coexist *btcoexist, - IN u8 *tmp_buf, IN u8 length); -void ex_halbtc8822b1ant_coex_dm_reset(IN struct btc_coexist *btcoexist); -void ex_halbtc8822b1ant_periodical(IN struct btc_coexist *btcoexist); -void ex_halbtc8822b1ant_display_coex_info(IN struct btc_coexist *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); - -#else -#define ex_halbtc8822b1ant_power_on_setting(btcoexist) -#define ex_halbtc8822b1ant_pre_load_firmware(btcoexist) -#define ex_halbtc8822b1ant_init_hw_config(btcoexist, wifi_only) -#define ex_halbtc8822b1ant_init_coex_dm(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) -#define ex_halbtc8822b1ant_bt_info_notify(btcoexist, tmp_buf, length) -#define ex_halbtc8822b1ant_rf_status_notify(btcoexist, type) -#define ex_halbtc8822b1ant_halt_notify(btcoexist) -#define ex_halbtc8822b1ant_pnp_notify(btcoexist, pnp_state) -#define ex_halbtc8822b1ant_ScoreBoardStatusNotify(btcoexist, tmp_buf, length) -#define ex_halbtc8822b1ant_coex_dm_reset(btcoexist) -#define ex_halbtc8822b1ant_periodical(btcoexist) -#define ex_halbtc8822b1ant_display_coex_info(btcoexist) -#define ex_halbtc8822b1ant_antenna_detection(btcoexist, cent_freq, offset, span, seconds) -#define ex_halbtc8822b1ant_antenna_isolation(btcoexist, cent_freq, offset, span, seconds) -#define ex_halbtc8822b1ant_psd_scan(btcoexist, cent_freq, offset, span, seconds) -#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/rtl8188eu/hal/btc/halbtc8822b2ant.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8822b2ant.c deleted file mode 100644 index 82927981ae62..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8822b2ant.c +++ /dev/null @@ -1,5544 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.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_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; - -const char *const glbt_info_src_8822b_2ant[] = { - "BT Info[wifi fw]", - "BT Info[bt rsp]", - "BT Info[bt auto report]", -}; - -u32 glcoex_ver_date_8822b_2ant = 20161026; -u32 glcoex_ver_8822b_2ant = 0x34; -u32 glcoex_ver_btdesired_8822b_2ant = 0x28; - -/* ************************************************************ - * local function proto type if needed - * ************************************************************ - * ************************************************************ - * local function start with halbtc8822b2ant_ - * ************************************************************ */ -u8 halbtc8822b2ant_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_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; -} - -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; -} - -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; - - - /* - 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; - */ - - - - - - /* - 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); - - */ -} - - -void halbtc8822b2ant_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 halbtc8822b2ant_query_bt_info(IN struct btc_coexist *btcoexist) -{ - u8 h2c_parameter[1] = {0}; - boolean RTL97F_8822B = false; - - if (RTL97F_8822B == true) - return; - - coex_sta->c2h_bt_info_req_sent = true; - - h2c_parameter[0] |= BIT(0); /* trigger */ - - btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); -} - -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; - - 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->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; - } - } - -} - -void halbtc8822b2ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) -{ -#if 0 - s32 wifi_rssi = 0; - boolean wifi_busy = false, wifi_under_b_mode = false; - static u8 cck_lock_counter = 0; - u32 total_cnt, reg_val1, reg_val2; - - 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 { - - reg_val1 = btcoexist->btc_read_4byte(btcoexist, 0xf00); - reg_val2 = btcoexist->btc_read_4byte(btcoexist, 0xf04); - coex_sta->crc_ok_cck = reg_val2 & 0xffff; - coex_sta->crc_err_cck = (reg_val1 & 0xffff) + ((reg_val2 - & 0xffff0000) >> 16); - - reg_val1 = btcoexist->btc_read_4byte(btcoexist, 0xf0c); - coex_sta->crc_ok_11n_agg = reg_val1 & 0xffff; - coex_sta->crc_err_11n_agg = (reg_val1 & 0xffff0000) >> - 16; - - reg_val1 = btcoexist->btc_read_4byte(btcoexist, 0xf10); - coex_sta->crc_ok_11n = reg_val1 & 0xffff; - coex_sta->crc_err_11n = (reg_val1 & 0xffff0000) >> 16; - - reg_val1 = btcoexist->btc_read_4byte(btcoexist, 0xf14); - coex_sta->crc_ok_11g = reg_val1 & 0xffff; - coex_sta->crc_err_11n = (reg_val1 & 0xffff0000) >> 16; - } - - - /* 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_2ANT_BT_STATUS_ACL_BUSY) || - (coex_dm->bt_status == - BT_8822B_2ANT_BT_STATUS_ACL_SCO_BUSY) || - (coex_dm->bt_status == - BT_8822B_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 -} - -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; - static u8 pre_hid_busy_num = 0; - 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; - 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->bt_disabled) { - - if (coex_sta->hid_busy_num != pre_hid_busy_num) { - pre_hid_busy_num = coex_sta->hid_busy_num; - return true; - } - } - } - - return false; -} - - -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_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); -} - -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 == true) - 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)) { - h2c_parameter[0] = - 0x1; /* enable BT AFH skip WL channel for 8822b 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); - -} - -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 == true) - 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); -} - -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 == true) - 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; -} - -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 == true) - return; - - h2c_parameter[0] = dec_bt_pwr_lvl; - - btcoexist->btc_fill_h2c(btcoexist, 0x62, 1, h2c_parameter); -} - -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; -} - - -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 - -} - - -void halbtc8822b2ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, - IN boolean enable_auto_report) -{ - u8 h2c_parameter[1] = {0}; - u32 RTL97F_8822B = 0; - - if (RTL97F_8822B == true) - return; - - h2c_parameter[0] = 0; - - if (enable_auto_report) - h2c_parameter[0] |= BIT(0); - - btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); -} - -void halbtc8822b2ant_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; - } - halbtc8822b2ant_set_bt_auto_report(btcoexist, - coex_dm->cur_bt_auto_report); - - coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; -} - -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); - -} - -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; -} - -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); - -} - - - -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; - } - -} - -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}; - static boolean state = false; - /* - if (state ==isenable) - return; - else - state = isenable; - */ - 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 -} - -u32 halbtc8822b2ant_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_2ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); - - - return btcoexist->btc_read_4byte(btcoexist, - 0x1708); /* get read data */ - -} - -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, 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_2ANT_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 = halbtc8822b2ant_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 0x7c0 */ - do { - j++; - } while (((btcoexist->btc_read_1byte(btcoexist, - 0x1703)&BIT(5)) == 0) && - (j < BT_8822B_2ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); - - - btcoexist->btc_write_4byte(btcoexist, 0x1700, - 0xc00F0000 | reg_addr); - - } - -} - -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] */ - -} - -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] */ - -} - -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; - - } - -} - -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; - - } - -} - -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] */ - - -} - - -void halbtc8822b2ant_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_8822B_2ANT_LBTT_WL_BREAK_LTE: - reg_addr = 0xa8; - break; - case BT_8822B_2ANT_LBTT_BT_BREAK_LTE: - reg_addr = 0xac; - break; - case BT_8822B_2ANT_LBTT_LTE_BREAK_WL: - reg_addr = 0xb0; - break; - case BT_8822B_2ANT_LBTT_LTE_BREAK_BT: - reg_addr = 0xb4; - break; - } - - if (reg_addr != 0x0000) - halbtc8822b2ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, - 0xff, table_content); /* 0xa8[15:0] or 0xb4[15:0] */ - - -} - - -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); -} - -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; -} - -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 == true) { - break_table = 0xf0ffffff; /* set WL hi-pri can break BT */ - select_table = - 0x3; /* 0xb/0x3,set Tx response = Hi-Pri/LO-Pri (ex: Transmitting ACK,BA,CTS) */ - } else { - break_table = 0xffffff; - select_table = 0x3; - } - - switch (type) { - case 0: - halbtc8822b2ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x55555555, 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, - 0x5a5a5a5a, 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, 0x5a5a5a5a, break_table, select_table); - break; - case 6: - halbtc8822b2ant_coex_table(btcoexist, force_exec, - 0x55555555, 0xaaaa5aaa, 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, - 0x55555555, 0x5a5a5a5a, break_table, select_table); - break; - case 9: - halbtc8822b2ant_coex_table(btcoexist, force_exec, - 0x55555555, 0xaaaa555a, break_table, select_table); - break; - case 10: - halbtc8822b2ant_coex_table(btcoexist, force_exec, - 0x55555555, 0xaaaa5aaa, break_table, select_table); - break; - case 11: - halbtc8822b2ant_coex_table(btcoexist, force_exec, - 0x55555555, 0xaaaaa5aa, break_table, select_table); - break; - default: - break; - } -} - -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 == true) - return; - - if (enable) - h2c_parameter[0] |= BIT(0); /* function enable */ - - btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); -} - -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; -} - -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); -} - -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; -} - -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 == true) - 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 */ - /*halbtc8822b2ant_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 */ - /*halbtc8822b2ant_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 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; - - 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: - 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); - coex_sta->force_lps_on = true; - break; - case BTC_PS_LPS_OFF: - halbtc8822b2ant_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 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; - - 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); - - 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))) { - - halbtc8822b2ant_power_save_state( - btcoexist, BTC_PS_LPS_ON, 0x50, - 0x4); - } else { - halbtc8822b2ant_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 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) && (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); - - 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, 0xe3, - 0x10, 0x03, 0xf1, - 0x54 | psTdmaByte4Modify); - break; - case 2: - default: - halbtc8822b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x35, 0x03, 0x71, - 0x11 | psTdmaByte4Modify); - break; - case 3: - halbtc8822b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x3a, 0x3, 0xf1, - 0x10 | psTdmaByte4Modify); - break; - case 4: - halbtc8822b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x21, 0x3, 0xf1, - 0x10 | psTdmaByte4Modify); - break; - case 5: - halbtc8822b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x25, 0x3, 0xf1, - 0x10 | psTdmaByte4Modify); - break; - case 6: - halbtc8822b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x10, 0x3, 0xf1, - 0x10 | psTdmaByte4Modify); - break; - case 7: - halbtc8822b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x20, 0x3, 0xf1, - 0x10 | psTdmaByte4Modify); - break; - case 11: - halbtc8822b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x30, 0x03, 0x71, - 0x10 | psTdmaByte4Modify); - break; - case 12: - halbtc8822b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x21, 0x03, 0x71, - 0x11 | psTdmaByte4Modify); - break; - case 13: - halbtc8822b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x1c, 0x03, 0x71, - 0x10 | psTdmaByte4Modify); - break; - case 14: - halbtc8822b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x30, 0x03, 0x71, - 0x11); - break; - case 51: - halbtc8822b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x10, 0x03, 0xf1, - 0x10 | psTdmaByte4Modify); - break; - case 101: - halbtc8822b2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x10, 0x03, 0x70, - 0x54 | psTdmaByte4Modify); - break; - case 102: - halbtc8822b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x35, 0x03, 0x71, - 0x11 | psTdmaByte4Modify); - break; - case 103: - halbtc8822b2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x3a, 0x3, 0x70, - 0x50 | psTdmaByte4Modify); - break; - case 104: - halbtc8822b2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x21, 0x3, 0x70, - 0x50 | psTdmaByte4Modify); - break; - case 105: - halbtc8822b2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x25, 0x3, 0x70, - 0x50 | psTdmaByte4Modify); - break; - case 106: - halbtc8822b2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x10, 0x3, 0x70, - 0x50 | psTdmaByte4Modify); - break; - case 107: - halbtc8822b2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x20, 0x3, 0x70, - 0x50 | psTdmaByte4Modify); - break; - case 151: - halbtc8822b2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x10, 0x03, 0x70, - 0x50 | psTdmaByte4Modify); - break; - } - } else { - /* disable PS tdma */ - switch (type) { - case 0: - halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x0, - 0x0, 0x0, 0x40, 0x0); - break; - case 1: - halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x0, - 0x0, 0x0, 0x48, 0x0); - break; - default: - halbtc8822b2ant_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 halbtc8822b2ant_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_8822B_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); - - 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 - -} - -/*anttenna control by bb mac bt antdiv pta to write 0x4c 0xcb4,0xcbd*/ -void halbtc8822b2ant_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_0xcbc = 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; - /* - 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; - } -*/ - if (board_info->ant_div_cfg) - /*ctrl_type = BT_8822B_2ANT_EXT_ANT_SWITCH_CTRL_BY_ANTDIV;*/ - - /* 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 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, - 0xff, 0x77); /* BB SW, DPDT use RFE_ctrl8 and RFE_ctrl9 as conctrol pin */ - - 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 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, - 0xff, 0x66); /* PTA, DPDT use RFE_ctrl8 and RFE_ctrl9 as conctrol pin */ - - regval_0xcbc = (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, 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 */ - - 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_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 */ -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*/ -void halbtc8822b2ant_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; - /* 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); - - 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); - - 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); - } 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); - } - coex_sta->run_time_state = true; - - 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 - -} - - -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 (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; -} - - - -void halbtc8822b2ant_action_coex_all_off(IN struct btc_coexist *btcoexist) -{ - - 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); - - /* fw all off */ - halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - - halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); - halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - -} - -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_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - - halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); - halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - halbtc8822b2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, - BT_8822B_2ANT_PHASE_5G_RUNTIME); -} - - -void halbtc8822b2ant_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); - - halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 8); - halbtc8822b2ant_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); - - halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 8); - - if (coex_sta->bt_create_connection) - halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 12); - else - halbtc8822b2ant_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); - - halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 8); - - if (wifi_busy) { - - if ((bt_link_info->a2dp_exist) && - (bt_link_info->acl_busy)) - halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 13); - else - halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 11); - - } else - halbtc8822b2ant_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); - - 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); - } - - halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0xd8); - halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -} - -void halbtc8822b2ant_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; - - halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0xd8); - halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); - - if ((bt_link_info->a2dp_exist) && (bt_link_info->acl_busy)) - halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); - else - halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 11); - -} - - -void halbtc8822b2ant_action_wifi_nonconnected(IN struct btc_coexist *btcoexist) -{ - 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); - - /* fw all off */ - halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - - halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); - halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); -} - -void halbtc8822b2ant_action_bt_idle(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_connected = false; - boolean scan = false, link = false, roam = false; - boolean wifi_busy = false; - - 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(&pre_bt_rssi_state, 2, - coex_sta->bt_coex_thres , 0); - - bt_rssi_state2 = halbtc8822b2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, - coex_sta->bt_coex_thres2 , 0); - - - 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 (scan || link || roam) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi link process + BT Idle!!\n"); - BTC_TRACE(trace_buf); - - halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 7); - - halbtc8822b2ant_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"); - BTC_TRACE(trace_buf); - - if (wifi_busy) { - 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); - /* - if (!BTC_RSSI_HIGH(bt_rssi_state2)) - halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - else { - 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); - - } - */ - } else { - 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); - - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi no-link + BT Idle!!\n"); - BTC_TRACE(trace_buf); - - 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); - } - - halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0xd8); - halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - -} - - -/* SCO only or SCO+PAN(HS) */ -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; - - - 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(&pre_bt_rssi_state, 2, - coex_sta->bt_coex_thres , 0); - - bt_rssi_state2 = halbtc8822b2ant_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)) { - - 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_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); - } 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; - - halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); - - halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - } - -} - - -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; - - - 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(&pre_bt_rssi_state, 2, - coex_sta->bt_coex_thres , 0); - - bt_rssi_state2 = halbtc8822b2ant_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)) { - - 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_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); - } 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; -/* - 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_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); - -/* - halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 10); -*/ - halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - } - -} - -/* A2DP only / PAN(EDR) only/ A2DP+PAN(HS) */ -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\n", - coex_sta->scan_ap_num); - BTC_TRACE(trace_buf); - -#if 1 - if ((wifi_busy) && (coex_sta->scan_ap_num <= 4)) - 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(&pre_bt_rssi_state, 2, - coex_sta->bt_coex_thres , 0); - - bt_rssi_state2 = halbtc8822b2ant_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)) { - - 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_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); - } 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->is_setupLink) - halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 51); - else { - 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, - true, 1); - } - } else - - halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 2); - } 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->is_setupLink) - halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 151); - else - halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 101); - } else - halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 102); - - } - -} - -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\n", - coex_sta->scan_ap_num); - BTC_TRACE(trace_buf); - -#if 1 - if ((wifi_busy) && (coex_sta->scan_ap_num <= 4)) - 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(&pre_bt_rssi_state, 2, - coex_sta->bt_coex_thres , 0); - - bt_rssi_state2 = halbtc8822b2ant_bt_rssi_state(&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_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, - BT_8822B_2ANT_PHASE_2G_RUNTIME_CONCURRENT); - - 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_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); - } 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_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, 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; - - 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) - halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 103); - else - halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 104); - - } - -#endif - -} - - -/* PAN(HS) only */ -void halbtc8822b2ant_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, 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\n", - coex_sta->scan_ap_num); - BTC_TRACE(trace_buf); - -#if 1 - if ((wifi_busy) && (coex_sta->scan_ap_num <= 4)) - 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(&pre_bt_rssi_state, 2, - coex_sta->bt_coex_thres , 0); - - bt_rssi_state2 = halbtc8822b2ant_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)) { - - 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_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); - } 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, 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); - - - } 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, 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); - } - -} - - -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; - - - 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(&pre_bt_rssi_state, 2, - coex_sta->bt_coex_thres , 0); - - bt_rssi_state2 = halbtc8822b2ant_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)) { - - 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_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); - } 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->is_setupLink) - halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 51); - else - 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, true, 1); - */ - } else - halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 2); - - - } 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_busy) && (coex_sta->hid_busy_num >= 2)) - halbtc8822b2ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 6); - else - /* - halbtc8822b2ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 9); - */ - halbtc8822b2ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - - if (wifi_busy) { - if (coex_sta->is_setupLink) - halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 151); - else - halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 101); - } else - halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 102); - - } - -} - - -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\n", - coex_sta->scan_ap_num); - BTC_TRACE(trace_buf); - -#if 1 - if ((wifi_busy) && (coex_sta->scan_ap_num <= 4)) - 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(&pre_bt_rssi_state, 2, - coex_sta->bt_coex_thres , 0); - - bt_rssi_state2 = halbtc8822b2ant_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)) { - - 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_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); - } 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 */ -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\n", - coex_sta->scan_ap_num); - BTC_TRACE(trace_buf); - -#if 1 - if ((wifi_busy) && (coex_sta->scan_ap_num <= 4)) - 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(&pre_bt_rssi_state, 2, - coex_sta->bt_coex_thres , 0); - - bt_rssi_state2 = halbtc8822b2ant_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)) { - - 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_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); - } 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_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, - 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); - - } - -} - -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; - - - 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(&pre_bt_rssi_state, 2, - coex_sta->bt_coex_thres , 0); - - bt_rssi_state2 = halbtc8822b2ant_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)) { - - 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_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); - } 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, 1); - - if (wifi_busy) - - halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 103); - else - - halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 104); - - } - -} - -/* HID+A2DP+PAN(EDR) */ -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; - - - 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(&pre_bt_rssi_state, 2, - coex_sta->bt_coex_thres , 0); - - bt_rssi_state2 = halbtc8822b2ant_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)) { - - 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_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); - } 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, 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); - } - -} - - - -void halbtc8822b2ant_action_bt_whck_test(IN struct btc_coexist *btcoexist) -{ - halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); - halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - 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); -} - -void halbtc8822b2ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) -{ - halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); - halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - /* hw all off */ - 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); -} - -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, - wifi_connected = false, 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; - } - - 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) { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], WiFi is under 5G!!!\n"); - BTC_TRACE(trace_buf); - - 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_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_action_bt_inquiry(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) { - 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); - 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); - halbtc8822b2ant_action_wifi_multi_port(btcoexist); - - return; - } - - miracast_plus_bt = false; - btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, - &miracast_plus_bt); - - - 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 (!wifi_connected) { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, wifi non-connected!!.\n"); - BTC_TRACE(trace_buf); - halbtc8822b2ant_action_wifi_nonconnected(btcoexist); - - } else if ((BT_8822B_2ANT_BT_STATUS_NON_CONNECTED_IDLE == - coex_dm->bt_status) || - (BT_8822B_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); - - halbtc8822b2ant_action_bt_idle(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_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_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_PANHS: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = HS mode.\n"); - BTC_TRACE(trace_buf); - halbtc8822b2ant_action_pan_hs(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_action_coex_all_off(btcoexist); - break; - } - coex_dm->pre_algorithm = coex_dm->cur_algorithm; - } -} - -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, 0); - halbtc8822b2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, - BT_8822B_2ANT_PHASE_2G_RUNTIME_CONCURRENT); - - /* fw all off */ - halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - - halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); - halbtc8822b2ant_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; - - halbtc8822b2ant_query_bt_info(btcoexist); -} - - -void halbtc8822b2ant_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 RTL97F_8822B = 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 == true) { - 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; - - /* 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 (btcoexist->btc_read_1byte(btcoexist, 0x80) == 0xc6)*/ - 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 */ - - /* WLAN_Tx by GNT_WL 0x950[29] = 0 */ - /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x953, 0x20, 0x0); */ - - halbtc8822b2ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); - - halbtc8822b2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); - - psd_scan->ant_det_is_ant_det_available = true; - - 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; - /* 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 */ - 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; - u32 value = 0; - - 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 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 = 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); - - /* 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; - 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 (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;*/ - 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" : - (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" : - ((BT_8822B_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; - } - - - 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", - "Role/IgnWlanAct/Feature", - ((bt_link_info->slave_role) ? "Slave" : "Master"), - ((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); - - 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", - ((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_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", - "AntDiv/ForceLPS/LPRA", - ((board_info->ant_div_cfg) ? "On" : "Off"), - ((coex_sta->force_lps_on) ? "On" : "Off"), - ((coex_dm->cur_low_penalty_ra) ? "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, - 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] = 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] = 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", - "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")); - 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, 0xcbd); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = 0x%04x/ 0x%04x/ 0x%x", - "0xcb0/0xcb4/0xcbd", - u32tmp[0], u32tmp[1], u8tmp[0]); - 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); - - 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 = %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(Lo-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_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) -{ - 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_on == true) { /* LPS No-32K */ - /* Write WL "Active" in Score-board for PS-TDMA */ - 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 */ - 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); - } -} - -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) -{ - - 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); - - 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); - } -} - - -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) -{ - u8 h2c_parameter[3] = {0}; - u32 wifi_bw; - u8 wifi_central_chnl; - u8 ap_num = 0; - 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; - - 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_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] : 0); - - 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; - } else - coex_sta->is_setupLink = false; - - if (coex_sta->bt_info_ext & BIT(3)) - coex_sta->cnt_IgnWlanAct++; - - if (coex_sta->bt_create_connection) - coex_sta->cnt_Page++; - - /* 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)))) { - - 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); - } - } - - } - - - halbtc8822b2ant_update_bt_link_info(btcoexist); - - if (btcoexist->manual_control) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), No run_coexist_mechanism 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 for Stop Coex DM\n"); - BTC_TRACE(trace_buf); - return; - } - - coex_sta->c2h_bt_info_req_sent = false; - - 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); - - coex_sta->wl_rf_off_on_event = true; - btcoexist->stop_coex_dm = 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); - } 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, false); - halbtc8822b2ant_post_state_to_bt(btcoexist, - BT_8822B_2ANT_SCOREBOARD_ONOFF, false); - btcoexist->stop_coex_dm = true; - coex_sta->wl_rf_off_on_event = false; - - } -} - -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) -{ - struct btc_board_info *board_info = &btcoexist->board_info; - boolean wifi_busy = false; - u32 bt_patch_ver; - u16 bt_scoreboard_val = 0; - static u8 cnt = 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); - /* - halbtc8822b2ant_post_state_to_bt(btcoexist, - BT_8822B_2ANT_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; - } - - /* 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_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); - - /*coex_sta->bt_ble_scan_type = btcoexist->btc_get_ble_scan_type_from_bt(btcoexist);*/ - 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->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); - } - if (halbtc8822b2ant_is_wifibt_status_changed(btcoexist)) - halbtc8822b2ant_run_coexist_mechanism(btcoexist); -} - - -/*#pragma optimize( "", off )*/ -void ex_halbtc8822b2ant_antenna_detection(IN struct btc_coexist *btcoexist, - IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) -{ -#if 0 - static u32 ant_det_count = 0, ant_det_fail_count = 0; - struct btc_board_info *board_info = &btcoexist->board_info; - u16 u16tmp; - u8 AntDetval = 0; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx Ext Call AntennaDetect()!!\n"); - BTC_TRACE(trace_buf); - -#if BT_8822B_2ANT_ANTDET_ENABLE - - 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_8822B_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); - - psd_scan->is_AntDet_running = true; - - halbtc8822b2ant_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; - psd_scan->ant_det_try_count = 1; - psd_scan->ant_det_fail_count = 0; - board_info->btdm_ant_num_by_ant_det = (u16tmp & - BIT(3)) ? 1 : 2; - psd_scan->ant_det_result = 12; - - psd_scan->ant_det_psd_scan_peak_val = - btcoexist->btc_get_ant_det_val_from_bt( - btcoexist) * 100; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Result from BT (%d-Ant)\n", - board_info->btdm_ant_num_by_ant_det); - BTC_TRACE(trace_buf); - } else - board_info->btdm_ant_det_finish = - halbtc8822b2ant_psd_antenna_detection_check( - btcoexist); - - btcoexist->bdontenterLPS = false; - - 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); - - /*for 8822b, btc_set_bt_trx_mask is just used to - notify BT stop le tx and Ant Det Result , not set BT RF TRx Mask */ - if (psd_scan->ant_det_result != 12) { - - AntDetval = (u8)(( - psd_scan->ant_det_psd_scan_peak_val - / 100) & 0x7f); - - AntDetval = - (board_info->btdm_ant_num_by_ant_det - == 1) ? (AntDetval | 0x80) : - AntDetval; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxx AntennaDetect(), Ant Count = %d, PSD Val = %d\n", - ((AntDetval & - 0x80) ? 1 - : 2), AntDetval - & 0x7f); - BTC_TRACE(trace_buf); - - if (btcoexist->btc_set_bt_trx_mask( - btcoexist, AntDetval)) - BTC_SPRINTF(trace_buf, - BT_TMP_BUF_SIZE, - "xxxxxx AntennaDetect(), Notify BT stop le tx by set_bt_trx_mask ok!\n"); - else - BTC_SPRINTF(trace_buf, - BT_TMP_BUF_SIZE, - "xxxxxx AntennaDetect(), Notify BT stop le tx by set_bt_trx_mask fail!\n"); - - BTC_TRACE(trace_buf); - } - - } 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; - psd_scan->is_AntDet_running = false; - - /* stimulate coex running */ - halbtc8822b2ant_run_coexist_mechanism( - btcoexist); - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Stimulate Coex running\n!!"); - BTC_TRACE(trace_buf); - } 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); - - if (psd_scan->ant_det_inteval_count == 8) - btcoexist->bdontenterLPS = true; - else - btcoexist->bdontenterLPS = false; - } - - } -#endif -#endif - -} - - -void ex_halbtc8822b2ant_display_ant_detection(IN struct btc_coexist *btcoexist) -{ -#if 0 -#if BT_8822B_2ANT_ANTDET_ENABLE - struct btc_board_info *board_info = &btcoexist->board_info; - - if (psd_scan->ant_det_try_count != 0) { - halbtc8822b2ant_psd_show_antenna_detect_result(btcoexist); - - if (board_info->btdm_ant_det_finish) - halbtc8822b2ant_psd_showdata(btcoexist); - } -#endif -#endif -} - - -#endif - -#endif /* #if (RTL8822B_SUPPORT == 1) */ - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8822b2ant.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8822b2ant.h deleted file mode 100644 index 0a20d7555618..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8822b2ant.h +++ /dev/null @@ -1,494 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ - -#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 1 -#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 - - -#define BT_8822B_2ANT_WIFI_RSSI_COEXSWITCH_THRES1 80 /* unit: % WiFi RSSI Threshold for 2-Ant free-run/2-Ant TDMA translation, default = 42 */ -#define BT_8822B_2ANT_BT_RSSI_COEXSWITCH_THRES1 80 /* unit: % BT RSSI Threshold for 2-Ant free-run/2-Ant TDMA translation, default = 46 */ -#define BT_8822B_2ANT_WIFI_RSSI_COEXSWITCH_THRES2 40 /* unit: % WiFi RSSI Threshold for 1-Ant TDMA/1-Ant PS-TDMA translation, default = 42 */ -#define BT_8822B_2ANT_BT_RSSI_COEXSWITCH_THRES2 35 /* unit: % BT RSSI Threshold for 1-Ant TDMA/1-Ant PS-TDMA translation, default = 46 */ -#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_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; - 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_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_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 pre_ccklock; - boolean cck_ever_lock; - - u8 coex_table_type; - boolean force_lps_on; - - 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 wl_rf_off_on_event; - 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; - u8 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; - - 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; -}; - - -#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 */ - 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 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; - u32 psd_avg_value; /* filter loop_max_value that below BT_8822B_1ANT_ANTDET_PSDTHRES_1ANT, and average the rest*/ - u32 psd_loop_max_value[BT_8822B_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_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/rtl8188eu/hal/btc/halbtc8822bwifionly.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8822bwifionly.c deleted file mode 100644 index 214fc8b61b84..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8822bwifionly.c +++ /dev/null @@ -1,55 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ -#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/rtl8188eu/hal/btc/halbtc8822bwifionly.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8822bwifionly.h deleted file mode 100644 index 71a1b7e81dc3..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtc8822bwifionly.h +++ /dev/null @@ -1,23 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ -#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/rtl8188eu/hal/btc/halbtcoutsrc.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtcoutsrc.h deleted file mode 100644 index e11f275098a4..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/halbtcoutsrc.h +++ /dev/null @@ -1,1004 +0,0 @@ -/* SPDX-License-Identifier: GPL-2.0 */ -#ifndef __HALBTC_OUT_SRC_H__ -#define __HALBTC_OUT_SRC_H__ - - -#define BTC_COEX_OFFLOAD 0 -#define BTC_TMP_BUF_SHORT 20 - -extern u1Byte gl_btc_trace_buf[]; -#define BTC_SPRINTF rsprintf -#define BTC_TRACE(_MSG_)\ -do {\ - if (GLBtcDbgType[COMP_COEX] & BIT(DBG_LOUD)) {\ - RTW_INFO("%s", _MSG_);\ - } \ -} while (0) -#define BT_PrintData(adapter, _MSG_, len, data) RTW_DBG_DUMP((_MSG_), data, len) - - -#define NORMAL_EXEC FALSE -#define FORCE_EXEC TRUE - -#define BTC_RF_OFF 0x0 -#define BTC_RF_ON 0x1 - -#define BTC_RF_A 0x0 -#define BTC_RF_B 0x1 -#define BTC_RF_C 0x2 -#define BTC_RF_D 0x3 - -#define BTC_SMSP SINGLEMAC_SINGLEPHY -#define BTC_DMDP DUALMAC_DUALPHY -#define BTC_DMSP DUALMAC_SINGLEPHY -#define BTC_MP_UNKNOWN 0xff - -#define BT_COEX_ANT_TYPE_PG 0 -#define BT_COEX_ANT_TYPE_ANTDIV 1 -#define BT_COEX_ANT_TYPE_DETECTED 2 - -#define BTC_MIMO_PS_STATIC 0 /* 1ss */ -#define BTC_MIMO_PS_DYNAMIC 1 /* 2ss */ - -#define BTC_RATE_DISABLE 0 -#define BTC_RATE_ENABLE 1 - -/* single Antenna definition */ -#define BTC_ANT_PATH_WIFI 0 -#define BTC_ANT_PATH_BT 1 -#define BTC_ANT_PATH_PTA 2 -#define BTC_ANT_PATH_WIFI5G 3 -#define BTC_ANT_PATH_AUTO 4 -/* dual Antenna definition */ -#define BTC_ANT_WIFI_AT_MAIN 0 -#define BTC_ANT_WIFI_AT_AUX 1 -#define BTC_ANT_WIFI_AT_DIVERSITY 2 -/* coupler Antenna definition */ -#define BTC_ANT_WIFI_AT_CPL_MAIN 0 -#define BTC_ANT_WIFI_AT_CPL_AUX 1 - -typedef enum _BTC_POWERSAVE_TYPE { - BTC_PS_WIFI_NATIVE = 0, /* wifi original power save behavior */ - BTC_PS_LPS_ON = 1, - BTC_PS_LPS_OFF = 2, - BTC_PS_MAX -} BTC_POWERSAVE_TYPE, *PBTC_POWERSAVE_TYPE; - -typedef enum _BTC_BT_REG_TYPE { - BTC_BT_REG_RF = 0, - BTC_BT_REG_MODEM = 1, - BTC_BT_REG_BLUEWIZE = 2, - BTC_BT_REG_VENDOR = 3, - BTC_BT_REG_LE = 4, - BTC_BT_REG_MAX -} BTC_BT_REG_TYPE, *PBTC_BT_REG_TYPE; - -typedef enum _BTC_CHIP_INTERFACE { - BTC_INTF_UNKNOWN = 0, - BTC_INTF_PCI = 1, - BTC_INTF_USB = 2, - BTC_INTF_SDIO = 3, - BTC_INTF_MAX -} BTC_CHIP_INTERFACE, *PBTC_CHIP_INTERFACE; - -typedef enum _BTC_CHIP_TYPE { - BTC_CHIP_UNDEF = 0, - BTC_CHIP_CSR_BC4 = 1, - BTC_CHIP_CSR_BC8 = 2, - BTC_CHIP_RTL8723A = 3, - BTC_CHIP_RTL8821 = 4, - BTC_CHIP_RTL8723B = 5, - BTC_CHIP_MAX -} BTC_CHIP_TYPE, *PBTC_CHIP_TYPE; - -/* following is for wifi link status */ -#define WIFI_STA_CONNECTED BIT0 -#define WIFI_AP_CONNECTED BIT1 -#define WIFI_HS_CONNECTED BIT2 -#define WIFI_P2P_GO_CONNECTED BIT3 -#define WIFI_P2P_GC_CONNECTED BIT4 - -/* following is for command line utility */ -#define CL_SPRINTF rsprintf -#define CL_PRINTF DCMD_Printf - -struct btc_board_info { - /* The following is some board information */ - u8 bt_chip_type; - u8 pg_ant_num; /* pg ant number */ - u8 btdm_ant_num; /* ant number for btdm */ - u8 btdm_ant_num_by_ant_det; /* ant number for btdm after antenna detection */ - u8 btdm_ant_pos; /* Bryant Add to indicate Antenna Position for (pg_ant_num = 2) && (btdm_ant_num =1) (DPDT+1Ant case) */ - 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; - boolean btdm_ant_det_complete_fail; - u8 ant_det_result; - boolean ant_det_result_five_complete; - u32 antdetval; -}; - -typedef enum _BTC_DBG_OPCODE { - BTC_DBG_SET_COEX_NORMAL = 0x0, - BTC_DBG_SET_COEX_WIFI_ONLY = 0x1, - BTC_DBG_SET_COEX_BT_ONLY = 0x2, - BTC_DBG_SET_COEX_DEC_BT_PWR = 0x3, - BTC_DBG_SET_COEX_BT_AFH_MAP = 0x4, - BTC_DBG_SET_COEX_BT_IGNORE_WLAN_ACT = 0x5, - BTC_DBG_SET_COEX_MANUAL_CTRL = 0x6, - BTC_DBG_MAX -} BTC_DBG_OPCODE, *PBTC_DBG_OPCODE; - -typedef enum _BTC_RSSI_STATE { - BTC_RSSI_STATE_HIGH = 0x0, - BTC_RSSI_STATE_MEDIUM = 0x1, - BTC_RSSI_STATE_LOW = 0x2, - BTC_RSSI_STATE_STAY_HIGH = 0x3, - BTC_RSSI_STATE_STAY_MEDIUM = 0x4, - BTC_RSSI_STATE_STAY_LOW = 0x5, - BTC_RSSI_MAX -} BTC_RSSI_STATE, *PBTC_RSSI_STATE; -#define BTC_RSSI_HIGH(_rssi_) ((_rssi_ == BTC_RSSI_STATE_HIGH || _rssi_ == BTC_RSSI_STATE_STAY_HIGH) ? TRUE:FALSE) -#define BTC_RSSI_MEDIUM(_rssi_) ((_rssi_ == BTC_RSSI_STATE_MEDIUM || _rssi_ == BTC_RSSI_STATE_STAY_MEDIUM) ? TRUE:FALSE) -#define BTC_RSSI_LOW(_rssi_) ((_rssi_ == BTC_RSSI_STATE_LOW || _rssi_ == BTC_RSSI_STATE_STAY_LOW) ? TRUE:FALSE) - -typedef enum _BTC_WIFI_ROLE { - BTC_ROLE_STATION = 0x0, - BTC_ROLE_AP = 0x1, - BTC_ROLE_IBSS = 0x2, - BTC_ROLE_HS_MODE = 0x3, - BTC_ROLE_MAX -} BTC_WIFI_ROLE, *PBTC_WIFI_ROLE; - -typedef enum _BTC_WIRELESS_FREQ { - BTC_FREQ_2_4G = 0x0, - BTC_FREQ_5G = 0x1, - BTC_FREQ_MAX -} BTC_WIRELESS_FREQ, *PBTC_WIRELESS_FREQ; - -typedef enum _BTC_WIFI_BW_MODE { - BTC_WIFI_BW_LEGACY = 0x0, - BTC_WIFI_BW_HT20 = 0x1, - BTC_WIFI_BW_HT40 = 0x2, - BTC_WIFI_BW_HT80 = 0x3, - BTC_WIFI_BW_HT160 = 0x4, - BTC_WIFI_BW_MAX -} BTC_WIFI_BW_MODE, *PBTC_WIFI_BW_MODE; - -typedef enum _BTC_WIFI_TRAFFIC_DIR { - BTC_WIFI_TRAFFIC_TX = 0x0, - BTC_WIFI_TRAFFIC_RX = 0x1, - BTC_WIFI_TRAFFIC_MAX -} BTC_WIFI_TRAFFIC_DIR, *PBTC_WIFI_TRAFFIC_DIR; - -typedef enum _BTC_WIFI_PNP { - BTC_WIFI_PNP_WAKE_UP = 0x0, - BTC_WIFI_PNP_SLEEP = 0x1, - BTC_WIFI_PNP_SLEEP_KEEP_ANT = 0x2, - BTC_WIFI_PNP_MAX -} BTC_WIFI_PNP, *PBTC_WIFI_PNP; - -typedef enum _BTC_IOT_PEER { - BTC_IOT_PEER_UNKNOWN = 0, - BTC_IOT_PEER_REALTEK = 1, - BTC_IOT_PEER_REALTEK_92SE = 2, - BTC_IOT_PEER_BROADCOM = 3, - BTC_IOT_PEER_RALINK = 4, - BTC_IOT_PEER_ATHEROS = 5, - BTC_IOT_PEER_CISCO = 6, - BTC_IOT_PEER_MERU = 7, - BTC_IOT_PEER_MARVELL = 8, - BTC_IOT_PEER_REALTEK_SOFTAP = 9, /* peer is RealTek SOFT_AP, by Bohn, 2009.12.17 */ - BTC_IOT_PEER_SELF_SOFTAP = 10, /* Self is SoftAP */ - BTC_IOT_PEER_AIRGO = 11, - BTC_IOT_PEER_INTEL = 12, - BTC_IOT_PEER_RTK_APCLIENT = 13, - BTC_IOT_PEER_REALTEK_81XX = 14, - BTC_IOT_PEER_REALTEK_WOW = 15, - BTC_IOT_PEER_REALTEK_JAGUAR_BCUTAP = 16, - BTC_IOT_PEER_REALTEK_JAGUAR_CCUTAP = 17, - BTC_IOT_PEER_MAX, -} BTC_IOT_PEER, *PBTC_IOT_PEER; - -/* for 8723b-d cut large current issue */ -typedef enum _BTC_WIFI_COEX_STATE { - BTC_WIFI_STAT_INIT, - BTC_WIFI_STAT_IQK, - BTC_WIFI_STAT_NORMAL_OFF, - BTC_WIFI_STAT_MP_OFF, - BTC_WIFI_STAT_NORMAL, - BTC_WIFI_STAT_ANT_DIV, - BTC_WIFI_STAT_MAX -} BTC_WIFI_COEX_STATE, *PBTC_WIFI_COEX_STATE; - -typedef enum _BTC_ANT_TYPE { - BTC_ANT_TYPE_0, - BTC_ANT_TYPE_1, - BTC_ANT_TYPE_2, - BTC_ANT_TYPE_3, - BTC_ANT_TYPE_4, - BTC_ANT_TYPE_MAX -} BTC_ANT_TYPE, *PBTC_ANT_TYPE; - -typedef enum _BTC_VENDOR { - BTC_VENDOR_LENOVO, - BTC_VENDOR_ASUS, - BTC_VENDOR_OTHER -} BTC_VENDOR, *PBTC_VENDOR; - - -/* defined for BFP_BTC_GET */ -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_BUSY, - BTC_GET_BL_WIFI_SCAN, - BTC_GET_BL_WIFI_LINK, - BTC_GET_BL_WIFI_ROAM, - BTC_GET_BL_WIFI_4_WAY_PROGRESS, - BTC_GET_BL_WIFI_UNDER_5G, - BTC_GET_BL_WIFI_AP_MODE_ENABLE, - BTC_GET_BL_WIFI_ENABLE_ENCRYPTION, - BTC_GET_BL_WIFI_UNDER_B_MODE, - BTC_GET_BL_EXT_SWITCH, - BTC_GET_BL_WIFI_IS_IN_MP_MODE, - BTC_GET_BL_IS_ASUS_8723B, - - /* type s4Byte */ - BTC_GET_S4_WIFI_RSSI, - BTC_GET_S4_HS_RSSI, - - /* type u4Byte */ - BTC_GET_U4_WIFI_BW, - BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, - BTC_GET_U4_WIFI_FW_VER, - BTC_GET_U4_WIFI_LINK_STATUS, - BTC_GET_U4_BT_PATCH_VER, - BTC_GET_U4_VENDOR, - BTC_GET_U4_SUPPORTED_VERSION, - BTC_GET_U4_SUPPORTED_FEATURE, - BTC_GET_U4_WIFI_IQK_TOTAL, - BTC_GET_U4_WIFI_IQK_OK, - BTC_GET_U4_WIFI_IQK_FAIL, - - /* type u1Byte */ - BTC_GET_U1_WIFI_DOT11_CHNL, - BTC_GET_U1_WIFI_CENTRAL_CHNL, - BTC_GET_U1_WIFI_HS_CHNL, - BTC_GET_U1_WIFI_P2P_CHNL, - BTC_GET_U1_MAC_PHY_MODE, - BTC_GET_U1_AP_NUM, - BTC_GET_U1_ANT_TYPE, - BTC_GET_U1_IOT_PEER, - - /*===== for 1Ant ======*/ - BTC_GET_U1_LPS_MODE, - - BTC_GET_MAX -} BTC_GET_TYPE, *PBTC_GET_TYPE; - -/* defined for BFP_BTC_SET */ -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, - BTC_SET_BL_TO_REJ_AP_AGG_PKT, - BTC_SET_BL_BT_CTRL_AGG_SIZE, - BTC_SET_BL_INC_SCAN_DEV_NUM, - BTC_SET_BL_BT_TX_RX_MASK, - BTC_SET_BL_MIRACAST_PLUS_BT, - - /* type u1Byte */ - BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, - BTC_SET_U1_AGG_BUF_SIZE, - - /* type trigger some action */ - BTC_SET_ACT_GET_BT_RSSI, - BTC_SET_ACT_AGGREGATE_CTRL, - BTC_SET_ACT_ANTPOSREGRISTRY_CTRL, - /*===== for 1Ant ======*/ - /* type BOOLEAN */ - - /* type u1Byte */ - BTC_SET_U1_RSSI_ADJ_VAL_FOR_1ANT_COEX_TYPE, - BTC_SET_U1_LPS_VAL, - BTC_SET_U1_RPWM_VAL, - /* type trigger some action */ - BTC_SET_ACT_LEAVE_LPS, - BTC_SET_ACT_ENTER_LPS, - BTC_SET_ACT_NORMAL_LPS, - BTC_SET_ACT_DISABLE_LOW_POWER, - BTC_SET_ACT_UPDATE_RAMASK, - BTC_SET_ACT_SEND_MIMO_PS, - /* BT Coex related */ - BTC_SET_ACT_CTRL_BT_INFO, - BTC_SET_ACT_CTRL_BT_COEX, - BTC_SET_ACT_CTRL_8723B_ANT, - /*=================*/ - BTC_SET_MAX -} BTC_SET_TYPE, *PBTC_SET_TYPE; - -typedef enum _BTC_DBG_DISP_TYPE { - BTC_DBG_DISP_COEX_STATISTICS = 0x0, - BTC_DBG_DISP_BT_LINK_INFO = 0x1, - BTC_DBG_DISP_WIFI_STATUS = 0x2, - BTC_DBG_DISP_MAX -} BTC_DBG_DISP_TYPE, *PBTC_DBG_DISP_TYPE; - -typedef enum _BTC_NOTIFY_TYPE_IPS { - BTC_IPS_LEAVE = 0x0, - BTC_IPS_ENTER = 0x1, - BTC_IPS_MAX -} BTC_NOTIFY_TYPE_IPS, *PBTC_NOTIFY_TYPE_IPS; -typedef enum _BTC_NOTIFY_TYPE_LPS { - BTC_LPS_DISABLE = 0x0, - BTC_LPS_ENABLE = 0x1, - BTC_LPS_MAX -} BTC_NOTIFY_TYPE_LPS, *PBTC_NOTIFY_TYPE_LPS; -typedef enum _BTC_NOTIFY_TYPE_SCAN { - BTC_SCAN_FINISH = 0x0, - BTC_SCAN_START = 0x1, - BTC_SCAN_START_2G = 0x2, - BTC_SCAN_MAX -} BTC_NOTIFY_TYPE_SCAN, *PBTC_NOTIFY_TYPE_SCAN; -typedef enum _BTC_NOTIFY_TYPE_SWITCHBAND { - BTC_NOT_SWITCH = 0x0, - BTC_SWITCH_TO_24G = 0x1, - BTC_SWITCH_TO_5G = 0x2, - BTC_SWITCH_TO_24G_NOFORSCAN = 0x3, - BTC_SWITCH_MAX -} BTC_NOTIFY_TYPE_SWITCHBAND, *PBTC_NOTIFY_TYPE_SWITCHBAND; -typedef enum _BTC_NOTIFY_TYPE_ASSOCIATE { - BTC_ASSOCIATE_FINISH = 0x0, - BTC_ASSOCIATE_START = 0x1, - BTC_ASSOCIATE_5G_FINISH = 0x2, - BTC_ASSOCIATE_5G_START = 0x3, - BTC_ASSOCIATE_MAX -} BTC_NOTIFY_TYPE_ASSOCIATE, *PBTC_NOTIFY_TYPE_ASSOCIATE; -typedef enum _BTC_NOTIFY_TYPE_MEDIA_STATUS { - BTC_MEDIA_DISCONNECT = 0x0, - BTC_MEDIA_CONNECT = 0x1, - BTC_MEDIA_MAX -} BTC_NOTIFY_TYPE_MEDIA_STATUS, *PBTC_NOTIFY_TYPE_MEDIA_STATUS; -typedef enum _BTC_NOTIFY_TYPE_SPECIFIC_PACKET { - BTC_PACKET_UNKNOWN = 0x0, - BTC_PACKET_DHCP = 0x1, - BTC_PACKET_ARP = 0x2, - BTC_PACKET_EAPOL = 0x3, - BTC_PACKET_MAX -} BTC_NOTIFY_TYPE_SPECIFIC_PACKET, *PBTC_NOTIFY_TYPE_SPECIFIC_PACKET; -typedef enum _BTC_NOTIFY_TYPE_STACK_OPERATION { - BTC_STACK_OP_NONE = 0x0, - BTC_STACK_OP_INQ_PAGE_PAIR_START = 0x1, - BTC_STACK_OP_INQ_PAGE_PAIR_FINISH = 0x2, - BTC_STACK_OP_MAX -} BTC_NOTIFY_TYPE_STACK_OPERATION, *PBTC_NOTIFY_TYPE_STACK_OPERATION; - -/* Bryant Add */ -typedef enum _BTC_ANTENNA_POS { - BTC_ANTENNA_AT_MAIN_PORT = 0x1, - BTC_ANTENNA_AT_AUX_PORT = 0x2, -} BTC_ANTENNA_POS, *PBTC_ANTENNA_POS; - -/* Bryant Add */ -typedef enum _BTC_BT_OFFON { - BTC_BT_OFF = 0x0, - BTC_BT_ON = 0x1, -} BTC_BTOFFON, *PBTC_BT_OFFON; - -/*================================================== -For following block is for coex offload -==================================================*/ -typedef struct _COL_H2C { - u1Byte opcode; - u1Byte opcode_ver:4; - u1Byte req_num:4; - u1Byte buf[1]; -} COL_H2C, *PCOL_H2C; - -#define COL_C2H_ACK_HDR_LEN 3 -typedef struct _COL_C2H_ACK { - u1Byte status; - u1Byte opcode_ver:4; - u1Byte req_num:4; - u1Byte ret_len; - u1Byte buf[1]; -} COL_C2H_ACK, *PCOL_C2H_ACK; - -#define COL_C2H_IND_HDR_LEN 3 -typedef struct _COL_C2H_IND { - u1Byte type; - u1Byte version; - u1Byte length; - u1Byte data[1]; -} COL_C2H_IND, *PCOL_C2H_IND; - -/*============================================ -NOTE: for debug message, the following define should match -the strings in coexH2cResultString. -============================================*/ -typedef enum _COL_H2C_STATUS { - /* c2h status */ - COL_STATUS_C2H_OK = 0x00, /* Wifi received H2C request and check content ok. */ - COL_STATUS_C2H_UNKNOWN = 0x01, /* Not handled routine */ - COL_STATUS_C2H_UNKNOWN_OPCODE = 0x02, /* Invalid OP code, It means that wifi firmware received an undefiend OP code. */ - COL_STATUS_C2H_OPCODE_VER_MISMATCH = 0x03, /* Wifi firmware and wifi driver mismatch, need to update wifi driver or wifi or. */ - COL_STATUS_C2H_PARAMETER_ERROR = 0x04, /* Error paraneter.(ex: parameters = NULL but it should have values) */ - COL_STATUS_C2H_PARAMETER_OUT_OF_RANGE = 0x05, /* Wifi firmware needs to check the parameters from H2C request and return the status.(ex: ch = 500, it's wrong) */ - /* other COL status start from here */ - COL_STATUS_C2H_REQ_NUM_MISMATCH , /* c2h req_num mismatch, means this c2h is not we expected. */ - COL_STATUS_H2C_HALMAC_FAIL , /* HALMAC return fail. */ - COL_STATUS_H2C_TIMTOUT , /* not received the c2h response from fw */ - COL_STATUS_INVALID_C2H_LEN , /* invalid coex offload c2h ack length, must >= 3 */ - COL_STATUS_COEX_DATA_OVERFLOW , /* coex returned length over the c2h ack length. */ - COL_STATUS_MAX -} COL_H2C_STATUS, *PCOL_H2C_STATUS; - -#define COL_MAX_H2C_REQ_NUM 16 - -#define COL_H2C_BUF_LEN 20 -typedef enum _COL_OPCODE { - COL_OP_WIFI_STATUS_NOTIFY = 0x0, - COL_OP_WIFI_PROGRESS_NOTIFY = 0x1, - COL_OP_WIFI_INFO_NOTIFY = 0x2, - COL_OP_WIFI_POWER_STATE_NOTIFY = 0x3, - COL_OP_SET_CONTROL = 0x4, - COL_OP_GET_CONTROL = 0x5, - COL_OP_WIFI_OPCODE_MAX -} COL_OPCODE, *PCOL_OPCODE; - -typedef enum _COL_IND_TYPE { - COL_IND_BT_INFO = 0x0, - COL_IND_PSTDMA = 0x1, - COL_IND_LIMITED_TX_RX = 0x2, - COL_IND_COEX_TABLE = 0x3, - COL_IND_REQ = 0x4, - COL_IND_MAX -} COL_IND_TYPE, *PCOL_IND_TYPE; - -typedef struct _COL_SINGLE_H2C_RECORD { - u1Byte h2c_buf[COL_H2C_BUF_LEN]; /* the latest sent h2c buffer */ - u4Byte h2c_len; - u1Byte c2h_ack_buf[COL_H2C_BUF_LEN]; /* the latest received c2h buffer */ - u4Byte c2h_ack_len; - u4Byte count; /* the total number of the sent h2c command */ - u4Byte status[COL_STATUS_MAX]; /* the c2h status for the sent h2c command */ -} COL_SINGLE_H2C_RECORD, *PCOL_SINGLE_H2C_RECORD; - -typedef struct _COL_SINGLE_C2H_IND_RECORD { - u1Byte ind_buf[COL_H2C_BUF_LEN]; /* the latest received c2h indication buffer */ - u4Byte ind_len; - u4Byte count; /* the total number of the rcvd c2h indication */ - u4Byte status[COL_STATUS_MAX]; /* the c2h indication verified status */ -} COL_SINGLE_C2H_IND_RECORD, *PCOL_SINGLE_C2H_IND_RECORD; - -typedef struct _BTC_OFFLOAD { - /* H2C command related */ - u1Byte h2c_req_num; - u4Byte cnt_h2c_sent; - COL_SINGLE_H2C_RECORD h2c_record[COL_OP_WIFI_OPCODE_MAX]; - - /* C2H Ack related */ - u4Byte cnt_c2h_ack; - u4Byte status[COL_STATUS_MAX]; - struct completion c2h_event[COL_MAX_H2C_REQ_NUM]; /* for req_num = 1~COL_MAX_H2C_REQ_NUM */ - u1Byte c2h_ack_buf[COL_MAX_H2C_REQ_NUM][COL_H2C_BUF_LEN]; - u1Byte c2h_ack_len[COL_MAX_H2C_REQ_NUM]; - - /* C2H Indication related */ - u4Byte cnt_c2h_ind; - COL_SINGLE_C2H_IND_RECORD c2h_ind_record[COL_IND_MAX]; - u4Byte c2h_ind_status[COL_STATUS_MAX]; - u1Byte c2h_ind_buf[COL_H2C_BUF_LEN]; - u1Byte c2h_ind_len; -} BTC_OFFLOAD, *PBTC_OFFLOAD; -extern BTC_OFFLOAD gl_coex_offload; -/*==================================================*/ - -typedef u1Byte -(*BFP_BTC_R1)( - IN PVOID pBtcContext, - IN u4Byte RegAddr - ); -typedef u2Byte -(*BFP_BTC_R2)( - IN PVOID pBtcContext, - IN u4Byte RegAddr - ); -typedef u4Byte -(*BFP_BTC_R4)( - IN PVOID pBtcContext, - IN u4Byte RegAddr - ); -typedef VOID -(*BFP_BTC_W1)( - IN PVOID pBtcContext, - IN u4Byte RegAddr, - IN u1Byte Data - ); -typedef VOID -(*BFP_BTC_W1_BIT_MASK)( - IN PVOID pBtcContext, - IN u4Byte regAddr, - IN u1Byte bitMask, - IN u1Byte data1b - ); -typedef VOID -(*BFP_BTC_W2)( - IN PVOID pBtcContext, - IN u4Byte RegAddr, - IN u2Byte Data - ); -typedef VOID -(*BFP_BTC_W4)( - IN PVOID pBtcContext, - IN u4Byte RegAddr, - IN u4Byte Data - ); -typedef VOID -(*BFP_BTC_LOCAL_REG_W1)( - IN PVOID pBtcContext, - IN u4Byte RegAddr, - IN u1Byte Data - ); -typedef VOID -(*BFP_BTC_SET_BB_REG)( - IN PVOID pBtcContext, - IN u4Byte RegAddr, - IN u4Byte BitMask, - IN u4Byte Data - ); -typedef u4Byte -(*BFP_BTC_GET_BB_REG)( - IN PVOID pBtcContext, - IN u4Byte RegAddr, - IN u4Byte BitMask - ); -typedef VOID -(*BFP_BTC_SET_RF_REG)( - IN PVOID pBtcContext, - IN u1Byte eRFPath, - IN u4Byte RegAddr, - IN u4Byte BitMask, - IN u4Byte Data - ); -typedef u4Byte -(*BFP_BTC_GET_RF_REG)( - IN PVOID pBtcContext, - IN u1Byte eRFPath, - IN u4Byte RegAddr, - IN u4Byte BitMask - ); -typedef VOID -(*BFP_BTC_FILL_H2C)( - IN PVOID pBtcContext, - IN u1Byte elementId, - IN u4Byte cmdLen, - IN pu1Byte pCmdBuffer - ); - -typedef BOOLEAN -(*BFP_BTC_GET)( - IN PVOID pBtCoexist, - IN u1Byte getType, - OUT PVOID pOutBuf - ); - -typedef BOOLEAN -(*BFP_BTC_SET)( - IN PVOID pBtCoexist, - IN u1Byte setType, - OUT PVOID pInBuf - ); -typedef u2Byte -(*BFP_BTC_SET_BT_REG)( - IN PVOID pBtcContext, - IN u1Byte regType, - IN u4Byte offset, - IN u4Byte value - ); -typedef BOOLEAN -(*BFP_BTC_SET_BT_ANT_DETECTION)( - IN PVOID pBtcContext, - IN u1Byte txTime, - IN u1Byte btChnl - ); - -typedef BOOLEAN -(*BFP_BTC_SET_BT_TRX_MASK)( - IN PVOID pBtcContext, - IN u1Byte bt_trx_mask - ); - -typedef u4Byte -(*BFP_BTC_GET_BT_REG)( - IN PVOID pBtcContext, - IN u1Byte regType, - IN u4Byte offset - ); -typedef VOID -(*BFP_BTC_DISP_DBG_MSG)( - IN PVOID pBtCoexist, - IN u1Byte dispType - ); - -typedef COL_H2C_STATUS -(*BFP_BTC_COEX_H2C_PROCESS)( - IN PVOID pBtCoexist, - IN u1Byte opcode, - IN u1Byte opcode_ver, - IN pu1Byte ph2c_par, - IN u1Byte h2c_par_len - ); - -typedef u4Byte -(*BFP_BTC_GET_BT_COEX_SUPPORTED_FEATURE)( - IN PVOID pBtcContext - ); - -typedef u4Byte -(*BFP_BTC_GET_BT_COEX_SUPPORTED_VERSION)( - IN PVOID pBtcContext - ); - -typedef u4Byte -(*BFP_BTC_GET_PHYDM_VERSION)( - IN PVOID pBtcContext - ); - -typedef VOID -(*BTC_PHYDM_MODIFY_RA_PCR_THRESHLOD)( - IN PVOID pDM_Odm, - IN u1Byte RA_offset_direction, - IN u1Byte RA_threshold_offset - ); - -typedef u4Byte -(*BTC_PHYDM_CMNINFOQUERY)( - IN PVOID pDM_Odm, - IN u1Byte info_type - ); - -typedef u1Byte -(*BFP_BTC_GET_ANT_DET_VAL_FROM_BT)( - - IN PVOID pBtcContext - ); - -typedef u1Byte -(*BFP_BTC_GET_BLE_SCAN_TYPE_FROM_BT)( - IN PVOID pBtcContext - ); - -typedef u4Byte -(*BFP_BTC_GET_BLE_SCAN_PARA_FROM_BT)( - IN PVOID pBtcContext, - IN u1Byte scanType - ); - -typedef BOOLEAN -(*BFP_BTC_GET_BT_AFH_MAP_FROM_BT)( - IN PVOID pBtcContext, - IN u1Byte mapType, - OUT pu1Byte afhMap - ); - -struct btc_bt_info { - boolean bt_disabled; - boolean bt_enable_disable_change; - u8 rssi_adjust_for_agc_table_on; - u8 rssi_adjust_for_1ant_coex_type; - boolean pre_bt_ctrl_agg_buf_size; - boolean bt_ctrl_agg_buf_size; - boolean pre_reject_agg_pkt; - boolean reject_agg_pkt; - boolean increase_scan_dev_num; - boolean bt_tx_rx_mask; - u8 pre_agg_buf_size; - u8 agg_buf_size; - boolean bt_busy; - boolean limited_dig; - u16 bt_hci_ver; - u16 bt_real_fw_ver; - u8 bt_fw_ver; - u32 get_bt_fw_ver_cnt; - u32 bt_get_fw_ver; - boolean miracast_plus_bt; - - boolean bt_disable_low_pwr; - - boolean bt_ctrl_lps; - boolean bt_lps_on; - boolean force_to_roam; /* for 1Ant solution */ - u8 lps_val; - u8 rpwm_val; - u32 ra_mask; -}; - -struct btc_stack_info { - boolean profile_notified; - u16 hci_version; /* stack hci version */ - u8 num_of_link; - boolean bt_link_exist; - boolean sco_exist; - boolean acl_exist; - boolean a2dp_exist; - boolean hid_exist; - u8 num_of_hid; - boolean pan_exist; - boolean unknown_acl_exist; - s8 min_bt_rssi; -}; - -struct btc_bt_link_info { - boolean bt_link_exist; - boolean bt_hi_pri_link_exist; - boolean sco_exist; - boolean sco_only; - boolean a2dp_exist; - boolean a2dp_only; - boolean hid_exist; - boolean hid_only; - boolean pan_exist; - boolean pan_only; - boolean slave_role; - boolean acl_busy; -}; - -struct btc_statistics { - u32 cnt_bind; - u32 cnt_power_on; - u32 cnt_pre_load_firmware; - u32 cnt_init_hw_config; - u32 cnt_init_coex_dm; - u32 cnt_ips_notify; - u32 cnt_lps_notify; - u32 cnt_scan_notify; - u32 cnt_connect_notify; - u32 cnt_media_status_notify; - u32 cnt_specific_packet_notify; - u32 cnt_bt_info_notify; - u32 cnt_rf_status_notify; - u32 cnt_periodical; - u32 cnt_coex_dm_switch; - u32 cnt_stack_operation_notify; - u32 cnt_dbg_ctrl; -}; - -struct btc_coexist { - BOOLEAN bBinded; /*make sure only one adapter can bind the data context*/ - PVOID Adapter; /*default adapter*/ - struct btc_board_info board_info; - 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; - BTC_CHIP_INTERFACE chip_interface; - PVOID odm_priv; - - BOOLEAN initilized; - BOOLEAN stop_coex_dm; - BOOLEAN manual_control; - BOOLEAN bdontenterLPS; - pu1Byte cli_buf; - struct btc_statistics statistics; - u1Byte pwrModeVal[10]; - - /* function pointers */ - /* io related */ - BFP_BTC_R1 btc_read_1byte; - BFP_BTC_W1 btc_write_1byte; - BFP_BTC_W1_BIT_MASK btc_write_1byte_bitmask; - BFP_BTC_R2 btc_read_2byte; - BFP_BTC_W2 btc_write_2byte; - BFP_BTC_R4 btc_read_4byte; - BFP_BTC_W4 btc_write_4byte; - BFP_BTC_LOCAL_REG_W1 btc_write_local_reg_1byte; - /* read/write bb related */ - BFP_BTC_SET_BB_REG btc_set_bb_reg; - BFP_BTC_GET_BB_REG btc_get_bb_reg; - - /* read/write rf related */ - BFP_BTC_SET_RF_REG btc_set_rf_reg; - BFP_BTC_GET_RF_REG btc_get_rf_reg; - - /* fill h2c related */ - BFP_BTC_FILL_H2C btc_fill_h2c; - /* other */ - BFP_BTC_DISP_DBG_MSG btc_disp_dbg_msg; - /* normal get/set related */ - BFP_BTC_GET btc_get; - BFP_BTC_SET btc_set; - - BFP_BTC_GET_BT_REG btc_get_bt_reg; - BFP_BTC_SET_BT_REG btc_set_bt_reg; - - BFP_BTC_SET_BT_ANT_DETECTION btc_set_bt_ant_detection; - - BFP_BTC_COEX_H2C_PROCESS btc_coex_h2c_process; - BFP_BTC_SET_BT_TRX_MASK btc_set_bt_trx_mask; - BFP_BTC_GET_BT_COEX_SUPPORTED_FEATURE btc_get_bt_coex_supported_feature; - BFP_BTC_GET_BT_COEX_SUPPORTED_VERSION btc_get_bt_coex_supported_version; - 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; - 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; - BFP_BTC_GET_BT_AFH_MAP_FROM_BT btc_get_bt_afh_map_from_bt; -}; -typedef struct btc_coexist *PBTC_COEXIST; - -extern struct btc_coexist GLBtCoexist; - -BOOLEAN -EXhalbtcoutsrc_InitlizeVariables( - IN PVOID Adapter - ); -VOID -EXhalbtcoutsrc_PowerOnSetting( - IN PBTC_COEXIST pBtCoexist - ); -VOID -EXhalbtcoutsrc_PreLoadFirmware( - IN PBTC_COEXIST pBtCoexist - ); -VOID -EXhalbtcoutsrc_InitHwConfig( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bWifiOnly - ); -VOID -EXhalbtcoutsrc_InitCoexDm( - IN PBTC_COEXIST pBtCoexist - ); -VOID -EXhalbtcoutsrc_IpsNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ); -VOID -EXhalbtcoutsrc_LpsNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ); -VOID -EXhalbtcoutsrc_ScanNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ); -VOID -EXhalbtcoutsrc_SetAntennaPathNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ); -VOID -EXhalbtcoutsrc_ConnectNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte action - ); -VOID -EXhalbtcoutsrc_MediaStatusNotify( - IN PBTC_COEXIST pBtCoexist, - IN RT_MEDIA_STATUS mediaStatus - ); -VOID -EXhalbtcoutsrc_SpecificPacketNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte pktType - ); -VOID -EXhalbtcoutsrc_BtInfoNotify( - IN PBTC_COEXIST pBtCoexist, - IN pu1Byte tmpBuf, - IN u1Byte length - ); -VOID -EXhalbtcoutsrc_RfStatusNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ); -VOID -EXhalbtcoutsrc_StackOperationNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ); -VOID -EXhalbtcoutsrc_HaltNotify( - IN PBTC_COEXIST pBtCoexist - ); -VOID -EXhalbtcoutsrc_PnpNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte pnpState - ); -VOID -EXhalbtcoutsrc_CoexDmSwitch( - IN PBTC_COEXIST pBtCoexist - ); -VOID -EXhalbtcoutsrc_Periodical( - IN PBTC_COEXIST pBtCoexist - ); -VOID -EXhalbtcoutsrc_DbgControl( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte opCode, - IN u1Byte opLen, - IN pu1Byte pData - ); -VOID -EXhalbtcoutsrc_AntennaDetection( - IN PBTC_COEXIST pBtCoexist, - IN u4Byte centFreq, - IN u4Byte offset, - IN u4Byte span, - IN u4Byte seconds - ); -VOID -EXhalbtcoutsrc_StackUpdateProfileInfo( - VOID - ); -VOID -EXhalbtcoutsrc_SetHciVersion( - IN u2Byte hciVersion - ); -VOID -EXhalbtcoutsrc_SetBtPatchVersion( - IN u2Byte btHciVersion, - IN u2Byte btPatchVersion - ); -VOID -EXhalbtcoutsrc_UpdateMinBtRssi( - IN s1Byte btRssi - ); -#if 0 -VOID -EXhalbtcoutsrc_SetBtExist( - IN BOOLEAN bBtExist - ); -#endif -VOID -EXhalbtcoutsrc_SetChipType( - IN u1Byte chipType - ); -VOID -EXhalbtcoutsrc_SetAntNum( - IN u1Byte type, - IN u1Byte antNum - ); -VOID -EXhalbtcoutsrc_SetSingleAntPath( - IN u1Byte singleAntPath - ); -VOID -EXhalbtcoutsrc_DisplayBtCoexInfo( - IN PBTC_COEXIST pBtCoexist - ); -VOID -EXhalbtcoutsrc_DisplayAntDetection( - IN PBTC_COEXIST pBtCoexist - ); - -#define MASKBYTE0 0xff -#define MASKBYTE1 0xff00 -#define MASKBYTE2 0xff0000 -#define MASKBYTE3 0xff000000 -#define MASKHWORD 0xffff0000 -#define MASKLWORD 0x0000ffff -#define MASKDWORD 0xffffffff -#define MASK12BITS 0xfff -#define MASKH4BITS 0xf0000000 -#define MASKOFDM_D 0xffc00000 -#define MASKCCK 0x3f3f3f3f - -#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/mp_precomp.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/mp_precomp.h deleted file mode 100644 index 54125b1c6427..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/btc/mp_precomp.h +++ /dev/null @@ -1,90 +0,0 @@ -/****************************************************************************** - * - * Copyright(c) 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 - * - * - ******************************************************************************/ -#ifndef __MP_PRECOMP_H__ -#define __MP_PRECOMP_H__ - -#include -#include - -#define BT_TMP_BUF_SIZE 100 - -#ifdef PLATFORM_LINUX -#define rsprintf snprintf -#elif defined(PLATFORM_WINDOWS) -#define rsprintf sprintf_s -#endif - -#define DCMD_Printf DBG_BT_INFO - -#define delay_ms(ms) rtw_mdelay_os(ms) - -#ifdef bEnable -#undef bEnable -#endif - -#define WPP_SOFTWARE_TRACE 0 - -typedef enum _BTC_MSG_COMP_TYPE { - COMP_COEX = 0, - COMP_MAX -} BTC_MSG_COMP_TYPE; -extern u4Byte GLBtcDbgType[]; - -#define DBG_OFF 0 -#define DBG_SEC 1 -#define DBG_SERIOUS 2 -#define DBG_WARNING 3 -#define DBG_LOUD 4 -#define DBG_TRACE 5 - -#ifdef CONFIG_BT_COEXIST -#define BT_SUPPORT 1 -#define COEX_SUPPORT 1 -#define HS_SUPPORT 1 -#else -#define BT_SUPPORT 0 -#define COEX_SUPPORT 0 -#define HS_SUPPORT 0 -#endif - -#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 "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__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/efuse/efuse_mask.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/efuse/efuse_mask.h index 849a4e49d0bf..ad6b61069d22 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/efuse/efuse_mask.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/efuse/efuse_mask.h @@ -1,107 +1,176 @@ /* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * 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 +#ifdef CONFIG_USB_HCI -#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_RTL8188GTV) + #include "rtl8188gtv/HalEfuseMask8188GTV_USB.h" + #endif -#elif DEV_BUS_TYPE == RT_PCI_INTERFACE + #if defined(CONFIG_RTL8822B) + #include "rtl8822b/HalEfuseMask8822B_USB.h" + #endif -#if defined(CONFIG_RTL8188E) - #include "rtl8188e/HalEfuseMask8188E_PCIE.h" -#endif + #if defined(CONFIG_RTL8821C) + #include "rtl8821c/HalEfuseMask8821C_USB.h" + #endif + + #if defined(CONFIG_RTL8710B) + #include "rtl8710b/HalEfuseMask8710B_USB.h" + #endif + + #if defined(CONFIG_RTL8192F) + #include "rtl8192f/HalEfuseMask8192F_USB.h" + #endif + #if defined(CONFIG_RTL8822C) + #include "rtl8822c/HalEfuseMask8822C_USB.h" + #endif +#endif /*CONFIG_USB_HCI*/ -#if defined(CONFIG_RTL8812A) - #include "rtl8812a/HalEfuseMask8812A_PCIE.h" -#endif +#ifdef CONFIG_PCI_HCI -#if defined(CONFIG_RTL8821A) - #include "rtl8812a/HalEfuseMask8821A_PCIE.h" -#endif + #if defined(CONFIG_RTL8188E) + #include "rtl8188e/HalEfuseMask8188E_PCIE.h" + #endif -#if defined(CONFIG_RTL8192E) - #include "rtl8192e/HalEfuseMask8192E_PCIE.h" -#endif + #if defined(CONFIG_RTL8812A) + #include "rtl8812a/HalEfuseMask8812A_PCIE.h" + #endif -#if defined(CONFIG_RTL8723B) - #include "rtl8723b/HalEfuseMask8723B_PCIE.h" -#endif + #if defined(CONFIG_RTL8821A) + #include "rtl8812a/HalEfuseMask8821A_PCIE.h" + #endif -#if defined(CONFIG_RTL8814A) - #include "rtl8814a/HalEfuseMask8814A_PCIE.h" -#endif + #if defined(CONFIG_RTL8192E) + #include "rtl8192e/HalEfuseMask8192E_PCIE.h" + #endif -#if defined(CONFIG_RTL8703B) - #include "rtl8703b/HalEfuseMask8703B_PCIE.h" -#endif + #if defined(CONFIG_RTL8723B) + #include "rtl8723b/HalEfuseMask8723B_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_RTL8814A) + #include "rtl8814a/HalEfuseMask8814A_PCIE.h" + #endif -#elif DEV_BUS_TYPE == RT_SDIO_INTERFACE + #if defined(CONFIG_RTL8703B) + #include "rtl8703b/HalEfuseMask8703B_PCIE.h" + #endif -#if defined(CONFIG_RTL8188E) - #include "rtl8188e/HalEfuseMask8188E_SDIO.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 -#if defined(CONFIG_RTL8703B) - #include "rtl8703b/HalEfuseMask8703B_SDIO.h" -#endif + #if defined(CONFIG_RTL8192F) + #include "rtl8192f/HalEfuseMask8192F_PCIE.h" + #endif + #if defined(CONFIG_RTL8822C) + #include "rtl8822c/HalEfuseMask8822C_PCIE.h" + #endif +#endif /*CONFIG_PCI_HCI*/ +#ifdef CONFIG_SDIO_HCI + #if defined(CONFIG_RTL8723B) + #include "rtl8723b/HalEfuseMask8723B_SDIO.h" + #endif -#if defined(CONFIG_RTL8188F) - #include "rtl8188f/HalEfuseMask8188F_SDIO.h" -#endif + #if defined(CONFIG_RTL8188E) + #include "rtl8188e/HalEfuseMask8188E_SDIO.h" + #endif -#if defined(CONFIG_RTL8723D) - #include "rtl8723d/HalEfuseMask8723D_SDIO.h" -#endif + #if defined(CONFIG_RTL8703B) + #include "rtl8703b/HalEfuseMask8703B_SDIO.h" + #endif -#if defined(CONFIG_RTL8821C) - #include "rtl8821c/HalEfuseMask8821C_SDIO.h" -#endif + #if defined(CONFIG_RTL8188F) + #include "rtl8188f/HalEfuseMask8188F_SDIO.h" + #endif -#if defined(CONFIG_RTL8822B) - #include "rtl8822b/HalEfuseMask8822B_SDIO.h" -#endif -#endif + #if defined(CONFIG_RTL8188GTV) + #include "rtl8188gtv/HalEfuseMask8188GTV_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 + + #if defined(CONFIG_RTL8192F) + #include "rtl8192f/HalEfuseMask8192F_SDIO.h" + #endif + + + #if defined(CONFIG_RTL8822C) + #include "rtl8822c/HalEfuseMask8822C_SDIO.h" + #endif + +#endif /*CONFIG_SDIO_HCI*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/efuse/rtl8188e/HalEfuseMask8188E_PCIE.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/efuse/rtl8188e/HalEfuseMask8188E_PCIE.c index bdbd7179bb79..bbe2b616e84f 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/efuse/rtl8188e/HalEfuseMask8188E_PCIE.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/efuse/rtl8188e/HalEfuseMask8188E_PCIE.c @@ -1,22 +1,18 @@ +/* SPDX-License-Identifier: GPL-2.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 -* -* -******************************************************************************/ + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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" */ @@ -31,7 +27,7 @@ * MPCIE.TXT ******************************************************************************/ -u1Byte Array_MP_8188E_MPCIE[] = { +u8 Array_MP_8188E_MPCIE[] = { 0xFF, 0xF3, 0x00, @@ -67,25 +63,25 @@ u1Byte Array_MP_8188E_MPCIE[] = { }; -u2Byte -EFUSE_GetArrayLen_MP_8188E_MPCIE(VOID) +u16 +EFUSE_GetArrayLen_MP_8188E_MPCIE(void) { - return sizeof(Array_MP_8188E_MPCIE) / sizeof(u1Byte); + return sizeof(Array_MP_8188E_MPCIE) / sizeof(u8); } -VOID +void EFUSE_GetMaskArray_MP_8188E_MPCIE( - IN OUT pu1Byte Array + u8 *Array ) { - u2Byte len = EFUSE_GetArrayLen_MP_8188E_MPCIE(), i = 0; + u16 len = EFUSE_GetArrayLen_MP_8188E_MPCIE(), i = 0; for (i = 0; i < len; ++i) Array[i] = Array_MP_8188E_MPCIE[i]; } BOOLEAN EFUSE_IsAddressMasked_MP_8188E_MPCIE( - IN u2Byte Offset + u16 Offset ) { int r = Offset / 16; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/efuse/rtl8188e/HalEfuseMask8188E_PCIE.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/efuse/rtl8188e/HalEfuseMask8188E_PCIE.h index f4f15f3562f3..acfb727f8f05 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/efuse/rtl8188e/HalEfuseMask8188E_PCIE.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/efuse/rtl8188e/HalEfuseMask8188E_PCIE.h @@ -1,22 +1,18 @@ +/* SPDX-License-Identifier: GPL-2.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 -* -* -******************************************************************************/ + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + *****************************************************************************/ @@ -25,15 +21,15 @@ ******************************************************************************/ -u2Byte -EFUSE_GetArrayLen_MP_8188E_MPCIE(VOID); +u16 +EFUSE_GetArrayLen_MP_8188E_MPCIE(void); -VOID +void EFUSE_GetMaskArray_MP_8188E_MPCIE( - IN OUT pu1Byte Array + u8 *Array ); BOOLEAN EFUSE_IsAddressMasked_MP_8188E_MPCIE(/* TC: Test Chip, MP: MP Chip */ - IN u2Byte Offset + u16 Offset ); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/efuse/rtl8188e/HalEfuseMask8188E_SDIO.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/efuse/rtl8188e/HalEfuseMask8188E_SDIO.c index d2b4ba16ee3f..b427ba4cdb69 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/efuse/rtl8188e/HalEfuseMask8188E_SDIO.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/efuse/rtl8188e/HalEfuseMask8188E_SDIO.c @@ -1,22 +1,18 @@ +/* SPDX-License-Identifier: GPL-2.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 -* -* -******************************************************************************/ + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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" */ @@ -31,7 +27,7 @@ * MSDIO.TXT ******************************************************************************/ -u1Byte Array_MP_8188E_MSDIO[] = { +u8 Array_MP_8188E_MSDIO[] = { 0xFF, 0xF3, 0x00, @@ -67,25 +63,25 @@ u1Byte Array_MP_8188E_MSDIO[] = { }; -u2Byte -EFUSE_GetArrayLen_MP_8188E_MSDIO(VOID) +u16 +EFUSE_GetArrayLen_MP_8188E_MSDIO(void) { - return sizeof(Array_MP_8188E_MSDIO) / sizeof(u1Byte); + return sizeof(Array_MP_8188E_MSDIO) / sizeof(u8); } -VOID +void EFUSE_GetMaskArray_MP_8188E_MSDIO( - IN OUT pu1Byte Array + u8 *Array ) { - u2Byte len = EFUSE_GetArrayLen_MP_8188E_MSDIO(), i = 0; + u16 len = EFUSE_GetArrayLen_MP_8188E_MSDIO(), i = 0; for (i = 0; i < len; ++i) Array[i] = Array_MP_8188E_MSDIO[i]; } BOOLEAN EFUSE_IsAddressMasked_MP_8188E_MSDIO( - IN u2Byte Offset + u16 Offset ) { int r = Offset / 16; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/efuse/rtl8188e/HalEfuseMask8188E_SDIO.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/efuse/rtl8188e/HalEfuseMask8188E_SDIO.h index f1f2ac243b21..22b3b3ff100e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/efuse/rtl8188e/HalEfuseMask8188E_SDIO.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/efuse/rtl8188e/HalEfuseMask8188E_SDIO.h @@ -1,22 +1,18 @@ +/* SPDX-License-Identifier: GPL-2.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 -* -* -******************************************************************************/ + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + *****************************************************************************/ @@ -25,15 +21,15 @@ ******************************************************************************/ -u2Byte -EFUSE_GetArrayLen_MP_8188E_MSDIO(VOID); +u16 +EFUSE_GetArrayLen_MP_8188E_MSDIO(void); -VOID +void EFUSE_GetMaskArray_MP_8188E_MSDIO( - IN OUT pu1Byte Array + u8 *Array ); BOOLEAN EFUSE_IsAddressMasked_MP_8188E_MSDIO(/* TC: Test Chip, MP: MP Chip */ - IN u2Byte Offset + u16 Offset ); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/efuse/rtl8188e/HalEfuseMask8188E_USB.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/efuse/rtl8188e/HalEfuseMask8188E_USB.c index 7bf04448e2d3..9c0f2707c2b3 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/efuse/rtl8188e/HalEfuseMask8188E_USB.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/efuse/rtl8188e/HalEfuseMask8188E_USB.c @@ -1,22 +1,18 @@ +/* SPDX-License-Identifier: GPL-2.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 -* -* -******************************************************************************/ + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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" */ @@ -30,7 +26,7 @@ * MUSB.TXT ******************************************************************************/ -u1Byte Array_MP_8188E_MUSB[] = { +u8 Array_MP_8188E_MUSB[] = { 0xFF, 0xF3, 0x00, @@ -66,25 +62,25 @@ u1Byte Array_MP_8188E_MUSB[] = { }; -u2Byte -EFUSE_GetArrayLen_MP_8188E_MUSB(VOID) +u16 +EFUSE_GetArrayLen_MP_8188E_MUSB(void) { - return sizeof(Array_MP_8188E_MUSB) / sizeof(u1Byte); + return sizeof(Array_MP_8188E_MUSB) / sizeof(u8); } -VOID +void EFUSE_GetMaskArray_MP_8188E_MUSB( - IN OUT pu1Byte Array + u8 *Array ) { - u2Byte len = EFUSE_GetArrayLen_MP_8188E_MUSB(), i = 0; + u16 len = EFUSE_GetArrayLen_MP_8188E_MUSB(), i = 0; for (i = 0; i < len; ++i) Array[i] = Array_MP_8188E_MUSB[i]; } BOOLEAN EFUSE_IsAddressMasked_MP_8188E_MUSB( - IN u2Byte Offset + u16 Offset ) { int r = Offset / 16; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/efuse/rtl8188e/HalEfuseMask8188E_USB.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/efuse/rtl8188e/HalEfuseMask8188E_USB.h index 8b70454486a4..95a1f78ca2b8 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/efuse/rtl8188e/HalEfuseMask8188E_USB.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/efuse/rtl8188e/HalEfuseMask8188E_USB.h @@ -1,22 +1,18 @@ +/* SPDX-License-Identifier: GPL-2.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 -* -* -******************************************************************************/ + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + *****************************************************************************/ @@ -25,15 +21,15 @@ ******************************************************************************/ -u2Byte -EFUSE_GetArrayLen_MP_8188E_MUSB(VOID); +u16 +EFUSE_GetArrayLen_MP_8188E_MUSB(void); -VOID +void EFUSE_GetMaskArray_MP_8188E_MUSB( - IN OUT pu1Byte Array + u8 *Array ); BOOLEAN EFUSE_IsAddressMasked_MP_8188E_MUSB(/* TC: Test Chip, MP: MP Chip */ - IN u2Byte Offset + u16 Offset ); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_btcoex.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_btcoex.c index 492f73f23611..fc6fc623eba1 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_btcoex.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_btcoex.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 @@ -76,13 +72,14 @@ const char *const GLBtcWifiBwString[] = { "11bg", "HT20", "HT40", - "HT80", - "HT160" + "VHT80", + "VHT160" }; const char *const GLBtcWifiFreqString[] = { "2.4G", - "5G" + "5G", + "2.4G+5G" }; const char *const GLBtcIotPeerString[] = { @@ -179,8 +176,12 @@ typedef enum _bt_op_code { BT_OP_GET_BT_COEX_SUPPORTED_FEATURE = 0x2a, BT_OP_GET_BT_COEX_SUPPORTED_VERSION = 0x2b, 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_BLE_SCAN_TYPE = 0x2d, + BT_OP_GET_BT_BLE_SCAN_PARA = 0x2e, + BT_OP_GET_BT_DEVICE_INFO = 0x30, + BT_OP_GET_BT_FORBIDDEN_SLOT_VAL = 0x31, + BT_OP_SET_BT_LANCONSTRAIN_LEVEL = 0x32, + BT_OP_SET_BT_TEST_MODE_VAL = 0x33, BT_OP_MAX } BT_OP_CODE; @@ -204,7 +205,7 @@ u8 GLBtcBtMpRptBTOK; */ u32 GLBtcDbgType[COMP_MAX]; u8 GLBtcDbgBuf[BT_TMP_BUF_SIZE]; -u1Byte gl_btc_trace_buf[BT_TMP_BUF_SIZE]; +u8 gl_btc_trace_buf[BT_TMP_BUF_SIZE]; typedef struct _btcoexdbginfo { u8 *info; @@ -269,13 +270,20 @@ static void halbtcoutsrc_DbgInit(void) GLBtcDbgType[i] = 0; } -static u8 halbtcoutsrc_IsCsrBtCoex(PBTC_COEXIST pBtCoexist) +static void halbtcoutsrc_EnterPwrLock(PBTC_COEXIST pBtCoexist) { - if (pBtCoexist->board_info.bt_chip_type == BTC_CHIP_CSR_BC4 - || pBtCoexist->board_info.bt_chip_type == BTC_CHIP_CSR_BC8 - ) - return _TRUE; - return _FALSE; + 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) @@ -290,7 +298,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 +308,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) @@ -341,6 +349,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 +378,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 */ @@ -480,12 +506,33 @@ u8 halbtcoutsrc_is_fw_ready(PBTC_COEXIST pBtCoexist) padapter = pBtCoexist->Adapter; - return padapter->bFWReady; + 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; @@ -562,10 +609,116 @@ u32 halbtcoutsrc_GetWifiLinkStatus(PBTC_COEXIST pBtCoexist) return retVal; } +struct btc_wifi_link_info halbtcoutsrc_getwifilinkinfo(PBTC_COEXIST pBtCoexist) +{ + u8 n_assoc_iface = 0, i =0, mcc_en = _FALSE; + PADAPTER adapter = NULL; + PADAPTER iface = NULL; + PADAPTER sta_iface = NULL, p2p_iface = NULL, ap_iface = NULL; + BTC_LINK_MODE btc_link_moe = BTC_LINK_MAX; + struct dvobj_priv *dvobj = NULL; + struct mlme_ext_priv *mlmeext = NULL; + struct btc_wifi_link_info wifi_link_info; + + adapter = (PADAPTER)pBtCoexist->Adapter; + dvobj = adapter_to_dvobj(adapter); + n_assoc_iface = rtw_mi_get_assoc_if_num(adapter); + + /* init value */ + wifi_link_info.link_mode = BTC_LINK_NONE; + wifi_link_info.sta_center_channel = 0; + wifi_link_info.p2p_center_channel = 0; + wifi_link_info.bany_client_join_go = _FALSE; + wifi_link_info.benable_noa = _FALSE; + wifi_link_info.bhotspot = _FALSE; + + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + if (!iface) + continue; + + mlmeext = &iface->mlmeextpriv; + if (MLME_IS_GO(iface)) { + wifi_link_info.link_mode = BTC_LINK_ONLY_GO; + wifi_link_info.p2p_center_channel = + rtw_get_center_ch(mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset); + p2p_iface = iface; + if (rtw_linked_check(iface)) + wifi_link_info.bany_client_join_go = _TRUE; + } else if (MLME_IS_GC(iface)) { + wifi_link_info.link_mode = BTC_LINK_ONLY_GC; + wifi_link_info.p2p_center_channel = + rtw_get_center_ch(mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset); + p2p_iface = iface; + } else if (MLME_IS_AP(iface)) { + wifi_link_info.link_mode = BTC_LINK_ONLY_AP; + ap_iface = iface; + wifi_link_info.p2p_center_channel = + rtw_get_center_ch(mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset); + } else if (MLME_IS_STA(iface) && rtw_linked_check(iface)) { + wifi_link_info.link_mode = BTC_LINK_ONLY_STA; + wifi_link_info.sta_center_channel = + rtw_get_center_ch(mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset); + sta_iface = iface; + } + } + +#ifdef CONFIG_MCC_MODE + if (MCC_EN(adapter)) { + if (rtw_hal_check_mcc_status(adapter, MCC_STATUS_DOING_MCC)) + mcc_en = _TRUE; + } +#endif/* CONFIG_MCC_MODE */ + + if (n_assoc_iface == 0) { + wifi_link_info.link_mode = BTC_LINK_NONE; + } else if (n_assoc_iface == 1) { + /* by pass */ + } else if (n_assoc_iface == 2) { + if (sta_iface && p2p_iface) { + u8 band_sta = sta_iface->mlmeextpriv.cur_channel > 14 ? BAND_ON_5G : BAND_ON_2_4G; + u8 band_p2p = p2p_iface->mlmeextpriv.cur_channel > 14 ? BAND_ON_5G : BAND_ON_2_4G; + if (band_sta == band_p2p) { + switch (band_sta) { + case BAND_ON_2_4G: + if (MLME_IS_GO(p2p_iface)) + wifi_link_info.link_mode = + mcc_en == _TRUE ? BTC_LINK_2G_MCC_GO_STA : BTC_LINK_2G_SCC_GO_STA; + else if (MLME_IS_GC(p2p_iface)) + wifi_link_info.link_mode = + mcc_en == _TRUE ? BTC_LINK_2G_MCC_GC_STA : BTC_LINK_2G_SCC_GC_STA; + break; + case BAND_ON_5G: + if (MLME_IS_GO(p2p_iface)) + wifi_link_info.link_mode = + mcc_en == _TRUE ? BTC_LINK_5G_MCC_GO_STA : BTC_LINK_5G_SCC_GO_STA; + else if (MLME_IS_GC(p2p_iface)) + wifi_link_info.link_mode = + mcc_en == _TRUE ? BTC_LINK_5G_MCC_GC_STA : BTC_LINK_5G_SCC_GC_STA; + break; + default: + break; + } + } else { + if (MLME_IS_GO(p2p_iface)) + wifi_link_info.link_mode = BTC_LINK_25G_MCC_GO_STA; + else if (MLME_IS_GC(p2p_iface)) + wifi_link_info.link_mode = BTC_LINK_25G_MCC_GC_STA; + } + } + } else { + if (pBtCoexist->board_info.btdm_ant_num == 1) + RTW_ERR("%s do not support n_assoc_iface > 2 (ant_num == 1)", __func__); + } + + return wifi_link_info; +} + + static void _btmpoper_timer_hdl(void *p) { - if (GLBtcBtMpRptWait) { - GLBtcBtMpRptWait = 0; + if (GLBtcBtMpRptWait == _TRUE) { + GLBtcBtMpRptWait = _FALSE; _rtw_up_sema(&GLBtcBtMpRptSema); } } @@ -581,7 +734,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; @@ -599,31 +751,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) { - RTW_ERR("%s: Didn't get BT response!\n", __FUNCTION__); + 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); @@ -678,8 +831,8 @@ u32 halbtcoutsrc_GetBtPatchVer(PBTC_COEXIST pBtCoexist) _exit_critical_mutex(&GLBtcBtMpOperLock, &irqL); } else { #ifdef CONFIG_BT_COEXIST_SOCKET_TRX - u1Byte dataLen = 2; - u1Byte buf[4] = {0}; + u8 dataLen = 2; + u8 buf[4] = {0}; buf[0] = 0x0; /* OP_Code */ buf[1] = 0x0; /* OP_Code_Length */ @@ -688,20 +841,12 @@ u32 halbtcoutsrc_GetBtPatchVer(PBTC_COEXIST pBtCoexist) } } -exit: return pBtCoexist->bt_info.bt_real_fw_ver; } s32 halbtcoutsrc_GetWifiRssi(PADAPTER padapter) { - PHAL_DATA_TYPE pHalData; - s32 undecorated_smoothed_pwdb = 0; - - pHalData = GET_HAL_DATA(padapter); - - undecorated_smoothed_pwdb = pHalData->entry_min_undecorated_smoothed_pwdb; - - return undecorated_smoothed_pwdb; + return rtw_dm_get_min_rssi(padapter); } u32 halbtcoutsrc_GetBtCoexSupportedFeature(void *pBtcContext) @@ -766,6 +911,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; @@ -792,11 +999,13 @@ u8 halbtcoutsrc_Get(void *pBtcContext, u8 getType, void *pOutBuf) PADAPTER padapter; PHAL_DATA_TYPE pHalData; struct mlme_ext_priv *mlmeext; + struct btc_wifi_link_info *wifi_link_info; u8 bSoftApExist, bVwifiExist; u8 *pu8; s32 *pS4Tmp; u32 *pU4Tmp; u8 *pU1Tmp; + u16 *pU2Tmp; u8 ret; @@ -813,6 +1022,8 @@ u8 halbtcoutsrc_Get(void *pBtcContext, u8 getType, void *pOutBuf) pS4Tmp = (s32 *)pOutBuf; pU4Tmp = (u32 *)pOutBuf; pU1Tmp = (u8 *)pOutBuf; + pU2Tmp = (u16*)pOutBuf; + wifi_link_info = (struct btc_wifi_link_info *)pOutBuf; ret = _TRUE; switch (getType) { @@ -834,6 +1045,10 @@ u8 halbtcoutsrc_Get(void *pBtcContext, u8 getType, void *pOutBuf) *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; @@ -861,7 +1076,7 @@ u8 halbtcoutsrc_Get(void *pBtcContext, u8 getType, void *pOutBuf) break; case BTC_GET_BL_WIFI_UNDER_5G: - *pu8 = (pHalData->current_band_type == 1) ? _TRUE : _FALSE; + *pu8 = (pHalData->current_band_type == BAND_ON_5G) ? _TRUE : _FALSE; break; case BTC_GET_BL_WIFI_AP_MODE_ENABLE: @@ -894,6 +1109,22 @@ 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_BL_WIFI_LW_PWR_STATE: + /* return false due to coex do not run during 32K */ + *pu8 = FALSE; + break; + case BTC_GET_S4_WIFI_RSSI: *pS4Tmp = halbtcoutsrc_GetWifiRssi(padapter); break; @@ -948,7 +1179,9 @@ u8 halbtcoutsrc_Get(void *pBtcContext, u8 getType, void *pOutBuf) case BTC_GET_U4_WIFI_LINK_STATUS: *pU4Tmp = halbtcoutsrc_GetWifiLinkStatus(pBtCoexist); break; - + case BTC_GET_BL_WIFI_LINK_INFO: + *wifi_link_info = halbtcoutsrc_getwifilinkinfo(pBtCoexist); + break; case BTC_GET_U4_BT_PATCH_VER: *pU4Tmp = halbtcoutsrc_GetBtPatchVer(pBtCoexist); break; @@ -964,6 +1197,14 @@ 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.n_iqk_cnt; break; @@ -1014,24 +1255,24 @@ u8 halbtcoutsrc_Get(void *pBtcContext, u8 getType, void *pOutBuf) case BTC_GET_U1_ANT_TYPE: switch (pHalData->bt_coexist.btAntisolation) { case 0: - *pU1Tmp = (u1Byte)BTC_ANT_TYPE_0; - pBtCoexist->board_info.ant_type = (u1Byte)BTC_ANT_TYPE_0; + *pU1Tmp = (u8)BTC_ANT_TYPE_0; + pBtCoexist->board_info.ant_type = (u8)BTC_ANT_TYPE_0; break; case 1: - *pU1Tmp = (u1Byte)BTC_ANT_TYPE_1; - pBtCoexist->board_info.ant_type = (u1Byte)BTC_ANT_TYPE_1; + *pU1Tmp = (u8)BTC_ANT_TYPE_1; + pBtCoexist->board_info.ant_type = (u8)BTC_ANT_TYPE_1; break; case 2: - *pU1Tmp = (u1Byte)BTC_ANT_TYPE_2; - pBtCoexist->board_info.ant_type = (u1Byte)BTC_ANT_TYPE_2; + *pU1Tmp = (u8)BTC_ANT_TYPE_2; + pBtCoexist->board_info.ant_type = (u8)BTC_ANT_TYPE_2; break; case 3: - *pU1Tmp = (u1Byte)BTC_ANT_TYPE_3; - pBtCoexist->board_info.ant_type = (u1Byte)BTC_ANT_TYPE_3; + *pU1Tmp = (u8)BTC_ANT_TYPE_3; + pBtCoexist->board_info.ant_type = (u8)BTC_ANT_TYPE_3; break; case 4: - *pU1Tmp = (u1Byte)BTC_ANT_TYPE_4; - pBtCoexist->board_info.ant_type = (u1Byte)BTC_ANT_TYPE_4; + *pU1Tmp = (u8)BTC_ANT_TYPE_4; + pBtCoexist->board_info.ant_type = (u8)BTC_ANT_TYPE_4; break; } break; @@ -1044,6 +1285,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; @@ -1052,6 +1297,30 @@ u8 halbtcoutsrc_Get(void *pBtcContext, u8 getType, void *pOutBuf) return ret; } +u16 halbtcoutsrc_LnaConstrainLvl(void *pBtcContext, u8 *lna_constrain_level) +{ + PBTC_COEXIST pBtCoexist; + u16 ret = BT_STATUS_BT_OP_SUCCESS; + + pBtCoexist = (PBTC_COEXIST)pBtcContext; + + if (halbtcoutsrc_IsHwMailboxExist(pBtCoexist) == _TRUE) { + _irqL irqL; + u8 op_code; + + _enter_critical_mutex(&GLBtcBtMpOperLock, &irqL); + + ret = _btmpoper_cmd(pBtCoexist, BT_OP_SET_BT_LANCONSTRAIN_LEVEL, 0, lna_constrain_level, 1); + + _exit_critical_mutex(&GLBtcBtMpOperLock, &irqL); + } else { + ret = BT_STATUS_NOT_IMPLEMENT; + RTW_INFO("%s halbtcoutsrc_IsHwMailboxExist(pBtCoexist) == FALSE\n", __func__); + } + + return ret; +} + u8 halbtcoutsrc_Set(void *pBtcContext, u8 setType, void *pInBuf) { PBTC_COEXIST pBtCoexist; @@ -1061,9 +1330,13 @@ u8 halbtcoutsrc_Set(void *pBtcContext, u8 setType, void *pInBuf) u8 *pU1Tmp; u32 *pU4Tmp; u8 ret; + u8 result = _TRUE; pBtCoexist = (PBTC_COEXIST)pBtcContext; + if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) + return _FALSE; + padapter = pBtCoexist->Adapter; pHalData = GET_HAL_DATA(padapter); pu8 = (u8 *)pInBuf; @@ -1071,9 +1344,6 @@ u8 halbtcoutsrc_Set(void *pBtcContext, u8 setType, void *pInBuf) pU4Tmp = (u32 *)pInBuf; ret = _TRUE; - if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) - return _FALSE; - switch (setType) { /* set some u8 type variables. */ case BTC_SET_BL_BT_DISABLE: @@ -1154,7 +1424,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: @@ -1165,11 +1435,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) { @@ -1178,8 +1457,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, psta->rssi_level, _FALSE); + rtw_hal_update_ra_mask(psta); } + */ break; case BTC_SET_ACT_SEND_MIMO_PS: { @@ -1231,8 +1511,8 @@ u8 halbtcoutsrc_Set(void *pBtcContext, u8 setType, void *pInBuf) case BTC_SET_ACT_CTRL_8723B_ANT: #if 0 { - u1Byte dataLen = *pU1Tmp; - u1Byte tmpBuf[BTC_TMP_BUF_SHORT]; + u8 dataLen = *pU1Tmp; + u8 tmpBuf[BTC_TMP_BUF_SHORT]; if (dataLen) PlatformMoveMemory(&tmpBuf[0], pU1Tmp + 1, dataLen); BT_Set8723bAnt(Adapter, dataLen, &tmpBuf[0]); @@ -1241,13 +1521,16 @@ u8 halbtcoutsrc_Set(void *pBtcContext, u8 setType, void *pInBuf) ret = _FALSE; #endif break; + case BTC_SET_BL_BT_LNA_CONSTRAIN_LEVEL: + halbtcoutsrc_LnaConstrainLvl(pBtCoexist, pu8); + break; /* ===================== */ default: ret = _FALSE; break; } - return ret; + return result; } u8 halbtcoutsrc_UnderIps(PBTC_COEXIST pBtCoexist) @@ -1293,8 +1576,8 @@ void halbtcoutsrc_DisplayCoexStatistics(PBTC_COEXIST pBtCoexist) PBT_MGNT pBtMgnt = &padapter->MgntInfo.BtInfo.BtMgnt; PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); u8 *cliBuf = pBtCoexist->cliBuf; - u1Byte i, j; - u1Byte tmpbuf[BTC_TMP_BUF_SHORT]; + u8 i, j; + u8 tmpbuf[BTC_TMP_BUF_SHORT]; if (gl_coex_offload.cnt_h2c_sent) { @@ -1492,18 +1775,108 @@ 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; + PHAL_DATA_TYPE hal = GET_HAL_DATA(padapter); + struct btc_wifi_link_info wifi_link_info; + + wifi_link_info = halbtcoutsrc_getwifilinkinfo(pBtCoexist); + + switch (wifi_link_info.link_mode) { + case BTC_LINK_NONE: + CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %d/ %d", "WifiLinkMode/HotSpa/Noa/ClientJoin", + "None", wifi_link_info.bhotspot, wifi_link_info.benable_noa, wifi_link_info.bany_client_join_go); + wifiFreq = hal->current_channel > 14 ? BTC_FREQ_5G : BTC_FREQ_2_4G; + break; + case BTC_LINK_ONLY_GO: + CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %d/ %d", "WifiLinkMode/HotSpa/Noa/ClientJoin", + "ONLY_GO", wifi_link_info.bhotspot, wifi_link_info.benable_noa, wifi_link_info.bany_client_join_go); + wifiFreq = hal->current_channel > 14 ? BTC_FREQ_5G : BTC_FREQ_2_4G; + break; + case BTC_LINK_ONLY_GC: + CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %d/ %d", "WifiLinkMode/HotSpa/Noa/ClientJoin", + "ONLY_GC", wifi_link_info.bhotspot, wifi_link_info.benable_noa, wifi_link_info.bany_client_join_go); + wifiFreq = hal->current_channel > 14 ? BTC_FREQ_5G : BTC_FREQ_2_4G; + break; + case BTC_LINK_ONLY_STA: + CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %d/ %d", "WifiLinkMode/HotSpa/Noa/ClientJoin", + "ONLY_STA", wifi_link_info.bhotspot, wifi_link_info.benable_noa, wifi_link_info.bany_client_join_go); + wifiFreq = hal->current_channel > 14 ? BTC_FREQ_5G : BTC_FREQ_2_4G; + break; + case BTC_LINK_ONLY_AP: + CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %d/ %d", "WifiLinkMode/HotSpa/Noa/ClientJoin", + "ONLY_AP", wifi_link_info.bhotspot, wifi_link_info.benable_noa, wifi_link_info.bany_client_join_go); + wifiFreq = hal->current_channel > 14 ? BTC_FREQ_5G : BTC_FREQ_2_4G; + break; + case BTC_LINK_2G_MCC_GO_STA: + CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %d/ %d", "WifiLinkMode/HotSpa/Noa/ClientJoin", + "24G_MCC_GO_STA", wifi_link_info.bhotspot, wifi_link_info.benable_noa, wifi_link_info.bany_client_join_go); + wifiFreq = BTC_FREQ_2_4G; + break; + case BTC_LINK_5G_MCC_GO_STA: + CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %d/ %d", "WifiLinkMode/HotSpa/Noa/ClientJoin", + "5G_MCC_GO_STA", wifi_link_info.bhotspot, wifi_link_info.benable_noa, wifi_link_info.bany_client_join_go); + wifiFreq = BTC_FREQ_5G; + break; + case BTC_LINK_25G_MCC_GO_STA: + CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %d/ %d", "WifiLinkMode/HotSpa/Noa/ClientJoin", + "2BANDS_MCC_GO_STA", wifi_link_info.bhotspot, wifi_link_info.benable_noa, wifi_link_info.bany_client_join_go); + wifiFreq = BTC_FREQ_25G; + break; + case BTC_LINK_2G_MCC_GC_STA: + CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %d/ %d", "WifiLinkMode/HotSpa/Noa/ClientJoin", + "24G_MCC_GC_STA", wifi_link_info.bhotspot, wifi_link_info.benable_noa, wifi_link_info.bany_client_join_go); + wifiFreq = BTC_FREQ_2_4G; + break; + case BTC_LINK_5G_MCC_GC_STA: + CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %d/ %d", "WifiLinkMode/HotSpa/Noa/ClientJoin", + "5G_MCC_GC_STA", wifi_link_info.bhotspot, wifi_link_info.benable_noa, wifi_link_info.bany_client_join_go); + wifiFreq = BTC_FREQ_5G; + break; + case BTC_LINK_25G_MCC_GC_STA: + CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %d/ %d", "WifiLinkMode/HotSpa/Noa/ClientJoin", + "2BANDS_MCC_GC_STA", wifi_link_info.bhotspot, wifi_link_info.benable_noa, wifi_link_info.bany_client_join_go); + wifiFreq = BTC_FREQ_25G; + break; + case BTC_LINK_2G_SCC_GO_STA: + CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %d/ %d", "WifiLinkMode/HotSpa/Noa/ClientJoin", + "24G_SCC_GO_STA", wifi_link_info.bhotspot, wifi_link_info.benable_noa, wifi_link_info.bany_client_join_go); + wifiFreq = BTC_FREQ_2_4G; + break; + case BTC_LINK_5G_SCC_GO_STA: + CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %d/ %d", "WifiLinkMode/HotSpa/Noa/ClientJoin", + "5G_SCC_GO_STA", wifi_link_info.bhotspot, wifi_link_info.benable_noa, wifi_link_info.bany_client_join_go); + wifiFreq = BTC_FREQ_5G; + break; + case BTC_LINK_2G_SCC_GC_STA: + CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %d/ %d", "WifiLinkMode/HotSpa/Noa/ClientJoin", + "24G_SCC_GC_STA", wifi_link_info.bhotspot, wifi_link_info.benable_noa, wifi_link_info.bany_client_join_go); + wifiFreq = BTC_FREQ_2_4G; + break; + case BTC_LINK_5G_SCC_GC_STA: + CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %d/ %d", "WifiLinkMode/HotSpa/Noa/ClientJoin", + "5G_SCC_GC_STA", wifi_link_info.bhotspot, wifi_link_info.benable_noa, wifi_link_info.bany_client_join_go); + wifiFreq = BTC_FREQ_5G; + break; + default: + CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %d/ %d", "WifiLinkMode/HotSpa/Noa/ClientJoin", + "UNKNOWN", wifi_link_info.bhotspot, wifi_link_info.benable_noa, wifi_link_info.bany_client_join_go); + wifiFreq = hal->current_channel > 14 ? BTC_FREQ_5G : BTC_FREQ_2_4G; + break; + } + + CL_PRINTF(cliBuf); 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", "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)); 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); @@ -1521,20 +1894,20 @@ 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); - 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); + pBtCoexist->btc_get(pBtCoexist, BTC_GET_U2_BEACON_PERIOD, &wifiBcnInterval); + wifiChnl = wifi_link_info.sta_center_channel; + wifiP2PChnl = wifi_link_info.p2p_center_channel; + + 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); pBtCoexist->btc_get(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); pBtCoexist->btc_get(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); 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); @@ -1547,7 +1920,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], @@ -1716,7 +2089,7 @@ u32 halbtcoutsrc_GetBbReg(void *pBtcContext, u32 RegAddr, u32 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; @@ -1728,7 +2101,7 @@ void halbtcoutsrc_SetRfReg(void *pBtcContext, u8 eRFPath, u32 RegAddr, u32 BitMa 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; @@ -1782,7 +2155,7 @@ u8 halbtcoutsrc_SetBtAntDetection(void *pBtcContext, u8 txTime, u8 btChnl) #if 0 PBTC_COEXIST pBtCoexist = (PBTC_COEXIST)pBtcContext; PADAPTER Adapter = pBtCoexist->Adapter; - u1Byte btCanTx = 0; + u8 btCanTx = 0; BOOLEAN bStatus = FALSE; bStatus = NDBG_SetBtAntDetection(Adapter, txTime, btChnl, &btCanTx); @@ -1797,8 +2170,8 @@ u8 halbtcoutsrc_SetBtAntDetection(void *pBtcContext, u8 txTime, u8 btChnl) BOOLEAN halbtcoutsrc_SetBtTRXMASK( - IN PVOID pBtcContext, - IN u1Byte bt_trx_mask + void *pBtcContext, + u8 bt_trx_mask ) { /* Always return _FALSE since we don't implement this yet */ @@ -1806,7 +2179,7 @@ halbtcoutsrc_SetBtTRXMASK( struct btc_coexist *pBtCoexist = (struct btc_coexist *)pBtcContext; PADAPTER Adapter = pBtCoexist->Adapter; BOOLEAN bStatus = FALSE; - u1Byte btCanTx = 0; + u8 btCanTx = 0; if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter) || IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter) || IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { @@ -1867,6 +2240,35 @@ u32 halbtcoutsrc_GetBtReg(void *pBtcContext, u8 RegType, u32 RegAddr) return (BT_STATUS_BT_OP_SUCCESS == halbtcoutsrc_GetBtReg_with_status(pBtcContext, RegType, RegAddr, ®Val)) ? regVal : 0xffffffff; } +u16 halbtcoutsrc_setbttestmode(void *pBtcContext, u8 Type) +{ + PBTC_COEXIST pBtCoexist; + u16 ret = BT_STATUS_BT_OP_SUCCESS; + + pBtCoexist = (PBTC_COEXIST)pBtcContext; + + if (halbtcoutsrc_IsHwMailboxExist(pBtCoexist) == _TRUE) { + _irqL irqL; + u8 op_code; + u8 status; + + _enter_critical_mutex(&GLBtcBtMpOperLock, &irqL); + + Type = cpu_to_le32(Type); + op_code = BT_OP_SET_BT_TEST_MODE_VAL; + status = _btmpoper_cmd(pBtCoexist, op_code, 0, (u8 *)&Type, 3); + if (status != BT_STATUS_BT_OP_SUCCESS) + ret = SET_BT_MP_OPER_RET(op_code, status); + + _exit_critical_mutex(&GLBtcBtMpOperLock, &irqL); + } else + ret = BT_STATUS_NOT_IMPLEMENT; + + return ret; + +} + + void halbtcoutsrc_FillH2cCmd(void *pBtcContext, u8 elementId, u32 cmdLen, u8 *pCmdBuffer) { PBTC_COEXIST pBtCoexist; @@ -1881,7 +2283,7 @@ void halbtcoutsrc_FillH2cCmd(void *pBtcContext, u8 elementId, u32 cmdLen, u8 *pC static void halbtcoutsrc_coex_offload_init(void) { - u1Byte i; + u8 i; gl_coex_offload.h2c_req_num = 0; gl_coex_offload.cnt_h2c_sent = 0; @@ -1905,7 +2307,7 @@ static COL_H2C_STATUS halbtcoutsrc_send_h2c(PADAPTER Adapter, PCOL_H2C pcol_h2c, if (TRUE) { #if 0 /*(USE_HAL_MAC_API == 1) */ - if (RT_STATUS_SUCCESS == HAL_MAC_Send_BT_COEX(&GET_HAL_MAC_INFO(Adapter), (pu1Byte)(pcol_h2c), (u4Byte)h2c_cmd_len, 1)) { + if (RT_STATUS_SUCCESS == HAL_MAC_Send_BT_COEX(&GET_HAL_MAC_INFO(Adapter), (u8 *)(pcol_h2c), (u32)h2c_cmd_len, 1)) { if (!wait_for_completion_timeout(&gl_coex_offload.c2h_event[pcol_h2c->req_num], 20)) { h2c_status = COL_STATUS_H2C_TIMTOUT; } @@ -1975,7 +2377,7 @@ COL_H2C_STATUS halbtcoutsrc_CoexH2cProcess(void *pBtCoexist, gl_coex_offload.h2c_record[opcode].count++; gl_coex_offload.h2c_record[opcode].h2c_len = col_h2c_len; - _rtw_memmove((PVOID)&gl_coex_offload.h2c_record[opcode].h2c_buf[0], (PVOID)pcol_h2c, col_h2c_len); + _rtw_memmove((void *)&gl_coex_offload.h2c_record[opcode].h2c_buf[0], (void *)pcol_h2c, col_h2c_len); h2c_status = halbtcoutsrc_send_h2c(Adapter, pcol_h2c, col_h2c_len); @@ -2001,8 +2403,8 @@ u8 halbtcoutsrc_GetAntDetValFromBt(void *pBtcContext) #if 0 struct btc_coexist *pBtCoexist = (struct btc_coexist *)pBtcContext; PADAPTER Adapter = pBtCoexist->Adapter; - u1Byte AntDetVal = 0x0; - u1Byte opcodeVer = 1; + u8 AntDetVal = 0x0; + u8 opcodeVer = 1; BOOLEAN status = false; status = NDBG_GetAntDetValFromBt(Adapter, opcodeVer, &AntDetVal); @@ -2061,11 +2463,12 @@ u32 halbtcoutsrc_GetBleScanParaFromBt(void *pBtcContext, u8 scanType) u8 op_code; u8 status; + buf[0] = scanType; _enter_critical_mutex(&GLBtcBtMpOperLock, &irqL); op_code = BT_OP_GET_BT_BLE_SCAN_PARA; - status = _btmpoper_cmd(pBtCoexist, op_code, 0, buf, 0); + status = _btmpoper_cmd(pBtCoexist, op_code, 0, buf, 1); if (status == BT_STATUS_BT_OP_SUCCESS) data = le32_to_cpu(*(u32 *)GLBtcBtMpRptRsp); else @@ -2169,6 +2572,43 @@ u32 halbtcoutsrc_GetPhydmVersion(void *pBtcContext) #ifdef CONFIG_RTL8821C return RELEASE_VERSION_8821C; #endif + +#ifdef CONFIG_RTL8192F + return RELEASE_VERSION_8192F; +#endif + +#ifdef CONFIG_RTL8822C + return RELEASE_VERSION_8822C; +#endif + +#ifdef CONFIG_RTL8814A + return RELEASE_VERSION_8814A; +#endif +} + +u8 halbtcoutsrc_SetTimer(void *pBtcContext, u32 type, u32 val) +{ + struct btc_coexist *pBtCoexist=(struct btc_coexist *)pBtcContext; + + if (type >= BTC_TIMER_MAX) + return _FALSE; + + pBtCoexist->coex_sta.cnt_timer[type] = val; + + RTW_DBG("[BTC], Set Timer: type = %d, val = %d\n", type, val); + + return _TRUE; +} + +u32 halbtcoutsrc_SetAtomic (void *btc_ctx, u32 *target, u32 val) +{ + *target = val; + return _SUCCESS; +} + +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) @@ -2187,12 +2627,22 @@ 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_cmn_info_query((struct PHY_DM_STRUCT *)pBtCoexist->odm_priv, (enum phydm_info_query_e)info_type); + return phydm_cmn_info_query((struct dm_struct *)pBtCoexist->odm_priv, (enum phydm_info_query)info_type); #else return 0; #endif } +void halbtcoutsrc_reduce_wl_tx_power(void *pBtcContext, s8 tx_power) +{ + struct btc_coexist *pBtCoexist = (struct btc_coexist *)pBtcContext; + HAL_DATA_TYPE *pHalData = GET_HAL_DATA((PADAPTER)pBtCoexist->Adapter); + + /* The reduction of wl tx pwr should be processed inside the set tx pwr lvl function */ + if (IS_HARDWARE_TYPE_8822C(pBtCoexist->Adapter)) + rtw_hal_set_tx_power_level(pBtCoexist->Adapter, pHalData->current_channel); +} + #if 0 static void BT_CoexOffloadRecordErrC2hAck(PADAPTER Adapter) { @@ -2283,25 +2733,25 @@ void BT_CoexOffloadC2hCheck(PADAPTER Adapter, u8 *Buffer, u8 Length) u8 c2hSubCmdId = 0, c2hAckLen = 0, h2cCmdId = 0, h2cSubCmdId = 0, c2hIndLen = 0; BT_PrintData(Adapter, "[COL], c2h packet:", Length - 2, Buffer + 2); - c2hSubCmdId = (u1Byte)C2H_HDR_GET_C2H_SUB_CMD_ID(Buffer); + c2hSubCmdId = (u8)C2H_HDR_GET_C2H_SUB_CMD_ID(Buffer); if (c2hSubCmdId == C2H_SUB_CMD_ID_H2C_ACK_HDR || c2hSubCmdId == C2H_SUB_CMD_ID_BT_COEX_INFO) { if (c2hSubCmdId == C2H_SUB_CMD_ID_H2C_ACK_HDR) { /* coex c2h ack */ - h2cCmdId = (u1Byte)H2C_ACK_HDR_GET_H2C_CMD_ID(Buffer); - h2cSubCmdId = (u1Byte)H2C_ACK_HDR_GET_H2C_SUB_CMD_ID(Buffer); + h2cCmdId = (u8)H2C_ACK_HDR_GET_H2C_CMD_ID(Buffer); + h2cSubCmdId = (u8)H2C_ACK_HDR_GET_H2C_SUB_CMD_ID(Buffer); if (h2cCmdId == 0xff && h2cSubCmdId == 0x60) { - c2hAckLen = (u1Byte)C2H_HDR_GET_LEN(Buffer); + c2hAckLen = (u8)C2H_HDR_GET_LEN(Buffer); if (c2hAckLen >= 8) - BT_CoexOffloadC2hAckCheck(Adapter, &Buffer[12], (u1Byte)(c2hAckLen - 8)); + BT_CoexOffloadC2hAckCheck(Adapter, &Buffer[12], (u8)(c2hAckLen - 8)); else BT_CoexOffloadRecordErrC2hAck(Adapter); } } else if (c2hSubCmdId == C2H_SUB_CMD_ID_BT_COEX_INFO) { /* coex c2h indication */ - c2hIndLen = (u1Byte)C2H_HDR_GET_LEN(Buffer); - BT_CoexOffloadC2hIndCheck(Adapter, &Buffer[4], (u1Byte)c2hIndLen); + c2hIndLen = (u8)C2H_HDR_GET_LEN(Buffer); + BT_CoexOffloadC2hIndCheck(Adapter, &Buffer[4], (u8)c2hIndLen); } } #endif @@ -2314,7 +2764,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) @@ -2325,7 +2774,7 @@ u8 EXhalbtcoutsrc_BindBtCoexWithAdapter(void *padapter) pBtCoexist->statistics.cnt_bind++; pBtCoexist->Adapter = padapter; - pBtCoexist->odm_priv = (PVOID)&(pHalData->odmpriv); + pBtCoexist->odm_priv = (void *)&(pHalData->odmpriv); pBtCoexist->stack_info.profile_notified = _FALSE; @@ -2335,6 +2784,22 @@ u8 EXhalbtcoutsrc_BindBtCoexWithAdapter(void *padapter) pBtCoexist->bt_info.increase_scan_dev_num = _FALSE; pBtCoexist->bt_info.miracast_plus_bt = _FALSE; + /* for btc common architecture, inform chip type to coex. mechanism */ + if(IS_HARDWARE_TYPE_8822C(padapter)) + pBtCoexist->chip_type = BTC_CHIP_RTL8822C; + else if (IS_HARDWARE_TYPE_8822B(padapter)) + pBtCoexist->chip_type = BTC_CHIP_RTL8822B; + else + pBtCoexist->chip_type = BTC_CHIP_UNDEF; + + 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); @@ -2343,6 +2808,9 @@ u8 EXhalbtcoutsrc_BindBtCoexWithAdapter(void *padapter) EXhalbtcoutsrc_SetSingleAntPath(singleAntPath); } + pBtCoexist->board_info.customerID = RT_CID_DEFAULT; + pBtCoexist->board_info.customer_id = RT_CID_DEFAULT; + /* set default antenna position to main port */ pBtCoexist->board_info.btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; @@ -2355,7 +2823,7 @@ u8 EXhalbtcoutsrc_BindBtCoexWithAdapter(void *padapter) pBtCoexist->board_info.ant_div_cfg = rtw_btcoex_get_ant_div_cfg((PADAPTER)padapter); - return _TRUE; + pBtCoexist->board_info.ant_distance = 10; } u8 EXhalbtcoutsrc_InitlizeVariables(void *padapter) @@ -2412,8 +2880,12 @@ u8 EXhalbtcoutsrc_InitlizeVariables(void *padapter) pBtCoexist->btc_get_ble_scan_para_from_bt = halbtcoutsrc_GetBleScanParaFromBt; pBtCoexist->btc_get_bt_afh_map_from_bt = halbtcoutsrc_GetBtAFHMapFromBt; pBtCoexist->btc_get_bt_phydm_version = halbtcoutsrc_GetPhydmVersion; + pBtCoexist->btc_set_timer = halbtcoutsrc_SetTimer; + pBtCoexist->btc_set_atomic= halbtcoutsrc_SetAtomic; 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_reduce_wl_tx_power = halbtcoutsrc_reduce_wl_tx_power; + pBtCoexist->btc_phydm_modify_antdiv_hwsw = halbtcoutsrc_phydm_modify_AntDiv_HwSw; pBtCoexist->cli_buf = &GLBtcDbgBuf[0]; @@ -2430,52 +2902,94 @@ 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 (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) + rtw_btc_ex_power_on_setting(pBtCoexist); + +#else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { +#ifdef CONFIG_RTL8723B if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8723b2ant_power_on_setting(pBtCoexist); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8723b1ant_power_on_setting(pBtCoexist); +#endif } - if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { +#ifdef CONFIG_RTL8703B + else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { + if (pBtCoexist->board_info.btdm_ant_num == 1) + ex_halbtc8703b1ant_power_on_setting(pBtCoexist); + } +#endif + +#ifdef CONFIG_RTL8723D + else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8723d2ant_power_on_setting(pBtCoexist); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8723d1ant_power_on_setting(pBtCoexist); } +#endif - if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { +#ifdef CONFIG_RTL8821A + else if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { + if (pBtCoexist->board_info.btdm_ant_num == 1) + ex_halbtc8821a1ant_power_on_setting(pBtCoexist); + else if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8821a2ant_power_on_setting(pBtCoexist); + } +#endif + +#ifdef CONFIG_RTL8822B + else 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); } +#endif - if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { +#ifdef CONFIG_RTL8821C + else 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) ex_halbtc8821c1ant_power_on_setting(pBtCoexist); } +#endif + +#ifdef CONFIG_RTL8814A + if (IS_HARDWARE_TYPE_8814A(pBtCoexist->Adapter)) { + if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8814a2ant_power_on_setting(pBtCoexist); + /* else if (pBtCoexist->board_info.btdm_ant_num == 1) + ex_halbtc8814a1ant_power_on_setting(pBtCoexist); */ + } +#endif + +#endif } void EXhalbtcoutsrc_PreLoadFirmware(PBTC_COEXIST pBtCoexist) @@ -2486,25 +3000,31 @@ void EXhalbtcoutsrc_PreLoadFirmware(PBTC_COEXIST pBtCoexist) pBtCoexist->statistics.cnt_pre_load_firmware++; if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { +#ifdef CONFIG_RTL8723B if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8723b2ant_pre_load_firmware(pBtCoexist); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8723b1ant_pre_load_firmware(pBtCoexist); +#endif } - if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { +#ifdef CONFIG_RTL8723D + else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8723d2ant_pre_load_firmware(pBtCoexist); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8723d1ant_pre_load_firmware(pBtCoexist); } +#endif - if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { +#ifdef CONFIG_RTL8821C + else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821c2ant_pre_load_firmware(pBtCoexist); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8821c1ant_pre_load_firmware(pBtCoexist); } +#endif } void EXhalbtcoutsrc_init_hw_config(PBTC_COEXIST pBtCoexist, u8 bWifiOnly) @@ -2514,58 +3034,88 @@ void EXhalbtcoutsrc_init_hw_config(PBTC_COEXIST pBtCoexist, u8 bWifiOnly) pBtCoexist->statistics.cnt_init_hw_config++; +#if (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) + rtw_btc_ex_init_hw_config(pBtCoexist, bWifiOnly); +#else + if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -#if 0 - if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) - ex_halbtc8821aCsr2ant_init_hw_config(pBtCoexist, bWifiOnly); - else -#endif +#ifdef CONFIG_RTL8821A 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); - } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { +#endif + } + +#ifdef CONFIG_RTL8723B + else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8723b2ant_init_hw_config(pBtCoexist, bWifiOnly); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8723b1ant_init_hw_config(pBtCoexist, bWifiOnly); - } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8703B + else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8703b1ant_init_hw_config(pBtCoexist, bWifiOnly); - } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8723D + else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8723d2ant_init_hw_config(pBtCoexist, bWifiOnly); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8723d1ant_init_hw_config(pBtCoexist, bWifiOnly); - } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8192E + else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8192e2ant_init_hw_config(pBtCoexist, bWifiOnly); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8192e1ant_init_hw_config(pBtCoexist, bWifiOnly); - } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8812A + else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8812a2ant_init_hw_config(pBtCoexist, bWifiOnly); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8812a1ant_init_hw_config(pBtCoexist, bWifiOnly); - } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8822B + 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)) { + } +#endif + +#ifdef CONFIG_RTL8821C + 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 } +#endif + +#ifdef CONFIG_RTL8814A + else if (IS_HARDWARE_TYPE_8814A(pBtCoexist->Adapter)) { + if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8814a2ant_init_hw_config(pBtCoexist, bWifiOnly); + } +#endif + +#endif } void EXhalbtcoutsrc_init_coex_dm(PBTC_COEXIST pBtCoexist) @@ -2575,50 +3125,88 @@ void EXhalbtcoutsrc_init_coex_dm(PBTC_COEXIST pBtCoexist) pBtCoexist->statistics.cnt_init_coex_dm++; +#if (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) + rtw_btc_ex_init_coex_dm(pBtCoexist); +#else + if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -#if 0 - if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) - ex_halbtc8821aCsr2ant_init_coex_dm(pBtCoexist); - else -#endif +#ifdef CONFIG_RTL8821A 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); - } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { +#endif + } + +#ifdef CONFIG_RTL8723B + else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8723b2ant_init_coex_dm(pBtCoexist); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8723b1ant_init_coex_dm(pBtCoexist); - } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8703B + else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8703b1ant_init_coex_dm(pBtCoexist); - } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8723D + else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8723d2ant_init_coex_dm(pBtCoexist); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8723d1ant_init_coex_dm(pBtCoexist); - } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8192E + else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8192e2ant_init_coex_dm(pBtCoexist); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8192e1ant_init_coex_dm(pBtCoexist); - } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8812A + else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8812a2ant_init_coex_dm(pBtCoexist); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8812a1ant_init_coex_dm(pBtCoexist); - } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8822B + 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)) { + } +#endif + +#ifdef CONFIG_RTL8821C + else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821c2ant_init_coex_dm(pBtCoexist); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8821c1ant_init_coex_dm(pBtCoexist); } +#endif + +#ifdef CONFIG_RTL8814A + else if (IS_HARDWARE_TYPE_8814A(pBtCoexist->Adapter)) { + if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8814a2ant_init_coex_dm(pBtCoexist); + } +#endif + +#endif pBtCoexist->initilized = _TRUE; } @@ -2645,51 +3233,88 @@ void EXhalbtcoutsrc_ips_notify(PBTC_COEXIST pBtCoexist, u8 type) /* All notify is called in cmd thread, don't need to leave low power again * halbtcoutsrc_LeaveLowPower(pBtCoexist); */ +#if (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) + rtw_btc_ex_ips_notify(pBtCoexist, ipsType); +#else + if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -#if 0 - if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) - ex_halbtc8821aCsr2ant_ips_notify(pBtCoexist, ipsType); - else -#endif +#ifdef CONFIG_RTL8821A 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); - } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { +#endif + } + +#ifdef CONFIG_RTL8723B + else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8723b2ant_ips_notify(pBtCoexist, ipsType); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8723b1ant_ips_notify(pBtCoexist, ipsType); - } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8703B + else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8703b1ant_ips_notify(pBtCoexist, ipsType); - } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8723D + else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8723d2ant_ips_notify(pBtCoexist, ipsType); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8723d1ant_ips_notify(pBtCoexist, ipsType); - } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8192E + else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8192e2ant_ips_notify(pBtCoexist, ipsType); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8192e1ant_ips_notify(pBtCoexist, ipsType); - } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8812A + else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8812a2ant_ips_notify(pBtCoexist, ipsType); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8812a1ant_ips_notify(pBtCoexist, ipsType); - } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8822B + 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)) { + } +#endif + +#ifdef CONFIG_RTL8821C + else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821c2ant_ips_notify(pBtCoexist, ipsType); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8821c1ant_ips_notify(pBtCoexist, ipsType); } +#endif +#ifdef CONFIG_RTL8814A + else if (IS_HARDWARE_TYPE_8814A(pBtCoexist->Adapter)) { + if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8814a2ant_ips_notify(pBtCoexist, ipsType); + } +#endif + +#endif /* halbtcoutsrc_NormalLowPower(pBtCoexist); */ } @@ -2713,50 +3338,88 @@ void EXhalbtcoutsrc_lps_notify(PBTC_COEXIST pBtCoexist, u8 type) GLBtcWiFiInLPS = _TRUE; } +#if (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) + rtw_btc_ex_lps_notify(pBtCoexist, lpsType); +#else + if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -#if 0 - if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) - ex_halbtc8821aCsr2ant_lps_notify(pBtCoexist, lpsType); - else -#endif +#ifdef CONFIG_RTL8821A 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); - } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { +#endif + } + +#ifdef CONFIG_RTL8723B + else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8723b2ant_lps_notify(pBtCoexist, lpsType); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8723b1ant_lps_notify(pBtCoexist, lpsType); - } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8703B + else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8703b1ant_lps_notify(pBtCoexist, lpsType); - } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8723D + else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8723d2ant_lps_notify(pBtCoexist, lpsType); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8723d1ant_lps_notify(pBtCoexist, lpsType); - } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8192E + else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8192e2ant_lps_notify(pBtCoexist, lpsType); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8192e1ant_lps_notify(pBtCoexist, lpsType); - } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8812A + else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8812a2ant_lps_notify(pBtCoexist, lpsType); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8812a1ant_lps_notify(pBtCoexist, lpsType); - } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8822B + 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)) { + } +#endif + +#ifdef CONFIG_RTL8821C + else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821c2ant_lps_notify(pBtCoexist, lpsType); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8821c1ant_lps_notify(pBtCoexist, lpsType); } +#endif + +#ifdef CONFIG_RTL8814A + else if (IS_HARDWARE_TYPE_8814A(pBtCoexist->Adapter)) { + if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8814a2ant_lps_notify(pBtCoexist, lpsType); + } +#endif + +#endif } void EXhalbtcoutsrc_scan_notify(PBTC_COEXIST pBtCoexist, u8 type) @@ -2780,50 +3443,88 @@ void EXhalbtcoutsrc_scan_notify(PBTC_COEXIST pBtCoexist, u8 type) /* All notify is called in cmd thread, don't need to leave low power again * halbtcoutsrc_LeaveLowPower(pBtCoexist); */ +#if (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) + rtw_btc_ex_scan_notify(pBtCoexist, scanType); +#else + if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -#if 0 - if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) - ex_halbtc8821aCsr2ant_scan_notify(pBtCoexist, scanType); - else -#endif +#ifdef CONFIG_RTL8821A 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); - } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { +#endif + } + +#ifdef CONFIG_RTL8723B + else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8723b2ant_scan_notify(pBtCoexist, scanType); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8723b1ant_scan_notify(pBtCoexist, scanType); - } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8703B + else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8703b1ant_scan_notify(pBtCoexist, scanType); - } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8723D + else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8723d2ant_scan_notify(pBtCoexist, scanType); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8723d1ant_scan_notify(pBtCoexist, scanType); - } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8192E + else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8192e2ant_scan_notify(pBtCoexist, scanType); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8192e1ant_scan_notify(pBtCoexist, scanType); - } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8812A + else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8812a2ant_scan_notify(pBtCoexist, scanType); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8812a1ant_scan_notify(pBtCoexist, scanType); - } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8822B + 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)) { + } +#endif + +#ifdef CONFIG_RTL8821C + else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821c2ant_scan_notify(pBtCoexist, scanType); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8821c1ant_scan_notify(pBtCoexist, scanType); } +#endif + +#ifdef CONFIG_RTL8814A + else if (IS_HARDWARE_TYPE_8814A(pBtCoexist->Adapter)) { + if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8814a2ant_scan_notify(pBtCoexist, scanType); + } +#endif + +#endif /* halbtcoutsrc_NormalLowPower(pBtCoexist); */ } @@ -2858,149 +3559,240 @@ 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 (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) + rtw_btc_ex_connect_notify(pBtCoexist, assoType); +#else if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -#if 0 - if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) - ex_halbtc8821aCsr2ant_connect_notify(pBtCoexist, assoType); - else -#endif +#ifdef CONFIG_RTL8821A 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); - } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { +#endif + } + +#ifdef CONFIG_RTL8723B + else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8723b2ant_connect_notify(pBtCoexist, assoType); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8723b1ant_connect_notify(pBtCoexist, assoType); - } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8703B + else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8703b1ant_connect_notify(pBtCoexist, assoType); - } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8723D + else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8723d2ant_connect_notify(pBtCoexist, assoType); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8723d1ant_connect_notify(pBtCoexist, assoType); - } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8192E + else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8192e2ant_connect_notify(pBtCoexist, assoType); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8192e1ant_connect_notify(pBtCoexist, assoType); - } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8812A + else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8812a2ant_connect_notify(pBtCoexist, assoType); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8812a1ant_connect_notify(pBtCoexist, assoType); - } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8822B + 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)) { + } +#endif + +#ifdef CONFIG_RTL8821C + else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821c2ant_connect_notify(pBtCoexist, assoType); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8821c1ant_connect_notify(pBtCoexist, assoType); } +#endif + +#ifdef CONFIG_RTL8814A + else if (IS_HARDWARE_TYPE_8814A(pBtCoexist->Adapter)) { + if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8814a2ant_connect_notify(pBtCoexist, assoType); + } +#endif + +#endif /* halbtcoutsrc_NormalLowPower(pBtCoexist); */ } void EXhalbtcoutsrc_media_status_notify(PBTC_COEXIST pBtCoexist, RT_MEDIA_STATUS mediaStatus) { - u8 mStatus; + u8 mStatus = BTC_MEDIA_MAX; + PADAPTER adapter = NULL; + HAL_DATA_TYPE *hal = NULL; if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) return; - pBtCoexist->statistics.cnt_media_status_notify++; if (pBtCoexist->manual_control) return; - if (RT_MEDIA_CONNECT == mediaStatus) - mStatus = BTC_MEDIA_CONNECT; - else + pBtCoexist->statistics.cnt_media_status_notify++; + adapter = (PADAPTER)pBtCoexist->Adapter; + hal = GET_HAL_DATA(adapter); + + if (RT_MEDIA_CONNECT == mediaStatus) { + if (hal->current_band_type == BAND_ON_2_4G) + mStatus = BTC_MEDIA_CONNECT; + else if (hal->current_band_type == BAND_ON_5G) + mStatus = BTC_MEDIA_CONNECT_5G; + else { + mStatus = BTC_MEDIA_CONNECT; + RTW_ERR("%s unknow band type\n", __func__); + } + } else mStatus = BTC_MEDIA_DISCONNECT; /* All notify is called in cmd thread, don't need to leave low power again * halbtcoutsrc_LeaveLowPower(pBtCoexist); */ +#if (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) + rtw_btc_ex_media_status_notify(pBtCoexist, mStatus); +#else if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -#if 0 - if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) - ex_halbtc8821aCsr2ant_media_status_notify(pBtCoexist, mStatus); - else -#endif +#ifdef CONFIG_RTL8821A + /* compatible for 8821A */ + if (mStatus == BTC_MEDIA_CONNECT_5G) + mStatus = BTC_MEDIA_CONNECT; 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); - } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { +#endif + } + +#ifdef CONFIG_RTL8723B + else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8723b2ant_media_status_notify(pBtCoexist, mStatus); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8723b1ant_media_status_notify(pBtCoexist, mStatus); - } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8703B + else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8703b1ant_media_status_notify(pBtCoexist, mStatus); - } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8723D + else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8723d2ant_media_status_notify(pBtCoexist, mStatus); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8723d1ant_media_status_notify(pBtCoexist, mStatus); - } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8192E + else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8192e2ant_media_status_notify(pBtCoexist, mStatus); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8192e1ant_media_status_notify(pBtCoexist, mStatus); - } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8812A + else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { + /* compatible for 8812A */ + if (mStatus == BTC_MEDIA_CONNECT_5G) + mStatus = BTC_MEDIA_CONNECT; if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8812a2ant_media_status_notify(pBtCoexist, mStatus); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8812a1ant_media_status_notify(pBtCoexist, mStatus); - } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8822B + 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)) { + } +#endif + +#ifdef CONFIG_RTL8821C + else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821c2ant_media_status_notify(pBtCoexist, mStatus); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8821c1ant_media_status_notify(pBtCoexist, mStatus); } +#endif + +#ifdef CONFIG_RTL8814A + else if (IS_HARDWARE_TYPE_8814A(pBtCoexist->Adapter)) { + if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8814a2ant_media_status_notify(pBtCoexist, mStatus); + } +#endif + +#endif /* halbtcoutsrc_NormalLowPower(pBtCoexist); */ } void EXhalbtcoutsrc_specific_packet_notify(PBTC_COEXIST pBtCoexist, u8 pktType) { - u8 packetType; + u8 packetType; + PADAPTER adapter = NULL; + HAL_DATA_TYPE *hal = NULL; if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) return; - pBtCoexist->statistics.cnt_specific_packet_notify++; + if (pBtCoexist->manual_control) return; + pBtCoexist->statistics.cnt_specific_packet_notify++; + adapter = (PADAPTER)pBtCoexist->Adapter; + hal = GET_HAL_DATA(adapter); + if (PACKET_DHCP == pktType) packetType = BTC_PACKET_DHCP; else if (PACKET_EAPOL == pktType) @@ -3012,53 +3804,101 @@ void EXhalbtcoutsrc_specific_packet_notify(PBTC_COEXIST pBtCoexist, u8 pktType) return; } + if (hal->current_band_type == BAND_ON_5G) + packetType |= BTC_5G_BAND; + /* All notify is called in cmd thread, don't need to leave low power again * halbtcoutsrc_LeaveLowPower(pBtCoexist); */ +#if (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) + rtw_btc_ex_specific_packet_notify(pBtCoexist, packetType); +#else if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -#if 0 - if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) - ex_halbtc8821aCsr2ant_specific_packet_notify(pBtCoexist, packetType); - else -#endif +#ifdef CONFIG_RTL8821A + /* compatible for 8821A */ + if (hal->current_band_type == BAND_ON_5G) + packetType &= ~BTC_5G_BAND; + 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); - } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { +#endif + } + +#ifdef CONFIG_RTL8723B + else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8723b2ant_specific_packet_notify(pBtCoexist, packetType); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8723b1ant_specific_packet_notify(pBtCoexist, packetType); - } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8703B + else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8703b1ant_specific_packet_notify(pBtCoexist, packetType); - } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8723D + else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8723d2ant_specific_packet_notify(pBtCoexist, packetType); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8723d1ant_specific_packet_notify(pBtCoexist, packetType); - } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8192E + else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8192e2ant_specific_packet_notify(pBtCoexist, packetType); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8192e1ant_specific_packet_notify(pBtCoexist, packetType); - } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8812A + else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { + /* compatible for 8812A */ + if (hal->current_band_type == BAND_ON_5G) + packetType &= ~BTC_5G_BAND; + if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8812a2ant_specific_packet_notify(pBtCoexist, packetType); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8812a1ant_specific_packet_notify(pBtCoexist, packetType); - } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8822B + 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)) { + } +#endif + +#ifdef CONFIG_RTL8821C + else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821c2ant_specific_packet_notify(pBtCoexist, packetType); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8821c1ant_specific_packet_notify(pBtCoexist, packetType); } +#endif + +#ifdef CONFIG_RTL8814A + else if (IS_HARDWARE_TYPE_8814A(pBtCoexist->Adapter)) { + if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8814a2ant_specific_packet_notify(pBtCoexist, packetType); + } +#endif + +#endif /* halbtcoutsrc_NormalLowPower(pBtCoexist); */ } @@ -3072,88 +3912,229 @@ void EXhalbtcoutsrc_bt_info_notify(PBTC_COEXIST pBtCoexist, u8 *tmpBuf, u8 lengt /* All notify is called in cmd thread, don't need to leave low power again * halbtcoutsrc_LeaveLowPower(pBtCoexist); */ +#if (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) + rtw_btc_ex_bt_info_notify(pBtCoexist, tmpBuf, length); +#else if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -#if 0 - if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) - ex_halbtc8821aCsr2ant_bt_info_notify(pBtCoexist, tmpBuf, length); - else -#endif +#ifdef CONFIG_RTL8821A 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); - } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { +#endif + } + +#ifdef CONFIG_RTL8723B + else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8723b2ant_bt_info_notify(pBtCoexist, tmpBuf, length); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8723b1ant_bt_info_notify(pBtCoexist, tmpBuf, length); - } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8703B + else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8703b1ant_bt_info_notify(pBtCoexist, tmpBuf, length); - } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8723D + else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8723d2ant_bt_info_notify(pBtCoexist, tmpBuf, length); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8723d1ant_bt_info_notify(pBtCoexist, tmpBuf, length); - } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8192E + else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8192e2ant_bt_info_notify(pBtCoexist, tmpBuf, length); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8192e1ant_bt_info_notify(pBtCoexist, tmpBuf, length); - } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8812A + else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8812a2ant_bt_info_notify(pBtCoexist, tmpBuf, length); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8812a1ant_bt_info_notify(pBtCoexist, tmpBuf, length); - } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8822B + 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)) { + } +#endif + +#ifdef CONFIG_RTL8821C + else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821c2ant_bt_info_notify(pBtCoexist, tmpBuf, length); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8821c1ant_bt_info_notify(pBtCoexist, tmpBuf, length); } +#endif + +#ifdef CONFIG_RTL8814A + else if (IS_HARDWARE_TYPE_8814A(pBtCoexist->Adapter)) { + if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8814a2ant_bt_info_notify(pBtCoexist, tmpBuf, length); + } +#endif + +#endif /* halbtcoutsrc_NormalLowPower(pBtCoexist); */ } -VOID +void EXhalbtcoutsrc_WlFwDbgInfoNotify(PBTC_COEXIST pBtCoexist, u8* tmpBuf, u8 length) +{ + if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) + return; + +#if (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) + rtw_btc_ex_wl_fwdbginfo_notify(pBtCoexist, tmpBuf, length); +#else + + if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { +#ifdef CONFIG_RTL8703B + if (pBtCoexist->board_info.btdm_ant_num == 1) + ex_halbtc8703b1ant_wl_fwdbginfo_notify(pBtCoexist, tmpBuf, length); +#endif + } + +#ifdef CONFIG_RTL8723D + 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); + } +#endif + +#ifdef CONFIG_RTL8821C + 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); + } +#endif + +#endif +} + +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 (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) + rtw_btc_ex_rx_rate_change_notify(pBtCoexist, is_data_frame, btc_rate_id); +#else + + if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { +#ifdef CONFIG_RTL8703B + if (pBtCoexist->board_info.btdm_ant_num == 1) + ex_halbtc8703b1ant_rx_rate_change_notify(pBtCoexist, is_data_frame, btc_rate_id); +#endif + } + +#ifdef CONFIG_RTL8723D + 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); + } +#endif + +#ifdef CONFIG_RTL8821C + 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); + } +#endif + +#endif +} + +void EXhalbtcoutsrc_RfStatusNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type + PBTC_COEXIST pBtCoexist, + u8 type ) { if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) return; pBtCoexist->statistics.cnt_rf_status_notify++; - if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { - } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { +#if (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) + rtw_btc_ex_rf_status_notify(pBtCoexist, type); +#else + + if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { +#ifdef CONFIG_RTL8723B if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8723b1ant_rf_status_notify(pBtCoexist, type); - } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { +#endif + } + +#ifdef CONFIG_RTL8703B + else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8703b1ant_rf_status_notify(pBtCoexist, type); - } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8723D + else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8723d1ant_rf_status_notify(pBtCoexist, type); - } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { - } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { - } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8822B + 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)) { + } +#endif + +#ifdef CONFIG_RTL8821C + else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821c2ant_rf_status_notify(pBtCoexist, type); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8821c1ant_rf_status_notify(pBtCoexist, type); } +#endif + +#ifdef CONFIG_RTL8814A + else if (IS_HARDWARE_TYPE_8814A(pBtCoexist->Adapter)) { + if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8814a2ant_rf_status_notify(pBtCoexist, type); + } +#endif + +#endif } void EXhalbtcoutsrc_StackOperationNotify(PBTC_COEXIST pBtCoexist, u8 type) @@ -3187,50 +4168,90 @@ void EXhalbtcoutsrc_halt_notify(PBTC_COEXIST pBtCoexist) if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) return; + pBtCoexist->statistics.cnt_halt_notify++; + +#if (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) + rtw_btc_ex_halt_notify(pBtCoexist); +#else + if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -#if 0 - if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) - ex_halbtc8821aCsr2ant_halt_notify(pBtCoexist); - else -#endif +#ifdef CONFIG_RTL8821A 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); - } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { +#endif + } + +#ifdef CONFIG_RTL8723B + else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8723b2ant_halt_notify(pBtCoexist); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8723b1ant_halt_notify(pBtCoexist); - } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8703B + else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8703b1ant_halt_notify(pBtCoexist); - } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8723D + else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8723d2ant_halt_notify(pBtCoexist); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8723d1ant_halt_notify(pBtCoexist); - } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8192E + else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8192e2ant_halt_notify(pBtCoexist); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8192e1ant_halt_notify(pBtCoexist); - } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8812A + else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8812a2ant_halt_notify(pBtCoexist); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8812a1ant_halt_notify(pBtCoexist); - } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8822B + 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)) { + } +#endif + +#ifdef CONFIG_RTL8821C + else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821c2ant_halt_notify(pBtCoexist); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8821c1ant_halt_notify(pBtCoexist); } +#endif + +#ifdef CONFIG_RTL8814A + else if (IS_HARDWARE_TYPE_8814A(pBtCoexist->Adapter)) { + if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8814a2ant_halt_notify(pBtCoexist); + } +#endif + +#endif } void EXhalbtcoutsrc_SwitchBtTRxMask(PBTC_COEXIST pBtCoexist) @@ -3249,51 +4270,90 @@ void EXhalbtcoutsrc_pnp_notify(PBTC_COEXIST pBtCoexist, u8 pnpState) if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) return; + pBtCoexist->statistics.cnt_pnp_notify++; + /* */ /* currently only 1ant we have to do the notification, */ /* once pnp is notified to sleep state, we have to leave LPS that we can sleep normally. */ /* */ +#if (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) + rtw_btc_ex_pnp_notify(pBtCoexist, pnpState); +#else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { +#ifdef CONFIG_RTL8723B if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8723b1ant_pnp_notify(pBtCoexist, pnpState); else if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8723b2ant_pnp_notify(pBtCoexist, pnpState); - } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { +#endif + } + +#ifdef CONFIG_RTL8703B + else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8703b1ant_pnp_notify(pBtCoexist, pnpState); - } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8723D + else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8723d1ant_pnp_notify(pBtCoexist, 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 + } #endif + +#ifdef CONFIG_RTL8821A + else if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { 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); - } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8192E + else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8192e1ant_pnp_notify(pBtCoexist, pnpState); - } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8812A + else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8812a1ant_pnp_notify(pBtCoexist, pnpState); - } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8822B + 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)) { + } +#endif + +#ifdef CONFIG_RTL8821C + else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821c2ant_pnp_notify(pBtCoexist, pnpState); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8821c1ant_pnp_notify(pBtCoexist, pnpState); } +#endif + +#ifdef CONFIG_RTL8814A + else if (IS_HARDWARE_TYPE_8814A(pBtCoexist->Adapter)) { + if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8814a2ant_pnp_notify(pBtCoexist, pnpState); + } +#endif + +#endif } void EXhalbtcoutsrc_CoexDmSwitch(PBTC_COEXIST pBtCoexist) @@ -3305,6 +4365,7 @@ void EXhalbtcoutsrc_CoexDmSwitch(PBTC_COEXIST pBtCoexist) halbtcoutsrc_LeaveLowPower(pBtCoexist); if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { +#ifdef CONFIG_RTL8723B if (pBtCoexist->board_info.btdm_ant_num == 1) { pBtCoexist->stop_coex_dm = TRUE; ex_halbtc8723b1ant_coex_dm_reset(pBtCoexist); @@ -3313,7 +4374,11 @@ void EXhalbtcoutsrc_CoexDmSwitch(PBTC_COEXIST pBtCoexist) ex_halbtc8723b2ant_init_coex_dm(pBtCoexist); pBtCoexist->stop_coex_dm = FALSE; } - } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { +#endif + } + +#ifdef CONFIG_RTL8723D + else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 1) { pBtCoexist->stop_coex_dm = TRUE; ex_halbtc8723d1ant_coex_dm_reset(pBtCoexist); @@ -3323,10 +4388,120 @@ void EXhalbtcoutsrc_CoexDmSwitch(PBTC_COEXIST pBtCoexist) pBtCoexist->stop_coex_dm = FALSE; } } +#endif halbtcoutsrc_NormalLowPower(pBtCoexist); } +#if (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) +void EXhalbtcoutsrc_TimerNotify(PBTC_COEXIST pBtCoexist, u32 timer_type) +{ + rtw_btc_ex_timerup_notify(pBtCoexist, timer_type); +} + +void EXhalbtcoutsrc_WLStatusChangeNotify(PBTC_COEXIST pBtCoexist, u32 change_type) +{ + rtw_btc_ex_wl_status_change_notify(pBtCoexist, change_type); +} + +u32 EXhalbtcoutsrc_CoexTimerCheck(PBTC_COEXIST pBtCoexist) +{ + u32 i, timer_map = 0; + + for (i = 0; i < BTC_TIMER_MAX; i++) { + if (pBtCoexist->coex_sta.cnt_timer[i] > 0) { + if (pBtCoexist->coex_sta.cnt_timer[i] == 1) { + timer_map |= BIT(i); + RTW_DBG("[BTC], %s(): timer_map = 0x%x\n", __func__, timer_map); + } + + pBtCoexist->coex_sta.cnt_timer[i]--; + } + } + + return timer_map; +} + +u32 EXhalbtcoutsrc_WLStatusCheck(PBTC_COEXIST pBtCoexist) +{ + struct btc_wifi_link_info link_info; + const struct btc_chip_para *chip_para = pBtCoexist->chip_para; + u32 change_map = 0; + static bool wl_busy_pre; + bool wl_busy = _FALSE; + s32 wl_rssi; + u32 traffic_dir; + u8 i, tmp; + static u8 rssi_step_pre = 4; + + /* WL busy to idle or idle to busy */ + pBtCoexist->btc_get(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &wl_busy); + if (wl_busy != wl_busy_pre) { + if (wl_busy) + change_map |= BIT(BTC_WLSTATUS_CHANGE_TOBUSY); + else + change_map |= BIT(BTC_WLSTATUS_CHANGE_TOIDLE); + + wl_busy_pre = wl_busy; + } + + /* WL RSSI */ + pBtCoexist->btc_get(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wl_rssi); + tmp = (u8)(wl_rssi & 0xff); + for (i = 0; i < 4; i++) { + if (tmp >= chip_para->wl_rssi_step[i]) { + if (rssi_step_pre != i) { + rssi_step_pre = i; + change_map |= BIT(BTC_WLSTATUS_CHANGE_RSSI); + } + break; + } else if (i == 3) + rssi_step_pre = 4; + } + + /* WL Link info */ + pBtCoexist->btc_get(pBtCoexist, BTC_GET_BL_WIFI_LINK_INFO, &link_info); + if (link_info.link_mode != pBtCoexist->wifi_link_info.link_mode || + link_info.sta_center_channel != + pBtCoexist->wifi_link_info.sta_center_channel || + link_info.p2p_center_channel != + pBtCoexist->wifi_link_info.p2p_center_channel || + link_info.bany_client_join_go != + pBtCoexist->wifi_link_info.bany_client_join_go) { + change_map |= BIT(BTC_WLSTATUS_CHANGE_LINKINFO); + pBtCoexist->wifi_link_info = link_info; + } + + /* WL Traffic Direction */ + pBtCoexist->btc_get(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, + &traffic_dir); + if (wl_busy && traffic_dir != + pBtCoexist->wifi_link_info_ext.traffic_dir) { + change_map |= BIT(BTC_WLSTATUS_CHANGE_DIRECTION); + pBtCoexist->wifi_link_info_ext.traffic_dir = traffic_dir; + } + + RTW_DBG("[BTC], %s(): change_map = 0x%x\n", __func__, change_map); + + return change_map; +} + +void EXhalbtcoutsrc_status_monitor(PBTC_COEXIST pBtCoexist) +{ + u32 timer_up_type = 0, wl_status_change_type = 0; + + timer_up_type = EXhalbtcoutsrc_CoexTimerCheck(pBtCoexist); + if (timer_up_type != 0) + EXhalbtcoutsrc_TimerNotify(pBtCoexist, timer_up_type); + + wl_status_change_type = EXhalbtcoutsrc_WLStatusCheck(pBtCoexist); + if (wl_status_change_type != 0) + EXhalbtcoutsrc_WLStatusChangeNotify(pBtCoexist, wl_status_change_type); + + rtw_btc_ex_periodical(pBtCoexist); +} +#endif + void EXhalbtcoutsrc_periodical(PBTC_COEXIST pBtCoexist) { if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) @@ -3336,53 +4511,90 @@ void EXhalbtcoutsrc_periodical(PBTC_COEXIST pBtCoexist) /* Periodical should be called in cmd thread, */ /* don't need to leave low power again * halbtcoutsrc_LeaveLowPower(pBtCoexist); */ +#if (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) + EXhalbtcoutsrc_status_monitor(pBtCoexist); +#else if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -#if 0 - if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) - ex_halbtc8821aCsr2ant_periodical(pBtCoexist); - else -#endif +#ifdef CONFIG_RTL8821A 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)) ex_halbtc8821a1ant_periodical(pBtCoexist); } - } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { +#endif + } + +#ifdef CONFIG_RTL8723B + else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8723b2ant_periodical(pBtCoexist); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8723b1ant_periodical(pBtCoexist); - } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8723D + else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8723d2ant_periodical(pBtCoexist); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8723d1ant_periodical(pBtCoexist); - } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8703B + else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8703b1ant_periodical(pBtCoexist); - } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8192E + else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8192e2ant_periodical(pBtCoexist); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8192e1ant_periodical(pBtCoexist); - } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8812A + else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8812a2ant_periodical(pBtCoexist); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8812a1ant_periodical(pBtCoexist); - } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8822B + 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)) { + } +#endif + +#ifdef CONFIG_RTL8821C + else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821c2ant_periodical(pBtCoexist); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8821c1ant_periodical(pBtCoexist); } +#endif + +#ifdef CONFIG_RTL8814A + else if (IS_HARDWARE_TYPE_8814A(pBtCoexist->Adapter)) { + if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8814a2ant_periodical(pBtCoexist); + } +#endif + +#endif /* halbtcoutsrc_NormalLowPower(pBtCoexist); */ } @@ -3397,30 +4609,45 @@ void EXhalbtcoutsrc_dbg_control(PBTC_COEXIST pBtCoexist, u8 opCode, u8 opLen, u8 /* This function doesn't be called yet, */ /* default no need to leave low power to avoid deadlock * halbtcoutsrc_LeaveLowPower(pBtCoexist); */ +#if (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) + /* rtw_btc_ex_dbg_control(pBtCoexist, opCode, opLen, pData); */ +#else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { +#ifdef CONFIG_RTL8192E if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8192e1ant_dbg_control(pBtCoexist, opCode, opLen, pData); - } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { +#endif + } + +#ifdef CONFIG_RTL8812A + else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8812a2ant_dbg_control(pBtCoexist, opCode, opLen, pData); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8812a1ant_dbg_control(pBtCoexist, opCode, opLen, pData); - } else if(IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) + } +#endif + +#ifdef CONFIG_RTL8822B + else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) if(pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8822b1ant_dbg_control(pBtCoexist, opCode, opLen, pData); +#endif + +#endif /* halbtcoutsrc_NormalLowPower(pBtCoexist); */ } #if 0 -VOID +void EXhalbtcoutsrc_AntennaDetection( - IN PBTC_COEXIST pBtCoexist, - IN u4Byte centFreq, - IN u4Byte offset, - IN u4Byte span, - IN u4Byte seconds + PBTC_COEXIST pBtCoexist, + u32 centFreq, + u32 offset, + u32 span, + u32 seconds ) { if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) @@ -3445,13 +4672,16 @@ void EXhalbtcoutsrc_StackUpdateProfileInfo(void) { #ifdef CONFIG_BT_COEXIST_SOCKET_TRX PBTC_COEXIST pBtCoexist = &GLBtCoexist; - PADAPTER padapter = (PADAPTER)GLBtCoexist.Adapter; - PBT_MGNT pBtMgnt = &padapter->coex_info.BtMgnt; + PADAPTER padapter = NULL; + PBT_MGNT pBtMgnt = NULL; u8 i; if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) return; + padapter = (PADAPTER)pBtCoexist->Adapter; + pBtMgnt = &padapter->coex_info.BtMgnt; + pBtCoexist->stack_info.profile_notified = _TRUE; pBtCoexist->stack_info.num_of_link = @@ -3589,55 +4819,103 @@ void EXhalbtcoutsrc_SetSingleAntPath(u8 singleAntPath) void EXhalbtcoutsrc_DisplayBtCoexInfo(PBTC_COEXIST pBtCoexist) { + HAL_DATA_TYPE *pHalData = NULL; + if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) return; halbtcoutsrc_LeaveLowPower(pBtCoexist); + /* To prevent the racing with IPS enter */ + halbtcoutsrc_EnterPwrLock(pBtCoexist); + +#if (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) + pHalData = GET_HAL_DATA((PADAPTER)pBtCoexist->Adapter); + + if (pHalData->EEPROMBluetoothCoexist == _TRUE) + rtw_btc_ex_display_coex_info(pBtCoexist); +#else + if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { -#if 0 - if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) - ex_halbtc8821aCsr2ant_display_coex_info(pBtCoexist); - else -#endif +#ifdef CONFIG_RTL8821A 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); - } else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { +#endif + } + +#ifdef CONFIG_RTL8723B + else if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8723b2ant_display_coex_info(pBtCoexist); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8723b1ant_display_coex_info(pBtCoexist); - } else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8703B + else if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8703b1ant_display_coex_info(pBtCoexist); - } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8723D + else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8723d2ant_display_coex_info(pBtCoexist); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8723d1ant_display_coex_info(pBtCoexist); - } else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8192E + else if (IS_HARDWARE_TYPE_8192E(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8192e2ant_display_coex_info(pBtCoexist); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8192e1ant_display_coex_info(pBtCoexist); - } else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8812A + else if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8812a2ant_display_coex_info(pBtCoexist); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8812a1ant_display_coex_info(pBtCoexist); - } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { + } +#endif + +#ifdef CONFIG_RTL8822B + 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)) { + } +#endif + +#ifdef CONFIG_RTL8821C + else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821c2ant_display_coex_info(pBtCoexist); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8821c1ant_display_coex_info(pBtCoexist); } +#endif + +#ifdef CONFIG_RTL8814A + else if (IS_HARDWARE_TYPE_8814A(pBtCoexist->Adapter)) { + if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8814a2ant_display_coex_info(pBtCoexist); + } +#endif + +#endif + + halbtcoutsrc_ExitPwrLock(pBtCoexist); halbtcoutsrc_NormalLowPower(pBtCoexist); } @@ -3650,13 +4928,10 @@ void EXhalbtcoutsrc_DisplayAntDetection(PBTC_COEXIST pBtCoexist) halbtcoutsrc_LeaveLowPower(pBtCoexist); if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { +#ifdef CONFIG_RTL8723B if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8723b1ant_display_ant_detection(pBtCoexist); - } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { - if (pBtCoexist->board_info.btdm_ant_num == 2) - ex_halbtc8821c2ant_display_ant_detection(pBtCoexist); - else if (pBtCoexist->board_info.btdm_ant_num == 1) - ex_halbtc8821c1ant_display_ant_detection(pBtCoexist); +#endif } halbtcoutsrc_NormalLowPower(pBtCoexist); @@ -3665,9 +4940,18 @@ void EXhalbtcoutsrc_DisplayAntDetection(PBTC_COEXIST pBtCoexist) void ex_halbtcoutsrc_pta_off_on_notify(PBTC_COEXIST pBtCoexist, u8 bBTON) { if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { +#ifdef CONFIG_RTL8812A if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8812a2ant_pta_off_on_notify(pBtCoexist, (bBTON == _TRUE) ? BTC_BT_ON : BTC_BT_OFF); +#endif } + +#ifdef CONFIG_RTL8814A + else if (IS_HARDWARE_TYPE_8814A(pBtCoexist->Adapter)) { + if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8814a2ant_pta_off_on_notify(pBtCoexist, (bBTON == _TRUE) ? BTC_BT_ON : BTC_BT_OFF); + } +#endif } void EXhalbtcoutsrc_set_rfe_type(u8 type) @@ -3675,6 +4959,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)) @@ -3685,67 +4981,309 @@ void EXhalbtcoutsrc_switchband_notify(struct btc_coexist *pBtCoexist, u8 type) /* Driver should guarantee that the HW status isn't in low power mode */ /* halbtcoutsrc_LeaveLowPower(pBtCoexist); */ +#if (CONFIG_BTCOEX_SUPPORT_BTC_CMN == 1) + rtw_btc_ex_switchband_notify(pBtCoexist, type); +#else if(IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { +#ifdef CONFIG_RTL8822B 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)) { +#endif + } + +#ifdef CONFIG_RTL8821C + else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821c2ant_switchband_notify(pBtCoexist, type); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8821c1ant_switchband_notify(pBtCoexist, type); } +#endif + +#ifdef CONFIG_RTL8814A + else if (IS_HARDWARE_TYPE_8814A(pBtCoexist->Adapter)) { + if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8814a2ant_switchband_notify(pBtCoexist, type); + } +#endif + +#endif /* halbtcoutsrc_NormalLowPower(pBtCoexist); */ } -static void halbt_init_hw_config92C(PADAPTER padapter) +u8 EXhalbtcoutsrc_rate_id_to_btc_rate_id(u8 rate_id) { - PHAL_DATA_TYPE pHalData; - u8 u1Tmp; + 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; - pHalData = GET_HAL_DATA(padapter); - if ((pHalData->bt_coexist.btChipType == BT_CSR_BC4) || - (pHalData->bt_coexist.btChipType == BT_CSR_BC8)) { - if (pHalData->rf_type == RF_1T1R) { - /* Config to 1T1R */ - u1Tmp = rtw_read8(padapter, rOFDM0_TRxPathEnable); - u1Tmp &= ~BIT(1); - rtw_write8(padapter, rOFDM0_TRxPathEnable, u1Tmp); - RT_DISP(FBT, BT_TRACE, ("[BTCoex], BT write 0xC04 = 0x%x\n", u1Tmp)); + /* 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; - u1Tmp = rtw_read8(padapter, rOFDM1_TRxPathEnable); - u1Tmp &= ~BIT(1); - rtw_write8(padapter, rOFDM1_TRxPathEnable, u1Tmp); - RT_DISP(FBT, BT_TRACE, ("[BTCoex], BT write 0xD04 = 0x%x\n", u1Tmp)); - } - } -} - -static void halbt_init_hw_config92D(PADAPTER padapter) -{ - PHAL_DATA_TYPE pHalData; - u8 u1Tmp; - - pHalData = GET_HAL_DATA(padapter); - if ((pHalData->bt_coexist.btChipType == BT_CSR_BC4) || - (pHalData->bt_coexist.btChipType == BT_CSR_BC8)) { - if (pHalData->rf_type == RF_1T1R) { - /* Config to 1T1R */ - u1Tmp = rtw_read8(padapter, rOFDM0_TRxPathEnable); - u1Tmp &= ~BIT(1); - rtw_write8(padapter, rOFDM0_TRxPathEnable, u1Tmp); - RT_DISP(FBT, BT_TRACE, ("[BTCoex], BT write 0xC04 = 0x%x\n", u1Tmp)); - - u1Tmp = rtw_read8(padapter, rOFDM1_TRxPathEnable); - u1Tmp &= ~BIT(1); - rtw_write8(padapter, rOFDM1_TRxPathEnable, u1Tmp); - RT_DISP(FBT, BT_TRACE, ("[BTCoex], BT write 0xD04 = 0x%x\n", u1Tmp)); - } + /* 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; } /* @@ -3814,10 +5352,6 @@ u8 hal_btcoex_Initialize(PADAPTER padapter) _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; @@ -3828,6 +5362,24 @@ 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) + || IS_HARDWARE_TYPE_8822C(padapter)) + rtw_write16(padapter, 0xaa, 0x8000); +} + void hal_btcoex_PreLoadFirmware(PADAPTER padapter) { EXhalbtcoutsrc_PreLoadFirmware(&GLBtCoexist); @@ -3859,7 +5411,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) @@ -3890,7 +5460,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)) @@ -3900,28 +5470,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) @@ -3940,6 +5514,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_btc_port_id_cmd(GLBtCoexist.Adapter); +#endif EXhalbtcoutsrc_pnp_notify(&GLBtCoexist, BTC_WIFI_PNP_WAKE_UP); break; } @@ -4063,6 +5641,21 @@ u32 hal_btcoex_GetRaMask(PADAPTER padapter) return GLBtCoexist.bt_info.ra_mask; } +u8 hal_btcoex_query_reduced_wl_pwr_lvl(PADAPTER padapter) +{ + return GLBtCoexist.coex_dm.cur_wl_pwr_lvl; +} + +void hal_btcoex_set_reduced_wl_pwr_lvl(PADAPTER padapter, u8 val) +{ + GLBtCoexist.coex_dm.cur_wl_pwr_lvl = val; +} + +void hal_btcoex_do_reduce_wl_pwr_lvl(PADAPTER padapter) +{ + halbtcoutsrc_reduce_wl_tx_power(&GLBtCoexist, 0); +} + void hal_btcoex_RecordPwrMode(PADAPTER padapter, u8 *pCmdBuf, u8 cmdLen) { @@ -4284,19 +5877,19 @@ void hal_btcoex_SetAntIsolationType(PADAPTER padapter, u8 anttype) switch (pHalData->bt_coexist.btAntisolation) { case 0: - pBtCoexist->board_info.ant_type = (u1Byte)BTC_ANT_TYPE_0; + pBtCoexist->board_info.ant_type = (u8)BTC_ANT_TYPE_0; break; case 1: - pBtCoexist->board_info.ant_type = (u1Byte)BTC_ANT_TYPE_1; + pBtCoexist->board_info.ant_type = (u8)BTC_ANT_TYPE_1; break; case 2: - pBtCoexist->board_info.ant_type = (u1Byte)BTC_ANT_TYPE_2; + pBtCoexist->board_info.ant_type = (u8)BTC_ANT_TYPE_2; break; case 3: - pBtCoexist->board_info.ant_type = (u1Byte)BTC_ANT_TYPE_3; + pBtCoexist->board_info.ant_type = (u8)BTC_ANT_TYPE_3; break; case 4: - pBtCoexist->board_info.ant_type = (u1Byte)BTC_ANT_TYPE_4; + pBtCoexist->board_info.ant_type = (u8)BTC_ANT_TYPE_4; break; } @@ -4354,7 +5947,7 @@ hal_btcoex_ParseAntIsolationConfigFile( RTW_INFO("Fail to parse parameters , format error!\n"); break; } - _rtw_memset((PVOID)param_value_string , 0 , 10); + _rtw_memset((void *)param_value_string , 0 , 10); if (!ParseQualifiedString(szLine , &i , param_value_string , '"' , '"')) { RTW_INFO("Fail to parse parameters\n"); return _FAIL; @@ -4397,8 +5990,8 @@ hal_btcoex_ParseAntIsolationConfigFile( int hal_btcoex_AntIsolationConfig_ParaFile( - IN PADAPTER Adapter, - IN char *pFileName + PADAPTER Adapter, + char *pFileName ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -4454,6 +6047,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) { @@ -4471,4 +6077,28 @@ 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)); +} + +u16 hal_btcoex_btset_testode(PADAPTER padapter, u8 type) +{ + u16 ret = 0; + + halbtcoutsrc_LeaveLowPower(&GLBtCoexist); + + ret = halbtcoutsrc_setbttestmode(&GLBtCoexist, type); + + halbtcoutsrc_NormalLowPower(&GLBtCoexist); + + return ret; +} + #endif /* CONFIG_BT_COEXIST */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_btcoex_wifionly.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_btcoex_wifionly.c index 838bb97fc7c3..7edb9b622b1a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_btcoex_wifionly.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_btcoex_wifionly.c @@ -1,10 +1,27 @@ /* SPDX-License-Identifier: GPL-2.0 */ -#include "btc/mp_precomp.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. + * + *****************************************************************************/ #include +#if (CONFIG_BTCOEX_SUPPORT_WIFI_ONLY_CFG == 1) + +#include "btc/mp_precomp.h" + struct wifi_only_cfg GLBtCoexistWifiOnly; -void halwifionly_write1byte(PVOID pwifionlyContext, u32 RegAddr, u8 Data) +void halwifionly_write1byte(void *pwifionlyContext, u32 RegAddr, u8 Data) { struct wifi_only_cfg *pwifionlycfg = (struct wifi_only_cfg *)pwifionlyContext; PADAPTER Adapter = pwifionlycfg->Adapter; @@ -12,7 +29,7 @@ void halwifionly_write1byte(PVOID pwifionlyContext, u32 RegAddr, u8 Data) rtw_write8(Adapter, RegAddr, Data); } -void halwifionly_write2byte(PVOID pwifionlyContext, u32 RegAddr, u16 Data) +void halwifionly_write2byte(void *pwifionlyContext, u32 RegAddr, u16 Data) { struct wifi_only_cfg *pwifionlycfg = (struct wifi_only_cfg *)pwifionlyContext; PADAPTER Adapter = pwifionlycfg->Adapter; @@ -20,7 +37,7 @@ void halwifionly_write2byte(PVOID pwifionlyContext, u32 RegAddr, u16 Data) rtw_write16(Adapter, RegAddr, Data); } -void halwifionly_write4byte(PVOID pwifionlyContext, u32 RegAddr, u32 Data) +void halwifionly_write4byte(void *pwifionlyContext, u32 RegAddr, u32 Data) { struct wifi_only_cfg *pwifionlycfg = (struct wifi_only_cfg *)pwifionlyContext; PADAPTER Adapter = pwifionlycfg->Adapter; @@ -28,7 +45,7 @@ void halwifionly_write4byte(PVOID pwifionlyContext, u32 RegAddr, u32 Data) rtw_write32(Adapter, RegAddr, Data); } -u8 halwifionly_read1byte(PVOID pwifionlyContext, u32 RegAddr) +u8 halwifionly_read1byte(void *pwifionlyContext, u32 RegAddr) { struct wifi_only_cfg *pwifionlycfg = (struct wifi_only_cfg *)pwifionlyContext; PADAPTER Adapter = pwifionlycfg->Adapter; @@ -36,7 +53,7 @@ u8 halwifionly_read1byte(PVOID pwifionlyContext, u32 RegAddr) return rtw_read8(Adapter, RegAddr); } -u16 halwifionly_read2byte(PVOID pwifionlyContext, u32 RegAddr) +u16 halwifionly_read2byte(void * pwifionlyContext, u32 RegAddr) { struct wifi_only_cfg *pwifionlycfg = (struct wifi_only_cfg *)pwifionlyContext; PADAPTER Adapter = pwifionlycfg->Adapter; @@ -44,7 +61,7 @@ u16 halwifionly_read2byte(PVOID pwifionlyContext, u32 RegAddr) return rtw_read16(Adapter, RegAddr); } -u32 halwifionly_read4byte(PVOID pwifionlyContext, u32 RegAddr) +u32 halwifionly_read4byte(void *pwifionlyContext, u32 RegAddr) { struct wifi_only_cfg *pwifionlycfg = (struct wifi_only_cfg *)pwifionlyContext; PADAPTER Adapter = pwifionlycfg->Adapter; @@ -52,7 +69,7 @@ u32 halwifionly_read4byte(PVOID pwifionlyContext, u32 RegAddr) return rtw_read32(Adapter, RegAddr); } -void halwifionly_bitmaskwrite1byte(PVOID pwifionlyContext, u32 regAddr, u8 bitMask, u8 data) +void halwifionly_bitmaskwrite1byte(void *pwifionlyContext, u32 regAddr, u8 bitMask, u8 data) { u8 originalValue, bitShift = 0; u8 i; @@ -72,7 +89,7 @@ void halwifionly_bitmaskwrite1byte(PVOID pwifionlyContext, u32 regAddr, u8 bitMa rtw_write8(Adapter, regAddr, data); } -void halwifionly_phy_set_rf_reg(PVOID pwifionlyContext, u8 eRFPath, u32 RegAddr, u32 BitMask, u32 Data) +void halwifionly_phy_set_rf_reg(void *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; @@ -80,7 +97,7 @@ void halwifionly_phy_set_rf_reg(PVOID pwifionlyContext, u8 eRFPath, u32 RegAddr, phy_set_rf_reg(Adapter, eRFPath, RegAddr, BitMask, Data); } -void halwifionly_phy_set_bb_reg(PVOID pwifionlyContext, u32 RegAddr, u32 BitMask, u32 Data) +void halwifionly_phy_set_bb_reg(void *pwifionlyContext, u32 RegAddr, u32 BitMask, u32 Data) { struct wifi_only_cfg *pwifionlycfg = (struct wifi_only_cfg *)pwifionlyContext; PADAPTER Adapter = pwifionlycfg->Adapter; @@ -96,10 +113,22 @@ void hal_btcoex_wifionly_switchband_notify(PADAPTER padapter) if (pHalData->current_band_type == BAND_ON_5G) is_5g = _TRUE; - if (IS_HARDWARE_TYPE_8822B(padapter)) + if (IS_HARDWARE_TYPE_8822B(padapter)) { +#ifdef CONFIG_RTL8822B ex_hal8822b_wifi_only_switchbandnotify(&GLBtCoexistWifiOnly, is_5g); +#endif + } + +#ifdef CONFIG_RTL8821C else if (IS_HARDWARE_TYPE_8821C(padapter)) ex_hal8821c_wifi_only_switchbandnotify(&GLBtCoexistWifiOnly, is_5g); +#endif + +#ifdef CONFIG_RTL8822C + else if (IS_HARDWARE_TYPE_8822C(padapter)) + ex_hal8822c_wifi_only_switchbandnotify(&GLBtCoexistWifiOnly, is_5g); +#endif + } void hal_btcoex_wifionly_scan_notify(PADAPTER padapter) @@ -110,22 +139,72 @@ void hal_btcoex_wifionly_scan_notify(PADAPTER padapter) if (pHalData->current_band_type == BAND_ON_5G) is_5g = _TRUE; - if (IS_HARDWARE_TYPE_8822B(padapter)) + if (IS_HARDWARE_TYPE_8822B(padapter)) { +#ifdef CONFIG_RTL8822B ex_hal8822b_wifi_only_scannotify(&GLBtCoexistWifiOnly, is_5g); +#endif + } + +#ifdef CONFIG_RTL8821C else if (IS_HARDWARE_TYPE_8821C(padapter)) ex_hal8821c_wifi_only_scannotify(&GLBtCoexistWifiOnly, is_5g); +#endif + +#ifdef CONFIG_RTL8822C + else if (IS_HARDWARE_TYPE_8822C(padapter)) + ex_hal8822c_wifi_only_scannotify(&GLBtCoexistWifiOnly, is_5g); +#endif +} + +void hal_btcoex_wifionly_connect_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)) { +#ifdef CONFIG_RTL8822B + ex_hal8822b_wifi_only_connectnotify(&GLBtCoexistWifiOnly, is_5g); +#endif + } + +#ifdef CONFIG_RTL8821C + else if (IS_HARDWARE_TYPE_8821C(padapter)) + ex_hal8821c_wifi_only_connectnotify(&GLBtCoexistWifiOnly, is_5g); +#endif + +#ifdef CONFIG_RTL8822C + else if (IS_HARDWARE_TYPE_8822C(padapter)) + ex_hal8822c_wifi_only_connectnotify(&GLBtCoexistWifiOnly, is_5g); +#endif } void hal_btcoex_wifionly_hw_config(PADAPTER padapter) { struct wifi_only_cfg *pwifionlycfg = &GLBtCoexistWifiOnly; - if (IS_HARDWARE_TYPE_8723B(padapter)) + if (IS_HARDWARE_TYPE_8723B(padapter)) { +#ifdef CONFIG_RTL8723B ex_hal8723b_wifi_only_hw_config(pwifionlycfg); +#endif + } + +#ifdef CONFIG_RTL8822B else if (IS_HARDWARE_TYPE_8822B(padapter)) ex_hal8822b_wifi_only_hw_config(pwifionlycfg); +#endif + +#ifdef CONFIG_RTL8821C else if (IS_HARDWARE_TYPE_8821C(padapter)) ex_hal8821c_wifi_only_hw_config(pwifionlycfg); +#endif + +#ifdef CONFIG_RTL8822C + else if (IS_HARDWARE_TYPE_8822C(padapter)) + ex_hal8822c_wifi_only_hw_config(pwifionlycfg); +#endif } void hal_btcoex_wifionly_initlizevariables(PADAPTER padapter) @@ -149,9 +228,19 @@ void hal_btcoex_wifionly_initlizevariables(PADAPTER padapter) #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; } +#endif + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_com.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_com.c index 61c2b98730a8..d23433b43757 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_com.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_com.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 @@ -36,12 +32,137 @@ void rtw_dump_fw_info(void *sel, _adapter *adapter) return; hal_data = GET_HAL_DATA(adapter); - if (adapter->bFWReady) + 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"); } +bool rsvd_page_cache_update_all(struct rsvd_page_cache_t *cache, u8 loc + , u8 txdesc_len, u32 page_size, u8 *info, u32 info_len) +{ + u8 page_num = (u8)PageNum(txdesc_len + info_len, page_size); + bool modified = 0; + bool loc_mod = 0, size_mod = 0, page_num_mod = 0; + + if (cache->loc != loc) { + RTW_INFO("%s %s loc change (%u -> %u)\n" + , __func__, cache->name, cache->loc, loc); + loc_mod = 1; + } + if (cache->size != info_len) { + RTW_INFO("%s %s size change (%u -> %u)\n" + , __func__, cache->name, cache->size, info_len); + size_mod = 1; + } + if (cache->page_num != page_num) { + RTW_INFO("%s %s page_num change (%u -> %u)\n" + , __func__, cache->name, cache->page_num, page_num); + page_num_mod = 1; + } + + if (info) { + if (cache->data) { + if (cache->size == info_len) { + if (_rtw_memcmp(cache->data, info, info_len) != _TRUE) { + RTW_INFO("%s %s data change\n", __func__, cache->name); + modified = 1; + } + } else + rsvd_page_cache_free_data(cache); + } + + if (!cache->data) { + cache->data = rtw_malloc(info_len); + if (!cache->data) { + RTW_ERR("%s %s alloc data with size(%u) fail\n" + , __func__, cache->name, info_len); + rtw_warn_on(1); + } else { + RTW_INFO("%s %s alloc data with size(%u)\n" + , __func__, cache->name, info_len); + } + modified = 1; + } + + if (cache->data && modified) + _rtw_memcpy(cache->data, info, info_len); + } else { + if (cache->data && size_mod) + rsvd_page_cache_free_data(cache); + } + + cache->loc = loc; + cache->page_num = page_num; + cache->size = info_len; + + return modified | loc_mod | size_mod | page_num_mod; +} + +bool rsvd_page_cache_update_data(struct rsvd_page_cache_t *cache, u8 *info, u32 info_len) +{ + bool modified = 0; + + if (!info || !info_len) { + RTW_WARN("%s %s invalid input(info:%p, info_len:%u)\n" + , __func__, cache->name, info, info_len); + goto exit; + } + + if (!cache->loc || !cache->page_num || !cache->size) { + RTW_ERR("%s %s layout not ready(loc:%u, page_num:%u, size:%u)\n" + , __func__, cache->name, cache->loc, cache->page_num, cache->size); + rtw_warn_on(1); + goto exit; + } + + if (cache->size != info_len) { + RTW_ERR("%s %s size(%u) differ with info_len(%u)\n" + , __func__, cache->name, cache->size, info_len); + rtw_warn_on(1); + goto exit; + } + + if (!cache->data) { + cache->data = rtw_zmalloc(cache->size); + if (!cache->data) { + RTW_ERR("%s %s alloc data with size(%u) fail\n" + , __func__, cache->name, cache->size); + rtw_warn_on(1); + goto exit; + } else { + RTW_INFO("%s %s alloc data with size(%u)\n" + , __func__, cache->name, info_len); + } + modified = 1; + } + + if (_rtw_memcmp(cache->data, info, cache->size) == _FALSE) { + RTW_INFO("%s %s data change\n", __func__, cache->name); + _rtw_memcpy(cache->data, info, cache->size); + modified = 1; + } + +exit: + return modified; +} + +void rsvd_page_cache_free_data(struct rsvd_page_cache_t *cache) +{ + if (cache->data) { + rtw_mfree(cache->data, cache->size); + cache->data = NULL; + } +} + +void rsvd_page_cache_free(struct rsvd_page_cache_t *cache) +{ + cache->loc = 0; + cache->page_num = 0; + rsvd_page_cache_free_data(cache); + cache->size = 0; +} + /* #define CONFIG_GTK_OL_DBG */ /*#define DBG_SEC_CAM_MOVE*/ @@ -52,7 +173,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); @@ -119,6 +240,8 @@ void dump_chip_info(HAL_VERSION ChipVersion) cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8188E_"); else if (IS_8188F(ChipVersion)) cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8188F_"); + else if (IS_8188GTV(ChipVersion)) + cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8188GTV_"); else if (IS_8812_SERIES(ChipVersion)) cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8812_"); else if (IS_8192E(ChipVersion)) @@ -137,6 +260,12 @@ void dump_chip_info(HAL_VERSION ChipVersion) cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8822B_"); else if (IS_8821C_SERIES(ChipVersion)) cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8821C_"); + else if (IS_8710B_SERIES(ChipVersion)) + cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8710B_"); + else if (IS_8192F_SERIES(ChipVersion)) + cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8192F_"); + else if (IS_8822C_SERIES(ChipVersion)) + cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_8822C_"); else cnt += sprintf((buf + cnt), "Chip Version Info: CHIP_UNKNOWN_"); @@ -188,6 +317,38 @@ void dump_chip_info(HAL_VERSION ChipVersion) RTW_INFO("%s", buf); } + +u8 rtw_hal_get_port(_adapter *adapter) +{ + u8 hw_port = get_hw_port(adapter); +#ifdef CONFIG_CLIENT_PORT_CFG + u8 clt_port = get_clt_port(adapter); + + if (clt_port) + hw_port = clt_port; + +#ifdef DBG_HW_PORT + if (MLME_IS_STA(adapter) && (adapter->client_id != MAX_CLIENT_PORT_NUM)) { + if(hw_port == CLT_PORT_INVALID) { + RTW_ERR(ADPT_FMT" @@@@@ Client port == 0 @@@@@\n", ADPT_ARG(adapter)); + rtw_warn_on(1); + } + } + else if (MLME_IS_AP(adapter) || MLME_IS_MESH(adapter)) { + if (hw_port != HW_PORT0) { + RTW_ERR(ADPT_FMT" @@@@@ AP / MESH port != 0 @@@@@\n", ADPT_ARG(adapter)); + rtw_warn_on(1); + } + } + if (0) + RTW_INFO(ADPT_FMT" - HP:%d,CP:%d\n", ADPT_ARG(adapter), get_hw_port(adapter), get_clt_port(adapter)); +#endif /*DBG_HW_PORT*/ + +#endif/*CONFIG_CLIENT_PORT_CFG*/ + + return hw_port; +} + void rtw_hal_config_rftype(PADAPTER padapter) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); @@ -233,20 +394,18 @@ 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( - IN PADAPTER padapter, - IN char *hw_alpha2, - IN u8 hw_chplan, - IN char *sw_alpha2, - IN u8 sw_chplan, - IN u8 def_chplan, - IN BOOLEAN AutoLoadFail +void hal_com_config_channel_plan( + PADAPTER padapter, + char *hw_alpha2, + u8 hw_chplan, + char *sw_alpha2, + u8 sw_chplan, + u8 def_chplan, + BOOLEAN AutoLoadFail ) { + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); PHAL_DATA_TYPE pHalData; u8 force_hw_chplan = _FALSE; int chplan = -1; @@ -307,7 +466,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: @@ -320,16 +479,15 @@ 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 HAL_IsLegalChannel( - IN PADAPTER Adapter, - IN u32 Channel + PADAPTER Adapter, + u32 Channel ) { BOOLEAN bLegalChannel = _TRUE; @@ -886,9 +1044,9 @@ u8 hw_rate_to_m_rate(u8 rate) } void HalSetBrateCfg( - IN PADAPTER Adapter, - IN u8 *mBratesOS, - OUT u16 *pBrateCfg) + PADAPTER Adapter, + u8 *mBratesOS, + u16 *pBrateCfg) { u8 i, is_brate, brate; @@ -939,9 +1097,9 @@ void HalSetBrateCfg( } } -static VOID +static void _OneOutPipeMapping( - IN PADAPTER pAdapter + PADAPTER pAdapter ) { struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(pAdapter); @@ -957,10 +1115,10 @@ _OneOutPipeMapping( pdvobjpriv->Queue2Pipe[7] = pdvobjpriv->RtOutPipe[0];/* TXCMD */ } -static VOID +static void _TwoOutPipeMapping( - IN PADAPTER pAdapter, - IN BOOLEAN bWIFICfg + PADAPTER pAdapter, + BOOLEAN bWIFICfg ) { struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(pAdapter); @@ -1002,9 +1160,9 @@ _TwoOutPipeMapping( } -static VOID _ThreeOutPipeMapping( - IN PADAPTER pAdapter, - IN BOOLEAN bWIFICfg +static void _ThreeOutPipeMapping( + PADAPTER pAdapter, + BOOLEAN bWIFICfg ) { struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(pAdapter); @@ -1044,9 +1202,10 @@ static VOID _ThreeOutPipeMapping( } } -static VOID _FourOutPipeMapping( - IN PADAPTER pAdapter, - IN BOOLEAN bWIFICfg +#if 0 +static void _FourOutPipeMapping( + PADAPTER pAdapter, + BOOLEAN bWIFICfg ) { struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(pAdapter); @@ -1086,10 +1245,11 @@ static VOID _FourOutPipeMapping( } } +#endif BOOLEAN Hal_MappingOutPipe( - IN PADAPTER pAdapter, - IN u8 NumOutPipe + PADAPTER pAdapter, + u8 NumOutPipe ) { struct registry_priv *pregistrypriv = &pAdapter->registrypriv; @@ -1104,6 +1264,8 @@ Hal_MappingOutPipe( break; case 3: case 4: + case 5: + case 6: _ThreeOutPipeMapping(pAdapter, bWIFICfg); break; case 1: @@ -1137,7 +1299,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)); } @@ -1145,13 +1307,41 @@ 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; + bcn_ctrl.rx_bssid_fit = 1; + bcn_ctrl.rxbcn_rpt = 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 - _adapter *iface; - struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); - rtw_mbid_cam_restore(adapter); #else int i; _adapter *iface; @@ -1160,7 +1350,25 @@ 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_hw_port_enable(iface); + } +#endif +} +#endif + +void rtw_mi_set_mac_addr(_adapter *adapter) +{ +#ifdef CONFIG_MI_WITH_MBSSID_CAM + rtw_mi_set_mbid_cam(adapter); +#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_set_hwreg(iface, HW_VAR_MAC_ADDR, adapter_mac_addr(iface)); } #endif if (1) @@ -1174,7 +1382,13 @@ void rtw_init_hal_com_default_value(PADAPTER Adapter) pHalData->AntDetection = 1; pHalData->antenna_test = _FALSE; - pHalData->u1ForcedIgiLb = regsty->force_igi_lb; + pHalData->RegIQKFWOffload = regsty->iqk_fw_offload; + pHalData->ch_switch_offload = regsty->ch_switch_offload; + pHalData->multi_ch_switch_mode = 0; +#ifdef RTW_REDUCE_SCAN_SWITCH_CH_TIME + if (pHalData->ch_switch_offload == 0) + pHalData->ch_switch_offload = 1; +#endif } #ifdef CONFIG_FW_C2H_REG @@ -1216,7 +1430,7 @@ s32 c2h_evt_read_88xx(_adapter *adapter, u8 *buf) for (i = 0; i < C2H_PLEN_88XX(buf); i++) *(C2H_PAYLOAD_88XX(buf) + i) = rtw_read8(adapter, REG_C2HEVT_MSG_NORMAL + 2 + i); - RTW_DBG_DUMP("payload:\n", C2H_PAYLOAD_88XX(buf), C2H_PLEN_88XX(buf)); + RTW_DBG_DUMP("payload: ", C2H_PAYLOAD_88XX(buf), C2H_PLEN_88XX(buf)); ret = _SUCCESS; @@ -1350,7 +1564,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) @@ -1378,7 +1591,7 @@ int c2h_mac_hidden_rpt_hdl(_adapter *adapter, u8 *data, u8 len) u8 wl_func; u8 hw_stype; u8 bw; - u8 fab; + u8 ss_num = 4; u8 ant_num; u8 protocol; u8 nic; @@ -1404,7 +1617,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); @@ -1421,28 +1633,46 @@ 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); } - /* - * NOTICE: - * for now, the following is common info/format - * if there is any hal difference need to export - * some IC dependent code will need to be implement - */ +#if defined(CONFIG_RTL8822C) + if (IS_8822C_SERIES(hal_data->version_id)) { + #define GET_C2H_MAC_HIDDEN_RPT_SS_NUM(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 6, 3, 2) + ss_num = GET_C2H_MAC_HIDDEN_RPT_SS_NUM(data); + + if (DBG_C2H_MAC_HIDDEN_RPT_HANDLE) + RTW_PRINT("ss_num:0x%x\n", ss_num); + } +#endif + +#if defined(CONFIG_RTL8822C) + if (IS_8822C_SERIES(hal_data->version_id)) { + if (hw_stype == 0xE) + hal_data->rf_type = RF_1T2R; /* txpath:A, rxpath:AB */ + } +#endif hal_data->PackageType = package_type; + hal_spec->hci_type = hci_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->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 */ + /* + * RF TX path num >= max_tx_cnt >= tx_nss_num + * ex: RF TX path num(4) >= max_tx_cnt(2) >= tx_nss_num(1) + * Select at most 2 out of 4 TX RF path to do 1SS 2TX + */ + hal_spec->max_tx_cnt = rtw_min(hal_spec->max_tx_cnt, rf_type_to_rf_tx_cnt(hal_data->rf_type)); + hal_spec->max_tx_cnt = rtw_min(hal_spec->max_tx_cnt, ant_num); + hal_spec->tx_nss_num = rtw_min(hal_spec->tx_nss_num, hal_spec->max_tx_cnt); + hal_spec->tx_nss_num = rtw_min(hal_spec->tx_nss_num, ss_num); + + hal_spec->rx_nss_num = rtw_min(hal_spec->rx_nss_num, rf_type_to_rf_rx_cnt(hal_data->rf_type)); + hal_spec->rx_nss_num = rtw_min(hal_spec->rx_nss_num, ant_num); + hal_spec->rx_nss_num = rtw_min(hal_spec->rx_nss_num, ss_num); ret = _SUCCESS; @@ -1468,6 +1698,19 @@ int c2h_mac_hidden_rpt_2_hdl(_adapter *adapter, u8 *data, u8 len) RTW_PRINT("%s: 0x%02X\n", __func__, *(data + i)); } + #if defined(CONFIG_RTL8188F) || defined(CONFIG_RTL8188GTV) + if (IS_8188F(hal_data->version_id) || IS_8188GTV(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: @@ -1480,7 +1723,7 @@ int hal_read_mac_hidden_rpt(_adapter *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; @@ -1531,8 +1774,6 @@ int hal_read_mac_hidden_rpt(_adapter *adapter) if (ret_fwdl == _SUCCESS && id == C2H_MAC_HIDDEN_RPT) ret = _SUCCESS; -exit: - #if defined(CONFIG_USB_HCI) || defined(CONFIG_PCI_HCI) if ((hci_type == RTW_USB || hci_type == RTW_PCIE) && !rtw_is_hw_init_completed(adapter)) @@ -1791,22 +2032,195 @@ 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) +#ifdef RTW_PER_CMD_SUPPORT_FW +#define H2C_REQ_PER_RPT_LEN 5 +#define SET_H2CCMD_REQ_PER_RPT_GROUP_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 4, __Value) +#define SET_H2CCMD_REQ_PER_RPT_RPT_TYPE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 4, __Value) +#define SET_H2CCMD_REQ_PER_RPT_MACID_BMAP(__pH2CCmd, __Value) SET_BITS_TO_LE_4BYTE(__pH2CCmd + 1, 0, 32, __Value) + +u8 rtw_hal_set_req_per_rpt_cmd(_adapter *adapter, u8 group_macid, + u8 rpt_type, u32 macid_bitmap) { -#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 ret = _FAIL; + u8 cmd_buf[H2C_REQ_PER_RPT_LEN] = {0}; - bw = rtw_get_tx_bw_mode(adapter, psta); + SET_H2CCMD_REQ_PER_RPT_GROUP_MACID(cmd_buf, group_macid); + SET_H2CCMD_REQ_PER_RPT_RPT_TYPE(cmd_buf, rpt_type); + SET_H2CCMD_REQ_PER_RPT_MACID_BMAP(cmd_buf, macid_bitmap); - return phydm_rate_id_mapping(&pHalData->odmpriv, psta->wireless_mode, pHalData->rf_type, bw); + ret = rtw_hal_fill_h2c_cmd(adapter, + H2C_REQ_PER_RPT, + H2C_REQ_PER_RPT_LEN, + cmd_buf); + return ret; +} + +#define GET_C2H_PER_RATE_RPT_TYPE0_MACID0(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)), 0, 8) +#define GET_C2H_PER_RATE_RPT_TYPE0_PER0(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 1, 0, 8) +#define GET_C2H_PER_RATE_RPT_TYPE0_RATE0(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 2, 0, 8) +#define GET_C2H_PER_RATE_RPT_TYPE0_BW0(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 3, 0, 2) +#define GET_C2H_PER_RATE_RPT_TYPE0_TOTAL_PKT0(_data) LE_BITS_TO_2BYTE(((u8 *)(_data)) + 4, 0, 16) +#define GET_C2H_PER_RATE_RPT_TYPE0_MACID1(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 6, 0, 8) +#define GET_C2H_PER_RATE_RPT_TYPE0_PER1(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 7, 0, 8) +#define GET_C2H_PER_RATE_RPT_TYPE0_RATE1(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 8, 0, 8) +#define GET_C2H_PER_RATE_RPT_TYPE0_BW1(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 9, 0, 2) +#define GET_C2H_PER_RATE_RPT_TYPE0_TOTAL_PKT1(_data) LE_BITS_TO_2BYTE(((u8 *)(_data)) + 10, 0, 16) + +#define GET_C2H_PER_RATE_RPT_TYPE1_MACID0(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)), 0, 8) +#define GET_C2H_PER_RATE_RPT_TYPE1_PER0(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 1, 0, 8) +#define GET_C2H_PER_RATE_RPT_TYPE1_RATE0(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 2, 0, 8) +#define GET_C2H_PER_RATE_RPT_TYPE1_BW0(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 3, 0, 2) +#define GET_C2H_PER_RATE_RPT_TYPE1_MACID1(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 4, 0, 8) +#define GET_C2H_PER_RATE_RPT_TYPE1_PER1(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 5, 0, 8) +#define GET_C2H_PER_RATE_RPT_TYPE1_RATE1(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 6, 0, 8) +#define GET_C2H_PER_RATE_RPT_TYPE1_BW1(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 7, 0, 2) +#define GET_C2H_PER_RATE_RPT_TYPE1_MACID2(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 8, 0, 8) +#define GET_C2H_PER_RATE_RPT_TYPE1_PER2(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 9, 0, 8) +#define GET_C2H_PER_RATE_RPT_TYPE1_RATE2(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 10, 0, 8) +#define GET_C2H_PER_RATE_RPT_TYPE1_BW2(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 11, 0, 2) + +static void per_rate_rpt_update(_adapter *adapter, u8 mac_id, + u8 per, u8 rate, + u8 bw, u8 total_pkt) +{ +#ifdef CONFIG_RTW_MESH + rtw_ieee80211s_update_metric(adapter, mac_id, + per, rate, + bw, total_pkt); #endif } + +int c2h_per_rate_rpt_hdl(_adapter *adapter, u8 *data, u8 len) +{ + /* Now only consider type0, since it covers all params in type1 + * type0: mac_id, per, rate, bw, total_pkt + * type1: mac_id, per, rate, bw + */ + u8 mac_id[2] = {0}, per[2] = {0}, rate[2] = {0}, bw[2] = {0}; + u16 total_pkt[2] = {0}; + int ret = _FAIL, i, macid_cnt = 0; + + /* type0: + * 1 macid includes 6 bytes info + 1 byte 0xff + * 2 macid includes 2*6 bytes info + */ + if (!(len == 7 || len == 12)) { + RTW_WARN("%s len(%u) != 7 or 12\n", __FUNCTION__, len); + goto exit; + } + + macid_cnt++; + mac_id[0] = GET_C2H_PER_RATE_RPT_TYPE0_MACID0(data); + per[0] = GET_C2H_PER_RATE_RPT_TYPE0_PER0(data); + rate[0] = GET_C2H_PER_RATE_RPT_TYPE0_RATE0(data); + bw[0] = GET_C2H_PER_RATE_RPT_TYPE0_BW0(data); + total_pkt[0] = GET_C2H_PER_RATE_RPT_TYPE0_TOTAL_PKT0(data); + + mac_id[1] = GET_C2H_PER_RATE_RPT_TYPE0_MACID1(data); + /* 0xff means no report anymore */ + if (mac_id[1] == 0xff) + goto update_per; + if (len != 12) { + RTW_WARN("%s incorrect format\n", __FUNCTION__); + goto exit; + } + macid_cnt++; + per[1] = GET_C2H_PER_RATE_RPT_TYPE0_PER1(data); + rate[1] = GET_C2H_PER_RATE_RPT_TYPE0_RATE1(data); + bw[1] = GET_C2H_PER_RATE_RPT_TYPE0_BW1(data); + total_pkt[1] = GET_C2H_PER_RATE_RPT_TYPE0_TOTAL_PKT1(data); + +update_per: + for (i = 0; i < macid_cnt; i++) { + RTW_DBG("[%s] type0 rpt[%d]: macid = %u, per = %u, " + "rate = %u, bw = %u, total_pkt = %u\n", + __FUNCTION__, i, mac_id[i], per[i], + rate[i], bw[i], total_pkt[i]); + per_rate_rpt_update(adapter, mac_id[i], + per[i], rate[i], + bw[i], total_pkt[i]); + } + ret = _SUCCESS; +exit: + return ret; +} +#endif /* RTW_PER_CMD_SUPPORT_FW */ + +void rtw_hal_update_sta_wset(_adapter *adapter, struct sta_info *psta) +{ + u8 w_set = 0; + + if (psta->wireless_mode & WIRELESS_11B) + w_set |= WIRELESS_CCK; + + 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); + +#ifdef CONFIG_CTRL_TXSS_BY_TP + rtw_ctrl_txss_update_mimo_type(adapter, psta); +#endif + + 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) { @@ -1826,13 +2240,11 @@ void rtw_hal_update_sta_rate_mask(PADAPTER padapter, struct sta_info *psta) { struct hal_spec_t *hal_spec = GET_HAL_SPEC(padapter); u8 i, rf_type, tx_nss; - u64 tx_ra_bitmap; + u64 tx_ra_bitmap = 0, tmp64=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]) @@ -1840,6 +2252,7 @@ void rtw_hal_update_sta_rate_mask(PADAPTER padapter, struct sta_info *psta) } #ifdef CONFIG_80211N_HT +if (padapter->registrypriv.ht_enable && is_supported_ht(padapter->registrypriv.wireless_mode)) { 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 @@ -1860,13 +2273,146 @@ void rtw_hal_update_sta_rate_mask(PADAPTER padapter, struct sta_info *psta) } } - tx_ra_bitmap |= (rtw_ht_mcs_set_to_bitmap(psta->htpriv.ht_cap.supp_mcs_set, tx_nss) << 12); + tmp64 = rtw_ht_mcs_set_to_bitmap(psta->htpriv.ht_cap.supp_mcs_set, tx_nss); + tx_ra_bitmap |= (tmp64 << 12); } +} #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); +} + +static u32 hw_bcn_ctrl_addr(_adapter *adapter, u8 hw_port) +{ + struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); + + if (hw_port >= hal_spec->port_num) { + RTW_ERR(FUNC_ADPT_FMT" HW Port(%d) invalid\n", FUNC_ADPT_ARG(adapter), hw_port); + rtw_warn_on(1); + return 0; + } + + switch (hw_port) { + case HW_PORT0: + return REG_BCN_CTRL; + case HW_PORT1: + return REG_BCN_CTRL_1; + } + + return 0; +} + +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*/ + *net_type = rtw_read8(adapter, MSR) & 0x03; + break; + case HW_PORT1: + /*REG_CR - BIT[19:18]-Network Type for port 1*/ + *net_type = (rtw_read8(adapter, MSR) & 0x0C) >> 2; + break; +#if defined(CONFIG_RTL8814A) + case HW_PORT2: + /*REG_CR_EXT- BIT[1:0]-Network Type for port 2*/ + *net_type = rtw_read8(adapter, MSR1) & 0x03; + break; + case HW_PORT3: + /*REG_CR_EXT- BIT[3:2]-Network Type for port 3*/ + *net_type = (rtw_read8(adapter, MSR1) & 0x0C) >> 2; + break; + case HW_PORT4: + /*REG_CR_EXT- BIT[5:4]-Network Type for port 4*/ + *net_type = (rtw_read8(adapter, MSR1) & 0x30) >> 4; + break; +#endif /*#if defined(CONFIG_RTL8814A)*/ + default: + RTW_INFO("[WARN] "ADPT_FMT"- invalid hw port -%d\n", + ADPT_ARG(adapter), adapter->hw_port); + rtw_warn_on(1); + break; + } +#endif /* !RTW_HALMAC */ +} + +#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) + 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; + rtw_write8(adapter, MSR, val8); + break; + case HW_PORT1: + /*REG_CR - BIT[19:18]-Network Type for port 1*/ + val8 = rtw_read8(adapter, MSR) & 0x03; + val8 |= net_type << 2; + rtw_write8(adapter, MSR, val8); + break; +#if defined(CONFIG_RTL8814A) + case HW_PORT2: + /*REG_CR_EXT- BIT[1:0]-Network Type for port 2*/ + val8 = rtw_read8(adapter, MSR1) & 0xFC; + val8 |= net_type; + rtw_write8(adapter, MSR1, val8); + break; + case HW_PORT3: + /*REG_CR_EXT- BIT[3:2]-Network Type for port 3*/ + val8 = rtw_read8(adapter, MSR1) & 0xF3; + val8 |= net_type << 2; + rtw_write8(adapter, MSR1, val8); + break; + case HW_PORT4: + /*REG_CR_EXT- BIT[5:4]-Network Type for port 4*/ + val8 = rtw_read8(adapter, MSR1) & 0xCF; + val8 |= net_type << 4; + rtw_write8(adapter, MSR1, val8); + break; +#endif /* CONFIG_RTL8814A */ + default: + RTW_INFO("[WARN] "ADPT_FMT"- invalid hw port -%d\n", + ADPT_ARG(adapter), adapter->hw_port); + rtw_warn_on(1); + break; + } +#endif /* !RTW_HALMAC */ +} + #ifndef SEC_CAM_ACCESS_TIMEOUT_MS #define SEC_CAM_ACCESS_TIMEOUT_MS 200 #endif @@ -1880,7 +2426,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; @@ -1922,7 +2468,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; @@ -2010,8 +2556,8 @@ void rtw_sec_write_cam_ent(_adapter *adapter, u8 id, u16 ctrl, u8 *mac, u8 *key) { unsigned int i; int j; - u8 addr; - u32 wdata; + u8 addr, addr1 = 0; + u32 wdata, wdata1 = 0; /* TODO: consider other key length accordingly */ #if 0 @@ -2046,8 +2592,20 @@ void rtw_sec_write_cam_ent(_adapter *adapter, u8 id, u16 ctrl, u8 *mac, u8 *key) addr = (id << 3) + j; +#if defined(CONFIG_RTL8192F) + if(j == 1) { + wdata1 = wdata; + addr1 = addr; + continue; + } +#endif + rtw_sec_write_cam(adapter, addr, wdata); } + +#if defined(CONFIG_RTL8192F) + rtw_sec_write_cam(adapter, addr1, wdata1); +#endif } void rtw_sec_clr_cam_ent(_adapter *adapter, u8 id) @@ -2213,14 +2771,14 @@ u8 rtw_mbid_camid_alloc(_adapter *adapter, u8 *mac_addr) struct mbid_cam_ctl_t *mbid_cam_ctl = &dvobj->mbid_cam_ctl; u8 entry_num = ATOMIC_READ(&mbid_cam_ctl->mbid_entry_num); + if (INVALID_CAM_ID != rtw_mbid_cam_search_by_macaddr(adapter, mac_addr)) + goto exit; + if (entry_num >= TOTAL_MBID_CAM_NUM) { RTW_INFO(FUNC_ADPT_FMT" failed !! MBSSID number :%d over TOTAL_CAM_ENTRY(8)\n", FUNC_ADPT_ARG(adapter), entry_num); rtw_warn_on(1); } - if (INVALID_CAM_ID != rtw_mbid_cam_search_by_macaddr(adapter, mac_addr)) - goto exit; - _enter_critical_bh(&mbid_cam_ctl->lock, &irqL); for (i = 0; i < TOTAL_MBID_CAM_NUM; i++) { if (!(mbid_cam_ctl->bitmap & BIT(i))) { @@ -2336,21 +2894,23 @@ int rtw_mbid_cam_cache_dump(void *sel, const char *fun_name, _adapter *adapter) if (mbid_cam_ctl->bitmap & BIT(i)) { iface_id = dvobj->mbid_cam_cache[i].iface_id; - RTW_PRINT_SEL(sel, "IF_ID:%d\t", iface_id); - RTW_PRINT_SEL(sel, "MAC Addr:"MAC_FMT"\t", MAC_ARG(dvobj->mbid_cam_cache[i].mac_addr)); + _RTW_PRINT_SEL(sel, "IF_ID:%d\t", iface_id); + _RTW_PRINT_SEL(sel, "MAC Addr:"MAC_FMT"\t", MAC_ARG(dvobj->mbid_cam_cache[i].mac_addr)); iface = dvobj->padapters[iface_id]; if (iface) { - if (check_fwstate(&iface->mlmepriv, WIFI_STATION_STATE) == _TRUE) - RTW_PRINT_SEL(sel, "ROLE:%s\n", "STA"); - else if (check_fwstate(&iface->mlmepriv, WIFI_AP_STATE) == _TRUE) - RTW_PRINT_SEL(sel, "ROLE:%s\n", "AP"); + if (MLME_IS_STA(iface)) + _RTW_PRINT_SEL(sel, "ROLE:%s\n", "STA"); + 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"); + _RTW_PRINT_SEL(sel, "ROLE:%s\n", "NONE"); } } else - RTW_PRINT_SEL(sel, "N/A\n"); + _RTW_PRINT_SEL(sel, "N/A\n"); } _exit_critical_bh(&mbid_cam_ctl->lock, &irqL); return 0; @@ -2405,7 +2965,7 @@ int rtw_mbid_cam_dump(void *sel, const char *fun_name, _adapter *adapter) RTW_PRINT_SEL(sel, "CAM_ID = %d\t", i); _rtw_memset(mac_addr, 0, ETH_ALEN); read_mbssid_cam(adapter, i, mac_addr); - RTW_PRINT_SEL(sel, "MAC Addr:"MAC_FMT"\n", MAC_ARG(mac_addr)); + _RTW_PRINT_SEL(sel, "MAC Addr:"MAC_FMT"\n", MAC_ARG(mac_addr)); } /*_exit_critical_bh(&mbid_cam_ctl->lock, &irqL);*/ return 0; @@ -2421,21 +2981,25 @@ static void write_mbssid_cam(_adapter *padapter, u8 cam_addr, u8 *mac) rtw_hal_set_hwreg(padapter, HW_VAR_MBSSID_CAM_WRITE, (u8 *)cam_val); } +/* static void clear_mbssid_cam(_adapter *padapter, u8 cam_addr) { rtw_hal_set_hwreg(padapter, HW_VAR_MBSSID_CAM_CLEAR, &cam_addr); } -static void enable_mbssid_cam(_adapter *adapter) +*/ + +void rtw_ap_set_mbid_num(_adapter *adapter, u8 ap_num) { - 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); - if (max_cam_id != INVALID_CAM_ID) { - rtw_write8(adapter, REG_MBID_NUM, - ((rtw_read8(adapter, REG_MBID_NUM) & 0xF8) | (max_cam_id & 0x07))); - } + rtw_write8(adapter, REG_MBID_NUM, + ((rtw_read8(adapter, REG_MBID_NUM) & 0xF8) | ((ap_num -1) & 0x07))); + } -void rtw_mbid_cam_restore(_adapter *adapter) +void rtw_mbid_cam_enable(_adapter *adapter) +{ + /*enable MBSSID*/ + rtw_hal_rcr_add(adapter, RCR_ENMBID); +} +void rtw_mi_set_mbid_cam(_adapter *adapter) { u8 i; struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); @@ -2451,10 +3015,264 @@ void rtw_mbid_cam_restore(_adapter *adapter) RTW_INFO("%s - cam_id:%d => mac:"MAC_FMT"\n", __func__, i, MAC_ARG(dvobj->mbid_cam_cache[i].mac_addr)); } } - enable_mbssid_cam(adapter); + rtw_mbid_cam_enable(adapter); } #endif /*CONFIG_MBSSID_CAM*/ +#ifdef CONFIG_FW_HANDLE_TXBCN +#define H2C_BCN_OFFLOAD_LEN 1 + +#define SET_H2CCMD_BCN_OFFLOAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) +#define SET_H2CCMD_BCN_ROOT_TBTT_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) +#define SET_H2CCMD_BCN_VAP1_TBTT_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) +#define SET_H2CCMD_BCN_VAP2_TBTT_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 1, __Value) +#define SET_H2CCMD_BCN_VAP3_TBTT_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 1, __Value) +#define SET_H2CCMD_BCN_VAP4_TBTT_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 5, 1, __Value) + +void rtw_hal_set_fw_ap_bcn_offload_cmd(_adapter *adapter, bool fw_bcn_en, u8 tbtt_rpt_map) +{ + u8 fw_bcn_offload[1] = {0}; + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + + if (fw_bcn_en) + SET_H2CCMD_BCN_OFFLOAD_EN(fw_bcn_offload, 1); + + if (tbtt_rpt_map & BIT(0)) + SET_H2CCMD_BCN_ROOT_TBTT_RPT(fw_bcn_offload, 1); + if (tbtt_rpt_map & BIT(1)) + SET_H2CCMD_BCN_VAP1_TBTT_RPT(fw_bcn_offload, 1); + if (tbtt_rpt_map & BIT(2)) + SET_H2CCMD_BCN_VAP2_TBTT_RPT(fw_bcn_offload, 1); + if (tbtt_rpt_map & BIT(3)) + SET_H2CCMD_BCN_VAP3_TBTT_RPT(fw_bcn_offload, 1); + + dvobj->vap_tbtt_rpt_map = tbtt_rpt_map; + dvobj->fw_bcn_offload = fw_bcn_en; + RTW_INFO("[FW BCN] Offload : %s\n", (dvobj->fw_bcn_offload) ? "EN" : "DIS"); + RTW_INFO("[FW BCN] TBTT RPT map : 0x%02x\n", dvobj->vap_tbtt_rpt_map); + + rtw_hal_fill_h2c_cmd(adapter, H2C_FW_BCN_OFFLOAD, + H2C_BCN_OFFLOAD_LEN, fw_bcn_offload); +} + +void rtw_hal_set_bcn_rsvdpage_loc_cmd(_adapter *adapter) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + u8 ret, vap_id; + u32 page_size = 0; + u8 bcn_rsvdpage[H2C_BCN_RSVDPAGE_LEN] = {0}; + + rtw_hal_get_def_var(adapter, HAL_DEF_TX_PAGE_SIZE, (u8 *)&page_size); + #if 1 + for (vap_id = 0; vap_id < CONFIG_LIMITED_AP_NUM; vap_id++) { + if (dvobj->vap_map & BIT(vap_id)) + bcn_rsvdpage[vap_id] = vap_id * (MAX_BEACON_LEN / page_size); + } + #else +#define SET_H2CCMD_BCN_RSVDPAGE_LOC_ROOT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) +#define SET_H2CCMD_BCN_RSVDPAGE_LOC_VAP1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 8, __Value) +#define SET_H2CCMD_BCN_RSVDPAGE_LOC_VAP2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 8, __Value) +#define SET_H2CCMD_BCN_RSVDPAGE_LOC_VAP3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 8, __Value) +#define SET_H2CCMD_BCN_RSVDPAGE_LOC_VAP4(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 8, __Value) + + if (dvobj->vap_map & BIT(0)) + SET_H2CCMD_BCN_RSVDPAGE_LOC_ROOT(bcn_rsvdpage, 0); + if (dvobj->vap_map & BIT(1)) + SET_H2CCMD_BCN_RSVDPAGE_LOC_VAP1(bcn_rsvdpage, + 1 * (MAX_BEACON_LEN / page_size)); + if (dvobj->vap_map & BIT(2)) + SET_H2CCMD_BCN_RSVDPAGE_LOC_VAP2(bcn_rsvdpage, + 2 * (MAX_BEACON_LEN / page_size)); + if (dvobj->vap_map & BIT(3)) + SET_H2CCMD_BCN_RSVDPAGE_LOC_VAP3(bcn_rsvdpage, + 3 * (MAX_BEACON_LEN / page_size)); + if (dvobj->vap_map & BIT(4)) + SET_H2CCMD_BCN_RSVDPAGE_LOC_VAP4(bcn_rsvdpage, + 4 * (MAX_BEACON_LEN / page_size)); + #endif + if (1) { + RTW_INFO("[BCN_LOC] vap_map : 0x%02x\n", dvobj->vap_map); + RTW_INFO("[BCN_LOC] page_size :%d, @bcn_page_num :%d\n" + , page_size, (MAX_BEACON_LEN / page_size)); + RTW_INFO("[BCN_LOC] root ap : 0x%02x\n", *bcn_rsvdpage); + RTW_INFO("[BCN_LOC] vap_1 : 0x%02x\n", *(bcn_rsvdpage + 1)); + RTW_INFO("[BCN_LOC] vap_2 : 0x%02x\n", *(bcn_rsvdpage + 2)); + RTW_INFO("[BCN_LOC] vap_3 : 0x%02x\n", *(bcn_rsvdpage + 3)); + RTW_INFO("[BCN_LOC] vap_4 : 0x%02x\n", *(bcn_rsvdpage + 4)); + } + ret = rtw_hal_fill_h2c_cmd(adapter, H2C_BCN_RSVDPAGE, + H2C_BCN_RSVDPAGE_LEN, bcn_rsvdpage); +} + +void rtw_ap_multi_bcn_cfg(_adapter *adapter) +{ + u8 dft_bcn_space = DEFAULT_BCN_INTERVAL; + u8 sub_bcn_space = (DEFAULT_BCN_INTERVAL / CONFIG_LIMITED_AP_NUM); + + /*enable to rx data frame*/ + rtw_write16(adapter, REG_RXFLTMAP2, 0xFFFF); + + /*Disable Port0's beacon function*/ + rtw_write8(adapter, REG_BCN_CTRL, rtw_read8(adapter, REG_BCN_CTRL) & ~BIT_EN_BCN_FUNCTION); + /*Reset Port0's TSF*/ + rtw_write8(adapter, REG_DUAL_TSF_RST, BIT_TSFTR_RST); + + rtw_ap_set_mbid_num(adapter, CONFIG_LIMITED_AP_NUM); + + /*BCN space & BCN sub-space 0x554[15:0] = 0x64,0x5BC[23:16] = 0x21*/ + rtw_halmac_set_bcn_interval(adapter_to_dvobj(adapter), HW_PORT0, dft_bcn_space); + rtw_write8(adapter, REG_MBSSID_BCN_SPACE3 + 2, sub_bcn_space); + + #if 0 /*setting in hw_var_set_opmode_mbid - ResumeTxBeacon*/ + /*BCN hold time 0x540[19:8] = 0x80*/ + rtw_write8(adapter, REG_TBTT_PROHIBIT + 1, TBTT_PROHIBIT_HOLD_TIME & 0xFF); + rtw_write8(adapter, REG_TBTT_PROHIBIT + 2, + (rtw_read8(adapter, REG_TBTT_PROHIBIT + 2) & 0xF0) | (TBTT_PROHIBIT_HOLD_TIME >> 8)); + #endif + + /*ATIM window -0x55A = 0x32, reg 0x570 = 0x32, reg 0x5A0 = 0x32 */ + rtw_write8(adapter, REG_ATIMWND, 0x32); + rtw_write8(adapter, REG_ATIMWND1_V1, 0x32); + rtw_write8(adapter, REG_ATIMWND2, 0x32); + rtw_write8(adapter, REG_ATIMWND3, 0x32); + /* + rtw_write8(adapter, REG_ATIMWND4, 0x32); + rtw_write8(adapter, REG_ATIMWND5, 0x32); + rtw_write8(adapter, REG_ATIMWND6, 0x32); + rtw_write8(adapter, REG_ATIMWND7, 0x32);*/ + + /*no limit setting - 0x5A7 = 0xFF - Packet in Hi Queue Tx immediately*/ + rtw_write8(adapter, REG_HIQ_NO_LMT_EN, 0xFF); + + /*Mask all beacon*/ + rtw_write8(adapter, REG_MBSSID_CTRL, 0); + + /*BCN invalid bit setting 0x454[6] = 1*/ + /*rtw_write8(adapter, REG_CCK_CHECK, rtw_read8(adapter, REG_CCK_CHECK) | BIT_EN_BCN_PKT_REL);*/ + + /*Enable Port0's beacon function*/ + rtw_write8(adapter, REG_BCN_CTRL, + rtw_read8(adapter, REG_BCN_CTRL) | BIT_DIS_RX_BSSID_FIT | BIT_P0_EN_TXBCN_RPT | BIT_DIS_TSF_UDT | BIT_EN_BCN_FUNCTION); + + /* Enable HW seq for BCN + * 0x4FC[0]: EN_HWSEQ / 0x4FC[1]: EN_HWSEQEXT */ + #ifdef CONFIG_RTL8822B + if (IS_HARDWARE_TYPE_8822B(adapter)) + rtw_write8(adapter, REG_DUMMY_PAGE4_V1_8822B, 0x01); + #endif + + #ifdef CONFIG_RTL8822C + if (IS_HARDWARE_TYPE_8822C(adapter)) + rtw_write8(adapter, REG_DUMMY_PAGE4_V1_8822C, 0x01); + #endif +} +static void _rtw_mbid_bcn_cfg(_adapter *adapter, bool mbcnq_en, u8 mbcnq_id) +{ + if (mbcnq_id >= CONFIG_LIMITED_AP_NUM) { + RTW_ERR(FUNC_ADPT_FMT"- mbid bcnq_id(%d) invalid\n", FUNC_ADPT_ARG(adapter), mbcnq_id); + rtw_warn_on(1); + } + + if (mbcnq_en) { + rtw_write8(adapter, REG_MBSSID_CTRL, + rtw_read8(adapter, REG_MBSSID_CTRL) | BIT(mbcnq_id)); + RTW_INFO(FUNC_ADPT_FMT"- mbid bcnq_id(%d) enabled\n", FUNC_ADPT_ARG(adapter), mbcnq_id); + } else { + rtw_write8(adapter, REG_MBSSID_CTRL, + rtw_read8(adapter, REG_MBSSID_CTRL) & (~BIT(mbcnq_id))); + RTW_INFO(FUNC_ADPT_FMT"- mbid bcnq_id(%d) disabled\n", FUNC_ADPT_ARG(adapter), mbcnq_id); + } +} +/*#define CONFIG_FW_TBTT_RPT*/ +void rtw_ap_mbid_bcn_en(_adapter *adapter, u8 ap_id) +{ + RTW_INFO(FUNC_ADPT_FMT"- ap_id(%d)\n", FUNC_ADPT_ARG(adapter), ap_id); + + #ifdef CONFIG_FW_TBTT_RPT + if (rtw_ap_get_nums(adapter) >= 1) { + u8 tbtt_rpt_map = adapter_to_dvobj(adapter)->vap_tbtt_rpt_map; + + rtw_hal_set_fw_ap_bcn_offload_cmd(adapter, _TRUE, + tbtt_rpt_map | BIT(ap_id));/*H2C-0xBA*/ + } + #else + if (rtw_ap_get_nums(adapter) == 1) + rtw_hal_set_fw_ap_bcn_offload_cmd(adapter, _TRUE, 0);/*H2C-0xBA*/ + #endif + + rtw_hal_set_bcn_rsvdpage_loc_cmd(adapter);/*H2C-0x09*/ + + _rtw_mbid_bcn_cfg(adapter, _TRUE, ap_id); +} +void rtw_ap_mbid_bcn_dis(_adapter *adapter, u8 ap_id) +{ + RTW_INFO(FUNC_ADPT_FMT"- ap_id(%d)\n", FUNC_ADPT_ARG(adapter), ap_id); + _rtw_mbid_bcn_cfg(adapter, _FALSE, ap_id); + + if (rtw_ap_get_nums(adapter) == 0) + rtw_hal_set_fw_ap_bcn_offload_cmd(adapter, _FALSE, 0); + #ifdef CONFIG_FW_TBTT_RPT + else if (rtw_ap_get_nums(adapter) >= 1) { + u8 tbtt_rpt_map = adapter_to_dvobj(adapter)->vap_tbtt_rpt_map; + + rtw_hal_set_fw_ap_bcn_offload_cmd(adapter, _TRUE, + tbtt_rpt_map & ~BIT(ap_id));/*H2C-0xBA*/ + } + #endif +} +#endif +#ifdef CONFIG_SWTIMER_BASED_TXBCN +void rtw_ap_multi_bcn_cfg(_adapter *adapter) +{ + #if defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822C) + rtw_write8(adapter, REG_BCN_CTRL, DIS_TSF_UDT); + #else + rtw_write8(adapter, REG_BCN_CTRL, DIS_TSF_UDT | DIS_BCNQ_SUB); + #endif + /*enable to rx data frame*/ + rtw_write16(adapter, REG_RXFLTMAP2, 0xFFFF); + + /*Beacon Control related register for first time*/ + rtw_write8(adapter, REG_BCNDMATIM, 0x02); /* 2ms */ + + /*rtw_write8(Adapter, REG_BCN_MAX_ERR, 0xFF);*/ + rtw_write8(adapter, REG_ATIMWND, 0x0c); /* 12ms */ + + #ifndef CONFIG_HW_P0_TSF_SYNC + rtw_write16(adapter, REG_TSFTR_SYN_OFFSET, 0x7fff);/* +32767 (~32ms) */ + #endif + + /*reset TSF*/ + rtw_write8(adapter, REG_DUAL_TSF_RST, BIT(0)); + + /*enable BCN0 Function for if1*/ + /*don't enable update TSF0 for if1 (due to TSF update when beacon,probe rsp are received)*/ + #if defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822C) + rtw_write8(adapter, REG_BCN_CTRL, BIT_DIS_RX_BSSID_FIT | BIT_P0_EN_TXBCN_RPT | BIT_DIS_TSF_UDT |BIT_EN_BCN_FUNCTION); + #else + rtw_write8(adapter, REG_BCN_CTRL, (DIS_TSF_UDT | EN_BCN_FUNCTION | EN_TXBCN_RPT | DIS_BCNQ_SUB)); + #endif + #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)); + + /* Enable HW seq for BCN + * 0x4FC[0]: EN_HWSEQ / 0x4FC[1]: EN_HWSEQEXT */ + #ifdef CONFIG_RTL8822B + if (IS_HARDWARE_TYPE_8822B(adapter)) + rtw_write8(adapter, REG_DUMMY_PAGE4_V1_8822B, 0x01); + #endif + + #ifdef CONFIG_RTL8822C + if (IS_HARDWARE_TYPE_8822C(adapter)) + rtw_write8(adapter, REG_DUMMY_PAGE4_V1_8822C, 0x01); + #endif +} +#endif + #ifdef CONFIG_MI_WITH_MBSSID_CAM void rtw_hal_set_macaddr_mbid(_adapter *adapter, u8 *mac_addr) { @@ -2493,7 +3311,8 @@ void rtw_hal_set_macaddr_mbid(_adapter *adapter, u8 *mac_addr) if (entry_id != INVALID_CAM_ID) { write_mbssid_cam(adapter, entry_id, mac_addr); - enable_mbssid_cam(adapter); + RTW_INFO("%s "ADPT_FMT"- mbid(%d) mac_addr ="MAC_FMT"\n", __func__, + ADPT_ARG(adapter), entry_id, MAC_ARG(mac_addr)); } } #endif @@ -2517,21 +3336,34 @@ 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) +#else +static void rtw_hal_set_macaddr_port(_adapter *adapter, u8 *val) { u8 idx = 0; u32 reg_macid = 0; + enum _hw_port hwport; if (val == NULL) return; + hwport = get_hw_port(adapter); RTW_INFO("%s "ADPT_FMT"- hw port(%d) mac_addr ="MAC_FMT"\n", __func__, - ADPT_ARG(adapter), adapter->hw_port, MAC_ARG(val)); + ADPT_ARG(adapter), hwport, MAC_ARG(val)); - switch (adapter->hw_port) { +#ifdef RTW_HALMAC + rtw_halmac_set_mac_address(adapter_to_dvobj(adapter), hwport, val); +#else /* !RTW_HALMAC */ + switch (hwport) { case HW_PORT0: default: reg_macid = REG_MACID; @@ -2552,10 +3384,13 @@ void rtw_hal_set_macaddr_port(_adapter *adapter, u8 *val) #endif/*defined(CONFIG_RTL8814A)*/ } - for (idx = 0; idx < 6; idx++) + for (idx = 0; idx < ETH_ALEN; 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) +#endif/*#ifdef CONFIG_MI_WITH_MBSSID_CAM*/ + +static void rtw_hal_get_macaddr_port(_adapter *adapter, u8 *mac_addr) { u8 idx = 0; u32 reg_macid = 0; @@ -2564,6 +3399,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: @@ -2585,19 +3423,25 @@ void rtw_hal_get_macaddr_port(_adapter *adapter, u8 *mac_addr) #endif /*defined(CONFIG_RTL8814A)*/ } - for (idx = 0; idx < 6; idx++) + for (idx = 0; idx < ETH_ALEN; 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) { + u8 hw_port = rtw_hal_get_port(adapter); + +#ifdef RTW_HALMAC + rtw_halmac_set_bssid(adapter_to_dvobj(adapter), hw_port, val); +#else /* !RTW_HALMAC */ u8 idx = 0; u32 reg_bssid = 0; - switch (adapter->hw_port) { + switch (hw_port) { case HW_PORT0: default: reg_bssid = REG_BSSID; @@ -2605,7 +3449,7 @@ void rtw_hal_set_bssid(_adapter *adapter, u8 *val) case HW_PORT1: reg_bssid = REG_BSSID1; break; -#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) +#if defined(CONFIG_RTL8814A) case HW_PORT2: reg_bssid = REG_BSSID2; break; @@ -2615,99 +3459,652 @@ void rtw_hal_set_bssid(_adapter *adapter, u8 *val) case HW_PORT4: reg_bssid = REG_BSSID4; break; -#endif/*defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B)*/ +#endif/*defined(CONFIG_RTL8814A)*/ } - for (idx = 0 ; idx < 6; idx++) + for (idx = 0 ; idx < ETH_ALEN; 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)); + RTW_INFO("%s "ADPT_FMT"- hw port -%d BSSID: "MAC_FMT"\n", + __func__, ADPT_ARG(adapter), hw_port, MAC_ARG(val)); } -void rtw_hal_get_msr(_adapter *adapter, u8 *net_type) +static void rtw_hal_set_tsf_update(_adapter *adapter, u8 en) { - switch (adapter->hw_port) { - case HW_PORT0: - /*REG_CR - BIT[17:16]-Network Type for port 1*/ - *net_type = rtw_read8(adapter, MSR) & 0x03; - break; - case HW_PORT1: - /*REG_CR - BIT[19:18]-Network Type for port 1*/ - *net_type = (rtw_read8(adapter, MSR) & 0x0C) >> 2; - break; -#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) - case HW_PORT2: - /*REG_CR_EXT- BIT[1:0]-Network Type for port 2*/ - *net_type = rtw_read8(adapter, MSR1) & 0x03; - break; - case HW_PORT3: - /*REG_CR_EXT- BIT[3:2]-Network Type for port 3*/ - *net_type = (rtw_read8(adapter, MSR1) & 0x0C) >> 2; - break; - case HW_PORT4: - /*REG_CR_EXT- BIT[5:4]-Network Type for port 4*/ - *net_type = (rtw_read8(adapter, MSR1) & 0x30) >> 4; - break; -#endif /*#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B)*/ - default: - RTW_INFO("[WARN] "ADPT_FMT"- invalid hw port -%d\n", - ADPT_ARG(adapter), adapter->hw_port); - rtw_warn_on(1); - break; - } -} + u32 addr = 0; + u8 val8; -void rtw_hal_set_msr(_adapter *adapter, u8 net_type) -{ - 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_; + rtw_hal_get_hwreg(adapter, HW_VAR_BCN_CTRL_ADDR, (u8 *)&addr); + if (addr) { + val8 = rtw_read8(adapter, addr); + if (en && (val8 & DIS_TSF_UDT)) { + rtw_write8(adapter, addr, val8 & ~DIS_TSF_UDT); + #ifdef DBG_TSF_UPDATE + RTW_INFO("port%u("ADPT_FMT") enable TSF update\n", adapter->hw_port, ADPT_ARG(adapter)); + #endif } -#endif - /*REG_CR - BIT[17:16]-Network Type for port 0*/ - val8 = rtw_read8(adapter, MSR) & 0x0C; - val8 |= net_type; - rtw_write8(adapter, MSR, val8); - break; - case HW_PORT1: - /*REG_CR - BIT[19:18]-Network Type for port 1*/ - val8 = rtw_read8(adapter, MSR) & 0x03; - val8 |= net_type << 2; - rtw_write8(adapter, MSR, val8); - break; -#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) - case HW_PORT2: - /*REG_CR_EXT- BIT[1:0]-Network Type for port 2*/ - val8 = rtw_read8(adapter, MSR1) & 0xFC; - val8 |= net_type; - rtw_write8(adapter, MSR1, val8); - break; - case HW_PORT3: - /*REG_CR_EXT- BIT[3:2]-Network Type for port 3*/ - val8 = rtw_read8(adapter, MSR1) & 0xF3; - val8 |= net_type << 2; - rtw_write8(adapter, MSR1, val8); - break; - case HW_PORT4: - /*REG_CR_EXT- BIT[5:4]-Network Type for port 4*/ - val8 = rtw_read8(adapter, MSR1) & 0xCF; - val8 |= net_type << 4; - rtw_write8(adapter, MSR1, val8); - break; -#endif /* CONFIG_RTL8814A | CONFIG_RTL8822B */ - default: - RTW_INFO("[WARN] "ADPT_FMT"- invalid hw port -%d\n", - ADPT_ARG(adapter), adapter->hw_port); + if (!en && !(val8 & DIS_TSF_UDT)) { + rtw_write8(adapter, addr, val8 | DIS_TSF_UDT); + #ifdef DBG_TSF_UPDATE + RTW_INFO("port%u("ADPT_FMT") disable TSF update\n", adapter->hw_port, ADPT_ARG(adapter)); + #endif + } + } else { + RTW_WARN("unknown port%d("ADPT_FMT") %s TSF update\n" + , adapter->hw_port, ADPT_ARG(adapter), en ? "enable" : "disable"); rtw_warn_on(1); - break; } } +static void rtw_hal_set_hw_update_tsf(PADAPTER padapter) +{ + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + +#if defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8822C) || defined(CONFIG_MI_WITH_MBSSID_CAM) + RTW_INFO("[Warn] %s "ADPT_FMT" enter func\n", __func__, ADPT_ARG(padapter)); + rtw_warn_on(1); + return; +#endif + + if (!pmlmeext->en_hw_update_tsf) + return; + + /* check RCR */ + if (!rtw_hal_rcr_check(padapter, RCR_CBSSID_BCN)) + return; + + if (pmlmeext->tsf_update_required) { + pmlmeext->tsf_update_pause_stime = 0; + rtw_hal_set_tsf_update(padapter, 1); + } + + pmlmeext->en_hw_update_tsf = 0; +} + +void rtw_iface_enable_tsf_update(_adapter *adapter) +{ + adapter->mlmeextpriv.tsf_update_pause_stime = 0; + adapter->mlmeextpriv.tsf_update_required = 1; +#ifdef CONFIG_MI_WITH_MBSSID_CAM + +#else + rtw_hal_set_tsf_update(adapter, 1); +#endif +} + +void rtw_iface_disable_tsf_update(_adapter *adapter) +{ + adapter->mlmeextpriv.tsf_update_required = 0; + adapter->mlmeextpriv.tsf_update_pause_stime = 0; + adapter->mlmeextpriv.en_hw_update_tsf = 0; +#ifdef CONFIG_MI_WITH_MBSSID_CAM + +#else + rtw_hal_set_tsf_update(adapter, 0); +#endif +} + +static void rtw_hal_tsf_update_pause(_adapter *adapter) +{ +#ifdef CONFIG_MI_WITH_MBSSID_CAM + +#else + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + _adapter *iface; + int i; + u8 val8; + + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + if (!iface) + continue; + + rtw_hal_set_tsf_update(iface, 0); + if (iface->mlmeextpriv.tsf_update_required) { + iface->mlmeextpriv.tsf_update_pause_stime = rtw_get_current_time(); + if (!iface->mlmeextpriv.tsf_update_pause_stime) + iface->mlmeextpriv.tsf_update_pause_stime++; + } + iface->mlmeextpriv.en_hw_update_tsf = 0; + } +#endif +} + +static void rtw_hal_tsf_update_restore(_adapter *adapter) +{ +#ifdef CONFIG_MI_WITH_MBSSID_CAM + +#else + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + _adapter *iface; + int i; + + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + if (!iface) + continue; + + if (iface->mlmeextpriv.tsf_update_required) { + /* enable HW TSF update when recive beacon*/ + iface->mlmeextpriv.en_hw_update_tsf = 1; + #ifdef DBG_TSF_UPDATE + RTW_INFO("port%d("ADPT_FMT") enabling TSF update...\n" + , iface->hw_port, ADPT_ARG(iface)); + #endif + } + } +#endif +} + +void rtw_hal_periodic_tsf_update_chk(_adapter *adapter) +{ +#ifdef CONFIG_MI_WITH_MBSSID_CAM + +#else + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + _adapter *iface; + struct mlme_ext_priv *mlmeext; + int i; + u32 restore_ms = 0; + + if (dvobj->periodic_tsf_update_etime) { + if (rtw_time_after(rtw_get_current_time(), dvobj->periodic_tsf_update_etime)) { + /* end for restore status */ + dvobj->periodic_tsf_update_etime = 0; + rtw_hal_rcr_set_chk_bssid(adapter, MLME_ACTION_NONE); + } + return; + } + + if (dvobj->rf_ctl.offch_state != OFFCHS_NONE) + return; + + /* + * all required ifaces can switch to restore status together + * loop all pause iface to get largest restore time required + */ + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + if (!iface) + continue; + + mlmeext = &iface->mlmeextpriv; + + if (mlmeext->tsf_update_required + && mlmeext->tsf_update_pause_stime + && rtw_get_passing_time_ms(mlmeext->tsf_update_pause_stime) + > mlmeext->mlmext_info.bcn_interval * mlmeext->tsf_update_pause_factor + ) { + if (restore_ms < mlmeext->mlmext_info.bcn_interval * mlmeext->tsf_update_restore_factor) + restore_ms = mlmeext->mlmext_info.bcn_interval * mlmeext->tsf_update_restore_factor; + } + } + + if (!restore_ms) + return; + + dvobj->periodic_tsf_update_etime = rtw_get_current_time() + rtw_ms_to_systime(restore_ms); + if (!dvobj->periodic_tsf_update_etime) + dvobj->periodic_tsf_update_etime++; + + rtw_hal_rcr_set_chk_bssid(adapter, MLME_ACTION_NONE); + + /* set timer to end restore status */ + _set_timer(&dvobj->periodic_tsf_update_end_timer, restore_ms); +#endif +} + +void rtw_hal_periodic_tsf_update_end_timer_hdl(void *ctx) +{ + struct dvobj_priv *dvobj = (struct dvobj_priv *)ctx; + + if (dev_is_surprise_removed(dvobj) || dev_is_drv_stopped(dvobj)) + return; + + rtw_periodic_tsf_update_end_cmd(dvobj_get_primary_adapter(dvobj)); +} + +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); + struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); + u32 rcr, rcr_new; + struct mi_state mstate, mstate_s; + + rtw_hal_get_hwreg(adapter, HW_VAR_RCR, (u8 *)&rcr); + rcr_new = rcr; + +#if defined(CONFIG_MI_WITH_MBSSID_CAM) && !defined(CONFIG_CLIENT_PORT_CFG) + 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; + case MLME_STA_CONNECTING: + mstate_s.lg_sta_num = 1; + mstate_s.ld_sta_num = 0; + break; + case MLME_STA_CONNECTED: + mstate_s.lg_sta_num = 0; + mstate_s.ld_sta_num = 1; + break; + case MLME_STA_DISCONNECTED: + mstate_s.lg_sta_num = 0; + mstate_s.ld_sta_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_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_SCAN_ENTER_NUM(&mstate) || hal_data->in_cta_test) + rcr_new &= ~RCR_CBSSID_BCN; + else if (MSTATE_STA_LG_NUM(&mstate) + || adapter_to_dvobj(adapter)->periodic_tsf_update_etime + ) + rcr_new |= RCR_CBSSID_BCN; + else if ((MSTATE_AP_NUM(&mstate) && adapter->registrypriv.wifi_spec) /* for 11n Logo 4.2.31/4.2.32 */ + || MSTATE_MESH_NUM(&mstate) + ) + rcr_new &= ~RCR_CBSSID_BCN; + else + rcr_new |= RCR_CBSSID_BCN; + + #ifdef CONFIG_CLIENT_PORT_CFG + if (get_clt_num(adapter) > MAX_CLIENT_PORT_NUM) + rcr_new &= ~RCR_CBSSID_BCN; + #endif +#endif /* CONFIG_MI_WITH_MBSSID_CAM */ + + if (rcr == rcr_new) + return; + + if (!hal_spec->rx_tsf_filter + && (rcr & RCR_CBSSID_BCN) && !(rcr_new & RCR_CBSSID_BCN)) + rtw_hal_tsf_update_pause(adapter); + + rtw_hal_set_hwreg(adapter, HW_VAR_RCR, (u8 *)&rcr_new); + + if (!hal_spec->rx_tsf_filter + && !(rcr & RCR_CBSSID_BCN) && (rcr_new & RCR_CBSSID_BCN) + && self_action != MLME_STA_CONNECTING) + rtw_hal_tsf_update_restore(adapter); +} + +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 hw_var_set_bcn_interval(_adapter *adapter, u16 interval) +{ +#ifdef CONFIG_SWTIMER_BASED_TXBCN + interval = rtw_hal_bcn_interval_adjust(adapter, interval); +#endif + +#ifdef RTW_HALMAC + rtw_halmac_set_bcn_interval(adapter_to_dvobj(adapter), adapter->hw_port, interval); +#else + rtw_write16(adapter, REG_MBSSID_BCN_SPACE, interval); +#endif + +#ifdef CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT + { + struct mlme_ext_priv *pmlmeext = &adapter->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__, interval, interval >> 1); + rtw_write8(adapter, REG_DRVERLYINT, interval >> 1); + } + } +#endif +} + +#if CONFIG_TX_AC_LIFETIME +const char *const _tx_aclt_conf_str[] = { + "DEFAULT", + "AP_M2U", + "MESH", + "INVALID", +}; + +void dump_tx_aclt_force_val(void *sel, struct dvobj_priv *dvobj) +{ +#define TX_ACLT_FORCE_MSG_LEN 64 + struct hal_spec_t *hal_spec = GET_HAL_SPEC(dvobj_get_primary_adapter(dvobj)); + struct tx_aclt_conf_t *conf = &dvobj->tx_aclt_force_val; + char buf[TX_ACLT_FORCE_MSG_LEN]; + int cnt = 0; + + RTW_PRINT_SEL(sel, "unit:%uus, maximum:%uus\n" + , hal_spec->tx_aclt_unit_factor * 32 + , 0xFFFF * hal_spec->tx_aclt_unit_factor * 32); + + RTW_PRINT_SEL(sel, "%-5s %-12s %-12s\n", "en", "vo_vi(us)", "be_bk(us)"); + RTW_PRINT_SEL(sel, " 0x%02x %12u %12u\n" + , conf->en + , conf->vo_vi * hal_spec->tx_aclt_unit_factor * 32 + , conf->be_bk * hal_spec->tx_aclt_unit_factor * 32 + ); + + cnt += snprintf(buf + cnt, TX_ACLT_FORCE_MSG_LEN - cnt - 1, "%5s", conf->en == 0xFF ? "AUTO" : "FORCE"); + if (cnt >= TX_ACLT_FORCE_MSG_LEN - 1) + goto exit; + + if (conf->vo_vi) + cnt += snprintf(buf + cnt, TX_ACLT_FORCE_MSG_LEN - cnt - 1, " FORCE:0x%04x", conf->vo_vi); + else + cnt += snprintf(buf + cnt, TX_ACLT_FORCE_MSG_LEN - cnt - 1, " AUTO"); + if (cnt >= TX_ACLT_FORCE_MSG_LEN - 1) + goto exit; + + + if (conf->be_bk) + cnt += snprintf(buf + cnt, TX_ACLT_FORCE_MSG_LEN - cnt - 1, " FORCE:0x%04x", conf->be_bk); + else + cnt += snprintf(buf + cnt, TX_ACLT_FORCE_MSG_LEN - cnt - 1, " AUTO"); + if (cnt >= TX_ACLT_FORCE_MSG_LEN - 1) + goto exit; + + RTW_PRINT_SEL(sel, "%s\n", buf); + +exit: + return; +} + +void rtw_hal_set_tx_aclt_force_val(_adapter *adapter, struct tx_aclt_conf_t *input, u8 arg_num) +{ + struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + struct tx_aclt_conf_t *conf = &dvobj->tx_aclt_force_val; + + if (arg_num >= 1) { + if (input->en == 0xFF) + conf->en = input->en; + else + conf->en = input->en & 0xF; + } + if (arg_num >= 2) { + conf->vo_vi = input->vo_vi / (hal_spec->tx_aclt_unit_factor * 32); + if (conf->vo_vi > 0xFFFF) + conf->vo_vi = 0xFFFF; + } + if (arg_num >= 3) { + conf->be_bk = input->be_bk / (hal_spec->tx_aclt_unit_factor * 32); + if (conf->be_bk > 0xFFFF) + conf->be_bk = 0xFFFF; + } +} + +void dump_tx_aclt_confs(void *sel, struct dvobj_priv *dvobj) +{ +#define TX_ACLT_CONF_MSG_LEN 32 + struct hal_spec_t *hal_spec = GET_HAL_SPEC(dvobj_get_primary_adapter(dvobj)); + struct tx_aclt_conf_t *conf; + char buf[TX_ACLT_CONF_MSG_LEN]; + int cnt; + int i; + + RTW_PRINT_SEL(sel, "unit:%uus, maximum:%uus\n" + , hal_spec->tx_aclt_unit_factor * 32 + , 0xFFFF * hal_spec->tx_aclt_unit_factor * 32); + + RTW_PRINT_SEL(sel, "%-7s %-1s %-3s %-9s %-9s %-10s %-10s\n" + , "name", "#", "en", "vo_vi(us)", "be_bk(us)", "vo_vi(reg)", "be_bk(reg)"); + + for (i = 0; i < TX_ACLT_CONF_NUM; i++) { + conf = &dvobj->tx_aclt_confs[i]; + cnt = 0; + + if (conf->vo_vi) + cnt += snprintf(buf + cnt, TX_ACLT_CONF_MSG_LEN - cnt - 1, " 0x%04x", conf->vo_vi); + else + cnt += snprintf(buf + cnt, TX_ACLT_CONF_MSG_LEN - cnt - 1, " N/A"); + if (cnt >= TX_ACLT_CONF_MSG_LEN - 1) + continue; + + if (conf->be_bk) + cnt += snprintf(buf + cnt, TX_ACLT_CONF_MSG_LEN - cnt - 1, " 0x%04x", conf->be_bk); + else + cnt += snprintf(buf + cnt, TX_ACLT_CONF_MSG_LEN - cnt - 1, " N/A"); + if (cnt >= TX_ACLT_CONF_MSG_LEN - 1) + continue; + + RTW_PRINT_SEL(sel, "%7s %1u 0x%x %9u %9u%s\n" + , tx_aclt_conf_str(i), i + , conf->en + , conf->vo_vi * hal_spec->tx_aclt_unit_factor * 32 + , conf->be_bk * hal_spec->tx_aclt_unit_factor * 32 + , buf + ); + } +} + +void rtw_hal_set_tx_aclt_conf(_adapter *adapter, u8 conf_idx, struct tx_aclt_conf_t *input, u8 arg_num) +{ + struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + struct tx_aclt_conf_t *conf; + + if (conf_idx >= TX_ACLT_CONF_NUM) + return; + + conf = &dvobj->tx_aclt_confs[conf_idx]; + + if (arg_num >= 1) { + if (input->en != 0xFF) + conf->en = input->en & 0xF; + } + if (arg_num >= 2) { + conf->vo_vi = input->vo_vi / (hal_spec->tx_aclt_unit_factor * 32); + if (conf->vo_vi > 0xFFFF) + conf->vo_vi = 0xFFFF; + } + if (arg_num >= 3) { + conf->be_bk = input->be_bk / (hal_spec->tx_aclt_unit_factor * 32); + if (conf->be_bk > 0xFFFF) + conf->be_bk = 0xFFFF; + } +} + +void rtw_hal_update_tx_aclt(_adapter *adapter) +{ +#ifdef CONFIG_TX_MCAST2UNI + extern int rtw_mc2u_disable; +#endif + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + struct macid_ctl_t *macid_ctl = adapter_to_macidctl(adapter); + u8 lt_en = 0, lt_en_ori; + u16 lt_vo_vi = 0xFFFF, lt_be_bk = 0xFFFF; + u32 lt, lt_ori; + struct tx_aclt_conf_t *conf; + int i; + + lt_en_ori = rtw_read8(adapter, REG_LIFETIME_EN); + lt_ori = rtw_read32(adapter, REG_PKT_LIFE_TIME); + + for (i = 0; i < TX_ACLT_CONF_NUM; i++) { + if (!(dvobj->tx_aclt_flags & BIT(i))) + continue; + + conf = &dvobj->tx_aclt_confs[i]; + + if (i == TX_ACLT_CONF_DEFAULT) { + /* first and default status, assign directly */ + lt_en = conf->en; + if (conf->vo_vi) + lt_vo_vi = conf->vo_vi; + if (conf->be_bk) + lt_be_bk = conf->be_bk; + } + #if defined(CONFIG_TX_MCAST2UNI) || defined(CONFIG_RTW_MESH) + else if (0 + #ifdef CONFIG_TX_MCAST2UNI + || (i == TX_ACLT_CONF_AP_M2U + && !rtw_mc2u_disable + && macid_ctl->op_num[H2C_MSR_ROLE_STA] /* having AP mode with STA connected */) + #endif + #ifdef CONFIG_RTW_MESH + || (i == TX_ACLT_CONF_MESH + && macid_ctl->op_num[H2C_MSR_ROLE_MESH] > 1 /* implies only 1 MESH mode supported */) + #endif + ) { + /* long term status, OR en and MIN lifetime */ + lt_en |= conf->en; + if (conf->vo_vi && lt_vo_vi > conf->vo_vi) + lt_vo_vi = conf->vo_vi; + if (conf->be_bk && lt_be_bk > conf->be_bk) + lt_be_bk = conf->be_bk; + } + #endif + } + + if (dvobj->tx_aclt_force_val.en != 0xFF) + lt_en = dvobj->tx_aclt_force_val.en; + if (dvobj->tx_aclt_force_val.vo_vi) + lt_vo_vi = dvobj->tx_aclt_force_val.vo_vi; + if (dvobj->tx_aclt_force_val.be_bk) + lt_be_bk = dvobj->tx_aclt_force_val.be_bk; + + lt_en = (lt_en_ori & 0xF0) | (lt_en & 0x0F); + lt = (lt_be_bk << 16) | lt_vo_vi; + + if (0) + RTW_INFO("lt_en:0x%x(0x%x), lt:0x%08x(0x%08x)\n", lt_en, lt_en_ori, lt, lt_ori); + + if (lt_en != lt_en_ori) + rtw_write8(adapter, REG_LIFETIME_EN, lt_en); + if (lt != lt_ori) + rtw_write32(adapter, REG_PKT_LIFE_TIME, lt); +} +#endif /* CONFIG_TX_AC_LIFETIME */ + void hw_var_port_switch(_adapter *adapter) { #ifdef CONFIG_CONCURRENT_MODE @@ -2738,6 +4135,10 @@ void hw_var_port_switch(_adapter *adapter) u8 bssid[6]; u8 macid_1[6]; u8 bssid_1[6]; +#if defined(CONFIG_RTL8192F) + u16 wlan_act_mask_ctrl = 0; + u16 en_port_mask = EN_PORT_0_FUNCTION | EN_PORT_1_FUNCTION; +#endif u8 hw_port; struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); @@ -2746,6 +4147,9 @@ void hw_var_port_switch(_adapter *adapter) msr = rtw_read8(adapter, MSR); bcn_ctrl = rtw_read8(adapter, REG_BCN_CTRL); bcn_ctrl_1 = rtw_read8(adapter, REG_BCN_CTRL_1); +#if defined(CONFIG_RTL8192F) + wlan_act_mask_ctrl = rtw_read16(adapter, REG_WLAN_ACT_MASK_CTRL_1); +#endif for (i = 0; i < 2; i++) atimwnd[i] = rtw_read8(adapter, REG_ATIMWND + i); @@ -2774,6 +4178,9 @@ void hw_var_port_switch(_adapter *adapter) "msr:0x%02x\n" "bcn_ctrl:0x%02x\n" "bcn_ctrl_1:0x%02x\n" +#if defined(CONFIG_RTL8192F) + "wlan_act_mask_ctrl:0x%02x\n" +#endif "atimwnd:0x%04x\n" "atimwnd_1:0x%04x\n" "tsftr:%llu\n" @@ -2786,6 +4193,9 @@ void hw_var_port_switch(_adapter *adapter) , msr , bcn_ctrl , bcn_ctrl_1 +#if defined(CONFIG_RTL8192F) + , wlan_act_mask_ctrl +#endif , *((u16 *)atimwnd) , *((u16 *)atimwnd_1) , *((u64 *)tsftr) @@ -2801,6 +4211,10 @@ void hw_var_port_switch(_adapter *adapter) rtw_write8(adapter, REG_BCN_CTRL, (bcn_ctrl & (~EN_BCN_FUNCTION)) | DIS_TSF_UDT); rtw_write8(adapter, REG_BCN_CTRL_1, (bcn_ctrl_1 & (~EN_BCN_FUNCTION)) | DIS_TSF_UDT); +#if defined(CONFIG_RTL8192F) + rtw_write16(adapter, REG_WLAN_ACT_MASK_CTRL_1, wlan_act_mask_ctrl & ~en_port_mask); +#endif + /* switch msr */ msr = (msr & 0xf0) | ((msr & 0x03) << 2) | ((msr & 0x0c) >> 2); rtw_write8(adapter, MSR, msr); @@ -2840,6 +4254,14 @@ void hw_var_port_switch(_adapter *adapter) rtw_write8(adapter, REG_BCN_CTRL, bcn_ctrl_1); rtw_write8(adapter, REG_BCN_CTRL_1, bcn_ctrl); +#if defined(CONFIG_RTL8192F) + /* if the setting of port0 and port1 are the same, it does not need to switch port setting*/ + if(((wlan_act_mask_ctrl & en_port_mask) != 0) && ((wlan_act_mask_ctrl & en_port_mask) + != (EN_PORT_0_FUNCTION | EN_PORT_1_FUNCTION))) + wlan_act_mask_ctrl ^= en_port_mask; + rtw_write16(adapter, REG_WLAN_ACT_MASK_CTRL_1, wlan_act_mask_ctrl); +#endif + if (adapter->iface_id == IFACE_ID0) iface = dvobj->padapters[IFACE_ID1]; else if (adapter->iface_id == IFACE_ID1) @@ -2862,6 +4284,9 @@ void hw_var_port_switch(_adapter *adapter) msr = rtw_read8(adapter, MSR); bcn_ctrl = rtw_read8(adapter, REG_BCN_CTRL); bcn_ctrl_1 = rtw_read8(adapter, REG_BCN_CTRL_1); +#if defined(CONFIG_RTL8192F) + wlan_act_mask_ctrl = rtw_read16(adapter, REG_WLAN_ACT_MASK_CTRL_1); +#endif for (i = 0; i < 2; i++) atimwnd[i] = rtw_read8(adapter, REG_ATIMWND + i); @@ -2889,6 +4314,9 @@ void hw_var_port_switch(_adapter *adapter) "msr:0x%02x\n" "bcn_ctrl:0x%02x\n" "bcn_ctrl_1:0x%02x\n" +#if defined(CONFIG_RTL8192F) + "wlan_act_mask_ctrl:0x%02x\n" +#endif "atimwnd:%u\n" "atimwnd_1:%u\n" "tsftr:%llu\n" @@ -2901,6 +4329,9 @@ void hw_var_port_switch(_adapter *adapter) , msr , bcn_ctrl , bcn_ctrl_1 +#if defined(CONFIG_RTL8192F) + , wlan_act_mask_ctrl +#endif , *((u16 *)atimwnd) , *((u16 *)atimwnd_1) , *((u64 *)tsftr) @@ -2924,6 +4355,7 @@ const char *const _h2c_msr_role_str[] = { "GO", "TDLS", "ADHOC", + "MESH", "INVALID", }; @@ -2933,15 +4365,21 @@ 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); + u8 port_id = rtw_hal_get_port(adapter); - SET_H2CCMD_DFTPID_PORT_ID(parm, adapter->hw_port); + if ((dvobj->dft.port_id == port_id) && (dvobj->dft.mac_id == mac_id)) + return ret; + + SET_H2CCMD_DFTPID_PORT_ID(parm, port_id); 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); + RTW_INFO("%s ("ADPT_FMT") port_id :%d, mad_id:%d\n", + __func__, ADPT_ARG(adapter), port_id, 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; + dvobj->dft.port_id = port_id; + dvobj->dft.mac_id = mac_id; return ret; } @@ -2950,15 +4388,11 @@ 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) { + if (is_client_associated_to_ap(adapter)) { psta = rtw_get_stainfo(&adapter->stapriv, get_bssid(pmlmepriv)); if (psta) - ret = rtw_hal_set_default_port_id_cmd(adapter, psta->mac_id); + ret = rtw_hal_set_default_port_id_cmd(adapter, psta->cmn.mac_id); } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { } else { @@ -2970,9 +4404,9 @@ 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); + struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); - if (adapter->hw_port == dvobj->default_port_id) + if (adapter->iface_id == pwrctl->fw_psmode_iface_id) return ret; rtw_hal_set_hwreg(adapter, HW_VAR_H2C_FW_JOINBSSRPT, @@ -2981,7 +4415,257 @@ s32 rtw_set_ps_rsvd_page(_adapter *adapter) return ret; } +#if 0 +_adapter * _rtw_search_dp_iface(_adapter *adapter) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + _adapter *iface; + _adapter *target_iface = NULL; + int i; + u8 sta_num = 0, tdls_num = 0, ap_num = 0, mesh_num = 0, adhoc_num = 0; + u8 p2p_go_num = 0, p2p_gc_num = 0; + _adapter *sta_ifs[8]; + _adapter *ap_ifs[8]; + _adapter *mesh_ifs[8]; + _adapter *gc_ifs[8]; + _adapter *go_ifs[8]; + + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + + if (check_fwstate(&iface->mlmepriv, WIFI_STATION_STATE) == _TRUE) { + if (check_fwstate(&iface->mlmepriv, _FW_LINKED) == _TRUE) { + sta_ifs[sta_num++] = iface; + + #ifdef CONFIG_TDLS + if (iface->tdlsinfo.link_established == _TRUE) + tdls_num++; + #endif + #ifdef CONFIG_P2P + if (MLME_IS_GC(iface)) + gc_ifs[p2p_gc_num++] = iface; + #endif + } +#ifdef CONFIG_AP_MODE + } else if (check_fwstate(&iface->mlmepriv, WIFI_AP_STATE) == _TRUE ) { + if (check_fwstate(&iface->mlmepriv, _FW_LINKED) == _TRUE) { + ap_ifs[ap_num++] = iface; + #ifdef CONFIG_P2P + if (MLME_IS_GO(iface)) + go_ifs[p2p_go_num++] = iface; + #endif + } #endif + } else if (check_fwstate(&iface->mlmepriv, WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE) == _TRUE + && check_fwstate(&iface->mlmepriv, _FW_LINKED) == _TRUE + ) { + adhoc_num++; + +#ifdef CONFIG_RTW_MESH + } else if (check_fwstate(&iface->mlmepriv, WIFI_MESH_STATE) == _TRUE + && check_fwstate(&iface->mlmepriv, _FW_LINKED) == _TRUE + ) { + mesh_ifs[mesh_num++] = iface; +#endif + } + } + + if (p2p_gc_num) { + target_iface = gc_ifs[0]; + } + else if (sta_num) { + if(sta_num == 1) { + target_iface = sta_ifs[0]; + } else if (sta_num >= 2) { + /*TODO get target_iface by timestamp*/ + target_iface = sta_ifs[0]; + } + } else if (ap_num) { + target_iface = ap_ifs[0]; + } + + RTW_INFO("[IFS_ASSOC_STATUS] - STA :%d", sta_num); + RTW_INFO("[IFS_ASSOC_STATUS] - TDLS :%d", tdls_num); + RTW_INFO("[IFS_ASSOC_STATUS] - AP:%d", ap_num); + RTW_INFO("[IFS_ASSOC_STATUS] - MESH :%d", mesh_num); + RTW_INFO("[IFS_ASSOC_STATUS] - ADHOC :%d", adhoc_num); + RTW_INFO("[IFS_ASSOC_STATUS] - P2P-GC :%d", p2p_gc_num); + RTW_INFO("[IFS_ASSOC_STATUS] - P2P-GO :%d", p2p_go_num); + + if (target_iface) + RTW_INFO("%s => target_iface ("ADPT_FMT")\n", + __func__, ADPT_ARG(target_iface)); + else + RTW_INFO("%s => target_iface NULL\n", __func__); + + return target_iface; +} + +void rtw_search_default_port(_adapter *adapter) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + _adapter *adp_iface = NULL; +#ifdef CONFIG_WOWLAN + struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); + + if (pwrpriv->wowlan_mode == _TRUE) { + adp_iface = adapter; + goto exit; + } +#endif + adp_iface = _rtw_search_dp_iface(adapter); + +exit : + if ((adp_iface != NULL) && (MLME_IS_STA(adp_iface))) + rtw_set_default_port_id(adp_iface); + else + rtw_hal_set_default_port_id_cmd(adapter, 0); + + if (1) { + _adapter *tmp_adp; + + tmp_adp = (adp_iface) ? adp_iface : adapter; + + RTW_INFO("%s ("ADPT_FMT")=> hw_port :%d, default_port(%d)\n", + __func__, ADPT_ARG(adapter), get_hw_port(tmp_adp), get_dft_portid(tmp_adp)); + } +} +#endif +#endif /*CONFIG_FW_MULTI_PORT_SUPPORT*/ + +#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; + u8 hw_port = rtw_hal_get_port(adapter); + + _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 = 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; + (&p2p_ps_para)->disable_close_rf = 0; +#ifdef CONFIG_P2P_PS_NOA_USE_MACID_SLEEP +#ifdef CONFIG_CONCURRENT_MODE + if (rtw_mi_buddy_check_fwstate(adapter, WIFI_ASOC_STATE)) +#endif /* CONFIG_CONCURRENT_MODE */ + (&p2p_ps_para)->disable_close_rf = 1; +#endif /* CONFIG_P2P_PS_NOA_USE_MACID_SLEEP */ + /* 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 - * @@ -3000,6 +4684,10 @@ s32 rtw_hal_set_FwMediaStatusRpt_cmd(_adapter *adapter, bool opmode, bool miraca u8 parm[H2C_MEDIA_STATUS_RPT_LEN] = {0}; int i; s32 ret; +#ifdef CONFIG_FW_MULTI_PORT_SUPPORT + u8 hw_port = rtw_hal_get_port(adapter); +#endif + u8 op_num_change_bmp = 0; SET_H2CCMD_MSRRPT_PARM_OPMODE(parm, opmode); SET_H2CCMD_MSRRPT_PARM_MACID_IND(parm, macid_ind); @@ -3009,33 +4697,14 @@ s32 rtw_hal_set_FwMediaStatusRpt_cmd(_adapter *adapter, bool opmode, bool miraca SET_H2CCMD_MSRRPT_PARM_MACID(parm, macid); SET_H2CCMD_MSRRPT_PARM_MACID_END(parm, macid_end); #ifdef CONFIG_FW_MULTI_PORT_SUPPORT - SET_H2CCMD_MSRRPT_PARM_PORT_NUM(parm, adapter->hw_port); + SET_H2CCMD_MSRRPT_PARM_PORT_NUM(parm, hw_port); #endif 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 - && !rtw_odm_dfs_domain_unknown(adapter) - ) { - 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; - } - } -#endif - 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); @@ -3073,7 +4742,7 @@ s32 rtw_hal_set_FwMediaStatusRpt_cmd(_adapter *adapter, bool opmode, bool miraca macid_end = macid; for (i = macid; macid <= macid_end; macid++) { - rtw_macid_ctl_set_h2c_msr(macid_ctl, macid, parm[0]); + op_num_change_bmp |= rtw_macid_ctl_set_h2c_msr(macid_ctl, macid, parm[0]); if (!opmode) { rtw_macid_ctl_set_bw(macid_ctl, macid, CHANNEL_WIDTH_20); rtw_macid_ctl_set_vht_en(macid_ctl, macid, 0); @@ -3081,6 +4750,12 @@ s32 rtw_hal_set_FwMediaStatusRpt_cmd(_adapter *adapter, bool opmode, bool miraca rtw_macid_ctl_set_rate_bmp1(macid_ctl, macid, 0); } } + +#if CONFIG_TX_AC_LIFETIME + if (op_num_change_bmp) + rtw_hal_update_tx_aclt(adapter); +#endif + if (!opmode) rtw_update_tx_rate_bmp(adapter_to_dvobj(adapter)); @@ -3127,7 +4802,9 @@ 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->version_id) || IS_8822B_SERIES(pHalData->version_id)) + if (IS_8723D_SERIES(pHalData->version_id) || IS_8192F_SERIES(pHalData->version_id) + || IS_8822B_SERIES(pHalData->version_id) || IS_8821C_SERIES(pHalData->version_id) + || IS_8822C_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. @@ -3136,12 +4813,20 @@ 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)); } void rtw_hal_set_output_gpio(_adapter *padapter, u8 index, u8 outputval) { +#if defined(CONFIG_RTL8192F) + rtw_hal_set_hwreg(padapter, HW_VAR_WOW_OUTPUT_GPIO, (u8 *)(&index)); +#else if (index <= 7) { /* config GPIO mode */ rtw_write8(padapter, REG_GPIO_PIN_CTRL + 3, @@ -3191,7 +4876,46 @@ void rtw_hal_set_output_gpio(_adapter *padapter, u8 index, u8 outputval) RTW_INFO("%s: invalid GPIO%d=%d\n", __FUNCTION__, index, outputval); } +#endif } +void rtw_hal_set_input_gpio(_adapter *padapter, u8 index) +{ +#if defined(CONFIG_RTL8192F) + rtw_hal_set_hwreg(padapter, HW_VAR_WOW_INPUT_GPIO, (u8 *)(&index)); +#else + 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 +} + #endif void rtw_hal_set_FwAoacRsvdPage_cmd(PADAPTER padapter, PRSVDPAGE_LOC rsvdpageloc) @@ -3203,16 +4927,21 @@ void rtw_hal_set_FwAoacRsvdPage_cmd(PADAPTER padapter, PRSVDPAGE_LOC rsvdpageloc #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); @@ -3252,6 +4981,26 @@ void rtw_hal_set_FwAoacRsvdPage_cmd(PADAPTER padapter, PRSVDPAGE_LOC rsvdpageloc #endif /* CONFIG_WOWLAN */ } +#ifdef DBG_FW_DEBUG_MSG_PKT +void rtw_hal_set_fw_dbg_msg_pkt_rsvd_page_cmd(PADAPTER padapter, PRSVDPAGE_LOC rsvdpageloc) +{ + struct hal_ops *pHalFunc = &padapter->hal_func; + u8 u1H2C_fw_dbg_msg_pkt_parm[H2C_FW_DBG_MSG_PKT_LEN] = {0}; + u8 ret = 0; + + + RTW_INFO("RsvdPageLoc: loc_fw_dbg_msg_pkt =%d\n", rsvdpageloc->loc_fw_dbg_msg_pkt); + + SET_H2CCMD_FW_DBG_MSG_PKT_EN(u1H2C_fw_dbg_msg_pkt_parm, 1); + SET_H2CCMD_RSVDPAGE_LOC_FW_DBG_MSG_PKT(u1H2C_fw_dbg_msg_pkt_parm, rsvdpageloc->loc_fw_dbg_msg_pkt); + ret = rtw_hal_fill_h2c_cmd(padapter, + H2C_FW_DBG_MSG_PKT, + H2C_FW_DBG_MSG_PKT_LEN, + u1H2C_fw_dbg_msg_pkt_parm); + +} +#endif /*DBG_FW_DEBUG_MSG_PKT*/ + /*#define DBG_GET_RSVD_PAGE*/ int rtw_hal_get_rsvd_page(_adapter *adapter, u32 page_offset, u32 page_num, u8 *buffer, u32 buffer_size) @@ -3262,6 +5011,14 @@ int rtw_hal_get_rsvd_page(_adapter *adapter, u32 page_offset, u8 i = 0; bool rst = _FALSE; +#ifdef DBG_LA_MODE + struct registry_priv *registry_par = &adapter->registrypriv; + + if(registry_par->la_mode_en == 1) { + RTW_INFO("%s LA debug mode can't dump rsvd pg \n", __func__); + return rst; + } +#endif rtw_hal_get_def_var(adapter, HAL_DEF_TX_PAGE_SIZE, &page_size); addr = page_offset * page_size; @@ -3280,7 +5037,7 @@ int rtw_hal_get_rsvd_page(_adapter *adapter, u32 page_offset, #else txbndy = rtw_read8(adapter, REG_TDECTRL + 1); - offset = (txbndy + page_offset) << 4; + offset = (txbndy + page_offset) * page_size / 8; count = (buffer_size / 8) + 1; rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, 0x69); @@ -3316,7 +5073,7 @@ void rtw_dump_rsvd_page(void *sel, _adapter *adapter, u8 page_offset, u8 page_nu if (page_num == 0) return; - RTW_PRINT_SEL(sel, "======= RSVG PAGE DUMP =======\n"); + 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); @@ -3326,7 +5083,7 @@ void rtw_dump_rsvd_page(void *sel, _adapter *adapter, u8 page_offset, u8 page_nu if (buffer) { rtw_hal_get_rsvd_page(adapter, page_offset, page_num, buffer, buf_size); - _RTW_DUMP_SEL(sel, 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"); @@ -3336,6 +5093,41 @@ void rtw_dump_rsvd_page(void *sel, _adapter *adapter, u8 page_offset, u8 page_nu 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; + u32 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) { @@ -3370,7 +5162,7 @@ static void rtw_hal_release_rx_dma(_adapter *adapter) rtw_write32(adapter, REG_RXPKT_NUM, (val32 & (~RW_RELEASE_EN))); RTW_INFO("%s, [0x%04x]: 0x%08x\n", - __func__, REG_RXPKT_NUM, (val32 & (~RW_RELEASE_EN))); + __func__, REG_RXPKT_NUM, (u32)(val32 & (~RW_RELEASE_EN))); } static u8 rtw_hal_pause_rx_dma(_adapter *adapter) @@ -3416,12 +5208,16 @@ 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"); +#ifdef CONFIG_RTL8822C RTW_PRINT("%s, RXPKT_NUM: 0x%04x\n", - __func__, tmp); - tmp = rtw_read16(adapter, REG_RXPKT_NUM + 2); + __func__, rtw_read16(adapter, 0x02B0)); +#else + RTW_PRINT("%s, RXPKT_NUM: 0x%02x\n", + __func__, ((tmp & 0xFF00) >> 8)); +#endif if (tmp & BIT(3)) RTW_PRINT("%s, RX DMA has req\n", __func__); @@ -3474,44 +5270,88 @@ static u8 rtw_hal_enable_cpwm2(_adapter *adapter) #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) || IS_HARDWARE_TYPE_JAGUAR3(adapter)) { + if (chk_type) { + reason = rtw_read8(adapter, REG_WOWLAN_WAKE_REASON); + RTW_INFO("%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_PRINT("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_PRINT("%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_INFO("%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_PRINT("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_PRINT("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", __func__, chk_type, res, (25 - trycnt)); return res; @@ -3560,7 +5400,7 @@ 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); @@ -3586,72 +5426,6 @@ static void rtw_hal_fw_sync_cam_id(_adapter *adapter) rtw_write8(adapter, REG_SECCFG, 0xcc); } -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->security_type); -} - -static void rtw_hal_get_aoac_rpt(_adapter *adapter) -{ - struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); - struct aoac_report *paoac_rpt = &pwrctl->wowlan_aoac_rpt; - u32 page_offset = 0, page_number = 0; - u32 page_size = 0, buf_size = 0; - u8 *buffer = NULL; - u8 i = 0, tmp = 0; - int ret = -1; - - /* read aoac report from rsvd page */ - page_offset = pwrctl->wowlan_aoac_rpt_loc; - page_number = 1; - - rtw_hal_get_def_var(adapter, HAL_DEF_TX_PAGE_SIZE, &page_size); - buf_size = page_size * page_number; - - buffer = rtw_zvmalloc(buf_size); - - if (NULL == buffer) { - 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); - goto _exit; - } - - _rtw_memset(paoac_rpt, 0, sizeof(struct aoac_report)); - _rtw_memcpy(paoac_rpt, buffer, sizeof(struct aoac_report)); - - for (i = 0 ; i < 4 ; i++) { - tmp = paoac_rpt->replay_counter_eapol_key[i]; - paoac_rpt->replay_counter_eapol_key[i] = - paoac_rpt->replay_counter_eapol_key[7 - i]; - paoac_rpt->replay_counter_eapol_key[7 - i] = tmp; - } - - /* rtw_dump_aoac_rpt(adapter); */ - -_exit: - if (buffer) - rtw_vmfree(buffer, buf_size); -} - static void rtw_hal_update_gtk_offload_info(_adapter *adapter) { struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); @@ -3662,10 +5436,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_id = 0, offset = 0, i = 0, sz = 0; - u64 replay_count = 0; + u8 gtk_id = 0, offset = 0, i = 0, sz = 0, aoac_rpt_ver = 0, has_rekey = _FALSE; + u64 replay_count = 0, tmp_iv_hdr = 0, pkt_pn = 0; - if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) + if (!MLME_IS_STA(adapter)) return; _rtw_memset(get_key, 0, sizeof(get_key)); @@ -3674,10 +5448,30 @@ static void rtw_hal_update_gtk_offload_info(_adapter *adapter) /*read gtk key index*/ gtk_id = paoac_rpt->key_index; + aoac_rpt_ver = paoac_rpt->version_info; - if (gtk_id == 5 || gtk_id == 0) { + if (aoac_rpt_ver == 0) { + /* initial verison */ + if (gtk_id == 5) + has_rekey = _FALSE; + else + has_rekey = _TRUE; + } else if (aoac_rpt_ver >= 1) { + /* Add krack patch */ + if (gtk_id == 5) + RTW_WARN("%s FW check iv fail\n", __func__); + + if (aoac_rpt_ver == 1) + RTW_WARN("%s aoac report version should be update to v2\n", __func__); + + /* Fix key id mismatch */ + if (aoac_rpt_ver == 2) + has_rekey = paoac_rpt->rekey_ok == 1 ? _TRUE : _FALSE; + } + + if (has_rekey == _FALSE) { RTW_INFO("%s no rekey event happened.\n", __func__); - } else if (gtk_id > 0 && gtk_id < 4) { + } else if (has_rekey == _TRUE) { 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_id, @@ -3716,17 +5510,21 @@ static void rtw_hal_update_gtk_offload_info(_adapter *adapter) &(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_id, KEY_ARG(psecuritypriv->dot118021XGrpKey[gtk_id].skey)); } + /* Update broadcast RX IV */ + if (psecuritypriv->dot118021XGrpPrivacy == _AES_) { + sz = sizeof(psecuritypriv->iv_seq[0]); + for (i = 0 ; i < 4 ; i++) { + _rtw_memcpy(&tmp_iv_hdr, paoac_rpt->rxgtk_iv[i], sz); + tmp_iv_hdr = le64_to_cpu(tmp_iv_hdr); + pkt_pn = CCMPH_2_PN(tmp_iv_hdr); + _rtw_memcpy(psecuritypriv->iv_seq[i], &pkt_pn, sz); + } + } + rtw_clean_dk_section(adapter); rtw_write8(adapter, REG_SECCFG, 0x0c); @@ -3737,6 +5535,83 @@ static void rtw_hal_update_gtk_offload_info(_adapter *adapter) dump_sec_cam_cache(RTW_DBGDUMP, adapter); #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; + int i = 0; + + 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->security_type); + RTW_INFO("[AOAC-RPT] wow_pattern_idx - %d\n", + paoac_rpt->wow_pattern_idx); + RTW_INFO("[AOAC-RPT] version_info - %d\n", paoac_rpt->version_info); + RTW_INFO("[AOAC-RPT] rekey_ok - %d\n", paoac_rpt->rekey_ok); + RTW_INFO_DUMP("[AOAC-RPT] RX PTK IV-", paoac_rpt->rxptk_iv, 8); + RTW_INFO_DUMP("[AOAC-RPT] RX GTK[0] IV-", paoac_rpt->rxgtk_iv[0], 8); + RTW_INFO_DUMP("[AOAC-RPT] RX GTK[1] IV-", paoac_rpt->rxgtk_iv[1], 8); + RTW_INFO_DUMP("[AOAC-RPT] RX GTK[2] IV-", paoac_rpt->rxgtk_iv[2], 8); + RTW_INFO_DUMP("[AOAC-RPT] RX GTK[3] IV-", paoac_rpt->rxgtk_iv[3], 8); +} + +static void rtw_hal_get_aoac_rpt(_adapter *adapter) +{ + struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); + struct aoac_report *paoac_rpt = &pwrctl->wowlan_aoac_rpt; + u32 page_offset = 0, page_number = 0; + u32 page_size = 0, buf_size = 0; + u8 *buffer = NULL; + u8 i = 0, tmp = 0; + int ret = -1; + + /* read aoac report from rsvd page */ + page_offset = pwrctl->wowlan_aoac_rpt_loc; + page_number = 1; + + rtw_hal_get_def_var(adapter, HAL_DEF_TX_PAGE_SIZE, &page_size); + buf_size = page_size * page_number; + + buffer = rtw_zvmalloc(buf_size); + + 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); + goto _exit; + } + + _rtw_memset(paoac_rpt, 0, sizeof(struct aoac_report)); + _rtw_memcpy(paoac_rpt, buffer, sizeof(struct aoac_report)); + + for (i = 0 ; i < 4 ; i++) { + tmp = paoac_rpt->replay_counter_eapol_key[i]; + paoac_rpt->replay_counter_eapol_key[i] = + paoac_rpt->replay_counter_eapol_key[7 - i]; + paoac_rpt->replay_counter_eapol_key[7 - i] = tmp; + } + + rtw_dump_aoac_rpt(adapter); + +_exit: + if (buffer) + rtw_vmfree(buffer, buf_size); +} static void rtw_hal_update_tx_iv(_adapter *adapter) { @@ -3783,10 +5658,18 @@ 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; + u8 sz = sizeof (psecpriv->iv_seq); + 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); +#else + _rtw_memset(psecpriv->iv_seq, 0, sz); +#endif } -#endif /*CONFIG_GTK_OL*/ static u8 rtw_hal_set_keep_alive_cmd(_adapter *adapter, u8 enable, u8 pkt_type) { @@ -3795,14 +5678,15 @@ static u8 rtw_hal_set_keep_alive_cmd(_adapter *adapter, u8 enable, u8 pkt_type) u8 u1H2CKeepAliveParm[H2C_KEEP_ALIVE_CTRL_LEN] = {0}; u8 adopt = 1, check_period = 5; u8 ret = _FAIL; + u8 hw_port = rtw_hal_get_port(adapter); 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); + SET_H2CCMD_KEEPALIVE_PARM_PORT_NUM(u1H2CKeepAliveParm, hw_port); + RTW_INFO("%s(): enable = %d, port = %d\n", __func__, enable, hw_port); #else RTW_INFO("%s(): enable = %d\n", __func__, enable); #endif @@ -3818,16 +5702,18 @@ static u8 rtw_hal_set_disconnect_decision_cmd(_adapter *adapter, u8 enable) { 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; + u8 hw_port = rtw_hal_get_port(adapter); SET_H2CCMD_DISCONDECISION_PARM_ENABLE(u1H2CDisconDecisionParm, enable); SET_H2CCMD_DISCONDECISION_PARM_ADOPT(u1H2CDisconDecisionParm, adopt); + /* SET_H2CCMD_DISCONDECISION_PARM_DISCONNECT_EN(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); + SET_H2CCMD_DISCONDECISION_PORT_NUM(u1H2CDisconDecisionParm, hw_port); + RTW_INFO("%s(): enable = %d, port = %d\n", __func__, enable, hw_port); #else RTW_INFO("%s(): enable = %d\n", __func__, enable); #endif @@ -3841,32 +5727,45 @@ 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->hal_func; + struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); u8 u1H2CWoWlanCtrlParm[H2C_WOWLAN_LEN] = {0}; - u8 discont_wake = 1, gpionum = 0, gpio_dur = 0; + u8 discont_wake = 0, gpionum = 0, gpio_dur = 0, no_wake = 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; gpionum = WAKEUP_GPIO_IDX; sdio_wakeup_enable = 0; #endif /* CONFIG_GPIO_WAKEUP */ - - if (!ppwrpriv->wowlan_pno_enable) + + if(registry_par->suspend_type == FW_IPS_DISABLE_BBRF && + !check_fwstate(pmlmepriv, _FW_LINKED)) + no_wake = 1; + + if (!ppwrpriv->wowlan_pno_enable && + registry_par->wakeup_event & BIT(0) && !no_wake) 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_) && !no_wake) + hw_unicast = 1; + + if (registry_par->wakeup_event & BIT(2) && !no_wake) + discont_wake = enable; RTW_INFO("%s(): enable=%d change_unit=%d\n", __func__, enable, change_unit); @@ -3886,15 +5785,16 @@ static u8 rtw_hal_set_wowlan_ctrl_cmd(_adapter *adapter, u8 enable, u8 change_un #endif SET_H2CCMD_WOWLAN_FUNC_ENABLE(u1H2CWoWlanCtrlParm, enable); - SET_H2CCMD_WOWLAN_PATTERN_MATCH_ENABLE(u1H2CWoWlanCtrlParm, enable); + if(!no_wake) + SET_H2CCMD_WOWLAN_PATTERN_MATCH_ENABLE(u1H2CWoWlanCtrlParm, enable); SET_H2CCMD_WOWLAN_MAGIC_PKT_ENABLE(u1H2CWoWlanCtrlParm, magic_pkt); SET_H2CCMD_WOWLAN_UNICAST_PKT_ENABLE(u1H2CWoWlanCtrlParm, hw_unicast); SET_H2CCMD_WOWLAN_ALL_PKT_DROP(u1H2CWoWlanCtrlParm, 0); SET_H2CCMD_WOWLAN_GPIO_ACTIVE(u1H2CWoWlanCtrlParm, gpio_high_active); #ifdef CONFIG_GTK_OL - /* GTK rekey only for AES, if GTK rekey is TKIP, then wake up*/ - if (psecpriv->binstallKCK_KEK == _TRUE) + 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); @@ -3911,6 +5811,34 @@ 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_DISABLE_UPHY(u1H2CWoWlanCtrlParm, dis_uphy); + SET_H2CCMD_WOWLAN_UNIT_FOR_UPHY_DISABLE(u1H2CWoWlanCtrlParm, dis_uphy_unit); + SET_H2CCMD_WOWLAN_TIME_FOR_UPHY_DISABLE(u1H2CWoWlanCtrlParm, dis_uphy_time); + if (ppwrpriv->hst2dev_high_active == 1) + SET_H2CCMD_WOWLAN_RISE_HST2DEV(u1H2CWoWlanCtrlParm, 1); +#ifdef CONFIG_RTW_ONE_PIN_GPIO + SET_H2CCMD_WOWLAN_GPIO_INPUT_EN(u1H2CWoWlanCtrlParm, 1); + SET_H2CCMD_WOWLAN_DEV2HST_EN(u1H2CWoWlanCtrlParm, 1); + SET_H2CCMD_WOWLAN_HST2DEV_EN(u1H2CWoWlanCtrlParm, 0); +#else + SET_H2CCMD_WOWLAN_HST2DEV_EN(u1H2CWoWlanCtrlParm, 1); +#endif /* CONFIG_RTW_ONE_PIN_GPIO */ +#endif /* CONFIG_DIS_UPHY */ + + ret = rtw_hal_fill_h2c_cmd(adapter, H2C_WOWLAN, H2C_WOWLAN_LEN, @@ -3925,82 +5853,105 @@ static u8 rtw_hal_set_remote_wake_ctrl_cmd(_adapter *adapter, u8 enable) struct pwrctrl_priv *ppwrpriv = adapter_to_pwrctl(adapter); struct registry_priv *pregistrypriv = &adapter->registrypriv; u8 u1H2CRemoteWakeCtrlParm[H2C_REMOTE_WAKE_CTRL_LEN] = {0}; - u8 ret = _FAIL, count = 0; + u8 ret = _FAIL, count = 0, no_wake = 0; + struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); RTW_INFO("%s(): enable=%d\n", __func__, enable); - if (!ppwrpriv->wowlan_pno_enable) { + if(pregistrypriv->suspend_type == FW_IPS_DISABLE_BBRF && + !check_fwstate(pmlmepriv, _FW_LINKED)) + no_wake = 1; + if(no_wake) { SET_H2CCMD_REMOTE_WAKECTRL_ENABLE( u1H2CRemoteWakeCtrlParm, enable); - SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_OFFLOAD_EN( - u1H2CRemoteWakeCtrlParm, 1); -#ifdef CONFIG_GTK_OL - if (psecuritypriv->binstallKCK_KEK == _TRUE) { - 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( + } else { + if (!ppwrpriv->wowlan_pno_enable) { + SET_H2CCMD_REMOTE_WAKECTRL_ENABLE( u1H2CRemoteWakeCtrlParm, enable); + SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_OFFLOAD_EN( + u1H2CRemoteWakeCtrlParm, 1); + #ifdef CONFIG_GTK_OL + 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 */ + + #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); + } + /* * 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); - } - - if ((psecuritypriv->dot11PrivacyAlgrthm == _AES_) || - (psecuritypriv->dot11PrivacyAlgrthm == _TKIP_) || - (psecuritypriv->dot11PrivacyAlgrthm == _NO_PRIVACY_)) { - SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_ACTION( - u1H2CRemoteWakeCtrlParm, 0); - } else { - SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_ACTION( - u1H2CRemoteWakeCtrlParm, 1); - } - - if (psecuritypriv->dot11PrivacyAlgrthm == _TKIP_) { - SET_H2CCMD_REMOTE_WAKE_CTRL_TKIP_OFFLOAD_EN( + #endif /*CONFIG_IPV6*/ + + #ifdef CONFIG_RTL8192F + if (IS_HARDWARE_TYPE_8192F(adapter)){ + SET_H2CCMD_REMOTE_WAKE_CTRL_FW_UNICAST_EN( u1H2CRemoteWakeCtrlParm, enable); - - if (IS_HARDWARE_TYPE_8188E(adapter) || - IS_HARDWARE_TYPE_8812(adapter)) { - SET_H2CCMD_REMOTE_WAKE_CTRL_TKIP_OFFLOAD_EN( + } + #endif /* CONFIG_RTL8192F */ + + if ((psecuritypriv->dot11PrivacyAlgrthm == _AES_) || + (psecuritypriv->dot11PrivacyAlgrthm == _TKIP_) || + (psecuritypriv->dot11PrivacyAlgrthm == _NO_PRIVACY_)) { + SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_ACTION( u1H2CRemoteWakeCtrlParm, 0); + } else { SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_ACTION( 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); } - - SET_H2CCMD_REMOTE_WAKE_CTRL_FW_PARSING_UNTIL_WAKEUP( - u1H2CRemoteWakeCtrlParm, 1); + #ifdef CONFIG_PNO_SUPPORT + else { + SET_H2CCMD_REMOTE_WAKECTRL_ENABLE( + u1H2CRemoteWakeCtrlParm, enable); + SET_H2CCMD_REMOTE_WAKE_CTRL_NLO_OFFLOAD_EN( + u1H2CRemoteWakeCtrlParm, enable); + } + #endif + + #ifdef CONFIG_P2P_WOWLAN + if (_TRUE == ppwrpriv->wowlan_p2p_mode) { + RTW_INFO("P2P OFFLOAD ENABLE\n"); + SET_H2CCMD_REMOTE_WAKE_CTRL_P2P_OFFLAD_EN(u1H2CRemoteWakeCtrlParm, 1); + } else { + RTW_INFO("P2P OFFLOAD DISABLE\n"); + SET_H2CCMD_REMOTE_WAKE_CTRL_P2P_OFFLAD_EN(u1H2CRemoteWakeCtrlParm, 0); + } + #endif /* CONFIG_P2P_WOWLAN */ } -#ifdef CONFIG_PNO_SUPPORT - else { - SET_H2CCMD_REMOTE_WAKECTRL_ENABLE( - u1H2CRemoteWakeCtrlParm, enable); - SET_H2CCMD_REMOTE_WAKE_CTRL_NLO_OFFLOAD_EN( - u1H2CRemoteWakeCtrlParm, enable); - } -#endif - -#ifdef CONFIG_P2P_WOWLAN - if (_TRUE == ppwrpriv->wowlan_p2p_mode) { - RTW_INFO("P2P OFFLOAD ENABLE\n"); - SET_H2CCMD_REMOTE_WAKE_CTRL_P2P_OFFLAD_EN(u1H2CRemoteWakeCtrlParm, 1); - } else { - RTW_INFO("P2P OFFLOAD DISABLE\n"); - SET_H2CCMD_REMOTE_WAKE_CTRL_P2P_OFFLAD_EN(u1H2CRemoteWakeCtrlParm, 0); - } -#endif /* CONFIG_P2P_WOWLAN */ ret = rtw_hal_fill_h2c_cmd(adapter, @@ -4068,22 +6019,30 @@ 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 pkt_type = 0, no_wake = 0; u8 ret = _SUCCESS; + + if(pregistry->suspend_type == FW_IPS_DISABLE_BBRF && + !check_fwstate(pmlmepriv, _FW_LINKED)) + no_wake = 1; RTW_PRINT("+%s()+: enable=%d\n", __func__, enable); rtw_hal_set_wowlan_ctrl_cmd(padapter, enable, _FALSE); if (enable) { - rtw_hal_set_global_info_cmd(padapter, + if(!no_wake) + rtw_hal_set_global_info_cmd(padapter, psecpriv->dot118021XGrpPrivacy, psecpriv->dot11PrivacyAlgrthm); if (!(ppwrpriv->wowlan_pno_enable)) { - rtw_hal_set_disconnect_decision_cmd(padapter, enable); + if (pregistry->wakeup_event & BIT(2) && !no_wake) + rtw_hal_set_disconnect_decision_cmd(padapter, + enable); #ifdef CONFIG_ARP_KEEP_ALIVE if ((psecpriv->dot11PrivacyAlgrthm == _WEP40_) || (psecpriv->dot11PrivacyAlgrthm == _WEP104_)) @@ -4093,7 +6052,8 @@ void rtw_hal_set_fw_wow_related_cmd(_adapter *padapter, u8 enable) #else pkt_type = 0; #endif /* CONFIG_ARP_KEEP_ALIVE */ - rtw_hal_set_keep_alive_cmd(padapter, enable, pkt_type); + if(!no_wake) + rtw_hal_set_keep_alive_cmd(padapter, enable, pkt_type); } rtw_hal_set_remote_wake_ctrl_cmd(padapter, enable); #ifdef CONFIG_PNO_SUPPORT @@ -4308,11 +6268,14 @@ static void rtw_hal_ap_wow_enable(_adapter *padapter) 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); - if (IS_8188F(pHalData->version_id) == FALSE) + if (IS_8188F(pHalData->version_id) == FALSE + && IS_8188GTV(pHalData->version_id) == FALSE) rtw_write8(padapter, REG_RSV_CTRL, 0x60); -#endif /*CONFIG_USB_HCI*/ +#endif } static void rtw_hal_ap_wow_disable(_adapter *padapter) @@ -4353,11 +6316,22 @@ static void rtw_hal_ap_wow_disable(_adapter *padapter) rtw_hal_fw_dl(padapter, _FALSE); #ifdef CONFIG_GPIO_WAKEUP +#ifdef CONFIG_RTW_ONE_PIN_GPIO + rtw_hal_set_input_gpio(padapter, WAKEUP_GPIO_IDX); +#else + #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_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 /* CONFIG_RTW_ONE_PIN_GPIO */ #endif media_status_rpt = RT_MEDIA_CONNECT; @@ -4681,17 +6655,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; */ @@ -4714,9 +6677,6 @@ static void rtw_hal_construct_P2PProbeRsp(_adapter *padapter, u8 *pframe, u32 *p #ifdef CONFIG_WFD u32 wfdielen = 0; #endif -#ifdef CONFIG_INTEL_WIDI - u8 zero_array_check[L2SDTA_SERVICE_VE_LEN] = { 0x00 }; -#endif /* CONFIG_INTEL_WIDI */ /* for debug */ u8 *dbgbuf = pframe; @@ -4811,39 +6771,6 @@ static void rtw_hal_construct_P2PProbeRsp(_adapter *padapter, u8 *pframe, u32 *p /* Value: */ wpsie[wpsielen++] = WPS_VERSION_1; /* Version 1.0 */ -#ifdef CONFIG_INTEL_WIDI - /* Commented by Kurt */ - /* Appended WiDi info. only if we did issued_probereq_widi(), and then we saved ven. ext. in pmlmepriv->sa_ext. */ - if (_rtw_memcmp(pmlmepriv->sa_ext, zero_array_check, L2SDTA_SERVICE_VE_LEN) == _FALSE - || pmlmepriv->num_p2p_sdt != 0) { - /* Sec dev type */ - *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_SEC_DEV_TYPE_LIST); - wpsielen += 2; - - /* Length: */ - *(u16 *)(wpsie + wpsielen) = cpu_to_be16(0x0008); - wpsielen += 2; - - /* Value: */ - /* Category ID */ - *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_PDT_CID_DISPLAYS); - wpsielen += 2; - - /* OUI */ - *(u32 *)(wpsie + wpsielen) = cpu_to_be32(INTEL_DEV_TYPE_OUI); - wpsielen += 4; - - *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_PDT_SCID_WIDI_CONSUMER_SINK); - wpsielen += 2; - - if (_rtw_memcmp(pmlmepriv->sa_ext, zero_array_check, L2SDTA_SERVICE_VE_LEN) == _FALSE) { - /* Vendor Extension */ - _rtw_memcpy(wpsie + wpsielen, pmlmepriv->sa_ext, L2SDTA_SERVICE_VE_LEN); - wpsielen += L2SDTA_SERVICE_VE_LEN; - } - } -#endif /* CONFIG_INTEL_WIDI */ - /* WiFi Simple Config State */ /* Type: */ *(u16 *)(wpsie + wpsielen) = cpu_to_be16(WPS_ATTR_SIMPLE_CONF_STATE); @@ -5015,6 +6942,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); @@ -5259,8 +7187,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)) @@ -5306,37 +7234,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: */ @@ -5532,6 +7445,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. */ @@ -5586,8 +7501,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)) @@ -5633,36 +7548,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 @@ -5871,7 +7772,7 @@ u8 rtw_hal_set_p2p_wowlan_offload_cmd(_adapter *adapter) } #endif /* CONFIG_P2P_WOWLAN */ -static void rtw_hal_construct_beacon(_adapter *padapter, +void rtw_hal_construct_beacon(_adapter *padapter, u8 *pframe, u32 *pLength) { struct rtw_ieee80211_hdr *pwlanhdr; @@ -5911,6 +7812,7 @@ static void rtw_hal_construct_beacon(_adapter *padapter, pframe += 2; pktlen += 2; +#if 0 /* capability info: 2 bytes */ _rtw_memcpy(pframe, (unsigned char *)(rtw_get_capability_from_ie(cur_network->IEs)), 2); @@ -5953,13 +7855,15 @@ static void rtw_hal_construct_beacon(_adapter *padapter, if (rate_len > 8) pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_, (rate_len - 8), (cur_network->SupportedRates + 8), &pktlen); - /* todo:HT for adhoc */ _ConstructBeacon: +#endif - if ((pktlen + TXDESC_SIZE) > 512) { - RTW_INFO("beacon frame too large\n"); + if ((pktlen + TXDESC_SIZE) > MAX_BEACON_LEN) { + RTW_ERR("beacon frame too large ,len(%d,%d)\n", + (pktlen + TXDESC_SIZE), MAX_BEACON_LEN); + rtw_warn_on(1); return; } @@ -6000,11 +7904,48 @@ static void rtw_hal_construct_PSPoll(_adapter *padapter, *pLength = 16; } + +#ifdef DBG_FW_DEBUG_MSG_PKT +void rtw_hal_construct_fw_dbg_msg_pkt( + PADAPTER padapter, + u8 *pframe, + u32 *plength) +{ + struct rtw_ieee80211_hdr *pwlanhdr; + u16 *fctrl; + u32 pktlen; + 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); + u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; + + + /* RTW_INFO("%s:%d\n", __FUNCTION__, bForcePowerSave); */ + + pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; + + fctrl = &pwlanhdr->frame_ctl; + *(fctrl) = 0; + + _rtw_memcpy(pwlanhdr->addr1, bc_addr, 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_frame_sub_type(pframe, WIFI_DATA); + + pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); + + *plength = pktlen; +} +#endif /*DBG_FW_DEBUG_MSG_PKT*/ + void rtw_hal_construct_NullFunctionData( PADAPTER padapter, u8 *pframe, u32 *pLength, - u8 *StaAddr, u8 bQoS, u8 AC, u8 bEosp, @@ -6017,7 +7958,8 @@ void rtw_hal_construct_NullFunctionData( struct wlan_network *cur_network = &pmlmepriv->cur_network; struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); - + u8 *sta_addr = NULL; + u8 bssid[ETH_ALEN] = {0}; /* RTW_INFO("%s:%d\n", __FUNCTION__, bForcePowerSave); */ @@ -6028,28 +7970,35 @@ void rtw_hal_construct_NullFunctionData( if (bForcePowerSave) SetPwrMgt(fctrl); + sta_addr = get_my_bssid(&pmlmeinfo->network); + if (NULL == sta_addr) { + _rtw_memcpy(bssid, adapter_mac_addr(padapter), ETH_ALEN); + sta_addr = bssid; + } + switch (cur_network->network.InfrastructureMode) { case Ndis802_11Infrastructure: 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, StaAddr, ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr3, sta_addr, ETH_ALEN); break; case Ndis802_11APMode: SetFrDs(fctrl); - _rtw_memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr1, sta_addr, ETH_ALEN); _rtw_memcpy(pwlanhdr->addr2, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); break; case Ndis802_11IBSS: default: - _rtw_memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr1, sta_addr, ETH_ALEN); _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); break; } SetSeqNum(pwlanhdr, 0); + set_duration(pwlanhdr, 0); if (bQoS == _TRUE) { struct rtw_ieee80211_hdr_3addr_qos *pwlanqoshdr; @@ -6071,11 +8020,11 @@ void rtw_hal_construct_NullFunctionData( } void rtw_hal_construct_ProbeRsp(_adapter *padapter, u8 *pframe, u32 *pLength, - u8 *StaAddr, BOOLEAN bHideSSID) + BOOLEAN bHideSSID) { struct rtw_ieee80211_hdr *pwlanhdr; u16 *fctrl; - u8 *mac, *bssid; + u8 *mac, *bssid, *sta_addr; u32 pktlen; struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); @@ -6087,10 +8036,11 @@ void rtw_hal_construct_ProbeRsp(_adapter *padapter, u8 *pframe, u32 *pLength, mac = adapter_mac_addr(padapter); bssid = cur_network->MacAddress; + sta_addr = get_my_bssid(&pmlmeinfo->network); fctrl = &(pwlanhdr->frame_ctl); *(fctrl) = 0; - _rtw_memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr1, sta_addr, ETH_ALEN); _rtw_memcpy(pwlanhdr->addr2, mac, ETH_ALEN); _rtw_memcpy(pwlanhdr->addr3, bssid, ETH_ALEN); @@ -6253,23 +8203,23 @@ static void rtw_hal_construct_ARPRsp( /* 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); + SET_ARP_HTYPE(pARPRspPkt, 1); + SET_ARP_PTYPE(pARPRspPkt, ETH_P_IP); /* IP protocol */ + SET_ARP_HLEN(pARPRspPkt, ETH_ALEN); + SET_ARP_PLEN(pARPRspPkt, RTW_IP_ADDR_LEN); + SET_ARP_OPER(pARPRspPkt, 2); /* ARP response */ + SET_ARP_SENDER_MAC_ADDR(pARPRspPkt, adapter_mac_addr(padapter)); + SET_ARP_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); + SET_ARP_TARGET_MAC_ADDR(pARPRspPkt, pmlmepriv->gw_mac_addr); + SET_ARP_TARGET_IP_ADDR(pARPRspPkt, pmlmepriv->gw_ip); } else #endif { - SET_ARP_PKT_TARGET_MAC_ADDR(pARPRspPkt, + SET_ARP_TARGET_MAC_ADDR(pARPRspPkt, get_my_bssid(&(pmlmeinfo->network))); - SET_ARP_PKT_TARGET_IP_ADDR(pARPRspPkt, + SET_ARP_TARGET_IP_ADDR(pARPRspPkt, pIPAddress); RTW_INFO("%s Target Mac Addr:" MAC_FMT "\n", __FUNCTION__, MAC_ARG(get_my_bssid(&(pmlmeinfo->network)))); @@ -6288,6 +8238,186 @@ static void rtw_hal_construct_ARPRsp( } } +#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; +#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. */ + /* ------------------------------------------------------------------------- */ + na_msg_offset = *pLength; + p_na_msg = (u8 *)(pframe + na_msg_offset); + payload = p_na_msg; /* Get Payload pointer */ + + /* LLC header */ + val8 = sizeof(ns_hdr); + _rtw_memcpy(p_na_msg, ns_hdr, val8); + *pLength += val8; + p_na_msg += val8; + + /* 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; + + /* 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; + + /* 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, u32 *pLength, pno_ssid_t *ssid) @@ -6576,6 +8706,78 @@ static void rtw_hal_construct_GTKRsp( } #endif /* CONFIG_GTK_OL */ +#define PN_2_CCMPH(ch,key_id) ((ch) & 0x000000000000ffff) \ + | (((ch) & 0x0000ffffffff0000) << 16) \ + | (((key_id) << 30)) \ + | BIT(29) +static void rtw_hal_construct_remote_control_info(_adapter *adapter, + u8 *pframe, u32 *pLength) +{ + struct mlme_priv *pmlmepriv = &adapter->mlmepriv; + struct sta_priv *pstapriv = &adapter->stapriv; + struct security_priv *psecuritypriv = &adapter->securitypriv; + struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; + struct sta_info *psta; + struct stainfo_rxcache *prxcache; + u8 cur_dot11rxiv[8], id = 0, tid_id = 0, i = 0; + size_t sz = 0, total = 0; + u64 ccmp_hdr = 0, tmp_key = 0; + + psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); + + if (psta == NULL) { + rtw_warn_on(1); + return; + } + + prxcache = &psta->sta_recvpriv.rxcache; + sz = sizeof(cur_dot11rxiv); + + /* 3 SEC IV * 1 page */ + rtw_get_sec_iv(adapter, cur_dot11rxiv, + get_my_bssid(&pmlmeinfo->network)); + + _rtw_memcpy(pframe, cur_dot11rxiv, sz); + *pLength += sz; + pframe += sz; + + _rtw_memset(&cur_dot11rxiv, 0, sz); + + if (psecuritypriv->ndisauthtype == Ndis802_11AuthModeWPA2PSK) { + id = psecuritypriv->dot118021XGrpKeyid; + tid_id = prxcache->last_tid; + REMOTE_INFO_CTRL_SET_VALD_EN(cur_dot11rxiv, 0xdd); + REMOTE_INFO_CTRL_SET_PTK_EN(cur_dot11rxiv, 1); + REMOTE_INFO_CTRL_SET_GTK_EN(cur_dot11rxiv, 1); + REMOTE_INFO_CTRL_SET_GTK_IDX(cur_dot11rxiv, id); + _rtw_memcpy(pframe, cur_dot11rxiv, sz); + *pLength += sz; + pframe += sz; + + _rtw_memcpy(pframe, prxcache->iv[tid_id], sz); + *pLength += sz; + pframe += sz; + + total = sizeof(psecuritypriv->iv_seq); + total /= sizeof(psecuritypriv->iv_seq[0]); + + for (i = 0 ; i < total ; i ++) { + ccmp_hdr = + le64_to_cpu(*(u64*)psecuritypriv->iv_seq[i]); + _rtw_memset(&cur_dot11rxiv, 0, sz); + if (ccmp_hdr != 0) { + tmp_key = i; + ccmp_hdr = PN_2_CCMPH(ccmp_hdr, tmp_key); + *(u64*)cur_dot11rxiv = cpu_to_le64(ccmp_hdr); + _rtw_memcpy(pframe, cur_dot11rxiv, sz); + } + *pLength += sz; + pframe += sz; + } + } +} + void rtw_hal_set_wow_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) @@ -6586,10 +8788,8 @@ 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, rc_len = 0; u8 CurtPktPageNum = 0; - u8 currentip[4]; - u8 cur_dot11txpn[8]; #ifdef CONFIG_GTK_OL struct sta_priv *pstapriv = &adapter->stapriv; @@ -6608,14 +8808,13 @@ void rtw_hal_set_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, 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_hal_construct_ARPRsp(adapter, &pframe[index], - &ARPLength, currentip); + &ARPLength, pmlmeinfo->ip_addr); rtw_hal_fill_fake_txdesc(adapter, &pframe[index - tx_desc], @@ -6626,22 +8825,50 @@ void rtw_hal_set_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, *page_num += CurtPktPageNum; index += (CurtPktPageNum * page_size); + RSVD_PAGE_CFG("WOW-ARPRsp", CurtPktPageNum, *page_num, 0); - /* 3 SEC IV * 1 page */ - rtw_get_sec_iv(adapter, cur_dot11txpn, - get_my_bssid(&pmlmeinfo->network)); +#ifdef CONFIG_IPV6 + /* 2 NS offload and NDP Info*/ + if (pwrctl->wowlan_ns_offload_en == _TRUE) { + rsvd_page_loc->LocNbrAdv = *page_num; + RTW_INFO("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_CFG("WOW-NbrAdv", CurtPktPageNum, *page_num, 0); + rsvd_page_loc->LocNDPInfo = *page_num; + RTW_INFO("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); + RSVD_PAGE_CFG("WOW-NDPInfo", CurtPktPageNum, *page_num, 0); + + } +#endif /*CONFIG_IPV6*/ + /* 3 Remote Control Info. * 1 page */ rsvd_page_loc->LocRemoteCtrlInfo = *page_num; - RTW_INFO("LocRemoteCtrlInfo: %d\n", rsvd_page_loc->LocRemoteCtrlInfo); - - _rtw_memcpy(pframe + index - tx_desc, cur_dot11txpn, _AES_IV_LEN_); - - CurtPktPageNum = (u8)PageNum(_AES_IV_LEN_, page_size); - + rtw_hal_construct_remote_control_info(adapter, + &pframe[index - tx_desc], + &rc_len); + CurtPktPageNum = (u8)PageNum(rc_len, page_size); *page_num += CurtPktPageNum; - - *total_pkt_len = index + _AES_IV_LEN_; + *total_pkt_len = index + rc_len; + RSVD_PAGE_CFG("WOW-RCI", CurtPktPageNum, *page_num, *total_pkt_len); #ifdef CONFIG_GTK_OL index += (CurtPktPageNum * page_size); @@ -6709,6 +8936,7 @@ void rtw_hal_set_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, *page_num += CurtPktPageNum; index += (CurtPktPageNum * page_size); + RSVD_PAGE_CFG("WOW-GTKInfo", CurtPktPageNum, *page_num, 0); /* 3 GTK Response */ rsvd_page_loc->LocGTKRsp = *page_num; @@ -6739,6 +8967,7 @@ void rtw_hal_set_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, *page_num += CurtPktPageNum; index += (CurtPktPageNum * page_size); + RSVD_PAGE_CFG("WOW-GTKRsp", CurtPktPageNum, *page_num, 0); /* below page is empty for GTK extension memory */ /* 3(11) GTK EXT MEM */ @@ -6752,6 +8981,7 @@ 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); + RSVD_PAGE_CFG("WOW-GTKEXTMEM", CurtPktPageNum, *page_num, *total_pkt_len); #endif /* CONFIG_GTK_OL */ index += (CurtPktPageNum * page_size); @@ -6761,6 +8991,7 @@ void rtw_hal_set_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, RTW_INFO("LocAOACReport: %d\n", rsvd_page_loc->LocAOACReport); *page_num += 1; *total_pkt_len = index + (page_size * 1); + RSVD_PAGE_CFG("WOW-AOAC", 1, *page_num, *total_pkt_len); } else { #ifdef CONFIG_PNO_SUPPORT if (pwrctl->wowlan_in_resume == _FALSE && @@ -6788,6 +9019,7 @@ void rtw_hal_set_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, *page_num += CurtPktPageNum; index += (CurtPktPageNum * page_size); + RSVD_PAGE_CFG("WOW-ProbeReq", CurtPktPageNum, *page_num, 0); /* Hidden SSID Probe Request */ ssid_num = pwrctl->pnlo_info->hidden_ssid_num; @@ -6812,6 +9044,7 @@ void rtw_hal_set_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, *page_num += CurtPktPageNum; index += (CurtPktPageNum * page_size); + RSVD_PAGE_CFG("WOW-ProbeReq", CurtPktPageNum, *page_num, 0); } /* PNO INFO Page */ @@ -6824,6 +9057,7 @@ void rtw_hal_set_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, CurtPktPageNum = (u8)PageNum(PNOLength, page_size); *page_num += CurtPktPageNum; index += (CurtPktPageNum * page_size); + RSVD_PAGE_CFG("WOW-PNOInfo", CurtPktPageNum, *page_num, 0); /* Scan Info Page */ rsvd_page_loc->LocScanInfo = *page_num; @@ -6836,6 +9070,7 @@ 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); + RSVD_PAGE_CFG("WOW-ScanInfo", CurtPktPageNum, *page_num, *total_pkt_len); } #endif /* CONFIG_PNO_SUPPORT */ } @@ -6844,10 +9079,25 @@ 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); @@ -6870,20 +9120,6 @@ static void rtw_hal_gate_bb(_adapter *adapter, bool stop) } } -static void rtw_hal_reset_mac_rx(_adapter *adapter) -{ - u8 val8 = 0; - /* Set REG_CR bit1, bit3, bit7 to 0*/ - val8 = rtw_read8(adapter, REG_CR); - val8 &= 0x75; - rtw_write8(adapter, REG_CR, val8); - val8 = rtw_read8(adapter, REG_CR); - /* Set REG_CR bit1, bit3, bit7 to 1*/ - val8 |= 0x8a; - rtw_write8(adapter, REG_CR, val8); - 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); @@ -6896,7 +9132,7 @@ static u8 rtw_hal_wow_pattern_generate(_adapter *adapter, u8 idx, struct rtl_wow 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 mask_len = 0; u8 mac_addr[ETH_ALEN] = {0}; u16 count = 0; int i, j; @@ -6989,6 +9225,19 @@ static u8 rtw_hal_wow_pattern_generate(_adapter *adapter, u8 idx, struct rtl_wow } #ifndef CONFIG_WOW_PATTERN_HW_CAM +static void rtw_hal_reset_mac_rx(_adapter *adapter) +{ + u8 val8 = 0; + /* Set REG_CR bit1, bit3, bit7 to 0*/ + val8 = rtw_read8(adapter, REG_CR); + val8 &= 0x75; + rtw_write8(adapter, REG_CR, val8); + val8 = rtw_read8(adapter, REG_CR); + /* Set REG_CR bit1, bit3, bit7 to 1*/ + val8 |= 0x8a; + rtw_write8(adapter, REG_CR, val8); + RTW_INFO("0x%04x: %02x\n", REG_CR, rtw_read8(adapter, REG_CR)); +} static void rtw_hal_set_wow_rxff_boundary(_adapter *adapter, bool wow_mode) { u8 val8 = 0; @@ -7229,6 +9478,7 @@ void rtw_clean_pattern(_adapter *adapter) rtw_write8(adapter, REG_WKFMCAM_NUM, 0); } +#if 0 static int rtw_hal_set_pattern(_adapter *adapter, u8 *pattern, u8 len, u8 *mask, u8 idx) { @@ -7342,6 +9592,8 @@ static int rtw_hal_set_pattern(_adapter *adapter, u8 *pattern, return res; } +#endif + void rtw_fill_pattern(_adapter *adapter) { int i = 0, total = 0, index; @@ -7384,7 +9636,7 @@ static u32 _rtw_wow_pattern_read_cam(_adapter *adapter, u8 addr) u32 rdata = 0; u32 cnt = 0; - u32 start = 0; + systime start = 0; u8 timeout = 0; u8 rst = _FALSE; @@ -7454,7 +9706,7 @@ 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; - u32 start = 0, end = 0; + systime start = 0, end = 0; u8 timeout = 0; /*RTW_INFO("%s ==> addr:0x%02x , wdata:0x%08x\n", __func__, addr, wdata);*/ @@ -7523,7 +9775,7 @@ 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; - u32 start = 0; + systime start = 0; u8 timeout = 0; u8 rst = _FAIL; @@ -7640,6 +9892,7 @@ static void rtw_hal_dl_pattern(_adapter *adapter, u8 mode) static void rtw_hal_wow_enable(_adapter *adapter) { + struct registry_priv *registry_par = &adapter->registrypriv; struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); struct security_priv *psecuritypriv = &adapter->securitypriv; struct mlme_priv *pmlmepriv = &adapter->mlmepriv; @@ -7648,9 +9901,19 @@ static void rtw_hal_wow_enable(_adapter *adapter) PHAL_DATA_TYPE pHalData = GET_HAL_DATA(adapter); int res; u16 media_status_rpt; + u8 no_wake = 0; + +#ifdef CONFIG_LPS_PG + u8 lps_pg_hdl_id = 0; +#endif - RTW_PRINT("%s, WOWLAN_ENABLE\n", __func__); + + if(registry_par->suspend_type == FW_IPS_DISABLE_BBRF && + !check_fwstate(pmlmepriv, _FW_LINKED)) + no_wake = 1; + + RTW_PRINT(FUNC_ADPT_FMT " WOWLAN_ENABLE\n", FUNC_ADPT_ARG(adapter)); rtw_hal_gate_bb(adapter, _TRUE); #ifdef CONFIG_GTK_OL if (psecuritypriv->binstallKCK_KEK == _TRUE) @@ -7659,6 +9922,14 @@ static void rtw_hal_wow_enable(_adapter *adapter) if (IS_HARDWARE_TYPE_8723B(adapter)) rtw_hal_backup_rate(adapter); + rtw_hal_fw_dl(adapter, _TRUE); + if(no_wake) + media_status_rpt = RT_MEDIA_DISCONNECT; + else + 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)) @@ -7675,22 +9946,20 @@ static void rtw_hal_wow_enable(_adapter *adapter) #endif /* 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); + if(!no_wake) + rtw_hal_dl_pattern(adapter, 1); if (!pwrctl->wowlan_pno_enable) { psta = rtw_get_stainfo(&adapter->stapriv, get_bssid(pmlmepriv)); if (psta != NULL) { #ifdef CONFIG_FW_MULTI_PORT_SUPPORT - rtw_hal_set_default_port_id_cmd(adapter, psta->mac_id); + adapter_to_dvobj(adapter)->dft.port_id = 0xFF; + adapter_to_dvobj(adapter)->dft.mac_id = 0xFF; + rtw_hal_set_default_port_id_cmd(adapter, psta->cmn.mac_id); #endif - - rtw_sta_media_status_rpt(adapter, psta, 1); + if(!no_wake) + rtw_sta_media_status_rpt(adapter, psta, 1); } } @@ -7721,15 +9990,26 @@ static void rtw_hal_wow_enable(_adapter *adapter) dump_sec_cam(RTW_DBGDUMP, adapter); dump_sec_cam_cache(RTW_DBGDUMP, adapter); #endif + +#ifdef CONFIG_LPS_PG + if (pwrctl->lps_level == LPS_PG) { + lps_pg_hdl_id = LPS_PG_INFO_CFG; + rtw_hal_set_hwreg(adapter, HW_VAR_LPS_PG_HANDLE, (u8 *)(&lps_pg_hdl_id)); + } +#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); - if (IS_8188F(pHalData->version_id) == FALSE) + if (IS_8188F(pHalData->version_id) == FALSE + && IS_8188GTV(pHalData->version_id) == FALSE) rtw_write8(adapter, REG_RSV_CTRL, 0x60); -#endif /*CONFIG_USB_HCI*/ +#endif rtw_hal_gate_bb(adapter, _FALSE); } @@ -7792,12 +10072,18 @@ static void rtw_hal_wow_disable(_adapter *adapter) struct mlme_priv *pmlmepriv = &adapter->mlmepriv; struct hal_ops *pHalFunc = &adapter->hal_func; struct sta_info *psta = NULL; + struct registry_priv *registry_par = &adapter->registrypriv; int res; u16 media_status_rpt; u8 val8; RTW_PRINT("%s, WOWLAN_DISABLE\n", __func__); - + + if(registry_par->suspend_type == FW_IPS_DISABLE_BBRF && !check_fwstate(pmlmepriv, _FW_LINKED)) { + RTW_INFO("FW_IPS_DISABLE_BBRF resume\n"); + return; + } + if (!pwrctl->wowlan_pno_enable) { psta = rtw_get_stainfo(&adapter->stapriv, get_bssid(pmlmepriv)); if (psta != NULL) @@ -7850,26 +10136,34 @@ static void rtw_hal_wow_disable(_adapter *adapter) rtw_hal_enable_tx_report(adapter); #endif -#ifdef CONFIG_GTK_OL - if (((pwrctl->wowlan_wake_reason != RX_DISASSOC) || - (pwrctl->wowlan_wake_reason != RX_DEAUTH) || - (pwrctl->wowlan_wake_reason != FW_DECISION_DISCONNECT)) && - psecuritypriv->binstallKCK_KEK == _TRUE) { + if ((pwrctl->wowlan_wake_reason != RX_DISASSOC) && + (pwrctl->wowlan_wake_reason != RX_DEAUTH) && + (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_RTW_ONE_PIN_GPIO + rtw_hal_set_input_gpio(adapter, WAKEUP_GPIO_IDX); +#else +#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_hal_set_output_gpio(adapter, WAKEUP_GPIO_IDX, val8); + rtw_hal_set_output_gpio(adapter, WAKEUP_GPIO_IDX, val8); rtw_hal_switch_gpio_wl_ctrl(adapter, WAKEUP_GPIO_IDX, _FALSE); #endif - +#endif /* CONFIG_RTW_ONE_PIN_GPIO */ +#endif if ((pwrctl->wowlan_wake_reason != FW_DECISION_DISCONNECT) && (pwrctl->wowlan_wake_reason != RX_PAIRWISEKEY) && (pwrctl->wowlan_wake_reason != RX_DISASSOC) && @@ -7881,7 +10175,9 @@ static void rtw_hal_wow_disable(_adapter *adapter) if (psta != NULL) { #ifdef CONFIG_FW_MULTI_PORT_SUPPORT - rtw_hal_set_default_port_id_cmd(adapter, psta->mac_id); + adapter_to_dvobj(adapter)->dft.port_id = 0xFF; + adapter_to_dvobj(adapter)->dft.mac_id = 0xFF; + rtw_hal_set_default_port_id_cmd(adapter, psta->cmn.mac_id); #endif rtw_sta_media_status_rpt(adapter, psta, 1); } @@ -7915,6 +10211,7 @@ void rtw_hal_set_p2p_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, *page_num += CurtPktPageNum; index += (CurtPktPageNum * page_size); + RSVD_PAGE_CFG("WOW-P2P-Beacon", CurtPktPageNum, *page_num, 0); /* P2P Probe rsp */ rsvd_page_loc->LocP2PProbeRsp = *page_num; @@ -7931,6 +10228,7 @@ void rtw_hal_set_p2p_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, *page_num += CurtPktPageNum; index += (CurtPktPageNum * page_size); + RSVD_PAGE_CFG("WOW-P2P-ProbeRsp", CurtPktPageNum, *page_num, 0); /* P2P nego rsp */ rsvd_page_loc->LocNegoRsp = *page_num; @@ -7947,6 +10245,7 @@ void rtw_hal_set_p2p_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, *page_num += CurtPktPageNum; index += (CurtPktPageNum * page_size); + RSVD_PAGE_CFG("WOW-P2P-NegoRsp", CurtPktPageNum, *page_num, 0); /* P2P invite rsp */ rsvd_page_loc->LocInviteRsp = *page_num; @@ -7963,6 +10262,7 @@ void rtw_hal_set_p2p_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, *page_num += CurtPktPageNum; index += (CurtPktPageNum * page_size); + RSVD_PAGE_CFG("WOW-P2P-InviteRsp", CurtPktPageNum, *page_num, 0); /* P2P provision discovery rsp */ rsvd_page_loc->LocPDRsp = *page_num; @@ -7980,6 +10280,7 @@ void rtw_hal_set_p2p_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, *page_num += CurtPktPageNum; *total_pkt_len = index + P2PPDRspLength; + RSVD_PAGE_CFG("WOW-P2P-PDR", CurtPktPageNum, *page_num, *total_pkt_len); index += (CurtPktPageNum * page_size); @@ -7988,99 +10289,318 @@ void rtw_hal_set_p2p_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, #endif /* CONFIG_P2P_WOWLAN */ #ifdef CONFIG_LPS_PG +#ifndef DBG_LPSPG_INFO_DUMP +#define DBG_LPSPG_INFO_DUMP 1 +#endif + #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) +#ifdef CONFIG_RTL8822C +static int rtw_lps_pg_set_dpk_info_rsvd_page(_adapter *adapter) { 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}; + struct dm_struct *dm = adapter_to_phydm(adapter); + struct rsvd_page_cache_t *cache = &pwrpriv->lpspg_dpk_info; + u8 *info = NULL; + u32 info_len; + int ret = _FAIL; + + /* get length */ + halrf_dpk_info_rsvd_page(dm, NULL, &info_len); + if (!info_len) { + RTW_ERR("get %s length fail\n", cache->name); + goto exit; + } + + /* allocate buf */ + info = rtw_zmalloc(info_len); + if (!info) { + RTW_ERR("alloc %s buffer fail(len=%d)\n", cache->name, info_len); + goto exit; + } + + /* get content */ + halrf_dpk_info_rsvd_page(dm, info, NULL); + + if (rsvd_page_cache_update_data(cache, info, info_len)) { + + #if (DBG_LPSPG_INFO_DUMP >= 1) + RTW_INFO_DUMP(cache->name, info, info_len); + #endif + + ret = rtw_halmac_download_rsvd_page(dvobj, cache->loc, info, info_len); + ret = !ret ? _SUCCESS : _FAIL; + if (ret != _SUCCESS) { + RTW_ERR("download %s rsvd page to offset:%u fail\n", cache->name, cache->loc); + goto free_mem; + } + + #if (DBG_LPSPG_INFO_DUMP >= 2) + RTW_INFO("get %s from rsvd page offset:%d\n", cache->name, cache->loc); + rtw_dump_rsvd_page(RTW_DBGDUMP, adapter, cache->loc, cache->page_num); + #endif + } + +free_mem: + rtw_mfree(info, info_len); + +exit: + return ret; +} + +static int rtw_lps_pg_set_iqk_info_rsvd_page(_adapter *adapter) +{ + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + struct dm_struct *dm = adapter_to_phydm(adapter); + struct rsvd_page_cache_t *cache = &pwrpriv->lpspg_iqk_info; + u8 *info = NULL; + u32 info_len = 0; + int ret = _FAIL; + + if (hal_data->RegIQKFWOffload) { + rsvd_page_cache_free_data(cache); + ret = _SUCCESS; + goto exit; + } + + /* get length */ + odm_iqk_get_cfir2fw_8822c(dm, NULL, &info_len); + if (!info_len) { + RTW_ERR("get %s length fail\n", cache->name); + goto exit; + } + + /* allocate buf */ + info = rtw_zmalloc(info_len); + if (!info) { + RTW_ERR("alloc %s buffer fail(len=%d)\n", cache->name, info_len); + goto exit; + } + + /* get content */ + odm_iqk_get_cfir2fw_8822c(dm, info, NULL); + + if (rsvd_page_cache_update_data(cache, info, info_len)) { + + #if (DBG_LPSPG_INFO_DUMP >= 1) + RTW_INFO_DUMP(cache->name, info, info_len); + #endif + + ret = rtw_halmac_download_rsvd_page(dvobj, cache->loc, info, info_len); + ret = !ret ? _SUCCESS : _FAIL; + if (ret != _SUCCESS) { + RTW_ERR("download %s rsvd page to offset:%u fail\n", cache->name, cache->loc); + goto free_mem; + } + + #if (DBG_LPSPG_INFO_DUMP >= 2) + RTW_INFO("get %s from rsvd page offset:%d\n", cache->name, cache->loc); + rtw_dump_rsvd_page(RTW_DBGDUMP, adapter, cache->loc, cache->page_num); + #endif + } + +free_mem: + rtw_mfree(info, info_len); + +exit: + return ret; +} +#endif /* CONFIG_RTL8822C */ + +static void rtw_hal_build_lps_pg_info_rsvd_page(_adapter *adapter, u8 *buf, u32 *buf_size) +{ +#define LPS_PG_INFO_RSVD_LEN 16 + + struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); + struct sta_info *psta; #ifdef CONFIG_MBSSID_CAM u8 cam_id = INVALID_CAM_ID; #endif - u8 *psec_cam_id = lps_pg_info + 8; + u8 *psec_cam_id = buf + 8; u8 sec_cam_num = 0; + u8 drv_rsvdpage_num = 0; - if (!psta) { - RTW_ERR("%s [ERROR] sta is NULL\n", __func__); - rtw_warn_on(1); - return; - } + if (buf) { + psta = rtw_get_stainfo(&adapter->stapriv, get_bssid(&adapter->mlmepriv)); + if (!psta) { + RTW_ERR("%s [ERROR] sta is NULL\n", __func__); + rtw_warn_on(1); + return; + } - /*Byte 0 - used macid*/ - LPSPG_RSVD_PAGE_SET_MACID(lps_pg_info, psta->mac_id); - RTW_INFO("[LPSPG-INFO] mac_id:%d\n", psta->mac_id); + /*Byte 0 - used macid*/ + LPSPG_RSVD_PAGE_SET_MACID(buf, 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); - RTW_INFO("[LPSPG-INFO] mbss_cam_id:%d\n", cam_id); + /*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(buf, 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); - RTW_INFO("[LPSPG-INFO] Max Pattern Match CAM entry :%d\n", pwrpriv->wowlan_pattern_idx); - } + /*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(buf, 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*/ - /*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); + /*Btye 3 - Max MU rate table Group ID*/ + LPSPG_RSVD_PAGE_SET_MU_RAID_GID(buf, 0); + RTW_INFO("[LPSPG-INFO] Max MU rate table Group ID :%d\n", 0); #endif - /*Btye 8 ~15 - used Security CAM entry */ - sec_cam_num = rtw_get_sec_camid(adapter, 8, psec_cam_id); + /*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); - RTW_INFO("[LPSPG-INFO] Security CAM entry number :%d\n", sec_cam_num); + /*Btye 4 - used Security CAM entry number*/ + if (sec_cam_num < 8) + LPSPG_RSVD_PAGE_SET_SEC_CAM_NUM(buf, 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*/ - LPSPG_RSVD_PAGE_SET_DRV_RSVDPAGE_NUM(lps_pg_info, phal_data->drv_rsvd_page_number); - RTW_INFO("[LPSPG-INFO] DRV's rsvd page numbers :%d\n", phal_data->drv_rsvd_page_number); + /*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(buf, drv_rsvdpage_num); + RTW_INFO("[LPSPG-INFO] DRV's rsvd page numbers :%d\n", drv_rsvdpage_num); + } -#ifdef DBG_LPSPG_SEC_DUMP - { - int i; + if (buf_size) + *buf_size = LPS_PG_INFO_RSVD_LEN; +} - for (i = 0; i < sec_cam_num; i++) - RTW_INFO("%d = sec_cam_id:%d\n", i, psec_cam_id[i]); +static int rtw_hal_set_lps_pg_info_rsvd_page(_adapter *adapter) +{ + struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + struct rsvd_page_cache_t *cache = &pwrpriv->lpspg_info; + u8 *info = NULL; + u32 info_len = 0; + int ret = _FAIL; + + /* get length */ + rtw_hal_build_lps_pg_info_rsvd_page(adapter, NULL, &info_len); + if (!info_len) { + RTW_ERR("get %s length fail\n", cache->name); + goto exit; + } + + /* allocate buf */ + info = rtw_zmalloc(info_len); + if (!info) { + RTW_ERR("alloc %s buffer fail(len=%d)\n", cache->name, info_len); + goto exit; + } + + /* get content */ + rtw_hal_build_lps_pg_info_rsvd_page(adapter, info, NULL); + + if (rsvd_page_cache_update_data(cache, info, info_len)) { + + #if (DBG_LPSPG_INFO_DUMP >= 1) + RTW_INFO_DUMP(cache->name, info, info_len); + #endif + + ret = rtw_halmac_download_rsvd_page(dvobj, cache->loc, info, info_len); + ret = !ret ? _SUCCESS : _FAIL; + if (ret != _SUCCESS) { + RTW_ERR("download %s rsvd page to offset:%u fail\n", cache->name, cache->loc); + goto free_mem; + } + + #if (DBG_LPSPG_INFO_DUMP >= 2) + RTW_INFO("get %s from rsvd page offset:%d\n", cache->name, cache->loc); + rtw_dump_rsvd_page(RTW_DBGDUMP, adapter, cache->loc, cache->page_num); + #endif + } + +free_mem: + rtw_mfree(info, info_len); + +exit: + return ret; +} + +static void rtw_lps_pg_set_rsvd_page(_adapter *adapter, u8 *frame, u16 *index + , u8 txdesc_size, u32 page_size, u8 *total_page_num, bool is_wow_mode, bool only_get_page_num) +{ + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); + struct rsvd_page_cache_t *cache; + u8 *pos; + u32 len; + + /* lps_level will not change when enter wow_mode */ + if (is_wow_mode && pwrctl->lps_level != LPS_PG) + return; + + pos = only_get_page_num ? NULL : frame + *index; + +#ifdef CONFIG_RTL8822C + if (IS_8822C_SERIES(hal_data->version_id)) { + /* LPSPG_DPK_INFO */ + cache = &pwrctl->lpspg_dpk_info; + if (pwrctl->lps_level != LPS_PG) + pos = NULL; + halrf_dpk_info_rsvd_page(adapter_to_phydm(adapter), pos, &len); + if (pos) { + #if (DBG_LPSPG_INFO_DUMP >= 1) + RTW_INFO_DUMP(cache->name, pos, len); + #endif + } + rsvd_page_cache_update_all(cache, *total_page_num, txdesc_size, page_size, pos, len); + *total_page_num += cache->page_num; + *index += page_size * cache->page_num; + pos = only_get_page_num ? NULL : frame + *index; + RSVD_PAGE_CFG(cache->name, cache->page_num, *total_page_num, *index); + + /* LPSPG_IQK_INFO */ + cache = &pwrctl->lpspg_iqk_info; + if (!(is_wow_mode && hal_data->RegIQKFWOffload)) { /* RegIQKFWOffload will not change when enter wow_mode */ + if (pwrctl->lps_level != LPS_PG || hal_data->RegIQKFWOffload) + pos = NULL; + odm_iqk_get_cfir2fw_8822c(adapter_to_phydm(adapter), pos, &len); + if (pos) { + #if (DBG_LPSPG_INFO_DUMP >= 1) + RTW_INFO_DUMP(cache->name, pos, len); + #endif + } + rsvd_page_cache_update_all(cache, *total_page_num, txdesc_size, page_size, pos, len); + *total_page_num += cache->page_num; + *index += page_size * cache->page_num; + pos = only_get_page_num ? NULL : frame + *index; + RSVD_PAGE_CFG(cache->name, cache->page_num, *total_page_num, *index); + } else + rsvd_page_cache_free_data(cache); } #endif -#ifdef DBG_LPSPG_INFO_DUMP - RTW_INFO("==== DBG_LPSPG_INFO_RSVD_PAGE_DUMP====\n"); - RTW_INFO(" %02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X\n", - *(lps_pg_info), *(lps_pg_info + 1), *(lps_pg_info + 2), *(lps_pg_info + 3), - *(lps_pg_info + 4), *(lps_pg_info + 5), *(lps_pg_info + 6), *(lps_pg_info + 7)); - RTW_INFO(" %02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X\n", - *(lps_pg_info + 8), *(lps_pg_info + 9), *(lps_pg_info + 10), *(lps_pg_info + 11), - *(lps_pg_info + 12), *(lps_pg_info + 13), *(lps_pg_info + 14), *(lps_pg_info + 15)); - RTW_INFO("==== DBG_LPSPG_INFO_RSVD_PAGE_DUMP====\n"); -#endif - - 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 + /* LPSPG_INFO */ + cache = &pwrctl->lpspg_info; + if (pwrctl->lps_level != LPS_PG) + pos = NULL; + rtw_hal_build_lps_pg_info_rsvd_page(adapter, pos, &len); + if (pos) { + #if (DBG_LPSPG_INFO_DUMP >= 1) + RTW_INFO_DUMP(cache->name, pos, len); + #endif + } + rsvd_page_cache_update_all(cache, *total_page_num, txdesc_size, page_size, pos, len); + *total_page_num += cache->page_num; + *index += page_size * cache->page_num; + pos = only_get_page_num ? NULL : frame + *index; + RSVD_PAGE_CFG(cache->name, cache->page_num, *total_page_num, *index); } - static u8 rtw_hal_set_lps_pg_info_cmd(_adapter *adapter) { struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); @@ -8089,10 +10609,9 @@ static u8 rtw_hal_set_lps_pg_info_cmd(_adapter *adapter) u8 lpspg_info[H2C_LPS_PG_INFO_LEN] = {0}; u8 ret = _FAIL; - RTW_INFO("%s: loc_lpspg_info:%d\n", __func__, pwrpriv->lpspg_rsvd_page_locate); - if (_NO_PRIVACY_ != adapter->securitypriv.dot11PrivacyAlgrthm) SET_H2CCMD_LPSPG_SEC_CAM_EN(lpspg_info, 1); /*SecurityCAM_En*/ + #ifdef CONFIG_MBSSID_CAM SET_H2CCMD_LPSPG_MBID_CAM_EN(lpspg_info, 1); /*BSSIDCAM_En*/ #endif @@ -8117,13 +10636,16 @@ static u8 rtw_hal_set_lps_pg_info_cmd(_adapter *adapter) SET_H2CCMD_LPSPG_MU_RATE_TB_EN(lpspg_info, 1); /*MURateTable_En*/ #endif - SET_H2CCMD_LPSPG_LOC(lpspg_info, pwrpriv->lpspg_rsvd_page_locate); + SET_H2CCMD_LPSPG_LOC(lpspg_info, pwrpriv->lpspg_info.loc); -#ifdef DBG_LPSPG_INFO_DUMP - RTW_INFO("==== DBG_LPSPG_INFO_CMD_DUMP====\n"); - RTW_INFO(" H2C_CMD: 0x%02x, H2C_LEN: %d\n", H2C_LPS_PG_INFO, H2C_LPS_PG_INFO_LEN); - RTW_INFO(" %02X:%02X\n", *(lpspg_info), *(lpspg_info + 1)); - RTW_INFO("==== DBG_LPSPG_INFO_CMD_DUMP====\n"); +#ifdef CONFIG_RTL8822C + SET_H2CCMD_LPSPG_DPK_INFO_LOC(lpspg_info, pwrpriv->lpspg_dpk_info.loc); + if (!GET_HAL_DATA(adapter)->RegIQKFWOffload) + SET_H2CCMD_LPSPG_IQK_INFO_LOC(lpspg_info, pwrpriv->lpspg_iqk_info.loc); +#endif + +#if (DBG_LPSPG_INFO_DUMP >= 1) + RTW_INFO_DUMP("H2C_LPS_PG_INFO: ", lpspg_info, H2C_LPS_PG_INFO_LEN); #endif ret = rtw_hal_fill_h2c_cmd(adapter, @@ -8137,44 +10659,76 @@ u8 rtw_hal_set_lps_pg_info(_adapter *adapter) u8 ret = _FAIL; struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); - if (pwrpriv->lpspg_rsvd_page_locate == 0) { - RTW_ERR("%s [ERROR] lpspg_rsvd_page_locate = 0\n", __func__); + if (pwrpriv->lpspg_info.loc == 0) { + RTW_ERR("%s lpspg_info.loc = 0\n", __func__); rtw_warn_on(1); return ret; } + rtw_lps_pg_set_dpk_info_rsvd_page(adapter); + rtw_lps_pg_set_iqk_info_rsvd_page(adapter); rtw_hal_set_lps_pg_info_rsvd_page(adapter); + ret = rtw_hal_set_lps_pg_info_cmd(adapter); - if (_SUCCESS == ret) - pwrpriv->blpspg_info_up = _FALSE; 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) { + struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + struct sta_priv *pstapriv = &adapter->stapriv; + struct sta_info *sta; + + sta = rtw_get_stainfo(pstapriv, pmlmeinfo->network.MacAddress); + switch (hdl_id) { case LPS_PG_INFO_CFG: rtw_hal_set_lps_pg_info(adapter); break; case LPS_PG_REDLEMEM: - /*rtw_halmac_redl_fw();*/ + if (IS_8822C_SERIES(GET_HAL_DATA(adapter)->version_id)) + break; + + /*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_PHYDM_DIS:/*Disable RA and PT by H2C*/ + if (IS_8822C_SERIES(GET_HAL_DATA(adapter)->version_id)) + break; - case LPS_PG_RESEND_H2C: - { - struct macid_ctl_t *macid_ctl = &adapter->dvobj->macid_ctl; - struct sta_info *sta; - PHAL_DATA_TYPE hal_data = GET_HAL_DATA(adapter); - int i; + if (sta) + rtw_phydm_lps_pg_hdl(adapter, sta, _TRUE); + break; + case LPS_PG_PHYDM_EN:/*Enable RA and PT by H2C*/ + if (IS_8822C_SERIES(GET_HAL_DATA(adapter)->version_id)) + break; - for (i = 0; i < MACID_NUM_SW_LIMIT; i++) { - sta = macid_ctl->sta[i]; - if (sta && !is_broadcast_mac_addr(sta->hwaddr)) { - /*rtw_dm_ra_mask_hdl(adapter, sta);*/ - /*phydm_rssi_report(hal_data->odmpriv, sta->mac_id);*/ - } - } + if (sta) { + rtw_hal_lps_pg_rssi_lv_decide(adapter, sta); + rtw_phydm_lps_pg_hdl(adapter, sta, _FALSE); + sta->lps_pg_rssi_lv = 0; } break; @@ -8185,6 +10739,74 @@ void rtw_hal_lps_pg_handler(_adapter *adapter, enum lps_pg_hdl_id hdl_id) #endif /*CONFIG_LPS_PG*/ +static u8 _rtw_mi_assoc_if_num(_adapter *adapter) +{ + u8 mi_iface_num = 0; + + if (0) { + RTW_INFO("[IFS_ASSOC_STATUS] - STA :%d", DEV_STA_LD_NUM(adapter_to_dvobj(adapter))); + RTW_INFO("[IFS_ASSOC_STATUS] - AP:%d", DEV_AP_NUM(adapter_to_dvobj(adapter))); + RTW_INFO("[IFS_ASSOC_STATUS] - AP starting :%d", DEV_AP_STARTING_NUM(adapter_to_dvobj(adapter))); + RTW_INFO("[IFS_ASSOC_STATUS] - MESH :%d", DEV_MESH_NUM(adapter_to_dvobj(adapter))); + RTW_INFO("[IFS_ASSOC_STATUS] - ADHOC :%d", DEV_ADHOC_NUM(adapter_to_dvobj(adapter))); + /*RTW_INFO("[IFS_ASSOC_STATUS] - P2P-GC :%d", DEV_P2P_GC_NUM(adapter_to_dvobj(adapter)));*/ + /*RTW_INFO("[IFS_ASSOC_STATUS] - P2P-GO :%d", DEV_P2P_GO_NUM(adapter_to_dvobj(adapter)));*/ + } + + mi_iface_num = (DEV_STA_LD_NUM(adapter_to_dvobj(adapter)) + + DEV_AP_NUM(adapter_to_dvobj(adapter)) + + DEV_AP_STARTING_NUM(adapter_to_dvobj(adapter))); + return mi_iface_num; +} +#ifdef CONFIG_CONCURRENT_MODE +static _adapter *_rtw_search_sta_iface(_adapter *adapter) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + _adapter *iface = NULL; + _adapter *sta_iface = NULL; + int i; + + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + if (check_fwstate(&iface->mlmepriv, WIFI_STATION_STATE) == _TRUE) { + if (check_fwstate(&iface->mlmepriv, _FW_LINKED) == _TRUE) { + sta_iface = iface; + break; + } + } + } + return sta_iface; +} +#if defined(CONFIG_AP_MODE) && defined(CONFIG_BT_COEXIST) +static _adapter *_rtw_search_ap_iface(_adapter *adapter) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + _adapter *iface = NULL; + _adapter *ap_iface = NULL; + int i; + + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + if (check_fwstate(&iface->mlmepriv, WIFI_AP_STATE) == _TRUE ) { + ap_iface = iface; + break; + } + } + return ap_iface; +} +#endif/*CONFIG_AP_MODE*/ +#endif/*CONFIG_CONCURRENT_MODE*/ + +#ifdef CONFIG_CUSTOMER01_SMART_ANTENNA +void rtw_hal_set_pathb_phase(_adapter *adapter, u8 phase_idx) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); + struct PHY_DM_STRUCT *pDM_Odm = &pHalData->odmpriv; + + return phydm_pathb_q_matrix_rotate(pDM_Odm, phase_idx); +} +#endif + /* * Description: Fill the reserved packets that FW will use to RSVD page. * Now we just send 4 types packet to rsvd page. @@ -8194,7 +10816,12 @@ void rtw_hal_lps_pg_handler(_adapter *adapter, enum lps_pg_hdl_id hdl_id) * 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 @@ -8202,14 +10829,12 @@ void rtw_hal_lps_pg_handler(_adapter *adapter, enum lps_pg_hdl_id hdl_id) */ /*#define DBG_DUMP_SET_RSVD_PAGE*/ -void rtw_hal_set_fw_rsvd_page(_adapter *adapter, bool finished) +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->hal_func; @@ -8222,6 +10847,11 @@ void rtw_hal_set_fw_rsvd_page(_adapter *adapter, bool finished) u16 BufIndex = 0; u32 TotalPacketLen = 0, MaxRsvdPageBufSize = 0, PageSize = 0; RSVDPAGE_LOC RsvdPageLoc; + struct registry_priv *registry_par = &adapter->registrypriv; + +#ifdef DBG_FW_DEBUG_MSG_PKT + u32 fw_dbg_msg_pkt_len = 0; +#endif /*DBG_FW_DEBUG_MSG_PKT*/ #ifdef DBG_CONFIG_ERROR_DETECT struct sreset_priv *psrtpriv; @@ -8230,51 +10860,76 @@ void rtw_hal_set_fw_rsvd_page(_adapter *adapter, bool finished) #ifdef CONFIG_MCC_MODE u8 dl_mcc_page = _FAIL; #endif /* CONFIG_MCC_MODE */ + u8 nr_assoc_if; + + _adapter *sta_iface = NULL; + _adapter *ap_iface = NULL; + + bool is_wow_mode = _FALSE; pHalData = GET_HAL_DATA(adapter); #ifdef DBG_CONFIG_ERROR_DETECT psrtpriv = &pHalData->srestpriv; #endif pxmitpriv = &adapter->xmitpriv; - pmlmeext = &adapter->mlmeextpriv; - pmlmeinfo = &pmlmeext->mlmext_info; pwrctl = adapter_to_pwrctl(adapter); rtw_hal_get_def_var(adapter, HAL_DEF_TX_PAGE_SIZE, (u8 *)&PageSize); if (PageSize == 0) { - RTW_INFO("[Error]: %s, PageSize is zero!!\n", __func__); + RTW_ERR("[Error]: %s, PageSize is zero!!\n", __func__); return; } + nr_assoc_if = _rtw_mi_assoc_if_num(adapter); - 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); + if ((pwrctl->wowlan_mode == _TRUE && pwrctl->wowlan_in_resume == _FALSE) || + pwrctl->wowlan_ap_mode == _TRUE || + pwrctl->wowlan_p2p_mode == _TRUE) + is_wow_mode = _TRUE; - RTW_INFO("%s PageSize: %d, RsvdPageNUm: %d\n", __func__, PageSize, RsvdPageNum); + /*page_num for init time to get rsvd page number*/ + /* 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; + } + RTW_INFO(FUNC_ADPT_FMT" Get [ %s ] RsvdPageNUm ==>\n", + FUNC_ADPT_ARG(adapter), (is_wow_mode) ? "WOW" : "NOR"); - MaxRsvdPageBufSize = RsvdPageNum * PageSize; + } else { + if (is_wow_mode) + RsvdPageNum = rtw_hal_get_txbuff_rsvd_page_num(adapter, _TRUE); + else + RsvdPageNum = rtw_hal_get_txbuff_rsvd_page_num(adapter, _FALSE); - 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; + RTW_INFO(FUNC_ADPT_FMT" PageSize: %d, [ %s ]-RsvdPageNUm: %d\n", + FUNC_ADPT_ARG(adapter), PageSize, (is_wow_mode) ? "WOW" : "NOR", RsvdPageNum); + + 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; + } + + 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 */ BufIndex = TxDescOffset; + + /*======== beacon content =======*/ rtw_hal_construct_beacon(adapter, &ReservedPagePacket[BufIndex], &BeaconLength); @@ -8282,22 +10937,30 @@ void rtw_hal_set_fw_rsvd_page(_adapter *adapter, bool finished) * When we count the first page size, we need to reserve description size for the RSVD * packet, it will be filled in front of the packet in TXPKTBUF. */ + BeaconLength = MAX_BEACON_LEN - TxDescLen; 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; +#ifdef CONFIG_FW_HANDLE_TXBCN + CurtPktPageNum = CurtPktPageNum * CONFIG_LIMITED_AP_NUM; +#endif TotalPageNum += CurtPktPageNum; BufIndex += (CurtPktPageNum * PageSize); - if (pwrctl->wowlan_ap_mode == _TRUE) { + RSVD_PAGE_CFG("Beacon", CurtPktPageNum, TotalPageNum, TotalPacketLen); + + /*======== probe response content ========*/ + if (pwrctl->wowlan_ap_mode == _TRUE) {/*WOW mode*/ + #ifdef CONFIG_CONCURRENT_MODE + if (nr_assoc_if >= 2) + RTW_ERR("Not support > 2 net-interface in WOW\n"); + #endif /* (4) probe response*/ RsvdPageLoc.LocProbeRsp = TotalPageNum; rtw_hal_construct_ProbeRsp( adapter, &ReservedPagePacket[BufIndex], &ProbeRspLength, - get_my_bssid(&pmlmeinfo->network), _FALSE); + _FALSE); rtw_hal_fill_fake_txdesc(adapter, &ReservedPagePacket[BufIndex - TxDescLen], ProbeRspLength, _FALSE, _FALSE, _FALSE); @@ -8306,102 +10969,165 @@ void rtw_hal_set_fw_rsvd_page(_adapter *adapter, bool finished) TotalPageNum += CurtPktPageNum; TotalPacketLen = BufIndex + ProbeRspLength; BufIndex += (CurtPktPageNum * PageSize); + RSVD_PAGE_CFG("ProbeRsp", CurtPktPageNum, TotalPageNum, TotalPacketLen); goto download_page; } - /* ps-poll * 1 page */ - RsvdPageLoc.LocPsPoll = TotalPageNum; - RTW_INFO("LocPsPoll: %d\n", RsvdPageLoc.LocPsPoll); - rtw_hal_construct_PSPoll(adapter, - &ReservedPagePacket[BufIndex], &PSPollLength); - rtw_hal_fill_fake_txdesc(adapter, - &ReservedPagePacket[BufIndex - TxDescLen], - PSPollLength, _TRUE, _FALSE, _FALSE); + /*======== ps-poll content * 1 page ========*/ + sta_iface = adapter; + #ifdef CONFIG_CONCURRENT_MODE + if (!MLME_IS_STA(sta_iface) && DEV_STA_LD_NUM(adapter_to_dvobj(sta_iface))) { + sta_iface = _rtw_search_sta_iface(adapter); + RTW_INFO("get ("ADPT_FMT") to create PS-Poll/Null/QosNull\n", ADPT_ARG(sta_iface)); + } + #endif - CurtPktPageNum = (u8)PageNum((TxDescLen + PSPollLength), PageSize); + if (MLME_IS_STA(sta_iface) || (nr_assoc_if == 0)) { + RsvdPageLoc.LocPsPoll = TotalPageNum; + RTW_INFO("LocPsPoll: %d\n", RsvdPageLoc.LocPsPoll); + rtw_hal_construct_PSPoll(sta_iface, + &ReservedPagePacket[BufIndex], &PSPollLength); + rtw_hal_fill_fake_txdesc(sta_iface, + &ReservedPagePacket[BufIndex - TxDescLen], + PSPollLength, _TRUE, _FALSE, _FALSE); - TotalPageNum += CurtPktPageNum; - - 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); - - CurtPktPageNum = (u8)PageNum(TxDescLen + BTQosNullLength, PageSize); - - TotalPageNum += CurtPktPageNum; - - BufIndex += (CurtPktPageNum * PageSize); -#endif /* CONFIG_BT_COEXIT */ - -#ifdef CONFIG_MCC_MODE - if (MCC_EN(adapter)) { - dl_mcc_page = rtw_hal_dl_mcc_fw_rsvd_page(adapter, ReservedPagePacket, - &BufIndex, TxDescLen, PageSize, - &TotalPageNum, &TotalPacketLen, &RsvdPageLoc); - } else - 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); - rtw_hal_construct_NullFunctionData( - adapter, - &ReservedPagePacket[BufIndex], - &NullDataLength, - get_my_bssid(&pmlmeinfo->network), - _FALSE, 0, 0, _FALSE); - rtw_hal_fill_fake_txdesc(adapter, - &ReservedPagePacket[BufIndex - TxDescLen], - NullDataLength, _FALSE, _FALSE, _FALSE); - - CurtPktPageNum = (u8)PageNum(TxDescLen + NullDataLength, PageSize); + CurtPktPageNum = (u8)PageNum((TxDescLen + PSPollLength), PageSize); TotalPageNum += CurtPktPageNum; BufIndex += (CurtPktPageNum * PageSize); -#ifdef CONFIG_MCC_MODE + RSVD_PAGE_CFG("PSPoll", CurtPktPageNum, TotalPageNum, TotalPacketLen); } + +#ifdef CONFIG_MCC_MODE + /*======== MCC * n page ======== */ + if (MCC_EN(adapter)) {/*Normal mode*/ + dl_mcc_page = rtw_hal_dl_mcc_fw_rsvd_page(adapter, ReservedPagePacket, + &BufIndex, TxDescLen, PageSize, &TotalPageNum, &RsvdPageLoc, page_num); + } else { + dl_mcc_page = _FAIL; + } + + if (dl_mcc_page == _FAIL) #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, + { /*======== null data * 1 page ======== */ + if (MLME_IS_STA(sta_iface) || (nr_assoc_if == 0)) { + RsvdPageLoc.LocNullData = TotalPageNum; + RTW_INFO("LocNullData: %d\n", RsvdPageLoc.LocNullData); + rtw_hal_construct_NullFunctionData( + sta_iface, + &ReservedPagePacket[BufIndex], + &NullDataLength, + _FALSE, 0, 0, _FALSE); + rtw_hal_fill_fake_txdesc(sta_iface, &ReservedPagePacket[BufIndex - TxDescLen], - QosNullLength, _FALSE, _FALSE, _FALSE); + NullDataLength, _FALSE, _FALSE, _FALSE); - CurtPktPageNum = (u8)PageNum(TxDescLen + QosNullLength, PageSize); + CurtPktPageNum = (u8)PageNum(TxDescLen + NullDataLength, PageSize); - TotalPageNum += CurtPktPageNum; + TotalPageNum += CurtPktPageNum; - TotalPacketLen = BufIndex + QosNullLength; + BufIndex += (CurtPktPageNum * PageSize); + RSVD_PAGE_CFG("NullData", CurtPktPageNum, TotalPageNum, TotalPacketLen); + } + } - BufIndex += (CurtPktPageNum * PageSize); + /*======== Qos null data * 1 page ======== */ + if (pwrctl->wowlan_mode == _FALSE || + pwrctl->wowlan_in_resume == _TRUE) {/*Normal mode*/ + if (MLME_IS_STA(sta_iface) || (nr_assoc_if == 0)) { + RsvdPageLoc.LocQosNull = TotalPageNum; + RTW_INFO("LocQosNull: %d\n", RsvdPageLoc.LocQosNull); + rtw_hal_construct_NullFunctionData(sta_iface, + &ReservedPagePacket[BufIndex], + &QosNullLength, + _TRUE, 0, 0, _FALSE); + rtw_hal_fill_fake_txdesc(sta_iface, + &ReservedPagePacket[BufIndex - TxDescLen], + QosNullLength, _FALSE, _FALSE, _FALSE); + + CurtPktPageNum = (u8)PageNum(TxDescLen + QosNullLength, + PageSize); + + TotalPageNum += CurtPktPageNum; + + BufIndex += (CurtPktPageNum * PageSize); + RSVD_PAGE_CFG("QosNull", CurtPktPageNum, TotalPageNum, TotalPacketLen); + } + } + +#ifdef CONFIG_BT_COEXIST + /*======== BT Qos null data * 1 page ======== */ + if (pwrctl->wowlan_mode == _FALSE || + pwrctl->wowlan_in_resume == _TRUE) {/*Normal mode*/ + + ap_iface = adapter; + #ifdef CONFIG_CONCURRENT_MODE + if (!MLME_IS_AP(ap_iface) && DEV_AP_NUM(adapter_to_dvobj(ap_iface))) { /*DEV_AP_STARTING_NUM*/ + ap_iface = _rtw_search_ap_iface(adapter); + RTW_INFO("get ("ADPT_FMT") to create BTQoSNull\n", ADPT_ARG(ap_iface)); + } + #endif + + if (MLME_IS_AP(ap_iface) || (nr_assoc_if == 0)) { + RsvdPageLoc.LocBTQosNull = TotalPageNum; + + RTW_INFO("LocBTQosNull: %d\n", RsvdPageLoc.LocBTQosNull); + + rtw_hal_construct_NullFunctionData(ap_iface, + &ReservedPagePacket[BufIndex], + &BTQosNullLength, + _TRUE, 0, 0, _FALSE); + + rtw_hal_fill_fake_txdesc(ap_iface, + &ReservedPagePacket[BufIndex - TxDescLen], + BTQosNullLength, _FALSE, _TRUE, _FALSE); + + CurtPktPageNum = (u8)PageNum(TxDescLen + BTQosNullLength, + PageSize); + + TotalPageNum += CurtPktPageNum; + BufIndex += (CurtPktPageNum * PageSize); + + RSVD_PAGE_CFG("BTQosNull", CurtPktPageNum, TotalPageNum, TotalPacketLen); + } + } +#endif /* CONFIG_BT_COEXIT */ + + TotalPacketLen = BufIndex; + +#ifdef DBG_FW_DEBUG_MSG_PKT + /*======== FW DEBUG MSG * n page ======== */ + RsvdPageLoc.loc_fw_dbg_msg_pkt = TotalPageNum; + RTW_INFO("loc_fw_dbg_msg_pkt: %d\n", RsvdPageLoc.loc_fw_dbg_msg_pkt); + rtw_hal_construct_fw_dbg_msg_pkt( + adapter, + &ReservedPagePacket[BufIndex], + &fw_dbg_msg_pkt_len); + + rtw_hal_fill_fake_txdesc(adapter, + &ReservedPagePacket[BufIndex - TxDescLen], + fw_dbg_msg_pkt_len, _FALSE, _FALSE, _FALSE); + + CurtPktPageNum = (u8)PageNum(TxDescLen + fw_dbg_msg_pkt_len, PageSize); + + TotalPageNum += CurtPktPageNum; + + TotalPacketLen = BufIndex + fw_dbg_msg_pkt_len; + BufIndex += (CurtPktPageNum * PageSize); +#endif /*DBG_FW_DEBUG_MSG_PKT*/ + +#ifdef CONFIG_LPS_PG + rtw_lps_pg_set_rsvd_page(adapter, ReservedPagePacket, &BufIndex + , TxDescLen, PageSize, &TotalPageNum, is_wow_mode, page_num ? 1 : 0); + TotalPacketLen = BufIndex; +#endif #ifdef CONFIG_WOWLAN + /*======== WOW * n page ======== */ if (pwrctl->wowlan_mode == _TRUE && - pwrctl->wowlan_in_resume == _FALSE) { + pwrctl->wowlan_in_resume == _FALSE && + !(registry_par->suspend_type == FW_IPS_DISABLE_BBRF && !check_fwstate(pmlmepriv, _FW_LINKED))) {/*WOW mode*/ rtw_hal_set_wow_fw_rsvd_page(adapter, ReservedPagePacket, BufIndex, TxDescLen, PageSize, &TotalPageNum, &TotalPacketLen, &RsvdPageLoc); @@ -8409,37 +11135,36 @@ void rtw_hal_set_fw_rsvd_page(_adapter *adapter, bool finished) #endif /* CONFIG_WOWLAN */ #ifdef CONFIG_P2P_WOWLAN - if (_TRUE == pwrctl->wowlan_p2p_mode) { + /*======== P2P WOW * n page ======== */ + if (_TRUE == pwrctl->wowlan_p2p_mode) {/*WOW mode*/ rtw_hal_set_p2p_wow_fw_rsvd_page(adapter, ReservedPagePacket, BufIndex, TxDescLen, PageSize, &TotalPageNum, &TotalPacketLen, &RsvdPageLoc); } #endif /* CONFIG_P2P_WOWLAN */ -#ifdef CONFIG_LPS_PG - /* must reserved last 1 x page for LPS PG Info*/ - pwrctl->lpspg_rsvd_page_locate = TotalPageNum; - pwrctl->blpspg_info_up = _TRUE; -#endif + /*Note: BufIndex already add a TxDescOffset offset in first Beacon page + * The "TotalPacketLen" is calculate by BufIndex. + * We need to decrease TxDescOffset before doing length check. by yiwei + */ + TotalPacketLen = TotalPacketLen - TxDescOffset; download_page: + if (page_num) { + *page_num = TotalPageNum; + rtw_mfree(ReservedPagePacket, MAX_CMDBUF_SZ); + ReservedPagePacket = NULL; + RTW_INFO(FUNC_ADPT_FMT" Get [ %s ] RsvdPageNUm <==\n", + FUNC_ADPT_ARG(adapter), (is_wow_mode) ? "WOW" : "NOR"); + 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_ERR("%s(ERROR): rsvd page size is not enough!!TotalPacketLen %d, MaxRsvdPageBufSize %d\n", + RTW_ERR("%s : rsvd page size is not enough!!TotalPacketLen %d, MaxRsvdPageBufSize %d\n", __FUNCTION__, TotalPacketLen, MaxRsvdPageBufSize); rtw_warn_on(1); goto error; @@ -8448,8 +11173,8 @@ void rtw_hal_set_fw_rsvd_page(_adapter *adapter, bool finished) pattrib = &pcmdframe->attrib; update_mgntframe_attrib(adapter, pattrib); pattrib->qsel = QSLT_BEACON; - pattrib->pktlen = TotalPacketLen - TxDescOffset; - pattrib->last_txcmdsz = TotalPacketLen - TxDescOffset; + pattrib->pktlen = TotalPacketLen; + pattrib->last_txcmdsz = TotalPacketLen; #ifdef CONFIG_PCI_HCI dump_mgntframe(adapter, pcmdframe); #else @@ -8464,8 +11189,14 @@ void rtw_hal_set_fw_rsvd_page(_adapter *adapter, bool finished) RTW_INFO_DUMP("\n", ReservedPagePacket, TotalPacketLen); RTW_INFO(" ==================================================\n"); #endif - if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { + + + if (check_fwstate(pmlmepriv, _FW_LINKED) + || MLME_IS_AP(adapter) || MLME_IS_MESH(adapter)){ rtw_hal_set_FwRsvdPage_cmd(adapter, &RsvdPageLoc); +#ifdef DBG_FW_DEBUG_MSG_PKT + rtw_hal_set_fw_dbg_msg_pkt_rsvd_page_cmd(adapter, &RsvdPageLoc); +#endif /*DBG_FW_DEBUG_MSG_PKT*/ #ifdef CONFIG_WOWLAN if (pwrctl->wowlan_mode == _TRUE && pwrctl->wowlan_in_resume == _FALSE) @@ -8486,43 +11217,765 @@ 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); } -static void rtw_hal_set_hw_update_tsf(PADAPTER padapter) + +void rtw_hal_set_fw_rsvd_page(struct _ADAPTER *adapter, bool finished) { - struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + if (finished) + rtw_mi_tx_beacon_hdl(adapter); + else + _rtw_hal_set_fw_rsvd_page(adapter, finished, NULL); +} -#if defined(CONFIG_RTL8822B) || defined(CONFIG_MI_WITH_MBSSID_CAM) - RTW_INFO("[Warn] %s "ADPT_FMT" enter func\n", __func__, ADPT_ARG(padapter)); - rtw_warn_on(1); - return; -#endif +/** + * 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; - if (!pmlmeext->en_hw_update_tsf) - return; - /* check REG_RCR bit is set */ - if (!(rtw_read32(padapter, REG_RCR) & RCR_CBSSID_BCN)) - return; + _rtw_hal_set_fw_rsvd_page(adapter, _FALSE, &num); + + return num; +} + +static void hw_var_set_bcn_func(_adapter *adapter, u8 enable) +{ + u32 bcn_ctrl_reg; - /* enable hw update tsf function for non-AP */ - if (rtw_linked_check(padapter) && - check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) { #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)); - else + if (adapter->hw_port == HW_PORT1) + bcn_ctrl_reg = REG_BCN_CTRL_1; + else #endif - rtw_write8(padapter, REG_BCN_CTRL, rtw_read8(padapter, REG_BCN_CTRL) & (~DIS_TSF_UDT)); + bcn_ctrl_reg = REG_BCN_CTRL; + + if (enable) + rtw_write8(adapter, bcn_ctrl_reg, (EN_BCN_FUNCTION | EN_TXBCN_RPT)); + else { + u8 val8; + + val8 = rtw_read8(adapter, bcn_ctrl_reg); + val8 &= ~(EN_BCN_FUNCTION | EN_TXBCN_RPT); + +#ifdef CONFIG_BT_COEXIST + if (GET_HAL_DATA(adapter)->EEPROMBluetoothCoexist == 1) { + /* Always enable port0 beacon function for PSTDMA */ + if (REG_BCN_CTRL == bcn_ctrl_reg) + val8 |= EN_BCN_FUNCTION; + } +#endif + + rtw_write8(adapter, bcn_ctrl_reg, val8); } - pmlmeext->en_hw_update_tsf = _FALSE; + +#ifdef CONFIG_RTL8192F + if (IS_HARDWARE_TYPE_8192F(adapter)) { + u16 val16, val16_ori; + + val16_ori = val16 = rtw_read16(adapter, REG_WLAN_ACT_MASK_CTRL_1); + + #ifdef CONFIG_CONCURRENT_MODE + if (adapter->hw_port == HW_PORT1) { + if (enable) + val16 |= EN_PORT_1_FUNCTION; + else + val16 &= ~EN_PORT_1_FUNCTION; + } else + #endif + { + if (enable) + val16 |= EN_PORT_0_FUNCTION; + else + val16 &= ~EN_PORT_0_FUNCTION; + + #ifdef CONFIG_BT_COEXIST + if (GET_HAL_DATA(adapter)->EEPROMBluetoothCoexist == 1) + val16 |= EN_PORT_0_FUNCTION; + #endif + } + + if (val16 != val16_ori) + rtw_write16(adapter, REG_WLAN_ACT_MASK_CTRL_1, val16); + } +#endif +} + +static void hw_var_set_mlme_disconnect(_adapter *adapter) +{ + u8 val8; + + /* reject all data frames */ +#ifdef CONFIG_CONCURRENT_MODE + if (rtw_mi_check_status(adapter, MI_LINKED) == _FALSE) +#endif + rtw_write16(adapter, REG_RXFLTMAP2, 0x0000); + +#ifdef CONFIG_CONCURRENT_MODE + if (adapter->hw_port == HW_PORT1) { + /* reset TSF1 */ + rtw_write8(adapter, REG_DUAL_TSF_RST, BIT(1)); + + /* disable update TSF1 */ + rtw_iface_disable_tsf_update(adapter); + + if (!IS_HARDWARE_TYPE_8723D(adapter) + && !IS_HARDWARE_TYPE_8192F(adapter) + && !IS_HARDWARE_TYPE_8710B(adapter) + ) { + /* disable Port1's beacon function */ + val8 = rtw_read8(adapter, REG_BCN_CTRL_1); + val8 &= ~EN_BCN_FUNCTION; + rtw_write8(adapter, REG_BCN_CTRL_1, val8); + } + } else +#endif + { + /* reset TSF */ + rtw_write8(adapter, REG_DUAL_TSF_RST, BIT(0)); + + /* disable update TSF */ + rtw_iface_disable_tsf_update(adapter); + } +} + +static void hw_var_set_mlme_sitesurvey(_adapter *adapter, u8 enable) +{ + 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 (enable) { /* 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); + + rtw_hal_rcr_set_chk_bssid(adapter, MLME_SCAN_ENTER); + + /* Save orignal RRSR setting, only 8812 set RRSR after set ch/bw/band */ + #if defined (CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) + hal_data->RegRRSR = rtw_read32(adapter, REG_RRSR); + hal_data->RegRRSR &= 0x000FFFFF; + #endif + + #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); + + /* Restore orignal RRSR setting,only 8812 set RRSR after set ch/bw/band */ + #if defined (CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) + #ifdef RTW_DYNAMIC_RRSR + rtw_phydm_set_rrsr(adapter, hal_data->RegRRSR, TRUE); + #else/*RTW_DYNAMIC_RRSR*/ + u32 temp_RRSR; + temp_RRSR = rtw_read32(adapter, REG_RRSR); + temp_RRSR &= 0xFFF00000; + hal_data->RegRRSR |= temp_RRSR; + rtw_write32(adapter, REG_RRSR, hal_data->RegRRSR); + #endif/*RTW_DYNAMIC_RRSR*/ + #endif + + #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); + } + } +} + +static void hw_var_set_mlme_join(_adapter *adapter, u8 type) +{ + u8 val8; + u16 val16; + u32 val32; + u8 RetryLimit = RL_VAL_STA; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + struct mlme_priv *pmlmepriv = &adapter->mlmepriv; + +#ifdef CONFIG_CONCURRENT_MODE + if (type == 0) { + /* prepare to join */ + if (rtw_mi_get_ap_num(adapter) || rtw_mi_get_mesh_num(adapter)) + StopTxBeacon(adapter); + + /* enable to rx data frame.Accept all data frame */ + rtw_write16(adapter, REG_RXFLTMAP2, 0xFFFF); + + if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) + RetryLimit = (hal_data->CustomerID == RT_CID_CCX) ? RL_VAL_AP : RL_VAL_STA; + else /* Ad-hoc Mode */ + RetryLimit = RL_VAL_AP; + + rtw_iface_enable_tsf_update(adapter); + + } else if (type == 1) { + /* joinbss_event call back when join res < 0 */ + if (rtw_mi_check_status(adapter, MI_LINKED) == _FALSE) + rtw_write16(adapter, REG_RXFLTMAP2, 0x00); + + rtw_iface_disable_tsf_update(adapter); + + if (rtw_mi_get_ap_num(adapter) || rtw_mi_get_mesh_num(adapter)) { + ResumeTxBeacon(adapter); + + /* reset TSF 1/2 after ResumeTxBeacon */ + rtw_write8(adapter, REG_DUAL_TSF_RST, BIT(1) | BIT(0)); + } + + } else if (type == 2) { + /* sta add event call back */ + if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE)) { + /* fixed beacon issue for 8191su........... */ + rtw_write8(adapter, 0x542 , 0x02); + RetryLimit = RL_VAL_AP; + } + + if (rtw_mi_get_ap_num(adapter) || rtw_mi_get_mesh_num(adapter)) { + ResumeTxBeacon(adapter); + + /* reset TSF 1/2 after ResumeTxBeacon */ + rtw_write8(adapter, REG_DUAL_TSF_RST, BIT(1) | BIT(0)); + } + } + + val16 = BIT_SRL(RetryLimit) | BIT_LRL(RetryLimit); + rtw_write16(adapter, REG_RETRY_LIMIT, val16); +#else /* !CONFIG_CONCURRENT_MODE */ + if (type == 0) { /* prepare to join */ + /* enable to rx data frame.Accept all data frame */ + rtw_write16(adapter, REG_RXFLTMAP2, 0xFFFF); + + if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) + RetryLimit = (hal_data->CustomerID == RT_CID_CCX) ? RL_VAL_AP : RL_VAL_STA; + else /* Ad-hoc Mode */ + RetryLimit = RL_VAL_AP; + + rtw_iface_enable_tsf_update(adapter); + + } else if (type == 1) { /* joinbss_event call back when join res < 0 */ + rtw_write16(adapter, REG_RXFLTMAP2, 0x00); + + rtw_iface_disable_tsf_update(adapter); + + } else if (type == 2) { /* sta add event call back */ + if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE)) + RetryLimit = RL_VAL_AP; + } + + val16 = BIT_SRL(RetryLimit) | BIT_LRL(RetryLimit); + rtw_write16(adapter, REG_RETRY_LIMIT, val16); +#endif /* !CONFIG_CONCURRENT_MODE */ +} + +#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 */ + +#ifdef CONFIG_HW_P0_TSF_SYNC +#ifdef CONFIG_CONCURRENT_MODE +static void hw_port0_tsf_sync_sel(_adapter *adapter, u8 benable, u8 hw_port, u16 tr_offset) +{ + u8 val8; + u8 client_id = 0; + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + +#ifdef CONFIG_MCC_MODE + if (MCC_EN(adapter) && (rtw_hal_check_mcc_status(adapter, MCC_STATUS_DOING_MCC))) { + RTW_INFO("[MCC] do not set HW TSF sync\n"); + return; + } +#endif + /* check if port0 is already synced */ + if (benable && dvobj->p0_tsf.sync_port != MAX_HW_PORT && dvobj->p0_tsf.sync_port == hw_port) { + RTW_WARN(FUNC_ADPT_FMT ": port0 already enable TSF sync(%d)\n", + FUNC_ADPT_ARG(adapter), dvobj->p0_tsf.sync_port); + return; + } + + /* check if port0 already disable sync */ + if (!benable && dvobj->p0_tsf.sync_port == MAX_HW_PORT) { + RTW_WARN(FUNC_ADPT_FMT ": port0 already disable TSF sync\n", FUNC_ADPT_ARG(adapter)); + return; + } + + /* check if port0 sync to port0 */ + if (benable && hw_port == HW_PORT0) { + RTW_ERR(FUNC_ADPT_FMT ": hw_port is port0 under enable\n", FUNC_ADPT_ARG(adapter)); + rtw_warn_on(1); + return; + } + + /*0x5B4 [6:4] :SYNC_CLI_SEL - The selector for the CLINT port of sync tsft source for port 0*/ + /* Bit[5:4] : 0 for clint0, 1 for clint1, 2 for clint2, 3 for clint3. + Bit6 : 1= enable sync to port 0. 0=disable sync to port 0.*/ + + val8 = rtw_read8(adapter, REG_TIMER0_SRC_SEL); + + if (benable) { + /*Disable Port0's beacon function*/ + rtw_write8(adapter, REG_BCN_CTRL, rtw_read8(adapter, REG_BCN_CTRL) & ~BIT_EN_BCN_FUNCTION); + + /*Reg 0x518[15:0]: TSFTR_SYN_OFFSET*/ + if (tr_offset) + rtw_write16(adapter, REG_TSFTR_SYN_OFFSET, tr_offset); + + /*reg 0x577[6]=1*/ /*auto sync by tbtt*/ + rtw_write8(adapter, REG_MISC_CTRL, rtw_read8(adapter, REG_MISC_CTRL) | BIT_AUTO_SYNC_BY_TBTT); + + if (HW_PORT1 == hw_port) + client_id = 0; + else if (HW_PORT2 == hw_port) + client_id = 1; + else if (HW_PORT3 == hw_port) + client_id = 2; + else if (HW_PORT4 == hw_port) + client_id = 3; + + val8 &= 0x8F; + val8 |= (BIT(6) | (client_id << 4)); + + dvobj->p0_tsf.sync_port = hw_port; + dvobj->p0_tsf.offset = tr_offset; + rtw_write8(adapter, REG_TIMER0_SRC_SEL, val8); + + /*Enable Port0's beacon function*/ + rtw_write8(adapter, REG_BCN_CTRL, rtw_read8(adapter, REG_BCN_CTRL) | BIT_EN_BCN_FUNCTION); + RTW_INFO("%s Port_%d TSF sync to P0, timer offset :%d\n", __func__, hw_port, tr_offset); + } else { + val8 &= ~BIT(6); + + dvobj->p0_tsf.sync_port = MAX_HW_PORT; + dvobj->p0_tsf.offset = 0; + rtw_write8(adapter, REG_TIMER0_SRC_SEL, val8); + RTW_INFO("%s P0 TSF sync disable\n", __func__); + } +} +static _adapter * _search_ld_sta(_adapter *adapter, u8 include_self) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + u8 i; + _adapter *iface = NULL; + + if (rtw_mi_get_assoced_sta_num(adapter) == 0) { + RTW_ERR("STA_LD_NUM == 0\n"); + rtw_warn_on(1); + } + + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + if (!iface) + continue; + if (include_self == _FALSE && adapter == iface) + continue; + if (is_client_associated_to_ap(iface)) + break; + } + if (iface) + RTW_INFO("search STA iface -"ADPT_FMT"\n", ADPT_ARG(iface)); + return iface; +} +#endif /*CONFIG_CONCURRENT_MODE*/ +/*Correct port0's TSF*/ +/*#define DBG_P0_TSF_SYNC*/ +void hw_var_set_correct_tsf(PADAPTER adapter, u8 mlme_state) +{ +#ifdef CONFIG_CONCURRENT_MODE + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + u8 p0_tsfsync = _FALSE; + struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; + _adapter *sta_if = NULL; + u8 hw_port; + + RTW_INFO(FUNC_ADPT_FMT "\n", FUNC_ADPT_ARG(adapter)); + #ifdef DBG_P0_TSF_SYNC + RTW_INFO("[TSF_SYNC] AP_NUM = %d\n", rtw_mi_get_ap_num(adapter)); + RTW_INFO("[TSF_SYNC] MESH_NUM = %d\n", rtw_mi_get_mesh_num(adapter)); + RTW_INFO("[TSF_SYNC] LD_STA_NUM = %d\n", rtw_mi_get_assoced_sta_num(adapter)); + if (dvobj->p0_tsf.sync_port == MAX_HW_PORT) + RTW_INFO("[TSF_SYNC] org p0 sync port = N/A\n"); + else + RTW_INFO("[TSF_SYNC] org p0 sync port = %d\n", dvobj->p0_tsf.sync_port); + RTW_INFO("[TSF_SYNC] timer offset = %d\n", dvobj->p0_tsf.offset); + #endif + switch (mlme_state) { + case MLME_STA_CONNECTED : + { + hw_port = rtw_hal_get_port(adapter); + + if (!MLME_IS_STA(adapter)) { + RTW_ERR("STA CON state,but iface("ADPT_FMT") is not STA\n", ADPT_ARG(adapter)); + rtw_warn_on(1); + } + + if ((dvobj->p0_tsf.sync_port != MAX_HW_PORT) && (hw_port == HW_PORT0)) { + RTW_ERR(ADPT_FMT" is STA with P0 connected => DIS P0_TSF_SYNC\n", ADPT_ARG(adapter)); + rtw_warn_on(1); + hw_port0_tsf_sync_sel(adapter, _FALSE, 0, 0); + } + + if ((dvobj->p0_tsf.sync_port == MAX_HW_PORT) && + (rtw_mi_get_ap_num(adapter) || rtw_mi_get_mesh_num(adapter))) { + hw_port0_tsf_sync_sel(adapter, _TRUE, hw_port, 50);/*timer offset 50ms*/ + #ifdef DBG_P0_TSF_SYNC + RTW_INFO("[TSF_SYNC] STA_LINKED => EN P0_TSF_SYNC\n"); + #endif + } + } + break; + case MLME_STA_DISCONNECTED : + { + hw_port = rtw_hal_get_port(adapter); + + if (!MLME_IS_STA(adapter)) { + RTW_ERR("STA DIS_CON state,but iface("ADPT_FMT") is not STA\n", ADPT_ARG(adapter)); + rtw_warn_on(1); + } + + if (dvobj->p0_tsf.sync_port == hw_port) { + if (rtw_mi_get_assoced_sta_num(adapter) >= 2) { + /* search next appropriate sta*/ + sta_if = _search_ld_sta(adapter, _FALSE); + if (sta_if) { + hw_port = rtw_hal_get_port(sta_if); + hw_port0_tsf_sync_sel(adapter, _TRUE, hw_port, 50);/*timer offset 50ms*/ + #ifdef DBG_P0_TSF_SYNC + RTW_INFO("[TSF_SYNC] STA_DIS_CON => CHANGE P0_TSF_SYNC\n"); + #endif + } + } else if (rtw_mi_get_assoced_sta_num(adapter) == 1) { + hw_port0_tsf_sync_sel(adapter, _FALSE, 0, 0); + #ifdef DBG_P0_TSF_SYNC + RTW_INFO("[TSF_SYNC] STA_DIS_CON => DIS P0_TSF_SYNC\n"); + #endif + } + } + } + break; + case MLME_AP_STARTED : + case MLME_MESH_STARTED : + { + if (!(MLME_IS_AP(adapter) || MLME_IS_MESH(adapter))) { + RTW_ERR("AP START state,but iface("ADPT_FMT") is not AP\n", ADPT_ARG(adapter)); + rtw_warn_on(1); + } + + if ((dvobj->p0_tsf.sync_port == MAX_HW_PORT) && + rtw_mi_get_assoced_sta_num(adapter)) { + /* get port of sta */ + sta_if = _search_ld_sta(adapter, _FALSE); + if (sta_if) { + hw_port = rtw_hal_get_port(sta_if); + hw_port0_tsf_sync_sel(adapter, _TRUE, hw_port, 50);/*timer offset 50ms*/ + #ifdef DBG_P0_TSF_SYNC + RTW_INFO("[TSF_SYNC] AP_START => EN P0_TSF_SYNC\n"); + #endif + } + } + } + break; + case MLME_AP_STOPPED : + case MLME_MESH_STOPPED : + { + if (!(MLME_IS_AP(adapter) || MLME_IS_MESH(adapter))) { + RTW_ERR("AP START state,but iface("ADPT_FMT") is not AP\n", ADPT_ARG(adapter)); + rtw_warn_on(1); + } + /*stop ap mode*/ + if ((rtw_mi_get_ap_num(adapter) + rtw_mi_get_mesh_num(adapter) == 1) && + (dvobj->p0_tsf.sync_port != MAX_HW_PORT)) { + hw_port0_tsf_sync_sel(adapter, _FALSE, 0, 0); + #ifdef DBG_P0_TSF_SYNC + RTW_INFO("[TSF_SYNC] AP_STOP => DIS P0_TSF_SYNC\n"); + #endif + } + } + break; + default : + RTW_ERR(FUNC_ADPT_FMT" unknow state(0x%02x)\n", FUNC_ADPT_ARG(adapter), mlme_state); + break; + } + + /*#ifdef DBG_P0_TSF_SYNC*/ + #if 1 + if (dvobj->p0_tsf.sync_port == MAX_HW_PORT) + RTW_INFO("[TSF_SYNC] p0 sync port = N/A\n"); + else + RTW_INFO("[TSF_SYNC] p0 sync port = %d\n", dvobj->p0_tsf.sync_port); + RTW_INFO("[TSF_SYNC] timer offset = %d\n", dvobj->p0_tsf.offset); + #endif +#endif /*CONFIG_CONCURRENT_MODE*/ +} + +#else /*! CONFIG_HW_P0_TSF_SYNC*/ + +#ifdef CONFIG_MI_WITH_MBSSID_CAM +static void hw_var_set_correct_tsf(_adapter *adapter, u8 mlme_state) +{ + /*do nothing*/ +} +#else /* !CONFIG_MI_WITH_MBSSID_CAM*/ +static void rtw_hal_correct_tsf(_adapter *padapter, u8 hw_port, u64 tsf) +{ + if (hw_port == HW_PORT0) { + /*disable related TSF function*/ + rtw_write8(padapter, REG_BCN_CTRL, rtw_read8(padapter, REG_BCN_CTRL) & (~EN_BCN_FUNCTION)); +#if defined(CONFIG_RTL8192F) + rtw_write16(padapter, REG_WLAN_ACT_MASK_CTRL_1, rtw_read16(padapter, + REG_WLAN_ACT_MASK_CTRL_1) & ~EN_PORT_0_FUNCTION); +#endif + + rtw_write32(padapter, REG_TSFTR, tsf); + rtw_write32(padapter, REG_TSFTR + 4, tsf >> 32); + + /*enable related TSF function*/ + rtw_write8(padapter, REG_BCN_CTRL, rtw_read8(padapter, REG_BCN_CTRL) | EN_BCN_FUNCTION); +#if defined(CONFIG_RTL8192F) + rtw_write16(padapter, REG_WLAN_ACT_MASK_CTRL_1, rtw_read16(padapter, + REG_WLAN_ACT_MASK_CTRL_1) | EN_PORT_0_FUNCTION); +#endif + } else if (hw_port == HW_PORT1) { + /*disable related TSF function*/ + rtw_write8(padapter, REG_BCN_CTRL_1, rtw_read8(padapter, REG_BCN_CTRL_1) & (~EN_BCN_FUNCTION)); +#if defined(CONFIG_RTL8192F) + rtw_write16(padapter, REG_WLAN_ACT_MASK_CTRL_1, rtw_read16(padapter, + REG_WLAN_ACT_MASK_CTRL_1) & ~EN_PORT_1_FUNCTION); +#endif + + rtw_write32(padapter, REG_TSFTR1, tsf); + rtw_write32(padapter, REG_TSFTR1 + 4, tsf >> 32); + + /*enable related TSF function*/ + rtw_write8(padapter, REG_BCN_CTRL_1, rtw_read8(padapter, REG_BCN_CTRL_1) | EN_BCN_FUNCTION); +#if defined(CONFIG_RTL8192F) + rtw_write16(padapter, REG_WLAN_ACT_MASK_CTRL_1, rtw_read16(padapter, + REG_WLAN_ACT_MASK_CTRL_1) | EN_PORT_1_FUNCTION); +#endif + } else + RTW_INFO("%s-[WARN] "ADPT_FMT" invalid hw_port:%d\n", __func__, ADPT_ARG(padapter), hw_port); +} +static void hw_var_set_correct_tsf(_adapter *adapter, u8 mlme_state) +{ + 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 /*#ifdef CONFIG_MI_WITH_MBSSID_CAM*/ +#endif /*#ifdef CONFIG_HW_P0_TSF_SYNC*/ + +u64 rtw_hal_get_tsftr_by_port(_adapter *adapter, u8 port) +{ + struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); + u64 tsftr = 0; + + if (port >= hal_spec->port_num) { + RTW_ERR("%s invalid port(%d) \n", __func__, port); + goto exit; + } + + switch (rtw_get_chip_type(adapter)) { +#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822C) + case RTL8814A: + case RTL8822B: + case RTL8821C: + case RTL8822C: + { + u8 val8; + + /* 0x554[30:28] - BIT_BCN_TIMER_SEL_FWRD */ + val8 = rtw_read8(adapter, REG_MBSSID_BCN_SPACE + 3); + val8 &= 0x8F; + val8 |= port << 4; + rtw_write8(adapter, REG_MBSSID_BCN_SPACE + 3, val8); + + tsftr = rtw_read32(adapter, REG_TSFTR + 4); + tsftr = tsftr << 32; + tsftr |= rtw_read32(adapter, REG_TSFTR); + + break; + } +#endif +#if defined(CONFIG_RTL8188E) || defined(CONFIG_RTL8188F) || defined(CONFIG_RTL8188GTV) \ + || defined(CONFIG_RTL8192E) || defined(CONFIG_RTL8192F) \ + || defined(CONFIG_RTL8723B) || defined(CONFIG_RTL8703B) || defined(CONFIG_RTL8723D) \ + || defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) \ + || defined(CONFIG_RTL8710B) + case RTL8188E: + case RTL8188F: + case RTL8188GTV: + case RTL8192E: + case RTL8192F: + case RTL8723B: + case RTL8703B: + case RTL8723D: + case RTL8812: + case RTL8821: + case RTL8710B: + { + u32 addr; + + if (port == HW_PORT0) + addr = REG_TSFTR; + else if (port == HW_PORT1) + addr = REG_TSFTR1; + else { + RTW_ERR("%s unknown port(%d) \n", __func__, port); + goto exit; + } + + tsftr = rtw_read32(adapter, addr + 4); + tsftr = tsftr << 32; + tsftr |= rtw_read32(adapter, addr); + + break; + } +#endif + default: + RTW_ERR("%s unknow chip type\n", __func__); + } + +exit: + return tsftr; } #ifdef CONFIG_TDLS @@ -8553,28 +12006,127 @@ s32 rtw_hal_ch_sw_oper_offload(_adapter *padapter, u8 channel, u8 channel_offset #endif #endif -#ifdef CONFIG_WMMPS +#ifdef CONFIG_WMMPS_STA void rtw_hal_update_uapsd_tid(_adapter *adapter) { - rtw_write8(adapter, REG_WMMPS_UAPSD_TID, 0xFF); + 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 +#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) +s32 rtw_hal_set_wifi_btc_port_id_cmd(_adapter *adapter) { - u8 port_id = 0; u8 h2c_buf[H2C_BTC_WL_PORT_ID_LEN] = {0}; + u8 hw_port = rtw_hal_get_port(adapter); - SET_H2CCMD_BTC_WL_PORT_ID(h2c_buf, adapter->hw_port); + SET_H2CCMD_BTC_WL_PORT_ID(h2c_buf, hw_port); + RTW_INFO("%s ("ADPT_FMT") - hw_port :%d\n", __func__, ADPT_ARG(adapter), hw_port); return rtw_hal_fill_h2c_cmd(adapter, H2C_BTC_WL_PORT_ID, H2C_BTC_WL_PORT_ID_LEN, h2c_buf); } #endif -void SetHwReg(_adapter *adapter, u8 variable, u8 *val) +#define LPS_ACTIVE_TIMEOUT 10 /*number of times*/ +void rtw_lps_state_chk(_adapter *adapter, u8 ps_mode) +{ + if (ps_mode == PS_MODE_ACTIVE) { + u8 ps_ready = _FALSE; + s8 leave_wait_count = LPS_ACTIVE_TIMEOUT; + + do { + if ((rtw_read8(adapter, REG_TCR) & BIT_PWRBIT_OW_EN) == 0) { + ps_ready = _TRUE; + break; + } + rtw_msleep_os(1); + } while (leave_wait_count--); + + if (ps_ready == _FALSE) { + RTW_ERR(FUNC_ADPT_FMT" PS_MODE_ACTIVE check failed\n", FUNC_ADPT_ARG(adapter)); + rtw_warn_on(1); + } + } +} +void rtw_var_set_basic_rate(PADAPTER padapter, u8 *val) { + + PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); + struct mlme_ext_info *mlmext_info = &padapter->mlmeextpriv.mlmext_info; + u16 input_b = 0, masked = 0, ioted = 0, BrateCfg = 0; + u16 rrsr_2g_force_mask = RRSR_CCK_RATES; + u16 rrsr_2g_allow_mask = (RRSR_24M | RRSR_12M | RRSR_6M | RRSR_CCK_RATES); + #ifdef CONFIG_IEEE80211_BAND_5GHZ + u16 rrsr_5g_force_mask = (RRSR_6M); + u16 rrsr_5g_allow_mask = (RRSR_OFDM_RATES); + #endif + #ifdef RTW_DYNAMIC_RRSR + u32 temp_RRSR; + #endif + + HalSetBrateCfg(padapter, val, &BrateCfg); + input_b = BrateCfg; + + /* apply force and allow mask */ + #ifdef CONFIG_IEEE80211_BAND_5GHZ + if (pHalData->current_band_type != BAND_ON_2_4G) { + BrateCfg |= rrsr_5g_force_mask; + BrateCfg &= rrsr_5g_allow_mask; + } else + #endif + { /* 2.4G */ + BrateCfg |= rrsr_2g_force_mask; + BrateCfg &= rrsr_2g_allow_mask; + } + masked = BrateCfg; + +#ifdef CONFIG_CMCC_TEST + BrateCfg |= (RRSR_11M | RRSR_5_5M | RRSR_1M); /* use 11M to send ACK */ + BrateCfg |= (RRSR_24M | RRSR_18M | RRSR_12M); /*CMCC_OFDM_ACK 12/18/24M */ +#endif + + /* IOT consideration */ + if (mlmext_info->assoc_AP_vendor == HT_IOT_PEER_CISCO) { + /* if peer is cisco and didn't use ofdm rate, we enable 6M ack */ + if ((BrateCfg & (RRSR_24M | RRSR_12M | RRSR_6M)) == 0) + BrateCfg |= RRSR_6M; + } + ioted = BrateCfg; + +#ifdef CONFIG_NARROWBAND_SUPPORTING + if ((padapter->registrypriv.rtw_nb_config == RTW_NB_CONFIG_WIDTH_10) + || (padapter->registrypriv.rtw_nb_config == RTW_NB_CONFIG_WIDTH_5)) { + BrateCfg &= ~RRSR_CCK_RATES; + BrateCfg |= RRSR_6M; + } +#endif + pHalData->BasicRateSet = BrateCfg; + + RTW_INFO("HW_VAR_BASIC_RATE: %#x->%#x->%#x\n", input_b, masked, ioted); + + /* Set RRSR rate table. */ + #ifdef RTW_DYNAMIC_RRSR + temp_RRSR = rtw_read32(padapter, REG_RRSR); + temp_RRSR &=0xFFFF0000; + temp_RRSR |=BrateCfg; + rtw_phydm_set_rrsr(padapter, temp_RRSR, TRUE); + #else + rtw_write16(padapter, REG_RRSR, BrateCfg); + #endif + rtw_write8(padapter, REG_RRSR + 2, rtw_read8(padapter, REG_RRSR + 2) & 0xf0); + + #if defined(CONFIG_RTL8188E) + rtw_hal_set_hwreg(padapter, HW_VAR_INIT_RTS_RATE, (u8 *)&BrateCfg); + #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: { @@ -8583,6 +12135,12 @@ void SetHwReg(_adapter *adapter, u8 variable, u8 *val) rtw_hal_set_msr(adapter, net_type); } break; + case HW_VAR_DO_IQK: + if (*val) + hal_data->bNeedIQK = _TRUE; + else + hal_data->bNeedIQK = _FALSE; + break; case HW_VAR_MAC_ADDR: #ifdef CONFIG_MI_WITH_MBSSID_CAM rtw_hal_set_macaddr_mbid(adapter, val); @@ -8593,6 +12151,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; @@ -8615,14 +12185,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: @@ -8723,45 +12288,185 @@ void SetHwReg(_adapter *adapter, u8 variable, u8 *val) break; #endif /*defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN)*/ + case HW_VAR_BCN_FUNC: + hw_var_set_bcn_func(adapter, *val); + break; + + case HW_VAR_MLME_DISCONNECT: + hw_var_set_mlme_disconnect(adapter); + break; + + case HW_VAR_MLME_SITESURVEY: + hw_var_set_mlme_sitesurvey(adapter, *val); + #ifdef CONFIG_BT_COEXIST + if (hal_data->EEPROMBluetoothCoexist == 1) + rtw_btcoex_ScanNotify(adapter, *val ? _TRUE : _FALSE); + #endif + break; + + case HW_VAR_MLME_JOIN: + hw_var_set_mlme_join(adapter, *val); + #ifdef CONFIG_BT_COEXIST + if (hal_data->EEPROMBluetoothCoexist == 1) { + switch (*val) { + case 0: + /* Notify coex. mechanism before join */ + rtw_btcoex_ConnectNotify(adapter, _TRUE); + break; + case 1: + case 2: + /* Notify coex. mechanism after join, whether successful or failed */ + rtw_btcoex_ConnectNotify(adapter, _FALSE); + break; + } + } + #endif /* CONFIG_BT_COEXIST */ + 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, *val); + break; +#if defined(CONFIG_HW_P0_TSF_SYNC) && defined(CONFIG_CONCURRENT_MODE) + case HW_VAR_TSF_AUTO_SYNC: + if (*val == _TRUE) + hw_port0_tsf_sync_sel(adapter, _TRUE, adapter->hw_port, 50); + else + hw_port0_tsf_sync_sel(adapter, _FALSE, adapter->hw_port, 50); + break; +#endif case HW_VAR_APFM_ON_MAC: hal_data->bMacPwrCtrlOn = *val; RTW_INFO("%s: bMacPwrCtrlOn=%d\n", __func__, hal_data->bMacPwrCtrlOn); break; -#ifdef CONFIG_WMMPS +#ifdef CONFIG_WMMPS_STA case HW_VAR_UAPSD_TID: rtw_hal_update_uapsd_tid(adapter); break; -#endif +#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 + case HW_VAR_ENABLE_RX_BAR: + if (*val == _TRUE) { + /* enable RX BAR */ + u16 val16 = rtw_read16(adapter, REG_RXFLTMAP1); + val16 |= BIT(8); + rtw_write16(adapter, REG_RXFLTMAP1, val16); + } else { + /* disable RX BAR */ + u16 val16 = rtw_read16(adapter, REG_RXFLTMAP1); + + val16 &= (~BIT(8)); + rtw_write16(adapter, REG_RXFLTMAP1, val16); + } + RTW_INFO("[HW_VAR_ENABLE_RX_BAR] 0x%02X=0x%02X\n", + REG_RXFLTMAP1, rtw_read16(adapter, REG_RXFLTMAP1)); + break; + case HW_VAR_HCI_SUS_STATE: + hal_data->hci_sus_state = *(u8 *)val; + RTW_INFO("%s: hci_sus_state=%u\n", __func__, hal_data->hci_sus_state); + break; +#if defined(CONFIG_AP_MODE) && defined(CONFIG_FW_HANDLE_TXBCN) && defined(CONFIG_SUPPORT_MULTI_BCN) + case HW_VAR_BCN_HEAD_SEL: + { + u8 vap_id = *(u8 *)val; + + if ((vap_id >= CONFIG_LIMITED_AP_NUM) && (vap_id != 0xFF)) { + RTW_ERR(ADPT_FMT " vap_id(%d:%d) is invalid\n", ADPT_ARG(adapter),vap_id, adapter->vap_id); + rtw_warn_on(1); + } + if (MLME_IS_AP(adapter) || MLME_IS_MESH(adapter)) { + u16 drv_pg_bndy = 0, bcn_addr = 0; + u32 page_size = 0; + + /*rtw_hal_get_def_var(adapter, HAL_DEF_TX_PAGE_BOUNDARY, &drv_pg_bndy);*/ + rtw_halmac_get_rsvd_drv_pg_bndy(adapter_to_dvobj(adapter), &drv_pg_bndy); + rtw_hal_get_def_var(adapter, HAL_DEF_TX_PAGE_SIZE, (u8 *)&page_size); + + if (vap_id != 0xFF) + bcn_addr = drv_pg_bndy + (vap_id * (MAX_BEACON_LEN / page_size)); + else + bcn_addr = drv_pg_bndy; + RTW_INFO(ADPT_FMT" vap_id(%d) change BCN HEAD to 0x%04x\n", + ADPT_ARG(adapter), vap_id, bcn_addr); + rtw_write16(adapter, REG_FIFOPAGE_CTRL_2, + (bcn_addr & BIT_MASK_BCN_HEAD_1_V1) | BIT_BCN_VALID_V1); + } + } + break; +#endif + case HW_VAR_LPS_STATE_CHK : + rtw_lps_state_chk(adapter, *(u8 *)val); + break; + +#ifdef CONFIG_RTS_FULL_BW + case HW_VAR_SET_RTS_BW: + { + #ifdef RTW_HALMAC + rtw_halmac_set_rts_full_bw(adapter_to_dvobj(adapter), (*val)); + #else + u8 temp; + if(*val) + temp = (( rtw_read8(adapter, REG_INIRTS_RATE_SEL)) | BIT5 ); + else + temp = (( rtw_read8(adapter, REG_INIRTS_RATE_SEL)) & (~BIT5)); + rtw_write8(adapter, REG_INIRTS_RATE_SEL, temp); + /*RTW_INFO("HW_VAR_SET_RTS_BW val=%u REG480=0x%x\n", *val, rtw_read8(adapter, REG_INIRTS_RATE_SEL));*/ + #endif + } + break; +#endif/*CONFIG_RTS_FULL_BW*/ +#if defined(CONFIG_PCI_HCI) + case HW_VAR_ENSWBCN: + if (*val == _TRUE) { + rtw_write8(adapter, REG_CR + 1, + rtw_read8(adapter, REG_CR + 1) | BIT(0)); + } else + rtw_write8(adapter, REG_CR + 1, + rtw_read8(adapter, REG_CR + 1) & ~BIT(0)); + 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; case HW_VAR_RF_TYPE: *((u8 *)val) = hal_data->rf_type; +#ifdef CONFIG_CUSTOMER01_SMART_ANTENNA + *((u8 *)val) = RF_1T1R; +#endif break; case HW_VAR_MEDIA_STATUS: rtw_hal_get_msr(adapter, val); @@ -8778,6 +12483,63 @@ 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_HCI_SUS_STATE: + *((u8 *)val) = hal_data->hci_sus_state; + break; + + case HW_VAR_BCN_CTRL_ADDR: + *((u32 *)val) = hw_bcn_ctrl_addr(adapter, adapter->hw_port); + break; + +#ifdef CONFIG_WAPI_SUPPORT + case HW_VAR_CAM_EMPTY_ENTRY: { + u8 ucIndex = *((u8 *)val); + u8 i; + u32 ulCommand = 0; + u32 ulContent = 0; + u32 ulEncAlgo = CAM_AES; + + for (i = 0; i < CAM_CONTENT_COUNT; i++) { + /* filled id in CAM config 2 byte */ + if (i == 0) + ulContent |= (ucIndex & 0x03) | ((u16)(ulEncAlgo) << 2); + else + ulContent = 0; + /* polling bit, and No Write enable, and address */ + ulCommand = CAM_CONTENT_COUNT * ucIndex + i; + ulCommand = ulCommand | CAM_POLLINIG | CAM_WRITE; + /* write content 0 is equall to mark invalid */ + rtw_write32(adapter, REG_CAMWRITE, ulContent); /* delay_ms(40); */ + rtw_write32(adapter, REG_CAMCMD, ulCommand); /* delay_ms(40); */ + } + } +#endif + default: if (0) RTW_PRINT(FUNC_ADPT_FMT" variable(%d) not defined!\n", @@ -8787,6 +12549,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) { @@ -8804,9 +12587,6 @@ SetHalDefVar(_adapter *adapter, HAL_DEF_VARIABLE variable, void *value) case HAL_DEF_ANT_DETECT: hal_data->AntDetection = *((u8 *)value); break; - case HAL_DEF_DBG_DIS_PWT: - hal_data->bDisableTXPowerTraining = *((u8 *)value); - break; default: RTW_PRINT("%s: [WARNING] HAL_DEF_VARIABLE(%d) not defined!\n", __FUNCTION__, variable); bResult = _FAIL; @@ -8861,6 +12641,48 @@ u8 rtw_hal_query_txbfee_rf_num(_adapter *adapter) return 1; } +#ifdef RTW_BEAMFORMING_VERSION_2 +void rtw_hal_beamforming_config_csirate(PADAPTER adapter) +{ + struct dm_struct *p_dm_odm; + struct beamforming_info *bf_info; + u8 fix_rate_enable = 0; + u8 new_csi_rate_idx; + u8 rrsr_54_en; + u32 temp_rrsr; + + /* Acting as BFee */ + if (IS_BEAMFORMEE(adapter)) { + #if 0 + /* Do not enable now because it will affect MU performance and CTS/BA rate. 2016.07.19. by tynli. [PCIE-1660] */ + if (IS_HARDWARE_TYPE_8821C(Adapter)) + FixRateEnable = 1; /* Support after 8821C */ + #endif + + p_dm_odm = adapter_to_phydm(adapter); + bf_info = GET_BEAMFORM_INFO(adapter); + + rtw_halmac_bf_cfg_csi_rate(adapter_to_dvobj(adapter), + p_dm_odm->rssi_min, + bf_info->cur_csi_rpt_rate, + fix_rate_enable, &new_csi_rate_idx, &rrsr_54_en); + + temp_rrsr = rtw_read32(adapter,REG_RRSR); + if(rrsr_54_en == 1) + temp_rrsr |= BIT(HALMAC_OFDM54); + else if(rrsr_54_en == 0) + temp_rrsr &= ~(BIT(HALMAC_OFDM54)); + #ifdef RTW_DYNAMIC_RRSR + rtw_phydm_set_rrsr(adapter, temp_rrsr, FALSE); + #else + rtw_write32(adapter, REG_RRSR, temp_rrsr); + #endif + + if (new_csi_rate_idx != bf_info->cur_csi_rpt_rate) + bf_info->cur_csi_rpt_rate = new_csi_rate_idx; + } +} +#endif #endif u8 @@ -8879,7 +12701,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.undecorated_smoothed_pwdb; + *((int *)value) = psta->cmn.rssi_stat.rssi; } break; case HAL_DEF_DBG_DUMP_RXPKT: @@ -8891,14 +12713,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; - break; - case HAL_DEF_DBG_DIS_PWT: - *(u8 *)value = hal_data->bDisableTXPowerTraining; + *((u32 *)value) = _get_page_size(adapter); break; case HAL_DEF_EXPLICIT_BEAMFORMER: case HAL_DEF_EXPLICIT_BEAMFORMEE: @@ -8923,259 +12739,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); - struct PHY_DM_STRUCT *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_cmn_info_ptr_array_hook(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); */ - psta->rssi_level = 0; - odm_cmn_info_ptr_array_hook(podmpriv, ODM_CMNINFO_STA_STATUS, psta->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: - odm_cmn_info_init(podmpriv, ODM_CMNINFO_DOMAIN_CODE_2G, pHalData->Regulation2_4G); - odm_cmn_info_init(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_inband_noise_monitor(podmpriv, pinfo->is_pause_dig, pinfo->igi_value, 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->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_FA_CNT_DUMP: - if (*((u8 *)pValue1)) - podmpriv->debug_components |= (ODM_COMP_DIG | ODM_COMP_FA_CNT); - else - podmpriv->debug_components &= ~(ODM_COMP_DIG | ODM_COMP_FA_CNT); - break; - case HAL_ODM_DBG_FLAG: - odm_cmn_info_update(podmpriv, ODM_CMNINFO_DBG_COMP, *((u8Byte *)pValue1)); - break; - case HAL_ODM_DBG_LEVEL: - odm_cmn_info_update(podmpriv, ODM_CMNINFO_DBG_LEVEL, *((u4Byte *)pValue1)); - break; - case HAL_ODM_RX_INFO_DUMP: { - struct _FALSE_ALARM_STATISTICS *false_alm_cnt = (struct _FALSE_ALARM_STATISTICS *)phydm_get_structure(podmpriv , PHYDM_FALSEALMCNT); - struct _dynamic_initial_gain_threshold_ *pDM_DigTable = &podmpriv->dm_dig_table; - void *sel; - - sel = pValue1; - - _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, podmpriv->rssi_min, pDM_DigTable->cur_ig_value); - _RTW_PRINT_SEL(sel , "cnt_cck_fail = %d, cnt_ofdm_fail = %d, Total False Alarm = %d\n", false_alm_cnt->cnt_cck_fail, false_alm_cnt->cnt_ofdm_fail, false_alm_cnt->cnt_all); - - if (podmpriv->is_linked) { - _RTW_PRINT_SEL(sel , "rx_rate = %s", HDATA_RATE(podmpriv->rx_rate)); - _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_auto_channel_select_reset(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_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) -{ - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - struct PHY_DM_STRUCT *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->debug_components; - break; - case HAL_ODM_DBG_LEVEL: - *((u4Byte *)pValue1) = podmpriv->debug_level; - 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_get_auto_channel_select_result(podmpriv, BAND_ON_2_4G); - if (is_supported_5g(Adapter->registrypriv.wireless_mode)) - *((u8 *)(pValue2)) = odm_get_auto_channel_select_result(podmpriv, BAND_ON_5G); - } - break; -#endif -#ifdef CONFIG_ANTENNA_DIVERSITY - case HAL_ODM_ANTDIV_SELECT: { - struct _FAST_ANTENNA_TRAINNING_ *pDM_FatTable = &podmpriv->dm_fat_table; - *((u8 *)pValue1) = pDM_FatTable->rx_idle_ant; - } - break; -#endif - case HAL_ODM_INITIAL_GAIN: { - struct _dynamic_initial_gain_threshold_ *pDM_DigTable = &podmpriv->dm_dig_table; - *((u8 *)pValue1) = pDM_DigTable->cur_ig_value; - } - break; - default: - break; - } -} - - -u32 rtw_phydm_ability_ops(_adapter *adapter, HAL_PHYDM_OPS ops, u32 ability) -{ - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); - struct PHY_DM_STRUCT *podmpriv = &pHalData->odmpriv; - u32 result = 0; - - switch (ops) { - case HAL_PHYDM_DIS_ALL_FUNC: - podmpriv->support_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; - break; - case HAL_PHYDM_ABILITY_RESTORE: - /* restore dm flag */ - podmpriv->support_ability = podmpriv->bk_support_ability; - break; - case HAL_PHYDM_ABILITY_SET: - podmpriv->support_ability = ability; - break; - case HAL_PHYDM_ABILITY_GET: - result = podmpriv->support_ability; - break; - } - return result; -} - BOOLEAN eqNByte( @@ -9200,7 +12763,7 @@ eqNByte( * */ u32 MapCharToHexDigit( - IN char chTmp + char chTmp ) { if (chTmp >= '0' && chTmp <= '9') @@ -9221,9 +12784,9 @@ MapCharToHexDigit( * */ BOOLEAN GetHexValueFromString( - IN char *szStr, - IN OUT u32 *pu4bVal, - IN OUT u32 *pu4bMove + char *szStr, + u32 *pu4bVal, + u32 *pu4bMove ) { char *szScan = szStr; @@ -9270,10 +12833,10 @@ GetHexValueFromString( BOOLEAN GetFractionValueFromString( - IN char *szStr, - IN OUT u8 *pInteger, - IN OUT u8 *pFraction, - IN OUT u32 *pu4bMove + char *szStr, + u8 *pInteger, + u8 *pFraction, + u32 *pu4bMove ) { char *szScan = szStr; @@ -9289,6 +12852,9 @@ GetFractionValueFromString( ++(*pu4bMove); } + if (*szScan < '0' || *szScan > '9') + return _FALSE; + /* Parse each digit. */ do { (*pInteger) *= 10; @@ -9303,12 +12869,17 @@ GetFractionValueFromString( if (*szScan < '0' || *szScan > '9') return _FALSE; - else { - *pFraction = *szScan - '0'; + + *pFraction += (*szScan - '0') * 10; + ++szScan; + ++(*pu4bMove); + + if (*szScan >= '0' && *szScan <= '9') { + *pFraction += *szScan - '0'; ++szScan; ++(*pu4bMove); - return _TRUE; } + return _TRUE; } } while (*szScan >= '0' && *szScan <= '9'); @@ -9321,7 +12892,7 @@ GetFractionValueFromString( * */ BOOLEAN IsCommentString( - IN char *szStr + char *szStr ) { if (*szStr == '/' && *(szStr + 1) == '/') @@ -9332,8 +12903,8 @@ IsCommentString( BOOLEAN GetU1ByteIntegerFromStringInDecimal( - IN char *Str, - IN OUT u8 *pInt + char *Str, + u8 *pInt ) { u16 i = 0; @@ -9356,11 +12927,11 @@ GetU1ByteIntegerFromStringInDecimal( * If RightQualifier does not exist, it will hang on in the while loop */ BOOLEAN ParseQualifiedString( - IN char *In, - IN OUT u32 *Start, - OUT char *Out, - IN char LeftQualifier, - IN char RightQualifier + char *In, + u32 *Start, + char *Out, + char LeftQualifier, + char RightQualifier ) { u32 i = 0, j = 0; @@ -9370,8 +12941,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); @@ -9409,12 +12985,14 @@ void rtw_hal_check_rxfifo_full(_adapter *adapter) /* switch counter to RX fifo */ if (IS_8188E(pHalData->version_id) || IS_8188F(pHalData->version_id) || + IS_8188GTV(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)) { + IS_8723D_SERIES(pHalData->version_id) || + IS_8192F_SERIES(pHalData->version_id)) { rtw_write8(adapter, REG_RXERR_RPT + 3, rtw_read8(adapter, REG_RXERR_RPT + 3) | 0xa0); save_cnt = _TRUE; } else { @@ -9519,6 +13097,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); @@ -9526,11 +13108,10 @@ 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}; + u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; + u8 null_addr[ETH_ALEN] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; if (precvpriv->store_law_data_flag) { @@ -9546,53 +13127,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, ETH_ALEN) != _TRUE) + && (_rtw_memcmp(psta->cmn.mac_addr, null_addr, ETH_ALEN) != _TRUE) + && (_rtw_memcmp(psta->cmn.mac_addr, adapter_mac_addr(padapter), ETH_ALEN) != _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); + } } + } } } @@ -9613,7 +13179,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; - struct _odm_phy_status_info_ *p_phy_info = (struct _odm_phy_status_info_ *)(&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; @@ -9640,9 +13206,13 @@ 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; @@ -9663,61 +13233,6 @@ void rtw_store_phy_info(_adapter *padapter, union recv_frame *prframe) } - -int check_phy_efuse_tx_power_info_valid(PADAPTER padapter) -{ - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); - u8 *pContent = pHalData->efuse_eeprom_data; - int index = 0; - u16 tx_index_offset = 0x0000; - - switch (rtw_get_chip_type(padapter)) { - case RTL8723B: - tx_index_offset = EEPROM_TX_PWR_INX_8723B; - break; - case RTL8703B: - tx_index_offset = EEPROM_TX_PWR_INX_8703B; - break; - case RTL8723D: - tx_index_offset = EEPROM_TX_PWR_INX_8723D; - break; - case RTL8188E: - tx_index_offset = EEPROM_TX_PWR_INX_88E; - break; - case RTL8188F: - tx_index_offset = EEPROM_TX_PWR_INX_8188F; - break; - case RTL8192E: - tx_index_offset = EEPROM_TX_PWR_INX_8192E; - break; - case RTL8821: - tx_index_offset = EEPROM_TX_PWR_INX_8821; - break; - case RTL8812: - tx_index_offset = EEPROM_TX_PWR_INX_8812; - break; - case RTL8814A: - tx_index_offset = EEPROM_TX_PWR_INX_8814; - break; - case RTL8822B: - tx_index_offset = EEPROM_TX_PWR_INX_8822B; - break; - case RTL8821C: - tx_index_offset = EEPROM_TX_PWR_INX_8821C; - break; - default: - tx_index_offset = 0x0010; - break; - } - - /* TODO: chacking length by ICs */ - for (index = 0 ; index < 11 ; index++) { - if (pContent[tx_index_offset + index] == 0xFF) - return _FALSE; - } - return _TRUE; -} - int hal_efuse_macaddr_offset(_adapter *adapter) { u8 interface_type = 0; @@ -9773,6 +13288,14 @@ int hal_efuse_macaddr_offset(_adapter *adapter) addr_offset = EEPROM_MAC_ADDR_8188FS; break; #endif +#ifdef CONFIG_RTL8188GTV + case RTL8188GTV: + if (interface_type == RTW_USB) + addr_offset = EEPROM_MAC_ADDR_8188GTVU; + else if (interface_type == RTW_SDIO) + addr_offset = EEPROM_MAC_ADDR_8188GTVS; + break; +#endif #ifdef CONFIG_RTL8812A case RTL8812: if (interface_type == RTW_USB) @@ -9831,6 +13354,36 @@ int hal_efuse_macaddr_offset(_adapter *adapter) addr_offset = EEPROM_MAC_ADDR_8821CE; break; #endif /* CONFIG_RTL8821C */ + +#ifdef CONFIG_RTL8710B + case RTL8710B: + if (interface_type == RTW_USB) + addr_offset = EEPROM_MAC_ADDR_8710B; + break; +#endif + +#ifdef CONFIG_RTL8192F + case RTL8192F: + if (interface_type == RTW_USB) + addr_offset = EEPROM_MAC_ADDR_8192FU; + else if (interface_type == RTW_SDIO) + addr_offset = EEPROM_MAC_ADDR_8192FS; + else if (interface_type == RTW_PCIE) + addr_offset = EEPROM_MAC_ADDR_8192FE; + break; +#endif /* CONFIG_RTL8192F */ + +#ifdef CONFIG_RTL8822C + case RTL8822C: + if (interface_type == RTW_USB) + addr_offset = EEPROM_MAC_ADDR_8822CU; + else if (interface_type == RTW_SDIO) + addr_offset = EEPROM_MAC_ADDR_8822CS; + else if (interface_type == RTW_PCIE) + addr_offset = EEPROM_MAC_ADDR_8822CE; + break; +#endif /* CONFIG_RTL8822C */ + } if (addr_offset == -1) { @@ -9869,22 +13422,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 } @@ -9937,6 +13479,9 @@ int hal_config_macaddr(_adapter *adapter, bool autoload_fail) int addr_offset = hal_efuse_macaddr_offset(adapter); u8 *hw_addr = NULL; int ret = _SUCCESS; +#if defined(CONFIG_RTL8822B) && defined(CONFIG_USB_HCI) + u8 ft_mac_addr[ETH_ALEN] = {0x00, 0xff, 0xff, 0xff, 0xff, 0xff}; /* FT USB2 for 8822B */ +#endif if (autoload_fail) goto bypass_hw_pg; @@ -9956,6 +13501,11 @@ int hal_config_macaddr(_adapter *adapter, bool autoload_fail) hw_addr = addr; } +#if defined(CONFIG_RTL8822B) && defined(CONFIG_USB_HCI) + if (_rtw_memcmp(hw_addr, ft_mac_addr, ETH_ALEN)) + hw_addr[0] = 0xff; +#endif + /* check hw pg data */ if (hw_addr && rtw_check_invalid_mac_address(hw_addr, _TRUE) == _FALSE) { _rtw_memcpy(hal_data->EEPROMMACAddr, hw_addr, ETH_ALEN); @@ -10001,9 +13551,9 @@ void rtw_bb_rf_gain_offset(_adapter *padapter) u8 value = pHalData->EEPROMRFGainOffset; u8 tmp = 0x3e; u32 res, i = 0; - u4Byte ArrayLen = sizeof(Array_kfreemap) / sizeof(u32); - pu4Byte Array = Array_kfreemap; - u4Byte v1 = 0, v2 = 0, GainValue = 0, target = 0; + u32 ArrayLen = sizeof(Array_kfreemap) / sizeof(u32); + u32 *Array = Array_kfreemap; + u32 v1 = 0, v2 = 0, GainValue = 0, target = 0; if (registry_par->RegPwrTrimEnable == 2) { RTW_INFO("Registry kfree default force disable.\n"); @@ -10011,18 +13561,18 @@ void rtw_bb_rf_gain_offset(_adapter *padapter) } #if defined(CONFIG_RTL8723B) - if (value & BIT4 || (registry_par->RegPwrTrimEnable == 1)) { + if (value & BIT4 && (registry_par->RegPwrTrimEnable == 1)) { RTW_INFO("Offset RF Gain.\n"); RTW_INFO("Offset RF Gain. pHalData->EEPROMRFGainVal=0x%x\n", pHalData->EEPROMRFGainVal); 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); */ @@ -10050,7 +13600,7 @@ void rtw_bb_rf_gain_offset(_adapter *padapter) RTW_INFO("Using the default RF gain.\n"); #elif defined(CONFIG_RTL8188E) - if (value & BIT4 || (registry_par->RegPwrTrimEnable == 1)) { + if (value & BIT4 && (registry_par->RegPwrTrimEnable == 1)) { RTW_INFO("8188ES Offset RF Gain.\n"); RTW_INFO("8188ES Offset RF Gain. EEPROMRFGainVal=0x%x\n", pHalData->EEPROMRFGainVal); @@ -10208,10 +13758,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) || IS_HARDWARE_TYPE_8822CU(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)) { @@ -10248,7 +13806,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 */ @@ -10257,7 +13817,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)) */ @@ -10322,7 +13882,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); @@ -10335,18 +13897,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); @@ -10358,7 +13922,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) @@ -10369,19 +13934,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; @@ -10623,8 +14189,11 @@ void rtw_reset_mac_rx_counters(_adapter *padapter) /* If no packet rx, MaxRx clock be gating ,BIT_DISGCLK bit19 set 1 for fix*/ if (IS_HARDWARE_TYPE_8703B(padapter) || - IS_HARDWARE_TYPE_8723D(padapter) || - IS_HARDWARE_TYPE_8188F(padapter)) + IS_HARDWARE_TYPE_8723D(padapter) || + IS_HARDWARE_TYPE_8188F(padapter) || + IS_HARDWARE_TYPE_8188GTV(padapter) || + IS_HARDWARE_TYPE_8192F(padapter) || + IS_HARDWARE_TYPE_8822C(padapter)) phy_set_mac_reg(padapter, REG_RCR, BIT19, 0x1); /* reset mac counter */ @@ -10650,6 +14219,18 @@ void rtw_dump_phy_rx_counters(_adapter *padapter, struct dbg_rx_counter *rx_coun 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 if(IS_HARDWARE_TYPE_JAGUAR3(padapter)){ + cckok = phy_query_bb_reg(padapter, 0x2c04, 0xffff); + ofdmok = phy_query_bb_reg(padapter, 0x2c14, 0xffff); + htok = phy_query_bb_reg(padapter, 0x2c10, 0xffff); + vht_ok = phy_query_bb_reg(padapter, 0x2c0c, 0xffff); + cckcrc = phy_query_bb_reg(padapter, 0x2c04, 0xffff0000); + ofdmcrc = phy_query_bb_reg(padapter, 0x2c14, 0xffff0000); + htcrc = phy_query_bb_reg(padapter, 0x2c10, 0xffff0000); + vht_err = phy_query_bb_reg(padapter, 0x2c0c, 0xffff0000); + CCK_FA = phy_query_bb_reg(padapter, 0x1a5c, bMaskLWord); + OFDM_FA = phy_query_bb_reg(padapter, 0x2d00, bMaskLWord) - phy_query_bb_reg(padapter, 0x2de0, bMaskLWord); + } else { cckok = phy_query_bb_reg(padapter, 0xF88, bMaskDWord); ofdmok = phy_query_bb_reg(padapter, 0xF94, bMaskLWord); @@ -10678,12 +14259,29 @@ void rtw_reset_phy_trx_ok_counters(_adapter *padapter) if (IS_HARDWARE_TYPE_JAGUAR(padapter) || IS_HARDWARE_TYPE_JAGUAR2(padapter)) { phy_set_bb_reg(padapter, 0xB58, BIT0, 0x1); phy_set_bb_reg(padapter, 0xB58, BIT0, 0x0); + } else if(IS_HARDWARE_TYPE_JAGUAR3(padapter)) { + phy_set_bb_reg(padapter, 0x1EB4, BIT25, 0x1); + phy_set_bb_reg(padapter, 0x1EB4, BIT25, 0x0); + } else { + phy_set_bb_reg(padapter, 0xF14, BIT16, 0x1); + phy_set_bb_reg(padapter, 0xF14, BIT16, 0x0); } } + void rtw_reset_phy_rx_counters(_adapter *padapter) { /* reset phy counter */ - if (IS_HARDWARE_TYPE_JAGUAR(padapter) || IS_HARDWARE_TYPE_JAGUAR2(padapter)) { + if (IS_HARDWARE_TYPE_JAGUAR3(padapter)) { + /* reset CCK FA counter */ + phy_set_bb_reg(padapter, 0x1a2c, BIT(15) | BIT(14), 0); + phy_set_bb_reg(padapter, 0x1a2c, BIT(15) | BIT(14), 2); + + /* reset CCK CCA counter */ + phy_set_bb_reg(padapter, 0x1a2c, BIT(13) | BIT(12), 0); + phy_set_bb_reg(padapter, 0x1a2c, BIT(13) | BIT(12), 2); + rtw_reset_phy_trx_ok_counters(padapter); + + } else if (IS_HARDWARE_TYPE_JAGUAR(padapter) || IS_HARDWARE_TYPE_JAGUAR2(padapter)) { rtw_reset_phy_trx_ok_counters(padapter); phy_set_bb_reg(padapter, 0x9A4, BIT17, 0x1);/* reset OFDA FA counter */ @@ -10778,61 +14376,54 @@ 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_inband_noise_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); - struct PHY_DM_STRUCT *pDM_Odm = &pHalData->odmpriv; - struct _rate_adaptive_table_ *pRA_Table = &pDM_Odm->dm_ra_table; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); u8 curr_tx_sgi = 0; + struct ra_sta_info *ra_info; + if (!psta) + return curr_tx_sgi; + + if (padapter->fix_rate == 0xff) { #if defined(CONFIG_RTL8188E) - curr_tx_sgi = odm_ra_get_decision_rate_8188e(pDM_Odm, macid); +#if (RATE_ADAPTIVE_SUPPORT == 1) + curr_tx_sgi = hal_data->odmpriv.ra_info[psta->cmn.mac_id].rate_sgi; +#endif /* (RATE_ADAPTIVE_SUPPORT == 1)*/ #else - curr_tx_sgi = ((pRA_Table->link_tx_rate[macid]) & 0x80) >> 7; + ra_info = &psta->cmn.ra_info; + curr_tx_sgi = ((ra_info->curr_tx_rate) & 0x80) >> 7; #endif + } else { + curr_tx_sgi = ((padapter->fix_rate) & 0x80) >> 7; + } return curr_tx_sgi; - } -u8 rtw_get_current_tx_rate(_adapter *padapter, u8 macid) -{ - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); - struct PHY_DM_STRUCT *pDM_Odm = &pHalData->odmpriv; - struct _rate_adaptive_table_ *pRA_Table = &pDM_Odm->dm_ra_table; - u8 rate_id = 0; +u8 rtw_get_current_tx_rate(_adapter *padapter, struct sta_info *psta) +{ + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); + u8 rate_id = 0; + struct ra_sta_info *ra_info; + + if (!psta) + return rate_id; + + if (padapter->fix_rate == 0xff) { +#if defined(CONFIG_RTL8188E) #if (RATE_ADAPTIVE_SUPPORT == 1) - rate_id = odm_ra_get_decision_rate_8188e(pDM_Odm, macid); + rate_id = hal_data->odmpriv.ra_info[psta->cmn.mac_id].decision_rate; +#endif /* (RATE_ADAPTIVE_SUPPORT == 1)*/ #else - rate_id = (pRA_Table->link_tx_rate[macid]) & 0x7f; + ra_info = &psta->cmn.ra_info; + rate_id = ra_info->curr_tx_rate & 0x7f; #endif + } else { + rate_id = padapter->fix_rate & 0x7f; + } return rate_id; - } void update_IOT_info(_adapter *padapter) @@ -10849,14 +14440,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; @@ -10865,82 +14452,49 @@ 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; +#ifdef CONFIG_RTS_FULL_BW +/* +8188E: not support full RTS BW feature(mac REG no define 480[5]) +*/ +void rtw_set_rts_bw(_adapter *padapter) { + int i; + u8 enable = 1; + bool connect_to_8812 = _FALSE; + 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); + struct sta_info *station = NULL; - 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; + for (i = 0; i < macid_ctl->num; i++) { + if (rtw_macid_is_used(macid_ctl, i)) { - 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); + station = NULL; + station = macid_ctl->sta[i]; + if(station) { + + _adapter *sta_adapter =station->padapter; + struct mlme_ext_priv *pmlmeext = &(sta_adapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + + if ( pmlmeinfo->state != WIFI_FW_NULL_STATE) { + if(_rtw_memcmp(macid_ctl->sta[i]->cmn.mac_addr, bc_addr, ETH_ALEN) != _TRUE) { + if ( macid_ctl->sta[i]->vendor_8812) { + connect_to_8812 = _TRUE; + enable = 0; + } + } + } + } } -#endif - } -} -#endif - -/* TODO: merge with phydm, see odm_SetCrystalCap() */ -void hal_set_crystal_cap(_adapter *adapter, u8 crystal_cap) -{ - crystal_cap = crystal_cap & 0x3F; - - switch (rtw_get_chip_type(adapter)) { -#if defined(CONFIG_RTL8188E) || defined(CONFIG_RTL8188F) - case RTL8188E: - case RTL8188F: - /* write 0x24[16:11] = 0x24[22:17] = CrystalCap */ - 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_set_bb_reg(adapter, REG_MAC_PHY_CTRL, 0x7FF80000, (crystal_cap | (crystal_cap << 6))); - break; -#endif -#if defined(CONFIG_RTL8723B) || defined(CONFIG_RTL8703B) || \ - defined(CONFIG_RTL8723D) || defined(CONFIG_RTL8821A) || \ - defined(CONFIG_RTL8192E) - case RTL8723B: - case RTL8703B: - case RTL8723D: - case RTL8821: - case RTL8192E: - /* write 0x2C[23:18] = 0x2C[17:12] = CrystalCap */ - 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_set_bb_reg(adapter, REG_MAC_PHY_CTRL, 0x07FF8000, (crystal_cap | (crystal_cap << 6))); - break; -#endif -#if defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) - - case RTL8822B: - case RTL8821C: - /* write 0x28[6:1] = 0x24[30:25] = CrystalCap */ - crystal_cap = crystal_cap & 0x3F; - 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: - rtw_warn_on(1); + + if(connect_to_8812) + break; } + + RTW_INFO("%s connect_to_8812=%d,enable=%u\n", __FUNCTION__,connect_to_8812,enable); + rtw_hal_set_hwreg(padapter, HW_VAR_SET_RTS_BW, &enable); } +#endif/*CONFIG_RTS_FULL_BW*/ int hal_spec_init(_adapter *adapter) { @@ -10975,6 +14529,11 @@ int hal_spec_init(_adapter *adapter) init_hal_spec_8188f(adapter); break; #endif +#ifdef CONFIG_RTL8188GTV + case RTL8188GTV: + init_hal_spec_8188gtv(adapter); + break; +#endif #ifdef CONFIG_RTL8812A case RTL8812: init_hal_spec_8812a(adapter); @@ -11004,6 +14563,21 @@ int hal_spec_init(_adapter *adapter) case RTL8821C: init_hal_spec_rtl8821c(adapter); break; +#endif +#ifdef CONFIG_RTL8710B + case RTL8710B: + init_hal_spec_8710b(adapter); + break; +#endif +#ifdef CONFIG_RTL8192F + case RTL8192F: + init_hal_spec_8192f(adapter); + break; +#endif +#ifdef CONFIG_RTL8822C + case RTL8822C: + rtl8822c_init_hal_spec(adapter); + break; #endif default: RTW_ERR("%s: unknown chip_type:%u\n" @@ -11050,10 +14624,13 @@ void dump_hal_spec(void *sel, _adapter *adapter) int i; RTW_PRINT_SEL(sel, "macid_num:%u\n", hal_spec->macid_num); + RTW_PRINT_SEL(sel, "macid_cap:%u\n", hal_spec->macid_cap); RTW_PRINT_SEL(sel, "sec_cap:0x%02x\n", hal_spec->sec_cap); RTW_PRINT_SEL(sel, "sec_cam_ent_num:%u\n", hal_spec->sec_cam_ent_num); 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, "txgi_max:%u\n", hal_spec->txgi_max); + RTW_PRINT_SEL(sel, "txgi_pdbm:%u\n", hal_spec->txgi_pdbm); RTW_PRINT_SEL(sel, "max_tx_cnt:%u\n", hal_spec->max_tx_cnt); 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); @@ -11085,6 +14662,16 @@ void dump_hal_spec(void *sel, _adapter *adapter) _RTW_PRINT_SEL(sel, "%s ", _wl_func_str[i]); } _RTW_PRINT_SEL(sel, "\n"); + +#if CONFIG_TX_AC_LIFETIME + RTW_PRINT_SEL(sel, "tx_aclt_unit_factor:%u (unit:%uus)\n" + , hal_spec->tx_aclt_unit_factor, hal_spec->tx_aclt_unit_factor * 32); +#endif + + RTW_PRINT_SEL(sel, "rx_tsf_filter:%u\n", hal_spec->rx_tsf_filter); + + RTW_PRINT_SEL(sel, "pg_txpwr_saddr:0x%X\n", hal_spec->pg_txpwr_saddr); + RTW_PRINT_SEL(sel, "pg_txgi_diff_factor:%u\n", hal_spec->pg_txgi_diff_factor); } inline bool hal_chk_band_cap(_adapter *adapter, u8 cap) @@ -11147,13 +14734,20 @@ inline bool hal_is_wireless_mode_support(_adapter *adapter, u8 mode) return 0; } +inline bool hal_is_mimo_support(_adapter *adapter) +{ + if ((GET_HAL_SPEC(adapter)->tx_nss_num == 1) && + (GET_HAL_SPEC(adapter)->rx_nss_num == 1)) + return 0; + return 1; +} /* * 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) { @@ -11168,117 +14762,168 @@ u8 hal_largest_bw(_adapter *adapter, u8 in_bw) return in_bw; } -void rtw_hal_correct_tsf(_adapter *padapter, u8 hw_port, u64 tsf) -{ - if (hw_port == HW_PORT0) { - /*disable related TSF function*/ - rtw_write8(padapter, REG_BCN_CTRL, rtw_read8(padapter, REG_BCN_CTRL) & (~EN_BCN_FUNCTION)); - - rtw_write32(padapter, REG_TSFTR, tsf); - rtw_write32(padapter, REG_TSFTR + 4, tsf >> 32); - - /*enable related TSF function*/ - rtw_write8(padapter, REG_BCN_CTRL, rtw_read8(padapter, REG_BCN_CTRL) | EN_BCN_FUNCTION); - } else if (hw_port == HW_PORT1) { - /*disable related TSF function*/ - rtw_write8(padapter, REG_BCN_CTRL_1, rtw_read8(padapter, REG_BCN_CTRL_1) & (~EN_BCN_FUNCTION)); - - rtw_write32(padapter, REG_TSFTR1, tsf); - rtw_write32(padapter, REG_TSFTR1 + 4, tsf >> 32); - - /*enable related TSF function*/ - rtw_write8(padapter, REG_BCN_CTRL_1, rtw_read8(padapter, REG_BCN_CTRL_1) | EN_BCN_FUNCTION); - } else - RTW_INFO("%s-[WARN] "ADPT_FMT" invalid hw_port:%d\n", __func__, ADPT_ARG(padapter), hw_port); -} - void ResumeTxBeacon(_adapter *padapter) { - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); + 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); - /*TBTT hold time :4ms 0x540[19:8]*/ - rtw_write8(padapter, REG_TBTT_PROHIBIT + 1, - TBTT_PROBIHIT_HOLD_TIME & 0xFF); + /* 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_PROBIHIT_HOLD_TIME >> 8)); + (rtw_read8(padapter, REG_TBTT_PROHIBIT + 2) & 0xF0) | (TBTT_PROHIBIT_HOLD_TIME >> 8)); } void StopTxBeacon(_adapter *padapter) { - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); + 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); + /* 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)); - - /*CheckFwRsvdPageContent(padapter);*/ /* 2010.06.23. Added by tynli. */ + (rtw_read8(padapter, REG_TBTT_PROHIBIT + 2) & 0xF0) | (TBTT_PROHIBIT_HOLD_TIME_STOP_BCN >> 8)); } #ifdef CONFIG_MI_WITH_MBSSID_CAM /*HW port0 - MBSS*/ + +#ifdef CONFIG_CLIENT_PORT_CFG +const u8 _clt_port_id[MAX_CLIENT_PORT_NUM] = { + CLT_PORT0, + CLT_PORT1, + CLT_PORT2, + CLT_PORT3 +}; + +void rtw_clt_port_init(struct clt_port_t *cltp) +{ + cltp->bmp = 0; + cltp->num = 0; + _rtw_spinlock_init(&cltp->lock); +} +void rtw_clt_port_deinit(struct clt_port_t *cltp) +{ + _rtw_spinlock_free(&cltp->lock); +} +static void _hw_client_port_alloc(_adapter *adapter) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + struct clt_port_t *cltp = &dvobj->clt_port; + _irqL irql; + int i; + + #if 0 + if (cltp->num > MAX_CLIENT_PORT_NUM) { + RTW_ERR(ADPT_FMT" cann't alloc client (%d)\n", ADPT_ARG(adapter), cltp->num); + rtw_warn_on(1); + return; + } + #endif + + if (adapter->client_id != MAX_CLIENT_PORT_NUM) { + RTW_INFO(ADPT_FMT" client_id %d has allocated port:%d\n", + ADPT_ARG(adapter), adapter->client_id, adapter->client_port); + return; + } + _enter_critical_bh(&cltp->lock, &irql); + for (i = 0; i < MAX_CLIENT_PORT_NUM; i++) { + if (!(cltp->bmp & BIT(i))) + break; + } + + if (i < MAX_CLIENT_PORT_NUM) { + adapter->client_id = i; + cltp->bmp |= BIT(i); + adapter->client_port = _clt_port_id[i]; + } + cltp->num++; + _exit_critical_bh(&cltp->lock, &irql); + RTW_INFO("%s("ADPT_FMT")id:%d, port:%d clt_num:%d\n", + __func__, ADPT_ARG(adapter), adapter->client_id, adapter->client_port, cltp->num); +} +static void _hw_client_port_free(_adapter *adapter) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + struct clt_port_t *cltp = &dvobj->clt_port; + _irqL irql; + + #if 0 + if (adapter->client_id >= MAX_CLIENT_PORT_NUM) { + RTW_ERR(ADPT_FMT" client_id %d is invalid\n", ADPT_ARG(adapter), adapter->client_id); + /*rtw_warn_on(1);*/ + } + #endif + + RTW_INFO("%s ("ADPT_FMT") id:%d, port:%d clt_num:%d\n", + __func__, ADPT_ARG(adapter), adapter->client_id, adapter->client_port, cltp->num); + + _enter_critical_bh(&cltp->lock, &irql); + if (adapter->client_id != MAX_CLIENT_PORT_NUM) { + cltp->bmp &= ~ BIT(adapter->client_id); + adapter->client_id = MAX_CLIENT_PORT_NUM; + adapter->client_port = CLT_PORT_INVALID; + } + cltp->num--; + if (cltp->num < 0) + cltp->num = 0; + _exit_critical_bh(&cltp->lock, &irql); +} +void rtw_hw_client_port_allocate(_adapter *adapter) +{ + struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); + + if (hal_spec->port_num != 5) + return; + + _hw_client_port_alloc(adapter); +} +void rtw_hw_client_port_release(_adapter *adapter) +{ + struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); + + if (hal_spec->port_num != 5) + return; + + _hw_client_port_free(adapter); +} +#endif /*CONFIG_CLIENT_PORT_CFG*/ + 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))); - - /* disable Port0 TSF update*/ - rtw_write8(Adapter, REG_BCN_CTRL, rtw_read8(Adapter, REG_BCN_CTRL) | DIS_TSF_UDT); + rtw_hal_rcr_set_chk_bssid(Adapter, MLME_ACTION_NONE); /* set net_type */ 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*/ - } else if (mode == _HW_STATE_ADHOC_) { + } else if (mode == _HW_STATE_ADHOC_) ResumeTxBeacon(Adapter); - rtw_write8(Adapter, REG_BCN_CTRL, DIS_TSF_UDT | EN_BCN_FUNCTION | DIS_BCNQ_SUB); + else if (mode == _HW_STATE_AP_) + /* enable rx ps-poll */ + rtw_write16(Adapter, REG_RXFLTMAP1, rtw_read16(Adapter, REG_RXFLTMAP1) | BIT_CTRLFLT10EN); - } else if (mode == _HW_STATE_AP_) { - ResumeTxBeacon(Adapter); - - rtw_write8(Adapter, REG_BCN_CTRL, DIS_TSF_UDT | DIS_BCNQ_SUB); - - /*enable to rx data frame*/ - rtw_write16(Adapter, REG_RXFLTMAP2, 0xFFFF); - - /*Beacon Control related register for first time*/ - rtw_write8(Adapter, REG_BCNDMATIM, 0x02); /* 2ms */ - - /*rtw_write8(Adapter, REG_BCN_MAX_ERR, 0xFF);*/ - rtw_write8(Adapter, REG_ATIMWND, 0x0a); /* 10ms */ - 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*/ - rtw_write8(Adapter, REG_DUAL_TSF_RST, BIT(0)); - - /*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)); - - 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)); - - } + /* enable rx data frame */ + rtw_write16(Adapter, REG_RXFLTMAP2, 0xFFFF); +#ifdef CONFIG_CLIENT_PORT_CFG + if (mode == _HW_STATE_STATION_) + rtw_hw_client_port_allocate(Adapter); + else + rtw_hw_client_port_release(Adapter); +#endif +#if defined(CONFIG_RTL8192F) + rtw_write16(Adapter, REG_WLAN_ACT_MASK_CTRL_1, rtw_read16(Adapter, + REG_WLAN_ACT_MASK_CTRL_1) | EN_PORT_0_FUNCTION); +#endif } #endif @@ -11420,3 +15065,200 @@ void rtw_dump_phy_cap(void *sel, _adapter *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*/ + +static void _rf_type_to_ant_path(enum rf_type rf, enum bb_path *tx, + enum bb_path *rx) +{ + if (tx) { + 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; + } + } + + if (rx) { + 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; + } + } +} + +/** + * rtw_hal_get_rf_path() - Get RF path related information + * @d: struct dvobj_priv* + * @type: RF type, nTnR + * @tx: Tx path + * @rx: Rx path + * + * Get RF type, TX path and RX path information. + */ +void rtw_hal_get_rf_path(struct dvobj_priv *d, enum rf_type *type, + enum bb_path *tx, enum bb_path *rx) +{ + struct _ADAPTER *a; + u8 val8 = RF_1T1R; + enum rf_type rf; + + + a = dvobj_get_primary_adapter(d); +#ifndef CONFIG_CUSTOMER01_SMART_ANTENNA + rtw_hal_get_hwreg(a, HW_VAR_RF_TYPE, &val8); +#else + val8 = RF_2T2R; +#endif + rf = (enum rf_type)val8; + if (type) + *type = rf; + + if (tx || rx) + _rf_type_to_ant_path(rf, tx, rx); +} + +#ifdef RTW_CHANNEL_SWITCH_OFFLOAD +void rtw_hal_switch_chnl_and_set_bw_offload(_adapter *adapter, u8 central_ch, u8 pri_ch_idx, u8 bw) +{ + u8 h2c[H2C_SINGLE_CHANNELSWITCH_V2_LEN] = {0}; + PHAL_DATA_TYPE hal; + struct submit_ctx *chsw_sctx; + + hal = GET_HAL_DATA(adapter); + chsw_sctx = &hal->chsw_sctx; + + SET_H2CCMD_SINGLE_CH_SWITCH_V2_CENTRAL_CH_NUM(h2c, central_ch); + SET_H2CCMD_SINGLE_CH_SWITCH_V2_PRIMARY_CH_IDX(h2c, pri_ch_idx); + SET_H2CCMD_SINGLE_CH_SWITCH_V2_BW(h2c, bw); + + rtw_sctx_init(chsw_sctx, 10); + rtw_hal_fill_h2c_cmd(adapter, H2C_SINGLE_CHANNELSWITCH_V2, H2C_SINGLE_CHANNELSWITCH_V2_LEN, h2c); + rtw_sctx_wait(chsw_sctx, __func__); +} +#endif /* RTW_CHANNEL_SWITCH_OFFLOAD */ + +#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8812A) ||\ + defined(CONFIG_RTL8192F) || defined(CONFIG_RTL8192E) ||\ + defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821A) ||\ + defined (CONFIG_RTL8822C) +u8 phy_get_current_tx_num( + PADAPTER pAdapter, + u8 Rate +) +{ + u8 tx_num = RF_1TX; + + if (IS_1T_RATE(Rate)) { + #if defined(CONFIG_RTW_TX_2PATH_EN) + tx_num = RF_2TX; + #else + tx_num = RF_1TX; + #endif + } else if (IS_2T_RATE(Rate)) + tx_num = RF_2TX; + else if (IS_3T_RATE(Rate)) + tx_num = RF_3TX; + else + rtw_warn_on(1); + + return tx_num; +} +#endif +#ifdef CONFIG_RTL8812A +u8 * rtw_hal_set_8812a_vendor_ie(_adapter *padapter , u8 *pframe ,uint *frlen ) { + int vender_len = 7; + unsigned char vendor_info[vender_len]; + unsigned char REALTEK_OUI[] = {0x00, 0xe0, 0x4c}; + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); + + if( !IS_HARDWARE_TYPE_8812(padapter) ) + return pframe; + + _rtw_memset(vendor_info,0,vender_len); + _rtw_memcpy(vendor_info, REALTEK_OUI, 3); + vendor_info[4] =2; + if(pHalData->version_id.CUTVersion > B_CUT_VERSION ) + vendor_info[6] = RT_HT_CAP_USE_JAGUAR_CCUT; + else + vendor_info[6] = RT_HT_CAP_USE_JAGUAR_BCUT; + pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_,vender_len,vendor_info , frlen); + + return pframe; +} +#endif /*CONFIG_RTL8812A*/ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_com_c2h.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_com_c2h.h index 6b7e9872e3e4..1f826e6a6a18 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_com_c2h.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_com_c2h.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -75,6 +71,10 @@ typedef enum _C2H_EVT { C2H_DEFEATURE_DBG = 0x22, C2H_CUSTOMER_STR_RPT = 0x24, C2H_CUSTOMER_STR_RPT_2 = 0x25, + C2H_WLAN_INFO = 0x27, +#ifdef RTW_PER_CMD_SUPPORT_FW + C2H_PER_RATE_RPT = 0x2c, +#endif C2H_DEFEATURE_RSVD = 0xFD, C2H_EXTEND = 0xff, } C2H_EVT; @@ -100,6 +100,8 @@ int c2h_mac_hidden_rpt_hdl(_adapter *adapter, u8 *data, u8 len); #define MAC_HIDDEN_RPT_2_LEN 5 int c2h_mac_hidden_rpt_2_hdl(_adapter *adapter, u8 *data, u8 len); int hal_read_mac_hidden_rpt(_adapter *adapter); +#else +#define hal_read_mac_hidden_rpt(adapter) _SUCCESS #endif /* CONFIG_RTW_MAC_HIDDEN_RPT */ /* C2H_DEFEATURE_DBG, 0x22 */ @@ -116,4 +118,9 @@ int c2h_customer_str_rpt_hdl(_adapter *adapter, u8 *data, u8 len); int c2h_customer_str_rpt_2_hdl(_adapter *adapter, u8 *data, u8 len); #endif /* CONFIG_RTW_CUSTOMER_STR */ +#ifdef RTW_PER_CMD_SUPPORT_FW +/* C2H_PER_RATE_RPT, 0x2c */ +int c2h_per_rate_rpt_hdl(_adapter *adapter, u8 *data, u8 len); +#endif + #endif /* __COMMON_C2H_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_com_phycfg.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_com_phycfg.c index 40f733b39239..0433406d1e87 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_com_phycfg.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_com_phycfg.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,27 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 #include +#define PG_TXPWR_1PATH_BYTE_NUM_2G 18 +#define PG_TXPWR_BASE_BYTE_NUM_2G 11 + +#define PG_TXPWR_1PATH_BYTE_NUM_5G 24 +#define PG_TXPWR_BASE_BYTE_NUM_5G 14 + #define PG_TXPWR_MSB_DIFF_S4BIT(_pg_v) (((_pg_v) & 0xf0) >> 4) #define PG_TXPWR_LSB_DIFF_S4BIT(_pg_v) ((_pg_v) & 0x0f) #define PG_TXPWR_MSB_DIFF_TO_S8BIT(_pg_v) ((PG_TXPWR_MSB_DIFF_S4BIT(_pg_v) & BIT3) ? (PG_TXPWR_MSB_DIFF_S4BIT(_pg_v) | 0xF0) : PG_TXPWR_MSB_DIFF_S4BIT(_pg_v)) #define PG_TXPWR_LSB_DIFF_TO_S8BIT(_pg_v) ((PG_TXPWR_LSB_DIFF_S4BIT(_pg_v) & BIT3) ? (PG_TXPWR_LSB_DIFF_S4BIT(_pg_v) | 0xF0) : PG_TXPWR_LSB_DIFF_S4BIT(_pg_v)) -#define IS_PG_TXPWR_BASE_INVALID(_base) ((_base) > 63) +#define IS_PG_TXPWR_BASE_INVALID(hal_spec, _base) ((_base) > hal_spec->txgi_max) #define IS_PG_TXPWR_DIFF_INVALID(_diff) ((_diff) > 7 || (_diff) < -8) #define PG_TXPWR_INVALID_BASE 255 #define PG_TXPWR_INVALID_DIFF 8 -#if !IS_PG_TXPWR_BASE_INVALID(PG_TXPWR_INVALID_BASE) -#error "PG_TXPWR_BASE definition has problem" -#endif - #if !IS_PG_TXPWR_DIFF_INVALID(PG_TXPWR_INVALID_DIFF) #error "PG_TXPWR_DIFF definition has problem" #endif @@ -57,7 +55,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 +140,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 +223,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 @@ -257,6 +257,14 @@ static const struct map_t rtl8188f_pg_txpwr_def_info = ); #endif +#ifdef CONFIG_RTL8188GTV +static const struct map_t rtl8188gtv_pg_txpwr_def_info = + MAP_ENT(0xB8, 1, 0xFF + , MAPSEG_ARRAY_ENT(0x10, 12, + 0x22, 0x22, 0x22, 0x22, 0x22, 0x22, 0x27, 0x27, 0x27, 0x27, 0x27, 0x24) + ); +#endif + #ifdef CONFIG_RTL8723B static const struct map_t rtl8723b_pg_txpwr_def_info = MAP_ENT(0xB8, 2, 0xFF @@ -309,13 +317,21 @@ static const struct map_t rtl8821a_pg_txpwr_def_info = static const struct map_t rtl8821c_pg_txpwr_def_info = MAP_ENT(0xB8, 1, 0xFF , MAPSEG_ARRAY_ENT(0x10, 54, - 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xFF, 0xFF, 0xFF, 0xFF, - 0xFF, 0xFF, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, + 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02, 0xFF, 0xFF, 0xFF, 0xFF, + 0xFF, 0xFF, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x28, 0x02, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xEC, 0xFF, 0xFF, 0xFF, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x02) ); #endif +#ifdef CONFIG_RTL8710B +static const struct map_t rtl8710b_pg_txpwr_def_info = + MAP_ENT(0xC8, 1, 0xFF + , MAPSEG_ARRAY_ENT(0x20, 12, + 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x20) + ); +#endif + #ifdef CONFIG_RTL8812A static const struct map_t rtl8812a_pg_txpwr_def_info = MAP_ENT(0xB8, 1, 0xFF @@ -342,6 +358,19 @@ static const struct map_t rtl8822b_pg_txpwr_def_info = ); #endif +#ifdef CONFIG_RTL8822C +static const struct map_t rtl8822c_pg_txpwr_def_info = + MAP_ENT(0xB8, 1, 0xFF + , MAPSEG_ARRAY_ENT(0x10, 82, + 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x02, 0x00, 0x00, 0xFF, 0xFF, + 0xFF, 0xFF, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, + 0x02, 0x00, 0xFF, 0xFF, 0x00, 0xFF, 0x00, 0x00, 0xFF, 0xFF, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, + 0x33, 0x33, 0x33, 0x33, 0x33, 0x02, 0x00, 0x00, 0xFF, 0xFF, 0xFF, 0xFF, 0x33, 0x33, 0x33, 0x33, + 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x33, 0x02, 0x00, 0xFF, 0xFF, 0x00, 0xFF, + 0x00, 0x00) + ); +#endif + #ifdef CONFIG_RTL8814A static const struct map_t rtl8814a_pg_txpwr_def_info = MAP_ENT(0xB8, 1, 0xFF @@ -360,6 +389,16 @@ static const struct map_t rtl8814a_pg_txpwr_def_info = ); #endif +#ifdef CONFIG_RTL8192F/*use 8192F default,no document*/ +static const struct map_t rtl8192f_pg_txpwr_def_info = + MAP_ENT(0xB8, 2, 0xFF + , MAPSEG_ARRAY_ENT(0x10, 14, + 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24, 0xEE, 0xEE) + , MAPSEG_ARRAY_ENT(0x3A, 14, + 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x2D, 0x24, 0xEE, 0xEE) + ); +#endif + const struct map_t *hal_pg_txpwr_def_info(_adapter *adapter) { u8 interface_type = 0; @@ -393,6 +432,11 @@ const struct map_t *hal_pg_txpwr_def_info(_adapter *adapter) map = &rtl8188f_pg_txpwr_def_info; break; #endif +#ifdef CONFIG_RTL8188GTV + case RTL8188GTV: + map = &rtl8188gtv_pg_txpwr_def_info; + break; +#endif #ifdef CONFIG_RTL8812A case RTL8812: map = &rtl8812a_pg_txpwr_def_info; @@ -422,6 +466,21 @@ const struct map_t *hal_pg_txpwr_def_info(_adapter *adapter) case RTL8821C: map = &rtl8821c_pg_txpwr_def_info; break; +#endif +#ifdef CONFIG_RTL8710B + case RTL8710B: + map = &rtl8710b_pg_txpwr_def_info; + break; +#endif +#ifdef CONFIG_RTL8192F + case RTL8192F: + map = &rtl8192f_pg_txpwr_def_info; + break; +#endif +#ifdef CONFIG_RTL8822C + case RTL8822C: + map = &rtl8822c_pg_txpwr_def_info; + break; #endif } @@ -446,8 +505,8 @@ static u8 hal_chk_pg_txpwr_info_2g(_adapter *adapter, TxPowerInfo24G *pwr_info) if (!HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path)) continue; for (group = 0; group < MAX_CHNL_GROUP_24G; group++) { - if (IS_PG_TXPWR_BASE_INVALID(pwr_info->IndexCCK_Base[path][group]) - || IS_PG_TXPWR_BASE_INVALID(pwr_info->IndexBW40_Base[path][group])) + if (IS_PG_TXPWR_BASE_INVALID(hal_spec, pwr_info->IndexCCK_Base[path][group]) + || IS_PG_TXPWR_BASE_INVALID(hal_spec, pwr_info->IndexBW40_Base[path][group])) return _FAIL; } for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) { @@ -477,7 +536,7 @@ static u8 hal_chk_pg_txpwr_info_5g(_adapter *adapter, TxPowerInfo5G *pwr_info) if (!HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path)) continue; for (group = 0; group < MAX_CHNL_GROUP_5G; group++) - if (IS_PG_TXPWR_BASE_INVALID(pwr_info->IndexBW40_Base[path][group])) + if (IS_PG_TXPWR_BASE_INVALID(hal_spec, pwr_info->IndexBW40_Base[path][group])) return _FAIL; for (tx_idx = 0; tx_idx < MAX_TX_COUNT; tx_idx++) { if (!HAL_SPEC_CHK_TX_CNT(hal_spec, tx_idx)) @@ -578,8 +637,6 @@ u16 hal_load_pg_txpwr_info_path_2g( const struct map_t *txpwr_map, u16 pg_offset) { -#define PG_TXPWR_1PATH_BYTE_NUM_2G 18 - struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); u16 offset = pg_offset; u8 group, tx_idx; @@ -598,8 +655,8 @@ u16 hal_load_pg_txpwr_info_path_2g( for (group = 0; group < MAX_CHNL_GROUP_24G; group++) { if (HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path)) { tmp_base = map_read8(txpwr_map, offset); - if (!IS_PG_TXPWR_BASE_INVALID(tmp_base) - && IS_PG_TXPWR_BASE_INVALID(pwr_info->IndexCCK_Base[path][group]) + if (!IS_PG_TXPWR_BASE_INVALID(hal_spec, tmp_base) + && IS_PG_TXPWR_BASE_INVALID(hal_spec, pwr_info->IndexCCK_Base[path][group]) ) { pwr_info->IndexCCK_Base[path][group] = tmp_base; if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) @@ -612,8 +669,8 @@ u16 hal_load_pg_txpwr_info_path_2g( for (group = 0; group < MAX_CHNL_GROUP_24G - 1; group++) { if (HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path)) { tmp_base = map_read8(txpwr_map, offset); - if (!IS_PG_TXPWR_BASE_INVALID(tmp_base) - && IS_PG_TXPWR_BASE_INVALID(pwr_info->IndexBW40_Base[path][group]) + if (!IS_PG_TXPWR_BASE_INVALID(hal_spec, tmp_base) + && IS_PG_TXPWR_BASE_INVALID(hal_spec, pwr_info->IndexBW40_Base[path][group]) ) { pwr_info->IndexBW40_Base[path][group] = tmp_base; if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) @@ -696,7 +753,7 @@ u16 hal_load_pg_txpwr_info_path_2g( rtw_warn_on(1); } -exit: +exit: return offset; } @@ -708,8 +765,6 @@ u16 hal_load_pg_txpwr_info_path_5g( const struct map_t *txpwr_map, u16 pg_offset) { -#define PG_TXPWR_1PATH_BYTE_NUM_5G 24 - struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); u16 offset = pg_offset; u8 group, tx_idx; @@ -724,7 +779,7 @@ u16 hal_load_pg_txpwr_info_path_5g( offset += PG_TXPWR_1PATH_BYTE_NUM_5G; goto exit; } - + #ifdef CONFIG_IEEE80211_BAND_5GHZ if (DBG_PG_TXPWR_READ) RTW_INFO("%s[%c] eaddr:0x%03x\n", __func__, rf_path_char(path), offset); @@ -732,8 +787,8 @@ u16 hal_load_pg_txpwr_info_path_5g( for (group = 0; group < MAX_CHNL_GROUP_5G; group++) { if (HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path)) { tmp_base = map_read8(txpwr_map, offset); - if (!IS_PG_TXPWR_BASE_INVALID(tmp_base) - && IS_PG_TXPWR_BASE_INVALID(pwr_info->IndexBW40_Base[path][group]) + if (!IS_PG_TXPWR_BASE_INVALID(hal_spec, tmp_base) + && IS_PG_TXPWR_BASE_INVALID(hal_spec, pwr_info->IndexBW40_Base[path][group]) ) { pwr_info->IndexBW40_Base[path][group] = tmp_base; if (LOAD_PG_TXPWR_WARN_COND(txpwr_src)) @@ -787,7 +842,7 @@ u16 hal_load_pg_txpwr_info_path_5g( } offset++; } - } + } /* OFDM diff 2T ~ 3T */ if (HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path) && HAL_SPEC_CHK_TX_CNT(hal_spec, 1)) { @@ -881,7 +936,7 @@ void hal_load_pg_txpwr_info( hal_init_pg_txpwr_info_5g(adapter, pwr_info_5g); select_src: - pg_offset = 0x10; + pg_offset = hal_spec->pg_txpwr_saddr; switch (txpwr_src) { case PG_TXPWR_SRC_PG_DATA: @@ -920,16 +975,89 @@ 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; } +#ifdef CONFIG_EFUSE_CONFIG_FILE + +#define EFUSE_POWER_INDEX_INVALID 0xFF + +static u8 _check_phy_efuse_tx_power_info_valid(u8 *pg_data, int base_len, u16 pg_offset) +{ + int ff_cnt = 0; + int i; + + for (i = 0; i < base_len; i++) { + if (*(pg_data + pg_offset + i) == 0xFF) + ff_cnt++; + } + + if (ff_cnt == 0) + return _TRUE; + else if (ff_cnt == base_len) + return _FALSE; + else + return EFUSE_POWER_INDEX_INVALID; +} + +int check_phy_efuse_tx_power_info_valid(_adapter *adapter) +{ + struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + u8 *pg_data = hal_data->efuse_eeprom_data; + u16 pg_offset = hal_spec->pg_txpwr_saddr; + u8 path; + u8 valid_2g_path_bmp = 0; +#ifdef CONFIG_IEEE80211_BAND_5GHZ + u8 valid_5g_path_bmp = 0; +#endif + int result = _FALSE; + + for (path = 0; path < MAX_RF_PATH; path++) { + u8 ret = _FALSE; + + if (!HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path) && !HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path)) + break; + + if (HAL_SPEC_CHK_RF_PATH_2G(hal_spec, path)) { + ret = _check_phy_efuse_tx_power_info_valid(pg_data, PG_TXPWR_BASE_BYTE_NUM_2G, pg_offset); + if (ret == _TRUE) + valid_2g_path_bmp |= BIT(path); + else if (ret == EFUSE_POWER_INDEX_INVALID) + return _FALSE; + } + pg_offset += PG_TXPWR_1PATH_BYTE_NUM_2G; + + #ifdef CONFIG_IEEE80211_BAND_5GHZ + if (HAL_SPEC_CHK_RF_PATH_5G(hal_spec, path)) { + ret = _check_phy_efuse_tx_power_info_valid(pg_data, PG_TXPWR_BASE_BYTE_NUM_5G, pg_offset); + if (ret == _TRUE) + valid_5g_path_bmp |= BIT(path); + else if (ret == EFUSE_POWER_INDEX_INVALID) + return _FALSE; + } + #endif + pg_offset += PG_TXPWR_1PATH_BYTE_NUM_5G; + } + + if ((hal_chk_band_cap(adapter, BAND_CAP_2G) && valid_2g_path_bmp) + #ifdef CONFIG_IEEE80211_BAND_5GHZ + || (hal_chk_band_cap(adapter, BAND_CAP_5G) && valid_5g_path_bmp) + #endif + ) + return _TRUE; + + return _FALSE; +} +#endif /* CONFIG_EFUSE_CONFIG_FILE */ + void hal_load_txpwr_info( _adapter *adapter, TxPowerInfo24G *pwr_info_2g, @@ -967,10 +1095,10 @@ void hal_load_txpwr_info( if (tx_idx >= max_tx_cnt) break; - hal_data->CCK_24G_Diff[rfpath][tx_idx] = pwr_info_2g->CCK_Diff[rfpath][tx_idx]; - hal_data->OFDM_24G_Diff[rfpath][tx_idx] = pwr_info_2g->OFDM_Diff[rfpath][tx_idx]; - hal_data->BW20_24G_Diff[rfpath][tx_idx] = pwr_info_2g->BW20_Diff[rfpath][tx_idx]; - hal_data->BW40_24G_Diff[rfpath][tx_idx] = pwr_info_2g->BW40_Diff[rfpath][tx_idx]; + hal_data->CCK_24G_Diff[rfpath][tx_idx] = pwr_info_2g->CCK_Diff[rfpath][tx_idx] * hal_spec->pg_txgi_diff_factor; + hal_data->OFDM_24G_Diff[rfpath][tx_idx] = pwr_info_2g->OFDM_Diff[rfpath][tx_idx] * hal_spec->pg_txgi_diff_factor; + hal_data->BW20_24G_Diff[rfpath][tx_idx] = pwr_info_2g->BW20_Diff[rfpath][tx_idx] * hal_spec->pg_txgi_diff_factor; + hal_data->BW40_24G_Diff[rfpath][tx_idx] = pwr_info_2g->BW40_Diff[rfpath][tx_idx] * hal_spec->pg_txgi_diff_factor; } bypass_2g: ; @@ -1002,10 +1130,10 @@ void hal_load_txpwr_info( if (tx_idx >= max_tx_cnt) break; - hal_data->OFDM_5G_Diff[rfpath][tx_idx] = pwr_info_5g->OFDM_Diff[rfpath][tx_idx]; - hal_data->BW20_5G_Diff[rfpath][tx_idx] = pwr_info_5g->BW20_Diff[rfpath][tx_idx]; - hal_data->BW40_5G_Diff[rfpath][tx_idx] = pwr_info_5g->BW40_Diff[rfpath][tx_idx]; - hal_data->BW80_5G_Diff[rfpath][tx_idx] = pwr_info_5g->BW80_Diff[rfpath][tx_idx]; + hal_data->OFDM_5G_Diff[rfpath][tx_idx] = pwr_info_5g->OFDM_Diff[rfpath][tx_idx] * hal_spec->pg_txgi_diff_factor; + hal_data->BW20_5G_Diff[rfpath][tx_idx] = pwr_info_5g->BW20_Diff[rfpath][tx_idx] * hal_spec->pg_txgi_diff_factor; + hal_data->BW40_5G_Diff[rfpath][tx_idx] = pwr_info_5g->BW40_Diff[rfpath][tx_idx] * hal_spec->pg_txgi_diff_factor; + hal_data->BW80_5G_Diff[rfpath][tx_idx] = pwr_info_5g->BW80_Diff[rfpath][tx_idx] * hal_spec->pg_txgi_diff_factor; } bypass_5g: ; @@ -1022,12 +1150,12 @@ void dump_hal_txpwr_info_2g(void *sel, _adapter *adapter, u8 rfpath_num, u8 max_ RTW_PRINT_SEL(sel, "CCK-1T base:\n"); RTW_PRINT_SEL(sel, "%4s ", ""); for (ch_idx = 0; ch_idx < CENTER_CH_2G_NUM; ch_idx++) - _RTW_PRINT_SEL(sel, "%2d ", center_ch_2g[ch_idx]); + _RTW_PRINT_SEL(sel, "%3d ", center_ch_2g[ch_idx]); _RTW_PRINT_SEL(sel, "\n"); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); for (ch_idx = 0; ch_idx < CENTER_CH_2G_NUM; ch_idx++) - _RTW_PRINT_SEL(sel, "%2u ", hal_data->Index24G_CCK_Base[path][ch_idx]); + _RTW_PRINT_SEL(sel, "%3u ", hal_data->Index24G_CCK_Base[path][ch_idx]); _RTW_PRINT_SEL(sel, "\n"); } RTW_PRINT_SEL(sel, "\n"); @@ -1048,12 +1176,12 @@ void dump_hal_txpwr_info_2g(void *sel, _adapter *adapter, u8 rfpath_num, u8 max_ RTW_PRINT_SEL(sel, "BW40-1S base:\n"); RTW_PRINT_SEL(sel, "%4s ", ""); for (ch_idx = 0; ch_idx < CENTER_CH_2G_NUM; ch_idx++) - _RTW_PRINT_SEL(sel, "%2d ", center_ch_2g[ch_idx]); + _RTW_PRINT_SEL(sel, "%3d ", center_ch_2g[ch_idx]); _RTW_PRINT_SEL(sel, "\n"); for (path = 0; path < MAX_RF_PATH && path < rfpath_num; path++) { RTW_PRINT_SEL(sel, "[%c]: ", rf_path_char(path)); for (ch_idx = 0; ch_idx < CENTER_CH_2G_NUM; ch_idx++) - _RTW_PRINT_SEL(sel, "%2u ", hal_data->Index24G_BW40_Base[path][ch_idx]); + _RTW_PRINT_SEL(sel, "%3u ", hal_data->Index24G_BW40_Base[path][ch_idx]); _RTW_PRINT_SEL(sel, "\n"); } RTW_PRINT_SEL(sel, "\n"); @@ -1209,10 +1337,10 @@ void dump_hal_txpwr_info_5g(void *sel, _adapter *adapter, u8 rfpath_num, u8 max_ * Return dBm or -1 for undefined */ s8 rtw_regsty_get_target_tx_power( - IN PADAPTER Adapter, - IN u8 Band, - IN u8 RfPath, - IN RATE_SECTION RateSection + PADAPTER Adapter, + u8 Band, + u8 RfPath, + RATE_SECTION RateSection ) { struct registry_priv *regsty = adapter_to_regsty(Adapter); @@ -1275,7 +1403,7 @@ bool rtw_regsty_chk_target_tx_power_valid(_adapter *adapter) if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) continue; - if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter)) + if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_ALL(adapter)) continue; target = rtw_regsty_get_target_tx_power(adapter, band, path, rs); @@ -1293,15 +1421,14 @@ bool rtw_regsty_chk_target_tx_power_valid(_adapter *adapter) /* * PHY_GetTxPowerByRateBase - * -* Return 2 times of dBm +* Return value in unit of TX Gain Index */ u8 PHY_GetTxPowerByRateBase( - IN PADAPTER Adapter, - IN u8 Band, - IN u8 RfPath, - IN u8 TxNum, - IN RATE_SECTION RateSection + PADAPTER Adapter, + u8 Band, + u8 RfPath, + RATE_SECTION RateSection ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -1320,27 +1447,26 @@ 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; } -VOID +void phy_SetTxPowerByRateBase( - IN PADAPTER Adapter, - IN u8 Band, - IN u8 RfPath, - IN RATE_SECTION RateSection, - IN u8 TxNum, - IN u8 Value + PADAPTER Adapter, + u8 Band, + u8 RfPath, + RATE_SECTION RateSection, + u8 Value ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -1358,45 +1484,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->tx_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->tx_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) @@ -1456,9 +1577,9 @@ static void phy_txpwr_by_rate_chk_for_path_dup(_adapter *adapter) } } -VOID +void phy_StoreTxPowerByRateBase( - IN PADAPTER pAdapter + PADAPTER pAdapter ) { struct hal_spec_t *hal_spec = GET_HAL_SPEC(pAdapter); @@ -1495,33 +1616,50 @@ phy_StoreTxPowerByRateBase( if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) continue; - if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(pAdapter)) + if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_ALL(pAdapter)) continue; if (regsty->target_tx_pwr_valid == _TRUE) - base = 2 * rtw_regsty_get_target_tx_power(pAdapter, band, path, rs); + base = hal_spec->txgi_pdbm * 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); } } } } -VOID +static u8 get_val_from_dhex(u32 dhex, u8 i) +{ + return (((dhex >> (i * 8 + 4)) & 0xF)) * 10 + ((dhex >> (i * 8)) & 0xF); +} + +static u8 get_val_from_hex(u32 hex, u8 i) +{ + return (hex >> (i * 8)) & 0xFF; +} + +void PHY_GetRateValuesOfTxPowerByRate( - IN PADAPTER pAdapter, - IN u32 RegAddr, - IN u32 BitMask, - IN u32 Value, - OUT u8 *Rate, - OUT s8 *PwrByRateVal, - OUT u8 *RateNum + PADAPTER pAdapter, + u32 RegAddr, + u32 BitMask, + u32 Value, + u8 *Rate, + s8 *PwrByRateVal, + u8 *RateNum ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - struct PHY_DM_STRUCT *pDM_Odm = &pHalData->odmpriv; + struct hal_spec_t *hal_spec = GET_HAL_SPEC(pAdapter); + struct dm_struct *pDM_Odm = &pHalData->odmpriv; u8 index = 0, i = 0; + u8 (*get_val)(u32, u8); + + if (pDM_Odm->phy_reg_pg_version == 1) + get_val = get_val_from_dhex; + else + get_val = get_val_from_hex; switch (RegAddr) { case rTxAGC_A_Rate18_06: @@ -1530,10 +1668,8 @@ PHY_GetRateValuesOfTxPowerByRate( Rate[1] = MGN_9M; Rate[2] = MGN_12M; Rate[3] = MGN_18M; - for (i = 0; i < 4; ++i) { - PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + - ((Value >> (i * 8)) & 0xF)); - } + for (i = 0; i < 4; ++i) + PwrByRateVal[i] = (s8)get_val(Value, i); *RateNum = 4; break; @@ -1543,17 +1679,14 @@ PHY_GetRateValuesOfTxPowerByRate( Rate[1] = MGN_36M; Rate[2] = MGN_48M; Rate[3] = MGN_54M; - for (i = 0; i < 4; ++i) { - PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + - ((Value >> (i * 8)) & 0xF)); - } + for (i = 0; i < 4; ++i) + PwrByRateVal[i] = (s8)get_val(Value, i); *RateNum = 4; break; case rTxAGC_A_CCK1_Mcs32: Rate[0] = MGN_1M; - PwrByRateVal[0] = (s8)((((Value >> (8 + 4)) & 0xF)) * 10 + - ((Value >> 8) & 0xF)); + PwrByRateVal[0] = (s8)get_val(Value, 1); *RateNum = 1; break; @@ -1562,15 +1695,12 @@ PHY_GetRateValuesOfTxPowerByRate( Rate[0] = MGN_2M; Rate[1] = MGN_5_5M; Rate[2] = MGN_11M; - for (i = 1; i < 4; ++i) { - PwrByRateVal[i - 1] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + - ((Value >> (i * 8)) & 0xF)); - } + for (i = 1; i < 4; ++i) + PwrByRateVal[i - 1] = (s8)get_val(Value, i); *RateNum = 3; } else if (BitMask == 0x000000ff) { Rate[0] = MGN_11M; - PwrByRateVal[0] = (s8)((((Value >> 4) & 0xF)) * 10 + - (Value & 0xF)); + PwrByRateVal[0] = (s8)get_val(Value, 0); *RateNum = 1; } break; @@ -1581,10 +1711,8 @@ PHY_GetRateValuesOfTxPowerByRate( Rate[1] = MGN_MCS1; Rate[2] = MGN_MCS2; Rate[3] = MGN_MCS3; - for (i = 0; i < 4; ++i) { - PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + - ((Value >> (i * 8)) & 0xF)); - } + for (i = 0; i < 4; ++i) + PwrByRateVal[i] = (s8)get_val(Value, i); *RateNum = 4; break; @@ -1594,10 +1722,8 @@ PHY_GetRateValuesOfTxPowerByRate( Rate[1] = MGN_MCS5; Rate[2] = MGN_MCS6; Rate[3] = MGN_MCS7; - for (i = 0; i < 4; ++i) { - PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + - ((Value >> (i * 8)) & 0xF)); - } + for (i = 0; i < 4; ++i) + PwrByRateVal[i] = (s8)get_val(Value, i); *RateNum = 4; break; @@ -1607,10 +1733,8 @@ PHY_GetRateValuesOfTxPowerByRate( Rate[1] = MGN_MCS9; Rate[2] = MGN_MCS10; Rate[3] = MGN_MCS11; - for (i = 0; i < 4; ++i) { - PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + - ((Value >> (i * 8)) & 0xF)); - } + for (i = 0; i < 4; ++i) + PwrByRateVal[i] = (s8)get_val(Value, i); *RateNum = 4; break; @@ -1620,22 +1744,17 @@ PHY_GetRateValuesOfTxPowerByRate( Rate[1] = MGN_MCS13; Rate[2] = MGN_MCS14; Rate[3] = MGN_MCS15; - for (i = 0; i < 4; ++i) { - PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + - ((Value >> (i * 8)) & 0xF)); - } + for (i = 0; i < 4; ++i) + PwrByRateVal[i] = (s8)get_val(Value, i); *RateNum = 4; - break; case rTxAGC_B_CCK1_55_Mcs32: Rate[0] = MGN_1M; Rate[1] = MGN_2M; Rate[2] = MGN_5_5M; - for (i = 1; i < 4; ++i) { - PwrByRateVal[i - 1] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + - ((Value >> (i * 8)) & 0xF)); - } + for (i = 1; i < 4; ++i) + PwrByRateVal[i - 1] = (s8)get_val(Value, i); *RateNum = 3; break; @@ -1647,10 +1766,8 @@ PHY_GetRateValuesOfTxPowerByRate( Rate[1] = MGN_2M; Rate[2] = MGN_5_5M; Rate[3] = MGN_11M; - for (i = 0; i < 4; ++i) { - PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + - ((Value >> (i * 8)) & 0xF)); - } + for (i = 0; i < 4; ++i) + PwrByRateVal[i] = (s8)get_val(Value, i); *RateNum = 4; break; @@ -1662,10 +1779,8 @@ PHY_GetRateValuesOfTxPowerByRate( Rate[1] = MGN_9M; Rate[2] = MGN_12M; Rate[3] = MGN_18M; - for (i = 0; i < 4; ++i) { - PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + - ((Value >> (i * 8)) & 0xF)); - } + for (i = 0; i < 4; ++i) + PwrByRateVal[i] = (s8)get_val(Value, i); *RateNum = 4; break; @@ -1677,10 +1792,8 @@ PHY_GetRateValuesOfTxPowerByRate( Rate[1] = MGN_36M; Rate[2] = MGN_48M; Rate[3] = MGN_54M; - for (i = 0; i < 4; ++i) { - PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + - ((Value >> (i * 8)) & 0xF)); - } + for (i = 0; i < 4; ++i) + PwrByRateVal[i] = (s8)get_val(Value, i); *RateNum = 4; break; @@ -1692,10 +1805,8 @@ PHY_GetRateValuesOfTxPowerByRate( Rate[1] = MGN_MCS1; Rate[2] = MGN_MCS2; Rate[3] = MGN_MCS3; - for (i = 0; i < 4; ++i) { - PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + - ((Value >> (i * 8)) & 0xF)); - } + for (i = 0; i < 4; ++i) + PwrByRateVal[i] = (s8)get_val(Value, i); *RateNum = 4; break; @@ -1707,10 +1818,8 @@ PHY_GetRateValuesOfTxPowerByRate( Rate[1] = MGN_MCS5; Rate[2] = MGN_MCS6; Rate[3] = MGN_MCS7; - for (i = 0; i < 4; ++i) { - PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + - ((Value >> (i * 8)) & 0xF)); - } + for (i = 0; i < 4; ++i) + PwrByRateVal[i] = (s8)get_val(Value, i); *RateNum = 4; break; @@ -1722,10 +1831,8 @@ PHY_GetRateValuesOfTxPowerByRate( Rate[1] = MGN_MCS9; Rate[2] = MGN_MCS10; Rate[3] = MGN_MCS11; - for (i = 0; i < 4; ++i) { - PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + - ((Value >> (i * 8)) & 0xF)); - } + for (i = 0; i < 4; ++i) + PwrByRateVal[i] = (s8)get_val(Value, i); *RateNum = 4; break; @@ -1737,10 +1844,8 @@ PHY_GetRateValuesOfTxPowerByRate( Rate[1] = MGN_MCS13; Rate[2] = MGN_MCS14; Rate[3] = MGN_MCS15; - for (i = 0; i < 4; ++i) { - PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + - ((Value >> (i * 8)) & 0xF)); - } + for (i = 0; i < 4; ++i) + PwrByRateVal[i] = (s8)get_val(Value, i); *RateNum = 4; break; @@ -1752,10 +1857,8 @@ PHY_GetRateValuesOfTxPowerByRate( Rate[1] = MGN_VHT1SS_MCS1; Rate[2] = MGN_VHT1SS_MCS2; Rate[3] = MGN_VHT1SS_MCS3; - for (i = 0; i < 4; ++i) { - PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + - ((Value >> (i * 8)) & 0xF)); - } + for (i = 0; i < 4; ++i) + PwrByRateVal[i] = (s8)get_val(Value, i); *RateNum = 4; break; @@ -1767,10 +1870,8 @@ PHY_GetRateValuesOfTxPowerByRate( Rate[1] = MGN_VHT1SS_MCS5; Rate[2] = MGN_VHT1SS_MCS6; Rate[3] = MGN_VHT1SS_MCS7; - for (i = 0; i < 4; ++i) { - PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + - ((Value >> (i * 8)) & 0xF)); - } + for (i = 0; i < 4; ++i) + PwrByRateVal[i] = (s8)get_val(Value, i); *RateNum = 4; break; @@ -1782,10 +1883,8 @@ PHY_GetRateValuesOfTxPowerByRate( Rate[1] = MGN_VHT1SS_MCS9; Rate[2] = MGN_VHT2SS_MCS0; Rate[3] = MGN_VHT2SS_MCS1; - for (i = 0; i < 4; ++i) { - PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + - ((Value >> (i * 8)) & 0xF)); - } + for (i = 0; i < 4; ++i) + PwrByRateVal[i] = (s8)get_val(Value, i); *RateNum = 4; break; @@ -1797,10 +1896,8 @@ PHY_GetRateValuesOfTxPowerByRate( Rate[1] = MGN_VHT2SS_MCS3; Rate[2] = MGN_VHT2SS_MCS4; Rate[3] = MGN_VHT2SS_MCS5; - for (i = 0; i < 4; ++i) { - PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + - ((Value >> (i * 8)) & 0xF)); - } + for (i = 0; i < 4; ++i) + PwrByRateVal[i] = (s8)get_val(Value, i); *RateNum = 4; break; @@ -1812,10 +1909,8 @@ PHY_GetRateValuesOfTxPowerByRate( Rate[1] = MGN_VHT2SS_MCS7; Rate[2] = MGN_VHT2SS_MCS8; Rate[3] = MGN_VHT2SS_MCS9; - for (i = 0; i < 4; ++i) { - PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + - ((Value >> (i * 8)) & 0xF)); - } + for (i = 0; i < 4; ++i) + PwrByRateVal[i] = (s8)get_val(Value, i); *RateNum = 4; break; @@ -1827,10 +1922,8 @@ PHY_GetRateValuesOfTxPowerByRate( Rate[1] = MGN_MCS17; Rate[2] = MGN_MCS18; Rate[3] = MGN_MCS19; - for (i = 0; i < 4; ++i) { - PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + - ((Value >> (i * 8)) & 0xF)); - } + for (i = 0; i < 4; ++i) + PwrByRateVal[i] = (s8)get_val(Value, i); *RateNum = 4; break; @@ -1842,10 +1935,8 @@ PHY_GetRateValuesOfTxPowerByRate( Rate[1] = MGN_MCS21; Rate[2] = MGN_MCS22; Rate[3] = MGN_MCS23; - for (i = 0; i < 4; ++i) { - PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + - ((Value >> (i * 8)) & 0xF)); - } + for (i = 0; i < 4; ++i) + PwrByRateVal[i] = (s8)get_val(Value, i); *RateNum = 4; break; @@ -1857,10 +1948,8 @@ PHY_GetRateValuesOfTxPowerByRate( Rate[1] = MGN_VHT3SS_MCS1; Rate[2] = MGN_VHT3SS_MCS2; Rate[3] = MGN_VHT3SS_MCS3; - for (i = 0; i < 4; ++i) { - PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + - ((Value >> (i * 8)) & 0xF)); - } + for (i = 0; i < 4; ++i) + PwrByRateVal[i] = (s8)get_val(Value, i); *RateNum = 4; break; @@ -1872,10 +1961,8 @@ PHY_GetRateValuesOfTxPowerByRate( Rate[1] = MGN_VHT3SS_MCS5; Rate[2] = MGN_VHT3SS_MCS6; Rate[3] = MGN_VHT3SS_MCS7; - for (i = 0; i < 4; ++i) { - PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + - ((Value >> (i * 8)) & 0xF)); - } + for (i = 0; i < 4; ++i) + PwrByRateVal[i] = (s8)get_val(Value, i); *RateNum = 4; break; @@ -1885,10 +1972,8 @@ PHY_GetRateValuesOfTxPowerByRate( case 0x1aE8: Rate[0] = MGN_VHT3SS_MCS8; Rate[1] = MGN_VHT3SS_MCS9; - for (i = 0; i < 2; ++i) { - PwrByRateVal[i] = (s8)((((Value >> (i * 8 + 4)) & 0xF)) * 10 + - ((Value >> (i * 8)) & 0xF)); - } + for (i = 0; i < 2; ++i) + PwrByRateVal[i] = (s8)get_val(Value, i); *RateNum = 2; break; @@ -1900,13 +1985,12 @@ PHY_GetRateValuesOfTxPowerByRate( void PHY_StoreTxPowerByRateNew( - IN PADAPTER pAdapter, - IN u32 Band, - IN u32 RfPath, - IN u32 TxNum, - IN u32 RegAddr, - IN u32 BitMask, - IN u32 Data + PADAPTER pAdapter, + u32 Band, + u32 RfPath, + u32 RegAddr, + u32 BitMask, + u32 Data ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); @@ -1920,76 +2004,61 @@ 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]; } } -VOID +void PHY_InitTxPowerByRate( - IN PADAPTER pAdapter + PADAPTER pAdapter ) { 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 +void phy_store_tx_power_by_rate( - IN PADAPTER pAdapter, - IN u32 Band, - IN u32 RfPath, - IN u32 TxNum, - IN u32 RegAddr, - IN u32 BitMask, - IN u32 Data + PADAPTER pAdapter, + u32 Band, + u32 RfPath, + u32 TxNum, + u32 RegAddr, + u32 BitMask, + u32 Data ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - struct PHY_DM_STRUCT *pDM_Odm = &pHalData->odmpriv; + struct dm_struct *pDM_Odm = &pHalData->odmpriv; if (pDM_Odm->phy_reg_pg_version > 0) - PHY_StoreTxPowerByRateNew(pAdapter, Band, RfPath, TxNum, RegAddr, BitMask, Data); + PHY_StoreTxPowerByRateNew(pAdapter, Band, RfPath, RegAddr, BitMask, Data); else RTW_INFO("Invalid PHY_REG_PG.txt version %d\n", pDM_Odm->phy_reg_pg_version); } -VOID +void phy_ConvertTxPowerByRateInDbmToRelativeValues( - IN PADAPTER pAdapter + PADAPTER pAdapter ) { 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 +2075,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); } } } @@ -2076,9 +2143,9 @@ phy_ConvertTxPowerByRateInDbmToRelativeValues( * This function must be called if the value in the PHY_REG_PG.txt(or header) * is exact dBm values */ -VOID +void PHY_TxPowerByRateConfiguration( - IN PADAPTER pAdapter + PADAPTER pAdapter ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); @@ -2088,12 +2155,12 @@ PHY_TxPowerByRateConfiguration( phy_ConvertTxPowerByRateInDbmToRelativeValues(pAdapter); } -VOID +void phy_set_tx_power_index_by_rate_section( - IN PADAPTER pAdapter, - IN u8 RFPath, - IN u8 Channel, - IN u8 RateSection + PADAPTER pAdapter, + enum rf_path RFPath, + u8 Channel, + u8 RateSection ) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); @@ -2116,8 +2183,8 @@ phy_set_tx_power_index_by_rate_section( BOOLEAN phy_GetChnlIndex( - IN u8 Channel, - OUT u8 *ChannelIdx + u8 Channel, + u8 *ChannelIdx ) { u8 i = 0; @@ -2140,18 +2207,18 @@ phy_GetChnlIndex( return bIn24G; } -u8 -PHY_GetTxPowerIndexBase( - IN PADAPTER pAdapter, - IN u8 RFPath, - IN u8 Rate, - IN CHANNEL_WIDTH BandWidth, - IN u8 Channel, - OUT PBOOLEAN bIn24G +u8 phy_get_pg_txpwr_idx( + PADAPTER pAdapter, + enum rf_path RFPath, + u8 Rate, + u8 ntx_idx, + enum channel_width BandWidth, + u8 Channel, + PBOOLEAN bIn24G ) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); - struct PHY_DM_STRUCT *pDM_Odm = &pHalData->odmpriv; + struct dm_struct *pDM_Odm = &pHalData->odmpriv; u8 i = 0; /* default set to 1S */ u8 txPower = 0; u8 chnlIdx = (Channel - 1); @@ -2163,153 +2230,172 @@ 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(0x%02x).\n", Rate); - - /* 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("===>PHY_GetTxPowerIndexBase: INVALID Rate(0x%02x).\n", Rate); - - /* 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("===>%s: INVALID Rate(0x%02x).\n", __func__, 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) { + #ifdef CONFIG_MP_INCLUDED + if (rtw_mp_mode_check(pAdapter) == _FALSE) + #endif + 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); - struct PHY_DM_STRUCT *pDM_Odm = &pHalData->odmpriv; + struct dm_struct *pDM_Odm = &pHalData->odmpriv; s8 offset = 0; if (pDM_Odm->rf_calibrate_info.txpowertrack_control == _FALSE) @@ -2330,7 +2416,7 @@ PHY_GetTxPowerTrackingOffset( /*The same as MRateToHwRate in hal_com.c*/ u8 PHY_GetRateIndexOfTxPowerByRate( - IN u8 Rate + u8 Rate ) { u8 index = 0; @@ -2597,11 +2683,10 @@ PHY_GetRateIndexOfTxPowerByRate( s8 _PHY_GetTxPowerByRate( - IN PADAPTER pAdapter, - IN u8 Band, - IN u8 RFPath, - IN u8 TxNum, - IN u8 Rate + PADAPTER pAdapter, + u8 Band, + enum rf_path RFPath, + u8 Rate ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); @@ -2612,20 +2697,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; @@ -2634,70 +2715,25 @@ _PHY_GetTxPowerByRate( s8 PHY_GetTxPowerByRate( - IN PADAPTER pAdapter, - IN u8 Band, - IN u8 RFPath, - IN u8 TxNum, - IN u8 Rate + PADAPTER pAdapter, + u8 Band, + enum rf_path RFPath, + 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 +void PHY_SetTxPowerByRate( - IN PADAPTER pAdapter, - IN u8 Band, - IN u8 RFPath, - IN u8 TxNum, - IN u8 Rate, - IN s8 Value + PADAPTER pAdapter, + u8 Band, + enum rf_path RFPath, + u8 Rate, + s8 Value ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); @@ -2707,31 +2743,57 @@ 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 +u8 phy_check_under_survey_ch(_adapter *adapter) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + _adapter *iface; + struct mlme_ext_priv *mlmeext; + u8 ret = _FALSE; + int i; + + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + if (!iface) + continue; + mlmeext = &iface->mlmeextpriv; + + /* check scan state */ + if (mlmeext_scan_state(mlmeext) != SCAN_DISABLE + && mlmeext_scan_state(mlmeext) != SCAN_COMPLETE + && mlmeext_scan_state(mlmeext) != SCAN_BACKING_OP) { + ret = _TRUE; + } else if (mlmeext_scan_state(mlmeext) == SCAN_BACKING_OP + && !mlmeext_chk_scan_backop_flags(mlmeext, SS_BACKOP_TX_RESUME)) { + ret = _TRUE; + } + } + + return ret; +} + +void phy_set_tx_power_level_by_path( - IN PADAPTER Adapter, - IN u8 channel, - IN u8 path + PADAPTER Adapter, + u8 channel, + u8 path ) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); BOOLEAN bIsIn24G = (pHalData->current_band_type == BAND_ON_2_4G); + u8 under_survey_ch = phy_check_under_survey_ch(Adapter); + /* if ( pMgntInfo->RegNByteAccess == 0 ) */ { @@ -2739,20 +2801,23 @@ phy_set_tx_power_level_by_path( phy_set_tx_power_index_by_rate_section(Adapter, path, channel, CCK); 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_set_tx_power_index_by_rate_section(Adapter, path, channel, VHT_1SSMCS0_1SSMCS9); - - if (pHalData->NumTotalRFPath >= 2) { - phy_set_tx_power_index_by_rate_section(Adapter, path, channel, HT_MCS8_MCS15); + if (!under_survey_ch) { + 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_set_tx_power_index_by_rate_section(Adapter, path, channel, VHT_2SSMCS0_2SSMCS9); + phy_set_tx_power_index_by_rate_section(Adapter, path, channel, VHT_1SSMCS0_1SSMCS9); - if (IS_HARDWARE_TYPE_8814A(Adapter)) { - 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); + if (pHalData->NumTotalRFPath >= 2) { + 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_set_tx_power_index_by_rate_section(Adapter, path, channel, VHT_2SSMCS0_2SSMCS9); + + if (IS_HARDWARE_TYPE_8814A(Adapter)) { + 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); + } } } } @@ -2762,14 +2827,14 @@ phy_set_tx_power_level_by_path( #define DBG_TX_POWER_IDX 0 #endif -VOID +void PHY_SetTxPowerIndexByRateArray( - IN PADAPTER pAdapter, - IN u8 RFPath, - IN CHANNEL_WIDTH BandWidth, - IN u8 Channel, - IN u8 *Rates, - IN u8 RateArraySize + PADAPTER pAdapter, + enum rf_path RFPath, + enum channel_width BandWidth, + u8 Channel, + u8 *Rates, + u8 RateArraySize ) { u32 powerIndex = 0; @@ -2780,9 +2845,10 @@ 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]) - , powerIndex, tic.base, (tic.by_rate > tic.limit ? tic.limit : tic.by_rate), tic.by_rate, tic.limit, tic.tpt, tic.ebias); + RTW_INFO("TXPWR: [%c][%s]ch:%u, %s %uT, pwr_idx:%u(0x%02x) = %u + (%d=%d:%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, powerIndex, tic.pg, (tic.by_rate > tic.limit ? tic.limit : tic.by_rate), tic.by_rate, tic.limit, tic.tpt + , tic.ebias, tic.btc, tic.dpd); #else powerIndex = phy_get_tx_power_index(pAdapter, RFPath, Rates[i], BandWidth, Channel); #endif @@ -2790,26 +2856,19 @@ PHY_SetTxPowerIndexByRateArray( } } -s8 -phy_GetWorldWideLimit( - s8 *LimitTable -) -{ - s8 min = LimitTable[0]; - u8 i = 0; +#if 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 + u8 Band, + u8 Channel ) { s8 channelIndex = -1; @@ -2831,104 +2890,236 @@ phy_GetChannelIndexOfTxPowerLimit( return channelIndex; } -static s8 _phy_get_txpwr_lmt( - IN PADAPTER Adapter, - IN u32 RegPwrTblSel, - IN BAND_TYPE Band, - IN CHANNEL_WIDTH Bandwidth, - IN u8 RfPath, - IN u8 DataRate, - IN u8 Channel, - BOOLEAN no_sc +static s8 phy_txpwr_ww_lmt_value(_adapter *adapter) +{ + struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); + + if (hal_spec->txgi_max == 63) + return -63; + else if (hal_spec->txgi_max == 127) + return -128; + + rtw_warn_on(1); + return -128; +} + +/* +* return txpwr limit absolute value +* hsl_spec->txgi_max is returned when NO limit +*/ +s8 phy_get_txpwr_lmt_abs( + PADAPTER Adapter, + const char *regd_name, + BAND_TYPE Band, + 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 hal_spec_t *hal_spec = GET_HAL_SPEC(Adapter); + struct txpwr_lmt_ent *ent = NULL; + _irqL irqL; + _list *cur, *head; + s8 ch_idx; + u8 is_ww_regd = 0; + s8 ww_lmt_val = phy_txpwr_ww_lmt_value(Adapter); + s8 lmt = hal_spec->txgi_max; 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 = ent->lmt_2g[bw][tlrs][ch_idx][ntx_idx]; + if (lmt != ww_lmt_val) + goto release_lock; + } + + /* search for min value for WW regd or WW limit */ + lmt = hal_spec->txgi_max; + 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->lmt_2g[bw][tlrs][ch_idx][ntx_idx] != ww_lmt_val) + lmt = rtw_min(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 = ent->lmt_5g[bw][tlrs - 1][ch_idx][ntx_idx]; + if (lmt != ww_lmt_val) + goto release_lock; + } + + /* search for min value for WW regd or WW limit */ + lmt = hal_spec->txgi_max; + 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->lmt_5g[bw][tlrs - 1][ch_idx][ntx_idx] != ww_lmt_val) + lmt = rtw_min(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 +* hal_spec->txgi_max is returned when NO limit +*/ +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 +) +{ + struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); + u8 tlrs; + s8 lmt = hal_spec->txgi_max; + + 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 != hal_spec->txgi_max) { + /* 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); + struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); + BOOLEAN no_sc = _FALSE; + s8 tlrs = -1, rs = -1; + s8 lmt = hal_spec->txgi_max; + u8 tmp_cch = 0; + u8 tmp_bw; + u8 bw_bmp = 0; + s8 min_lmt = hal_spec->txgi_max; + 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 +3127,191 @@ 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 != hal_spec->txgi_max) { + /* 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 hal_spec_t *hal_spec = GET_HAL_SPEC(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->current_band_type, 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] != hal_spec->txgi_max) { + 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] != hal_spec->txgi_max) { + 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 hal_spec_t *hal_spec = GET_HAL_SPEC(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] == hal_spec->txgi_max) + 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] != hal_spec->txgi_max) + 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]; + } } } @@ -3370,178 +3321,326 @@ phy_CrossReferenceHTAndVHTTxPowerLimit( if (0) { RTW_INFO("ht_ref_vht_5g_20_40:%d, ht_has_ref_5g_20_40:%d\n", ht_ref_vht_5g_20_40, ht_has_ref_5g_20_40); - RTW_INFO("vht_ref_hht_5g_20_40:%d, vht_has_ref_5g_20_40:%d\n", vht_ref_ht_5g_20_40, vht_has_ref_5g_20_40); + RTW_INFO("vht_ref_ht_5g_20_40:%d, vht_has_ref_5g_20_40:%d\n", vht_ref_ht_5g_20_40, vht_has_ref_5g_20_40); } /* 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.phy_reg_pg_value_type != 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_ALL(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] == hal_spec->txgi_max) + _RTW_PRINT_SEL(RTW_DBGDUMP, "N/A "); + else if (lmt[bw_pos] > -hal_spec->txgi_pdbm && lmt[bw_pos] < 0) /* -1 < value < 0 */ + _RTW_PRINT_SEL(RTW_DBGDUMP, "-0.%d", (rtw_abs(lmt[bw_pos]) % hal_spec->txgi_pdbm) * 100 / hal_spec->txgi_pdbm); + else if (lmt[bw_pos] % hal_spec->txgi_pdbm) + _RTW_PRINT_SEL(RTW_DBGDUMP, "%2d.%d ", lmt[bw_pos] / hal_spec->txgi_pdbm, (rtw_abs(lmt[bw_pos]) % hal_spec->txgi_pdbm) * 100 / hal_spec->txgi_pdbm); + else + _RTW_PRINT_SEL(RTW_DBGDUMP, "%2d ", lmt[bw_pos] / hal_spec->txgi_pdbm); + } + _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] == hal_spec->txgi_max) + _RTW_PRINT_SEL(RTW_DBGDUMP, "N/A "); + else if (lmt[bw_pos] > -hal_spec->txgi_pdbm && lmt[bw_pos] < 0) /* -1 < value < 0 */ + _RTW_PRINT_SEL(RTW_DBGDUMP, "-0.%d", (rtw_abs(lmt[bw_pos]) % hal_spec->txgi_pdbm) * 100 / hal_spec->txgi_pdbm); + else if (lmt[bw_pos] % hal_spec->txgi_pdbm) + _RTW_PRINT_SEL(RTW_DBGDUMP, "%2d.%d ", lmt[bw_pos] / hal_spec->txgi_pdbm, (rtw_abs(lmt[bw_pos]) % hal_spec->txgi_pdbm) * 100 / hal_spec->txgi_pdbm); + else + _RTW_PRINT_SEL(RTW_DBGDUMP, "%2d ", lmt[bw_pos] / hal_spec->txgi_pdbm); + } + _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_ALL(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( + char *str, + 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_set_tx_power_limit - Parsing TX power limit from phydm array, called by odm_ConfigBB_TXPWR_LMT_XXX in phydm */ -VOID +void 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 *Channel, - IN u8 *PowerLimit + struct dm_struct *pDM_Odm, + u8 *Regulation, + u8 *Band, + u8 *Bandwidth, + u8 *RateSection, + u8 *ntx, + u8 *Channel, + u8 *PowerLimit ) { +#if CONFIG_TXPWR_LIMIT PADAPTER Adapter = pDM_Odm->adapter; HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - u8 regulation = 0, bandwidth = 0, rateSection = 0, channel; + struct hal_spec_t *hal_spec = GET_HAL_SPEC(Adapter); + u8 band = 0, bandwidth = 0, tlrs = 0, channel; + u8 ntx_idx; s8 powerLimit = 0, prevPowerLimit, channelIndex; + s8 ww_lmt_val = phy_txpwr_ww_lmt_value(Adapter); 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; } - powerLimit = powerLimit > MAX_POWER_INDEX ? MAX_POWER_INDEX : powerLimit; + if (powerLimit != ww_lmt_val) { + if (powerLimit < -hal_spec->txgi_max || powerLimit > hal_spec->txgi_max) + RTW_PRINT("Illegal power limit value [ch %s][val %s]\n", Channel, 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 (powerLimit > hal_spec->txgi_max) + powerLimit = hal_spec->txgi_max; + else if (powerLimit < -hal_spec->txgi_max) + powerLimit = ww_lmt_val + 1; + } + + 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 +3650,15 @@ phy_set_tx_power_limit( 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 +3671,11 @@ phy_set_tx_power_limit( 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,80 +3683,37 @@ phy_set_tx_power_limit( 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_get_tx_power_index( - IN PADAPTER pAdapter, - IN u8 RFPath, - IN u8 Rate, - IN CHANNEL_WIDTH BandWidth, - IN u8 Channel + PADAPTER pAdapter, + enum rf_path RFPath, + u8 Rate, + enum channel_width BandWidth, + u8 Channel ) { return rtw_hal_get_tx_power_index(pAdapter, RFPath, Rate, BandWidth, Channel, NULL); } -VOID +void PHY_SetTxPowerIndex( - IN PADAPTER pAdapter, - IN u32 PowerIndex, - IN u8 RFPath, - IN u8 Rate + PADAPTER pAdapter, + u32 PowerIndex, + enum rf_path RFPath, + u8 Rate ) { - if (IS_HARDWARE_TYPE_8814A(pAdapter)) { -#if (RTL8814A_SUPPORT == 1) - PHY_SetTxPowerIndex_8814A(pAdapter, PowerIndex, RFPath, Rate); -#endif - } else if (IS_HARDWARE_TYPE_JAGUAR(pAdapter)) { -#if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) - PHY_SetTxPowerIndex_8812A(pAdapter, PowerIndex, RFPath, Rate); -#endif - } else if (IS_HARDWARE_TYPE_8723B(pAdapter)) { -#if (RTL8723B_SUPPORT == 1) - PHY_SetTxPowerIndex_8723B(pAdapter, PowerIndex, RFPath, Rate); -#endif - } else if (IS_HARDWARE_TYPE_8703B(pAdapter)) { -#if (RTL8703B_SUPPORT == 1) - PHY_SetTxPowerIndex_8703B(pAdapter, PowerIndex, RFPath, Rate); -#endif - } else if (IS_HARDWARE_TYPE_8723D(pAdapter)) { -#if (RTL8723D_SUPPORT == 1) - PHY_SetTxPowerIndex_8723D(pAdapter, PowerIndex, RFPath, Rate); -#endif - } else if (IS_HARDWARE_TYPE_8192E(pAdapter)) { -#if (RTL8192E_SUPPORT == 1) - PHY_SetTxPowerIndex_8192E(pAdapter, PowerIndex, RFPath, Rate); -#endif - } else if (IS_HARDWARE_TYPE_8188E(pAdapter)) { -#if (RTL8188E_SUPPORT == 1) - PHY_SetTxPowerIndex_8188E(pAdapter, PowerIndex, RFPath, Rate); -#endif - } else if (IS_HARDWARE_TYPE_8188F(pAdapter)) { -#if (RTL8188F_SUPPORT == 1) - PHY_SetTxPowerIndex_8188F(pAdapter, PowerIndex, RFPath, Rate); -#endif - } else if (IS_HARDWARE_TYPE_8822B(pAdapter)) - rtw_hal_set_tx_power_index(pAdapter, PowerIndex, RFPath, Rate); - else if (IS_HARDWARE_TYPE_8821C(pAdapter)) - rtw_hal_set_tx_power_index(pAdapter, PowerIndex, RFPath, Rate); + rtw_hal_set_tx_power_index(pAdapter, PowerIndex, RFPath, Rate); } void dump_tx_power_idx_title(void *sel, _adapter *adapter) @@ -3678,8 +3728,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%6s %-3s %-3s %-4s %-4s %-3s %-5s %-3s %-3s\n" + , "path", "rate", "", "pwr", "", "pg", "", "(byr", "lmt)", "tpt", "ebias", "btc", "dpd"); } void dump_tx_power_idx_by_path_rs(void *sel, _adapter *adapter, u8 rfpath, u8 rs) @@ -3706,15 +3756,16 @@ void dump_tx_power_idx_by_path_rs(void *sel, _adapter *adapter, u8 rfpath, u8 rs if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) return; - if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter)) + if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_ALL(adapter)) return; 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]) - , power_idx, tic.base, (tic.by_rate > tic.limit ? tic.limit : tic.by_rate), tic.by_rate, tic.limit, tic.tpt, tic.ebias); + RTW_PRINT_SEL(sel, "%4c %9s %uT %3u(0x%02x) %3u %3d (%3d %3d) %3d %5d %3d %3d\n" + , rf_path_char(rfpath), MGN_RATE_STR(rates_by_sections[rs].rates[i]), tic.ntx_idx + 1 + , power_idx, power_idx, tic.pg, (tic.by_rate > tic.limit ? tic.limit : tic.by_rate) + , tic.by_rate, tic.limit, tic.tpt, tic.ebias, tic.btc, tic.dpd); } } @@ -3733,9 +3784,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)); +#if CONFIG_TXPWR_LIMIT if (regsty->RegEnableTxPowerLimit == 1 || (regsty->RegEnableTxPowerLimit == 2 && hal_data->EEPROMRegulatory == 1)) return _TRUE; +#endif + return _FALSE; } @@ -3797,14 +3851,17 @@ int phy_load_tx_power_by_rate(_adapter *adapter, u8 chk_file) return ret; } +#if 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 +3878,7 @@ int phy_load_tx_power_limit(_adapter *adapter, u8 chk_file) #endif #ifdef CONFIG_EMBEDDED_FWIMG - if (HAL_STATUS_SUCCESS == odm_config_rf_with_header_file(&hal_data->odmpriv, CONFIG_RF_TXPWR_LMT, (enum 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 +3889,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 +3912,10 @@ void phy_load_tx_power_ext_info(_adapter *adapter, u8 chk_file) ) phy_load_tx_power_by_rate(adapter, chk_file); +#if 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) @@ -3875,7 +3936,7 @@ void dump_tx_power_ext_info(void *sel, _adapter *adapter) if (regsty->target_tx_pwr_valid == _TRUE) RTW_PRINT_SEL(sel, "target_tx_power: from registry\n"); else if (phy_is_tx_power_by_rate_needed(adapter)) - RTW_PRINT_SEL(sel, "target_tx_power: from power by rate\n"); + RTW_PRINT_SEL(sel, "target_tx_power: from power by rate\n"); else RTW_PRINT_SEL(sel, "target_tx_power: unavailable\n"); @@ -3919,20 +3980,22 @@ void dump_target_tx_power(void *sel, _adapter *adapter) if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) continue; - if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter)) + if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_ALL(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); - else - _RTW_PRINT_SEL(sel, "%7s: %4d\n", rate_section_str(rs), target / 2); + if (target % hal_spec->txgi_pdbm) { + _RTW_PRINT_SEL(sel, "%7s: %2d.%d\n", rate_section_str(rs) + , target / hal_spec->txgi_pdbm, (target % hal_spec->txgi_pdbm) * 100 / hal_spec->txgi_pdbm); + } else { + _RTW_PRINT_SEL(sel, "%7s: %5d\n", rate_section_str(rs) + , target / hal_spec->txgi_pdbm); + } } } } -exit: return; } @@ -3963,35 +4026,36 @@ void dump_tx_power_by_rate(void *sel, _adapter *adapter) if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) continue; - if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter)) + if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_ALL(adapter)) continue; - if (IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter)) + if (IS_HARDWARE_TYPE_JAGUAR_ALL(adapter)) max_rate_num = 10; 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); - else - _RTW_PRINT_SEL(sel, "%4d ", (base + by_rate_offset) / 2); + if ((base + by_rate_offset) % hal_spec->txgi_pdbm) { + _RTW_PRINT_SEL(sel, "%2d.%d ", (base + by_rate_offset) / hal_spec->txgi_pdbm + , ((base + by_rate_offset) % hal_spec->txgi_pdbm) * 100 / hal_spec->txgi_pdbm); + } else + _RTW_PRINT_SEL(sel, "%5d ", (base + by_rate_offset) / hal_spec->txgi_pdbm); } for (n = 0; n < max_rate_num - rate_num; n++) - _RTW_PRINT_SEL(sel, "%4s ", ""); + _RTW_PRINT_SEL(sel, "%5s ", ""); _RTW_PRINT_SEL(sel, "|"); /* 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 +4065,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->tx_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 @@ -4202,8 +4091,8 @@ int rtw_get_phy_file_path(_adapter *adapter, const char *file_name) #ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE int phy_ConfigMACWithParaFile( - IN PADAPTER Adapter, - IN char *pFileName + PADAPTER Adapter, + char *pFileName ) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); @@ -4218,7 +4107,8 @@ phy_ConfigMACWithParaFile( if ((pHalData->mac_reg_len == 0) && (pHalData->mac_reg == NULL)) { rtw_get_phy_file_path(Adapter, pFileName); - if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE) { + if (rtw_readable_file_sz_chk(rtw_phy_para_file_path, + MAX_PARA_FILE_BUF_LEN) == _TRUE) { rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); if (rlen > 0) { rtStatus = _SUCCESS; @@ -4264,9 +4154,9 @@ phy_ConfigMACWithParaFile( int phy_ConfigBBWithParaFile( - IN PADAPTER Adapter, - IN char *pFileName, - IN u32 ConfigType + PADAPTER Adapter, + char *pFileName, + u32 ConfigType ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -4297,7 +4187,8 @@ phy_ConfigBBWithParaFile( if ((pBufLen != NULL) && (*pBufLen == 0) && (pBuf == NULL)) { rtw_get_phy_file_path(Adapter, pFileName); - if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE) { + if (rtw_readable_file_sz_chk(rtw_phy_para_file_path, + MAX_PARA_FILE_BUF_LEN) == _TRUE) { rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); if (rlen > 0) { rtStatus = _SUCCESS; @@ -4373,7 +4264,7 @@ phy_ConfigBBWithParaFile( return rtStatus; } -VOID +void phy_DecryptBBPgParaFile( PADAPTER Adapter, char *buffer @@ -4411,14 +4302,19 @@ phy_DecryptBBPgParaFile( } } +#ifndef DBG_TXPWR_BY_RATE_FILE_PARSE +#define DBG_TXPWR_BY_RATE_FILE_PARSE 0 +#endif + int phy_ParseBBPgParaFile( PADAPTER Adapter, char *buffer ) { - int rtStatus = _SUCCESS; + int rtStatus = _FAIL; HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); + struct hal_spec_t *hal_spec = GET_HAL_SPEC(Adapter); char *szLine, *ptmp; u32 u4bRegOffset, u4bRegMask, u4bRegValue; u32 u4bMove; @@ -4426,8 +4322,6 @@ phy_ParseBBPgParaFile( u8 tx_num = 0; u8 band = 0, rf_path = 0; - /* RTW_INFO("=====>phy_ParseBBPgParaFile()\n"); */ - if (Adapter->registrypriv.RegDecryptCustomFile == 1) phy_DecryptBBPgParaFile(Adapter, buffer); @@ -4439,112 +4333,25 @@ phy_ParseBBPgParaFile( if (!IsCommentString(szLine)) { /* Get header info (relative value or exact value) */ if (firstLine) { - if (eqNByte(szLine, (u8 *)("#[v1]"), 5)) { - + if (eqNByte(szLine, (u8 *)("#[v1]"), 5) + || eqNByte(szLine, (u8 *)("#[v2]"), 5)) 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.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); - return _FAIL; + else { + RTW_ERR("The format in PHY_REG_PG are invalid %s\n", szLine); + goto exit; } if (eqNByte(szLine + 5, (u8 *)("[Exact]#"), 8)) { 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.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; } else { - RTW_INFO("The values in PHY_REG_PG are invalid %s\n", szLine); - return _FAIL; + RTW_ERR("The values in PHY_REG_PG are invalid %s\n", szLine); + goto exit; } } - if (pHalData->odmpriv.phy_reg_pg_version == 0) { - /* Get 1st hex value as register offset. */ - if (GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove)) { - szLine += u4bMove; - if (u4bRegOffset == 0xffff) { - /* Ending. */ - break; - } - - /* Get 2nd hex value as register mask. */ - if (GetHexValueFromString(szLine, &u4bRegMask, &u4bMove)) - szLine += u4bMove; - else - return _FAIL; - - 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_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.phy_reg_pg_value_type == PHY_REG_PG_EXACT_VALUE) { - u32 combineValue = 0; - u8 integer = 0, fraction = 0; - - if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) - szLine += u4bMove; - else - return _FAIL; - - integer *= 2; - if (fraction == 5) - integer += 1; - combineValue |= (((integer / 10) << 4) + (integer % 10)); - /* RTW_INFO(" %d", integer ); */ - - if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) - szLine += u4bMove; - else - return _FAIL; - - integer *= 2; - if (fraction == 5) - integer += 1; - combineValue <<= 8; - combineValue |= (((integer / 10) << 4) + (integer % 10)); - /* RTW_INFO(" %d", integer ); */ - - if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) - szLine += u4bMove; - else - return _FAIL; - - integer *= 2; - if (fraction == 5) - integer += 1; - combineValue <<= 8; - combineValue |= (((integer / 10) << 4) + (integer % 10)); - /* RTW_INFO(" %d", integer ); */ - - if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) - szLine += u4bMove; - else - return _FAIL; - - integer *= 2; - if (fraction == 5) - integer += 1; - combineValue <<= 8; - combineValue |= (((integer / 10) << 4) + (integer % 10)); - /* RTW_INFO(" %d", integer ); */ - 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.phy_reg_pg_version > 0) { + if (pHalData->odmpriv.phy_reg_pg_version > 0) { u32 index = 0, cnt = 0; if (eqNByte(szLine, "0xffff", 6)) @@ -4561,12 +4368,13 @@ phy_ParseBBPgParaFile( band = BAND_ON_5G; index += 6; } else { - RTW_INFO("Invalid band %s in PHY_REG_PG.txt\n", szLine); - return _FAIL; + RTW_ERR("Invalid band %s in PHY_REG_PG.txt\n", szLine); + goto exit; } rf_path = szLine[index] - 'A'; - /* RTW_INFO(" Table label Band %d, RfPath %d\n", band, rf_path ); */ + if (DBG_TXPWR_BY_RATE_FILE_PARSE) + RTW_INFO(" Table label Band %d, RfPath %d\n", band, rf_path ); } else { /* load rows of tables */ if (szLine[1] == '1') tx_num = RF_1TX; @@ -4577,8 +4385,8 @@ phy_ParseBBPgParaFile( else if (szLine[1] == '4') tx_num = RF_4TX; else { - RTW_INFO("Invalid row in PHY_REG_PG.txt '%c'(%d)\n", szLine[1], szLine[1]); - return _FAIL; + RTW_ERR("Invalid row in PHY_REG_PG.txt '%c'(%d)\n", szLine[1], szLine[1]); + goto exit; } while (szLine[index] != ']') @@ -4590,88 +4398,91 @@ phy_ParseBBPgParaFile( if (GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove)) szLine += u4bMove; else - return _FAIL; + goto exit; /* Get 2nd hex value as register mask. */ if (GetHexValueFromString(szLine, &u4bRegMask, &u4bMove)) szLine += u4bMove; else - return _FAIL; + goto exit; - 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_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.phy_reg_pg_value_type == PHY_REG_PG_EXACT_VALUE) { + if (pHalData->odmpriv.phy_reg_pg_value_type == PHY_REG_PG_EXACT_VALUE) { u32 combineValue = 0; u8 integer = 0, fraction = 0; if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) szLine += u4bMove; else - return _FAIL; + goto exit; - integer *= 2; - if (fraction == 5) - integer += 1; - combineValue |= (((integer / 10) << 4) + (integer % 10)); - /* RTW_INFO(" %d", integer ); */ + integer *= hal_spec->txgi_pdbm; + integer += ((u16)fraction * (u16)hal_spec->txgi_pdbm) / 100; + if (pHalData->odmpriv.phy_reg_pg_version == 1) + combineValue |= (((integer / 10) << 4) + (integer % 10)); + else + combineValue |= integer; if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) szLine += u4bMove; else - return _FAIL; + goto exit; - integer *= 2; - if (fraction == 5) - integer += 1; + integer *= hal_spec->txgi_pdbm; + integer += ((u16)fraction * (u16)hal_spec->txgi_pdbm) / 100; combineValue <<= 8; - combineValue |= (((integer / 10) << 4) + (integer % 10)); - /* RTW_INFO(" %d", integer ); */ + if (pHalData->odmpriv.phy_reg_pg_version == 1) + combineValue |= (((integer / 10) << 4) + (integer % 10)); + else + combineValue |= integer; if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) szLine += u4bMove; else - return _FAIL; + goto exit; - integer *= 2; - if (fraction == 5) - integer += 1; + integer *= hal_spec->txgi_pdbm; + integer += ((u16)fraction * (u16)hal_spec->txgi_pdbm) / 100; combineValue <<= 8; - combineValue |= (((integer / 10) << 4) + (integer % 10)); - /* RTW_INFO(" %d", integer ); */ + if (pHalData->odmpriv.phy_reg_pg_version == 1) + combineValue |= (((integer / 10) << 4) + (integer % 10)); + else + combineValue |= integer; if (GetFractionValueFromString(szLine, &integer, &fraction, &u4bMove)) szLine += u4bMove; else - return _FAIL; + goto exit; - integer *= 2; - if (fraction == 5) - integer += 1; + integer *= hal_spec->txgi_pdbm; + integer += ((u16)fraction * (u16)hal_spec->txgi_pdbm) / 100; combineValue <<= 8; - combineValue |= (((integer / 10) << 4) + (integer % 10)); - /* RTW_INFO(" %d", integer ); */ + if (pHalData->odmpriv.phy_reg_pg_version == 1) + combineValue |= (((integer / 10) << 4) + (integer % 10)); + else + combineValue |= integer; + 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 ); */ + if (DBG_TXPWR_BY_RATE_FILE_PARSE) + RTW_INFO("addr:0x%3x mask:0x%08x %dTx = 0x%08x\n", u4bRegOffset, u4bRegMask, tx_num + 1, combineValue); } } } } } } - /* RTW_INFO("<=====phy_ParseBBPgParaFile()\n"); */ + + rtStatus = _SUCCESS; + +exit: + RTW_INFO("%s return %d\n", __func__, rtStatus); return rtStatus; } int phy_ConfigBBWithPgParaFile( - IN PADAPTER Adapter, - IN const char *pFileName) + PADAPTER Adapter, + const char *pFileName) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); int rlen = 0, rtStatus = _FAIL; @@ -4683,7 +4494,8 @@ phy_ConfigBBWithPgParaFile( if (pHalData->bb_phy_reg_pg == NULL) { rtw_get_phy_file_path(Adapter, pFileName); - if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE) { + if (rtw_readable_file_sz_chk(rtw_phy_para_file_path, + MAX_PARA_FILE_BUF_LEN) == _TRUE) { rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); if (rlen > 0) { rtStatus = _SUCCESS; @@ -4705,7 +4517,7 @@ phy_ConfigBBWithPgParaFile( if (rtStatus == _SUCCESS) { /* RTW_INFO("phy_ConfigBBWithPgParaFile(): read %s ok\n", pFileName); */ - phy_ParseBBPgParaFile(Adapter, pHalData->para_file_buf); + rtStatus = phy_ParseBBPgParaFile(Adapter, pHalData->para_file_buf); } else RTW_INFO("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName); @@ -4716,8 +4528,8 @@ phy_ConfigBBWithPgParaFile( int phy_ConfigBBWithMpParaFile( - IN PADAPTER Adapter, - IN char *pFileName + PADAPTER Adapter, + char *pFileName ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -4732,7 +4544,8 @@ phy_ConfigBBWithMpParaFile( if ((pHalData->bb_phy_reg_mp_len == 0) && (pHalData->bb_phy_reg_mp == NULL)) { rtw_get_phy_file_path(Adapter, pFileName); - if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE) { + if (rtw_readable_file_sz_chk(rtw_phy_para_file_path, + MAX_PARA_FILE_BUF_LEN) == _TRUE) { rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); if (rlen > 0) { rtStatus = _SUCCESS; @@ -4802,9 +4615,9 @@ phy_ConfigBBWithMpParaFile( int PHY_ConfigRFWithParaFile( - IN PADAPTER Adapter, - IN char *pFileName, - IN u8 eRFPath + PADAPTER Adapter, + char *pFileName, + enum rf_path eRFPath ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -4819,11 +4632,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; @@ -4836,7 +4649,8 @@ PHY_ConfigRFWithParaFile( if ((pBufLen != NULL) && (*pBufLen == 0) && (pBuf == NULL)) { rtw_get_phy_file_path(Adapter, pFileName); - if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE) { + if (rtw_readable_file_sz_chk(rtw_phy_para_file_path, + MAX_PARA_FILE_BUF_LEN) == _TRUE) { rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); if (rlen > 0) { rtStatus = _SUCCESS; @@ -4846,12 +4660,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); @@ -4921,7 +4738,7 @@ PHY_ConfigRFWithParaFile( return rtStatus; } -VOID +void initDeltaSwingIndexTables( PADAPTER Adapter, char *Band, @@ -4949,8 +4766,8 @@ initDeltaSwingIndexTables( } } while (0)\ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - struct PHY_DM_STRUCT *pDM_Odm = &pHalData->odmpriv; - struct odm_rf_calibration_structure *pRFCalibrateInfo = &(pDM_Odm->rf_calibrate_info); + struct dm_struct *pDM_Odm = &pHalData->odmpriv; + struct dm_rf_calibration_struct *pRFCalibrateInfo = &(pDM_Odm->rf_calibrate_info); u32 j = 0; char *token; char delim[] = ","; @@ -5013,13 +4830,13 @@ initDeltaSwingIndexTables( int PHY_ConfigRFWithTxPwrTrackParaFile( - IN PADAPTER Adapter, - IN char *pFileName + PADAPTER Adapter, + char *pFileName ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - struct PHY_DM_STRUCT *pDM_Odm = &pHalData->odmpriv; - struct odm_rf_calibration_structure *pRFCalibrateInfo = &(pDM_Odm->rf_calibrate_info); + struct dm_struct *pDM_Odm = &pHalData->odmpriv; + struct dm_rf_calibration_struct *pRFCalibrateInfo = &(pDM_Odm->rf_calibrate_info); int rlen = 0, rtStatus = _FAIL; char *szLine, *ptmp; u32 i = 0, j = 0; @@ -5032,7 +4849,8 @@ PHY_ConfigRFWithTxPwrTrackParaFile( if ((pHalData->rf_tx_pwr_track_len == 0) && (pHalData->rf_tx_pwr_track == NULL)) { rtw_get_phy_file_path(Adapter, pFileName); - if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE) { + if (rtw_readable_file_sz_chk(rtw_phy_para_file_path, + MAX_PARA_FILE_BUF_LEN) == _TRUE) { rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); if (rlen > 0) { rtStatus = _SUCCESS; @@ -5109,23 +4927,142 @@ PHY_ConfigRFWithTxPwrTrackParaFile( return rtStatus; } -int +#if 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 ) { - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - struct PHY_DM_STRUCT *pDM_Odm = &(pHalData->odmpriv); - u32 i = 0, forCnt = 0; - u8 loadingStage = 0, limitValue = 0, fraction = 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]; - u8 colNum = 0; +#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 - RTW_INFO("===>phy_ParsePowerLimitTableFile()\n"); + int rtStatus = _FAIL; + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); + struct hal_spec_t *hal_spec = GET_HAL_SPEC(Adapter); + struct dm_struct *pDM_Odm = &(pHalData->odmpriv); + u8 loadingStage = LD_STAGE_EXC_MAPPING; + u32 i = 0, forCnt = 0; + char *szLine, *ptmp; + char band[10], bandwidth[10], rateSection[10], ntx[10], colNumBuf[10]; + char **regulation = NULL; + u8 colNum = 0; if (Adapter->registrypriv.RegDecryptCustomFile == 1) phy_DecryptBBPgParaFile(Adapter, buffer); @@ -5134,20 +5071,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 +5101,30 @@ phy_ParsePowerLimitTableFile( szLine[--i] = ' '; /* return the space in front of the regulation info */ /* Parse the label of the table */ + _rtw_memset((void *) band, 0, 10); + _rtw_memset((void *) bandwidth, 0, 10); + _rtw_memset((void *) ntx, 0, 10); + _rtw_memset((void *) 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 +5134,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 +5149,59 @@ phy_ParsePowerLimitTableFile( while (szLine[i] == ' ' || szLine[i] == '\t') ++i; + _rtw_memset((void *) 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 +5212,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' */ @@ -5275,88 +5254,89 @@ phy_ParsePowerLimitTableFile( ++i; /* load the power limit value */ - cnt = 0; - fraction = 0; - _rtw_memset((PVOID) powerLimit, 0, 10); - while ((szLine[i] >= '0' && szLine[i] <= '9') || szLine[i] == '.') { - 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_memset((void *) powerLimit, 0, 10); - break; - } + if (szLine[i] == 'W' && szLine[i + 1] == 'W') { + /* + * case "WW" assign special ww value + * means to get minimal limit in other regulations at same channel + */ + s8 ww_value = phy_txpwr_ww_lmt_value(Adapter); - powerLimit[cnt] = szLine[i]; - ++cnt; - ++i; - } - - if (powerLimit[0] == '\0') { - powerLimit[0] = '6'; - powerLimit[1] = '3'; + sprintf(powerLimit, "%d", ww_value); i += 2; + + } else if (szLine[i] == 'N' && szLine[i + 1] == 'A') { + /* + * case "NA" assign max txgi value + * means no limitation + */ + sprintf(powerLimit, "%d", hal_spec->txgi_max); + i += 2; + + } else if ((szLine[i] >= '0' && szLine[i] <= '9') || szLine[i] == '.' + || szLine[i] == '+' || szLine[i] == '-' + ){ + /* case of dBm value */ + u8 integer = 0, fraction = 0, negative = 0; + u32 u4bMove; + s8 lmt = 0; + + if (szLine[i] == '+' || szLine[i] == '-') { + if (szLine[i] == '-') + negative = 1; + i++; + } + + if (GetFractionValueFromString(&szLine[i], &integer, &fraction, &u4bMove)) + i += u4bMove; + else { + RTW_ERR("Limit \"%s\" is not valid decimal\n", &szLine[i]); + goto exit; + } + + /* transform to string of value in unit of txgi */ + lmt = integer * hal_spec->txgi_pdbm + ((u16)fraction * (u16)hal_spec->txgi_pdbm) / 100; + if (negative) + lmt = -lmt; + sprintf(powerLimit, "%d", lmt); + } else { - if (!GetU1ByteIntegerFromStringInDecimal(powerLimit, &limitValue)) - return _FAIL; - - limitValue *= 2; - cnt = 0; - if (fraction == '5') - ++limitValue; - - /* the value is greater or equal to 100 */ - if (limitValue >= 100) { - powerLimit[cnt++] = limitValue / 100 + '0'; - limitValue %= 100; - - if (limitValue >= 10) { - powerLimit[cnt++] = limitValue / 10 + '0'; - limitValue %= 10; - } else - powerLimit[cnt++] = '0'; - - powerLimit[cnt++] = limitValue + '0'; - } - /* the value is greater or equal to 10 */ - else if (limitValue >= 10) { - powerLimit[cnt++] = limitValue / 10 + '0'; - limitValue %= 10; - powerLimit[cnt++] = limitValue + '0'; - } - /* the value is less than 10 */ - else - powerLimit[cnt++] = limitValue + '0'; - - powerLimit[cnt] = '\0'; + RTW_ERR("Wrong limit expression \"%c%c\"(%d, %d)\n" + , szLine[i], szLine[i + 1], szLine[i], szLine[i + 1]); + goto exit; } - /* RTW_INFO("ch%s => %s\n", channel, powerLimit); */ - /* store the power limit value */ phy_set_tx_power_limit(pDM_Odm, (u8 *)regulation[forCnt], (u8 *)band, - (u8 *)bandwidth, (u8 *)rateSection, (u8 *)rfPath, (u8 *)channel, (u8 *)powerLimit); + (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; } int PHY_ConfigRFWithPowerLimitTableParaFile( - IN PADAPTER Adapter, - IN const char *pFileName + PADAPTER Adapter, + const char *pFileName ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -5369,7 +5349,8 @@ PHY_ConfigRFWithPowerLimitTableParaFile( if (pHalData->rf_tx_pwr_lmt == NULL) { rtw_get_phy_file_path(Adapter, pFileName); - if (rtw_is_file_readable(rtw_phy_para_file_path) == _TRUE) { + if (rtw_readable_file_sz_chk(rtw_phy_para_file_path, + MAX_PARA_FILE_BUF_LEN) == _TRUE) { rlen = rtw_retrieve_from_file(rtw_phy_para_file_path, pHalData->para_file_buf, MAX_PARA_FILE_BUF_LEN); if (rlen > 0) { rtStatus = _SUCCESS; @@ -5397,6 +5378,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/rtl8188eu/hal/hal_dm.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_dm.c index 2198617ddfe7..e1b9e6a84f42 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_dm.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_dm.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,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. */ -enum odm_board_type_e boardType(u8 InterfaceSel) +enum odm_board_type boardType(u8 InterfaceSel) { - enum odm_board_type_e board = ODM_BOARD_DEFAULT; + enum odm_board_type board = ODM_BOARD_DEFAULT; #ifdef CONFIG_PCI_HCI INTERFACE_SELECT_PCIE pcie = (INTERFACE_SELECT_PCIE)InterfaceSel; @@ -70,22 +66,264 @@ enum 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 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 (rtw_mi_check_status(adapter, MI_LINKED)) { + LPS_Leave(adapter, "SWITCH_IQK_OFFLOAD"); + halrf_iqk_trigger(p_dm_odm, _FALSE); + } +} + +#if ((RTL8822B_SUPPORT == 1) || (RTL8821C_SUPPORT == 1) || (RTL8814B_SUPPORT == 1) || (RTL8822C_SUPPORT == 1)) +void rtw_phydm_iqk_trigger(_adapter *adapter) +{ + struct dm_struct *p_dm_odm = adapter_to_phydm(adapter); + u8 clear = _TRUE; + u8 segment = _FALSE; + u8 rfk_forbidden = _FALSE; + + halrf_cmn_info_set(p_dm_odm, HALRF_CMNINFO_RFK_FORBIDDEN, rfk_forbidden); +#if (RTL8822C_SUPPORT == 1) + /* halrf_cmn_info_set(p_dm_odm, HALRF_CMNINFO_IQK_SEGMENT, segment); to do */ + halrf_rf_k_connect_trigger(p_dm_odm, _TRUE, SEGMENT_FREE); +#else + /*segment = _rtw_phydm_iqk_segment_chk(adapter);*/ + halrf_cmn_info_set(p_dm_odm, HALRF_CMNINFO_IQK_SEGMENT, segment); + halrf_segment_iqk_trigger(p_dm_odm, clear, segment); +#endif +} +#endif + +void rtw_phydm_iqk_trigger_dbg(_adapter *adapter, bool recovery, bool clear, bool segment) +{ + struct dm_struct *p_dm_odm = adapter_to_phydm(adapter); + +#if ((RTL8822B_SUPPORT == 1) || (RTL8821C_SUPPORT == 1) || (RTL8814B_SUPPORT == 1) || (RTL8822C_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 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 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 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 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 dm_struct *p_dm = (struct 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); + + if (p_sta) { + 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)); + } +} + +#ifdef CONFIG_SUPPORT_DYNAMIC_TXPWR +void rtw_phydm_fill_desc_dpt(void *dm, u8 *desc, u8 dpt_lv) +{ + struct dm_struct *p_dm = (struct dm_struct *)dm; + _adapter *adapter = p_dm->adapter; + + switch (rtw_get_chip_type(adapter)) { +/* + #ifdef CONFIG_RTL8188F + case RTL8188F: + break; + #endif + + #ifdef CONFIG_RTL8723B + case RTL8723B : + break; + #endif + + #ifdef CONFIG_RTL8703B + case RTL8703B : + break; + #endif + + #ifdef CONFIG_RTL8812A + case RTL8812 : + break; + #endif + + #ifdef CONFIG_RTL8821A + case RTL8821: + break; + #endif + + #ifdef CONFIG_RTL8814A + case RTL8814A : + break; + #endif + + #ifdef CONFIG_RTL8192F + case RTL8192F : + break; + #endif +*/ +/* + #ifdef CONFIG_RTL8192E + case RTL8192E : + SET_TX_DESC_TX_POWER_0_PSET_92E(desc, dpt_lv); + break; + #endif +*/ + + #ifdef CONFIG_RTL8821C + case RTL8821C : + SET_TX_DESC_TXPWR_OFSET_8821C(desc, dpt_lv); + break; + #endif + + default : + RTW_ERR("%s IC not support dynamic tx power\n", __func__); + break; + } +} +void rtw_phydm_set_dyntxpwr(_adapter *adapter, u8 *desc, u8 mac_id) +{ + struct dm_struct *dm = adapter_to_phydm(adapter); + + odm_set_dyntxpwr(dm, desc, mac_id); +} +#endif + +#ifdef CONFIG_RTW_TX_2PATH_EN +void rtw_phydm_tx_2path_en(_adapter *adapter) +{ + struct dm_struct *dm = adapter_to_phydm(adapter); + + phydm_tx_2path(dm); +} +#endif +#ifdef CONFIG_TDMADIG +void rtw_phydm_tdmadig(_adapter *adapter, u8 state) +{ + struct registry_priv *pregistrypriv = &adapter->registrypriv; + struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); + struct dm_struct *dm = adapter_to_phydm(adapter); + u8 tdma_dig_en; + + switch (state) { + case TDMADIG_INIT: + phydm_tdma_dig_para_upd(dm, ENABLE_TDMA, pregistrypriv->tdmadig_en); + phydm_tdma_dig_para_upd(dm, MODE_DECISION, pregistrypriv->tdmadig_mode); + break; + case TDMADIG_NON_INIT: + if(pregistrypriv->tdmadig_dynamic) { + if(pmlmepriv->LinkDetectInfo.bBusyTraffic == _TRUE) + tdma_dig_en = 0; + else + tdma_dig_en = pregistrypriv->tdmadig_en; + phydm_tdma_dig_para_upd(dm, ENABLE_TDMA, tdma_dig_en); + } + break; + default: + break; + + } +} +#endif/*CONFIG_TDMADIG*/ +void rtw_phydm_ops_func_init(struct dm_struct *p_phydm) +{ + struct ra_table *p_ra_t = &p_phydm->dm_ra_table; + + p_ra_t->record_ra_info = record_ra_info; + #ifdef CONFIG_SUPPORT_DYNAMIC_TXPWR + p_phydm->fill_desc_dyntxpwr = rtw_phydm_fill_desc_dpt; + #endif +} +void rtw_phydm_priv_init(_adapter *adapter) +{ + PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); + struct dm_struct *phydm = &(hal->odmpriv); + + phydm->adapter = adapter; + odm_cmn_info_init(phydm, ODM_CMNINFO_PLATFORM, ODM_CE); +} + void Init_ODM_ComInfo(_adapter *adapter) { struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); PHAL_DATA_TYPE pHalData = GET_HAL_DATA(adapter); - struct PHY_DM_STRUCT *pDM_Odm = &(pHalData->odmpriv); - struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; - struct mlme_priv *pmlmepriv = &adapter->mlmepriv; + struct 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; - - odm_cmn_info_init(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*/ rtw_odm_init_ic_type(adapter); if (rtw_get_intf_type(adapter) == RTW_GSPI) @@ -99,28 +337,10 @@ void Init_ODM_ComInfo(_adapter *adapter) odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_BWIFI_TEST, adapter->registrypriv.wifi_spec); - - if (pHalData->rf_type == RF_1T1R) - odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_1T1R); - else if (pHalData->rf_type == RF_1T2R) - odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_1T2R); - else if (pHalData->rf_type == RF_2T2R) - odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_2T2R); - else if (pHalData->rf_type == RF_2T2R_GREEN) - odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_2T2R_GREEN); - else if (pHalData->rf_type == RF_2T3R) - odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_2T3R); - else if (pHalData->rf_type == RF_2T4R) - odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_2T4R); - else if (pHalData->rf_type == RF_3T3R) - odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_3T3R); - else if (pHalData->rf_type == RF_3T4R) - odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_3T4R); - else if (pHalData->rf_type == RF_4T4R) - odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_4T4R); - else - odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_XTXR); - +#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 ======= */ @@ -149,12 +369,11 @@ void Init_ODM_ComInfo(_adapter *adapter) /* 1 ============== End of BoardType ============== */ } - odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_DOMAIN_CODE_2G, pHalData->Regulation2_4G); - odm_cmn_info_init(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_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)); + odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_DFS_MASTER_ENABLE, &(adapter_to_rfctl(adapter)->radar_detect_enabled)); #endif odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_GPA, pHalData->TypeGPA); @@ -163,6 +382,7 @@ void Init_ODM_ComInfo(_adapter *adapter) odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_ALNA, pHalData->TypeALNA); odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_RFE_TYPE, pHalData->rfe_type); + odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_X_CAP_SETTING, pHalData->crystal_cap); odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_EXT_TRSW, 0); @@ -170,55 +390,1292 @@ void Init_ODM_ComInfo(_adapter *adapter) 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_cmn_info_hook(pDM_Odm, ODM_CMNINFO_ANT_DIV, &(pHalData->AntDivCfg)); 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); + + /* waiting for PhyDMV034 support*/ + odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_MANUAL_SUPPORTABILITY, &(adapter->registrypriv.phydm_ability)); /*Add by YuChen for adaptivity init*/ 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_PWT_TYPE, 0); + + 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 - odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_IQKFWOFFLOAD, pHalData->RegIQKFWOffload); + 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 */ + /*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_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_cmn_info_hook(pDM_Odm, ODM_CMNINFO_WM_MODE, &(pmlmeext->cur_wireless_mode)); + 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_FORCED_IGI_LB, &(pHalData->u1ForcedIgiLb)); 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_FORCED_IGI_LB, &(pHalData->u1ForcedIgiLb)); - odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_SCAN, &(pmlmepriv->bScanInProcess)); + 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_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_cmn_info_hook(pDM_Odm, ODM_CMNINFO_HUBUSBMODE, &(dvobj->usb_speed)); #endif + +#ifdef CONFIG_DYNAMIC_SOML + odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_ADAPTIVE_SOML, &(adapter->registrypriv.dyn_soml_en)); +#endif + + odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_FCS_MODE, &(pHalData->multi_ch_switch_mode)); + + /*halrf info hook*/ + /* waiting for PhyDMV034 support*/ + halrf_cmn_info_hook(pDM_Odm, HALRF_CMNINFO_MANUAL_RF_SUPPORTABILITY, &(adapter->registrypriv.halrf_ability)); +#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_cmn_info_ptr_array_hook(pDM_Odm, ODM_CMNINFO_STA_STATUS, i, NULL); - - phydm_init_debug_setting(pDM_Odm); + phydm_cmn_sta_info_hook(pDM_Odm, i, NULL); + rtw_phydm_ops_func_init(pDM_Odm); + phydm_dm_early_init(pDM_Odm); /* TODO */ /* 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}; + + +struct turbo_edca_setting{ + u32 edca_ul; /* uplink, tx */ + u32 edca_dl; /* downlink, rx */ +}; + +#define TURBO_EDCA_ENT(UL, DL) {UL, DL} + +#if 0 +#define TURBO_EDCA_MODE_NUM 18 +static struct turbo_edca_setting rtw_turbo_edca[TURBO_EDCA_MODE_NUM] = { + TURBO_EDCA_ENT(0xa42b, 0xa42b), /* mode 0 */ + TURBO_EDCA_ENT(0x431c, 0x431c), /* mode 1 */ + TURBO_EDCA_ENT(0x4319, 0x4319), /* mode 2 */ + + TURBO_EDCA_ENT(0x5ea42b, 0x5ea42b), /* mode 3 */ + TURBO_EDCA_ENT(0x5e431c, 0x5e431c), /* mode 4 */ + TURBO_EDCA_ENT(0x5e4319, 0x5e4319), /* mode 5 */ + + TURBO_EDCA_ENT(0x6ea42b, 0x6ea42b), /* mode 6 */ + TURBO_EDCA_ENT(0x6e431c, 0x6e431c), /* mode 7 */ + TURBO_EDCA_ENT(0x6e4319, 0x6e4319), /* mode 8 */ + + TURBO_EDCA_ENT(0x5ea42b, 0xa42b), /* mode 9 */ + TURBO_EDCA_ENT(0x5e431c, 0x431c), /* mode 10 */ + TURBO_EDCA_ENT(0x5e4319, 0x4319), /* mode 11 */ + + TURBO_EDCA_ENT(0x6ea42b, 0xa42b), /* mode 12 */ + TURBO_EDCA_ENT(0x6e431c, 0x431c), /* mode 13 */ + TURBO_EDCA_ENT(0x6e4319, 0x4319), /* mode 14 */ + + TURBO_EDCA_ENT(0x431c, 0x5e431c), /* mode 15 */ + + TURBO_EDCA_ENT(0xa42b, 0x5ea42b), /* mode 16 */ + + TURBO_EDCA_ENT(0x138642b, 0x431c), /* mode 17 */ +}; +#else +#define TURBO_EDCA_MODE_NUM 8 +static struct turbo_edca_setting rtw_turbo_edca[TURBO_EDCA_MODE_NUM] = { + /* { UL, DL } */ + TURBO_EDCA_ENT(0x5e431c, 0x431c), /* mode 0 */ + + TURBO_EDCA_ENT(0x431c, 0x431c), /* mode 1 */ + + TURBO_EDCA_ENT(0x5e431c, 0x5e431c), /* mode 2 */ + + TURBO_EDCA_ENT(0x5ea42b, 0x5ea42b), /* mode 3 */ + + TURBO_EDCA_ENT(0x5ea42b, 0x431c), /* mode 4 */ + + TURBO_EDCA_ENT(0x6ea42b, 0x6ea42b), /* mode 5 */ + + TURBO_EDCA_ENT(0xa42b, 0xa42b), /* mode 6 */ + + TURBO_EDCA_ENT(0x5e431c, 0xa42b), /* mode 7 */ +}; +#endif + +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 == 1) + 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) || (ic_type == RTL8192F)) { /* 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 == RTL8822C) + || (ic_type == RTL8814A))) { + EDCA_BE_UL = 0x6ea42b; + EDCA_BE_DL = 0x6ea42b; + } + + if ((ic_type == RTL8822B) + && (interface_type == RTW_SDIO)) + EDCA_BE_DL = 0x00431c; + +#ifdef CONFIG_RTW_TPT_MODE + if ( dvobj->tpt_mode > 0 ) { + EDCA_BE_UL = dvobj->edca_be_ul; + EDCA_BE_DL = dvobj->edca_be_dl; + } +#endif /* CONFIG_RTW_TPT_MODE */ + + /* keep this condition at last check */ + if (hal_data->dis_turboedca == 2) { + + if (hal_data->edca_param_mode < TURBO_EDCA_MODE_NUM) { + + struct turbo_edca_setting param; + + param = rtw_turbo_edca[hal_data->edca_param_mode]; + + EDCA_BE_UL = param.edca_ul; + EDCA_BE_DL = param.edca_dl; + + } else { + + EDCA_BE_UL = hal_data->edca_param_mode; + EDCA_BE_DL = hal_data->edca_param_mode; + } + } + + if (traffic_index == DOWN_LINK) + edca_param = EDCA_BE_DL; + else + edca_param = EDCA_BE_UL; + +#ifdef CONFIG_EXTEND_LOWRATE_TXOP +#define TXOP_CCK1M 0x01A6 +#define TXOP_CCK2M 0x00E6 +#define TXOP_CCK5M 0x006B +#define TXOP_OFD6M 0x0066 +#define TXOP_MCS6M 0x0061 +{ + struct sta_info *psta; + struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); + u8 mac_id, role, current_rate_id; + + /* search all used & connect2AP macid */ + for (mac_id = 0; mac_id < macid_ctl->num; mac_id++) { + if (rtw_macid_is_used(macid_ctl, mac_id)) { + role = GET_H2CCMD_MSRRPT_PARM_ROLE(&(macid_ctl->h2c_msr[mac_id])); + if (role != H2C_MSR_ROLE_AP) + continue; + + psta = macid_ctl->sta[mac_id]; + current_rate_id = rtw_get_current_tx_rate(adapter, psta); + /* Check init tx_rate==1M and set 0x508[31:16]==0x019B(unit 32us) if it is */ + switch (current_rate_id) { + case DESC_RATE1M: + edca_param &= 0x0000FFFF; + edca_param |= (TXOP_CCK1M<<16); + break; + case DESC_RATE2M: + edca_param &= 0x0000FFFF; + edca_param |= (TXOP_CCK2M<<16); + break; + case DESC_RATE5_5M: + edca_param &= 0x0000FFFF; + edca_param |= (TXOP_CCK5M<<16); + break; + case DESC_RATE6M: + edca_param &= 0x0000FFFF; + edca_param |= (TXOP_OFD6M<<16); + break; + case DESC_RATEMCS0: + edca_param &= 0x0000FFFF; + edca_param |= (TXOP_MCS6M<<16); + break; + default: + break; + } + } + } +} +#endif /* CONFIG_EXTEND_LOWRATE_TXOP */ + +#ifdef CONFIG_RTW_CUSTOMIZE_BEEDCA + edca_param = CONFIG_RTW_CUSTOMIZE_BEEDCA; +#endif + + if ( edca_param != hal_data->ac_param_be) { + + rtw_hal_set_hwreg(adapter, HW_VAR_AC_PARAM_BE, (u8 *)(&edca_param)); + + RTW_INFO("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_dm_get_min_rssi(_adapter *adapter) +{ + struct macid_ctl_t *macid_ctl = adapter_to_macidctl(adapter); + struct sta_info *sta; + s8 min_rssi = 127, rssi; + int i; + + for (i = 0; i < MACID_NUM_SW_LIMIT; i++) { + sta = macid_ctl->sta[i]; + if (!sta || !GET_H2CCMD_MSRRPT_PARM_OPMODE(macid_ctl->h2c_msr + i) + || is_broadcast_mac_addr(sta->cmn.mac_addr)) + continue; + rssi = sta->cmn.rssi_stat.rssi; + if (rssi >= 0 && min_rssi > rssi) + min_rssi = rssi; + } + + return min_rssi == 127 ? 0 : min_rssi; +} + +s8 rtw_phydm_get_min_rssi(_adapter *adapter) +{ + struct dm_struct *phydm = adapter_to_phydm(adapter); + s8 rssi_min = 0; + + rssi_min = phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_RSSI_MIN); + return rssi_min; +} + +u8 rtw_phydm_get_cur_igi(_adapter *adapter) +{ + struct dm_struct *phydm = adapter_to_phydm(adapter); + u8 cur_igi = 0; + + cur_igi = phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_CURR_IGI); + return cur_igi; +} + +u32 rtw_phydm_get_phy_cnt(_adapter *adapter, enum phy_cnt cnt) +{ + struct dm_struct *phydm = adapter_to_phydm(adapter); + + if (cnt == FA_OFDM) + return phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_FA_OFDM); + else if (cnt == FA_CCK) + return phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_FA_CCK); + else if (cnt == FA_TOTAL) + return phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_FA_TOTAL); + else if (cnt == CCA_OFDM) + return phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_CCA_OFDM); + else if (cnt == CCA_CCK) + return phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_CCA_CCK); + else if (cnt == CCA_ALL) + return phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_CCA_ALL); + else if (cnt == CRC32_OK_VHT) + return phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_CRC32_OK_VHT); + else if (cnt == CRC32_OK_HT) + return phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_CRC32_OK_HT); + else if (cnt == CRC32_OK_LEGACY) + return phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_CRC32_OK_LEGACY); + else if (cnt == CRC32_OK_CCK) + return phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_CRC32_OK_CCK); + else if (cnt == CRC32_ERROR_VHT) + return phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_CRC32_ERROR_VHT); + else if (cnt == CRC32_ERROR_HT) + return phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_CRC32_ERROR_HT); + else if (cnt == CRC32_ERROR_LEGACY) + return phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_CRC32_ERROR_LEGACY); + else if (cnt == CRC32_ERROR_CCK) + return phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_CRC32_ERROR_CCK); + else + return 0; +} + +u8 rtw_phydm_is_iqk_in_progress(_adapter *adapter) +{ + u8 rts = _FALSE; + struct 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, + void *pValue1, + BOOLEAN bSet) +{ + struct 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); + 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; + 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 */ + phydm_adaptivity_info_update(podmpriv, PHYDM_ADAPINFO_DOMAIN_CODE_2G, 0); + phydm_adaptivity_info_update(podmpriv, PHYDM_ADAPINFO_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(%%)(%d(%%)), current_igi = 0x%x\n" + , podmpriv->is_linked, rssi_min, rtw_dm_get_min_rssi(Adapter), 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, + void *pValue1, + void *pValue2) +{ + struct 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 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 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 = (mask) ? 1 : 0; + 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 = (mask) ? 1 : 0; + 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 = (mask) ? 1 : 0; + 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 = (mask) ? 1 : 0; + 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 = (mask) ? 1 : 0; + 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 = (mask) ? 1 : 0; + 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 = (mask) ? 1 : 0; + 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 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; + u8 cur_igi = 0; + s8 min_rssi = 0; + + if (!rtw_is_hw_init_completed(adapter)) + return; + + cur_igi = rtw_phydm_get_cur_igi(adapter); + min_rssi = rtw_dm_get_min_rssi(adapter); + /*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; + u32 tx_tp_mbips, rx_tp_mbips, bi_tp_mbips; + + if (!psta) + return; + RTW_PRINT_SEL(sel, "\n"); + RTW_PRINT_SEL(sel, "====== mac_id : %d [" MAC_FMT "] ======\n", + psta->cmn.mac_id, MAC_ARG(psta->cmn.mac_addr)); + + if (is_client_associated_to_ap(psta->padapter)) + RTW_PRINT_SEL(sel, "BCN counts : %d (per-%d second), DTIM Period:%d\n", + rtw_get_bcn_cnt(psta->padapter) / 2, 1, rtw_get_bcn_dtim_period(psta->padapter)); + + ra_info = &psta->cmn.ra_info; + curr_sgi = rtw_get_current_tx_sgi(adapter, psta); + RTW_PRINT_SEL(sel, "tx_rate : %s(%s) rx_rate : %s, rx_rate_bmc : %s, rssi : %d %%\n" + , HDATA_RATE(rtw_get_current_tx_rate(adapter, psta)), (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, "RTW: [TP] "); + tx_tp_mbips = psta->sta_stats.tx_tp_kbits >> 10; + rx_tp_mbips = psta->sta_stats.rx_tp_kbits >> 10; + bi_tp_mbips = tx_tp_mbips + rx_tp_mbips; + + if (tx_tp_mbips) + _RTW_PRINT_SEL(sel, "Tx : %d(Mbps) ", tx_tp_mbips); + else + _RTW_PRINT_SEL(sel, "Tx : %d(Kbps) ", psta->sta_stats.tx_tp_kbits); + + if (rx_tp_mbips) + _RTW_PRINT_SEL(sel, "Rx : %d(Mbps) ", rx_tp_mbips); + else + _RTW_PRINT_SEL(sel, "Rx : %d(Kbps) ", psta->sta_stats.rx_tp_kbits); + + if (bi_tp_mbips) + _RTW_PRINT_SEL(sel, "Total : %d(Mbps)\n", bi_tp_mbips); + else + _RTW_PRINT_SEL(sel, "Total : %d(Kbps)\n", psta->sta_stats.tx_tp_kbits + psta->sta_stats.rx_tp_kbits); + + + _RTW_PRINT_SEL(sel, "RTW: [Smooth TP] "); + tx_tp_mbips = psta->sta_stats.smooth_tx_tp_kbits >> 10; + rx_tp_mbips = psta->sta_stats.smooth_rx_tp_kbits >> 10; + bi_tp_mbips = tx_tp_mbips + rx_tp_mbips; + if (tx_tp_mbips) + _RTW_PRINT_SEL(sel, "Tx : %d(Mbps) ", tx_tp_mbips); + else + _RTW_PRINT_SEL(sel, "Tx : %d(Kbps) ", psta->sta_stats.smooth_tx_tp_kbits); + + if (rx_tp_mbips) + _RTW_PRINT_SEL(sel, "Rx : %d(Mbps) ", rx_tp_mbips); + else + _RTW_PRINT_SEL(sel, "Rx : %d(Kbps) ", psta->sta_stats.smooth_rx_tp_kbits); + + if (bi_tp_mbips) + _RTW_PRINT_SEL(sel, "Total : %d(Mbps)\n", bi_tp_mbips); + else + _RTW_PRINT_SEL(sel, "Total : %d(Kbps)\n", psta->sta_stats.smooth_tx_tp_kbits + psta->sta_stats.rx_tp_kbits); + + #if 0 + 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); + #endif +} + +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, "static smps : %s\n", (psta->cmn.sm_ps == SM_PS_STATIC) ? "Y" : "N"); + 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 = rtw_get_current_tx_sgi(psta->padapter, psta); + curr_tx_rate = rtw_get_current_tx_rate(psta->padapter, psta); + 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); + dump_sta_info(RTW_DBGDUMP, psta); +} + +static void init_phydm_info(_adapter *adapter) +{ + PHAL_DATA_TYPE hal_data = GET_HAL_DATA(adapter); + struct dm_struct *phydm = &(hal_data->odmpriv); + + odm_cmn_info_update(phydm, ODM_CMNINFO_IS_DOWNLOAD_FW, hal_data->bFWReady); + odm_cmn_info_init(phydm, ODM_CMNINFO_FW_VER, hal_data->firmware_version); + odm_cmn_info_init(phydm, ODM_CMNINFO_FW_SUB_VER, hal_data->firmware_sub_version); +} +void rtw_phydm_init(_adapter *adapter) +{ + PHAL_DATA_TYPE hal_data = GET_HAL_DATA(adapter); + struct dm_struct *phydm = &(hal_data->odmpriv); + + init_phydm_info(adapter); + odm_dm_init(phydm); +#ifdef CONFIG_CUSTOMER01_SMART_ANTENNA + phydm_pathb_q_matrix_rotate_en(phydm); +#endif +} + +bool rtw_phydm_set_crystal_cap(_adapter *adapter, u8 crystal_cap) +{ + PHAL_DATA_TYPE hal_data = GET_HAL_DATA(adapter); + struct dm_struct *phydm = &(hal_data->odmpriv); + + return phydm_set_crystal_cap_reg(phydm, crystal_cap); +} + +#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; +} +*/ +void rtw_phydm_lps_pg_hdl(_adapter *adapter, struct sta_info *sta, bool in_lpspg) +{ + struct dm_struct *phydm = adapter_to_phydm(adapter); + /*u8 rate_id;*/ + + if(sta == NULL) { + RTW_ERR("%s sta is null\n", __func__); + rtw_warn_on(1); + return; + } + + if (in_lpspg) { + sta->cmn.ra_info.disable_ra = _TRUE; + sta->cmn.ra_info.disable_pt = _TRUE; + /*TODO : DRV fix tx rate*/ + /*rate_id = phydm_get_rate_from_rssi_lv(phydm, sta->cmn.mac_id);*/ + } else { + sta->cmn.ra_info.disable_ra = _FALSE; + sta->cmn.ra_info.disable_pt = _FALSE; + } + + rtw_phydm_ra_registed(adapter, sta); +} +#endif + +/*#define DBG_PHYDM_STATE_CHK*/ + + +static u8 _rtw_phydm_rfk_condition_check(_adapter *adapter, u8 is_scaning, u8 ifs_linked) +{ + u8 rfk_allowed = _TRUE; + + #ifdef CONFIG_SKIP_RFK_IN_DM + rfk_allowed = _FALSE; + if (0) + RTW_ERR("[RFK-CHK] RF-K not allowed due to CONFIG_SKIP_RFK_IN_DM\n"); + return rfk_allowed; + #endif + + #ifdef CONFIG_MCC_MODE + /*not in MCC State*/ + if (MCC_EN(adapter) && + rtw_hal_check_mcc_status(adapter, MCC_STATUS_DOING_MCC)) { + rfk_allowed = _FALSE; + if (0) + RTW_INFO("[RFK-CHK] RF-K not allowed due to doing MCC\n"); + return rfk_allowed; + } + #endif + + #if defined(CONFIG_TDLS) && defined(CONFIG_TDLS_CH_SW) + + #endif + + if (ifs_linked) { + if (is_scaning) { + rfk_allowed = _FALSE; + RTW_DBG("[RFK-CHK] RF-K not allowed due to ifaces under site-survey\n"); + } + else { + rfk_allowed = rtw_mi_stayin_union_ch_chk(adapter) ? _TRUE : _FALSE; + if (rfk_allowed == _FALSE) + RTW_ERR("[RFK-CHK] RF-K not allowed due to ld_iface not stayin union ch\n"); + } + } + + return rfk_allowed; +} + +#if ((RTL8822B_SUPPORT == 1) || (RTL8821C_SUPPORT == 1) || (RTL8814B_SUPPORT == 1) || (RTL8822C_SUPPORT == 1)) +static u8 _rtw_phydm_iqk_segment_chk(_adapter *adapter, u8 ifs_linked) +{ + u8 iqk_sgt = _FALSE; + +#if 0 + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + if (ifs_linked && (dvobj->traffic_stat.cur_tx_tp > 2 || dvobj->traffic_stat.cur_rx_tp > 2)) + rst = _TRUE; +#else + if (ifs_linked) + iqk_sgt = _TRUE; +#endif + return iqk_sgt; +} +#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; +} + +#ifdef CONFIG_DYNAMIC_SOML +void rtw_dyn_soml_byte_update(_adapter *adapter, u8 data_rate, u32 size) +{ + struct dm_struct *phydm = adapter_to_phydm(adapter); + + phydm_soml_bytes_acq(phydm, data_rate, size); +} + +void rtw_dyn_soml_para_set(_adapter *adapter, u8 train_num, u8 intvl, + u8 period, u8 delay) +{ + struct dm_struct *phydm = adapter_to_phydm(adapter); + + phydm_adaptive_soml_para_set(phydm, train_num, intvl, period, delay); + RTW_INFO("%s.\n", __func__); +} + +void rtw_dyn_soml_config(_adapter *adapter) +{ + RTW_INFO("%s.\n", __func__); + + if (adapter->registrypriv.dyn_soml_en == 1) { + /* Must after phydm_adaptive_soml_init() */ + rtw_hal_set_hwreg(adapter , HW_VAR_SET_SOML_PARAM , NULL); + RTW_INFO("dyn_soml_en = 1\n"); + } else { + if (adapter->registrypriv.dyn_soml_en == 2) { + rtw_dyn_soml_para_set(adapter, + adapter->registrypriv.dyn_soml_train_num, + adapter->registrypriv.dyn_soml_interval, + adapter->registrypriv.dyn_soml_period, + adapter->registrypriv.dyn_soml_delay); + RTW_INFO("dyn_soml_en = 2\n"); + RTW_INFO("dyn_soml_en, param = %d, %d, %d, %d\n", + adapter->registrypriv.dyn_soml_train_num, + adapter->registrypriv.dyn_soml_interval, + adapter->registrypriv.dyn_soml_period, + adapter->registrypriv.dyn_soml_delay); + } else if (adapter->registrypriv.dyn_soml_en == 0) { + RTW_INFO("dyn_soml_en = 0\n"); + } else + RTW_ERR("%s, wrong setting: dyn_soml_en = %d\n", __func__, + adapter->registrypriv.dyn_soml_en); + } +} +#endif + +#ifdef RTW_DYNAMIC_RRSR +void rtw_phydm_set_rrsr(_adapter *adapter, u32 rrsr_value, bool write_rrsr) +{ + + struct dm_struct *phydm = adapter_to_phydm(adapter); + + odm_cmn_info_update(phydm, ODM_CMNINFO_RRSR_VAL, rrsr_value); + if(write_rrsr) + phydm_rrsr_set_register(phydm, rrsr_value); +} +#endif/*RTW_DYNAMIC_RRSR*/ +void rtw_phydm_read_efuse(_adapter *adapter) +{ + PHAL_DATA_TYPE hal_data = GET_HAL_DATA(adapter); + struct dm_struct *phydm = &(hal_data->odmpriv); + + /*PHYDM API - thermal trim*/ + phydm_get_thermal_trim_offset(phydm); + /*PHYDM API - power trim*/ + phydm_get_power_trim_offset(phydm); +} + +#ifdef CONFIG_LPS_PWR_TRACKING +void rtw_phydm_pwr_tracking_directly(_adapter *adapter) +{ + PHAL_DATA_TYPE hal_data = GET_HAL_DATA(adapter); + u8 rfk_forbidden = _TRUE; + u8 is_linked = _FALSE; + + if (rtw_mi_check_status(adapter, MI_ASSOC)) + is_linked = _TRUE; + + rfk_forbidden = (_rtw_phydm_rfk_condition_check(adapter, hal_data->bScanInProcess, is_linked) == _TRUE) ? _FALSE : _TRUE; + halrf_cmn_info_set(&hal_data->odmpriv, HALRF_CMNINFO_RFK_FORBIDDEN, rfk_forbidden); + + odm_txpowertracking_direct_ce(&hal_data->odmpriv); +} +#endif + +void rtw_phydm_watchdog(_adapter *adapter, bool in_lps) +{ + u8 bLinked = _FALSE; + u8 bsta_state = _FALSE; + u8 bBtDisabled = _TRUE; + u8 rfk_forbidden = _FALSE; + #if ((RTL8822B_SUPPORT == 1) || (RTL8821C_SUPPORT == 1) || (RTL8814B_SUPPORT == 1) || (RTL8822C_SUPPORT == 1)) + u8 segment_iqk = _FALSE; + #endif + u8 tx_unlinked_low_rate = 0xFF; + PHAL_DATA_TYPE pHalData = GET_HAL_DATA(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); + + rfk_forbidden = (_rtw_phydm_rfk_condition_check(adapter, pHalData->bScanInProcess, bLinked) == _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) || (RTL8822C_SUPPORT == 1)) + segment_iqk = _rtw_phydm_iqk_segment_chk(adapter, bLinked); + halrf_cmn_info_set(&pHalData->odmpriv, HALRF_CMNINFO_IQK_SEGMENT, segment_iqk); + #endif + #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 (bLinked == _FALSE) { + 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); + } + + /*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; + }*/ + + #ifdef CONFIG_TDMADIG + rtw_phydm_tdmadig(adapter, TDMADIG_NON_INIT); + #endif/*CONFIG_TDMADIG*/ + + if (in_lps) + phydm_watchdog_lps(&pHalData->odmpriv); + else + phydm_watchdog(&pHalData->odmpriv); + + #ifdef CONFIG_RTW_ACS + rtw_acs_update_current_info(adapter); + #endif + + return; +} + +#ifdef CONFIG_CTRL_TXSS_BY_TP +void rtw_phydm_trx_cfg(_adapter *adapter, bool tx_1ss) +{ + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + enum bb_path txpath = BB_PATH_AB; + enum bb_path rxpath = BB_PATH_AB; + /*is_2tx = _FALSE for 8822B, or BB_PATH_AUTO for PATH_DIVERSITY for 8822B*/ + enum bb_path txpath_1ss = BB_PATH_A; + + rtw_hal_get_rf_path(adapter_to_dvobj(adapter), NULL, &txpath, &rxpath); + txpath = (tx_1ss) ? BB_PATH_A : txpath; + + if (phydm_api_trx_mode(adapter_to_phydm(adapter), txpath, rxpath, txpath_1ss) == FALSE) + RTW_ERR("%s failed\n", __func__); +} +#endif + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_dm.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_dm.h index 1232708fc49b..d1d36642256f 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_dm.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_dm.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,110 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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)) +#define dvobj_to_phydm(dvobj) adapter_to_phydm(dvobj_get_primary_adapter(dvobj)) +#ifdef CONFIG_TDMADIG +void rtw_phydm_tdmadig(_adapter *adapter, u8 state); +#endif +void rtw_phydm_priv_init(_adapter *adapter); void Init_ODM_ComInfo(_adapter *adapter); +void rtw_phydm_init(_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, + void *pValue1, + void *pValue2); +void SetHalODMVar( + PADAPTER Adapter, + HAL_ODM_VARIABLE eVariable, + void *pValue1, + BOOLEAN bSet); + +void rtw_phydm_ra_registed(_adapter *adapter, struct sta_info *psta); + +#ifdef CONFIG_DYNAMIC_SOML +void rtw_dyn_soml_byte_update(_adapter *adapter, u8 data_rate, u32 size); +void rtw_dyn_soml_para_set(_adapter *adapter, u8 train_num, u8 intvl, + u8 period, u8 delay); +void rtw_dyn_soml_config(_adapter *adapter); +#endif +#ifdef RTW_DYNAMIC_RRSR +void rtw_phydm_set_rrsr(_adapter *adapter, u32 rrsr_value, bool write_rrsr); +#endif +void rtw_phydm_watchdog(_adapter *adapter, bool in_lps); + +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_dm_get_min_rssi(_adapter *adapter); +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 +#ifdef CONFIG_TDMADIG +enum rtw_tdmadig_state{ + TDMADIG_INIT, + TDMADIG_NON_INIT, +}; +#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) || (RTL8822C_SUPPORT == 1)) +void rtw_phydm_iqk_trigger(_adapter *adapter); +#endif +void rtw_phydm_read_efuse(_adapter *adapter); +bool rtw_phydm_set_crystal_cap(_adapter *adapter, u8 crystal_cap); + +#ifdef CONFIG_SUPPORT_DYNAMIC_TXPWR +void rtw_phydm_set_dyntxpwr(_adapter *adapter, u8 *desc, u8 mac_id); +#endif +#ifdef CONFIG_RTW_TX_2PATH_EN +void rtw_phydm_tx_2path_en(_adapter *adapter); +#endif +#ifdef CONFIG_LPS_PG +void rtw_phydm_lps_pg_hdl(_adapter *adapter, struct sta_info *sta, bool in_lpspg); +#endif +#ifdef CONFIG_LPS_PWR_TRACKING +void rtw_phydm_pwr_tracking_directly(_adapter *adapter); +#endif + +#ifdef CONFIG_CTRL_TXSS_BY_TP +void rtw_phydm_trx_cfg(_adapter *adapter, bool tx_1ss); +#endif #endif /* __HAL_DM_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_dm_acs.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_dm_acs.c new file mode 100644 index 000000000000..9b581a6059c6 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_dm_acs.c @@ -0,0 +1,555 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * 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 dm_struct *phydm = adapter_to_phydm(adapter); + + return phydm_cmn_info_query(phydm, (enum phydm_info_query) PHYDM_INFO_CLM_RATIO); +} +u8 rtw_phydm_nhm_ratio(_adapter *adapter) +{ + struct dm_struct *phydm = adapter_to_phydm(adapter); + + return phydm_cmn_info_query(phydm, (enum phydm_info_query) 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)); + #ifdef CONFIG_RTW_ACS_DBG + rtw_acs_adv_reset(adapter); + #endif /*CONFIG_RTW_ACS_DBG*/ +} + +#ifdef CONFIG_RTW_ACS_DBG +u8 rtw_is_acs_igi_valid(_adapter *adapter) +{ + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + struct auto_chan_sel *pacs = &hal_data->acs; + + if ((pacs->igi) && ((pacs->igi >= 0x1E) || (pacs->igi < 0x60))) + return _TRUE; + + return _FALSE; +} +void rtw_acs_adv_setting(_adapter *adapter, RT_SCAN_TYPE scan_type, u16 scan_time, u8 igi, u8 bw) +{ + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + struct auto_chan_sel *pacs = &hal_data->acs; + struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; + + pacs->scan_type = scan_type; + pacs->scan_time = scan_time; + pacs->igi = igi; + pacs->bw = bw; + RTW_INFO("[ACS] ADV setting - scan_type:%c, ch_ms:%d(ms), igi:0x%02x, bw:%d\n", + pacs->scan_type ? 'A' : 'P', pacs->scan_time, pacs->igi, pacs->bw); +} +void rtw_acs_adv_reset(_adapter *adapter) +{ + rtw_acs_adv_setting(adapter, SCAN_ACTIVE, 0, 0, 0); +} +#endif /*CONFIG_RTW_ACS_DBG*/ + +void rtw_acs_trigger(_adapter *adapter, u16 scan_time_ms, u8 scan_chan, enum NHM_PID pid) +{ + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + struct dm_struct *phydm = adapter_to_phydm(adapter); +#if (RTK_ACS_VERSION == 3) + struct clm_para_info clm_para; + struct nhm_para_info nhm_para; + struct env_trig_rpt trig_rpt; + + scan_time_ms -= 10; + + init_acs_clm(clm_para, scan_time_ms); + + if (pid == NHM_PID_IEEE_11K_HIGH) + init_11K_high_nhm(nhm_para, scan_time_ms); + else if (pid == NHM_PID_IEEE_11K_LOW) + init_11K_low_nhm(nhm_para, scan_time_ms); + else + init_acs_nhm(nhm_para, scan_time_ms); + + hal_data->acs.trig_rst = phydm_env_mntr_trigger(phydm, &nhm_para, &clm_para, &trig_rpt); + if (hal_data->acs.trig_rst == (NHM_SUCCESS | CLM_SUCCESS)) { + hal_data->acs.trig_rpt.clm_rpt_stamp = trig_rpt.clm_rpt_stamp; + hal_data->acs.trig_rpt.nhm_rpt_stamp = trig_rpt.nhm_rpt_stamp; + /*RTW_INFO("[ACS] trigger success (rst = 0x%02x, clm_stamp:%d, nhm_stamp:%d)\n", + hal_data->acs.trig_rst, hal_data->acs.trig_rpt.clm_rpt_stamp, hal_data->acs.trig_rpt.nhm_rpt_stamp);*/ + } else + RTW_ERR("[ACS] trigger failed (rst = 0x%02x)\n", hal_data->acs.trig_rst); +#else + phydm_ccx_monitor_trigger(phydm, scan_time_ms); +#endif + + hal_data->acs.trigger_ch = scan_chan; + hal_data->acs.triggered = _TRUE; + + #ifdef CONFIG_RTW_ACS_DBG + RTW_INFO("[ACS] Trigger CH:%d, Times:%d\n", hal_data->acs.trigger_ch, scan_time_ms); + #endif +} +void rtw_acs_get_rst(_adapter *adapter) +{ + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + struct dm_struct *phydm = adapter_to_phydm(adapter); + int chan_idx = -1; + u8 cur_chan = hal_data->acs.trigger_ch; + + if (cur_chan == 0) + return; + + if (!hal_data->acs.triggered) + 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; + } +#if (RTK_ACS_VERSION == 3) + if (!(hal_data->acs.trig_rst == (NHM_SUCCESS | CLM_SUCCESS))) { + RTW_ERR("[ACS] get_rst return, due to acs trigger failed\n"); + return; + } + + { + struct env_mntr_rpt rpt = {0}; + u8 rst; + + rst = phydm_env_mntr_result(phydm, &rpt); + if ((rst == (NHM_SUCCESS | CLM_SUCCESS)) && + (rpt.clm_rpt_stamp == hal_data->acs.trig_rpt.clm_rpt_stamp) && + (rpt.nhm_rpt_stamp == hal_data->acs.trig_rpt.nhm_rpt_stamp)){ + hal_data->acs.clm_ratio[chan_idx] = rpt.clm_ratio; + hal_data->acs.nhm_ratio[chan_idx] = rpt.nhm_ratio; + _rtw_memcpy(&hal_data->acs.nhm[chan_idx][0], rpt.nhm_result, NHM_RPT_NUM); + + /*RTW_INFO("[ACS] get_rst success (rst = 0x%02x, clm_stamp:%d:%d, nhm_stamp:%d:%d)\n", + rst, + hal_data->acs.trig_rpt.clm_rpt_stamp, rpt.clm_rpt_stamp, + hal_data->acs.trig_rpt.nhm_rpt_stamp, rpt.nhm_rpt_stamp);*/ + } else { + RTW_ERR("[ACS] get_rst failed (rst = 0x%02x, clm_stamp:%d:%d, nhm_stamp:%d:%d)\n", + rst, + hal_data->acs.trig_rpt.clm_rpt_stamp, rpt.clm_rpt_stamp, + hal_data->acs.trig_rpt.nhm_rpt_stamp, rpt.nhm_rpt_stamp); + } + } + +#else + 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); +#endif + hal_data->acs.triggered = _FALSE; + #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, "Advanced setting - scan_type:%c, ch_ms:%d(ms), igi:0x%02x, bw:%d\n", + hal_data->acs.scan_type ? 'A' : 'P', hal_data->acs.scan_time, hal_data->acs.igi, hal_data->acs.bw); + + _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 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/rtl8188eu/hal/hal_dm_acs.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_dm_acs.h new file mode 100644 index 000000000000..c515deed624e --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_dm_acs.h @@ -0,0 +1,168 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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 3 + +#if (RTK_ACS_VERSION == 3) +enum NHM_PID { + NHM_PID_ACS, + NHM_PID_IEEE_11K_HIGH, + NHM_PID_IEEE_11K_LOW, +}; + +#define init_clm_param(clm, app, lv, time) \ + do {\ + clm.clm_app = app;\ + clm.clm_lv = lv;\ + clm.mntr_time = time;\ + } while (0) + +#define init_nhm_param(nhm, txon, cca, cnt_opt, app, lv, time) \ + do {\ + nhm.incld_txon = txon;\ + nhm.incld_cca = cca;\ + nhm.div_opt = cnt_opt;\ + nhm.nhm_app = app;\ + nhm.nhm_lv = lv;\ + nhm.mntr_time = time;\ + } while (0) + + +#define init_acs_clm(clm, time) \ + init_clm_param(clm, CLM_ACS, CLM_LV_2, time) + +#define init_acs_nhm(nhm, time) \ + init_nhm_param(nhm, NHM_EXCLUDE_TXON, NHM_EXCLUDE_CCA, NHM_CNT_ALL, NHM_ACS, NHM_LV_2, time) + +#define init_11K_high_nhm(nhm, time) \ + init_nhm_param(nhm, NHM_EXCLUDE_TXON, NHM_EXCLUDE_CCA, NHM_CNT_ALL, IEEE_11K_HIGH, NHM_LV_2, time) + +#define init_11K_low_nhm(nhm, time) \ + init_nhm_param(nhm, NHM_EXCLUDE_TXON, NHM_EXCLUDE_CCA, NHM_CNT_ALL, IEEE_11K_LOW, NHM_LV_2, time) + + +#endif /*(RTK_ACS_VERSION == 3)*/ +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, +}; + +#define ACS_BW_20M BIT(0) +#define ACS_BW_40M BIT(1) +#define ACS_BW_80M BIT(2) +#define ACS_BW_160M BIT(3) + +struct auto_chan_sel { + ATOMIC_T state; + u8 trigger_ch; + bool triggered; + u8 clm_ratio[MAX_CHANNEL_NUM]; + u8 nhm_ratio[MAX_CHANNEL_NUM]; + #if (RTK_ACS_VERSION == 3) + u8 nhm[MAX_CHANNEL_NUM][NHM_RPT_NUM]; + #endif + 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; + + #if (RTK_ACS_VERSION == 3) + u8 trig_rst; + struct env_trig_rpt trig_rpt; + #endif + + #ifdef CONFIG_RTW_ACS_DBG + RT_SCAN_TYPE scan_type; + u16 scan_time; + u8 igi; + u8 bw; + #endif +}; + +#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) + +#ifdef CONFIG_RTW_ACS_DBG +#define rtw_is_acs_passiv_scan(adapter) (((GET_HAL_DATA(adapter)->acs.scan_type) == SCAN_PASSIVE) ? _TRUE : _FALSE) + +#define rtw_acs_get_adv_st(adapter) (GET_HAL_DATA(adapter)->acs.scan_time) +#define rtw_is_acs_st_valid(adapter) ((GET_HAL_DATA(adapter)->acs.scan_time) ? _TRUE : _FALSE) + +#define rtw_acs_get_adv_igi(adapter) (GET_HAL_DATA(adapter)->acs.igi) +u8 rtw_is_acs_igi_valid(_adapter *adapter); + +#define rtw_acs_get_adv_bw(adapter) (GET_HAL_DATA(adapter)->acs.bw) + +void rtw_acs_adv_setting(_adapter *adapter, RT_SCAN_TYPE scan_type, u16 scan_time, u8 igi, u8 bw); +void rtw_acs_adv_reset(_adapter *adapter); +#endif + +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, enum NHM_PID pid); +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/rtl8188eu/hal/hal_halmac.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_halmac.c index fb0b73d7151b..7e78aef5fb53 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_halmac.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_halmac.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * Copyright(c) 2015 - 2016 Realtek Corporation. All rights reserved. + * Copyright(c) 2015 - 2019 Realtek Corporation. * * This program is 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 +12,24 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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. */ +/* + * HALMAC take return value 0 for fail and 1 for success to replace + * _FALSE/_TRUE after V1_04_09 + */ +#define RTW_HALMAC_FAIL 0 +#define RTW_HALMAC_SUCCESS 1 + #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 @@ -43,14 +47,19 @@ static u8 _halmac_mac_reg_page0_chk(const char *func, struct dvobj_priv *dvobj, 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\n", - FUNC_ADPT_ARG(dvobj_get_primary_adapter(dvobj)), mac_reg_offset, pwrpriv->pwr_mode); + 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; } @@ -70,7 +79,7 @@ static u8 _halmac_sdio_cmd52_read(void *p, u32 offset) _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; } @@ -87,7 +96,7 @@ static void _halmac_sdio_cmd52_write(void *p, u32 offset, u8 val) _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) @@ -95,7 +104,7 @@ 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; @@ -105,9 +114,9 @@ static u8 _halmac_sdio_reg_read_8(void *p, u32 offset) 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; } @@ -124,7 +133,7 @@ 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; @@ -134,9 +143,9 @@ static u16 _halmac_sdio_reg_read_16(void *p, u32 offset) 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; } @@ -153,7 +162,7 @@ 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; @@ -163,9 +172,9 @@ static u32 _halmac_sdio_reg_read_32(void *p, u32 offset) 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; } @@ -180,29 +189,30 @@ static u32 _halmac_sdio_reg_read_32(void *p, u32 offset) 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 rst = _FALSE; + u8 ret; + u8 rst = RTW_HALMAC_FAIL; 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); - pbuf = rtw_zmalloc(sdio_read_size); - if ((!pbuf) || (!data)) + if (!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__); + sdio_read_size = RND4(size); + sdio_read_size = rtw_sdio_cmd53_align_size(d, sdio_read_size); + + pbuf = rtw_zmalloc(sdio_read_size); + if (!pbuf) + return rst; + + ret = rtw_sdio_read_cmd53(d, offset, pbuf, sdio_read_size); + if (ret == _FAIL) { + RTW_ERR("%s: I/O FAIL!\n", __FUNCTION__); goto exit; } _rtw_memcpy(data, pbuf, size); - rst = _TRUE; + rst = RTW_HALMAC_SUCCESS; exit: rtw_mfree(pbuf, sdio_read_size); @@ -213,7 +223,7 @@ 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; @@ -223,9 +233,9 @@ static void _halmac_sdio_reg_write_8(void *p, u32 offset, u8 val) 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); } @@ -234,7 +244,7 @@ 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; @@ -245,9 +255,9 @@ static void _halmac_sdio_reg_write_16(void *p, u32 offset, u16 val) 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); } @@ -256,7 +266,7 @@ 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; @@ -267,13 +277,29 @@ static void _halmac_sdio_reg_write_32(void *p, u32 offset, u32 val) 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); } +static u8 _halmac_sdio_read_cia(void *p, u32 offset) +{ + struct dvobj_priv *d; + u8 data = 0; + u8 ret; + + + d = (struct dvobj_priv *)p; + + ret = rtw_sdio_f0_read(d, offset, &data, 1); + if (ret == _FAIL) + RTW_ERR("%s: I/O FAIL!\n", __FUNCTION__); + + return data; +} + #else /* !CONFIG_SDIO_HCI */ static u8 _halmac_reg_read_8(void *p, u32 offset) @@ -324,7 +350,7 @@ static void _halmac_reg_write_8(void *p, u32 offset, u8 val) 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) @@ -339,7 +365,7 @@ static void _halmac_reg_write_16(void *p, u32 offset, u16 val) 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) @@ -354,14 +380,14 @@ static void _halmac_reg_write_32(void *p, u32 offset, u32 val) 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 */ static u8 _halmac_mfree(void *p, void *buffer, u32 size) { rtw_mfree(buffer, size); - return _TRUE; + return RTW_HALMAC_SUCCESS; } static void *_halmac_malloc(void *p, u32 size) @@ -372,30 +398,36 @@ static void *_halmac_malloc(void *p, u32 size) static u8 _halmac_memcpy(void *p, void *dest, void *src, u32 size) { _rtw_memcpy(dest, src, size); - return _TRUE; + return RTW_HALMAC_SUCCESS; } static u8 _halmac_memset(void *p, void *addr, u8 value, u32 size) { _rtw_memset(addr, value, size); - return _TRUE; + return RTW_HALMAC_SUCCESS; } static void _halmac_udelay(void *p, u32 us) { - rtw_udelay_os(us); + /* Most hardware polling wait time < 50us) */ + if (us <= 50) + rtw_udelay_os(us); + else if (us <= 1000) + rtw_usleep_os(us); + else + rtw_msleep_os(RTW_DIV_ROUND_UP(us, 1000)); } static u8 _halmac_mutex_init(void *p, HALMAC_MUTEX *pMutex) { _rtw_mutex_init(pMutex); - return _TRUE; + return RTW_HALMAC_SUCCESS; } static u8 _halmac_mutex_deinit(void *p, HALMAC_MUTEX *pMutex) { _rtw_mutex_free(pMutex); - return _TRUE; + return RTW_HALMAC_SUCCESS; } static u8 _halmac_mutex_lock(void *p, HALMAC_MUTEX *pMutex) @@ -404,50 +436,102 @@ static u8 _halmac_mutex_lock(void *p, HALMAC_MUTEX *pMutex) err = _enter_critical_mutex(pMutex, NULL); if (err) - return _FALSE; + return RTW_HALMAC_FAIL; - return _TRUE; + return RTW_HALMAC_SUCCESS; } static u8 _halmac_mutex_unlock(void *p, HALMAC_MUTEX *pMutex) { _exit_critical_mutex(pMutex, NULL); + return RTW_HALMAC_SUCCESS; +} + +#ifndef CONFIG_SDIO_HCI +#define DBG_MSG_FILTER +#endif + +#ifdef DBG_MSG_FILTER +static u8 is_msg_allowed(uint drv_lv, u8 msg_lv) +{ + switch (drv_lv) { + case _DRV_NONE_: + return _FALSE; + + case _DRV_ALWAYS_: + if (msg_lv > HALMAC_DBG_ALWAYS) + return _FALSE; + break; + case _DRV_ERR_: + if (msg_lv > HALMAC_DBG_ERR) + return _FALSE; + break; + case _DRV_WARNING_: + if (msg_lv > HALMAC_DBG_WARN) + return _FALSE; + break; + case _DRV_INFO_: + if (msg_lv >= HALMAC_DBG_TRACE) + return _FALSE; + break; + } + return _TRUE; } +#endif /* DBG_MSG_FILTER */ 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}; +#ifdef DBG_MSG_FILTER + uint drv_level = _DRV_NONE_; +#endif + int err; + u8 ret = RTW_HALMAC_SUCCESS; +#ifdef DBG_MSG_FILTER +#ifdef CONFIG_RTW_DEBUG + drv_level = rtw_drv_log_level; +#endif + if (is_msg_allowed(drv_level, msg_level) == _FALSE) + return ret; +#endif + str[0] = '\n'; 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 RTW_HALMAC_FAIL; + /* Output may be truncated due to size limit */ + if ((err == (MSG_LEN - 1)) && (str[MSG_LEN - 2] != '\n')) + ret = RTW_HALMAC_FAIL; + + 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]" - if (msg_level <= HALMAC_DBG_WARN) RTW_INFO_DUMP(MSG_PREFIX, buf, size); else RTW_DBG_DUMP(MSG_PREFIX, buf, size); - return _TRUE; + return RTW_HALMAC_SUCCESS; } @@ -462,14 +546,15 @@ const char *const RTW_HALMAC_FEATURE_NAME[] = { "HALMAC_FEATURE_IQK", "HALMAC_FEATURE_POWER_TRACKING", "HALMAC_FEATURE_PSD", + "HALMAC_FEATURE_FW_SNDING", "HALMAC_FEATURE_ALL" }; -static inline u8 is_valid_id_status(HALMAC_FEATURE_ID id, HALMAC_CMD_PROCESS_STATUS status) +static inline u8 is_valid_id_status(enum halmac_feature_id id, enum halmac_cmd_process_status status) { 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]); @@ -485,6 +570,9 @@ static inline u8 is_valid_id_status(HALMAC_FEATURE_ID id, HALMAC_CMD_PROCESS_STA break; case HALMAC_FEATURE_UPDATE_PACKET: RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); + if (status != HALMAC_CMD_PROCESS_DONE) + RTW_INFO("%s: id(%d) unspecified status(%d)!\n", + __FUNCTION__, id, status); break; case HALMAC_FEATURE_UPDATE_DATAPACK: RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); @@ -494,6 +582,11 @@ static inline u8 is_valid_id_status(HALMAC_FEATURE_ID id, HALMAC_CMD_PROCESS_STA break; case HALMAC_FEATURE_CHANNEL_SWITCH: RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); + if ((status != HALMAC_CMD_PROCESS_DONE) && (status != HALMAC_CMD_PROCESS_RCVD)) + RTW_INFO("%s: id(%d) unspecified status(%d)!\n", + __FUNCTION__, id, status); + if (status == HALMAC_CMD_PROCESS_DONE) + return _FALSE; break; case HALMAC_FEATURE_IQK: RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); @@ -504,6 +597,9 @@ static inline u8 is_valid_id_status(HALMAC_FEATURE_ID id, HALMAC_CMD_PROCESS_STA case HALMAC_FEATURE_PSD: RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); break; + case HALMAC_FEATURE_FW_SNDING: + RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); + break; case HALMAC_FEATURE_ALL: RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); break; @@ -515,7 +611,7 @@ static inline u8 is_valid_id_status(HALMAC_FEATURE_ID id, HALMAC_CMD_PROCESS_STA return _TRUE; } -static int init_halmac_event_with_waittime(struct dvobj_priv *d, HALMAC_FEATURE_ID id, u8 *buf, u32 size, u32 time) +static int init_halmac_event_with_waittime(struct dvobj_priv *d, enum halmac_feature_id id, u8 *buf, u32 size, u32 time) { struct submit_ctx *sctx; @@ -541,12 +637,12 @@ static int init_halmac_event_with_waittime(struct dvobj_priv *d, HALMAC_FEATURE_ return 0; } -static inline int init_halmac_event(struct dvobj_priv *d, HALMAC_FEATURE_ID id, u8 *buf, u32 size) +static inline int init_halmac_event(struct dvobj_priv *d, enum halmac_feature_id id, u8 *buf, u32 size) { return init_halmac_event_with_waittime(d, id, buf, size, DEFAULT_INDICATOR_TIMELMT); } -static void free_halmac_event(struct dvobj_priv *d, HALMAC_FEATURE_ID id) +static void free_halmac_event(struct dvobj_priv *d, enum halmac_feature_id id) { struct submit_ctx *sctx; @@ -559,10 +655,10 @@ static void free_halmac_event(struct dvobj_priv *d, HALMAC_FEATURE_ID id) rtw_mfree((u8 *)sctx, sizeof(*sctx)); } -static int wait_halmac_event(struct dvobj_priv *d, HALMAC_FEATURE_ID id) +static int wait_halmac_event(struct dvobj_priv *d, enum halmac_feature_id id) { - PHALMAC_ADAPTER mac; - PHALMAC_API api; + struct halmac_adapter *mac; + struct halmac_api *api; struct submit_ctx *sctx; int ret; @@ -588,9 +684,9 @@ static int wait_halmac_event(struct dvobj_priv *d, HALMAC_FEATURE_ID id) /* * Return: - * Always return _TRUE, HALMAC don't care the return value. + * Always return RTW_HALMAC_SUCCESS, HALMAC don't care the return value. */ -static u8 _halmac_event_indication(void *p, HALMAC_FEATURE_ID feature_id, HALMAC_CMD_PROCESS_STATUS process_status, u8 *buf, u32 size) +static u8 _halmac_event_indication(void *p, enum halmac_feature_id feature_id, enum halmac_cmd_process_status process_status, u8 *buf, u32 size) { struct dvobj_priv *d; PADAPTER adapter; @@ -639,10 +735,10 @@ static u8 _halmac_event_indication(void *p, HALMAC_FEATURE_ID feature_id, HALMAC rtw_sctx_done(&sctx); exit: - return _TRUE; + return RTW_HALMAC_SUCCESS; } -HALMAC_PLATFORM_API rtw_halmac_platform_api = { +struct halmac_platform_api rtw_halmac_platform_api = { /* R/W register */ #ifdef CONFIG_SDIO_HCI .SDIO_CMD52_READ = _halmac_sdio_cmd52_read, @@ -654,16 +750,16 @@ HALMAC_PLATFORM_API rtw_halmac_platform_api = { .SDIO_CMD53_WRITE_8 = _halmac_sdio_reg_write_8, .SDIO_CMD53_WRITE_16 = _halmac_sdio_reg_write_16, .SDIO_CMD53_WRITE_32 = _halmac_sdio_reg_write_32, - + .SDIO_CMD52_CIA_READ = _halmac_sdio_read_cia, #endif /* CONFIG_SDIO_HCI */ -#if defined(CONFIG_USB_HCI) || defined(CONFIG_PCIE_HCI) +#if defined(CONFIG_USB_HCI) || defined(CONFIG_PCI_HCI) .REG_READ_8 = _halmac_reg_read_8, .REG_READ_16 = _halmac_reg_read_16, .REG_READ_32 = _halmac_reg_read_32, .REG_WRITE_8 = _halmac_reg_write_8, .REG_WRITE_16 = _halmac_reg_write_16, .REG_WRITE_32 = _halmac_reg_write_32, -#endif /* CONFIG_USB_HCI || CONFIG_PCIE_HCI */ +#endif /* CONFIG_USB_HCI || CONFIG_PCI_HCI */ /* Write data */ #if 0 @@ -693,8 +789,8 @@ HALMAC_PLATFORM_API rtw_halmac_platform_api = { u8 rtw_halmac_read8(struct intf_hdl *pintfhdl, u32 addr) { - PHALMAC_ADAPTER mac; - PHALMAC_API api; + struct halmac_adapter *mac; + struct halmac_api *api; /* WARNING: pintf_dev should not be null! */ @@ -706,8 +802,8 @@ u8 rtw_halmac_read8(struct intf_hdl *pintfhdl, u32 addr) u16 rtw_halmac_read16(struct intf_hdl *pintfhdl, u32 addr) { - PHALMAC_ADAPTER mac; - PHALMAC_API api; + struct halmac_adapter *mac; + struct halmac_api *api; /* WARNING: pintf_dev should not be null! */ @@ -719,8 +815,8 @@ u16 rtw_halmac_read16(struct intf_hdl *pintfhdl, u32 addr) u32 rtw_halmac_read32(struct intf_hdl *pintfhdl, u32 addr) { - PHALMAC_ADAPTER mac; - PHALMAC_API api; + struct halmac_adapter *mac; + struct halmac_api *api; /* WARNING: pintf_dev should not be null! */ @@ -730,29 +826,119 @@ 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 u8 rtw_halmac_iread8(struct intf_hdl *pintfhdl, u32 addr) { - PHALMAC_ADAPTER mac; - PHALMAC_API api; + struct halmac_adapter *mac; + struct halmac_api *api; /* WARNING: pintf_dev should not be null! */ mac = dvobj_to_halmac(pintfhdl->pintf_dev); @@ -764,8 +950,8 @@ u8 rtw_halmac_iread8(struct intf_hdl *pintfhdl, u32 addr) u16 rtw_halmac_iread16(struct intf_hdl *pintfhdl, u32 addr) { - PHALMAC_ADAPTER mac; - PHALMAC_API api; + struct halmac_adapter *mac; + struct halmac_api *api; u16 val16 = 0; /* WARNING: pintf_dev should not be null! */ @@ -778,8 +964,8 @@ u16 rtw_halmac_iread16(struct intf_hdl *pintfhdl, u32 addr) u32 rtw_halmac_iread32(struct intf_hdl *pintfhdl, u32 addr) { - PHALMAC_ADAPTER mac; - PHALMAC_API api; + struct halmac_adapter *mac; + struct halmac_api *api; /* WARNING: pintf_dev should not be null! */ @@ -788,13 +974,13 @@ 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) { - PHALMAC_ADAPTER mac; - PHALMAC_API api; - HALMAC_RET_STATUS status; + struct halmac_adapter *mac; + struct halmac_api *api; + enum halmac_ret_status status; /* WARNING: pintf_dev should not be null! */ @@ -811,9 +997,9 @@ int rtw_halmac_write8(struct intf_hdl *pintfhdl, u32 addr, u8 value) int rtw_halmac_write16(struct intf_hdl *pintfhdl, u32 addr, u16 value) { - PHALMAC_ADAPTER mac; - PHALMAC_API api; - HALMAC_RET_STATUS status; + struct halmac_adapter *mac; + struct halmac_api *api; + enum halmac_ret_status status; /* WARNING: pintf_dev should not be null! */ @@ -830,9 +1016,9 @@ int rtw_halmac_write16(struct intf_hdl *pintfhdl, u32 addr, u16 value) int rtw_halmac_write32(struct intf_hdl *pintfhdl, u32 addr, u32 value) { - PHALMAC_ADAPTER mac; - PHALMAC_API api; - HALMAC_RET_STATUS status; + struct halmac_adapter *mac; + struct halmac_api *api; + enum halmac_ret_status status; /* WARNING: pintf_dev should not be null! */ @@ -847,15 +1033,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_PCI_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); @@ -886,7 +1115,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; @@ -899,42 +1128,64 @@ static void deinit_priv(struct halmacpriv *priv) } } -void rtw_dump_halmac_info(void *sel) +#ifdef CONFIG_SDIO_HCI +static enum halmac_sdio_spec_ver _sdio_ver_drv2halmac(struct dvobj_priv *d) { - HALMAC_RET_STATUS status; - HALMAC_VER halmac_version; + bool v3; + enum halmac_sdio_spec_ver ver; - status = halmac_get_version(&halmac_version); + + 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) +{ + enum halmac_ret_status status; + struct halmac_ver ver; + + + status = halmac_get_version(&ver); if (status != HALMAC_RET_SUCCESS) return; - RTW_PRINT_SEL(sel, "HALMAC VER -%x.%x.%x\n", halmac_version.major_ver, halmac_version.prototype_ver, halmac_version.minor_ver); + 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) +int rtw_halmac_init_adapter(struct dvobj_priv *d, struct halmac_platform_api *pf_api) { - PHALMAC_ADAPTER halmac; - PHALMAC_API api; - HALMAC_INTERFACE intf; - HALMAC_RET_STATUS status; + struct halmac_adapter *halmac; + struct halmac_api *api; + enum halmac_interface intf; + enum halmac_ret_status status; int err = 0; +#ifdef CONFIG_SDIO_HCI + struct halmac_sdio_hw_info info; +#endif /* CONFIG_SDIO_HCI */ halmac = dvobj_to_halmac(d); if (halmac) { - err = 0; - goto out; + RTW_WARN("%s: initialize already completed!\n", __FUNCTION__); + goto error; } err = init_priv(&d->hmpriv); if (err) - goto out; + goto error; #ifdef CONFIG_SDIO_HCI intf = HALMAC_INTERFACE_SDIO; #elif defined(CONFIG_USB_HCI) intf = HALMAC_INTERFACE_USB; -#elif defined(CONFIG_PCIE_HCI) +#elif defined(CONFIG_PCI_HCI) intf = HALMAC_INTERFACE_PCIE; #else #warning "INTERFACE(CONFIG_XXX_HCI) not be defined!!" @@ -942,46 +1193,1357 @@ 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; + if (halmac) + goto deinit; + goto free; } dvobj_set_halmac(d, halmac); -out: - if (err) - rtw_halmac_deinit_adapter(d); + 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 deinit; + } + 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 deinit; + } + + init_write_rsvd_page_size(d); + +#ifdef CONFIG_SDIO_HCI + _rtw_memset(&info, 0, sizeof(info)); + info.spec_ver = _sdio_ver_drv2halmac(d); + /* Convert clock speed unit to MHz from Hz */ + info.clock_speed = RTW_DIV_ROUND_UP(rtw_sdio_get_clock(d), 1000000); + info.block_size = rtw_sdio_get_block_size(d); + RTW_DBG("%s: SDIO ver=%u clock=%uMHz blk_size=%u bytes\n", + __FUNCTION__, info.spec_ver+2, info.clock_speed, + info.block_size); + 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 deinit; + } +#endif /* CONFIG_SDIO_HCI */ + + return 0; + +deinit: + status = halmac_deinit_adapter(halmac); + dvobj_set_halmac(d, NULL); + if (status != HALMAC_RET_SUCCESS) + RTW_ERR("%s: halmac_deinit_adapter fail!(status=%d)\n", + __FUNCTION__, status); + +free: + deinit_priv(&d->hmpriv); + +error: return err; } int rtw_halmac_deinit_adapter(struct dvobj_priv *d) { - PHALMAC_ADAPTER halmac; - HALMAC_RET_STATUS status; + struct halmac_adapter *halmac; + enum halmac_ret_status status; int err = 0; halmac = dvobj_to_halmac(d); - if (!halmac) { - err = 0; - goto out; + if (halmac) { + status = halmac_deinit_adapter(halmac); + dvobj_set_halmac(d, NULL); + if (status != HALMAC_RET_SUCCESS) + err = -1; } deinit_priv(&d->hmpriv); - status = halmac_deinit_adapter(halmac); - dvobj_set_halmac(d, NULL); - if (status != HALMAC_RET_SUCCESS) { - err = -1; - goto out; + return err; +} + +static inline enum halmac_portid _hw_port_drv2halmac(enum _hw_port hwport) +{ + enum halmac_portid port = HALMAC_PORTID_NUM; + + + switch (hwport) { + case HW_PORT0: + port = HALMAC_PORTID0; + break; + case HW_PORT1: + port = HALMAC_PORTID1; + break; + case HW_PORT2: + port = HALMAC_PORTID2; + break; + case HW_PORT3: + port = HALMAC_PORTID3; + break; + case HW_PORT4: + port = HALMAC_PORTID4; + break; + default: + 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->en_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->en_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, enum halmac_hw_id hw_id, void *pvalue) +{ + struct halmac_adapter *mac; + struct halmac_api *api; + enum 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; +} + +/** + * 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); + api = HALMAC_GET_API(halmac); + + status = api->halmac_get_hw_value(halmac, HALMAC_HW_TXFIFO_SIZE, &val); + if (status != HALMAC_RET_SUCCESS) + return -1; + + *size = val; + + 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) +{ + enum halmac_ret_status status; + struct halmac_adapter *halmac = dvobj_to_halmac(d); + struct halmac_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) +{ + struct halmac_adapter *halmac; + struct halmac_api *api; + enum halmac_portid port; + union halmac_wlan_addr hwa; + enum halmac_ret_status status; + int err = -1; + + + if (!addr) + goto out; + + halmac = dvobj_to_halmac(d); + api = HALMAC_GET_API(halmac); + port = _hw_port_drv2halmac(hwport); + _rtw_memset(&hwa, 0, sizeof(hwa)); + + status = api->halmac_get_mac_addr(halmac, port, &hwa); + if (status != HALMAC_RET_SUCCESS) + goto out; + + _rtw_memcpy(addr, hwa.addr, 6); + + err = 0; out: return err; } +/** + * 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) +{ +#if 0 + struct halmac_adapter *halmac; + struct halmac_api *api; + enum halmac_portid 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 = HALMAC_NETWORK_UNDEFINE; + + 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; + enum halmac_portid 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 HALMAC_PORTID0: + val = rtw_read32(a, REG_CR); + network = BIT_GET_NETYPE0(val); + break; + + case HALMAC_PORTID1: + val = rtw_read32(a, REG_CR); + network = BIT_GET_NETYPE1(val); + break; + + case HALMAC_PORTID2: + val = rtw_read32(a, REG_CR_EXT); + network = BIT_GET_NETYPE2(val); + break; + + case HALMAC_PORTID3: + val = rtw_read32(a, REG_CR_EXT); + network = BIT_GET_NETYPE3(val); + break; + + case HALMAC_PORTID4: + 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; + enum halmac_portid 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(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; +} + +/* + * Note: + * When this function return, the register REG_RCR may be changed. + */ +int rtw_halmac_config_rx_info(struct dvobj_priv *d, enum halmac_drv_info info) +{ + struct halmac_adapter *halmac; + struct halmac_api *api; + enum halmac_ret_status status; + int err = -1; + + + halmac = dvobj_to_halmac(d); + api = HALMAC_GET_API(halmac); + + status = api->halmac_cfg_drv_info(halmac, info); + if (status != HALMAC_RET_SUCCESS) + goto out; + + err = 0; +out: + 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) +{ + struct halmac_adapter *mac; + struct halmac_api *api; + enum 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) +{ + struct halmac_adapter *halmac; + struct halmac_api *api; + enum halmac_portid 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(hwa)); + _rtw_memcpy(hwa.addr, 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) +{ + struct halmac_adapter *halmac; + struct halmac_api *api; + enum halmac_portid 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(hwa)); + _rtw_memcpy(hwa.addr, 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; + enum halmac_portid 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(hwa)); + _rtw_memcpy(hwa.addr, 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) +{ + struct halmac_adapter *halmac; + struct halmac_api *api; + enum halmac_portid 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; +} + +/** + * 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; + enum halmac_portid 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; + enum halmac_portid 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; + enum halmac_portid 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(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; + enum halmac_portid 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) +{ + struct halmac_adapter *mac; + struct halmac_api *api; + enum 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) +{ + struct halmac_adapter *mac; + struct halmac_api *api; + enum halmac_acq_id ac; + struct halmac_edca_para edca; + enum 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; +} + +/** + * rtw_halmac_set_rts_full_bw() - Send RTS to all covered channels + * @d: struct dvobj_priv* + * @enable: _TRUE(enable), _FALSE(disable) + * + * Hradware will duplicate RTS packet to all channels which are covered in used + * bandwidth. + * + * Return 0 if process OK, otherwise -1. + */ +int rtw_halmac_set_rts_full_bw(struct dvobj_priv *d, u8 enable) +{ + struct halmac_adapter *mac; + struct halmac_api *api; + enum halmac_ret_status status; + u8 full; + + + mac = dvobj_to_halmac(d); + api = HALMAC_GET_API(mac); + full = (enable == _TRUE) ? 1 : 0; + + status = api->halmac_set_hw_value(mac, HALMAC_HW_RTS_FULL_BW, &full); + if (HALMAC_RET_SUCCESS != status) + return -1; + + return 0; +} + +#ifdef RTW_HALMAC_DBG_POWER_SWITCH +static void _dump_mac_reg(struct dvobj_priv *d, u32 start, u32 end) +{ + struct _ADAPTER *adapter; + int i, j = 1; + + + adapter = dvobj_get_primary_adapter(d); + for (i = start; i < end; i += 4) { + if (j % 4 == 1) + RTW_PRINT("0x%04x", i); + _RTW_PRINT(" 0x%08x ", rtw_read32(adapter, i)); + if ((j++) % 4 == 0) + _RTW_PRINT("\n"); + } +} + +void dump_dbg_val(struct _ADAPTER *a, u32 reg) +{ + u32 v32; + + + rtw_write8(a, 0x3A, reg); + v32 = rtw_read32(a, 0xC0); + RTW_PRINT("0x3A = %02x, 0xC0 = 0x%08x\n",reg, v32); +} + +#ifdef CONFIG_PCI_HCI +static void _dump_pcie_cfg_space(struct dvobj_priv *d) +{ + struct _ADAPTER *padapter = dvobj_get_primary_adapter(d); + struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); + struct pci_dev *pdev = pdvobjpriv->ppcidev; + struct pci_dev *bridge_pdev = pdev->bus->self; + + u32 tmp[4] = { 0 }; + u32 i, j; + + RTW_PRINT("\n***** PCI Device Configuration Space *****\n\n"); + + for(i = 0; i < 0x100; i += 0x10) + { + for (j = 0 ; j < 4 ; j++) + pci_read_config_dword(pdev, i + j * 4, tmp+j); + + RTW_PRINT("%03x: %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x\n", + i, tmp[0] & 0xFF, (tmp[0] >> 8) & 0xFF, (tmp[0] >> 16) & 0xFF, (tmp[0] >> 24) & 0xFF, + tmp[1] & 0xFF, (tmp[1] >> 8) & 0xFF, (tmp[1] >> 16) & 0xFF, (tmp[1] >> 24) & 0xFF, + tmp[2] & 0xFF, (tmp[2] >> 8) & 0xFF, (tmp[2] >> 16) & 0xFF, (tmp[2] >> 24) & 0xFF, + tmp[3] & 0xFF, (tmp[3] >> 8) & 0xFF, (tmp[3] >> 16) & 0xFF, (tmp[3] >> 24) & 0xFF); + } + + RTW_PRINT("\n***** PCI Host Device Configuration Space*****\n\n"); + + for(i = 0; i < 0x100; i += 0x10) + { + for (j = 0 ; j < 4 ; j++) + pci_read_config_dword(bridge_pdev, i + j * 4, tmp+j); + + RTW_PRINT("%03x: %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x\n", + i, tmp[0] & 0xFF, (tmp[0] >> 8) & 0xFF, (tmp[0] >> 16) & 0xFF, (tmp[0] >> 24) & 0xFF, + tmp[1] & 0xFF, (tmp[1] >> 8) & 0xFF, (tmp[1] >> 16) & 0xFF, (tmp[1] >> 24) & 0xFF, + tmp[2] & 0xFF, (tmp[2] >> 8) & 0xFF, (tmp[2] >> 16) & 0xFF, (tmp[2] >> 24) & 0xFF, + tmp[3] & 0xFF, (tmp[3] >> 8) & 0xFF, (tmp[3] >> 16) & 0xFF, (tmp[3] >> 24) & 0xFF); + } +} +#endif + +static void _dump_mac_reg_for_power_switch(struct dvobj_priv *d, + const char* caller, char* desc) +{ + struct _ADAPTER *a; + u8 v8; + + + RTW_PRINT("%s: %s\n", caller, desc); + RTW_PRINT("======= MAC REG =======\n"); + /* page 0/1 */ + _dump_mac_reg(d, 0x0, 0x200); + _dump_mac_reg(d, 0x300, 0x400); /* also dump page 3 */ + + /* dump debug register */ + a = dvobj_get_primary_adapter(d); + +#ifdef CONFIG_PCI_HCI + _dump_pcie_cfg_space(d); + + v8 = rtw_read8(a, 0xF6) | 0x01; + rtw_write8(a, 0xF6, v8); + RTW_PRINT("0xF6 = %02x\n", v8); + + dump_dbg_val(a, 0x63); + dump_dbg_val(a, 0x64); + dump_dbg_val(a, 0x68); + dump_dbg_val(a, 0x69); + dump_dbg_val(a, 0x6a); + dump_dbg_val(a, 0x6b); + dump_dbg_val(a, 0x71); + dump_dbg_val(a, 0x72); +#endif +} + +static enum halmac_ret_status _power_switch(struct halmac_adapter *halmac, + struct halmac_api *api, + enum halmac_mac_power pwr) +{ + enum halmac_ret_status status; + char desc[80] = {0}; + + + rtw_sprintf(desc, 80, "before calling power %s", + (pwr==HALMAC_MAC_POWER_ON)?"on":"off"); + _dump_mac_reg_for_power_switch((struct dvobj_priv *)halmac->drv_adapter, + __FUNCTION__, desc); + + status = api->halmac_mac_power_switch(halmac, pwr); + RTW_PRINT("%s: status=%d\n", __FUNCTION__, status); + + rtw_sprintf(desc, 80, "after calling power %s", + (pwr==HALMAC_MAC_POWER_ON)?"on":"off"); + _dump_mac_reg_for_power_switch((struct dvobj_priv *)halmac->drv_adapter, + __FUNCTION__, desc); + + return status; +} +#else /* !RTW_HALMAC_DBG_POWER_SWITCH */ +#define _power_switch(mac, api, pwr) (api)->halmac_mac_power_switch(mac, pwr) +#endif /* !RTW_HALMAC_DBG_POWER_SWITCH */ + /* * Description: * Power on device hardware. @@ -995,11 +2557,17 @@ int rtw_halmac_deinit_adapter(struct dvobj_priv *d) */ int rtw_halmac_poweron(struct dvobj_priv *d) { - PHALMAC_ADAPTER halmac; - PHALMAC_API api; - HALMAC_RET_STATUS status; + struct halmac_adapter *halmac; + struct halmac_api *api; + enum halmac_ret_status status; int err = -1; +#if defined(CONFIG_PCI_HCI) && defined(CONFIG_RTL8822B) + struct _ADAPTER *a; + u8 v8; + u32 addr; + a = dvobj_get_primary_adapter(d); +#endif halmac = dvobj_to_halmac(d); if (!halmac) @@ -1012,19 +2580,53 @@ int rtw_halmac_poweron(struct dvobj_priv *d) goto out; #ifdef CONFIG_SDIO_HCI - status = api->halmac_sdio_cmd53_4byte(halmac, 1); + status = api->halmac_sdio_cmd53_4byte(halmac, HALMAC_SDIO_CMD53_4BYTE_MODE_RW); if (status != HALMAC_RET_SUCCESS) goto out; +#endif /* CONFIG_SDIO_HCI */ + +#if defined(CONFIG_PCI_HCI) && defined(CONFIG_RTL8822B) + addr = 0x3F3; + v8 = rtw_read8(a, addr); + RTW_PRINT("%s: 0x%X = 0x%02x\n", __FUNCTION__, addr, v8); + /* are we in pcie debug mode? */ + if (!(v8 & BIT(2))) { + RTW_PRINT("%s: Enable pcie debug mode\n", __FUNCTION__); + v8 |= BIT(2); + v8 = rtw_write8(a, addr, v8); + } #endif - status = api->halmac_mac_power_switch(halmac, HALMAC_MAC_POWER_ON); + status = _power_switch(halmac, api, HALMAC_MAC_POWER_ON); if (HALMAC_RET_PWR_UNCHANGE == status) { + +#if defined(CONFIG_PCI_HCI) && defined(CONFIG_RTL8822B) + addr = 0x3F3; + v8 = rtw_read8(a, addr); + RTW_PRINT("%s: 0x%X = 0x%02x\n", __FUNCTION__, addr, v8); + + /* are we in pcie debug mode? */ + if (!(v8 & BIT(2))) { + RTW_PRINT("%s: Enable pcie debug mode\n", __FUNCTION__); + v8 |= BIT(2); + v8 = rtw_write8(a, addr, v8); + } else if (v8 & BIT(0)) { + /* DMA stuck */ + addr = 0x1350; + v8 = rtw_read8(a, addr); + RTW_PRINT("%s: 0x%X = 0x%02x\n", __FUNCTION__, addr, v8); + RTW_PRINT("%s: recover DMA stuck\n", __FUNCTION__); + v8 |= BIT(6); + v8 = rtw_write8(a, addr, v8); + RTW_PRINT("%s: 0x%X = 0x%02x\n", __FUNCTION__, addr, v8); + } +#endif /* * 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); + _power_switch(halmac, api, HALMAC_MAC_POWER_OFF); + status = _power_switch(halmac, api, HALMAC_MAC_POWER_ON); RTW_WARN("%s: Power state abnormal, try to recover...%s\n", __FUNCTION__, (HALMAC_RET_SUCCESS == status)?"OK":"FAIL!"); } @@ -1053,9 +2655,9 @@ int rtw_halmac_poweron(struct dvobj_priv *d) */ int rtw_halmac_poweroff(struct dvobj_priv *d) { - PHALMAC_ADAPTER halmac; - PHALMAC_API api; - HALMAC_RET_STATUS status; + struct halmac_adapter *halmac; + struct halmac_api *api; + enum halmac_ret_status status; int err = -1; @@ -1065,7 +2667,7 @@ int rtw_halmac_poweroff(struct dvobj_priv *d) api = HALMAC_GET_API(halmac); - status = api->halmac_mac_power_switch(halmac, HALMAC_MAC_POWER_OFF); + status = _power_switch(halmac, api, HALMAC_MAC_POWER_OFF); if ((HALMAC_RET_SUCCESS != status) && (HALMAC_RET_PWR_UNCHANGE != status)) goto out; @@ -1075,32 +2677,8 @@ int rtw_halmac_poweroff(struct dvobj_priv *d) return err; } -/* - * Note: - * When this function return, the register REG_RCR may be changed. - */ -int rtw_halmac_config_rx_info(struct dvobj_priv *d, HALMAC_DRV_INFO info) -{ - PHALMAC_ADAPTER halmac; - PHALMAC_API api; - HALMAC_RET_STATUS status; - int err = -1; - - - halmac = dvobj_to_halmac(d); - api = HALMAC_GET_API(halmac); - - status = api->halmac_cfg_drv_info(halmac, info); - if (status != HALMAC_RET_SUCCESS) - 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) +static inline enum halmac_rx_fifo_expanding_mode _trx_share_mode_drv2halmac(u8 trx_share_mode) { if (0 == trx_share_mode) return HALMAC_RX_FIFO_EXPANDING_MODE_DISABLE; @@ -1113,16 +2691,18 @@ static inline HALMAC_RX_FIFO_EXPANDING_MODE _trx_share_mode_drv2halmac(u8 trx_sh else return HALMAC_RX_FIFO_EXPANDING_MODE_DISABLE; } -static HALMAC_RX_FIFO_EXPANDING_MODE _rtw_get_trx_share_mode(_adapter *adapter) + +static enum halmac_rx_fifo_expanding_mode _rtw_get_trx_share_mode(struct _ADAPTER *adapter) { - struct registry_priv *registry_par = &adapter->registrypriv; + struct registry_priv *registry_par = &adapter->registrypriv; return _trx_share_mode_drv2halmac(registry_par->trx_share_mode); } -void dump_trx_share_mode(void *sel, _adapter *adapter) + +void dump_trx_share_mode(void *sel, struct _ADAPTER *adapter) { struct registry_priv *registry_par = &adapter->registrypriv; - u8 mode = _trx_share_mode_drv2halmac(registry_par->trx_share_mode); + u8 mode = _trx_share_mode_drv2halmac(registry_par->trx_share_mode); if (HALMAC_RX_FIFO_EXPANDING_MODE_1_BLOCK == mode) RTW_PRINT_SEL(sel, "TRx share mode : %s\n", "RX_FIFO_EXPANDING_MODE_1"); @@ -1135,21 +2715,68 @@ void dump_trx_share_mode(void *sel, _adapter *adapter) } #endif -static u8 _get_drv_rsvd_page(HALMAC_DRV_RSVD_PG_NUM rsvd_page_number) +static enum halmac_drv_rsvd_pg_num _rsvd_page_num_drv2halmac(u16 num) { - if (HALMAC_RSVD_PG_NUM16 == rsvd_page_number) - return 16; - else if (HALMAC_RSVD_PG_NUM24 == rsvd_page_number) - return 24; - else if (HALMAC_RSVD_PG_NUM32 == rsvd_page_number) - return 32; + 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) + return HALMAC_RSVD_PG_NUM32; + if (num <= 64) + return HALMAC_RSVD_PG_NUM64; + if (num <= 128) + return HALMAC_RSVD_PG_NUM128; - RTW_ERR("%s unknown HALMAC_RSVD_PG type :%d\n", __func__, rsvd_page_number); - rtw_warn_on(1); - return 0; + if (num > 256) + RTW_WARN("%s: Fail to allocate RSVD page(%d)!!" + " The MAX RSVD page number is 256...\n", + __FUNCTION__, num); + + return HALMAC_RSVD_PG_NUM256; } -static HALMAC_TRX_MODE _choose_trx_mode(struct dvobj_priv *d) +static u16 _rsvd_page_num_halmac2drv(enum halmac_drv_rsvd_pg_num rsvd_page_number) +{ + u16 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; + + case HALMAC_RSVD_PG_NUM64: + num = 64; + break; + + case HALMAC_RSVD_PG_NUM128: + num = 128; + break; + + case HALMAC_RSVD_PG_NUM256: + num = 256; + break; + } + + return num; +} + +static enum halmac_trx_mode _choose_trx_mode(struct dvobj_priv *d) { PADAPTER p; @@ -1167,30 +2794,27 @@ static HALMAC_TRX_MODE _choose_trx_mode(struct dvobj_priv *d) return HALMAC_TRX_MODE_NORMAL; } -static inline HALMAC_RF_TYPE _rf_type_drv2halmac(RT_RF_TYPE_DEF_E rf_drv) +static inline enum halmac_rf_type _rf_type_drv2halmac(enum rf_type rf_drv) { - HALMAC_RF_TYPE rf_mac; + 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; @@ -1201,22 +2825,120 @@ 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 inline enum rf_type _rf_type_halmac2drv(enum halmac_rf_type rf_mac) +{ + enum rf_type rf_drv; + + + switch (rf_mac) { + case HALMAC_RF_1T2R: + rf_drv = RF_1T2R; + break; + case HALMAC_RF_2T4R: + rf_drv = RF_2T4R; + break; + case HALMAC_RF_2T2R: + case HALMAC_RF_2T2R_GREEN: + rf_drv = RF_2T2R; + break; + case HALMAC_RF_2T3R: + rf_drv = RF_2T3R; + break; + case HALMAC_RF_1T1R: + rf_drv = RF_1T1R; + break; + case HALMAC_RF_3T3R: + rf_drv = RF_3T3R; + break; + case HALMAC_RF_3T4R: + rf_drv = RF_3T4R; + break; + case HALMAC_RF_4T4R: + rf_drv = RF_4T4R; + break; + default: + rf_drv = RF_TYPE_MAX; + RTW_ERR("%s: Invalid RF type(0x%x)!\n", __FUNCTION__, rf_mac); + break; + } + + return rf_drv; +} + +static enum odm_cut_version _cut_version_drv2phydm( + enum tag_HAL_Cut_Version_Definition cut_drv) +{ + enum odm_cut_version cut_phydm = ODM_CUT_A; + u32 diff; + + + if (cut_drv > K_CUT_VERSION) + RTW_WARN("%s: unknown cut_ver=%d !!\n", __FUNCTION__, cut_drv); + + diff = cut_drv - A_CUT_VERSION; + cut_phydm += diff; + + return cut_phydm; +} + +static int _send_general_info_by_reg(struct dvobj_priv *d, + struct halmac_general_info *info) +{ + struct _ADAPTER *a; + struct hal_com_data *hal; + enum tag_HAL_Cut_Version_Definition cut_drv; + enum rf_type rftype; + enum odm_cut_version cut_phydm; + u8 h2c[RTW_HALMAC_H2C_MAX_SIZE] = {0}; + + + a = dvobj_get_primary_adapter(d); + hal = GET_HAL_DATA(a); + rftype = _rf_type_halmac2drv(info->rf_type); + cut_drv = GET_CVID_CUT_VERSION(hal->version_id); + cut_phydm = _cut_version_drv2phydm(cut_drv); + +#define CLASS_GENERAL_INFO_REG 0x02 +#define CMD_ID_GENERAL_INFO_REG 0x0C +#define GENERAL_INFO_REG_SET_CMD_ID(buf, v) SET_BITS_TO_LE_4BYTE(buf, 0, 5, v) +#define GENERAL_INFO_REG_SET_CLASS(buf, v) SET_BITS_TO_LE_4BYTE(buf, 5, 3, v) +#define GENERAL_INFO_REG_SET_RFE_TYPE(buf, v) SET_BITS_TO_LE_4BYTE(buf, 8, 8, v) +#define GENERAL_INFO_REG_SET_RF_TYPE(buf, v) SET_BITS_TO_LE_4BYTE(buf, 16, 8, v) +#define GENERAL_INFO_REG_SET_CUT_VERSION(buf, v) SET_BITS_TO_LE_4BYTE(buf, 24, 8, v) +#define GENERAL_INFO_REG_SET_RX_ANT_STATUS(buf, v) SET_BITS_TO_LE_1BYTE(buf+4, 0, 4, v) +#define GENERAL_INFO_REG_SET_TX_ANT_STATUS(buf, v) SET_BITS_TO_LE_1BYTE(buf+4, 4, 4, v) + + GENERAL_INFO_REG_SET_CMD_ID(h2c, CMD_ID_GENERAL_INFO_REG); + GENERAL_INFO_REG_SET_CLASS(h2c, CLASS_GENERAL_INFO_REG); + GENERAL_INFO_REG_SET_RFE_TYPE(h2c, info->rfe_type); + GENERAL_INFO_REG_SET_RF_TYPE(h2c, rftype); + GENERAL_INFO_REG_SET_CUT_VERSION(h2c, cut_phydm); + GENERAL_INFO_REG_SET_RX_ANT_STATUS(h2c, info->rx_ant_status); + GENERAL_INFO_REG_SET_TX_ANT_STATUS(h2c, info->tx_ant_status); + + return rtw_halmac_send_h2c(d, h2c); +} + 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; - u8 val8; + 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 = RF_1T1R; + enum bb_path txpath = BB_PATH_A; + enum bb_path rxpath = BB_PATH_A; + int err; adapter = dvobj_get_primary_adapter(d); @@ -1228,8 +2950,10 @@ static int _send_general_info(struct dvobj_priv *d) _rtw_memset(&info, 0, sizeof(info)); info.rfe_type = (u8)hal->rfe_type; - rtw_hal_get_hwreg(adapter, HW_VAR_RF_TYPE, &val8); - info.rf_type = _rf_type_drv2halmac(val8); + rtw_hal_get_rf_path(d, &rf, &txpath, &rxpath); + info.rf_type = _rf_type_drv2halmac(rf); + info.tx_ant_status = (u8)txpath; + info.rx_ant_status = (u8)rxpath; status = api->halmac_send_general_info(halmac, &info); switch (status) { @@ -1243,9 +2967,239 @@ static int _send_general_info(struct dvobj_priv *d) return -1; } + err = _send_general_info_by_reg(d, &info); + if (err) { + RTW_ERR("%s: Fail to send general info by register!\n", + __FUNCTION__); + return -1; + } + return 0; } +static int _cfg_drv_rsvd_pg_num(struct dvobj_priv *d) +{ + struct _ADAPTER *a; + struct hal_com_data *hal; + struct halmac_adapter *halmac; + struct halmac_api *api; + enum halmac_drv_rsvd_pg_num rsvd_page_number; + enum halmac_ret_status status; + u16 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; +} + +static void _debug_dlfw_fail(struct dvobj_priv *d) +{ + struct _ADAPTER *a; + u32 addr; + u32 v32, i, n; + u8 data[0x100] = {0}; + + + a = dvobj_get_primary_adapter(d); + + /* read 0x80[15:0], 0x10F8[31:0] once */ + addr = 0x80; + v32 = rtw_read16(a, addr); + RTW_PRINT("%s: 0x%X = 0x%04x\n", __FUNCTION__, addr, v32); + + addr = 0x10F8; + v32 = rtw_read32(a, addr); + RTW_PRINT("%s: 0x%X = 0x%08x\n", __FUNCTION__, addr, v32); + + /* read 0x10FC[31:0], 5 times */ + addr = 0x10FC; + n = 5; + for (i = 0; i < n; i++) { + v32 = rtw_read32(a, addr); + RTW_PRINT("%s: 0x%X = 0x%08x (%u/%u)\n", + __FUNCTION__, addr, v32, i, n); + } + + /* + * write 0x3A[7:0]=0x28 and 0xF6[7:0]=0x01 + * and then read 0xC0[31:0] 5 times + */ + addr = 0x3A; + v32 = 0x28; + rtw_write8(a, addr, (u8)v32); + v32 = rtw_read8(a, addr); + RTW_PRINT("%s: 0x%X = 0x%02x\n", __FUNCTION__, addr, v32); + + addr = 0xF6; + v32 = 0x1; + rtw_write8(a, addr, (u8)v32); + v32 = rtw_read8(a, addr); + RTW_PRINT("%s: 0x%X = 0x%02x\n", __FUNCTION__, addr, v32); + + addr = 0xC0; + n = 5; + for (i = 0; i < n; i++) { + v32 = rtw_read32(a, addr); + RTW_PRINT("%s: 0x%X = 0x%08x (%u/%u)\n", + __FUNCTION__, addr, v32, i, n); + } + + /* 0x00~0xFF, 0x1000~0x10FF */ + addr = 0; + n = 0x100; + for (i = 0; i < n; i+=4) + *(u32*)&data[i] = cpu_to_le32(rtw_read32(a, addr+i)); + for (i = 0; i < n; i++) { + if (i % 16 == 0) + RTW_PRINT("0x%04x\t", addr+i); + _RTW_PRINT("0x%02x", data[i]); + if (i % 16 == 15) + _RTW_PRINT("\n"); + else + _RTW_PRINT(" "); + } + + addr = 0x1000; + n = 0x100; + for (i = 0; i < n; i+=4) + *(u32*)&data[i] = cpu_to_le32(rtw_read32(a, addr+i)); + for (i = 0; i < n; i++) { + if (i % 16 == 0) + RTW_PRINT("0x%04x\t", addr+i); + _RTW_PRINT("0x%02x", data[i]); + if (i % 16 == 15) + _RTW_PRINT("\n"); + else + _RTW_PRINT(" "); + } + + /* read 0x80 after 10 secs */ + rtw_msleep_os(10000); + addr = 0x80; + v32 = rtw_read16(a, addr); + RTW_PRINT("%s: 0x%X = 0x%04x (after 10 secs)\n", + __FUNCTION__, addr, v32); +} + +static enum halmac_ret_status _enter_cpu_sleep_mode(struct dvobj_priv *d) +{ + struct hal_com_data *hal; + struct halmac_adapter *mac; + struct halmac_api *api; + + + hal = GET_HAL_DATA(dvobj_get_primary_adapter(d)); + mac = dvobj_to_halmac(d); + api = HALMAC_GET_API(mac); + +#ifdef CONFIG_RTL8822B + /* Support after firmware version 21 */ + if (hal->firmware_version < 21) + return HALMAC_RET_NOT_SUPPORT; +#elif defined(CONFIG_RTL8821C) + /* Support after firmware version 13.6 or 16 */ + if (hal->firmware_version == 13) { + if (hal->firmware_sub_version < 6) + return HALMAC_RET_NOT_SUPPORT; + } else if (hal->firmware_version < 16) { + return HALMAC_RET_NOT_SUPPORT; + } +#endif + + return api->halmac_enter_cpu_sleep_mode(mac); +} + +/* + * _cpu_sleep() - Let IC CPU enter sleep mode + * @d: struct dvobj_priv* + * @timeout: time limit of wait, unit is ms + * 0 for no limit + * + * Rteurn 0 for CPU in sleep mode, otherwise fail to enter sleep mode. + * Error codes definition are as follow: + * -1 HALMAC enter sleep return fail + * -2 HALMAC get CPU mode return fail + * -110 timeout + */ +static int _cpu_sleep(struct dvobj_priv *d, u32 timeout) +{ + struct halmac_adapter *mac; + struct halmac_api *api; + enum halmac_ret_status status; + enum halmac_wlcpu_mode mode = HALMAC_WLCPU_UNDEFINE; + systime start_t; + s32 period = 0; + u32 cnt = 0; + int err = 0; + + + mac = dvobj_to_halmac(d); + api = HALMAC_GET_API(mac); + + start_t = rtw_get_current_time(); + + status = _enter_cpu_sleep_mode(d); + if (status != HALMAC_RET_SUCCESS) { + if (status != HALMAC_RET_NOT_SUPPORT) + err = -1; + goto exit; + } + + do { + cnt++; + + mode = HALMAC_WLCPU_UNDEFINE; + status = api->halmac_get_cpu_mode(mac, &mode); + + period = rtw_get_passing_time_ms(start_t); + + if (status != HALMAC_RET_SUCCESS) { + err = -2; + break; + } + if (mode == HALMAC_WLCPU_SLEEP) + break; + if (period > timeout) { + err = -110; + break; + } + + rtw_msleep_os(1); + } while (1); + +exit: + if (err) + RTW_ERR("%s: Fail to enter sleep mode! (%d, %d)\n", + __FUNCTION__, status, mode); + + RTW_INFO("%s: Cost %dms to polling %u times. (err=%d)\n", + __FUNCTION__, period, cnt, err); + + return err; +} + +static void _init_trx_cfg_drv(struct dvobj_priv *d) +{ +#ifdef CONFIG_PCI_HCI + rtw_hal_irp_reset(dvobj_get_primary_adapter(d)); +#endif +} + /* * Description: * Downlaod Firmware Flow @@ -1264,17 +3218,17 @@ static int _send_general_info(struct dvobj_priv *d) */ 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; + struct halmac_adapter *mac; + struct halmac_api *api; + struct halmac_fw_version fw_vesion; + enum halmac_ret_status status; + int err = 0; + hal = GET_HAL_DATA(dvobj_get_primary_adapter(d)); mac = dvobj_to_halmac(d); api = HALMAC_GET_API(mac); - hal = GET_HAL_DATA(dvobj_get_primary_adapter(d)); if ((!fw) || (!fwsize)) return -1; @@ -1283,70 +3237,101 @@ static int download_fw(struct dvobj_priv *d, u8 *fw, u32 fwsize, u8 re_dl) /* ToDo */ /* 2. Driver Check Tx FIFO is empty */ - /* ToDo */ + err = rtw_halmac_txfifo_wait_empty(d, 2000); /* wait 2s */ + if (err) { + err = -1; + goto resume_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; - - /* 5. Driver resume TX if needed */ - /* ToDo */ + /* + * Already done in rtw_halmac_init_adapter() or + * somewhere calling rtw_halmac_set_max_dl_fw_size(). + */ if (re_dl) { - HALMAC_TRX_MODE mode; + /* 4. Enter IC CPU sleep mode */ + err = _cpu_sleep(d, 2000); + if (err) { + RTW_ERR("%s: IC CPU fail to enter sleep mode!(%d)\n", + __FUNCTION__, err); + /* skip this error */ + err = 0; + } + } - /* 6. Init TRX Configuration */ + /* 5. 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); + _debug_dlfw_fail(d); + err = -1; + goto resume_tx; + } + + /* 5.1. (Driver) Reset driver variables if needed */ + hal->LastHMEBoxNum = 0; + + /* 5.2. (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; + } + +resume_tx: + /* 6. Driver resume TX if needed */ + /* ToDo */ + + if (err) + goto exit; + + if (re_dl) { + enum halmac_trx_mode mode; + + /* 7. Change reserved page size */ + err = _cfg_drv_rsvd_pg_num(d); + if (err) + return -1; + + /* 8. Init TRX Configuration */ mode = _choose_trx_mode(d); status = api->halmac_init_trx_cfg(mac, mode); if (HALMAC_RET_SUCCESS != status) return -1; + _init_trx_cfg_drv(d); - /* 7. Config RX Aggregation */ + /* 9. Config RX Aggregation */ err = rtw_halmac_rx_agg_switch(d, _TRUE); if (err) return -1; - /* 8. Send General Info */ + /* 10. Send General Info */ err = _send_general_info(d); if (err) return -1; } - /* 9. Reset driver variables if needed */ - hal->LastHMEBoxNum = 0; - - /* 10. 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; - } - +exit: return err; } -static HALMAC_RET_STATUS init_mac_flow(struct dvobj_priv *d) +static int init_mac_flow(struct dvobj_priv *d) { PADAPTER p; - PHALMAC_ADAPTER halmac; - PHALMAC_API api; - HALMAC_WLAN_ADDR hwa; - HALMAC_TRX_MODE trx_mode; - HALMAC_RET_STATUS status; + struct hal_com_data *hal; + struct halmac_adapter *halmac; + struct halmac_api *api; + enum halmac_drv_rsvd_pg_num rsvd_page_number; + union halmac_wlan_addr hwa; + enum halmac_trx_mode trx_mode; + enum halmac_ret_status status; + u8 drv_rsvd_num; u8 nettype; - int err; - PHAL_DATA_TYPE hal; - HALMAC_DRV_RSVD_PG_NUM rsvd_page_number = HALMAC_RSVD_PG_NUM16;/*HALMAC_RSVD_PG_NUM24/HALMAC_RSVD_PG_NUM32*/ + int err, err_ret = -1; + p = dvobj_get_primary_adapter(d); hal = GET_HAL_DATA(p); @@ -1354,18 +3339,26 @@ static HALMAC_RET_STATUS init_mac_flow(struct dvobj_priv *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)); + status = api->halmac_cfg_rxff_expand_mode(halmac, + _rtw_get_trx_share_mode(p)); if (status != HALMAC_RET_SUCCESS) goto out; #endif -#ifdef CONFIG_PNO_SUPPORT - rsvd_page_number = HALMAC_RSVD_PG_NUM32; +#ifdef DBG_LA_MODE + if (dvobj_to_regsty(d)->la_mode_en) { + status = api->halmac_cfg_la_mode(halmac, HALMAC_LA_MODE_PARTIAL); + if (status != HALMAC_RET_SUCCESS) { + RTW_ERR("%s: Fail to enable LA mode!\n", __FUNCTION__); + goto out; + } + RTW_PRINT("%s: Enable LA mode OK.\n", __FUNCTION__); + } #endif - status = api->halmac_cfg_drv_rsvd_pg_num(halmac, rsvd_page_number); - if (status != HALMAC_RET_SUCCESS) + + err = _cfg_drv_rsvd_pg_num(d); + if (err) goto out; - hal->drv_rsvd_page_number = _get_drv_rsvd_page(rsvd_page_number); #ifdef CONFIG_USB_HCI status = api->halmac_set_bulkout_num(halmac, d->RtNumOutPipes); @@ -1377,6 +3370,7 @@ static HALMAC_RET_STATUS init_mac_flow(struct dvobj_priv *d) status = api->halmac_init_mac_cfg(halmac, trx_mode); if (status != HALMAC_RET_SUCCESS) goto out; + _init_trx_cfg_drv(d); err = rtw_halmac_rx_agg_switch(d, _TRUE); if (err) @@ -1394,8 +3388,33 @@ static HALMAC_RET_STATUS init_mac_flow(struct dvobj_priv *d) if (status != HALMAC_RET_SUCCESS) goto out; + err_ret = 0; out: - return status; + 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) { +#ifdef CONFIG_NEW_NETDEV_HDL + status = rtw_mi_start_drv_threads(adapter); +#else + status = rtw_start_drv_threads(adapter); +#endif + if (status == _FAIL) { + RTW_ERR("%s: Start threads Failed!\n", __FUNCTION__); + return -1; + } + } + + rtw_intf_start(adapter); + + return 0; } /* @@ -1408,10 +3427,10 @@ static HALMAC_RET_STATUS init_mac_flow(struct dvobj_priv *d) static int _halmac_init_hal(struct dvobj_priv *d, u8 *fw, u32 fwsize) { PADAPTER adapter; - PHALMAC_ADAPTER halmac; - PHALMAC_API api; - HALMAC_RET_STATUS status; - u32 ok = _TRUE; + struct halmac_adapter *halmac; + struct halmac_api *api; + enum halmac_ret_status status; + u32 ok; u8 fw_ok = _FALSE; int err, err_ret = -1; @@ -1444,8 +3463,13 @@ static int _halmac_init_hal(struct dvobj_priv *d, u8 *fw, u32 fwsize) } /* 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 */ @@ -1514,11 +3538,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; @@ -1533,7 +3562,7 @@ int rtw_halmac_init_hal_fw_file(struct dvobj_priv *d, u8 *fwpath) exit: rtw_mfree(fw, fwmaxsize); - fw = NULL; + /*fw = NULL;*/ return err; } @@ -1541,9 +3570,9 @@ int rtw_halmac_init_hal_fw_file(struct dvobj_priv *d, u8 *fwpath) int rtw_halmac_deinit_hal(struct dvobj_priv *d) { PADAPTER adapter; - PHALMAC_ADAPTER halmac; - PHALMAC_API api; - HALMAC_RET_STATUS status; + struct halmac_adapter *halmac; + struct halmac_api *api; + enum halmac_ret_status status; int err = -1; @@ -1566,9 +3595,9 @@ int rtw_halmac_deinit_hal(struct dvobj_priv *d) int rtw_halmac_self_verify(struct dvobj_priv *d) { - PHALMAC_ADAPTER mac; - PHALMAC_API api; - HALMAC_RET_STATUS status; + struct halmac_adapter *mac; + struct halmac_api *api; + enum halmac_ret_status status; int err = -1; @@ -1588,10 +3617,189 @@ int rtw_halmac_self_verify(struct dvobj_priv *d) return err; } -int rtw_halmac_redl_fw(struct dvobj_priv *d, u8 *fw, u32 fwsize) +static u8 rtw_halmac_txfifo_is_empty(struct dvobj_priv *d) { + 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, + 0x418, 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); + + 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 */ + 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. 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; + } + +resume_tx: +#ifndef RTW_HALMAC_DLFW_MEM_NO_STOP_TX + /* 4. Driver resume TX if needed */ + /* ToDo */ +#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; } @@ -1603,8 +3811,8 @@ int rtw_halmac_redl_fw(struct dvobj_priv *d, u8 *fw, u32 fwsize) int rtw_halmac_dlfw(struct dvobj_priv *d, u8 *fw, u32 fwsize) { PADAPTER adapter; - HALMAC_RET_STATUS status; - u32 ok = _TRUE; + enum halmac_ret_status status; + u32 ok; int err, err_ret = -1; @@ -1629,8 +3837,8 @@ int rtw_halmac_dlfw(struct dvobj_priv *d, u8 *fw, u32 fwsize) goto out; } - status = init_mac_flow(d); - if (status != HALMAC_RET_SUCCESS) + err = init_mac_flow(d); + if (err) goto out; err = _send_general_info(d); @@ -1646,11 +3854,16 @@ int rtw_halmac_dlfw(struct dvobj_priv *d, u8 *fw, u32 fwsize) 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; @@ -1662,7 +3875,7 @@ int rtw_halmac_dlfw_from_file(struct dvobj_priv *d, u8 *fwpath) err = -1; rtw_mfree(fw, fwmaxsize); - fw = NULL; + /*fw = NULL;*/ return err; } @@ -1681,9 +3894,10 @@ int rtw_halmac_dlfw_from_file(struct dvobj_priv *d, u8 *fwpath) int rtw_halmac_phy_power_switch(struct dvobj_priv *d, u8 enable) { PADAPTER adapter; - PHALMAC_ADAPTER halmac; - PHALMAC_API api; - HALMAC_RET_STATUS status; + struct halmac_adapter *halmac; + struct halmac_api *api; + enum halmac_ret_status status; + u8 on; adapter = dvobj_get_primary_adapter(d); @@ -1691,8 +3905,9 @@ int rtw_halmac_phy_power_switch(struct dvobj_priv *d, u8 enable) if (!halmac) return -1; api = HALMAC_GET_API(halmac); + on = (enable == _TRUE) ? 1 : 0; - status = api->halmac_set_hw_value(halmac, HALMAC_HW_EN_BB_RF, &enable); + status = api->halmac_set_hw_value(halmac, HALMAC_HW_EN_BB_RF, &on); if (status != HALMAC_RET_SUCCESS) return -1; @@ -1705,8 +3920,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) @@ -1715,9 +3928,25 @@ 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). + * + * Assume firmware be ready to accept H2C here, please check + * (hal->bFWReady == _TRUE) before call this function or make sure firmware is + * ready. + * + * Return: 0 if process OK, otherwise fail to send this H2C. + */ int rtw_halmac_send_h2c(struct dvobj_priv *d, u8 *h2c) { PADAPTER adapter = dvobj_get_primary_adapter(d); @@ -1727,40 +3956,40 @@ int rtw_halmac_send_h2c(struct dvobj_priv *d, u8 *h2c) 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 (!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); @@ -1768,21 +3997,36 @@ 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; - PHALMAC_API api; - HALMAC_RET_STATUS status; + struct halmac_adapter *mac; + struct halmac_api *api; + enum halmac_ret_status status; mac = dvobj_to_halmac(d); @@ -1797,9 +4041,9 @@ int rtw_halmac_c2h_handle(struct dvobj_priv *d, u8 *c2h, u32 size) int rtw_halmac_get_available_efuse_size(struct dvobj_priv *d, u32 *size) { - PHALMAC_ADAPTER mac; - PHALMAC_API api; - HALMAC_RET_STATUS status; + struct halmac_adapter *mac; + struct halmac_api *api; + enum halmac_ret_status status; u32 val; @@ -1816,9 +4060,9 @@ int rtw_halmac_get_available_efuse_size(struct dvobj_priv *d, u32 *size) int rtw_halmac_get_physical_efuse_size(struct dvobj_priv *d, u32 *size) { - PHALMAC_ADAPTER mac; - PHALMAC_API api; - HALMAC_RET_STATUS status; + struct halmac_adapter *mac; + struct halmac_api *api; + enum halmac_ret_status status; u32 val; @@ -1835,10 +4079,10 @@ int rtw_halmac_get_physical_efuse_size(struct dvobj_priv *d, u32 *size) int rtw_halmac_read_physical_efuse_map(struct dvobj_priv *d, u8 *map, u32 size) { - PHALMAC_ADAPTER mac; - PHALMAC_API api; - HALMAC_RET_STATUS status; - HALMAC_FEATURE_ID id; + struct halmac_adapter *mac; + struct halmac_api *api; + enum halmac_ret_status status; + enum halmac_feature_id id; int ret; @@ -1850,7 +4094,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; @@ -1865,37 +4109,61 @@ int rtw_halmac_read_physical_efuse_map(struct dvobj_priv *d, u8 *map, u32 size) int rtw_halmac_read_physical_efuse(struct dvobj_priv *d, u32 offset, u32 cnt, u8 *data) { - PHALMAC_ADAPTER mac; - PHALMAC_API api; - HALMAC_RET_STATUS status; + struct halmac_adapter *mac; + struct halmac_api *api; + enum 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) { - PHALMAC_ADAPTER mac; - PHALMAC_API api; - HALMAC_RET_STATUS status; + struct halmac_adapter *mac; + struct halmac_api *api; + enum halmac_ret_status status; u32 i; 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) @@ -1907,9 +4175,9 @@ int rtw_halmac_write_physical_efuse(struct dvobj_priv *d, u32 offset, u32 cnt, u int rtw_halmac_get_logical_efuse_size(struct dvobj_priv *d, u32 *size) { - PHALMAC_ADAPTER mac; - PHALMAC_API api; - HALMAC_RET_STATUS status; + struct halmac_adapter *mac; + struct halmac_api *api; + enum halmac_ret_status status; u32 val; @@ -1924,12 +4192,12 @@ 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; - HALMAC_RET_STATUS status; - HALMAC_FEATURE_ID id; + struct halmac_adapter *mac; + struct halmac_api *api; + enum halmac_ret_status status; + enum halmac_feature_id id; int ret; @@ -1951,23 +4219,36 @@ 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.efuse_map = map; + pginfo.efuse_map_size = size; + pginfo.efuse_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; } int rtw_halmac_write_logical_efuse_map(struct dvobj_priv *d, u8 *map, u32 size, u8 *maskmap, u32 masksize) { - PHALMAC_ADAPTER mac; - PHALMAC_API api; - HALMAC_PG_EFUSE_INFO pginfo; - HALMAC_RET_STATUS status; + struct halmac_adapter *mac; + struct halmac_api *api; + struct halmac_pg_efuse_info pginfo; + enum halmac_ret_status status; mac = dvobj_to_halmac(d); api = HALMAC_GET_API(mac); - pginfo.pEfuse_map = map; + pginfo.efuse_map = map; pginfo.efuse_map_size = size; - pginfo.pEfuse_mask = maskmap; + pginfo.efuse_mask = maskmap; pginfo.efuse_mask_size = masksize; status = api->halmac_pg_efuse_by_map(mac, &pginfo, HALMAC_EFUSE_R_AUTO); @@ -1979,9 +4260,9 @@ int rtw_halmac_write_logical_efuse_map(struct dvobj_priv *d, u8 *map, u32 size, int rtw_halmac_read_logical_efuse(struct dvobj_priv *d, u32 offset, u32 cnt, u8 *data) { - PHALMAC_ADAPTER mac; - PHALMAC_API api; - HALMAC_RET_STATUS status; + struct halmac_adapter *mac; + struct halmac_api *api; + enum halmac_ret_status status; u8 v; u32 i; @@ -2001,9 +4282,9 @@ int rtw_halmac_read_logical_efuse(struct dvobj_priv *d, u32 offset, u32 cnt, u8 int rtw_halmac_write_logical_efuse(struct dvobj_priv *d, u32 offset, u32 cnt, u8 *data) { - PHALMAC_ADAPTER mac; - PHALMAC_API api; - HALMAC_RET_STATUS status; + struct halmac_adapter *mac; + struct halmac_api *api; + enum halmac_ret_status status; u32 i; @@ -2021,12 +4302,13 @@ int rtw_halmac_write_logical_efuse(struct dvobj_priv *d, u32 offset, u32 cnt, u8 int rtw_halmac_write_bt_physical_efuse(struct dvobj_priv *d, u32 offset, u32 cnt, u8 *data) { - PHALMAC_ADAPTER mac; - PHALMAC_API api; - HALMAC_RET_STATUS status; + struct halmac_adapter *mac; + struct halmac_api *api; + enum halmac_ret_status status; u32 i; u8 bank = 1; + mac = dvobj_to_halmac(d); api = HALMAC_GET_API(mac); @@ -2044,13 +4326,12 @@ int rtw_halmac_write_bt_physical_efuse(struct dvobj_priv *d, u32 offset, u32 cnt int rtw_halmac_read_bt_physical_efuse_map(struct dvobj_priv *d, u8 *map, u32 size) { - PHALMAC_ADAPTER mac; - PHALMAC_API api; - HALMAC_RET_STATUS status; - HALMAC_FEATURE_ID id; - int ret; + struct halmac_adapter *mac; + struct halmac_api *api; + enum halmac_ret_status status; int bank = 1; + mac = dvobj_to_halmac(d); api = HALMAC_GET_API(mac); @@ -2065,147 +4346,38 @@ 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; -} - -static HAL_FIFO_SEL _fifo_sel_drv2halmac(u8 fifo_sel) -{ - if (0 == fifo_sel) - return HAL_FIFO_SEL_TX; - else if (1 == fifo_sel) - return HAL_FIFO_SEL_RX; - else if (2 == fifo_sel) - return HAL_FIFO_SEL_RSVD_PAGE; - else if (3 == fifo_sel) - return HAL_FIFO_SEL_REPORT; - else if (4 == fifo_sel) - return HAL_FIFO_SEL_LLT; - else - return HAL_FIFO_SEL_RSVD_PAGE; -} - -#define CONFIG_HALMAC_FIFO_DUMP +/*#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; + struct halmac_adapter *mac; + struct halmac_api *api; + enum hal_fifo_sel halmac_fifo_sel; + enum halmac_ret_status status; u8 *pfifo_map = NULL; u32 fifo_size = 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); @@ -2237,31 +4409,52 @@ int rtw_halmac_dump_fifo(struct dvobj_priv *d, u8 fifo_sel, u32 addr, u32 size, #ifdef CONFIG_HALMAC_FIFO_DUMP { static const char * const fifo_sel_str[] = { - "TX", "RX", "RSVD_PAGE", "REPORT", "LLT" + "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 +#endif /* CONFIG_HALMAC_FIFO_DUMP */ _exit: - if (mem_created && pfifo_map) + if ((mem_created == _TRUE) && pfifo_map) rtw_vmfree(pfifo_map, fifo_size); - return ret; + return ret; } +/* + * rtw_halmac_rx_agg_switch() - Switch RX aggregation function and setting + * @d struct dvobj_priv * + * @enable _FALSE/_TRUE for disable/enable RX aggregation function + * + * This function could help to on/off bus RX aggregation function, and is only + * useful for SDIO and USB interface. Although only "enable" flag is brough in, + * some setting would be taken from other places, and they are from: + * [DMA aggregation] + * struct hal_com_data.rxagg_dma_size + * struct hal_com_data.rxagg_dma_timeout + * [USB aggregation] (only use for USB interface) + * struct hal_com_data.rxagg_usb_size + * struct hal_com_data.rxagg_usb_timeout + * If above values of size and timeout are both 0 means driver would not + * control the threshold setting and leave it to HALMAC handle. + * + * From HALMAC V1_04_04, driver force the size threshold be hard limit, and the + * rx size can not exceed the setting. + * + * Return 0 for success, otherwise fail. + */ int rtw_halmac_rx_agg_switch(struct dvobj_priv *d, u8 enable) { - PADAPTER adapter; - PHAL_DATA_TYPE hal; - PHALMAC_ADAPTER halmac; - PHALMAC_API api; - HALMAC_RXAGG_CFG rxaggcfg; - HALMAC_RET_STATUS status; - int err = -1; + struct _ADAPTER *adapter; + struct hal_com_data *hal; + struct halmac_adapter *halmac; + struct halmac_api *api; + struct halmac_rxagg_cfg rxaggcfg; + enum halmac_ret_status status; adapter = dvobj_get_primary_adapter(d); @@ -2269,12 +4462,29 @@ int rtw_halmac_rx_agg_switch(struct dvobj_priv *d, u8 enable) halmac = dvobj_to_halmac(d); api = HALMAC_GET_API(halmac); _rtw_memset((void *)&rxaggcfg, 0, sizeof(rxaggcfg)); + rxaggcfg.mode = HALMAC_RX_AGG_MODE_NONE; + /* + * Always enable size limit to avoid rx size exceed + * driver defined size. + */ + rxaggcfg.threshold.size_limit_en = 1; +#ifdef RTW_RX_AGGREGATION if (_TRUE == enable) { #ifdef CONFIG_SDIO_HCI rxaggcfg.mode = HALMAC_RX_AGG_MODE_DMA; rxaggcfg.threshold.drv_define = 0; -#elif defined(CONFIG_USB_HCI) && defined(CONFIG_USB_RX_AGGREGATION) + if (hal->rxagg_dma_size || hal->rxagg_dma_timeout) { + rxaggcfg.threshold.drv_define = 1; + rxaggcfg.threshold.timeout = hal->rxagg_dma_timeout; + rxaggcfg.threshold.size = hal->rxagg_dma_size; + RTW_INFO("%s: RX aggregation threshold: " + "timeout=%u size=%u\n", + __FUNCTION__, + hal->rxagg_dma_timeout, + hal->rxagg_dma_size); + } +#elif defined(CONFIG_USB_HCI) switch (hal->rxagg_mode) { case RX_AGG_DISABLE: rxaggcfg.mode = HALMAC_RX_AGG_MODE_NONE; @@ -2300,63 +4510,10 @@ int rtw_halmac_rx_agg_switch(struct dvobj_priv *d, u8 enable) break; } #endif /* CONFIG_USB_HCI */ - } else - rxaggcfg.mode = HALMAC_RX_AGG_MODE_NONE; + } +#endif /* RTW_RX_AGGREGATION */ status = api->halmac_cfg_rx_aggregation(halmac, &rxaggcfg); - if (status != HALMAC_RET_SUCCESS) - goto out; - - 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; @@ -2365,16 +4522,15 @@ int rtw_halmac_get_rsvd_drv_pg_bndy(struct dvobj_priv *dvobj, u16 *drv_pg) int rtw_halmac_download_rsvd_page(struct dvobj_priv *dvobj, u8 pg_offset, u8 *pbuf, u32 size) { - HALMAC_RET_STATUS status = HALMAC_RET_SUCCESS; - PHALMAC_ADAPTER halmac = dvobj_to_halmac(dvobj); - PHALMAC_API api = HALMAC_GET_API(halmac); + enum halmac_ret_status status = HALMAC_RET_SUCCESS; + struct halmac_adapter *halmac = dvobj_to_halmac(dvobj); + struct halmac_api *api = HALMAC_GET_API(halmac); status = api->halmac_dl_drv_rsvd_page(halmac, pg_offset, pbuf, size); if (status != HALMAC_RET_SUCCESS) return -1; return 0; - } /* @@ -2388,9 +4544,9 @@ int rtw_halmac_download_rsvd_page(struct dvobj_priv *dvobj, u8 pg_offset, u8 *pb */ 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; + enum halmac_ret_status status; + struct halmac_adapter *halmac; + struct halmac_api *api; u8 cam = 0; /* Security Cam Entry Number */ @@ -2408,6 +4564,607 @@ int rtw_halmac_fill_hal_spec(struct dvobj_priv *dvobj, struct hal_spec_t *spec) return 0; } +int rtw_halmac_p2pps(struct dvobj_priv *dvobj, struct hal_p2p_ps_para *pp2p_ps_para) +{ + enum halmac_ret_status status = HALMAC_RET_SUCCESS; + struct halmac_adapter *halmac = dvobj_to_halmac(dvobj); + struct halmac_api *api = HALMAC_GET_API(halmac); + struct 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)->disable_close_rf = pp2p_ps_para->disable_close_rf; + (&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) +{ + struct halmac_adapter *mac; + struct halmac_api *api; + enum halmac_ret_status status; + enum halmac_feature_id id; + struct 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 inline u32 _phy_parameter_val_drv2halmac(u32 val, u8 msk_en, u32 msk) +{ + if (!msk_en) + return val; + + return (val << bitshift(msk)); +} + +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 = _phy_parameter_val_drv2halmac( + para->data.mac.value, + para->data.mac.msk_en, + para->data.mac.msk); + 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 = _phy_parameter_val_drv2halmac( + para->data.bb.value, + para->data.bb.msk_en, + para->data.bb.msk); + info->content.BB_REG_W.msk = para->data.bb.msk; + info->content.BB_REG_W.offset = para->data.bb.offset; + info->content.BB_REG_W.msk_en = para->data.bb.msk_en; + break; + + case 2: + /* RF register */ + info->cmd_id = HALMAC_PARAMETER_CMD_RF_W; + info->content.RF_REG_W.value = _phy_parameter_val_drv2halmac( + para->data.rf.value, + para->data.rf.msk_en, + para->data.rf.msk); + 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; +} + +static enum halmac_wlled_mode _led_mode_drv2halmac(u8 drv_mode) +{ + enum halmac_wlled_mode halmac_mode; + + + switch (drv_mode) { + case 1: + halmac_mode = HALMAC_WLLED_MODE_TX; + break; + case 2: + halmac_mode = HALMAC_WLLED_MODE_RX; + break; + case 3: + halmac_mode = HALMAC_WLLED_MODE_SW_CTRL; + break; + case 0: + default: + halmac_mode = HALMAC_WLLED_MODE_TRX; + break; + } + + return halmac_mode; +} + +/** + * rtw_halmac_led_cfg() - Configure Hardware LED Mode + * @d: struct dvobj_priv* + * @enable: enable or disable LED function + * 0: disable + * 1: enable + * @mode: WLan LED mode (valid when enable==1) + * 0: Blink when TX(transmit packet) and RX(receive packet) + * 1: Blink when TX only + * 2: Blink when RX only + * 3: Software control + * + * Configure hardware WLan LED mode. + * If want to change LED mode after enabled, need to disable LED first and + * enable again to set new mode. + * + * Rteurn 0 for OK, otherwise fail. + */ +int rtw_halmac_led_cfg(struct dvobj_priv *d, u8 enable, u8 mode) +{ + struct halmac_adapter *halmac; + struct halmac_api *api; + enum halmac_wlled_mode led_mode; + enum halmac_ret_status status; + + + halmac = dvobj_to_halmac(d); + api = HALMAC_GET_API(halmac); + + if (enable) { + status = api->halmac_pinmux_set_func(halmac, + HALMAC_GPIO_FUNC_WL_LED); + if (status != HALMAC_RET_SUCCESS) { + RTW_ERR("%s: pinmux set fail!(0x%x)\n", + __FUNCTION__, status); + return -1; + } + + led_mode = _led_mode_drv2halmac(mode); + status = api->halmac_pinmux_wl_led_mode(halmac, led_mode); + if (status != HALMAC_RET_SUCCESS) { + RTW_ERR("%s: mode set fail!(0x%x)\n", + __FUNCTION__, status); + return -1; + } + } else { + /* Change LED to software control and turn off */ + api->halmac_pinmux_wl_led_mode(halmac, + HALMAC_WLLED_MODE_SW_CTRL); + api->halmac_pinmux_wl_led_sw_ctrl(halmac, 0); + + status = api->halmac_pinmux_free_func(halmac, + HALMAC_GPIO_FUNC_WL_LED); + if (status != HALMAC_RET_SUCCESS) { + RTW_ERR("%s: pinmux free fail!(0x%x)\n", + __FUNCTION__, status); + return -1; + } + } + + return 0; +} + +/** + * rtw_halmac_led_switch() - Turn Hardware LED on/off + * @d: struct dvobj_priv* + * @on: LED light or not + * 0: Off + * 1: On(Light) + * + * Turn Hardware WLan LED On/Off. + * Before use this function, user should call rtw_halmac_led_ctrl() to switch + * mode to "software control(3)" first, otherwise control would fail. + * The interval between on and off must be longer than 1 ms, or the LED would + * keep light or dark only. + * Ex. Turn off LED at first, turn on after 0.5ms and turn off again after + * 0.5ms. The LED during this flow will only keep dark, and miss the turn on + * operation between two turn off operations. + */ +void rtw_halmac_led_switch(struct dvobj_priv *d, u8 on) +{ + struct halmac_adapter *halmac; + struct halmac_api *api; + + + halmac = dvobj_to_halmac(d); + api = HALMAC_GET_API(halmac); + + api->halmac_pinmux_wl_led_sw_ctrl(halmac, on); +} + +/** + * rtw_halmac_bt_wake_cfg() - Configure BT wake host function + * @d: struct dvobj_priv* + * @enable: enable or disable BT wake host function + * 0: disable + * 1: enable + * + * Configure pinmux to allow BT to control BT wake host pin. + * + * Rteurn 0 for OK, otherwise fail. + */ +int rtw_halmac_bt_wake_cfg(struct dvobj_priv *d, u8 enable) +{ + struct halmac_adapter *halmac; + struct halmac_api *api; + enum halmac_ret_status status; + + + halmac = dvobj_to_halmac(d); + api = HALMAC_GET_API(halmac); + + if (enable) { + status = api->halmac_pinmux_set_func(halmac, + HALMAC_GPIO_FUNC_BT_HOST_WAKE1); + if (status != HALMAC_RET_SUCCESS) { + RTW_ERR("%s: pinmux set BT_HOST_WAKE1 fail!(0x%x)\n", + __FUNCTION__, status); + return -1; + } + } else { + status = api->halmac_pinmux_free_func(halmac, + HALMAC_GPIO_FUNC_BT_HOST_WAKE1); + if (status != HALMAC_RET_SUCCESS) { + RTW_ERR("%s: pinmux free BT_HOST_WAKE1 fail!(0x%x)\n", + __FUNCTION__, status); + return -1; + } + } + + return 0; +} + +#ifdef CONFIG_PNO_SUPPORT +/** + * _halmac_scanoffload() - Switch channel by firmware during scanning + * @d: struct dvobj_priv* + * @enable: 1: enable, 0: disable + * @nlo: 1: nlo mode (no c2h event), 0: normal mode + * @ssid: ssid of probe request + * @ssid_len: ssid length + * + * Switch Channel and Send Porbe Request Offloaded by FW + * + * Rteurn 0 for OK, otherwise fail. + */ +static int _halmac_scanoffload(struct dvobj_priv *d, u32 enable, u8 nlo, + u8 *ssid, u8 ssid_len) +{ + struct _ADAPTER *adapter; + struct halmac_adapter *mac; + struct halmac_api *api; + enum halmac_ret_status status; + struct halmac_ch_info ch_info; + struct halmac_ch_switch_option cs_option; + struct mlme_ext_priv *pmlmeext; + enum halmac_feature_id id_update, id_ch_sw; + struct halmac_indicator *indicator, *tbl; + + int err = 0; + u8 probereq[64]; + u32 len = 0; + int i = 0; + struct pno_ssid pnossid; + struct rf_ctl_t *rfctl = NULL; + struct _RT_CHANNEL_INFO *ch_set; + + + tbl = d->hmpriv.indicator; + adapter = dvobj_get_primary_adapter(d); + mac = dvobj_to_halmac(d); + if (!mac) + return -1; + api = HALMAC_GET_API(mac); + id_update = HALMAC_FEATURE_UPDATE_PACKET; + id_ch_sw = HALMAC_FEATURE_CHANNEL_SWITCH; + pmlmeext = &(adapter->mlmeextpriv); + rfctl = adapter_to_rfctl(adapter); + ch_set = rfctl->channel_set; + + RTW_INFO("%s: %s scanoffload, mode: %s\n", + __FUNCTION__, enable?"Enable":"Disable", + nlo?"PNO/NLO":"Normal"); + + if (enable) { + _rtw_memset(probereq, 0, sizeof(probereq)); + + _rtw_memset(&pnossid, 0, sizeof(pnossid)); + if (ssid) { + if (ssid_len > sizeof(pnossid.SSID)) { + RTW_ERR("%s: SSID length(%d) is too long(>%d)!!\n", + __FUNCTION__, ssid_len, sizeof(pnossid.SSID)); + return -1; + } + + pnossid.SSID_len = ssid_len; + _rtw_memcpy(pnossid.SSID, ssid, ssid_len); + } + + rtw_hal_construct_ProbeReq(adapter, probereq, &len, &pnossid); + + if (!nlo) { + err = init_halmac_event(d, id_update, NULL, 0); + if (err) + return -1; + } + + status = api->halmac_update_packet(mac, HALMAC_PACKET_PROBE_REQ, + probereq, len); + if (status != HALMAC_RET_SUCCESS) { + if (!nlo) + free_halmac_event(d, id_update); + RTW_ERR("%s: halmac_update_packet FAIL(%d)!!\n", + __FUNCTION__, status); + return -1; + } + + if (!nlo) { + err = wait_halmac_event(d, id_update); + if (err) + RTW_ERR("%s: wait update packet FAIL(%d)!!\n", + __FUNCTION__, err); + } + + api->halmac_clear_ch_info(mac); + + for (i = 0; i < rfctl->max_chan_nums && ch_set[i].ChannelNum != 0; i++) { + _rtw_memset(&ch_info, 0, sizeof(ch_info)); + ch_info.extra_info = 0; + ch_info.channel = ch_set[i].ChannelNum; + ch_info.bw = HALMAC_BW_20; + ch_info.pri_ch_idx = HALMAC_CH_IDX_1; + ch_info.action_id = HALMAC_CS_ACTIVE_SCAN; + ch_info.timeout = 1; + status = api->halmac_add_ch_info(mac, &ch_info); + if (status != HALMAC_RET_SUCCESS) { + RTW_ERR("%s: add_ch_info FAIL(%d)!!\n", + __FUNCTION__, status); + return -1; + } + } + + /* set channel switch option */ + _rtw_memset(&cs_option, 0, sizeof(cs_option)); + cs_option.dest_bw = HALMAC_BW_20; + cs_option.periodic_option = HALMAC_CS_PERIODIC_2_PHASE; + cs_option.dest_pri_ch_idx = HALMAC_CH_IDX_UNDEFINE; + cs_option.tsf_low = 0; + cs_option.switch_en = 1; + cs_option.dest_ch_en = 1; + cs_option.absolute_time_en = 0; + cs_option.dest_ch = 1; + + cs_option.normal_period = 5; + cs_option.normal_period_sel = 0; + cs_option.normal_cycle = 10; + + cs_option.phase_2_period = 1; + cs_option.phase_2_period_sel = 1; + + /* nlo is for wow fw, 1: no c2h response */ + cs_option.nlo_en = nlo; + + if (!nlo) { + err = init_halmac_event(d, id_ch_sw, NULL, 0); + if (err) + return -1; + } + + status = api->halmac_ctrl_ch_switch(mac, &cs_option); + if (status != HALMAC_RET_SUCCESS) { + if (!nlo) + free_halmac_event(d, id_ch_sw); + RTW_ERR("%s: halmac_ctrl_ch_switch FAIL(%d)!!\n", + __FUNCTION__, status); + return -1; + } + + if (!nlo) { + err = wait_halmac_event(d, id_ch_sw); + if (err) + RTW_ERR("%s: wait ctrl_ch_switch FAIL(%d)!!\n", + __FUNCTION__, err); + } + } else { + api->halmac_clear_ch_info(mac); + + _rtw_memset(&cs_option, 0, sizeof(cs_option)); + cs_option.switch_en = 0; + + if (!nlo) { + err = init_halmac_event(d, id_ch_sw, NULL, 0); + if (err) + return -1; + } + + status = api->halmac_ctrl_ch_switch(mac, &cs_option); + if (status != HALMAC_RET_SUCCESS) { + if (!nlo) + free_halmac_event(d, id_ch_sw); + RTW_ERR("%s: halmac_ctrl_ch_switch FAIL(%d)!!\n", + __FUNCTION__, status); + return -1; + } + + if (!nlo) { + err = wait_halmac_event(d, id_ch_sw); + if (err) + RTW_ERR("%s: wait ctrl_ch_switch FAIL(%d)!!\n", + __FUNCTION__, err); + } + } + + return 0; +} + +/** + * rtw_halmac_pno_scanoffload() - Control firmware scan AP function for PNO + * @d: struct dvobj_priv* + * @enable: 1: enable, 0: disable + * + * Switch firmware scan AP function for PNO(prefer network offload) or + * NLO(network list offload). + * + * Rteurn 0 for OK, otherwise fail. + */ +int rtw_halmac_pno_scanoffload(struct dvobj_priv *d, u32 enable) +{ + return _halmac_scanoffload(d, enable, 1, NULL, 0); +} +#endif /* CONFIG_PNO_SUPPORT */ + #ifdef CONFIG_SDIO_HCI /* @@ -2425,12 +5182,12 @@ int rtw_halmac_query_tx_page_num(struct dvobj_priv *d) { PADAPTER adapter; struct halmacpriv *hmpriv; - PHALMAC_ADAPTER halmac; - PHALMAC_API api; - HALMAC_RQPN_MAP rqpn; - HALMAC_DMA_MAPPING dmaqueue; - HALMAC_TXFF_ALLOCATION fifosize; - HALMAC_RET_STATUS status; + struct halmac_adapter *halmac; + struct halmac_api *api; + struct halmac_rqpn_map rqpn; + enum halmac_dma_mapping dmaqueue; + struct halmac_txff_allocation fifosize; + enum halmac_ret_status status; u8 i; @@ -2529,9 +5286,9 @@ int rtw_halmac_get_tx_queue_page_num(struct dvobj_priv *d, u8 queue, u32 *page) */ u32 rtw_halmac_sdio_get_tx_addr(struct dvobj_priv *d, u8 *desc, u32 size) { - PHALMAC_ADAPTER mac; - PHALMAC_API api; - HALMAC_RET_STATUS status; + struct halmac_adapter *mac; + struct halmac_api *api; + enum halmac_ret_status status; u32 addr; @@ -2547,9 +5304,9 @@ u32 rtw_halmac_sdio_get_tx_addr(struct dvobj_priv *d, u8 *desc, u32 size) int rtw_halmac_sdio_tx_allowed(struct dvobj_priv *d, u8 *buf, u32 size) { - PHALMAC_ADAPTER mac; - PHALMAC_API api; - HALMAC_RET_STATUS status; + struct halmac_adapter *mac; + struct halmac_api *api; + enum halmac_ret_status status; mac = dvobj_to_halmac(d); @@ -2573,14 +5330,30 @@ u32 rtw_halmac_sdio_get_rx_addr(struct dvobj_priv *d, u8 *seq) (*seq)++; return RTW_SDIO_ADDR_RX_RX0FF_GEN(id); } + +int rtw_halmac_sdio_set_tx_format(struct dvobj_priv *d, enum halmac_sdio_tx_format format) +{ + struct halmac_adapter *mac; + struct halmac_api *api; + enum halmac_ret_status status; + + mac = dvobj_to_halmac(d); + api = HALMAC_GET_API(mac); + + status = api->halmac_set_hw_value(mac, HALMAC_HW_SDIO_TX_FORMAT, &format); + if (HALMAC_RET_SUCCESS != status) + return -1; + + return 0; +} #endif /* CONFIG_SDIO_HCI */ #ifdef CONFIG_USB_HCI u8 rtw_halmac_usb_get_bulkout_id(struct dvobj_priv *d, u8 *buf, u32 size) { - PHALMAC_ADAPTER mac; - PHALMAC_API api; - HALMAC_RET_STATUS status; + struct halmac_adapter *mac; + struct halmac_api *api; + enum halmac_ret_status status; u8 bulkout_id; @@ -2594,9 +5367,38 @@ u8 rtw_halmac_usb_get_bulkout_id(struct dvobj_priv *d, u8 *buf, u32 size) return bulkout_id; } -static inline HALMAC_USB_MODE _usb_mode_drv2halmac(enum RTW_USB_SPEED usb_mode) +/** + * 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) { - HALMAC_USB_MODE halmac_usb_mode = HALMAC_USB_MODE_U2; + 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 enum halmac_usb_mode _usb_mode_drv2halmac(enum RTW_USB_SPEED usb_mode) +{ + enum halmac_usb_mode halmac_usb_mode = HALMAC_USB_MODE_U2; switch (usb_mode) { case RTW_USB_SPEED_2: @@ -2615,11 +5417,11 @@ static inline HALMAC_USB_MODE _usb_mode_drv2halmac(enum RTW_USB_SPEED usb_mode) u8 rtw_halmac_switch_usb_mode(struct dvobj_priv *d, enum RTW_USB_SPEED usb_mode) { - PHALMAC_ADAPTER mac; - PHALMAC_API api; - HALMAC_RET_STATUS status; PADAPTER adapter; - HALMAC_USB_MODE halmac_usb_mode; + struct halmac_adapter *mac; + struct halmac_api *api; + enum halmac_ret_status status; + enum halmac_usb_mode halmac_usb_mode; adapter = dvobj_get_primary_adapter(d); mac = dvobj_to_halmac(d); @@ -2633,3 +5435,166 @@ u8 rtw_halmac_switch_usb_mode(struct dvobj_priv *d, enum RTW_USB_SPEED usb_mode) return _SUCCESS; } #endif /* CONFIG_USB_HCI */ + +#ifdef CONFIG_BEAMFORMING +#ifdef RTW_BEAMFORMING_VERSION_2 +int rtw_halmac_bf_add_mu_bfer(struct dvobj_priv *d, u16 paid, u16 csi_para, + u16 my_aid, enum halmac_csi_seg_len sel, u8 *addr) +{ + struct halmac_adapter *mac; + struct halmac_api *api; + enum halmac_ret_status status; + struct halmac_mu_bfer_init_para param; + + + mac = dvobj_to_halmac(d); + api = HALMAC_GET_API(mac); + + _rtw_memset(¶m, 0, sizeof(param)); + param.paid = paid; + param.csi_para = csi_para; + param.my_aid = my_aid; + param.csi_length_sel = sel; + _rtw_memcpy(param.bfer_address.addr, addr, 6); + + status = api->halmac_mu_bfer_entry_init(mac, ¶m); + if (status != HALMAC_RET_SUCCESS) + return -1; + + return 0; +} + +int rtw_halmac_bf_del_mu_bfer(struct dvobj_priv *d) +{ + struct halmac_adapter *mac; + struct halmac_api *api; + enum halmac_ret_status status; + + + mac = dvobj_to_halmac(d); + api = HALMAC_GET_API(mac); + + status = api->halmac_mu_bfer_entry_del(mac); + if (status != HALMAC_RET_SUCCESS) + return -1; + + return 0; +} + + +int rtw_halmac_bf_cfg_sounding(struct dvobj_priv *d, + enum halmac_snd_role role, enum halmac_data_rate rate) +{ + struct halmac_adapter *mac; + struct halmac_api *api; + enum halmac_ret_status status; + + + mac = dvobj_to_halmac(d); + api = HALMAC_GET_API(mac); + + status = api->halmac_cfg_sounding(mac, role, rate); + if (status != HALMAC_RET_SUCCESS) + return -1; + + return 0; +} + +int rtw_halmac_bf_del_sounding(struct dvobj_priv *d, + enum halmac_snd_role role) +{ + struct halmac_adapter *mac; + struct halmac_api *api; + enum halmac_ret_status status; + + + mac = dvobj_to_halmac(d); + api = HALMAC_GET_API(mac); + + status = api->halmac_del_sounding(mac, role); + if (status != HALMAC_RET_SUCCESS) + return -1; + + return 0; +} + +/** + * rtw_halmac_bf_cfg_csi_rate() - Config data rate for CSI report by CSSI + * @d: struct dvobj_priv* + * @rssi: RSSI vlaue, unit is percentage (0~100). + * @current_rate: Current CSI frame rate + * Valid value example + * 0 CCK 1M + * 3 CCK 11M + * 4 OFDM 6M + * and so on + * @fixrate_en: Enable to fix CSI frame in VHT rate, otherwise legacy OFDM rate. + * The value "0" for disable, otheriwse enable. + * @new_rate: Return new data rate, and value range is the same as current_rate + * @bmp_ofdm54: Return to suggest enabling OFDM 54M for CSI report frame or not, + * The valid values and meanings are: + * 0x00 disable + * 0x01 enable + * 0xFF Keep current setting + * + * According RSSI to config data rate for CSI report frame of Beamforming. + * + * Rteurn 0 for OK, otherwise fail. + */ +int rtw_halmac_bf_cfg_csi_rate(struct dvobj_priv *d, + u8 rssi, u8 current_rate, u8 fixrate_en, + u8 *new_rate, u8 *bmp_ofdm54) +{ + struct halmac_adapter *mac; + struct halmac_api *api; + enum halmac_ret_status status; + + + mac = dvobj_to_halmac(d); + api = HALMAC_GET_API(mac); + + status = api->halmac_cfg_csi_rate(mac, + rssi, current_rate, fixrate_en, new_rate, bmp_ofdm54); + if (status != HALMAC_RET_SUCCESS) + return -1; + + return 0; +} + +int rtw_halmac_bf_cfg_mu_mimo(struct dvobj_priv *d, enum halmac_snd_role role, + u8 *sounding_sts, u16 grouping_bitmap, u8 mu_tx_en, + u32 *given_gid_tab, u32 *given_user_pos) +{ + struct halmac_adapter *mac; + struct halmac_api *api; + enum halmac_ret_status status; + struct halmac_cfg_mumimo_para param; + + + mac = dvobj_to_halmac(d); + api = HALMAC_GET_API(mac); + + _rtw_memset(¶m, 0, sizeof(param)); + + param.role = role; + param.grouping_bitmap = grouping_bitmap; + param.mu_tx_en = mu_tx_en; + + if (sounding_sts) + _rtw_memcpy(param.sounding_sts, sounding_sts, 6); + + if (given_gid_tab) + _rtw_memcpy(param.given_gid_tab, given_gid_tab, 8); + + if (given_user_pos) + _rtw_memcpy(param.given_user_pos, given_user_pos, 16); + + status = api->halmac_cfg_mumimo(mac, ¶m); + if (status != HALMAC_RET_SUCCESS) + return -1; + + return 0; +} + +#endif /* RTW_BEAMFORMING_VERSION_2 */ +#endif /* CONFIG_BEAMFORMING */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_halmac.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_halmac.h index 980e8a489328..f38f060c1ed9 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_halmac.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_halmac.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * Copyright(c) 2015 - 2016 Realtek Corporation. All rights reserved. + * Copyright(c) 2015 - 2019 Realtek Corporation. * * This program is free software; you can redistribute it and/or modify it * under the terms of version 2 of the GNU General Public License as @@ -11,25 +12,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 _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. */ +#include "halmac/halmac_api.h" /* struct halmac_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)) -#define dvobj_to_halmac(d) ((PHALMAC_ADAPTER)((d)->halmac)) +#define dvobj_to_halmac(d) ((struct halmac_adapter *)((d)->halmac)) #define adapter_to_halmac(p) dvobj_to_halmac(adapter_to_dvobj(p)) /* for H2C cmd */ @@ -42,7 +38,67 @@ typedef enum _RTW_HALMAC_MODE { RTW_HALMAC_MODE_WIFI_TEST, } RTW_HALMAC_MODE; -extern HALMAC_PLATFORM_API rtw_halmac_platform_api; +union rtw_phy_para_data { + struct _mac { + u32 value; /* value to be set in bit mask(msk) */ + u32 msk; /* bit mask */ + u16 offset; /* address */ + u8 msk_en; /* 0/1 for msk invalid/valid */ + 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 struct halmac_platform_api rtw_halmac_platform_api; /* HALMAC API for Driver(HAL) */ u8 rtw_halmac_read8(struct intf_hdl *, u32 addr); @@ -53,14 +109,53 @@ 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); -void rtw_dump_halmac_info(void *sel); -int rtw_halmac_init_adapter(struct dvobj_priv *, PHALMAC_PLATFORM_API); +/* Software Information */ +void rtw_halmac_get_version(char *str, u32 len); + +/* Software Initialization */ +int rtw_halmac_init_adapter(struct dvobj_priv *d, struct halmac_platform_api *pf_api); int rtw_halmac_deinit_adapter(struct dvobj_priv *); + +/* Get operations */ +int rtw_halmac_get_hw_value(struct dvobj_priv *d, enum 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 *d, enum halmac_drv_info 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); +int rtw_halmac_set_rts_full_bw(struct dvobj_priv *d, u8 enable); + +/* Functions */ int rtw_halmac_poweron(struct dvobj_priv *); int rtw_halmac_poweroff(struct dvobj_priv *); int rtw_halmac_init_hal(struct dvobj_priv *); @@ -68,19 +163,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); -int rtw_halmac_get_available_efuse_size(struct dvobj_priv *d, 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); @@ -88,19 +187,21 @@ 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 *, 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 *, 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 *, 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); +int rtw_halmac_led_cfg(struct dvobj_priv *d, u8 enable, u8 mode); +void rtw_halmac_led_switch(struct dvobj_priv *d, u8 on); +int rtw_halmac_bt_wake_cfg(struct dvobj_priv *d, u8 enable); +#ifdef CONFIG_PNO_SUPPORT +int rtw_halmac_pno_scanoffload(struct dvobj_priv *d, u32 enable); +#endif #ifdef CONFIG_SDIO_HCI int rtw_halmac_query_tx_page_num(struct dvobj_priv *); @@ -108,14 +209,39 @@ int rtw_halmac_get_tx_queue_page_num(struct dvobj_priv *, u8 queue, u32 *page); u32 rtw_halmac_sdio_get_tx_addr(struct dvobj_priv *, u8 *desc, u32 size); int rtw_halmac_sdio_tx_allowed(struct dvobj_priv *, u8 *buf, u32 size); u32 rtw_halmac_sdio_get_rx_addr(struct dvobj_priv *, u8 *seq); +int rtw_halmac_sdio_set_tx_format(struct dvobj_priv *d, enum halmac_sdio_tx_format format); #endif /* CONFIG_SDIO_HCI */ #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 */ #ifdef CONFIG_SUPPORT_TRX_SHARED void dump_trx_share_mode(void *sel, _adapter *adapter); #endif + +#ifdef CONFIG_BEAMFORMING +#ifdef RTW_BEAMFORMING_VERSION_2 +int rtw_halmac_bf_add_mu_bfer(struct dvobj_priv *d, u16 paid, u16 csi_para, + u16 my_aid, enum halmac_csi_seg_len sel, u8 *addr); +int rtw_halmac_bf_del_mu_bfer(struct dvobj_priv *d); + +int rtw_halmac_bf_cfg_sounding(struct dvobj_priv *d, enum halmac_snd_role role, + enum halmac_data_rate rate); +int rtw_halmac_bf_del_sounding(struct dvobj_priv *d, enum halmac_snd_role role); + +int rtw_halmac_bf_cfg_csi_rate(struct dvobj_priv *d, u8 rssi, u8 current_rate, + u8 fixrate_en, u8 *new_rate, u8 *bmp_ofdm54); + +int rtw_halmac_bf_cfg_mu_mimo(struct dvobj_priv *d, enum halmac_snd_role role, + u8 *sounding_sts, u16 grouping_bitmap, u8 mu_tx_en, + u32 *given_gid_tab, u32 *given_user_pos); +#define rtw_halmac_bf_cfg_mu_bfee(d, gid_tab, user_pos) \ + rtw_halmac_bf_cfg_mu_mimo(d, HAL_BFEE, NULL, 0, 0, gid_tab, user_pos) + +#endif /* RTW_BEAMFORMING_VERSION_2 */ +#endif /* CONFIG_BEAMFORMING */ + #endif /* _HAL_HALMAC_H_ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_hci/hal_usb.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_hci/hal_usb.c index 7e6202aceb1f..f25623ff31a1 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_hci/hal_usb.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_hci/hal_usb.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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_USB_C_ #include @@ -218,7 +214,7 @@ void usb_free_recv_priv(_adapter *padapter, u16 ini_in_buf_sz) IF_DEQUEUE(&precvpriv->rx_indicate_queue, m); if (m == NULL) break; - m_freem(m); + rtw_os_pkt_free(m); } mtx_destroy(&precvpriv->rx_indicate_queue.ifq_mtx); #endif /* CONFIG_RX_INDICATE_QUEUE */ @@ -338,6 +334,13 @@ u8 usb_read8(struct intf_hdl *pintfhdl, u32 addr) wvalue = (u16)(addr & 0x0000ffff); len = 1; + +/* WLANON PAGE0_REG needs to add an offset 0x8000 */ +#if defined(CONFIG_RTL8710B) + if(wvalue >= 0x0000 && wvalue < 0x0100) + wvalue |= 0x8000; +#endif + usbctrl_vendorreq(pintfhdl, request, wvalue, index, &data, len, requesttype); @@ -361,6 +364,13 @@ u16 usb_read16(struct intf_hdl *pintfhdl, u32 addr) wvalue = (u16)(addr & 0x0000ffff); len = 2; + +/* WLANON PAGE0_REG needs to add an offset 0x8000 */ +#if defined(CONFIG_RTL8710B) + if(wvalue >= 0x0000 && wvalue < 0x0100) + wvalue |= 0x8000; +#endif + usbctrl_vendorreq(pintfhdl, request, wvalue, index, &data, len, requesttype); @@ -385,6 +395,13 @@ u32 usb_read32(struct intf_hdl *pintfhdl, u32 addr) wvalue = (u16)(addr & 0x0000ffff); len = 4; + +/* WLANON PAGE0_REG needs to add an offset 0x8000 */ +#if defined(CONFIG_RTL8710B) + if(wvalue >= 0x0000 && wvalue < 0x0100) + wvalue |= 0x8000; +#endif + usbctrl_vendorreq(pintfhdl, request, wvalue, index, &data, len, requesttype); @@ -409,8 +426,14 @@ int usb_write8(struct intf_hdl *pintfhdl, u32 addr, u8 val) wvalue = (u16)(addr & 0x0000ffff); len = 1; - data = val; + +/* WLANON PAGE0_REG needs to add an offset 0x8000 */ +#if defined(CONFIG_RTL8710B) + if(wvalue >= 0x0000 && wvalue < 0x0100) + wvalue |= 0x8000; +#endif + ret = usbctrl_vendorreq(pintfhdl, request, wvalue, index, &data, len, requesttype); @@ -435,8 +458,14 @@ int usb_write16(struct intf_hdl *pintfhdl, u32 addr, u16 val) wvalue = (u16)(addr & 0x0000ffff); len = 2; - data = val; + +/* WLANON PAGE0_REG needs to add an offset 0x8000 */ +#if defined(CONFIG_RTL8710B) + if(wvalue >= 0x0000 && wvalue < 0x0100) + wvalue |= 0x8000; +#endif + ret = usbctrl_vendorreq(pintfhdl, request, wvalue, index, &data, len, requesttype); @@ -463,6 +492,13 @@ int usb_write32(struct intf_hdl *pintfhdl, u32 addr, u32 val) wvalue = (u16)(addr & 0x0000ffff); len = 4; data = val; + +/* WLANON PAGE0_REG needs to add an offset 0x8000 */ +#if defined(CONFIG_RTL8710B) + if(wvalue >= 0x0000 && wvalue < 0x0100) + wvalue |= 0x8000; +#endif + ret = usbctrl_vendorreq(pintfhdl, request, wvalue, index, &data, len, requesttype); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_intf.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_intf.c index f22d62a5821e..8fbdd1aab439 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_intf.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_intf.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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_ @@ -33,9 +29,13 @@ const u32 _chip_type_to_odm_ic_type[] = { ODM_RTL8814A, ODM_RTL8703B, ODM_RTL8188F, + ODM_RTL8188F, ODM_RTL8822B, ODM_RTL8723D, ODM_RTL8821C, + ODM_RTL8710B, + ODM_RTL8192F, + ODM_RTL8822C, 0, }; @@ -56,7 +56,7 @@ 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) @@ -80,23 +80,58 @@ void rtw_hal_read_chip_version(_adapter *padapter) rtw_odm_init_ic_type(padapter); } +static void rtw_init_wireless_mode(_adapter *padapter) +{ + u8 proto_wireless_mode = 0; + struct hal_spec_t *hal_spec = GET_HAL_SPEC(padapter); + if(hal_spec->proto_cap & PROTO_CAP_11B) + proto_wireless_mode |= WIRELESS_11B; + + if(hal_spec->proto_cap & PROTO_CAP_11G) + proto_wireless_mode |= WIRELESS_11G; +#ifdef CONFIG_80211AC_VHT + if(hal_spec->band_cap & BAND_CAP_5G) + proto_wireless_mode |= WIRELESS_11A; +#endif + +#ifdef CONFIG_80211N_HT + if(hal_spec->proto_cap & PROTO_CAP_11N) { + + if(hal_spec->band_cap & BAND_CAP_2G) + proto_wireless_mode |= WIRELESS_11_24N; + if(hal_spec->band_cap & BAND_CAP_5G) + proto_wireless_mode |= WIRELESS_11_5N; + } +#endif + +#ifdef CONFIG_80211AC_VHT + if(hal_spec->proto_cap & PROTO_CAP_11AC) + proto_wireless_mode |= WIRELESS_11AC; +#endif + padapter->registrypriv.wireless_mode &= proto_wireless_mode; +} + void rtw_hal_def_value_init(_adapter *padapter) { if (is_primary_adapter(padapter)) { + /*init fw_psmode_iface_id*/ + adapter_to_pwrctl(padapter)->fw_psmode_iface_id = 0xff; + /*wireless_mode*/ + rtw_init_wireless_mode(padapter); padapter->hal_func.init_default_value(padapter); rtw_init_hal_com_default_value(padapter); + + #ifdef CONFIG_FW_MULTI_PORT_SUPPORT + adapter_to_dvobj(padapter)->dft.port_id = 0xFF; + adapter_to_dvobj(padapter)->dft.mac_id = 0xFF; + #endif + #ifdef CONFIG_HW_P0_TSF_SYNC + adapter_to_dvobj(padapter)->p0_tsf.sync_port = MAX_HW_PORT; + adapter_to_dvobj(padapter)->p0_tsf.offset = 0; + #endif - { - struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); - struct hal_spec_t *hal_spec = GET_HAL_SPEC(padapter); - - /* hal_spec is ready here */ - dvobj->macid_ctl.num = rtw_min(hal_spec->macid_num, MACID_NUM_SW_LIMIT); - - dvobj->cam_ctl.sec_cap = hal_spec->sec_cap; - dvobj->cam_ctl.num = rtw_min(hal_spec->sec_cam_ent_num, SEC_CAM_ENT_NUM_SW_LIMIT); - } + GET_HAL_DATA(padapter)->rx_tsf_addr_filter_config = 0; } } @@ -109,6 +144,7 @@ u8 rtw_hal_data_init(_adapter *padapter) RTW_INFO("cant not alloc memory for HAL DATA\n"); return _FAIL; } + rtw_phydm_priv_init(padapter); } return _SUCCESS; } @@ -154,27 +190,64 @@ void rtw_hal_dm_deinit(_adapter *padapter) _rtw_spinlock_free(&pHalData->IQKSpinLock); } } -void rtw_hal_sw_led_init(_adapter *padapter) + +#ifdef CONFIG_RTW_SW_LED +void rtw_hal_sw_led_init(_adapter *padapter) { - if (padapter->hal_func.InitSwLeds) + struct led_priv *ledpriv = adapter_to_led(padapter); + + if (ledpriv->bRegUseLed == _FALSE) + return; + + if (!is_primary_adapter(padapter)) + return; + + if (padapter->hal_func.InitSwLeds) { padapter->hal_func.InitSwLeds(padapter); + rtw_led_set_ctl_en_mask_primary(padapter); + rtw_led_set_iface_en(padapter, 1); + } } void rtw_hal_sw_led_deinit(_adapter *padapter) { + struct led_priv *ledpriv = adapter_to_led(padapter); + + if (ledpriv->bRegUseLed == _FALSE) + return; + + if (!is_primary_adapter(padapter)) + return; + if (padapter->hal_func.DeInitSwLeds) padapter->hal_func.DeInitSwLeds(padapter); } +#endif u32 rtw_hal_power_on(_adapter *padapter) { - return padapter->hal_func.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) { struct macid_ctl_t *macid_ctl = &padapter->dvobj->macid_ctl; _rtw_memset(macid_ctl->h2c_msr, 0, MACID_NUM_SW_LIMIT); + _rtw_memset(macid_ctl->op_num, 0, H2C_MSR_ROLE_MAX); + +#ifdef CONFIG_BT_COEXIST + rtw_btcoex_PowerOffSetting(padapter); +#endif padapter->hal_func.hal_power_off(padapter); } @@ -192,27 +265,88 @@ 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 +#ifdef CONFIG_RTW_MESH + else if (fw_state & WIFI_MESH_STATE) + networkType = Ndis802_11_mesh; +#endif else return; - rtw_setopmode_cmd(padapter, networkType, _FALSE); + rtw_setopmode_cmd(padapter, networkType, RTW_CMDF_DIRECTLY); } +#ifdef CONFIG_NEW_NETDEV_HDL +uint rtw_hal_iface_init(_adapter *adapter) +{ + uint status = _SUCCESS; + + rtw_hal_set_hwreg(adapter, HW_VAR_MAC_ADDR, adapter_mac_addr(adapter)); + #ifdef RTW_HALMAC + rtw_hal_hw_port_enable(adapter); + #endif + rtw_sec_restore_wep_key(adapter); + rtw_hal_init_opmode(adapter); + rtw_hal_start_thread(adapter); + return status; +} +uint rtw_hal_init(_adapter *padapter) +{ + uint status = _SUCCESS; + + status = padapter->hal_func.hal_init(padapter); + + if (status == _SUCCESS) { + rtw_set_hw_init_completed(padapter, _TRUE); + if (padapter->registrypriv.notch_filter == 1) + rtw_hal_notch_filter(padapter, 1); + rtw_led_control(padapter, LED_CTL_POWER_ON); + init_hw_mlme_ext(padapter); + #ifdef CONFIG_RF_POWER_TRIM + rtw_bb_rf_gain_offset(padapter); + #endif /*CONFIG_RF_POWER_TRIM*/ + GET_PRIMARY_ADAPTER(padapter)->bup = _TRUE; /*temporary*/ + #ifdef CONFIG_MI_WITH_MBSSID_CAM + rtw_mi_set_mbid_cam(padapter); + #endif + #ifdef CONFIG_SUPPORT_MULTI_BCN + rtw_ap_multi_bcn_cfg(padapter); + #endif + #if (RTL8822B_SUPPORT == 1) || (RTL8192F_SUPPORT == 1) + #ifdef CONFIG_DYNAMIC_SOML + rtw_dyn_soml_config(padapter); + #endif + #endif + #ifdef CONFIG_TDMADIG + rtw_phydm_tdmadig(padapter, TDMADIG_INIT); + #endif/*CONFIG_TDMADIG*/ +#ifdef CONFIG_RTW_TX_2PATH_EN + rtw_phydm_tx_2path_en(padapter); +#endif + } else { + rtw_set_hw_init_completed(padapter, _FALSE); + RTW_ERR("%s: hal_init fail\n", __func__); + } + return status; +} +#else uint rtw_hal_init(_adapter *padapter) { uint status = _SUCCESS; struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); int i; status = padapter->hal_func.hal_init(padapter); if (status == _SUCCESS) { - pHalData->hw_init_completed = _TRUE; - rtw_restore_mac_addr(padapter); - + rtw_set_hw_init_completed(padapter, _TRUE); + rtw_mi_set_mac_addr(padapter);/*set mac addr of all ifaces*/ + #ifdef RTW_HALMAC + rtw_restore_hw_port_cfg(padapter); + #endif if (padapter->registrypriv.notch_filter == 1) rtw_hal_notch_filter(padapter, 1); @@ -225,32 +359,48 @@ uint rtw_hal_init(_adapter *padapter) rtw_hal_init_opmode(padapter); -#ifdef CONFIG_RF_POWER_TRIM + #ifdef CONFIG_RF_POWER_TRIM rtw_bb_rf_gain_offset(padapter); -#endif /*CONFIG_RF_POWER_TRIM*/ + #endif /*CONFIG_RF_POWER_TRIM*/ + #ifdef CONFIG_SUPPORT_MULTI_BCN + rtw_ap_multi_bcn_cfg(padapter); + #endif + +#if (RTL8822B_SUPPORT == 1) || (RTL8192F_SUPPORT == 1) +#ifdef CONFIG_DYNAMIC_SOML + rtw_dyn_soml_config(padapter); +#endif +#endif + #ifdef CONFIG_TDMADIG + rtw_phydm_tdmadig(padapter, TDMADIG_INIT); + #endif/*CONFIG_TDMADIG*/ + +#ifdef CONFIG_RTW_TX_2PATH_EN + rtw_phydm_tx_2path_en(padapter); +#endif } else { - pHalData->hw_init_completed = _FALSE; - RTW_INFO("rtw_hal_init: hal_init fail\n"); + rtw_set_hw_init_completed(padapter, _FALSE); + RTW_ERR("%s: fail\n", __func__); } return status; } +#endif uint rtw_hal_deinit(_adapter *padapter) { uint status = _SUCCESS; struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); int i; status = padapter->hal_func.hal_deinit(padapter); if (status == _SUCCESS) { rtw_led_control(padapter, LED_CTL_POWER_OFF); - pHalData->hw_init_completed = _FALSE; + rtw_set_hw_init_completed(padapter, _FALSE); } else RTW_INFO("\n rtw_hal_deinit: hal_init fail\n"); @@ -258,9 +408,9 @@ 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->hal_func.set_hw_reg_handler(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) @@ -268,20 +418,20 @@ void rtw_hal_get_hwreg(_adapter *padapter, u8 variable, u8 *val) padapter->hal_func.GetHwRegHandler(padapter, variable, val); } -u8 rtw_hal_set_def_var(_adapter *padapter, HAL_DEF_VARIABLE eVariable, PVOID pValue) +u8 rtw_hal_set_def_var(_adapter *padapter, HAL_DEF_VARIABLE eVariable, void *pValue) { return padapter->hal_func.SetHalDefVarHandler(padapter, eVariable, pValue); } -u8 rtw_hal_get_def_var(_adapter *padapter, HAL_DEF_VARIABLE eVariable, PVOID pValue) +u8 rtw_hal_get_def_var(_adapter *padapter, HAL_DEF_VARIABLE eVariable, void *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) +void rtw_hal_set_odm_var(_adapter *padapter, HAL_ODM_VARIABLE eVariable, void *pValue1, BOOLEAN 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) +void rtw_hal_get_odm_var(_adapter *padapter, HAL_ODM_VARIABLE eVariable, void *pValue1, void *pValue2) { padapter->hal_func.GetHalODMVarHandler(padapter, eVariable, pValue1, pValue2); } @@ -319,6 +469,25 @@ s32 rtw_hal_fw_dl(_adapter *padapter, u8 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) { @@ -350,6 +519,58 @@ void rtw_hal_irp_reset(_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 */ @@ -376,39 +597,18 @@ s32 rtw_hal_xmit(_adapter *padapter, struct xmit_frame *pxmitframe) s32 rtw_hal_mgnt_xmit(_adapter *padapter, struct xmit_frame *pmgntframe) { s32 ret = _FAIL; - u8 *pframe, subtype; - struct rtw_ieee80211_hdr *pwlanhdr; - struct sta_info *psta; - struct sta_priv *pstapriv = &padapter->stapriv; update_mgntframe_attrib_addr(padapter, pmgntframe); - pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; - 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); */ - -#ifdef CONFIG_IEEE80211W - if (padapter->securitypriv.binstallBIPkey == _TRUE && (subtype == WIFI_DEAUTH || subtype == WIFI_DISASSOC || - subtype == WIFI_ACTION)) { - if (IS_MCAST(pmgntframe->attrib.ra) && pmgntframe->attrib.key_type != IEEE80211W_NO_KEY) { - pmgntframe->attrib.encrypt = _BIP_; - /* pmgntframe->attrib.bswenc = _TRUE; */ - } else if (pmgntframe->attrib.key_type != IEEE80211W_NO_KEY) { - psta = rtw_get_stainfo(pstapriv, pmgntframe->attrib.ra); - if (psta && psta->bpairwise_key_installed == _TRUE) { - pmgntframe->attrib.encrypt = _AES_; - pmgntframe->attrib.bswenc = _TRUE; - } else { - RTW_INFO("%s, %d, bpairwise_key_installed is FALSE\n", __func__, __LINE__); - goto no_mgmt_coalesce; - } - } - RTW_INFO("encrypt=%d, bswenc=%d\n", pmgntframe->attrib.encrypt, pmgntframe->attrib.bswenc); +#if defined(CONFIG_IEEE80211W) || defined(CONFIG_RTW_MESH) + if ((!MLME_IS_MESH(padapter) && SEC_IS_BIP_KEY_INSTALLED(&padapter->securitypriv) == _TRUE) + #ifdef CONFIG_RTW_MESH + || (MLME_IS_MESH(padapter) && padapter->mesh_info.mesh_auth_id) + #endif + ) rtw_mgmt_xmitframe_coalesce(padapter, pmgntframe->pkt, pmgntframe); - } -#endif /* CONFIG_IEEE80211W */ -no_mgmt_coalesce: +#endif + ret = padapter->hal_func.mgnt_xmit(padapter, pmgntframe); return ret; } @@ -431,97 +631,44 @@ void rtw_hal_free_recv_priv(_adapter *padapter) padapter->hal_func.free_recv_priv(padapter); } -void rtw_update_ramask(_adapter *padapter, struct sta_info *psta, u32 mac_id, u8 rssi_level, u8 is_update_bw) +void rtw_sta_ra_registed(_adapter *padapter, struct sta_info *psta) { - struct macid_cfg h2c_macid_cfg; - struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); - struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); - struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); - HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); - u8 disable_cck_rate = FALSE, MimoPs_enable = FALSE; - u32 ratr_bitmap_msb = 0, ratr_bitmap_lsb = 0; - u64 mask = 0, rate_bitmap = 0; - u8 bw, short_gi; + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); if (psta == NULL) { - RTW_ERR(FUNC_ADPT_FMT" macid:%u, sta is NULL\n", FUNC_ADPT_ARG(padapter), mac_id); + RTW_ERR(FUNC_ADPT_FMT" sta is NULL\n", FUNC_ADPT_ARG(padapter)); rtw_warn_on(1); return; } - _rtw_memset(&h2c_macid_cfg, 0, sizeof(struct macid_cfg)); - bw = rtw_get_tx_bw_mode(padapter, psta); - short_gi = query_ra_short_GI(psta, bw); - - ratr_bitmap_msb = (u32)(psta->ra_mask >> 32); - ratr_bitmap_lsb = (u32)(psta->ra_mask); - - phydm_update_hal_ra_mask(&hal_data->odmpriv, psta->wireless_mode, hal_data->rf_type, bw, MimoPs_enable, disable_cck_rate, &ratr_bitmap_msb, &ratr_bitmap_lsb, rssi_level); - mask = (((u64)ratr_bitmap_msb) << 32) | ((u64)ratr_bitmap_lsb); - - -#ifdef CONFIG_BT_COEXIST - if (hal_data->EEPROMBluetoothCoexist == 1) { - 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); +#ifdef CONFIG_AP_MODE + if (MLME_IS_AP(padapter) || MLME_IS_MESH(padapter)) { + if (psta->cmn.aid > padapter->stapriv.max_aid) { + 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 #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[mac_id] = psta->init_rate; + hal_data->INIDATA_RATE[psta->cmn.mac_id] = psta->init_rate; - - RTW_INFO("%s => mac_id:%d, networkType:0x%02x, mask:0x%016llx\n\t ==> rssi_level:%d, rate_bitmap:0x%016llx, shortGIrate=%d\n\t ==> bw:%d, ignore_bw:0x%d\n", - __func__, mac_id, psta->wireless_mode, mask, rssi_level, rate_bitmap, short_gi, bw, (!is_update_bw)); - - rtw_macid_ctl_set_bw(macid_ctl, mac_id, bw); - rtw_macid_ctl_set_vht_en(macid_ctl, mac_id, is_supported_vht(psta->wireless_mode)); - rtw_macid_ctl_set_rate_bmp0(macid_ctl, mac_id, mask); - rtw_macid_ctl_set_rate_bmp1(macid_ctl, mac_id, mask >> 32); - rtw_update_tx_rate_bmp(adapter_to_dvobj(padapter)); - - h2c_macid_cfg.mac_id = mac_id; - h2c_macid_cfg.rate_id = psta->raid; - h2c_macid_cfg.bandwidth = bw; - h2c_macid_cfg.ignore_bw = (!is_update_bw); - h2c_macid_cfg.short_gi = short_gi; - h2c_macid_cfg.ra_mask = mask; - - padapter->hal_func.update_ra_mask_handler(padapter, psta, &h2c_macid_cfg); + rtw_phydm_ra_registed(padapter, psta); } -void rtw_hal_update_ra_mask(struct sta_info *psta, u8 rssi_level, u8 is_update_bw) +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, is_update_bw); - else { - psta->raid = rtw_hal_networktype_to_raid(padapter, psta); - rtw_update_ramask(padapter, psta, psta->mac_id, rssi_level, is_update_bw); - } + rtw_sta_ra_registed(padapter, psta); } /* Start specifical interface thread */ @@ -558,30 +705,34 @@ void rtw_hal_write_bbreg(_adapter *padapter, u32 RegAddr, u32 BitMask, u32 Data) 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->hal_func.read_rfreg) { data = padapter->hal_func.read_rfreg(padapter, eRFPath, RegAddr, BitMask); - if (match_rf_read_sniff_ranges(eRFPath, RegAddr, BitMask)) { + #ifdef DBG_IO + if (match_rf_read_sniff_ranges(padapter, eRFPath, RegAddr, BitMask)) { RTW_INFO("DBG_IO rtw_hal_read_rfreg(%u, 0x%04x, 0x%08x) read:0x%08x(0x%08x)\n" , eRFPath, RegAddr, BitMask, (data << PHY_CalculateBitShift(BitMask)), data); } + #endif } 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->hal_func.write_rfreg) { - if (match_rf_write_sniff_ranges(eRFPath, RegAddr, BitMask)) { + #ifdef DBG_IO + if (match_rf_write_sniff_ranges(padapter, 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); } + #endif padapter->hal_func.write_rfreg(padapter, eRFPath, RegAddr, BitMask, Data); @@ -592,6 +743,23 @@ void rtw_hal_write_rfreg(_adapter *padapter, u32 eRFPath, u32 RegAddr, u32 BitMa } } +#ifdef CONFIG_SYSON_INDIRECT_ACCESS +u32 rtw_hal_read_syson_reg(PADAPTER padapter, u32 RegAddr, u32 BitMask) +{ + u32 data = 0; + if (padapter->hal_func.read_syson_reg) + data = padapter->hal_func.read_syson_reg(padapter, RegAddr, BitMask); + + return data; +} + +void rtw_hal_write_syson_reg(_adapter *padapter, u32 RegAddr, u32 BitMask, u32 Data) +{ + if (padapter->hal_func.write_syson_reg) + padapter->hal_func.write_syson_reg(padapter, RegAddr, BitMask, Data); +} +#endif + #if defined(CONFIG_PCI_HCI) s32 rtw_hal_interrupt_handler(_adapter *padapter) { @@ -599,6 +767,11 @@ s32 rtw_hal_interrupt_handler(_adapter *padapter) ret = padapter->hal_func.interrupt_handler(padapter); return ret; } + +void rtw_hal_unmap_beacon_icf(_adapter *padapter) +{ + padapter->hal_func.unmap_beacon_icf(padapter); +} #endif #if defined(CONFIG_USB_HCI) && defined(CONFIG_SUPPORT_USB_INT) void rtw_hal_interrupt_handler(_adapter *padapter, u16 pkt_len, u8 *pbuf) @@ -607,22 +780,22 @@ 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) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); - struct PHY_DM_STRUCT *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_acquire_spin_lock(pDM_Odm, RT_IQK_SPINLOCK); - if (pDM_Odm->rf_calibrate_info.is_iqk_in_progress == _TRUE) + if (rtw_phydm_is_iqk_in_progress(padapter)) RTW_ERR("%s, %d, IQK may race condition\n", __func__, __LINE__); - odm_release_spin_lock(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); @@ -645,29 +818,15 @@ void rtw_hal_set_chnl_bw(_adapter *padapter, u8 channel, CHANNEL_WIDTH Bandwidth 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->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->hal_func.get_tx_power_level_handler) - padapter->hal_func.get_tx_power_level_handler(padapter, powerlevel); -} - void rtw_hal_dm_watchdog(_adapter *padapter) { -#ifdef CONFIG_MCC_MODE - if (MCC_EN(padapter)) { - if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) - return; - } -#endif /* CONFIG_MCC_MODE */ + rtw_hal_turbo_edca(padapter); padapter->hal_func.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 @@ -680,11 +839,10 @@ void rtw_hal_dm_watchdog_in_lps(_adapter *padapter) #endif #endif - if (adapter_to_pwrctl(padapter)->bFwCurrentInPSMode == _TRUE) { - padapter->hal_func.hal_dm_watchdog_in_lps(padapter);/* this function caller is in interrupt context */ - } + if (adapter_to_pwrctl(padapter)->bFwCurrentInPSMode == _TRUE) + rtw_phydm_watchdog_in_lps_lclk(padapter);/* this function caller is in interrupt context */ } -#endif +#endif /*CONFIG_LPS_LCLK_WD_TIMER*/ void rtw_hal_bcn_related_reg_setting(_adapter *padapter) { @@ -830,15 +988,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); - struct PHY_DM_STRUCT *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; @@ -854,7 +1007,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 */ @@ -898,18 +1054,21 @@ s32 c2h_handler(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload) c2h_customer_str_rpt_2_hdl(adapter, payload, plen); break; #endif - +#ifdef RTW_PER_CMD_SUPPORT_FW + case C2H_PER_RATE_RPT: + c2h_per_rate_rpt_hdl(adapter, payload, plen); + break; +#endif case C2H_EXTEND: sub_id = payload[0]; /* 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; } -exit: if (ret != _SUCCESS) { if (id == C2H_EXTEND) RTW_WARN("%s: unknown C2H(0x%02x, 0x%02x)\n", __func__, id, sub_id); @@ -955,55 +1114,328 @@ 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; + u8 mid = 0; + u32 val32; + + do { + if (mid == 0) { + m = bmp->m0; + reg_sleep = macid_ctl->reg_sleep_m0; + #if (MACID_NUM_SW_LIMIT > 32) + } else if (mid == 1) { + m = bmp->m1; + reg_sleep = macid_ctl->reg_sleep_m1; + #endif + #if (MACID_NUM_SW_LIMIT > 64) + } else if (mid == 2) { + m = bmp->m2; + reg_sleep = macid_ctl->reg_sleep_m2; + #endif + #if (MACID_NUM_SW_LIMIT > 96) + } else if (mid == 3) { + m = bmp->m3; + reg_sleep = macid_ctl->reg_sleep_m3; + #endif + } else { + rtw_warn_on(1); + break; + } + + if (m == 0) + goto move_next; + + 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: + 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); +} + +inline s32 rtw_hal_macid_wakeup_all_used(_adapter *adapter) +{ + struct macid_ctl_t *macid_ctl = adapter_to_macidctl(adapter); + + return _rtw_hal_macid_bmp_sleep(adapter, &macid_ctl->used, 0); +} + +static s32 _rtw_hal_macid_drop(_adapter *adapter, u8 macid, u8 drop) +{ + struct macid_ctl_t *macid_ctl = adapter_to_macidctl(adapter); +#ifndef CONFIG_PROTSEL_MACSLEEP + u16 reg_drop = 0; +#else + u16 reg_drop_info = macid_ctl->reg_drop_info; + u16 reg_drop_ctrl = macid_ctl->reg_drop_ctrl; + const u32 sel_mask_sel = BIT(0) | BIT(1) | BIT(2); +#endif /* CONFIG_PROTSEL_MACSLEEP */ + u8 bit_shift; + u32 val32; + s32 ret = _FAIL; +/* some IC doesn't have this register */ +#ifndef REG_PKT_BUFF_ACCESS_CTRL +#define REG_PKT_BUFF_ACCESS_CTRL 0 +#endif 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), drop ? "drop" : "undrop" , macid); + goto exit; } + + if(_rtw_macid_ctl_chk_cap(adapter, MACID_DROP)) { + if (macid < 32) { +#ifndef CONFIG_PROTSEL_MACSLEEP + reg_drop = macid_ctl->reg_drop_m0; +#endif /* CONFIG_PROTSEL_MACSLEEP */ + bit_shift = macid; + #if (MACID_NUM_SW_LIMIT > 32) + } else if (macid < 64) { +#ifndef CONFIG_PROTSEL_MACSLEEP + reg_drop = macid_ctl->reg_drop_m1; +#endif /* CONFIG_PROTSEL_MACSLEEP */ + bit_shift = macid - 32; + #endif + #if (MACID_NUM_SW_LIMIT > 64) + } else if (macid < 96) { +#ifndef CONFIG_PROTSEL_MACSLEEP + reg_drop = macid_ctl->reg_drop_m2; +#endif /* CONFIG_PROTSEL_MACSLEEP */ + bit_shift = macid - 64; + #endif + #if (MACID_NUM_SW_LIMIT > 96) + } else if (macid < 128) { +#ifndef CONFIG_PROTSEL_MACSLEEP + reg_drop = macid_ctl->reg_drop_m3; +#endif /* CONFIG_PROTSEL_MACSLEEP */ + bit_shift = macid - 96; + #endif + } else { + rtw_warn_on(1); + goto exit; + } - rtw_hal_set_hwreg(padapter, HW_VAR_MACID_WAKEUP, &macid); +#ifndef CONFIG_PROTSEL_MACSLEEP + if (!reg_drop) { + rtw_warn_on(1); + goto exit; + } + val32 = rtw_read32(adapter, reg_drop); + /*RTW_INFO(ADPT_FMT" %s macid=%d, ori reg_0x%03x=0x%08x \n" + , ADPT_ARG(adapter), drop ? "drop" : "undrop" + , macid, reg_drop, val32);*/ +#else + if (!reg_drop_ctrl || !reg_drop_info) { + rtw_warn_on(1); + goto exit; + } - return _SUCCESS; + val32 = rtw_read32(adapter, reg_drop_ctrl); + val32 = (val32 &~sel_mask_sel) | ((macid / 32) & sel_mask_sel); + rtw_write32(adapter, reg_drop_ctrl, val32); + + val32 = rtw_read32(adapter, reg_drop_info); + /*RTW_INFO(ADPT_FMT" %s macid=%d, ori reg_0x%03x=0x%08x\n" + , ADPT_ARG(adapter), drop ? "drop" : "undrop" + , macid, reg_drop_info, val32);*/ +#endif /* CONFIG_PROTSEL_MACSLEEP */ + ret = _SUCCESS; + + if (drop) { + if (val32 & BIT(bit_shift)) + goto exit; + val32 |= BIT(bit_shift); + } else { + if (!(val32 & BIT(bit_shift))) + goto exit; + val32 &= ~BIT(bit_shift); + } + +#ifndef CONFIG_PROTSEL_MACSLEEP + rtw_write32(adapter, reg_drop, val32); + RTW_INFO(ADPT_FMT" %s macid=%d, done reg_0x%03x=0x%08x\n" + , ADPT_ARG(adapter), drop ? "drop" : "undrop" + , macid, reg_drop, val32); +#else + rtw_write32(adapter, reg_drop_info, val32); + RTW_INFO(ADPT_FMT" %s macid=%d, done reg_0x%03x=0x%08x\n" + , ADPT_ARG(adapter), drop ? "drop" : "undrop" + , macid, reg_drop_info, val32); +#endif /* CONFIG_PROTSEL_MACSLEEP */ + + + } else if(_rtw_macid_ctl_chk_cap(adapter, MACID_DROP_INDIRECT)) { + u16 start_addr = macid_ctl->macid_txrpt/8; + u32 txrpt_h4b = 0; + u8 i; + + /* each address means 1 byte */ + start_addr += macid*(macid_ctl->macid_txrpt_pgsz/8); + /* select tx report buffer */ + rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, TXREPORT_BUF_SELECT); + /* set tx report buffer start address for reading */ + rtw_write32(adapter, REG_PKTBUF_DBG_CTRL, start_addr); + txrpt_h4b = rtw_read32(adapter, REG_PKTBUF_DBG_DATA_H); + /* OFFSET5 BIT2 is BIT10 of high 4 bytes */ + if (drop) { + if (txrpt_h4b & BIT(10)) + goto exit; + txrpt_h4b |= BIT(10); + } else { + if (!(txrpt_h4b & BIT(10))) + goto exit; + txrpt_h4b &= ~BIT(10); + } + /* set to macid drop field */ + rtw_write32(adapter, REG_PKTBUF_DBG_DATA_H, txrpt_h4b); + /* 0x20800000 only write BIT10 of tx report buf */ + rtw_write32(adapter, REG_PKTBUF_DBG_CTRL, 0x20800000 | start_addr); +#if 0 /* some ICs doesn't clear the write done bit */ + /* checking TX queue status */ + for (i = 0 ; i < 50 ; i++) { + txrpt_h4b = rtw_read32(adapter, REG_PKTBUF_DBG_CTRL); + if (txrpt_h4b & BIT(23)) { + RTW_INFO("%s: wait to write TX RTP buf (%d)!\n", __func__, i); + rtw_mdelay_os(10); + } else { + RTW_INFO("%s: wait to write TX RTP buf done (%d)!\n", __func__, i); + break; + } + } +#endif + rtw_write32(adapter, REG_PKTBUF_DBG_CTRL, start_addr); + RTW_INFO("start_addr=%x, data_H:%08x, data_L:%08x, macid=%d, txrpt_h4b=%x\n", start_addr + ,rtw_read32(adapter, REG_PKTBUF_DBG_DATA_H), rtw_read32(adapter, REG_PKTBUF_DBG_DATA_L), macid, txrpt_h4b); + } else { + RTW_INFO("There is no definition for camctl cap , please correct it\n"); + } +exit: + return ret; +} + +inline s32 rtw_hal_macid_drop(_adapter *adapter, u8 macid) +{ + return _rtw_hal_macid_drop(adapter, macid, 1); +} + +inline s32 rtw_hal_macid_undrop(_adapter *adapter, u8 macid) +{ + return _rtw_hal_macid_drop(adapter, macid, 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) + 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" @@ -1017,9 +1449,21 @@ void rtw_hal_fill_fake_txdesc(_adapter *padapter, u8 *pDesc, u32 BufferLen, 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->hal_func.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 @@ -1046,20 +1490,37 @@ void rtw_hal_gpio_multi_func_reset(_adapter *padapter, u8 gpio_num) } #endif +#ifdef CONFIG_FW_CORRECT_BCN void rtw_hal_fw_correct_bcn(_adapter *padapter) { if (padapter->hal_func.fw_correct_bcn) padapter->hal_func.fw_correct_bcn(padapter); } +#endif -void rtw_hal_set_tx_power_index(PADAPTER padapter, u32 powerindex, u8 rfpath, u8 rate) +void rtw_hal_set_tx_power_level(_adapter *adapter, u8 channel) { - return padapter->hal_func.set_tx_power_index_handler(padapter, powerindex, rfpath, rate); + adapter->hal_func.set_tx_power_level_handler(adapter, channel); + rtw_hal_set_txpwr_done(adapter); } -u8 rtw_hal_get_tx_power_index(PADAPTER padapter, u8 rfpath, u8 rate, u8 bandwidth, u8 channel, struct txpwr_idx_comp *tic) +void rtw_hal_set_txpwr_done(_adapter *adapter) { - return padapter->hal_func.get_tx_power_index_handler(padapter, rfpath, rate, bandwidth, channel, tic); + if (adapter->hal_func.set_txpwr_done) + adapter->hal_func.set_txpwr_done(adapter); +} + +void rtw_hal_set_tx_power_index(_adapter *adapter, u32 powerindex + , enum rf_path rfpath, u8 rate) +{ + adapter->hal_func.set_tx_power_index_handler(adapter, powerindex, rfpath, rate); +} + +u8 rtw_hal_get_tx_power_index(_adapter *adapter, enum rf_path rfpath, u8 rate + , u8 bandwidth, u8 channel, struct txpwr_idx_comp *tic) +{ + return adapter->hal_func.get_tx_power_index_handler(adapter, rfpath, rate + , bandwidth, channel, tic); } #ifdef RTW_HALMAC @@ -1254,12 +1715,6 @@ u8 rtw_hal_ops_check(_adapter *padapter) rtw_hal_error_msg("hal_dm_watchdog"); ret = _FAIL; } -#ifdef CONFIG_LPS_LCLK_WD_TIMER - if (NULL == padapter->hal_func.hal_dm_watchdog_in_lps) { - rtw_hal_error_msg("hal_dm_watchdog_in_lps"); - ret = _FAIL; - } -#endif /*** xxx section ***/ if (NULL == padapter->hal_func.set_chnl_bw_handler) { @@ -1291,10 +1746,6 @@ u8 rtw_hal_ops_check(_adapter *padapter) rtw_hal_error_msg("SetHalODMVarHandler"); ret = _FAIL; } - if (NULL == padapter->hal_func.update_ra_mask_handler) { - rtw_hal_error_msg("update_ra_mask_handler"); - ret = _FAIL; - } if (NULL == padapter->hal_func.SetBeaconRelatedRegistersHandler) { rtw_hal_error_msg("SetBeaconRelatedRegistersHandler"); @@ -1324,10 +1775,13 @@ u8 rtw_hal_ops_check(_adapter *padapter) ret = _FAIL; } #endif + +#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) @@ -1343,20 +1797,22 @@ u8 rtw_hal_ops_check(_adapter *padapter) ret = _FAIL; } - if ((IS_HARDWARE_TYPE_8814A(padapter) - || IS_HARDWARE_TYPE_8822BU(padapter) || IS_HARDWARE_TYPE_8822BS(padapter)) + #ifdef CONFIG_FW_CORRECT_BCN + if (IS_HARDWARE_TYPE_8814A(padapter) && NULL == padapter->hal_func.fw_correct_bcn) { rtw_hal_error_msg("fw_correct_bcn"); ret = _FAIL; } + #endif - if (IS_HARDWARE_TYPE_8822B(padapter) || IS_HARDWARE_TYPE_8821C(padapter)) { - if (!padapter->hal_func.set_tx_power_index_handler) { - rtw_hal_error_msg("set_tx_power_index_handler"); - ret = _FAIL; - } + if (!padapter->hal_func.set_tx_power_level_handler) { + rtw_hal_error_msg("set_tx_power_level_handler"); + ret = _FAIL; + } + if (!padapter->hal_func.set_tx_power_index_handler) { + rtw_hal_error_msg("set_tx_power_index_handler"); + ret = _FAIL; } - if (!padapter->hal_func.get_tx_power_index_handler) { rtw_hal_error_msg("get_tx_power_index_handler"); ret = _FAIL; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_mcc.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_mcc.c index 6d1a217dc443..14fc20e24702 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_mcc.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_mcc.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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,21 +21,24 @@ #include /* HAL_DATA */ #include /* power control */ -#define MCC_DURATION_IDX 0 +/* use for AP/GO + STA/GC case */ +#define MCC_DURATION_IDX 0 /* druration for station side */ #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 MCC_STOP_THRESHOLD 6 #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}, +/* druration, TSF sync offset, start time offset, interval (unit:TU (1024 microseconds))*/ +u8 mcc_switch_channel_policy_table[][7]={ + {20, 50, 40, 100, 0, 0, 30}, + {80, 50, 10, 100, 0, 0, 30}, + {36, 50, 32, 100, 0, 0, 30}, + {30, 50, 35, 100, 0, 0, 30}, }; -const int mcc_max_policy_num = sizeof(mcc_switch_channel_policy_table) /sizeof(u8) /6; +const int mcc_max_policy_num = sizeof(mcc_switch_channel_policy_table) /sizeof(u8) /7; static void dump_iqk_val_table(PADAPTER padapter) { @@ -49,6 +49,9 @@ static void dump_iqk_val_table(PADAPTER padapter) u8 backup_chan_idx = 0; u8 backup_reg_idx = 0; +#ifdef CONFIG_MCC_MODE_V2 +#else + 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++) { @@ -64,6 +67,8 @@ static void dump_iqk_val_table(PADAPTER padapter) } } RTW_INFO("=============================================\n"); + +#endif } static void rtw_hal_mcc_build_p2p_noa_attr(PADAPTER padapter, u8 *ie, u32 *ie_len) @@ -76,14 +81,14 @@ static void rtw_hal_mcc_build_p2p_noa_attr(PADAPTER padapter, u8 *ie, u32 *ie_le u8 noa_desc_num = 1; u8 opp_ps = 0; /* Disable OppPS */ u8 noa_count = 255; - u32 noa_duration = 0x20; - u32 noa_interval = 0x64; + u32 noa_duration; + u32 noa_interval; 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]; + noa_duration = mcc_switch_channel_policy_table[mcc_policy_idx][MCC_DURATION_IDX] * TU; + noa_interval = mcc_switch_channel_policy_table[mcc_policy_idx][MCC_INTERVAL_IDX] * TU; /* P2P OUI(4 bytes) */ _rtw_memcpy(p2p_noa_attr_ie, P2P_OUI, 4); @@ -94,7 +99,7 @@ static void rtw_hal_mcc_build_p2p_noa_attr(PADAPTER padapter, u8 *ie, u32 *ie_le 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)); + 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) */ @@ -110,11 +115,11 @@ static void rtw_hal_mcc_build_p2p_noa_attr(PADAPTER padapter, u8 *ie, u32 *ie_le 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)); + RTW_PUT_LE32(p2p_noa_attr_ie + p2p_noa_attr_len, noa_duration); 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)); + RTW_PUT_LE32(p2p_noa_attr_ie + p2p_noa_attr_len, noa_interval); p2p_noa_attr_len = p2p_noa_attr_len + 4; /* NoA Start Time (4 bytes) unit: microseconds */ @@ -139,6 +144,7 @@ static void rtw_hal_mcc_build_p2p_noa_attr(PADAPTER padapter, u8 *ie, u32 *ie_le static void rtw_hal_mcc_update_go_p2p_ie(PADAPTER padapter) { struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; + struct mcc_obj_priv *mccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); u8 *pos = NULL; @@ -146,14 +152,22 @@ static void rtw_hal_mcc_update_go_p2p_ie(PADAPTER padapter) 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 */ + /* has noa attribut, modify it */ + u32 noa_duration = 0; + /* update index */ pos = pmccadapriv->p2p_go_noa_ie + pmccadapriv->p2p_go_noa_ie_len - 15; /* 0~255 */ (*pos) = ((*pos) + 1) % 256; - if (1) + if (0) RTW_INFO("indxe:%d\n", (*pos)); + + /* update duration */ + noa_duration = mcc_switch_channel_policy_table[mccobjpriv->policy_index][MCC_DURATION_IDX] * TU; + pos = pmccadapriv->p2p_go_noa_ie + pmccadapriv->p2p_go_noa_ie_len - 12; + RTW_PUT_LE32(pos, noa_duration); + /* update start time */ pos = pmccadapriv->p2p_go_noa_ie + pmccadapriv->p2p_go_noa_ie_len - 4; RTW_PUT_LE32(pos, pmccadapriv->noa_start_time); @@ -167,16 +181,8 @@ static void rtw_hal_mcc_update_go_p2p_ie(PADAPTER padapter) } 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"); + RTW_INFO_DUMP("\n", pmccadapriv->p2p_go_noa_ie, pmccadapriv->p2p_go_noa_ie_len); } update_beacon(padapter, _VENDOR_SPECIFIC_IE_, P2P_OUI, _TRUE); } @@ -204,6 +210,7 @@ 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; + struct mcc_adapter_priv *mccadapriv = NULL; u8 i = 0; rtw_hal_get_hwreg(padapter, HW_VAR_CH_SW_NEED_TO_TAKE_CARE_IQK_INFO, &take_care_iqk); @@ -213,6 +220,10 @@ void rtw_hal_mcc_restore_iqk_val(PADAPTER padapter) if (iface == NULL) continue; + mccadapriv = &iface->mcc_adapterpriv; + if (mccadapriv->role == MCC_ROLE_MAX) + continue; + rtw_hal_ch_sw_iqk_info_restore(iface, CH_SW_USE_CASE_MCC); } } @@ -245,101 +256,74 @@ 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) +static void rtw_hal_mcc_update_policy_table(PADAPTER adapter) { - struct registry_priv *registry_par = &padapter->registrypriv; - u8 idx = 0; + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + struct mcc_obj_priv *mccobjpriv = &(dvobj->mcc_objpriv); + u8 mcc_duration = mccobjpriv->duration; + s8 mcc_policy_idx = mccobjpriv->policy_index; + u8 interval = mcc_switch_channel_policy_table[mcc_policy_idx][MCC_INTERVAL_IDX]; + u8 new_mcc_duration_time = 0; + u8 new_starttime_offset = 0; - if (registry_par->rtw_mcc_policy_table_idx < 0) - return; + /* convert % to ms */ + new_mcc_duration_time = mcc_duration * interval / 100; - 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; - } + /* start time offset = (interval - duration time)/2 */ + new_starttime_offset = (interval - new_mcc_duration_time) >> 1; - idx = registry_par->rtw_mcc_policy_table_idx; + /* update modified parameters */ + mcc_switch_channel_policy_table[mcc_policy_idx][MCC_DURATION_IDX] + = new_mcc_duration_time; + + mcc_switch_channel_policy_table[mcc_policy_idx][MCC_START_TIME_OFFSET_IDX] + = new_starttime_offset; - 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 mcc_obj_priv *mccobjpriv = &(dvobj->mcc_objpriv); struct registry_priv *registry_par = &padapter->registrypriv; - u8 interval = pmlmepriv->cur_network.network.Configuration.BeaconPeriod; - u8 i = 0; + u8 mcc_duration = 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; + mcc_duration = mccobjpriv->duration; 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); + mccobjpriv->policy_index = 0; + RTW_INFO("[MCC] can't find table(%d), use default policy(%d)\n", + mcc_policy_idx, mccobjpriv->policy_index); } else - pmccobjpriv->policy_index = mcc_policy_idx; + mccobjpriv->policy_index = mcc_policy_idx; + + /* convert % to time */ + if (mcc_duration != 0) + rtw_hal_mcc_update_policy_table(padapter); 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]); + , mccobjpriv->policy_index + , mcc_switch_channel_policy_table[mccobjpriv->policy_index][MCC_DURATION_IDX] + , mcc_switch_channel_policy_table[mccobjpriv->policy_index][MCC_TSF_SYNC_OFFSET_IDX] + , mcc_switch_channel_policy_table[mccobjpriv->policy_index][MCC_START_TIME_OFFSET_IDX] + , mcc_switch_channel_policy_table[mccobjpriv->policy_index][MCC_INTERVAL_IDX] + , mcc_switch_channel_policy_table[mccobjpriv->policy_index][MCC_GUARD_OFFSET0_IDX] + , mcc_switch_channel_policy_table[mccobjpriv->policy_index][MCC_GUARD_OFFSET1_IDX]); } -static void rtw_hal_config_mcc_role_setting(PADAPTER padapter) +static void rtw_hal_mcc_assign_tx_threshold(PADAPTER padapter) { - struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); - struct mcc_obj_priv *pmccobjpriv = &(pdvobjpriv->mcc_objpriv); - struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; - struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); - struct wlan_network *cur_network = &(pmlmepriv->cur_network); - 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; + struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - 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 = mcc_duration; - switch (pmlmeext->cur_bwmode) { case CHANNEL_WIDTH_20: /* @@ -363,26 +347,9 @@ static void rtw_hal_config_mcc_role_setting(PADAPTER padapter) , FUNC_ADPT_ARG(padapter), pmlmeext->cur_bwmode); break; } - - /* assign used mac to avoid affecting RA */ - pmccadapriv->mgmt_queue_macid = MCC_ROLE_STA_GC_MGMT_QUEUE_MACID; - - 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); - } else { - RTW_INFO(FUNC_ADPT_FMT":AP/GO station info is NULL\n", FUNC_ADPT_ARG(padapter)); - rtw_warn_on(1); - } break; case MCC_ROLE_AP: case MCC_ROLE_GO: - pmccadapriv->order = 0; - /* 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: pmccadapriv->mcc_target_tx_bytes_to_port = preg->rtw_mcc_ap_bw20_target_tx_tp * 128 * pmccadapriv->mcc_duration; @@ -399,52 +366,771 @@ static void rtw_hal_config_mcc_role_setting(PADAPTER padapter) , FUNC_ADPT_ARG(padapter), pmlmeext->cur_bwmode); break; } + break; + default: + RTW_INFO(FUNC_ADPT_FMT": unknown role = %d\n" + , FUNC_ADPT_ARG(padapter), pmccadapriv->role); + break; + } +} +#ifdef CONFIG_MCC_PHYDM_OFFLOAD +static void mcc_cfg_phdym_rf_ch (_adapter *adapter) +{ + struct mcc_adapter_priv *mccadapriv = &adapter->mcc_adapterpriv; + struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; + HAL_DATA_TYPE *hal = GET_HAL_DATA(adapter); + struct dm_struct *dm = &hal->odmpriv; + struct _phydm_mcc_dm_ *mcc_dm = &dm->mcc_dm; + u8 order = 0; - psta = rtw_get_bcmc_stainfo(padapter); + set_channel_bwmode(adapter, mlmeext->cur_channel, mlmeext->cur_ch_offset, mlmeext->cur_bwmode); + order = mccadapriv->order; + mcc_dm->mcc_rf_channel[order] = phy_query_rf_reg(adapter, RF_PATH_A, 0x18, 0xffffffff); +} - if (psta != NULL) - pmccadapriv->mgmt_queue_macid = psta->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" - , FUNC_ADPT_ARG(padapter), pmccadapriv->mgmt_queue_macid); +static void mcc_cfg_phdym_update_macid (_adapter *adapter, u8 add, u8 mac_id) +{ + struct mcc_adapter_priv *mccadapriv = &adapter->mcc_adapterpriv; + struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; + HAL_DATA_TYPE *hal = GET_HAL_DATA(adapter); + struct dm_struct *dm = &hal->odmpriv; + struct _phydm_mcc_dm_ *mcc_dm = &dm->mcc_dm; + u8 order = 0, i = 0; + + order = mccadapriv->order; + if (add) { + for (i = 0; i < NUM_STA; i++) { + if (mcc_dm->sta_macid[order][i] == 0xff) { + mcc_dm->sta_macid[order][i] = mac_id; + break; + } + } + } else { + for (i = 0; i < NUM_STA; i++) { + if (mcc_dm->sta_macid[order][i] == mac_id) { + mcc_dm->sta_macid[order][i] = 0xff; + break; + } + } } - /* combine client macid and mgmt queue macid to bitmap */ - pmccadapriv->mcc_macid_bitmap = (0xff << 8) | BIT(pmccadapriv->mgmt_queue_macid); - break; - default: - RTW_INFO("Unknown role\n"); - rtw_warn_on(1); - break; + +} + +static void mcc_cfg_phdym_start(_adapter *adapter, u8 start) +{ + struct dvobj_priv *dvobj; + struct mcc_obj_priv *mccobjpriv; + HAL_DATA_TYPE *hal; + struct dm_struct *dm; + struct _phydm_mcc_dm_ *mcc_dm; + u8 rfk_forbidden = _TRUE; + u8 i = 0, j = 0; + + dvobj = adapter_to_dvobj(adapter); + mccobjpriv = adapter_to_mccobjpriv(adapter); + hal = GET_HAL_DATA(adapter); + dm = &hal->odmpriv; + mcc_dm = &dm->mcc_dm; + + if (start) { + #ifdef CONFIG_MCC_PHYDM_OFFLOAD + mcc_dm->mcc_status = mccobjpriv->mcc_phydm_offload; + #endif + + rfk_forbidden = _TRUE; + halrf_cmn_info_set(dm, HALRF_CMNINFO_RFK_FORBIDDEN, rfk_forbidden); + } else { + rfk_forbidden = _FALSE; + halrf_cmn_info_set(dm, HALRF_CMNINFO_RFK_FORBIDDEN, rfk_forbidden); + + #ifdef CONFIG_MCC_PHYDM_OFFLOAD + for(i = 0; i < MAX_MCC_NUM; i ++) { + for(j = 0; j < NUM_STA; j ++) { + if (mcc_dm->sta_macid[i][j] != 0xff) + /* clear all used value for mcc stop */ + /* do nothing for mcc start due to phydm will init to 0xff */ + mcc_dm->sta_macid[i][j] = 0xff; + } + mcc_dm->mcc_rf_channel[i] = 0xff; + } + mcc_dm->mcc_status = 0; + #endif } +} + +static void mcc_cfg_phdym_dump(_adapter *adapter, void *sel) +{ + HAL_DATA_TYPE *hal; + struct dm_struct *dm; + struct _phydm_mcc_dm_ *mcc_dm; + u8 rfk_forbidden = _TRUE; + u8 i = 0, j = 0; + + + hal = GET_HAL_DATA(adapter); + dm = &hal->odmpriv; + mcc_dm = &dm->mcc_dm; + + rfk_forbidden = halrf_cmn_info_get(dm, HALRF_CMNINFO_RFK_FORBIDDEN); + RTW_PRINT_SEL(sel, "dump mcc dm info\n"); + RTW_PRINT_SEL(sel, "mcc_status=%d\n", mcc_dm->mcc_status); + RTW_PRINT_SEL(sel, "rfk_forbidden=%d\n", rfk_forbidden); + for(i = 0; i < MAX_MCC_NUM; i ++) { + + if (mcc_dm->mcc_rf_channel[i] != 0xff) + RTW_PRINT_SEL(sel, "mcc_dm->mcc_rf_channel[%d] = 0x%02x\n", i, mcc_dm->mcc_rf_channel[i]); + + for(j = 0; j < NUM_STA; j ++) { + if (mcc_dm->sta_macid[i][j] != 0xff) + RTW_PRINT_SEL(sel, "mcc_dm->sta_macid[%d][%d] = %d\n", i, j, mcc_dm->sta_macid[i][j]); + } + } +} + +static void mcc_cfg_phdym_offload(_adapter *adapter, u8 enable) +{ + struct mcc_obj_priv *mccobjpriv = adapter_to_mccobjpriv(adapter); + _adapter *iface = NULL; + struct mcc_adapter_priv *mccadapriv = NULL; + HAL_DATA_TYPE *hal = NULL; + struct dm_struct *dm = NULL; + struct _phydm_mcc_dm_ *mcc_dm = NULL; + struct sta_priv *stapriv = NULL; + struct sta_info *sta = NULL; + struct wlan_network *cur_network = NULL; + _irqL irqL; + _list *head = NULL, *list = NULL; + u8 i = 0; + + + hal = GET_HAL_DATA(adapter); + dm = &hal->odmpriv; + mcc_dm = &dm->mcc_dm; + + /* due to phydm will rst related date, driver must set related data */ + if (enable) { + for (i = 0; i < MAX_MCC_NUM; i++) { + iface = mccobjpriv->iface[i]; + if (!iface) + continue; + stapriv = &iface->stapriv; + mccadapriv = &iface->mcc_adapterpriv; + switch (mccadapriv->role) { + case MCC_ROLE_STA: + case MCC_ROLE_GC: + cur_network = &iface->mlmepriv.cur_network; + sta = rtw_get_stainfo(stapriv, cur_network->network.MacAddress); + if (sta) + mcc_cfg_phdym_update_macid(iface, _TRUE, sta->cmn.mac_id); + break; + case MCC_ROLE_AP: + case MCC_ROLE_GO: + _enter_critical_bh(&stapriv->asoc_list_lock, &irqL); + + head = &stapriv->asoc_list; + list = get_next(head); + + while ((rtw_end_of_queue_search(head, list)) == _FALSE) { + sta = LIST_CONTAINOR(list, struct sta_info, asoc_list); + list = get_next(list); + mcc_cfg_phdym_update_macid(iface, _TRUE, sta->cmn.mac_id); + } + + _exit_critical_bh(&stapriv->asoc_list_lock, &irqL); + break; + default: + RTW_INFO("Unknown role\n"); + rtw_warn_on(1); + break; + } + + } + } + + mcc_dm->mcc_status = enable; +} + +static void rtw_hal_mcc_cfg_phydm (_adapter *adapter, enum mcc_cfg_phydm_ops ops, void *data) +{ + switch (ops) { + case MCC_CFG_PHYDM_OFFLOAD: + mcc_cfg_phdym_offload(adapter, *(u8 *)data); + break; + case MCC_CFG_PHYDM_RF_CH: + mcc_cfg_phdym_rf_ch(adapter); + break; + case MCC_CFG_PHYDM_ADD_CLIENT: + mcc_cfg_phdym_update_macid(adapter, _TRUE, *(u8 *)data); + break; + case MCC_CFG_PHYDM_REMOVE_CLIENT: + mcc_cfg_phdym_update_macid(adapter, _FALSE, *(u8 *)data); + break; + case MCC_CFG_PHYDM_START: + mcc_cfg_phdym_start(adapter, _TRUE); + break; + case MCC_CFG_PHYDM_STOP: + mcc_cfg_phdym_start(adapter, _FALSE); + break; + case MCC_CFG_PHYDM_DUMP: + mcc_cfg_phdym_dump(adapter, data); + break; + case MCC_CFG_PHYDM_MAX: + default: + RTW_ERR("[MCC] rtw_hal_mcc_cfg_phydm ops error (%d)\n", ops); + break; + + } +} +#endif + +static void rtw_hal_config_mcc_role_setting(PADAPTER padapter, u8 order) +{ + struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); + struct mcc_obj_priv *pmccobjpriv = &(pdvobjpriv->mcc_objpriv); + struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct wlan_network *cur_network = &(pmlmepriv->cur_network); + struct sta_priv *pstapriv = &padapter->stapriv; + struct sta_info *psta = NULL; + struct registry_priv *preg = &padapter->registrypriv; + _irqL irqL; + _list *phead =NULL, *plist = NULL; + u8 policy_index = 0; + u8 mcc_duration = 0; + u8 mcc_interval = 0; + u8 starting_ap_num = DEV_AP_STARTING_NUM(pdvobjpriv); + u8 ap_num = DEV_AP_NUM(pdvobjpriv); + + 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]; + + if (starting_ap_num == 0 && ap_num == 0) { + pmccadapriv->order = order; + + if (pmccadapriv->order == 0) { + /* setting is smiliar to GO/AP */ + /* pmccadapriv->mcc_duration = mcc_interval - mcc_duration;*/ + pmccadapriv->mgmt_queue_macid = MCC_ROLE_SOFTAP_GO_MGMT_QUEUE_MACID; + } else if (pmccadapriv->order == 1) { + /* pmccadapriv->mcc_duration = mcc_duration; */ + pmccadapriv->mgmt_queue_macid = MCC_ROLE_STA_GC_MGMT_QUEUE_MACID; + } else { + RTW_INFO("[MCC] not support >= 3 interface\n"); + rtw_warn_on(1); + } + + rtw_hal_mcc_assign_tx_threshold(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->cmn.mac_id) | BIT(pmccadapriv->mgmt_queue_macid); + #ifdef CONFIG_MCC_PHYDM_OFFLOAD + rtw_hal_mcc_cfg_phydm(padapter, MCC_CFG_PHYDM_ADD_CLIENT, &psta->cmn.mac_id); + #endif + } else { + RTW_INFO(FUNC_ADPT_FMT":AP/GO station info is NULL\n", FUNC_ADPT_ARG(padapter)); + rtw_warn_on(1); + } + } else { + /* 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 = mcc_duration; + + rtw_hal_mcc_assign_tx_threshold(padapter); + /* assign used mac to avoid affecting RA */ + pmccadapriv->mgmt_queue_macid = MCC_ROLE_STA_GC_MGMT_QUEUE_MACID; + + 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->cmn.mac_id) | BIT(pmccadapriv->mgmt_queue_macid); + #ifdef CONFIG_MCC_PHYDM_OFFLOAD + rtw_hal_mcc_cfg_phydm(padapter, MCC_CFG_PHYDM_ADD_CLIENT, &psta->cmn.mac_id); + #endif + } else { + RTW_INFO(FUNC_ADPT_FMT":AP/GO station info is NULL\n", FUNC_ADPT_ARG(padapter)); + rtw_warn_on(1); + } + break; + case MCC_ROLE_AP: + case MCC_ROLE_GO: + pmccadapriv->order = 0; + /* 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 */ + + rtw_hal_mcc_assign_tx_threshold(padapter); + + _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); + + phead = &pstapriv->asoc_list; + plist = get_next(phead); + pmccadapriv->mcc_macid_bitmap = 0; + + while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { + psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); + plist = get_next(plist); + pmccadapriv->mcc_macid_bitmap |= BIT(psta->cmn.mac_id); + #ifdef CONFIG_MCC_PHYDM_OFFLOAD + rtw_hal_mcc_cfg_phydm(padapter, MCC_CFG_PHYDM_ADD_CLIENT, &psta->cmn.mac_id); + #endif + } + + _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); + + psta = rtw_get_bcmc_stainfo(padapter); + + if (psta != NULL) + 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" + , FUNC_ADPT_ARG(padapter), pmccadapriv->mgmt_queue_macid); + } + + /* combine client macid and mgmt queue macid to bitmap */ + pmccadapriv->mcc_macid_bitmap |= BIT(pmccadapriv->mgmt_queue_macid); + break; + default: + RTW_INFO("Unknown role\n"); + rtw_warn_on(1); + break; + } + + } + + /* setting Null data parameters */ + if (pmccadapriv->role == MCC_ROLE_STA) { + pmccadapriv->null_early = 3; + pmccadapriv->null_rty_num= 5; + } else if (pmccadapriv->role == MCC_ROLE_GC) { + pmccadapriv->null_early = 2; + pmccadapriv->null_rty_num= 5; + } else { + pmccadapriv->null_early = 0; + pmccadapriv->null_rty_num= 0; + } + + RTW_INFO("********* "FUNC_ADPT_FMT" *********\n", FUNC_ADPT_ARG(padapter)); + RTW_INFO("order:%d\n", pmccadapriv->order); + RTW_INFO("role:%d\n", pmccadapriv->role); + RTW_INFO("mcc duration:%d\n", pmccadapriv->mcc_duration); + RTW_INFO("null_early:%d\n", pmccadapriv->null_early); + RTW_INFO("null_rty_num:%d\n", pmccadapriv->null_rty_num); + RTW_INFO("mgmt queue macid:%d\n", pmccadapriv->mgmt_queue_macid); + RTW_INFO("bitmap:0x%02x\n", pmccadapriv->mcc_macid_bitmap); + RTW_INFO("target tx bytes:%d\n", pmccadapriv->mcc_target_tx_bytes_to_port); + RTW_INFO("**********************************\n"); 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); + #ifdef CONFIG_MCC_PHYDM_OFFLOAD + rtw_hal_mcc_cfg_phydm(padapter, MCC_CFG_PHYDM_RF_CH, NULL); + #endif + } -static void rtw_hal_clear_mcc_macid(PADAPTER padapter) +static void rtw_hal_mcc_rqt_tsf(PADAPTER padapter, u64 *out_tsf) { - u16 media_status_rpt; - struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + struct mcc_obj_priv *mccobjpriv = &(dvobj->mcc_objpriv); + PADAPTER order0_iface = NULL; + PADAPTER order1_iface = NULL; + struct submit_ctx *tsf_req_sctx = NULL; + enum _hw_port tsfx = MAX_HW_PORT; + enum _hw_port tsfy = MAX_HW_PORT; + u8 cmd[H2C_MCC_RQT_TSF_LEN] = {0}; - switch (pmccadapriv->role) { - case MCC_ROLE_STA: - case MCC_ROLE_GC: + _enter_critical_mutex(&mccobjpriv->mcc_tsf_req_mutex, NULL); + + order0_iface = mccobjpriv->iface[0]; + order1_iface = mccobjpriv->iface[1]; + + tsf_req_sctx = &mccobjpriv->mcc_tsf_req_sctx; + rtw_sctx_init(tsf_req_sctx, MCC_EXPIRE_TIME); + mccobjpriv->mcc_tsf_req_sctx_order = 0; + tsfx = rtw_hal_get_port(order0_iface); + tsfy = rtw_hal_get_port(order1_iface); + + SET_H2CCMD_MCC_RQT_TSFX(cmd, tsfx); + SET_H2CCMD_MCC_RQT_TSFY(cmd, tsfy); + + rtw_hal_fill_h2c_cmd(padapter, H2C_MCC_RQT_TSF, H2C_MCC_RQT_TSF_LEN, cmd); + + if (!rtw_sctx_wait(tsf_req_sctx, __func__)) + RTW_INFO(FUNC_ADPT_FMT": wait for mcc tsf req C2H time out\n", FUNC_ADPT_ARG(padapter)); + + if (tsf_req_sctx->status == RTW_SCTX_DONE_SUCCESS && out_tsf != NULL) { + out_tsf[0] = order0_iface->mcc_adapterpriv.tsf; + out_tsf[1] = order1_iface->mcc_adapterpriv.tsf; + } + + + _exit_critical_mutex(&mccobjpriv->mcc_tsf_req_mutex, NULL); +} + +static u8 rtw_hal_mcc_check_start_time_is_valid(PADAPTER padapter, u8 case_num, + u32 tsfdiff, s8 *upper_bound_0, s8 *lower_bound_0, s8 *upper_bound_1, s8 *lower_bound_1) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + struct mcc_obj_priv *mccobjpriv = &(dvobj->mcc_objpriv); + u8 duration_0 = 0, duration_1 = 0; + s8 final_upper_bound = 0, final_lower_bound = 0; + u8 intersection = _FALSE; + u8 min_start_time = 5; + u8 max_start_time = 95; + + duration_0 = mccobjpriv->iface[0]->mcc_adapterpriv.mcc_duration; + duration_1 = mccobjpriv->iface[1]->mcc_adapterpriv.mcc_duration; + + switch(case_num) { + case 1: + *upper_bound_0 = tsfdiff; + *lower_bound_0 = tsfdiff - duration_1; + *upper_bound_1 = 150 - duration_1; + *lower_bound_1= 0; break; - case MCC_ROLE_AP: - case MCC_ROLE_GO: - /* nothing to do */ + case 2: + *upper_bound_0 = tsfdiff + 100; + *lower_bound_0 = tsfdiff + 100 - duration_1; + *upper_bound_1 = 150 - duration_1; + *lower_bound_1= 0; + break; + case 3: + *upper_bound_0 = tsfdiff + 50; + *lower_bound_0 = tsfdiff + 50 - duration_1; + *upper_bound_1 = 150 - duration_1; + *lower_bound_1= 0; + break; + case 4: + *upper_bound_0 = tsfdiff; + *lower_bound_0 = tsfdiff - duration_1; + *upper_bound_1 = 150 - duration_1; + *lower_bound_1= 0; + break; + case 5: + *upper_bound_0 = 200 - tsfdiff; + *lower_bound_0 = 200 - tsfdiff - duration_1; + *upper_bound_1 = 150 - duration_1; + *lower_bound_1= 0; + break; + case 6: + *upper_bound_0 = tsfdiff - 50; + *lower_bound_0 = tsfdiff - 50 - duration_1; + *upper_bound_1 = 150 - duration_1; + *lower_bound_1= 0; break; default: - RTW_INFO("Unknown role\n"); - rtw_warn_on(1); - break; + RTW_ERR("[MCC] %s: error case number(%d\n)", __func__, case_num); } + + + /* check Intersection or not */ + if ((*lower_bound_1 >= *upper_bound_0) || + (*lower_bound_0 >= *upper_bound_1)) + intersection = _FALSE; + else + intersection = _TRUE; + + if (intersection) { + if (*upper_bound_0 > *upper_bound_1) + final_upper_bound = *upper_bound_1; + else + final_upper_bound = *upper_bound_0; + + if (*lower_bound_0 > *lower_bound_1) + final_lower_bound = *lower_bound_0; + else + final_lower_bound = *lower_bound_1; + + mccobjpriv->start_time = (final_lower_bound + final_upper_bound) / 2; + + /* check start time less than 5ms, request by Pablo@SD1 */ + if (mccobjpriv->start_time <= min_start_time) { + mccobjpriv->start_time = 6; + if (mccobjpriv->start_time < final_lower_bound && mccobjpriv->start_time > final_upper_bound) { + intersection = _FALSE; + goto exit; + } + } + + /* check start time less than 95ms */ + if (mccobjpriv->start_time >= max_start_time) { + mccobjpriv->start_time = 90; + if (mccobjpriv->start_time < final_lower_bound && mccobjpriv->start_time > final_upper_bound) { + intersection = _FALSE; + goto exit; + } + } + } + +exit: + return intersection; } + +static void rtw_hal_mcc_decide_duration(PADAPTER padapter) +{ + struct registry_priv *registry_par = &padapter->registrypriv; + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + struct mcc_obj_priv *mccobjpriv = &(dvobj->mcc_objpriv); + struct mcc_adapter_priv *mccadapriv = NULL, *mccadapriv_order0 = NULL, *mccadapriv_order1 = NULL; + _adapter *iface = NULL, *iface_order0 = NULL, *iface_order1 = NULL; + u8 duration = 0, i = 0, duration_time; + u8 mcc_interval = 150; + + iface_order0 = mccobjpriv->iface[0]; + iface_order1 = mccobjpriv->iface[1]; + mccadapriv_order0 = &iface_order0->mcc_adapterpriv; + mccadapriv_order1 = &iface_order1->mcc_adapterpriv; + + if (mccobjpriv->duration == 0) { + /* default */ + duration = 30;/*(%)*/ + RTW_INFO("%s: mccobjpriv->duration=0, use default value(%d)\n", + __FUNCTION__, duration); + } else { + duration = mccobjpriv->duration;/*(%)*/ + RTW_INFO("%s: mccobjpriv->duration=%d\n", + __FUNCTION__, duration); + } + + mccobjpriv->interval = mcc_interval; + mccobjpriv->mcc_stop_threshold = 2000 * 4 / 300 - 6; + /* convert % to ms, for primary adapter */ + duration_time = mccobjpriv->interval * duration / 100; + + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + + if (!iface) + continue; + + mccadapriv = &iface->mcc_adapterpriv; + if (mccadapriv->role == MCC_ROLE_MAX) + continue; + + if (is_primary_adapter(iface)) + mccadapriv->mcc_duration = duration_time; + else + mccadapriv->mcc_duration = mccobjpriv->interval - duration_time; + } + + RTW_INFO("[MCC]" FUNC_ADPT_FMT " order 0 duration=%d\n", FUNC_ADPT_ARG(iface_order0), mccadapriv_order0->mcc_duration); + RTW_INFO("[MCC]" FUNC_ADPT_FMT " order 1 duration=%d\n", FUNC_ADPT_ARG(iface_order1), mccadapriv_order1->mcc_duration); +} + +static u8 rtw_hal_mcc_update_timing_parameters(PADAPTER padapter, u8 force_update) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + u8 need_update = _FALSE; + u8 starting_ap_num = DEV_AP_STARTING_NUM(dvobj); + u8 ap_num = DEV_AP_NUM(dvobj); + + + /* for STA+STA, modify policy table */ + if (starting_ap_num == 0 && ap_num == 0) { + 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; + u64 tsf[MAX_MCC_NUM] = {0}; + u64 tsf0 = 0, tsf1 = 0; + u32 beaconperiod_0 = 0, beaconperiod_1 = 0, tsfdiff = 0; + s8 upper_bound_0 = 0, lower_bound_0 = 0; + s8 upper_bound_1 = 0, lower_bound_1 = 0; + u8 valid = _FALSE; + u8 case_num = 1; + u8 i = 0; + + /* query TSF */ + rtw_hal_mcc_rqt_tsf(padapter, tsf); + + /* selecet policy table according TSF diff */ + tsf0 = tsf[0]; + beaconperiod_0 = pmccobjpriv->iface[0]->mlmepriv.cur_network.network.Configuration.BeaconPeriod; + tsf0 = rtw_modular64(tsf0, (beaconperiod_0 * TU)); + + tsf1 = tsf[1]; + beaconperiod_1 = pmccobjpriv->iface[1]->mlmepriv.cur_network.network.Configuration.BeaconPeriod; + tsf1 = rtw_modular64(tsf1, (beaconperiod_1 * TU)); + + if (tsf0 > tsf1) + tsfdiff = tsf0- tsf1; + else + tsfdiff = (tsf0 + beaconperiod_0 * TU) - tsf1; + + /* convert to ms */ + tsfdiff = (tsfdiff / TU); + + /* force update*/ + if (force_update) { + RTW_INFO("orig TSF0:%lld, orig TSF1:%lld\n", + pmccobjpriv->iface[0]->mcc_adapterpriv.tsf, pmccobjpriv->iface[1]->mcc_adapterpriv.tsf); + RTW_INFO("tsf0:%lld, tsf1:%lld\n", tsf0, tsf1); + RTW_INFO("%s: force=%d, last_tsfdiff=%d, tsfdiff=%d, THRESHOLD=%d\n", + __func__, force_update, pmccobjpriv->last_tsfdiff, tsfdiff, MCC_UPDATE_PARAMETER_THRESHOLD); + pmccobjpriv->last_tsfdiff = tsfdiff; + need_update = _TRUE; + } else { + if (pmccobjpriv->last_tsfdiff > tsfdiff) { + /* last tsfdiff - current tsfdiff > THRESHOLD, update parameters */ + if (pmccobjpriv->last_tsfdiff > (tsfdiff + MCC_UPDATE_PARAMETER_THRESHOLD)) { + RTW_INFO("orig TSF0:%lld, orig TSF1:%lld\n", + pmccobjpriv->iface[0]->mcc_adapterpriv.tsf, pmccobjpriv->iface[1]->mcc_adapterpriv.tsf); + RTW_INFO("tsf0:%lld, tsf1:%lld\n", tsf0, tsf1); + RTW_INFO("%s: force=%d, last_tsfdiff=%d, tsfdiff=%d, THRESHOLD=%d\n", + __func__, force_update, pmccobjpriv->last_tsfdiff, tsfdiff, MCC_UPDATE_PARAMETER_THRESHOLD); + + pmccobjpriv->last_tsfdiff = tsfdiff; + need_update = _TRUE; + } else { + need_update = _FALSE; + } + } else if (tsfdiff > pmccobjpriv->last_tsfdiff){ + /* current tsfdiff - last tsfdiff > THRESHOLD, update parameters */ + if (tsfdiff > (pmccobjpriv->last_tsfdiff + MCC_UPDATE_PARAMETER_THRESHOLD)) { + RTW_INFO("orig TSF0:%lld, orig TSF1:%lld\n", + pmccobjpriv->iface[0]->mcc_adapterpriv.tsf, pmccobjpriv->iface[1]->mcc_adapterpriv.tsf); + RTW_INFO("tsf0:%lld, tsf1:%lld\n", tsf0, tsf1); + RTW_INFO("%s: force=%d, last_tsfdiff=%d, tsfdiff=%d, THRESHOLD=%d\n", + __func__, force_update, pmccobjpriv->last_tsfdiff, tsfdiff, MCC_UPDATE_PARAMETER_THRESHOLD); + + pmccobjpriv->last_tsfdiff = tsfdiff; + need_update = _TRUE; + } else { + need_update = _FALSE; + } + } else { + need_update = _FALSE; + } + } + + if (need_update == _FALSE) + goto exit; + + rtw_hal_mcc_decide_duration(padapter); + + if (tsfdiff <= 50) { + + /* RX TBTT 0 */ + case_num = 1; + valid = rtw_hal_mcc_check_start_time_is_valid(padapter, case_num, tsfdiff, + &upper_bound_0, &lower_bound_0, &upper_bound_1, &lower_bound_1); + + if (valid) + goto valid_result; + + /* RX TBTT 1 */ + case_num = 2; + valid = rtw_hal_mcc_check_start_time_is_valid(padapter, case_num, tsfdiff, + &upper_bound_0, &lower_bound_0, &upper_bound_1, &lower_bound_1); + + if (valid) + goto valid_result; + + /* RX TBTT 2 */ + case_num = 3; + valid = rtw_hal_mcc_check_start_time_is_valid(padapter, case_num, tsfdiff, + &upper_bound_0, &lower_bound_0, &upper_bound_1, &lower_bound_1); + + if (valid) + goto valid_result; + + if (valid == _FALSE) { + RTW_INFO("[MCC] do not find fit start time\n"); + RTW_INFO("[MCC] tsfdiff:%d, duration:%d(%c), interval:%d\n", + tsfdiff, pmccobjpriv->duration, 37, pmccobjpriv->interval); + + } + + } else { + + /* RX TBTT 0 */ + case_num = 4; + valid = rtw_hal_mcc_check_start_time_is_valid(padapter, case_num, tsfdiff, + &upper_bound_0, &lower_bound_0, &upper_bound_1, &lower_bound_1); + + if (valid) + goto valid_result; + + + /* RX TBTT 1 */ + case_num = 5; + valid = rtw_hal_mcc_check_start_time_is_valid(padapter, case_num, tsfdiff, + &upper_bound_0, &lower_bound_0, &upper_bound_1, &lower_bound_1); + + if (valid) + goto valid_result; + + + /* RX TBTT 2 */ + case_num = 6; + valid = rtw_hal_mcc_check_start_time_is_valid(padapter, case_num, tsfdiff, + &upper_bound_0, &lower_bound_0, &upper_bound_1, &lower_bound_1); + + if (valid) + goto valid_result; + + if (valid == _FALSE) { + RTW_INFO("[MCC] do not find fit start time\n"); + RTW_INFO("[MCC] tsfdiff:%d, duration:%d(%c), interval:%d\n", + tsfdiff, pmccobjpriv->duration, 37, pmccobjpriv->interval); + } + } + + + + valid_result: + RTW_INFO("********************\n"); + RTW_INFO("%s: case_num:%d, start time:%d\n", + __func__, case_num, pmccobjpriv->start_time); + RTW_INFO("%s: upper_bound_0:%d, lower_bound_0:%d\n", + __func__, upper_bound_0, lower_bound_0); + RTW_INFO("%s: upper_bound_1:%d, lower_bound_1:%d\n", + __func__, upper_bound_1, lower_bound_1); + + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + if (iface == NULL) + continue; + + pmccadapriv = &iface->mcc_adapterpriv; + pmccadapriv = &iface->mcc_adapterpriv; + if (pmccadapriv->role == MCC_ROLE_MAX) + continue; +#if 0 + if (pmccadapriv->order == 0) { + pmccadapriv->mcc_duration = mcc_duration; + } else if (pmccadapriv->order == 1) { + pmccadapriv->mcc_duration = mcc_interval - mcc_duration; + } else { + RTW_INFO("[MCC] not support >= 3 interface\n"); + rtw_warn_on(1); + } +#endif + RTW_INFO("********************\n"); + RTW_INFO(FUNC_ADPT_FMT": order:%d, role:%d\n", + FUNC_ADPT_ARG(iface), pmccadapriv->order, pmccadapriv->role); + RTW_INFO(FUNC_ADPT_FMT": mcc duration:%d, target tx bytes:%d\n", + FUNC_ADPT_ARG(iface), pmccadapriv->mcc_duration, pmccadapriv->mcc_target_tx_bytes_to_port); + RTW_INFO(FUNC_ADPT_FMT": mgmt queue macid:%d, bitmap:0x%02x\n", + FUNC_ADPT_ARG(iface), pmccadapriv->mgmt_queue_macid, pmccadapriv->mcc_macid_bitmap); + RTW_INFO("********************\n"); + } + + } +exit: + return need_update; +} + static u8 rtw_hal_decide_mcc_role(PADAPTER padapter) { struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); @@ -453,6 +1139,7 @@ static u8 rtw_hal_decide_mcc_role(PADAPTER padapter) struct wifidirect_info *pwdinfo = NULL; struct mlme_priv *pmlmepriv = NULL; u8 ret = _SUCCESS, i = 0; + u8 order = 1; for (i = 0; i < dvobj->iface_nums; i++) { iface = dvobj->padapters[i]; @@ -460,6 +1147,7 @@ static u8 rtw_hal_decide_mcc_role(PADAPTER padapter) continue; pmccadapriv = &iface->mcc_adapterpriv; + pwdinfo = &iface->wdinfo; if (MLME_IS_GO(iface)) pmccadapriv->role = MCC_ROLE_GO; @@ -467,32 +1155,36 @@ static u8 rtw_hal_decide_mcc_role(PADAPTER padapter) pmccadapriv->role = MCC_ROLE_AP; else if (MLME_IS_GC(iface)) pmccadapriv->role = MCC_ROLE_GC; - else if (MLME_IS_STA(iface)) - pmccadapriv->role = MCC_ROLE_STA; - else { - pwdinfo = &iface->wdinfo; - pmlmepriv = &iface->mlmepriv; - - RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(iface)); - RTW_INFO("Unknown:P2P state:%d, mlme state:0x%2x, mlmext info state:0x%02x\n", - pwdinfo->role, pmlmepriv->fw_state, iface->mlmeextpriv.mlmext_info.state); - rtw_warn_on(1); - ret = _FAIL; - goto exit; + else if (MLME_IS_STA(iface)) { + if (MLME_IS_LINKING(iface) || MLME_IS_ASOC(iface)) + pmccadapriv->role = MCC_ROLE_STA; + else { + /* bypass non-linked/non-linking interface */ + RTW_INFO(FUNC_ADPT_FMT" mlme state:0x%2x\n", + FUNC_ADPT_ARG(iface), MLME_STATE(iface)); + continue; + } + } else { + /* bypass non-linked/non-linking interface */ + RTW_INFO(FUNC_ADPT_FMT" P2P Role:%d, mlme state:0x%2x\n", + FUNC_ADPT_ARG(iface), pwdinfo->role, MLME_STATE(iface)); + continue; } - if (ret == _SUCCESS) - rtw_hal_config_mcc_role_setting(iface); + if (padapter == iface) { + /* current adapter is order 0 */ + rtw_hal_config_mcc_role_setting(iface, 0); + } else { + rtw_hal_config_mcc_role_setting(iface, order); + order ++; + } } + rtw_hal_mcc_update_timing_parameters(padapter, _TRUE); exit: return ret; } -static void rtw_hal_init_mcc_parameter(PADAPTER padapter) -{ -} - static void rtw_hal_construct_CTS(PADAPTER padapter, u8 *pframe, u32 *pLength) { u8 broadcast_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; @@ -514,9 +1206,63 @@ static void rtw_hal_construct_CTS(PADAPTER padapter, u8 *pframe, u32 *pLength) *pLength = 22; } +/* avoid wrong information for power limit */ +void rtw_hal_mcc_upadate_chnl_bw(_adapter *padapter, u8 ch, u8 ch_offset, u8 bw, u8 print) +{ + + u8 center_ch, chnl_offset80 = HAL_PRIME_CHNL_OFFSET_DONT_CARE; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + PHAL_DATA_TYPE hal = GET_HAL_DATA(padapter); + u8 cch_160, cch_80, cch_40, cch_20; + + center_ch = rtw_get_center_ch(ch, bw, ch_offset); + + if (bw == CHANNEL_WIDTH_80) { + if (center_ch > ch) + chnl_offset80 = HAL_PRIME_CHNL_OFFSET_LOWER; + else if (center_ch < ch) + chnl_offset80 = HAL_PRIME_CHNL_OFFSET_UPPER; + else + chnl_offset80 = HAL_PRIME_CHNL_OFFSET_DONT_CARE; + } + + /* set Channel */ + /* saved channel/bw info */ + rtw_set_oper_ch(padapter, ch); + rtw_set_oper_bw(padapter, bw); + rtw_set_oper_choffset(padapter, ch_offset); + + cch_80 = bw == CHANNEL_WIDTH_80 ? center_ch : 0; + cch_40 = bw == CHANNEL_WIDTH_40 ? center_ch : 0; + cch_20 = bw == CHANNEL_WIDTH_20 ? center_ch : 0; + + if (cch_80 != 0) + cch_40 = rtw_get_scch_by_cch_offset(cch_80, CHANNEL_WIDTH_80, chnl_offset80); + if (cch_40 != 0) + cch_20 = rtw_get_scch_by_cch_offset(cch_40, CHANNEL_WIDTH_40, ch_offset); + + + hal->cch_80 = cch_80; + hal->cch_40 = cch_40; + hal->cch_20 = cch_20; + hal->current_channel = center_ch; + hal->CurrentCenterFrequencyIndex1 = center_ch; + hal->current_channel_bw = bw; + hal->nCur40MhzPrimeSC = ch_offset; + hal->nCur80MhzPrimeSC = chnl_offset80; + hal->current_band_type = ch > 14 ? BAND_ON_5G:BAND_ON_2_4G; + + if (print) { + RTW_INFO(FUNC_ADPT_FMT" cch:%u, %s, offset40:%u, offset80:%u (%u, %u, %u), band:%s\n" + , FUNC_ADPT_ARG(padapter), center_ch, ch_width_str(bw) + , ch_offset, chnl_offset80 + , hal->cch_80, hal->cch_40, hal->cch_20 + , band_str(hal->current_band_type)); + } +} + 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 *total_page_num, RSVDPAGE_LOC *rsvd_page_loc, u8 *page_num) { u32 len = 0; _adapter *iface = NULL; @@ -524,8 +1270,21 @@ u8 rtw_hal_dl_mcc_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 *index, struct mcc_obj_priv *pmccobjpriv = &(dvobj->mcc_objpriv); struct mlme_ext_info *pmlmeinfo = NULL; struct mlme_ext_priv *pmlmeext = NULL; - u8 ret = _SUCCESS, i = 0, order = 0, CurtPktPageNum = 0; - u8 bssid[ETH_ALEN] = {0}; + struct hal_com_data *hal = GET_HAL_DATA(adapter); + struct mcc_adapter_priv *mccadapriv = NULL; + u8 ret = _SUCCESS, i = 0, j =0, order = 0, CurtPktPageNum = 0; + u8 *start = NULL; + u8 path = RF_PATH_A; + + if (page_num) { +#ifdef CONFIG_MCC_MODE_V2 + if (!hal->RegIQKFWOffload) + RTW_WARN("[MCC] must enable FW IQK for New IC\n"); +#endif /* CONFIG_MCC_MODE_V2 */ + *total_page_num += (2 * MAX_MCC_NUM+ 1); + RTW_INFO("[MCC] allocate mcc rsvd page num = %d\n", *total_page_num); + goto exit; + } /* check proccess mcc start setting */ if (!rtw_hal_check_mcc_status(adapter, MCC_STATUS_PROCESS_MCC_START_SETTING)) { @@ -538,34 +1297,35 @@ u8 rtw_hal_dl_mcc_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 *index, if (iface == NULL) continue; - order = iface->mcc_adapterpriv.order; - dvobj->mcc_objpriv.mcc_loc_rsvd_paga[order] = *page_num; + mccadapriv = &iface->mcc_adapterpriv; + if (mccadapriv->role == MCC_ROLE_MAX) + continue; - switch (iface->mcc_adapterpriv.role) { + order = mccadapriv->order; + pmccobjpriv->mcc_loc_rsvd_paga[order] = *total_page_num; + + switch (mccadapriv->role) { case MCC_ROLE_STA: case MCC_ROLE_GC: /* Build NULL DATA */ RTW_INFO("LocNull(order:%d): %d\n" - , order, dvobj->mcc_objpriv.mcc_loc_rsvd_paga[order]); + , order, pmccobjpriv->mcc_loc_rsvd_paga[order]); len = 0; - pmlmeext = &iface->mlmeextpriv; - pmlmeinfo = &pmlmeext->mlmext_info; - _rtw_memcpy(bssid, get_my_bssid(&pmlmeinfo->network), ETH_ALEN); rtw_hal_construct_NullFunctionData(iface - , &pframe[*index], &len, bssid, _FALSE, 0, 0, _FALSE); + , &pframe[*index], &len, _FALSE, 0, 0, _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; + *total_page_num += CurtPktPageNum; *index += (CurtPktPageNum * page_size); - *total_pkt_len = *index + len; + RSVD_PAGE_CFG("LocNull", CurtPktPageNum, *total_page_num, *index); break; case MCC_ROLE_AP: /* Bulid CTS */ RTW_INFO("LocCTS(order:%d): %d\n" - , order, dvobj->mcc_objpriv.mcc_loc_rsvd_paga[order]); + , order, pmccobjpriv->mcc_loc_rsvd_paga[order]); len = 0; rtw_hal_construct_CTS(iface, &pframe[*index], &len); @@ -573,15 +1333,311 @@ u8 rtw_hal_dl_mcc_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 *index, len, _FALSE, _FALSE, _FALSE); CurtPktPageNum = (u8)PageNum(tx_desc + len, page_size); - *page_num += CurtPktPageNum; + *total_page_num += CurtPktPageNum; *index += (CurtPktPageNum * page_size); - *total_pkt_len = *index + len; + RSVD_PAGE_CFG("LocCTS", CurtPktPageNum, *total_page_num, *index); break; case MCC_ROLE_GO: /* To DO */ break; + default: + RTW_INFO(FUNC_ADPT_FMT": unknown role = %d\n" + , FUNC_ADPT_ARG(iface), mccadapriv->role); + break; } } + + for (i = 0; i < MAX_MCC_NUM; i++) { + u8 center_ch = 0, ch = 0, bw = 0, bw_offset = 0; + u8 power_index = 0; + u8 rate_array_sz = 0; + u8 *rates = NULL; + u8 rate = 0; + u8 shift = 0; + u32 power_index_4bytes = 0; + u8 total_rate = 0; + u8 *total_rate_offset = NULL; + + iface = pmccobjpriv->iface[i]; + pmlmeext = &iface->mlmeextpriv; + ch = pmlmeext->cur_channel; + bw = pmlmeext->cur_bwmode; + bw_offset = pmlmeext->cur_ch_offset; + center_ch = rtw_get_center_ch(ch, bw, bw_offset); + rtw_hal_mcc_upadate_chnl_bw(iface, ch, bw_offset, bw, _TRUE); + + start = &pframe[*index - tx_desc]; + _rtw_memset(start, 0, page_size); + pmccobjpriv->mcc_pwr_idx_rsvd_page[i] = *total_page_num; + RTW_INFO(ADPT_FMT" order:%d, pwr_idx_rsvd_page location[%d]: %d\n", + ADPT_ARG(iface), mccadapriv->order, + i, pmccobjpriv->mcc_pwr_idx_rsvd_page[i]); + + total_rate_offset = start; + + for (path = RF_PATH_A; path < hal->NumTotalRFPath; ++path) { + total_rate = 0; + /* PATH A for 0~63 byte, PATH B for 64~127 byte*/ + if (path == RF_PATH_A) + start = total_rate_offset + 1; + else if (path == RF_PATH_B) + start = total_rate_offset + 64; + else { + RTW_INFO("[MCC] %s: unknow RF PATH(%d)\n", __func__, path); + break; + } + + /* CCK */ + if (ch <= 14) { + rate_array_sz = rates_by_sections[CCK].rate_num; + rates = rates_by_sections[CCK].rates; + for (j = 0; j < rate_array_sz; ++j) { + power_index = rtw_hal_get_tx_power_index(iface, path, rates[j], bw, center_ch, NULL); + rate = PHY_GetRateIndexOfTxPowerByRate(rates[j]); + + shift = rate % 4; + if (shift == 0) { + *start = rate; + start++; + total_rate++; + + #ifdef DBG_PWR_IDX_RSVD_PAGE + RTW_INFO("TXPWR("ADPT_FMT"): [%c][%s]ch:%u, %s, pwr_idx:%u\n", + ADPT_ARG(iface), rf_path_char(path), ch_width_str(bw), + center_ch, MGN_RATE_STR(rates[j]), power_index); + #endif + } + + *start = power_index; + start++; + + #ifdef DBG_PWR_IDX_RSVD_PAGE + RTW_INFO("TXPWR("ADPT_FMT"): [%c][%s]ch:%u, %s, pwr_idx:%u\n", + ADPT_ARG(iface), rf_path_char(path), ch_width_str(bw), + center_ch, MGN_RATE_STR(rates[j]), power_index); + + + shift = rate % 4; + power_index_4bytes |= ((power_index & 0xff) << (shift * 8)); + if (shift == 3) { + rate = rate - 3; + RTW_INFO("(index:0x%02x, rfpath:%d, rate:0x%02x)\n", index, path, rate); + power_index_4bytes = 0; + total_rate++; + } + #endif + + } + } + + /* OFDM */ + rate_array_sz = rates_by_sections[OFDM].rate_num; + rates = rates_by_sections[OFDM].rates; + for (j = 0; j < rate_array_sz; ++j) { + power_index = rtw_hal_get_tx_power_index(iface, path, rates[j], bw, center_ch, NULL); + rate = PHY_GetRateIndexOfTxPowerByRate(rates[j]); + + shift = rate % 4; + if (shift == 0) { + *start = rate; + start++; + total_rate++; + + #ifdef DBG_PWR_IDX_RSVD_PAGE + RTW_INFO("TXPWR("ADPT_FMT"): [%c][%s]ch:%u, %s, pwr_idx:%u\n", + ADPT_ARG(iface), rf_path_char(path), ch_width_str(bw), + center_ch, MGN_RATE_STR(rates[j]), power_index); + #endif + + } + + *start = power_index; + start++; + + #ifdef DBG_PWR_IDX_RSVD_PAGE + RTW_INFO("TXPWR("ADPT_FMT"): [%c][%s]ch:%u, %s, pwr_idx:%u\n", + ADPT_ARG(iface), rf_path_char(path), ch_width_str(bw), + center_ch, MGN_RATE_STR(rates[j]), power_index); + + shift = rate % 4; + power_index_4bytes |= ((power_index & 0xff) << (shift * 8)); + if (shift == 3) { + rate = rate - 3; + RTW_INFO("(index:0x%02x, rfpath:%d, rate:0x%02x)\n", index, path, rate); + power_index_4bytes = 0; + total_rate++; + } + #endif + } + + /* HT_MCS0_MCS7 */ + rate_array_sz = rates_by_sections[HT_MCS0_MCS7].rate_num; + rates = rates_by_sections[HT_MCS0_MCS7].rates; + for (j = 0; j < rate_array_sz; ++j) { + power_index = rtw_hal_get_tx_power_index(iface, path, rates[j], bw, center_ch, NULL); + rate = PHY_GetRateIndexOfTxPowerByRate(rates[j]); + + shift = rate % 4; + if (shift == 0) { + *start = rate; + start++; + total_rate++; + + #ifdef DBG_PWR_IDX_RSVD_PAGE + RTW_INFO("TXPWR("ADPT_FMT"): [%c][%s]ch:%u, %s, pwr_idx:%u\n", + ADPT_ARG(iface), rf_path_char(path), ch_width_str(bw), + center_ch, MGN_RATE_STR(rates[j]), power_index); + #endif + + } + + *start = power_index; + start++; + + #ifdef DBG_PWR_IDX_RSVD_PAGE + RTW_INFO("TXPWR("ADPT_FMT"): [%c][%s]ch:%u, %s, pwr_idx:%u\n", + ADPT_ARG(iface), rf_path_char(path), ch_width_str(bw), + center_ch, MGN_RATE_STR(rates[j]), power_index); + + shift = rate % 4; + power_index_4bytes |= ((power_index & 0xff) << (shift * 8)); + if (shift == 3) { + rate = rate - 3; + RTW_INFO("(index:0x%02x, rfpath:%d, rate:0x%02x)\n", index, path, rate); + power_index_4bytes = 0; + total_rate++; + } + #endif + } + + /* HT_MCS8_MCS15 */ + rate_array_sz = rates_by_sections[HT_MCS8_MCS15].rate_num; + rates = rates_by_sections[HT_MCS8_MCS15].rates; + for (j = 0; j < rate_array_sz; ++j) { + power_index = rtw_hal_get_tx_power_index(iface, path, rates[j], bw, center_ch, NULL); + rate = PHY_GetRateIndexOfTxPowerByRate(rates[j]); + + shift = rate % 4; + if (shift == 0) { + *start = rate; + start++; + total_rate++; + + #ifdef DBG_PWR_IDX_RSVD_PAGE + RTW_INFO("TXPWR("ADPT_FMT"): [%c][%s]ch:%u, %s, pwr_idx:%u\n", + ADPT_ARG(iface), rf_path_char(path), ch_width_str(bw), + center_ch, MGN_RATE_STR(rates[j]), power_index); + #endif + } + + *start = power_index; + start++; + + #ifdef DBG_PWR_IDX_RSVD_PAGE + RTW_INFO("TXPWR("ADPT_FMT"): [%c][%s]ch:%u, %s, pwr_idx:%u\n", + ADPT_ARG(iface), rf_path_char(path), ch_width_str(bw), + center_ch, MGN_RATE_STR(rates[j]), power_index); + + shift = rate % 4; + power_index_4bytes |= ((power_index & 0xff) << (shift * 8)); + if (shift == 3) { + rate = rate - 3; + RTW_INFO("(index:0x%02x, rfpath:%d, rate:0x%02x)\n", index, path, rate); + power_index_4bytes = 0; + total_rate++; + } + #endif + } + + /* VHT_1SSMCS0_1SSMCS9 */ + rate_array_sz = rates_by_sections[VHT_1SSMCS0_1SSMCS9].rate_num; + rates = rates_by_sections[VHT_1SSMCS0_1SSMCS9].rates; + for (j = 0; j < rate_array_sz; ++j) { + power_index = rtw_hal_get_tx_power_index(iface, path, rates[j], bw, center_ch, NULL); + rate = PHY_GetRateIndexOfTxPowerByRate(rates[j]); + + shift = rate % 4; + if (shift == 0) { + *start = rate; + start++; + total_rate++; + #ifdef DBG_PWR_IDX_RSVD_PAGE + RTW_INFO("TXPWR("ADPT_FMT"): [%c][%s]ch:%u, %s, pwr_idx:0x%02x\n", + ADPT_ARG(iface), rf_path_char(path), ch_width_str(bw), + center_ch, MGN_RATE_STR(rates[j]), power_index); + #endif + } + *start = power_index; + start++; + #ifdef DBG_PWR_IDX_RSVD_PAGE + RTW_INFO("TXPWR("ADPT_FMT"): [%c][%s]ch:%u, %s, pwr_idx:%u\n", + ADPT_ARG(iface), rf_path_char(path), ch_width_str(bw), + center_ch, MGN_RATE_STR(rates[j]), power_index); + + shift = rate % 4; + power_index_4bytes |= ((power_index & 0xff) << (shift * 8)); + if (shift == 3) { + rate = rate - 3; + RTW_INFO("(index:0x%02x, rfpath:%d, rate:0x%02x)\n", index, path, rate); + power_index_4bytes = 0; + total_rate++; + } + #endif + } + + /* VHT_2SSMCS0_2SSMCS9 */ + rate_array_sz = rates_by_sections[VHT_2SSMCS0_2SSMCS9].rate_num; + rates = rates_by_sections[VHT_2SSMCS0_2SSMCS9].rates; + for (j = 0; j < rate_array_sz; ++j) { + power_index = rtw_hal_get_tx_power_index(iface, path, rates[j], bw, center_ch, NULL); + rate = PHY_GetRateIndexOfTxPowerByRate(rates[j]); + + shift = rate % 4; + if (shift == 0) { + *start = rate; + start++; + total_rate++; + #ifdef DBG_PWR_IDX_RSVD_PAGE + RTW_INFO("TXPWR("ADPT_FMT"): [%c][%s]ch:%u, %s, pwr_idx:%u\n", + ADPT_ARG(iface), rf_path_char(path), ch_width_str(bw), + center_ch, MGN_RATE_STR(rates[j]), power_index); + #endif + } + *start = power_index; + start++; + #ifdef DBG_PWR_IDX_RSVD_PAGE + RTW_INFO("TXPWR("ADPT_FMT"): [%c][%s]ch:%u, %s, pwr_idx:%u\n", + ADPT_ARG(iface), rf_path_char(path), ch_width_str(bw), + center_ch, MGN_RATE_STR(rates[j]), power_index); + + shift = rate % 4; + power_index_4bytes |= ((power_index & 0xff) << (shift * 8)); + if (shift == 3) { + rate = rate - 3; + RTW_INFO("(index:0x%02x, rfpath:%d, rate:0x%02x)\n", index, path, rate); + power_index_4bytes = 0; + total_rate++; + } + #endif + } + + } + /* total rate store in offset 0 */ + *total_rate_offset = total_rate; + +#ifdef DBG_PWR_IDX_RSVD_PAGE + RTW_INFO("total_rate=%d\n", total_rate); + RTW_INFO(" ======================="ADPT_FMT"===========================\n", ADPT_ARG(iface)); + RTW_INFO_DUMP("\n", total_rate_offset, 128); + RTW_INFO(" ==================================================\n"); +#endif + + CurtPktPageNum = 1; + *total_page_num += CurtPktPageNum; + *index += (CurtPktPageNum * page_size); + RSVD_PAGE_CFG("mcc_pwr_idx_rsvd_page", CurtPktPageNum, *total_page_num, *index); + } + exit: return ret; } @@ -605,12 +1661,17 @@ static void rtw_hal_set_fw_mcc_rsvd_page(PADAPTER padapter) rtw_hal_set_hwreg(port0_iface, HW_VAR_H2C_FW_JOINBSSRPT, (u8 *)(&mstatus)); /* Re-Download beacon */ - for (i = 0; i < dvobj->iface_nums; i++) { + for (i = 0; i < MAX_MCC_NUM; i++) { iface = pmccobjpriv->iface[i]; + if (iface == NULL) + continue; + 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); + } } } @@ -618,23 +1679,17 @@ static void rtw_hal_set_mcc_rsvdpage_cmd(_adapter *padapter) { u8 cmd[H2C_MCC_LOCATION_LEN] = {0}, i = 0, order = 0; _adapter *iface = NULL; + PHAL_DATA_TYPE hal = GET_HAL_DATA(padapter); struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); struct mcc_obj_priv *pmccobjpriv = &(dvobj->mcc_objpriv); + SET_H2CCMD_MCC_PWRIDX_OFFLOAD_EN(cmd, _TRUE); + SET_H2CCMD_MCC_PWRIDX_OFFLOAD_RFNUM(cmd, hal->NumTotalRFPath); + for (order = 0; order < MAX_MCC_NUM; order++) { + iface = pmccobjpriv->iface[i]; - for (i = 0; i < dvobj->iface_nums; i++) { - iface = dvobj->padapters[i]; - if (iface == NULL) - continue; - - 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); - continue; - } - - SET_H2CCMD_MCC_RSVDPAGE_LOC((cmd + order), (pmccobjpriv->mcc_loc_rsvd_paga[order])); + SET_H2CCMD_MCC_RSVDPAGE_LOC((cmd + order), pmccobjpriv->mcc_loc_rsvd_paga[order]); + SET_H2CCMD_MCC_PWRIDX_RSVDPAGE_LOC ((cmd + order), pmccobjpriv->mcc_pwr_idx_rsvd_page[order]); } #ifdef CONFIG_MCC_MODE_DEBUG @@ -649,44 +1704,78 @@ static void rtw_hal_set_mcc_rsvdpage_cmd(_adapter *padapter) rtw_hal_fill_h2c_cmd(padapter, H2C_MCC_LOCATION, H2C_MCC_LOCATION_LEN, cmd); } -static void rtw_hal_set_mcc_noa_cmd(PADAPTER padapter) +static void rtw_hal_set_mcc_time_setting_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 = 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]; + struct mcc_obj_priv *mccobjpriv = &(dvobj->mcc_objpriv); + u8 cmd[H2C_MCC_TIME_SETTING_LEN] = {0}; + u8 fw_eable = 1; u8 swchannel_early_time = MCC_SWCH_FW_EARLY_TIME; - u8 i = 0; + u8 starting_ap_num = DEV_AP_STARTING_NUM(dvobj); + u8 ap_num = DEV_AP_NUM(dvobj); - /* FW set NOA enable */ - SET_H2CCMD_MCC_NOA_FW_EN(cmd, noa_fw_eable); - /* 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_offset + guard_offset0)); - /* NoA interval */ - SET_H2CCMD_MCC_NOA_INTERVAL(cmd, noa_interval); - /* Early time to inform driver by C2H before switch channel */ - SET_H2CCMD_MCC_EARLY_TIME(cmd, swchannel_early_time); + if (starting_ap_num == 0 && ap_num == 0) + /* For STA+GC/STA+STA, TSF of GC/STA does not need to sync from TSF of other STA/GC */ + fw_eable = 0; + else + /* Only for STA+GO/STA+AP, TSF of AP/GO need to sync from TSF of STA */ + fw_eable = 1; + + if (fw_eable == 1) { + PADAPTER order0_iface = NULL; + PADAPTER order1_iface = NULL; + u8 policy_idx = mccobjpriv->policy_index; + u8 tsf_sync_offset = mcc_switch_channel_policy_table[policy_idx][MCC_TSF_SYNC_OFFSET_IDX]; + u8 start_time_offset = mcc_switch_channel_policy_table[policy_idx][MCC_START_TIME_OFFSET_IDX]; + u8 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]; + enum _hw_port tsf_bsae_port = MAX_HW_PORT; + enum _hw_port tsf_sync_port = MAX_HW_PORT; + order0_iface = mccobjpriv->iface[0]; + order1_iface = mccobjpriv->iface[1]; + + tsf_bsae_port = rtw_hal_get_port(order1_iface); + tsf_sync_port = rtw_hal_get_port(order0_iface); + + /* FW set enable */ + SET_H2CCMD_MCC_TIME_SETTING_FW_EN(cmd, fw_eable); + /* TSF Sync offset */ + SET_H2CCMD_MCC_TIME_SETTING_TSF_SYNC_OFFSET(cmd, tsf_sync_offset); + /* start time offset */ + SET_H2CCMD_MCC_TIME_SETTING_START_TIME(cmd, (start_time_offset + guard_offset0)); + /* interval */ + SET_H2CCMD_MCC_TIME_SETTING_INTERVAL(cmd, interval); + /* Early time to inform driver by C2H before switch channel */ + SET_H2CCMD_MCC_TIME_SETTING_EARLY_SWITCH_RPT(cmd, swchannel_early_time); + /* Port0 sync from Port1, not support multi-port */ + SET_H2CCMD_MCC_TIME_SETTING_ORDER_BASE(cmd, tsf_bsae_port); + SET_H2CCMD_MCC_TIME_SETTING_ORDER_SYNC(cmd, tsf_sync_port); + } else { + /* start time offset */ + SET_H2CCMD_MCC_TIME_SETTING_START_TIME(cmd, mccobjpriv->start_time); + /* interval */ + SET_H2CCMD_MCC_TIME_SETTING_INTERVAL(cmd, mccobjpriv->interval); + /* Early time to inform driver by C2H before switch channel */ + SET_H2CCMD_MCC_TIME_SETTING_EARLY_SWITCH_RPT(cmd, swchannel_early_time); + } #ifdef CONFIG_MCC_MODE_DEBUG - RTW_INFO("=========================\n"); - RTW_INFO("NoA:\n"); - for (i = 0; i < H2C_MCC_NOA_PARAM_LEN; i++) - pr_dbg("0x%x ", cmd[i]); - pr_dbg("\n"); - RTW_INFO("=========================\n"); + { + u8 i = 0; + + RTW_INFO("=========================\n"); + RTW_INFO("NoA:\n"); + for (i = 0; i < H2C_MCC_TIME_SETTING_LEN; i++) + pr_dbg("0x%x ", cmd[i]); + pr_dbg("\n"); + RTW_INFO("=========================\n"); + } #endif /* CONFIG_MCC_MODE_DEBUG */ - rtw_hal_fill_h2c_cmd(padapter, H2C_MCC_NOA_PARAM, H2C_MCC_NOA_PARAM_LEN, cmd); + rtw_hal_fill_h2c_cmd(padapter, H2C_MCC_TIME_SETTING, H2C_MCC_TIME_SETTING_LEN, cmd); } static void rtw_hal_set_mcc_IQK_offload_cmd(PADAPTER padapter) @@ -701,7 +1790,7 @@ static void rtw_hal_set_mcc_IQK_offload_cmd(PADAPTER padapter) 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++) { + for (i = 0; i < MAX_MCC_NUM; i++) { iface = pmccobjpriv->iface[i]; if (iface == NULL) continue; @@ -783,6 +1872,9 @@ static void rtw_hal_set_mcc_macid_cmd(PADAPTER padapter) continue; pmccadapriv = &iface->mcc_adapterpriv; + if (pmccadapriv->role == MCC_ROLE_MAX) + continue; + order = pmccadapriv->order; bitmap = pmccadapriv->mcc_macid_bitmap; @@ -799,28 +1891,79 @@ static void rtw_hal_set_mcc_macid_cmd(PADAPTER padapter) RTW_INFO("=========================\n"); RTW_INFO("MACID BITMAP: "); for (i = 0; i < H2C_MCC_MACID_BITMAP_LEN; i++) - pr_dbg("0x%x ", cmd[i]); - pr_dbg("\n"); + printk("0x%x ", cmd[i]); + printk("\n"); RTW_INFO("=========================\n"); #endif /* CONFIG_MCC_MODE_DEBUG */ rtw_hal_fill_h2c_cmd(padapter, H2C_MCC_MACID_BITMAP, H2C_MCC_MACID_BITMAP_LEN, cmd); } -static void rtw_hal_set_mcc_ctrl_cmd(PADAPTER padapter, u8 stop) +#ifdef CONFIG_MCC_MODE_V2 +static u8 get_pri_ch_idx_by_adapter(u8 center_ch, u8 channel, u8 bw, u8 ch_offset40) +{ + u8 pri_ch_idx = 0, chnl_offset80 = 0; + + if (bw == CHANNEL_WIDTH_80) { + if (center_ch > channel) + chnl_offset80 = HAL_PRIME_CHNL_OFFSET_LOWER; + else if (center_ch < channel) + chnl_offset80 = HAL_PRIME_CHNL_OFFSET_UPPER; + else + chnl_offset80 = HAL_PRIME_CHNL_OFFSET_DONT_CARE; + } + + if (bw == CHANNEL_WIDTH_80) { + /* primary channel is at lower subband of 80MHz & 40MHz */ + if ((ch_offset40 == HAL_PRIME_CHNL_OFFSET_LOWER) && (chnl_offset80 == HAL_PRIME_CHNL_OFFSET_LOWER)) + pri_ch_idx = VHT_DATA_SC_20_LOWEST_OF_80MHZ; + /* primary channel is at lower subband of 80MHz & upper subband of 40MHz */ + else if ((ch_offset40 == HAL_PRIME_CHNL_OFFSET_UPPER) && (chnl_offset80 == HAL_PRIME_CHNL_OFFSET_LOWER)) + pri_ch_idx = VHT_DATA_SC_20_LOWER_OF_80MHZ; + /* primary channel is at upper subband of 80MHz & lower subband of 40MHz */ + else if ((ch_offset40 == HAL_PRIME_CHNL_OFFSET_LOWER) && (chnl_offset80 == HAL_PRIME_CHNL_OFFSET_UPPER)) + pri_ch_idx = VHT_DATA_SC_20_UPPER_OF_80MHZ; + /* primary channel is at upper subband of 80MHz & upper subband of 40MHz */ + else if ((ch_offset40 == HAL_PRIME_CHNL_OFFSET_UPPER) && (chnl_offset80 == HAL_PRIME_CHNL_OFFSET_UPPER)) + pri_ch_idx = VHT_DATA_SC_20_UPPERST_OF_80MHZ; + else { + if (chnl_offset80 == HAL_PRIME_CHNL_OFFSET_LOWER) + pri_ch_idx = VHT_DATA_SC_40_LOWER_OF_80MHZ; + else if (chnl_offset80 == HAL_PRIME_CHNL_OFFSET_UPPER) + pri_ch_idx = VHT_DATA_SC_40_UPPER_OF_80MHZ; + else + RTW_INFO("SCMapping: DONOT CARE Mode Setting\n"); + } + } else if (bw == CHANNEL_WIDTH_40) { + /* primary channel is at upper subband of 40MHz */ + if (ch_offset40== HAL_PRIME_CHNL_OFFSET_UPPER) + pri_ch_idx = VHT_DATA_SC_20_UPPER_OF_80MHZ; + /* primary channel is at lower subband of 40MHz */ + else if (ch_offset40 == HAL_PRIME_CHNL_OFFSET_LOWER) + pri_ch_idx = VHT_DATA_SC_20_LOWER_OF_80MHZ; + else + RTW_INFO("SCMapping: DONOT CARE Mode Setting\n"); + } + + return pri_ch_idx; +} + +static void rtw_hal_set_mcc_ctrl_cmd_v2(PADAPTER padapter, u8 stop) { 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; + u8 order = 0, totalnum = 0; + u8 center_ch = 0, pri_ch_idx = 0, bw = 0; + u8 duration = 0, role = 0, incurch = 0, rfetype = 0, distxnull = 0, c2hrpt = 0; + u8 dis_sw_retry = 0, null_early_time=2, tsfx = 0, update_parm = 0; struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); struct mcc_obj_priv *pmccobjpriv = &(dvobj->mcc_objpriv); + struct mcc_adapter_priv *mccadapriv = NULL; struct mlme_ext_priv *pmlmeext = NULL; struct mlme_ext_info *pmlmeinfo = NULL; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); _adapter *iface = NULL; RTW_INFO(FUNC_ADPT_FMT": stop=%d\n", FUNC_ADPT_ARG(padapter), stop); - for (i = 0; i < dvobj->iface_nums; i++) { + for (i = 0; i < MAX_MCC_NUM; i++) { iface = pmccobjpriv->iface[i]; if (iface == NULL) continue; @@ -830,10 +1973,108 @@ static void rtw_hal_set_mcc_ctrl_cmd(PADAPTER padapter, u8 stop) continue; } + mccadapriv = &iface->mcc_adapterpriv; + order = mccadapriv->order; - order = iface->mcc_adapterpriv.order; if (!stop) - totalnum = dvobj->iface_nums; + totalnum = MAX_MCC_NUM; + else + totalnum = 0xff; /* 0xff means stop */ + + pmlmeext = &iface->mlmeextpriv; + center_ch = rtw_get_center_ch(pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset); + pri_ch_idx = get_pri_ch_idx_by_adapter(center_ch, pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset); + bw = pmlmeext->cur_bwmode; + duration = mccadapriv->mcc_duration; + role = mccadapriv->role; + + incurch = _FALSE; + dis_sw_retry = _TRUE; + + /* STA/GC TX NULL data to inform AP/GC for ps mode */ + switch (role) { + case MCC_ROLE_GO: + case MCC_ROLE_AP: + distxnull = MCC_DISABLE_TX_NULL; + break; + case MCC_ROLE_GC: + set_channel_bwmode(iface, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); + distxnull = MCC_ENABLE_TX_NULL; + break; + case MCC_ROLE_STA: + distxnull = MCC_ENABLE_TX_NULL; + break; + } + + null_early_time = mccadapriv->null_early; + + c2hrpt = MCC_C2H_REPORT_ALL_STATUS; + tsfx = rtw_hal_get_port(iface); + update_parm = 0; + + SET_H2CCMD_MCC_CTRL_V2_ORDER(cmd, order); + SET_H2CCMD_MCC_CTRL_V2_TOTALNUM(cmd, totalnum); + SET_H2CCMD_MCC_CTRL_V2_CENTRAL_CH(cmd, center_ch); + SET_H2CCMD_MCC_CTRL_V2_PRIMARY_CH(cmd, pri_ch_idx); + SET_H2CCMD_MCC_CTRL_V2_BW(cmd, bw); + SET_H2CCMD_MCC_CTRL_V2_DURATION(cmd, duration); + SET_H2CCMD_MCC_CTRL_V2_ROLE(cmd, role); + SET_H2CCMD_MCC_CTRL_V2_INCURCH(cmd, incurch); + SET_H2CCMD_MCC_CTRL_V2_DIS_SW_RETRY(cmd, dis_sw_retry); + SET_H2CCMD_MCC_CTRL_V2_DISTXNULL(cmd, distxnull); + SET_H2CCMD_MCC_CTRL_V2_C2HRPT(cmd, c2hrpt); + SET_H2CCMD_MCC_CTRL_V2_TSFX(cmd, tsfx); + SET_H2CCMD_MCC_CTRL_V2_NULL_EARLY(cmd, null_early_time); + SET_H2CCMD_MCC_CTRL_V2_UPDATE_PARM(cmd, update_parm); + +#ifdef CONFIG_MCC_MODE_DEBUG + RTW_INFO("=========================\n"); + RTW_INFO(FUNC_ADPT_FMT" MCC INFO:\n", FUNC_ADPT_ARG(iface)); + 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_CTRL_V2, H2C_MCC_CTRL_LEN, cmd); + } +} + +#else +static void rtw_hal_set_mcc_ctrl_cmd_v1(PADAPTER padapter, u8 stop) +{ + 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); + struct mcc_obj_priv *pmccobjpriv = &(dvobj->mcc_objpriv); + struct mcc_adapter_priv *mccadapriv = NULL; + struct mlme_ext_priv *pmlmeext = NULL; + struct mlme_ext_info *pmlmeinfo = NULL; + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); + _adapter *iface = NULL; + + RTW_INFO(FUNC_ADPT_FMT": stop=%d\n", FUNC_ADPT_ARG(padapter), stop); + + for (i = 0; i < MAX_MCC_NUM; i++) { + iface = pmccobjpriv->iface[i]; + if (iface == NULL) + continue; + + if (stop) { + if (iface != padapter) + continue; + } + + mccadapriv = &iface->mcc_adapterpriv; + order = mccadapriv->order; + + if (!stop) + totalnum = MAX_MCC_NUM; else totalnum = 0xff; /* 0xff means stop */ @@ -855,8 +2096,8 @@ static void rtw_hal_set_mcc_ctrl_cmd(PADAPTER padapter, u8 stop) } else bw80sc = HAL_PRIME_CHNL_OFFSET_DONT_CARE; - duration = iface->mcc_adapterpriv.mcc_duration; - role = iface->mcc_adapterpriv.role; + duration = mccadapriv->mcc_duration; + role = mccadapriv->role; incurch = _FALSE; @@ -910,10 +2151,72 @@ static void rtw_hal_set_mcc_ctrl_cmd(PADAPTER padapter, u8 stop) rtw_hal_fill_h2c_cmd(padapter, H2C_MCC_CTRL, H2C_MCC_CTRL_LEN, cmd); } } +#endif + +static void rtw_hal_set_mcc_ctrl_cmd(PADAPTER padapter, u8 stop) +{ + #ifdef CONFIG_MCC_MODE_V2 + /* new cmd 0x17 */ + rtw_hal_set_mcc_ctrl_cmd_v2(padapter, stop); + #else + /* old cmd 0x18 */ + rtw_hal_set_mcc_ctrl_cmd_v1(padapter, stop); + #endif +} + +static u8 check_mcc_support(PADAPTER adapter) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + u8 sta_linked_num = DEV_STA_LD_NUM(dvobj); + u8 starting_ap_num = DEV_AP_STARTING_NUM(dvobj); + u8 ap_num = DEV_AP_NUM(dvobj); + u8 ret = _FAIL; + + RTW_INFO("[MCC] sta_linked_num=%d, starting_ap_num=%d,ap_num=%d\n", + sta_linked_num, starting_ap_num, ap_num); + + /* case for sta + sta case */ + if (sta_linked_num == MAX_MCC_NUM) { + ret = _SUCCESS; + goto exit; + } + + /* case for starting AP + linked sta */ + if ((starting_ap_num + sta_linked_num) == MAX_MCC_NUM) { + ret = _SUCCESS; + goto exit; + } + + /* case for started AP + linked sta */ + if ((ap_num + sta_linked_num) == MAX_MCC_NUM) { + ret = _SUCCESS; + goto exit; + } + +exit: + return ret; +} + +static void rtw_hal_mcc_start_prehdl(PADAPTER padapter) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + _adapter *iface = NULL; + struct mcc_adapter_priv *mccadapriv = NULL; + u8 i = 1; + + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + if (iface == NULL) + continue; + + mccadapriv = &iface->mcc_adapterpriv; + mccadapriv->role = MCC_ROLE_MAX; + } +} static u8 rtw_hal_set_mcc_start_setting(PADAPTER padapter, u8 status) { - u8 ret = _SUCCESS; + u8 ret = _SUCCESS, enable_tsf_auto_sync = _FALSE; struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); @@ -923,12 +2226,13 @@ static u8 rtw_hal_set_mcc_start_setting(PADAPTER padapter, u8 status) LeaveAllPowerSaveModeDirect(padapter); } - if (dvobj->iface_nums > MAX_MCC_NUM) { - RTW_INFO("%s: current iface num(%d) > MAX_MCC_NUM(%d)\n", __func__, dvobj->iface_nums, MAX_MCC_NUM); + if (check_mcc_support(padapter) == _FAIL) { ret = _FAIL; goto exit; } + rtw_hal_mcc_start_prehdl(padapter); + /* configure mcc switch channel setting */ rtw_hal_config_mcc_switch_channel_setting(padapter); @@ -947,15 +2251,25 @@ static u8 rtw_hal_set_mcc_start_setting(PADAPTER padapter, u8 status) rtw_hal_set_mcc_rsvdpage_cmd(padapter); } - /* configure NoA setting */ - rtw_hal_set_mcc_noa_cmd(padapter); + /* configure time setting */ + rtw_hal_set_mcc_time_setting_cmd(padapter); +#ifndef CONFIG_MCC_MODE_V2 /* IQK value offload */ rtw_hal_set_mcc_IQK_offload_cmd(padapter); +#endif /* set mac id to fw */ rtw_hal_set_mcc_macid_cmd(padapter); + if (dvobj->p0_tsf.sync_port != MAX_HW_PORT ) { + /* disable tsf auto sync */ + RTW_INFO("[MCC] disable HW TSF sync\n"); + rtw_hal_set_hwreg(padapter, HW_VAR_TSF_AUTO_SYNC, &enable_tsf_auto_sync); + } else { + RTW_INFO("[MCC] already disable HW TSF sync\n"); + } + /* set mcc parameter */ rtw_hal_set_mcc_ctrl_cmd(padapter, _FALSE); @@ -966,7 +2280,9 @@ static u8 rtw_hal_set_mcc_start_setting(PADAPTER padapter, u8 status) static void rtw_hal_set_mcc_stop_setting(PADAPTER padapter, u8 status) { struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + struct mcc_obj_priv *mccobjpriv = &dvobj->mcc_objpriv; _adapter *iface = NULL; + struct mcc_adapter_priv *mccadapriv = NULL; u8 i = 0; /* * when adapter disconnect, stop mcc mod @@ -976,10 +2292,13 @@ static void rtw_hal_set_mcc_stop_setting(PADAPTER padapter, u8 status) switch (status) { default: /* let fw switch to other interface channel */ - for (i = 0; i < dvobj->iface_nums; i++) { - iface = dvobj->padapters[i]; + for (i = 0; i < MAX_MCC_NUM; i++) { + iface = mccobjpriv->iface[i]; if (iface == NULL) continue; + + mccadapriv = &iface->mcc_adapterpriv; + /* use other interface to set cmd */ if (iface != padapter) { rtw_hal_set_mcc_ctrl_cmd(iface, _TRUE); @@ -1014,38 +2333,88 @@ static void rtw_hal_mcc_status_hdl(PADAPTER padapter, u8 status) static void rtw_hal_mcc_stop_posthdl(PADAPTER padapter) { struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + struct mcc_obj_priv *mccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); + struct mcc_adapter_priv *mccadapriv = NULL; _adapter *iface = NULL; + PHAL_DATA_TYPE hal; u8 i = 0; + u8 enable_rx_bar = _FALSE; - for (i = 0; i < dvobj->iface_nums; i++) { - iface = dvobj->padapters[i]; + hal = GET_HAL_DATA(padapter); + + for (i = 0; i < MAX_MCC_NUM; i++) { + iface = mccobjpriv->iface[i]; if (iface == NULL) continue; + /* release network queue */ rtw_netif_wake_queue(iface->pnetdev); - 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; + mccadapriv = &iface->mcc_adapterpriv; + mccadapriv->mcc_tx_bytes_from_kernel = 0; + mccadapriv->mcc_last_tx_bytes_from_kernel = 0; + mccadapriv->mcc_tx_bytes_to_port = 0; - if (iface->mcc_adapterpriv.role == MCC_ROLE_GO) + if (mccadapriv->role == MCC_ROLE_GO) rtw_hal_mcc_remove_go_p2p_ie(iface); + +#ifdef CONFIG_TDLS + if (MLME_IS_STA(iface)) { + if (mccadapriv->backup_tdls_en) { + rtw_enable_tdls_func(iface); + RTW_INFO("%s: Disable MCC, Enable TDLS\n", __func__); + mccadapriv->backup_tdls_en = _FALSE; + } + } +#endif /* CONFIG_TDLS */ + + mccadapriv->role = MCC_ROLE_MAX; + mccobjpriv->iface[i] = NULL; } + + /* force switch channel */ + hal->current_channel = 0; + hal->current_channel_bw = CHANNEL_WIDTH_MAX; + #ifdef CONFIG_MCC_PHYDM_OFFLOAD + rtw_hal_mcc_cfg_phydm(padapter, MCC_CFG_PHYDM_STOP, NULL); + #endif } static void rtw_hal_mcc_start_posthdl(PADAPTER padapter) { struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + struct mcc_obj_priv *mccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); + struct mcc_adapter_priv *mccadapriv = NULL; + struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); _adapter *iface = NULL; - u8 i = 0; + u8 i = 0, order = 0; + u8 enable_rx_bar = _TRUE; - for (i = 0; i < dvobj->iface_nums; i++) { - iface = dvobj->padapters[i]; + for (i = 0; i < MAX_MCC_NUM; i++) { + iface = mccobjpriv->iface[i]; if (iface == NULL) continue; - 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; + + mccadapriv = &iface->mcc_adapterpriv; + if (mccadapriv->role == MCC_ROLE_MAX) + continue; + + mccadapriv->mcc_tx_bytes_from_kernel = 0; + mccadapriv->mcc_last_tx_bytes_from_kernel = 0; + mccadapriv->mcc_tx_bytes_to_port = 0; + +#ifdef CONFIG_TDLS + if (MLME_IS_STA(iface)) { + if (rtw_is_tdls_enabled(iface)) { + mccadapriv->backup_tdls_en = _TRUE; + rtw_disable_tdls_func(iface, _TRUE); + RTW_INFO("%s: Enable MCC, Disable TDLS\n", __func__); + } + } +#endif /* CONFIG_TDLS */ } + #ifdef CONFIG_MCC_PHYDM_OFFLOAD + rtw_hal_mcc_cfg_phydm(padapter, MCC_CFG_PHYDM_START, NULL); + #endif } /* @@ -1079,6 +2448,7 @@ static u8 rtw_hal_set_mcc_setting(PADAPTER padapter, u8 status) if (ret == _SUCCESS) { RTW_INFO(FUNC_ADPT_FMT": mcc start sucecssfully\n", FUNC_ADPT_ARG(padapter)); + rtw_hal_mcc_status_hdl(padapter, status); rtw_hal_mcc_start_posthdl(padapter); } } else { @@ -1094,13 +2464,12 @@ static u8 rtw_hal_set_mcc_setting(PADAPTER padapter, u8 status) RTW_INFO(FUNC_ADPT_FMT": wait for mcc stop C2H time out\n", FUNC_ADPT_ARG(padapter)); else { ret = _SUCCESS; + rtw_hal_mcc_status_hdl(padapter, status); rtw_hal_mcc_stop_posthdl(padapter); } } exit: - - rtw_hal_mcc_status_hdl(padapter, status); /* clear mcc status */ rtw_hal_clear_mcc_status(padapter , MCC_STATUS_PROCESS_MCC_START_SETTING | MCC_STATUS_PROCESS_MCC_STOP_SETTING); @@ -1145,6 +2514,9 @@ static void rtw_hal_mcc_sw_ch_fw_notify_hdl(PADAPTER padapter) for (i = 0; i < iface_num; i++) { iface = pdvobjpriv->padapters[i]; + if (iface == NULL) + continue; + if (cur_op_ch == iface->mlmeextpriv.cur_channel) { cur_iface = iface; cur_mccadapriv = &cur_iface->mcc_adapterpriv; @@ -1156,6 +2528,12 @@ static void rtw_hal_mcc_sw_ch_fw_notify_hdl(PADAPTER padapter) } } + if (cur_iface == NULL || next_iface == NULL) { + RTW_ERR("cur_iface=%p,next_iface=%p\n", cur_iface, next_iface); + rtw_warn_on(1); + return; + } + /* check other interface tx busy traffic or not under every 2 switch channel notify(Mbits/100ms) */ if (cnt == 2) { cur_mccadapriv->mcc_tp = (cur_mccadapriv->mcc_tx_bytes_from_kernel @@ -1234,6 +2612,9 @@ static void rtw_hal_mcc_update_noa_start_time_hdl(PADAPTER padapter, u8 buflen, continue; pmccadapriv = &iface->mcc_adapterpriv; + if (pmccadapriv->role == MCC_ROLE_MAX) + continue; + /* GO & channel match */ if (pmccadapriv->role == MCC_ROLE_GO) { /* convert GO TBTT from FW to noa_start_time(TU convert to mircosecond) */ @@ -1259,6 +2640,145 @@ static void rtw_hal_mcc_update_noa_start_time_hdl(PADAPTER padapter, u8 buflen, } +static u8 mcc_get_reg_hdl(PADAPTER adapter, const u8 *val) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + struct mcc_obj_priv *mccobjpriv = &(dvobj->mcc_objpriv); + struct hal_com_data *hal = GET_HAL_DATA(adapter); + _adapter *cur_iface = NULL; + u8 ret = _SUCCESS; + u8 cur_order = 0; + + u16 dbg_reg[DBG_MCC_REG_NUM] = {0x4d4,0x522,0xc50,0xe50}; + u16 dbg_rf_reg[DBG_MCC_RF_REG_NUM] = {0x18}; + u8 i; + u32 reg_val; + u8 path = 0, path_nums = 0; + + if (!rtw_hal_check_mcc_status(adapter, MCC_STATUS_DOING_MCC)) { + ret = _FAIL; + goto exit; + } + + if (!val) + cur_order = 0xff; + else + cur_order = *val; + + if (cur_order >= MAX_MCC_NUM && cur_order != 0xff) { + RTW_ERR("%s: cur_order=%d\n", __func__, cur_order); + ret = _FAIL; + goto exit; + } + + path_nums = hal->NumTotalRFPath; + if (cur_order == 0xff) + cur_iface = adapter; + else + cur_iface = mccobjpriv->iface[cur_order]; + + if (!cur_iface) { + RTW_ERR("%s: cur_iface = NULL, cur_order=%d\n", __func__, cur_order); + ret = _FAIL; + goto exit; + } + + _enter_critical_mutex(&mccobjpriv->mcc_dbg_reg_mutex, NULL); + if (!RTW_CANNOT_IO(adapter)) { + /* RTW_INFO("=================================\n"); + RTW_INFO(ADPT_FMT": cur_order:%d\n", ADPT_ARG(cur_iface), cur_order); */ + + for (i = 0; i < ARRAY_SIZE(dbg_reg); i++) { + reg_val = rtw_read32(adapter, dbg_reg[i]); + mccobjpriv->dbg_reg[i] = dbg_reg[i]; + mccobjpriv->dbg_reg_val[i] = reg_val; + /* RTW_PRINT("REG_%X:0x%08x\n", dbg_reg[i], reg_val); */ + } + for (i = 0; i < ARRAY_SIZE(dbg_rf_reg); i++) { + for (path = 0; path < path_nums; path++) { + reg_val = rtw_hal_read_rfreg(adapter, path, dbg_rf_reg[i], 0xffffffff); + /* RTW_PRINT("RF_PATH_%d_REG_%X:0x%08x\n", + path, dbg_rf_reg[i], reg_val); */ + mccobjpriv->dbg_rf_reg[i] = dbg_rf_reg[i]; + mccobjpriv->dbg_rf_reg_val[i][path] = reg_val; + } + } + } + _exit_critical_mutex(&mccobjpriv->mcc_dbg_reg_mutex, NULL); + +exit: + return ret; +} + +static u8 mcc_get_reg_cmd(_adapter *adapter, u8 cur_order) +{ + struct cmd_obj *cmdobj; + struct drvextra_cmd_parm *pdrvextra_cmd_parm; + struct cmd_priv *pcmdpriv = &adapter->cmdpriv; + u8 *mcc_cur_order = NULL; + u8 res = _SUCCESS; + + + cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); + if (cmdobj == 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 *)cmdobj, sizeof(struct cmd_obj)); + res = _FAIL; + goto exit; + } + + mcc_cur_order = rtw_zmalloc(sizeof(u8)); + if (mcc_cur_order == NULL) { + rtw_mfree((u8 *)cmdobj, sizeof(struct cmd_obj)); + rtw_mfree((u8 *)pdrvextra_cmd_parm, sizeof(struct drvextra_cmd_parm)); + res = _FAIL; + goto exit; + } + + pdrvextra_cmd_parm->ec_id = MCC_CMD_WK_CID; + pdrvextra_cmd_parm->type = MCC_GET_DBG_REG_WK_CID; + pdrvextra_cmd_parm->size = 1; + pdrvextra_cmd_parm->pbuf = mcc_cur_order; + + _rtw_memcpy(mcc_cur_order, &cur_order, 1); + + init_h2fwcmd_w_parm_no_rsp(cmdobj, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); + res = rtw_enqueue_cmd(pcmdpriv, cmdobj); + +exit: + return res; +} + +static void rtw_hal_mcc_rpt_tsf_hdl(PADAPTER padapter, u8 buflen, u8 *tmpBuf) +{ + struct dvobj_priv *dvobjpriv = adapter_to_dvobj(padapter); + struct mcc_obj_priv *mccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); + struct submit_ctx *mcc_tsf_req_sctx = &mccobjpriv->mcc_tsf_req_sctx; + struct mcc_adapter_priv *mccadapriv = NULL; + _adapter *iface = NULL; + u8 order = 0; + + order = mccobjpriv->mcc_tsf_req_sctx_order; + iface = mccobjpriv->iface[order]; + mccadapriv = &iface->mcc_adapterpriv; + mccadapriv->tsf = RTW_GET_LE64(tmpBuf + 2); + + + if (0) + RTW_INFO(FUNC_ADPT_FMT" TSF(order:%d):0x%02llx\n", FUNC_ADPT_ARG(iface), mccadapriv->order, mccadapriv->tsf); + + if (mccadapriv->order == (MAX_MCC_NUM - 1)) + rtw_sctx_done(&mcc_tsf_req_sctx); + else + mccobjpriv->mcc_tsf_req_sctx_order ++; + +} + /** * rtw_hal_mcc_c2h_handler - mcc c2h handler */ @@ -1268,6 +2788,8 @@ void rtw_hal_mcc_c2h_handler(PADAPTER padapter, u8 buflen, u8 *tmpBuf) struct mcc_obj_priv *pmccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; struct submit_ctx *mcc_sctx = &pmccobjpriv->mcc_sctx; + _adapter *cur_adapter = NULL; + u8 cur_ch = 0, cur_bw = 0, cur_ch_offset = 0; _irqL irqL; /* RTW_INFO("[length]=%d, [C2H data]="MAC_FMT"\n", buflen, MAC_ARG(tmpBuf)); */ @@ -1277,20 +2799,36 @@ void rtw_hal_mcc_c2h_handler(PADAPTER padapter, u8 buflen, u8 *tmpBuf) return; } + _enter_critical_bh(&pmccobjpriv->mcc_lock, &irqL); pmccobjpriv->mcc_c2h_status = tmpBuf[0]; + pmccobjpriv->current_order = tmpBuf[1]; + cur_adapter = pmccobjpriv->iface[pmccobjpriv->current_order]; + cur_ch = cur_adapter->mlmeextpriv.cur_channel; + cur_bw = cur_adapter->mlmeextpriv.cur_bwmode; + cur_ch_offset = cur_adapter->mlmeextpriv.cur_ch_offset; + rtw_set_oper_ch(cur_adapter, cur_ch); + rtw_set_oper_bw(cur_adapter, cur_bw); + rtw_set_oper_choffset(cur_adapter, cur_ch_offset); + _exit_critical_bh(&pmccobjpriv->mcc_lock, &irqL); + + if (0) + RTW_INFO("%d,order:%d,TSF:0x%llx\n", tmpBuf[0], tmpBuf[1], RTW_GET_LE64(tmpBuf + 2)); + switch (pmccobjpriv->mcc_c2h_status) { case MCC_RPT_SUCCESS: - pdvobjpriv->oper_channel = tmpBuf[1]; _enter_critical_bh(&pmccobjpriv->mcc_lock, &irqL); pmccobjpriv->cur_mcc_success_cnt++; + rtw_hal_mcc_upadate_chnl_bw(cur_adapter, cur_ch, cur_ch_offset, cur_bw, _FALSE); + mcc_get_reg_cmd(padapter, pmccobjpriv->current_order); _exit_critical_bh(&pmccobjpriv->mcc_lock, &irqL); break; case MCC_RPT_TXNULL_FAIL: RTW_INFO("[MCC] TXNULL FAIL\n"); break; case MCC_RPT_STOPMCC: - RTW_INFO("[MCC] MCC stop (time:%d)\n", rtw_get_current_time()); + RTW_INFO("[MCC] MCC stop\n"); pmccobjpriv->mcc_c2h_status = MCC_RPT_STOPMCC; + rtw_hal_mcc_upadate_chnl_bw(cur_adapter, cur_ch, cur_ch_offset, cur_bw, _TRUE); rtw_sctx_done(&mcc_sctx); break; case MCC_RPT_READY: @@ -1303,22 +2841,116 @@ void rtw_hal_mcc_c2h_handler(PADAPTER padapter, u8 buflen, u8 *tmpBuf) pmccobjpriv->mcc_tolerance_time = MCC_TOLERANCE_TIME; _exit_critical_bh(&pmccobjpriv->mcc_lock, &irqL); - RTW_INFO("[MCC] MCC ready (time:%d)\n", pmccobjpriv->mcc_launch_time); + RTW_INFO("[MCC] MCC ready\n"); rtw_sctx_done(&mcc_sctx); break; case MCC_RPT_SWICH_CHANNEL_NOTIFY: - 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; + case MCC_RPT_TSF: + _enter_critical_bh(&pmccobjpriv->mcc_lock, &irqL); + rtw_hal_mcc_rpt_tsf_hdl(padapter, buflen, tmpBuf); + _exit_critical_bh(&pmccobjpriv->mcc_lock, &irqL); + break; default: /* RTW_INFO("[MCC] Other MCC status(%d)\n", pmccobjpriv->mcc_c2h_status); */ break; } } +void rtw_hal_mcc_update_parameter(PADAPTER padapter, u8 force_update) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + struct mcc_obj_priv *mccobjpriv = &(dvobj->mcc_objpriv); + u8 cmd[H2C_MCC_TIME_SETTING_LEN] = {0}; + u8 swchannel_early_time = MCC_SWCH_FW_EARLY_TIME; + u8 ap_num = DEV_AP_NUM(dvobj); + + if (ap_num == 0) { + u8 need_update = _FALSE; + u8 start_time_offset = 0, interval = 0, duration = 0; + + need_update = rtw_hal_mcc_update_timing_parameters(padapter, force_update); + + if (need_update == _FALSE) + return; + + start_time_offset = mccobjpriv->start_time; + interval = mccobjpriv->interval; + duration = mccobjpriv->iface[0]->mcc_adapterpriv.mcc_duration; + + SET_H2CCMD_MCC_TIME_SETTING_START_TIME(cmd, start_time_offset); + SET_H2CCMD_MCC_TIME_SETTING_INTERVAL(cmd, interval); + SET_H2CCMD_MCC_TIME_SETTING_EARLY_SWITCH_RPT(cmd, swchannel_early_time); + SET_H2CCMD_MCC_TIME_SETTING_UPDATE(cmd, _TRUE); + SET_H2CCMD_MCC_TIME_SETTING_ORDER0_DURATION(cmd, duration); + } else { + PADAPTER order0_iface = NULL; + PADAPTER order1_iface = NULL; + u8 policy_idx = mccobjpriv->policy_index; + u8 duration = mcc_switch_channel_policy_table[policy_idx][MCC_DURATION_IDX]; + u8 tsf_sync_offset = mcc_switch_channel_policy_table[policy_idx][MCC_TSF_SYNC_OFFSET_IDX]; + u8 start_time_offset = mcc_switch_channel_policy_table[policy_idx][MCC_START_TIME_OFFSET_IDX]; + u8 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 order0_duration = 0; + u8 i = 0; + enum _hw_port tsf_bsae_port = MAX_HW_PORT; + enum _hw_port tsf_sync_port = MAX_HW_PORT; + + RTW_INFO("%s: policy_idx=%d\n", __func__, policy_idx); + + order0_iface = mccobjpriv->iface[0]; + order1_iface = mccobjpriv->iface[1]; + + /* GO/AP is order 0, GC/STA is order 1 */ + order0_duration = order0_iface->mcc_adapterpriv.mcc_duration = interval - duration; + order0_iface->mcc_adapterpriv.mcc_duration = duration; + + tsf_bsae_port = rtw_hal_get_port(order1_iface); + tsf_sync_port = rtw_hal_get_port(order0_iface); + + /* update IE */ + for (i = 0; i < dvobj->iface_nums; i++) { + PADAPTER iface = NULL; + struct mcc_adapter_priv *mccadapriv = NULL; + + iface = dvobj->padapters[i]; + if (iface == NULL) + continue; + + mccadapriv = &iface->mcc_adapterpriv; + if (mccadapriv->role == MCC_ROLE_MAX) + continue; + + if (mccadapriv->role == MCC_ROLE_GO) + rtw_hal_mcc_update_go_p2p_ie(iface); + } + + /* update H2C cmd */ + /* FW set enable */ + SET_H2CCMD_MCC_TIME_SETTING_FW_EN(cmd, _TRUE); + /* TSF Sync offset */ + SET_H2CCMD_MCC_TIME_SETTING_TSF_SYNC_OFFSET(cmd, tsf_sync_offset); + /* start time offset */ + SET_H2CCMD_MCC_TIME_SETTING_START_TIME(cmd, (start_time_offset + guard_offset0)); + /* interval */ + SET_H2CCMD_MCC_TIME_SETTING_INTERVAL(cmd, interval); + /* Early time to inform driver by C2H before switch channel */ + SET_H2CCMD_MCC_TIME_SETTING_EARLY_SWITCH_RPT(cmd, swchannel_early_time); + /* Port0 sync from Port1, not support multi-port */ + SET_H2CCMD_MCC_TIME_SETTING_ORDER_BASE(cmd, tsf_bsae_port); + SET_H2CCMD_MCC_TIME_SETTING_ORDER_SYNC(cmd, tsf_sync_port); + SET_H2CCMD_MCC_TIME_SETTING_UPDATE(cmd, _TRUE); + SET_H2CCMD_MCC_TIME_SETTING_ORDER0_DURATION(cmd, order0_duration); + } + + rtw_hal_fill_h2c_cmd(padapter, H2C_MCC_TIME_SETTING, H2C_MCC_TIME_SETTING_LEN, cmd); +} /** * rtw_hal_mcc_sw_status_check - check mcc swich channel status @@ -1329,8 +2961,14 @@ void rtw_hal_mcc_sw_status_check(PADAPTER padapter) struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); struct mcc_obj_priv *pmccobjpriv = &(dvobj->mcc_objpriv); struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); - u8 cur_cnt = 0, prev_cnt = 0, diff_cnt = 0, check_ret = _FAIL; + struct mcc_adapter_priv *mccadapriv = NULL; + _adapter *iface = NULL; + u8 cur_cnt = 0, prev_cnt = 0, diff_cnt = 0, check_ret = _FAIL, threshold = 0; + u8 policy_idx = pmccobjpriv->policy_index; + u8 noa_enable = _FALSE; + u8 i = 0; _irqL irqL; + u8 ap_num = DEV_AP_NUM(dvobj); /* #define MCC_RESTART 1 */ @@ -1341,6 +2979,27 @@ void rtw_hal_mcc_sw_status_check(PADAPTER padapter) if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) { + /* check noa enable or not */ + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + if (iface == NULL) + continue; + + mccadapriv = &iface->mcc_adapterpriv; + if (mccadapriv->role == MCC_ROLE_MAX) + continue; + + if (iface->wdinfo.p2p_ps_mode == P2P_PS_NOA) { + noa_enable = _TRUE; + break; + } + } + + if (!noa_enable && ap_num == 0) + rtw_hal_mcc_update_parameter(padapter, _FALSE); + + threshold = pmccobjpriv->mcc_stop_threshold; + if (pwrpriv->pwr_mode != PS_MODE_ACTIVE) { rtw_warn_on(1); RTW_INFO("PS mode is not active under mcc, force exit ps mode\n"); @@ -1357,7 +3016,7 @@ void rtw_hal_mcc_sw_status_check(PADAPTER padapter) else diff_cnt = cur_cnt - prev_cnt; - if (diff_cnt < 30) { + if (diff_cnt < threshold) { pmccobjpriv->mcc_tolerance_time--; RTW_INFO("%s: diff_cnt:%d, tolerance_time:%d\n", __func__, diff_cnt, pmccobjpriv->mcc_tolerance_time); @@ -1402,10 +3061,11 @@ void rtw_hal_mcc_sw_status_check(PADAPTER padapter) */ u8 rtw_hal_mcc_change_scan_flag(PADAPTER padapter, u8 *ch, u8 *bw, u8 *offset) { - u8 need_ch_setting_union = _TRUE, i = 0, flags = 0, role = 0; + u8 need_ch_setting_union = _TRUE, i = 0, flags = 0, back_op = _FALSE; struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); - struct mcc_adapter_priv *pmccadapriv = NULL; - struct mlme_ext_priv *pmlmeext = NULL; + struct mcc_adapter_priv *mccadapriv = NULL; + struct mlme_ext_priv *mlmeext = NULL; + _adapter *iface = NULL; if (!MCC_EN(padapter)) goto exit; @@ -1413,41 +3073,45 @@ u8 rtw_hal_mcc_change_scan_flag(PADAPTER padapter, u8 *ch, u8 *bw, u8 *offset) if (!rtw_hal_check_mcc_status(padapter, MCC_STATUS_NEED_MCC)) goto exit; + /* disable PS_ANNC & TX_RESUME for all interface */ + /* ToDo: TX_RESUME by interface in SCAN_BACKING_OP */ + mlmeext = &padapter->mlmeextpriv; + + flags = mlmeext_scan_backop_flags(mlmeext); + if (mlmeext_chk_scan_backop_flags(mlmeext, SS_BACKOP_PS_ANNC)) + flags &= ~SS_BACKOP_PS_ANNC; + + if (mlmeext_chk_scan_backop_flags(mlmeext, SS_BACKOP_TX_RESUME)) + flags &= ~SS_BACKOP_TX_RESUME; + + mlmeext_assign_scan_backop_flags(mlmeext, flags); + for (i = 0; i < dvobj->iface_nums; i++) { - if (!dvobj->padapters[i]) - continue; + iface = dvobj->padapters[i]; + if (!iface) + continue; - pmlmeext = &dvobj->padapters[i]->mlmeextpriv; - pmccadapriv = &dvobj->padapters[i]->mcc_adapterpriv; - role = pmccadapriv->role; + mlmeext = &iface->mlmeextpriv; - switch (role) { - case MCC_ROLE_AP: - case MCC_ROLE_GO: - *ch = pmlmeext->cur_channel; - *bw = pmlmeext->cur_bwmode; - *offset = pmlmeext->cur_ch_offset; - need_ch_setting_union = _FALSE; - break; - case MCC_ROLE_STA: - case MCC_ROLE_GC: - break; - default: - RTW_INFO("unknown role\n"); - rtw_warn_on(1); - break; + if (MLME_IS_GO(iface) || MLME_IS_AP(iface)) + back_op = _TRUE; + else if (MLME_IS_GC(iface) && (iface != padapter)) + /* switch to another linked interface(GO) to receive beacon to avoid no beacon disconnect */ + back_op = _TRUE; + else if (MLME_IS_STA(iface) && MLME_IS_ASOC(iface) && (iface != padapter)) + /* switch to another linked interface(STA) to receive beacon to avoid no beacon disconnect */ + back_op = _TRUE; + else { + /* bypass non-linked/non-linking interface/scan interface */ + continue; + } + + if (back_op) { + *ch = mlmeext->cur_channel; + *bw = mlmeext->cur_bwmode; + *offset = mlmeext->cur_ch_offset; + need_ch_setting_union = _FALSE; } - - /* check other scan flag */ - flags = mlmeext_scan_backop_flags(pmlmeext); - if (mlmeext_chk_scan_backop_flags(pmlmeext, SS_BACKOP_PS_ANNC)) - flags &= ~SS_BACKOP_PS_ANNC; - - if (mlmeext_chk_scan_backop_flags(pmlmeext, SS_BACKOP_TX_RESUME)) - flags &= ~SS_BACKOP_TX_RESUME; - - mlmeext_assign_scan_backop_flags(pmlmeext, flags); - } exit: return need_ch_setting_union; @@ -1483,13 +3147,14 @@ inline void rtw_hal_mcc_calc_tx_bytes_to_port(PADAPTER padapter, u32 len) struct mcc_obj_priv *pmccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; - if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) + 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); } + } } /** @@ -1516,6 +3181,45 @@ inline u8 rtw_hal_mcc_stop_tx_bytes_to_port(PADAPTER padapter) return _FALSE; } +static void rtw_hal_mcc_assign_scan_flag(PADAPTER padapter, u8 scan_done) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + struct mcc_adapter_priv *mccadapriv = NULL; + _adapter *iface = NULL; + struct mlme_ext_priv *pmlmeext = NULL; + u8 i = 0, flags; + + if (!MCC_EN(padapter)) + return; + + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + if (iface == NULL) + continue; + + mccadapriv = &iface->mcc_adapterpriv; + if (mccadapriv->role == MCC_ROLE_MAX) + continue; + + pmlmeext = &iface->mlmeextpriv; + if (is_client_associated_to_ap(iface)) { + flags = mlmeext_scan_backop_flags_sta(pmlmeext); + if (scan_done) { + if (mlmeext_chk_scan_backop_flags_sta(pmlmeext, SS_BACKOP_EN)) { + flags &= ~SS_BACKOP_EN; + mlmeext_assign_scan_backop_flags_sta(pmlmeext, flags); + } + } else { + if (!mlmeext_chk_scan_backop_flags_sta(pmlmeext, SS_BACKOP_EN)) { + flags |= SS_BACKOP_EN; + mlmeext_assign_scan_backop_flags_sta(pmlmeext, flags); + } + } + + } + } +} + /** * rtw_hal_set_mcc_setting_scan_start - setting mcc under scan start * @padapter: the adapter to be setted @@ -1532,8 +3236,7 @@ u8 rtw_hal_set_mcc_setting_scan_start(PADAPTER padapter) if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_NEED_MCC)) { if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) { ret = rtw_hal_set_mcc_setting(padapter, MCC_SETCMD_STATUS_STOP_SCAN_START); - /* issue null data to all station connected to AP before scan */ - rtw_hal_mcc_issue_null_data(padapter, 0, 1); + rtw_hal_mcc_assign_scan_flag(padapter, 0); } } _exit_critical_mutex(&pmccobjpriv->mcc_mutex, NULL); @@ -1556,9 +3259,10 @@ 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); - + if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_NEED_MCC)) { + rtw_hal_mcc_assign_scan_flag(padapter, 1); + ret = rtw_hal_set_mcc_setting(padapter, MCC_SETCMD_STATUS_START_SCAN_DONE); + } _exit_critical_mutex(&pmccobjpriv->mcc_mutex, NULL); } @@ -1655,9 +3359,9 @@ u8 rtw_hal_set_mcc_setting_join_done_chk_ch(PADAPTER 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; } @@ -1680,12 +3384,15 @@ u8 rtw_hal_set_mcc_setting_chk_start_clnt_join(PADAPTER padapter, u8 *ch, u8 *bw if (chbw_allow == _FALSE) { struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + /* issue null data to other interface connected to AP */ + rtw_hal_mcc_issue_null_data(padapter, chbw_allow, _TRUE); + *ch = pmlmeext->cur_channel; *bw = pmlmeext->cur_bwmode; *offset = pmlmeext->cur_ch_offset; RTW_INFO(FUNC_ADPT_FMT" en_mcc:%d(%d,%d,%d,)\n" - , FUNC_ADPT_ARG(padapter), padapter->registrypriv.en_mcc + , FUNC_ADPT_ARG(padapter), MCC_EN(padapter) , *ch, *bw, *offset); ret = _SUCCESS; } @@ -1711,50 +3418,100 @@ static void rtw_hal_mcc_dump_noa_content(void *sel, PADAPTER padapter) RTW_PRINT_SEL(sel, "End to dump NoA Content\n"); } +static void mcc_dump_dbg_reg(void *sel, _adapter *adapter) +{ + struct mcc_obj_priv *mccobjpriv = adapter_to_mccobjpriv(adapter); + HAL_DATA_TYPE *hal = GET_HAL_DATA(adapter); + u8 i,j; + _irqL irqL; + + _enter_critical_bh(&mccobjpriv->mcc_lock, &irqL); + RTW_PRINT_SEL(sel, "current order=%d\n", mccobjpriv->current_order); + _exit_critical_bh(&mccobjpriv->mcc_lock, &irqL); + + _enter_critical_mutex(&mccobjpriv->mcc_dbg_reg_mutex, NULL); + for (i = 0; i < ARRAY_SIZE(mccobjpriv->dbg_reg); i++) + RTW_PRINT_SEL(sel, "REG_0x%X:0x%08x\n", mccobjpriv->dbg_reg[i], mccobjpriv->dbg_reg_val[i]); + + for (i = 0; i < ARRAY_SIZE(mccobjpriv->dbg_rf_reg); i++) { + for (j = 0; j < hal->NumTotalRFPath; j++) + RTW_PRINT_SEL(sel, "RF_PATH_%d_REG_0x%X:0x%08x\n", + j, mccobjpriv->dbg_rf_reg[i], mccobjpriv->dbg_rf_reg_val[i][j]); + } + _exit_critical_mutex(&mccobjpriv->mcc_dbg_reg_mutex, NULL); +} + + void rtw_hal_dump_mcc_info(void *sel, struct dvobj_priv *dvobj) { - struct mcc_obj_priv *pmccobjpriv = &(dvobj->mcc_objpriv); - struct mcc_adapter_priv *pmccadapriv = NULL; - _adapter *iface = NULL, *adapter = NULL; + struct mcc_obj_priv *mccobjpriv = &(dvobj->mcc_objpriv); + struct mcc_adapter_priv *mccadapriv = NULL; + _adapter *iface = NULL, *pri_adapter = NULL; struct registry_priv *regpriv = NULL; - u8 i = 0; + HAL_DATA_TYPE *hal = NULL; + u8 i = 0, j = 0; + u64 tsf[MAX_MCC_NUM] = {0}; /* regpriv is common for all adapter */ - adapter = dvobj->padapters[IFACE_ID0]; + pri_adapter = dvobj_get_primary_adapter(dvobj); + hal = GET_HAL_DATA(pri_adapter); RTW_PRINT_SEL(sel, "**********************************************\n"); - for (i = 0; i < dvobj->iface_nums; i++) { - iface = dvobj->padapters[i]; - if (!iface) - continue; + RTW_PRINT_SEL(sel, "en_mcc:%d\n", MCC_EN(pri_adapter)); + RTW_PRINT_SEL(sel, "primary adapter("ADPT_FMT") duration:%d%c\n", + ADPT_ARG(dvobj_get_primary_adapter(dvobj)), mccobjpriv->duration, 37); + RTW_PRINT_SEL(sel, "runtime duration:%s\n", mccobjpriv->enable_runtime_duration ? "enable":"disable"); + RTW_PRINT_SEL(sel, "phydm offload:%s\n", mccobjpriv->mcc_phydm_offload ? "enable":"disable"); - regpriv = &iface->registrypriv; - pmccadapriv = &iface->mcc_adapterpriv; - if (pmccadapriv) { - RTW_PRINT_SEL(sel, "adapter mcc info:\n"); - RTW_PRINT_SEL(sel, "ifname:%s\n", ADPT_ARG(iface)); - RTW_PRINT_SEL(sel, "order:%d\n", pmccadapriv->order); - RTW_PRINT_SEL(sel, "duration:%d\n", pmccadapriv->mcc_duration); - RTW_PRINT_SEL(sel, "target tx bytes:%d\n", pmccadapriv->mcc_target_tx_bytes_to_port); - RTW_PRINT_SEL(sel, "current TP:%d\n", pmccadapriv->mcc_tp); - RTW_PRINT_SEL(sel, "mgmt queue macid:%d\n", pmccadapriv->mgmt_queue_macid); - RTW_PRINT_SEL(sel, "macid bitmap:0x%02x\n\n", pmccadapriv->mcc_macid_bitmap); - RTW_PRINT_SEL(sel, "registry data:\n"); - RTW_PRINT_SEL(sel, "en_mcc:%d\n", regpriv->en_mcc); - RTW_PRINT_SEL(sel, "ap target tx TP(BW:20M):%d Mbps\n", regpriv->rtw_mcc_ap_bw20_target_tx_tp); - RTW_PRINT_SEL(sel, "ap target tx TP(BW:40M):%d Mbps\n", regpriv->rtw_mcc_ap_bw40_target_tx_tp); - RTW_PRINT_SEL(sel, "ap target tx TP(BW:80M):%d Mbps\n", regpriv->rtw_mcc_ap_bw80_target_tx_tp); - RTW_PRINT_SEL(sel, "sta target tx TP(BW:20M):%d Mbps\n", regpriv->rtw_mcc_sta_bw20_target_tx_tp); - 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"); + if (rtw_hal_check_mcc_status(pri_adapter, MCC_STATUS_DOING_MCC)) { + rtw_hal_mcc_rqt_tsf(pri_adapter, tsf); + + for (i = 0; i < MAX_MCC_NUM; i++) { + iface = mccobjpriv->iface[i]; + if (!iface) + continue; + + regpriv = &iface->registrypriv; + mccadapriv = &iface->mcc_adapterpriv; + + if (mccadapriv) { + u8 p2p_ps_mode = iface->wdinfo.p2p_ps_mode; + + RTW_PRINT_SEL(sel, "adapter mcc info:\n"); + RTW_PRINT_SEL(sel, "ifname:%s\n", ADPT_ARG(iface)); + RTW_PRINT_SEL(sel, "order:%d\n", mccadapriv->order); + RTW_PRINT_SEL(sel, "duration:%d\n", mccadapriv->mcc_duration); + RTW_PRINT_SEL(sel, "target tx bytes:%d\n", mccadapriv->mcc_target_tx_bytes_to_port); + RTW_PRINT_SEL(sel, "current TP:%d\n", mccadapriv->mcc_tp); + RTW_PRINT_SEL(sel, "mgmt queue macid:%d\n", mccadapriv->mgmt_queue_macid); + RTW_PRINT_SEL(sel, "macid bitmap:0x%02x\n", mccadapriv->mcc_macid_bitmap); + RTW_PRINT_SEL(sel, "P2P NoA:%s\n\n", p2p_ps_mode == P2P_PS_NOA ? "enable":"disable"); + RTW_PRINT_SEL(sel, "registry data:\n"); + RTW_PRINT_SEL(sel, "ap target tx TP(BW:20M):%d Mbps\n", regpriv->rtw_mcc_ap_bw20_target_tx_tp); + RTW_PRINT_SEL(sel, "ap target tx TP(BW:40M):%d Mbps\n", regpriv->rtw_mcc_ap_bw40_target_tx_tp); + RTW_PRINT_SEL(sel, "ap target tx TP(BW:80M):%d Mbps\n", regpriv->rtw_mcc_ap_bw80_target_tx_tp); + RTW_PRINT_SEL(sel, "sta target tx TP(BW:20M):%d Mbps\n", regpriv->rtw_mcc_sta_bw20_target_tx_tp); + 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); + RTW_PRINT_SEL(sel, "HW TSF=0x%llx\n", tsf[mccadapriv->order]); + if (MLME_IS_GO(iface)) + rtw_hal_mcc_dump_noa_content(sel, iface); + RTW_PRINT_SEL(sel, "**********************************************\n"); + } } + + mcc_dump_dbg_reg(sel, pri_adapter); } + + #ifdef CONFIG_MCC_PHYDM_OFFLOAD + RTW_PRINT_SEL(sel, "@@@@@@@@@@@@@@@@@@@@\n"); + rtw_hal_mcc_cfg_phydm(pri_adapter, MCC_CFG_PHYDM_DUMP, sel); + RTW_PRINT_SEL(sel, "@@@@@@@@@@@@@@@@@@@@\n"); + #endif + RTW_PRINT_SEL(sel, "------------------------------------------\n"); - RTW_PRINT_SEL(sel, "policy index:%d\n", pmccobjpriv->policy_index); + RTW_PRINT_SEL(sel, "policy index:%d\n", mccobjpriv->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); @@ -1811,7 +3568,7 @@ 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)) @@ -1828,11 +3585,22 @@ void rtw_hal_mcc_issue_null_data(_adapter *padapter, u8 chbw_allow, u8 ps_mode) /* 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, offset, bw); + + if (ps_mode) + rtw_hal_macid_sleep(iface, sta->cmn.mac_id); + else + rtw_hal_macid_wakeup(iface, sta->cmn.mac_id); - set_channel_bwmode(iface, ch, bw, offset); issue_nulldata(iface, NULL, ps_mode, 3, 50); } } @@ -1874,4 +3642,290 @@ void rtw_hal_dump_mcc_policy_table(void *sel) } } +void rtw_hal_mcc_update_macid_bitmap(PADAPTER padapter, int mac_id, u8 add) +{ + struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; + + if (!MCC_EN(padapter)) + return; + + if (!rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) + return; + + if (pmccadapriv->role == MCC_ROLE_GC || pmccadapriv->role == MCC_ROLE_STA) + return; + + if (mac_id < 0) { + RTW_WARN("%s: mac_id < 0(%d)\n", __func__, mac_id); + return; + } + + RTW_INFO(ADPT_FMT" %s macid=%d, ori mcc_macid_bitmap=0x%08x\n" + , ADPT_ARG(padapter), add ? "add" : "clear" + , mac_id, pmccadapriv->mcc_macid_bitmap); + + if (add) { + #ifdef CONFIG_MCC_PHYDM_OFFLOAD + rtw_hal_mcc_cfg_phydm(padapter, MCC_CFG_PHYDM_ADD_CLIENT, &mac_id); + #endif + pmccadapriv->mcc_macid_bitmap |= BIT(mac_id); + } else { + #ifdef CONFIG_MCC_PHYDM_OFFLOAD + rtw_hal_mcc_cfg_phydm(padapter, MCC_CFG_PHYDM_REMOVE_CLIENT, &mac_id); + #endif + pmccadapriv->mcc_macid_bitmap &= ~(BIT(mac_id)); + } + rtw_hal_set_mcc_macid_cmd(padapter); +} + +void rtw_hal_mcc_process_noa(PADAPTER padapter) +{ + struct wifidirect_info *pwdinfo = &(padapter->wdinfo); + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + struct mcc_obj_priv *pmccobjpriv = &(dvobj->mcc_objpriv); + + if (!MCC_EN(padapter)) + return; + + if (!rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) + return; + + if (!MLME_IS_GC(padapter)) + return; + + switch(pwdinfo->p2p_ps_mode) { + case P2P_PS_NONE: + RTW_INFO("[MCC] Disable NoA under MCC\n"); + rtw_hal_mcc_update_parameter(padapter, _TRUE); + break; + case P2P_PS_NOA: + RTW_INFO("[MCC] Enable NoA under MCC\n"); + break; + default: + break; + + } +} + +void rtw_hal_mcc_parameter_init(PADAPTER padapter) +{ + if (!padapter->registrypriv.en_mcc) + return; + + if (is_primary_adapter(padapter)) { + SET_MCC_EN_FLAG(padapter, padapter->registrypriv.en_mcc); + SET_MCC_DURATION(padapter, padapter->registrypriv.rtw_mcc_duration); + SET_MCC_RUNTIME_DURATION(padapter, padapter->registrypriv.rtw_mcc_enable_runtime_duration); + SET_MCC_PHYDM_OFFLOAD(padapter, padapter->registrypriv.rtw_mcc_phydm_offload); + } +} + + +static u8 set_mcc_duration_hdl(PADAPTER adapter, const u8 *val) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + struct mcc_obj_priv *mccobjpriv = &(dvobj->mcc_objpriv); + _adapter *iface = NULL; + u8 duration = 50; + u8 ret = _SUCCESS, noa_enable = _FALSE, i = 0; + enum mcc_duration_setting type; + + if (!mccobjpriv->enable_runtime_duration) + goto exit; + +#ifdef CONFIG_P2P_PS + /* check noa enable or not */ + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + if (iface->wdinfo.p2p_ps_mode == P2P_PS_NOA) { + noa_enable = _TRUE; + break; + } + } +#endif /* CONFIG_P2P_PS */ + + type = val[0]; + duration = val[1]; + + if (type == MCC_DURATION_MAPPING) { + switch (duration) { + /* 0 = fair scheduling */ + case 0: + mccobjpriv->duration= 40; + mccobjpriv->policy_index = 2; + mccobjpriv->mchan_sched_mode = MCC_FAIR_SCHEDULE; + break; + /* 1 = favor STA */ + case 1: + mccobjpriv->duration= 70; + mccobjpriv->policy_index = 1; + mccobjpriv->mchan_sched_mode = MCC_FAVOR_STA; + break; + /* 2 = favor P2P*/ + case 2: + default: + mccobjpriv->duration= 30; + mccobjpriv->policy_index = 0; + mccobjpriv->mchan_sched_mode = MCC_FAVOR_P2P; + break; + } + } else { + mccobjpriv->duration = duration; + rtw_hal_mcc_update_policy_table(adapter); + } + + /* only update sw parameter under MCC + it will be force update during */ + if (noa_enable) + goto exit; + + if (rtw_hal_check_mcc_status(adapter, MCC_STATUS_DOING_MCC)) + rtw_hal_mcc_update_parameter(adapter, _TRUE); +exit: + return ret; +} + +u8 rtw_set_mcc_duration_cmd(_adapter *adapter, u8 type, u8 val) +{ + struct cmd_obj *cmdobj; + struct drvextra_cmd_parm *pdrvextra_cmd_parm; + struct cmd_priv *pcmdpriv = &adapter->cmdpriv; + u8 *buf = NULL; + u8 sz = 2; + u8 res = _SUCCESS; + + + cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); + if (cmdobj == 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 *)cmdobj, sizeof(struct cmd_obj)); + res = _FAIL; + goto exit; + } + + buf = rtw_zmalloc(sizeof(u8) * sz); + if (buf == NULL) { + rtw_mfree((u8 *)cmdobj, sizeof(struct cmd_obj)); + rtw_mfree((u8 *)pdrvextra_cmd_parm, sizeof(struct drvextra_cmd_parm)); + res = _FAIL; + goto exit; + } + + pdrvextra_cmd_parm->ec_id = MCC_CMD_WK_CID; + pdrvextra_cmd_parm->type = MCC_SET_DURATION_WK_CID; + pdrvextra_cmd_parm->size = sz; + pdrvextra_cmd_parm->pbuf = buf; + + _rtw_memcpy(buf, &type, 1); + _rtw_memcpy(buf + 1, &val, 1); + + init_h2fwcmd_w_parm_no_rsp(cmdobj, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); + res = rtw_enqueue_cmd(pcmdpriv, cmdobj); + +exit: + return res; +} + +#ifdef CONFIG_MCC_PHYDM_OFFLOAD +static u8 mcc_phydm_offload_enable_hdl(_adapter *adapter, const u8 *val) +{ + struct mcc_obj_priv *mccobjpriv = adapter_to_mccobjpriv(adapter); + u8 ret = _SUCCESS; + u8 enable = *val; + + /*only modify driver parameter during non-mcc status */ + if (!rtw_hal_check_mcc_status(adapter, MCC_STATUS_DOING_MCC)) { + mccobjpriv->mcc_phydm_offload = enable; + } else { + /*modify both driver & phydm parameter during mcc status */ + mccobjpriv->mcc_phydm_offload = enable; + rtw_hal_mcc_cfg_phydm(adapter, MCC_CFG_PHYDM_OFFLOAD, &mccobjpriv->mcc_phydm_offload); + } + + RTW_INFO("[MCC] phydm offload enable hdl(%d)\n", mccobjpriv->mcc_phydm_offload); + + return ret; +} + +u8 rtw_set_mcc_phydm_offload_enable_cmd(_adapter *adapter, u8 enable, u8 enqueue) +{ + u8 res = _SUCCESS; + + if (enqueue) { + struct cmd_obj *cmdobj; + struct drvextra_cmd_parm *pdrvextra_cmd_parm; + struct cmd_priv *pcmdpriv = &adapter->cmdpriv; + u8 *mcc_phydm_offload_enable = NULL; + + + cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); + if (cmdobj == 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 *)cmdobj, sizeof(struct cmd_obj)); + res = _FAIL; + goto exit; + } + + mcc_phydm_offload_enable = rtw_zmalloc(sizeof(u8)); + if (mcc_phydm_offload_enable == NULL) { + rtw_mfree((u8 *)cmdobj, sizeof(struct cmd_obj)); + rtw_mfree((u8 *)pdrvextra_cmd_parm, sizeof(struct drvextra_cmd_parm)); + res = _FAIL; + goto exit; + } + + pdrvextra_cmd_parm->ec_id = MCC_CMD_WK_CID; + pdrvextra_cmd_parm->type = MCC_SET_PHYDM_OFFLOAD_WK_CID; + pdrvextra_cmd_parm->size = 1; + pdrvextra_cmd_parm->pbuf = mcc_phydm_offload_enable; + + _rtw_memcpy(mcc_phydm_offload_enable, &enable, 1); + init_h2fwcmd_w_parm_no_rsp(cmdobj, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); + res = rtw_enqueue_cmd(pcmdpriv, cmdobj); + } else { + mcc_phydm_offload_enable_hdl(adapter, &enable); + } + +exit: + return res; +} +#endif + +u8 rtw_mcc_cmd_hdl(_adapter *adapter, u8 type, const u8 *val) +{ + struct mcc_obj_priv *mccobjpriv = adapter_to_mccobjpriv(adapter); + u8 ret = _SUCCESS; + + switch (type) { + case MCC_SET_DURATION_WK_CID: + set_mcc_duration_hdl(adapter, val); + break; + case MCC_GET_DBG_REG_WK_CID: + mcc_get_reg_hdl(adapter, val); + break; + #ifdef CONFIG_MCC_PHYDM_OFFLOAD + case MCC_SET_PHYDM_OFFLOAD_WK_CID: + mcc_phydm_offload_enable_hdl(adapter, val); + break; + #endif + default: + RTW_ERR("[MCC] rtw_mcc_cmd_hdl fail(%d)\n", type); + break; + } + + + + return ret; +} + #endif /* CONFIG_MCC_MODE */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_mp.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_mp.c index 8ddb33e746ab..653e3185418c 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_mp.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_mp.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 @@ -47,9 +43,18 @@ #ifdef CONFIG_RTL8723D #include #endif + #ifdef CONFIG_RTL8710B + #include + #endif #ifdef CONFIG_RTL8188F #include #endif + #ifdef CONFIG_RTL8188GTV + #include + #endif + #ifdef CONFIG_RTL8192F + #include + #endif #endif /* !RTW_HALMAC */ @@ -77,40 +82,40 @@ void hal_mpt_SwitchRfSetting(PADAPTER pAdapter) HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); u8 ChannelToSw = pMptCtx->MptChannelToSw; - ULONG ulRateIdx = pMptCtx->mpt_rate_index; - ULONG ulbandwidth = pMptCtx->MptBandWidth; + u32 ulRateIdx = pMptCtx->mpt_rate_index; + u32 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_query_rf_reg(pAdapter, ODM_RF_PATH_A, RF_0x52, 0x000F0); - pMptCtx->backup0x52_RF_B = (u1Byte)phy_query_rf_reg(pAdapter, ODM_RF_PATH_B, RF_0x52, 0x000F0); + pMptCtx->backup0x52_RF_A = (u8)phy_query_rf_reg(pAdapter, RF_PATH_A, RF_0x52, 0x000F0); + pMptCtx->backup0x52_RF_B = (u8)phy_query_rf_reg(pAdapter, RF_PATH_B, RF_0x52, 0x000F0); if ((PlatformEFIORead4Byte(pAdapter, 0xF4) & BIT29) == BIT29) { - phy_set_rf_reg(pAdapter, ODM_RF_PATH_A, RF_0x52, 0x000F0, 0xB); - phy_set_rf_reg(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_set_rf_reg(pAdapter, ODM_RF_PATH_A, RF_0x52, 0x000F0, 0xD); - phy_set_rf_reg(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_set_rf_reg(pAdapter, ODM_RF_PATH_A, RF_0x52, 0x000F0, 0xB); /*RF 0x52 = 0x0007E4BD*/ - phy_set_rf_reg(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_set_rf_reg(pAdapter, ODM_RF_PATH_A, RF_0x52, 0x000F0, 0x9); /*RF 0x52 = 0x0007E49D*/ - phy_set_rf_reg(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_set_rf_reg(pAdapter, ODM_RF_PATH_A, RF_0x52, 0x000F0, pMptCtx->backup0x52_RF_A); - phy_set_rf_reg(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); - struct PHY_DM_STRUCT *pDM_Odm = &(pHalData->odmpriv); + struct dm_struct *pDM_Odm = &(pHalData->odmpriv); if (!netif_running(padapter->pnetdev)) { @@ -131,7 +136,7 @@ s32 hal_mpt_SetPowerTracking(PADAPTER padapter, u8 enable) void hal_mpt_GetPowerTracking(PADAPTER padapter, u8 *enable) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); - struct PHY_DM_STRUCT *pDM_Odm = &(pHalData->odmpriv); + struct dm_struct *pDM_Odm = &(pHalData->odmpriv); *enable = pDM_Odm->rf_calibrate_info.txpowertrack_control; @@ -145,12 +150,13 @@ void hal_mpt_CCKTxPowerAdjust(PADAPTER Adapter, BOOLEAN bInCH14) u8 i; HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.mpt_ctx); - u1Byte u1Channel = pHalData->current_channel; - ULONG ulRateIdx = pMptCtx->mpt_rate_index; - u1Byte DataRate = 0xFF; + u8 u1Channel = pHalData->current_channel; + u32 ulRateIdx = pMptCtx->mpt_rate_index; + u8 DataRate = 0xFF; /* 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)) + if(IS_HARDWARE_TYPE_8822B(Adapter) || IS_HARDWARE_TYPE_8821C(Adapter) || + IS_HARDWARE_TYPE_8723D(Adapter) || IS_HARDWARE_TYPE_8192F(Adapter) || IS_HARDWARE_TYPE_8822C(Adapter)) return; DataRate = mpt_to_mgnt_rate(ulRateIdx); @@ -188,7 +194,7 @@ void hal_mpt_CCKTxPowerAdjust(PADAPTER Adapter, BOOLEAN bInCH14) pHalData->RegForRecover[i].value); } } - } else if (IS_HARDWARE_TYPE_8188F(Adapter)) { + } else if (IS_HARDWARE_TYPE_8188F(Adapter) || IS_HARDWARE_TYPE_8188GTV(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 */ @@ -313,9 +319,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); - struct PHY_DM_STRUCT *pDM_Odm = &(pHalData->odmpriv); + struct dm_struct *pDM_Odm = &(pHalData->odmpriv); struct mp_priv *pmp = &pAdapter->mppriv; u8 channel = pmp->channel; u8 bandwidth = pmp->bandwidth; @@ -324,9 +330,16 @@ void hal_mpt_SetChannel(PADAPTER pAdapter) pHalData->bSwChnl = _TRUE; pHalData->bSetChnlBW = _TRUE; - rtw_hal_set_chnl_bw(pAdapter, channel, bandwidth, 0, 0); + + if (bandwidth == 2) { + rtw_hal_set_chnl_bw(pAdapter, channel, bandwidth, HAL_PRIME_CHNL_OFFSET_LOWER, HAL_PRIME_CHNL_OFFSET_UPPER); + } else if (bandwidth == 1) { + rtw_hal_set_chnl_bw(pAdapter, channel, bandwidth, HAL_PRIME_CHNL_OFFSET_UPPER, 0); + } else + rtw_hal_set_chnl_bw(pAdapter, channel, bandwidth, pmp->prime_channel_offset, 0); hal_mpt_CCKTxPowerAdjust(pAdapter, pHalData->bCCKinCH14); + rtw_btcoex_wifionly_scan_notify(pAdapter); } @@ -344,36 +357,44 @@ void hal_mpt_SetBandwidth(PADAPTER pAdapter) pHalData->bSwChnl = _TRUE; pHalData->bSetChnlBW = _TRUE; - rtw_hal_set_chnl_bw(pAdapter, channel, bandwidth, 0, 0); + + if (bandwidth == 2) { + rtw_hal_set_chnl_bw(pAdapter, channel, bandwidth, HAL_PRIME_CHNL_OFFSET_LOWER, HAL_PRIME_CHNL_OFFSET_UPPER); + } else if (bandwidth == 1) { + rtw_hal_set_chnl_bw(pAdapter, channel, bandwidth, HAL_PRIME_CHNL_OFFSET_UPPER, 0); + } else + rtw_hal_set_chnl_bw(pAdapter, channel, bandwidth, pmp->prime_channel_offset, 0); hal_mpt_SwitchRfSetting(pAdapter); + rtw_btcoex_wifionly_scan_notify(pAdapter); + } void mpt_SetTxPower_Old(PADAPTER pAdapter, MPT_TXPWR_DEF Rate, u8 *pTxPower) { switch (Rate) { case MPT_CCK: { - u4Byte TxAGC = 0, pwr = 0; - u1Byte rf; + u32 TxAGC = 0, pwr = 0; + u8 rf; - pwr = pTxPower[ODM_RF_PATH_A]; + pwr = pTxPower[RF_PATH_A]; if (pwr < 0x3f) { TxAGC = (pwr << 16) | (pwr << 8) | (pwr); - phy_set_bb_reg(pAdapter, rTxAGC_A_CCK1_Mcs32, bMaskByte1, pTxPower[ODM_RF_PATH_A]); + 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_set_bb_reg(pAdapter, rTxAGC_B_CCK11_A_CCK2_11, bMaskByte0, pTxPower[ODM_RF_PATH_B]); + 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; case MPT_OFDM_AND_HT: { - u4Byte TxAGC = 0; - u1Byte pwr = 0, rf; + u32 TxAGC = 0; + u8 pwr = 0, rf; pwr = pTxPower[0]; if (pwr < 0x3f) { @@ -411,22 +432,23 @@ void mpt_SetTxPower( PADAPTER pAdapter, MPT_TXPWR_DEF Rate, - pu1Byte pTxPower + u8 *pTxPower ) { 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; + u8 path = 0 , i = 0, MaxRate = MGN_6M; + u8 StartPath = RF_PATH_A, EndPath = RF_PATH_B; if (IS_HARDWARE_TYPE_8814A(pAdapter)) - EndPath = ODM_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_D; + else if (IS_HARDWARE_TYPE_8188F(pAdapter) || IS_HARDWARE_TYPE_8188GTV(pAdapter) + || IS_HARDWARE_TYPE_8723D(pAdapter) || IS_HARDWARE_TYPE_8821C(pAdapter)) + EndPath = RF_PATH_A; switch (Rate) { case MPT_CCK: { - u1Byte rate[] = {MGN_1M, MGN_2M, MGN_5_5M, MGN_11M}; + u8 rate[] = {MGN_1M, MGN_2M, MGN_5_5M, MGN_11M}; for (path = StartPath; path <= EndPath; path++) for (i = 0; i < sizeof(rate); ++i) @@ -434,7 +456,7 @@ mpt_SetTxPower( } break; case MPT_OFDM: { - u1Byte rate[] = { + u8 rate[] = { MGN_6M, MGN_9M, MGN_12M, MGN_18M, MGN_24M, MGN_36M, MGN_48M, MGN_54M, }; @@ -445,7 +467,7 @@ mpt_SetTxPower( } break; case MPT_HT: { - u1Byte rate[] = { + u8 rate[] = { 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, @@ -470,7 +492,7 @@ mpt_SetTxPower( } break; case MPT_VHT: { - u1Byte rate[] = { + u8 rate[] = { 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_VHT1SS_MCS8, MGN_VHT1SS_MCS9, MGN_VHT2SS_MCS0, MGN_VHT2SS_MCS1, MGN_VHT2SS_MCS2, MGN_VHT2SS_MCS3, MGN_VHT2SS_MCS4, @@ -506,15 +528,17 @@ void hal_mpt_SetTxPower(PADAPTER pAdapter) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); - struct PHY_DM_STRUCT *pDM_Odm = &pHalData->odmpriv; + struct 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->antenna_tx_path == ANTENNA_A) ? (ODM_RF_PATH_A) : (ODM_RF_PATH_B); + IS_HARDWARE_TYPE_8188F(pAdapter) || + IS_HARDWARE_TYPE_8188GTV(pAdapter) + ) { + u8 path = (pHalData->antenna_tx_path == ANTENNA_A) ? (RF_PATH_A) : (RF_PATH_B); RTW_INFO("===> MPT_ProSetTxPower: Old\n"); @@ -522,15 +546,19 @@ void hal_mpt_SetTxPower(PADAPTER pAdapter) mpt_SetTxPower_Old(pAdapter, MPT_OFDM_AND_HT, pMptCtx->TxPwrLevel); } else { - RTW_INFO("===> MPT_ProSetTxPower: Jaguar/Jaguar2\n"); + mpt_SetTxPower(pAdapter, MPT_CCK, pMptCtx->TxPwrLevel); mpt_SetTxPower(pAdapter, MPT_OFDM, pMptCtx->TxPwrLevel); mpt_SetTxPower(pAdapter, MPT_HT, pMptCtx->TxPwrLevel); - mpt_SetTxPower(pAdapter, MPT_VHT, pMptCtx->TxPwrLevel); - + if(IS_HARDWARE_TYPE_JAGUAR_ALL(pAdapter)) { + RTW_INFO("===> MPT_ProSetTxPower: Jaguar/Jaguar2\n"); + mpt_SetTxPower(pAdapter, MPT_VHT, pMptCtx->TxPwrLevel); + } } + + rtw_hal_set_txpwr_done(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_clear_txpowertracking_state(pDM_Odm); } @@ -547,26 +575,26 @@ void hal_mpt_SetDataRate(PADAPTER pAdapter) hal_mpt_CCKTxPowerAdjust(pAdapter, pHalData->bCCKinCH14); #ifdef CONFIG_RTL8723B - if (IS_HARDWARE_TYPE_8723B(pAdapter) || IS_HARDWARE_TYPE_8188F(pAdapter)) { + if (IS_HARDWARE_TYPE_8723B(pAdapter)) { if (IS_CCK_RATE(DataRate)) { - if (pMptCtx->mpt_rf_path == ODM_RF_PATH_A) - phy_set_rf_reg(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_set_rf_reg(pAdapter, ODM_RF_PATH_A, 0x71, 0xF, 0x6); + phy_set_rf_reg(pAdapter, RF_PATH_A, 0x71, 0xF, 0x6); } else { - if (pMptCtx->mpt_rf_path == ODM_RF_PATH_A) - phy_set_rf_reg(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_set_rf_reg(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->mpt_rf_path == ODM_RF_PATH_A) - phy_set_rf_reg(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_set_rf_reg(pAdapter, ODM_RF_PATH_A, 0x71, 0xF, 0xE); + phy_set_rf_reg(pAdapter, RF_PATH_A, 0x71, 0xF, 0xE); } #endif } @@ -574,20 +602,20 @@ void hal_mpt_SetDataRate(PADAPTER pAdapter) #define RF_PATH_AB 22 #ifdef CONFIG_RTL8814A -VOID mpt_ToggleIG_8814A(PADAPTER pAdapter) +void mpt_ToggleIG_8814A(PADAPTER pAdapter) { - u1Byte Path = 0; - u4Byte IGReg = rA_IGI_Jaguar, IGvalue = 0; + u8 Path; + u32 IGReg = rA_IGI_Jaguar, IGvalue = 0; - for (Path; Path <= ODM_RF_PATH_D; Path++) { + for (Path = 0; 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: @@ -601,7 +629,7 @@ VOID mpt_ToggleIG_8814A(PADAPTER pAdapter) } } -VOID mpt_SetRFPath_8814A(PADAPTER pAdapter) +void mpt_SetRFPath_8814A(PADAPTER pAdapter) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); @@ -609,7 +637,6 @@ VOID mpt_SetRFPath_8814A(PADAPTER pAdapter) R_ANTENNA_SELECT_OFDM *p_ofdm_tx; /* OFDM Tx register */ R_ANTENNA_SELECT_CCK *p_cck_txrx; 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);*/ @@ -617,52 +644,29 @@ VOID mpt_SetRFPath_8814A(PADAPTER pAdapter) 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->mpt_rf_path = ODM_RF_PATH_BC; - /*pHalData->ValidTxPath = 0x06; linux no use */ - phy_set_bb_reg(pAdapter, rTxAnt_23Nsts_Jaguar2, 0x0000fff0, 0x106); /*/ 0x940[15:4]=12'b0000_0100_0011*/ - break; - - case ANTENNA_CD: - pMptCtx->mpt_rf_path = ODM_RF_PATH_CD; - /*pHalData->ValidTxPath = 0x0C;*/ - phy_set_bb_reg(pAdapter, rTxAnt_23Nsts_Jaguar2, 0x0000fff0, 0x40c); /*/ 0x940[15:4]=12'b0000_0100_0011*/ - break; - case ANTENNA_AB: - default: - pMptCtx->mpt_rf_path = ODM_RF_PATH_AB; - /*pHalData->ValidTxPath = 0x03;*/ - phy_set_bb_reg(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->mpt_rf_path = ODM_RF_PATH_BCD; + pMptCtx->mpt_rf_path = RF_PATH_BCD; /*pHalData->ValidTxPath = 0x0e;*/ phy_set_bb_reg(pAdapter, rTxAnt_23Nsts_Jaguar2, 0x0fff0000, 0x90e); /*/ 0x940[27:16]=12'b0010_0100_0111*/ break; case ANTENNA_ABC: default: - pMptCtx->mpt_rf_path = ODM_RF_PATH_ABC; + pMptCtx->mpt_rf_path = RF_PATH_ABC; /*pHalData->ValidTxPath = 0x0d;*/ 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->mpt_rf_path = ODM_RF_PATH_BCD; + pMptCtx->mpt_rf_path = RF_PATH_BCD; /*pHalData->ValidTxPath = 0x0e;*/ phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x7); phy_set_bb_reg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0x000f00000, 0xe); @@ -670,14 +674,14 @@ VOID mpt_SetRFPath_8814A(PADAPTER pAdapter) break; case ANTENNA_BC: - pMptCtx->mpt_rf_path = ODM_RF_PATH_BC; + pMptCtx->mpt_rf_path = RF_PATH_BC; /*pHalData->ValidTxPath = 0x06;*/ 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->mpt_rf_path = ODM_RF_PATH_B; + pMptCtx->mpt_rf_path = RF_PATH_B; /*pHalData->ValidTxPath = 0x02;*/ 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*/ @@ -685,7 +689,7 @@ VOID mpt_SetRFPath_8814A(PADAPTER pAdapter) break; case ANTENNA_C: - pMptCtx->mpt_rf_path = ODM_RF_PATH_C; + pMptCtx->mpt_rf_path = RF_PATH_C; /*pHalData->ValidTxPath = 0x04;*/ 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*/ @@ -693,7 +697,7 @@ VOID mpt_SetRFPath_8814A(PADAPTER pAdapter) break; case ANTENNA_D: - pMptCtx->mpt_rf_path = ODM_RF_PATH_D; + pMptCtx->mpt_rf_path = RF_PATH_D; /*pHalData->ValidTxPath = 0x08;*/ 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*/ @@ -702,7 +706,7 @@ VOID mpt_SetRFPath_8814A(PADAPTER pAdapter) case ANTENNA_A: default: - pMptCtx->mpt_rf_path = ODM_RF_PATH_A; + pMptCtx->mpt_rf_path = RF_PATH_A; /*pHalData->ValidTxPath = 0x01;*/ 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*/ @@ -714,14 +718,16 @@ VOID mpt_SetRFPath_8814A(PADAPTER pAdapter) switch (ulAntennaRx) { case ANTENNA_A: /*pHalData->ValidRxPath = 0x01;*/ + 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, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_A_0x0[19:16] = 3, RX mode*/ - phy_set_rf_reg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_0x0[19:16] = 1, Standby mode*/ - phy_set_rf_reg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_C_0x0[19:16] = 1, Standby mode*/ - phy_set_rf_reg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_D_0x0[19:16] = 1, Standby mode*/ + 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_set_bb_reg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); @@ -729,14 +735,16 @@ VOID mpt_SetRFPath_8814A(PADAPTER pAdapter) case ANTENNA_B: /*pHalData->ValidRxPath = 0x02;*/ + 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, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ - phy_set_rf_reg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_0x0[19:16] = 3, RX mode*/ - phy_set_rf_reg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_C_0x0[19:16] = 1, Standby mode*/ - phy_set_rf_reg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_D_0x0[19:16] = 1, Standby mode*/ + 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_set_bb_reg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); @@ -744,14 +752,16 @@ VOID mpt_SetRFPath_8814A(PADAPTER pAdapter) case ANTENNA_C: /*pHalData->ValidRxPath = 0x04;*/ + 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, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ - phy_set_rf_reg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_0x0[19:16] = 1, Standby mode*/ - phy_set_rf_reg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, RX mode*/ - phy_set_rf_reg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_D_0x0[19:16] = 1, Standby mode*/ + 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_set_bb_reg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); @@ -759,14 +769,16 @@ VOID mpt_SetRFPath_8814A(PADAPTER pAdapter) case ANTENNA_D: /*pHalData->ValidRxPath = 0x08;*/ + 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, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ - phy_set_rf_reg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_0x0[19:16] = 1, Standby mode*/ - phy_set_rf_reg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_C_0x0[19:16] = 1, Standby mode*/ - phy_set_rf_reg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_D_0x0[19:16] = 3, RX mode*/ + 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_set_bb_reg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); @@ -774,14 +786,16 @@ VOID mpt_SetRFPath_8814A(PADAPTER pAdapter) case ANTENNA_BC: /*pHalData->ValidRxPath = 0x06;*/ + 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, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ - phy_set_rf_reg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_0x0[19:16] = 3, RX mode*/ - phy_set_rf_reg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, Rx mode*/ - phy_set_rf_reg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_D_0x0[19:16] = 1, Standby mode*/ + 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_set_bb_reg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); @@ -789,14 +803,16 @@ VOID mpt_SetRFPath_8814A(PADAPTER pAdapter) case ANTENNA_CD: /*pHalData->ValidRxPath = 0x0C;*/ + 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, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ - phy_set_rf_reg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_0x0[19:16] = 1, Standby mode*/ - phy_set_rf_reg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, Rx mode*/ - phy_set_rf_reg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_D_0x0[19:16] = 3, RX mode*/ + 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_set_bb_reg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); @@ -804,14 +820,16 @@ VOID mpt_SetRFPath_8814A(PADAPTER pAdapter) case ANTENNA_BCD: /*pHalData->ValidRxPath = 0x0e;*/ + 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, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ - phy_set_rf_reg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_0x0[19:16] = 3, RX mode*/ - phy_set_rf_reg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, RX mode*/ - phy_set_rf_reg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_D_0x0[19:16] = 3, Rx mode*/ + 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_set_bb_reg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x3); phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0x8); @@ -819,14 +837,16 @@ VOID mpt_SetRFPath_8814A(PADAPTER pAdapter) case ANTENNA_ABCD: /*pHalData->ValidRxPath = 0x0f;*/ + 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, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_A_0x0[19:16] = 3, RX mode*/ - phy_set_rf_reg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_0x0[19:16] = 3, RX mode*/ - phy_set_rf_reg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, RX mode*/ - phy_set_rf_reg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_D_0x0[19:16] = 3, RX mode*/ + 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_set_bb_reg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x3); phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0x8); @@ -841,17 +861,17 @@ VOID mpt_SetRFPath_8814A(PADAPTER pAdapter) mpt_ToggleIG_8814A(pAdapter); } #endif /* CONFIG_RTL8814A */ -#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) -VOID +#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822C) +void mpt_SetSingleTone_8814A( - IN PADAPTER pAdapter, - IN BOOLEAN bSingleTone, - IN BOOLEAN bEnPMacTx) + PADAPTER pAdapter, + BOOLEAN bSingleTone, + BOOLEAN bEnPMacTx) { PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); - u1Byte StartPath = ODM_RF_PATH_A, EndPath = ODM_RF_PATH_A; - static u4Byte regIG0 = 0, regIG1 = 0, regIG2 = 0, regIG3 = 0; + u8 StartPath = RF_PATH_A, EndPath = RF_PATH_A, path; + static u32 regIG0 = 0, regIG1 = 0, regIG2 = 0, regIG3 = 0; if (bSingleTone) { regIG0 = phy_query_bb_reg(pAdapter, rA_TxScale_Jaguar, bMaskDWord); /*/ 0xC1C[31:21]*/ @@ -860,29 +880,29 @@ mpt_SetSingleTone_8814A( regIG3 = phy_query_bb_reg(pAdapter, rD_TxScale_Jaguar2, bMaskDWord); /*/ 0x1A1C[31:21]*/ switch (pMptCtx->mpt_rf_path) { - case ODM_RF_PATH_A: - case ODM_RF_PATH_B: - case ODM_RF_PATH_C: - case ODM_RF_PATH_D: + 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; } @@ -893,11 +913,11 @@ mpt_SetSingleTone_8814A( phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x1); /*/ Disable CCA*/ - for (StartPath; StartPath <= EndPath; StartPath++) { - 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*/ + for (path = StartPath; path <= EndPath; path++) { + phy_set_rf_reg(pAdapter, path, RF_AC_Jaguar, 0xF0000, 0x2); /*/ Tx mode: RF0x00[19:16]=4'b0010 */ + phy_set_rf_reg(pAdapter, path, RF_AC_Jaguar, 0x1F, 0x0); /*/ Lowest RF gain index: RF_0x0[4:0] = 0*/ - phy_set_rf_reg(pAdapter, StartPath, lna_low_gain_3, BIT1, 0x1); /*/ RF LO enabled*/ + phy_set_rf_reg(pAdapter, path, lna_low_gain_3, BIT1, 0x1); /*/ RF LO enabled*/ } phy_set_bb_reg(pAdapter, rA_TxScale_Jaguar, 0xFFE00000, 0); /*/ 0xC1C[31:21]*/ @@ -906,33 +926,33 @@ mpt_SetSingleTone_8814A( phy_set_bb_reg(pAdapter, rD_TxScale_Jaguar2, 0xFFE00000, 0); /*/ 0x1A1C[31:21]*/ } else { switch (pMptCtx->mpt_rf_path) { - case ODM_RF_PATH_A: - case ODM_RF_PATH_B: - case ODM_RF_PATH_C: - case ODM_RF_PATH_D: + 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_set_rf_reg(pAdapter, StartPath, lna_low_gain_3, BIT1, 0x0); /* RF LO disabled */ + for (path = StartPath; path <= EndPath; path++) + phy_set_rf_reg(pAdapter, path, lna_low_gain_3, BIT1, 0x0); /* RF LO disabled */ phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x0); /* Enable CCA*/ @@ -964,25 +984,25 @@ void mpt_SetRFPath_8812A(PADAPTER pAdapter) switch (ulAntennaTx) { case ANTENNA_A: - pMptCtx->mpt_rf_path = ODM_RF_PATH_A; + 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->mpt_rf_path = ODM_RF_PATH_B; + 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->mpt_rf_path = ODM_RF_PATH_AB; + 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->mpt_rf_path = ODM_RF_PATH_AB; + pMptCtx->mpt_rf_path = RF_PATH_AB; RTW_INFO("Unknown Tx antenna.\n"); break; } @@ -991,9 +1011,9 @@ void mpt_SetRFPath_8812A(PADAPTER pAdapter) u32 reg0xC50 = 0; case ANTENNA_A: phy_set_bb_reg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x11); - phy_set_rf_reg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_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_bb_reg(pAdapter, rCCK_RX_Jaguar, bCCK_RX_Jaguar, 0x0); - phy_set_rf_reg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, BIT19 | BIT18 | BIT17 | BIT16, 0x3); + 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_query_bb_reg(pAdapter, rA_IGI_Jaguar, bMaskByte0); @@ -1017,9 +1037,9 @@ void mpt_SetRFPath_8812A(PADAPTER pAdapter) break; case ANTENNA_B: phy_set_bb_reg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x22); - phy_set_rf_reg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1);/*/ RF_A_0x0[19:16] = 1, Standby mode */ + 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, ODM_RF_PATH_B, RF_AC_Jaguar, BIT19 | BIT18 | BIT17 | BIT16, 0x3); + 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_query_bb_reg(pAdapter, rB_IGI_Jaguar, bMaskByte0); @@ -1043,7 +1063,7 @@ void mpt_SetRFPath_8812A(PADAPTER pAdapter) break; case ANTENNA_AB: phy_set_bb_reg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x33); - phy_set_rf_reg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_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_bb_reg(pAdapter, rCCK_RX_Jaguar, bCCK_RX_Jaguar, 0x0); /* set PWED_TH for BB Yn user guide R29 */ phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x04); @@ -1052,6 +1072,18 @@ void mpt_SetRFPath_8812A(PADAPTER pAdapter) 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 @@ -1061,13 +1093,13 @@ void mpt_SetRFPath_8723B(PADAPTER pAdapter) HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); u32 ulAntennaTx, ulAntennaRx; 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); + struct dm_struct *pDM_Odm = &pHalData->odmpriv; + struct dm_rf_calibration_struct *pRFCalibrateInfo = &(pDM_Odm->rf_calibrate_info); 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; } @@ -1075,19 +1107,13 @@ 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->mpt_rf_path = ODM_RF_PATH_A; + 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_set_rf_reg(pAdapter, ODM_RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B10E); - else - phy_set_rf_reg(pAdapter, ODM_RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B04E); - for (i = 0; i < 3; ++i) { - u4Byte offset = pRFCalibrateInfo->tx_iqc_8723b[ODM_RF_PATH_A][i][0]; - u4Byte data = pRFCalibrateInfo->tx_iqc_8723b[ODM_RF_PATH_A][i][1]; + u32 offset = pRFCalibrateInfo->tx_iqc_8723b[RF_PATH_A][i][0]; + u32 data = pRFCalibrateInfo->tx_iqc_8723b[RF_PATH_A][i][1]; if (offset != 0) { phy_set_bb_reg(pAdapter, offset, bMaskDWord, data); @@ -1095,8 +1121,8 @@ void mpt_SetRFPath_8723B(PADAPTER pAdapter) } } for (i = 0; i < 2; ++i) { - u4Byte offset = pRFCalibrateInfo->rx_iqc_8723b[ODM_RF_PATH_A][i][0]; - u4Byte data = pRFCalibrateInfo->rx_iqc_8723b[ODM_RF_PATH_A][i][1]; + u32 offset = pRFCalibrateInfo->rx_iqc_8723b[RF_PATH_A][i][0]; + u32 data = pRFCalibrateInfo->rx_iqc_8723b[RF_PATH_A][i][1]; if (offset != 0) { phy_set_bb_reg(pAdapter, offset, bMaskDWord, data); @@ -1106,32 +1132,27 @@ void mpt_SetRFPath_8723B(PADAPTER pAdapter) } break; case ANTENNA_B: { /*/ Actually path S0 (BT)*/ - u4Byte offset; - u4Byte data; + u32 offset; + u32 data; - pMptCtx->mpt_rf_path = ODM_RF_PATH_B; + 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_set_rf_reg(pAdapter, ODM_RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B10E); - else - phy_set_rf_reg(pAdapter, ODM_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->tx_iqc_8723b[ODM_RF_PATH_A][i][0]; - data = pRFCalibrateInfo->tx_iqc_8723b[ODM_RF_PATH_B][i][1]; - if (pRFCalibrateInfo->tx_iqc_8723b[ODM_RF_PATH_B][i][0] != 0) { + 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->rx_iqc_8723b[ODM_RF_PATH_A][i][0]; - data = pRFCalibrateInfo->rx_iqc_8723b[ODM_RF_PATH_B][i][1]; - if (pRFCalibrateInfo->rx_iqc_8723b[ODM_RF_PATH_B][i][0] != 0) { + 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); } @@ -1149,30 +1170,30 @@ void mpt_SetRFPath_8723B(PADAPTER pAdapter) void mpt_SetRFPath_8703B(PADAPTER pAdapter) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - u4Byte ulAntennaTx, ulAntennaRx; + u32 ulAntennaTx, ulAntennaRx; 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); + struct dm_struct *pDM_Odm = &pHalData->odmpriv; + struct dm_rf_calibration_struct *pRFCalibrateInfo = &(pDM_Odm->rf_calibrate_info); 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; } switch (pAdapter->mppriv.antenna_tx) { - u1Byte p = 0, i = 0; + u8 p = 0, i = 0; case ANTENNA_A: { /* Actually path S1 (Wi-Fi) */ - pMptCtx->mpt_rf_path = ODM_RF_PATH_A; + 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->tx_iqc_8703b[i][0]; - u4Byte data = pRFCalibrateInfo->tx_iqc_8703b[i][1]; + u32 offset = pRFCalibrateInfo->tx_iqc_8703b[i][0]; + u32 data = pRFCalibrateInfo->tx_iqc_8703b[i][1]; if (offset != 0) { phy_set_bb_reg(pAdapter, offset, bMaskDWord, data); @@ -1181,8 +1202,8 @@ void mpt_SetRFPath_8703B(PADAPTER pAdapter) } for (i = 0; i < 2; ++i) { - u4Byte offset = pRFCalibrateInfo->rx_iqc_8703b[i][0]; - u4Byte data = pRFCalibrateInfo->rx_iqc_8703b[i][1]; + u32 offset = pRFCalibrateInfo->rx_iqc_8703b[i][0]; + u32 data = pRFCalibrateInfo->rx_iqc_8703b[i][1]; if (offset != 0) { phy_set_bb_reg(pAdapter, offset, bMaskDWord, data); @@ -1192,13 +1213,13 @@ void mpt_SetRFPath_8703B(PADAPTER pAdapter) } break; case ANTENNA_B: { /* Actually path S0 (BT)*/ - pMptCtx->mpt_rf_path = ODM_RF_PATH_B; + 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->tx_iqc_8703b[i][0]; - u4Byte data = pRFCalibrateInfo->tx_iqc_8703b[i][1]; + u32 offset = pRFCalibrateInfo->tx_iqc_8703b[i][0]; + u32 data = pRFCalibrateInfo->tx_iqc_8703b[i][1]; if (pRFCalibrateInfo->tx_iqc_8703b[i][0] != 0) { phy_set_bb_reg(pAdapter, offset, bMaskDWord, data); @@ -1206,8 +1227,8 @@ void mpt_SetRFPath_8703B(PADAPTER pAdapter) } } for (i = 0; i < 2; ++i) { - u4Byte offset = pRFCalibrateInfo->rx_iqc_8703b[i][0]; - u4Byte data = pRFCalibrateInfo->rx_iqc_8703b[i][1]; + u32 offset = pRFCalibrateInfo->rx_iqc_8703b[i][0]; + u32 data = pRFCalibrateInfo->rx_iqc_8703b[i][1]; if (pRFCalibrateInfo->rx_iqc_8703b[i][0] != 0) { phy_set_bb_reg(pAdapter, offset, bMaskDWord, data); @@ -1228,16 +1249,16 @@ void mpt_SetRFPath_8703B(PADAPTER pAdapter) 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; + u8 p = 0, i = 0; + u32 ulAntennaTx, ulAntennaRx, offset = 0, data = 0, val32 = 0; 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); + struct dm_struct *pDM_Odm = &pHalData->odmpriv; + struct dm_rf_calibration_struct *pRFCalibrateInfo = &(pDM_Odm->rf_calibrate_info); 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; } @@ -1245,13 +1266,13 @@ void mpt_SetRFPath_8723D(PADAPTER pAdapter) switch (pAdapter->mppriv.antenna_tx) { /* Actually path S1 (Wi-Fi) */ case ANTENNA_A: { - pMptCtx->mpt_rf_path = ODM_RF_PATH_A; + 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->mpt_rf_path = ODM_RF_PATH_B; + pMptCtx->mpt_rf_path = RF_PATH_B; phy_set_bb_reg(pAdapter, rS0S1_PathSwitch, BIT9|BIT8|BIT7|BIT6, 0xA); } @@ -1263,16 +1284,16 @@ void mpt_SetRFPath_8723D(PADAPTER pAdapter) } #endif -VOID mpt_SetRFPath_819X(PADAPTER pAdapter) +void mpt_SetRFPath_819X(PADAPTER pAdapter) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); - u4Byte ulAntennaTx, ulAntennaRx; + u32 ulAntennaTx, ulAntennaRx; R_ANTENNA_SELECT_OFDM *p_ofdm_tx; /* OFDM Tx register */ R_ANTENNA_SELECT_CCK *p_cck_txrx; - u1Byte r_rx_antenna_ofdm = 0, r_ant_select_cck_val = 0; - u1Byte chgTx = 0, chgRx = 0; - u4Byte r_ant_sel_cck_val = 0, r_ant_select_ofdm_val = 0, r_ofdm_tx_en_val = 0; + u8 r_rx_antenna_ofdm = 0, r_ant_select_cck_val = 0; + u8 chgTx = 0, chgRx = 0; + u32 r_ant_sel_cck_val = 0, r_ant_select_ofdm_val = 0, r_ofdm_tx_en_val = 0; ulAntennaTx = pHalData->antenna_tx_path; ulAntennaRx = pHalData->AntennaRxPath; @@ -1310,7 +1331,7 @@ VOID mpt_SetRFPath_819X(PADAPTER pAdapter) phy_set_bb_reg(pAdapter, rFPGA0_XAB_RFParameter, BIT17, 0); } } - pMptCtx->mpt_rf_path = ODM_RF_PATH_A; + pMptCtx->mpt_rf_path = RF_PATH_A; break; case ANTENNA_B: p_ofdm_tx->r_tx_antenna = 0x2; @@ -1337,7 +1358,7 @@ VOID mpt_SetRFPath_819X(PADAPTER pAdapter) phy_set_bb_reg(pAdapter, rFPGA0_XAB_RFParameter, BIT17, 1); } } - pMptCtx->mpt_rf_path = ODM_RF_PATH_B; + pMptCtx->mpt_rf_path = RF_PATH_B; break; case ANTENNA_AB:/*/ For 8192S*/ p_ofdm_tx->r_tx_antenna = 0x3; @@ -1364,7 +1385,7 @@ VOID mpt_SetRFPath_819X(PADAPTER pAdapter) phy_set_bb_reg(pAdapter, rFPGA0_XAB_RFParameter, BIT17, 1); } } - pMptCtx->mpt_rf_path = ODM_RF_PATH_AB; + pMptCtx->mpt_rf_path = RF_PATH_AB; break; default: break; @@ -1422,11 +1443,76 @@ VOID mpt_SetRFPath_819X(PADAPTER pAdapter) } } /* MPT_ProSetRFPath */ +#ifdef CONFIG_RTL8192F + +void mpt_set_rfpath_8192f(PADAPTER pAdapter) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); + PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); + + u16 ForcedDataRate = mpt_to_mgnt_rate(pMptCtx->mpt_rate_index); + u8 NssforRate, odmNssforRate; + u32 ulAntennaTx, ulAntennaRx; + u8 RxAntToPhyDm; + u8 TxAntToPhyDm; + + ulAntennaTx = pHalData->antenna_tx_path; + ulAntennaRx = pHalData->AntennaRxPath; + NssforRate = MgntQuery_NssTxRate(ForcedDataRate); + + if (pHalData->rf_chip >= RF_TYPE_MAX) + RTW_INFO("This RF chip ID is not supported\n"); + + switch (ulAntennaTx) { + case ANTENNA_A: + pMptCtx->mpt_rf_path = RF_PATH_A; + TxAntToPhyDm = BB_PATH_A; + break; + case ANTENNA_B: + pMptCtx->mpt_rf_path = RF_PATH_B; + TxAntToPhyDm = BB_PATH_B; + break; + case ANTENNA_AB: + pMptCtx->mpt_rf_path = RF_PATH_AB; + TxAntToPhyDm = (BB_PATH_A|BB_PATH_B); + break; + default: + pMptCtx->mpt_rf_path = RF_PATH_AB; + TxAntToPhyDm = (BB_PATH_A|BB_PATH_B); + break; + } + + switch (ulAntennaRx) { + case ANTENNA_A: + RxAntToPhyDm = BB_PATH_A; + break; + case ANTENNA_B: + RxAntToPhyDm = BB_PATH_B; + break; + case ANTENNA_AB: + RxAntToPhyDm = (BB_PATH_A|BB_PATH_B); + break; + default: + RxAntToPhyDm = (BB_PATH_A|BB_PATH_B); + break; + } + + config_phydm_trx_mode_8192f(GET_PDM_ODM(pAdapter), TxAntToPhyDm, RxAntToPhyDm, FALSE); + +} + +#endif void hal_mpt_SetAntenna(PADAPTER pAdapter) { RTW_INFO("Do %s\n", __func__); +#ifdef CONFIG_RTL8822C + if (IS_HARDWARE_TYPE_8822C(pAdapter)) { + rtl8822c_mp_config_rfpath(pAdapter); + return; + } +#endif #ifdef CONFIG_RTL8814A if (IS_HARDWARE_TYPE_8814A(pAdapter)) { mpt_SetRFPath_8814A(pAdapter); @@ -1471,6 +1557,14 @@ void hal_mpt_SetAntenna(PADAPTER pAdapter) return; } #endif + +#ifdef CONFIG_RTL8192F + if (IS_HARDWARE_TYPE_8192F(pAdapter)) { + mpt_set_rfpath_8192f(pAdapter); + return; + } +#endif + /* else if (IS_HARDWARE_TYPE_8821B(pAdapter)) mpt_SetRFPath_8821B(pAdapter); Prepare for 8822B @@ -1509,23 +1603,49 @@ s32 hal_mpt_SetThermalMeter(PADAPTER pAdapter, u8 target_ther) void hal_mpt_TriggerRFThermalMeter(PADAPTER pAdapter) { - phy_set_rf_reg(pAdapter, ODM_RF_PATH_A, 0x42, BIT17 | BIT16, 0x03); + if (IS_HARDWARE_TYPE_JAGUAR3(pAdapter)) { + phy_set_rf_reg(pAdapter, RF_PATH_A, 0x42, BIT19, 0x1); + phy_set_rf_reg(pAdapter, RF_PATH_A, 0x42, BIT19, 0x0); + phy_set_rf_reg(pAdapter, RF_PATH_A, 0x42, BIT19, 0x1); + } else + phy_set_rf_reg(pAdapter, RF_PATH_A, 0x42, BIT17 | BIT16, 0x03); } -u8 hal_mpt_ReadRFThermalMeter(PADAPTER pAdapter) +u8 hal_mpt_ReadRFThermalMeter(PADAPTER pAdapter, u8 rf_path) { + struct dm_struct *p_dm_odm = adapter_to_phydm(pAdapter); + u32 ThermalValue = 0; + s32 thermal_value_temp = 0; + s8 thermal_offset = 0; + u32 thermal_reg_mask = 0; + + if (IS_8822C_SERIES(GET_HAL_DATA(pAdapter)->version_id)) + thermal_reg_mask = 0x007e; /*0x42: RF Reg[6:1], 35332(themal K & bias k & power trim) & 35325(tssi )*/ + else + thermal_reg_mask = 0xfc00; /*0x42: RF Reg[15:10]*/ + + ThermalValue = (u8)phy_query_rf_reg(pAdapter, rf_path, 0x42, thermal_reg_mask); + + 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_query_rf_reg(pAdapter, ODM_RF_PATH_A, 0x42, 0xfc00); /*0x42: RF Reg[15:10]*/ return (u8)ThermalValue; - } -void hal_mpt_GetThermalMeter(PADAPTER pAdapter, u8 *value) +void hal_mpt_GetThermalMeter(PADAPTER pAdapter, u8 rfpath, u8 *value) { #if 0 fw_cmd(pAdapter, IOCMD_GET_THERMAL_METER); @@ -1535,7 +1655,7 @@ void hal_mpt_GetThermalMeter(PADAPTER pAdapter, u8 *value) #else hal_mpt_TriggerRFThermalMeter(pAdapter); rtw_msleep_os(1000); - *value = hal_mpt_ReadRFThermalMeter(pAdapter); + *value = hal_mpt_ReadRFThermalMeter(pAdapter, rfpath); #endif } @@ -1561,7 +1681,7 @@ void hal_mpt_SetSingleCarrierTx(PADAPTER pAdapter, u8 bStart) /*/ 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)) + if (IS_HARDWARE_TYPE_JAGUAR_ALL(pAdapter)) 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 */ @@ -1572,7 +1692,7 @@ void hal_mpt_SetSingleCarrierTx(PADAPTER pAdapter, u8 bStart) /*/ Stop Single Carrier.*/ /*/ 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)) + if (IS_HARDWARE_TYPE_JAGUAR_ALL(pAdapter)) 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 */ @@ -1590,23 +1710,31 @@ void hal_mpt_SetSingleToneTx(PADAPTER pAdapter, u8 bStart) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); 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; + struct dm_struct *pDM_Odm = &pHalData->odmpriv; + u32 ulAntennaTx = pHalData->antenna_tx_path; + static u32 regRF = 0, regBB0 = 0, regBB1 = 0, regBB2 = 0, regBB3 = 0; u8 rfPath; + if (IS_HARDWARE_TYPE_JAGUAR3(pAdapter)) { +#ifdef PHYDM_MP_SUPPORT + phydm_mp_set_single_tone(pDM_Odm, bStart, pMptCtx->mpt_rf_path); +#endif + return; + } + 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; } @@ -1616,7 +1744,7 @@ void hal_mpt_SetSingleToneTx(PADAPTER pAdapter, u8 bStart) /*/ <20120326, Kordan> To amplify the power of tone for Xtal calibration. (asked by Edlu)*/ if (IS_HARDWARE_TYPE_8188E(pAdapter)) { regRF = phy_query_rf_reg(pAdapter, rfPath, lna_low_gain_3, bRFRegOffsetMask); - phy_set_rf_reg(pAdapter, ODM_RF_PATH_A, lna_low_gain_3, BIT1, 0x1); /*/ RF LO enabled*/ + 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.*/ @@ -1624,41 +1752,53 @@ void hal_mpt_SetSingleToneTx(PADAPTER pAdapter, u8 bStart) 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_8192F(pAdapter)) { /* USB need to do RF LO disable first, PCIE isn't required to follow this order.*/ + #ifdef CONFIG_RTL8192F + phy_set_mac_reg(pAdapter, REG_LEDCFG0_8192F, BIT23, 0x1); + phy_set_mac_reg(pAdapter, REG_LEDCFG0_8192F, BIT26, 0x1); + phy_set_mac_reg(pAdapter, REG_PAD_CTRL1_8192F, BIT7, 0x1); + phy_set_mac_reg(pAdapter, REG_PAD_CTRL1_8192F, BIT1, 0x1); + phy_set_mac_reg(pAdapter, REG_PAD_CTRL1_8192F, BIT0, 0x1); + phy_set_mac_reg(pAdapter, REG_AFE_CTRL_4_8192F, BIT16, 0x1); + phy_set_bb_reg(pAdapter, 0x88C, 0xF00000, 0xF); + phy_set_rf_reg(pAdapter, pMptCtx->mpt_rf_path, 0x57, BIT1, 0x1); /* RF LO disabled*/ + phy_set_rf_reg(pAdapter, pMptCtx->mpt_rf_path, RF_AC, 0xF0000, 0x2); /* Tx mode*/ +#endif } else if (IS_HARDWARE_TYPE_8723B(pAdapter)) { - if (pMptCtx->mpt_rf_path == ODM_RF_PATH_A) { - phy_set_rf_reg(pAdapter, ODM_RF_PATH_A, RF_AC, 0xF0000, 0x2); /*/ Tx mode*/ - phy_set_rf_reg(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_set_rf_reg(pAdapter, ODM_RF_PATH_A, RF_AC, 0xF0000, 0x2); /*/ Tx mode*/ - phy_set_rf_reg(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->mpt_rf_path == ODM_RF_PATH_A) { - phy_set_rf_reg(pAdapter, ODM_RF_PATH_A, RF_AC, 0xF0000, 0x2); /* Tx mode */ - phy_set_rf_reg(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)) { + } else if (IS_HARDWARE_TYPE_8188F(pAdapter) || IS_HARDWARE_TYPE_8188GTV(pAdapter)) { /*Set BB REG 88C: Prevent SingleTone Fail*/ 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->mpt_rf_path == ODM_RF_PATH_A) { + if (pMptCtx->mpt_rf_path == RF_PATH_A) { phy_set_bb_reg(pAdapter, rFPGA0_RFMOD, bCCKEn|bOFDMEn, 0); - phy_set_rf_reg(pAdapter, ODM_RF_PATH_A, RF_AC, BIT16, 0x0); - phy_set_rf_reg(pAdapter, ODM_RF_PATH_A, 0x53, BIT0, 0x1); + 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_set_bb_reg(pAdapter, rFPGA0_RFMOD, bCCKEn|bOFDMEn, 0); - phy_set_rf_reg(pAdapter, ODM_RF_PATH_A, RF_AC, BIT16, 0x0); - phy_set_rf_reg(pAdapter, ODM_RF_PATH_A, 0x63, BIT0, 0x1); + 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) - u1Byte p = ODM_RF_PATH_A; + } else if (IS_HARDWARE_TYPE_JAGUAR(pAdapter) || IS_HARDWARE_TYPE_8822B(pAdapter) || IS_HARDWARE_TYPE_8821C(pAdapter)) { +#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) + u8 p = RF_PATH_A; - regRF = phy_query_rf_reg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, bRFRegOffsetMask); + 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); @@ -1666,8 +1806,8 @@ void hal_mpt_SetSingleToneTx(PADAPTER pAdapter, u8 bStart) phy_set_bb_reg(pAdapter, rOFDMCCKEN_Jaguar, BIT29 | BIT28, 0x0); /*/ Disable CCK and OFDM*/ - if (pMptCtx->mpt_rf_path == ODM_RF_PATH_AB) { - for (p = ODM_RF_PATH_A; p <= ODM_RF_PATH_B; ++p) { + 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*/ @@ -1675,26 +1815,49 @@ void hal_mpt_SetSingleToneTx(PADAPTER pAdapter, u8 bStart) } else { 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*/ +#ifdef CONFIG_RTL8821C + if (IS_HARDWARE_TYPE_8821C(pAdapter) && pDM_Odm->current_rf_set_8821c == SWITCH_TO_BTG) + phy_set_rf_reg(pAdapter, pMptCtx->mpt_rf_path, 0x75, BIT16, 0x1); /* RF LO (for BTG) enabled */ + else +#endif + phy_set_rf_reg(pAdapter, pMptCtx->mpt_rf_path, lna_low_gain_3, BIT1, 0x1); /*/ RF LO enabled*/ } + if (IS_HARDWARE_TYPE_8822B(pAdapter)) { + phy_set_bb_reg(pAdapter, rA_RFE_Pinmux_Jaguar, bMaskDWord, 0x77777777); /* 0xCB0=0x77777777*/ + phy_set_bb_reg(pAdapter, rB_RFE_Pinmux_Jaguar, bMaskDWord, 0x77777777); /* 0xEB0=0x77777777*/ + phy_set_bb_reg(pAdapter, rA_RFE_Pinmux_Jaguar + 4, bMaskLWord, 0x7777); /* 0xCB4[15:0] = 0x7777*/ + phy_set_bb_reg(pAdapter, rB_RFE_Pinmux_Jaguar + 4, bMaskLWord, 0x7777); /* 0xEB4[15:0] = 0x7777*/ + phy_set_bb_reg(pAdapter, rA_RFE_Inverse_Jaguar, 0xFFF, 0xb); /* 0xCBC[23:16] = 0x12*/ + phy_set_bb_reg(pAdapter, rB_RFE_Inverse_Jaguar, 0xFFF, 0x830); /* 0xEBC[23:16] = 0x12*/ + } else if (IS_HARDWARE_TYPE_8821C(pAdapter)) { + phy_set_bb_reg(pAdapter, rA_RFE_Pinmux_Jaguar, 0xF0F0, 0x707); /* 0xCB0[[15:12, 7:4] = 0x707*/ - 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->external_pa_5g) + { + phy_set_bb_reg(pAdapter, rA_RFE_Pinmux_Jaguar + 4, 0xA00000, 0x1); /* 0xCB4[23, 21] = 0x1*/ + } + else if (pHalData->ExternalPA_2G) + { + phy_set_bb_reg(pAdapter, rA_RFE_Pinmux_Jaguar + 4, 0xA00000, 0x1); /* 0xCB4[23, 21] = 0x1*/ + } + } else { + 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->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_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*/ + 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_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 } -#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8821C) - else if (IS_HARDWARE_TYPE_8814A(pAdapter) || IS_HARDWARE_TYPE_8821C(pAdapter)) +#if defined(CONFIG_RTL8814A) + else if (IS_HARDWARE_TYPE_8814A(pAdapter)) mpt_SetSingleTone_8814A(pAdapter, TRUE, FALSE); #endif - else /*/ Turn On SingleTone and turn off the other test modes.*/ phy_set_bb_reg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_SingleTone); @@ -1704,7 +1867,7 @@ void hal_mpt_SetSingleToneTx(PADAPTER pAdapter, u8 bStart) } else {/*/ Stop Single Ton e.*/ if (IS_HARDWARE_TYPE_8188E(pAdapter)) { - phy_set_rf_reg(pAdapter, ODM_RF_PATH_A, lna_low_gain_3, bRFRegOffsetMask, regRF); + 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)) { @@ -1712,48 +1875,65 @@ void hal_mpt_SetSingleToneTx(PADAPTER pAdapter, u8 bStart) 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_set_mac_reg(pAdapter, 0x88C, 0xF00000, 0x0); + } else if (IS_HARDWARE_TYPE_8192F(pAdapter)){ +#ifdef CONFIG_RTL8192F + phy_set_mac_reg(pAdapter, REG_LEDCFG0_8192F, BIT23, 0x0); + phy_set_mac_reg(pAdapter, REG_LEDCFG0_8192F, BIT26, 0x0); + phy_set_mac_reg(pAdapter, REG_PAD_CTRL1_8192F, BIT7, 0x0); + phy_set_mac_reg(pAdapter, REG_PAD_CTRL1_8192F, BIT1, 0x0); + phy_set_mac_reg(pAdapter, REG_PAD_CTRL1_8192F, BIT0, 0x0); + phy_set_mac_reg(pAdapter, REG_AFE_CTRL_4_8192F, BIT16, 0x0); + phy_set_bb_reg(pAdapter, 0x88C, 0xF00000, 0x0); + phy_set_rf_reg(pAdapter, pMptCtx->mpt_rf_path, 0x57, BIT1, 0x0); /* RF LO disabled*/ + phy_set_rf_reg(pAdapter, pMptCtx->mpt_rf_path, RF_AC, 0xF0000, 0x3); /* Rx mode*/ +#endif } else if (IS_HARDWARE_TYPE_8723B(pAdapter)) { - if (pMptCtx->mpt_rf_path == ODM_RF_PATH_A) { - phy_set_rf_reg(pAdapter, ODM_RF_PATH_A, RF_AC, 0xF0000, 0x3); /*/ Rx mode*/ - phy_set_rf_reg(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_set_rf_reg(pAdapter, ODM_RF_PATH_A, RF_AC, 0xF0000, 0x3); /*/ Rx mode*/ - phy_set_rf_reg(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->mpt_rf_path == ODM_RF_PATH_A) { - phy_set_rf_reg(pAdapter, ODM_RF_PATH_A, RF_AC, 0xF0000, 0x3); /* Rx mode */ - phy_set_rf_reg(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)) { + } else if (IS_HARDWARE_TYPE_8188F(pAdapter) || IS_HARDWARE_TYPE_8188GTV(pAdapter)) { 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_set_bb_reg(pAdapter, rFPGA0_AnalogParameter4, 0xF00000, 0xc); } else if (IS_HARDWARE_TYPE_8723D(pAdapter)) { - if (pMptCtx->mpt_rf_path == ODM_RF_PATH_A) { + if (pMptCtx->mpt_rf_path == RF_PATH_A) { phy_set_bb_reg(pAdapter, rFPGA0_RFMOD, bCCKEn|bOFDMEn, 0x3); - phy_set_rf_reg(pAdapter, ODM_RF_PATH_A, RF_AC, BIT16, 0x1); - phy_set_rf_reg(pAdapter, ODM_RF_PATH_A, 0x53, BIT0, 0x0); + 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_set_bb_reg(pAdapter, rFPGA0_RFMOD, bCCKEn|bOFDMEn, 0x3); - phy_set_rf_reg(pAdapter, ODM_RF_PATH_A, RF_AC, BIT16, 0x1); - phy_set_rf_reg(pAdapter, ODM_RF_PATH_A, 0x63, BIT0, 0x0); + 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) - u1Byte p = ODM_RF_PATH_A; + } else if (IS_HARDWARE_TYPE_JAGUAR(pAdapter) || IS_HARDWARE_TYPE_8822B(pAdapter) || IS_HARDWARE_TYPE_8821C(pAdapter)) { +#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) + u8 p = RF_PATH_A; phy_set_bb_reg(pAdapter, rOFDMCCKEN_Jaguar, BIT29 | BIT28, 0x3); /*/ Disable CCK and OFDM*/ - if (pMptCtx->mpt_rf_path == ODM_RF_PATH_AB) { - for (p = ODM_RF_PATH_A; p <= ODM_RF_PATH_B; ++p) { + 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 { + p = pMptCtx->mpt_rf_path; phy_set_rf_reg(pAdapter, p, RF_AC_Jaguar, bRFRegOffsetMask, regRF); + + if (IS_HARDWARE_TYPE_8821C(pAdapter)) + phy_set_rf_reg(pAdapter, p, 0x75, BIT16, 0x0); /* RF LO (for BTG) disabled */ + phy_set_rf_reg(pAdapter, p, lna_low_gain_3, BIT1, 0x0); /*/ RF LO disabled*/ } @@ -1761,10 +1941,16 @@ void hal_mpt_SetSingleToneTx(PADAPTER pAdapter, u8 bStart) 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); + + if (IS_HARDWARE_TYPE_8822B(pAdapter)) { + RTW_INFO("Restore RFE control Pin cbc\n"); + phy_set_bb_reg(pAdapter, rA_RFE_Inverse_Jaguar, 0xfff, 0x0); + phy_set_bb_reg(pAdapter, rB_RFE_Inverse_Jaguar, 0xfff, 0x0); + } #endif } -#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) - else if (IS_HARDWARE_TYPE_8814A(pAdapter) || IS_HARDWARE_TYPE_8821C(pAdapter)) +#if defined(CONFIG_RTL8814A) + else if (IS_HARDWARE_TYPE_8814A(pAdapter)) mpt_SetSingleTone_8814A(pAdapter, FALSE, FALSE); else/*/ Turn off all test modes.*/ @@ -1778,10 +1964,19 @@ void hal_mpt_SetSingleToneTx(PADAPTER pAdapter, u8 bStart) void hal_mpt_SetCarrierSuppressionTx(PADAPTER pAdapter, u8 bStart) { + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); + struct dm_struct *pdm_odm = &pHalData->odmpriv; u8 Rate; pAdapter->mppriv.mpt_ctx.is_carrier_suppression = bStart; + if (IS_HARDWARE_TYPE_JAGUAR3(pAdapter)) { +#ifdef PHYDM_MP_SUPPORT + phydm_mp_set_carrier_supp(pdm_odm, bStart, pAdapter->mppriv.rateidx); +#endif + return; + } + Rate = HwRateToMPTRate(pAdapter->mppriv.rateidx); if (bStart) {/* Start Carrier Suppression.*/ if (Rate <= MPT_RATE_11M) { @@ -1790,7 +1985,7 @@ void hal_mpt_SetCarrierSuppressionTx(PADAPTER pAdapter, u8 bStart) write_bbreg(pAdapter, rFPGA0_RFMOD, bCCKEn, bEnable);/*set CCK block on*/ /*/Turn Off All Test Mode*/ - if (IS_HARDWARE_TYPE_JAGUAR(pAdapter) || IS_HARDWARE_TYPE_8814A(pAdapter) /*|| IS_HARDWARE_TYPE_8822B(pAdapter)*/) + if (IS_HARDWARE_TYPE_JAGUAR_ALL(pAdapter)) phy_set_bb_reg(pAdapter, 0x914, BIT18 | BIT17 | BIT16, OFDM_ALL_OFF); /* rSingleTone_ContTx_Jaguar*/ else phy_set_bb_reg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ALL_OFF); @@ -1827,12 +2022,26 @@ u32 hal_mpt_query_phytxok(PADAPTER pAdapter) { PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); RT_PMAC_TX_INFO PMacTxInfo = pMptCtx->PMacTxInfo; + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); u16 count = 0; +#ifdef PHYDM_MP_SUPPORT + struct dm_struct *dm = (struct dm_struct *)&pHalData->odmpriv; + struct phydm_mp *mp = &dm->dm_mp_table; + + if (IS_HARDWARE_TYPE_JAGUAR3(pAdapter)) { + phydm_mp_get_tx_ok(&pHalData->odmpriv, pAdapter->mppriv.rateidx); + count = mp->tx_phy_ok_cnt; + + } else +#endif + { + if (IS_MPT_CCK_RATE(PMacTxInfo.TX_RATE)) count = phy_query_bb_reg(pAdapter, 0xF50, bMaskLWord); /* [15:0]*/ else count = phy_query_bb_reg(pAdapter, 0xF50, bMaskHWord); /* [31:16]*/ + } if (count > 50000) { rtw_reset_phy_trx_ok_counters(pAdapter); @@ -1844,13 +2053,13 @@ u32 hal_mpt_query_phytxok(PADAPTER pAdapter) } -static VOID mpt_StopCckContTx( +static void mpt_StopCckContTx( PADAPTER pAdapter ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); - u1Byte u1bReg; + u8 u1bReg; pMptCtx->bCckContTx = FALSE; pMptCtx->bOfdmContTx = FALSE; @@ -1858,7 +2067,7 @@ static VOID mpt_StopCckContTx( 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_JAGUAR2(pAdapter)) { + if (!IS_HARDWARE_TYPE_JAGUAR_ALL(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*/ @@ -1871,32 +2080,41 @@ static VOID mpt_StopCckContTx( phy_set_bb_reg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); phy_set_bb_reg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); + if (!IS_HARDWARE_TYPE_JAGUAR_ALL(pAdapter)) { phy_set_bb_reg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); phy_set_bb_reg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); + } + + if (IS_HARDWARE_TYPE_8188E(pAdapter) || IS_HARDWARE_TYPE_8723B(pAdapter) || + IS_HARDWARE_TYPE_8703B(pAdapter) || IS_HARDWARE_TYPE_8188F(pAdapter) || + IS_HARDWARE_TYPE_8723D(pAdapter) || IS_HARDWARE_TYPE_8192F(pAdapter) || + IS_HARDWARE_TYPE_8821C(pAdapter) || IS_HARDWARE_TYPE_8188GTV(pAdapter)) { + phy_set_bb_reg(pAdapter, 0xA70, BIT(14), bDisable);/* patch Count CCK adjust Rate*/ + } } /* mpt_StopCckContTx */ -static VOID mpt_StopOfdmContTx( +static void mpt_StopOfdmContTx( PADAPTER pAdapter ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); - u1Byte u1bReg; - u4Byte data; + u8 u1bReg; + u32 data; pMptCtx->bCckContTx = FALSE; pMptCtx->bOfdmContTx = FALSE; - if (IS_HARDWARE_TYPE_JAGUAR(pAdapter) || IS_HARDWARE_TYPE_JAGUAR2(pAdapter)) + if (IS_HARDWARE_TYPE_JAGUAR_ALL(pAdapter)) phy_set_bb_reg(pAdapter, 0x914, BIT18 | BIT17 | BIT16, OFDM_ALL_OFF); else 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)) { + if (!IS_HARDWARE_TYPE_JAGUAR_ALL(pAdapter)){ phy_set_bb_reg(pAdapter, 0xa14, 0x300, 0x0); /* 0xa15[1:0] = 0*/ phy_set_bb_reg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x0); /* 0xc08[16] = 0*/ } @@ -1905,25 +2123,27 @@ static VOID mpt_StopOfdmContTx( phy_set_bb_reg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); phy_set_bb_reg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); + if (!IS_HARDWARE_TYPE_JAGUAR_ALL(pAdapter)) { phy_set_bb_reg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); phy_set_bb_reg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); + } } /* mpt_StopOfdmContTx */ -static VOID mpt_StartCckContTx( +static void mpt_StartCckContTx( PADAPTER pAdapter ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); - u4Byte cckrate; + u32 cckrate; /* 1. if 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)) + if (IS_HARDWARE_TYPE_JAGUAR_ALL(pAdapter)) phy_set_bb_reg(pAdapter, 0x914, BIT18 | BIT17 | BIT16, OFDM_ALL_OFF); else phy_set_bb_reg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ALL_OFF); @@ -1935,7 +2155,7 @@ static VOID mpt_StartCckContTx( 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)) { + if (!IS_HARDWARE_TYPE_JAGUAR_ALL(pAdapter)) { 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); @@ -1943,8 +2163,20 @@ static VOID mpt_StartCckContTx( phy_set_bb_reg(pAdapter, 0x0B34, BIT14, 1); } - phy_set_bb_reg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); - phy_set_bb_reg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); + if (!IS_HARDWARE_TYPE_JAGUAR_ALL(pAdapter)) { + phy_set_bb_reg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); + phy_set_bb_reg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); + } + + if (IS_HARDWARE_TYPE_8188E(pAdapter) || IS_HARDWARE_TYPE_8723B(pAdapter) || + IS_HARDWARE_TYPE_8703B(pAdapter) || IS_HARDWARE_TYPE_8188F(pAdapter) || + IS_HARDWARE_TYPE_8723D(pAdapter) || IS_HARDWARE_TYPE_8192F(pAdapter) || + IS_HARDWARE_TYPE_8821C(pAdapter) || IS_HARDWARE_TYPE_8188GTV(pAdapter)) { + if (pAdapter->mppriv.rateidx == MPT_RATE_1M) /* patch Count CCK adjust Rate*/ + phy_set_bb_reg(pAdapter, 0xA70, BIT(14), bDisable); + else + phy_set_bb_reg(pAdapter, 0xA70, BIT(14), bEnable); + } pMptCtx->bCckContTx = TRUE; pMptCtx->bOfdmContTx = FALSE; @@ -1952,7 +2184,7 @@ static VOID mpt_StartCckContTx( } /* mpt_StartCckContTx */ -static VOID mpt_StartOfdmContTx( +static void mpt_StartOfdmContTx( PADAPTER pAdapter ) { @@ -1969,36 +2201,68 @@ static VOID mpt_StartOfdmContTx( /* 3. turn on scramble setting*/ phy_set_bb_reg(pAdapter, rCCK0_System, bCCKScramble, 1); - if (!IS_HARDWARE_TYPE_JAGUAR(pAdapter) && !IS_HARDWARE_TYPE_JAGUAR2(pAdapter)) { + if (!IS_HARDWARE_TYPE_JAGUAR_ALL(pAdapter)) { 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)) + if (IS_HARDWARE_TYPE_JAGUAR_ALL(pAdapter)) phy_set_bb_reg(pAdapter, 0x914, BIT18 | BIT17 | BIT16, OFDM_ContinuousTx); else phy_set_bb_reg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ContinuousTx); + if (!IS_HARDWARE_TYPE_JAGUAR_ALL(pAdapter)) { 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) || defined(CONFIG_RTL8822C) +#ifdef PHYDM_PMAC_TX_SETTING_SUPPORT +static void mpt_convert_phydm_txinfo_for_jaguar3( + RT_PMAC_TX_INFO pMacTxInfo, struct phydm_pmac_info *phydmtxinfo) +{ + phydmtxinfo->en_pmac_tx = pMacTxInfo.bEnPMacTx; + phydmtxinfo->mode = pMacTxInfo.Mode; + phydmtxinfo->tx_rate = MRateToHwRate(mpt_to_mgnt_rate(pMacTxInfo.TX_RATE)); + phydmtxinfo->tx_sc = pMacTxInfo.TX_SC; + phydmtxinfo->is_short_preamble = pMacTxInfo.bSPreamble; + phydmtxinfo->ndp_sound = pMacTxInfo.NDP_sound; + phydmtxinfo->bw = pMacTxInfo.BandWidth; + phydmtxinfo->m_stbc = pMacTxInfo.m_STBC; + phydmtxinfo->packet_period = pMacTxInfo.PacketPeriod; + phydmtxinfo->packet_count = pMacTxInfo.PacketCount; + phydmtxinfo->packet_pattern = pMacTxInfo.PacketPattern; + phydmtxinfo->sfd = pMacTxInfo.SFD; + phydmtxinfo->signal_field = pMacTxInfo.SignalField; + phydmtxinfo->service_field = pMacTxInfo.ServiceField; + phydmtxinfo->length = pMacTxInfo.LENGTH; + _rtw_memcpy(&phydmtxinfo->crc16,pMacTxInfo.CRC16, 2); + _rtw_memcpy(&phydmtxinfo->lsig , pMacTxInfo.LSIG,3); + _rtw_memcpy(&phydmtxinfo->ht_sig , pMacTxInfo.HT_SIG,6); + _rtw_memcpy(&phydmtxinfo->vht_sig_a , pMacTxInfo.VHT_SIG_A,6); + _rtw_memcpy(&phydmtxinfo->vht_sig_b , pMacTxInfo.VHT_SIG_B,4); + phydmtxinfo->vht_sig_b_crc = pMacTxInfo.VHT_SIG_B_CRC; + _rtw_memcpy(&phydmtxinfo->vht_delimiter,pMacTxInfo.VHT_Delimiter,4); +} +#endif -#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8821B) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) /* for HW TX mode */ void mpt_ProSetPMacTx(PADAPTER Adapter) { + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.mpt_ctx); + struct mp_priv *pmppriv = &Adapter->mppriv; RT_PMAC_TX_INFO PMacTxInfo = pMptCtx->PMacTxInfo; u32 u4bTmp; + struct dm_struct *p_dm_odm; + + p_dm_odm = &pHalData->odmpriv; - 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); @@ -2007,46 +2271,71 @@ void mpt_ProSetPMacTx(PADAPTER Adapter) 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); - PRINT_DATA("Dest Address", PMacTxInfo.MacAddress, 6); + PRINT_DATA("Src Address", Adapter->mac_addr, ETH_ALEN); + PRINT_DATA("Dest Address", PMacTxInfo.MacAddress, ETH_ALEN); #endif + if (pmppriv->pktInterval != 0) + PMacTxInfo.PacketPeriod = pmppriv->pktInterval; + + if (pmppriv->tx.count != 0) + PMacTxInfo.PacketCount = pmppriv->tx.count; + + RTW_INFO("SGI %d bSPreamble %d bSTBC %d bLDPC %d NDP_sound %d\n", PMacTxInfo.bSGI, PMacTxInfo.bSPreamble, PMacTxInfo.bSTBC, PMacTxInfo.bLDPC, PMacTxInfo.NDP_sound); + RTW_INFO("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 (IS_HARDWARE_TYPE_JAGUAR3(Adapter)) { +#ifdef PHYDM_PMAC_TX_SETTING_SUPPORT + struct phydm_pmac_info phydm_mactxinfo; + + mpt_convert_phydm_txinfo_for_jaguar3(PMacTxInfo, &phydm_mactxinfo); + phydm_set_pmac_tx(p_dm_odm, &phydm_mactxinfo, pMptCtx->mpt_rf_path); +#endif + return; + } if (PMacTxInfo.bEnPMacTx == FALSE) { - if (PMacTxInfo.Mode == CONTINUOUS_TX) { + if (pMptCtx->HWTxmode == CONTINUOUS_TX) { phy_set_bb_reg(Adapter, 0xb04, 0xf, 2); /* TX Stop*/ - if (IS_MPT_CCK_RATE(PMacTxInfo.TX_RATE)) + if (IS_MPT_CCK_RATE(pMptCtx->mpt_rate_index)) mpt_StopCckContTx(Adapter); else mpt_StopOfdmContTx(Adapter); - } else if (IS_MPT_CCK_RATE(PMacTxInfo.TX_RATE)) { + } else if (IS_MPT_CCK_RATE(pMptCtx->mpt_rate_index)) { 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_set_bb_reg(Adapter, 0xb04, 0xf, 2); /* TX Stop*/ - if (PMacTxInfo.Mode == OFDM_Single_Tone_TX) { + if (pMptCtx->HWTxmode == OFDM_Single_Tone_TX) { /* Stop HW TX -> Stop Continuous TX -> Stop RF Setting*/ - if (IS_MPT_CCK_RATE(PMacTxInfo.TX_RATE)) + if (IS_MPT_CCK_RATE(pMptCtx->mpt_rate_index)) mpt_StopCckContTx(Adapter); else mpt_StopOfdmContTx(Adapter); mpt_SetSingleTone_8814A(Adapter, FALSE, TRUE); } - + pMptCtx->HWTxmode = TEST_NONE; return; } + pMptCtx->mpt_rate_index = PMacTxInfo.TX_RATE; + if (PMacTxInfo.Mode == CONTINUOUS_TX) { + pMptCtx->HWTxmode = CONTINUOUS_TX; PMacTxInfo.PacketCount = 1; + hal_mpt_SetTxPower(Adapter); + if (IS_MPT_CCK_RATE(PMacTxInfo.TX_RATE)) mpt_StartCckContTx(Adapter); else mpt_StartOfdmContTx(Adapter); } else if (PMacTxInfo.Mode == OFDM_Single_Tone_TX) { /* Continuous TX -> HW TX -> RF Setting */ + pMptCtx->HWTxmode = OFDM_Single_Tone_TX; PMacTxInfo.PacketCount = 1; if (IS_MPT_CCK_RATE(PMacTxInfo.TX_RATE)) @@ -2054,6 +2343,7 @@ void mpt_ProSetPMacTx(PADAPTER Adapter) else mpt_StartOfdmContTx(Adapter); } else if (PMacTxInfo.Mode == PACKETS_TX) { + pMptCtx->HWTxmode = PACKETS_TX; if (IS_MPT_CCK_RATE(PMacTxInfo.TX_RATE) && PMacTxInfo.PacketCount == 0) PMacTxInfo.PacketCount = 0xffff; } @@ -2160,8 +2450,8 @@ void mpt_ProSetPMacTx(PADAPTER Adapter) u4bTmp = (PMacTxInfo.TX_SC) | ((PMacTxInfo.BandWidth) << 4) | ((PMacTxInfo.m_STBC - 1) << 6) | ((PMacTxInfo.NDP_sound) << 8); phy_set_bb_reg(Adapter, 0xb4c, 0x1ff, u4bTmp); - if (IS_HARDWARE_TYPE_8814A(Adapter) || IS_HARDWARE_TYPE_8822B(Adapter)) { - u4Byte offset = 0xb44; + if (IS_HARDWARE_TYPE_JAGUAR2(Adapter)) { + u32 offset = 0xb44; if (IS_MPT_OFDM_RATE(PMacTxInfo.TX_RATE)) phy_set_bb_reg(Adapter, offset, 0xc0000000, 0); @@ -2169,6 +2459,16 @@ void mpt_ProSetPMacTx(PADAPTER Adapter) phy_set_bb_reg(Adapter, offset, 0xc0000000, 1); else if (IS_MPT_VHT_RATE(PMacTxInfo.TX_RATE)) phy_set_bb_reg(Adapter, offset, 0xc0000000, 2); + + } else if(IS_HARDWARE_TYPE_JAGUAR(Adapter)) { + u32 offset = 0xb4c; + + if(IS_MPT_OFDM_RATE(PMacTxInfo.TX_RATE)) + phy_set_bb_reg(Adapter, offset, 0xc0000000, 0); + else if(IS_MPT_HT_RATE(PMacTxInfo.TX_RATE)) + phy_set_bb_reg(Adapter, offset, 0xc0000000, 1); + else if(IS_MPT_VHT_RATE(PMacTxInfo.TX_RATE)) + phy_set_bb_reg(Adapter, offset, 0xc0000000, 2); } phy_set_bb_reg(Adapter, 0xb00, BIT8, 1); /* Turn on PMAC*/ @@ -2190,8 +2490,7 @@ void hal_mpt_SetContinuousTx(PADAPTER pAdapter, u8 bStart) { u8 Rate; - RT_TRACE(_module_mp_, _drv_info_, - ("SetContinuousTx: rate:%d\n", pAdapter->mppriv.rateidx)); + RTW_INFO("SetContinuousTx: rate:%d\n", pAdapter->mppriv.rateidx); Rate = HwRateToMPTRate(pAdapter->mppriv.rateidx); pAdapter->mppriv.mpt_ctx.is_start_cont_tx = bStart; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_phy.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_phy.c index 5c87dbb43c7c..ae806ececf3a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_phy.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/hal_phy.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,32 +12,21 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 -/* ******************************************************************************** - * Constant. - * ******************************************************************************** - * 2008/11/20 MH For Debug only, RF */ -static RF_SHADOW_T RF_Shadow[RF6052_MAX_PATH][RF6052_MAX_REG]; - /** * Function: PHY_CalculateBitShift * * OverView: Get shifted position of the BitMask * * Input: -* u4Byte BitMask, +* u32 BitMask, * * Output: none -* Return: u4Byte Return the shift bit bit position of the mask +* Return: u32 Return the shift bit bit position of the mask */ u32 PHY_CalculateBitShift( @@ -54,6 +44,13 @@ PHY_CalculateBitShift( } +#ifdef CONFIG_RF_SHADOW_RW +/* ******************************************************************************** + * Constant. + * ******************************************************************************** + * 2008/11/20 MH For Debug only, RF */ +static RF_SHADOW_T RF_Shadow[RF6052_MAX_PATH][RF6052_MAX_REG]; + /* * ==> RF shadow Operation API Code Section!!! * @@ -84,21 +81,21 @@ PHY_CalculateBitShift( *---------------------------------------------------------------------------*/ u32 PHY_RFShadowRead( - IN PADAPTER Adapter, - IN u8 eRFPath, - IN u32 Offset) + PADAPTER Adapter, + enum rf_path eRFPath, + u32 Offset) { return RF_Shadow[eRFPath][Offset].Value; } /* PHY_RFShadowRead */ -VOID +void PHY_RFShadowWrite( - IN PADAPTER Adapter, - IN u8 eRFPath, - IN u32 Offset, - IN u32 Data) + PADAPTER Adapter, + enum rf_path eRFPath, + u32 Offset, + u32 Data) { RF_Shadow[eRFPath][Offset].Value = (Data & bRFRegOffsetMask); RF_Shadow[eRFPath][Offset].Driver_Write = _TRUE; @@ -108,9 +105,9 @@ PHY_RFShadowWrite( BOOLEAN PHY_RFShadowCompare( - IN PADAPTER Adapter, - IN u8 eRFPath, - IN u32 Offset) + PADAPTER Adapter, + enum rf_path eRFPath, + u32 Offset) { u32 reg; /* Check if we need to check the register */ @@ -127,11 +124,11 @@ PHY_RFShadowCompare( } /* PHY_RFShadowCompare */ -VOID +void PHY_RFShadowRecorver( - IN PADAPTER Adapter, - IN u8 eRFPath, - IN u32 Offset) + PADAPTER Adapter, + enum rf_path eRFPath, + u32 Offset) { /* Check if the address is error */ if (RF_Shadow[eRFPath][Offset].ErrorOrNot == _TRUE) { @@ -145,11 +142,11 @@ PHY_RFShadowRecorver( } /* PHY_RFShadowRecorver */ -VOID +void PHY_RFShadowCompareAll( - IN PADAPTER Adapter) + 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++) { @@ -160,11 +157,11 @@ PHY_RFShadowCompareAll( } /* PHY_RFShadowCompareAll */ -VOID +void PHY_RFShadowRecorverAll( - IN PADAPTER Adapter) + 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++) { @@ -175,12 +172,12 @@ PHY_RFShadowRecorverAll( } /* PHY_RFShadowRecorverAll */ -VOID +void PHY_RFShadowCompareFlagSet( - IN PADAPTER Adapter, - IN u8 eRFPath, - IN u32 Offset, - IN u8 Type) + PADAPTER Adapter, + enum rf_path eRFPath, + u32 Offset, + u8 Type) { /* Set True or False!!! */ RF_Shadow[eRFPath][Offset].Compare = Type; @@ -188,12 +185,12 @@ PHY_RFShadowCompareFlagSet( } /* PHY_RFShadowCompareFlagSet */ -VOID +void PHY_RFShadowRecorverFlagSet( - IN PADAPTER Adapter, - IN u8 eRFPath, - IN u32 Offset, - IN u8 Type) + PADAPTER Adapter, + enum rf_path eRFPath, + u32 Offset, + u8 Type) { /* Set True or False!!! */ RF_Shadow[eRFPath][Offset].Recorver = Type; @@ -201,11 +198,11 @@ PHY_RFShadowRecorverFlagSet( } /* PHY_RFShadowRecorverFlagSet */ -VOID +void PHY_RFShadowCompareFlagSetAll( - IN PADAPTER Adapter) + 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++) { @@ -221,11 +218,11 @@ PHY_RFShadowCompareFlagSetAll( } /* PHY_RFShadowCompareFlagSetAll */ -VOID +void PHY_RFShadowRecorverFlagSetAll( - IN PADAPTER Adapter) + 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++) { @@ -240,11 +237,11 @@ PHY_RFShadowRecorverFlagSetAll( } /* PHY_RFShadowCompareFlagSetAll */ -VOID +void PHY_RFShadowRefresh( - IN PADAPTER Adapter) + 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++) { @@ -258,3 +255,4 @@ PHY_RFShadowRefresh( } } /* PHY_RFShadowRead */ +#endif /*CONFIG_RF_SHADOW_RW*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/led/hal_led.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/led/hal_led.c new file mode 100644 index 000000000000..7a68107c67f8 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/led/hal_led.c @@ -0,0 +1,255 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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 + +#ifdef CONFIG_RTW_LED +void dump_led_config(void *sel, _adapter *adapter) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + struct led_priv *ledpriv = adapter_to_led(adapter); + int i; + + RTW_PRINT_SEL(sel, "strategy:%u\n", ledpriv->LedStrategy); +#ifdef CONFIG_RTW_SW_LED + RTW_PRINT_SEL(sel, "bRegUseLed:%u\n", ledpriv->bRegUseLed); + RTW_PRINT_SEL(sel, "iface_en_mask:0x%02X\n", ledpriv->iface_en_mask); + for (i = 0; i < dvobj->iface_nums; i++) + RTW_PRINT_SEL(sel, "ctl_en_mask[%d]:0x%08X\n", i, ledpriv->ctl_en_mask[i]); +#endif +} + +void rtw_led_set_strategy(_adapter *adapter, u8 strategy) +{ + struct led_priv *ledpriv = adapter_to_led(adapter); + _adapter *pri_adapter = GET_PRIMARY_ADAPTER(adapter); + +#ifndef CONFIG_RTW_SW_LED + if (IS_SW_LED_STRATEGY(strategy)) { + RTW_WARN("CONFIG_RTW_SW_LED is not defined\n"); + return; + } +#endif + +#ifdef CONFIG_RTW_SW_LED + if (!ledpriv->bRegUseLed) + return; +#endif + + if (ledpriv->LedStrategy == strategy) + return; + + if (IS_HW_LED_STRATEGY(strategy) || IS_HW_LED_STRATEGY(ledpriv->LedStrategy)) { + RTW_WARN("switching on/off HW_LED strategy is not supported\n"); + return; + } + + ledpriv->LedStrategy = strategy; + +#ifdef CONFIG_RTW_SW_LED + rtw_hal_sw_led_deinit(pri_adapter); +#endif + + rtw_led_control(pri_adapter, RTW_LED_OFF); +} + +#ifdef CONFIG_RTW_SW_LED +#if CONFIG_RTW_SW_LED_TRX_DA_CLASSIFY +void rtw_sw_led_blink_uc_trx_only(LED_DATA *led) +{ + _adapter *adapter = led->padapter; + BOOLEAN bStopBlinking = _FALSE; + + if (led->BlinkingLedState == RTW_LED_ON) + SwLedOn(adapter, led); + else + SwLedOff(adapter, led); + + switch (led->CurrLedState) { + case RTW_LED_ON: + SwLedOn(adapter, led); + break; + + case RTW_LED_OFF: + SwLedOff(adapter, led); + break; + + case LED_BLINK_TXRX: + led->BlinkTimes--; + if (led->BlinkTimes == 0) + bStopBlinking = _TRUE; + + if (adapter_to_pwrctl(adapter)->rf_pwrstate != rf_on + && adapter_to_pwrctl(adapter)->rfoff_reason > RF_CHANGE_BY_PS + ) { + SwLedOff(adapter, led); + led->bLedBlinkInProgress = _FALSE; + } else { + if (led->bLedOn) + led->BlinkingLedState = RTW_LED_OFF; + else + led->BlinkingLedState = RTW_LED_ON; + + if (bStopBlinking) { + led->CurrLedState = RTW_LED_OFF; + led->bLedBlinkInProgress = _FALSE; + } + _set_timer(&(led->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); + } + break; + + default: + break; + } +} + +void rtw_sw_led_ctl_mode_uc_trx_only(_adapter *adapter, LED_CTL_MODE ctl) +{ + struct led_priv *ledpriv = adapter_to_led(adapter); + LED_DATA *led = &(ledpriv->SwLed0); + LED_DATA *led1 = &(ledpriv->SwLed1); + LED_DATA *led2 = &(ledpriv->SwLed2); + + switch (ctl) { + case LED_CTL_UC_TX: + case LED_CTL_UC_RX: + if (led->bLedBlinkInProgress == _FALSE) { + led->bLedBlinkInProgress = _TRUE; + led->CurrLedState = LED_BLINK_TXRX; + led->BlinkTimes = 2; + if (led->bLedOn) + led->BlinkingLedState = RTW_LED_OFF; + else + led->BlinkingLedState = RTW_LED_ON; + _set_timer(&(led->BlinkTimer), LED_BLINK_FASTER_INTERVAL_ALPHA); + } + break; + + case LED_CTL_POWER_OFF: + led->CurrLedState = RTW_LED_OFF; + led->BlinkingLedState = RTW_LED_OFF; + + if (led->bLedBlinkInProgress) { + _cancel_timer_ex(&(led->BlinkTimer)); + led->bLedBlinkInProgress = _FALSE; + } + + SwLedOff(adapter, led); + SwLedOff(adapter, led1); + SwLedOff(adapter, led2); + break; + + default: + break; + } +} +#endif /* CONFIG_RTW_SW_LED_TRX_DA_CLASSIFY */ + +void rtw_led_control(_adapter *adapter, LED_CTL_MODE ctl) +{ + struct led_priv *ledpriv = adapter_to_led(adapter); + + if (ledpriv->LedControlHandler) { + #if CONFIG_RTW_SW_LED_TRX_DA_CLASSIFY + if (ledpriv->LedStrategy != SW_LED_MODE_UC_TRX_ONLY) { + if (ctl == LED_CTL_UC_TX || ctl == LED_CTL_BMC_TX) { + if (ledpriv->ctl_en_mask[adapter->iface_id] & BIT(LED_CTL_TX)) + ctl = LED_CTL_TX; /* transform specific TX ctl to general TX ctl */ + } else if (ctl == LED_CTL_UC_RX || ctl == LED_CTL_BMC_RX) { + if (ledpriv->ctl_en_mask[adapter->iface_id] & BIT(LED_CTL_RX)) + ctl = LED_CTL_RX; /* transform specific RX ctl to general RX ctl */ + } + } + #endif + + if ((ledpriv->iface_en_mask & BIT(adapter->iface_id)) + && (ledpriv->ctl_en_mask[adapter->iface_id] & BIT(ctl))) + ledpriv->LedControlHandler(adapter, ctl); + } +} + +void rtw_led_tx_control(_adapter *adapter, const u8 *da) +{ +#if CONFIG_RTW_SW_LED_TRX_DA_CLASSIFY + if (IS_MCAST(da)) + rtw_led_control(adapter, LED_CTL_BMC_TX); + else + rtw_led_control(adapter, LED_CTL_UC_TX); +#else + rtw_led_control(adapter, LED_CTL_TX); +#endif +} + +void rtw_led_rx_control(_adapter *adapter, const u8 *da) +{ +#if CONFIG_RTW_SW_LED_TRX_DA_CLASSIFY + if (IS_MCAST(da)) + rtw_led_control(adapter, LED_CTL_BMC_RX); + else + rtw_led_control(adapter, LED_CTL_UC_RX); +#else + rtw_led_control(adapter, LED_CTL_RX); +#endif +} + +void rtw_led_set_iface_en(_adapter *adapter, u8 en) +{ + struct led_priv *ledpriv = adapter_to_led(adapter); + + if (en) + ledpriv->iface_en_mask |= BIT(adapter->iface_id); + else + ledpriv->iface_en_mask &= ~BIT(adapter->iface_id); +} + +void rtw_led_set_iface_en_mask(_adapter *adapter, u8 mask) +{ + struct led_priv *ledpriv = adapter_to_led(adapter); + + ledpriv->iface_en_mask = mask; +} + +void rtw_led_set_ctl_en_mask(_adapter *adapter, u32 ctl_mask) +{ + struct led_priv *ledpriv = adapter_to_led(adapter); + +#if CONFIG_RTW_SW_LED_TRX_DA_CLASSIFY + if (ctl_mask & BIT(LED_CTL_TX)) + ctl_mask |= BIT(LED_CTL_UC_TX) | BIT(LED_CTL_BMC_TX); + if (ctl_mask & BIT(LED_CTL_RX)) + ctl_mask |= BIT(LED_CTL_UC_RX) | BIT(LED_CTL_BMC_RX); +#endif + + ledpriv->ctl_en_mask[adapter->iface_id] = ctl_mask; +} + +void rtw_led_set_ctl_en_mask_primary(_adapter *adapter) +{ + rtw_led_set_ctl_en_mask(adapter, 0xFFFFFFFF); +} + +void rtw_led_set_ctl_en_mask_virtual(_adapter *adapter) +{ + rtw_led_set_ctl_en_mask(adapter + , BIT(LED_CTL_POWER_ON) | BIT(LED_CTL_POWER_OFF) + | BIT(LED_CTL_TX) | BIT(LED_CTL_RX) + ); +} +#endif /* CONFIG_RTW_SW_LED */ + +#endif /* CONFIG_RTW_LED */ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/led/hal_usb_led.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/led/hal_usb_led.c index 099ea74a594f..0933d49eec14 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/led/hal_usb_led.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/led/hal_usb_led.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,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: @@ -123,7 +120,7 @@ SwLedBlink1( { _adapter *padapter = pLed->padapter; PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); - struct led_priv *ledpriv = &(padapter->ledpriv); + struct led_priv *ledpriv = adapter_to_led(padapter); struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); PLED_USB pLed1 = &(ledpriv->SwLed1); u8 bStopBlinking = _FALSE; @@ -511,7 +508,7 @@ SwLedBlink4( ) { _adapter *padapter = pLed->padapter; - struct led_priv *ledpriv = &(padapter->ledpriv); + struct led_priv *ledpriv = adapter_to_led(padapter); struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); PLED_USB pLed1 = &(ledpriv->SwLed1); u8 bStopBlinking = _FALSE; @@ -1483,9 +1480,9 @@ SwLedBlink12( } -VOID +void SwLedBlink13( - IN PLED_USB pLed + PLED_USB pLed ) { PADAPTER Adapter = pLed->padapter; @@ -1544,9 +1541,9 @@ SwLedBlink13( } -VOID +void SwLedBlink14( - IN PLED_USB pLed + PLED_USB pLed ) { PADAPTER Adapter = pLed->padapter; @@ -1601,9 +1598,9 @@ SwLedBlink14( } -VOID +void SwLedBlink15( - IN PLED_USB pLed + PLED_USB pLed ) { PADAPTER Adapter = pLed->padapter; @@ -1737,7 +1734,7 @@ SwLedBlink15( void BlinkHandler(PLED_USB pLed) { _adapter *padapter = pLed->padapter; - struct led_priv *ledpriv = &(padapter->ledpriv); + struct led_priv *ledpriv = adapter_to_led(padapter); /* RTW_INFO("%s (%s:%d)\n",__FUNCTION__, current->comm, current->pid); */ @@ -1750,6 +1747,12 @@ void BlinkHandler(PLED_USB pLed) } switch (ledpriv->LedStrategy) { + #if CONFIG_RTW_SW_LED_TRX_DA_CLASSIFY + case SW_LED_MODE_UC_TRX_ONLY: + rtw_sw_led_blink_uc_trx_only(pLed); + break; + #endif + case SW_LED_MODE0: SwLedBlink(pLed); break; @@ -1840,8 +1843,8 @@ void BlinkTimerCallback(void *data) return; } -#ifdef CONFIG_LED_HANDLED_BY_CMD_THREAD - rtw_led_blink_cmd(padapter, (PVOID)pLed); +#ifdef CONFIG_RTW_LED_HANDLED_BY_CMD_THREAD + rtw_led_blink_cmd(padapter, (void *)pLed); #else _set_workitem(&(pLed->BlinkWorkItem)); #endif @@ -1864,7 +1867,7 @@ SwLedControlMode0( LED_CTL_MODE LedAction ) { - struct led_priv *ledpriv = &(padapter->ledpriv); + struct led_priv *ledpriv = adapter_to_led(padapter); PLED_USB pLed = &(ledpriv->SwLed1); /* Decide led state */ @@ -1966,7 +1969,7 @@ SwLedControlMode1( LED_CTL_MODE LedAction ) { - struct led_priv *ledpriv = &(padapter->ledpriv); + struct led_priv *ledpriv = adapter_to_led(padapter); PLED_USB pLed = &(ledpriv->SwLed0); struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); @@ -2203,7 +2206,7 @@ SwLedControlMode2( LED_CTL_MODE LedAction ) { - struct led_priv *ledpriv = &(padapter->ledpriv); + struct led_priv *ledpriv = adapter_to_led(padapter); struct mlme_priv *pmlmepriv = &padapter->mlmepriv; PLED_USB pLed = &(ledpriv->SwLed0); @@ -2342,7 +2345,7 @@ SwLedControlMode3( LED_CTL_MODE LedAction ) { - struct led_priv *ledpriv = &(padapter->ledpriv); + struct led_priv *ledpriv = adapter_to_led(padapter); struct mlme_priv *pmlmepriv = &padapter->mlmepriv; PLED_USB pLed = &(ledpriv->SwLed0); @@ -2497,7 +2500,7 @@ SwLedControlMode4( LED_CTL_MODE LedAction ) { - struct led_priv *ledpriv = &(padapter->ledpriv); + struct led_priv *ledpriv = adapter_to_led(padapter); struct mlme_priv *pmlmepriv = &padapter->mlmepriv; PLED_USB pLed = &(ledpriv->SwLed0); PLED_USB pLed1 = &(ledpriv->SwLed1); @@ -2802,7 +2805,7 @@ SwLedControlMode5( LED_CTL_MODE LedAction ) { - struct led_priv *ledpriv = &(padapter->ledpriv); + struct led_priv *ledpriv = adapter_to_led(padapter); struct mlme_priv *pmlmepriv = &padapter->mlmepriv; PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); PLED_USB pLed = &(ledpriv->SwLed0); @@ -2881,7 +2884,7 @@ SwLedControlMode6( LED_CTL_MODE LedAction ) { - struct led_priv *ledpriv = &(padapter->ledpriv); + struct led_priv *ledpriv = adapter_to_led(padapter); struct mlme_priv *pmlmepriv = &padapter->mlmepriv; PLED_USB pLed0 = &(ledpriv->SwLed0); @@ -2912,7 +2915,7 @@ SwLedControlMode7( LED_CTL_MODE LedAction ) { - struct led_priv *ledpriv = &(Adapter->ledpriv); + struct led_priv *ledpriv = adapter_to_led(Adapter); struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; PLED_USB pLed = &(ledpriv->SwLed0); @@ -3051,7 +3054,7 @@ SwLedControlMode8( LED_CTL_MODE LedAction ) { - struct led_priv *ledpriv = &(Adapter->ledpriv); + struct led_priv *ledpriv = adapter_to_led(Adapter); struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; PLED_USB pLed0 = &(ledpriv->SwLed0); @@ -3084,11 +3087,11 @@ SwLedControlMode8( /* page added for Belkin AC950, 20120813 */ void SwLedControlMode9( - IN PADAPTER Adapter, - IN LED_CTL_MODE LedAction + PADAPTER Adapter, + LED_CTL_MODE LedAction ) { - struct led_priv *ledpriv = &(Adapter->ledpriv); + struct led_priv *ledpriv = adapter_to_led(Adapter); struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; PLED_USB pLed = &(ledpriv->SwLed0); PLED_USB pLed1 = &(ledpriv->SwLed1); @@ -3391,7 +3394,7 @@ SwLedControlMode10( ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - struct led_priv *ledpriv = &(Adapter->ledpriv); + struct led_priv *ledpriv = adapter_to_led(Adapter); struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; PLED_USB pLed = &(ledpriv->SwLed0); PLED_USB pLed1 = &(ledpriv->SwLed1); @@ -3588,7 +3591,7 @@ SwLedControlMode11( LED_CTL_MODE LedAction ) { - struct led_priv *ledpriv = &(Adapter->ledpriv); + struct led_priv *ledpriv = adapter_to_led(Adapter); struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; PLED_USB pLed = &(ledpriv->SwLed0); @@ -3681,13 +3684,13 @@ SwLedControlMode11( /* page added for NEC */ -VOID +void SwLedControlMode12( PADAPTER Adapter, LED_CTL_MODE LedAction ) { - struct led_priv *ledpriv = &(Adapter->ledpriv); + struct led_priv *ledpriv = adapter_to_led(Adapter); struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; PLED_USB pLed = &(ledpriv->SwLed0); @@ -3762,13 +3765,13 @@ SwLedControlMode12( /* Maddest add for NETGEAR R6100 */ -VOID +void SwLedControlMode13( - IN PADAPTER Adapter, - IN LED_CTL_MODE LedAction + PADAPTER Adapter, + LED_CTL_MODE LedAction ) { - struct led_priv *ledpriv = &(Adapter->ledpriv); + struct led_priv *ledpriv = adapter_to_led(Adapter); struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; PLED_USB pLed = &(ledpriv->SwLed0); @@ -3908,13 +3911,13 @@ SwLedControlMode13( /* Maddest add for DNI Buffalo */ -VOID +void SwLedControlMode14( - IN PADAPTER Adapter, - IN LED_CTL_MODE LedAction + PADAPTER Adapter, + LED_CTL_MODE LedAction ) { - struct led_priv *ledpriv = &(Adapter->ledpriv); + struct led_priv *ledpriv = adapter_to_led(Adapter); PLED_USB pLed = &(ledpriv->SwLed0); switch (LedAction) { @@ -3967,13 +3970,13 @@ SwLedControlMode14( /* Maddest add for Dlink */ -VOID +void SwLedControlMode15( - IN PADAPTER Adapter, - IN LED_CTL_MODE LedAction + PADAPTER Adapter, + LED_CTL_MODE LedAction ) { - struct led_priv *ledpriv = &(Adapter->ledpriv); + struct led_priv *ledpriv = adapter_to_led(Adapter); struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; PLED_USB pLed = &(ledpriv->SwLed0); @@ -4122,7 +4125,7 @@ LedControlUSB( LED_CTL_MODE LedAction ) { - struct led_priv *ledpriv = &(padapter->ledpriv); + struct led_priv *ledpriv = adapter_to_led(padapter); #if (MP_DRIVER == 1) if (padapter->registrypriv.mp_mode == 1) @@ -4143,12 +4146,6 @@ LedControlUSB( /* if(priv->bInHctTest) */ /* return; */ -#ifdef CONFIG_CONCURRENT_MODE - /* Only do led action for PRIMARY_ADAPTER */ - if (padapter->adapter_type != PRIMARY_ADAPTER) - return; -#endif - if ((adapter_to_pwrctl(padapter)->rf_pwrstate != rf_on && adapter_to_pwrctl(padapter)->rfoff_reason > RF_CHANGE_BY_PS) && (LedAction == LED_CTL_TX || LedAction == LED_CTL_RX || @@ -4159,6 +4156,12 @@ LedControlUSB( return; switch (ledpriv->LedStrategy) { + #if CONFIG_RTW_SW_LED_TRX_DA_CLASSIFY + case SW_LED_MODE_UC_TRX_ONLY: + rtw_sw_led_ctl_mode_uc_trx_only(padapter, LedAction); + break; + #endif + case SW_LED_MODE0: SwLedControlMode0(padapter, LedAction); break; @@ -4267,7 +4270,7 @@ InitLed( pLed->LedPin = LedPin; ResetLedStatus(pLed); - _init_timer(&(pLed->BlinkTimer), padapter->pnetdev, BlinkTimerCallback, pLed); + rtw_init_timer(&(pLed->BlinkTimer), padapter, BlinkTimerCallback, pLed); _init_workitem(&(pLed->BlinkWorkItem), BlinkWorkItemCallback, pLed); } @@ -4285,3 +4288,4 @@ DeInitLed( _cancel_timer_ex(&(pLed->BlinkTimer)); ResetLedStatus(pLed); } +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/ap_makefile.mk b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/ap_makefile.mk new file mode 100644 index 000000000000..09e98af1fb10 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/ap_makefile.mk @@ -0,0 +1,206 @@ +# SPDX-License-Identifier: GPL-2.0 + +_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_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/phydm_lna_sat.o\ + phydm/phydm_pmac_tx_setting.o\ + phydm/phydm_mp.o\ + phydm/txbf/phydm_hal_txbf_api.o\ + EdcaTurboCheck.o\ + phydm/halrf/halrf.o\ + phydm/halrf/halrf_debug.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 + _PHYDM_FILES += phydm/rtl8812a/phydm_rtl8812a.o +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 + _PHYDM_FILES += phydm/halrf/rtl8822b/halhwimg8822b_rf.o + ifeq ($(CONFIG_RTL_ODM_WLAN_DRIVER),y) + _PHYDM_FILES += \ + phydm/rtl8822b/halhwimg8822b_bb.o\ + phydm/rtl8822b/halhwimg8822b_mac.o\ + phydm/rtl8822b/phydm_regconfig8822b.o\ + phydm/rtl8822b/phydm_hal_api8822b.o\ + phydm/rtl8822b/phydm_rtl8822b.o + endif +endif + +ifeq ($(CONFIG_WLAN_HAL_8822CE),y) + _PHYDM_FILES += phydm/halrf/rtl8822c/halrf_8822c.o + _PHYDM_FILES += phydm/halrf/rtl8822c/halrf_iqk_8822c.o + _PHYDM_FILES += phydm/halrf/rtl8822c/halrf_dpk_8822c.o + _PHYDM_FILES += phydm/halrf/rtl8822c/halrf_rfk_init_8822c.o + _PHYDM_FILES += phydm/halrf/rtl8822c/halhwimg8822c_rf.o + ifeq ($(CONFIG_RTL_ODM_WLAN_DRIVER),y) + _PHYDM_FILES += \ + phydm/rtl8822c/halhwimg8822c_bb.o\ + phydm/rtl8822c/halhwimg8822c_mac.o\ + phydm/rtl8822c/phydm_regconfig8822c.o\ + phydm/rtl8822c/phydm_hal_api8822c.o + endif +endif + +ifeq ($(CONFIG_WLAN_HAL_8812FE),y) + _PHYDM_FILES += phydm/halrf/rtl8812f/halrf_8812f.o + _PHYDM_FILES += phydm/halrf/rtl8812f/halrf_iqk_8812f.o + _PHYDM_FILES += phydm/halrf/rtl8812f/halrf_dpk_8812f.o + _PHYDM_FILES += phydm/halrf/rtl8812f/halrf_tssi_8812f.o + _PHYDM_FILES += phydm/halrf/rtl8812f/halrf_rfk_init_8812f.o + _PHYDM_FILES += phydm/halrf/rtl8812f/halhwimg8812f_rf.o + ifeq ($(CONFIG_RTL_ODM_WLAN_DRIVER),y) + _PHYDM_FILES += \ + phydm/rtl8812f/halhwimg8812f_bb.o\ + phydm/rtl8812f/halhwimg8812f_mac.o\ + phydm/rtl8812f/phydm_regconfig8812f.o\ + phydm/rtl8812f/phydm_hal_api8812f.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 + _PHYDM_FILES += phydm/halrf/rtl8821c/halhwimg8821c_rf.o + ifeq ($(CONFIG_RTL_ODM_WLAN_DRIVER),y) + _PHYDM_FILES += \ + phydm/rtl8821c/halhwimg8821c_bb.o\ + phydm/rtl8821c/halhwimg8821c_mac.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 += phydm/halrf/rtl8197f/halrf_dpk_8197f.o + _PHYDM_FILES += phydm/halrf/rtl8197f/halhwimg8197f_rf.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/phydm_hal_api8197f.o\ + phydm/rtl8197f/phydm_regconfig8197f.o\ + phydm/rtl8197f/phydm_rtl8197f.o + endif +endif + + +ifeq ($(CONFIG_WLAN_HAL_8192FE),y) + _PHYDM_FILES += phydm/halrf/rtl8192f/halrf_8192f.o + _PHYDM_FILES += phydm/halrf/rtl8192f/halrf_dpk_8192f.o + _PHYDM_FILES += phydm/halrf/rtl8192f/halhwimg8192f_rf.o + ifeq ($(CONFIG_RTL_ODM_WLAN_DRIVER),y) + _PHYDM_FILES += \ + phydm/rtl8192f/halhwimg8192f_bb.o\ + phydm/rtl8192f/halhwimg8192f_mac.o\ + phydm/rtl8192f/phydm_hal_api8192f.o\ + phydm/rtl8192f/phydm_regconfig8192f.o\ + phydm/rtl8192f/phydm_rtl8192f.o + endif +endif + +ifeq ($(CONFIG_WLAN_HAL_8198F),y) + _PHYDM_FILES += phydm/halrf/rtl8198f/halrf_8198f.o + _PHYDM_FILES += phydm/halrf/rtl8198f/halrf_iqk_8198f.o + _PHYDM_FILES += phydm/halrf/rtl8198f/halrf_dpk_8198f.o + _PHYDM_FILES += phydm/halrf/rtl8198f/halrf_rfk_init_8198f.o + _PHYDM_FILES += phydm/halrf/rtl8198f/halhwimg8198f_rf.o + ifeq ($(CONFIG_RTL_ODM_WLAN_DRIVER),y) + _PHYDM_FILES += \ + phydm/rtl8198f/phydm_hal_api8198f.o\ + phydm/rtl8198f/halhwimg8198f_bb.o\ + phydm/rtl8198f/halhwimg8198f_mac.o\ + phydm/rtl8198f/phydm_regconfig8198f.o \ + phydm/halrf/rtl8198f/halrf_8198f.o + endif +endif + +ifeq ($(CONFIG_WLAN_HAL_8814BE),y) + _PHYDM_FILES += phydm/halrf/rtl8814b/halrf_8814b.o + _PHYDM_FILES += phydm/halrf/rtl8814b/halrf_iqk_8814b.o + _PHYDM_FILES += phydm/halrf/rtl8814b/halrf_dpk_8814b.o + _PHYDM_FILES += phydm/halrf/rtl8814b/halrf_rfk_init_8814b.o + _PHYDM_FILES += phydm/halrf/rtl8814b/halhwimg8814b_rf.o + ifeq ($(CONFIG_RTL_ODM_WLAN_DRIVER),y) + _PHYDM_FILES += \ + phydm/rtl8814b/phydm_hal_api8814b.o\ + phydm/rtl8814b/halhwimg8814b_bb.o\ + phydm/rtl8814b/halhwimg8814b_mac.o\ + phydm/rtl8814b/phydm_regconfig8814b.o \ + phydm/halrf/rtl8814b/halrf_8814b.o + endif +endif + + + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halhwimg.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halhwimg.h index cca28990f647..1c8f0841394a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halhwimg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halhwimg.h @@ -1,78 +1,92 @@ /* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * 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 */ + /* @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 */ + /* @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 */ + /* @For 8723 */ #define RTL8723E_HWIMG_SUPPORT 1 #define RTL8723U_HWIMG_SUPPORT 0 #define RTL8723S_HWIMG_SUPPORT 0 - /* For 88E */ + /* @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 */ + /* @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 */ + /* @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 */ + /* @For 8723 */ #define RTL8723E_HWIMG_SUPPORT 0 #define RTL8723U_HWIMG_SUPPORT 1 #define RTL8723S_HWIMG_SUPPORT 0 - /* For 88E */ + /* @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 */ + /* @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 */ + /* @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 */ + /* @For 8723 */ #define RTL8723E_HWIMG_SUPPORT 0 #define RTL8723U_HWIMG_SUPPORT 0 #define RTL8723S_HWIMG_SUPPORT 1 - /* For 88E */ + /* @For 88E */ #define RTL8188EE_HWIMG_SUPPORT 0 #define RTL8188EU_HWIMG_SUPPORT 0 #define RTL8188ES_HWIMG_SUPPORT 0 @@ -80,40 +94,40 @@ #else /* PLATFORM_WINDOWS & MacOSX */ - /* For 92C */ + /* @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 */ + /* @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 */ + /* @For 8723 */ #define RTL8723E_HWIMG_SUPPORT 0 #define RTL8723U_HWIMG_SUPPORT 0 #define RTL8723S_HWIMG_SUPPORT 1 - /* For 88E */ + /* @For 88E */ #define RTL8188EE_HWIMG_SUPPORT 0 #define RTL8188EU_HWIMG_SUPPORT 0 #define RTL8188ES_HWIMG_SUPPORT 0 #else - /* For 8723 */ + /* @For 8723 */ #define RTL8723E_HWIMG_SUPPORT 1 - /* #define RTL_8723E_TEST_HWIMG_SUPPORT 1 */ + /* @#define RTL_8723E_TEST_HWIMG_SUPPORT 1 */ #define RTL8723U_HWIMG_SUPPORT 1 - /* #define RTL_8723U_TEST_HWIMG_SUPPORT 1 */ + /* @#define RTL_8723U_TEST_HWIMG_SUPPORT 1 */ #define RTL8723S_HWIMG_SUPPORT 1 - /* #define RTL_8723S_TEST_HWIMG_SUPPORT 1 */ + /* @#define RTL_8723S_TEST_HWIMG_SUPPORT 1 */ - /* For 88E */ + /* @For 88E */ #define RTL8188EE_HWIMG_SUPPORT 1 #define RTL8188EU_HWIMG_SUPPORT 1 #define RTL8188ES_HWIMG_SUPPORT 1 @@ -121,4 +135,4 @@ #endif -#endif /* __INC_HW_IMG_H */ +#endif /* @__INC_HW_IMG_H */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halphyrf_ap.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halphyrf_ap.c deleted file mode 100644 index ebddba1f2ef5..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halphyrf_ap.c +++ /dev/null @@ -1,2665 +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, _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_odm = (struct PHY_DM_STRUCT *)p_dm_void; -#if RTL8812A_SUPPORT -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - /* if (IS_HARDWARE_TYPE_8812(p_dm_odm->adapter)) */ - if (p_dm_odm->support_ic_type == ODM_RTL8812) - configure_txpower_track_8812a(p_config); - /* else */ -#endif -#endif - -#if RTL8814A_SUPPORT - if (p_dm_odm->support_ic_type == ODM_RTL8814A) - configure_txpower_track_8814a(p_config); -#endif - - -#if RTL8188E_SUPPORT - if (p_dm_odm->support_ic_type == ODM_RTL8188E) - configure_txpower_track_8188e(p_config); -#endif - -#if RTL8197F_SUPPORT - if (p_dm_odm->support_ic_type == ODM_RTL8197F) - configure_txpower_track_8197f(p_config); -#endif - -#if RTL8822B_SUPPORT - if (p_dm_odm->support_ic_type == ODM_RTL8822B) - configure_txpower_track_8822b(p_config); -#endif - - -} - -#if (RTL8192E_SUPPORT == 1) -void -odm_txpowertracking_callback_thermal_meter_92e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - void *p_dm_void -#else - struct _ADAPTER *adapter -#endif -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - 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_odm->priv; - - rf_mimo_mode = p_dm_odm->rf_type; - /* ODM_RT_TRACE(p_dm_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); - } - - thermal_value = (unsigned char)odm_get_rf_reg(p_dm_odm, RF_PATH_A, ODM_RF_T_METER_92E, 0xfc00); /* 0x42: RF Reg[15:10] 88E */ - ODM_RT_TRACE(p_dm_odm, 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 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_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, 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_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, 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, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("\n******** START POWER TRACKING ********\n")); - ODM_RT_TRACE(p_dm_odm, 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, 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, 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, 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, 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, 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, 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, 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, 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, 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) { - priv->pshare->thermal_value_iqk = thermal_value; -#ifdef MP_TEST - if (!(priv->pshare->rf_ft_var.mp_specific && (OPMODE & (WIFI_MP_CTX_BACKGROUND | WIFI_MP_CTX_PACKET)))) -#endif - phy_iq_calibrate_8192e(p_dm_odm, false); - } - - if (delta_LCK > 8) { - 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("\n******** END:%s() ********\n", __FUNCTION__)); -} -#endif - - - -#if (RTL8197F_SUPPORT == 1 || RTL8822B_SUPPORT == 1) -void -odm_txpowertracking_callback_thermal_meter_jaguar_series3( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - void *p_dm_void -#else - struct _ADAPTER *adapter -#endif -) -{ -#if 1 - struct PHY_DM_STRUCT *p_dm_odm = (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_odm->priv; - struct _TXPWRTRACK_CFG c; - struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm_odm->rf_calibrate_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) || 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); - } - - configure_txpower_track(p_dm_odm, &c); - - (*c.get_delta_all_swing_table)(p_dm_odm, (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_odm, ODM_RF_PATH_A, c.thermal_reg_addr, 0xfc00); /*0x42: RF Reg[15:10] 88E*/ - - ODM_RT_TRACE(p_dm_odm, 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_odm->rf_calibrate_info.thermal_value) - p_dm_odm->rf_calibrate_info.thermal_value = priv->pmib->dot11RFEntry.ther; - - if (!p_dm_odm->rf_calibrate_info.thermal_value_lck) - p_dm_odm->rf_calibrate_info.thermal_value_lck = priv->pmib->dot11RFEntry.ther; - - if (!p_dm_odm->rf_calibrate_info.thermal_value_iqk) - p_dm_odm->rf_calibrate_info.thermal_value_iqk = priv->pmib->dot11RFEntry.ther; - - /* calculate average thermal meter */ - p_dm_odm->rf_calibrate_info.thermal_value_avg[p_dm_odm->rf_calibrate_info.thermal_value_avg_index] = thermal_value; - p_dm_odm->rf_calibrate_info.thermal_value_avg_index++; - - if (p_dm_odm->rf_calibrate_info.thermal_value_avg_index == c.average_thermal_num) /*Average times = c.average_thermal_num*/ - p_dm_odm->rf_calibrate_info.thermal_value_avg_index = 0; - - for (i = 0; i < c.average_thermal_num; i++) { - if (p_dm_odm->rf_calibrate_info.thermal_value_avg[i]) { - thermal_value_avg += p_dm_odm->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, 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, 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_odm->rf_calibrate_info.thermal_value_lck); - delta_IQK = RTL_ABS(thermal_value, p_dm_odm->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, 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(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_LCK(%d) >= threshold_iqk(%d)\n", delta_LCK, c.threshold_iqk)); - p_dm_odm->rf_calibrate_info.thermal_value_lck = thermal_value; - if (c.phy_lc_calibrate) - (*c.phy_lc_calibrate)(p_dm_odm); - } - - if (delta_IQK > c.threshold_iqk) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_IQK(%d) >= threshold_iqk(%d)\n", delta_IQK, c.threshold_iqk)); - p_dm_odm->rf_calibrate_info.thermal_value_iqk = thermal_value; - if (c.do_iqk) - (*c.do_iqk)(p_dm_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 (thermal_value != p_dm_odm->rf_calibrate_info.thermal_value) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("\n\n******** START POWER TRACKING ********\n")); - ODM_RT_TRACE(p_dm_odm, 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_odm->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 = ODM_RF_PATH_A; p < c.rf_path_count; p++) { - switch (p) { - case ODM_RF_PATH_B: - ODM_RT_TRACE(p_dm_odm, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is higher and pRF->absolute_ofdm_swing_idx[ODM_RF_PATH_B] = %d pRF->absolute_cck_swing_idx[ODM_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 ODM_RF_PATH_C: - ODM_RT_TRACE(p_dm_odm, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is higher and pRF->absolute_ofdm_swing_idx[ODM_RF_PATH_C] = %d pRF->absolute_cck_swing_idx[ODM_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 ODM_RF_PATH_D: - ODM_RT_TRACE(p_dm_odm, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is higher and pRF->absolute_ofdm_swing_idx[ODM_RF_PATH_D] = %d pRF->absolute_cck_swing_idx[ODM_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, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is higher and pRF->absolute_ofdm_swing_idx[ODM_RF_PATH_A] = %d pRF->absolute_cck_swing_idx[ODM_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 = ODM_RF_PATH_A; p < c.rf_path_count; p++) { - switch (p) { - case ODM_RF_PATH_B: - ODM_RT_TRACE(p_dm_odm, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is lower and pRF->absolute_ofdm_swing_idx[ODM_RF_PATH_B] = %d pRF->absolute_cck_swing_idx[ODM_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 ODM_RF_PATH_C: - ODM_RT_TRACE(p_dm_odm, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is lower and pRF->absolute_ofdm_swing_idx[ODM_RF_PATH_C] = %d pRF->absolute_cck_swing_idx[ODM_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 ODM_RF_PATH_D: - ODM_RT_TRACE(p_dm_odm, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is lower and pRF->absolute_ofdm_swing_idx[ODM_RF_PATH_D] = %d pRF->absolute_cck_swing_idx[ODM_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, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is lower and pRF->absolute_ofdm_swing_idx[ODM_RF_PATH_A] = %d pRF->absolute_cck_swing_idx[ODM_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, 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.rf_path_count; p++) - (*c.odm_tx_pwr_track_set_pwr)(p_dm_odm, BBSWING, p, 0); - } else if (GET_CHIP_VER(priv) == VERSION_8822B) { - for (p = ODM_RF_PATH_A; p < c.rf_path_count; p++) - (*c.odm_tx_pwr_track_set_pwr)(p_dm_odm, MIX_MODE, p, 0); - } - } else { - ODM_RT_TRACE(p_dm_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.rf_path_count; p++) - (*c.odm_tx_pwr_track_set_pwr)(p_dm_odm, BBSWING, p, 0); - } else if (GET_CHIP_VER(priv) == VERSION_8822B) { - for (p = ODM_RF_PATH_A; p < c.rf_path_count; p++) - (*c.odm_tx_pwr_track_set_pwr)(p_dm_odm, MIX_MODE, p, 0); - } - } - } -#endif - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("\n******** END:%s() ********\n\n", __func__)); - /*update thermal meter value*/ - p_dm_odm->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( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - void *p_dm_void -#else - struct _ADAPTER *adapter -#endif -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (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_odm->priv; - struct _TXPWRTRACK_CFG c; - bool is_tssi_enable = false; - struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm_odm->rf_calibrate_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) || 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); - } - - configure_txpower_track(p_dm_odm, &c); - p_rf_calibrate_info->default_ofdm_index = priv->pshare->OFDM_index0[ODM_RF_PATH_A]; - - (*c.get_delta_swing_table)(p_dm_odm, (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_odm->support_ic_type & ODM_RTL8814A) /* for 8814 path C & D */ - (*c.get_delta_swing_table8814only)(p_dm_odm, (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_odm, ODM_RF_PATH_A, c.thermal_reg_addr, 0xfc00); /* 0x42: RF Reg[15:10] 88E */ - ODM_RT_TRACE(p_dm_odm, 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_odm->rf_calibrate_info.thermal_value, priv->pmib->dot11RFEntry.ther)); - - /* Initialize */ - if (!p_dm_odm->rf_calibrate_info.thermal_value) - p_dm_odm->rf_calibrate_info.thermal_value = priv->pmib->dot11RFEntry.ther; - - if (!p_dm_odm->rf_calibrate_info.thermal_value_lck) - p_dm_odm->rf_calibrate_info.thermal_value_lck = priv->pmib->dot11RFEntry.ther; - - if (!p_dm_odm->rf_calibrate_info.thermal_value_iqk) - p_dm_odm->rf_calibrate_info.thermal_value_iqk = priv->pmib->dot11RFEntry.ther; - - is_tssi_enable = (bool)odm_get_rf_reg(p_dm_odm, ODM_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 = ODM_RF_PATH_A ; p < c.rf_path_count ; p++) { - ele_D = odm_get_bb_reg(p_dm_odm, bb_swing_reg[p], 0xffe00000); - ODM_RT_TRACE(p_dm_odm, 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_odm, 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_odm->rf_calibrate_info.OFDM_index[p] = (u8)bb_swing_idx; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("OFDM_index[%d]=%d\n", p, p_dm_odm->rf_calibrate_info.OFDM_index[p])); - break; - } - } - ODM_RT_TRACE(p_dm_odm, 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_odm->rf_calibrate_info.thermal_value_avg[p_dm_odm->rf_calibrate_info.thermal_value_avg_index] = thermal_value; - p_dm_odm->rf_calibrate_info.thermal_value_avg_index++; - if (p_dm_odm->rf_calibrate_info.thermal_value_avg_index == c.average_thermal_num) /* Average times = c.average_thermal_num */ - p_dm_odm->rf_calibrate_info.thermal_value_avg_index = 0; - - for (i = 0; i < c.average_thermal_num; i++) { - if (p_dm_odm->rf_calibrate_info.thermal_value_avg[i]) { - thermal_value_avg += p_dm_odm->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, 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_odm->rf_calibrate_info.thermal_value_lck); - delta_IQK = RTL_ABS(thermal_value, p_dm_odm->rf_calibrate_info.thermal_value_iqk); - is_increase = ((thermal_value < priv->pmib->dot11RFEntry.ther) ? 0 : 1); - - /* 4 if necessary, do LCK. */ - if (!(p_dm_odm->support_ic_type & ODM_RTL8821)) { - if (delta_LCK > c.threshold_iqk) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_LCK(%d) >= threshold_iqk(%d)\n", delta_LCK, c.threshold_iqk)); - p_dm_odm->rf_calibrate_info.thermal_value_lck = thermal_value; - - /*Use RTLCK, so close power tracking driver LCK*/ -#if (RTL8814A_SUPPORT != 1) - if (!(p_dm_odm->support_ic_type & ODM_RTL8814A)) { - if (c.phy_lc_calibrate) - (*c.phy_lc_calibrate)(p_dm_odm); - } -#endif - } - } - - if (delta_IQK > c.threshold_iqk) { - panic_printk("%s(%d)\n", __FUNCTION__, __LINE__); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_IQK(%d) >= threshold_iqk(%d)\n", delta_IQK, c.threshold_iqk)); - p_dm_odm->rf_calibrate_info.thermal_value_iqk = thermal_value; - if (c.do_iqk) - (*c.do_iqk)(p_dm_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 (is_tssi_enable == true) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter PURE TSSI MODE**********\n")); - for (p = ODM_RF_PATH_A; p < c.rf_path_count; p++) - (*c.odm_tx_pwr_track_set_pwr)(p_dm_odm, TSSI_MODE, p, 0); - } else if (thermal_value != p_dm_odm->rf_calibrate_info.thermal_value) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("\n******** START POWER TRACKING ********\n")); - ODM_RT_TRACE(p_dm_odm, 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_odm->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 = ODM_RF_PATH_A; p < c.rf_path_count; p++) { - switch (p) { - case ODM_RF_PATH_B: - ODM_RT_TRACE(p_dm_odm, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is higher and p_dm_odm->absolute_ofdm_swing_idx[ODM_RF_PATH_B] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); - break; - - case ODM_RF_PATH_C: - ODM_RT_TRACE(p_dm_odm, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is higher and p_dm_odm->absolute_ofdm_swing_idx[ODM_RF_PATH_C] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); - break; - - case ODM_RF_PATH_D: - ODM_RT_TRACE(p_dm_odm, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is higher and p_dm_odm->absolute_ofdm_swing_idx[ODM_RF_PATH_D] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); - break; - - default: - ODM_RT_TRACE(p_dm_odm, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is higher and p_dm_odm->absolute_ofdm_swing_idx[ODM_RF_PATH_A] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); - break; - } - } - } else { /* thermal is lower than base */ - for (p = ODM_RF_PATH_A; p < c.rf_path_count; p++) { - switch (p) { - case ODM_RF_PATH_B: - ODM_RT_TRACE(p_dm_odm, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is lower and p_dm_odm->absolute_ofdm_swing_idx[ODM_RF_PATH_B] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); - break; - - case ODM_RF_PATH_C: - ODM_RT_TRACE(p_dm_odm, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is lower and p_dm_odm->absolute_ofdm_swing_idx[ODM_RF_PATH_C] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); - break; - - case ODM_RF_PATH_D: - ODM_RT_TRACE(p_dm_odm, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is lower and p_dm_odm->absolute_ofdm_swing_idx[ODM_RF_PATH_D] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); - break; - - default: - ODM_RT_TRACE(p_dm_odm, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is lower and p_dm_odm->absolute_ofdm_swing_idx[ODM_RF_PATH_A] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); - break; - } - } - } - - if (is_increase) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, (">>> increse power --->\n")); - for (p = ODM_RF_PATH_A; p < c.rf_path_count; p++) - (*c.odm_tx_pwr_track_set_pwr)(p_dm_odm, MIX_MODE, p, 0); - } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, (">>> decrese power --->\n")); - for (p = ODM_RF_PATH_A; p < c.rf_path_count; p++) - (*c.odm_tx_pwr_track_set_pwr)(p_dm_odm, MIX_MODE, p, 0); - } - } -#endif - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("\n******** END:%s() ********\n", __FUNCTION__)); - /* update thermal meter value */ - p_dm_odm->rf_calibrate_info.thermal_value = thermal_value; - - } -} -#endif - -#if (RTL8812A_SUPPORT == 1 || RTL8881A_SUPPORT == 1) -void -odm_txpowertracking_callback_thermal_meter_jaguar_series( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - void *p_dm_void -#else - struct _ADAPTER *adapter -#endif -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (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_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 (p_dm_odm->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_odm->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, 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, 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, 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, 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, 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, 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, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("\n******** START POWER TRACKING ********\n")); - ODM_RT_TRACE(p_dm_odm, 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_odm->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, 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, 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_odm->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_odm->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, 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, 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) { - 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, 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( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - void *p_dm_void -#else - struct _ADAPTER *adapter -#endif -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm_odm->rf_calibrate_info); - - -#if (RTL8197F_SUPPORT == 1 || RTL8822B_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8197F || p_dm_odm->support_ic_type == ODM_RTL8822B) { - odm_txpowertracking_callback_thermal_meter_jaguar_series3(p_dm_odm); - return; - } -#endif -#if (RTL8814A_SUPPORT == 1) /*use this function to do power tracking after 8814 by YuChen*/ - if (p_dm_odm->support_ic_type & ODM_RTL8814A) { - odm_txpowertracking_callback_thermal_meter_jaguar_series2(p_dm_odm); - return; - } -#endif -#if (RTL8881A_SUPPORT || RTL8812A_SUPPORT == 1) - if (p_dm_odm->support_ic_type & ODM_RTL8812 || p_dm_odm->support_ic_type & ODM_RTL8881A) { - odm_txpowertracking_callback_thermal_meter_jaguar_series(p_dm_odm); - return; - } -#endif - -#if (RTL8192E_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8192E) { - odm_txpowertracking_callback_thermal_meter_92e(p_dm_odm); - 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; */ - bool 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 }; -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif - - 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_odm->priv; -#endif - - /* 4 2. Initilization ( 7 steps in total ) */ - - configure_txpower_track(p_dm_odm, &c); - - p_dm_odm->rf_calibrate_info.txpowertracking_callback_cnt++; /* cosa add for debug */ - p_dm_odm->rf_calibrate_info.is_txpowertracking_init = true; - -#if (MP_DRIVER == 1) - p_dm_odm->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_odm->rf_calibrate_info.rega24 = 0x090e1317; -#endif - -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) && defined(MP_TEST) - if ((OPMODE & WIFI_MP_STATE) || p_dm_odm->priv->pshare->rf_ft_var.mp_specific) { - if (p_dm_odm->priv->pshare->mp_txpwr_tracking == false) - return; - } -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("===>odm_txpowertracking_callback_thermal_meter_8188e, p_dm_odm->bb_swing_idx_cck_base: %d, p_dm_odm->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_odm->rf_calibrate_info.tm_trigger) { - odm_set_rf_reg(p_dm_odm, RF_PATH_A, c.thermal_reg_addr, BIT(17) | BIT(16), 0x3); - p_dm_odm->rf_calibrate_info.tm_trigger = 1; - return; - } - */ - thermal_value = (u8)odm_get_rf_reg(p_dm_odm, 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_odm->rf_calibrate_info.txpowertrack_control) -#else - if (!p_dm_odm->rf_calibrate_info.txpowertrack_control) -#endif - return; - - /* 4 3. Initialize ThermalValues of rf_calibrate_info */ - - if (!p_dm_odm->rf_calibrate_info.thermal_value) { - p_dm_odm->rf_calibrate_info.thermal_value_lck = thermal_value; - p_dm_odm->rf_calibrate_info.thermal_value_iqk = thermal_value; - } - - if (p_dm_odm->rf_calibrate_info.is_reloadtxpowerindex) - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("reload ofdm index for band switch\n")); - - /* 4 4. Calculate average thermal meter */ - - p_dm_odm->rf_calibrate_info.thermal_value_avg[p_dm_odm->rf_calibrate_info.thermal_value_avg_index] = thermal_value; - p_dm_odm->rf_calibrate_info.thermal_value_avg_index++; - if (p_dm_odm->rf_calibrate_info.thermal_value_avg_index == c.average_thermal_num) - p_dm_odm->rf_calibrate_info.thermal_value_avg_index = 0; - - for (i = 0; i < c.average_thermal_num; i++) { - if (p_dm_odm->rf_calibrate_info.thermal_value_avg[i]) { - thermal_value_avg += p_dm_odm->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, 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_odm->rf_calibrate_info.thermal_value) ? (thermal_value - p_dm_odm->rf_calibrate_info.thermal_value) : (p_dm_odm->rf_calibrate_info.thermal_value - thermal_value); - delta_LCK = (thermal_value > p_dm_odm->rf_calibrate_info.thermal_value_lck) ? (thermal_value - p_dm_odm->rf_calibrate_info.thermal_value_lck) : (p_dm_odm->rf_calibrate_info.thermal_value_lck - thermal_value); - delta_IQK = (thermal_value > p_dm_odm->rf_calibrate_info.thermal_value_iqk) ? (thermal_value - p_dm_odm->rf_calibrate_info.thermal_value_iqk) : (p_dm_odm->rf_calibrate_info.thermal_value_iqk - thermal_value); - - /* 4 6. If necessary, do LCK. */ - if (!(p_dm_odm->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) { - /*Delta temperature is equal to or larger than 20 centigrade.*/ - p_dm_odm->rf_calibrate_info.thermal_value_lck = thermal_value; - (*c.phy_lc_calibrate)(p_dm_odm); - } - } - - /* 3 7. If necessary, move the index of swing table to adjust Tx power. */ - - if (delta > 0 && p_dm_odm->rf_calibrate_info.txpowertrack_control) { -#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_odm->priv->pmib->dot11RFEntry.ther) ? (thermal_value - p_dm_odm->priv->pmib->dot11RFEntry.ther) : (p_dm_odm->priv->pmib->dot11RFEntry.ther - thermal_value); -#endif - - - /* 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_odm->priv->pmib->dot11RFEntry.ther) { -#endif - CALCULATE_SWINGTALBE_OFFSET(offset, POWER_INC, index_mapping_NUM_88E, delta); - p_dm_odm->rf_calibrate_info.delta_power_index_last = p_dm_odm->rf_calibrate_info.delta_power_index; - p_dm_odm->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_odm->rf_calibrate_info.delta_power_index_last = p_dm_odm->rf_calibrate_info.delta_power_index; - p_dm_odm->rf_calibrate_info.delta_power_index = (-1) * delta_swing_table_idx[POWER_DEC][offset]; - } - - if (p_dm_odm->rf_calibrate_info.delta_power_index == p_dm_odm->rf_calibrate_info.delta_power_index_last) - p_dm_odm->rf_calibrate_info.power_index_offset = 0; - else - p_dm_odm->rf_calibrate_info.power_index_offset = p_dm_odm->rf_calibrate_info.delta_power_index - p_dm_odm->rf_calibrate_info.delta_power_index_last; - - for (i = 0; i < rf; i++) - p_dm_odm->rf_calibrate_info.OFDM_index[i] = p_rf_calibrate_info->bb_swing_idx_ofdm_base + p_dm_odm->rf_calibrate_info.power_index_offset; - p_dm_odm->rf_calibrate_info.CCK_index = p_rf_calibrate_info->bb_swing_idx_cck_base + p_dm_odm->rf_calibrate_info.power_index_offset; - - p_rf_calibrate_info->bb_swing_idx_cck = p_dm_odm->rf_calibrate_info.CCK_index; - p_rf_calibrate_info->bb_swing_idx_ofdm[RF_PATH_A] = p_dm_odm->rf_calibrate_info.OFDM_index[RF_PATH_A]; - - ODM_RT_TRACE(p_dm_odm, 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_odm->rf_calibrate_info.power_index_offset)); - ODM_RT_TRACE(p_dm_odm, 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_odm->rf_calibrate_info.power_index_offset)); - - /* 4 7.1 Handle boundary conditions of index. */ - - - for (i = 0; i < rf; i++) { - if (p_dm_odm->rf_calibrate_info.OFDM_index[i] > OFDM_max_index) - p_dm_odm->rf_calibrate_info.OFDM_index[i] = OFDM_max_index; - else if (p_dm_odm->rf_calibrate_info.OFDM_index[i] < 0) - p_dm_odm->rf_calibrate_info.OFDM_index[i] = 0; - } - - if (p_dm_odm->rf_calibrate_info.CCK_index > c.swing_table_size_cck - 1) - p_dm_odm->rf_calibrate_info.CCK_index = c.swing_table_size_cck - 1; - else if (p_dm_odm->rf_calibrate_info.CCK_index < 0) - p_dm_odm->rf_calibrate_info.CCK_index = 0; - } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("The thermal meter is unchanged or TxPowerTracking OFF: thermal_value: %d, p_dm_odm->rf_calibrate_info.thermal_value: %d)\n", thermal_value, p_dm_odm->rf_calibrate_info.thermal_value)); - p_dm_odm->rf_calibrate_info.power_index_offset = 0; - } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("TxPowerTracking: [CCK] Swing Current index: %d, Swing base index: %d\n", p_dm_odm->rf_calibrate_info.CCK_index, p_rf_calibrate_info->bb_swing_idx_cck_base)); - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("TxPowerTracking: [OFDM] Swing Current index: %d, Swing base index: %d\n", p_dm_odm->rf_calibrate_info.OFDM_index[RF_PATH_A], p_rf_calibrate_info->bb_swing_idx_ofdm_base)); - - if (p_dm_odm->rf_calibrate_info.power_index_offset != 0 && p_dm_odm->rf_calibrate_info.txpowertrack_control) { - /* 4 7.2 Configure the Swing Table to adjust Tx Power. */ - - p_dm_odm->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_odm->rf_calibrate_info.thermal_value) { - /* ODM_RT_TRACE(p_dm_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", */ - /* p_dm_odm->rf_calibrate_info.power_index_offset, delta, thermal_value, p_hal_data->eeprom_thermal_meter, p_dm_odm->rf_calibrate_info.thermal_value)); */ - } else if (thermal_value < p_dm_odm->rf_calibrate_info.thermal_value) { /* Low temperature */ - /* ODM_RT_TRACE(p_dm_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", */ - /* p_dm_odm->rf_calibrate_info.power_index_offset, delta, thermal_value, p_hal_data->eeprom_thermal_meter, p_dm_odm->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_odm->priv->pmib->dot11RFEntry.ther) -#endif - { - /* ODM_RT_TRACE(p_dm_odm,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_odm, TXAGC, 0, 0); - } else { - /* ODM_RT_TRACE(p_dm_odm,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_odm, BBSWING, RF_PATH_A, indexforchannel); - if (is2T) - (*c.odm_tx_pwr_track_set_pwr)(p_dm_odm, 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_odm->rf_calibrate_info.thermal_value = thermal_value; - - } - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - /* if((delta_IQK > p_hal_data->delta_iqk) && (p_hal_data->delta_iqk != 0)) */ - if ((delta_IQK >= 8)) /* Delta temperature is equal to or larger than 20 centigrade. */ - (*c.do_iqk)(p_dm_odm, delta_IQK, thermal_value, 8); -#endif - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("<===dm_TXPowerTrackingCallback_ThermalMeter_8188E\n")); - - p_dm_odm->rf_calibrate_info.tx_powercount = 0; -} - -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - - -void -phy_path_a_stand_by( - struct _ADAPTER *p_adapter -) -{ - RTPRINT(FINIT, INIT_IQK, ("path-A standby mode!\n")); - - phy_set_bb_reg(p_adapter, REG_FPGA0_IQK, 0xffffff00, 0x0); - phy_set_bb_reg(p_adapter, 0x840, MASKDWORD, 0x00010000); - phy_set_bb_reg(p_adapter, REG_FPGA0_IQK, 0xffffff00, 0x808000); -} - -/* 1 7. IQK - * #define MAX_TOLERANCE 5 - * #define IQK_DELAY_TIME 1 */ /* ms */ - -u8 /* bit0 = 1 => Tx OK, bit1 = 1 => Rx OK */ -phy_path_a_iqk_8192c( - struct _ADAPTER *p_adapter, - bool config_path_b -) -{ - - u32 reg_eac, reg_e94, reg_e9c, reg_ea4; - u8 result = 0x00; - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); - - RTPRINT(FINIT, INIT_IQK, ("path A IQK!\n")); - - /* path-A IQK setting */ - RTPRINT(FINIT, INIT_IQK, ("path-A IQK setting!\n")); - if (p_adapter->interface_index == 0) { - phy_set_bb_reg(p_adapter, REG_TX_IQK_TONE_A, MASKDWORD, 0x10008c1f); - phy_set_bb_reg(p_adapter, REG_RX_IQK_TONE_A, MASKDWORD, 0x10008c1f); - } else { - phy_set_bb_reg(p_adapter, REG_TX_IQK_TONE_A, MASKDWORD, 0x10008c22); - phy_set_bb_reg(p_adapter, REG_RX_IQK_TONE_A, MASKDWORD, 0x10008c22); - } - - phy_set_bb_reg(p_adapter, REG_TX_IQK_PI_A, MASKDWORD, 0x82140102); - - phy_set_bb_reg(p_adapter, REG_RX_IQK_PI_A, MASKDWORD, config_path_b ? 0x28160202 : - IS_81xxC_VENDOR_UMC_B_CUT(p_hal_data->version_id) ? 0x28160202 : 0x28160502); - - /* path-B IQK setting */ - if (config_path_b) { - phy_set_bb_reg(p_adapter, REG_TX_IQK_TONE_B, MASKDWORD, 0x10008c22); - phy_set_bb_reg(p_adapter, REG_RX_IQK_TONE_B, MASKDWORD, 0x10008c22); - phy_set_bb_reg(p_adapter, REG_TX_IQK_PI_B, MASKDWORD, 0x82140102); - phy_set_bb_reg(p_adapter, REG_RX_IQK_PI_B, MASKDWORD, 0x28160202); - } - - /* LO calibration setting */ - RTPRINT(FINIT, INIT_IQK, ("LO calibration setting!\n")); - phy_set_bb_reg(p_adapter, REG_IQK_AGC_RSP, MASKDWORD, 0x001028d1); - - /* One shot, path A LOK & IQK */ - RTPRINT(FINIT, INIT_IQK, ("One shot, path A LOK & IQK!\n")); - phy_set_bb_reg(p_adapter, REG_IQK_AGC_PTS, MASKDWORD, 0xf9000000); - phy_set_bb_reg(p_adapter, REG_IQK_AGC_PTS, MASKDWORD, 0xf8000000); - - /* delay x ms */ - RTPRINT(FINIT, INIT_IQK, ("delay %d ms for One shot, path A LOK & IQK.\n", IQK_DELAY_TIME)); - platform_stall_execution(IQK_DELAY_TIME * 1000); - - /* Check failed */ - reg_eac = phy_query_bb_reg(p_adapter, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD); - RTPRINT(FINIT, INIT_IQK, ("0xeac = 0x%x\n", reg_eac)); - reg_e94 = phy_query_bb_reg(p_adapter, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD); - RTPRINT(FINIT, INIT_IQK, ("0xe94 = 0x%x\n", reg_e94)); - reg_e9c = phy_query_bb_reg(p_adapter, REG_TX_POWER_AFTER_IQK_A, MASKDWORD); - RTPRINT(FINIT, INIT_IQK, ("0xe9c = 0x%x\n", reg_e9c)); - reg_ea4 = phy_query_bb_reg(p_adapter, REG_RX_POWER_BEFORE_IQK_A_2, MASKDWORD); - RTPRINT(FINIT, INIT_IQK, ("0xea4 = 0x%x\n", reg_ea4)); - - if (!(reg_eac & BIT(28)) && - (((reg_e94 & 0x03FF0000) >> 16) != 0x142) && - (((reg_e9c & 0x03FF0000) >> 16) != 0x42)) - result |= 0x01; - else /* if Tx not OK, ignore Rx */ - return result; - - if (!(reg_eac & BIT(27)) && /* if Tx is OK, check whether Rx is OK */ - (((reg_ea4 & 0x03FF0000) >> 16) != 0x132) && - (((reg_eac & 0x03FF0000) >> 16) != 0x36)) - result |= 0x02; - else - RTPRINT(FINIT, INIT_IQK, ("path A Rx IQK fail!!\n")); - - return result; - - -} - -u8 /* bit0 = 1 => Tx OK, bit1 = 1 => Rx OK */ -phy_path_b_iqk_8192c( - struct _ADAPTER *p_adapter -) -{ - u32 reg_eac, reg_eb4, reg_ebc, reg_ec4, reg_ecc; - u8 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_set_bb_reg(p_adapter, REG_IQK_AGC_CONT, MASKDWORD, 0x00000002); - phy_set_bb_reg(p_adapter, REG_IQK_AGC_CONT, MASKDWORD, 0x00000000); - - /* delay x ms */ - RTPRINT(FINIT, INIT_IQK, ("delay %d ms for One shot, path B LOK & IQK.\n", IQK_DELAY_TIME)); - platform_stall_execution(IQK_DELAY_TIME * 1000); - - /* Check failed */ - reg_eac = phy_query_bb_reg(p_adapter, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD); - RTPRINT(FINIT, INIT_IQK, ("0xeac = 0x%x\n", reg_eac)); - reg_eb4 = phy_query_bb_reg(p_adapter, REG_TX_POWER_BEFORE_IQK_B, MASKDWORD); - RTPRINT(FINIT, INIT_IQK, ("0xeb4 = 0x%x\n", reg_eb4)); - reg_ebc = phy_query_bb_reg(p_adapter, REG_TX_POWER_AFTER_IQK_B, MASKDWORD); - RTPRINT(FINIT, INIT_IQK, ("0xebc = 0x%x\n", reg_ebc)); - reg_ec4 = phy_query_bb_reg(p_adapter, REG_RX_POWER_BEFORE_IQK_B_2, MASKDWORD); - RTPRINT(FINIT, INIT_IQK, ("0xec4 = 0x%x\n", reg_ec4)); - reg_ecc = phy_query_bb_reg(p_adapter, REG_RX_POWER_AFTER_IQK_B_2, MASKDWORD); - RTPRINT(FINIT, INIT_IQK, ("0xecc = 0x%x\n", reg_ecc)); - - if (!(reg_eac & BIT(31)) && - (((reg_eb4 & 0x03FF0000) >> 16) != 0x142) && - (((reg_ebc & 0x03FF0000) >> 16) != 0x42)) - result |= 0x01; - else - return result; - - if (!(reg_eac & BIT(30)) && - (((reg_ec4 & 0x03FF0000) >> 16) != 0x132) && - (((reg_ecc & 0x03FF0000) >> 16) != 0x36)) - result |= 0x02; - else - RTPRINT(FINIT, INIT_IQK, ("path B Rx IQK fail!!\n")); - - - return result; - -} - -void -phy_path_a_fill_iqk_matrix( - struct _ADAPTER *p_adapter, - bool is_iqk_ok, - s32 result[][8], - u8 final_candidate, - bool is_tx_only -) -{ - u32 oldval_0, X, TX0_A, reg; - s32 Y, TX0_C; - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); - - RTPRINT(FINIT, INIT_IQK, ("path A IQ Calibration %s !\n", (is_iqk_ok) ? "Success" : "Failed")); - - if (final_candidate == 0xFF) - return; - - else if (is_iqk_ok) { - oldval_0 = (phy_query_bb_reg(p_adapter, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKDWORD) >> 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_set_bb_reg(p_adapter, REG_OFDM_0_XA_TX_IQ_IMBALANCE, 0x3FF, TX0_A); - phy_set_bb_reg(p_adapter, REG_OFDM_0_ECCA_THRESHOLD, 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 (p_adapter->interface_index == 1 && p_hal_data->current_band_type == 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_set_bb_reg(p_adapter, REG_OFDM_0_XC_TX_AFE, 0xF0000000, ((TX0_C & 0x3C0) >> 6)); - phy_set_bb_reg(p_adapter, REG_OFDM_0_XA_TX_IQ_IMBALANCE, 0x003F0000, (TX0_C & 0x3F)); - phy_set_bb_reg(p_adapter, REG_OFDM_0_ECCA_THRESHOLD, BIT(29), ((Y * oldval_0 >> 7) & 0x1)); - - if (is_tx_only) { - RTPRINT(FINIT, INIT_IQK, ("phy_path_a_fill_iqk_matrix only Tx OK\n")); - return; - } - - reg = result[final_candidate][2]; - phy_set_bb_reg(p_adapter, REG_OFDM_0_XA_RX_IQ_IMBALANCE, 0x3FF, reg); - - reg = result[final_candidate][3] & 0x3F; - phy_set_bb_reg(p_adapter, REG_OFDM_0_XA_RX_IQ_IMBALANCE, 0xFC00, reg); - - reg = (result[final_candidate][3] >> 6) & 0xF; - phy_set_bb_reg(p_adapter, REG_OFDM_0_RX_IQ_EXT_ANTA, 0xF0000000, reg); - } -} - -void -phy_path_b_fill_iqk_matrix( - struct _ADAPTER *p_adapter, - bool is_iqk_ok, - s32 result[][8], - u8 final_candidate, - bool is_tx_only /* do Tx only */ -) -{ - u32 oldval_1, X, TX1_A, reg; - s32 Y, TX1_C; - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); - - RTPRINT(FINIT, INIT_IQK, ("path B IQ Calibration %s !\n", (is_iqk_ok) ? "Success" : "Failed")); - - if (final_candidate == 0xFF) - return; - - else if (is_iqk_ok) { - oldval_1 = (phy_query_bb_reg(p_adapter, REG_OFDM_0_XB_TX_IQ_IMBALANCE, MASKDWORD) >> 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_set_bb_reg(p_adapter, REG_OFDM_0_XB_TX_IQ_IMBALANCE, 0x3FF, TX1_A); - phy_set_bb_reg(p_adapter, REG_OFDM_0_ECCA_THRESHOLD, BIT(27), ((X * oldval_1 >> 7) & 0x1)); - - Y = result[final_candidate][5]; - if ((Y & 0x00000200) != 0) - Y = Y | 0xFFFFFC00; - if (p_hal_data->current_band_type == 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_set_bb_reg(p_adapter, REG_OFDM_0_XD_TX_AFE, 0xF0000000, ((TX1_C & 0x3C0) >> 6)); - phy_set_bb_reg(p_adapter, REG_OFDM_0_XB_TX_IQ_IMBALANCE, 0x003F0000, (TX1_C & 0x3F)); - phy_set_bb_reg(p_adapter, REG_OFDM_0_ECCA_THRESHOLD, BIT(25), ((Y * oldval_1 >> 7) & 0x1)); - - if (is_tx_only) - return; - - reg = result[final_candidate][6]; - phy_set_bb_reg(p_adapter, REG_OFDM_0_XB_RX_IQ_IMBALANCE, 0x3FF, reg); - - reg = result[final_candidate][7] & 0x3F; - phy_set_bb_reg(p_adapter, REG_OFDM_0_XB_RX_IQ_IMBALANCE, 0xFC00, reg); - - reg = (result[final_candidate][7] >> 6) & 0xF; - phy_set_bb_reg(p_adapter, REG_OFDM_0_AGC_RSSI_TABLE, 0x0000F000, reg); - } -} - - -bool -phy_simularity_compare_92c( - struct _ADAPTER *p_adapter, - s32 result[][8], - u8 c1, - u8 c2 -) -{ - u32 i, j, diff, simularity_bit_map, bound = 0; - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); - u8 final_candidate[2] = {0xFF, 0xFF}; /* for path A and path B */ - bool is_result = true, is2T = IS_92C_SERIAL(p_hal_data->version_id); - - if (is2T) - bound = 8; - else - bound = 4; - - simularity_bit_map = 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) && !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); - } - } - - 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 & 0x0F)) { /* path A OK */ - for (i = 0; i < 4; i++) - result[3][i] = result[c1][i]; - return false; - } else if (!(simularity_bit_map & 0xF0) && is2T) { /* path B OK */ - for (i = 4; i < 8; i++) - result[3][i] = result[c1][i]; - return false; - } else - return false; - -} - -/* -return false => do IQK again -*/ -bool -phy_simularity_compare( - struct _ADAPTER *p_adapter, - s32 result[][8], - u8 c1, - u8 c2 -) -{ - return phy_simularity_compare_92c(p_adapter, result, c1, c2); - -} - -void -_phy_iq_calibrate_8192c( - struct _ADAPTER *p_adapter, - s32 result[][8], - u8 t, - bool is2T -) -{ - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); - u32 i; - u8 path_aok, path_bok; - 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 - }; - - /* since 92C & 92D have the different define in IQK_BB_REG */ - 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_FPGA0_RFMOD*/ REG_CCK_0_AFE_SETTING - }; - - u32 IQK_BB_REG_92D[IQK_BB_REG_NUM_92D] = { /* for normal */ - REG_FPGA0_XAB_RF_INTERFACE_SW, REG_FPGA0_XA_RF_INTERFACE_OE, - REG_FPGA0_XB_RF_INTERFACE_OE, REG_OFDM_0_TR_MUX_PAR, - REG_FPGA0_XCD_RF_INTERFACE_SW, REG_OFDM_0_TRX_PATH_ENABLE, - /*REG_FPGA0_RFMOD*/ REG_CCK_0_AFE_SETTING, REG_FPGA0_ANALOG_PARAMETER4, - REG_OFDM_0_XA_AGC_CORE1, REG_OFDM_0_XB_AGC_CORE1 - }; -#if MP_DRIVER - const u32 retry_count = 9; -#else - const u32 retry_count = 2; -#endif - /* Neil Chen--2011--05--19-- - * 3 path Div */ - u8 rf_path_switch = 0x0; - - /* Note: IQ calibration must be performed after loading */ - /* PHY_REG.txt , and radio_a, radio_b.txt */ - - u32 bbvalue; - - if (t == 0) { - /* bbvalue = phy_query_bb_reg(p_adapter, REG_FPGA0_RFMOD, MASKDWORD); */ - /* RTPRINT(FINIT, INIT_IQK, ("_phy_iq_calibrate_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_save_adda_registers(p_adapter, ADDA_REG, p_hal_data->ADDA_backup, IQK_ADDA_REG_NUM); - phy_save_mac_registers(p_adapter, IQK_MAC_REG, p_hal_data->IQK_MAC_backup); - phy_save_adda_registers(p_adapter, IQK_BB_REG_92C, p_hal_data->IQK_BB_backup, IQK_BB_REG_NUM); - } - - phy_path_adda_on(p_adapter, ADDA_REG, true, is2T); - - if (t == 0) - p_hal_data->is_rf_pi_enable = (u8)phy_query_bb_reg(p_adapter, REG_FPGA0_XA_HSSI_PARAMETER1, BIT(8)); - - if (!p_hal_data->is_rf_pi_enable) { - /* Switch BB to PI mode to do IQ Calibration. */ - phy_pi_mode_switch(p_adapter, true); - } - - /* MAC settings */ - phy_mac_setting_calibration(p_adapter, IQK_MAC_REG, p_hal_data->IQK_MAC_backup); - - /* phy_set_bb_reg(p_adapter, REG_FPGA0_RFMOD, BIT24, 0x00); */ - phy_set_bb_reg(p_adapter, REG_CCK_0_AFE_SETTING, MASKDWORD, (0x0f000000 | (phy_query_bb_reg(p_adapter, REG_CCK_0_AFE_SETTING, MASKDWORD)))); - phy_set_bb_reg(p_adapter, REG_OFDM_0_TRX_PATH_ENABLE, MASKDWORD, 0x03a05600); - phy_set_bb_reg(p_adapter, REG_OFDM_0_TR_MUX_PAR, MASKDWORD, 0x000800e4); - phy_set_bb_reg(p_adapter, REG_FPGA0_XCD_RF_INTERFACE_SW, MASKDWORD, 0x22204000); - { - phy_set_bb_reg(p_adapter, REG_FPGA0_XAB_RF_INTERFACE_SW, BIT(10), 0x01); - phy_set_bb_reg(p_adapter, REG_FPGA0_XAB_RF_INTERFACE_SW, BIT(26), 0x01); - phy_set_bb_reg(p_adapter, REG_FPGA0_XA_RF_INTERFACE_OE, BIT(10), 0x00); - phy_set_bb_reg(p_adapter, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(10), 0x00); - } - - if (is2T) { - phy_set_bb_reg(p_adapter, REG_FPGA0_XA_LSSI_PARAMETER, MASKDWORD, 0x00010000); - phy_set_bb_reg(p_adapter, REG_FPGA0_XB_LSSI_PARAMETER, MASKDWORD, 0x00010000); - } - - { - /* Page B init */ - phy_set_bb_reg(p_adapter, REG_CONFIG_ANT_A, MASKDWORD, 0x00080000); - - if (is2T) - phy_set_bb_reg(p_adapter, REG_CONFIG_ANT_B, MASKDWORD, 0x00080000); - } - /* IQ calibration setting */ - RTPRINT(FINIT, INIT_IQK, ("IQK setting!\n")); - phy_set_bb_reg(p_adapter, REG_FPGA0_IQK, 0xffffff00, 0x808000); - phy_set_bb_reg(p_adapter, REG_TX_IQK, MASKDWORD, 0x01007c00); - phy_set_bb_reg(p_adapter, REG_RX_IQK, MASKDWORD, 0x01004800); - - for (i = 0 ; i < retry_count ; i++) { - path_aok = phy_path_a_iqk_8192c(p_adapter, is2T); - if (path_aok == 0x03) { - RTPRINT(FINIT, INIT_IQK, ("path A IQK Success!!\n")); - result[t][0] = (phy_query_bb_reg(p_adapter, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD) & 0x3FF0000) >> 16; - result[t][1] = (phy_query_bb_reg(p_adapter, REG_TX_POWER_AFTER_IQK_A, MASKDWORD) & 0x3FF0000) >> 16; - result[t][2] = (phy_query_bb_reg(p_adapter, REG_RX_POWER_BEFORE_IQK_A_2, MASKDWORD) & 0x3FF0000) >> 16; - result[t][3] = (phy_query_bb_reg(p_adapter, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD) & 0x3FF0000) >> 16; - break; - } else if (i == (retry_count - 1) && path_aok == 0x01) { /* Tx IQK OK */ - RTPRINT(FINIT, INIT_IQK, ("path A IQK Only Tx Success!!\n")); - - result[t][0] = (phy_query_bb_reg(p_adapter, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD) & 0x3FF0000) >> 16; - result[t][1] = (phy_query_bb_reg(p_adapter, REG_TX_POWER_AFTER_IQK_A, MASKDWORD) & 0x3FF0000) >> 16; - } - } - - if (0x00 == path_aok) - RTPRINT(FINIT, INIT_IQK, ("path A IQK failed!!\n")); - - if (is2T) { - phy_path_a_stand_by(p_adapter); - - /* Turn path B ADDA on */ - phy_path_adda_on(p_adapter, ADDA_REG, false, is2T); - - for (i = 0 ; i < retry_count ; i++) { - path_bok = phy_path_b_iqk_8192c(p_adapter); - if (path_bok == 0x03) { - RTPRINT(FINIT, INIT_IQK, ("path B IQK Success!!\n")); - result[t][4] = (phy_query_bb_reg(p_adapter, REG_TX_POWER_BEFORE_IQK_B, MASKDWORD) & 0x3FF0000) >> 16; - result[t][5] = (phy_query_bb_reg(p_adapter, REG_TX_POWER_AFTER_IQK_B, MASKDWORD) & 0x3FF0000) >> 16; - result[t][6] = (phy_query_bb_reg(p_adapter, REG_RX_POWER_BEFORE_IQK_B_2, MASKDWORD) & 0x3FF0000) >> 16; - result[t][7] = (phy_query_bb_reg(p_adapter, REG_RX_POWER_AFTER_IQK_B_2, MASKDWORD) & 0x3FF0000) >> 16; - break; - } else if (i == (retry_count - 1) && path_bok == 0x01) { /* Tx IQK OK */ - RTPRINT(FINIT, INIT_IQK, ("path B Only Tx IQK Success!!\n")); - result[t][4] = (phy_query_bb_reg(p_adapter, REG_TX_POWER_BEFORE_IQK_B, MASKDWORD) & 0x3FF0000) >> 16; - result[t][5] = (phy_query_bb_reg(p_adapter, REG_TX_POWER_AFTER_IQK_B, MASKDWORD) & 0x3FF0000) >> 16; - } - } - - if (0x00 == path_bok) - 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_set_bb_reg(p_adapter, REG_FPGA0_IQK, 0xffffff00, 0); - - if (t != 0) { - if (!p_hal_data->is_rf_pi_enable) { - /* Switch back BB to SI mode after finish IQ Calibration. */ - phy_pi_mode_switch(p_adapter, false); - } - - /* Reload ADDA power saving parameters */ - phy_reload_adda_registers(p_adapter, ADDA_REG, p_hal_data->ADDA_backup, IQK_ADDA_REG_NUM); - - /* Reload MAC parameters */ - phy_reload_mac_registers(p_adapter, IQK_MAC_REG, p_hal_data->IQK_MAC_backup); - - /* Reload BB parameters */ - phy_reload_adda_registers(p_adapter, IQK_BB_REG_92C, p_hal_data->IQK_BB_backup, IQK_BB_REG_NUM); - - /*Restore RX initial gain*/ - phy_set_bb_reg(p_adapter, REG_FPGA0_XA_LSSI_PARAMETER, MASKDWORD, 0x00032ed3); - if (is2T) - phy_set_bb_reg(p_adapter, REG_FPGA0_XB_LSSI_PARAMETER, MASKDWORD, 0x00032ed3); - /* load 0xe30 IQC default value */ - phy_set_bb_reg(p_adapter, REG_TX_IQK_TONE_A, MASKDWORD, 0x01008c00); - phy_set_bb_reg(p_adapter, REG_RX_IQK_TONE_A, MASKDWORD, 0x01008c00); - - } - RTPRINT(FINIT, INIT_IQK, ("_phy_iq_calibrate_8192c() <==\n")); - -} - - -void -_phy_lccalibrate92c( - struct _ADAPTER *p_adapter, - bool is2T -) -{ - u8 tmp_reg; - u32 rf_amode = 0, rf_bmode = 0, lc_cal; - /* HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); */ - - /* Check continuous TX and Packet TX */ - tmp_reg = platform_efio_read_1byte(p_adapter, 0xd03); - - if ((tmp_reg & 0x70) != 0) /* Deal with contisuous TX case */ - platform_efio_write_1byte(p_adapter, 0xd03, tmp_reg & 0x8F); /* disable all continuous TX */ - else /* Deal with Packet TX case */ - platform_efio_write_1byte(p_adapter, REG_TXPAUSE, 0xFF); /* block all queues */ - - if ((tmp_reg & 0x70) != 0) { - /* 1. Read original RF mode */ - /* path-A */ - rf_amode = phy_query_rf_reg(p_adapter, RF_PATH_A, RF_AC, MASK12BITS); - - /* path-B */ - if (is2T) - rf_bmode = phy_query_rf_reg(p_adapter, RF_PATH_B, RF_AC, MASK12BITS); - - /* 2. Set RF mode = standby mode */ - /* path-A */ - phy_set_rf_reg(p_adapter, RF_PATH_A, RF_AC, MASK12BITS, (rf_amode & 0x8FFFF) | 0x10000); - - /* path-B */ - if (is2T) - phy_set_rf_reg(p_adapter, RF_PATH_B, RF_AC, MASK12BITS, (rf_bmode & 0x8FFFF) | 0x10000); - } - - /* 3. Read RF reg18 */ - lc_cal = phy_query_rf_reg(p_adapter, RF_PATH_A, RF_CHNLBW, MASK12BITS); - - /* 4. Set LC calibration begin bit15 */ - phy_set_rf_reg(p_adapter, RF_PATH_A, RF_CHNLBW, MASK12BITS, lc_cal | 0x08000); - - delay_ms(100); - - - /* Restore original situation */ - if ((tmp_reg & 0x70) != 0) { /* Deal with contisuous TX case */ - /* path-A */ - platform_efio_write_1byte(p_adapter, 0xd03, tmp_reg); - phy_set_rf_reg(p_adapter, RF_PATH_A, RF_AC, MASK12BITS, rf_amode); - - /* path-B */ - if (is2T) - phy_set_rf_reg(p_adapter, RF_PATH_B, RF_AC, MASK12BITS, rf_bmode); - } else /* Deal with Packet TX case */ - platform_efio_write_1byte(p_adapter, REG_TXPAUSE, 0x00); -} - - -void -phy_lc_calibrate( - struct _ADAPTER *p_adapter, - bool is2T -) -{ - _phy_lccalibrate92c(p_adapter, is2T); -} - - - -/* Analog Pre-distortion calibration */ -#define APK_BB_REG_NUM 8 -#define APK_CURVE_REG_NUM 4 -#define PATH_NUM 2 - -void -_phy_ap_calibrate_8192c( - struct _ADAPTER *p_adapter, - s8 delta, - bool is2T -) -{ - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); - - u32 reg_d[PATH_NUM]; - u32 tmp_reg, index, offset, i, apkbound; - u8 path, pathbound = PATH_NUM; - u32 BB_backup[APK_BB_REG_NUM]; - u32 BB_REG[APK_BB_REG_NUM] = { - REG_FPGA1_TX_BLOCK, REG_OFDM_0_TRX_PATH_ENABLE, - REG_FPGA0_RFMOD, REG_OFDM_0_TR_MUX_PAR, - REG_FPGA0_XCD_RF_INTERFACE_SW, REG_FPGA0_XAB_RF_INTERFACE_SW, - REG_FPGA0_XA_RF_INTERFACE_OE, REG_FPGA0_XB_RF_INTERFACE_OE - }; - u32 BB_AP_MODE[APK_BB_REG_NUM] = { - 0x00000020, 0x00a05430, 0x02040000, - 0x000800e4, 0x00204000 - }; - u32 BB_normal_AP_MODE[APK_BB_REG_NUM] = { - 0x00000020, 0x00a05430, 0x02040000, - 0x000800e4, 0x22204000 - }; - - u32 AFE_backup[IQK_ADDA_REG_NUM]; - u32 AFE_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 MAC_backup[IQK_MAC_REG_NUM]; - u32 MAC_REG[IQK_MAC_REG_NUM] = { - REG_TXPAUSE, REG_BCN_CTRL, - REG_BCN_CTRL_1, REG_GPIO_MUXCFG - }; - - u32 APK_RF_init_value[PATH_NUM][APK_BB_REG_NUM] = { - {0x0852c, 0x1852c, 0x5852c, 0x1852c, 0x5852c}, - {0x2852e, 0x0852e, 0x3852e, 0x0852e, 0x0852e} - }; - - u32 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} - }; - - u32 APK_RF_value_0[PATH_NUM][APK_BB_REG_NUM] = { - {0x52019, 0x52014, 0x52013, 0x5200f, 0x5208d}, - {0x5201a, 0x52019, 0x52016, 0x52033, 0x52050} - }; - - u32 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 - u32 APK_RF_value_A[PATH_NUM][APK_BB_REG_NUM] = { - {0x1adb0, 0x1adb0, 0x1ada0, 0x1ad90, 0x1ad80}, - {0x00fb0, 0x00fb0, 0x00fa0, 0x00f90, 0x00f80} - }; -#endif - u32 AFE_on_off[PATH_NUM] = { - 0x04db25a4, 0x0b1b25a4 - }; /* path A on path B off / path A off path B on */ - - u32 APK_offset[PATH_NUM] = { - REG_CONFIG_ANT_A, REG_CONFIG_ANT_B - }; - - u32 APK_normal_offset[PATH_NUM] = { - REG_CONFIG_PMPD_ANT_A, REG_CONFIG_PMPD_ANT_B - }; - - u32 APK_value[PATH_NUM] = { - 0x92fc0000, 0x12fc0000 - }; - - u32 APK_normal_value[PATH_NUM] = { - 0x92680000, 0x12680000 - }; - - s8 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} - }; - - u32 APK_normal_setting_value_1[13] = { - 0x01017018, 0xf7ed8f84, 0x1b1a1816, 0x2522201e, 0x322e2b28, - 0x433f3a36, 0x5b544e49, 0x7b726a62, 0xa69a8f84, 0xdfcfc0b3, - 0x12680000, 0x00880000, 0x00880000 - }; - - u32 APK_normal_setting_value_2[16] = { - 0x01c7021d, 0x01670183, 0x01000123, 0x00bf00e2, 0x008d00a3, - 0x0068007b, 0x004d0059, 0x003a0042, 0x002b0031, 0x001f0025, - 0x0017001b, 0x00110014, 0x000c000f, 0x0009000b, 0x00070008, - 0x00050006 - }; - - u32 APK_result[PATH_NUM][APK_BB_REG_NUM]; /* val_1_1a, val_1_2a, val_2a, val_3a, val_4a - * u32 AP_curve[PATH_NUM][APK_CURVE_REG_NUM]; */ - - s32 BB_offset, delta_V, delta_offset; - -#if MP_DRIVER == 1 - PMPT_CONTEXT p_mpt_ctx = &(p_adapter->mpt_ctx); - - p_mpt_ctx->APK_bound[0] = 45; - p_mpt_ctx->APK_bound[1] = 52; -#endif - - RTPRINT(FINIT, INIT_IQK, ("==>_phy_ap_calibrate_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_query_bb_reg(p_adapter, BB_REG[index], MASKDWORD); - } - - /* save MAC default value */ - phy_save_mac_registers(p_adapter, MAC_REG, MAC_backup); - - /* save AFE default value */ - phy_save_adda_registers(p_adapter, 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 = REG_PDP_ANT_A; - for (index = 0; index < 11; index++) { - phy_set_bb_reg(p_adapter, offset, MASKDWORD, APK_normal_setting_value_1[index]); - RTPRINT(FINIT, INIT_IQK, ("_phy_ap_calibrate_8192c() offset 0x%x value 0x%x\n", offset, phy_query_bb_reg(p_adapter, offset, MASKDWORD))); - - offset += 0x04; - } - - phy_set_bb_reg(p_adapter, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x12680000); - - offset = REG_CONFIG_ANT_A; - for (; index < 13; index++) { - phy_set_bb_reg(p_adapter, offset, MASKDWORD, APK_normal_setting_value_1[index]); - RTPRINT(FINIT, INIT_IQK, ("_phy_ap_calibrate_8192c() offset 0x%x value 0x%x\n", offset, phy_query_bb_reg(p_adapter, offset, MASKDWORD))); - - offset += 0x04; - } - - /* page-B1 */ - phy_set_bb_reg(p_adapter, REG_FPGA0_IQK, 0xffffff00, 0x400000); - - /* path A */ - offset = REG_PDP_ANT_A; - for (index = 0; index < 16; index++) { - phy_set_bb_reg(p_adapter, offset, MASKDWORD, APK_normal_setting_value_2[index]); - RTPRINT(FINIT, INIT_IQK, ("_phy_ap_calibrate_8192c() offset 0x%x value 0x%x\n", offset, phy_query_bb_reg(p_adapter, offset, MASKDWORD))); - - offset += 0x04; - } - phy_set_bb_reg(p_adapter, REG_FPGA0_IQK, 0xffffff00, 0); - } else if (path == RF_PATH_B) { - /* path B APK */ - /* load APK setting */ - /* path-B */ - offset = REG_PDP_ANT_B; - for (index = 0; index < 10; index++) { - phy_set_bb_reg(p_adapter, offset, MASKDWORD, APK_normal_setting_value_1[index]); - RTPRINT(FINIT, INIT_IQK, ("_phy_ap_calibrate_8192c() offset 0x%x value 0x%x\n", offset, phy_query_bb_reg(p_adapter, offset, MASKDWORD))); - - offset += 0x04; - } - phy_set_bb_reg(p_adapter, REG_CONFIG_PMPD_ANT_A, MASKDWORD, 0x12680000); - - phy_set_bb_reg(p_adapter, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x12680000); - - offset = REG_CONFIG_ANT_A; - index = 11; - for (; index < 13; index++) { /* offset 0xb68, 0xb6c */ - phy_set_bb_reg(p_adapter, offset, MASKDWORD, APK_normal_setting_value_1[index]); - RTPRINT(FINIT, INIT_IQK, ("_phy_ap_calibrate_8192c() offset 0x%x value 0x%x\n", offset, phy_query_bb_reg(p_adapter, offset, MASKDWORD))); - - offset += 0x04; - } - - /* page-B1 */ - phy_set_bb_reg(p_adapter, REG_FPGA0_IQK, 0xffffff00, 0x400000); - - /* path B */ - offset = 0xb60; - for (index = 0; index < 16; index++) { - phy_set_bb_reg(p_adapter, offset, MASKDWORD, APK_normal_setting_value_2[index]); - RTPRINT(FINIT, INIT_IQK, ("_phy_ap_calibrate_8192c() offset 0x%x value 0x%x\n", offset, phy_query_bb_reg(p_adapter, offset, MASKDWORD))); - - offset += 0x04; - } - phy_set_bb_reg(p_adapter, REG_FPGA0_IQK, 0xffffff00, 0); - } - - /* save RF default value */ - reg_d[path] = phy_query_rf_reg(p_adapter, path, RF_TXBIAS_A, RFREGOFFSETMASK); - - /* path A AFE all on, path B AFE All off or vise versa */ - for (index = 0; index < IQK_ADDA_REG_NUM ; index++) - phy_set_bb_reg(p_adapter, AFE_REG[index], MASKDWORD, AFE_on_off[path]); - RTPRINT(FINIT, INIT_IQK, ("_phy_ap_calibrate_8192c() offset 0xe70 %x\n", phy_query_bb_reg(p_adapter, REG_RX_WAIT_CCA, MASKDWORD))); - - /* 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_set_bb_reg(p_adapter, BB_REG[index], MASKDWORD, BB_AP_MODE[index]); - else if (BB_REG[index] == 0x870) - phy_set_bb_reg(p_adapter, BB_REG[index], MASKDWORD, BB_backup[index] | BIT(10) | BIT(26)); - else - phy_set_bb_reg(p_adapter, BB_REG[index], BIT(10), 0x0); - } - - phy_set_bb_reg(p_adapter, REG_TX_IQK_TONE_A, MASKDWORD, 0x01008c00); - phy_set_bb_reg(p_adapter, REG_RX_IQK_TONE_A, MASKDWORD, 0x01008c00); - } else { /* path B */ - phy_set_bb_reg(p_adapter, REG_TX_IQK_TONE_B, MASKDWORD, 0x01008c00); - phy_set_bb_reg(p_adapter, REG_RX_IQK_TONE_B, MASKDWORD, 0x01008c00); - - } - - RTPRINT(FINIT, INIT_IQK, ("_phy_ap_calibrate_8192c() offset 0x800 %x\n", phy_query_bb_reg(p_adapter, 0x800, MASKDWORD))); - - /* MAC settings */ - phy_mac_setting_calibration(p_adapter, MAC_REG, MAC_backup); - - if (path == RF_PATH_A) /* path B to standby mode */ - phy_set_rf_reg(p_adapter, RF_PATH_B, RF_AC, RFREGOFFSETMASK, 0x10000); - else { /* path A to standby mode */ - phy_set_rf_reg(p_adapter, RF_PATH_A, RF_AC, RFREGOFFSETMASK, 0x10000); - phy_set_rf_reg(p_adapter, RF_PATH_A, RF_MODE1, RFREGOFFSETMASK, 0x1000f); - phy_set_rf_reg(p_adapter, RF_PATH_A, RF_MODE2, RFREGOFFSETMASK, 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; - - tmp_reg = APK_RF_init_value[path][index]; -#if 1 - if (!p_hal_data->is_apk_thermal_meter_ignore) { - BB_offset = (tmp_reg & 0xF0000) >> 16; - - if (!(tmp_reg & BIT(15))) /* sign bit 0 */ - BB_offset = -BB_offset; - - delta_V = APK_delta_mapping[index][delta_offset]; - - BB_offset += delta_V; - - RTPRINT(FINIT, INIT_IQK, ("_phy_ap_calibrate_8192c() APK index %d tmp_reg 0x%x delta_V %d delta_offset %d\n", index, tmp_reg, delta_V, delta_offset)); - - if (BB_offset < 0) { - tmp_reg = tmp_reg & (~BIT(15)); - BB_offset = -BB_offset; - } else - tmp_reg = tmp_reg | BIT(15); - tmp_reg = (tmp_reg & 0xFFF0FFFF) | (BB_offset << 16); - } -#endif - -#if DEV_BUS_TYPE == RT_PCI_INTERFACE - if (IS_81xxC_VENDOR_UMC_B_CUT(p_hal_data->version_id)) - phy_set_rf_reg(p_adapter, path, RF_IPA_A, RFREGOFFSETMASK, 0x894ae); - else -#endif - phy_set_rf_reg(p_adapter, path, RF_IPA_A, RFREGOFFSETMASK, 0x8992e); - RTPRINT(FINIT, INIT_IQK, ("_phy_ap_calibrate_8192c() offset 0xc %x\n", phy_query_rf_reg(p_adapter, path, RF_IPA_A, RFREGOFFSETMASK))); - phy_set_rf_reg(p_adapter, path, RF_AC, RFREGOFFSETMASK, APK_RF_value_0[path][index]); - RTPRINT(FINIT, INIT_IQK, ("_phy_ap_calibrate_8192c() offset 0x0 %x\n", phy_query_rf_reg(p_adapter, path, RF_AC, RFREGOFFSETMASK))); - phy_set_rf_reg(p_adapter, path, RF_TXBIAS_A, RFREGOFFSETMASK, tmp_reg); - RTPRINT(FINIT, INIT_IQK, ("_phy_ap_calibrate_8192c() offset 0xd %x\n", phy_query_rf_reg(p_adapter, path, RF_TXBIAS_A, RFREGOFFSETMASK))); - - /* PA11+PAD01111, one shot */ - i = 0; - do { - phy_set_bb_reg(p_adapter, REG_FPGA0_IQK, 0xffffff00, 0x800000); - { - phy_set_bb_reg(p_adapter, APK_offset[path], MASKDWORD, APK_value[0]); - RTPRINT(FINIT, INIT_IQK, ("_phy_ap_calibrate_8192c() offset 0x%x value 0x%x\n", APK_offset[path], phy_query_bb_reg(p_adapter, APK_offset[path], MASKDWORD))); - delay_ms(3); - phy_set_bb_reg(p_adapter, APK_offset[path], MASKDWORD, APK_value[1]); - RTPRINT(FINIT, INIT_IQK, ("_phy_ap_calibrate_8192c() offset 0x%x value 0x%x\n", APK_offset[path], phy_query_bb_reg(p_adapter, APK_offset[path], MASKDWORD))); - - delay_ms(20); - } - phy_set_bb_reg(p_adapter, REG_FPGA0_IQK, 0xffffff00, 0); - - if (path == RF_PATH_A) - tmp_reg = phy_query_bb_reg(p_adapter, REG_APK, 0x03E00000); - else - tmp_reg = phy_query_bb_reg(p_adapter, REG_APK, 0xF8000000); - RTPRINT(FINIT, INIT_IQK, ("_phy_ap_calibrate_8192c() offset 0xbd8[25:21] %x\n", tmp_reg)); - - - i++; - } while (tmp_reg > apkbound && i < 4); - - APK_result[path][index] = tmp_reg; - } - } - - /* reload MAC default value */ - phy_reload_mac_registers(p_adapter, MAC_REG, MAC_backup); - - /* reload BB default value */ - for (index = 0; index < APK_BB_REG_NUM ; index++) { - - if (index == 0) /* skip */ - continue; - phy_set_bb_reg(p_adapter, BB_REG[index], MASKDWORD, BB_backup[index]); - } - - /* reload AFE default value */ - phy_reload_adda_registers(p_adapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); - - /* reload RF path default value */ - for (path = 0; path < pathbound; path++) { - phy_set_rf_reg(p_adapter, path, RF_TXBIAS_A, RFREGOFFSETMASK, reg_d[path]); - if (path == RF_PATH_B) { - phy_set_rf_reg(p_adapter, RF_PATH_A, RF_MODE1, RFREGOFFSETMASK, 0x1000f); - phy_set_rf_reg(p_adapter, RF_PATH_A, RF_MODE2, RFREGOFFSETMASK, 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_set_rf_reg(p_adapter, path, RF_BS_PA_APSET_G1_G4, RFREGOFFSETMASK, - ((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_set_rf_reg(p_adapter, path, RF_BS_PA_APSET_G5_G8, RFREGOFFSETMASK, - ((APK_result[path][1] << 15) | (APK_result[path][1] << 10) | (0x00 << 5) | 0x05)); - else - phy_set_rf_reg(p_adapter, path, RF_BS_PA_APSET_G5_G8, RFREGOFFSETMASK, - ((APK_result[path][1] << 15) | (APK_result[path][1] << 10) | (0x02 << 5) | 0x05)); - - phy_set_rf_reg(p_adapter, path, RF_BS_PA_APSET_G9_G11, RFREGOFFSETMASK, ((0x08 << 15) | (0x08 << 10) | (0x08 << 5) | 0x08)); - } - - p_hal_data->is_ap_kdone = true; - - RTPRINT(FINIT, INIT_IQK, ("<==_phy_ap_calibrate_8192c()\n")); -} - - -void -phy_iq_calibrate_8192c( - struct _ADAPTER *p_adapter, - bool is_recovery -) -{ - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); - s32 result[4][8]; /* last is final result */ - u8 i, final_candidate, indexforchannel; - bool is_patha_ok, is_pathb_ok; - s32 rege94, rege9c, regea4, regeac, regeb4, regebc, regec4, regecc, reg_tmp = 0; - bool is12simular, is13simular, is23simular; - bool is_start_cont_tx = false, is_single_tone = false, is_carrier_suppression = false; - 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 - }; - - if (odm_check_power_status(p_adapter) == false) - return; - -#if MP_DRIVER == 1 - is_start_cont_tx = p_adapter->mpt_ctx.is_start_cont_tx; - is_single_tone = p_adapter->mpt_ctx.is_single_tone; - is_carrier_suppression = p_adapter->mpt_ctx.is_carrier_suppression; -#endif - - /* ignore IQK when continuous Tx */ - if (is_start_cont_tx || is_single_tone || is_carrier_suppression) - return; - -#ifdef DISABLE_BB_RF - return; -#endif - if (p_adapter->is_slave_of_dmsp) - return; - - if (is_recovery) { - phy_reload_adda_registers(p_adapter, IQK_BB_REG_92C, p_hal_data->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; - is_patha_ok = false; - is_pathb_ok = false; - is12simular = false; - is23simular = false; - is13simular = false; - - acquire_cck_and_rw_page_a_control(p_adapter); - /*RT_TRACE(COMP_INIT,DBG_LOUD,("Acquire Mutex in IQCalibrate\n"));*/ - for (i = 0; i < 3; i++) { - /*For 88C 1T1R*/ - _phy_iq_calibrate_8192c(p_adapter, result, i, false); - - if (i == 1) { - is12simular = phy_simularity_compare(p_adapter, result, 0, 1); - if (is12simular) { - final_candidate = 0; - break; - } - } - - if (i == 2) { - is13simular = phy_simularity_compare(p_adapter, result, 0, 2); - if (is13simular) { - final_candidate = 0; - break; - } - - is23simular = phy_simularity_compare(p_adapter, result, 1, 2); - if (is23simular) - final_candidate = 1; - else { - for (i = 0; i < 8; i++) - reg_tmp += result[3][i]; - - if (reg_tmp != 0) - final_candidate = 3; - else - final_candidate = 0xFF; - } - } - } - /* RT_TRACE(COMP_INIT,DBG_LOUD,("Release Mutex in IQCalibrate\n")); */ - release_cck_and_rw_pagea_control(p_adapter); - - 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) { - p_hal_data->rege94 = rege94 = result[final_candidate][0]; - p_hal_data->rege9c = rege9c = result[final_candidate][1]; - regea4 = result[final_candidate][2]; - regeac = result[final_candidate][3]; - p_hal_data->regeb4 = regeb4 = result[final_candidate][4]; - p_hal_data->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)); - is_patha_ok = is_pathb_ok = true; - } else { - rege94 = regeb4 = p_hal_data->rege94 = p_hal_data->regeb4 = 0x100; /* X default value */ - rege9c = regebc = p_hal_data->rege9c = p_hal_data->regebc = 0x0; /* Y default value */ - } - - if ((rege94 != 0)/*&&(regea4 != 0)*/) { - if (p_hal_data->current_band_type == BAND_ON_5G) - phy_path_a_fill_iqk_matrix_5g_normal(p_adapter, is_patha_ok, result, final_candidate, (regea4 == 0)); - else - phy_path_a_fill_iqk_matrix(p_adapter, is_patha_ok, result, final_candidate, (regea4 == 0)); - - } - - if (IS_92C_SERIAL(p_hal_data->version_id) || IS_92D_SINGLEPHY(p_hal_data->version_id)) { - if ((regeb4 != 0)/*&&(regec4 != 0)*/) { - if (p_hal_data->current_band_type == BAND_ON_5G) - phy_path_b_fill_iqk_matrix_5g_normal(p_adapter, is_pathb_ok, result, final_candidate, (regec4 == 0)); - else - phy_path_b_fill_iqk_matrix(p_adapter, is_pathb_ok, result, final_candidate, (regec4 == 0)); - } - } - - phy_save_adda_registers(p_adapter, IQK_BB_REG_92C, p_hal_data->IQK_BB_backup_recover, 9); - -} - - -void -phy_lc_calibrate_8192c( - struct _ADAPTER *p_adapter -) -{ - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); - bool is_start_cont_tx = false, is_single_tone = false, is_carrier_suppression = false; - PMGNT_INFO p_mgnt_info = &p_adapter->MgntInfo; - PMGNT_INFO p_mgnt_info_buddy_adapter; - u32 timeout = 2000, timecount = 0; - struct _ADAPTER *buddy_adapter = p_adapter->buddy_adapter; - -#if MP_DRIVER == 1 - is_start_cont_tx = p_adapter->mpt_ctx.is_start_cont_tx; - is_single_tone = p_adapter->mpt_ctx.is_single_tone; - is_carrier_suppression = p_adapter->mpt_ctx.is_carrier_suppression; -#endif - -#ifdef DISABLE_BB_RF - return; -#endif - - /* ignore LCK when continuous Tx */ - if (is_start_cont_tx || is_single_tone || is_carrier_suppression) - return; - - if (buddy_adapter != NULL && - ((p_adapter->interface_index == 0 && p_hal_data->current_band_type == BAND_ON_2_4G) || - (p_adapter->interface_index == 1 && p_hal_data->current_band_type == BAND_ON_5G))) { - p_mgnt_info_buddy_adapter = &buddy_adapter->MgntInfo; - while (p_mgnt_info_buddy_adapter->is_scan_in_progress && timecount < timeout) { - delay_ms(50); - timecount += 50; - } - } - - while (p_mgnt_info->is_scan_in_progress && timecount < timeout) { - delay_ms(50); - timecount += 50; - } - - p_hal_data->is_lck_in_progress = true; - - RTPRINT(FINIT, INIT_IQK, ("LCK:Start!!!interface %d currentband %x delay %d ms\n", p_adapter->interface_index, p_hal_data->current_band_type, timecount)); - - /* if(IS_92C_SERIAL(p_hal_data->version_id) || IS_92D_SINGLEPHY(p_hal_data->version_id)) */ - if (IS_2T2R(p_hal_data->version_id)) - phy_lc_calibrate(p_adapter, true); - else { - /* For 88C 1T1R */ - phy_lc_calibrate(p_adapter, false); - } - - p_hal_data->is_lck_in_progress = false; - - RTPRINT(FINIT, INIT_IQK, ("LCK:Finish!!!interface %d\n", p_adapter->interface_index)); - - -} - -void -phy_ap_calibrate_8192c( - struct _ADAPTER *p_adapter, - s8 delta -) -{ - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); - - /* 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 (p_hal_data->is_ap_kdone) -#endif - return; - - if (IS_92C_SERIAL(p_hal_data->version_id)) - _phy_ap_calibrate_8192c(p_adapter, delta, true); - else { - /* For 88C 1T1R */ - _phy_ap_calibrate_8192c(p_adapter, delta, false); - } -} - - -#endif - - -/* 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_odm -) -{ - struct _ADAPTER *adapter = p_dm_odm->adapter; - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - if (*p_dm_odm->p_is_fcs_mode_enable) - return; -#endif - - - - if (p_dm_odm->is_linked) { - if ((*p_dm_odm->p_channel != p_dm_odm->pre_channel) && (!*p_dm_odm->p_is_scan_in_process)) { - p_dm_odm->pre_channel = *p_dm_odm->p_channel; - p_dm_odm->linked_interval = 0; - } - - if (p_dm_odm->linked_interval < 3) - p_dm_odm->linked_interval++; - - if (p_dm_odm->linked_interval == 2) { - -#if (RTL8814A_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8814A) - phy_iq_calibrate_8814a(p_dm_odm, false); -#endif - -#if (RTL8822B_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8822B) - phy_iq_calibrate_8822b(p_dm_odm, false); -#endif - -#if (RTL8821C_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8821C) - phy_iq_calibrate_8821c(p_dm_odm, false); -#endif - -#if (RTL8821A_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8821) - phy_iq_calibrate_8821a(p_dm_odm, false); -#endif - -#if (RTL8812A_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8812) - _phy_iq_calibrate_8812a(p_dm_odm, false); -#endif - } - } else - p_dm_odm->linked_interval = 0; - -} - -void phydm_rf_init(void *p_dm_void) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - odm_txpowertracking_init(p_dm_odm); - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - odm_clear_txpowertracking_state(p_dm_odm); -#endif - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -#if (RTL8814A_SUPPORT == 1) - if (p_dm_odm->support_ic_type & ODM_RTL8814A) - phy_iq_calibrate_8814a_init(p_dm_odm); -#endif -#endif - -} - -void phydm_rf_watchdog(void *p_dm_void) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - odm_txpowertracking_check(p_dm_odm); - if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) - odm_iq_calibrate(p_dm_odm); -#endif -} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halphyrf_ce.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halphyrf_ce.c deleted file mode 100644 index 7451d5853dc7..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halphyrf_ce.c +++ /dev/null @@ -1,799 +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, _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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - -#if RTL8192E_SUPPORT - if (p_dm_odm->support_ic_type == ODM_RTL8192E) - configure_txpower_track_8192e(p_config); -#endif -#if RTL8821A_SUPPORT - if (p_dm_odm->support_ic_type == ODM_RTL8821) - configure_txpower_track_8821a(p_config); -#endif -#if RTL8812A_SUPPORT - if (p_dm_odm->support_ic_type == ODM_RTL8812) - configure_txpower_track_8812a(p_config); -#endif -#if RTL8188E_SUPPORT - if (p_dm_odm->support_ic_type == ODM_RTL8188E) - configure_txpower_track_8188e(p_config); -#endif - -#if RTL8723B_SUPPORT - if (p_dm_odm->support_ic_type == ODM_RTL8723B) - configure_txpower_track_8723b(p_config); -#endif - -#if RTL8814A_SUPPORT - if (p_dm_odm->support_ic_type == ODM_RTL8814A) - configure_txpower_track_8814a(p_config); -#endif - -#if RTL8703B_SUPPORT - if (p_dm_odm->support_ic_type == ODM_RTL8703B) - configure_txpower_track_8703b(p_config); -#endif - -#if RTL8188F_SUPPORT - if (p_dm_odm->support_ic_type == ODM_RTL8188F) - configure_txpower_track_8188f(p_config); -#endif -#if RTL8723D_SUPPORT - if (p_dm_odm->support_ic_type == ODM_RTL8723D) - configure_txpower_track_8723d(p_config); -#endif -#if RTL8822B_SUPPORT - if (p_dm_odm->support_ic_type == ODM_RTL8822B) - configure_txpower_track_8822b(p_config); -#endif -#if RTL8821C_SUPPORT - if (p_dm_odm->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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - PHAL_DATA_TYPE p_hal_data = GET_HAL_DATA(p_dm_odm->adapter); - u8 p = 0; - struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm_odm->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_odm->rf_calibrate_info.CCK_index = 0; - - for (p = ODM_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_odm -#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_odm = &p_hal_data->DM_OutSrc; -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->odmpriv; -#endif -#endif - - struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm_odm->rf_calibrate_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->rf_power_tracking_type; - u8 xtal_offset_eanble = 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_odm, &c); - - (*c.get_delta_swing_table)(p_dm_odm, (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_odm->support_ic_type & ODM_RTL8814A) /*for 8814 path C & D*/ - (*c.get_delta_swing_table8814only)(p_dm_odm, (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); - - if (p_dm_odm->support_ic_type & (ODM_RTL8703B | ODM_RTL8723D)) /*for Xtal Offset*/ - (*c.get_delta_swing_xtal_table)(p_dm_odm, (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_odm->mp_mode == true) - p_rf_calibrate_info->rega24 = 0x090e1317; -#endif - - ODM_RT_TRACE(p_dm_odm, 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[ODM_RF_PATH_A], p_rf_calibrate_info->default_ofdm_index)); - - ODM_RT_TRACE(p_dm_odm, 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_odm, ODM_RF_PATH_A, c.thermal_reg_addr, 0xfc00); /* 0x42: RF Reg[15:10] 88E */ - - /*add log by zhao he, check c80/c94/c14/ca0 value*/ - if (p_dm_odm->support_ic_type == ODM_RTL8723D) { - regc80 = odm_get_bb_reg(p_dm_odm, 0xc80, MASKDWORD); - regcd0 = odm_get_bb_reg(p_dm_odm, 0xcd0, MASKDWORD); - regcd4 = odm_get_bb_reg(p_dm_odm, 0xcd4, MASKDWORD); - regab4 = odm_get_bb_reg(p_dm_odm, 0xab4, 0x000007FF); - ODM_RT_TRACE(p_dm_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 (!p_rf_calibrate_info->txpowertrack_control) - return; - - - /*4 3. Initialize ThermalValues of rf_calibrate_info*/ - - if (p_rf_calibrate_info->is_reloadtxpowerindex) - ODM_RT_TRACE(p_dm_odm, 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, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("no PG, use thermal_value for IQK\n")); - } - - for (p = ODM_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_odm->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, 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_odm->support_ic_type & ODM_RTL8814A)) { - if (c.phy_lc_calibrate) - (*c.phy_lc_calibrate)(p_dm_odm); - } - - 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, 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(p_dm_odm, 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_odm->support_ic_type & ODM_RTL8814A)) { - if (c.phy_lc_calibrate) - (*c.phy_lc_calibrate)(p_dm_odm); - } - } - } - - /*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_odm->priv->pmib->dot11RFEntry.ther) ? (thermal_value - p_dm_odm->priv->pmib->dot11RFEntry.ther) : (p_dm_odm->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_odm->priv->pmib->dot11RFEntry.ther) { -#endif - - for (p = ODM_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 ODM_RF_PATH_B: - ODM_RT_TRACE(p_dm_odm, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is higher and p_rf_calibrate_info->absolute_ofdm_swing_idx[ODM_RF_PATH_B] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); - break; - - case ODM_RF_PATH_C: - ODM_RT_TRACE(p_dm_odm, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is higher and p_rf_calibrate_info->absolute_ofdm_swing_idx[ODM_RF_PATH_C] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); - break; - - case ODM_RF_PATH_D: - ODM_RT_TRACE(p_dm_odm, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is higher and p_rf_calibrate_info->absolute_ofdm_swing_idx[ODM_RF_PATH_D] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); - break; - - default: - ODM_RT_TRACE(p_dm_odm, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is higher and p_rf_calibrate_info->absolute_ofdm_swing_idx[ODM_RF_PATH_A] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); - break; - } - } - - if (p_dm_odm->support_ic_type & (ODM_RTL8703B | ODM_RTL8723D)) { - /*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, 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 = ODM_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 ODM_RF_PATH_B: - ODM_RT_TRACE(p_dm_odm, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is lower and p_rf_calibrate_info->absolute_ofdm_swing_idx[ODM_RF_PATH_B] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); - break; - - case ODM_RF_PATH_C: - ODM_RT_TRACE(p_dm_odm, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is lower and p_rf_calibrate_info->absolute_ofdm_swing_idx[ODM_RF_PATH_C] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); - break; - - case ODM_RF_PATH_D: - ODM_RT_TRACE(p_dm_odm, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is lower and p_rf_calibrate_info->absolute_ofdm_swing_idx[ODM_RF_PATH_D] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); - break; - - default: - ODM_RT_TRACE(p_dm_odm, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is lower and p_rf_calibrate_info->absolute_ofdm_swing_idx[ODM_RF_PATH_A] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); - break; - } - } - - if (p_dm_odm->support_ic_type & (ODM_RTL8703B | ODM_RTL8723D)) { - /*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, 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 = ODM_RF_PATH_A; p < c.rf_path_count; p++) { - ODM_RT_TRACE(p_dm_odm, 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, 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, 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, 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, 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, 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 = ODM_RF_PATH_A; p < c.rf_path_count; p++) - p_rf_calibrate_info->power_index_offset[p] = 0; - } - - ODM_RT_TRACE(p_dm_odm, 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 = ODM_RF_PATH_A; p < c.rf_path_count; p++) { - ODM_RT_TRACE(p_dm_odm, 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_odm->support_ic_type & ODM_RTL8814A)) { - ODM_RT_TRACE(p_dm_odm, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX_MODE**********\n")); - for (p = ODM_RF_PATH_A; p < c.rf_path_count; p++) - (*c.odm_tx_pwr_track_set_pwr)(p_dm_odm, MIX_MODE, p, 0); - } else if (power_tracking_type == 1) { - ODM_RT_TRACE(p_dm_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.rf_path_count; p++) - (*c.odm_tx_pwr_track_set_pwr)(p_dm_odm, MIX_2G_TSSI_5G_MODE, p, 0); - } else if (power_tracking_type == 2) { - ODM_RT_TRACE(p_dm_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.rf_path_count; p++) - (*c.odm_tx_pwr_track_set_pwr)(p_dm_odm, MIX_5G_TSSI_2G_MODE, p, 0); - } else if (power_tracking_type == 3) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking TSSI MODE**********\n")); - for (p = ODM_RF_PATH_A; p < c.rf_path_count; p++) - (*c.odm_tx_pwr_track_set_pwr)(p_dm_odm, 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[ODM_RF_PATH_A] != 0 || - p_rf_calibrate_info->power_index_offset[ODM_RF_PATH_B] != 0 || - p_rf_calibrate_info->power_index_offset[ODM_RF_PATH_C] != 0 || - p_rf_calibrate_info->power_index_offset[ODM_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 = ODM_RF_PATH_A; p < c.rf_path_count; p++) { - ODM_RT_TRACE(p_dm_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, 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 = ODM_RF_PATH_A; p < c.rf_path_count; p++) { - ODM_RT_TRACE(p_dm_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, 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_odm->priv->pmib->dot11RFEntry.ther) -#endif - { - ODM_RT_TRACE(p_dm_odm, 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_odm->support_ic_type == ODM_RTL8188E || p_dm_odm->support_ic_type == ODM_RTL8192E || p_dm_odm->support_ic_type == ODM_RTL8821 || - p_dm_odm->support_ic_type == ODM_RTL8812 || p_dm_odm->support_ic_type == ODM_RTL8723B || p_dm_odm->support_ic_type == ODM_RTL8814A || - p_dm_odm->support_ic_type == ODM_RTL8703B || p_dm_odm->support_ic_type == ODM_RTL8188F || p_dm_odm->support_ic_type == ODM_RTL8822B || - p_dm_odm->support_ic_type == ODM_RTL8723D || p_dm_odm->support_ic_type == ODM_RTL8821C) { - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX_MODE**********\n")); - for (p = ODM_RF_PATH_A; p < c.rf_path_count; p++) - (*c.odm_tx_pwr_track_set_pwr)(p_dm_odm, MIX_MODE, p, 0); - } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking BBSWING_MODE**********\n")); - for (p = ODM_RF_PATH_A; p < c.rf_path_count; p++) - (*c.odm_tx_pwr_track_set_pwr)(p_dm_odm, BBSWING, p, indexforchannel); - } - } else { - ODM_RT_TRACE(p_dm_odm, 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_odm->support_ic_type == ODM_RTL8188E || p_dm_odm->support_ic_type == ODM_RTL8192E || p_dm_odm->support_ic_type == ODM_RTL8821 || - p_dm_odm->support_ic_type == ODM_RTL8812 || p_dm_odm->support_ic_type == ODM_RTL8723B || p_dm_odm->support_ic_type == ODM_RTL8814A || - p_dm_odm->support_ic_type == ODM_RTL8703B || p_dm_odm->support_ic_type == ODM_RTL8188F || p_dm_odm->support_ic_type == ODM_RTL8822B || - p_dm_odm->support_ic_type == ODM_RTL8723D || p_dm_odm->support_ic_type == ODM_RTL8821C) { - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX_MODE**********\n")); - for (p = ODM_RF_PATH_A; p < c.rf_path_count; p++) - (*c.odm_tx_pwr_track_set_pwr)(p_dm_odm, MIX_MODE, p, indexforchannel); - } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking BBSWING_MODE**********\n")); - for (p = ODM_RF_PATH_A; p < c.rf_path_count; p++) - (*c.odm_tx_pwr_track_set_pwr)(p_dm_odm, 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 = ODM_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, 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_odm->support_ic_type == ODM_RTL8703B || p_dm_odm->support_ic_type == ODM_RTL8723D) { - - if (xtal_offset_eanble != 0 && p_rf_calibrate_info->txpowertrack_control && (p_hal_data->eeprom_thermal_meter != 0xff)) { - - ODM_RT_TRACE(p_dm_odm, 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_odm->priv->pmib->dot11RFEntry.ther) { -#endif - ODM_RT_TRACE(p_dm_odm, 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_odm); - } else { - ODM_RT_TRACE(p_dm_odm, 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); - } - } - ODM_RT_TRACE(p_dm_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(p_dm_odm, 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_odm, delta_IQK, thermal_value, 8); - } - } - if (p_rf_calibrate_info->dpk_thermal[ODM_RF_PATH_A] != 0) { - if (diff_DPK[ODM_RF_PATH_A] >= c.threshold_dpk) { - odm_set_bb_reg(p_dm_odm, 0x82c, BIT(31), 0x1); - odm_set_bb_reg(p_dm_odm, 0xcc4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), (diff_DPK[ODM_RF_PATH_A] / c.threshold_dpk)); - odm_set_bb_reg(p_dm_odm, 0x82c, BIT(31), 0x0); - } else if ((diff_DPK[ODM_RF_PATH_A] <= -1 * c.threshold_dpk)) { - s32 value = 0x20 + (diff_DPK[ODM_RF_PATH_A] / c.threshold_dpk); - - odm_set_bb_reg(p_dm_odm, 0x82c, BIT(31), 0x1); - odm_set_bb_reg(p_dm_odm, 0xcc4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), value); - odm_set_bb_reg(p_dm_odm, 0x82c, BIT(31), 0x0); - } else { - odm_set_bb_reg(p_dm_odm, 0x82c, BIT(31), 0x1); - odm_set_bb_reg(p_dm_odm, 0xcc4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), 0); - odm_set_bb_reg(p_dm_odm, 0x82c, BIT(31), 0x0); - } - } - if (p_rf_calibrate_info->dpk_thermal[ODM_RF_PATH_B] != 0) { - if (diff_DPK[ODM_RF_PATH_B] >= c.threshold_dpk) { - odm_set_bb_reg(p_dm_odm, 0x82c, BIT(31), 0x1); - odm_set_bb_reg(p_dm_odm, 0xec4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), (diff_DPK[ODM_RF_PATH_B] / c.threshold_dpk)); - odm_set_bb_reg(p_dm_odm, 0x82c, BIT(31), 0x0); - } else if ((diff_DPK[ODM_RF_PATH_B] <= -1 * c.threshold_dpk)) { - s32 value = 0x20 + (diff_DPK[ODM_RF_PATH_B] / c.threshold_dpk); - - odm_set_bb_reg(p_dm_odm, 0x82c, BIT(31), 0x1); - odm_set_bb_reg(p_dm_odm, 0xec4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), value); - odm_set_bb_reg(p_dm_odm, 0x82c, BIT(31), 0x0); - } else { - odm_set_bb_reg(p_dm_odm, 0x82c, BIT(31), 0x1); - odm_set_bb_reg(p_dm_odm, 0xec4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), 0); - odm_set_bb_reg(p_dm_odm, 0x82c, BIT(31), 0x0); - } - } - -#endif - - ODM_RT_TRACE(p_dm_odm, 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_odm -) -{ - struct _ADAPTER *adapter = p_dm_odm->adapter; - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - if (*p_dm_odm->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_odm->is_linked) { - if ((*p_dm_odm->p_channel != p_dm_odm->pre_channel) && (!*p_dm_odm->p_is_scan_in_process)) { - p_dm_odm->pre_channel = *p_dm_odm->p_channel; - p_dm_odm->linked_interval = 0; - } - - if (p_dm_odm->linked_interval < 3) - p_dm_odm->linked_interval++; - - if (p_dm_odm->linked_interval == 2) { - if (IS_HARDWARE_TYPE_8814A(adapter)) { -#if (RTL8814A_SUPPORT == 1) - phy_iq_calibrate_8814a(p_dm_odm, false); -#endif - } - -#if (RTL8822B_SUPPORT == 1) - else if (IS_HARDWARE_TYPE_8822B(adapter)) - phy_iq_calibrate_8822b(p_dm_odm, false); -#endif - -#if (RTL8821C_SUPPORT == 1) - else if (IS_HARDWARE_TYPE_8821C(adapter)) - phy_iq_calibrate_8821c(p_dm_odm, false); -#endif - -#if (RTL8821A_SUPPORT == 1) - else if (IS_HARDWARE_TYPE_8821(adapter)) - phy_iq_calibrate_8821a(p_dm_odm, false); -#endif - } - } else - p_dm_odm->linked_interval = 0; -} - -void phydm_rf_init(void *p_dm_void) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - odm_txpowertracking_init(p_dm_odm); - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - odm_clear_txpowertracking_state(p_dm_odm); -#endif - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -#if (RTL8814A_SUPPORT == 1) - if (p_dm_odm->support_ic_type & ODM_RTL8814A) - phy_iq_calibrate_8814a_init(p_dm_odm); -#endif -#endif - -} - -void phydm_rf_watchdog(void *p_dm_void) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - odm_txpowertracking_check(p_dm_odm); - if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) - odm_iq_calibrate(p_dm_odm); -#endif -} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halphyrf_win.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halphyrf_win.c deleted file mode 100644 index c7c6108c8281..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halphyrf_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 "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_odm, - struct _TXPWRTRACK_CFG *p_config -) -{ -#if RTL8192E_SUPPORT - if (p_dm_odm->support_ic_type == ODM_RTL8192E) - configure_txpower_track_8192e(p_config); -#endif -#if RTL8821A_SUPPORT - if (p_dm_odm->support_ic_type == ODM_RTL8821) - configure_txpower_track_8821a(p_config); -#endif -#if RTL8812A_SUPPORT - if (p_dm_odm->support_ic_type == ODM_RTL8812) - configure_txpower_track_8812a(p_config); -#endif -#if RTL8188E_SUPPORT - if (p_dm_odm->support_ic_type == ODM_RTL8188E) - configure_txpower_track_8188e(p_config); -#endif - -#if RTL8188F_SUPPORT - if (p_dm_odm->support_ic_type == ODM_RTL8188F) - configure_txpower_track_8188f(p_config); -#endif - -#if RTL8723B_SUPPORT - if (p_dm_odm->support_ic_type == ODM_RTL8723B) - configure_txpower_track_8723b(p_config); -#endif - -#if RTL8814A_SUPPORT - if (p_dm_odm->support_ic_type == ODM_RTL8814A) - configure_txpower_track_8814a(p_config); -#endif - -#if RTL8703B_SUPPORT - if (p_dm_odm->support_ic_type == ODM_RTL8703B) - configure_txpower_track_8703b(p_config); -#endif - -#if RTL8822B_SUPPORT - if (p_dm_odm->support_ic_type == ODM_RTL8822B) - configure_txpower_track_8822b(p_config); -#endif - -#if RTL8723D_SUPPORT - if (p_dm_odm->support_ic_type == ODM_RTL8723D) - configure_txpower_track_8723d(p_config); -#endif - -#if RTL8821C_SUPPORT - if (p_dm_odm->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_odm -) -{ - PHAL_DATA_TYPE p_hal_data = GET_HAL_DATA(p_dm_odm->adapter); - u8 p = 0; - struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm_odm->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 = ODM_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_odm -#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_odm = &p_hal_data->DM_OutSrc; -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->odmpriv; -#endif -#endif - - struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm_odm->rf_calibrate_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; - - 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_odm, &c); - - (*c.get_delta_swing_table)(p_dm_odm, (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_odm->support_ic_type & ODM_RTL8814A) /*for 8814 path C & D*/ - (*c.get_delta_swing_table8814only)(p_dm_odm, (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); - - if (p_dm_odm->support_ic_type & (ODM_RTL8703B | ODM_RTL8723D)) /*for Xtal Offset*/ - (*c.get_delta_swing_xtal_table)(p_dm_odm, (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_odm->mp_mode == true) - p_rf_calibrate_info->rega24 = 0x090e1317; -#endif - - ODM_RT_TRACE(p_dm_odm, 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[ODM_RF_PATH_A], p_rf_calibrate_info->default_ofdm_index)); - - ODM_RT_TRACE(p_dm_odm, 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_odm, ODM_RF_PATH_A, c.thermal_reg_addr, 0xfc00); /* 0x42: RF Reg[15:10] 88E */ - - /*add log by zhao he, check c80/c94/c14/ca0 value*/ - if (p_dm_odm->support_ic_type == ODM_RTL8723D) { - regc80 = odm_get_bb_reg(p_dm_odm, 0xc80, MASKDWORD); - regcd0 = odm_get_bb_reg(p_dm_odm, 0xcd0, MASKDWORD); - regcd4 = odm_get_bb_reg(p_dm_odm, 0xcd4, MASKDWORD); - regab4 = odm_get_bb_reg(p_dm_odm, 0xab4, 0x000007FF); - ODM_RT_TRACE(p_dm_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 (!p_rf_calibrate_info->txpowertrack_control) - return; - - - /*4 3. Initialize ThermalValues of rf_calibrate_info*/ - - if (p_rf_calibrate_info->is_reloadtxpowerindex) - ODM_RT_TRACE(p_dm_odm, 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, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("no PG, use thermal_value for IQK\n")); - } - - for (p = ODM_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_odm->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, 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_odm->support_ic_type & ODM_RTL8814A)) { - if (c.phy_lc_calibrate) - (*c.phy_lc_calibrate)(p_dm_odm); - } - - 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, 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(p_dm_odm, 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_odm->support_ic_type & ODM_RTL8814A)) { - if (c.phy_lc_calibrate) - (*c.phy_lc_calibrate)(p_dm_odm); - } - } - } - - /*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_odm->priv->pmib->dot11RFEntry.ther) ? (thermal_value - p_dm_odm->priv->pmib->dot11RFEntry.ther) : (p_dm_odm->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_odm->priv->pmib->dot11RFEntry.ther) { -#endif - - for (p = ODM_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 ODM_RF_PATH_B: - ODM_RT_TRACE(p_dm_odm, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is higher and p_rf_calibrate_info->absolute_ofdm_swing_idx[ODM_RF_PATH_B] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); - break; - - case ODM_RF_PATH_C: - ODM_RT_TRACE(p_dm_odm, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is higher and p_rf_calibrate_info->absolute_ofdm_swing_idx[ODM_RF_PATH_C] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); - break; - - case ODM_RF_PATH_D: - ODM_RT_TRACE(p_dm_odm, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is higher and p_rf_calibrate_info->absolute_ofdm_swing_idx[ODM_RF_PATH_D] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); - break; - - default: - ODM_RT_TRACE(p_dm_odm, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is higher and p_rf_calibrate_info->absolute_ofdm_swing_idx[ODM_RF_PATH_A] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); - break; - } - } - - if (p_dm_odm->support_ic_type & (ODM_RTL8703B | ODM_RTL8723D)) { - /*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, 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 = ODM_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 ODM_RF_PATH_B: - ODM_RT_TRACE(p_dm_odm, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is lower and p_rf_calibrate_info->absolute_ofdm_swing_idx[ODM_RF_PATH_B] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); - break; - - case ODM_RF_PATH_C: - ODM_RT_TRACE(p_dm_odm, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is lower and p_rf_calibrate_info->absolute_ofdm_swing_idx[ODM_RF_PATH_C] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); - break; - - case ODM_RF_PATH_D: - ODM_RT_TRACE(p_dm_odm, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is lower and p_rf_calibrate_info->absolute_ofdm_swing_idx[ODM_RF_PATH_D] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); - break; - - default: - ODM_RT_TRACE(p_dm_odm, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is lower and p_rf_calibrate_info->absolute_ofdm_swing_idx[ODM_RF_PATH_A] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); - break; - } - } - - if (p_dm_odm->support_ic_type & (ODM_RTL8703B | ODM_RTL8723D)) { - /*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, 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 = ODM_RF_PATH_A; p < c.rf_path_count; p++) { - ODM_RT_TRACE(p_dm_odm, 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, 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, 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, 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, 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, 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 = ODM_RF_PATH_A; p < c.rf_path_count; p++) - p_rf_calibrate_info->power_index_offset[p] = 0; - } - - ODM_RT_TRACE(p_dm_odm, 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 = ODM_RF_PATH_A; p < c.rf_path_count; p++) { - ODM_RT_TRACE(p_dm_odm, 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_odm->support_ic_type & ODM_RTL8814A)) { - ODM_RT_TRACE(p_dm_odm, 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX_MODE**********\n")); - for (p = ODM_RF_PATH_A; p < c.rf_path_count; p++) - (*c.odm_tx_pwr_track_set_pwr)(p_dm_odm, MIX_MODE, p, 0); - } else if (power_tracking_type == 1) { - ODM_RT_TRACE(p_dm_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.rf_path_count; p++) - (*c.odm_tx_pwr_track_set_pwr)(p_dm_odm, MIX_2G_TSSI_5G_MODE, p, 0); - } else if (power_tracking_type == 2) { - ODM_RT_TRACE(p_dm_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.rf_path_count; p++) - (*c.odm_tx_pwr_track_set_pwr)(p_dm_odm, MIX_5G_TSSI_2G_MODE, p, 0); - } else if (power_tracking_type == 3) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking TSSI MODE**********\n")); - for (p = ODM_RF_PATH_A; p < c.rf_path_count; p++) - (*c.odm_tx_pwr_track_set_pwr)(p_dm_odm, 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[ODM_RF_PATH_A] != 0 || - p_rf_calibrate_info->power_index_offset[ODM_RF_PATH_B] != 0 || - p_rf_calibrate_info->power_index_offset[ODM_RF_PATH_C] != 0 || - p_rf_calibrate_info->power_index_offset[ODM_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 = ODM_RF_PATH_A; p < c.rf_path_count; p++) { - ODM_RT_TRACE(p_dm_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, 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 = ODM_RF_PATH_A; p < c.rf_path_count; p++) { - ODM_RT_TRACE(p_dm_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, 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_odm->priv->pmib->dot11RFEntry.ther) -#endif - { - ODM_RT_TRACE(p_dm_odm, 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_odm->support_ic_type == ODM_RTL8188E || p_dm_odm->support_ic_type == ODM_RTL8192E || p_dm_odm->support_ic_type == ODM_RTL8821 || - p_dm_odm->support_ic_type == ODM_RTL8812 || p_dm_odm->support_ic_type == ODM_RTL8723B || p_dm_odm->support_ic_type == ODM_RTL8814A || - p_dm_odm->support_ic_type == ODM_RTL8703B || p_dm_odm->support_ic_type == ODM_RTL8188F || p_dm_odm->support_ic_type == ODM_RTL8822B || - p_dm_odm->support_ic_type == ODM_RTL8723D || p_dm_odm->support_ic_type == ODM_RTL8821C) { - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX_MODE**********\n")); - for (p = ODM_RF_PATH_A; p < c.rf_path_count; p++) - (*c.odm_tx_pwr_track_set_pwr)(p_dm_odm, MIX_MODE, p, 0); - } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking BBSWING_MODE**********\n")); - for (p = ODM_RF_PATH_A; p < c.rf_path_count; p++) - (*c.odm_tx_pwr_track_set_pwr)(p_dm_odm, BBSWING, p, indexforchannel); - } - } else { - ODM_RT_TRACE(p_dm_odm, 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_odm->support_ic_type == ODM_RTL8188E || p_dm_odm->support_ic_type == ODM_RTL8192E || p_dm_odm->support_ic_type == ODM_RTL8821 || - p_dm_odm->support_ic_type == ODM_RTL8812 || p_dm_odm->support_ic_type == ODM_RTL8723B || p_dm_odm->support_ic_type == ODM_RTL8814A || - p_dm_odm->support_ic_type == ODM_RTL8703B || p_dm_odm->support_ic_type == ODM_RTL8188F || p_dm_odm->support_ic_type == ODM_RTL8822B || - p_dm_odm->support_ic_type == ODM_RTL8723D || p_dm_odm->support_ic_type == ODM_RTL8821C) { - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX_MODE**********\n")); - for (p = ODM_RF_PATH_A; p < c.rf_path_count; p++) - (*c.odm_tx_pwr_track_set_pwr)(p_dm_odm, MIX_MODE, p, indexforchannel); - } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking BBSWING_MODE**********\n")); - for (p = ODM_RF_PATH_A; p < c.rf_path_count; p++) - (*c.odm_tx_pwr_track_set_pwr)(p_dm_odm, 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 = ODM_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, 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_odm->support_ic_type == ODM_RTL8703B || p_dm_odm->support_ic_type == ODM_RTL8723D) { - - if (xtal_offset_eanble != 0 && p_rf_calibrate_info->txpowertrack_control && (p_hal_data->eeprom_thermal_meter != 0xff)) { - - ODM_RT_TRACE(p_dm_odm, 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_odm->priv->pmib->dot11RFEntry.ther) { -#endif - ODM_RT_TRACE(p_dm_odm, 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_odm); - } else { - ODM_RT_TRACE(p_dm_odm, 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); - } - } - ODM_RT_TRACE(p_dm_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) { - p_rf_calibrate_info->thermal_value_iqk = thermal_value; - ODM_RT_TRACE(p_dm_odm, 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_odm, delta_IQK, thermal_value, 8); - } - } - if (p_rf_calibrate_info->dpk_thermal[ODM_RF_PATH_A] != 0) { - if (diff_DPK[ODM_RF_PATH_A] >= c.threshold_dpk) { - odm_set_bb_reg(p_dm_odm, 0x82c, BIT(31), 0x1); - odm_set_bb_reg(p_dm_odm, 0xcc4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), (diff_DPK[ODM_RF_PATH_A] / c.threshold_dpk)); - odm_set_bb_reg(p_dm_odm, 0x82c, BIT(31), 0x0); - } else if ((diff_DPK[ODM_RF_PATH_A] <= -1 * c.threshold_dpk)) { - s32 value = 0x20 + (diff_DPK[ODM_RF_PATH_A] / c.threshold_dpk); - - odm_set_bb_reg(p_dm_odm, 0x82c, BIT(31), 0x1); - odm_set_bb_reg(p_dm_odm, 0xcc4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), value); - odm_set_bb_reg(p_dm_odm, 0x82c, BIT(31), 0x0); - } else { - odm_set_bb_reg(p_dm_odm, 0x82c, BIT(31), 0x1); - odm_set_bb_reg(p_dm_odm, 0xcc4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), 0); - odm_set_bb_reg(p_dm_odm, 0x82c, BIT(31), 0x0); - } - } - if (p_rf_calibrate_info->dpk_thermal[ODM_RF_PATH_B] != 0) { - if (diff_DPK[ODM_RF_PATH_B] >= c.threshold_dpk) { - odm_set_bb_reg(p_dm_odm, 0x82c, BIT(31), 0x1); - odm_set_bb_reg(p_dm_odm, 0xec4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), (diff_DPK[ODM_RF_PATH_B] / c.threshold_dpk)); - odm_set_bb_reg(p_dm_odm, 0x82c, BIT(31), 0x0); - } else if ((diff_DPK[ODM_RF_PATH_B] <= -1 * c.threshold_dpk)) { - s32 value = 0x20 + (diff_DPK[ODM_RF_PATH_B] / c.threshold_dpk); - - odm_set_bb_reg(p_dm_odm, 0x82c, BIT(31), 0x1); - odm_set_bb_reg(p_dm_odm, 0xec4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), value); - odm_set_bb_reg(p_dm_odm, 0x82c, BIT(31), 0x0); - } else { - odm_set_bb_reg(p_dm_odm, 0x82c, BIT(31), 0x1); - odm_set_bb_reg(p_dm_odm, 0xec4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), 0); - odm_set_bb_reg(p_dm_odm, 0x82c, BIT(31), 0x0); - } - } - -#endif - - ODM_RT_TRACE(p_dm_odm, 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_odm -) -{ - 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_odm -) -{ - struct _ADAPTER *adapter = p_dm_odm->adapter; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); - - RT_TRACE(COMP_SCAN, ODM_DBG_LOUD, ("=>%s\n" , __FUNCTION__)); - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - if (*p_dm_odm->p_is_fcs_mode_enable) - return; -#endif - - if (p_dm_odm->is_linked) { - RT_TRACE(COMP_SCAN, ODM_DBG_LOUD, ("interval=%d ch=%d prech=%d scan=%s\n", p_dm_odm->linked_interval, - *p_dm_odm->p_channel, p_dm_odm->pre_channel, *p_dm_odm->p_is_scan_in_process == TRUE ? "TRUE":"FALSE")); - - if (*p_dm_odm->p_channel != p_dm_odm->pre_channel) { - p_dm_odm->pre_channel = *p_dm_odm->p_channel; - p_dm_odm->linked_interval = 0; - } - - if ((p_dm_odm->linked_interval < 3) && (!*p_dm_odm->p_is_scan_in_process)) - p_dm_odm->linked_interval++; - - if (p_dm_odm->linked_interval == 2) - PHY_IQCalibrate(adapter, false); - } else - p_dm_odm->linked_interval = 0; - - RT_TRACE(COMP_SCAN, ODM_DBG_LOUD, ("<=%s interval=%d ch=%d prech=%d scan=%s\n", __FUNCTION__, p_dm_odm->linked_interval, - *p_dm_odm->p_channel, p_dm_odm->pre_channel, *p_dm_odm->p_is_scan_in_process == TRUE?"TRUE":"FALSE")); -} - -void phydm_rf_init(struct PHY_DM_STRUCT *p_dm_odm) -{ - - odm_txpowertracking_init(p_dm_odm); - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - odm_clear_txpowertracking_state(p_dm_odm); -#endif - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -#if (RTL8814A_SUPPORT == 1) - if (p_dm_odm->support_ic_type & ODM_RTL8814A) - phy_iq_calibrate_8814a_init(p_dm_odm); -#endif -#endif - -} - -void phydm_rf_watchdog(struct PHY_DM_STRUCT *p_dm_odm) -{ - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - odm_txpowertracking_check(p_dm_odm); - if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) - odm_iq_calibrate(p_dm_odm); -#endif -} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halphyrf_ap.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halphyrf_ap.c new file mode 100644 index 000000000000..0b5a7caedb4c --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halphyrf_ap.c @@ -0,0 +1,1625 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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 odm_clear_txpowertracking_state( + void *dm_void +) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); + struct rtl8192cd_priv *priv = dm->priv; + + u8 i; + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "===>%s\n", __func__); + + for (i = 0; i < MAX_RF_PATH; i++) { + cali_info->absolute_ofdm_swing_idx[i] = 0; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "cali_info->absolute_ofdm_swing_idx[%d]=%d\n", + i, cali_info->absolute_ofdm_swing_idx[i]); + } + + dm->rf_calibrate_info.thermal_value = 0; + dm->rf_calibrate_info.thermal_value_lck = 0; + dm->rf_calibrate_info.thermal_value_iqk = 0; +} + +void configure_txpower_track( + void *dm_void, + struct txpwrtrack_cfg *config +) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; +#if RTL8812A_SUPPORT +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + /* if (IS_HARDWARE_TYPE_8812(dm->adapter)) */ + if (dm->support_ic_type == ODM_RTL8812) + configure_txpower_track_8812a(config); + /* else */ +#endif +#endif + +#if RTL8814A_SUPPORT + if (dm->support_ic_type == ODM_RTL8814A) + configure_txpower_track_8814a(config); +#endif + + +#if RTL8188E_SUPPORT + if (dm->support_ic_type == ODM_RTL8188E) + configure_txpower_track_8188e(config); +#endif + +#if RTL8197F_SUPPORT + if (dm->support_ic_type == ODM_RTL8197F) + configure_txpower_track_8197f(config); +#endif + +#if RTL8822B_SUPPORT + if (dm->support_ic_type == ODM_RTL8822B) + configure_txpower_track_8822b(config); +#endif + +#if RTL8192F_SUPPORT + if (dm->support_ic_type == ODM_RTL8192F) + configure_txpower_track_8192f(config); +#endif + +#if RTL8198F_SUPPORT + if (dm->support_ic_type == ODM_RTL8198F) + configure_txpower_track_8198f(config); +#endif + +#if RTL8814B_SUPPORT + if (dm->support_ic_type == ODM_RTL8814B) + configure_txpower_track_8814b(config); +#endif + +} + +#if (RTL8192E_SUPPORT == 1) +void +odm_txpowertracking_callback_thermal_meter_92e( + void *dm_void +) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct dm_iqk_info *iqk_info = &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 = dm->priv; + + rf_mimo_mode = dm->rf_type; + /* RF_DBG(dm,DBG_RF_TX_PWR_TRACK,"%s:%d rf_mimo_mode:%d\n", __FUNCTION__, __LINE__, rf_mimo_mode); */ + +#ifdef MP_TEST + if ((OPMODE & WIFI_MP_STATE) || *(dm->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(dm, RF_PATH_A, ODM_RF_T_METER_92E, 0xfc00); /* 0x42: RF Reg[15:10] 88E */ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "\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; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "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; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "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); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "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) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "\n******** START POWER TRACKING ********\n"); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "\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) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "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]); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, ">>> 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); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, ">>> 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]); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, ">>> 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); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, ">>> 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 */ + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "ofdm_swing_table_92e[(unsigned int)OFDM_index[0]] = %x\n", ofdm_swing_table_92e[(unsigned int)OFDM_index[0]]); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "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); + } + + } + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "0xc80 = 0x%x\n", phy_query_bb_reg(priv, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKDWORD)); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "0xc88 = 0x%x\n", phy_query_bb_reg(priv, REG_OFDM_0_XB_TX_IQ_IMBALANCE, MASKDWORD)); + + if ((delta_IQK > 3) && (!iqk_info->rfk_forbidden)) { + priv->pshare->thermal_value_iqk = thermal_value; +#ifdef MP_TEST +#endif if (!(*(dm->mp_mode) && (OPMODE & (WIFI_MP_CTX_BACKGROUND | WIFI_MP_CTX_PACKET)))) + + halrf_iqk_trigger(dm, false); + } + + if ((delta_LCK > 8) && (!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; + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "\n******** END:%s() ********\n", __FUNCTION__); +} +#endif + +#if (RTL8814B_SUPPORT == 1) +void +odm_txpowertracking_callback_thermal_meter_jaguar_series4(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); + struct dm_iqk_info *iqk_info = &dm->IQK_info; + struct _hal_rf_ *rf = &dm->rf_table; + struct _halrf_tssi_data *tssi = &rf->halrf_tssi_data; + struct rtl8192cd_priv *priv = dm->priv; + struct txpwrtrack_cfg c; + + if (!(rf->rf_supportability & HAL_RF_TX_PWR_TRACK)) + return; + + u8 thermal_value[MAX_RF_PATH] = {0}, delta[MAX_RF_PATH] = {0}; + u8 delta_swing_table_idx_tup[DELTA_SWINGIDX_SIZE] = {0}; + u8 delta_swing_table_idx_tdown[DELTA_SWINGIDX_SIZE] = {0}; + u8 delta_LCK = 0, delta_IQK = 0, i = 0, j = 0, p; + u8 thermal_value_avg_count[MAX_RF_PATH] = {0}; + u32 thermal_value_avg[MAX_RF_PATH] = {0}; + s8 thermal_value_temp[MAX_RF_PATH] = {0}; + + u8 *pwrtrk_tab_up_a = NULL; + u8 *pwrtrk_tab_down_a = NULL; + u8 *pwrtrk_tab_up_b = NULL; + u8 *pwrtrk_tab_down_b = NULL; + u8 *pwrtrk_tab_up_c = NULL; + u8 *pwrtrk_tab_down_c = NULL; + u8 *pwrtrk_tab_up_d = NULL; + u8 *pwrtrk_tab_down_d = NULL; + + configure_txpower_track(dm, &c); + + (*c.get_delta_swing_table)(dm, + (u8 **)&pwrtrk_tab_up_a, (u8 **)&pwrtrk_tab_down_a, + (u8 **)&pwrtrk_tab_up_b, (u8 **)&pwrtrk_tab_down_b); + + if (GET_CHIP_VER(priv) == VERSION_8814B) { + (*c.get_delta_swing_table8814only)(dm, + (u8 **)&pwrtrk_tab_up_c, (u8 **)&pwrtrk_tab_down_c, + (u8 **)&pwrtrk_tab_up_d, (u8 **)&pwrtrk_tab_down_d); + } + + cali_info->txpowertracking_callback_cnt++; + cali_info->is_txpowertracking_init = true; + + /* Initialize */ + if (!dm->rf_calibrate_info.thermal_value) + dm->rf_calibrate_info.thermal_value = + priv->pmib->dot11RFEntry.thermal[RF_PATH_A]; + + if (!dm->rf_calibrate_info.thermal_value_lck) + dm->rf_calibrate_info.thermal_value_lck = + priv->pmib->dot11RFEntry.thermal[RF_PATH_A]; + + if (!dm->rf_calibrate_info.thermal_value_iqk) + dm->rf_calibrate_info.thermal_value_iqk = + priv->pmib->dot11RFEntry.thermal[RF_PATH_A]; + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "===>odm_txpowertracking_callback_thermal_meter\n cali_info->bb_swing_idx_cck_base: %d, cali_info->bb_swing_idx_ofdm_base[A]: %d, cali_info->default_ofdm_index: %d\n", + cali_info->bb_swing_idx_cck_base, cali_info->bb_swing_idx_ofdm_base_path[RF_PATH_A], cali_info->default_ofdm_index); + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "cali_info->txpowertrack_control=%d\n", cali_info->txpowertrack_control); + + for (i = 0; i < c.rf_path_count; i++) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "PGthermal[%d]=0x%x(%d)\n", i, + priv->pmib->dot11RFEntry.thermal[i], + priv->pmib->dot11RFEntry.thermal[i]); + + if (priv->pmib->dot11RFEntry.thermal[i] == 0xff || + priv->pmib->dot11RFEntry.thermal[i] == 0x0) + return; + } + + for (i = 0; i < c.rf_path_count; i++) { + thermal_value[i] = (u8)odm_get_rf_reg(dm, i, c.thermal_reg_addr, 0xfc00); /* 0x42: RF Reg[15:10] 88E */ + + thermal_value_temp[i] = (s8)thermal_value[i] + phydm_get_thermal_offset(dm); + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "thermal_value_temp[%d](%d) = thermal_value[%d](%d) + power_time_thermal(%d)\n", i, thermal_value_temp[i], i, thermal_value[i], phydm_get_thermal_offset(dm)); + + if (thermal_value_temp[i] > 63) + thermal_value[i] = 63; + else if (thermal_value_temp[i] < 0) + thermal_value[i] = 0; + else + thermal_value[i] = thermal_value_temp[i]; + } + + for (j = 0; j < c.rf_path_count; j++) { + cali_info->thermal_value_avg_path[j][cali_info->thermal_value_avg_index_path[j]] = thermal_value[j]; + cali_info->thermal_value_avg_index_path[j]++; + if (cali_info->thermal_value_avg_index_path[j] == c.average_thermal_num) /*Average times = c.average_thermal_num*/ + cali_info->thermal_value_avg_index_path[j] = 0; + + + for (i = 0; i < c.average_thermal_num; i++) { + if (cali_info->thermal_value_avg_path[j][i]) { + thermal_value_avg[j] += cali_info->thermal_value_avg_path[j][i]; + thermal_value_avg_count[j]++; + } + } + + if (thermal_value_avg_count[j]) { /* Calculate Average thermal_value after average enough times */ + thermal_value[j] = (u8)(thermal_value_avg[j] / thermal_value_avg_count[j]); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "PGthermal[%d] = 0x%x(%d), AVG Thermal Meter = 0x%x(%d)\n", j, + priv->pmib->dot11RFEntry.thermal[j], + priv->pmib->dot11RFEntry.thermal[j], + thermal_value[j], + thermal_value[j]); + } + /* 4 5. Calculate delta, delta_LCK, delta_IQK. */ + + /* "delta" here is used to determine whether thermal value changes or not. */ + delta[j] = RTL_ABS(thermal_value[j], priv->pmib->dot11RFEntry.thermal[j]); + delta_LCK = RTL_ABS(thermal_value[RF_PATH_A], dm->rf_calibrate_info.thermal_value_lck); + delta_IQK = RTL_ABS(thermal_value[RF_PATH_A], dm->rf_calibrate_info.thermal_value_iqk); + } + + /*4 6. If necessary, do LCK.*/ + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "(delta[%d], delta_LCK, delta_IQK) = (%d, %d, %d)\n", RF_PATH_A, delta[RF_PATH_A], delta_LCK, delta_IQK); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "(delta[%d], delta_LCK, delta_IQK) = (%d, %d, %d)\n", RF_PATH_B, delta[RF_PATH_B], delta_LCK, delta_IQK); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "(delta[%d], delta_LCK, delta_IQK) = (%d, %d, %d)\n", RF_PATH_C, delta[RF_PATH_C], delta_LCK, delta_IQK); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "(delta[%d], delta_LCK, delta_IQK) = (%d, %d, %d)\n", RF_PATH_D, delta[RF_PATH_D], delta_LCK, delta_IQK); + + /* Wait sacn to do LCK by RF Jenyu*/ + if( (*dm->is_scan_in_process == false) && (!iqk_info->rfk_forbidden)) { + /* Delta temperature is equal to or larger than 20 centigrade.*/ + if (delta_LCK >= c.threshold_iqk) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta_LCK(%d) >= threshold_iqk(%d)\n", delta_LCK, c.threshold_iqk); + cali_info->thermal_value_lck = thermal_value[RF_PATH_A]; + + /*Use RTLCK, so close power tracking driver LCK*/ + if ((!(dm->support_ic_type & ODM_RTL8814A)) && (!(dm->support_ic_type & ODM_RTL8822B))) { + if (c.phy_lc_calibrate) + (*c.phy_lc_calibrate)(dm); + } else + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "Do not do LCK\n"); + } + } + + /*3 7. If necessary, move the index of swing table to adjust Tx power.*/ +#ifdef _TRACKING_TABLE_FILE + for (i = 0; i < c.rf_path_count; i++) { + if (i == RF_PATH_B) { + odm_move_memory(dm, delta_swing_table_idx_tup, pwrtrk_tab_up_b, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, delta_swing_table_idx_tdown, pwrtrk_tab_down_b, DELTA_SWINGIDX_SIZE); + } else if (i == RF_PATH_C) { + odm_move_memory(dm, delta_swing_table_idx_tup, pwrtrk_tab_up_c, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, delta_swing_table_idx_tdown, pwrtrk_tab_down_c, DELTA_SWINGIDX_SIZE); + } else if (i == RF_PATH_D) { + odm_move_memory(dm, delta_swing_table_idx_tup, pwrtrk_tab_up_d, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, delta_swing_table_idx_tdown, pwrtrk_tab_down_d, DELTA_SWINGIDX_SIZE); + } else { + odm_move_memory(dm, delta_swing_table_idx_tup, pwrtrk_tab_up_a, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, delta_swing_table_idx_tdown, pwrtrk_tab_down_a, DELTA_SWINGIDX_SIZE); + } + + cali_info->delta_power_index_last_path[i] = cali_info->delta_power_index_path[i]; /*recording poer index offset*/ + delta[i] = thermal_value[i] > priv->pmib->dot11RFEntry.thermal[i] ? (thermal_value[i] - priv->pmib->dot11RFEntry.thermal[i]) : (priv->pmib->dot11RFEntry.thermal[i] - thermal_value[i]); + + if (delta[i] >= TXPWR_TRACK_TABLE_SIZE) + delta[i] = TXPWR_TRACK_TABLE_SIZE - 1; + + if (thermal_value[i] > priv->pmib->dot11RFEntry.thermal[i]) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "delta_swing_table_idx_tup[%d]=%d Path=%d\n", delta[i], delta_swing_table_idx_tup[delta[i]], i); + + cali_info->delta_power_index_path[i] = delta_swing_table_idx_tup[delta[i]]; + cali_info->absolute_ofdm_swing_idx[i] = delta_swing_table_idx_tup[delta[i]]; /*Record delta swing for mix mode power tracking*/ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "******Temp is higher and cali_info->absolute_ofdm_swing_idx[%d]=%d Path=%d\n", delta[i], cali_info->absolute_ofdm_swing_idx[i], i); + } else { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "delta_swing_table_idx_tdown[%d]=%d Path=%d\n", delta[i], delta_swing_table_idx_tdown[delta[i]], i); + cali_info->delta_power_index_path[i] = -1 * delta_swing_table_idx_tdown[delta[i]]; + cali_info->absolute_ofdm_swing_idx[i] = -1 * delta_swing_table_idx_tdown[delta[i]]; /*Record delta swing for mix mode power tracking*/ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "******Temp is lower and cali_info->absolute_ofdm_swing_idx[%d]=%d Path=%d\n", delta[i], cali_info->absolute_ofdm_swing_idx[i], i); + } + } + +#endif + + for (p = RF_PATH_A; p < c.rf_path_count; p++) { + if (cali_info->delta_power_index_path[p] == cali_info->delta_power_index_last_path[p]) /*If Thermal value changes but lookup table value still the same*/ + cali_info->power_index_offset_path[p] = 0; + else + cali_info->power_index_offset_path[p] = cali_info->delta_power_index_path[p] - cali_info->delta_power_index_last_path[p]; /*Power index diff between 2 times Power Tracking*/ + } + + if ((cali_info->power_index_offset_path[RF_PATH_A] != 0 || + cali_info->power_index_offset_path[RF_PATH_B] != 0 || + cali_info->power_index_offset_path[RF_PATH_C] != 0 || + cali_info->power_index_offset_path[RF_PATH_D] != 0)) { + + if (dm->support_ic_type == ODM_RTL8814B) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking MIX_MODE**********\n"); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0); + } else { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking BBSWING_MODE**********\n"); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(dm, BBSWING, p, 0); + } + } else + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "TXAGC offset is unchanged\n"); + + /* Wait sacn to do IQK by RF Jenyu*/ + if ((*dm->is_scan_in_process == false) && (!iqk_info->rfk_forbidden)) { + /*Delta temperature is equal to or larger than 20 centigrade (When threshold is 8).*/ + if (delta_IQK >= c.threshold_iqk) { + cali_info->thermal_value_iqk = thermal_value[RF_PATH_A]; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta_IQK(%d) >= threshold_iqk(%d)\n", delta_IQK, c.threshold_iqk); + if (!cali_info->is_iqk_in_progress) + (*c.do_iqk)(dm, delta_IQK, thermal_value[RF_PATH_A], 8); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "Do IQK\n"); + } + } + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "<===%s\n", __func__); + + cali_info->tx_powercount = 0; +} +#endif + +#if (RTL8197F_SUPPORT == 1 || RTL8192F_SUPPORT == 1 || RTL8822B_SUPPORT == 1 ||\ + RTL8821C_SUPPORT == 1 || RTL8198F_SUPPORT == 1) +void +odm_txpowertracking_callback_thermal_meter_jaguar_series3( + void *dm_void +) +{ +#if 1 + struct dm_struct *dm = (struct dm_struct *)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 = dm->priv; + struct txpwrtrack_cfg c; + struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); + struct dm_iqk_info *iqk_info = &dm->IQK_info; + struct _hal_rf_ *rf = &dm->rf_table; + /*The following tables decide the final index of OFDM/CCK swing table.*/ + u8 *pwrtrk_tab_up_a = NULL, *pwrtrk_tab_down_a = NULL; + u8 *pwrtrk_tab_up_b = NULL, *pwrtrk_tab_down_b = NULL; + u8 *pwrtrk_tab_up_cck_a = NULL, *pwrtrk_tab_down_cck_a = NULL; + u8 *pwrtrk_tab_up_cck_b = NULL, *pwrtrk_tab_down_cck_b = NULL; + /*for 8814 add by Yu Chen*/ + u8 *pwrtrk_tab_up_c = NULL, *pwrtrk_tab_down_c = NULL; + u8 *pwrtrk_tab_up_d = NULL, *pwrtrk_tab_down_d = NULL; + u8 *pwrtrk_tab_up_cck_c = NULL, *pwrtrk_tab_down_cck_c = NULL; + u8 *pwrtrk_tab_up_cck_d = NULL, *pwrtrk_tab_down_cck_d = NULL; + s8 thermal_value_temp = 0; + +#ifdef MP_TEST + if ((OPMODE & WIFI_MP_STATE) || *(dm->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(dm, &c); + + (*c.get_delta_all_swing_table)(dm, + (u8 **)&pwrtrk_tab_up_a, (u8 **)&pwrtrk_tab_down_a, + (u8 **)&pwrtrk_tab_up_b, (u8 **)&pwrtrk_tab_down_b, + (u8 **)&pwrtrk_tab_up_cck_a, (u8 **)&pwrtrk_tab_down_cck_a, + (u8 **)&pwrtrk_tab_up_cck_b, (u8 **)&pwrtrk_tab_down_cck_b); + + if (GET_CHIP_VER(priv) == VERSION_8198F) { + (*c.get_delta_all_swing_table_ex)(dm, + (u8 **)&pwrtrk_tab_up_c, (u8 **)&pwrtrk_tab_down_c, + (u8 **)&pwrtrk_tab_up_d, (u8 **)&pwrtrk_tab_down_d, + (u8 **)&pwrtrk_tab_up_cck_c, (u8 **)&pwrtrk_tab_down_cck_c, + (u8 **)&pwrtrk_tab_up_cck_d, (u8 **)&pwrtrk_tab_down_cck_d); + } + /*0x42: RF Reg[15:10] 88E*/ + thermal_value = (u8)odm_get_rf_reg(dm, RF_PATH_A, c.thermal_reg_addr, 0xfc00); +#ifdef THER_TRIM + if (GET_CHIP_VER(priv) == VERSION_8197F) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"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; + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"after thermal trim, thermal_value=%d\n", thermal_value); + } + + if (GET_CHIP_VER(priv) == VERSION_8198F) { + thermal_value_temp = thermal_value + phydm_get_thermal_offset(dm); + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "thermal_value_temp(%d) = ther_value(%d) + ther_trim_ther(%d)\n", + thermal_value_temp, thermal_value, phydm_get_thermal_offset(dm)); + + if (thermal_value_temp > 63) + thermal_value = 63; + else if (thermal_value_temp < 0) + thermal_value = 0; + else + thermal_value = thermal_value_temp; + } +#endif + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"\n\n\nCurrent Thermal = 0x%x(%d) EEPROMthermalmeter 0x%x(%d)\n" + , thermal_value, thermal_value, priv->pmib->dot11RFEntry.ther, priv->pmib->dot11RFEntry.ther); + + /* Initialize */ + if (!dm->rf_calibrate_info.thermal_value) + dm->rf_calibrate_info.thermal_value = priv->pmib->dot11RFEntry.ther; + + if (!dm->rf_calibrate_info.thermal_value_lck) + dm->rf_calibrate_info.thermal_value_lck = priv->pmib->dot11RFEntry.ther; + + if (!dm->rf_calibrate_info.thermal_value_iqk) + dm->rf_calibrate_info.thermal_value_iqk = priv->pmib->dot11RFEntry.ther; + + /* calculate average thermal meter */ + dm->rf_calibrate_info.thermal_value_avg[dm->rf_calibrate_info.thermal_value_avg_index] = thermal_value; + dm->rf_calibrate_info.thermal_value_avg_index++; + + if (dm->rf_calibrate_info.thermal_value_avg_index == c.average_thermal_num) /*Average times = c.average_thermal_num*/ + dm->rf_calibrate_info.thermal_value_avg_index = 0; + + for (i = 0; i < c.average_thermal_num; i++) { + if (dm->rf_calibrate_info.thermal_value_avg[i]) { + thermal_value_avg += 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*/ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"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); + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"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, dm->rf_calibrate_info.thermal_value_lck); + delta_IQK = RTL_ABS(thermal_value, 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*/ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta(%d) > 29, set delta to 29\n", delta); + delta = 29; + } + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "(delta, delta_LCK, delta_IQK) = (%d, %d, %d)\n", delta, delta_LCK, delta_IQK); + + /*4 if necessary, do LCK.*/ + if ((delta_LCK >= c.threshold_iqk) && (!iqk_info->rfk_forbidden)) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta_LCK(%d) >= threshold_iqk(%d)\n", delta_LCK, c.threshold_iqk); + dm->rf_calibrate_info.thermal_value_lck = thermal_value; +#if (RTL8822B_SUPPORT != 1) + if (!(dm->support_ic_type & ODM_RTL8822B)) { + if (c.phy_lc_calibrate) + (*c.phy_lc_calibrate)(dm); + } +#endif + } + + if (!priv->pmib->dot11RFEntry.ther) /*Don't do power tracking since no calibrated thermal value*/ + return; + + /*4 Do Power Tracking*/ + + if (thermal_value != dm->rf_calibrate_info.thermal_value) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******** START POWER TRACKING ********\n"); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"Readback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", + thermal_value, 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: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"pwrtrk_tab_up_b[%d] = %d pwrtrk_tab_up_cck_b[%d] = %d\n", delta, pwrtrk_tab_up_b[delta], delta, pwrtrk_tab_up_cck_b[delta]); + cali_info->absolute_ofdm_swing_idx[p] = pwrtrk_tab_up_b[delta]; + cali_info->absolute_cck_swing_idx[p] = pwrtrk_tab_up_cck_b[delta]; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is higher and pRF->absolute_ofdm_swing_idx[RF_PATH_B] = %d pRF->absolute_cck_swing_idx[RF_PATH_B] = %d\n", cali_info->absolute_ofdm_swing_idx[p], cali_info->absolute_cck_swing_idx[p]); + break; + + case RF_PATH_C: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"pwrtrk_tab_up_c[%d] = %d pwrtrk_tab_up_cck_c[%d] = %d\n", delta, pwrtrk_tab_up_c[delta], delta, pwrtrk_tab_up_cck_c[delta]); + cali_info->absolute_ofdm_swing_idx[p] = pwrtrk_tab_up_c[delta]; + cali_info->absolute_cck_swing_idx[p] = pwrtrk_tab_up_cck_c[delta]; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is higher and pRF->absolute_ofdm_swing_idx[RF_PATH_C] = %d pRF->absolute_cck_swing_idx[RF_PATH_C] = %d\n", cali_info->absolute_ofdm_swing_idx[p], cali_info->absolute_cck_swing_idx[p]); + break; + + case RF_PATH_D: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"pwrtrk_tab_up_d[%d] = %d pwrtrk_tab_up_cck_d[%d] = %d\n", delta, pwrtrk_tab_up_d[delta], delta, pwrtrk_tab_up_cck_d[delta]); + cali_info->absolute_ofdm_swing_idx[p] = pwrtrk_tab_up_d[delta]; + cali_info->absolute_cck_swing_idx[p] = pwrtrk_tab_up_cck_d[delta]; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is higher and pRF->absolute_ofdm_swing_idx[RF_PATH_D] = %d pRF->absolute_cck_swing_idx[RF_PATH_D] = %d\n", cali_info->absolute_ofdm_swing_idx[p], cali_info->absolute_cck_swing_idx[p]); + break; + default: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"pwrtrk_tab_up_a[%d] = %d pwrtrk_tab_up_cck_a[%d] = %d\n", delta, pwrtrk_tab_up_a[delta], delta, pwrtrk_tab_up_cck_a[delta]); + cali_info->absolute_ofdm_swing_idx[p] = pwrtrk_tab_up_a[delta]; + cali_info->absolute_cck_swing_idx[p] = pwrtrk_tab_up_cck_a[delta]; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is higher and pRF->absolute_ofdm_swing_idx[RF_PATH_A] = %d pRF->absolute_cck_swing_idx[RF_PATH_A] = %d\n", cali_info->absolute_ofdm_swing_idx[p], cali_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: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"pwrtrk_tab_down_b[%d] = %d pwrtrk_tab_down_cck_b[%d] = %d\n", delta, pwrtrk_tab_down_b[delta], delta, pwrtrk_tab_down_cck_b[delta]); + cali_info->absolute_ofdm_swing_idx[p] = -1 * pwrtrk_tab_down_b[delta]; + cali_info->absolute_cck_swing_idx[p] = -1 * pwrtrk_tab_down_cck_b[delta]; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is lower and pRF->absolute_ofdm_swing_idx[RF_PATH_B] = %d pRF->absolute_cck_swing_idx[RF_PATH_B] = %d\n", cali_info->absolute_ofdm_swing_idx[p], cali_info->absolute_cck_swing_idx[p]); + break; + + case RF_PATH_C: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"pwrtrk_tab_down_c[%d] = %d pwrtrk_tab_down_cck_c[%d] = %d\n", delta, pwrtrk_tab_down_c[delta], delta, pwrtrk_tab_down_cck_c[delta]); + cali_info->absolute_ofdm_swing_idx[p] = -1 * pwrtrk_tab_down_c[delta]; + cali_info->absolute_cck_swing_idx[p] = -1 * pwrtrk_tab_down_cck_c[delta]; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is lower and pRF->absolute_ofdm_swing_idx[RF_PATH_C] = %d pRF->absolute_cck_swing_idx[RF_PATH_C] = %d\n", cali_info->absolute_ofdm_swing_idx[p], cali_info->absolute_cck_swing_idx[p]); + break; + + case RF_PATH_D: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"pwrtrk_tab_down_d[%d] = %d pwrtrk_tab_down_cck_d[%d] = %d\n", delta, pwrtrk_tab_down_d[delta], delta, pwrtrk_tab_down_cck_d[delta]); + cali_info->absolute_ofdm_swing_idx[p] = -1 * pwrtrk_tab_down_d[delta]; + cali_info->absolute_cck_swing_idx[p] = -1 * pwrtrk_tab_down_cck_d[delta]; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is lower and pRF->absolute_ofdm_swing_idx[RF_PATH_D] = %d pRF->absolute_cck_swing_idx[RF_PATH_D] = %d\n", cali_info->absolute_ofdm_swing_idx[p], cali_info->absolute_cck_swing_idx[p]); + break; + + default: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"pwrtrk_tab_down_a[%d] = %d pwrtrk_tab_down_cck_a[%d] = %d\n", delta, pwrtrk_tab_down_a[delta], delta, pwrtrk_tab_down_cck_a[delta]); + cali_info->absolute_ofdm_swing_idx[p] = -1 * pwrtrk_tab_down_a[delta]; + cali_info->absolute_cck_swing_idx[p] = -1 * pwrtrk_tab_down_cck_a[delta]; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is lower and pRF->absolute_ofdm_swing_idx[RF_PATH_A] = %d pRF->absolute_cck_swing_idx[RF_PATH_A] = %d\n", cali_info->absolute_ofdm_swing_idx[p], cali_info->absolute_cck_swing_idx[p]); + break; + } + } + } + + if (is_increase) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, ">>> 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)(dm, BBSWING, p, 0); + //} else if (GET_CHIP_VER(priv) == VERSION_8192F) { + // for (p = RF_PATH_A; p < c.rf_path_count; p++) + // (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, 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)(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)(dm, MIX_MODE, p, 0); + } else if (GET_CHIP_VER(priv) == VERSION_8198F) { + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0); + } + } else { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, ">>> 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)(dm, BBSWING, p, 0); + //} else if (GET_CHIP_VER(priv) == VERSION_8192F) { + // for (p = RF_PATH_A; p < c.rf_path_count; p++) + // (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, 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)(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)(dm, MIX_MODE, p, 0); + } else if (GET_CHIP_VER(priv) == VERSION_8198F) { + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0); + } + } + } +#endif + + if (GET_CHIP_VER(priv) != VERSION_8198F) { + if ((delta_IQK >= c.threshold_iqk) && (!iqk_info->rfk_forbidden)) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta_IQK(%d) >= threshold_iqk(%d)\n", delta_IQK, c.threshold_iqk); + dm->rf_calibrate_info.thermal_value_iqk = thermal_value; + if (!(dm->support_ic_type & ODM_RTL8197F)) { + if (c.do_iqk) + (*c.do_iqk)(dm, false, thermal_value, 0); + } + } + } + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "\n******** END:%s() ********\n\n", __func__); + /*update thermal meter value*/ + 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 *dm_void +) +{ + struct dm_struct *dm = (struct dm_struct *)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 = dm->priv; + struct txpwrtrack_cfg c; + boolean is_tssi_enable = false; + struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); + struct dm_iqk_info *iqk_info = &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) || *(dm->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(dm, &c); + cali_info->default_ofdm_index = priv->pshare->OFDM_index0[RF_PATH_A]; + + (*c.get_delta_swing_table)(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 (dm->support_ic_type & ODM_RTL8814A) /* for 8814 path C & D */ + (*c.get_delta_swing_table8814only)(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(dm, RF_PATH_A, c.thermal_reg_addr, 0xfc00); /* 0x42: RF Reg[15:10] 88E */ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"\nReadback Thermal Meter = 0x%x, pre thermal meter 0x%x, EEPROMthermalmeter 0x%x\n", thermal_value, dm->rf_calibrate_info.thermal_value, priv->pmib->dot11RFEntry.ther); + + /* Initialize */ + if (!dm->rf_calibrate_info.thermal_value) + dm->rf_calibrate_info.thermal_value = priv->pmib->dot11RFEntry.ther; + + if (!dm->rf_calibrate_info.thermal_value_lck) + dm->rf_calibrate_info.thermal_value_lck = priv->pmib->dot11RFEntry.ther; + + if (!dm->rf_calibrate_info.thermal_value_iqk) + dm->rf_calibrate_info.thermal_value_iqk = priv->pmib->dot11RFEntry.ther; + + is_tssi_enable = (boolean)odm_get_rf_reg(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(dm, bb_swing_reg[p], 0xffe00000); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"0x%x:0x%x ([31:21] = 0x%x)\n", bb_swing_reg[p], odm_get_bb_reg(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]) { + dm->rf_calibrate_info.OFDM_index[p] = (u8)bb_swing_idx; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"OFDM_index[%d]=%d\n", p, dm->rf_calibrate_info.OFDM_index[p]); + break; + } + } + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "kfree_offset[%d]=%d\n", p, cali_info->kfree_offset[p]); + + } + + /* calculate average thermal meter */ + dm->rf_calibrate_info.thermal_value_avg[dm->rf_calibrate_info.thermal_value_avg_index] = thermal_value; + dm->rf_calibrate_info.thermal_value_avg_index++; + if (dm->rf_calibrate_info.thermal_value_avg_index == c.average_thermal_num) /* Average times = c.average_thermal_num */ + dm->rf_calibrate_info.thermal_value_avg_index = 0; + + for (i = 0; i < c.average_thermal_num; i++) { + if (dm->rf_calibrate_info.thermal_value_avg[i]) { + thermal_value_avg += 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); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"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, dm->rf_calibrate_info.thermal_value_lck); + delta_IQK = RTL_ABS(thermal_value, dm->rf_calibrate_info.thermal_value_iqk); + is_increase = ((thermal_value < priv->pmib->dot11RFEntry.ther) ? 0 : 1); + + /* 4 if necessary, do LCK. */ + if (!(dm->support_ic_type & ODM_RTL8821)) { + if ((delta_LCK > c.threshold_iqk) && (!iqk_info->rfk_forbidden)) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta_LCK(%d) >= threshold_iqk(%d)\n", delta_LCK, c.threshold_iqk); + dm->rf_calibrate_info.thermal_value_lck = thermal_value; + + /*Use RTLCK, so close power tracking driver LCK*/ +#if (RTL8814A_SUPPORT != 1) + if (!(dm->support_ic_type & ODM_RTL8814A)) { + if (c.phy_lc_calibrate) + (*c.phy_lc_calibrate)(dm); + } +#endif + } + } + + if ((delta_IQK > c.threshold_iqk) && (!iqk_info->rfk_forbidden)) { + panic_printk("%s(%d)\n", __FUNCTION__, __LINE__); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta_IQK(%d) >= threshold_iqk(%d)\n", delta_IQK, c.threshold_iqk); + dm->rf_calibrate_info.thermal_value_iqk = thermal_value; + if (c.do_iqk) + (*c.do_iqk)(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) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter PURE TSSI MODE**********\n"); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(dm, TSSI_MODE, p, 0); + } else if (thermal_value != dm->rf_calibrate_info.thermal_value) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"\n******** START POWER TRACKING ********\n"); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", thermal_value, 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: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"delta_swing_table_idx_tup_b[%d] = %d\n", delta, delta_swing_table_idx_tup_b[delta]); + cali_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_b[delta]; /* Record delta swing for mix mode power tracking */ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is higher and dm->absolute_ofdm_swing_idx[RF_PATH_B] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); + break; + + case RF_PATH_C: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"delta_swing_table_idx_tup_c[%d] = %d\n", delta, delta_swing_table_idx_tup_c[delta]); + cali_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_c[delta]; /* Record delta swing for mix mode power tracking */ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is higher and dm->absolute_ofdm_swing_idx[RF_PATH_C] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); + break; + + case RF_PATH_D: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"delta_swing_table_idx_tup_d[%d] = %d\n", delta, delta_swing_table_idx_tup_d[delta]); + cali_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_d[delta]; /* Record delta swing for mix mode power tracking */ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is higher and dm->absolute_ofdm_swing_idx[RF_PATH_D] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); + break; + + default: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"delta_swing_table_idx_tup_a[%d] = %d\n", delta, delta_swing_table_idx_tup_a[delta]); + cali_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_a[delta]; /* Record delta swing for mix mode power tracking */ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is higher and dm->absolute_ofdm_swing_idx[RF_PATH_A] = %d\n", cali_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: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"delta_swing_table_idx_tdown_b[%d] = %d\n", delta, delta_swing_table_idx_tdown_b[delta]); + cali_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_b[delta]; /* Record delta swing for mix mode power tracking */ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is lower and dm->absolute_ofdm_swing_idx[RF_PATH_B] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); + break; + + case RF_PATH_C: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"delta_swing_table_idx_tdown_c[%d] = %d\n", delta, delta_swing_table_idx_tdown_c[delta]); + cali_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_c[delta]; /* Record delta swing for mix mode power tracking */ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is lower and dm->absolute_ofdm_swing_idx[RF_PATH_C] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); + break; + + case RF_PATH_D: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"delta_swing_table_idx_tdown_d[%d] = %d\n", delta, delta_swing_table_idx_tdown_d[delta]); + cali_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_d[delta]; /* Record delta swing for mix mode power tracking */ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is lower and dm->absolute_ofdm_swing_idx[RF_PATH_D] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); + break; + + default: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"delta_swing_table_idx_tdown_a[%d] = %d\n", delta, delta_swing_table_idx_tdown_a[delta]); + cali_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_a[delta]; /* Record delta swing for mix mode power tracking */ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"******Temp is lower and dm->absolute_ofdm_swing_idx[RF_PATH_A] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); + break; + } + } + } + + if (is_increase) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, ">>> increse power --->\n"); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0); + } else { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, ">>> decrese power --->\n"); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0); + } + } +#endif + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "\n******** END:%s() ********\n", __FUNCTION__); + /* update thermal meter value */ + 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 *dm_void +) +{ + struct dm_struct *dm = (struct dm_struct *)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 = 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 dm_iqk_info *iqk_info = &dm->IQK_info; + + +#ifdef MP_TEST + if ((OPMODE & WIFI_MP_STATE) || *(dm->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 (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 && (*dm->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 */ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "\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); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "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; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "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); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "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; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "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); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "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; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "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) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "\n******** START POWER TRACKING ********\n"); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "\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 (*dm->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++) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "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]); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, ">>> 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 (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 (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 + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, ">>> 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]]); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "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) && (!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; + } + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "\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 *dm_void +) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); + struct dm_iqk_info *iqk_info = &dm->IQK_info; + + +#if (RTL8814B_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8814B) { + odm_txpowertracking_callback_thermal_meter_jaguar_series4(dm); + } +#endif +#if (RTL8197F_SUPPORT == 1 ||RTL8192F_SUPPORT == 1 || RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1 || RTL8198F_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8197F || dm->support_ic_type == ODM_RTL8192F || dm->support_ic_type == ODM_RTL8822B + || dm->support_ic_type == ODM_RTL8821C || dm->support_ic_type == ODM_RTL8198F) { + odm_txpowertracking_callback_thermal_meter_jaguar_series3(dm); + return; + } +#endif +#if (RTL8814A_SUPPORT == 1) /*use this function to do power tracking after 8814 by YuChen*/ + if (dm->support_ic_type & ODM_RTL8814A) { + odm_txpowertracking_callback_thermal_meter_jaguar_series2(dm); + return; + } +#endif +#if (RTL8881A_SUPPORT || RTL8812A_SUPPORT == 1) + if (dm->support_ic_type & ODM_RTL8812 || dm->support_ic_type & ODM_RTL8881A) { + odm_txpowertracking_callback_thermal_meter_jaguar_series(dm); + return; + } +#endif + +#if (RTL8192E_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8192E) { + odm_txpowertracking_callback_thermal_meter_92e(dm); + return; + } +#endif + +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + /* PMGNT_INFO 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(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 = dm->priv; +#endif + + /* 4 2. Initilization ( 7 steps in total ) */ + + configure_txpower_track(dm, &c); + + dm->rf_calibrate_info.txpowertracking_callback_cnt++; /* cosa add for debug */ + dm->rf_calibrate_info.is_txpowertracking_init = true; + +#if (MP_DRIVER == 1) + dm->rf_calibrate_info.txpowertrack_control = 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. */ + dm->rf_calibrate_info.rega24 = 0x090e1317; +#endif + +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) && defined(MP_TEST) + if ((OPMODE & WIFI_MP_STATE) || *(dm->mp_mode)) { + if (dm->priv->pshare->mp_txpwr_tracking == false) + return; + } +#endif + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "===>odm_txpowertracking_callback_thermal_meter_8188e, dm->bb_swing_idx_cck_base: %d, dm->bb_swing_idx_ofdm_base: %d\n", cali_info->bb_swing_idx_cck_base, cali_info->bb_swing_idx_ofdm_base); + /* + if (!dm->rf_calibrate_info.tm_trigger) { + odm_set_rf_reg(dm, RF_PATH_A, c.thermal_reg_addr, BIT(17) | BIT(16), 0x3); + dm->rf_calibrate_info.tm_trigger = 1; + return; + } + */ + thermal_value = (u8)odm_get_rf_reg(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 || !dm->rf_calibrate_info.txpowertrack_control) +#else + if (!dm->rf_calibrate_info.txpowertrack_control) +#endif + return; + + /* 4 3. Initialize ThermalValues of rf_calibrate_info */ + + if (!dm->rf_calibrate_info.thermal_value) { + dm->rf_calibrate_info.thermal_value_lck = thermal_value; + dm->rf_calibrate_info.thermal_value_iqk = thermal_value; + } + + if (dm->rf_calibrate_info.is_reloadtxpowerindex) + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "reload ofdm index for band switch\n"); + + /* 4 4. Calculate average thermal meter */ + + dm->rf_calibrate_info.thermal_value_avg[dm->rf_calibrate_info.thermal_value_avg_index] = thermal_value; + dm->rf_calibrate_info.thermal_value_avg_index++; + if (dm->rf_calibrate_info.thermal_value_avg_index == c.average_thermal_num) + dm->rf_calibrate_info.thermal_value_avg_index = 0; + + for (i = 0; i < c.average_thermal_num; i++) { + if (dm->rf_calibrate_info.thermal_value_avg[i]) { + thermal_value_avg += 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)); + cali_info->thermal_value_delta = thermal_value - priv->pmib->dot11RFEntry.ther; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "AVG Thermal Meter = 0x%x\n", thermal_value); + } + + /* 4 5. Calculate delta, delta_LCK, delta_IQK. */ + + delta = (thermal_value > dm->rf_calibrate_info.thermal_value) ? (thermal_value - dm->rf_calibrate_info.thermal_value) : (dm->rf_calibrate_info.thermal_value - thermal_value); + delta_LCK = (thermal_value > dm->rf_calibrate_info.thermal_value_lck) ? (thermal_value - dm->rf_calibrate_info.thermal_value_lck) : (dm->rf_calibrate_info.thermal_value_lck - thermal_value); + delta_IQK = (thermal_value > dm->rf_calibrate_info.thermal_value_iqk) ? (thermal_value - dm->rf_calibrate_info.thermal_value_iqk) : (dm->rf_calibrate_info.thermal_value_iqk - thermal_value); + + /* 4 6. If necessary, do LCK. */ + if (!(dm->support_ic_type & ODM_RTL8821)) { + /*if((delta_LCK > hal_data->delta_lck) && (hal_data->delta_lck != 0))*/ + if ((delta_LCK >= c.threshold_iqk) && (!iqk_info->rfk_forbidden)) { + /*Delta temperature is equal to or larger than 20 centigrade.*/ + dm->rf_calibrate_info.thermal_value_lck = thermal_value; + (*c.phy_lc_calibrate)(dm); + } + } + + /* 3 7. If necessary, move the index of swing table to adjust Tx power. */ + + if (delta > 0 && dm->rf_calibrate_info.txpowertrack_control) { + + delta = (thermal_value > dm->priv->pmib->dot11RFEntry.ther) ? (thermal_value - dm->priv->pmib->dot11RFEntry.ther) : (dm->priv->pmib->dot11RFEntry.ther - thermal_value); + + /* 4 7.1 The Final Power index = BaseIndex + power_index_offset */ + + if (thermal_value > dm->priv->pmib->dot11RFEntry.ther) { + CALCULATE_SWINGTALBE_OFFSET(offset, POWER_INC, index_mapping_NUM_88E, delta); + dm->rf_calibrate_info.delta_power_index_last = dm->rf_calibrate_info.delta_power_index; + 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); + dm->rf_calibrate_info.delta_power_index_last = dm->rf_calibrate_info.delta_power_index; + dm->rf_calibrate_info.delta_power_index = (-1) * delta_swing_table_idx[POWER_DEC][offset]; + } + + if (dm->rf_calibrate_info.delta_power_index == dm->rf_calibrate_info.delta_power_index_last) + dm->rf_calibrate_info.power_index_offset = 0; + else + dm->rf_calibrate_info.power_index_offset = dm->rf_calibrate_info.delta_power_index - dm->rf_calibrate_info.delta_power_index_last; + + for (i = 0; i < rf; i++) + dm->rf_calibrate_info.OFDM_index[i] = cali_info->bb_swing_idx_ofdm_base + dm->rf_calibrate_info.power_index_offset; + dm->rf_calibrate_info.CCK_index = cali_info->bb_swing_idx_cck_base + dm->rf_calibrate_info.power_index_offset; + + cali_info->bb_swing_idx_cck = dm->rf_calibrate_info.CCK_index; + cali_info->bb_swing_idx_ofdm[RF_PATH_A] = dm->rf_calibrate_info.OFDM_index[RF_PATH_A]; + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "The 'CCK' final index(%d) = BaseIndex(%d) + power_index_offset(%d)\n", cali_info->bb_swing_idx_cck, cali_info->bb_swing_idx_cck_base, dm->rf_calibrate_info.power_index_offset); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "The 'OFDM' final index(%d) = BaseIndex(%d) + power_index_offset(%d)\n", cali_info->bb_swing_idx_ofdm[RF_PATH_A], cali_info->bb_swing_idx_ofdm_base, dm->rf_calibrate_info.power_index_offset); + + /* 4 7.1 Handle boundary conditions of index. */ + + + for (i = 0; i < rf; i++) { + if (dm->rf_calibrate_info.OFDM_index[i] > OFDM_max_index) + dm->rf_calibrate_info.OFDM_index[i] = OFDM_max_index; + else if (dm->rf_calibrate_info.OFDM_index[i] < 0) + dm->rf_calibrate_info.OFDM_index[i] = 0; + } + + if (dm->rf_calibrate_info.CCK_index > c.swing_table_size_cck - 1) + dm->rf_calibrate_info.CCK_index = c.swing_table_size_cck - 1; + else if (dm->rf_calibrate_info.CCK_index < 0) + dm->rf_calibrate_info.CCK_index = 0; + } else { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"The thermal meter is unchanged or TxPowerTracking OFF: thermal_value: %d, dm->rf_calibrate_info.thermal_value: %d)\n", thermal_value, dm->rf_calibrate_info.thermal_value); + dm->rf_calibrate_info.power_index_offset = 0; + } + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"TxPowerTracking: [CCK] Swing Current index: %d, Swing base index: %d\n", dm->rf_calibrate_info.CCK_index, cali_info->bb_swing_idx_cck_base); + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK,"TxPowerTracking: [OFDM] Swing Current index: %d, Swing base index: %d\n", dm->rf_calibrate_info.OFDM_index[RF_PATH_A], cali_info->bb_swing_idx_ofdm_base); + + if (dm->rf_calibrate_info.power_index_offset != 0 && dm->rf_calibrate_info.txpowertrack_control) { + /* 4 7.2 Configure the Swing Table to adjust Tx Power. */ + + 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 > dm->rf_calibrate_info.thermal_value) { + /* RF_DBG(dm,DBG_RF_TX_PWR_TRACK, */ + /* "Temperature Increasing: delta_pi: %d, delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", */ + /* dm->rf_calibrate_info.power_index_offset, delta, thermal_value, hal_data->eeprom_thermal_meter, dm->rf_calibrate_info.thermal_value); */ + } else if (thermal_value < dm->rf_calibrate_info.thermal_value) { /* Low temperature */ + /* RF_DBG(dm,DBG_RF_TX_PWR_TRACK, */ + /* "Temperature Decreasing: delta_pi: %d, delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", */ + /* dm->rf_calibrate_info.power_index_offset, delta, thermal_value, hal_data->eeprom_thermal_meter, dm->rf_calibrate_info.thermal_value); */ + } + if (thermal_value > dm->priv->pmib->dot11RFEntry.ther) + { + /* RF_DBG(dm,DBG_RF_TX_PWR_TRACK,"Temperature(%d) hugher than PG value(%d), increases the power by tx_agc\n", thermal_value, hal_data->eeprom_thermal_meter); */ + (*c.odm_tx_pwr_track_set_pwr)(dm, TXAGC, 0, 0); + } else { + /* RF_DBG(dm,DBG_RF_TX_PWR_TRACK,"Temperature(%d) lower than PG value(%d), increases the power by tx_agc\n", thermal_value, hal_data->eeprom_thermal_meter); */ + (*c.odm_tx_pwr_track_set_pwr)(dm, BBSWING, RF_PATH_A, indexforchannel); + if (is2T) + (*c.odm_tx_pwr_track_set_pwr)(dm, BBSWING, RF_PATH_B, indexforchannel); + } + + cali_info->bb_swing_idx_cck_base = cali_info->bb_swing_idx_cck; + cali_info->bb_swing_idx_ofdm_base = cali_info->bb_swing_idx_ofdm[RF_PATH_A]; + dm->rf_calibrate_info.thermal_value = thermal_value; + + } + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "<===dm_TXPowerTrackingCallback_ThermalMeter_8188E\n"); + + dm->rf_calibrate_info.tx_powercount = 0; +} + +/* 3============================================================ + * 3 IQ Calibration + * 3============================================================ */ + +void +odm_reset_iqk_result( + void *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 dm_struct *dm +) +{ + struct dm_iqk_info *iqk_info = &dm->IQK_info; + + if ((dm->is_linked) && (!iqk_info->rfk_forbidden)) { + if ((*dm->channel != dm->pre_channel) && (!*dm->is_scan_in_process)) { + dm->pre_channel = *dm->channel; + dm->linked_interval = 0; + } + + if (dm->linked_interval < 3) + dm->linked_interval++; + + if (dm->linked_interval == 2) + halrf_iqk_trigger(dm, false); + } else + dm->linked_interval = 0; + +} + +void phydm_rf_init(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + odm_txpowertracking_init(dm); + +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) +#if (RTL8814A_SUPPORT == 1) + if (dm->support_ic_type & ODM_RTL8814A) + phy_iq_calibrate_8814a_init(dm); +#endif +#endif + +} + +void phydm_rf_watchdog(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + odm_txpowertracking_check(dm); +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + if (dm->support_ic_type & ODM_IC_11AC_SERIES) + odm_iq_calibrate(dm); +#endif +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halphyrf_ap.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halphyrf_ap.h similarity index 55% rename from drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halphyrf_ap.h rename to drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halphyrf_ap.h index 30017f199558..5d2bd68325c5 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halphyrf_ap.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halphyrf_ap.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,34 +12,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 - * - * - ******************************************************************************/ + *****************************************************************************/ -#ifndef __HAL_PHY_RF_H__ -#define __HAL_PHY_RF_H__ +#ifndef __HALPHYRF_H__ +#define __HALPHYRF_H__ + +#include "halrf/halrf_powertracking_ap.h" +#include "halrf/halrf_kfree.h" -#include "phydm_powertracking_ap.h" #if (RTL8814A_SUPPORT == 1) - #include "rtl8814a/phydm_iqk_8814a.h" + #include "halrf/rtl8814a/halrf_iqk_8814a.h" #endif #if (RTL8822B_SUPPORT == 1) - #include "rtl8822b/phydm_iqk_8822b.h" + #include "halrf/rtl8822b/halrf_iqk_8822b.h" #endif #if (RTL8821C_SUPPORT == 1) - #include "rtl8822b/phydm_iqk_8821c.h" + #include "halrf/rtl8821c/halrf_iqk_8821c.h" +#endif + +#if (RTL8195B_SUPPORT == 1) +// #include "halrf/rtl8195b/halrf.h" + #include "halrf/rtl8195b/halrf_iqk_8195b.h" + #include "halrf/rtl8195b/halrf_txgapk_8195b.h" + #include "halrf/rtl8195b/halrf_dpk_8195b.h" +#endif + +#if (RTL8198F_SUPPORT == 1) + #include "halrf/rtl8198f/halrf_iqk_8198f.h" + #include "halrf/rtl8198f/halrf_dpk_8198f.h" +#endif + +#if (RTL8812F_SUPPORT == 1) + #include "halrf/rtl8812f/halrf_iqk_8812f.h" + #include "halrf/rtl8812f/halrf_dpk_8812f.h" + #include "halrf/rtl8812f/halrf_tssi_8812f.h" +#endif + +#if (RTL8814B_SUPPORT == 1) + #include "halrf/rtl8814b/halrf_iqk_8814b.h" + #include "halrf/rtl8814b/halrf_dpk_8814b.h" #endif enum pwrtrack_method { BBSWING, TXAGC, MIX_MODE, - TSSI_MODE + TSSI_MODE, + MIX_2G_TSSI_5G_MODE, + MIX_5G_TSSI_2G_MODE, + CLEAN_MODE }; typedef void (*func_set_pwr)(void *, enum pwrtrack_method, u8, u8); @@ -48,9 +72,9 @@ 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_all_swing)(void *, u8 **, u8 **, u8 **, u8 **, u8 **, u8 **, u8 **, u8 **); +typedef void (*func_all_swing_ex)(void *, u8 **, u8 **, u8 **, u8 **, u8 **, u8 **, u8 **, u8 **); - -struct _TXPWRTRACK_CFG { +struct txpwrtrack_cfg { u8 swing_table_size_cck; u8 swing_table_size_ofdm; u8 threshold_iqk; @@ -63,116 +87,76 @@ struct _TXPWRTRACK_CFG { 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; + func_all_swing get_delta_all_swing_table; + func_all_swing_ex get_delta_all_swing_table_ex; }; +void +odm_clear_txpowertracking_state( + void *dm_void +); + void configure_txpower_track( - void *p_dm_void, - struct _TXPWRTRACK_CFG *p_config + void *dm_void, + struct txpwrtrack_cfg *config ); void odm_txpowertracking_callback_thermal_meter( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - void *p_dm_void -#else - struct _ADAPTER *adapter -#endif + void *dm_void ); #if (RTL8192E_SUPPORT == 1) void odm_txpowertracking_callback_thermal_meter_92e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - void *p_dm_void -#else - struct _ADAPTER *adapter -#endif + void *dm_void ); #endif #if (RTL8814A_SUPPORT == 1) void odm_txpowertracking_callback_thermal_meter_jaguar_series2( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - void *p_dm_void -#else - struct _ADAPTER *adapter -#endif + void *dm_void ); #elif ODM_IC_11AC_SERIES_SUPPORT void odm_txpowertracking_callback_thermal_meter_jaguar_series( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - void *p_dm_void -#else - struct _ADAPTER *adapter -#endif + void *dm_void ); -#elif (RTL8197F_SUPPORT == 1 || RTL8822B_SUPPORT == 1) +#elif (RTL8197F_SUPPORT == 1 || RTL8192F_SUPPORT == 1 || RTL8822B_SUPPORT == 1 ||\ + RTL8821C_SUPPORT == 1 || RTL8198F_SUPPORT == 1) void odm_txpowertracking_callback_thermal_meter_jaguar_series3( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - void *p_dm_void -#else - struct _ADAPTER *adapter -#endif + void *dm_void +); + +#elif (RTL8814B_SUPPORT == 1) +void +odm_txpowertracking_callback_thermal_meter_jaguar_series4( + void *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) - -#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_set_monitor_mode8192c(struct _ADAPTER *p_adapter, - bool is_enable_monitor_mode); - -/* - * IQ calibrate - * */ -void -phy_iq_calibrate_8192c(struct _ADAPTER *p_adapter, - bool is_recovery); - -/* - * LC calibrate - * */ -void -phy_lc_calibrate_8192c(struct _ADAPTER *p_adapter); - -/* - * AP calibrate - * */ -void -phy_ap_calibrate_8192c(struct _ADAPTER *p_adapter, - s8 delta); -#endif - #define ODM_TARGET_CHNL_NUM_2G_5G 59 void odm_reset_iqk_result( - void *p_dm_void + void *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); +void phydm_rf_init(void *dm_void); +void phydm_rf_watchdog(void *dm_void); -#endif /* #ifndef __HAL_PHY_RF_H__ */ +#endif /*#ifndef __HALPHYRF_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halphyrf_ce.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halphyrf_ce.c new file mode 100644 index 000000000000..847dc4d1fbb6 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halphyrf_ce.c @@ -0,0 +1,1126 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +#include "mp_precomp.h" +#include "phydm_precomp.h" + +#define CALCULATE_SWINGTALBE_OFFSET(_offset, _direction, _size, _delta_thermal)\ + do { \ + u32 __offset = (u32)_offset; \ + u32 __size = (u32)_size; \ + 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 *dm_void, struct txpwrtrack_cfg *config) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + +#if RTL8192E_SUPPORT + if (dm->support_ic_type == ODM_RTL8192E) + configure_txpower_track_8192e(config); +#endif +#if RTL8821A_SUPPORT + if (dm->support_ic_type == ODM_RTL8821) + configure_txpower_track_8821a(config); +#endif +#if RTL8812A_SUPPORT + if (dm->support_ic_type == ODM_RTL8812) + configure_txpower_track_8812a(config); +#endif +#if RTL8188E_SUPPORT + if (dm->support_ic_type == ODM_RTL8188E) + configure_txpower_track_8188e(config); +#endif + +#if RTL8723B_SUPPORT + if (dm->support_ic_type == ODM_RTL8723B) + configure_txpower_track_8723b(config); +#endif + +#if RTL8814A_SUPPORT + if (dm->support_ic_type == ODM_RTL8814A) + configure_txpower_track_8814a(config); +#endif + +#if RTL8703B_SUPPORT + if (dm->support_ic_type == ODM_RTL8703B) + configure_txpower_track_8703b(config); +#endif + +#if RTL8188F_SUPPORT + if (dm->support_ic_type == ODM_RTL8188F) + configure_txpower_track_8188f(config); +#endif +#if RTL8723D_SUPPORT + if (dm->support_ic_type == ODM_RTL8723D) + configure_txpower_track_8723d(config); +#endif +/*@ JJ ADD 20161014 */ +#if RTL8710B_SUPPORT + if (dm->support_ic_type == ODM_RTL8710B) + configure_txpower_track_8710b(config); +#endif +#if RTL8822B_SUPPORT + if (dm->support_ic_type == ODM_RTL8822B) + configure_txpower_track_8822b(config); +#endif +#if RTL8821C_SUPPORT + if (dm->support_ic_type == ODM_RTL8821C) + configure_txpower_track_8821c(config); +#endif + +#if RTL8192F_SUPPORT + if (dm->support_ic_type == ODM_RTL8192F) + configure_txpower_track_8192f(config); +#endif + +#if RTL8822C_SUPPORT + if (dm->support_ic_type == ODM_RTL8822C) + configure_txpower_track_8822c(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 *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &dm->rf_table; + u8 p = 0; + struct dm_rf_calibration_struct *cali_info = &dm->rf_calibrate_info; + + cali_info->bb_swing_idx_cck_base = cali_info->default_cck_index; + cali_info->bb_swing_idx_cck = cali_info->default_cck_index; + dm->rf_calibrate_info.CCK_index = 0; + + for (p = RF_PATH_A; p < MAX_RF_PATH; ++p) { + cali_info->bb_swing_idx_ofdm_base[p] + = cali_info->default_ofdm_index; + cali_info->bb_swing_idx_ofdm[p] = cali_info->default_ofdm_index; + cali_info->OFDM_index[p] = cali_info->default_ofdm_index; + + cali_info->power_index_offset[p] = 0; + cali_info->delta_power_index[p] = 0; + cali_info->delta_power_index_last[p] = 0; + + /* Initial Mix mode power tracking*/ + cali_info->absolute_ofdm_swing_idx[p] = 0; + cali_info->remnant_ofdm_swing_idx[p] = 0; + cali_info->kfree_offset[p] = 0; + } + /* Initial Mix mode power tracking*/ + cali_info->modify_tx_agc_flag_path_a = false; + cali_info->modify_tx_agc_flag_path_b = false; + cali_info->modify_tx_agc_flag_path_c = false; + cali_info->modify_tx_agc_flag_path_d = false; + cali_info->remnant_cck_swing_idx = 0; + cali_info->thermal_value = rf->eeprom_thermal; + cali_info->modify_tx_agc_value_cck = 0; + cali_info->modify_tx_agc_value_ofdm = 0; +} + +void odm_get_tracking_table(void *dm_void, u8 thermal_value, u8 delta) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct dm_rf_calibration_struct *cali_info = &dm->rf_calibrate_info; + struct _hal_rf_ *rf = &dm->rf_table; + struct txpwrtrack_cfg c = {0}; + + u8 p; + /* 4 1. TWO tables decide the final index of OFDM/CCK swing table. */ + u8 *pwrtrk_tab_up_a = NULL; + u8 *pwrtrk_tab_down_a = NULL; + u8 *pwrtrk_tab_up_b = NULL; + u8 *pwrtrk_tab_down_b = NULL; + /*for 8814 add by Yu Chen*/ + u8 *pwrtrk_tab_up_c = NULL; + u8 *pwrtrk_tab_down_c = NULL; + u8 *pwrtrk_tab_up_d = NULL; + u8 *pwrtrk_tab_down_d = NULL; + /*for Xtal Offset by James.Tung*/ + s8 *xtal_tab_up = NULL; + s8 *xtal_tab_down = NULL; + + configure_txpower_track(dm, &c); + + (*c.get_delta_swing_table)(dm, + (u8 **)&pwrtrk_tab_up_a, + (u8 **)&pwrtrk_tab_down_a, + (u8 **)&pwrtrk_tab_up_b, + (u8 **)&pwrtrk_tab_down_b); + + if (dm->support_ic_type & ODM_RTL8814A) /*for 8814 path C & D*/ + (*c.get_delta_swing_table8814only)(dm, + (u8 **)&pwrtrk_tab_up_c, + (u8 **)&pwrtrk_tab_down_c, + (u8 **)&pwrtrk_tab_up_d, + (u8 **)&pwrtrk_tab_down_d); + /*for Xtal Offset*/ + if (dm->support_ic_type & + (ODM_RTL8703B | ODM_RTL8723D | ODM_RTL8710B | ODM_RTL8192F)) + (*c.get_delta_swing_xtal_table)(dm, + (s8 **)&xtal_tab_up, + (s8 **)&xtal_tab_down); + + if (thermal_value > rf->eeprom_thermal) { + for (p = RF_PATH_A; p < c.rf_path_count; p++) { + /*recording power index offset*/ + cali_info->delta_power_index_last[p] = + cali_info->delta_power_index[p]; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "******Temp is higher******\n"); + switch (p) { + case RF_PATH_B: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "pwrtrk_tab_up_b[%d] = %d\n", delta, + pwrtrk_tab_up_b[delta]); + + cali_info->delta_power_index[p] = + pwrtrk_tab_up_b[delta]; + cali_info->absolute_ofdm_swing_idx[p] = + pwrtrk_tab_up_b[delta]; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "absolute_ofdm_swing_idx[PATH_B] = %d\n", + cali_info->absolute_ofdm_swing_idx[p]); + break; + + case RF_PATH_C: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "pwrtrk_tab_up_c[%d] = %d\n", delta, + pwrtrk_tab_up_c[delta]); + + cali_info->delta_power_index[p] = + pwrtrk_tab_up_c[delta]; + cali_info->absolute_ofdm_swing_idx[p] = + pwrtrk_tab_up_c[delta]; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "absolute_ofdm_swing_idx[PATH_C] = %d\n", + cali_info->absolute_ofdm_swing_idx[p]); + break; + + case RF_PATH_D: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "pwrtrk_tab_up_d[%d] = %d\n", delta, + pwrtrk_tab_up_d[delta]); + + cali_info->delta_power_index[p] = + pwrtrk_tab_up_d[delta]; + cali_info->absolute_ofdm_swing_idx[p] = + pwrtrk_tab_up_d[delta]; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "absolute_ofdm_swing_idx[PATH_D] = %d\n", + cali_info->absolute_ofdm_swing_idx[p]); + break; + + default: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "pwrtrk_tab_up_a[%d] = %d\n", delta, + pwrtrk_tab_up_a[delta]); + + cali_info->delta_power_index[p] = + pwrtrk_tab_up_a[delta]; + cali_info->absolute_ofdm_swing_idx[p] = + pwrtrk_tab_up_a[delta]; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "absolute_ofdm_swing_idx[PATH_A] = %d\n", + cali_info->absolute_ofdm_swing_idx[p]); + break; + } + } + /* @JJ ADD 20161014 */ + /*Save xtal_offset from Xtal table*/ + if (dm->support_ic_type & + (ODM_RTL8703B | ODM_RTL8723D | ODM_RTL8710B | + ODM_RTL8192F)) { + /*recording last Xtal offset*/ + cali_info->xtal_offset_last = cali_info->xtal_offset; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "[Xtal] xtal_tab_up[%d] = %d\n", + delta, xtal_tab_up[delta]); + cali_info->xtal_offset = xtal_tab_up[delta]; + if (cali_info->xtal_offset_last != xtal_tab_up[delta]) + cali_info->xtal_offset_eanble = 1; + } + } else { + for (p = RF_PATH_A; p < c.rf_path_count; p++) { + /*recording power index offset*/ + cali_info->delta_power_index_last[p] = + cali_info->delta_power_index[p]; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "******Temp is lower******\n"); + switch (p) { + case RF_PATH_B: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "pwrtrk_tab_down_b[%d] = %d\n", delta, + pwrtrk_tab_down_b[delta]); + cali_info->delta_power_index[p] = + -1 * pwrtrk_tab_down_b[delta]; + cali_info->absolute_ofdm_swing_idx[p] = + -1 * pwrtrk_tab_down_b[delta]; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "absolute_ofdm_swing_idx[PATH_B] = %d\n", + cali_info->absolute_ofdm_swing_idx[p]); + break; + + case RF_PATH_C: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "pwrtrk_tab_down_c[%d] = %d\n", delta, + pwrtrk_tab_down_c[delta]); + cali_info->delta_power_index[p] = + -1 * pwrtrk_tab_down_c[delta]; + cali_info->absolute_ofdm_swing_idx[p] = + -1 * pwrtrk_tab_down_c[delta]; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "absolute_ofdm_swing_idx[PATH_C] = %d\n", + cali_info->absolute_ofdm_swing_idx[p]); + break; + + case RF_PATH_D: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "pwrtrk_tab_down_d[%d] = %d\n", delta, + pwrtrk_tab_down_d[delta]); + cali_info->delta_power_index[p] = + -1 * pwrtrk_tab_down_d[delta]; + cali_info->absolute_ofdm_swing_idx[p] = + -1 * pwrtrk_tab_down_d[delta]; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "absolute_ofdm_swing_idx[PATH_D] = %d\n", + cali_info->absolute_ofdm_swing_idx[p]); + break; + + default: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "pwrtrk_tab_down_a[%d] = %d\n", delta, + pwrtrk_tab_down_a[delta]); + cali_info->delta_power_index[p] = + -1 * pwrtrk_tab_down_a[delta]; + cali_info->absolute_ofdm_swing_idx[p] = + -1 * pwrtrk_tab_down_a[delta]; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "absolute_ofdm_swing_idx[PATH_A] = %d\n", + cali_info->absolute_ofdm_swing_idx[p]); + break; + } + } + /* @JJ ADD 20161014 */ + if (dm->support_ic_type & + (ODM_RTL8703B | ODM_RTL8723D | ODM_RTL8710B | + ODM_RTL8192F)) { + /*recording last Xtal offset*/ + cali_info->xtal_offset_last = cali_info->xtal_offset; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "[Xtal] xtal_tab_down[%d] = %d\n", delta, + xtal_tab_down[delta]); + /*Save xtal_offset from Xtal table*/ + cali_info->xtal_offset = xtal_tab_down[delta]; + if (cali_info->xtal_offset_last != xtal_tab_down[delta]) + cali_info->xtal_offset_eanble = 1; + } + } +} + +void odm_pwrtrk_method(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 p, idxforchnl = 0; + + struct txpwrtrack_cfg c = {0}; + + configure_txpower_track(dm, &c); + + if (dm->support_ic_type & + (ODM_RTL8188E | ODM_RTL8192E | ODM_RTL8821 | ODM_RTL8812 | + ODM_RTL8723B | ODM_RTL8814A | ODM_RTL8703B | ODM_RTL8188F | + ODM_RTL8822B | ODM_RTL8723D | ODM_RTL8821C | ODM_RTL8710B | + ODM_RTL8192F)) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "***Enter PwrTrk MIX_MODE***\n"); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0); + } else { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "***Enter PwrTrk BBSWING_MODE***\n"); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr) + (dm, BBSWING, p, idxforchnl); + } +} + +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) +void odm_txpowertracking_callback_thermal_meter(struct dm_struct *dm) +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) +void odm_txpowertracking_callback_thermal_meter(void *dm_void) +#else +void odm_txpowertracking_callback_thermal_meter(void *adapter) +#endif +{ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + struct dm_struct *dm = &hal_data->DM_OutSrc; +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + struct dm_struct *dm = (struct dm_struct *)dm_void; +#endif + + struct _hal_rf_ *rf = &dm->rf_table; + struct dm_rf_calibration_struct *cali_info = &dm->rf_calibrate_info; + struct dm_iqk_info *iqk_info = &dm->IQK_info; + + u8 thermal_value = 0, delta, delta_lck, delta_iqk, p = 0, i = 0; + u8 thermal_value_avg_count = 0; + u32 thermal_value_avg = 0, regc80, regcd0, regcd4, regab4; + + /* OFDM BB Swing should be less than +3.0dB, required by Arthur */ +#if 0 + u8 OFDM_min_index = 0; +#endif +#if 0 + /* get_right_chnl_place_for_iqk(hal_data->current_channel) */ +#endif + u8 power_tracking_type = rf->pwt_type; + s8 thermal_value_temp = 0; + + struct txpwrtrack_cfg c = {0}; + + /* @4 2. Initialization ( 7 steps in total ) */ + + configure_txpower_track(dm, &c); + + cali_info->txpowertracking_callback_cnt++; + cali_info->is_txpowertracking_init = true; + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "\n\n\n===>%s bbsw_idx_cck_base=%d\n", + __func__, cali_info->bb_swing_idx_cck_base); + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "bbsw_idx_ofdm_base[A]=%d default_ofdm_idx=%d\n", + cali_info->bb_swing_idx_ofdm_base[RF_PATH_A], + cali_info->default_ofdm_index); + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "cali_info->txpowertrack_control=%d, rf->eeprom_thermal %d\n", + cali_info->txpowertrack_control, rf->eeprom_thermal); + + /* 0x42: RF Reg[15:10] 88E */ + thermal_value = + (u8)odm_get_rf_reg(dm, RF_PATH_A, c.thermal_reg_addr, 0xfc00); + + thermal_value_temp = thermal_value + phydm_get_thermal_offset(dm); + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "thermal_value_temp(%d) = ther_value(%d) + pwr_trim_ther(%d)\n", + thermal_value_temp, thermal_value, + phydm_get_thermal_offset(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 (dm->support_ic_type & + (ODM_RTL8723D | ODM_RTL8710B)) { + regc80 = odm_get_bb_reg(dm, R_0xc80, MASKDWORD); + regcd0 = odm_get_bb_reg(dm, R_0xcd0, MASKDWORD); + regcd4 = odm_get_bb_reg(dm, R_0xcd4, MASKDWORD); + regab4 = odm_get_bb_reg(dm, R_0xab4, 0x000007FF); + RF_DBG(dm, DBG_RF_IQK, + "0xc80 = 0x%x 0xcd0 = 0x%x 0xcd4 = 0x%x 0xab4 = 0x%x\n", + regc80, regcd0, regcd4, regab4); + } + + if (!cali_info->txpowertrack_control) + return; + + if (rf->eeprom_thermal == 0xff) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "no pg, hal_data->eeprom_thermal_meter = 0x%x\n", + rf->eeprom_thermal); + return; + } + + /*@4 3. Initialize ThermalValues of rf_calibrate_info*/ + + if (cali_info->is_reloadtxpowerindex) + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "reload ofdm index for band switch\n"); + + /*@4 4. Calculate average thermal meter*/ + + cali_info->thermal_value_avg[cali_info->thermal_value_avg_index] + = thermal_value; + + cali_info->thermal_value_avg_index++; + /*Average times = c.average_thermal_num*/ + if (cali_info->thermal_value_avg_index == c.average_thermal_num) + cali_info->thermal_value_avg_index = 0; + + for (i = 0; i < c.average_thermal_num; i++) { + if (cali_info->thermal_value_avg[i]) { + thermal_value_avg += cali_info->thermal_value_avg[i]; + thermal_value_avg_count++; + } + } + + /* Calculate Average thermal_value after average enough times */ + if (thermal_value_avg_count) { + thermal_value = + (u8)(thermal_value_avg / thermal_value_avg_count); + cali_info->thermal_value_delta + = thermal_value - rf->eeprom_thermal; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "AVG Thermal Meter = 0x%X, EFUSE Thermal base = 0x%X\n", + thermal_value, rf->eeprom_thermal); + } + + /* @4 5. Calculate delta, delta_lck, delta_iqk. */ + /* "delta" here is used to determine thermal value changes or not. */ + if (thermal_value > cali_info->thermal_value) + delta = thermal_value - cali_info->thermal_value; + else + delta = cali_info->thermal_value - thermal_value; + + if (thermal_value > cali_info->thermal_value_lck) + delta_lck = thermal_value - cali_info->thermal_value_lck; + else + delta_lck = cali_info->thermal_value_lck - thermal_value; + + if (thermal_value > cali_info->thermal_value_iqk) + delta_iqk = thermal_value - cali_info->thermal_value_iqk; + else + delta_iqk = cali_info->thermal_value_iqk - thermal_value; + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "(delta, delta_lck, delta_iqk) = (%d, %d, %d)\n", delta, + delta_lck, delta_iqk); + + /*@4 6. If necessary, do LCK.*/ + /* Wait sacn to do LCK by RF Jenyu*/ + if (!(*dm->is_scan_in_process) && !iqk_info->rfk_forbidden) { + /* Delta temperature is equal to or larger than 20 centigrade.*/ + if (delta_lck >= c.threshold_iqk) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "delta_lck(%d) >= threshold_iqk(%d)\n", + delta_lck, c.threshold_iqk); + cali_info->thermal_value_lck = thermal_value; + + /*Use RTLCK, close power tracking driver LCK*/ + /*8821 don't do LCK*/ + if (!(dm->support_ic_type & + (ODM_RTL8821 | ODM_RTL8814A | ODM_RTL8822B)) && + c.phy_lc_calibrate) { + (*c.phy_lc_calibrate)(dm); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "do pwrtrk lck\n"); + } + } + } + + /*@3 7. If necessary, move the index of swing table to adjust Tx power.*/ + /* "delta" here is used to record the absolute value of difference. */ + if (delta > 0 && cali_info->txpowertrack_control) { + if (thermal_value > rf->eeprom_thermal) + delta = thermal_value - rf->eeprom_thermal; + else + delta = rf->eeprom_thermal - thermal_value; + + if (delta >= TXPWR_TRACK_TABLE_SIZE) + delta = TXPWR_TRACK_TABLE_SIZE - 1; + + odm_get_tracking_table(dm, thermal_value, delta); + + for (p = RF_PATH_A; p < c.rf_path_count; p++) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "\n[path-%d] Calculate pwr_idx_offset\n", p); + + /*If Thermal value changes but table value is the same*/ + if (cali_info->delta_power_index[p] == + cali_info->delta_power_index_last[p]) + cali_info->power_index_offset[p] = 0; + else + cali_info->power_index_offset[p] = + cali_info->delta_power_index[p] - + cali_info->delta_power_index_last[p]; + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "path-%d pwridx_diff%d=pwr_idx%d - last_idx%d\n", + p, cali_info->power_index_offset[p], + cali_info->delta_power_index[p], + cali_info->delta_power_index_last[p]); +#if 0 + + cali_info->OFDM_index[p] = cali_info->bb_swing_idx_ofdm_base[p] + cali_info->power_index_offset[p]; + cali_info->CCK_index = cali_info->bb_swing_idx_cck_base + cali_info->power_index_offset[p]; + + cali_info->bb_swing_idx_cck = cali_info->CCK_index; + cali_info->bb_swing_idx_ofdm[p] = cali_info->OFDM_index[p]; + + /*************Print BB Swing base and index Offset*************/ + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "The 'CCK' final index(%d) = BaseIndex(%d) + power_index_offset(%d)\n", + cali_info->bb_swing_idx_cck, + cali_info->bb_swing_idx_cck_base, + cali_info->power_index_offset[p]); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "The 'OFDM' final index(%d) = BaseIndex[%d](%d) + power_index_offset(%d)\n", + cali_info->bb_swing_idx_ofdm[p], p, + cali_info->bb_swing_idx_ofdm_base[p], + cali_info->power_index_offset[p]); + + /*4 7.1 Handle boundary conditions of index.*/ + + if (cali_info->OFDM_index[p] > c.swing_table_size_ofdm - 1) + cali_info->OFDM_index[p] = c.swing_table_size_ofdm - 1; + else if (cali_info->OFDM_index[p] <= OFDM_min_index) + cali_info->OFDM_index[p] = OFDM_min_index; +#endif + } +#if 0 + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "\n\n========================================================================================================\n"); + + if (cali_info->CCK_index > c.swing_table_size_cck - 1) + cali_info->CCK_index = c.swing_table_size_cck - 1; + else if (cali_info->CCK_index <= 0) + cali_info->CCK_index = 0; +#endif + } else { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "Thermal is unchanged thermal=%d last_thermal=%d\n", + thermal_value, + cali_info->thermal_value); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + cali_info->power_index_offset[p] = 0; + } + +#if 0 + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "TxPowerTracking: [CCK] Swing Current index: %d, Swing base index: %d\n", + cali_info->CCK_index, + cali_info->bb_swing_idx_cck_base); /*Print Swing base & current*/ + + for (p = RF_PATH_A; p < c.rf_path_count; p++) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "TxPowerTracking: [OFDM] Swing Current index: %d, Swing base index[%d]: %d\n", + cali_info->OFDM_index[p], p, + cali_info->bb_swing_idx_ofdm_base[p]); + } +#endif + + if ((dm->support_ic_type & ODM_RTL8814A)) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "power_tracking_type=%d\n", + power_tracking_type); + + if (power_tracking_type == 0) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "***Enter PwrTrk MIX_MODE***\n"); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr) + (dm, MIX_MODE, p, 0); + } else if (power_tracking_type == 1) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "***Enter PwrTrk MIX(2G) TSSI(5G) MODE***\n"); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr) + (dm, MIX_2G_TSSI_5G_MODE, p, 0); + } else if (power_tracking_type == 2) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "***Enter PwrTrk MIX(5G) TSSI(2G)MODE***\n"); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr) + (dm, MIX_5G_TSSI_2G_MODE, p, 0); + } else if (power_tracking_type == 3) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "***Enter PwrTrk TSSI MODE***\n"); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr) + (dm, TSSI_MODE, p, 0); + } + } else if ((cali_info->power_index_offset[RF_PATH_A] != 0 || + cali_info->power_index_offset[RF_PATH_B] != 0 || + cali_info->power_index_offset[RF_PATH_C] != 0 || + cali_info->power_index_offset[RF_PATH_D] != 0)) { +#if 0 + /* 4 7.2 Configure the Swing Table to adjust Tx Power. */ + /*Always true after Tx Power is adjusted by power tracking.*/ + + cali_info->is_tx_power_changed = true; + /* 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 > cali_info->thermal_value) { + for (p = RF_PATH_A; p < c.rf_path_count; p++) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "Temperature Increasing(%d): delta_pi: %d, delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", + p, cali_info->power_index_offset[p], + delta, thermal_value, rf->eeprom_thermal, + cali_info->thermal_value); + } + } else if (thermal_value < cali_info->thermal_value) { /*Low temperature*/ + for (p = RF_PATH_A; p < c.rf_path_count; p++) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "Temperature Decreasing(%d): delta_pi: %d, delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", + p, cali_info->power_index_offset[p], + delta, thermal_value, rf->eeprom_thermal, + cali_info->thermal_value); + } + } +#endif + +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) + if (thermal_value > rf->eeprom_thermal) { +#else + if (thermal_value > dm->priv->pmib->dot11RFEntry.ther) { +#endif + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "Temperature(%d) higher than PG value(%d)\n", + thermal_value, rf->eeprom_thermal); + + odm_pwrtrk_method(dm); + } else { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "Temperature(%d) lower than PG value(%d)\n", + thermal_value, rf->eeprom_thermal); + + odm_pwrtrk_method(dm); + } + +#if 0 + /*Record last time Power Tracking result as base.*/ + cali_info->bb_swing_idx_cck_base = cali_info->bb_swing_idx_cck; + for (p = RF_PATH_A; p < c.rf_path_count; p++) + cali_info->bb_swing_idx_ofdm_base[p] = cali_info->bb_swing_idx_ofdm[p]; +#endif + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "cali_info->thermal_value = %d thermal_value= %d\n", + cali_info->thermal_value, thermal_value); + } + /*Record last Power Tracking Thermal value*/ + cali_info->thermal_value = thermal_value; + + if (dm->support_ic_type & + (ODM_RTL8703B | ODM_RTL8723D | ODM_RTL8192F | ODM_RTL8710B)) { + if (cali_info->xtal_offset_eanble != 0 && + cali_info->txpowertrack_control && + rf->eeprom_thermal != 0xff) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "**********Enter Xtal Tracking**********\n"); + +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) + if (thermal_value > rf->eeprom_thermal) { +#else + if (thermal_value > dm->priv->pmib->dot11RFEntry.ther) { +#endif + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "Temperature(%d) higher than PG (%d)\n", + thermal_value, rf->eeprom_thermal); + (*c.odm_txxtaltrack_set_xtal)(dm); + } else { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "Temperature(%d) lower than PG (%d)\n", + thermal_value, rf->eeprom_thermal); + (*c.odm_txxtaltrack_set_xtal)(dm); + } + } + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "**********End Xtal Tracking**********\n"); + } + +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) + + /* Wait sacn to do IQK by RF Jenyu*/ + if (!(*dm->is_scan_in_process) && !iqk_info->rfk_forbidden && + !cali_info->is_iqk_in_progress) { + if (!(dm->support_ic_type & ODM_RTL8723B)) { + /*Delta temperature is equal or larger than 20 Celsius*/ + /*When threshold is 8*/ + if (delta_iqk >= c.threshold_iqk) { + cali_info->thermal_value_iqk = thermal_value; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "delta_iqk(%d) >= threshold_iqk(%d)\n", + delta_iqk, c.threshold_iqk); + (*c.do_iqk)(dm, delta_iqk, thermal_value, 8); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "do pwrtrk iqk\n"); + } + } + } + +#if 0 + if (cali_info->dpk_thermal[RF_PATH_A] != 0) { + if (diff_DPK[RF_PATH_A] >= c.threshold_dpk) { + odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x1); + odm_set_bb_reg(dm, R_0xcc4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), (diff_DPK[RF_PATH_A] / c.threshold_dpk)); + odm_set_bb_reg(dm, R_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(dm, R_0x82c, BIT(31), 0x1); + odm_set_bb_reg(dm, R_0xcc4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), value); + odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x0); + } else { + odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x1); + odm_set_bb_reg(dm, R_0xcc4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), 0); + odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x0); + } + } + if (cali_info->dpk_thermal[RF_PATH_B] != 0) { + if (diff_DPK[RF_PATH_B] >= c.threshold_dpk) { + odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x1); + odm_set_bb_reg(dm, R_0xec4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), (diff_DPK[RF_PATH_B] / c.threshold_dpk)); + odm_set_bb_reg(dm, R_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(dm, R_0x82c, BIT(31), 0x1); + odm_set_bb_reg(dm, R_0xec4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), value); + odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x0); + } else { + odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x1); + odm_set_bb_reg(dm, R_0xec4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), 0); + odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x0); + } + } +#endif + +#endif + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "<===%s\n", __func__); + + cali_info->tx_powercount = 0; +} + +#if (RTL8822C_SUPPORT == 1) +void +odm_txpowertracking_new_callback_thermal_meter(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); + struct dm_iqk_info *iqk_info = &dm->IQK_info; + struct _hal_rf_ *rf = &dm->rf_table; + struct _halrf_tssi_data *tssi = &rf->halrf_tssi_data; + u8 thermal_value[MAX_RF_PATH] = {0}, delta[MAX_RF_PATH] = {0}; + u8 delta_swing_table_idx_tup[DELTA_SWINGIDX_SIZE] = {0}; + u8 delta_swing_table_idx_tdown[DELTA_SWINGIDX_SIZE] = {0}; + u8 delta_LCK = 0, delta_IQK = 0, i = 0, j = 0, p; + u8 thermal_value_avg_count[MAX_RF_PATH] = {0}; + u32 thermal_value_avg[MAX_RF_PATH] = {0}; + s8 thermal_value_temp[MAX_RF_PATH] = {0}; + + struct txpwrtrack_cfg c; + + 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; + 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; + + configure_txpower_track(dm, &c); + + (*c.get_delta_swing_table)(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); + + cali_info->txpowertracking_callback_cnt++; + cali_info->is_txpowertracking_init = true; + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "===>odm_txpowertracking_callback_thermal_meter\n cali_info->bb_swing_idx_cck_base: %d, cali_info->bb_swing_idx_ofdm_base[A]: %d, cali_info->default_ofdm_index: %d\n", + cali_info->bb_swing_idx_cck_base, cali_info->bb_swing_idx_ofdm_base[RF_PATH_A], cali_info->default_ofdm_index); + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "cali_info->txpowertrack_control=%d, tssi->thermal[RF_PATH_A]=%d tssi->thermal[RF_PATH_B]=%d\n", + cali_info->txpowertrack_control, tssi->thermal[RF_PATH_A], tssi->thermal[RF_PATH_B]); + + thermal_value[RF_PATH_A] = (u8)odm_get_rf_reg(dm, RF_PATH_A, c.thermal_reg_addr, 0xfc00); /* 0x42: RF Reg[15:10] 88E */ + thermal_value[RF_PATH_B] = (u8)odm_get_rf_reg(dm, RF_PATH_B, c.thermal_reg_addr, 0xfc00); + + for (i = 0; i < c.rf_path_count; i++) { + thermal_value_temp[i] = (s8)thermal_value[i] + phydm_get_thermal_offset(dm); + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "thermal_value_temp[%d](%d) = thermal_value[%d](%d) + power_time_thermal(%d)\n", i, thermal_value_temp[i], i, thermal_value[i], phydm_get_thermal_offset(dm)); + + if (thermal_value_temp[i] > 63) + thermal_value[i] = 63; + else if (thermal_value_temp[i] < 0) + thermal_value[i] = 0; + else + thermal_value[i] = thermal_value_temp[i]; + } + + if (tssi->thermal[RF_PATH_A] == 0xff || tssi->thermal[RF_PATH_B] == 0xff) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "no pg, tssi->thermal[A] = 0x%x tssi->thermal[B] = 0x%x\n", + tssi->thermal[RF_PATH_A], tssi->thermal[RF_PATH_B]); + return; + } + + for (j = 0; j < c.rf_path_count; j++) { + cali_info->thermal_value_avg_path[j][cali_info->thermal_value_avg_index_path[j]] = thermal_value[j]; + cali_info->thermal_value_avg_index_path[j]++; + if (cali_info->thermal_value_avg_index_path[j] == c.average_thermal_num) /*Average times = c.average_thermal_num*/ + cali_info->thermal_value_avg_index_path[j] = 0; + + + for (i = 0; i < c.average_thermal_num; i++) { + if (cali_info->thermal_value_avg_path[j][i]) { + thermal_value_avg[j] += cali_info->thermal_value_avg_path[j][i]; + thermal_value_avg_count[j]++; + } + } + + if (thermal_value_avg_count[j]) { /* Calculate Average thermal_value after average enough times */ + thermal_value[j] = (u8)(thermal_value_avg[j] / thermal_value_avg_count[j]); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "AVG Thermal Meter = 0x%X, tssi->thermal[A] = 0x%x tssi->thermal[B] = 0x%x\n", + thermal_value[j], tssi->thermal[RF_PATH_A], tssi->thermal[RF_PATH_B]); + } + /* 4 5. Calculate delta, delta_LCK, delta_IQK. */ + + /* "delta" here is used to determine whether thermal value changes or not. */ + delta[j] = (thermal_value[j] > cali_info->thermal_value_path[j]) ? (thermal_value[j] - cali_info->thermal_value_path[j]) : (cali_info->thermal_value_path[j] - thermal_value[j]); + delta_LCK = (thermal_value[0] > cali_info->thermal_value_lck) ? (thermal_value[0] - cali_info->thermal_value_lck) : (cali_info->thermal_value_lck - thermal_value[0]); + delta_IQK = (thermal_value[0] > cali_info->thermal_value_iqk) ? (thermal_value[0] - cali_info->thermal_value_iqk) : (cali_info->thermal_value_iqk - thermal_value[0]); + } + + /*4 6. If necessary, do LCK.*/ + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "(delta[%d], delta_LCK, delta_IQK) = (%d, %d, %d)\n", RF_PATH_A, delta[RF_PATH_A], delta_LCK, delta_IQK); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "(delta[%d], delta_LCK, delta_IQK) = (%d, %d, %d)\n", RF_PATH_B, delta[RF_PATH_B], delta_LCK, delta_IQK); + + /* Wait sacn to do LCK by RF Jenyu*/ + if( (*dm->is_scan_in_process == false) && (!iqk_info->rfk_forbidden)) { + /* Delta temperature is equal to or larger than 20 centigrade.*/ + if (delta_LCK >= c.threshold_iqk) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta_LCK(%d) >= threshold_iqk(%d)\n", delta_LCK, c.threshold_iqk); + cali_info->thermal_value_lck = thermal_value[RF_PATH_A]; + + /*Use RTLCK, so close power tracking driver LCK*/ + if ((!(dm->support_ic_type & ODM_RTL8814A)) && (!(dm->support_ic_type & ODM_RTL8822B))) { + if (c.phy_lc_calibrate) + (*c.phy_lc_calibrate)(dm); + } else + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "Do not do LCK\n"); + } + } + + /*3 7. If necessary, move the index of swing table to adjust Tx power.*/ + for (i = 0; i < c.rf_path_count; i++) { + if (i == RF_PATH_B) { + odm_move_memory(dm, delta_swing_table_idx_tup, delta_swing_table_idx_tup_b, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, delta_swing_table_idx_tdown, delta_swing_table_idx_tdown_b, DELTA_SWINGIDX_SIZE); + } else if (i == RF_PATH_C) { + odm_move_memory(dm, delta_swing_table_idx_tup, delta_swing_table_idx_tup_c, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, delta_swing_table_idx_tdown, delta_swing_table_idx_tdown_c, DELTA_SWINGIDX_SIZE); + } else if (i == RF_PATH_D) { + odm_move_memory(dm, delta_swing_table_idx_tup, delta_swing_table_idx_tup_d, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, delta_swing_table_idx_tdown, delta_swing_table_idx_tdown_d, DELTA_SWINGIDX_SIZE); + } else { + odm_move_memory(dm, delta_swing_table_idx_tup, delta_swing_table_idx_tup_a, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, delta_swing_table_idx_tdown, delta_swing_table_idx_tdown_a, DELTA_SWINGIDX_SIZE); + } + + cali_info->delta_power_index_last[i] = cali_info->delta_power_index[i]; /*recording poer index offset*/ + delta[i] = thermal_value[i] > tssi->thermal[i] ? (thermal_value[i] - tssi->thermal[i]) : (tssi->thermal[i] - thermal_value[i]); + + if (delta[i] >= TXPWR_TRACK_TABLE_SIZE) + delta[i] = TXPWR_TRACK_TABLE_SIZE - 1; + + if (thermal_value[i] > tssi->thermal[i]) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "delta_swing_table_idx_tup[%d]=%d Path=%d\n", delta[i], delta_swing_table_idx_tup[delta[i]], i); + + cali_info->delta_power_index[i] = delta_swing_table_idx_tup[delta[i]]; + cali_info->absolute_ofdm_swing_idx[i] = delta_swing_table_idx_tup[delta[i]]; /*Record delta swing for mix mode power tracking*/ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "******Temp is higher and cali_info->absolute_ofdm_swing_idx[%d]=%d Path=%d\n", delta[i], cali_info->absolute_ofdm_swing_idx[i], i); + } else { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "delta_swing_table_idx_tdown[%d]=%d Path=%d\n", delta[i], delta_swing_table_idx_tdown[delta[i]], i); + cali_info->delta_power_index[i] = -1 * delta_swing_table_idx_tdown[delta[i]]; + cali_info->absolute_ofdm_swing_idx[i] = -1 * delta_swing_table_idx_tdown[delta[i]]; /*Record delta swing for mix mode power tracking*/ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "******Temp is lower and cali_info->absolute_ofdm_swing_idx[%d]=%d Path=%d\n", delta[i], cali_info->absolute_ofdm_swing_idx[i], i); + } + } + + for (p = RF_PATH_A; p < c.rf_path_count; p++) { + if (cali_info->delta_power_index[p] == cali_info->delta_power_index_last[p]) /*If Thermal value changes but lookup table value still the same*/ + cali_info->power_index_offset[p] = 0; + else + cali_info->power_index_offset[p] = cali_info->delta_power_index[p] - cali_info->delta_power_index_last[p]; /*Power index diff between 2 times Power Tracking*/ + } + + if ((cali_info->power_index_offset[RF_PATH_A] != 0 || + cali_info->power_index_offset[RF_PATH_B] != 0 || + cali_info->power_index_offset[RF_PATH_C] != 0 || + cali_info->power_index_offset[RF_PATH_D] != 0)) { + + if (dm->support_ic_type == ODM_RTL8822C) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking MIX_MODE**********\n"); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0); + } else { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking BBSWING_MODE**********\n"); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(dm, BBSWING, p, 0); + } + } else + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "TXAGC offset is unchanged\n"); + + /* Wait sacn to do IQK by RF Jenyu*/ + if ((*dm->is_scan_in_process == false) && (!iqk_info->rfk_forbidden)) { + /*Delta temperature is equal to or larger than 20 centigrade (When threshold is 8).*/ + if (delta_IQK >= c.threshold_iqk) { + cali_info->thermal_value_iqk = thermal_value[RF_PATH_A]; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta_IQK(%d) >= threshold_iqk(%d)\n", delta_IQK, c.threshold_iqk); + if (!cali_info->is_iqk_in_progress) + (*c.do_iqk)(dm, delta_IQK, thermal_value[RF_PATH_A], 8); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "Do IQK\n"); + } + } + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "<===%s\n", __func__); + + cali_info->tx_powercount = 0; +} +#endif + +/*@3============================================================ + * 3 IQ Calibration + * 3============================================================ + */ + +void odm_reset_iqk_result(void *dm_void) +{ +} + +#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 dm_struct *dm) +{ + void *adapter = dm->adapter; + struct dm_iqk_info *iqk_info = &dm->IQK_info; + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + if (*dm->is_fcs_mode_enable) + return; +#endif + +#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) + if (IS_HARDWARE_TYPE_8812AU(adapter)) + return; +#endif + + if (dm->is_linked && !iqk_info->rfk_forbidden) { + if ((*dm->channel != dm->pre_channel) && + (!*dm->is_scan_in_process)) { + dm->pre_channel = *dm->channel; + dm->linked_interval = 0; + } + + if (dm->linked_interval < 3) + dm->linked_interval++; + + if (dm->linked_interval == 2) + halrf_iqk_trigger(dm, false); + } else { + dm->linked_interval = 0; + } +} + +void phydm_rf_init(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + odm_txpowertracking_init(dm); + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + odm_clear_txpowertracking_state(dm); +#endif +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) +#if (RTL8814A_SUPPORT == 1) + if (dm->support_ic_type & ODM_RTL8814A) + phy_iq_calibrate_8814a_init(dm); +#endif +#endif +} + +void phydm_rf_watchdog(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + odm_txpowertracking_check(dm); +#if 0 +/*if (dm->support_ic_type & ODM_IC_11AC_SERIES)*/ +/*odm_iq_calibrate(dm);*/ +#endif +#endif +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halphyrf_ce.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halphyrf_ce.h new file mode 100644 index 000000000000..da8b0923e3e9 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halphyrf_ce.h @@ -0,0 +1,121 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +#ifndef __HALPHYRF_H__ +#define __HALPHYRF_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 + +#if (RTL8195B_SUPPORT == 1) +/* #include "halrf/rtl8195b/halrf.h" */ +#include "halrf/rtl8195b/halrf_iqk_8195b.h" +#include "halrf/rtl8195b/halrf_txgapk_8195b.h" +#include "halrf/rtl8195b/halrf_dpk_8195b.h" +#endif + +#if (RTL8814B_SUPPORT == 1) + #include "halrf/rtl8814b/halrf_iqk_8814b.h" + #include "halrf/rtl8814b/halrf_dpk_8814b.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, + CLEAN_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 *dm_void, struct txpwrtrack_cfg *config); + +void odm_clear_txpowertracking_state(void *dm_void); + +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) +void odm_txpowertracking_callback_thermal_meter(void *dm_void); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) +void odm_txpowertracking_callback_thermal_meter(void *dm); +#else +void odm_txpowertracking_callback_thermal_meter(void *adapter); +#endif + +#if (RTL8822C_SUPPORT == 1) +void odm_txpowertracking_new_callback_thermal_meter(void *dm_void); +#endif + +#define ODM_TARGET_CHNL_NUM_2G_5G 59 + +void odm_reset_iqk_result(void *dm_void); +u8 odm_get_right_chnl_place_for_iqk(u8 chnl); + +void phydm_rf_init(void *dm_void); +void phydm_rf_watchdog(void *dm_void); + +#endif /*__HALPHYRF_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halphyrf_iot.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halphyrf_iot.c new file mode 100644 index 000000000000..171553a34681 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halphyrf_iot.c @@ -0,0 +1,618 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +#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 *dm_void, + struct txpwrtrack_cfg *config +) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; +#if RTL8195B_SUPPORT + if (dm->support_ic_type == ODM_RTL8195B) + configure_txpower_track_8195b(config); +#endif +#if RTL8710C_SUPPORT + if (dm->support_ic_type == ODM_RTL8710C) + configure_txpower_track_8710c(config); +#endif +#if RTL8721D_SUPPORT + if (dm->support_ic_type == ODM_RTL8721D) + configure_txpower_track_8721d(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 *dm_void +) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &dm->rf_table; + u8 p = 0; + struct dm_rf_calibration_struct *cali_info = &dm->rf_calibrate_info; + + cali_info->bb_swing_idx_cck_base = cali_info->default_cck_index; + cali_info->bb_swing_idx_cck = cali_info->default_cck_index; + dm->rf_calibrate_info.CCK_index = 0; + + for (p = RF_PATH_A; p < MAX_RF_PATH; ++p) { + cali_info->bb_swing_idx_ofdm_base[p] = cali_info->default_ofdm_index; + cali_info->bb_swing_idx_ofdm[p] = cali_info->default_ofdm_index; + cali_info->OFDM_index[p] = cali_info->default_ofdm_index; + + cali_info->power_index_offset[p] = 0; + cali_info->delta_power_index[p] = 0; + cali_info->delta_power_index_last[p] = 0; + + cali_info->absolute_ofdm_swing_idx[p] = 0; + cali_info->remnant_ofdm_swing_idx[p] = 0; + cali_info->kfree_offset[p] = 0; + } + + cali_info->modify_tx_agc_flag_path_a = false; + cali_info->modify_tx_agc_flag_path_b = false; + cali_info->modify_tx_agc_flag_path_c = false; + cali_info->modify_tx_agc_flag_path_d = false; + cali_info->remnant_cck_swing_idx = 0; + cali_info->thermal_value = rf->eeprom_thermal; + cali_info->modify_tx_agc_value_cck = 0; + cali_info->modify_tx_agc_value_ofdm = 0; +} + +void +odm_txpowertracking_callback_thermal_meter( + void *dm_void +) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &dm->rf_table; + struct dm_rf_calibration_struct *cali_info = &dm->rf_calibrate_info; + struct dm_iqk_info *iqk_info = &dm->IQK_info; + + u8 thermal_value = 0, delta, delta_LCK, delta_IQK, p = 0, i = 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(hal_data->current_channel) */ + u8 power_tracking_type = rf->pwt_type; + 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; +#if (RTL8721D_SUPPORT == 1) + u8 *delta_swing_table_idx_tup_a_cck = NULL; + u8 *delta_swing_table_idx_tdown_a_cck = NULL; + u8 *delta_swing_table_idx_tup_b_cck = NULL; + u8 *delta_swing_table_idx_tdown_b_cck = NULL; +#endif + /*for Xtal Offset by James.Tung*/ + s8 *delta_swing_table_xtal_up = NULL; + s8 *delta_swing_table_xtal_down = NULL; + + /* 4 2. Initialization ( 7 steps in total ) */ + + configure_txpower_track(dm, &c); +#if (RTL8721D_SUPPORT == 1) + (*c.get_delta_swing_table)(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_a_cck, (u8 **)&delta_swing_table_idx_tdown_a_cck, + (u8 **)&delta_swing_table_idx_tup_b_cck, (u8 **)&delta_swing_table_idx_tdown_b_cck); +#else + (*c.get_delta_swing_table)(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); +#endif + + /*for Xtal Offset*/ + if (dm->support_ic_type == ODM_RTL8195B || + dm->support_ic_type == ODM_RTL8721D) + (*c.get_delta_swing_xtal_table)(dm, + (s8 **)&delta_swing_table_xtal_up, + (s8 **)&delta_swing_table_xtal_down); + + cali_info->txpowertracking_callback_cnt++; /*cosa add for debug*/ + cali_info->is_txpowertracking_init = true; + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "===>odm_txpowertracking_callback_thermal_meter\n cali_info->bb_swing_idx_cck_base: %d, cali_info->bb_swing_idx_ofdm_base[A]: %d, cali_info->default_ofdm_index: %d\n", + cali_info->bb_swing_idx_cck_base, + cali_info->bb_swing_idx_ofdm_base[RF_PATH_A], + cali_info->default_ofdm_index); + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "cali_info->txpowertrack_control = %d, hal_data->eeprom_thermal_meter %d\n", + cali_info->txpowertrack_control, rf->eeprom_thermal); + + if (dm->support_ic_type == ODM_RTL8721D) + thermal_value = (u8)odm_get_rf_reg(dm, RF_PATH_A, + c.thermal_reg_addr, 0x7e0); + /* 0x42: RF Reg[10:5] 8721D */ + else + thermal_value = (u8)odm_get_rf_reg(dm, RF_PATH_A, + c.thermal_reg_addr, 0xfc00); + /* 0x42: RF Reg[15:10] 88E */ + + thermal_value_temp = thermal_value + phydm_get_thermal_offset(dm); + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "thermal_value_temp(%d) = thermal_value(%d) + power_trim_thermal(%d)\n", thermal_value_temp, thermal_value, phydm_get_thermal_offset(dm)); + + if (thermal_value_temp > 63) + thermal_value = 63; + else if (thermal_value_temp < 0) + thermal_value = 0; + else + thermal_value = thermal_value_temp; + + if (!cali_info->txpowertrack_control) + return; + + if (rf->eeprom_thermal == 0xff) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "no pg, hal_data->eeprom_thermal_meter = 0x%x\n", rf->eeprom_thermal); + return; + } +#if 0 + /*4 3. Initialize ThermalValues of rf_calibrate_info*/ + //if (cali_info->is_reloadtxpowerindex) + // RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "reload ofdm index for band switch\n"); +#endif + /*4 4. Calculate average thermal meter*/ + + cali_info->thermal_value_avg[cali_info->thermal_value_avg_index] = thermal_value; + cali_info->thermal_value_avg_index++; + if (cali_info->thermal_value_avg_index == c.average_thermal_num) /*Average times = c.average_thermal_num*/ + cali_info->thermal_value_avg_index = 0; + + for (i = 0; i < c.average_thermal_num; i++) { + if (cali_info->thermal_value_avg[i]) { + thermal_value_avg += cali_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); + cali_info->thermal_value_delta = thermal_value - rf->eeprom_thermal; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "AVG Thermal Meter = 0x%X, EFUSE Thermal base = 0x%X\n", thermal_value, rf->eeprom_thermal); + } + + /* 4 5. Calculate delta, delta_LCK, delta_IQK. */ + /* "delta" here is used to determine whether thermal value changes or not. */ + delta = (thermal_value > cali_info->thermal_value) ? (thermal_value - cali_info->thermal_value) : (cali_info->thermal_value - thermal_value); + delta_LCK = (thermal_value > cali_info->thermal_value_lck) ? (thermal_value - cali_info->thermal_value_lck) : (cali_info->thermal_value_lck - thermal_value); + delta_IQK = (thermal_value > cali_info->thermal_value_iqk) ? (thermal_value - cali_info->thermal_value_iqk) : (cali_info->thermal_value_iqk - thermal_value); + + /*4 6. If necessary, do LCK.*/ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "(delta, delta_LCK, delta_IQK) = (%d, %d, %d)\n", delta, delta_LCK, delta_IQK); + + /* Wait sacn to do LCK by RF Jenyu*/ + if ((!*dm->is_scan_in_process) && !iqk_info->rfk_forbidden && + (!*dm->is_tdma)) { + /* Delta temperature is equal to or larger than 20 centigrade.*/ + if (delta_LCK >= c.threshold_iqk) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta_LCK(%d) >= threshold_iqk(%d)\n", delta_LCK, c.threshold_iqk); + cali_info->thermal_value_lck = thermal_value; + + /*Use RTLCK, so close power tracking driver LCK*/ + (*c.phy_lc_calibrate)(dm); + } + } + + /*3 7. If necessary, move the index of swing table to adjust Tx power.*/ + if (delta > 0 && cali_info->txpowertrack_control) { + /* "delta" here is used to record the absolute value of difference. */ + delta = thermal_value > rf->eeprom_thermal ? (thermal_value - rf->eeprom_thermal) : (rf->eeprom_thermal - thermal_value); + + if (delta >= TXPWR_TRACK_TABLE_SIZE) + delta = TXPWR_TRACK_TABLE_SIZE - 1; + + /*4 7.1 The Final Power index = BaseIndex + power_index_offset*/ + if (thermal_value > rf->eeprom_thermal) { + for (p = RF_PATH_A; p < c.rf_path_count; p++) { + cali_info->delta_power_index_last[p] = cali_info->delta_power_index[p]; /*recording poer index offset*/ + switch (p) { + case RF_PATH_B: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "delta_swing_table_idx_tup_b[%d] = %d\n", delta, delta_swing_table_idx_tup_b[delta]); +#if (RTL8721D_SUPPORT == 1) + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "delta_swing_table_idx_tup_b_cck[%d] = %d\n", delta, delta_swing_table_idx_tup_b_cck[delta]); + + cali_info->absolute_cck_swing_idx[p] = delta_swing_table_idx_tup_b_cck[delta]; + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "******Temp is higher and cali_info->absolute_cck_swing_idx[RF_PATH_B] = %d\n", + cali_info->absolute_cck_swing_idx[p]); +#endif + cali_info->delta_power_index[p] = + delta_swing_table_idx_tup_b + [delta]; + cali_info->absolute_ofdm_swing_idx[p] = + delta_swing_table_idx_tup_b + [delta]; + /*Record delta swing for mix mode*/ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "******Temp is higher and cali_info->absolute_ofdm_swing_idx[RF_PATH_B] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); + break; + + default: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "delta_swing_table_idx_tup_a[%d] = %d\n", delta, delta_swing_table_idx_tup_a[delta]); +#if (RTL8721D_SUPPORT == 1) + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "delta_swing_table_idx_tup_a_cck[%d] = %d\n", delta, delta_swing_table_idx_tup_a_cck[delta]); + + cali_info->absolute_cck_swing_idx[p] = delta_swing_table_idx_tup_a_cck[delta]; + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "******Temp is higher and cali_info->absolute_cck_swing_idx[RF_PATH_A] = %d\n", cali_info->absolute_cck_swing_idx[p]); +#endif + cali_info->delta_power_index[p] = delta_swing_table_idx_tup_a[delta]; + cali_info->absolute_ofdm_swing_idx[p] = + delta_swing_table_idx_tup_a[delta]; + /*Record delta swing*/ + /*for mix mode power tracking*/ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "******Temp is higher and cali_info->absolute_ofdm_swing_idx[RF_PATH_A] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); + break; + } + } + /* JJ ADD 20161014 */ + if (dm->support_ic_type == ODM_RTL8195B || + dm->support_ic_type == ODM_RTL8721D) { + /*Save xtal_offset from Xtal table*/ + cali_info->xtal_offset_last = cali_info->xtal_offset; /*recording last Xtal offset*/ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "[Xtal] delta_swing_table_xtal_up[%d] = %d\n", delta, delta_swing_table_xtal_up[delta]); + cali_info->xtal_offset = delta_swing_table_xtal_up[delta]; + xtal_offset_eanble = (cali_info->xtal_offset_last != cali_info->xtal_offset); + } + + } else { + for (p = RF_PATH_A; p < c.rf_path_count; p++) { + cali_info->delta_power_index_last[p] = cali_info->delta_power_index[p]; /*recording poer index offset*/ + + switch (p) { + case RF_PATH_B: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "delta_swing_table_idx_tdown_b[%d] = %d\n", delta, delta_swing_table_idx_tdown_b[delta]); +#if (RTL8721D_SUPPORT == 1) + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "delta_swing_table_idx_tdown_b_cck[%d] = %d\n", delta, delta_swing_table_idx_tdown_b_cck[delta]); + + cali_info->absolute_cck_swing_idx[p] = -1 * delta_swing_table_idx_tdown_b_cck[delta]; + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "******Temp is lower and cali_info->absolute_cck_swing_idx[RF_PATH_B] = %d\n", cali_info->absolute_cck_swing_idx[p]); +#endif + cali_info->delta_power_index[p] = -1 * delta_swing_table_idx_tdown_b[delta]; + cali_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_b[delta]; /*Record delta swing for mix mode power tracking*/ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "******Temp is lower and cali_info->absolute_ofdm_swing_idx[RF_PATH_B] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); + break; + + default: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "delta_swing_table_idx_tdown_a[%d] = %d\n", delta, delta_swing_table_idx_tdown_a[delta]); +#if (RTL8721D_SUPPORT == 1) + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "delta_swing_table_idx_tdown_a_cck[%d] = %d\n", delta, delta_swing_table_idx_tdown_a_cck[delta]); + + cali_info->absolute_cck_swing_idx[p] = -1 * delta_swing_table_idx_tdown_a_cck[delta]; + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "******Temp is lower and cali_info->absolute_cck_swing_idx[RF_PATH_A] = %d\n", cali_info->absolute_cck_swing_idx[p]); +#endif + cali_info->delta_power_index[p] = -1 * delta_swing_table_idx_tdown_a[delta]; + cali_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_a[delta]; /*Record delta swing for mix mode power tracking*/ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "******Temp is lower and cali_info->absolute_ofdm_swing_idx[RF_PATH_A] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); + break; + } + } + /* JJ ADD 20161014 */ + + if (dm->support_ic_type == ODM_RTL8195B || + dm->support_ic_type == ODM_RTL8721D) { + /*Save xtal_offset from Xtal table*/ + cali_info->xtal_offset_last = cali_info->xtal_offset; /*recording last Xtal offset*/ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "[Xtal] delta_swing_table_xtal_down[%d] = %d\n", delta, delta_swing_table_xtal_down[delta]); + cali_info->xtal_offset = delta_swing_table_xtal_down[delta]; + xtal_offset_eanble = (cali_info->xtal_offset_last != cali_info->xtal_offset); + } + } +#if 0 + for (p = RF_PATH_A; p < c.rf_path_count; p++) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "\n\n=========================== [path-%d] Calculating power_index_offset===========================\n", p); + + if (cali_info->delta_power_index[p] == cali_info->delta_power_index_last[p]) /*If Thermal value changes but lookup table value still the same*/ + cali_info->power_index_offset[p] = 0; + else + cali_info->power_index_offset[p] = cali_info->delta_power_index[p] - cali_info->delta_power_index_last[p]; /*Power index diff between 2 times Power Tracking*/ + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "[path-%d] power_index_offset(%d) = delta_power_index(%d) - delta_power_index_last(%d)\n", p, cali_info->power_index_offset[p], cali_info->delta_power_index[p], cali_info->delta_power_index_last[p]); + + cali_info->OFDM_index[p] = cali_info->bb_swing_idx_ofdm_base[p] + cali_info->power_index_offset[p]; + cali_info->CCK_index = cali_info->bb_swing_idx_cck_base + cali_info->power_index_offset[p]; + + cali_info->bb_swing_idx_cck = cali_info->CCK_index; + cali_info->bb_swing_idx_ofdm[p] = cali_info->OFDM_index[p]; + + /*************Print BB Swing base and index Offset*************/ + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "The 'CCK' final index(%d) = BaseIndex(%d) + power_index_offset(%d)\n", cali_info->bb_swing_idx_cck, cali_info->bb_swing_idx_cck_base, cali_info->power_index_offset[p]); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "The 'OFDM' final index(%d) = BaseIndex[%d](%d) + power_index_offset(%d)\n", cali_info->bb_swing_idx_ofdm[p], p, cali_info->bb_swing_idx_ofdm_base[p], cali_info->power_index_offset[p]); + + /*4 7.1 Handle boundary conditions of index.*/ + + if (cali_info->OFDM_index[p] > c.swing_table_size_ofdm - 1) + cali_info->OFDM_index[p] = c.swing_table_size_ofdm - 1; + else if (cali_info->OFDM_index[p] <= OFDM_min_index) + cali_info->OFDM_index[p] = OFDM_min_index; + } + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "\n\n========================================================================================================\n"); + + if (cali_info->CCK_index > c.swing_table_size_cck - 1) + cali_info->CCK_index = c.swing_table_size_cck - 1; + else if (cali_info->CCK_index <= 0) + cali_info->CCK_index = 0; +#endif + } else { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "The thermal meter is unchanged or TxPowerTracking OFF(%d): thermal_value: %d, cali_info->thermal_value: %d\n", + cali_info->txpowertrack_control, thermal_value, cali_info->thermal_value); + + for (p = RF_PATH_A; p < c.rf_path_count; p++) + cali_info->power_index_offset[p] = 0; + } +#if 0 + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "TxPowerTracking: [CCK] Swing Current index: %d, Swing base index: %d\n", + cali_info->CCK_index, cali_info->bb_swing_idx_cck_base); /*Print Swing base & current*/ + + for (p = RF_PATH_A; p < c.rf_path_count; p++) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "TxPowerTracking: [OFDM] Swing Current index: %d, Swing base index[%d]: %d\n", + cali_info->OFDM_index[p], p, cali_info->bb_swing_idx_ofdm_base[p]); + } +#endif + if (thermal_value > rf->eeprom_thermal) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "Temperature(%d) higher than PG value(%d)\n", thermal_value, rf->eeprom_thermal); + + if (dm->support_ic_type == ODM_RTL8188E || + dm->support_ic_type == ODM_RTL8192E || + dm->support_ic_type == ODM_RTL8821 || + dm->support_ic_type == ODM_RTL8812 || + dm->support_ic_type == ODM_RTL8723B || + dm->support_ic_type == ODM_RTL8814A || + dm->support_ic_type == ODM_RTL8703B || + dm->support_ic_type == ODM_RTL8188F || + dm->support_ic_type == ODM_RTL8822B || + dm->support_ic_type == ODM_RTL8723D || + dm->support_ic_type == ODM_RTL8821C || + dm->support_ic_type == ODM_RTL8710B || + dm->support_ic_type == ODM_RTL8192F || + dm->support_ic_type == ODM_RTL8195B || + dm->support_ic_type == ODM_RTL8721D){ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking MIX_MODE**********\n"); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0); + } else { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking BBSWING_MODE**********\n"); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(dm, BBSWING, p, indexforchannel); + } + } else { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "Temperature(%d) lower than PG value(%d)\n", thermal_value, rf->eeprom_thermal); + + if (dm->support_ic_type == ODM_RTL8188E || + dm->support_ic_type == ODM_RTL8192E || + dm->support_ic_type == ODM_RTL8821 || + dm->support_ic_type == ODM_RTL8812 || + dm->support_ic_type == ODM_RTL8723B || + dm->support_ic_type == ODM_RTL8814A || + dm->support_ic_type == ODM_RTL8703B || + dm->support_ic_type == ODM_RTL8188F || + dm->support_ic_type == ODM_RTL8822B || + dm->support_ic_type == ODM_RTL8723D || + dm->support_ic_type == ODM_RTL8821C || + dm->support_ic_type == ODM_RTL8710B || + dm->support_ic_type == ODM_RTL8192F || + dm->support_ic_type == ODM_RTL8195B || + dm->support_ic_type == ODM_RTL8721D) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking MIX_MODE**********\n"); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, indexforchannel); + } else { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking BBSWING_MODE**********\n"); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(dm, BBSWING, p, indexforchannel); + } + + cali_info->bb_swing_idx_cck_base = cali_info->bb_swing_idx_cck; /*Record last time Power Tracking result as base.*/ + for (p = RF_PATH_A; p < c.rf_path_count; p++) + cali_info->bb_swing_idx_ofdm_base[p] = cali_info->bb_swing_idx_ofdm[p]; + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "cali_info->thermal_value = %d thermal_value= %d\n", cali_info->thermal_value, thermal_value); + + cali_info->thermal_value = thermal_value; /*Record last Power Tracking Thermal value*/ + } + + /* JJ ADD 20161014 */ + if (dm->support_ic_type == ODM_RTL8195B || + dm->support_ic_type == ODM_RTL8721D) { + if (xtal_offset_eanble != 0 && cali_info->txpowertrack_control && (rf->eeprom_thermal != 0xff)) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter Xtal Tracking**********\n"); + + if (thermal_value > rf->eeprom_thermal) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "Temperature(%d) higher than PG value(%d)\n", thermal_value, rf->eeprom_thermal); + (*c.odm_txxtaltrack_set_xtal)(dm); + } else { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "Temperature(%d) lower than PG value(%d)\n", thermal_value, rf->eeprom_thermal); + (*c.odm_txxtaltrack_set_xtal)(dm); + } + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********End Xtal Tracking**********\n"); + } + } +#if (!RTL8721D_SUPPORT) + /* Wait sacn to do IQK by RF Jenyu*/ + if ((!*dm->is_scan_in_process) && (!iqk_info->rfk_forbidden)) { + /*Delta temperature is equal to or larger than 20 centigrade (When threshold is 8).*/ + if (delta_IQK >= c.threshold_iqk) { + cali_info->thermal_value_iqk = thermal_value; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta_IQK(%d) >= threshold_iqk(%d)\n", delta_IQK, c.threshold_iqk); + if (!cali_info->is_iqk_in_progress) + (*c.do_iqk)(dm, delta_IQK, thermal_value, 8); + } + } +#endif + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "<===odm_txpowertracking_callback_thermal_meter\n"); + + cali_info->tx_powercount = 0; +} + +/* 3============================================================ + * 3 IQ Calibration + * 3============================================================ + */ + +void +odm_reset_iqk_result( + void *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 dm_struct *dm +) +{ +#if (RTL8721D_SUPPORT == 1) + struct dm_iqk_info *iqk_info = &dm->IQK_info; + + if (dm->is_linked && !iqk_info->rfk_forbidden) { + if ((*dm->channel != dm->pre_channel) && + (!*dm->is_scan_in_process)) { + dm->pre_channel = *dm->channel; + dm->linked_interval = 0; + } + + if (dm->linked_interval < 3) + dm->linked_interval++; + + if (dm->linked_interval == 2) + halrf_iqk_trigger(dm, false); + } else { + dm->linked_interval = 0; + } +#endif +} + +void phydm_rf_init(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + odm_txpowertracking_init(dm); + + odm_clear_txpowertracking_state(dm); +} + +void phydm_rf_watchdog(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + odm_txpowertracking_check(dm); +#if (RTL8721D_SUPPORT == 1) + odm_iq_calibrate(dm); +#endif +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halphyrf_ce.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halphyrf_iot.h similarity index 56% rename from drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halphyrf_ce.h rename to drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halphyrf_iot.h index 71d104a4945d..ed573a00d3cd 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halphyrf_ce.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halphyrf_iot.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,33 +9,38 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ -#ifndef __HAL_PHY_RF_H__ -#define __HAL_PHY_RF_H__ +#ifndef __HALPHYRF_H__ +#define __HALPHYRF_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 +#include "halrf/halrf_kfree.h" #if (RTL8821C_SUPPORT == 1) - #include "rtl8821c/phydm_iqk_8821c.h" + #include "halrf/rtl8821c/halrf_iqk_8821c.h" #endif -#include "phydm_powertracking_ce.h" +#if (RTL8195B_SUPPORT == 1) +// #include "halrf/rtl8195b/halrf.h" + #include "halrf/rtl8195b/halrf_iqk_8195b.h" + #include "halrf/rtl8195b/halrf_txgapk_8195b.h" + #include "halrf/rtl8195b/halrf_dpk_8195b.h" +#endif + +#include "halrf/halrf_powertracking_iot.h" enum spur_cal_method { @@ -54,12 +60,17 @@ enum pwrtrack_method { 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 **); +#if (RTL8721D_SUPPORT == 1) + typedef void (*func_swing)(void *, u8 **, u8 **, u8 **, u8 **, + u8 **, u8 **, u8 **, u8 **); +#else + typedef void (*func_swing)(void *, u8 **, u8 **, u8 **, u8 **); +#endif 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 { +struct txpwrtrack_cfg { u8 swing_table_size_cck; u8 swing_table_size_ofdm; u8 threshold_iqk; @@ -78,22 +89,24 @@ struct _TXPWRTRACK_CFG { void configure_txpower_track( - void *p_dm_void, - struct _TXPWRTRACK_CFG *p_config + void *dm_void, + struct txpwrtrack_cfg *config ); void odm_clear_txpowertracking_state( - void *p_dm_void + void *dm_void ); void odm_txpowertracking_callback_thermal_meter( #if (DM_ODM_SUPPORT_TYPE & ODM_AP) - void *p_dm_void + void *dm_void +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + void *dm #else - struct _ADAPTER *adapter + void *adapter #endif ); @@ -104,14 +117,14 @@ odm_txpowertracking_callback_thermal_meter( void odm_reset_iqk_result( - void *p_dm_void + void *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); +void phydm_rf_init(void *dm_void); +void phydm_rf_watchdog(void *dm_void); -#endif /* #ifndef __HAL_PHY_RF_H__ */ +#endif /*#ifndef __HALPHYRF_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halphyrf_win.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halphyrf_win.c new file mode 100644 index 000000000000..9b5969f02211 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halphyrf_win.c @@ -0,0 +1,1060 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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 dm_struct *dm, + struct txpwrtrack_cfg *config +) +{ +#if RTL8192E_SUPPORT + if (dm->support_ic_type == ODM_RTL8192E) + configure_txpower_track_8192e(config); +#endif +#if RTL8821A_SUPPORT + if (dm->support_ic_type == ODM_RTL8821) + configure_txpower_track_8821a(config); +#endif +#if RTL8812A_SUPPORT + if (dm->support_ic_type == ODM_RTL8812) + configure_txpower_track_8812a(config); +#endif +#if RTL8188E_SUPPORT + if (dm->support_ic_type == ODM_RTL8188E) + configure_txpower_track_8188e(config); +#endif + +#if RTL8188F_SUPPORT + if (dm->support_ic_type == ODM_RTL8188F) + configure_txpower_track_8188f(config); +#endif + +#if RTL8723B_SUPPORT + if (dm->support_ic_type == ODM_RTL8723B) + configure_txpower_track_8723b(config); +#endif + +#if RTL8814A_SUPPORT + if (dm->support_ic_type == ODM_RTL8814A) + configure_txpower_track_8814a(config); +#endif + +#if RTL8703B_SUPPORT + if (dm->support_ic_type == ODM_RTL8703B) + configure_txpower_track_8703b(config); +#endif + +#if RTL8822B_SUPPORT + if (dm->support_ic_type == ODM_RTL8822B) + configure_txpower_track_8822b(config); +#endif + +#if RTL8723D_SUPPORT + if (dm->support_ic_type == ODM_RTL8723D) + configure_txpower_track_8723d(config); +#endif + +/* JJ ADD 20161014 */ +#if RTL8710B_SUPPORT + if (dm->support_ic_type == ODM_RTL8710B) + configure_txpower_track_8710b(config); +#endif + +#if RTL8821C_SUPPORT + if (dm->support_ic_type == ODM_RTL8821C) + configure_txpower_track_8821c(config); +#endif + +#if RTL8192F_SUPPORT + if (dm->support_ic_type == ODM_RTL8192F) + configure_txpower_track_8192f(config); +#endif + +#if RTL8822C_SUPPORT + if (dm->support_ic_type == ODM_RTL8822C) + configure_txpower_track_8822c(config); +#endif + +#if RTL8814B_SUPPORT + if (dm->support_ic_type == ODM_RTL8814B) + configure_txpower_track_8814b(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 dm_struct *dm +) +{ + PHAL_DATA_TYPE hal_data = GET_HAL_DATA((PADAPTER)(dm->adapter)); + u8 p = 0; + struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); + + cali_info->bb_swing_idx_cck_base = cali_info->default_cck_index; + cali_info->bb_swing_idx_cck = cali_info->default_cck_index; + cali_info->CCK_index = 0; + + for (p = RF_PATH_A; p < MAX_RF_PATH; ++p) { + cali_info->bb_swing_idx_ofdm_base[p] = cali_info->default_ofdm_index; + cali_info->bb_swing_idx_ofdm[p] = cali_info->default_ofdm_index; + cali_info->OFDM_index[p] = cali_info->default_ofdm_index; + + cali_info->power_index_offset[p] = 0; + cali_info->delta_power_index[p] = 0; + cali_info->delta_power_index_last[p] = 0; + + cali_info->absolute_ofdm_swing_idx[p] = 0; /* Initial Mix mode power tracking*/ + cali_info->remnant_ofdm_swing_idx[p] = 0; + cali_info->kfree_offset[p] = 0; + } + + cali_info->modify_tx_agc_flag_path_a = false; /*Initial at Modify Tx Scaling mode*/ + cali_info->modify_tx_agc_flag_path_b = false; /*Initial at Modify Tx Scaling mode*/ + cali_info->modify_tx_agc_flag_path_c = false; /*Initial at Modify Tx Scaling mode*/ + cali_info->modify_tx_agc_flag_path_d = false; /*Initial at Modify Tx Scaling mode*/ + cali_info->remnant_cck_swing_idx = 0; + cali_info->thermal_value = hal_data->eeprom_thermal_meter; + + cali_info->modify_tx_agc_value_cck = 0; /* modify by Mingzhi.Guo */ + cali_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 dm_struct *dm +#else + void *adapter +#endif +) +{ +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct dm_struct *dm = &hal_data->DM_OutSrc; +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + struct dm_struct *dm = &hal_data->odmpriv; +#endif +#endif + + struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); + struct dm_iqk_info *iqk_info = &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, regc88, rege14, reg848,reg838, reg86c; + + 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(hal_data->current_channel) */ + u8 power_tracking_type = 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(dm, &c); + + (*c.get_delta_swing_table)(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 (dm->support_ic_type & (ODM_RTL8814A | ODM_RTL8814B)) /*for 8814 path C & D*/ + (*c.get_delta_swing_table8814only)(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 (dm->support_ic_type & (ODM_RTL8703B | ODM_RTL8723D | ODM_RTL8710B | ODM_RTL8192F)) /*for Xtal Offset*/ + (*c.get_delta_swing_xtal_table)(dm, (s8 **)&delta_swing_table_xtal_up, (s8 **)&delta_swing_table_xtal_down); + + + cali_info->txpowertracking_callback_cnt++; /*cosa add for debug*/ + cali_info->is_txpowertracking_init = true; + + /*cali_info->txpowertrack_control = 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) + cali_info->rega24 = 0x090e1317; +#endif +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + if (*(dm->mp_mode) == true) + cali_info->rega24 = 0x090e1317; +#endif + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "===>odm_txpowertracking_callback_thermal_meter\n cali_info->bb_swing_idx_cck_base: %d, cali_info->bb_swing_idx_ofdm_base[A]: %d, cali_info->default_ofdm_index: %d\n", + cali_info->bb_swing_idx_cck_base, cali_info->bb_swing_idx_ofdm_base[RF_PATH_A], cali_info->default_ofdm_index); + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "cali_info->txpowertrack_control=%d, hal_data->eeprom_thermal_meter %d\n", cali_info->txpowertrack_control, hal_data->eeprom_thermal_meter); + thermal_value = (u8)odm_get_rf_reg(dm, RF_PATH_A, c.thermal_reg_addr, 0xfc00); /* 0x42: RF Reg[15:10] 88E */ + + thermal_value_temp = thermal_value + phydm_get_thermal_offset(dm); + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "thermal_value_temp(%d) = thermal_value(%d) + power_time_thermal(%d)\n", thermal_value_temp, thermal_value, phydm_get_thermal_offset(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 (dm->support_ic_type == ODM_RTL8723D) { + regc80 = odm_get_bb_reg(dm, R_0xc80, MASKDWORD); + regcd0 = odm_get_bb_reg(dm, R_0xcd0, MASKDWORD); + regcd4 = odm_get_bb_reg(dm, R_0xcd4, MASKDWORD); + regab4 = odm_get_bb_reg(dm, R_0xab4, 0x000007FF); + RF_DBG(dm, DBG_RF_IQK, "0xc80 = 0x%x 0xcd0 = 0x%x 0xcd4 = 0x%x 0xab4 = 0x%x\n", regc80, regcd0, regcd4, regab4); + } + + /* JJ ADD 20161014 */ + if (dm->support_ic_type == ODM_RTL8710B) { + regc80 = odm_get_bb_reg(dm, R_0xc80, MASKDWORD); + regcd0 = odm_get_bb_reg(dm, R_0xcd0, MASKDWORD); + regcd4 = odm_get_bb_reg(dm, R_0xcd4, MASKDWORD); + regab4 = odm_get_bb_reg(dm, R_0xab4, 0x000007FF); + RF_DBG(dm, DBG_RF_IQK, "0xc80 = 0x%x 0xcd0 = 0x%x 0xcd4 = 0x%x 0xab4 = 0x%x\n", regc80, regcd0, regcd4, regab4); + } + /* Winnita add 20171205 */ + if (dm->support_ic_type == ODM_RTL8192F) { + regc80 = odm_get_bb_reg(dm, R_0xc80, MASKDWORD); + regc88 = odm_get_bb_reg(dm, R_0xc88, MASKDWORD); + regab4 = odm_get_bb_reg(dm, R_0xab4, MASKDWORD); + rege14 = odm_get_bb_reg(dm, R_0xe14, MASKDWORD); + reg848 = odm_get_bb_reg(dm, R_0x848, MASKDWORD); + reg838 = odm_get_bb_reg(dm, R_0x838, MASKDWORD); + reg86c = odm_get_bb_reg(dm, R_0x86c, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xc80 = 0x%x 0xc88 = 0x%x 0xab4 = 0x%x 0xe14 = 0x%x\n", regc80, regc88, regab4, rege14); + RF_DBG(dm, DBG_RF_IQK, "0x848 = 0x%x 0x838 = 0x%x 0x86c = 0x%x\n", reg848, reg838, reg86c); + } + + if (!cali_info->txpowertrack_control) + return; + + if (hal_data->eeprom_thermal_meter == 0xff) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "no pg, hal_data->eeprom_thermal_meter = 0x%x\n", hal_data->eeprom_thermal_meter); + return; + } + + /*4 3. Initialize ThermalValues of rf_calibrate_info*/ + + if (cali_info->is_reloadtxpowerindex) + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "reload ofdm index for band switch\n"); + + /*4 4. Calculate average thermal meter*/ + + cali_info->thermal_value_avg[cali_info->thermal_value_avg_index] = thermal_value; + cali_info->thermal_value_avg_index++; + if (cali_info->thermal_value_avg_index == c.average_thermal_num) /*Average times = c.average_thermal_num*/ + cali_info->thermal_value_avg_index = 0; + + for (i = 0; i < c.average_thermal_num; i++) { + if (cali_info->thermal_value_avg[i]) { + thermal_value_avg += cali_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); + cali_info->thermal_value_delta = thermal_value - hal_data->eeprom_thermal_meter; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "AVG Thermal Meter = 0x%X, EFUSE Thermal base = 0x%X\n", thermal_value, 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 > cali_info->thermal_value) ? (thermal_value - cali_info->thermal_value) : (cali_info->thermal_value - thermal_value); + delta_LCK = (thermal_value > cali_info->thermal_value_lck) ? (thermal_value - cali_info->thermal_value_lck) : (cali_info->thermal_value_lck - thermal_value); + delta_IQK = (thermal_value > cali_info->thermal_value_iqk) ? (thermal_value - cali_info->thermal_value_iqk) : (cali_info->thermal_value_iqk - thermal_value); + + if (cali_info->thermal_value_iqk == 0xff) { /*no PG, use thermal value for IQK*/ + cali_info->thermal_value_iqk = thermal_value; + delta_IQK = (thermal_value > cali_info->thermal_value_iqk) ? (thermal_value - cali_info->thermal_value_iqk) : (cali_info->thermal_value_iqk - thermal_value); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "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)cali_info->dpk_thermal[p]; + + /*4 6. If necessary, do LCK.*/ + + if (!(dm->support_ic_type & ODM_RTL8821)) { /*no PG, do LCK at initial status*/ + if (cali_info->thermal_value_lck == 0xff) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "no PG, do LCK\n"); + cali_info->thermal_value_lck = thermal_value; + + /*Use RTLCK, so close power tracking driver LCK*/ + if ((!(dm->support_ic_type & ODM_RTL8814A)) && (!(dm->support_ic_type & ODM_RTL8822B))) { + if (c.phy_lc_calibrate) + (*c.phy_lc_calibrate)(dm); + } + + delta_LCK = (thermal_value > cali_info->thermal_value_lck) ? (thermal_value - cali_info->thermal_value_lck) : (cali_info->thermal_value_lck - thermal_value); + } + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "(delta, delta_LCK, delta_IQK) = (%d, %d, %d)\n", delta, delta_LCK, delta_IQK); + + /* Wait sacn to do LCK by RF Jenyu*/ + if( (*dm->is_scan_in_process == false) && (!iqk_info->rfk_forbidden)) { + /* Delta temperature is equal to or larger than 20 centigrade.*/ + if (delta_LCK >= c.threshold_iqk) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta_LCK(%d) >= threshold_iqk(%d)\n", delta_LCK, c.threshold_iqk); + cali_info->thermal_value_lck = thermal_value; + + /*Use RTLCK, so close power tracking driver LCK*/ + if ((!(dm->support_ic_type & ODM_RTL8814A)) && (!(dm->support_ic_type & ODM_RTL8822B))) { + if (c.phy_lc_calibrate) + (*c.phy_lc_calibrate)(dm); + } + } + } + } + + /*3 7. If necessary, move the index of swing table to adjust Tx power.*/ + + if (delta > 0 && cali_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 > hal_data->eeprom_thermal_meter ? (thermal_value - hal_data->eeprom_thermal_meter) : (hal_data->eeprom_thermal_meter - thermal_value); +#else + delta = (thermal_value > dm->priv->pmib->dot11RFEntry.ther) ? (thermal_value - dm->priv->pmib->dot11RFEntry.ther) : (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 > hal_data->eeprom_thermal_meter) { +#else + if (thermal_value > dm->priv->pmib->dot11RFEntry.ther) { +#endif + + for (p = RF_PATH_A; p < c.rf_path_count; p++) { + cali_info->delta_power_index_last[p] = cali_info->delta_power_index[p]; /*recording poer index offset*/ + switch (p) { + case RF_PATH_B: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "delta_swing_table_idx_tup_b[%d] = %d\n", delta, delta_swing_table_idx_tup_b[delta]); + + cali_info->delta_power_index[p] = delta_swing_table_idx_tup_b[delta]; + cali_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_b[delta]; /*Record delta swing for mix mode power tracking*/ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "******Temp is higher and cali_info->absolute_ofdm_swing_idx[RF_PATH_B] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); + break; + + case RF_PATH_C: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "delta_swing_table_idx_tup_c[%d] = %d\n", delta, delta_swing_table_idx_tup_c[delta]); + + cali_info->delta_power_index[p] = delta_swing_table_idx_tup_c[delta]; + cali_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_c[delta]; /*Record delta swing for mix mode power tracking*/ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "******Temp is higher and cali_info->absolute_ofdm_swing_idx[RF_PATH_C] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); + break; + + case RF_PATH_D: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "delta_swing_table_idx_tup_d[%d] = %d\n", delta, delta_swing_table_idx_tup_d[delta]); + + cali_info->delta_power_index[p] = delta_swing_table_idx_tup_d[delta]; + cali_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_d[delta]; /*Record delta swing for mix mode power tracking*/ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "******Temp is higher and cali_info->absolute_ofdm_swing_idx[RF_PATH_D] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); + break; + + default: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "delta_swing_table_idx_tup_a[%d] = %d\n", delta, delta_swing_table_idx_tup_a[delta]); + + cali_info->delta_power_index[p] = delta_swing_table_idx_tup_a[delta]; + cali_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_a[delta]; /*Record delta swing for mix mode power tracking*/ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "******Temp is higher and cali_info->absolute_ofdm_swing_idx[RF_PATH_A] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); + break; + } + } + /* JJ ADD 20161014 */ + if (dm->support_ic_type & (ODM_RTL8703B | ODM_RTL8723D | ODM_RTL8710B | ODM_RTL8192F)) { + /*Save xtal_offset from Xtal table*/ + cali_info->xtal_offset_last = cali_info->xtal_offset; /*recording last Xtal offset*/ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "[Xtal] delta_swing_table_xtal_up[%d] = %d\n", delta, delta_swing_table_xtal_up[delta]); + cali_info->xtal_offset = delta_swing_table_xtal_up[delta]; + + if (cali_info->xtal_offset_last == cali_info->xtal_offset) + xtal_offset_eanble = 0; + else + xtal_offset_eanble = 1; + } + + } else { + for (p = RF_PATH_A; p < c.rf_path_count; p++) { + cali_info->delta_power_index_last[p] = cali_info->delta_power_index[p]; /*recording poer index offset*/ + + switch (p) { + case RF_PATH_B: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "delta_swing_table_idx_tdown_b[%d] = %d\n", delta, delta_swing_table_idx_tdown_b[delta]); + cali_info->delta_power_index[p] = -1 * delta_swing_table_idx_tdown_b[delta]; + cali_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_b[delta]; /*Record delta swing for mix mode power tracking*/ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "******Temp is lower and cali_info->absolute_ofdm_swing_idx[RF_PATH_B] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); + break; + + case RF_PATH_C: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "delta_swing_table_idx_tdown_c[%d] = %d\n", delta, delta_swing_table_idx_tdown_c[delta]); + cali_info->delta_power_index[p] = -1 * delta_swing_table_idx_tdown_c[delta]; + cali_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_c[delta]; /*Record delta swing for mix mode power tracking*/ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "******Temp is lower and cali_info->absolute_ofdm_swing_idx[RF_PATH_C] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); + break; + + case RF_PATH_D: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "delta_swing_table_idx_tdown_d[%d] = %d\n", delta, delta_swing_table_idx_tdown_d[delta]); + cali_info->delta_power_index[p] = -1 * delta_swing_table_idx_tdown_d[delta]; + cali_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_d[delta]; /*Record delta swing for mix mode power tracking*/ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "******Temp is lower and cali_info->absolute_ofdm_swing_idx[RF_PATH_D] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); + break; + + default: + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "delta_swing_table_idx_tdown_a[%d] = %d\n", delta, delta_swing_table_idx_tdown_a[delta]); + cali_info->delta_power_index[p] = -1 * delta_swing_table_idx_tdown_a[delta]; + cali_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_a[delta]; /*Record delta swing for mix mode power tracking*/ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "******Temp is lower and cali_info->absolute_ofdm_swing_idx[RF_PATH_A] = %d\n", cali_info->absolute_ofdm_swing_idx[p]); + break; + } + } + /* JJ ADD 20161014 */ + if (dm->support_ic_type & (ODM_RTL8703B | ODM_RTL8723D | ODM_RTL8710B | ODM_RTL8192F)) { + /*Save xtal_offset from Xtal table*/ + cali_info->xtal_offset_last = cali_info->xtal_offset; /*recording last Xtal offset*/ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "[Xtal] delta_swing_table_xtal_down[%d] = %d\n", delta, delta_swing_table_xtal_down[delta]); + cali_info->xtal_offset = delta_swing_table_xtal_down[delta]; + + if (cali_info->xtal_offset_last == cali_info->xtal_offset) + xtal_offset_eanble = 0; + else + xtal_offset_eanble = 1; + } + + } + + for (p = RF_PATH_A; p < c.rf_path_count; p++) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "\n\n=========================== [path-%d] Calculating power_index_offset===========================\n", p); + + if (cali_info->delta_power_index[p] == cali_info->delta_power_index_last[p]) /*If Thermal value changes but lookup table value still the same*/ + cali_info->power_index_offset[p] = 0; + else + cali_info->power_index_offset[p] = cali_info->delta_power_index[p] - cali_info->delta_power_index_last[p]; /*Power index diff between 2 times Power Tracking*/ + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "[path-%d] power_index_offset(%d) = delta_power_index(%d) - delta_power_index_last(%d)\n", p, cali_info->power_index_offset[p], cali_info->delta_power_index[p], cali_info->delta_power_index_last[p]); + + cali_info->OFDM_index[p] = cali_info->bb_swing_idx_ofdm_base[p] + cali_info->power_index_offset[p]; + cali_info->CCK_index = cali_info->bb_swing_idx_cck_base + cali_info->power_index_offset[p]; + + cali_info->bb_swing_idx_cck = cali_info->CCK_index; + cali_info->bb_swing_idx_ofdm[p] = cali_info->OFDM_index[p]; + + /*************Print BB Swing base and index Offset*************/ + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "The 'CCK' final index(%d) = BaseIndex(%d) + power_index_offset(%d)\n", cali_info->bb_swing_idx_cck, cali_info->bb_swing_idx_cck_base, cali_info->power_index_offset[p]); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "The 'OFDM' final index(%d) = BaseIndex[%d](%d) + power_index_offset(%d)\n", cali_info->bb_swing_idx_ofdm[p], p, cali_info->bb_swing_idx_ofdm_base[p], cali_info->power_index_offset[p]); + + /*4 7.1 Handle boundary conditions of index.*/ + + if (cali_info->OFDM_index[p] > c.swing_table_size_ofdm - 1) + cali_info->OFDM_index[p] = c.swing_table_size_ofdm - 1; + else if (cali_info->OFDM_index[p] <= OFDM_min_index) + cali_info->OFDM_index[p] = OFDM_min_index; + } + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "\n\n========================================================================================================\n"); + + if (cali_info->CCK_index > c.swing_table_size_cck - 1) + cali_info->CCK_index = c.swing_table_size_cck - 1; + else if (cali_info->CCK_index <= 0) + cali_info->CCK_index = 0; + } else { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "The thermal meter is unchanged or TxPowerTracking OFF(%d): thermal_value: %d, cali_info->thermal_value: %d\n", + cali_info->txpowertrack_control, thermal_value, cali_info->thermal_value); + + for (p = RF_PATH_A; p < c.rf_path_count; p++) + cali_info->power_index_offset[p] = 0; + } + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "TxPowerTracking: [CCK] Swing Current index: %d, Swing base index: %d\n", + cali_info->CCK_index, cali_info->bb_swing_idx_cck_base); /*Print Swing base & current*/ + + for (p = RF_PATH_A; p < c.rf_path_count; p++) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "TxPowerTracking: [OFDM] Swing Current index: %d, Swing base index[%d]: %d\n", + cali_info->OFDM_index[p], p, cali_info->bb_swing_idx_ofdm_base[p]); + } + + if (dm->support_ic_type & ODM_RTL8814B) + power_tracking_type = TSSI_MODE; + + if (dm->support_ic_type & (ODM_RTL8814A | ODM_RTL8814B)) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "power_tracking_type=%d\n", power_tracking_type); + + if (power_tracking_type == 0) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking MIX_MODE**********\n"); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0); + } else if (power_tracking_type == 1) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********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)(dm, MIX_2G_TSSI_5G_MODE, p, 0); + } else if (power_tracking_type == 2) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********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)(dm, MIX_5G_TSSI_2G_MODE, p, 0); + } else if (power_tracking_type == 3) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking TSSI MODE**********\n"); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(dm, TSSI_MODE, p, 0); + } + cali_info->thermal_value = thermal_value; /*Record last Power Tracking Thermal value*/ + + } else if ((cali_info->power_index_offset[RF_PATH_A] != 0 || + cali_info->power_index_offset[RF_PATH_B] != 0 || + cali_info->power_index_offset[RF_PATH_C] != 0 || + cali_info->power_index_offset[RF_PATH_D] != 0) && + cali_info->txpowertrack_control && (hal_data->eeprom_thermal_meter != 0xff)) { + /* 4 7.2 Configure the Swing Table to adjust Tx Power. */ + + cali_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 > cali_info->thermal_value) { + for (p = RF_PATH_A; p < c.rf_path_count; p++) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "Temperature Increasing(%d): delta_pi: %d, delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", + p, cali_info->power_index_offset[p], delta, thermal_value, hal_data->eeprom_thermal_meter, cali_info->thermal_value); + } + } else if (thermal_value < cali_info->thermal_value) { /*Low temperature*/ + for (p = RF_PATH_A; p < c.rf_path_count; p++) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "Temperature Decreasing(%d): delta_pi: %d, delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", + p, cali_info->power_index_offset[p], delta, thermal_value, hal_data->eeprom_thermal_meter, cali_info->thermal_value); + } + } + +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) + if (thermal_value > hal_data->eeprom_thermal_meter) +#else + if (thermal_value > dm->priv->pmib->dot11RFEntry.ther) +#endif + { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "Temperature(%d) higher than PG value(%d)\n", thermal_value, hal_data->eeprom_thermal_meter); + + if (dm->support_ic_type == ODM_RTL8188E || dm->support_ic_type == ODM_RTL8192E || dm->support_ic_type == ODM_RTL8821 || + dm->support_ic_type == ODM_RTL8812 || dm->support_ic_type == ODM_RTL8723B || dm->support_ic_type == ODM_RTL8814A || + dm->support_ic_type == ODM_RTL8703B || dm->support_ic_type == ODM_RTL8188F || dm->support_ic_type == ODM_RTL8822B || + dm->support_ic_type == ODM_RTL8723D || dm->support_ic_type == ODM_RTL8821C || dm->support_ic_type == ODM_RTL8710B || + dm->support_ic_type == ODM_RTL8192F) { + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking MIX_MODE**********\n"); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0); + } else { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking BBSWING_MODE**********\n"); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(dm, BBSWING, p, indexforchannel); + } + } else { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "Temperature(%d) lower than PG value(%d)\n", thermal_value, hal_data->eeprom_thermal_meter); + + if (dm->support_ic_type == ODM_RTL8188E || dm->support_ic_type == ODM_RTL8192E || dm->support_ic_type == ODM_RTL8821 || + dm->support_ic_type == ODM_RTL8812 || dm->support_ic_type == ODM_RTL8723B || dm->support_ic_type == ODM_RTL8814A || + dm->support_ic_type == ODM_RTL8703B || dm->support_ic_type == ODM_RTL8188F || dm->support_ic_type == ODM_RTL8822B || + dm->support_ic_type == ODM_RTL8723D || dm->support_ic_type == ODM_RTL8821C || dm->support_ic_type == ODM_RTL8710B || + dm->support_ic_type == ODM_RTL8192F) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking MIX_MODE**********\n"); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, indexforchannel); + } else { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking BBSWING_MODE**********\n"); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(dm, BBSWING, p, indexforchannel); + } + + } + + cali_info->bb_swing_idx_cck_base = cali_info->bb_swing_idx_cck; /*Record last time Power Tracking result as base.*/ + for (p = RF_PATH_A; p < c.rf_path_count; p++) + cali_info->bb_swing_idx_ofdm_base[p] = cali_info->bb_swing_idx_ofdm[p]; + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "cali_info->thermal_value = %d thermal_value= %d\n", cali_info->thermal_value, thermal_value); + + cali_info->thermal_value = thermal_value; /*Record last Power Tracking Thermal value*/ + + } + + + if (dm->support_ic_type == ODM_RTL8703B || dm->support_ic_type == ODM_RTL8723D || + dm->support_ic_type == ODM_RTL8192F || dm->support_ic_type == ODM_RTL8710B) {/* JJ ADD 20161014 */ + + if (xtal_offset_eanble != 0 && cali_info->txpowertrack_control && (hal_data->eeprom_thermal_meter != 0xff)) { + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter Xtal Tracking**********\n"); + +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) + if (thermal_value > hal_data->eeprom_thermal_meter) { +#else + if (thermal_value > dm->priv->pmib->dot11RFEntry.ther) { +#endif + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "Temperature(%d) higher than PG value(%d)\n", thermal_value, hal_data->eeprom_thermal_meter); + (*c.odm_txxtaltrack_set_xtal)(dm); + } else { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "Temperature(%d) lower than PG value(%d)\n", thermal_value, hal_data->eeprom_thermal_meter); + (*c.odm_txxtaltrack_set_xtal)(dm); + } + } + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********End Xtal Tracking**********\n"); + } + +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) + + /* Wait sacn to do IQK by RF Jenyu*/ + if ((*dm->is_scan_in_process == false) && (!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) { + cali_info->thermal_value_iqk = thermal_value; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta_IQK(%d) >= threshold_iqk(%d)\n", delta_IQK, c.threshold_iqk); + if (!cali_info->is_iqk_in_progress) + (*c.do_iqk)(dm, delta_IQK, thermal_value, 8); + } + } + } + if (cali_info->dpk_thermal[RF_PATH_A] != 0) { + if (diff_DPK[RF_PATH_A] >= c.threshold_dpk) { + odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x1); + odm_set_bb_reg(dm, R_0xcc4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), (diff_DPK[RF_PATH_A] / c.threshold_dpk)); + odm_set_bb_reg(dm, R_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(dm, R_0x82c, BIT(31), 0x1); + odm_set_bb_reg(dm, R_0xcc4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), value); + odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x0); + } else { + odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x1); + odm_set_bb_reg(dm, R_0xcc4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), 0); + odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x0); + } + } + if (cali_info->dpk_thermal[RF_PATH_B] != 0) { + if (diff_DPK[RF_PATH_B] >= c.threshold_dpk) { + odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x1); + odm_set_bb_reg(dm, R_0xec4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), (diff_DPK[RF_PATH_B] / c.threshold_dpk)); + odm_set_bb_reg(dm, R_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(dm, R_0x82c, BIT(31), 0x1); + odm_set_bb_reg(dm, R_0xec4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), value); + odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x0); + } else { + odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x1); + odm_set_bb_reg(dm, R_0xec4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), 0); + odm_set_bb_reg(dm, R_0x82c, BIT(31), 0x0); + } + } + +#endif + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "<===odm_txpowertracking_callback_thermal_meter\n"); + + cali_info->tx_powercount = 0; +} + +#if (RTL8822C_SUPPORT == 1) +void +odm_txpowertracking_new_callback_thermal_meter(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); + struct dm_iqk_info *iqk_info = &dm->IQK_info; + struct _hal_rf_ *rf = &dm->rf_table; + struct _halrf_tssi_data *tssi = &rf->halrf_tssi_data; + u8 thermal_value[MAX_RF_PATH] = {0}, delta[MAX_RF_PATH] = {0}; + u8 delta_swing_table_idx_tup[DELTA_SWINGIDX_SIZE] = {0}; + u8 delta_swing_table_idx_tdown[DELTA_SWINGIDX_SIZE] = {0}; + u8 delta_LCK = 0, delta_IQK = 0, i = 0, j = 0, p; + u8 thermal_value_avg_count[MAX_RF_PATH] = {0}; + u32 thermal_value_avg[MAX_RF_PATH] = {0}; + s8 thermal_value_temp[MAX_RF_PATH] = {0}; + + struct txpwrtrack_cfg c; + + 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; + 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; + + configure_txpower_track(dm, &c); + + (*c.get_delta_swing_table)(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); + + cali_info->txpowertracking_callback_cnt++; + cali_info->is_txpowertracking_init = true; + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "===>odm_txpowertracking_callback_thermal_meter\n cali_info->bb_swing_idx_cck_base: %d, cali_info->bb_swing_idx_ofdm_base[A]: %d, cali_info->default_ofdm_index: %d\n", + cali_info->bb_swing_idx_cck_base, cali_info->bb_swing_idx_ofdm_base[RF_PATH_A], cali_info->default_ofdm_index); + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "cali_info->txpowertrack_control=%d, tssi->thermal[RF_PATH_A]=%d tssi->thermal[RF_PATH_B]=%d\n", + cali_info->txpowertrack_control, tssi->thermal[RF_PATH_A], tssi->thermal[RF_PATH_B]); + + thermal_value[RF_PATH_A] = (u8)odm_get_rf_reg(dm, RF_PATH_A, c.thermal_reg_addr, 0xfc00); /* 0x42: RF Reg[15:10] 88E */ + thermal_value[RF_PATH_B] = (u8)odm_get_rf_reg(dm, RF_PATH_B, c.thermal_reg_addr, 0xfc00); + + for (i = 0; i < c.rf_path_count; i++) { + thermal_value_temp[i] = (s8)thermal_value[i] + phydm_get_thermal_offset(dm); + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "thermal_value_temp[%d](%d) = thermal_value[%d](%d) + power_time_thermal(%d)\n", i, thermal_value_temp[i], i, thermal_value[i], phydm_get_thermal_offset(dm)); + + if (thermal_value_temp[i] > 63) + thermal_value[i] = 63; + else if (thermal_value_temp[i] < 0) + thermal_value[i] = 0; + else + thermal_value[i] = thermal_value_temp[i]; + } + + if (tssi->thermal[RF_PATH_A] == 0xff || tssi->thermal[RF_PATH_B] == 0xff) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "no pg, tssi->thermal[A] = 0x%x tssi->thermal[B] = 0x%x\n", + tssi->thermal[RF_PATH_A], tssi->thermal[RF_PATH_B]); + return; + } + + for (j = 0; j < c.rf_path_count; j++) { + cali_info->thermal_value_avg_path[j][cali_info->thermal_value_avg_index_path[j]] = thermal_value[j]; + cali_info->thermal_value_avg_index_path[j]++; + if (cali_info->thermal_value_avg_index_path[j] == c.average_thermal_num) /*Average times = c.average_thermal_num*/ + cali_info->thermal_value_avg_index_path[j] = 0; + + + for (i = 0; i < c.average_thermal_num; i++) { + if (cali_info->thermal_value_avg_path[j][i]) { + thermal_value_avg[j] += cali_info->thermal_value_avg_path[j][i]; + thermal_value_avg_count[j]++; + } + } + + if (thermal_value_avg_count[j]) { /* Calculate Average thermal_value after average enough times */ + thermal_value[j] = (u8)(thermal_value_avg[j] / thermal_value_avg_count[j]); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "AVG Thermal Meter = 0x%X, tssi->thermal[A] = 0x%x tssi->thermal[B] = 0x%x\n", + thermal_value[j], tssi->thermal[RF_PATH_A], tssi->thermal[RF_PATH_B]); + } + /* 4 5. Calculate delta, delta_LCK, delta_IQK. */ + + /* "delta" here is used to determine whether thermal value changes or not. */ + delta[j] = (thermal_value[j] > cali_info->thermal_value_path[j]) ? (thermal_value[j] - cali_info->thermal_value_path[j]) : (cali_info->thermal_value_path[j] - thermal_value[j]); + delta_LCK = (thermal_value[0] > cali_info->thermal_value_lck) ? (thermal_value[0] - cali_info->thermal_value_lck) : (cali_info->thermal_value_lck - thermal_value[0]); + delta_IQK = (thermal_value[0] > cali_info->thermal_value_iqk) ? (thermal_value[0] - cali_info->thermal_value_iqk) : (cali_info->thermal_value_iqk - thermal_value[0]); + } + + /*4 6. If necessary, do LCK.*/ + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "(delta[%d], delta_LCK, delta_IQK) = (%d, %d, %d)\n", RF_PATH_A, delta[RF_PATH_A], delta_LCK, delta_IQK); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "(delta[%d], delta_LCK, delta_IQK) = (%d, %d, %d)\n", RF_PATH_B, delta[RF_PATH_B], delta_LCK, delta_IQK); + + /* Wait sacn to do LCK by RF Jenyu*/ + if( (*dm->is_scan_in_process == false) && (!iqk_info->rfk_forbidden)) { + /* Delta temperature is equal to or larger than 20 centigrade.*/ + if (delta_LCK >= c.threshold_iqk) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta_LCK(%d) >= threshold_iqk(%d)\n", delta_LCK, c.threshold_iqk); + cali_info->thermal_value_lck = thermal_value[RF_PATH_A]; + + /*Use RTLCK, so close power tracking driver LCK*/ + if ((!(dm->support_ic_type & ODM_RTL8814A)) && (!(dm->support_ic_type & ODM_RTL8822B))) { + if (c.phy_lc_calibrate) + (*c.phy_lc_calibrate)(dm); + } else + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "Do not do LCK\n"); + } + } + + /*3 7. If necessary, move the index of swing table to adjust Tx power.*/ + for (i = 0; i < c.rf_path_count; i++) { + if (i == RF_PATH_B) { + odm_move_memory(dm, delta_swing_table_idx_tup, delta_swing_table_idx_tup_b, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, delta_swing_table_idx_tdown, delta_swing_table_idx_tdown_b, DELTA_SWINGIDX_SIZE); + } else if (i == RF_PATH_C) { + odm_move_memory(dm, delta_swing_table_idx_tup, delta_swing_table_idx_tup_c, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, delta_swing_table_idx_tdown, delta_swing_table_idx_tdown_c, DELTA_SWINGIDX_SIZE); + } else if (i == RF_PATH_D) { + odm_move_memory(dm, delta_swing_table_idx_tup, delta_swing_table_idx_tup_d, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, delta_swing_table_idx_tdown, delta_swing_table_idx_tdown_d, DELTA_SWINGIDX_SIZE); + } else { + odm_move_memory(dm, delta_swing_table_idx_tup, delta_swing_table_idx_tup_a, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, delta_swing_table_idx_tdown, delta_swing_table_idx_tdown_a, DELTA_SWINGIDX_SIZE); + } + + cali_info->delta_power_index_last[i] = cali_info->delta_power_index[i]; /*recording poer index offset*/ + delta[i] = thermal_value[i] > tssi->thermal[i] ? (thermal_value[i] - tssi->thermal[i]) : (tssi->thermal[i] - thermal_value[i]); + + if (delta[i] >= TXPWR_TRACK_TABLE_SIZE) + delta[i] = TXPWR_TRACK_TABLE_SIZE - 1; + + if (thermal_value[i] > tssi->thermal[i]) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "delta_swing_table_idx_tup[%d]=%d Path=%d\n", delta[i], delta_swing_table_idx_tup[delta[i]], i); + + cali_info->delta_power_index[i] = delta_swing_table_idx_tup[delta[i]]; + cali_info->absolute_ofdm_swing_idx[i] = delta_swing_table_idx_tup[delta[i]]; /*Record delta swing for mix mode power tracking*/ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "******Temp is higher and cali_info->absolute_ofdm_swing_idx[%d]=%d Path=%d\n", delta[i], cali_info->absolute_ofdm_swing_idx[i], i); + } else { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "delta_swing_table_idx_tdown[%d]=%d Path=%d\n", delta[i], delta_swing_table_idx_tdown[delta[i]], i); + cali_info->delta_power_index[i] = -1 * delta_swing_table_idx_tdown[delta[i]]; + cali_info->absolute_ofdm_swing_idx[i] = -1 * delta_swing_table_idx_tdown[delta[i]]; /*Record delta swing for mix mode power tracking*/ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "******Temp is lower and cali_info->absolute_ofdm_swing_idx[%d]=%d Path=%d\n", delta[i], cali_info->absolute_ofdm_swing_idx[i], i); + } + } + + for (p = RF_PATH_A; p < c.rf_path_count; p++) { + if (cali_info->delta_power_index[p] == cali_info->delta_power_index_last[p]) /*If Thermal value changes but lookup table value still the same*/ + cali_info->power_index_offset[p] = 0; + else + cali_info->power_index_offset[p] = cali_info->delta_power_index[p] - cali_info->delta_power_index_last[p]; /*Power index diff between 2 times Power Tracking*/ + } + + if ((cali_info->power_index_offset[RF_PATH_A] != 0 || + cali_info->power_index_offset[RF_PATH_B] != 0 || + cali_info->power_index_offset[RF_PATH_C] != 0 || + cali_info->power_index_offset[RF_PATH_D] != 0)) { + + if (dm->support_ic_type == ODM_RTL8822C) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking MIX_MODE**********\n"); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(dm, MIX_MODE, p, 0); + } else { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "**********Enter POWER Tracking BBSWING_MODE**********\n"); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(dm, BBSWING, p, 0); + } + } else + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "TXAGC offset is unchanged\n"); + + /* Wait sacn to do IQK by RF Jenyu*/ + if ((*dm->is_scan_in_process == false) && (!iqk_info->rfk_forbidden)) { + /*Delta temperature is equal to or larger than 20 centigrade (When threshold is 8).*/ + if (delta_IQK >= c.threshold_iqk) { + cali_info->thermal_value_iqk = thermal_value[RF_PATH_A]; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "delta_IQK(%d) >= threshold_iqk(%d)\n", delta_IQK, c.threshold_iqk); + if (!cali_info->is_iqk_in_progress) + (*c.do_iqk)(dm, delta_IQK, thermal_value[RF_PATH_A], 8); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "Do IQK\n"); + } + } + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "<===%s\n", __func__); + + cali_info->tx_powercount = 0; +} +#endif + +/* 3============================================================ + * 3 IQ Calibration + * 3============================================================ */ + +void +odm_reset_iqk_result( + struct dm_struct *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 dm_struct *dm +) +{ + void *adapter = dm->adapter; + struct dm_iqk_info *iqk_info = &dm->IQK_info; + + RF_DBG(dm, DBG_RF_IQK, "=>%s\n",__FUNCTION__); + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + if (*dm->is_fcs_mode_enable) + return; +#endif + + if ((dm->is_linked) && (!iqk_info->rfk_forbidden)) { + RF_DBG(dm, DBG_RF_IQK, "interval=%d ch=%d prech=%d scan=%s\n", dm->linked_interval, + *dm->channel, dm->pre_channel, *dm->is_scan_in_process == TRUE ? "TRUE":"FALSE"); + + if (*dm->channel != dm->pre_channel) { + dm->pre_channel = *dm->channel; + dm->linked_interval = 0; + } + + if ((dm->linked_interval < 3) && (!*dm->is_scan_in_process)) + dm->linked_interval++; + + if (dm->linked_interval == 2) + PHY_IQCalibrate(adapter, false); + } else + dm->linked_interval = 0; + + RF_DBG(dm, DBG_RF_IQK, "<=%s interval=%d ch=%d prech=%d scan=%s\n", __FUNCTION__, dm->linked_interval, + *dm->channel, dm->pre_channel, *dm->is_scan_in_process == TRUE?"TRUE":"FALSE"); +} + +void phydm_rf_init(struct dm_struct *dm) +{ + + odm_txpowertracking_init(dm); + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + odm_clear_txpowertracking_state(dm); +#endif + +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) +#if (RTL8814A_SUPPORT == 1) + if (dm->support_ic_type & ODM_RTL8814A) + phy_iq_calibrate_8814a_init(dm); +#endif +#endif + +} + +void phydm_rf_watchdog(struct dm_struct *dm) +{ +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) +#if (MP_DRIVER == 1) + /*struct _ADAPTER *adapter = dm->adapter;*/ + /*PMPT_CONTEXT p_mpt_ctx = &(adapter->MptCtx);*/ +#endif + FunctionIn(COMP_MLME); + + if (*dm->mp_mode == 1) { +#if (MP_DRIVER == 1) + /*if (p_mpt_ctx->bTxPowerTrackOn)*/ + odm_txpowertracking_check(dm); +#endif + } else { + odm_txpowertracking_check(dm); + + if (dm->support_ic_type & (ODM_IC_11AC_SERIES | ODM_IC_JGR3_SERIES)) + odm_iq_calibrate(dm); + } +#endif +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halphyrf_win.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halphyrf_win.h similarity index 64% rename from drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halphyrf_win.h rename to drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halphyrf_win.h index e82b42ab36de..e085e41889d2 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halphyrf_win.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halphyrf_win.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,35 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ +#ifndef __HALPHYRF_H__ +#define __HALPHYRF_H__ -#include "phydm_kfree.h" #if (RTL8814A_SUPPORT == 1) - #include "rtl8814a/phydm_iqk_8814a.h" + #include "halrf/rtl8814a/halrf_iqk_8814a.h" #endif #if (RTL8822B_SUPPORT == 1) - #include "rtl8822b/phydm_iqk_8822b.h" + #include "halrf/rtl8822b/halrf_iqk_8822b.h" #include "../mac/Halmac_type.h" #endif -#include "phydm_powertracking_win.h" - +#include "halrf/halrf_powertracking_win.h" +#include "halrf/halrf_kfree.h" +#include "halrf/halrf_txgapcal.h" #if (RTL8821C_SUPPORT == 1) - #include "rtl8821c/phydm_iqk_8821c.h" + #include "halrf/rtl8821c/halrf_iqk_8821c.h" +#endif + +#if (RTL8195B_SUPPORT == 1) +// #include "halrf/rtl8195b/halrf.h" + #include "halrf/rtl8195b/halrf_iqk_8195b.h" + #include "halrf/rtl8195b/halrf_txgapk_8195b.h" + #include "halrf/rtl8195b/halrf_dpk_8195b.h" +#endif + +#if (RTL8814B_SUPPORT == 1) + #include "halrf/rtl8814b/halrf_iqk_8814b.h" #endif enum spur_cal_method { @@ -47,7 +54,8 @@ enum pwrtrack_method { MIX_MODE, TSSI_MODE, MIX_2G_TSSI_5G_MODE, - MIX_5G_TSSI_2G_MODE + MIX_5G_TSSI_2G_MODE, + CLEAN_MODE }; typedef void(*func_set_pwr)(void *, enum pwrtrack_method, u8, u8); @@ -59,7 +67,7 @@ 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 { +struct txpwrtrack_cfg { u8 swing_table_size_cck; u8 swing_table_size_ofdm; u8 threshold_iqk; @@ -79,41 +87,44 @@ struct _TXPWRTRACK_CFG { void configure_txpower_track( - struct PHY_DM_STRUCT *p_dm_odm, - struct _TXPWRTRACK_CFG *p_config + struct dm_struct *dm, + struct txpwrtrack_cfg *config ); void odm_clear_txpowertracking_state( - struct PHY_DM_STRUCT *p_dm_odm + struct dm_struct *dm ); void odm_txpowertracking_callback_thermal_meter( #if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm + struct dm_struct *dm #else - struct _ADAPTER *adapter + void *adapter #endif ); - +#if (RTL8822C_SUPPORT == 1) +void +odm_txpowertracking_new_callback_thermal_meter(void *dm_void); +#endif #define ODM_TARGET_CHNL_NUM_2G_5G 59 void odm_reset_iqk_result( - struct PHY_DM_STRUCT *p_dm_odm + struct dm_struct *dm ); u8 odm_get_right_chnl_place_for_iqk( u8 chnl ); -void odm_iq_calibrate(struct PHY_DM_STRUCT *p_dm_odm); -void phydm_rf_init(struct PHY_DM_STRUCT *p_dm_odm); -void phydm_rf_watchdog(struct PHY_DM_STRUCT *p_dm_odm); +void odm_iq_calibrate(struct dm_struct *dm); +void phydm_rf_init(struct dm_struct *dm); +void phydm_rf_watchdog(struct dm_struct *dm); -#endif /* #ifndef __HAL_PHY_RF_H__ */ +#endif /*#ifndef __HALPHYRF_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf.c new file mode 100644 index 000000000000..133cd22b66fd --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf.c @@ -0,0 +1,3002 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +/*@************************************************************ + * include files + * ************************************************************ + */ + +#include "mp_precomp.h" +#include "phydm_precomp.h" + +#if (RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1 ||\ + RTL8195B_SUPPORT == 1 || RTL8198F_SUPPORT == 1 ||\ + RTL8814B_SUPPORT == 1 || RTL8822C_SUPPORT == 1 ||\ + RTL8812F_SUPPORT == 1) + +void _iqk_check_if_reload(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct dm_iqk_info *iqk_info = &dm->IQK_info; + + iqk_info->is_reload = (boolean)odm_get_bb_reg(dm, R_0x1bf0, BIT(16)); +} + +void _iqk_page_switch(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (dm->support_ic_type == ODM_RTL8821C) + odm_write_4byte(dm, 0x1b00, 0xf8000008); + else + odm_write_4byte(dm, 0x1b00, 0xf800000a); +} + +u32 halrf_psd_log2base(u32 val) +{ + u8 j; + u32 tmp, tmp2, val_integerd_b = 0, tindex, shiftcount = 0; + u32 result, val_fractiond_b = 0; + u32 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 *dm_void, u8 idx, u8 path, boolean debug) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct dm_iqk_info *iqk_info = &dm->IQK_info; + + u8 i, ch; + u32 tmp; + u32 bit_mask_20_16 = BIT(20) | BIT(19) | BIT(18) | BIT(17) | BIT(16); + + if (debug) + ch = 2; + else + ch = 0; + + odm_set_bb_reg(dm, R_0x1b00, MASKDWORD, 0xf8000008 | path << 1); + if (idx == 0) + odm_set_bb_reg(dm, R_0x1b0c, BIT(13) | BIT(12), 0x3); + else + odm_set_bb_reg(dm, R_0x1b0c, BIT(13) | BIT(12), 0x1); + odm_set_bb_reg(dm, R_0x1bd4, bit_mask_20_16, 0x10); + for (i = 0; i < 8; i++) { + odm_set_bb_reg(dm, R_0x1bd8, MASKDWORD, 0xe0000001 + (i * 4)); + tmp = odm_get_bb_reg(dm, R_0x1bfc, MASKDWORD); + iqk_info->iqk_cfir_real[ch][path][idx][i] = + (u16)((tmp & 0x0fff0000) >> 16); + iqk_info->iqk_cfir_imag[ch][path][idx][i] = (u16)(tmp & 0xfff); + } + odm_set_bb_reg(dm, R_0x1bd8, MASKDWORD, 0x0); + odm_set_bb_reg(dm, R_0x1b0c, BIT(13) | BIT(12), 0x0); +} + +void halrf_iqk_xym_enable(struct dm_struct *dm, u8 xym_enable) +{ + struct dm_iqk_info *iqk_info = &dm->IQK_info; + + if (xym_enable == 0) + iqk_info->xym_read = false; + else + iqk_info->xym_read = true; + + RF_DBG(dm, DBG_RF_IQK, "[IQK]%-20s %s\n", "xym_read = ", + (iqk_info->xym_read ? "true" : "false")); +} + +/*xym_type => 0: rx_sym; 1: tx_xym; 2:gs1_xym; 3:gs2_sym; 4: rxk1_xym*/ +void halrf_iqk_xym_read(void *dm_void, u8 path, u8 xym_type) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct dm_iqk_info *iqk_info = &dm->IQK_info; + u8 i, start, num; + u32 tmp1, tmp2; + + if (!iqk_info->xym_read) + return; + + if (*dm->band_width == 0) { + start = 3; + num = 4; + } else if (*dm->band_width == 1) { + start = 2; + num = 6; + } else { + start = 0; + num = 10; + } + + odm_write_4byte(dm, 0x1b00, 0xf8000008); + tmp1 = odm_read_4byte(dm, 0x1b1c); + odm_write_4byte(dm, 0x1b1c, 0xa2193c32); + + odm_write_4byte(dm, 0x1b00, 0xf800000a); + tmp2 = odm_read_4byte(dm, 0x1b1c); + odm_write_4byte(dm, 0x1b1c, 0xa2193c32); + + for (path = 0; path < 2; path++) { + odm_write_4byte(dm, 0x1b00, 0xf8000008 | path << 1); + switch (xym_type) { + case 0: + for (i = 0; i < num; i++) { + odm_write_4byte(dm, 0x1b14, 0xe6 + start + i); + odm_write_4byte(dm, 0x1b14, 0x0); + iqk_info->rx_xym[path][i] = + odm_read_4byte(dm, 0x1b38); + } + break; + case 1: + for (i = 0; i < num; i++) { + odm_write_4byte(dm, 0x1b14, 0xe6 + start + i); + odm_write_4byte(dm, 0x1b14, 0x0); + iqk_info->tx_xym[path][i] = + odm_read_4byte(dm, 0x1b38); + } + break; + case 2: + for (i = 0; i < 6; i++) { + odm_write_4byte(dm, 0x1b14, 0xe0 + i); + odm_write_4byte(dm, 0x1b14, 0x0); + iqk_info->gs1_xym[path][i] = + odm_read_4byte(dm, 0x1b38); + } + break; + case 3: + for (i = 0; i < 6; i++) { + odm_write_4byte(dm, 0x1b14, 0xe0 + i); + odm_write_4byte(dm, 0x1b14, 0x0); + iqk_info->gs2_xym[path][i] = + odm_read_4byte(dm, 0x1b38); + } + break; + case 4: + for (i = 0; i < 6; i++) { + odm_write_4byte(dm, 0x1b14, 0xe0 + i); + odm_write_4byte(dm, 0x1b14, 0x0); + iqk_info->rxk1_xym[path][i] = + odm_read_4byte(dm, 0x1b38); + } + break; + } + odm_write_4byte(dm, 0x1b38, 0x20000000); + odm_write_4byte(dm, 0x1b00, 0xf8000008); + odm_write_4byte(dm, 0x1b1c, tmp1); + odm_write_4byte(dm, 0x1b00, 0xf800000a); + odm_write_4byte(dm, 0x1b1c, tmp2); + _iqk_page_switch(dm); + } +} + +/*xym_type => 0: rx_sym; 1: tx_xym; 2:gs1_xym; 3:gs2_sym; 4: rxk1_xym*/ +void halrf_iqk_xym_show(struct dm_struct *dm, u8 xym_type) +{ + u8 num, path, path_num, i; + struct dm_iqk_info *iqk_info = &dm->IQK_info; + + if (dm->rf_type == RF_1T1R) + path_num = 0x1; + else if (dm->rf_type == RF_2T2R) + path_num = 0x2; + else + path_num = 0x4; + + if (*dm->band_width == CHANNEL_WIDTH_20) + num = 4; + else if (*dm->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++) + RF_DBG(dm, DBG_RF_IQK, + "[IQK]%-20s %-2d: 0x%x\n", + (path == 0) ? "PATH A RX-XYM " : + "PATH B RX-XYM", i, + iqk_info->rx_xym[path][i]); + break; + case 1: + for (i = 0; i < num; i++) + RF_DBG(dm, DBG_RF_IQK, + "[IQK]%-20s %-2d: 0x%x\n", + (path == 0) ? "PATH A TX-XYM " : + "PATH B TX-XYM", i, + iqk_info->tx_xym[path][i]); + break; + case 2: + for (i = 0; i < 6; i++) + RF_DBG(dm, DBG_RF_IQK, + "[IQK]%-20s %-2d: 0x%x\n", + (path == 0) ? "PATH A GS1-XYM " : + "PATH B GS1-XYM", i, + iqk_info->gs1_xym[path][i]); + break; + case 3: + for (i = 0; i < 6; i++) + RF_DBG(dm, DBG_RF_IQK, + "[IQK]%-20s %-2d: 0x%x\n", + (path == 0) ? "PATH A GS2-XYM " : + "PATH B GS2-XYM", i, + iqk_info->gs2_xym[path][i]); + break; + case 4: + for (i = 0; i < 6; i++) + RF_DBG(dm, DBG_RF_IQK, + "[IQK]%-20s %-2d: 0x%x\n", + (path == 0) ? "PATH A RXK1-XYM " : + "PATH B RXK1-XYM", i, + iqk_info->rxk1_xym[path][i]); + break; + } + } +} + +void halrf_iqk_xym_dump(void *dm_void) +{ + u32 tmp1, tmp2; + struct dm_struct *dm = (struct dm_struct *)dm_void; + + odm_write_4byte(dm, 0x1b00, 0xf8000008); + tmp1 = odm_read_4byte(dm, 0x1b1c); + odm_write_4byte(dm, 0x1b00, 0xf800000a); + tmp2 = odm_read_4byte(dm, 0x1b1c); +#if 0 + /*halrf_iqk_xym_read(dm, xym_type);*/ +#endif + odm_write_4byte(dm, 0x1b00, 0xf8000008); + odm_write_4byte(dm, 0x1b1c, tmp1); + odm_write_4byte(dm, 0x1b00, 0xf800000a); + odm_write_4byte(dm, 0x1b1c, tmp2); + _iqk_page_switch(dm); +} + +void halrf_iqk_info_dump(void *dm_void, u32 *_used, char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 used = *_used; + u32 out_len = *_out_len; + u8 rf_path, j, reload_iqk = 0; + u32 tmp; + /*two channel, PATH, TX/RX, 0:pass 1 :fail*/ + boolean iqk_result[2][NUM][2]; + struct dm_iqk_info *iqk_info = &dm->IQK_info; + + if (!(dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8821C))) + return; + + /* IQK INFO */ + PDM_SNPF(out_len, used, output + used, out_len - used, "%-20s\n", + "% IQK Info %"); + PDM_SNPF(out_len, used, output + used, out_len - used, "%-20s\n", + (dm->fw_offload_ability & PHYDM_RF_IQK_OFFLOAD) ? "FW-IQK" : + "Driver-IQK"); + + reload_iqk = (u8)odm_get_bb_reg(dm, R_0x1bf0, BIT(16)); + PDM_SNPF(out_len, used, output + used, out_len - used, "%-20s: %s\n", + "reload", (reload_iqk) ? "True" : "False"); + + PDM_SNPF(out_len, used, output + used, out_len - used, "%-20s: %s\n", + "rfk_forbidden", (iqk_info->rfk_forbidden) ? "True" : "False"); +#if (RTL8814A_SUPPORT == 1 || RTL8822B_SUPPORT == 1 || \ + RTL8821C_SUPPORT == 1 || RTL8195B_SUPPORT == 1 ||\ + RTL8814B_SUPPORT == 1 || RTL8822C_SUPPORT == 1) + PDM_SNPF(out_len, used, output + used, out_len - used, "%-20s: %s\n", + "segment_iqk", (iqk_info->segment_iqk) ? "True" : "False"); +#endif + + PDM_SNPF(out_len, used, output + used, out_len - used, "%-20s:%d %d\n", + "iqk count / fail count", dm->n_iqk_cnt, dm->n_iqk_fail_cnt); + + PDM_SNPF(out_len, used, output + used, out_len - used, "%-20s: %d\n", + "channel", *dm->channel); + + if (*dm->band_width == CHANNEL_WIDTH_20) + PDM_SNPF(out_len, used, output + used, out_len - used, + "%-20s: %s\n", "bandwidth", "BW_20"); + else if (*dm->band_width == CHANNEL_WIDTH_40) + PDM_SNPF(out_len, used, output + used, out_len - used, + "%-20s: %s\n", "bandwidth", "BW_40"); + else if (*dm->band_width == CHANNEL_WIDTH_80) + PDM_SNPF(out_len, used, output + used, out_len - used, + "%-20s: %s\n", "bandwidth", "BW_80"); + else if (*dm->band_width == CHANNEL_WIDTH_160) + PDM_SNPF(out_len, used, output + used, out_len - used, + "%-20s: %s\n", "bandwidth", "BW_160"); + else + PDM_SNPF(out_len, used, output + used, out_len - used, + "%-20s: %s\n", "bandwidth", "BW_UNKNOWN"); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "%-20s: %llu %s\n", "progressing_time", + dm->rf_calibrate_info.iqk_total_progressing_time, "(ms)"); + + tmp = odm_read_4byte(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)))); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "%-20s: 0x%08x\n", "Reg0x1bf0", tmp); + PDM_SNPF(out_len, used, output + used, out_len - used, "%-20s: %s\n", + "PATH_A-Tx result", + (iqk_result[0][RF_PATH_A][0]) ? "Fail" : "Pass"); + PDM_SNPF(out_len, used, 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) + PDM_SNPF(out_len, used, output + used, out_len - used, "%-20s: %s\n", + "PATH_B-Tx result", + (iqk_result[0][RF_PATH_B][0]) ? "Fail" : "Pass"); + PDM_SNPF(out_len, used, 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 *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &dm->rf_table; + + rf->fw_ver = (dm->fw_version << 16) | dm->fw_sub_version; +} + +void halrf_iqk_dbg(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 rf_path, j; + u32 tmp; + /*two channel, PATH, TX/RX, 0:pass 1 :fail*/ + boolean iqk_result[2][NUM][2]; + struct dm_iqk_info *iqk_info = &dm->IQK_info; + struct _hal_rf_ *rf = &dm->rf_table; + + /* IQK INFO */ + RF_DBG(dm, DBG_RF_IQK, "%-20s\n", "====== IQK Info ======"); + + RF_DBG(dm, DBG_RF_IQK, "%-20s\n", + (dm->fw_offload_ability & PHYDM_RF_IQK_OFFLOAD) ? "FW-IQK" : + "Driver-IQK"); + + if (dm->fw_offload_ability & PHYDM_RF_IQK_OFFLOAD) { + halrf_get_fw_version(dm); + RF_DBG(dm, DBG_RF_IQK, "%-20s: 0x%x\n", "FW_VER", rf->fw_ver); + } else { + RF_DBG(dm, DBG_RF_IQK, "%-20s: %s\n", "IQK_VER", HALRF_IQK_VER); + } + + RF_DBG(dm, DBG_RF_IQK, "%-20s: %s\n", "reload", + (iqk_info->is_reload) ? "True" : "False"); + + RF_DBG(dm, DBG_RF_IQK, "%-20s: %d %d\n", "iqk count / fail count", + dm->n_iqk_cnt, dm->n_iqk_fail_cnt); + + RF_DBG(dm, DBG_RF_IQK, "%-20s: %d\n", "channel", *dm->channel); + + if (*dm->band_width == CHANNEL_WIDTH_20) + RF_DBG(dm, DBG_RF_IQK, "%-20s: %s\n", "bandwidth", "BW_20"); + else if (*dm->band_width == CHANNEL_WIDTH_40) + RF_DBG(dm, DBG_RF_IQK, "%-20s: %s\n", "bandwidth", "BW_40"); + else if (*dm->band_width == CHANNEL_WIDTH_80) + RF_DBG(dm, DBG_RF_IQK, "%-20s: %s\n", "bandwidth", "BW_80"); + else if (*dm->band_width == CHANNEL_WIDTH_160) + RF_DBG(dm, DBG_RF_IQK, "%-20s: %s\n", "bandwidth", "BW_160"); + else + RF_DBG(dm, DBG_RF_IQK, "%-20s: %s\n", "bandwidth", + "BW_UNKNOWN"); +#if 0 +/* + * RF_DBG(dm, DBG_RF_IQK, "%-20s: %llu %s\n", + * "progressing_time", + * dm->rf_calibrate_info.iqk_total_progressing_time, "(ms)"); + */ +#endif + RF_DBG(dm, DBG_RF_IQK, "%-20s: %s\n", "rfk_forbidden", + (iqk_info->rfk_forbidden) ? "True" : "False"); +#if (RTL8814A_SUPPORT == 1 || RTL8822B_SUPPORT == 1 || \ + RTL8821C_SUPPORT == 1 || RTL8195B_SUPPORT == 1 ||\ + RTL8814B_SUPPORT == 1 || RTL8822C_SUPPORT == 1) + RF_DBG(dm, DBG_RF_IQK, "%-20s: %s\n", "segment_iqk", + (iqk_info->segment_iqk) ? "True" : "False"); +#endif + + RF_DBG(dm, DBG_RF_IQK, "%-20s: %llu %s\n", "progressing_time", + dm->rf_calibrate_info.iqk_progressing_time, "(ms)"); + + tmp = odm_read_4byte(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)))); + + RF_DBG(dm, DBG_RF_IQK, "%-20s: 0x%08x\n", "Reg0x1bf0", tmp); + RF_DBG(dm, DBG_RF_IQK, "%-20s: 0x%08x\n", "Reg0x1be8", + odm_read_4byte(dm, 0x1be8)); + RF_DBG(dm, DBG_RF_IQK, "%-20s: %s\n", "PATH_A-Tx result", + (iqk_result[0][RF_PATH_A][0]) ? "Fail" : "Pass"); + RF_DBG(dm, DBG_RF_IQK, "%-20s: %s\n", "PATH_A-Rx result", + (iqk_result[0][RF_PATH_A][1]) ? "Fail" : "Pass"); +#if (RTL8822B_SUPPORT == 1) + RF_DBG(dm, DBG_RF_IQK, "%-20s: %s\n", "PATH_B-Tx result", + (iqk_result[0][RF_PATH_B][0]) ? "Fail" : "Pass"); + RF_DBG(dm, DBG_RF_IQK, "%-20s: %s\n", "PATH_B-Rx result", + (iqk_result[0][RF_PATH_B][1]) ? "Fail" : "Pass"); +#endif +} + +void halrf_lck_dbg(struct dm_struct *dm) +{ + RF_DBG(dm, DBG_RF_IQK, "%-20s\n", "====== LCK Info ======"); +#if 0 + /*RF_DBG(dm, DBG_RF_IQK, "%-20s\n", + * (dm->fw_offload_ability & PHYDM_RF_IQK_OFFLOAD) ? "LCK" : "RTK")); + */ +#endif + RF_DBG(dm, DBG_RF_IQK, "%-20s: %llu %s\n", "progressing_time", + dm->rf_calibrate_info.lck_progressing_time, "(ms)"); +} + +void halrf_iqk_dbg_cfir_backup(struct dm_struct *dm) +{ + struct dm_iqk_info *iqk_info = &dm->IQK_info; + u8 path, idx, i; + + RF_DBG(dm, DBG_RF_IQK, "[IQK]%-20s\n", "backup TX/RX CFIR"); + + for (path = 0; path < 2; path++) + for (idx = 0; idx < 2; idx++) + phydm_get_iqk_cfir(dm, idx, path, true); + + for (path = 0; path < 2; path++) { + for (idx = 0; idx < 2; idx++) { + for (i = 0; i < 8; i++) { + RF_DBG(dm, DBG_RF_IQK, + "[IQK]%-7s %-3s CFIR_real: %-2d: 0x%x\n", + (path == 0) ? "PATH A" : "PATH B", + (idx == 0) ? "TX" : "RX", i, + iqk_info->iqk_cfir_real[2][path][idx][i]) + ; + } + for (i = 0; i < 8; i++) { + RF_DBG(dm, DBG_RF_IQK, + "[IQK]%-7s %-3s CFIR_img:%-2d: 0x%x\n", + (path == 0) ? "PATH A" : "PATH B", + (idx == 0) ? "TX" : "RX", i, + iqk_info->iqk_cfir_imag[2][path][idx][i]) + ; + } + } + } +} + +void halrf_iqk_dbg_cfir_backup_update(struct dm_struct *dm) +{ + struct dm_iqk_info *iqk = &dm->IQK_info; + u8 i, path, idx; + u32 bmask13_12 = BIT(13) | BIT(12); + u32 bmask20_16 = BIT(20) | BIT(19) | BIT(18) | BIT(17) | BIT(16); + u32 data; + + if (iqk->iqk_cfir_real[2][0][0][0] == 0) { + RF_DBG(dm, DBG_RF_IQK, "[IQK]%-20s\n", "CFIR is invalid"); + return; + } + for (path = 0; path < 2; path++) { + for (idx = 0; idx < 2; idx++) { + odm_set_bb_reg(dm, R_0x1b00, MASKDWORD, + 0xf8000008 | path << 1); + odm_set_bb_reg(dm, R_0x1b2c, MASKDWORD, 0x7); + odm_set_bb_reg(dm, R_0x1b38, MASKDWORD, 0x20000000); + odm_set_bb_reg(dm, R_0x1b3c, MASKDWORD, 0x20000000); + odm_set_bb_reg(dm, R_0x1bcc, MASKDWORD, 0x00000000); + if (idx == 0) + odm_set_bb_reg(dm, R_0x1b0c, bmask13_12, 0x3); + else + odm_set_bb_reg(dm, R_0x1b0c, bmask13_12, 0x1); + odm_set_bb_reg(dm, R_0x1bd4, bmask20_16, 0x10); + for (i = 0; i < 8; i++) { + data = ((0xc0000000 >> idx) + 0x3) + (i * 4) + + (iqk->iqk_cfir_real[2][path][idx][i] + << 9); + odm_write_4byte(dm, 0x1bd8, data); + data = ((0xc0000000 >> idx) + 0x1) + (i * 4) + + (iqk->iqk_cfir_imag[2][path][idx][i] + << 9); + odm_write_4byte(dm, 0x1bd8, data); +#if 0 + /*odm_write_4byte(dm, 0x1bd8, iqk->iqk_cfir_real[2][path][idx][i]);*/ + /*odm_write_4byte(dm, 0x1bd8, iqk->iqk_cfir_imag[2][path][idx][i]);*/ +#endif + } + } + odm_set_bb_reg(dm, R_0x1bd8, MASKDWORD, 0x0); + odm_set_bb_reg(dm, R_0x1b0c, bmask13_12, 0x0); + } + RF_DBG(dm, DBG_RF_IQK, "[IQK]%-20s\n", "update new CFIR"); +} + +void halrf_iqk_dbg_cfir_reload(struct dm_struct *dm) +{ + struct dm_iqk_info *iqk = &dm->IQK_info; + u8 i, path, idx; + u32 bmask13_12 = BIT(13) | BIT(12); + u32 bmask20_16 = BIT(20) | BIT(19) | BIT(18) | BIT(17) | BIT(16); + u32 data; + + if (iqk->iqk_cfir_real[0][0][0][0] == 0) { + RF_DBG(dm, DBG_RF_IQK, "[IQK]%-20s\n", "CFIR is invalid"); + return; + } + for (path = 0; path < 2; path++) { + for (idx = 0; idx < 2; idx++) { + odm_set_bb_reg(dm, R_0x1b00, MASKDWORD, + 0xf8000008 | path << 1); + odm_set_bb_reg(dm, R_0x1b2c, MASKDWORD, 0x7); + odm_set_bb_reg(dm, R_0x1b38, MASKDWORD, 0x20000000); + odm_set_bb_reg(dm, R_0x1b3c, MASKDWORD, 0x20000000); + odm_set_bb_reg(dm, R_0x1bcc, MASKDWORD, 0x00000000); + if (idx == 0) + odm_set_bb_reg(dm, R_0x1b0c, bmask13_12, 0x3); + else + odm_set_bb_reg(dm, R_0x1b0c, bmask13_12, 0x1); + odm_set_bb_reg(dm, R_0x1bd4, bmask20_16, 0x10); + for (i = 0; i < 8; i++) { +#if 0 + /*odm_write_4byte(dm, 0x1bd8, iqk->iqk_cfir_real[0][path][idx][i]);*/ + /*odm_write_4byte(dm, 0x1bd8, iqk->iqk_cfir_imag[0][path][idx][i]);*/ +#endif + data = ((0xc0000000 >> idx) + 0x3) + (i * 4) + + (iqk->iqk_cfir_real[0][path][idx][i] + << 9); + odm_write_4byte(dm, 0x1bd8, data); + data = ((0xc0000000 >> idx) + 0x1) + (i * 4) + + (iqk->iqk_cfir_imag[0][path][idx][i] + << 9); + odm_write_4byte(dm, 0x1bd8, data); + } + } + odm_set_bb_reg(dm, R_0x1bd8, MASKDWORD, 0x0); + odm_set_bb_reg(dm, R_0x1b0c, bmask13_12, 0x0); + } + RF_DBG(dm, DBG_RF_IQK, "[IQK]%-20s\n", "write CFIR with default value"); +} + +void halrf_iqk_dbg_cfir_write(struct dm_struct *dm, u8 type, u32 path, u32 idx, + u32 i, u32 data) +{ + struct dm_iqk_info *iqk_info = &dm->IQK_info; + + if (type == 0) + iqk_info->iqk_cfir_real[2][path][idx][i] = (u16)data; + else + iqk_info->iqk_cfir_imag[2][path][idx][i] = (u16)data; +} + +void halrf_iqk_dbg_cfir_backup_show(struct dm_struct *dm) +{ + struct dm_iqk_info *iqk_info = &dm->IQK_info; + u8 path, idx, i; + + RF_DBG(dm, DBG_RF_IQK, "[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++) { + RF_DBG(dm, DBG_RF_IQK, + "[IQK]%-10s %-3s CFIR_real:%-2d: 0x%x\n", + (path == 0) ? "PATH A" : "PATH B", + (idx == 0) ? "TX" : "RX", i, + iqk_info->iqk_cfir_real[2][path][idx][i]) + ; + } + for (i = 0; i < 8; i++) { + RF_DBG(dm, DBG_RF_IQK, + "[IQK]%-10s %-3s CFIR_img:%-2d: 0x%x\n", + (path == 0) ? "PATH A" : "PATH B", + (idx == 0) ? "TX" : "RX", i, + iqk_info->iqk_cfir_imag[2][path][idx][i]) + ; + } + } + } +} + +void halrf_do_imr_test(void *dm_void, u8 flag_imr_test) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (flag_imr_test != 0x0) + switch (dm->support_ic_type) { +#if (RTL8822B_SUPPORT == 1) + case ODM_RTL8822B: + do_imr_test_8822b(dm); + break; +#endif +#if (RTL8821C_SUPPORT == 1) + case ODM_RTL8821C: + do_imr_test_8821c(dm); + break; +#endif + default: + break; + } +} + +void halrf_iqk_debug(void *dm_void, u32 *const dm_value, u32 *_used, + char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + +#if 0 + /*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*/ +#endif + if (dm_value[0] == 0x0) + halrf_iqk_dbg_cfir_backup(dm); + else if (dm_value[0] == 0x1) + halrf_iqk_dbg_cfir_backup_update(dm); + else if (dm_value[0] == 0x2) + halrf_iqk_dbg_cfir_reload(dm); + else if (dm_value[0] == 0x3) + halrf_iqk_dbg_cfir_backup_show(dm); + else if (dm_value[0] == 0x10) + halrf_iqk_dbg_cfir_write(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(dm, 1, dm_value[1], dm_value[2], + dm_value[3], dm_value[4]); + else if (dm_value[0] == 0x20) + halrf_iqk_xym_enable(dm, (u8)dm_value[1]); + else if (dm_value[0] == 0x21) + halrf_iqk_xym_show(dm, (u8)dm_value[1]); + else if (dm_value[0] == 0x30) + halrf_do_imr_test(dm, (u8)dm_value[1]); +} + +void halrf_iqk_hwtx_check(void *dm_void, boolean is_check) +{ +#if 0 + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct dm_iqk_info *iqk_info = &dm->IQK_info; + u32 tmp_b04; + + if (is_check) { + iqk_info->is_hwtx = (boolean)odm_get_bb_reg(dm, R_0xb00, BIT(8)); + } else { + if (iqk_info->is_hwtx) { + tmp_b04 = odm_read_4byte(dm, 0xb04); + odm_set_bb_reg(dm, R_0xb04, BIT(3) | BIT(2), 0x0); + odm_write_4byte(dm, 0xb04, tmp_b04); + } + } +#endif +} + + +#endif + +u8 halrf_match_iqk_version(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + u32 iqk_version = 0; + char temp[10] = {0}; + + odm_move_memory(dm, temp, HALRF_IQK_VER, sizeof(temp)); + PHYDM_SSCANF(temp + 2, DCMD_HEX, &iqk_version); + + if (dm->support_ic_type == ODM_RTL8822B) { + if (iqk_version >= 0x24 && (odm_get_hw_img_version(dm) >= 72)) + return 1; + else if ((iqk_version <= 0x23) && + (odm_get_hw_img_version(dm) <= 71)) + return 1; + else + return 0; + } + + if (dm->support_ic_type == ODM_RTL8821C) { + if (iqk_version >= 0x18 && (odm_get_hw_img_version(dm) >= 37)) + return 1; + else + return 0; + } + + return 1; +} + +void halrf_rf_lna_setting(void *dm_void, enum halrf_lna_set type) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + switch (dm->support_ic_type) { +#if (RTL8188E_SUPPORT == 1) + case ODM_RTL8188E: + halrf_rf_lna_setting_8188e(dm, type); + break; +#endif +#if (RTL8192E_SUPPORT == 1) + case ODM_RTL8192E: + halrf_rf_lna_setting_8192e(dm, type); + break; +#endif +#if (RTL8192F_SUPPORT == 1) + case ODM_RTL8192F: + halrf_rf_lna_setting_8192f(dm, type); + break; +#endif + +#if (RTL8723B_SUPPORT == 1) + case ODM_RTL8723B: + halrf_rf_lna_setting_8723b(dm, type); + break; +#endif +#if (RTL8812A_SUPPORT == 1) + case ODM_RTL8812: + halrf_rf_lna_setting_8812a(dm, type); + break; +#endif +#if ((RTL8821A_SUPPORT == 1) || (RTL8881A_SUPPORT == 1)) + case ODM_RTL8881A: + case ODM_RTL8821: + halrf_rf_lna_setting_8821a(dm, type); + break; +#endif +#if (RTL8822B_SUPPORT == 1) + case ODM_RTL8822B: + halrf_rf_lna_setting_8822b(dm_void, type); + break; +#endif +#if (RTL8822C_SUPPORT == 1) + case ODM_RTL8822C: + halrf_rf_lna_setting_8822c(dm_void, type); + break; +#endif +#if (RTL8812F_SUPPORT == 1) + case ODM_RTL8812F: + halrf_rf_lna_setting_8812f(dm_void, type); + break; +#endif +#if (RTL8821C_SUPPORT == 1) + case ODM_RTL8821C: + halrf_rf_lna_setting_8821c(dm_void, type); + break; +#endif +#if (RTL8814B_SUPPORT == 1) + case ODM_RTL8814B: + break; +#endif + default: + break; + } +} + +void halrf_support_ability_debug(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &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 + 2], DCMD_DECIMAL, &dm_value[i]); + + if (dm_value[0] == 100) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "\n[RF Supportability]\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "00. (( %s ))Power Tracking\n", + ((rf->rf_supportability & HAL_RF_TX_PWR_TRACK) ? + ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "01. (( %s ))IQK\n", + ((rf->rf_supportability & HAL_RF_IQK) ? ("V") : + ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "02. (( %s ))LCK\n", + ((rf->rf_supportability & HAL_RF_LCK) ? ("V") : + ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "03. (( %s ))DPK\n", + ((rf->rf_supportability & HAL_RF_DPK) ? ("V") : + ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "04. (( %s ))HAL_RF_TXGAPK\n", + ((rf->rf_supportability & HAL_RF_TXGAPK) ? ("V") : + ("."))); + } else { + if (dm_value[1] == 1) /* enable */ + rf->rf_supportability |= BIT(dm_value[0]); + else if (dm_value[1] == 2) /* disable */ + rf->rf_supportability &= ~(BIT(dm_value[0])); + else + PDM_SNPF(out_len, used, output + used, out_len - used, + "[Warning!!!] 1:enable, 2:disable\n"); + } + PDM_SNPF(out_len, used, output + used, out_len - used, + "\nCurr-RF_supportability = 0x%x\n\n", rf->rf_supportability); + + *_used = used; + *_out_len = out_len; +} + +void halrf_cmn_info_init(void *dm_void, enum halrf_cmninfo_init cmn_info, + u32 value) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &dm->rf_table; + + switch (cmn_info) { + case HALRF_CMNINFO_EEPROM_THERMAL_VALUE: + rf->eeprom_thermal = (u8)value; + break; + case HALRF_CMNINFO_PWT_TYPE: + rf->pwt_type = (u8)value; + break; + default: + break; + } +} + +void halrf_cmn_info_hook(void *dm_void, enum halrf_cmninfo_hook cmn_info, + void *value) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &dm->rf_table; + + switch (cmn_info) { + case HALRF_CMNINFO_CON_TX: + rf->is_con_tx = (boolean *)value; + break; + case HALRF_CMNINFO_SINGLE_TONE: + rf->is_single_tone = (boolean *)value; + break; + case HALRF_CMNINFO_CARRIER_SUPPRESSION: + rf->is_carrier_suppresion = (boolean *)value; + break; + case HALRF_CMNINFO_MP_RATE_INDEX: + rf->mp_rate_index = (u8 *)value; + break; + case HALRF_CMNINFO_MANUAL_RF_SUPPORTABILITY: + rf->manual_rf_supportability = (u32 *)value; + break; + default: + /*do nothing*/ + break; + } +} + +void halrf_cmn_info_set(void *dm_void, u32 cmn_info, u64 value) +{ + /* This init variable may be changed in run time. */ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &dm->rf_table; + + switch (cmn_info) { + case HALRF_CMNINFO_ABILITY: + rf->rf_supportability = (u32)value; + break; + + case HALRF_CMNINFO_DPK_EN: + rf->dpk_en = (u8)value; + break; + case HALRF_CMNINFO_RFK_FORBIDDEN: + dm->IQK_info.rfk_forbidden = (boolean)value; + break; +#if (RTL8814A_SUPPORT == 1 || RTL8822B_SUPPORT == 1 || \ + RTL8821C_SUPPORT == 1 || RTL8195B_SUPPORT == 1 ||\ + RTL8814B_SUPPORT == 1 || RTL8822C_SUPPORT == 1) + case HALRF_CMNINFO_IQK_SEGMENT: + dm->IQK_info.segment_iqk = (boolean)value; + break; +#endif + case HALRF_CMNINFO_RATE_INDEX: + rf->p_rate_index = (u32)value; + break; +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + case HALRF_CMNINFO_MP_PSD_POINT: + rf->halrf_psd_data.point = (u32)value; + break; + case HALRF_CMNINFO_MP_PSD_START_POINT: + rf->halrf_psd_data.start_point = (u32)value; + break; + case HALRF_CMNINFO_MP_PSD_STOP_POINT: + rf->halrf_psd_data.stop_point = (u32)value; + break; + case HALRF_CMNINFO_MP_PSD_AVERAGE: + rf->halrf_psd_data.average = (u32)value; + break; +#endif + default: + /* do nothing */ + break; + } +} + +u64 halrf_cmn_info_get(void *dm_void, u32 cmn_info) +{ + /* This init variable may be changed in run time. */ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &dm->rf_table; + u64 return_value = 0; + + switch (cmn_info) { + case HALRF_CMNINFO_ABILITY: + return_value = (u32)rf->rf_supportability; + break; + case HALRF_CMNINFO_RFK_FORBIDDEN: + return_value = dm->IQK_info.rfk_forbidden; + break; +#if (RTL8814A_SUPPORT == 1 || RTL8822B_SUPPORT == 1 || \ + RTL8821C_SUPPORT == 1 || RTL8195B_SUPPORT == 1 ||\ + RTL8814B_SUPPORT == 1 || RTL8822C_SUPPORT == 1) + case HALRF_CMNINFO_IQK_SEGMENT: + return_value = dm->IQK_info.segment_iqk; + break; + case HALRF_CMNINFO_IQK_TIMES: + return_value = dm->IQK_info.iqk_times; + break; +#endif + default: + /* do nothing */ + break; + } + + return return_value; +} + +void halrf_supportability_init_mp(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &dm->rf_table; + + switch (dm->support_ic_type) { + case ODM_RTL8814B: +#if (RTL8814B_SUPPORT == 1) + rf->rf_supportability = + /*HAL_RF_TX_PWR_TRACK |*/ + HAL_RF_IQK | + HAL_RF_LCK | + HAL_RF_DPK | + HAL_RF_DACK | + HAL_RF_DPK_TRACK | + 0; +#endif + break; +#if (RTL8822B_SUPPORT == 1) + case ODM_RTL8822B: + rf->rf_supportability = + /*HAL_RF_TX_PWR_TRACK |*/ + HAL_RF_IQK | + HAL_RF_LCK | + /*@HAL_RF_DPK |*/ + 0; + break; +#endif +#if (RTL8822C_SUPPORT == 1) + case ODM_RTL8822C: + rf->rf_supportability = + /*HAL_RF_TX_PWR_TRACK |*/ + HAL_RF_IQK | + HAL_RF_LCK | + HAL_RF_DPK | + HAL_RF_DACK | + HAL_RF_DPK_TRACK | + 0; + break; +#endif +#if (RTL8821C_SUPPORT == 1) + case ODM_RTL8821C: + rf->rf_supportability = + /*HAL_RF_TX_PWR_TRACK |*/ + HAL_RF_IQK | + HAL_RF_LCK | + /*@HAL_RF_DPK |*/ + /*@HAL_RF_TXGAPK |*/ + 0; + break; +#endif +#if (RTL8195B_SUPPORT == 1) + case ODM_RTL8195B: + rf->rf_supportability = + HAL_RF_TX_PWR_TRACK | + HAL_RF_IQK | + HAL_RF_LCK | + HAL_RF_DPK | + HAL_RF_TXGAPK | + HAL_RF_DPK_TRACK | + 0; + break; +#endif +#if (RTL8812F_SUPPORT == 1) + case ODM_RTL8812F: + rf->rf_supportability = + /*HAL_RF_TX_PWR_TRACK |*/ + HAL_RF_IQK | + HAL_RF_LCK | + HAL_RF_DPK | + HAL_RF_DACK | + HAL_RF_DPK_TRACK | + 0; + break; +#endif + +#if (RTL8198F_SUPPORT == 1) + case ODM_RTL8198F: + rf->rf_supportability = + /*HAL_RF_TX_PWR_TRACK |*/ + HAL_RF_IQK | + HAL_RF_LCK | + HAL_RF_DPK | + /*@HAL_RF_TXGAPK |*/ + 0; + break; +#endif + +#if (RTL8192F_SUPPORT == 1) + case ODM_RTL8192F: + rf->rf_supportability = + /*HAL_RF_TX_PWR_TRACK |*/ + HAL_RF_IQK | + HAL_RF_LCK | + HAL_RF_DPK | + /*@HAL_RF_TXGAPK |*/ + 0; + break; +#endif + +#if (RTL8197F_SUPPORT == 1) + case ODM_RTL8197F: + rf->rf_supportability = + /*HAL_RF_TX_PWR_TRACK |*/ + HAL_RF_IQK | + HAL_RF_LCK | + HAL_RF_DPK | + /*@HAL_RF_TXGAPK |*/ + 0; + break; +#endif + + default: + rf->rf_supportability = + /*HAL_RF_TX_PWR_TRACK |*/ + HAL_RF_IQK | + HAL_RF_LCK | + /*@HAL_RF_DPK |*/ + /*@HAL_RF_TXGAPK |*/ + 0; + break; + } + + RF_DBG(dm, DBG_RF_INIT, + "IC = ((0x%x)), RF_Supportability Init MP = ((0x%x))\n", + dm->support_ic_type, rf->rf_supportability); +} + +void halrf_supportability_init(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &dm->rf_table; + + switch (dm->support_ic_type) { + case ODM_RTL8814B: +#if (RTL8814B_SUPPORT == 1) + rf->rf_supportability = + HAL_RF_TX_PWR_TRACK | + HAL_RF_IQK | + HAL_RF_LCK | + HAL_RF_DPK | + HAL_RF_DPK_TRACK | + 0; +#endif + break; +#if (RTL8822B_SUPPORT == 1) + case ODM_RTL8822B: + rf->rf_supportability = + HAL_RF_TX_PWR_TRACK | + HAL_RF_IQK | + HAL_RF_LCK | + /*@HAL_RF_DPK |*/ + 0; + break; +#endif +#if (RTL8822C_SUPPORT == 1) + case ODM_RTL8822C: + rf->rf_supportability = + HAL_RF_TX_PWR_TRACK | + HAL_RF_IQK | + HAL_RF_LCK | + HAL_RF_DPK | + HAL_RF_DACK | + HAL_RF_DPK_TRACK | + 0; + break; +#endif +#if (RTL8821C_SUPPORT == 1) + case ODM_RTL8821C: + rf->rf_supportability = + HAL_RF_TX_PWR_TRACK | + HAL_RF_IQK | + HAL_RF_LCK | + /*@HAL_RF_DPK |*/ + /*@HAL_RF_TXGAPK |*/ + 0; + break; +#endif +#if (RTL8195B_SUPPORT == 1) + case ODM_RTL8195B: + rf->rf_supportability = + HAL_RF_TX_PWR_TRACK | + HAL_RF_IQK | + HAL_RF_LCK | + HAL_RF_DPK | + HAL_RF_TXGAPK | + HAL_RF_DPK_TRACK | + 0; + break; +#endif +#if (RTL8812F_SUPPORT == 1) + case ODM_RTL8812F: + rf->rf_supportability = + HAL_RF_TX_PWR_TRACK | + HAL_RF_IQK | + HAL_RF_LCK | + HAL_RF_DPK | + HAL_RF_DACK | + HAL_RF_DPK_TRACK | + 0; + break; +#endif + +#if (RTL8198F_SUPPORT == 1) + case ODM_RTL8198F: + rf->rf_supportability = + HAL_RF_TX_PWR_TRACK | + HAL_RF_IQK | + HAL_RF_LCK | + HAL_RF_DPK | + /*@HAL_RF_TXGAPK |*/ + 0; + break; +#endif + +#if (RTL8192F_SUPPORT == 1) + case ODM_RTL8192F: + rf->rf_supportability = + HAL_RF_TX_PWR_TRACK | + HAL_RF_IQK | + HAL_RF_LCK | + HAL_RF_DPK | + /*@HAL_RF_TXGAPK |*/ + 0; + break; +#endif + +#if (RTL8197F_SUPPORT == 1) + case ODM_RTL8197F: + rf->rf_supportability = + HAL_RF_TX_PWR_TRACK | + HAL_RF_IQK | + HAL_RF_LCK | + HAL_RF_DPK | + /*@HAL_RF_TXGAPK |*/ + 0; + break; +#endif + + default: + rf->rf_supportability = + HAL_RF_TX_PWR_TRACK | + HAL_RF_IQK | + HAL_RF_LCK | + /*@HAL_RF_DPK |*/ + 0; + break; + } + + RF_DBG(dm, DBG_RF_INIT, + "IC = ((0x%x)), RF_Supportability Init = ((0x%x))\n", + dm->support_ic_type, rf->rf_supportability); +} + +void halrf_watchdog(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &dm->rf_table; +#if 0 + /*RF_DBG(dm, DBG_RF_TMP, "%s\n", __func__);*/ +#endif + + if (rf->is_dpk_in_progress || dm->rf_calibrate_info.is_iqk_in_progress) + return; + + phydm_rf_watchdog(dm); + halrf_dpk_track(dm); +} + +#if 0 +void +halrf_iqk_init( + void *dm_void +) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &dm->rf_table; + + switch (dm->support_ic_type) { +#if (RTL8814B_SUPPORT == 1) + case ODM_RTL8814B: + break; +#endif +#if (RTL8822B_SUPPORT == 1) + case ODM_RTL8822B: + _iq_calibrate_8822b_init(dm); + break; +#endif +#if (RTL8822C_SUPPORT == 1) + case ODM_RTL8822C: + _iq_calibrate_8822c_init(dm); + break; +#endif +#if (RTL8821C_SUPPORT == 1) + case ODM_RTL8821C: + break; +#endif + + default: + break; + } +} +#endif + +void halrf_rf_k_connect_trigger(void *dm_void, boolean is_recovery, + enum halrf_k_segment_time seg_time) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct dm_dpk_info *dpk_info = &dm->dpk_info; + struct _hal_rf_ *rf = &dm->rf_table; + + if (dm->mp_mode && rf->is_con_tx && rf->is_single_tone && + rf->is_carrier_suppresion) { + if (*dm->mp_mode && + (*rf->is_con_tx || *rf->is_single_tone || + *rf->is_carrier_suppresion)) + return; + } + /*[TX GAP K]*/ + + /*[LOK, IQK]*/ + halrf_segment_iqk_trigger(dm, true, seg_time); + + /*[TSSI Trk]*/ + /*halrf_do_tssi(dm);*/ + /*halrf_do_tssi(dm);*/ + /*halrf_tssi_set_de(dm);*/ + + /*[DPK]*/ + if(dpk_info->is_dpk_by_channel == true) + halrf_dpk_trigger(dm); + else + halrf_dpk_reload(dm); +} + +void halrf_dack_trigger(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &dm->rf_table; + + u64 start_time; + + if (!(rf->rf_supportability & HAL_RF_DACK)) + return; + + start_time = odm_get_current_time(dm); + + switch (dm->support_ic_type) { +#if (RTL8822C_SUPPORT == 1) + case ODM_RTL8822C: + halrf_dac_cal_8822c(dm); + break; +#endif +#if (RTL8812F_SUPPORT == 1) + case ODM_RTL8812F: + halrf_dac_cal_8812f(dm); + break; +#endif +#if (RTL8814B_SUPPORT == 1) + case ODM_RTL8814B: + halrf_dac_cal_8814b(dm); + break; +#endif + default: + break; + } + rf->dpk_progressing_time = odm_get_progressing_time(dm, start_time); + RF_DBG(dm, DBG_RF_DACK, "[DACK]DACK progressing_time = %lld ms\n", + rf->dpk_progressing_time); +} + +void halrf_segment_iqk_trigger(void *dm_void, boolean clear, + boolean segment_iqk) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct dm_iqk_info *iqk_info = &dm->IQK_info; + struct _hal_rf_ *rf = &dm->rf_table; + u64 start_time; + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) + if (odm_check_power_status(dm) == false) + return; +#endif + + if (dm->mp_mode && + rf->is_con_tx && + rf->is_single_tone && + rf->is_carrier_suppresion) + if (*dm->mp_mode && + ((*rf->is_con_tx || + *rf->is_single_tone || + *rf->is_carrier_suppresion))) + return; + +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) + if (!(rf->rf_supportability & HAL_RF_IQK)) + return; +#endif + +#if DISABLE_BB_RF + return; +#endif + if (iqk_info->rfk_forbidden) + return; + + if (!dm->rf_calibrate_info.is_iqk_in_progress) { + odm_acquire_spin_lock(dm, RT_IQK_SPINLOCK); + dm->rf_calibrate_info.is_iqk_in_progress = true; + odm_release_spin_lock(dm, RT_IQK_SPINLOCK); + start_time = odm_get_current_time(dm); + dm->IQK_info.segment_iqk = segment_iqk; + + switch (dm->support_ic_type) { +#if (RTL8822B_SUPPORT == 1) + case ODM_RTL8822B: + phy_iq_calibrate_8822b(dm, clear, segment_iqk); + break; +#endif +#if (RTL8822C_SUPPORT == 1) + case ODM_RTL8822C: + phy_iq_calibrate_8822c(dm, clear, segment_iqk); + break; +#endif +#if (RTL8821C_SUPPORT == 1) + case ODM_RTL8821C: + phy_iq_calibrate_8821c(dm, clear, segment_iqk); + break; +#endif +#if (RTL8814B_SUPPORT == 1) + case ODM_RTL8814B: + phy_iq_calibrate_8814b(dm, clear, segment_iqk); + break; +#endif +#if (RTL8195B_SUPPORT == 1) + case ODM_RTL8195B: + phy_iq_calibrate_8195b(dm, clear, segment_iqk); + break; +#endif +/* +#if (RTL8710C_SUPPORT == 1) + case ODM_RTL8710C: + phy_iq_calibrate_8710c(dm, clear, segment_iqk); + break; +#endif +*/ +#if (RTL8198F_SUPPORT == 1) + case ODM_RTL8198F: + phy_iq_calibrate_8198f(dm, clear, segment_iqk); + break; +#endif +#if (RTL8812F_SUPPORT == 1) + case ODM_RTL8812F: + phy_iq_calibrate_8812f(dm, clear, segment_iqk); + break; +#endif +#if (RTL8197G_SUPPORT == 1) + case ODM_RTL8197G: + phy_iq_calibrate_8197g(dm, clear, segment_iqk); + break; +#endif +#if (RTL8188E_SUPPORT == 1) + case ODM_RTL8188E: + phy_iq_calibrate_8188e(dm, false); + break; +#endif +#if (RTL8188F_SUPPORT == 1) + case ODM_RTL8188F: + phy_iq_calibrate_8188f(dm, false); + break; +#endif +#if (RTL8192E_SUPPORT == 1) + case ODM_RTL8192E: + phy_iq_calibrate_8192e(dm, false); + break; +#endif +#if (RTL8197F_SUPPORT == 1) + case ODM_RTL8197F: + phy_iq_calibrate_8197f(dm, false); + break; +#endif +#if (RTL8192F_SUPPORT == 1) + case ODM_RTL8192F: + phy_iq_calibrate_8192f(dm, false); + break; +#endif +#if (RTL8703B_SUPPORT == 1) + case ODM_RTL8703B: + phy_iq_calibrate_8703b(dm, false); + break; +#endif +#if (RTL8710B_SUPPORT == 1) + case ODM_RTL8710B: + phy_iq_calibrate_8710b(dm, false); + break; +#endif +#if (RTL8723B_SUPPORT == 1) + case ODM_RTL8723B: + phy_iq_calibrate_8723b(dm, false); + break; +#endif +#if (RTL8723D_SUPPORT == 1) + case ODM_RTL8723D: + phy_iq_calibrate_8723d(dm, false); + break; +#endif +#if (RTL8721D_SUPPORT == 1) + case ODM_RTL8721D: + phy_iq_calibrate_8721d(dm, false); + break; +#endif +#if (RTL8812A_SUPPORT == 1) + case ODM_RTL8812: + phy_iq_calibrate_8812a(dm, false); + break; +#endif +#if (RTL8821A_SUPPORT == 1) + case ODM_RTL8821: + phy_iq_calibrate_8821a(dm, false); + break; +#endif +#if (RTL8814A_SUPPORT == 1) + case ODM_RTL8814A: + phy_iq_calibrate_8814a(dm, false); + break; +#endif + default: + break; + } + dm->rf_calibrate_info.iqk_progressing_time = + odm_get_progressing_time(dm, start_time); + RF_DBG(dm, DBG_RF_IQK, "[IQK]IQK progressing_time = %lld ms\n", + dm->rf_calibrate_info.iqk_progressing_time); + + odm_acquire_spin_lock(dm, RT_IQK_SPINLOCK); + dm->rf_calibrate_info.is_iqk_in_progress = false; + odm_release_spin_lock(dm, RT_IQK_SPINLOCK); + } else { + RF_DBG(dm, DBG_RF_IQK, + "== Return the IQK CMD, because RFKs in Progress ==\n"); + } +} + + +void halrf_iqk_trigger(void *dm_void, boolean is_recovery) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct dm_iqk_info *iqk_info = &dm->IQK_info; + struct dm_dpk_info *dpk_info = &dm->dpk_info; + struct _hal_rf_ *rf = &dm->rf_table; + u64 start_time; + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) + if (odm_check_power_status(dm) == false) + return; +#endif + + if (dm->mp_mode && + rf->is_con_tx && + rf->is_single_tone && + rf->is_carrier_suppresion) + if (*dm->mp_mode && + ((*rf->is_con_tx || + *rf->is_single_tone || + *rf->is_carrier_suppresion))) + return; + + if (!(rf->rf_supportability & HAL_RF_IQK)) + return; + +#if DISABLE_BB_RF + return; +#endif + + if (iqk_info->rfk_forbidden) + return; + + if (!dm->rf_calibrate_info.is_iqk_in_progress) { + odm_acquire_spin_lock(dm, RT_IQK_SPINLOCK); + dm->rf_calibrate_info.is_iqk_in_progress = true; + odm_release_spin_lock(dm, RT_IQK_SPINLOCK); + start_time = odm_get_current_time(dm); + switch (dm->support_ic_type) { +#if (RTL8188E_SUPPORT == 1) + case ODM_RTL8188E: + phy_iq_calibrate_8188e(dm, is_recovery); + break; +#endif +#if (RTL8188F_SUPPORT == 1) + case ODM_RTL8188F: + phy_iq_calibrate_8188f(dm, is_recovery); + break; +#endif +#if (RTL8192E_SUPPORT == 1) + case ODM_RTL8192E: + phy_iq_calibrate_8192e(dm, is_recovery); + break; +#endif +#if (RTL8197F_SUPPORT == 1) + case ODM_RTL8197F: + phy_iq_calibrate_8197f(dm, is_recovery); + break; +#endif +#if (RTL8192F_SUPPORT == 1) + case ODM_RTL8192F: + phy_iq_calibrate_8192f(dm, is_recovery); + break; +#endif +#if (RTL8703B_SUPPORT == 1) + case ODM_RTL8703B: + phy_iq_calibrate_8703b(dm, is_recovery); + break; +#endif +#if (RTL8710B_SUPPORT == 1) + case ODM_RTL8710B: + phy_iq_calibrate_8710b(dm, is_recovery); + break; +#endif +#if (RTL8723B_SUPPORT == 1) + case ODM_RTL8723B: + phy_iq_calibrate_8723b(dm, is_recovery); + break; +#endif +#if (RTL8723D_SUPPORT == 1) + case ODM_RTL8723D: + phy_iq_calibrate_8723d(dm, is_recovery); + break; +#endif +#if (RTL8721D_SUPPORT == 1) + case ODM_RTL8721D: + phy_iq_calibrate_8721d(dm, is_recovery); + break; +#endif +#if (RTL8812A_SUPPORT == 1) + case ODM_RTL8812: + phy_iq_calibrate_8812a(dm, is_recovery); + break; +#endif +#if (RTL8821A_SUPPORT == 1) + case ODM_RTL8821: + phy_iq_calibrate_8821a(dm, is_recovery); + break; +#endif +#if (RTL8814A_SUPPORT == 1) + case ODM_RTL8814A: + phy_iq_calibrate_8814a(dm, is_recovery); + break; +#endif +#if (RTL8822B_SUPPORT == 1) + case ODM_RTL8822B: + phy_iq_calibrate_8822b(dm, false, false); + break; +#endif +#if (RTL8822C_SUPPORT == 1) + case ODM_RTL8822C: + phy_iq_calibrate_8822c(dm, false, false); + break; +#endif +#if (RTL8821C_SUPPORT == 1) + case ODM_RTL8821C: + phy_iq_calibrate_8821c(dm, false, false); + break; +#endif +#if (RTL8814B_SUPPORT == 1) + case ODM_RTL8814B: + phy_iq_calibrate_8814b(dm, false, false); + //_do_dpk_8814b(dm); + break; +#endif +#if (RTL8195B_SUPPORT == 1) + case ODM_RTL8195B: + phy_iq_calibrate_8195b(dm, false, false); + break; +#endif +#if (RTL8198F_SUPPORT == 1) + case ODM_RTL8198F: + phy_iq_calibrate_8198f(dm, false, false); + break; +#endif +#if (RTL8812F_SUPPORT == 1) + case ODM_RTL8812F: + phy_iq_calibrate_8812f(dm, false, false); + break; +#endif + default: + break; + } + rf->iqk_progressing_time = odm_get_progressing_time(dm, start_time); + RF_DBG(dm, DBG_RF_LCK, "[IQK]Trigger IQK progressing_time = %lld ms\n", + rf->iqk_progressing_time); + odm_acquire_spin_lock(dm, RT_IQK_SPINLOCK); + dm->rf_calibrate_info.is_iqk_in_progress = false; + odm_release_spin_lock(dm, RT_IQK_SPINLOCK); + } else { + RF_DBG(dm, DBG_RF_IQK, + "== Return the IQK CMD, because RFKs in Progress ==\n"); + } +} + +void halrf_lck_trigger(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct dm_iqk_info *iqk_info = &dm->IQK_info; + struct _hal_rf_ *rf = &dm->rf_table; + u64 start_time; + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) + if (odm_check_power_status(dm) == false) + return; +#endif + + if (dm->mp_mode && + rf->is_con_tx && + rf->is_single_tone && + rf->is_carrier_suppresion) + if (*dm->mp_mode && + ((*rf->is_con_tx || + *rf->is_single_tone || + *rf->is_carrier_suppresion))) + return; + + if (!(rf->rf_supportability & HAL_RF_LCK)) + return; + +#if DISABLE_BB_RF + return; +#endif + if (iqk_info->rfk_forbidden) + return; + while (*dm->is_scan_in_process) { + RF_DBG(dm, DBG_RF_IQK, "[LCK]scan is in process, bypass LCK\n"); + return; + } + + if (!dm->rf_calibrate_info.is_lck_in_progress) { + odm_acquire_spin_lock(dm, RT_IQK_SPINLOCK); + dm->rf_calibrate_info.is_lck_in_progress = true; + odm_release_spin_lock(dm, RT_IQK_SPINLOCK); + start_time = odm_get_current_time(dm); + switch (dm->support_ic_type) { +#if (RTL8188E_SUPPORT == 1) + case ODM_RTL8188E: + phy_lc_calibrate_8188e(dm); + break; +#endif +#if (RTL8188F_SUPPORT == 1) + case ODM_RTL8188F: + phy_lc_calibrate_8188f(dm); + break; +#endif +#if (RTL8192E_SUPPORT == 1) + case ODM_RTL8192E: + phy_lc_calibrate_8192e(dm); + break; +#endif +#if (RTL8197F_SUPPORT == 1) + case ODM_RTL8197F: + phy_lc_calibrate_8197f(dm); + break; +#endif +#if (RTL8192F_SUPPORT == 1) + case ODM_RTL8192F: + phy_lc_calibrate_8192f(dm); + break; +#endif +#if (RTL8703B_SUPPORT == 1) + case ODM_RTL8703B: + phy_lc_calibrate_8703b(dm); + break; +#endif +#if (RTL8710B_SUPPORT == 1) + case ODM_RTL8710B: + phy_lc_calibrate_8710b(dm); + break; +#endif +#if (RTL8721D_SUPPORT == 1) + case ODM_RTL8721D: + phy_lc_calibrate_8721d(dm); + break; +#endif +#if (RTL8723B_SUPPORT == 1) + case ODM_RTL8723B: + phy_lc_calibrate_8723b(dm); + break; +#endif +#if (RTL8723D_SUPPORT == 1) + case ODM_RTL8723D: + phy_lc_calibrate_8723d(dm); + break; +#endif +#if (RTL8812A_SUPPORT == 1) + case ODM_RTL8812: + phy_lc_calibrate_8812a(dm); + break; +#endif +#if (RTL8821A_SUPPORT == 1) + case ODM_RTL8821: + phy_lc_calibrate_8821a(dm); + break; +#endif +#if (RTL8814A_SUPPORT == 1) + case ODM_RTL8814A: + phy_lc_calibrate_8814a(dm); + break; +#endif +#if (RTL8822B_SUPPORT == 1) + case ODM_RTL8822B: + phy_lc_calibrate_8822b(dm); + break; +#endif +#if (RTL8822C_SUPPORT == 1) + case ODM_RTL8822C: + phy_lc_calibrate_8822c(dm); + break; +#endif +#if (RTL8812F_SUPPORT == 1) + case ODM_RTL8812F: + phy_lc_calibrate_8812f(dm); + break; +#endif +#if (RTL8821C_SUPPORT == 1) + case ODM_RTL8821C: + phy_lc_calibrate_8821c(dm); + break; +#endif +#if (RTL8814B_SUPPORT == 1) + case ODM_RTL8814B: + break; +#endif + default: + break; + } + dm->rf_calibrate_info.lck_progressing_time = + odm_get_progressing_time(dm, start_time); + RF_DBG(dm, DBG_RF_IQK, "[IQK]LCK progressing_time = %lld ms\n", + dm->rf_calibrate_info.lck_progressing_time); +#if (RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1) + halrf_lck_dbg(dm); +#endif + odm_acquire_spin_lock(dm, RT_IQK_SPINLOCK); + dm->rf_calibrate_info.is_lck_in_progress = false; + odm_release_spin_lock(dm, RT_IQK_SPINLOCK); + } else { + RF_DBG(dm, DBG_RF_IQK, + "= Return the LCK CMD, because RFK is in Progress =\n"); + } +} + +void halrf_aac_check(struct dm_struct *dm) +{ + switch (dm->support_ic_type) { +#if (RTL8821C_SUPPORT == 1) + case ODM_RTL8821C: +#if 0 + aac_check_8821c(dm); +#endif + break; +#endif +#if (RTL8822B_SUPPORT == 1) + case ODM_RTL8822B: +#if 1 + aac_check_8822b(dm); +#endif + break; +#endif + default: + break; + } +} + +void halrf_x2k_check(struct dm_struct *dm) +{ + + switch (dm->support_ic_type) { + case ODM_RTL8821C: +#if (RTL8821C_SUPPORT == 1) +#endif + break; + case ODM_RTL8822C: +#if (RTL8822C_SUPPORT == 1) + phy_x2_check_8822c(dm); + break; +#endif + case ODM_RTL8812F: +#if (RTL8812F_SUPPORT == 1) + phy_x2_check_8812f(dm); + break; +#endif + default: + break; + } +} + +void halrf_init(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &dm->rf_table; + + RF_DBG(dm, DBG_RF_INIT, "HALRF_Init\n"); + rf->aac_checked = false; + halrf_init_debug_setting(dm); + + if (rf->manual_rf_supportability && + *rf->manual_rf_supportability != 0xffffffff) { + rf->rf_supportability = *rf->manual_rf_supportability; + } else if (*dm->mp_mode) { + halrf_supportability_init_mp(dm); + } else { + halrf_supportability_init(dm); + } +#if 1 + /*Init all RF funciton*/ + halrf_aac_check(dm); + halrf_dack_trigger(dm); + halrf_x2k_check(dm); +#endif + + /*power trim, thrmal trim, pa bias*/ + phydm_config_new_kfree(dm); + + /*TSSI Init*/ + halrf_tssi_get_efuse(dm); +} + +void halrf_dpk_trigger(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &dm->rf_table; + struct dm_dpk_info *dpk_info = &dm->dpk_info; + struct dm_iqk_info *iqk_info = &dm->IQK_info; + + u64 start_time; + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) + if (odm_check_power_status(dm) == false) + return; +#endif + + if (dm->mp_mode && + rf->is_con_tx && + rf->is_single_tone && + rf->is_carrier_suppresion) + if (*dm->mp_mode && + ((*rf->is_con_tx || + *rf->is_single_tone || + *rf->is_carrier_suppresion))) + return; + + if (!(rf->rf_supportability & HAL_RF_DPK)) + return; + +#if DISABLE_BB_RF + return; +#endif + + if (iqk_info->rfk_forbidden) + return; + + if (!rf->is_dpk_in_progress) { + odm_acquire_spin_lock(dm, RT_IQK_SPINLOCK); + rf->is_dpk_in_progress = true; + odm_release_spin_lock(dm, RT_IQK_SPINLOCK); + start_time = odm_get_current_time(dm); + + switch (dm->support_ic_type) { +#if (RTL8822C_SUPPORT == 1) + case ODM_RTL8822C: + do_dpk_8822c(dm); + break; +#endif + +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) +#if (RTL8197F_SUPPORT == 1) + case ODM_RTL8197F: + do_dpk_8197f(dm); + break; +#endif +#if (RTL8192F_SUPPORT == 1) + case ODM_RTL8192F: + do_dpk_8192f(dm); + break; +#endif + +#if (RTL8198F_SUPPORT == 1) + case ODM_RTL8198F: + do_dpk_8198f(dm); + break; +#endif +#if (RTL8812F_SUPPORT == 1) + case ODM_RTL8812F: + do_dpk_8812f(dm); + break; +#endif + +#endif + +#if (RTL8814B_SUPPORT == 1) + case ODM_RTL8814B: + do_dpk_8814b(dm); + break; +#endif + +#if (DM_ODM_SUPPORT_TYPE & (ODM_IOT)) +#if (RTL8195B_SUPPORT == 1) + case ODM_RTL8195B: + do_dpk_8195b(dm); + break; +#endif +#endif + default: + break; + } + rf->dpk_progressing_time = odm_get_progressing_time(dm, start_time); + RF_DBG(dm, DBG_RF_DPK, "[DPK]DPK progressing_time = %lld ms\n", + rf->dpk_progressing_time); + + odm_acquire_spin_lock(dm, RT_IQK_SPINLOCK); + rf->is_dpk_in_progress = false; + odm_release_spin_lock(dm, RT_IQK_SPINLOCK); + } else { + RF_DBG(dm, DBG_RF_DPK, + "== Return the DPK CMD, because RFKs in Progress ==\n"); + } +} + +void halrf_set_dpkbychannel(void *dm_void, boolean dpk_by_ch) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &dm->rf_table; + struct dm_dpk_info *dpk_info = &dm->dpk_info; + struct dm_iqk_info *iqk_info = &dm->IQK_info; + + + switch (dm->support_ic_type) { +#if (RTL8814B_SUPPORT == 1) + case ODM_RTL8814B: + dpk_set_dpkbychannel_8814b(dm, dpk_by_ch); + break; +#endif + +#if (DM_ODM_SUPPORT_TYPE & (ODM_IOT)) +#if (RTL8195B_SUPPORT == 1) + case ODM_RTL8195B: + dpk_set_dpkbychannel_8195b(dm,dpk_by_ch); + break; +#endif +#endif + default: + if (dpk_by_ch) + dpk_info->is_dpk_by_channel = 1; + else + dpk_info->is_dpk_by_channel = 0; + break; + } + +} + +void halrf_set_dpkenable(void *dm_void, boolean is_dpk_enable) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &dm->rf_table; + struct dm_dpk_info *dpk_info = &dm->dpk_info; + struct dm_iqk_info *iqk_info = &dm->IQK_info; + + + switch (dm->support_ic_type) { +#if (RTL8814B_SUPPORT == 1) + case ODM_RTL8814B: + dpk_set_is_dpk_enable_8814b(dm, is_dpk_enable); + break; +#endif + +#if (DM_ODM_SUPPORT_TYPE & (ODM_IOT)) +#if (RTL8195B_SUPPORT == 1) + case ODM_RTL8195B: + dpk_set_is_dpk_enable_8195b(dm, is_dpk_enable); + break; +#endif +#endif + + + default: + break; + } + +} +boolean halrf_get_dpkbychannel(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &dm->rf_table; + struct dm_dpk_info *dpk_info = &dm->dpk_info; + struct dm_iqk_info *iqk_info = &dm->IQK_info; + boolean is_dpk_by_channel = true; + + switch (dm->support_ic_type) { +#if (RTL8814B_SUPPORT == 1) + case ODM_RTL8814B: + is_dpk_by_channel = dpk_get_dpkbychannel_8814b(dm); + break; +#endif + +#if (DM_ODM_SUPPORT_TYPE & (ODM_IOT)) +#if (RTL8195B_SUPPORT == 1) + case ODM_RTL8195B: + is_dpk_by_channel = dpk_get_dpkbychannel_8195b(dm); + break; +#endif +#endif + + default: + break; + } + return is_dpk_by_channel; + +} + + +boolean halrf_get_dpkenable(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &dm->rf_table; + struct dm_dpk_info *dpk_info = &dm->dpk_info; + struct dm_iqk_info *iqk_info = &dm->IQK_info; + boolean is_dpk_enable = true; + + + switch (dm->support_ic_type) { +#if (RTL8814B_SUPPORT == 1) + case ODM_RTL8814B: + is_dpk_enable = dpk_get_is_dpk_enable_8814b(dm); + break; +#endif + +#if (DM_ODM_SUPPORT_TYPE & (ODM_IOT)) +#if (RTL8195B_SUPPORT == 1) + case ODM_RTL8195B: + is_dpk_enable = dpk_get_is_dpk_enable_8195b(dm); + break; +#endif +#endif + default: + break; + } + return is_dpk_enable; + +} + +u8 halrf_dpk_result_check(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct dm_dpk_info *dpk_info = &dm->dpk_info; + + u8 result = 0; + + switch (dm->support_ic_type) { +#if (RTL8822C_SUPPORT == 1) + case ODM_RTL8822C: + if (dpk_info->dpk_path_ok == 0x3) + result = 1; + else + result = 0; + break; +#endif + +#if (RTL8195B_SUPPORT == 1) + case ODM_RTL8195B: + if (dpk_info->dpk_path_ok == 0x1) + result = 1; + else + result = 0; + break; +#endif + +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + +#if (RTL8197F_SUPPORT == 1) + case ODM_RTL8197F: + if (dpk_info->dpk_path_ok == 0x3) + result = 1; + else + result = 0; + break; +#endif + +#if (RTL8192F_SUPPORT == 1) + case ODM_RTL8192F: + if (dpk_info->dpk_path_ok == 0x3) + result = 1; + else + result = 0; + break; +#endif + +#if (RTL8198F_SUPPORT == 1) + case ODM_RTL8198F: + if (dpk_info->dpk_path_ok == 0xf) + result = 1; + else + result = 0; + break; +#endif + +#if (RTL8814B_SUPPORT == 1) + case ODM_RTL8814B: + if (dpk_info->dpk_path_ok == 0xf) + result = 1; + else + result = 0; + break; +#endif + +#if (RTL8812F_SUPPORT == 1) + case ODM_RTL8812F: + if (dpk_info->dpk_path_ok == 0x3) + result = 1; + else + result = 0; + break; +#endif + +#endif + default: + break; + } + return result; +} + +void halrf_dpk_sram_read(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + u8 path, group; + + switch (dm->support_ic_type) { +#if (RTL8822C_SUPPORT == 1) + case ODM_RTL8822C: + dpk_coef_read_8822c(dm); + break; +#endif + +#if (RTL8195B_SUPPORT == 1) + case ODM_RTL8195B: + dpk_sram_read_8195b(dm); + break; +#endif + +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + +#if (RTL8197F_SUPPORT == 1) + case ODM_RTL8197F: + dpk_sram_read_8197f(dm); + break; +#endif + +#if (RTL8192F_SUPPORT == 1) + case ODM_RTL8192F: + dpk_sram_read_8192f(dm); + break; +#endif + +#if (RTL8198F_SUPPORT == 1) + case ODM_RTL8198F: + dpk_sram_read_8198f(dm); + break; +#endif + +#if (RTL8814B_SUPPORT == 1) + case ODM_RTL8814B: + dpk_sram_read_8814b(dm); + break; +#endif + +#if (RTL8812F_SUPPORT == 1) + case ODM_RTL8812F: + dpk_coef_read_8812f(dm); + break; +#endif + + +#endif + default: + break; + } +} + +void halrf_dpk_enable_disable(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &dm->rf_table; + + if (!(rf->rf_supportability & HAL_RF_DPK)) + return; + + if (!rf->is_dpk_in_progress) { + odm_acquire_spin_lock(dm, RT_IQK_SPINLOCK); + rf->is_dpk_in_progress = true; + odm_release_spin_lock(dm, RT_IQK_SPINLOCK); + + switch (dm->support_ic_type) { +#if (RTL8822C_SUPPORT == 1) + case ODM_RTL8822C: + dpk_enable_disable_8822c(dm); + break; +#endif +#if (RTL8195B_SUPPORT == 1) + case ODM_RTL8195B: + dpk_enable_disable_8195b(dm); + break; +#endif + +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + +#if (RTL8197F_SUPPORT == 1) + case ODM_RTL8197F: + phy_dpk_enable_disable_8197f(dm); + break; +#endif +#if (RTL8192F_SUPPORT == 1) + case ODM_RTL8192F: + phy_dpk_enable_disable_8192f(dm); + break; +#endif + +#if (RTL8198F_SUPPORT == 1) + case ODM_RTL8198F: + dpk_enable_disable_8198f(dm); + break; +#endif + +#if (RTL8814B_SUPPORT == 1) + case ODM_RTL8814B: + dpk_enable_disable_8814b(dm); + break; +#endif + +#if (RTL8812F_SUPPORT == 1) + case ODM_RTL8812F: + dpk_enable_disable_8812f(dm); + break; +#endif + + +#endif + default: + break; + } + + odm_acquire_spin_lock(dm, RT_IQK_SPINLOCK); + rf->is_dpk_in_progress = false; + odm_release_spin_lock(dm, RT_IQK_SPINLOCK); + } else { + RF_DBG(dm, DBG_RF_DPK, + "== Return the DPK CMD, because RFKs in Progress ==\n"); + } +} + +void halrf_dpk_track(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct dm_dpk_info *dpk_info = &dm->dpk_info; + struct _hal_rf_ *rf = &dm->rf_table; + + if (rf->is_dpk_in_progress || dm->rf_calibrate_info.is_iqk_in_progress || + dm->is_psd_in_process || (dpk_info->dpk_path_ok == 0) || + !(rf->rf_supportability & HAL_RF_DPK_TRACK)) + return; + + switch (dm->support_ic_type) { +#if (RTL8814B_SUPPORT == 1) + case ODM_RTL8814B: + dpk_track_8814b(dm); + break; +#endif + +#if (RTL8822C_SUPPORT == 1) + case ODM_RTL8822C: + dpk_track_8822c(dm); + break; +#endif + +#if (RTL8195B_SUPPORT == 1) + case ODM_RTL8195B: + dpk_track_8195b(dm); + break; +#endif + +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + +#if (RTL8197F_SUPPORT == 1) + case ODM_RTL8197F: + phy_dpk_track_8197f(dm); + break; +#endif + +#if (RTL8192F_SUPPORT == 1) + case ODM_RTL8192F: + phy_dpk_track_8192f(dm); + break; +#endif + +#if (RTL8198F_SUPPORT == 1) + case ODM_RTL8198F: + dpk_track_8198f(dm); + break; +#endif + +#if (RTL8812F_SUPPORT == 1) + case ODM_RTL8812F: + dpk_track_8812f(dm); + break; +#endif + +#endif + default: + break; + } +} + +void halrf_set_dpk_track(void *dm_void, u8 enable) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &(dm->rf_table); + + if (enable) + rf->rf_supportability = rf->rf_supportability | HAL_RF_DPK_TRACK; + else + rf->rf_supportability = rf->rf_supportability & ~HAL_RF_DPK_TRACK; +} + +void halrf_dpk_reload(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct dm_dpk_info *dpk_info = &dm->dpk_info; + + switch (dm->support_ic_type) { +#if (RTL8195B_SUPPORT == 1) + case ODM_RTL8195B: + if (dpk_info->dpk_path_ok > 0) + dpk_reload_8195b(dm); + break; +#endif + +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + +#if (RTL8197F_SUPPORT == 1) + case ODM_RTL8197F: + if (dpk_info->dpk_path_ok > 0) + dpk_reload_8197f(dm); + break; +#endif + +#if (RTL8192F_SUPPORT == 1) + case ODM_RTL8192F: + if (dpk_info->dpk_path_ok > 0) + dpk_reload_8192f(dm); + + break; +#endif + +#if (RTL8198F_SUPPORT == 1) + case ODM_RTL8198F: + if (dpk_info->dpk_path_ok > 0) + dpk_reload_8198f(dm); + break; +#endif + +#if (RTL8814B_SUPPORT == 1) + case ODM_RTL8814B: + if (dpk_info->dpk_path_ok > 0) + dpk_reload_8814b(dm); + break; +#endif + +#endif + default: + break; + } +} + +void halrf_dpk_info_rsvd_page(void *dm_void, u8 *buf, u32 *buf_size) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &dm->rf_table; + struct dm_dpk_info *dpk_info = &dm->dpk_info; + + if (!(rf->rf_supportability & HAL_RF_DPK) || rf->is_dpk_in_progress) + return; + + switch (dm->support_ic_type) { +#if (RTL8822C_SUPPORT == 1) + case ODM_RTL8822C: + dpk_info_rsvd_page_8822c(dm, buf, buf_size); + break; +#endif + default: + break; + } +} + +enum hal_status +halrf_config_rfk_with_header_file(void *dm_void, u32 config_type) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + enum hal_status result = HAL_STATUS_SUCCESS; +#if 0 +#if (RTL8822B_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8822B) { + if (config_type == CONFIG_BB_RF_CAL_INIT) + odm_read_and_config_mp_8822b_cal_init(dm); + } +#endif +#endif +#if (RTL8198F_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8198F) { + if (config_type == CONFIG_BB_RF_CAL_INIT) + odm_read_and_config_mp_8198f_cal_init(dm); + } +#endif +#if (RTL8812F_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8812F) { + if (config_type == CONFIG_BB_RF_CAL_INIT) + odm_read_and_config_mp_8812f_cal_init(dm); + } +#endif +#if (RTL8822C_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8822C) { + if (config_type == CONFIG_BB_RF_CAL_INIT) + odm_read_and_config_mp_8822c_cal_init(dm); + } +#endif +#if (RTL8814B_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8814B) { + if (config_type == CONFIG_BB_RF_CAL_INIT) + odm_read_and_config_mp_8814b_cal_init(dm); + } +#endif +#if (RTL8195B_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8195B) { + if (config_type == CONFIG_BB_RF_CAL_INIT) + odm_read_and_config_mp_8195b_cal_init(dm); + } +#endif + return result; +} + +void halrf_txgapk_trigger(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &dm->rf_table; + + u64 start_time; + + start_time = odm_get_current_time(dm); + + switch (dm->support_ic_type) { +#if (DM_ODM_SUPPORT_TYPE & (ODM_IOT)) +#if (RTL8195B_SUPPORT == 1) + case ODM_RTL8195B: + phy_txgap_calibrate_8195b(dm, false); + break; +#endif +#endif + + default: + break; + } + rf->dpk_progressing_time = + odm_get_progressing_time(dm_void, start_time); + RF_DBG(dm, DBG_RF_TXGAPK, "[TGGC]TXGAPK progressing_time = %lld ms\n", + rf->dpk_progressing_time); +} + +void halrf_tssi_get_efuse(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + +#if (RTL8822C_SUPPORT == 1) + if (dm->support_ic_type & ODM_RTL8822C) { + /*halrf_tssi_get_efuse_8822c(dm);*/ + /*halrf_tssi_get_kfree_efuse_8822c(dm);*/ + halrf_get_efuse_thermal_pwrtype_8822c(dm); + } +#endif + +#if (RTL8814B_SUPPORT == 1) + if (dm->support_ic_type & ODM_RTL8814B) { + halrf_tssi_get_efuse_8814b(dm); + } +#endif + +} + +void halrf_do_tssi(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + +#if (RTL8822C_SUPPORT == 1) + /*halrf_do_tssi_8822c(dm);*/ + halrf_do_thermal_8822c(dm); + +#endif +} + +void halrf_do_thermal(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + +#if (RTL8822C_SUPPORT == 1) + halrf_do_thermal_8822c(dm); +#endif +} + + + +u32 halrf_set_tssi_value(void *dm_void, u32 tssi_value) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + +#if (RTL8822C_SUPPORT == 1) + return halrf_set_tssi_value_8822c(dm, tssi_value); +#endif + return 0; +} + +void halrf_set_tssi_power(void *dm_void, s8 power) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + +#if (RTL8822C_SUPPORT == 1) + /*halrf_set_tssi_poewr_8822c(dm, power);*/ +#endif +} + +void halrf_tssi_set_de_for_tx_verify(void *dm_void, u32 tssi_de, u8 path) +{ + return; +} +u32 halrf_query_tssi_value(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + +#if (RTL8822C_SUPPORT == 1) + /*return halrf_query_tssi_value_8822c(dm);*/ +#endif + return 0; +} + +void halrf_tssi_cck(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + +#if (RTL8822C_SUPPORT == 1) + /*halrf_tssi_cck_8822c(dm);*/ + halrf_thermal_cck_8822c(dm); +#endif + +} + +void halrf_thermal_cck(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + +#if (RTL8822C_SUPPORT == 1) + halrf_thermal_cck_8822c(dm); +#endif + +} + +void halrf_tssi_set_de(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + +#if (RTL8814B_SUPPORT == 1) + if (dm->support_ic_type & ODM_RTL8814B) + halrf_tssi_set_de_8814b(dm); +#endif +} + +void halrf_tssi_dck(void *dm_void, u8 direct_do) +{ + +} + +void halrf_calculate_tssi_codeword(void *dm_void) +{ + +} + +void halrf_set_tssi_codeword(void *dm_void) +{ + +} + +u8 halrf_get_tssi_codeword_for_txindex(void *dm_void) +{ + return 0; +} + + +u32 halrf_tssi_get_de(void *dm_void, u8 path) +{ + return 0; +} + +/*Golbal function*/ +void halrf_reload_bp(void *dm_void, u32 *bp_reg, u32 *bp, u32 num) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 i; + + for (i = 0; i < num; i++) + odm_write_4byte(dm, bp_reg[i], bp[i]); +} + +void halrf_reload_bprf(void *dm_void, u32 *bp_reg, u32 bp[][4], u32 num, + u8 ss) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 i, path; + + for (i = 0; i < num; i++) { + for (path = 0; path < ss; path++) + odm_set_rf_reg(dm, (enum rf_path)path, bp_reg[i], + MASK20BITS, bp[i][path]); + } +} + +void halrf_bp(void *dm_void, u32 *bp_reg, u32 *bp, u32 num) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 i; + + for (i = 0; i < num; i++) + bp[i] = odm_read_4byte(dm, bp_reg[i]); +} + +void halrf_bprf(void *dm_void, u32 *bp_reg, u32 bp[][4], u32 num, u8 ss) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 i, path; + + for (i = 0; i < num; i++) { + for (path = 0; path < ss; path++) { + bp[i][path] = + odm_get_rf_reg(dm, (enum rf_path)path, + bp_reg[i], MASK20BITS); + } + } +} + +void halrf_swap(void *dm_void, u32 *v1, u32 *v2) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 temp; + + temp = *v1; + *v1 = *v2; + *v2 = temp; +} + +void halrf_bubble(void *dm_void, u32 *v1, u32 *v2) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 temp; + + if (*v1 >= 0x200 && *v2 >= 0x200) { + if (*v1 > *v2) + halrf_swap(dm, v1, v2); + } else if (*v1 < 0x200 && *v2 < 0x200) { + if (*v1 > *v2) + halrf_swap(dm, v1, v2); + } else if (*v1 < 0x200 && *v2 >= 0x200) { + halrf_swap(dm, v1, v2); + } +} + +void halrf_b_sort(void *dm_void, u32 *iv, u32 *qv) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 temp; + u32 i, j; + + RF_DBG(dm, DBG_RF_DACK, "[DACK]bubble!!!!!!!!!!!!"); + for (i = 0; i < SN - 1; i++) { + for (j = 0; j < (SN - 1 - i) ; j++) { + halrf_bubble(dm, &iv[j], &iv[j + 1]); + halrf_bubble(dm, &qv[j], &qv[j + 1]); + } + } +} + +void halrf_minmax_compare(void *dm_void, u32 value, u32 *min, + u32 *max) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (value >= 0x200) { + if (*min >= 0x200) { + if (*min > value) + *min = value; + } else { + *min = value; + } + if (*max >= 0x200) { + if (*max < value) + *max = value; + } + } else { + if (*min < 0x200) { + if (*min > value) + *min = value; + } + + if (*max >= 0x200) { + *max = value; + } else { + if (*max < value) + *max = value; + } + } +} + +u32 halrf_delta(void *dm_void, u32 v1, u32 v2) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (v1 >= 0x200 && v2 >= 0x200) { + if (v1 > v2) + return v1 - v2; + else + return v2 - v1; + } else if (v1 >= 0x200 && v2 < 0x200) { + return v2 + (0x400 - v1); + } else if (v1 < 0x200 && v2 >= 0x200) { + return v1 + (0x400 - v2); + } + + if (v1 > v2) + return v1 - v2; + else + return v2 - v1; +} + +boolean halrf_compare(void *dm_void, u32 value) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + boolean fail = false; + + if (value >= 0x200 && (0x400 - value) > 0x64) + fail = true; + else if (value < 0x200 && value > 0x64) + fail = true; + + if (fail) + RF_DBG(dm, DBG_RF_DACK, "[DACK]overflow!!!!!!!!!!!!!!!"); + return fail; +} + +void halrf_mode(void *dm_void, u32 *i_value, u32 *q_value) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 iv[SN], qv[SN], im[SN], qm[SN], temp, temp1, temp2; + u32 p, m, t; + u32 i_max = 0, q_max = 0, i_min = 0x0, q_min = 0x0, c = 0x0; + u32 i_delta, q_delta; + u8 i, j, ii = 0, qi = 0; + boolean fail = false; + + ODM_delay_ms(10); + for (i = 0; i < SN; i++) { + im[i] = 0; + qm[i] = 0; + } + i = 0; + c = 0; + while (i < SN && c < 1000) { + c++; + temp = odm_get_bb_reg(dm, 0x2dbc, 0x3fffff); + iv[i] = (temp & 0x3ff000) >> 12; + qv[i] = temp & 0x3ff; + + fail = false; + if (halrf_compare(dm, iv[i])) + fail = true; + if (halrf_compare(dm, qv[i])) + fail = true; + if (!fail) + i++; + } + c = 0; + do { + c++; + i_min = iv[0]; + i_max = iv[0]; + q_min = qv[0]; + q_max = qv[0]; + for (i = 0; i < SN; i++) { + halrf_minmax_compare(dm, iv[i], &i_min, &i_max); + halrf_minmax_compare(dm, qv[i], &q_min, &q_max); + } + RF_DBG(dm, DBG_RF_DACK, "[DACK]i_min=0x%x, i_max=0x%x", + i_min, i_max); + RF_DBG(dm, DBG_RF_DACK, "[DACK]q_min=0x%x, q_max=0x%x", + q_min, q_max); + if (i_max < 0x200 && i_min < 0x200) + i_delta = i_max - i_min; + else if (i_max >= 0x200 && i_min >= 0x200) + i_delta = i_max - i_min; + else + i_delta = i_max + (0x400 - i_min); + + if (q_max < 0x200 && q_min < 0x200) + q_delta = q_max - q_min; + else if (q_max >= 0x200 && q_min >= 0x200) + q_delta = q_max - q_min; + else + q_delta = q_max + (0x400 - q_min); + RF_DBG(dm, DBG_RF_DACK, "[DACK]i_delta=0x%x, q_delta=0x%x", + i_delta, q_delta); + halrf_b_sort(dm, iv, qv); + if (i_delta > 5 || q_delta > 5) { + temp = odm_get_bb_reg(dm, 0x2dbc, 0x3fffff); + iv[0] = (temp & 0x3ff000) >> 12; + qv[0] = temp & 0x3ff; + temp = odm_get_bb_reg(dm, 0x2dbc, 0x3fffff); + iv[SN - 1] = (temp & 0x3ff000) >> 12; + qv[SN - 1] = temp & 0x3ff; + } else { + break; + } + } while (c < 100); +#if 1 +#if 0 + for (i = 0; i < SN; i++) + RF_DBG(dm, DBG_RF_DACK, "[DACK]iv[%d] = 0x%x\n", i, iv[i]); + for (i = 0; i < SN; i++) + RF_DBG(dm, DBG_RF_DACK, "[DACK]qv[%d] = 0x%x\n", i, qv[i]); +#endif + /*i*/ + m = 0; + p = 0; + for (i = 10; i < SN - 10; i++) { + if (iv[i] > 0x200) + m = (0x400 - iv[i]) + m; + else + p = iv[i] + p; + } + + if (p > m) { + t = p - m; + t = t / (SN - 20); + } else { + t = m - p; + t = t / (SN - 20); + if (t != 0x0) + t = 0x400 - t; + } + *i_value = t; + /*q*/ + m = 0; + p = 0; + for (i = 10; i < SN - 10; i++) { + if (qv[i] > 0x200) + m = (0x400 - qv[i]) + m; + else + p = qv[i] + p; + } + if (p > m) { + t = p - m; + t = t / (SN - 20); + } else { + t = m - p; + t = t / (SN - 20); + if (t != 0x0) + t = 0x400 - t; + } + *q_value = t; +#endif +} + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf.h new file mode 100644 index 000000000000..56dd503ec796 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf.h @@ -0,0 +1,680 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +#ifndef __HALRF_H__ +#define __HALRF_H__ + +/*@============================================================*/ +/*@include files*/ +/*@============================================================*/ +#include "halrf/halrf_psd.h" +#if (RTL8822B_SUPPORT == 1) +#include "halrf/rtl8822b/halrf_rfk_init_8822b.h" +#endif +#if (RTL8822C_SUPPORT == 1) +#include "halrf/rtl8822c/halrf_rfk_init_8822c.h" +#include "halrf/rtl8822c/halrf_iqk_8822c.h" +#include "halrf/rtl8822c/halrf_tssi_8822c.h" +#include "halrf/rtl8822c/halrf_dpk_8822c.h" +#endif + +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) +#if (RTL8198F_SUPPORT == 1) +#include "halrf/rtl8198f/halrf_rfk_init_8198f.h" +#endif +#if (RTL8812F_SUPPORT == 1) +#include "halrf/rtl8812f/halrf_rfk_init_8812f.h" +#endif + +#endif + +#if (RTL8814B_SUPPORT == 1) +#include "halrf/rtl8814b/halrf_rfk_init_8814b.h" +#include "halrf/rtl8814b/halrf_iqk_8814b.h" +#include "halrf/rtl8814b/halrf_dpk_8814b.h" +#endif + +/*@============================================================*/ +/*@Definition */ +/*@============================================================*/ +/*IQK version*/ +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) +#define IQK_VER_8188E "0x14" +#define IQK_VER_8192E "0x01" +#define IQK_VER_8192F "0x01" +#define IQK_VER_8723B "0x1e" +#define IQK_VER_8812A "0x02" +#define IQK_VER_8821A "0x01" +#elif (DM_ODM_SUPPORT_TYPE & (ODM_CE)) +#define IQK_VER_8188E "0x01" +#define IQK_VER_8192E "0x01" +#define IQK_VER_8192F "0x01" +#define IQK_VER_8723B "0x1e" +#define IQK_VER_8812A "0x01" +#define IQK_VER_8821A "0x01" +#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) +#define IQK_VER_8188E "0x01" +#define IQK_VER_8192E "0x01" +#define IQK_VER_8192F "0x01" +#define IQK_VER_8723B "0x1e" +#define IQK_VER_8812A "0x01" +#define IQK_VER_8821A "0x01" +#elif (DM_ODM_SUPPORT_TYPE & (ODM_IOT)) +#define IQK_VER_8188E "0x01" +#define IQK_VER_8192E "0x01" +#define IQK_VER_8192F "0x01" +#define IQK_VER_8723B "0x1e" +#define IQK_VER_8812A "0x01" +#define IQK_VER_8821A "0x01" +#endif +#define IQK_VER_8814A "0x0f" +#define IQK_VER_8188F "0x01" +#define IQK_VER_8197F "0x1d" +#define IQK_VER_8703B "0x05" +#define IQK_VER_8710B "0x01" +#define IQK_VER_8723D "0x02" +#define IQK_VER_8822B "0x30" +#define IQK_VER_8822C "0x0b" +#define IQK_VER_8821C "0x23" +#define IQK_VER_8198F "0x09" +#define IQK_VER_8814B "0x0b" +#define IQK_VER_8812F "0x07" + +/*LCK version*/ +#define LCK_VER_8188E "0x01" +#define LCK_VER_8192E "0x01" +#define LCK_VER_8192F "0x01" +#define LCK_VER_8723B "0x01" +#define LCK_VER_8812A "0x01" +#define LCK_VER_8821A "0x01" +#define LCK_VER_8814A "0x01" +#define LCK_VER_8188F "0x01" +#define LCK_VER_8197F "0x01" +#define LCK_VER_8703B "0x01" +#define LCK_VER_8710B "0x01" +#define LCK_VER_8723D "0x01" +#define LCK_VER_8822B "0x02" +#define LCK_VER_8822C "0x00" +#define LCK_VER_8821C "0x02" +#define LCK_VER_8814B "0x00" +#define LCK_VER_8195B "0x02" + +/*power tracking version*/ +#define PWRTRK_VER_8188E "0x01" +#define PWRTRK_VER_8192E "0x01" +#define PWRTRK_VER_8192F "0x01" +#define PWRTRK_VER_8723B "0x01" +#define PWRTRK_VER_8812A "0x01" +#define PWRTRK_VER_8821A "0x01" +#define PWRTRK_VER_8814A "0x01" +#define PWRTRK_VER_8188F "0x01" +#define PWRTRK_VER_8197F "0x01" +#define PWRTRK_VER_8703B "0x01" +#define PWRTRK_VER_8710B "0x01" +#define PWRTRK_VER_8723D "0x01" +#define PWRTRK_VER_8822B "0x01" +#define PWRTRK_VER_8822C "0x00" +#define PWRTRK_VER_8821C "0x01" +#define PWRTRK_VER_8814B "0x00" + +/*DPK version*/ +#define DPK_VER_8188E "NONE" +#define DPK_VER_8192E "NONE" +#define DPK_VER_8723B "NONE" +#define DPK_VER_8812A "NONE" +#define DPK_VER_8821A "NONE" +#define DPK_VER_8814A "NONE" +#define DPK_VER_8188F "NONE" +#define DPK_VER_8197F "0x08" +#define DPK_VER_8703B "NONE" +#define DPK_VER_8710B "NONE" +#define DPK_VER_8723D "NONE" +#define DPK_VER_8822B "NONE" +#define DPK_VER_8822C "0x18" +#define DPK_VER_8821C "NONE" +#define DPK_VER_8192F "0x0d" +#define DPK_VER_8198F "0x0a" +#define DPK_VER_8814B "0x04" +#define DPK_VER_8195B "0x0a" +#define DPK_VER_8812F "0x02" + +/*RFK_INIT version*/ +#define RFK_INIT_VER_8822B "0x8" +#define RFK_INIT_VER_8822C "0x7" +#define RFK_INIT_VER_8195B "0x1" +#define RFK_INIT_VER_8198F "0x5" +#define RFK_INIT_VER_8814B "0x5" +#define RFK_INIT_VER_8812F "0x2" + + +/*DACK version*/ +#define DACK_VER_8822C "0x5" +#define DACK_VER_8814B "0x3" + +/*Kfree tracking version*/ +#define KFREE_VER_8188E \ + (dm->power_trim_data.flag & KFREE_FLAG_ON) ? "0x01" : "NONE" +#define KFREE_VER_8192E \ + (dm->power_trim_data.flag & KFREE_FLAG_ON) ? "0x01" : "NONE" +#define KFREE_VER_8192F \ + (dm->power_trim_data.flag & KFREE_FLAG_ON) ? "0x01" : "NONE" +#define KFREE_VER_8723B \ + (dm->power_trim_data.flag & KFREE_FLAG_ON) ? "0x01" : "NONE" +#define KFREE_VER_8812A \ + (dm->power_trim_data.flag & KFREE_FLAG_ON) ? "0x01" : "NONE" +#define KFREE_VER_8821A \ + (dm->power_trim_data.flag & KFREE_FLAG_ON) ? "0x01" : "NONE" +#define KFREE_VER_8814A \ + (dm->power_trim_data.flag & KFREE_FLAG_ON) ? "0x01" : "NONE" +#define KFREE_VER_8188F \ + (dm->power_trim_data.flag & KFREE_FLAG_ON) ? "0x01" : "NONE" +#define KFREE_VER_8197F \ + (dm->power_trim_data.flag & KFREE_FLAG_ON) ? "0x01" : "NONE" +#define KFREE_VER_8703B \ + (dm->power_trim_data.flag & KFREE_FLAG_ON) ? "0x01" : "NONE" +#define KFREE_VER_8710B \ + (dm->power_trim_data.flag & KFREE_FLAG_ON) ? "0x01" : "NONE" +#define KFREE_VER_8723D \ + (dm->power_trim_data.flag & KFREE_FLAG_ON) ? "0x01" : "NONE" +#define KFREE_VER_8822B \ + (dm->power_trim_data.flag & KFREE_FLAG_ON) ? "0x01" : "NONE" +#define KFREE_VER_8822C \ + (dm->power_trim_data.flag & KFREE_FLAG_ON) ? "0x01" : "NONE" +#define KFREE_VER_8821C \ + (dm->power_trim_data.flag & KFREE_FLAG_ON) ? "0x01" : "NONE" +#define KFREE_VER_8814B \ + (dm->power_trim_data.flag & KFREE_FLAG_ON) ? "0x01" : "NONE" + +/*PA Bias Calibration version*/ +#define PABIASK_VER_8188E \ + (dm->power_trim_data.pa_bias_flag & PA_BIAS_FLAG_ON) ? "0x01" : "NONE" +#define PABIASK_VER_8192E \ + (dm->power_trim_data.pa_bias_flag & PA_BIAS_FLAG_ON) ? "0x01" : "NONE" +#define PABIASK_VER_8192F \ + (dm->power_trim_data.pa_bias_flag & PA_BIAS_FLAG_ON) ? "0x01" : "NONE" +#define PABIASK_VER_8723B \ + (dm->power_trim_data.pa_bias_flag & PA_BIAS_FLAG_ON) ? "0x01" : "NONE" +#define PABIASK_VER_8812A \ + (dm->power_trim_data.pa_bias_flag & PA_BIAS_FLAG_ON) ? "0x01" : "NONE" +#define PABIASK_VER_8821A \ + (dm->power_trim_data.pa_bias_flag & PA_BIAS_FLAG_ON) ? "0x01" : "NONE" +#define PABIASK_VER_8814A \ + (dm->power_trim_data.pa_bias_flag & PA_BIAS_FLAG_ON) ? "0x01" : "NONE" +#define PABIASK_VER_8188F \ + (dm->power_trim_data.pa_bias_flag & PA_BIAS_FLAG_ON) ? "0x01" : "NONE" +#define PABIASK_VER_8197F \ + (dm->power_trim_data.pa_bias_flag & PA_BIAS_FLAG_ON) ? "0x01" : "NONE" +#define PABIASK_VER_8703B \ + (dm->power_trim_data.pa_bias_flag & PA_BIAS_FLAG_ON) ? "0x01" : "NONE" +#define PABIASK_VER_8710B \ + (dm->power_trim_data.pa_bias_flag & PA_BIAS_FLAG_ON) ? "0x01" : "NONE" +#define PABIASK_VER_8723D \ + (dm->power_trim_data.pa_bias_flag & PA_BIAS_FLAG_ON) ? "0x01" : "NONE" +#define PABIASK_VER_8822B \ + (dm->power_trim_data.pa_bias_flag & PA_BIAS_FLAG_ON) ? "0x01" : "NONE" +#define PABIASK_VER_8822C \ + (dm->power_trim_data.pa_bias_flag & PA_BIAS_FLAG_ON) ? "0x01" : "NONE" +#define PABIASK_VER_8821C \ + (dm->power_trim_data.pa_bias_flag & PA_BIAS_FLAG_ON) ? "0x01" : "NONE" +#define PABIASK_VER_8814B \ + (dm->power_trim_data.pa_bias_flag & PA_BIAS_FLAG_ON) ? "0x01" : "NONE" + +#define HALRF_IQK_VER \ + (dm->support_ic_type == ODM_RTL8188E) ? IQK_VER_8188E : \ + (dm->support_ic_type == ODM_RTL8192E) ? IQK_VER_8192E : \ + (dm->support_ic_type == ODM_RTL8192F) ? IQK_VER_8192F : \ + (dm->support_ic_type == ODM_RTL8723B) ? IQK_VER_8723B : \ + (dm->support_ic_type == ODM_RTL8812) ? IQK_VER_8812A : \ + (dm->support_ic_type == ODM_RTL8821) ? IQK_VER_8821A : \ + (dm->support_ic_type == ODM_RTL8814A) ? IQK_VER_8814A : \ + (dm->support_ic_type == ODM_RTL8188F) ? IQK_VER_8188F : \ + (dm->support_ic_type == ODM_RTL8197F) ? IQK_VER_8197F : \ + (dm->support_ic_type == ODM_RTL8703B) ? IQK_VER_8703B : \ + (dm->support_ic_type == ODM_RTL8710B) ? IQK_VER_8710B : \ + (dm->support_ic_type == ODM_RTL8723D) ? IQK_VER_8723D : \ + (dm->support_ic_type == ODM_RTL8822B) ? IQK_VER_8822B : \ + (dm->support_ic_type == ODM_RTL8822C) ? IQK_VER_8822C : \ + (dm->support_ic_type == ODM_RTL8821C) ? IQK_VER_8821C : \ + (dm->support_ic_type == ODM_RTL8814B) ? IQK_VER_8814B : "unknown" + +#define HALRF_LCK_VER \ + (dm->support_ic_type == ODM_RTL8188E) ? LCK_VER_8188E : \ + (dm->support_ic_type == ODM_RTL8192E) ? LCK_VER_8192E : \ + (dm->support_ic_type == ODM_RTL8192F) ? LCK_VER_8192F : \ + (dm->support_ic_type == ODM_RTL8723B) ? LCK_VER_8723B : \ + (dm->support_ic_type == ODM_RTL8812) ? LCK_VER_8812A : \ + (dm->support_ic_type == ODM_RTL8821) ? LCK_VER_8821A : \ + (dm->support_ic_type == ODM_RTL8814A) ? LCK_VER_8814A : \ + (dm->support_ic_type == ODM_RTL8188F) ? LCK_VER_8188F : \ + (dm->support_ic_type == ODM_RTL8197F) ? LCK_VER_8197F : \ + (dm->support_ic_type == ODM_RTL8703B) ? LCK_VER_8703B : \ + (dm->support_ic_type == ODM_RTL8710B) ? LCK_VER_8710B : \ + (dm->support_ic_type == ODM_RTL8723D) ? LCK_VER_8723D : \ + (dm->support_ic_type == ODM_RTL8822B) ? LCK_VER_8822B : \ + (dm->support_ic_type == ODM_RTL8822C) ? LCK_VER_8822C : \ + (dm->support_ic_type == ODM_RTL8821C) ? LCK_VER_8821C : \ + (dm->support_ic_type == ODM_RTL8814B) ? LCK_VER_8814B : "unknown" + +#define HALRF_POWRTRACKING_VER \ + (dm->support_ic_type == ODM_RTL8188E) ? PWRTRK_VER_8188E : \ + (dm->support_ic_type == ODM_RTL8192E) ? PWRTRK_VER_8192E : \ + (dm->support_ic_type == ODM_RTL8192F) ? PWRTRK_VER_8192F : \ + (dm->support_ic_type == ODM_RTL8723B) ? PWRTRK_VER_8723B : \ + (dm->support_ic_type == ODM_RTL8812) ? PWRTRK_VER_8812A : \ + (dm->support_ic_type == ODM_RTL8821) ? PWRTRK_VER_8821A : \ + (dm->support_ic_type == ODM_RTL8814A) ? PWRTRK_VER_8814A : \ + (dm->support_ic_type == ODM_RTL8188F) ? PWRTRK_VER_8188F : \ + (dm->support_ic_type == ODM_RTL8197F) ? PWRTRK_VER_8197F : \ + (dm->support_ic_type == ODM_RTL8703B) ? PWRTRK_VER_8703B : \ + (dm->support_ic_type == ODM_RTL8710B) ? PWRTRK_VER_8710B : \ + (dm->support_ic_type == ODM_RTL8723D) ? PWRTRK_VER_8723D : \ + (dm->support_ic_type == ODM_RTL8822B) ? PWRTRK_VER_8822B : \ + (dm->support_ic_type == ODM_RTL8822C) ? PWRTRK_VER_8822C : \ + (dm->support_ic_type == ODM_RTL8821C) ? PWRTRK_VER_8821C : \ + (dm->support_ic_type == ODM_RTL8814B) ? PWRTRK_VER_8814B : "unknown" + +#define HALRF_DPK_VER \ + (dm->support_ic_type == ODM_RTL8188E) ? DPK_VER_8188E : \ + (dm->support_ic_type == ODM_RTL8192E) ? DPK_VER_8192E : \ + (dm->support_ic_type == ODM_RTL8192F) ? DPK_VER_8192F : \ + (dm->support_ic_type == ODM_RTL8723B) ? DPK_VER_8723B : \ + (dm->support_ic_type == ODM_RTL8812) ? DPK_VER_8812A : \ + (dm->support_ic_type == ODM_RTL8821) ? DPK_VER_8821A : \ + (dm->support_ic_type == ODM_RTL8814A) ? DPK_VER_8814A : \ + (dm->support_ic_type == ODM_RTL8188F) ? DPK_VER_8188F : \ + (dm->support_ic_type == ODM_RTL8197F) ? DPK_VER_8197F : \ + (dm->support_ic_type == ODM_RTL8198F) ? DPK_VER_8198F : \ + (dm->support_ic_type == ODM_RTL8703B) ? DPK_VER_8703B : \ + (dm->support_ic_type == ODM_RTL8710B) ? DPK_VER_8710B : \ + (dm->support_ic_type == ODM_RTL8723D) ? DPK_VER_8723D : \ + (dm->support_ic_type == ODM_RTL8822B) ? DPK_VER_8822B : \ + (dm->support_ic_type == ODM_RTL8822C) ? DPK_VER_8822C : \ + (dm->support_ic_type == ODM_RTL8821C) ? DPK_VER_8821C : \ + (dm->support_ic_type == ODM_RTL8814B) ? DPK_VER_8814B : "unknown" + +#define HALRF_KFREE_VER \ + (dm->support_ic_type == ODM_RTL8188E) ? KFREE_VER_8188E : \ + (dm->support_ic_type == ODM_RTL8192E) ? KFREE_VER_8192E : \ + (dm->support_ic_type == ODM_RTL8192F) ? KFREE_VER_8192F : \ + (dm->support_ic_type == ODM_RTL8723B) ? KFREE_VER_8723B : \ + (dm->support_ic_type == ODM_RTL8812) ? KFREE_VER_8812A : \ + (dm->support_ic_type == ODM_RTL8821) ? KFREE_VER_8821A : \ + (dm->support_ic_type == ODM_RTL8814A) ? KFREE_VER_8814A : \ + (dm->support_ic_type == ODM_RTL8188F) ? KFREE_VER_8188F : \ + (dm->support_ic_type == ODM_RTL8197F) ? KFREE_VER_8197F : \ + (dm->support_ic_type == ODM_RTL8703B) ? KFREE_VER_8703B : \ + (dm->support_ic_type == ODM_RTL8710B) ? KFREE_VER_8710B : \ + (dm->support_ic_type == ODM_RTL8723D) ? KFREE_VER_8723D : \ + (dm->support_ic_type == ODM_RTL8822B) ? KFREE_VER_8822B : \ + (dm->support_ic_type == ODM_RTL8822C) ? KFREE_VER_8822C : \ + (dm->support_ic_type == ODM_RTL8821C) ? KFREE_VER_8821C : \ + (dm->support_ic_type == ODM_RTL8814B) ? KFREE_VER_8814B : "unknown" + +#define HALRF_PABIASK_VER \ + (dm->support_ic_type == ODM_RTL8188E) ? PABIASK_VER_8188E : \ + (dm->support_ic_type == ODM_RTL8192E) ? PABIASK_VER_8192E : \ + (dm->support_ic_type == ODM_RTL8192F) ? PABIASK_VER_8192F : \ + (dm->support_ic_type == ODM_RTL8723B) ? PABIASK_VER_8723B : \ + (dm->support_ic_type == ODM_RTL8812) ? PABIASK_VER_8812A : \ + (dm->support_ic_type == ODM_RTL8821) ? PABIASK_VER_8821A : \ + (dm->support_ic_type == ODM_RTL8814A) ? PABIASK_VER_8814A : \ + (dm->support_ic_type == ODM_RTL8188F) ? PABIASK_VER_8188F : \ + (dm->support_ic_type == ODM_RTL8197F) ? PABIASK_VER_8197F : \ + (dm->support_ic_type == ODM_RTL8703B) ? PABIASK_VER_8703B : \ + (dm->support_ic_type == ODM_RTL8710B) ? PABIASK_VER_8710B : \ + (dm->support_ic_type == ODM_RTL8723D) ? PABIASK_VER_8723D : \ + (dm->support_ic_type == ODM_RTL8822B) ? PABIASK_VER_8822B : \ + (dm->support_ic_type == ODM_RTL8822C) ? PABIASK_VER_8822C : \ + (dm->support_ic_type == ODM_RTL8821C) ? PABIASK_VER_8821C : \ + (dm->support_ic_type == ODM_RTL8814B) ? PABIASK_VER_8814B : "unknown" + +#define HALRF_RFK_INIT_VER \ + (dm->support_ic_type == ODM_RTL8822B) ? RFK_INIT_VER_8822B : \ + (dm->support_ic_type == ODM_RTL8822C) ? RFK_INIT_VER_8822C : \ + (dm->support_ic_type == ODM_RTL8198F) ? RFK_INIT_VER_8198F : \ + (dm->support_ic_type == ODM_RTL8814B) ? RFK_INIT_VER_8814B : "unknown" + +#define HALRF_DACK_VER \ + (dm->support_ic_type == ODM_RTL8822C) ? DACK_VER_8822C : "unknown" + +#define IQK_THRESHOLD 8 +#define DPK_THRESHOLD 4 +#define HALRF_ABS(a,b) ((a>b) ? (a-b) : (b-a)) +#define SN 100 + +#define CCK_TSSI_NUM 6 +#define OFDM_2G_TSSI_NUM 5 +#define OFDM_5G_TSSI_NUM 14 + + + +/*@===========================================================*/ +/*AGC RX High Power mode*/ +/*@===========================================================*/ +#define lna_low_gain_1 0x64 +#define lna_low_gain_2 0x5A +#define lna_low_gain_3 0x58 + +/*@============================================================*/ +/*@ enumeration */ +/*@============================================================*/ + +#define POWER_INDEX_DIFF 4 +#define TSSI_TXAGC_DIFF 2 + +#define TSSI_CODE_NUM 84 + +#define TSSI_SLOPE_2G 8 +#define TSSI_SLOPE_5G 5 + +#define TSSI_EFUSE_NUM 25 +#define TSSI_EFUSE_KFREE_NUM 4 + + +enum halrf_func_idx { /*F_XXX = PHYDM XXX function*/ + RF00_PWR_TRK = 0, /*Pow_trk, TSSI_trk*/ + RF01_IQK = 1, /*LOK, IQK*/ + RF02_LCK = 2, + RF03_DPK = 3, + RF04_TXGAPK = 4, + RF05_DACK = 5, + RF06_DPK_TRK = 6, +}; + +enum halrf_ability { + HAL_RF_TX_PWR_TRACK = BIT(RF00_PWR_TRK), + HAL_RF_IQK = BIT(RF01_IQK), + HAL_RF_LCK = BIT(RF02_LCK), + HAL_RF_DPK = BIT(RF03_DPK), + HAL_RF_TXGAPK = BIT(RF04_TXGAPK), + HAL_RF_DACK = BIT(RF05_DACK), + HAL_RF_DPK_TRACK = BIT(RF06_DPK_TRK) +}; + +enum halrf_dbg_comp { + DBG_RF_TX_PWR_TRACK = BIT(RF00_PWR_TRK), + DBG_RF_IQK = BIT(RF01_IQK), + DBG_RF_LCK = BIT(RF02_LCK), + DBG_RF_DPK = BIT(RF03_DPK), + DBG_RF_TXGAPK = BIT(RF04_TXGAPK), + DBG_RF_DACK = BIT(RF05_DACK), + DBG_RF_MP = BIT(29), + DBG_RF_TMP = BIT(30), + DBG_RF_INIT = BIT(31) +}; + +enum halrf_cmninfo_init { + HALRF_CMNINFO_ABILITY = 0, + HALRF_CMNINFO_DPK_EN = 1, + HALRF_CMNINFO_EEPROM_THERMAL_VALUE, + HALRF_CMNINFO_RFK_FORBIDDEN, + HALRF_CMNINFO_IQK_SEGMENT, + HALRF_CMNINFO_RATE_INDEX, + HALRF_CMNINFO_PWT_TYPE, + HALRF_CMNINFO_MP_PSD_POINT, + HALRF_CMNINFO_MP_PSD_START_POINT, + HALRF_CMNINFO_MP_PSD_STOP_POINT, + HALRF_CMNINFO_MP_PSD_AVERAGE, + HALRF_CMNINFO_IQK_TIMES +}; + +enum halrf_cmninfo_hook { + HALRF_CMNINFO_CON_TX, + HALRF_CMNINFO_SINGLE_TONE, + HALRF_CMNINFO_CARRIER_SUPPRESSION, + HALRF_CMNINFO_MP_RATE_INDEX, + HALRF_CMNINFO_MANUAL_RF_SUPPORTABILITY +}; + +enum halrf_lna_set { + HALRF_LNA_DISABLE = 0, + HALRF_LNA_ENABLE = 1, +}; + +enum halrf_k_segment_time { + SEGMENT_FREE = 0, + SEGMENT_10MS = 10, /*10ms*/ + SEGMENT_30MS = 30, /*30ms*/ + SEGMENT_50MS = 50, /*50ms*/ +}; + + +#if (RTL8822C_SUPPORT == 1 || RTL8812F_SUPPORT == 1 || RTL8814B_SUPPORT) + +#define POWER_INDEX_DIFF 4 +#define TSSI_TXAGC_DIFF 2 + +#define TSSI_CODE_NUM 84 + +#define TSSI_SLOPE_2G 8 +#define TSSI_SLOPE_5G 5 + +#define TSSI_EFUSE_NUM 25 +#define TSSI_EFUSE_KFREE_NUM 4 + +struct _halrf_tssi_data { + s32 cck_offset_patha; + s32 cck_offset_pathb; + s32 power_track_offset[PHYDM_MAX_RF_PATH]; + s16 txagc_codeword[TSSI_CODE_NUM]; + u16 tssi_codeword[TSSI_CODE_NUM]; + s8 tssi_efuse[PHYDM_MAX_RF_PATH][TSSI_EFUSE_NUM]; + s8 tssi_kfree_efuse[PHYDM_MAX_RF_PATH][TSSI_EFUSE_KFREE_NUM]; + u8 thermal[PHYDM_MAX_RF_PATH]; + u32 index[PHYDM_MAX_RF_PATH][14]; + u8 do_tssi; + u8 get_thermal; +}; +#endif + +/*@============================================================*/ +/*@ 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; + u64 dpk_progressing_time; + u64 iqk_progressing_time; + u32 fw_ver; + + boolean *is_con_tx; + boolean *is_single_tone; + boolean *is_carrier_suppresion; + boolean is_dpk_in_progress; + boolean is_tssi_in_progress; + boolean aac_checked; + + u8 *mp_rate_index; + u32 *manual_rf_supportability; + u32 p_rate_index; + u8 pwt_type; + u32 rf_dbg_comp; + struct _halrf_psd_data halrf_psd_data; +#if (RTL8822C_SUPPORT == 1 || RTL8812F_SUPPORT == 1 || RTL8814B_SUPPORT == 1) + struct _halrf_tssi_data halrf_tssi_data; +#endif + u8 power_track_type; +}; + +/*@============================================================*/ +/*@ function prototype */ +/*@============================================================*/ + +#if (RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1 ||\ + RTL8195B_SUPPORT == 1 || RTL8198F_SUPPORT == 1 ||\ + RTL8814B_SUPPORT == 1 || RTL8822C_SUPPORT == 1 ||\ + RTL8812F_SUPPORT == 1) +void halrf_iqk_info_dump(void *dm_void, u32 *_used, char *output, + u32 *_out_len); + +void halrf_iqk_hwtx_check(void *dm_void, boolean is_check); +#endif + +u8 halrf_match_iqk_version(void *dm_void); + +void halrf_support_ability_debug(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len); + +void halrf_cmn_info_init(void *dm_void, enum halrf_cmninfo_init cmn_info, + u32 value); + +void halrf_cmn_info_hook(void *dm_void, enum halrf_cmninfo_hook cmn_info, + void *value); + +void halrf_cmn_info_set(void *dm_void, u32 cmn_info, u64 value); + +u64 halrf_cmn_info_get(void *dm_void, u32 cmn_info); + +void halrf_watchdog(void *dm_void); + +void halrf_supportability_init(void *dm_void); + +void halrf_init(void *dm_void); + +void halrf_iqk_trigger(void *dm_void, boolean is_recovery); + +void halrf_rf_k_connect_trigger(void *dm_void, boolean is_recovery, + enum halrf_k_segment_time seg_time); + +void halrf_segment_iqk_trigger(void *dm_void, boolean clear, + boolean segment_iqk); + +void halrf_lck_trigger(void *dm_void); + +void halrf_iqk_debug(void *dm_void, u32 *const dm_value, u32 *_used, + char *output, u32 *_out_len); + +void phydm_get_iqk_cfir(void *dm_void, u8 idx, u8 path, boolean debug); + +void halrf_iqk_xym_read(void *dm_void, u8 path, u8 xym_type); + +void halrf_rf_lna_setting(void *dm_void, enum halrf_lna_set type); + +void halrf_do_imr_test(void *dm_void, u8 data); + +u32 halrf_psd_log2base(u32 val); + +void halrf_dpk_trigger(void *dm_void); + +u8 halrf_dpk_result_check(void *dm_void); + +void halrf_dpk_sram_read(void *dm_void); + +void halrf_dpk_enable_disable(void *dm_void); + +void halrf_dpk_track(void *dm_void); + +void halrf_dpk_reload(void *dm_void); + +void halrf_dpk_info_rsvd_page(void *dm_void, u8 *buf, u32 *buf_size); + +/*Global function*/ + +void halrf_reload_bp(void *dm_void, u32 *bp_reg, u32 *bp, u32 num); + +void halrf_reload_bprf(void *dm_void, u32 *bp_reg, u32 bp[][4], u32 num, + u8 ss); + +void halrf_bp(void *dm_void, u32 *bp_reg, u32 *bp, u32 num); + +void halrf_bprf(void *dm_void, u32 *bp_reg, u32 bp[][4], u32 num, u8 ss); + +void halrf_mode(void *dm_void, u32 *i_value, u32 *q_value); + +boolean halrf_compare(void *dm_void, u32 value); + +u32 halrf_delta(void *dm_void, u32 v1, u32 v2); + +void halrf_minmax_compare(void *dm_void, u32 value, u32 *min, u32 *max); + +void halrf_b_sort(void *dm_void, u32 *iv, u32 *qv); + +void halrf_bubble(void *dm_void, u32 *v1, u32 *v2); + +void halrf_swap(void *dm_void, u32 *v1, u32 *v2); + +enum hal_status +halrf_config_rfk_with_header_file(void *dm_void, u32 config_type); + +#if (RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1 ||\ + RTL8195B_SUPPORT == 1 || RTL8198F_SUPPORT == 1 ||\ + RTL8814B_SUPPORT == 1 || RTL8822C_SUPPORT == 1 ||\ + RTL8812F_SUPPORT == 1) +void halrf_iqk_dbg(void *dm_void); +#endif + +void halrf_tssi_get_efuse(void *dm_void); + +void halrf_do_tssi(void *dm_void); + +void halrf_do_thermal(void *dm_void); + +u32 halrf_set_tssi_value(void *dm_void, u32 tssi_value); + +void halrf_tssi_set_de_for_tx_verify(void *dm_void, u32 tssi_de, u8 path); + +void halrf_set_tssi_power(void *dm_void, s8 power); + +u32 halrf_query_tssi_value(void *dm_void); + +void halrf_tssi_cck(void *dm_void); + +void halrf_thermal_cck(void *dm_void); + +void halrf_tssi_set_de(void *dm_void); + +void halrf_tssi_dck(void *dm_void, u8 direct_do); + +void halrf_calculate_tssi_codeword(void *dm_void); + +void halrf_set_tssi_codeword(void *dm_void); + +u8 halrf_get_tssi_codeword_for_txindex(void *dm_void); + +u32 halrf_tssi_get_de(void *dm_void, u8 path); + +void halrf_set_dpk_track(void *dm_void, u8 enable); + +void halrf_set_dpkbychannel(void *dm_void, boolean dpk_by_ch); + +void halrf_set_dpkenable(void *dm_void, boolean is_dpk_enable); + +boolean halrf_get_dpkbychannel(void *dm_void); + +boolean halrf_get_dpkenable(void *dm_void); + +void _iqk_check_if_reload(void *dm_void); + + +#endif /*__HALRF_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_debug.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_debug.c new file mode 100644 index 000000000000..4e258ba87431 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_debug.c @@ -0,0 +1,272 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +/*@************************************************************ + * include files + * ************************************************************ + */ + +#include "mp_precomp.h" +#include "phydm_precomp.h" + +void halrf_basic_profile(void *dm_void, u32 *_used, char *output, u32 *_out_len) +{ +#ifdef CONFIG_PHYDM_DEBUG_FUNCTION + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 used = *_used; + u32 out_len = *_out_len; + u32 rf_release_ver = 0; + +#if (RTL8822C_SUPPORT) + if (dm->support_ic_type == ODM_RTL8822C) { + rf_release_ver = RF_RELEASE_VERSION_8822C; + } +#endif + + PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %d\n", + "RF Para Release Ver", rf_release_ver); + + /* HAL RF version List */ + PDM_SNPF(out_len, used, output + used, out_len - used, "%-35s\n", + "% HAL RF version %"); + PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", + "Power Tracking", HALRF_POWRTRACKING_VER); + PDM_SNPF(out_len, used, output + used, out_len - used, + " %-35s: %s %s\n", "IQK", + (dm->fw_offload_ability & PHYDM_RF_IQK_OFFLOAD) ? "FW" : + HALRF_IQK_VER, + (halrf_match_iqk_version(dm_void)) ? "(match)" : "(mismatch)"); + + PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", + "LCK", HALRF_LCK_VER); + PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", + "DPK", HALRF_DPK_VER); + PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", + "KFREE", HALRF_KFREE_VER); + PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", + "TX 2G Current Calibration", HALRF_PABIASK_VER); + PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", + "RFK Init. Parameter", HALRF_RFK_INIT_VER); + + *_used = used; + *_out_len = out_len; +#endif +} + +void halrf_debug_trace(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &dm->rf_table; + u32 one = 1; + u32 used = *_used; + u32 out_len = *_out_len; + u32 rf_var[10] = {0}; + u8 i; + + for (i = 0; i < 5; i++) + if (input[i + 1]) + PHYDM_SSCANF(input[i + 2], DCMD_DECIMAL, &rf_var[i]); + + if (rf_var[0] == 100) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "\n[DBG MSG] RF Selection\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "00. (( %s ))TX_PWR_TRACK\n", + ((rf->rf_dbg_comp & DBG_RF_TX_PWR_TRACK) ? ("V") : + ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "01. (( %s ))IQK\n", + ((rf->rf_dbg_comp & DBG_RF_IQK) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "02. (( %s ))LCK\n", + ((rf->rf_dbg_comp & DBG_RF_LCK) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "03. (( %s ))DPK\n", + ((rf->rf_dbg_comp & DBG_RF_DPK) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "04. (( %s ))TXGAPK\n", + ((rf->rf_dbg_comp & DBG_RF_TXGAPK) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "29. (( %s ))MP\n", + ((rf->rf_dbg_comp & DBG_RF_MP) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "30. (( %s ))TMP\n", + ((rf->rf_dbg_comp & DBG_RF_TMP) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "31. (( %s ))INIT\n", + ((rf->rf_dbg_comp & DBG_RF_INIT) ? ("V") : ("."))); + + } else if (rf_var[0] == 101) { + rf->rf_dbg_comp = 0; + PDM_SNPF(out_len, used, output + used, out_len - used, + "Disable all DBG COMP\n"); + } else { + if (rf_var[1] == 1) /*enable*/ + rf->rf_dbg_comp |= (one << rf_var[0]); + else if (rf_var[1] == 2) /*disable*/ + rf->rf_dbg_comp &= ~(one << rf_var[0]); + } + PDM_SNPF(out_len, used, output + used, out_len - used, + "\nCurr-RF_Dbg_Comp = 0x%x\n", rf->rf_dbg_comp); + + *_used = used; + *_out_len = out_len; +} + +struct halrf_command { + char name[16]; + u8 id; +}; + +enum halrf_CMD_ID { + HALRF_HELP, + HALRF_SUPPORTABILITY, + HALRF_DBG_COMP, + HALRF_PROFILE, + HALRF_IQK_INFO, + HALRF_IQK, + HALRF_IQK_DEBUG, +}; + +struct halrf_command halrf_cmd_ary[] = { + {"-h", HALRF_HELP}, + {"ability", HALRF_SUPPORTABILITY}, + {"dbg", HALRF_DBG_COMP}, + {"profile", HALRF_PROFILE}, + {"iqk_info", HALRF_IQK_INFO}, + {"iqk", HALRF_IQK}, + {"iqk_dbg", HALRF_IQK_DEBUG}, +}; + +void halrf_cmd_parser(void *dm_void, char input[][16], u32 *_used, char *output, + u32 *_out_len, u32 input_num) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; +#ifdef CONFIG_PHYDM_DEBUG_FUNCTION + u8 id = 0; + u32 rf_var[10] = {0}; + u32 i, input_idx = 0; + u32 halrf_ary_size = + sizeof(halrf_cmd_ary) / sizeof(struct halrf_command); + u32 used = *_used; + u32 out_len = *_out_len; + + /* Parsing Cmd ID */ + for (i = 0; i < halrf_ary_size; i++) { + if (strcmp(halrf_cmd_ary[i].name, input[1]) == 0) { + id = halrf_cmd_ary[i].id; + break; + } + } + + if (i == halrf_ary_size) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "RF Cmd not found\n"); + return; + } + + switch (id) { + case HALRF_HELP: + PDM_SNPF(out_len, used, output + used, out_len - used, + "RF cmd ==>\n"); + + for (i = 0; i < halrf_ary_size - 1; i++) { + PDM_SNPF(out_len, used, output + used, out_len - used, + " %-5d: %s\n", i, halrf_cmd_ary[i + 1].name); + } + break; + case HALRF_SUPPORTABILITY: + halrf_support_ability_debug(dm, &input[0], &used, output, + &out_len); + break; + case HALRF_DBG_COMP: + halrf_debug_trace(dm, &input[0], &used, output, &out_len); + break; + case HALRF_PROFILE: + halrf_basic_profile(dm, &used, output, &out_len); + break; + case HALRF_IQK_INFO: +#if (RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1) + halrf_iqk_info_dump(dm, &used, output, &out_len); +#endif + break; + case HALRF_IQK: + PDM_SNPF(out_len, used, output + used, out_len - used, + "TRX IQK Trigger\n"); + halrf_iqk_trigger(dm, false); +#if (RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1) + halrf_iqk_info_dump(dm, &used, output, &out_len); +#endif + break; + case HALRF_IQK_DEBUG: + + for (i = 0; i < 5; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 2], DCMD_HEX, + &rf_var[i]); + input_idx++; + } + } + + if (input_idx >= 1) { +#if (RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1) + if (dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8821C)) + halrf_iqk_debug(dm, (u32 *)rf_var, &used, + output, &out_len); +#endif + } + break; + default: + break; + } + + *_used = used; + *_out_len = out_len; +#endif +} + +void halrf_init_debug_setting(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &dm->rf_table; + + rf->rf_dbg_comp = +#if DBG +#if 0 + /*DBG_RF_TX_PWR_TRACK |*/ + /*DBG_RF_IQK | */ + /*DBG_RF_LCK | */ + /*DBG_RF_DPK | */ + /*DBG_RF_DACK | */ + /*DBG_RF_TXGAPK | */ + /*DBG_RF_MP | */ + /*DBG_RF_TMP | */ + /*DBG_RF_INIT | */ +#endif +#endif + 0; +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_debug.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_debug.h new file mode 100644 index 000000000000..15d4a6268587 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_debug.h @@ -0,0 +1,124 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +#ifndef __HALRF_DEBUG_H__ +#define __HALRF_DEBUG_H__ + +/*@============================================================*/ +/*@include files*/ +/*@============================================================*/ + +/*@============================================================*/ +/*@Definition */ +/*@============================================================*/ + +#if DBG + +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) +#define RF_DBG(dm, comp, fmt, args...) \ + do { \ + if ((comp) & dm->rf_table.rf_dbg_comp) { \ + pr_debug("[RF] "); \ + RT_PRINTK(fmt, ##args); \ + } \ + } while (0) + +#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) + +static __inline void RF_DBG(PDM_ODM_T dm, int comp, char *fmt, ...) +{ + RT_STATUS rt_status; + va_list args; + char buf[PRINT_MAX_SIZE] = {0}; + + if ((comp & dm->rf_table.rf_dbg_comp) == 0) + return; + + if (fmt == NULL) + return; + + va_start(args, fmt); + rt_status = (RT_STATUS)RtlStringCbVPrintfA(buf, PRINT_MAX_SIZE, fmt, args); + va_end(args); + + if (rt_status != RT_STATUS_SUCCESS) { + DbgPrint("Failed (%d) to print message to buffer\n", rt_status); + return; + } + + DbgPrint("[RF] %s", buf); +} + +#elif (DM_ODM_SUPPORT_TYPE == ODM_IOT) + +#define RF_DBG(dm, comp, fmt, args...) \ + do { \ + if ((comp) & dm->rf_table.rf_dbg_comp) { \ + RT_DEBUG(COMP_PHYDM, DBG_DMESG, "[RF] " fmt, ##args); \ + } \ + } while (0) + +#else +#define RF_DBG(dm, comp, fmt, args...) \ + do { \ + struct dm_struct *__dm = dm; \ + if ((comp) & __dm->rf_table.rf_dbg_comp) { \ + RT_TRACE(((struct rtl_priv *)__dm->adapter), \ + COMP_PHYDM, DBG_DMESG, "[RF] " fmt, ##args); \ + } \ + } while (0) +#endif + +#else /*#if DBG*/ + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +static __inline void RF_DBG(struct dm_struct *dm, int comp, char *fmt, ...) +{ +} +#else +#define RF_DBG(dm, comp, fmt, args...) +#endif + +#endif /*#if DBG*/ + +/*@============================================================*/ +/*@ enumeration */ +/*@============================================================*/ + +/*@============================================================*/ +/*@ structure */ +/*@============================================================*/ + +/*@============================================================*/ +/*@ function prototype */ +/*@============================================================*/ + +void halrf_cmd_parser(void *dm_void, char input[][16], u32 *_used, char *output, + u32 *_out_len, u32 input_num); + +void halrf_init_debug_setting(void *dm_void); + +#endif /*__HALRF_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_dpk.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_dpk.h new file mode 100644 index 000000000000..2e9c94138019 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_dpk.h @@ -0,0 +1,107 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +#ifndef __HALRF_DPK_H__ +#define __HALRF_DPK_H__ + +/*@--------------------------Define Parameters-------------------------------*/ +#define GAIN_LOSS 1 +#define DO_DPK 2 +#define DPK_ON 3 +#define DPK_LOK 4 +#define DPK_TXK 5 + +#define DAGC 4 +#define LOSS_CHK 0 +#define GAIN_CHK 1 +#define PAS_READ 2 +#define AVG_THERMAL_NUM 8 +#define AVG_THERMAL_NUM_DPK 8 +#define THERMAL_DPK_AVG_NUM 4 + +/*@---------------------------End Define Parameters---------------------------*/ + +struct dm_dpk_info { + + boolean is_dpk_enable; + boolean is_dpk_pwr_on; + boolean is_dpk_by_channel; + boolean is_tssi_mode; + boolean is_reload; + u16 dpk_path_ok; + /*@BIT(15)~BIT(12) : 5G reserved, BIT(11)~BIT(8) 5G_S3~5G_S0*/ + /*@BIT(7)~BIT(4) : 2G reserved, BIT(3)~BIT(0) 2G_S3~2G_S0*/ + u8 thermal_dpk[4]; /*path*/ + u8 thermal_dpk_avg[4][AVG_THERMAL_NUM_DPK]; /*path*/ + u8 thermal_dpk_avg_index; + u8 pre_pwsf[4]; + u32 gnt_control; + u32 gnt_value; + u8 dpk_ch; + u8 dpk_band; + u8 dpk_bw; + +#if (RTL8822C_SUPPORT == 1 || RTL8812F_SUPPORT == 1) + u8 result[2]; /*path*/ + u8 dpk_txagc[2]; /*path*/ + u32 coef[2][20]; /*path/MDPD coefficient*/ + u16 dpk_gs[2]; /*MDPD coef gs*/ + u8 thermal_dpk_delta[2]; /*path*/ +#endif + +#if (RTL8198F_SUPPORT == 1 || RTL8192F_SUPPORT == 1 || RTL8197F_SUPPORT == 1 || RTL8814B_SUPPORT) + /*2G DPK data*/ + u8 dpk_result[4][3]; /*path/group*/ + u8 pwsf_2g[4][3]; /*path/group*/ + u32 lut_2g_even[4][3][64]; /*path/group/LUT data*/ + u32 lut_2g_odd[4][3][64]; /*path/group/LUT data*/ + /*5G DPK data*/ + u8 dpk_5g_result[4][6]; /*path/group*/ + u8 pwsf_5g[4][6]; /*path/group*/ + u32 lut_5g[4][6][64]; /*path/group/LUT data*/ + u32 lut_2g[4][3][64]; /*path/group/LUT data*/ + /*8814B*/ + u8 rxbb[4]; /*path/group*/ + u8 txbb[4]; /*path/group*/ + u8 tx_gain; +#endif + +#if (RTL8195B_SUPPORT == 1) + /*2G DPK data*/ + u8 dpk_2g_result[1][3]; /*path/group*/ + u8 pwsf_2g[1][3]; /*path/group*/ + u32 lut_2g_even[1][3][16]; /*path/group/LUT data*/ + u32 lut_2g_odd[1][3][16]; /*path/group/LUT data*/ + /*5G DPK data*/ + u8 dpk_5g_result[1][13]; /*path/group*/ + u8 pwsf_5g[1][13]; /*path/group*/ + u32 lut_5g_even[1][13][16]; /*path/group/LUT data*/ + u32 lut_5g_odd[1][13][16]; /*path/group/LUT data*/ +#endif + +}; + +#endif /*__HALRF_DPK_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_features.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_features.h new file mode 100644 index 000000000000..a17483b98753 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_features.h @@ -0,0 +1,44 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +#ifndef __HALRF_FEATURES_H__ +#define __HALRF_FEATURES_H__ + +#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 /*#ifndef __HALRF_FEATURES_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_iqk.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_iqk.h new file mode 100644 index 000000000000..e89eec504a7e --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_iqk.h @@ -0,0 +1,120 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +#ifndef __HALRF_IQK_H__ +#define __HALRF_IQK_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 6 +#define TXWBIQK_EN 1 +#define RXWBIQK_EN 1 +#define NUM 4 +/*@-----------------------End Define Parameters-----------------------*/ + +struct dm_dack_info { + u32 ic_a; + u32 qc_a; + u32 ic_b; + u32 qc_b; +}; + +struct dm_iqk_info { + boolean lok_fail[NUM]; + boolean iqk_fail[2][NUM]; + u32 iqc_matrix[2][NUM]; + u8 iqk_times; + u32 rf_reg18; + u32 rf_reg08; + u32 lna_idx; + u8 iqk_step; + u8 rxiqk_step; + u8 tmp1bcc; + u8 txgain; + u32 txgain56; + u8 kcount; + u8 rfk_ing; /*bit0:IQKing, bit1:LCKing, bit2:DPKing*/ + boolean rfk_forbidden; + u8 rxbb; + u32 rf_reg58; + boolean segment_iqk; +#if (RTL8814A_SUPPORT == 1 || RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1 ||\ + RTL8195B_SUPPORT == 1 || RTL8198F_SUPPORT == 1 ||\ + RTL8814B_SUPPORT == 1 || RTL8822C_SUPPORT == 1 ||\ + RTL8812F_SUPPORT == 1 || RTL8197G_SUPPORT == 1 ) + u32 iqk_channel[2]; + boolean iqk_fail_report[2][4][2]; /*channel/path/TRX(TX:0, RX:1) */ + /*channel / path / TRX(TX:0, RX:1) / CFIR_real*/ + /*channel index = 2 is just for debug*/ +#if (RTL8812F_SUPPORT == 1 || RTL8822C_SUPPORT == 1 ) + u16 iqk_cfir_real[3][2][2][17]; + /*channel / path / TRX(TX:0, RX:1) / CFIR_imag*/ + /*channel index = 2 is just for debug*/ + u16 iqk_cfir_imag[3][2][2][17]; + u32 rx_cfir_real[2][2][17]; + u32 rx_cfir_imag[2][2][17]; + u32 rx_cfir[2][2]; + /*times/path*/ +#else + u32 iqk_cfir_real[3][4][2][8]; + /*channel / path / TRX(TX:0, RX:1) / CFIR_imag*/ + /*channel index = 2 is just for debug*/ + u32 iqk_cfir_imag[3][4][2][8]; +#endif + 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) */ + /* channel / path 0:SRXK1 fail, 1:RXK1 fail 2:RXK2 fail */ + u8 rxiqk_fail_code[2][4]; + 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 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]; + u32 txxy[2][2]; + u32 rxxy[2][2]; +#endif +}; + +#endif /*__HALRF_IQK_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_kfree.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_kfree.c new file mode 100644 index 000000000000..bd819a562cc1 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_kfree.c @@ -0,0 +1,1479 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +/*@============================================================*/ +/*@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 *dm_void, u8 e_rf_path, u8 data) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct dm_rf_calibration_struct *cali_info = &dm->rf_calibrate_info; + boolean is_odd; + u32 tx_gain_bitmask = (BIT(17) | BIT(16) | BIT(15)); + + if ((data % 2) != 0) { /*odd->positive*/ + data = data - 1; + odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(19), 1); + is_odd = true; + } else { /*even->negative*/ + odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(19), 0); + is_odd = false; + } + RF_DBG(dm, DBG_RF_MP, "phy_ConfigKFree8814A(): RF_0x55[19]= %d\n", + is_odd); + switch (data) { + case 0: + odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(14), 0); + odm_set_rf_reg(dm, e_rf_path, RF_0x55, tx_gain_bitmask, 0); + cali_info->kfree_offset[e_rf_path] = 0; + break; + case 2: + odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(14), 1); + odm_set_rf_reg(dm, e_rf_path, RF_0x55, tx_gain_bitmask, 0); + cali_info->kfree_offset[e_rf_path] = 0; + break; + case 4: + odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(14), 0); + odm_set_rf_reg(dm, e_rf_path, RF_0x55, tx_gain_bitmask, 1); + cali_info->kfree_offset[e_rf_path] = 1; + break; + case 6: + odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(14), 1); + odm_set_rf_reg(dm, e_rf_path, RF_0x55, tx_gain_bitmask, 1); + cali_info->kfree_offset[e_rf_path] = 1; + break; + case 8: + odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(14), 0); + odm_set_rf_reg(dm, e_rf_path, RF_0x55, tx_gain_bitmask, 2); + cali_info->kfree_offset[e_rf_path] = 2; + break; + case 10: + odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(14), 1); + odm_set_rf_reg(dm, e_rf_path, RF_0x55, tx_gain_bitmask, 2); + cali_info->kfree_offset[e_rf_path] = 2; + break; + case 12: + odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(14), 0); + odm_set_rf_reg(dm, e_rf_path, RF_0x55, tx_gain_bitmask, 3); + cali_info->kfree_offset[e_rf_path] = 3; + break; + case 14: + odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(14), 1); + odm_set_rf_reg(dm, e_rf_path, RF_0x55, tx_gain_bitmask, 3); + cali_info->kfree_offset[e_rf_path] = 3; + break; + case 16: + odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(14), 0); + odm_set_rf_reg(dm, e_rf_path, RF_0x55, tx_gain_bitmask, 4); + cali_info->kfree_offset[e_rf_path] = 4; + break; + case 18: + odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(14), 1); + odm_set_rf_reg(dm, e_rf_path, RF_0x55, tx_gain_bitmask, 4); + cali_info->kfree_offset[e_rf_path] = 4; + break; + case 20: + odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(14), 0); + odm_set_rf_reg(dm, e_rf_path, RF_0x55, tx_gain_bitmask, 5); + cali_info->kfree_offset[e_rf_path] = 5; + break; + + default: + break; + } + + if (!is_odd) { + /*that means Kfree offset is negative, we need to record it.*/ + cali_info->kfree_offset[e_rf_path] = + (-1) * cali_info->kfree_offset[e_rf_path]; + RF_DBG(dm, DBG_RF_MP, + "phy_ConfigKFree8814A(): kfree_offset = %d\n", + cali_info->kfree_offset[e_rf_path]); + } else { + RF_DBG(dm, DBG_RF_MP, + "phy_ConfigKFree8814A(): kfree_offset = %d\n", + cali_info->kfree_offset[e_rf_path]); + } +} + +void phydm_get_thermal_trim_offset_8821c(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; + + u8 pg_therm = 0xff; + + odm_efuse_one_byte_read(dm, PPG_THERMAL_OFFSET_21C, &pg_therm, false); + + if (pg_therm != 0xff) { + pg_therm = pg_therm & 0x1f; + if ((pg_therm & BIT(0)) == 0) + power_trim_info->thermal = (-1 * (pg_therm >> 1)); + else + power_trim_info->thermal = (pg_therm >> 1); + + power_trim_info->flag |= KFREE_FLAG_THERMAL_K_ON; + } + + RF_DBG(dm, DBG_RF_MP, "[kfree] 8821c thermal trim flag:0x%02x\n", + power_trim_info->flag); + + if (power_trim_info->flag & KFREE_FLAG_THERMAL_K_ON) + RF_DBG(dm, DBG_RF_MP, "[kfree] 8821c thermal:%d\n", + power_trim_info->thermal); +} + +void phydm_get_power_trim_offset_8821c(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; + + u8 pg_power = 0xff, i; + + odm_efuse_one_byte_read(dm, PPG_2G_TXAB_21C, &pg_power, false); + + if (pg_power != 0xff) { + power_trim_info->bb_gain[0][0] = pg_power; + odm_efuse_one_byte_read(dm, PPG_5GL1_TXA_21C, &pg_power, false); + power_trim_info->bb_gain[1][0] = pg_power; + odm_efuse_one_byte_read(dm, PPG_5GL2_TXA_21C, &pg_power, false); + power_trim_info->bb_gain[2][0] = pg_power; + odm_efuse_one_byte_read(dm, PPG_5GM1_TXA_21C, &pg_power, false); + power_trim_info->bb_gain[3][0] = pg_power; + odm_efuse_one_byte_read(dm, PPG_5GM2_TXA_21C, &pg_power, false); + power_trim_info->bb_gain[4][0] = pg_power; + odm_efuse_one_byte_read(dm, PPG_5GH1_TXA_21C, &pg_power, false); + power_trim_info->bb_gain[5][0] = pg_power; + power_trim_info->flag = + power_trim_info->flag | KFREE_FLAG_ON | + KFREE_FLAG_ON_2G | KFREE_FLAG_ON_5G; + } + + RF_DBG(dm, DBG_RF_MP, "[kfree] 8821c power trim flag:0x%02x\n", + power_trim_info->flag); + + if (power_trim_info->flag & KFREE_FLAG_ON) { + for (i = 0; i < KFREE_BAND_NUM; i++) + RF_DBG(dm, DBG_RF_MP, + "[kfree] 8821c pwr_trim->bb_gain[%d][0]=0x%X\n", + i, power_trim_info->bb_gain[i][0]); + } +} + +void phydm_set_kfree_to_rf_8821c(void *dm_void, u8 e_rf_path, boolean wlg_btg, + u8 data) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 wlg, btg; + u32 gain_bmask = (BIT(18) | BIT(17) | BIT(16) | BIT(15) | BIT(14)); + u32 s_gain_bmask = (BIT(19) | BIT(18) | BIT(17) | + BIT(16) | BIT(15) | BIT(14)); + + odm_set_rf_reg(dm, e_rf_path, RF_0xde, BIT(0), 1); + odm_set_rf_reg(dm, e_rf_path, RF_0xde, BIT(5), 1); + odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(6), 1); + odm_set_rf_reg(dm, e_rf_path, RF_0x65, BIT(6), 1); + + if (wlg_btg) { + wlg = data & 0xf; + btg = (data & 0xf0) >> 4; + + odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(19), (wlg & BIT(0))); + odm_set_rf_reg(dm, e_rf_path, RF_0x55, gain_bmask, (wlg >> 1)); + + odm_set_rf_reg(dm, e_rf_path, RF_0x65, BIT(19), (btg & BIT(0))); + odm_set_rf_reg(dm, e_rf_path, RF_0x65, gain_bmask, (btg >> 1)); + } else { + odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(19), data & BIT(0)); + odm_set_rf_reg(dm, e_rf_path, RF_0x55, gain_bmask, + ((data & 0x1f) >> 1)); + } + + RF_DBG(dm, DBG_RF_MP, + "[kfree] 8821c 0x55[19:14]=0x%X 0x65[19:14]=0x%X\n", + odm_get_rf_reg(dm, e_rf_path, RF_0x55, s_gain_bmask), + odm_get_rf_reg(dm, e_rf_path, RF_0x65, s_gain_bmask)); +} + +void phydm_clear_kfree_to_rf_8821c(void *dm_void, u8 e_rf_path, u8 data) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 gain_bmask = (BIT(18) | BIT(17) | BIT(16) | BIT(15) | BIT(14)); + u32 s_gain_bmask = (BIT(19) | BIT(18) | BIT(17) | + BIT(16) | BIT(15) | BIT(14)); + + odm_set_rf_reg(dm, e_rf_path, RF_0xde, BIT(0), 1); + odm_set_rf_reg(dm, e_rf_path, RF_0xde, BIT(5), 1); + odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(6), 1); + odm_set_rf_reg(dm, e_rf_path, RF_0x65, BIT(6), 1); + + odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(19), (data & BIT(0))); + odm_set_rf_reg(dm, e_rf_path, RF_0x55, gain_bmask, (data >> 1)); + + odm_set_rf_reg(dm, e_rf_path, RF_0x65, BIT(19), (data & BIT(0))); + odm_set_rf_reg(dm, e_rf_path, RF_0x65, gain_bmask, (data >> 1)); + + odm_set_rf_reg(dm, e_rf_path, RF_0xde, BIT(0), 0); + odm_set_rf_reg(dm, e_rf_path, RF_0xde, BIT(5), 0); + odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(6), 0); + odm_set_rf_reg(dm, e_rf_path, RF_0x65, BIT(6), 0); + + RF_DBG(dm, DBG_RF_MP, + "[kfree] 8821c 0x55[19:14]=0x%X 0x65[19:14]=0x%X\n", + odm_get_rf_reg(dm, e_rf_path, RF_0x55, s_gain_bmask), + odm_get_rf_reg(dm, e_rf_path, RF_0x65, s_gain_bmask)); +} + +void phydm_get_thermal_trim_offset_8822b(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; + + u8 pg_therm = 0xff; + + odm_efuse_one_byte_read(dm, PPG_THERMAL_OFFSET_22B, &pg_therm, false); + + if (pg_therm != 0xff) { + pg_therm = pg_therm & 0x1f; + if ((pg_therm & BIT(0)) == 0) + power_trim_info->thermal = (-1 * (pg_therm >> 1)); + else + power_trim_info->thermal = (pg_therm >> 1); + + power_trim_info->flag |= KFREE_FLAG_THERMAL_K_ON; + } + + RF_DBG(dm, DBG_RF_MP, "[kfree] 8822b thermal trim flag:0x%02x\n", + power_trim_info->flag); + + if (power_trim_info->flag & KFREE_FLAG_THERMAL_K_ON) + RF_DBG(dm, DBG_RF_MP, "[kfree] 8822b thermal:%d\n", + power_trim_info->thermal); +} + +void phydm_get_power_trim_offset_8822b(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; + + u8 pg_power = 0xff, i, j; + + odm_efuse_one_byte_read(dm, PPG_2G_TXAB_22B, &pg_power, false); + + if (pg_power != 0xff) { + /*Path A*/ + odm_efuse_one_byte_read(dm, PPG_2G_TXAB_22B, &pg_power, false); + power_trim_info->bb_gain[0][0] = (pg_power & 0xf); + + /*Path B*/ + odm_efuse_one_byte_read(dm, PPG_2G_TXAB_22B, &pg_power, false); + power_trim_info->bb_gain[0][1] = ((pg_power & 0xf0) >> 4); + + power_trim_info->flag |= KFREE_FLAG_ON_2G; + power_trim_info->flag |= KFREE_FLAG_ON; + } + + odm_efuse_one_byte_read(dm, PPG_5GL1_TXA_22B, &pg_power, false); + + if (pg_power != 0xff) { + /*Path A*/ + odm_efuse_one_byte_read(dm, PPG_5GL1_TXA_22B, &pg_power, false); + power_trim_info->bb_gain[1][0] = pg_power; + odm_efuse_one_byte_read(dm, PPG_5GL2_TXA_22B, &pg_power, false); + power_trim_info->bb_gain[2][0] = pg_power; + odm_efuse_one_byte_read(dm, PPG_5GM1_TXA_22B, &pg_power, false); + power_trim_info->bb_gain[3][0] = pg_power; + odm_efuse_one_byte_read(dm, PPG_5GM2_TXA_22B, &pg_power, false); + power_trim_info->bb_gain[4][0] = pg_power; + odm_efuse_one_byte_read(dm, PPG_5GH1_TXA_22B, &pg_power, false); + power_trim_info->bb_gain[5][0] = pg_power; + + /*Path B*/ + odm_efuse_one_byte_read(dm, PPG_5GL1_TXB_22B, &pg_power, false); + power_trim_info->bb_gain[1][1] = pg_power; + odm_efuse_one_byte_read(dm, PPG_5GL2_TXB_22B, &pg_power, false); + power_trim_info->bb_gain[2][1] = pg_power; + odm_efuse_one_byte_read(dm, PPG_5GM1_TXB_22B, &pg_power, false); + power_trim_info->bb_gain[3][1] = pg_power; + odm_efuse_one_byte_read(dm, PPG_5GM2_TXB_22B, &pg_power, false); + power_trim_info->bb_gain[4][1] = pg_power; + odm_efuse_one_byte_read(dm, PPG_5GH1_TXB_22B, &pg_power, false); + power_trim_info->bb_gain[5][1] = pg_power; + + power_trim_info->flag |= KFREE_FLAG_ON_5G; + power_trim_info->flag |= KFREE_FLAG_ON; + } + + RF_DBG(dm, DBG_RF_MP, "[kfree] 8822b power trim flag:0x%02x\n", + power_trim_info->flag); + + if (!(power_trim_info->flag & KFREE_FLAG_ON)) + return; + + for (i = 0; i < KFREE_BAND_NUM; i++) { + for (j = 0; j < 2; j++) + RF_DBG(dm, DBG_RF_MP, + "[kfree] 8822b PwrTrim->bb_gain[%d][%d]=0x%X\n", + i, j, power_trim_info->bb_gain[i][j]); + } +} + +void phydm_set_pa_bias_to_rf_8822b(void *dm_void, u8 e_rf_path, s8 tx_pa_bias) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 rf_reg_51 = 0, rf_reg_52 = 0, rf_reg_3f = 0; + u32 tx_pa_bias_bmask = (BIT(12) | BIT(11) | BIT(10) | BIT(9)); + + rf_reg_51 = odm_get_rf_reg(dm, e_rf_path, RF_0x51, RFREGOFFSETMASK); + rf_reg_52 = odm_get_rf_reg(dm, e_rf_path, RF_0x52, RFREGOFFSETMASK); + + RF_DBG(dm, DBG_RF_MP, + "[kfree] 8822b 2g rf(0x51)=0x%X rf(0x52)=0x%X path=%d\n", + rf_reg_51, rf_reg_52, e_rf_path); + +#if 0 + /*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]*/ +#endif + 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); + + RF_DBG(dm, DBG_RF_MP, + "[kfree] 8822b 2g original 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 & tx_pa_bias_bmask) >> 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)); + + RF_DBG(dm, DBG_RF_MP, + "[kfree] 8822b 2g 0x%X 0x%X pa_bias=%d rfreg_3f=0x%X path=%d\n", + PPG_PABIAS_2GA_22B, PPG_PABIAS_2GB_22B, + tx_pa_bias, rf_reg_3f, e_rf_path); + + odm_set_rf_reg(dm, e_rf_path, RF_0xef, BIT(10), 0x1); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x0); + odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, rf_reg_3f); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, BIT(0), 0x1); + odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, rf_reg_3f); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, BIT(1), 0x1); + odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, rf_reg_3f); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, (BIT(1) | BIT(0)), 0x3); + odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, rf_reg_3f); + odm_set_rf_reg(dm, e_rf_path, RF_0xef, BIT(10), 0x0); + + RF_DBG(dm, DBG_RF_MP, + "[kfree] 8822b 2g tx pa bias rf_0x3f(0x%X) path=%d\n", + odm_get_rf_reg(dm, e_rf_path, RF_0x3f, + (BIT(12) | BIT(11) | BIT(10) | BIT(9))), + e_rf_path); +} + +void phydm_get_pa_bias_offset_8822b(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; + + u8 pg_pa_bias = 0xff, e_rf_path = 0; + s8 tx_pa_bias[2] = {0}; + + odm_efuse_one_byte_read(dm, PPG_PABIAS_2GA_22B, &pg_pa_bias, false); + + if (pg_pa_bias != 0xff) { + /*paht a*/ + odm_efuse_one_byte_read(dm, PPG_PABIAS_2GA_22B, + &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(dm, PPG_PABIAS_2GB_22B, + &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); + + RF_DBG(dm, DBG_RF_MP, + "[kfree] 8822b 2g PathA_pa_bias:%d 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(dm, e_rf_path, + tx_pa_bias[e_rf_path]); + + power_trim_info->pa_bias_flag |= PA_BIAS_FLAG_ON; + } else { + RF_DBG(dm, DBG_RF_MP, "[kfree] 8822b 2g tx pa bias no pg\n"); + } +} + +void phydm_set_kfree_to_rf_8822b(void *dm_void, u8 e_rf_path, u8 data) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 gain_bmask = (BIT(18) | BIT(17) | BIT(16) | BIT(15) | BIT(14)); + + odm_set_rf_reg(dm, e_rf_path, RF_0xde, BIT(0), 1); + odm_set_rf_reg(dm, e_rf_path, RF_0xde, BIT(4), 1); + odm_set_rf_reg(dm, e_rf_path, RF_0x65, MASKLWORD, 0x9000); + odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(5), 1); + + odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(19), (data & BIT(0))); + odm_set_rf_reg(dm, e_rf_path, RF_0x55, gain_bmask, + ((data & 0x1f) >> 1)); + + RF_DBG(dm, DBG_RF_MP, "[kfree] 8822b 0x55[19:14]=0x%X path=%d\n", + odm_get_rf_reg(dm, e_rf_path, RF_0x55, + (BIT(19) | BIT(18) | BIT(17) | BIT(16) | + BIT(15) | BIT(14))), e_rf_path); +} + +void phydm_clear_kfree_to_rf_8822b(void *dm_void, u8 e_rf_path, u8 data) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 gain_bmask = (BIT(18) | BIT(17) | BIT(16) | BIT(15) | BIT(14)); + + odm_set_rf_reg(dm, e_rf_path, RF_0xde, BIT(0), 1); + odm_set_rf_reg(dm, e_rf_path, RF_0xde, BIT(4), 1); + odm_set_rf_reg(dm, e_rf_path, RF_0x65, MASKLWORD, 0x9000); + odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(5), 1); + + odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(19), (data & BIT(0))); + odm_set_rf_reg(dm, e_rf_path, RF_0x55, gain_bmask, + ((data & 0x1f) >> 1)); + + odm_set_rf_reg(dm, e_rf_path, RF_0xde, BIT(0), 0); + odm_set_rf_reg(dm, e_rf_path, RF_0xde, BIT(4), 1); + odm_set_rf_reg(dm, e_rf_path, RF_0x65, MASKLWORD, 0x9000); + odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(5), 0); + odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(7), 0); + + RF_DBG(dm, DBG_RF_MP, + "[kfree] 8822b clear power trim 0x55[19:14]=0x%X path=%d\n", + odm_get_rf_reg(dm, e_rf_path, RF_0x55, + (BIT(19) | BIT(18) | BIT(17) | BIT(16) | + BIT(15) | BIT(14))), e_rf_path); +} + +void phydm_get_thermal_trim_offset_8710b(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; + + u8 pg_therm = 0xff; + + odm_efuse_one_byte_read(dm, 0x0EF, &pg_therm, false); + + if (pg_therm != 0xff) { + pg_therm = pg_therm & 0x1f; + if ((pg_therm & BIT(0)) == 0) + power_trim_info->thermal = (-1 * (pg_therm >> 1)); + else + power_trim_info->thermal = (pg_therm >> 1); + + power_trim_info->flag |= KFREE_FLAG_THERMAL_K_ON; + } + + RF_DBG(dm, DBG_RF_MP, "[kfree] 8710b thermal trim flag:0x%02x\n", + power_trim_info->flag); + + if (power_trim_info->flag & KFREE_FLAG_THERMAL_K_ON) + RF_DBG(dm, DBG_RF_MP, "[kfree] 8710b thermal:%d\n", + power_trim_info->thermal); +} + +void phydm_get_power_trim_offset_8710b(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; + + u8 pg_power = 0xff; + + odm_efuse_one_byte_read(dm, 0xEE, &pg_power, false); + + if (pg_power != 0xff) { + /*Path A*/ + odm_efuse_one_byte_read(dm, 0xEE, &pg_power, false); + power_trim_info->bb_gain[0][0] = (pg_power & 0xf); + + power_trim_info->flag |= KFREE_FLAG_ON_2G; + power_trim_info->flag |= KFREE_FLAG_ON; + } + + RF_DBG(dm, DBG_RF_MP, "[kfree] 8710b power trim flag:0x%02x\n", + power_trim_info->flag); + + if (power_trim_info->flag & KFREE_FLAG_ON) + RF_DBG(dm, DBG_RF_MP, + "[kfree] 8710b power_trim_data->bb_gain[0][0]=0x%X\n", + power_trim_info->bb_gain[0][0]); +} + +void phydm_set_kfree_to_rf_8710b(void *dm_void, u8 e_rf_path, u8 data) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 gain_bmask = (BIT(18) | BIT(17) | BIT(16) | BIT(15)); + + odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(19), (data & BIT(0))); + odm_set_rf_reg(dm, e_rf_path, RF_0x55, gain_bmask, ((data & 0xf) >> 1)); + + RF_DBG(dm, DBG_RF_MP, "[kfree] 8710b 0x55[19:14]=0x%X path=%d\n", + odm_get_rf_reg(dm, e_rf_path, RF_0x55, + (BIT(19) | BIT(18) | BIT(17) | BIT(16) | + BIT(15) | BIT(14))), e_rf_path); +} + +void phydm_clear_kfree_to_rf_8710b(void *dm_void, u8 e_rf_path, u8 data) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 gain_bmask = (BIT(18) | BIT(17) | BIT(16) | BIT(15) | BIT(14)); + + odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(19), (data & BIT(0))); + odm_set_rf_reg(dm, e_rf_path, RF_0x55, gain_bmask, + ((data & 0x1f) >> 1)); + + RF_DBG(dm, DBG_RF_MP, + "[kfree] 8710b clear power trim 0x55[19:14]=0x%X path=%d\n", + odm_get_rf_reg(dm, e_rf_path, RF_0x55, + (BIT(19) | BIT(18) | BIT(17) | BIT(16) | + BIT(15) | BIT(14))), e_rf_path); +} + +void phydm_get_thermal_trim_offset_8192f(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; + + u8 pg_therm = 0xff; + + odm_efuse_one_byte_read(dm, 0x1EF, &pg_therm, false); + + if (pg_therm != 0xff) { + pg_therm = pg_therm & 0x1f; + if ((pg_therm & BIT(0)) == 0) + power_trim_info->thermal = (-1 * (pg_therm >> 1)); + else + power_trim_info->thermal = (pg_therm >> 1); + + power_trim_info->flag |= KFREE_FLAG_THERMAL_K_ON; + } + + RF_DBG(dm, DBG_RF_MP, "[kfree] 8192f thermal trim flag:0x%02x\n", + power_trim_info->flag); + + if (power_trim_info->flag & KFREE_FLAG_THERMAL_K_ON) + RF_DBG(dm, DBG_RF_MP, "[kfree] 8192f thermal:%d\n", + power_trim_info->thermal); +} + +void phydm_get_power_trim_offset_8192f(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; + + u8 pg_power1 = 0xff, pg_power2 = 0xff, pg_power3 = 0xff, i, j; + + odm_efuse_one_byte_read(dm, 0x1EE, &pg_power1, false); /*CH4-9*/ + + if (pg_power1 != 0xff) { + /*Path A*/ + odm_efuse_one_byte_read(dm, 0x1EE, &pg_power1, false); + power_trim_info->bb_gain[1][0] = (pg_power1 & 0xf); + /*Path B*/ + odm_efuse_one_byte_read(dm, 0x1EE, &pg_power1, false); + power_trim_info->bb_gain[1][1] = ((pg_power1 & 0xf0) >> 4); + + power_trim_info->flag |= KFREE_FLAG_ON_2G; + power_trim_info->flag |= KFREE_FLAG_ON; + } + + odm_efuse_one_byte_read(dm, 0x1EC, &pg_power2, false); /*CH1-3*/ + + if (pg_power2 != 0xff) { + /*Path A*/ + odm_efuse_one_byte_read(dm, 0x1EC, &pg_power2, false); + power_trim_info->bb_gain[0][0] = (pg_power2 & 0xf); + /*Path B*/ + odm_efuse_one_byte_read(dm, 0x1EC, &pg_power2, false); + power_trim_info->bb_gain[0][1] = ((pg_power2 & 0xf0) >> 4); + + power_trim_info->flag |= KFREE_FLAG_ON_2G; + power_trim_info->flag |= KFREE_FLAG_ON; + } else { + power_trim_info->bb_gain[0][0] = (pg_power1 & 0xf); + power_trim_info->bb_gain[0][1] = ((pg_power1 & 0xf0) >> 4); + } + + odm_efuse_one_byte_read(dm, 0x1EA, &pg_power3, false); /*CH10-14*/ + + if (pg_power3 != 0xff) { + /*Path A*/ + odm_efuse_one_byte_read(dm, 0x1EA, &pg_power3, false); + power_trim_info->bb_gain[2][0] = (pg_power3 & 0xf); + /*Path B*/ + odm_efuse_one_byte_read(dm, 0x1EA, &pg_power3, false); + power_trim_info->bb_gain[2][1] = ((pg_power3 & 0xf0) >> 4); + + power_trim_info->flag |= KFREE_FLAG_ON_2G; + power_trim_info->flag |= KFREE_FLAG_ON; + } else { + power_trim_info->bb_gain[2][0] = (pg_power1 & 0xf); + power_trim_info->bb_gain[2][1] = ((pg_power1 & 0xf0) >> 4); + } + + RF_DBG(dm, DBG_RF_MP, "[kfree] 8192F power trim flag:0x%02x\n", + power_trim_info->flag); + + if (!(power_trim_info->flag & KFREE_FLAG_ON)) + return; + + for (i = 0; i < KFREE_CH_NUM; i++) { + for (j = 0; j < 2; j++) + RF_DBG(dm, DBG_RF_MP, + "[kfree] 8192F PwrTrim->bb_gain[%d][%d]=0x%X\n", + i, j, power_trim_info->bb_gain[i][j]); + } +} + +void phydm_set_kfree_to_rf_8192f(void *dm_void, u8 e_rf_path, u8 channel_idx, + u8 data) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + /*power_trim based on 55[19:14]*/ + odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(5), 1); + /*enable 55[14] for 0.5db step*/ + odm_set_rf_reg(dm, e_rf_path, RF_0xf5, BIT(18), 1); + /*enter power_trim debug mode*/ + odm_set_rf_reg(dm, e_rf_path, RF_0xdf, BIT(7), 1); + /*write enable*/ + odm_set_rf_reg(dm, e_rf_path, RF_0xef, BIT(7), 1); + + if (e_rf_path == 0) { + if (channel_idx == 0) { + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 0); + odm_set_rf_reg(dm, e_rf_path, 0x33, 0x3F, data); + + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 1); + odm_set_rf_reg(dm, e_rf_path, 0x33, 0x3F, data); + + } else if (channel_idx == 1) { + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 2); + odm_set_rf_reg(dm, e_rf_path, 0x33, 0x3F, data); + + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 3); + odm_set_rf_reg(dm, e_rf_path, 0x33, 0x3F, data); + } else if (channel_idx == 2) { + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 4); + odm_set_rf_reg(dm, e_rf_path, 0x33, 0x3F, data); + + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 5); + odm_set_rf_reg(dm, e_rf_path, 0x33, 0x3F, data); + } + } else if (e_rf_path == 1) { + if (channel_idx == 0) { + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 0); + odm_set_rf_reg(dm, e_rf_path, 0x33, 0x3F, data); + + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 1); + odm_set_rf_reg(dm, e_rf_path, 0x33, 0x3F, data); + } else if (channel_idx == 1) { + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 2); + odm_set_rf_reg(dm, e_rf_path, 0x33, 0x3F, data); + + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 3); + odm_set_rf_reg(dm, e_rf_path, 0x33, 0x3F, data); + } else if (channel_idx == 2) { + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 4); + odm_set_rf_reg(dm, e_rf_path, 0x33, 0x3F, data); + + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 5); + odm_set_rf_reg(dm, e_rf_path, 0x33, 0x3F, data); + } + } + + /*leave power_trim debug mode*/ + odm_set_rf_reg(dm, e_rf_path, RF_0xdf, BIT(7), 0); + /*write disable*/ + odm_set_rf_reg(dm, e_rf_path, RF_0xef, BIT(7), 0); + + RF_DBG(dm, DBG_RF_MP, + "[kfree] 8192F 0x55[19:14]=0x%X path=%d channel=%d\n", + odm_get_rf_reg(dm, e_rf_path, RF_0x55, + (BIT(19) | BIT(18) | BIT(17) | BIT(16) | + BIT(15) | BIT(14))), e_rf_path, channel_idx); +} + +#if 0 +/* +void phydm_clear_kfree_to_rf_8192f(void *dm_void, u8 e_rf_path, u8 data) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct dm_rf_calibration_struct *cali_info = &dm->rf_calibrate_info; + + odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(19), (data & BIT(0))); + odm_set_rf_reg(dm, e_rf_path, RF_0x55, (BIT(18) | BIT(17) | BIT(16) | BIT(15) | BIT(14)), ((data & 0x1f) >> 1)); + + RF_DBG(dm, DBG_RF_MP, + "[kfree] 8192F clear power trim 0x55[19:14]=0x%X path=%d\n", + odm_get_rf_reg(dm, e_rf_path, RF_0x55, (BIT(19) | BIT(18) | BIT(17) | BIT(16) | BIT(15) | BIT(14))), + e_rf_path + ); +} +*/ +#endif + +void phydm_get_thermal_trim_offset_8198f(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; + + u8 pg_therm = 0xff; + + odm_efuse_one_byte_read(dm, PPG_THERMAL_OFFSET_98F, &pg_therm, false); + + if (pg_therm != 0xff) { + pg_therm = pg_therm & 0x1f; + if ((pg_therm & BIT(0)) == 0) + power_trim_info->thermal = (-1 * (pg_therm >> 1)); + else + power_trim_info->thermal = (pg_therm >> 1); + + power_trim_info->flag |= KFREE_FLAG_THERMAL_K_ON; + } + + RF_DBG(dm, DBG_RF_MP, "[kfree] 8198f thermal trim flag:0x%02x\n", + power_trim_info->flag); + + if (power_trim_info->flag & KFREE_FLAG_THERMAL_K_ON) + RF_DBG(dm, DBG_RF_MP, "[kfree] 8198f thermal:%d\n", + power_trim_info->thermal); +} + +void phydm_get_power_trim_offset_8198f(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; + + u8 pg_power = 0xff, i, j; + + odm_efuse_one_byte_read(dm, PPG_2GL_TXAB_98F, &pg_power, false); + + if (pg_power != 0xff) { + power_trim_info->bb_gain[0][0] = pg_power & 0xf; + power_trim_info->bb_gain[0][1] = (pg_power & 0xf0) >> 4; + + odm_efuse_one_byte_read(dm, PPG_2GL_TXCD_98F, &pg_power, false); + power_trim_info->bb_gain[0][2] = pg_power & 0xf; + power_trim_info->bb_gain[0][3] = (pg_power & 0xf0) >> 4; + + odm_efuse_one_byte_read(dm, PPG_2GM_TXAB_98F, &pg_power, false); + power_trim_info->bb_gain[1][0] = pg_power & 0xf; + power_trim_info->bb_gain[1][1] = (pg_power & 0xf0) >> 4; + + odm_efuse_one_byte_read(dm, PPG_2GM_TXCD_98F, &pg_power, false); + power_trim_info->bb_gain[1][2] = pg_power & 0xf; + power_trim_info->bb_gain[1][3] = (pg_power & 0xf0) >> 4; + + odm_efuse_one_byte_read(dm, PPG_2GH_TXAB_98F, &pg_power, false); + power_trim_info->bb_gain[2][0] = pg_power & 0xf; + power_trim_info->bb_gain[2][1] = (pg_power & 0xf0) >> 4; + + odm_efuse_one_byte_read(dm, PPG_2GH_TXCD_98F, &pg_power, false); + power_trim_info->bb_gain[2][2] = pg_power & 0xf; + power_trim_info->bb_gain[2][3] = (pg_power & 0xf0) >> 4; + + power_trim_info->flag = + power_trim_info->flag | KFREE_FLAG_ON | KFREE_FLAG_ON_2G; + } + + RF_DBG(dm, DBG_RF_MP, "[kfree] 8198f power trim flag:0x%02x\n", + power_trim_info->flag); + + if (power_trim_info->flag & KFREE_FLAG_ON) { + for (i = 0; i < KFREE_BAND_NUM; i++) { + for (j = 0; j < MAX_RF_PATH; j++) { + RF_DBG(dm, DBG_RF_MP, + "[kfree] 8198f pwr_trim->bb_gain[%d][%d]=0x%X\n", + i, j, power_trim_info->bb_gain[i][j]); + } + } + } +} + +void phydm_set_kfree_to_rf_8198f(void *dm_void, u8 e_rf_path, u8 data) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; + u32 band, i; + s8 pwr_offset[3]; + + RF_DBG(dm, DBG_RF_MP, + "[kfree] %s:Set kfree to rf 0x33\n", __func__); + + /*power_trim based on 55[19:14]*/ + odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(5), 1); + /*enable 55[14] for 0.5db step*/ + odm_set_rf_reg(dm, e_rf_path, RF_0xf5, BIT(18), 1); + /*enter power_trim debug mode*/ + odm_set_rf_reg(dm, e_rf_path, RF_0xdf, BIT(7), 0); + /*write enable*/ + odm_set_rf_reg(dm, e_rf_path, RF_0xef, BIT(7), 1); + + for (i =0; i < 3; i++) + pwr_offset[i] = power_trim_info->bb_gain[i][e_rf_path]; + + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 0); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x3F, pwr_offset[0]); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 1); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x3F, pwr_offset[0]); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 2); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x3F, pwr_offset[1]); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 3); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x3F, pwr_offset[1]); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 4); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x3F, pwr_offset[2]); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 5); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x3F, pwr_offset[2]); + + /*leave power_trim debug mode*/ + /*odm_set_rf_reg(dm, e_rf_path, RF_0xdf, BIT(7), 0);*/ + /*write disable*/ + odm_set_rf_reg(dm, e_rf_path, RF_0xef, BIT(7), 0); + +} + +void phydm_clear_kfree_to_rf_8198f(void *dm_void, u8 e_rf_path, u8 data) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + RF_DBG(dm, DBG_RF_MP, + "[kfree] %s:Clear kfree to rf 0x55\n", __func__); +#if 0 + /*power_trim based on 55[19:14]*/ + odm_set_rf_reg(dm, e_rf_path, RF_0x55, BIT(5), 1); + /*enable 55[14] for 0.5db step*/ + odm_set_rf_reg(dm, e_rf_path, RF_0xf5, BIT(18), 1); + /*enter power_trim debug mode*/ + odm_set_rf_reg(dm, e_rf_path, RF_0xdf, BIT(7), 0); + /*write enable*/ + odm_set_rf_reg(dm, e_rf_path, RF_0xef, BIT(7), 1); + + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 0); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x3F, data); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 1); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x3F, data); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 2); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x3F, data); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 3); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x3F, data); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 4); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x3F, data); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x70000, 5); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, 0x3F, data); + + /*leave power_trim debug mode*/ + odm_set_rf_reg(dm, e_rf_path, RF_0xdf, BIT(7), 0); + /*enable 55[14] for 0.5db step*/ + odm_set_rf_reg(dm, e_rf_path, RF_0xf5, BIT(18), 0); + /*write disable*/ + odm_set_rf_reg(dm, e_rf_path, RF_0xef, BIT(7), 0); +#else + + odm_set_rf_reg(dm, e_rf_path, RF_0xdf, BIT(7), 1); + /*odm_set_rf_reg(dm, e_rf_path, RF_0xf5, BIT(18), 0);*/ + +#endif + +} + +void phydm_get_set_thermal_trim_offset_8822c(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; + + u8 pg_therm = 0xff, thermal[2] = {0}; + + odm_efuse_one_byte_read(dm, PPG_THERMAL_A_OFFSET_22C, &pg_therm, false); + + if (pg_therm != 0xff) { + /*s0*/ + pg_therm = pg_therm & 0x1f; + + thermal[RF_PATH_A] = + ((pg_therm & 0x1) << 3) | ((pg_therm >> 1) & 0x7); + + odm_set_rf_reg(dm, RF_PATH_A, RF_0x43, 0x000f0000, thermal[RF_PATH_A]); + + /*s1*/ + odm_efuse_one_byte_read(dm, PPG_THERMAL_B_OFFSET_22C, &pg_therm, false); + + pg_therm = pg_therm & 0x1f; + + thermal[RF_PATH_B] = ((pg_therm & 0x1) << 3) | ((pg_therm >> 1) & 0x7); + + odm_set_rf_reg(dm, RF_PATH_B, RF_0x43, 0x000f0000, thermal[RF_PATH_B]); + + power_trim_info->flag |= KFREE_FLAG_THERMAL_K_ON; + + } + + RF_DBG(dm, DBG_RF_MP, "[kfree] 8822c thermal trim flag:0x%02x\n", + power_trim_info->flag); + + if (power_trim_info->flag & KFREE_FLAG_THERMAL_K_ON) + RF_DBG(dm, DBG_RF_MP, "[kfree] 8822c thermalA:%d thermalB:%d\n", + thermal[RF_PATH_A], + thermal[RF_PATH_B]); +} + +void phydm_set_power_trim_offset_8822c(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; + u8 e_rf_path; + + for (e_rf_path = RF_PATH_A; e_rf_path < 2; e_rf_path++) + { + odm_set_rf_reg(dm, e_rf_path, RF_0xee, BIT(19), 1); + + odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x0); + odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, + power_trim_info->bb_gain[0][e_rf_path]); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x1); + odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, + power_trim_info->bb_gain[1][e_rf_path]); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x2); + odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, + power_trim_info->bb_gain[2][e_rf_path]); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x3); + odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, + power_trim_info->bb_gain[2][e_rf_path]); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x4); + odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, + power_trim_info->bb_gain[3][e_rf_path]); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x5); + odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, + power_trim_info->bb_gain[4][e_rf_path]); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x6); + odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, + power_trim_info->bb_gain[5][e_rf_path]); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x7); + odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, + power_trim_info->bb_gain[6][e_rf_path]); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x8); + odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, + power_trim_info->bb_gain[7][e_rf_path]); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0x9); + odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, + power_trim_info->bb_gain[3][e_rf_path]); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0xa); + odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, + power_trim_info->bb_gain[4][e_rf_path]); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0xb); + odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, + power_trim_info->bb_gain[5][e_rf_path]); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0xc); + odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, + power_trim_info->bb_gain[6][e_rf_path]); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0xd); + odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, + power_trim_info->bb_gain[7][e_rf_path]); + odm_set_rf_reg(dm, e_rf_path, RF_0x33, RFREGOFFSETMASK, 0xe); + odm_set_rf_reg(dm, e_rf_path, RF_0x3f, RFREGOFFSETMASK, + power_trim_info->bb_gain[7][e_rf_path]); + + odm_set_rf_reg(dm, e_rf_path, RF_0xee, BIT(19), 0); + } +} + +void phydm_get_power_trim_offset_8822c(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; + + u8 pg_power = 0xff, i, j; + u8 pg_power1, pg_power2 , pg_power3, pg_power4, pg_power5; + + odm_efuse_one_byte_read(dm, PPG_2GL_TXAB_22C, &pg_power1, false); + odm_efuse_one_byte_read(dm, PPG_2GM_TXAB_22C, &pg_power2, false); + odm_efuse_one_byte_read(dm, PPG_2GH_TXAB_22C, &pg_power3, false); + odm_efuse_one_byte_read(dm, PPG_5GL1_TXA_22C, &pg_power4, false); + odm_efuse_one_byte_read(dm, PPG_5GL1_TXB_22C, &pg_power5, false); + + if (pg_power1 != 0xff || pg_power2 != 0xff || pg_power3 != 0xff || + pg_power4 != 0xff || pg_power5 != 0xff) { + odm_efuse_one_byte_read(dm, PPG_2GL_TXAB_22C, &pg_power, false); + if (pg_power == 0xff) + pg_power = 0; + power_trim_info->bb_gain[0][0] = pg_power & 0xf; + power_trim_info->bb_gain[0][1] = (pg_power & 0xf0) >> 4; + + odm_efuse_one_byte_read(dm, PPG_2GM_TXAB_22C, &pg_power, false); + if (pg_power == 0xff) + pg_power = 0; + power_trim_info->bb_gain[1][0] = pg_power & 0xf; + power_trim_info->bb_gain[1][1] = (pg_power & 0xf0) >> 4; + + odm_efuse_one_byte_read(dm, PPG_2GH_TXAB_22C, &pg_power, false); + if (pg_power == 0xff) + pg_power = 0; + power_trim_info->bb_gain[2][0] = pg_power & 0xf; + power_trim_info->bb_gain[2][1] = (pg_power & 0xf0) >> 4; + + odm_efuse_one_byte_read(dm, PPG_5GL1_TXA_22C, &pg_power, false); + if (pg_power == 0xff) + pg_power = 0; + power_trim_info->bb_gain[3][0] = pg_power & 0x1f; + odm_efuse_one_byte_read(dm, PPG_5GL1_TXB_22C, &pg_power, false); + if (pg_power == 0xff) + pg_power = 0; + power_trim_info->bb_gain[3][1] = pg_power & 0x1f; + + odm_efuse_one_byte_read(dm, PPG_5GL2_TXA_22C, &pg_power, false); + if (pg_power == 0xff) + pg_power = 0; + power_trim_info->bb_gain[4][0] = pg_power & 0x1f; + odm_efuse_one_byte_read(dm, PPG_5GL2_TXB_22C, &pg_power, false); + if (pg_power == 0xff) + pg_power = 0; + power_trim_info->bb_gain[4][1] = pg_power & 0x1f; + + odm_efuse_one_byte_read(dm, PPG_5GM1_TXA_22C, &pg_power, false); + if (pg_power == 0xff) + pg_power = 0; + power_trim_info->bb_gain[5][0] = pg_power & 0x1f; + odm_efuse_one_byte_read(dm, PPG_5GM1_TXB_22C, &pg_power, false); + if (pg_power == 0xff) + pg_power = 0; + power_trim_info->bb_gain[5][1] = pg_power & 0x1f; + + odm_efuse_one_byte_read(dm, PPG_5GM2_TXA_22C, &pg_power, false); + if (pg_power == 0xff) + pg_power = 0; + power_trim_info->bb_gain[6][0] = pg_power & 0x1f; + odm_efuse_one_byte_read(dm, PPG_5GM2_TXB_22C, &pg_power, false); + if (pg_power == 0xff) + pg_power = 0; + power_trim_info->bb_gain[6][1] = pg_power & 0x1f; + + odm_efuse_one_byte_read(dm, PPG_5GH1_TXA_22C, &pg_power, false); + if (pg_power == 0xff) + pg_power = 0; + power_trim_info->bb_gain[7][0] = pg_power & 0x1f; + odm_efuse_one_byte_read(dm, PPG_5GH1_TXB_22C, &pg_power, false); + if (pg_power == 0xff) + pg_power = 0; + power_trim_info->bb_gain[7][1] = pg_power & 0x1f; + + power_trim_info->flag = + power_trim_info->flag | KFREE_FLAG_ON | + KFREE_FLAG_ON_2G | + KFREE_FLAG_ON_5G; + + phydm_set_power_trim_offset_8822c(dm); + } + + RF_DBG(dm, DBG_RF_MP, "[kfree] 8822c power trim flag:0x%02x\n", + power_trim_info->flag); + + if (power_trim_info->flag & KFREE_FLAG_ON) { + for (i = 0; i < KFREE_BAND_NUM; i++) { + for (j = 0; j < 2; j++) { + RF_DBG(dm, DBG_RF_MP, + "[kfree] 8822c pwr_trim->bb_gain[%d][%d]=0x%X\n", + i, j, power_trim_info->bb_gain[i][j]); + } + } + } +} + +void phydm_get_set_pa_bias_offset_8822c(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; + + u8 pg_pa_bias = 0xff; + + RF_DBG(dm, DBG_RF_MP, "======>%s\n", __func__); + + odm_efuse_one_byte_read(dm, PPG_PABIAS_2GA_22C, &pg_pa_bias, false); + + if (pg_pa_bias != 0xff) { + /*2G s0*/ + odm_efuse_one_byte_read(dm, PPG_PABIAS_2GA_22C, + &pg_pa_bias, false); + pg_pa_bias = pg_pa_bias & 0xf; + + RF_DBG(dm, DBG_RF_MP, "[kfree] 2G s0 pa_bias=0x%x\n", pg_pa_bias); + + odm_set_rf_reg(dm, RF_PATH_A, 0x60, 0x0000f000, pg_pa_bias); + + /*2G s1*/ + odm_efuse_one_byte_read(dm, PPG_PABIAS_2GB_22C, + &pg_pa_bias, false); + pg_pa_bias = pg_pa_bias & 0xf; + + RF_DBG(dm, DBG_RF_MP, "[kfree] 2G s1 pa_bias=0x%x\n", pg_pa_bias); + + odm_set_rf_reg(dm, RF_PATH_B, 0x60, 0x0000f000, pg_pa_bias); + + /*5G s0*/ + odm_efuse_one_byte_read(dm, PPG_PABIAS_5GA_22C, + &pg_pa_bias, false); + pg_pa_bias = pg_pa_bias & 0xf; + + RF_DBG(dm, DBG_RF_MP, "[kfree] 5G s0 pa_bias=0x%x\n", pg_pa_bias); + + odm_set_rf_reg(dm, RF_PATH_A, 0x60, 0x000f0000, pg_pa_bias); + + /*5G s1*/ + odm_efuse_one_byte_read(dm, PPG_PABIAS_5GB_22C, + &pg_pa_bias, false); + pg_pa_bias = pg_pa_bias & 0xf; + + RF_DBG(dm, DBG_RF_MP, "[kfree] 5G s1 pa_bias=0x%x\n", pg_pa_bias); + + odm_set_rf_reg(dm, RF_PATH_B, 0x60, 0x000f0000, pg_pa_bias); + + power_trim_info->pa_bias_flag |= PA_BIAS_FLAG_ON; + } else { + RF_DBG(dm, DBG_RF_MP, "[kfree] 8822c tx pa bias no pg\n"); + } + +} + +void phydm_do_new_kfree(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (dm->support_ic_type & ODM_RTL8822C) { + phydm_get_set_thermal_trim_offset_8822c(dm); + phydm_get_power_trim_offset_8822c(dm); + phydm_get_set_pa_bias_offset_8822c(dm); + } +} + + + +void phydm_set_kfree_to_rf(void *dm_void, u8 e_rf_path, u8 data) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (dm->support_ic_type & ODM_RTL8814A) + phydm_set_kfree_to_rf_8814a(dm, e_rf_path, data); + + if ((dm->support_ic_type & ODM_RTL8821C) && + (*dm->band_type == ODM_BAND_2_4G)) + phydm_set_kfree_to_rf_8821c(dm, e_rf_path, true, data); + else if (dm->support_ic_type & ODM_RTL8821C) + phydm_set_kfree_to_rf_8821c(dm, e_rf_path, false, data); + + if (dm->support_ic_type & ODM_RTL8822B) + phydm_set_kfree_to_rf_8822b(dm, e_rf_path, data); + + if (dm->support_ic_type & ODM_RTL8710B) + phydm_set_kfree_to_rf_8710b(dm, e_rf_path, data); + + if (dm->support_ic_type & ODM_RTL8198F) + phydm_set_kfree_to_rf_8198f(dm, e_rf_path, data); +} + +void phydm_clear_kfree_to_rf(void *dm_void, u8 e_rf_path, u8 data) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (dm->support_ic_type & ODM_RTL8822B) + phydm_clear_kfree_to_rf_8822b(dm, e_rf_path, 1); + + if (dm->support_ic_type & ODM_RTL8821C) + phydm_clear_kfree_to_rf_8821c(dm, e_rf_path, 1); + + if (dm->support_ic_type & ODM_RTL8198F) + phydm_clear_kfree_to_rf_8198f(dm, e_rf_path, 0); +} + +void phydm_get_thermal_trim_offset(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + void *adapter = dm->adapter; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + PEFUSE_HAL pEfuseHal = &hal_data->EfuseHal; + u1Byte eFuseContent[DCMD_EFUSE_MAX_SECTION_NUM * EFUSE_MAX_WORD_UNIT * 2]; + + if (HAL_MAC_Dump_EFUSE(&GET_HAL_MAC_INFO((PADAPTER)adapter), EFUSE_WIFI, eFuseContent, pEfuseHal->PhysicalLen_WiFi, HAL_MAC_EFUSE_PHYSICAL, HAL_MAC_EFUSE_PARSE_DRV) != RT_STATUS_SUCCESS) + RF_DBG(dm, DBG_RF_MP, "[kfree] dump efuse fail !!!\n"); +#endif + + if (dm->support_ic_type & ODM_RTL8821C) + phydm_get_thermal_trim_offset_8821c(dm_void); + else if (dm->support_ic_type & ODM_RTL8822B) + phydm_get_thermal_trim_offset_8822b(dm_void); + else if (dm->support_ic_type & ODM_RTL8710B) + phydm_get_thermal_trim_offset_8710b(dm_void); + else if (dm->support_ic_type & ODM_RTL8192F) + phydm_get_thermal_trim_offset_8192f(dm_void); + else if (dm->support_ic_type & ODM_RTL8198F) + phydm_get_thermal_trim_offset_8198f(dm_void); +} + +void phydm_get_power_trim_offset(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + +#if 0 //(DM_ODM_SUPPORT_TYPE & ODM_WIN) // 2017 MH DM Should use the same code.s + void *adapter = dm->adapter; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + PEFUSE_HAL pEfuseHal = &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) + RF_DBG(dm, DBG_RF_MP, "[kfree] dump efuse fail !!!\n"); +#endif + + if (dm->support_ic_type & ODM_RTL8821C) + phydm_get_power_trim_offset_8821c(dm_void); + else if (dm->support_ic_type & ODM_RTL8822B) + phydm_get_power_trim_offset_8822b(dm_void); + else if (dm->support_ic_type & ODM_RTL8710B) + phydm_get_power_trim_offset_8710b(dm_void); + else if (dm->support_ic_type & ODM_RTL8192F) + phydm_get_power_trim_offset_8192f(dm_void); + else if (dm->support_ic_type & ODM_RTL8198F) + phydm_get_power_trim_offset_8198f(dm_void); +} + +void phydm_get_pa_bias_offset(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + void *adapter = dm->adapter; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + PEFUSE_HAL pEfuseHal = &hal_data->EfuseHal; + u1Byte eFuseContent[DCMD_EFUSE_MAX_SECTION_NUM * EFUSE_MAX_WORD_UNIT * 2]; + + if (HAL_MAC_Dump_EFUSE(&GET_HAL_MAC_INFO((PADAPTER)adapter), EFUSE_WIFI, eFuseContent, pEfuseHal->PhysicalLen_WiFi, HAL_MAC_EFUSE_PHYSICAL, HAL_MAC_EFUSE_PARSE_DRV) != RT_STATUS_SUCCESS) + RF_DBG(dm, DBG_RF_MP, "[kfree] dump efuse fail !!!\n"); +#endif + + if (dm->support_ic_type & ODM_RTL8822B) + phydm_get_pa_bias_offset_8822b(dm_void); +} + +s8 phydm_get_thermal_offset(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct odm_power_trim_data *power_trim_info = &dm->power_trim_data; + + if (power_trim_info->flag & KFREE_FLAG_THERMAL_K_ON) + return power_trim_info->thermal; + else + return 0; +} + +void phydm_do_kfree(void *dm_void, u8 channel_to_sw) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct odm_power_trim_data *pwrtrim = &dm->power_trim_data; + u8 channel_idx = 0, rfpath = 0, max_path = 0, kfree_band_num = 0; + u8 i, j; + s8 bb_gain; + + if (dm->support_ic_type & ODM_RTL8814A) + max_path = 4; /*0~3*/ + else if (dm->support_ic_type & + (ODM_RTL8812 | ODM_RTL8822B | ODM_RTL8192F)) { + max_path = 2; /*0~1*/ + kfree_band_num = KFREE_BAND_NUM; + } else if (dm->support_ic_type & ODM_RTL8821C) { + max_path = 1; + kfree_band_num = KFREE_BAND_NUM; + } else if (dm->support_ic_type & ODM_RTL8710B) { + max_path = 1; + kfree_band_num = 1; + } else if (dm->support_ic_type & ODM_RTL8198F) { + max_path = 4; + kfree_band_num = 3; + } + + if (dm->support_ic_type & + (ODM_RTL8192F | ODM_RTL8822B | ODM_RTL8821C | + ODM_RTL8814A | ODM_RTL8710B)) { + for (i = 0; i < kfree_band_num; i++) { + for (j = 0; j < max_path; j++) + RF_DBG(dm, DBG_RF_MP, + "[kfree] PwrTrim->gain[%d][%d]=0x%X\n", + i, j, pwrtrim->bb_gain[i][j]); + } + } + if (*dm->band_type == ODM_BAND_2_4G && + pwrtrim->flag & KFREE_FLAG_ON_2G) { + if (!(dm->support_ic_type & ODM_RTL8192F)) { + if (channel_to_sw >= 1 && channel_to_sw <= 14) + channel_idx = PHYDM_2G; + for (rfpath = RF_PATH_A; rfpath < max_path; rfpath++) { + RF_DBG(dm, DBG_RF_MP, + "[kfree] %s:chnl=%d PATH=%d gain:0x%X\n", + __func__, channel_to_sw, rfpath, + pwrtrim->bb_gain[channel_idx][rfpath]); + bb_gain = pwrtrim->bb_gain[channel_idx][rfpath]; + phydm_set_kfree_to_rf(dm, rfpath, bb_gain); + } + } else if (dm->support_ic_type & ODM_RTL8192F) { + if (channel_to_sw >= 1 && channel_to_sw <= 3) + channel_idx = 0; + if (channel_to_sw >= 4 && channel_to_sw <= 9) + channel_idx = 1; + if (channel_to_sw >= 10 && channel_to_sw <= 14) + channel_idx = 2; + for (rfpath = RF_PATH_A; rfpath < max_path; rfpath++) { + RF_DBG(dm, DBG_RF_MP, + "[kfree] %s:chnl=%d PATH=%d gain:0x%X\n", + __func__, channel_to_sw, rfpath, + pwrtrim->bb_gain[channel_idx][rfpath]); + bb_gain = pwrtrim->bb_gain[channel_idx][rfpath]; + phydm_set_kfree_to_rf_8192f(dm, rfpath, + channel_idx, + bb_gain); + } + } + } else if (*dm->band_type == ODM_BAND_5G && + pwrtrim->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_path; rfpath++) { + RF_DBG(dm, DBG_RF_MP, + "[kfree] %s: channel=%d PATH=%d bb_gain:0x%X\n", + __func__, channel_to_sw, rfpath, + pwrtrim->bb_gain[channel_idx][rfpath]); + bb_gain = pwrtrim->bb_gain[channel_idx][rfpath]; + phydm_set_kfree_to_rf(dm, rfpath, bb_gain); + } + } else { + RF_DBG(dm, DBG_RF_MP, "[kfree] Set default Register\n"); + if (!(dm->support_ic_type & ODM_RTL8192F)) { + for (rfpath = RF_PATH_A; rfpath < max_path; rfpath++) { + bb_gain = pwrtrim->bb_gain[channel_idx][rfpath]; + phydm_clear_kfree_to_rf(dm, rfpath, bb_gain); + } + } +#if 0 + /*else if(dm->support_ic_type & ODM_RTL8192F){ + if (channel_to_sw >= 1 && channel_to_sw <= 3) + channel_idx = 0; + if (channel_to_sw >= 4 && channel_to_sw <= 9) + channel_idx = 1; + if (channel_to_sw >= 9 && channel_to_sw <= 14) + channel_idx = 2; + for (rfpath = RF_PATH_A; rfpath < max_path; rfpath++) + phydm_clear_kfree_to_rf_8192f(dm, rfpath, pwrtrim->bb_gain[channel_idx][rfpath]); + }*/ +#endif + } +} + +void phydm_config_new_kfree(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct dm_rf_calibration_struct *cali_info = &dm->rf_calibrate_info; + + if (cali_info->reg_rf_kfree_enable == 2) { + RF_DBG(dm, DBG_RF_MP, + "[kfree] %s: reg_rf_kfree_enable == 2, Disable\n", + __func__); + return; + } else if (cali_info->reg_rf_kfree_enable == 1 || + cali_info->reg_rf_kfree_enable == 0) { + RF_DBG(dm, DBG_RF_MP, + "[kfree] %s: reg_rf_kfree_enable == true\n", __func__); + + phydm_do_new_kfree(dm); + } +} + +void phydm_config_kfree(void *dm_void, u8 channel_to_sw) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct dm_rf_calibration_struct *cali_info = &dm->rf_calibrate_info; + struct odm_power_trim_data *pwrtrim = &dm->power_trim_data; + + RF_DBG(dm, DBG_RF_MP, "===>[kfree] phy_ConfigKFree()\n"); + + if (cali_info->reg_rf_kfree_enable == 2) { + RF_DBG(dm, DBG_RF_MP, + "[kfree] %s: reg_rf_kfree_enable == 2, Disable\n", + __func__); + return; + } else if (cali_info->reg_rf_kfree_enable == 1 || + cali_info->reg_rf_kfree_enable == 0) { + RF_DBG(dm, DBG_RF_MP, + "[kfree] %s: reg_rf_kfree_enable == true\n", __func__); + /*Make sure the targetval is defined*/ + if (!(pwrtrim->flag & KFREE_FLAG_ON)) { + RF_DBG(dm, DBG_RF_MP, + "[kfree] %s: efuse is 0xff, KFree not work\n", + __func__); + return; + } +#if 0 + /*if kfree_table[0] == 0xff, means no Kfree*/ +#endif + phydm_do_kfree(dm, channel_to_sw); + } + RF_DBG(dm, DBG_RF_MP, "<===[kfree] phy_ConfigKFree()\n"); +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_kfree.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_kfree.h new file mode 100644 index 000000000000..aeeef1208d35 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_kfree.h @@ -0,0 +1,143 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +#ifndef __HALRF_KFREE_H__ +#define __HALRF_KFREE_H__ + +#define KFREE_VERSION "1.0" + +#define KFREE_BAND_NUM 8 +#define KFREE_CH_NUM 3 + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_AP)) + +#define BB_GAIN_NUM 6 + +#endif + +#define KFREE_FLAG_ON BIT(0) +#define KFREE_FLAG_THERMAL_K_ON BIT(1) + +#define KFREE_FLAG_ON_2G BIT(2) +#define KFREE_FLAG_ON_5G BIT(3) + +#define PA_BIAS_FLAG_ON BIT(4) + +#define PPG_THERMAL_OFFSET_98F 0x50 +#define PPG_2GM_TXAB_98F 0x51 +#define PPG_2GM_TXCD_98F 0x52 +#define PPG_2GL_TXAB_98F 0x53 +#define PPG_2GL_TXCD_98F 0x54 +#define PPG_2GH_TXAB_98F 0x55 +#define PPG_2GH_TXCD_98F 0x56 + +#define PPG_THERMAL_OFFSET_21C 0x1EF +#define PPG_2G_TXAB_21C 0x1EE +#define PPG_5GL1_TXA_21C 0x1EC +#define PPG_5GL2_TXA_21C 0x1E8 +#define PPG_5GM1_TXA_21C 0x1E4 +#define PPG_5GM2_TXA_21C 0x1E0 +#define PPG_5GH1_TXA_21C 0x1DC + +#define PPG_THERMAL_OFFSET_22B 0x3EF +#define PPG_2G_TXAB_22B 0x3EE +#define PPG_2G_TXCD_22B 0x3ED +#define PPG_5GL1_TXA_22B 0x3EC +#define PPG_5GL1_TXB_22B 0x3EB +#define PPG_5GL1_TXC_22B 0x3EA +#define PPG_5GL1_TXD_22B 0x3E9 +#define PPG_5GL2_TXA_22B 0x3E8 +#define PPG_5GL2_TXB_22B 0x3E7 +#define PPG_5GL2_TXC_22B 0x3E6 +#define PPG_5GL2_TXD_22B 0x3E5 +#define PPG_5GM1_TXA_22B 0x3E4 +#define PPG_5GM1_TXB_22B 0x3E3 +#define PPG_5GM1_TXC_22B 0x3E2 +#define PPG_5GM1_TXD_22B 0x3E1 +#define PPG_5GM2_TXA_22B 0x3E0 +#define PPG_5GM2_TXB_22B 0x3DF +#define PPG_5GM2_TXC_22B 0x3DE +#define PPG_5GM2_TXD_22B 0x3DD +#define PPG_5GH1_TXA_22B 0x3DC +#define PPG_5GH1_TXB_22B 0x3DB +#define PPG_5GH1_TXC_22B 0x3DA +#define PPG_5GH1_TXD_22B 0x3D9 + +#define PPG_PABIAS_2GA_22B 0x3D5 +#define PPG_PABIAS_2GB_22B 0x3D6 + +#define PPG_THERMAL_A_OFFSET_22C 0x1ef +#define PPG_THERMAL_B_OFFSET_22C 0x1b0 +#define PPG_2GL_TXAB_22C 0x1d4 +#define PPG_2GM_TXAB_22C 0x1ee +#define PPG_2GH_TXAB_22C 0x1d2 +#define PPG_5GL1_TXA_22C 0x1ec +#define PPG_5GL1_TXB_22C 0x1eb +#define PPG_5GL2_TXA_22C 0x1e8 +#define PPG_5GL2_TXB_22C 0x1e7 +#define PPG_5GM1_TXA_22C 0x1e4 +#define PPG_5GM1_TXB_22C 0x1e3 +#define PPG_5GM2_TXA_22C 0x1e0 +#define PPG_5GM2_TXB_22C 0x1df +#define PPG_5GH1_TXA_22C 0x1dc +#define PPG_5GH1_TXB_22C 0x1db + +#define PPG_PABIAS_2GA_22C 0x1d6 +#define PPG_PABIAS_2GB_22C 0x1d5 +#define PPG_PABIAS_5GA_22C 0x1d8 +#define PPG_PABIAS_5GB_22C 0x1d7 + +struct odm_power_trim_data { + u8 flag; + u8 pa_bias_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 *dm_void); + +void phydm_get_power_trim_offset(void *dm_void); + +void phydm_get_pa_bias_offset(void *dm_void); + +s8 phydm_get_thermal_offset(void *dm_void); + +void phydm_clear_kfree_to_rf(void *dm_void, u8 e_rf_path, u8 data); + +void phydm_config_new_kfree(void *dm_void); + +void phydm_config_kfree(void *dm_void, u8 channel_to_sw); + +#endif /*__HALRF_KFREE_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_powertracking.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_powertracking.c new file mode 100644 index 000000000000..cadbeb8de7ef --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_powertracking.c @@ -0,0 +1,174 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +/*@************************************************************ + * include files + * ************************************************************ + */ +#include "mp_precomp.h" +#include "phydm_precomp.h" + +boolean +odm_check_power_status(void *dm_void) +{ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct dm_struct *dm = (struct dm_struct *)dm_void; + PADAPTER *adapter = dm->adapter; + + RT_RF_POWER_STATE rt_state; + MGNT_INFO *mgnt_info = &((PADAPTER)adapter)->MgntInfo; + + /* 2011/07/27 MH We are not testing ready~~!! We may fail to get correct value when init sequence. */ + if (mgnt_info->init_adpt_in_progress == true) { + RF_DBG(dm, DBG_RF_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. + */ + ((PADAPTER)adapter)->HalFunc.GetHwRegHandler((PADAPTER)adapter, HW_VAR_RF_STATE, (u8 *)(&rt_state)); + if (((PADAPTER)adapter)->bDriverStopped || ((PADAPTER)adapter)->bDriverIsGoingToPnpSetPowerSleep || rt_state == eRfOff) { + RF_DBG(dm, DBG_RF_INIT, + "check_pow_status Return false, due to %d/%d/%d\n", + ((PADAPTER)adapter)->bDriverStopped, + ((PADAPTER)adapter)->bDriverIsGoingToPnpSetPowerSleep, + rt_state); + return false; + } +#endif + return true; +} + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) +void halrf_update_pwr_track(void *dm_void, u8 rate) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + u8 path_idx = 0; +#endif + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "Pwr Track Get rate=0x%x\n", rate); + + 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(&dm->ra_rpt_workitem); +#else + if (dm->support_ic_type == ODM_RTL8821) { +#if (RTL8821A_SUPPORT == 1) + odm_tx_pwr_track_set_pwr8821a(dm, MIX_MODE, RF_PATH_A, 0); +#endif + } else if (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(dm, MIX_MODE, path_idx, 0); +#endif + } + } else if (dm->support_ic_type == ODM_RTL8723B) { +#if (RTL8723B_SUPPORT == 1) + odm_tx_pwr_track_set_pwr_8723b(dm, MIX_MODE, RF_PATH_A, 0); +#endif + } else if (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(dm, MIX_MODE, path_idx, 0); +#endif + } + } else if (dm->support_ic_type == ODM_RTL8188E) { +#if (RTL8188E_SUPPORT == 1) + odm_tx_pwr_track_set_pwr88_e(dm, MIX_MODE, RF_PATH_A, 0); +#endif + } +#endif +#else + odm_schedule_work_item(&dm->ra_rpt_workitem); +#endif +#endif +} + +#endif + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +void halrf_update_init_rate_work_item_callback( + void *context) +{ + void *adapter = (void *)context; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + struct dm_struct *dm = &hal_data->DM_OutSrc; + u8 p = 0; + + if (dm->support_ic_type == ODM_RTL8821) { +#if (RTL8821A_SUPPORT == 1) + odm_tx_pwr_track_set_pwr8821a(dm, MIX_MODE, RF_PATH_A, 0); +#endif + } else if (dm->support_ic_type == ODM_RTL8812) { +#if (RTL8812A_SUPPORT == 1) + /*Don't know how to include &c*/ + for (p = RF_PATH_A; p < MAX_PATH_NUM_8812A; p++) + odm_tx_pwr_track_set_pwr8812a(dm, MIX_MODE, p, 0); +#endif + } else if (dm->support_ic_type == ODM_RTL8723B) { +#if (RTL8723B_SUPPORT == 1) + odm_tx_pwr_track_set_pwr_8723b(dm, MIX_MODE, RF_PATH_A, 0); +#endif + } else if (dm->support_ic_type == ODM_RTL8192E) { +#if (RTL8192E_SUPPORT == 1) + /*Don't know how to include &c*/ + for (p = RF_PATH_A; p < MAX_PATH_NUM_8192E; p++) + odm_tx_pwr_track_set_pwr92_e(dm, MIX_MODE, p, 0); +#endif + } else if (dm->support_ic_type == ODM_RTL8188E) { +#if (RTL8188E_SUPPORT == 1) + odm_tx_pwr_track_set_pwr88_e(dm, MIX_MODE, RF_PATH_A, 0); +#endif + } +} +#endif + +void halrf_set_pwr_track(void *dm_void, u8 enable) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &(dm->rf_table); + struct txpwrtrack_cfg c; + u8 i; + + configure_txpower_track(dm, &c); + if (enable) + rf->rf_supportability = rf->rf_supportability | HAL_RF_TX_PWR_TRACK; + else { + rf->rf_supportability = rf->rf_supportability & ~HAL_RF_TX_PWR_TRACK; + odm_clear_txpowertracking_state(dm); + for (i = 0; i < c.rf_path_count; i++) + (*c.odm_tx_pwr_track_set_pwr)(dm, CLEAN_MODE, i, 0); + } + + /*halrf_do_tssi(dm);*/ +} + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_powertracking.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_powertracking.h new file mode 100644 index 000000000000..99ee3cff4dfa --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_powertracking.h @@ -0,0 +1,44 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +#ifndef __HALRF_POWER_TRACKING_H__ +#define __HALRF_POWER_TRACKING_H__ + +boolean +odm_check_power_status(void *dm_void); + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) +void halrf_update_pwr_track(void *dm_void, u8 rate); +#endif + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +void halrf_update_init_rate_work_item_callback( + void *context); +#endif + +void halrf_set_pwr_track(void *dm_void, u8 enable); + +#endif /*#ifndef __HALRF_POWERTRACKING_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_powertracking_ap.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_powertracking_ap.c similarity index 84% rename from drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_powertracking_ap.c rename to drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_powertracking_ap.c index 42b17a9713c2..6838ddcdf7e6 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_powertracking_ap.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_powertracking_ap.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 @@ -343,6 +339,50 @@ u8 cck_swing_table_ch14_88f[CCK_TABLE_SIZE_88F][16] = { {0xD8, 0xD1, 0xBD, 0x7D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} /*-6dB*/ }; +/* Winnita ADD 20171113 PathA 0xAB4[10:0],PathB 0xAB4[21:11]*/ +u32 cck_swing_table_ch1_ch14_8192f[CCK_TABLE_SIZE_8192F] = { + 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, +}; #if 0 @@ -515,50 +555,6 @@ u8 cck_swing_table_ch14_92e[CCK_TABLE_SIZE_92E][8] = { /* Index53 -15.9dB */ {0x09, 0x08, 0x07, 0x06, 0x00, 0x00, 0x00, 0x00} }; #endif - -#ifdef AP_BUILD_WORKAROUND - -unsigned int tx_pwr_trk_ofdm_swing_tbl[tx_pwr_trk_ofdm_swing_tbl_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 @@ -741,7 +737,9 @@ u8 cck_swing_table_ch14_92e[CCK_TABLE_SIZE_92E][8] = { }; #endif -#if (RTL8814A_SUPPORT == 1 || RTL8822B_SUPPORT == 1) +#if (RTL8814A_SUPPORT == 1 || RTL8822B_SUPPORT == 1 ||\ + RTL8821C_SUPPORT == 1 || RTL8198F_SUPPORT == 1 ||\ + RTL8814B_SUPPORT == 1) u32 tx_scaling_table_jaguar[TXSCALE_TABLE_SIZE] = { 0x081, /* 0, -12.0dB */ 0x088, /* 1, -11.5dB */ @@ -872,6 +870,50 @@ u32 cck_swing_table_ch1_ch14_8723d[CCK_TABLE_SIZE_8723D] = { 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 */ @@ -881,35 +923,44 @@ u32 cck_swing_table_ch1_ch14_8723d[CCK_TABLE_SIZE_8723D] = { void odm_txpowertracking_init( - void *p_dm_void + void *dm_void ) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - if (!(p_dm_odm->support_ic_type & (ODM_RTL8814A | ODM_RTL8822B | ODM_IC_11N_SERIES))) + if (!(dm->support_ic_type & (ODM_RTL8814A | ODM_RTL8822B | ODM_IC_11N_SERIES))) return; #endif - odm_txpowertracking_thermal_meter_init(p_dm_odm); + odm_txpowertracking_thermal_meter_init(dm); } u8 get_swing_index( - void *p_dm_void + void *dm_void ) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)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_odm->priv; + u32 *swing_table = 0; + struct rtl8192cd_priv *priv = 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 = ofdm_swing_table_new; + swing_table_size = OFDM_TABLE_SIZE_92D; + bb_swing_mask = 22; + } +#endif + +#if (RTL8192F_SUPPORT == 1) + if (GET_CHIP_VER(priv) == VERSION_8192F) { + bb_swing = phy_query_bb_reg(priv, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKOFDM_D); + swing_table = ofdm_swing_table_new; swing_table_size = OFDM_TABLE_SIZE_92D; bb_swing_mask = 22; } @@ -918,20 +969,20 @@ get_swing_index( #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 = 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; + u32 table_value = swing_table[i] >> bb_swing_mask; if (bb_swing == table_value) break; } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("bb_swing=0x%x bbswing_index=%d\n", bb_swing, i)); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "bb_swing=0x%x bbswing_index=%d\n", bb_swing, i); return i; @@ -940,59 +991,56 @@ get_swing_index( void odm_txpowertracking_thermal_meter_init( - void *p_dm_void + void *dm_void ) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm_odm->rf_calibrate_info); - struct rtl8192cd_priv *priv = p_dm_odm->priv; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); + struct rtl8192cd_priv *priv = 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_odm); +#if (RTL8197F_SUPPORT == 1 || RTL8822B_SUPPORT == 1 || RTL8192F_SUPPORT == 1) + if ((GET_CHIP_VER(priv) == VERSION_8197F) || (GET_CHIP_VER(priv) == VERSION_8822B) ||(GET_CHIP_VER(priv) == VERSION_8192F)) + default_swing_index = get_swing_index(dm); #endif #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _ADAPTER *adapter = p_dm_odm->adapter; - PMGNT_INFO p_mgnt_info = &adapter->MgntInfo; - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + void *adapter = dm->adapter; + PMGNT_INFO mgnt_info = &adapter->MgntInfo; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); - p_mgnt_info->is_txpowertracking = true; - p_hal_data->tx_powercount = 0; - p_hal_data->is_txpowertracking_init = false; + mgnt_info->is_txpowertracking = true; + hal_data->tx_powercount = 0; + hal_data->is_txpowertracking_init = false; - if (p_dm_odm->mp_mode == false) - p_hal_data->txpowertrack_control = true; - ODM_RT_TRACE(p_dm_odm, COMP_POWER_TRACKING, DBG_LOUD, ("p_mgnt_info->is_txpowertracking = %d\n", p_mgnt_info->is_txpowertracking)); + if (*(dm->mp_mode) == false) + hal_data->txpowertrack_control = true; + RF_DBG(dm, COMP_POWER_TRACKING, "mgnt_info->is_txpowertracking = %d\n", mgnt_info->is_txpowertracking); #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) #ifdef CONFIG_RTL8188E { - p_dm_odm->rf_calibrate_info.is_txpowertracking = _TRUE; - p_dm_odm->rf_calibrate_info.tx_powercount = 0; - p_dm_odm->rf_calibrate_info.is_txpowertracking_init = _FALSE; + dm->rf_calibrate_info.is_txpowertracking = true; + dm->rf_calibrate_info.tx_powercount = 0; + dm->rf_calibrate_info.is_txpowertracking_init = false; - if (p_dm_odm->mp_mode == false) - p_dm_odm->rf_calibrate_info.txpowertrack_control = _TRUE; + if (*(dm->mp_mode) == false) + dm->rf_calibrate_info.txpowertrack_control = true; - MSG_8192C("p_dm_odm txpowertrack_control = %d\n", p_dm_odm->rf_calibrate_info.txpowertrack_control); + MSG_8192C("dm txpowertrack_control = %d\n", dm->rf_calibrate_info.txpowertrack_control); } #else { - struct _ADAPTER *adapter = p_dm_odm->adapter; - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); - struct dm_priv *pdmpriv = &p_hal_data->dmpriv; + void *adapter = dm->adapter; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + struct dm_priv *pdmpriv = &hal_data->dmpriv; + + pdmpriv->is_txpowertracking = true; + pdmpriv->tx_powercount = 0; + pdmpriv->is_txpowertracking_init = false; - /* if(IS_HARDWARE_TYPE_8192C(p_hal_data)) */ - { - pdmpriv->is_txpowertracking = _TRUE; - pdmpriv->tx_powercount = 0; - pdmpriv->is_txpowertracking_init = _FALSE; + if (*(dm->mp_mode) == false) /* for mp driver, turn off txpwrtracking as default */ + pdmpriv->txpowertrack_control = true; - if (p_dm_odm->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); } @@ -1001,73 +1049,79 @@ odm_txpowertracking_thermal_meter_init( #ifdef RTL8188E_SUPPORT { - p_dm_odm->rf_calibrate_info.is_txpowertracking = _TRUE; - p_dm_odm->rf_calibrate_info.tx_powercount = 0; - p_dm_odm->rf_calibrate_info.is_txpowertracking_init = _FALSE; - p_dm_odm->rf_calibrate_info.txpowertrack_control = _TRUE; - p_dm_odm->rf_calibrate_info.tm_trigger = 0; + dm->rf_calibrate_info.is_txpowertracking = true; + dm->rf_calibrate_info.tx_powercount = 0; + dm->rf_calibrate_info.is_txpowertracking_init = false; + dm->rf_calibrate_info.txpowertrack_control = true; + dm->rf_calibrate_info.tm_trigger = 0; } #endif #endif - p_dm_odm->rf_calibrate_info.txpowertrack_control = true; - p_dm_odm->rf_calibrate_info.delta_power_index = 0; - p_dm_odm->rf_calibrate_info.delta_power_index_last = 0; - p_dm_odm->rf_calibrate_info.power_index_offset = 0; - p_dm_odm->rf_calibrate_info.thermal_value = 0; - p_rf_calibrate_info->default_ofdm_index = 28; + dm->rf_calibrate_info.txpowertrack_control = true; + dm->rf_calibrate_info.delta_power_index = 0; + dm->rf_calibrate_info.delta_power_index_last = 0; + dm->rf_calibrate_info.power_index_offset = 0; + dm->rf_calibrate_info.thermal_value = 0; + cali_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; + cali_info->default_ofdm_index = (default_swing_index >= (OFDM_TABLE_SIZE_92D - 1)) ? 30 : default_swing_index; + cali_info->default_cck_index = 28; + } +#endif + +#if (RTL8192F_SUPPORT == 1) + if (GET_CHIP_VER(priv) == VERSION_8192F) { + cali_info->default_ofdm_index = 30; + cali_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; + cali_info->default_ofdm_index = (default_swing_index >= (TXSCALE_TABLE_SIZE - 1)) ? 24 : default_swing_index; + cali_info->default_cck_index = 20; } #endif #if RTL8188E_SUPPORT - p_rf_calibrate_info->default_cck_index = 20; /* -6 dB */ + cali_info->default_cck_index = 20; /* -6 dB */ #elif RTL8192E_SUPPORT - p_rf_calibrate_info->default_cck_index = 8; /* -12 dB */ + cali_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_odm->rf_calibrate_info.CCK_index = p_rf_calibrate_info->default_cck_index; + cali_info->bb_swing_idx_ofdm_base = cali_info->default_ofdm_index; + cali_info->bb_swing_idx_cck_base = cali_info->default_cck_index; + dm->rf_calibrate_info.CCK_index = cali_info->default_cck_index; for (p = 0; p < MAX_RF_PATH; p++) { - p_dm_odm->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*/ + dm->rf_calibrate_info.OFDM_index[p] = cali_info->default_ofdm_index; + cali_info->bb_swing_idx_ofdm[p] = cali_info->default_ofdm_index; + cali_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, 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)); + cali_info->bb_swing_idx_cck = cali_info->default_cck_index; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "cali_info->default_ofdm_index=%d cali_info->default_cck_index=%d\n", cali_info->default_ofdm_index, cali_info->default_cck_index); + cali_info->tm_trigger = 0; } void odm_txpowertracking_check( - void *p_dm_void + void *dm_void ) { /* */ /* For AP/ADSL use struct rtl8192cd_priv* */ - /* For CE/NIC use struct _ADAPTER* */ + /* For CE/NIC use struct void* */ /* */ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &(dm->rf_table); - - - if (!(p_dm_odm->support_ability & ODM_RF_TX_PWR_TRACK)) + if (!(rf->rf_supportability & HAL_RF_TX_PWR_TRACK)) return; /* */ @@ -1075,21 +1129,17 @@ odm_txpowertracking_check( /* at the same time. In the stage2/3, we need to prive universal interface and merge all */ /* HW dynamic mechanism. */ /* */ - switch (p_dm_odm->support_platform) { + switch (dm->support_platform) { case ODM_WIN: - odm_txpowertracking_check_mp(p_dm_odm); + odm_txpowertracking_check_mp(dm); break; case ODM_CE: - odm_txpowertracking_check_ce(p_dm_odm); + odm_txpowertracking_check_ce(dm); break; case ODM_AP: - odm_txpowertracking_check_ap(p_dm_odm); - break; - - case ODM_ADSL: - /*odm_DIGAP(p_dm_odm);*/ + odm_txpowertracking_check_ap(dm); break; } @@ -1097,31 +1147,33 @@ odm_txpowertracking_check( void odm_txpowertracking_check_ce( - void *p_dm_void + void *dm_void ) { #if (DM_ODM_SUPPORT_TYPE == ODM_CE) - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTER *adapter = p_dm_odm->adapter; + struct dm_struct *dm = (struct dm_struct *)dm_void; + void *adapter = dm->adapter; + struct _hal_rf_ *rf = &(dm->rf_table); #if (RTL8188E_SUPPORT == 1) - /* if(!p_mgnt_info->is_txpowertracking || (!pdmpriv->txpowertrack_control && pdmpriv->is_ap_kdone)) */ - if (!(p_dm_odm->support_ability & ODM_RF_TX_PWR_TRACK)) + /* if(!mgnt_info->is_txpowertracking || (!pdmpriv->txpowertrack_control && pdmpriv->is_ap_kdone)) */ + + if (!(rf->rf_supportability & HAL_RF_TX_PWR_TRACK)) return; - if (!p_dm_odm->rf_calibrate_info.tm_trigger) { /* at least delay 1 sec */ - /* p_hal_data->TxPowerCheckCnt++; */ /* cosa add for debug */ - odm_set_rf_reg(p_dm_odm, RF_PATH_A, RF_T_METER, RFREGOFFSETMASK, 0x60); + if (!dm->rf_calibrate_info.tm_trigger) { /* at least delay 1 sec */ + /* hal_data->TxPowerCheckCnt++; */ /* cosa add for debug */ + odm_set_rf_reg(dm, RF_PATH_A, RF_T_METER, RFREGOFFSETMASK, 0x60); /* DBG_8192C("Trigger 92C Thermal Meter!!\n"); */ - p_dm_odm->rf_calibrate_info.tm_trigger = 1; + 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_odm->rf_calibrate_info.tm_trigger = 0; + dm->rf_calibrate_info.tm_trigger = 0; } #endif @@ -1130,12 +1182,12 @@ odm_txpowertracking_check_ce( void odm_txpowertracking_check_mp( - void *p_dm_void + void *dm_void ) { #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTER *adapter = p_dm_odm->adapter; + struct dm_struct *dm = (struct dm_struct *)dm_void; + void *adapter = dm->adapter; if (odm_check_power_status(adapter) == false) return; @@ -1149,57 +1201,35 @@ odm_txpowertracking_check_mp( void odm_txpowertracking_check_ap( - void *p_dm_void + void *dm_void ) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) - struct rtl8192cd_priv *priv = p_dm_odm->priv; + struct dm_struct *dm = (struct dm_struct *)dm_void; -#if ((RTL8188E_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8812A_SUPPORT == 1) || (RTL8881A_SUPPORT == 1) || (RTL8814A_SUPPORT == 1) || (RTL8197F_SUPPORT == 1)) - if (p_dm_odm->support_ic_type & (ODM_RTL8188E | ODM_RTL8192E | ODM_RTL8812 | ODM_RTL8881A | ODM_RTL8814A | ODM_RTL8197F | ODM_RTL8822B)) - odm_txpowertracking_callback_thermal_meter(p_dm_odm); - else -#endif - { - } -#endif +#if ((RTL8188E_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8812A_SUPPORT == 1) || (RTL8881A_SUPPORT == 1) || (RTL8814A_SUPPORT == 1) || (RTL8197F_SUPPORT == 1) || (RTL8192F_SUPPORT == 1) || (RTL8198F_SUPPORT == 1) || (RTL8814B_SUPPORT == 1) || (RTL8812F_SUPPORT == 1)) + if (!dm->rf_calibrate_info.tm_trigger) { + if (dm->support_ic_type & (ODM_RTL8188E | ODM_RTL8192E | ODM_RTL8812 | ODM_RTL8881A | ODM_RTL8814A | ODM_RTL8197F | ODM_RTL8822B | ODM_RTL8821C | ODM_RTL8192F | ODM_RTL8198F)) { + odm_set_rf_reg(dm, RF_PATH_A, 0x42, (BIT(17) | BIT(16)), 0x3); + } else if (dm->support_ic_type & ODM_RTL8812F) { + odm_set_rf_reg(dm, RF_PATH_A, R_0x42, BIT(19), 0x01); + odm_set_rf_reg(dm, RF_PATH_A, R_0x42, BIT(19), 0x00); + odm_set_rf_reg(dm, RF_PATH_A, R_0x42, BIT(19), 0x01); + + odm_set_rf_reg(dm, RF_PATH_B, R_0x42, BIT(19), 0x01); + odm_set_rf_reg(dm, RF_PATH_B, R_0x42, BIT(19), 0x00); + odm_set_rf_reg(dm, RF_PATH_B, R_0x42, BIT(19), 0x01); + } else if (dm->support_ic_type & ODM_RTL8814B) { + odm_set_rf_reg(dm, RF_PATH_A, 0x42, BIT(17), 0x1); + odm_set_rf_reg(dm, RF_PATH_B, 0x42, BIT(17), 0x1); + odm_set_rf_reg(dm, RF_PATH_C, 0x42, BIT(17), 0x1); + odm_set_rf_reg(dm, RF_PATH_D, 0x42, BIT(17), 0x1); + } -} - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - -void -odm_txpowertracking_thermal_meter_check( - struct _ADAPTER *adapter -) -{ -#ifndef AP_BUILD_WORKAROUND -#if (HAL_CODE_BASE == RTL8192_C) - PMGNT_INFO p_mgnt_info = &adapter->MgntInfo; - /* HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); */ - static u8 tm_trigger = 0; - /* u8 TxPowerCheckCnt = 5; */ /* 10 sec */ - - if (!p_mgnt_info->is_txpowertracking /*|| (!p_hal_data->txpowertrack_control && p_hal_data->is_ap_kdone)*/) - return; - - if (!tm_trigger) { /* at least delay 1 sec */ - if (IS_HARDWARE_TYPE_8188E(adapter) || IS_HARDWARE_TYPE_8812(adapter)) - phy_set_rf_reg(adapter, RF_PATH_A, RF_T_METER_88E, BIT(17) | BIT(16), 0x03); - else - phy_set_rf_reg(adapter, RF_PATH_A, RF_T_METER, RFREGOFFSETMASK, 0x60); - RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, ("Trigger 92C Thermal Meter!!\n")); - - tm_trigger = 1; - return; + dm->rf_calibrate_info.tm_trigger = 1; } else { - RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, ("Schedule TxPowerTracking direct call!!\n")); - odm_txpowertracking_direct_call(adapter); /* Using direct call is instead, added by Roger, 2009.06.18. */ - tm_trigger = 0; + odm_txpowertracking_callback_thermal_meter(dm); + dm->rf_calibrate_info.tm_trigger = 0; } #endif -#endif -} -#endif +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_powertracking_ap.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_powertracking_ap.h similarity index 74% rename from drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_powertracking_ap.h rename to drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_powertracking_ap.h index 30f5bea284a8..b35999c13499 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_powertracking_ap.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_powertracking_ap.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,17 +12,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 __PHYDMPOWERTRACKING_H__ -#define __PHYDMPOWERTRACKING_H__ - -#define POWRTRACKING_VERSION "1.1" +#ifndef __HALRF_POWERTRACKING_H__ +#define __HALRF_POWERTRACKING_H__ #if (DM_ODM_SUPPORT_TYPE == ODM_AP) #ifdef RTK_AC_SUPPORT @@ -41,6 +35,8 @@ #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 @@ -48,9 +44,10 @@ #define IQK_BB_REG_NUM 9 -#define HP_THERMAL_NUM 8 - #define AVG_THERMAL_NUM 8 +#define AVG_THERMAL_NUM_DPK 8 +#define THERMAL_DPK_AVG_NUM 4 + #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 */ @@ -60,6 +57,7 @@ #define OFDM_TABLE_SIZE 37 #define CCK_TABLE_SIZE 33 #define CCK_TABLE_SIZE_88F 21 + #define CCK_TABLE_SIZE_8192F 41 @@ -76,11 +74,13 @@ 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_8192f[CCK_TABLE_SIZE_8192F]; #endif #define ODM_OFDM_TABLE_SIZE 37 #define ODM_CCK_TABLE_SIZE 33 +#define TXPWR_TRACK_TABLE_SIZE 30 /* <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]; @@ -103,22 +103,26 @@ static u8 delta_swing_table_idx_2ga_n_8188e[] = {0, 0, 0, 2, 2, 3, 3, 4, 4, 4, 4 #define OFDM_TABLE_SIZE_8812 43 #define AVG_THERMAL_NUM_8812 4 -#if (RTL8814A_SUPPORT == 1 || RTL8822B_SUPPORT == 1) +#if (RTL8814A_SUPPORT == 1 || RTL8822B_SUPPORT == 1 ||\ + RTL8821C_SUPPORT == 1 || RTL8198F_SUPPORT == 1 ||\ + RTL8814B_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 { - bool is_iqk_done; +struct iqk_matrix_regs_setting { + boolean is_iqk_done; s32 value[1][iqk_matrix_reg_num]; }; -struct odm_rf_calibration_structure { +struct dm_rf_calibration_struct { /* for tx power tracking */ u32 rega24; /* for TempCCK */ @@ -129,28 +133,32 @@ struct odm_rf_calibration_structure { /* u8 is_txpowertracking; */ u8 tx_powercount; - bool is_txpowertracking_init; - bool is_txpowertracking; + 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_path[MAX_RF_PATH]; 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_path[MAX_RF_PATH][AVG_THERMAL_NUM]; u8 thermal_value_avg_index; + u8 thermal_value_avg_index_path[MAX_RF_PATH]; + s8 power_index_offset_path[MAX_RF_PATH]; + u8 thermal_value_rx_gain; u8 thermal_value_crystal; u8 thermal_value_dpk_store; u8 thermal_value_dpk_track; - bool txpowertracking_in_progress; - bool is_dpk_enable; + boolean txpowertracking_in_progress; - bool is_reloadtxpowerindex; + + boolean is_reloadtxpowerindex; u8 is_rf_pi_enable; u32 txpowertracking_callback_cnt; /* cosa add for debug */ @@ -159,12 +167,12 @@ struct odm_rf_calibration_structure { u8 OFDM_index[MAX_RF_PATH]; s8 power_index_offset; s8 delta_power_index; + s8 delta_power_index_path[MAX_RF_PATH]; s8 delta_power_index_last; - bool is_tx_power_changed; + s8 delta_power_index_last_path[MAX_RF_PATH]; + 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]; + 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]; @@ -202,6 +210,8 @@ struct odm_rf_calibration_structure { 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]; @@ -211,25 +221,27 @@ struct odm_rf_calibration_structure { u8 bb_swing_idx_ofdm_base[MAX_RF_PATH]; #else u8 bb_swing_idx_ofdm_base; + u8 bb_swing_idx_ofdm_base_path[MAX_RF_PATH]; #endif - bool bb_swing_flag_ofdm; + 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; - bool bb_swing_flag_cck; + 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 */ - bool modify_tx_agc_flag_path_a; - bool modify_tx_agc_flag_path_b; - bool modify_tx_agc_flag_path_c; - bool modify_tx_agc_flag_path_d; - bool modify_tx_agc_flag_path_a_cck; + 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; + boolean modify_tx_agc_flag_path_b_cck; s8 kfree_offset[MAX_RF_PATH]; @@ -245,12 +257,12 @@ struct odm_rf_calibration_structure { u32 reg860; u32 reg864; - bool is_iqk_initialized; - bool is_lck_in_progress; - bool is_antenna_detected; - bool is_need_iqk; - bool is_iqk_in_progress; - bool is_iqk_pa_off; + 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]; @@ -264,19 +276,63 @@ struct odm_rf_calibration_structure { 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 */ - bool is_mp_mode; + 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; +#if 0 /*move below members to halrf_dpk.h*/ u8 is_dp_path_aok; u8 is_dp_path_bok; + u8 is_dp_path_cok; + u8 is_dp_path_dok; + u8 dp_path_a_result[3]; + u8 dp_path_b_result[3]; + u8 dp_path_c_result[3]; + u8 dp_path_d_result[3]; + boolean is_dpk_enable; + u32 txrate[11]; + u8 pwsf_2g_a[3]; + u8 pwsf_2g_b[3]; + u8 pwsf_2g_c[3]; + u8 pwsf_2g_d[3]; + u32 lut_2g_even_a[3][64]; + u32 lut_2g_odd_a[3][64]; + u32 lut_2g_even_b[3][64]; + u32 lut_2g_odd_b[3][64]; + u32 lut_2g_even_c[3][64]; + u32 lut_2g_odd_c[3][64]; + u32 lut_2g_even_d[3][64]; + u32 lut_2g_odd_d[3][64]; + u1Byte is_5g_pdk_a_ok; + u1Byte is_5g_pdk_b_ok; + u1Byte is_5g_pdk_c_ok; + u1Byte is_5g_pdk_d_ok; + u1Byte pwsf_5g_a[9]; + u1Byte pwsf_5g_b[9]; + u1Byte pwsf_5g_c[9]; + u1Byte pwsf_5g_d[9]; + u4Byte lut_5g_even_a[9][16]; + u4Byte lut_5g_odd_a[9][16]; + u4Byte lut_5g_even_b[9][16]; + u4Byte lut_5g_odd_b[9][16]; + u4Byte lut_5g_even_c[9][16]; + u4Byte lut_5g_odd_c[9][16]; + u4Byte lut_5g_even_d[9][16]; + u4Byte lut_5g_odd_d[9][16]; + u8 thermal_value_dpk; + u8 thermal_value_dpk_avg[AVG_THERMAL_NUM_DPK]; + u8 thermal_value_dpk_avg_index; +#endif + 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*/ @@ -286,34 +342,34 @@ struct odm_rf_calibration_structure { void odm_txpowertracking_check_ap( - void *p_dm_void + void *dm_void ); void odm_txpowertracking_check( - void *p_dm_void + void *dm_void ); void odm_txpowertracking_thermal_meter_init( - void *p_dm_void + void *dm_void ); void odm_txpowertracking_init( - void *p_dm_void + void *dm_void ); void odm_txpowertracking_check_mp( - void *p_dm_void + void *dm_void ); void odm_txpowertracking_check_ce( - void *p_dm_void + void *dm_void ); @@ -321,31 +377,31 @@ odm_txpowertracking_check_ce( void odm_txpowertracking_callback_thermal_meter92c( - struct _ADAPTER *adapter + void *adapter ); void odm_txpowertracking_callback_rx_gain_thermal_meter92d( - struct _ADAPTER *adapter + void *adapter ); void odm_txpowertracking_callback_thermal_meter92d( - struct _ADAPTER *adapter + void *adapter ); void odm_txpowertracking_direct_call92c( - struct _ADAPTER *adapter + void *adapter ); void odm_txpowertracking_thermal_meter_check( - struct _ADAPTER *adapter + void *adapter ); #endif -#endif +#endif /*#ifndef __HALRF_POWER_TRACKING_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_powertracking_ce.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_powertracking_ce.c new file mode 100644 index 000000000000..cf8563888bc5 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_powertracking_ce.c @@ -0,0 +1,924 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +/*@=========================================================== + * 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.0 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.0 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, +}; + +/*@Winnita ADD 20171116 PathA 0xAB4[10:0],PathB 0xAB4[21:11]*/ +u32 cck_swing_table_ch1_ch14_8192f[CCK_TABLE_SIZE_8192F] = { + 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 */ +}; + +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) +#else +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}; +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 + +void odm_txpowertracking_init(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + odm_txpowertracking_thermal_meter_init(dm); +} + +u8 get_swing_index(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; +#if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) + void *adapter = dm->adapter; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); +#endif + u8 i = 0; + u32 bb_swing, table_value; + + if (dm->support_ic_type & + (ODM_RTL8188E | ODM_RTL8723B | ODM_RTL8192E | + ODM_RTL8188F | ODM_RTL8703B | ODM_RTL8723D | + ODM_RTL8710B | ODM_RTL8821)) { +#if (RTL8821A_SUPPORT == 1) + bb_swing = + phy_get_tx_bb_swing_8812a(adapter, + hal_data->current_band_type, + RF_PATH_A); +#else + bb_swing = odm_get_bb_reg(dm, R_0xc80, 0xFFC00000); +#endif + for (i = 0; i < OFDM_TABLE_SIZE; i++) { + table_value = ofdm_swing_table_new[i]; + + if (table_value >= 0x100000) + table_value >>= 22; + if (bb_swing == table_value) + break; + } + } else { +#if (RTL8812A_SUPPORT == 1) + bb_swing = + phy_get_tx_bb_swing_8812a(adapter, + hal_data->current_band_type, + RF_PATH_A); +#else + bb_swing = odm_get_bb_reg(dm, R_0xc1c, 0xFFE00000); +#endif + for (i = 0; i < TXSCALE_TABLE_SIZE; i++) { + table_value = tx_scaling_table_jaguar[i]; + + if (bb_swing == table_value) + break; + } + } + + return i; +} + +u8 get_cck_swing_index(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + u8 i = 0; + u32 bb_cck_swing; + + if (dm->support_ic_type & + (ODM_RTL8188E | ODM_RTL8723B | ODM_RTL8192E)) { + bb_cck_swing = odm_read_1byte(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 (dm->support_ic_type & ODM_RTL8703B) { + bb_cck_swing = odm_read_1byte(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 *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct dm_rf_calibration_struct *cali_info = &dm->rf_calibrate_info; + struct _hal_rf_ *rf = &dm->rf_table; +#if (RTL8822C_SUPPORT == 1) + struct _halrf_tssi_data *tssi = &rf->halrf_tssi_data; +#endif + + u8 swing_idx = get_swing_index(dm); + u8 cckswing_idx = get_cck_swing_index(dm); + u8 p = 0; + + cali_info->is_txpowertracking = true; + cali_info->tx_powercount = 0; + cali_info->is_txpowertracking_init = false; + + if (!(*dm->mp_mode)) + cali_info->txpowertrack_control = true; + else + cali_info->txpowertrack_control = false; + + if (!(*dm->mp_mode)) + cali_info->txpowertrack_control = true; + + RF_DBG(dm, DBG_RF_IQK, "dm txpowertrack_control = %d\n", + cali_info->txpowertrack_control); +#if 0 + /* dm->rf_calibrate_info.txpowertrack_control = true; */ +#endif + cali_info->thermal_value = rf->eeprom_thermal; + cali_info->thermal_value_iqk = rf->eeprom_thermal; + cali_info->thermal_value_lck = rf->eeprom_thermal; + +#if (RTL8822C_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8822C) { + cali_info->thermal_value_path[RF_PATH_A] = tssi->thermal[RF_PATH_A]; + cali_info->thermal_value_path[RF_PATH_B] = tssi->thermal[RF_PATH_B]; + cali_info->thermal_value_iqk = tssi->thermal[RF_PATH_A]; + cali_info->thermal_value_lck = tssi->thermal[RF_PATH_A]; + } +#endif + + if (!cali_info->default_bb_swing_index_flag) { + if (dm->support_ic_type & + (ODM_RTL8188E | ODM_RTL8723B | ODM_RTL8192E | + ODM_RTL8703B | ODM_RTL8821)) { + if (swing_idx >= OFDM_TABLE_SIZE) + cali_info->default_ofdm_index = 30; + else + cali_info->default_ofdm_index = swing_idx; + + if (cckswing_idx >= CCK_TABLE_SIZE) + cali_info->default_cck_index = 20; + else + cali_info->default_cck_index = cckswing_idx; + /*@add by Mingzhi.Guo 2015-03-23*/ + } else if (dm->support_ic_type == ODM_RTL8188F) { + cali_info->default_ofdm_index = 28; /*OFDM: -1dB*/ + cali_info->default_cck_index = 20; /*CCK:-6dB*/ + /*@add by zhaohe 2015-10-27*/ + } else if (dm->support_ic_type == ODM_RTL8723D) { + cali_info->default_ofdm_index = 28; /*OFDM: -1dB*/ + cali_info->default_cck_index = 28; /*CCK: -6dB*/ + /*@JJ ADD 20161014 */ + } else if (dm->support_ic_type == ODM_RTL8710B) { + cali_info->default_ofdm_index = 28; /*OFDM: -1dB*/ + cali_info->default_cck_index = 28; /*CCK: -6dB*/ + } else if (dm->support_ic_type == ODM_RTL8192F) { + cali_info->default_ofdm_index = 30;/*OFDM: 0dB*/ + cali_info->default_cck_index = 28; /*CCK: -6dB*/ + } else { + if (swing_idx >= TXSCALE_TABLE_SIZE) + cali_info->default_ofdm_index = 24; + else + cali_info->default_ofdm_index = swing_idx; + + cali_info->default_cck_index = 24; + } + cali_info->default_bb_swing_index_flag = true; + } + + cali_info->bb_swing_idx_cck_base = cali_info->default_cck_index; + cali_info->CCK_index = cali_info->default_cck_index; + + for (p = RF_PATH_A; p < MAX_RF_PATH; ++p) { + cali_info->bb_swing_idx_ofdm_base[p] = + cali_info->default_ofdm_index; + cali_info->OFDM_index[p] = cali_info->default_ofdm_index; + cali_info->delta_power_index[p] = 0; + cali_info->delta_power_index_last[p] = 0; + cali_info->power_index_offset[p] = 0; + } + cali_info->modify_tx_agc_value_ofdm = 0; + cali_info->modify_tx_agc_value_cck = 0; + cali_info->tm_trigger = 0; +} + +void odm_txpowertracking_check(void *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 dm_struct *dm = (struct dm_struct *)dm_void; + + switch (dm->support_platform) { + case ODM_WIN: + odm_txpowertracking_check_mp(dm); + break; + + case ODM_CE: + odm_txpowertracking_check_ce(dm); + break; + + case ODM_AP: + odm_txpowertracking_check_ap(dm); + break; + + default: + break; + } +} + +void odm_txpowertracking_check_ce(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &dm->rf_table; +#if (RTL8822C_SUPPORT == 1) + struct _halrf_tssi_data *tssi = &rf->halrf_tssi_data; +#endif + +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) + if (!(rf->rf_supportability & HAL_RF_TX_PWR_TRACK)) + return; + + if (dm->support_ic_type & ODM_RTL8814B) + return; + + if ((rf->power_track_type & 0xf0) >> 4 != 0) { + if (dm->support_ic_type & ODM_RTL8822C) { + /*halrf_tssi_cck(dm);*/ + /*halrf_thermal_cck(dm);*/ + return; + } + } + + if (!dm->rf_calibrate_info.tm_trigger) { + if (dm->support_ic_type & + (ODM_RTL8188E | ODM_RTL8188F | ODM_RTL8192E | + ODM_RTL8723B | ODM_RTL8812 | ODM_RTL8821 | + ODM_RTL8814A | ODM_RTL8703B | ODM_RTL8723D | + ODM_RTL8822B | ODM_RTL8821C | ODM_RTL8710B | + ODM_RTL8192F)) + odm_set_rf_reg(dm, RF_PATH_A, RF_T_METER_NEW, + (BIT(17) | BIT(16)), 0x03); + else if (dm->support_ic_type & ODM_RTL8822C) { + odm_set_rf_reg(dm, RF_PATH_A, R_0x42, BIT(19), 0x01); + odm_set_rf_reg(dm, RF_PATH_A, R_0x42, BIT(19), 0x00); + odm_set_rf_reg(dm, RF_PATH_A, R_0x42, BIT(19), 0x01); + + odm_set_rf_reg(dm, RF_PATH_B, R_0x42, BIT(19), 0x01); + odm_set_rf_reg(dm, RF_PATH_B, R_0x42, BIT(19), 0x00); + odm_set_rf_reg(dm, RF_PATH_B, R_0x42, BIT(19), 0x01); + } else + odm_set_rf_reg(dm, RF_PATH_A, RF_T_METER_OLD, + RFREGOFFSETMASK, 0x60); + + dm->rf_calibrate_info.tm_trigger = 1; + return; + } + + if (dm->support_ic_type & ODM_RTL8822C) { +#if (RTL8822C_SUPPORT == 1) + odm_txpowertracking_new_callback_thermal_meter(dm); +#endif + } else + odm_txpowertracking_callback_thermal_meter(dm); + dm->rf_calibrate_info.tm_trigger = 0; +#endif +} + +void +odm_txpowertracking_direct_ce(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &dm->rf_table; +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) + + if (!(rf->rf_supportability & HAL_RF_TX_PWR_TRACK)) + return; + + if (dm->support_ic_type & ODM_RTL8814B) + return; + + if (dm->support_ic_type & ODM_RTL8822C) { + /*halrf_tssi_cck(dm);*/ + /*halrf_thermal_cck(dm);*/ + return; + } + + if (dm->support_ic_type & + (ODM_RTL8188E | ODM_RTL8188F | ODM_RTL8192E | + ODM_RTL8723B | ODM_RTL8812 | ODM_RTL8821 | + ODM_RTL8814A | ODM_RTL8703B | ODM_RTL8723D | + ODM_RTL8822B | ODM_RTL8821C | ODM_RTL8710B | + ODM_RTL8192F)) + odm_set_rf_reg(dm, RF_PATH_A, RF_T_METER_NEW, (BIT(17) | BIT(16)), 0x03); + else if (dm->support_ic_type & ODM_RTL8822C) { + odm_set_rf_reg(dm, RF_PATH_A, R_0x42, BIT(19), 0x01); + odm_set_rf_reg(dm, RF_PATH_A, R_0x42, BIT(19), 0x00); + odm_set_rf_reg(dm, RF_PATH_A, R_0x42, BIT(19), 0x01); + + odm_set_rf_reg(dm, RF_PATH_B, R_0x42, BIT(19), 0x01); + odm_set_rf_reg(dm, RF_PATH_B, R_0x42, BIT(19), 0x00); + odm_set_rf_reg(dm, RF_PATH_B, R_0x42, BIT(19), 0x01); + } else + odm_set_rf_reg(dm, RF_PATH_A, RF_T_METER_OLD, RFREGOFFSETMASK, 0x60); + + odm_txpowertracking_callback_thermal_meter(dm); +#endif + +} + + +void odm_txpowertracking_check_mp(void *dm_void) +{ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct dm_struct *dm = (struct dm_struct *)dm_void; + void *adapter = 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 *dm_void) +{ +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct rtl8192cd_priv *priv = dm->priv; + + return; + +#endif +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_powertracking_ce.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_powertracking_ce.h new file mode 100644 index 000000000000..1e128700696b --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_powertracking_ce.h @@ -0,0 +1,331 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +#ifndef __HALRF_POWERTRACKING_H__ +#define __HALRF_POWERTRACKING_H__ + +#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 CCK_TABLE_SIZE_8192F 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 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 +/* Channels_2_4G_NUM + Channels_5G_20M_NUM + Channels_5G */ +#define IQK_MATRIX_SETTINGS_NUM (14 + 24 + 21) +#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 cck_swing_table_ch1_ch14_8192f[CCK_TABLE_SIZE_8192F]; + +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 +extern u8 delta_swing_table_idx_2ga_p_8188e[]; +extern u8 delta_swing_table_idx_2ga_n_8188e[]; +#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 dm_rf_calibration_struct { + /* 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; + /* for mp mode, turn off txpwrtracking as default */ + u8 txpowertrack_control; + u8 tm_trigger; + u8 internal_pa_5g[2]; /* pathA / pathB */ + + /* thermal_meter, index 0 for RFIC0, and 1 for RFIC1 */ + u8 thermal_meter[2]; + u8 thermal_value; + u8 thermal_value_path[MAX_RF_PATH]; + 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_path[MAX_RF_PATH][AVG_THERMAL_NUM]; + u8 thermal_value_avg_index; + u8 thermal_value_avg_index_path[MAX_RF_PATH]; + 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 xtal_offset_eanble; + + 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; + boolean modify_tx_agc_flag_path_b_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]; + /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}} */ + u32 tx_iqc_8723b[2][3][2]; + /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}} */ + u32 rx_iqc_8723b[2][2][2]; + /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}} */ + u32 tx_iqc_8703b[3][2]; + /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}} */ + u32 rx_iqc_8703b[2][2]; + /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}} */ + u32 tx_iqc_8723d[2][3][2]; + /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}} */ + u32 rx_iqc_8723d[2][2][2]; + /* JJ ADD 20161014 */ + /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}} */ + u32 tx_iqc_8710b[2][3][2]; + /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}} */ + u32 rx_iqc_8710b[2][2][2]; + + 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 *dm_void); + +void odm_txpowertracking_init(void *dm_void); + +void odm_txpowertracking_check_ap(void *dm_void); + +void odm_txpowertracking_thermal_meter_init(void *dm_void); + +void odm_txpowertracking_init(void *dm_void); + +void odm_txpowertracking_check_mp(void *dm_void); + +void odm_txpowertracking_check_ce(void *dm_void); + +void odm_txpowertracking_direct_ce(void *dm_void); + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) + +void odm_txpowertracking_callback_thermal_meter92c( + void *adapter); + +void odm_txpowertracking_callback_rx_gain_thermal_meter92d( + void *adapter); + +void odm_txpowertracking_callback_thermal_meter92d( + void *adapter); + +void odm_txpowertracking_direct_call92c( + void *adapter); + +void odm_txpowertracking_thermal_meter_check( + void *adapter); + +#endif + +#endif /*__HALRF_POWER_TRACKING_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_powertracking_ce.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_powertracking_iot.c similarity index 69% rename from drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_powertracking_ce.c rename to drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_powertracking_iot.c index 88b4fba68054..ddbd93e24208 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_powertracking_ce.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_powertracking_iot.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,15 +9,20 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ /*============================================================ */ /* include files */ @@ -26,7 +32,8 @@ /* ************************************************************ * Global var - * ************************************************************ */ + * ************************************************************ + */ u32 ofdm_swing_table[OFDM_TABLE_SIZE] = { 0x7f8001fe, /* 0, +6.0dB */ @@ -104,7 +111,6 @@ u8 cck_swing_table_ch1_ch13[CCK_TABLE_SIZE][8] = { {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 */ @@ -141,7 +147,6 @@ u8 cck_swing_table_ch14[CCK_TABLE_SIZE][8] = { {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*/ @@ -188,7 +193,6 @@ u32 ofdm_swing_table_new[OFDM_TABLE_SIZE] = { 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*/ @@ -213,7 +217,6 @@ u8 cck_swing_table_ch1_ch14_88f[CCK_TABLE_SIZE_88F][16] = { {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*/ @@ -238,7 +241,6 @@ u8 cck_swing_table_ch1_ch13_88f[CCK_TABLE_SIZE_88F][16] = { {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*/ @@ -263,7 +265,6 @@ u8 cck_swing_table_ch14_88f[CCK_TABLE_SIZE_88F][16] = { {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*/ @@ -300,7 +301,6 @@ u8 cck_swing_table_ch1_ch13_new[CCK_TABLE_SIZE][8] = { {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*/ @@ -336,6 +336,7 @@ u8 cck_swing_table_ch14_new[CCK_TABLE_SIZE][8] = { {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, @@ -380,6 +381,140 @@ u32 cck_swing_table_ch1_ch14_8723d[CCK_TABLE_SIZE_8723D] = { 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, +}; + +/* Winnita ADD 20171116 PathA 0xAB4[10:0],PathB 0xAB4[21:11]*/ +u32 cck_swing_table_ch1_ch14_8192f[CCK_TABLE_SIZE_8192F] = { + 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, +}; + +/* Winnita ADD 201805 PathA 0xAB4[10:0]*/ +u32 cck_swing_table_ch1_ch14_8721d[CCK_TABLE_SIZE_8721D] = { + 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*/ @@ -421,325 +556,187 @@ u32 tx_scaling_table_jaguar[TXSCALE_TABLE_SIZE] = { 0x3FE /* 36, +6.0dB */ }; -#ifdef AP_BUILD_WORKAROUND - -unsigned int tx_pwr_trk_ofdm_swing_tbl[tx_pwr_trk_ofdm_swing_tbl_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_txpowertracking_init( - void *p_dm_void + void *dm_void ) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - if (!(p_dm_odm->support_ic_type & (ODM_RTL8814A | ODM_IC_11N_SERIES | ODM_RTL8822B))) - return; -#endif + struct dm_struct *dm = (struct dm_struct *)dm_void; - odm_txpowertracking_thermal_meter_init(p_dm_odm); + odm_txpowertracking_thermal_meter_init(dm); } u8 get_swing_index( - void *p_dm_void + void *dm_void ) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTER *adapter = p_dm_odm->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; + struct dm_struct *dm = (struct dm_struct *)dm_void; - if (p_dm_odm->support_ic_type == ODM_RTL8188E || p_dm_odm->support_ic_type == ODM_RTL8723B - || p_dm_odm->support_ic_type == ODM_RTL8192E || p_dm_odm->support_ic_type == ODM_RTL8188F || p_dm_odm->support_ic_type == ODM_RTL8703B - ) { - bb_swing = odm_get_bb_reg(p_dm_odm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, 0xFFC00000); + u8 i = 0; + u32 bb_swing; + u32 swing_table_size; + u32 *swing_table; - p_swing_table = ofdm_swing_table_new; - swing_table_size = OFDM_TABLE_SIZE; - } else { -#if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) - if (p_dm_odm->support_ic_type == ODM_RTL8812 || p_dm_odm->support_ic_type == ODM_RTL8821) { - bb_swing = phy_get_tx_bb_swing_8812a(adapter, p_hal_data->current_band_type, ODM_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; - } + if (dm->support_ic_type == ODM_RTL8195B) { + bb_swing = odm_get_bb_reg(dm, R_0xc1c, 0xFFE00000); + 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]; + for (i = 0; i < swing_table_size; i++) { + u32 table_value = swing_table[i]; - if (table_value >= 0x100000) - table_value >>= 22; + table_value = table_value; if (bb_swing == table_value) break; } + + return i; +} + +u8 +get_cck_swing_index( + void *dm_void +) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + u8 i = 0; + u32 bb_cck_swing; + + if (dm->support_ic_type == ODM_RTL8188E || dm->support_ic_type == ODM_RTL8723B || + dm->support_ic_type == ODM_RTL8192E) { + bb_cck_swing = odm_read_1byte(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 (dm->support_ic_type == ODM_RTL8703B) { + bb_cck_swing = odm_read_1byte(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 + void *dm_void ) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 default_swing_index = get_swing_index(p_dm_odm); - u8 p = 0; - struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm_odm->rf_calibrate_info); -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _ADAPTER *adapter = p_dm_odm->adapter; - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 default_swing_index = get_swing_index(dm); + u8 p = 0; + struct dm_rf_calibration_struct *cali_info = &dm->rf_calibrate_info; + struct _hal_rf_ *rf = &dm->rf_table; - if (p_dm_odm->mp_mode == false) - p_hal_data->txpowertrack_control = true; -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - struct _ADAPTER *adapter = p_dm_odm->adapter; - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); - - 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_odm->mp_mode == false) - p_rf_calibrate_info->txpowertrack_control = _TRUE; + if (!(*dm->mp_mode)) + cali_info->txpowertrack_control = true; else - p_rf_calibrate_info->txpowertrack_control = _FALSE; + cali_info->txpowertrack_control = false; - if (p_dm_odm->mp_mode == false) - p_rf_calibrate_info->txpowertrack_control = _TRUE; + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "dm txpowertrack_control = %d\n", cali_info->txpowertrack_control); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("p_dm_odm txpowertrack_control = %d\n", p_rf_calibrate_info->txpowertrack_control)); + /* dm->rf_calibrate_info.txpowertrack_control = true; */ + cali_info->thermal_value = rf->eeprom_thermal; + cali_info->thermal_value_iqk = rf->eeprom_thermal; + cali_info->thermal_value_lck = rf->eeprom_thermal; -#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_odm->rf_calibrate_info.txpowertrack_control = true; */ - 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_odm->support_ic_type == ODM_RTL8188E || p_dm_odm->support_ic_type == ODM_RTL8723B || - p_dm_odm->support_ic_type == ODM_RTL8192E || p_dm_odm->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 = 20; - } else if (p_dm_odm->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_odm->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 { - 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; + if (!cali_info->default_bb_swing_index_flag) { + if (dm->support_ic_type == ODM_RTL8195B) { + cali_info->default_ofdm_index = (default_swing_index >= TXSCALE_TABLE_SIZE) ? 24 : default_swing_index; + cali_info->default_cck_index = 24; + } else if (dm->support_ic_type == ODM_RTL8721D) { + cali_info->default_ofdm_index = 28; /*OFDM: -1dB*/ + cali_info->default_cck_index = 28; /*CCK: -6dB*/ } - p_rf_calibrate_info->default_bb_swing_index_flag = true; + cali_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; + cali_info->bb_swing_idx_cck_base = cali_info->default_cck_index; + cali_info->CCK_index = cali_info->default_cck_index; - for (p = ODM_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; + for (p = RF_PATH_A; p < MAX_RF_PATH; ++p) { + cali_info->bb_swing_idx_ofdm_base[p] = cali_info->default_ofdm_index; + cali_info->OFDM_index[p] = cali_info->default_ofdm_index; + cali_info->delta_power_index[p] = 0; + cali_info->delta_power_index_last[p] = 0; + cali_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; - + cali_info->modify_tx_agc_value_ofdm = 0; + cali_info->modify_tx_agc_value_cck = 0; + cali_info->tm_trigger = 0; } - void odm_txpowertracking_check( - void *p_dm_void + void *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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - switch (p_dm_odm->support_platform) { - case ODM_WIN: - odm_txpowertracking_check_mp(p_dm_odm); - break; - - case ODM_CE: - odm_txpowertracking_check_ce(p_dm_odm); - break; - - case ODM_AP: - odm_txpowertracking_check_ap(p_dm_odm); - break; - - default: - break; - } + struct dm_struct *dm = (struct dm_struct *)dm_void; + odm_txpowertracking_check_iot(dm); } void -odm_txpowertracking_check_ce( - void *p_dm_void +odm_txpowertracking_check_iot( + void *dm_void ) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - struct _ADAPTER *adapter = p_dm_odm->adapter; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &dm->rf_table; - if (!(p_dm_odm->support_ability & ODM_RF_TX_PWR_TRACK)) + if (!(rf->rf_supportability & HAL_RF_TX_PWR_TRACK)) return; - if (!p_dm_odm->rf_calibrate_info.tm_trigger) { + if (!dm->rf_calibrate_info.tm_trigger) { + if (dm->support_ic_type == ODM_RTL8195B) + odm_set_rf_reg(dm, RF_PATH_A, RF_T_METER_NEW, (BIT(17) | BIT(16)), 0x03); + else if (dm->support_ic_type == ODM_RTL8721D) + odm_set_rf_reg(dm, RF_PATH_A, RF_T_METER_NEW, + (BIT(12) | BIT(11)), 0x03); - 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_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_T_METER_NEW, (BIT(17) | BIT(16)), 0x03); - else - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_T_METER_OLD, RFREGOFFSETMASK, 0x60); - - - - p_dm_odm->rf_calibrate_info.tm_trigger = 1; + dm->rf_calibrate_info.tm_trigger = 1; return; - } else { - - odm_txpowertracking_callback_thermal_meter(adapter); - p_dm_odm->rf_calibrate_info.tm_trigger = 0; } - -#endif + odm_txpowertracking_callback_thermal_meter(dm); + dm->rf_calibrate_info.tm_trigger = 0; } void odm_txpowertracking_check_mp( - void *p_dm_void + void *dm_void ) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _ADAPTER *adapter = p_dm_odm->adapter; + struct dm_struct *dm = (struct dm_struct *)dm_void; + void *adapter = dm->adapter; if (odm_check_power_status(adapter) == false) { - RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, ("===>odm_check_power_status() return false\n")); + 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 + void *dm_void ) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; #if (DM_ODM_SUPPORT_TYPE == ODM_AP) - struct rtl8192cd_priv *priv = p_dm_odm->priv; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct rtl8192cd_priv *priv = dm->priv; return; #endif } - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -void -odm_txpowertracking_thermal_meter_check( - struct _ADAPTER *adapter -) -{ -#ifndef AP_BUILD_WORKAROUND - static u8 tm_trigger = 0; - - if (!(GET_HAL_DATA(adapter)->DM_OutSrc.support_ability & ODM_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_8723D(adapter)) - phy_set_rf_reg(adapter, ODM_RF_PATH_A, RF_T_METER_88E, BIT(17) | BIT(16), 0x03); - else - phy_set_rf_reg(adapter, ODM_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 -} -#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_powertracking_ce.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_powertracking_iot.h similarity index 76% rename from drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_powertracking_ce.h rename to drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_powertracking_iot.h index 72a30d419194..563f92f6c59f 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_powertracking_ce.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_powertracking_iot.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,20 +9,23 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ -#ifndef __PHYDMPOWERTRACKING_H__ -#define __PHYDMPOWERTRACKING_H__ - -#define POWRTRACKING_VERSION "1.1" +#ifndef __HALRF_POWERTRACKING_H__ +#define __HALRF_POWERTRACKING_H__ #define DPK_DELTA_MAPPING_NUM 13 #define index_mapping_HP_NUM 15 @@ -30,6 +34,11 @@ #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 CCK_TABLE_SIZE_8192F 41 +#define CCK_TABLE_SIZE_8721D 41 + #define TXPWR_TRACK_TABLE_SIZE 30 #define DELTA_SWINGIDX_SIZE 30 @@ -37,7 +46,6 @@ #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 @@ -47,7 +55,10 @@ #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]; @@ -60,22 +71,34 @@ 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 cck_swing_table_ch1_ch14_8192f[CCK_TABLE_SIZE_8192F]; +extern u32 cck_swing_table_ch1_ch14_8721d[CCK_TABLE_SIZE_8721D]; 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 + +void +odm_txpowertracking_init( + void *dm_void +); #define dm_check_txpowertracking odm_txpowertracking_check -struct _IQK_MATRIX_REGS_SETTING { - bool is_iqk_done; +struct iqk_matrix_regs_setting { + boolean is_iqk_done; s32 value[3][iqk_matrix_reg_num]; - bool is_bw_iqk_result_saved[3]; + boolean is_bw_iqk_result_saved[3]; }; -struct odm_rf_calibration_structure { +struct dm_rf_calibration_struct { /* for tx power tracking */ u32 rega24; /* for TempCCK */ @@ -85,8 +108,8 @@ struct odm_rf_calibration_structure { s32 regebc; u8 tx_powercount; - bool is_txpowertracking_init; - bool is_txpowertracking; + 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 */ @@ -103,9 +126,9 @@ struct odm_rf_calibration_structure { u8 thermal_value_crystal; u8 thermal_value_dpk_store; u8 thermal_value_dpk_track; - bool txpowertracking_in_progress; + boolean txpowertracking_in_progress; - bool is_reloadtxpowerindex; + boolean is_reloadtxpowerindex; u8 is_rf_pi_enable; u32 txpowertracking_callback_cnt; /* cosa add for debug */ @@ -117,13 +140,11 @@ struct odm_rf_calibration_structure { s8 power_index_offset[MAX_RF_PATH]; s8 delta_power_index[MAX_RF_PATH]; s8 delta_power_index_last[MAX_RF_PATH]; - bool is_tx_power_changed; + 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]; + 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]; @@ -169,30 +190,31 @@ struct odm_rf_calibration_structure { u8 bb_swing_idx_ofdm[MAX_RF_PATH]; u8 bb_swing_idx_ofdm_current; -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE | ODM_IOT)) u8 bb_swing_idx_ofdm_base[MAX_RF_PATH]; #else u8 bb_swing_idx_ofdm_base; #endif - bool default_bb_swing_index_flag; - bool bb_swing_flag_ofdm; + 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; - bool bb_swing_flag_cck; + 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 */ - bool modify_tx_agc_flag_path_a; - bool modify_tx_agc_flag_path_b; - bool modify_tx_agc_flag_path_c; - bool modify_tx_agc_flag_path_d; - bool modify_tx_agc_flag_path_a_cck; + 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; + boolean modify_tx_agc_flag_path_b_cck; s8 kfree_offset[MAX_RF_PATH]; @@ -208,12 +230,12 @@ struct odm_rf_calibration_structure { u32 reg860; u32 reg864; - bool is_iqk_initialized; - bool is_lck_in_progress; - bool is_antenna_detected; - bool is_need_iqk; - bool is_iqk_in_progress; - bool is_iqk_pa_off; + 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]; @@ -225,18 +247,22 @@ struct odm_rf_calibration_structure { 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 */ - bool is_mp_mode; + boolean is_mp_mode; /* IQK time measurement */ - u64 iqk_start_time; - u64 iqk_progressing_time; - u64 iqk_total_progressing_time; + u32 iqk_start_time; + u32 iqk_progressing_time; + u32 iqk_total_progressing_time; + u32 lck_progressing_time; u32 lok_result; @@ -246,7 +272,7 @@ struct odm_rf_calibration_structure { u8 is_apk_thermal_meter_ignore; /* DPK */ - bool is_dpk_fail; + boolean is_dpk_fail; u8 is_dp_done; u8 is_dp_path_aok; u8 is_dp_path_bok; @@ -267,68 +293,58 @@ struct odm_rf_calibration_structure { void odm_txpowertracking_check( - void *p_dm_void -); - - -void -odm_txpowertracking_init( - void *p_dm_void + void *dm_void ); void odm_txpowertracking_check_ap( - void *p_dm_void + void *dm_void ); void odm_txpowertracking_thermal_meter_init( - void *p_dm_void + void *dm_void ); -void -odm_txpowertracking_init( - void *p_dm_void -); void odm_txpowertracking_check_mp( - void *p_dm_void + void *dm_void ); void -odm_txpowertracking_check_ce( - void *p_dm_void +odm_txpowertracking_check_iot( + void *dm_void ); #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) void odm_txpowertracking_callback_thermal_meter92c( - struct _ADAPTER *adapter + void *adapter ); void odm_txpowertracking_callback_rx_gain_thermal_meter92d( - struct _ADAPTER *adapter + void *adapter ); void odm_txpowertracking_callback_thermal_meter92d( - struct _ADAPTER *adapter + void *adapter ); void odm_txpowertracking_direct_call92c( - struct _ADAPTER *adapter + void *adapter ); void odm_txpowertracking_thermal_meter_check( - struct _ADAPTER *adapter + void *adapter ); #endif -#endif +#endif /*#ifndef __HALRF_POWER_TRACKING_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_powertracking_win.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_powertracking_win.c similarity index 70% rename from drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_powertracking_win.c rename to drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_powertracking_win.c index 31841ae4ce2e..516132bffd33 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_powertracking_win.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_powertracking_win.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,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 files - * ************************************************************ */ +/*============================================================ */ +/* include files */ +/*============================================================ */ #include "mp_precomp.h" #include "phydm_precomp.h" @@ -264,8 +260,6 @@ u8 cck_swing_table_ch14_88f[CCK_TABLE_SIZE_88F][16] = { }; - - 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 */ @@ -381,7 +375,95 @@ u32 cck_swing_table_ch1_ch14_8723d[CCK_TABLE_SIZE_8723D] = { 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, +}; +/* Winnita ADD 20170828 PathA 0xAB4[10:0],PathB 0xAB4[21:11]*/ +u32 cck_swing_table_ch1_ch14_8192f[CCK_TABLE_SIZE_8192F] = { + 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 */ @@ -423,141 +505,136 @@ u32 tx_scaling_table_jaguar[TXSCALE_TABLE_SIZE] = { 0x3FE /* 36, +6.0dB */ }; - -#ifdef AP_BUILD_WORKAROUND - -unsigned int tx_pwr_trk_ofdm_swing_tbl[tx_pwr_trk_ofdm_swing_tbl_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_txpowertracking_init( - void *p_dm_void + void *dm_void ) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - if (!(p_dm_odm->support_ic_type & (ODM_RTL8814A | ODM_IC_11N_SERIES | ODM_RTL8822B))) + if (!(dm->support_ic_type & (ODM_RTL8814A | ODM_IC_11N_SERIES | ODM_RTL8822B))) return; #endif - odm_txpowertracking_thermal_meter_init(p_dm_odm); + odm_txpowertracking_thermal_meter_init(dm); } u8 get_swing_index( - void *p_dm_void + void *dm_void ) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTER *adapter = p_dm_odm->adapter; - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + struct dm_struct *dm = (struct dm_struct *)dm_void; + void *adapter = dm->adapter; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); u8 i = 0; - u32 bb_swing; - u32 swing_table_size; - u32 *p_swing_table; + u32 bb_swing, table_value; - if (p_dm_odm->support_ic_type == ODM_RTL8188E || p_dm_odm->support_ic_type == ODM_RTL8723B || - p_dm_odm->support_ic_type == ODM_RTL8192E || p_dm_odm->support_ic_type == ODM_RTL8188F || p_dm_odm->support_ic_type == ODM_RTL8703B) { - bb_swing = odm_get_bb_reg(p_dm_odm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, 0xFFC00000); + if (dm->support_ic_type == ODM_RTL8188E || dm->support_ic_type == ODM_RTL8723B || + dm->support_ic_type == ODM_RTL8192E || dm->support_ic_type == ODM_RTL8188F || + dm->support_ic_type == ODM_RTL8703B || dm->support_ic_type == ODM_RTL8723D || + dm->support_ic_type == ODM_RTL8192F || dm->support_ic_type == ODM_RTL8710B || + dm->support_ic_type == ODM_RTL8821) { + bb_swing = odm_get_bb_reg(dm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, 0xFFC00000); - p_swing_table = ofdm_swing_table_new; - swing_table_size = OFDM_TABLE_SIZE; + for (i = 0; i < OFDM_TABLE_SIZE; i++) { + table_value = ofdm_swing_table_new[i]; + + if (table_value >= 0x100000) + table_value >>= 22; + if (bb_swing == table_value) + break; + } } else { - bb_swing = PHY_GetTxBBSwing_8812A(adapter, p_hal_data->CurrentBandType, ODM_RF_PATH_A); - p_swing_table = tx_scaling_table_jaguar; - swing_table_size = TXSCALE_TABLE_SIZE; + bb_swing = PHY_GetTxBBSwing_8812A(adapter, hal_data->CurrentBandType, RF_PATH_A); + + for (i = 0; i < TXSCALE_TABLE_SIZE; i++) { + table_value = tx_scaling_table_jaguar[i]; + + if (bb_swing == table_value) + break; + } } - 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; } -void -odm_txpowertracking_thermal_meter_init( - void *p_dm_void +u8 +get_cck_swing_index( + void *dm_void ) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 default_swing_index = get_swing_index(p_dm_odm); - struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm_odm->rf_calibrate_info); + struct dm_struct *dm = (struct dm_struct *)dm_void; + + u8 i = 0; + u32 bb_cck_swing; + + if (dm->support_ic_type == ODM_RTL8188E || dm->support_ic_type == ODM_RTL8723B || + dm->support_ic_type == ODM_RTL8192E) { + bb_cck_swing = odm_read_1byte(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 (dm->support_ic_type == ODM_RTL8703B) { + bb_cck_swing = odm_read_1byte(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 *dm_void +) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 default_swing_index = get_swing_index(dm); + u8 default_cck_swing_index = get_cck_swing_index(dm); + struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); + struct _hal_rf_ *rf = &dm->rf_table; +#if (RTL8822C_SUPPORT == 1) + struct _halrf_tssi_data *tssi = &rf->halrf_tssi_data; +#endif #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _ADAPTER *adapter = p_dm_odm->adapter; - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + void *adapter = dm->adapter; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); u8 p = 0; - if (p_dm_odm->mp_mode == false) - p_rf_calibrate_info->txpowertrack_control = true; + if (*(dm->mp_mode) == false) + cali_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; + cali_info->is_txpowertracking = true; + cali_info->tx_powercount = 0; + cali_info->is_txpowertracking_init = false; - if (p_dm_odm->mp_mode == false) - p_rf_calibrate_info->txpowertrack_control = _TRUE; + if (*(dm->mp_mode) == false) + cali_info->txpowertrack_control = true; - MSG_8192C("p_dm_odm txpowertrack_control = %d\n", p_rf_calibrate_info->txpowertrack_control); + MSG_8192C("dm txpowertrack_control = %d\n", cali_info->txpowertrack_control); } #else { - struct _ADAPTER *adapter = p_dm_odm->adapter; - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); - struct dm_priv *pdmpriv = &p_hal_data->dmpriv; + void *adapter = dm->adapter; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + struct dm_priv *pdmpriv = &hal_data->dmpriv; - pdmpriv->is_txpowertracking = _TRUE; + pdmpriv->is_txpowertracking = true; pdmpriv->tx_powercount = 0; - pdmpriv->is_txpowertracking_init = _FALSE; + pdmpriv->is_txpowertracking_init = false; - if (p_dm_odm->mp_mode == false) - pdmpriv->txpowertrack_control = _TRUE; + if (*(dm->mp_mode) == false) + pdmpriv->txpowertrack_control = true; MSG_8192C("pdmpriv->txpowertrack_control = %d\n", pdmpriv->txpowertrack_control); @@ -566,67 +643,85 @@ odm_txpowertracking_thermal_meter_init( #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; + cali_info->is_txpowertracking = true; + cali_info->tx_powercount = 0; + cali_info->is_txpowertracking_init = false; + cali_info->txpowertrack_control = true; } #endif #endif #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) #if (MP_DRIVER == 1) - p_rf_calibrate_info->txpowertrack_control = false; + cali_info->txpowertrack_control = false; #else - p_rf_calibrate_info->txpowertrack_control = true; + cali_info->txpowertrack_control = true; #endif #else - p_rf_calibrate_info->txpowertrack_control = true; + cali_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; + cali_info->thermal_value = hal_data->eeprom_thermal_meter; + cali_info->thermal_value_iqk = hal_data->eeprom_thermal_meter; + cali_info->thermal_value_lck = hal_data->eeprom_thermal_meter; - if (p_rf_calibrate_info->default_bb_swing_index_flag != true) { +#if (RTL8822C_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8822C) { + cali_info->thermal_value_path[RF_PATH_A] = tssi->thermal[RF_PATH_A]; + cali_info->thermal_value_path[RF_PATH_B] = tssi->thermal[RF_PATH_B]; + cali_info->thermal_value_iqk = tssi->thermal[RF_PATH_A]; + cali_info->thermal_value_lck = tssi->thermal[RF_PATH_A]; + } +#endif + + if (cali_info->default_bb_swing_index_flag != true) { /*The index of "0 dB" in SwingTable.*/ - if (p_dm_odm->support_ic_type == ODM_RTL8188E || p_dm_odm->support_ic_type == ODM_RTL8723B || - p_dm_odm->support_ic_type == ODM_RTL8192E || p_dm_odm->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 = 20; - } else if (p_dm_odm->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_odm->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*/ + if (dm->support_ic_type == ODM_RTL8188E || dm->support_ic_type == ODM_RTL8723B || + dm->support_ic_type == ODM_RTL8192E || dm->support_ic_type == ODM_RTL8703B || + dm->support_ic_type == ODM_RTL8821) { + cali_info->default_ofdm_index = (default_swing_index >= OFDM_TABLE_SIZE) ? 30 : default_swing_index; + cali_info->default_cck_index = (default_cck_swing_index >= CCK_TABLE_SIZE) ? 20 : default_cck_swing_index; + } else if (dm->support_ic_type == ODM_RTL8188F) { /*add by Mingzhi.Guo 2015-03-23*/ + cali_info->default_ofdm_index = 28; /*OFDM: -1dB*/ + cali_info->default_cck_index = 20; /*CCK:-6dB*/ + } else if (dm->support_ic_type == ODM_RTL8723D) { /*add by zhaohe 2015-10-27*/ + cali_info->default_ofdm_index = 28; /*OFDM: -1dB*/ + cali_info->default_cck_index = 28; /*CCK: -6dB*/ + /* JJ ADD 20161014 */ + } else if (dm->support_ic_type == ODM_RTL8710B) { + cali_info->default_ofdm_index = 28; /*OFDM: -1dB*/ + cali_info->default_cck_index = 28; /*CCK: -6dB*/ + /*Winnita add 20170828*/ + } else if (dm->support_ic_type == ODM_RTL8192F) { + cali_info->default_ofdm_index = 30; /*OFDM: 0dB*/ + cali_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; + cali_info->default_ofdm_index = (default_swing_index >= TXSCALE_TABLE_SIZE) ? 24 : default_swing_index; + cali_info->default_cck_index = 24; } - p_rf_calibrate_info->default_bb_swing_index_flag = true; + cali_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; + cali_info->bb_swing_idx_cck_base = cali_info->default_cck_index; + cali_info->CCK_index = cali_info->default_cck_index; - for (p = ODM_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; + for (p = RF_PATH_A; p < MAX_RF_PATH; ++p) { + cali_info->bb_swing_idx_ofdm_base[p] = cali_info->default_ofdm_index; + cali_info->OFDM_index[p] = cali_info->default_ofdm_index; + cali_info->delta_power_index[p] = 0; + cali_info->delta_power_index_last[p] = 0; + cali_info->power_index_offset[p] = 0; + cali_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; - + cali_info->modify_tx_agc_value_ofdm = 0; + cali_info->modify_tx_agc_value_cck = 0; + cali_info->tm_trigger = 0; } void odm_txpowertracking_check( - void *p_dm_void + void *dm_void ) { @@ -636,18 +731,18 @@ odm_txpowertracking_check( /* HW dynamic mechanism. */ #endif - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - switch (p_dm_odm->support_platform) { + struct dm_struct *dm = (struct dm_struct *)dm_void; + switch (dm->support_platform) { case ODM_WIN: - odm_txpowertracking_check_mp(p_dm_odm); + odm_txpowertracking_check_mp(dm); break; case ODM_CE: - odm_txpowertracking_check_ce(p_dm_odm); + odm_txpowertracking_check_ce(dm); break; case ODM_AP: - odm_txpowertracking_check_ap(p_dm_odm); + odm_txpowertracking_check_ap(dm); break; default: @@ -658,32 +753,33 @@ odm_txpowertracking_check( void odm_txpowertracking_check_ce( - void *p_dm_void + void *dm_void ) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &(dm->rf_table); #if (DM_ODM_SUPPORT_TYPE == ODM_CE) - struct _ADAPTER *adapter = p_dm_odm->adapter; + void *adapter = dm->adapter; #if ((RTL8188F_SUPPORT == 1)) rtl8192c_odm_check_txpowertracking(adapter); #endif #if (RTL8188E_SUPPORT == 1) - if (!(p_dm_odm->support_ability & ODM_RF_TX_PWR_TRACK)) + if (!(rf->rf_supportability & HAL_RF_TX_PWR_TRACK)) return; - if (!p_rf_calibrate_info->tm_trigger) { - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_T_METER, RFREGOFFSETMASK, 0x60); + if (!cali_info->tm_trigger) { + odm_set_rf_reg(dm, RF_PATH_A, RF_T_METER, RFREGOFFSETMASK, 0x60); /*DBG_8192C("Trigger 92C Thermal Meter!!\n");*/ - p_rf_calibrate_info->tm_trigger = 1; + cali_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; + cali_info->tm_trigger = 0; } #endif #endif @@ -691,18 +787,18 @@ odm_txpowertracking_check_ce( void odm_txpowertracking_check_mp( - void *p_dm_void + void *dm_void ) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _ADAPTER *adapter = p_dm_odm->adapter; + void *adapter = dm->adapter; - if (*p_dm_odm->p_is_fcs_mode_enable) + if (*dm->is_fcs_mode_enable) return; - if (odm_check_power_status(adapter) == false) { - RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, ("===>odm_check_power_status() return false\n")); + if (odm_check_power_status(dm) == false) { + RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, ("check_pow_status return false\n")); return; } @@ -719,7 +815,7 @@ odm_txpowertracking_check_mp( void odm_txpowertracking_check_ap( - void *p_dm_void + void *dm_void ) { return; @@ -730,36 +826,61 @@ odm_txpowertracking_check_ap( void odm_txpowertracking_direct_call( - struct _ADAPTER *adapter + void *adapter ) { - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + struct dm_struct *dm = &hal_data->DM_OutSrc; - odm_txpowertracking_callback_thermal_meter(adapter); + if (dm->support_ic_type & ODM_RTL8822C) { +#if (RTL8822C_SUPPORT == 1) + odm_txpowertracking_new_callback_thermal_meter(dm); +#endif + } else + odm_txpowertracking_callback_thermal_meter(adapter); } void odm_txpowertracking_thermal_meter_check( - struct _ADAPTER *adapter + void *adapter ) { -#ifndef AP_BUILD_WORKAROUND static u8 tm_trigger = 0; + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(((PADAPTER)adapter)); + struct dm_struct *dm = &(pHalData->DM_OutSrc); + struct _hal_rf_ *rf = &(dm->rf_table); - if (!(GET_HAL_DATA(adapter)->DM_OutSrc.support_ability & ODM_RF_TX_PWR_TRACK)) { + if (!(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")); + ("===>odm_txpowertracking_thermal_meter_check(),mgnt_info->is_txpowertracking is false, return!!\n")); return; } + if (rf->power_track_type != 0) { + if (IS_HARDWARE_TYPE_8822C(adapter)) { + /*halrf_tssi_cck(dm);*/ + /*halrf_thermal_cck(dm);*/ + 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, BIT(17) | BIT(16), 0x03); + if (IS_HARDWARE_TYPE_8188E(adapter) || IS_HARDWARE_TYPE_JAGUAR(adapter) || IS_HARDWARE_TYPE_8192E(adapter) || IS_HARDWARE_TYPE_8192F(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) + || IS_HARDWARE_TYPE_8814B(adapter))/* JJ ADD 20161014 */ + PHY_SetRFReg(adapter, RF_PATH_A, RF_T_METER_88E, BIT(17) | BIT(16), 0x03); + else if (IS_HARDWARE_TYPE_8822C(adapter)) { + odm_set_rf_reg(dm, RF_PATH_A, R_0x42, BIT(19), 0x01); + odm_set_rf_reg(dm, RF_PATH_A, R_0x42, BIT(19), 0x00); + odm_set_rf_reg(dm, RF_PATH_A, R_0x42, BIT(19), 0x01); + + odm_set_rf_reg(dm, RF_PATH_B, R_0x42, BIT(19), 0x01); + odm_set_rf_reg(dm, RF_PATH_B, R_0x42, BIT(19), 0x00); + odm_set_rf_reg(dm, RF_PATH_B, R_0x42, BIT(19), 0x01); + } else - PHY_SetRFReg(adapter, ODM_RF_PATH_A, RF_T_METER, RFREGOFFSETMASK, 0x60); + PHY_SetRFReg(adapter, RF_PATH_A, RF_T_METER, RFREGOFFSETMASK, 0x60); RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, ("Trigger Thermal Meter!!\n")); @@ -770,7 +891,6 @@ odm_txpowertracking_thermal_meter_check( odm_txpowertracking_direct_call(adapter); tm_trigger = 0; } -#endif } #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_powertracking_win.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_powertracking_win.h similarity index 80% rename from drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_powertracking_win.h rename to drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_powertracking_win.h index a1581352dbf4..73a4d5a59178 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_powertracking_win.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_powertracking_win.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,35 +12,32 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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" +#ifndef __HALRF_POWERTRACKING_H__ +#define __HALRF_POWERTRACKING_H__ #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 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 CCK_TABLE_SIZE_8192F 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 @@ -58,6 +56,9 @@ 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 cck_swing_table_ch1_ch14_8192f[CCK_TABLE_SIZE_8192F]; extern u32 tx_scaling_table_jaguar[TXSCALE_TABLE_SIZE]; @@ -67,33 +68,33 @@ static u8 delta_swing_table_idx_2ga_n_8188e[] = {0, 0, 0, 2, 2, 3, 3, 4, 4, 4, 4 void odm_txpowertracking_check( - void *p_dm_void + void *dm_void ); void odm_txpowertracking_check_ap( - void *p_dm_void + void *dm_void ); void odm_txpowertracking_thermal_meter_init( - void *p_dm_void + void *dm_void ); void odm_txpowertracking_init( - void *p_dm_void + void *dm_void ); void odm_txpowertracking_check_mp( - void *p_dm_void + void *dm_void ); void odm_txpowertracking_check_ce( - void *p_dm_void + void *dm_void ); #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) @@ -101,18 +102,18 @@ odm_txpowertracking_check_ce( void odm_txpowertracking_thermal_meter_check( - struct _ADAPTER *adapter + void *adapter ); #endif -struct _IQK_MATRIX_REGS_SETTING { - bool is_iqk_done; +struct iqk_matrix_regs_setting { + boolean is_iqk_done; s32 value[3][iqk_matrix_reg_num]; - bool is_bw_iqk_result_saved[3]; + boolean is_bw_iqk_result_saved[3]; }; -struct odm_rf_calibration_structure { +struct dm_rf_calibration_struct { /* for tx power tracking */ u32 rega24; /* for TempCCK */ @@ -122,22 +123,27 @@ struct odm_rf_calibration_structure { s32 regebc; /* u8 is_txpowertracking; */ u8 tx_powercount; - bool is_txpowertracking_init; - bool is_txpowertracking; + 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_path[MAX_RF_PATH]; u8 thermal_value_lck; u8 thermal_value_iqk; - s8 thermal_value_delta; /* delta of thermal_value and efuse thermal */ + 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_path[MAX_RF_PATH][AVG_THERMAL_NUM]; u8 thermal_value_avg_index; + u8 thermal_value_avg_index_path[MAX_RF_PATH]; u8 thermal_value_rx_gain; - bool is_reloadtxpowerindex; + + boolean is_reloadtxpowerindex; u8 is_rf_pi_enable; u32 txpowertracking_callback_cnt; /* cosa add for debug */ @@ -149,13 +155,11 @@ struct odm_rf_calibration_structure { s8 power_index_offset[MAX_RF_PATH]; s8 delta_power_index[MAX_RF_PATH]; s8 delta_power_index_last[MAX_RF_PATH]; - bool is_tx_power_changed; + 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]; + 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]; @@ -206,25 +210,26 @@ struct odm_rf_calibration_structure { #else u8 bb_swing_idx_ofdm_base; #endif - bool default_bb_swing_index_flag; - bool bb_swing_flag_ofdm; + 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; - bool bb_swing_flag_cck; + 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 */ - bool modify_tx_agc_flag_path_a; - bool modify_tx_agc_flag_path_b; - bool modify_tx_agc_flag_path_c; - bool modify_tx_agc_flag_path_d; - bool modify_tx_agc_flag_path_a_cck; + 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; + boolean modify_tx_agc_flag_path_b_cck; s8 kfree_offset[MAX_RF_PATH]; @@ -240,12 +245,12 @@ struct odm_rf_calibration_structure { u32 reg860; u32 reg864; - bool is_iqk_initialized; - bool is_lck_in_progress; - bool is_antenna_detected; - bool is_need_iqk; - bool is_iqk_in_progress; - bool is_iqk_pa_off; + 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]; @@ -257,15 +262,19 @@ struct odm_rf_calibration_structure { 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 */ - bool is_mp_mode; + boolean is_mp_mode; /* for APK */ u32 ap_koutput[2][2]; /* path A/B; output1_1a/output1_2a */ @@ -273,7 +282,7 @@ struct odm_rf_calibration_structure { u8 is_apk_thermal_meter_ignore; /* DPK */ - bool is_dpk_fail; + boolean is_dpk_fail; u8 is_dp_done; u8 is_dp_path_aok; u8 is_dp_path_bok; @@ -289,11 +298,9 @@ struct odm_rf_calibration_structure { /*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 +#endif /*#ifndef __HALRF_POWER_TRACKING_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_psd.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_psd.c new file mode 100644 index 000000000000..5258960b163b --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_psd.c @@ -0,0 +1,533 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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" + +u64 _sqrt(u64 x) +{ + u64 i = 0; + u64 j = (x >> 1) + 1; + + while (i <= j) { + u64 mid = (i + j) >> 1; + + u64 sq = mid * mid; + + if (sq == x) + return mid; + else if (sq < x) + i = mid + 1; + else + j = mid - 1; + } + + return j; +} + +u32 halrf_get_psd_data( + struct dm_struct *dm, + u32 point) +{ + struct _hal_rf_ *rf = &(dm->rf_table); + struct _halrf_psd_data *psd = &(rf->halrf_psd_data); + u32 psd_val = 0, psd_reg, psd_report, psd_point, psd_start, i, delay_time = 0; + +#if (DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE) + if (dm->support_interface == ODM_ITRF_USB || dm->support_interface == ODM_ITRF_SDIO) { + if (psd->average == 0) + delay_time = 100; + else + delay_time = 0; + } +#endif +#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) + if (dm->support_interface == ODM_ITRF_PCIE) { + if (psd->average == 0) + delay_time = 1000; + else + delay_time = 100; + } +#endif + + if (dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8814A | ODM_RTL8822B | ODM_RTL8821C)) { + psd_reg = R_0x910; + psd_report = R_0xf44; + } else { + psd_reg = R_0x808; + psd_report = R_0x8b4; + } + + if (dm->support_ic_type & ODM_RTL8710B) { + psd_point = 0xeffffc00; + psd_start = 0x10000000; + } else { + psd_point = 0xffbffc00; + psd_start = 0x00400000; + } + + psd_val = odm_get_bb_reg(dm, psd_reg, MASKDWORD); + + psd_val &= psd_point; + psd_val |= point; + + odm_set_bb_reg(dm, psd_reg, MASKDWORD, psd_val); + + psd_val |= psd_start; + + odm_set_bb_reg(dm, psd_reg, MASKDWORD, psd_val); + + for (i = 0; i < delay_time; i++) + ODM_delay_us(1); + + psd_val = odm_get_bb_reg(dm, psd_report, MASKDWORD); + + if (dm->support_ic_type & (ODM_RTL8821C | ODM_RTL8710B)) { + psd_val &= MASKL3BYTES; + psd_val = psd_val / 32; + } else { + psd_val &= MASKLWORD; + } + + return psd_val; +} + +void halrf_psd( + struct dm_struct *dm, + u32 point, + u32 start_point, + u32 stop_point, + u32 average) +{ + struct _hal_rf_ *rf = &(dm->rf_table); + struct _halrf_psd_data *psd = &(rf->halrf_psd_data); + + u32 i = 0, j = 0, k = 0; + u32 psd_reg, avg_org, point_temp, average_tmp, mode; + u64 data_tatal = 0, data_temp[64] = {0}; + + psd->buf_size = 256; + + mode = average >> 16; + + if (mode == 2) + average_tmp = 1; + else + average_tmp = average & 0xffff; + + if (dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8814A | ODM_RTL8822B | ODM_RTL8821C)) + psd_reg = R_0x910; + else + psd_reg = R_0x808; + +#if 0 + dbg_print("[PSD]point=%d, start_point=%d, stop_point=%d, average=%d, average_tmp=%d, buf_size=%d\n", + point, start_point, stop_point, average, average_tmp, psd->buf_size); +#endif + + for (i = 0; i < psd->buf_size; i++) + psd->psd_data[i] = 0; + + if (dm->support_ic_type & ODM_RTL8710B) + avg_org = odm_get_bb_reg(dm, psd_reg, 0x30000); + else + avg_org = odm_get_bb_reg(dm, psd_reg, 0x3000); + + if (mode == 1) { + if (dm->support_ic_type & ODM_RTL8710B) + odm_set_bb_reg(dm, psd_reg, 0x30000, 0x1); + else + odm_set_bb_reg(dm, psd_reg, 0x3000, 0x1); + } + +#if 0 + if (avg_temp == 0) + avg = 1; + else if (avg_temp == 1) + avg = 8; + else if (avg_temp == 2) + avg = 16; + else if (avg_temp == 3) + avg = 32; +#endif + + i = start_point; + while (i < stop_point) { + data_tatal = 0; + + if (i >= point) + point_temp = i - point; + else + point_temp = i; + + for (k = 0; k < average_tmp; k++) { + data_temp[k] = halrf_get_psd_data(dm, point_temp); + data_tatal = data_tatal + (data_temp[k] * data_temp[k]); + +#if 0 + if ((k % 20) == 0) + dbg_print("\n "); + + dbg_print("0x%x ", data_temp[k]); +#endif + } +#if 0 + /*dbg_print("\n");*/ +#endif + + data_tatal = phydm_division64((data_tatal * 100), average_tmp); + psd->psd_data[j] = (u32)_sqrt(data_tatal); + + i++; + j++; + } + +#if 0 + for (i = 0; i < psd->buf_size; i++) { + if ((i % 20) == 0) + dbg_print("\n "); + + dbg_print("0x%x ", psd->psd_data[i]); + } + dbg_print("\n\n"); +#endif + + if (dm->support_ic_type & ODM_RTL8710B) + odm_set_bb_reg(dm, psd_reg, 0x30000, avg_org); + else + odm_set_bb_reg(dm, psd_reg, 0x3000, avg_org); +} + +void backup_bb_register(struct dm_struct *dm, u32 *bb_backup, u32 *backup_bb_reg, u32 counter) +{ + u32 i ; + + for (i = 0; i < counter; i++) + bb_backup[i] = odm_get_bb_reg(dm, backup_bb_reg[i], MASKDWORD); +} + +void restore_bb_register(struct dm_struct *dm, u32 *bb_backup, u32 *backup_bb_reg, u32 counter) +{ + u32 i ; + + for (i = 0; i < counter; i++) + odm_set_bb_reg(dm, backup_bb_reg[i], MASKDWORD, bb_backup[i]); +} + + + +void _halrf_psd_iqk_init(struct dm_struct *dm) +{ + odm_set_bb_reg(dm, 0x1b04, MASKDWORD, 0x0); + odm_set_bb_reg(dm, 0x1b08, MASKDWORD, 0x80); + odm_set_bb_reg(dm, 0x1b0c, 0xc00, 0x3); + odm_set_bb_reg(dm, 0x1b14, MASKDWORD, 0x0); + odm_set_bb_reg(dm, 0x1b18, BIT(0), 0x1); + + if (dm->support_ic_type & ODM_RTL8197G) + odm_set_bb_reg(dm, 0x1b20, MASKDWORD, 0x00040008); + if (dm->support_ic_type & ODM_RTL8198F) { + odm_set_bb_reg(dm, 0x1b20, MASKDWORD, 0x00000000); + odm_set_bb_reg(dm, 0x1b1c, 0xfff, 0xd21); + odm_set_bb_reg(dm, 0x1b1c, 0xfff00000, 0x821); + } + + if (dm->support_ic_type & (ODM_RTL8197G | ODM_RTL8198F)) { + odm_set_bb_reg(dm, 0x1b24, MASKDWORD, 0x00030000); + odm_set_bb_reg(dm, 0x1b28, MASKDWORD, 0x00000000); + odm_set_bb_reg(dm, 0x1b2c, MASKDWORD, 0x00180018); + odm_set_bb_reg(dm, 0x1b30, MASKDWORD, 0x20000000); + /*odm_set_bb_reg(dm, 0x1b38, MASKDWORD, 0x20000000);*/ + /*odm_set_bb_reg(dm, 0x1b3C, MASKDWORD, 0x20000000);*/ + } + + odm_set_bb_reg(dm, 0x1b28, MASKDWORD, 0x0); + odm_set_bb_reg(dm, 0x1bcc, 0x3f, 0x3f); +} + + +u32 halrf_get_iqk_psd_data( + struct dm_struct *dm, + u32 point) +{ + struct _hal_rf_ *rf = &(dm->rf_table); + struct _halrf_psd_data *psd = &(rf->halrf_psd_data); + u32 psd_val, psd_val1, psd_val2, psd_point, i, delay_time = 0; + +#if (DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE) + if (dm->support_interface == ODM_ITRF_USB || dm->support_interface == ODM_ITRF_SDIO) { + if (dm->support_ic_type & ODM_RTL8822C) + delay_time = 1000; + else + delay_time = 0; + } +#endif +#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) + if (dm->support_interface == ODM_ITRF_PCIE) { + if (dm->support_ic_type & ODM_RTL8822C) + delay_time = 1000; + else + delay_time = 150; + } +#endif + psd_point = odm_get_bb_reg(dm, R_0x1b2c, MASKDWORD); + + psd_point &= 0xF000FFFF; + + point &= 0xFFF; + + psd_point = psd_point | (point << 16); + + odm_set_bb_reg(dm, R_0x1b2c, MASKDWORD, psd_point); + + odm_set_bb_reg(dm, R_0x1b34, MASKDWORD, 0x1); + + odm_set_bb_reg(dm, R_0x1b34, MASKDWORD, 0x0); + + for (i = 0; i < delay_time; i++) + ODM_delay_us(1); + + if (dm->support_ic_type & (ODM_RTL8197G | ODM_RTL8198F)) { + if (dm->support_ic_type & ODM_RTL8197G) + odm_set_bb_reg(dm, R_0x1bd4, MASKDWORD, 0x001a0001); + else + odm_set_bb_reg(dm, R_0x1bd4, MASKDWORD, 0x00250001); + + psd_val1 = odm_get_bb_reg(dm, R_0x1bfc, MASKDWORD); + + psd_val1 = (psd_val1 & 0x001f0000) >> 16; + + if (dm->support_ic_type & ODM_RTL8197G) + odm_set_bb_reg(dm, R_0x1bd4, MASKDWORD, 0x001b0001); + else + odm_set_bb_reg(dm, R_0x1bd4, MASKDWORD, 0x002e0001); + + psd_val2 = odm_get_bb_reg(dm, R_0x1bfc, MASKDWORD); + + psd_val = (psd_val1 << 27) + (psd_val2 >> 5); + } else { + odm_set_bb_reg(dm, R_0x1bd4, MASKDWORD, 0x00250001); + + psd_val1 = odm_get_bb_reg(dm, R_0x1bfc, MASKDWORD); + + psd_val1 = (psd_val1 & 0x07FF0000) >> 16; + + odm_set_bb_reg(dm, R_0x1bd4, MASKDWORD, 0x002e0001); + + psd_val2 = odm_get_bb_reg(dm, R_0x1bfc, MASKDWORD); + + psd_val = (psd_val1 << 21) + (psd_val2 >> 11); + } + + return psd_val; +} + +void halrf_iqk_psd( + struct dm_struct *dm, + u32 point, + u32 start_point, + u32 stop_point, + u32 average) +{ + struct _hal_rf_ *rf = &(dm->rf_table); + struct _halrf_psd_data *psd = &(rf->halrf_psd_data); + + u32 i = 0, j = 0, k = 0; + u32 psd_reg, avg_org, point_temp, average_tmp = 32, mode, reg_tmp = 5; + u64 data_tatal = 0, data_temp[64] = {0}; + s32 s_point_tmp; + + psd->buf_size = 256; + + mode = average >> 16; + + if (mode == 2) { + if (dm->support_ic_type & ODM_RTL8822C) + average_tmp = 1; + else { + reg_tmp = odm_get_bb_reg(dm, R_0x1b1c, 0x000e0000); + if (reg_tmp == 0) + average_tmp = 1; + else if (reg_tmp == 3) + average_tmp = 8; + else if (reg_tmp == 4) + average_tmp = 16; + else if (reg_tmp == 5) + average_tmp = 32; + odm_set_bb_reg(dm, R_0x1b1c, 0x000e0000, 0x0); + } + } else { + reg_tmp = odm_get_bb_reg(dm, R_0x1b1c, 0x000e0000); + if (reg_tmp == 0) + average_tmp = 1; + else if (reg_tmp == 3) + average_tmp = 8; + else if (reg_tmp == 4) + average_tmp = 16; + else if (reg_tmp == 5) + average_tmp = 32; + odm_set_bb_reg(dm, R_0x1b1c, 0x000e0000, 0x0); + } + +#if 0 + DbgPrint("[PSD]point=%d, start_point=%d, stop_point=%d, average=0x%x, average_tmp=%d, buf_size=%d, mode=%d\n", + point, start_point, stop_point, average, average_tmp, psd->buf_size, mode); +#endif + + for (i = 0; i < psd->buf_size; i++) + psd->psd_data[i] = 0; + + i = start_point; + while (i < stop_point) { + data_tatal = 0; + + if (i >= point) + point_temp = i - point; + else + { + if (dm->support_ic_type & ODM_RTL8814B) + { + s_point_tmp = i - point - 1; + point_temp = s_point_tmp & 0xfff; + } + else + point_temp = i; + } + + for (k = 0; k < average_tmp; k++) { + data_temp[k] = halrf_get_iqk_psd_data(dm, point_temp); + /*data_tatal = data_tatal + (data_temp[k] * data_temp[k]);*/ + data_tatal = data_tatal + data_temp[k]; + +#if 0 + if ((k % 20) == 0) + DbgPrint("\n "); + + DbgPrint("0x%x ", data_temp[k]); +#endif + } + + data_tatal = phydm_division64((data_tatal * 10), average_tmp); + psd->psd_data[j] = (u32)data_tatal; + + i++; + j++; + } + + if (dm->support_ic_type & (ODM_RTL8814B | ODM_RTL8198F | ODM_RTL8197G)) + odm_set_bb_reg(dm, R_0x1b1c, 0x000e0000, reg_tmp); + +#if 0 + DbgPrint("\n [iqk psd]psd result:\n"); + + for (i = 0; i < psd->buf_size; i++) { + if ((i % 20) == 0) + DbgPrint("\n "); + + DbgPrint("0x%x ", psd->psd_data[i]); + } + DbgPrint("\n\n"); +#endif +} + + +u32 +halrf_psd_init( + void *dm_void) +{ + enum rt_status ret_status = RT_STATUS_SUCCESS; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &(dm->rf_table); + struct _halrf_psd_data *psd = &(rf->halrf_psd_data); + +#if 0 + u32 bb_backup[12]; + u32 backup_bb_reg[12] = {0x1b04, 0x1b08, 0x1b0c, 0x1b14, 0x1b18, + 0x1b1c, 0x1b28, 0x1bcc, 0x1b2c, 0x1b34, + 0x1bd4, 0x1bfc}; +#endif + + if (psd->psd_progress) { + ret_status = RT_STATUS_PENDING; + } else { + psd->psd_progress = 1; + if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8814B | ODM_RTL8198F | ODM_RTL8197G)) { + /*backup_bb_register(dm, bb_backup, backup_bb_reg, 12);*/ + _halrf_psd_iqk_init(dm); + halrf_iqk_psd(dm, psd->point, psd->start_point, psd->stop_point, psd->average); + /*restore_bb_register(dm, bb_backup, backup_bb_reg, 12);*/ + } else + halrf_psd(dm, psd->point, psd->start_point, psd->stop_point, psd->average); + psd->psd_progress = 0; + } + return ret_status; +} + +u32 +halrf_psd_query( + void *dm_void, + u32 *outbuf, + u32 buf_size) +{ + enum rt_status ret_status = RT_STATUS_SUCCESS; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &(dm->rf_table); + struct _halrf_psd_data *psd = &(rf->halrf_psd_data); + + if (psd->psd_progress) + ret_status = RT_STATUS_PENDING; + else + odm_move_memory(dm, outbuf, psd->psd_data, + sizeof(u32) * psd->buf_size); + + return ret_status; +} + +u32 +halrf_psd_init_query( + void *dm_void, + u32 *outbuf, + u32 point, + u32 start_point, + u32 stop_point, + u32 average, + u32 buf_size) +{ + enum rt_status ret_status = RT_STATUS_SUCCESS; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _hal_rf_ *rf = &(dm->rf_table); + struct _halrf_psd_data *psd = &(rf->halrf_psd_data); + + psd->point = point; + psd->start_point = start_point; + psd->stop_point = stop_point; + psd->average = average; + + if (psd->psd_progress) { + ret_status = RT_STATUS_PENDING; + } else { + psd->psd_progress = 1; + halrf_psd(dm, psd->point, psd->start_point, psd->stop_point, psd->average); + odm_move_memory(dm, outbuf, psd->psd_data, 0x400); + psd->psd_progress = 0; + } + + return ret_status; +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_psd.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_psd.h new file mode 100644 index 000000000000..fe7b327cd0ad --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_psd.h @@ -0,0 +1,51 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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_PSD_H__ +#define __HALRF_PSD_H__ + + +struct _halrf_psd_data { + u32 point; + u32 start_point; + u32 stop_point; + u32 average; + u32 buf_size; + u32 psd_data[256]; + u32 psd_progress; +}; + +u32 +halrf_psd_init( + void *dm_void); + +u32 +halrf_psd_query( + void *dm_void, + u32 *outbuf, + u32 buf_size); + +u32 +halrf_psd_init_query( + void *dm_void, + u32 *outbuf, + u32 point, + u32 start_point, + u32 stop_point, + u32 average, + u32 buf_size); + +#endif /*#__HALRF_PSD_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_txgapcal.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_txgapcal.c new file mode 100644 index 000000000000..45aec82a4ebe --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_txgapcal.c @@ -0,0 +1,301 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ +#include "mp_precomp.h" +#include "phydm_precomp.h" + +void odm_bub_sort(u32 *data, u32 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 *dm_void, + u1Byte rf_path, + u4Byte rf56) +{ + PDM_ODM_T dm = (PDM_ODM_T)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(dm, rf_path, RF_0xdf, bRFRegOffsetMask, 0x00e02); + + ODM_delay_us(100); + + odm_set_bb_reg(dm, R_0xe28, 0xffffffff, 0x0); + + odm_set_rf_reg(dm, rf_path, RF_0x56, 0xfff, rf56); + while (rf56 != (odm_get_rf_reg(dm, rf_path, RF_0x56, 0xfff))) + odm_set_rf_reg(dm, rf_path, RF_0x56, 0xfff, rf56); + + odm_set_bb_reg(dm, R_0xd94, 0xffffffff, 0x44FFBB44); + odm_set_bb_reg(dm, R_0xe70, 0xffffffff, 0x00400040); + odm_set_bb_reg(dm, R_0xc04, 0xffffffff, 0x6f005403); + odm_set_bb_reg(dm, R_0xc08, 0xffffffff, 0x000804e4); + odm_set_bb_reg(dm, R_0x874, 0xffffffff, 0x04203400); + odm_set_bb_reg(dm, R_0xe28, 0xffffffff, 0x80800000); + + odm_set_bb_reg(dm, iqk_ctl_addr[rf_path][0], 0xffffffff, psd_cntl_value[rf_path][0]); + odm_set_bb_reg(dm, iqk_ctl_addr[rf_path][1], 0xffffffff, psd_cntl_value[rf_path][1]); + odm_set_bb_reg(dm, iqk_ctl_addr[rf_path][2], 0xffffffff, psd_cntl_value[rf_path][0]); + odm_set_bb_reg(dm, iqk_ctl_addr[rf_path][3], 0xffffffff, psd_cntl_value[rf_path][0]); + odm_set_bb_reg(dm, iqk_ctl_addr[rf_path][4], 0xffffffff, 0x8215001F); + odm_set_bb_reg(dm, iqk_ctl_addr[rf_path][5], 0xffffffff, 0x2805001F); + + odm_set_bb_reg(dm, R_0xe40, 0xffffffff, 0x81007C00); + odm_set_bb_reg(dm, R_0xe44, 0xffffffff, 0x81004800); + odm_set_bb_reg(dm, R_0xe4c, 0xffffffff, 0x0046a8d0); + + for (i = 0; i < psd_avg_time; i++) { + for (j = 0; j < 1000; j++) { + odm_set_bb_reg(dm, R_0xe48, 0xffffffff, 0xfa005800); + odm_set_bb_reg(dm, R_0xe48, 0xffffffff, 0xf8005800); + + while (!odm_get_bb_reg(dm, R_0xeac, psd_finish_bit[rf_path])) + ; /*wait finish bit*/ + + if (!odm_get_bb_reg(dm, R_0xeac, psd_fail_bit[rf_path])) { /*check fail bit*/ + + psd_vaule[i] = odm_get_bb_reg(dm, psd_report_addr[rf_path], 0xffffffff); + + if (psd_vaule[i] > 0xffff) + break; + } + } + + RF_DBG(dm, DBG_RF_IQK, + "[TGGC] rf0=0x%x rf56=0x%x rf56_reg=0x%x time=%d psd_vaule=0x%x\n", + odm_get_rf_reg(dm, rf_path, RF_0x0, 0xff), rf56, + odm_get_rf_reg(dm, rf_path, RF_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(dm, R_0xd94, 0xffffffff, 0x44BBBB44); + odm_set_bb_reg(dm, R_0xe70, 0xffffffff, 0x80408040); + odm_set_bb_reg(dm, R_0xc04, 0xffffffff, 0x6f005433); + odm_set_bb_reg(dm, R_0xc08, 0xffffffff, 0x000004e4); + odm_set_bb_reg(dm, R_0x874, 0xffffffff, 0x04003400); + odm_set_bb_reg(dm, R_0xe28, 0xffffffff, 0x00000000); + + RF_DBG(dm, DBG_RF_IQK, + "[TGGC] rf0=0x%x rf56=0x%x rf56_reg=0x%x psd_vaule_temp=0x%x\n", + odm_get_rf_reg(dm, rf_path, RF_0x0, 0xff), rf56, + odm_get_rf_reg(dm, rf_path, RF_0x56, 0xfff), psd_vaule_temp); + + odm_set_rf_reg(dm, rf_path, RF_0xdf, bRFRegOffsetMask, 0x00602); + + return psd_vaule_temp; +} + +void odm_tx_gain_gap_calibration_8197f( + void *dm_void) +{ + PDM_ODM_T dm = (PDM_ODM_T)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(dm, R_0x88c, (BIT(21) | BIT(20)), 0x3); /*disable 3-wire*/ + else if (rf_path == RF_PATH_B) + odm_set_bb_reg(dm, R_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(dm, rf_path, RF_0x0, 0xff, rf0_idx_current); + ODM_delay_us(100); + rf56_current_temp[rf_path][rf0_idx] = odm_get_rf_reg(dm, rf_path, RF_0x56, 0xfff); + rf56_current = rf56_current_temp[rf_path][rf0_idx]; + + rf0_idx_next = 3 * rf0_idx + 1; + odm_set_rf_reg(dm, rf_path, RF_0x0, 0xff, rf0_idx_next); + ODM_delay_us(100); + rf56_next = odm_get_rf_reg(dm, rf_path, RF_0x56, 0xfff); + + RF_DBG(dm, DBG_RF_IQK, + "[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; + + RF_DBG(dm, DBG_RF_IQK, + "[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]); + + continue; + } + + RF_DBG(dm, DBG_RF_IQK, + "[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(dm, rf_path, rf56_current); + + psd_value_next = odm_tx_gain_gap_psd_8197f(dm, 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]; + + RF_DBG(dm, DBG_RF_IQK, + "[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; + + if (delta_gain_gap_pre != delta_gain_gap[rf_path][rf0_idx]) { + delta_gain_gap[rf_path][rf0_idx] = 0; + + RF_DBG(dm, DBG_RF_IQK, "[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; + } + + RF_DBG(dm, DBG_RF_IQK, + "[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(dm, R_0x88c, (BIT(21) | BIT(20)), 0x0); /*enable 3-wire*/ + else if (rf_path == RF_PATH_B) + odm_set_bb_reg(dm, R_0x88c, (BIT(23) | BIT(22)), 0x0); /*enable 3-wire*/ + + ODM_delay_us(100); + } + +#if 0 + /*odm_set_bb_reg(dm, R_0x88c, (BIT(23) | BIT(22) | BIT(21) | BIT(20)), 0x0);*/ /*enable 3-wire*/ +#endif + + for (rf_path = RF_PATH_A; rf_path <= RF_PATH_B; rf_path++) { + odm_set_rf_reg(dm, rf_path, RF_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); + + RF_DBG(dm, DBG_RF_IQK, + "[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(dm, rf_path, RF_0x33, bRFRegOffsetMask, rf33[rf_path][rf0_idx]); + } + + odm_set_rf_reg(dm, rf_path, RF_0xef, bRFRegOffsetMask, 0x00000); + } +} +#endif + +void odm_tx_gain_gap_calibration(void *dm_void) +{ + PDM_ODM_T dm = (PDM_ODM_T)dm_void; +#if (RTL8197F_SUPPORT == 1) + if (dm->SupportICType & ODM_RTL8197F) + odm_tx_gain_gap_calibration_8197f(dm_void); +#endif +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_txgapcal.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_txgapcal.h new file mode 100644 index 000000000000..bafa6d3f813a --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/halrf_txgapcal.h @@ -0,0 +1,32 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +#ifndef __HALRF_TXGAPCAL_H__ +#define __HALRF_TXGAPCAL_H__ + +void odm_tx_gain_gap_calibration(void *dm_void); + +#endif /*__HALRF_TXGAPCAL_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/rtl8188e/halrf_8188e_ap.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/rtl8188e/halrf_8188e_ap.c new file mode 100644 index 000000000000..29d8f65270c9 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/rtl8188e/halrf_8188e_ap.c @@ -0,0 +1,1249 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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 Local Constant---------------------------*/ +/* 2010/04/25 MH Define the max tx power tracking tx agc power. */ +#define ODM_TXPWRTRACK_MAX_IDX_88E 6 + +/*---------------------------Define Local Constant---------------------------*/ + + +/* 3============================================================ + * 3 Tx Power Tracking + * 3============================================================ */ + + +void halrf_rf_lna_setting_8188e( + struct dm_struct *dm, + enum halrf_lna_set type +) +{ +/*phydm_disable_lna*/ + if (type == HALRF_LNA_DISABLE) { + odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, 0x80000, 0x1); + odm_set_rf_reg(dm, RF_PATH_A, RF_0x30, 0xfffff, 0x18000); /*select Rx mode*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0x31, 0xfffff, 0x0000f); + odm_set_rf_reg(dm, RF_PATH_A, RF_0x32, 0xfffff, 0x37f82); /*disable LNA*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, 0x80000, 0x0); + if (dm->rf_type > RF_1T1R) { + odm_set_rf_reg(dm, RF_PATH_B, RF_0xef, 0x80000, 0x1); + odm_set_rf_reg(dm, RF_PATH_B, RF_0x30, 0xfffff, 0x18000); + odm_set_rf_reg(dm, RF_PATH_B, RF_0x31, 0xfffff, 0x0000f); + odm_set_rf_reg(dm, RF_PATH_B, RF_0x32, 0xfffff, 0x37f82); + odm_set_rf_reg(dm, RF_PATH_B, RF_0xef, 0x80000, 0x0); + } + } else if (type == HALRF_LNA_ENABLE) { + /*phydm_enable_lna*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, 0x80000, 0x1); + odm_set_rf_reg(dm, RF_PATH_A, RF_0x30, 0xfffff, 0x18000); /*select Rx mode*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0x31, 0xfffff, 0x0000f); + odm_set_rf_reg(dm, RF_PATH_A, RF_0x32, 0xfffff, 0x77f82); /*back to normal*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, 0x80000, 0x0); + if (dm->rf_type > RF_1T1R) { + odm_set_rf_reg(dm, RF_PATH_B, RF_0xef, 0x80000, 0x1); + odm_set_rf_reg(dm, RF_PATH_B, RF_0x30, 0xfffff, 0x18000); + odm_set_rf_reg(dm, RF_PATH_B, RF_0x31, 0xfffff, 0x0000f); + odm_set_rf_reg(dm, RF_PATH_B, RF_0x32, 0xfffff, 0x77f82); + odm_set_rf_reg(dm, RF_PATH_B, RF_0xef, 0x80000, 0x0); + } + + } +} + +void set_iqk_matrix_8188e( + struct dm_struct *dm, + u8 OFDM_index, + u8 rf_path, + s32 iqk_result_x, + s32 iqk_result_y +) +{ + s32 ele_A = 0, ele_D, ele_C = 0, /*TempCCk,*/ value32; + + ele_D = (ofdm_swing_table_new[OFDM_index] & 0xFFC00000) >> 22; + + /* new element A = element D x X */ + if ((iqk_result_x != 0) && (*(dm->band_type) == ODM_BAND_2_4G)) { + if ((iqk_result_x & 0x00000200) != 0) /* consider minus */ + iqk_result_x = iqk_result_x | 0xFFFFFC00; + ele_A = ((iqk_result_x * ele_D) >> 8) & 0x000003FF; + + /* new element C = element D x Y */ + if ((iqk_result_y & 0x00000200) != 0) + iqk_result_y = iqk_result_y | 0xFFFFFC00; + ele_C = ((iqk_result_y * ele_D) >> 8) & 0x000003FF; + + if (rf_path == RF_PATH_A) + switch (rf_path) { + case RF_PATH_A: + /* 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; + odm_set_bb_reg(dm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKDWORD, value32); + + value32 = (ele_C & 0x000003C0) >> 6; + odm_set_bb_reg(dm, REG_OFDM_0_XC_TX_AFE, MASKH4BITS, value32); + + value32 = ((iqk_result_x * ele_D) >> 7) & 0x01; + odm_set_bb_reg(dm, REG_OFDM_0_ECCA_THRESHOLD, BIT(24), value32); + break; + case RF_PATH_B: + /* 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; + odm_set_bb_reg(dm, REG_OFDM_0_XB_TX_IQ_IMBALANCE, MASKDWORD, value32); + + value32 = (ele_C & 0x000003C0) >> 6; + odm_set_bb_reg(dm, REG_OFDM_0_XD_TX_AFE, MASKH4BITS, value32); + + value32 = ((iqk_result_x * ele_D) >> 7) & 0x01; + odm_set_bb_reg(dm, REG_OFDM_0_ECCA_THRESHOLD, BIT(28), value32); + + break; + default: + break; + } + } else { + switch (rf_path) { + case RF_PATH_A: + odm_set_bb_reg(dm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKDWORD, ofdm_swing_table_new[OFDM_index]); + odm_set_bb_reg(dm, REG_OFDM_0_XC_TX_AFE, MASKH4BITS, 0x00); + odm_set_bb_reg(dm, REG_OFDM_0_ECCA_THRESHOLD, BIT(24), 0x00); + break; + + case RF_PATH_B: + odm_set_bb_reg(dm, REG_OFDM_0_XB_TX_IQ_IMBALANCE, MASKDWORD, ofdm_swing_table_new[OFDM_index]); + odm_set_bb_reg(dm, REG_OFDM_0_XD_TX_AFE, MASKH4BITS, 0x00); + odm_set_bb_reg(dm, REG_OFDM_0_ECCA_THRESHOLD, BIT(28), 0x00); + break; + + default: + break; + } + } + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "TxPwrTracking path B: X = 0x%x, Y = 0x%x ele_A = 0x%x ele_C = 0x%x ele_D = 0x%x 0xeb4 = 0x%x 0xebc = 0x%x\n", + (u32)iqk_result_x, (u32)iqk_result_y, (u32)ele_A, (u32)ele_C, (u32)ele_D, (u32)iqk_result_x, (u32)iqk_result_y); +} + +void do_iqk_8188e( + void *dm_void, + u8 delta_thermal_index, + u8 thermal_value, + u8 threshold +) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + odm_reset_iqk_result(dm); + + dm->rf_calibrate_info.thermal_value_iqk = thermal_value; + halrf_iqk_trigger(dm, false); +} + +/*----------------------------------------------------------------------------- + * Function: odm_TxPwrTrackSetPwr88E() + * + * Overview: 88E 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_pwr88_e( + struct dm_struct *dm, + enum pwrtrack_method method, + u8 rf_path, + u8 channel_mapped_index +) +{ + if (method == TXAGC) { + /* u8 cck_power_level[MAX_TX_COUNT], ofdm_power_level[MAX_TX_COUNT]; + * u8 bw20_power_level[MAX_TX_COUNT], bw40_power_level[MAX_TX_COUNT]; + * u8 rf = 0; */ + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "odm_TxPwrTrackSetPwr88E CH=%d\n", *(dm->channel)); +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + phy_rf6052_set_cck_tx_power(dm->priv, *(dm->channel)); + phy_rf6052_set_ofdm_tx_power(dm->priv, *(dm->channel)); +#endif + + } else if (method == BBSWING) { + /* Adjust BB swing by OFDM IQ matrix */ + if (rf_path == RF_PATH_A) { + set_iqk_matrix_8188e(dm, dm->rf_calibrate_info.bb_swing_idx_ofdm[RF_PATH_A], RF_PATH_A, + dm->rf_calibrate_info.iqk_matrix_reg_setting[channel_mapped_index].value[0][0], + dm->rf_calibrate_info.iqk_matrix_reg_setting[channel_mapped_index].value[0][1]); + } else if (rf_path == RF_PATH_B) { + set_iqk_matrix_8188e(dm, dm->rf_calibrate_info.bb_swing_idx_ofdm[RF_PATH_B], RF_PATH_B, + dm->rf_calibrate_info.iqk_matrix_reg_setting[channel_mapped_index].value[0][4], + dm->rf_calibrate_info.iqk_matrix_reg_setting[channel_mapped_index].value[0][5]); + } + /*Adjust BB swing by CCK filter coefficient*/ + if (*dm->channel != 14) { + odm_write_1byte(dm, 0xa22, cck_swing_table_ch1_ch13_new[dm->rf_calibrate_info.bb_swing_idx_cck][0]); + odm_write_1byte(dm, 0xa23, cck_swing_table_ch1_ch13_new[dm->rf_calibrate_info.bb_swing_idx_cck][1]); + odm_write_1byte(dm, 0xa24, cck_swing_table_ch1_ch13_new[dm->rf_calibrate_info.bb_swing_idx_cck][2]); + odm_write_1byte(dm, 0xa25, cck_swing_table_ch1_ch13_new[dm->rf_calibrate_info.bb_swing_idx_cck][3]); + odm_write_1byte(dm, 0xa26, cck_swing_table_ch1_ch13_new[dm->rf_calibrate_info.bb_swing_idx_cck][4]); + odm_write_1byte(dm, 0xa27, cck_swing_table_ch1_ch13_new[dm->rf_calibrate_info.bb_swing_idx_cck][5]); + odm_write_1byte(dm, 0xa28, cck_swing_table_ch1_ch13_new[dm->rf_calibrate_info.bb_swing_idx_cck][6]); + odm_write_1byte(dm, 0xa29, cck_swing_table_ch1_ch13_new[dm->rf_calibrate_info.bb_swing_idx_cck][7]); + } else { + odm_write_1byte(dm, 0xa22, cck_swing_table_ch14_new[dm->rf_calibrate_info.bb_swing_idx_cck][0]); + odm_write_1byte(dm, 0xa23, cck_swing_table_ch14_new[dm->rf_calibrate_info.bb_swing_idx_cck][1]); + odm_write_1byte(dm, 0xa24, cck_swing_table_ch14_new[dm->rf_calibrate_info.bb_swing_idx_cck][2]); + odm_write_1byte(dm, 0xa25, cck_swing_table_ch14_new[dm->rf_calibrate_info.bb_swing_idx_cck][3]); + odm_write_1byte(dm, 0xa26, cck_swing_table_ch14_new[dm->rf_calibrate_info.bb_swing_idx_cck][4]); + odm_write_1byte(dm, 0xa27, cck_swing_table_ch14_new[dm->rf_calibrate_info.bb_swing_idx_cck][5]); + odm_write_1byte(dm, 0xa28, cck_swing_table_ch14_new[dm->rf_calibrate_info.bb_swing_idx_cck][6]); + odm_write_1byte(dm, 0xa29, cck_swing_table_ch14_new[dm->rf_calibrate_info.bb_swing_idx_cck][7]); + } + } else + return; + + + + +} /* odm_TxPwrTrackSetPwr88E */ + +void configure_txpower_track_8188e( + struct txpwrtrack_cfg *config +) +{ + config->swing_table_size_cck = CCK_TABLE_SIZE; + config->swing_table_size_ofdm = OFDM_TABLE_SIZE_92D; + config->threshold_iqk = 8; + config->average_thermal_num = AVG_THERMAL_NUM_88E; + config->rf_path_count = 1; + config->thermal_reg_addr = RF_T_METER_88E; + + config->odm_tx_pwr_track_set_pwr = odm_tx_pwr_track_set_pwr88_e; + config->do_iqk = do_iqk_8188e; + config->phy_lc_calibrate = halrf_lck_trigger; +} + +/* 1 7. IQK */ +#define MAX_TOLERANCE 5 +#define IQK_DELAY_TIME 1 /* ms */ + +u8 /* bit0 = 1 => Tx OK, bit1 = 1 => Rx OK */ +phy_path_a_iqk_8188e( + struct dm_struct *dm, + boolean config_path_b +) +{ + u32 reg_eac, reg_e94, reg_e9c, reg_ea4; + u8 result = 0x00; + + RF_DBG(dm, DBG_RF_IQK, "path A IQK!\n"); + /* 1 Tx IQK */ + /* path-A IQK setting */ + RF_DBG(dm, DBG_RF_IQK, "path-A IQK setting!\n"); + odm_set_bb_reg(dm, REG_TX_IQK_TONE_A, MASKDWORD, 0x10008c1c); + odm_set_bb_reg(dm, REG_RX_IQK_TONE_A, MASKDWORD, 0x30008c1c); + odm_set_bb_reg(dm, REG_TX_IQK_PI_A, MASKDWORD, 0x8214032a); + odm_set_bb_reg(dm, REG_RX_IQK_PI_A, MASKDWORD, 0x28160000); + + /* LO calibration setting */ + RF_DBG(dm, DBG_RF_IQK, "LO calibration setting!\n"); + odm_set_bb_reg(dm, REG_IQK_AGC_RSP, MASKDWORD, 0x00462911); + + /* One shot, path A LOK & IQK */ + RF_DBG(dm, DBG_RF_IQK, "One shot, path A LOK & IQK!\n"); + odm_set_bb_reg(dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf9000000); + odm_set_bb_reg(dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf8000000); + + /* delay x ms */ + RF_DBG(dm, DBG_RF_IQK, "delay %d ms for One shot, path A LOK & IQK.\n", IQK_DELAY_TIME_88E); + /* platform_stall_execution(IQK_DELAY_TIME_88E*1000); */ + ODM_delay_ms(IQK_DELAY_TIME_88E); + /* Check failed */ + reg_eac = odm_get_bb_reg(dm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xeac = 0x%x\n", reg_eac); + reg_e94 = odm_get_bb_reg(dm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xe94 = 0x%x\n", reg_e94); + reg_e9c = odm_get_bb_reg(dm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xe9c = 0x%x\n", reg_e9c); + reg_ea4 = odm_get_bb_reg(dm, REG_RX_POWER_BEFORE_IQK_A_2, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xea4 = 0x%x\n", reg_ea4); + + if (!(reg_eac & BIT(28)) && + (((reg_e94 & 0x03FF0000) >> 16) != 0x142) && + (((reg_e9c & 0x03FF0000) >> 16) != 0x42)) + result |= 0x01; + /* else */ /* if Tx not OK, ignore Rx */ + /* return result; */ +#if 0 + if (!(reg_eac & BIT(27)) && /* if Tx is OK, check whether Rx is OK */ + (((reg_ea4 & 0x03FF0000) >> 16) != 0x132) && + (((reg_eac & 0x03FF0000) >> 16) != 0x36)) + result |= 0x02; + else + RTPRINT(FINIT, INIT_IQK, ("path A Rx IQK fail!!\n")); +#endif + + return result; + + +} + +u8 /* bit0 = 1 => Tx OK, bit1 = 1 => Rx OK */ +phy_path_a_rx_iqk( + struct dm_struct *dm, + boolean config_path_b +) +{ + u32 reg_eac, reg_e94, reg_e9c, reg_ea4, u4tmp; + u8 result = 0x00; + + RF_DBG(dm, DBG_RF_IQK, "path A Rx IQK!\n"); + + /* 1 Get TXIMR setting */ + /* modify RXIQK mode table */ + RF_DBG(dm, DBG_RF_IQK, "path-A Rx IQK modify RXIQK mode table!\n"); + odm_set_bb_reg(dm, REG_FPGA0_IQK, 0xffffff00, 0); + odm_set_rf_reg(dm, RF_PATH_A, RF_WE_LUT, RFREGOFFSETMASK, 0x800a0); + odm_set_rf_reg(dm, RF_PATH_A, RF_RCK_OS, RFREGOFFSETMASK, 0x30000); + odm_set_rf_reg(dm, RF_PATH_A, RF_TXPA_G1, RFREGOFFSETMASK, 0x0000f); + odm_set_rf_reg(dm, RF_PATH_A, RF_TXPA_G2, RFREGOFFSETMASK, 0xf117B); + odm_set_bb_reg(dm, REG_FPGA0_IQK, 0xffffff00, 0x808000); + + /* IQK setting */ + odm_set_bb_reg(dm, REG_TX_IQK, MASKDWORD, 0x01007c00); + odm_set_bb_reg(dm, REG_RX_IQK, MASKDWORD, 0x81004800); + + /* path-A IQK setting */ + odm_set_bb_reg(dm, REG_TX_IQK_TONE_A, MASKDWORD, 0x10008c1c); + odm_set_bb_reg(dm, REG_RX_IQK_TONE_A, MASKDWORD, 0x30008c1c); + odm_set_bb_reg(dm, REG_TX_IQK_PI_A, MASKDWORD, 0x82160804); + odm_set_bb_reg(dm, REG_RX_IQK_PI_A, MASKDWORD, 0x28160000); + + /* LO calibration setting */ + RF_DBG(dm, DBG_RF_IQK, "LO calibration setting!\n"); + odm_set_bb_reg(dm, REG_IQK_AGC_RSP, MASKDWORD, 0x0046a911); + + /* One shot, path A LOK & IQK */ + RF_DBG(dm, DBG_RF_IQK, "One shot, path A LOK & IQK!\n"); + odm_set_bb_reg(dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf9000000); + odm_set_bb_reg(dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf8000000); + + /* delay x ms */ + RF_DBG(dm, DBG_RF_IQK, "delay %d ms for One shot, path A LOK & IQK.\n", IQK_DELAY_TIME_88E); + /* platform_stall_execution(IQK_DELAY_TIME_88E*1000); */ + ODM_delay_ms(IQK_DELAY_TIME_88E); + /* Check failed */ + reg_eac = odm_get_bb_reg(dm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xeac = 0x%x\n", reg_eac); + reg_e94 = odm_get_bb_reg(dm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xe94 = 0x%x\n", reg_e94); + reg_e9c = odm_get_bb_reg(dm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xe9c = 0x%x\n", reg_e9c); + + if (!(reg_eac & BIT(28)) && + (((reg_e94 & 0x03FF0000) >> 16) != 0x142) && + (((reg_e9c & 0x03FF0000) >> 16) != 0x42)) + result |= 0x01; + else { /* if Tx not OK, ignore Rx */ + return result; + } + + u4tmp = 0x80007C00 | (reg_e94 & 0x3FF0000) | ((reg_e9c & 0x3FF0000) >> 16); + odm_set_bb_reg(dm, REG_TX_IQK, MASKDWORD, u4tmp); + RF_DBG(dm, DBG_RF_IQK, "0xe40 = 0x%x u4tmp = 0x%x\n", odm_get_bb_reg(dm, REG_TX_IQK, MASKDWORD), u4tmp); + + + /* 1 RX IQK */ + /* modify RXIQK mode table */ + RF_DBG(dm, DBG_RF_IQK, "path-A Rx IQK modify RXIQK mode table 2!\n"); + odm_set_bb_reg(dm, REG_FPGA0_IQK, 0xffffff00, 0); + odm_set_rf_reg(dm, RF_PATH_A, RF_WE_LUT, RFREGOFFSETMASK, 0x800a0); + odm_set_rf_reg(dm, RF_PATH_A, RF_RCK_OS, RFREGOFFSETMASK, 0x30000); + odm_set_rf_reg(dm, RF_PATH_A, RF_TXPA_G1, RFREGOFFSETMASK, 0x0000f); + odm_set_rf_reg(dm, RF_PATH_A, RF_TXPA_G2, RFREGOFFSETMASK, 0xf7ffa); + odm_set_bb_reg(dm, REG_FPGA0_IQK, 0xffffff00, 0x808000); + + /* IQK setting */ + odm_set_bb_reg(dm, REG_RX_IQK, MASKDWORD, 0x01004800); + + /* path-A IQK setting */ + odm_set_bb_reg(dm, REG_TX_IQK_TONE_A, MASKDWORD, 0x30008c1c); + odm_set_bb_reg(dm, REG_RX_IQK_TONE_A, MASKDWORD, 0x10008c1c); + odm_set_bb_reg(dm, REG_TX_IQK_PI_A, MASKDWORD, 0x82160c05); + odm_set_bb_reg(dm, REG_RX_IQK_PI_A, MASKDWORD, 0x28160c05); + + /* LO calibration setting */ + RF_DBG(dm, DBG_RF_IQK, "LO calibration setting!\n"); + odm_set_bb_reg(dm, REG_IQK_AGC_RSP, MASKDWORD, 0x0046a911); + + /* One shot, path A LOK & IQK */ + RF_DBG(dm, DBG_RF_IQK, "One shot, path A LOK & IQK!\n"); + odm_set_bb_reg(dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf9000000); + odm_set_bb_reg(dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf8000000); + + /* delay x ms */ + RF_DBG(dm, DBG_RF_IQK, "delay %d ms for One shot, path A LOK & IQK.\n", IQK_DELAY_TIME_88E); + /* platform_stall_execution(IQK_DELAY_TIME_88E*1000); */ + + ODM_delay_ms(IQK_DELAY_TIME_88E); + /* Check failed */ + reg_eac = odm_get_bb_reg(dm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xeac = 0x%x\n", reg_eac); + reg_e94 = odm_get_bb_reg(dm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xe94 = 0x%x\n", reg_e94); + reg_e9c = odm_get_bb_reg(dm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xe9c = 0x%x\n", reg_e9c); + reg_ea4 = odm_get_bb_reg(dm, REG_RX_POWER_BEFORE_IQK_A_2, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xea4 = 0x%x\n", reg_ea4); + +#if 0 + if (!(reg_eac & BIT(28)) && + (((reg_e94 & 0x03FF0000) >> 16) != 0x142) && + (((reg_e9c & 0x03FF0000) >> 16) != 0x42)) + result |= 0x01; + else /* if Tx not OK, ignore Rx */ + return result; +#endif + + if (!(reg_eac & BIT(27)) && /* if Tx is OK, check whether Rx is OK */ + (((reg_ea4 & 0x03FF0000) >> 16) != 0x132) && + (((reg_eac & 0x03FF0000) >> 16) != 0x36)) + result |= 0x02; + else + RF_DBG(dm, DBG_RF_IQK, "path A Rx IQK fail!!\n"); + + return result; + + +} + +u8 /* bit0 = 1 => Tx OK, bit1 = 1 => Rx OK */ +phy_path_b_iqk_8188e( + struct dm_struct *dm +) +{ + u32 reg_eac, reg_eb4, reg_ebc, reg_ec4, reg_ecc; + u8 result = 0x00; + RF_DBG(dm, DBG_RF_IQK, "path B IQK!\n"); + + /* One shot, path B LOK & IQK */ + RF_DBG(dm, DBG_RF_IQK, "One shot, path A LOK & IQK!\n"); + odm_set_bb_reg(dm, REG_IQK_AGC_CONT, MASKDWORD, 0x00000002); + odm_set_bb_reg(dm, REG_IQK_AGC_CONT, MASKDWORD, 0x00000000); + + /* delay x ms */ + RF_DBG(dm, DBG_RF_IQK, "delay %d ms for One shot, path B LOK & IQK.\n", IQK_DELAY_TIME_88E); + /* platform_stall_execution(IQK_DELAY_TIME_88E*1000); */ + ODM_delay_ms(IQK_DELAY_TIME_88E); + + /* Check failed */ + reg_eac = odm_get_bb_reg(dm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xeac = 0x%x\n", reg_eac); + reg_eb4 = odm_get_bb_reg(dm, REG_TX_POWER_BEFORE_IQK_B, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xeb4 = 0x%x\n", reg_eb4); + reg_ebc = odm_get_bb_reg(dm, REG_TX_POWER_AFTER_IQK_B, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xebc = 0x%x\n", reg_ebc); + reg_ec4 = odm_get_bb_reg(dm, REG_RX_POWER_BEFORE_IQK_B_2, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xec4 = 0x%x\n", reg_ec4); + reg_ecc = odm_get_bb_reg(dm, REG_RX_POWER_AFTER_IQK_B_2, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xecc = 0x%x\n", reg_ecc); + + if (!(reg_eac & BIT(31)) && + (((reg_eb4 & 0x03FF0000) >> 16) != 0x142) && + (((reg_ebc & 0x03FF0000) >> 16) != 0x42)) + result |= 0x01; + else + return result; + + if (!(reg_eac & BIT(30)) && + (((reg_ec4 & 0x03FF0000) >> 16) != 0x132) && + (((reg_ecc & 0x03FF0000) >> 16) != 0x36)) + result |= 0x02; + else + RF_DBG(dm, DBG_RF_IQK, "path B Rx IQK fail!!\n"); + + + return result; + +} + +void +_phy_path_a_fill_iqk_matrix( + struct dm_struct *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; + RF_DBG(dm, DBG_RF_IQK, "path A 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(dm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKDWORD) >> 22) & 0x3FF; + + X = result[final_candidate][0]; + if ((X & 0x00000200) != 0) + X = X | 0xFFFFFC00; + TX0_A = (X * oldval_0) >> 8; + RF_DBG(dm, DBG_RF_IQK, "X = 0x%x, TX0_A = 0x%x, oldval_0 0x%x\n", X, TX0_A, oldval_0); + odm_set_bb_reg(dm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, 0x3FF, TX0_A); + + odm_set_bb_reg(dm, REG_OFDM_0_ECCA_THRESHOLD, BIT(31), ((X * oldval_0 >> 7) & 0x1)); + + Y = result[final_candidate][1]; + if ((Y & 0x00000200) != 0) + Y = Y | 0xFFFFFC00; + + + TX0_C = (Y * oldval_0) >> 8; + RF_DBG(dm, DBG_RF_IQK, "Y = 0x%x, TX = 0x%x\n", Y, TX0_C); + odm_set_bb_reg(dm, REG_OFDM_0_XC_TX_AFE, 0xF0000000, ((TX0_C & 0x3C0) >> 6)); + odm_set_bb_reg(dm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, 0x003F0000, (TX0_C & 0x3F)); + + odm_set_bb_reg(dm, REG_OFDM_0_ECCA_THRESHOLD, BIT(29), ((Y * oldval_0 >> 7) & 0x1)); + + if (is_tx_only) { + RF_DBG(dm, DBG_RF_IQK, "_phy_path_a_fill_iqk_matrix 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(dm, REG_OFDM_0_XA_RX_IQ_IMBALANCE, 0x3FF, reg); + + reg = result[final_candidate][3] & 0x3F; + odm_set_bb_reg(dm, REG_OFDM_0_XA_RX_IQ_IMBALANCE, 0xFC00, reg); + + reg = (result[final_candidate][3] >> 6) & 0xF; + odm_set_bb_reg(dm, REG_OFDM_0_RX_IQ_EXT_ANTA, 0xF0000000, reg); + } +} + +void +_phy_path_b_fill_iqk_matrix( + struct dm_struct *dm, + boolean is_iqk_ok, + s32 result[][8], + u8 final_candidate, + boolean is_tx_only /* do Tx only */ +) +{ + u32 oldval_1, X, TX1_A, reg; + s32 Y, TX1_C; + RF_DBG(dm, DBG_RF_IQK, "path B 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(dm, REG_OFDM_0_XB_TX_IQ_IMBALANCE, MASKDWORD) >> 22) & 0x3FF; + + X = result[final_candidate][4]; + if ((X & 0x00000200) != 0) + X = X | 0xFFFFFC00; + TX1_A = (X * oldval_1) >> 8; + RF_DBG(dm, DBG_RF_IQK, "X = 0x%x, TX1_A = 0x%x\n", X, TX1_A); + odm_set_bb_reg(dm, REG_OFDM_0_XB_TX_IQ_IMBALANCE, 0x3FF, TX1_A); + + odm_set_bb_reg(dm, REG_OFDM_0_ECCA_THRESHOLD, BIT(27), ((X * oldval_1 >> 7) & 0x1)); + + Y = result[final_candidate][5]; + if ((Y & 0x00000200) != 0) + Y = Y | 0xFFFFFC00; + + TX1_C = (Y * oldval_1) >> 8; + RF_DBG(dm, DBG_RF_IQK, "Y = 0x%x, TX1_C = 0x%x\n", Y, TX1_C); + odm_set_bb_reg(dm, REG_OFDM_0_XD_TX_AFE, 0xF0000000, ((TX1_C & 0x3C0) >> 6)); + odm_set_bb_reg(dm, REG_OFDM_0_XB_TX_IQ_IMBALANCE, 0x003F0000, (TX1_C & 0x3F)); + + odm_set_bb_reg(dm, REG_OFDM_0_ECCA_THRESHOLD, BIT(25), ((Y * oldval_1 >> 7) & 0x1)); + + if (is_tx_only) + return; + + reg = result[final_candidate][6]; + odm_set_bb_reg(dm, REG_OFDM_0_XB_RX_IQ_IMBALANCE, 0x3FF, reg); + + reg = result[final_candidate][7] & 0x3F; + odm_set_bb_reg(dm, REG_OFDM_0_XB_RX_IQ_IMBALANCE, 0xFC00, reg); + + reg = (result[final_candidate][7] >> 6) & 0xF; + odm_set_bb_reg(dm, REG_OFDM_0_AGC_RSSI_TABLE, 0x0000F000, reg); + } +} + +void +_phy_save_adda_registers( + struct dm_struct *dm, + u32 *adda_reg, + u32 *adda_backup, + u32 register_num +) +{ + u32 i; + + RF_DBG(dm, DBG_RF_IQK, "Save ADDA parameters.\n"); + for (i = 0 ; i < register_num ; i++) + adda_backup[i] = odm_get_bb_reg(dm, adda_reg[i], MASKDWORD); +} + + +void +_phy_save_mac_registers( + struct dm_struct *dm, + u32 *mac_reg, + u32 *mac_backup +) +{ + u32 i; + RF_DBG(dm, DBG_RF_IQK, "Save MAC parameters.\n"); + for (i = 0 ; i < (IQK_MAC_REG_NUM - 1); i++) + mac_backup[i] = odm_read_1byte(dm, mac_reg[i]); + mac_backup[i] = odm_read_4byte(dm, mac_reg[i]); + +} + + +void +_phy_reload_adda_registers( + struct dm_struct *dm, + u32 *adda_reg, + u32 *adda_backup, + u32 regiester_num +) +{ + u32 i; + RF_DBG(dm, DBG_RF_IQK, "Reload ADDA power saving parameters !\n"); + for (i = 0 ; i < regiester_num; i++) + odm_set_bb_reg(dm, adda_reg[i], MASKDWORD, adda_backup[i]); +} + +void +_phy_reload_mac_registers( + struct dm_struct *dm, + u32 *mac_reg, + u32 *mac_backup +) +{ + u32 i; + RF_DBG(dm, DBG_RF_IQK, "Reload MAC parameters !\n"); + for (i = 0 ; i < (IQK_MAC_REG_NUM - 1); i++) + odm_write_1byte(dm, mac_reg[i], (u8)mac_backup[i]); + odm_write_4byte(dm, mac_reg[i], mac_backup[i]); +} + + +void +_phy_path_adda_on( + struct dm_struct *dm, + u32 *adda_reg, + boolean is_path_a_on, + boolean is2T +) +{ + u32 path_on; + u32 i; + RF_DBG(dm, DBG_RF_IQK, "ADDA ON.\n"); + + path_on = is_path_a_on ? 0x04db25a4 : 0x0b1b25a4; + if (false == is2T) { + path_on = 0x0bdb25a0; + odm_set_bb_reg(dm, adda_reg[0], MASKDWORD, 0x0b1b25a0); + } else + odm_set_bb_reg(dm, adda_reg[0], MASKDWORD, path_on); + + for (i = 1 ; i < IQK_ADDA_REG_NUM ; i++) + odm_set_bb_reg(dm, adda_reg[i], MASKDWORD, path_on); + +} + +void +_phy_mac_setting_calibration( + struct dm_struct *dm, + u32 *mac_reg, + u32 *mac_backup +) +{ + u32 i = 0; + RF_DBG(dm, DBG_RF_IQK, "MAC settings for Calibration.\n"); + + odm_write_1byte(dm, mac_reg[i], 0x3F); + + for (i = 1 ; i < (IQK_MAC_REG_NUM - 1); i++) + odm_write_1byte(dm, mac_reg[i], (u8)(mac_backup[i] & (~BIT(3)))); + odm_write_1byte(dm, mac_reg[i], (u8)(mac_backup[i] & (~BIT(5)))); + +} + +void +_phy_path_a_stand_by( + struct dm_struct *dm +) +{ + RF_DBG(dm, DBG_RF_IQK, "path-A standby mode!\n"); + + odm_set_bb_reg(dm, REG_FPGA0_IQK, 0xffffff00, 0x0); + odm_set_bb_reg(dm, R_0x840, MASKDWORD, 0x00010000); + odm_set_bb_reg(dm, REG_FPGA0_IQK, 0xffffff00, 0x808000); +} + +void +_phy_pi_mode_switch( + struct dm_struct *dm, + boolean pi_mode +) +{ + u32 mode; + RF_DBG(dm, DBG_RF_IQK, "BB Switch to %s mode!\n", (pi_mode ? "PI" : "SI")); + + mode = pi_mode ? 0x01000100 : 0x01000000; + odm_set_bb_reg(dm, REG_FPGA0_XA_HSSI_PARAMETER1, MASKDWORD, mode); + odm_set_bb_reg(dm, REG_FPGA0_XB_HSSI_PARAMETER1, MASKDWORD, mode); +} + +boolean +phy_simularity_compare_8188e( + struct dm_struct *dm, + s32 result[][8], + u8 c1, + u8 c2 +) +{ + u32 i, j, diff, simularity_bit_map, bound = 0; + u8 final_candidate[2] = {0xFF, 0xFF}; /* for path A and path B */ + boolean is_result = true; + boolean is2T = 0; + + if (is2T) + bound = 8; + else + bound = 4; + + RF_DBG(dm, DBG_RF_IQK, "===> IQK:phy_simularity_compare_8188e c1 %d c2 %d!!!\n", c1, c2); + + + simularity_bit_map = 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) { + RF_DBG(dm, DBG_RF_IQK, "IQK:phy_simularity_compare_8188e differnece overflow index %d compare1 0x%x compare2 0x%x!!!\n", 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); + } + } + + RF_DBG(dm, DBG_RF_IQK, "IQK:phy_simularity_compare_8188e simularity_bit_map %d !!!\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 & 0x0F)) { /* path A OK */ + for (i = 0; i < 4; i++) + result[3][i] = result[c1][i]; + return false; + } else if (!(simularity_bit_map & 0xF0) && is2T) { /* path B OK */ + for (i = 4; i < 8; i++) + result[3][i] = result[c1][i]; + return false; + } else + return false; + +} + + + +void +_phy_iq_calibrate_8188e( + struct dm_struct *dm, + s32 result[][8], + u8 t, + boolean is2T +) +{ + u32 i; + u8 path_aok, path_bok; + 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 + }; + + /* since 92C & 92D have the different define in IQK_BB_REG */ + 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_FPGA0_RFMOD*/ REG_CCK_0_AFE_SETTING + }; + + u32 retry_count = 2; + /* Note: IQ calibration must be performed after loading */ + /* PHY_REG.txt , and radio_a, radio_b.txt */ + + /* u32 bbvalue; */ + + if (*(dm->mp_mode)) + retry_count = 9; + + if (t == 0) { + /* bbvalue = odm_get_bb_reg(dm, REG_FPGA0_RFMOD, MASKDWORD); + * RTPRINT(FINIT, INIT_IQK, ("_phy_iq_calibrate_8188e()==>0x%08x\n",bbvalue)); */ + + RF_DBG(dm, DBG_RF_IQK, "IQ Calibration for %s for %d times\n", (is2T ? "2T2R" : "1T1R"), t); + + /* Save ADDA parameters, turn path A ADDA on */ + _phy_save_adda_registers(dm, ADDA_REG, dm->rf_calibrate_info.ADDA_backup, IQK_ADDA_REG_NUM); + _phy_save_mac_registers(dm, IQK_MAC_REG, dm->rf_calibrate_info.IQK_MAC_backup); + _phy_save_adda_registers(dm, IQK_BB_REG_92C, dm->rf_calibrate_info.IQK_BB_backup, IQK_BB_REG_NUM); + } + RF_DBG(dm, DBG_RF_IQK, "IQ Calibration for %s for %d times\n", (is2T ? "2T2R" : "1T1R"), t); + + _phy_path_adda_on(dm, ADDA_REG, true, is2T); + + if (t == 0) + dm->rf_calibrate_info.is_rf_pi_enable = (u8)odm_get_bb_reg(dm, REG_FPGA0_XA_HSSI_PARAMETER1, BIT(8)); + + if (!dm->rf_calibrate_info.is_rf_pi_enable) { + /* Switch BB to PI mode to do IQ Calibration. */ + _phy_pi_mode_switch(dm, true); + } + + /* MAC settings */ + _phy_mac_setting_calibration(dm, IQK_MAC_REG, dm->rf_calibrate_info.IQK_MAC_backup); + + /* BB setting */ + /* odm_set_bb_reg(dm, REG_FPGA0_RFMOD, BIT24, 0x00); */ + odm_set_bb_reg(dm, REG_CCK_0_AFE_SETTING, MASKDWORD, (0x0f000000 | (odm_get_bb_reg(dm, REG_CCK_0_AFE_SETTING, MASKDWORD)))); + odm_set_bb_reg(dm, REG_OFDM_0_TRX_PATH_ENABLE, MASKDWORD, 0x03a05600); + odm_set_bb_reg(dm, REG_OFDM_0_TR_MUX_PAR, MASKDWORD, 0x000800e4); + odm_set_bb_reg(dm, REG_FPGA0_XCD_RF_INTERFACE_SW, MASKDWORD, 0x22204000); + + + odm_set_bb_reg(dm, REG_FPGA0_XAB_RF_INTERFACE_SW, BIT(10), 0x01); + odm_set_bb_reg(dm, REG_FPGA0_XAB_RF_INTERFACE_SW, BIT(26), 0x01); + odm_set_bb_reg(dm, REG_FPGA0_XA_RF_INTERFACE_OE, BIT(10), 0x00); + odm_set_bb_reg(dm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(10), 0x00); + + + if (is2T) { + odm_set_bb_reg(dm, REG_FPGA0_XA_LSSI_PARAMETER, MASKDWORD, 0x00010000); + odm_set_bb_reg(dm, REG_FPGA0_XB_LSSI_PARAMETER, MASKDWORD, 0x00010000); + } + + /* Page B init */ + /* AP or IQK */ + odm_set_bb_reg(dm, REG_CONFIG_ANT_A, MASKDWORD, 0x0f600000); + + if (is2T) + odm_set_bb_reg(dm, REG_CONFIG_ANT_B, MASKDWORD, 0x0f600000); + + /* IQ calibration setting */ + RF_DBG(dm, DBG_RF_IQK, "IQK setting!\n"); + odm_set_bb_reg(dm, REG_FPGA0_IQK, 0xffffff00, 0x808000); + odm_set_bb_reg(dm, REG_TX_IQK, MASKDWORD, 0x01007c00); + odm_set_bb_reg(dm, REG_RX_IQK, MASKDWORD, 0x81004800); + + for (i = 0 ; i < retry_count ; i++) { + path_aok = phy_path_a_iqk_8188e(dm, is2T); + /* if(path_aok == 0x03){ */ + if (path_aok == 0x01) { + RF_DBG(dm, DBG_RF_IQK, "path A Tx IQK Success!!\n"); + result[t][0] = (odm_get_bb_reg(dm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD) & 0x3FF0000) >> 16; + result[t][1] = (odm_get_bb_reg(dm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD) & 0x3FF0000) >> 16; + break; + } +#if 0 + else if (i == (retry_count - 1) && path_aok == 0x01) { /* Tx IQK OK */ + RTPRINT(FINIT, INIT_IQK, ("path A IQK Only Tx Success!!\n")); + + result[t][0] = (odm_get_bb_reg(dm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD) & 0x3FF0000) >> 16; + result[t][1] = (odm_get_bb_reg(dm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD) & 0x3FF0000) >> 16; + } +#endif + } + + for (i = 0 ; i < retry_count ; i++) { + path_aok = phy_path_a_rx_iqk(dm, is2T); + if (path_aok == 0x03) { + RF_DBG(dm, DBG_RF_IQK, "path A Rx IQK Success!!\n"); + /* result[t][0] = (odm_get_bb_reg(dm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD)&0x3FF0000)>>16; + * result[t][1] = (odm_get_bb_reg(dm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD)&0x3FF0000)>>16; */ + result[t][2] = (odm_get_bb_reg(dm, REG_RX_POWER_BEFORE_IQK_A_2, MASKDWORD) & 0x3FF0000) >> 16; + result[t][3] = (odm_get_bb_reg(dm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD) & 0x3FF0000) >> 16; + break; + } else + RF_DBG(dm, DBG_RF_IQK, "path A Rx IQK Fail!!\n"); + } + + if (0x00 == path_aok) + RF_DBG(dm, DBG_RF_IQK, "path A IQK failed!!\n"); + + if (is2T) { + _phy_path_a_stand_by(dm); + + /* Turn path B ADDA on */ + _phy_path_adda_on(dm, ADDA_REG, false, is2T); + + for (i = 0 ; i < retry_count ; i++) { + path_bok = phy_path_b_iqk_8188e(dm); + if (path_bok == 0x03) { + RF_DBG(dm, DBG_RF_IQK, "path B IQK Success!!\n"); + result[t][4] = (odm_get_bb_reg(dm, REG_TX_POWER_BEFORE_IQK_B, MASKDWORD) & 0x3FF0000) >> 16; + result[t][5] = (odm_get_bb_reg(dm, REG_TX_POWER_AFTER_IQK_B, MASKDWORD) & 0x3FF0000) >> 16; + result[t][6] = (odm_get_bb_reg(dm, REG_RX_POWER_BEFORE_IQK_B_2, MASKDWORD) & 0x3FF0000) >> 16; + result[t][7] = (odm_get_bb_reg(dm, REG_RX_POWER_AFTER_IQK_B_2, MASKDWORD) & 0x3FF0000) >> 16; + break; + } else if (i == (retry_count - 1) && path_bok == 0x01) { /* Tx IQK OK */ + RF_DBG(dm, DBG_RF_IQK, "path B Only Tx IQK Success!!\n"); + result[t][4] = (odm_get_bb_reg(dm, REG_TX_POWER_BEFORE_IQK_B, MASKDWORD) & 0x3FF0000) >> 16; + result[t][5] = (odm_get_bb_reg(dm, REG_TX_POWER_AFTER_IQK_B, MASKDWORD) & 0x3FF0000) >> 16; + } + } + + if (0x00 == path_bok) + RF_DBG(dm, DBG_RF_IQK, "path B IQK failed!!\n"); + } + + /* Back to BB mode, load original value */ + RF_DBG(dm, DBG_RF_IQK, "IQK:Back to BB mode, load original value!\n"); + odm_set_bb_reg(dm, REG_FPGA0_IQK, 0xffffff00, 0); + + if (t != 0) { + if (!dm->rf_calibrate_info.is_rf_pi_enable) { + /* Switch back BB to SI mode after finish IQ Calibration. */ + _phy_pi_mode_switch(dm, false); + } + /* Reload ADDA power saving parameters */ + _phy_reload_adda_registers(dm, ADDA_REG, dm->rf_calibrate_info.ADDA_backup, IQK_ADDA_REG_NUM); + + /* Reload MAC parameters */ + _phy_reload_mac_registers(dm, IQK_MAC_REG, dm->rf_calibrate_info.IQK_MAC_backup); + + _phy_reload_adda_registers(dm, IQK_BB_REG_92C, dm->rf_calibrate_info.IQK_BB_backup, IQK_BB_REG_NUM); + + /* Restore RX initial gain */ + odm_set_bb_reg(dm, REG_FPGA0_XA_LSSI_PARAMETER, MASKDWORD, 0x00032ed3); + if (is2T) + odm_set_bb_reg(dm, REG_FPGA0_XB_LSSI_PARAMETER, MASKDWORD, 0x00032ed3); + + /* load 0xe30 IQC default value */ + odm_set_bb_reg(dm, REG_TX_IQK_TONE_A, MASKDWORD, 0x01008c00); + odm_set_bb_reg(dm, REG_RX_IQK_TONE_A, MASKDWORD, 0x01008c00); + + } + RF_DBG(dm, DBG_RF_IQK, "_phy_iq_calibrate_8188e() <==\n"); +} + + +void +_phy_lc_calibrate_8188e( + struct dm_struct *dm, + boolean is2T +) +{ + u8 tmp_reg; + u32 rf_amode = 0, rf_bmode = 0, lc_cal; + + /* Check continuous TX and Packet TX */ + tmp_reg = odm_read_1byte(dm, 0xd03); + + if ((tmp_reg & 0x70) != 0) /* Deal with contisuous TX case */ + ;/* odm_write_1byte(dm, 0xd03, tmp_reg&0x8F); */ /* disable all continuous TX */ + else /* Deal with Packet TX case */ + odm_write_1byte(dm, REG_TXPAUSE, 0xFF); /* block all queues */ + + if ((tmp_reg & 0x70) != 0) { + /* 1. Read original RF mode */ + /* path-A */ + + rf_amode = odm_get_rf_reg(dm, RF_PATH_A, RF_AC, MASK20BITS); + + /* path-B */ + if (is2T) + rf_bmode = odm_get_rf_reg(dm, RF_PATH_B, RF_AC, MASK12BITS); + + /* 2. Set RF mode = standby mode */ + /* path-A */ + odm_set_rf_reg(dm, RF_PATH_A, RF_AC, MASK20BITS, (rf_amode & 0x8FFFF) | 0x10000); + + /* path-B */ + if (is2T) + odm_set_rf_reg(dm, RF_PATH_B, RF_AC, MASK20BITS, (rf_bmode & 0x8FFFF) | 0x10000); + } + + /* 3. Read RF reg18 */ + lc_cal = odm_get_rf_reg(dm, RF_PATH_A, RF_CHNLBW, MASK20BITS); + + /* 4. Set LC calibration begin bit15 */ + odm_set_rf_reg(dm, RF_PATH_A, RF_CHNLBW, MASK20BITS, lc_cal | 0x08000); + + ODM_delay_ms(100); + + /* Restore original situation */ + if ((tmp_reg & 0x70) != 0) { /* Deal with contisuous TX case */ + /* path-A */ + /* odm_write_1byte(dm, 0xd03, tmp_reg); */ + odm_set_rf_reg(dm, RF_PATH_A, RF_AC, MASK20BITS, rf_amode); + + /* path-B */ + if (is2T) + odm_set_rf_reg(dm, RF_PATH_B, RF_AC, MASK20BITS, rf_bmode); + } else /* Deal with Packet TX case */ + odm_write_1byte(dm, REG_TXPAUSE, 0x00); +} + +void +phy_iq_calibrate_8188e( + struct dm_struct *dm, + boolean is_recovery +) +{ + struct dm_iqk_info *iqk_info = &dm->IQK_info; + s32 result[4][8]; /* last is final result */ + u8 i, final_candidate, indexforchannel; + /* u8 channel_to_iqk = 7; */ + boolean is_patha_ok, is_pathb_ok; + s32 rege94, rege9c, regea4, regeac, regeb4, regebc, regec4, regecc, reg_tmp = 0; + 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 + }; + + if (is_recovery) { + RF_DBG(dm, DBG_RF_INIT, "phy_iq_calibrate_8188e: Return due to is_recovery!\n"); + _phy_reload_adda_registers(dm, IQK_BB_REG_92C, dm->rf_calibrate_info.IQK_BB_backup_recover, 9); + return; + } + RF_DBG(dm, DBG_RF_IQK, "IQK:Start!!!\n"); + iqk_info->iqk_times++; + /*priv->pshare->IQK_total_cnt++;*/ + + 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_patha_ok = false; + is_pathb_ok = false; + is12simular = false; + is23simular = false; + is13simular = false; + + for (i = 0; i < 3; i++) { + /* For 88C 1T1R */ + _phy_iq_calibrate_8188e(dm, result, i, false); + if (i == 1) { + is12simular = phy_simularity_compare_8188e(dm, result, 0, 1); + if (is12simular) { + final_candidate = 0; + RF_DBG(dm, DBG_RF_IQK, "IQK: is12simular final_candidate is %x\n", final_candidate); + break; + } + } + if (i == 2) { + is13simular = phy_simularity_compare_8188e(dm, result, 0, 2); + if (is13simular) { + final_candidate = 0; + RF_DBG(dm, DBG_RF_IQK, "IQK: is13simular final_candidate is %x\n", final_candidate); + break; + } + is23simular = phy_simularity_compare_8188e(dm, result, 1, 2); + if (is23simular) { + final_candidate = 1; + RF_DBG(dm, DBG_RF_IQK, "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; + } + } + } + /* RT_TRACE(COMP_INIT,DBG_LOUD,("Release Mutex in IQCalibrate\n")); */ + 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]; + RF_DBG(dm, DBG_RF_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) { + dm->rf_calibrate_info.rege94 = rege94 = result[final_candidate][0]; + dm->rf_calibrate_info.rege9c = rege9c = result[final_candidate][1]; + regea4 = result[final_candidate][2]; + regeac = result[final_candidate][3]; + dm->rf_calibrate_info.regeb4 = regeb4 = result[final_candidate][4]; + dm->rf_calibrate_info.regebc = regebc = result[final_candidate][5]; + regec4 = result[final_candidate][6]; + regecc = result[final_candidate][7]; + RF_DBG(dm, DBG_RF_IQK, "IQK: final_candidate is %x\n", final_candidate); + RF_DBG(dm, DBG_RF_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); + is_patha_ok = is_pathb_ok = true; + } else { + RF_DBG(dm, DBG_RF_IQK, "IQK: FAIL use default value\n"); + + dm->rf_calibrate_info.rege94 = dm->rf_calibrate_info.regeb4 = 0x100; /* X default value */ + dm->rf_calibrate_info.rege9c = dm->rf_calibrate_info.regebc = 0x0; /* Y default value */ + /*priv->pshare->IQK_fail_cnt++;*/ + } + + if ((rege94 != 0)/*&&(regea4 != 0)*/) + _phy_path_a_fill_iqk_matrix(dm, is_patha_ok, result, final_candidate, (regea4 == 0)); + + indexforchannel = 0; + + /* To Fix BSOD when final_candidate is 0xff + * by sherry 20120321 */ + if (final_candidate < 4) { + for (i = 0; i < iqk_matrix_reg_num; i++) + dm->rf_calibrate_info.iqk_matrix_reg_setting[indexforchannel].value[0][i] = result[final_candidate][i]; + dm->rf_calibrate_info.iqk_matrix_reg_setting[indexforchannel].is_iqk_done = true; + } + /* RTPRINT(FINIT, INIT_IQK, ("\nIQK OK indexforchannel %d.\n", indexforchannel)); */ + RF_DBG(dm, DBG_RF_IQK, "\nIQK OK indexforchannel %d.\n", indexforchannel); + _phy_save_adda_registers(dm, IQK_BB_REG_92C, dm->rf_calibrate_info.IQK_BB_backup_recover, IQK_BB_REG_NUM); + + RF_DBG(dm, DBG_RF_IQK, "IQK finished\n"); +#if 0 /* Suggested by Edlu,120413 */ + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + adapter->hal_func.sw_chnl_by_timer_handler(adapter, origin_channel); +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + adapter->hal_func.set_channel_handler(adapter, origin_channel); +#endif +#endif +} + + +void +phy_lc_calibrate_8188e( + struct dm_struct *dm +) +{ + _phy_lc_calibrate_8188e(dm, false); +} + + +void _phy_set_rf_path_switch_8188e( + struct dm_struct *dm, + boolean is_main, + boolean is2T +) +{ + if (is2T) { /* 92C */ + if (is_main) + odm_set_bb_reg(dm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(5) | BIT(6), 0x1); /* 92C_Path_A */ + else + odm_set_bb_reg(dm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(5) | BIT(6), 0x2); /* BT */ + } else { /* 88C */ + + /* <20120504, Kordan> [8188E] We should make AntDiversity controlled by HW (0x870[9:8] = 0), */ + /* otherwise the following action has no effect. (0x860[9:8] has the effect only if AntDiversity controlled by SW) */ + odm_set_bb_reg(dm, REG_FPGA0_XAB_RF_INTERFACE_SW, BIT(8) | BIT(9), 0x0); + odm_set_bb_reg(dm, R_0x914, MASKLWORD, 0x0201); /* Set up the ant mapping table */ + + if (is_main) { + /* odm_set_bb_reg(dm, REG_FPGA0_XA_RF_INTERFACE_OE, BIT(8)|BIT9, 0x2); */ /* Tx Main (SW control)(The right antenna) */ + /* 4 [ Tx ] */ + odm_set_bb_reg(dm, REG_FPGA0_XA_RF_INTERFACE_OE, BIT(14) | BIT(13) | BIT(12), 0x1); /* Tx Main (HW control)(The right antenna) */ + + /* 4 [ Rx ] */ + odm_set_bb_reg(dm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(5) | BIT(4) | BIT(3), 0x1); /* ant_div_type = TRDiv, right antenna */ + if (dm->ant_div_type == CGCS_RX_HW_ANTDIV) + odm_set_bb_reg(dm, R_0xb2c, BIT(31), 0x1); /* RxCG, Default is RxCG. ant_div_type = 2RDiv, left antenna */ + + } else { + /* odm_set_bb_reg(dm, REG_FPGA0_XA_RF_INTERFACE_OE, BIT(8)|BIT9, 0x1); */ /* Tx Aux (SW control)(The left antenna) */ + /* 4 [ Tx ] */ + odm_set_bb_reg(dm, REG_FPGA0_XA_RF_INTERFACE_OE, BIT(14) | BIT(13) | BIT(12), 0x0); /* Tx Aux (HW control)(The left antenna) */ + + /* 4 [ Rx ] */ + odm_set_bb_reg(dm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(5) | BIT(4) | BIT(3), 0x0); /* ant_div_type = TRDiv, left antenna */ + if (dm->ant_div_type == CGCS_RX_HW_ANTDIV) + odm_set_bb_reg(dm, R_0xb2c, BIT(31), 0x0); /* RxCS, ant_div_type = 2RDiv, right antenna */ + } + + } +} +void phy_set_rf_path_switch_8188e( + struct dm_struct *dm, + boolean is_main +) +{ +#ifdef DISABLE_BB_RF + return; +#endif + + { + /* For 88C 1T1R */ + _phy_set_rf_path_switch_8188e(dm, is_main, false); + } +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halphyrf_8188e_ap.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/rtl8188e/halrf_8188e_ap.h similarity index 51% rename from drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halphyrf_8188e_ap.h rename to drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/rtl8188e/halrf_8188e_ap.h index dbcbfb796f22..49850ba13093 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halphyrf_8188e_ap.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/rtl8188e/halrf_8188e_ap.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,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 __HAL_PHY_RF_8188E_H__ -#define __HAL_PHY_RF_8188E_H__ +#ifndef __HALRF_8188E_H__ +#define __HALRF_8188E_H__ /*--------------------------Define Parameters-------------------------------*/ #define IQK_DELAY_TIME_88E 10 /* ms */ @@ -29,11 +25,11 @@ #include "../halphyrf_ap.h" void configure_txpower_track_8188e( - struct _TXPWRTRACK_CFG *p_config + struct txpwrtrack_cfg *config ); void do_iqk_8188e( - void *p_dm_void, + void *dm_void, u8 delta_thermal_index, u8 thermal_value, u8 threshold @@ -41,7 +37,7 @@ void do_iqk_8188e( void odm_tx_pwr_track_set_pwr88_e( - struct PHY_DM_STRUCT *p_dm_odm, + struct dm_struct *dm, enum pwrtrack_method method, u8 rf_path, u8 channel_mapped_index @@ -51,12 +47,8 @@ odm_tx_pwr_track_set_pwr88_e( void phy_iq_calibrate_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *adapter, -#endif - bool is_recovery); + struct dm_struct *dm, + boolean is_recovery); /* @@ -64,11 +56,7 @@ phy_iq_calibrate_8188e( * */ void phy_lc_calibrate_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm -#else - struct _ADAPTER *p_adapter -#endif + struct dm_struct *dm ); /* @@ -76,23 +64,12 @@ phy_lc_calibrate_8188e( * */ void phy_ap_calibrate_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif + struct dm_struct *dm, s8 delta); -void -phy_digital_predistortion_8188e(struct _ADAPTER *p_adapter); - void _phy_save_adda_registers( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif + struct dm_struct *dm, u32 *adda_reg, u32 *adda_backup, u32 register_num @@ -100,23 +77,15 @@ _phy_save_adda_registers( void _phy_path_adda_on( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif + struct dm_struct *dm, u32 *adda_reg, - bool is_path_a_on, - bool is2T + boolean is_path_a_on, + boolean is2T ); void _phy_mac_setting_calibration( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif + struct dm_struct *dm, u32 *mac_reg, u32 *mac_backup ); @@ -124,12 +93,13 @@ _phy_mac_setting_calibration( void _phy_path_a_stand_by( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm -#else - struct _ADAPTER *p_adapter -#endif + struct dm_struct *dm ); +void +halrf_rf_lna_setting_8188e( + struct dm_struct *dm, + enum halrf_lna_set type +); -#endif /* #ifndef __HAL_PHY_RF_8188E_H__ */ +#endif /*#ifndef __HALRF_8188E_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/rtl8188e/halrf_8188e_ce.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/rtl8188e/halrf_8188e_ce.c new file mode 100644 index 000000000000..022c96c9989c --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/rtl8188e/halrf_8188e_ce.c @@ -0,0 +1,1591 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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 Local Constant---------------------------*/ +/* 2010/04/25 MH Define the max tx power tracking tx agc power. */ +#define ODM_TXPWRTRACK_MAX_IDX_88E 6 + +/*---------------------------Define Local Constant---------------------------*/ + +/* 3============================================================ + * 3 Tx Power Tracking + * 3============================================================ */ + +void halrf_rf_lna_setting_8188e(struct dm_struct *dm, enum halrf_lna_set type) +{ + /*phydm_disable_lna*/ + if (type == HALRF_LNA_DISABLE) { + odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, 0x80000, 0x1); + odm_set_rf_reg(dm, RF_PATH_A, RF_0x30, 0xfffff, 0x18000); /*select Rx mode*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0x31, 0xfffff, 0x0000f); + odm_set_rf_reg(dm, RF_PATH_A, RF_0x32, 0xfffff, 0x37f82); /*disable LNA*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, 0x80000, 0x0); + if (dm->rf_type > RF_1T1R) { + odm_set_rf_reg(dm, RF_PATH_B, RF_0xef, 0x80000, 0x1); + odm_set_rf_reg(dm, RF_PATH_B, RF_0x30, 0xfffff, 0x18000); + odm_set_rf_reg(dm, RF_PATH_B, RF_0x31, 0xfffff, 0x0000f); + odm_set_rf_reg(dm, RF_PATH_B, RF_0x32, 0xfffff, 0x37f82); + odm_set_rf_reg(dm, RF_PATH_B, RF_0xef, 0x80000, 0x0); + } + } else if (type == HALRF_LNA_ENABLE) { + /*phydm_enable_lna*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, 0x80000, 0x1); + odm_set_rf_reg(dm, RF_PATH_A, RF_0x30, 0xfffff, 0x18000); /*select Rx mode*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0x31, 0xfffff, 0x0000f); + odm_set_rf_reg(dm, RF_PATH_A, RF_0x32, 0xfffff, 0x77f82); /*back to normal*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, 0x80000, 0x0); + if (dm->rf_type > RF_1T1R) { + odm_set_rf_reg(dm, RF_PATH_B, RF_0xef, 0x80000, 0x1); + odm_set_rf_reg(dm, RF_PATH_B, RF_0x30, 0xfffff, 0x18000); + odm_set_rf_reg(dm, RF_PATH_B, RF_0x31, 0xfffff, 0x0000f); + odm_set_rf_reg(dm, RF_PATH_B, RF_0x32, 0xfffff, 0x77f82); + odm_set_rf_reg(dm, RF_PATH_B, RF_0xef, 0x80000, 0x0); + } + } +} + +void set_iqk_matrix_8188e(struct dm_struct *dm, u8 OFDM_index, u8 rf_path, + s32 iqk_result_x, s32 iqk_result_y) +{ + s32 ele_A = 0, ele_D, ele_C = 0, value32; + + ele_D = (ofdm_swing_table_new[OFDM_index] & 0xFFC00000) >> 22; + + /* new element A = element D x X */ + if (iqk_result_x != 0 && (*dm->band_type == ODM_BAND_2_4G)) { + if ((iqk_result_x & 0x00000200) != 0) /* consider minus */ + iqk_result_x = iqk_result_x | 0xFFFFFC00; + ele_A = ((iqk_result_x * ele_D) >> 8) & 0x000003FF; + + /* new element C = element D x Y */ + if ((iqk_result_y & 0x00000200) != 0) + iqk_result_y = iqk_result_y | 0xFFFFFC00; + ele_C = ((iqk_result_y * ele_D) >> 8) & 0x000003FF; + + /* if (rf_path == RF_PATH_A) */ + switch (rf_path) { + case RF_PATH_A: + /* 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; + odm_set_bb_reg(dm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKDWORD, value32); + + value32 = (ele_C & 0x000003C0) >> 6; + odm_set_bb_reg(dm, REG_OFDM_0_XC_TX_AFE, MASKH4BITS, value32); + + value32 = ((iqk_result_x * ele_D) >> 7) & 0x01; + odm_set_bb_reg(dm, REG_OFDM_0_ECCA_THRESHOLD, BIT(24), value32); + break; + case RF_PATH_B: + /* 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; + odm_set_bb_reg(dm, REG_OFDM_0_XB_TX_IQ_IMBALANCE, MASKDWORD, value32); + + value32 = (ele_C & 0x000003C0) >> 6; + odm_set_bb_reg(dm, REG_OFDM_0_XD_TX_AFE, MASKH4BITS, value32); + + value32 = ((iqk_result_x * ele_D) >> 7) & 0x01; + odm_set_bb_reg(dm, REG_OFDM_0_ECCA_THRESHOLD, BIT(28), value32); + + break; + default: + break; + } + } else { + switch (rf_path) { + case RF_PATH_A: + odm_set_bb_reg(dm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKDWORD, ofdm_swing_table_new[OFDM_index]); + odm_set_bb_reg(dm, REG_OFDM_0_XC_TX_AFE, MASKH4BITS, 0x00); + odm_set_bb_reg(dm, REG_OFDM_0_ECCA_THRESHOLD, BIT(24), 0x00); + break; + + case RF_PATH_B: + odm_set_bb_reg(dm, REG_OFDM_0_XB_TX_IQ_IMBALANCE, MASKDWORD, ofdm_swing_table_new[OFDM_index]); + odm_set_bb_reg(dm, REG_OFDM_0_XD_TX_AFE, MASKH4BITS, 0x00); + odm_set_bb_reg(dm, REG_OFDM_0_ECCA_THRESHOLD, BIT(28), 0x00); + break; + + default: + break; + } + } + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "TxPwrTracking path B: X = 0x%x, Y = 0x%x ele_A = 0x%x ele_C = 0x%x ele_D = 0x%x 0xeb4 = 0x%x 0xebc = 0x%x\n", + (u32)iqk_result_x, (u32)iqk_result_y, (u32)ele_A, (u32)ele_C, + (u32)ele_D, (u32)iqk_result_x, (u32)iqk_result_y); +} + +void do_iqk_8188e(void *dm_void, u8 delta_thermal_index, u8 thermal_value, + u8 threshold) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + odm_reset_iqk_result(dm); + dm->rf_calibrate_info.thermal_value_iqk = thermal_value; + halrf_iqk_trigger(dm, false); +} + +/*----------------------------------------------------------------------------- + * Function: odm_TxPwrTrackSetPwr88E() + * + * Overview: 88E 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_pwr88_e(void *dm_void, enum pwrtrack_method method, + u8 rf_path, u8 channel_mapped_index) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _ADAPTER *adapter = dm->adapter; + PHAL_DATA_TYPE hal_data = GET_HAL_DATA(adapter); + u8 pwr_tracking_limit_ofdm = 30; /* +0dB */ + u8 pwr_tracking_limit_cck = 28; /* -2dB */ + u8 tx_rate = 0xFF; + u8 final_ofdm_swing_index = 0; + u8 final_cck_swing_index = 0; + u8 i = 0; + struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); + struct _hal_rf_ *rf = &(dm->rf_table); + + if (*dm->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->mpt_ctx); + + tx_rate = mpt_to_mgnt_rate(p_mpt_ctx->mpt_rate_index); +#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 = *(dm->forced_data_rate); + + if (!rate) { /*auto rate*/ +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + tx_rate = adapter->HalFunc.GetHwRateFromMRateHandler(dm->tx_rate); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + if (dm->number_linked_client != 0) + tx_rate = hw_rate_to_m_rate(dm->tx_rate); + else + tx_rate = rf->p_rate_index; +#endif + } else /*force rate*/ + tx_rate = (u8)rate; + } + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "Power Tracking tx_rate=0x%X\n", + tx_rate); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "===>ODM_TxPwrTrackSetPwr8188E\n"); + + if (tx_rate != 0xFF) { + /* 2 CCK */ + if ((tx_rate >= MGN_1M && tx_rate <= MGN_5_5M) || tx_rate == MGN_11M) + pwr_tracking_limit_cck = 28; /* -2dB */ + /* 2 OFDM */ + else if ((tx_rate >= MGN_6M) && (tx_rate <= MGN_48M)) + pwr_tracking_limit_ofdm = 36; /* +3dB */ + else if (tx_rate == MGN_54M) + pwr_tracking_limit_ofdm = 34; /* +2dB */ + + /* 2 HT */ + else if ((tx_rate >= MGN_MCS0) && (tx_rate <= MGN_MCS2)) /* QPSK/BPSK */ + pwr_tracking_limit_ofdm = 38; /* +4dB */ + else if ((tx_rate >= MGN_MCS3) && (tx_rate <= MGN_MCS4)) /* 16QAM */ + pwr_tracking_limit_ofdm = 36; /* +3dB */ + else if ((tx_rate >= MGN_MCS5) && (tx_rate <= MGN_MCS7)) /* 64QAM */ + pwr_tracking_limit_ofdm = 34; /* +2dB */ + + else + pwr_tracking_limit_ofdm = cali_info->default_ofdm_index; /*Default OFDM index = 30*/ + } + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "tx_rate=0x%x, pwr_tracking_limit=%d\n", + tx_rate, pwr_tracking_limit_ofdm); + + if (method == TXAGC) { + u32 pwr = 0, tx_agc = 0; + void *adapter = dm->adapter; + + cali_info->remnant_ofdm_swing_idx[rf_path] = cali_info->absolute_ofdm_swing_idx[rf_path]; /*Remnant index equal to aboslute compensate value.*/ + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "odm_TxPwrTrackSetPwr88E CH=%d\n", *(dm->channel)); + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + + if (*dm->mp_mode == true) { + pwr = phy_query_bb_reg(adapter, REG_TX_AGC_A_RATE18_06, 0xFF); + pwr += dm->rf_calibrate_info.power_index_offset[RF_PATH_A]; + phy_set_bb_reg(adapter, REG_TX_AGC_A_CCK_1_MCS32, MASKBYTE1, pwr); + tx_agc = (pwr << 16) | (pwr << 8) | (pwr); + phy_set_bb_reg(adapter, REG_TX_AGC_B_CCK_11_A_CCK_2_11, MASKH3BYTES, tx_agc); + /* RT_DISP(FPHY, PHY_TXPWR, ("odm_tx_pwr_track_set_pwr88_e: CCK Tx-rf(A) Power = 0x%x\n", tx_agc)); */ + + pwr = phy_query_bb_reg(adapter, REG_TX_AGC_A_RATE18_06, 0xFF); + pwr += (cali_info->bb_swing_idx_ofdm[RF_PATH_A] - cali_info->bb_swing_idx_ofdm_base[RF_PATH_A]); + tx_agc |= ((pwr << 24) | (pwr << 16) | (pwr << 8) | pwr); + phy_set_bb_reg(adapter, REG_TX_AGC_A_RATE18_06, MASKDWORD, tx_agc); + phy_set_bb_reg(adapter, REG_TX_AGC_A_RATE54_24, MASKDWORD, tx_agc); + phy_set_bb_reg(adapter, REG_TX_AGC_A_MCS03_MCS00, MASKDWORD, tx_agc); + phy_set_bb_reg(adapter, REG_TX_AGC_A_MCS07_MCS04, MASKDWORD, tx_agc); + phy_set_bb_reg(adapter, REG_TX_AGC_A_MCS11_MCS08, MASKDWORD, tx_agc); + phy_set_bb_reg(adapter, REG_TX_AGC_A_MCS15_MCS12, MASKDWORD, tx_agc); + /* RT_DISP(FPHY, PHY_TXPWR, ("odm_tx_pwr_track_set_pwr88_e: OFDM Tx-rf(A) Power = 0x%x\n", tx_agc)); */ + } else { + /* phy_set_tx_power_level8188e(dm->adapter, *dm->channel); */ + cali_info->modify_tx_agc_flag_path_a = true; + cali_info->modify_tx_agc_flag_path_a_cck = true; + + if (rf_path == RF_PATH_A) { + phy_set_tx_power_index_by_rate_section(adapter, RF_PATH_A, *dm->channel, CCK); + phy_set_tx_power_index_by_rate_section(adapter, RF_PATH_A, *dm->channel, OFDM); + phy_set_tx_power_index_by_rate_section(adapter, RF_PATH_A, *dm->channel, HT_MCS0_MCS7); + } + } + +#endif +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) +/* phy_rf6052_set_cck_tx_power(dm->priv, *(dm->channel)); */ +/* phy_rf6052_set_ofdm_tx_power(dm->priv, *(dm->channel)); */ +#endif + + } else if (method == BBSWING) { + final_ofdm_swing_index = cali_info->default_ofdm_index + cali_info->absolute_ofdm_swing_idx[rf_path]; + final_cck_swing_index = cali_info->default_cck_index + cali_info->absolute_ofdm_swing_idx[rf_path]; + + 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) + final_cck_swing_index = CCK_TABLE_SIZE - 1; + else if (cali_info->bb_swing_idx_cck <= 0) + final_cck_swing_index = 0; + + /* Adjust BB swing by OFDM IQ matrix */ + if (rf_path == RF_PATH_A) { + set_iqk_matrix_8188e(dm, final_ofdm_swing_index, RF_PATH_A, + dm->rf_calibrate_info.iqk_matrix_reg_setting[channel_mapped_index].value[0][0], + dm->rf_calibrate_info.iqk_matrix_reg_setting[channel_mapped_index].value[0][1]); + /* Adjust BB swing by CCK filter coefficient */ + if (*dm->channel != 14) { + odm_write_1byte(dm, 0xa22, cck_swing_table_ch1_ch13_new[final_cck_swing_index][0]); + odm_write_1byte(dm, 0xa23, cck_swing_table_ch1_ch13_new[final_cck_swing_index][1]); + odm_write_1byte(dm, 0xa24, cck_swing_table_ch1_ch13_new[final_cck_swing_index][2]); + odm_write_1byte(dm, 0xa25, cck_swing_table_ch1_ch13_new[final_cck_swing_index][3]); + odm_write_1byte(dm, 0xa26, cck_swing_table_ch1_ch13_new[final_cck_swing_index][4]); + odm_write_1byte(dm, 0xa27, cck_swing_table_ch1_ch13_new[final_cck_swing_index][5]); + odm_write_1byte(dm, 0xa28, cck_swing_table_ch1_ch13_new[final_cck_swing_index][6]); + odm_write_1byte(dm, 0xa29, cck_swing_table_ch1_ch13_new[final_cck_swing_index][7]); + } else { + odm_write_1byte(dm, 0xa22, cck_swing_table_ch14_new[final_cck_swing_index][0]); + odm_write_1byte(dm, 0xa23, cck_swing_table_ch14_new[final_cck_swing_index][1]); + odm_write_1byte(dm, 0xa24, cck_swing_table_ch14_new[final_cck_swing_index][2]); + odm_write_1byte(dm, 0xa25, cck_swing_table_ch14_new[final_cck_swing_index][3]); + odm_write_1byte(dm, 0xa26, cck_swing_table_ch14_new[final_cck_swing_index][4]); + odm_write_1byte(dm, 0xa27, cck_swing_table_ch14_new[final_cck_swing_index][5]); + odm_write_1byte(dm, 0xa28, cck_swing_table_ch14_new[final_cck_swing_index][6]); + odm_write_1byte(dm, 0xa29, cck_swing_table_ch14_new[final_cck_swing_index][7]); + } + } + } else if (method == MIX_MODE) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "cali_info->default_ofdm_index=%d, dm->DefaultCCKIndex=%d, cali_info->absolute_ofdm_swing_idx[rf_path]=%d, rf_path = %d\n", + cali_info->default_ofdm_index, + cali_info->default_cck_index, + cali_info->absolute_ofdm_swing_idx[rf_path], rf_path); + + final_cck_swing_index = cali_info->default_cck_index + cali_info->absolute_ofdm_swing_idx[rf_path]; + final_ofdm_swing_index = cali_info->default_ofdm_index + cali_info->absolute_ofdm_swing_idx[rf_path]; + + if (final_ofdm_swing_index > pwr_tracking_limit_ofdm) { /* BBSwing higher then Limit */ + cali_info->remnant_ofdm_swing_idx[rf_path] = final_ofdm_swing_index - pwr_tracking_limit_ofdm; + + set_iqk_matrix_8188e(dm, pwr_tracking_limit_ofdm, RF_PATH_A, + dm->rf_calibrate_info.iqk_matrix_reg_setting[channel_mapped_index].value[0][0], + dm->rf_calibrate_info.iqk_matrix_reg_setting[channel_mapped_index].value[0][1]); + + cali_info->modify_tx_agc_flag_path_a = true; + + phy_set_tx_power_index_by_rate_section(adapter, RF_PATH_A, *dm->channel, OFDM); + phy_set_tx_power_index_by_rate_section(adapter, RF_PATH_A, *dm->channel, HT_MCS0_MCS7); + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "******Path_A Over BBSwing Limit, pwr_tracking_limit = %d, Remnant tx_agc value = %d\n", + pwr_tracking_limit_ofdm, + cali_info->remnant_ofdm_swing_idx[rf_path]); + } else if (final_ofdm_swing_index <= 0) { + cali_info->remnant_ofdm_swing_idx[rf_path] = final_ofdm_swing_index; + + set_iqk_matrix_8188e(dm, 0, RF_PATH_A, + dm->rf_calibrate_info.iqk_matrix_reg_setting[channel_mapped_index].value[0][0], + dm->rf_calibrate_info.iqk_matrix_reg_setting[channel_mapped_index].value[0][1]); + + cali_info->modify_tx_agc_flag_path_a = true; + + phy_set_tx_power_index_by_rate_section(adapter, RF_PATH_A, *dm->channel, OFDM); + phy_set_tx_power_index_by_rate_section(adapter, RF_PATH_A, *dm->channel, HT_MCS0_MCS7); + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "******Path_A Lower then BBSwing lower bound 0, Remnant tx_agc value = %d\n", + cali_info->remnant_ofdm_swing_idx[rf_path]); + } else { + set_iqk_matrix_8188e(dm, final_ofdm_swing_index, RF_PATH_A, + dm->rf_calibrate_info.iqk_matrix_reg_setting[channel_mapped_index].value[0][0], + dm->rf_calibrate_info.iqk_matrix_reg_setting[channel_mapped_index].value[0][1]); + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "******Path_A Compensate with BBSwing, final_ofdm_swing_index = %d\n", + final_ofdm_swing_index); + + if (cali_info->modify_tx_agc_flag_path_a) { /*If tx_agc has changed, reset tx_agc again*/ + cali_info->remnant_ofdm_swing_idx[rf_path] = 0; + + phy_set_tx_power_index_by_rate_section(adapter, RF_PATH_A, *dm->channel, OFDM); + phy_set_tx_power_index_by_rate_section(adapter, RF_PATH_A, *dm->channel, HT_MCS0_MCS7); + + cali_info->modify_tx_agc_flag_path_a = false; + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "******Path_A dm->Modify_TxAGC_Flag = false\n"); + } + } + + if (final_cck_swing_index > pwr_tracking_limit_cck) { + cali_info->remnant_cck_swing_idx = final_cck_swing_index - pwr_tracking_limit_cck; + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "******Path_A CCK Over Limit, pwr_tracking_limit_cck = %d, cali_info->remnant_cck_swing_idx = %d\n", + pwr_tracking_limit_cck, + cali_info->remnant_cck_swing_idx); + + /* Adjust BB swing by CCK filter coefficient */ + + if (*dm->channel != 14) { + odm_write_1byte(dm, 0xa22, cck_swing_table_ch1_ch13_new[pwr_tracking_limit_cck][0]); + odm_write_1byte(dm, 0xa23, cck_swing_table_ch1_ch13_new[pwr_tracking_limit_cck][1]); + odm_write_1byte(dm, 0xa24, cck_swing_table_ch1_ch13_new[pwr_tracking_limit_cck][2]); + odm_write_1byte(dm, 0xa25, cck_swing_table_ch1_ch13_new[pwr_tracking_limit_cck][3]); + odm_write_1byte(dm, 0xa26, cck_swing_table_ch1_ch13_new[pwr_tracking_limit_cck][4]); + odm_write_1byte(dm, 0xa27, cck_swing_table_ch1_ch13_new[pwr_tracking_limit_cck][5]); + odm_write_1byte(dm, 0xa28, cck_swing_table_ch1_ch13_new[pwr_tracking_limit_cck][6]); + odm_write_1byte(dm, 0xa29, cck_swing_table_ch1_ch13_new[pwr_tracking_limit_cck][7]); + } else { + odm_write_1byte(dm, 0xa22, cck_swing_table_ch14_new[pwr_tracking_limit_cck][0]); + odm_write_1byte(dm, 0xa23, cck_swing_table_ch14_new[pwr_tracking_limit_cck][1]); + odm_write_1byte(dm, 0xa24, cck_swing_table_ch14_new[pwr_tracking_limit_cck][2]); + odm_write_1byte(dm, 0xa25, cck_swing_table_ch14_new[pwr_tracking_limit_cck][3]); + odm_write_1byte(dm, 0xa26, cck_swing_table_ch14_new[pwr_tracking_limit_cck][4]); + odm_write_1byte(dm, 0xa27, cck_swing_table_ch14_new[pwr_tracking_limit_cck][5]); + odm_write_1byte(dm, 0xa28, cck_swing_table_ch14_new[pwr_tracking_limit_cck][6]); + odm_write_1byte(dm, 0xa29, cck_swing_table_ch14_new[pwr_tracking_limit_cck][7]); + } + + cali_info->modify_tx_agc_flag_path_a_cck = true; + + phy_set_tx_power_index_by_rate_section(adapter, RF_PATH_A, *dm->channel, CCK); + + } else if (final_cck_swing_index <= 0) { /* Lowest CCK index = 0 */ + cali_info->remnant_cck_swing_idx = final_cck_swing_index; + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "******Path_A CCK Under Limit, pwr_tracking_limit_cck = %d, cali_info->remnant_cck_swing_idx = %d\n", + 0, cali_info->remnant_cck_swing_idx); + + if (*dm->channel != 14) { + odm_write_1byte(dm, 0xa22, cck_swing_table_ch1_ch13_new[0][0]); + odm_write_1byte(dm, 0xa23, cck_swing_table_ch1_ch13_new[0][1]); + odm_write_1byte(dm, 0xa24, cck_swing_table_ch1_ch13_new[0][2]); + odm_write_1byte(dm, 0xa25, cck_swing_table_ch1_ch13_new[0][3]); + odm_write_1byte(dm, 0xa26, cck_swing_table_ch1_ch13_new[0][4]); + odm_write_1byte(dm, 0xa27, cck_swing_table_ch1_ch13_new[0][5]); + odm_write_1byte(dm, 0xa28, cck_swing_table_ch1_ch13_new[0][6]); + odm_write_1byte(dm, 0xa29, cck_swing_table_ch1_ch13_new[0][7]); + } else { + odm_write_1byte(dm, 0xa22, cck_swing_table_ch14_new[0][0]); + odm_write_1byte(dm, 0xa23, cck_swing_table_ch14_new[0][1]); + odm_write_1byte(dm, 0xa24, cck_swing_table_ch14_new[0][2]); + odm_write_1byte(dm, 0xa25, cck_swing_table_ch14_new[0][3]); + odm_write_1byte(dm, 0xa26, cck_swing_table_ch14_new[0][4]); + odm_write_1byte(dm, 0xa27, cck_swing_table_ch14_new[0][5]); + odm_write_1byte(dm, 0xa28, cck_swing_table_ch14_new[0][6]); + odm_write_1byte(dm, 0xa29, cck_swing_table_ch14_new[0][7]); + } + + cali_info->modify_tx_agc_flag_path_a_cck = true; + + phy_set_tx_power_index_by_rate_section(adapter, RF_PATH_A, *dm->channel, CCK); + + } else { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "******Path_A CCK Compensate with BBSwing, final_cck_swing_index = %d\n", + final_cck_swing_index); + + if (*dm->channel != 14) { + odm_write_1byte(dm, 0xa22, cck_swing_table_ch1_ch13_new[final_cck_swing_index][0]); + odm_write_1byte(dm, 0xa23, cck_swing_table_ch1_ch13_new[final_cck_swing_index][1]); + odm_write_1byte(dm, 0xa24, cck_swing_table_ch1_ch13_new[final_cck_swing_index][2]); + odm_write_1byte(dm, 0xa25, cck_swing_table_ch1_ch13_new[final_cck_swing_index][3]); + odm_write_1byte(dm, 0xa26, cck_swing_table_ch1_ch13_new[final_cck_swing_index][4]); + odm_write_1byte(dm, 0xa27, cck_swing_table_ch1_ch13_new[final_cck_swing_index][5]); + odm_write_1byte(dm, 0xa28, cck_swing_table_ch1_ch13_new[final_cck_swing_index][6]); + odm_write_1byte(dm, 0xa29, cck_swing_table_ch1_ch13_new[final_cck_swing_index][7]); + } else { + odm_write_1byte(dm, 0xa22, cck_swing_table_ch14_new[final_cck_swing_index][0]); + odm_write_1byte(dm, 0xa23, cck_swing_table_ch14_new[final_cck_swing_index][1]); + odm_write_1byte(dm, 0xa24, cck_swing_table_ch14_new[final_cck_swing_index][2]); + odm_write_1byte(dm, 0xa25, cck_swing_table_ch14_new[final_cck_swing_index][3]); + odm_write_1byte(dm, 0xa26, cck_swing_table_ch14_new[final_cck_swing_index][4]); + odm_write_1byte(dm, 0xa27, cck_swing_table_ch14_new[final_cck_swing_index][5]); + odm_write_1byte(dm, 0xa28, cck_swing_table_ch14_new[final_cck_swing_index][6]); + odm_write_1byte(dm, 0xa29, cck_swing_table_ch14_new[final_cck_swing_index][7]); + } + + if (cali_info->modify_tx_agc_flag_path_a_cck) { /*If tx_agc has changed, reset tx_agc again*/ + cali_info->remnant_cck_swing_idx = 0; + phy_set_tx_power_index_by_rate_section(adapter, RF_PATH_A, *dm->channel, CCK); + cali_info->modify_tx_agc_flag_path_a_cck = false; + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, + "******Path_A dm->Modify_TxAGC_Flag_CCK = false\n"); + } + } + } else + return; +} /* odm_TxPwrTrackSetPwr88E */ + +void get_delta_swing_table_8188e(void *dm_void, u8 **temperature_up_a, + u8 **temperature_down_a, u8 **temperature_up_b, + u8 **temperature_down_b) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _ADAPTER *adapter = dm->adapter; + PHAL_DATA_TYPE hal_data = GET_HAL_DATA(adapter); + struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); + struct _hal_rf_ *rf = &(dm->rf_table); + + u8 tx_rate = 0xFF; + u8 channel = *dm->channel; + + if (*dm->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->mpt_ctx); + + tx_rate = mpt_to_mgnt_rate(p_mpt_ctx->mpt_rate_index); +#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 = *(dm->forced_data_rate); + + if (!rate) { /*auto rate*/ +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + tx_rate = adapter->HalFunc.GetHwRateFromMRateHandler(dm->tx_rate); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + if (dm->number_linked_client != 0) + tx_rate = hw_rate_to_m_rate(dm->tx_rate); + else + tx_rate = rf->p_rate_index; +#endif + } else /*force rate*/ + tx_rate = (u8)rate; + } + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "Power Tracking tx_rate=0x%X\n", + tx_rate); + + if (1 <= channel && channel <= 14) { + if (IS_CCK_RATE(tx_rate)) { + *temperature_up_a = cali_info->delta_swing_table_idx_2g_cck_a_p; + *temperature_down_a = cali_info->delta_swing_table_idx_2g_cck_a_n; + } else { + *temperature_up_a = cali_info->delta_swing_table_idx_2ga_p; + *temperature_down_a = cali_info->delta_swing_table_idx_2ga_n; + } + } else { + *temperature_up_a = (u8 *)delta_swing_table_idx_2ga_p_8188e; + *temperature_down_a = (u8 *)delta_swing_table_idx_2ga_n_8188e; + } +} + +void configure_txpower_track_8188e(struct txpwrtrack_cfg *config) +{ + config->swing_table_size_cck = CCK_TABLE_SIZE; + config->swing_table_size_ofdm = OFDM_TABLE_SIZE; + config->threshold_iqk = IQK_THRESHOLD; + config->average_thermal_num = AVG_THERMAL_NUM_88E; + config->rf_path_count = MAX_PATH_NUM_8188E; + config->thermal_reg_addr = RF_T_METER_88E; + + config->odm_tx_pwr_track_set_pwr = odm_tx_pwr_track_set_pwr88_e; + config->do_iqk = do_iqk_8188e; + config->phy_lc_calibrate = halrf_lck_trigger; + config->get_delta_swing_table = get_delta_swing_table_8188e; +} + +/* 1 7. IQK */ +#define MAX_TOLERANCE 5 +#define IQK_DELAY_TIME 1 /* ms */ + +u8 /* bit0 = 1 => Tx OK, bit1 = 1 => Rx OK */ + phy_path_a_iqk_8188e( + struct dm_struct *dm, + boolean config_path_b) +{ + u32 reg_eac, reg_e94, reg_e9c, reg_ea4; + u8 result = 0x00; + RF_DBG(dm, DBG_RF_IQK, "path A IQK!\n"); + + /* 1 Tx IQK */ + /* path-A IQK setting */ + RF_DBG(dm, DBG_RF_IQK, "path-A IQK setting!\n"); + odm_set_bb_reg(dm, REG_TX_IQK_TONE_A, MASKDWORD, 0x10008c1c); + odm_set_bb_reg(dm, REG_RX_IQK_TONE_A, MASKDWORD, 0x30008c1c); + odm_set_bb_reg(dm, REG_TX_IQK_PI_A, MASKDWORD, 0x8214032a); + odm_set_bb_reg(dm, REG_RX_IQK_PI_A, MASKDWORD, 0x28160000); + + /* LO calibration setting */ + RF_DBG(dm, DBG_RF_IQK, "LO calibration setting!\n"); + odm_set_bb_reg(dm, REG_IQK_AGC_RSP, MASKDWORD, 0x00462911); + + /* One shot, path A LOK & IQK */ + RF_DBG(dm, DBG_RF_IQK, "One shot, path A LOK & IQK!\n"); + odm_set_bb_reg(dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf9000000); + odm_set_bb_reg(dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf8000000); + + /* delay x ms */ + RF_DBG(dm, DBG_RF_IQK, "delay %d ms for One shot, path A LOK & IQK.\n", + IQK_DELAY_TIME_88E); + /* platform_stall_execution(IQK_DELAY_TIME_88E*1000); */ + ODM_delay_ms(IQK_DELAY_TIME_88E); + + /* Check failed */ + reg_eac = odm_get_bb_reg(dm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xeac = 0x%x\n", reg_eac); + reg_e94 = odm_get_bb_reg(dm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xe94 = 0x%x\n", reg_e94); + reg_e9c = odm_get_bb_reg(dm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xe9c = 0x%x\n", reg_e9c); + reg_ea4 = odm_get_bb_reg(dm, REG_RX_POWER_BEFORE_IQK_A_2, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xea4 = 0x%x\n", reg_ea4); + + if (!(reg_eac & BIT(28)) && + (((reg_e94 & 0x03FF0000) >> 16) != 0x142) && + (((reg_e9c & 0x03FF0000) >> 16) != 0x42)) + result |= 0x01; + else /* if Tx not OK, ignore Rx */ + return result; + +#if 0 + if (!(reg_eac & BIT(27)) && /* if Tx is OK, check whether Rx is OK */ + (((reg_ea4 & 0x03FF0000) >> 16) != 0x132) && + (((reg_eac & 0x03FF0000) >> 16) != 0x36)) + result |= 0x02; + else + RT_DISP(FINIT, INIT_IQK, ("path A Rx IQK fail!!\n")); +#endif + + return result; +} + +u8 /* bit0 = 1 => Tx OK, bit1 = 1 => Rx OK */ + phy_path_a_rx_iqk( + struct dm_struct *dm, + boolean config_path_b) +{ + u32 reg_eac, reg_e94, reg_e9c, reg_ea4, u4tmp; + u8 result = 0x00; + + RF_DBG(dm, DBG_RF_IQK, "path A Rx IQK!\n"); + /* 1 Get TXIMR setting */ + /* modify RXIQK mode table */ + RF_DBG(dm, DBG_RF_IQK, "path-A Rx IQK modify RXIQK mode table!\n"); + odm_set_bb_reg(dm, REG_FPGA0_IQK, MASKH3BYTES, 0x000000); + odm_set_rf_reg(dm, RF_PATH_A, RF_WE_LUT, RFREGOFFSETMASK, 0x800a0); + odm_set_rf_reg(dm, RF_PATH_A, RF_RCK_OS, RFREGOFFSETMASK, 0x30000); + odm_set_rf_reg(dm, RF_PATH_A, RF_TXPA_G1, RFREGOFFSETMASK, 0x0000f); + odm_set_rf_reg(dm, RF_PATH_A, RF_TXPA_G2, RFREGOFFSETMASK, 0xf117B); + odm_set_bb_reg(dm, REG_FPGA0_IQK, MASKH3BYTES, 0x808000); + + /* IQK setting */ + odm_set_bb_reg(dm, REG_TX_IQK, MASKDWORD, 0x01007c00); + odm_set_bb_reg(dm, REG_RX_IQK, MASKDWORD, 0x81004800); + + /* path-A IQK setting */ + odm_set_bb_reg(dm, REG_TX_IQK_TONE_A, MASKDWORD, 0x10008c1c); + odm_set_bb_reg(dm, REG_RX_IQK_TONE_A, MASKDWORD, 0x30008c1c); + odm_set_bb_reg(dm, REG_TX_IQK_PI_A, MASKDWORD, 0x82160804); + odm_set_bb_reg(dm, REG_RX_IQK_PI_A, MASKDWORD, 0x28160000); + + /* LO calibration setting */ + RF_DBG(dm, DBG_RF_IQK, "LO calibration setting!\n"); + odm_set_bb_reg(dm, REG_IQK_AGC_RSP, MASKDWORD, 0x0046a911); + + /* One shot, path A LOK & IQK */ + RF_DBG(dm, DBG_RF_IQK, "One shot, path A LOK & IQK!\n"); + odm_set_bb_reg(dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf9000000); + odm_set_bb_reg(dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf8000000); + + /* delay x ms */ + RF_DBG(dm, DBG_RF_IQK, "delay %d ms for One shot, path A LOK & IQK.\n", + IQK_DELAY_TIME_88E); + /* platform_stall_execution(IQK_DELAY_TIME_88E*1000); */ + ODM_delay_ms(IQK_DELAY_TIME_88E); + + /* Check failed */ + reg_eac = odm_get_bb_reg(dm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xeac = 0x%x\n", reg_eac); + reg_e94 = odm_get_bb_reg(dm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xe94 = 0x%x\n", reg_e94); + reg_e9c = odm_get_bb_reg(dm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xe9c = 0x%x\n", reg_e9c); + + if (!(reg_eac & BIT(28)) && + (((reg_e94 & 0x03FF0000) >> 16) != 0x142) && + (((reg_e9c & 0x03FF0000) >> 16) != 0x42)) + result |= 0x01; + else /* if Tx not OK, ignore Rx */ + return result; + + u4tmp = 0x80007C00 | (reg_e94 & 0x3FF0000) | ((reg_e9c & 0x3FF0000) >> 16); + odm_set_bb_reg(dm, REG_TX_IQK, MASKDWORD, u4tmp); + RF_DBG(dm, DBG_RF_IQK, "0xe40 = 0x%x u4tmp = 0x%x\n", + odm_get_bb_reg(dm, REG_TX_IQK, MASKDWORD), u4tmp); + + /* 1 RX IQK */ + /* modify RXIQK mode table */ + RF_DBG(dm, DBG_RF_IQK, "path-A Rx IQK modify RXIQK mode table 2!\n"); + odm_set_bb_reg(dm, REG_FPGA0_IQK, MASKH3BYTES, 0x000000); + odm_set_rf_reg(dm, RF_PATH_A, RF_WE_LUT, RFREGOFFSETMASK, 0x800a0); + odm_set_rf_reg(dm, RF_PATH_A, RF_RCK_OS, RFREGOFFSETMASK, 0x30000); + odm_set_rf_reg(dm, RF_PATH_A, RF_TXPA_G1, RFREGOFFSETMASK, 0x0000f); + odm_set_rf_reg(dm, RF_PATH_A, RF_TXPA_G2, RFREGOFFSETMASK, 0xf7ffa); + odm_set_bb_reg(dm, REG_FPGA0_IQK, MASKH3BYTES, 0x808000); + + /* IQK setting */ + odm_set_bb_reg(dm, REG_RX_IQK, MASKDWORD, 0x01004800); + + /* path-A IQK setting */ + odm_set_bb_reg(dm, REG_TX_IQK_TONE_A, MASKDWORD, 0x30008c1c); + odm_set_bb_reg(dm, REG_RX_IQK_TONE_A, MASKDWORD, 0x10008c1c); + odm_set_bb_reg(dm, REG_TX_IQK_PI_A, MASKDWORD, 0x82160c05); + odm_set_bb_reg(dm, REG_RX_IQK_PI_A, MASKDWORD, 0x28160c05); + + /* LO calibration setting */ + RF_DBG(dm, DBG_RF_IQK, "LO calibration setting!\n"); + odm_set_bb_reg(dm, REG_IQK_AGC_RSP, MASKDWORD, 0x0046a911); + + /* One shot, path A LOK & IQK */ + RF_DBG(dm, DBG_RF_IQK, "One shot, path A LOK & IQK!\n"); + odm_set_bb_reg(dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf9000000); + odm_set_bb_reg(dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf8000000); + + /* delay x ms */ + RF_DBG(dm, DBG_RF_IQK, "delay %d ms for One shot, path A LOK & IQK.\n", + IQK_DELAY_TIME_88E); + /* platform_stall_execution(IQK_DELAY_TIME_88E*1000); */ + ODM_delay_ms(IQK_DELAY_TIME_88E); + + /* Check failed */ + reg_eac = odm_get_bb_reg(dm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xeac = 0x%x\n", reg_eac); + reg_e94 = odm_get_bb_reg(dm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xe94 = 0x%x\n", reg_e94); + reg_e9c = odm_get_bb_reg(dm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xe9c = 0x%x\n", reg_e9c); + reg_ea4 = odm_get_bb_reg(dm, REG_RX_POWER_BEFORE_IQK_A_2, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xea4 = 0x%x\n", reg_ea4); + +#if 0 + if (!(reg_eac & BIT(28)) && + (((reg_e94 & 0x03FF0000) >> 16) != 0x142) && + (((reg_e9c & 0x03FF0000) >> 16) != 0x42)) + result |= 0x01; + else /* if Tx not OK, ignore Rx */ + return result; +#endif + + if (!(reg_eac & BIT(27)) && /* if Tx is OK, check whether Rx is OK */ + (((reg_ea4 & 0x03FF0000) >> 16) != 0x132) && + (((reg_eac & 0x03FF0000) >> 16) != 0x36)) + result |= 0x02; + else + RF_DBG(dm, DBG_RF_IQK, "path A Rx IQK fail!!\n"); + + return result; +} + +u8 /* bit0 = 1 => Tx OK, bit1 = 1 => Rx OK */ + phy_path_b_iqk_8188e( + struct dm_struct *dm) +{ + u32 reg_eac, reg_eb4, reg_ebc, reg_ec4, reg_ecc; + u8 result = 0x00; + + RF_DBG(dm, DBG_RF_IQK, "path B IQK!\n"); + + /* One shot, path B LOK & IQK */ + RF_DBG(dm, DBG_RF_IQK, "One shot, path A LOK & IQK!\n"); + odm_set_bb_reg(dm, REG_IQK_AGC_CONT, MASKDWORD, 0x00000002); + odm_set_bb_reg(dm, REG_IQK_AGC_CONT, MASKDWORD, 0x00000000); + + /* delay x ms */ + RF_DBG(dm, DBG_RF_IQK, "delay %d ms for One shot, path B LOK & IQK.\n", + IQK_DELAY_TIME_88E); + /* platform_stall_execution(IQK_DELAY_TIME_88E*1000); */ + ODM_delay_ms(IQK_DELAY_TIME_88E); + + /* Check failed */ + reg_eac = odm_get_bb_reg(dm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xeac = 0x%x\n", reg_eac); + reg_eb4 = odm_get_bb_reg(dm, REG_TX_POWER_BEFORE_IQK_B, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xeb4 = 0x%x\n", reg_eb4); + reg_ebc = odm_get_bb_reg(dm, REG_TX_POWER_AFTER_IQK_B, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xebc = 0x%x\n", reg_ebc); + reg_ec4 = odm_get_bb_reg(dm, REG_RX_POWER_BEFORE_IQK_B_2, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xec4 = 0x%x\n", reg_ec4); + reg_ecc = odm_get_bb_reg(dm, REG_RX_POWER_AFTER_IQK_B_2, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xecc = 0x%x\n", reg_ecc); + + if (!(reg_eac & BIT(31)) && + (((reg_eb4 & 0x03FF0000) >> 16) != 0x142) && + (((reg_ebc & 0x03FF0000) >> 16) != 0x42)) + result |= 0x01; + else + return result; + + if (!(reg_eac & BIT(30)) && + (((reg_ec4 & 0x03FF0000) >> 16) != 0x132) && + (((reg_ecc & 0x03FF0000) >> 16) != 0x36)) + result |= 0x02; + else + RF_DBG(dm, DBG_RF_IQK, "path B Rx IQK fail!!\n"); + + return result; +} + +void _phy_path_a_fill_iqk_matrix(struct dm_struct *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; + + RF_DBG(dm, DBG_RF_IQK, "path A 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(dm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKDWORD) >> 22) & 0x3FF; + + X = result[final_candidate][0]; + if ((X & 0x00000200) != 0) + X = X | 0xFFFFFC00; + TX0_A = (X * oldval_0) >> 8; + RF_DBG(dm, DBG_RF_IQK, + "X = 0x%x, TX0_A = 0x%x, oldval_0 0x%x\n", X, TX0_A, + oldval_0); + odm_set_bb_reg(dm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, 0x3FF, TX0_A); + + odm_set_bb_reg(dm, REG_OFDM_0_ECCA_THRESHOLD, BIT(31), ((X * oldval_0 >> 7) & 0x1)); + + Y = result[final_candidate][1]; + if ((Y & 0x00000200) != 0) + Y = Y | 0xFFFFFC00; + + TX0_C = (Y * oldval_0) >> 8; + RF_DBG(dm, DBG_RF_IQK, "Y = 0x%x, TX = 0x%x\n", Y, TX0_C); + odm_set_bb_reg(dm, REG_OFDM_0_XC_TX_AFE, 0xF0000000, ((TX0_C & 0x3C0) >> 6)); + odm_set_bb_reg(dm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, 0x003F0000, (TX0_C & 0x3F)); + + odm_set_bb_reg(dm, REG_OFDM_0_ECCA_THRESHOLD, BIT(29), ((Y * oldval_0 >> 7) & 0x1)); + + if (is_tx_only) { + RF_DBG(dm, DBG_RF_IQK, "%s only Tx OK\n", __func__); + 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(dm, REG_OFDM_0_XA_RX_IQ_IMBALANCE, 0x3FF, reg); + + reg = result[final_candidate][3] & 0x3F; + odm_set_bb_reg(dm, REG_OFDM_0_XA_RX_IQ_IMBALANCE, 0xFC00, reg); + + reg = (result[final_candidate][3] >> 6) & 0xF; + odm_set_bb_reg(dm, REG_OFDM_0_RX_IQ_EXT_ANTA, 0xF0000000, reg); + } +} + +void _phy_path_b_fill_iqk_matrix(struct dm_struct *dm, boolean is_iqk_ok, + s32 result[][8], u8 final_candidate, + boolean is_tx_only /* do Tx only */) +{ + u32 oldval_1, X, TX1_A, reg; + s32 Y, TX1_C; + + RF_DBG(dm, DBG_RF_IQK, "path B 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(dm, REG_OFDM_0_XB_TX_IQ_IMBALANCE, MASKDWORD) >> 22) & 0x3FF; + + X = result[final_candidate][4]; + if ((X & 0x00000200) != 0) + X = X | 0xFFFFFC00; + TX1_A = (X * oldval_1) >> 8; + RF_DBG(dm, DBG_RF_IQK, "X = 0x%x, TX1_A = 0x%x\n", X, TX1_A); + odm_set_bb_reg(dm, REG_OFDM_0_XB_TX_IQ_IMBALANCE, 0x3FF, TX1_A); + + odm_set_bb_reg(dm, REG_OFDM_0_ECCA_THRESHOLD, BIT(27), ((X * oldval_1 >> 7) & 0x1)); + + Y = result[final_candidate][5]; + if ((Y & 0x00000200) != 0) + Y = Y | 0xFFFFFC00; + + TX1_C = (Y * oldval_1) >> 8; + RF_DBG(dm, DBG_RF_IQK, "Y = 0x%x, TX1_C = 0x%x\n", Y, TX1_C); + odm_set_bb_reg(dm, REG_OFDM_0_XD_TX_AFE, 0xF0000000, ((TX1_C & 0x3C0) >> 6)); + odm_set_bb_reg(dm, REG_OFDM_0_XB_TX_IQ_IMBALANCE, 0x003F0000, (TX1_C & 0x3F)); + + odm_set_bb_reg(dm, REG_OFDM_0_ECCA_THRESHOLD, BIT(25), ((Y * oldval_1 >> 7) & 0x1)); + + if (is_tx_only) + return; + + reg = result[final_candidate][6]; + odm_set_bb_reg(dm, REG_OFDM_0_XB_RX_IQ_IMBALANCE, 0x3FF, reg); + + reg = result[final_candidate][7] & 0x3F; + odm_set_bb_reg(dm, REG_OFDM_0_XB_RX_IQ_IMBALANCE, 0xFC00, reg); + + reg = (result[final_candidate][7] >> 6) & 0xF; + odm_set_bb_reg(dm, REG_OFDM_0_AGC_RSSI_TABLE, 0x0000F000, reg); + } +} + +void _phy_save_adda_registers(struct dm_struct *dm, u32 *adda_reg, + u32 *adda_backup, u32 register_num) +{ + u32 i; + + RF_DBG(dm, DBG_RF_IQK, "Save ADDA parameters.\n"); + for (i = 0; i < register_num; i++) + adda_backup[i] = odm_get_bb_reg(dm, adda_reg[i], MASKDWORD); +} + +void _phy_save_mac_registers(struct dm_struct *dm, u32 *mac_reg, + u32 *mac_backup) +{ + u32 i; + + RF_DBG(dm, DBG_RF_IQK, "Save MAC parameters.\n"); + for (i = 0; i < (IQK_MAC_REG_NUM - 1); i++) + mac_backup[i] = odm_read_1byte(dm, mac_reg[i]); + mac_backup[i] = odm_read_4byte(dm, mac_reg[i]); +} + +void _phy_reload_adda_registers(struct dm_struct *dm, u32 *adda_reg, + u32 *adda_backup, u32 regiester_num) +{ + u32 i; + + RF_DBG(dm, DBG_RF_IQK, "Reload ADDA power saving parameters !\n"); + for (i = 0; i < regiester_num; i++) + odm_set_bb_reg(dm, adda_reg[i], MASKDWORD, adda_backup[i]); +} + +void _phy_reload_mac_registers(struct dm_struct *dm, u32 *mac_reg, + u32 *mac_backup) +{ + u32 i; + + RF_DBG(dm, DBG_RF_IQK, "Reload MAC parameters !\n"); + for (i = 0; i < (IQK_MAC_REG_NUM - 1); i++) + odm_write_1byte(dm, mac_reg[i], (u8)mac_backup[i]); + odm_write_4byte(dm, mac_reg[i], mac_backup[i]); +} + +void _phy_path_adda_on(struct dm_struct *dm, u32 *adda_reg, + boolean is_path_a_on, boolean is2T) +{ + u32 path_on; + u32 i; + + RF_DBG(dm, DBG_RF_IQK, "ADDA ON.\n"); + + path_on = is_path_a_on ? 0x04db25a4 : 0x0b1b25a4; + if (false == is2T) { + path_on = 0x0bdb25a0; + odm_set_bb_reg(dm, adda_reg[0], MASKDWORD, 0x0b1b25a0); + } else + odm_set_bb_reg(dm, adda_reg[0], MASKDWORD, path_on); + + for (i = 1; i < IQK_ADDA_REG_NUM; i++) + odm_set_bb_reg(dm, adda_reg[i], MASKDWORD, path_on); +} + +void _phy_mac_setting_calibration(struct dm_struct *dm, u32 *mac_reg, + u32 *mac_backup) +{ + u32 i = 0; + + RF_DBG(dm, DBG_RF_IQK, "MAC settings for Calibration.\n"); + + odm_write_1byte(dm, mac_reg[i], 0x3F); + + for (i = 1; i < (IQK_MAC_REG_NUM - 1); i++) + odm_write_1byte(dm, mac_reg[i], (u8)(mac_backup[i] & (~BIT(3)))); + odm_write_1byte(dm, mac_reg[i], (u8)(mac_backup[i] & (~BIT(5)))); +} + +void _phy_path_a_stand_by(struct dm_struct *dm) +{ + RF_DBG(dm, DBG_RF_IQK, "path-A standby mode!\n"); + odm_set_bb_reg(dm, REG_FPGA0_IQK, MASKH3BYTES, 0x0); + odm_set_bb_reg(dm, R_0x840, MASKDWORD, 0x00010000); + odm_set_bb_reg(dm, REG_FPGA0_IQK, MASKH3BYTES, 0x808000); +} + +void _phy_pi_mode_switch(struct dm_struct *dm, boolean pi_mode) +{ + u32 mode; + RF_DBG(dm, DBG_RF_IQK, "BB Switch to %s mode!\n", + (pi_mode ? "PI" : "SI")); + mode = pi_mode ? 0x01000100 : 0x01000000; + odm_set_bb_reg(dm, REG_FPGA0_XA_HSSI_PARAMETER1, MASKDWORD, mode); + odm_set_bb_reg(dm, REG_FPGA0_XB_HSSI_PARAMETER1, MASKDWORD, mode); +} + +boolean +phy_simularity_compare_8188e(struct dm_struct *dm, s32 result[][8], u8 c1, + u8 c2) +{ + u32 i, j, diff, simularity_bit_map, bound = 0; + u8 final_candidate[2] = {0xFF, 0xFF}; /* for path A and path B */ + boolean is_result = true; + boolean is2T = false; + + if (is2T) + bound = 8; + else + bound = 4; + + RF_DBG(dm, DBG_RF_IQK, "===> IQK:%s c1 %d c2 %d!!!\n", __func__, c1, + c2); + simularity_bit_map = 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) { + RF_DBG(dm, DBG_RF_IQK, + "IQK:%s differnece overflow index %d compare1 0x%x compare2 0x%x!!!\n", + __func__, 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); + } + } + + RF_DBG(dm, DBG_RF_IQK, "IQK:%s simularity_bit_map %d !!!\n", __func__, + 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 & 0x0F)) { /* path A OK */ + for (i = 0; i < 4; i++) + result[3][i] = result[c1][i]; + return false; + } else if (!(simularity_bit_map & 0xF0) && is2T) { /* path B OK */ + for (i = 4; i < 8; i++) + result[3][i] = result[c1][i]; + return false; + } else + return false; +} + +void _phy_iq_calibrate_8188e(struct dm_struct *dm, s32 result[][8], u8 t, + boolean is2T) +{ + u32 i; + u8 path_aok = 0, path_bok = 0; + 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}; + + /* since 92C & 92D have the different define in IQK_BB_REG */ + 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 retry_count = 2; + + if (*dm->mp_mode == true) + retry_count = 9; + + /* Note: IQ calibration must be performed after loading */ + /* PHY_REG.txt , and radio_a, radio_b.txt */ + + /* u32 bbvalue; */ + + if (t == 0) { + /* bbvalue = odm_get_bb_reg(dm, REG_FPGA0_RFMOD, MASKDWORD); + * RT_DISP(FINIT, INIT_IQK, ("_phy_iq_calibrate_8188e()==>0x%08x\n",bbvalue)); */ + + RF_DBG(dm, DBG_RF_IQK, "IQ Calibration for %s for %d times\n", + (is2T ? "2T2R" : "1T1R"), t); + + /* Save ADDA parameters, turn path A ADDA on */ + _phy_save_adda_registers(dm, ADDA_REG, dm->rf_calibrate_info.ADDA_backup, IQK_ADDA_REG_NUM); + _phy_save_mac_registers(dm, IQK_MAC_REG, dm->rf_calibrate_info.IQK_MAC_backup); + _phy_save_adda_registers(dm, IQK_BB_REG_92C, dm->rf_calibrate_info.IQK_BB_backup, IQK_BB_REG_NUM); + } + RF_DBG(dm, DBG_RF_IQK, "IQ Calibration for %s for %d times\n", + (is2T ? "2T2R" : "1T1R"), t); + _phy_path_adda_on(dm, ADDA_REG, true, is2T); + + if (t == 0) + dm->rf_calibrate_info.is_rf_pi_enable = (u8)odm_get_bb_reg(dm, REG_FPGA0_XA_HSSI_PARAMETER1, BIT(8)); + + if (!dm->rf_calibrate_info.is_rf_pi_enable) { + /* Switch BB to PI mode to do IQ Calibration. */ + _phy_pi_mode_switch(dm, true); + } + /* MAC settings */ + _phy_mac_setting_calibration(dm, IQK_MAC_REG, dm->rf_calibrate_info.IQK_MAC_backup); + /* BB setting */ + /* odm_set_bb_reg(dm, REG_FPGA0_RFMOD, BIT24, 0x00); */ + odm_set_bb_reg(dm, REG_CCK_0_AFE_SETTING, 0x0f000000, 0xf); + odm_set_bb_reg(dm, REG_OFDM_0_TRX_PATH_ENABLE, MASKDWORD, 0x03a05600); + odm_set_bb_reg(dm, REG_OFDM_0_TR_MUX_PAR, MASKDWORD, 0x000800e4); + odm_set_bb_reg(dm, REG_FPGA0_XCD_RF_INTERFACE_SW, MASKDWORD, 0x22204000); + + odm_set_bb_reg(dm, REG_FPGA0_XAB_RF_INTERFACE_SW, BIT(10), 0x01); + odm_set_bb_reg(dm, REG_FPGA0_XAB_RF_INTERFACE_SW, BIT(26), 0x01); + odm_set_bb_reg(dm, REG_FPGA0_XA_RF_INTERFACE_OE, BIT(10), 0x00); + odm_set_bb_reg(dm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(10), 0x00); + + if (is2T) { + odm_set_bb_reg(dm, REG_FPGA0_XA_LSSI_PARAMETER, MASKDWORD, 0x00010000); + odm_set_bb_reg(dm, REG_FPGA0_XB_LSSI_PARAMETER, MASKDWORD, 0x00010000); + } + /* Page B init */ + /* AP or IQK */ + odm_set_bb_reg(dm, REG_CONFIG_ANT_A, MASKDWORD, 0x0f600000); + if (is2T) + odm_set_bb_reg(dm, REG_CONFIG_ANT_B, MASKDWORD, 0x0f600000); + + /* IQ calibration setting */ + RF_DBG(dm, DBG_RF_IQK, "IQK setting!\n"); + odm_set_bb_reg(dm, REG_FPGA0_IQK, MASKH3BYTES, 0x808000); + odm_set_bb_reg(dm, REG_TX_IQK, MASKDWORD, 0x01007c00); + odm_set_bb_reg(dm, REG_RX_IQK, MASKDWORD, 0x81004800); + + for (i = 0; i < retry_count; i++) { + path_aok = phy_path_a_iqk_8188e(dm, is2T); + /* if(path_aok == 0x03){ */ + if (path_aok == 0x01) { + RF_DBG(dm, DBG_RF_IQK, "path A Tx IQK Success!!\n"); + result[t][0] = (odm_get_bb_reg(dm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD) & 0x3FF0000) >> 16; + result[t][1] = (odm_get_bb_reg(dm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD) & 0x3FF0000) >> 16; + break; + } +#if 0 + else if (i == (retry_count - 1) && path_aok == 0x01) { /* Tx IQK OK */ + RT_DISP(FINIT, INIT_IQK, ("path A IQK Only Tx Success!!\n")); + + result[t][0] = (odm_get_bb_reg(dm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD) & 0x3FF0000) >> 16; + result[t][1] = (odm_get_bb_reg(dm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD) & 0x3FF0000) >> 16; + } +#endif + } + + for (i = 0; i < retry_count; i++) { + path_aok = phy_path_a_rx_iqk(dm, is2T); + if (path_aok == 0x03) { + RF_DBG(dm, DBG_RF_IQK, "path A Rx IQK Success!!\n"); + /* result[t][0] = (odm_get_bb_reg(dm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD)&0x3FF0000)>>16; + * result[t][1] = (odm_get_bb_reg(dm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD)&0x3FF0000)>>16; */ + result[t][2] = (odm_get_bb_reg(dm, REG_RX_POWER_BEFORE_IQK_A_2, MASKDWORD) & 0x3FF0000) >> 16; + result[t][3] = (odm_get_bb_reg(dm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD) & 0x3FF0000) >> 16; + break; + } + + RF_DBG(dm, DBG_RF_IQK, "path A Rx IQK Fail!!\n"); + } + + if (0x00 == path_aok) + RF_DBG(dm, DBG_RF_IQK, "path A IQK failed!!\n"); + + if (is2T) { + _phy_path_a_stand_by(dm); + /* Turn path B ADDA on */ + _phy_path_adda_on(dm, ADDA_REG, false, is2T); + + for (i = 0; i < retry_count; i++) { + path_bok = phy_path_b_iqk_8188e(dm); + if (path_bok == 0x03) { + RF_DBG(dm, DBG_RF_IQK, + "path B IQK Success!!\n"); + result[t][4] = (odm_get_bb_reg(dm, REG_TX_POWER_BEFORE_IQK_B, MASKDWORD) & 0x3FF0000) >> 16; + result[t][5] = (odm_get_bb_reg(dm, REG_TX_POWER_AFTER_IQK_B, MASKDWORD) & 0x3FF0000) >> 16; + result[t][6] = (odm_get_bb_reg(dm, REG_RX_POWER_BEFORE_IQK_B_2, MASKDWORD) & 0x3FF0000) >> 16; + result[t][7] = (odm_get_bb_reg(dm, REG_RX_POWER_AFTER_IQK_B_2, MASKDWORD) & 0x3FF0000) >> 16; + break; + } else if (i == (retry_count - 1) && path_bok == 0x01) { /* Tx IQK OK */ + RF_DBG(dm, DBG_RF_IQK, + "path B Only Tx IQK Success!!\n"); + result[t][4] = (odm_get_bb_reg(dm, REG_TX_POWER_BEFORE_IQK_B, MASKDWORD) & 0x3FF0000) >> 16; + result[t][5] = (odm_get_bb_reg(dm, REG_TX_POWER_AFTER_IQK_B, MASKDWORD) & 0x3FF0000) >> 16; + } + } + + if (0x00 == path_bok) + RF_DBG(dm, DBG_RF_IQK, "path B IQK failed!!\n"); + } + + /* Back to BB mode, load original value */ + RF_DBG(dm, DBG_RF_IQK, "IQK:Back to BB mode, load original value!\n"); + odm_set_bb_reg(dm, REG_FPGA0_IQK, MASKH3BYTES, 0); + + if (t != 0) { + if (!dm->rf_calibrate_info.is_rf_pi_enable) { + /* Switch back BB to SI mode after finish IQ Calibration. */ + _phy_pi_mode_switch(dm, false); + } + /* Reload ADDA power saving parameters */ + _phy_reload_adda_registers(dm, ADDA_REG, dm->rf_calibrate_info.ADDA_backup, IQK_ADDA_REG_NUM); + /* Reload MAC parameters */ + _phy_reload_mac_registers(dm, IQK_MAC_REG, dm->rf_calibrate_info.IQK_MAC_backup); + _phy_reload_adda_registers(dm, IQK_BB_REG_92C, dm->rf_calibrate_info.IQK_BB_backup, IQK_BB_REG_NUM); + /* Restore RX initial gain */ + odm_set_bb_reg(dm, REG_FPGA0_XA_LSSI_PARAMETER, MASKDWORD, 0x00032ed3); + if (is2T) + odm_set_bb_reg(dm, REG_FPGA0_XB_LSSI_PARAMETER, MASKDWORD, 0x00032ed3); + + /* load 0xe30 IQC default value */ + odm_set_bb_reg(dm, REG_TX_IQK_TONE_A, MASKDWORD, 0x01008c00); + odm_set_bb_reg(dm, REG_RX_IQK_TONE_A, MASKDWORD, 0x01008c00); + } + RF_DBG(dm, DBG_RF_IQK, "%s <==\n", __func__); +} + +void _phy_lc_calibrate_8188e(struct dm_struct *dm, boolean is2T) +{ + u8 tmp_reg; + u32 rf_amode = 0, rf_bmode = 0, lc_cal; + + /* Check continuous TX and Packet TX */ + tmp_reg = odm_read_1byte(dm, 0xd03); + + if ((tmp_reg & 0x70) != 0) /* Deal with contisuous TX case */ + odm_write_1byte(dm, 0xd03, tmp_reg & 0x8F); /* disable all continuous TX */ + else /* Deal with Packet TX case */ + odm_write_1byte(dm, REG_TXPAUSE, 0xFF); /* block all queues */ + + if ((tmp_reg & 0x70) != 0) { + /* 1. Read original RF mode */ + /* path-A */ + rf_amode = odm_get_rf_reg(dm, RF_PATH_A, RF_AC, MASK12BITS); + /* path-B */ + if (is2T) + rf_bmode = odm_get_rf_reg(dm, RF_PATH_B, RF_AC, MASK12BITS); + /* 2. Set RF mode = standby mode */ + /* path-A */ + odm_set_rf_reg(dm, RF_PATH_A, RF_AC, MASK12BITS, (rf_amode & 0x8FFFF) | 0x10000); + /* path-B */ + if (is2T) + odm_set_rf_reg(dm, RF_PATH_B, RF_AC, MASK12BITS, (rf_bmode & 0x8FFFF) | 0x10000); + } + + /* 3. Read RF reg18 */ + lc_cal = odm_get_rf_reg(dm, RF_PATH_A, RF_CHNLBW, MASK12BITS); + + /* 4. Set LC calibration begin bit15 */ + odm_set_rf_reg(dm, RF_PATH_A, RF_CHNLBW, MASK12BITS, lc_cal | 0x08000); + ODM_delay_ms(100); + + /* Restore original situation */ + if ((tmp_reg & 0x70) != 0) { /* Deal with contisuous TX case */ + /* path-A */ + odm_write_1byte(dm, 0xd03, tmp_reg); + odm_set_rf_reg(dm, RF_PATH_A, RF_AC, MASK12BITS, rf_amode); + + /* path-B */ + if (is2T) + odm_set_rf_reg(dm, RF_PATH_B, RF_AC, MASK12BITS, rf_bmode); + } else /* Deal with Packet TX case */ + odm_write_1byte(dm, REG_TXPAUSE, 0x00); +} + +void phy_iq_calibrate_8188e(void *dm_void, boolean is_recovery) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + s32 result[4][8]; /* last is final result */ + u8 i, final_candidate, indexforchannel; + u8 channel_to_iqk = 7; + boolean is_patha_ok, is_pathb_ok; + s32 rege94, rege9c, regea4, regeac, regeb4, regebc, regec4, regecc, reg_tmp = 0; + 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}; + + if (is_recovery) { + RF_DBG(dm, DBG_RF_INIT, "%s: Return due to is_recovery!\n", + __func__); + _phy_reload_adda_registers(dm, IQK_BB_REG_92C, dm->rf_calibrate_info.IQK_BB_backup_recover, 9); + return; + } + RF_DBG(dm, DBG_RF_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; + is_patha_ok = false; + is_pathb_ok = false; + is12simular = false; + is23simular = false; + is13simular = false; + + for (i = 0; i < 3; i++) { + _phy_iq_calibrate_8188e(dm, result, i, false); + if (i == 1) { + is12simular = phy_simularity_compare_8188e(dm, result, 0, 1); + if (is12simular) { + final_candidate = 0; + RF_DBG(dm, DBG_RF_IQK, + "IQK: is12simular final_candidate is %x\n", + final_candidate); + break; + } + } + + if (i == 2) { + is13simular = phy_simularity_compare_8188e(dm, result, 0, 2); + if (is13simular) { + final_candidate = 0; + RF_DBG(dm, DBG_RF_IQK, + "IQK: is13simular final_candidate is %x\n", + final_candidate); + break; + } + is23simular = phy_simularity_compare_8188e(dm, result, 1, 2); + if (is23simular) { + final_candidate = 1; + RF_DBG(dm, DBG_RF_IQK, + "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; + } + } + } + /* RT_TRACE(COMP_INIT,DBG_LOUD,("Release Mutex in IQCalibrate\n")); */ + + 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]; + RF_DBG(dm, DBG_RF_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) { + dm->rf_calibrate_info.rege94 = rege94 = result[final_candidate][0]; + dm->rf_calibrate_info.rege9c = rege9c = result[final_candidate][1]; + regea4 = result[final_candidate][2]; + regeac = result[final_candidate][3]; + dm->rf_calibrate_info.regeb4 = regeb4 = result[final_candidate][4]; + dm->rf_calibrate_info.regebc = regebc = result[final_candidate][5]; + regec4 = result[final_candidate][6]; + regecc = result[final_candidate][7]; + RF_DBG(dm, DBG_RF_IQK, "IQK: final_candidate is %x\n", + final_candidate); + RF_DBG(dm, DBG_RF_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); + is_patha_ok = is_pathb_ok = true; + } else { + RF_DBG(dm, DBG_RF_IQK, "IQK: FAIL use default value\n"); + + dm->rf_calibrate_info.rege94 = dm->rf_calibrate_info.regeb4 = 0x100; /* X default value */ + dm->rf_calibrate_info.rege9c = dm->rf_calibrate_info.regebc = 0x0; /* Y default value */ + } + + if ((rege94 != 0) /*&&(regea4 != 0)*/) + _phy_path_a_fill_iqk_matrix(dm, is_patha_ok, result, final_candidate, (regea4 == 0)); + + indexforchannel = odm_get_right_chnl_place_for_iqk(*dm->channel); + + /* To Fix BSOD when final_candidate is 0xff + * by sherry 20120321 */ + if (final_candidate < 4) { + for (i = 0; i < iqk_matrix_reg_num; i++) + dm->rf_calibrate_info.iqk_matrix_reg_setting[indexforchannel].value[0][i] = result[final_candidate][i]; + dm->rf_calibrate_info.iqk_matrix_reg_setting[indexforchannel].is_iqk_done = true; + } + /* RT_DISP(FINIT, INIT_IQK, ("\nIQK OK indexforchannel %d.\n", indexforchannel)); */ + RF_DBG(dm, DBG_RF_IQK, "\nIQK OK indexforchannel %d.\n", + indexforchannel); + _phy_save_adda_registers(dm, IQK_BB_REG_92C, dm->rf_calibrate_info.IQK_BB_backup_recover, IQK_BB_REG_NUM); + RF_DBG(dm, DBG_RF_IQK, "IQK finished\n"); +} + +void phy_lc_calibrate_8188e(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + _phy_lc_calibrate_8188e(dm, false); +} + +void _phy_set_rf_path_switch_8188e( +#if ((DM_ODM_SUPPORT_TYPE & ODM_AP) || (DM_ODM_SUPPORT_TYPE == ODM_CE)) + struct dm_struct *dm, +#else + void *adapter, +#endif + boolean is_main, boolean is2T) +{ +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + struct dm_struct *dm = &hal_data->DM_OutSrc; +#endif + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + if (!adapter->bHWInitReady) +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + void *adapter = dm->adapter; + if (!rtw_is_hw_init_completed(adapter)) +#endif + { + u8 u1b_tmp; + u1b_tmp = odm_read_1byte(dm, REG_LEDCFG2) | BIT(7); + odm_write_1byte(dm, REG_LEDCFG2, u1b_tmp); + /* odm_set_bb_reg(dm, REG_LEDCFG0, BIT23, 0x01); */ + odm_set_bb_reg(dm, REG_FPGA0_XAB_RF_PARAMETER, BIT(13), 0x01); + } + +#endif + + if (is2T) { /* 92C */ + if (is_main) + odm_set_bb_reg(dm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(5) | BIT(6), 0x1); /* 92C_Path_A */ + else + odm_set_bb_reg(dm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(5) | BIT(6), 0x2); /* BT */ + } else { /* 88C */ + #ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY + /* <20120504, Kordan> [8188E] We should make AntDiversity controlled by HW (0x870[9:8] = 0), */ + /* otherwise the following action has no effect. (0x860[9:8] has the effect only if AntDiversity controlled by SW) */ + odm_set_bb_reg(dm, REG_FPGA0_XAB_RF_INTERFACE_SW, BIT(8) | BIT(9), 0x0); + odm_set_bb_reg(dm, R_0x914, MASKLWORD, 0x0201); /* Set up the ant mapping table */ + + if (is_main) { + /* odm_set_bb_reg(dm, REG_FPGA0_XA_RF_INTERFACE_OE, BIT(8)|BIT9, 0x2); */ /* Tx Main (SW control)(The right antenna) */ + /* 4 [ Tx ] */ + odm_set_bb_reg(dm, REG_FPGA0_XA_RF_INTERFACE_OE, BIT(14) | BIT(13) | BIT(12), 0x1); /* Tx Main (HW control)(The right antenna) */ + + /* 4 [ Rx ] */ + odm_set_bb_reg(dm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(5) | BIT(4) | BIT(3), 0x1); /* ant_div_type = TRDiv, right antenna */ + if (dm->ant_div_type == CGCS_RX_HW_ANTDIV) + odm_set_bb_reg(dm, R_0xb2c, BIT(31), 0x1); /* RxCG, Default is RxCG. ant_div_type = 2RDiv, left antenna */ + + } else { + /* odm_set_bb_reg(dm, REG_FPGA0_XA_RF_INTERFACE_OE, BIT(8)|BIT9, 0x1); */ /* Tx Aux (SW control)(The left antenna) */ + /* 4 [ Tx ] */ + odm_set_bb_reg(dm, REG_FPGA0_XA_RF_INTERFACE_OE, BIT(14) | BIT(13) | BIT(12), 0x0); /* Tx Aux (HW control)(The left antenna) */ + + /* 4 [ Rx ] */ + odm_set_bb_reg(dm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(5) | BIT(4) | BIT(3), 0x0); /* ant_div_type = TRDiv, left antenna */ + if (dm->ant_div_type == CGCS_RX_HW_ANTDIV) + odm_set_bb_reg(dm, R_0xb2c, BIT(31), 0x0); /* RxCS, ant_div_type = 2RDiv, right antenna */ + } + #endif + } +} +void phy_set_rf_path_switch_8188e( +#if ((DM_ODM_SUPPORT_TYPE & ODM_AP) || (DM_ODM_SUPPORT_TYPE == ODM_CE)) + struct dm_struct *dm, +#else + void *adapter, +#endif + boolean is_main) +{ +#if !((DM_ODM_SUPPORT_TYPE & ODM_AP) || (DM_ODM_SUPPORT_TYPE & ODM_CE)) + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); +#endif + +#if DISABLE_BB_RF + return; +#endif + + { +/* For 88C 1T1R */ +#if !((DM_ODM_SUPPORT_TYPE & ODM_AP) || (DM_ODM_SUPPORT_TYPE & ODM_CE)) + _phy_set_rf_path_switch_8188e(adapter, is_main, false); +#else + _phy_set_rf_path_switch_8188e(dm, is_main, false); +#endif + } +} + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +/* return value true => Main; false => Aux */ +boolean _phy_query_rf_path_switch_8188e( +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + struct dm_struct *dm, +#else + void *adapter, +#endif + boolean is2T) +{ +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) + struct dm_struct *dm = &hal_data->odmpriv; +#endif +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct dm_struct *dm = &hal_data->DM_OutSrc; +#endif +#endif + if (!adapter->is_hw_init_ready) { + u8 u1b_tmp; + u1b_tmp = odm_read_1byte(dm, REG_LEDCFG2) | BIT(7); + odm_write_1byte(dm, REG_LEDCFG2, u1b_tmp); + /* odm_set_bb_reg(dm, REG_LEDCFG0, BIT23, 0x01); */ + odm_set_bb_reg(dm, REG_FPGA0_XAB_RF_PARAMETER, BIT(13), 0x01); + } + + if (is2T) { + if (odm_get_bb_reg(dm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(5) | BIT(6)) == 0x01) + return true; + else + return false; + } else { + if ((odm_get_bb_reg(dm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(5) | BIT(4) | BIT(3)) == 0x1)) + return true; + else + return false; + } +} + +/* return value true => Main; false => Aux */ +boolean phy_query_rf_path_switch_8188e( +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + struct dm_struct *dm +#else + void *adapter +#endif + ) +{ + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + +#if DISABLE_BB_RF + return true; +#endif +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) + if (IS_2T2R(hal_data->version_id)) + return _phy_query_rf_path_switch_8188e(adapter, true); +#endif +/* For 88C 1T1R */ +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) + return _phy_query_rf_path_switch_8188e(adapter, false); +#else + return _phy_query_rf_path_switch_8188e(dm, false); +#endif +} +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/rtl8188e/halrf_8188e_ce.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/rtl8188e/halrf_8188e_ce.h new file mode 100644 index 000000000000..c6ca0f3b86a4 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/rtl8188e/halrf_8188e_ce.h @@ -0,0 +1,60 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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_8188E_H__ +#define __HALRF_8188E_H__ + +/*--------------------------Define Parameters-------------------------------*/ +#define IQK_DELAY_TIME_88E 10 /* ms */ +#define index_mapping_NUM_88E 15 +#define AVG_THERMAL_NUM_88E 4 + +#include "../halphyrf_ce.h" + +void configure_txpower_track_8188e(struct txpwrtrack_cfg *config); + +void get_delta_swing_table_8188e(void *dm_void, u8 **temperature_up_a, + u8 **temperature_down_a, u8 **temperature_up_b, + u8 **temperature_down_b); + +void do_iqk_8188e(void *dm_void, u8 delta_thermal_index, u8 thermal_value, + u8 threshold); + +void odm_tx_pwr_track_set_pwr88_e(void *dm_void, enum pwrtrack_method method, + u8 rf_path, u8 channel_mapped_index); + +/* 1 7. IQK */ + +void phy_iq_calibrate_8188e(void *dm_void, boolean is_recovery); + +/* + * LC calibrate + * */ +void phy_lc_calibrate_8188e(void *dm_void); + +void _phy_save_adda_registers(struct dm_struct *dm, u32 *adda_reg, + u32 *adda_backup, u32 register_num); + +void _phy_path_adda_on(struct dm_struct *dm, u32 *adda_reg, + boolean is_path_a_on, boolean is2T); + +void _phy_mac_setting_calibration(struct dm_struct *dm, u32 *mac_reg, + u32 *mac_backup); + +void _phy_path_a_stand_by(struct dm_struct *dm); +void halrf_rf_lna_setting_8188e(struct dm_struct *dm, enum halrf_lna_set type); + +#endif /*#ifndef __HALRF_8188E_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/rtl8188e/halrf_8188e_win.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/rtl8188e/halrf_8188e_win.c new file mode 100644 index 000000000000..d99cc80e41a3 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/rtl8188e/halrf_8188e_win.c @@ -0,0 +1,1792 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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 RT_PLATFORM==PLATFORM_MACOSX +#include "phydm_precomp.h" +#else +#include "../phydm_precomp.h" +#endif + +#if (RTL8188E_SUPPORT == 1) + +/*---------------------------Define Local Constant---------------------------*/ +/* 2010/04/25 MH Define the max tx power tracking tx agc power. */ +#define ODM_TXPWRTRACK_MAX_IDX_88E 6 + +/*---------------------------Define Local Constant---------------------------*/ + + +/* 3============================================================ + * 3 Tx Power Tracking + * 3============================================================ */ + +void halrf_rf_lna_setting_8188e( + struct dm_struct *dm, + enum halrf_lna_set type +) +{ +/*phydm_disable_lna*/ + if (type == HALRF_LNA_DISABLE) { + odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, 0x80000, 0x1); + odm_set_rf_reg(dm, RF_PATH_A, RF_0x30, 0xfffff, 0x18000); /*select Rx mode*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0x31, 0xfffff, 0x0000f); + odm_set_rf_reg(dm, RF_PATH_A, RF_0x32, 0xfffff, 0x37f82); /*disable LNA*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, 0x80000, 0x0); + if (dm->rf_type > RF_1T1R) { + odm_set_rf_reg(dm, RF_PATH_B, RF_0xef, 0x80000, 0x1); + odm_set_rf_reg(dm, RF_PATH_B, RF_0x30, 0xfffff, 0x18000); + odm_set_rf_reg(dm, RF_PATH_B, RF_0x31, 0xfffff, 0x0000f); + odm_set_rf_reg(dm, RF_PATH_B, RF_0x32, 0xfffff, 0x37f82); + odm_set_rf_reg(dm, RF_PATH_B, RF_0xef, 0x80000, 0x0); + } + } else if (type == HALRF_LNA_ENABLE) { + /*phydm_enable_lna*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, 0x80000, 0x1); + odm_set_rf_reg(dm, RF_PATH_A, RF_0x30, 0xfffff, 0x18000); /*select Rx mode*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0x31, 0xfffff, 0x0000f); + odm_set_rf_reg(dm, RF_PATH_A, RF_0x32, 0xfffff, 0x77f82); /*back to normal*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, 0x80000, 0x0); + if (dm->rf_type > RF_1T1R) { + odm_set_rf_reg(dm, RF_PATH_B, RF_0xef, 0x80000, 0x1); + odm_set_rf_reg(dm, RF_PATH_B, RF_0x30, 0xfffff, 0x18000); + odm_set_rf_reg(dm, RF_PATH_B, RF_0x31, 0xfffff, 0x0000f); + odm_set_rf_reg(dm, RF_PATH_B, RF_0x32, 0xfffff, 0x77f82); + odm_set_rf_reg(dm, RF_PATH_B, RF_0xef, 0x80000, 0x0); + } + + } +} + +void set_iqk_matrix_8188e( + struct dm_struct *dm, + u8 OFDM_index, + u8 rf_path, + s32 iqk_result_x, + s32 iqk_result_y +) +{ + s32 ele_A = 0, ele_D, ele_C = 0, value32; + + ele_D = (ofdm_swing_table_new[OFDM_index] & 0xFFC00000) >> 22; + + /* new element A = element D x X */ + if ((iqk_result_x != 0) && (*(dm->band_type) == ODM_BAND_2_4G)) { + if ((iqk_result_x & 0x00000200) != 0) /* consider minus */ + iqk_result_x = iqk_result_x | 0xFFFFFC00; + ele_A = ((iqk_result_x * ele_D) >> 8) & 0x000003FF; + + /* new element C = element D x Y */ + if ((iqk_result_y & 0x00000200) != 0) + iqk_result_y = iqk_result_y | 0xFFFFFC00; + ele_C = ((iqk_result_y * ele_D) >> 8) & 0x000003FF; + + if (rf_path == RF_PATH_A) + switch (rf_path) { + case RF_PATH_A: + /* 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; + odm_set_bb_reg(dm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKDWORD, value32); + + value32 = (ele_C & 0x000003C0) >> 6; + odm_set_bb_reg(dm, REG_OFDM_0_XC_TX_AFE, MASKH4BITS, value32); + + value32 = ((iqk_result_x * ele_D) >> 7) & 0x01; + odm_set_bb_reg(dm, REG_OFDM_0_ECCA_THRESHOLD, BIT(24), value32); + break; + case RF_PATH_B: + /* 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; + odm_set_bb_reg(dm, REG_OFDM_0_XB_TX_IQ_IMBALANCE, MASKDWORD, value32); + + value32 = (ele_C & 0x000003C0) >> 6; + odm_set_bb_reg(dm, REG_OFDM_0_XD_TX_AFE, MASKH4BITS, value32); + + value32 = ((iqk_result_x * ele_D) >> 7) & 0x01; + odm_set_bb_reg(dm, REG_OFDM_0_ECCA_THRESHOLD, BIT(28), value32); + + break; + default: + break; + } + } else { + switch (rf_path) { + case RF_PATH_A: + odm_set_bb_reg(dm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKDWORD, ofdm_swing_table_new[OFDM_index]); + odm_set_bb_reg(dm, REG_OFDM_0_XC_TX_AFE, MASKH4BITS, 0x00); + odm_set_bb_reg(dm, REG_OFDM_0_ECCA_THRESHOLD, BIT(24), 0x00); + break; + + case RF_PATH_B: + odm_set_bb_reg(dm, REG_OFDM_0_XB_TX_IQ_IMBALANCE, MASKDWORD, ofdm_swing_table_new[OFDM_index]); + odm_set_bb_reg(dm, REG_OFDM_0_XD_TX_AFE, MASKH4BITS, 0x00); + odm_set_bb_reg(dm, REG_OFDM_0_ECCA_THRESHOLD, BIT(28), 0x00); + break; + + default: + break; + } + } + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "TxPwrTracking path B: X = 0x%x, Y = 0x%x ele_A = 0x%x ele_C = 0x%x ele_D = 0x%x 0xeb4 = 0x%x 0xebc = 0x%x\n", + (u32)iqk_result_x, (u32)iqk_result_y, (u32)ele_A, (u32)ele_C, (u32)ele_D, (u32)iqk_result_x, (u32)iqk_result_y); +} + +void do_iqk_8188e( + void *dm_void, + u8 delta_thermal_index, + u8 thermal_value, + u8 threshold +) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + odm_reset_iqk_result(dm); + dm->rf_calibrate_info.thermal_value_iqk = thermal_value; + halrf_iqk_trigger(dm, false); +} + +/*----------------------------------------------------------------------------- + * Function: odm_TxPwrTrackSetPwr88E() + * + * Overview: 88E 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_pwr88_e( + void *dm_void, + enum pwrtrack_method method, + u8 rf_path, + u8 channel_mapped_index +) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _ADAPTER *adapter = dm->adapter; + u8 pwr_tracking_limit_ofdm = 30; /* +0dB */ + u8 pwr_tracking_limit_cck = 28; /* -2dB */ + u8 tx_rate = 0xFF; + u8 final_ofdm_swing_index = 0; + u8 final_cck_swing_index = 0; + struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); + + + if (*(dm->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 = *(dm->forced_data_rate); + + if (!rate) { /*auto rate*/ +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + tx_rate = ((PADAPTER)adapter)->HalFunc.GetHwRateFromMRateHandler(dm->tx_rate); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + tx_rate = hw_rate_to_m_rate(dm->tx_rate); +#endif + } else /*force rate*/ + tx_rate = (u8)rate; + } + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "Power Tracking tx_rate=0x%X\n", tx_rate); + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "===>ODM_TxPwrTrackSetPwr8188E\n"); + + if (tx_rate != 0xFF) { + /* 2 CCK */ + if (((tx_rate >= MGN_1M) && (tx_rate <= MGN_5_5M)) || (tx_rate == MGN_11M)) + pwr_tracking_limit_cck = 28; /* -2dB */ + /* 2 OFDM */ + else if ((tx_rate >= MGN_6M) && (tx_rate <= MGN_48M)) + pwr_tracking_limit_ofdm = 36; /* +3dB */ + else if (tx_rate == MGN_54M) + pwr_tracking_limit_ofdm = 34; /* +2dB */ + + /* 2 HT */ + else if ((tx_rate >= MGN_MCS0) && (tx_rate <= MGN_MCS2)) /* QPSK/BPSK */ + pwr_tracking_limit_ofdm = 38; /* +4dB */ + else if ((tx_rate >= MGN_MCS3) && (tx_rate <= MGN_MCS4)) /* 16QAM */ + pwr_tracking_limit_ofdm = 36; /* +3dB */ + else if ((tx_rate >= MGN_MCS5) && (tx_rate <= MGN_MCS7)) /* 64QAM */ + pwr_tracking_limit_ofdm = 34; /* +2dB */ + + else + pwr_tracking_limit_ofdm = cali_info->default_ofdm_index; /* Default OFDM index = 30 */ + } + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "tx_rate=0x%x, pwr_tracking_limit=%d\n", tx_rate, pwr_tracking_limit_ofdm); + + if (method == TXAGC) { + u32 pwr = 0, tx_agc = 0; + void *adapter = dm->adapter; + + cali_info->remnant_ofdm_swing_idx[rf_path] = cali_info->absolute_ofdm_swing_idx[rf_path]; /* Remnant index equal to aboslute compensate value. */ + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "odm_TxPwrTrackSetPwr88E CH=%d\n", *(dm->channel)); + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + +#if (MP_DRIVER != 1) + /* phy_set_tx_power_level8188e(dm->adapter, *dm->channel); */ + + cali_info->modify_tx_agc_flag_path_a = true; + cali_info->modify_tx_agc_flag_path_a_cck = true; + + if (rf_path == RF_PATH_A) { + PHY_SetTxPowerIndexByRateSection(adapter, RF_PATH_A, *dm->channel, CCK); + PHY_SetTxPowerIndexByRateSection(adapter, RF_PATH_A, *dm->channel, OFDM); + PHY_SetTxPowerIndexByRateSection(adapter, RF_PATH_A, *dm->channel, HT_MCS0_MCS7); + } + +#else + pwr = PHY_QueryBBReg(adapter, REG_TX_AGC_A_RATE18_06, 0xFF); + pwr += cali_info->power_index_offset[RF_PATH_A]; + PHY_SetBBReg(adapter, REG_TX_AGC_A_CCK_1_MCS32, MASKBYTE1, pwr); + tx_agc = (pwr << 16) | (pwr << 8) | (pwr); + PHY_SetBBReg(adapter, REG_TX_AGC_B_CCK_11_A_CCK_2_11, 0xffffff00, tx_agc); + RT_DISP(FPHY, PHY_TXPWR, ("odm_tx_pwr_track_set_pwr88_e: CCK Tx-rf(A) Power = 0x%x\n", tx_agc)); + + pwr = PHY_QueryBBReg(adapter, REG_TX_AGC_A_RATE18_06, 0xFF); + pwr += (cali_info->bb_swing_idx_ofdm[RF_PATH_A] - cali_info->bb_swing_idx_ofdm_base[RF_PATH_A]); + tx_agc |= ((pwr << 24) | (pwr << 16) | (pwr << 8) | pwr); + PHY_SetBBReg(adapter, REG_TX_AGC_A_RATE18_06, MASKDWORD, tx_agc); + PHY_SetBBReg(adapter, REG_TX_AGC_A_RATE54_24, MASKDWORD, tx_agc); + PHY_SetBBReg(adapter, REG_TX_AGC_A_MCS03_MCS00, MASKDWORD, tx_agc); + PHY_SetBBReg(adapter, REG_TX_AGC_A_MCS07_MCS04, MASKDWORD, tx_agc); + PHY_SetBBReg(adapter, REG_TX_AGC_A_MCS11_MCS08, MASKDWORD, tx_agc); + PHY_SetBBReg(adapter, REG_TX_AGC_A_MCS15_MCS12, MASKDWORD, tx_agc); + RT_DISP(FPHY, PHY_TXPWR, ("odm_tx_pwr_track_set_pwr88_e: OFDM Tx-rf(A) Power = 0x%x\n", tx_agc)); +#endif + +#endif +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + /* phy_rf6052_set_cck_tx_power(dm->priv, *(dm->channel)); */ + /* phy_rf6052_set_ofdm_tx_power(dm->priv, *(dm->channel)); */ +#endif + + } else if (method == BBSWING) { + final_ofdm_swing_index = cali_info->default_ofdm_index + cali_info->absolute_ofdm_swing_idx[rf_path]; + final_cck_swing_index = cali_info->default_cck_index + cali_info->absolute_ofdm_swing_idx[rf_path]; + + 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) + final_cck_swing_index = CCK_TABLE_SIZE - 1; + else if (cali_info->bb_swing_idx_cck < 0) + final_cck_swing_index = 0; + + /* Adjust BB swing by OFDM IQ matrix */ + if (rf_path == RF_PATH_A) { + set_iqk_matrix_8188e(dm, final_ofdm_swing_index, RF_PATH_A, + cali_info->iqk_matrix_reg_setting[channel_mapped_index].value[0][0], + cali_info->iqk_matrix_reg_setting[channel_mapped_index].value[0][1]); + /* Adjust BB swing by CCK filter coefficient */ + if (*dm->channel != 14) { + odm_write_1byte(dm, 0xa22, cck_swing_table_ch1_ch13_new[final_cck_swing_index][0]); + odm_write_1byte(dm, 0xa23, cck_swing_table_ch1_ch13_new[final_cck_swing_index][1]); + odm_write_1byte(dm, 0xa24, cck_swing_table_ch1_ch13_new[final_cck_swing_index][2]); + odm_write_1byte(dm, 0xa25, cck_swing_table_ch1_ch13_new[final_cck_swing_index][3]); + odm_write_1byte(dm, 0xa26, cck_swing_table_ch1_ch13_new[final_cck_swing_index][4]); + odm_write_1byte(dm, 0xa27, cck_swing_table_ch1_ch13_new[final_cck_swing_index][5]); + odm_write_1byte(dm, 0xa28, cck_swing_table_ch1_ch13_new[final_cck_swing_index][6]); + odm_write_1byte(dm, 0xa29, cck_swing_table_ch1_ch13_new[final_cck_swing_index][7]); + } else { + odm_write_1byte(dm, 0xa22, cck_swing_table_ch14_new[final_cck_swing_index][0]); + odm_write_1byte(dm, 0xa23, cck_swing_table_ch14_new[final_cck_swing_index][1]); + odm_write_1byte(dm, 0xa24, cck_swing_table_ch14_new[final_cck_swing_index][2]); + odm_write_1byte(dm, 0xa25, cck_swing_table_ch14_new[final_cck_swing_index][3]); + odm_write_1byte(dm, 0xa26, cck_swing_table_ch14_new[final_cck_swing_index][4]); + odm_write_1byte(dm, 0xa27, cck_swing_table_ch14_new[final_cck_swing_index][5]); + odm_write_1byte(dm, 0xa28, cck_swing_table_ch14_new[final_cck_swing_index][6]); + odm_write_1byte(dm, 0xa29, cck_swing_table_ch14_new[final_cck_swing_index][7]); + } + } + } else if (method == MIX_MODE) { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "cali_info->default_ofdm_index=%d, dm->DefaultCCKIndex=%d, cali_info->absolute_ofdm_swing_idx[rf_path]=%d, rf_path = %d\n", + cali_info->default_ofdm_index, cali_info->default_cck_index, cali_info->absolute_ofdm_swing_idx[rf_path], rf_path); + + final_cck_swing_index = cali_info->default_cck_index + cali_info->absolute_ofdm_swing_idx[rf_path]; + final_ofdm_swing_index = cali_info->default_ofdm_index + cali_info->absolute_ofdm_swing_idx[rf_path]; + + if (final_ofdm_swing_index > pwr_tracking_limit_ofdm) { /* BBSwing higher then Limit */ + cali_info->remnant_ofdm_swing_idx[rf_path] = final_ofdm_swing_index - pwr_tracking_limit_ofdm; + + set_iqk_matrix_8188e(dm, pwr_tracking_limit_ofdm, RF_PATH_A, + cali_info->iqk_matrix_reg_setting[channel_mapped_index].value[0][0], + cali_info->iqk_matrix_reg_setting[channel_mapped_index].value[0][1]); + + cali_info->modify_tx_agc_flag_path_a = true; + + PHY_SetTxPowerIndexByRateSection(adapter, RF_PATH_A, *dm->channel, OFDM); + PHY_SetTxPowerIndexByRateSection(adapter, RF_PATH_A, *dm->channel, HT_MCS0_MCS7); + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "******Path_A Over BBSwing Limit, pwr_tracking_limit = %d, Remnant tx_agc value = %d\n", pwr_tracking_limit_ofdm, cali_info->remnant_ofdm_swing_idx[rf_path]); + } else if (final_ofdm_swing_index < 0) { + cali_info->remnant_ofdm_swing_idx[rf_path] = final_ofdm_swing_index ; + + set_iqk_matrix_8188e(dm, 0, RF_PATH_A, + cali_info->iqk_matrix_reg_setting[channel_mapped_index].value[0][0], + cali_info->iqk_matrix_reg_setting[channel_mapped_index].value[0][1]); + + cali_info->modify_tx_agc_flag_path_a = true; + + PHY_SetTxPowerIndexByRateSection(adapter, RF_PATH_A, *dm->channel, OFDM); + PHY_SetTxPowerIndexByRateSection(adapter, RF_PATH_A, *dm->channel, HT_MCS0_MCS7); + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "******Path_A Lower then BBSwing lower bound 0, Remnant tx_agc value = %d\n", cali_info->remnant_ofdm_swing_idx[rf_path]); + } else { + set_iqk_matrix_8188e(dm, final_ofdm_swing_index, RF_PATH_A, + cali_info->iqk_matrix_reg_setting[channel_mapped_index].value[0][0], + cali_info->iqk_matrix_reg_setting[channel_mapped_index].value[0][1]); + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "******Path_A Compensate with BBSwing, final_ofdm_swing_index = %d\n", final_ofdm_swing_index); + + if (cali_info->modify_tx_agc_flag_path_a) { /* If tx_agc has changed, reset tx_agc again */ + cali_info->remnant_ofdm_swing_idx[rf_path] = 0; + + PHY_SetTxPowerIndexByRateSection(adapter, RF_PATH_A, *dm->channel, OFDM); + PHY_SetTxPowerIndexByRateSection(adapter, RF_PATH_A, *dm->channel, HT_MCS0_MCS7); + + cali_info->modify_tx_agc_flag_path_a = false; + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "******Path_A dm->Modify_TxAGC_Flag = false\n"); + } + } + + if (final_cck_swing_index > pwr_tracking_limit_cck) { + cali_info->remnant_cck_swing_idx = final_cck_swing_index - pwr_tracking_limit_cck; + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "******Path_A CCK Over Limit, pwr_tracking_limit_cck = %d, cali_info->remnant_cck_swing_idx = %d\n", pwr_tracking_limit_cck, cali_info->remnant_cck_swing_idx); + + /* Adjust BB swing by CCK filter coefficient */ + + if (*dm->channel != 14) { + odm_write_1byte(dm, 0xa22, cck_swing_table_ch1_ch13_new[pwr_tracking_limit_cck][0]); + odm_write_1byte(dm, 0xa23, cck_swing_table_ch1_ch13_new[pwr_tracking_limit_cck][1]); + odm_write_1byte(dm, 0xa24, cck_swing_table_ch1_ch13_new[pwr_tracking_limit_cck][2]); + odm_write_1byte(dm, 0xa25, cck_swing_table_ch1_ch13_new[pwr_tracking_limit_cck][3]); + odm_write_1byte(dm, 0xa26, cck_swing_table_ch1_ch13_new[pwr_tracking_limit_cck][4]); + odm_write_1byte(dm, 0xa27, cck_swing_table_ch1_ch13_new[pwr_tracking_limit_cck][5]); + odm_write_1byte(dm, 0xa28, cck_swing_table_ch1_ch13_new[pwr_tracking_limit_cck][6]); + odm_write_1byte(dm, 0xa29, cck_swing_table_ch1_ch13_new[pwr_tracking_limit_cck][7]); + } else { + odm_write_1byte(dm, 0xa22, cck_swing_table_ch14_new[pwr_tracking_limit_cck][0]); + odm_write_1byte(dm, 0xa23, cck_swing_table_ch14_new[pwr_tracking_limit_cck][1]); + odm_write_1byte(dm, 0xa24, cck_swing_table_ch14_new[pwr_tracking_limit_cck][2]); + odm_write_1byte(dm, 0xa25, cck_swing_table_ch14_new[pwr_tracking_limit_cck][3]); + odm_write_1byte(dm, 0xa26, cck_swing_table_ch14_new[pwr_tracking_limit_cck][4]); + odm_write_1byte(dm, 0xa27, cck_swing_table_ch14_new[pwr_tracking_limit_cck][5]); + odm_write_1byte(dm, 0xa28, cck_swing_table_ch14_new[pwr_tracking_limit_cck][6]); + odm_write_1byte(dm, 0xa29, cck_swing_table_ch14_new[pwr_tracking_limit_cck][7]); + } + + cali_info->modify_tx_agc_flag_path_a_cck = true; + + PHY_SetTxPowerIndexByRateSection(adapter, RF_PATH_A, *dm->channel, CCK); + + } else if (final_cck_swing_index < 0) { /* Lowest CCK index = 0 */ + cali_info->remnant_cck_swing_idx = final_cck_swing_index; + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "******Path_A CCK Under Limit, pwr_tracking_limit_cck = %d, cali_info->remnant_cck_swing_idx = %d\n", 0, cali_info->remnant_cck_swing_idx); + + if (*dm->channel != 14) { + odm_write_1byte(dm, 0xa22, cck_swing_table_ch1_ch13_new[0][0]); + odm_write_1byte(dm, 0xa23, cck_swing_table_ch1_ch13_new[0][1]); + odm_write_1byte(dm, 0xa24, cck_swing_table_ch1_ch13_new[0][2]); + odm_write_1byte(dm, 0xa25, cck_swing_table_ch1_ch13_new[0][3]); + odm_write_1byte(dm, 0xa26, cck_swing_table_ch1_ch13_new[0][4]); + odm_write_1byte(dm, 0xa27, cck_swing_table_ch1_ch13_new[0][5]); + odm_write_1byte(dm, 0xa28, cck_swing_table_ch1_ch13_new[0][6]); + odm_write_1byte(dm, 0xa29, cck_swing_table_ch1_ch13_new[0][7]); + } else { + odm_write_1byte(dm, 0xa22, cck_swing_table_ch14_new[0][0]); + odm_write_1byte(dm, 0xa23, cck_swing_table_ch14_new[0][1]); + odm_write_1byte(dm, 0xa24, cck_swing_table_ch14_new[0][2]); + odm_write_1byte(dm, 0xa25, cck_swing_table_ch14_new[0][3]); + odm_write_1byte(dm, 0xa26, cck_swing_table_ch14_new[0][4]); + odm_write_1byte(dm, 0xa27, cck_swing_table_ch14_new[0][5]); + odm_write_1byte(dm, 0xa28, cck_swing_table_ch14_new[0][6]); + odm_write_1byte(dm, 0xa29, cck_swing_table_ch14_new[0][7]); + } + + cali_info->modify_tx_agc_flag_path_a_cck = true; + + PHY_SetTxPowerIndexByRateSection(adapter, RF_PATH_A, *dm->channel, CCK); + + } else { + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "******Path_A CCK Compensate with BBSwing, final_cck_swing_index = %d\n", final_cck_swing_index); + + if (*dm->channel != 14) { + odm_write_1byte(dm, 0xa22, cck_swing_table_ch1_ch13_new[final_cck_swing_index][0]); + odm_write_1byte(dm, 0xa23, cck_swing_table_ch1_ch13_new[final_cck_swing_index][1]); + odm_write_1byte(dm, 0xa24, cck_swing_table_ch1_ch13_new[final_cck_swing_index][2]); + odm_write_1byte(dm, 0xa25, cck_swing_table_ch1_ch13_new[final_cck_swing_index][3]); + odm_write_1byte(dm, 0xa26, cck_swing_table_ch1_ch13_new[final_cck_swing_index][4]); + odm_write_1byte(dm, 0xa27, cck_swing_table_ch1_ch13_new[final_cck_swing_index][5]); + odm_write_1byte(dm, 0xa28, cck_swing_table_ch1_ch13_new[final_cck_swing_index][6]); + odm_write_1byte(dm, 0xa29, cck_swing_table_ch1_ch13_new[final_cck_swing_index][7]); + } else { + odm_write_1byte(dm, 0xa22, cck_swing_table_ch14_new[final_cck_swing_index][0]); + odm_write_1byte(dm, 0xa23, cck_swing_table_ch14_new[final_cck_swing_index][1]); + odm_write_1byte(dm, 0xa24, cck_swing_table_ch14_new[final_cck_swing_index][2]); + odm_write_1byte(dm, 0xa25, cck_swing_table_ch14_new[final_cck_swing_index][3]); + odm_write_1byte(dm, 0xa26, cck_swing_table_ch14_new[final_cck_swing_index][4]); + odm_write_1byte(dm, 0xa27, cck_swing_table_ch14_new[final_cck_swing_index][5]); + odm_write_1byte(dm, 0xa28, cck_swing_table_ch14_new[final_cck_swing_index][6]); + odm_write_1byte(dm, 0xa29, cck_swing_table_ch14_new[final_cck_swing_index][7]); + } + + if (cali_info->modify_tx_agc_flag_path_a_cck) { /* If tx_agc has changed, reset tx_agc again */ + cali_info->remnant_cck_swing_idx = 0; + PHY_SetTxPowerIndexByRateSection(adapter, RF_PATH_A, *dm->channel, CCK); + cali_info->modify_tx_agc_flag_path_a_cck = false; + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "******Path_A dm->Modify_TxAGC_Flag_CCK = false\n"); + } + + } + } else + return; +} /* odm_TxPwrTrackSetPwr88E */ + +void +get_delta_swing_table_8188e( + void *dm_void, + u8 **temperature_up_a, + u8 **temperature_down_a, + u8 **temperature_up_b, + u8 **temperature_down_b +) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _ADAPTER *adapter = dm->adapter; + struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); + u8 tx_rate = 0xFF; + u8 channel = *dm->channel; + + if (*(dm->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 = *(dm->forced_data_rate); + + if (!rate) { /*auto rate*/ +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + tx_rate = ((PADAPTER)adapter)->HalFunc.GetHwRateFromMRateHandler(dm->tx_rate); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + tx_rate = hw_rate_to_m_rate(dm->tx_rate); +#endif + } else /*force rate*/ + tx_rate = (u8)rate; + } + + RF_DBG(dm, DBG_RF_TX_PWR_TRACK, "Power Tracking tx_rate=0x%X\n", tx_rate); + + if (1 <= channel && channel <= 14) { + if (IS_CCK_RATE(tx_rate)) { + *temperature_up_a = cali_info->delta_swing_table_idx_2g_cck_a_p; + *temperature_down_a = cali_info->delta_swing_table_idx_2g_cck_a_n; + } else { + *temperature_up_a = cali_info->delta_swing_table_idx_2ga_p; + *temperature_down_a = cali_info->delta_swing_table_idx_2ga_n; + } + } else { + *temperature_up_a = (u8 *)delta_swing_table_idx_2ga_p_8188e; + *temperature_down_a = (u8 *)delta_swing_table_idx_2ga_n_8188e; + } +} + +void configure_txpower_track_8188e( + struct txpwrtrack_cfg *config +) +{ + config->swing_table_size_cck = CCK_TABLE_SIZE; + config->swing_table_size_ofdm = OFDM_TABLE_SIZE; + config->threshold_iqk = IQK_THRESHOLD; + config->average_thermal_num = AVG_THERMAL_NUM_88E; + config->rf_path_count = MAX_PATH_NUM_8188E; + config->thermal_reg_addr = RF_T_METER_88E; + + config->odm_tx_pwr_track_set_pwr = odm_tx_pwr_track_set_pwr88_e; + config->do_iqk = do_iqk_8188e; + config->phy_lc_calibrate = halrf_lck_trigger; + config->get_delta_swing_table = get_delta_swing_table_8188e; +} + +/* 1 7. IQK */ +#define MAX_TOLERANCE 5 +#define IQK_DELAY_TIME 1 /* ms */ + +u8 /* bit0 = 1 => Tx OK, bit1 = 1 => Rx OK */ +phy_path_a_iqk_8188e( + + struct dm_struct *dm, + boolean config_path_b, + u32 ktimes +) +{ + u32 reg_eac, reg_e94, reg_e9c, reg_ea4; + u8 result = 0x00; + RF_DBG(dm, DBG_RF_IQK, "path A IQK!\n"); + + /* 1 Tx IQK */ + /* path-A IQK setting */ + RF_DBG(dm, DBG_RF_IQK, "path-A IQK setting!\n"); + odm_set_bb_reg(dm, REG_TX_IQK_TONE_A, MASKDWORD, 0x18008c1c); + odm_set_bb_reg(dm, REG_RX_IQK_TONE_A, MASKDWORD, 0x38008c1c); + odm_set_bb_reg(dm, REG_TX_IQK_PI_A, MASKDWORD, 0x821403ff); + odm_set_bb_reg(dm, REG_RX_IQK_PI_A, MASKDWORD, 0x28160000); + + if (ktimes == 0x0) { + /* LO calibration on */ + RF_DBG(dm, DBG_RF_IQK, "LO calibration setting!\n"); + odm_set_bb_reg(dm, REG_IQK_AGC_RSP, MASKDWORD, 0x00462911); + } else { + /* LO calibration off */ + RF_DBG(dm, DBG_RF_IQK, "LO calibration setting!\n"); + odm_set_bb_reg(dm, REG_IQK_AGC_RSP, MASKDWORD, 0x0046a911); + } + + /* TX IQK mode setting */ + odm_set_bb_reg(dm, REG_FPGA0_IQK, 0xffffff00, 0x000000); + odm_set_rf_reg(dm, RF_PATH_A, RF_WE_LUT, RFREGOFFSETMASK, 0x800a0); + odm_set_rf_reg(dm, RF_PATH_A, RF_RCK_OS, RFREGOFFSETMASK, 0x20000); + odm_set_rf_reg(dm, RF_PATH_A, RF_TXPA_G1, RFREGOFFSETMASK, 0x0000f); + odm_set_rf_reg(dm, RF_PATH_A, RF_TXPA_G2, RFREGOFFSETMASK, 0x07f7f); + + /* PA,PAD gain adjust */ + odm_set_rf_reg(dm, RF_PATH_A, RF_0xdf, RFREGOFFSETMASK, 0x980); + odm_set_rf_reg(dm, RF_PATH_A, RF_0x56, RFREGOFFSETMASK, 0x510f0); + + odm_set_bb_reg(dm, REG_FPGA0_IQK, 0xffffff00, 0x808000); + + /* One shot, path A LOK & IQK */ + RF_DBG(dm, DBG_RF_IQK, "One shot, path A LOK & IQK!\n"); + odm_set_bb_reg(dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf9000000); + odm_set_bb_reg(dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf8000000); + + if (ktimes == 0) { + /* delay x ms */ + RF_DBG(dm, DBG_RF_IQK, "delay %d ms for One shot, path A LOK & IQK.\n", IQK_DELAY_TIME_88E); + /* platform_stall_execution(IQK_DELAY_TIME_88E*1000); */ + ODM_delay_ms(IQK_DELAY_TIME_88E * 2); + + } else { + /* delay x ms */ + RF_DBG(dm, DBG_RF_IQK, "delay %d ms for One shot, path A LOK & IQK.\n", IQK_DELAY_TIME_88E); + /* platform_stall_execution(IQK_DELAY_TIME_88E*1000); */ + ODM_delay_ms(IQK_DELAY_TIME_88E); + + } + + /* reload RF 0xdf */ + odm_set_bb_reg(dm, REG_FPGA0_IQK, 0xffffff00, 0x000000); + odm_set_rf_reg(dm, RF_PATH_A, RF_0xdf, RFREGOFFSETMASK, 0x180); + + + + /* Check failed */ + reg_eac = odm_get_bb_reg(dm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xeac = 0x%x\n", reg_eac); + reg_e94 = odm_get_bb_reg(dm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xe94 = 0x%x\n", reg_e94); + reg_e9c = odm_get_bb_reg(dm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xe9c = 0x%x\n", reg_e9c); + reg_ea4 = odm_get_bb_reg(dm, REG_RX_POWER_BEFORE_IQK_A_2, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xea4 = 0x%x\n", reg_ea4); + + if (!(reg_eac & BIT(28)) && + (((reg_e94 & 0x03FF0000) >> 16) != 0x142) && + (((reg_e9c & 0x03FF0000) >> 16) != 0x42)) + result |= 0x01; + else /* if Tx not OK, ignore Rx */ + return result; + +#if 0 + if (!(reg_eac & BIT(27)) && /* if Tx is OK, check whether Rx is OK */ + (((reg_ea4 & 0x03FF0000) >> 16) != 0x132) && + (((reg_eac & 0x03FF0000) >> 16) != 0x36)) + result |= 0x02; + else + RT_DISP(FINIT, INIT_IQK, ("path A Rx IQK fail!!\n")); +#endif + + return result; + + +} + +u8 /* bit0 = 1 => Tx OK, bit1 = 1 => Rx OK */ +phy_path_a_rx_iqk( + struct dm_struct *dm, + boolean config_path_b +) +{ + u32 reg_eac, reg_e94, reg_e9c, reg_ea4, u4tmp; + u8 result = 0x00; + RF_DBG(dm, DBG_RF_IQK, "path A Rx IQK!\n"); + + /* 1 Get TXIMR setting */ + /* modify RXIQK mode table */ + RF_DBG(dm, DBG_RF_IQK, "path-A Rx IQK modify RXIQK mode table!\n"); + odm_set_bb_reg(dm, REG_FPGA0_IQK, 0xffffff00, 0x000000); + odm_set_rf_reg(dm, RF_PATH_A, RF_WE_LUT, RFREGOFFSETMASK, 0x800a0); + odm_set_rf_reg(dm, RF_PATH_A, RF_RCK_OS, RFREGOFFSETMASK, 0x30000); + odm_set_rf_reg(dm, RF_PATH_A, RF_TXPA_G1, RFREGOFFSETMASK, 0x0000f); + odm_set_rf_reg(dm, RF_PATH_A, RF_TXPA_G2, RFREGOFFSETMASK, 0xf117b); + + /* PA,PAD gain adjust */ + odm_set_rf_reg(dm, RF_PATH_A, RF_0xdf, RFREGOFFSETMASK, 0x980); + odm_set_rf_reg(dm, RF_PATH_A, RF_0x56, RFREGOFFSETMASK, 0x510f0); + + odm_set_bb_reg(dm, REG_FPGA0_IQK, 0xffffff00, 0x808000); + + /* IQK setting */ + odm_set_bb_reg(dm, REG_TX_IQK, MASKDWORD, 0x01007c00); + odm_set_bb_reg(dm, REG_RX_IQK, MASKDWORD, 0x81004800); + + /* path-A IQK setting */ + odm_set_bb_reg(dm, REG_TX_IQK_TONE_A, MASKDWORD, 0x18008c1c); + odm_set_bb_reg(dm, REG_RX_IQK_TONE_A, MASKDWORD, 0x38008c1c); + odm_set_bb_reg(dm, REG_TX_IQK_PI_A, MASKDWORD, 0x82160fff); + odm_set_bb_reg(dm, REG_RX_IQK_PI_A, MASKDWORD, 0x28160000); + + /* LO calibration setting */ + RF_DBG(dm, DBG_RF_IQK, "LO calibration setting!\n"); + odm_set_bb_reg(dm, REG_IQK_AGC_RSP, MASKDWORD, 0x0046a911); + + /* One shot, path A LOK & IQK */ + RF_DBG(dm, DBG_RF_IQK, "One shot, path A LOK & IQK!\n"); + odm_set_bb_reg(dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf9000000); + odm_set_bb_reg(dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf8000000); + + /* delay x ms */ + RF_DBG(dm, DBG_RF_IQK, "delay %d ms for One shot, path A LOK & IQK.\n", IQK_DELAY_TIME_88E); + /* platform_stall_execution(IQK_DELAY_TIME_88E*1000); */ + ODM_delay_ms(IQK_DELAY_TIME_88E); + + /* reload RF 0xdf */ + odm_set_bb_reg(dm, REG_FPGA0_IQK, 0xffffff00, 0x000000); + odm_set_rf_reg(dm, RF_PATH_A, RF_0xdf, RFREGOFFSETMASK, 0x180); + + /* Check failed */ + reg_eac = odm_get_bb_reg(dm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xeac = 0x%x\n", reg_eac); + reg_e94 = odm_get_bb_reg(dm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xe94 = 0x%x\n", reg_e94); + reg_e9c = odm_get_bb_reg(dm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xe9c = 0x%x\n", reg_e9c); + + if (!(reg_eac & BIT(28)) && + (((reg_e94 & 0x03FF0000) >> 16) != 0x142) && + (((reg_e9c & 0x03FF0000) >> 16) != 0x42)) + result |= 0x01; + else /* if Tx not OK, ignore Rx */ + return result; + + u4tmp = 0x80007C00 | (reg_e94 & 0x3FF0000) | ((reg_e9c & 0x3FF0000) >> 16); + odm_set_bb_reg(dm, REG_TX_IQK, MASKDWORD, u4tmp); + RF_DBG(dm, DBG_RF_IQK, "0xe40 = 0x%x u4tmp = 0x%x\n", odm_get_bb_reg(dm, REG_TX_IQK, MASKDWORD), u4tmp); + + + /* 1 RX IQK */ + /* modify RXIQK mode table */ + RF_DBG(dm, DBG_RF_IQK, "path-A Rx IQK modify RXIQK mode table 2!\n"); + odm_set_bb_reg(dm, REG_FPGA0_IQK, 0xffffff00, 0x000000); + odm_set_rf_reg(dm, RF_PATH_A, RF_WE_LUT, RFREGOFFSETMASK, 0x800a0); + odm_set_rf_reg(dm, RF_PATH_A, RF_RCK_OS, RFREGOFFSETMASK, 0x30000); + odm_set_rf_reg(dm, RF_PATH_A, RF_TXPA_G1, RFREGOFFSETMASK, 0x0000f); + odm_set_rf_reg(dm, RF_PATH_A, RF_TXPA_G2, RFREGOFFSETMASK, 0xf7ffa); + + /* PA,PAD gain adjust */ + odm_set_rf_reg(dm, RF_PATH_A, RF_0xdf, RFREGOFFSETMASK, 0x980); + odm_set_rf_reg(dm, RF_PATH_A, RF_0x56, RFREGOFFSETMASK, 0x51000); + + odm_set_bb_reg(dm, REG_FPGA0_IQK, 0xffffff00, 0x808000); + + /* IQK setting */ + odm_set_bb_reg(dm, REG_RX_IQK, MASKDWORD, 0x01004800); + + /* path-A IQK setting */ + odm_set_bb_reg(dm, REG_TX_IQK_TONE_A, MASKDWORD, 0x38008c1c); + odm_set_bb_reg(dm, REG_RX_IQK_TONE_A, MASKDWORD, 0x18008c1c); + odm_set_bb_reg(dm, REG_TX_IQK_PI_A, MASKDWORD, 0x82160000); + odm_set_bb_reg(dm, REG_RX_IQK_PI_A, MASKDWORD, 0x28160fff); + + /* LO calibration setting */ + RF_DBG(dm, DBG_RF_IQK, "LO calibration setting!\n"); + odm_set_bb_reg(dm, REG_IQK_AGC_RSP, MASKDWORD, 0x0046a911); + + /* One shot, path A LOK & IQK */ + RF_DBG(dm, DBG_RF_IQK, "One shot, path A LOK & IQK!\n"); + odm_set_bb_reg(dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf9000000); + odm_set_bb_reg(dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf8000000); + + /* delay x ms */ + RF_DBG(dm, DBG_RF_IQK, "delay %d ms for One shot, path A LOK & IQK.\n", IQK_DELAY_TIME_88E); + /* platform_stall_execution(IQK_DELAY_TIME_88E*1000); */ + ODM_delay_ms(IQK_DELAY_TIME_88E); + + /* reload RF 0xdf */ + odm_set_bb_reg(dm, REG_FPGA0_IQK, 0xffffff00, 0x000000); + odm_set_rf_reg(dm, RF_PATH_A, RF_0xdf, RFREGOFFSETMASK, 0x180); + + /* Check failed */ + reg_eac = odm_get_bb_reg(dm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xeac = 0x%x\n", reg_eac); + reg_e94 = odm_get_bb_reg(dm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xe94 = 0x%x\n", reg_e94); + reg_e9c = odm_get_bb_reg(dm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xe9c = 0x%x\n", reg_e9c); + reg_ea4 = odm_get_bb_reg(dm, REG_RX_POWER_BEFORE_IQK_A_2, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xea4 = 0x%x\n", reg_ea4); + +#if 0 + if (!(reg_eac & BIT(28)) && + (((reg_e94 & 0x03FF0000) >> 16) != 0x142) && + (((reg_e9c & 0x03FF0000) >> 16) != 0x42)) + result |= 0x01; + else /* if Tx not OK, ignore Rx */ + return result; +#endif + + if (!(reg_eac & BIT(27)) && /* if Tx is OK, check whether Rx is OK */ + (((reg_ea4 & 0x03FF0000) >> 16) != 0x132) && + (((reg_eac & 0x03FF0000) >> 16) != 0x36)) + result |= 0x02; + else + RF_DBG(dm, DBG_RF_IQK, "path A Rx IQK fail!!\n"); + + return result; + + +} + +u8 /* bit0 = 1 => Tx OK, bit1 = 1 => Rx OK */ +phy_path_b_iqk_8188e( + struct dm_struct *dm +) +{ + u32 reg_eac, reg_eb4, reg_ebc, reg_ec4, reg_ecc; + u8 result = 0x00; + RF_DBG(dm, DBG_RF_IQK, "path B IQK!\n"); + + /* One shot, path B LOK & IQK */ + RF_DBG(dm, DBG_RF_IQK, "One shot, path A LOK & IQK!\n"); + odm_set_bb_reg(dm, REG_IQK_AGC_CONT, MASKDWORD, 0x00000002); + odm_set_bb_reg(dm, REG_IQK_AGC_CONT, MASKDWORD, 0x00000000); + + /* delay x ms */ + RF_DBG(dm, DBG_RF_IQK, "delay %d ms for One shot, path B LOK & IQK.\n", IQK_DELAY_TIME_88E); + /* platform_stall_execution(IQK_DELAY_TIME_88E*1000); */ + ODM_delay_ms(IQK_DELAY_TIME_88E); + + /* Check failed */ + reg_eac = odm_get_bb_reg(dm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xeac = 0x%x\n", reg_eac); + reg_eb4 = odm_get_bb_reg(dm, REG_TX_POWER_BEFORE_IQK_B, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xeb4 = 0x%x\n", reg_eb4); + reg_ebc = odm_get_bb_reg(dm, REG_TX_POWER_AFTER_IQK_B, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xebc = 0x%x\n", reg_ebc); + reg_ec4 = odm_get_bb_reg(dm, REG_RX_POWER_BEFORE_IQK_B_2, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xec4 = 0x%x\n", reg_ec4); + reg_ecc = odm_get_bb_reg(dm, REG_RX_POWER_AFTER_IQK_B_2, MASKDWORD); + RF_DBG(dm, DBG_RF_IQK, "0xecc = 0x%x\n", reg_ecc); + + if (!(reg_eac & BIT(31)) && + (((reg_eb4 & 0x03FF0000) >> 16) != 0x142) && + (((reg_ebc & 0x03FF0000) >> 16) != 0x42)) + result |= 0x01; + else + return result; + + if (!(reg_eac & BIT(30)) && + (((reg_ec4 & 0x03FF0000) >> 16) != 0x132) && + (((reg_ecc & 0x03FF0000) >> 16) != 0x36)) + result |= 0x02; + else + RF_DBG(dm, DBG_RF_IQK, "path B Rx IQK fail!!\n"); + + + return result; + +} + +void +_phy_path_a_fill_iqk_matrix( + struct dm_struct *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; + RF_DBG(dm, DBG_RF_IQK, "path A 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(dm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKDWORD) >> 22) & 0x3FF; + + X = result[final_candidate][0]; + if ((X & 0x00000200) != 0) + X = X | 0xFFFFFC00; + TX0_A = (X * oldval_0) >> 8; + RF_DBG(dm, DBG_RF_IQK, "X = 0x%x, TX0_A = 0x%x, oldval_0 0x%x\n", X, TX0_A, oldval_0); + odm_set_bb_reg(dm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, 0x3FF, TX0_A); + + odm_set_bb_reg(dm, REG_OFDM_0_ECCA_THRESHOLD, BIT(31), ((X * oldval_0 >> 7) & 0x1)); + + Y = result[final_candidate][1]; + if ((Y & 0x00000200) != 0) + Y = Y | 0xFFFFFC00; + + + TX0_C = (Y * oldval_0) >> 8; + RF_DBG(dm, DBG_RF_IQK, "Y = 0x%x, TX = 0x%x\n", Y, TX0_C); + odm_set_bb_reg(dm, REG_OFDM_0_XC_TX_AFE, 0xF0000000, ((TX0_C & 0x3C0) >> 6)); + odm_set_bb_reg(dm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, 0x003F0000, (TX0_C & 0x3F)); + + odm_set_bb_reg(dm, REG_OFDM_0_ECCA_THRESHOLD, BIT(29), ((Y * oldval_0 >> 7) & 0x1)); + + if (is_tx_only) { + RF_DBG(dm, DBG_RF_IQK, "_phy_path_a_fill_iqk_matrix 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(dm, REG_OFDM_0_XA_RX_IQ_IMBALANCE, 0x3FF, reg); + + reg = result[final_candidate][3] & 0x3F; + odm_set_bb_reg(dm, REG_OFDM_0_XA_RX_IQ_IMBALANCE, 0xFC00, reg); + + reg = (result[final_candidate][3] >> 6) & 0xF; + odm_set_bb_reg(dm, REG_OFDM_0_RX_IQ_EXT_ANTA, 0xF0000000, reg); + } +} + +void +_phy_path_b_fill_iqk_matrix( + struct dm_struct *dm, + boolean is_iqk_ok, + s32 result[][8], + u8 final_candidate, + boolean is_tx_only /* do Tx only */ +) +{ + u32 oldval_1, X, TX1_A, reg; + s32 Y, TX1_C; + + RF_DBG(dm, DBG_RF_IQK, "path B 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(dm, REG_OFDM_0_XB_TX_IQ_IMBALANCE, MASKDWORD) >> 22) & 0x3FF; + + X = result[final_candidate][4]; + if ((X & 0x00000200) != 0) + X = X | 0xFFFFFC00; + TX1_A = (X * oldval_1) >> 8; + RF_DBG(dm, DBG_RF_IQK, "X = 0x%x, TX1_A = 0x%x\n", X, TX1_A); + odm_set_bb_reg(dm, REG_OFDM_0_XB_TX_IQ_IMBALANCE, 0x3FF, TX1_A); + + odm_set_bb_reg(dm, REG_OFDM_0_ECCA_THRESHOLD, BIT(27), ((X * oldval_1 >> 7) & 0x1)); + + Y = result[final_candidate][5]; + if ((Y & 0x00000200) != 0) + Y = Y | 0xFFFFFC00; + + TX1_C = (Y * oldval_1) >> 8; + RF_DBG(dm, DBG_RF_IQK, "Y = 0x%x, TX1_C = 0x%x\n", Y, TX1_C); + odm_set_bb_reg(dm, REG_OFDM_0_XD_TX_AFE, 0xF0000000, ((TX1_C & 0x3C0) >> 6)); + odm_set_bb_reg(dm, REG_OFDM_0_XB_TX_IQ_IMBALANCE, 0x003F0000, (TX1_C & 0x3F)); + + odm_set_bb_reg(dm, REG_OFDM_0_ECCA_THRESHOLD, BIT(25), ((Y * oldval_1 >> 7) & 0x1)); + + if (is_tx_only) + return; + + reg = result[final_candidate][6]; + odm_set_bb_reg(dm, REG_OFDM_0_XB_RX_IQ_IMBALANCE, 0x3FF, reg); + + reg = result[final_candidate][7] & 0x3F; + odm_set_bb_reg(dm, REG_OFDM_0_XB_RX_IQ_IMBALANCE, 0xFC00, reg); + + reg = (result[final_candidate][7] >> 6) & 0xF; + odm_set_bb_reg(dm, REG_OFDM_0_AGC_RSSI_TABLE, 0x0000F000, reg); + } +} + +void +_phy_save_adda_registers( + struct dm_struct *dm, + u32 *adda_reg, + u32 *adda_backup, + u32 register_num +) +{ + u32 i; + + if (odm_check_power_status(dm) == false) + return; + RF_DBG(dm, DBG_RF_IQK, "Save ADDA parameters.\n"); + for (i = 0 ; i < register_num ; i++) + adda_backup[i] = odm_get_bb_reg(dm, adda_reg[i], MASKDWORD); +} + + +void +_phy_save_mac_registers( + struct dm_struct *dm, + u32 *mac_reg, + u32 *mac_backup +) +{ + u32 i; + + RF_DBG(dm, DBG_RF_IQK, "Save MAC parameters.\n"); + for (i = 0 ; i < (IQK_MAC_REG_NUM - 1); i++) + mac_backup[i] = odm_read_1byte(dm, mac_reg[i]); + mac_backup[i] = odm_read_4byte(dm, mac_reg[i]); + +} + + +void +_phy_reload_adda_registers( + struct dm_struct *dm, + u32 *adda_reg, + u32 *adda_backup, + u32 regiester_num +) +{ + u32 i; + + RF_DBG(dm, DBG_RF_IQK, "Reload ADDA power saving parameters !\n"); + for (i = 0 ; i < regiester_num; i++) + odm_set_bb_reg(dm, adda_reg[i], MASKDWORD, adda_backup[i]); +} + +void +_phy_reload_mac_registers( + struct dm_struct *dm, + u32 *mac_reg, + u32 *mac_backup +) +{ + u32 i; + + RF_DBG(dm, DBG_RF_IQK, "Reload MAC parameters !\n"); + for (i = 0 ; i < (IQK_MAC_REG_NUM - 1); i++) + odm_write_1byte(dm, mac_reg[i], (u8)mac_backup[i]); + odm_write_4byte(dm, mac_reg[i], mac_backup[i]); +} + + +void +_phy_path_adda_on( + struct dm_struct *dm, + u32 *adda_reg, + boolean is_path_a_on, + boolean is2T +) +{ + u32 path_on; + u32 i; + + RF_DBG(dm, DBG_RF_IQK, "ADDA ON.\n"); + + path_on = is_path_a_on ? 0x04db25a4 : 0x0b1b25a4; + if (false == is2T) { + path_on = 0x0bdb25a0; + odm_set_bb_reg(dm, adda_reg[0], MASKDWORD, 0x0b1b25a0); + } else + odm_set_bb_reg(dm, adda_reg[0], MASKDWORD, path_on); + + for (i = 1 ; i < IQK_ADDA_REG_NUM ; i++) + odm_set_bb_reg(dm, adda_reg[i], MASKDWORD, path_on); + +} + +void +_phy_mac_setting_calibration( + + struct dm_struct *dm, + u32 *mac_reg, + u32 *mac_backup +) +{ + u32 i = 0; + + RF_DBG(dm, DBG_RF_IQK, "MAC settings for Calibration.\n"); + + odm_write_1byte(dm, mac_reg[i], 0x3F); + + for (i = 1 ; i < (IQK_MAC_REG_NUM - 1); i++) + odm_write_1byte(dm, mac_reg[i], (u8)(mac_backup[i] & (~BIT(3)))); + odm_write_1byte(dm, mac_reg[i], (u8)(mac_backup[i] & (~BIT(5)))); + +} + +void +_phy_path_a_stand_by( + struct dm_struct *dm +) +{ + RF_DBG(dm, DBG_RF_IQK, "path-A standby mode!\n"); + + odm_set_bb_reg(dm, REG_FPGA0_IQK, 0xffffff00, 0x000000); + odm_set_bb_reg(dm, R_0x840, MASKDWORD, 0x00010000); + odm_set_bb_reg(dm, REG_FPGA0_IQK, 0xffffff00, 0x808000); +} + +void +_phy_pi_mode_switch( + struct dm_struct *dm, + boolean pi_mode +) +{ + u32 mode; + + RF_DBG(dm, DBG_RF_IQK, "BB Switch to %s mode!\n", (pi_mode ? "PI" : "SI")); + + mode = pi_mode ? 0x01000100 : 0x01000000; + odm_set_bb_reg(dm, REG_FPGA0_XA_HSSI_PARAMETER1, MASKDWORD, mode); + odm_set_bb_reg(dm, REG_FPGA0_XB_HSSI_PARAMETER1, MASKDWORD, mode); +} + +boolean +phy_simularity_compare_8188e( + struct dm_struct *dm, + s32 result[][8], + u8 c1, + u8 c2 +) +{ + u32 i, j, diff, simularity_bit_map, bound = 0; + u8 final_candidate[2] = {0xFF, 0xFF}; /* for path A and path B */ + boolean is_result = true; + boolean is2T = false; + + if (is2T) + bound = 8; + else + bound = 4; + + RF_DBG(dm, DBG_RF_IQK, "===> IQK:phy_simularity_compare_8188e c1 %d c2 %d!!!\n", c1, c2); + + + simularity_bit_map = 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) { + RF_DBG(dm, DBG_RF_IQK, "IQK:phy_simularity_compare_8188e differnece overflow index %d compare1 0x%x compare2 0x%x!!!\n", 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); + } + } + + RF_DBG(dm, DBG_RF_IQK, "IQK:phy_simularity_compare_8188e simularity_bit_map %d !!!\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 & 0x0F)) { /* path A OK */ + for (i = 0; i < 4; i++) + result[3][i] = result[c1][i]; + return false; + } else if (!(simularity_bit_map & 0xF0) && is2T) { /* path B OK */ + for (i = 4; i < 8; i++) + result[3][i] = result[c1][i]; + return false; + } else + return false; + +} + + + +void +_phy_iq_calibrate_8188e( + struct dm_struct *dm, + s32 result[][8], + u8 t, + boolean is2T +) +{ + struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); + u32 i; + u8 path_aok, path_bok; + 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 + }; + + /* since 92C & 92D have the different define in IQK_BB_REG */ + 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 + }; + +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + u32 retry_count = 2; +#else +#if MP_DRIVER + const u32 retry_count = 2; +#else + const u32 retry_count = 2; +#endif +#endif + + /* Note: IQ calibration must be performed after loading */ + /* PHY_REG.txt , and radio_a, radio_b.txt */ + + /* u32 bbvalue; */ + +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) +#ifdef MP_TEST + if (*(dm->mp_mode)) + retry_count = 9; +#endif +#endif + + + if (t == 0) { + /* bbvalue = odm_get_bb_reg(dm, REG_FPGA0_RFMOD, MASKDWORD); + * RT_DISP(FINIT, INIT_IQK, ("_phy_iq_calibrate_8188e()==>0x%08x\n",bbvalue)); */ + + RF_DBG(dm, DBG_RF_IQK, "IQ Calibration for %s for %d times\n", (is2T ? "2T2R" : "1T1R"), t); + + /* Save ADDA parameters, turn path A ADDA on */ + _phy_save_adda_registers(dm, ADDA_REG, cali_info->ADDA_backup, IQK_ADDA_REG_NUM); + _phy_save_mac_registers(dm, IQK_MAC_REG, cali_info->IQK_MAC_backup); + _phy_save_adda_registers(dm, IQK_BB_REG_92C, cali_info->IQK_BB_backup, IQK_BB_REG_NUM); + } + RF_DBG(dm, DBG_RF_IQK, "IQ Calibration for %s for %d times\n", (is2T ? "2T2R" : "1T1R"), t); + + _phy_path_adda_on(dm, ADDA_REG, true, is2T); + + if (t == 0) + cali_info->is_rf_pi_enable = (u8)odm_get_bb_reg(dm, REG_FPGA0_XA_HSSI_PARAMETER1, BIT(8)); + + if (!cali_info->is_rf_pi_enable) { + /* Switch BB to PI mode to do IQ Calibration. */ + _phy_pi_mode_switch(dm, true); + } + + /* MAC settings */ + _phy_mac_setting_calibration(dm, IQK_MAC_REG, cali_info->IQK_MAC_backup); + + /* BB setting */ + /* odm_set_bb_reg(dm, REG_FPGA0_RFMOD, BIT24, 0x00); */ + odm_set_bb_reg(dm, REG_CCK_0_AFE_SETTING, 0x0f000000, 0xf); + odm_set_bb_reg(dm, REG_OFDM_0_TRX_PATH_ENABLE, MASKDWORD, 0x03a05600); + odm_set_bb_reg(dm, REG_OFDM_0_TR_MUX_PAR, MASKDWORD, 0x000800e4); + odm_set_bb_reg(dm, REG_FPGA0_XCD_RF_INTERFACE_SW, MASKDWORD, 0x22204000); + + + odm_set_bb_reg(dm, REG_FPGA0_XAB_RF_INTERFACE_SW, BIT(10), 0x01); + odm_set_bb_reg(dm, REG_FPGA0_XAB_RF_INTERFACE_SW, BIT(26), 0x01); + odm_set_bb_reg(dm, REG_FPGA0_XA_RF_INTERFACE_OE, BIT(10), 0x00); + odm_set_bb_reg(dm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(10), 0x00); + + + if (is2T) { + odm_set_bb_reg(dm, REG_FPGA0_XA_LSSI_PARAMETER, MASKDWORD, 0x00010000); + odm_set_bb_reg(dm, REG_FPGA0_XB_LSSI_PARAMETER, MASKDWORD, 0x00010000); + } + + + + + /* Page B init */ + /* AP or IQK */ + odm_set_bb_reg(dm, REG_CONFIG_ANT_A, MASKDWORD, 0x0f600000); + + if (is2T) + odm_set_bb_reg(dm, REG_CONFIG_ANT_B, MASKDWORD, 0x0f600000); + + /* IQ calibration setting */ + RF_DBG(dm, DBG_RF_IQK, "IQK setting!\n"); + odm_set_bb_reg(dm, REG_FPGA0_IQK, 0xffffff00, 0x808000); + odm_set_bb_reg(dm, REG_TX_IQK, MASKDWORD, 0x01007c00); + odm_set_bb_reg(dm, REG_RX_IQK, MASKDWORD, 0x81004800); + + + for (i = 0 ; i < retry_count ; i++) { + path_aok = phy_path_a_iqk_8188e(dm, is2T, t + i); + + /* if(path_aok == 0x03){ */ + if (path_aok == 0x01) { + RF_DBG(dm, DBG_RF_IQK, "path A Tx IQK Success!!\n"); + result[t][0] = (odm_get_bb_reg(dm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD) & 0x3FF0000) >> 16; + result[t][1] = (odm_get_bb_reg(dm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD) & 0x3FF0000) >> 16; + break; + } +#if 0 + else if (i == (retry_count - 1) && path_aok == 0x01) { /* Tx IQK OK */ + RT_DISP(FINIT, INIT_IQK, ("path A IQK Only Tx Success!!\n")); + + result[t][0] = (odm_get_bb_reg(dm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD) & 0x3FF0000) >> 16; + result[t][1] = (odm_get_bb_reg(dm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD) & 0x3FF0000) >> 16; + } +#endif + } + + for (i = 0 ; i < retry_count ; i++) { + path_aok = phy_path_a_rx_iqk(dm, is2T); + + if (path_aok == 0x03) { + RF_DBG(dm, DBG_RF_IQK, "path A Rx IQK Success!!\n"); + /* result[t][0] = (odm_get_bb_reg(dm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD)&0x3FF0000)>>16; + * result[t][1] = (odm_get_bb_reg(dm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD)&0x3FF0000)>>16; */ + result[t][2] = (odm_get_bb_reg(dm, REG_RX_POWER_BEFORE_IQK_A_2, MASKDWORD) & 0x3FF0000) >> 16; + result[t][3] = (odm_get_bb_reg(dm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD) & 0x3FF0000) >> 16; + break; + } else + RF_DBG(dm, DBG_RF_IQK, "path A Rx IQK Fail!!\n"); + } + + if (0x00 == path_aok) + RF_DBG(dm, DBG_RF_IQK, "path A IQK failed!!\n"); + + if (is2T) { + _phy_path_a_stand_by(dm); + + /* Turn path B ADDA on */ + _phy_path_adda_on(dm, ADDA_REG, false, is2T); + + for (i = 0 ; i < retry_count ; i++) { + path_bok = phy_path_b_iqk_8188e(dm); + + if (path_bok == 0x03) { + RF_DBG(dm, DBG_RF_IQK, "path B IQK Success!!\n"); + result[t][4] = (odm_get_bb_reg(dm, REG_TX_POWER_BEFORE_IQK_B, MASKDWORD) & 0x3FF0000) >> 16; + result[t][5] = (odm_get_bb_reg(dm, REG_TX_POWER_AFTER_IQK_B, MASKDWORD) & 0x3FF0000) >> 16; + result[t][6] = (odm_get_bb_reg(dm, REG_RX_POWER_BEFORE_IQK_B_2, MASKDWORD) & 0x3FF0000) >> 16; + result[t][7] = (odm_get_bb_reg(dm, REG_RX_POWER_AFTER_IQK_B_2, MASKDWORD) & 0x3FF0000) >> 16; + break; + } else if (i == (retry_count - 1) && path_bok == 0x01) { /* Tx IQK OK */ + RF_DBG(dm, DBG_RF_IQK, "path B Only Tx IQK Success!!\n"); + result[t][4] = (odm_get_bb_reg(dm, REG_TX_POWER_BEFORE_IQK_B, MASKDWORD) & 0x3FF0000) >> 16; + result[t][5] = (odm_get_bb_reg(dm, REG_TX_POWER_AFTER_IQK_B, MASKDWORD) & 0x3FF0000) >> 16; + } + } + + if (0x00 == path_bok) + RF_DBG(dm, DBG_RF_IQK, "path B IQK failed!!\n"); + } + + /* Back to BB mode, load original value */ + RF_DBG(dm, DBG_RF_IQK, "IQK:Back to BB mode, load original value!\n"); + odm_set_bb_reg(dm, REG_FPGA0_IQK, 0xffffff00, 0x000000); + + if (t != 0) { + if (!cali_info->is_rf_pi_enable) { + /* Switch back BB to SI mode after finish IQ Calibration. */ + _phy_pi_mode_switch(dm, false); + } + /* Reload ADDA power saving parameters */ + _phy_reload_adda_registers(dm, ADDA_REG, cali_info->ADDA_backup, IQK_ADDA_REG_NUM); + /* Reload MAC parameters */ + _phy_reload_mac_registers(dm, IQK_MAC_REG, cali_info->IQK_MAC_backup); + _phy_reload_adda_registers(dm, IQK_BB_REG_92C, cali_info->IQK_BB_backup, IQK_BB_REG_NUM); + + /* Restore RX initial gain */ + odm_set_bb_reg(dm, REG_FPGA0_XA_LSSI_PARAMETER, MASKDWORD, 0x00032ed3); + if (is2T) + odm_set_bb_reg(dm, REG_FPGA0_XB_LSSI_PARAMETER, MASKDWORD, 0x00032ed3); + + /* load 0xe30 IQC default value */ + odm_set_bb_reg(dm, REG_TX_IQK_TONE_A, MASKDWORD, 0x01008c00); + odm_set_bb_reg(dm, REG_RX_IQK_TONE_A, MASKDWORD, 0x01008c00); + + } + RF_DBG(dm, DBG_RF_IQK, "_phy_iq_calibrate_8188e() <==\n"); + +} + + +void +_phy_lc_calibrate_8188e( + struct dm_struct *dm, + boolean is2T +) +{ + u8 tmp_reg; + u32 rf_amode = 0, rf_bmode = 0, lc_cal; + + /* Check continuous TX and Packet TX */ + tmp_reg = odm_read_1byte(dm, 0xd03); + + if ((tmp_reg & 0x70) != 0) /* Deal with contisuous TX case */ + odm_write_1byte(dm, 0xd03, tmp_reg & 0x8F); /* disable all continuous TX */ + else /* Deal with Packet TX case */ + odm_write_1byte(dm, REG_TXPAUSE, 0xFF); /* block all queues */ + + if ((tmp_reg & 0x70) != 0) { + /* 1. Read original RF mode */ + /* path-A */ +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) + rf_amode = odm_get_rf_reg(dm, RF_PATH_A, RF_AC, MASK12BITS); + + /* path-B */ + if (is2T) + rf_bmode = odm_get_rf_reg(dm, RF_PATH_B, RF_AC, MASK12BITS); +#else + rf_amode = odm_get_rf_reg(dm, RF_PATH_A, RF_AC, MASK12BITS); + + /* path-B */ + if (is2T) + rf_bmode = odm_get_rf_reg(dm, RF_PATH_B, RF_AC, MASK12BITS); +#endif + + /* 2. Set RF mode = standby mode */ + /* path-A */ + odm_set_rf_reg(dm, RF_PATH_A, RF_AC, MASK12BITS, (rf_amode & 0x8FFFF) | 0x10000); + + /* path-B */ + if (is2T) + odm_set_rf_reg(dm, RF_PATH_B, RF_AC, MASK12BITS, (rf_bmode & 0x8FFFF) | 0x10000); + } + + /* 3. Read RF reg18 */ +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) + lc_cal = odm_get_rf_reg(dm, RF_PATH_A, RF_CHNLBW, MASK12BITS); +#else + lc_cal = odm_get_rf_reg(dm, RF_PATH_A, RF_CHNLBW, MASK12BITS); +#endif + + /* 4. Set LC calibration begin bit15 */ + odm_set_rf_reg(dm, RF_PATH_A, RF_CHNLBW, MASK12BITS, lc_cal | 0x08000); + + ODM_delay_ms(100); + + + /* Restore original situation */ + if ((tmp_reg & 0x70) != 0) { /* Deal with contisuous TX case */ + /* path-A */ + odm_write_1byte(dm, 0xd03, tmp_reg); + odm_set_rf_reg(dm, RF_PATH_A, RF_AC, MASK12BITS, rf_amode); + + /* path-B */ + if (is2T) + odm_set_rf_reg(dm, RF_PATH_B, RF_AC, MASK12BITS, rf_bmode); + } else /* Deal with Packet TX case */ + odm_write_1byte(dm, REG_TXPAUSE, 0x00); +} + +/* 20131031*/ +/* IQK:0x14*/ +/* 1.fine tune TXIQK/RXIQK loop gain for SMIC.*/ +/* 2.LOK only perform 1 time.*/ +/* 3.IQK retry count 10-->2 */ +void +phy_iq_calibrate_8188e( + void *dm_void, + boolean is_recovery +) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); + + s32 result[4][8]; /* last is final result */ + u8 i, final_candidate, indexforchannel; + boolean is_patha_ok, is_pathb_ok; + s32 rege94, rege9c, regea4, regeac, regeb4, regebc, regec4, regecc, reg_tmp = 0; + 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 + }; + +#if (DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_AP)) + if (is_recovery) +#else/* for ODM_WIN */ + if (is_recovery && (!dm->is_in_hct_test)) /* YJ,add for PowerTest,120405 */ +#endif + { + RF_DBG(dm, DBG_RF_INIT, "phy_iq_calibrate_8188e: Return due to is_recovery!\n"); + _phy_reload_adda_registers(dm, IQK_BB_REG_92C, cali_info->IQK_BB_backup_recover, 9); + return; + } + RF_DBG(dm, DBG_RF_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; + is_patha_ok = false; + is_pathb_ok = false; + is12simular = false; + is23simular = false; + is13simular = false; + + + for (i = 0; i < 3; i++) { + _phy_iq_calibrate_8188e(dm, result, i, false); + + if (i == 1) { + is12simular = phy_simularity_compare_8188e(dm, result, 0, 1); + if (is12simular) { + final_candidate = 0; + RF_DBG(dm, DBG_RF_IQK, "IQK: is12simular final_candidate is %x\n", final_candidate); + break; + } + } + + if (i == 2) { + is13simular = phy_simularity_compare_8188e(dm, result, 0, 2); + if (is13simular) { + final_candidate = 0; + RF_DBG(dm, DBG_RF_IQK, "IQK: is13simular final_candidate is %x\n", final_candidate); + + break; + } + is23simular = phy_simularity_compare_8188e(dm, result, 1, 2); + if (is23simular) { + final_candidate = 1; + RF_DBG(dm, DBG_RF_IQK, "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; + } + } + } + /* RT_TRACE(COMP_INIT,DBG_LOUD,("Release Mutex in IQCalibrate\n")); */ + + 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]; + RF_DBG(dm, DBG_RF_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) { + cali_info->rege94 = rege94 = result[final_candidate][0]; + cali_info->rege9c = rege9c = result[final_candidate][1]; + regea4 = result[final_candidate][2]; + regeac = result[final_candidate][3]; + cali_info->regeb4 = regeb4 = result[final_candidate][4]; + cali_info->regebc = regebc = result[final_candidate][5]; + regec4 = result[final_candidate][6]; + regecc = result[final_candidate][7]; + RF_DBG(dm, DBG_RF_IQK, "IQK: final_candidate is %x\n", final_candidate); + RF_DBG(dm, DBG_RF_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); + is_patha_ok = is_pathb_ok = true; + } else { + RF_DBG(dm, DBG_RF_IQK, "IQK: FAIL use default value\n"); + + cali_info->rege94 = cali_info->regeb4 = 0x100; /* X default value */ + cali_info->rege9c = cali_info->regebc = 0x0; /* Y default value */ + } + + if ((rege94 != 0)/*&&(regea4 != 0)*/) + _phy_path_a_fill_iqk_matrix(dm, is_patha_ok, result, final_candidate, (regea4 == 0)); + + + indexforchannel = odm_get_right_chnl_place_for_iqk(*dm->channel); + + /* To Fix BSOD when final_candidate is 0xff + * by sherry 20120321 */ + if (final_candidate < 4) { + for (i = 0; i < iqk_matrix_reg_num; i++) + cali_info->iqk_matrix_reg_setting[indexforchannel].value[0][i] = result[final_candidate][i]; + cali_info->iqk_matrix_reg_setting[indexforchannel].is_iqk_done = true; + } + /* RT_DISP(FINIT, INIT_IQK, ("\nIQK OK indexforchannel %d.\n", indexforchannel)); */ + RF_DBG(dm, DBG_RF_IQK, "\nIQK OK indexforchannel %d.\n", indexforchannel); + _phy_save_adda_registers(dm, IQK_BB_REG_92C, cali_info->IQK_BB_backup_recover, IQK_BB_REG_NUM); + RF_DBG(dm, DBG_RF_IQK, "IQK finished\n"); +} + + +void +phy_lc_calibrate_8188e( + void *dm_void +) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + _phy_lc_calibrate_8188e(dm, false); +} + + + +void _phy_set_rf_path_switch_8188e( +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + struct dm_struct *dm, +#else + void *adapter, +#endif + boolean is_main, + boolean is2T +) +{ +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) + struct dm_struct *dm = &hal_data->odmpriv; +#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct dm_struct *dm = &hal_data->DM_OutSrc; +#endif + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + if (!(((PADAPTER)(adapter))->bHWInitReady)) +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + if (adapter->hw_init_completed == false) +#endif + { + u8 u1b_tmp; + u1b_tmp = odm_read_1byte(dm, REG_LEDCFG2) | BIT(7); + odm_write_1byte(dm, REG_LEDCFG2, u1b_tmp); + /* odm_set_bb_reg(dm, REG_LEDCFG0, BIT23, 0x01); */ + odm_set_bb_reg(dm, REG_FPGA0_XAB_RF_PARAMETER, BIT(13), 0x01); + } + +#endif + + if (is2T) { /* 92C */ + if (is_main) + odm_set_bb_reg(dm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(5) | BIT(6), 0x1); /* 92C_Path_A */ + else + odm_set_bb_reg(dm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(5) | BIT(6), 0x2); /* BT */ + } else { /* 88C */ + + /* <20120504, Kordan> [8188E] We should make AntDiversity controlled by HW (0x870[9:8] = 0), */ + /* otherwise the following action has no effect. (0x860[9:8] has the effect only if AntDiversity controlled by SW) */ + odm_set_bb_reg(dm, REG_FPGA0_XAB_RF_INTERFACE_SW, BIT(8) | BIT(9), 0x0); + odm_set_bb_reg(dm, R_0x914, MASKLWORD, 0x0201); /* Set up the ant mapping table */ + + if (is_main) { + /* odm_set_bb_reg(dm, REG_FPGA0_XA_RF_INTERFACE_OE, BIT(8)|BIT9, 0x2); */ /* Tx Main (SW control)(The right antenna) */ + /* 4 [ Tx ] */ + odm_set_bb_reg(dm, REG_FPGA0_XA_RF_INTERFACE_OE, BIT(14) | BIT(13) | BIT(12), 0x1); /* Tx Main (HW control)(The right antenna) */ + + /* 4 [ Rx ] */ + odm_set_bb_reg(dm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(5) | BIT(4) | BIT(3), 0x1); /* ant_div_type = TRDiv, right antenna */ + if (dm->ant_div_type == CGCS_RX_HW_ANTDIV) + odm_set_bb_reg(dm, R_0xb2c, BIT(31), 0x1); /* RxCG, Default is RxCG. ant_div_type = 2RDiv, left antenna */ + + } else { + /* odm_set_bb_reg(dm, REG_FPGA0_XA_RF_INTERFACE_OE, BIT(8)|BIT9, 0x1); */ /* Tx Aux (SW control)(The left antenna) */ + /* 4 [ Tx ] */ + odm_set_bb_reg(dm, REG_FPGA0_XA_RF_INTERFACE_OE, BIT(14) | BIT(13) | BIT(12), 0x0); /* Tx Aux (HW control)(The left antenna) */ + + /* 4 [ Rx ] */ + odm_set_bb_reg(dm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(5) | BIT(4) | BIT(3), 0x0); /* ant_div_type = TRDiv, left antenna */ + if (dm->ant_div_type == CGCS_RX_HW_ANTDIV) + odm_set_bb_reg(dm, R_0xb2c, BIT(31), 0x0); /* RxCS, ant_div_type = 2RDiv, right antenna */ + } + + } +} +void phy_set_rf_path_switch_8188e( +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + struct dm_struct *dm, +#else + void *adapter, +#endif + boolean is_main +) +{ +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); +#endif + +#if DISABLE_BB_RF + return; +#endif + +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) + if (IS_92C_SERIAL(hal_data->VersionID)) + _phy_set_rf_path_switch_8188e(adapter, is_main, true); + else +#endif + { + /* For 88C 1T1R */ +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) + _phy_set_rf_path_switch_8188e(adapter, is_main, false); +#else + _phy_set_rf_path_switch_8188e(dm, is_main, false); +#endif + } +} + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +/* return value true => Main; false => Aux */ +boolean _phy_query_rf_path_switch_8188e( +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + struct dm_struct *dm, +#else + void *adapter, +#endif + boolean is2T +) +{ +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) + struct dm_struct *dm = &hal_data->odmpriv; +#endif +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct dm_struct *dm = &hal_data->DM_OutSrc; +#endif +#endif + if (!(((PADAPTER)(adapter))->bHWInitReady)){ + u8 u1b_tmp; + u1b_tmp = odm_read_1byte(dm, REG_LEDCFG2) | BIT(7); + odm_write_1byte(dm, REG_LEDCFG2, u1b_tmp); + /* odm_set_bb_reg(dm, REG_LEDCFG0, BIT23, 0x01); */ + odm_set_bb_reg(dm, REG_FPGA0_XAB_RF_PARAMETER, BIT(13), 0x01); + } + + if (is2T) { + if (odm_get_bb_reg(dm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(5) | BIT(6)) == 0x01) + return true; + else + return false; + } else { + if ((odm_get_bb_reg(dm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(5) | BIT(4) | BIT(3)) == 0x1)) + return true; + else + return false; + } +} + + + +/* return value true => Main; false => Aux */ +boolean phy_query_rf_path_switch_8188e( +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + struct dm_struct *dm +#else + void *adapter +#endif +) +{ + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + +#if DISABLE_BB_RF + return true; +#endif +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) + + /* if(IS_92C_SERIAL( hal_data->version_id)) { */ + if (IS_2T2R(hal_data->VersionID)) + return _phy_query_rf_path_switch_8188e(adapter, true); + else +#endif + { + /* For 88C 1T1R */ +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) + return _phy_query_rf_path_switch_8188e(adapter, false); +#else + return _phy_query_rf_path_switch_8188e(dm, false); +#endif + } +} +#endif +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halphyrf_8188e_win.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/rtl8188e/halrf_8188e_win.h similarity index 59% rename from drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halphyrf_8188e_win.h rename to drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/rtl8188e/halrf_8188e_win.h index 518a927406d4..7fa4fe6bbe5d 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halphyrf_8188e_win.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/halrf/rtl8188e/halrf_8188e_win.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,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 __HAL_PHY_RF_8188E_H__ -#define __HAL_PHY_RF_8188E_H__ +#ifndef __HALRF_8188E_H__ +#define __HALRF_8188E_H__ /*--------------------------Define Parameters-------------------------------*/ #define IQK_DELAY_TIME_88E 15 /* ms */ @@ -28,15 +24,15 @@ #define index_mapping_NUM_88E 15 #define AVG_THERMAL_NUM_88E 4 -#include "halphyrf_win.h" +#include "halrf/halphyrf_win.h" void configure_txpower_track_8188e( - struct _TXPWRTRACK_CFG *p_config + struct txpwrtrack_cfg *config ); void get_delta_swing_table_8188e( - void *p_dm_void, + void *dm_void, u8 **temperature_up_a, u8 **temperature_down_a, u8 **temperature_up_b, @@ -44,7 +40,7 @@ get_delta_swing_table_8188e( ); void do_iqk_8188e( - void *p_dm_void, + void *dm_void, u8 delta_thermal_index, u8 thermal_value, u8 threshold @@ -52,7 +48,7 @@ void do_iqk_8188e( void odm_tx_pwr_track_set_pwr88_e( - void *p_dm_void, + void *dm_void, enum pwrtrack_method method, u8 rf_path, u8 channel_mapped_index @@ -62,12 +58,8 @@ odm_tx_pwr_track_set_pwr88_e( void phy_iq_calibrate_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *adapter, -#endif - bool is_recovery); + void *dm_void, + boolean is_recovery); /* @@ -75,32 +67,31 @@ phy_iq_calibrate_8188e( * */ void phy_lc_calibrate_8188e( - void *p_dm_void + void *dm_void ); /* * AP calibrate * */ +#if 0 void phy_ap_calibrate_8188e( #if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, + struct dm_struct *dm, #else - struct _ADAPTER *p_adapter, + void *adapter, #endif s8 delta); void -phy_digital_predistortion_8188e(struct _ADAPTER *p_adapter); +phy_digital_predistortion_8188e(void *adapter); + +#endif #define phy_dp_calibrate_8821a phy_dp_calibrate_8812a void _phy_save_adda_registers( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif + struct dm_struct *dm, u32 *adda_reg, u32 *adda_backup, u32 register_num @@ -108,23 +99,15 @@ _phy_save_adda_registers( void _phy_path_adda_on( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif + struct dm_struct *dm, u32 *adda_reg, - bool is_path_a_on, - bool is2T + boolean is_path_a_on, + boolean is2T ); void _phy_mac_setting_calibration( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif + struct dm_struct *dm, u32 *mac_reg, u32 *mac_backup ); @@ -132,12 +115,23 @@ _phy_mac_setting_calibration( void _phy_path_a_stand_by( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm -#else - struct _ADAPTER *p_adapter -#endif + struct dm_struct *dm ); -#endif /* #ifndef __HAL_PHY_RF_8188E_H__ */ +void phy_set_rf_path_switch_8188e( +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + struct dm_struct *dm, +#else + void *adapter, +#endif + boolean is_main +); + +void +halrf_rf_lna_setting_8188e( + struct dm_struct *dm, + enum halrf_lna_set type +); + +#endif /*#ifndef __HALRF_8188E_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/mp_precomp.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/mp_precomp.h index fa483c6ddabc..34208ac03b43 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/mp_precomp.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/mp_precomp.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,12 +9,17 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm.c index b7188e178343..413181672e51 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,2521 +9,2951 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ -/* ************************************************************ +/*@************************************************************ * 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} +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*/ + 19, 39, 58, 78, 117, 156, 175, 195, /*@MCS16~23*/ + 26, 52, 78, 104, 156, 208, 234, 260, /*@MCS24~31*/ + 6, 13, 19, 26, 39, 52, 58, 65, 78, 90, /*@1ss MCS0~9*/ + 13, 26, 39, 52, 78, 104, 117, 130, 156, 180, /*@2ss MCS0~9*/ + 19, 39, 58, 78, 117, 156, 175, 195, 234, 260, /*@3ss MCS0~9*/ + 26, 52, 78, 104, 156, 208, 234, 260, 312, 360 /*@4ss MCS0~9*/ }; - -/* ************************************************************ - * Local Function predefine. - * ************************************************************ */ - -/* START------------COMMON INFO RELATED--------------- */ - -void -odm_global_adapter_check( - void -); - -/* move to odm_PowerTacking.h by YuChen */ - - - -void -odm_update_power_training_state( - struct PHY_DM_STRUCT *p_dm_odm -); - -/* ************************************************************ - * 3 Export Interface - * ************************************************************ */ - -/*Y = 10*log(X)*/ -s32 -odm_pwdb_conversion( - s32 X, - u32 total_bit, - u32 decimal_bit -) +void phydm_traffic_load_decision(void *dm_void) { - s32 Y, integer = 0, decimal = 0; - u32 i; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 shift = 0; - if (X == 0) - X = 1; /* log2(x), x can't be 0 */ + /*@---TP & Trafic-load calculation---*/ - 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; - } - } + if (dm->last_tx_ok_cnt > *dm->num_tx_bytes_unicast) + dm->last_tx_ok_cnt = *dm->num_tx_bytes_unicast; - Y = 3 * (integer - decimal_bit) + decimal; /* 10*log(x)=3*log2(x), */ + if (dm->last_rx_ok_cnt > *dm->num_rx_bytes_unicast) + dm->last_rx_ok_cnt = *dm->num_rx_bytes_unicast; - return Y; -} + dm->cur_tx_ok_cnt = *dm->num_tx_bytes_unicast - dm->last_tx_ok_cnt; + dm->cur_rx_ok_cnt = *dm->num_rx_bytes_unicast - dm->last_rx_ok_cnt; + dm->last_tx_ok_cnt = *dm->num_tx_bytes_unicast; + dm->last_rx_ok_cnt = *dm->num_rx_bytes_unicast; -s32 -odm_sign_conversion( - s32 value, - u32 total_bit -) -{ - if (value & BIT(total_bit - 1)) - value -= BIT(total_bit); - return value; -} + /*@AP: <<3(8bit), >>20(10^6,M), >>0(1sec)*/ + shift = 17 + (PHYDM_WATCH_DOG_PERIOD - 1); + /*@WIN&CE: <<3(8bit), >>20(10^6,M), >>1(2sec)*/ -void -phydm_seq_sorting( - void *p_dm_void, - u32 *p_value, - u32 *rank_idx, - u32 *p_idx_out, - u8 seq_length -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 i = 0, j = 0; - u32 tmp_a, tmp_b; - u32 tmp_idx_a, tmp_idx_b; + dm->tx_tp = (dm->tx_tp >> 1) + (u32)((dm->cur_tx_ok_cnt >> shift) >> 1); + dm->rx_tp = (dm->rx_tp >> 1) + (u32)((dm->cur_rx_ok_cnt >> shift) >> 1); - for (i = 0; i < seq_length; i++) { - rank_idx[i] = i; - /**/ - } + dm->total_tp = dm->tx_tp + dm->rx_tp; - 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_init_mp_driver_status( - struct PHY_DM_STRUCT *p_dm_odm -) -{ -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - - /* Decide when compile time */ -#if (MP_DRIVER == 1) - p_dm_odm->mp_mode = true; -#else - p_dm_odm->mp_mode = false; -#endif - -#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - - struct _ADAPTER *adapter = p_dm_odm->adapter; - - /* Update information every period */ - p_dm_odm->mp_mode = (bool)adapter->registrypriv.mp_mode; - -#else - - struct rtl8192cd_priv *priv = p_dm_odm->priv; - - p_dm_odm->mp_mode = (bool)priv->pshare->rf_ft_var.mp_specific; - -#endif -} - -void -odm_update_mp_driver_status( - struct PHY_DM_STRUCT *p_dm_odm -) -{ -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - - /* Do nothing. */ - -#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - struct _ADAPTER *adapter = p_dm_odm->adapter; - - /* Update information erery period */ - p_dm_odm->mp_mode = (bool)adapter->registrypriv.mp_mode; - -#else - - /* Do nothing. */ - -#endif -} - -void -phydm_init_trx_antenna_setting( - struct PHY_DM_STRUCT *p_dm_odm -) -{ - /*#if (RTL8814A_SUPPORT == 1)*/ - - if (p_dm_odm->support_ic_type & (ODM_RTL8814A)) { - u8 rx_ant = 0, tx_ant = 0; - - rx_ant = (u8)odm_get_bb_reg(p_dm_odm, ODM_REG(BB_RX_PATH, p_dm_odm), ODM_BIT(BB_RX_PATH, p_dm_odm)); - tx_ant = (u8)odm_get_bb_reg(p_dm_odm, ODM_REG(BB_TX_PATH, p_dm_odm), ODM_BIT(BB_TX_PATH, p_dm_odm)); - p_dm_odm->tx_ant_status = (tx_ant & 0xf); - p_dm_odm->rx_ant_status = (rx_ant & 0xf); - } else if (p_dm_odm->support_ic_type & (ODM_RTL8723D | ODM_RTL8821C)) { - p_dm_odm->tx_ant_status = 0x1; - p_dm_odm->rx_ant_status = 0x1; - - } - /*#endif*/ -} - -void -phydm_traffic_load_decision( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _sw_antenna_switch_ *p_dm_swat_table = &p_dm_odm->dm_swat_table; - - /*---TP & Trafic-load calculation---*/ - - if (p_dm_odm->last_tx_ok_cnt > (*(p_dm_odm->p_num_tx_bytes_unicast))) - p_dm_odm->last_tx_ok_cnt = (*(p_dm_odm->p_num_tx_bytes_unicast)); - - if (p_dm_odm->last_rx_ok_cnt > (*(p_dm_odm->p_num_rx_bytes_unicast))) - p_dm_odm->last_rx_ok_cnt = (*(p_dm_odm->p_num_rx_bytes_unicast)); - - p_dm_odm->cur_tx_ok_cnt = *(p_dm_odm->p_num_tx_bytes_unicast) - p_dm_odm->last_tx_ok_cnt; - p_dm_odm->cur_rx_ok_cnt = *(p_dm_odm->p_num_rx_bytes_unicast) - p_dm_odm->last_rx_ok_cnt; - p_dm_odm->last_tx_ok_cnt = *(p_dm_odm->p_num_tx_bytes_unicast); - p_dm_odm->last_rx_ok_cnt = *(p_dm_odm->p_num_rx_bytes_unicast); - -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - p_dm_odm->tx_tp = ((p_dm_odm->tx_tp) >> 1) + (u32)(((p_dm_odm->cur_tx_ok_cnt) >> 17) >> 1); /* <<3(8bit), >>20(10^6,M)*/ - p_dm_odm->rx_tp = ((p_dm_odm->rx_tp) >> 1) + (u32)(((p_dm_odm->cur_rx_ok_cnt) >> 17) >> 1); /* <<3(8bit), >>20(10^6,M)*/ -#else - p_dm_odm->tx_tp = ((p_dm_odm->tx_tp) >> 1) + (u32)(((p_dm_odm->cur_tx_ok_cnt) >> 18) >> 1); /* <<3(8bit), >>20(10^6,M), >>1(2sec)*/ - p_dm_odm->rx_tp = ((p_dm_odm->rx_tp) >> 1) + (u32)(((p_dm_odm->cur_rx_ok_cnt) >> 18) >> 1); /* <<3(8bit), >>20(10^6,M), >>1(2sec)*/ -#endif - p_dm_odm->total_tp = p_dm_odm->tx_tp + p_dm_odm->rx_tp; - - if (p_dm_odm->total_tp == 0) - p_dm_odm->consecutive_idlel_time += PHYDM_WATCH_DOG_PERIOD; + /*@[Calculate TX/RX state]*/ + if (dm->tx_tp > (dm->rx_tp << 1)) + dm->txrx_state_all = TX_STATE; + else if (dm->rx_tp > (dm->tx_tp << 1)) + dm->txrx_state_all = RX_STATE; else - p_dm_odm->consecutive_idlel_time = 0; - /* - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("cur_tx_ok_cnt = %d, cur_rx_ok_cnt = %d, last_tx_ok_cnt = %d, last_rx_ok_cnt = %d\n", - p_dm_odm->cur_tx_ok_cnt, p_dm_odm->cur_rx_ok_cnt, p_dm_odm->last_tx_ok_cnt, p_dm_odm->last_rx_ok_cnt)); + dm->txrx_state_all = BI_DIRECTION_STATE; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("tx_tp = %d, rx_tp = %d\n", - p_dm_odm->tx_tp, p_dm_odm->rx_tp)); - */ + /*@[Traffic load decision]*/ + dm->pre_traffic_load = dm->traffic_load; - p_dm_odm->pre_traffic_load = p_dm_odm->traffic_load; - - if (p_dm_odm->cur_tx_ok_cnt > 1875000 || p_dm_odm->cur_rx_ok_cnt > 1875000) { /* ( 1.875M * 8bit ) / 2sec= 7.5M bits /sec )*/ - - p_dm_odm->traffic_load = TRAFFIC_HIGH; - /**/ - } else if (p_dm_odm->cur_tx_ok_cnt > 500000 || p_dm_odm->cur_rx_ok_cnt > 500000) { /*( 0.5M * 8bit ) / 2sec = 2M bits /sec )*/ - - p_dm_odm->traffic_load = TRAFFIC_MID; - /**/ - } else if (p_dm_odm->cur_tx_ok_cnt > 100000 || p_dm_odm->cur_rx_ok_cnt > 100000) { /*( 0.1M * 8bit ) / 2sec = 0.4M bits /sec )*/ - - p_dm_odm->traffic_load = TRAFFIC_LOW; - /**/ + if (dm->cur_tx_ok_cnt > 1875000 || dm->cur_rx_ok_cnt > 1875000) { + /* @( 1.875M * 8bit ) / 2sec= 7.5M bits /sec )*/ + dm->traffic_load = TRAFFIC_HIGH; + } else if (dm->cur_tx_ok_cnt > 500000 || dm->cur_rx_ok_cnt > 500000) { + /*@( 0.5M * 8bit ) / 2sec = 2M bits /sec )*/ + dm->traffic_load = TRAFFIC_MID; + } else if (dm->cur_tx_ok_cnt > 100000 || dm->cur_rx_ok_cnt > 100000) { + /*@( 0.1M * 8bit ) / 2sec = 0.4M bits /sec )*/ + dm->traffic_load = TRAFFIC_LOW; + } else if (dm->cur_tx_ok_cnt > 25000 || dm->cur_rx_ok_cnt > 25000) { + /*@( 0.025M * 8bit ) / 2sec = 0.1M bits /sec )*/ + dm->traffic_load = TRAFFIC_ULTRA_LOW; } else { - - p_dm_odm->traffic_load = TRAFFIC_ULTRA_LOW; - /**/ + dm->traffic_load = TRAFFIC_NO_TP; } + + /*@[Calculate consecutive idlel time]*/ + if (dm->traffic_load == 0) + dm->consecutive_idlel_time += PHYDM_WATCH_DOG_PERIOD; + else + dm->consecutive_idlel_time = 0; + + #if 0 + PHYDM_DBG(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", + dm->cur_tx_ok_cnt, dm->cur_rx_ok_cnt, dm->last_tx_ok_cnt, + dm->last_rx_ok_cnt); + + PHYDM_DBG(dm, DBG_COMMON_FLOW, "tx_tp = %d, rx_tp = %d\n", dm->tx_tp, + dm->rx_tp); + #endif } -void -phydm_config_ofdm_tx_path( - struct PHY_DM_STRUCT *p_dm_odm, - u32 path -) +void phydm_cck_new_agc_chk(struct dm_struct *dm) { - u8 ofdm_tx_path = 0x33; + dm->cck_new_agc = 0; -#if (RTL8192E_SUPPORT == 1) - if (p_dm_odm->support_ic_type & (ODM_RTL8192E)) { - - if (path == PHYDM_A) { - odm_set_bb_reg(p_dm_odm, 0x90c, MASKDWORD, 0x81121111); - /**/ - } else if (path == PHYDM_B) { - odm_set_bb_reg(p_dm_odm, 0x90c, MASKDWORD, 0x82221222); - /**/ - } else if (path == PHYDM_AB) { - odm_set_bb_reg(p_dm_odm, 0x90c, MASKDWORD, 0x83321333); - /**/ - } - - - } -#endif - -#if (RTL8812A_SUPPORT == 1) - if (p_dm_odm->support_ic_type & (ODM_RTL8812)) { - - if (path == PHYDM_A) { - ofdm_tx_path = 0x11; - /**/ - } else if (path == PHYDM_B) { - ofdm_tx_path = 0x22; - /**/ - } else if (path == PHYDM_AB) { - ofdm_tx_path = 0x33; - /**/ - } - - odm_set_bb_reg(p_dm_odm, 0x80c, 0xff00, ofdm_tx_path); +#if (RTL8723D_SUPPORT || RTL8822B_SUPPORT || RTL8821C_SUPPORT ||\ + RTL8197F_SUPPORT || RTL8710B_SUPPORT || RTL8192F_SUPPORT ||\ + RTL8195B_SUPPORT || RTL8198F_SUPPORT || RTL8822C_SUPPORT ||\ + RTL8721D_SUPPORT) + if (dm->support_ic_type & + (ODM_RTL8723D | ODM_RTL8822B | ODM_RTL8821C | ODM_RTL8197F | + ODM_RTL8710B | ODM_RTL8192F | ODM_RTL8195B | ODM_RTL8721D)) { + /*@1: new agc 0: old agc*/ + dm->cck_new_agc = (boolean)odm_get_bb_reg(dm, R_0xa9c, BIT(17)); + } else if (dm->support_ic_type & (ODM_RTL8198F | ODM_RTL8822C)) { + /*@1: new agc 0: old agc*/ + dm->cck_new_agc = (boolean)odm_get_bb_reg(dm, R_0x1a9c, + BIT(17)); } #endif } -void -phydm_config_ofdm_rx_path( - struct PHY_DM_STRUCT *p_dm_odm, - u32 path -) -{ - u8 ofdm_rx_path = 0; - - - if (p_dm_odm->support_ic_type & (ODM_RTL8192E)) { -#if (RTL8192E_SUPPORT == 1) - 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_set_bb_reg(p_dm_odm, 0xC04, 0xff, (((ofdm_rx_path) << 4) | ofdm_rx_path)); - odm_set_bb_reg(p_dm_odm, 0xD04, 0xf, ofdm_rx_path); -#endif - } -#if (RTL8812A_SUPPORT || RTL8822B_SUPPORT) - else if (p_dm_odm->support_ic_type & (ODM_RTL8812 | ODM_RTL8822B)) { - - 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_set_bb_reg(p_dm_odm, 0x808, MASKBYTE0, ((ofdm_rx_path << 4) | ofdm_rx_path)); - } -#endif -} - -void -phydm_config_cck_rx_antenna_init( - struct PHY_DM_STRUCT *p_dm_odm -) -{ -#if ((RTL8192E_SUPPORT == 1) || (RTL8812A_SUPPORT == 1)) - if (p_dm_odm->support_ic_type & (ODM_RTL8192E | ODM_RTL8812)) { - - /*CCK 2R CCA parameters*/ - odm_set_bb_reg(p_dm_odm, 0xa2c, BIT(18), 1); /*enable 2R Rx path*/ - odm_set_bb_reg(p_dm_odm, 0xa2c, BIT(22), 1); /*enable 2R MRC*/ - odm_set_bb_reg(p_dm_odm, 0xa84, BIT(28), 1); /*1. pdx1[5:0] > 2*PD_lim 2. RXIQ_3 = 0 ( signed )*/ - odm_set_bb_reg(p_dm_odm, 0xa70, BIT(7), 0); /*Concurrent CCA at LSB & USB*/ - odm_set_bb_reg(p_dm_odm, 0xa74, BIT(8), 0); /*RX path diversity enable*/ - odm_set_bb_reg(p_dm_odm, 0xa08, BIT(28), 1); /* r_cck_2nd_sel_eco*/ - odm_set_bb_reg(p_dm_odm, 0xa14, BIT(7), 0); /* r_en_mrc_antsel*/ - } -#endif -} - -void -phydm_config_cck_rx_path( - struct PHY_DM_STRUCT *p_dm_odm, - u8 path, - u8 path_div_en -) -{ - u8 path_div_select = 0; - u8 cck_1_path = 0, cck_2_path = 0; - -#if ((RTL8192E_SUPPORT == 1) || (RTL8812A_SUPPORT == 1)) - if (p_dm_odm->support_ic_type & (ODM_RTL8192E | ODM_RTL8812)) { - - 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_set_bb_reg(p_dm_odm, 0xa04, (BIT(27) | BIT(26)), cck_1_path); - odm_set_bb_reg(p_dm_odm, 0xa04, (BIT(25) | BIT(24)), cck_2_path); - odm_set_bb_reg(p_dm_odm, 0xa74, BIT(8), path_div_select); - - } -#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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u32 pre_support_ability; - 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_odm, 0xa04, 0xf0000000, 0x8); - else if (dm_value[2] == 2) - odm_set_bb_reg(p_dm_odm, 0xa04, 0xf0000000, 0x4); - else if (dm_value[2] == 3) - odm_set_bb_reg(p_dm_odm, 0xa04, 0xf0000000, 0xc); - } else if (dm_value[1] == 2) { /*RX*/ - - phydm_config_cck_rx_antenna_init(p_dm_odm); - - if (dm_value[2] == 1) - phydm_config_cck_rx_path(p_dm_odm, PHYDM_A, CCA_PATHDIV_DISABLE); - else if (dm_value[2] == 2) - phydm_config_cck_rx_path(p_dm_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(p_dm_odm, PHYDM_AB, CCA_PATHDIV_ENABLE); - else - phydm_config_cck_rx_path(p_dm_odm, PHYDM_B, CCA_PATHDIV_DISABLE); - } - } - } - /* OFDM */ - else if (dm_value[0] == 1) { - - if (dm_value[1] == 1) { /*TX*/ - phydm_config_ofdm_tx_path(p_dm_odm, dm_value[2]); - /**/ - } else if (dm_value[1] == 2) { /*RX*/ - phydm_config_ofdm_rx_path(p_dm_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( - struct PHY_DM_STRUCT *p_dm_odm -) +/*select 3 or 4 bit LNA */ +void phydm_cck_lna_bit_num_chk(struct dm_struct *dm) { + boolean report_type = 0; + #if (RTL8192E_SUPPORT) u32 value_824, value_82c; + #endif - p_dm_odm->is_cck_high_power = (bool) odm_get_bb_reg(p_dm_odm, ODM_REG(CCK_RPT_FORMAT, p_dm_odm), ODM_BIT(CCK_RPT_FORMAT, p_dm_odm)); - -#if (RTL8192E_SUPPORT == 1) - if (p_dm_odm->support_ic_type & (ODM_RTL8192E)) { -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - phydm_config_cck_rx_antenna_init(p_dm_odm); - phydm_config_cck_rx_path(p_dm_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_get_bb_reg(p_dm_odm, 0x824, BIT(9)); - value_82c = odm_get_bb_reg(p_dm_odm, 0x82c, BIT(9)); + #if (RTL8192E_SUPPORT) + if (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(dm, R_0x824, BIT(9)); + value_82c = odm_get_bb_reg(dm, R_0x82c, BIT(9)); if (value_824 != value_82c) - odm_set_bb_reg(p_dm_odm, 0x82c, BIT(9), value_824); - odm_set_bb_reg(p_dm_odm, 0xa80, BIT(7), value_824); - p_dm_odm->cck_agc_report_type = (bool)value_824; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("cck_agc_report_type = (( %d )), ext_lna_gain = (( %d ))\n", p_dm_odm->cck_agc_report_type, p_dm_odm->ext_lna_gain)); + odm_set_bb_reg(dm, R_0x82c, BIT(9), value_824); + odm_set_bb_reg(dm, R_0xa80, BIT(7), value_824); + report_type = (boolean)value_824; } -#endif + #endif -#if ((RTL8703B_SUPPORT == 1) || (RTL8723D_SUPPORT == 1)) - if (p_dm_odm->support_ic_type & (ODM_RTL8703B | ODM_RTL8723D)) { + #if (RTL8703B_SUPPORT || RTL8723D_SUPPORT || RTL8710B_SUPPORT) + if (dm->support_ic_type & + (ODM_RTL8703B | ODM_RTL8723D | ODM_RTL8710B)) { + report_type = (boolean)odm_get_bb_reg(dm, R_0x950, BIT(11)); - p_dm_odm->cck_agc_report_type = odm_get_bb_reg(p_dm_odm, 0x950, BIT(11)) ? 1 : 0; /*1: 4bit LNA, 0: 3bit LNA */ - - if (p_dm_odm->cck_agc_report_type != 1) { - dbg_print("[Warning] 8703B/8723D CCK should be 4bit LNA, ie. 0x950[11] = 1\n"); - /**/ - } + if (report_type != 1) + pr_debug("[Warning] CCK should be 4bit LNA\n"); } -#endif + #endif -#if ((RTL8723D_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) || (RTL8197F_SUPPORT == 1)) + #if (RTL8821C_SUPPORT) + if (dm->support_ic_type & ODM_RTL8821C) { + if (dm->default_rf_set_8821c == SWITCH_TO_BTG) + report_type = 1; + } + #endif - if (p_dm_odm->support_ic_type & (ODM_RTL8723D | ODM_RTL8822B | ODM_RTL8197F)) { - p_dm_odm->cck_new_agc = odm_get_bb_reg(p_dm_odm, 0xa9c, BIT(17)) ? true : false; /*1: new agc 0: old agc*/ - } else -#endif - p_dm_odm->cck_new_agc = false; + dm->cck_agc_report_type = report_type; + PHYDM_DBG(dm, ODM_COMP_INIT, "cck_agc_report_type=((%d))\n", + dm->cck_agc_report_type); } -void -phydm_init_soft_ml_setting( - struct PHY_DM_STRUCT *p_dm_odm -) +void phydm_init_cck_setting(struct dm_struct *dm) { -#if (RTL8822B_SUPPORT == 1) - if (p_dm_odm->mp_mode == false) { - if (p_dm_odm->support_ic_type & ODM_RTL8822B) - odm_set_bb_reg(p_dm_odm, 0x19a8, MASKDWORD, 0xc10a0000); - } + u32 reg_tmp = 0; + u32 mask_tmp = 0; + + phydm_cck_new_agc_chk(dm); + + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + return; + + reg_tmp = ODM_REG(CCK_RPT_FORMAT, dm); + mask_tmp = ODM_BIT(CCK_RPT_FORMAT, dm); + dm->is_cck_high_power = (boolean)odm_get_bb_reg(dm, reg_tmp, mask_tmp); + + PHYDM_DBG(dm, ODM_COMP_INIT, "ext_lna_gain=((%d))\n", dm->ext_lna_gain); + + phydm_config_cck_rx_antenna_init(dm); + + if (dm->support_ic_type & ODM_RTL8192F) + phydm_config_cck_rx_path(dm, BB_PATH_AB); + else if (dm->valid_path_set == BB_PATH_A) + phydm_config_cck_rx_path(dm, BB_PATH_A); + else if (dm->valid_path_set == BB_PATH_B) + phydm_config_cck_rx_path(dm, BB_PATH_B); + + phydm_cck_lna_bit_num_chk(dm); + phydm_get_cck_rssi_table_from_reg(dm); +} + +void phydm_init_hw_info_by_rfe(struct dm_struct *dm) +{ +#if (RTL8822B_SUPPORT) + /*@if (dm->support_ic_type & ODM_RTL8822B)*/ + /*@phydm_init_hw_info_by_rfe_type_8822b(dm);*/ +#endif +#if (RTL8821C_SUPPORT) + if (dm->support_ic_type & ODM_RTL8821C) + phydm_init_hw_info_by_rfe_type_8821c(dm); +#endif +#if (RTL8197F_SUPPORT) + if (dm->support_ic_type & ODM_RTL8197F) + phydm_init_hw_info_by_rfe_type_8197f(dm); #endif } -void -phydm_init_hw_info_by_rfe( - struct PHY_DM_STRUCT *p_dm_odm -) +void phydm_common_info_self_init(struct dm_struct *dm) { -#if (RTL8822B_SUPPORT == 1) - if (p_dm_odm->support_ic_type & ODM_RTL8822B) - phydm_init_hw_info_by_rfe_type_8822b(p_dm_odm); -#endif -#if (RTL8821C_SUPPORT == 1) - if (p_dm_odm->support_ic_type & ODM_RTL8821C) - phydm_init_hw_info_by_rfe_type_8821c(p_dm_odm); -#endif -#if (RTL8197F_SUPPORT == 1) - if (p_dm_odm->support_ic_type & ODM_RTL8197F) - phydm_init_hw_info_by_rfe_type_8197f(p_dm_odm); -#endif -} + u32 reg_tmp = 0; + u32 mask_tmp = 0; -void -odm_common_info_self_init( - struct PHY_DM_STRUCT *p_dm_odm -) -{ - phydm_init_cck_setting(p_dm_odm); - p_dm_odm->rf_path_rx_enable = (u8) odm_get_bb_reg(p_dm_odm, ODM_REG(BB_RX_PATH, p_dm_odm), ODM_BIT(BB_RX_PATH, p_dm_odm)); + dm->run_in_drv_fw = RUN_IN_DRIVER; + + /*@BB IP Generation*/ + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + dm->ic_ip_series = PHYDM_IC_JGR3; + else if (dm->support_ic_type & ODM_IC_11AC_SERIES) + dm->ic_ip_series = PHYDM_IC_AC; + else if (dm->support_ic_type & ODM_IC_11N_SERIES) + dm->ic_ip_series = PHYDM_IC_N; + + /*@BB phy-status Generation*/ + if (dm->support_ic_type & PHYSTS_3RD_TYPE_IC) + dm->ic_phy_sts_type = PHYDM_PHYSTS_TYPE_3; + else if (dm->support_ic_type & PHYSTS_2ND_TYPE_IC) + dm->ic_phy_sts_type = PHYDM_PHYSTS_TYPE_2; + else + dm->ic_phy_sts_type = PHYDM_PHYSTS_TYPE_1; + + phydm_init_cck_setting(dm); + + reg_tmp = ODM_REG(BB_RX_PATH, dm); + mask_tmp = ODM_BIT(BB_RX_PATH, dm); + dm->rf_path_rx_enable = (u8)odm_get_bb_reg(dm, reg_tmp, mask_tmp); #if (DM_ODM_SUPPORT_TYPE != ODM_CE) - p_dm_odm->p_is_net_closed = &p_dm_odm->BOOLEAN_temp; + dm->is_net_closed = &dm->BOOLEAN_temp; - phydm_init_debug_setting(p_dm_odm); + phydm_init_debug_setting(dm); #endif - odm_init_mp_driver_status(p_dm_odm); - phydm_init_trx_antenna_setting(p_dm_odm); - phydm_init_soft_ml_setting(p_dm_odm); + phydm_init_soft_ml_setting(dm); - p_dm_odm->phydm_period = PHYDM_WATCH_DOG_PERIOD; - p_dm_odm->phydm_sys_up_time = 0; + dm->phydm_sys_up_time = 0; - if (p_dm_odm->support_ic_type & ODM_IC_1SS) - p_dm_odm->num_rf_path = 1; - else if (p_dm_odm->support_ic_type & ODM_IC_2SS) - p_dm_odm->num_rf_path = 2; - else if (p_dm_odm->support_ic_type & ODM_IC_3SS) - p_dm_odm->num_rf_path = 3; - else if (p_dm_odm->support_ic_type & ODM_IC_4SS) - p_dm_odm->num_rf_path = 4; + if (dm->support_ic_type & ODM_IC_1SS) + dm->num_rf_path = 1; + else if (dm->support_ic_type & ODM_IC_2SS) + dm->num_rf_path = 2; + #if 0 + /* @RTK do not has IC which is equipped with 3 RF paths, + * so ODM_IC_3SS is an enpty macro and result in coverity check errors + */ + else if (dm->support_ic_type & ODM_IC_3SS) + dm->num_rf_path = 3; + #endif + else if (dm->support_ic_type & ODM_IC_4SS) + dm->num_rf_path = 4; + else + dm->num_rf_path = 1; - p_dm_odm->tx_rate = 0xFF; + phydm_trx_antenna_setting_init(dm, dm->num_rf_path); - p_dm_odm->number_linked_client = 0; - p_dm_odm->pre_number_linked_client = 0; - p_dm_odm->number_active_client = 0; - p_dm_odm->pre_number_active_client = 0; + dm->tx_rate = 0xFF; + dm->rssi_min_by_path = 0xFF; - p_dm_odm->last_tx_ok_cnt = 0; - p_dm_odm->last_rx_ok_cnt = 0; - p_dm_odm->tx_tp = 0; - p_dm_odm->rx_tp = 0; - p_dm_odm->total_tp = 0; - p_dm_odm->traffic_load = TRAFFIC_LOW; + dm->number_linked_client = 0; + dm->pre_number_linked_client = 0; + dm->number_active_client = 0; + dm->pre_number_active_client = 0; - p_dm_odm->nbi_set_result = 0; - p_dm_odm->is_init_hw_info_by_rfe = false; + dm->last_tx_ok_cnt = 0; + dm->last_rx_ok_cnt = 0; + dm->tx_tp = 0; + dm->rx_tp = 0; + dm->total_tp = 0; + dm->traffic_load = TRAFFIC_LOW; + dm->nbi_set_result = 0; + dm->is_init_hw_info_by_rfe = false; + dm->pre_dbg_priority = DBGPORT_RELEASE; + dm->tp_active_th = 5; + dm->disable_phydm_watchdog = 0; + + dm->u8_dummy = 0xf; + dm->u16_dummy = 0xffff; + dm->u32_dummy = 0xffffffff; + + dm->pause_lv_table.lv_cckpd = PHYDM_PAUSE_RELEASE; + dm->pause_lv_table.lv_dig = PHYDM_PAUSE_RELEASE; + dm->pre_is_linked = false; + dm->is_linked = false; + + if (!(dm->is_fcs_mode_enable)) { + dm->is_fcs_mode_enable = &dm->boolean_dummy; + pr_debug("[Warning] is_fcs_mode_enable=NULL\n"); + } } -void -odm_common_info_self_update( - struct PHY_DM_STRUCT *p_dm_odm -) +void phydm_cmn_sta_info_update(void *dm_void, u8 macid) { - u8 entry_cnt = 0, num_active_client = 0; - u32 i, one_entry_macid = 0, ma_rx_tp = 0; - struct sta_info *p_entry; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct cmn_sta_info *sta = dm->phydm_sta_info[macid]; + struct ra_sta_info *ra = NULL; -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - - struct _ADAPTER *adapter = p_dm_odm->adapter; - PMGNT_INFO p_mgnt_info = &adapter->MgntInfo; - - p_entry = p_dm_odm->p_odm_sta_info[0]; - if (p_mgnt_info->mAssoc) { - p_entry->bUsed = true; - for (i = 0; i < 6; i++) - p_entry->MacAddr[i] = p_mgnt_info->Bssid[i]; - } else if (GetFirstClientPort(adapter)) { - struct _ADAPTER *p_client_adapter = GetFirstClientPort(adapter); - - p_entry->bUsed = true; - for (i = 0; i < 6; i++) - p_entry->MacAddr[i] = p_client_adapter->MgntInfo.Bssid[i]; + if (is_sta_active(sta)) { + ra = &sta->ra_info; } else { - p_entry->bUsed = false; + PHYDM_DBG(dm, DBG_RA_MASK, "[Warning] %s invalid sta_info\n", + __func__); + return; + } + + PHYDM_DBG(dm, DBG_RA_MASK, "%s ======>\n", __func__); + PHYDM_DBG(dm, DBG_RA_MASK, "MACID=%d\n", sta->mac_id); + + /*@[Calculate TX/RX state]*/ + if (sta->tx_moving_average_tp > (sta->rx_moving_average_tp << 1)) + ra->txrx_state = TX_STATE; + else if (sta->rx_moving_average_tp > (sta->tx_moving_average_tp << 1)) + ra->txrx_state = RX_STATE; + else + ra->txrx_state = BI_DIRECTION_STATE; + + ra->is_noisy = dm->noisy_decision; +} + +void phydm_common_info_self_update(struct dm_struct *dm) +{ + u8 sta_cnt = 0, num_active_client = 0; + u32 i, one_entry_macid = 0; + u32 ma_rx_tp = 0; + u32 tp_diff = 0; + struct cmn_sta_info *sta; +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + PADAPTER adapter = (PADAPTER)dm->adapter; + PMGNT_INFO mgnt_info = &((PADAPTER)adapter)->MgntInfo; + + sta = dm->phydm_sta_info[0]; + if (mgnt_info->mAssoc) { + sta->dm_ctrl |= STA_DM_CTRL_ACTIVE; for (i = 0; i < 6; i++) - p_entry->MacAddr[i] = 0; + sta->mac_addr[i] = mgnt_info->Bssid[i]; + } else if (GetFirstClientPort(adapter)) { + struct _ADAPTER *client_adapter = GetFirstClientPort(adapter); + + sta->dm_ctrl |= STA_DM_CTRL_ACTIVE; + for (i = 0; i < 6; i++) + sta->mac_addr[i] = client_adapter->MgntInfo.Bssid[i]; + } else { + sta->dm_ctrl = sta->dm_ctrl & (~STA_DM_CTRL_ACTIVE); + for (i = 0; i < 6; i++) + sta->mac_addr[i] = 0; } /* STA mode is linked to AP */ - if (IS_STA_VALID(p_dm_odm->p_odm_sta_info[0]) && !ACTING_AS_AP(adapter)) - p_dm_odm->bsta_state = true; + if (is_sta_active(sta) && !ACTING_AS_AP(adapter)) + dm->bsta_state = true; else - p_dm_odm->bsta_state = false; -#endif - - /* THis variable cannot be used because it is wrong*/ -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) - if (*(p_dm_odm->p_band_width) == ODM_BW40M) { - if (*(p_dm_odm->p_sec_ch_offset) == 1) - p_dm_odm->control_channel = *(p_dm_odm->p_channel) + 2; - else if (*(p_dm_odm->p_sec_ch_offset) == 2) - p_dm_odm->control_channel = *(p_dm_odm->p_channel) - 2; - } else if (*(p_dm_odm->p_band_width) == ODM_BW80M) { - if (*(p_dm_odm->p_sec_ch_offset) == 1) - p_dm_odm->control_channel = *(p_dm_odm->p_channel) + 6; - else if (*(p_dm_odm->p_sec_ch_offset) == 2) - p_dm_odm->control_channel = *(p_dm_odm->p_channel) - 6; - } else - p_dm_odm->control_channel = *(p_dm_odm->p_channel); -#else - if (*(p_dm_odm->p_band_width) == ODM_BW40M) { - if (*(p_dm_odm->p_sec_ch_offset) == 1) - p_dm_odm->control_channel = *(p_dm_odm->p_channel) - 2; - else if (*(p_dm_odm->p_sec_ch_offset) == 2) - p_dm_odm->control_channel = *(p_dm_odm->p_channel) + 2; - } else - p_dm_odm->control_channel = *(p_dm_odm->p_channel); + dm->bsta_state = false; #endif for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { - p_entry = p_dm_odm->p_odm_sta_info[i]; - if (IS_STA_VALID(p_entry)) { - entry_cnt++; - if (entry_cnt == 1) + sta = dm->phydm_sta_info[i]; + if (is_sta_active(sta)) { + sta_cnt++; + + if (sta_cnt == 1) one_entry_macid = i; -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) - ma_rx_tp = (p_entry->rx_byte_cnt_low_maw) << 3; /* low moving average RX TP ( bit /sec)*/ + phydm_cmn_sta_info_update(dm, (u8)i); + #ifdef PHYDM_BEAMFORMING_SUPPORT + /*@phydm_get_txbf_device_num(dm, (u8)i);*/ + #endif - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("ClientTP[%d]: ((%d )) bit/sec\n", i, ma_rx_tp)); + ma_rx_tp = sta->rx_moving_average_tp + + sta->tx_moving_average_tp; + + PHYDM_DBG(dm, DBG_COMMON_FLOW, + "TP[%d]: ((%d )) bit/sec\n", i, ma_rx_tp); if (ma_rx_tp > ACTIVE_TP_THRESHOLD) num_active_client++; -#endif } } - if (entry_cnt == 1) { - p_dm_odm->is_one_entry_only = true; - p_dm_odm->one_entry_macid = one_entry_macid; - } else - p_dm_odm->is_one_entry_only = false; +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + dm->is_linked = (sta_cnt != 0) ? true : false; +#endif - p_dm_odm->pre_number_linked_client = p_dm_odm->number_linked_client; - p_dm_odm->pre_number_active_client = p_dm_odm->number_active_client; + if (sta_cnt == 1) { + dm->is_one_entry_only = true; + dm->one_entry_macid = one_entry_macid; + dm->one_entry_tp = ma_rx_tp; - p_dm_odm->number_linked_client = entry_cnt; - p_dm_odm->number_active_client = num_active_client; + dm->tp_active_occur = 0; - /* Update MP driver status*/ - odm_update_mp_driver_status(p_dm_odm); + PHYDM_DBG(dm, DBG_COMMON_FLOW, + "one_entry_tp=((%d)), pre_one_entry_tp=((%d))\n", + dm->one_entry_tp, dm->pre_one_entry_tp); + + if (dm->one_entry_tp > dm->pre_one_entry_tp && + dm->pre_one_entry_tp <= 2) { + tp_diff = dm->one_entry_tp - dm->pre_one_entry_tp; + + if (tp_diff > dm->tp_active_th) + dm->tp_active_occur = 1; + } + dm->pre_one_entry_tp = dm->one_entry_tp; + } else { + dm->is_one_entry_only = false; + } + + dm->pre_number_linked_client = dm->number_linked_client; + dm->pre_number_active_client = dm->number_active_client; + + dm->number_linked_client = sta_cnt; + dm->number_active_client = num_active_client; /*Traffic load information update*/ - phydm_traffic_load_decision(p_dm_odm); + phydm_traffic_load_decision(dm); - p_dm_odm->phydm_sys_up_time += p_dm_odm->phydm_period; + dm->phydm_sys_up_time += PHYDM_WATCH_DOG_PERIOD; + + dm->is_dfs_band = phydm_is_dfs_band(dm); + dm->phy_dbg_info.show_phy_sts_cnt = 0; + + /*[Link Status Check]*/ + dm->first_connect = dm->is_linked && !dm->pre_is_linked; + dm->first_disconnect = !dm->is_linked && dm->pre_is_linked; + dm->pre_is_linked = dm->is_linked; } -void -odm_common_info_self_reset( - struct PHY_DM_STRUCT *p_dm_odm -) +void phydm_common_info_self_reset(struct dm_struct *dm) { -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - p_dm_odm->phy_dbg_info.num_qry_beacon_pkt = 0; -#endif + struct odm_phy_dbg_info *dbg_t = &dm->phy_dbg_info; + + dbg_t->beacon_cnt_in_period = dbg_t->num_qry_beacon_pkt; + dbg_t->num_qry_beacon_pkt = 0; + + dm->rxsc_l = 0xff; + dm->rxsc_20 = 0xff; + dm->rxsc_40 = 0xff; + dm->rxsc_80 = 0xff; } void * -phydm_get_structure( - struct PHY_DM_STRUCT *p_dm_odm, - u8 structure_type -) +phydm_get_structure(struct dm_struct *dm, u8 structure_type) { - void *p_struct = NULL; -#if RTL8195A_SUPPORT + void *structure = NULL; + switch (structure_type) { - case PHYDM_FALSEALMCNT: - p_struct = &false_alm_cnt; + case PHYDM_FALSEALMCNT: + structure = &dm->false_alm_cnt; break; - case PHYDM_CFOTRACK: - p_struct = &dm_cfo_track; + case PHYDM_CFOTRACK: + structure = &dm->dm_cfo_track; break; - case PHYDM_ADAPTIVITY: - p_struct = &(p_dm_odm->adaptivity); + case PHYDM_ADAPTIVITY: + structure = &dm->adaptivity; + break; + + case PHYDM_DFS: + structure = &dm->dfs; break; default: break; } -#else - switch (structure_type) { - case PHYDM_FALSEALMCNT: - p_struct = &(p_dm_odm->false_alm_cnt); - break; - - case PHYDM_CFOTRACK: - p_struct = &(p_dm_odm->dm_cfo_track); - break; - - case PHYDM_ADAPTIVITY: - p_struct = &(p_dm_odm->adaptivity); - break; - - default: - break; - } - -#endif - return p_struct; + return structure; } -void -odm_hw_setting( - struct PHY_DM_STRUCT *p_dm_odm -) +void phydm_phy_info_update(struct dm_struct *dm) +{ +#if (RTL8822B_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8822B) + dm->phy_dbg_info.condi_num = phydm_get_condi_num_8822b(dm); +#endif +} + +void phydm_hw_setting(struct dm_struct *dm) { #if (RTL8821A_SUPPORT == 1) - if (p_dm_odm->support_ic_type & ODM_RTL8821) - odm_hw_setting_8821a(p_dm_odm); + if (dm->support_ic_type & ODM_RTL8821) + odm_hw_setting_8821a(dm); #endif #if (RTL8814A_SUPPORT == 1) - if (p_dm_odm->support_ic_type & ODM_RTL8814A) - phydm_hwsetting_8814a(p_dm_odm); + if (dm->support_ic_type & ODM_RTL8814A) + phydm_hwsetting_8814a(dm); #endif #if (RTL8822B_SUPPORT == 1) - if (p_dm_odm->support_ic_type & ODM_RTL8822B) - phydm_hwsetting_8822b(p_dm_odm); + if (dm->support_ic_type & ODM_RTL8822B) + phydm_hwsetting_8822b(dm); +#endif + +#if (RTL8812A_SUPPORT == 1) + if (dm->support_ic_type & ODM_RTL8812) + phydm_hwsetting_8812a(dm); #endif #if (RTL8197F_SUPPORT == 1) - if (p_dm_odm->support_ic_type & ODM_RTL8197F) - phydm_hwsetting_8197f(p_dm_odm); + if (dm->support_ic_type & ODM_RTL8197F) + phydm_hwsetting_8197f(dm); +#endif + +#if (RTL8192F_SUPPORT == 1) + if (dm->support_ic_type & ODM_RTL8192F) + phydm_hwsetting_8192f(dm); #endif } -#if SUPPORTABLITY_PHYDMLIZE -void -phydm_supportability_init( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u32 support_ability = 0; + #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) - struct _ADAPTER *adapter = p_dm_odm->adapter; - PMGNT_INFO p_mgnt_info = &adapter->MgntInfo; +u64 phydm_supportability_init_win( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u64 support_ability = 0; + + switch (dm->support_ic_type) { +/*@---------------N Series--------------------*/ +#if (RTL8188E_SUPPORT) + 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 (p_dm_odm->support_ic_type != ODM_RTL8821C) - return; - - switch (p_dm_odm->support_ic_type) { - - /*---------------N Series--------------------*/ - case ODM_RTL8188E: +#if (RTL8192E_SUPPORT) + 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_RF_TX_PWR_TRACK | - ODM_RF_RX_GAIN_TRACK | - ODM_RF_CALIBRATION | - ODM_BB_CFO_TRACKING | - ODM_BB_NHM_CNT | + 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 - case ODM_RTL8192E: +#if (RTL8723B_SUPPORT) + case ODM_RTL8723B: support_ability |= - ODM_BB_DIG | - ODM_RF_TX_PWR_TRACK | - ODM_BB_RA_MASK | - ODM_BB_FA_CNT | - ODM_BB_RSSI_MONITOR | - ODM_BB_CFO_TRACKING | - /* ODM_BB_PWR_TRAIN |*/ - ODM_BB_NHM_CNT | + 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 - case ODM_RTL8723B: +#if (RTL8703B_SUPPORT) + 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_RF_TX_PWR_TRACK | - ODM_RF_RX_GAIN_TRACK | - ODM_RF_CALIBRATION | - ODM_BB_CFO_TRACKING | - /* ODM_BB_PWR_TRAIN |*/ - ODM_BB_NHM_CNT; + 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 - case ODM_RTL8703B: +#if (RTL8723D_SUPPORT) + 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_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 - case ODM_RTL8723D: +#if (RTL8710B_SUPPORT) + case ODM_RTL8710B: 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_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 - case ODM_RTL8188F: +#if (RTL8188F_SUPPORT) + 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_BB_CFO_TRACKING | - ODM_BB_NHM_CNT | - ODM_RF_TX_PWR_TRACK | - ODM_RF_CALIBRATION; + 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; - /*---------------AC Series-------------------*/ +#endif - case ODM_RTL8812: - case ODM_RTL8821: +#if (RTL8192F_SUPPORT) + case ODM_RTL8192F: support_ability |= - ODM_BB_DIG | - ODM_BB_FA_CNT | - ODM_BB_RSSI_MONITOR | - ODM_BB_RA_MASK | - ODM_RF_TX_PWR_TRACK | - ODM_BB_CFO_TRACKING | - /* ODM_BB_PWR_TRAIN |*/ - ODM_BB_DYNAMIC_TXPWR | - ODM_BB_NHM_CNT; - break; + 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 (RTL8812A_SUPPORT || RTL8821A_SUPPORT) + 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) 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_BB_CFO_TRACKING | - ODM_BB_DYNAMIC_TXPWR | - ODM_BB_NHM_CNT; + 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) 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_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_ADAPTIVE_SOML |*/ + ODM_BB_RATE_ADAPTIVE | + /*ODM_BB_PATH_DIV |*/ + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR; break; +#endif +#if (RTL8821C_SUPPORT) 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 | -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) - ODM_MAC_EDCA_TURBO | + 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 - ODM_BB_CFO_TRACKING; /* | - * ODM_BB_DYNAMIC_TXPWR | - * ODM_BB_NHM_CNT;*/ - break; - default: - dbg_print("[Warning] Supportability Init error !!!\n"); - break; +/*@---------------JGR3 Series-------------------*/ + +#if (RTL8822C_SUPPORT) + case ODM_RTL8822C: + 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_RATE_ADAPTIVE | + ODM_BB_PATH_DIV | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR; + break; +#endif + +#if (RTL8814B_SUPPORT) + 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 + + 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; + + pr_debug("[Warning] Supportability Init Warning !!!\n"); + break; } - if (*(p_dm_odm->p_enable_antdiv)) + return support_ability; +} +#endif + +#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) +u64 phydm_supportability_init_ce(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u64 support_ability = 0; + + switch (dm->support_ic_type) { +/*@---------------N Series--------------------*/ +#if (RTL8188E_SUPPORT) + 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) + 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) + 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) + 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) + 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) + 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) + 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 + +#if (RTL8192F_SUPPORT) + case ODM_RTL8192F: + 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 (RTL8812A_SUPPORT || RTL8821A_SUPPORT) + 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) + 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 (RTL8822B_SUPPORT) + 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_PATH_DIV |*/ + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR; + break; +#endif + +#if (RTL8821C_SUPPORT) + 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 + +/*@---------------JGR3 Series-------------------*/ + +#if (RTL8822C_SUPPORT) + case ODM_RTL8822C: + 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_RATE_ADAPTIVE | + ODM_BB_PATH_DIV | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR; + break; +#endif + +#if (RTL8814B_SUPPORT) + 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 + + 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; + + pr_debug("[Warning] Supportability Init Warning !!!\n"); + break; + } + + return support_ability; +} +#endif + +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) +u64 phydm_supportability_init_ap( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u64 support_ability = 0; + + switch (dm->support_ic_type) { +/*@---------------N Series--------------------*/ +#if (RTL8188E_SUPPORT) + 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) + 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) + 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 || RTL8197F_SUPPORT) + case ODM_RTL8198F: + 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; + 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 + +#if (RTL8192F_SUPPORT) + case ODM_RTL8192F: + 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 |*/ + 0; + break; +#endif + +/*@---------------AC Series-------------------*/ + +#if (RTL8881A_SUPPORT) + 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) + 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 (RTL8822B_SUPPORT) + 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_ADAPTIVE_SOML |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR; + break; +#endif + +#if (RTL8821C_SUPPORT) + 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 + +/*@---------------JGR3 Series-------------------*/ + +#if (RTL8814B_SUPPORT) + 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 + + 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; + + pr_debug("[Warning] Supportability Init Warning !!!\n"); + break; + } + +#if 0 + /*@[Config Antenna Diveristy]*/ + if (*dm->enable_antdiv) support_ability |= ODM_BB_ANT_DIV; - if (*(p_dm_odm->p_enable_adaptivity)) { - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ODM adaptivity is set to Enabled!!!\n")); - + /*@[Config Adaptivity]*/ + if (*dm->enable_adaptivity) support_ability |= ODM_BB_ADAPTIVITY; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) - phydm_adaptivity_info_init(p_dm_odm, PHYDM_ADAPINFO_CARRIER_SENSE_ENABLE, p_mgnt_info->RegEnableCarrierSense); - phydm_adaptivity_info_init(p_dm_odm, PHYDM_ADAPINFO_DCBACKOFF, p_mgnt_info->RegDCbackoff); - phydm_adaptivity_info_init(p_dm_odm, PHYDM_ADAPINFO_DYNAMICLINKADAPTIVITY, p_mgnt_info->RegDmLinkAdaptivity); - phydm_adaptivity_info_init(p_dm_odm, PHYDM_ADAPINFO_AP_NUM_TH, p_mgnt_info->RegAPNumTH); - phydm_adaptivity_info_init(p_dm_odm, PHYDM_ADAPINFO_TH_L2H_INI, p_mgnt_info->RegL2HForAdaptivity); - phydm_adaptivity_info_init(p_dm_odm, PHYDM_ADAPINFO_TH_EDCCA_HL_DIFF, p_mgnt_info->RegHLDiffForAdaptivity); #endif - } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ODM adaptivity is set to disnabled!!!\n")); - /**/ - } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("PHYDM support_ability = ((0x%x))\n", support_ability)); - odm_cmn_info_init(p_dm_odm, ODM_CMNINFO_ABILITY, support_ability); + + return support_ability; } #endif -/* - * 2011/09/21 MH Add to describe different team necessary resource allocate?? - * */ -void -odm_dm_init( - struct PHY_DM_STRUCT *p_dm_odm -) +#if (DM_ODM_SUPPORT_TYPE & (ODM_IOT)) +u64 phydm_supportability_init_iot( + void *dm_void) { -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _ADAPTER *adapter = p_dm_odm->adapter; - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + struct dm_struct *dm = (struct dm_struct *)dm_void; + u64 support_ability = 0; + + switch (dm->support_ic_type) { +#if (RTL8710B_SUPPORT) + 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 SUPPORTABLITY_PHYDMLIZE - phydm_supportability_init(p_dm_odm); -#endif - odm_common_info_self_init(p_dm_odm); - odm_dig_init(p_dm_odm); - phydm_nhm_counter_statistics_init(p_dm_odm); - phydm_adaptivity_init(p_dm_odm); - phydm_ra_info_init(p_dm_odm); - odm_rate_adaptive_mask_init(p_dm_odm); - odm_cfo_tracking_init(p_dm_odm); -#if PHYDM_SUPPORT_EDCA - odm_edca_turbo_init(p_dm_odm); -#endif - odm_rssi_monitor_init(p_dm_odm); - phydm_rf_init(p_dm_odm); - odm_txpowertracking_init(p_dm_odm); - -#if (RTL8822B_SUPPORT == 1) - if (p_dm_odm->support_ic_type & ODM_RTL8822B) - phydm_txcurrentcalibration(p_dm_odm); -#endif - - odm_antenna_diversity_init(p_dm_odm); -#if (CONFIG_DYNAMIC_RX_PATH == 1) - phydm_dynamic_rx_path_init(p_dm_odm); -#endif - odm_auto_channel_select_init(p_dm_odm); - odm_path_diversity_init(p_dm_odm); - odm_dynamic_tx_power_init(p_dm_odm); - phydm_init_ra_info(p_dm_odm); -#if (PHYDM_LA_MODE_SUPPORT == 1) - adc_smp_init(p_dm_odm); +#if (RTL8195A_SUPPORT) + 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 - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -#ifdef BEAMFORMING_VERSION_1 - if (p_hal_data->beamforming_version == BEAMFORMING_VERSION_1) +#if (RTL8195B_SUPPORT) + case ODM_RTL8195B: + 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 - { - phydm_beamforming_init(p_dm_odm); + +#if (RTL8721D_SUPPORT) + case ODM_RTL8721D: + 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; + + pr_debug("[Warning] Supportability Init Warning !!!\n"); + break; } + + return support_ability; +} #endif - if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) { -#if (defined(CONFIG_BB_POWER_SAVING)) - odm_dynamic_bb_power_saving_init(p_dm_odm); +void phydm_fwoffload_ability_init(struct dm_struct *dm, + enum phydm_offload_ability offload_ability) +{ + switch (offload_ability) { + case PHYDM_PHY_PARAM_OFFLOAD: + if (dm->support_ic_type & + (ODM_RTL8814A | ODM_RTL8822B | ODM_RTL8821C)) + dm->fw_offload_ability |= PHYDM_PHY_PARAM_OFFLOAD; + break; + + case PHYDM_RF_IQK_OFFLOAD: + dm->fw_offload_ability |= PHYDM_RF_IQK_OFFLOAD; + break; + + default: + PHYDM_DBG(dm, ODM_COMP_INIT, "fwofflad, wrong init type!!\n"); + break; + } + + PHYDM_DBG(dm, ODM_COMP_INIT, "fw_offload_ability = %x\n", + dm->fw_offload_ability); +} + +void phydm_fwoffload_ability_clear(struct dm_struct *dm, + enum phydm_offload_ability offload_ability) +{ + switch (offload_ability) { + case PHYDM_PHY_PARAM_OFFLOAD: + if (dm->support_ic_type & + (ODM_RTL8814A | ODM_RTL8822B | ODM_RTL8821C)) + dm->fw_offload_ability &= (~PHYDM_PHY_PARAM_OFFLOAD); + break; + + case PHYDM_RF_IQK_OFFLOAD: + dm->fw_offload_ability &= (~PHYDM_RF_IQK_OFFLOAD); + break; + + default: + PHYDM_DBG(dm, ODM_COMP_INIT, "fwofflad, wrong init type!!\n"); + break; + } + + PHYDM_DBG(dm, ODM_COMP_INIT, "fw_offload_ability = %x\n", + dm->fw_offload_ability); +} + +void phydm_supportability_init(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u64 support_ability; + + if (dm->manual_supportability && + *dm->manual_supportability != 0xffffffff) { + support_ability = *dm->manual_supportability; + } else if (*dm->mp_mode) { + support_ability = 0; + } else { + #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) + support_ability = phydm_supportability_init_win(dm); + #elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + support_ability = phydm_supportability_init_ap(dm); + #elif(DM_ODM_SUPPORT_TYPE & (ODM_CE)) + support_ability = phydm_supportability_init_ce(dm); + #elif(DM_ODM_SUPPORT_TYPE & (ODM_IOT)) + support_ability = phydm_supportability_init_iot(dm); + #endif + + /*@[Config Antenna Diversity]*/ + if (IS_FUNC_EN(dm->enable_antdiv)) + support_ability |= ODM_BB_ANT_DIV; + + /*@[Config TXpath Diversity]*/ + if (IS_FUNC_EN(dm->enable_pathdiv)) + support_ability |= ODM_BB_PATH_DIV; + + /*@[Config Adaptive SOML]*/ + if (IS_FUNC_EN(dm->en_adap_soml)) + support_ability |= ODM_BB_ADAPTIVE_SOML; + + /* @[Config Adaptivity]*/ + if (IS_FUNC_EN(dm->enable_adaptivity)) + support_ability |= ODM_BB_ADAPTIVITY; + } + dm->support_ability = support_ability; + PHYDM_DBG(dm, ODM_COMP_INIT, "IC=0x%x, mp=%d, Supportability=0x%llx\n", + dm->support_ic_type, *dm->mp_mode, dm->support_ability); +} + +void phydm_rfe_init(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + PHYDM_DBG(dm, ODM_COMP_INIT, "RFE_Init\n"); +#if (RTL8822B_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8822B) + phydm_rfe_8822b_init(dm); +#endif +} + +void phydm_dm_early_init(struct dm_struct *dm) +{ +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) + phydm_init_debug_setting(dm); +#endif +} + +void odm_dm_init(struct dm_struct *dm) +{ + halrf_init(dm); + phydm_supportability_init(dm); + phydm_rfe_init(dm); + phydm_common_info_self_init(dm); + phydm_rx_phy_status_init(dm); +#ifdef PHYDM_AUTO_DEGBUG + phydm_auto_dbg_engine_init(dm); +#endif + phydm_dig_init(dm); +#ifdef PHYDM_SUPPORT_CCKPD + phydm_cck_pd_init(dm); +#endif + phydm_env_monitor_init(dm); + phydm_adaptivity_init(dm); + phydm_ra_info_init(dm); + phydm_rssi_monitor_init(dm); + phydm_cfo_tracking_init(dm); + phydm_rf_init(dm); + phydm_dc_cancellation(dm); +#ifdef PHYDM_TXA_CALIBRATION + phydm_txcurrentcalibration(dm); + phydm_get_pa_bias_offset(dm); +#endif +#ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY + odm_antenna_diversity_init(dm); +#endif +#ifdef CONFIG_ADAPTIVE_SOML + phydm_adaptive_soml_init(dm); +#endif +#ifdef CONFIG_PATH_DIVERSITY + phydm_tx_path_diversity_init(dm); +#endif +#ifdef CONFIG_DYNAMIC_TX_TWR + phydm_dynamic_tx_power_init(dm); +#endif +#if (PHYDM_LA_MODE_SUPPORT == 1) + phydm_la_init(dm); +#endif + +#ifdef PHYDM_BEAMFORMING_VERSION1 + phydm_beamforming_init(dm); #endif #if (RTL8188E_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8188E) { - odm_primary_cca_init(p_dm_odm); - odm_ra_info_init_all(p_dm_odm); - } + odm_ra_info_init_all(dm); +#endif +#ifdef PHYDM_PRIMARY_CCA + phydm_primary_cca_init(dm); +#endif +#ifdef CONFIG_PSD_TOOL + phydm_psd_init(dm); #endif -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - -#if (RTL8723B_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8723B) - odm_sw_ant_detect_init(p_dm_odm); +#ifdef CONFIG_SMART_ANTENNA + phydm_smt_ant_init(dm); +#endif +#ifdef PHYDM_LNA_SAT_CHK_SUPPORT + phydm_lna_sat_check_init(dm); +#endif +#ifdef CONFIG_MCC_DM + phydm_mcc_init(dm); #endif -#if (RTL8192E_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8192E) - odm_primary_cca_check_init(p_dm_odm); +#ifdef CONFIG_MU_RSOML + phydm_mu_rsoml_init(dm); #endif - -#endif - - } - } -void -odm_dm_reset( - struct PHY_DM_STRUCT *p_dm_odm -) +void odm_dm_reset(struct dm_struct *dm) { - struct _dynamic_initial_gain_threshold_ *p_dm_dig_table = &p_dm_odm->dm_dig_table; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; - odm_ant_div_reset(p_dm_odm); - phydm_set_edcca_threshold_api(p_dm_odm, p_dm_dig_table->cur_ig_value); + #ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY + odm_ant_div_reset(dm); + #endif + phydm_set_edcca_threshold_api(dm, 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 -) +void phydm_supportability_en(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u32 pre_support_ability; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 dm_value[10] = {0}; + u64 pre_support_ability, one = 1; + u64 comp = 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]); + } + + pre_support_ability = dm->support_ability; + comp = dm->support_ability; + + PDM_SNPF(out_len, used, output + used, out_len - used, + "\n================================\n"); - pre_support_ability = p_dm_odm->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_odm->support_ability & ODM_BB_DIG) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "01. (( %s ))RA_MASK\n", ((p_dm_odm->support_ability & ODM_BB_RA_MASK) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "02. (( %s ))DYNAMIC_TXPWR\n", ((p_dm_odm->support_ability & ODM_BB_DYNAMIC_TXPWR) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "03. (( %s ))FA_CNT\n", ((p_dm_odm->support_ability & ODM_BB_FA_CNT) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "04. (( %s ))RSSI_MONITOR\n", ((p_dm_odm->support_ability & ODM_BB_RSSI_MONITOR) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "05. (( %s ))CCK_PD\n", ((p_dm_odm->support_ability & ODM_BB_CCK_PD) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "06. (( %s ))ANT_DIV\n", ((p_dm_odm->support_ability & ODM_BB_ANT_DIV) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "08. (( %s ))PWR_TRAIN\n", ((p_dm_odm->support_ability & ODM_BB_PWR_TRAIN) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "09. (( %s ))RATE_ADAPTIVE\n", ((p_dm_odm->support_ability & ODM_BB_RATE_ADAPTIVE) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "10. (( %s ))PATH_DIV\n", ((p_dm_odm->support_ability & ODM_BB_PATH_DIV) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "13. (( %s ))ADAPTIVITY\n", ((p_dm_odm->support_ability & ODM_BB_ADAPTIVITY) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "14. (( %s ))struct _CFO_TRACKING_\n", ((p_dm_odm->support_ability & ODM_BB_CFO_TRACKING) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "15. (( %s ))NHM_CNT\n", ((p_dm_odm->support_ability & ODM_BB_NHM_CNT) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "16. (( %s ))PRIMARY_CCA\n", ((p_dm_odm->support_ability & ODM_BB_PRIMARY_CCA) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "17. (( %s ))TXBF\n", ((p_dm_odm->support_ability & ODM_BB_TXBF) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "18. (( %s ))DYNAMIC_ARFR\n", ((p_dm_odm->support_ability & ODM_BB_DYNAMIC_ARFR) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "20. (( %s ))EDCA_TURBO\n", ((p_dm_odm->support_ability & ODM_MAC_EDCA_TURBO) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "21. (( %s ))DYNAMIC_RX_PATH\n", ((p_dm_odm->support_ability & ODM_BB_DYNAMIC_RX_PATH) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "24. (( %s ))TX_PWR_TRACK\n", ((p_dm_odm->support_ability & ODM_RF_TX_PWR_TRACK) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "25. (( %s ))RX_GAIN_TRACK\n", ((p_dm_odm->support_ability & ODM_RF_RX_GAIN_TRACK) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "26. (( %s ))RF_CALIBRATION\n", ((p_dm_odm->support_ability & ODM_RF_CALIBRATION) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); - } - /* - else if(dm_value[0] == 101) - { - p_dm_odm->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 { + PDM_SNPF(out_len, used, output + used, out_len - used, + "[Supportability] PhyDM Selection\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "================================\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "00. (( %s ))DIG\n", + ((comp & ODM_BB_DIG) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "01. (( %s ))RA_MASK\n", + ((comp & ODM_BB_RA_MASK) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "02. (( %s ))DYN_TXPWR\n", + ((comp & ODM_BB_DYNAMIC_TXPWR) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "03. (( %s ))FA_CNT\n", + ((comp & ODM_BB_FA_CNT) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "04. (( %s ))RSSI_MNTR\n", + ((comp & ODM_BB_RSSI_MONITOR) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "05. (( %s ))CCK_PD\n", + ((comp & ODM_BB_CCK_PD) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "06. (( %s ))ANT_DIV\n", + ((comp & ODM_BB_ANT_DIV) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "07. (( %s ))SMT_ANT\n", + ((comp & ODM_BB_SMT_ANT) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "08. (( %s ))PWR_TRAIN\n", + ((comp & ODM_BB_PWR_TRAIN) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "09. (( %s ))RA\n", + ((comp & ODM_BB_RATE_ADAPTIVE) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "10. (( %s ))PATH_DIV\n", + ((comp & ODM_BB_PATH_DIV) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "11. (( %s ))DFS\n", + ((comp & ODM_BB_DFS) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "12. (( %s ))DYN_ARFR\n", + ((comp & ODM_BB_DYNAMIC_ARFR) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "13. (( %s ))ADAPTIVITY\n", + ((comp & ODM_BB_ADAPTIVITY) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "14. (( %s ))CFO_TRACK\n", + ((comp & ODM_BB_CFO_TRACKING) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "15. (( %s ))ENV_MONITOR\n", + ((comp & ODM_BB_ENV_MONITOR) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "16. (( %s ))PRI_CCA\n", + ((comp & ODM_BB_PRIMARY_CCA) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "17. (( %s ))ADPTV_SOML\n", + ((comp & ODM_BB_ADAPTIVE_SOML) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "18. (( %s ))LNA_SAT_CHK\n", + ((comp & ODM_BB_LNA_SAT_CHK) ? ("V") : ("."))); - if (dm_value[1] == 1) { /* enable */ - p_dm_odm->support_ability |= BIT(dm_value[0]) ; - if (BIT(dm_value[0]) & ODM_BB_PATH_DIV) - odm_path_diversity_init(p_dm_odm); - } else if (dm_value[1] == 2) /* disable */ - p_dm_odm->support_ability &= ~(BIT(dm_value[0])) ; - else { - /* dbg_print("\n[Warning!!!] 1:enable, 2:disable \n\n"); */ - PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "[Warning!!!] 1:enable, 2:disable")); + PDM_SNPF(out_len, used, output + used, out_len - used, + "================================\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "[Supportability] PhyDM offload ability\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "================================\n"); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "00. (( %s ))PHY PARAM OFFLOAD\n", + ((dm->fw_offload_ability & PHYDM_PHY_PARAM_OFFLOAD) ? + ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "01. (( %s ))RF IQK OFFLOAD\n", + ((dm->fw_offload_ability & PHYDM_RF_IQK_OFFLOAD) ? + ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "================================\n"); + + } else if (dm_value[0] == 101) { + dm->support_ability = 0; + PDM_SNPF(out_len, used, output + used, out_len - used, + "Disable all support_ability components\n"); + } else { + if (dm_value[1] == 1) { /* @enable */ + dm->support_ability |= (one << dm_value[0]); + } else if (dm_value[1] == 2) {/* @disable */ + dm->support_ability &= ~(one << dm_value[0]); + } else { + PDM_SNPF(out_len, used, output + used, out_len - used, + "[Warning!!!] 1:enable, 2:disable\n"); } } - PHYDM_SNPRINTF((output + used, out_len - used, "pre-support_ability = 0x%x\n", pre_support_ability)); - PHYDM_SNPRINTF((output + used, out_len - used, "Curr-support_ability = 0x%x\n", p_dm_odm->support_ability)); - PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); + PDM_SNPF(out_len, used, output + used, out_len - used, + "pre-supportability = 0x%llx\n", pre_support_ability); + PDM_SNPF(out_len, used, output + used, out_len - used, + "Cur-supportability = 0x%llx\n", dm->support_ability); + PDM_SNPF(out_len, used, output + used, out_len - used, + "================================\n"); + + *_used = used; + *_out_len = out_len; } -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -/* - * tmp modify for LC Only - * */ -void -odm_dm_watchdog_lps( - struct PHY_DM_STRUCT *p_dm_odm -) +void phydm_watchdog_lps_32k(struct dm_struct *dm) { - odm_common_info_self_update(p_dm_odm); - odm_false_alarm_counter_statistics(p_dm_odm); - odm_rssi_monitor_check(p_dm_odm); - odm_dig_by_rssi_lps(p_dm_odm); - odm_cck_packet_detection_thresh(p_dm_odm); - odm_common_info_self_reset(p_dm_odm); + PHYDM_DBG(dm, DBG_COMMON_FLOW, "%s ======>\n", __func__); - if (*(p_dm_odm->p_is_power_saving) == true) + phydm_common_info_self_update(dm); + phydm_rssi_monitor_check(dm); + phydm_dig_lps_32k(dm); + phydm_common_info_self_reset(dm); +} + +void phydm_watchdog_lps(struct dm_struct *dm) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE | ODM_IOT)) + PHYDM_DBG(dm, DBG_COMMON_FLOW, "%s ======>\n", __func__); + + phydm_common_info_self_update(dm); + phydm_rssi_monitor_check(dm); + phydm_basic_dbg_message(dm); + phydm_receiver_blocking(dm); + phydm_false_alarm_counter_statistics(dm); + phydm_dig_by_rssi_lps(dm); + #ifdef PHYDM_SUPPORT_CCKPD + phydm_cck_pd_th(dm); + #endif + phydm_adaptivity(dm); + #if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) + #ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY + /*@enable AntDiv in PS mode, request from SD4 Jeff*/ + odm_antenna_diversity(dm); + #endif + #endif + phydm_common_info_self_reset(dm); +#endif +} + +void phydm_watchdog_mp(struct dm_struct *dm) +{ +} + +void phydm_pause_dm_watchdog(void *dm_void, enum phydm_pause_type pause_type) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (pause_type == PHYDM_PAUSE) { + dm->disable_phydm_watchdog = 1; + PHYDM_DBG(dm, ODM_COMP_API, "PHYDM Stop\n"); + } else { + dm->disable_phydm_watchdog = 0; + PHYDM_DBG(dm, ODM_COMP_API, "PHYDM Start\n"); + } +} + +u8 phydm_pause_func(void *dm_void, enum phydm_func_idx pause_func, + enum phydm_pause_type pause_type, + enum phydm_pause_level pause_lv, u8 val_lehgth, + u32 *val_buf) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_func_poiner *func_t = &dm->phydm_func_handler; + s8 *pause_lv_pre = &dm->s8_dummy; + u32 *bkp_val = &dm->u32_dummy; + u32 ori_val[5] = {0}; + u64 pause_func_bitmap = (u64)BIT(pause_func); + u8 i = 0; + u8 en_2rcca = 0; + u8 en_bw40m = 0; + u8 pause_result = PAUSE_FAIL; + + PHYDM_DBG(dm, ODM_COMP_API, "\n"); + PHYDM_DBG(dm, ODM_COMP_API, "[%s][%s] LV=%d, Len=%d\n", __func__, + ((pause_type == PHYDM_PAUSE) ? "Pause" : + ((pause_type == PHYDM_RESUME) ? "Resume" : "Pause no_set")), + pause_lv, val_lehgth); + + if (pause_lv >= PHYDM_PAUSE_MAX_NUM) { + PHYDM_DBG(dm, ODM_COMP_API, "[WARNING]Wrong LV=%d\n", pause_lv); + return PAUSE_FAIL; + } + + if (pause_func == F00_DIG) { + PHYDM_DBG(dm, ODM_COMP_API, "[DIG]\n"); + + if (val_lehgth != 1) { + PHYDM_DBG(dm, ODM_COMP_API, "[WARNING] length != 1\n"); + return PAUSE_FAIL; + } + + ori_val[0] = (u32)(dm->dm_dig_table.cur_ig_value); + pause_lv_pre = &dm->pause_lv_table.lv_dig; + bkp_val = (u32 *)(&dm->dm_dig_table.rvrt_val); + /*@function pointer hook*/ + func_t->pause_phydm_handler = phydm_set_dig_val; + +#ifdef PHYDM_SUPPORT_CCKPD + } else if (pause_func == F05_CCK_PD) { + PHYDM_DBG(dm, ODM_COMP_API, "[CCK_PD]\n"); + + if (val_lehgth != 1) { + PHYDM_DBG(dm, ODM_COMP_API, "[WARNING] length != 1\n"); + return PAUSE_FAIL; + } + + ori_val[0] = (u32)dm->dm_cckpd_table.cck_pd_lv; + pause_lv_pre = &dm->pause_lv_table.lv_cckpd; + bkp_val = (u32 *)(&dm->dm_cckpd_table.rvrt_val); + /*@function pointer hook*/ + func_t->pause_phydm_handler = phydm_set_cckpd_val; +#endif + +#ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY + } else if (pause_func == F06_ANT_DIV) { + PHYDM_DBG(dm, ODM_COMP_API, "[AntDiv]\n"); + + if (val_lehgth != 1) { + PHYDM_DBG(dm, ODM_COMP_API, "[WARNING] length != 1\n"); + return PAUSE_FAIL; + } + /*@default antenna*/ + ori_val[0] = (u32)(dm->dm_fat_table.rx_idle_ant); + pause_lv_pre = &dm->pause_lv_table.lv_antdiv; + bkp_val = (u32 *)(&dm->dm_fat_table.rvrt_val); + /*@function pointer hook*/ + func_t->pause_phydm_handler = phydm_set_antdiv_val; + +#endif +#ifdef PHYDM_SUPPORT_ADAPTIVITY + } else if (pause_func == F13_ADPTVTY) { + PHYDM_DBG(dm, ODM_COMP_API, "[Adaptivity]\n"); + + if (val_lehgth != 2) { + PHYDM_DBG(dm, ODM_COMP_API, "[WARNING] length != 2\n"); + return PAUSE_FAIL; + } + + ori_val[0] = (u32)(dm->adaptivity.th_l2h); /*th_l2h*/ + ori_val[1] = (u32)(dm->adaptivity.th_h2l); /*th_h2l*/ + pause_lv_pre = &dm->pause_lv_table.lv_adapt; + bkp_val = (u32 *)(&dm->adaptivity.rvrt_val); + /*@function pointer hook*/ + func_t->pause_phydm_handler = phydm_set_edcca_val; + +#endif +#ifdef CONFIG_ADAPTIVE_SOML + } else if (pause_func == F17_ADPTV_SOML) { + PHYDM_DBG(dm, ODM_COMP_API, "[AD-SOML]\n"); + + if (val_lehgth != 1) { + PHYDM_DBG(dm, ODM_COMP_API, "[WARNING] length != 1\n"); + return PAUSE_FAIL; + } + /*SOML_ON/OFF*/ + ori_val[0] = (u32)(dm->dm_soml_table.soml_on_off); + + pause_lv_pre = &dm->pause_lv_table.lv_adsl; + bkp_val = (u32 *)(&dm->dm_soml_table.rvrt_val); + /*@function pointer hook*/ + func_t->pause_phydm_handler = phydm_set_adsl_val; + +#endif + } else { + PHYDM_DBG(dm, ODM_COMP_API, "[WARNING] error func idx\n"); + return PAUSE_FAIL; + } + + PHYDM_DBG(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) { + PHYDM_DBG(dm, ODM_COMP_API, + "[PAUSE FAIL] Pre_LV >= Curr_LV\n"); + return PAUSE_FAIL; + } + + if (!(dm->pause_ability & pause_func_bitmap)) { + for (i = 0; i < val_lehgth; i++) + bkp_val[i] = ori_val[i]; + } + + dm->pause_ability |= pause_func_bitmap; + PHYDM_DBG(dm, ODM_COMP_API, "pause_ability=0x%llx\n", + dm->pause_ability); + + if (pause_type == PHYDM_PAUSE) { + for (i = 0; i < val_lehgth; i++) + PHYDM_DBG(dm, ODM_COMP_API, + "[PAUSE SUCCESS] val_idx[%d]{New, Ori}={0x%x, 0x%x}\n", + i, val_buf[i], bkp_val[i]); + func_t->pause_phydm_handler(dm, val_buf, val_lehgth); + } else { + for (i = 0; i < val_lehgth; i++) + PHYDM_DBG(dm, ODM_COMP_API, + "[PAUSE NO Set: SUCCESS] val_idx[%d]{Ori}={0x%x}\n", + i, bkp_val[i]); + } + + *pause_lv_pre = pause_lv; + pause_result = PAUSE_SUCCESS; + + } else if (pause_type == PHYDM_RESUME) { + if ((dm->pause_ability & pause_func_bitmap) == 0) { + PHYDM_DBG(dm, ODM_COMP_API, + "[RESUME] No Need to Revert\n"); + return PAUSE_SUCCESS; + } + + dm->pause_ability &= ~pause_func_bitmap; + PHYDM_DBG(dm, ODM_COMP_API, "pause_ability=0x%llx\n", + dm->pause_ability); + + *pause_lv_pre = PHYDM_PAUSE_RELEASE; + + for (i = 0; i < val_lehgth; i++) { + PHYDM_DBG(dm, ODM_COMP_API, + "[RESUME] val_idx[%d]={0x%x}\n", i, + bkp_val[i]); + } + + func_t->pause_phydm_handler(dm, bkp_val, val_lehgth); + + pause_result = PAUSE_SUCCESS; + } else { + PHYDM_DBG(dm, ODM_COMP_API, "[WARNING] error pause_type\n"); + pause_result = PAUSE_FAIL; + } + return pause_result; +} + +void phydm_pause_func_console(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + char help[] = "-h"; + u32 var1[10] = {0}; + u32 used = *_used; + u32 out_len = *_out_len; + u32 i; + u8 length = 0; + u32 buf[5] = {0}; + u8 set_result = 0; + enum phydm_func_idx func = 0; + enum phydm_pause_type type = 0; + enum phydm_pause_level lv = 0; + + if ((strcmp(input[1], help) == 0)) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "{Func} {1:pause,2:pause no set 3:Resume} {lv:0~3} Val[5:0]\n"); + + goto out; + } + + for (i = 0; i < 10; i++) { + if (input[i + 1]) + PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); + } + + func = (enum phydm_func_idx)var1[0]; + type = (enum phydm_pause_type)var1[1]; + lv = (enum phydm_pause_level)var1[2]; + + for (i = 0; i < 5; i++) + buf[i] = var1[3 + i]; + + if (func == F00_DIG) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "[DIG]\n"); + length = 1; + + } else if (func == F05_CCK_PD) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "[CCK_PD]\n"); + length = 1; + } else if (func == F06_ANT_DIV) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "[Ant_Div]\n"); + length = 1; + } else if (func == F13_ADPTVTY) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "[Adaptivity]\n"); + length = 2; + } else if (func == F17_ADPTV_SOML) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "[ADSL]\n"); + length = 1; + } else { + PDM_SNPF(out_len, used, output + used, out_len - used, + "[Set Function Error]\n"); + length = 0; + } + + if (length != 0) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "{%s, lv=%d} val = %d, %d}\n", + ((type == PHYDM_PAUSE) ? "Pause" : + ((type == PHYDM_RESUME) ? "Resume" : "Pause no_set")), + lv, var1[3], var1[4]); + + set_result = phydm_pause_func(dm, func, type, lv, length, buf); + } + + PDM_SNPF(out_len, used, output + used, out_len - used, + "set_result = %d\n", set_result); + +out: + *_used = used; + *_out_len = out_len; +} + +u8 phydm_stop_dm_watchdog_check(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (dm->disable_phydm_watchdog == 1) { + PHYDM_DBG(dm, DBG_COMMON_FLOW, "Disable phydm\n"); + return true; + } else { + return false; + } +} + +void phydm_watchdog(struct dm_struct *dm) +{ + PHYDM_DBG(dm, DBG_COMMON_FLOW, "%s ======>\n", __func__); + + phydm_common_info_self_update(dm); + phydm_phy_info_update(dm); + phydm_rssi_monitor_check(dm); + phydm_basic_dbg_message(dm); + phydm_dm_summary(dm, FIRST_MACID); +#ifdef PHYDM_AUTO_DEGBUG + phydm_auto_dbg_engine(dm); +#endif + phydm_receiver_blocking(dm); + + if (phydm_stop_dm_watchdog_check(dm) == true) return; -} -#endif -void -phydm_watchdog_mp( - struct PHY_DM_STRUCT *p_dm_odm -) -{ -#if (CONFIG_DYNAMIC_RX_PATH == 1) - phydm_dynamic_rx_path_caller(p_dm_odm); -#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_dm_watchdog( - struct PHY_DM_STRUCT *p_dm_odm -) -{ - odm_common_info_self_update(p_dm_odm); - phydm_basic_dbg_message(p_dm_odm); - phydm_receiver_blocking(p_dm_odm); - odm_hw_setting(p_dm_odm); + phydm_hw_setting(dm); -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) + #ifdef PHYDM_TDMA_DIG_SUPPORT + if (dm->original_dig_restore == 0) + phydm_tdma_dig_timer_check(dm); + else + #endif { - struct rtl8192cd_priv *priv = p_dm_odm->priv; - if ((priv->auto_channel != 0) && (priv->auto_channel != 2)) /* if struct _ACS_ running, do not do FA/CCA counter read */ - return; - } -#endif - odm_false_alarm_counter_statistics(p_dm_odm); - phydm_noisy_detection(p_dm_odm); - - odm_rssi_monitor_check(p_dm_odm); - - if (*(p_dm_odm->p_is_power_saving) == true) { - odm_dig_by_rssi_lps(p_dm_odm); - phydm_adaptivity(p_dm_odm); -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) - odm_antenna_diversity(p_dm_odm); /*enable AntDiv in PS mode, request from SD4 Jeff*/ -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("DMWatchdog in power saving mode\n")); - return; + phydm_false_alarm_counter_statistics(dm); + phydm_noisy_detection(dm); + phydm_dig(dm); + #ifdef PHYDM_SUPPORT_CCKPD + phydm_cck_pd_th(dm); + #endif } - phydm_check_adaptivity(p_dm_odm); - odm_update_power_training_state(p_dm_odm); - odm_DIG(p_dm_odm); - phydm_adaptivity(p_dm_odm); - odm_cck_packet_detection_thresh(p_dm_odm); - - phydm_ra_info_watchdog(p_dm_odm); -#if PHYDM_SUPPORT_EDCA - odm_edca_turbo_check(p_dm_odm); +#ifdef PHYDM_POWER_TRAINING_SUPPORT + phydm_update_power_training_state(dm); #endif - odm_path_diversity(p_dm_odm); - odm_cfo_tracking(p_dm_odm); - odm_dynamic_tx_power(p_dm_odm); - odm_antenna_diversity(p_dm_odm); -#if (CONFIG_DYNAMIC_RX_PATH == 1) - phydm_dynamic_rx_path(p_dm_odm); + phydm_adaptivity(dm); + phydm_ra_info_watchdog(dm); +#ifdef CONFIG_PATH_DIVERSITY + phydm_tx_path_diversity(dm); +#endif + phydm_cfo_tracking(dm); +#ifdef CONFIG_DYNAMIC_TX_TWR + phydm_dynamic_tx_power(dm); +#endif +#ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY + odm_antenna_diversity(dm); +#endif +#ifdef CONFIG_ADAPTIVE_SOML + phydm_adaptive_soml(dm); #endif -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - phydm_beamforming_watchdog(p_dm_odm); +#ifdef PHYDM_BEAMFORMING_VERSION1 + phydm_beamforming_watchdog(dm); #endif - phydm_rf_watchdog(p_dm_odm); - - if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) { - -#if (RTL8188E_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8188E) - odm_dynamic_primary_cca(p_dm_odm); + halrf_watchdog(dm); +#ifdef PHYDM_PRIMARY_CCA + phydm_primary_cca(dm); #endif - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - -#if (RTL8192E_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8192E) - odm_dynamic_primary_cca_check(p_dm_odm); -#endif -#endif - } - #if (DM_ODM_SUPPORT_TYPE == ODM_CE) - odm_dtc(p_dm_odm); + odm_dtc(dm); #endif - odm_common_info_self_reset(p_dm_odm); + phydm_env_mntr_watchdog(dm); +#ifdef PHYDM_LNA_SAT_CHK_SUPPORT + phydm_lna_sat_chk_watchdog(dm); +#endif +#ifdef CONFIG_MCC_DM + phydm_mcc_switch(dm); +#endif + +#ifdef CONFIG_MU_RSOML + phydm_mu_rsoml_decision(dm); +#endif + + phydm_common_info_self_reset(dm); } - -/* +/*@ * Init /.. Fixed HW value. Only init time. - * */ -void -odm_cmn_info_init( - struct PHY_DM_STRUCT *p_dm_odm, - enum odm_cmninfo_e cmn_info, - u32 value -) + */ +void odm_cmn_info_init(struct dm_struct *dm, enum odm_cmninfo cmn_info, + u64 value) { - /* */ /* This section is used for init value */ - /* */ - switch (cmn_info) { - /* */ - /* Fixed ODM value. */ - /* */ - case ODM_CMNINFO_ABILITY: - p_dm_odm->support_ability = (u32)value; + switch (cmn_info) { + /* @Fixed ODM value. */ + case ODM_CMNINFO_ABILITY: + dm->support_ability = (u64)value; break; - case ODM_CMNINFO_RF_TYPE: - p_dm_odm->rf_type = (u8)value; + case ODM_CMNINFO_RF_TYPE: + dm->rf_type = (u8)value; break; - case ODM_CMNINFO_PLATFORM: - p_dm_odm->support_platform = (u8)value; + case ODM_CMNINFO_PLATFORM: + dm->support_platform = (u8)value; break; - case ODM_CMNINFO_INTERFACE: - p_dm_odm->support_interface = (u8)value; + case ODM_CMNINFO_INTERFACE: + dm->support_interface = (u8)value; break; - case ODM_CMNINFO_MP_TEST_CHIP: - p_dm_odm->is_mp_chip = (u8)value; + case ODM_CMNINFO_MP_TEST_CHIP: + dm->is_mp_chip = (u8)value; break; - case ODM_CMNINFO_IC_TYPE: - p_dm_odm->support_ic_type = value; + case ODM_CMNINFO_IC_TYPE: + dm->support_ic_type = (u32)value; break; - case ODM_CMNINFO_CUT_VER: - p_dm_odm->cut_version = (u8)value; + case ODM_CMNINFO_CUT_VER: + dm->cut_version = (u8)value; break; - case ODM_CMNINFO_FAB_VER: - p_dm_odm->fab_version = (u8)value; + case ODM_CMNINFO_FAB_VER: + dm->fab_version = (u8)value; + break; + case ODM_CMNINFO_FW_VER: + dm->fw_version = (u8)value; + break; + case ODM_CMNINFO_FW_SUB_VER: + dm->fw_sub_version = (u8)value; + break; + case ODM_CMNINFO_RFE_TYPE: +#if (RTL8821C_SUPPORT) + if (dm->support_ic_type & ODM_RTL8821C) + dm->rfe_type_expand = (u8)value; + else +#endif + dm->rfe_type = (u8)value; + phydm_init_hw_info_by_rfe(dm); break; - case ODM_CMNINFO_RFE_TYPE: - p_dm_odm->rfe_type = (u8)value; - phydm_init_hw_info_by_rfe(p_dm_odm); + case ODM_CMNINFO_RF_ANTENNA_TYPE: + dm->ant_div_type = (u8)value; break; - case ODM_CMNINFO_RF_ANTENNA_TYPE: - p_dm_odm->ant_div_type = (u8)value; + case ODM_CMNINFO_WITH_EXT_ANTENNA_SWITCH: + dm->with_extenal_ant_switch = (u8)value; break; - case ODM_CMNINFO_WITH_EXT_ANTENNA_SWITCH: - p_dm_odm->with_extenal_ant_switch = (u8)value; - break; - - case ODM_CMNINFO_BE_FIX_TX_ANT: - p_dm_odm->dm_fat_table.b_fix_tx_ant = (u8)value; - break; - - case ODM_CMNINFO_BOARD_TYPE: - if (!p_dm_odm->is_init_hw_info_by_rfe) - p_dm_odm->board_type = (u8)value; - break; - - case ODM_CMNINFO_PACKAGE_TYPE: - if (!p_dm_odm->is_init_hw_info_by_rfe) - p_dm_odm->package_type = (u8)value; - break; - - case ODM_CMNINFO_EXT_LNA: - if (!p_dm_odm->is_init_hw_info_by_rfe) - p_dm_odm->ext_lna = (u8)value; - break; - - case ODM_CMNINFO_5G_EXT_LNA: - if (!p_dm_odm->is_init_hw_info_by_rfe) - p_dm_odm->ext_lna_5g = (u8)value; - break; - - case ODM_CMNINFO_EXT_PA: - if (!p_dm_odm->is_init_hw_info_by_rfe) - p_dm_odm->ext_pa = (u8)value; - break; - - case ODM_CMNINFO_5G_EXT_PA: - if (!p_dm_odm->is_init_hw_info_by_rfe) - p_dm_odm->ext_pa_5g = (u8)value; - break; - - case ODM_CMNINFO_GPA: - if (!p_dm_odm->is_init_hw_info_by_rfe) - p_dm_odm->type_gpa = (u16)value; - break; - - case ODM_CMNINFO_APA: - if (!p_dm_odm->is_init_hw_info_by_rfe) - p_dm_odm->type_apa = (u16)value; - break; - - case ODM_CMNINFO_GLNA: - if (!p_dm_odm->is_init_hw_info_by_rfe) - p_dm_odm->type_glna = (u16)value; - break; - - case ODM_CMNINFO_ALNA: - if (!p_dm_odm->is_init_hw_info_by_rfe) - p_dm_odm->type_alna = (u16)value; - break; - - case ODM_CMNINFO_EXT_TRSW: - if (!p_dm_odm->is_init_hw_info_by_rfe) - p_dm_odm->ext_trsw = (u8)value; - break; - case ODM_CMNINFO_EXT_LNA_GAIN: - p_dm_odm->ext_lna_gain = (u8)value; - break; - case ODM_CMNINFO_PATCH_ID: - p_dm_odm->patch_id = (u8)value; - break; - case ODM_CMNINFO_BINHCT_TEST: - p_dm_odm->is_in_hct_test = (bool)value; - break; - case ODM_CMNINFO_BWIFI_TEST: - p_dm_odm->wifi_test = (u8)value; - break; - case ODM_CMNINFO_SMART_CONCURRENT: - p_dm_odm->is_dual_mac_smart_concurrent = (bool)value; - break; - case ODM_CMNINFO_DOMAIN_CODE_2G: - p_dm_odm->odm_regulation_2_4g = (u8)value; - break; - case ODM_CMNINFO_DOMAIN_CODE_5G: - p_dm_odm->odm_regulation_5g = (u8)value; - break; - case ODM_CMNINFO_CONFIG_BB_RF: - p_dm_odm->config_bbrf = (bool)value; - break; - case ODM_CMNINFO_IQKFWOFFLOAD: - p_dm_odm->iqk_fw_offload = (u8)value; - break; - case ODM_CMNINFO_IQKPAOFF: - p_dm_odm->rf_calibrate_info.is_iqk_pa_off = (bool)value; - break; - case ODM_CMNINFO_REGRFKFREEENABLE: - p_dm_odm->rf_calibrate_info.reg_rf_kfree_enable = (u8)value; - break; - case ODM_CMNINFO_RFKFREEENABLE: - p_dm_odm->rf_calibrate_info.rf_kfree_enable = (u8)value; - break; - case ODM_CMNINFO_NORMAL_RX_PATH_CHANGE: - p_dm_odm->normal_rx_path = (u8)value; - break; - case ODM_CMNINFO_EFUSE0X3D8: - p_dm_odm->efuse0x3d8 = (u8)value; - break; - case ODM_CMNINFO_EFUSE0X3D7: - p_dm_odm->efuse0x3d7 = (u8)value; - break; -#ifdef CONFIG_PHYDM_DFS_MASTER - case ODM_CMNINFO_DFS_REGION_DOMAIN: - p_dm_odm->dfs_region_domain = (u8)value; +#ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY + case ODM_CMNINFO_BE_FIX_TX_ANT: + dm->dm_fat_table.b_fix_tx_ant = (u8)value; break; #endif - /* To remove the compiler warning, must add an empty default statement to handle the other values. */ - default: - /* do nothing */ + + case ODM_CMNINFO_BOARD_TYPE: + if (!dm->is_init_hw_info_by_rfe) + dm->board_type = (u8)value; break; - } + case ODM_CMNINFO_PACKAGE_TYPE: + if (!dm->is_init_hw_info_by_rfe) + dm->package_type = (u8)value; + break; + case ODM_CMNINFO_EXT_LNA: + if (!dm->is_init_hw_info_by_rfe) + dm->ext_lna = (u8)value; + break; + + case ODM_CMNINFO_5G_EXT_LNA: + if (!dm->is_init_hw_info_by_rfe) + dm->ext_lna_5g = (u8)value; + break; + + case ODM_CMNINFO_EXT_PA: + if (!dm->is_init_hw_info_by_rfe) + dm->ext_pa = (u8)value; + break; + + case ODM_CMNINFO_5G_EXT_PA: + if (!dm->is_init_hw_info_by_rfe) + dm->ext_pa_5g = (u8)value; + break; + + case ODM_CMNINFO_GPA: + if (!dm->is_init_hw_info_by_rfe) + dm->type_gpa = (u16)value; + break; + + case ODM_CMNINFO_APA: + if (!dm->is_init_hw_info_by_rfe) + dm->type_apa = (u16)value; + break; + + case ODM_CMNINFO_GLNA: + if (!dm->is_init_hw_info_by_rfe) + dm->type_glna = (u16)value; + break; + + case ODM_CMNINFO_ALNA: + if (!dm->is_init_hw_info_by_rfe) + dm->type_alna = (u16)value; + break; + + case ODM_CMNINFO_EXT_TRSW: + if (!dm->is_init_hw_info_by_rfe) + dm->ext_trsw = (u8)value; + break; + case ODM_CMNINFO_EXT_LNA_GAIN: + dm->ext_lna_gain = (u8)value; + break; + case ODM_CMNINFO_PATCH_ID: + dm->iot_table.win_patch_id = (u8)value; + break; + case ODM_CMNINFO_BINHCT_TEST: + dm->is_in_hct_test = (boolean)value; + break; + case ODM_CMNINFO_BWIFI_TEST: + dm->wifi_test = (u8)value; + break; + case ODM_CMNINFO_SMART_CONCURRENT: + dm->is_dual_mac_smart_concurrent = (boolean)value; + break; +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + case ODM_CMNINFO_CONFIG_BB_RF: + dm->config_bbrf = (boolean)value; + break; +#endif + case ODM_CMNINFO_IQKPAOFF: + dm->rf_calibrate_info.is_iqk_pa_off = (boolean)value; + break; + case ODM_CMNINFO_REGRFKFREEENABLE: + dm->rf_calibrate_info.reg_rf_kfree_enable = (u8)value; + break; + case ODM_CMNINFO_RFKFREEENABLE: + dm->rf_calibrate_info.rf_kfree_enable = (u8)value; + break; + case ODM_CMNINFO_NORMAL_RX_PATH_CHANGE: + dm->normal_rx_path = (u8)value; + break; + case ODM_CMNINFO_VALID_PATH_SET: + dm->valid_path_set = (u8)value; + break; + case ODM_CMNINFO_EFUSE0X3D8: + dm->efuse0x3d8 = (u8)value; + break; + case ODM_CMNINFO_EFUSE0X3D7: + dm->efuse0x3d7 = (u8)value; + break; + case ODM_CMNINFO_ADVANCE_OTA: + dm->p_advance_ota = (u8)value; + break; + +#ifdef CONFIG_PHYDM_DFS_MASTER + case ODM_CMNINFO_DFS_REGION_DOMAIN: + dm->dfs_region_domain = (u8)value; + break; +#endif + case ODM_CMNINFO_SOFT_AP_SPECIAL_SETTING: + dm->soft_ap_special_setting = (u32)value; + break; + + case ODM_CMNINFO_X_CAP_SETTING: + dm->dm_cfo_track.crystal_cap_default = (u8)value; + break; + + case ODM_CMNINFO_DPK_EN: + /*@dm->dpk_en = (u1Byte)value;*/ + halrf_cmn_info_set(dm, HALRF_CMNINFO_DPK_EN, (u64)value); + break; + + case ODM_CMNINFO_HP_HWID: + dm->hp_hw_id = (boolean)value; + break; + case ODM_CMNINFO_DIS_DPD: + dm->en_dis_dpd = (boolean)value; + break; + default: + break; + } } - -void -odm_cmn_info_hook( - struct PHY_DM_STRUCT *p_dm_odm, - enum odm_cmninfo_e cmn_info, - void *p_value -) +void odm_cmn_info_hook(struct dm_struct *dm, enum odm_cmninfo cmn_info, + void *value) { - /* */ - /* Hook call by reference pointer. */ - /* */ - switch (cmn_info) { - /* */ - /* Dynamic call by reference pointer. */ - /* */ - case ODM_CMNINFO_MAC_PHY_MODE: - p_dm_odm->p_mac_phy_mode = (u8 *)p_value; + /* @Hook call by reference pointer. */ + switch (cmn_info) { + /* @Dynamic call by reference pointer. */ + case ODM_CMNINFO_TX_UNI: + dm->num_tx_bytes_unicast = (u64 *)value; break; - case ODM_CMNINFO_TX_UNI: - p_dm_odm->p_num_tx_bytes_unicast = (u64 *)p_value; + case ODM_CMNINFO_RX_UNI: + dm->num_rx_bytes_unicast = (u64 *)value; break; - case ODM_CMNINFO_RX_UNI: - p_dm_odm->p_num_rx_bytes_unicast = (u64 *)p_value; + case ODM_CMNINFO_BAND: + dm->band_type = (u8 *)value; break; - case ODM_CMNINFO_WM_MODE: - p_dm_odm->p_wireless_mode = (u8 *)p_value; + case ODM_CMNINFO_SEC_CHNL_OFFSET: + dm->sec_ch_offset = (u8 *)value; break; - case ODM_CMNINFO_BAND: - p_dm_odm->p_band_type = (u8 *)p_value; + case ODM_CMNINFO_SEC_MODE: + dm->security = (u8 *)value; break; - case ODM_CMNINFO_SEC_CHNL_OFFSET: - p_dm_odm->p_sec_ch_offset = (u8 *)p_value; + case ODM_CMNINFO_BW: + dm->band_width = (u8 *)value; break; - case ODM_CMNINFO_SEC_MODE: - p_dm_odm->p_security = (u8 *)p_value; + case ODM_CMNINFO_CHNL: + dm->channel = (u8 *)value; break; - case ODM_CMNINFO_BW: - p_dm_odm->p_band_width = (u8 *)p_value; + case ODM_CMNINFO_SCAN: + dm->is_scan_in_process = (boolean *)value; break; - case ODM_CMNINFO_CHNL: - p_dm_odm->p_channel = (u8 *)p_value; + case ODM_CMNINFO_POWER_SAVING: + dm->is_power_saving = (boolean *)value; break; - case ODM_CMNINFO_DMSP_GET_VALUE: - p_dm_odm->p_is_get_value_from_other_mac = (bool *)p_value; + case ODM_CMNINFO_TDMA: + dm->is_tdma = (boolean *)value; break; - case ODM_CMNINFO_BUDDY_ADAPTOR: - p_dm_odm->p_buddy_adapter = (struct _ADAPTER **)p_value; + case ODM_CMNINFO_ONE_PATH_CCA: + dm->one_path_cca = (u8 *)value; break; - case ODM_CMNINFO_DMSP_IS_MASTER: - p_dm_odm->p_is_master_of_dmsp = (bool *)p_value; + case ODM_CMNINFO_DRV_STOP: + dm->is_driver_stopped = (boolean *)value; + break; + case ODM_CMNINFO_INIT_ON: + dm->pinit_adpt_in_progress = (boolean *)value; break; - case ODM_CMNINFO_SCAN: - p_dm_odm->p_is_scan_in_process = (bool *)p_value; + case ODM_CMNINFO_ANT_TEST: + dm->antenna_test = (u8 *)value; break; - case ODM_CMNINFO_POWER_SAVING: - p_dm_odm->p_is_power_saving = (bool *)p_value; + case ODM_CMNINFO_NET_CLOSED: + dm->is_net_closed = (boolean *)value; break; - case ODM_CMNINFO_ONE_PATH_CCA: - p_dm_odm->p_one_path_cca = (u8 *)p_value; + case ODM_CMNINFO_FORCED_RATE: + dm->forced_data_rate = (u16 *)value; + break; + case ODM_CMNINFO_ANT_DIV: + dm->enable_antdiv = (u8 *)value; + break; + case ODM_CMNINFO_PATH_DIV: + dm->enable_pathdiv = (u8 *)value; + break; + case ODM_CMNINFO_ADAPTIVE_SOML: + dm->en_adap_soml = (u8 *)value; + break; + case ODM_CMNINFO_ADAPTIVITY: + dm->enable_adaptivity = (u8 *)value; break; - case ODM_CMNINFO_DRV_STOP: - p_dm_odm->p_is_driver_stopped = (bool *)p_value; + case ODM_CMNINFO_P2P_LINK: + dm->dm_dig_table.is_p2p_in_process = (u8 *)value; break; - case ODM_CMNINFO_PNP_IN: - p_dm_odm->p_is_driver_is_going_to_pnp_set_power_sleep = (bool *)p_value; + case ODM_CMNINFO_IS1ANTENNA: + dm->is_1_antenna = (boolean *)value; break; - case ODM_CMNINFO_INIT_ON: - p_dm_odm->pinit_adpt_in_progress = (bool *)p_value; + case ODM_CMNINFO_RFDEFAULTPATH: + dm->rf_default_path = (u8 *)value; break; - case ODM_CMNINFO_ANT_TEST: - p_dm_odm->p_antenna_test = (u8 *)p_value; + case ODM_CMNINFO_FCS_MODE: /* @fast channel switch (= MCC mode)*/ + dm->is_fcs_mode_enable = (boolean *)value; break; - case ODM_CMNINFO_NET_CLOSED: - p_dm_odm->p_is_net_closed = (bool *)p_value; + case ODM_CMNINFO_HUBUSBMODE: + dm->hub_usb_mode = (u8 *)value; break; - - case ODM_CMNINFO_FORCED_RATE: - p_dm_odm->p_forced_data_rate = (u16 *)p_value; + case ODM_CMNINFO_FWDWRSVDPAGEINPROGRESS: + dm->is_fw_dw_rsvd_page_in_progress = (boolean *)value; break; - case ODM_CMNINFO_ANT_DIV: - p_dm_odm->p_enable_antdiv = (u8 *)p_value; + case ODM_CMNINFO_TX_TP: + dm->current_tx_tp = (u32 *)value; break; - case ODM_CMNINFO_ADAPTIVITY: - p_dm_odm->p_enable_adaptivity = (u8 *)p_value; + case ODM_CMNINFO_RX_TP: + dm->current_rx_tp = (u32 *)value; break; - case ODM_CMNINFO_FORCED_IGI_LB: - p_dm_odm->pu1_forced_igi_lb = (u8 *)p_value; - break; - - case ODM_CMNINFO_P2P_LINK: - p_dm_odm->dm_dig_table.is_p2p_in_process = (u8 *)p_value; - break; - - case ODM_CMNINFO_IS1ANTENNA: - p_dm_odm->p_is_1_antenna = (bool *)p_value; - break; - - case ODM_CMNINFO_RFDEFAULTPATH: - p_dm_odm->p_rf_default_path = (u8 *)p_value; - break; - - case ODM_CMNINFO_FCS_MODE: - p_dm_odm->p_is_fcs_mode_enable = (bool *)p_value; - break; - /*add by YuChen for beamforming PhyDM*/ - case ODM_CMNINFO_HUBUSBMODE: - p_dm_odm->hub_usb_mode = (u8 *)p_value; - break; - case ODM_CMNINFO_FWDWRSVDPAGEINPROGRESS: - p_dm_odm->p_is_fw_dw_rsvd_page_in_progress = (bool *)p_value; - break; - case ODM_CMNINFO_TX_TP: - p_dm_odm->p_current_tx_tp = (u32 *)p_value; - break; - case ODM_CMNINFO_RX_TP: - p_dm_odm->p_current_rx_tp = (u32 *)p_value; - break; - case ODM_CMNINFO_SOUNDING_SEQ: - p_dm_odm->p_sounding_seq = (u8 *)p_value; + case ODM_CMNINFO_SOUNDING_SEQ: + dm->sounding_seq = (u8 *)value; break; #ifdef CONFIG_PHYDM_DFS_MASTER - case ODM_CMNINFO_DFS_MASTER_ENABLE: - p_dm_odm->dfs_master_enabled = (u8 *)p_value; + case ODM_CMNINFO_DFS_MASTER_ENABLE: + dm->dfs_master_enabled = (u8 *)value; break; #endif - case ODM_CMNINFO_FORCE_TX_ANT_BY_TXDESC: - p_dm_odm->dm_fat_table.p_force_tx_ant_by_desc = (u8 *)p_value; - break; - case ODM_CMNINFO_SET_S0S1_DEFAULT_ANTENNA: - p_dm_odm->dm_fat_table.p_default_s0_s1 = (u8 *)p_value; - break; +#ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY + case ODM_CMNINFO_FORCE_TX_ANT_BY_TXDESC: + dm->dm_fat_table.p_force_tx_by_desc = (u8 *)value; + break; + case ODM_CMNINFO_SET_S0S1_DEFAULT_ANTENNA: + dm->dm_fat_table.p_default_s0_s1 = (u8 *)value; + break; + case ODM_CMNINFO_BF_ANTDIV_DECISION: + dm->dm_fat_table.is_no_csi_feedback = (boolean *)value; + break; +#endif + + case ODM_CMNINFO_SOFT_AP_MODE: + dm->soft_ap_mode = (u32 *)value; + break; + case ODM_CMNINFO_MP_MODE: + dm->mp_mode = (u8 *)value; + break; + case ODM_CMNINFO_INTERRUPT_MASK: + dm->interrupt_mask = (u32 *)value; + break; + case ODM_CMNINFO_BB_OPERATION_MODE: + dm->bb_op_mode = (u8 *)value; + break; + case ODM_CMNINFO_MANUAL_SUPPORTABILITY: + dm->manual_supportability = (u32 *)value; + break; default: /*do nothing*/ break; - } - } - -void -odm_cmn_info_ptr_array_hook( - struct PHY_DM_STRUCT *p_dm_odm, - enum odm_cmninfo_e cmn_info, - u16 index, - void *p_value -) -{ - /*Hook call by reference pointer.*/ - switch (cmn_info) { - /*Dynamic call by reference pointer. */ - case ODM_CMNINFO_STA_STATUS: - p_dm_odm->p_odm_sta_info[index] = (struct sta_info *)p_value; - - if (IS_STA_VALID(p_dm_odm->p_odm_sta_info[index])) -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - p_dm_odm->platform2phydm_macid_table[((struct sta_info *)p_value)->AssociatedMacId] = index; /*associated_mac_id are unique bttween different adapter*/ -#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) - p_dm_odm->platform2phydm_macid_table[((struct sta_info *)p_value)->aid] = index; -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - p_dm_odm->platform2phydm_macid_table[((struct sta_info *)p_value)->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_cmn_info_update( - struct PHY_DM_STRUCT *p_dm_odm, - u32 cmn_info, - u64 value -) + */ +void odm_cmn_info_update(struct dm_struct *dm, u32 cmn_info, u64 value) { - /* */ /* This init variable may be changed in run time. */ - /* */ - switch (cmn_info) { + switch (cmn_info) { case ODM_CMNINFO_LINK_IN_PROGRESS: - p_dm_odm->is_link_in_process = (bool)value; + dm->is_link_in_process = (boolean)value; break; - case ODM_CMNINFO_ABILITY: - p_dm_odm->support_ability = (u32)value; + case ODM_CMNINFO_ABILITY: + dm->support_ability = (u64)value; break; - case ODM_CMNINFO_RF_TYPE: - p_dm_odm->rf_type = (u8)value; + case ODM_CMNINFO_RF_TYPE: + dm->rf_type = (u8)value; break; - case ODM_CMNINFO_WIFI_DIRECT: - p_dm_odm->is_wifi_direct = (bool)value; + case ODM_CMNINFO_WIFI_DIRECT: + dm->is_wifi_direct = (boolean)value; break; - case ODM_CMNINFO_WIFI_DISPLAY: - p_dm_odm->is_wifi_display = (bool)value; + case ODM_CMNINFO_WIFI_DISPLAY: + dm->is_wifi_display = (boolean)value; break; - case ODM_CMNINFO_LINK: - p_dm_odm->is_linked = (bool)value; + case ODM_CMNINFO_LINK: + dm->is_linked = (boolean)value; break; - case ODM_CMNINFO_STATION_STATE: - p_dm_odm->bsta_state = (bool)value; + case ODM_CMNINFO_CMW500LINK: + dm->iot_table.is_linked_cmw500 = (boolean)value; break; - case ODM_CMNINFO_RSSI_MIN: - p_dm_odm->rssi_min = (u8)value; + case ODM_CMNINFO_STATION_STATE: + dm->bsta_state = (boolean)value; break; - case ODM_CMNINFO_DBG_COMP: - p_dm_odm->debug_components = (u32)value; + case ODM_CMNINFO_RSSI_MIN: + dm->rssi_min = (u8)value; break; - case ODM_CMNINFO_DBG_LEVEL: - p_dm_odm->debug_level = (u32)value; - break; - case ODM_CMNINFO_RA_THRESHOLD_HIGH: - p_dm_odm->rate_adaptive.high_rssi_thresh = (u8)value; + case ODM_CMNINFO_RSSI_MIN_BY_PATH: + dm->rssi_min_by_path = (u8)value; break; - case ODM_CMNINFO_RA_THRESHOLD_LOW: - p_dm_odm->rate_adaptive.low_rssi_thresh = (u8)value; + case ODM_CMNINFO_DBG_COMP: + dm->debug_components = (u64)value; break; -#if defined(BT_SUPPORT) && (BT_SUPPORT == 1) + +#ifdef ODM_CONFIG_BT_COEXIST /* The following is for BT HS mode and BT coexist mechanism. */ case ODM_CMNINFO_BT_ENABLED: - p_dm_odm->is_bt_enabled = (bool)value; + dm->bt_info_table.is_bt_enabled = (boolean)value; break; case ODM_CMNINFO_BT_HS_CONNECT_PROCESS: - p_dm_odm->is_bt_connect_process = (bool)value; + dm->bt_info_table.is_bt_connect_process = (boolean)value; break; case ODM_CMNINFO_BT_HS_RSSI: - p_dm_odm->bt_hs_rssi = (u8)value; + dm->bt_info_table.bt_hs_rssi = (u8)value; break; - case ODM_CMNINFO_BT_OPERATION: - p_dm_odm->is_bt_hs_operation = (bool)value; + case ODM_CMNINFO_BT_OPERATION: + dm->bt_info_table.is_bt_hs_operation = (boolean)value; break; - case ODM_CMNINFO_BT_LIMITED_DIG: - p_dm_odm->is_bt_limited_dig = (bool)value; - break; - - case ODM_CMNINFO_BT_DIG: - p_dm_odm->bt_hs_dig_val = (u8)value; - break; - - case ODM_CMNINFO_BT_BUSY: - p_dm_odm->is_bt_busy = (bool)value; - break; - - case ODM_CMNINFO_BT_DISABLE_EDCA: - p_dm_odm->is_bt_disable_edca_turbo = (bool)value; + case ODM_CMNINFO_BT_LIMITED_DIG: + dm->bt_info_table.is_bt_limited_dig = (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: - p_dm_odm->vxd_linked = (bool)value; - break; -#endif -#endif - - case ODM_CMNINFO_AP_TOTAL_NUM: - p_dm_odm->ap_total_num = (u8)value; - break; - - case ODM_CMNINFO_POWER_TRAINING: - p_dm_odm->is_disable_power_training = (bool)value; + case ODM_CMNINFO_AP_TOTAL_NUM: + dm->ap_total_num = (u8)value; break; #ifdef CONFIG_PHYDM_DFS_MASTER - case ODM_CMNINFO_DFS_REGION_DOMAIN: - p_dm_odm->dfs_region_domain = (u8)value; + case ODM_CMNINFO_DFS_REGION_DOMAIN: + dm->dfs_region_domain = (u8)value; break; #endif -#if 0 - case ODM_CMNINFO_OP_MODE: - p_dm_odm->op_mode = (u8)value; + case ODM_CMNINFO_BT_CONTINUOUS_TURN: + dm->is_bt_continuous_turn = (boolean)value; break; - - case ODM_CMNINFO_WM_MODE: - p_dm_odm->wireless_mode = (u8)value; + case ODM_CMNINFO_IS_DOWNLOAD_FW: + dm->is_download_fw = (boolean)value; break; - - case ODM_CMNINFO_BAND: - p_dm_odm->band_type = (u8)value; + case ODM_CMNINFO_PHYDM_PATCH_ID: + dm->iot_table.phydm_patch_id = (u32)value; break; - - case ODM_CMNINFO_SEC_CHNL_OFFSET: - p_dm_odm->sec_ch_offset = (u8)value; + case ODM_CMNINFO_RRSR_VAL: + dm->dm_ra_table.rrsr_val_init = (u32)value; break; - - case ODM_CMNINFO_SEC_MODE: - p_dm_odm->security = (u8)value; - break; - - case ODM_CMNINFO_BW: - p_dm_odm->band_width = (u8)value; - break; - - case ODM_CMNINFO_CHNL: - p_dm_odm->channel = (u8)value; - break; -#endif default: - /* do nothing */ break; } - - } -u32 -phydm_cmn_info_query( - struct PHY_DM_STRUCT *p_dm_odm, - enum phydm_info_query_e info_type -) +u32 phydm_cmn_info_query(struct dm_struct *dm, enum phydm_info_query info_type) { - struct _FALSE_ALARM_STATISTICS *false_alm_cnt = (struct _FALSE_ALARM_STATISTICS *)phydm_get_structure(p_dm_odm, PHYDM_FALSEALMCNT); + struct phydm_fa_struct *fa_t = &dm->false_alm_cnt; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + struct ccx_info *ccx_info = &dm->dm_ccx_info; switch (info_type) { + /*@=== [FA Relative] ===========================================*/ case PHYDM_INFO_FA_OFDM: - return false_alm_cnt->cnt_ofdm_fail; + return fa_t->cnt_ofdm_fail; case PHYDM_INFO_FA_CCK: - return false_alm_cnt->cnt_cck_fail; + return fa_t->cnt_cck_fail; case PHYDM_INFO_FA_TOTAL: - return false_alm_cnt->cnt_all; + return fa_t->cnt_all; case PHYDM_INFO_CCA_OFDM: - return false_alm_cnt->cnt_ofdm_cca; + return fa_t->cnt_ofdm_cca; case PHYDM_INFO_CCA_CCK: - return false_alm_cnt->cnt_cck_cca; + return fa_t->cnt_cck_cca; case PHYDM_INFO_CCA_ALL: - return false_alm_cnt->cnt_cca_all; + return fa_t->cnt_cca_all; case PHYDM_INFO_CRC32_OK_VHT: - return false_alm_cnt->cnt_vht_crc32_ok; + return fa_t->cnt_vht_crc32_ok; case PHYDM_INFO_CRC32_OK_HT: - return false_alm_cnt->cnt_ht_crc32_ok; + return fa_t->cnt_ht_crc32_ok; case PHYDM_INFO_CRC32_OK_LEGACY: - return false_alm_cnt->cnt_ofdm_crc32_ok; + return fa_t->cnt_ofdm_crc32_ok; case PHYDM_INFO_CRC32_OK_CCK: - return false_alm_cnt->cnt_cck_crc32_ok; + return fa_t->cnt_cck_crc32_ok; case PHYDM_INFO_CRC32_ERROR_VHT: - return false_alm_cnt->cnt_vht_crc32_error; + return fa_t->cnt_vht_crc32_error; case PHYDM_INFO_CRC32_ERROR_HT: - return false_alm_cnt->cnt_ht_crc32_error; + return fa_t->cnt_ht_crc32_error; case PHYDM_INFO_CRC32_ERROR_LEGACY: - return false_alm_cnt->cnt_ofdm_crc32_error; + return fa_t->cnt_ofdm_crc32_error; case PHYDM_INFO_CRC32_ERROR_CCK: - return false_alm_cnt->cnt_cck_crc32_error; + return fa_t->cnt_cck_crc32_error; case PHYDM_INFO_EDCCA_FLAG: - return false_alm_cnt->edcca_flag; + return fa_t->edcca_flag; case PHYDM_INFO_OFDM_ENABLE: - return false_alm_cnt->ofdm_block_enable; + return fa_t->ofdm_block_enable; case PHYDM_INFO_CCK_ENABLE: - return false_alm_cnt->cck_block_enable; + return fa_t->cck_block_enable; case PHYDM_INFO_DBG_PORT_0: - return false_alm_cnt->dbg_port0; + return fa_t->dbg_port0; + case PHYDM_INFO_CRC32_OK_HT_AGG: + return fa_t->cnt_ht_crc32_ok_agg; + + case PHYDM_INFO_CRC32_ERROR_HT_AGG: + return fa_t->cnt_ht_crc32_error_agg; + + /*@=== [DIG] ================================================*/ + + case PHYDM_INFO_CURR_IGI: + return dig_t->cur_ig_value; + + /*@=== [RSSI] ===============================================*/ + case PHYDM_INFO_RSSI_MIN: + return (u32)dm->rssi_min; + + case PHYDM_INFO_RSSI_MAX: + return (u32)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_odm) +void odm_init_all_work_items(struct dm_struct *dm) { - - struct _ADAPTER *p_adapter = p_dm_odm->adapter; + void *adapter = dm->adapter; #if USE_WORKITEM -#if CONFIG_DYNAMIC_RX_PATH - odm_initialize_work_item(p_dm_odm, - &p_dm_odm->dm_drp_table.phydm_dynamic_rx_path_workitem, - (RT_WORKITEM_CALL_BACK)phydm_dynamic_rx_path_workitem_callback, - (void *)p_adapter, - "DynamicRxPathWorkitem"); - +#ifdef CONFIG_ADAPTIVE_SOML + odm_initialize_work_item(dm, + &dm->dm_soml_table.phydm_adaptive_soml_workitem, + (RT_WORKITEM_CALL_BACK)phydm_adaptive_soml_workitem_callback, + (void *)adapter, + "AdaptiveSOMLWorkitem"); #endif + +#ifdef ODM_EVM_ENHANCE_ANTDIV + odm_initialize_work_item(dm, + &dm->phydm_evm_antdiv_workitem, + (RT_WORKITEM_CALL_BACK)phydm_evm_antdiv_workitem_callback, + (void *)adapter, + "EvmAntdivWorkitem"); +#endif + #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY - odm_initialize_work_item(p_dm_odm, - &p_dm_odm->dm_swat_table.phydm_sw_antenna_switch_workitem, - (RT_WORKITEM_CALL_BACK)odm_sw_antdiv_workitem_callback, - (void *)p_adapter, + odm_initialize_work_item(dm, + &dm->dm_swat_table.phydm_sw_antenna_switch_workitem, + (RT_WORKITEM_CALL_BACK)odm_sw_antdiv_workitem_callback, + (void *)adapter, "AntennaSwitchWorkitem"); #endif -#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 - odm_initialize_work_item(p_dm_odm, - &p_dm_odm->dm_sat_table.hl_smart_antenna_workitem, - (RT_WORKITEM_CALL_BACK)phydm_beam_switch_workitem_callback, - (void *)p_adapter, +#if (defined(CONFIG_HL_SMART_ANTENNA)) + odm_initialize_work_item(dm, + &dm->dm_sat_table.hl_smart_antenna_workitem, + (RT_WORKITEM_CALL_BACK)phydm_beam_switch_workitem_callback, + (void *)adapter, "hl_smart_ant_workitem"); - odm_initialize_work_item(p_dm_odm, - &p_dm_odm->dm_sat_table.hl_smart_antenna_decision_workitem, - (RT_WORKITEM_CALL_BACK)phydm_beam_decision_workitem_callback, - (void *)p_adapter, + odm_initialize_work_item(dm, + &dm->dm_sat_table.hl_smart_antenna_decision_workitem, + (RT_WORKITEM_CALL_BACK)phydm_beam_decision_workitem_callback, + (void *)adapter, "hl_smart_ant_decision_workitem"); #endif odm_initialize_work_item( - p_dm_odm, - &(p_dm_odm->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_odm, - &(p_dm_odm->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_odm, - &(p_dm_odm->mpt_dig_workitem), - (RT_WORKITEM_CALL_BACK)odm_mpt_dig_work_item_callback, - (void *)p_adapter, - "mpt_dig_workitem"); - - odm_initialize_work_item( - p_dm_odm, - &(p_dm_odm->ra_rpt_workitem), - (RT_WORKITEM_CALL_BACK)odm_update_init_rate_work_item_callback, - (void *)p_adapter, + dm, + &dm->ra_rpt_workitem, + (RT_WORKITEM_CALL_BACK)halrf_update_init_rate_work_item_callback, + (void *)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_odm, - &(p_dm_odm->fast_ant_training_workitem), + dm, + &dm->fast_ant_training_workitem, (RT_WORKITEM_CALL_BACK)odm_fast_ant_training_work_item_callback, - (void *)p_adapter, + (void *)adapter, "fast_ant_training_workitem"); #endif #endif /*#if USE_WORKITEM*/ -#if (BEAMFORMING_SUPPORT == 1) +#ifdef PHYDM_BEAMFORMING_SUPPORT odm_initialize_work_item( - p_dm_odm, - &(p_dm_odm->beamforming_info.txbf_info.txbf_enter_work_item), + dm, + &dm->beamforming_info.txbf_info.txbf_enter_work_item, (RT_WORKITEM_CALL_BACK)hal_com_txbf_enter_work_item_callback, - (void *)p_adapter, + (void *)adapter, "txbf_enter_work_item"); odm_initialize_work_item( - p_dm_odm, - &(p_dm_odm->beamforming_info.txbf_info.txbf_leave_work_item), + dm, + &dm->beamforming_info.txbf_info.txbf_leave_work_item, (RT_WORKITEM_CALL_BACK)hal_com_txbf_leave_work_item_callback, - (void *)p_adapter, + (void *)adapter, "txbf_leave_work_item"); odm_initialize_work_item( - p_dm_odm, - &(p_dm_odm->beamforming_info.txbf_info.txbf_fw_ndpa_work_item), + dm, + &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, + (void *)adapter, "txbf_fw_ndpa_work_item"); odm_initialize_work_item( - p_dm_odm, - &(p_dm_odm->beamforming_info.txbf_info.txbf_clk_work_item), + dm, + &dm->beamforming_info.txbf_info.txbf_clk_work_item, (RT_WORKITEM_CALL_BACK)hal_com_txbf_clk_work_item_callback, - (void *)p_adapter, + (void *)adapter, "txbf_clk_work_item"); odm_initialize_work_item( - p_dm_odm, - &(p_dm_odm->beamforming_info.txbf_info.txbf_rate_work_item), + dm, + &dm->beamforming_info.txbf_info.txbf_rate_work_item, (RT_WORKITEM_CALL_BACK)hal_com_txbf_rate_work_item_callback, - (void *)p_adapter, + (void *)adapter, "txbf_rate_work_item"); odm_initialize_work_item( - p_dm_odm, - &(p_dm_odm->beamforming_info.txbf_info.txbf_status_work_item), + dm, + &dm->beamforming_info.txbf_info.txbf_status_work_item, (RT_WORKITEM_CALL_BACK)hal_com_txbf_status_work_item_callback, - (void *)p_adapter, + (void *)adapter, "txbf_status_work_item"); odm_initialize_work_item( - p_dm_odm, - &(p_dm_odm->beamforming_info.txbf_info.txbf_reset_tx_path_work_item), + dm, + &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, + (void *)adapter, "txbf_reset_tx_path_work_item"); odm_initialize_work_item( - p_dm_odm, - &(p_dm_odm->beamforming_info.txbf_info.txbf_get_tx_rate_work_item), + dm, + &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, + (void *)adapter, "txbf_get_tx_rate_work_item"); #endif - odm_initialize_work_item( - p_dm_odm, - &(p_dm_odm->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_odm, - &(p_dm_odm->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_odm, - &(p_dm_odm->adcsmp.adc_smp_work_item), + dm, + &dm->adcsmp.adc_smp_work_item, (RT_WORKITEM_CALL_BACK)adc_smp_work_item_callback, - (void *)p_adapter, + (void *)adapter, "adc_smp_work_item"); odm_initialize_work_item( - p_dm_odm, - &(p_dm_odm->adcsmp.adc_smp_work_item_1), + dm, + &dm->adcsmp.adc_smp_work_item_1, (RT_WORKITEM_CALL_BACK)adc_smp_work_item_callback, - (void *)p_adapter, + (void *)adapter, "adc_smp_work_item_1"); #endif - } -void -odm_free_all_work_items(struct PHY_DM_STRUCT *p_dm_odm) +void odm_free_all_work_items(struct dm_struct *dm) { #if USE_WORKITEM #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY - odm_free_work_item(&(p_dm_odm->dm_swat_table.phydm_sw_antenna_switch_workitem)); + odm_free_work_item(&dm->dm_swat_table.phydm_sw_antenna_switch_workitem); #endif -#if CONFIG_DYNAMIC_RX_PATH - odm_free_work_item(&(p_dm_odm->dm_drp_table.phydm_dynamic_rx_path_workitem)); +#ifdef CONFIG_ADAPTIVE_SOML + odm_free_work_item(&dm->dm_soml_table.phydm_adaptive_soml_workitem); #endif - - -#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 - odm_free_work_item(&(p_dm_odm->dm_sat_table.hl_smart_antenna_workitem)); - odm_free_work_item(&(p_dm_odm->dm_sat_table.hl_smart_antenna_decision_workitem)); +#ifdef ODM_EVM_ENHANCE_ANTDIV + odm_free_work_item(&dm->phydm_evm_antdiv_workitem); +#endif + +#if (defined(CONFIG_HL_SMART_ANTENNA)) + odm_free_work_item(&dm->dm_sat_table.hl_smart_antenna_workitem); + odm_free_work_item(&dm->dm_sat_table.hl_smart_antenna_decision_workitem); #endif - odm_free_work_item(&(p_dm_odm->path_div_switch_workitem)); - odm_free_work_item(&(p_dm_odm->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_odm->fast_ant_training_workitem)); + odm_free_work_item(&dm->fast_ant_training_workitem); #endif - odm_free_work_item(&(p_dm_odm->mpt_dig_workitem)); - odm_free_work_item(&(p_dm_odm->ra_rpt_workitem)); - /*odm_free_work_item((&p_dm_odm->sbdcnt_workitem));*/ + odm_free_work_item(&dm->ra_rpt_workitem); +/*odm_free_work_item((&dm->sbdcnt_workitem));*/ #endif -#if (BEAMFORMING_SUPPORT == 1) - odm_free_work_item((&p_dm_odm->beamforming_info.txbf_info.txbf_enter_work_item)); - odm_free_work_item((&p_dm_odm->beamforming_info.txbf_info.txbf_leave_work_item)); - odm_free_work_item((&p_dm_odm->beamforming_info.txbf_info.txbf_fw_ndpa_work_item)); - odm_free_work_item((&p_dm_odm->beamforming_info.txbf_info.txbf_clk_work_item)); - odm_free_work_item((&p_dm_odm->beamforming_info.txbf_info.txbf_rate_work_item)); - odm_free_work_item((&p_dm_odm->beamforming_info.txbf_info.txbf_status_work_item)); - odm_free_work_item((&p_dm_odm->beamforming_info.txbf_info.txbf_reset_tx_path_work_item)); - odm_free_work_item((&p_dm_odm->beamforming_info.txbf_info.txbf_get_tx_rate_work_item)); +#ifdef PHYDM_BEAMFORMING_SUPPORT + odm_free_work_item((&dm->beamforming_info.txbf_info.txbf_enter_work_item)); + odm_free_work_item((&dm->beamforming_info.txbf_info.txbf_leave_work_item)); + odm_free_work_item((&dm->beamforming_info.txbf_info.txbf_fw_ndpa_work_item)); + odm_free_work_item((&dm->beamforming_info.txbf_info.txbf_clk_work_item)); + odm_free_work_item((&dm->beamforming_info.txbf_info.txbf_rate_work_item)); + odm_free_work_item((&dm->beamforming_info.txbf_info.txbf_status_work_item)); + odm_free_work_item((&dm->beamforming_info.txbf_info.txbf_reset_tx_path_work_item)); + odm_free_work_item((&dm->beamforming_info.txbf_info.txbf_get_tx_rate_work_item)); #endif - odm_free_work_item((&p_dm_odm->adaptivity.phydm_pause_edcca_work_item)); - odm_free_work_item((&p_dm_odm->adaptivity.phydm_resume_edcca_work_item)); - #if (PHYDM_LA_MODE_SUPPORT == 1) - odm_free_work_item((&p_dm_odm->adcsmp.adc_smp_work_item)); - odm_free_work_item((&p_dm_odm->adcsmp.adc_smp_work_item_1)); + odm_free_work_item((&dm->adcsmp.adc_smp_work_item)); + odm_free_work_item((&dm->adcsmp.adc_smp_work_item_1)); #endif - } #endif /*#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ -#if 0 -void -odm_FindMinimumRSSI( - struct PHY_DM_STRUCT *p_dm_odm -) -{ - u32 i; - u8 rssi_min = 0xFF; - - for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { - /* if(p_dm_odm->p_odm_sta_info[i] != NULL) */ - if (IS_STA_VALID(p_dm_odm->p_odm_sta_info[i])) { - if (p_dm_odm->p_odm_sta_info[i]->rssi_ave < rssi_min) - rssi_min = p_dm_odm->p_odm_sta_info[i]->rssi_ave; - } - } - - p_dm_odm->rssi_min = rssi_min; - -} - -void -odm_IsLinked( - struct PHY_DM_STRUCT *p_dm_odm -) -{ - u32 i; - bool Linked = false; - - for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { - if (IS_STA_VALID(p_dm_odm->p_odm_sta_info[i])) { - Linked = true; - break; - } - - } - - p_dm_odm->is_linked = Linked; -} -#endif - -void -odm_init_all_timers( - struct PHY_DM_STRUCT *p_dm_odm -) +void odm_init_all_timers(struct dm_struct *dm) { #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) - odm_ant_div_timers(p_dm_odm, INIT_ANTDIV_TIMMER); + odm_ant_div_timers(dm, INIT_ANTDIV_TIMMER); #endif - -#if (CONFIG_DYNAMIC_RX_PATH == 1) - phydm_dynamic_rx_path_timers(p_dm_odm, INIT_DRP_TIMMER); +#if (defined(PHYDM_TDMA_DIG_SUPPORT)) +#ifdef IS_USE_NEW_TDMA + phydm_tdma_dig_timers(dm, INIT_TDMA_DIG_TIMMER); #endif - -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -#ifdef MP_TEST - if (p_dm_odm->priv->pshare->rf_ft_var.mp_specific) - odm_initialize_timer(p_dm_odm, &p_dm_odm->mpt_dig_timer, - (void *)odm_mpt_dig_callback, NULL, "mpt_dig_timer"); #endif -#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) - odm_initialize_timer(p_dm_odm, &p_dm_odm->mpt_dig_timer, - (void *)odm_mpt_dig_callback, NULL, "mpt_dig_timer"); +#ifdef CONFIG_ADAPTIVE_SOML + phydm_adaptive_soml_timers(dm, INIT_SOML_TIMMER); +#endif +#ifdef PHYDM_LNA_SAT_CHK_SUPPORT +#ifdef PHYDM_LNA_SAT_CHK_TYPE1 + phydm_lna_sat_chk_timers(dm, INIT_LNA_SAT_CHK_TIMMER); +#endif #endif #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - odm_initialize_timer(p_dm_odm, &p_dm_odm->path_div_switch_timer, - (void *)odm_path_div_chk_ant_switch_callback, NULL, "PathDivTimer"); - odm_initialize_timer(p_dm_odm, &p_dm_odm->cck_path_diversity_timer, - (void *)odm_cck_tx_path_diversity_callback, NULL, "cck_path_diversity_timer"); - odm_initialize_timer(p_dm_odm, &p_dm_odm->sbdcnt_timer, + odm_initialize_timer(dm, &dm->sbdcnt_timer, (void *)phydm_sbd_callback, NULL, "SbdTimer"); -#if (BEAMFORMING_SUPPORT == 1) - odm_initialize_timer(p_dm_odm, &p_dm_odm->beamforming_info.txbf_info.txbf_fw_ndpa_timer, - (void *)hal_com_txbf_fw_ndpa_timer_callback, NULL, "txbf_fw_ndpa_timer"); +#ifdef PHYDM_BEAMFORMING_SUPPORT + odm_initialize_timer(dm, &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_odm, &p_dm_odm->beamforming_info.beamforming_timer, - (void *)beamforming_sw_timer_callback, NULL, "beamforming_timer"); +#ifdef PHYDM_BEAMFORMING_SUPPORT + odm_initialize_timer(dm, &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_odm -) +void odm_cancel_all_timers(struct dm_struct *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_odm); + /* @2012/01/12 MH Temp BSOD fix. We need to find NIC allocate mem fail reason in win7*/ + if (dm->adapter == NULL) + return; #endif #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) - odm_ant_div_timers(p_dm_odm, CANCEL_ANTDIV_TIMMER); + odm_ant_div_timers(dm, CANCEL_ANTDIV_TIMMER); #endif - -#if (CONFIG_DYNAMIC_RX_PATH == 1) - phydm_dynamic_rx_path_timers(p_dm_odm, CANCEL_DRP_TIMMER); +#ifdef PHYDM_TDMA_DIG_SUPPORT +#ifdef IS_USE_NEW_TDMA + phydm_tdma_dig_timers(dm, CANCEL_TDMA_DIG_TIMMER); #endif - -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -#ifdef MP_TEST - if (p_dm_odm->priv->pshare->rf_ft_var.mp_specific) - odm_cancel_timer(p_dm_odm, &p_dm_odm->mpt_dig_timer); #endif -#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) - odm_cancel_timer(p_dm_odm, &p_dm_odm->mpt_dig_timer); +#ifdef CONFIG_ADAPTIVE_SOML + phydm_adaptive_soml_timers(dm, CANCEL_SOML_TIMMER); +#endif +#ifdef PHYDM_LNA_SAT_CHK_SUPPORT +#ifdef PHYDM_LNA_SAT_CHK_TYPE1 + phydm_lna_sat_chk_timers(dm, CANCEL_LNA_SAT_CHK_TIMMER); +#endif #endif #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - odm_cancel_timer(p_dm_odm, &p_dm_odm->path_div_switch_timer); - odm_cancel_timer(p_dm_odm, &p_dm_odm->cck_path_diversity_timer); - odm_cancel_timer(p_dm_odm, &p_dm_odm->mpt_dig_timer); - odm_cancel_timer(p_dm_odm, &p_dm_odm->sbdcnt_timer); -#if (BEAMFORMING_SUPPORT == 1) - odm_cancel_timer(p_dm_odm, &p_dm_odm->beamforming_info.txbf_info.txbf_fw_ndpa_timer); + odm_cancel_timer(dm, &dm->sbdcnt_timer); +#ifdef PHYDM_BEAMFORMING_SUPPORT + odm_cancel_timer(dm, &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_odm, &p_dm_odm->beamforming_info.beamforming_timer); +#ifdef PHYDM_BEAMFORMING_SUPPORT + odm_cancel_timer(dm, &dm->beamforming_info.beamforming_timer); #endif #endif - } - -void -odm_release_all_timers( - struct PHY_DM_STRUCT *p_dm_odm -) +void odm_release_all_timers(struct dm_struct *dm) { #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) - odm_ant_div_timers(p_dm_odm, RELEASE_ANTDIV_TIMMER); + odm_ant_div_timers(dm, RELEASE_ANTDIV_TIMMER); #endif - -#if (CONFIG_DYNAMIC_RX_PATH == 1) - phydm_dynamic_rx_path_timers(p_dm_odm, RELEASE_DRP_TIMMER); +#ifdef PHYDM_TDMA_DIG_SUPPORT +#ifdef IS_USE_NEW_TDMA + phydm_tdma_dig_timers(dm, RELEASE_TDMA_DIG_TIMMER); #endif - -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -#ifdef MP_TEST - if (p_dm_odm->priv->pshare->rf_ft_var.mp_specific) - odm_release_timer(p_dm_odm, &p_dm_odm->mpt_dig_timer); #endif -#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) - odm_release_timer(p_dm_odm, &p_dm_odm->mpt_dig_timer); +#ifdef CONFIG_ADAPTIVE_SOML + phydm_adaptive_soml_timers(dm, RELEASE_SOML_TIMMER); +#endif +#ifdef PHYDM_LNA_SAT_CHK_SUPPORT +#ifdef PHYDM_LNA_SAT_CHK_TYPE1 + phydm_lna_sat_chk_timers(dm, RELEASE_LNA_SAT_CHK_TIMMER); +#endif #endif #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - odm_release_timer(p_dm_odm, &p_dm_odm->path_div_switch_timer); - odm_release_timer(p_dm_odm, &p_dm_odm->cck_path_diversity_timer); - odm_release_timer(p_dm_odm, &p_dm_odm->mpt_dig_timer); - odm_release_timer(p_dm_odm, &p_dm_odm->sbdcnt_timer); -#if (BEAMFORMING_SUPPORT == 1) - odm_release_timer(p_dm_odm, &p_dm_odm->beamforming_info.txbf_info.txbf_fw_ndpa_timer); + odm_release_timer(dm, &dm->sbdcnt_timer); +#ifdef PHYDM_BEAMFORMING_SUPPORT + odm_release_timer(dm, &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_odm, &p_dm_odm->beamforming_info.beamforming_timer); +#ifdef PHYDM_BEAMFORMING_SUPPORT + odm_release_timer(dm, &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_odm -) +void odm_init_all_threads( + struct dm_struct *dm) { #ifdef TPT_THREAD - k_tpt_task_init(p_dm_odm->priv); + k_tpt_task_init(dm->priv); #endif } -void -odm_stop_all_threads( - struct PHY_DM_STRUCT *p_dm_odm -) +void odm_stop_all_threads( + struct dm_struct *dm) { #ifdef TPT_THREAD - k_tpt_task_stop(p_dm_odm->priv); + k_tpt_task_stop(dm->priv); #endif } #endif - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -/* - * 2011/07/26 MH Add an API for testing IQK fail case. - * */ -bool -odm_check_power_status( - struct _ADAPTER *adapter) -{ - - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; - RT_RF_POWER_STATE rt_state; - PMGNT_INFO p_mgnt_info = &(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) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("odm_check_power_status 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, (u8 *)(&rt_state)); - if (adapter->bDriverStopped || adapter->bDriverIsGoingToPnpSetPowerSleep || rt_state == eRfOff) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("odm_check_power_status Return false, due to %d/%d/%d\n", - adapter->bDriverStopped, adapter->bDriverIsGoingToPnpSetPowerSleep, rt_state)); - return false; - } - return true; -} -#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) -bool -odm_check_power_status( - struct _ADAPTER *adapter) -{ -#if 0 - /* HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); */ - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; - RT_RF_POWER_STATE rt_state; - PMGNT_INFO p_mgnt_info = &(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) { - ODM_RT_TRACE(p_dm_odm, COMP_INIT, DBG_LOUD, ("odm_check_power_status Return true, due to initadapter")); - return true; - } - - /* */ - /* 2011/07/19 MH We can not execute tx pwoer tracking/ LLC calibrate or IQK. */ - /* */ - phydm_get_hw_reg_interface(p_dm_odm, HW_VAR_RF_STATE, (u8 *)(&rt_state)); - if (adapter->is_driver_stopped || adapter->is_driver_is_going_to_pnp_set_power_sleep || rt_state == eRfOff) { - ODM_RT_TRACE(p_dm_odm, COMP_INIT, DBG_LOUD, ("odm_check_power_status Return false, due to %d/%d/%d\n", - adapter->is_driver_stopped, adapter->is_driver_is_going_to_pnp_set_power_sleep, rt_state)); - return false; - } -#endif - 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)) -u32 -get_psd_data( - struct PHY_DM_STRUCT *p_dm_odm, - unsigned int point, - u8 initial_gain_psd) -{ - /* unsigned int val, rfval; */ - /* int psd_report; */ - u32 psd_report; - - /* HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); */ - /* Debug Message */ - /* val = phy_query_bb_reg(adapter,0x908, MASKDWORD); */ - /* dbg_print("reg908 = 0x%x\n",val); */ - /* val = phy_query_bb_reg(adapter,0xDF4, MASKDWORD); */ - /* rfval = phy_query_rf_reg(adapter, ODM_RF_PATH_A, 0x00, RFREGOFFSETMASK); */ - /* dbg_print("RegDF4 = 0x%x, RFReg00 = 0x%x\n",val, rfval); */ - /* dbg_print("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_set_bb_reg(p_dm_odm, 0x808, 0x3FF, point); - - /* Start PSD calculation, Reg808[22]=0->1 */ - odm_set_bb_reg(p_dm_odm, 0x808, BIT(22), 1); - /* Need to wait for HW PSD report */ - odm_stall_execution(1000); - odm_set_bb_reg(p_dm_odm, 0x808, BIT(22), 0); - /* Read PSD report, Reg8B4[15:0] */ - psd_report = odm_get_bb_reg(p_dm_odm, 0x8B4, MASKDWORD) & 0x0000FFFF; - -#if 1/* (DEV_BUS_TYPE == RT_PCI_INTERFACE) && ((RT_PLATFORM == PLATFORM_LINUX) || (RT_PLATFORM == PLATFORM_MACOSX)) */ - psd_report = (u32)(odm_convert_to_db(psd_report)) + (u32)(initial_gain_psd - 0x1c); -#else - psd_report = (int)(20 * log10((double)psd_report)) + (int)(initial_gain_psd - 0x1c); -#endif - - return psd_report; - -} -#endif - -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; -} - -/* - * ODM multi-port consideration, added by Roger, 2013.10.01. - * */ -void -odm_asoc_entry_init( - struct PHY_DM_STRUCT *p_dm_odm -) -{ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _ADAPTER *p_loop_adapter = GetDefaultAdapter(p_dm_odm->adapter); - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_loop_adapter); - struct PHY_DM_STRUCT *p_dm_out_src = &p_hal_data->DM_OutSrc; - u8 total_assoc_entry_num = 0; - u8 index = 0; - u8 adaptercount = 0; - - odm_cmn_info_ptr_array_hook(p_dm_out_src, ODM_CMNINFO_STA_STATUS, 0, &p_loop_adapter->MgntInfo.DefaultPort[0]); - p_loop_adapter->MgntInfo.DefaultPort[0].MultiPortStationIdx = total_assoc_entry_num; - - adaptercount += 1; - RT_TRACE(COMP_INIT, DBG_LOUD, ("adaptercount=%d\n", adaptercount)); - p_loop_adapter = GetNextExtAdapter(p_loop_adapter); - total_assoc_entry_num += 1; - - while (p_loop_adapter) { - for (index = 0; index < ASSOCIATE_ENTRY_NUM; index++) { - odm_cmn_info_ptr_array_hook(p_dm_out_src, ODM_CMNINFO_STA_STATUS, total_assoc_entry_num + index, &p_loop_adapter->MgntInfo.AsocEntry[index]); - p_loop_adapter->MgntInfo.AsocEntry[index].MultiPortStationIdx = total_assoc_entry_num + index; - } - - total_assoc_entry_num += index; - if (IS_HARDWARE_TYPE_8188E((p_dm_odm->adapter))) - p_loop_adapter->RASupport = true; - adaptercount += 1; - RT_TRACE(COMP_INIT, DBG_LOUD, ("adaptercount=%d\n", adaptercount)); - p_loop_adapter = GetNextExtAdapter(p_loop_adapter); - } - - RT_TRACE(COMP_INIT, DBG_LOUD, ("total_assoc_entry_num = %d\n", total_assoc_entry_num)); - if (total_assoc_entry_num < (ODM_ASSOCIATE_ENTRY_NUM - 1)) { - - RT_TRACE(COMP_INIT, DBG_LOUD, ("In hook null\n")); - for (index = total_assoc_entry_num; index < ODM_ASSOCIATE_ENTRY_NUM; index++) - odm_cmn_info_ptr_array_hook(p_dm_out_src, 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(struct PHY_DM_STRUCT *p_dm_odm) +/* @Justin: According to the current RRSI to adjust Response Frame TX power, + * 2012/11/05 + */ +void odm_dtc(struct dm_struct *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 higher than this value, start to decade TX power */ +#define DTC_BASE 35 + +/* RSSI lower than this value, start to increase TX power */ +#define DTC_DWN_BASE (DTC_BASE - 5) /* RSSI vs TX power step mapping: decade TX power */ static const u8 dtc_table_down[] = { @@ -2531,8 +2962,7 @@ void odm_dtc(struct PHY_DM_STRUCT *p_dm_odm) (DTC_BASE + 10), (DTC_BASE + 15), (DTC_BASE + 20), - (DTC_BASE + 25) - }; + (DTC_BASE + 25)}; /* RSSI vs TX power step mapping: increase TX power */ static const u8 dtc_table_up[] = { @@ -2546,8 +2976,7 @@ void odm_dtc(struct PHY_DM_STRUCT *p_dm_odm) (DTC_DWN_BASE - 25), (DTC_DWN_BASE - 25), (DTC_DWN_BASE - 30), - (DTC_DWN_BASE - 35) - }; + (DTC_DWN_BASE - 35)}; u8 i; u8 dtc_steps = 0; @@ -2555,28 +2984,28 @@ void odm_dtc(struct PHY_DM_STRUCT *p_dm_odm) u8 resp_txagc = 0; #if 0 - /* As DIG is disabled, DTC is also disable */ - if (!(p_dm_odm->support_ability & ODM_XXXXXX)) + /* @As DIG is disabled, DTC is also disable */ + if (!(dm->support_ability & ODM_XXXXXX)) return; #endif - if (DTC_BASE < p_dm_odm->rssi_min) { + if (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_odm->rssi_min) || (dtc_steps >= 6)) + if (dtc_table_down[i] >= dm->rssi_min || dtc_steps >= 6) break; else dtc_steps++; } } #if 0 - else if (DTC_DWN_BASE > p_dm_odm->rssi_min) { + else if (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_odm->rssi_min) || (dtc_steps >= 10)) + if (dtc_table_up[i] <= dm->rssi_min || dtc_steps >= 10) break; else dtc_steps++; @@ -2590,836 +3019,303 @@ void odm_dtc(struct PHY_DM_STRUCT *p_dm_odm) resp_txagc = dtc_steps | (sign << 4); resp_txagc = resp_txagc | (resp_txagc << 5); - odm_write_1byte(p_dm_odm, 0x06d9, resp_txagc); + odm_write_1byte(dm, 0x06d9, resp_txagc); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_PWR_TRAIN, ODM_DBG_LOUD, ("%s rssi_min:%u, set RESP_TXAGC to %s %u\n", - __func__, p_dm_odm->rssi_min, sign ? "minus" : "plus", dtc_steps)); -#endif /* CONFIG_RESP_TXAGC_ADJUST */ + PHYDM_DBG(dm, ODM_COMP_PWR_TRAIN, + "%s rssi_min:%u, set RESP_TXAGC to %s %u\n", __func__, + dm->rssi_min, sign ? "minus" : "plus", dtc_steps); +#endif /* @CONFIG_RESP_TXAGC_ADJUST */ } -#endif /* #if (DM_ODM_SUPPORT_TYPE == ODM_CE) */ +#endif /* @#if (DM_ODM_SUPPORT_TYPE == ODM_CE) */ -void -odm_update_power_training_state( - struct PHY_DM_STRUCT *p_dm_odm -) +/*@<20170126, BB-Kevin>8188F D-CUT DC cancellation and 8821C*/ +void phydm_dc_cancellation(struct dm_struct *dm) { -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - struct _FALSE_ALARM_STATISTICS *false_alm_cnt = (struct _FALSE_ALARM_STATISTICS *)phydm_get_structure(p_dm_odm, PHYDM_FALSEALMCNT); - struct _dynamic_initial_gain_threshold_ *p_dm_dig_table = &p_dm_odm->dm_dig_table; - u32 score = 0; +#ifdef PHYDM_DC_CANCELLATION + u32 offset_i_hex[PHYDM_MAX_RF_PATH] = {0}; + u32 offset_q_hex[PHYDM_MAX_RF_PATH] = {0}; + u32 reg_value32[PHYDM_MAX_RF_PATH] = {0}; + u8 path = RF_PATH_A; + u8 set_result; - if (!(p_dm_odm->support_ability & ODM_BB_PWR_TRAIN)) + if (!(dm->support_ic_type & ODM_DC_CANCELLATION_SUPPORT)) + return; + if ((dm->support_ic_type & ODM_RTL8188F) && + dm->cut_version < ODM_CUT_D) + return; + if ((dm->support_ic_type & ODM_RTL8192F) && + dm->cut_version == ODM_CUT_A) return; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("odm_update_power_training_state()============>\n")); - p_dm_odm->is_change_state = false; + PHYDM_DBG(dm, ODM_COMP_API, "%s ======>\n", __func__); - /* Debug command */ - if (p_dm_odm->force_power_training_state) { - if (p_dm_odm->force_power_training_state == 1 && !p_dm_odm->is_disable_power_training) { - p_dm_odm->is_change_state = true; - p_dm_odm->is_disable_power_training = true; - } else if (p_dm_odm->force_power_training_state == 2 && p_dm_odm->is_disable_power_training) { - p_dm_odm->is_change_state = true; - p_dm_odm->is_disable_power_training = false; - } + /*@DC_Estimation (only for 2x2 ic now) */ - p_dm_odm->PT_score = 0; - p_dm_odm->phy_dbg_info.num_qry_phy_status_ofdm = 0; - p_dm_odm->phy_dbg_info.num_qry_phy_status_cck = 0; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("odm_update_power_training_state(): force_power_training_state = %d\n", - p_dm_odm->force_power_training_state)); - return; - } - - if (!p_dm_odm->is_linked) - return; - - /* First connect */ - if ((p_dm_odm->is_linked) && (p_dm_dig_table->is_media_connect_0 == false)) { - p_dm_odm->PT_score = 0; - p_dm_odm->is_change_state = true; - p_dm_odm->phy_dbg_info.num_qry_phy_status_ofdm = 0; - p_dm_odm->phy_dbg_info.num_qry_phy_status_cck = 0; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("odm_update_power_training_state(): First Connect\n")); - return; - } - - /* Compute score */ - if (p_dm_odm->nhm_cnt_0 >= 215) - score = 2; - else if (p_dm_odm->nhm_cnt_0 >= 190) - score = 1; /* unknow state */ - else { - u32 rx_pkt_cnt; - - rx_pkt_cnt = (u32)(p_dm_odm->phy_dbg_info.num_qry_phy_status_ofdm) + (u32)(p_dm_odm->phy_dbg_info.num_qry_phy_status_cck); - - if ((false_alm_cnt->cnt_cca_all > 31 && rx_pkt_cnt > 31) && (false_alm_cnt->cnt_cca_all >= rx_pkt_cnt)) { - if ((rx_pkt_cnt + (rx_pkt_cnt >> 1)) <= false_alm_cnt->cnt_cca_all) - score = 0; - else if ((rx_pkt_cnt + (rx_pkt_cnt >> 2)) <= false_alm_cnt->cnt_cca_all) - score = 1; - else - score = 2; - } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("odm_update_power_training_state(): rx_pkt_cnt = %d, cnt_cca_all = %d\n", - rx_pkt_cnt, false_alm_cnt->cnt_cca_all)); - } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("odm_update_power_training_state(): num_qry_phy_status_ofdm = %d, num_qry_phy_status_cck = %d\n", - (u32)(p_dm_odm->phy_dbg_info.num_qry_phy_status_ofdm), (u32)(p_dm_odm->phy_dbg_info.num_qry_phy_status_cck))); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("odm_update_power_training_state(): nhm_cnt_0 = %d, score = %d\n", - p_dm_odm->nhm_cnt_0, score)); - - /* smoothing */ - p_dm_odm->PT_score = (score << 4) + (p_dm_odm->PT_score >> 1) + (p_dm_odm->PT_score >> 2); - score = (p_dm_odm->PT_score + 32) >> 6; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("odm_update_power_training_state(): PT_score = %d, score after smoothing = %d\n", - p_dm_odm->PT_score, score)); - - /* mode decision */ - if (score == 2) { - if (p_dm_odm->is_disable_power_training) { - p_dm_odm->is_change_state = true; - p_dm_odm->is_disable_power_training = false; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("odm_update_power_training_state(): Change state\n")); - } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("odm_update_power_training_state(): Enable Power Training\n")); - } else if (score == 0) { - if (!p_dm_odm->is_disable_power_training) { - p_dm_odm->is_change_state = true; - p_dm_odm->is_disable_power_training = true; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("odm_update_power_training_state(): Change state\n")); - } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("odm_update_power_training_state(): Disable Power Training\n")); - } - - p_dm_odm->phy_dbg_info.num_qry_phy_status_ofdm = 0; - p_dm_odm->phy_dbg_info.num_qry_phy_status_cck = 0; -#endif -} - - - -/*===========================================================*/ -/* The following is for compile only*/ -/*===========================================================*/ -/*#define TARGET_CHNL_NUM_2G_5G 59*/ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - -u8 get_right_chnl_place_for_iqk(u8 chnl) -{ - u8 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 - }; - 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 -phydm_noisy_detection( - struct PHY_DM_STRUCT *p_dm_odm -) -{ - u32 total_fa_cnt, total_cca_cnt; - u32 score = 0, i, score_smooth; - - total_cca_cnt = p_dm_odm->false_alm_cnt.cnt_cca_all; - total_fa_cnt = p_dm_odm->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; + for (path = RF_PATH_A; path < PHYDM_MAX_RF_PATH; path++) { + if (path > RF_PATH_A && + dm->support_ic_type & (ODM_RTL8821C | ODM_RTL8188F | + ODM_RTL8710B | ODM_RTL8721D)) break; + else if (path > RF_PATH_B && + dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8192F)) + break; + if (phydm_stop_ic_trx(dm, PHYDM_SET) == PHYDM_SET_FAIL) { + PHYDM_DBG(dm, ODM_COMP_API, "STOP_TRX_FAIL\n"); + return; } + odm_write_dig(dm, 0x7e); + /*@Disable LNA*/ + if (dm->support_ic_type & ODM_RTL8821C) + halrf_rf_lna_setting(dm, HALRF_LNA_DISABLE); + /*Turn off 3-wire*/ + phydm_stop_3_wire(dm, PHYDM_SET); + if (dm->support_ic_type & (ODM_RTL8188F | ODM_RTL8710B)) { + /*set debug port to 0x235*/ + if (!phydm_set_bb_dbg_port(dm, DBGPORT_PRI_1, 0x235)) { + PHYDM_DBG(dm, ODM_COMP_API, + "Set Debug port Fail\n"); + return; + } + } else if (dm->support_ic_type & ODM_RTL8721D) { + /*set debug port to 0x200*/ + if (!phydm_set_bb_dbg_port(dm, DBGPORT_PRI_2, 0x200)) { + PHYDM_DBG(dm, ODM_COMP_API, + "Set Debug port Fail\n"); + return; + } + } else if (dm->support_ic_type & ODM_RTL8821C) { + if (!phydm_set_bb_dbg_port(dm, DBGPORT_PRI_1, 0x200)) { + /*set debug port to 0x200*/ + PHYDM_DBG(dm, ODM_COMP_API, + "Set Debug port Fail\n"); + return; + } + phydm_bb_dbg_port_header_sel(dm, 0x0); + } else if (dm->support_ic_type & ODM_RTL8822B) { + if (path == RF_PATH_A && + !phydm_set_bb_dbg_port(dm, DBGPORT_PRI_1, 0x200)) { + /*set debug port to 0x200*/ + PHYDM_DBG(dm, ODM_COMP_API, + "Set Debug port Fail\n"); + return; + } + if (path == RF_PATH_B && + !phydm_set_bb_dbg_port(dm, DBGPORT_PRI_1, 0x202)) { + /*set debug port to 0x200*/ + PHYDM_DBG(dm, ODM_COMP_API, + "Set Debug port Fail\n"); + return; + } + phydm_bb_dbg_port_header_sel(dm, 0x0); + } else if (dm->support_ic_type & ODM_RTL8192F) { + if (path == RF_PATH_A && + !phydm_set_bb_dbg_port(dm, DBGPORT_PRI_1, 0x235)) { + /*set debug port to 0x235*/ + PHYDM_DBG(dm, ODM_COMP_API, + "Set Debug port Fail\n"); + return; + } + if (path == RF_PATH_B && + !phydm_set_bb_dbg_port(dm, DBGPORT_PRI_1, 0x23d)) { + /*set debug port to 0x23d*/ + PHYDM_DBG(dm, ODM_COMP_API, + "Set Debug port Fail\n"); + return; + } + } + + /*@disable CCK DCNF*/ + odm_set_bb_reg(dm, R_0xa78, MASKBYTE1, 0x0); + + PHYDM_DBG(dm, ODM_COMP_API, "DC cancellation Begin!!!\n"); + + phydm_stop_ck320(dm, true); /*stop ck320*/ + + /* the same debug port both for path-a and path-b*/ + reg_value32[path] = phydm_get_bb_dbg_port_val(dm); + + phydm_stop_ck320(dm, false); /*start ck320*/ + + phydm_release_bb_dbg_port(dm); + /* @Turn on 3-wire*/ + phydm_stop_3_wire(dm, PHYDM_REVERT); + /* @Enable LNA*/ + if (dm->support_ic_type & ODM_RTL8821C) + halrf_rf_lna_setting(dm, HALRF_LNA_ENABLE); + + odm_write_dig(dm, 0x20); + + set_result = phydm_stop_ic_trx(dm, PHYDM_REVERT); + + PHYDM_DBG(dm, ODM_COMP_API, "DC cancellation OK!!!\n"); } - /* noisy_decision_smooth = noisy_decision_smooth>>1 + (score<<3)>>1; */ - p_dm_odm->noisy_decision_smooth = (p_dm_odm->noisy_decision_smooth >> 1) + (score << 2); + /*@DC_Cancellation*/ + /*@DC compensation to CCK data path*/ + odm_set_bb_reg(dm, R_0xa9c, BIT(20), 0x1); + if (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; - /* Round the noisy_decision_smooth: +"3" comes from (2^3)/2-1 */ - score_smooth = (total_cca_cnt >= 300) ? ((p_dm_odm->noisy_decision_smooth + 3) >> 3) : 0; + /*@Before filling into registers, + *offset should be multiplexed (-1) + */ + offset_i_hex[0] = (offset_i_hex[0] >= 0x200) ? + (0x400 - offset_i_hex[0]) : + (0x1ff - offset_i_hex[0]); + offset_q_hex[0] = (offset_q_hex[0] >= 0x200) ? + (0x400 - offset_q_hex[0]) : + (0x1ff - offset_q_hex[0]); - p_dm_odm->noisy_decision = (score_smooth >= 3) ? 1 : 0; -#if 0 - switch (score_smooth) { - case 0: - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] total_fa_cnt/total_cca_cnt=0%%\n")); - break; - case 1: - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] total_fa_cnt/total_cca_cnt=6.25%%\n")); - break; - case 2: - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] total_fa_cnt/total_cca_cnt=12.5%%\n")); - break; - case 3: - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] total_fa_cnt/total_cca_cnt=18.75%%\n")); - break; - case 4: - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] total_fa_cnt/total_cca_cnt=25%%\n")); - break; - case 5: - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] total_fa_cnt/total_cca_cnt=31.25%%\n")); - break; - case 6: - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] total_fa_cnt/total_cca_cnt=37.5%%\n")); - break; - case 7: - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] total_fa_cnt/total_cca_cnt=43.75%%\n")); - break; - case 8: - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] total_fa_cnt/total_cca_cnt=50%%\n")); - break; - case 9: - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] total_fa_cnt/total_cca_cnt=56.25%%\n")); - break; - case 10: - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] total_fa_cnt/total_cca_cnt=62.5%%\n")); - break; - case 11: - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] total_fa_cnt/total_cca_cnt=68.75%%\n")); - break; - case 12: - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] total_fa_cnt/total_cca_cnt=75%%\n")); - break; - case 13: - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] total_fa_cnt/total_cca_cnt=81.25%%\n")); - break; - case 14: - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] total_fa_cnt/total_cca_cnt=87.5%%\n")); - break; - case 15: - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] total_fa_cnt/total_cca_cnt=93.75%%\n")); - break; - case 16: - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] total_fa_cnt/total_cca_cnt=100%%\n")); - break; - default: - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] Unknown value!! Need Check!!\n")); + odm_set_bb_reg(dm, R_0x950, 0x1ff, offset_i_hex[0]); + odm_set_bb_reg(dm, R_0x950, 0x1ff0000, offset_q_hex[0]); + } else if (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(dm, R_0xc10, 0x3c000000, + (0x3c0 & offset_i_hex[0]) >> 6); + odm_set_bb_reg(dm, R_0xc10, 0xfc00, 0x3f & offset_i_hex[0]); + odm_set_bb_reg(dm, R_0xc14, 0x3c000000, + (0x3c0 & offset_q_hex[0]) >> 6); + odm_set_bb_reg(dm, R_0xc14, 0xfc00, 0x3f & offset_q_hex[0]); + + /* Path-b */ + if (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(dm, R_0xe10, 0x3c000000, + (0x3c0 & offset_i_hex[1]) >> 6); + odm_set_bb_reg(dm, R_0xe10, 0xfc00, + 0x3f & offset_i_hex[1]); + odm_set_bb_reg(dm, R_0xe14, 0x3c000000, + (0x3c0 & offset_q_hex[1]) >> 6); + odm_set_bb_reg(dm, R_0xe14, 0xfc00, + 0x3f & offset_q_hex[1]); + } + } else if (dm->support_ic_type & (ODM_RTL8192F)) { + /* Path-a I:df4[27:18],Q:df4[17:8]*/ + 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[0]) : + (0xff - offset_i_hex[0]); + offset_q_hex[0] = (offset_q_hex[0] >= 0x200) ? + (0x400 - offset_q_hex[0]) : + (0xff - offset_q_hex[0]); + /*Path-a I:c10[7:0],Q:c10[15:8]*/ + odm_set_bb_reg(dm, R_0xc10, 0xff, offset_i_hex[0]); + odm_set_bb_reg(dm, R_0xc10, 0xff00, offset_q_hex[0]); + + /* Path-b */ + if (dm->rf_type > RF_1T1R) { + /* @I:df4[27:18],Q:df4[17:8]*/ + offset_i_hex[1] = (reg_value32[1] & 0xffc0000) >> 18; + offset_q_hex[1] = (reg_value32[1] & 0x3ff00) >> 8; + + /*@Before filling into registers, + *offset should be multiplexed (-1) + */ + offset_i_hex[1] = (offset_i_hex[1] >= 0x200) ? + (0x400 - offset_i_hex[1]) : + (0xff - offset_i_hex[1]); + offset_q_hex[1] = (offset_q_hex[1] >= 0x200) ? + (0x400 - offset_q_hex[1]) : + (0xff - offset_q_hex[1]); + /*Path-b I:c18[7:0],Q:c18[15:8]*/ + odm_set_bb_reg(dm, R_0xc18, 0xff, offset_i_hex[1]); + odm_set_bb_reg(dm, R_0xc18, 0xff00, offset_q_hex[1]); + } + } else if (dm->support_ic_type & (ODM_RTL8721D)) { + /*judy modified 20180517*/ + offset_i_hex[0] = (reg_value32[0] & 0xff80000) >> 19; + offset_q_hex[0] = (reg_value32[0] & 0x3fe00) >> 9; + + /*@Before filling into registers, + *offset should be multiplexed (-1) + */ + offset_i_hex[0] = 0x200 - offset_i_hex[0]; + offset_q_hex[0] = 0x200 - offset_q_hex[0]; + + odm_set_bb_reg(dm, R_0x950, 0x1ff, offset_i_hex[0]); + odm_set_bb_reg(dm, R_0x950, 0x1ff0000, offset_q_hex[0]); } #endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_NOISY_DETECT, ODM_DBG_LOUD, - ("[NoisyDetection] total_cca_cnt=%d, total_fa_cnt=%d, noisy_decision_smooth=%d, score=%d, score_smooth=%d, p_dm_odm->noisy_decision=%d\n", - total_cca_cnt, total_fa_cnt, p_dm_odm->noisy_decision_smooth, score, score_smooth, p_dm_odm->noisy_decision)); - } -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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u32 used = *_used; - u32 out_len = *_out_len; - u32 ext_ant_switch = dm_value[0]; - - if (p_dm_odm->support_ic_type & (ODM_RTL8821 | ODM_RTL8881A)) { - - /*Output Pin Settings*/ - odm_set_mac_reg(p_dm_odm, 0x4C, BIT(23), 0); /*select DPDT_P and DPDT_N as output pin*/ - odm_set_mac_reg(p_dm_odm, 0x4C, BIT(24), 1); /*by WLAN control*/ - - odm_set_bb_reg(p_dm_odm, 0xCB4, 0xF, 7); /*DPDT_P = 1b'0*/ - odm_set_bb_reg(p_dm_odm, 0xCB4, 0xF0, 7); /*DPDT_N = 1b'0*/ - - if (ext_ant_switch == MAIN_ANT) { - odm_set_bb_reg(p_dm_odm, 0xCB4, (BIT(29) | BIT(28)), 1); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_API, ODM_DBG_LOUD, ("***8821A set ant switch = 2b'01 (Main)\n")); - } else if (ext_ant_switch == AUX_ANT) { - odm_set_bb_reg(p_dm_odm, 0xCB4, BIT(29) | BIT(28), 2); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_API, ODM_DBG_LOUD, ("***8821A set ant switch = 2b'10 (Aux)\n")); - } - } -} - -void -phydm_csi_mask_enable( - void *p_dm_void, - u32 enable -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u32 reg_value = 0; - - reg_value = (enable == CSI_MASK_ENABLE) ? 1 : 0; - - if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) { - - odm_set_bb_reg(p_dm_odm, 0xD2C, BIT(28), reg_value); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_API, ODM_DBG_LOUD, ("Enable CSI Mask: Reg 0xD2C[28] = ((0x%x))\n", reg_value)); - - } else if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) { - - odm_set_bb_reg(p_dm_odm, 0x874, BIT(0), reg_value); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_API, ODM_DBG_LOUD, ("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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - - if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) { - - odm_set_bb_reg(p_dm_odm, 0xD40, MASKDWORD, 0); - odm_set_bb_reg(p_dm_odm, 0xD44, MASKDWORD, 0); - odm_set_bb_reg(p_dm_odm, 0xD48, MASKDWORD, 0); - odm_set_bb_reg(p_dm_odm, 0xD4c, MASKDWORD, 0); - - } else if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) { - - odm_set_bb_reg(p_dm_odm, 0x880, MASKDWORD, 0); - odm_set_bb_reg(p_dm_odm, 0x884, MASKDWORD, 0); - odm_set_bb_reg(p_dm_odm, 0x888, MASKDWORD, 0); - odm_set_bb_reg(p_dm_odm, 0x88c, MASKDWORD, 0); - odm_set_bb_reg(p_dm_odm, 0x890, MASKDWORD, 0); - odm_set_bb_reg(p_dm_odm, 0x894, MASKDWORD, 0); - odm_set_bb_reg(p_dm_odm, 0x898, MASKDWORD, 0); - odm_set_bb_reg(p_dm_odm, 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_odm = (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_odm->support_ic_type & ODM_IC_11N_SERIES) { - - tone_num = 64; - csi_mask_reg_p = 0xD40; - csi_mask_reg_n = 0xD48; - - } else if (p_dm_odm->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_odm, target_reg); - ODM_RT_TRACE(p_dm_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_write_1byte(p_dm_odm, target_reg, reg_tmp_value); - ODM_RT_TRACE(p_dm_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( - void *p_dm_void, - u32 tone_idx_tmp, - u32 bw -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (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_odm->support_ic_type & ODM_IC_11N_SERIES) - - nbi_table_idx = FFT_128_TYPE; - else if (p_dm_odm->support_ic_type & ODM_IC_11AC_1_SERIES) - - nbi_table_idx = FFT_256_TYPE; - else if (p_dm_odm->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_odm->support_ic_type & ODM_IC_11N_SERIES) { - odm_set_bb_reg(p_dm_odm, 0xc40, 0x1f000000, reg_idx); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_API, ODM_DBG_LOUD, ("Set tone idx: Reg0xC40[28:24] = ((0x%x))\n", reg_idx)); - /**/ - } else { - odm_set_bb_reg(p_dm_odm, 0x87c, 0xfc000, reg_idx); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_API, ODM_DBG_LOUD, ("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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u32 reg_value = 0; - - reg_value = (enable == NBI_ENABLE) ? 1 : 0; - - if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) { - - odm_set_bb_reg(p_dm_odm, 0xc40, BIT(9), reg_value); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_API, ODM_DBG_LOUD, ("Enable NBI Reg0xC40[9] = ((0x%x))\n", reg_value)); - - } else if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) { - - odm_set_bb_reg(p_dm_odm, 0x87c, BIT(13), reg_value); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_API, ODM_DBG_LOUD, ("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_odm = (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 SET_ERROR; - - fc = 2412 + (channel - 1) * 5; - - if (bw == 40 && (second_ch == PHYDM_ABOVE)) { - - if (channel >= 10) { - ODM_RT_TRACE(p_dm_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(p_dm_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(p_dm_odm, ODM_COMP_API, ODM_DBG_LOUD, ("Mod_CH = ((%d))\n", channel)); - } - - fc = 5180 + (channel - 36) * 5; - - } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_API, ODM_DBG_LOUD, ("CH = ((%d)) Error setting\n", channel)); - return SET_ERROR; - } - - *fc_in = fc; - - return 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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u32 bw_up, bw_low; - u32 int_distance; - u32 tone_idx_tmp; - u8 set_result = SET_NO_NEED; - - bw_up = fc + bw / 2; - bw_low = fc - bw / 2; - - ODM_RT_TRACE(p_dm_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(p_dm_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; - -} - - -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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u32 fc; - u32 int_distance; - u8 tone_direction; - u32 tone_idx_tmp; - u8 set_result = SET_SUCCESS; - - if (enable == CSI_MASK_DISABLE) { - set_result = SET_SUCCESS; - phydm_clean_all_csi_mask(p_dm_odm); - - } else { - - ODM_RT_TRACE(p_dm_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(p_dm_odm, channel, bw, second_ch, &fc) == SET_ERROR) - set_result = SET_ERROR; - - else { - /*calculate interference distance*/ - if (phydm_calculate_intf_distance(p_dm_odm, bw, fc, f_interference, &tone_idx_tmp) == SET_SUCCESS) { - - tone_direction = (f_interference >= fc) ? FREQ_POSITIVE : FREQ_NEGATIVE; - phydm_set_csi_mask_reg(p_dm_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(p_dm_odm, enable); - else - phydm_csi_mask_enable(p_dm_odm, CSI_MASK_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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u32 fc; - u32 int_distance; - u32 tone_idx_tmp; - u8 set_result = SET_SUCCESS; - u32 bw_max = 40; - - if (enable == NBI_DISABLE) - set_result = SET_SUCCESS; - - else { - - ODM_RT_TRACE(p_dm_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(p_dm_odm, channel, bw, second_ch, &fc) == SET_ERROR) - set_result = SET_ERROR; - - else { - /*calculate interference distance*/ - if (phydm_calculate_intf_distance(p_dm_odm, bw, fc, f_interference, &tone_idx_tmp) == SET_SUCCESS) { - - phydm_set_nbi_reg(p_dm_odm, tone_idx_tmp, bw); - set_result = SET_SUCCESS; - } else - set_result = SET_NO_NEED; - } - } - - if (set_result == SET_SUCCESS) - phydm_nbi_enable(p_dm_odm, enable); - else - phydm_nbi_enable(p_dm_odm, NBI_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_odm = (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] == 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(p_dm_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(p_dm_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(p_dm_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(p_dm_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"))); - } -} - -void -phydm_receiver_blocking( - void *p_dm_void -) +void phydm_receiver_blocking(void *dm_void) { #ifdef CONFIG_RECEIVER_BLOCKING - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u32 channel = *p_dm_odm->p_channel; - u8 bw = *p_dm_odm->p_band_width; - u8 set_result = 0; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 chnl = *dm->channel; + u8 bw = *dm->band_width; + u32 bb_regf0 = odm_get_bb_reg(dm, R_0xf0, 0xf000); - if (!(p_dm_odm->support_ic_type & ODM_RECEIVER_BLOCKING_SUPPORT)) + if (!(dm->support_ic_type & ODM_RECEIVER_BLOCKING_SUPPORT) || + !(dm->support_ability & ODM_BB_ADAPTIVITY)) return; - - if (p_dm_odm->consecutive_idlel_time > 10 && p_dm_odm->mp_mode == false && p_dm_odm->adaptivity_enable == true) { - if ((bw == ODM_BW20M) && (channel == 1)) { - set_result = phydm_nbi_setting(p_dm_odm, NBI_ENABLE, channel, 20, 2410, PHYDM_DONT_CARE); - p_dm_odm->is_receiver_blocking_en = true; - } else if ((bw == ODM_BW20M) && (channel == 13)) { - set_result = phydm_nbi_setting(p_dm_odm, NBI_ENABLE, channel, 20, 2473, PHYDM_DONT_CARE); - p_dm_odm->is_receiver_blocking_en = true; - } else if (*(p_dm_odm->p_is_scan_in_process) == false) { - if (p_dm_odm->is_receiver_blocking_en && channel != 1 && channel != 13) { - phydm_nbi_enable(p_dm_odm, NBI_DISABLE); - odm_set_bb_reg(p_dm_odm, 0xc40, 0x1f000000, 0x1f); - p_dm_odm->is_receiver_blocking_en = false; - } + + if ((dm->support_ic_type & ODM_RTL8188E && bb_regf0 < 8) || + dm->support_ic_type & ODM_RTL8192E) { + /*@8188E_T version*/ + if (dm->consecutive_idlel_time <= 10 || *dm->mp_mode) + goto end; + + if (bw == CHANNEL_WIDTH_20 && chnl == 1) { + phydm_nbi_setting(dm, FUNC_ENABLE, chnl, 20, 2410, + PHYDM_DONT_CARE); + dm->is_rx_blocking_en = true; + } else if ((bw == CHANNEL_WIDTH_20) && (chnl == 13)) { + phydm_nbi_setting(dm, FUNC_ENABLE, chnl, 20, 2473, + PHYDM_DONT_CARE); + dm->is_rx_blocking_en = true; + } else if (dm->is_rx_blocking_en && chnl != 1 && chnl != 13) { + phydm_nbi_enable(dm, FUNC_DISABLE); + odm_set_bb_reg(dm, R_0xc40, 0x1f000000, 0x1f); + dm->is_rx_blocking_en = false; } - } else { - if (p_dm_odm->is_receiver_blocking_en) { - phydm_nbi_enable(p_dm_odm, NBI_DISABLE); - odm_set_bb_reg(p_dm_odm, 0xc40, 0x1f000000, 0x1f); - p_dm_odm->is_receiver_blocking_en = false; + return; + } else if ((dm->support_ic_type & ODM_RTL8188E && bb_regf0 >= 8)) { + /*@8188E_S version*/ + if (dm->consecutive_idlel_time <= 10 || *dm->mp_mode) + goto end; + + if (bw == CHANNEL_WIDTH_20 && chnl == 13) { + phydm_nbi_setting(dm, FUNC_ENABLE, chnl, 20, 2473, + PHYDM_DONT_CARE); + dm->is_rx_blocking_en = true; + } else if (dm->is_rx_blocking_en && chnl != 13) { + phydm_nbi_enable(dm, FUNC_DISABLE); + odm_set_bb_reg(dm, R_0xc40, 0x1f000000, 0x1f); + dm->is_rx_blocking_en = false; } + return; + } + +end: + if (dm->is_rx_blocking_en) { + phydm_nbi_enable(dm, FUNC_DISABLE); + odm_set_bb_reg(dm, R_0xc40, 0x1f000000, 0x1f); + dm->is_rx_blocking_en = false; } - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, - ("[NBI set result: %s]\n", (set_result == SET_SUCCESS ? "Success" : (set_result == SET_NO_NEED ? "No need" : "Error")))); #endif } diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm.h index 857a1366af49..f50e5cdc7274 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,297 +9,359 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ - -#ifndef __HALDMOUTSRC_H__ +#ifndef __HALDMOUTSRC_H__ #define __HALDMOUTSRC_H__ -/*============================================================*/ -/*include files*/ -/*============================================================*/ +/*@============================================================*/ +/*@include files*/ +/*@============================================================*/ +/*PHYDM header*/ #include "phydm_pre_define.h" +#include "phydm_features.h" #include "phydm_dig.h" -#if PHYDM_SUPPORT_EDCA -#include "phydm_edcaturbocheck.h" -#endif +#ifdef CONFIG_PATH_DIVERSITY #include "phydm_pathdiv.h" +#endif +#ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY #include "phydm_antdiv.h" +#endif + +#include "phydm_soml.h" + +#ifdef CONFIG_SMART_ANTENNA +#include "phydm_smt_ant.h" +#endif +#ifdef CONFIG_ANT_DETECTION #include "phydm_antdect.h" -#include "phydm_dynamicbbpowersaving.h" +#endif #include "phydm_rainfo.h" +#ifdef CONFIG_DYNAMIC_TX_TWR #include "phydm_dynamictxpower.h" +#endif #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" - +#if (PHYDM_LA_MODE_SUPPORT) #include "phydm_adc_sampling.h" -#include "phydm_dynamic_rx_path.h" - - -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_WIN)) +#endif +#ifdef CONFIG_PSD_TOOL +#include "phydm_psd.h" +#endif +#ifdef PHYDM_PRIMARY_CCA +#include "phydm_primary_cca.h" +#endif +#include "phydm_cck_pd.h" +#include "phydm_rssi_monitor.h" +#ifdef PHYDM_AUTO_DEGBUG +#include "phydm_auto_dbg.h" +#endif +#include "phydm_math_lib.h" +#include "phydm_noisemonitor.h" +#include "phydm_api.h" +#ifdef PHYDM_POWER_TRAINING_SUPPORT +#include "phydm_pow_train.h" +#endif +#ifdef PHYDM_LNA_SAT_CHK_SUPPORT +#include "phydm_lna_sat.h" +#endif +#ifdef PHYDM_PMAC_TX_SETTING_SUPPORT +#include "phydm_pmac_tx_setting.h" +#endif +#ifdef PHYDM_MP_SUPPORT +#include "phydm_mp.h" +#endif +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) #include "phydm_beamforming.h" #endif +#ifdef CONFIG_DIRECTIONAL_BF +#include "phydm_direct_bf.h" +#endif + +#include "phydm_regtable.h" + +/*@HALRF header*/ +#include "halrf/halrf_iqk.h" +#include "halrf/halrf_dpk.h" +#include "halrf/halrf.h" +#include "halrf/halrf_powertracking.h" #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - #include "halphyrf_ap.h" + #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" +#elif(DM_ODM_SUPPORT_TYPE & (ODM_IOT)) + #include "halrf/halphyrf_iot.h" #endif -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) - #include "phydm_noisemonitor.h" - #include "halphyrf_ce.h" -#endif +extern const u16 phy_rate_table[84]; -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) - #include "halphyrf_win.h" - #include "phydm_noisemonitor.h" -#endif - -/*============================================================*/ -/*Definition */ -/*============================================================*/ +/*@============================================================*/ +/*@Definition */ +/*@============================================================*/ /* Traffic load decision */ -#define TRAFFIC_ULTRA_LOW 1 +#define TRAFFIC_NO_TP 0 +#define TRAFFIC_ULTRA_LOW 1 #define TRAFFIC_LOW 2 #define TRAFFIC_MID 3 #define TRAFFIC_HIGH 4 -#define NONE 0 +#define NONE 0 -/*NBI API------------------------------------*/ -#define NBI_ENABLE 1 -#define NBI_DISABLE 2 +#if defined(DM_ODM_CE_MAC80211) +#define MAX_2(x, y) \ + __max2(typeof(x), typeof(y), \ + x, y) +#define __max2(t1, t2, x, y) ({ \ + t1 m80211_max1 = (x); \ + t2 m80211_max2 = (y); \ + m80211_max1 > m80211_max2 ? m80211_max1 : m80211_max2; }) -#define NBI_TABLE_SIZE_128 27 -#define NBI_TABLE_SIZE_256 59 +#define MIN_2(x, y) \ + __min2(typeof(x), typeof(y), \ + x, y) +#define __min2(t1, t2, x, y) ({ \ + t1 m80211_min1 = (x); \ + t2 m80211_min2 = (y); \ + m80211_min1 < m80211_min2 ? m80211_min1 : m80211_min2; }) -#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 +#define DIFF_2(x, y) \ + __diff2(typeof(x), typeof(y), \ + x, y) +#define __diff2(t1, t2, x, y) ({ \ + t1 __d1 = (x); \ + t2 __d2 = (y); \ + (__d1 >= __d2) ? (__d1 - __d2) : (__d2 - __d1); }) #else - #define PHYDM_WATCH_DOG_PERIOD 2 +#define MAX_2(_x_, _y_) (((_x_) > (_y_)) ? (_x_) : (_y_)) +#define MIN_2(_x_, _y_) (((_x_) < (_y_)) ? (_x_) : (_y_)) +#define DIFF_2(_x_, _y_) ((_x_ >= _y_) ? (_x_ - _y_) : (_y_ - _x_)) #endif -/*============================================================*/ +#define IS_GREATER(_x_, _y_) (((_x_) >= (_y_)) ? true : false) +#define IS_LESS(_x_, _y_) (((_x_) < (_y_)) ? true : false) + +#if defined(DM_ODM_CE_MAC80211) +#define BYTE_DUPLICATE_2_DWORD(B0) ({ \ + u32 __b_dup = (B0);\ + (((__b_dup) << 24) | ((__b_dup) << 16) | ((__b_dup) << 8) | (__b_dup));\ + }) +#else +#define BYTE_DUPLICATE_2_DWORD(B0) \ + (((B0) << 24) | ((B0) << 16) | ((B0) << 8) | (B0)) +#endif +#define BYTE_2_DWORD(B3, B2, B1, B0) \ + (((B3) << 24) | ((B2) << 16) | ((B1) << 8) | (B0)) +#define BIT_2_BYTE(B3, B2, B1, B0) \ + (((B3) << 3) | ((B2) << 2) | ((B1) << 1) | (B0)) + +/*@For cmn sta info*/ +#if defined(DM_ODM_CE_MAC80211) +#define is_sta_active(sta) ({ \ + struct cmn_sta_info *__sta = (sta); \ + ((__sta) && (__sta->dm_ctrl & STA_DM_CTRL_ACTIVE)); \ + }) + +#define IS_FUNC_EN(name) ({ \ + u8 *__is_func_name = (name); \ + (__is_func_name) && (*__is_func_name); \ + }) +#else +#define is_sta_active(sta) ((sta) && (sta->dm_ctrl & STA_DM_CTRL_ACTIVE)) + +#define IS_FUNC_EN(name) ((name) && (*name)) +#endif + +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) + #define PHYDM_WATCH_DOG_PERIOD 1 /*second*/ +#else + #define PHYDM_WATCH_DOG_PERIOD 2 /*second*/ +#endif + +#define PHY_HIST_SIZE 12 + +/*@============================================================*/ /*structure and define*/ -/*============================================================*/ +/*@============================================================*/ -/*2011/09/20 MH Add for AP/ADSLpseudo DM structuer requirement.*/ -/*We need to remove to other position???*/ +#define dm_type_by_fw 0 +#define dm_type_by_driver 1 -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_WIN)) -struct rtl8192cd_priv { - u8 temp; +#ifdef BB_RAM_SUPPORT - }; -#endif +struct phydm_bb_ram_per_sta { + /* @Reg0x1E84 for RAM I/O*/ + boolean hw_igi_en; + boolean tx_pwr_offset0_en; + boolean tx_pwr_offset1_en; + /* @ macid from 0 to 63, above 63 => mapping to 63*/ + u8 macid_addr; + /* @hw_igi value for paths after packet Tx in a period of time*/ + u8 hw_igi; + /* @tx_pwr_offset0 offset for Tx power index*/ + s8 tx_pwr_offset0; + s8 tx_pwr_offset1; - -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -struct _ADAPTER { - u8 temp; -#ifdef AP_BUILD_WORKAROUND - HAL_DATA_TYPE *temp2; - struct rtl8192cd_priv *priv; -#endif }; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) - -struct _WLAN_STA { - u8 temp; +struct phydm_bb_ram_ctrl { + /*@ For 98F/14B/22C/12F, each TxAGC step will be 0.25dB*/ + struct phydm_bb_ram_per_sta pram_sta_ctrl[ODM_ASSOCIATE_ENTRY_NUM]; + /*------------ For table2 do not set power offset by macid --------*/ + /* For type == 2'b10, 0x1e70[22:16] = tx_pwr_offset_reg0, 0x1e70[23] = enable */ + boolean tx_pwr_offset_reg0_en; + u8 tx_pwr_offset_reg0; + /* For type == 2'b11, 0x1e70[30:24] = tx_pwr_offset_reg1, 0x1e70[31] = enable */ + boolean tx_pwr_offset_reg1_en; + u8 tx_pwr_offset_reg1; }; #endif -struct _dynamic_primary_cca { - u8 pri_cca_flag; - u8 intf_flag; - u8 intf_type; - u8 dup_rts_flag; - u8 monitor_flag; - u8 CH_offset; - u8 MF_state; -}; - - -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - #ifdef ADSL_AP_BUILD_WORKAROUND - #define MAX_TOLERANCE 5 - #define IQK_DELAY_TIME 1 /*ms*/ +struct phydm_phystatus_statistic { + /*@[CCK]*/ + u32 rssi_cck_sum; + u32 rssi_cck_cnt; + u32 rssi_beacon_sum; + u32 rssi_beacon_cnt; + /*@[OFDM]*/ + u32 rssi_ofdm_sum[RF_PATH_MEM_SIZE]; + u32 rssi_ofdm_cnt; + u32 evm_ofdm_sum; + u32 snr_ofdm_sum[RF_PATH_MEM_SIZE]; + u16 evm_ofdm_hist[PHY_HIST_SIZE]; + u16 snr_ofdm_hist[PHY_HIST_SIZE]; + /*@[1SS]*/ + u32 rssi_1ss_cnt; + u32 rssi_1ss_sum[RF_PATH_MEM_SIZE]; + u32 evm_1ss_sum; + u32 snr_1ss_sum[RF_PATH_MEM_SIZE]; + u16 evm_1ss_hist[PHY_HIST_SIZE]; + u16 snr_1ss_hist[PHY_HIST_SIZE]; + /*@[2SS]*/ + #if (defined(PHYDM_COMPILE_ABOVE_2SS)) + u32 rssi_2ss_cnt; + u32 rssi_2ss_sum[RF_PATH_MEM_SIZE]; + u32 evm_2ss_sum[2]; + u32 snr_2ss_sum[RF_PATH_MEM_SIZE]; + u16 evm_2ss_hist[2][PHY_HIST_SIZE]; + u16 snr_2ss_hist[2][PHY_HIST_SIZE]; + #endif + /*@[3SS]*/ + #if (defined(PHYDM_COMPILE_ABOVE_3SS)) + u32 rssi_3ss_cnt; + u32 rssi_3ss_sum[RF_PATH_MEM_SIZE]; + u32 evm_3ss_sum[3]; + u32 snr_3ss_sum[RF_PATH_MEM_SIZE]; + u16 evm_3ss_hist[3][PHY_HIST_SIZE]; + u16 snr_3ss_hist[3][PHY_HIST_SIZE]; + #endif + /*@[4SS]*/ + #if (defined(PHYDM_COMPILE_ABOVE_4SS)) + u32 rssi_4ss_cnt; + u32 rssi_4ss_sum[RF_PATH_MEM_SIZE]; + u32 evm_4ss_sum[4]; + u32 snr_4ss_sum[RF_PATH_MEM_SIZE]; + u16 evm_4ss_hist[4][PHY_HIST_SIZE]; + u16 snr_4ss_hist[4][PHY_HIST_SIZE]; #endif -#endif /*#if(DM_ODM_SUPPORT_TYPE & (ODM_AP))*/ - -#define dm_type_by_fw 0 -#define dm_type_by_driver 1 - -/*Declare for common info*/ - -#define IQK_THRESHOLD 8 -#define DPK_THRESHOLD 4 - - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -__PACK struct _odm_phy_status_info_ { - u8 rx_pwdb_all; - u8 signal_quality; /* in 0-100 index. */ - u8 rx_mimo_signal_strength[4]; /* in 0~100 index */ - s8 rx_mimo_signal_quality[4]; /* EVM */ - s8 rx_snr[4]; /* per-path's SNR */ -#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) - u8 rx_count:2; /* RX path counter---*/ - u8 band_width:2; - u8 rxsc:4; /* sub-channel---*/ -#else - u8 band_width; -#endif -#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) - u8 channel; /* channel number---*/ - bool is_mu_packet; /* is MU packet or not---*/ - bool is_beamformed; /* BF packet---*/ -#endif }; -struct _odm_phy_status_info_append_ { - u8 MAC_CRC32; - +struct phydm_phystatus_avg { + /*@[CCK]*/ + u8 rssi_cck_avg; + u8 rssi_beacon_avg; + /*@[OFDM]*/ + u8 rssi_ofdm_avg[RF_PATH_MEM_SIZE]; + u8 evm_ofdm_avg; + u8 snr_ofdm_avg[RF_PATH_MEM_SIZE]; + /*@[1SS]*/ + u8 rssi_1ss_avg[RF_PATH_MEM_SIZE]; + u8 evm_1ss_avg; + u8 snr_1ss_avg[RF_PATH_MEM_SIZE]; + /*@[2SS]*/ + #if (defined(PHYDM_COMPILE_ABOVE_2SS)) + u8 rssi_2ss_avg[RF_PATH_MEM_SIZE]; + u8 evm_2ss_avg[2]; + u8 snr_2ss_avg[RF_PATH_MEM_SIZE]; + #endif + /*@[3SS]*/ + #if (defined(PHYDM_COMPILE_ABOVE_3SS)) + u8 rssi_3ss_avg[RF_PATH_MEM_SIZE]; + u8 evm_3ss_avg[3]; + u8 snr_3ss_avg[RF_PATH_MEM_SIZE]; + #endif + /*@[4SS]*/ + #if (defined(PHYDM_COMPILE_ABOVE_4SS)) + u8 rssi_4ss_avg[RF_PATH_MEM_SIZE]; + u8 evm_4ss_avg[4]; + u8 snr_4ss_avg[RF_PATH_MEM_SIZE]; + #endif }; -#else - -struct _odm_phy_status_info_ { - /* */ - /* Be care, if you want to add any element please insert between */ - /* rx_pwdb_all & signal_strength. */ - /* */ -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) - u32 rx_pwdb_all; -#else - u8 rx_pwdb_all; +struct odm_phy_dbg_info { + /*@ODM Write,debug info*/ + u32 num_qry_phy_status_cck; + u32 num_qry_phy_status_ofdm; +#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT) || (defined(PHYSTS_3RD_TYPE_SUPPORT)) + u32 num_qry_mu_pkt; + u32 num_qry_bf_pkt; + u16 num_mu_vht_pkt[VHT_RATE_NUM]; + boolean is_ldpc_pkt; + boolean is_stbc_pkt; + u8 num_of_ppdu[4]; + u8 gid_num[4]; #endif - u8 signal_quality; /* in 0-100 index. */ - s8 rx_mimo_signal_quality[4]; /* per-path's EVM translate to 0~100% */ - u8 rx_mimo_evm_dbm[4]; /* per-path's original EVM (dbm) */ - u8 rx_mimo_signal_strength[4]; /* in 0~100 index */ - 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 */ - /* s8 BB_Backup[13]; backup reg. */ -#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) - u8 rx_count:2; /* RX path counter---*/ - u8 band_width:2; - u8 rxsc:4; /* sub-channel---*/ -#else - u8 band_width; -#endif -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - u8 bt_coex_pwr_adjust; -#endif -#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) - u8 channel; /* channel number---*/ - bool is_mu_packet; /* is MU packet or not---*/ - bool is_beamformed; /* BF packet---*/ -#endif -}; -#endif - -struct _odm_per_pkt_info_ { - u8 data_rate; - u8 station_id; - bool is_packet_match_bssid; - bool is_packet_to_self; - bool is_packet_beacon; - bool is_to_self; - u8 ppdu_cnt; + u32 condi_num; /*@condition number U(18,4)*/ + u8 condi_num_cdf[CN_CNT_MAX]; + u8 num_qry_beacon_pkt; + u8 beacon_cnt_in_period; /*@beacon cnt within watchdog period*/ + u8 beacon_phy_rate; + u8 show_phy_sts_all_pkt; /*@Show phy status witch not match BSSID*/ + u16 show_phy_sts_max_cnt; /*@show number of phy-status row data per PHYDM watchdog*/ + u16 show_phy_sts_cnt; + u16 num_qry_legacy_pkt[LEGACY_RATE_NUM]; + u16 num_qry_ht_pkt[HT_RATE_NUM]; + u16 num_qry_pkt_sc_20m[LOW_BW_RATE_NUM]; /*@20M SC*/ + boolean ht_pkt_not_zero; + boolean low_bw_20_occur; + #if ODM_IC_11AC_SERIES_SUPPORT || defined(PHYDM_IC_JGR3_SERIES_SUPPORT) + u16 num_qry_vht_pkt[VHT_RATE_NUM]; + u16 num_qry_pkt_sc_40m[LOW_BW_RATE_NUM]; /*@40M SC*/ + boolean vht_pkt_not_zero; + boolean low_bw_40_occur; + #endif + u16 snr_hist_th[PHY_HIST_SIZE - 1]; + u16 evm_hist_th[PHY_HIST_SIZE - 1]; + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + s16 cfo_tail[4]; /* per-path's cfo_tail */ + #endif + struct phydm_phystatus_statistic physts_statistic_info; + struct phydm_phystatus_avg phystatus_statistic_avg; }; - -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]; - u32 num_qry_vht_pkt[40]; - bool is_ldpc_pkt; - bool is_stbc_pkt; - u8 num_of_ppdu[4]; - u8 gid_num[4]; -#endif - u8 num_qry_beacon_pkt; - /* Others */ - s32 rx_evm[4]; - -}; - - -/*2011/20/20 MH For MP driver RT_WLAN_STA = struct sta_info*/ -/*Please declare below ODM relative info in your STA info structure.*/ - -#if 1 -struct _ODM_STA_INFO { - /*Driver Write*/ - bool is_used; /*record the sta status link or not?*/ - u8 iot_peer; /*Enum value. HT_IOT_PEER_E*/ - - /*ODM Write*/ - /*PHY_STATUS_INFO*/ - u8 rssi_path[4]; - u8 rssi_ave; - u8 RXEVM[4]; - u8 RXSNR[4]; - -}; -#endif - -enum odm_cmninfo_e { - /*Fixed value*/ - /*-----------HOOK BEFORE REG INIT-----------*/ +enum odm_cmninfo { + /*@Fixed value*/ + /*@-----------HOOK BEFORE REG INIT-----------*/ ODM_CMNINFO_PLATFORM = 0, ODM_CMNINFO_ABILITY, ODM_CMNINFO_INTERFACE, @@ -306,8 +369,11 @@ enum odm_cmninfo_e { ODM_CMNINFO_IC_TYPE, ODM_CMNINFO_CUT_VER, ODM_CMNINFO_FAB_VER, + ODM_CMNINFO_FW_VER, + ODM_CMNINFO_FW_SUB_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, @@ -318,6 +384,7 @@ enum odm_cmninfo_e { ODM_CMNINFO_APA, ODM_CMNINFO_GLNA, ODM_CMNINFO_ALNA, + ODM_CMNINFO_TDMA, ODM_CMNINFO_EXT_TRSW, ODM_CMNINFO_EXT_LNA_GAIN, ODM_CMNINFO_PATCH_ID, @@ -325,9 +392,6 @@ enum odm_cmninfo_e { 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, @@ -337,17 +401,21 @@ enum odm_cmninfo_e { ODM_CMNINFO_REGRFKFREEENABLE, ODM_CMNINFO_RFKFREEENABLE, ODM_CMNINFO_NORMAL_RX_PATH_CHANGE, + ODM_CMNINFO_VALID_PATH_SET, ODM_CMNINFO_EFUSE0X3D8, ODM_CMNINFO_EFUSE0X3D7, - /*-----------HOOK BEFORE REG INIT-----------*/ + ODM_CMNINFO_SOFT_AP_SPECIAL_SETTING, + ODM_CMNINFO_X_CAP_SETTING, + ODM_CMNINFO_ADVANCE_OTA, + ODM_CMNINFO_HP_HWID, + ODM_CMNINFO_DIS_DPD, + /*@-----------HOOK BEFORE REG INIT-----------*/ - /*Dynamic value:*/ + /*@Dynamic value:*/ - /*--------- POINTER REFERENCE-----------*/ - ODM_CMNINFO_MAC_PHY_MODE, + /*@--------- POINTER REFERENCE-----------*/ ODM_CMNINFO_TX_UNI, ODM_CMNINFO_RX_UNI, - ODM_CMNINFO_WM_MODE, ODM_CMNINFO_BAND, ODM_CMNINFO_SEC_CHNL_OFFSET, ODM_CMNINFO_SEC_MODE, @@ -355,10 +423,9 @@ enum odm_cmninfo_e { ODM_CMNINFO_CHNL, ODM_CMNINFO_FORCED_RATE, ODM_CMNINFO_ANT_DIV, + ODM_CMNINFO_PATH_DIV, + ODM_CMNINFO_ADAPTIVE_SOML, 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, @@ -367,7 +434,6 @@ enum odm_cmninfo_e { 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, @@ -375,19 +441,26 @@ enum odm_cmninfo_e { ODM_CMNINFO_DFS_MASTER_ENABLE, ODM_CMNINFO_FORCE_TX_ANT_BY_TXDESC, ODM_CMNINFO_SET_S0S1_DEFAULT_ANTENNA, - /*--------- POINTER REFERENCE-----------*/ + ODM_CMNINFO_SOFT_AP_MODE, + ODM_CMNINFO_MP_MODE, + ODM_CMNINFO_INTERRUPT_MASK, + ODM_CMNINFO_BB_OPERATION_MODE, + ODM_CMNINFO_BF_ANTDIV_DECISION, + ODM_CMNINFO_MANUAL_SUPPORTABILITY, + /*@--------- POINTER REFERENCE-----------*/ - /*------------CALL BY VALUE-------------*/ + /*@------------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, - ODM_CMNINFO_RA_THRESHOLD_LOW, + 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, @@ -396,27 +469,41 @@ enum odm_cmninfo_e { 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-------------*/ + ODM_CMNINFO_BT_CONTINUOUS_TURN, + ODM_CMNINFO_IS_DOWNLOAD_FW, + ODM_CMNINFO_PHYDM_PATCH_ID, + ODM_CMNINFO_RRSR_VAL, + /*@------------CALL BY VALUE-------------*/ - /*Dynamic ptr array hook itms.*/ + /*@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 { +enum phydm_info_query { PHYDM_INFO_FA_OFDM, PHYDM_INFO_FA_CCK, PHYDM_INFO_FA_TOTAL, @@ -434,543 +521,765 @@ enum phydm_info_query_e { PHYDM_INFO_EDCCA_FLAG, PHYDM_INFO_OFDM_ENABLE, PHYDM_INFO_CCK_ENABLE, - PHYDM_INFO_DBG_PORT_0 + 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_api { + PHYDM_API_NBI = 1, + PHYDM_API_CSI_MASK = 2, }; +enum phydm_func_idx { /*@F_XXX = PHYDM XXX function*/ -/*2011/10/20 MH Define ODM support ability. ODM_CMNINFO_ABILITY*/ -enum odm_ability_e { - - /*BB ODM section BIT 0-19*/ - ODM_BB_DIG = BIT(0), - ODM_BB_RA_MASK = BIT(1), - ODM_BB_DYNAMIC_TXPWR = BIT(2), - ODM_BB_FA_CNT = BIT(3), - ODM_BB_RSSI_MONITOR = BIT(4), - ODM_BB_CCK_PD = BIT(5), - ODM_BB_ANT_DIV = BIT(6), - ODM_BB_PWR_TRAIN = BIT(8), - ODM_BB_RATE_ADAPTIVE = BIT(9), - ODM_BB_PATH_DIV = BIT(10), - ODM_BB_ADAPTIVITY = BIT(13), - ODM_BB_CFO_TRACKING = BIT(14), - ODM_BB_NHM_CNT = BIT(15), - ODM_BB_PRIMARY_CCA = BIT(16), - ODM_BB_TXBF = BIT(17), - ODM_BB_DYNAMIC_ARFR = BIT(18), - - ODM_MAC_EDCA_TURBO = BIT(20), - ODM_BB_DYNAMIC_RX_PATH = BIT(21), - - /*RF ODM section BIT 24-31*/ - ODM_RF_TX_PWR_TRACK = BIT(24), - ODM_RF_RX_GAIN_TRACK = BIT(25), - ODM_RF_CALIBRATION = BIT(26), - + 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, }; +/*@=[PHYDM supportability]==========================================*/ +enum odm_ability { + 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), +}; -/*ODM_CMNINFO_ONE_PATH_CCA*/ -enum odm_cca_path_e { +/*@=[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), + /*BIT(19)*/ + /*Neet to re-arrange*/ + DBG_PHY_STATUS = BIT(20), + DBG_TMP = BIT(21), + DBG_FW_TRACE = BIT(22), + DBG_TXBF = BIT(23), + DBG_COMMON_FLOW = BIT(24), + DBG_COMP_MCC = BIT(25), + /*BIT(26)*/ + DBG_DM_SUMMARY = BIT(27), + ODM_PHY_CONFIG = BIT(28), + ODM_COMP_INIT = BIT(29), + DBG_CMN = BIT(30),/*@common*/ + ODM_COMP_API = BIT(31) +}; + +/*@=========================================================*/ + +/*@ODM_CMNINFO_ONE_PATH_CCA*/ +enum odm_cca_path { ODM_CCA_2R = 0, ODM_CCA_1R_A = 1, ODM_CCA_1R_B = 2, }; -enum cca_pathdiv_en_e { - CCA_PATHDIV_DISABLE = 0, - CCA_PATHDIV_ENABLE = 1, - -}; - - enum phy_reg_pg_type { PHY_REG_PG_RELATIVE_VALUE = 0, - PHY_REG_PG_EXACT_VALUE = 1 + PHY_REG_PG_EXACT_VALUE = 1 }; -/*2011/09/22 MH Copy from SD4 defined structure. We use to support PHY DM integration.*/ +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; + s8 lv_adsl; +}; + +struct phydm_func_poiner { + void (*pause_phydm_handler)(void *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 (RTL8822B_SUPPORT) +struct drp_rtl8822b_struct { + enum bb_path path_judge; + u16 path_a_cck_fa; + u16 path_b_cck_fa; +}; +#endif + +#ifdef CONFIG_MCC_DM +#define MCC_DM_REG_NUM 32 +struct _phydm_mcc_dm_ { + u8 mcc_pre_status; + u8 mcc_reg_id[MCC_DM_REG_NUM]; + u16 mcc_dm_reg[MCC_DM_REG_NUM]; + u8 mcc_dm_val[MCC_DM_REG_NUM][2]; + /*mcc DIG*/ + u8 mcc_rssi[2]; + /*u8 mcc_igi[2];*/ + + /* need to be config by driver*/ + u8 mcc_status; + u8 sta_macid[2][NUM_STA]; + u16 mcc_rf_ch[2]; + +}; +#endif + +#if (RTL8822C_SUPPORT || RTL8812F_SUPPORT) +struct phydm_physts { + u8 cck_gi_u_bnd; + u8 cck_gi_l_bnd; +}; +#endif #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) #if (RT_PLATFORM != PLATFORM_LINUX) typedef #endif - struct PHY_DM_STRUCT -#else/*for AP,ADSL,CE Team*/ - struct PHY_DM_STRUCT +struct dm_struct { +#else/*for AP, CE Team*/ +struct dm_struct { #endif -{ - /*Add for different team use temporarily*/ - struct _ADAPTER *adapter; /*For CE/NIC team*/ - struct rtl8192cd_priv *priv; /*For AP/ADSL team*/ - /*WHen you use adapter or priv pointer, you must make sure the pointer is ready.*/ - bool odm_ready; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_WIN)) - struct rtl8192cd_priv fake_priv; -#endif -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - /* ADSL_AP_BUILD_WORKAROUND */ - struct _ADAPTER fake_adapter; -#endif - - enum phy_reg_pg_type phy_reg_pg_value_type; - u8 phy_reg_pg_version; - - u32 debug_components; + /*@Add for different team use temporarily*/ + void *adapter; /*@For CE/NIC team*/ + struct rtl8192cd_priv *priv; /*@For AP team*/ + 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; + u8 cmn_dbg_msg_period; + u8 cmn_dbg_msg_cnt; u32 fw_debug_components; - u32 debug_level; - - u32 num_qry_phy_status_all; /*CCK + OFDM*/ + u32 num_qry_phy_status_all; /*@CCK + OFDM*/ u32 last_num_qry_phy_status_all; u32 rx_pwdb_ave; - bool MPDIG_2G; /*off MPDIG*/ - u8 times_2g; - bool is_init_hw_info_by_rfe; + boolean is_init_hw_info_by_rfe; - /*------ ODM HANDLE, DRIVER NEEDS NOT TO HOOK------*/ - bool is_cck_high_power; + /*@------ ODM HANDLE, DRIVER NEEDS NOT TO HOOK------*/ + boolean is_cck_high_power; u8 rf_path_rx_enable; - u8 control_channel; - /*------ ODM HANDLE, DRIVER NEEDS NOT TO HOOK------*/ + /*@------ ODM HANDLE, DRIVER NEEDS NOT TO HOOK------*/ + /* @COMMON INFORMATION */ - /* 1 COMMON INFORMATION */ + /*@Init value*/ + /*@-----------HOOK BEFORE REG INIT-----------*/ - /*Init value*/ - /*-----------HOOK BEFORE REG INIT-----------*/ - /*ODM Platform info AP/ADSL/CE/MP = 1/2/3/4*/ - u8 support_platform; - /* ODM Platform info WIN/AP/CE = 1/2/3 */ + u8 support_platform; /*@PHYDM Platform info WIN/AP/CE = 1/2/3 */ u8 normal_rx_path; - /*ODM Support Ability DIG/RATR/TX_PWR_TRACK/ ¡K¡K = 1/2/3/¡K*/ - u32 support_ability; - /*ODM PCIE/USB/SDIO = 1/2/3*/ - u8 support_interface; - /*ODM composite or independent. Bit oriented/ 92C+92D+ .... or any other type = 1/2/3/...*/ - u32 support_ic_type; - /*cut version TestChip/A-cut/B-cut... = 0/1/2/3/...*/ - u8 cut_version; - /*Fab version TSMC/UMC = 0/1*/ - u8 fab_version; - /*RF type 4T4R/3T3R/2T2R/1T2R/1T1R/...*/ - u8 rf_type; + u8 valid_path_set; /*@use for single rx path only*/ + 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*/ + enum phydm_api_host run_in_drv_fw; /*@PHYDM API is using in FW or Driver*/ + u8 ic_ip_series; /*N/AC/JGR3*/ + enum phydm_phy_sts_type ic_phy_sts_type; /*@Type1/type2/type3*/ + u8 cut_version; /*@cut version TestChip/A-cut/B-cut... = 0/1/2/3/...*/ + u8 fab_version; /*@Fab version TSMC/UMC = 0/1*/ + u8 fw_version; + u8 fw_sub_version; + u8 rf_type; /*@RF type 4T4R/3T3R/2T2R/1T2R/1T1R/...*/ u8 rfe_type; - /*Board type Normal/HighPower/MiniCard/SLIM/Combo/... = 0/1/2/3/4/...*/ u8 board_type; u8 package_type; u16 type_glna; u16 type_gpa; u16 type_alna; u16 type_apa; - /*with external LNA NO/Yes = 0/1*/ - u8 ext_lna; /*2G*/ - u8 ext_lna_5g; /*5G*/ - /*with external PA NO/Yes = 0/1*/ - u8 ext_pa; /*2G*/ - u8 ext_pa_5g; /*5G*/ - /*with Efuse number*/ - u8 efuse0x3d7; - u8 efuse0x3d8; - /*with external TRSW NO/Yes = 0/1*/ - u8 ext_trsw; - u8 ext_lna_gain; /*2G*/ - u8 patch_id; /*Customer ID*/ - bool is_in_hct_test; + 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; - - bool is_dual_mac_smart_concurrent; - u32 bk_support_ability; - u8 ant_div_type; + boolean is_dual_mac_smart_concurrent; + u32 bk_support_ability; /*SD4 only*/ u8 with_extenal_ant_switch; - bool config_bbrf; - u8 odm_regulation_2_4g; - u8 odm_regulation_5g; - u8 iqk_fw_offload; - bool cck_new_agc; - u8 phydm_period; + /*@cck agc relative*/ + boolean cck_new_agc; + s8 cck_lna_gain_table[8]; + /*@-------------------------------------*/ u32 phydm_sys_up_time; - u8 num_rf_path; - u8 is_receiver_blocking_en; - /*-----------HOOK BEFORE REG INIT-----------*/ + u8 num_rf_path; /*@ex: 8821C=1, 8192E=2, 8814B=4*/ + u32 soft_ap_special_setting; + boolean boolean_dummy; + 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_rx_blocking_en; + u16 fw_offload_ability; + boolean is_download_fw; + boolean en_dis_dpd; + u16 dis_dpd_rate; + #if (RTL8822C_SUPPORT) + u8 txagc_buff[2][NUM_RATE_AC_2SS]; + u32 bp_0x9b0; + #endif +/*@-----------HOOK BEFORE REG INIT-----------*/ +/*@===========================================================*/ +/*@====[ CALL BY Reference ]=========================================*/ +/*@===========================================================*/ - /*Dynamic value*/ + u64 *num_tx_bytes_unicast; /*@TX Unicast byte cnt*/ + u64 *num_rx_bytes_unicast; /*@RX Unicast byte cnt*/ + u8 *band_type; /*@2.4G/5G = 0/1*/ + u8 *sec_ch_offset; /*@Secondary channel offset don't_care/below/above = 0/1/2*/ + u8 *security; /*@security mode Open/WEP/AES/TKIP = 0/1/2/3*/ + u8 *band_width; /*@20M/40M/80M = 0/1/2*/ + u8 *channel; /*@central CH number*/ + boolean *is_scan_in_process; + boolean *is_power_saving; + boolean *is_tdma; + u8 *one_path_cca; /*@CCA path 2-path/path-A/path-B = 0/1/2; using enum odm_cca_path.*/ + u8 *antenna_test; + boolean *is_net_closed; + boolean *is_fcs_mode_enable; /*@fast channel switch (= MCC mode)*/ + /*@--------- For 8723B IQK-------------------------------------*/ + boolean *is_1_antenna; + u8 *rf_default_path; /* @0:S1, 1:S0 */ + /*@-----------------------------------------------------------*/ - /*--------- POINTER REFERENCE-----------*/ + u16 *forced_data_rate; + u8 *enable_antdiv; + u8 *enable_pathdiv; + u8 *en_adap_soml; + u8 *enable_adaptivity; + u8 *hub_usb_mode; /*@1:USB2.0, 2:USB3.0*/ + boolean *is_fw_dw_rsvd_page_in_progress; + u32 *current_tx_tp; + u32 *current_rx_tp; + u8 *sounding_seq; + u32 *soft_ap_mode; + u8 *mp_mode; + u32 *interrupt_mask; + u8 *bb_op_mode; + u32 *manual_supportability; +/*@===========================================================*/ +/*@====[ CALL BY VALUE ]===========================================*/ +/*@===========================================================*/ - u8 u1_byte_temp; - bool BOOLEAN_temp; - struct _ADAPTER *PADAPTER_temp; - - /*MAC PHY mode SMSP/DMSP/DMDP = 0/1/2*/ - u8 *p_mac_phy_mode; - /*TX Unicast byte count*/ - u64 *p_num_tx_bytes_unicast; - /*RX Unicast byte count*/ - u64 *p_num_rx_bytes_unicast; - /*Wireless mode B/G/A/N = BIT0/BIT1/BIT2/BIT3*/ - u8 *p_wireless_mode; - /*Frequence band 2.4G/5G = 0/1*/ - u8 *p_band_type; - /*Secondary channel offset don't_care/below/above = 0/1/2*/ - u8 *p_sec_ch_offset; - /*security mode Open/WEP/AES/TKIP = 0/1/2/3*/ - u8 *p_security; - /*BW info 20M/40M/80M = 0/1/2*/ - u8 *p_band_width; - /*Central channel location Ch1/Ch2/....*/ - u8 *p_channel; /*central channel number*/ - bool dpk_done; - /*Common info for 92D DMSP*/ - - bool *p_is_get_value_from_other_mac; - struct _ADAPTER **p_buddy_adapter; - bool *p_is_master_of_dmsp; /* MAC0: master, MAC1: slave */ - /*Common info for status*/ - bool *p_is_scan_in_process; - bool *p_is_power_saving; - /*CCA path 2-path/path-A/path-B = 0/1/2; using enum odm_cca_path_e.*/ - u8 *p_one_path_cca; - u8 *p_antenna_test; - bool *p_is_net_closed; - u8 *pu1_forced_igi_lb; - bool *p_is_fcs_mode_enable; - /*--------- For 8723B IQK-----------*/ - bool *p_is_1_antenna; - u8 *p_rf_default_path; - /* 0:S1, 1:S0 */ - - /*--------- POINTER REFERENCE-----------*/ - u16 *p_forced_data_rate; - u8 *p_enable_antdiv; - u8 *p_enable_adaptivity; - u8 *hub_usb_mode; - bool *p_is_fw_dw_rsvd_page_in_progress; - u32 *p_current_tx_tp; - u32 *p_current_rx_tp; - u8 *p_sounding_seq; - /*------------CALL BY VALUE-------------*/ - bool is_link_in_process; - bool is_wifi_direct; - bool is_wifi_display; - bool is_linked; - bool bsta_state; -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) /*for repeater mode add by YuChen 2014.06.23*/ -#ifdef UNIVERSAL_REPEATER - bool vxd_linked; -#endif -#endif + u8 disable_phydm_watchdog; + boolean is_link_in_process; + boolean is_wifi_direct; + boolean is_wifi_display; + boolean is_linked; + boolean pre_is_linked; + boolean first_connect; + boolean first_disconnect; + boolean bsta_state; u8 rssi_min; - u8 interface_index; /*Add for 92D dual MAC: 0--Mac0 1--Mac1*/ - bool is_mp_chip; - bool is_one_entry_only; - bool mp_mode; + u8 rssi_min_macid; + u8 pre_rssi_min; + u8 rssi_max; + u8 rssi_max_macid; + 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; - /*Common info for BTDM*/ - bool is_bt_enabled; /*BT is enabled*/ - bool is_bt_connect_process; /*BT HS is under connection progress.*/ - u8 bt_hs_rssi; /*BT HS mode wifi rssi value.*/ - bool is_bt_hs_operation; /*BT HS mode is under progress*/ - u8 bt_hs_dig_val; /*use BT rssi to decide the DIG value*/ - bool is_bt_disable_edca_turbo; /*Under some condition, don't enable the EDCA Turbo*/ - bool is_bt_busy; /*BT is busy.*/ - bool is_bt_limited_dig; /*BT is busy.*/ - bool is_disable_phy_api; - /*------------CALL BY VALUE-------------*/ - 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; + boolean is_disable_phy_api; + u8 rssi_a; + u8 rssi_b; + u8 rssi_c; + u8 rssi_d; + s8 rxsc_80; + s8 rxsc_40; + s8 rxsc_20; + s8 rxsc_l; + u64 rssi_trsw; + u64 rssi_trsw_h; + u64 rssi_trsw_l; + u64 rssi_trsw_iso; + u8 tx_ant_status; /*TX path enable*/ + u8 rx_ant_status; /*RX path enable*/ + #ifdef PHYDM_COMPILE_ABOVE_4SS + enum bb_path tx_4ss_status; /*@Use N-X for 4STS rate*/ + #endif + #ifdef PHYDM_COMPILE_ABOVE_3SS + enum bb_path tx_3ss_status; /*@Use N-X for 3STS rate*/ + #endif + #ifdef PHYDM_COMPILE_ABOVE_2SS + enum bb_path tx_2ss_status; /*@Use N-X for 2STS rate*/ + #endif + enum bb_path tx_1ss_status; /*@Use N-X for 1STS rate*/ u8 cck_lna_idx; u8 cck_vga_idx; u8 curr_station_id; u8 ofdm_agc_idx[4]; - u8 rx_rate; - bool is_noisy_state; + u8 rate_ss; u8 tx_rate; u8 linked_interval; u8 pre_channel; u32 txagc_offset_value_a; - bool is_txagc_offset_positive_a; + boolean is_txagc_offset_positive_a; u32 txagc_offset_value_b; - bool is_txagc_offset_positive_b; - u32 tx_tp; - u32 rx_tp; - u32 total_tp; + boolean is_txagc_offset_positive_b; + u8 ap_total_num; + /*@[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-dir*/ 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*/ - u32 bb_swing_offset_a; - bool is_bb_swing_offset_positive_a; - u32 bb_swing_offset_b; - bool is_bb_swing_offset_positive_b; - u8 igi_lower_bound; - u8 igi_upper_bound; + 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*/ + u8 force_igi; /*@for debug*/ + + /*@[TDMA-DIG]*/ + u8 tdma_dig_timer_ms; + u8 tdma_dig_state_number; + u8 tdma_dig_low_upper_bond; + u8 force_tdma_low_igi; + u8 force_tdma_high_igi; + 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 antdiv_delay; u8 ant_type; + u8 ant_type2; u8 pre_ant_type; + u8 pre_ant_type2; 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; - bool h2c_rarpt_connect; - bool cck_agc_report_type; + u8 antdiv_counter; + /*@---------------------------*/ - u8 dm_dig_max_TH; - u8 dm_dig_min_TH; + u8 ndpa_period; + boolean h2c_rarpt_connect; + boolean cck_agc_report_type; /*@1:4bit LNA, 0:3bit LNA */ u8 print_agc; - u8 traffic_load; - u8 pre_traffic_load; - /*8821C Antenna BTG/WLG/WLA Select*/ + u8 la_mode; + /*@---8821C Antenna and RF Set BTG/WLG/WLA Select---------------*/ u8 current_rf_set_8821c; u8 default_rf_set_8821c; - /*For Adaptivtiy*/ - u16 nhm_cnt_0; - u16 nhm_cnt_1; + u8 current_ant_num_8821c; + u8 default_ant_num_8821c; + u8 rfe_type_expand; + /*@-----------------------------------------------------------*/ + /*@---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; - bool carrier_sense_enable; - u8 adaptivity_igi_upper; - bool adaptivity_flag; - u8 dc_backoff; - bool adaptivity_enable; - u8 ap_total_num; - bool edcca_enable; - struct _ADAPTIVITY_STATISTICS adaptivity; - /*For Adaptivtiy*/ - u8 last_usb_hub; - u8 tx_bf_data_rate; - + boolean carrier_sense_enable; + /*@-----------------------------------------------------------*/ + u8 pre_dbg_priority; u8 nbi_set_result; - u8 c2h_cmd_start; u8 fw_debug_trace[60]; u8 pre_c2h_seq; - bool fw_buff_is_enpty; + boolean fw_buff_is_enpty; u32 data_frame_num; - - /*for noise detection*/ - bool noisy_decision; /*b_noisy*/ - bool pre_b_noisy; +#if (RTL8814B_SUPPORT) + /*@--- for spur detection ---------------------------------------*/ + u8 dsde_sel; + u8 nbi_path_sel; + u8 csi_wgt; + /*@------------------------------------------*/ +#endif + /*@--- for noise detection ---------------------------------------*/ + boolean is_noisy_state; + boolean noisy_decision; /*@b_noisy*/ + boolean pre_b_noisy; u32 noisy_decision_smooth; - bool is_disable_dym_ecs; + /*@-----------------------------------------------------------*/ -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_WIN)) - struct _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.??*/ - struct sta_info *p_odm_sta_info[ODM_ASSOCIATE_ENTRY_NUM]; - u16 platform2phydm_macid_table[ODM_ASSOCIATE_ENTRY_NUM]; - /* platform_macid_table[platform_macid] = phydm_macid */ -#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) - s32 accumulate_pwdb[ODM_ASSOCIATE_ENTRY_NUM]; -#endif + /*@--- for MCC ant weighting ------------------------------------*/ + boolean is_stop_dym_ant_weighting; + /*@-----------------------------------------------------------*/ -#if (RATE_ADAPTIVE_SUPPORT == 1) + boolean is_disable_dym_ecs; + boolean is_disable_dym_ant_weighting; + struct cmn_sta_info *phydm_sta_info[ODM_ASSOCIATE_ENTRY_NUM]; + u8 phydm_macid_table[ODM_ASSOCIATE_ENTRY_NUM];/*@sta_idx = phydm_macid_table[HW_macid]*/ + +#if (RATE_ADAPTIVE_SUPPORT) 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*/ + struct _phydm_txstatistic_ hw_stats; + 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 - - /*2012/02/14 MH Add to share 88E ra with other SW team.*/ + /*@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 ra_support88e; + boolean *is_driver_stopped; + boolean *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*/ - bool ra_support88e; + /*@---PSD Relative ---------------------------------------------*/ + boolean is_psd_in_process; + boolean is_psd_active; + /*@-----------------------------------------------------------*/ - struct _odm_phy_dbg_info_ phy_dbg_info; - - /*ODM Structure*/ -#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - struct _BF_DIV_COEX_ dm_bdc_table; -#endif - -#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 - struct _SMART_ANTENNA_TRAINNING_ dm_sat_table; -#endif - -#endif - struct _FAST_ANTENNA_TRAINNING_ dm_fat_table; - struct _dynamic_initial_gain_threshold_ dm_dig_table; -#if (defined(CONFIG_BB_POWER_SAVING)) - struct _dynamic_power_saving dm_ps_table; -#endif - struct _dynamic_primary_cca dm_pri_cca; - struct _rate_adaptive_table_ dm_ra_table; - struct _FALSE_ALARM_STATISTICS false_alm_cnt; - struct _FALSE_ALARM_STATISTICS flase_alm_cnt_buddy_adapter; - struct _sw_antenna_switch_ dm_swat_table; - struct _CFO_TRACKING_ dm_cfo_track; - struct _ACS_ dm_acs; - struct _CCX_INFO dm_ccx_info; -#if (PHYDM_LA_MODE_SUPPORT == 1) - struct _RT_ADCSMP adcsmp; -#endif -#if (CONFIG_DYNAMIC_RX_PATH == 1) - struct _DYNAMIC_RX_PATH_ dm_drp_table; -#endif - -#if (RTL8814A_SUPPORT == 1 || RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1) - struct _IQK_INFORMATION IQK_info; -#endif - -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - /*path Div Struct*/ - struct _path_div_parameter_define_ path_iqk; -#endif -#if (defined(CONFIG_PATH_DIVERSITY)) - struct _ODM_PATH_DIVERSITY_ dm_path_div; -#endif - -#if PHYDM_SUPPORT_EDCA - struct _EDCA_TURBO_ dm_edca_table; - u32 WMMEDCA_BE; -#endif - - bool *p_is_driver_stopped; - bool *p_is_driver_is_going_to_pnp_set_power_sleep; - bool *pinit_adpt_in_progress; - - /*PSD*/ - bool is_user_assign_level; - u8 RSSI_BT; /*come from BT*/ - bool is_psd_in_process; - bool is_psd_active; - bool is_dm_initial_gain_enable; - - /*MPT DIG*/ - struct timer_list mpt_dig_timer; - - /*for rate adaptive, in fact, 88c/92c fw will handle this*/ - u8 is_use_ra_mask; - - struct _ODM_RATE_ADAPTIVE rate_adaptive; -#if (defined(CONFIG_ANT_DETECTION)) - struct _ANT_DETECTED_INFO ant_detected_info; /* Antenna detected information for RSSI tool*/ -#endif - struct odm_rf_calibration_structure rf_calibrate_info; + boolean bsomlenabled; /* @D-SoML control */ + boolean bhtstfdisabled; /* @dynamic HTSTF gain control*/ u32 n_iqk_cnt; u32 n_iqk_ok_cnt; u32 n_iqk_fail_cnt; -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - /*Power Training*/ - u8 force_power_training_state; - bool is_change_state; - u32 PT_score; - u64 ofdm_rx_cnt; - u64 cck_rx_cnt; +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + boolean config_bbrf; +#endif + boolean is_disable_power_training; + boolean is_bt_continuous_turn; + u8 enhance_pwr_th[3]; + u8 set_pwr_th[3]; + /*@----------Dyn Tx Pwr ---------------------------------------*/ +#ifdef BB_RAM_SUPPORT + struct phydm_bb_ram_ctrl p_bb_ram_ctrl; #endif - bool is_disable_power_training; u8 dynamic_tx_high_power_lvl; + void (*fill_desc_dyntxpwr)(void *dm, u8 *desc, u8 dyn_tx_power); u8 last_dtp_lvl; + u8 min_power_index; u32 tx_agc_ofdm_18_6; + /*-------------------------------------------------------------*/ u8 rx_pkt_type; - /*ODM relative time.*/ - struct timer_list path_div_switch_timer; - /*2011.09.27 add for path Diversity*/ - struct timer_list cck_path_diversity_timer; - 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; +#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; + + u32 radar_detect_reg_a40; + u32 radar_detect_reg_a44; + u32 radar_detect_reg_a48; + u32 radar_detect_reg_a4c; + u32 radar_detect_reg_a50; + u32 radar_detect_reg_a54; + + u32 radar_detect_reg_f54; + u32 radar_detect_reg_f58; + u32 radar_detect_reg_f5c; + u32 radar_detect_reg_f70; + u32 radar_detect_reg_f74; + /*@---For zero-wait DFS---------------------------------------*/ + boolean seg1_dfs_flag; + /*@-----------------------------------------------------------*/ +/*@-----------------------------------------------------------*/ +#endif + +/*@=== RTL8721D ADC clock 80MHz only for CBW20MHz ===*/ +#if (RTL8721D_SUPPORT) + boolean cbw20_adc80; +#endif + +/*@=== PHYDM Timer ========================================== (start)*/ + + struct phydm_timer_list mpt_dig_timer; + struct phydm_timer_list fast_ant_training_timer; +#ifdef ODM_EVM_ENHANCE_ANTDIV + struct phydm_timer_list evm_fast_ant_training_timer; +#endif +#ifdef PHYDM_TDMA_DIG_SUPPORT + struct phydm_timer_list tdma_dig_timer; +#endif + struct phydm_timer_list sbdcnt_timer; + +/*@=== PHYDM Workitem ======================================= (start)*/ - /*ODM relative workitem.*/ #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 mpt_dig_workitem; - RT_WORK_ITEM ra_rpt_workitem; - RT_WORK_ITEM sbdcnt_workitem; + RT_WORK_ITEM fast_ant_training_workitem; + RT_WORK_ITEM ra_rpt_workitem; + RT_WORK_ITEM sbdcnt_workitem; + RT_WORK_ITEM phydm_evm_antdiv_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 PHYDM_IC_JGR3_SERIES_SUPPORT + struct phydm_bf_rate_info_jgr3 bf_rate_info_jgr3; +#endif + +#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 _hal_rf_ rf_table; /*@for HALRF function*/ + struct dm_rf_calibration_struct rf_calibrate_info; + struct dm_iqk_info IQK_info; + struct dm_dpk_info dpk_info; + +#ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY + struct phydm_fat_struct dm_fat_table; + struct sw_antenna_switch dm_swat_table; +#endif + struct phydm_dig_struct dm_dig_table; +#ifdef PHYDM_LNA_SAT_CHK_SUPPORT + struct phydm_lna_sat_t dm_lna_sat_info; +#endif + +#ifdef CONFIG_MCC_DM + struct _phydm_mcc_dm_ mcc_dm; +#endif + +#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 ra_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; +#ifdef IS_USE_NEW_TDMA + struct phydm_fa_acc_struct false_alm_cnt_acc_low; +#endif +#endif + struct phydm_cfo_track_struct dm_cfo_track; + struct ccx_info dm_ccx_info; + + struct odm_power_trim_data power_trim_data; +#if (RTL8822B_SUPPORT) + struct drp_rtl8822b_struct phydm_rtl8822b; +#endif + +#ifdef CONFIG_PSD_TOOL + struct psd_info dm_psd_table; +#endif + +#if (PHYDM_LA_MODE_SUPPORT) + struct rt_adcsmp adcsmp; +#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; +#endif + #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -#if (BEAMFORMING_SUPPORT == 1) - struct _RT_BEAMFORMING_INFO beamforming_info; +#ifdef PHYDM_BEAMFORMING_SUPPORT + struct _RT_BEAMFORMING_INFO beamforming_info; #endif +#endif +#ifdef PHYDM_AUTO_DEGBUG + struct phydm_auto_dbg_struct auto_dbg_table; #endif -#ifdef CONFIG_PHYDM_DFS_MASTER - u8 dfs_region_domain; - u8 *dfs_master_enabled; + 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 - /*====== 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; - /*====== phydm_radar_detect_with_dbg_parm end ======*/ +#ifdef PHYDM_PMAC_TX_SETTING_SUPPORT + struct phydm_pmac_tx dm_pmac_tx_table; +#endif + +#ifdef PHYDM_MP_SUPPORT + struct phydm_mp dm_mp_table; +#endif +/*@==========================================================*/ + +#if (RTL8822C_SUPPORT || RTL8812F_SUPPORT) + /*@-------------------phydm_phystatus report --------------------*/ + struct phydm_physts dm_physts_table; #endif #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) #if (RT_PLATFORM != PLATFORM_LINUX) -}; /*DM_Dynamic_Mechanism_Structure*/ +} dm_struct; /*@DM_Dynamic_Mechanism_Structure*/ #else }; #endif -#else /*for AP,ADSL,CE Team*/ +#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), + PHYDM_LENOVO_OTA_SETTING_NBI_CSI = BIT(6), + +}; + +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_rf_content { - odm_radioa_txt = 0x1000, - odm_radiob_txt = 0x1001, - odm_radioc_txt = 0x1002, - odm_radiod_txt = 0x1003 -}; - enum odm_bb_config_type { CONFIG_BB_PHY_REG, CONFIG_BB_AGC_TAB, @@ -979,11 +1288,13 @@ enum odm_bb_config_type { CONFIG_BB_PHY_REG_PG, CONFIG_BB_PHY_REG_MP, CONFIG_BB_AGC_TAB_DIFF, + CONFIG_BB_RF_CAL_INIT, }; enum odm_rf_config_type { CONFIG_RF_RADIO, CONFIG_RF_TXPWR_LMT, + CONFIG_RF_SYN_RADIO, }; enum odm_fw_config_type { @@ -1010,327 +1321,112 @@ enum rt_status { RT_STATUS_NOT_SUPPORT, RT_STATUS_OS_API_FAILED, }; -#endif /*end of enum rt_status definition*/ +#endif /*@end of enum rt_status definition*/ -#ifdef REMOVE_PACK - #pragma pack() -#endif +void +phydm_watchdog_lps(struct dm_struct *dm); -/*===========================================================*/ -/*AGC RX High Power mode*/ -/*===========================================================*/ -#define lna_low_gain_1 0x64 -#define lna_low_gain_2 0x5A -#define lna_low_gain_3 0x58 +void +phydm_watchdog_lps_32k(struct dm_struct *dm); -#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 +void +phydm_txcurrentcalibration(struct dm_struct *dm); -enum dm_1r_cca_e { - CCA_1R = 0, - CCA_2R = 1, - CCA_MAX = 2, -}; +void +phydm_dm_early_init(struct dm_struct *dm); -enum dm_rf_e { - rf_save = 0, - rf_normal = 1, - RF_MAX = 2, -}; +void +odm_dm_init(struct dm_struct *dm); -/*check Sta pointer valid or not*/ +void +odm_dm_reset(struct dm_struct *dm); -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - #define IS_STA_VALID(p_sta) (p_sta && p_sta->expire_to) -#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) - #define IS_STA_VALID(p_sta) (p_sta && p_sta->bUsed) -#else - #define IS_STA_VALID(p_sta) (p_sta) -#endif +void +phydm_fwoffload_ability_init(struct dm_struct *dm, + enum phydm_offload_ability offload_ability); -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_AP)) +void +phydm_fwoffload_ability_clear(struct dm_struct *dm, + enum phydm_offload_ability offload_ability); -bool -odm_check_power_status( - struct _ADAPTER *adapter -); +void +phydm_supportability_en(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len); -#endif +void +phydm_pause_dm_watchdog(void *dm_void, enum phydm_pause_type pause_type); -u32 odm_convert_to_db(u32 value); +void +phydm_watchdog(struct dm_struct *dm); -u32 odm_convert_to_linear(u32 value); +void +phydm_watchdog_mp(struct dm_struct *dm); -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) +u8 +phydm_pause_func(void *dm_void, enum phydm_func_idx 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 *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len); + +void +odm_cmn_info_init(struct dm_struct *dm, enum odm_cmninfo cmn_info, u64 value); + +void +odm_cmn_info_hook(struct dm_struct *dm, enum odm_cmninfo cmn_info, void *value); + +void +odm_cmn_info_update(struct dm_struct *dm, u32 cmn_info, u64 value); u32 -get_psd_data( - struct PHY_DM_STRUCT *p_dm_odm, - unsigned int point, - u8 initial_gain_psd); +phydm_cmn_info_query(struct dm_struct *dm, enum phydm_info_query info_type); +void +odm_init_all_timers(struct dm_struct *dm); + +void +odm_cancel_all_timers(struct dm_struct *dm); + +void +odm_release_all_timers(struct dm_struct *dm); + +void * +phydm_get_structure(struct dm_struct *dm, u8 structure_type); + +void +phydm_dc_cancellation(struct dm_struct *dm); + +void +phydm_receiver_blocking(void *dm_void); + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +void +odm_init_all_work_items( + struct dm_struct *dm +); +void +odm_free_all_work_items( + struct dm_struct *dm +); +#endif /*@#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ + +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) +void +odm_dtc(struct dm_struct *dm); #endif -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -void -odm_dm_watchdog_lps( - struct PHY_DM_STRUCT *p_dm_odm -); -#endif - - -s32 -odm_pwdb_conversion( - s32 X, - u32 total_bit, - u32 decimal_bit -); - -s32 -odm_sign_conversion( - s32 value, - u32 total_bit -); - -void -odm_init_mp_driver_status( - struct PHY_DM_STRUCT *p_dm_odm -); - -void -phydm_txcurrentcalibration( - struct PHY_DM_STRUCT *p_dm_odm -); - - -void -phydm_seq_sorting( - void *p_dm_void, - u32 *p_value, - u32 *rank_idx, - u32 *p_idx_out, - u8 seq_length -); - -void -odm_dm_init( - struct PHY_DM_STRUCT *p_dm_odm -); - -void -odm_dm_reset( - struct PHY_DM_STRUCT *p_dm_odm -); - -void -phydm_support_ability_debug( - void *p_dm_void, - u32 *const dm_value, - u32 *_used, - char *output, - u32 *_out_len -); - -void -phydm_config_ofdm_rx_path( - struct PHY_DM_STRUCT *p_dm_odm, - u32 path -); - -void -phydm_config_trx_path( - void *p_dm_void, - u32 *const dm_value, - u32 *_used, - char *output, - u32 *_out_len -); - -void -odm_dm_watchdog( - struct PHY_DM_STRUCT *p_dm_odm -); - -void -phydm_watchdog_mp( - struct PHY_DM_STRUCT *p_dm_odm -); - -void -odm_cmn_info_init( - struct PHY_DM_STRUCT *p_dm_odm, - enum odm_cmninfo_e cmn_info, - u32 value -); - -void -odm_cmn_info_hook( - struct PHY_DM_STRUCT *p_dm_odm, - enum odm_cmninfo_e cmn_info, - void *p_value -); - -void -odm_cmn_info_ptr_array_hook( - struct PHY_DM_STRUCT *p_dm_odm, - enum odm_cmninfo_e cmn_info, - u16 index, - void *p_value -); - -void -odm_cmn_info_update( - struct PHY_DM_STRUCT *p_dm_odm, - u32 cmn_info, - u64 value -); - -u32 -phydm_cmn_info_query( - struct PHY_DM_STRUCT *p_dm_odm, - 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_odm + struct dm_struct *dm ); void odm_stop_all_threads( - struct PHY_DM_STRUCT *p_dm_odm + struct dm_struct *dm ); #endif -void -odm_init_all_timers( - struct PHY_DM_STRUCT *p_dm_odm -); - -void -odm_cancel_all_timers( - struct PHY_DM_STRUCT *p_dm_odm -); - -void -odm_release_all_timers( - struct PHY_DM_STRUCT *p_dm_odm -); - - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -void odm_init_all_work_items(struct PHY_DM_STRUCT *p_dm_odm); -void odm_free_all_work_items(struct PHY_DM_STRUCT *p_dm_odm); - -u64 -platform_division64( - u64 x, - u64 y -); - -#define dm_change_dynamic_init_gain_thresh odm_change_dynamic_init_gain_thresh - -enum dm_dig_connect_e { - DIG_STA_DISCONNECT = 0, - DIG_STA_CONNECT = 1, - DIG_STA_BEFORE_CONNECT = 2, - DIG_MULTI_STA_DISCONNECT = 3, - DIG_MULTI_STA_CONNECT = 4, - DIG_CONNECT_MAX -}; - -/*2012/01/12 MH Check afapter status. Temp fix BSOD.*/ - -#define HAL_ADAPTER_STS_CHK(p_dm_odm) do {\ - if (p_dm_odm->adapter == NULL) { \ - \ - return;\ - } \ - } while (0) - -#endif /*#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ - -void -odm_asoc_entry_init( - struct PHY_DM_STRUCT *p_dm_odm -); - - -void * -phydm_get_structure( - struct PHY_DM_STRUCT *p_dm_odm, - u8 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(__prx_status_desc) LE_BITS_TO_1BYTE(__prx_status_desc+12, 0, 6) - - #define REG_CONFIG_RAM64X16 0xb2c - - #define TARGET_CHNL_NUM_2G_5G 59 - - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - u8 get_right_chnl_place_for_iqk(u8 chnl); - #endif - - /* *********************************************************** */ #endif - -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - void odm_dtc(struct PHY_DM_STRUCT *p_dm_odm); -#endif /* #if (DM_ODM_SUPPORT_TYPE == ODM_CE) */ - - -void phydm_noisy_detection(struct PHY_DM_STRUCT *p_dm_odm); - - -#endif - -void -phydm_set_ext_switch( - void *p_dm_void, - u32 *const dm_value, - u32 *_used, - char *output, - u32 *_out_len -); - -void -phydm_api_debug( - void *p_dm_void, - u32 function_map, - u32 *const dm_value, - u32 *_used, - char *output, - u32 *_out_len -); - -u8 -phydm_nbi_setting( - void *p_dm_void, - u32 enable, - u32 channel, - u32 bw, - u32 f_interference, - u32 second_ch -); - -void -phydm_receiver_blocking( - void *p_dm_void -); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm.mk b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm.mk new file mode 100644 index 000000000000..1b5fb3e6bcfc --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm.mk @@ -0,0 +1,232 @@ +# SPDX-License-Identifier: GPL-2.0 +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_beamforming.o\ + hal/phydm/phydm_direct_bf.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/phydm_lna_sat.o\ + hal/phydm/phydm_pmac_tx_setting.o\ + hal/phydm/phydm_mp.o\ + hal/phydm/halrf/halrf.o\ + hal/phydm/halrf/halrf_debug.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\ + hal/phydm/halrf/halrf_psd.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/$(RTL871X)/phydm_rtl8703b.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_RTL8710B), y) +RTL871X = rtl8710b +_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8710b_bb.o\ + hal/phydm/$(RTL871X)/halhwimg8710b_mac.o\ + hal/phydm/$(RTL871X)/phydm_regconfig8710b.o\ + hal/phydm/$(RTL871X)/phydm_rtl8710b.o\ + hal/phydm/halrf/$(RTL871X)/halhwimg8710b_rf.o\ + hal/phydm/halrf/$(RTL871X)/halrf_8710b.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/halrf/$(RTL871X)/halrf_8822b.o \ + hal/phydm/$(RTL871X)/phydm_hal_api8822b.o \ + hal/phydm/halrf/$(RTL871X)/halhwimg8822b_rf.o \ + hal/phydm/halrf/$(RTL871X)/halrf_iqk_8822b.o \ + hal/phydm/halrf/$(RTL871X)/halrf_rfk_init_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)/phydm_hal_api8821c.o \ + hal/phydm/$(RTL871X)/phydm_regconfig8821c.o\ + hal/phydm/halrf/$(RTL871X)/halhwimg8821c_rf.o \ + hal/phydm/halrf/$(RTL871X)/halrf_8821c.o\ + hal/phydm/halrf/$(RTL871X)/halrf_iqk_8821c.o +endif +ifeq ($(CONFIG_RTL8192F), y) +RTL871X = rtl8192f +_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8192f_bb.o\ + hal/phydm/$(RTL871X)/halhwimg8192f_mac.o\ + hal/phydm/$(RTL871X)/phydm_hal_api8192f.o\ + hal/phydm/$(RTL871X)/phydm_regconfig8192f.o\ + hal/phydm/$(RTL871X)/phydm_rtl8192f.o\ + hal/phydm/halrf/$(RTL871X)/halhwimg8192f_rf.o\ + hal/phydm/halrf/$(RTL871X)/halrf_8192f.o +endif + +ifeq ($(CONFIG_RTL8198F), y) +RTL871X = rtl8198f +_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8198f_bb.o\ + hal/phydm/$(RTL871X)/halhwimg8198f_mac.o\ + hal/phydm/$(RTL871X)/phydm_hal_api8198f.o\ + hal/phydm/$(RTL871X)/phydm_regconfig8198f.o\ + hal/phydm/halrf/$(RTL871X)/halhwimg8198f_rf.o +endif + +ifeq ($(CONFIG_RTL8822C), y) +RTL871X = rtl8822c +_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8822c_bb.o\ + hal/phydm/$(RTL871X)/halhwimg8822c_mac.o\ + hal/phydm/$(RTL871X)/phydm_hal_api8822c.o\ + hal/phydm/$(RTL871X)/phydm_regconfig8822c.o\ + hal/phydm/halrf/$(RTL871X)/halrf_8822c.o\ + hal/phydm/halrf/$(RTL871X)/halrf_iqk_8822c.o\ + hal/phydm/halrf/$(RTL871X)/halrf_tssi_8822c.o\ + hal/phydm/halrf/$(RTL871X)/halrf_dpk_8822c.o\ + hal/phydm/halrf/$(RTL871X)/halrf_rfk_init_8822c.o\ + hal/phydm/halrf/$(RTL871X)/halhwimg8822c_rf.o +endif + +ifeq ($(CONFIG_RTL8814B), y) +RTL871X = rtl8814b +_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8814b_bb.o\ + hal/phydm/$(RTL871X)/halhwimg8814b_mac.o\ + hal/phydm/$(RTL871X)/phydm_hal_api8814b.o\ + hal/phydm/$(RTL871X)/phydm_regconfig8814b.o\ + hal/phydm/halrf/$(RTL871X)/halhwimg8814b_rf.o\ + hal/phydm/halrf/$(RTL871X)/halrf_8814b.o \ + hal/phydm/halrf/$(RTL871X)/halrf_iqk_8814b.o \ + hal/phydm/halrf/$(RTL871X)/halrf_dpk_8814b.o\ + hal/phydm/halrf/$(RTL871X)/halrf_rfk_init_8814b.o +endif \ No newline at end of file diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_acs.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_acs.c deleted file mode 100644 index b340123ef5c3..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_acs.c +++ /dev/null @@ -1,1154 +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" - - -u8 -odm_get_auto_channel_select_result( - void *p_dm_void, - u8 band -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ACS_ *p_acs = &p_dm_odm->dm_acs; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - if (band == ODM_BAND_2_4G) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("[struct _ACS_] odm_get_auto_channel_select_result(): clean_channel_2g(%d)\n", p_acs->clean_channel_2g)); - return (u8)p_acs->clean_channel_2g; - } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("[struct _ACS_] odm_get_auto_channel_select_result(): clean_channel_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_setting( - void *p_dm_void, - bool is_enable -) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u16 period = 0x2710;/* 40ms in default */ - u16 nhm_type = 0x7; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_auto_channel_select_setting()=========>\n")); - - if (is_enable) { - /* 20 ms */ - period = 0x1388; - nhm_type = 0x1; - } - - if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) { - /* PHY parameters initialize for ac series */ - odm_write_2byte(p_dm_odm, ODM_REG_CCX_PERIOD_11AC + 2, period); /* 0x990[31:16]=0x2710 Time duration for NHM unit: 4us, 0x2710=40ms */ - /* odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH9_TH10_11AC, BIT(8)|BIT9|BIT10, nhm_type); */ /* 0x994[9:8]=3 enable CCX */ - } else if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) { - /* PHY parameters initialize for n series */ - odm_write_2byte(p_dm_odm, ODM_REG_CCX_PERIOD_11N + 2, period); /* 0x894[31:16]=0x2710 Time duration for NHM unit: 4us, 0x2710=40ms */ - /* odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH9_TH10_11N, BIT(10)|BIT9|BIT8, nhm_type); */ /* 0x890[9:8]=3 enable CCX */ - } -#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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ACS_ *p_acs = &p_dm_odm->dm_acs; - u8 i; - - if (!(p_dm_odm->support_ability & ODM_BB_NHM_CNT)) - return; - - if (p_acs->is_force_acs_result) - return; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_auto_channel_select_init()=========>\n")); - - 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_odm->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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ACS_ *p_acs = &p_dm_odm->dm_acs; - - if (!(p_dm_odm->support_ability & ODM_BB_NHM_CNT)) - return; - - if (p_acs->is_force_acs_result) - return; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_auto_channel_select_reset()=========>\n")); - - odm_auto_channel_select_setting(p_dm_odm, true); /* for 20ms measurement */ - phydm_nhm_counter_statistics_reset(p_dm_odm); -#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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ACS_ *p_acs = &p_dm_odm->dm_acs; - u8 channel_idx = 0, search_idx = 0; - u16 max_score = 0; - - if (!(p_dm_odm->support_ability & ODM_BB_NHM_CNT)) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_auto_channel_select(): Return: support_ability ODM_BB_NHM_CNT is disabled\n")); - return; - } - - if (p_acs->is_force_acs_result) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_auto_channel_select(): Force 2G clean channel = %d, 5G clean channel = %d\n", - p_acs->clean_channel_2g, p_acs->clean_channel_5g)); - return; - } - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_auto_channel_select(): channel = %d=========>\n", channel)); - - phydm_get_nhm_counter_statistics(p_dm_odm); - odm_auto_channel_select_setting(p_dm_odm, false); - - 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) + (p_dm_odm->nhm_cnt_0 >> 2); - else - p_acs->channel_info_2g[0][channel_idx] = p_dm_odm->nhm_cnt_0; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_auto_channel_select(): nhm_cnt_0 = %d\n", p_dm_odm->nhm_cnt_0)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_auto_channel_select(): Channel_Info[0][%d] = %d, Channel_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) { - if (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; - } - } - } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("(1)odm_auto_channel_select(): 2G: clean_channel_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 -} - -#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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct rtl8192cd_priv *priv = p_dm_odm->priv; - struct _ACS_ *p_acs = &p_dm_odm->dm_acs; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_AutoChannelSelectSettingAP()=========>\n")); - - /* 3 Store Default setting */ - if (setting == STORE_DEFAULT_NHM_SETTING) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("STORE_DEFAULT_NHM_SETTING\n")); - - if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) { /* store reg0x990, reg0x994, reg0x998, reg0x99c, Reg0x9a0 */ - p_acs->reg0x990 = odm_read_4byte(p_dm_odm, ODM_REG_CCX_PERIOD_11AC); /* reg0x990 */ - p_acs->reg0x994 = odm_read_4byte(p_dm_odm, ODM_REG_NHM_TH9_TH10_11AC); /* reg0x994 */ - p_acs->reg0x998 = odm_read_4byte(p_dm_odm, ODM_REG_NHM_TH3_TO_TH0_11AC); /* reg0x998 */ - p_acs->reg0x99c = odm_read_4byte(p_dm_odm, ODM_REG_NHM_TH7_TO_TH4_11AC); /* Reg0x99c */ - p_acs->reg0x9a0 = odm_read_1byte(p_dm_odm, ODM_REG_NHM_TH8_11AC); /* Reg0x9a0, u8 */ - } else if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) { - p_acs->reg0x890 = odm_read_4byte(p_dm_odm, ODM_REG_NHM_TH9_TH10_11N); /* reg0x890 */ - p_acs->reg0x894 = odm_read_4byte(p_dm_odm, ODM_REG_CCX_PERIOD_11N); /* reg0x894 */ - p_acs->reg0x898 = odm_read_4byte(p_dm_odm, ODM_REG_NHM_TH3_TO_TH0_11N); /* reg0x898 */ - p_acs->reg0x89c = odm_read_4byte(p_dm_odm, ODM_REG_NHM_TH7_TO_TH4_11N); /* Reg0x89c */ - p_acs->reg0xe28 = odm_read_1byte(p_dm_odm, ODM_REG_NHM_TH8_11N); /* Reg0xe28, u8 */ - } - } - - /* 3 Restore Default setting */ - else if (setting == RESTORE_DEFAULT_NHM_SETTING) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("RESTORE_DEFAULT_NHM_SETTING\n")); - - if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) { /* store reg0x990, reg0x994, reg0x998, reg0x99c, Reg0x9a0 */ - odm_write_4byte(p_dm_odm, ODM_REG_CCX_PERIOD_11AC, p_acs->reg0x990); - odm_write_4byte(p_dm_odm, ODM_REG_NHM_TH9_TH10_11AC, p_acs->reg0x994); - odm_write_4byte(p_dm_odm, ODM_REG_NHM_TH3_TO_TH0_11AC, p_acs->reg0x998); - odm_write_4byte(p_dm_odm, ODM_REG_NHM_TH7_TO_TH4_11AC, p_acs->reg0x99c); - odm_write_1byte(p_dm_odm, ODM_REG_NHM_TH8_11AC, p_acs->reg0x9a0); - } else if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) { - odm_write_4byte(p_dm_odm, ODM_REG_NHM_TH9_TH10_11N, p_acs->reg0x890); - odm_write_4byte(p_dm_odm, ODM_REG_CCX_PERIOD_11AC, p_acs->reg0x894); - odm_write_4byte(p_dm_odm, ODM_REG_NHM_TH3_TO_TH0_11N, p_acs->reg0x898); - odm_write_4byte(p_dm_odm, ODM_REG_NHM_TH7_TO_TH4_11N, p_acs->reg0x89c); - odm_write_1byte(p_dm_odm, ODM_REG_NHM_TH8_11N, p_acs->reg0xe28); - } - } - - /* 3 struct _ACS_ setting */ - else if (setting == ACS_NHM_SETTING) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("ACS_NHM_SETTING\n")); - u16 period; - period = 0x61a8; - p_acs->acs_step = acs_step; - - if (p_dm_odm->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, 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, 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_odm, 0xc50, BIT(0) | BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) | BIT(6), 0x3E); - if (get_rf_mimo_mode(priv) != MIMO_1T1R) - odm_set_bb_reg(p_dm_odm, 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, ODM_REG_NHM_TH3_TO_TH0_11AC, 0x82786e64); - odm_write_4byte(p_dm_odm, ODM_REG_NHM_TH7_TO_TH4_11AC, 0xffffff8c); - odm_write_1byte(p_dm_odm, ODM_REG_NHM_TH8_11AC, 0xff); - odm_write_2byte(p_dm_odm, ODM_REG_NHM_TH9_TH10_11AC + 2, 0xffff); - - } else if (p_acs->acs_step == 1) { - /* 4 Set IGI */ - odm_set_bb_reg(p_dm_odm, 0xc50, BIT(0) | BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) | BIT(6), 0x2A); - if (get_rf_mimo_mode(priv) != MIMO_1T1R) - odm_set_bb_reg(p_dm_odm, 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, ODM_REG_NHM_TH3_TO_TH0_11AC, 0x5a50463c); - odm_write_4byte(p_dm_odm, ODM_REG_NHM_TH7_TO_TH4_11AC, 0xffffff64); - - } - - } else if (p_dm_odm->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, 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, 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_odm, 0xc50, BIT(0) | BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) | BIT(6), 0x3E); - if (get_rf_mimo_mode(priv) != MIMO_1T1R) - odm_set_bb_reg(p_dm_odm, 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, ODM_REG_NHM_TH3_TO_TH0_11N, 0x82786e64); - odm_write_4byte(p_dm_odm, ODM_REG_NHM_TH7_TO_TH4_11N, 0xffffff8c); - odm_write_1byte(p_dm_odm, ODM_REG_NHM_TH8_11N, 0xff); - odm_write_2byte(p_dm_odm, ODM_REG_NHM_TH9_TH10_11N + 2, 0xffff); - - } else if (p_acs->acs_step == 1) { - /* 4 Set IGI */ - odm_set_bb_reg(p_dm_odm, 0xc50, BIT(0) | BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) | BIT(6), 0x2A); - if (get_rf_mimo_mode(priv) != MIMO_1T1R) - odm_set_bb_reg(p_dm_odm, 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, ODM_REG_NHM_TH3_TO_TH0_11N, 0x5a50463c); - odm_write_4byte(p_dm_odm, 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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct rtl8192cd_priv *priv = p_dm_odm->priv; - struct _ACS_ *p_acs = &p_dm_odm->dm_acs; - u32 value32 = 0; - u8 i; - - p_acs->acs_step = acs_step; - - if (p_dm_odm->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_odm, REG_FPGA0_PSD_REPORT, BIT(17))) - break; - } - - /* 4 Get NHM Statistics */ - if (p_acs->acs_step == 1) { - - value32 = odm_read_4byte(p_dm_odm, 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, 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, ODM_REG_NHM_CNT_11N); /* ODM_REG_NHM_CNT3_TO_CNT0_11N */ - - p_acs->nhm_cnt[idx][4] = odm_read_1byte(p_dm_odm, 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_odm->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, ODM_REG_NHM_DUR_READY_11AC, BIT(16))) - break; - } - - if (p_acs->acs_step == 1) { - - value32 = odm_read_4byte(p_dm_odm, 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, 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, ODM_REG_NHM_CNT_11AC); /* ODM_REG_NHM_CNT3_TO_CNT0_11AC */ - - p_acs->nhm_cnt[idx][4] = odm_read_1byte(p_dm_odm, 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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ACS_ *p_acs = &p_dm_odm->dm_acs; - struct rtl8192cd_priv *priv = p_dm_odm->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_odm->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_odm->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_odm->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_odm->p_band_type == ODM_BAND_5G) - && (priv->pmib->dot11nConfigEntry.dot11nUse40M == HT_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 = HT_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_odm->p_band_type == ODM_BAND_5G) - && (priv->pmib->dot11nConfigEntry.dot11nUse40M == HT_CHANNEL_WIDTH_20_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 = HT_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_odm->p_band_type == ODM_BAND_2_4G) - && (priv->pmib->dot11nConfigEntry.dot11nUse40M == HT_CHANNEL_WIDTH_20_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 == 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; 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_odm->p_band_type == ODM_BAND_5G) { - if (priv->pmib->dot11nConfigEntry.dot11nUse40M == HT_CHANNEL_WIDTH_80) { - if (!is80MChannel(priv->available_chnl, priv->available_chnl_num, minChan)) { - - /* priv->pmib->dot11n_config_entry.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)) { - - /* priv->pmib->dot11n_config_entry.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 (*p_dm_odm->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/rtl8188eu/hal/phydm/phydm_acs.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_acs.h deleted file mode 100644 index fccbe84f10de..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_acs.h +++ /dev/null @@ -1,105 +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 __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_ { - bool 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 -); - -#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/rtl8188eu/hal/phydm/phydm_adaptivity.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_adaptivity.c index a5aff76534c9..bbe206392c05 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_adaptivity.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_adaptivity.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,19 +9,24 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ -/* ************************************************************ +/*@************************************************************ * include files - * ************************************************************ */ + ************************************************************/ #include "mp_precomp.h" #include "phydm_precomp.h" @@ -29,529 +35,233 @@ #include "PhyDM_Adaptivity.tmh" #endif #endif - - -void -phydm_check_adaptivity( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTIVITY_STATISTICS *adaptivity = (struct _ADAPTIVITY_STATISTICS *)phydm_get_structure(p_dm_odm, PHYDM_ADAPTIVITY); - - if (p_dm_odm->support_ability & ODM_BB_ADAPTIVITY) { +#ifdef PHYDM_SUPPORT_ADAPTIVITY #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - if (p_dm_odm->ap_total_num > adaptivity->ap_num_th) { - p_dm_odm->adaptivity_enable = false; - p_dm_odm->adaptivity_flag = false; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("AP total num > %d!!, disable adaptivity\n", adaptivity->ap_num_th)); - } else -#endif - { - if (adaptivity->dynamic_link_adaptivity || adaptivity->acs_for_adaptivity) { - if (p_dm_odm->is_linked && adaptivity->is_check == false) { - phydm_nhm_counter_statistics(p_dm_odm); - phydm_check_environment(p_dm_odm); - } else if (!p_dm_odm->is_linked) - adaptivity->is_check = false; - } else { - p_dm_odm->adaptivity_enable = true; +boolean +phydm_check_channel_plan(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_adaptivity_struct *adapt = &dm->adaptivity; + void *adapter = dm->adapter; + PMGNT_INFO mgnt_info = &((PADAPTER)adapter)->MgntInfo; - if (p_dm_odm->support_ic_type & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA)) - p_dm_odm->adaptivity_flag = false; - else - p_dm_odm->adaptivity_flag = true; - } + if (mgnt_info->RegEnableAdaptivity != 2) + return false; + + if (!dm->carrier_sense_enable) { /*@check domain Code for adaptivity or CarrierSense*/ + if ((*dm->band_type == ODM_BAND_5G) && + !(adapt->regulation_5g == REGULATION_ETSI || adapt->regulation_5g == REGULATION_WW)) { + PHYDM_DBG(dm, DBG_ADPTVTY, + "adaptivity skip 5G domain code : %d\n", + adapt->regulation_5g); + return true; + } else if ((*dm->band_type == ODM_BAND_2_4G) && + !(adapt->regulation_2g == REGULATION_ETSI || adapt->regulation_2g == REGULATION_WW)) { + PHYDM_DBG(dm, DBG_ADPTVTY, + "adaptivity skip 2.4G domain code : %d\n", + adapt->regulation_2g); + return true; + } else if ((*dm->band_type != ODM_BAND_2_4G) && (*dm->band_type != ODM_BAND_5G)) { + PHYDM_DBG(dm, DBG_ADPTVTY, + "adaptivity neither 2G nor 5G band, return\n"); + return true; } } else { - p_dm_odm->adaptivity_enable = false; - p_dm_odm->adaptivity_flag = false; - } - - - -} - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -bool -phydm_check_channel_plan( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTER *p_adapter = p_dm_odm->adapter; - PMGNT_INFO p_mgnt_info = &(p_adapter->MgntInfo); - - if (p_mgnt_info->RegEnableAdaptivity == 2) { - if (p_dm_odm->carrier_sense_enable == false) { /*check domain Code for adaptivity or CarrierSense*/ - if ((*p_dm_odm->p_band_type == ODM_BAND_5G) && - !(p_dm_odm->odm_regulation_5g == REGULATION_ETSI || p_dm_odm->odm_regulation_5g == REGULATION_WW)) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("adaptivity skip 5G domain code : %d\n", p_dm_odm->odm_regulation_5g)); - p_dm_odm->adaptivity_enable = false; - p_dm_odm->adaptivity_flag = false; - return true; - } else if ((*p_dm_odm->p_band_type == ODM_BAND_2_4G) && - !(p_dm_odm->odm_regulation_2_4g == REGULATION_ETSI || p_dm_odm->odm_regulation_2_4g == REGULATION_WW)) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("adaptivity skip 2.4G domain code : %d\n", p_dm_odm->odm_regulation_2_4g)); - p_dm_odm->adaptivity_enable = false; - p_dm_odm->adaptivity_flag = false; - return true; - - } else if ((*p_dm_odm->p_band_type != ODM_BAND_2_4G) && (*p_dm_odm->p_band_type != ODM_BAND_5G)) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("adaptivity neither 2G nor 5G band, return\n")); - p_dm_odm->adaptivity_enable = false; - p_dm_odm->adaptivity_flag = false; - return true; - } - } else { - if ((*p_dm_odm->p_band_type == ODM_BAND_5G) && - !(p_dm_odm->odm_regulation_5g == REGULATION_MKK || p_dm_odm->odm_regulation_5g == REGULATION_WW)) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("CarrierSense skip 5G domain code : %d\n", p_dm_odm->odm_regulation_5g)); - p_dm_odm->adaptivity_enable = false; - p_dm_odm->adaptivity_flag = false; - return true; - } - - else if ((*p_dm_odm->p_band_type == ODM_BAND_2_4G) && - !(p_dm_odm->odm_regulation_2_4g == REGULATION_MKK || p_dm_odm->odm_regulation_2_4g == REGULATION_WW)) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("CarrierSense skip 2.4G domain code : %d\n", p_dm_odm->odm_regulation_2_4g)); - p_dm_odm->adaptivity_enable = false; - p_dm_odm->adaptivity_flag = false; - return true; - - } else if ((*p_dm_odm->p_band_type != ODM_BAND_2_4G) && (*p_dm_odm->p_band_type != ODM_BAND_5G)) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("CarrierSense neither 2G nor 5G band, return\n")); - p_dm_odm->adaptivity_enable = false; - p_dm_odm->adaptivity_flag = false; - return true; - } + if ((*dm->band_type == ODM_BAND_5G) && + !(adapt->regulation_5g == REGULATION_MKK || adapt->regulation_5g == REGULATION_WW)) { + PHYDM_DBG(dm, DBG_ADPTVTY, + "CarrierSense skip 5G domain code : %d\n", + adapt->regulation_5g); + return true; + } else if ((*dm->band_type == ODM_BAND_2_4G) && + !(adapt->regulation_2g == REGULATION_MKK || adapt->regulation_2g == REGULATION_WW)) { + PHYDM_DBG(dm, DBG_ADPTVTY, + "CarrierSense skip 2.4G domain code : %d\n", + adapt->regulation_2g); + return true; + } else if ((*dm->band_type != ODM_BAND_2_4G) && (*dm->band_type != ODM_BAND_5G)) { + PHYDM_DBG(dm, DBG_ADPTVTY, + "CarrierSense neither 2G nor 5G band, return\n"); + return true; } } return false; - -} -#endif - -void -phydm_nhm_counter_statistics_init( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - - if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) { - /*PHY parameters initialize for n series*/ - odm_write_2byte(p_dm_odm, ODM_REG_CCX_PERIOD_11N + 2, 0xC350); /*0x894[31:16]=0x0xC350 Time duration for NHM unit: us, 0xc350=200ms*/ - odm_write_2byte(p_dm_odm, ODM_REG_NHM_TH9_TH10_11N + 2, 0xffff); /*0x890[31:16]=0xffff th_9, th_10*/ - odm_write_4byte(p_dm_odm, ODM_REG_NHM_TH3_TO_TH0_11N, 0xffffff50); /*0x898=0xffffff52 th_3, th_2, th_1, th_0*/ - odm_write_4byte(p_dm_odm, ODM_REG_NHM_TH7_TO_TH4_11N, 0xffffffff); /*0x89c=0xffffffff th_7, th_6, th_5, th_4*/ - odm_set_bb_reg(p_dm_odm, ODM_REG_FPGA0_IQK_11N, MASKBYTE0, 0xff); /*0xe28[7:0]=0xff th_8*/ - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH9_TH10_11N, BIT(10) | BIT9 | BIT8, 0x1); /*0x890[10:8]=1 ignoreCCA ignore PHYTXON enable CCX*/ - odm_set_bb_reg(p_dm_odm, ODM_REG_OFDM_FA_RSTC_11N, BIT(7), 0x1); /*0xc0c[7]=1 max power among all RX ants*/ - } -#if (RTL8195A_SUPPORT == 0) - else if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) { - /*PHY parameters initialize for ac series*/ - odm_write_2byte(p_dm_odm, ODM_REG_CCX_PERIOD_11AC + 2, 0xC350); /*0x990[31:16]=0xC350 Time duration for NHM unit: us, 0xc350=200ms*/ - odm_write_2byte(p_dm_odm, ODM_REG_NHM_TH9_TH10_11AC + 2, 0xffff); /*0x994[31:16]=0xffff th_9, th_10*/ - odm_write_4byte(p_dm_odm, ODM_REG_NHM_TH3_TO_TH0_11AC, 0xffffff50); /*0x998=0xffffff52 th_3, th_2, th_1, th_0*/ - odm_write_4byte(p_dm_odm, ODM_REG_NHM_TH7_TO_TH4_11AC, 0xffffffff); /*0x99c=0xffffffff th_7, th_6, th_5, th_4*/ - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH8_11AC, MASKBYTE0, 0xff); /*0x9a0[7:0]=0xff th_8*/ - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH9_TH10_11AC, BIT(8) | BIT9 | BIT10, 0x1); /*0x994[10:8]=1 ignoreCCA ignore PHYTXON enable CCX*/ - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_9E8_11AC, BIT(0), 0x1); /*0x9e8[7]=1 max power among all RX ants*/ - - } -#endif } -void -phydm_nhm_counter_statistics( - void *p_dm_void -) +boolean +phydm_soft_ap_special_set(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_adaptivity_struct *adapt = &dm->adaptivity; + u8 disable_ap_adapt_setting = false; - if (!(p_dm_odm->support_ability & ODM_BB_NHM_CNT)) - return; - - /*Get NHM report*/ - phydm_get_nhm_counter_statistics(p_dm_odm); - - /*Reset NHM counter*/ - phydm_nhm_counter_statistics_reset(p_dm_odm); -} - -void -phydm_get_nhm_counter_statistics( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u32 value32 = 0; -#if (RTL8195A_SUPPORT == 0) - if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) - value32 = odm_get_bb_reg(p_dm_odm, ODM_REG_NHM_CNT_11AC, MASKDWORD); - else if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) -#endif - value32 = odm_get_bb_reg(p_dm_odm, ODM_REG_NHM_CNT_11N, MASKDWORD); - - p_dm_odm->nhm_cnt_0 = (u8)(value32 & MASKBYTE0); - p_dm_odm->nhm_cnt_1 = (u8)((value32 & MASKBYTE1) >> 8); - -} - -void -phydm_nhm_counter_statistics_reset( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - - if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) { - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH9_TH10_11N, BIT(1), 0); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH9_TH10_11N, BIT(1), 1); - } -#if (RTL8195A_SUPPORT == 0) - else if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) { - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH9_TH10_11AC, BIT(1), 0); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH9_TH10_11AC, BIT(1), 1); - } - -#endif - -} - -void -phydm_set_edcca_threshold( - void *p_dm_void, - s8 H2L, - s8 L2H -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - - if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_ECCA_THRESHOLD, MASKBYTE2 | MASKBYTE0, (u32)((u8)L2H | (u8)H2L << 16)); -#if (RTL8195A_SUPPORT == 0) - else if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) - odm_set_bb_reg(p_dm_odm, 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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - - if (p_dm_odm->support_ic_type & (ODM_RTL8188E | ODM_RTL8192E)) { - if (type == phydm_disable_lna) { - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x0000f); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0x37f82); /*disable LNA*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); - if (p_dm_odm->rf_type > ODM_1T1R) { - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x1); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0x30, 0xfffff, 0x18000); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0x31, 0xfffff, 0x0000f); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0x32, 0xfffff, 0x37f82); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x0); - } - } else if (type == phydm_enable_lna) { - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x0000f); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0x77f82); /*back to normal*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); - if (p_dm_odm->rf_type > ODM_1T1R) { - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x1); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0x30, 0xfffff, 0x18000); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0x31, 0xfffff, 0x0000f); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0x32, 0xfffff, 0x77f82); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x0); - } - } - } else if (p_dm_odm->support_ic_type & ODM_RTL8723B) { - if (type == phydm_disable_lna) { - /*S0*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x0001f); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0xe6137); /*disable LNA*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); - /*S1*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0xed, 0x00020, 0x1); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x43, 0xfffff, 0x3008d); /*select Rx mode and disable LNA*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0xed, 0x00020, 0x0); - } else if (type == phydm_enable_lna) { - /*S0*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x0001f); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0xe6177); /*disable LNA*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); - /*S1*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0xed, 0x00020, 0x1); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x43, 0xfffff, 0x300bd); /*select Rx mode and disable LNA*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0xed, 0x00020, 0x0); - } - - } else if (p_dm_odm->support_ic_type & ODM_RTL8812) { - if (type == phydm_disable_lna) { - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x3f7ff); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0xc22bf); /*disable LNA*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); - if (p_dm_odm->rf_type > ODM_1T1R) { - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x1); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0x31, 0xfffff, 0x3f7ff); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0x32, 0xfffff, 0xc22bf); /*disable LNA*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x0); - } - } else if (type == phydm_enable_lna) { - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x3f7ff); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0xc26bf); /*disable LNA*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); - if (p_dm_odm->rf_type > ODM_1T1R) { - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x1); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0x31, 0xfffff, 0x3f7ff); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0x32, 0xfffff, 0xc26bf); /*disable LNA*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x0); - } - } - } else if (p_dm_odm->support_ic_type & (ODM_RTL8821 | ODM_RTL8881A)) { - if (type == phydm_disable_lna) { - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x0002f); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0xfb09b); /*disable LNA*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); - } else if (type == phydm_enable_lna) { - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x0002f); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0xfb0bb); /*disable LNA*/ - odm_set_rf_reg(p_dm_odm, ODM_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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - - if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) { - odm_set_bb_reg(p_dm_odm, ODM_REG_CCK_RPT_FORMAT_11N, BIT(3) | BIT2 | BIT1, tx_mode); /*set TXmod to standby mode to remove outside noise affect*/ - odm_set_bb_reg(p_dm_odm, ODM_REG_CCK_RPT_FORMAT_11N, BIT(22) | BIT21 | BIT20, rx_mode); /*set RXmod to standby mode to remove outside noise affect*/ - if (p_dm_odm->rf_type > ODM_1T1R) { - odm_set_bb_reg(p_dm_odm, ODM_REG_CCK_RPT_FORMAT_11N_B, BIT(3) | BIT2 | BIT1, tx_mode); /*set TXmod to standby mode to remove outside noise affect*/ - odm_set_bb_reg(p_dm_odm, ODM_REG_CCK_RPT_FORMAT_11N_B, BIT(22) | BIT21 | BIT20, rx_mode); /*set RXmod to standby mode to remove outside noise affect*/ - } - } -#if (RTL8195A_SUPPORT == 0) - else if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) { - odm_set_bb_reg(p_dm_odm, ODM_REG_TRMUX_11AC, BIT(11) | BIT10 | BIT9 | BIT8, tx_mode); /*set TXmod to standby mode to remove outside noise affect*/ - odm_set_bb_reg(p_dm_odm, ODM_REG_TRMUX_11AC, BIT(7) | BIT6 | BIT5 | BIT4, rx_mode); /*set RXmod to standby mode to remove outside noise affect*/ - if (p_dm_odm->rf_type > ODM_1T1R) { - odm_set_bb_reg(p_dm_odm, ODM_REG_TRMUX_11AC_B, BIT(11) | BIT10 | BIT9 | BIT8, tx_mode); /*set TXmod to standby mode to remove outside noise affect*/ - odm_set_bb_reg(p_dm_odm, ODM_REG_TRMUX_11AC_B, BIT(7) | BIT6 | BIT5 | BIT4, 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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - if (state == phydm_ignore_edcca) { - odm_set_mac_reg(p_dm_odm, REG_TX_PTCL_CTRL, BIT(15), 1); /*ignore EDCCA reg520[15]=1*/ - /* odm_set_mac_reg(p_dm_odm, REG_RD_CTRL, BIT(11), 0); */ /*reg524[11]=0*/ - } else { /*don't set MAC ignore EDCCA signal*/ - odm_set_mac_reg(p_dm_odm, REG_TX_PTCL_CTRL, BIT(15), 0); /*don't ignore EDCCA reg520[15]=0*/ - /* odm_set_mac_reg(p_dm_odm, REG_RD_CTRL, BIT(11), 1); */ /*reg524[11]=1 */ - } - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("EDCCA enable state = %d\n", state)); - -} - -bool -phydm_cal_nhm_cnt( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u16 base = 0; - - base = p_dm_odm->nhm_cnt_0 + p_dm_odm->nhm_cnt_1; - - if (base != 0) { - p_dm_odm->nhm_cnt_0 = ((p_dm_odm->nhm_cnt_0) << 8) / base; - p_dm_odm->nhm_cnt_1 = ((p_dm_odm->nhm_cnt_1) << 8) / base; - } - if ((p_dm_odm->nhm_cnt_0 - p_dm_odm->nhm_cnt_1) >= 100) - return true; /*clean environment*/ - else - return false; /*noisy environment*/ - -} - - -void -phydm_check_environment( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTIVITY_STATISTICS *adaptivity = (struct _ADAPTIVITY_STATISTICS *)phydm_get_structure(p_dm_odm, PHYDM_ADAPTIVITY); - bool is_clean_environment = false; -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct rtl8192cd_priv *priv = p_dm_odm->priv; -#endif - - if (adaptivity->is_first_link == true) { - if (p_dm_odm->support_ic_type & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA)) - p_dm_odm->adaptivity_flag = false; + if (dm->soft_ap_mode != NULL) { + if (*dm->soft_ap_mode != 0 && + (dm->soft_ap_special_setting & BIT(0))) + disable_ap_adapt_setting = true; else - p_dm_odm->adaptivity_flag = true; - - adaptivity->is_first_link = false; - return; - } else { - if (adaptivity->nhm_wait < 3) { /*Start enter NHM after 4 nhm_wait*/ - adaptivity->nhm_wait++; - phydm_nhm_counter_statistics(p_dm_odm); - return; - } else { - phydm_nhm_counter_statistics(p_dm_odm); - is_clean_environment = phydm_cal_nhm_cnt(p_dm_odm); - if (is_clean_environment == true) { - p_dm_odm->th_l2h_ini = adaptivity->th_l2h_ini_backup; /*adaptivity mode*/ - p_dm_odm->th_edcca_hl_diff = adaptivity->th_edcca_hl_diff_backup; - - p_dm_odm->adaptivity_enable = true; - - if (p_dm_odm->support_ic_type & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA)) - p_dm_odm->adaptivity_flag = false; - else - p_dm_odm->adaptivity_flag = true; -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - priv->pshare->rf_ft_var.is_clean_environment = true; -#endif - } else { - if (!adaptivity->acs_for_adaptivity) { - p_dm_odm->th_l2h_ini = p_dm_odm->th_l2h_ini_mode2; /*mode2*/ - p_dm_odm->th_edcca_hl_diff = p_dm_odm->th_edcca_hl_diff_mode2; - - p_dm_odm->adaptivity_flag = false; - p_dm_odm->adaptivity_enable = false; - } -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - priv->pshare->rf_ft_var.is_clean_environment = false; -#endif - } - adaptivity->nhm_wait = 0; - adaptivity->is_first_link = true; - adaptivity->is_check = true; - } - + disable_ap_adapt_setting = false; + PHYDM_DBG(dm, DBG_ADPTVTY, + "soft_ap_setting = %x, soft_ap = %d, dis_ap_adapt = %d\n", + dm->soft_ap_special_setting, *dm->soft_ap_mode, + disable_ap_adapt_setting); } - + return disable_ap_adapt_setting; } -void -phydm_search_pwdb_lower_bound( - void *p_dm_void -) +boolean +phydm_ap_num_check(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTIVITY_STATISTICS *adaptivity = (struct _ADAPTIVITY_STATISTICS *)phydm_get_structure(p_dm_odm, PHYDM_ADAPTIVITY); - u32 value32 = 0, reg_value32 = 0; - u8 cnt, try_count = 0; - u8 tx_edcca1 = 0, tx_edcca0 = 0; - bool is_adjust = true; - s8 th_l2h_dmc, th_h2l_dmc, igi_target = 0x32; - s8 diff; - u8 IGI = adaptivity->igi_base + 30 + (u8)p_dm_odm->th_l2h_ini - (u8)p_dm_odm->th_edcca_hl_diff; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_adaptivity_struct *adapt = &dm->adaptivity; + boolean dis_adapt = false; - if (p_dm_odm->support_ic_type & (ODM_RTL8723B | ODM_RTL8188E | ODM_RTL8192E | ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8881A)) - phydm_set_lna(p_dm_odm, phydm_disable_lna); - else { - phydm_set_trx_mux(p_dm_odm, phydm_standby_mode, phydm_standby_mode); - odm_pause_dig(p_dm_odm, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_0, 0x7e); + if (dm->ap_total_num > adapt->ap_num_th) { + dis_adapt = true; + PHYDM_DBG(dm, DBG_ADPTVTY, "AP total num > %d, disable adapt\n", + adapt->ap_num_th); + } else { + dis_adapt = false; + } + return dis_adapt; +} +#endif + +void phydm_dig_up_bound_lmt_en(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_adaptivity_struct *adapt = &dm->adaptivity; + + if (!(dm->support_ability & ODM_BB_ADAPTIVITY) || + !dm->is_linked || + !adapt->is_adapt_en) { + adapt->igi_up_bound_lmt_cnt = 0; + adapt->igi_lmt_en = false; + return; } - diff = igi_target - (s8)IGI; - th_l2h_dmc = p_dm_odm->th_l2h_ini + diff; + if (dm->total_tp > 1) { + adapt->igi_lmt_en = true; + adapt->igi_up_bound_lmt_cnt = adapt->igi_up_bound_lmt_val; + PHYDM_DBG(dm, DBG_ADPTVTY, + "TP >1, Start limit IGI upper bound\n"); + } else { + if (adapt->igi_up_bound_lmt_cnt == 0) + adapt->igi_lmt_en = false; + else + adapt->igi_up_bound_lmt_cnt--; + } + + PHYDM_DBG(dm, DBG_ADPTVTY, "IGI_lmt_cnt = %d\n", + adapt->igi_up_bound_lmt_cnt); +} + +void phydm_check_adaptivity(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_adaptivity_struct *adapt = &dm->adaptivity; + + if (!(dm->support_ability & ODM_BB_ADAPTIVITY)) { + adapt->is_adapt_en = false; + PHYDM_DBG(dm, DBG_ADPTVTY, "adaptivity disable\n"); + return; + } + + adapt->is_adapt_en = true; +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + if (phydm_check_channel_plan(dm) || + phydm_ap_num_check(dm) || + phydm_soft_ap_special_set(dm)) + adapt->is_adapt_en = false; +#endif +} + +void phydm_set_edcca_threshold(void *dm_void, s8 H2L, s8 L2H) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + odm_set_bb_reg(dm, R_0x84c, MASKBYTE2, (u8)L2H + 0x80); + odm_set_bb_reg(dm, R_0x84c, MASKBYTE3, (u8)H2L + 0x80); + } else if (dm->support_ic_type & ODM_IC_11N_SERIES) { + odm_set_bb_reg(dm, R_0xc4c, MASKBYTE0, (u8)L2H); + odm_set_bb_reg(dm, R_0xc4c, MASKBYTE2, (u8)H2L); + } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + odm_set_bb_reg(dm, R_0x8a4, MASKBYTE0, (u8)L2H); + odm_set_bb_reg(dm, R_0x8a4, MASKBYTE1, (u8)H2L); + } +} + +void phydm_mac_edcca_state(void *dm_void, enum phydm_mac_edcca_type state) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (state == PHYDM_IGNORE_EDCCA) { + odm_set_mac_reg(dm, R_0x520, BIT(15), 1); /*@ignore EDCCA*/ +#if 0 + /*odm_set_mac_reg(dm, REG_RD_CTRL, BIT(11), 0);*/ +#endif + } else { /*@don't set MAC ignore EDCCA signal*/ + odm_set_mac_reg(dm, R_0x520, BIT(15), 0); /*@don't ignore EDCCA*/ +#if 0 + /*odm_set_mac_reg(dm, REG_RD_CTRL, BIT(11), 1);*/ +#endif + } + PHYDM_DBG(dm, DBG_ADPTVTY, "EDCCA enable state = %d\n", state); +} + +void phydm_search_pwdb_lower_bound(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_adaptivity_struct *adapt = &dm->adaptivity; + u32 value32 = 0, reg_value32 = 0; + u8 cnt = 0, try_count = 0; + u8 tx_edcca1 = 0; + boolean is_adjust = true; + s8 th_l2h_dmc, th_h2l_dmc, igi_target = 0x32; + s8 diff = 0; + s8 IGI = adapt->igi_base + 30 + dm->th_l2h_ini - dm->th_edcca_hl_diff; + + halrf_rf_lna_setting(dm, HALRF_LNA_DISABLE); + diff = igi_target - IGI; + th_l2h_dmc = dm->th_l2h_ini + diff; if (th_l2h_dmc > 10) th_l2h_dmc = 10; - th_h2l_dmc = th_l2h_dmc - p_dm_odm->th_edcca_hl_diff; - phydm_set_edcca_threshold(p_dm_odm, th_h2l_dmc, th_l2h_dmc); + th_h2l_dmc = th_l2h_dmc - dm->th_edcca_hl_diff; + phydm_set_edcca_threshold(dm, th_h2l_dmc, th_l2h_dmc); ODM_delay_ms(30); while (is_adjust) { - if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) { - odm_set_bb_reg(p_dm_odm, ODM_REG_DBG_RPT_11N, MASKDWORD, 0x0); - reg_value32 = odm_get_bb_reg(p_dm_odm, ODM_REG_RPT_11N, MASKDWORD); - } -#if (RTL8195A_SUPPORT == 0) - else if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) { - odm_set_bb_reg(p_dm_odm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0x0); - reg_value32 = odm_get_bb_reg(p_dm_odm, ODM_REG_RPT_11AC, MASKDWORD); - } -#endif - while (reg_value32 & BIT(3) && try_count < 3) { - try_count = try_count + 1; - ODM_delay_ms(3); - if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) - reg_value32 = odm_get_bb_reg(p_dm_odm, ODM_REG_RPT_11N, MASKDWORD); -#if (RTL8195A_SUPPORT == 0) - else if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) - reg_value32 = odm_get_bb_reg(p_dm_odm, ODM_REG_RPT_11AC, MASKDWORD); -#endif - } - try_count = 0; + /*@check CCA status*/ + /*set debug port to 0x0*/ + if (phydm_set_bb_dbg_port(dm, DBGPORT_PRI_1, 0x0)) { + reg_value32 = phydm_get_bb_dbg_port_val(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_val(dm); + } + phydm_release_bb_dbg_port(dm); + try_count = 0; + } + + /*@count EDCCA signal = 1 times*/ for (cnt = 0; cnt < 20; cnt++) { - if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) { - odm_set_bb_reg(p_dm_odm, ODM_REG_DBG_RPT_11N, MASKDWORD, 0x208); - value32 = odm_get_bb_reg(p_dm_odm, ODM_REG_RPT_11N, MASKDWORD); + if (phydm_set_bb_dbg_port(dm, DBGPORT_PRI_1, + adapt->adaptivity_dbg_port)) { + value32 = phydm_get_bb_dbg_port_val(dm); + phydm_release_bb_dbg_port(dm); } -#if (RTL8195A_SUPPORT == 0) - else if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) { - odm_set_bb_reg(p_dm_odm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0x209); - value32 = odm_get_bb_reg(p_dm_odm, ODM_REG_RPT_11AC, MASKDWORD); - } -#endif - if (value32 & BIT(30) && (p_dm_odm->support_ic_type & (ODM_RTL8723B | ODM_RTL8188E))) + + if (value32 & BIT(30) && dm->support_ic_type & + (ODM_RTL8723B | ODM_RTL8188E)) tx_edcca1 = tx_edcca1 + 1; else if (value32 & BIT(29)) tx_edcca1 = tx_edcca1 + 1; - else - tx_edcca0 = tx_edcca0 + 1; } if (tx_edcca1 > 1) { @@ -559,560 +269,245 @@ phydm_search_pwdb_lower_bound( th_l2h_dmc = th_l2h_dmc + 1; if (th_l2h_dmc > 10) th_l2h_dmc = 10; - th_h2l_dmc = th_l2h_dmc - p_dm_odm->th_edcca_hl_diff; - - phydm_set_edcca_threshold(p_dm_odm, th_h2l_dmc, th_l2h_dmc); - if (th_l2h_dmc == 10) { - is_adjust = false; - adaptivity->h2l_lb = th_h2l_dmc; - adaptivity->l2h_lb = th_l2h_dmc; - p_dm_odm->adaptivity_igi_upper = IGI; - } + th_h2l_dmc = th_l2h_dmc - dm->th_edcca_hl_diff; + phydm_set_edcca_threshold(dm, th_h2l_dmc, th_l2h_dmc); tx_edcca1 = 0; - tx_edcca0 = 0; + if (th_l2h_dmc == 10) + is_adjust = false; } else { is_adjust = false; - adaptivity->h2l_lb = th_h2l_dmc; - adaptivity->l2h_lb = th_l2h_dmc; - p_dm_odm->adaptivity_igi_upper = IGI; - tx_edcca1 = 0; - tx_edcca0 = 0; } } - p_dm_odm->adaptivity_igi_upper = p_dm_odm->adaptivity_igi_upper - p_dm_odm->dc_backoff; - adaptivity->h2l_lb = adaptivity->h2l_lb + p_dm_odm->dc_backoff; - adaptivity->l2h_lb = adaptivity->l2h_lb + p_dm_odm->dc_backoff; + adapt->adapt_igi_up = IGI - ADAPT_DC_BACKOFF; + adapt->h2l_lb = th_h2l_dmc + ADAPT_DC_BACKOFF; + adapt->l2h_lb = th_l2h_dmc + ADAPT_DC_BACKOFF; - if (p_dm_odm->support_ic_type & (ODM_RTL8723B | ODM_RTL8188E | ODM_RTL8192E | ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8881A)) - phydm_set_lna(p_dm_odm, phydm_enable_lna); - else { - phydm_set_trx_mux(p_dm_odm, phydm_tx_mode, phydm_rx_mode); - odm_pause_dig(p_dm_odm, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_0, NONE); - } - - phydm_set_edcca_threshold(p_dm_odm, 0x7f, 0x7f); /*resume to no link state*/ + halrf_rf_lna_setting(dm, HALRF_LNA_ENABLE); + phydm_set_edcca_threshold(dm, 0x7f, 0x7f); /*resume to no link state*/ } -bool -phydm_re_search_condition( - void *p_dm_void -) +boolean +phydm_re_search_condition(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - /*struct _ADAPTIVITY_STATISTICS* adaptivity = (struct _ADAPTIVITY_STATISTICS*)phydm_get_structure(p_dm_odm, PHYDM_ADAPTIVITY);*/ - u8 adaptivity_igi_upper; - u8 count = 0; - /*s8 TH_L2H_dmc, IGI_target = 0x32;*/ - /*s8 diff;*/ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_adaptivity_struct *adaptivity = &dm->adaptivity; + u8 adaptivity_igi_upper = adaptivity->adapt_igi_up + ADAPT_DC_BACKOFF; - adaptivity_igi_upper = p_dm_odm->adaptivity_igi_upper + p_dm_odm->dc_backoff; - - /*TH_L2H_dmc = 10;*/ - - /*diff = TH_L2H_dmc - p_dm_odm->TH_L2H_ini;*/ - /*lowest_IGI_upper = IGI_target - diff;*/ - - /*if ((adaptivity_igi_upper - lowest_IGI_upper) <= 5)*/ - if (adaptivity_igi_upper <= 0x26 && count < 3) { - count = count + 1; + 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 -) +void phydm_set_l2h_th_ini(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTIVITY_STATISTICS *adaptivity = (struct _ADAPTIVITY_STATISTICS *)phydm_get_structure(p_dm_odm, PHYDM_ADAPTIVITY); + struct dm_struct *dm = (struct dm_struct *)dm_void; - switch (cmn_info) { - case PHYDM_ADAPINFO_CARRIER_SENSE_ENABLE: - p_dm_odm->carrier_sense_enable = (bool)value; - break; - - case PHYDM_ADAPINFO_DCBACKOFF: - p_dm_odm->dc_backoff = (u8)value; - break; - - case PHYDM_ADAPINFO_DYNAMICLINKADAPTIVITY: - adaptivity->dynamic_link_adaptivity = (bool)value; - break; - - case PHYDM_ADAPINFO_TH_L2H_INI: - p_dm_odm->th_l2h_ini = (s8)value; - break; - - case PHYDM_ADAPINFO_TH_EDCCA_HL_DIFF: - p_dm_odm->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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTIVITY_STATISTICS *adaptivity = (struct _ADAPTIVITY_STATISTICS *)phydm_get_structure(p_dm_odm, PHYDM_ADAPTIVITY); - s8 igi_target = 0x32; - /*struct _dynamic_initial_gain_threshold_* p_dm_dig_table = &p_dm_odm->dm_dig_table;*/ - -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_WIN)) - - if (p_dm_odm->carrier_sense_enable == false) { - if (p_dm_odm->th_l2h_ini == 0) - p_dm_odm->th_l2h_ini = 0xf5; - } else - p_dm_odm->th_l2h_ini = 0xa; - - if (p_dm_odm->th_edcca_hl_diff == 0) - p_dm_odm->th_edcca_hl_diff = 7; -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) - if (p_dm_odm->wifi_test == true || p_dm_odm->mp_mode == true) -#else - if ((p_dm_odm->wifi_test & RT_WIFI_LOGO) == true) -#endif - p_dm_odm->edcca_enable = false; /*even no adaptivity, we still enable EDCCA, AP side use mib control*/ - else - p_dm_odm->edcca_enable = true; - -#elif (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct rtl8192cd_priv *priv = p_dm_odm->priv; - - if (p_dm_odm->carrier_sense_enable) { - p_dm_odm->th_l2h_ini = 0xa; - p_dm_odm->th_edcca_hl_diff = 7; + if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + if (dm->support_ic_type & + (ODM_RTL8821C | ODM_RTL8822B | ODM_RTL8814A)) + dm->th_l2h_ini = 0xf2; + else + dm->th_l2h_ini = 0xef; + } else if (dm->support_ic_type & ODM_RTL8822C) { + dm->th_l2h_ini = 0x2d; + } else if (dm->support_ic_type & ODM_RTL8814B) { + dm->th_l2h_ini = 0x31; } else { - p_dm_odm->th_l2h_ini = p_dm_odm->TH_L2H_default; /*set by mib*/ - p_dm_odm->th_edcca_hl_diff = p_dm_odm->th_edcca_hl_diff_default; + dm->th_l2h_ini = 0xf5; } - - if (priv->pshare->rf_ft_var.adaptivity_enable == 3) - adaptivity->acs_for_adaptivity = true; - else - adaptivity->acs_for_adaptivity = false; - - if (priv->pshare->rf_ft_var.adaptivity_enable == 2) - adaptivity->dynamic_link_adaptivity = true; - else - adaptivity->dynamic_link_adaptivity = false; - - priv->pshare->rf_ft_var.is_clean_environment = false; - -#endif - - p_dm_odm->adaptivity_igi_upper = 0; - p_dm_odm->adaptivity_enable = false; /*use this flag to decide enable or disable*/ - - p_dm_odm->th_l2h_ini_mode2 = 20; - p_dm_odm->th_edcca_hl_diff_mode2 = 8; - adaptivity->th_l2h_ini_backup = p_dm_odm->th_l2h_ini; - adaptivity->th_edcca_hl_diff_backup = p_dm_odm->th_edcca_hl_diff; - - adaptivity->igi_base = 0x32; - adaptivity->igi_target = 0x1c; - adaptivity->h2l_lb = 0; - adaptivity->l2h_lb = 0; - adaptivity->nhm_wait = 0; - adaptivity->is_check = false; - adaptivity->is_first_link = true; - adaptivity->adajust_igi_level = 0; - adaptivity->is_stop_edcca = false; - adaptivity->backup_h2l = 0; - adaptivity->backup_l2h = 0; - - phydm_mac_edcca_state(p_dm_odm, phydm_dont_ignore_edcca); - - /*Search pwdB lower bound*/ - if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) - odm_set_bb_reg(p_dm_odm, ODM_REG_DBG_RPT_11N, MASKDWORD, 0x208); -#if (RTL8195A_SUPPORT == 0) - else if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) - odm_set_bb_reg(p_dm_odm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0x209); -#endif - - if (p_dm_odm->support_ic_type & ODM_IC_11N_GAIN_IDX_EDCCA) { - /*odm_set_bb_reg(p_dm_odm, ODM_REG_EDCCA_DOWN_OPT_11N, BIT(12) | BIT11 | BIT10, 0x7);*/ /*interfernce need > 2^x us, and then EDCCA will be 1*/ - if (p_dm_odm->support_ic_type & ODM_RTL8197F) { - odm_set_bb_reg(p_dm_odm, ODM_REG_PAGE_B1_97F, BIT(30), 0x1); /*set to page B1*/ - odm_set_bb_reg(p_dm_odm, ODM_REG_EDCCA_DCNF_97F, BIT(27) | BIT26, 0x1); /*0:rx_dfir, 1: dcnf_out, 2 :rx_iq, 3: rx_nbi_nf_out*/ - odm_set_bb_reg(p_dm_odm, ODM_REG_PAGE_B1_97F, BIT(30), 0x0); -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - if (priv->pshare->rf_ft_var.adaptivity_enable == 1) - odm_set_bb_reg(p_dm_odm, 0xce8, BIT(13), 0x1); /*0: mean, 1:max pwdB*/ -#endif - } else - odm_set_bb_reg(p_dm_odm, ODM_REG_EDCCA_DCNF_11N, BIT(21) | BIT20, 0x1); /*0:rx_dfir, 1: dcnf_out, 2 :rx_iq, 3: rx_nbi_nf_out*/ - } -#if (RTL8195A_SUPPORT == 0) - if (p_dm_odm->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, ODM_REG_EDCCA_DOWN_OPT, BIT(30) | BIT29 | BIT28, 0x7);*/ /*interfernce need > 2^x us, and then EDCCA will be 1*/ - odm_set_bb_reg(p_dm_odm, ODM_REG_ACBB_EDCCA_ENHANCE, BIT(29) | BIT28, 0x1); /*0:rx_dfir, 1: dcnf_out, 2 :rx_iq, 3: rx_nbi_nf_out*/ - } - - if (!(p_dm_odm->support_ic_type & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA))) { - phydm_search_pwdb_lower_bound(p_dm_odm); - if (phydm_re_search_condition(p_dm_odm)) - phydm_search_pwdb_lower_bound(p_dm_odm); - } -#endif - - /*we need to consider PwdB upper bound for 8814 later IC*/ - adaptivity->adajust_igi_level = (u8)((p_dm_odm->th_l2h_ini + igi_target) - pwdb_upper_bound + dfir_loss); /*IGI = L2H - PwdB - dfir_loss*/ - - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("th_l2h_ini = 0x%x, th_edcca_hl_diff = 0x%x, adaptivity->adajust_igi_level = 0x%x\n", p_dm_odm->th_l2h_ini, p_dm_odm->th_edcca_hl_diff, adaptivity->adajust_igi_level)); - - /*Check this later on Windows*/ - /*phydm_set_edcca_threshold_api(p_dm_odm, p_dm_dig_table->cur_ig_value);*/ - } - -void -phydm_adaptivity( - void *p_dm_void -) +void phydm_set_l2h_th_ini_carrier_sense(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _dynamic_initial_gain_threshold_ *p_dm_dig_table = &p_dm_odm->dm_dig_table; - u8 IGI = p_dm_dig_table->cur_ig_value; - s8 th_l2h_dmc, th_h2l_dmc; - s8 diff = 0, igi_target; - struct _ADAPTIVITY_STATISTICS *adaptivity = (struct _ADAPTIVITY_STATISTICS *)phydm_get_structure(p_dm_odm, PHYDM_ADAPTIVITY); -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _ADAPTER *p_adapter = p_dm_odm->adapter; - bool is_fw_current_in_ps_mode = false; + struct dm_struct *dm = (struct dm_struct *)dm_void; - p_adapter->HalFunc.GetHwRegHandler(p_adapter, HW_VAR_FW_PSMODE_STATUS, (u8 *)(&is_fw_current_in_ps_mode)); + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + dm->th_l2h_ini = 0x3c; + else + dm->th_l2h_ini = 0xa; +} - /*Disable EDCCA mode while under LPS mode, added by Roger, 2012.09.14.*/ - if (is_fw_current_in_ps_mode) +void phydm_set_forgetting_factor(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (dm->support_ability & ODM_BB_ADAPTIVITY) { + if (dm->support_ic_type & + (ODM_RTL8821C | ODM_RTL8822B | ODM_RTL8814A)) + odm_set_bb_reg(dm, R_0x8a0, BIT(1) | BIT(0), 0); + } +} + +void phydm_set_pwdb_mode(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (dm->support_ability & ODM_BB_ADAPTIVITY) { + if (dm->support_ic_type & ODM_RTL8822B) + odm_set_bb_reg(dm, R_0x8dc, BIT(5), 0x1); + else if (dm->support_ic_type & (ODM_RTL8197F | ODM_RTL8192F)) + odm_set_bb_reg(dm, R_0xce8, BIT(13), 0x1); + else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + odm_set_bb_reg(dm, R_0x844, BIT(30) | BIT(29), 0x0); + } +} + +void phydm_adaptivity_debug(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_adaptivity_struct *adaptivity = &dm->adaptivity; + u32 used = *_used; + u32 out_len = *_out_len; + char help[] = "-h"; + u32 dm_value[10] = {0}; + u8 i = 0, input_idx = 0; + u32 reg_value32 = 0; + s8 h2l_diff = 0; + + for (i = 0; i < 5; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_HEX, &dm_value[i]); + input_idx++; + } + } + if (strcmp(input[1], help) == 0) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "Show adaptivity message: {0}\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "Enter debug mode: {1} {th_l2h_ini} {th_edcca_hl_diff}\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "Leave debug mode: {2}\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "Disable EDCCA thr: {3}\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "Enable EDCCA thr: {4}\n"); + goto out; + } + + if (input_idx == 0) return; + + if (dm_value[0] == PHYDM_ADAPT_DEBUG) { + adaptivity->debug_mode = true; + if (dm_value[1] != 0) + dm->th_l2h_ini = (s8)dm_value[1]; + if (dm_value[2] != 0) + dm->th_edcca_hl_diff = (s8)dm_value[2]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "th_l2h_ini = %d, th_edcca_hl_diff = %d\n", + dm->th_l2h_ini, dm->th_edcca_hl_diff); + } else if (dm_value[0] == PHYDM_ADAPT_RESUME) { + adaptivity->debug_mode = false; + dm->th_l2h_ini = adaptivity->th_l2h_ini_backup; + dm->th_edcca_hl_diff = adaptivity->th_edcca_hl_diff_backup; + } else if (dm_value[0] == PHYDM_EDCCA_TH_PAUSE) { + adaptivity->edcca_en = false; + } else if (dm_value[0] == PHYDM_EDCCA_TH_RESUME) { + adaptivity->edcca_en = true; + } else if (dm_value[0] == PHYDM_ADAPT_MSG) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "debug_mode = %s, th_l2h_ini = %d\n", + (adaptivity->debug_mode ? "TRUE" : "FALSE"), + dm->th_l2h_ini); + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + reg_value32 = odm_get_bb_reg(dm, R_0x84c, MASKDWORD); + h2l_diff = (s8)((0x00ff0000 & reg_value32) >> 16) - + (s8)((0xff000000 & reg_value32) >> 24); + } else if (dm->support_ic_type & ODM_IC_11N_SERIES) { + reg_value32 = odm_get_bb_reg(dm, R_0xc4c, MASKDWORD); + h2l_diff = (s8)(0x000000ff & reg_value32) - + (s8)((0x00ff0000 & reg_value32) >> 16); + } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + reg_value32 = odm_get_bb_reg(dm, R_0x8a4, MASKDWORD); + h2l_diff = (s8)(0x000000ff & reg_value32) - + (s8)((0x0000ff00 & reg_value32) >> 8); + } + + if (h2l_diff == 7) + PDM_SNPF(out_len, used, output + used, out_len - used, + "adaptivity enable\n"); + else + PDM_SNPF(out_len, used, output + used, out_len - used, + "adaptivity disable\n"); + } + +out: + *_used = used; + *_out_len = out_len; +} + +void phydm_set_edcca_val(void *dm_void, u32 *val_buf, u8 val_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (val_len != 2) { + PHYDM_DBG(dm, ODM_COMP_API, + "[Error][adaptivity]Need val_len = 2\n"); + return; + } + phydm_set_edcca_threshold(dm, (s8)val_buf[1], (s8)val_buf[0]); +} + +boolean phydm_edcca_abort(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_adaptivity_struct *adapt = &dm->adaptivity; +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + void *adapter = dm->adapter; + u32 is_fw_in_psmode = false; #endif - if ((p_dm_odm->edcca_enable == false) || (adaptivity->is_stop_edcca == true)) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("Disable EDCCA!!!\n")); - return; + if (dm->pause_ability & ODM_BB_ADAPTIVITY) { + PHYDM_DBG(dm, DBG_ADPTVTY, "Return: Pause ADPTVTY in LV=%d\n", + dm->pause_lv_table.lv_adapt); + return true; } - if (!(p_dm_odm->support_ability & ODM_BB_ADAPTIVITY)) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("adaptivity disable, enable EDCCA mode!!!\n")); - p_dm_odm->th_l2h_ini = p_dm_odm->th_l2h_ini_mode2; - p_dm_odm->th_edcca_hl_diff = p_dm_odm->th_edcca_hl_diff_mode2; + if (!adapt->edcca_en) { + PHYDM_DBG(dm, DBG_ADPTVTY, "Disable EDCCA!!!\n"); + return true; } + #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - else { - if (phydm_check_channel_plan(p_dm_odm) || (p_dm_odm->ap_total_num > adaptivity->ap_num_th)) { - p_dm_odm->th_l2h_ini = p_dm_odm->th_l2h_ini_mode2; - p_dm_odm->th_edcca_hl_diff = p_dm_odm->th_edcca_hl_diff_mode2; + ((PADAPTER)adapter)->HalFunc.GetHwRegHandler(adapter, + HW_VAR_FW_PSMODE_STATUS, + (u8 *)(&is_fw_in_psmode)); + + /*@Disable EDCCA while under LPS mode, added by Roger, 2012.09.14.*/ + if (is_fw_in_psmode) + return true; +#endif + + return false; +} +#endif +void phydm_set_edcca_threshold_api(void *dm_void, u8 IGI) +{ +#ifdef PHYDM_SUPPORT_ADAPTIVITY + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_adaptivity_struct *adaptivity = &dm->adaptivity; + s8 th_l2h_dmc = 0, th_h2l_dmc = 0; + s8 diff = 0, igi_target = 0x32; + + if (dm->support_ability & ODM_BB_ADAPTIVITY) { + if (!(dm->support_ic_type & ODM_IC_PWDB_EDCCA)) { + if (adaptivity->adjust_l2h > IGI) + diff = adaptivity->adjust_l2h - IGI; + + th_l2h_dmc = dm->th_l2h_ini - diff + igi_target; + th_h2l_dmc = th_l2h_dmc - dm->th_edcca_hl_diff; } else { - p_dm_odm->th_l2h_ini = adaptivity->th_l2h_ini_backup; - p_dm_odm->th_edcca_hl_diff = adaptivity->th_edcca_hl_diff_backup; - } - } -#endif - - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("odm_Adaptivity() =====>\n")); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("igi_base=0x%x, th_l2h_ini = %d, th_edcca_hl_diff = %d\n", - adaptivity->igi_base, p_dm_odm->th_l2h_ini, p_dm_odm->th_edcca_hl_diff)); -#if (RTL8195A_SUPPORT == 0) - if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) { - /*fix AC series when enable EDCCA hang issue*/ - odm_set_bb_reg(p_dm_odm, 0x800, BIT(10), 1); /*ADC_mask disable*/ - odm_set_bb_reg(p_dm_odm, 0x800, BIT(10), 0); /*ADC_mask enable*/ - } -#endif - if (*p_dm_odm->p_band_width == ODM_BW20M) /*CHANNEL_WIDTH_20*/ - igi_target = adaptivity->igi_base; - else if (*p_dm_odm->p_band_width == ODM_BW40M) - igi_target = adaptivity->igi_base + 2; -#if (RTL8195A_SUPPORT == 0) - else if (*p_dm_odm->p_band_width == ODM_BW80M) - igi_target = adaptivity->igi_base + 2; -#endif - else - igi_target = adaptivity->igi_base; - adaptivity->igi_target = (u8) igi_target; - - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("band_width=%s, igi_target=0x%x, dynamic_link_adaptivity = %d, acs_for_adaptivity = %d\n", - (*p_dm_odm->p_band_width == ODM_BW80M) ? "80M" : ((*p_dm_odm->p_band_width == ODM_BW40M) ? "40M" : "20M"), igi_target, adaptivity->dynamic_link_adaptivity, adaptivity->acs_for_adaptivity)); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("RSSI_min = %d, adaptivity->adajust_igi_level= 0x%x, adaptivity_flag = %d, adaptivity_enable = %d\n", - p_dm_odm->rssi_min, adaptivity->adajust_igi_level, p_dm_odm->adaptivity_flag, p_dm_odm->adaptivity_enable)); - - if ((adaptivity->dynamic_link_adaptivity == true) && (!p_dm_odm->is_linked) && (p_dm_odm->adaptivity_enable == false)) { - phydm_set_edcca_threshold(p_dm_odm, 0x7f, 0x7f); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("In DynamicLink mode(noisy) and No link, Turn off EDCCA!!\n")); - return; - } - - if (p_dm_odm->support_ic_type & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA)) { - if ((adaptivity->adajust_igi_level > IGI) && (p_dm_odm->adaptivity_enable == true)) - diff = adaptivity->adajust_igi_level - IGI; - - th_l2h_dmc = p_dm_odm->th_l2h_ini - diff + igi_target; - th_h2l_dmc = th_l2h_dmc - p_dm_odm->th_edcca_hl_diff; - } -#if (RTL8195A_SUPPORT == 0) - else { - diff = igi_target - (s8)IGI; - th_l2h_dmc = p_dm_odm->th_l2h_ini + diff; - if (th_l2h_dmc > 10 && (p_dm_odm->adaptivity_enable == true)) - th_l2h_dmc = 10; - - th_h2l_dmc = th_l2h_dmc - p_dm_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(p_dm_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(p_dm_odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("adaptivity_igi_upper=0x%x, h2l_lb = 0x%x, l2h_lb = 0x%x\n", p_dm_odm->adaptivity_igi_upper, adaptivity->h2l_lb, adaptivity->l2h_lb)); - - phydm_set_edcca_threshold(p_dm_odm, th_h2l_dmc, th_l2h_dmc); - - if (p_dm_odm->adaptivity_enable == true) - odm_set_mac_reg(p_dm_odm, REG_RD_CTRL, BIT(11), 1); - - return; -} - - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - -void -phydm_adaptivity_bsod( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTER *p_adapter = p_dm_odm->adapter; - PMGNT_INFO p_mgnt_info = &(p_adapter->MgntInfo); - u8 count = 0; - u32 u4_value; - - /* - 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")); - - p_adapter->dropPktByMacIdCnt++; - p_mgnt_info->bDropPktInProgress = true; - - p_adapter->HalFunc.GetHwRegHandler(p_adapter, HW_VAR_MAX_Q_PAGE_NUM, (u8 *)(&u4_value)); - RT_TRACE(COMP_INIT, DBG_LOUD, ("Queue Reserved Page number = 0x%08x\n", u4_value)); - p_adapter->HalFunc.GetHwRegHandler(p_adapter, HW_VAR_AVBL_Q_PAGE_NUM, (u8 *)(&u4_value)); - RT_TRACE(COMP_INIT, DBG_LOUD, ("Available Queue Page number = 0x%08x\n", u4_value)); - - /*Standby mode*/ - phydm_set_trx_mux(p_dm_odm, phydm_standby_mode, phydm_standby_mode); - odm_write_dig(p_dm_odm, 0x20); - - /*H2C mac id drop*/ - MacIdIndicateDisconnect(p_adapter); - - /*Ignore EDCCA*/ - phydm_mac_edcca_state(p_dm_odm, phydm_ignore_edcca); - - delay_ms(50); - count = 5; - - /*Resume EDCCA*/ - phydm_mac_edcca_state(p_dm_odm, phydm_dont_ignore_edcca); - - /*Turn on TRx mode*/ - phydm_set_trx_mux(p_dm_odm, phydm_tx_mode, phydm_rx_mode); - odm_write_dig(p_dm_odm, 0x20); - - /*Resume H2C macid*/ - MacIdRecoverMediaStatus(p_adapter); - - p_adapter->HalFunc.GetHwRegHandler(p_adapter, HW_VAR_AVBL_Q_PAGE_NUM, (u8 *)(&u4_value)); - RT_TRACE(COMP_INIT, DBG_LOUD, ("Available Queue Page number = 0x%08x\n", u4_value)); - - p_mgnt_info->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_pause_edcca( - void *p_dm_void, - bool is_pasue_edcca -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTIVITY_STATISTICS *adaptivity = (struct _ADAPTIVITY_STATISTICS *)phydm_get_structure(p_dm_odm, PHYDM_ADAPTIVITY); - struct _dynamic_initial_gain_threshold_ *p_dm_dig_table = &p_dm_odm->dm_dig_table; - u8 IGI = p_dm_dig_table->cur_ig_value; - s8 diff = 0; - - if (is_pasue_edcca) { - adaptivity->is_stop_edcca = true; - - if (p_dm_odm->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_odm->th_l2h_ini - diff + adaptivity->igi_target; - adaptivity->backup_h2l = adaptivity->backup_l2h - p_dm_odm->th_edcca_hl_diff; - } -#if (RTL8195A_SUPPORT == 0) - else { - diff = adaptivity->igi_target - (s8)IGI; - adaptivity->backup_l2h = p_dm_odm->th_l2h_ini + diff; - if (adaptivity->backup_l2h > 10) - adaptivity->backup_l2h = 10; - - adaptivity->backup_h2l = adaptivity->backup_l2h - p_dm_odm->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 - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("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_odm); -#endif - - } else { - - adaptivity->is_stop_edcca = false; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("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_odm); -#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_odm = &p_hal_data->DM_OutSrc; -#else - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; -#endif - - if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_ECCA_THRESHOLD, MASKBYTE2 | MASKBYTE0, (u32)(0x7f | 0x7f << 16)); -#if (RTL8195A_SUPPORT == 0) - else if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) - odm_set_bb_reg(p_dm_odm, 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_odm = &p_hal_data->DM_OutSrc; -#else - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; -#endif - struct _ADAPTIVITY_STATISTICS *adaptivity = (struct _ADAPTIVITY_STATISTICS *)phydm_get_structure(p_dm_odm, PHYDM_ADAPTIVITY); - - if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) - odm_set_bb_reg(p_dm_odm, 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_odm->support_ic_type & ODM_IC_11AC_SERIES) - odm_set_bb_reg(p_dm_odm, 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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTIVITY_STATISTICS *adaptivity = (struct _ADAPTIVITY_STATISTICS *)phydm_get_structure(p_dm_odm, PHYDM_ADAPTIVITY); - s8 th_l2h_dmc, th_h2l_dmc; - s8 diff = 0, igi_target = 0x32; - - if (p_dm_odm->support_ability & ODM_BB_ADAPTIVITY) { - if (p_dm_odm->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_odm->th_l2h_ini - diff + igi_target; - th_h2l_dmc = th_l2h_dmc - p_dm_odm->th_edcca_hl_diff; - } -#if (RTL8195A_SUPPORT == 0) - else { diff = igi_target - (s8)IGI; - th_l2h_dmc = p_dm_odm->th_l2h_ini + diff; + th_l2h_dmc = dm->th_l2h_ini + diff; if (th_l2h_dmc > 10) th_l2h_dmc = 10; - th_h2l_dmc = th_l2h_dmc - p_dm_odm->th_edcca_hl_diff; + th_h2l_dmc = th_l2h_dmc - dm->th_edcca_hl_diff; /*replace lower bound to prevent EDCCA always equal 1*/ if (th_h2l_dmc < adaptivity->h2l_lb) @@ -1120,11 +515,262 @@ phydm_set_edcca_threshold_api( if (th_l2h_dmc < adaptivity->l2h_lb) th_l2h_dmc = adaptivity->l2h_lb; } -#endif - ODM_RT_TRACE(p_dm_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(p_dm_odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("API :adaptivity_igi_upper=0x%x, h2l_lb = 0x%x, l2h_lb = 0x%x\n", p_dm_odm->adaptivity_igi_upper, adaptivity->h2l_lb, adaptivity->l2h_lb)); - phydm_set_edcca_threshold(p_dm_odm, th_h2l_dmc, th_l2h_dmc); + PHYDM_DBG(dm, DBG_ADPTVTY, + "API :IGI=0x%x, th_l2h_dmc = %d, th_h2l_dmc = %d\n", + IGI, th_l2h_dmc, th_h2l_dmc); + + phydm_set_edcca_threshold(dm, th_h2l_dmc, th_l2h_dmc); + } +#endif +} + +void phydm_adaptivity_info_init(void *dm_void, enum phydm_adapinfo cmn_info, + u32 value) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_adaptivity_struct *adaptivity = &dm->adaptivity; + + switch (cmn_info) { + case PHYDM_ADAPINFO_CARRIER_SENSE_ENABLE: + dm->carrier_sense_enable = (boolean)value; + break; + case PHYDM_ADAPINFO_TH_L2H_INI: + dm->th_l2h_ini = (s8)value; + break; + case PHYDM_ADAPINFO_TH_EDCCA_HL_DIFF: + 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_info_update(void *dm_void, enum phydm_adapinfo cmn_info, + u32 value) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_adaptivity_struct *adapt = &dm->adaptivity; + + /*This init variable may be changed in run time.*/ + switch (cmn_info) { + case PHYDM_ADAPINFO_DOMAIN_CODE_2G: + adapt->regulation_2g = (u8)value; + break; + case PHYDM_ADAPINFO_DOMAIN_CODE_5G: + adapt->regulation_5g = (u8)value; + break; + default: + break; + } +} + +void phydm_adaptivity_init(void *dm_void) +{ +#ifdef PHYDM_SUPPORT_ADAPTIVITY + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_adaptivity_struct *adaptivity = &dm->adaptivity; + +#if (DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_WIN)) + + if (!dm->carrier_sense_enable) { + if (dm->th_l2h_ini == 0) + phydm_set_l2h_th_ini(dm); + } else { + phydm_set_l2h_th_ini_carrier_sense(dm); } + if (dm->th_edcca_hl_diff == 0) + dm->th_edcca_hl_diff = 7; +#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) + if (dm->wifi_test || *dm->mp_mode) +#else + if (dm->wifi_test & RT_WIFI_LOGO) /*@AP side use mib control*/ +#endif + /*@even no adaptivity, we still enable EDCCA*/ + adaptivity->edcca_en = false; + else + adaptivity->edcca_en = true; + +#elif (DM_ODM_SUPPORT_TYPE & ODM_AP) + if (dm->carrier_sense_enable) { + phydm_set_l2h_th_ini_carrier_sense(dm); + dm->th_edcca_hl_diff = 7; + } else { + dm->th_l2h_ini = dm->TH_L2H_default; /*set by mib*/ + dm->th_edcca_hl_diff = dm->th_edcca_hl_diff_default; + } + + adaptivity->edcca_en = true; +#endif + + adaptivity->is_adapt_en = false; /*@decide enable or not*/ + adaptivity->debug_mode = false; + adaptivity->th_l2h_ini_backup = dm->th_l2h_ini; + adaptivity->th_edcca_hl_diff_backup = dm->th_edcca_hl_diff; + adaptivity->igi_base = 0x32; + adaptivity->adapt_igi_up = 0; + adaptivity->h2l_lb = 0; + adaptivity->l2h_lb = 0; + adaptivity->adjust_l2h = 0; + adaptivity->th_l2h = 0x7f; + adaptivity->th_h2l = 0x7f; + phydm_mac_edcca_state(dm, PHYDM_DONT_IGNORE_EDCCA); + + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + adaptivity->adaptivity_dbg_port = 0x000; + odm_set_bb_reg(dm, R_0x1d6c, BIT(0), 1); + } else if (dm->support_ic_type & ODM_IC_11N_SERIES) { + adaptivity->adaptivity_dbg_port = 0x208; + } else { + adaptivity->adaptivity_dbg_port = 0x209; + } + if (dm->support_ic_type & ODM_IC_11N_SERIES && + !(dm->support_ic_type & ODM_IC_PWDB_EDCCA)) { + /*@interfernce need > 2^x us, and then EDCCA will be 1*/ +#if 0 + /*odm_set_bb_reg(dm, 0x948, 0x1c00, 0x7);*/ +#endif + if (dm->support_ic_type & (ODM_RTL8197F | ODM_RTL8192F)) { + /*set to page B1*/ + odm_set_bb_reg(dm, R_0xe28, BIT(30), 0x1); + /*@0:rx_dfir, 1: dcnf_out, 2 :rx_iq, 3: rx_nbi_nf_out*/ + odm_set_bb_reg(dm, R_0xbc0, BIT(27) | BIT(26), 0x1); + odm_set_bb_reg(dm, R_0xe28, BIT(30), 0x0); + } else { + /*@0:rx_dfir, 1: dcnf_out, 2 :rx_iq, 3: rx_nbi_nf_out*/ + odm_set_bb_reg(dm, R_0xe24, BIT(21) | BIT(20), 0x1); + } + } else if (dm->support_ic_type & ODM_IC_11AC_SERIES && + !(dm->support_ic_type & ODM_IC_PWDB_EDCCA)) { + /*@interfernce need > 2^x us, and then EDCCA will be 1*/ +#if 0 + /*odm_set_bb_reg(dm, 0x900, 0x70000000, 0x7);*/ +#endif + /*@0:rx_dfir, 1: dcnf_out, 2 :rx_iq, 3: rx_nbi_nf_out*/ + odm_set_bb_reg(dm, R_0x944, BIT(29) | BIT(28), 0x1); + } + + if (dm->support_ic_type & ODM_IC_PWDB_EDCCA) { + phydm_search_pwdb_lower_bound(dm); + if (phydm_re_search_condition(dm)) + phydm_search_pwdb_lower_bound(dm); + } else { + /*resume to no link state*/ + phydm_set_edcca_threshold(dm, 0x7f, 0x7f); + } + + /*@forgetting factor setting*/ + phydm_set_forgetting_factor(dm); + + /*pwdb mode setting with 0: mean, 1:max*/ + phydm_set_pwdb_mode(dm); + +#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; +#endif +} + +void phydm_adaptivity(void *dm_void) +{ +#ifdef PHYDM_SUPPORT_ADAPTIVITY + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + struct phydm_adaptivity_struct *adapt = &dm->adaptivity; + u8 igi = dig_t->cur_ig_value; + s8 th_l2h_dmc = 0, th_h2l_dmc = 0; + s8 diff = 0, igi_target = adapt->igi_base; + + if (phydm_edcca_abort(dm)) + return; + + /*@fix AC series when enable EDCCA hang issue*/ + if (dm->support_ic_type & ODM_RTL8812) { + odm_set_bb_reg(dm, R_0x800, BIT(10), 1); /*@ADC_mask disable*/ + odm_set_bb_reg(dm, R_0x800, BIT(10), 0); /*@ADC_mask enable*/ + } + + if (!adapt->debug_mode) + phydm_check_adaptivity(dm); /*@Check adaptivity enable*/ + + PHYDM_DBG(dm, DBG_ADPTVTY, "%s ====>\n", __func__); + PHYDM_DBG(dm, DBG_ADPTVTY, "th_l2h_ini = %d, th_edcca_hl_diff = %d\n", + dm->th_l2h_ini, dm->th_edcca_hl_diff); + PHYDM_DBG(dm, DBG_ADPTVTY, "is_adapt_en = %d, debug_mode = %d\n", + adapt->is_adapt_en, adapt->debug_mode); + + if (dm->support_ic_type & ODM_IC_PWDB_EDCCA) { + if (adapt->is_adapt_en) { + /*@Limit IGI upper bound for adaptivity*/ + phydm_dig_up_bound_lmt_en(dm); + diff = igi_target - (s8)igi; + th_l2h_dmc = dm->th_l2h_ini + diff; + if (th_l2h_dmc > 10) + th_l2h_dmc = 10; + + th_h2l_dmc = th_l2h_dmc - dm->th_edcca_hl_diff; + } else { + th_l2h_dmc = 0x46 - igi; + th_h2l_dmc = th_l2h_dmc - EDCCA_HL_DIFF_NORMAL; + } + /*replace lower bound to prevent EDCCA always equal 1*/ + if (th_h2l_dmc < adapt->h2l_lb) + th_h2l_dmc = adapt->h2l_lb; + if (th_l2h_dmc < adapt->l2h_lb) + th_l2h_dmc = adapt->l2h_lb; + PHYDM_DBG(dm, DBG_ADPTVTY, + "adapt_igi_up=0x%x, h2l_lb = 0x%x, l2h_lb = 0x%x\n", + adapt->adapt_igi_up, adapt->h2l_lb, adapt->l2h_lb); + } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + if (adapt->is_adapt_en) { + /*need to prevent pwdB clipping*/ + adapt->adjust_l2h = (u8)(dm->th_l2h_ini - ADC_BACKOFF); + diff = adapt->adjust_l2h > igi ? + adapt->adjust_l2h - igi : + 0; + th_l2h_dmc = dm->th_l2h_ini - diff; + th_h2l_dmc = th_l2h_dmc - dm->th_edcca_hl_diff; + } else { + th_l2h_dmc = igi + TH_L2H_DIFF_IGI > EDCCA_TH_L2H_LB ? + igi + TH_L2H_DIFF_IGI : + EDCCA_TH_L2H_LB; + th_h2l_dmc = th_l2h_dmc - EDCCA_HL_DIFF_NORMAL; + } + } else { + if (adapt->is_adapt_en) { + /*need to consider PwdB upper bound for 8814 later IC*/ + adapt->adjust_l2h = (u8)(dm->th_l2h_ini + igi_target - + PWDB_UPPER_BOUND + DFIR_LOSS); + diff = adapt->adjust_l2h > igi ? + adapt->adjust_l2h - igi : + 0; + th_l2h_dmc = dm->th_l2h_ini - diff + igi_target; + th_h2l_dmc = th_l2h_dmc - dm->th_edcca_hl_diff; + } else { + th_l2h_dmc = igi + TH_L2H_DIFF_IGI > EDCCA_TH_L2H_LB ? + igi + TH_L2H_DIFF_IGI : + EDCCA_TH_L2H_LB; + th_h2l_dmc = th_l2h_dmc - EDCCA_HL_DIFF_NORMAL; + } + } + + adapt->th_l2h = th_l2h_dmc; + adapt->th_h2l = th_h2l_dmc; + PHYDM_DBG(dm, DBG_ADPTVTY, "IGI=0x%x, th_l2h_dmc=%d, th_h2l_dmc=%d\n", + igi, th_l2h_dmc, th_h2l_dmc); + phydm_set_edcca_threshold(dm, th_h2l_dmc, th_l2h_dmc); + + if (adapt->is_adapt_en) + odm_set_mac_reg(dm, REG_RD_CTRL, BIT(11), 1); + + return; +#endif } diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_adaptivity.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_adaptivity.h index 27a50ea0828a..aead7bd5772b 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_adaptivity.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_adaptivity.h @@ -1,7 +1,7 @@ - +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -9,211 +9,117 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ -#ifndef __PHYDMADAPTIVITY_H__ -#define __PHYDMADAPTIVITY_H__ +#ifndef __PHYDMADAPTIVITY_H__ +#define __PHYDMADAPTIVITY_H__ -#define ADAPTIVITY_VERSION "9.3.5" /*20160902 changed by Kevin, refine method for searching pwdb lower bound*/ +#define ADAPTIVITY_VERSION "9.6.07" /*@20181107 changed by Kevin, + *remove pwdB mode with non-adaptivity case + */ -#define pwdb_upper_bound 7 -#define dfir_loss 5 +#define PWDB_UPPER_BOUND 7 +#define DFIR_LOSS 7 +#define ADC_BACKOFF 12 +#define EDCCA_TH_L2H_LB 0x30 +#define TH_L2H_DIFF_IGI 8 +#define EDCCA_HL_DIFF_NORMAL 8 +#define ODM_IC_PWDB_EDCCA (ODM_RTL8188E | ODM_RTL8723B | ODM_RTL8192E |\ + ODM_RTL8881A | ODM_RTL8821 | ODM_RTL8812) + +#if (DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_AP)) + #define ADAPT_DC_BACKOFF 2 +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + #define ADAPT_DC_BACKOFF 4 +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + #define ADAPT_DC_BACKOFF 0 +#endif #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 + REGULATION_FCC = 0, + REGULATION_MKK = 1, + REGULATION_ETSI = 2, + REGULATION_WW = 3, + MAX_REGULATION_NUM = 4 }; #endif -enum phydm_adapinfo_e { +enum phydm_adapinfo { 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 + PHYDM_ADAPINFO_AP_NUM_TH, + PHYDM_ADAPINFO_DOMAIN_CODE_2G, + PHYDM_ADAPINFO_DOMAIN_CODE_5G }; enum phydm_mac_edcca_type { - phydm_ignore_edcca = 0, - phydm_dont_ignore_edcca = 1 + PHYDM_IGNORE_EDCCA = 0, + PHYDM_DONT_IGNORE_EDCCA = 1 }; -struct _ADAPTIVITY_STATISTICS { +enum phydm_adaptivity_mode { + PHYDM_ADAPT_MSG = 0, + PHYDM_ADAPT_DEBUG = 1, + PHYDM_ADAPT_RESUME = 2, + PHYDM_EDCCA_TH_PAUSE = 3, + PHYDM_EDCCA_TH_RESUME = 4 +}; + +struct phydm_adaptivity_struct { s8 th_l2h_ini_backup; s8 th_edcca_hl_diff_backup; s8 igi_base; - u8 igi_target; - u8 nhm_wait; s8 h2l_lb; s8 l2h_lb; - bool is_first_link; - bool is_check; - bool dynamic_link_adaptivity; u8 ap_num_th; - u8 adajust_igi_level; - bool acs_for_adaptivity; - s8 backup_l2h; - s8 backup_h2l; - bool 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 + u8 adjust_l2h; + u32 adaptivity_dbg_port; /*N:0x208, AC:0x209*/ + u8 debug_mode; + 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; + u32 rvrt_val[2]; + s8 th_l2h; + s8 th_h2l; + u8 regulation_2g; + u8 regulation_5g; + boolean is_adapt_en; + boolean edcca_en; }; -void -phydm_pause_edcca( - void *p_dm_void, - bool is_pasue_edcca -); - -void -phydm_check_adaptivity( - void *p_dm_void -); - -void -phydm_check_environment( - void *p_dm_void -); - -void -phydm_nhm_counter_statistics_init( - void *p_dm_void -); - -void -phydm_nhm_counter_statistics( - void *p_dm_void -); - -void -phydm_nhm_counter_statistics_reset( - void *p_dm_void -); - -void -phydm_get_nhm_counter_statistics( - 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 -); - -bool -phydm_cal_nhm_cnt( - void *p_dm_void -); - -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 -); - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -void -phydm_disable_edcca( - void *p_dm_void -); - -void -phydm_dynamic_edcca( - void *p_dm_void -); - -void -phydm_adaptivity_bsod( - void *p_dm_void -); +#ifdef PHYDM_SUPPORT_ADAPTIVITY +void phydm_adaptivity_debug(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len); +void phydm_set_edcca_val(void *dm_void, u32 *val_buf, u8 val_len); #endif -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_set_edcca_threshold_api(void *dm_void, u8 IGI); -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_info_init(void *dm_void, enum phydm_adapinfo cmn_info, + u32 value); + +void phydm_adaptivity_info_update(void *dm_void, enum phydm_adapinfo cmn_info, + u32 value); + +void phydm_adaptivity_init(void *dm_void); + +void phydm_adaptivity(void *dm_void); #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_adc_sampling.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_adc_sampling.c index 1e9cf35fb66e..056f272b5815 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_adc_sampling.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_adc_sampling.c @@ -1,765 +1,1389 @@ /* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + #include "mp_precomp.h" #include "phydm_precomp.h" +#if (PHYDM_LA_MODE_SUPPORT) + #if (DM_ODM_SUPPORT_TYPE & ODM_AP) - #if ((RTL8197F_SUPPORT == 1) || (RTL8822B_SUPPORT == 1)) - #include "rtl8197f/Hal8197FPhyReg.h" - #include "WlanHAL/HalMac88XX/halmac_reg2.h" + #if (RTL8197F_SUPPORT || RTL8822B_SUPPORT || RTL8192F_SUPPORT) + #include "rtl8197f/Hal8197FPhyReg.h" + #include "WlanHAL/HalMac88XX/halmac_reg2.h" #else - #include "WlanHAL/HalHeader/HalComReg.h" + #include "WlanHAL/HalHeader/HalComReg.h" + #endif +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + #if WPP_SOFTWARE_TRACE + #include "phydm_adc_sampling.tmh" #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)) -bool -phydm_la_buffer_allocate( - void *p_dm_void -) +#if RTL8814B_SUPPORT +boolean phydm_la_finish_addr_recover_8814B(void *dm_void, u32 *finish_addr) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_ADCSMP *adc_smp = &(p_dm_odm->adcsmp); - struct _ADAPTER *adapter = p_dm_odm->adapter; - struct _RT_ADCSMP_STRING *adc_smp_buf = &(adc_smp->adc_smp_buf); - bool ret = false; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct rt_adcsmp *smp = &dm->adcsmp; + boolean recover_success; - dbg_print("[LA mode BufferAllocate]\n"); + if (dm->support_ic_type != ODM_RTL8814B) + return false; - if (adc_smp_buf->length == 0) { + if (smp->la_buff_mode == ADCSMP_BUFF_HALF) { + if (*finish_addr < 0x4000) /*0~0x4000*/ + *finish_addr += 0x8000; -#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_odm, (void **)&adc_smp_buf->octet, adc_smp_buf->buffer_size); - if (!adc_smp_buf->octet) { + recover_success = true; + } else { + if (*finish_addr >= 0x4000 && *finish_addr < 0x8000) + recover_success = true; + else + recover_success = false; + } + pr_debug("[8814B] recover_success=(%d)\n", recover_success); + + return recover_success; +} #endif + +#if RTL8198F_SUPPORT +void phydm_la_pre_run(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct rt_adcsmp *smp = &dm->adcsmp; + struct rt_adcsmp_string *buf = &smp->adc_smp_buf; + u8 i = 0; + u8 tmp = 0; + u8 target_polling_bit = BIT(1); + + if (!(dm->support_ic_type & ODM_RTL8198F)) + return; + + if (smp->la_trig_mode == PHYDM_ADC_MAC_TRIG) + return; + + /*pre run */ + /*force to bb trigger*/ + odm_set_mac_reg(dm, R_0x7c0, BIT(3), 0); + /*dma_trig_and(AND1) output 1*/ + odm_set_bb_reg(dm, R_0x1ce4, 0xf0000000, 0x0); + /*r_dma_trigger_AND1_inv = 1*/ + odm_set_bb_reg(dm, R_0x1ce8, BIT5, 1); /*@AND 1 val*/ + /* polling bit for BB ADC mode */ + odm_set_mac_reg(dm, 0x7c0, BIT(1), 1); + + pr_debug("buf[end:start]=(0x%x~0x%x)\n", buf->end_pos, buf->start_pos); + + do { + tmp = odm_read_1byte(dm, R_0x7c0); + if ((tmp & target_polling_bit) == false) { + pr_debug("LA pre-run fail.\n"); + phydm_la_stop(dm); + phydm_release_bb_dbg_port(dm); + } else { + ODM_delay_ms(100); + pr_debug("LA pre-run while_cnt = %d.\n", i); + i++; + } + } while (i < 3); + + /*r_dma_trigger_AND1_inv = 0*/ + odm_set_bb_reg(dm, R_0x1ce8, BIT5, 0); /*@AND 1 val*/ + + if (smp->la_trig_mode == PHYDM_ADC_MAC_TRIG) + odm_set_mac_reg(dm, R_0x7c0, BIT(3), 1); +} +#endif + +#if (RTL8821C_SUPPORT | RTL8195B_SUPPORT) +void +phydm_la_clk_en(void *dm_void, boolean enable) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 val = (enable) ? 1 : 0; + + if (!(dm->support_ic_type & (ODM_RTL8195B | ODM_RTL8821C))) + return; + + if (dm->support_ic_type == ODM_RTL8821C && + dm->cut_version == ODM_CUT_A) + return; + + odm_set_bb_reg(dm, R_0x95c, BIT(23), val); +} +#endif + +#if (RTL8197F_SUPPORT) +void +phydm_la_stop_dma_8197f(void *dm_void, enum phydm_backup_type opt) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct rt_adcsmp *smp = &dm->adcsmp; + + if (dm->support_ic_type != ODM_RTL8197F) + return; + + if (opt == PHYDM_BACKUP) { + /*Stop DMA*/ + smp->backup_dma = odm_get_mac_reg(dm, R_0x300, 0xffff); + odm_set_mac_reg(dm, R_0x300, 0x7fff, 0x7fff); + } else { /*restore*/ + /*Resume DMA*/ + odm_set_mac_reg(dm, R_0x300, 0x7fff, smp->backup_dma); + } +} +#endif + +#ifdef PHYDM_COMPILE_LA_STORE_IN_IMEM +void +phydm_la_mv_data_2_tx_buffer(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct rt_adcsmp *smp = &dm->adcsmp; + struct rt_adcsmp_string *buf = &smp->adc_smp_buf; + + if (!(dm->support_ic_type & PHYDM_LA_STORE_IN_IMEM_IC)) + return; + + pr_debug("98F GetTxPktBuf from iMEM\n"); + odm_set_bb_reg(dm, R_0x7c0, BIT(0), 0x0); /*Disable LA mode HW block*/ + + /* 98F LA memory loccation is separate from normal + * driver use, DMA is no longer required to stop + */ + #if (RTL8197F_SUPPORT) + phydm_la_stop_dma_8197f(dm, PHYDM_BACKUP); + #endif + + /* @move LA mode content from IMEM to TxPktBuffer + * Source : OCPBASE_IMEM 0x00000000 + * Destination : OCPBASE_TXBUF 0x18780000 + * Length : 64K + */ + GET_HAL_INTERFACE(dm->priv)->init_ddma_handler(dm->priv, + OCPBASE_IMEM, + OCPBASE_TXBUF + + buf->start_pos, + 0x10000); +} +#endif + +#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + +void phydm_la_bb_adv_reset_jgr3(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct rt_adcsmp *smp = &dm->adcsmp; + struct la_adv_trig *adv = &smp->adv_trig_table; + +#if 1 + odm_memory_set(dm, adv, 0, sizeof(struct la_adv_trig)); +#else + adv->la_en_new_bbtrigger = false; + adv->la_ori_bb_dis = false; + adv->la_and1_sel = 0; + adv->la_and1_val = 0; + adv->la_and2_sel = 0; + adv->la_and2_val = 0; + adv->la_and3_sel = 0; + adv->la_and3_val = 0; + adv->la_and4_mask = 0; + adv->la_and4_bitmap = 0; +#endif +} + +void phydm_la_bb_adv_trig_setting_jgr3(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct rt_adcsmp *smp = &dm->adcsmp; + struct la_adv_trig *adv = &smp->adv_trig_table; + boolean adv_bb_trig_en = adv->la_en_new_bbtrigger; + + pr_debug(" *ADV BB-trig = %d\n", adv_bb_trig_en); + + if (!adv_bb_trig_en) { /*normal LA mode & back to default*/ + /*@AND0*/ + odm_set_bb_reg(dm, R_0x1ce4, BIT(27), 0); + + /*@AND1*/ + odm_set_bb_reg(dm, R_0x1ce4, MASKH4BITS, 0); + odm_set_bb_reg(dm, R_0x1ce8, BIT(5), 0); /*@AND 1 inv*/ + /*@AND2*/ + odm_set_bb_reg(dm, R_0x1ce8, 0x3c0, 0); + odm_set_bb_reg(dm, R_0x1ce8, BIT(15), 0); /*@AND 2 inv*/ + /*@AND3*/ + odm_set_bb_reg(dm, R_0x1ce8, 0xf0000, 0); + odm_set_bb_reg(dm, R_0x1ce8, BIT(25), 0); /*@AND 3 inv*/ + /*@AND4*/ + odm_set_bb_reg(dm, R_0x1cf0, MASKDWORD, 0); /*@AND 4 mask en*/ + odm_set_bb_reg(dm, R_0x1ce8, BIT(26), 0); /*@AND 4 inv*/ + } else { + /* @AND0 */ + /*path 1 default: enable ori. BB trigger*/ + odm_set_bb_reg(dm, R_0x1ce4, BIT(27), + (adv->la_ori_bb_dis ? 1 : 0)); + + /* @AND1 */ + odm_set_bb_reg(dm, R_0x1ce8, BIT(5), adv->la_and1_inv); + odm_set_bb_reg(dm, R_0x1ce4, MASKH4BITS, adv->la_and1_sel); + odm_set_bb_reg(dm, R_0x1ce8, 0x1f, adv->la_and1_val); + + /* @AND2 */ + odm_set_bb_reg(dm, R_0x1ce8, BIT(15), adv->la_and2_inv); + odm_set_bb_reg(dm, R_0x1ce8, 0x3c0, adv->la_and2_sel); + odm_set_bb_reg(dm, R_0x1ce8, 0x7c00, adv->la_and2_val); + + /* @AND3 */ + odm_set_bb_reg(dm, R_0x1ce8, BIT(25), adv->la_and3_inv); + odm_set_bb_reg(dm, R_0x1ce8, 0xf0000, adv->la_and3_sel); + odm_set_bb_reg(dm, R_0x1ce8, 0x1f00000, adv->la_and3_val); + + /* @AND4 */ + odm_set_bb_reg(dm, R_0x1ce8, BIT(26), adv->la_and4_inv); + odm_set_bb_reg(dm, R_0x1cf0, MASKDWORD, adv->la_and4_mask); + odm_set_bb_reg(dm, R_0x1cec, MASKDWORD, adv->la_and4_bitmap); + } +} + +void phydm_la_bb_adv_cmd_show_jgr3(void *dm_void, u32 *_used, + char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct rt_adcsmp *smp = &dm->adcsmp; + struct la_adv_trig *adv = &smp->adv_trig_table; + + PDM_SNPF(*_out_len, *_used, output + *_used, *_out_len - *_used, + " *And0 Disable=%d\n", adv->la_ori_bb_dis); + PDM_SNPF(*_out_len, *_used, output + *_used, *_out_len - *_used, + " *And1{sel,val,inv}={0x%x,0x%x,%d}\n *And2{sel,val,inv}={0x%x,0x%x,%d}\n *And3{sel,val,inv}={0x%x,0x%x,%d}\n", + adv->la_and1_sel, adv->la_and1_val, adv->la_and1_inv, + adv->la_and2_sel, adv->la_and2_val, adv->la_and2_inv, + adv->la_and3_sel, adv->la_and3_val, adv->la_and3_inv); + PDM_SNPF(*_out_len, *_used, output + *_used, *_out_len - *_used, + " *And4{mask,bitmap,inv}={0x%x,0x%x,%d}\n", + adv->la_and4_mask, adv->la_and4_bitmap, adv->la_and4_inv); +} + +void phydm_la_bb_adv_cmd_jgr3(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct rt_adcsmp *smp = &dm->adcsmp; + struct la_adv_trig *adv = &smp->adv_trig_table; + u32 var1[10] = {0}; + u32 adv_trig_en; + + if (!(dm->support_ic_type & ODM_IC_JGR3_SERIES)) + return; + + if ((strcmp(input[2], "show") == 0)) { + phydm_la_bb_adv_cmd_show_jgr3(dm, _used, output, _out_len); + return; + } + + PHYDM_SSCANF(input[2], DCMD_HEX, &var1[0]); + PHYDM_SSCANF(input[3], DCMD_HEX, &var1[1]); + PHYDM_SSCANF(input[4], DCMD_HEX, &var1[2]); + PHYDM_SSCANF(input[5], DCMD_HEX, &var1[3]); + PHYDM_SSCANF(input[6], DCMD_HEX, &var1[4]); + + adv_trig_en = var1[0]; + + if (adv_trig_en != 1) { + PDM_SNPF(*_out_len, *_used, output + *_used, *_out_len - *_used, + "Back to Ori-BB-trig\n"); + phydm_la_bb_adv_reset_jgr3(dm); + return; + } + + adv->la_en_new_bbtrigger = true; + + if (var1[1] == 0) { + adv->la_ori_bb_dis = (boolean)var1[2]; + } else if (var1[1] == 1) { + adv->la_and1_sel = (u8)var1[2]; + adv->la_and1_val = (u8)var1[3]; + adv->la_and1_inv = (boolean)var1[4]; + } else if (var1[1] == 2) { + adv->la_and2_sel = (u8)var1[2]; + adv->la_and2_val = (u8)var1[3]; + adv->la_and2_inv = (boolean)var1[4]; + } else if (var1[1] == 3) { + adv->la_and3_sel = (u8)var1[2]; + adv->la_and3_val = (u8)var1[3]; + adv->la_and2_inv = (boolean)var1[4]; + } else if (var1[1] == 4) { + adv->la_and4_mask = (u8)var1[2]; + adv->la_and4_bitmap = (u8)var1[3]; + adv->la_and4_inv = (boolean)var1[4]; + } + + PDM_SNPF(*_out_len, *_used, output + *_used, *_out_len - *_used, + "[Adv_trig_en=%d]\n\n", adv_trig_en); + + phydm_la_bb_adv_cmd_show_jgr3(dm, _used, output, _out_len); +} + +#endif + +void +phydm_la_buffer_print(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct rt_adcsmp *smp = &dm->adcsmp; + struct rt_adcsmp_string *buf = &smp->adc_smp_buf; + u32 i; + u32 idx; + + if (!buf->octet || buf->length == 0 || buf->length < smp->smp_number) + return; + + pr_debug("[LA Data Dump] smp_number = %d\n", smp->smp_number); + + for (i = 0; i < smp->smp_number; i++) { + idx = i << 1; + + #if 0 /*((DM_ODM_SUPPORT_TYPE & ODM_WIN) && !DBG)*/ + /*WIN driver free build*/ + RT_TRACE_EX(COMP_LA_MODE, DBG_LOUD, ("%08x%08x\n", + buf->octet[idx], buf->octet[idx + 1])); + #else + pr_debug("%08x%08x\n", buf->octet[idx], buf->octet[idx + 1]); + #endif + } + pr_debug("Dump Finished\n\n"); +} + +void +phydm_la_buffer_release(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct rt_adcsmp *smp = &dm->adcsmp; + struct rt_adcsmp_string *buf = &smp->adc_smp_buf; + + if (buf->length != 0x0) { + odm_free_memory(dm, buf->octet, buf->length); + buf->length = 0x0; + } +} + +boolean +phydm_la_buffer_allocate(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct rt_adcsmp *smp = &dm->adcsmp; + #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + void *adapter = dm->adapter; + #endif + struct rt_adcsmp_string *buf = &smp->adc_smp_buf; + boolean ret = true; + + pr_debug("[LA mode BufferAllocate]\n"); + + if (buf->length == 0) { + #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + if (PlatformAllocateMemoryWithZero(adapter, (void **)& + buf->octet, + buf->buffer_size) != + RT_STATUS_SUCCESS) ret = false; - } else - adc_smp_buf->length = adc_smp_buf->buffer_size; - ret = true; + #else + odm_allocate_memory(dm, (void **)&buf->octet, buf->buffer_size); + + if (!buf->octet) + ret = false; + #endif + + if (ret) + buf->length = buf->buffer_size; } return ret; } -#endif -void -phydm_la_get_tx_pkt_buf( - void *p_dm_void -) +void phydm_la_access_tx_pkt_buf(void *dm_void, u32 addr, u32 buff_idx) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_ADCSMP *adc_smp = &(p_dm_odm->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;*/ - bool is_round_up; - static u32 page = 0xFF; - u32 smp_cnt = 0, smp_number = 0, addr_8byte = 0; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct rt_adcsmp *smp = &dm->adcsmp; + struct rt_adcsmp_string *buf = &smp->adc_smp_buf; + u32 page; + u32 data_l = 0, data_h = 0; - odm_memory_set(p_dm_odm, adc_smp_buf->octet, 0, adc_smp_buf->length); - odm_write_1byte(p_dm_odm, 0x0106, 0x69); + #if (RTL8192F_SUPPORT) + if (dm->support_ic_type & ODM_RTL8192F) { + #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + indirect_access_sdram_8192f(dm->adapter, TX_PACKET_BUFFER, + TRUE, (u16)addr >> 3, 0, + &data_h, &data_l); + #else + odm_write_1byte(dm, R_0x0106, 0x69); + odm_set_bb_reg(dm, R_0x0140, MASKDWORD, addr >> 3); + data_l = odm_get_bb_reg(dm, R_0x0144, MASKDWORD); + data_h = odm_get_bb_reg(dm, R_0x0148, MASKDWORD); + odm_write_1byte(dm, R_0x0106, 0x0); + #endif + } else + #endif + { + /* Reg140=0x780+(addr>>12), + * addr=0x30~0x3F, total 16 pages + */ + page = addr >> 12; - dbg_print("GetTxPktBuf\n"); + if (page != smp->txff_page) { + smp->txff_page = page; + odm_set_bb_reg(dm, R_0x0140, MASKLWORD, 0x780 + page); + } + data_l = odm_read_4byte(dm, 0x8000 + (addr & 0xfff)); + data_h = odm_read_4byte(dm, 0x8000 + (addr & 0xfff) + 4); + } - value32 = odm_read_4byte(p_dm_odm, 0x7c0); - is_round_up = (bool)((value32 & BIT(31)) >> 31); - finish_addr = (value32 & 0x7FFF0000) >> 16; /*Reg7C0[30:16]: finish addr (unit: 8byte)*/ + buf->octet[buff_idx] = data_h; + buf->octet[buff_idx + 1] = data_l; +} - 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 64Byte*/ - } else { - addr = adc_smp_buf->start_pos; +void phydm_la_get_tx_pkt_buf(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct rt_adcsmp *smp = &dm->adcsmp; + struct rt_adcsmp_string *buf = &smp->adc_smp_buf; + u32 i = 0, value32 = 0; + u32 addr = 0, finish_addr = 0; /* @(unit: 8Byte)*/ + boolean is_round_up = false; + u32 addr_8byte = 0; + u32 round_up_point = 0; + #if (RTL8814B_SUPPORT) + boolean recover_success = true; + #endif - addr_8byte = addr >> 3; - if (addr_8byte > finish_addr) - smp_number = addr_8byte - finish_addr; + odm_memory_set(dm, buf->octet, 0, buf->length); + pr_debug("GetTxPktBuf\n"); + + /*@==== [Get LA Report] ==============================================*/ + if (dm->support_ic_type & ODM_RTL8192F) { + value32 = odm_read_4byte(dm, R_0x7f0); + is_round_up = (boolean)((value32 & BIT(31)) >> 31); + finish_addr = (value32 & 0x7FFF8000) >> 15; /*@16 bit (unit: 8Byte)*/ + } else { + odm_write_1byte(dm, R_0x0106, 0x69); + value32 = odm_read_4byte(dm, R_0x7c0); + is_round_up = (boolean)((value32 & BIT(31)) >> 31); + + if (dm->support_ic_type & PHYDM_LA_STORE_IN_IMEM_IC) + finish_addr = (value32 & 0x7FFF8000) >> 15; /*@16 bit (unit: 8Byte)*/ 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); - + finish_addr = (value32 & 0x7FFF0000) >> 16; /*@15bit (unit: 8Byte)*/ } - /* - 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 (DM_ODM_SUPPORT_TYPE & ODM_AP) - watchdog_stop(p_dm_odm->priv); -#endif - if (p_dm_odm->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_odm, 0x0140, MASKLWORD, 0x780 + (addr >> 12)); - data_l = odm_get_bb_reg(p_dm_odm, 0x8000 + (addr & 0xfff), MASKDWORD); - data_h = odm_get_bb_reg(p_dm_odm, 0x8000 + (addr & 0xfff) + 4, MASKDWORD); + #if (RTL8814B_SUPPORT) + recover_success = phydm_la_finish_addr_recover_8814B(dm, &finish_addr); + #endif - dbg_print("%08x%08x\n", data_h, data_l); - } + pr_debug("start_addr = ((0x%x)), end_addr = ((0x%x)), buffer_size = ((0x%x))\n", + buf->start_pos, buf->end_pos, buf->buffer_size); + if (is_round_up) { + pr_debug("buf_start(0x%x)|----2---->|finish_addr(0x%x)|----1---->|buf_end(0x%x)\n", + buf->start_pos, finish_addr << 3, buf->end_pos); + addr = (finish_addr + 2) << 3; /*+1 or +2 ??*/ + round_up_point = (buf->end_pos - addr) >> 3; /*@Byte to 8Byte*/ + smp->smp_number = smp->smp_number_max; + pr_debug("is_round_up=(%d), round_up_point=(%d), 0x7c0/0x7F0=(0x%x), smp_number=(%d)\n", + is_round_up, round_up_point, value32, smp->smp_number); } else { - 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_odm, 0x0140, MASKLWORD, 0x780 + page); + pr_debug("buf_start(0x%x)|------->|finish_addr(0x%x) |buf_end(0x%x)\n", + buf->start_pos, finish_addr << 3, buf->end_pos); + addr = buf->start_pos; + addr_8byte = addr >> 3; + smp->smp_number = DIFF_2(addr_8byte, finish_addr); - /*pDataL = 0x8000+(addr&0xfff);*/ - data_l = odm_get_bb_reg(p_dm_odm, 0x8000 + (addr & 0xfff), MASKDWORD); - data_h = odm_get_bb_reg(p_dm_odm, 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 - dbg_print("%08x%08x\n", data_h, data_l); -#else -#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 + pr_debug("is_round_up=(%d), smp_number=(%d)\n", + is_round_up, smp->smp_number); } -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - watchdog_resume(p_dm_odm->priv); -#endif + /*@==== [Get LA Patterns in TXFF] ====================================*/ + #ifdef PHYDM_COMPILE_LA_STORE_IN_IMEM + phydm_la_mv_data_2_tx_buffer(dm); + #endif + + #if (RTL8814B_SUPPORT) + if ((dm->support_ic_type & ODM_RTL8814B) && !recover_success) { + addr = buf->start_pos; + smp->smp_number = smp->smp_number_max; + } + #endif + + for (i = 0; i < smp->smp_number; i++) { + phydm_la_access_tx_pkt_buf(dm, addr, i << 1); + addr += 8; + + if (addr >= buf->end_pos) + addr = buf->start_pos; /*Ring buffer*/ + } + + /*@==== [Print LA Patterns] ==========================================*/ + if (smp->is_la_print) + phydm_la_buffer_print(dm); + + #if (RTL8197F_SUPPORT) + phydm_la_stop_dma_8197f(dm, PHYDM_RESTORE); + #endif } -void -phydm_la_mode_set_mac_iq_dump( - void *p_dm_void -) +void phydm_la_set_trig_src(void *dm_void, u8 la_trig_mode) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_ADCSMP *adc_smp = &(p_dm_odm->adcsmp); - u32 reg_value; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 reg = (dm->support_ic_type == ODM_RTL8192F) ? R_0x7f0 : R_0x7c0; - odm_write_1byte(p_dm_odm, 0x7c0, 0); /*clear all 0x7c0*/ - odm_set_mac_reg(p_dm_odm, 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_odm, 0x7c0, BIT(2), 1); /*polling bit for MAC mode*/ - odm_set_mac_reg(p_dm_odm, 0x7c0, BIT(4) | BIT3, 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_ref_mask, adc_smp->la_trig_sig_sel, adc_smp->la_dbg_port); - /*[Set MAC Debug Port]*/ - odm_set_mac_reg(p_dm_odm, 0xF4, BIT(16), 1); - odm_set_mac_reg(p_dm_odm, 0x38, 0xff0000, adc_smp->la_dbg_port); - odm_set_mac_reg(p_dm_odm, 0x7c4, MASKDWORD, adc_smp->la_mac_ref_mask); - odm_set_mac_reg(p_dm_odm, 0x7c8, MASKDWORD, adc_smp->la_trig_sig_sel); - - } else { - - adc_smp->is_bb_trigger = 1; - odm_set_mac_reg(p_dm_odm, 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_odm, 0x7c0, BIT(3), 1); /*polling bit for MAC trigger event*/ - odm_set_mac_reg(p_dm_odm, 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_odm, 0x7c0, BIT(5), 1); /* manual trigger 0x7C0[5] = 0->1*/ - } - } - - reg_value = odm_get_bb_reg(p_dm_odm, 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_la_mode_set_dma_type( - void *p_dm_void, - u8 la_dma_type -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - - dbg_print("2. [LA mode DMA setting] Dma_type = ((%d))\n", la_dma_type); -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - RT_TRACE_EX(COMP_LA_MODE, DBG_LOUD, ("2. [LA mode DMA setting] Dma_type = ((%d))\n", la_dma_type)); -#endif - - if (p_dm_odm->support_ic_type & ODM_N_ANTDIV_SUPPORT) - odm_set_bb_reg(p_dm_odm, 0x9a0, 0xf00, la_dma_type); /*0x9A0[11:8]*/ + if (la_trig_mode == PHYDM_ADC_MAC_TRIG) + odm_set_mac_reg(dm, reg, BIT(3), 1); else - odm_set_bb_reg(p_dm_odm, odm_adc_trigger_jaguar2, 0xf00, la_dma_type); /*0x95C[11:8]*/ + odm_set_mac_reg(dm, reg, BIT(3), 0); } -void -phydm_adc_smp_start( - void *p_dm_void -) +void phydm_la_set_mac_iq_dump(void *dm_void, boolean impossible_trig_condi) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_ADCSMP *adc_smp = &(p_dm_odm->adcsmp); - u8 tmp_u1b; - u8 backup_DMA, while_cnt = 0; - u8 polling_ok = false, target_polling_bit; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct rt_adcsmp *smp = &dm->adcsmp; + u32 reg_value = 0; + u32 reg1 = 0, reg2 = 0, reg3 = 0; - phydm_la_mode_bb_setting(p_dm_odm); - phydm_la_mode_set_dma_type(p_dm_odm, adc_smp->la_dma_type); - phydm_la_mode_set_trigger_time(p_dm_odm, adc_smp->la_trigger_time); - - if (p_dm_odm->support_ic_type & ODM_RTL8197F) - odm_set_bb_reg(p_dm_odm, 0xd00, BIT(26), 0x1); - else { /*for 8814A and 8822B?*/ - odm_write_1byte(p_dm_odm, 0x198c, 0x7); - odm_write_1byte(p_dm_odm, 0x8b4, 0x80); - /* odm_set_bb_reg(p_dm_odm, 0x8b4, BIT7, 1); */ + if (dm->support_ic_type & ODM_RTL8192F) { + reg1 = R_0x7f0; + reg2 = R_0x7f4; + reg3 = R_0x7f8; + } else { + reg1 = R_0x7c0; + reg2 = R_0x7c4; + reg3 = R_0x7c8; } - phydm_la_mode_set_mac_iq_dump(p_dm_odm); - /* return; */ -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - watchdog_stop(p_dm_odm->priv); + odm_write_1byte(dm, reg1, 0); /*@clear all reg1*/ + /*@Enable LA mode HW block*/ + odm_set_mac_reg(dm, reg1, BIT(0), 1); + + if (smp->la_trig_mode == PHYDM_MAC_TRIG) { + smp->la_dump_mode = LA_MAC_DBG_DUMP; + /*polling bit for MAC mode*/ + odm_set_mac_reg(dm, reg1, BIT(2), 1); + /*trigger mode for MAC*/ + odm_set_mac_reg(dm, reg1, 0x18, smp->la_trigger_edge); + pr_debug("[MAC_trig] ref_mask=(0x%x), ref_value=(0x%x), dbg_port =(0x%x)\n", + smp->la_mac_mask_or_hdr_sel, smp->la_trig_sig_sel, + smp->la_dbg_port); + /*@[Set MAC Debug Port]*/ + odm_set_mac_reg(dm, R_0xf4, BIT(16), 1); + odm_set_mac_reg(dm, R_0x38, 0xff0000, smp->la_dbg_port); + odm_set_mac_reg(dm, reg2, MASKDWORD, + smp->la_mac_mask_or_hdr_sel); + odm_set_mac_reg(dm, reg3, MASKDWORD, smp->la_trig_sig_sel); + } else { + smp->la_dump_mode = LA_BB_ADC_DUMP; + + if (smp->la_trig_mode == PHYDM_ADC_MAC_TRIG) { + /*polling bit for MAC trigger event*/ + if (impossible_trig_condi) + phydm_la_set_trig_src(dm, PHYDM_ADC_BB_TRIG); + else + phydm_la_set_trig_src(dm, PHYDM_ADC_MAC_TRIG); + + odm_set_mac_reg(dm, reg1, 0xc0, smp->la_trig_sig_sel); + + if (smp->la_trig_sig_sel == ADCSMP_TRIG_REG) { + /* @manual trigger reg1[5] = 0->1*/ + odm_set_mac_reg(dm, reg1, BIT(5), 1); + } + } + /*polling bit for BB ADC mode*/ + odm_set_mac_reg(dm, reg1, BIT(1), 1); + } + + reg_value = odm_get_bb_reg(dm, reg1, 0xff); + pr_debug("4. [Set MAC IQ dump] 0x%x[7:0]=(0x%x)\n", reg1, reg_value); + + #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + RT_TRACE_EX(COMP_LA_MODE, DBG_LOUD, + ("4. [Set MAC IQ dump] 0x%x[7:0]=(0x%x)\n", reg1, + reg_value)); + #endif +} + +void phydm_la_set_bb_dbg_port(void *dm_void, boolean impossible_trig_condi) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct rt_adcsmp *smp = &dm->adcsmp; + + u8 trig_mode = smp->la_trig_mode; + u32 trig_sel = smp->la_trig_sig_sel; + u32 dbg_port = smp->la_dbg_port; + + if (trig_mode == PHYDM_MAC_TRIG) + trig_sel = 0; /*@ignore this setting*/ + + /*set BB debug port*/ + if (impossible_trig_condi) { + dbg_port = 0xf; + trig_sel = 0; + pr_debug("[BB Setting] fake-trigger!\n"); + } + + if (phydm_set_bb_dbg_port(dm, DBGPORT_PRI_3, dbg_port)) { + pr_debug(" *Set dbg_port=(0x%x)\n", dbg_port); + } else { + dbg_port = phydm_get_bb_dbg_port_idx(dm); + pr_debug("[Set dbg_port fail!] Curr-DbgPort=0x%x\n", dbg_port); + } + + /*@debug port bit*/ + if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + odm_set_bb_reg(dm, R_0x95c, 0x1f, trig_sel); + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + odm_set_bb_reg(dm, R_0x1ce4, 0x3e000, trig_sel); + #endif + } else { + odm_set_bb_reg(dm, R_0x9a0, 0x1f, trig_sel); + } + + if (smp->la_trig_mode == PHYDM_ADC_BB_TRIG) { + pr_debug(" *Set dbg_port[BIT] = %d\n", trig_sel); + + #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + RT_TRACE_EX(COMP_LA_MODE, DBG_LOUD, + (" *Set dbg_port[BIT] = %d\n", trig_sel)); + #endif + } +} + +void phydm_la_set_bb(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct rt_adcsmp *smp = &dm->adcsmp; + + u8 trig_mode = smp->la_trig_mode; + u8 edge = smp->la_trigger_edge; + u8 smp_rate = smp->la_smp_rate; + u8 dma_type = smp->la_dma_type; + u32 dbg_port_hdr_sel = 0; + char *trig_mode_word = NULL; + + pr_debug("3. [BB Setting] mode=(%d), Edge=(%s), smp_rate=(%dM), Dma_type=(%d)\n", + trig_mode, + (edge == 0) ? "P" : "N", 80 >> smp_rate, dma_type); + + if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + if (trig_mode == PHYDM_ADC_RF0_TRIG) + dbg_port_hdr_sel = 9; /*@DBGOUT_RFC_a[31:0]*/ + else if (trig_mode == PHYDM_ADC_RF1_TRIG) + dbg_port_hdr_sel = 8; /*@DBGOUT_RFC_b[31:0]*/ + else if ((trig_mode == PHYDM_ADC_BB_TRIG) || + (trig_mode == PHYDM_ADC_MAC_TRIG)) { + if (smp->la_mac_mask_or_hdr_sel <= 0xf) + dbg_port_hdr_sel = smp->la_mac_mask_or_hdr_sel; + else + dbg_port_hdr_sel = 0; + } + + phydm_bb_dbg_port_header_sel(dm, dbg_port_hdr_sel); + + odm_set_bb_reg(dm, R_0x8b4, BIT(7), 1);/*@update rpt every pkt*/ + odm_set_bb_reg(dm, R_0x95c, 0xf00, dma_type); + /*@0: posedge, 1: negedge*/ + odm_set_bb_reg(dm, R_0x95c, BIT(31), edge); + odm_set_bb_reg(dm, R_0x95c, 0xe0, smp_rate); + /* @(0:) '80MHz' + * (1:) '40MHz' + * (2:) '20MHz' + * (3:) '10MHz' + * (4:) '5MHz' + * (5:) '2.5MHz' + * (6:) '1.25MHz' + * (7:) '160MHz (for BW160 ic)' + */ + #if (RTL8821C_SUPPORT | RTL8195B_SUPPORT) + phydm_la_clk_en(dm, true); + #endif + + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + odm_set_bb_reg(dm, R_0x1eb4, BIT(23), 0x1);/*@update rpt every pkt*/ + /*@MAC-PHY timing*/ + odm_set_bb_reg(dm, R_0x1ce4, BIT(7) | BIT(6), 0); + odm_set_bb_reg(dm, R_0x1cf4, BIT(23), 1); /*@LA mode on*/ + odm_set_bb_reg(dm, R_0x1ce4, 0x3f, dma_type); + /*@0: posedge, 1: negedge ??*/ + odm_set_bb_reg(dm, R_0x1ce4, BIT(26), edge); + odm_set_bb_reg(dm, R_0x1ce4, 0x700, smp_rate); + + phydm_la_bb_adv_trig_setting_jgr3(dm); + #endif + } else { + if (dm->support_ic_type & (ODM_RTL8197F | ODM_RTL8192F)) + odm_set_bb_reg(dm, R_0xd00, BIT(26), 0x1); /*@update rpt every pkt*/ + + #if (RTL8192F_SUPPORT) + if ((dm->support_ic_type & ODM_RTL8192F)) + /*@LA reset HW block enable for true-mac asic*/ + odm_set_bb_reg(dm, R_0x9a0, BIT(15), 1); + #endif + + odm_set_bb_reg(dm, R_0x9a0, 0xf00, dma_type); + /*@0: posedge, 1: negedge*/ + odm_set_bb_reg(dm, R_0x9a0, BIT(31), edge); + odm_set_bb_reg(dm, R_0x9a0, 0xe0, smp_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_set_mac_trigger_time(void *dm_void, u32 trigger_time_mu_sec) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 time_unit_num = 0; + u32 unit = 0; + + if (trigger_time_mu_sec < 128) + unit = 0; /*unit: 1mu sec*/ + else if (trigger_time_mu_sec < 256) + unit = 1; /*unit: 2mu sec*/ + else if (trigger_time_mu_sec < 512) + unit = 2; /*unit: 4mu sec*/ + else if (trigger_time_mu_sec < 1024) + unit = 3; /*unit: 8mu sec*/ + else if (trigger_time_mu_sec < 2048) + unit = 4; /*unit: 16mu sec*/ + else if (trigger_time_mu_sec < 4096) + unit = 5; /*unit: 32mu sec*/ + else if (trigger_time_mu_sec < 8192) + unit = 6; /*unit: 64mu sec*/ + + time_unit_num = (u8)(trigger_time_mu_sec >> unit); + + pr_debug("2. [Set Trigger Time] Trig_Time = ((%d)) * unit = ((2^%d us))\n", + time_unit_num, 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", + time_unit_num, unit)); + #endif + + if (dm->support_ic_type & ODM_RTL8192F) { + odm_set_mac_reg(dm, R_0x7fc, BIT(2) | BIT(1) | BIT(0), unit); + odm_set_mac_reg(dm, R_0x7f0, 0x7f00, (time_unit_num & 0x7f)); + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + odm_set_mac_reg(dm, R_0x7cc, BIT(18) | BIT(17) | BIT(16), unit); + odm_set_mac_reg(dm, R_0x7c0, 0x7f00, (time_unit_num & 0x7f)); + #endif + } else { + odm_set_mac_reg(dm, R_0x7cc, BIT(20) | BIT(19) | BIT(18), unit); + odm_set_mac_reg(dm, R_0x7c0, 0x7f00, (time_unit_num & 0x7f)); + } +} + +void phydm_la_set_buff_mode(void *dm_void, enum la_buff_mode mode) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct rt_adcsmp *smp = &dm->adcsmp; + struct rt_adcsmp_string *buf = &smp->adc_smp_buf; +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) + struct rtl8192cd_priv *priv = dm->priv; + u8 normal_LA_on = priv->pmib->miscEntry.normal_LA_on; #endif + u32 buff_size_base = 0; + u32 end_pos_tmp = 0; - 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_odm, 0x7c0); + smp->la_buff_mode = mode; + switch (dm->support_ic_type) { + case ODM_RTL8814A: + buff_size_base = 0x10000; + end_pos_tmp = 0x40000; + break; + case ODM_RTL8822B: + case ODM_RTL8822C: + case ODM_RTL8812F: + buff_size_base = 0x20000; /*@WIN: TX_FIFO_SIZE_LA_8822C*/ + end_pos_tmp = 0x40000; + break; + case ODM_RTL8814B: + buff_size_base = 0x30000; + end_pos_tmp = 0x60000; + break; +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) + case ODM_RTL8197F: + case ODM_RTL8198F: + case ODM_RTL8197G: + buff_size_base = 0x10000; + end_pos_tmp = (normal_LA_on == 1) ? 0x20000 : 0x10000; + break; +#endif + case ODM_RTL8192F: + buff_size_base = 0xE000; + end_pos_tmp = 0x10000; + break; + case ODM_RTL8821C: + buff_size_base = 0x8000; + end_pos_tmp = 0x10000; + break; + case ODM_RTL8195B: + buff_size_base = 0x4000; + end_pos_tmp = 0x8000; + break; + default: + pr_debug("[%s] Warning!", __func__); + break; + } - if (adc_smp->adc_smp_state != ADCSMP_STATE_SET) { - dbg_print("[state Error] adc_smp_state != ADCSMP_STATE_SET\n"); + buf->buffer_size = buff_size_base; + + if (dm->support_ic_type & FULL_BUFF_MODE_SUPPORT) { + if (mode == ADCSMP_BUFF_HALF) { + odm_set_mac_reg(dm, R_0x7cc, BIT(30), 0); + } else { + buf->buffer_size = buf->buffer_size << 1; + odm_set_mac_reg(dm, R_0x7cc, BIT(30), 1); + } + } + + buf->end_pos = end_pos_tmp; + buf->start_pos = end_pos_tmp - buf->buffer_size; + smp->smp_number_max = buf->buffer_size >> 3; + + PHYDM_DBG(dm, DBG_TMP, + "start_addr=(0x%x), end_addr=(0x%x), buffer_size=(0x%x), smp_number_max=(%d)\n", + buf->start_pos, buf->end_pos, buf->buffer_size, + smp->smp_number_max); +} + +void phydm_la_adc_smp_start(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct rt_adcsmp *smp = &dm->adcsmp; + u8 tmp_u1b = 0; + u8 i = 0; + u8 polling_bit = 0; + boolean polling_ok = false; + boolean impossible_trig_condi = (smp->en_fake_trig) ? true : false; + + #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + RT_TRACE_EX(COMP_LA_MODE, DBG_LOUD, + ("1. [BB Setting] Mode=(%d), DbgPort=(0x%x), Edge=(%d), SmpRate=(%d), Trig_Sel=(0x%x), Dma_type=(%d)\n", + smp->la_trig_mode, smp->la_dbg_port, smp->la_trigger_edge, + smp->la_smp_rate, smp->la_trig_sig_sel, smp->la_dma_type)); + #endif + pr_debug("1. [BB Setting] trig_mode = ((%d)), dbg_port = ((0x%x)), Trig_Edge = ((%d)), smp_rate = ((%d)), Trig_Sel = ((0x%x)), Dma_type = ((%d))\n", + smp->la_trig_mode, smp->la_dbg_port, smp->la_trigger_edge, + smp->la_smp_rate, smp->la_trig_sig_sel, smp->la_dma_type); + + phydm_la_set_mac_trigger_time(dm, smp->la_trigger_time); + phydm_la_set_bb(dm); + phydm_la_set_bb_dbg_port(dm, impossible_trig_condi); + phydm_la_set_mac_iq_dump(dm, impossible_trig_condi); + + #if (DM_ODM_SUPPORT_TYPE & ODM_AP) + watchdog_stop(dm->priv); + #endif + + if (impossible_trig_condi) { + ODM_delay_ms(100); + phydm_la_set_bb_dbg_port(dm, false); + + if (smp->la_trig_mode == PHYDM_ADC_MAC_TRIG) { + phydm_la_set_trig_src(dm, PHYDM_ADC_MAC_TRIG); + } + } +#if RTL8198F_SUPPORT + phydm_la_pre_run(dm); +#endif + polling_bit = (smp->la_dump_mode == LA_BB_ADC_DUMP) ? BIT(1) : BIT(2); + do { /*Polling time always use 100ms, when it exceed 2s, break loop*/ + if (dm->support_ic_type & ODM_RTL8192F) + tmp_u1b = odm_read_1byte(dm, R_0x7f0); + else + tmp_u1b = odm_read_1byte(dm, R_0x7c0); + + pr_debug("[%d] polling rpt=((0x%x))\n", i, tmp_u1b); + + if (smp->adc_smp_state != ADCSMP_STATE_SET) { + pr_debug("[state Error] state != ADCSMP_STATE_SET\n"); break; - } else if (tmp_u1b & target_polling_bit) { + } else if (tmp_u1b & polling_bit) { ODM_delay_ms(100); - while_cnt = while_cnt + 1; + i++; continue; } else { - dbg_print("[LA Query OK] polling_bit=((0x%x))\n", target_polling_bit); + pr_debug("[LA Query OK] polling_bit=%d\n", polling_bit); polling_ok = true; - if (p_dm_odm->support_ic_type & ODM_RTL8197F) - odm_set_bb_reg(p_dm_odm, 0x7c0, BIT(0), 0x0); break; } - } while (while_cnt < 20); - -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - watchdog_resume(p_dm_odm->priv); -#if (RTL8197F_SUPPORT) - if (p_dm_odm->support_ic_type & ODM_RTL8197F) { - /*Stop DMA*/ - backup_DMA = odm_get_mac_reg(p_dm_odm, 0x300, MASKLWORD); - odm_set_mac_reg(p_dm_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(p_dm_odm->priv)->init_ddma_handler(p_dm_odm->priv, OCPBASE_IMEM, OCPBASE_TXBUF, 0x10000); - } -#endif -#endif - - if (adc_smp->adc_smp_state == ADCSMP_STATE_SET) { + } while (i < 20); + if (smp->adc_smp_state == ADCSMP_STATE_SET) { if (polling_ok) - phydm_la_get_tx_pkt_buf(p_dm_odm); + phydm_la_get_tx_pkt_buf(dm); else - dbg_print("[Polling timeout]\n"); + pr_debug("[Polling timeout]\n"); } -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - if (p_dm_odm->support_ic_type & ODM_RTL8197F) - odm_set_mac_reg(p_dm_odm, 0x300, 0x7fff, backup_DMA); /*Resume DMA*/ -#endif + #if (DM_ODM_SUPPORT_TYPE & ODM_AP) + watchdog_resume(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 + #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + if (smp->adc_smp_state == ADCSMP_STATE_SET) + 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 + pr_debug("[LA mode] la_count = ((%d))\n", smp->la_count); + #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + RT_TRACE_EX(COMP_LA_MODE, DBG_LOUD, + ("[LA mode] la_count = ((%d))\n", smp->la_count)); + #endif + phydm_la_stop(dm); - adc_smp_stop(p_dm_odm); + if (smp->la_count == 0) { + pr_debug("LA Dump finished ---------->\n\n\n"); + phydm_release_bb_dbg_port(dm); - if (adc_smp->la_count == 0) { - dbg_print("LA Dump finished ---------->\n\n\n"); - /**/ + #if (RTL8821C_SUPPORT | RTL8195B_SUPPORT) + phydm_la_clk_en(dm, false); + #endif } else { - adc_smp->la_count--; - dbg_print("LA Dump more ---------->\n\n\n"); - adc_smp_set(p_dm_odm, adc_smp->la_trig_mode, adc_smp->la_trig_sig_sel, adc_smp->la_dma_type, adc_smp->la_trigger_time, 0); + smp->la_count--; + pr_debug("LA Dump more ---------->\n\n\n"); + phydm_la_set(dm); + } +} + +void phydm_la_set(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + boolean is_set_success = true; + struct rt_adcsmp *smp = &dm->adcsmp; + + if (smp->adc_smp_state != ADCSMP_STATE_IDLE) + is_set_success = false; + else if (smp->adc_smp_buf.length == 0) + is_set_success = phydm_la_buffer_allocate(dm); + + if (!is_set_success) { + pr_debug("[LA Set Fail] LA_State=(%d)\n", smp->adc_smp_state); + return; } -} + smp->adc_smp_state = ADCSMP_STATE_SET; -#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_odm = &p_hal_data->DM_OutSrc; - struct _RT_ADCSMP *adc_smp = &(p_dm_odm->adcsmp); - - dbg_print("[WorkItem Call back] LA_State=((%d))\n", adc_smp->adc_smp_state); - phydm_adc_smp_start(p_dm_odm); -} -#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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - bool is_set_success = true; - struct _RT_ADCSMP *adc_smp = &(p_dm_odm->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_odm); -#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); + pr_debug("[LA Set Success] LA_State=(%d)\n", 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; - } + pr_debug("ADCSmp_work_item_index=(%d)\n", smp->la_work_item_index); + + if (smp->la_work_item_index != 0) { + odm_schedule_work_item(&smp->adc_smp_work_item_1); + smp->la_work_item_index = 0; + } else { + odm_schedule_work_item(&smp->adc_smp_work_item); + smp->la_work_item_index = 1; + } #else - phydm_adc_smp_start(p_dm_odm); + phydm_la_adc_smp_start(dm); #endif - } else - dbg_print("[LA Set Fail] LA_State=((%d))\n", adc_smp->adc_smp_state); - - } +void phydm_la_cmd_fast(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct rt_adcsmp *smp = &dm->adcsmp; + u32 var[10] = {0}; + u8 bw = *dm->band_width; + + if (bw > 2) { + PDM_SNPF(*_out_len, *_used, output + *_used, *_out_len - *_used, + "Not Support for BW > %dM\n", 20 << bw); + return; + } + + PHYDM_SSCANF(input[2], DCMD_HEX, &var[0]); + + if (var[0] <= 10) { /* CCA P-edge trigger*/ + smp->la_trig_mode = 1; + smp->la_trig_sig_sel = 2; + smp->la_trigger_time = ((smp->smp_number_max >> (bw + 1)) / 10) + - (2 << (2 - bw)) - (2 - bw); + smp->la_mac_mask_or_hdr_sel = 0; + smp->la_trigger_edge = 0; + smp->la_smp_rate = 2 - bw; + smp->la_count = 0; + if (var[0] == 0) { + smp->la_dma_type = 5; + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + smp->la_dbg_port = 0x870; + else + smp->la_dbg_port = 0x210; + } else if (var[0] == 1) { + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + smp->la_dma_type = 4; + smp->la_dbg_port = 0x392; + } else { + smp->la_dma_type = 5; + smp->la_dbg_port = 0xa44; + } + } + } + + PDM_SNPF(*_out_len, *_used, output + *_used, *_out_len - *_used, + "echo lamode 1 %d %d %d %d %d %x %d %d %d\n", + smp->la_trig_mode, smp->la_trig_sig_sel, smp->la_dma_type, + smp->la_trigger_time, smp->la_mac_mask_or_hdr_sel, + smp->la_dbg_port, smp->la_trigger_edge, smp->la_smp_rate, + smp->la_count); + + phydm_la_set(dm); +} + +void phydm_la_cmd(void *dm_void, char input[][16], u32 *_used, char *output, + u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct rt_adcsmp *smp = &dm->adcsmp; + u8 trig_mode = 0, dma_data_sig_sel = 0; + u32 trig_sig_sel = 0; + u32 trigger_time_mu_sec = 0; + char help[] = "-h"; + u32 var1[10] = {0}; + u32 used = *_used; + u32 out_len = *_out_len; + + if (!(dm->support_ic_type & PHYDM_IC_SUPPORT_LA_MODE)) + return; + +#ifdef PHYDM_COMPILE_LA_STORE_IN_IMEM + if (dm->support_ic_type & PHYDM_LA_STORE_IN_IMEM_IC) { + if (dm->is_download_fw) + return; + } + #if RTL8198F_SUPPORT + if (dm->support_ic_type & ODM_RTL8198F) { + if (!*dm->mp_mode && !dm->priv->pmib->miscEntry.normal_LA_on) { + pr_debug("plz re-set normal_LA_on = 1 & DnUp.\n"); + return; + } + } + #endif +#endif + + PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); + + /*@dbg_print("echo cmd input_num = %d\n", input_num);*/ + + if ((strcmp(input[1], help) == 0)) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "=====[LA Mode Help] =============================\n"); + /*Trigger*/ + PDM_SNPF(out_len, used, output + used, out_len - used, + "BB_trig: 1 0 {DbgPort Bit} {DMA#} {TrigTime} {DbgPort_head(Jgr2)}\n\t{DbgPort} {Edge: 0(P),1(N)} {f_smp:80 >> N} {Capture num}\n\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "MAC_trig: 1 1 {0-ok/1-fail/2-cca} {DMA#} {TrigTime} {DbgPort_head(Jgr2)}\n\t{DbgPort} {N/A} {f_smp:80 >> N} {Cpture num}\n\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "All: {En} {0:ADC_BB_trig,1:ADC MAC_trig,2:RF0,3:RF1,4:MAC}\n\t{BB:dbg_port[bit],BB_MAC:0-ok/1-fail/2-cca,MAC:ref} {DMA#} {TrigTime}\n\t{DbgPort_head/ref_mask} {dbg_port} {0:P_Edge, 1:N_Edge} {SpRate:0-80M,1-40M,2-20M} {Capture num}\n\n"); + /*Adv-Trig*/ + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + PDM_SNPF(out_len, used, output + used, out_len - used, + "adv show\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "adv {adv_trig_en} {0:And[0]_disable} {en}\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "adv {adv_trig_en} {1~3: And[3:0]} {Sel} {Val} {Inv}\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "adv {adv_trig_en} {4: And[4]} {BitMask} {BitVal} {Inv}\n\n"); + #endif + /*Setting*/ + PDM_SNPF(out_len, used, output + used, out_len - used, + "set {1:tx_buff_size} {0: half, 1:full}\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "set {2:Fake Trigger} {en}\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "set {3:Auto Print} {en}\n\n"); + /*Print*/ + PDM_SNPF(out_len, used, output + used, out_len - used, + "print\n\n"); + + /*Fast Trigger*/ + PDM_SNPF(out_len, used, output + used, out_len - used, + "fast {0: CCA trig & CCA Dbg Port}\n"); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "fast {1: CCA trig & EVM Dbg Port}\n"); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "=================================================\n"); + } else if ((strcmp(input[1], "print") == 0)) { + phydm_la_buffer_print(dm); + } else if ((strcmp(input[1], "fast") == 0)) { + phydm_la_cmd_fast(dm, input, &used, output, &out_len); +#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + } else if ((strcmp(input[1], "adv") == 0)) { + phydm_la_bb_adv_cmd_jgr3(dm, input, &used, output, &out_len); +#endif + } else if ((strcmp(input[1], "set") == 0)) { + PHYDM_SSCANF(input[2], DCMD_DECIMAL, &var1[1]); + + if (var1[1] == 1) { + PHYDM_SSCANF(input[3], DCMD_DECIMAL, &var1[2]); + phydm_la_set_buff_mode(dm, (enum la_buff_mode)var1[2]); + PDM_SNPF(out_len, used, output + used, out_len - used, + "Buff_mode=(%d/2)\n", smp->la_buff_mode + 1); + } else if (var1[1] == 2) { + PHYDM_SSCANF(input[3], DCMD_DECIMAL, &var1[2]); + smp->en_fake_trig = (boolean)var1[2]; + + PDM_SNPF(out_len, used, output + used, out_len - used, + "en_fake_trig=(%d)\n", smp->en_fake_trig); + } else if (var1[1] == 3) { + PHYDM_SSCANF(input[3], DCMD_DECIMAL, &var1[2]); + smp->is_la_print = (boolean)var1[2]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "Auto print=(%d)\n", smp->is_la_print); + } + } else if (var1[0] == 1) { + PHYDM_SSCANF(input[2], DCMD_DECIMAL, &var1[1]); + + smp->la_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]); + smp->la_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]); + + smp->la_dma_type = (u8)var1[3]; + smp->la_trigger_time = var1[4]; /*unit: us*/ + smp->la_mac_mask_or_hdr_sel = var1[5]; + smp->la_dbg_port = var1[6]; + smp->la_trigger_edge = (u8)var1[7]; + smp->la_smp_rate = (u8)(var1[8] & 0x7); + smp->la_count = var1[9]; + + pr_debug("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 + + PDM_SNPF(out_len, used, 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); + PDM_SNPF(out_len, used, 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, + smp->la_mac_mask_or_hdr_sel, smp->la_dbg_port); + PDM_SNPF(out_len, used, output + used, out_len - used, + "h.Trig_edge = ((%d)), i.smp rate = ((%d MHz)), j.Cap_num = ((%d))\n", + smp->la_trigger_edge, (80 >> smp->la_smp_rate), + smp->la_count); + + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + PDM_SNPF(out_len, used, output + used, out_len - used, + "k.en_new_bbtrigger = ((%d))\n", + smp->adv_trig_table.la_en_new_bbtrigger); + #endif + + phydm_la_set(dm); + } else { + phydm_la_stop(dm); + PDM_SNPF(out_len, used, output + used, out_len - used, + "Disable LA mode\n"); + } + + *_used = used; + *_out_len = out_len; +} + +void phydm_la_stop(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct rt_adcsmp *smp = &dm->adcsmp; + + smp->adc_smp_state = ADCSMP_STATE_IDLE; + + PHYDM_DBG(dm, DBG_TMP, "[LA_Stop] LA_state = %d\n", smp->adc_smp_state); +} + +void phydm_la_init(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct rt_adcsmp *smp = &dm->adcsmp; + struct rt_adcsmp_string *buf = &smp->adc_smp_buf; + + smp->adc_smp_state = ADCSMP_STATE_IDLE; + smp->is_la_print = true; + smp->en_fake_trig = false; + smp->txff_page = 0xffffffff; + phydm_la_set_buff_mode(dm, ADCSMP_BUFF_HALF); + + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + phydm_la_bb_adv_reset_jgr3(dm); + #endif +} + +void adc_smp_de_init(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + phydm_la_stop(dm); + phydm_la_buffer_release(dm); +} + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) +void adc_smp_work_item_callback(void *context) +{ + void *adapter = (void *)context; + PHAL_DATA_TYPE hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + struct dm_struct *dm = &hal_data->DM_OutSrc; + struct rt_adcsmp *smp = &dm->adcsmp; + + pr_debug("[WorkItem Call back] LA_State=(%d)\n", smp->adc_smp_state); + phydm_la_adc_smp_start(dm); +} +#endif + +#if 0 #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 -) +adc_smp_query(void *dm_void, ULONG info_buf_length, void *info_buf, + PULONG bytes_written) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_ADCSMP *adc_smp = &(p_dm_odm->adcsmp); - enum rt_status ret_status = RT_STATUS_SUCCESS; - struct _RT_ADCSMP_STRING *adc_smp_buf = &(adc_smp->adc_smp_buf); + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct rt_adcsmp *smp = &dm->adcsmp; + enum rt_status ret_status = RT_STATUS_SUCCESS; + struct rt_adcsmp_string *buf = &smp->adc_smp_buf; - dbg_print("[%s] LA_State=((%d))", __func__, adc_smp->adc_smp_state); + pr_debug("[%s] LA_State=((%d))", __func__, smp->adc_smp_state); - if (information_buffer_length != adc_smp_buf->buffer_size) { + if (info_buf_length != buf->buffer_size) { *bytes_written = 0; ret_status = RT_STATUS_RESOURCE; - } else if (adc_smp_buf->length != adc_smp_buf->buffer_size) { + } else if (buf->length != buf->buffer_size) { *bytes_written = 0; ret_status = RT_STATUS_RESOURCE; - } else if (adc_smp->adc_smp_state != ADCSMP_STATE_QUERY) { + } else if (smp->adc_smp_state != ADCSMP_STATE_QUERY) { *bytes_written = 0; ret_status = RT_STATUS_PENDING; } else { - odm_move_memory(p_dm_odm, information_buffer, adc_smp_buf->octet, adc_smp_buf->buffer_size); - *bytes_written = adc_smp_buf->buffer_size; + odm_move_memory(dm, info_buf, buf->octet, buf->buffer_size); + *bytes_written = buf->buffer_size; - adc_smp->adc_smp_state = ADCSMP_STATE_IDLE; + smp->adc_smp_state = ADCSMP_STATE_IDLE; } - dbg_print("Return status %d\n", ret_status); + pr_debug("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 -) +void adc_smp_query(void *dm_void, void *output, u32 out_len, u32 *pused) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_ADCSMP *adc_smp = &(p_dm_odm->adcsmp); - struct _RT_ADCSMP_STRING *adc_smp_buf = &(adc_smp->adc_smp_buf); + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct rt_adcsmp *smp = &dm->adcsmp; + struct rt_adcsmp_string *buf = &smp->adc_smp_buf; u32 used = *pused; - u32 i; + u32 i = 0; +#if 0 /* struct timespec t; */ /* rtw_get_current_timespec(&t); */ +#endif - dbg_print("%s adc_smp_state %d", __func__, adc_smp->adc_smp_state); + pr_debug("%s adc_smp_state %d", __func__, 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])); + for (i = 0; i < (buf->length >> 2) - 2; i += 2) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "%08x%08x\n", buf->octet[i], 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)); */ + PDM_SNPF(out_len, used, output + used, out_len - used, "\n"); + /* PDM_SNPF(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 -) +s32 adc_smp_get_sample_counts(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_ADCSMP *adc_smp = &(p_dm_odm->adcsmp); - struct _RT_ADCSMP_STRING *adc_smp_buf = &(adc_smp->adc_smp_buf); + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct rt_adcsmp *smp = &dm->adcsmp; + struct rt_adcsmp_string *buf = &smp->adc_smp_buf; - return (adc_smp_buf->length >> 2) - 2; + return (buf->length >> 2) - 2; } -s32 -adc_smp_query_single_data( - void *p_dm_void, - void *output, - u32 out_len, - u32 index -) +s32 adc_smp_query_single_data(void *dm_void, void *output, u32 out_len, u32 idx) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_ADCSMP *adc_smp = &(p_dm_odm->adcsmp); - struct _RT_ADCSMP_STRING *adc_smp_buf = &(adc_smp->adc_smp_buf); + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct rt_adcsmp *smp = &dm->adcsmp; + struct rt_adcsmp_string *buf = &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")); + /* @dbg_print("%s adc_smp_state %d\n", __func__,*/ + /* smp->adc_smp_state);*/ + if (smp->adc_smp_state != ADCSMP_STATE_QUERY) { + PDM_SNPF(out_len, used, 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])); + if (idx < ((buf->length >> 2) - 2)) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "%08x%08x\n", buf->octet[idx], buf->octet[idx + 1]); } return 0; } - +#endif #endif -void -adc_smp_stop( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_ADCSMP *adc_smp = &(p_dm_odm->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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_ADCSMP *adc_smp = &(p_dm_odm->adcsmp); - struct _RT_ADCSMP_STRING *adc_smp_buf = &(adc_smp->adc_smp_buf); - - adc_smp->adc_smp_state = ADCSMP_STATE_IDLE; - - if (p_dm_odm->support_ic_type & ODM_RTL8814A) { - adc_smp_buf->start_pos = 0x30000; - adc_smp_buf->buffer_size = 0x10000; - } else if (p_dm_odm->support_ic_type & ODM_RTL8822B) { - adc_smp_buf->start_pos = 0x20000; - adc_smp_buf->buffer_size = 0x20000; - } else if (p_dm_odm->support_ic_type & ODM_RTL8197F) { - adc_smp_buf->start_pos = 0x00000; - adc_smp_buf->buffer_size = 0x10000; - } else if (p_dm_odm->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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_ADCSMP *adc_smp = &(p_dm_odm->adcsmp); - struct _RT_ADCSMP_STRING *adc_smp_buf = &(adc_smp->adc_smp_buf); - - adc_smp_stop(p_dm_odm); - - if (adc_smp_buf->length != 0x0) { - odm_free_memory(p_dm_odm, 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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_ADCSMP *adc_smp = &(p_dm_odm->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; - - dbg_print("1. [LA mode bb_setting] trig_mode = ((%d)), dbg_port = ((0x%x)), Trig_Edge = ((%d)), smp_rate = ((%d)), Trig_Sel = ((0x%x))\n", - trig_mode, dbg_port, is_trigger_edge, sampling_rate, trig_sig_sel); - -#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))\n", - trig_mode, dbg_port, is_trigger_edge, sampling_rate, trig_sig_sel)); -#endif - - if (trig_mode == PHYDM_MAC_TRIG) - trig_sig_sel = 0; /*ignore this setting*/ - - if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) { - - if (trig_mode == PHYDM_ADC_RF0_TRIG) { - odm_set_bb_reg(p_dm_odm, 0x8f8, BIT(25) | BIT24 | BIT23 | BIT22, 9); /*DBGOUT_RFC_a[31:0]*/ - } else if (trig_mode == PHYDM_ADC_RF1_TRIG) { - odm_set_bb_reg(p_dm_odm, 0x8f8, BIT(25) | BIT24 | BIT23 | BIT22, 8); /*DBGOUT_RFC_b[31:0]*/ - } else - odm_set_bb_reg(p_dm_odm, 0x8f8, BIT(25) | BIT(24) | BIT(23) | BIT(22), 0); - /* - (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}' - */ - - odm_set_bb_reg(p_dm_odm, 0x198C, BIT(2) | BIT1 | BIT0, 7); /*disable dbg clk gating*/ - - /*dword= odm_get_bb_reg(p_dm_odm, 0x8FC, MASKDWORD);*/ - /*dbg_print("dbg_port = ((0x%x))\n", dword);*/ - odm_set_bb_reg(p_dm_odm, 0x95C, 0x1f, trig_sig_sel); /*0x95C[4:0], BB debug port bit*/ - odm_set_bb_reg(p_dm_odm, 0x8FC, MASKDWORD, dbg_port); - odm_set_bb_reg(p_dm_odm, 0x95C, BIT(31), is_trigger_edge); /*0: posedge, 1: negedge*/ - odm_set_bb_reg(p_dm_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_set_bb_reg(p_dm_odm, 0x9a0, 0x1f, trig_sig_sel); /*0x9A0[4:0], BB debug port bit*/ - odm_set_bb_reg(p_dm_odm, 0x908, MASKDWORD, dbg_port); - odm_set_bb_reg(p_dm_odm, 0x9A0, BIT(31), is_trigger_edge); /*0: posedge, 1: negedge*/ - odm_set_bb_reg(p_dm_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)' - */ - } -} - -void -phydm_la_mode_set_trigger_time( - void *p_dm_void, - u32 trigger_time_mu_sec -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (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("3. [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_odm, 0x7cc, BIT(20) | BIT(19) | BIT(18), time_unit); - odm_set_mac_reg(p_dm_odm, 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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_ADCSMP *adc_smp = &(p_dm_odm->adcsmp); - u8 trig_mode, dma_data_sig_sel; - u32 trig_sig_sel; - bool is_enable_la_mode, is_trigger_edge; - u32 dbg_port, trigger_time_mu_sec; - u32 mac_ref_signal_mask; - u8 sampling_rate = 0, i; - char help[] = "-h"; - u32 var1[10] = {0}; - u32 used = *_used; - u32 out_len = *_out_len; - - if (p_dm_odm->support_ic_type & PHYDM_IC_SUPPORT_LA_MODE) { - - PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); - is_enable_la_mode = (bool)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 {polling_time/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_ref_mask = 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.mac_ref_mask = ((0x%x)), g.dbg_port = ((0x%x))\n", trigger_time_mu_sec, adc_smp->la_mac_ref_mask, 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_odm, trig_mode, trig_sig_sel, dma_data_sig_sel, trigger_time_mu_sec, 0); - - } else { - adc_smp_stop(p_dm_odm); - PHYDM_SNPRINTF((output + used, out_len - used, "Disable LA mode\n")); - } - } -} - -#endif /*endif PHYDM_LA_MODE_SUPPORT == 1*/ +#endif /*@endif PHYDM_LA_MODE_SUPPORT*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_adc_sampling.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_adc_sampling.h index 6ebd7f6d7195..c595a392a584 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_adc_sampling.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_adc_sampling.h @@ -1,19 +1,61 @@ /* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + #ifndef __INC_ADCSMP_H #define __INC_ADCSMP_H -#define DYNAMIC_LA_MODE "1.0" /*2016.07.15 Dino */ +#if (PHYDM_LA_MODE_SUPPORT) -#if (PHYDM_LA_MODE_SUPPORT == 1) +#define DYNAMIC_LA_MODE "4.0" -struct _RT_ADCSMP_STRING { - u32 *octet; - u32 length; - u32 buffer_size; - u32 start_pos; +/* @1 ============================================================ + * 1 Definition + * 1 ============================================================ + */ + +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) +#if (RTL8197F_SUPPORT || RTL8198F_SUPPORT || RTL8197G_SUPPORT) + #define PHYDM_COMPILE_LA_STORE_IN_IMEM +#endif +#endif + +#define PHYDM_LA_STORE_IN_IMEM_IC (ODM_RTL8197F | ODM_RTL8198F | ODM_RTL8197G) + +#define FULL_BUFF_MODE_SUPPORT (ODM_RTL8821C | ODM_RTL8195B | ODM_RTL8822C |\ + ODM_RTL8812F | ODM_RTL8814B) + +/* @ ============================================================ + * enumrate + * ============================================================ + */ +enum la_dump_mode { + LA_BB_ADC_DUMP = 0, + LA_MAC_DBG_DUMP = 1 }; - enum rt_adcsmp_trig_sel { PHYDM_ADC_BB_TRIG = 0, PHYDM_ADC_MAC_TRIG = 1, @@ -22,7 +64,6 @@ enum rt_adcsmp_trig_sel { PHYDM_MAC_TRIG = 4 }; - enum rt_adcsmp_trig_sig_sel { ADCSMP_TRIG_CRCOK = 0, ADCSMP_TRIG_CRCFAIL = 1, @@ -30,119 +71,119 @@ enum rt_adcsmp_trig_sig_sel { ADCSMP_TRIG_REG = 3 }; - enum rt_adcsmp_state { - ADCSMP_STATE_IDLE = 0, - ADCSMP_STATE_SET = 1, - ADCSMP_STATE_QUERY = 2 + ADCSMP_STATE_IDLE = 0, + ADCSMP_STATE_SET = 1, + ADCSMP_STATE_QUERY = 2 }; +enum la_buff_mode { + ADCSMP_BUFF_HALF = 0, + ADCSMP_BUFF_ALL = 1 /*Only use in MP Driver*/ +}; -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_ref_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; +/* @ ============================================================ + * structure + * ============================================================ + */ + +struct rt_adcsmp_string { + u32 *octet; + u32 length; + u32 buffer_size; + u32 start_pos; + u32 end_pos; /*@buf addr*/ +}; + +#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT +struct la_adv_trig { + boolean la_en_new_bbtrigger; + boolean la_ori_bb_dis; + u8 la_and1_sel; + u8 la_and1_val; + boolean la_and1_inv; + u8 la_and2_sel; + u8 la_and2_val; + boolean la_and2_inv; + u8 la_and3_sel; + u8 la_and3_val; + boolean la_and3_inv; + u32 la_and4_mask; + u32 la_and4_bitmap; + boolean la_and4_inv; +}; +#endif + +struct rt_adcsmp { + struct rt_adcsmp_string adc_smp_buf; + enum rt_adcsmp_state adc_smp_state; + enum la_buff_mode la_buff_mode; + enum la_dump_mode la_dump_mode; + u8 la_trig_mode; + u32 la_trig_sig_sel; + u8 la_dma_type; + u32 la_trigger_time; + /*@1.BB mode: Dbg port header sel, 2.MAC mode: for reference mask*/ + u32 la_mac_mask_or_hdr_sel; + u32 la_dbg_port; + u8 la_trigger_edge; + u8 la_smp_rate; + u32 la_count; + u32 smp_number; + u32 smp_number_max; + u32 txff_page; + boolean is_la_print; + boolean en_fake_trig; +#if (RTL8197F_SUPPORT) + u32 backup_dma; +#endif #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - RT_WORK_ITEM adc_smp_work_item; - RT_WORK_ITEM adc_smp_work_item_1; + u8 la_work_item_index; + RT_WORK_ITEM adc_smp_work_item; + RT_WORK_ITEM adc_smp_work_item_1; +#endif + +#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + struct la_adv_trig adv_trig_table; #endif }; +/* @ ============================================================ + * Function Prototype + * ============================================================ + */ + +void phydm_la_set(void *dm_void); + +void phydm_la_cmd(void *dm_void, char input[][16], u32 *_used, char *output, + u32 *_out_len); + +void phydm_la_stop(void *dm_void); + +void phydm_la_init(void *dm_void); + +void adc_smp_de_init(void *dm_void); + #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -void -adc_smp_work_item_callback( - void *p_context -); +void adc_smp_work_item_callback(void *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 0 #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 -); +enum rt_status adc_smp_query(void *dm_void, ULONG info_buf_length, + void *info_buf, 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 -); +void adc_smp_query(void *dm_void, void *output, u32 out_len, u32 *pused); -s32 -adc_smp_query_single_data( - void *p_dm_void, - void *output, - u32 out_len, - u32 index -); +s32 adc_smp_get_sample_counts(void *dm_void); + +s32 adc_smp_query_single_data(void *dm_void, void *output, u32 out_len, + u32 idx); +#endif +#endif -#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/rtl8188eu/hal/phydm/phydm_antdect.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_antdect.c index 2acac2a2a756..fcee74fe673f 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_antdect.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_antdect.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,15 +9,20 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ /* ************************************************************ * include files @@ -25,47 +31,55 @@ #include "mp_precomp.h" #include "phydm_precomp.h" -/* #if( DM_ODM_SUPPORT_TYPE & (ODM_WIN |ODM_CE)) */ -#if (defined(CONFIG_ANT_DETECTION)) +#ifdef CONFIG_ANT_DETECTION -/* IS_ANT_DETECT_SUPPORT_SINGLE_TONE(adapter) +/* @IS_ANT_DETECT_SUPPORT_SINGLE_TONE(adapter) * IS_ANT_DETECT_SUPPORT_RSSI(adapter) * IS_ANT_DETECT_SUPPORT_PSD(adapter) */ -/* 1 [1. Single Tone method] =================================================== */ +/* @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 -) +void odm_sw_ant_div_construct_scan_chnl( + void *adapter, + u8 scan_chnl) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _sw_antenna_switch_ *p_dm_swat_table = &p_dm_odm->dm_swat_table; - struct _ADAPTER *p_adapter = p_dm_odm->adapter; +} - u8 bt_ant_num = BT_GetPgAntNum(p_adapter); +u8 odm_sw_ant_div_select_scan_chnl( + void *adapter) +{ + return 0; +} + +void odm_single_dual_antenna_default_setting( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct sw_antenna_switch *dm_swat_table = &dm->dm_swat_table; + void *adapter = dm->adapter; + + u8 bt_ant_num = BT_GetPgAntNum(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; + dm_swat_table->ANTA_ON = true; + 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; + dm_swat_table->ANTA_ON = true; + dm_swat_table->ANTB_ON = false; } else RT_ASSERT(false, ("Incorrect antenna number!!\n")); } - -/* 2 8723A ANT DETECT +/* @2 8723A ANT DETECT * * Description: * Implement IQK single tone for RF DPK loopback and BB PSD scanning. @@ -73,792 +87,806 @@ odm_single_dual_antenna_default_setting( * * Added by Roger, 2011.12.15 * */ -bool +boolean odm_single_dual_antenna_detection( - void *p_dm_void, - u8 mode -) + void *dm_void, + u8 mode) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTER *p_adapter = p_dm_odm->adapter; - struct _sw_antenna_switch_ *p_dm_swat_table = &p_dm_odm->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; - bool is_result = true; - u32 afe_backup[16]; - u32 AFE_REG_8723A[16] = { - 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, - REG_FPGA0_XCD_SWITCH_CONTROL, REG_BLUE_TOOTH - }; + struct dm_struct *dm = (struct dm_struct *)dm_void; + void *adapter = dm->adapter; + struct sw_antenna_switch *dm_swat_table = &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; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_single_dual_antenna_detection()============>\n")); + PHYDM_DBG(dm, DBG_ANT_DIV, "%s============>\n", __func__); - - if (!(p_dm_odm->support_ic_type & ODM_RTL8723B)) + if (!(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)) + if (!IS_ANT_DETECT_SUPPORT_SINGLE_TONE(((PADAPTER)adapter))) return is_result; - /* 1 Backup Current RF/BB Settings */ + /* @1 Backup Current RF/BB Settings */ - current_channel = odm_get_rf_reg(p_dm_odm, ODM_RF_PATH_A, ODM_CHANNEL, RFREGOFFSETMASK); - rf_loop_reg = odm_get_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x00, RFREGOFFSETMASK); - if (p_dm_odm->support_ic_type & ODM_RTL8723B) { - reg92c = odm_get_bb_reg(p_dm_odm, REG_DPDT_CONTROL, MASKDWORD); - reg930 = odm_get_bb_reg(p_dm_odm, rfe_ctrl_anta_src, MASKDWORD); - reg948 = odm_get_bb_reg(p_dm_odm, REG_S0_S1_PATH_SWITCH, MASKDWORD); - regb2c = odm_get_bb_reg(p_dm_odm, REG_AGC_TABLE_SELECT, MASKDWORD); - reg064 = odm_get_mac_reg(p_dm_odm, REG_SYM_WLBT_PAPE_SEL, BIT(29)); - odm_set_bb_reg(p_dm_odm, REG_DPDT_CONTROL, 0x3, 0x1); - odm_set_bb_reg(p_dm_odm, rfe_ctrl_anta_src, 0xff, 0x77); - odm_set_mac_reg(p_dm_odm, REG_SYM_WLBT_PAPE_SEL, BIT(29), 0x1); /* dbg 7 */ - odm_set_bb_reg(p_dm_odm, REG_S0_S1_PATH_SWITCH, 0x3c0, 0x0);/* dbg 8 */ - odm_set_bb_reg(p_dm_odm, REG_AGC_TABLE_SELECT, BIT(31), 0x0); + current_channel = odm_get_rf_reg(dm, RF_PATH_A, ODM_CHANNEL, RFREGOFFSETMASK); + rf_loop_reg = odm_get_rf_reg(dm, RF_PATH_A, RF_0x00, RFREGOFFSETMASK); + if (dm->support_ic_type & ODM_RTL8723B) { + reg92c = odm_get_bb_reg(dm, REG_DPDT_CONTROL, MASKDWORD); + reg930 = odm_get_bb_reg(dm, rfe_ctrl_anta_src, MASKDWORD); + reg948 = odm_get_bb_reg(dm, REG_S0_S1_PATH_SWITCH, MASKDWORD); + regb2c = odm_get_bb_reg(dm, REG_AGC_TABLE_SELECT, MASKDWORD); + reg064 = odm_get_mac_reg(dm, REG_SYM_WLBT_PAPE_SEL, BIT(29)); + odm_set_bb_reg(dm, REG_DPDT_CONTROL, 0x3, 0x1); + odm_set_bb_reg(dm, rfe_ctrl_anta_src, 0xff, 0x77); + odm_set_mac_reg(dm, REG_SYM_WLBT_PAPE_SEL, BIT(29), 0x1); /* @dbg 7 */ + odm_set_bb_reg(dm, REG_S0_S1_PATH_SWITCH, 0x3c0, 0x0); /* @dbg 8 */ + odm_set_bb_reg(dm, REG_AGC_TABLE_SELECT, BIT(31), 0x0); } - odm_stall_execution(10); + ODM_delay_us(10); /* Store A path Register 88c, c08, 874, c50 */ - reg88c = odm_get_bb_reg(p_dm_odm, REG_FPGA0_ANALOG_PARAMETER4, MASKDWORD); - regc08 = odm_get_bb_reg(p_dm_odm, REG_OFDM_0_TR_MUX_PAR, MASKDWORD); - reg874 = odm_get_bb_reg(p_dm_odm, REG_FPGA0_XCD_RF_INTERFACE_SW, MASKDWORD); - regc50 = odm_get_bb_reg(p_dm_odm, REG_OFDM_0_XA_AGC_CORE1, MASKDWORD); + reg88c = odm_get_bb_reg(dm, REG_FPGA0_ANALOG_PARAMETER4, MASKDWORD); + regc08 = odm_get_bb_reg(dm, REG_OFDM_0_TR_MUX_PAR, MASKDWORD); + reg874 = odm_get_bb_reg(dm, REG_FPGA0_XCD_RF_INTERFACE_SW, MASKDWORD); + regc50 = odm_get_bb_reg(dm, REG_OFDM_0_XA_AGC_CORE1, MASKDWORD); /* Store AFE Registers */ - if (p_dm_odm->support_ic_type & ODM_RTL8723B) - afe_rrx_wait_cca = odm_get_bb_reg(p_dm_odm, REG_RX_WAIT_CCA, MASKDWORD); + if (dm->support_ic_type & ODM_RTL8723B) + afe_rrx_wait_cca = odm_get_bb_reg(dm, REG_RX_WAIT_CCA, MASKDWORD); /* Set PSD 128 pts */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_PSD_FUNCTION, BIT(14) | BIT15, 0x0); /* 128 pts */ + odm_set_bb_reg(dm, REG_FPGA0_PSD_FUNCTION, BIT(14) | BIT15, 0x0); /* @128 pts */ /* To SET CH1 to do */ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, ODM_CHANNEL, RFREGOFFSETMASK, 0x7401); /* channel 1 */ + odm_set_rf_reg(dm, RF_PATH_A, ODM_CHANNEL, RFREGOFFSETMASK, 0x7401); /* @channel 1 */ - /* AFE all on step */ - if (p_dm_odm->support_ic_type & ODM_RTL8723B) - odm_set_bb_reg(p_dm_odm, REG_RX_WAIT_CCA, MASKDWORD, 0x01c00016); + /* @AFE all on step */ + if (dm->support_ic_type & ODM_RTL8723B) + odm_set_bb_reg(dm, REG_RX_WAIT_CCA, MASKDWORD, 0x01c00016); - /* 3 wire Disable */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_ANALOG_PARAMETER4, MASKDWORD, 0xCCF000C0); + /* @3 wire Disable */ + odm_set_bb_reg(dm, REG_FPGA0_ANALOG_PARAMETER4, MASKDWORD, 0xCCF000C0); - /* BB IQK setting */ - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_TR_MUX_PAR, MASKDWORD, 0x000800E4); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XCD_RF_INTERFACE_SW, MASKDWORD, 0x22208000); + /* @BB IQK setting */ + odm_set_bb_reg(dm, REG_OFDM_0_TR_MUX_PAR, MASKDWORD, 0x000800E4); + odm_set_bb_reg(dm, REG_FPGA0_XCD_RF_INTERFACE_SW, MASKDWORD, 0x22208000); - /* IQK setting tone@ 4.34Mhz */ - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_TONE_A, MASKDWORD, 0x10008C1C); - odm_set_bb_reg(p_dm_odm, REG_TX_IQK, MASKDWORD, 0x01007c00); + /* @IQK setting tone@ 4.34Mhz */ + odm_set_bb_reg(dm, REG_TX_IQK_TONE_A, MASKDWORD, 0x10008C1C); + odm_set_bb_reg(dm, REG_TX_IQK, MASKDWORD, 0x01007c00); /* Page B init */ - odm_set_bb_reg(p_dm_odm, REG_CONFIG_ANT_A, MASKDWORD, 0x00080000); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_ANT_A, MASKDWORD, 0x0f600000); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK, MASKDWORD, 0x01004800); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_TONE_A, MASKDWORD, 0x10008c1f); - if (p_dm_odm->support_ic_type & ODM_RTL8723B) { - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_PI_A, MASKDWORD, 0x82150016); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_PI_A, MASKDWORD, 0x28150016); + odm_set_bb_reg(dm, REG_CONFIG_ANT_A, MASKDWORD, 0x00080000); + odm_set_bb_reg(dm, REG_CONFIG_ANT_A, MASKDWORD, 0x0f600000); + odm_set_bb_reg(dm, REG_RX_IQK, MASKDWORD, 0x01004800); + odm_set_bb_reg(dm, REG_RX_IQK_TONE_A, MASKDWORD, 0x10008c1f); + if (dm->support_ic_type & ODM_RTL8723B) { + odm_set_bb_reg(dm, REG_TX_IQK_PI_A, MASKDWORD, 0x82150016); + odm_set_bb_reg(dm, REG_RX_IQK_PI_A, MASKDWORD, 0x28150016); } - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_RSP, MASKDWORD, 0x001028d0); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XA_AGC_CORE1, 0x7f, initial_gain); + odm_set_bb_reg(dm, REG_IQK_AGC_RSP, MASKDWORD, 0x001028d0); + odm_set_bb_reg(dm, REG_OFDM_0_XA_AGC_CORE1, 0x7f, initial_gain); - /* IQK Single tone start */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x808000); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_PTS, MASKDWORD, 0xf9000000); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_PTS, MASKDWORD, 0xf8000000); + /* @IQK Single tone start */ + odm_set_bb_reg(dm, REG_FPGA0_IQK, 0xffffff00, 0x808000); + odm_set_bb_reg(dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf9000000); + odm_set_bb_reg(dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf8000000); - odm_stall_execution(10000); + ODM_delay_us(10000); /* PSD report of antenna A */ PSD_report_tmp = 0x0; for (n = 0; n < 2; n++) { - PSD_report_tmp = get_psd_data(p_dm_odm, 14, initial_gain); + PSD_report_tmp = phydm_get_psd_data(dm, 14, initial_gain); if (PSD_report_tmp > ant_a_report) ant_a_report = PSD_report_tmp; } - /* change to Antenna B */ - if (p_dm_odm->support_ic_type & ODM_RTL8723B) { - /* odm_set_bb_reg(p_dm_odm, REG_DPDT_CONTROL, 0x3, 0x2); */ - odm_set_bb_reg(p_dm_odm, REG_S0_S1_PATH_SWITCH, 0xfff, 0x280); - odm_set_bb_reg(p_dm_odm, REG_AGC_TABLE_SELECT, BIT(31), 0x1); + /* @change to Antenna B */ + if (dm->support_ic_type & ODM_RTL8723B) { +#if 0 + /* odm_set_bb_reg(dm, REG_DPDT_CONTROL, 0x3, 0x2); */ +#endif + odm_set_bb_reg(dm, REG_S0_S1_PATH_SWITCH, 0xfff, 0x280); + odm_set_bb_reg(dm, REG_AGC_TABLE_SELECT, BIT(31), 0x1); } - odm_stall_execution(10); + ODM_delay_us(10); /* PSD report of antenna B */ PSD_report_tmp = 0x0; for (n = 0; n < 2; n++) { - PSD_report_tmp = get_psd_data(p_dm_odm, 14, initial_gain); + PSD_report_tmp = phydm_get_psd_data(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_odm, REG_FPGA0_IQK, 0xffffff00, 0x000000); + /* @Close IQK Single Tone function */ + odm_set_bb_reg(dm, REG_FPGA0_IQK, 0xffffff00, 0x000000); - /* 1 Return to antanna A */ - if (p_dm_odm->support_ic_type & ODM_RTL8723B) { - /* external DPDT */ - odm_set_bb_reg(p_dm_odm, REG_DPDT_CONTROL, MASKDWORD, reg92c); + /* @1 Return to antanna A */ + if (dm->support_ic_type & ODM_RTL8723B) { + /* @external DPDT */ + odm_set_bb_reg(dm, REG_DPDT_CONTROL, MASKDWORD, reg92c); - /* internal S0/S1 */ - odm_set_bb_reg(p_dm_odm, REG_S0_S1_PATH_SWITCH, MASKDWORD, reg948); - odm_set_bb_reg(p_dm_odm, REG_AGC_TABLE_SELECT, MASKDWORD, regb2c); - odm_set_bb_reg(p_dm_odm, rfe_ctrl_anta_src, MASKDWORD, reg930); - odm_set_mac_reg(p_dm_odm, REG_SYM_WLBT_PAPE_SEL, BIT(29), reg064); + /* @internal S0/S1 */ + odm_set_bb_reg(dm, REG_S0_S1_PATH_SWITCH, MASKDWORD, reg948); + odm_set_bb_reg(dm, REG_AGC_TABLE_SELECT, MASKDWORD, regb2c); + odm_set_bb_reg(dm, rfe_ctrl_anta_src, MASKDWORD, reg930); + odm_set_mac_reg(dm, REG_SYM_WLBT_PAPE_SEL, BIT(29), reg064); } - odm_set_bb_reg(p_dm_odm, REG_FPGA0_ANALOG_PARAMETER4, MASKDWORD, reg88c); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_TR_MUX_PAR, MASKDWORD, regc08); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XCD_RF_INTERFACE_SW, MASKDWORD, reg874); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XA_AGC_CORE1, 0x7F, 0x40); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XA_AGC_CORE1, MASKDWORD, regc50); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_CHNLBW, RFREGOFFSETMASK, current_channel); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x00, RFREGOFFSETMASK, rf_loop_reg); + odm_set_bb_reg(dm, REG_FPGA0_ANALOG_PARAMETER4, MASKDWORD, reg88c); + odm_set_bb_reg(dm, REG_OFDM_0_TR_MUX_PAR, MASKDWORD, regc08); + odm_set_bb_reg(dm, REG_FPGA0_XCD_RF_INTERFACE_SW, MASKDWORD, reg874); + odm_set_bb_reg(dm, REG_OFDM_0_XA_AGC_CORE1, 0x7F, 0x40); + odm_set_bb_reg(dm, REG_OFDM_0_XA_AGC_CORE1, MASKDWORD, regc50); + odm_set_rf_reg(dm, RF_PATH_A, RF_CHNLBW, RFREGOFFSETMASK, current_channel); + odm_set_rf_reg(dm, RF_PATH_A, RF_0x00, RFREGOFFSETMASK, rf_loop_reg); /* Reload AFE Registers */ - if (p_dm_odm->support_ic_type & ODM_RTL8723B) - odm_set_bb_reg(p_dm_odm, REG_RX_WAIT_CCA, MASKDWORD, afe_rrx_wait_cca); + if (dm->support_ic_type & ODM_RTL8723B) + odm_set_bb_reg(dm, REG_RX_WAIT_CCA, MASKDWORD, afe_rrx_wait_cca); - if (p_dm_odm->support_ic_type & ODM_RTL8723B) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("psd_report_A[%d]= %d\n", 2416, ant_a_report)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("psd_report_B[%d]= %d\n", 2416, ant_b_report)); + if (dm->support_ic_type & ODM_RTL8723B) { + PHYDM_DBG(dm, DBG_ANT_DIV, "psd_report_A[%d]= %d\n", 2416, + ant_a_report); + PHYDM_DBG(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)) { + /* @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; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_single_dual_antenna_detection(): Dual Antenna\n")); + dm_swat_table->ANTA_ON = true; + dm_swat_table->ANTB_ON = true; + PHYDM_DBG(dm, DBG_ANT_DIV, "%s: Dual Antenna\n", + __func__); } 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; + ((ant_b_report - ant_a_report >= TH1) && (ant_b_report - ant_a_report <= TH2))) { + dm_swat_table->ANTA_ON = false; + dm_swat_table->ANTB_ON = false; is_result = false; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_single_dual_antenna_detection(): Need to check again\n")); + PHYDM_DBG(dm, DBG_ANT_DIV, + "%s: Need to check again\n", + __func__); } else { - p_dm_swat_table->ANTA_ON = true; - p_dm_swat_table->ANTB_ON = false; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_single_dual_antenna_detection(): Single Antenna\n")); + dm_swat_table->ANTA_ON = true; + dm_swat_table->ANTB_ON = false; + PHYDM_DBG(dm, DBG_ANT_DIV, + "%s: Single Antenna\n", __func__); } - p_dm_odm->ant_detected_info.is_ant_detected = true; - p_dm_odm->ant_detected_info.db_for_ant_a = ant_a_report; - p_dm_odm->ant_detected_info.db_for_ant_b = ant_b_report; - p_dm_odm->ant_detected_info.db_for_ant_o = ant_0_report; + dm->ant_detected_info.is_ant_detected = true; + dm->ant_detected_info.db_for_ant_a = ant_a_report; + dm->ant_detected_info.db_for_ant_b = ant_b_report; + dm->ant_detected_info.db_for_ant_o = ant_0_report; } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("return false!!\n")); + PHYDM_DBG(dm, DBG_ANT_DIV, "return false!!\n"); is_result = false; } } return is_result; - } +/* @1 [2. Scan AP RSSI method] ================================================== */ - -/* 1 [2. Scan AP RSSI method] ================================================== */ - - - - -bool +boolean odm_sw_ant_div_check_before_link( - void *p_dm_void -) + void *dm_void) { - #if (RT_MEM_SIZE_LEVEL != RT_MEM_SIZE_MINIMUM) - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTER *adapter = p_dm_odm->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_odm->dm_swat_table; - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->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; + struct dm_struct *dm = (struct dm_struct *)dm_void; + void *adapter = dm->adapter; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + //PMGNT_INFO mgnt_info = &adapter->MgntInfo; + PMGNT_INFO mgnt_info = &(((PADAPTER)(adapter))->MgntInfo); + struct sw_antenna_switch *dm_swat_table = &dm->dm_swat_table; + struct phydm_fat_struct *fat_tab = &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; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ANTA_ON = (( %d )) , ANTB_ON = (( %d ))\n", p_dm_odm->dm_swat_table.ANTA_ON, p_dm_odm->dm_swat_table.ANTB_ON)); + PHYDM_DBG(dm, DBG_ANT_DIV, "ANTA_ON = (( %d )) , ANTB_ON = (( %d ))\n", + dm->dm_swat_table.ANTA_ON, dm->dm_swat_table.ANTB_ON); - /* if(HP id) */ + /* @if(HP id) */ { - if (p_dm_odm->dm_swat_table.rssi_ant_dect_result == true && p_dm_odm->support_ic_type == ODM_RTL8723B) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("8723B RSSI-based Antenna Detection is done\n")); + if (dm->dm_swat_table.rssi_ant_dect_result == true && dm->support_ic_type == ODM_RTL8723B) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "8723B RSSI-based Antenna Detection is done\n"); return false; } - if (p_dm_odm->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_odm, REG_S0_S1_PATH_SWITCH); + if (dm->support_ic_type == ODM_RTL8723B) { + if (dm_swat_table->swas_no_link_bk_reg948 == 0xff) + dm_swat_table->swas_no_link_bk_reg948 = odm_read_4byte(dm, REG_S0_S1_PATH_SWITCH); } } - if (p_dm_odm->adapter == NULL) { /* For BSOD when plug/unplug fast. //By YJ,120413 */ + if (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)) + if (!IS_ANT_DETECT_SUPPORT_RSSI(((PADAPTER)adapter))) return false; else - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Antenna Detection: RSSI method\n")); + PHYDM_DBG(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_odm, RT_RF_STATE_SPINLOCK); - if (p_hal_data->eRFPowerState != eRfOn || p_mgnt_info->RFChangeInProgress || p_mgnt_info->bMediaConnect) { - odm_release_spin_lock(p_dm_odm, RT_RF_STATE_SPINLOCK); + odm_acquire_spin_lock(dm, RT_RF_STATE_SPINLOCK); + if (hal_data->eRFPowerState != eRfOn || mgnt_info->RFChangeInProgress || mgnt_info->bMediaConnect) { + odm_release_spin_lock(dm, RT_RF_STATE_SPINLOCK); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, - ("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)); + PHYDM_DBG(dm, DBG_ANT_DIV, + "%s: rf_change_in_progress(%x), e_rf_power_state(%x)\n", + __func__, mgnt_info->RFChangeInProgress, + hal_data->eRFPowerState); - p_dm_swat_table->swas_no_link_state = 0; + dm_swat_table->swas_no_link_state = 0; return false; } else - odm_release_spin_lock(p_dm_odm, RT_RF_STATE_SPINLOCK); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("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. */ + odm_release_spin_lock(dm, RT_RF_STATE_SPINLOCK); + PHYDM_DBG(dm, DBG_ANT_DIV, "dm_swat_table->swas_no_link_state = %d\n", + dm_swat_table->swas_no_link_state); + /* @1 Run AntDiv mechanism "Before Link" part. */ + if (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; + 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); + /* @Copy Current Scan list. */ + mgnt_info->tmpNumBssDesc = mgnt_info->NumBssDesc; + PlatformMoveMemory((void *)mgnt_info->tmpbssDesc, (void *)mgnt_info->bssDesc, sizeof(RT_WLAN_BSS) * MAX_BSS_DESC); - /* Go back to scan function again. */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_sw_ant_div_check_before_link: Scan one more time\n")); - p_mgnt_info->ScanStep = 0; - p_mgnt_info->bScanAntDetect = true; + /* @Go back to scan function again. */ + PHYDM_DBG(dm, DBG_ANT_DIV, "%s: Scan one more time\n", + __func__); + mgnt_info->ScanStep = 0; + mgnt_info->bScanAntDetect = true; scan_channel = odm_sw_ant_div_select_scan_chnl(adapter); - - if (p_dm_odm->support_ic_type & (ODM_RTL8188E | ODM_RTL8821)) { - if (p_dm_fat_table->rx_idle_ant == MAIN_ANT) - odm_update_rx_idle_ant(p_dm_odm, AUX_ANT); + if (dm->support_ic_type & (ODM_RTL8188E | ODM_RTL8821)) { + if (fat_tab->rx_idle_ant == MAIN_ANT) + odm_update_rx_idle_ant(dm, AUX_ANT); else - odm_update_rx_idle_ant(p_dm_odm, MAIN_ANT); + odm_update_rx_idle_ant(dm, MAIN_ANT); if (scan_channel == 0) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, - ("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")); + PHYDM_DBG(dm, DBG_ANT_DIV, + "%s: No AP List Avaiable, Using ant(%s)\n", + __func__, + (fat_tab->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; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("p_dm_swat_table->ant_5g=%s\n", (p_dm_fat_table->rx_idle_ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT")); + if (IS_5G_WIRELESS_MODE(mgnt_info->dot11CurrentWirelessMode)) { + dm_swat_table->ant_5g = fat_tab->rx_idle_ant; + PHYDM_DBG(dm, DBG_ANT_DIV, "dm_swat_table->ant_5g=%s\n", (fat_tab->rx_idle_ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT"); } else { - p_dm_swat_table->ant_2g = p_dm_fat_table->rx_idle_ant; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("p_dm_swat_table->ant_2g=%s\n", (p_dm_fat_table->rx_idle_ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT")); + dm_swat_table->ant_2g = fat_tab->rx_idle_ant; + PHYDM_DBG(dm, DBG_ANT_DIV, "dm_swat_table->ant_2g=%s\n", (fat_tab->rx_idle_ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT"); } return false; } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, - ("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_odm->support_ic_type & (ODM_RTL8723B)) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "%s: Change to %s for testing.\n", __func__, + ((fat_tab->rx_idle_ant == MAIN_ANT) ? + "MAIN_ANT" : "AUX_ANT")); + } else if (dm->support_ic_type & (ODM_RTL8723B)) { /*Switch Antenna to another one.*/ - tmp_swas_no_link_bk_reg948 = odm_read_4byte(p_dm_odm, REG_S0_S1_PATH_SWITCH); + tmp_swas_no_link_bk_reg948 = odm_read_4byte(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_odm, REG_S0_S1_PATH_SWITCH, 0xfff, 0x280); - odm_set_bb_reg(p_dm_odm, REG_AGC_TABLE_SELECT, BIT(31), 0x1); - p_dm_swat_table->cur_antenna = AUX_ANT; + if (dm_swat_table->cur_antenna == MAIN_ANT && tmp_swas_no_link_bk_reg948 == 0x200) { + odm_set_bb_reg(dm, REG_S0_S1_PATH_SWITCH, 0xfff, 0x280); + odm_set_bb_reg(dm, REG_AGC_TABLE_SELECT, BIT(31), 0x1); + dm_swat_table->cur_antenna = AUX_ANT; } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Reg[948]= (( %x )) was in wrong state\n", tmp_swas_no_link_bk_reg948)); + PHYDM_DBG(dm, DBG_ANT_DIV, + "Reg[948]= (( %x )) was in wrong state\n", + tmp_swas_no_link_bk_reg948); return false; } - odm_stall_execution(10); + ODM_delay_us(10); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_sw_ant_div_check_before_link: Change to (( %s-ant)) for testing.\n", (p_dm_swat_table->cur_antenna == MAIN_ANT) ? "MAIN" : "AUX")); + PHYDM_DBG(dm, DBG_ANT_DIV, + "%s: Change to (( %s-ant)) for testing.\n", + __func__, + (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); + PlatformSetTimer(adapter, &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. */ + } else { /* @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. */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" tmp_num_bss_desc= (( %d ))\n", p_mgnt_info->tmpNumBssDesc)); /* debug for Dino */ + PHYDM_DBG(dm, DBG_ANT_DIV, " tmp_num_bss_desc= (( %d ))\n", + 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 */ + for (index = 0; index < mgnt_info->tmpNumBssDesc; index++) { + p_tmp_bss_desc = &mgnt_info->tmpbssDesc[index]; /* @Antenna 1 */ + p_test_bss_desc = &mgnt_info->bssDesc[index]; /* @Antenna 2 */ if (PlatformCompareMemory(p_test_bss_desc->bdBssIdBuf, p_tmp_bss_desc->bdBssIdBuf, 6) != 0) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_sw_ant_div_check_before_link(): ERROR!! This shall not happen.\n")); + PHYDM_DBG(dm, DBG_ANT_DIV, + "%s: ERROR!! This shall not happen.\n", + __func__); continue; } - if (p_dm_odm->support_ic_type != ODM_RTL8723B) { + if (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) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_sw_ant_div_check_before_link: Compare scan entry: score++\n")); + PHYDM_DBG(dm, DBG_ANT_DIV, "%s: Compare scan entry: score++\n", __func__); RT_PRINT_STR(COMP_SCAN, DBG_WARNING, "GetScanInfo(): new Bss SSID:", p_tmp_bss_desc->bdSsIdBuf, p_tmp_bss_desc->bdSsIdLen); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("at ch %d, Original: %d, Test: %d\n\n", p_tmp_bss_desc->ChannelNumber, p_tmp_bss_desc->RecvSignalPower, p_test_bss_desc->RecvSignalPower)); + PHYDM_DBG(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) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_sw_ant_div_check_before_link: Compare scan entry: score--\n")); + PHYDM_DBG(dm, DBG_ANT_DIV, "%s: Compare scan entry: score--\n", __func__); RT_PRINT_STR(COMP_SCAN, DBG_WARNING, "GetScanInfo(): new Bss SSID:", p_tmp_bss_desc->bdSsIdBuf, p_tmp_bss_desc->bdSsIdLen); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("at ch %d, Original: %d, Test: %d\n\n", p_tmp_bss_desc->ChannelNumber, p_tmp_bss_desc->RecvSignalPower, p_test_bss_desc->RecvSignalPower)); + PHYDM_DBG(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); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("at ch %d, Original: %d, Test: %d\n", p_tmp_bss_desc->ChannelNumber, p_tmp_bss_desc->RecvSignalPower, p_test_bss_desc->RecvSignalPower)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("The 2nd Antenna didn't get this AP\n\n")); + PHYDM_DBG(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(dm, DBG_ANT_DIV, "The 2nd Antenna didn't get this AP\n\n"); } } } - } else { /* 8723B */ + } else { /* @8723B */ if (p_tmp_bss_desc->ChannelNumber == scan_channel) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("channel_number == scan_channel->(( %d ))\n", p_tmp_bss_desc->ChannelNumber)); + PHYDM_DBG(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; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Original: %d, Test: %d\n", p_tmp_bss_desc->RecvSignalPower, p_test_bss_desc->RecvSignalPower)); - ODM_PRINT_ADDR(p_dm_odm, ODM_COMP_ANT_DIV, DBG_LOUD, ("SSID:"), p_tmp_bss_desc->bdSsIdBuf); - ODM_PRINT_ADDR(p_dm_odm, ODM_COMP_ANT_DIV, DBG_LOUD, ("BSSID:"), p_tmp_bss_desc->bdSsIdBuf); + PHYDM_DBG(dm, DBG_ANT_DIV, "Original: %d, Test: %d\n", p_tmp_bss_desc->RecvSignalPower, p_test_bss_desc->RecvSignalPower); + PHYDM_PRINT_ADDR(dm, DBG_ANT_DIV, "SSID:", p_tmp_bss_desc->bdSsIdBuf); + PHYDM_PRINT_ADDR(dm, DBG_ANT_DIV, "BSSID:", p_tmp_bss_desc->bdSsIdBuf); - /* ODM_RT_TRACE(p_dm_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 0 + /* PHYDM_DBG(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); */ +#endif 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(p_dm_odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("max_power_diff: (( %d)),min_power_diff: (( %d))\n",max_power_diff,min_power_diff)); */ +#if 0 + /* PHYDM_DBG(dm,DBG_ANT_DIV, "max_power_diff: (( %d)),min_power_diff: (( %d))\n",max_power_diff,min_power_diff); */ +#endif 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; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Original: %d, Test: %d\n", p_tmp_bss_desc->RecvSignalPower, p_test_bss_desc->RecvSignalPower)); - ODM_PRINT_ADDR(p_dm_odm, ODM_COMP_ANT_DIV, DBG_LOUD, ("SSID:"), p_tmp_bss_desc->bdSsIdBuf); - ODM_PRINT_ADDR(p_dm_odm, ODM_COMP_ANT_DIV, DBG_LOUD, ("BSSID:"), p_tmp_bss_desc->bdSsIdBuf); + PHYDM_DBG(dm, DBG_ANT_DIV, "Original: %d, Test: %d\n", p_tmp_bss_desc->RecvSignalPower, p_test_bss_desc->RecvSignalPower); + PHYDM_PRINT_ADDR(dm, DBG_ANT_DIV, "SSID:", p_tmp_bss_desc->bdSsIdBuf); + PHYDM_PRINT_ADDR(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) */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("time_diff: %lld\n", (p_test_bss_desc->bdTstamp - p_tmp_bss_desc->bdTstamp) / 1000)); + PHYDM_DBG(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++; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Original: %d, Test: %d\n", p_tmp_bss_desc->RecvSignalPower, p_test_bss_desc->RecvSignalPower)); - ODM_PRINT_ADDR(p_dm_odm, ODM_COMP_ANT_DIV, DBG_LOUD, ("SSID:"), p_tmp_bss_desc->bdSsIdBuf); - ODM_PRINT_ADDR(p_dm_odm, ODM_COMP_ANT_DIV, DBG_LOUD, ("BSSID:"), p_tmp_bss_desc->bdSsIdBuf); + PHYDM_DBG(dm, DBG_ANT_DIV, "Original: %d, Test: %d\n", p_tmp_bss_desc->RecvSignalPower, p_test_bss_desc->RecvSignalPower); + PHYDM_PRINT_ADDR(dm, DBG_ANT_DIV, "SSID:", p_tmp_bss_desc->bdSsIdBuf); + PHYDM_PRINT_ADDR(dm, DBG_ANT_DIV, "BSSID:", p_tmp_bss_desc->bdSsIdBuf); min_power_diff = 0; } } else - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Error !!!]: Time_diff: %lld\n", (p_test_bss_desc->bdTstamp - p_tmp_bss_desc->bdTstamp) / 1000)); + PHYDM_DBG(dm, DBG_ANT_DIV, "[Error !!!]: Time_diff: %lld\n", (p_test_bss_desc->bdTstamp - p_tmp_bss_desc->bdTstamp) / 1000); } } } } - if (p_dm_odm->support_ic_type & (ODM_RTL8188E | ODM_RTL8821)) { - if (p_mgnt_info->NumBssDesc != 0 && score < 0) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, - ("odm_sw_ant_div_check_before_link(): Using ant(%s)\n", (p_dm_fat_table->rx_idle_ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT")); + if (dm->support_ic_type & (ODM_RTL8188E | ODM_RTL8821)) { + if (mgnt_info->NumBssDesc != 0 && score < 0) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "%s: Using ant(%s)\n", __func__, + (fat_tab->rx_idle_ant == MAIN_ANT) ? + "MAIN_ANT" : "AUX_ANT"); } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, - ("odm_sw_ant_div_check_before_link(): Remain ant(%s)\n", (p_dm_fat_table->rx_idle_ant == MAIN_ANT) ? "AUX_ANT" : "MAIN_ANT")); + PHYDM_DBG(dm, DBG_ANT_DIV, + "%s: Remain ant(%s)\n", __func__, + (fat_tab->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_odm, AUX_ANT); + if (fat_tab->rx_idle_ant == MAIN_ANT) + odm_update_rx_idle_ant(dm, AUX_ANT); else - odm_update_rx_idle_ant(p_dm_odm, MAIN_ANT); + odm_update_rx_idle_ant(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; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("p_dm_swat_table->ant_5g=%s\n", (p_dm_fat_table->rx_idle_ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT")); + if (IS_5G_WIRELESS_MODE(mgnt_info->dot11CurrentWirelessMode)) { + dm_swat_table->ant_5g = fat_tab->rx_idle_ant; + PHYDM_DBG(dm, DBG_ANT_DIV, + "dm_swat_table->ant_5g=%s\n", + (fat_tab->rx_idle_ant == MAIN_ANT) ? + "MAIN_ANT" : "AUX_ANT"); } else { - p_dm_swat_table->ant_2g = p_dm_fat_table->rx_idle_ant; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("p_dm_swat_table->ant_2g=%s\n", (p_dm_fat_table->rx_idle_ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT")); + dm_swat_table->ant_2g = fat_tab->rx_idle_ant; + PHYDM_DBG(dm, DBG_ANT_DIV, + "dm_swat_table->ant_2g=%s\n", + (fat_tab->rx_idle_ant == MAIN_ANT) ? + "MAIN_ANT" : "AUX_ANT"); } - } else if (p_dm_odm->support_ic_type == ODM_RTL8723B) { + } else if (dm->support_ic_type == ODM_RTL8723B) { if (counter == 0) { - if (p_dm_odm->dm_swat_table.pre_aux_fail_detec == false) { - p_dm_odm->dm_swat_table.pre_aux_fail_detec = true; - p_dm_odm->dm_swat_table.rssi_ant_dect_result = false; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("counter=(( 0 )) , [[ Cannot find any AP with Aux-ant ]] -> Scan Target-channel again\n")); + if (dm->dm_swat_table.pre_aux_fail_detec == false) { + dm->dm_swat_table.pre_aux_fail_detec = true; + dm->dm_swat_table.rssi_ant_dect_result = false; + PHYDM_DBG(dm, DBG_ANT_DIV, "counter=(( 0 )) , [[ Cannot find any AP with Aux-ant ]] -> Scan Target-channel again\n"); - /* 3 [ Scan again ] */ + /* @3 [ Scan again ] */ odm_sw_ant_div_construct_scan_chnl(adapter, scan_channel); - PlatformSetTimer(adapter, &p_mgnt_info->ScanTimer, 5); + PlatformSetTimer(adapter, &mgnt_info->ScanTimer, 5); return true; } else { /* pre_aux_fail_detec == true */ - /* 2 [ Single Antenna ] */ - p_dm_odm->dm_swat_table.pre_aux_fail_detec = false; - p_dm_odm->dm_swat_table.rssi_ant_dect_result = true; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("counter=(( 0 )) , [[ Still cannot find any AP ]]\n")); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_sw_ant_div_check_before_link(): Single antenna\n")); + /* @2 [ Single Antenna ] */ + dm->dm_swat_table.pre_aux_fail_detec = false; + dm->dm_swat_table.rssi_ant_dect_result = true; + PHYDM_DBG(dm, DBG_ANT_DIV, "counter=(( 0 )) , [[ Still cannot find any AP ]]\n"); + PHYDM_DBG(dm, DBG_ANT_DIV, "%s: Single antenna\n", __func__); } - p_dm_odm->dm_swat_table.aux_fail_detec_counter++; + dm->dm_swat_table.aux_fail_detec_counter++; } else { - p_dm_odm->dm_swat_table.pre_aux_fail_detec = false; + 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); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("counter: (( %d )) , power_diff: (( %d ))\n", counter, power_diff)); - ODM_RT_TRACE(p_dm_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)); + PHYDM_DBG(dm, DBG_ANT_DIV, "counter: (( %d )) , power_diff: (( %d ))\n", counter, power_diff); + PHYDM_DBG(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); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("counter: (( %d )) , power_diff: (( %d ))\n", counter, power_diff)); - ODM_RT_TRACE(p_dm_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)); + PHYDM_DBG(dm, DBG_ANT_DIV, "counter: (( %d )) , power_diff: (( %d ))\n", counter, power_diff); + PHYDM_DBG(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 */ + } else { /* @counter==1,2 */ avg_power_diff = power_diff / counter; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("avg_power_diff: (( %d )) , counter: (( %d )) , power_diff: (( %d ))\n", avg_power_diff, counter, power_diff)); + PHYDM_DBG(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_odm->dm_swat_table.retry_counter++; + /* @2 [ Retry ] */ + if (avg_power_diff >= power_target_L && avg_power_diff <= power_target_H) { + dm->dm_swat_table.retry_counter++; - if (p_dm_odm->dm_swat_table.retry_counter <= 3) { - p_dm_odm->dm_swat_table.rssi_ant_dect_result = false; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[[ Low confidence result ]] avg_power_diff= (( %d )) -> Scan Target-channel again ]]\n", avg_power_diff)); + if (dm->dm_swat_table.retry_counter <= 3) { + dm->dm_swat_table.rssi_ant_dect_result = false; + PHYDM_DBG(dm, DBG_ANT_DIV, "[[ Low confidence result ]] avg_power_diff= (( %d )) -> Scan Target-channel again ]]\n", avg_power_diff); - /* 3 [ Scan again ] */ + /* @3 [ Scan again ] */ odm_sw_ant_div_construct_scan_chnl(adapter, scan_channel); - PlatformSetTimer(adapter, &p_mgnt_info->ScanTimer, 5); + PlatformSetTimer(adapter, &mgnt_info->ScanTimer, 5); return true; } else { - p_dm_odm->dm_swat_table.rssi_ant_dect_result = true; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[[ Still Low confidence result ]] (( retry_counter > 3 ))\n")); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_sw_ant_div_check_before_link(): Single antenna\n")); + dm->dm_swat_table.rssi_ant_dect_result = true; + PHYDM_DBG(dm, DBG_ANT_DIV, "[[ Still Low confidence result ]] (( retry_counter > 3 ))\n"); + PHYDM_DBG(dm, DBG_ANT_DIV, "%s: Single antenna\n", __func__); } - } - /* 2 [ Dual Antenna ] */ - else if ((p_mgnt_info->NumBssDesc != 0) && (avg_power_diff < power_target_L)) { - p_dm_odm->dm_swat_table.rssi_ant_dect_result = true; - if (p_dm_odm->dm_swat_table.ANTB_ON == false) { - p_dm_odm->dm_swat_table.ANTA_ON = true; - p_dm_odm->dm_swat_table.ANTB_ON = true; + /* @2 [ Dual Antenna ] */ + else if ((mgnt_info->NumBssDesc != 0) && (avg_power_diff < power_target_L)) { + dm->dm_swat_table.rssi_ant_dect_result = true; + if (dm->dm_swat_table.ANTB_ON == false) { + dm->dm_swat_table.ANTA_ON = true; + dm->dm_swat_table.ANTB_ON = true; } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_sw_ant_div_check_before_link(): Dual antenna\n")); - p_dm_odm->dm_swat_table.dual_ant_counter++; + PHYDM_DBG(dm, DBG_ANT_DIV, "%s: Dual antenna\n", __func__); + 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_odm->support_ability |= ODM_BB_ANT_DIV; - odm_ant_div_init(p_dm_odm); + /* @3 [ Init antenna diversity ] */ + dm->support_ability |= ODM_BB_ANT_DIV; + odm_ant_div_init(dm); } - /* 2 [ Single Antenna ] */ + /* @2 [ Single Antenna ] */ else if (avg_power_diff > power_target_H) { - p_dm_odm->dm_swat_table.rssi_ant_dect_result = true; - if (p_dm_odm->dm_swat_table.ANTB_ON == true) { - p_dm_odm->dm_swat_table.ANTA_ON = true; - p_dm_odm->dm_swat_table.ANTB_ON = false; - /* bt_set_bt_coex_ant_num(adapter, BT_COEX_ANT_TYPE_DETECTED, 1); */ + dm->dm_swat_table.rssi_ant_dect_result = true; + if (dm->dm_swat_table.ANTB_ON == true) { + dm->dm_swat_table.ANTA_ON = true; + dm->dm_swat_table.ANTB_ON = false; +#if 0 + /* @bt_set_bt_coex_ant_num(adapter, BT_COEX_ANT_TYPE_DETECTED, 1); */ +#endif } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_sw_ant_div_check_before_link(): Single antenna\n")); - p_dm_odm->dm_swat_table.single_ant_counter++; + PHYDM_DBG(dm, DBG_ANT_DIV, "%s: Single antenna\n", __func__); + dm->dm_swat_table.single_ant_counter++; } } - /* ODM_RT_TRACE(p_dm_odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("is_result=(( %d ))\n",p_dm_odm->dm_swat_table.rssi_ant_dect_result)); */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("dual_ant_counter = (( %d )), single_ant_counter = (( %d )) , retry_counter = (( %d )) , aux_fail_detec_counter = (( %d ))\n\n\n", - p_dm_odm->dm_swat_table.dual_ant_counter, p_dm_odm->dm_swat_table.single_ant_counter, p_dm_odm->dm_swat_table.retry_counter, p_dm_odm->dm_swat_table.aux_fail_detec_counter)); +#if 0 + /* PHYDM_DBG(dm,DBG_ANT_DIV, "is_result=(( %d ))\n",dm->dm_swat_table.rssi_ant_dect_result); */ +#endif + PHYDM_DBG(dm, DBG_ANT_DIV, + "dual_ant_counter = (( %d )), single_ant_counter = (( %d )) , retry_counter = (( %d )) , aux_fail_detec_counter = (( %d ))\n\n\n", + dm->dm_swat_table.dual_ant_counter, + dm->dm_swat_table.single_ant_counter, + dm->dm_swat_table.retry_counter, + dm->dm_swat_table.aux_fail_detec_counter); - /* 2 recover the antenna setting */ - - if (p_dm_odm->dm_swat_table.ANTB_ON == false) - odm_set_bb_reg(p_dm_odm, REG_S0_S1_PATH_SWITCH, 0xfff, (p_dm_swat_table->swas_no_link_bk_reg948)); - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("is_result=(( %d )), Recover Reg[948]= (( %x )) \n\n", p_dm_odm->dm_swat_table.rssi_ant_dect_result, p_dm_swat_table->swas_no_link_bk_reg948)); + /* @2 recover the antenna setting */ + if (dm->dm_swat_table.ANTB_ON == false) + odm_set_bb_reg(dm, REG_S0_S1_PATH_SWITCH, 0xfff, (dm_swat_table->swas_no_link_bk_reg948)); + PHYDM_DBG(dm, DBG_ANT_DIV, + "is_result=(( %d )), Recover Reg[948]= (( %x ))\n\n", + dm->dm_swat_table.rssi_ant_dect_result, + 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; + /* @Check state reset to default and wait for next time. */ + dm_swat_table->swas_no_link_state = 0; + mgnt_info->bScanAntDetect = false; return false; } #else - return false; + return false; #endif return false; } - - - - - -/* 1 [3. PSD method] ========================================================== */ - - - - -u32 -odm_get_psd_data( - void *p_dm_void, - u16 point, - u8 initial_gain) +/* @1 [3. PSD method] ========================================================== */ +void odm_single_dual_antenna_detection_psd( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u32 psd_report; - - odm_set_bb_reg(p_dm_odm, 0x808, 0x3FF, point); - odm_set_bb_reg(p_dm_odm, 0x808, BIT(22), 1); /* Start PSD calculation, Reg808[22]=0->1 */ - odm_stall_execution(150);/* Wait for HW PSD report */ - odm_set_bb_reg(p_dm_odm, 0x808, BIT(22), 0);/* Stop PSD calculation, Reg808[22]=1->0 */ - psd_report = odm_get_bb_reg(p_dm_odm, 0x8B4, MASKDWORD) & 0x0000FFFF; /* Read PSD report, Reg8B4[15:0] */ - - psd_report = (u32)(odm_convert_to_db(psd_report)); /* +(u32)(initial_gain); */ - return psd_report; -} - - - -void -odm_single_dual_antenna_detection_psd( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (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}; + struct dm_struct *dm = (struct dm_struct *)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; + 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_odm->support_ic_type != ODM_RTL8723B) + if (dm->support_ic_type != ODM_RTL8723B) return; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_single_dual_antenna_detection_psd()============>\n")); + PHYDM_DBG(dm, DBG_ANT_DIV, "%s============>\n", __func__); - /* 2 [ Backup Current RF/BB Settings ] */ + /* @2 [ Backup Current RF/BB Settings ] */ - channel_ori = odm_get_rf_reg(p_dm_odm, ODM_RF_PATH_A, ODM_CHANNEL, RFREGOFFSETMASK); - reg948 = odm_get_bb_reg(p_dm_odm, REG_S0_S1_PATH_SWITCH, MASKDWORD); - regb2c = odm_get_bb_reg(p_dm_odm, REG_AGC_TABLE_SELECT, MASKDWORD); - regc50 = odm_get_bb_reg(p_dm_odm, REG_OFDM_0_XA_AGC_CORE1, MASKDWORD); - regc14 = odm_get_bb_reg(p_dm_odm, 0xc14, MASKDWORD); - reg908 = odm_get_bb_reg(p_dm_odm, 0x908, MASKDWORD); + channel_ori = odm_get_rf_reg(dm, RF_PATH_A, ODM_CHANNEL, RFREGOFFSETMASK); + reg948 = odm_get_bb_reg(dm, REG_S0_S1_PATH_SWITCH, MASKDWORD); + regb2c = odm_get_bb_reg(dm, REG_AGC_TABLE_SELECT, MASKDWORD); + regc50 = odm_get_bb_reg(dm, REG_OFDM_0_XA_AGC_CORE1, MASKDWORD); + regc14 = odm_get_bb_reg(dm, R_0xc14, MASKDWORD); + reg908 = odm_get_bb_reg(dm, R_0x908, MASKDWORD); - /* 2 [ setting for doing PSD function (CH4)] */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_RFMOD, BIT(24), 0); /* disable whole CCK block */ - odm_write_1byte(p_dm_odm, REG_TXPAUSE, 0xFF); /* Turn off TX -> Pause TX Queue */ - odm_set_bb_reg(p_dm_odm, 0xC14, MASKDWORD, 0x0); /* [ Set IQK Matrix = 0 ] equivalent to [ Turn off CCA] */ + /* @2 [ setting for doing PSD function (CH4)] */ + odm_set_bb_reg(dm, REG_FPGA0_RFMOD, BIT(24), 0); /* @disable whole CCK block */ + odm_write_1byte(dm, REG_TXPAUSE, 0xFF); /* Turn off TX -> Pause TX Queue */ + odm_set_bb_reg(dm, R_0xc14, MASKDWORD, 0x0); /* @[ Set IQK Matrix = 0 ] equivalent to [ Turn off CCA] */ /* PHYTXON while loop */ - odm_set_bb_reg(p_dm_odm, 0x908, MASKDWORD, 0x803); - while (odm_get_bb_reg(p_dm_odm, 0xdf4, BIT(6))) { + odm_set_bb_reg(dm, R_0x908, MASKDWORD, 0x803); + while (odm_get_bb_reg(dm, R_0xdf4, BIT(6))) { i++; if (i > 1000000) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Wait in %s() more than %d times!\n", __FUNCTION__, i)); + PHYDM_DBG(dm, DBG_ANT_DIV, + "Wait in %s() more than %d times!\n", + __FUNCTION__, i); break; } } - odm_set_bb_reg(p_dm_odm, 0xc50, 0x7f, initial_gain); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, ODM_CHANNEL, 0x7ff, 0x04); /* Set RF to CH4 & 40M */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_ANALOG_PARAMETER4, 0xf00000, 0xf); /* 3 wire Disable 88c[23:20]=0xf */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_PSD_FUNCTION, BIT(14) | BIT15, 0x0); /* 128 pt */ /* Set PSD 128 ptss */ - odm_stall_execution(3000); + odm_set_bb_reg(dm, R_0xc50, 0x7f, initial_gain); + odm_set_rf_reg(dm, RF_PATH_A, ODM_CHANNEL, 0x7ff, 0x04); /* Set RF to CH4 & 40M */ + odm_set_bb_reg(dm, REG_FPGA0_ANALOG_PARAMETER4, 0xf00000, 0xf); /* @3 wire Disable 88c[23:20]=0xf */ + odm_set_bb_reg(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)] */ - /* 2 [ Doing PSD Function in (CH4)] */ - - /* Antenna A */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Switch to Main-ant (CH4)\n")); - odm_set_bb_reg(p_dm_odm, 0x948, 0xfff, 0x200); - odm_stall_execution(10); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("dbg\n")); + /* @Antenna A */ + PHYDM_DBG(dm, DBG_ANT_DIV, "Switch to Main-ant (CH4)\n"); + odm_set_bb_reg(dm, R_0x948, 0xfff, 0x200); + ODM_delay_us(10); + PHYDM_DBG(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 = odm_get_psd_data(p_dm_odm, tone_idx_1[tone_idx], initial_gain); - /* if( PSD_report_temp>psd_report_main[tone_idx] ) */ + PSD_report_temp = phydm_get_psd_data(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 */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Switch to Aux-ant (CH4)\n")); - odm_set_bb_reg(p_dm_odm, 0x948, 0xfff, 0x280); - odm_stall_execution(10); + /* @Antenna B */ + PHYDM_DBG(dm, DBG_ANT_DIV, "Switch to Aux-ant (CH4)\n"); + odm_set_bb_reg(dm, R_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 = odm_get_psd_data(p_dm_odm, tone_idx_1[tone_idx], initial_gain); - /* if( PSD_report_temp>psd_report_aux[tone_idx] ) */ + PSD_report_temp = phydm_get_psd_data(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)] */ + /* @2 [ Doing PSD Function in (CH8)] */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_ANALOG_PARAMETER4, 0xf00000, 0x0); /* 3 wire enable 88c[23:20]=0x0 */ - odm_stall_execution(3000); + odm_set_bb_reg(dm, REG_FPGA0_ANALOG_PARAMETER4, 0xf00000, 0x0); /* @3 wire enable 88c[23:20]=0x0 */ + ODM_delay_us(3000); - odm_set_bb_reg(p_dm_odm, 0xc50, 0x7f, initial_gain); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, ODM_CHANNEL, 0x7ff, 0x04); /* Set RF to CH8 & 40M */ + odm_set_bb_reg(dm, R_0xc50, 0x7f, initial_gain); + odm_set_rf_reg(dm, RF_PATH_A, ODM_CHANNEL, 0x7ff, 0x04); /* Set RF to CH8 & 40M */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_ANALOG_PARAMETER4, 0xf00000, 0xf); /* 3 wire Disable 88c[23:20]=0xf */ - odm_stall_execution(3000); + odm_set_bb_reg(dm, REG_FPGA0_ANALOG_PARAMETER4, 0xf00000, 0xf); /* @3 wire Disable 88c[23:20]=0xf */ + ODM_delay_us(3000); - /* Antenna A */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Switch to Main-ant (CH8)\n")); - odm_set_bb_reg(p_dm_odm, 0x948, 0xfff, 0x200); - odm_stall_execution(10); + /* @Antenna A */ + PHYDM_DBG(dm, DBG_ANT_DIV, "Switch to Main-ant (CH8)\n"); + odm_set_bb_reg(dm, R_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 = odm_get_psd_data(p_dm_odm, tone_idx_2[tone_idx], initial_gain); - /* if( PSD_report_temp>psd_report_main[tone_idx] ) */ + PSD_report_temp = phydm_get_psd_data(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 */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Switch to Aux-ant (CH8)\n")); - odm_set_bb_reg(p_dm_odm, 0x948, 0xfff, 0x280); - odm_stall_execution(10); + /* @Antenna B */ + PHYDM_DBG(dm, DBG_ANT_DIV, "Switch to Aux-ant (CH8)\n"); + odm_set_bb_reg(dm, R_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 = odm_get_psd_data(p_dm_odm, tone_idx_2[tone_idx], initial_gain); - /* if( PSD_report_temp>psd_report_aux[tone_idx] ) */ + PSD_report_temp = phydm_get_psd_data(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 ] */ + /* @2 [ Calculate Result ] */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\nMain PSD Result: (ALL)\n")); + PHYDM_DBG(dm, DBG_ANT_DIV, "\nMain PSD Result: (ALL)\n"); for (tone_idx = 0; tone_idx < (tone_lenth_1 + tone_lenth_2); tone_idx++) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Tone-%d]: %d,\n", (tone_idx + 1), psd_report_main[tone_idx])); + PHYDM_DBG(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]; } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("--------------------------- \nTotal_Main= (( %d ))\n", main_psd_result)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("MAX_Main = (( %d ))\n", max_psd_report_main)); + PHYDM_DBG(dm, DBG_ANT_DIV, + "--------------------------- \nTotal_Main= (( %d ))\n", + main_psd_result); + PHYDM_DBG(dm, DBG_ANT_DIV, "MAX_Main = (( %d ))\n", + max_psd_report_main); - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\nAux PSD Result: (ALL)\n")); + PHYDM_DBG(dm, DBG_ANT_DIV, "\nAux PSD Result: (ALL)\n"); for (tone_idx = 0; tone_idx < (tone_lenth_1 + tone_lenth_2); tone_idx++) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Tone-%d]: %d,\n", (tone_idx + 1), psd_report_aux[tone_idx])); + PHYDM_DBG(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]; } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("--------------------------- \nTotal_Aux= (( %d ))\n", aux_psd_result)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("MAX_Aux = (( %d ))\n\n", max_psd_report_aux)); + PHYDM_DBG(dm, DBG_ANT_DIV, + "--------------------------- \nTotal_Aux= (( %d ))\n", + aux_psd_result); + PHYDM_DBG(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; */ + /* @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(p_dm_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)); + PHYDM_DBG(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 ] */ + /* @3 [ Dual Antenna ] */ if (aux_psd_result >= PSD_power_threshold) { - if (p_dm_odm->dm_swat_table.ANTB_ON == false) { - p_dm_odm->dm_swat_table.ANTA_ON = true; - p_dm_odm->dm_swat_table.ANTB_ON = true; + if (dm->dm_swat_table.ANTB_ON == false) { + dm->dm_swat_table.ANTA_ON = true; + dm->dm_swat_table.ANTB_ON = true; } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_sw_ant_div_check_before_link(): Dual antenna\n")); + PHYDM_DBG(dm, DBG_ANT_DIV, + "odm_sw_ant_div_check_before_link(): Dual antenna\n"); +#if 0 /* set bt coexDM from 1ant coexDM to 2ant coexDM */ - /* bt_set_bt_coex_ant_num(p_adapter, BT_COEX_ANT_TYPE_DETECTED, 2); */ + /* @bt_set_bt_coex_ant_num(adapter, BT_COEX_ANT_TYPE_DETECTED, 2); */ +#endif - /* Init antenna diversity */ - p_dm_odm->support_ability |= ODM_BB_ANT_DIV; - odm_ant_div_init(p_dm_odm); + /* @Init antenna diversity */ + dm->support_ability |= ODM_BB_ANT_DIV; + odm_ant_div_init(dm); } - /* 3 [ Single Antenna ] */ + /* @3 [ Single Antenna ] */ else { - if (p_dm_odm->dm_swat_table.ANTB_ON == true) { - p_dm_odm->dm_swat_table.ANTA_ON = true; - p_dm_odm->dm_swat_table.ANTB_ON = false; + if (dm->dm_swat_table.ANTB_ON == true) { + dm->dm_swat_table.ANTA_ON = true; + dm->dm_swat_table.ANTB_ON = false; } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_sw_ant_div_check_before_link(): Single antenna\n")); + PHYDM_DBG(dm, DBG_ANT_DIV, + "odm_sw_ant_div_check_before_link(): Single antenna\n"); } - /* 2 [ Recover all parameters ] */ + /* @2 [ Recover all parameters ] */ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_CHNLBW, RFREGOFFSETMASK, channel_ori); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_ANALOG_PARAMETER4, 0xf00000, 0x0); /* 3 wire enable 88c[23:20]=0x0 */ - odm_set_bb_reg(p_dm_odm, 0xc50, 0x7f, regc50); + odm_set_rf_reg(dm, RF_PATH_A, RF_CHNLBW, RFREGOFFSETMASK, channel_ori); + odm_set_bb_reg(dm, REG_FPGA0_ANALOG_PARAMETER4, 0xf00000, 0x0); /* @3 wire enable 88c[23:20]=0x0 */ + odm_set_bb_reg(dm, R_0xc50, 0x7f, regc50); - odm_set_bb_reg(p_dm_odm, REG_S0_S1_PATH_SWITCH, MASKDWORD, reg948); - odm_set_bb_reg(p_dm_odm, REG_AGC_TABLE_SELECT, MASKDWORD, regb2c); + odm_set_bb_reg(dm, REG_S0_S1_PATH_SWITCH, MASKDWORD, reg948); + odm_set_bb_reg(dm, REG_AGC_TABLE_SELECT, MASKDWORD, regb2c); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_RFMOD, BIT(24), 1); /* enable whole CCK block */ - odm_write_1byte(p_dm_odm, REG_TXPAUSE, 0x0); /* Turn on TX */ /* Resume TX Queue */ - odm_set_bb_reg(p_dm_odm, 0xC14, MASKDWORD, regc14); /* [ Set IQK Matrix = 0 ] equivalent to [ Turn on CCA] */ - odm_set_bb_reg(p_dm_odm, 0x908, MASKDWORD, reg908); + odm_set_bb_reg(dm, REG_FPGA0_RFMOD, BIT(24), 1); /* @enable whole CCK block */ + odm_write_1byte(dm, REG_TXPAUSE, 0x0); /* Turn on TX */ /* Resume TX Queue */ + odm_set_bb_reg(dm, R_0xc14, MASKDWORD, regc14); /* @[ Set IQK Matrix = 0 ] equivalent to [ Turn on CCA] */ + odm_set_bb_reg(dm, R_0x908, MASKDWORD, reg908); return; - } -#endif -void -odm_sw_ant_detect_init( - void *p_dm_void -) +void odm_sw_ant_detect_init(void *dm_void) { -#if (defined(CONFIG_ANT_DETECTION)) - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _sw_antenna_switch_ *p_dm_swat_table = &p_dm_odm->dm_swat_table; +#if (RTL8723B_SUPPORT == 1) - /* 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; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct sw_antenna_switch *dm_swat_table = &dm->dm_swat_table; + + if (dm->support_ic_type != ODM_RTL8723B) + return; + + /* @dm_swat_table->pre_antenna = MAIN_ANT; */ + /* @dm_swat_table->cur_antenna = MAIN_ANT; */ + dm_swat_table->swas_no_link_state = 0; + dm_swat_table->pre_aux_fail_detec = false; + dm_swat_table->swas_no_link_bk_reg948 = 0xff; + +#ifdef CONFIG_PSD_TOOL + phydm_psd_init(dm); +#endif #endif } +#endif + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_antdect.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_antdect.h index 59d279b6c44a..c36b936b9725 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_antdect.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_antdect.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,88 +9,71 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ -#ifndef __PHYDMANTDECT_H__ -#define __PHYDMANTDECT_H__ +#ifndef __PHYDMANTDECT_H__ +#define __PHYDMANTDECT_H__ -#define ANTDECT_VERSION "2.1" /*2015.07.29 by YuChen*/ +#define ANTDECT_VERSION "2.1" #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 +/* @#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 { - bool is_ant_detected; - u32 db_for_ant_a; - u32 db_for_ant_b; - u32 db_for_ant_o; + boolean is_ant_detected; + u32 db_for_ant_a; + u32 db_for_ant_b; + u32 db_for_ant_o; }; - -enum dm_swas_e { +enum dm_swas { antenna_a = 1, antenna_b = 2, antenna_max = 3, }; +/* @1 [1. Single Tone method] =================================================== */ +void odm_single_dual_antenna_default_setting( + void *dm_void); -/* 1 [1. Single Tone method] =================================================== */ - - - -void -odm_single_dual_antenna_default_setting( - void *p_dm_void -); - -bool +boolean odm_single_dual_antenna_detection( - void *p_dm_void, - u8 mode -); + void *dm_void, + u8 mode); -/* 1 [2. Scan AP RSSI method] ================================================== */ +/* @1 [2. Scan AP RSSI method] ================================================== */ -#define sw_ant_div_check_before_link odm_sw_ant_div_check_before_link +#define sw_ant_div_check_before_link odm_sw_ant_div_check_before_link -bool +boolean odm_sw_ant_div_check_before_link( - void *p_dm_void -); + void *dm_void); +/* @1 [3. PSD method] ========================================================== */ +void odm_single_dual_antenna_detection_psd( + void *dm_void); - -/* 1 [3. PSD method] ========================================================== */ - - -void -odm_single_dual_antenna_detection_psd( - void *p_dm_void -); - +void odm_sw_ant_detect_init(void *dm_void); #endif - -void -odm_sw_ant_detect_init( - void *p_dm_void -); - - #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_antdiv.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_antdiv.c index 3418c97ccc86..d3c6512d2cc7 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_antdiv.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_antdiv.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,347 +9,473 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ -/* ************************************************************ +/************************************************************* * 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 -) +/******************************************************* + * 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. + ***************************************************** + */ +#ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY +void odm_stop_antenna_switch_dm(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - /* disable ODM antenna diversity */ - p_dm_odm->support_ability &= ~ODM_BB_ANT_DIV; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("STOP Antenna Diversity\n")); + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + /* @disable ODM antenna diversity */ + dm->support_ability &= ~ODM_BB_ANT_DIV; + if (fat_tab->div_path_type == ANT_PATH_A) + odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_A); + else if (fat_tab->div_path_type == ANT_PATH_B) + odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_B); + else if (fat_tab->div_path_type == ANT_PATH_AB) + odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_AB); + odm_tx_by_tx_desc_or_reg(dm, TX_BY_REG); + PHYDM_DBG(dm, DBG_ANT_DIV, "STOP Antenna Diversity\n"); } -void -phydm_enable_antenna_diversity( - void *p_dm_void -) +void phydm_enable_antenna_diversity(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; - p_dm_odm->support_ability |= ODM_BB_ANT_DIV; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("AntDiv is enabled & Re-Init AntDiv\n")); - odm_antenna_diversity_init(p_dm_odm); + dm->support_ability |= ODM_BB_ANT_DIV; + dm->antdiv_select = 0; + PHYDM_DBG(dm, DBG_ANT_DIV, "AntDiv is enabled & Re-Init AntDiv\n"); + odm_antenna_diversity_init(dm); } -void -odm_set_ant_config( - void *p_dm_void, - u8 ant_setting /* 0=A, 1=B, 2=C, .... */ -) +void odm_set_ant_config(void *dm_void, u8 ant_setting /* @0=A, 1=B, 2=C,...*/) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - if (p_dm_odm->support_ic_type == ODM_RTL8723B) { - if (ant_setting == 0) /* ant A*/ - odm_set_bb_reg(p_dm_odm, 0x948, MASKDWORD, 0x00000000); + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (dm->support_ic_type == ODM_RTL8723B) { + if (ant_setting == 0) /* @ant A*/ + odm_set_bb_reg(dm, R_0x948, MASKDWORD, 0x00000000); else if (ant_setting == 1) - odm_set_bb_reg(p_dm_odm, 0x948, MASKDWORD, 0x00000280); - } else if (p_dm_odm->support_ic_type == ODM_RTL8723D) { - if (ant_setting == 0) /* ant A*/ - odm_set_bb_reg(p_dm_odm, 0x948, MASKLWORD, 0x0000); + odm_set_bb_reg(dm, R_0x948, MASKDWORD, 0x00000280); + } else if (dm->support_ic_type == ODM_RTL8723D) { + if (ant_setting == 0) /* @ant A*/ + odm_set_bb_reg(dm, R_0x948, MASKLWORD, 0x0000); else if (ant_setting == 1) - odm_set_bb_reg(p_dm_odm, 0x948, MASKLWORD, 0x0280); + odm_set_bb_reg(dm, R_0x948, MASKLWORD, 0x0280); } } /* ****************************************************** */ - -void -odm_sw_ant_div_rest_after_link( - void *p_dm_void -) +void odm_sw_ant_div_rest_after_link(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _sw_antenna_switch_ *p_dm_swat_table = &p_dm_odm->dm_swat_table; - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; - u32 i; - - if (p_dm_odm->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; - #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct sw_antenna_switch *swat_tab = &dm->dm_swat_table; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + u32 i; + + if (dm->ant_div_type == S0S1_SW_ANTDIV) { + swat_tab->try_flag = SWAW_STEP_INIT; + swat_tab->rssi_trying = 0; + swat_tab->double_chk_flag = 0; + fat_tab->rx_idle_ant = MAIN_ANT; + for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) - phydm_antdiv_reset_statistic(p_dm_odm, i); -#endif - - + phydm_antdiv_reset_statistic(dm, i); } + +#endif } - -#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -void -phydm_antdiv_reset_statistic( - void *p_dm_void, - u32 macid -) +void phydm_n_on_off(void *dm_void, u8 swch, u8 path) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fat_struct *fat_tab = &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 -odm_ant_div_on_off( - void *p_dm_void, - u8 swch -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; - - if (p_dm_fat_table->ant_div_on_off != swch) { - if (p_dm_odm->ant_div_type == S0S1_SW_ANTDIV) - return; - - if (p_dm_odm->support_ic_type & ODM_N_ANTDIV_SUPPORT) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("(( Turn %s )) N-Series HW-AntDiv block\n", (swch == ANTDIV_ON) ? "ON" : "OFF")); - odm_set_bb_reg(p_dm_odm, 0xc50, BIT(7), swch); - odm_set_bb_reg(p_dm_odm, 0xa00, BIT(15), swch); - - } else if (p_dm_odm->support_ic_type & ODM_AC_ANTDIV_SUPPORT) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("(( Turn %s )) AC-Series HW-AntDiv block\n", (swch == ANTDIV_ON) ? "ON" : "OFF")); - if (p_dm_odm->support_ic_type & (ODM_RTL8812 | ODM_RTL8822B)) { - odm_set_bb_reg(p_dm_odm, 0xc50, BIT(7), swch); /* OFDM AntDiv function block enable */ - odm_set_bb_reg(p_dm_odm, 0xa00, BIT(15), swch); /* CCK AntDiv function block enable */ - } else { - odm_set_bb_reg(p_dm_odm, 0x8D4, BIT(24), swch); /* OFDM AntDiv function block enable */ - - if ((p_dm_odm->cut_version >= ODM_CUT_C) && (p_dm_odm->support_ic_type == ODM_RTL8821) && (p_dm_odm->ant_div_type != S0S1_SW_ANTDIV)) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("(( Turn %s )) CCK HW-AntDiv block\n", (swch == ANTDIV_ON) ? "ON" : "OFF")); - odm_set_bb_reg(p_dm_odm, 0x800, BIT(25), swch); - odm_set_bb_reg(p_dm_odm, 0xA00, BIT(15), swch); /* CCK AntDiv function block enable */ - } else if (p_dm_odm->support_ic_type == ODM_RTL8821C) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("(( Turn %s )) CCK HW-AntDiv block\n", (swch == ANTDIV_ON) ? "ON" : "OFF")); - odm_set_bb_reg(p_dm_odm, 0x800, BIT(25), swch); - odm_set_bb_reg(p_dm_odm, 0xA00, BIT(15), swch); /* CCK AntDiv function block enable */ - } - } + if (path == ANT_PATH_A) { + odm_set_bb_reg(dm, R_0xc50, BIT(7), swch); + } else if (path == ANT_PATH_B) { + odm_set_bb_reg(dm, R_0xc58, BIT(7), swch); + } else if (path == ANT_PATH_AB) { + odm_set_bb_reg(dm, R_0xc50, BIT(7), swch); + odm_set_bb_reg(dm, R_0xc58, BIT(7), swch); + } + odm_set_bb_reg(dm, R_0xa00, BIT(15), swch); +#if (RTL8723D_SUPPORT == 1) + /*@Mingzhi 2017-05-08*/ + if (dm->support_ic_type == ODM_RTL8723D) { + if (swch == ANTDIV_ON) { + odm_set_bb_reg(dm, R_0xce0, BIT(1), 1); + odm_set_bb_reg(dm, R_0x948, BIT(6), 1); + /*@1:HW ctrl 0:SW ctrl*/ + } else { + odm_set_bb_reg(dm, R_0xce0, BIT(1), 0); + odm_set_bb_reg(dm, R_0x948, BIT(6), 0); + /*@1:HW ctrl 0:SW ctrl*/ } } - p_dm_fat_table->ant_div_on_off = swch; - +#endif } -void -phydm_fast_training_enable( - void *p_dm_void, - u8 swch -) +void phydm_ac_on_off(void *dm_void, u8 swch, u8 path) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 enable; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + + if (dm->support_ic_type & ODM_RTL8812) { + odm_set_bb_reg(dm, R_0xc50, BIT(7), swch); + /* OFDM AntDiv function block enable */ + odm_set_bb_reg(dm, R_0xa00, BIT(15), swch); + /* @CCK AntDiv function block enable */ + } else if (dm->support_ic_type & ODM_RTL8822B) { + odm_set_bb_reg(dm, R_0x800, BIT(25), swch); + odm_set_bb_reg(dm, R_0xa00, BIT(15), swch); + if (path == ANT_PATH_A) { + odm_set_bb_reg(dm, R_0xc50, BIT(7), swch); + } else if (path == ANT_PATH_B) { + odm_set_bb_reg(dm, R_0xe50, BIT(7), swch); + } else if (path == ANT_PATH_AB) { + odm_set_bb_reg(dm, R_0xc50, BIT(7), swch); + odm_set_bb_reg(dm, R_0xe50, BIT(7), swch); + } + } else { + odm_set_bb_reg(dm, R_0x8d4, BIT(24), swch); + /* OFDM AntDiv function block enable */ + + if (dm->cut_version >= ODM_CUT_C && + dm->support_ic_type == ODM_RTL8821 && + dm->ant_div_type != S0S1_SW_ANTDIV) { + PHYDM_DBG(dm, DBG_ANT_DIV, "(Turn %s) CCK HW-AntDiv\n", + (swch == ANTDIV_ON) ? "ON" : "OFF"); + odm_set_bb_reg(dm, R_0x800, BIT(25), swch); + odm_set_bb_reg(dm, R_0xa00, BIT(15), swch); + /* @CCK AntDiv function block enable */ + } else if (dm->support_ic_type == ODM_RTL8821C) { + PHYDM_DBG(dm, DBG_ANT_DIV, "(Turn %s) CCK HW-AntDiv\n", + (swch == ANTDIV_ON) ? "ON" : "OFF"); + odm_set_bb_reg(dm, R_0x800, BIT(25), swch); + odm_set_bb_reg(dm, R_0xa00, BIT(15), swch); + /* @CCK AntDiv function block enable */ + } + } +} + +void odm_ant_div_on_off(void *dm_void, u8 swch, u8 path) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + + if (fat_tab->ant_div_on_off != swch) { + if (dm->ant_div_type == S0S1_SW_ANTDIV) + return; + + if (dm->support_ic_type & ODM_N_ANTDIV_SUPPORT) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "(( Turn %s )) N-Series HW-AntDiv block\n", + (swch == ANTDIV_ON) ? "ON" : "OFF"); + phydm_n_on_off(dm, swch, path); + + } else if (dm->support_ic_type & ODM_AC_ANTDIV_SUPPORT) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "(( Turn %s )) AC-Series HW-AntDiv block\n", + (swch == ANTDIV_ON) ? "ON" : "OFF"); + phydm_ac_on_off(dm, swch, path); + } + } + fat_tab->ant_div_on_off = swch; +} + +void odm_tx_by_tx_desc_or_reg(void *dm_void, u8 swch) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + u8 enable; + + if (fat_tab->b_fix_tx_ant == NO_FIX_TX_ANT) + enable = (swch == TX_BY_DESC) ? 1 : 0; + else + enable = 0; /*@Force TX by Reg*/ + + if (dm->ant_div_type != CGCS_RX_HW_ANTDIV) { + if (dm->support_ic_type & ODM_N_ANTDIV_SUPPORT) + odm_set_bb_reg(dm, R_0x80c, BIT(21), enable); + else if (dm->support_ic_type & ODM_AC_ANTDIV_SUPPORT) + odm_set_bb_reg(dm, R_0x900, BIT(18), enable); + + PHYDM_DBG(dm, DBG_ANT_DIV, "[AntDiv] TX_Ant_BY (( %s ))\n", + (enable == TX_BY_DESC) ? "DESC" : "REG"); + } +} + +void phydm_antdiv_reset_statistic(void *dm_void, u32 macid) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + + fat_tab->main_sum[macid] = 0; + fat_tab->aux_sum[macid] = 0; + fat_tab->main_cnt[macid] = 0; + fat_tab->aux_cnt[macid] = 0; + fat_tab->main_sum_cck[macid] = 0; + fat_tab->aux_sum_cck[macid] = 0; + fat_tab->main_cnt_cck[macid] = 0; + fat_tab->aux_cnt_cck[macid] = 0; +} + +void phydm_fast_training_enable(void *dm_void, u8 swch) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 enable; if (swch == FAT_ON) enable = 1; else enable = 0; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Fast ant Training_en = ((%d))\n", enable)); + PHYDM_DBG(dm, DBG_ANT_DIV, "Fast ant Training_en = ((%d))\n", enable); - if (p_dm_odm->support_ic_type == ODM_RTL8188E) { - odm_set_bb_reg(p_dm_odm, 0xe08, BIT(16), enable); /*enable fast training*/ - /**/ - } else if (p_dm_odm->support_ic_type == ODM_RTL8192E) { - odm_set_bb_reg(p_dm_odm, 0xB34, BIT(28), enable); /*enable fast training (path-A)*/ - /*odm_set_bb_reg(p_dm_odm, 0xB34, BIT(29), enable);*/ /*enable fast training (path-B)*/ - } else if (p_dm_odm->support_ic_type & (ODM_RTL8821 | ODM_RTL8822B)) { - odm_set_bb_reg(p_dm_odm, 0x900, BIT(19), enable); /*enable fast training */ - /**/ + if (dm->support_ic_type == ODM_RTL8188E) { + odm_set_bb_reg(dm, R_0xe08, BIT(16), enable); + /*@enable fast training*/ + } else if (dm->support_ic_type == ODM_RTL8192E) { + odm_set_bb_reg(dm, R_0xb34, BIT(28), enable); + /*@enable fast training (path-A)*/ +#if 0 + odm_set_bb_reg(dm, R_0xb34, BIT(29), enable); + /*enable fast training (path-B)*/ +#endif + } else if (dm->support_ic_type & (ODM_RTL8821 | ODM_RTL8822B)) { + odm_set_bb_reg(dm, R_0x900, BIT(19), enable); + /*@enable fast training */ } } -void -phydm_keep_rx_ack_ant_by_tx_ant_time( - void *p_dm_void, - u32 time -) +void phydm_keep_rx_ack_ant_by_tx_ant_time(void *dm_void, u32 time) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; /* Timming issue: keep Rx ant after tx for ACK ( time x 3.2 mu sec)*/ - if (p_dm_odm->support_ic_type & ODM_N_ANTDIV_SUPPORT) { + if (dm->support_ic_type & ODM_N_ANTDIV_SUPPORT) + odm_set_bb_reg(dm, R_0xe20, 0xf00000, time); + else if (dm->support_ic_type & ODM_AC_ANTDIV_SUPPORT) + odm_set_bb_reg(dm, R_0x818, 0xf00000, time); +} - odm_set_bb_reg(p_dm_odm, 0xE20, BIT(23) | BIT(22) | BIT(21) | BIT(20), time); - /**/ - } else if (p_dm_odm->support_ic_type & ODM_AC_ANTDIV_SUPPORT) { +void phydm_update_rx_idle_ac(void *dm_void, u8 ant, u32 default_ant, + u32 optional_ant, u32 default_tx_ant) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; - odm_set_bb_reg(p_dm_odm, 0x818, BIT(23) | BIT(22) | BIT(21) | BIT(20), time); - /**/ + u16 value16 = odm_read_2byte(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_tx_ant << 9); + odm_write_2byte(dm, ODM_REG_TRMUX_11AC + 2, value16); +#if 0 + odm_set_bb_reg(dm, ODM_REG_TRMUX_11AC, 0x380000, default_ant); + /* @Default RX */ + odm_set_bb_reg(dm, ODM_REG_TRMUX_11AC, 0x1c00000, optional_ant); + /* Optional RX */ + odm_set_bb_reg(dm, ODM_REG_TRMUX_11AC, 0xe000000, default_ant); + /* @Default TX */ +#endif +} + +void phydm_update_rx_idle_n(void *dm_void, u8 ant, u32 default_ant, + u32 optional_ant, u32 default_tx_ant) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 value32; + + if (dm->support_ic_type & (ODM_RTL8192E | ODM_RTL8197F)) { + odm_set_bb_reg(dm, R_0xb38, 0x38, default_ant); + /* @Default RX */ + odm_set_bb_reg(dm, R_0xb38, 0x1c0, optional_ant); + /* Optional RX */ + odm_set_bb_reg(dm, R_0x860, 0x7000, default_ant); + /* @Default TX */ +#if (RTL8723B_SUPPORT == 1) + } else if (dm->support_ic_type == ODM_RTL8723B) { + value32 = odm_get_bb_reg(dm, R_0x948, 0xFFF); + + if (value32 != 0x280) + odm_update_rx_idle_ant_8723b(dm, ant, default_ant, + optional_ant); + else + PHYDM_DBG(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 (dm->support_ic_type == ODM_RTL8723D) { + phydm_set_tx_ant_pwr_8723d(dm, ant); + odm_update_rx_idle_ant_8723d(dm, ant, default_ant, + optional_ant); +#endif + +#if (RTL8721D_SUPPORT == 1) + } else if (dm->support_ic_type == ODM_RTL8721D) { + odm_update_rx_idle_ant_8721d(dm, ant, default_ant, + optional_ant); +#endif + } else { +/*@8188E & 8188F*/ +/*@ if (dm->support_ic_type == ODM_RTL8723D) {*/ +/*#if (RTL8723D_SUPPORT == 1)*/ +/* phydm_set_tx_ant_pwr_8723d(dm, ant);*/ +/*#endif*/ +/* }*/ +#if (RTL8188F_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8188F) + phydm_update_rx_idle_antenna_8188F(dm, default_ant); +#endif + + odm_set_bb_reg(dm, R_0x864, 0x38, default_ant);/*@Default RX*/ + odm_set_bb_reg(dm, R_0x864, 0x1c0, optional_ant); + /*Optional RX*/ + odm_set_bb_reg(dm, R_0x860, 0x7000, default_tx_ant); + /*@Default TX*/ } } -void -odm_tx_by_tx_desc_or_reg( - void *p_dm_void, - u8 swch -) +void odm_update_rx_idle_ant(void *dm_void, u8 ant) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; - u8 enable; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + u32 default_ant, optional_ant, value32, default_tx_ant; - 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 (fat_tab->rx_idle_ant != ant) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ Update Rx-Idle-ant ] rx_idle_ant =%s\n", + (ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT"); - if (p_dm_odm->ant_div_type != CGCS_RX_HW_ANTDIV) { - if (p_dm_odm->support_ic_type & ODM_N_ANTDIV_SUPPORT) - odm_set_bb_reg(p_dm_odm, 0x80c, BIT(21), enable); - else if (p_dm_odm->support_ic_type & ODM_AC_ANTDIV_SUPPORT) - odm_set_bb_reg(p_dm_odm, 0x900, BIT(18), enable); - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[AntDiv] TX_Ant_BY (( %s ))\n", (enable == TX_BY_DESC) ? "DESC" : "REG")); - } -} - -void -odm_update_rx_idle_ant( - void *p_dm_void, - u8 ant -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; - u32 default_ant, optional_ant, value32, default_tx_ant; - - if (p_dm_fat_table->rx_idle_ant != ant) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-ant ] rx_idle_ant =%s\n", (ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT")); - - if (!(p_dm_odm->support_ic_type & ODM_RTL8723B)) - p_dm_fat_table->rx_idle_ant = ant; + if (!(dm->support_ic_type & ODM_RTL8723B)) + fat_tab->rx_idle_ant = ant; if (ant == MAIN_ANT) { - default_ant = ANT1_2G; - optional_ant = ANT2_2G; + default_ant = ANT1_2G; + optional_ant = ANT2_2G; } else { - default_ant = ANT2_2G; - optional_ant = ANT1_2G; + 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; + if (fat_tab->b_fix_tx_ant != NO_FIX_TX_ANT) + default_tx_ant = (fat_tab->b_fix_tx_ant == + FIX_TX_AT_MAIN) ? 0 : 1; else default_tx_ant = default_ant; - if (p_dm_odm->support_ic_type & ODM_N_ANTDIV_SUPPORT) { - if (p_dm_odm->support_ic_type == ODM_RTL8192E) { - odm_set_bb_reg(p_dm_odm, 0xB38, BIT(5) | BIT4 | BIT3, default_ant); /* Default RX */ - odm_set_bb_reg(p_dm_odm, 0xB38, BIT(8) | BIT7 | BIT6, optional_ant); /* Optional RX */ - odm_set_bb_reg(p_dm_odm, 0x860, BIT(14) | BIT13 | BIT12, default_ant); /* Default TX */ - } -#if (RTL8723B_SUPPORT == 1) - else if (p_dm_odm->support_ic_type == ODM_RTL8723B) { - - value32 = odm_get_bb_reg(p_dm_odm, 0x948, 0xFFF); - - if (value32 != 0x280) - odm_update_rx_idle_ant_8723b(p_dm_odm, ant, default_ant, optional_ant); - else - ODM_RT_TRACE(p_dm_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 (p_dm_odm->support_ic_type == ODM_RTL8723D) { -#if (RTL8723D_SUPPORT == 1) - phydm_set_tx_ant_pwr_8723d(p_dm_odm, ant); -#endif - } -#if (RTL8188F_SUPPORT == 1) - else if (p_dm_odm->support_ic_type == ODM_RTL8188F) { - phydm_update_rx_idle_antenna_8188F(p_dm_odm, default_ant); - /**/ - } -#endif - - odm_set_bb_reg(p_dm_odm, 0x864, BIT(5) | BIT4 | BIT3, default_ant); /*Default RX*/ - odm_set_bb_reg(p_dm_odm, 0x864, BIT(8) | BIT7 | BIT6, optional_ant); /*Optional RX*/ - odm_set_bb_reg(p_dm_odm, 0x860, BIT(14) | BIT13 | BIT12, default_tx_ant); /*Default TX*/ - } - } else if (p_dm_odm->support_ic_type & ODM_AC_ANTDIV_SUPPORT) { - u16 value16 = odm_read_2byte(p_dm_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 &= ~(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, ODM_REG_TRMUX_11AC + 2, value16); -#if 0 - odm_set_bb_reg(p_dm_odm, ODM_REG_TRMUX_11AC, BIT(21) | BIT20 | BIT19, default_ant); /* Default RX */ - odm_set_bb_reg(p_dm_odm, ODM_REG_TRMUX_11AC, BIT(24) | BIT23 | BIT22, optional_ant); /* Optional RX */ - odm_set_bb_reg(p_dm_odm, ODM_REG_TRMUX_11AC, BIT(27) | BIT26 | BIT25, default_ant); /* Default TX */ -#endif + if (dm->support_ic_type & ODM_N_ANTDIV_SUPPORT) { + phydm_update_rx_idle_n(dm, ant, default_ant, + optional_ant, default_tx_ant); + } else if (dm->support_ic_type & ODM_AC_ANTDIV_SUPPORT) { + phydm_update_rx_idle_ac(dm, ant, default_ant, + optional_ant, default_tx_ant); } + /*PathA Resp Tx*/ + if (dm->support_ic_type & (ODM_RTL8821C | ODM_RTL8822B | + ODM_RTL8814A)) + odm_set_mac_reg(dm, R_0x6d8, 0x7, default_tx_ant); + else if (dm->support_ic_type == ODM_RTL8188E) + odm_set_mac_reg(dm, R_0x6d8, 0xc0, default_tx_ant); + else + odm_set_mac_reg(dm, R_0x6d8, 0x700, default_tx_ant); - if (p_dm_odm->support_ic_type == ODM_RTL8188E) { - odm_set_mac_reg(p_dm_odm, 0x6D8, BIT(7) | BIT6, default_tx_ant); /*PathA Resp Tx*/ - /**/ - } else { - odm_set_mac_reg(p_dm_odm, 0x6D8, BIT(10) | BIT9 | BIT8, default_tx_ant); /*PathA Resp Tx*/ - /**/ - } - - } else { /* p_dm_fat_table->rx_idle_ant == ant */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Stay in Ori-ant ] rx_idle_ant =%s\n", (ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT")); - p_dm_fat_table->rx_idle_ant = ant; + } else { /* @fat_tab->rx_idle_ant == ant */ + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ Stay in Ori-ant ] rx_idle_ant =%s\n", + (ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT"); + fat_tab->rx_idle_ant = ant; } } -void -odm_update_tx_ant( - void *p_dm_void, - u8 ant, - u32 mac_id -) +void phydm_update_rx_idle_ant_pathb(void *dm_void, u8 ant) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; - u8 tx_ant; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + u32 default_ant, optional_ant, value32, default_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 (fat_tab->rx_idle_ant2 != ant) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ Update Rx-Idle-ant2 ] rx_idle_ant2 =%s\n", + (ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_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_odm->ant_div_type == CG_TRX_SMART_ANTDIV) + if (fat_tab->b_fix_tx_ant != NO_FIX_TX_ANT) + default_tx_ant = (fat_tab->b_fix_tx_ant == + FIX_TX_AT_MAIN) ? 0 : 1; + else + default_tx_ant = default_ant; + if (dm->support_ic_type & ODM_RTL8822B) { + u16 v16 = odm_read_2byte(dm, ODM_REG_ANT_11AC_B + 2); + + v16 &= ~(0xff8);/*0xE08[11:3]*/ + v16 |= ((u16)default_ant << 3); + v16 |= ((u16)optional_ant << 6); + v16 |= ((u16)default_tx_ant << 9); + odm_write_2byte(dm, ODM_REG_ANT_11AC_B + 2, v16); + odm_set_mac_reg(dm, R_0x6d8, 0x38, default_tx_ant); + /*PathB Resp Tx*/ + } + } else { + /* fat_tab->rx_idle_ant2 == ant */ + PHYDM_DBG(dm, DBG_ANT_DIV, "[Stay Ori Ant] rx_idle_ant2 = %s\n", + (ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT"); + fat_tab->rx_idle_ant2 = ant; + } +} + +void phydm_set_antdiv_val(void *dm_void, u32 *val_buf, u8 val_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (val_len != 1) { + PHYDM_DBG(dm, ODM_COMP_API, "[Error][antdiv]Need val_len=1\n"); + return; + } + + odm_update_rx_idle_ant(dm, (u8)(*val_buf)); +} + +void odm_update_tx_ant(void *dm_void, u8 ant, u32 mac_id) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + u8 tx_ant; + + if (fat_tab->b_fix_tx_ant != NO_FIX_TX_ANT) + ant = (fat_tab->b_fix_tx_ant == FIX_TX_AT_MAIN) ? + MAIN_ANT : AUX_ANT; + + if (dm->ant_div_type == CG_TRX_SMART_ANTDIV) tx_ant = ant; else { if (ant == MAIN_ANT) @@ -357,597 +484,626 @@ odm_update_tx_ant( 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; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Set TX-DESC value]: mac_id:(( %d )), tx_ant = (( %s ))\n", mac_id, (ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT")); - /* ODM_RT_TRACE(p_dm_odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("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] )); */ + fat_tab->antsel_a[mac_id] = tx_ant & BIT(0); + fat_tab->antsel_b[mac_id] = (tx_ant & BIT(1)) >> 1; + fat_tab->antsel_c[mac_id] = (tx_ant & BIT(2)) >> 2; + PHYDM_DBG(dm, DBG_ANT_DIV, + "[Set TX-DESC value]: mac_id:(( %d )), tx_ant = (( %s ))\n", + mac_id, (ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT"); +#if 0 + PHYDM_DBG(dm, DBG_ANT_DIV, + "antsel_tr_mux=(( 3'b%d%d%d ))\n", + fat_tab->antsel_c[mac_id], fat_tab->antsel_b[mac_id], + fat_tab->antsel_a[mac_id]); +#endif } -#ifdef BEAMFORMING_SUPPORT +#ifdef PHYDM_BEAMFORMING_SUPPORT #if (DM_ODM_SUPPORT_TYPE == ODM_AP) -void -odm_bdc_init( - void *p_dm_void -) +void odm_bdc_init( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _BF_DIV_COEX_ *p_dm_bdc_table = &p_dm_odm->dm_bdc_table; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _BF_DIV_COEX_ *dm_bdc_table = &dm->dm_bdc_table; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\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_odm->bdc_holdstate = 0xff; + PHYDM_DBG(dm, DBG_ANT_DIV, "\n[ BDC Initialization......]\n"); + dm_bdc_table->BDC_state = BDC_DIV_TRAIN_STATE; + dm_bdc_table->bdc_mode = BDC_MODE_NULL; + dm_bdc_table->bdc_try_flag = 0; + dm_bdc_table->bd_ccoex_type_wbfer = 0; + dm->bdc_holdstate = 0xff; - if (p_dm_odm->support_ic_type == ODM_RTL8192E) { - odm_set_bb_reg(p_dm_odm, 0xd7c, 0x0FFFFFFF, 0x1081008); - odm_set_bb_reg(p_dm_odm, 0xd80, 0x0FFFFFFF, 0); - } else if (p_dm_odm->support_ic_type == ODM_RTL8812) { - odm_set_bb_reg(p_dm_odm, 0x9b0, 0x0FFFFFFF, 0x1081008); /* 0x9b0[30:0] = 01081008 */ - odm_set_bb_reg(p_dm_odm, 0x9b4, 0x0FFFFFFF, 0); /* 0x9b4[31:0] = 00000000 */ + if (dm->support_ic_type == ODM_RTL8192E) { + odm_set_bb_reg(dm, R_0xd7c, 0x0FFFFFFF, 0x1081008); + odm_set_bb_reg(dm, R_0xd80, 0x0FFFFFFF, 0); + } else if (dm->support_ic_type == ODM_RTL8812) { + odm_set_bb_reg(dm, R_0x9b0, 0x0FFFFFFF, 0x1081008); + /* @0x9b0[30:0] = 01081008 */ + odm_set_bb_reg(dm, R_0x9b4, 0x0FFFFFFF, 0); + /* @0x9b4[31:0] = 00000000 */ } - } - -void -odm_CSI_on_off( - void *p_dm_void, - u8 CSI_en -) +void odm_CSI_on_off( + void *dm_void, + u8 CSI_en) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; if (CSI_en == CSI_ON) { - if (p_dm_odm->support_ic_type == ODM_RTL8192E) { - odm_set_mac_reg(p_dm_odm, 0xd84, BIT(11), 1); /* 0xd84[11]=1 */ - } else if (p_dm_odm->support_ic_type == ODM_RTL8812) { - odm_set_mac_reg(p_dm_odm, 0x9b0, BIT(31), 1); /* 0x9b0[31]=1 */ - } + if (dm->support_ic_type == ODM_RTL8192E) + odm_set_mac_reg(dm, R_0xd84, BIT(11), 1); + /* @0xd84[11]=1 */ + else if (dm->support_ic_type == ODM_RTL8812) + odm_set_mac_reg(dm, R_0x9b0, BIT(31), 1); + /* @0x9b0[31]=1 */ } else if (CSI_en == CSI_OFF) { - if (p_dm_odm->support_ic_type == ODM_RTL8192E) { - odm_set_mac_reg(p_dm_odm, 0xd84, BIT(11), 0); /* 0xd84[11]=0 */ - } else if (p_dm_odm->support_ic_type == ODM_RTL8812) { - odm_set_mac_reg(p_dm_odm, 0x9b0, BIT(31), 0); /* 0x9b0[31]=0 */ - } + if (dm->support_ic_type == ODM_RTL8192E) + odm_set_mac_reg(dm, R_0xd84, BIT(11), 0); + /* @0xd84[11]=0 */ + else if (dm->support_ic_type == ODM_RTL8812) + odm_set_mac_reg(dm, R_0x9b0, BIT(31), 0); + /* @0x9b0[31]=0 */ } } -void -odm_bd_ccoex_type_with_bfer_client( - void *p_dm_void, - u8 swch -) +void odm_bd_ccoex_type_with_bfer_client( + void *dm_void, + u8 swch) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _BF_DIV_COEX_ *p_dm_bdc_table = &p_dm_odm->dm_bdc_table; - u8 bd_ccoex_type_wbfer; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _BF_DIV_COEX_ *dm_bdc_table = &dm->dm_bdc_table; + u8 bd_ccoex_type_wbfer; if (swch == DIVON_CSIOFF) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[BDCcoexType: 1] {DIV,CSI} ={1,0}\n")); + PHYDM_DBG(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_odm, ANTDIV_ON); - odm_CSI_on_off(p_dm_odm, CSI_OFF); - p_dm_bdc_table->bd_ccoex_type_wbfer = 1; + if (bd_ccoex_type_wbfer != dm_bdc_table->bd_ccoex_type_wbfer) { + odm_ant_div_on_off(dm, ANTDIV_ON, ANT_PATH_A); + odm_CSI_on_off(dm, CSI_OFF); + dm_bdc_table->bd_ccoex_type_wbfer = 1; } } else if (swch == DIVOFF_CSION) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[BDCcoexType: 2] {DIV,CSI} ={0,1}\n")); + PHYDM_DBG(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_odm, ANTDIV_OFF); - odm_CSI_on_off(p_dm_odm, CSI_ON); - p_dm_bdc_table->bd_ccoex_type_wbfer = 2; + if (bd_ccoex_type_wbfer != dm_bdc_table->bd_ccoex_type_wbfer) { + odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_A); + odm_CSI_on_off(dm, CSI_ON); + dm_bdc_table->bd_ccoex_type_wbfer = 2; } } } -void -odm_bf_ant_div_mode_arbitration( - void *p_dm_void -) +void odm_bf_ant_div_mode_arbitration( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _BF_DIV_COEX_ *p_dm_bdc_table = &p_dm_odm->dm_bdc_table; - u8 current_bdc_mode; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _BF_DIV_COEX_ *dm_bdc_table = &dm->dm_bdc_table; + u8 current_bdc_mode; #if (DM_ODM_SUPPORT_TYPE == ODM_AP) - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\n")); + PHYDM_DBG(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)) { + /* @2 mode 1 */ + if (dm_bdc_table->num_txbfee_client != 0 && + 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_odm, DIVON_CSIOFF); - p_dm_bdc_table->bdc_rx_idle_update_counter = 1; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Change to (( Mode1 ))\n")); + if (current_bdc_mode != dm_bdc_table->bdc_mode) { + dm_bdc_table->bdc_mode = BDC_MODE_1; + odm_bd_ccoex_type_with_bfer_client(dm, DIVON_CSIOFF); + dm_bdc_table->bdc_rx_idle_update_counter = 1; + PHYDM_DBG(dm, DBG_ANT_DIV, "Change to (( Mode1 ))\n"); } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Antdiv + BF coextance mode] : (( Mode1 ))\n")); + PHYDM_DBG(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)) { + /* @2 mode 2 */ + else if ((dm_bdc_table->num_txbfee_client == 0) && + (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; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Change to (( Mode2 ))\n")); - + if (current_bdc_mode != dm_bdc_table->bdc_mode) { + dm_bdc_table->bdc_mode = BDC_MODE_2; + dm_bdc_table->BDC_state = BDC_DIV_TRAIN_STATE; + dm_bdc_table->bdc_try_flag = 0; + PHYDM_DBG(dm, DBG_ANT_DIV, "Change to (( Mode2 ))\n"); } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Antdiv + BF coextance mode] : (( Mode2 ))\n")); + PHYDM_DBG(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)) { + /* @2 mode 3 */ + else if ((dm_bdc_table->num_txbfee_client != 0) && + (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; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Change to (( Mode3 ))\n")); + if (current_bdc_mode != dm_bdc_table->bdc_mode) { + dm_bdc_table->bdc_mode = BDC_MODE_3; + dm_bdc_table->BDC_state = BDC_DIV_TRAIN_STATE; + dm_bdc_table->bdc_try_flag = 0; + dm_bdc_table->bdc_rx_idle_update_counter = 1; + PHYDM_DBG(dm, DBG_ANT_DIV, "Change to (( Mode3 ))\n"); } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Antdiv + BF coextance mode] : (( Mode3 ))\n")); + PHYDM_DBG(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)) { + /* @2 mode 4 */ + else if ((dm_bdc_table->num_txbfee_client == 0) && + (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_odm, DIVON_CSIOFF); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Change to (( Mode4 ))\n")); + if (current_bdc_mode != dm_bdc_table->bdc_mode) { + dm_bdc_table->bdc_mode = BDC_MODE_4; + odm_bd_ccoex_type_with_bfer_client(dm, DIVON_CSIOFF); + PHYDM_DBG(dm, DBG_ANT_DIV, "Change to (( Mode4 ))\n"); } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Antdiv + BF coextance mode] : (( Mode4 ))\n")); + PHYDM_DBG(dm, DBG_ANT_DIV, + "[Antdiv + BF coextance mode] : (( Mode4 ))\n"); } #endif - } -void -odm_div_train_state_setting( - void *p_dm_void -) +void odm_div_train_state_setting( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _BF_DIV_COEX_ *p_dm_bdc_table = &p_dm_odm->dm_bdc_table; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _BF_DIV_COEX_ *dm_bdc_table = &dm->dm_bdc_table; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\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_odm, DIVON_CSIOFF); + PHYDM_DBG(dm, DBG_ANT_DIV, + "\n*****[S T A R T ]***** [2-0. DIV_TRAIN_STATE]\n"); + dm_bdc_table->bdc_try_counter = 2; + dm_bdc_table->bdc_try_flag = 1; + dm_bdc_table->BDC_state = bdc_bfer_train_state; + odm_bd_ccoex_type_with_bfer_client(dm, DIVON_CSIOFF); } -void -odm_bd_ccoex_bfee_rx_div_arbitration( - void *p_dm_void -) +void odm_bd_ccoex_bfee_rx_div_arbitration( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _BF_DIV_COEX_ *p_dm_bdc_table = &p_dm_odm->dm_bdc_table; - bool stop_bf_flag; - u8 bdc_active_mode; - + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _BF_DIV_COEX_ *dm_bdc_table = &dm->dm_bdc_table; + boolean stop_bf_flag; + u8 bdc_active_mode; #if (DM_ODM_SUPPORT_TYPE == ODM_AP) - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***{ 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)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***{ num_BF_tars, num_DIV_tars } = (( %d , %d ))\n", p_dm_bdc_table->num_bf_tar, p_dm_bdc_table->num_div_tar)); + PHYDM_DBG(dm, DBG_ANT_DIV, + "***{ num_BFee, num_BFer, num_client} = (( %d , %d , %d))\n", + dm_bdc_table->num_txbfee_client, + dm_bdc_table->num_txbfer_client, dm_bdc_table->num_client); + PHYDM_DBG(dm, DBG_ANT_DIV, + "***{ num_BF_tars, num_DIV_tars } = (( %d , %d ))\n", + dm_bdc_table->num_bf_tar, dm_bdc_table->num_div_tar); - /* 2 [ MIB control ] */ - if (p_dm_odm->bdc_holdstate == 2) { - odm_bd_ccoex_type_with_bfer_client(p_dm_odm, DIVOFF_CSION); - p_dm_bdc_table->BDC_state = BDC_BF_HOLD_STATE; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Force in [ BF STATE]\n")); + /* @2 [ MIB control ] */ + if (dm->bdc_holdstate == 2) { + odm_bd_ccoex_type_with_bfer_client(dm, DIVOFF_CSION); + dm_bdc_table->BDC_state = BDC_BF_HOLD_STATE; + PHYDM_DBG(dm, DBG_ANT_DIV, "Force in [ BF STATE]\n"); return; - } else if (p_dm_odm->bdc_holdstate == 1) { - p_dm_bdc_table->BDC_state = BDC_DIV_HOLD_STATE; - odm_bd_ccoex_type_with_bfer_client(p_dm_odm, DIVON_CSIOFF); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Force in [ DIV STATE]\n")); + } else if (dm->bdc_holdstate == 1) { + dm_bdc_table->BDC_state = BDC_DIV_HOLD_STATE; + odm_bd_ccoex_type_with_bfer_client(dm, DIVON_CSIOFF); + PHYDM_DBG(dm, DBG_ANT_DIV, "Force in [ DIV STATE]\n"); return; } - /* ------------------------------------------------------------ */ + /* @------------------------------------------------------------ */ + /* @2 mode 2 & 3 */ + if (dm_bdc_table->bdc_mode == BDC_MODE_2 || + dm_bdc_table->bdc_mode == BDC_MODE_3) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "\n{ Try_flag, Try_counter } = { %d , %d }\n", + dm_bdc_table->bdc_try_flag, + dm_bdc_table->bdc_try_counter); + PHYDM_DBG(dm, DBG_ANT_DIV, "BDCcoexType = (( %d ))\n\n", + dm_bdc_table->bd_ccoex_type_wbfer); - - /* 2 mode 2 & 3 */ - if (p_dm_bdc_table->bdc_mode == BDC_MODE_2 || p_dm_bdc_table->bdc_mode == BDC_MODE_3) { - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\n{ Try_flag, Try_counter } = { %d , %d }\n", p_dm_bdc_table->bdc_try_flag, p_dm_bdc_table->bdc_try_counter)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("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 */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("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_odm, DIVOFF_CSION); + /* @All Client have Bfer-Cap------------------------------- */ + if (dm_bdc_table->num_txbfer_client == dm_bdc_table->num_client) { + /* @BFer STA Only?: yes */ + PHYDM_DBG(dm, DBG_ANT_DIV, + "BFer STA only? (( Yes ))\n"); + dm_bdc_table->bdc_try_flag = 0; + dm_bdc_table->BDC_state = BDC_DIV_TRAIN_STATE; + odm_bd_ccoex_type_with_bfer_client(dm, DIVOFF_CSION); return; } else - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("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) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("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_odm, DIVOFF_CSION); + PHYDM_DBG(dm, DBG_ANT_DIV, + "BFer STA only? (( No ))\n"); + if (dm_bdc_table->is_all_bf_sta_idle == false && dm_bdc_table->is_all_div_sta_idle == true) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "All DIV-STA are idle, but BF-STA not\n"); + dm_bdc_table->bdc_try_flag = 0; + dm_bdc_table->BDC_state = bdc_bfer_train_state; + odm_bd_ccoex_type_with_bfer_client(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) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("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_odm, DIVON_CSIOFF); + } else if (dm_bdc_table->is_all_bf_sta_idle == true && dm_bdc_table->is_all_div_sta_idle == false) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "All BF-STA are idle, but DIV-STA not\n"); + dm_bdc_table->bdc_try_flag = 0; + dm_bdc_table->BDC_state = BDC_DIV_TRAIN_STATE; + odm_bd_ccoex_type_with_bfer_client(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 */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Select active mode (( 1 ))\n")); - p_dm_bdc_table->bdc_active_mode = 1; + if (dm_bdc_table->num_bf_tar == 0) { /* Selsect_1, Selsect_2 */ + if (dm_bdc_table->num_div_tar == 0) { /* Selsect_3 */ + PHYDM_DBG(dm, DBG_ANT_DIV, + "Select active mode (( 1 ))\n"); + dm_bdc_table->bdc_active_mode = 1; } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Select active mode (( 2 ))\n")); - p_dm_bdc_table->bdc_active_mode = 2; + PHYDM_DBG(dm, DBG_ANT_DIV, + "Select active mode (( 2 ))\n"); + 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_odm, DIVON_CSIOFF); + dm_bdc_table->bdc_try_flag = 0; + dm_bdc_table->BDC_state = BDC_DIV_TRAIN_STATE; + odm_bd_ccoex_type_with_bfer_client(dm, DIVON_CSIOFF); return; } else { /* num_bf_tar > 0 */ - if (p_dm_bdc_table->num_div_tar == 0) { /* Selsect_3 */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("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_odm, DIVOFF_CSION); + if (dm_bdc_table->num_div_tar == 0) { /* Selsect_3 */ + PHYDM_DBG(dm, DBG_ANT_DIV, + "Select active mode (( 3 ))\n"); + dm_bdc_table->bdc_active_mode = 3; + dm_bdc_table->bdc_try_flag = 0; + dm_bdc_table->BDC_state = bdc_bfer_train_state; + odm_bd_ccoex_type_with_bfer_client(dm, + DIVOFF_CSION) + ; return; } else { /* Selsect_4 */ bdc_active_mode = 4; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Select active mode (( 4 ))\n")); + PHYDM_DBG(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; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Change to active mode (( 4 )) & return!!!\n")); + if (bdc_active_mode != dm_bdc_table->bdc_active_mode) { + dm_bdc_table->bdc_active_mode = 4; + PHYDM_DBG(dm, DBG_ANT_DIV, "Change to active mode (( 4 )) & return!!!\n"); return; } } } #if 1 - if (p_dm_odm->bdc_holdstate == 0xff) { - p_dm_bdc_table->BDC_state = BDC_DIV_HOLD_STATE; - odm_bd_ccoex_type_with_bfer_client(p_dm_odm, DIVON_CSIOFF); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Force in [ DIV STATE]\n")); + if (dm->bdc_holdstate == 0xff) { + dm_bdc_table->BDC_state = BDC_DIV_HOLD_STATE; + odm_bd_ccoex_type_with_bfer_client(dm, DIVON_CSIOFF); + PHYDM_DBG(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; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ The number of client has been changed !!!] return to (( BDC_DIV_TRAIN_STATE ))\n")); + /* @Does Client number changed ? ------------------------------- */ + if (dm_bdc_table->num_client != dm_bdc_table->pre_num_client) { + dm_bdc_table->bdc_try_flag = 0; + dm_bdc_table->BDC_state = BDC_DIV_TRAIN_STATE; + PHYDM_DBG(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; + dm_bdc_table->pre_num_client = 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_odm); - /* 2 BFer_TRAIN_STATE (mode 2-1) */ - else if (p_dm_bdc_table->BDC_state == bdc_bfer_train_state) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*****[2-1. BFer_TRAIN_STATE ]*****\n")); + if (dm_bdc_table->bdc_try_flag == 0) { + /* @2 DIV_TRAIN_STATE (mode 2-0) */ + if (dm_bdc_table->BDC_state == BDC_DIV_TRAIN_STATE) + odm_div_train_state_setting(dm); + /* @2 BFer_TRAIN_STATE (mode 2-1) */ + else if (dm_bdc_table->BDC_state == bdc_bfer_train_state) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "*****[2-1. BFer_TRAIN_STATE ]*****\n"); - /* if(p_dm_bdc_table->num_bf_tar==0) */ - /* { */ - /* ODM_RT_TRACE(p_dm_odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BF_tars exist? : (( No )), [ bdc_bfer_train_state ] >> [BDC_DIV_TRAIN_STATE]\n")); */ - /* odm_div_train_state_setting( p_dm_odm); */ - /* } */ +#if 0 + /* @if(dm_bdc_table->num_bf_tar==0) */ + /* @{ */ + /* PHYDM_DBG(dm,DBG_ANT_DIV, "BF_tars exist? : (( No )), [ bdc_bfer_train_state ] >> [BDC_DIV_TRAIN_STATE]\n"); */ + /* odm_div_train_state_setting( 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_odm, DIVOFF_CSION); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BF_tars exist? : (( Yes )), [ bdc_bfer_train_state ] >> [BDC_DECISION_STATE]\n")); - /* } */ + /* @{ */ +#endif + dm_bdc_table->bdc_try_counter = 2; + dm_bdc_table->bdc_try_flag = 1; + dm_bdc_table->BDC_state = BDC_DECISION_STATE; + odm_bd_ccoex_type_with_bfer_client(dm, DIVOFF_CSION); + PHYDM_DBG(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) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*****[2-2. DECISION_STATE]*****\n")); - /* if(p_dm_bdc_table->num_bf_tar==0) */ - /* { */ + /* @2 DECISION_STATE (mode 2-2) */ + else if (dm_bdc_table->BDC_state == BDC_DECISION_STATE) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "*****[2-2. DECISION_STATE]*****\n"); +#if 0 + /* @if(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_odm); */ - /* } */ + /* odm_div_train_state_setting( dm); */ + /* @} */ /* else */ /* num_bf_tar != 0 */ - /* { */ - if (p_dm_bdc_table->BF_pass == false || p_dm_bdc_table->DIV_pass == false) + /* @{ */ +#endif + if (dm_bdc_table->BF_pass == false || dm_bdc_table->DIV_pass == false) stop_bf_flag = true; else stop_bf_flag = false; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("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)); + PHYDM_DBG(dm, DBG_ANT_DIV, + "BF_tars exist? : (( Yes )), {BF_pass, DIV_pass, stop_bf_flag } = { %d, %d, %d }\n", + dm_bdc_table->BF_pass, + 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_odm, DIVON_CSIOFF); - p_dm_bdc_table->BDC_state = BDC_DIV_HOLD_STATE; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 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_odm, DIVOFF_CSION); - p_dm_bdc_table->BDC_state = BDC_BF_HOLD_STATE; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[stop_bf_flag= ((false)), BDC_DECISION_STATE ] >> [BDC_BF_HOLD_STATE]\n")); + if (stop_bf_flag == true) { /* @DIV_en */ + dm_bdc_table->bdc_hold_counter = 10; /* @20 */ + odm_bd_ccoex_type_with_bfer_client(dm, DIVON_CSIOFF); + dm_bdc_table->BDC_state = BDC_DIV_HOLD_STATE; + PHYDM_DBG(dm, DBG_ANT_DIV, "[ stop_bf_flag= ((true)), BDC_DECISION_STATE ] >> [BDC_DIV_HOLD_STATE]\n"); + } else { /* @BF_en */ + dm_bdc_table->bdc_hold_counter = 10; /* @20 */ + odm_bd_ccoex_type_with_bfer_client(dm, DIVOFF_CSION); + dm_bdc_table->BDC_state = BDC_BF_HOLD_STATE; + PHYDM_DBG(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) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*****[2-3. BF_HOLD_STATE ]*****\n")); + /* @2 BF-HOLD_STATE (mode 2-3) */ + else if (dm_bdc_table->BDC_state == BDC_BF_HOLD_STATE) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "*****[2-3. BF_HOLD_STATE ]*****\n"); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("bdc_hold_counter = (( %d ))\n", p_dm_bdc_table->bdc_hold_counter)); + PHYDM_DBG(dm, DBG_ANT_DIV, + "bdc_hold_counter = (( %d ))\n", + dm_bdc_table->bdc_hold_counter); - if (p_dm_bdc_table->bdc_hold_counter == 1) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ BDC_BF_HOLD_STATE ] >> [BDC_DIV_TRAIN_STATE]\n")); - odm_div_train_state_setting(p_dm_odm); + if (dm_bdc_table->bdc_hold_counter == 1) { + PHYDM_DBG(dm, DBG_ANT_DIV, "[ BDC_BF_HOLD_STATE ] >> [BDC_DIV_TRAIN_STATE]\n"); + odm_div_train_state_setting(dm); } else { - p_dm_bdc_table->bdc_hold_counter--; + dm_bdc_table->bdc_hold_counter--; - /* if(p_dm_bdc_table->num_bf_tar==0) */ - /* { */ - /* ODM_RT_TRACE(p_dm_odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BF_tars exist? : (( No )), [ BDC_BF_HOLD_STATE ] >> [BDC_DIV_TRAIN_STATE]\n")); */ - /* odm_div_train_state_setting( p_dm_odm); */ - /* } */ +#if 0 + /* @if(dm_bdc_table->num_bf_tar==0) */ + /* @{ */ + /* PHYDM_DBG(dm,DBG_ANT_DIV, "BF_tars exist? : (( No )), [ BDC_BF_HOLD_STATE ] >> [BDC_DIV_TRAIN_STATE]\n"); */ + /* odm_div_train_state_setting( dm); */ + /* @} */ /* else */ /* num_bf_tar != 0 */ - /* { */ - /* ODM_RT_TRACE(p_dm_odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BF_tars exist? : (( Yes ))\n")); */ - p_dm_bdc_table->BDC_state = BDC_BF_HOLD_STATE; - odm_bd_ccoex_type_with_bfer_client(p_dm_odm, DIVOFF_CSION); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ BDC_BF_HOLD_STATE ] >> [BDC_BF_HOLD_STATE]\n")); - /* } */ + /* @{ */ + /* PHYDM_DBG(dm,DBG_ANT_DIV, "BF_tars exist? : (( Yes ))\n"); */ +#endif + dm_bdc_table->BDC_state = BDC_BF_HOLD_STATE; + odm_bd_ccoex_type_with_bfer_client(dm, DIVOFF_CSION); + PHYDM_DBG(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) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*****[2-4. DIV_HOLD_STATE ]*****\n")); + /* @2 DIV-HOLD_STATE (mode 2-4) */ + else if (dm_bdc_table->BDC_state == BDC_DIV_HOLD_STATE) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "*****[2-4. DIV_HOLD_STATE ]*****\n"); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("bdc_hold_counter = (( %d ))\n", p_dm_bdc_table->bdc_hold_counter)); + PHYDM_DBG(dm, DBG_ANT_DIV, + "bdc_hold_counter = (( %d ))\n", + dm_bdc_table->bdc_hold_counter); - if (p_dm_bdc_table->bdc_hold_counter == 1) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ BDC_DIV_HOLD_STATE ] >> [BDC_DIV_TRAIN_STATE]\n")); - odm_div_train_state_setting(p_dm_odm); + if (dm_bdc_table->bdc_hold_counter == 1) { + PHYDM_DBG(dm, DBG_ANT_DIV, "[ BDC_DIV_HOLD_STATE ] >> [BDC_DIV_TRAIN_STATE]\n"); + odm_div_train_state_setting(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_odm, DIVON_CSIOFF); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ BDC_DIV_HOLD_STATE ] >> [BDC_DIV_HOLD_STATE]\n")); + dm_bdc_table->bdc_hold_counter--; + dm_bdc_table->BDC_state = BDC_DIV_HOLD_STATE; + odm_bd_ccoex_type_with_bfer_client(dm, DIVON_CSIOFF); + PHYDM_DBG(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; + } else if (dm_bdc_table->bdc_try_flag == 1) { + /* @2 Set Training counter */ + if (dm_bdc_table->bdc_try_counter > 1) { + dm_bdc_table->bdc_try_counter--; + if (dm_bdc_table->bdc_try_counter == 1) + dm_bdc_table->bdc_try_flag = 0; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Training !!\n")); + PHYDM_DBG(dm, DBG_ANT_DIV, "Training !!\n"); /* return ; */ } - } - } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\n[end]\n")); - -#endif /* #if(DM_ODM_SUPPORT_TYPE == ODM_AP) */ - - - - - + PHYDM_DBG(dm, DBG_ANT_DIV, "\n[end]\n"); +#endif /* @#if(DM_ODM_SUPPORT_TYPE == ODM_AP) */ } #endif -#endif /* #ifdef BEAMFORMING_SUPPORT */ - +#endif /* @#ifdef PHYDM_BEAMFORMING_SUPPORT*/ #if (RTL8188E_SUPPORT == 1) - -void -odm_rx_hw_ant_div_init_88e( - void *p_dm_void -) +void odm_rx_hw_ant_div_init_88e(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u32 value32; - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 value32; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -#if 0 - if (p_dm_odm->mp_mode == true) { - odm_set_bb_reg(p_dm_odm, ODM_REG_IGI_A_11N, BIT(7), 0); /* disable HW AntDiv */ - odm_set_bb_reg(p_dm_odm, ODM_REG_LNA_SWITCH_11N, BIT(31), 1); /* 1:CG, 0:CS */ - return; - } -#endif + PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8188E AntDiv_Init => ant_div_type=[CGCS_RX_HW_ANTDIV]\n")); - - /* MAC setting */ - value32 = odm_get_mac_reg(p_dm_odm, ODM_REG_ANTSEL_PIN_11N, MASKDWORD); - odm_set_mac_reg(p_dm_odm, ODM_REG_ANTSEL_PIN_11N, MASKDWORD, value32 | (BIT(23) | BIT25)); /* Reg4C[25]=1, Reg4C[23]=1 for pin output */ + /* @MAC setting */ + value32 = odm_get_mac_reg(dm, ODM_REG_ANTSEL_PIN_11N, MASKDWORD); + odm_set_mac_reg(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, ODM_REG_PIN_CTRL_11N, BIT(9) | BIT8, 0);/* reg870[8]=1'b0, reg870[9]=1'b0 */ /* antsel antselb by HW */ - odm_set_bb_reg(p_dm_odm, ODM_REG_RX_ANT_CTRL_11N, BIT(10), 0); /* reg864[10]=1'b0 */ /* antsel2 by HW */ - odm_set_bb_reg(p_dm_odm, ODM_REG_LNA_SWITCH_11N, BIT(22), 1); /* regb2c[22]=1'b0 */ /* disable CS/CG switch */ - odm_set_bb_reg(p_dm_odm, ODM_REG_LNA_SWITCH_11N, BIT(31), 1); /* regb2c[31]=1'b1 */ /* output at CG only */ + odm_set_bb_reg(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(dm, ODM_REG_RX_ANT_CTRL_11N, BIT(10), 0); + /* reg864[10]=1'b0 */ /* antsel2 by HW */ + odm_set_bb_reg(dm, ODM_REG_LNA_SWITCH_11N, BIT(22), 1); + /* regb2c[22]=1'b0 */ /* disable CS/CG switch */ + odm_set_bb_reg(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, ODM_REG_ANTDIV_PARA1_11N, MASKDWORD, 0x000000a0); - /* CCK Settings */ - odm_set_bb_reg(p_dm_odm, ODM_REG_BB_PWR_SAV4_11N, BIT(7), 1); /* Fix CCK PHY status report issue */ - odm_set_bb_reg(p_dm_odm, ODM_REG_CCK_ANTDIV_PARA2_11N, BIT(4), 1); /* CCK complete HW AntDiv within 64 samples */ + odm_set_bb_reg(dm, ODM_REG_ANTDIV_PARA1_11N, MASKDWORD, 0x000000a0); + /* @CCK Settings */ + odm_set_bb_reg(dm, ODM_REG_BB_PWR_SAV4_11N, BIT(7), 1); + /* @Fix CCK PHY status report issue */ + odm_set_bb_reg(dm, ODM_REG_CCK_ANTDIV_PARA2_11N, BIT(4), 1); + /* @CCK complete HW AntDiv within 64 samples */ - odm_set_bb_reg(p_dm_odm, ODM_REG_ANT_MAPPING1_11N, 0xFFFF, 0x0001); /* antenna mapping table */ + odm_set_bb_reg(dm, ODM_REG_ANT_MAPPING1_11N, 0xFFFF, 0x0001); + /* @antenna mapping table */ - p_dm_fat_table->enable_ctrl_frame_antdiv = 1; + fat_tab->enable_ctrl_frame_antdiv = 1; } -void -odm_trx_hw_ant_div_init_88e( - void *p_dm_void -) +void odm_trx_hw_ant_div_init_88e(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u32 value32; - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 value32; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; -#if 0 - if (p_dm_odm->mp_mode == true) { - odm_set_bb_reg(p_dm_odm, ODM_REG_IGI_A_11N, BIT(7), 0); /* disable HW AntDiv */ - odm_set_bb_reg(p_dm_odm, ODM_REG_RX_ANT_CTRL_11N, BIT(5) | BIT4 | BIT3, 0); /* Default RX (0/1) */ - return; - } -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8188E AntDiv_Init => ant_div_type=[CG_TRX_HW_ANTDIV (SPDT)]\n")); + PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); - /* MAC setting */ - value32 = odm_get_mac_reg(p_dm_odm, ODM_REG_ANTSEL_PIN_11N, MASKDWORD); - odm_set_mac_reg(p_dm_odm, ODM_REG_ANTSEL_PIN_11N, MASKDWORD, value32 | (BIT(23) | BIT25)); /* Reg4C[25]=1, Reg4C[23]=1 for pin output */ + /* @MAC setting */ + value32 = odm_get_mac_reg(dm, ODM_REG_ANTSEL_PIN_11N, MASKDWORD); + odm_set_mac_reg(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, ODM_REG_PIN_CTRL_11N, BIT(9) | BIT8, 0);/* reg870[8]=1'b0, reg870[9]=1'b0 */ /* antsel antselb by HW */ - odm_set_bb_reg(p_dm_odm, ODM_REG_RX_ANT_CTRL_11N, BIT(10), 0); /* reg864[10]=1'b0 */ /* antsel2 by HW */ - odm_set_bb_reg(p_dm_odm, ODM_REG_LNA_SWITCH_11N, BIT(22), 0); /* regb2c[22]=1'b0 */ /* disable CS/CG switch */ - odm_set_bb_reg(p_dm_odm, ODM_REG_LNA_SWITCH_11N, BIT(31), 1); /* regb2c[31]=1'b1 */ /* output at CG only */ + odm_set_bb_reg(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(dm, ODM_REG_RX_ANT_CTRL_11N, BIT(10), 0); + /* reg864[10]=1'b0 */ /* antsel2 by HW */ + odm_set_bb_reg(dm, ODM_REG_LNA_SWITCH_11N, BIT(22), 0); + /* regb2c[22]=1'b0 */ /* disable CS/CG switch */ + odm_set_bb_reg(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, ODM_REG_ANTDIV_PARA1_11N, MASKDWORD, 0x000000a0); - /* CCK Settings */ - odm_set_bb_reg(p_dm_odm, ODM_REG_BB_PWR_SAV4_11N, BIT(7), 1); /* Fix CCK PHY status report issue */ - odm_set_bb_reg(p_dm_odm, ODM_REG_CCK_ANTDIV_PARA2_11N, BIT(4), 1); /* CCK complete HW AntDiv within 64 samples */ + odm_set_bb_reg(dm, ODM_REG_ANTDIV_PARA1_11N, MASKDWORD, 0x000000a0); + /* @CCK Settings */ + odm_set_bb_reg(dm, ODM_REG_BB_PWR_SAV4_11N, BIT(7), 1); + /* @Fix CCK PHY status report issue */ + odm_set_bb_reg(dm, ODM_REG_CCK_ANTDIV_PARA2_11N, BIT(4), 1); + /* @CCK complete HW AntDiv within 64 samples */ - /* antenna mapping table */ - if (!p_dm_odm->is_mp_chip) { /* testchip */ - odm_set_bb_reg(p_dm_odm, ODM_REG_RX_DEFUALT_A_11N, BIT(10) | BIT9 | BIT8, 1); /* Reg858[10:8]=3'b001 */ - odm_set_bb_reg(p_dm_odm, ODM_REG_RX_DEFUALT_A_11N, BIT(13) | BIT12 | BIT11, 2); /* Reg858[13:11]=3'b010 */ - } else /* MPchip */ - odm_set_bb_reg(p_dm_odm, ODM_REG_ANT_MAPPING1_11N, MASKDWORD, 0x0201); /*Reg914=3'b010, Reg915=3'b001*/ + /* @antenna mapping table */ + if (!dm->is_mp_chip) { /* testchip */ + odm_set_bb_reg(dm, ODM_REG_RX_DEFAULT_A_11N, 0x700, 1); + /* Reg858[10:8]=3'b001 */ + odm_set_bb_reg(dm, ODM_REG_RX_DEFAULT_A_11N, 0x3800, 2); + /* Reg858[13:11]=3'b010 */ + } else /* @MPchip */ + odm_set_bb_reg(dm, ODM_REG_ANT_MAPPING1_11N, MASKDWORD, 0x0201); + /*Reg914=3'b010, Reg915=3'b001*/ - p_dm_fat_table->enable_ctrl_frame_antdiv = 1; + fat_tab->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 -) +void odm_smart_hw_ant_div_init_88e( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u32 value32, i; - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 value32, i; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8188E AntDiv_Init => ant_div_type=[CG_TRX_SMART_ANTDIV]\n")); + PHYDM_DBG(dm, DBG_ANT_DIV, + "***8188E AntDiv_Init => ant_div_type=[CG_TRX_SMART_ANTDIV]\n"); #if 0 - if (p_dm_odm->mp_mode == true) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("p_dm_odm->ant_div_type: %d\n", p_dm_odm->ant_div_type)); + if (*dm->mp_mode == true) { + PHYDM_DBG(dm, ODM_COMP_INIT, "dm->ant_div_type: %d\n", + dm->ant_div_type); return; } #endif - p_dm_fat_table->train_idx = 0; - p_dm_fat_table->fat_state = FAT_PREPARE_STATE; + fat_tab->train_idx = 0; + fat_tab->fat_state = FAT_PREPARE_STATE; - p_dm_odm->fat_comb_a = 5; - p_dm_odm->antdiv_intvl = 0x64; /* 100ms */ + dm->fat_comb_a = 5; + dm->antdiv_intvl = 0x64; /* @100ms */ for (i = 0; i < 6; i++) - p_dm_fat_table->bssid[i] = 0; - for (i = 0; i < (p_dm_odm->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; + fat_tab->bssid[i] = 0; + for (i = 0; i < (dm->fat_comb_a); i++) { + fat_tab->ant_sum_rssi[i] = 0; + fat_tab->ant_rssi_cnt[i] = 0; + fat_tab->ant_ave_rssi[i] = 0; } - /* MAC setting */ - value32 = odm_get_mac_reg(p_dm_odm, 0x4c, MASKDWORD); - odm_set_mac_reg(p_dm_odm, 0x4c, MASKDWORD, value32 | (BIT(23) | BIT25)); /* Reg4C[25]=1, Reg4C[23]=1 for pin output */ - value32 = odm_get_mac_reg(p_dm_odm, 0x7B4, MASKDWORD); - odm_set_mac_reg(p_dm_odm, 0x7b4, MASKDWORD, value32 | (BIT(16) | BIT17)); /* Reg7B4[16]=1 enable antenna training, Reg7B4[17]=1 enable A2 match */ + /* @MAC setting */ + value32 = odm_get_mac_reg(dm, R_0x4c, MASKDWORD); + odm_set_mac_reg(dm, R_0x4c, MASKDWORD, value32 | (BIT(23) | BIT(25))); /* Reg4C[25]=1, Reg4C[23]=1 for pin output */ + value32 = odm_get_mac_reg(dm, R_0x7b4, MASKDWORD); + odm_set_mac_reg(dm, R_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_odm, 0x7b4, 0xFFFF, 0); - odm_set_mac_reg(p_dm_odm, 0x7b0, MASKDWORD, 0); + /* @Match MAC ADDR */ + odm_set_mac_reg(dm, R_0x7b4, 0xFFFF, 0); + odm_set_mac_reg(dm, R_0x7b0, MASKDWORD, 0); - odm_set_bb_reg(p_dm_odm, 0x870, BIT(9) | BIT8, 0);/* reg870[8]=1'b0, reg870[9]=1'b0 */ /* antsel antselb by HW */ - odm_set_bb_reg(p_dm_odm, 0x864, BIT(10), 0); /* reg864[10]=1'b0 */ /* antsel2 by HW */ - odm_set_bb_reg(p_dm_odm, 0xb2c, BIT(22), 0); /* regb2c[22]=1'b0 */ /* disable CS/CG switch */ - odm_set_bb_reg(p_dm_odm, 0xb2c, BIT(31), 0); /* regb2c[31]=1'b1 */ /* output at CS only */ - odm_set_bb_reg(p_dm_odm, 0xca4, MASKDWORD, 0x000000a0); + odm_set_bb_reg(dm, R_0x870, BIT(9) | BIT(8), 0); /* reg870[8]=1'b0, reg870[9]=1'b0 */ /* antsel antselb by HW */ + odm_set_bb_reg(dm, R_0x864, BIT(10), 0); /* reg864[10]=1'b0 */ /* antsel2 by HW */ + odm_set_bb_reg(dm, R_0xb2c, BIT(22), 0); /* regb2c[22]=1'b0 */ /* disable CS/CG switch */ + odm_set_bb_reg(dm, R_0xb2c, BIT(31), 0); /* regb2c[31]=1'b1 */ /* output at CS only */ + odm_set_bb_reg(dm, R_0xca4, MASKDWORD, 0x000000a0); - /* antenna mapping table */ - if (p_dm_odm->fat_comb_a == 2) { - if (!p_dm_odm->is_mp_chip) { /* testchip */ - odm_set_bb_reg(p_dm_odm, 0x858, BIT(10) | BIT9 | BIT8, 1); /* Reg858[10:8]=3'b001 */ - odm_set_bb_reg(p_dm_odm, 0x858, BIT(13) | BIT12 | BIT11, 2); /* Reg858[13:11]=3'b010 */ - } else { /* MPchip */ - odm_set_bb_reg(p_dm_odm, 0x914, MASKBYTE0, 1); - odm_set_bb_reg(p_dm_odm, 0x914, MASKBYTE1, 2); + /* @antenna mapping table */ + if (dm->fat_comb_a == 2) { + if (!dm->is_mp_chip) { /* testchip */ + odm_set_bb_reg(dm, R_0x858, BIT(10) | BIT(9) | BIT(8), 1); /* Reg858[10:8]=3'b001 */ + odm_set_bb_reg(dm, R_0x858, BIT(13) | BIT(12) | BIT(11), 2); /* Reg858[13:11]=3'b010 */ + } else { /* @MPchip */ + odm_set_bb_reg(dm, R_0x914, MASKBYTE0, 1); + odm_set_bb_reg(dm, R_0x914, MASKBYTE1, 2); } } else { - if (!p_dm_odm->is_mp_chip) { /* testchip */ - odm_set_bb_reg(p_dm_odm, 0x858, BIT(10) | BIT9 | BIT8, 0); /* Reg858[10:8]=3'b000 */ - odm_set_bb_reg(p_dm_odm, 0x858, BIT(13) | BIT12 | BIT11, 1); /* Reg858[13:11]=3'b001 */ - odm_set_bb_reg(p_dm_odm, 0x878, BIT(16), 0); - odm_set_bb_reg(p_dm_odm, 0x858, BIT(15) | BIT14, 2); /* (Reg878[0],Reg858[14:15])=3'b010 */ - odm_set_bb_reg(p_dm_odm, 0x878, BIT(19) | BIT18 | BIT17, 3); /* Reg878[3:1]=3b'011 */ - odm_set_bb_reg(p_dm_odm, 0x878, BIT(22) | BIT21 | BIT20, 4); /* Reg878[6:4]=3b'100 */ - odm_set_bb_reg(p_dm_odm, 0x878, BIT(25) | BIT24 | BIT23, 5); /* Reg878[9:7]=3b'101 */ - odm_set_bb_reg(p_dm_odm, 0x878, BIT(28) | BIT27 | BIT26, 6); /* Reg878[12:10]=3b'110 */ - odm_set_bb_reg(p_dm_odm, 0x878, BIT(31) | BIT30 | BIT29, 7); /* Reg878[15:13]=3b'111 */ - } else { /* MPchip */ - odm_set_bb_reg(p_dm_odm, 0x914, MASKBYTE0, 4); /* 0: 3b'000 */ - odm_set_bb_reg(p_dm_odm, 0x914, MASKBYTE1, 2); /* 1: 3b'001 */ - odm_set_bb_reg(p_dm_odm, 0x914, MASKBYTE2, 0); /* 2: 3b'010 */ - odm_set_bb_reg(p_dm_odm, 0x914, MASKBYTE3, 1); /* 3: 3b'011 */ - odm_set_bb_reg(p_dm_odm, 0x918, MASKBYTE0, 3); /* 4: 3b'100 */ - odm_set_bb_reg(p_dm_odm, 0x918, MASKBYTE1, 5); /* 5: 3b'101 */ - odm_set_bb_reg(p_dm_odm, 0x918, MASKBYTE2, 6); /* 6: 3b'110 */ - odm_set_bb_reg(p_dm_odm, 0x918, MASKBYTE3, 255); /* 7: 3b'111 */ + if (!dm->is_mp_chip) { /* testchip */ + odm_set_bb_reg(dm, R_0x858, BIT(10) | BIT(9) | BIT(8), 0); /* Reg858[10:8]=3'b000 */ + odm_set_bb_reg(dm, R_0x858, BIT(13) | BIT(12) | BIT(11), 1); /* Reg858[13:11]=3'b001 */ + odm_set_bb_reg(dm, R_0x878, BIT(16), 0); + odm_set_bb_reg(dm, R_0x858, BIT(15) | BIT(14), 2); /* @(Reg878[0],Reg858[14:15])=3'b010 */ + odm_set_bb_reg(dm, R_0x878, BIT(19) | BIT(18) | BIT(17), 3); /* Reg878[3:1]=3b'011 */ + odm_set_bb_reg(dm, R_0x878, BIT(22) | BIT(21) | BIT(20), 4); /* Reg878[6:4]=3b'100 */ + odm_set_bb_reg(dm, R_0x878, BIT(25) | BIT(24) | BIT(23), 5); /* Reg878[9:7]=3b'101 */ + odm_set_bb_reg(dm, R_0x878, BIT(28) | BIT(27) | BIT(26), 6); /* Reg878[12:10]=3b'110 */ + odm_set_bb_reg(dm, R_0x878, BIT(31) | BIT(30) | BIT(29), 7); /* Reg878[15:13]=3b'111 */ + } else { /* @MPchip */ + odm_set_bb_reg(dm, R_0x914, MASKBYTE0, 4); /* @0: 3b'000 */ + odm_set_bb_reg(dm, R_0x914, MASKBYTE1, 2); /* @1: 3b'001 */ + odm_set_bb_reg(dm, R_0x914, MASKBYTE2, 0); /* @2: 3b'010 */ + odm_set_bb_reg(dm, R_0x914, MASKBYTE3, 1); /* @3: 3b'011 */ + odm_set_bb_reg(dm, R_0x918, MASKBYTE0, 3); /* @4: 3b'100 */ + odm_set_bb_reg(dm, R_0x918, MASKBYTE1, 5); /* @5: 3b'101 */ + odm_set_bb_reg(dm, R_0x918, MASKBYTE2, 6); /* @6: 3b'110 */ + odm_set_bb_reg(dm, R_0x918, MASKBYTE3, 255); /* @7: 3b'111 */ } } - /* Default ant setting when no fast training */ - odm_set_bb_reg(p_dm_odm, 0x864, BIT(5) | BIT4 | BIT3, 0); /* Default RX */ - odm_set_bb_reg(p_dm_odm, 0x864, BIT(8) | BIT7 | BIT6, 1); /* Optional RX */ - odm_set_bb_reg(p_dm_odm, 0x860, BIT(14) | BIT13 | BIT12, 0); /* Default TX */ + /* @Default ant setting when no fast training */ + odm_set_bb_reg(dm, R_0x864, BIT(5) | BIT(4) | BIT(3), 0); /* @Default RX */ + odm_set_bb_reg(dm, R_0x864, BIT(8) | BIT(7) | BIT(6), 1); /* Optional RX */ + odm_set_bb_reg(dm, R_0x860, BIT(14) | BIT(13) | BIT(12), 0); /* @Default TX */ - /* Enter Traing state */ - odm_set_bb_reg(p_dm_odm, 0x864, BIT(2) | BIT1 | BIT0, (p_dm_odm->fat_comb_a - 1)); /* reg864[2:0]=3'd6 */ /* ant combination=reg864[2:0]+1 */ + /* @Enter Traing state */ + odm_set_bb_reg(dm, R_0x864, BIT(2) | BIT(1) | BIT(0), (dm->fat_comb_a - 1)); /* reg864[2:0]=3'd6 */ /* ant combination=reg864[2:0]+1 */ +#if 0 /* SW Control */ /* phy_set_bb_reg(adapter, 0x864, BIT10, 1); */ /* phy_set_bb_reg(adapter, 0x870, BIT9, 1); */ @@ -955,980 +1111,1404 @@ odm_smart_hw_ant_div_init_88e( /* 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 -#endif /* #if (RTL8188E_SUPPORT == 1) */ - +#endif /* @#if (RTL8188E_SUPPORT == 1) */ #if (RTL8192E_SUPPORT == 1) -void -odm_rx_hw_ant_div_init_92e( - void *p_dm_void -) +void odm_rx_hw_ant_div_init_92e(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; #if 0 - if (p_dm_odm->mp_mode == true) { - odm_ant_div_on_off(p_dm_odm, ANTDIV_OFF); - odm_set_bb_reg(p_dm_odm, 0xc50, BIT(8), 0); /* r_rxdiv_enable_anta regc50[8]=1'b0 0: control by c50[9] */ - odm_set_bb_reg(p_dm_odm, 0xc50, BIT(9), 1); /* 1:CG, 0:CS */ + if (*dm->mp_mode == true) { + odm_ant_div_on_off(dm, ANTDIV_OFF); + odm_set_bb_reg(dm, R_0xc50, BIT(8), 0); + /* r_rxdiv_enable_anta regc50[8]=1'b0 0: control by c50[9] */ + odm_set_bb_reg(dm, R_0xc50, BIT(9), 1); + /* @1:CG, 0:CS */ return; } #endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8192E AntDiv_Init => ant_div_type=[CGCS_RX_HW_ANTDIV]\n")); + PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); /* Pin Settings */ - odm_set_bb_reg(p_dm_odm, 0x870, BIT(8), 0);/* reg870[8]=1'b0, */ /* "antsel" is controled by HWs */ - odm_set_bb_reg(p_dm_odm, 0xc50, BIT(8), 1); /* regc50[8]=1'b1 */ /* " CS/CG switching" is controled by HWs */ + odm_set_bb_reg(dm, R_0x870, BIT(8), 0); + /* reg870[8]=1'b0, antsel is controled by HWs */ + odm_set_bb_reg(dm, R_0xc50, BIT(8), 1); + /* regc50[8]=1'b1 CS/CG switching is controled by HWs*/ - /* Mapping table */ - odm_set_bb_reg(p_dm_odm, 0x914, 0xFFFF, 0x0100); /* antenna mapping table */ + /* @Mapping table */ + odm_set_bb_reg(dm, R_0x914, 0xFFFF, 0x0100); + /* @antenna mapping table */ /* OFDM Settings */ - odm_set_bb_reg(p_dm_odm, 0xca4, 0x7FF, 0xA0); /* thershold */ - odm_set_bb_reg(p_dm_odm, 0xca4, 0x7FF000, 0x0); /* bias */ + odm_set_bb_reg(dm, R_0xca4, 0x7FF, 0xA0); /* thershold */ + odm_set_bb_reg(dm, R_0xca4, 0x7FF000, 0x0); /* @bias */ - /* CCK Settings */ - odm_set_bb_reg(p_dm_odm, 0xa04, 0xF000000, 0); /* Select which path to receive for CCK_1 & CCK_2 */ - odm_set_bb_reg(p_dm_odm, 0xb34, BIT(30), 0); /* (92E) ANTSEL_CCK_opt = r_en_antsel_cck? ANTSEL_CCK: 1'b0 */ - odm_set_bb_reg(p_dm_odm, 0xa74, BIT(7), 1); /* Fix CCK PHY status report issue */ - odm_set_bb_reg(p_dm_odm, 0xa0c, BIT(4), 1); /* CCK complete HW AntDiv within 64 samples */ + /* @CCK Settings */ + odm_set_bb_reg(dm, R_0xa04, 0xF000000, 0); + /* Select which path to receive for CCK_1 & CCK_2 */ + odm_set_bb_reg(dm, R_0xb34, BIT(30), 0); + /* @(92E) ANTSEL_CCK_opt = r_en_antsel_cck? ANTSEL_CCK: 1'b0 */ + odm_set_bb_reg(dm, R_0xa74, BIT(7), 1); + /* @Fix CCK PHY status report issue */ + odm_set_bb_reg(dm, R_0xa0c, BIT(4), 1); + /* @CCK complete HW AntDiv within 64 samples */ #ifdef ODM_EVM_ENHANCE_ANTDIV - /* EVM enhance AntDiv method init---------------------------------------------------------------------- */ - p_dm_fat_table->EVM_method_enable = 0; - p_dm_fat_table->fat_state = NORMAL_STATE_MIAN; - p_dm_odm->antdiv_intvl = 0x64; - odm_set_bb_reg(p_dm_odm, 0x910, 0x3f, 0xf); - p_dm_odm->antdiv_evm_en = 1; - /* p_dm_odm->antdiv_period=1; */ - p_dm_odm->evm_antdiv_period = 3; - + phydm_evm_sw_antdiv_init(dm); #endif - } -void -odm_trx_hw_ant_div_init_92e( - void *p_dm_void -) +void odm_trx_hw_ant_div_init_92e(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; + struct dm_struct *dm = (struct dm_struct *)dm_void; #if 0 - if (p_dm_odm->mp_mode == true) { - odm_ant_div_on_off(p_dm_odm, ANTDIV_OFF); - odm_set_bb_reg(p_dm_odm, 0xc50, BIT(8), 0); /* r_rxdiv_enable_anta regc50[8]=1'b0 0: control by c50[9] */ - odm_set_bb_reg(p_dm_odm, 0xc50, BIT(9), 1); /* 1:CG, 0:CS */ + if (*dm->mp_mode == true) { + odm_ant_div_on_off(dm, ANTDIV_OFF); + odm_set_bb_reg(dm, R_0xc50, BIT(8), 0); /* r_rxdiv_enable_anta regc50[8]=1'b0 0: control by c50[9] */ + odm_set_bb_reg(dm, R_0xc50, BIT(9), 1); /* @1:CG, 0:CS */ return; } #endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8192E AntDiv_Init => ant_div_type=[ Only for DIR605, CG_TRX_HW_ANTDIV]\n")); + PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); - /* 3 --RFE pin setting--------- */ - /* [MAC] */ - odm_set_mac_reg(p_dm_odm, 0x38, BIT(11), 1); /* DBG PAD Driving control (GPIO 8) */ - odm_set_mac_reg(p_dm_odm, 0x4c, BIT(23), 0); /* path-A, RFE_CTRL_3 */ - odm_set_mac_reg(p_dm_odm, 0x4c, BIT(29), 1); /* path-A, RFE_CTRL_8 */ - /* [BB] */ - odm_set_bb_reg(p_dm_odm, 0x944, BIT(3), 1); /* RFE_buffer */ - odm_set_bb_reg(p_dm_odm, 0x944, BIT(8), 1); - odm_set_bb_reg(p_dm_odm, 0x940, BIT(7) | BIT6, 0x0); /* r_rfe_path_sel_ (RFE_CTRL_3) */ - odm_set_bb_reg(p_dm_odm, 0x940, BIT(17) | BIT16, 0x0); /* r_rfe_path_sel_ (RFE_CTRL_8) */ - odm_set_bb_reg(p_dm_odm, 0x944, BIT(31), 0); /* RFE_buffer */ - odm_set_bb_reg(p_dm_odm, 0x92C, BIT(3), 0); /* rfe_inv (RFE_CTRL_3) */ - odm_set_bb_reg(p_dm_odm, 0x92C, BIT(8), 1); /* rfe_inv (RFE_CTRL_8) */ - odm_set_bb_reg(p_dm_odm, 0x930, 0xF000, 0x8); /* path-A, RFE_CTRL_3 */ - odm_set_bb_reg(p_dm_odm, 0x934, 0xF, 0x8); /* path-A, RFE_CTRL_8 */ - /* 3 ------------------------- */ + /* @3 --RFE pin setting--------- */ + /* @[MAC] */ + odm_set_mac_reg(dm, R_0x38, BIT(11), 1); + /* @DBG PAD Driving control (GPIO 8) */ + odm_set_mac_reg(dm, R_0x4c, BIT(23), 0); /* path-A, RFE_CTRL_3 */ + odm_set_mac_reg(dm, R_0x4c, BIT(29), 1); /* path-A, RFE_CTRL_8 */ + /* @[BB] */ + odm_set_bb_reg(dm, R_0x944, BIT(3), 1); /* RFE_buffer */ + odm_set_bb_reg(dm, R_0x944, BIT(8), 1); + odm_set_bb_reg(dm, R_0x940, BIT(7) | BIT(6), 0x0); + /* r_rfe_path_sel_ (RFE_CTRL_3) */ + odm_set_bb_reg(dm, R_0x940, BIT(17) | BIT(16), 0x0); + /* r_rfe_path_sel_ (RFE_CTRL_8) */ + odm_set_bb_reg(dm, R_0x944, BIT(31), 0); /* RFE_buffer */ + odm_set_bb_reg(dm, R_0x92c, BIT(3), 0); /* rfe_inv (RFE_CTRL_3) */ + odm_set_bb_reg(dm, R_0x92c, BIT(8), 1); /* rfe_inv (RFE_CTRL_8) */ + odm_set_bb_reg(dm, R_0x930, 0xF000, 0x8); /* path-A, RFE_CTRL_3 */ + odm_set_bb_reg(dm, R_0x934, 0xF, 0x8); /* path-A, RFE_CTRL_8 */ + /* @3 ------------------------- */ /* Pin Settings */ - odm_set_bb_reg(p_dm_odm, 0xC50, BIT(8), 0); /* path-A */ /* disable CS/CG switch */ + odm_set_bb_reg(dm, R_0xc50, BIT(8), 0); + /* path-A */ /* disable CS/CG switch */ #if 0 - /* Let it follows PHY_REG for bit9 setting */ - if (p_dm_odm->priv->pshare->rf_ft_var.use_ext_pa || p_dm_odm->priv->pshare->rf_ft_var.use_ext_lna) - odm_set_bb_reg(p_dm_odm, 0xC50, BIT(9), 1);/* path-A //output at CS */ + /* @Let it follows PHY_REG for bit9 setting */ + if (dm->priv->pshare->rf_ft_var.use_ext_pa || + dm->priv->pshare->rf_ft_var.use_ext_lna) + odm_set_bb_reg(dm, R_0xc50, BIT(9), 1);/* path-A output at CS */ else - odm_set_bb_reg(p_dm_odm, 0xC50, BIT(9), 0); /* path-A //output at CG ->normal power */ + odm_set_bb_reg(dm, R_0xc50, BIT(9), 0); + /* path-A output at CG ->normal power */ #endif - odm_set_bb_reg(p_dm_odm, 0x870, BIT(9) | BIT8, 0); /* path-A */ /* antsel antselb by HW */ - odm_set_bb_reg(p_dm_odm, 0xB38, BIT(10), 0); /* path-A */ /* antsel2 by HW */ + odm_set_bb_reg(dm, R_0x870, BIT(9) | BIT(8), 0); + /* path-A*/ /* antsel antselb by HW */ + odm_set_bb_reg(dm, R_0xb38, BIT(10), 0);/* path-A*/ /* antsel2 by HW */ - /* Mapping table */ - odm_set_bb_reg(p_dm_odm, 0x914, 0xFFFF, 0x0100); /* antenna mapping table */ + /* @Mapping table */ + odm_set_bb_reg(dm, R_0x914, 0xFFFF, 0x0100); + /* @antenna mapping table */ /* OFDM Settings */ - odm_set_bb_reg(p_dm_odm, 0xca4, 0x7FF, 0xA0); /* thershold */ - odm_set_bb_reg(p_dm_odm, 0xca4, 0x7FF000, 0x0); /* bias */ + odm_set_bb_reg(dm, R_0xca4, 0x7FF, 0xA0); /* thershold */ + odm_set_bb_reg(dm, R_0xca4, 0x7FF000, 0x0); /* @bias */ - /* CCK Settings */ - odm_set_bb_reg(p_dm_odm, 0xa04, 0xF000000, 0); /* Select which path to receive for CCK_1 & CCK_2 */ - odm_set_bb_reg(p_dm_odm, 0xb34, BIT(30), 0); /* (92E) ANTSEL_CCK_opt = r_en_antsel_cck? ANTSEL_CCK: 1'b0 */ - odm_set_bb_reg(p_dm_odm, 0xa74, BIT(7), 1); /* Fix CCK PHY status report issue */ - odm_set_bb_reg(p_dm_odm, 0xa0c, BIT(4), 1); /* CCK complete HW AntDiv within 64 samples */ + /* @CCK Settings */ + odm_set_bb_reg(dm, R_0xa04, 0xF000000, 0); + /* Select which path to receive for CCK_1 & CCK_2 */ + odm_set_bb_reg(dm, R_0xb34, BIT(30), 0); + /* @(92E) ANTSEL_CCK_opt = r_en_antsel_cck? ANTSEL_CCK: 1'b0 */ + odm_set_bb_reg(dm, R_0xa74, BIT(7), 1); + /* @Fix CCK PHY status report issue */ + odm_set_bb_reg(dm, R_0xa0c, BIT(4), 1); + /* @CCK complete HW AntDiv within 64 samples */ #ifdef ODM_EVM_ENHANCE_ANTDIV - /* EVM enhance AntDiv method init---------------------------------------------------------------------- */ - p_dm_fat_table->EVM_method_enable = 0; - p_dm_fat_table->fat_state = NORMAL_STATE_MIAN; - p_dm_odm->antdiv_intvl = 0x64; - odm_set_bb_reg(p_dm_odm, 0x910, 0x3f, 0xf); - p_dm_odm->antdiv_evm_en = 1; - /* p_dm_odm->antdiv_period=1; */ - p_dm_odm->evm_antdiv_period = 3; + phydm_evm_sw_antdiv_init(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 -) +void odm_smart_hw_ant_div_init_92e( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8192E AntDiv_Init => ant_div_type=[CG_TRX_SMART_ANTDIV]\n")); + struct dm_struct *dm = (struct dm_struct *)dm_void; + + PHYDM_DBG(dm, DBG_ANT_DIV, + "***8192E AntDiv_Init => ant_div_type=[CG_TRX_SMART_ANTDIV]\n"); } #endif -#endif /* #if (RTL8192E_SUPPORT == 1) */ +#endif /* @#if (RTL8192E_SUPPORT == 1) */ + +#if (RTL8192F_SUPPORT == 1) +void odm_rx_hw_ant_div_init_92f(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + + PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); + + /* Pin Settings */ + odm_set_bb_reg(dm, R_0x870, BIT(8), 0); + /* reg870[8]=1'b0, "antsel" is controlled by HWs */ + odm_set_bb_reg(dm, R_0xc50, BIT(8), 1); + /* regc50[8]=1'b1, " CS/CG switching" is controlled by HWs */ + + /* @Mapping table */ + odm_set_bb_reg(dm, R_0x914, 0xFFFF, 0x0100); + /* @antenna mapping table */ + + /* OFDM Settings */ + odm_set_bb_reg(dm, R_0xca4, 0x7FF, 0xA0); /* thershold */ + odm_set_bb_reg(dm, R_0xca4, 0x7FF000, 0x0); /* @bias */ + + /* @CCK Settings */ + odm_set_bb_reg(dm, R_0xa04, 0xF000000, 0); + /* Select which path to receive for CCK_1 & CCK_2 */ + odm_set_bb_reg(dm, R_0xb34, BIT(30), 0); + /* @(92E) ANTSEL_CCK_opt = r_en_antsel_cck? ANTSEL_CCK: 1'b0 */ + odm_set_bb_reg(dm, R_0xa74, BIT(7), 1); + /* @Fix CCK PHY status report issue */ + odm_set_bb_reg(dm, R_0xa0c, BIT(4), 1); + /* @CCK complete HW AntDiv within 64 samples */ + +#ifdef ODM_EVM_ENHANCE_ANTDIV + phydm_evm_sw_antdiv_init(dm); +#endif +} + +void odm_trx_hw_ant_div_init_92f(void *dm_void) + +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); + /* @3 --RFE pin setting--------- */ + /* @[MAC] */ + odm_set_mac_reg(dm, R_0x1048, BIT(0), 1); + /* @DBG PAD Driving control (gpioA_0) */ + odm_set_mac_reg(dm, R_0x1048, BIT(1), 1); + /* @DBG PAD Driving control (gpioA_1) */ + odm_set_mac_reg(dm, R_0x4c, BIT(24), 1); + odm_set_mac_reg(dm, R_0x1038, BIT(25) | BIT(24) | BIT(23), 0); + /* @gpioA_0,gpioA_1*/ + odm_set_mac_reg(dm, R_0x4c, BIT(23), 0); + /* @[BB] */ + odm_set_bb_reg(dm, R_0x944, BIT(8), 1); /* output enable */ + odm_set_bb_reg(dm, R_0x944, BIT(9), 1); + odm_set_bb_reg(dm, R_0x940, BIT(16) | BIT(17), 0x0); + /* r_rfe_path_sel_ (RFE_CTRL_8) */ + odm_set_bb_reg(dm, R_0x940, BIT(18) | BIT(19), 0x0); + /* r_rfe_path_sel_ (RFE_CTRL_9) */ + odm_set_bb_reg(dm, R_0x944, BIT(31), 0); /* RFE_buffer_en */ + odm_set_bb_reg(dm, R_0x92c, BIT(8), 0); /* rfe_inv (RFE_CTRL_8) */ + odm_set_bb_reg(dm, R_0x92c, BIT(9), 1); /* rfe_inv (RFE_CTRL_9) */ + odm_set_bb_reg(dm, R_0x934, 0xF, 0x8); /* path-A, RFE_CTRL_8 */ + odm_set_bb_reg(dm, R_0x934, 0xF0, 0x8); /* path-A, RFE_CTRL_9 */ + /* @3 ------------------------- */ + + /* Pin Settings */ + odm_set_bb_reg(dm, R_0xc50, BIT(8), 0); + /* path-A,disable CS/CG switch */ + odm_set_bb_reg(dm, R_0x870, BIT(9) | BIT(8), 0); + /* path-A*, antsel antselb by HW */ + odm_set_bb_reg(dm, R_0xb38, BIT(10), 0); /* path-A ,antsel2 by HW */ + + /* @Mapping table */ + odm_set_bb_reg(dm, R_0x914, 0xFFFF, 0x0100); + /* @antenna mapping table */ + + /* OFDM Settings */ + odm_set_bb_reg(dm, R_0xca4, 0x7FF, 0xA0); /* thershold */ + odm_set_bb_reg(dm, R_0xca4, 0x7FF000, 0x0); /* @bias */ + + /* @CCK Settings */ + odm_set_bb_reg(dm, R_0xa04, 0xF000000, 0); + /* Select which path to receive for CCK_1 & CCK_2 */ + odm_set_bb_reg(dm, R_0xb34, BIT(30), 0); + /* @(92E) ANTSEL_CCK_opt = r_en_antsel_cck? ANTSEL_CCK: 1'b0 */ + odm_set_bb_reg(dm, R_0xa74, BIT(7), 1); + /* @Fix CCK PHY status report issue */ + odm_set_bb_reg(dm, R_0xa0c, BIT(4), 1); + /* @CCK complete HW AntDiv within 64 samples */ + +#ifdef ODM_EVM_ENHANCE_ANTDIV + phydm_evm_sw_antdiv_init(dm); +#endif +} + +#endif /* @#if (RTL8192F_SUPPORT == 1) */ + +#if (RTL8822B_SUPPORT == 1) +void phydm_trx_hw_ant_div_init_22b(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); + + /* Pin Settings */ + odm_set_bb_reg(dm, R_0xcb8, BIT(21) | BIT(20), 0x1); + odm_set_bb_reg(dm, R_0xcb8, BIT(23) | BIT(22), 0x1); + odm_set_bb_reg(dm, R_0xc1c, BIT(7) | BIT(6), 0x0); + /* @------------------------- */ + + /* @Mapping table */ + /* @antenna mapping table */ + odm_set_bb_reg(dm, R_0xca4, 0xFFFF, 0x0100); + + /* OFDM Settings */ + /* thershold */ + odm_set_bb_reg(dm, R_0x8d4, 0x7FF, 0xA0); + /* @bias */ + odm_set_bb_reg(dm, R_0x8d4, 0x7FF000, 0x0); + odm_set_bb_reg(dm, R_0x668, BIT(3), 0x1); + + /* @CCK Settings */ + /* Select which path to receive for CCK_1 & CCK_2 */ + odm_set_bb_reg(dm, R_0xa04, 0xF000000, 0); + /* @Fix CCK PHY status report issue */ + odm_set_bb_reg(dm, R_0xa74, BIT(7), 1); + /* @CCK complete HW AntDiv within 64 samples */ + odm_set_bb_reg(dm, R_0xa0c, BIT(4), 1); + /* @BT Coexistence */ + /* @keep antsel_map when GNT_BT = 1 */ + odm_set_bb_reg(dm, R_0xcac, BIT(9), 1); + /* @Disable hw antsw & fast_train.antsw when GNT_BT=1 */ + odm_set_bb_reg(dm, R_0x804, BIT(4), 1); + /* response TX ant by RX ant */ + odm_set_mac_reg(dm, R_0x668, BIT(3), 1); +#if (defined(CONFIG_2T4R_ANTENNA)) + PHYDM_DBG(dm, DBG_ANT_DIV, + "***8822B AntDiv_Init => 2T4R case\n"); + /* Pin Settings */ + odm_set_bb_reg(dm, R_0xeb8, BIT(21) | BIT(20), 0x1); + odm_set_bb_reg(dm, R_0xeb8, BIT(23) | BIT(22), 0x1); + odm_set_bb_reg(dm, R_0xe1c, BIT(7) | BIT(6), 0x0); + /* @BT Coexistence */ + odm_set_bb_reg(dm, R_0xeac, BIT(9), 1); + /* @keep antsel_map when GNT_BT = 1 */ + /* Mapping table */ + /* antenna mapping table */ + odm_set_bb_reg(dm, R_0xea4, 0xFFFF, 0x0100); + /*odm_set_bb_reg(dm, R_0x900, 0x30000, 0x3);*/ +#endif + +#ifdef ODM_EVM_ENHANCE_ANTDIV + phydm_evm_sw_antdiv_init(dm); +#endif +} +#endif /* @#if (RTL8822B_SUPPORT == 1) */ + +#if (RTL8197F_SUPPORT == 1) +void phydm_rx_hw_ant_div_init_97f(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + +#if 0 + if (*dm->mp_mode == true) { + odm_ant_div_on_off(dm, ANTDIV_OFF); + odm_set_bb_reg(dm, R_0xc50, BIT(8), 0); + /* r_rxdiv_enable_anta regc50[8]=1'b0 0: control by c50[9] */ + odm_set_bb_reg(dm, R_0xc50, BIT(9), 1); /* @1:CG, 0:CS */ + return; + } +#endif + PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); + + /* Pin Settings */ + odm_set_bb_reg(dm, R_0x870, BIT(8), 0); + /* reg870[8]=1'b0, */ /* "antsel" is controlled by HWs */ + odm_set_bb_reg(dm, R_0xc50, BIT(8), 1); + /* regc50[8]=1'b1 *//*"CS/CG switching" is controlled by HWs */ + + /* @Mapping table */ + odm_set_bb_reg(dm, R_0x914, 0xFFFF, 0x0100); + /* @antenna mapping table */ + + /* OFDM Settings */ + odm_set_bb_reg(dm, R_0xca4, 0x7FF, 0xA0); /* thershold */ + odm_set_bb_reg(dm, R_0xca4, 0x7FF000, 0x0); /* @bias */ + + /* @CCK Settings */ + odm_set_bb_reg(dm, R_0xa04, 0xF000000, 0); + /* Select which path to receive for CCK_1 & CCK_2 */ + odm_set_bb_reg(dm, R_0xb34, BIT(30), 0); + /* @(92E) ANTSEL_CCK_opt = r_en_antsel_cck? ANTSEL_CCK: 1'b0 */ + odm_set_bb_reg(dm, R_0xa74, BIT(7), 1); + /* @Fix CCK PHY status report issue */ + odm_set_bb_reg(dm, R_0xa0c, BIT(4), 1); + /* @CCK complete HW AntDiv within 64 samples */ + +#ifdef ODM_EVM_ENHANCE_ANTDIV + phydm_evm_sw_antdiv_init(dm); +#endif +} +#endif //#if (RTL8197F_SUPPORT == 1) #if (RTL8723D_SUPPORT == 1) -void -odm_trx_hw_ant_div_init_8723d( - void *p_dm_void -) +void odm_trx_hw_ant_div_init_8723d(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[8723D] AntDiv_Init => ant_div_type=[S0S1_HW_TRX_AntDiv]\n")); + struct dm_struct *dm = (struct dm_struct *)dm_void; - /*BT Coexistence*/ - /*keep antsel_map when GNT_BT = 1*/ - odm_set_bb_reg(p_dm_odm, 0x864, BIT(12), 1); - /* Disable hw antsw & fast_train.antsw when GNT_BT=1 */ - odm_set_bb_reg(p_dm_odm, 0x874, BIT(23), 0); - /* Disable hw antsw & fast_train.antsw when BT TX/RX */ - odm_set_bb_reg(p_dm_odm, 0xE64, 0xFFFF0000, 0x000c); + PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); + /*@BT Coexistence*/ + /*@keep antsel_map when GNT_BT = 1*/ + odm_set_bb_reg(dm, R_0x864, BIT(12), 1); + /* @Disable hw antsw & fast_train.antsw when GNT_BT=1 */ + odm_set_bb_reg(dm, R_0x874, BIT(23), 0); + /* @Disable hw antsw & fast_train.antsw when BT TX/RX */ + odm_set_bb_reg(dm, R_0xe64, 0xFFFF0000, 0x000c); - odm_set_bb_reg(p_dm_odm, 0x870, BIT(9) | BIT(8), 0); + odm_set_bb_reg(dm, R_0x870, BIT(9) | BIT(8), 0); +#if 0 /*PTA setting: WL_BB_SEL_BTG_TRXG_anta, (1: HW CTRL 0: SW CTRL)*/ - /*odm_set_bb_reg(p_dm_odm, 0x948, BIT6, 0);*/ - /*odm_set_bb_reg(p_dm_odm, 0x948, BIT8, 0);*/ - /*GNT_WL tx*/ - odm_set_bb_reg(p_dm_odm, 0x950, BIT(29), 0); + /*odm_set_bb_reg(dm, R_0x948, BIT6, 0);*/ + /*odm_set_bb_reg(dm, R_0x948, BIT8, 0);*/ +#endif + /*@GNT_WL tx*/ + odm_set_bb_reg(dm, R_0x950, BIT(29), 0); - - /*Mapping Table*/ - odm_set_bb_reg(p_dm_odm, 0x914, MASKBYTE0, 0); - odm_set_bb_reg(p_dm_odm, 0x914, MASKBYTE1, 3); - /* odm_set_bb_reg(p_dm_odm, 0x864, BIT5|BIT4|BIT3, 0); */ - /* odm_set_bb_reg(p_dm_odm, 0x864, BIT8|BIT7|BIT6, 1); */ + /*@Mapping Table*/ + odm_set_bb_reg(dm, R_0x914, MASKBYTE0, 0); + odm_set_bb_reg(dm, R_0x914, MASKBYTE1, 3); +#if 0 + /* odm_set_bb_reg(dm, R_0x864, BIT5|BIT4|BIT3, 0); */ + /* odm_set_bb_reg(dm, R_0x864, BIT8|BIT7|BIT6, 1); */ +#endif /* Set WLBB_SEL_RF_ON 1 if RXFIR_PWDB > 0xCcc[3:0] */ - odm_set_bb_reg(p_dm_odm, 0xCcc, BIT(12), 0); - /* Low-to-High threshold for WLBB_SEL_RF_ON when OFDM enable */ - odm_set_bb_reg(p_dm_odm, 0xCcc, 0x0F, 0x01); - /* High-to-Low threshold for WLBB_SEL_RF_ON when OFDM enable */ - odm_set_bb_reg(p_dm_odm, 0xCcc, 0xF0, 0x0); - /* b Low-to-High threshold for WLBB_SEL_RF_ON when OFDM disable ( only CCK ) */ - odm_set_bb_reg(p_dm_odm, 0xAbc, 0xFF, 0x06); - /* High-to-Low threshold for WLBB_SEL_RF_ON when OFDM disable ( only CCK ) */ - odm_set_bb_reg(p_dm_odm, 0xAbc, 0xFF00, 0x00); - + odm_set_bb_reg(dm, R_0xccc, BIT(12), 0); + /* @Low-to-High threshold for WLBB_SEL_RF_ON when OFDM enable */ + odm_set_bb_reg(dm, R_0xccc, 0x0F, 0x01); + /* @High-to-Low threshold for WLBB_SEL_RF_ON when OFDM enable */ + odm_set_bb_reg(dm, R_0xccc, 0xF0, 0x0); + /* @b Low-to-High threshold for WLBB_SEL_RF_ON when OFDM disable (CCK)*/ + odm_set_bb_reg(dm, R_0xabc, 0xFF, 0x06); + /* @High-to-Low threshold for WLBB_SEL_RF_ON when OFDM disable (CCK) */ + odm_set_bb_reg(dm, R_0xabc, 0xFF00, 0x00); /*OFDM HW AntDiv Parameters*/ - odm_set_bb_reg(p_dm_odm, 0xCA4, 0x7FF, 0xa0); - odm_set_bb_reg(p_dm_odm, 0xCA4, 0x7FF000, 0x00); - odm_set_bb_reg(p_dm_odm, 0xC5C, BIT(20) | BIT(19) | BIT(18), 0x04); + odm_set_bb_reg(dm, R_0xca4, 0x7FF, 0xa0); + odm_set_bb_reg(dm, R_0xca4, 0x7FF000, 0x00); + odm_set_bb_reg(dm, R_0xc5c, BIT(20) | BIT(19) | BIT(18), 0x04); - /*CCK HW AntDiv Parameters*/ - odm_set_bb_reg(p_dm_odm, 0xA74, BIT(7), 1); - odm_set_bb_reg(p_dm_odm, 0xA0C, BIT(4), 1); - odm_set_bb_reg(p_dm_odm, 0xAA8, BIT(8), 0); + /*@CCK HW AntDiv Parameters*/ + odm_set_bb_reg(dm, R_0xa74, BIT(7), 1); + odm_set_bb_reg(dm, R_0xa0c, BIT(4), 1); + odm_set_bb_reg(dm, R_0xaa8, BIT(8), 0); - odm_set_bb_reg(p_dm_odm, 0xA0C, 0x0F, 0xf); - odm_set_bb_reg(p_dm_odm, 0xA14, 0x1F, 0x8); - odm_set_bb_reg(p_dm_odm, 0xA10, BIT(13), 0x1); - odm_set_bb_reg(p_dm_odm, 0xA74, BIT(8), 0x0); - odm_set_bb_reg(p_dm_odm, 0xB34, BIT(30), 0x1); + odm_set_bb_reg(dm, R_0xa0c, 0x0F, 0xf); + odm_set_bb_reg(dm, R_0xa14, 0x1F, 0x8); + odm_set_bb_reg(dm, R_0xa10, BIT(13), 0x1); + odm_set_bb_reg(dm, R_0xa74, BIT(8), 0x0); + odm_set_bb_reg(dm, R_0xb34, BIT(30), 0x1); - /*disable antenna training */ - odm_set_bb_reg(p_dm_odm, 0xE08, BIT(16), 0); - odm_set_bb_reg(p_dm_odm, 0xc50, BIT(8), 0); + /*@disable antenna training */ + odm_set_bb_reg(dm, R_0xe08, BIT(16), 0); + odm_set_bb_reg(dm, R_0xc50, BIT(8), 0); +} +/*@Mingzhi 2017-05-08*/ +void odm_s0s1_sw_ant_div_init_8723d(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct sw_antenna_switch *swat_tab = &dm->dm_swat_table; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + + PHYDM_DBG(dm, DBG_ANT_DIV, + "***8723D AntDiv_Init => ant_div_type=[ S0S1_SW_AntDiv]\n"); + + /*@keep antsel_map when GNT_BT = 1*/ + odm_set_bb_reg(dm, R_0x864, BIT(12), 1); + + /* @Disable antsw when GNT_BT=1 */ + odm_set_bb_reg(dm, R_0x874, BIT(23), 0); + + /* @Mapping Table */ + odm_set_bb_reg(dm, R_0x914, MASKBYTE0, 0); + odm_set_bb_reg(dm, R_0x914, MASKBYTE1, 1); + + /* Output Pin Settings */ +#if 0 + /* odm_set_bb_reg(dm, R_0x948, BIT6, 0x1); */ +#endif + odm_set_bb_reg(dm, R_0x870, BIT(8), 1); + odm_set_bb_reg(dm, R_0x870, BIT(9), 1); + + /* Status init */ + fat_tab->is_become_linked = false; + swat_tab->try_flag = SWAW_STEP_INIT; + swat_tab->double_chk_flag = 0; + swat_tab->cur_antenna = MAIN_ANT; + swat_tab->pre_ant = MAIN_ANT; + dm->antdiv_counter = CONFIG_ANTDIV_PERIOD; + + /* @2 [--For HW Bug setting] */ + odm_set_bb_reg(dm, R_0x80c, BIT(21), 0); /* TX ant by Reg */ } -void -phydm_set_tx_ant_pwr_8723d( - void *p_dm_void, - u8 ant -) +void odm_update_rx_idle_ant_8723d(void *dm_void, u8 ant, u32 default_ant, + u32 optional_ant) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; - struct _ADAPTER *p_adapter = p_dm_odm->adapter; - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + void *adapter = dm->adapter; + u8 count = 0; - p_dm_fat_table->rx_idle_ant = ant; +#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) + /*score board to BT ,a002:WL to do ant-div*/ + odm_set_mac_reg(dm, R_0xa8, MASKHWORD, 0xa002); + ODM_delay_us(50); +#endif +#if 0 + /* odm_set_bb_reg(dm, R_0x948, BIT(6), 0x1); */ +#endif + if (dm->ant_div_type == S0S1_SW_ANTDIV) { + odm_set_bb_reg(dm, R_0x860, BIT(8), default_ant); + odm_set_bb_reg(dm, R_0x860, BIT(9), default_ant); + } + odm_set_bb_reg(dm, R_0x864, BIT(5) | BIT(4) | BIT(3), default_ant); + /*@Default RX*/ + odm_set_bb_reg(dm, R_0x864, BIT(8) | BIT(7) | BIT(6), optional_ant); + /*Optional RX*/ + odm_set_bb_reg(dm, R_0x860, BIT(14) | BIT(13) | BIT(12), default_ant); + /*@Default TX*/ + fat_tab->rx_idle_ant = ant; +#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) + /*score board to BT ,a000:WL@S1 a001:WL@S0*/ + if (default_ant == ANT1_2G) + odm_set_mac_reg(dm, R_0xa8, MASKHWORD, 0xa000); + else + odm_set_mac_reg(dm, R_0xa8, MASKHWORD, 0xa001); +#endif +} + +void phydm_set_tx_ant_pwr_8723d(void *dm_void, u8 ant) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + void *adapter = dm->adapter; + + fat_tab->rx_idle_ant = ant; #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - p_adapter->HalFunc.SetTxPowerLevelHandler(p_adapter, *p_dm_odm->p_channel); + ((PADAPTER)adapter)->HalFunc.SetTxPowerLevelHandler(adapter, *dm->channel); #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - rtw_hal_set_tx_power_level(p_adapter, *p_dm_odm->p_channel); + rtw_hal_set_tx_power_level(adapter, *dm->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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8723B AntDiv_Init => ant_div_type=[CG_TRX_HW_ANTDIV(DPDT)]\n")); +#if (RTL8721D_SUPPORT == 1) - /* Mapping Table */ - odm_set_bb_reg(p_dm_odm, 0x914, MASKBYTE0, 0); - odm_set_bb_reg(p_dm_odm, 0x914, MASKBYTE1, 1); +void odm_update_rx_idle_ant_8721d(void *dm_void, u8 ant, u32 default_ant, + u32 optional_ant) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + + odm_set_bb_reg(dm, R_0x864, BIT(5) | BIT(4) | BIT(3), default_ant); + /*@Default RX*/ + odm_set_bb_reg(dm, R_0x864, BIT(8) | BIT(7) | BIT(6), optional_ant); + /*@Optional RX*/ + odm_set_bb_reg(dm, R_0x860, BIT(14) | BIT(13) | BIT(12), default_ant); + /*@Default TX*/ + fat_tab->rx_idle_ant = ant; +} + +void odm_trx_hw_ant_div_init_8721d(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + PHYDM_DBG(dm, DBG_ANT_DIV, + "[8721D] AntDiv_Init => ant_div_type=[CG_TRX_HW_ANTDIV]\n"); + + /*@BT Coexistence*/ + /*@keep antsel_map when GNT_BT = 1*/ + odm_set_bb_reg(dm, R_0x864, BIT(12), 1); + /* @Disable hw antsw & fast_train.antsw when GNT_BT=1 */ + odm_set_bb_reg(dm, R_0x874, BIT(23), 0); + /* @Disable hw antsw & fast_train.antsw when BT TX/RX */ + odm_set_bb_reg(dm, R_0xe64, 0xFFFF0000, 0x000c); + + u32 sysreg408 = HAL_READ32(SYSTEM_CTRL_BASE_LP, 0x0408); + + sysreg408 &= ~0x0000001F; + sysreg408 |= 0x12; + HAL_WRITE32(SYSTEM_CTRL_BASE_LP, 0x0408, sysreg408); + + u32 sysreg410 = HAL_READ32(SYSTEM_CTRL_BASE_LP, 0x0410); + + sysreg410 &= ~0x0000001F; + sysreg410 |= 0x12; + HAL_WRITE32(SYSTEM_CTRL_BASE_LP, 0x0410, sysreg410); + + u32 sysreg208 = HAL_READ32(SYSTEM_CTRL_BASE_LP, REG_LP_FUNC_EN0); + + sysreg208 |= BIT(28); + HAL_WRITE32(SYSTEM_CTRL_BASE_LP, REG_LP_FUNC_EN0, sysreg208); + + u32 sysreg344 = + HAL_READ32(SYSTEM_CTRL_BASE_LP, REG_AUDIO_SHARE_PAD_CTRL); + + sysreg344 |= BIT(9); + HAL_WRITE32(SYSTEM_CTRL_BASE_LP, REG_AUDIO_SHARE_PAD_CTRL, sysreg344); + + u32 sysreg280 = HAL_READ32(SYSTEM_CTRL_BASE_LP, REG_LP_SYSPLL_CTRL0); + + sysreg280 |= 0x7; + HAL_WRITE32(SYSTEM_CTRL_BASE_LP, REG_LP_SYSPLL_CTRL0, sysreg280); + + sysreg344 |= BIT(8); + HAL_WRITE32(SYSTEM_CTRL_BASE_LP, REG_AUDIO_SHARE_PAD_CTRL, sysreg344); + + sysreg344 |= BIT(0); + HAL_WRITE32(SYSTEM_CTRL_BASE_LP, REG_AUDIO_SHARE_PAD_CTRL, sysreg344); + + odm_set_bb_reg(dm, R_0x930, 0xF00, 8); /* RFE CTRL_2 ANTSEL0 */ + odm_set_bb_reg(dm, R_0x930, 0xF000, 8); /* RFE CTRL_3 ANTSEL0 */ + odm_set_bb_reg(dm, R_0x92c, BIT(3) | BIT(2), 2); + + odm_set_bb_reg(dm, R_0x870, BIT(9) | BIT(8), 0); + odm_set_bb_reg(dm, R_0x804, 0xF00, 1); /* r_keep_rfpin */ + odm_set_bb_reg(dm, R_0x944, 0x0000000C, 0x3); /* PAD in/output CTRL */ + + /*PTA setting: WL_BB_SEL_BTG_TRXG_anta, (1: HW CTRL 0: SW CTRL)*/ + /*odm_set_bb_reg(dm, R_0x948, BIT6, 0);*/ + /*odm_set_bb_reg(dm, R_0x948, BIT8, 0);*/ + /*@GNT_WL tx*/ + odm_set_bb_reg(dm, R_0x950, BIT(29), 0); + + /*@Mapping Table*/ + odm_set_bb_reg(dm, R_0x914, MASKBYTE0, 0); + odm_set_bb_reg(dm, R_0x914, MASKBYTE1, 1); + /* odm_set_bb_reg(dm, R_0x864, BIT5|BIT4|BIT3, 0); */ + /* odm_set_bb_reg(dm, R_0x864, BIT8|BIT7|BIT6, 1); */ + + /* Set WLBB_SEL_RF_ON 1 if RXFIR_PWDB > 0xCcc[3:0] */ + odm_set_bb_reg(dm, R_0xccc, BIT(12), 0); + /* @Low-to-High threshold for WLBB_SEL_RF_ON */ + /*when OFDM enable */ + odm_set_bb_reg(dm, R_0xccc, 0x0F, 0x01); + /* @High-to-Low threshold for WLBB_SEL_RF_ON */ + /* when OFDM enable */ + odm_set_bb_reg(dm, R_0xccc, 0xF0, 0x0); + /* @b Low-to-High threshold for WLBB_SEL_RF_ON*/ + /*when OFDM disable ( only CCK ) */ + odm_set_bb_reg(dm, R_0xabc, 0xFF, 0x06); + /* @High-to-Low threshold for WLBB_SEL_RF_ON*/ + /* when OFDM disable ( only CCK ) */ + odm_set_bb_reg(dm, R_0xabc, 0xFF00, 0x00); + + /*OFDM HW AntDiv Parameters*/ + odm_set_bb_reg(dm, R_0xca4, 0x7FF, 0xa0); + odm_set_bb_reg(dm, R_0xca4, 0x7FF000, 0x00); + odm_set_bb_reg(dm, R_0xc5c, BIT(20) | BIT(19) | BIT(18), 0x04); + + /*@CCK HW AntDiv Parameters*/ + odm_set_bb_reg(dm, R_0xa74, BIT(7), 1); + odm_set_bb_reg(dm, R_0xa0c, BIT(4), 1); + odm_set_bb_reg(dm, R_0xaa8, BIT(8), 0); + + odm_set_bb_reg(dm, R_0xa0c, 0x0F, 0xf); + odm_set_bb_reg(dm, R_0xa14, 0x1F, 0x8); + odm_set_bb_reg(dm, R_0xa10, BIT(13), 0x1); + odm_set_bb_reg(dm, R_0xa74, BIT(8), 0x0); + odm_set_bb_reg(dm, R_0xb34, BIT(30), 0x1); + + /*@disable antenna training */ + odm_set_bb_reg(dm, R_0xe08, BIT(16), 0); + odm_set_bb_reg(dm, R_0xc50, BIT(8), 0); +} +#endif +#if (RTL8723B_SUPPORT == 1) +void odm_trx_hw_ant_div_init_8723b(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + PHYDM_DBG(dm, DBG_ANT_DIV, + "***8723B AntDiv_Init => ant_div_type=[CG_TRX_HW_ANTDIV(DPDT)]\n"); + + /* @Mapping Table */ + odm_set_bb_reg(dm, R_0x914, MASKBYTE0, 0); + odm_set_bb_reg(dm, R_0x914, MASKBYTE1, 1); /* OFDM HW AntDiv Parameters */ - odm_set_bb_reg(p_dm_odm, 0xCA4, 0x7FF, 0xa0); /* thershold */ - odm_set_bb_reg(p_dm_odm, 0xCA4, 0x7FF000, 0x00); /* bias */ + odm_set_bb_reg(dm, R_0xca4, 0x7FF, 0xa0); /* thershold */ + odm_set_bb_reg(dm, R_0xca4, 0x7FF000, 0x00); /* @bias */ - /* CCK HW AntDiv Parameters */ - odm_set_bb_reg(p_dm_odm, 0xA74, BIT(7), 1); /* patch for clk from 88M to 80M */ - odm_set_bb_reg(p_dm_odm, 0xA0C, BIT(4), 1); /* do 64 samples */ + /* @CCK HW AntDiv Parameters */ + odm_set_bb_reg(dm, R_0xa74, BIT(7), 1); + /* patch for clk from 88M to 80M */ + odm_set_bb_reg(dm, R_0xa0c, BIT(4), 1); + /* @do 64 samples */ - /* BT Coexistence */ - odm_set_bb_reg(p_dm_odm, 0x864, BIT(12), 0); /* keep antsel_map when GNT_BT = 1 */ - odm_set_bb_reg(p_dm_odm, 0x874, BIT(23), 0); /* Disable hw antsw & fast_train.antsw when GNT_BT=1 */ + /* @BT Coexistence */ + odm_set_bb_reg(dm, R_0x864, BIT(12), 0); + /* @keep antsel_map when GNT_BT = 1 */ + odm_set_bb_reg(dm, R_0x874, BIT(23), 0); + /* @Disable hw antsw & fast_train.antsw when GNT_BT=1 */ /* Output Pin Settings */ - odm_set_bb_reg(p_dm_odm, 0x870, BIT(8), 0); + odm_set_bb_reg(dm, R_0x870, BIT(8), 0); - odm_set_bb_reg(p_dm_odm, 0x948, BIT(6), 0); /* WL_BB_SEL_BTG_TRXG_anta, (1: HW CTRL 0: SW CTRL) */ - odm_set_bb_reg(p_dm_odm, 0x948, BIT(7), 0); + odm_set_bb_reg(dm, R_0x948, BIT(6), 0); + /* WL_BB_SEL_BTG_TRXG_anta, (1: HW CTRL 0: SW CTRL) */ + odm_set_bb_reg(dm, R_0x948, BIT(7), 0); - odm_set_mac_reg(p_dm_odm, 0x40, BIT(3), 1); - odm_set_mac_reg(p_dm_odm, 0x38, BIT(11), 1); - odm_set_mac_reg(p_dm_odm, 0x4C, BIT(24) | BIT23, 2); /* select DPDT_P and DPDT_N as output pin */ + odm_set_mac_reg(dm, R_0x40, BIT(3), 1); + odm_set_mac_reg(dm, R_0x38, BIT(11), 1); + odm_set_mac_reg(dm, R_0x4c, BIT(24) | BIT(23), 2); + /* select DPDT_P and DPDT_N as output pin */ - odm_set_bb_reg(p_dm_odm, 0x944, BIT(0) | BIT1, 3); /* in/out */ - odm_set_bb_reg(p_dm_odm, 0x944, BIT(31), 0); + odm_set_bb_reg(dm, R_0x944, BIT(0) | BIT(1), 3); /* @in/out */ + odm_set_bb_reg(dm, R_0x944, BIT(31), 0); - odm_set_bb_reg(p_dm_odm, 0x92C, BIT(1), 0); /* DPDT_P non-inverse */ - odm_set_bb_reg(p_dm_odm, 0x92C, BIT(0), 1); /* DPDT_N inverse */ + odm_set_bb_reg(dm, R_0x92c, BIT(1), 0); /* @DPDT_P non-inverse */ + odm_set_bb_reg(dm, R_0x92c, BIT(0), 1); /* @DPDT_N inverse */ - odm_set_bb_reg(p_dm_odm, 0x930, 0xF0, 8); /* DPDT_P = ANTSEL[0] */ - odm_set_bb_reg(p_dm_odm, 0x930, 0xF, 8); /* DPDT_N = ANTSEL[0] */ - - /* 2 [--For HW Bug setting] */ - if (p_dm_odm->ant_type == ODM_AUTO_ANT) - odm_set_bb_reg(p_dm_odm, 0xA00, BIT(15), 0); /* CCK AntDiv function block enable */ + odm_set_bb_reg(dm, R_0x930, 0xF0, 8); /* @DPDT_P = ANTSEL[0] */ + odm_set_bb_reg(dm, R_0x930, 0xF, 8); /* @DPDT_N = ANTSEL[0] */ + /* @2 [--For HW Bug setting] */ + if (dm->ant_type == ODM_AUTO_ANT) + odm_set_bb_reg(dm, R_0xa00, BIT(15), 0); + /* @CCK AntDiv function block enable */ } - - -void -odm_s0s1_sw_ant_div_init_8723b( - void *p_dm_void -) +void odm_s0s1_sw_ant_div_init_8723b(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _sw_antenna_switch_ *p_dm_swat_table = &p_dm_odm->dm_swat_table; - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct sw_antenna_switch *swat_tab = &dm->dm_swat_table; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8723B AntDiv_Init => ant_div_type=[ S0S1_SW_AntDiv]\n")); + PHYDM_DBG(dm, DBG_ANT_DIV, + "***8723B AntDiv_Init => ant_div_type=[ S0S1_SW_AntDiv]\n"); - /* Mapping Table */ - odm_set_bb_reg(p_dm_odm, 0x914, MASKBYTE0, 0); - odm_set_bb_reg(p_dm_odm, 0x914, MASKBYTE1, 1); + /* @Mapping Table */ + odm_set_bb_reg(dm, R_0x914, MASKBYTE0, 0); + odm_set_bb_reg(dm, R_0x914, MASKBYTE1, 1); +#if 0 /* Output Pin Settings */ - /* odm_set_bb_reg(p_dm_odm, 0x948, BIT6, 0x1); */ - odm_set_bb_reg(p_dm_odm, 0x870, BIT(9) | BIT(8), 0); + /* odm_set_bb_reg(dm, R_0x948, BIT6, 0x1); */ +#endif + odm_set_bb_reg(dm, R_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_odm, 0x80C, BIT(21), 0); /* TX ant by Reg */ + fat_tab->is_become_linked = false; + swat_tab->try_flag = SWAW_STEP_INIT; + swat_tab->double_chk_flag = 0; + /* @2 [--For HW Bug setting] */ + odm_set_bb_reg(dm, R_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 -) +void odm_update_rx_idle_ant_8723b( + void *dm_void, + u8 ant, + u32 default_ant, + u32 optional_ant) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; - struct _ADAPTER *p_adapter = p_dm_odm->adapter; - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); - u8 count = 0; - u8 u1_temp; - u8 h2c_parameter; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + void *adapter = dm->adapter; + u8 count = 0; + /*u8 u1_temp;*/ + /*u8 h2c_parameter;*/ - if ((!p_dm_odm->is_linked) && (p_dm_odm->ant_type == ODM_AUTO_ANT)) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-ant ] 8723B: Fail to set RX antenna due to no link\n")); + if (!dm->is_linked && dm->ant_type == ODM_AUTO_ANT) { + PHYDM_DBG(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 */ + /* @Enable wifi calibration */ h2c_parameter = true; - odm_fill_h2c_cmd(p_dm_odm, ODM_H2C_WIFI_CALIBRATION, 1, &h2c_parameter); + odm_fill_h2c_cmd(dm, ODM_H2C_WIFI_CALIBRATION, 1, &h2c_parameter); - /* Check if H2C command sucess or not (0x1e6) */ - u1_temp = odm_read_1byte(p_dm_odm, 0x1e6); + /* @Check if H2C command sucess or not (0x1e6) */ + u1_temp = odm_read_1byte(dm, 0x1e6); while ((u1_temp != 0x1) && (count < 100)) { ODM_delay_us(10); - u1_temp = odm_read_1byte(p_dm_odm, 0x1e6); + u1_temp = odm_read_1byte(dm, 0x1e6); count++; } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-ant ] 8723B: H2C command status = %d, count = %d\n", u1_temp, count)); + PHYDM_DBG(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) */ + /* @Check if BT is doing IQK (0x1e7) */ count = 0; - u1_temp = odm_read_1byte(p_dm_odm, 0x1e7); + u1_temp = odm_read_1byte(dm, 0x1e7); while ((!(u1_temp & BIT(0))) && (count < 100)) { ODM_delay_us(50); - u1_temp = odm_read_1byte(p_dm_odm, 0x1e7); + u1_temp = odm_read_1byte(dm, 0x1e7); count++; } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-ant ] 8723B: BT IQK status = %d, count = %d\n", u1_temp, count)); + PHYDM_DBG(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_odm, 0x948, BIT(6), 0x1); - odm_set_bb_reg(p_dm_odm, 0x948, BIT(9), default_ant); - odm_set_bb_reg(p_dm_odm, 0x864, BIT(5) | BIT4 | BIT3, default_ant); /* Default RX */ - odm_set_bb_reg(p_dm_odm, 0x864, BIT(8) | BIT7 | BIT6, optional_ant); /* Optional RX */ - odm_set_bb_reg(p_dm_odm, 0x860, BIT(14) | BIT13 | BIT12, default_ant); /* Default TX */ - p_dm_fat_table->rx_idle_ant = ant; + odm_set_bb_reg(dm, R_0x948, BIT(6), 0x1); + odm_set_bb_reg(dm, R_0x948, BIT(9), default_ant); + odm_set_bb_reg(dm, R_0x864, 0x38, default_ant); + /* @Default RX */ + odm_set_bb_reg(dm, R_0x864, 0x1c0, optional_ant); + /* @Optional RX */ + odm_set_bb_reg(dm, R_0x860, 0x7000, default_ant); + /* @Default TX */ + fat_tab->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_odm->p_channel); + adapter->hal_func.set_tx_power_level_handler(adapter, *dm->channel); #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - rtw_hal_set_tx_power_level(p_adapter, *p_dm_odm->p_channel); + rtw_hal_set_tx_power_level(adapter, *dm->channel); #endif /* Set IQC by S0/S1 */ - odm_set_iqc_by_rfpath(p_dm_odm, default_ant); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-ant ] 8723B: Sucess to set RX antenna\n")); + odm_set_iqc_by_rfpath(dm, default_ant); + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ Update Rx-Idle-ant ] 8723B: Success to set RX antenna\n"); } else - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-ant ] 8723B: Fail to set RX antenna due to BT IQK\n")); + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ Update Rx-Idle-ant ] 8723B: Fail to set RX antenna due to BT IQK\n"); } else - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-ant ] 8723B: Fail to set RX antenna due to H2C command fail\n")); + PHYDM_DBG(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 */ + /* @Disable wifi calibration */ h2c_parameter = false; - odm_fill_h2c_cmd(p_dm_odm, ODM_H2C_WIFI_CALIBRATION, 1, &h2c_parameter); + odm_fill_h2c_cmd(dm, ODM_H2C_WIFI_CALIBRATION, 1, &h2c_parameter); #else - odm_set_bb_reg(p_dm_odm, 0x948, BIT(6), 0x1); - odm_set_bb_reg(p_dm_odm, 0x948, BIT(9), default_ant); - odm_set_bb_reg(p_dm_odm, 0x864, BIT(5) | BIT4 | BIT3, default_ant); /*Default RX*/ - odm_set_bb_reg(p_dm_odm, 0x864, BIT(8) | BIT7 | BIT6, optional_ant); /*Optional RX*/ - odm_set_bb_reg(p_dm_odm, 0x860, BIT(14) | BIT13 | BIT12, default_ant); /*Default TX*/ - p_dm_fat_table->rx_idle_ant = ant; + odm_set_bb_reg(dm, R_0x948, BIT(6), 0x1); + odm_set_bb_reg(dm, R_0x948, BIT(9), default_ant); + odm_set_bb_reg(dm, R_0x864, BIT(5) | BIT(4) | BIT(3), default_ant); + /*@Default RX*/ + odm_set_bb_reg(dm, R_0x864, BIT(8) | BIT(7) | BIT(6), optional_ant); + /*Optional RX*/ + odm_set_bb_reg(dm, R_0x860, BIT(14) | BIT(13) | BIT(12), default_ant); + /*@Default TX*/ + fat_tab->rx_idle_ant = ant; - /* Set TX AGC by S0/S1 */ - /* Need to consider Linux driver */ +/* 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_odm->p_channel); + ((PADAPTER)adapter)->HalFunc.SetTxPowerLevelHandler(adapter, *dm->channel); #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - rtw_hal_set_tx_power_level(p_adapter, *p_dm_odm->p_channel); + rtw_hal_set_tx_power_level(adapter, *dm->channel); #endif /* Set IQC by S0/S1 */ - odm_set_iqc_by_rfpath(p_dm_odm, default_ant); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-ant ] 8723B: Success to set RX antenna\n")); + odm_set_iqc_by_rfpath(dm, default_ant); + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ Update Rx-Idle-ant ] 8723B: Success to set RX antenna\n"); #endif } -bool -phydm_is_bt_enable_8723b( - void *p_dm_void -) +boolean +phydm_is_bt_enable_8723b(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u32 bt_state; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 bt_state; +#if 0 /*u32 reg75;*/ - /*reg75 = odm_get_bb_reg(p_dm_odm, 0x74, BIT8);*/ - /*odm_set_bb_reg(p_dm_odm, 0x74, BIT8, 0x0);*/ - odm_set_bb_reg(p_dm_odm, 0xa0, BIT(24) | BIT(25) | BIT(26), 0x5); - bt_state = odm_get_bb_reg(p_dm_odm, 0xa0, (BIT(3) | BIT(2) | BIT(1) | BIT(0))); - /*odm_set_bb_reg(p_dm_odm, 0x74, BIT8, reg75);*/ + /*reg75 = odm_get_bb_reg(dm, R_0x74, BIT8);*/ + /*odm_set_bb_reg(dm, R_0x74, BIT8, 0x0);*/ +#endif + odm_set_bb_reg(dm, R_0xa0, BIT(24) | BIT(25) | BIT(26), 0x5); + bt_state = odm_get_bb_reg(dm, R_0xa0, 0xf); +#if 0 + /*odm_set_bb_reg(dm, R_0x74, BIT8, reg75);*/ +#endif - if ((bt_state == 4) || (bt_state == 7) || (bt_state == 9) || (bt_state == 13)) + if (bt_state == 4 || bt_state == 7 || bt_state == 9 || bt_state == 13) return true; else return false; } -#endif /* #if (RTL8723B_SUPPORT == 1) */ +#endif /* @#if (RTL8723B_SUPPORT == 1) */ #if (RTL8821A_SUPPORT == 1) -#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -void -phydm_hl_smart_ant_type1_init_8821a( - void *p_dm_void -) + +void odm_trx_hw_ant_div_init_8821a(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _SMART_ANTENNA_TRAINNING_ *pdm_sat_table = &(p_dm_odm->dm_sat_table); - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; - u32 value32; + struct dm_struct *dm = (struct dm_struct *)dm_void; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***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_odm, 0x64, BIT(18), 0); - odm_set_mac_reg(p_dm_odm, 0x44, BIT(27) | BIT(26), 0); - odm_set_mac_reg(p_dm_odm, 0x44, BIT(19) | BIT18, 0x3); /*enable_output for P_GPIO[3:2]*/ - /*odm_set_mac_reg(p_dm_odm, 0x44, BIT(11)|BIT10, 0);*/ /*output value*/ - odm_set_mac_reg(p_dm_odm, 0x40, BIT(1) | 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(p_dm_odm); - - p_dm_fat_table->fat_state = FAT_BEFORE_LINK_STATE; - - odm_set_bb_reg(p_dm_odm, 0xCA4, MASKDWORD, 0x01000100); - odm_set_bb_reg(p_dm_odm, 0xCA8, MASKDWORD, 0x01000100); - - /*[BB] FAT setting*/ - odm_set_bb_reg(p_dm_odm, 0xc08, BIT(18) | BIT(17) | BIT(16), pdm_sat_table->ant_num); - odm_set_bb_reg(p_dm_odm, 0xc08, BIT(31), 0); /*increase ant num every FAT period 0:+1, 1+2*/ - odm_set_bb_reg(p_dm_odm, 0x8c4, BIT(2) | BIT1, 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_odm, 0x8c4, BIT(0), 1); /*FAT_watchdog_en*/ - - value32 = odm_get_mac_reg(p_dm_odm, 0x7B4, MASKDWORD); - odm_set_mac_reg(p_dm_odm, 0x7b4, MASKDWORD, value32 | (BIT(16) | BIT17)); /*Reg7B4[16]=1 enable antenna training */ - /*Reg7B4[17]=1 enable match MAC addr*/ - odm_set_mac_reg(p_dm_odm, 0x7b4, 0xFFFF, 0);/*Match MAC ADDR*/ - odm_set_mac_reg(p_dm_odm, 0x7b0, MASKDWORD, 0); - -} -#endif - -void -odm_trx_hw_ant_div_init_8821a( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8821A AntDiv_Init => ant_div_type=[ CG_TRX_HW_ANTDIV (DPDT)]\n")); + PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); /* Output Pin Settings */ - odm_set_mac_reg(p_dm_odm, 0x4C, BIT(25), 0); + odm_set_mac_reg(dm, R_0x4c, BIT(25), 0); - odm_set_mac_reg(p_dm_odm, 0x64, BIT(29), 1); /* PAPE by WLAN control */ - odm_set_mac_reg(p_dm_odm, 0x64, BIT(28), 1); /* LNAON by WLAN control */ + odm_set_mac_reg(dm, R_0x64, BIT(29), 1); /* PAPE by WLAN control */ + odm_set_mac_reg(dm, R_0x64, BIT(28), 1); /* @LNAON by WLAN control */ - odm_set_bb_reg(p_dm_odm, 0xCB0, MASKDWORD, 0x77775745); - odm_set_bb_reg(p_dm_odm, 0xCB8, BIT(16), 0); + odm_set_bb_reg(dm, R_0xcb8, BIT(16), 0); - odm_set_mac_reg(p_dm_odm, 0x4C, BIT(23), 0); /* select DPDT_P and DPDT_N as output pin */ - odm_set_mac_reg(p_dm_odm, 0x4C, BIT(24), 1); /* by WLAN control */ - odm_set_bb_reg(p_dm_odm, 0xCB4, 0xF, 8); /* DPDT_P = ANTSEL[0] */ - odm_set_bb_reg(p_dm_odm, 0xCB4, 0xF0, 8); /* DPDT_N = ANTSEL[0] */ - odm_set_bb_reg(p_dm_odm, 0xCB4, BIT(29), 0); /* DPDT_P non-inverse */ - odm_set_bb_reg(p_dm_odm, 0xCB4, BIT(28), 1); /* DPDT_N inverse */ + odm_set_mac_reg(dm, R_0x4c, BIT(23), 0); + /* select DPDT_P and DPDT_N as output pin */ + odm_set_mac_reg(dm, R_0x4c, BIT(24), 1); /* @by WLAN control */ + odm_set_bb_reg(dm, R_0xcb4, 0xF, 8); /* @DPDT_P = ANTSEL[0] */ + odm_set_bb_reg(dm, R_0xcb4, 0xF0, 8); /* @DPDT_N = ANTSEL[0] */ + odm_set_bb_reg(dm, R_0xcb4, BIT(29), 0); /* @DPDT_P non-inverse */ + odm_set_bb_reg(dm, R_0xcb4, BIT(28), 1); /* @DPDT_N inverse */ - /* Mapping Table */ - odm_set_bb_reg(p_dm_odm, 0xCA4, MASKBYTE0, 0); - odm_set_bb_reg(p_dm_odm, 0xCA4, MASKBYTE1, 1); + /* @Mapping Table */ + odm_set_bb_reg(dm, R_0xca4, MASKBYTE0, 0); + odm_set_bb_reg(dm, R_0xca4, MASKBYTE1, 1); /* OFDM HW AntDiv Parameters */ - odm_set_bb_reg(p_dm_odm, 0x8D4, 0x7FF, 0xA0); /* thershold */ - odm_set_bb_reg(p_dm_odm, 0x8D4, 0x7FF000, 0x10); /* bias */ + odm_set_bb_reg(dm, R_0x8d4, 0x7FF, 0xA0); /* thershold */ + odm_set_bb_reg(dm, R_0x8d4, 0x7FF000, 0x10); /* @bias */ - /* CCK HW AntDiv Parameters */ - odm_set_bb_reg(p_dm_odm, 0xA74, BIT(7), 1); /* patch for clk from 88M to 80M */ - odm_set_bb_reg(p_dm_odm, 0xA0C, BIT(4), 1); /* do 64 samples */ + /* @CCK HW AntDiv Parameters */ + odm_set_bb_reg(dm, R_0xa74, BIT(7), 1); + /* patch for clk from 88M to 80M */ + odm_set_bb_reg(dm, R_0xa0c, BIT(4), 1); /* @do 64 samples */ - odm_set_bb_reg(p_dm_odm, 0x800, BIT(25), 0); /* ANTSEL_CCK sent to the smart_antenna circuit */ - odm_set_bb_reg(p_dm_odm, 0xA00, BIT(15), 0); /* CCK AntDiv function block enable */ + odm_set_bb_reg(dm, R_0x800, BIT(25), 0); + /* @ANTSEL_CCK sent to the smart_antenna circuit */ + odm_set_bb_reg(dm, R_0xa00, BIT(15), 0); + /* @CCK AntDiv function block enable */ - /* BT Coexistence */ - odm_set_bb_reg(p_dm_odm, 0xCAC, BIT(9), 1); /* keep antsel_map when GNT_BT = 1 */ - odm_set_bb_reg(p_dm_odm, 0x804, BIT(4), 1); /* Disable hw antsw & fast_train.antsw when GNT_BT=1 */ + /* @BT Coexistence */ + odm_set_bb_reg(dm, R_0xcac, BIT(9), 1); + /* @keep antsel_map when GNT_BT = 1 */ + odm_set_bb_reg(dm, R_0x804, BIT(4), 1); + /* @Disable hw antsw & fast_train.antsw when GNT_BT=1 */ - odm_set_bb_reg(p_dm_odm, 0x8CC, BIT(20) | BIT19 | BIT18, 3); /* settling time of antdiv by RF LNA = 100ns */ + odm_set_bb_reg(dm, R_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_odm, 0x668, BIT(3), 1); - + odm_set_mac_reg(dm, R_0x668, BIT(3), 1); } -void -odm_s0s1_sw_ant_div_init_8821a( - void *p_dm_void -) +void odm_s0s1_sw_ant_div_init_8821a(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _sw_antenna_switch_ *p_dm_swat_table = &p_dm_odm->dm_swat_table; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct sw_antenna_switch *swat_tab = &dm->dm_swat_table; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8821A AntDiv_Init => ant_div_type=[ S0S1_SW_AntDiv]\n")); + PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); /* Output Pin Settings */ - odm_set_mac_reg(p_dm_odm, 0x4C, BIT(25), 0); + odm_set_mac_reg(dm, R_0x4c, BIT(25), 0); - odm_set_mac_reg(p_dm_odm, 0x64, BIT(29), 1); /* PAPE by WLAN control */ - odm_set_mac_reg(p_dm_odm, 0x64, BIT(28), 1); /* LNAON by WLAN control */ + odm_set_mac_reg(dm, R_0x64, BIT(29), 1); /* PAPE by WLAN control */ + odm_set_mac_reg(dm, R_0x64, BIT(28), 1); /* @LNAON by WLAN control */ - odm_set_bb_reg(p_dm_odm, 0xCB0, MASKDWORD, 0x77775745); - odm_set_bb_reg(p_dm_odm, 0xCB8, BIT(16), 0); + odm_set_bb_reg(dm, R_0xcb8, BIT(16), 0); - odm_set_mac_reg(p_dm_odm, 0x4C, BIT(23), 0); /* select DPDT_P and DPDT_N as output pin */ - odm_set_mac_reg(p_dm_odm, 0x4C, BIT(24), 1); /* by WLAN control */ - odm_set_bb_reg(p_dm_odm, 0xCB4, 0xF, 8); /* DPDT_P = ANTSEL[0] */ - odm_set_bb_reg(p_dm_odm, 0xCB4, 0xF0, 8); /* DPDT_N = ANTSEL[0] */ - odm_set_bb_reg(p_dm_odm, 0xCB4, BIT(29), 0); /* DPDT_P non-inverse */ - odm_set_bb_reg(p_dm_odm, 0xCB4, BIT(28), 1); /* DPDT_N inverse */ + odm_set_mac_reg(dm, R_0x4c, BIT(23), 0); + /* select DPDT_P and DPDT_N as output pin */ + odm_set_mac_reg(dm, R_0x4c, BIT(24), 1); /* @by WLAN control */ + odm_set_bb_reg(dm, R_0xcb4, 0xF, 8); /* @DPDT_P = ANTSEL[0] */ + odm_set_bb_reg(dm, R_0xcb4, 0xF0, 8); /* @DPDT_N = ANTSEL[0] */ + odm_set_bb_reg(dm, R_0xcb4, BIT(29), 0); /* @DPDT_P non-inverse */ + odm_set_bb_reg(dm, R_0xcb4, BIT(28), 1); /* @DPDT_N inverse */ - /* Mapping Table */ - odm_set_bb_reg(p_dm_odm, 0xCA4, MASKBYTE0, 0); - odm_set_bb_reg(p_dm_odm, 0xCA4, MASKBYTE1, 1); + /* @Mapping Table */ + odm_set_bb_reg(dm, R_0xca4, MASKBYTE0, 0); + odm_set_bb_reg(dm, R_0xca4, MASKBYTE1, 1); /* OFDM HW AntDiv Parameters */ - odm_set_bb_reg(p_dm_odm, 0x8D4, 0x7FF, 0xA0); /* thershold */ - odm_set_bb_reg(p_dm_odm, 0x8D4, 0x7FF000, 0x10); /* bias */ + odm_set_bb_reg(dm, R_0x8d4, 0x7FF, 0xA0); /* thershold */ + odm_set_bb_reg(dm, R_0x8d4, 0x7FF000, 0x10); /* @bias */ - /* CCK HW AntDiv Parameters */ - odm_set_bb_reg(p_dm_odm, 0xA74, BIT(7), 1); /* patch for clk from 88M to 80M */ - odm_set_bb_reg(p_dm_odm, 0xA0C, BIT(4), 1); /* do 64 samples */ + /* @CCK HW AntDiv Parameters */ + odm_set_bb_reg(dm, R_0xa74, BIT(7), 1); + /* patch for clk from 88M to 80M */ + odm_set_bb_reg(dm, R_0xa0c, BIT(4), 1); /* @do 64 samples */ - odm_set_bb_reg(p_dm_odm, 0x800, BIT(25), 0); /* ANTSEL_CCK sent to the smart_antenna circuit */ - odm_set_bb_reg(p_dm_odm, 0xA00, BIT(15), 0); /* CCK AntDiv function block enable */ + odm_set_bb_reg(dm, R_0x800, BIT(25), 0); + /* @ANTSEL_CCK sent to the smart_antenna circuit */ + odm_set_bb_reg(dm, R_0xa00, BIT(15), 0); + /* @CCK AntDiv function block enable */ - /* BT Coexistence */ - odm_set_bb_reg(p_dm_odm, 0xCAC, BIT(9), 1); /* keep antsel_map when GNT_BT = 1 */ - odm_set_bb_reg(p_dm_odm, 0x804, BIT(4), 1); /* Disable hw antsw & fast_train.antsw when GNT_BT=1 */ + /* @BT Coexistence */ + odm_set_bb_reg(dm, R_0xcac, BIT(9), 1); + /* @keep antsel_map when GNT_BT = 1 */ + odm_set_bb_reg(dm, R_0x804, BIT(4), 1); + /* @Disable hw antsw & fast_train.antsw when GNT_BT=1 */ - odm_set_bb_reg(p_dm_odm, 0x8CC, BIT(20) | BIT19 | BIT18, 3); /* settling time of antdiv by RF LNA = 100ns */ + odm_set_bb_reg(dm, R_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_odm, 0x668, BIT(3), 1); + odm_set_mac_reg(dm, R_0x668, BIT(3), 1); + odm_set_bb_reg(dm, R_0x900, BIT(18), 0); - odm_set_bb_reg(p_dm_odm, 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; - + swat_tab->try_flag = SWAW_STEP_INIT; + swat_tab->double_chk_flag = 0; + swat_tab->cur_antenna = MAIN_ANT; + swat_tab->pre_ant = MAIN_ANT; + swat_tab->swas_no_link_state = 0; } -#endif /* #if (RTL8821A_SUPPORT == 1) */ - -#if (RTL8822B_SUPPORT == 1) -#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -void -phydm_hl_smart_ant_type1_init_8822b( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _SMART_ANTENNA_TRAINNING_ *pdm_sat_table = &(p_dm_odm->dm_sat_table); - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8821A SmartAnt_Init => ant_div_type=[Hong-Lin Smart ant Type1]\n")); - - /*OFDM HW AntDiv Parameters*/ - odm_set_bb_reg(p_dm_odm, 0x8D4, 0x7FF, 0xA0); /*thershold*/ - odm_set_bb_reg(p_dm_odm, 0x8D4, 0x7FF000, 0x10); /*bias*/ - odm_set_bb_reg(p_dm_odm, 0x8CC, BIT(20) | BIT19 | BIT18, 3); /*settling time of antdiv by RF LNA = 100ns*/ - - /*CCK HW AntDiv Parameters*/ - odm_set_bb_reg(p_dm_odm, 0xA74, BIT(7), 1); /*patch for clk from 88M to 80M*/ - odm_set_bb_reg(p_dm_odm, 0xA0C, BIT(4), 1); /*do 64 samples*/ - odm_set_bb_reg(p_dm_odm, 0x800, BIT(25), 0); /*ANTSEL_CCK sent to the smart_antenna circuit*/ - odm_set_bb_reg(p_dm_odm, 0xA00, BIT(15), 0); /*CCK AntDiv function block enable*/ - - /*BT Coexistence*/ - odm_set_bb_reg(p_dm_odm, 0xCAC, BIT(9), 1); /*keep antsel_map when GNT_BT = 1*/ - odm_set_bb_reg(p_dm_odm, 0x804, BIT(4), 1); /*Disable hw antsw & fast_train.antsw when GNT_BT=1*/ - - /*CGCS setting*/ - odm_set_bb_reg(p_dm_odm, 0xC1C, (BIT(7) | BIT6), 0); /*force to CG*/ - - - -#if 0 - /* ---------------------------------------- */ - /* 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 */ - /* ------------------------------------------ */ -#endif - - /*GPIO setting*/ - odm_set_mac_reg(p_dm_odm, 0x64, (BIT(18) | BIT(17) | BIT(16)), 0); - odm_set_mac_reg(p_dm_odm, 0x44, BIT(25) | BIT24, 0); /*config P_GPIO[3:2] to data port*/ - odm_set_mac_reg(p_dm_odm, 0x44, BIT(17) | BIT16, 0x3); /*enable_output for P_GPIO[3:2]*/ - /*odm_set_mac_reg(p_dm_odm, 0x44, BIT(9)|BIT8, 0);*/ /*P_GPIO[3:2] output value*/ - odm_set_mac_reg(p_dm_odm, 0x40, BIT(1) | 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 = 0;/*set=1~7,1~7ant, set=0: 8ant*/ - pdm_sat_table->ant_num_total = MAX_PATH_NUM_8822B; - 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_odm); - - p_dm_fat_table->fat_state = FAT_BEFORE_LINK_STATE; - - /*Mapping table*/ - odm_set_bb_reg(p_dm_odm, 0xCA4, MASKDWORD, 0x03020100); - odm_set_bb_reg(p_dm_odm, 0xCA8, MASKDWORD, 0x07060504); - - /*Smart Antenna training setting*/ - odm_set_bb_reg(p_dm_odm, 0xc08, BIT(18) | BIT(17) | BIT(16), pdm_sat_table->ant_num); - odm_set_bb_reg(p_dm_odm, 0xc08, BIT(31), 0); /*increase ant num every FAT period 0:+1, 1+2*/ - odm_set_bb_reg(p_dm_odm, 0x8c4, BIT(2) | BIT1, 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_odm, 0x8c4, BIT(0), 1); /*FAT_watchdog_en*/ - - odm_set_mac_reg(p_dm_odm, 0x7b4, (BIT(17) | BIT16), 0x3); /*Reg7B4[16]=1 enable antenna training */ - /*Reg7B4[17]=1 enable match MAC addr*/ - odm_set_mac_reg(p_dm_odm, 0x7b4, 0xFFFF, 0); /*Match MAC ADDR part1*/ - odm_set_mac_reg(p_dm_odm, 0x7b0, MASKDWORD, 0); /*Match MAC ADDR part2*/ - -} -#endif -#endif - +#endif /* @#if (RTL8821A_SUPPORT == 1) */ #if (RTL8821C_SUPPORT == 1) -void -odm_trx_hw_ant_div_init_8821c( - void *p_dm_void -) +void odm_trx_hw_ant_div_init_8821c(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8821C AntDiv_Init => ant_div_type=[ CG_TRX_HW_ANTDIV (DPDT)]\n")); + PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); /* Output Pin Settings */ - odm_set_mac_reg(p_dm_odm, 0x4C, BIT(25), 0); + odm_set_mac_reg(dm, R_0x4c, BIT(25), 0); - odm_set_mac_reg(p_dm_odm, 0x64, BIT(29), 1); /* PAPE by WLAN control */ - odm_set_mac_reg(p_dm_odm, 0x64, BIT(28), 1); /* LNAON by WLAN control */ + odm_set_mac_reg(dm, R_0x64, BIT(29), 1); /* PAPE by WLAN control */ + odm_set_mac_reg(dm, R_0x64, BIT(28), 1); /* @LNAON by WLAN control */ - odm_set_bb_reg(p_dm_odm, 0xCB0, MASKDWORD, 0x77775745); - odm_set_bb_reg(p_dm_odm, 0xCB8, BIT(16), 0); + odm_set_bb_reg(dm, R_0xcb8, BIT(16), 0); - odm_set_mac_reg(p_dm_odm, 0x4C, BIT(23), 0); /* select DPDT_P and DPDT_N as output pin */ - odm_set_mac_reg(p_dm_odm, 0x4C, BIT(24), 1); /* by WLAN control */ - odm_set_bb_reg(p_dm_odm, 0xCB4, 0xF, 8); /* DPDT_P = ANTSEL[0] */ - odm_set_bb_reg(p_dm_odm, 0xCB4, 0xF0, 8); /* DPDT_N = ANTSEL[0] */ - odm_set_bb_reg(p_dm_odm, 0xCB4, BIT(29), 0); /* DPDT_P non-inverse */ - odm_set_bb_reg(p_dm_odm, 0xCB4, BIT(28), 1); /* DPDT_N inverse */ + odm_set_mac_reg(dm, R_0x4c, BIT(23), 0); + /* select DPDT_P and DPDT_N as output pin */ + odm_set_mac_reg(dm, R_0x4c, BIT(24), 1); /* @by WLAN control */ + odm_set_bb_reg(dm, R_0xcb4, 0xF, 8); /* @DPDT_P = ANTSEL[0] */ + odm_set_bb_reg(dm, R_0xcb4, 0xF0, 8); /* @DPDT_N = ANTSEL[0] */ + odm_set_bb_reg(dm, R_0xcb4, BIT(29), 0); /* @DPDT_P non-inverse */ + odm_set_bb_reg(dm, R_0xcb4, BIT(28), 1); /* @DPDT_N inverse */ - /* Mapping Table */ - odm_set_bb_reg(p_dm_odm, 0xCA4, MASKBYTE0, 0); - odm_set_bb_reg(p_dm_odm, 0xCA4, MASKBYTE1, 1); + /* @Mapping Table */ + odm_set_bb_reg(dm, R_0xca4, MASKBYTE0, 0); + odm_set_bb_reg(dm, R_0xca4, MASKBYTE1, 1); /* OFDM HW AntDiv Parameters */ - odm_set_bb_reg(p_dm_odm, 0x8D4, 0x7FF, 0xA0); /* thershold */ - odm_set_bb_reg(p_dm_odm, 0x8D4, 0x7FF000, 0x10); /* bias */ + odm_set_bb_reg(dm, R_0x8d4, 0x7FF, 0xA0); /* thershold */ + odm_set_bb_reg(dm, R_0x8d4, 0x7FF000, 0x10); /* @bias */ - /* CCK HW AntDiv Parameters */ - odm_set_bb_reg(p_dm_odm, 0xA74, BIT(7), 1); /* patch for clk from 88M to 80M */ - odm_set_bb_reg(p_dm_odm, 0xA0C, BIT(4), 1); /* do 64 samples */ + /* @CCK HW AntDiv Parameters */ + odm_set_bb_reg(dm, R_0xa74, BIT(7), 1); + /* patch for clk from 88M to 80M */ + odm_set_bb_reg(dm, R_0xa0c, BIT(4), 1); /* @do 64 samples */ - odm_set_bb_reg(p_dm_odm, 0x800, BIT(25), 0); /* ANTSEL_CCK sent to the smart_antenna circuit */ - odm_set_bb_reg(p_dm_odm, 0xA00, BIT(15), 0); /* CCK AntDiv function block enable */ + odm_set_bb_reg(dm, R_0x800, BIT(25), 0); + /* @ANTSEL_CCK sent to the smart_antenna circuit */ + odm_set_bb_reg(dm, R_0xa00, BIT(15), 0); + /* @CCK AntDiv function block enable */ - /* BT Coexistence */ - odm_set_bb_reg(p_dm_odm, 0xCAC, BIT(9), 1); /* keep antsel_map when GNT_BT = 1 */ - odm_set_bb_reg(p_dm_odm, 0x804, BIT(4), 1); /* Disable hw antsw & fast_train.antsw when GNT_BT=1 */ + /* @BT Coexistence */ + odm_set_bb_reg(dm, R_0xcac, BIT(9), 1); + /* @keep antsel_map when GNT_BT = 1 */ + odm_set_bb_reg(dm, R_0x804, BIT(4), 1); + /* @Disable hw antsw & fast_train.antsw when GNT_BT=1 */ /* Timming issue */ - odm_set_bb_reg(p_dm_odm, 0x818, BIT(23) | BIT22 | BIT21 | BIT20, 0); /*keep antidx after tx for ACK ( unit x 3.2 mu sec)*/ - odm_set_bb_reg(p_dm_odm, 0x8CC, BIT(20) | BIT19 | BIT18, 3); /* settling time of antdiv by RF LNA = 100ns */ + odm_set_bb_reg(dm, R_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(dm, R_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_odm, 0x668, BIT(3), 1); - + odm_set_mac_reg(dm, R_0x668, BIT(3), 1); } -#endif /* #if (RTL8821C_SUPPORT == 1) */ - -#if (RTL8881A_SUPPORT == 1) -void -odm_trx_hw_ant_div_init_8881a( - void *p_dm_void -) +void phydm_s0s1_sw_ant_div_init_8821c(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct sw_antenna_switch *swat_tab = &dm->dm_swat_table; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8881A AntDiv_Init => ant_div_type=[ CG_TRX_HW_ANTDIV (SPDT)]\n")); + PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); /* Output Pin Settings */ - /* [SPDT related] */ - odm_set_mac_reg(p_dm_odm, 0x4C, BIT(25), 0); - odm_set_mac_reg(p_dm_odm, 0x4C, BIT(26), 0); - odm_set_bb_reg(p_dm_odm, 0xCB4, BIT(31), 0); /* delay buffer */ - odm_set_bb_reg(p_dm_odm, 0xCB4, BIT(22), 0); - odm_set_bb_reg(p_dm_odm, 0xCB4, BIT(24), 1); - odm_set_bb_reg(p_dm_odm, 0xCB0, 0xF00, 8); /* DPDT_P = ANTSEL[0] */ - odm_set_bb_reg(p_dm_odm, 0xCB0, 0xF0000, 8); /* DPDT_N = ANTSEL[0] */ + odm_set_mac_reg(dm, R_0x4c, BIT(25), 0); - /* Mapping Table */ - odm_set_bb_reg(p_dm_odm, 0xCA4, MASKBYTE0, 0); - odm_set_bb_reg(p_dm_odm, 0xCA4, MASKBYTE1, 1); + odm_set_mac_reg(dm, R_0x64, BIT(29), 1); /* PAPE by WLAN control */ + odm_set_mac_reg(dm, R_0x64, BIT(28), 1); /* @LNAON by WLAN control */ + + odm_set_bb_reg(dm, R_0xcb8, BIT(16), 0); + + odm_set_mac_reg(dm, R_0x4c, BIT(23), 0); + /* select DPDT_P and DPDT_N as output pin */ + odm_set_mac_reg(dm, R_0x4c, BIT(24), 1); /* @by WLAN control */ + odm_set_bb_reg(dm, R_0xcb4, 0xF, 8); /* @DPDT_P = ANTSEL[0] */ + odm_set_bb_reg(dm, R_0xcb4, 0xF0, 8); /* @DPDT_N = ANTSEL[0] */ + odm_set_bb_reg(dm, R_0xcb4, BIT(29), 0); /* @DPDT_P non-inverse */ + odm_set_bb_reg(dm, R_0xcb4, BIT(28), 1); /* @DPDT_N inverse */ + + /* @Mapping Table */ + odm_set_bb_reg(dm, R_0xca4, MASKBYTE0, 0); + odm_set_bb_reg(dm, R_0xca4, MASKBYTE1, 1); /* OFDM HW AntDiv Parameters */ - odm_set_bb_reg(p_dm_odm, 0x8D4, 0x7FF, 0xA0); /* thershold */ - odm_set_bb_reg(p_dm_odm, 0x8D4, 0x7FF000, 0x0); /* bias */ - odm_set_bb_reg(p_dm_odm, 0x8CC, BIT(20) | BIT19 | BIT18, 3); /* settling time of antdiv by RF LNA = 100ns */ + odm_set_bb_reg(dm, R_0x8d4, 0x7FF, 0xA0); /* thershold */ + odm_set_bb_reg(dm, R_0x8d4, 0x7FF000, 0x00); /* @bias */ - /* CCK HW AntDiv Parameters */ - odm_set_bb_reg(p_dm_odm, 0xA74, BIT(7), 1); /* patch for clk from 88M to 80M */ - odm_set_bb_reg(p_dm_odm, 0xA0C, BIT(4), 1); /* do 64 samples */ + /* @CCK HW AntDiv Parameters */ + odm_set_bb_reg(dm, R_0xa74, BIT(7), 1); + /* patch for clk from 88M to 80M */ + odm_set_bb_reg(dm, R_0xa0c, BIT(4), 1); /* @do 64 samples */ - /* 2 [--For HW Bug setting] */ + odm_set_bb_reg(dm, R_0x800, BIT(25), 0); + /* @ANTSEL_CCK sent to the smart_antenna circuit */ + odm_set_bb_reg(dm, R_0xa00, BIT(15), 0); + /* @CCK AntDiv function block enable */ - odm_set_bb_reg(p_dm_odm, 0x900, BIT(18), 0); /* TX ant by Reg */ /* A-cut bug */ + /* @BT Coexistence */ + odm_set_bb_reg(dm, R_0xcac, BIT(9), 1); + /* @keep antsel_map when GNT_BT = 1 */ + odm_set_bb_reg(dm, R_0x804, BIT(4), 1); + /* @Disable hw antsw & fast_train.antsw when GNT_BT=1 */ + + odm_set_bb_reg(dm, R_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(dm, R_0x668, BIT(3), 1); + + odm_set_bb_reg(dm, R_0x900, BIT(18), 0); + + swat_tab->try_flag = SWAW_STEP_INIT; + swat_tab->double_chk_flag = 0; + swat_tab->cur_antenna = MAIN_ANT; + swat_tab->pre_ant = MAIN_ANT; + swat_tab->swas_no_link_state = 0; +} +#endif /* @#if (RTL8821C_SUPPORT == 1) */ + +#if (RTL8881A_SUPPORT == 1) +void odm_trx_hw_ant_div_init_8881a(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); + + /* Output Pin Settings */ + /* @[SPDT related] */ + odm_set_mac_reg(dm, R_0x4c, BIT(25), 0); + odm_set_mac_reg(dm, R_0x4c, BIT(26), 0); + odm_set_bb_reg(dm, R_0xcb4, BIT(31), 0); /* @delay buffer */ + odm_set_bb_reg(dm, R_0xcb4, BIT(22), 0); + odm_set_bb_reg(dm, R_0xcb4, BIT(24), 1); + odm_set_bb_reg(dm, R_0xcb0, 0xF00, 8); /* @DPDT_P = ANTSEL[0] */ + odm_set_bb_reg(dm, R_0xcb0, 0xF0000, 8); /* @DPDT_N = ANTSEL[0] */ + + /* @Mapping Table */ + odm_set_bb_reg(dm, R_0xca4, MASKBYTE0, 0); + odm_set_bb_reg(dm, R_0xca4, MASKBYTE1, 1); + + /* OFDM HW AntDiv Parameters */ + odm_set_bb_reg(dm, R_0x8d4, 0x7FF, 0xA0); /* thershold */ + odm_set_bb_reg(dm, R_0x8d4, 0x7FF000, 0x0); /* @bias */ + odm_set_bb_reg(dm, R_0x8cc, BIT(20) | BIT(19) | BIT(18), 3); + /* settling time of antdiv by RF LNA = 100ns */ + + /* @CCK HW AntDiv Parameters */ + odm_set_bb_reg(dm, R_0xa74, BIT(7), 1); + /* patch for clk from 88M to 80M */ + odm_set_bb_reg(dm, R_0xa0c, BIT(4), 1); /* @do 64 samples */ + + /* @2 [--For HW Bug setting] */ + + odm_set_bb_reg(dm, R_0x900, BIT(18), 0); + /* TX ant by Reg *//* A-cut bug */ } -#endif /* #if (RTL8881A_SUPPORT == 1) */ - +#endif /* @#if (RTL8881A_SUPPORT == 1) */ #if (RTL8812A_SUPPORT == 1) -void -odm_trx_hw_ant_div_init_8812a( - void *p_dm_void -) +void odm_trx_hw_ant_div_init_8812a(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8812A AntDiv_Init => ant_div_type=[ CG_TRX_HW_ANTDIV (SPDT)]\n")); + struct dm_struct *dm = (struct dm_struct *)dm_void; - /* 3 */ /* 3 --RFE pin setting--------- */ - /* [BB] */ - odm_set_bb_reg(p_dm_odm, 0x900, BIT(10) | BIT9 | BIT8, 0x0); /* disable SW switch */ - odm_set_bb_reg(p_dm_odm, 0x900, BIT(17) | BIT(16), 0x0); - odm_set_bb_reg(p_dm_odm, 0x974, BIT(7) | BIT6, 0x3); /* in/out */ - odm_set_bb_reg(p_dm_odm, 0xCB4, BIT(31), 0); /* delay buffer */ - odm_set_bb_reg(p_dm_odm, 0xCB4, BIT(26), 0); - odm_set_bb_reg(p_dm_odm, 0xCB4, BIT(27), 1); - odm_set_bb_reg(p_dm_odm, 0xCB0, 0xF000000, 8); /* DPDT_P = ANTSEL[0] */ - odm_set_bb_reg(p_dm_odm, 0xCB0, 0xF0000000, 8); /* DPDT_N = ANTSEL[0] */ - /* 3 ------------------------- */ + PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); - /* Mapping Table */ - odm_set_bb_reg(p_dm_odm, 0xCA4, MASKBYTE0, 0); - odm_set_bb_reg(p_dm_odm, 0xCA4, MASKBYTE1, 1); + /* @3 */ /* @3 --RFE pin setting--------- */ + /* @[BB] */ + odm_set_bb_reg(dm, R_0x900, BIT(10) | BIT(9) | BIT(8), 0x0); + /* @disable SW switch */ + odm_set_bb_reg(dm, R_0x900, BIT(17) | BIT(16), 0x0); + odm_set_bb_reg(dm, R_0x974, BIT(7) | BIT(6), 0x3); /* @in/out */ + odm_set_bb_reg(dm, R_0xcb4, BIT(31), 0); /* @delay buffer */ + odm_set_bb_reg(dm, R_0xcb4, BIT(26), 0); + odm_set_bb_reg(dm, R_0xcb4, BIT(27), 1); + odm_set_bb_reg(dm, R_0xcb0, 0xF000000, 8); /* @DPDT_P = ANTSEL[0] */ + odm_set_bb_reg(dm, R_0xcb0, 0xF0000000, 8); /* @DPDT_N = ANTSEL[0] */ + /* @3 ------------------------- */ + + /* @Mapping Table */ + odm_set_bb_reg(dm, R_0xca4, MASKBYTE0, 0); + odm_set_bb_reg(dm, R_0xca4, MASKBYTE1, 1); /* OFDM HW AntDiv Parameters */ - odm_set_bb_reg(p_dm_odm, 0x8D4, 0x7FF, 0xA0); /* thershold */ - odm_set_bb_reg(p_dm_odm, 0x8D4, 0x7FF000, 0x0); /* bias */ - odm_set_bb_reg(p_dm_odm, 0x8CC, BIT(20) | BIT19 | BIT18, 3); /* settling time of antdiv by RF LNA = 100ns */ + odm_set_bb_reg(dm, R_0x8d4, 0x7FF, 0xA0); /* thershold */ + odm_set_bb_reg(dm, R_0x8d4, 0x7FF000, 0x0); /* @bias */ + odm_set_bb_reg(dm, R_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_odm, 0xA74, BIT(7), 1); /* patch for clk from 88M to 80M */ - odm_set_bb_reg(p_dm_odm, 0xA0C, BIT(4), 1); /* do 64 samples */ + /* @CCK HW AntDiv Parameters */ + odm_set_bb_reg(dm, R_0xa74, BIT(7), 1); + /* patch for clk from 88M to 80M */ + odm_set_bb_reg(dm, R_0xa0c, BIT(4), 1); /* @do 64 samples */ - /* 2 [--For HW Bug setting] */ - - odm_set_bb_reg(p_dm_odm, 0x900, BIT(18), 0); /* TX ant by Reg */ /* A-cut bug */ + /* @2 [--For HW Bug setting] */ + odm_set_bb_reg(dm, R_0x900, BIT(18), 0); + /* TX ant by Reg */ /* A-cut bug */ } -#endif /* #if (RTL8812A_SUPPORT == 1) */ +#endif /* @#if (RTL8812A_SUPPORT == 1) */ #if (RTL8188F_SUPPORT == 1) -void -odm_s0s1_sw_ant_div_init_8188f( - void *p_dm_void -) +void odm_s0s1_sw_ant_div_init_8188f(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _sw_antenna_switch_ *p_dm_swat_table = &p_dm_odm->dm_swat_table; - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct sw_antenna_switch *swat_tab = &dm->dm_swat_table; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8188F AntDiv_Init => ant_div_type=[ S0S1_SW_AntDiv]\n")); - - - /*GPIO setting*/ - /*odm_set_mac_reg(p_dm_odm, 0x64, BIT18, 0); */ - /*odm_set_mac_reg(p_dm_odm, 0x44, BIT28|BIT27, 0);*/ - odm_set_mac_reg(p_dm_odm, 0x44, BIT(20) | BIT19, 0x3); /*enable_output for P_GPIO[4:3]*/ - /*odm_set_mac_reg(p_dm_odm, 0x44, BIT(12)|BIT11, 0);*/ /*output value*/ - /*odm_set_mac_reg(p_dm_odm, 0x40, BIT(1)|BIT0, 0);*/ /*GPIO function*/ - - 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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 codeword; - - if (default_ant == ANT1_2G) - codeword = 1; /*2'b01*/ - else - codeword = 2;/*2'b10*/ - - odm_set_mac_reg(p_dm_odm, 0x44, (BIT(12) | BIT11), codeword); /*GPIO[4:3] output value*/ -} + PHYDM_DBG(dm, DBG_ANT_DIV, "[%s]=====>\n", __func__); +#if 0 + /*@GPIO setting*/ + /*odm_set_mac_reg(dm, R_0x64, BIT(18), 0); */ + /*odm_set_mac_reg(dm, R_0x44, BIT(28)|BIT(27), 0);*/ + /*odm_set_mac_reg(dm, R_0x44, BIT(20) | BIT(19), 0x3);*/ + /*enable_output for P_GPIO[4:3]*/ + /*odm_set_mac_reg(dm, R_0x44, BIT(12)|BIT(11), 0);*/ /*output value*/ + /*odm_set_mac_reg(dm, R_0x40, BIT(1)|BIT(0), 0);*/ /*GPIO function*/ #endif + if (dm->support_ic_type == ODM_RTL8188F) { + if (dm->support_interface == ODM_ITRF_USB) + odm_set_mac_reg(dm, R_0x44, BIT(20) | BIT(19), 0x3); + /*@enable_output for P_GPIO[4:3]*/ + else if (dm->support_interface == ODM_ITRF_SDIO) + odm_set_mac_reg(dm, R_0x44, BIT(18), 0x1); + /*@enable_output for P_GPIO[2]*/ + } - -#ifdef ODM_EVM_ENHANCE_ANTDIV - -void -odm_evm_fast_ant_reset( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; - - p_dm_fat_table->EVM_method_enable = 0; - odm_ant_div_on_off(p_dm_odm, ANTDIV_ON); - p_dm_fat_table->fat_state = NORMAL_STATE_MIAN; - p_dm_odm->antdiv_period = 0; - odm_set_mac_reg(p_dm_odm, 0x608, BIT(8), 0); + fat_tab->is_become_linked = false; + swat_tab->try_flag = SWAW_STEP_INIT; + swat_tab->double_chk_flag = 0; } - -void -odm_evm_enhance_ant_div( - void *p_dm_void -) +void phydm_update_rx_idle_antenna_8188F(void *dm_void, u32 default_ant) { - struct PHY_DM_STRUCT *p_dm_odm = (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; - u8 score_EVM = 0, score_CRC = 0; - u8 rssi_larger_ant = 0; - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; - u32 value32, i; - bool main_above1 = false, aux_above1 = false; - bool force_antenna = false; - struct sta_info *p_entry; - p_dm_fat_table->target_ant_enhance = 0xFF; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 codeword; + if (dm->support_ic_type == ODM_RTL8188F) { + if (dm->support_interface == ODM_ITRF_USB) { + if (default_ant == ANT1_2G) + codeword = 1; /*@2'b01*/ + else + codeword = 2; /*@2'b10*/ + odm_set_mac_reg(dm, R_0x44, 0x1800, codeword); + /*@GPIO[4:3] output value*/ + } else if (dm->support_interface == ODM_ITRF_SDIO) { + if (default_ant == ANT1_2G) { + codeword = 0; /*@1'b0*/ + odm_set_bb_reg(dm, R_0x870, 0x300, 0x3); + odm_set_bb_reg(dm, R_0x860, 0x300, 0x1); + } else { + codeword = 1; /*@1'b1*/ + odm_set_bb_reg(dm, R_0x870, 0x300, 0x3); + odm_set_bb_reg(dm, R_0x860, 0x300, 0x2); + } + odm_set_mac_reg(dm, R_0x44, BIT(10), codeword); + /*@GPIO[2] output value*/ + } + } +} +#endif - if ((p_dm_odm->support_ic_type & ODM_EVM_ENHANCE_ANTDIV_SUPPORT_IC)) { - if (p_dm_odm->is_one_entry_only) { - /* ODM_RT_TRACE(p_dm_odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[One Client only]\n")); */ - i = p_dm_odm->one_entry_macid; +#ifdef ODM_EVM_ENHANCE_ANTDIV +void phydm_rx_rate_for_antdiv(void *dm_void, void *pkt_info_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + struct phydm_perpkt_info_struct *pktinfo = NULL; + u8 data_rate = 0; - 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; + pktinfo = (struct phydm_perpkt_info_struct *)pkt_info_void; + data_rate = pktinfo->data_rate & 0x7f; + + if (!fat_tab->get_stats) + return; + + if (fat_tab->antsel_rx_keep_0 == ANT1_2G) { + if (data_rate >= ODM_RATEMCS0 && + data_rate <= ODM_RATEMCS15) + fat_tab->main_ht_cnt[data_rate - ODM_RATEMCS0]++; + else if (data_rate >= ODM_RATEVHTSS1MCS0 && + data_rate <= ODM_RATEVHTSS2MCS9) + fat_tab->main_vht_cnt[data_rate - ODM_RATEVHTSS1MCS0]++; + } else { /*ANT2_2G*/ + if (data_rate >= ODM_RATEMCS0 && + data_rate <= ODM_RATEMCS15) + fat_tab->aux_ht_cnt[data_rate - ODM_RATEMCS0]++; + else if (data_rate >= ODM_RATEVHTSS1MCS0 && + data_rate <= ODM_RATEVHTSS2MCS9) + fat_tab->aux_vht_cnt[data_rate - ODM_RATEVHTSS1MCS0]++; + } +} + +void phydm_antdiv_reset_rx_rate(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + + odm_memory_set(dm, &fat_tab->main_ht_cnt[0], 0, HT_IDX * 2); + odm_memory_set(dm, &fat_tab->aux_ht_cnt[0], 0, HT_IDX * 2); + odm_memory_set(dm, &fat_tab->main_vht_cnt[0], 0, VHT_IDX * 2); + odm_memory_set(dm, &fat_tab->aux_vht_cnt[0], 0, VHT_IDX * 2); +} + +void phydm_statistics_evm_1ss(void *dm_void, void *phy_info_void, + u8 antsel_tr_mux, u32 id, u32 utility) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + struct phydm_phyinfo_struct *phy_info = NULL; + + phy_info = (struct phydm_phyinfo_struct *)phy_info_void; + if (antsel_tr_mux == ANT1_2G) { + fat_tab->main_evm_sum[id] += ((phy_info->rx_mimo_evm_dbm[0]) + << 5); + fat_tab->main_evm_cnt[id]++; + } else { + fat_tab->aux_evm_sum[id] += ((phy_info->rx_mimo_evm_dbm[0]) + << 5); + fat_tab->aux_evm_cnt[id]++; + } +} + +void phydm_statistics_evm_2ss(void *dm_void, void *phy_info_void, + u8 antsel_tr_mux, u32 id, u32 utility) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + struct phydm_phyinfo_struct *phy_info = NULL; + + phy_info = (struct phydm_phyinfo_struct *)phy_info_void; + if (antsel_tr_mux == ANT1_2G) { + fat_tab->main_evm_2ss_sum[id][0] += phy_info->rx_mimo_evm_dbm[0] + << 5; + fat_tab->main_evm_2ss_sum[id][1] += phy_info->rx_mimo_evm_dbm[1] + << 5; + fat_tab->main_evm_2ss_cnt[id]++; + + } else { + fat_tab->aux_evm_2ss_sum[id][0] += (phy_info->rx_mimo_evm_dbm[0] + << 5); + fat_tab->aux_evm_2ss_sum[id][1] += (phy_info->rx_mimo_evm_dbm[1] + << 5); + fat_tab->aux_evm_2ss_cnt[id]++; + } +} + +void phydm_evm_sw_antdiv_init(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + + /*@EVM enhance AntDiv method init----------------*/ + fat_tab->evm_method_enable = 0; + fat_tab->fat_state = NORMAL_STATE_MIAN; + fat_tab->fat_state_cnt = 0; + fat_tab->pre_antdiv_rssi = 0; + + dm->antdiv_intvl = 30; + dm->antdiv_delay = 20; + dm->antdiv_train_num = 4; + odm_set_bb_reg(dm, R_0x910, 0x3f, 0xf); + dm->antdiv_evm_en = 1; + /*@dm->antdiv_period=1;*/ +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + dm->evm_antdiv_period = 1; +#else + dm->evm_antdiv_period = 3; +#endif + dm->stop_antdiv_rssi_th = 3; + dm->stop_antdiv_tp_th = 80; + dm->antdiv_tp_period = 3; + dm->stop_antdiv_tp_diff_th = 5; +} + +void odm_evm_fast_ant_reset(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + + fat_tab->evm_method_enable = 0; + if (fat_tab->div_path_type == ANT_PATH_A) + odm_ant_div_on_off(dm, ANTDIV_ON, ANT_PATH_A); + else if (fat_tab->div_path_type == ANT_PATH_B) + odm_ant_div_on_off(dm, ANTDIV_ON, ANT_PATH_B); + else if (fat_tab->div_path_type == ANT_PATH_AB) + odm_ant_div_on_off(dm, ANTDIV_ON, ANT_PATH_AB); + fat_tab->fat_state = NORMAL_STATE_MIAN; + fat_tab->fat_state_cnt = 0; + dm->antdiv_period = 0; + odm_set_mac_reg(dm, R_0x608, BIT(8), 0); +} + +void odm_evm_enhance_ant_div(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)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 *fat_tab = &dm->dm_fat_table; + u32 value32, i, mac_id; + boolean main_above1 = false, aux_above1 = false; + boolean force_antenna = false; + struct cmn_sta_info *sta; + u32 main_tp_avg, aux_tp_avg; + u8 curr_rssi, rssi_diff; + u32 tp_diff, tp_diff_avg; + u16 main_max_cnt = 0, aux_max_cnt = 0; + u16 main_max_idx = 0, aux_max_idx = 0; + u16 main_cnt_all = 0, aux_cnt_all = 0; + u8 rate_num = dm->num_rf_path; + u8 rate_ss_shift = 0; + 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; + + fat_tab->target_ant_enhance = 0xFF; + + if ((dm->support_ic_type & ODM_EVM_ANTDIV_IC)) { + if (dm->is_one_entry_only) { +#if 0 + /* PHYDM_DBG(dm,DBG_ANT_DIV, "[One Client only]\n"); */ +#endif + mac_id = dm->one_entry_macid; + sta = dm->phydm_sta_info[mac_id]; + + main_rssi = (fat_tab->main_cnt[mac_id] != 0) ? (fat_tab->main_sum[mac_id] / fat_tab->main_cnt[mac_id]) : 0; + aux_rssi = (fat_tab->aux_cnt[mac_id] != 0) ? (fat_tab->aux_sum[mac_id] / fat_tab->aux_cnt[mac_id]) : 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; @@ -1940,89 +2520,159 @@ odm_evm_enhance_ant_div( else rssi_larger_ant = AUX_ANT; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" Main_Cnt = (( %d )) , main_rssi= (( %d ))\n", p_dm_fat_table->main_ant_cnt[i], main_rssi)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" Aux_Cnt = (( %d )) , aux_rssi = (( %d ))\n", p_dm_fat_table->aux_ant_cnt[i], aux_rssi)); + PHYDM_DBG(dm, DBG_ANT_DIV, + "Main_Cnt=(( %d )), main_rssi=(( %d ))\n", + fat_tab->main_cnt[mac_id], main_rssi); + PHYDM_DBG(dm, DBG_ANT_DIV, + "Aux_Cnt=(( %d )), aux_rssi=(( %d ))\n", + fat_tab->aux_cnt[mac_id], 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) */ - ) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[> TH_H || EVM_method_enable==1] && ")); + if (((main_rssi >= evm_rssi_th_high || aux_rssi >= evm_rssi_th_high) || fat_tab->evm_method_enable == 1) + /* @&& (diff_rssi <= FORCE_RSSI_DIFF + 1) */ + ) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "> TH_H || evm_method_enable==1\n"); - if (((main_rssi >= evm_rssi_th_low) || (aux_rssi >= evm_rssi_th_low))) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[> TH_L ]\n")); + if ((main_rssi >= evm_rssi_th_low || aux_rssi >= evm_rssi_th_low)) { + PHYDM_DBG(dm, DBG_ANT_DIV, "> TH_L, fat_state_cnt =((%d))\n", fat_tab->fat_state_cnt); - /* 2 [ Normal state Main] */ - if (p_dm_fat_table->fat_state == NORMAL_STATE_MIAN) { + /*Traning state: 0(alt) 1(ori) 2(alt) 3(ori)============================================================*/ + if (fat_tab->fat_state_cnt < (dm->antdiv_train_num << 1)) { + if (fat_tab->fat_state_cnt == 0) { + /*Reset EVM 1SS Method */ + fat_tab->main_evm_sum[mac_id] = 0; + fat_tab->aux_evm_sum[mac_id] = 0; + fat_tab->main_evm_cnt[mac_id] = 0; + fat_tab->aux_evm_cnt[mac_id] = 0; + /*Reset EVM 2SS Method */ + fat_tab->main_evm_2ss_sum[mac_id][0] = 0; + fat_tab->main_evm_2ss_sum[mac_id][1] = 0; + fat_tab->aux_evm_2ss_sum[mac_id][0] = 0; + fat_tab->aux_evm_2ss_sum[mac_id][1] = 0; + fat_tab->main_evm_2ss_cnt[mac_id] = 0; + fat_tab->aux_evm_2ss_cnt[mac_id] = 0; - p_dm_fat_table->EVM_method_enable = 1; - odm_ant_div_on_off(p_dm_odm, ANTDIV_OFF); - p_dm_odm->antdiv_period = p_dm_odm->evm_antdiv_period; + /*Reset TP Method */ + fat_tab->main_tp = 0; + fat_tab->aux_tp = 0; + fat_tab->main_tp_cnt = 0; + fat_tab->aux_tp_cnt = 0; + phydm_antdiv_reset_rx_rate(dm); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ start training: MIAN]\n")); - 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 CRC Method */ + fat_tab->main_crc32_ok_cnt = 0; + fat_tab->main_crc32_fail_cnt = 0; + fat_tab->aux_crc32_ok_cnt = 0; + fat_tab->aux_crc32_fail_cnt = 0; - p_dm_fat_table->fat_state = NORMAL_STATE_AUX; - odm_set_mac_reg(p_dm_odm, 0x608, BIT(8), 1); /* Accept CRC32 Error packets. */ - odm_update_rx_idle_ant(p_dm_odm, MAIN_ANT); +#ifdef SKIP_EVM_ANTDIV_TRAINING_PATCH + if ((*dm->band_width == CHANNEL_WIDTH_20) && sta->mimo_type == RF_2T2R) { + /*@1. Skip training: RSSI*/ +#if 0 + /*PHYDM_DBG(pDM_Odm,DBG_ANT_DIV, "TargetAnt_enhance=((%d)), RxIdleAnt=((%d))\n", pDM_FatTable->TargetAnt_enhance, pDM_FatTable->RxIdleAnt);*/ +#endif + curr_rssi = (u8)((fat_tab->rx_idle_ant == MAIN_ANT) ? main_rssi : aux_rssi); + rssi_diff = (curr_rssi > fat_tab->pre_antdiv_rssi) ? (curr_rssi - fat_tab->pre_antdiv_rssi) : (fat_tab->pre_antdiv_rssi - curr_rssi); - p_dm_fat_table->crc32_ok_cnt = 0; - p_dm_fat_table->crc32_fail_cnt = 0; - odm_set_timer(p_dm_odm, &p_dm_odm->evm_fast_ant_training_timer, p_dm_odm->antdiv_intvl); /* m */ + PHYDM_DBG(dm, DBG_ANT_DIV, "[1] rssi_return, curr_rssi=((%d)), pre_rssi=((%d))\n", curr_rssi, fat_tab->pre_antdiv_rssi); + + fat_tab->pre_antdiv_rssi = curr_rssi; + if (rssi_diff < dm->stop_antdiv_rssi_th && curr_rssi != 0) + rssi_return = 1; + + /*@2. Skip training: TP Diff*/ + tp_diff = (dm->rx_tp > fat_tab->pre_antdiv_tp) ? (dm->rx_tp - fat_tab->pre_antdiv_tp) : (fat_tab->pre_antdiv_tp - dm->rx_tp); + + PHYDM_DBG(dm, DBG_ANT_DIV, "[2] tp_diff_return, curr_tp=((%d)), pre_tp=((%d))\n", dm->rx_tp, fat_tab->pre_antdiv_tp); + fat_tab->pre_antdiv_tp = dm->rx_tp; + if ((tp_diff < (u32)(dm->stop_antdiv_tp_diff_th) && dm->rx_tp != 0)) + tp_diff_return = 1; + + PHYDM_DBG(dm, DBG_ANT_DIV, "[3] tp_return, curr_rx_tp=((%d))\n", dm->rx_tp); + /*@3. Skip training: TP*/ + if (dm->rx_tp >= (u32)(dm->stop_antdiv_tp_th)) + tp_return = 1; + + PHYDM_DBG(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(dm, DBG_ANT_DIV, "***Return EVM SW AntDiv\n"); + return; + } + } + } +#endif + + fat_tab->evm_method_enable = 1; + if (fat_tab->div_path_type == ANT_PATH_A) + odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_A); + else if (fat_tab->div_path_type == ANT_PATH_B) + odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_B); + else if (fat_tab->div_path_type == ANT_PATH_AB) + odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_AB); + dm->antdiv_period = dm->evm_antdiv_period; + odm_set_mac_reg(dm, R_0x608, BIT(8), 1); /*RCR accepts CRC32-Error packets*/ + fat_tab->fat_state_cnt++; + fat_tab->get_stats = false; + next_ant = (fat_tab->rx_idle_ant == MAIN_ANT) ? MAIN_ANT : AUX_ANT; + odm_update_rx_idle_ant(dm, next_ant); + PHYDM_DBG(dm, DBG_ANT_DIV, "[Antdiv Delay ]\n"); + odm_set_timer(dm, &dm->evm_fast_ant_training_timer, dm->antdiv_delay); //ms + } else if ((fat_tab->fat_state_cnt % 2) != 0) { + fat_tab->fat_state_cnt++; + fat_tab->get_stats = true; + odm_set_timer(dm, &dm->evm_fast_ant_training_timer, dm->antdiv_intvl); //ms + } else if ((fat_tab->fat_state_cnt % 2) == 0) { + fat_tab->fat_state_cnt++; + fat_tab->get_stats = false; + next_ant = (fat_tab->rx_idle_ant == MAIN_ANT) ? AUX_ANT : MAIN_ANT; + odm_update_rx_idle_ant(dm, next_ant); + PHYDM_DBG(dm, DBG_ANT_DIV, "[Antdiv Delay ]\n"); + odm_set_timer(dm, &dm->evm_fast_ant_training_timer, dm->antdiv_delay); //ms + } } - /* 2 [ Normal state Aux ] */ - else if (p_dm_fat_table->fat_state == NORMAL_STATE_AUX) { - p_dm_fat_table->main_crc32_ok_cnt = p_dm_fat_table->crc32_ok_cnt; - p_dm_fat_table->main_crc32_fail_cnt = p_dm_fat_table->crc32_fail_cnt; + /*@Decision state: 4==============================================================*/ + else { + fat_tab->get_stats = false; + fat_tab->fat_state_cnt = 0; + PHYDM_DBG(dm, DBG_ANT_DIV, "[Decisoin state ]\n"); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ start training: AUX]\n")); - p_dm_fat_table->fat_state = TRAINING_STATE; - odm_update_rx_idle_ant(p_dm_odm, AUX_ANT); - - p_dm_fat_table->crc32_ok_cnt = 0; - p_dm_fat_table->crc32_fail_cnt = 0; - odm_set_timer(p_dm_odm, &p_dm_odm->evm_fast_ant_training_timer, p_dm_odm->antdiv_intvl); /* ms */ - } else if (p_dm_fat_table->fat_state == TRAINING_STATE) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Training state ]\n")); - p_dm_fat_table->fat_state = NORMAL_STATE_MIAN; - - /* 3 [CRC32 statistic] */ - p_dm_fat_table->aux_crc32_ok_cnt = p_dm_fat_table->crc32_ok_cnt; - p_dm_fat_table->aux_crc32_fail_cnt = p_dm_fat_table->crc32_fail_cnt; - - if ((p_dm_fat_table->main_crc32_ok_cnt > ((p_dm_fat_table->aux_crc32_ok_cnt) << 1)) || ((diff_rssi >= 20) && (rssi_larger_ant == MAIN_ANT))) { - p_dm_fat_table->target_ant_crc32 = MAIN_ANT; +/* @3 [CRC32 statistic] */ +#if 0 + if ((fat_tab->main_crc32_ok_cnt > (fat_tab->aux_crc32_ok_cnt << 1)) || (diff_rssi >= 40 && rssi_larger_ant == MAIN_ANT)) { + fat_tab->target_ant_crc32 = MAIN_ANT; force_antenna = true; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("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 >= 20) && (rssi_larger_ant == AUX_ANT))) { - p_dm_fat_table->target_ant_crc32 = AUX_ANT; + PHYDM_DBG(dm, DBG_ANT_DIV, "CRC32 Force Main\n"); + } else if ((fat_tab->aux_crc32_ok_cnt > ((fat_tab->main_crc32_ok_cnt) << 1)) || ((diff_rssi >= 40) && (rssi_larger_ant == AUX_ANT))) { + fat_tab->target_ant_crc32 = AUX_ANT; force_antenna = true; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("CRC32 Force Aux\n")); - } else { - if (p_dm_fat_table->main_crc32_fail_cnt <= 5) - p_dm_fat_table->main_crc32_fail_cnt = 5; + PHYDM_DBG(dm, DBG_ANT_DIV, "CRC32 Force Aux\n"); + } else +#endif + { + if (fat_tab->main_crc32_fail_cnt <= 5) + fat_tab->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 (fat_tab->aux_crc32_fail_cnt <= 5) + fat_tab->aux_crc32_fail_cnt = 5; - if (p_dm_fat_table->main_crc32_ok_cnt > p_dm_fat_table->main_crc32_fail_cnt) + if (fat_tab->main_crc32_ok_cnt > fat_tab->main_crc32_fail_cnt) main_above1 = true; - if (p_dm_fat_table->aux_crc32_ok_cnt > p_dm_fat_table->aux_crc32_fail_cnt) + if (fat_tab->aux_crc32_ok_cnt > fat_tab->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; + fat_tab->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; + fat_tab->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); + main_crc_utility = ((fat_tab->main_crc32_ok_cnt) << 7) / fat_tab->main_crc32_fail_cnt; + aux_crc_utility = ((fat_tab->aux_crc32_ok_cnt) << 7) / fat_tab->aux_crc32_fail_cnt; + fat_tab->target_ant_crc32 = (main_crc_utility == aux_crc_utility) ? (fat_tab->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) @@ -2031,14 +2681,14 @@ odm_evm_enhance_ant_div( 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; + if (fat_tab->main_crc32_ok_cnt == 0) + fat_tab->main_crc32_ok_cnt = 1; + if (fat_tab->aux_crc32_ok_cnt == 0) + fat_tab->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); + main_crc_utility = ((fat_tab->main_crc32_fail_cnt) << 7) / fat_tab->main_crc32_ok_cnt; + aux_crc_utility = ((fat_tab->aux_crc32_fail_cnt) << 7) / fat_tab->aux_crc32_ok_cnt; + fat_tab->target_ant_crc32 = (main_crc_utility == aux_crc_utility) ? (fat_tab->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) @@ -2048,2752 +2698,2705 @@ odm_evm_enhance_ant_div( } } } - odm_set_mac_reg(p_dm_odm, 0x608, BIT(8), 0);/* NOT Accept CRC32 Error packets. */ + odm_set_mac_reg(dm, R_0x608, BIT(8), 0); /* NOT Accept CRC32 Error packets. */ + PHYDM_DBG(dm, DBG_ANT_DIV, "MAIN_CRC: Ok=((%d)), Fail = ((%d)), Utility = ((%d))\n", fat_tab->main_crc32_ok_cnt, fat_tab->main_crc32_fail_cnt, main_crc_utility); + PHYDM_DBG(dm, DBG_ANT_DIV, "AUX__CRC: Ok=((%d)), Fail = ((%d)), Utility = ((%d))\n", fat_tab->aux_crc32_ok_cnt, fat_tab->aux_crc32_fail_cnt, aux_crc_utility); + PHYDM_DBG(dm, DBG_ANT_DIV, "***1.TargetAnt_CRC32 = ((%s))\n", (fat_tab->target_ant_crc32 == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT"); - /* 3 [EVM statistic] */ - main_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_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; - p_dm_fat_table->target_ant_evm = (main_evm == aux_evm) ? (p_dm_fat_table->pre_target_ant_enhance) : ((main_evm >= aux_evm) ? MAIN_ANT : AUX_ANT); + for (i = 0; i < HT_IDX; i++) { + main_cnt_all += fat_tab->main_ht_cnt[i]; + aux_cnt_all += fat_tab->aux_ht_cnt[i]; + + if (fat_tab->main_ht_cnt[i] > main_max_cnt) { + main_max_cnt = fat_tab->main_ht_cnt[i]; + main_max_idx = i; + } + + if (fat_tab->aux_ht_cnt[i] > aux_max_cnt) { + aux_max_cnt = fat_tab->aux_ht_cnt[i]; + aux_max_idx = i; + } + } + + for (i = 0; i < rate_num; i++) { + rate_ss_shift = (i << 3); + PHYDM_DBG(dm, DBG_ANT_DIV, "*main_ht_cnt HT MCS[%d :%d ] = {%d, %d, %d, %d, %d, %d, %d, %d}\n", + (rate_ss_shift), (rate_ss_shift + 7), + fat_tab->main_ht_cnt[rate_ss_shift + 0], fat_tab->main_ht_cnt[rate_ss_shift + 1], + fat_tab->main_ht_cnt[rate_ss_shift + 2], fat_tab->main_ht_cnt[rate_ss_shift + 3], + fat_tab->main_ht_cnt[rate_ss_shift + 4], fat_tab->main_ht_cnt[rate_ss_shift + 5], + fat_tab->main_ht_cnt[rate_ss_shift + 6], fat_tab->main_ht_cnt[rate_ss_shift + 7]); + } + + for (i = 0; i < rate_num; i++) { + rate_ss_shift = (i << 3); + PHYDM_DBG(dm, DBG_ANT_DIV, "*aux_ht_cnt HT MCS[%d :%d ] = {%d, %d, %d, %d, %d, %d, %d, %d}\n", + (rate_ss_shift), (rate_ss_shift + 7), + fat_tab->aux_ht_cnt[rate_ss_shift + 0], fat_tab->aux_ht_cnt[rate_ss_shift + 1], + fat_tab->aux_ht_cnt[rate_ss_shift + 2], fat_tab->aux_ht_cnt[rate_ss_shift + 3], + fat_tab->aux_ht_cnt[rate_ss_shift + 4], fat_tab->aux_ht_cnt[rate_ss_shift + 5], + fat_tab->aux_ht_cnt[rate_ss_shift + 6], fat_tab->aux_ht_cnt[rate_ss_shift + 7]); + } + + /* @3 [EVM statistic] */ + /*@1SS EVM*/ + main_1ss_evm = (fat_tab->main_evm_cnt[mac_id] != 0) ? (fat_tab->main_evm_sum[mac_id] / fat_tab->main_evm_cnt[mac_id]) : 0; + aux_1ss_evm = (fat_tab->aux_evm_cnt[mac_id] != 0) ? (fat_tab->aux_evm_sum[mac_id] / fat_tab->aux_evm_cnt[mac_id]) : 0; + target_ant_evm_1ss = (main_1ss_evm == aux_1ss_evm) ? (fat_tab->pre_target_ant_enhance) : ((main_1ss_evm >= aux_1ss_evm) ? MAIN_ANT : AUX_ANT); + + PHYDM_DBG(dm, DBG_ANT_DIV, "Cnt = ((%d)), Main1ss_EVM= (( %d ))\n", fat_tab->main_evm_cnt[mac_id], main_1ss_evm); + PHYDM_DBG(dm, DBG_ANT_DIV, "Cnt = ((%d)), Aux_1ss_EVM = (( %d ))\n", fat_tab->aux_evm_cnt[mac_id], aux_1ss_evm); + + /*@2SS EVM*/ + main_2ss_evm[0] = (fat_tab->main_evm_2ss_cnt[mac_id] != 0) ? (fat_tab->main_evm_2ss_sum[mac_id][0] / fat_tab->main_evm_2ss_cnt[mac_id]) : 0; + main_2ss_evm[1] = (fat_tab->main_evm_2ss_cnt[mac_id] != 0) ? (fat_tab->main_evm_2ss_sum[mac_id][1] / fat_tab->main_evm_2ss_cnt[mac_id]) : 0; + main_2ss_evm_sum = main_2ss_evm[0] + main_2ss_evm[1]; + + aux_2ss_evm[0] = (fat_tab->aux_evm_2ss_cnt[mac_id] != 0) ? (fat_tab->aux_evm_2ss_sum[mac_id][0] / fat_tab->aux_evm_2ss_cnt[mac_id]) : 0; + aux_2ss_evm[1] = (fat_tab->aux_evm_2ss_cnt[mac_id] != 0) ? (fat_tab->aux_evm_2ss_sum[mac_id][1] / fat_tab->aux_evm_2ss_cnt[mac_id]) : 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) ? (fat_tab->pre_target_ant_enhance) : ((main_2ss_evm_sum >= aux_2ss_evm_sum) ? MAIN_ANT : AUX_ANT); + + PHYDM_DBG(dm, DBG_ANT_DIV, "Cnt = ((%d)), Main2ss_EVM{A,B,Sum} = {%d, %d, %d}\n", + fat_tab->main_evm_2ss_cnt[mac_id], main_2ss_evm[0], main_2ss_evm[1], main_2ss_evm_sum); + PHYDM_DBG(dm, DBG_ANT_DIV, "Cnt = ((%d)), Aux_2ss_EVM{A,B,Sum} = {%d, %d, %d}\n", + fat_tab->aux_evm_2ss_cnt[mac_id], 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; + fat_tab->target_ant_evm = target_ant_evm_2ss; + } else { + decision_evm_ss = 1; + main_evm = main_1ss_evm; + aux_evm = aux_1ss_evm; + fat_tab->target_ant_evm = target_ant_evm_1ss; + } if ((main_evm == 0 || aux_evm == 0)) - diff_EVM = 0; + diff_EVM = 100; else if (main_evm >= aux_evm) diff_EVM = main_evm - aux_evm; else diff_EVM = aux_evm - main_evm; - /* 2 [ Decision state ] */ - if (p_dm_fat_table->target_ant_evm == p_dm_fat_table->target_ant_crc32) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Decision type 1, CRC_utility = ((%d)), EVM_diff = ((%d))\n", utility_ratio, diff_EVM)); + PHYDM_DBG(dm, DBG_ANT_DIV, "***2.TargetAnt_EVM((%d-ss)) = ((%s))\n", decision_evm_ss, (fat_tab->target_ant_evm == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT"); + + //3 [TP statistic] + main_tp_avg = (fat_tab->main_tp_cnt != 0) ? (fat_tab->main_tp / fat_tab->main_tp_cnt) : 0; + aux_tp_avg = (fat_tab->aux_tp_cnt != 0) ? (fat_tab->aux_tp / fat_tab->aux_tp_cnt) : 0; + tp_diff_avg = DIFF_2(main_tp_avg, aux_tp_avg); + fat_tab->target_ant_tp = (tp_diff_avg < 100) ? (fat_tab->pre_target_ant_enhance) : ((main_tp_avg >= aux_tp_avg) ? MAIN_ANT : AUX_ANT); + + PHYDM_DBG(dm, DBG_ANT_DIV, "Cnt = ((%d)), Main_TP = ((%d))\n", fat_tab->main_tp_cnt, main_tp_avg); + PHYDM_DBG(dm, DBG_ANT_DIV, "Cnt = ((%d)), Aux_TP = ((%d))\n", fat_tab->aux_tp_cnt, aux_tp_avg); + PHYDM_DBG(dm, DBG_ANT_DIV, "***3.TargetAnt_TP = ((%s))\n", (fat_tab->target_ant_tp == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT"); + + /*Reset TP Method */ + fat_tab->main_tp = 0; + fat_tab->aux_tp = 0; + fat_tab->main_tp_cnt = 0; + fat_tab->aux_tp_cnt = 0; + + /* @2 [ Decision state ] */ + #if 1 + if (main_max_idx == aux_max_idx && ((main_cnt_all + aux_cnt_all) != 0)) { + PHYDM_DBG(dm, DBG_ANT_DIV, "Decision EVM, main_max_idx = ((MCS%d)), aux_max_idx = ((MCS%d))\n", main_max_idx, aux_max_idx); + fat_tab->target_ant_enhance = fat_tab->target_ant_evm; + } else { + PHYDM_DBG(dm, DBG_ANT_DIV, "Decision TP, main_max_idx = ((MCS%d)), aux_max_idx = ((MCS%d))\n", main_max_idx, aux_max_idx); + fat_tab->target_ant_enhance = fat_tab->target_ant_tp; + } + #else + if (fat_tab->target_ant_evm == fat_tab->target_ant_crc32) { + PHYDM_DBG(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; + fat_tab->target_ant_enhance = fat_tab->pre_target_ant_enhance; else - p_dm_fat_table->target_ant_enhance = p_dm_fat_table->target_ant_evm; - } else if ((diff_EVM <= 50 && (utility_ratio > 4 && force_antenna == false)) || (force_antenna == true)) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("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; - } else if (diff_EVM >= 100) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("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; + fat_tab->target_ant_enhance = fat_tab->target_ant_evm; + } + #if 0 + else if ((diff_EVM <= 50 && (utility_ratio > 4 && force_antenna == false)) || (force_antenna == true)) { + PHYDM_DBG(dm, DBG_ANT_DIV, "Decision type 2, CRC_utility = ((%d)), EVM_diff = ((%d))\n", utility_ratio, diff_EVM); + fat_tab->target_ant_enhance = fat_tab->target_ant_crc32; + } + #endif + else if (diff_EVM >= 20) { + PHYDM_DBG(dm, DBG_ANT_DIV, "Decision type 3, CRC_utility = ((%d)), EVM_diff = ((%d))\n", utility_ratio, diff_EVM); + fat_tab->target_ant_enhance = fat_tab->target_ant_evm; } else if (utility_ratio >= 6 && force_antenna == false) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("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; + PHYDM_DBG(dm, DBG_ANT_DIV, "Decision type 4, CRC_utility = ((%d)), EVM_diff = ((%d))\n", utility_ratio, diff_EVM); + fat_tab->target_ant_enhance = fat_tab->target_ant_crc32; } else { - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Decision type 5, CRC_utility = ((%d)), EVM_diff = ((%d))\n", utility_ratio, diff_EVM)); + PHYDM_DBG(dm, DBG_ANT_DIV, "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*/ + 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 >= 100) + if (diff_EVM >= 15) + score_EVM = 3; + else if (diff_EVM >= 10) score_EVM = 2; - else if (diff_EVM >= 50) + 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; + fat_tab->target_ant_enhance = fat_tab->target_ant_crc32; else if (score_CRC < score_EVM) - p_dm_fat_table->target_ant_enhance = p_dm_fat_table->target_ant_evm; + fat_tab->target_ant_enhance = fat_tab->target_ant_evm; else - p_dm_fat_table->target_ant_enhance = p_dm_fat_table->pre_target_ant_enhance; + fat_tab->target_ant_enhance = fat_tab->pre_target_ant_enhance; } - p_dm_fat_table->pre_target_ant_enhance = p_dm_fat_table->target_ant_enhance; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : MainEVM_Cnt = (( %d )) , main_evm= (( %d ))\n", i, p_dm_fat_table->main_ant_evm_cnt[i], main_evm)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : AuxEVM_Cnt = (( %d )) , aux_evm = (( %d ))\n", i, p_dm_fat_table->aux_ant_evm_cnt[i], aux_evm)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** target_ant_evm = (( %s ))\n", (p_dm_fat_table->target_ant_evm == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT")); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("M_CRC_Ok = (( %d )) , M_CRC_Fail = (( %d )), main_crc_utility = (( %d ))\n", p_dm_fat_table->main_crc32_ok_cnt, p_dm_fat_table->main_crc32_fail_cnt, main_crc_utility)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("A_CRC_Ok = (( %d )) , A_CRC_Fail = (( %d )), aux_crc_utility = (( %d ))\n", p_dm_fat_table->aux_crc32_ok_cnt, p_dm_fat_table->aux_crc32_fail_cnt, aux_crc_utility)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** target_ant_crc32 = (( %s ))\n", (p_dm_fat_table->target_ant_crc32 == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT")); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("****** target_ant_enhance = (( %s ))******\n", (p_dm_fat_table->target_ant_enhance == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT")); - + #endif + fat_tab->pre_target_ant_enhance = fat_tab->target_ant_enhance; + PHYDM_DBG(dm, DBG_ANT_DIV, "*** 4.TargetAnt_enhance = (( %s ))******\n", (fat_tab->target_ant_enhance == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT"); } } else { /* RSSI< = evm_rssi_th_low */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ TH_L ]\n")); - odm_evm_fast_ant_reset(p_dm_odm); + PHYDM_DBG(dm, DBG_ANT_DIV, "[ TH_L ]\n"); + odm_evm_fast_ant_reset(dm); } } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[escape from> TH_H || EVM_method_enable==1]\n")); - odm_evm_fast_ant_reset(p_dm_odm); + PHYDM_DBG(dm, DBG_ANT_DIV, + "[escape from> TH_H || evm_method_enable==1]\n"); + odm_evm_fast_ant_reset(dm); } } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[multi-Client]\n")); - odm_evm_fast_ant_reset(p_dm_odm); + PHYDM_DBG(dm, DBG_ANT_DIV, "[multi-Client]\n"); + odm_evm_fast_ant_reset(dm); } } } -void -odm_evm_fast_ant_training_callback( - void *p_dm_void -) +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +void phydm_evm_antdiv_callback( + struct phydm_timer_list *timer) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("******odm_evm_fast_ant_training_callback******\n")); - odm_hw_ant_div(p_dm_odm); + void *adapter = (void *)timer->Adapter; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + struct dm_struct *dm = &hal_data->DM_OutSrc; + + #if DEV_BUS_TYPE == RT_PCI_INTERFACE + #if USE_WORKITEM + odm_schedule_work_item(&dm->phydm_evm_antdiv_workitem); + #else + { + odm_hw_ant_div(dm); + } + #endif + #else + odm_schedule_work_item(&dm->phydm_evm_antdiv_workitem); + #endif +} + +void phydm_evm_antdiv_workitem_callback( + void *context) +{ + void *adapter = (void *)context; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + struct dm_struct *dm = &hal_data->DM_OutSrc; + + odm_hw_ant_div(dm); +} + +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) +void phydm_evm_antdiv_callback(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + void *padapter = dm->adapter; + + if (*dm->is_net_closed) + return; + if (dm->support_interface == ODM_ITRF_PCIE) { + odm_hw_ant_div(dm); + } else { + /* @Can't do I/O in timer callback*/ + phydm_run_in_thread_cmd(dm, + phydm_evm_antdiv_workitem_callback, + padapter); + } +} + +void phydm_evm_antdiv_workitem_callback(void *context) +{ + void *adapter = (void *)context; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + struct dm_struct *dm = &hal_data->odmpriv; + + odm_hw_ant_div(dm); +} + +#else +void phydm_evm_antdiv_callback( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + PHYDM_DBG(dm, DBG_ANT_DIV, "******AntDiv_Callback******\n"); + odm_hw_ant_div(dm); } #endif -void -odm_hw_ant_div( - void *p_dm_void -) +#endif + +void odm_hw_ant_div(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (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 _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; - u8 rx_idle_ant = p_dm_fat_table->rx_idle_ant, target_ant = 7; - struct _dynamic_initial_gain_threshold_ *p_dm_dig_table = &p_dm_odm->dm_dig_table; - struct sta_info *p_entry; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 i, min_max_rssi = 0xFF, ant_div_max_rssi = 0, max_rssi = 0; + u32 main_rssi, aux_rssi, mian_cnt, aux_cnt, local_max_rssi; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + u8 rx_idle_ant = fat_tab->rx_idle_ant, target_ant = 7; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + struct cmn_sta_info *sta; -#if (BEAMFORMING_SUPPORT == 1) +#ifdef PHYDM_BEAMFORMING_SUPPORT #if (DM_ODM_SUPPORT_TYPE == ODM_AP) - struct _BF_DIV_COEX_ *p_dm_bdc_table = &p_dm_odm->dm_bdc_table; - u32 TH1 = 500000; - u32 TH2 = 10000000; - u32 ma_rx_temp, degrade_TP_temp, improve_TP_temp; - u8 monitor_rssi_threshold = 30; + struct _BF_DIV_COEX_ *dm_bdc_table = &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; + dm_bdc_table->BF_pass = true; + dm_bdc_table->DIV_pass = true; + dm_bdc_table->is_all_div_sta_idle = true; + dm_bdc_table->is_all_bf_sta_idle = true; + dm_bdc_table->num_bf_tar = 0; + dm_bdc_table->num_div_tar = 0; + dm_bdc_table->num_client = 0; #endif #endif - if (!p_dm_odm->is_linked) { /* is_linked==False */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[No Link!!!]\n")); + if (!dm->is_linked) { /* @is_linked==False */ + PHYDM_DBG(dm, DBG_ANT_DIV, "[No Link!!!]\n"); - if (p_dm_fat_table->is_become_linked == true) { - odm_ant_div_on_off(p_dm_odm, ANTDIV_OFF); - odm_update_rx_idle_ant(p_dm_odm, MAIN_ANT); - odm_tx_by_tx_desc_or_reg(p_dm_odm, TX_BY_REG); - p_dm_odm->antdiv_period = 0; + if (fat_tab->is_become_linked) { + if (fat_tab->div_path_type == ANT_PATH_A) + odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_A); + else if (fat_tab->div_path_type == ANT_PATH_B) + odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_B); + else if (fat_tab->div_path_type == ANT_PATH_AB) + odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_AB); + odm_update_rx_idle_ant(dm, MAIN_ANT); + odm_tx_by_tx_desc_or_reg(dm, TX_BY_REG); + dm->antdiv_period = 0; - p_dm_fat_table->is_become_linked = p_dm_odm->is_linked; + fat_tab->is_become_linked = dm->is_linked; } return; } else { - if (p_dm_fat_table->is_become_linked == false) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Linked !!!]\n")); - odm_ant_div_on_off(p_dm_odm, ANTDIV_ON); - /*odm_tx_by_tx_desc_or_reg(p_dm_odm, TX_BY_DESC);*/ + if (!fat_tab->is_become_linked) { + PHYDM_DBG(dm, DBG_ANT_DIV, "[Linked !!!]\n"); + if (fat_tab->div_path_type == ANT_PATH_A) + odm_ant_div_on_off(dm, ANTDIV_ON, ANT_PATH_A); + else if (fat_tab->div_path_type == ANT_PATH_B) + odm_ant_div_on_off(dm, ANTDIV_ON, ANT_PATH_B); + else if (fat_tab->div_path_type == ANT_PATH_AB) + odm_ant_div_on_off(dm, ANTDIV_ON, ANT_PATH_AB); + #if 0 + /*odm_tx_by_tx_desc_or_reg(dm, TX_BY_DESC);*/ - /* if(p_dm_odm->support_ic_type == ODM_RTL8821 ) */ - /* odm_set_bb_reg(p_dm_odm, 0x800, BIT(25), 0); */ /* CCK AntDiv function disable */ + /* @if(dm->support_ic_type == ODM_RTL8821 ) */ + /* odm_set_bb_reg(dm, R_0x800, BIT(25), 0); */ + /* CCK AntDiv function disable */ - /* #if(DM_ODM_SUPPORT_TYPE == ODM_AP) */ - /* else if(p_dm_odm->support_ic_type == ODM_RTL8881A) */ - /* odm_set_bb_reg(p_dm_odm, 0x800, BIT(25), 0); */ /* CCK AntDiv function disable */ - /* #endif */ + /* @#if(DM_ODM_SUPPORT_TYPE == ODM_AP) */ + /* @else if(dm->support_ic_type == ODM_RTL8881A) */ + /* odm_set_bb_reg(dm, R_0x800, BIT(25), 0); */ + /* CCK AntDiv function disable */ + /* @#endif */ - /* else if(p_dm_odm->support_ic_type == ODM_RTL8723B ||p_dm_odm->support_ic_type == ODM_RTL8812) */ - /* odm_set_bb_reg(p_dm_odm, 0xA00, BIT(15), 0); */ /* CCK AntDiv function disable */ + /* @else if(dm->support_ic_type == ODM_RTL8723B ||*/ + /* @dm->support_ic_type == ODM_RTL8812) */ + /* odm_set_bb_reg(dm, R_0xa00, BIT(15), 0); */ + /* CCK AntDiv function disable */ + #endif - p_dm_fat_table->is_become_linked = p_dm_odm->is_linked; + fat_tab->is_become_linked = dm->is_linked; - if (p_dm_odm->support_ic_type == ODM_RTL8723B && p_dm_odm->ant_div_type == CG_TRX_HW_ANTDIV) { - odm_set_bb_reg(p_dm_odm, 0x930, 0xF0, 8); /* DPDT_P = ANTSEL[0] */ /* for 8723B AntDiv function patch. BB Dino 130412 */ - odm_set_bb_reg(p_dm_odm, 0x930, 0xF, 8); /* DPDT_N = ANTSEL[0] */ + if (dm->support_ic_type == ODM_RTL8723B && + dm->ant_div_type == CG_TRX_HW_ANTDIV) { + odm_set_bb_reg(dm, R_0x930, 0xF0, 8); + /* @DPDT_P = ANTSEL[0] for 8723B AntDiv */ + odm_set_bb_reg(dm, R_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_odm); -#endif -#endif + /* @ BDC Init */ + #ifdef PHYDM_BEAMFORMING_SUPPORT + #if (DM_ODM_SUPPORT_TYPE == ODM_AP) + odm_bdc_init(dm); + #endif + #endif -#ifdef ODM_EVM_ENHANCE_ANTDIV - odm_evm_fast_ant_reset(p_dm_odm); -#endif + #ifdef ODM_EVM_ENHANCE_ANTDIV + odm_evm_fast_ant_reset(dm); + #endif } } - if (*(p_dm_fat_table->p_force_tx_ant_by_desc) == false) { - if (p_dm_odm->is_one_entry_only == true) - odm_tx_by_tx_desc_or_reg(p_dm_odm, TX_BY_REG); + if (!(*fat_tab->p_force_tx_by_desc)) { + if (dm->is_one_entry_only) + odm_tx_by_tx_desc_or_reg(dm, TX_BY_REG); else - odm_tx_by_tx_desc_or_reg(p_dm_odm, TX_BY_DESC); + odm_tx_by_tx_desc_or_reg(dm, TX_BY_DESC); } #ifdef ODM_EVM_ENHANCE_ANTDIV - if (p_dm_odm->antdiv_evm_en == 1) { - odm_evm_enhance_ant_div(p_dm_odm); - if (p_dm_fat_table->fat_state != NORMAL_STATE_MIAN) + if (dm->antdiv_evm_en == 1) { + odm_evm_enhance_ant_div(dm); + if (fat_tab->fat_state_cnt != 0) return; } else - odm_evm_fast_ant_reset(p_dm_odm); + odm_evm_fast_ant_reset(dm); #endif - /* 2 BDC mode Arbitration */ -#if (BEAMFORMING_SUPPORT == 1) +/* @2 BDC mode Arbitration */ +#ifdef PHYDM_BEAMFORMING_SUPPORT #if (DM_ODM_SUPPORT_TYPE == ODM_AP) - if (p_dm_odm->antdiv_evm_en == 0 || p_dm_fat_table->EVM_method_enable == 0) - odm_bf_ant_div_mode_arbitration(p_dm_odm); + if (dm->antdiv_evm_en == 0 || fat_tab->evm_method_enable == 0) + odm_bf_ant_div_mode_arbitration(dm); #endif #endif for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { - p_entry = p_dm_odm->p_odm_sta_info[i]; - if (IS_STA_VALID(p_entry)) { - /* 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*/ - } - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** 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)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** 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)); - /* ODM_RT_TRACE(p_dm_odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** 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_odm->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_odm->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_odm, 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_entry->rx_byte_cnt_low_maw) << 3 ; /* 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; - ODM_RT_TRACE(p_dm_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, 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; - ODM_RT_TRACE(p_dm_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, 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; - } - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** 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) - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : MA_rx_TP_DIV = (( %d ))\n", i, p_dm_bdc_table->MA_rx_TP_DIV[i])); - - else - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : MA_rx_TP = (( %d ))\n", i, p_dm_bdc_table->MA_rx_TP[i])); - - } -#endif -#endif - + sta = dm->phydm_sta_info[i]; + if (!is_sta_active(sta)) { + phydm_antdiv_reset_statistic(dm, i); + continue; } -#if (BEAMFORMING_SUPPORT == 1) -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) - if (p_dm_bdc_table->bdc_try_flag == 0) -#endif + /* @2 Caculate RSSI per Antenna */ + if (fat_tab->main_cnt[i] != 0 || fat_tab->aux_cnt[i] != 0) { + mian_cnt = fat_tab->main_cnt[i]; + aux_cnt = fat_tab->aux_cnt[i]; + main_rssi = (mian_cnt != 0) ? + (fat_tab->main_sum[i] / mian_cnt) : 0; + aux_rssi = (aux_cnt != 0) ? + (fat_tab->aux_sum[i] / aux_cnt) : 0; + target_ant = (mian_cnt == aux_cnt) ? + fat_tab->rx_idle_ant : + ((mian_cnt >= aux_cnt) ? + MAIN_ANT : AUX_ANT); + /*Use counter number for OFDM*/ + + } else { /*@CCK only case*/ + mian_cnt = fat_tab->main_cnt_cck[i]; + aux_cnt = fat_tab->aux_cnt_cck[i]; + main_rssi = (mian_cnt != 0) ? + (fat_tab->main_sum_cck[i] / mian_cnt) : 0; + aux_rssi = (aux_cnt != 0) ? + (fat_tab->aux_sum_cck[i] / aux_cnt) : 0; + target_ant = (main_rssi == aux_rssi) ? + fat_tab->rx_idle_ant : + ((main_rssi >= aux_rssi) ? + MAIN_ANT : AUX_ANT); + /*Use RSSI for CCK only case*/ + } + + PHYDM_DBG(dm, DBG_ANT_DIV, + "*** Client[ %d ] : Main_Cnt = (( %d )) , CCK_Main_Cnt = (( %d )) , main_rssi= (( %d ))\n", + i, fat_tab->main_cnt[i], + fat_tab->main_cnt_cck[i], main_rssi); + PHYDM_DBG(dm, DBG_ANT_DIV, + "*** Client[ %d ] : Aux_Cnt = (( %d )) , CCK_Aux_Cnt = (( %d )) , aux_rssi = (( %d ))\n", + i, fat_tab->aux_cnt[i], + fat_tab->aux_cnt_cck[i], aux_rssi); + + local_max_rssi = (main_rssi > aux_rssi) ? main_rssi : aux_rssi; + /* @ 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; + + /* @ 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 (dm->antdiv_evm_en == 1) { + if (fat_tab->target_ant_enhance != 0xFF) { + target_ant = fat_tab->target_ant_enhance; + rx_idle_ant = fat_tab->target_ant_enhance; + } + } #endif + + /* @2 Select TX Antenna */ + if (dm->ant_div_type != CGCS_RX_HW_ANTDIV) { + #ifdef PHYDM_BEAMFORMING_SUPPORT + #if (DM_ODM_SUPPORT_TYPE == ODM_AP) + if (dm_bdc_table->w_bfee_client[i] == 0) + #endif + #endif + { + odm_update_tx_ant(dm, target_ant, i); + } + } + +/* @------------------------------------------------------------ */ + + #ifdef PHYDM_BEAMFORMING_SUPPORT + #if (DM_ODM_SUPPORT_TYPE == ODM_AP) + + dm_bdc_table->num_client++; + + if (dm_bdc_table->bdc_mode == BDC_MODE_2 || dm_bdc_table->bdc_mode == BDC_MODE_3) { + /* @2 Byte counter */ + + ma_rx_temp = sta->rx_moving_average_tp; /* RX TP ( bit /sec) */ + + if (dm_bdc_table->BDC_state == bdc_bfer_train_state) + dm_bdc_table->MA_rx_TP_DIV[i] = ma_rx_temp; + else + 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 (dm_bdc_table->w_bfer_client[i] == 1) { /* @Bfer_Target */ + dm_bdc_table->num_bf_tar++; + + if (dm_bdc_table->BDC_state == BDC_DECISION_STATE && dm_bdc_table->bdc_try_flag == 0) { + improve_TP_temp = (dm_bdc_table->MA_rx_TP_DIV[i] * 9) >> 3; /* @* 1.125 */ + dm_bdc_table->BF_pass = (dm_bdc_table->MA_rx_TP[i] > improve_TP_temp) ? true : false; + PHYDM_DBG(dm, DBG_ANT_DIV, "*** Client[ %d ] : { MA_rx_TP,improve_TP_temp, MA_rx_TP_DIV, BF_pass}={ %d, %d, %d , %d }\n", i, dm_bdc_table->MA_rx_TP[i], improve_TP_temp, dm_bdc_table->MA_rx_TP_DIV[i], dm_bdc_table->BF_pass); + } + } else { /* @DIV_Target */ + dm_bdc_table->num_div_tar++; + + if (dm_bdc_table->BDC_state == BDC_DECISION_STATE && dm_bdc_table->bdc_try_flag == 0) { + degrade_TP_temp = (dm_bdc_table->MA_rx_TP_DIV[i] * 5) >> 3; /* @* 0.625 */ + dm_bdc_table->DIV_pass = (dm_bdc_table->MA_rx_TP[i] > degrade_TP_temp) ? true : false; + PHYDM_DBG(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, dm_bdc_table->MA_rx_TP[i], degrade_TP_temp, dm_bdc_table->MA_rx_TP_DIV[i], dm_bdc_table->DIV_pass); + } + } + } + + if (ma_rx_temp > TH1) { + if (dm_bdc_table->w_bfer_client[i] == 1) /* @Bfer_Target */ + dm_bdc_table->is_all_bf_sta_idle = false; + else /* @DIV_Target */ + dm_bdc_table->is_all_div_sta_idle = false; + } + + PHYDM_DBG(dm, DBG_ANT_DIV, + "*** Client[ %d ] : { BFmeeCap, BFmerCap} = { %d , %d }\n", + i, dm_bdc_table->w_bfee_client[i], + dm_bdc_table->w_bfer_client[i]); + + if (dm_bdc_table->BDC_state == bdc_bfer_train_state) + PHYDM_DBG(dm, DBG_ANT_DIV, "*** Client[ %d ] : MA_rx_TP_DIV = (( %d ))\n", i, dm_bdc_table->MA_rx_TP_DIV[i]); + + else + PHYDM_DBG(dm, DBG_ANT_DIV, "*** Client[ %d ] : MA_rx_TP = (( %d ))\n", i, dm_bdc_table->MA_rx_TP[i]); + } + #endif + #endif + + #ifdef PHYDM_BEAMFORMING_SUPPORT + #if (DM_ODM_SUPPORT_TYPE == ODM_AP) + if (dm_bdc_table->bdc_try_flag == 0) + #endif + #endif { - phydm_antdiv_reset_statistic(p_dm_odm, i); + phydm_antdiv_reset_statistic(dm, i); } } - - - /* 2 Set RX Idle Antenna & TX Antenna(Because of HW Bug ) */ +/* @2 Set RX Idle Antenna & TX Antenna(Because of HW Bug ) */ #if (DM_ODM_SUPPORT_TYPE == ODM_AP) - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** rx_idle_ant = (( %s ))\n\n", (rx_idle_ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT")); + PHYDM_DBG(dm, DBG_ANT_DIV, "*** rx_idle_ant = (( %s ))\n", + (rx_idle_ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT"); -#if (BEAMFORMING_SUPPORT == 1) +#ifdef PHYDM_BEAMFORMING_SUPPORT #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) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** bdc_rx_idle_update_counter = (( %d ))\n", p_dm_bdc_table->bdc_rx_idle_update_counter)); + if (dm_bdc_table->bdc_mode == BDC_MODE_1 || dm_bdc_table->bdc_mode == BDC_MODE_3) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "*** bdc_rx_idle_update_counter = (( %d ))\n", + dm_bdc_table->bdc_rx_idle_update_counter); - if (p_dm_bdc_table->bdc_rx_idle_update_counter == 1) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***Update RxIdle Antenna!!!\n")); - p_dm_bdc_table->bdc_rx_idle_update_counter = 30; - odm_update_rx_idle_ant(p_dm_odm, rx_idle_ant); + if (dm_bdc_table->bdc_rx_idle_update_counter == 1) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "***Update RxIdle Antenna!!!\n"); + dm_bdc_table->bdc_rx_idle_update_counter = 30; + odm_update_rx_idle_ant(dm, rx_idle_ant); } else { - p_dm_bdc_table->bdc_rx_idle_update_counter--; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***NOT update RxIdle Antenna because of BF ( need to fix TX-ant)\n")); + dm_bdc_table->bdc_rx_idle_update_counter--; + PHYDM_DBG(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_odm, rx_idle_ant); + odm_update_rx_idle_ant(dm, rx_idle_ant); #else - odm_update_rx_idle_ant(p_dm_odm, rx_idle_ant); + odm_update_rx_idle_ant(dm, rx_idle_ant); -#endif/* #if(DM_ODM_SUPPORT_TYPE == ODM_AP) */ +#endif /* @#if(DM_ODM_SUPPORT_TYPE == ODM_AP) */ - - - /* 2 BDC Main Algorithm */ -#if (BEAMFORMING_SUPPORT == 1) +/* @2 BDC Main Algorithm */ +#ifdef PHYDM_BEAMFORMING_SUPPORT #if (DM_ODM_SUPPORT_TYPE == ODM_AP) - if (p_dm_odm->antdiv_evm_en == 0 || p_dm_fat_table->EVM_method_enable == 0) - odm_bd_ccoex_bfee_rx_div_arbitration(p_dm_odm); + if (dm->antdiv_evm_en == 0 || fat_tab->evm_method_enable == 0) + odm_bd_ccoex_bfee_rx_div_arbitration(dm); + + dm_bdc_table->num_txbfee_client = 0; + dm_bdc_table->num_txbfer_client = 0; #endif #endif if (ant_div_max_rssi == 0) - p_dm_dig_table->ant_div_rssi_max = p_dm_odm->rssi_min; + dig_t->ant_div_rssi_max = dm->rssi_min; else - p_dm_dig_table->ant_div_rssi_max = ant_div_max_rssi; + dig_t->ant_div_rssi_max = ant_div_max_rssi; - p_dm_dig_table->RSSI_max = max_rssi; + PHYDM_DBG(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 -) +void odm_s0s1_sw_ant_div_reset(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _sw_antenna_switch_ *p_dm_swat_table = &p_dm_odm->dm_swat_table; - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct sw_antenna_switch *swat_tab = &dm->dm_swat_table; + struct phydm_fat_struct *fat_tab = &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; + fat_tab->is_become_linked = false; + swat_tab->try_flag = SWAW_STEP_INIT; + swat_tab->double_chk_flag = 0; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_s0s1_sw_ant_div_reset(): p_dm_fat_table->is_become_linked = %d\n", p_dm_fat_table->is_become_linked)); + PHYDM_DBG(dm, DBG_ANT_DIV, "%s: fat_tab->is_become_linked = %d\n", + __func__, fat_tab->is_become_linked); } -void -odm_s0s1_sw_ant_div( - void *p_dm_void, - u8 step -) +void phydm_sw_antdiv_train_time(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _sw_antenna_switch_ *p_dm_swat_table = &p_dm_odm->dm_swat_table; - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->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 sta_info *p_entry = NULL; - u32 value32; - u32 main_ant_sum; - u32 aux_ant_sum; - u32 main_ant_cnt; - u32 aux_ant_cnt; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct sw_antenna_switch *swat_tab = &dm->dm_swat_table; + u8 high_traffic_train_time_u = 0x32, high_traffic_train_time_l = 0; + u8 low_traffic_train_time_u = 200, low_traffic_train_time_l = 0; + u8 train_time_temp; + if (dm->traffic_load == TRAFFIC_HIGH) { + train_time_temp = swat_tab->train_time; - if (!p_dm_odm->is_linked) { /* is_linked==False */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[No Link!!!]\n")); - if (p_dm_fat_table->is_become_linked == true) { - odm_tx_by_tx_desc_or_reg(p_dm_odm, TX_BY_REG); - if (p_dm_odm->support_ic_type == ODM_RTL8723B) { + if (swat_tab->train_time_flag == 3) { + high_traffic_train_time_l = 0xa; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Set REG 948[9:6]=0x0\n")); - odm_set_bb_reg(p_dm_odm, 0x948, (BIT(9) | BIT(8) | BIT(7) | BIT(6)), 0x0); + if (train_time_temp <= 16) + train_time_temp = high_traffic_train_time_l; + else + train_time_temp -= 16; + + } else if (swat_tab->train_time_flag == 2) { + train_time_temp -= 8; + high_traffic_train_time_l = 0xf; + } else if (swat_tab->train_time_flag == 1) { + train_time_temp -= 4; + high_traffic_train_time_l = 0x1e; + } else if (swat_tab->train_time_flag == 0) { + train_time_temp += 8; + high_traffic_train_time_l = 0x28; + } + + if (dm->support_ic_type == ODM_RTL8188F) { + if (dm->support_interface == ODM_ITRF_SDIO) + high_traffic_train_time_l += 0xa; + } + + /* @-- */ + 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; + + swat_tab->train_time = train_time_temp; /*@10ms~200ms*/ + + PHYDM_DBG(dm, DBG_ANT_DIV, + "train_time_flag=((%d)), train_time=((%d))\n", + swat_tab->train_time_flag, + swat_tab->train_time); + + } else if ((dm->traffic_load == TRAFFIC_MID) || + (dm->traffic_load == TRAFFIC_LOW)) { + train_time_temp = swat_tab->train_time; + + if (swat_tab->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 (swat_tab->train_time_flag == 2) { + train_time_temp -= 30; + low_traffic_train_time_l = 36; + } else if (swat_tab->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 (dm->support_ic_type == ODM_RTL8188F) { + if (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; + + swat_tab->train_time = train_time_temp; /*@10ms~200ms*/ + + PHYDM_DBG(dm, DBG_ANT_DIV, + "train_time_flag=((%d)) , train_time=((%d))\n", + swat_tab->train_time_flag, swat_tab->train_time); + + } else { + swat_tab->train_time = 0xc8; /*@200ms*/ + } +} + +void phydm_sw_antdiv_decision(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct sw_antenna_switch *swat_tab = &dm->dm_swat_table; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + u32 i, min_max_rssi = 0xFF, local_max_rssi, local_min_rssi; + u32 main_rssi, aux_rssi; + u8 rx_idle_ant = swat_tab->pre_ant; + u8 target_ant = swat_tab->pre_ant, next_ant = 0; + struct cmn_sta_info *entry = NULL; + u32 main_cnt = 0, aux_cnt = 0, main_sum = 0, aux_sum = 0; + u32 main_ctrl_cnt = 0, aux_ctrl_cnt = 0; + boolean is_by_ctrl_frame = false; + boolean cond_23d_main, cond_23d_aux; + u64 pkt_cnt_total = 0; + + for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { + entry = dm->phydm_sta_info[i]; + if (!is_sta_active(entry)) { + phydm_antdiv_reset_statistic(dm, i); + continue; + } + + /* @2 Caculate RSSI per Antenna */ + if (fat_tab->main_cnt[i] != 0 || fat_tab->aux_cnt[i] != 0) { + main_cnt = (u32)fat_tab->main_cnt[i]; + aux_cnt = (u32)fat_tab->aux_cnt[i]; + main_rssi = (main_cnt != 0) ? + (fat_tab->main_sum[i] / main_cnt) : 0; + aux_rssi = (aux_cnt != 0) ? + (fat_tab->aux_sum[i] / aux_cnt) : 0; + if (dm->support_ic_type == ODM_RTL8723D) { + cond_23d_main = (aux_cnt > main_cnt) && + ((main_rssi - aux_rssi < 5) || + (aux_rssi > main_rssi)); + cond_23d_aux = (main_cnt > aux_cnt) && + ((aux_rssi - main_rssi < 5) || + (main_rssi > aux_rssi)); + if (swat_tab->pre_ant == MAIN_ANT) { + if (main_cnt == 0) + target_ant = (aux_cnt != 0) ? + AUX_ANT : + swat_tab->pre_ant; + else + target_ant = cond_23d_main ? + AUX_ANT : + swat_tab->pre_ant; + } else { + if (aux_cnt == 0) + target_ant = (main_cnt != 0) ? + MAIN_ANT : + swat_tab->pre_ant; + else + target_ant = cond_23d_aux ? + MAIN_ANT : + swat_tab->pre_ant; + } + } else { + if (swat_tab->pre_ant == MAIN_ANT) { + target_ant = (aux_rssi > main_rssi) ? + AUX_ANT : + swat_tab->pre_ant; + } else if (swat_tab->pre_ant == AUX_ANT) { + target_ant = (main_rssi > aux_rssi) ? + MAIN_ANT : + swat_tab->pre_ant; + } } - p_dm_fat_table->is_become_linked = p_dm_odm->is_linked; + } else { /*@CCK only case*/ + main_cnt = fat_tab->main_cnt_cck[i]; + aux_cnt = fat_tab->aux_cnt_cck[i]; + main_rssi = (main_cnt != 0) ? + (fat_tab->main_sum_cck[i] / main_cnt) : 0; + aux_rssi = (aux_cnt != 0) ? + (fat_tab->aux_sum_cck[i] / aux_cnt) : 0; + target_ant = (main_rssi == aux_rssi) ? + swat_tab->pre_ant : + ((main_rssi >= aux_rssi) ? + MAIN_ANT : AUX_ANT); + /*Use RSSI for CCK only case*/ + } + local_max_rssi = (main_rssi >= aux_rssi) ? main_rssi : aux_rssi; + local_min_rssi = (main_rssi >= aux_rssi) ? aux_rssi : main_rssi; + + PHYDM_DBG(dm, DBG_ANT_DIV, + "*** CCK_counter_main = (( %d )) , CCK_counter_aux= (( %d ))\n", + fat_tab->main_cnt_cck[i], fat_tab->aux_cnt_cck[i]); + PHYDM_DBG(dm, DBG_ANT_DIV, + "*** OFDM_counter_main = (( %d )) , OFDM_counter_aux= (( %d ))\n", + fat_tab->main_cnt[i], fat_tab->aux_cnt[i]); + PHYDM_DBG(dm, DBG_ANT_DIV, + "*** main_Cnt = (( %d )) , aux_Cnt = (( %d ))\n", + main_cnt, aux_cnt); + PHYDM_DBG(dm, DBG_ANT_DIV, + "*** main_rssi= (( %d )) , aux_rssi = (( %d ))\n", + main_rssi, aux_rssi); + PHYDM_DBG(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(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) { + swat_tab->train_time_flag = 3; + } else { + if (min_max_rssi > RSSI_CHECK_THRESHOLD) + swat_tab->train_time_flag = 0; + else + swat_tab->train_time_flag = 3; + } + } else if ((local_max_rssi - local_min_rssi) > 5) { + swat_tab->train_time_flag = 2; + } else if ((local_max_rssi - local_min_rssi) > 2) { + swat_tab->train_time_flag = 1; + } else { + swat_tab->train_time_flag = 0; + } + } + + /* @2 Select TX Antenna */ + if (target_ant == MAIN_ANT) + fat_tab->antsel_a[i] = ANT1_2G; + else + fat_tab->antsel_a[i] = ANT2_2G; + + phydm_antdiv_reset_statistic(dm, i); + pkt_cnt_total += (main_cnt + aux_cnt); + } + + if (swat_tab->is_sw_ant_div_by_ctrl_frame) { + odm_s0s1_sw_ant_div_by_ctrl_frame(dm, SWAW_STEP_DETERMINE); + is_by_ctrl_frame = true; + } + + PHYDM_DBG(dm, DBG_ANT_DIV, + "Control frame packet counter = %d, data frame packet counter = %llu\n", + swat_tab->pkt_cnt_sw_ant_div_by_ctrl_frame, pkt_cnt_total); + + if (min_max_rssi == 0xff || ((pkt_cnt_total < + (swat_tab->pkt_cnt_sw_ant_div_by_ctrl_frame >> 1)) && + dm->phy_dbg_info.num_qry_beacon_pkt < 2)) { + min_max_rssi = 0; + PHYDM_DBG(dm, DBG_ANT_DIV, + "Check RSSI of control frame because min_max_rssi == 0xff\n"); + PHYDM_DBG(dm, DBG_ANT_DIV, "is_by_ctrl_frame = %d\n", + is_by_ctrl_frame); + + if (is_by_ctrl_frame) { + main_ctrl_cnt = fat_tab->main_ctrl_cnt; + aux_ctrl_cnt = fat_tab->aux_ctrl_cnt; + main_rssi = (main_ctrl_cnt != 0) ? + (fat_tab->main_ctrl_sum / main_ctrl_cnt) : + 0; + aux_rssi = (aux_ctrl_cnt != 0) ? + (fat_tab->aux_ctrl_sum / aux_ctrl_cnt) : 0; + + if (main_ctrl_cnt <= 1 && + fat_tab->cck_ctrl_frame_cnt_main >= 1) + main_rssi = 0; + + if (aux_ctrl_cnt <= 1 && + fat_tab->cck_ctrl_frame_cnt_aux >= 1) + aux_rssi = 0; + + if (main_rssi != 0 || aux_rssi != 0) { + rx_idle_ant = (main_rssi == aux_rssi) ? + swat_tab->pre_ant : + ((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) + swat_tab->train_time_flag = 3; + else if ((local_max_rssi - local_min_rssi) > 5) + swat_tab->train_time_flag = 2; + else if ((local_max_rssi - local_min_rssi) > 2) + swat_tab->train_time_flag = 1; + else + swat_tab->train_time_flag = 0; + + PHYDM_DBG(dm, DBG_ANT_DIV, + "Control frame: main_rssi = %d, aux_rssi = %d\n", + main_rssi, aux_rssi); + PHYDM_DBG(dm, DBG_ANT_DIV, + "rx_idle_ant decided by control frame = %s\n", + (rx_idle_ant == MAIN_ANT ? + "MAIN" : "AUX")); + } + } + } + + fat_tab->min_max_rssi = min_max_rssi; + swat_tab->try_flag = SWAW_STEP_PEEK; + + if (swat_tab->double_chk_flag == 1) { + swat_tab->double_chk_flag = 0; + + if (fat_tab->min_max_rssi > RSSI_CHECK_THRESHOLD) { + PHYDM_DBG(dm, DBG_ANT_DIV, + " [Double check] min_max_rssi ((%d)) > %d again!!\n", + fat_tab->min_max_rssi, RSSI_CHECK_THRESHOLD); + + odm_update_rx_idle_ant(dm, rx_idle_ant); + + PHYDM_DBG(dm, DBG_ANT_DIV, + "[reset try_flag = 0] Training accomplished !!!]\n\n\n"); + } else { + PHYDM_DBG(dm, DBG_ANT_DIV, + " [Double check] min_max_rssi ((%d)) <= %d !!\n", + fat_tab->min_max_rssi, RSSI_CHECK_THRESHOLD); + + next_ant = (fat_tab->rx_idle_ant == MAIN_ANT) ? + AUX_ANT : MAIN_ANT; + swat_tab->try_flag = SWAW_STEP_PEEK; + swat_tab->reset_idx = RSSI_CHECK_RESET_PERIOD; + PHYDM_DBG(dm, DBG_ANT_DIV, + "[set try_flag=0] Normal state: Need to tryg again!!\n\n\n"); + } + } else { + if (fat_tab->min_max_rssi < RSSI_CHECK_THRESHOLD) + swat_tab->reset_idx = RSSI_CHECK_RESET_PERIOD; + + swat_tab->pre_ant = rx_idle_ant; + odm_update_rx_idle_ant(dm, rx_idle_ant); + PHYDM_DBG(dm, DBG_ANT_DIV, + "[reset try_flag = 0] Training accomplished !!!]\n\n\n"); + } +} + +void odm_s0s1_sw_ant_div(void *dm_void, u8 step) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct sw_antenna_switch *swat_tab = &dm->dm_swat_table; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + u32 value32; + u8 next_ant = 0; + + if (!dm->is_linked) { /* @is_linked==False */ + PHYDM_DBG(dm, DBG_ANT_DIV, "[No Link!!!]\n"); + if (fat_tab->is_become_linked == true) { + odm_tx_by_tx_desc_or_reg(dm, TX_BY_REG); + if (dm->support_ic_type == ODM_RTL8723B) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "Set REG 948[9:6]=0x0\n"); + odm_set_bb_reg(dm, R_0x948, 0x3c0, 0x0); + } + fat_tab->is_become_linked = dm->is_linked; } return; } else { - if (p_dm_fat_table->is_become_linked == false) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Linked !!!]\n")); + if (fat_tab->is_become_linked == false) { + PHYDM_DBG(dm, DBG_ANT_DIV, "[Linked !!!]\n"); - if (p_dm_odm->support_ic_type == ODM_RTL8723B) { - value32 = odm_get_bb_reg(p_dm_odm, 0x864, BIT(5) | BIT(4) | BIT(3)); + if (dm->support_ic_type == ODM_RTL8723B) { + value32 = odm_get_bb_reg(dm, R_0x864, 0x38); #if (RTL8723B_SUPPORT == 1) if (value32 == 0x0) - odm_update_rx_idle_ant_8723b(p_dm_odm, MAIN_ANT, ANT1_2G, ANT2_2G); + odm_update_rx_idle_ant_8723b(dm, + MAIN_ANT, + ANT1_2G, + ANT2_2G); else if (value32 == 0x1) - odm_update_rx_idle_ant_8723b(p_dm_odm, AUX_ANT, ANT2_2G, ANT1_2G); + odm_update_rx_idle_ant_8723b(dm, + AUX_ANT, + ANT2_2G, + ANT1_2G); #endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("8723B: First link! Force antenna to %s\n", (value32 == 0x0 ? "MAIN" : "AUX"))); + PHYDM_DBG(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_odm->is_linked; + + if (dm->support_ic_type == ODM_RTL8723D) { + value32 = odm_get_bb_reg(dm, R_0x864, 0x38); +#if (RTL8723D_SUPPORT == 1) + if (value32 == 0x0) + odm_update_rx_idle_ant_8723d(dm, + MAIN_ANT, + ANT1_2G, + ANT2_2G); + else if (value32 == 0x1) + odm_update_rx_idle_ant_8723d(dm, + AUX_ANT, + ANT2_2G, + ANT1_2G); + PHYDM_DBG(dm, DBG_ANT_DIV, + "8723D: First link! Force antenna to %s\n", + (value32 == 0x0 ? "MAIN" : "AUX")); +#endif + } + fat_tab->is_become_linked = dm->is_linked; } } - if (*(p_dm_fat_table->p_force_tx_ant_by_desc) == false) { - if (p_dm_odm->is_one_entry_only == true) - odm_tx_by_tx_desc_or_reg(p_dm_odm, TX_BY_REG); + if (!(*fat_tab->p_force_tx_by_desc)) { + if (dm->is_one_entry_only == true) + odm_tx_by_tx_desc_or_reg(dm, TX_BY_REG); else - odm_tx_by_tx_desc_or_reg(p_dm_odm, TX_BY_DESC); + odm_tx_by_tx_desc_or_reg(dm, TX_BY_DESC); } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[%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)); + PHYDM_DBG(dm, DBG_ANT_DIV, + "[%d] { try_flag=(( %d )), step=(( %d )), double_chk_flag = (( %d )) }\n", + __LINE__, swat_tab->try_flag, step, + swat_tab->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) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[step != try_flag] Need to Reset After Link\n")); - odm_sw_ant_div_rest_after_link(p_dm_odm); + /* @ Handling step mismatch condition. */ + /* @ Peak step is not finished at last time. */ + /* @ Recover the variable and check again. */ + if (step != swat_tab->try_flag) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "[step != try_flag] Need to Reset After Link\n"); + odm_sw_ant_div_rest_after_link(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; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[set try_flag = 0] Prepare for peek!\n\n")); + if (swat_tab->try_flag == SWAW_STEP_INIT) { + swat_tab->try_flag = SWAW_STEP_PEEK; + swat_tab->train_time_flag = 0; + PHYDM_DBG(dm, DBG_ANT_DIV, + "[set try_flag = 0] Prepare for peek!\n\n"); return; } else { + /* @1 Normal state (Begin Trying) */ + if (swat_tab->try_flag == SWAW_STEP_PEEK) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "TxOkCnt=(( %llu )), RxOkCnt=(( %llu )), traffic_load = (%d))\n", + dm->cur_tx_ok_cnt, dm->cur_rx_ok_cnt, + dm->traffic_load); + phydm_sw_antdiv_train_time(dm); - /* 1 Normal state (Begin Trying) */ - if (p_dm_swat_table->try_flag == SWAW_STEP_PEEK) { - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("TxOkCnt=(( %llu )), RxOkCnt=(( %llu )), traffic_load = (%d))\n", p_dm_odm->cur_tx_ok_cnt, p_dm_odm->cur_rx_ok_cnt, p_dm_odm->traffic_load)); - - if (p_dm_odm->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; - } - - - /* ODM_RT_TRACE(p_dm_odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** 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*/ - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("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_odm->traffic_load == TRAFFIC_MID) || (p_dm_odm->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 (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*/ - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("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(dm, DBG_ANT_DIV, + "Current min_max_rssi is ((%d))\n", + fat_tab->min_max_rssi); + /* @---reset index--- */ + if (swat_tab->reset_idx >= RSSI_CHECK_RESET_PERIOD) { + fat_tab->min_max_rssi = 0; + swat_tab->reset_idx = 0; } + PHYDM_DBG(dm, DBG_ANT_DIV, "reset_idx = (( %d ))\n", + swat_tab->reset_idx); - /* ----------------- */ + swat_tab->reset_idx++; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Current min_max_rssi is ((%d))\n", p_dm_fat_table->min_max_rssi)); + /* @---double check flag--- */ + if (fat_tab->min_max_rssi > RSSI_CHECK_THRESHOLD && + swat_tab->double_chk_flag == 0) { + PHYDM_DBG(dm, DBG_ANT_DIV, + " min_max_rssi is ((%d)), and > %d\n", + fat_tab->min_max_rssi, + RSSI_CHECK_THRESHOLD); - /* ---reset index--- */ - if (p_dm_swat_table->reset_idx >= RSSI_CHECK_RESET_PERIOD) { + swat_tab->double_chk_flag = 1; + swat_tab->try_flag = SWAW_STEP_DETERMINE; + swat_tab->rssi_trying = 0; - p_dm_fat_table->min_max_rssi = 0; - p_dm_swat_table->reset_idx = 0; - } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("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)) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" 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; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Test the current ant for (( %d )) ms again\n", p_dm_swat_table->train_time)); - odm_update_rx_idle_ant(p_dm_odm, p_dm_fat_table->rx_idle_ant); - odm_set_timer(p_dm_odm, &(p_dm_swat_table->phydm_sw_antenna_switch_timer), p_dm_swat_table->train_time); /*ms*/ + PHYDM_DBG(dm, DBG_ANT_DIV, + "Test the current ant for (( %d )) ms again\n", + swat_tab->train_time); + odm_update_rx_idle_ant(dm, + fat_tab->rx_idle_ant); + odm_set_timer(dm, &swat_tab->sw_antdiv_timer, + swat_tab->train_time); /*@ms*/ return; } - next_ant = (p_dm_fat_table->rx_idle_ant == MAIN_ANT) ? AUX_ANT : MAIN_ANT; + next_ant = (fat_tab->rx_idle_ant == MAIN_ANT) ? + AUX_ANT : MAIN_ANT; - p_dm_swat_table->try_flag = SWAW_STEP_DETERMINE; + swat_tab->try_flag = SWAW_STEP_DETERMINE; - if (p_dm_swat_table->reset_idx <= 1) - p_dm_swat_table->rssi_trying = 2; + if (swat_tab->reset_idx <= 1) + swat_tab->rssi_trying = 2; else - p_dm_swat_table->rssi_trying = 1; + swat_tab->rssi_trying = 1; - odm_s0s1_sw_ant_div_by_ctrl_frame(p_dm_odm, SWAW_STEP_PEEK); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[set try_flag=1] Normal state: Begin Trying!!\n")); + odm_s0s1_sw_ant_div_by_ctrl_frame(dm, SWAW_STEP_PEEK); + PHYDM_DBG(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--; + } else if ((swat_tab->try_flag == SWAW_STEP_DETERMINE) && + (swat_tab->double_chk_flag == 0)) { + next_ant = (fat_tab->rx_idle_ant == MAIN_ANT) ? + AUX_ANT : MAIN_ANT; + swat_tab->rssi_trying--; } - /* 1 Decision state */ - if ((p_dm_swat_table->try_flag == SWAW_STEP_DETERMINE) && (p_dm_swat_table->rssi_trying == 0)) { - - bool is_by_ctrl_frame = false; - u64 pkt_cnt_total = 0; - - for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { - p_entry = p_dm_odm->p_odm_sta_info[i]; - if (IS_STA_VALID(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; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** 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])); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** 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])); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Main_Cnt = (( %d )) , main_rssi= (( %d ))\n", main_ant_cnt, main_rssi)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Aux_Cnt = (( %d )) , aux_rssi = (( %d ))\n", aux_ant_cnt, aux_rssi)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** 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; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** 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_odm, 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_odm, SWAW_STEP_DETERMINE); - is_by_ctrl_frame = true; - } - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("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_odm->phy_dbg_info.num_qry_beacon_pkt < 2)) { - min_max_rssi = 0; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Check RSSI of control frame because min_max_rssi == 0xff\n")); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("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; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Control frame: main_rssi = %d, aux_rssi = %d\n", main_rssi, aux_rssi)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("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) { - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" [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_odm, rx_idle_ant); - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[reset try_flag = 0] Training accomplished !!!]\n\n\n")); - return; - } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" [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; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[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_odm, rx_idle_ant); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[reset try_flag = 0] Training accomplished !!!] \n\n\n")); - return; - } - + /* @1 Decision state */ + if (swat_tab->try_flag == SWAW_STEP_DETERMINE && + swat_tab->rssi_trying == 0) { + phydm_sw_antdiv_decision(dm); + return; } - } - /* 1 4.Change TRX antenna */ + /* @1 4.Change TRX antenna */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("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"))); + PHYDM_DBG(dm, DBG_ANT_DIV, + "rssi_trying = (( %d )), ant: (( %s )) >>> (( %s ))\n", + swat_tab->rssi_trying, + (fat_tab->rx_idle_ant == MAIN_ANT ? "MAIN" : "AUX"), + (next_ant == MAIN_ANT ? "MAIN" : "AUX")); - odm_update_rx_idle_ant(p_dm_odm, next_ant); + odm_update_rx_idle_ant(dm, next_ant); - /* 1 5.Reset Statistics */ + /* @1 5.Reset Statistics */ - p_dm_fat_table->rx_idle_ant = next_ant; + fat_tab->rx_idle_ant = next_ant; - /* 1 6.Set next timer (Trying state) */ + if (dm->support_ic_type == ODM_RTL8723D) { + if (fat_tab->rx_idle_ant == MAIN_ANT) { + fat_tab->main_sum[0] = 0; + fat_tab->main_cnt[0] = 0; + fat_tab->main_sum_cck[0] = 0; + fat_tab->main_cnt_cck[0] = 0; + } else { + fat_tab->aux_sum[0] = 0; + fat_tab->aux_cnt[0] = 0; + fat_tab->aux_sum_cck[0] = 0; + fat_tab->aux_cnt_cck[0] = 0; + } + } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" Test ((%s)) ant for (( %d )) ms\n", (next_ant == MAIN_ANT ? "MAIN" : "AUX"), p_dm_swat_table->train_time)); - odm_set_timer(p_dm_odm, &(p_dm_swat_table->phydm_sw_antenna_switch_timer), p_dm_swat_table->train_time); /*ms*/ + if (dm->support_ic_type == ODM_RTL8188F) { + if (dm->support_interface == ODM_ITRF_SDIO) { + ODM_delay_us(200); + + if (fat_tab->rx_idle_ant == MAIN_ANT) { + fat_tab->main_sum[0] = 0; + fat_tab->main_cnt[0] = 0; + fat_tab->main_sum_cck[0] = 0; + fat_tab->main_cnt_cck[0] = 0; + } else { + fat_tab->aux_sum[0] = 0; + fat_tab->aux_cnt[0] = 0; + fat_tab->aux_sum_cck[0] = 0; + fat_tab->aux_cnt_cck[0] = 0; + } + } + } + /* @1 6.Set next timer (Trying state) */ + PHYDM_DBG(dm, DBG_ANT_DIV, " Test ((%s)) ant for (( %d )) ms\n", + (next_ant == MAIN_ANT ? "MAIN" : "AUX"), + swat_tab->train_time); + odm_set_timer(dm, &swat_tab->sw_antdiv_timer, swat_tab->train_time); + /*@ms*/ } - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -void -odm_sw_antdiv_callback( - struct timer_list *p_timer -) +void odm_sw_antdiv_callback(struct phydm_timer_list *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; + void *adapter = (void *)timer->Adapter; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + struct sw_antenna_switch *swat_tab = &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); + odm_schedule_work_item(&swat_tab->phydm_sw_antenna_switch_workitem); #else { - /* dbg_print("SW_antdiv_Callback"); */ - odm_s0s1_sw_ant_div(&p_hal_data->DM_OutSrc, SWAW_STEP_DETERMINE); +#if 0 + /* @dbg_print("SW_antdiv_Callback"); */ +#endif + odm_s0s1_sw_ant_div(&hal_data->DM_OutSrc, SWAW_STEP_DETERMINE); } #endif #else - odm_schedule_work_item(&p_dm_swat_table->phydm_sw_antenna_switch_workitem); + odm_schedule_work_item(&swat_tab->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); +void odm_sw_antdiv_workitem_callback(void *context) +{ + void *adapter = (void *)context; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + +#if 0 + /* @dbg_print("SW_antdiv_Workitem_Callback"); */ +#endif + odm_s0s1_sw_ant_div(&hal_data->DM_OutSrc, SWAW_STEP_DETERMINE); } #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -void -odm_sw_antdiv_workitem_callback( - void *p_context -) +void odm_sw_antdiv_workitem_callback(void *context) { - struct _ADAPTER * - p_adapter = (struct _ADAPTER *)p_context; + void * + adapter = (void *)context; HAL_DATA_TYPE - *p_hal_data = GET_HAL_DATA(p_adapter); + *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); - /*dbg_print("SW_antdiv_Workitem_Callback");*/ - odm_s0s1_sw_ant_div(&p_hal_data->odmpriv, SWAW_STEP_DETERMINE); +#if 0 + /*@dbg_print("SW_antdiv_Workitem_Callback");*/ +#endif + odm_s0s1_sw_ant_div(&hal_data->odmpriv, SWAW_STEP_DETERMINE); } -void -odm_sw_antdiv_callback(void *function_context) +void odm_sw_antdiv_callback(void *function_context) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)function_context; - struct _ADAPTER *padapter = p_dm_odm->adapter; - if (padapter->net_closed == _TRUE) + struct dm_struct *dm = (struct dm_struct *)function_context; + void *padapter = dm->adapter; + if (*dm->is_net_closed == true) return; -#if 0 /* Can't do I/O in timer callback*/ - odm_s0s1_sw_ant_div(p_dm_odm, SWAW_STEP_DETERMINE); +#if 0 /* @Can't do I/O in timer callback*/ + odm_s0s1_sw_ant_div(dm, SWAW_STEP_DETERMINE); #else - rtw_run_in_thread_cmd(padapter, odm_sw_antdiv_workitem_callback, padapter); + 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 -) +void odm_s0s1_sw_ant_div_by_ctrl_frame(void *dm_void, u8 step) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _sw_antenna_switch_ *p_dm_swat_table = &p_dm_odm->dm_swat_table; - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct sw_antenna_switch *swat_tab = &dm->dm_swat_table; + struct phydm_fat_struct *fat_tab = &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; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_S0S1_SwAntDivForAPMode(): Start peek and reset counter\n")); + swat_tab->pkt_cnt_sw_ant_div_by_ctrl_frame = 0; + swat_tab->is_sw_ant_div_by_ctrl_frame = true; + fat_tab->main_ctrl_cnt = 0; + fat_tab->aux_ctrl_cnt = 0; + fat_tab->main_ctrl_sum = 0; + fat_tab->aux_ctrl_sum = 0; + fat_tab->cck_ctrl_frame_cnt_main = 0; + fat_tab->cck_ctrl_frame_cnt_aux = 0; + fat_tab->ofdm_ctrl_frame_cnt_main = 0; + fat_tab->ofdm_ctrl_frame_cnt_aux = 0; + PHYDM_DBG(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; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_S0S1_SwAntDivForAPMode(): Stop peek\n")); + swat_tab->is_sw_ant_div_by_ctrl_frame = false; + PHYDM_DBG(dm, DBG_ANT_DIV, + "odm_S0S1_SwAntDivForAPMode(): Stop peek\n"); break; default: - p_dm_swat_table->is_sw_ant_div_by_ctrl_frame = false; + swat_tab->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 - -) +void odm_antsel_statistics_ctrl(void *dm_void, u8 antsel_tr_mux, + u32 rx_pwdb_all) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fat_struct *fat_tab = &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++; + fat_tab->main_ctrl_sum += rx_pwdb_all; + fat_tab->main_ctrl_cnt++; } else { - p_dm_fat_table->aux_ant_ctrl_frame_sum += rx_pwdb_all; - p_dm_fat_table->aux_ant_ctrl_frame_cnt++; + fat_tab->aux_ctrl_sum += rx_pwdb_all; + fat_tab->aux_ctrl_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 _odm_phy_status_info_* p_phy_info, */ - /* struct _odm_per_pkt_info_* p_pktinfo */ -) +void odm_s0s1_sw_ant_div_by_ctrl_frame_process_rssi(void *dm_void, + void *phy_info_void, + void *pkt_info_void + /* struct phydm_phyinfo_struct* phy_info, */ + /* struct phydm_perpkt_info_struct* pktinfo */ + ) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _odm_phy_status_info_ *p_phy_info = (struct _odm_phy_status_info_ *)p_phy_info_void; - struct _odm_per_pkt_info_ *p_pktinfo = (struct _odm_per_pkt_info_ *)p_pkt_info_void; - struct _sw_antenna_switch_ *p_dm_swat_table = &p_dm_odm->dm_swat_table; - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; - bool is_cck_rate; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_phyinfo_struct *phy_info = NULL; + struct phydm_perpkt_info_struct *pktinfo = NULL; + struct sw_antenna_switch *swat_tab = &dm->dm_swat_table; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + u8 rssi_cck; - if (!(p_dm_odm->support_ability & ODM_BB_ANT_DIV)) + phy_info = (struct phydm_phyinfo_struct *)phy_info_void; + pktinfo = (struct phydm_perpkt_info_struct *)pkt_info_void; + + if (!(dm->support_ability & ODM_BB_ANT_DIV)) return; - if (p_dm_odm->ant_div_type != S0S1_SW_ANTDIV) + if (dm->ant_div_type != S0S1_SW_ANTDIV) return; - /* In try state */ - if (!p_dm_swat_table->is_sw_ant_div_by_ctrl_frame) + /* @In try state */ + if (!swat_tab->is_sw_ant_div_by_ctrl_frame) return; /* No HW error and match receiver address */ - if (!p_pktinfo->is_to_self) + if (!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; + swat_tab->pkt_cnt_sw_ant_div_by_ctrl_frame++; - 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 (pktinfo->is_cck_rate) { + rssi_cck = phy_info->rx_mimo_signal_strength[RF_PATH_A]; + fat_tab->antsel_rx_keep_0 = (fat_tab->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++; + if (fat_tab->antsel_rx_keep_0 == ANT1_2G) + fat_tab->cck_ctrl_frame_cnt_main++; else - p_dm_fat_table->cck_ctrl_frame_cnt_aux++; + fat_tab->cck_ctrl_frame_cnt_aux++; - odm_antsel_statistics_of_ctrl_frame(p_dm_odm, p_dm_fat_table->antsel_rx_keep_0, p_phy_info->rx_mimo_signal_strength[ODM_RF_PATH_A]); + odm_antsel_statistics_ctrl(dm, fat_tab->antsel_rx_keep_0, + rssi_cck); } else { - 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++; + fat_tab->antsel_rx_keep_0 = (fat_tab->rx_idle_ant == MAIN_ANT) ? + ANT1_2G : ANT2_2G; - odm_antsel_statistics_of_ctrl_frame(p_dm_odm, p_dm_fat_table->antsel_rx_keep_0, p_phy_info->rx_pwdb_all); + if (fat_tab->antsel_rx_keep_0 == ANT1_2G) + fat_tab->ofdm_ctrl_frame_cnt_main++; + else + fat_tab->ofdm_ctrl_frame_cnt_aux++; + + odm_antsel_statistics_ctrl(dm, fat_tab->antsel_rx_keep_0, + phy_info->rx_pwdb_all); } } -#endif /* #if (RTL8723B_SUPPORT == 1) || (RTL8821A_SUPPORT == 1) */ +#endif /* @#if (RTL8723B_SUPPORT == 1) || (RTL8821A_SUPPORT == 1) */ - - - -void -odm_set_next_mac_addr_target( - void *p_dm_void -) +void odm_set_next_mac_addr_target(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; - struct sta_info *p_entry; - u32 value32, i; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + struct cmn_sta_info *entry; + u32 value32, i; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_set_next_mac_addr_target() ==>\n")); + PHYDM_DBG(dm, DBG_ANT_DIV, "%s ==>\n", __func__); - if (p_dm_odm->is_linked) { + if (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; + if ((fat_tab->train_idx + 1) == ODM_ASSOCIATE_ENTRY_NUM) + fat_tab->train_idx = 0; else - p_dm_fat_table->train_idx++; + fat_tab->train_idx++; - p_entry = p_dm_odm->p_odm_sta_info[p_dm_fat_table->train_idx]; + entry = dm->phydm_sta_info[fat_tab->train_idx]; - if (IS_STA_VALID(p_entry)) { + if (is_sta_active(entry)) { + /*@Match MAC ADDR*/ + value32 = (entry->mac_addr[5] << 8) | entry->mac_addr[4]; - /*Match MAC ADDR*/ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP | ODM_CE)) - value32 = (p_entry->hwaddr[5] << 8) | p_entry->hwaddr[4]; -#else - value32 = (p_entry->MacAddr[5] << 8) | p_entry->MacAddr[4]; -#endif + odm_set_mac_reg(dm, R_0x7b4, 0xFFFF, value32); /*@0x7b4~0x7b5*/ - odm_set_mac_reg(p_dm_odm, 0x7b4, 0xFFFF, value32);/*0x7b4~0x7b5*/ + value32 = (entry->mac_addr[3] << 24) | (entry->mac_addr[2] << 16) | (entry->mac_addr[1] << 8) | entry->mac_addr[0]; -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP | ODM_CE)) - value32 = (p_entry->hwaddr[3] << 24) | (p_entry->hwaddr[2] << 16) | (p_entry->hwaddr[1] << 8) | p_entry->hwaddr[0]; -#else - value32 = (p_entry->MacAddr[3] << 24) | (p_entry->MacAddr[2] << 16) | (p_entry->MacAddr[1] << 8) | p_entry->MacAddr[0]; -#endif - odm_set_mac_reg(p_dm_odm, 0x7b0, MASKDWORD, value32);/*0x7b0~0x7b3*/ + odm_set_mac_reg(dm, R_0x7b0, MASKDWORD, value32); /*@0x7b0~0x7b3*/ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("p_dm_fat_table->train_idx=%d\n", p_dm_fat_table->train_idx)); + PHYDM_DBG(dm, DBG_ANT_DIV, + "fat_tab->train_idx=%d\n", + fat_tab->train_idx); -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP | ODM_CE)) - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Training MAC addr = %x:%x:%x:%x:%x:%x\n", - p_entry->hwaddr[5], p_entry->hwaddr[4], p_entry->hwaddr[3], p_entry->hwaddr[2], p_entry->hwaddr[1], p_entry->hwaddr[0])); -#else - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Training MAC addr = %x:%x:%x:%x:%x:%x\n", - p_entry->MacAddr[5], p_entry->MacAddr[4], p_entry->MacAddr[3], p_entry->MacAddr[2], p_entry->MacAddr[1], p_entry->MacAddr[0])); -#endif + PHYDM_DBG(dm, DBG_ANT_DIV, + "Training MAC addr = %x:%x:%x:%x:%x:%x\n", + entry->mac_addr[5], + entry->mac_addr[4], + entry->mac_addr[3], + entry->mac_addr[2], + entry->mac_addr[1], + entry->mac_addr[0]); 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) - { - struct _ADAPTER *adapter = p_dm_odm->adapter; - PMGNT_INFO p_mgnt_info = &adapter->MgntInfo; - - for (i = 0; i < 6; i++) { - bssid[i] = p_mgnt_info->bssid[i]; - /* dbg_print("bssid[%d]=%x\n", i, bssid[i]); */ - } - } -#endif - - /* odm_set_next_mac_addr_target(p_dm_odm); */ - - /* 1 Select MAC Address Filter */ - for (i = 0; i < 6; i++) { - if (bssid[i] != p_dm_fat_table->bssid[i]) { - is_match_bssid = false; - break; - } - } - if (is_match_bssid == false) { - /* Match MAC ADDR */ - value32 = (bssid[5] << 8) | bssid[4]; - odm_set_mac_reg(p_dm_odm, 0x7b4, 0xFFFF, value32); - value32 = (bssid[3] << 24) | (bssid[2] << 16) | (bssid[1] << 8) | bssid[0]; - odm_set_mac_reg(p_dm_odm, 0x7b0, MASKDWORD, value32); - } - - return is_match_bssid; -#endif - } #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( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; - u32 max_rssi_path_a = 0, pckcnt_path_a = 0; - u8 i, target_ant_path_a = 0; - bool is_pkt_filter_macth_path_a = false; + 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; - bool is_pkt_filter_macth_path_b = false; + 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 (!dm->is_linked) { /* @is_linked==False */ + PHYDM_DBG(dm, DBG_ANT_DIV, "[No Link!!!]\n"); - if (!p_dm_odm->is_linked) { /* is_linked==False */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[No Link!!!]\n")); - - if (p_dm_fat_table->is_become_linked == true) { - odm_ant_div_on_off(p_dm_odm, ANTDIV_OFF); - phydm_fast_training_enable(p_dm_odm, FAT_OFF); - odm_tx_by_tx_desc_or_reg(p_dm_odm, TX_BY_REG); - p_dm_fat_table->is_become_linked = p_dm_odm->is_linked; + if (fat_tab->is_become_linked == true) { + odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_A); + phydm_fast_training_enable(dm, FAT_OFF); + odm_tx_by_tx_desc_or_reg(dm, TX_BY_REG); + fat_tab->is_become_linked = dm->is_linked; } return; } else { - if (p_dm_fat_table->is_become_linked == false) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Linked!!!]\n")); - p_dm_fat_table->is_become_linked = p_dm_odm->is_linked; + if (fat_tab->is_become_linked == false) { + PHYDM_DBG(dm, DBG_ANT_DIV, "[Linked!!!]\n"); + fat_tab->is_become_linked = dm->is_linked; } } - if (*(p_dm_fat_table->p_force_tx_ant_by_desc) == false) { - if (p_dm_odm->is_one_entry_only == true) - odm_tx_by_tx_desc_or_reg(p_dm_odm, TX_BY_REG); + if (!(*fat_tab->p_force_tx_by_desc)) { + if (dm->is_one_entry_only == true) + odm_tx_by_tx_desc_or_reg(dm, TX_BY_REG); else - odm_tx_by_tx_desc_or_reg(p_dm_odm, TX_BY_DESC); + odm_tx_by_tx_desc_or_reg(dm, TX_BY_DESC); } - - if (p_dm_odm->support_ic_type == ODM_RTL8188E) - odm_set_bb_reg(p_dm_odm, 0x864, BIT(2) | BIT(1) | BIT(0), ((p_dm_odm->fat_comb_a) - 1)); + if (dm->support_ic_type == ODM_RTL8188E) + odm_set_bb_reg(dm, R_0x864, BIT(2) | BIT(1) | BIT(0), ((dm->fat_comb_a) - 1)); #if (RTL8192E_SUPPORT == 1) - else if (p_dm_odm->support_ic_type == ODM_RTL8192E) { - odm_set_bb_reg(p_dm_odm, 0xB38, BIT(2) | BIT1 | BIT0, ((p_dm_odm->fat_comb_a) - 1)); /* path-A */ /* ant combination=regB38[2:0]+1 */ - odm_set_bb_reg(p_dm_odm, 0xB38, BIT(18) | BIT17 | BIT16, ((p_dm_odm->fat_comb_b) - 1)); /* path-B */ /* ant combination=regB38[18:16]+1 */ + else if (dm->support_ic_type == ODM_RTL8192E) { + odm_set_bb_reg(dm, R_0xb38, BIT(2) | BIT(1) | BIT(0), ((dm->fat_comb_a) - 1)); /* path-A */ /* ant combination=regB38[2:0]+1 */ + odm_set_bb_reg(dm, R_0xb38, BIT(18) | BIT(17) | BIT(16), ((dm->fat_comb_b) - 1)); /* path-B */ /* ant combination=regB38[18:16]+1 */ } #endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("==>odm_fast_ant_training()\n")); + PHYDM_DBG(dm, DBG_ANT_DIV, "==>%s\n", __func__); - /* 1 TRAINING STATE */ - if (p_dm_fat_table->fat_state == FAT_TRAINING_STATE) { - /* 2 Caculate RSSI per Antenna */ + /* @1 TRAINING STATE */ + if (fat_tab->fat_state == FAT_TRAINING_STATE) { + /* @2 Caculate RSSI per Antenna */ - /* 3 [path-A]--------------------------- */ - for (i = 0; i < (p_dm_odm->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; + /* @3 [path-A]--------------------------- */ + for (i = 0; i < (dm->fat_comb_a); i++) { /* @i : antenna index */ + if (fat_tab->ant_rssi_cnt[i] == 0) + fat_tab->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]; + fat_tab->ant_ave_rssi[i] = fat_tab->ant_sum_rssi[i] / fat_tab->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 ; + if (fat_tab->ant_ave_rssi[i] > max_rssi_path_a) { + max_rssi_path_a = fat_tab->ant_ave_rssi[i]; + pckcnt_path_a = fat_tab->ant_rssi_cnt[i]; + target_ant_path_a = i; + } else if (fat_tab->ant_ave_rssi[i] == max_rssi_path_a) { + if (fat_tab->ant_rssi_cnt[i] > pckcnt_path_a) { + max_rssi_path_a = fat_tab->ant_ave_rssi[i]; + pckcnt_path_a = fat_tab->ant_rssi_cnt[i]; + target_ant_path_a = i; } } - ODM_RT_TRACE("*** 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]); + PHYDM_DBG( + "*** ant-index : [ %d ], counter = (( %d )), Avg RSSI = (( %d ))\n", + i, fat_tab->ant_rssi_cnt[i], + fat_tab->ant_ave_rssi[i]); } - #if 0 #if (RTL8192E_SUPPORT == 1) - /* 3 [path-B]--------------------------- */ - for (i = 0; i < (p_dm_odm->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]; + /* @3 [path-B]--------------------------- */ + for (i = 0; i < (dm->fat_comb_b); i++) { + if (fat_tab->antRSSIcnt_pathB[i] == 0) + fat_tab->antAveRSSI_pathB[i] = 0; + else { /* @(ant_rssi_cnt[i] != 0) */ + fat_tab->antAveRSSI_pathB[i] = fat_tab->antSumRSSI_pathB[i] / fat_tab->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 (fat_tab->antAveRSSI_pathB[i] > max_rssi_path_b) { + max_rssi_path_b = fat_tab->antAveRSSI_pathB[i]; + pckcnt_path_b = fat_tab->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 (fat_tab->antAveRSSI_pathB[i] == max_rssi_path_b) { + if (fat_tab->antRSSIcnt_pathB > pckcnt_path_b) { + max_rssi_path_b = fat_tab->antAveRSSI_pathB[i]; + target_ant_path_b = (u8)i; } } - if (p_dm_odm->fat_print_rssi == 1) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***{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])); + if (dm->fat_print_rssi == 1) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "***{path-B}: Sum RSSI[%d] = (( %d )), cnt RSSI [%d] = (( %d )), Avg RSSI[%d] = (( %d ))\n", + i, fat_tab->antSumRSSI_pathB[i], i, + fat_tab->antRSSIcnt_pathB[i], i, + fat_tab->antAveRSSI_pathB[i]); } } #endif #endif - /* 1 DECISION STATE */ + /* @1 DECISION STATE */ - /* 2 Select TRX Antenna */ + /* @2 Select TRX Antenna */ - phydm_fast_training_enable(p_dm_odm, FAT_OFF); + phydm_fast_training_enable(dm, FAT_OFF); - /* 3 [path-A]--------------------------- */ - if (is_pkt_filter_macth_path_a == false) { - /* ODM_RT_TRACE(p_dm_odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("{path-A}: None Packet is matched\n")); */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("{path-A}: None Packet is matched\n")); - odm_ant_div_on_off(p_dm_odm, ANTDIV_OFF); + /* @3 [path-A]--------------------------- */ + if (is_pkt_filter_macth_path_a == false) { +#if 0 + /* PHYDM_DBG(dm,DBG_ANT_DIV, "{path-A}: None Packet is matched\n"); */ +#endif + PHYDM_DBG(dm, DBG_ANT_DIV, + "{path-A}: None Packet is matched\n"); + odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_A); } else { - ODM_RT_TRACE("target_ant_path_a = (( %d )) , max_rssi_path_a = (( %d ))\n", target_ant_path_a, max_rssi_path_a); + 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_odm->support_ic_type == ODM_RTL8188E) - odm_set_bb_reg(p_dm_odm, 0x864, BIT(8) | BIT(7) | BIT(6), target_ant_path_a); - else if (p_dm_odm->support_ic_type == ODM_RTL8192E) { - odm_set_bb_reg(p_dm_odm, 0xB38, BIT(8) | BIT7 | BIT6, target_ant_path_a); /* Optional RX [pth-A] */ - } - /* 3 [ update TX ant ] */ - odm_update_tx_ant(p_dm_odm, target_ant_path_a, (p_dm_fat_table->train_idx)); + /* @3 [ update RX-optional ant ] Default RX is Omni, Optional RX is the best decision by FAT */ + if (dm->support_ic_type == ODM_RTL8188E) + odm_set_bb_reg(dm, R_0x864, BIT(8) | BIT(7) | BIT(6), target_ant_path_a); + else if (dm->support_ic_type == ODM_RTL8192E) + odm_set_bb_reg(dm, R_0xb38, BIT(8) | BIT(7) | BIT(6), target_ant_path_a); /* Optional RX [pth-A] */ + + /* @3 [ update TX ant ] */ + odm_update_tx_ant(dm, target_ant_path_a, (fat_tab->train_idx)); if (target_ant_path_a == 0) - odm_ant_div_on_off(p_dm_odm, ANTDIV_OFF); + odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_A); } #if 0 #if (RTL8192E_SUPPORT == 1) - /* 3 [path-B]--------------------------- */ + /* @3 [path-B]--------------------------- */ if (is_pkt_filter_macth_path_b == false) { - if (p_dm_odm->fat_print_rssi == 1) - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***[%d]{path-B}: None Packet is matched\n\n\n", __LINE__)); + if (dm->fat_print_rssi == 1) + PHYDM_DBG(dm, DBG_ANT_DIV, + "***[%d]{path-B}: None Packet is matched\n\n\n", + __LINE__); } else { - if (p_dm_odm->fat_print_rssi == 1) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, - (" ***target_ant_path_b = (( %d )) *** max_rssi = (( %d ))***\n\n\n", target_ant_path_b, max_rssi_path_b)); + if (dm->fat_print_rssi == 1) { + PHYDM_DBG(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_odm, 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_odm, 0x80c, BIT(21), 1); /* Reg80c[21]=1'b1 //from TX Info */ + odm_set_bb_reg(dm, R_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(dm, R_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; + fat_tab->antsel_pathB[fat_tab->train_idx] = target_ant_path_b; } #endif #endif - /* 2 Reset counter */ - for (i = 0; i < (p_dm_odm->fat_comb_a); i++) { - p_dm_fat_table->ant_sum_rssi[i] = 0; - p_dm_fat_table->ant_rssi_cnt[i] = 0; + /* @2 Reset counter */ + for (i = 0; i < (dm->fat_comb_a); i++) { + fat_tab->ant_sum_rssi[i] = 0; + fat_tab->ant_rssi_cnt[i] = 0; } - /* + /*@ #if (RTL8192E_SUPPORT == 1) - for(i=0; i<=(p_dm_odm->fat_comb_b); i++) + for(i=0; i<=(dm->fat_comb_b); i++) { - p_dm_fat_table->antSumRSSI_pathB[i] = 0; - p_dm_fat_table->antRSSIcnt_pathB[i] = 0; + fat_tab->antSumRSSI_pathB[i] = 0; + fat_tab->antRSSIcnt_pathB[i] = 0; } #endif */ - p_dm_fat_table->fat_state = FAT_PREPARE_STATE; + fat_tab->fat_state = FAT_PREPARE_STATE; return; } - /* 1 NORMAL STATE */ - if (p_dm_fat_table->fat_state == FAT_PREPARE_STATE) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Start Prepare state ]\n")); + /* @1 NORMAL STATE */ + if (fat_tab->fat_state == FAT_PREPARE_STATE) { + PHYDM_DBG(dm, DBG_ANT_DIV, "[ Start Prepare state ]\n"); - odm_set_next_mac_addr_target(p_dm_odm); + odm_set_next_mac_addr_target(dm); - /* 2 Prepare Training */ - p_dm_fat_table->fat_state = FAT_TRAINING_STATE; - phydm_fast_training_enable(p_dm_odm, FAT_ON); - odm_ant_div_on_off(p_dm_odm, ANTDIV_ON); /* enable HW AntDiv */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Start Training state]\n")); + /* @2 Prepare Training */ + fat_tab->fat_state = FAT_TRAINING_STATE; + phydm_fast_training_enable(dm, FAT_ON); + odm_ant_div_on_off(dm, ANTDIV_ON, ANT_PATH_A); + /* @enable HW AntDiv */ + PHYDM_DBG(dm, DBG_ANT_DIV, "[Start Training state]\n"); - odm_set_timer(p_dm_odm, &p_dm_odm->fast_ant_training_timer, p_dm_odm->antdiv_intvl); /* ms */ + odm_set_timer(dm, &dm->fast_ant_training_timer, dm->antdiv_intvl); /* @ms */ } - } -void -odm_fast_ant_training_callback( - void *p_dm_void -) +void odm_fast_ant_training_callback( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; #if (DM_ODM_SUPPORT_TYPE == ODM_CE) - struct _ADAPTER *padapter = p_dm_odm->adapter; - if (padapter->net_closed == _TRUE) + if (*(dm->is_net_closed) == true) return; - /* if(*p_dm_odm->p_is_net_closed == true) */ - /* return; */ #endif #if USE_WORKITEM - odm_schedule_work_item(&p_dm_odm->fast_ant_training_workitem); + odm_schedule_work_item(&dm->fast_ant_training_workitem); #else - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("******odm_fast_ant_training_callback******\n")); - odm_fast_ant_training(p_dm_odm); + PHYDM_DBG(dm, DBG_ANT_DIV, "******%s******\n", __func__); + odm_fast_ant_training(dm); #endif } -void -odm_fast_ant_training_work_item_callback( - void *p_dm_void -) +void odm_fast_ant_training_work_item_callback( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("******odm_fast_ant_training_work_item_callback******\n")); - odm_fast_ant_training(p_dm_odm); + struct dm_struct *dm = (struct dm_struct *)dm_void; + + PHYDM_DBG(dm, DBG_ANT_DIV, "******%s******\n", __func__); + odm_fast_ant_training(dm); } #endif -#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 - -u32 -phydm_construct_hl_beam_codeword( - void *p_dm_void, - u32 *beam_pattern_idx, - u32 ant_num -) +void odm_ant_div_init(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _SMART_ANTENNA_TRAINNING_ *pdm_sat_table = &(p_dm_odm->dm_sat_table); - u32 codeword = 0; - u32 data_tmp; - u32 i; - u32 break_counter = 0; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + struct sw_antenna_switch *swat_tab = &dm->dm_swat_table; - if (ant_num < 8) { - for (i = 0; i < (pdm_sat_table->ant_num_total); i++) { - /*ODM_RT_TRACE(p_dm_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 (*p_dm_odm->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_odm->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_odm->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_odm->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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _SMART_ANTENNA_TRAINNING_ *pdm_sat_table = &(p_dm_odm->dm_sat_table); - u8 i; - bool beam_ctrl_signal; - u32 one = 0x1; - u32 reg44_tmp_p, reg44_tmp_n, reg44_ori; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ SmartAnt ] Set Beam Pattern =0x%x\n", codeword)); - - reg44_ori = odm_get_mac_reg(p_dm_odm, 0x44, MASKDWORD); - /*ODM_RT_TRACE(p_dm_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 = (bool)((codeword & BIT(i)) >> i); - - if (p_dm_odm->debug_components & ODM_COMP_ANT_DIV) { - - if (i == (codeword_length - 1)) { - dbg_print("%d ]\n", beam_ctrl_signal); - /**/ - } else if (i == 0) { - dbg_print("Send codeword[1:24] ---> [ %d ", beam_ctrl_signal); - /**/ - } else if ((i % 4) == 3) { - dbg_print("%d | ", beam_ctrl_signal); - /**/ - } else { - dbg_print("%d ", beam_ctrl_signal); - /**/ - } - } - - if (p_dm_odm->support_ic_type == ODM_RTL8821) { -#if (RTL8821A_SUPPORT == 1) - reg44_tmp_p = reg44_ori & (~(BIT(11) | BIT10)); /*clean bit 10 & 11*/ - reg44_tmp_p |= ((1 << 11) | (beam_ctrl_signal << 10)); - reg44_tmp_n = reg44_ori & (~(BIT(11) | BIT(10))); - - /*ODM_RT_TRACE(p_dm_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_set_mac_reg(p_dm_odm, 0x44, MASKDWORD, reg44_tmp_p); - odm_set_mac_reg(p_dm_odm, 0x44, MASKDWORD, reg44_tmp_n); -#endif - } -#if (RTL8822B_SUPPORT == 1) - else if (p_dm_odm->support_ic_type == ODM_RTL8822B) { - - reg44_tmp_p = reg44_ori & (~(BIT(9) | BIT8)); /*clean bit 9 & 8*/ - reg44_tmp_p |= ((1 << 9) | (beam_ctrl_signal << 8)); - reg44_tmp_n = reg44_ori & (~(BIT(9) | BIT(8))); - - /* ODM_RT_TRACE(p_dm_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_set_mac_reg(p_dm_odm, 0x44, MASKDWORD, reg44_tmp_p); - ODM_delay_us(10); - odm_set_mac_reg(p_dm_odm, 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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; - struct _SMART_ANTENNA_TRAINNING_ *pdm_sat_table = &(p_dm_odm->dm_sat_table); - u32 i; - - pdm_sat_table->update_beam_codeword = phydm_construct_hl_beam_codeword(p_dm_odm, &(pdm_sat_table->rx_idle_beam[0]), pdm_sat_table->ant_num); - ODM_RT_TRACE(p_dm_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(p_dm_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(p_dm_odm, pdm_sat_table->update_beam_codeword, pdm_sat_table->data_codeword_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, - u32 *const dm_value, - u32 *_used, - char *output, - u32 *_out_len -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _SMART_ANTENNA_TRAINNING_ *pdm_sat_table = &(p_dm_odm->dm_sat_table); - u32 used = *_used; - u32 out_len = *_out_len; - u32 one = 0x1; - u32 codeword_length = pdm_sat_table->data_codeword_bit_num; - u32 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 << codeword_length)) { - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 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; - ODM_RT_TRACE(p_dm_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 = (bool)((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(p_dm_odm, pdm_sat_table->update_beam_codeword, pdm_sat_table->data_codeword_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]; - ODM_RT_TRACE(p_dm_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 = (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)); - } - } - -} - - -void -phydm_set_all_ant_same_beam_num( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _SMART_ANTENNA_TRAINNING_ *pdm_sat_table = &(p_dm_odm->dm_sat_table); - - if (p_dm_odm->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_odm, &(pdm_sat_table->rx_idle_beam[0]), pdm_sat_table->ant_num); - - ODM_RT_TRACE(p_dm_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(p_dm_odm, pdm_sat_table->update_beam_codeword, pdm_sat_table->data_codeword_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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _SMART_ANTENNA_TRAINNING_ *pdm_sat_table = &(p_dm_odm->dm_sat_table); - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &(p_dm_odm->dm_fat_table); - struct _sw_antenna_switch_ *p_dm_swat_table = &p_dm_odm->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_odm->is_linked) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[No Link!!!]\n")); - - if (p_dm_fat_table->is_become_linked == true) { - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Link->no Link\n")); - p_dm_fat_table->fat_state = FAT_BEFORE_LINK_STATE; - odm_ant_div_on_off(p_dm_odm, ANTDIV_OFF); - odm_tx_by_tx_desc_or_reg(p_dm_odm, TX_BY_REG); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("change to (( %d )) FAT_state\n", p_dm_fat_table->fat_state)); - - p_dm_fat_table->is_become_linked = p_dm_odm->is_linked; - } - return; - - } else { - if (p_dm_fat_table->is_become_linked == false) { - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Linked !!!]\n")); - - p_dm_fat_table->fat_state = FAT_PREPARE_STATE; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("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_odm);*/ - - p_dm_fat_table->is_become_linked = p_dm_odm->is_linked; - } - } - - if (*(p_dm_fat_table->p_force_tx_ant_by_desc) == false) { - if (p_dm_odm->is_one_entry_only == true) - odm_tx_by_tx_desc_or_reg(p_dm_odm, TX_BY_REG); - else - odm_tx_by_tx_desc_or_reg(p_dm_odm, TX_BY_DESC); - } - - /*ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("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) { - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 3. In Decision state]\n")); - phydm_fast_training_enable(p_dm_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(p_dm_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(p_dm_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(p_dm_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(p_dm_odm, &rssi_sorting_seq[0], &rank_idx_seq[0], &rank_idx_out[0], SUPPORT_BEAM_PATTERN_NUM);*/ - - /* - ODM_RT_TRACE(p_dm_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(p_dm_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(p_dm_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) { - target_ant = i; - max_beam_ant_rssi = target_ant_beam_max_rssi[i]; - /*ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("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; - - ODM_RT_TRACE(p_dm_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 (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_odm, (u8)target_ant); - - /* [ update TX ant ]*/ - odm_update_tx_ant(p_dm_odm, (u8)target_ant, (p_dm_fat_table->train_idx)); - } - - /*set beam in each antenna*/ - phydm_update_rx_idle_beam(p_dm_odm); - - odm_ant_div_on_off(p_dm_odm, 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) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2. In Training state]\n")); - - ODM_RT_TRACE(p_dm_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(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[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_odm); - - } else { - pdm_sat_table->fast_training_beam_num++; - - ODM_RT_TRACE(p_dm_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(p_dm_odm); - p_dm_fat_table->fat_state = FAT_TRAINING_STATE; - - } - } - pdm_sat_table->pre_fast_training_beam_num = pdm_sat_table->fast_training_beam_num; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[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) { - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\n\n[ 1. In Prepare state]\n")); - - if (p_dm_odm->pre_traffic_load == (p_dm_odm->traffic_load)) { - if (pdm_sat_table->decision_holding_period != 0) { - ODM_RT_TRACE(p_dm_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 (p_dm_odm->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; - } - } - ODM_RT_TRACE(p_dm_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(p_dm_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_fast_training_enable(p_dm_odm, FAT_OFF); - pdm_sat_table->pre_beacon_counter = pdm_sat_table->beacon_counter; - pdm_sat_table->update_beam_idx = 0; - - if (*p_dm_odm->p_band_type == ODM_BAND_5G) { - ODM_RT_TRACE(p_dm_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(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Set 2.4G ant\n")); - used_ant = pdm_sat_table->first_train_ant; - } - - odm_update_rx_idle_ant(p_dm_odm, (u8)used_ant); - -#else - /* Set training MAC addr. of target */ - odm_set_next_mac_addr_target(p_dm_odm); - phydm_fast_training_enable(p_dm_odm, FAT_ON); -#endif - - odm_ant_div_on_off(p_dm_odm, 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_odm); - 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_odm = &p_hal_data->DM_OutSrc; - struct _SMART_ANTENNA_TRAINNING_ *pdm_sat_table = &(p_dm_odm->dm_sat_table); - -#if DEV_BUS_TYPE != RT_PCI_INTERFACE - pdm_sat_table->pkt_skip_statistic_en = 1; -#endif - ODM_RT_TRACE(p_dm_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(p_dm_odm, pdm_sat_table->update_beam_codeword, pdm_sat_table->data_codeword_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 - ODM_RT_TRACE(p_dm_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( - 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_odm = &p_hal_data->DM_OutSrc; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ SmartAnt ] Beam decision Workitem Callback\n")); - odm_fast_ant_training_hl_smart_antenna_type1(p_dm_odm); -} -#endif - -#endif /*#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1*/ - -void -odm_ant_div_init( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; - struct _sw_antenna_switch_ *p_dm_swat_table = &p_dm_odm->dm_swat_table; - - - if (!(p_dm_odm->support_ability & ODM_BB_ANT_DIV)) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Return!!!] Not Support Antenna Diversity Function\n")); + if (!(dm->support_ability & ODM_BB_ANT_DIV)) { + PHYDM_DBG(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) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[2G AntDiv Init]: Only Support 2G Antenna Diversity Function\n")); - if (!(p_dm_odm->support_ic_type & ODM_ANTDIV_2G_SUPPORT_IC)) + if (fat_tab->ant_div_2g_5g == ODM_ANTDIV_2G) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "[2G AntDiv Init]: Only Support 2G Antenna Diversity Function\n"); + if (!(dm->support_ic_type & ODM_ANTDIV_2G_SUPPORT_IC)) return; - } else if (p_dm_fat_table->ant_div_2g_5g == ODM_ANTDIV_5G) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[5G AntDiv Init]: Only Support 5G Antenna Diversity Function\n")); - if (!(p_dm_odm->support_ic_type & ODM_ANTDIV_5G_SUPPORT_IC)) + } else if (fat_tab->ant_div_2g_5g == ODM_ANTDIV_5G) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "[5G AntDiv Init]: Only Support 5G Antenna Diversity Function\n"); + if (!(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)) - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[2G & 5G AntDiv Init]:Support Both 2G & 5G Antenna Diversity Function\n")); + } else if (fat_tab->ant_div_2g_5g == (ODM_ANTDIV_2G | ODM_ANTDIV_5G)) + PHYDM_DBG(dm, DBG_ANT_DIV, + "[2G & 5G AntDiv Init]:Support Both 2G & 5G Antenna Diversity Function\n"); #endif - /* --- */ + /* @--- */ - /* 2 [--General---] */ - p_dm_odm->antdiv_period = 0; + /* @2 [--General---] */ + dm->antdiv_period = 0; - p_dm_fat_table->is_become_linked = false; - p_dm_fat_table->ant_div_on_off = 0xff; + fat_tab->is_become_linked = false; + fat_tab->ant_div_on_off = 0xff; - /* 3 - AP - */ +/* @3 - AP - */ #if (DM_ODM_SUPPORT_TYPE == ODM_AP) -#if (BEAMFORMING_SUPPORT == 1) +#ifdef PHYDM_BEAMFORMING_SUPPORT #if (DM_ODM_SUPPORT_TYPE == ODM_AP) - odm_bdc_init(p_dm_odm); + odm_bdc_init(dm); #endif #endif - /* 3 - WIN - */ +/* @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; + swat_tab->ant_5g = MAIN_ANT; + swat_tab->ant_2g = MAIN_ANT; #endif - /* 2 [---Set MAIN_ANT as default antenna if Auto-ant enable---] */ - odm_ant_div_on_off(p_dm_odm, ANTDIV_OFF); + /* @2 [---Set MAIN_ANT as default antenna if Auto-ant enable---] */ + if (fat_tab->div_path_type == ANT_PATH_A) + odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_A); + else if (fat_tab->div_path_type == ANT_PATH_B) + odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_B); + else if (fat_tab->div_path_type == ANT_PATH_AB) + odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_AB); - p_dm_odm->ant_type = ODM_AUTO_ANT; + 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_odm, MAIN_ANT); - phydm_keep_rx_ack_ant_by_tx_ant_time(p_dm_odm, 0); /* Timming issue: keep Rx ant after tx for ACK ( 5 x 3.2 mu = 16mu sec)*/ + fat_tab->rx_idle_ant = 0xff; + /*to make RX-idle-antenna will be updated absolutly*/ + odm_update_rx_idle_ant(dm, MAIN_ANT); + phydm_keep_rx_ack_ant_by_tx_ant_time(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); + /* @2 [---Set TX Antenna---] */ + if (!fat_tab->p_force_tx_by_desc) { + fat_tab->force_tx_by_desc = 0; + fat_tab->p_force_tx_by_desc = &fat_tab->force_tx_by_desc; } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("p_force_tx_ant_by_desc = %d\n", *p_dm_fat_table->p_force_tx_ant_by_desc)); + PHYDM_DBG(dm, DBG_ANT_DIV, "p_force_tx_by_desc = %d\n", + *fat_tab->p_force_tx_by_desc); - if (*(p_dm_fat_table->p_force_tx_ant_by_desc) == true) - odm_tx_by_tx_desc_or_reg(p_dm_odm, TX_BY_DESC); + if (*fat_tab->p_force_tx_by_desc) + odm_tx_by_tx_desc_or_reg(dm, TX_BY_DESC); else - odm_tx_by_tx_desc_or_reg(p_dm_odm, TX_BY_REG); + odm_tx_by_tx_desc_or_reg(dm, TX_BY_REG); - - /* 2 [--88E---] */ - if (p_dm_odm->support_ic_type == ODM_RTL8188E) { + /* @2 [--88E---] */ + if (dm->support_ic_type == ODM_RTL8188E) { #if (RTL8188E_SUPPORT == 1) - /* p_dm_odm->ant_div_type = CGCS_RX_HW_ANTDIV; */ - /* p_dm_odm->ant_div_type = CG_TRX_HW_ANTDIV; */ - /* p_dm_odm->ant_div_type = CG_TRX_SMART_ANTDIV; */ + /* @dm->ant_div_type = CGCS_RX_HW_ANTDIV; */ + /* @dm->ant_div_type = CG_TRX_HW_ANTDIV; */ + /* @dm->ant_div_type = CG_TRX_SMART_ANTDIV; */ - if ((p_dm_odm->ant_div_type != CGCS_RX_HW_ANTDIV) && (p_dm_odm->ant_div_type != CG_TRX_HW_ANTDIV) && (p_dm_odm->ant_div_type != CG_TRX_SMART_ANTDIV)) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Return!!!] 88E Not Supprrt This AntDiv type\n")); - p_dm_odm->support_ability &= ~(ODM_BB_ANT_DIV); + if (dm->ant_div_type != CGCS_RX_HW_ANTDIV && + dm->ant_div_type != CG_TRX_HW_ANTDIV && + dm->ant_div_type != CG_TRX_SMART_ANTDIV) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "[Return!!!] 88E Not Supprrt This AntDiv type\n"); + dm->support_ability &= ~(ODM_BB_ANT_DIV); return; } - if (p_dm_odm->ant_div_type == CGCS_RX_HW_ANTDIV) - odm_rx_hw_ant_div_init_88e(p_dm_odm); - else if (p_dm_odm->ant_div_type == CG_TRX_HW_ANTDIV) - odm_trx_hw_ant_div_init_88e(p_dm_odm); + if (dm->ant_div_type == CGCS_RX_HW_ANTDIV) + odm_rx_hw_ant_div_init_88e(dm); + else if (dm->ant_div_type == CG_TRX_HW_ANTDIV) + odm_trx_hw_ant_div_init_88e(dm); #if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) || (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) - else if (p_dm_odm->ant_div_type == CG_TRX_SMART_ANTDIV) - odm_smart_hw_ant_div_init_88e(p_dm_odm); + else if (dm->ant_div_type == CG_TRX_SMART_ANTDIV) + odm_smart_hw_ant_div_init_88e(dm); #endif #endif } - /* 2 [--92E---] */ +/* @2 [--92E---] */ #if (RTL8192E_SUPPORT == 1) - else if (p_dm_odm->support_ic_type == ODM_RTL8192E) { - /* p_dm_odm->ant_div_type = CGCS_RX_HW_ANTDIV; */ - /* p_dm_odm->ant_div_type = CG_TRX_HW_ANTDIV; */ - /* p_dm_odm->ant_div_type = CG_TRX_SMART_ANTDIV; */ + else if (dm->support_ic_type == ODM_RTL8192E) { + /* @dm->ant_div_type = CGCS_RX_HW_ANTDIV; */ + /* @dm->ant_div_type = CG_TRX_HW_ANTDIV; */ + /* @dm->ant_div_type = CG_TRX_SMART_ANTDIV; */ - if ((p_dm_odm->ant_div_type != CGCS_RX_HW_ANTDIV) && (p_dm_odm->ant_div_type != CG_TRX_HW_ANTDIV) && (p_dm_odm->ant_div_type != CG_TRX_SMART_ANTDIV)) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Return!!!] 8192E Not Supprrt This AntDiv type\n")); - p_dm_odm->support_ability &= ~(ODM_BB_ANT_DIV); + if (dm->ant_div_type != CGCS_RX_HW_ANTDIV && + dm->ant_div_type != CG_TRX_HW_ANTDIV && + dm->ant_div_type != CG_TRX_SMART_ANTDIV) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "[Return!!!] 8192E Not Supprrt This AntDiv type\n"); + dm->support_ability &= ~(ODM_BB_ANT_DIV); return; } - if (p_dm_odm->ant_div_type == CGCS_RX_HW_ANTDIV) - odm_rx_hw_ant_div_init_92e(p_dm_odm); - else if (p_dm_odm->ant_div_type == CG_TRX_HW_ANTDIV) - odm_trx_hw_ant_div_init_92e(p_dm_odm); + if (dm->ant_div_type == CGCS_RX_HW_ANTDIV) + odm_rx_hw_ant_div_init_92e(dm); + else if (dm->ant_div_type == CG_TRX_HW_ANTDIV) + odm_trx_hw_ant_div_init_92e(dm); #if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) || (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) - else if (p_dm_odm->ant_div_type == CG_TRX_SMART_ANTDIV) - odm_smart_hw_ant_div_init_92e(p_dm_odm); + else if (dm->ant_div_type == CG_TRX_SMART_ANTDIV) + odm_smart_hw_ant_div_init_92e(dm); #endif - } #endif - /* 2 [--8723B---] */ + /* @2 [--92F---] */ +#if (RTL8192F_SUPPORT == 1) + else if (dm->support_ic_type == ODM_RTL8192F) { + /* @dm->ant_div_type = CGCS_RX_HW_ANTDIV; */ + /* @dm->ant_div_type = CG_TRX_HW_ANTDIV; */ + /* @dm->ant_div_type = CG_TRX_SMART_ANTDIV; */ + + if (dm->ant_div_type != CGCS_RX_HW_ANTDIV) { + if (dm->ant_div_type != CG_TRX_HW_ANTDIV) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "[Return!!!] 8192F Not Supprrt This AntDiv type\n"); + dm->support_ability &= ~(ODM_BB_ANT_DIV); + return; + } + } + if (dm->ant_div_type == CGCS_RX_HW_ANTDIV) + odm_rx_hw_ant_div_init_92f(dm); + else if (dm->ant_div_type == CG_TRX_HW_ANTDIV) + odm_trx_hw_ant_div_init_92f(dm); + } +#endif + +#if (RTL8197F_SUPPORT == 1) + else if (dm->support_ic_type == ODM_RTL8197F) { + dm->ant_div_type = CGCS_RX_HW_ANTDIV; + + if (dm->ant_div_type != CGCS_RX_HW_ANTDIV) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "[Return!!!] 8197F Not Supprrt This AntDiv type\n"); + dm->support_ability &= ~(ODM_BB_ANT_DIV); + return; + } + phydm_rx_hw_ant_div_init_97f(dm); + } +#endif +/* @2 [--8723B---] */ #if (RTL8723B_SUPPORT == 1) - else if (p_dm_odm->support_ic_type == ODM_RTL8723B) { - p_dm_odm->ant_div_type = S0S1_SW_ANTDIV; - /* p_dm_odm->ant_div_type = CG_TRX_HW_ANTDIV; */ + else if (dm->support_ic_type == ODM_RTL8723B) { + dm->ant_div_type = S0S1_SW_ANTDIV; + /* @dm->ant_div_type = CG_TRX_HW_ANTDIV; */ - if (p_dm_odm->ant_div_type != S0S1_SW_ANTDIV && p_dm_odm->ant_div_type != CG_TRX_HW_ANTDIV) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Return!!!] 8723B Not Supprrt This AntDiv type\n")); - p_dm_odm->support_ability &= ~(ODM_BB_ANT_DIV); + if (dm->ant_div_type != S0S1_SW_ANTDIV && + dm->ant_div_type != CG_TRX_HW_ANTDIV) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "[Return!!!] 8723B Not Supprrt This AntDiv type\n"); + dm->support_ability &= ~(ODM_BB_ANT_DIV); return; } - if (p_dm_odm->ant_div_type == S0S1_SW_ANTDIV) - odm_s0s1_sw_ant_div_init_8723b(p_dm_odm); - else if (p_dm_odm->ant_div_type == CG_TRX_HW_ANTDIV) - odm_trx_hw_ant_div_init_8723b(p_dm_odm); + if (dm->ant_div_type == S0S1_SW_ANTDIV) + odm_s0s1_sw_ant_div_init_8723b(dm); + else if (dm->ant_div_type == CG_TRX_HW_ANTDIV) + odm_trx_hw_ant_div_init_8723b(dm); } #endif - /*2 [--8723D---]*/ +/*@2 [--8723D---]*/ #if (RTL8723D_SUPPORT == 1) - else if (p_dm_odm->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); + else if (dm->support_ic_type == ODM_RTL8723D) { + if (fat_tab->p_default_s0_s1 == NULL) { + fat_tab->default_s0_s1 = 1; + fat_tab->p_default_s0_s1 = &fat_tab->default_s0_s1; } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("default_s0_s1 = %d\n", *p_dm_fat_table->p_default_s0_s1)); + PHYDM_DBG(dm, DBG_ANT_DIV, "default_s0_s1 = %d\n", + *fat_tab->p_default_s0_s1); - if (*(p_dm_fat_table->p_default_s0_s1) == true) - odm_update_rx_idle_ant(p_dm_odm, MAIN_ANT); + if (*fat_tab->p_default_s0_s1 == true) + odm_update_rx_idle_ant(dm, MAIN_ANT); else - odm_update_rx_idle_ant(p_dm_odm, AUX_ANT); + odm_update_rx_idle_ant(dm, AUX_ANT); - if (p_dm_odm->ant_div_type == S0S1_TRX_HW_ANTDIV) - odm_trx_hw_ant_div_init_8723d(p_dm_odm); + if (dm->ant_div_type == S0S1_TRX_HW_ANTDIV) + odm_trx_hw_ant_div_init_8723d(dm); + else if (dm->ant_div_type == S0S1_SW_ANTDIV) + odm_s0s1_sw_ant_div_init_8723d(dm); else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Return!!!] 8723D Not Supprrt This AntDiv type\n")); - p_dm_odm->support_ability &= ~(ODM_BB_ANT_DIV); + PHYDM_DBG(dm, DBG_ANT_DIV, + "[Return!!!] 8723D Not Supprrt This AntDiv type\n"); + dm->support_ability &= ~(ODM_BB_ANT_DIV); return; } - } #endif - /* 2 [--8811A 8821A---] */ +#if (RTL8721D_SUPPORT == 1) + else if (dm->support_ic_type == ODM_RTL8721D) { + /* @dm->ant_div_type = CG_TRX_HW_ANTDIV; */ + + if (dm->ant_div_type != CG_TRX_HW_ANTDIV) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "[Return!!!] 8721D Not Supprrt This AntDiv type\n"); + dm->support_ability &= ~(ODM_BB_ANT_DIV); + return; + } + if (dm->ant_div_type == CG_TRX_HW_ANTDIV) + odm_trx_hw_ant_div_init_8721d(dm); + } +#endif +/* @2 [--8811A 8821A---] */ #if (RTL8821A_SUPPORT == 1) - else if (p_dm_odm->support_ic_type == ODM_RTL8821) { + else if (dm->support_ic_type == ODM_RTL8821) { #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 - p_dm_odm->ant_div_type = HL_SW_SMART_ANT_TYPE1; + dm->ant_div_type = HL_SW_SMART_ANT_TYPE1; - if (p_dm_odm->ant_div_type == HL_SW_SMART_ANT_TYPE1) { - - odm_trx_hw_ant_div_init_8821a(p_dm_odm); - phydm_hl_smart_ant_type1_init_8821a(p_dm_odm); + if (dm->ant_div_type == HL_SW_SMART_ANT_TYPE1) { + odm_trx_hw_ant_div_init_8821a(dm); + phydm_hl_smart_ant_type1_init_8821a(dm); } else #endif { - /*p_dm_odm->ant_div_type = CG_TRX_HW_ANTDIV;*/ - p_dm_odm->ant_div_type = S0S1_SW_ANTDIV; +#ifdef ODM_CONFIG_BT_COEXIST + dm->ant_div_type = S0S1_SW_ANTDIV; +#else + dm->ant_div_type = CG_TRX_HW_ANTDIV; +#endif - if (p_dm_odm->ant_div_type != CG_TRX_HW_ANTDIV && p_dm_odm->ant_div_type != S0S1_SW_ANTDIV) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Return!!!] 8821A & 8811A Not Supprrt This AntDiv type\n")); - p_dm_odm->support_ability &= ~(ODM_BB_ANT_DIV); + if (dm->ant_div_type != CG_TRX_HW_ANTDIV && + dm->ant_div_type != S0S1_SW_ANTDIV) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "[Return!!!] 8821A & 8811A Not Supprrt This AntDiv type\n"); + dm->support_ability &= ~(ODM_BB_ANT_DIV); return; } - if (p_dm_odm->ant_div_type == CG_TRX_HW_ANTDIV) - odm_trx_hw_ant_div_init_8821a(p_dm_odm); - else if (p_dm_odm->ant_div_type == S0S1_SW_ANTDIV) - odm_s0s1_sw_ant_div_init_8821a(p_dm_odm); + if (dm->ant_div_type == CG_TRX_HW_ANTDIV) + odm_trx_hw_ant_div_init_8821a(dm); + else if (dm->ant_div_type == S0S1_SW_ANTDIV) + odm_s0s1_sw_ant_div_init_8821a(dm); } } #endif - /* 2 [--8821C---] */ +/* @2 [--8821C---] */ #if (RTL8821C_SUPPORT == 1) - else if (p_dm_odm->support_ic_type == ODM_RTL8821C) { - p_dm_odm->ant_div_type = CG_TRX_HW_ANTDIV; - if (p_dm_odm->ant_div_type != CG_TRX_HW_ANTDIV) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Return!!!] 8821C Not Supprrt This AntDiv type\n")); - p_dm_odm->support_ability &= ~(ODM_BB_ANT_DIV); + else if (dm->support_ic_type == ODM_RTL8821C) { + dm->ant_div_type = S0S1_SW_ANTDIV; + if (dm->ant_div_type != S0S1_SW_ANTDIV) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "[Return!!!] 8821C Not Supprrt This AntDiv type\n"); + dm->support_ability &= ~(ODM_BB_ANT_DIV); return; } - odm_trx_hw_ant_div_init_8821c(p_dm_odm); + phydm_s0s1_sw_ant_div_init_8821c(dm); + odm_trx_hw_ant_div_init_8821c(dm); } #endif - /* 2 [--8881A---] */ +/* @2 [--8881A---] */ #if (RTL8881A_SUPPORT == 1) - else if (p_dm_odm->support_ic_type == ODM_RTL8881A) { - /* p_dm_odm->ant_div_type = CGCS_RX_HW_ANTDIV; */ - /* p_dm_odm->ant_div_type = CG_TRX_HW_ANTDIV; */ + else if (dm->support_ic_type == ODM_RTL8881A) { + /* @dm->ant_div_type = CGCS_RX_HW_ANTDIV; */ + /* @dm->ant_div_type = CG_TRX_HW_ANTDIV; */ - if (p_dm_odm->ant_div_type == CG_TRX_HW_ANTDIV) { - - odm_trx_hw_ant_div_init_8881a(p_dm_odm); - /**/ + if (dm->ant_div_type == CG_TRX_HW_ANTDIV) { + odm_trx_hw_ant_div_init_8881a(dm); } else { - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Return!!!] 8881A Not Supprrt This AntDiv type\n")); - p_dm_odm->support_ability &= ~(ODM_BB_ANT_DIV); + PHYDM_DBG(dm, DBG_ANT_DIV, + "[Return!!!] 8881A Not Supprrt This AntDiv type\n"); + dm->support_ability &= ~(ODM_BB_ANT_DIV); return; } - odm_trx_hw_ant_div_init_8881a(p_dm_odm); + odm_trx_hw_ant_div_init_8881a(dm); } #endif - /* 2 [--8812---] */ +/* @2 [--8812---] */ #if (RTL8812A_SUPPORT == 1) - else if (p_dm_odm->support_ic_type == ODM_RTL8812) { - /* p_dm_odm->ant_div_type = CG_TRX_HW_ANTDIV; */ + else if (dm->support_ic_type == ODM_RTL8812) { + /* @dm->ant_div_type = CG_TRX_HW_ANTDIV; */ - if (p_dm_odm->ant_div_type != CG_TRX_HW_ANTDIV) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Return!!!] 8812A Not Supprrt This AntDiv type\n")); - p_dm_odm->support_ability &= ~(ODM_BB_ANT_DIV); + if (dm->ant_div_type != CG_TRX_HW_ANTDIV) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "[Return!!!] 8812A Not Supprrt This AntDiv type\n"); + dm->support_ability &= ~(ODM_BB_ANT_DIV); return; } - odm_trx_hw_ant_div_init_8812a(p_dm_odm); + odm_trx_hw_ant_div_init_8812a(dm); } #endif - /*[--8188F---]*/ +/*@[--8188F---]*/ #if (RTL8188F_SUPPORT == 1) - else if (p_dm_odm->support_ic_type == ODM_RTL8188F) { - - p_dm_odm->ant_div_type = S0S1_SW_ANTDIV; - odm_s0s1_sw_ant_div_init_8188f(p_dm_odm); + else if (dm->support_ic_type == ODM_RTL8188F) { + dm->ant_div_type = S0S1_SW_ANTDIV; + odm_s0s1_sw_ant_div_init_8188f(dm); } #endif - /*[--8822B---]*/ +/*@[--8822B---]*/ #if (RTL8822B_SUPPORT == 1) - else if (p_dm_odm->support_ic_type == ODM_RTL8822B) { -#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 - p_dm_odm->ant_div_type = HL_SW_SMART_ANT_TYPE1; + else if (dm->support_ic_type == ODM_RTL8822B) { + dm->ant_div_type = CG_TRX_HW_ANTDIV; - if (p_dm_odm->ant_div_type == HL_SW_SMART_ANT_TYPE1) + if (dm->ant_div_type != CG_TRX_HW_ANTDIV) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "[Return!!!] 8822B Not Supprrt This AntDiv type\n"); + dm->support_ability &= ~(ODM_BB_ANT_DIV); + return; + } + phydm_trx_hw_ant_div_init_22b(dm); +#ifdef CONFIG_HL_SMART_ANTENNA_TYPE2 + dm->ant_div_type = HL_SW_SMART_ANT_TYPE2; - phydm_hl_smart_ant_type1_init_8822b(p_dm_odm); + if (dm->ant_div_type == HL_SW_SMART_ANT_TYPE2) + phydm_hl_smart_ant_type2_init_8822b(dm); #endif } #endif - /* - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** support_ic_type=[%lu]\n",p_dm_odm->support_ic_type)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** AntDiv support_ability=[%lu]\n",(p_dm_odm->support_ability & ODM_BB_ANT_DIV)>>6)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** AntDiv type=[%d]\n",p_dm_odm->ant_div_type)); - */ +/*@PHYDM_DBG(dm, DBG_ANT_DIV, "*** support_ic_type=[%lu]\n",*/ +/*dm->support_ic_type);*/ +/*PHYDM_DBG(dm, DBG_ANT_DIV, "*** AntDiv support_ability=[%lu]\n",*/ +/* (dm->support_ability & ODM_BB_ANT_DIV)>>6);*/ +/*PHYDM_DBG(dm, DBG_ANT_DIV, "*** AntDiv type=[%d]\n",dm->ant_div_type);*/ } -void -odm_ant_div( - void *p_dm_void -) +void odm_ant_div(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTER *p_adapter = p_dm_odm->adapter; - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; -#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 - struct _SMART_ANTENNA_TRAINNING_ *pdm_sat_table = &(p_dm_odm->dm_sat_table); + struct dm_struct *dm = (struct dm_struct *)dm_void; + void *adapter = dm->adapter; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; +#if (defined(CONFIG_HL_SMART_ANTENNA)) + struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; #endif - if (*p_dm_odm->p_band_type == ODM_BAND_5G) { - if (p_dm_fat_table->idx_ant_div_counter_5g < p_dm_odm->antdiv_period) { - p_dm_fat_table->idx_ant_div_counter_5g++; +#ifdef ODM_EVM_ENHANCE_ANTDIV + if (dm->is_linked) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "tp_active_occur=((%d)), evm_method_enable=((%d))\n", + dm->tp_active_occur, fat_tab->evm_method_enable); + + if (dm->tp_active_occur == 1 && + fat_tab->evm_method_enable == 1) { + fat_tab->idx_ant_div_counter_5g = dm->antdiv_period; + fat_tab->idx_ant_div_counter_2g = dm->antdiv_period; + } + } +#endif + + if (*dm->band_type == ODM_BAND_5G) { + if (fat_tab->idx_ant_div_counter_5g < dm->antdiv_period) { + fat_tab->idx_ant_div_counter_5g++; return; } else - p_dm_fat_table->idx_ant_div_counter_5g = 0; - } else if (*p_dm_odm->p_band_type == ODM_BAND_2_4G) { - if (p_dm_fat_table->idx_ant_div_counter_2g < p_dm_odm->antdiv_period) { - p_dm_fat_table->idx_ant_div_counter_2g++; + fat_tab->idx_ant_div_counter_5g = 0; + } else if (*dm->band_type == ODM_BAND_2_4G) { + if (fat_tab->idx_ant_div_counter_2g < dm->antdiv_period) { + fat_tab->idx_ant_div_counter_2g++; return; } else - p_dm_fat_table->idx_ant_div_counter_2g = 0; + fat_tab->idx_ant_div_counter_2g = 0; } - /* ---------- */ - if (!(p_dm_odm->support_ability & ODM_BB_ANT_DIV)) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Return!!!] Not Support Antenna Diversity Function\n")); - return; - } +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN || DM_ODM_SUPPORT_TYPE == ODM_CE) - /* ---------- */ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - - if (p_dm_fat_table->enable_ctrl_frame_antdiv) { - - if ((p_dm_odm->data_frame_num <= 10) && (p_dm_odm->is_linked)) - p_dm_fat_table->use_ctrl_frame_antdiv = 1; + if (fat_tab->enable_ctrl_frame_antdiv) { + if (dm->data_frame_num <= 10 && dm->is_linked) + fat_tab->use_ctrl_frame_antdiv = 1; else - p_dm_fat_table->use_ctrl_frame_antdiv = 0; + fat_tab->use_ctrl_frame_antdiv = 0; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("use_ctrl_frame_antdiv = (( %d )), data_frame_num = (( %d ))\n", p_dm_fat_table->use_ctrl_frame_antdiv, p_dm_odm->data_frame_num)); - p_dm_odm->data_frame_num = 0; + PHYDM_DBG(dm, DBG_ANT_DIV, + "use_ctrl_frame_antdiv = (( %d )), data_frame_num = (( %d ))\n", + fat_tab->use_ctrl_frame_antdiv, dm->data_frame_num); + dm->data_frame_num = 0; } - if (p_adapter->MgntInfo.AntennaTest) - return; - { -#if (BEAMFORMING_SUPPORT == 1) - enum beamforming_cap beamform_cap = (p_dm_odm->beamforming_info.beamform_cap); +#ifdef PHYDM_BEAMFORMING_SUPPORT - if (beamform_cap & BEAMFORMEE_CAP) { /* BFmee On && Div On->Div Off */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ AntDiv : OFF ] BFmee ==1\n")); - if (p_dm_fat_table->fix_ant_bfee == 0) { - odm_ant_div_on_off(p_dm_odm, 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_odm->is_linked) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ AntDiv : ON ] BFmee ==0\n")); - if ((p_dm_odm->ant_div_type != S0S1_SW_ANTDIV)) - odm_ant_div_on_off(p_dm_odm, ANTDIV_ON); - - p_dm_fat_table->fix_ant_bfee = 0; + enum beamforming_cap beamform_cap = phydm_get_beamform_cap(dm); + PHYDM_DBG(dm, DBG_ANT_DIV, "is_bt_continuous_turn = ((%d))\n", + dm->is_bt_continuous_turn); + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ AntDiv Beam Cap ] cap= ((%d))\n", beamform_cap); + if (!dm->is_bt_continuous_turn) { + if ((beamform_cap & BEAMFORMEE_CAP) && + (!(*fat_tab->is_no_csi_feedback))) { + /* @BFmee On && Div On->Div Off */ + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ AntDiv : OFF ] BFmee ==1; cap= ((%d))\n", + beamform_cap); + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ AntDiv BF] is_no_csi_feedback= ((%d))\n", + *(fat_tab->is_no_csi_feedback)); + if (fat_tab->fix_ant_bfee == 0) { + odm_ant_div_on_off(dm, ANTDIV_OFF, + ANT_PATH_A); + fat_tab->fix_ant_bfee = 1; + } + return; + } else { /* @BFmee Off && Div Off->Div On */ + if (fat_tab->fix_ant_bfee == 1 && + dm->is_linked) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ AntDiv : ON ] BFmee ==0; cap=((%d))\n", + beamform_cap); + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ AntDiv BF] is_no_csi_feedback= ((%d))\n", + *fat_tab->is_no_csi_feedback); + if (dm->ant_div_type != S0S1_SW_ANTDIV) + odm_ant_div_on_off(dm, ANTDIV_ON + , ANT_PATH_A) + ; + fat_tab->fix_ant_bfee = 0; + } } + } else { + if (fat_tab->div_path_type == ANT_PATH_A) + odm_ant_div_on_off(dm, ANTDIV_ON, ANT_PATH_A); + else if (fat_tab->div_path_type == ANT_PATH_B) + odm_ant_div_on_off(dm, ANTDIV_ON, ANT_PATH_B); + else if (fat_tab->div_path_type == ANT_PATH_AB) + odm_ant_div_on_off(dm, ANTDIV_ON, ANT_PATH_AB); } #endif } #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) - /* ----------just for fool proof */ + /* @----------just for fool proof */ - if (p_dm_odm->antdiv_rssi) - p_dm_odm->debug_components |= ODM_COMP_ANT_DIV; + if (dm->antdiv_rssi) + dm->debug_components |= DBG_ANT_DIV; else - p_dm_odm->debug_components &= ~ODM_COMP_ANT_DIV; + dm->debug_components &= ~DBG_ANT_DIV; - if (p_dm_fat_table->ant_div_2g_5g == ODM_ANTDIV_2G) { - /* ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[ 2G AntDiv Running ]\n")); */ - if (!(p_dm_odm->support_ic_type & ODM_ANTDIV_2G_SUPPORT_IC)) + if (fat_tab->ant_div_2g_5g == ODM_ANTDIV_2G) { + if (!(dm->support_ic_type & ODM_ANTDIV_2G_SUPPORT_IC)) return; - } else if (p_dm_fat_table->ant_div_2g_5g == ODM_ANTDIV_5G) { - /* ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[ 5G AntDiv Running ]\n")); */ - if (!(p_dm_odm->support_ic_type & ODM_ANTDIV_5G_SUPPORT_IC)) + } else if (fat_tab->ant_div_2g_5g == ODM_ANTDIV_5G) { + if (!(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)) */ - /* { */ - /* ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[ 2G & 5G AntDiv Running ]\n")); */ - /* } */ #endif - /* ---------- */ + /* @---------- */ - if (p_dm_odm->antdiv_select == 1) - p_dm_odm->ant_type = ODM_FIX_MAIN_ANT; - else if (p_dm_odm->antdiv_select == 2) - p_dm_odm->ant_type = ODM_FIX_AUX_ANT; - else /* if (p_dm_odm->antdiv_select==0) */ - p_dm_odm->ant_type = ODM_AUTO_ANT; + if (dm->antdiv_select == 1) + dm->ant_type = ODM_FIX_MAIN_ANT; + else if (dm->antdiv_select == 2) + dm->ant_type = ODM_FIX_AUX_ANT; + else { /* @if (dm->antdiv_select==0) */ + dm->ant_type = ODM_AUTO_ANT; - /* ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("ant_type= (( %d )) , pre_ant_type= (( %d ))\n",p_dm_odm->ant_type,p_dm_odm->pre_ant_type)); */ - - if (p_dm_odm->ant_type != ODM_AUTO_ANT) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Fix Antenna at (( %s ))\n", (p_dm_odm->ant_type == ODM_FIX_MAIN_ANT) ? "MAIN" : "AUX")); - - if (p_dm_odm->ant_type != p_dm_odm->pre_ant_type) { - odm_ant_div_on_off(p_dm_odm, ANTDIV_OFF); - odm_tx_by_tx_desc_or_reg(p_dm_odm, TX_BY_REG); - - if (p_dm_odm->ant_type == ODM_FIX_MAIN_ANT) - odm_update_rx_idle_ant(p_dm_odm, MAIN_ANT); - else if (p_dm_odm->ant_type == ODM_FIX_AUX_ANT) - odm_update_rx_idle_ant(p_dm_odm, AUX_ANT); +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + /*Stop Antenna diversity for CMW500 testing case*/ + if (dm->consecutive_idlel_time >= 10) { + dm->ant_type = ODM_FIX_MAIN_ANT; + PHYDM_DBG(dm, DBG_ANT_DIV, + "[AntDiv: OFF] No TP case, consecutive_idlel_time=((%d))\n", + dm->consecutive_idlel_time); } - p_dm_odm->pre_ant_type = p_dm_odm->ant_type; +#endif + } + + /*PHYDM_DBG(dm, DBG_ANT_DIV,"ant_type= (%d), pre_ant_type= (%d)\n",*/ + /*dm->ant_type,dm->pre_ant_type); */ + + if (dm->ant_type != ODM_AUTO_ANT) { + PHYDM_DBG(dm, DBG_ANT_DIV, "Fix Antenna at (( %s ))\n", + (dm->ant_type == ODM_FIX_MAIN_ANT) ? "MAIN" : "AUX"); + + if (dm->ant_type != dm->pre_ant_type) { + odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_A); + odm_tx_by_tx_desc_or_reg(dm, TX_BY_REG); + + if (dm->ant_type == ODM_FIX_MAIN_ANT) + odm_update_rx_idle_ant(dm, MAIN_ANT); + else if (dm->ant_type == ODM_FIX_AUX_ANT) + odm_update_rx_idle_ant(dm, AUX_ANT); + } + dm->pre_ant_type = dm->ant_type; return; } else { - if (p_dm_odm->ant_type != p_dm_odm->pre_ant_type) { - odm_ant_div_on_off(p_dm_odm, ANTDIV_ON); - odm_tx_by_tx_desc_or_reg(p_dm_odm, TX_BY_DESC); + if (dm->ant_type != dm->pre_ant_type) { + odm_ant_div_on_off(dm, ANTDIV_ON, ANT_PATH_A); + odm_tx_by_tx_desc_or_reg(dm, TX_BY_DESC); } - p_dm_odm->pre_ant_type = p_dm_odm->ant_type; + dm->pre_ant_type = dm->ant_type; } +#if (defined(CONFIG_2T4R_ANTENNA)) + if (dm->ant_type2 != ODM_AUTO_ANT) { + PHYDM_DBG(dm, DBG_ANT_DIV, "PathB Fix Ant at (( %s ))\n", + (dm->ant_type2 == ODM_FIX_MAIN_ANT) ? "MAIN" : "AUX"); + if (dm->ant_type2 != dm->pre_ant_type2) { + odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_B); + odm_tx_by_tx_desc_or_reg(dm, TX_BY_REG); - /* 3 ----------------------------------------------------------------------------------------------------------- */ - /* 2 [--88E---] */ - if (p_dm_odm->support_ic_type == ODM_RTL8188E) { + if (dm->ant_type2 == ODM_FIX_MAIN_ANT) + phydm_update_rx_idle_ant_pathb(dm, MAIN_ANT); + else if (dm->ant_type2 == ODM_FIX_AUX_ANT) + phydm_update_rx_idle_ant_pathb(dm, AUX_ANT); + } + dm->pre_ant_type2 = dm->ant_type2; + return; + } + if (dm->ant_type2 != dm->pre_ant_type2) { + odm_ant_div_on_off(dm, ANTDIV_ON, ANT_PATH_B); + odm_tx_by_tx_desc_or_reg(dm, TX_BY_DESC); + } + dm->pre_ant_type2 = dm->ant_type2; + +#endif + +/*@ ----------------------------------------------- */ +/*@ [--8188E--] */ + if (dm->support_ic_type == ODM_RTL8188E) { #if (RTL8188E_SUPPORT == 1) - if (p_dm_odm->ant_div_type == CG_TRX_HW_ANTDIV || p_dm_odm->ant_div_type == CGCS_RX_HW_ANTDIV) - odm_hw_ant_div(p_dm_odm); + if (dm->ant_div_type == CG_TRX_HW_ANTDIV || + dm->ant_div_type == CGCS_RX_HW_ANTDIV) + odm_hw_ant_div(dm); -#if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) || (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) - else if (p_dm_odm->ant_div_type == CG_TRX_SMART_ANTDIV) - odm_fast_ant_training(p_dm_odm); +#if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) ||\ + (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) + else if (dm->ant_div_type == CG_TRX_SMART_ANTDIV) + odm_fast_ant_training(dm); #endif #endif - } - /* 2 [--92E---] */ +/*@ [--8192E--] */ #if (RTL8192E_SUPPORT == 1) - else if (p_dm_odm->support_ic_type == ODM_RTL8192E) { - if (p_dm_odm->ant_div_type == CGCS_RX_HW_ANTDIV || p_dm_odm->ant_div_type == CG_TRX_HW_ANTDIV) - odm_hw_ant_div(p_dm_odm); + else if (dm->support_ic_type == ODM_RTL8192E) { + if (dm->ant_div_type == CGCS_RX_HW_ANTDIV || + dm->ant_div_type == CG_TRX_HW_ANTDIV) + odm_hw_ant_div(dm); -#if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) || (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) - else if (p_dm_odm->ant_div_type == CG_TRX_SMART_ANTDIV) - odm_fast_ant_training(p_dm_odm); +#if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) ||\ + (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) + else if (dm->ant_div_type == CG_TRX_SMART_ANTDIV) + odm_fast_ant_training(dm); #endif - + } +#endif +/*@ [--8197F--] */ +#if (RTL8197F_SUPPORT == 1) + else if (dm->support_ic_type == ODM_RTL8197F) { + if (dm->ant_div_type == CGCS_RX_HW_ANTDIV) + odm_hw_ant_div(dm); } #endif #if (RTL8723B_SUPPORT == 1) - /* 2 [--8723B---] */ - else if (p_dm_odm->support_ic_type == ODM_RTL8723B) { - if (phydm_is_bt_enable_8723b(p_dm_odm)) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[BT is enable!!!]\n")); - if (p_dm_fat_table->is_become_linked == true) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Set REG 948[9:6]=0x0\n")); - if (p_dm_odm->support_ic_type == ODM_RTL8723B) - odm_set_bb_reg(p_dm_odm, 0x948, BIT(9) | BIT(8) | BIT(7) | BIT(6), 0x0); +/*@ [--8723B---] */ + else if (dm->support_ic_type == ODM_RTL8723B) { + if (phydm_is_bt_enable_8723b(dm)) { + PHYDM_DBG(dm, DBG_ANT_DIV, "[BT is enable!!!]\n"); + if (fat_tab->is_become_linked == true) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "Set REG 948[9:6]=0x0\n"); + if (dm->support_ic_type == ODM_RTL8723B) + odm_set_bb_reg(dm, R_0x948, 0x3c0, 0x0) + ; - p_dm_fat_table->is_become_linked = false; + fat_tab->is_become_linked = false; } } else { - if (p_dm_odm->ant_div_type == S0S1_SW_ANTDIV) { - -#ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY - odm_s0s1_sw_ant_div(p_dm_odm, SWAW_STEP_PEEK); -#endif - } else if (p_dm_odm->ant_div_type == CG_TRX_HW_ANTDIV) - odm_hw_ant_div(p_dm_odm); + if (dm->ant_div_type == S0S1_SW_ANTDIV) { + #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY + odm_s0s1_sw_ant_div(dm, SWAW_STEP_PEEK); + #endif + } else if (dm->ant_div_type == CG_TRX_HW_ANTDIV) + odm_hw_ant_div(dm); } } #endif - /*8723D*/ +/*@ [--8723D--]*/ #if (RTL8723D_SUPPORT == 1) - else if (p_dm_odm->support_ic_type == ODM_RTL8723D) { - - odm_hw_ant_div(p_dm_odm); - /**/ + else if (dm->support_ic_type == ODM_RTL8723D) { + if (dm->ant_div_type == S0S1_SW_ANTDIV) { + #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY + if (dm->antdiv_counter == CONFIG_ANTDIV_PERIOD) { + odm_s0s1_sw_ant_div(dm, SWAW_STEP_PEEK); + dm->antdiv_counter--; + } else { + dm->antdiv_counter--; + } + if (dm->antdiv_counter == 0) + dm->antdiv_counter = CONFIG_ANTDIV_PERIOD; + #endif + } else if (dm->ant_div_type == CG_TRX_HW_ANTDIV) { + odm_hw_ant_div(dm); + } } #endif - - /* 2 [--8821A---] */ +#if (RTL8721D_SUPPORT == 1) + else if (dm->support_ic_type == ODM_RTL8721D) { + if (dm->ant_div_type == CG_TRX_HW_ANTDIV) { + odm_hw_ant_div(dm); + } + } +#endif +/*@ [--8821A--] */ #if (RTL8821A_SUPPORT == 1) - else if (p_dm_odm->support_ic_type == ODM_RTL8821) { -#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 - if (p_dm_odm->ant_div_type == HL_SW_SMART_ANT_TYPE1) { - - if (pdm_sat_table->fix_beam_pattern_en != 0) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" [ SmartAnt ] Fix SmartAnt Pattern = 0x%x\n", pdm_sat_table->fix_beam_pattern_codeword)); + else if (dm->support_ic_type == ODM_RTL8821) { + #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 + if (dm->ant_div_type == HL_SW_SMART_ANT_TYPE1) { + if (sat_tab->fix_beam_pattern_en != 0) { + PHYDM_DBG(dm, DBG_ANT_DIV, + " [ SmartAnt ] Fix SmartAnt Pattern = 0x%x\n", + sat_tab->fix_beam_pattern_codeword); /*return;*/ } else { - /*ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ SmartAnt ] ant_div_type = HL_SW_SMART_ANT_TYPE1\n"));*/ - odm_fast_ant_training_hl_smart_antenna_type1(p_dm_odm); + odm_fast_ant_training_hl_smart_antenna_type1(dm); } } else -#endif + #endif { - - if (!p_dm_odm->is_bt_enabled) { /*BT disabled*/ - if (p_dm_odm->ant_div_type == S0S1_SW_ANTDIV) { - p_dm_odm->ant_div_type = CG_TRX_HW_ANTDIV; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" [S0S1_SW_ANTDIV] -> [CG_TRX_HW_ANTDIV]\n")); - /*odm_set_bb_reg(p_dm_odm, 0x8D4, BIT24, 1); */ - if (p_dm_fat_table->is_become_linked == true) - odm_ant_div_on_off(p_dm_odm, ANTDIV_ON); + #ifdef ODM_CONFIG_BT_COEXIST + if (!dm->bt_info_table.is_bt_enabled) { /*@BT disabled*/ + if (dm->ant_div_type == S0S1_SW_ANTDIV) { + dm->ant_div_type = CG_TRX_HW_ANTDIV; + PHYDM_DBG(dm, DBG_ANT_DIV, + " [S0S1_SW_ANTDIV] -> [CG_TRX_HW_ANTDIV]\n"); + /*odm_set_bb_reg(dm, 0x8d4, BIT24, 1);*/ + if (fat_tab->is_become_linked == true) + odm_ant_div_on_off(dm, + ANTDIV_ON, + ANT_PATH_A); } - } else { /*BT enabled*/ + } else { /*@BT enabled*/ - if (p_dm_odm->ant_div_type == CG_TRX_HW_ANTDIV) { - p_dm_odm->ant_div_type = S0S1_SW_ANTDIV; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" [CG_TRX_HW_ANTDIV] -> [S0S1_SW_ANTDIV]\n")); - /*odm_set_bb_reg(p_dm_odm, 0x8D4, BIT24, 0);*/ - odm_ant_div_on_off(p_dm_odm, ANTDIV_OFF); + if (dm->ant_div_type == CG_TRX_HW_ANTDIV) { + dm->ant_div_type = S0S1_SW_ANTDIV; + PHYDM_DBG(dm, DBG_ANT_DIV, + " [CG_TRX_HW_ANTDIV] -> [S0S1_SW_ANTDIV]\n"); + /*odm_set_bb_reg(dm, 0x8d4, BIT24, 0);*/ + odm_ant_div_on_off(dm, ANTDIV_OFF, + ANT_PATH_A); } } + #endif - if (p_dm_odm->ant_div_type == S0S1_SW_ANTDIV) { - -#ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY - odm_s0s1_sw_ant_div(p_dm_odm, SWAW_STEP_PEEK); -#endif - } else if (p_dm_odm->ant_div_type == CG_TRX_HW_ANTDIV) - odm_hw_ant_div(p_dm_odm); + if (dm->ant_div_type == S0S1_SW_ANTDIV) { + #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY + odm_s0s1_sw_ant_div(dm, SWAW_STEP_PEEK); + #endif + } else if (dm->ant_div_type == CG_TRX_HW_ANTDIV) { + odm_hw_ant_div(dm); + } } } #endif - /* 2 [--8821C---] */ +/*@ [--8821C--] */ #if (RTL8821C_SUPPORT == 1) - else if (p_dm_odm->support_ic_type == ODM_RTL8821C) - odm_hw_ant_div(p_dm_odm); + else if (dm->support_ic_type == ODM_RTL8821C) { + if (!dm->is_bt_continuous_turn) { + dm->ant_div_type = S0S1_SW_ANTDIV; + PHYDM_DBG(dm, DBG_ANT_DIV, + "is_bt_continuous_turn = ((%d)) ==> SW AntDiv\n", + dm->is_bt_continuous_turn); + + } else { + dm->ant_div_type = CG_TRX_HW_ANTDIV; + PHYDM_DBG(dm, DBG_ANT_DIV, + "is_bt_continuous_turn = ((%d)) ==> HW AntDiv\n", + dm->is_bt_continuous_turn); + odm_ant_div_on_off(dm, ANTDIV_ON, ANT_PATH_A); + } + + if (fat_tab->force_antdiv_type) + dm->ant_div_type = fat_tab->antdiv_type_dbg; + + if (dm->ant_div_type == S0S1_SW_ANTDIV) { + #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY + odm_s0s1_sw_ant_div(dm, SWAW_STEP_PEEK); + #endif + } else if (dm->ant_div_type == CG_TRX_HW_ANTDIV) { + odm_ant_div_on_off(dm, ANTDIV_ON, ANT_PATH_A); + odm_hw_ant_div(dm); + } + } #endif - /* 2 [--8881A---] */ +/* @ [--8881A--] */ #if (RTL8881A_SUPPORT == 1) - else if (p_dm_odm->support_ic_type == ODM_RTL8881A) - odm_hw_ant_div(p_dm_odm); + else if (dm->support_ic_type == ODM_RTL8881A) + odm_hw_ant_div(dm); #endif - /* 2 [--8812A---] */ +/*@ [--8812A--] */ #if (RTL8812A_SUPPORT == 1) - else if (p_dm_odm->support_ic_type == ODM_RTL8812) - odm_hw_ant_div(p_dm_odm); + else if (dm->support_ic_type == ODM_RTL8812) + odm_hw_ant_div(dm); #endif #if (RTL8188F_SUPPORT == 1) - /* [--8188F---]*/ - else if (p_dm_odm->support_ic_type == ODM_RTL8188F) { - -#ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY - odm_s0s1_sw_ant_div(p_dm_odm, SWAW_STEP_PEEK); -#endif +/*@ [--8188F--]*/ + else if (dm->support_ic_type == ODM_RTL8188F) { + #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY + odm_s0s1_sw_ant_div(dm, SWAW_STEP_PEEK); + #endif } #endif - /* [--8822B---]*/ -#if (RTL8821A_SUPPORT == 1) - else if (p_dm_odm->support_ic_type == ODM_RTL8822B) { -#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 - if (p_dm_odm->ant_div_type == HL_SW_SMART_ANT_TYPE1) { - - if (pdm_sat_table->fix_beam_pattern_en != 0) - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" [ SmartAnt ] Fix SmartAnt Pattern = 0x%x\n", pdm_sat_table->fix_beam_pattern_codeword)); +/*@ [--8822B--]*/ +#if (RTL8822B_SUPPORT == 1) + else if (dm->support_ic_type == ODM_RTL8822B) { + if (dm->ant_div_type == CG_TRX_HW_ANTDIV) + odm_hw_ant_div(dm); + #ifdef CONFIG_HL_SMART_ANTENNA_TYPE2 + if (dm->ant_div_type == HL_SW_SMART_ANT_TYPE2) { + if (sat_tab->fix_beam_pattern_en != 0) + PHYDM_DBG(dm, DBG_ANT_DIV, + " [ SmartAnt ] Fix SmartAnt Pattern = 0x%x\n", + sat_tab->fix_beam_pattern_codeword); else - odm_fast_ant_training_hl_smart_antenna_type1(p_dm_odm); + phydm_fast_ant_training_hl_smart_antenna_type2(dm); } -#endif + #endif } #endif - - } - -void -odm_antsel_statistics( - void *p_dm_void, - u8 antsel_tr_mux, - u32 mac_id, - u32 utility, - u8 method, - u8 is_cck_rate - -) +void odm_antsel_statistics(void *dm_void, void *phy_info_void, + u8 antsel_tr_mux, u32 mac_id, u32 utility, u8 method, + u8 is_cck_rate) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + struct phydm_phyinfo_struct *phy_info = NULL; + + phy_info = (struct phydm_phyinfo_struct *)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)*/ + /*to prevent u16 overflow, max(RSSI)=100, 65435+100 = 65535 (u16)*/ + if (fat_tab->main_sum_cck[mac_id] > 65435) return; - p_dm_fat_table->main_ant_sum_cck[mac_id] += (u16)utility; - p_dm_fat_table->main_ant_cnt_cck[mac_id]++; + fat_tab->main_sum_cck[mac_id] += (u16)utility; + fat_tab->main_cnt_cck[mac_id]++; } else { - if (p_dm_fat_table->aux_ant_sum_cck[mac_id] > 65435) + if (fat_tab->aux_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]++; + fat_tab->aux_sum_cck[mac_id] += (u16)utility; + fat_tab->aux_cnt_cck[mac_id]++; } } else { /*ofdm rate*/ if (antsel_tr_mux == ANT1_2G) { - if (p_dm_fat_table->main_ant_sum[mac_id] > 65435) + if (fat_tab->main_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]++; + fat_tab->main_sum[mac_id] += (u16)utility; + fat_tab->main_cnt[mac_id]++; } else { - if (p_dm_fat_table->aux_ant_sum[mac_id] > 65435) + if (fat_tab->aux_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]++; + fat_tab->aux_sum[mac_id] += (u16)utility; + fat_tab->aux_cnt[mac_id]++; } } } #ifdef ODM_EVM_ENHANCE_ANTDIV else if (method == EVM_METHOD) { - if (antsel_tr_mux == ANT1_2G) { - p_dm_fat_table->main_ant_evm_sum[mac_id] += (utility << 5); - p_dm_fat_table->main_ant_evm_cnt[mac_id]++; - } else { - p_dm_fat_table->aux_ant_evm_sum[mac_id] += (utility << 5); - p_dm_fat_table->aux_ant_evm_cnt[mac_id]++; + if (!fat_tab->get_stats) + return; + + if (dm->rate_ss == 1) { + phydm_statistics_evm_1ss(dm, phy_info, antsel_tr_mux, + mac_id, utility); + } else { /*@>= 2SS*/ + phydm_statistics_evm_2ss(dm, phy_info, antsel_tr_mux, + mac_id, utility); } + } else if (method == CRC32_METHOD) { - if (utility == 0) - p_dm_fat_table->crc32_fail_cnt++; - else - p_dm_fat_table->crc32_ok_cnt += utility; + if (antsel_tr_mux == ANT1_2G) { + fat_tab->main_crc32_ok_cnt += utility; + fat_tab->main_crc32_fail_cnt++; + } else { + fat_tab->aux_crc32_ok_cnt += utility; + fat_tab->aux_crc32_fail_cnt++; + } + + } else if (method == TP_METHOD) { + if (!fat_tab->get_stats) + return; + if (utility <= ODM_RATEMCS15 && utility >= ODM_RATEMCS0) { + if (antsel_tr_mux == ANT1_2G) { + fat_tab->main_tp += (phy_rate_table[utility]) + << 5; + fat_tab->main_tp_cnt++; + } else { + fat_tab->aux_tp += (phy_rate_table[utility]) + << 5; + fat_tab->aux_tp_cnt++; + } + } } #endif } - -void -odm_process_rssi_for_ant_div( - void *p_dm_void, - void *p_phy_info_void, - void *p_pkt_info_void - /* struct _odm_phy_status_info_* p_phy_info, */ - /* struct _odm_per_pkt_info_* p_pktinfo */ -) +void odm_process_rssi_smart(void *dm_void, void *phy_info_void, + void *pkt_info_void, u8 rx_power_ant0) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _odm_phy_status_info_ *p_phy_info = (struct _odm_phy_status_info_ *)p_phy_info_void; - struct _odm_per_pkt_info_ *p_pktinfo = (struct _odm_per_pkt_info_ *)p_pkt_info_void; - u8 is_cck_rate = 0, cck_max_rate = ODM_RATE11M; - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; -#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 - struct _SMART_ANTENNA_TRAINNING_ *pdm_sat_table = &(p_dm_odm->dm_sat_table); - u32 beam_tmp; - u8 next_ant; - u8 train_pkt_number; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_phyinfo_struct *phy_info = NULL; + struct phydm_perpkt_info_struct *pktinfo = NULL; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + + phy_info = (struct phydm_phyinfo_struct *)phy_info_void; + pktinfo = (struct phydm_perpkt_info_struct *)pkt_info_void; + + if ((dm->support_ic_type & ODM_SMART_ANT_SUPPORT) && + pktinfo->is_packet_to_self && + fat_tab->fat_state == FAT_TRAINING_STATE) { + /* @(pktinfo->is_packet_match_bssid && (!pktinfo->is_packet_beacon)) */ + u8 antsel_tr_mux; + + antsel_tr_mux = (fat_tab->antsel_rx_keep_2 << 2) | + (fat_tab->antsel_rx_keep_1 << 1) | + fat_tab->antsel_rx_keep_0; + fat_tab->ant_sum_rssi[antsel_tr_mux] += rx_power_ant0; + fat_tab->ant_rssi_cnt[antsel_tr_mux]++; + } +} + +void odm_process_rssi_normal(void *dm_void, void *phy_info_void, + void *pkt_info_void, u8 rx_pwr0) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_phyinfo_struct *phy_info = NULL; + struct phydm_perpkt_info_struct *pktinfo = NULL; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + u8 rx_evm0, rx_evm1; + boolean b_main; + + phy_info = (struct phydm_phyinfo_struct *)phy_info_void; + pktinfo = (struct phydm_perpkt_info_struct *)pkt_info_void; + rx_evm0 = phy_info->rx_mimo_signal_quality[0]; + rx_evm1 = phy_info->rx_mimo_signal_quality[1]; + + if (!(pktinfo->is_packet_to_self || fat_tab->use_ctrl_frame_antdiv)) + return; + + if (dm->ant_div_type == S0S1_SW_ANTDIV) { + if (pktinfo->is_cck_rate || + dm->support_ic_type == ODM_RTL8188F) { + + b_main = (fat_tab->rx_idle_ant == MAIN_ANT); + fat_tab->antsel_rx_keep_0 = b_main ? ANT1_2G : ANT2_2G; + } + + odm_antsel_statistics(dm, phy_info, fat_tab->antsel_rx_keep_0, + pktinfo->station_id, rx_pwr0, RSSI_METHOD, + pktinfo->is_cck_rate); + } else { + odm_antsel_statistics(dm, phy_info, fat_tab->antsel_rx_keep_0, + pktinfo->station_id, rx_pwr0, RSSI_METHOD, + pktinfo->is_cck_rate); + + #ifdef ODM_EVM_ENHANCE_ANTDIV + if (!(dm->support_ic_type & ODM_EVM_ANTDIV_IC)) + return; + if (pktinfo->is_cck_rate) + return; + + odm_antsel_statistics(dm, phy_info, fat_tab->antsel_rx_keep_0, + pktinfo->station_id, rx_evm0, EVM_METHOD, + pktinfo->is_cck_rate); + odm_antsel_statistics(dm, phy_info, fat_tab->antsel_rx_keep_0, + pktinfo->station_id, rx_evm0, TP_METHOD, + pktinfo->is_cck_rate); + #endif + } +} + +void odm_process_rssi_for_ant_div(void *dm_void, void *phy_info_void, + void *pkt_info_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_phyinfo_struct *phy_info = NULL; + struct phydm_perpkt_info_struct *pktinfo = NULL; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; +#if (defined(CONFIG_HL_SMART_ANTENNA)) + struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; + u32 beam_tmp; + u8 next_ant; + u8 train_pkt_number; #endif + boolean b_main; + u8 rx_power_ant0, rx_power_ant1; + u8 rx_evm_ant0, rx_evm_ant1; + u8 rssi_avg; + u64 rssi_linear = 0; -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) - u32 rx_power_ant0, rx_power_ant1; - u32 rx_evm_ant0, rx_evm_ant1; -#else - u8 rx_power_ant0, rx_power_ant1; - u8 rx_evm_ant0, rx_evm_ant1; + phy_info = (struct phydm_phyinfo_struct *)phy_info_void; + pktinfo = (struct phydm_perpkt_info_struct *)pkt_info_void; + rx_power_ant0 = phy_info->rx_mimo_signal_strength[0]; + rx_power_ant1 = phy_info->rx_mimo_signal_strength[1]; + rx_evm_ant0 = phy_info->rx_mimo_signal_quality[0]; + rx_evm_ant1 = phy_info->rx_mimo_signal_quality[1]; + + if ((dm->support_ic_type & ODM_IC_2SS) && !pktinfo->is_cck_rate) { + if (rx_power_ant1 < 100) { + rssi_linear = phydm_db_2_linear(rx_power_ant0) + + phydm_db_2_linear(rx_power_ant1); + /* @Rounding and removing fractional bits */ + rssi_linear = (rssi_linear + + (1 << (FRAC_BITS - 1))) >> FRAC_BITS; + /* @Calculate average RSSI */ + rssi_linear = DIVIDED_2(rssi_linear); + /* @averaged PWDB */ + rssi_avg = (u8)odm_convert_to_db(rssi_linear); + } + + } else { + rx_power_ant0 = (u8)phy_info->rx_pwdb_all; + rssi_avg = rx_power_ant0; + } + +#ifdef CONFIG_HL_SMART_ANTENNA_TYPE2 + if ((dm->ant_div_type == HL_SW_SMART_ANT_TYPE2) && (fat_tab->fat_state == FAT_TRAINING_STATE)) + phydm_process_rssi_for_hb_smtant_type2(dm, phy_info, pktinfo, rssi_avg); /*@for 8822B*/ + else #endif - cck_max_rate = ODM_RATE11M; - is_cck_rate = (p_pktinfo->data_rate <= cck_max_rate) ? true : false; - - if ((p_dm_odm->support_ic_type & ODM_IC_2SS) && (p_pktinfo->data_rate > cck_max_rate)) { - rx_power_ant0 = p_phy_info->rx_mimo_signal_strength[0]; - rx_power_ant1 = p_phy_info->rx_mimo_signal_strength[1]; - - rx_evm_ant0 = p_phy_info->rx_mimo_signal_quality[0]; - rx_evm_ant1 = p_phy_info->rx_mimo_signal_quality[1]; - } else - rx_power_ant0 = p_phy_info->rx_pwdb_all; - #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 #ifdef CONFIG_FAT_PATCH - if ((p_dm_odm->ant_div_type == HL_SW_SMART_ANT_TYPE1) && (p_dm_fat_table->fat_state == FAT_TRAINING_STATE)) { + if (dm->ant_div_type == HL_SW_SMART_ANT_TYPE1 && fat_tab->fat_state == FAT_TRAINING_STATE) { + /*@[Beacon]*/ + if (pktinfo->is_packet_beacon) { + sat_tab->beacon_counter++; + PHYDM_DBG(dm, DBG_ANT_DIV, + "MatchBSSID_beacon_counter = ((%d))\n", + sat_tab->beacon_counter); - /*[Beacon]*/ - if (p_pktinfo->is_packet_beacon) { - - pdm_sat_table->beacon_counter++; - ODM_RT_TRACE(p_dm_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 = (p_dm_fat_table->rx_idle_ant == MAIN_ANT) ? AUX_ANT : MAIN_ANT; - odm_update_rx_idle_ant(p_dm_odm, next_ant); + if (sat_tab->beacon_counter >= sat_tab->pre_beacon_counter + 2) { + if (sat_tab->ant_num > 1) { + next_ant = (fat_tab->rx_idle_ant == MAIN_ANT) ? AUX_ANT : MAIN_ANT; + odm_update_rx_idle_ant(dm, next_ant); } - pdm_sat_table->update_beam_idx++; + sat_tab->update_beam_idx++; - ODM_RT_TRACE(p_dm_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)); + PHYDM_DBG(dm, DBG_ANT_DIV, + "pre_beacon_counter = ((%d)), pkt_counter = ((%d)), update_beam_idx = ((%d))\n", + sat_tab->pre_beacon_counter, + sat_tab->pkt_counter, + sat_tab->update_beam_idx); - pdm_sat_table->pre_beacon_counter = pdm_sat_table->beacon_counter; - pdm_sat_table->pkt_counter = 0; + sat_tab->pre_beacon_counter = sat_tab->beacon_counter; + sat_tab->pkt_counter = 0; } } - /*[data]*/ - else if (p_pktinfo->is_packet_to_self) { - - if (pdm_sat_table->pkt_skip_statistic_en == 0) { - /* - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("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)); + /*@[data]*/ + else if (pktinfo->is_packet_to_self) { + if (sat_tab->pkt_skip_statistic_en == 0) { + /*@ + PHYDM_DBG(dm, DBG_ANT_DIV, "StaID[%d]: antsel_pathA = ((%d)), hw_antsw_occur = ((%d)), Beam_num = ((%d)), RSSI = ((%d))\n", + pktinfo->station_id, fat_tab->antsel_rx_keep_0, fat_tab->hw_antsw_occur, sat_tab->fast_training_beam_num, rx_power_ant0); */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("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)); + PHYDM_DBG(dm, DBG_ANT_DIV, + "ID[%d][pkt_cnt = %d]: {ANT, Beam} = {%d, %d}, RSSI = ((%d))\n", + pktinfo->station_id, + sat_tab->pkt_counter, + fat_tab->antsel_rx_keep_0, + sat_tab->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++; + sat_tab->pkt_rssi_sum[fat_tab->antsel_rx_keep_0][sat_tab->fast_training_beam_num] += rx_power_ant0; + sat_tab->pkt_rssi_cnt[fat_tab->antsel_rx_keep_0][sat_tab->fast_training_beam_num]++; + sat_tab->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]; + train_pkt_number = sat_tab->beam_train_cnt[fat_tab->rx_idle_ant - 1][sat_tab->fast_training_beam_num]; #else - train_pkt_number = pdm_sat_table->per_beam_training_pkt_num; + train_pkt_number = sat_tab->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(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("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_odm, next_ant); + if (sat_tab->pkt_counter == train_pkt_number) { + if (sat_tab->ant_num > 1) { + PHYDM_DBG(dm, DBG_ANT_DIV, "packet enugh ((%d ))pkts ---> Switch antenna\n", train_pkt_number); + next_ant = (fat_tab->rx_idle_ant == MAIN_ANT) ? AUX_ANT : MAIN_ANT; + odm_update_rx_idle_ant(dm, next_ant); } - pdm_sat_table->update_beam_idx++; - ODM_RT_TRACE(p_dm_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)); + sat_tab->update_beam_idx++; + PHYDM_DBG(dm, DBG_ANT_DIV, "pre_beacon_counter = ((%d)), update_beam_idx_counter = ((%d))\n", + sat_tab->pre_beacon_counter, sat_tab->update_beam_idx); - pdm_sat_table->pre_beacon_counter = pdm_sat_table->beacon_counter; - pdm_sat_table->pkt_counter = 0; + sat_tab->pre_beacon_counter = sat_tab->beacon_counter; + sat_tab->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) { + /*Swich Beam after switch "sat_tab->ant_num" antennas*/ + if (sat_tab->update_beam_idx == sat_tab->ant_num) { + sat_tab->update_beam_idx = 0; + sat_tab->pkt_counter = 0; + beam_tmp = sat_tab->fast_training_beam_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 (sat_tab->fast_training_beam_num >= (sat_tab->beam_patten_num_each_ant - 1)) { + fat_tab->fat_state = FAT_DECISION_STATE; #if DEV_BUS_TYPE == RT_PCI_INTERFACE - odm_fast_ant_training_hl_smart_antenna_type1(p_dm_odm); -#else - odm_schedule_work_item(&pdm_sat_table->hl_smart_antenna_decision_workitem); + if (dm->support_interface == ODM_ITRF_PCIE) + odm_fast_ant_training_hl_smart_antenna_type1(dm); +#endif +#if DEV_BUS_TYPE == RT_USB_INTERFACE || DEV_BUS_TYPE == RT_SDIO_INTERFACE + if (dm->support_interface == ODM_ITRF_USB || dm->support_interface == ODM_ITRF_SDIO) + odm_schedule_work_item(&sat_tab->hl_smart_antenna_decision_workitem); #endif - } else { - pdm_sat_table->fast_training_beam_num++; - ODM_RT_TRACE(p_dm_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(p_dm_odm); + sat_tab->fast_training_beam_num++; + PHYDM_DBG(dm, DBG_ANT_DIV, + "Update Beam_num (( %d )) -> (( %d ))\n", + beam_tmp, + sat_tab->fast_training_beam_num); + phydm_set_all_ant_same_beam_num(dm); - p_dm_fat_table->fat_state = FAT_TRAINING_STATE; + fat_tab->fat_state = FAT_TRAINING_STATE; } } - } #else - if (p_dm_odm->ant_div_type == HL_SW_SMART_ANT_TYPE1) { - if ((p_dm_odm->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) { - /* - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("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)); + if (dm->ant_div_type == HL_SW_SMART_ANT_TYPE1) { + if ((dm->support_ic_type & ODM_HL_SMART_ANT_TYPE1_SUPPORT) && + pktinfo->is_packet_to_self && + fat_tab->fat_state == FAT_TRAINING_STATE) { + if (sat_tab->pkt_skip_statistic_en == 0) { + /*@ + PHYDM_DBG(dm, DBG_ANT_DIV, "StaID[%d]: antsel_pathA = ((%d)), hw_antsw_occur = ((%d)), Beam_num = ((%d)), RSSI = ((%d))\n", + pktinfo->station_id, fat_tab->antsel_rx_keep_0, fat_tab->hw_antsw_occur, sat_tab->fast_training_beam_num, rx_power_ant0); */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("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)); + PHYDM_DBG(dm, DBG_ANT_DIV, + "StaID[%d]: antsel_pathA = ((%d)), is_packet_to_self = ((%d)), Beam_num = ((%d)), RSSI = ((%d))\n", + pktinfo->station_id, + fat_tab->antsel_rx_keep_0, + pktinfo->is_packet_to_self, + sat_tab->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++; + sat_tab->pkt_rssi_sum[fat_tab->antsel_rx_keep_0][sat_tab->fast_training_beam_num] += rx_power_ant0; + sat_tab->pkt_rssi_cnt[fat_tab->antsel_rx_keep_0][sat_tab->fast_training_beam_num]++; + sat_tab->pkt_counter++; /*swich beam every N pkt*/ - if ((pdm_sat_table->pkt_counter) >= (pdm_sat_table->per_beam_training_pkt_num)) { + if (sat_tab->pkt_counter >= sat_tab->per_beam_training_pkt_num) { + sat_tab->pkt_counter = 0; + beam_tmp = sat_tab->fast_training_beam_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 (sat_tab->fast_training_beam_num >= (sat_tab->beam_patten_num_each_ant - 1)) { + fat_tab->fat_state = FAT_DECISION_STATE; #if DEV_BUS_TYPE == RT_PCI_INTERFACE - odm_fast_ant_training_hl_smart_antenna_type1(p_dm_odm); -#else - odm_schedule_work_item(&pdm_sat_table->hl_smart_antenna_decision_workitem); + if (dm->support_interface == ODM_ITRF_PCIE) + odm_fast_ant_training_hl_smart_antenna_type1(dm); +#endif +#if DEV_BUS_TYPE == RT_USB_INTERFACE || DEV_BUS_TYPE == RT_SDIO_INTERFACE + if (dm->support_interface == ODM_ITRF_USB || dm->support_interface == ODM_ITRF_SDIO) + odm_schedule_work_item(&sat_tab->hl_smart_antenna_decision_workitem); #endif - } else { - pdm_sat_table->fast_training_beam_num++; - phydm_set_all_ant_same_beam_num(p_dm_odm); + sat_tab->fast_training_beam_num++; + phydm_set_all_ant_same_beam_num(dm); - p_dm_fat_table->fat_state = FAT_TRAINING_STATE; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Update Beam_num (( %d )) -> (( %d ))\n", beam_tmp, pdm_sat_table->fast_training_beam_num)); + fat_tab->fat_state = FAT_TRAINING_STATE; + PHYDM_DBG(dm, DBG_ANT_DIV, "Update Beam_num (( %d )) -> (( %d ))\n", beam_tmp, sat_tab->fast_training_beam_num); } } } @@ -4802,433 +5405,595 @@ odm_process_rssi_for_ant_div( #endif else #endif - if (p_dm_odm->ant_div_type == CG_TRX_SMART_ANTDIV) { - if ((p_dm_odm->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_odm->support_ic_type & ODM_ANTDIV_SUPPORT) && (p_pktinfo->is_packet_to_self || p_dm_fat_table->use_ctrl_frame_antdiv)) { - - if (p_dm_odm->ant_div_type == S0S1_SW_ANTDIV) { - - 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; - - odm_antsel_statistics(p_dm_odm, 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_odm, 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_odm->support_ic_type == ODM_RTL8192E) { - if (!is_cck_rate) - odm_antsel_statistics(p_dm_odm, p_dm_fat_table->antsel_rx_keep_0, p_pktinfo->station_id, rx_evm_ant0, EVM_METHOD, is_cck_rate); - - } -#endif - } - } + if (dm->ant_div_type == CG_TRX_SMART_ANTDIV) { + odm_process_rssi_smart(dm, phy_info, pktinfo, + rx_power_ant0); + } else { /* @ant_div_type != CG_TRX_SMART_ANTDIV */ + odm_process_rssi_normal(dm, phy_info, pktinfo, + rx_power_ant0); } - /* ODM_RT_TRACE(p_dm_odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("is_cck_rate=%d, PWDB_ALL=%d\n",is_cck_rate, p_phy_info->rx_pwdb_all)); */ - /* ODM_RT_TRACE(p_dm_odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("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 0 +/* PHYDM_DBG(dm,DBG_ANT_DIV,"is_cck_rate=%d, pwdb_all=%d\n", + * pktinfo->is_cck_rate, phy_info->rx_pwdb_all); + * PHYDM_DBG(dm,DBG_ANT_DIV,"antsel_tr_mux=3'b%d%d%d\n", + * fat_tab->antsel_rx_keep_2, fat_tab->antsel_rx_keep_1, + * fat_tab->antsel_rx_keep_0); + */ +#endif } -#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 - -) +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE | ODM_IOT)) +void odm_set_tx_ant_by_tx_info(void *dm_void, u8 *desc, u8 mac_id) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; - if (!(p_dm_odm->support_ability & ODM_BB_ANT_DIV)) + if (!(dm->support_ability & ODM_BB_ANT_DIV)) return; - if (p_dm_odm->ant_div_type == CGCS_RX_HW_ANTDIV) + if (dm->ant_div_type == CGCS_RX_HW_ANTDIV) return; - - if (p_dm_odm->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]); - /*ODM_RT_TRACE(p_dm_odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[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]));*/ + if (dm->support_ic_type == (ODM_RTL8723B | ODM_RTL8721D)) { +#if (RTL8723B_SUPPORT == 1 || RTL8721D_SUPPORT == 1) + SET_TX_DESC_ANTSEL_A_8723B(desc, fat_tab->antsel_a[mac_id]); +/*PHYDM_DBG(dm,DBG_ANT_DIV, + * "[8723B] SetTxAntByTxInfo_WIN: mac_id=%d, antsel_tr_mux=3'b%d%d%d\n", + * mac_id, fat_tab->antsel_c[mac_id], fat_tab->antsel_b[mac_id], + * fat_tab->antsel_a[mac_id]); + */ #endif - } else if (p_dm_odm->support_ic_type == ODM_RTL8821) { + } else if (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]); - /*ODM_RT_TRACE(p_dm_odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[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]));*/ + SET_TX_DESC_ANTSEL_A_8812(desc, fat_tab->antsel_a[mac_id]); +/*PHYDM_DBG(dm,DBG_ANT_DIV, + * "[8821A] SetTxAntByTxInfo_WIN: mac_id=%d, antsel_tr_mux=3'b%d%d%d\n", + * mac_id, fat_tab->antsel_c[mac_id], fat_tab->antsel_b[mac_id], + * fat_tab->antsel_a[mac_id]); + */ #endif - } else if (p_dm_odm->support_ic_type == ODM_RTL8188E) { + } else if (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]); - /*ODM_RT_TRACE(p_dm_odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[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]));*/ + SET_TX_DESC_ANTSEL_A_88E(desc, fat_tab->antsel_a[mac_id]); + SET_TX_DESC_ANTSEL_B_88E(desc, fat_tab->antsel_b[mac_id]); + SET_TX_DESC_ANTSEL_C_88E(desc, fat_tab->antsel_c[mac_id]); +/*PHYDM_DBG(dm,DBG_ANT_DIV, + * "[8188E] SetTxAntByTxInfo_WIN: mac_id=%d, antsel_tr_mux=3'b%d%d%d\n", + * mac_id, fat_tab->antsel_c[mac_id], fat_tab->antsel_b[mac_id], + * fat_tab->antsel_a[mac_id]); + */ #endif - } else if (p_dm_odm->support_ic_type == ODM_RTL8821C) { + } else if (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]); - /*ODM_RT_TRACE(p_dm_odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[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]));*/ + SET_TX_DESC_ANTSEL_A_8821C(desc, fat_tab->antsel_a[mac_id]); +/*PHYDM_DBG(dm,DBG_ANT_DIV, + * "[8821C] SetTxAntByTxInfo_WIN: mac_id=%d, antsel_tr_mux=3'b%d%d%d\n", + * mac_id, fat_tab->antsel_c[mac_id], fat_tab->antsel_b[mac_id], + * fat_tab->antsel_a[mac_id]); + */ #endif + } else if (dm->support_ic_type == ODM_RTL8822B) { +#if (RTL8822B_SUPPORT == 1) + SET_TX_DESC_ANTSEL_A_8822B(desc, fat_tab->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 -) +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_odm = &(priv->pshare->_dmodm); - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &priv->pshare->_dmodm.dm_fat_table; - u32 support_ic_type = priv->pshare->_dmodm.support_ic_type; + struct dm_struct *dm = GET_PDM_ODM(priv); /*@&(priv->pshare->_dmODM);*/ + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; - if (!(p_dm_odm->support_ability & ODM_BB_ANT_DIV)) + if (!(dm->support_ability & ODM_BB_ANT_DIV)) return; - if (p_dm_odm->ant_div_type == CGCS_RX_HW_ANTDIV) + if (dm->ant_div_type == CGCS_RX_HW_ANTDIV) return; - if (support_ic_type == ODM_RTL8881A) { + if (dm->support_ic_type == ODM_RTL8881A) { +#if 0 /*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 (support_ic_type == ODM_RTL8192E) { +#endif + pdesc->Dword6 &= set_desc(~(BIT(18) | BIT(17) | BIT(16))); + pdesc->Dword6 |= set_desc(fat_tab->antsel_a[aid] << 16); + } else if (dm->support_ic_type == ODM_RTL8192E) { +#if 0 /*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 (support_ic_type == ODM_RTL8188E) { +#endif + pdesc->Dword6 &= set_desc(~(BIT(18) | BIT(17) | BIT(16))); + pdesc->Dword6 |= set_desc(fat_tab->antsel_a[aid] << 16); + } else if (dm->support_ic_type == ODM_RTL8197F) { +#if 0 + /*panic_printk("[%s] [%d] ******ODM_SetTxAntByTxInfo_8192E******\n",__FUNCTION__,__LINE__); */ +#endif + pdesc->Dword6 &= set_desc(~(BIT(17) | BIT(16))); + pdesc->Dword6 |= set_desc(fat_tab->antsel_a[aid] << 16); + } else if (dm->support_ic_type == ODM_RTL8822B) { + pdesc->Dword6 &= set_desc(~(BIT(17) | BIT(16))); + pdesc->Dword6 |= set_desc(fat_tab->antsel_a[aid] << 16); + } else if (dm->support_ic_type == ODM_RTL8188E) { +#if 0 /*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)); +#endif + 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); + pdesc->Dword2 |= set_desc(fat_tab->antsel_a[aid] << 24); + pdesc->Dword2 |= set_desc(fat_tab->antsel_b[aid] << 25); + pdesc->Dword7 |= set_desc(fat_tab->antsel_c[aid] << 29); - - } else if (support_ic_type == ODM_RTL8812) { - /*[path-A]*/ + } else if (dm->support_ic_type == ODM_RTL8812) { + /*@[path-A]*/ +#if 0 /*panic_printk("[%s] [%d] ******ODM_SetTxAntByTxInfo_8881E******\n",__FUNCTION__,__LINE__);*/ +#endif - 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); + pdesc->Dword6 &= set_desc(~BIT(16)); + pdesc->Dword6 &= set_desc(~BIT(17)); + pdesc->Dword6 &= set_desc(~BIT(18)); + pdesc->Dword6 |= set_desc(fat_tab->antsel_a[aid] << 16); + pdesc->Dword6 |= set_desc(fat_tab->antsel_b[aid] << 17); + pdesc->Dword6 |= set_desc(fat_tab->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 -) +#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_odm = &(priv->pshare->_dmodm); - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &priv->pshare->_dmodm.dm_fat_table; - u32 support_ic_type = priv->pshare->_dmodm.support_ic_type; - PTX_DESC_DATA_88XX pdescdata = (PTX_DESC_DATA_88XX)pdesc_data; + struct dm_struct *dm = GET_PDM_ODM(priv); /*@&(priv->pshare->_dmODM);*/ + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + PTX_DESC_DATA_88XX pdescdata = (PTX_DESC_DATA_88XX)pdesc_data; - if (!(p_dm_odm->support_ability & ODM_BB_ANT_DIV)) + if (!(dm->support_ability & ODM_BB_ANT_DIV)) return; - if (p_dm_odm->ant_div_type == CGCS_RX_HW_ANTDIV) + if (dm->ant_div_type == CGCS_RX_HW_ANTDIV) return; - if (support_ic_type == ODM_RTL8881A || support_ic_type == ODM_RTL8192E || support_ic_type == ODM_RTL8814A) { - /*panic_printk("[%s] [%d] ******odm_set_tx_ant_by_tx_info_hal******\n",__FUNCTION__,__LINE__);*/ + if (dm->support_ic_type & (ODM_RTL8881A | ODM_RTL8192E | ODM_RTL8814A | + ODM_RTL8197F | ODM_RTL8822B)) { +#if 0 + /*panic_printk("[%s] [%d] **odm_set_tx_ant_by_tx_info_hal**\n", + * __FUNCTION__,__LINE__); + */ +#endif pdescdata->ant_sel = 1; - pdescdata->ant_sel_a = p_dm_fat_table->antsel_a[aid]; + pdescdata->ant_sel_a = fat_tab->antsel_a[aid]; } } -#endif /*#ifdef CONFIG_WLAN_HAL*/ +#endif /*@#ifdef CONFIG_WLAN_HAL*/ #endif - -void -odm_ant_div_config( - void *p_dm_void -) +void odm_ant_div_config(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("WIN Config Antenna Diversity\n")); - /* - if(p_dm_odm->support_ic_type==ODM_RTL8723B) + PHYDM_DBG(dm, DBG_ANT_DIV, "WIN Config Antenna Diversity\n"); + /*@ + if(dm->support_ic_type==ODM_RTL8723B) { - if((!p_dm_odm->dm_swat_table.ANTA_ON || !p_dm_odm->dm_swat_table.ANTB_ON)) - p_dm_odm->support_ability &= ~(ODM_BB_ANT_DIV); + if((!dm->swat_tab.ANTA_ON || !dm->swat_tab.ANTB_ON)) + dm->support_ability &= ~(ODM_BB_ANT_DIV); } */ - if (p_dm_odm->support_ic_type == ODM_RTL8723D) { + #if (defined(CONFIG_2T3R_ANTENNA)) + #if (RTL8822B_SUPPORT == 1) + dm->rfe_type = ANT_2T3R_RFE_TYPE; + #endif + #endif - p_dm_odm->ant_div_type = S0S1_TRX_HW_ANTDIV; - /**/ - } + #if (defined(CONFIG_2T4R_ANTENNA)) + #if (RTL8822B_SUPPORT == 1) + dm->rfe_type = ANT_2T4R_RFE_TYPE; + #endif + #endif + + if (dm->support_ic_type == ODM_RTL8723D) + dm->ant_div_type = S0S1_SW_ANTDIV; #elif (DM_ODM_SUPPORT_TYPE & (ODM_CE)) - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("CE Config Antenna Diversity\n")); + PHYDM_DBG(dm, DBG_ANT_DIV, "CE Config Antenna Diversity\n"); - if (p_dm_odm->support_ic_type == ODM_RTL8723B) - p_dm_odm->ant_div_type = S0S1_SW_ANTDIV; + if (dm->support_ic_type == ODM_RTL8723B) + dm->ant_div_type = S0S1_SW_ANTDIV; + if (dm->support_ic_type == ODM_RTL8723D) + dm->ant_div_type = S0S1_SW_ANTDIV; +#elif (DM_ODM_SUPPORT_TYPE & (ODM_IOT)) + PHYDM_DBG(dm, DBG_ANT_DIV, "IOT Config Antenna Diversity\n"); + + if (dm->support_ic_type == ODM_RTL8721D) + dm->ant_div_type = CG_TRX_HW_ANTDIV; #elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("AP Config Antenna Diversity\n")); + PHYDM_DBG(dm, DBG_ANT_DIV, "AP Config Antenna Diversity\n"); - /* 2 [ NOT_SUPPORT_ANTDIV ] */ + /* @2 [ NOT_SUPPORT_ANTDIV ] */ #if (defined(CONFIG_NOT_SUPPORT_ANTDIV)) - p_dm_odm->support_ability &= ~(ODM_BB_ANT_DIV); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Disable AntDiv function] : Not Support 2.4G & 5G Antenna Diversity\n")); + dm->support_ability &= ~(ODM_BB_ANT_DIV); + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ Disable AntDiv function] : Not Support 2.4G & 5G Antenna Diversity\n"); - /* 2 [ 2G&5G_SUPPORT_ANTDIV ] */ + /* @2 [ 2G&5G_SUPPORT_ANTDIV ] */ #elif (defined(CONFIG_2G5G_SUPPORT_ANTDIV)) - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 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); + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ Enable AntDiv function] : 2.4G & 5G Support Antenna Diversity Simultaneously\n"); + fat_tab->ant_div_2g_5g = (ODM_ANTDIV_2G | ODM_ANTDIV_5G); - if (p_dm_odm->support_ic_type & ODM_ANTDIV_SUPPORT) - p_dm_odm->support_ability |= ODM_BB_ANT_DIV; - if (*p_dm_odm->p_band_type == ODM_BAND_5G) { + if (dm->support_ic_type & ODM_ANTDIV_SUPPORT) + dm->support_ability |= ODM_BB_ANT_DIV; + if (*dm->band_type == ODM_BAND_5G) { #if (defined(CONFIG_5G_CGCS_RX_DIVERSITY)) - p_dm_odm->ant_div_type = CGCS_RX_HW_ANTDIV; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv type = CGCS_RX_HW_ANTDIV\n")); + dm->ant_div_type = CGCS_RX_HW_ANTDIV; + PHYDM_DBG(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_odm->ant_div_type = CG_TRX_HW_ANTDIV; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv type = CG_TRX_HW_ANTDIV\n")); +#elif (defined(CONFIG_5G_CG_TRX_DIVERSITY) ||\ + defined(CONFIG_2G5G_CG_TRX_DIVERSITY_8881A)) + dm->ant_div_type = CG_TRX_HW_ANTDIV; + PHYDM_DBG(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_odm->ant_div_type = CG_TRX_SMART_ANTDIV; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv type = CG_SMART_ANTDIV\n")); + dm->ant_div_type = CG_TRX_SMART_ANTDIV; + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ 5G] : AntDiv type = CG_SMART_ANTDIV\n"); #elif (defined(CONFIG_5G_S0S1_SW_ANT_DIVERSITY)) - p_dm_odm->ant_div_type = S0S1_SW_ANTDIV; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv type = S0S1_SW_ANTDIV\n")); + dm->ant_div_type = S0S1_SW_ANTDIV; + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ 5G] : AntDiv type = S0S1_SW_ANTDIV\n"); #endif - } else if (*p_dm_odm->p_band_type == ODM_BAND_2_4G) { + } else if (*dm->band_type == ODM_BAND_2_4G) { #if (defined(CONFIG_2G_CGCS_RX_DIVERSITY)) - p_dm_odm->ant_div_type = CGCS_RX_HW_ANTDIV; - ODM_RT_TRACE(p_dm_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)) - p_dm_odm->ant_div_type = CG_TRX_HW_ANTDIV; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv type = CG_TRX_HW_ANTDIV\n")); + dm->ant_div_type = CGCS_RX_HW_ANTDIV; + PHYDM_DBG(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)) + dm->ant_div_type = CG_TRX_HW_ANTDIV; + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ 2.4G] : AntDiv type = CG_TRX_HW_ANTDIV\n"); #elif (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) - p_dm_odm->ant_div_type = CG_TRX_SMART_ANTDIV; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv type = CG_SMART_ANTDIV\n")); + dm->ant_div_type = CG_TRX_SMART_ANTDIV; + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ 2.4G] : AntDiv type = CG_SMART_ANTDIV\n"); #elif (defined(CONFIG_2G_S0S1_SW_ANT_DIVERSITY)) - p_dm_odm->ant_div_type = S0S1_SW_ANTDIV; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv type = S0S1_SW_ANTDIV\n")); + dm->ant_div_type = S0S1_SW_ANTDIV; + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ 2.4G] : AntDiv type = S0S1_SW_ANTDIV\n"); #endif } - /* 2 [ 5G_SUPPORT_ANTDIV ] */ + /* @2 [ 5G_SUPPORT_ANTDIV ] */ #elif (defined(CONFIG_5G_SUPPORT_ANTDIV)) - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Enable AntDiv function] : Only 5G Support Antenna Diversity\n")); + PHYDM_DBG(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_odm->p_band_type == ODM_BAND_5G) { - if (p_dm_odm->support_ic_type & ODM_ANTDIV_5G_SUPPORT_IC) - p_dm_odm->support_ability |= ODM_BB_ANT_DIV; + fat_tab->ant_div_2g_5g = (ODM_ANTDIV_5G); + if (*dm->band_type == ODM_BAND_5G) { + if (dm->support_ic_type & ODM_ANTDIV_5G_SUPPORT_IC) + dm->support_ability |= ODM_BB_ANT_DIV; #if (defined(CONFIG_5G_CGCS_RX_DIVERSITY)) - p_dm_odm->ant_div_type = CGCS_RX_HW_ANTDIV; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv type = CGCS_RX_HW_ANTDIV\n")); + dm->ant_div_type = CGCS_RX_HW_ANTDIV; + PHYDM_DBG(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_odm->ant_div_type = CG_TRX_HW_ANTDIV; + dm->ant_div_type = CG_TRX_HW_ANTDIV; panic_printk("[ 5G] : AntDiv type = CG_TRX_HW_ANTDIV\n"); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv type = CG_TRX_HW_ANTDIV\n")); + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ 5G] : AntDiv type = CG_TRX_HW_ANTDIV\n"); #elif (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) - p_dm_odm->ant_div_type = CG_TRX_SMART_ANTDIV; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv type = CG_SMART_ANTDIV\n")); + dm->ant_div_type = CG_TRX_SMART_ANTDIV; + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ 5G] : AntDiv type = CG_SMART_ANTDIV\n"); #elif (defined(CONFIG_5G_S0S1_SW_ANT_DIVERSITY)) - p_dm_odm->ant_div_type = S0S1_SW_ANTDIV; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv type = S0S1_SW_ANTDIV\n")); + dm->ant_div_type = S0S1_SW_ANTDIV; + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ 5G] : AntDiv type = S0S1_SW_ANTDIV\n"); #endif - } else if (*p_dm_odm->p_band_type == ODM_BAND_2_4G) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Not Support 2G ant_div_type\n")); - p_dm_odm->support_ability &= ~(ODM_BB_ANT_DIV); + } else if (*dm->band_type == ODM_BAND_2_4G) { + PHYDM_DBG(dm, DBG_ANT_DIV, "Not Support 2G ant_div_type\n"); + dm->support_ability &= ~(ODM_BB_ANT_DIV); } - /* 2 [ 2G_SUPPORT_ANTDIV ] */ + /* @2 [ 2G_SUPPORT_ANTDIV ] */ #elif (defined(CONFIG_2G_SUPPORT_ANTDIV)) - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Enable AntDiv function] : Only 2.4G Support Antenna Diversity\n")); - p_dm_fat_table->ant_div_2g_5g = (ODM_ANTDIV_2G); - if (*p_dm_odm->p_band_type == ODM_BAND_2_4G) { - if (p_dm_odm->support_ic_type & ODM_ANTDIV_2G_SUPPORT_IC) - p_dm_odm->support_ability |= ODM_BB_ANT_DIV; + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ Enable AntDiv function] : Only 2.4G Support Antenna Diversity\n"); + fat_tab->ant_div_2g_5g = (ODM_ANTDIV_2G); + if (*dm->band_type == ODM_BAND_2_4G) { + if (dm->support_ic_type & ODM_ANTDIV_2G_SUPPORT_IC) + dm->support_ability |= ODM_BB_ANT_DIV; #if (defined(CONFIG_2G_CGCS_RX_DIVERSITY)) - p_dm_odm->ant_div_type = CGCS_RX_HW_ANTDIV; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv type = CGCS_RX_HW_ANTDIV\n")); + dm->ant_div_type = CGCS_RX_HW_ANTDIV; + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ 2.4G] : AntDiv type = CGCS_RX_HW_ANTDIV\n"); #elif (defined(CONFIG_2G_CG_TRX_DIVERSITY)) - p_dm_odm->ant_div_type = CG_TRX_HW_ANTDIV; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv type = CG_TRX_HW_ANTDIV\n")); + dm->ant_div_type = CG_TRX_HW_ANTDIV; + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ 2.4G] : AntDiv type = CG_TRX_HW_ANTDIV\n"); #elif (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) - p_dm_odm->ant_div_type = CG_TRX_SMART_ANTDIV; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv type = CG_SMART_ANTDIV\n")); + dm->ant_div_type = CG_TRX_SMART_ANTDIV; + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ 2.4G] : AntDiv type = CG_SMART_ANTDIV\n"); #elif (defined(CONFIG_2G_S0S1_SW_ANT_DIVERSITY)) - p_dm_odm->ant_div_type = S0S1_SW_ANTDIV; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv type = S0S1_SW_ANTDIV\n")); + dm->ant_div_type = S0S1_SW_ANTDIV; + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ 2.4G] : AntDiv type = S0S1_SW_ANTDIV\n"); #endif - } else if (*p_dm_odm->p_band_type == ODM_BAND_5G) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Not Support 5G ant_div_type\n")); - p_dm_odm->support_ability &= ~(ODM_BB_ANT_DIV); + } else if (*dm->band_type == ODM_BAND_5G) { + PHYDM_DBG(dm, DBG_ANT_DIV, "Not Support 5G ant_div_type\n"); + dm->support_ability &= ~(ODM_BB_ANT_DIV); } #endif #endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[AntDiv Config Info] AntDiv_SupportAbility = (( %x ))\n", ((p_dm_odm->support_ability & ODM_BB_ANT_DIV) ? 1 : 0))); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[AntDiv Config Info] be_fix_tx_ant = ((%d))\n", p_dm_odm->dm_fat_table.b_fix_tx_ant)); - + PHYDM_DBG(dm, DBG_ANT_DIV, + "[AntDiv Config Info] AntDiv_SupportAbility = (( %x ))\n", + ((dm->support_ability & ODM_BB_ANT_DIV) ? 1 : 0)); + PHYDM_DBG(dm, DBG_ANT_DIV, + "[AntDiv Config Info] be_fix_tx_ant = ((%d))\n", + dm->dm_fat_table.b_fix_tx_ant); } - -void -odm_ant_div_timers( - void *p_dm_void, - u8 state -) +void odm_ant_div_timers(void *dm_void, u8 state) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; if (state == INIT_ANTDIV_TIMMER) { #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY - odm_initialize_timer(p_dm_odm, &(p_dm_odm->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_odm, &p_dm_odm->fast_ant_training_timer, - (void *)odm_fast_ant_training_callback, NULL, "fast_ant_training_timer"); + odm_initialize_timer(dm, + &dm->dm_swat_table.sw_antdiv_timer, + (void *)odm_sw_antdiv_callback, NULL, + "sw_antdiv_timer"); +#elif (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) ||\ + (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) + odm_initialize_timer(dm, &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_odm, &p_dm_odm->evm_fast_ant_training_timer, - (void *)odm_evm_fast_ant_training_callback, NULL, "evm_fast_ant_training_timer"); + odm_initialize_timer(dm, &dm->evm_fast_ant_training_timer, + (void *)phydm_evm_antdiv_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_odm, &(p_dm_odm->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_odm, &p_dm_odm->fast_ant_training_timer); + odm_cancel_timer(dm, + &dm->dm_swat_table.sw_antdiv_timer); +#elif (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) ||\ + (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) + odm_cancel_timer(dm, &dm->fast_ant_training_timer); #endif #ifdef ODM_EVM_ENHANCE_ANTDIV - odm_cancel_timer(p_dm_odm, &p_dm_odm->evm_fast_ant_training_timer); + odm_cancel_timer(dm, &dm->evm_fast_ant_training_timer); #endif } else if (state == RELEASE_ANTDIV_TIMMER) { #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY - odm_release_timer(p_dm_odm, &(p_dm_odm->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_odm, &p_dm_odm->fast_ant_training_timer); + odm_release_timer(dm, + &dm->dm_swat_table.sw_antdiv_timer); +#elif (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) ||\ + (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) + odm_release_timer(dm, &dm->fast_ant_training_timer); #endif #ifdef ODM_EVM_ENHANCE_ANTDIV - odm_release_timer(p_dm_odm, &p_dm_odm->evm_fast_ant_training_timer); + odm_release_timer(dm, &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 -) +void phydm_antdiv_debug(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - /*struct _FAST_ANTENNA_TRAINNING_* p_dm_fat_table = &p_dm_odm->dm_fat_table;*/ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; u32 used = *_used; u32 out_len = *_out_len; + u32 dm_value[10] = {0}; + char help[] = "-h"; + u8 i, input_idx = 0; - if (dm_value[0] == 1) { /*fixed or auto antenna*/ + for (i = 0; i < 5; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_HEX, &dm_value[i]); + input_idx++; + } + } + + if (input_idx == 0) + return; + + if ((strcmp(input[1], help) == 0)) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "{1} {0:auto, 1:fix main, 2:fix auto}\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{2} {antdiv_period}\n"); + #if (RTL8821C_SUPPORT == 1) + PDM_SNPF(out_len, used, output + used, out_len - used, + "{3} {en} {0:Default, 1:HW_Div, 2:SW_Div}\n"); + #endif + + } else if (dm_value[0] == 1) { + /*@fixed or auto antenna*/ + if (dm_value[1] == 0) { + dm->ant_type = ODM_AUTO_ANT; + PDM_SNPF(out_len, used, output + used, out_len - used, + "AntDiv: Auto\n"); + } else if (dm_value[1] == 1) { + dm->ant_type = ODM_FIX_MAIN_ANT; + PDM_SNPF(out_len, used, output + used, out_len - used, + "AntDiv: Fix Main\n"); + } else if (dm_value[1] == 2) { + dm->ant_type = ODM_FIX_AUX_ANT; + PDM_SNPF(out_len, used, output + used, out_len - used, + "AntDiv: Fix Aux\n"); + } + + if (dm->ant_type != ODM_AUTO_ANT) { + odm_stop_antenna_switch_dm(dm); + if (dm->ant_type == ODM_FIX_MAIN_ANT) + odm_update_rx_idle_ant(dm, MAIN_ANT); + else if (dm->ant_type == ODM_FIX_AUX_ANT) + odm_update_rx_idle_ant(dm, AUX_ANT); + } else { + phydm_enable_antenna_diversity(dm); + } + dm->pre_ant_type = dm->ant_type; + } else if (dm_value[0] == 2) { + /*@dynamic period for AntDiv*/ + dm->antdiv_period = (u8)dm_value[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "AntDiv_period=((%d))\n", dm->antdiv_period); + } + #if (RTL8821C_SUPPORT == 1) + else if (dm_value[0] == 3 && + dm->support_ic_type == ODM_RTL8821C) { + /*Only for 8821C*/ + if (dm_value[1] == 0) { + fat_tab->force_antdiv_type = false; + PDM_SNPF(out_len, used, output + used, out_len - used, + "[8821C] AntDiv: Default\n"); + } else if (dm_value[1] == 1) { + fat_tab->force_antdiv_type = true; + fat_tab->antdiv_type_dbg = CG_TRX_HW_ANTDIV; + PDM_SNPF(out_len, used, output + used, out_len - used, + "[8821C] AntDiv: HW diversity\n"); + } else if (dm_value[1] == 2) { + fat_tab->force_antdiv_type = true; + fat_tab->antdiv_type_dbg = S0S1_SW_ANTDIV; + PDM_SNPF(out_len, used, output + used, out_len - used, + "[8821C] AntDiv: SW diversity\n"); + } + } + #endif + #ifdef ODM_EVM_ENHANCE_ANTDIV + else if (dm_value[0] == 4) { + if (dm_value[1] == 0) { + /*@init parameters for EVM AntDiv*/ + phydm_evm_sw_antdiv_init(dm); + PDM_SNPF(out_len, used, output + used, out_len - used, + "init evm antdiv parameters\n"); + } else if (dm_value[1] == 1) { + /*training number for EVM AntDiv*/ + dm->antdiv_train_num = (u8)dm_value[2]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "antdiv_train_num = ((%d))\n", + dm->antdiv_train_num); + } else if (dm_value[1] == 2) { + /*training interval for EVM AntDiv*/ + dm->antdiv_intvl = (u8)dm_value[2]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "antdiv_intvl = ((%d))\n", + dm->antdiv_intvl); + } else if (dm_value[1] == 3) { + /*@function period for EVM AntDiv*/ + dm->evm_antdiv_period = (u8)dm_value[2]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "evm_antdiv_period = ((%d))\n", + dm->evm_antdiv_period); + } else if (dm_value[1] == 100) {/*show parameters*/ + PDM_SNPF(out_len, used, output + used, out_len - used, + "ant_type = ((%d))\n", dm->ant_type); + PDM_SNPF(out_len, used, output + used, out_len - used, + "antdiv_train_num = ((%d))\n", + dm->antdiv_train_num); + PDM_SNPF(out_len, used, output + used, out_len - used, + "antdiv_intvl = ((%d))\n", + dm->antdiv_intvl); + PDM_SNPF(out_len, used, output + used, out_len - used, + "evm_antdiv_period = ((%d))\n", + dm->evm_antdiv_period); + } + } + #ifdef CONFIG_2T4R_ANTENNA + else if (dm_value[0] == 5) { /*Only for 8822B 2T4R case*/ if (dm_value[1] == 0) { - p_dm_odm->antdiv_select = 0; - PHYDM_SNPRINTF((output + used, out_len - used, "AntDiv: Auto\n")); + dm->ant_type2 = ODM_AUTO_ANT; + PDM_SNPF(out_len, used, output + used, out_len - used, + "AntDiv: PathB Auto\n"); } else if (dm_value[1] == 1) { - p_dm_odm->antdiv_select = 1; - PHYDM_SNPRINTF((output + used, out_len - used, "AntDiv: Fix MAin\n")); + dm->ant_type2 = ODM_FIX_MAIN_ANT; + PDM_SNPF(out_len, used, output + used, out_len - used, + "AntDiv: PathB Fix Main\n"); } else if (dm_value[1] == 2) { - p_dm_odm->antdiv_select = 2; - PHYDM_SNPRINTF((output + used, out_len - used, "AntDiv: Fix Aux\n")); + dm->ant_type2 = ODM_FIX_AUX_ANT; + PDM_SNPF(out_len, used, output + used, out_len - used, + "AntDiv: PathB Fix Aux\n"); } - } else if (dm_value[0] == 2) { /*dynamic period for AntDiv*/ - p_dm_odm->antdiv_period = (u8)dm_value[1]; - PHYDM_SNPRINTF((output + used, out_len - used, "AntDiv_period = ((%d))\n", p_dm_odm->antdiv_period)); + if (dm->ant_type2 != ODM_AUTO_ANT) { + odm_stop_antenna_switch_dm(dm); + if (dm->ant_type2 == ODM_FIX_MAIN_ANT) + phydm_update_rx_idle_ant_pathb(dm, MAIN_ANT); + else if (dm->ant_type2 == ODM_FIX_AUX_ANT) + phydm_update_rx_idle_ant_pathb(dm, AUX_ANT); + } else { + phydm_enable_antenna_diversity(dm); + } + dm->pre_ant_type2 = dm->ant_type2; } + #endif + #endif + *_used = used; + *_out_len = out_len; } -#endif /*#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY))*/ - -void -odm_ant_div_reset( - void *p_dm_void -) +void odm_ant_div_reset(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - - if (p_dm_odm->ant_div_type == S0S1_SW_ANTDIV) { -#ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY - odm_s0s1_sw_ant_div_reset(p_dm_odm); -#endif - } + struct dm_struct *dm = (struct dm_struct *)dm_void; + #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY + if (dm->ant_div_type == S0S1_SW_ANTDIV) + odm_s0s1_sw_ant_div_reset(dm); + #endif } -void -odm_antenna_diversity_init( - void *p_dm_void -) +void odm_antenna_diversity_init(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; -#if 0 - if (p_dm_odm->mp_mode == true) - return; -#endif - -#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) - odm_ant_div_config(p_dm_odm); - odm_ant_div_init(p_dm_odm); -#endif + odm_ant_div_config(dm); + odm_ant_div_init(dm); } -void -odm_antenna_diversity( - void *p_dm_void -) +void odm_antenna_diversity(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - if (p_dm_odm->mp_mode == true) + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (*dm->mp_mode) return; -#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) - odm_ant_div(p_dm_odm); -#endif + if (!(dm->support_ability & ODM_BB_ANT_DIV)) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "[Return!!!] Not Support Antenna Diversity Function\n"); + return; + } + + if (dm->pause_ability & ODM_BB_ANT_DIV) { + PHYDM_DBG(dm, DBG_ANT_DIV, "Return: Pause AntDIv in LV=%d\n", + dm->pause_lv_table.lv_antdiv); + return; + } + + odm_ant_div(dm); } +#endif /*@#ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY*/ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_antdiv.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_antdiv.h index 272b4fd58ed3..31a39e0a28ac 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_antdiv.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_antdiv.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,68 +9,96 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ -#ifndef __PHYDMANTDIV_H__ -#define __PHYDMANTDIV_H__ +#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 "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 ============================================================ * 1 Definition - * 1 ============================================================ */ + * 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 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 */ +#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 */ +/* @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_N_ANTDIV_SUPPORT (ODM_RTL8188E | ODM_RTL8192E | ODM_RTL8723B |\ + ODM_RTL8188F | ODM_RTL8723D | ODM_RTL8195A |\ + ODM_RTL8197F | ODM_RTL8721D) +#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_ANTDIV_2G_SUPPORT_IC (ODM_RTL8188E | ODM_RTL8192E | ODM_RTL8723B |\ + ODM_RTL8881A | ODM_RTL8188F | ODM_RTL8723D |\ + ODM_RTL8197F) +#define ODM_ANTDIV_5G_SUPPORT_IC (ODM_RTL8821 | ODM_RTL8881A | ODM_RTL8812 |\ + ODM_RTL8821C | ODM_RTL8822B) -#define ODM_EVM_ENHANCE_ANTDIV_SUPPORT_IC (ODM_RTL8192E) +#define ODM_EVM_ANTDIV_IC (ODM_RTL8192E | ODM_RTL8197F | ODM_RTL8822B) #define ODM_ANTDIV_2G BIT(0) #define ODM_ANTDIV_5G BIT(1) @@ -77,15 +106,20 @@ #define ANTDIV_ON 1 #define ANTDIV_OFF 0 +#define ANT_PATH_A 0 +#define ANT_PATH_B 1 +#define ANT_PATH_AB 2 + #define FAT_ON 1 #define FAT_OFF 0 #define TX_BY_DESC 1 #define TX_BY_REG 0 -#define RSSI_METHOD 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 @@ -103,6 +137,9 @@ #define FORCE_RSSI_DIFF 10 +#define HT_IDX 16 +#define VHT_IDX 20 + #define CSI_ON 1 #define CSI_OFF 0 @@ -129,27 +166,36 @@ #define RSSI_CHECK_RESET_PERIOD 10 #define RSSI_CHECK_THRESHOLD 50 -/*Hong Lin Smart antenna*/ +/*@Hong Lin Smart antenna*/ #define HL_SMTANT_2WIRE_DATA_LEN 24 -/* 1 ============================================================ +#if (RTL8723D_SUPPORT == 1) + #ifndef CONFIG_ANTDIV_PERIOD + #define CONFIG_ANTDIV_PERIOD 1 + #endif +#endif +/* @1 ============================================================ * 1 structure - * 1 ============================================================ */ + * 1 ============================================================ + */ -struct _sw_antenna_switch_ { - u8 double_chk_flag; /*If current antenna RSSI > "RSSI_CHECK_THRESHOLD", than check this antenna again*/ +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 pre_ant; 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; + u8 train_time_flag; + /*@base on RSSI difference between two antennas*/ + struct phydm_timer_list sw_antdiv_timer; u32 pkt_cnt_sw_ant_div_by_ctrl_frame; - bool is_sw_ant_div_by_ctrl_frame; + boolean is_sw_ant_div_by_ctrl_frame; #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) #if USE_WORKITEM @@ -157,33 +203,30 @@ struct _sw_antenna_switch_ { #endif #endif - /* AntDect (Before link Antenna Switch check) need to be moved*/ + /* @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; - bool ANTA_ON; /*To indicate ant A is or not*/ - bool ANTB_ON; /*To indicate ant B is on or not*/ - bool pre_aux_fail_detec; - bool rssi_ant_dect_result; + 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_ { - bool w_bfer_client[ODM_ASSOCIATE_ENTRY_NUM]; - bool w_bfee_client[ODM_ASSOCIATE_ENTRY_NUM]; - u32 MA_rx_TP[ODM_ASSOCIATE_ENTRY_NUM]; - u32 MA_rx_TP_DIV[ODM_ASSOCIATE_ENTRY_NUM]; + 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 bd_ccoex_type_wbfer; u8 num_txbfee_client; u8 num_txbfer_client; u8 bdc_try_counter; @@ -197,56 +240,16 @@ struct _BF_DIV_COEX_ { u8 num_bf_tar; u8 num_div_tar; - bool is_all_div_sta_idle; - bool is_all_bf_sta_idle; - bool bdc_try_flag; - bool BF_pass; - bool DIV_pass; + boolean is_all_div_sta_idle; + boolean is_all_bf_sta_idle; + boolean bdc_try_flag; + boolean BF_pass; + boolean DIV_pass; }; #endif #endif -#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -struct _SMART_ANTENNA_TRAINNING_ { - u32 latch_time; - bool 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*/ - 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 data_codeword_bit_num; - u8 per_beam_training_pkt_num; - u8 decision_holding_period; - u8 pkt_counter; - u32 fast_training_beam_num; - u32 pre_fast_training_beam_num; - u32 pkt_rssi_pre[SUPPORT_RF_PATH_NUM][SUPPORT_BEAM_PATTERN_NUM]; - u8 beam_train_cnt[SUPPORT_RF_PATH_NUM][SUPPORT_BEAM_PATTERN_NUM]; - u8 beam_train_rssi_diff[SUPPORT_RF_PATH_NUM][SUPPORT_BEAM_PATTERN_NUM]; - u32 pkt_rssi_sum[8][SUPPORT_BEAM_PATTERN_NUM]; - u32 pkt_rssi_cnt[8][SUPPORT_BEAM_PATTERN_NUM]; - u32 rx_idle_beam[SUPPORT_RF_PATH_NUM]; - u32 pre_codeword; - bool force_update_beam_en; - u32 beacon_counter; - u32 pre_beacon_counter; - u8 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 - -}; -#endif - -struct _FAST_ANTENNA_TRAINNING_ { +struct phydm_fat_struct { u8 bssid[6]; u8 antsel_rx_keep_0; u8 antsel_rx_keep_1; @@ -256,34 +259,52 @@ struct _FAST_ANTENNA_TRAINNING_ { 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]; + u16 main_ht_cnt[HT_IDX]; + u16 aux_ht_cnt[HT_IDX]; + u16 main_vht_cnt[VHT_IDX]; + u16 aux_vht_cnt[VHT_IDX]; + u16 main_sum[ODM_ASSOCIATE_ENTRY_NUM]; + u16 aux_sum[ODM_ASSOCIATE_ENTRY_NUM]; + u16 main_cnt[ODM_ASSOCIATE_ENTRY_NUM]; + u16 aux_cnt[ODM_ASSOCIATE_ENTRY_NUM]; + u16 main_sum_cck[ODM_ASSOCIATE_ENTRY_NUM]; + u16 aux_sum_cck[ODM_ASSOCIATE_ENTRY_NUM]; + u16 main_cnt_cck[ODM_ASSOCIATE_ENTRY_NUM]; + u16 aux_cnt_cck[ODM_ASSOCIATE_ENTRY_NUM]; u8 rx_idle_ant; + u8 rx_idle_ant2; + u8 rvrt_val; u8 ant_div_on_off; - bool is_become_linked; + u8 div_path_type; + boolean is_become_linked; + boolean get_stats; 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 - 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]; - bool EVM_method_enable; + /*@For 1SS RX phy rate*/ + u32 main_evm_sum[ODM_ASSOCIATE_ENTRY_NUM]; + u32 aux_evm_sum[ODM_ASSOCIATE_ENTRY_NUM]; + u32 main_evm_cnt[ODM_ASSOCIATE_ENTRY_NUM]; + u32 aux_evm_cnt[ODM_ASSOCIATE_ENTRY_NUM]; + + /*@For 2SS RX phy rate*/ + u32 main_evm_2ss_sum[ODM_ASSOCIATE_ENTRY_NUM][2];/*@2SS with A1+B*/ + u32 aux_evm_2ss_sum[ODM_ASSOCIATE_ENTRY_NUM][2];/*@2SS with A2+B*/ + u32 main_evm_2ss_cnt[ODM_ASSOCIATE_ENTRY_NUM]; + u32 aux_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; @@ -295,36 +316,46 @@ struct _FAST_ANTENNA_TRAINNING_ { u32 aux_crc32_ok_cnt; u32 main_crc32_fail_cnt; u32 aux_crc32_fail_cnt; + + u32 main_tp; + u32 aux_tp; + u32 main_tp_cnt; + u32 aux_tp_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; + u32 main_ctrl_sum; + u32 aux_ctrl_sum; + u32 main_ctrl_cnt; + u32 aux_ctrl_cnt; #endif u8 b_fix_tx_ant; - bool fix_ant_bfee; - bool enable_ctrl_frame_antdiv; - bool use_ctrl_frame_antdiv; + boolean fix_ant_bfee; + boolean enable_ctrl_frame_antdiv; + boolean use_ctrl_frame_antdiv; + boolean *is_no_csi_feedback; + boolean force_antdiv_type; + u8 antdiv_type_dbg; 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; + u8 *p_force_tx_by_desc; + u8 force_tx_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 ============================================================ * 1 enumeration - * 1 ============================================================ */ + * 1 ============================================================ + */ - - -enum fat_state_e /*Fast antenna training*/ +enum fat_state /*@Fast antenna training*/ { FAT_BEFORE_LINK_STATE = 0, FAT_PREPARE_STATE = 1, @@ -332,301 +363,170 @@ enum fat_state_e /*Fast antenna training*/ FAT_DECISION_STATE = 3 }; -enum ant_div_type_e { +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*/ + 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 ============================================================ * 1 function prototype - * 1 ============================================================ */ + * 1 ============================================================ + */ +void odm_stop_antenna_switch_dm(void *dm_void); -void -odm_stop_antenna_switch_dm( - void *p_dm_void -); +void phydm_enable_antenna_diversity(void *dm_void); -void -phydm_enable_antenna_diversity( - void *p_dm_void -); +void odm_set_ant_config(void *dm_void, u8 ant_setting /* @0=A, 1=B, 2=C,....*/ + ); -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 *dm_void); -#define sw_ant_div_rest_after_link odm_sw_ant_div_rest_after_link +void odm_ant_div_on_off(void *dm_void, u8 swch, u8 path); -void odm_sw_ant_div_rest_after_link( - void *p_dm_void -); +void odm_tx_by_tx_desc_or_reg(void *dm_void, u8 swch); #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -void -phydm_antdiv_reset_statistic( - void *p_dm_void, - u32 macid -); +void phydm_antdiv_reset_statistic(void *dm_void, u32 macid); -void -odm_update_rx_idle_ant( - void *p_dm_void, - u8 ant -); +void odm_update_rx_idle_ant(void *dm_void, u8 ant); + +void phydm_update_rx_idle_ant_pathb(void *dm_void, u8 ant); + +void phydm_set_antdiv_val(void *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 -); +void odm_update_rx_idle_ant_8723b(void *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 -); +void phydm_update_rx_idle_antenna_8188F(void *dm_void, u32 default_ant); #endif #if (RTL8723D_SUPPORT == 1) -void -phydm_set_tx_ant_pwr_8723d( - void *p_dm_void, - u8 ant -); +void phydm_set_tx_ant_pwr_8723d(void *dm_void, u8 ant); + +void odm_update_rx_idle_ant_8723d(void *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 -); +void odm_sw_antdiv_callback(struct phydm_timer_list *timer); +void odm_sw_antdiv_workitem_callback(void *context); #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -void -odm_sw_antdiv_workitem_callback( - void *p_context -); +void odm_sw_antdiv_workitem_callback(void *context); -void -odm_sw_antdiv_callback( - void *function_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_s0s1_sw_ant_div_by_ctrl_frame(void *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_antsel_statistics_ctrl(void *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 -); +void odm_s0s1_sw_ant_div_by_ctrl_frame_process_rssi(void *dm_void, + void *phy_info_void, + void *pkt_info_void); #endif #ifdef ODM_EVM_ENHANCE_ANTDIV -void -odm_evm_fast_ant_training_callback( - void *p_dm_void -); -#endif +void phydm_evm_sw_antdiv_init(void *dm_void); -void -odm_hw_ant_div( - void *p_dm_void -); +void phydm_rx_rate_for_antdiv(void *dm_void, void *pkt_info_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 - - -#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 +void phydm_antdiv_reset_rx_rate(void *dm_void); #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -void -phydm_beam_switch_workitem_callback( - void *p_context -); +void phydm_evm_antdiv_callback(struct phydm_timer_list *timer); -void -phydm_beam_decision_workitem_callback( - void *p_context -); +void phydm_evm_antdiv_workitem_callback(void *context); + +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) +void phydm_evm_antdiv_callback(void *dm_void); + +void phydm_evm_antdiv_workitem_callback(void *context); + +#else +void phydm_evm_antdiv_callback(void *dm_void); +#endif #endif -void -phydm_update_beam_pattern( - void *p_dm_void, - u32 codeword, - u32 codeword_length -); +void odm_hw_ant_div(void *dm_void); -void -phydm_set_all_ant_same_beam_num( - 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 *dm_void); -void -phydm_hl_smart_ant_debug( - void *p_dm_void, - u32 *const dm_value, - u32 *_used, - char *output, - u32 *_out_len -); +void odm_fast_ant_training_callback(void *dm_void); -#endif/*#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1*/ +void odm_fast_ant_training_work_item_callback(void *dm_void); +#endif -void -odm_ant_div_init( - void *p_dm_void -); +void odm_ant_div_init(void *dm_void); -void -odm_ant_div( - void *p_dm_void -); - -void -odm_antsel_statistics( - void *p_dm_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 -); +void odm_ant_div(void *dm_void); +void odm_antsel_statistics(void *dm_void, void *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 *dm_void, void *phy_info_void, + void *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 -); +void odm_set_tx_ant_by_tx_info(void *dm_void, u8 *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*/ +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 -); +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*/ +#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 *dm_void); -void -odm_ant_div_config( - void *p_dm_void -); +void odm_ant_div_timers(void *dm_void, u8 state); -void -odm_ant_div_timers( - void *p_dm_void, - u8 state -); +void phydm_antdiv_debug(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len); -void -phydm_antdiv_debug( - void *p_dm_void, - u32 *const dm_value, - u32 *_used, - char *output, - u32 *_out_len -); +void odm_ant_div_reset(void *dm_void); -#endif /*#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY))*/ +void odm_antenna_diversity_init(void *dm_void); -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__*/ +void odm_antenna_diversity(void *dm_void); +#endif /*@#ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY*/ +#endif /*@#ifndef __ODMANTDIV_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_api.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_api.c new file mode 100644 index 000000000000..fb3bb0ca6c17 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_api.c @@ -0,0 +1,3096 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +/*@************************************************************ + * include files + * ************************************************************ + */ + +#include "mp_precomp.h" +#include "phydm_precomp.h" + +void phydm_reset_bb_hw_cnt(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + /*@ Reset all counter when 1 */ + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + odm_set_bb_reg(dm, R_0x1eb4, BIT(25), 1); + odm_set_bb_reg(dm, R_0x1eb4, BIT(25), 0); + } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + /*@ Reset all counter when 1 (including PMAC and PHY)*/ + /* Reset Page F counter*/ + odm_set_bb_reg(dm, R_0xb58, BIT(0), 1); + odm_set_bb_reg(dm, R_0xb58, BIT(0), 0); + } else if (dm->support_ic_type & ODM_IC_11N_SERIES) { + odm_set_bb_reg(dm, R_0xf14, BIT(16), 0x1); + odm_set_bb_reg(dm, R_0xf14, BIT(16), 0x0); + } +} + +void phydm_dynamic_ant_weighting(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + +#ifdef DYN_ANT_WEIGHTING_SUPPORT + #if (RTL8197F_SUPPORT) + if (dm->support_ic_type & (ODM_RTL8197F)) + phydm_dynamic_ant_weighting_8197f(dm); + #endif + + #if (RTL8812A_SUPPORT) + if (dm->support_ic_type & (ODM_RTL8812)) { + phydm_dynamic_ant_weighting_8812a(dm); + } + #endif + + #if (RTL8822B_SUPPORT) + if (dm->support_ic_type & (ODM_RTL8822B)) + phydm_dynamic_ant_weighting_8822b(dm); + #endif +#endif +} + +#ifdef DYN_ANT_WEIGHTING_SUPPORT +void phydm_ant_weight_dbg(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + char help[] = "-h"; + u32 var1[10] = {0}; + u32 used = *_used; + u32 out_len = *_out_len; + + if ((strcmp(input[1], help) == 0)) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "echo dis_dym_ant_weighting {0/1}\n"); + + } else { + PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); + + if (var1[0] == 1) { + dm->is_disable_dym_ant_weighting = 1; + PDM_SNPF(out_len, used, output + used, out_len - used, + "Disable dyn-ant-weighting\n"); + } else { + dm->is_disable_dym_ant_weighting = 0; + PDM_SNPF(out_len, used, output + used, out_len - used, + "Enable dyn-ant-weighting\n"); + } + } + *_used = used; + *_out_len = out_len; +} +#endif + +void phydm_trx_antenna_setting_init(void *dm_void, u8 num_rf_path) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 rx_ant = 0, tx_ant = 0; + u8 path_bitmap = 1; + + path_bitmap = (u8)phydm_gen_bitmask(num_rf_path); +#if 0 + /*PHYDM_DBG(dm, ODM_COMP_INIT, "path_bitmap=0x%x\n", path_bitmap);*/ +#endif + + dm->tx_ant_status = path_bitmap; + dm->rx_ant_status = path_bitmap; + + if (num_rf_path == PDM_1SS) + return; + + #if (defined(PHYDM_COMPILE_ABOVE_2SS)) + if (dm->support_ic_type & + (ODM_RTL8192F | ODM_RTL8192E | ODM_RTL8197F)) { + dm->rx_ant_status = (u8)odm_get_bb_reg(dm, R_0xc04, 0x3); + dm->tx_ant_status = (u8)odm_get_bb_reg(dm, R_0x90c, 0x3); + } else if (dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8814A)) { + dm->rx_ant_status = (u8)odm_get_bb_reg(dm, R_0x808, 0xf); + dm->tx_ant_status = (u8)odm_get_bb_reg(dm, R_0x80c, 0xf); + } + #endif + #if (defined(PHYDM_IC_JGR3_SERIES_SUPPORT)) + if (dm->support_ic_type & + (ODM_RTL8198F | ODM_RTL8814B | ODM_RTL8822C)) { + dm->rx_ant_status = (u8)odm_get_bb_reg(dm, R_0x824, 0xf0000); + dm->tx_ant_status = (u8)odm_get_bb_reg(dm, R_0x820, 0xf); + } + #endif + + PHYDM_DBG(dm, ODM_COMP_INIT, "[%s]ant_status{tx,rx}={0x%x, 0x%x}\n", + __func__, dm->tx_ant_status, dm->rx_ant_status); +} + +void phydm_config_ofdm_tx_path(void *dm_void, u32 path) +{ +#if (RTL8192E_SUPPORT || RTL8812A_SUPPORT) + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 ofdm_tx_path = 0x33; + + if (dm->num_rf_path == PDM_1SS) + return; + + switch (dm->support_ic_type) { + #if (RTL8192E_SUPPORT) + case ODM_RTL8192E: + if (path == BB_PATH_A) + odm_set_bb_reg(dm, R_0x90c, MASKDWORD, 0x81121111); + else if (path == BB_PATH_B) + odm_set_bb_reg(dm, R_0x90c, MASKDWORD, 0x82221222); + else if (path == BB_PATH_AB) + odm_set_bb_reg(dm, R_0x90c, MASKDWORD, 0x83321333); + + break; + #endif + + #if (RTL8812A_SUPPORT) + case 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(dm, R_0x80c, 0xff00, ofdm_tx_path); + + break; + #endif + + default: + break; + } +#endif +} + +void phydm_config_ofdm_rx_path(void *dm_void, u32 path) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 val = 0; + + if (dm->support_ic_type & (ODM_RTL8192E)) { +#if (RTL8192E_SUPPORT) + if (path == BB_PATH_A) + val = 1; + else if (path == BB_PATH_B) + val = 2; + else if (path == BB_PATH_AB) + val = 3; + + odm_set_bb_reg(dm, R_0xc04, 0xff, ((val << 4) | val)); + odm_set_bb_reg(dm, R_0xd04, 0xf, val); +#endif + } +#if (RTL8812A_SUPPORT || RTL8822B_SUPPORT) + else if (dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8822B)) { + if (path == BB_PATH_A) + val = 1; + else if (path == BB_PATH_B) + val = 2; + else if (path == BB_PATH_AB) + val = 3; + + odm_set_bb_reg(dm, R_0x808, MASKBYTE0, ((val << 4) | val)); + } +#endif +} + +void phydm_config_cck_rx_antenna_init(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + +#if (defined(PHYDM_COMPILE_ABOVE_2SS)) + if (dm->support_ic_type & ODM_IC_1SS) + return; + + /*@CCK 2R CCA parameters*/ + odm_set_bb_reg(dm, R_0xa00, BIT(15), 0x0); /*@Disable Ant diversity*/ + odm_set_bb_reg(dm, R_0xa70, BIT(7), 0); /*@Concurrent CCA at LSB & USB*/ + odm_set_bb_reg(dm, R_0xa74, BIT(8), 0); /*RX path diversity enable*/ + odm_set_bb_reg(dm, R_0xa14, BIT(7), 0); /*r_en_mrc_antsel*/ + odm_set_bb_reg(dm, R_0xa20, (BIT(5) | BIT(4)), 1); /*@MBC weighting*/ + + if (dm->support_ic_type & (ODM_RTL8192E | ODM_RTL8197F | ODM_RTL8192F)) + odm_set_bb_reg(dm, R_0xa08, BIT(28), 1); /*r_cck_2nd_sel_eco*/ + else if (dm->support_ic_type & ODM_RTL8814A) + odm_set_bb_reg(dm, R_0xa84, BIT(28), 1); /*@2R CCA only*/ +#endif +} + +void phydm_config_cck_rx_path(void *dm_void, enum bb_path path) +{ +#if (defined(PHYDM_COMPILE_ABOVE_2SS)) + struct dm_struct *dm = (struct dm_struct *)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; + + if (dm->support_ic_type & ODM_IC_1SS) + return; + + 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; + } + /*@CCK_1 input signal path*/ + odm_set_bb_reg(dm, R_0xa04, (BIT(27) | BIT(26)), cck_path[0]); + /*@CCK_2 input signal path*/ + odm_set_bb_reg(dm, R_0xa04, (BIT(25) | BIT(24)), cck_path[1]); + /*@enable Rx path diversity*/ + odm_set_bb_reg(dm, R_0xa74, BIT(8), path_div_select); + /*@enable 2R Rx path*/ + odm_set_bb_reg(dm, R_0xa2c, BIT(18), en_2R_path); + /*@enable 2R MRC*/ + odm_set_bb_reg(dm, R_0xa2c, BIT(22), en_2R_mrc); + if (dm->support_ic_type & ODM_RTL8192F) { + if (path == BB_PATH_A) { + odm_set_bb_reg(dm, R_0xa04, (BIT(27) | BIT(26)), 0); + odm_set_bb_reg(dm, R_0xa04, (BIT(25) | BIT(24)), 0); + odm_set_bb_reg(dm, R_0xa74, BIT(8), 0); + odm_set_bb_reg(dm, R_0xa2c, (BIT(18) | BIT(17)), 0); + odm_set_bb_reg(dm, R_0xa2c, (BIT(22) | BIT(21)), 0); + } else if (path == BB_PATH_B) {/*@for DC cancellation*/ + odm_set_bb_reg(dm, R_0xa04, (BIT(27) | BIT(26)), 1); + odm_set_bb_reg(dm, R_0xa04, (BIT(25) | BIT(24)), 1); + odm_set_bb_reg(dm, R_0xa74, BIT(8), 0); + odm_set_bb_reg(dm, R_0xa2c, (BIT(18) | BIT(17)), 0); + odm_set_bb_reg(dm, R_0xa2c, (BIT(22) | BIT(21)), 0); + } else if (path == BB_PATH_AB) { + odm_set_bb_reg(dm, R_0xa04, (BIT(27) | BIT(26)), 0); + odm_set_bb_reg(dm, R_0xa04, (BIT(25) | BIT(24)), 1); + odm_set_bb_reg(dm, R_0xa74, BIT(8), 1); + odm_set_bb_reg(dm, R_0xa2c, (BIT(18) | BIT(17)), 1); + odm_set_bb_reg(dm, R_0xa2c, (BIT(22) | BIT(21)), 1); + } + } else if (dm->support_ic_type & ODM_RTL8822B) { + if (path == BB_PATH_A) { + odm_set_bb_reg(dm, R_0xa04, (BIT(27) | BIT(26)), 0); + odm_set_bb_reg(dm, R_0xa04, (BIT(25) | BIT(24)), 0); + } else { + odm_set_bb_reg(dm, R_0xa04, (BIT(27) | BIT(26)), 1); + odm_set_bb_reg(dm, R_0xa04, (BIT(25) | BIT(24)), 1); + } + } + +#endif +} + +void phydm_config_cck_tx_path(void *dm_void, enum bb_path path) +{ +#if (defined(PHYDM_COMPILE_ABOVE_2SS)) + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (path == BB_PATH_A) + odm_set_bb_reg(dm, R_0xa04, 0xf0000000, 0x8); + else if (path == BB_PATH_B) + odm_set_bb_reg(dm, R_0xa04, 0xf0000000, 0x4); + else if (path == BB_PATH_AB) + odm_set_bb_reg(dm, R_0xa04, 0xf0000000, 0xc); +#endif +} + +void phydm_config_trx_path_v2(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len) +{ +#if (RTL8822B_SUPPORT || RTL8197F_SUPPORT || RTL8192F_SUPPORT ||\ + RTL8822C_SUPPORT || RTL8814B_SUPPORT) + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 used = *_used; + u32 out_len = *_out_len; + u32 val[10] = {0}; + char help[] = "-h"; + u8 i = 0, input_idx = 0; + enum bb_path tx_path, rx_path, tx_path_ctrl; + boolean dbg_mode_en; + + if (!(dm->support_ic_type & + (ODM_RTL8822B | ODM_RTL8197F | ODM_RTL8192F | ODM_RTL8822C | + ODM_RTL8814B | ODM_RTL8812F | ODM_RTL8197G))) + return; + + for (i = 0; i < 5; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_HEX, &val[i]); + input_idx++; + } + } + + if (input_idx == 0) + return; + + dbg_mode_en = (boolean)val[0]; + tx_path = (enum bb_path)val[1]; + rx_path = (enum bb_path)val[2]; + tx_path_ctrl = (enum bb_path)val[3]; + + if ((strcmp(input[1], help) == 0)) { + if (dm->support_ic_type & ODM_RTL8822C) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "{en} {tx_path} {rx_path} {ff:auto, else:1ss_tx_path}\n" + ); + } else { + PDM_SNPF(out_len, used, output + used, out_len - used, + "{en} {tx_path} {rx_path} {is_tx_2_path}\n"); + } + + } else if (dbg_mode_en) { + dm->is_disable_phy_api = false; + phydm_api_trx_mode(dm, tx_path, rx_path, tx_path_ctrl); + dm->is_disable_phy_api = true; + PDM_SNPF(out_len, used, output + used, out_len - used, + "T/RX path = 0x%x/0x%x, tx_path_ctrl=%d\n", + tx_path, rx_path, tx_path_ctrl); + PDM_SNPF(out_len, used, output + used, out_len - used, + "T/RX path_en={0x%x, 0x%x}, tx_1ss=%d\n", + dm->tx_ant_status, dm->rx_ant_status, + dm->tx_1ss_status); + } else { + dm->is_disable_phy_api = false; + PDM_SNPF(out_len, used, output + used, out_len - used, + "Disable API debug mode\n"); + } +#endif +} + +void phydm_config_trx_path_v1(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len) +{ +#if (RTL8192E_SUPPORT || RTL8812A_SUPPORT) + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 used = *_used; + u32 out_len = *_out_len; + u32 val[10] = {0}; + char help[] = "-h"; + u8 i = 0, input_idx = 0; + + if (!(dm->support_ic_type & (ODM_RTL8192E | ODM_RTL8812))) + return; + + for (i = 0; i < 5; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_HEX, &val[i]); + input_idx++; + } + } + + if (input_idx == 0) + return; + + if ((strcmp(input[1], help) == 0)) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "{0:CCK, 1:OFDM} {1:TX, 2:RX} {1:path_A, 2:path_B, 3:path_AB}\n"); + + *_used = used; + *_out_len = out_len; + return; + + } else if (val[0] == 0) { + /* @CCK */ + if (val[1] == 1) { /*TX*/ + if (val[2] == 1) + phydm_config_cck_tx_path(dm, BB_PATH_A); + else if (val[2] == 2) + phydm_config_cck_tx_path(dm, BB_PATH_B); + else if (val[2] == 3) + phydm_config_cck_tx_path(dm, BB_PATH_AB); + } else if (val[1] == 2) { /*RX*/ + + phydm_config_cck_rx_antenna_init(dm); + + if (val[2] == 1) + phydm_config_cck_rx_path(dm, BB_PATH_A); + else if (val[2] == 2) + phydm_config_cck_rx_path(dm, BB_PATH_B); + else if (val[2] == 3) + phydm_config_cck_rx_path(dm, BB_PATH_AB); + } + } + /* OFDM */ + else if (val[0] == 1) { + if (val[1] == 1) /*TX*/ + phydm_config_ofdm_tx_path(dm, val[2]); + else if (val[1] == 2) /*RX*/ + phydm_config_ofdm_rx_path(dm, val[2]); + } + + PDM_SNPF(out_len, used, output + used, out_len - used, + "PHYDM Set path [%s] [%s] = [%s%s%s%s]\n", + (val[0] == 1) ? "OFDM" : "CCK", + (val[1] == 1) ? "TX" : "RX", + (val[2] & 0x1) ? "A" : "", (val[2] & 0x2) ? "B" : "", + (val[2] & 0x4) ? "C" : "", + (val[2] & 0x8) ? "D" : ""); + + *_used = used; + *_out_len = out_len; +#endif +} + +void phydm_config_trx_path(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (dm->support_ic_type & (ODM_RTL8192E | ODM_RTL8812)) { + #if (RTL8192E_SUPPORT || RTL8812A_SUPPORT) + phydm_config_trx_path_v1(dm, input, _used, output, _out_len); + #endif + } else if (dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8197F | + ODM_RTL8192F | ODM_RTL8822C | ODM_RTL8812F | + ODM_RTL8197G | ODM_RTL8814B)) { + #if (RTL8822B_SUPPORT || RTL8197F_SUPPORT ||\ + RTL8192F_SUPPORT || RTL8822C_SUPPORT ||\ + RTL8814B_SUPPORT || RTL8812F_SUPPORT ||\ + RTL8197G_SUPPORT) + phydm_config_trx_path_v2(dm, input, _used, output, _out_len); + #endif + } +} + +void phydm_tx_2path(void *dm_void) +{ +#if (defined(PHYDM_COMPILE_IC_2SS)) + struct dm_struct *dm = (struct dm_struct *)dm_void; + enum bb_path rx_path = (enum bb_path)dm->rx_ant_status; + + PHYDM_DBG(dm, ODM_COMP_API, "%s ======>\n", __func__); + + + if (!(dm->support_ic_type & ODM_IC_2SS)) + return; + + #if (RTL8822B_SUPPORT || RTL8192F_SUPPORT || RTL8197F_SUPPORT ||\ + RTL8822C_SUPPORT || RTL8812F_SUPPORT || RTL8197G_SUPPORT) + if (dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8197F | ODM_RTL8192F | + ODM_RTL8822C | ODM_RTL8812F | ODM_RTL8197G)) + phydm_api_trx_mode(dm, BB_PATH_AB, rx_path, BB_PATH_AB); + #endif + + #if (RTL8812A_SUPPORT || RTL8192E_SUPPORT) + if (dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8192E)) { + phydm_config_cck_tx_path(dm, BB_PATH_AB); + phydm_config_ofdm_tx_path(dm, BB_PATH_AB); + } + #endif +#endif +} + +void phydm_stop_3_wire(void *dm_void, u8 set_type) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (set_type == PHYDM_SET) { + /*@[Stop 3-wires]*/ + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + odm_set_bb_reg(dm, R_0x180c, 0x3, 0x0); + odm_set_bb_reg(dm, R_0x180c, BIT(28), 0x1); + + #if (defined(PHYDM_COMPILE_ABOVE_2SS)) + if (dm->support_ic_type & PHYDM_IC_ABOVE_2SS) { + odm_set_bb_reg(dm, R_0x410c, 0x3, 0x0); + odm_set_bb_reg(dm, R_0x410c, BIT(28), 0x1); + } + #endif + + #if (defined(PHYDM_COMPILE_ABOVE_4SS)) + if (dm->support_ic_type & PHYDM_IC_ABOVE_4SS) { + odm_set_bb_reg(dm, R_0x520c, 0x3, 0x0); + odm_set_bb_reg(dm, R_0x520c, BIT(28), 0x1); + odm_set_bb_reg(dm, R_0x530c, 0x3, 0x0); + odm_set_bb_reg(dm, R_0x530c, BIT(28), 0x1); + } + #endif + } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + odm_set_bb_reg(dm, R_0xc00, 0xf, 0x4); + odm_set_bb_reg(dm, R_0xe00, 0xf, 0x4); + } else { + odm_set_bb_reg(dm, R_0x88c, 0xf00000, 0xf); + } + + } else { /*@if (set_type == PHYDM_REVERT)*/ + + /*@[Start 3-wires]*/ + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + odm_set_bb_reg(dm, R_0x180c, 0x3, 0x3); + odm_set_bb_reg(dm, R_0x180c, BIT(28), 0x1); + + #if (defined(PHYDM_COMPILE_ABOVE_2SS)) + if (dm->support_ic_type & PHYDM_IC_ABOVE_2SS) { + odm_set_bb_reg(dm, R_0x410c, 0x3, 0x3); + odm_set_bb_reg(dm, R_0x410c, BIT(28), 0x1); + } + #endif + + #if (defined(PHYDM_COMPILE_ABOVE_4SS)) + if (dm->support_ic_type & PHYDM_IC_ABOVE_4SS) { + odm_set_bb_reg(dm, R_0x520c, 0x3, 0x3); + odm_set_bb_reg(dm, R_0x520c, BIT(28), 0x1); + odm_set_bb_reg(dm, R_0x530c, 0x3, 0x3); + odm_set_bb_reg(dm, R_0x530c, BIT(28), 0x1); + } + #endif + } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + odm_set_bb_reg(dm, R_0xc00, 0xf, 0x7); + odm_set_bb_reg(dm, R_0xe00, 0xf, 0x7); + } else { + odm_set_bb_reg(dm, R_0x88c, 0xf00000, 0x0); + } + } +} + +u8 phydm_stop_ic_trx(void *dm_void, u8 set_type) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_api_stuc *api = &dm->api_table; + u32 i = 0; + u8 trx_idle_success = false; + u32 dbg_port_value = 0; + + if (set_type == PHYDM_SET) { + /*@[Stop TRX]---------------------------------------------------------*/ + /*set debug port to 0x0*/ + if (!phydm_set_bb_dbg_port(dm, DBGPORT_PRI_3, 0x0)) + return PHYDM_SET_FAIL; + + for (i = 0; i < 100; i++) { + dbg_port_value = phydm_get_bb_dbg_port_val(dm); + + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + /* BB idle */ + if ((dbg_port_value & 0x1FFEFF3F) == 0 && + (dbg_port_value & 0xC0010000) == + 0xC0010000) { + PHYDM_DBG(dm, ODM_COMP_API, + "Stop trx wait for (%d) times\n", + i); + + trx_idle_success = true; + break; + } + } else { + /* PHYTXON && CCA_all */ + if (dm->support_ic_type == ODM_RTL8721D) { + if ((dbg_port_value & + (BIT(20) | BIT(15))) == 0) { + PHYDM_DBG(dm, ODM_COMP_API, + "Stop trx wait for (%d) times\n", + i); + + trx_idle_success = true; + break; + } + } else { + if ((dbg_port_value & + (BIT(17) | BIT(3))) == 0) { + PHYDM_DBG(dm, ODM_COMP_API, + "Stop trx wait for (%d) times\n", + i); + + trx_idle_success = true; + break; + } + } + } + ODM_delay_ms(1); + } + phydm_release_bb_dbg_port(dm); + + if (trx_idle_success) { + api->tx_queue_bitmap = odm_read_1byte(dm, R_0x522); + + /*pause all TX queue*/ + odm_set_mac_reg(dm, R_0x520, 0xff0000, 0xff); + + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + /*@disable OFDM RX CCA*/ + odm_set_bb_reg(dm, R_0x1c68, BIT(24), 1); + } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + /*@disable OFDM RX CCA*/ + odm_set_bb_reg(dm, R_0x838, BIT(1), 1); + } else { + api->rxiqc_reg1 = odm_read_4byte(dm, R_0xc14); + api->rxiqc_reg2 = odm_read_4byte(dm, R_0xc1c); + /* @[ Set IQK Matrix = 0 ] + * equivalent to [ Turn off CCA] + */ + odm_set_bb_reg(dm, R_0xc14, MASKDWORD, 0x0); + odm_set_bb_reg(dm, R_0xc1c, MASKDWORD, 0x0); + } + phydm_dis_cck_trx(dm, PHYDM_SET); + } else { + return PHYDM_SET_FAIL; + } + + return PHYDM_SET_SUCCESS; + + } else { /*@if (set_type == PHYDM_REVERT)*/ + /*Release all TX queue*/ + odm_write_1byte(dm, R_0x522, api->tx_queue_bitmap); + + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + /*@enable OFDM RX CCA*/ + odm_set_bb_reg(dm, R_0x1c68, BIT(24), 0); + } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + /*@enable OFDM RX CCA*/ + odm_set_bb_reg(dm, R_0x838, BIT(1), 0); + } else { + /* @[Set IQK Matrix = 0] equivalent to [ Turn off CCA]*/ + odm_write_4byte(dm, R_0xc14, api->rxiqc_reg1); + odm_write_4byte(dm, R_0xc1c, api->rxiqc_reg2); + } + phydm_dis_cck_trx(dm, PHYDM_REVERT); + return PHYDM_SET_SUCCESS; + } +} + +void phydm_dis_cck_trx(void *dm_void, u8 set_type) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_api_stuc *api = &dm->api_table; + + if (set_type == PHYDM_SET) { + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + api->ccktx_path = (u8)odm_get_bb_reg(dm, R_0x1a04, + 0xf0000000); + /* @CCK RxIQ weighting = [0,0] */ + odm_set_bb_reg(dm, R_0x1a14, 0x300, 0x3); + /* @disable CCK Tx */ + odm_set_bb_reg(dm, R_0x1a04, 0xf0000000, 0x0); + } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + api->ccktx_path = (u8)odm_get_bb_reg(dm, R_0xa04, + 0xf0000000); + /* @disable CCK block */ + odm_set_bb_reg(dm, R_0x808, BIT(28), 0); + /* @disable CCK Tx */ + odm_set_bb_reg(dm, R_0xa04, 0xf0000000, 0x0); + } else { + api->ccktx_path = (u8)odm_get_bb_reg(dm, R_0xa04, + 0xf0000000); + /* @disable whole CCK block */ + odm_set_bb_reg(dm, R_0x800, BIT(24), 0); + /* @disable CCK Tx */ + odm_set_bb_reg(dm, R_0xa04, 0xf0000000, 0x0); + } + } else if (set_type == PHYDM_REVERT) { + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + /* @CCK RxIQ weighting = [1,1] */ + odm_set_bb_reg(dm, R_0x1a14, 0x300, 0x0); + /* @enable CCK Tx */ + odm_set_bb_reg(dm, R_0x1a04, 0xf0000000, + api->ccktx_path); + } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + /* @enable CCK block */ + odm_set_bb_reg(dm, R_0x808, BIT(28), 1); + /* @enable CCK Tx */ + odm_set_bb_reg(dm, R_0xa04, 0xf0000000, + api->ccktx_path); + } else { + /* @enable whole CCK block */ + odm_set_bb_reg(dm, R_0x800, BIT(24), 1); + /* @enable CCK Tx */ + odm_set_bb_reg(dm, R_0xa04, 0xf0000000, + api->ccktx_path); + } + } +} +void phydm_set_ext_switch(void *dm_void, u32 ext_ant_switch) +{ +#if (RTL8821A_SUPPORT || RTL8881A_SUPPORT) + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (!(dm->support_ic_type & (ODM_RTL8821 | ODM_RTL8881A))) + return; + + /*Output Pin Settings*/ + + /*select DPDT_P and DPDT_N as output pin*/ + odm_set_mac_reg(dm, R_0x4c, BIT(23), 0); + + /*@by WLAN control*/ + odm_set_mac_reg(dm, R_0x4c, BIT(24), 1); + + /*@DPDT_N = 1b'0*/ /*@DPDT_P = 1b'0*/ + odm_set_bb_reg(dm, R_0xcb4, 0xFF, 77); + + if (ext_ant_switch == 1) { /*@2b'01*/ + odm_set_bb_reg(dm, R_0xcb4, (BIT(29) | BIT(28)), 1); + PHYDM_DBG(dm, ODM_COMP_API, "8821A ant swh=2b'01\n"); + } else if (ext_ant_switch == 2) { /*@2b'10*/ + odm_set_bb_reg(dm, R_0xcb4, BIT(29) | BIT(28), 2); + PHYDM_DBG(dm, ODM_COMP_API, "*8821A ant swh=2b'10\n"); + } +#endif +} + +void phydm_csi_mask_enable(void *dm_void, u32 enable) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + boolean en = false; + + en = (enable == FUNC_ENABLE) ? true : false; + + if (dm->support_ic_type & ODM_IC_11N_SERIES) { + odm_set_bb_reg(dm, R_0xd2c, BIT(28), en); + PHYDM_DBG(dm, ODM_COMP_API, + "Enable CSI Mask: Reg 0xD2C[28] = ((0x%x))\n", en); + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + odm_set_bb_reg(dm, R_0xc0c, BIT(3), en); + PHYDM_DBG(dm, ODM_COMP_API, + "Enable CSI Mask: Reg 0xc0c[3] = ((0x%x))\n", en); + #endif + } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + odm_set_bb_reg(dm, R_0x874, BIT(0), en); + PHYDM_DBG(dm, ODM_COMP_API, + "Enable CSI Mask: Reg 0x874[0] = ((0x%x))\n", en); + } +} + +void phydm_clean_all_csi_mask(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (dm->support_ic_type & ODM_IC_11N_SERIES) { + odm_set_bb_reg(dm, R_0xd40, MASKDWORD, 0); + odm_set_bb_reg(dm, R_0xd44, MASKDWORD, 0); + odm_set_bb_reg(dm, R_0xd48, MASKDWORD, 0); + odm_set_bb_reg(dm, R_0xd4c, MASKDWORD, 0); + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + u8 i = 0, idx_lmt = 0; + + if (dm->support_ic_type & + (ODM_RTL8822C | ODM_RTL8812F | ODM_RTL8197G)) + idx_lmt = 127; + else /*@for IC supporting 80 + 80*/ + idx_lmt = 255; + + odm_set_bb_reg(dm, R_0x1ee8, 0x3, 0x3); + odm_set_bb_reg(dm, R_0x1d94, BIT(31) | BIT(30), 0x1); + for (i = 0; i < idx_lmt; i++) { + odm_set_bb_reg(dm, R_0x1d94, MASKBYTE2, i); + odm_set_bb_reg(dm, R_0x1d94, MASKBYTE0, 0x0); + } + odm_set_bb_reg(dm, R_0x1ee8, 0x3, 0x0); + #endif + } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + odm_set_bb_reg(dm, R_0x880, MASKDWORD, 0); + odm_set_bb_reg(dm, R_0x884, MASKDWORD, 0); + odm_set_bb_reg(dm, R_0x888, MASKDWORD, 0); + odm_set_bb_reg(dm, R_0x88c, MASKDWORD, 0); + odm_set_bb_reg(dm, R_0x890, MASKDWORD, 0); + odm_set_bb_reg(dm, R_0x894, MASKDWORD, 0); + odm_set_bb_reg(dm, R_0x898, MASKDWORD, 0); + odm_set_bb_reg(dm, R_0x89c, MASKDWORD, 0); + } +} + +void phydm_set_csi_mask(void *dm_void, u32 tone_idx_tmp, u8 tone_direction) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 byte_offset = 0, bit_offset = 0; + u32 target_reg = 0; + u8 reg_tmp_value = 0; + 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 (dm->support_ic_type & ODM_IC_11N_SERIES) { + tone_num = 64; + csi_mask_reg_p = 0xD40; + csi_mask_reg_n = 0xD48; + + } else if (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(dm, target_reg); + PHYDM_DBG(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(dm, target_reg, reg_tmp_value); + PHYDM_DBG(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 *dm_void, u32 tone_idx_tmp, u32 bw) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + /*tone_idx X 10*/ + u32 nbi_128[NBI_128TONE] = {25, 55, 85, 115, 135, + 155, 185, 205, 225, 245, + 265, 285, 305, 335, 355, + 375, 395, 415, 435, 455, + 485, 505, 525, 555, 585, 615, 635}; + /*tone_idx X 10*/ + u32 nbi_256[NBI_256TONE] = {25, 55, 85, 115, 135, + 155, 175, 195, 225, 245, + 265, 285, 305, 325, 345, + 365, 385, 405, 425, 445, + 465, 485, 505, 525, 545, + 565, 585, 605, 625, 645, + 665, 695, 715, 735, 755, + 775, 795, 815, 835, 855, + 875, 895, 915, 935, 955, + 975, 995, 1015, 1035, 1055, + 1085, 1105, 1125, 1145, 1175, + 1195, 1225, 1255, 1275}; + u32 reg_idx = 0; + u32 i; + u8 nbi_table_idx = FFT_128_TYPE; + + if (dm->support_ic_type & ODM_IC_11N_SERIES) { + nbi_table_idx = FFT_128_TYPE; + } else if (dm->support_ic_type & ODM_IC_11AC_1_SERIES) { + nbi_table_idx = FFT_256_TYPE; + } else if (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_128TONE; i++) { + if (tone_idx_tmp < nbi_128[i]) { + reg_idx = i + 1; + break; + } + } + + } else if (nbi_table_idx == FFT_256_TYPE) { + for (i = 0; i < NBI_256TONE; i++) { + if (tone_idx_tmp < nbi_256[i]) { + reg_idx = i + 1; + break; + } + } + } + + if (dm->support_ic_type & ODM_IC_11N_SERIES) { + odm_set_bb_reg(dm, R_0xc40, 0x1f000000, reg_idx); + PHYDM_DBG(dm, ODM_COMP_API, + "Set tone idx: Reg0xC40[28:24] = ((0x%x))\n", + reg_idx); + } else { + odm_set_bb_reg(dm, R_0x87c, 0xfc000, reg_idx); + PHYDM_DBG(dm, ODM_COMP_API, + "Set tone idx: Reg0x87C[19:14] = ((0x%x))\n", + reg_idx); + } +} + +void phydm_nbi_enable(void *dm_void, u32 enable) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 val = 0; + + val = (enable == FUNC_ENABLE) ? 1 : 0; + + PHYDM_DBG(dm, ODM_COMP_API, "Enable NBI=%d\n", val); + + if (dm->support_ic_type & ODM_IC_11N_SERIES) { + if (dm->support_ic_type & (ODM_RTL8192F | ODM_RTL8197F)) { + val = (enable == FUNC_ENABLE) ? 0xf : 0; + odm_set_bb_reg(dm, R_0xc50, 0xf000000, val); + } else { + odm_set_bb_reg(dm, R_0xc40, BIT(9), val); + } + } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + if (dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8821C)) { + odm_set_bb_reg(dm, R_0x87c, BIT(13), val); + odm_set_bb_reg(dm, R_0xc20, BIT(28), val); + if (dm->rf_type > RF_1T1R) + odm_set_bb_reg(dm, R_0xe20, BIT(28), val); + } else { + odm_set_bb_reg(dm, R_0x87c, BIT(13), val); + } + } +} + +u8 phydm_find_fc(void *dm_void, u32 channel, u32 bw, u32 second_ch, u32 *fc_in) +{ + struct dm_struct *dm = (struct dm_struct *)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 *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(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(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; + start_ch = &start_ch_per_40m[0]; + channel_offset = CH_OFFSET_40M; + } else if (bw == 80) { + num_start_channel = NUM_START_CH_80M; + start_ch = &start_ch_per_80m[0]; + channel_offset = CH_OFFSET_80M; + } + + for (i = 0; i < (num_start_channel - 1); i++) { + if (channel < start_ch[i + 1]) { + channel = start_ch[i] + channel_offset; + break; + } + } + PHYDM_DBG(dm, ODM_COMP_API, "Mod_CH = ((%d))\n", + channel); + } + + fc = 5180 + (channel - 36) * 5; + + } else { + PHYDM_DBG(dm, ODM_COMP_API, "CH = ((%d)) Error setting\n", + channel); + return PHYDM_SET_FAIL; + } + + *fc_in = fc; + + return PHYDM_SET_SUCCESS; +} + +u8 phydm_find_intf_distance(void *dm_void, u32 bw, u32 fc, u32 f_interference, + u32 *tone_idx_tmp_in) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 bw_up = 0, bw_low = 0; + u32 int_distance = 0; + u32 tone_idx_tmp = 0; + u8 set_result = PHYDM_SET_NO_NEED; + + bw_up = fc + bw / 2; + bw_low = fc - bw / 2; + + PHYDM_DBG(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 = DIFF_2(fc, f_interference); + /*@10*(int_distance /0.3125)*/ + tone_idx_tmp = (int_distance << 5); + PHYDM_DBG(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); + *tone_idx_tmp_in = tone_idx_tmp; + set_result = PHYDM_SET_SUCCESS; + } + + return set_result; +} + +u8 phydm_csi_mask_setting(void *dm_void, u32 enable, u32 ch, u32 bw, + u32 f_intf, u32 sec_ch) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 fc = 2412; + u8 direction = FREQ_POSITIVE; + u32 tone_idx = 0; + u8 set_result = PHYDM_SET_SUCCESS; + u8 rpt = 0; + + if (enable == FUNC_DISABLE) { + set_result = PHYDM_SET_SUCCESS; + phydm_clean_all_csi_mask(dm); + + } else { + PHYDM_DBG(dm, ODM_COMP_API, + "[Set CSI MASK_] CH = ((%d)), BW = ((%d)), f_intf = ((%d)), Scnd_CH = ((%s))\n", + ch, bw, f_intf, + (((bw == 20) || (ch > 14)) ? "Don't care" : + (sec_ch == PHYDM_ABOVE) ? "H" : "L")); + + /*@calculate fc*/ + if (phydm_find_fc(dm, ch, bw, sec_ch, &fc) == PHYDM_SET_FAIL) { + set_result = PHYDM_SET_FAIL; + } else { + /*@calculate interference distance*/ + rpt = phydm_find_intf_distance(dm, bw, fc, f_intf, + &tone_idx); + if (rpt == PHYDM_SET_SUCCESS) { + if (f_intf >= fc) + direction = FREQ_POSITIVE; + else + direction = FREQ_NEGATIVE; + + phydm_set_csi_mask(dm, tone_idx, direction); + set_result = PHYDM_SET_SUCCESS; + } else { + set_result = PHYDM_SET_NO_NEED; + } + } + } + + if (set_result == PHYDM_SET_SUCCESS) + phydm_csi_mask_enable(dm, enable); + else + phydm_csi_mask_enable(dm, FUNC_DISABLE); + + return set_result; +} + +#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT +u8 phydm_find_intf_distance_jgr3(void *dm_void, u32 bw, u32 fc, + u32 f_interference, u32 *tone_idx_tmp_in) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 bw_up = 0, bw_low = 0; + u32 int_distance = 0; + u32 tone_idx_tmp = 0; + u8 set_result = PHYDM_SET_NO_NEED; + + bw_up = 1000 * (fc + bw / 2); + bw_low = 1000 * (fc - bw / 2); + fc = 1000 * fc; + + PHYDM_DBG(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 = DIFF_2(fc, f_interference); + /*@10*(int_distance /0.3125)*/ + tone_idx_tmp = (int_distance / 312); + PHYDM_DBG(dm, ODM_COMP_API, + "int_distance = ((%d)) , tone_idx_tmp = ((%d))\n", + int_distance, tone_idx_tmp); + *tone_idx_tmp_in = tone_idx_tmp; + set_result = PHYDM_SET_SUCCESS; + } + + return set_result; +} +u8 phydm_csi_mask_setting_jgr3(void *dm_void, u32 enable, u32 ch, u32 bw, + u32 f_intf, u32 sec_ch, u8 wgt) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 fc = 2412; + u8 direction = FREQ_POSITIVE; + u32 tone_idx = 0; + u8 set_result = PHYDM_SET_SUCCESS; + u8 rpt = 0; + + if (enable == FUNC_DISABLE) { + phydm_csi_mask_enable(dm, FUNC_ENABLE); + phydm_clean_all_csi_mask(dm); + phydm_csi_mask_enable(dm, FUNC_DISABLE); + set_result = PHYDM_SET_SUCCESS; + } else { + PHYDM_DBG(dm, ODM_COMP_API, + "[Set CSI MASK] CH = ((%d)), BW = ((%d)), f_intf = ((%d)), Scnd_CH = ((%s)), wgt = ((%d))\n", + ch, bw, f_intf, + (((bw == 20) || (ch > 14)) ? "Don't care" : + (sec_ch == PHYDM_ABOVE) ? "H" : "L"), wgt); + + /*@calculate fc*/ + if (phydm_find_fc(dm, ch, bw, sec_ch, &fc) == PHYDM_SET_FAIL) { + set_result = PHYDM_SET_FAIL; + } else { + /*@calculate interference distance*/ + rpt = phydm_find_intf_distance_jgr3(dm, bw, fc, f_intf, + &tone_idx); + if (rpt == PHYDM_SET_SUCCESS) { + if (f_intf >= 1000 * fc) + direction = FREQ_POSITIVE; + else + direction = FREQ_NEGATIVE; + + phydm_csi_mask_enable(dm, FUNC_ENABLE); + phydm_set_csi_mask_jgr3(dm, tone_idx, direction, + wgt); + set_result = PHYDM_SET_SUCCESS; + } else { + set_result = PHYDM_SET_NO_NEED; + } + } + if (!(set_result == PHYDM_SET_SUCCESS)) + phydm_csi_mask_enable(dm, FUNC_DISABLE); + } + + return set_result; +} + +void phydm_set_csi_mask_jgr3(void *dm_void, u32 tone_idx_tmp, u8 tone_direction, + u8 wgt) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 reg_tmp_value = 0; + u32 tone_num = 64; + u32 table_addr = 0; + u32 addr = 0; + u8 rf_bw = 0; + u8 value = 0; + + rf_bw = odm_read_1byte(dm, R_0x9b0); + if (((rf_bw & 0xc) >> 2) == 0x2) + tone_num = 128; /* @RF80 : tone(-1) at tone_idx=255 */ + else + tone_num = 64; /* @RF20/40 : tone(-1) at tone_idx=127 */ + + if (tone_direction == FREQ_POSITIVE) { + if (tone_idx_tmp >= (tone_num - 1)) + tone_idx_tmp = (tone_num - 1); + } else { + if (tone_idx_tmp >= tone_num) + tone_idx_tmp = tone_num; + + tone_idx_tmp = (tone_num << 1) - tone_idx_tmp; + } + table_addr = tone_idx_tmp >> 1; + + reg_tmp_value = odm_read_4byte(dm, R_0x1d94); + PHYDM_DBG(dm, ODM_COMP_API, + "Pre Mask tone idx[%d]: Reg0x1d94 = ((0x%x))\n", + tone_idx_tmp, reg_tmp_value); + odm_set_bb_reg(dm, R_0x1ee8, 0x3, 0x3); + odm_set_bb_reg(dm, R_0x1d94, BIT(31) | BIT(30), 0x1); + odm_set_bb_reg(dm, R_0x1d94, MASKBYTE2, (table_addr & 0xff)); + if (tone_idx_tmp % 2) + value = (BIT(3) | (wgt & 0x7)) << 4; + else + value = BIT(3) | (wgt & 0x7); + + odm_set_bb_reg(dm, R_0x1d94, 0xff, value); + reg_tmp_value = odm_read_4byte(dm, R_0x1d94); + PHYDM_DBG(dm, ODM_COMP_API, + "New Mask tone idx[%d]: Reg0x1d94 = ((0x%x))\n", + tone_idx_tmp, reg_tmp_value); + odm_set_bb_reg(dm, R_0x1ee8, 0x3, 0x0); +} + +void phydm_nbi_reset_jgr3(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + odm_set_bb_reg(dm, R_0x818, BIT(3), 1); + odm_set_bb_reg(dm, R_0x1d3c, 0x78000000, 0); + odm_set_bb_reg(dm, R_0x818, BIT(3), 0); + odm_set_bb_reg(dm, R_0x818, BIT(11), 0); +} + +u8 phydm_nbi_setting_jgr3(void *dm_void, u32 enable, u32 ch, u32 bw, u32 f_intf, + u32 sec_ch, u8 path) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 fc = 2412; + u8 direction = FREQ_POSITIVE; + u32 tone_idx = 0; + u8 set_result = PHYDM_SET_SUCCESS; + u8 rpt = 0; + + if (enable == FUNC_DISABLE) { + phydm_nbi_reset_jgr3(dm); + set_result = PHYDM_SET_SUCCESS; + } else { + PHYDM_DBG(dm, ODM_COMP_API, + "[Set NBI] CH = ((%d)), BW = ((%d)), f_intf = ((%d)), Scnd_CH = ((%s))\n", + ch, bw, f_intf, + (((sec_ch == PHYDM_DONT_CARE) || (bw == 20) || + (ch > 14)) ? "Don't care" : + (sec_ch == PHYDM_ABOVE) ? "H" : "L")); + + /*@calculate fc*/ + if (phydm_find_fc(dm, ch, bw, sec_ch, &fc) == PHYDM_SET_FAIL) { + set_result = PHYDM_SET_FAIL; + } else { + /*@calculate interference distance*/ + rpt = phydm_find_intf_distance_jgr3(dm, bw, fc, f_intf, + &tone_idx); + if (rpt == PHYDM_SET_SUCCESS) { + if (f_intf >= 1000 * fc) + direction = FREQ_POSITIVE; + else + direction = FREQ_NEGATIVE; + + phydm_set_nbi_reg_jgr3(dm, tone_idx, direction, + path); + set_result = PHYDM_SET_SUCCESS; + } else { + set_result = PHYDM_SET_NO_NEED; + } + } + } + + if (set_result == PHYDM_SET_SUCCESS) + phydm_nbi_enable_jgr3(dm, enable, path); + else + phydm_nbi_enable_jgr3(dm, FUNC_DISABLE, path); + + return set_result; +} + +void phydm_set_nbi_reg_jgr3(void *dm_void, u32 tone_idx_tmp, u8 tone_direction, + u8 path) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 reg_tmp_value = 0; + u32 tone_num = 64; + u32 addr = 0; + u8 rf_bw = 0; + + rf_bw = odm_read_1byte(dm, R_0x9b0); + if (((rf_bw & 0xc) >> 2) == 0x2) + tone_num = 128; /* RF80 : tone-1 at tone_idx=255 */ + else + tone_num = 64; /* RF20/40 : tone-1 at tone_idx=127 */ + + if (tone_direction == FREQ_POSITIVE) { + if (tone_idx_tmp >= (tone_num - 1)) + tone_idx_tmp = (tone_num - 1); + } else { + if (tone_idx_tmp >= tone_num) + tone_idx_tmp = tone_num; + + tone_idx_tmp = (tone_num << 1) - tone_idx_tmp; + } + + switch (path) { + case RF_PATH_A: + odm_set_bb_reg(dm, R_0x1944, 0x001FF000, tone_idx_tmp); + PHYDM_DBG(dm, ODM_COMP_API, + "Set tone idx[%d]:PATH-A = ((0x%x))\n", + tone_idx_tmp, tone_idx_tmp); + break; + #if (defined(PHYDM_COMPILE_ABOVE_2SS)) + case RF_PATH_B: + odm_set_bb_reg(dm, R_0x4044, 0x001FF000, tone_idx_tmp); + PHYDM_DBG(dm, ODM_COMP_API, + "Set tone idx[%d]:PATH-B = ((0x%x))\n", + tone_idx_tmp, tone_idx_tmp); + break; + #endif + #if (defined(PHYDM_COMPILE_ABOVE_3SS)) + case RF_PATH_C: + odm_set_bb_reg(dm, R_0x5044, 0x001FF000, tone_idx_tmp); + PHYDM_DBG(dm, ODM_COMP_API, + "Set tone idx[%d]:PATH-C = ((0x%x))\n", + tone_idx_tmp, tone_idx_tmp); + break; + #endif + #if (defined(PHYDM_COMPILE_ABOVE_4SS)) + case RF_PATH_D: + odm_set_bb_reg(dm, R_0x5144, 0x001FF000, tone_idx_tmp); + PHYDM_DBG(dm, ODM_COMP_API, + "Set tone idx[%d]:PATH-D = ((0x%x))\n", + tone_idx_tmp, tone_idx_tmp); + break; + #endif + default: + break; + } +} + +void phydm_nbi_enable_jgr3(void *dm_void, u32 enable, u8 path) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + boolean val = false; + + val = (enable == FUNC_ENABLE) ? true : false; + + PHYDM_DBG(dm, ODM_COMP_API, "Enable NBI=%d\n", val); + + if (dm->support_ic_type & ODM_RTL8814B) { + odm_set_bb_reg(dm, R_0x1d3c, BIT(19), val); + odm_set_bb_reg(dm, R_0x818, BIT(3), val); + } else if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8812F)) { + odm_set_bb_reg(dm, R_0x818, BIT(3), !val); + } + odm_set_bb_reg(dm, R_0x818, BIT(11), val); + odm_set_bb_reg(dm, R_0x1d3c, 0x78000000, 0xf); + + if (enable == FUNC_ENABLE) { + switch (path) { + case RF_PATH_A: + odm_set_bb_reg(dm, R_0x1940, BIT(31), val); + break; + #if (defined(PHYDM_COMPILE_ABOVE_2SS)) + case RF_PATH_B: + odm_set_bb_reg(dm, R_0x4040, BIT(31), val); + break; + #endif + #if (defined(PHYDM_COMPILE_ABOVE_3SS)) + case RF_PATH_C: + odm_set_bb_reg(dm, R_0x5040, BIT(31), val); + break; + #endif + #if (defined(PHYDM_COMPILE_ABOVE_4SS)) + case RF_PATH_D: + odm_set_bb_reg(dm, R_0x5140, BIT(31), val); + break; + #endif + default: + break; + } + } else { + odm_set_bb_reg(dm, R_0x1940, BIT(31), val); + #if (defined(PHYDM_COMPILE_ABOVE_2SS)) + odm_set_bb_reg(dm, R_0x4040, BIT(31), val); + #endif + #if (defined(PHYDM_COMPILE_ABOVE_3SS)) + odm_set_bb_reg(dm, R_0x5040, BIT(31), val); + #endif + #if (defined(PHYDM_COMPILE_ABOVE_4SS)) + odm_set_bb_reg(dm, R_0x5140, BIT(31), val); + #endif + } +} + +u8 phydm_phystat_rpt_jgr3(void *dm_void, enum phystat_rpt info, + enum rf_path ant_path) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + s8 evm_org, cfo_org, rxsnr_org; + u8 i, return_info = 0, tmp_lsb = 0, tmp_msb = 0, tmp_info = 0; + + /* Update the status for each pkt */ + odm_set_bb_reg(dm, R_0x8c4, 0xfff000, 0x448); + odm_set_bb_reg(dm, R_0x8c0, MASKLWORD, 0x4001); + /* PHY status Page1 */ + odm_set_bb_reg(dm, R_0x8c0, 0x3C00000, 0x1); + /*choose debug port for phystatus */ + odm_set_bb_reg(dm, R_0x1c3c, 0xFFF00, 0x380); + + if (info == PHY_PWDB) { + /* Choose the report of the diff path */ + if (ant_path == RF_PATH_A) + odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x1); + else if (ant_path == RF_PATH_B) + odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x2); + else if (ant_path == RF_PATH_C) + odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x3); + else if (ant_path == RF_PATH_D) + odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x4); + } else if (info == PHY_EVM) { + /* Choose the report of the diff path */ + if (ant_path == RF_PATH_A) + odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x10); + else if (ant_path == RF_PATH_B) + odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x11); + else if (ant_path == RF_PATH_C) + odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x12); + else if (ant_path == RF_PATH_D) + odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x13); + return_info = (u8)odm_get_bb_reg(dm, R_0x2dbc, 0xff); + } else if (info == PHY_CFO) { + /* Choose the report of the diff path */ + if (ant_path == RF_PATH_A) + odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x14); + else if (ant_path == RF_PATH_B) + odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x15); + else if (ant_path == RF_PATH_C) + odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x16); + else if (ant_path == RF_PATH_D) + odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x17); + return_info = (u8)odm_get_bb_reg(dm, R_0x2dbc, 0xff); + } else if (info == PHY_RXSNR) { + /* Choose the report of the diff path */ + if (ant_path == RF_PATH_A) + odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x18); + else if (ant_path == RF_PATH_B) + odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x19); + else if (ant_path == RF_PATH_C) + odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x1a); + else if (ant_path == RF_PATH_D) + odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x1b); + return_info = (u8)odm_get_bb_reg(dm, R_0x2dbc, 0xff); + } else if (info == PHY_LGAIN) { + /* choose page */ + odm_set_bb_reg(dm, R_0x8c0, 0x3c00000, 0x2); + /* Choose the report of the diff path */ + if (ant_path == RF_PATH_A) { + odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0xd); + tmp_info = (u8)odm_get_bb_reg(dm, R_0x2dbc, 0x3f); + return_info = tmp_info; + } else if (ant_path == RF_PATH_B) { + odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0xd); + tmp_lsb = (u8)odm_get_bb_reg(dm, R_0x2dbc, 0xc0); + odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0xe); + tmp_msb = (u8)odm_get_bb_reg(dm, R_0x2dbc, 0xf); + tmp_info |= (tmp_msb << 2) | tmp_lsb; + return_info = tmp_info; + } else if (ant_path == RF_PATH_C) { + odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0xe); + tmp_lsb = (u8)odm_get_bb_reg(dm, R_0x2dbc, 0xf0); + odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0xf); + tmp_msb = (u8)odm_get_bb_reg(dm, R_0x2dbc, 0x3); + tmp_info |= (tmp_msb << 4) | tmp_lsb; + return_info = tmp_info; + } else if (ant_path == RF_PATH_D) { + odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x10); + tmp_info = (u8)odm_get_bb_reg(dm, R_0x2dbc, 0x3f); + return_info = tmp_info; + } + } else if (info == PHY_HT_AAGC_GAIN) { + /* choose page */ + odm_set_bb_reg(dm, R_0x8c0, 0x3c00000, 0x2); + /* Choose the report of the diff path */ + if (ant_path == RF_PATH_A) + odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x12); + else if (ant_path == RF_PATH_B) + odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x13); + else if (ant_path == RF_PATH_C) + odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x14); + else if (ant_path == RF_PATH_D) + odm_set_bb_reg(dm, R_0x8c4, 0x3ff, 0x15); + return_info = (u8)odm_get_bb_reg(dm, R_0x2dbc, 0xff); + } + return return_info; +} + +void phydm_ex_hal8814b_wifi_only_hw_config(void *dm_void) +{ + /*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 phydm_user_position_for_sniffer(void *dm_void, u8 user_position) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + /* user position valid */ + odm_set_bb_reg(dm, R_0xa68, BIT(17), 1); + /* Select user seat from pmac */ + odm_set_bb_reg(dm, R_0xa68, BIT(16), 1); + /*user seat*/ + odm_set_bb_reg(dm, R_0xa68, (BIT(19) | BIT(18)), user_position); +} + +#endif +u8 phydm_nbi_setting(void *dm_void, u32 enable, u32 ch, u32 bw, u32 f_intf, + u32 sec_ch) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 fc = 2412; + u8 direction = FREQ_POSITIVE; + u32 tone_idx = 0; + u8 set_result = PHYDM_SET_SUCCESS; + u8 rpt = 0; + + if (enable == FUNC_DISABLE) { + set_result = PHYDM_SET_SUCCESS; + } else { + PHYDM_DBG(dm, ODM_COMP_API, + "[Set NBI] CH = ((%d)), BW = ((%d)), f_intf = ((%d)), Scnd_CH = ((%s))\n", + ch, bw, f_intf, + (((sec_ch == PHYDM_DONT_CARE) || (bw == 20) || + (ch > 14)) ? "Don't care" : + (sec_ch == PHYDM_ABOVE) ? "H" : "L")); + + /*@calculate fc*/ + if (phydm_find_fc(dm, ch, bw, sec_ch, &fc) == PHYDM_SET_FAIL) { + set_result = PHYDM_SET_FAIL; + } else { + /*@calculate interference distance*/ + rpt = phydm_find_intf_distance(dm, bw, fc, f_intf, + &tone_idx); + if (rpt == PHYDM_SET_SUCCESS) { + if (f_intf >= fc) + direction = FREQ_POSITIVE; + else + direction = FREQ_NEGATIVE; + + phydm_set_nbi_reg(dm, tone_idx, bw); + + set_result = PHYDM_SET_SUCCESS; + } else { + set_result = PHYDM_SET_NO_NEED; + } + } + } + + if (set_result == PHYDM_SET_SUCCESS) + phydm_nbi_enable(dm, enable); + else + phydm_nbi_enable(dm, FUNC_DISABLE); + + return set_result; +} + +void phydm_nbi_debug(void *dm_void, char input[][16], u32 *_used, char *output, + u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 used = *_used; + u32 out_len = *_out_len; + u32 val[10] = {0}; + char help[] = "-h"; + u8 i = 0, input_idx = 0, idx_lmt = 0; + u32 enable = 0; /*@function enable*/ + u32 ch = 0; + u32 bw = 0; + u32 f_int = 0; /*@interference frequency*/ + u32 sec_ch = 0; /*secondary channel*/ + u8 rpt = 0; + u8 path = 0; + + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + idx_lmt = 6; + else + idx_lmt = 5; + for (i = 0; i < idx_lmt; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &val[i]); + input_idx++; + } + } + + if (input_idx == 0) + return; + + enable = val[0]; + ch = val[1]; + bw = val[2]; + f_int = val[3]; + sec_ch = val[4]; + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + path = (u8)val[5]; + #endif + + if ((strcmp(input[1], help) == 0)) { + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + PDM_SNPF(out_len, used, output + used, out_len - used, + "{en:1 Dis:2} {ch} {BW:20/40/80} {f_intf(khz)} {Scnd_CH(L=1, H=2)} {Path:A~D(0~3)}\n"); + else + #endif + PDM_SNPF(out_len, used, output + used, out_len - used, + "{en:1 Dis:2} {ch} {BW:20/40/80} {f_intf(khz)} {Scnd_CH(L=1, H=2)}\n"); + *_used = used; + *_out_len = out_len; + return; + } else if (val[0] == FUNC_ENABLE) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "[Enable NBI] CH = ((%d)), BW = ((%d)), f_intf = ((%d)), Scnd_CH = ((%s))\n", + ch, bw, f_int, + ((sec_ch == PHYDM_DONT_CARE) || + (bw == 20) || (ch > 14)) ? "Don't care" : + ((sec_ch == PHYDM_ABOVE) ? "H" : "L")); + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + rpt = phydm_nbi_setting_jgr3(dm, enable, ch, bw, f_int, + sec_ch, path); + else + #endif + rpt = phydm_nbi_setting(dm, enable, ch, bw, f_int, + sec_ch); + } else if (val[0] == FUNC_DISABLE) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "[Disable NBI]\n"); + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + rpt = phydm_nbi_setting_jgr3(dm, enable, ch, bw, f_int, + sec_ch, path); + else + #endif + rpt = phydm_nbi_setting(dm, enable, ch, bw, f_int, + sec_ch); + } else { + rpt = PHYDM_SET_FAIL; + } + + PDM_SNPF(out_len, used, output + used, out_len - used, + "[NBI set result: %s]\n", + (rpt == PHYDM_SET_SUCCESS) ? "Success" : + ((rpt == PHYDM_SET_NO_NEED) ? "No need" : "Error")); + + *_used = used; + *_out_len = out_len; +} + +void phydm_csi_debug(void *dm_void, char input[][16], u32 *_used, char *output, + u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 used = *_used; + u32 out_len = *_out_len; + u32 val[10] = {0}; + char help[] = "-h"; + u8 i = 0, input_idx = 0, idx_lmt = 0; + u32 enable = 0; /*@function enable*/ + u32 ch = 0; + u32 bw = 0; + u32 f_int = 0; /*@interference frequency*/ + u32 sec_ch = 0; /*secondary channel*/ + u8 rpt = 0; + u8 wgt = 0; + + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + idx_lmt = 6; + else + idx_lmt = 5; + + for (i = 0; i < idx_lmt; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &val[i]); + input_idx++; + } + } + + if (input_idx == 0) + return; + + enable = val[0]; + ch = val[1]; + bw = val[2]; + f_int = val[3]; + sec_ch = val[4]; + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + wgt = (u8)val[5]; + #endif + + if ((strcmp(input[1], help) == 0)) { + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + PDM_SNPF(out_len, used, output + used, out_len - used, + "{en:1 Dis:2} {ch} {BW:20/40/80} {f_intf(KHz)} {Scnd_CH(L=1, H=2)}\n{wgt:(7:3/4),(6~1: 1/2 ~ 1/64),(0:0)}\n"); + else + #endif + PDM_SNPF(out_len, used, output + used, out_len - used, + "{en:1 Dis:2} {ch} {BW:20/40/80} {f_intf(Mhz)} {Scnd_CH(L=1, H=2)}\n"); + + *_used = used; + *_out_len = out_len; + return; + + } else if (val[0] == FUNC_ENABLE) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "[Enable CSI MASK] CH = ((%d)), BW = ((%d)), f_intf = ((%d)), Scnd_CH = ((%s))\n", + ch, bw, f_int, + (ch > 14) ? "Don't care" : + (((sec_ch == PHYDM_DONT_CARE) || + (bw == 20) || (ch > 14)) ? "H" : "L")); + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + rpt = phydm_csi_mask_setting_jgr3(dm, enable, ch, bw, + f_int, sec_ch, wgt); + else + #endif + rpt = phydm_csi_mask_setting(dm, enable, ch, bw, f_int, + sec_ch); + } else if (val[0] == FUNC_DISABLE) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "[Disable CSI MASK]\n"); + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + rpt = phydm_csi_mask_setting_jgr3(dm, enable, ch, bw, + f_int, sec_ch, wgt); + else + #endif + rpt = phydm_csi_mask_setting(dm, enable, ch, bw, f_int, + sec_ch); + } else { + rpt = PHYDM_SET_FAIL; + } + PDM_SNPF(out_len, used, output + used, out_len - used, + "[CSI MASK set result: %s]\n", + (rpt == PHYDM_SET_SUCCESS) ? "Success" : + ((rpt == PHYDM_SET_NO_NEED) ? "No need" : "Error")); + + *_used = used; + *_out_len = out_len; +} + +void phydm_stop_ck320(void *dm_void, u8 enable) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 val = enable ? 1 : 0; + + if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + odm_set_bb_reg(dm, R_0x8b4, BIT(6), val); + } else { + if (dm->support_ic_type & ODM_IC_N_2SS) /*N-2SS*/ + odm_set_bb_reg(dm, R_0x87c, BIT(29), val); + else /*N-1SS*/ + odm_set_bb_reg(dm, R_0x87c, BIT(31), val); + } +} + +boolean +phydm_set_bb_txagc_offset(void *dm_void, s8 power_offset, /*@(unit: dB)*/ + u8 add_half_db /*@(+0.5 dB)*/) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + s8 power_idx = power_offset * 2; + boolean set_success = false; + + PHYDM_DBG(dm, ODM_COMP_API, "power_offset=%d, add_half_db =%d\n", + power_offset, add_half_db); + + #if ODM_IC_11AC_SERIES_SUPPORT + if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + if (power_offset > -16 && power_offset < 15) { + if (add_half_db) + power_idx += 1; + + power_idx &= 0x3f; + + PHYDM_DBG(dm, ODM_COMP_API, "Reg_idx =0x%x\n", + power_idx); + odm_set_bb_reg(dm, R_0x8b4, 0x3f, power_idx); + set_success = true; + } else { + pr_debug("[Warning] TX AGC Offset Setting error!"); + } + } + #endif + + #if ODM_IC_11N_SERIES_SUPPORT + if (dm->support_ic_type & ODM_IC_11N_SERIES) { + if (power_offset > -8 || power_offset < 7) { + if (add_half_db) + power_idx += 1; + + power_idx &= 0x1f; + + PHYDM_DBG(dm, ODM_COMP_API, "Reg_idx =0x%x\n", + power_idx); + /*r_txagc_offset_a*/ + odm_set_bb_reg(dm, R_0x80c, 0x1f00, power_idx); + /*r_txagc_offset_b*/ + odm_set_bb_reg(dm, R_0x80c, 0x3e000, power_idx); + set_success = true; + } else { + pr_debug("[Warning] TX AGC Offset Setting error!"); + } + } + #endif + + return set_success; +} + +#ifdef PHYDM_COMMON_API_SUPPORT +boolean +phydm_api_shift_txagc(void *dm_void, u32 pwr_offset, enum rf_path path, + boolean is_positive) { + struct dm_struct *dm = (struct dm_struct *)dm_void; + boolean ret = false; + u32 txagc_cck = 0; + u32 txagc_ofdm = 0; + u32 r_txagc_ofdm[4] = {0x18e8, 0x41e8, 0x52e8, 0x53e8}; + u32 r_txagc_cck[4] = {0x18a0, 0x41a0, 0x52a0, 0x53a0}; + + #if (RTL8822C_SUPPORT || RTL8812F_SUPPORT || RTL8197G_SUPPORT) + if (dm->support_ic_type & + (ODM_RTL8822C | ODM_RTL8812F | ODM_RTL8197G)) { + if (path > RF_PATH_B) { + PHYDM_DBG(dm, ODM_PHY_CONFIG, "Unsupported path (%d)\n", + path); + return false; + } + txagc_cck = (u8)odm_get_bb_reg(dm, r_txagc_cck[path], + 0x7F0000); + txagc_ofdm = (u8)odm_get_bb_reg(dm, r_txagc_ofdm[path], + 0x1FC00); + if (is_positive) { + if (((txagc_cck + pwr_offset) > 127) || + ((txagc_ofdm + pwr_offset) > 127)) + return false; + + txagc_cck += pwr_offset; + txagc_ofdm += pwr_offset; + } else { + if (pwr_offset > txagc_cck || pwr_offset > txagc_ofdm) + return false; + + txagc_cck -= pwr_offset; + txagc_ofdm -= pwr_offset; + } + #if (RTL8822C_SUPPORT) + ret = config_phydm_write_txagc_ref_8822c(dm, (u8)txagc_cck, + path, PDM_CCK); + ret &= config_phydm_write_txagc_ref_8822c(dm, (u8)txagc_ofdm, + path, PDM_OFDM); + #endif + #if (RTL8812F_SUPPORT) + ret = config_phydm_write_txagc_ref_8812f(dm, (u8)txagc_cck, + path, PDM_CCK); + ret &= config_phydm_write_txagc_ref_8812f(dm, (u8)txagc_ofdm, + path, PDM_OFDM); + #endif + #if (RTL8197G_SUPPORT) + ret = config_phydm_write_txagc_ref_8197g(dm, (u8)txagc_cck, + path, PDM_CCK); + ret &= config_phydm_write_txagc_ref_8197g(dm, (u8)txagc_ofdm, + path, PDM_OFDM); + #endif + PHYDM_DBG(dm, ODM_PHY_CONFIG, + "%s: path-%d txagc_cck_ref=%x txagc_ofdm_ref=0x%x\n", + __func__, path, txagc_cck, txagc_ofdm); + } + #endif + + #if (RTL8198F_SUPPORT || RTL8814B_SUPPORT) + if (dm->support_ic_type & (ODM_RTL8198F | ODM_RTL8814B)) { + if (path > RF_PATH_D) { + PHYDM_DBG(dm, ODM_PHY_CONFIG, "Unsupported path (%d)\n", + path); + return false; + } + txagc_cck = (u8)odm_get_bb_reg(dm, r_txagc_cck[path], + 0x7F0000); + txagc_ofdm = (u8)odm_get_bb_reg(dm, r_txagc_ofdm[path], + 0x1FC00); + if (is_positive) { + if (((txagc_cck + pwr_offset) > 127) || + ((txagc_ofdm + pwr_offset) > 127)) + return false; + + txagc_cck += pwr_offset; + txagc_ofdm += pwr_offset; + } else { + if (pwr_offset > txagc_cck || pwr_offset > txagc_ofdm) + return false; + + txagc_cck -= pwr_offset; + txagc_ofdm -= pwr_offset; + } + #if (RTL8198F_SUPPORT) + ret = config_phydm_write_txagc_ref_8198f(dm, (u8)txagc_cck, + path, PDM_CCK); + ret &= config_phydm_write_txagc_ref_8198f(dm, (u8)txagc_ofdm, + path, PDM_OFDM); + #endif + #if (RTL8814B_SUPPORT) + ret = config_phydm_write_txagc_ref_8814b(dm, (u8)txagc_cck, + path, PDM_CCK); + ret &= config_phydm_write_txagc_ref_8814b(dm, (u8)txagc_ofdm, + path, PDM_OFDM); + #endif + PHYDM_DBG(dm, ODM_PHY_CONFIG, + "%s: path-%d txagc_cck_ref=%x txagc_ofdm_ref=0x%x\n", + __func__, path, txagc_cck, txagc_ofdm); + } + #endif + + return ret; +} + +boolean +phydm_api_set_txagc(void *dm_void, u32 pwr_idx, enum rf_path path, + u8 rate, boolean is_single_rate) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + boolean ret = false; + #if (RTL8198F_SUPPORT || RTL8822C_SUPPORT || RTL8812F_SUPPORT ||\ + RTL8814B_SUPPORT || RTL8197G_SUPPORT) + u8 base = 0; + u8 txagc_tmp = 0; + s8 pw_by_rate_tmp = 0; + s8 pw_by_rate_new = 0; + #endif + #if (DM_ODM_SUPPORT_TYPE & ODM_AP) + u8 i = 0; + #endif + +#if (RTL8822B_SUPPORT || RTL8821C_SUPPORT || RTL8195B_SUPPORT) + if (dm->support_ic_type & + (ODM_RTL8822B | ODM_RTL8821C | ODM_RTL8195B)) { + if (is_single_rate) { + #if (RTL8822B_SUPPORT) + if (dm->support_ic_type == ODM_RTL8822B) + ret = phydm_write_txagc_1byte_8822b(dm, pwr_idx, + path, rate); + #endif + + #if (RTL8821C_SUPPORT) + if (dm->support_ic_type == ODM_RTL8821C) + ret = phydm_write_txagc_1byte_8821c(dm, pwr_idx, + path, rate); + #endif + + #if (RTL8195B_SUPPORT) + if (dm->support_ic_type == ODM_RTL8195B) + ret = phydm_write_txagc_1byte_8195b(dm, pwr_idx, + path, rate); + #endif + + #if (DM_ODM_SUPPORT_TYPE & ODM_AP) + set_current_tx_agc(dm->priv, path, rate, (u8)pwr_idx); + #endif + + } else { + #if (RTL8822B_SUPPORT) + if (dm->support_ic_type == ODM_RTL8822B) + ret = config_phydm_write_txagc_8822b(dm, + pwr_idx, + path, + rate); + #endif + + #if (RTL8821C_SUPPORT) + if (dm->support_ic_type == ODM_RTL8821C) + ret = config_phydm_write_txagc_8821c(dm, + pwr_idx, + path, + rate); + #endif + + #if (RTL8195B_SUPPORT) + if (dm->support_ic_type == ODM_RTL8195B) + ret = config_phydm_write_txagc_8195b(dm, + pwr_idx, + path, + rate); + #endif + + #if (DM_ODM_SUPPORT_TYPE & ODM_AP) + for (i = 0; i < 4; i++) + set_current_tx_agc(dm->priv, path, (rate + i), + (u8)pwr_idx); + #endif + } + } +#endif + +#if (RTL8198F_SUPPORT) + if (dm->support_ic_type & ODM_RTL8198F) { + if (rate < 0x4) + txagc_tmp = config_phydm_read_txagc_8198f(dm, path, + rate, + PDM_CCK); + else + txagc_tmp = config_phydm_read_txagc_8198f(dm, path, + rate, + PDM_OFDM); + + pw_by_rate_tmp = config_phydm_read_txagc_diff_8198f(dm, rate); + base = txagc_tmp - pw_by_rate_tmp; + base = base & 0x7f; + if (DIFF_2((pwr_idx & 0x7f), base) > 64 || pwr_idx > 127) + return false; + + pw_by_rate_new = (s8)(pwr_idx - base); + ret = phydm_write_txagc_1byte_8198f(dm, pw_by_rate_new, rate); + PHYDM_DBG(dm, ODM_PHY_CONFIG, + "%s: path-%d rate_idx=%x base=0x%x new_diff=0x%x\n", + __func__, path, rate, base, pw_by_rate_new); + } +#endif + +#if (RTL8822C_SUPPORT) + if (dm->support_ic_type & ODM_RTL8822C) { + if (rate < 0x4) + txagc_tmp = config_phydm_read_txagc_8822c(dm, path, + rate, + PDM_CCK); + else + txagc_tmp = config_phydm_read_txagc_8822c(dm, path, + rate, + PDM_OFDM); + + pw_by_rate_tmp = config_phydm_read_txagc_diff_8822c(dm, rate); + base = txagc_tmp - pw_by_rate_tmp; + base = base & 0x7f; + if (DIFF_2((pwr_idx & 0x7f), base) > 63 || pwr_idx > 127) + return false; + + pw_by_rate_new = (s8)(pwr_idx - base); + ret = phydm_write_txagc_1byte_8822c(dm, pw_by_rate_new, rate); + PHYDM_DBG(dm, ODM_PHY_CONFIG, + "%s: path-%d rate_idx=%x base=0x%x new_diff=0x%x\n", + __func__, path, rate, base, pw_by_rate_new); + } +#endif + +#if (RTL8814B_SUPPORT) + if (dm->support_ic_type & ODM_RTL8814B) { + if (rate < 0x4) + txagc_tmp = config_phydm_read_txagc_8814b(dm, path, + rate, + PDM_CCK); + else + txagc_tmp = config_phydm_read_txagc_8814b(dm, path, + rate, + PDM_OFDM); + + pw_by_rate_tmp = config_phydm_read_txagc_diff_8814b(dm, rate); + base = txagc_tmp - pw_by_rate_tmp; + base = base & 0x7f; + if (DIFF_2((pwr_idx & 0x7f), base) > 64) + return false; + + pw_by_rate_new = (s8)(pwr_idx - base); + ret = phydm_write_txagc_1byte_8814b(dm, pw_by_rate_new, rate); + PHYDM_DBG(dm, ODM_PHY_CONFIG, + "%s: path-%d rate_idx=%x base=0x%x new_diff=0x%x\n", + __func__, path, rate, base, pw_by_rate_new); + } +#endif + +#if (RTL8812F_SUPPORT) + if (dm->support_ic_type & ODM_RTL8812F) { + if (rate < 0x4) + txagc_tmp = config_phydm_read_txagc_8812f(dm, path, + rate, + PDM_CCK); + else + txagc_tmp = config_phydm_read_txagc_8812f(dm, path, + rate, + PDM_OFDM); + + pw_by_rate_tmp = config_phydm_read_txagc_diff_8812f(dm, rate); + base = txagc_tmp - pw_by_rate_tmp; + base = base & 0x7f; + if (DIFF_2((pwr_idx & 0x7f), base) > 63 || pwr_idx > 127) + return false; + + pw_by_rate_new = (s8)(pwr_idx - base); + ret = phydm_write_txagc_1byte_8812f(dm, pw_by_rate_new, rate); + PHYDM_DBG(dm, ODM_PHY_CONFIG, + "%s: path-%d rate_idx=%x base=0x%x new_diff=0x%x\n", + __func__, path, rate, base, pw_by_rate_new); + } +#endif + +#if (RTL8197G_SUPPORT) + if (dm->support_ic_type & ODM_RTL8197G) { + if (rate < 0x4) + txagc_tmp = config_phydm_read_txagc_8197g(dm, path, + rate, + PDM_CCK); + else + txagc_tmp = config_phydm_read_txagc_8197g(dm, path, + rate, + PDM_OFDM); + + pw_by_rate_tmp = config_phydm_read_txagc_diff_8197g(dm, rate); + base = txagc_tmp - pw_by_rate_tmp; + base = base & 0x7f; + if (DIFF_2((pwr_idx & 0x7f), base) > 63 || pwr_idx > 127) + return false; + + pw_by_rate_new = (s8)(pwr_idx - base); + ret = phydm_write_txagc_1byte_8197g(dm, pw_by_rate_new, rate); + PHYDM_DBG(dm, ODM_PHY_CONFIG, + "%s: path-%d rate_idx=%x base=0x%x new_diff=0x%x\n", + __func__, path, rate, base, pw_by_rate_new); + } +#endif + +#if (RTL8197F_SUPPORT) + if (dm->support_ic_type & ODM_RTL8197F) + ret = config_phydm_write_txagc_8197f(dm, pwr_idx, path, rate); +#endif + +#if (RTL8192F_SUPPORT) + if (dm->support_ic_type & ODM_RTL8192F) + ret = config_phydm_write_txagc_8192f(dm, pwr_idx, path, rate); +#endif + +#if (RTL8721D_SUPPORT) + if (dm->support_ic_type & ODM_RTL8721D) + ret = config_phydm_write_txagc_8721d(dm, pwr_idx, path, rate); +#endif + return ret; +} + +u8 phydm_api_get_txagc(void *dm_void, enum rf_path path, u8 hw_rate) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 ret = 0; + +#if (RTL8822B_SUPPORT) + if (dm->support_ic_type & ODM_RTL8822B) + ret = config_phydm_read_txagc_8822b(dm, path, hw_rate); +#endif + +#if (RTL8197F_SUPPORT) + if (dm->support_ic_type & ODM_RTL8197F) + ret = config_phydm_read_txagc_8197f(dm, path, hw_rate); +#endif + +#if (RTL8821C_SUPPORT) + if (dm->support_ic_type & ODM_RTL8821C) + ret = config_phydm_read_txagc_8821c(dm, path, hw_rate); +#endif + +#if (RTL8195B_SUPPORT) + if (dm->support_ic_type & ODM_RTL8195B) + ret = config_phydm_read_txagc_8195b(dm, path, hw_rate); +#endif + +/*@jj add 20170822*/ +#if (RTL8192F_SUPPORT) + if (dm->support_ic_type & ODM_RTL8192F) + ret = config_phydm_read_txagc_8192f(dm, path, hw_rate); +#endif + +#if (RTL8198F_SUPPORT) + if (dm->support_ic_type & ODM_RTL8198F) { + if (hw_rate < 0x4) { + ret = config_phydm_read_txagc_8198f(dm, path, hw_rate, + PDM_CCK); + } else { + ret = config_phydm_read_txagc_8198f(dm, path, hw_rate, + PDM_OFDM); + } + } +#endif + +#if (RTL8822C_SUPPORT) + if (dm->support_ic_type & ODM_RTL8822C) { + if (hw_rate < 0x4) { + ret = config_phydm_read_txagc_8822c(dm, path, hw_rate, + PDM_CCK); + } else { + ret = config_phydm_read_txagc_8822c(dm, path, hw_rate, + PDM_OFDM); + } + } +#endif + +#if (RTL8814B_SUPPORT) + if (dm->support_ic_type & ODM_RTL8814B) { + if (hw_rate < 0x4) { + ret = config_phydm_read_txagc_8814b(dm, path, hw_rate, + PDM_CCK); + } else { + ret = config_phydm_read_txagc_8814b(dm, path, hw_rate, + PDM_OFDM); + } + } +#endif + +#if (RTL8812F_SUPPORT) + if (dm->support_ic_type & ODM_RTL8812F) { + if (hw_rate < 0x4) { + ret = config_phydm_read_txagc_8812f(dm, path, hw_rate, + PDM_CCK); + } else { + ret = config_phydm_read_txagc_8812f(dm, path, hw_rate, + PDM_OFDM); + } + } +#endif + +#if (RTL8197G_SUPPORT) + if (dm->support_ic_type & ODM_RTL8197G) { + if (hw_rate < 0x4) { + ret = config_phydm_read_txagc_8197g(dm, path, hw_rate, + PDM_CCK); + } else { + ret = config_phydm_read_txagc_8197g(dm, path, hw_rate, + PDM_OFDM); + } + } +#endif + +#if (RTL8721D_SUPPORT) + if (dm->support_ic_type & ODM_RTL8721D) + ret = config_phydm_read_txagc_8721d(dm, path, hw_rate); +#endif + return ret; +} + +boolean +phydm_api_switch_bw_channel(void *dm_void, u8 ch, u8 pri_ch, + enum channel_width bw) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + boolean ret = false; + + switch (dm->support_ic_type) { +#if (RTL8822B_SUPPORT) + case ODM_RTL8822B: + ret = config_phydm_switch_channel_bw_8822b(dm, ch, pri_ch, bw); + break; +#endif + +#if (RTL8197F_SUPPORT) + case ODM_RTL8197F: + ret = config_phydm_switch_channel_bw_8197f(dm, ch, pri_ch, bw); + break; +#endif + +#if (RTL8821C_SUPPORT) + case ODM_RTL8821C: + ret = config_phydm_switch_channel_bw_8821c(dm, ch, pri_ch, bw); + break; +#endif + +#if (RTL8192F_SUPPORT) + case ODM_RTL8192F: + ret = config_phydm_switch_channel_bw_8192f(dm, ch, pri_ch, bw); + break; +#endif + +#if (RTL8198F_SUPPORT) + case ODM_RTL8198F: + ret = config_phydm_switch_channel_bw_8198f(dm, ch, pri_ch, bw); + break; +#endif + +#if (RTL8822C_SUPPORT) + case ODM_RTL8822C: + ret = config_phydm_switch_channel_bw_8822c(dm, ch, pri_ch, bw); + break; +#endif + +#if (RTL8814B_SUPPORT) + case ODM_RTL8814B: + ret = config_phydm_switch_channel_bw_8814b(dm, ch, pri_ch, bw); + break; +#endif + +#if (RTL8812F_SUPPORT) + case ODM_RTL8812F: + ret = config_phydm_switch_channel_bw_8812f(dm, ch, pri_ch, bw); + break; +#endif + +#if (RTL8197G_SUPPORT) + case ODM_RTL8197G: + ret = config_phydm_switch_channel_bw_8197g(dm, ch, pri_ch, bw); + break; +#endif + +#if (RTL8721D_SUPPORT) + case ODM_RTL8721D: + ret = config_phydm_switch_channel_bw_8721d(dm, ch, pri_ch, bw); +#endif + + default: + break; + } + return ret; +} + +boolean +phydm_api_trx_mode(void *dm_void, enum bb_path tx_path, enum bb_path rx_path, + enum bb_path tx_path_ctrl) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + boolean ret = false; + boolean is_2tx = false; + + if (tx_path_ctrl == BB_PATH_AB) + is_2tx = true; + + switch (dm->support_ic_type) { + #if (RTL8822B_SUPPORT) + case ODM_RTL8822B: + ret = config_phydm_trx_mode_8822b(dm, tx_path, rx_path, + tx_path_ctrl); + break; + #endif + + #if (RTL8197F_SUPPORT) + case ODM_RTL8197F: + ret = config_phydm_trx_mode_8197f(dm, tx_path, rx_path, is_2tx); + break; + #endif + + #if (RTL8192F_SUPPORT) + case ODM_RTL8192F: + ret = config_phydm_trx_mode_8192f(dm, tx_path, rx_path, is_2tx); + break; + #endif + + #if (RTL8198F_SUPPORT) + case ODM_RTL8198F: + ret = config_phydm_trx_mode_8198f(dm, tx_path, rx_path, is_2tx); + break; + #endif + + #if 0/*(RTL8814B_SUPPORT)*/ + case ODM_RTL8814B: + ret = config_phydm_trx_mode_8814b(dm, tx_path, rx_path, is_2tx); + break; + #endif + + #if (RTL8822C_SUPPORT) + case ODM_RTL8822C: + ret = config_phydm_trx_mode_8822c(dm, tx_path, rx_path, + tx_path_ctrl); + break; + #endif + + #if (RTL8812F_SUPPORT) + case ODM_RTL8812F: + ret = config_phydm_trx_mode_8812f(dm, tx_path, rx_path, is_2tx); + break; + #endif + + #if (RTL8197G_SUPPORT) + case ODM_RTL8197G: + ret = config_phydm_trx_mode_8197g(dm, tx_path, rx_path, is_2tx); + break; + #endif + + #if (RTL8721D_SUPPORT) + case ODM_RTL8721D: + ret = config_phydm_trx_mode_8721d(dm, tx_path, rx_path, is_2tx); + break; + #endif + } + return ret; +} +#else +u8 config_phydm_read_txagc_n(void *dm_void, enum rf_path path, u8 hw_rate) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 read_back_data = INVALID_TXAGC_DATA; + u32 reg_txagc; + u32 reg_mask; + /* This function is for 92E/88E etc... */ + /* @Input need to be HW rate index, not driver rate index!!!! */ + + /* @Error handling */ + if (path > RF_PATH_B || hw_rate > ODM_RATEMCS15) { + PHYDM_DBG(dm, ODM_PHY_CONFIG, "%s: unsupported path (%d)\n", + __func__, path); + return INVALID_TXAGC_DATA; + } + + if (path == RF_PATH_A) { + switch (hw_rate) { + case ODM_RATE1M: + reg_txagc = R_0xe08; + reg_mask = 0x00007f00; + break; + case ODM_RATE2M: + reg_txagc = R_0x86c; + reg_mask = 0x00007f00; + break; + case ODM_RATE5_5M: + reg_txagc = R_0x86c; + reg_mask = 0x007f0000; + break; + case ODM_RATE11M: + reg_txagc = R_0x86c; + reg_mask = 0x7f000000; + break; + + case ODM_RATE6M: + reg_txagc = R_0xe00; + reg_mask = 0x0000007f; + break; + case ODM_RATE9M: + reg_txagc = R_0xe00; + reg_mask = 0x00007f00; + break; + case ODM_RATE12M: + reg_txagc = R_0xe00; + reg_mask = 0x007f0000; + break; + case ODM_RATE18M: + reg_txagc = R_0xe00; + reg_mask = 0x7f000000; + break; + case ODM_RATE24M: + reg_txagc = R_0xe04; + reg_mask = 0x0000007f; + break; + case ODM_RATE36M: + reg_txagc = R_0xe04; + reg_mask = 0x00007f00; + break; + case ODM_RATE48M: + reg_txagc = R_0xe04; + reg_mask = 0x007f0000; + break; + case ODM_RATE54M: + reg_txagc = R_0xe04; + reg_mask = 0x7f000000; + break; + + case ODM_RATEMCS0: + reg_txagc = R_0xe10; + reg_mask = 0x0000007f; + break; + case ODM_RATEMCS1: + reg_txagc = R_0xe10; + reg_mask = 0x00007f00; + break; + case ODM_RATEMCS2: + reg_txagc = R_0xe10; + reg_mask = 0x007f0000; + break; + case ODM_RATEMCS3: + reg_txagc = R_0xe10; + reg_mask = 0x7f000000; + break; + case ODM_RATEMCS4: + reg_txagc = R_0xe14; + reg_mask = 0x0000007f; + break; + case ODM_RATEMCS5: + reg_txagc = R_0xe14; + reg_mask = 0x00007f00; + break; + case ODM_RATEMCS6: + reg_txagc = R_0xe14; + reg_mask = 0x007f0000; + break; + case ODM_RATEMCS7: + reg_txagc = R_0xe14; + reg_mask = 0x7f000000; + break; + + case ODM_RATEMCS8: + reg_txagc = R_0xe18; + reg_mask = 0x0000007f; + break; + case ODM_RATEMCS9: + reg_txagc = R_0xe18; + reg_mask = 0x00007f00; + break; + case ODM_RATEMCS10: + reg_txagc = R_0xe18; + reg_mask = 0x007f0000; + break; + case ODM_RATEMCS11: + reg_txagc = R_0xe18; + reg_mask = 0x7f000000; + break; + case ODM_RATEMCS12: + reg_txagc = R_0xe1c; + reg_mask = 0x0000007f; + break; + case ODM_RATEMCS13: + reg_txagc = R_0xe1c; + reg_mask = 0x00007f00; + break; + case ODM_RATEMCS14: + reg_txagc = R_0xe1c; + reg_mask = 0x007f0000; + break; + case ODM_RATEMCS15: + reg_txagc = R_0xe1c; + reg_mask = 0x7f000000; + break; + + default: + PHYDM_DBG(dm, ODM_PHY_CONFIG, "Invalid HWrate!\n"); + break; + } + } else if (path == RF_PATH_B) { + switch (hw_rate) { + case ODM_RATE1M: + reg_txagc = R_0x838; + reg_mask = 0x00007f00; + break; + case ODM_RATE2M: + reg_txagc = R_0x838; + reg_mask = 0x007f0000; + break; + case ODM_RATE5_5M: + reg_txagc = R_0x838; + reg_mask = 0x7f000000; + break; + case ODM_RATE11M: + reg_txagc = R_0x86c; + reg_mask = 0x0000007f; + break; + + case ODM_RATE6M: + reg_txagc = R_0x830; + reg_mask = 0x0000007f; + break; + case ODM_RATE9M: + reg_txagc = R_0x830; + reg_mask = 0x00007f00; + break; + case ODM_RATE12M: + reg_txagc = R_0x830; + reg_mask = 0x007f0000; + break; + case ODM_RATE18M: + reg_txagc = R_0x830; + reg_mask = 0x7f000000; + break; + case ODM_RATE24M: + reg_txagc = R_0x834; + reg_mask = 0x0000007f; + break; + case ODM_RATE36M: + reg_txagc = R_0x834; + reg_mask = 0x00007f00; + break; + case ODM_RATE48M: + reg_txagc = R_0x834; + reg_mask = 0x007f0000; + break; + case ODM_RATE54M: + reg_txagc = R_0x834; + reg_mask = 0x7f000000; + break; + + case ODM_RATEMCS0: + reg_txagc = R_0x83c; + reg_mask = 0x0000007f; + break; + case ODM_RATEMCS1: + reg_txagc = R_0x83c; + reg_mask = 0x00007f00; + break; + case ODM_RATEMCS2: + reg_txagc = R_0x83c; + reg_mask = 0x007f0000; + break; + case ODM_RATEMCS3: + reg_txagc = R_0x83c; + reg_mask = 0x7f000000; + break; + case ODM_RATEMCS4: + reg_txagc = R_0x848; + reg_mask = 0x0000007f; + break; + case ODM_RATEMCS5: + reg_txagc = R_0x848; + reg_mask = 0x00007f00; + break; + case ODM_RATEMCS6: + reg_txagc = R_0x848; + reg_mask = 0x007f0000; + break; + case ODM_RATEMCS7: + reg_txagc = R_0x848; + reg_mask = 0x7f000000; + break; + + case ODM_RATEMCS8: + reg_txagc = R_0x84c; + reg_mask = 0x0000007f; + break; + case ODM_RATEMCS9: + reg_txagc = R_0x84c; + reg_mask = 0x00007f00; + break; + case ODM_RATEMCS10: + reg_txagc = R_0x84c; + reg_mask = 0x007f0000; + break; + case ODM_RATEMCS11: + reg_txagc = R_0x84c; + reg_mask = 0x7f000000; + break; + case ODM_RATEMCS12: + reg_txagc = R_0x868; + reg_mask = 0x0000007f; + break; + case ODM_RATEMCS13: + reg_txagc = R_0x868; + reg_mask = 0x00007f00; + break; + case ODM_RATEMCS14: + reg_txagc = R_0x868; + reg_mask = 0x007f0000; + break; + case ODM_RATEMCS15: + reg_txagc = R_0x868; + reg_mask = 0x7f000000; + break; + + default: + PHYDM_DBG(dm, ODM_PHY_CONFIG, "Invalid HWrate!\n"); + break; + } + } else { + PHYDM_DBG(dm, ODM_PHY_CONFIG, "Invalid RF path!!\n"); + } + read_back_data = (u8)odm_get_bb_reg(dm, reg_txagc, reg_mask); + PHYDM_DBG(dm, ODM_PHY_CONFIG, "%s: path-%d rate index 0x%x = 0x%x\n", + __func__, path, hw_rate, read_back_data); + return read_back_data; +} +#endif + +#ifdef CONFIG_MCC_DM +#ifdef DYN_ANT_WEIGHTING_SUPPORT +void phydm_set_weighting_cmn(struct dm_struct *dm) +{ + PHYDM_DBG(dm, DBG_COMP_MCC, "%s\n", __func__); + odm_set_bb_reg(dm, 0xc04, (BIT(18) | BIT(21)), 0x0); + odm_set_bb_reg(dm, 0xe04, (BIT(18) | BIT(21)), 0x0); +} + +void phydm_set_weighting_mcc(u8 b_equal_weighting, void *dm_void, u8 port) +{ + /*u8 reg_8;*/ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _phydm_mcc_dm_ *mcc_dm = &dm->mcc_dm; + u8 val_0x98e, val_0x98f, val_0x81b; + u32 temp_reg; + + PHYDM_DBG(dm, DBG_COMP_MCC, "ant_weighting_mcc, port = %d\n", port); + if (b_equal_weighting) { + temp_reg = odm_get_bb_reg(dm, 0x98c, 0x00ff0000); + val_0x98e = (u8)(temp_reg >> 16) & 0xc0; + temp_reg = odm_get_bb_reg(dm, 0x98c, 0xff000000); + val_0x98f = (u8)(temp_reg >> 24) & 0x7f; + temp_reg = odm_get_bb_reg(dm, 0x818, 0xff000000); + val_0x81b = (u8)(temp_reg >> 24) & 0xfd; + PHYDM_DBG(dm, DBG_COMP_MCC, "Equal weighting ,rssi_min = %d\n", + dm->rssi_min); + /*equal weighting*/ + } else { + val_0x98e = 0x44; + val_0x98f = 0x43; + temp_reg = odm_get_bb_reg(dm, 0x818, 0xff000000); + val_0x81b = (u8)(temp_reg >> 24) | BIT(2); + PHYDM_DBG(dm, DBG_COMP_MCC, "AGC weighting ,rssi_min = %d\n", + dm->rssi_min); + /*fix sec_min_wgt = 1/2*/ + } + mcc_dm->mcc_reg_id[2] = 0x2; + mcc_dm->mcc_dm_reg[2] = 0x98e; + mcc_dm->mcc_dm_val[2][port] = val_0x98e; + + mcc_dm->mcc_reg_id[3] = 0x3; + mcc_dm->mcc_dm_reg[3] = 0x98f; + mcc_dm->mcc_dm_val[3][port] = val_0x98f; + + mcc_dm->mcc_reg_id[4] = 0x4; + mcc_dm->mcc_dm_reg[4] = 0x81b; + mcc_dm->mcc_dm_val[4][port] = val_0x81b; +} + +void phydm_dyn_ant_dec_mcc(u8 port, u8 rssi_in, void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 rssi_l2h = 43, rssi_h2l = 37; + + if (rssi_in == 0xff) + phydm_set_weighting_mcc(FALSE, dm, port); + else if (rssi_in >= rssi_l2h) + phydm_set_weighting_mcc(TRUE, dm, port); + else if (rssi_in <= rssi_h2l) + phydm_set_weighting_mcc(FALSE, dm, port); +} + +void phydm_dynamic_ant_weighting_mcc_8822b(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _phydm_mcc_dm_ *mcc_dm = &dm->mcc_dm; + u8 i; + + phydm_set_weighting_cmn(dm); + for (i = 0; i <= 1; i++) + phydm_dyn_ant_dec_mcc(i, mcc_dm->mcc_rssi[i], dm); +} +#endif /*#ifdef DYN_ANT_WEIGHTING_SUPPORT*/ + +void phydm_mcc_init(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _phydm_mcc_dm_ *mcc_dm = &dm->mcc_dm; + u8 i; + + /*PHYDM_DBG(dm, DBG_COMP_MCC, ("MCC init\n"));*/ + PHYDM_DBG(dm, DBG_COMP_MCC, "MCC init\n"); + for (i = 0; i < MCC_DM_REG_NUM; i++) { + mcc_dm->mcc_reg_id[i] = 0xff; + mcc_dm->mcc_dm_reg[i] = 0; + mcc_dm->mcc_dm_val[i][0] = 0; + mcc_dm->mcc_dm_val[i][1] = 0; + } + for (i = 0; i < NUM_STA; i++) { + mcc_dm->sta_macid[0][i] = 0xff; + mcc_dm->sta_macid[1][i] = 0xff; + } + /* Function init */ + dm->is_stop_dym_ant_weighting = 0; +} + +u8 phydm_check(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _phydm_mcc_dm_ *mcc_dm = &dm->mcc_dm; + struct cmn_sta_info *p_entry = NULL; + u8 shift = 0; + u8 i = 0; + u8 j = 0; + u8 rssi_min[2] = {0xff, 0xff}; + u8 sta_num = 8; + u8 mcc_macid = 0; + + for (i = 0; i <= 1; i++) { + for (j = 0; j < sta_num; j++) { + if (mcc_dm->sta_macid[i][j] != 0xff) { + mcc_macid = mcc_dm->sta_macid[i][j]; + p_entry = dm->phydm_sta_info[mcc_macid]; + if (!p_entry) { + PHYDM_DBG(dm, DBG_COMP_MCC, + "PEntry NULL(mac=%d)\n", + mcc_dm->sta_macid[i][j]); + return _FAIL; + } + PHYDM_DBG(dm, DBG_COMP_MCC, + "undec_smoothed_pwdb=%d\n", + p_entry->rssi_stat.rssi); + if (p_entry->rssi_stat.rssi < rssi_min[i]) + rssi_min[i] = p_entry->rssi_stat.rssi; + } + } + } + mcc_dm->mcc_rssi[0] = (u8)rssi_min[0]; + mcc_dm->mcc_rssi[1] = (u8)rssi_min[1]; + return _SUCCESS; +} + +void phydm_mcc_h2ccmd_rst(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _phydm_mcc_dm_ *mcc_dm = &dm->mcc_dm; + u8 i; + u8 regid; + u8 h2c_mcc[H2C_MAX_LENGTH]; + + /* RST MCC */ + for (i = 0; i < H2C_MAX_LENGTH; i++) + h2c_mcc[i] = 0xff; + h2c_mcc[0] = 0x00; + odm_fill_h2c_cmd(dm, PHYDM_H2C_MCC, H2C_MAX_LENGTH, h2c_mcc); + PHYDM_DBG(dm, DBG_COMP_MCC, "MCC H2C RST\n"); +} + +void phydm_mcc_h2ccmd(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _phydm_mcc_dm_ *mcc_dm = &dm->mcc_dm; + u8 i; + u8 regid; + u8 h2c_mcc[H2C_MAX_LENGTH]; + + if (mcc_dm->mcc_rf_ch[0] == 0xff && mcc_dm->mcc_rf_ch[1] == 0xff) { + PHYDM_DBG(dm, DBG_COMP_MCC, "MCC channel Error\n"); + return; + } + /* Set Channel number */ + for (i = 0; i < H2C_MAX_LENGTH; i++) + h2c_mcc[i] = 0xff; + h2c_mcc[0] = 0xe0; + h2c_mcc[1] = (u8)(mcc_dm->mcc_rf_ch[0]); + h2c_mcc[2] = (u8)(mcc_dm->mcc_rf_ch[0] >> 8); + h2c_mcc[3] = (u8)(mcc_dm->mcc_rf_ch[1]); + h2c_mcc[4] = (u8)(mcc_dm->mcc_rf_ch[1] >> 8); + h2c_mcc[5] = 0xff; + h2c_mcc[6] = 0xff; + odm_fill_h2c_cmd(dm, PHYDM_H2C_MCC, H2C_MAX_LENGTH, h2c_mcc); + PHYDM_DBG(dm, DBG_COMP_MCC, + "MCC H2C SetCH: 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x\n", + h2c_mcc[0], h2c_mcc[1], h2c_mcc[2], h2c_mcc[3], + h2c_mcc[4], h2c_mcc[5], h2c_mcc[6]); + + /* Set Reg and value*/ + for (i = 0; i < H2C_MAX_LENGTH; i++) + h2c_mcc[i] = 0xff; + + for (i = 0; i < MCC_DM_REG_NUM; i++) { + regid = mcc_dm->mcc_reg_id[i]; + if (regid != 0xff) { + h2c_mcc[0] = 0xa0 | (regid & 0x1f); + h2c_mcc[1] = (u8)(mcc_dm->mcc_dm_reg[i]); + h2c_mcc[2] = (u8)(mcc_dm->mcc_dm_reg[i] >> 8); + h2c_mcc[3] = mcc_dm->mcc_dm_val[i][0]; + h2c_mcc[4] = mcc_dm->mcc_dm_val[i][1]; + h2c_mcc[5] = 0xff; + h2c_mcc[6] = 0xff; + odm_fill_h2c_cmd(dm, PHYDM_H2C_MCC, H2C_MAX_LENGTH, + h2c_mcc); + PHYDM_DBG(dm, DBG_COMP_MCC, + "MCC H2C: 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x\n", + h2c_mcc[0], h2c_mcc[1], h2c_mcc[2], + h2c_mcc[3], h2c_mcc[4], + h2c_mcc[5], h2c_mcc[6]); + } + } +} + +void phydm_mcc_ctrl(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _phydm_mcc_dm_ *mcc_dm = &dm->mcc_dm; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + + PHYDM_DBG(dm, DBG_COMP_MCC, "MCC status: %x\n", mcc_dm->mcc_status); + /*MCC stage no change*/ + if (mcc_dm->mcc_status == mcc_dm->mcc_pre_status) + return; + /*Not in MCC stage*/ + if (mcc_dm->mcc_status == 0) { + /* Enable normal Ant-weighting */ + dm->is_stop_dym_ant_weighting = 0; + /* Enable normal DIG */ + odm_pause_dig(dm, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_1, 0x20); + } else { + /* Disable normal Ant-weighting */ + dm->is_stop_dym_ant_weighting = 1; + /* Enable normal DIG */ + odm_pause_dig(dm, PHYDM_PAUSE_NO_SET, PHYDM_PAUSE_LEVEL_1, + 0x20); + } + if (mcc_dm->mcc_status == 0 && mcc_dm->mcc_pre_status != 0) + phydm_mcc_init(dm); + mcc_dm->mcc_pre_status = mcc_dm->mcc_status; + } + +void phydm_fill_mcccmd(void *dm_void, u8 regid, u16 reg_add, + u8 val0, u8 val1) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _phydm_mcc_dm_ *mcc_dm = &dm->mcc_dm; + + mcc_dm->mcc_reg_id[regid] = regid; + mcc_dm->mcc_dm_reg[regid] = reg_add; + mcc_dm->mcc_dm_val[regid][0] = val0; + mcc_dm->mcc_dm_val[regid][1] = val1; +} + +void phydm_mcc_switch(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _phydm_mcc_dm_ *mcc_dm = &dm->mcc_dm; + s8 ret; + + phydm_mcc_ctrl(dm); + if (mcc_dm->mcc_status == 0) {/*Not in MCC stage*/ + phydm_mcc_h2ccmd_rst(dm); + return; + } + PHYDM_DBG(dm, DBG_COMP_MCC, "MCC switch\n"); + ret = phydm_check(dm); + if (ret == _FAIL) { + PHYDM_DBG(dm, DBG_COMP_MCC, "MCC check fail\n"); + return; + } + /* Set IGI*/ + phydm_mcc_igi_cal(dm); + + /* Set Antenna Gain*/ +#if (RTL8822B_SUPPORT == 1) + phydm_dynamic_ant_weighting_mcc_8822b(dm); +#endif + /* Set H2C Cmd*/ + phydm_mcc_h2ccmd(dm); +} +#endif + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +void phydm_normal_driver_rx_sniffer( + struct dm_struct *dm, + u8 *desc, + PRT_RFD_STATUS rt_rfd_status, + u8 *drv_info, + u8 phy_status) +{ +#if (defined(CONFIG_PHYDM_RX_SNIFFER_PARSING)) + u32 *msg; + u16 seq_num; + + if (rt_rfd_status->packet_report_type != NORMAL_RX) + return; + + if (!dm->is_linked) { + if (rt_rfd_status->is_hw_error) + return; + } + + if (phy_status == true) { + if (dm->rx_pkt_type == type_block_ack || + dm->rx_pkt_type == type_rts || dm->rx_pkt_type == type_cts) + seq_num = 0; + else + seq_num = rt_rfd_status->seq_num; + + PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, + "%04d , %01s, rate=0x%02x, L=%04d , %s , %s", + seq_num, + /*rt_rfd_status->mac_id,*/ + (rt_rfd_status->is_crc ? "C" : + rt_rfd_status->is_ampdu ? "A" : "_"), + rt_rfd_status->data_rate, + rt_rfd_status->length, + ((rt_rfd_status->band_width == 0) ? "20M" : + ((rt_rfd_status->band_width == 1) ? "40M" : "80M")), + (rt_rfd_status->is_ldpc ? "LDP" : "BCC")); + + if (dm->rx_pkt_type == type_asoc_req) + PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, " , [%s]", "AS_REQ"); + else if (dm->rx_pkt_type == type_asoc_rsp) + PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, " , [%s]", "AS_RSP"); + else if (dm->rx_pkt_type == type_probe_req) + PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, " , [%s]", "PR_REQ"); + else if (dm->rx_pkt_type == type_probe_rsp) + PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, " , [%s]", "PR_RSP"); + else if (dm->rx_pkt_type == type_deauth) + PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, " , [%s]", "DEAUTH"); + else if (dm->rx_pkt_type == type_beacon) + PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, " , [%s]", "BEACON"); + else if (dm->rx_pkt_type == type_block_ack_req) + PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, " , [%s]", "BA_REQ"); + else if (dm->rx_pkt_type == type_rts) + PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, " , [%s]", "__RTS_"); + else if (dm->rx_pkt_type == type_cts) + PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, " , [%s]", "__CTS_"); + else if (dm->rx_pkt_type == type_ack) + PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, " , [%s]", "__ACK_"); + else if (dm->rx_pkt_type == type_block_ack) + PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, " , [%s]", "__BA__"); + else if (dm->rx_pkt_type == type_data) + PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, " , [%s]", "_DATA_"); + else if (dm->rx_pkt_type == type_data_ack) + PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, " , [%s]", "Data_Ack"); + else if (dm->rx_pkt_type == type_qos_data) + PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, " , [%s]", "QoS_Data"); + else + PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, " , [0x%x]", + dm->rx_pkt_type); + + PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, " , [RSSI=%d,%d,%d,%d ]", + dm->rssi_a, + dm->rssi_b, + dm->rssi_c, + dm->rssi_d); + + msg = (u32 *)drv_info; + + PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, + " , P-STS[28:0]=%08x-%08x-%08x-%08x-%08x-%08x-%08x\n", + msg[6], msg[5], msg[4], msg[3], + msg[2], msg[1], msg[1]); + } else { + PHYDM_DBG_F(dm, ODM_COMP_SNIFFER, + "%04d , %01s, rate=0x%02x, L=%04d , %s , %s\n", + rt_rfd_status->seq_num, + /*rt_rfd_status->mac_id,*/ + (rt_rfd_status->is_crc ? "C" : + (rt_rfd_status->is_ampdu) ? "A" : "_"), + rt_rfd_status->data_rate, + rt_rfd_status->length, + ((rt_rfd_status->band_width == 0) ? "20M" : + ((rt_rfd_status->band_width == 1) ? "40M" : "80M")), + (rt_rfd_status->is_ldpc ? "LDP" : "BCC")); + } + +#endif +} + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_api.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_api.h new file mode 100644 index 000000000000..f94f85f7082b --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_api.h @@ -0,0 +1,193 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +#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 CN_CNT_MAX 10 /*@max condition number threshold*/ + +#define FUNC_ENABLE 1 +#define FUNC_DISABLE 2 + +/*@NBI API------------------------------------*/ +#define NBI_128TONE 27 /*register table size*/ +#define NBI_256TONE 59 /*register table size*/ + +#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 +/*@------------------------------------------------*/ + +enum phystat_rpt { + PHY_PWDB = 0, + PHY_EVM = 1, + PHY_CFO = 2, + PHY_RXSNR = 3, + PHY_LGAIN = 4, + PHY_HT_AAGC_GAIN = 5, +}; + +#ifndef PHYDM_COMMON_API_SUPPORT +#define INVALID_RF_DATA 0xffffffff +#define INVALID_TXAGC_DATA 0xff +#endif + +/* @1 ============================================================ + * 1 structure + * 1 ============================================================ + */ + +struct phydm_api_stuc { + u32 rxiqc_reg1; /*N-mode: for pathA REG0xc14*/ + u32 rxiqc_reg2; /*N-mode: for pathB REG0xc1c*/ + u8 tx_queue_bitmap; /*REG0x520[23:16]*/ + u8 ccktx_path; +}; + +/* @1 ============================================================ + * 1 enumeration + * 1 ============================================================ + */ + +/* @1 ============================================================ + * 1 function prototype + * 1 ============================================================ + */ +void phydm_reset_bb_hw_cnt(void *dm_void); + +void phydm_dynamic_ant_weighting(void *dm_void); + +#ifdef DYN_ANT_WEIGHTING_SUPPORT +void phydm_ant_weight_dbg(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len); +#endif + +void phydm_trx_antenna_setting_init(void *dm_void, u8 num_rf_path); + +void phydm_config_ofdm_rx_path(void *dm_void, u32 path); + +void phydm_config_cck_rx_path(void *dm_void, enum bb_path path); + +void phydm_config_cck_rx_antenna_init(void *dm_void); + +void phydm_config_trx_path(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len); + +void phydm_tx_2path(void *dm_void); + +void phydm_stop_3_wire(void *dm_void, u8 set_type); + +u8 phydm_stop_ic_trx(void *dm_void, u8 set_type); + +void phydm_dis_cck_trx(void *dm_void, u8 set_type); + +void phydm_set_ext_switch(void *dm_void, u32 ext_ant_switch); + +void phydm_nbi_enable(void *dm_void, u32 enable); + +u8 phydm_csi_mask_setting(void *dm_void, u32 enable, u32 ch, u32 bw, u32 f_intf, + u32 sec_ch); + +u8 phydm_nbi_setting(void *dm_void, u32 enable, u32 ch, u32 bw, u32 f_intf, + u32 sec_ch); + +void phydm_nbi_debug(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len); + +void phydm_csi_debug(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len); + +void phydm_stop_ck320(void *dm_void, u8 enable); + +boolean +phydm_set_bb_txagc_offset(void *dm_void, s8 power_offset, u8 add_half_db); +#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT +u8 phydm_csi_mask_setting_jgr3(void *dm_void, u32 enable, u32 ch, u32 bw, + u32 f_intf, u32 sec_ch, u8 wgt); + +void phydm_set_csi_mask_jgr3(void *dm_void, u32 tone_idx_tmp, u8 tone_direction, + u8 wgt); + +u8 phydm_nbi_setting_jgr3(void *dm_void, u32 enable, u32 ch, u32 bw, u32 f_intf, + u32 sec_ch, u8 path); + +void phydm_set_nbi_reg_jgr3(void *dm_void, u32 tone_idx_tmp, u8 tone_direction, + u8 path); + +void phydm_nbi_enable_jgr3(void *dm_void, u32 enable, u8 path); + +u8 phydm_phystat_rpt_jgr3(void *dm_void, enum phystat_rpt info, + enum rf_path ant_path); +void phydm_user_position_for_sniffer(void *dm_void, u8 user_position); + +#endif + +#ifdef PHYDM_COMMON_API_SUPPORT +boolean +phydm_api_shift_txagc(void *dm_void, u32 pwr_offset, enum rf_path path, + boolean is_positive); +boolean +phydm_api_set_txagc(void *dm_void, u32 power_index, enum rf_path path, + u8 hw_rate, boolean is_single_rate); + +u8 phydm_api_get_txagc(void *dm_void, enum rf_path path, u8 hw_rate); + +boolean +phydm_api_switch_bw_channel(void *dm_void, u8 central_ch, u8 primary_ch_idx, + enum channel_width bandwidth); + +boolean +phydm_api_trx_mode(void *dm_void, enum bb_path tx_path, enum bb_path rx_path, + enum bb_path tx_path_ctrl); + +#endif + +#ifdef CONFIG_MCC_DM +#ifdef DYN_ANT_WEIGHTING_SUPPORT +void phydm_dynamic_ant_weighting_mcc_8822b(void *dm_void); +#endif /*#ifdef DYN_ANT_WEIGHTING_SUPPORT*/ +void phydm_fill_mcccmd(void *dm_void, u8 regid, u16 reg_add, + u8 val0, u8 val1); +u8 phydm_check(void *dm_void); +void phydm_mcc_init(void *dm_void); +void phydm_mcc_switch(void *dm_void); +#endif /*#ifdef CONFIG_MCC_DM*/ + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_auto_dbg.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_auto_dbg.c new file mode 100644 index 000000000000..38c6e8b164c8 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_auto_dbg.c @@ -0,0 +1,726 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +/************************************************************* + * include files + ************************************************************/ + +#include "mp_precomp.h" +#include "phydm_precomp.h" + +#ifdef PHYDM_AUTO_DEGBUG + +void phydm_check_hang_reset( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_auto_dbg_struct *atd_t = &dm->auto_dbg_table; + + atd_t->dbg_step = 0; + atd_t->auto_dbg_type = AUTO_DBG_STOP; + phydm_pause_dm_watchdog(dm, PHYDM_RESUME); + dm->debug_components &= (~ODM_COMP_API); +} + +void phydm_check_hang_init( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_auto_dbg_struct *atd_t = &dm->auto_dbg_table; + + atd_t->dbg_step = 0; + atd_t->auto_dbg_type = AUTO_DBG_STOP; + phydm_pause_dm_watchdog(dm, PHYDM_RESUME); +} + +#if (ODM_IC_11N_SERIES_SUPPORT == 1) +void phydm_auto_check_hang_engine_n( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_auto_dbg_struct *atd_t = &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 (atd_t->auto_dbg_type == AUTO_DBG_STOP) + return; + + if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + phydm_check_hang_reset(dm); + return; + } + + if (atd_t->dbg_step == 0) { + pr_debug("dbg_step=0\n\n"); + + /*Reset all packet counter*/ + odm_set_bb_reg(dm, R_0xf14, BIT(16), 1); + odm_set_bb_reg(dm, R_0xf14, BIT(16), 0); + + } else if (atd_t->dbg_step == 1) { + pr_debug("dbg_step=1\n\n"); + + /*Check packet counter Register*/ + atd_t->ofdm_t_cnt = (u16)odm_get_bb_reg(dm, R_0x9cc, MASKHWORD); + atd_t->ofdm_r_cnt = (u16)odm_get_bb_reg(dm, R_0xf94, MASKLWORD); + atd_t->ofdm_crc_error_cnt = (u16)odm_get_bb_reg(dm, R_0xf94, + MASKHWORD); + + atd_t->cck_t_cnt = (u16)odm_get_bb_reg(dm, R_0x9d0, MASKHWORD); + atd_t->cck_r_cnt = (u16)odm_get_bb_reg(dm, R_0xfa0, MASKHWORD); + atd_t->cck_crc_error_cnt = (u16)odm_get_bb_reg(dm, R_0xf84, + 0x3fff); + + /*Check Debug Port*/ + for (i = 0; i < DBGPORT_CHK_NUM; i++) { + if (phydm_set_bb_dbg_port(dm, DBGPORT_PRI_3, + (u32)atd_t->dbg_port_table[i]) + ) { + atd_t->dbg_port_val[i] = + phydm_get_bb_dbg_port_val(dm); + phydm_release_bb_dbg_port(dm); + } + } + + } else if (atd_t->dbg_step == 2) { + pr_debug("dbg_step=2\n\n"); + + /*Check packet counter Register*/ + curr_ofdm_t_cnt = (u16)odm_get_bb_reg(dm, R_0x9cc, MASKHWORD); + curr_ofdm_r_cnt = (u16)odm_get_bb_reg(dm, R_0xf94, MASKLWORD); + curr_ofdm_crc_error_cnt = (u16)odm_get_bb_reg(dm, R_0xf94, + MASKHWORD); + + curr_cck_t_cnt = (u16)odm_get_bb_reg(dm, R_0x9d0, MASKHWORD); + curr_cck_r_cnt = (u16)odm_get_bb_reg(dm, R_0xfa0, MASKHWORD); + curr_cck_crc_error_cnt = (u16)odm_get_bb_reg(dm, R_0xf84, + 0x3fff); + + /*Check Debug Port*/ + for (i = 0; i < DBGPORT_CHK_NUM; i++) { + if (phydm_set_bb_dbg_port(dm, DBGPORT_PRI_3, + (u32)atd_t->dbg_port_table[i]) + ) { + curr_dbg_port_val[i] = + phydm_get_bb_dbg_port_val(dm); + phydm_release_bb_dbg_port(dm); + } + } + + /*=== Make check hang decision ===============================*/ + pr_debug("Check Hang Decision\n\n"); + + /* ----- Check RF Register -----------------------------------*/ + for (i = 0; i < dm->num_rf_path; i++) { + rf_mode = (u8)odm_get_rf_reg(dm, i, RF_0x0, 0xf0000); + pr_debug("RF0x0[%d] = 0x%x\n", i, rf_mode); + if (rf_mode > 3) { + pr_debug("Incorrect RF mode\n"); + pr_debug("ReasonCode:RHN-1\n"); + } + } + value32_tmp = odm_get_rf_reg(dm, 0, RF_0xb0, 0xf0000); + if (dm->support_ic_type == ODM_RTL8188E) { + if (value32_tmp != 0xff8c8) { + pr_debug("ReasonCode:RHN-3\n"); + } + } + /* ----- Check BB Register ----------------------------------*/ + /*BB mode table*/ + value32_tmp = odm_get_bb_reg(dm, R_0x824, 0xe); + value32_tmp_2 = odm_get_bb_reg(dm, R_0x82c, 0xe); + pr_debug("BB TX mode table {A, B}= {%d, %d}\n", + value32_tmp, value32_tmp_2); + + if (value32_tmp > 3 || value32_tmp_2 > 3) { + pr_debug("ReasonCode:RHN-2\n"); + } + + value32_tmp = odm_get_bb_reg(dm, R_0x824, 0x700000); + value32_tmp_2 = odm_get_bb_reg(dm, R_0x82c, 0x700000); + pr_debug("BB RX mode table {A, B}= {%d, %d}\n", value32_tmp, + value32_tmp_2); + + if (value32_tmp > 3 || value32_tmp_2 > 3) { + pr_debug("ReasonCode:RHN-2\n"); + } + + /*BB HW Block*/ + value32_tmp = odm_get_bb_reg(dm, R_0x800, MASKDWORD); + + if (!(value32_tmp & BIT(24))) { + pr_debug("Reg0x800[24] = 0, CCK BLK is disabled\n"); + pr_debug("ReasonCode: THN-3\n"); + } + + if (!(value32_tmp & BIT(25))) { + pr_debug("Reg0x800[24] = 0, OFDM BLK is disabled\n"); + pr_debug("ReasonCode:THN-3\n"); + } + + /*BB Continue TX*/ + value32_tmp = odm_get_bb_reg(dm, R_0xd00, 0x70000000); + pr_debug("Continue TX=%d\n", value32_tmp); + if (value32_tmp != 0) { + pr_debug("ReasonCode: THN-4\n"); + } + + /* ----- Check Packet Counter --------------------------------*/ + diff_ofdm_t_cnt = curr_ofdm_t_cnt - atd_t->ofdm_t_cnt; + diff_ofdm_r_cnt = curr_ofdm_r_cnt - atd_t->ofdm_r_cnt; + diff_ofdm_crc_error_cnt = curr_ofdm_crc_error_cnt - + atd_t->ofdm_crc_error_cnt; + + diff_cck_t_cnt = curr_cck_t_cnt - atd_t->cck_t_cnt; + diff_cck_r_cnt = curr_cck_r_cnt - atd_t->cck_r_cnt; + diff_cck_crc_error_cnt = curr_cck_crc_error_cnt - + atd_t->cck_crc_error_cnt; + + pr_debug("OFDM[t=0~1] {TX, RX, CRC_error} = {%d, %d, %d}\n", + atd_t->ofdm_t_cnt, atd_t->ofdm_r_cnt, + atd_t->ofdm_crc_error_cnt); + pr_debug("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); + pr_debug("OFDM_diff {TX, RX, CRC_error} = {%d, %d, %d}\n", + diff_ofdm_t_cnt, diff_ofdm_r_cnt, + diff_ofdm_crc_error_cnt); + + pr_debug("CCK[t=0~1] {TX, RX, CRC_error} = {%d, %d, %d}\n", + atd_t->cck_t_cnt, atd_t->cck_r_cnt, + atd_t->cck_crc_error_cnt); + pr_debug("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); + pr_debug("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++) { + pr_debug("Dbg_port=((0x%x))\n", + atd_t->dbg_port_table[i]); + pr_debug("Val{pre, curr}={0x%x, 0x%x}\n", + atd_t->dbg_port_val[i], curr_dbg_port_val[i]); + + if (atd_t->dbg_port_table[i] == 0) { + if (atd_t->dbg_port_val[i] == + curr_dbg_port_val[i]) { + pr_debug("BB state hang\n"); + pr_debug("ReasonCode:\n"); + } + + } else if (atd_t->dbg_port_table[i] == 0x803) { + if (atd_t->dbg_port_val[i] == + curr_dbg_port_val[i]) { + /* dbgport_803 = */ + /* (struct n_dbgport_803 ) */ + /* (atd_t->dbg_port_val[i]); */ + odm_move_memory(dm, &dbgport_803, + &atd_t->dbg_port_val[i], + sizeof(struct n_dbgport_803)); + pr_debug("RSTB{BB, GLB, OFDM}={%d, %d,%d}\n", + dbgport_803.bb_rst_b, + dbgport_803.glb_rst_b, + dbgport_803.ofdm_rst_b); + pr_debug("{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); + pr_debug("CCA_PP{OFDM, CCK}={%d, %d}\n", + dbgport_803.ofdm_cca_pp, + dbgport_803.cck_cca_pp); + + if (dbgport_803.phy_tx_on) + pr_debug("Maybe TX Hang\n"); + else if (dbgport_803.ofdm_cca_pp || + dbgport_803.cck_cca_pp) + pr_debug("Maybe RX Hang\n"); + } + + } else if (atd_t->dbg_port_table[i] == 0x208) { + if ((atd_t->dbg_port_val[i] & BIT(30)) && + (curr_dbg_port_val[i] & BIT(30))) { + pr_debug("EDCCA Pause TX\n"); + pr_debug("ReasonCode: THN-2\n"); + } + + } else if (atd_t->dbg_port_table[i] == 0xab0) { + /* atd_t->dbg_port_val[i] & 0xffffff == 0 */ + /* curr_dbg_port_val[i] & 0xffffff == 0 */ + if (((atd_t->dbg_port_val[i] & + MASK24BITS) == 0) || + ((curr_dbg_port_val[i] & + MASK24BITS) == 0)) { + pr_debug("Wrong L-SIG formate\n"); + pr_debug("ReasonCode: THN-1\n"); + } + } + } + + phydm_check_hang_reset(dm); + } + + atd_t->dbg_step++; +} + +void phydm_bb_auto_check_hang_start_n( + void *dm_void, + u32 *_used, + char *output, + u32 *_out_len) +{ + u32 value32 = 0; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_auto_dbg_struct *atd_t = &dm->auto_dbg_table; + u32 used = *_used; + u32 out_len = *_out_len; + + if (dm->support_ic_type & ODM_IC_11AC_SERIES) + return; + + PDM_SNPF(out_len, used, output + used, out_len - used, + "PHYDM auto check hang (N-series) is started, Please check the system log\n"); + + dm->debug_components |= ODM_COMP_API; + atd_t->auto_dbg_type = AUTO_DBG_CHECK_HANG; + atd_t->dbg_step = 0; + + phydm_pause_dm_watchdog(dm, PHYDM_PAUSE); + + *_used = used; + *_out_len = out_len; +} + +void phydm_dbg_port_dump_n(void *dm_void, u32 *_used, char *output, + u32 *_out_len) +{ + u32 value32 = 0; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 used = *_used; + u32 out_len = *_out_len; + + if (dm->support_ic_type & ODM_IC_11AC_SERIES) + return; + + PDM_SNPF(out_len, used, 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_dbg_port_dump_ac(void *dm_void, u32 *_used, char *output, + u32 *_out_len) +{ + u32 value32 = 0; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 used = *_used; + u32 out_len = *_out_len; + + if (dm->support_ic_type & ODM_IC_11N_SERIES) + return; + + value32 = odm_get_bb_reg(dm, R_0xf80, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = 0x%x", "rptreg of sc/bw/ht/...", value32); + + if (dm->support_ic_type & ODM_RTL8822B) + odm_set_bb_reg(dm, R_0x198c, BIT(2) | BIT(1) | BIT(0), 7); + + /* dbg_port = basic state machine */ + { + odm_set_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0x000); + value32 = odm_get_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = 0x%x", "0x8fc", value32); + + value32 = odm_get_bb_reg(dm, ODM_REG_RPT_11AC, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = 0x%x", "basic state machine", value32); + } + + /* dbg_port = state machine */ + { + odm_set_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0x007); + value32 = odm_get_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = 0x%x", "0x8fc", value32); + + value32 = odm_get_bb_reg(dm, ODM_REG_RPT_11AC, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = 0x%x", "state machine", value32); + } + + /* dbg_port = CCA-related*/ + { + odm_set_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0x204); + value32 = odm_get_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = 0x%x", "0x8fc", value32); + + value32 = odm_get_bb_reg(dm, ODM_REG_RPT_11AC, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = 0x%x", "CCA-related", value32); + } + + /* dbg_port = edcca/rxd*/ + { + odm_set_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0x278); + value32 = odm_get_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = 0x%x", "0x8fc", value32); + + value32 = odm_get_bb_reg(dm, ODM_REG_RPT_11AC, MASKDWORD); + PDM_SNPF(out_len, used, 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(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0x290); + value32 = odm_get_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = 0x%x", "0x8fc", value32); + + value32 = odm_get_bb_reg(dm, ODM_REG_RPT_11AC, MASKDWORD); + PDM_SNPF(out_len, used, 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(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0x2B2); + value32 = odm_get_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = 0x%x", "0x8fc", value32); + + value32 = odm_get_bb_reg(dm, ODM_REG_RPT_11AC, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = 0x%x", "bf-related", value32); + } + + /* dbg_port = bf-related*/ + { + odm_set_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0x2B8); + value32 = odm_get_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = 0x%x", "0x8fc", value32); + + value32 = odm_get_bb_reg(dm, ODM_REG_RPT_11AC, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = 0x%x", "bf-related", value32); + } + + /* dbg_port = txon/rxd*/ + { + odm_set_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xA03); + value32 = odm_get_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = 0x%x", "0x8fc", value32); + + value32 = odm_get_bb_reg(dm, ODM_REG_RPT_11AC, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = 0x%x", "txon/rxd", value32); + } + + /* dbg_port = l_rate/l_length*/ + { + odm_set_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xA0B); + value32 = odm_get_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = 0x%x", "0x8fc", value32); + + value32 = odm_get_bb_reg(dm, ODM_REG_RPT_11AC, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = 0x%x", "l_rate/l_length", value32); + } + + /* dbg_port = rxd/rxd_hit*/ + { + odm_set_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xA0D); + value32 = odm_get_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = 0x%x", "0x8fc", value32); + + value32 = odm_get_bb_reg(dm, ODM_REG_RPT_11AC, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = 0x%x", "rxd/rxd_hit", value32); + } + + /* dbg_port = dis_cca*/ + { + odm_set_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xAA0); + value32 = odm_get_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = 0x%x", "0x8fc", value32); + + value32 = odm_get_bb_reg(dm, ODM_REG_RPT_11AC, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = 0x%x", "dis_cca", value32); + } + + /* dbg_port = tx*/ + { + odm_set_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xAB0); + value32 = odm_get_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = 0x%x", "0x8fc", value32); + + value32 = odm_get_bb_reg(dm, ODM_REG_RPT_11AC, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = 0x%x", "tx", value32); + } + + /* dbg_port = rx plcp*/ + { + odm_set_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xAD0); + value32 = odm_get_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = 0x%x", "0x8fc", value32); + + value32 = odm_get_bb_reg(dm, ODM_REG_RPT_11AC, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = 0x%x", "rx plcp", value32); + + odm_set_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xAD1); + value32 = odm_get_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = 0x%x", "0x8fc", value32); + + value32 = odm_get_bb_reg(dm, ODM_REG_RPT_11AC, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = 0x%x", "rx plcp", value32); + + odm_set_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xAD2); + value32 = odm_get_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = 0x%x", "0x8fc", value32); + + value32 = odm_get_bb_reg(dm, ODM_REG_RPT_11AC, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = 0x%x", "rx plcp", value32); + + odm_set_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xAD3); + value32 = odm_get_bb_reg(dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = 0x%x", "0x8fc", value32); + + value32 = odm_get_bb_reg(dm, ODM_REG_RPT_11AC, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = 0x%x", "rx plcp", value32); + } + *_used = used; + *_out_len = out_len; +} +#endif + +#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT +void phydm_dbg_port_dump_jgr3(void *dm_void, u32 *_used, char *output, + u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 used = *_used; + u32 out_len = *_out_len; + /*u32 dbg_port_idx_all[3] = {0x000, 0x001, 0x002};*/ + u32 val = 0; + u32 dbg_port_idx = 0; + u32 i = 0; + + if (!(dm->support_ic_type & ODM_IC_JGR3_SERIES)) + return; + + PDM_VAST_SNPF(out_len, used, output + used, out_len - used, + "%-17s = %s\n", "DbgPort index", "Value"); + +#if 0 + /*0x000/0x001/0x002*/ + for (i = 0; i < 3; i++) { + dbg_port_idx = dbg_port_idx_all[i]; + if (phydm_set_bb_dbg_port(dm, DBGPORT_PRI_3, dbg_port_idx)) { + val = phydm_get_bb_dbg_port_val(dm); + PDM_SNPF(out_len, used, output + used, out_len - used, + "0x%-15x = 0x%x\n", dbg_port_idx, val); + phydm_release_bb_dbg_port(dm); + } + } +#endif + for (dbg_port_idx = 0x0; dbg_port_idx <= 0xfff; dbg_port_idx++) { + if (phydm_set_bb_dbg_port(dm, DBGPORT_PRI_3, dbg_port_idx)) { + val = phydm_get_bb_dbg_port_val(dm); + PDM_VAST_SNPF(out_len, used, output + used, + out_len - used, + "0x%-15x = 0x%x\n", dbg_port_idx, val); + phydm_release_bb_dbg_port(dm); + } + } + *_used = used; + *_out_len = out_len; +} +#endif + +void phydm_dbg_port_dump(void *dm_void, u32 *_used, char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 used = *_used; + u32 out_len = *_out_len; + + PDM_VAST_SNPF(out_len, used, output + used, out_len - used, + "------ BB debug port start ------\n"); + + switch (dm->ic_ip_series) { + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + case PHYDM_IC_JGR3: + phydm_dbg_port_dump_jgr3(dm, &used, output, &out_len); + break; + #endif + + #if (ODM_IC_11AC_SERIES_SUPPORT == 1) + case PHYDM_IC_AC: + phydm_dbg_port_dump_ac(dm, &used, output, &out_len); + break; + #endif + + #if (ODM_IC_11N_SERIES_SUPPORT == 1) + case PHYDM_IC_N: + phydm_dbg_port_dump_n(dm, &used, output, &out_len); + break; + #endif + + default: + break; + } + *_used = used; + *_out_len = out_len; +} + +void phydm_auto_dbg_console( + void *dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)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)) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "hang: {1} {1:Show DbgPort, 2:Auto check hang}\n"); + return; + } else if (var1[0] == 1) { + PHYDM_SSCANF(input[2], DCMD_DECIMAL, &var1[1]); + if (var1[1] == 1) { + phydm_dbg_port_dump(dm, &used, output, &out_len); + } else if (var1[1] == 2) { + if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + PDM_SNPF(out_len, used, output + used, + out_len - used, "Not support\n"); + } else { + #if (ODM_IC_11N_SERIES_SUPPORT == 1) + phydm_bb_auto_check_hang_start_n(dm, &used, + output, + &out_len); + #else + PDM_SNPF(out_len, used, output + used, + out_len - used, "Not support\n"); + #endif + } + } + } + + *_used = used; + *_out_len = out_len; +} + +void phydm_auto_dbg_engine(void *dm_void) +{ + u32 value32 = 0; + + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_auto_dbg_struct *atd_t = &dm->auto_dbg_table; + + if (atd_t->auto_dbg_type == AUTO_DBG_STOP) + return; + + pr_debug("%s ======>\n", __func__); + + if (atd_t->auto_dbg_type == AUTO_DBG_CHECK_HANG) { + if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + pr_debug("Not Support\n"); + } else { + #if (ODM_IC_11N_SERIES_SUPPORT == 1) + phydm_auto_check_hang_engine_n(dm); + #else + pr_debug("Not Support\n"); + #endif + } + + } else if (atd_t->auto_dbg_type == AUTO_DBG_CHECK_RA) { + pr_debug("Not Support\n"); + } +} + +void phydm_auto_dbg_engine_init(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_auto_dbg_struct *atd_t = &dm->auto_dbg_table; + u16 dbg_port_table[DBGPORT_CHK_NUM] = {0x0, 0x803, 0x208, 0xab0, + 0xab1, 0xab2}; + + PHYDM_DBG(dm, ODM_COMP_API, "%s ======>n", __func__); + + odm_move_memory(dm, &atd_t->dbg_port_table[0], + &dbg_port_table[0], (DBGPORT_CHK_NUM * 2)); + + phydm_check_hang_init(dm); +} +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_auto_dbg.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_auto_dbg.h new file mode 100644 index 000000000000..9e18ceb87c79 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_auto_dbg.h @@ -0,0 +1,116 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +#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_struct { + 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_dbg_port_dump(void *dm_void, u32 *used, char *output, u32 *out_len); + +void phydm_auto_dbg_console( + void *dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len); + +void phydm_auto_dbg_engine(void *dm_void); + +void phydm_auto_dbg_engine_init(void *dm_void); +#endif +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_beamforming.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_beamforming.c index c21e2ed7aacd..689f63ec9467 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_beamforming.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_beamforming.c @@ -1,4 +1,29 @@ /* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + #include "mp_precomp.h" #include "phydm_precomp.h" @@ -8,118 +33,160 @@ #endif #endif -#if (BEAMFORMING_SUPPORT == 1) +#ifdef PHYDM_BEAMFORMING_SUPPORT + +void phydm_get_txbf_device_num( + void *dm_void, + u8 macid) +{ +#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) /*@For BDC*/ +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) + + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct cmn_sta_info *sta = dm->phydm_sta_info[macid]; + struct bf_cmn_info *bf = NULL; + struct _BF_DIV_COEX_ *dm_bdc_table = &dm->dm_bdc_table; + u8 act_as_bfer = 0; + u8 act_as_bfee = 0; + + if (is_sta_active(sta)) { + bf = &(sta->bf_info); + } else { + PHYDM_DBG(dm, DBG_TXBF, "[Warning] %s invalid sta_info\n", + __func__); + return; + } + + if (sta->support_wireless_set & WIRELESS_VHT) { + if (bf->vht_beamform_cap & BEAMFORMING_VHT_BEAMFORMEE_ENABLE) + act_as_bfer = 1; + + if (bf->vht_beamform_cap & BEAMFORMING_VHT_BEAMFORMER_ENABLE) + act_as_bfee = 1; + + } else if (sta->support_wireless_set & WIRELESS_HT) { + if (bf->ht_beamform_cap & BEAMFORMING_HT_BEAMFORMEE_ENABLE) + act_as_bfer = 1; + + if (bf->ht_beamform_cap & BEAMFORMING_HT_BEAMFORMER_ENABLE) + act_as_bfee = 1; + } + + if (act_as_bfer)) + { /* Our Device act as BFer */ + dm_bdc_table->w_bfee_client[macid] = true; + dm_bdc_table->num_txbfee_client++; + } + else + dm_bdc_table->w_bfee_client[macid] = false; + + if (act_as_bfee)) + { /* Our Device act as BFee */ + dm_bdc_table->w_bfer_client[macid] = true; + dm_bdc_table->num_txbfer_client++; + } + else + dm_bdc_table->w_bfer_client[macid] = false; + +#endif +#endif +} struct _RT_BEAMFORM_STAINFO * -phydm_sta_info_init( - struct PHY_DM_STRUCT *p_dm_odm, - u16 sta_idx -) +phydm_sta_info_init(struct dm_struct *dm, u16 sta_idx, u8 *my_mac_addr) { - struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm_odm->beamforming_info; - struct _RT_BEAMFORM_STAINFO *p_entry = &(p_beam_info->beamform_sta_info); - struct sta_info *p_sta = p_dm_odm->p_odm_sta_info[sta_idx]; - struct _ADAPTER *adapter = p_dm_odm->adapter; + struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; + struct _RT_BEAMFORM_STAINFO *entry = &beam_info->beamform_sta_info; + struct cmn_sta_info *cmn_sta = dm->phydm_sta_info[sta_idx]; + //void *adapter = dm->adapter; + ADAPTER * adapter = 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; + 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); +#endif - iotpeer = p_MgntInfo->IOTPeer; - odm_move_memory(p_dm_odm, 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_sta->AID; - p_entry->ra = p_sta->MacAddr; - p_entry->mac_id = p_sta->AssociatedMacId; - p_entry->wireless_mode = p_sta->WirelessMode; - p_entry->bw = p_sta->BandWidth; - p_entry->cur_beamform = p_sta->HTInfo.HtCurBeamform; - } 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_sta->VHTInfo.VhtCurBeamform; - else - p_entry->cur_beamform_vht = p_vht_info->VhtCurBeamform; - - } - - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("p_sta->wireless_mode = 0x%x, staidx = %d\n", p_sta->WirelessMode, sta_idx)); -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - - if (!IS_STA_VALID(p_sta)) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s => sta_info(mac_id:%d) failed\n", __func__, sta_idx)); + if (!is_sta_active(cmn_sta)) { + PHYDM_DBG(dm, DBG_TXBF, "%s => sta_info(mac_id:%d) failed\n", + __func__, sta_idx); + #if (DM_ODM_SUPPORT_TYPE == ODM_CE) rtw_warn_on(1); - return p_entry; + #endif + + return entry; } - odm_move_memory(p_dm_odm, p_entry->my_mac_addr, adapter_mac_addr(p_sta->padapter), 6); - p_entry->ht_beamform_cap = p_sta->htpriv.beamform_cap; +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + /*odm_move_memory(dm, (PVOID)(entry->my_mac_addr),*/ + /*(PVOID)(adapter->CurrentAddress), 6);*/ + odm_move_memory(dm, entry->my_mac_addr, my_mac_addr, 6); +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + /*odm_move_memory(dm, entry->my_mac_addr,*/ + /*adapter_mac_addr(sta->padapter), 6);*/ + odm_move_memory(dm, entry->my_mac_addr, my_mac_addr, 6); +#endif - p_entry->aid = p_sta->aid; - p_entry->ra = p_sta->hwaddr; - p_entry->mac_id = p_sta->mac_id; - p_entry->wireless_mode = p_sta->wireless_mode; - p_entry->bw = p_sta->bw_mode; + entry->aid = cmn_sta->aid; + entry->ra = cmn_sta->mac_addr; + entry->mac_id = cmn_sta->mac_id; + entry->bw = cmn_sta->bw_mode; + entry->cur_beamform = cmn_sta->bf_info.ht_beamform_cap; + entry->ht_beamform_cap = cmn_sta->bf_info.ht_beamform_cap; - p_entry->cur_beamform = p_sta->htpriv.beamform_cap; -#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_sta->vhtpriv.beamform_cap; - p_entry->vht_beamform_cap = p_sta->vhtpriv.beamform_cap; +#if ODM_IC_11AC_SERIES_SUPPORT + if (cmn_sta->support_wireless_set & WIRELESS_VHT) { + entry->cur_beamform_vht = cmn_sta->bf_info.vht_beamform_cap; + entry->vht_beamform_cap = cmn_sta->bf_info.vht_beamform_cap; } #endif - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("p_sta->wireless_mode = 0x%x, staidx = %d\n", p_sta->wireless_mode, sta_idx)); -#endif - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("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; +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) /*To Be Removed */ + entry->ht_beamform_cap = p_ht_info->HtBeamformCap; /*To Be Removed*/ + entry->vht_beamform_cap = p_vht_info->VhtBeamformCap; /*To Be Removed*/ + + if (sta_idx == 0) { /*@client mode*/ + #if ODM_IC_11AC_SERIES_SUPPORT + if (cmn_sta->support_wireless_set & WIRELESS_VHT) + entry->cur_beamform_vht = p_vht_info->VhtCurBeamform; + #endif + } +#endif + + PHYDM_DBG(dm, DBG_TXBF, "wireless_set = 0x%x, staidx = %d\n", + cmn_sta->support_wireless_set, sta_idx); + PHYDM_DBG(dm, DBG_TXBF, + "entry->cur_beamform = 0x%x, entry->cur_beamform_vht = 0x%x\n", + entry->cur_beamform, entry->cur_beamform_vht); + return entry; } void phydm_sta_info_update( - struct PHY_DM_STRUCT *p_dm_odm, - u16 sta_idx, - struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry -) + struct dm_struct *dm, + u16 sta_idx, + struct _RT_BEAMFORMEE_ENTRY *beamform_entry) { - struct sta_info *p_sta = p_dm_odm->p_odm_sta_info[sta_idx]; + struct cmn_sta_info *sta = dm->phydm_sta_info[sta_idx]; - if (!IS_STA_VALID(p_sta)) + if (!is_sta_active(sta)) return; -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - p_sta->txbf_paid = p_beamform_entry->p_aid; - p_sta->txbf_gid = p_beamform_entry->g_id; -#endif + sta->bf_info.p_aid = beamform_entry->p_aid; + sta->bf_info.g_id = beamform_entry->g_id; } struct _RT_BEAMFORMEE_ENTRY * phydm_beamforming_get_bfee_entry_by_addr( - void *p_dm_void, - u8 *RA, - u8 *idx -) + void *dm_void, + u8 *RA, + u8 *idx) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 i = 0; - struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm_odm->beamforming_info; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 i = 0; + struct _RT_BEAMFORMING_INFO *beam_info = &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))) { + if (beam_info->beamformee_entry[i].is_used && (eq_mac_addr(RA, beam_info->beamformee_entry[i].mac_addr))) { *idx = i; - return &(p_beam_info->beamformee_entry[i]); + return &beam_info->beamformee_entry[i]; } } @@ -128,62 +195,57 @@ phydm_beamforming_get_bfee_entry_by_addr( struct _RT_BEAMFORMER_ENTRY * phydm_beamforming_get_bfer_entry_by_addr( - void *p_dm_void, - u8 *TA, - u8 *idx -) + void *dm_void, + u8 *TA, + u8 *idx) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 i = 0; - struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm_odm->beamforming_info; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 i = 0; + struct _RT_BEAMFORMING_INFO *beam_info = &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))) { + if (beam_info->beamformer_entry[i].is_used && (eq_mac_addr(TA, beam_info->beamformer_entry[i].mac_addr))) { *idx = i; - return &(p_beam_info->beamformer_entry[i]); + return &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 -) + void *dm_void, + u8 mac_id, + u8 *idx) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 i = 0; - struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm_odm->beamforming_info; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 i = 0; + struct _RT_BEAMFORMING_INFO *beam_info = &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)) { + if (beam_info->beamformee_entry[i].is_used && mac_id == beam_info->beamformee_entry[i].mac_id) { *idx = i; - return &(p_beam_info->beamformee_entry[i]); + return &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 -) + void *dm_void, + u8 mac_id) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 i = 0; - struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm_odm->beamforming_info; - enum beamforming_cap beamform_entry_cap = BEAMFORMING_CAP_NONE; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 i = 0; + struct _RT_BEAMFORMING_INFO *beam_info = &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; + if (beam_info->beamformee_entry[i].is_used && mac_id == beam_info->beamformee_entry[i].mac_id) { + beamform_entry_cap = beam_info->beamformee_entry[i].beamform_entry_cap; i = BEAMFORMEE_ENTRY_NUM; } } @@ -191,21 +253,19 @@ phydm_beamforming_get_entry_beam_cap_by_mac_id( return beamform_entry_cap; } - struct _RT_BEAMFORMEE_ENTRY * phydm_beamforming_get_free_bfee_entry( - void *p_dm_void, - u8 *idx -) + void *dm_void, + u8 *idx) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 i = 0; - struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm_odm->beamforming_info; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 i = 0; + struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { - if (p_beam_info->beamformee_entry[i].is_used == false) { + if (beam_info->beamformee_entry[i].is_used == false) { *idx = i; - return &(p_beam_info->beamformee_entry[i]); + return &beam_info->beamformee_entry[i]; } } return NULL; @@ -213,26 +273,25 @@ phydm_beamforming_get_free_bfee_entry( struct _RT_BEAMFORMER_ENTRY * phydm_beamforming_get_free_bfer_entry( - void *p_dm_void, - u8 *idx -) + void *dm_void, + u8 *idx) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 i = 0; - struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm_odm->beamforming_info; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 i = 0; + struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s ===>\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "%s ===>\n", __func__); for (i = 0; i < BEAMFORMER_ENTRY_NUM; i++) { - if (p_beam_info->beamformer_entry[i].is_used == false) { + if (beam_info->beamformer_entry[i].is_used == false) { *idx = i; - return &(p_beam_info->beamformer_entry[i]); + return &beam_info->beamformer_entry[i]; } } return NULL; } -/* +/*@ * Description: Get the first entry index of MU Beamformee. * * Return value: index of the first MU sta. @@ -240,19 +299,18 @@ phydm_beamforming_get_free_bfer_entry( * 2015.05.25. Created by tynli. * */ -u8 -phydm_beamforming_get_first_mu_bfee_entry_idx( - void *p_dm_void -) +u8 phydm_beamforming_get_first_mu_bfee_entry_idx( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 idx = 0xFF; - struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm_odm->beamforming_info; - bool is_found = false; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 idx = 0xFF; + struct _RT_BEAMFORMING_INFO *beam_info = &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) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] idx=%d!\n", __func__, idx)); + if (beam_info->beamformee_entry[idx].is_used && beam_info->beamformee_entry[idx].is_mu_sta) { + PHYDM_DBG(dm, DBG_TXBF, "[%s] idx=%d!\n", __func__, + idx); is_found = true; break; } @@ -264,419 +322,409 @@ phydm_beamforming_get_first_mu_bfee_entry_idx( return idx; } - -/*Add SU BFee and MU BFee*/ +/*@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 -) + void *dm_void, + struct _RT_BEAMFORM_STAINFO *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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_BEAMFORMEE_ENTRY *p_entry = phydm_beamforming_get_free_bfee_entry(p_dm_odm, idx); + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _RT_BEAMFORMEE_ENTRY *entry = phydm_beamforming_get_free_bfee_entry(dm, idx); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); + PHYDM_DBG(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_odm, p_entry->my_mac_addr, p_sta->my_mac_addr, 6); + if (entry != NULL) { + entry->is_used = true; + entry->aid = sta->aid; + entry->mac_id = sta->mac_id; + entry->sound_bw = sta->bw; + odm_move_memory(dm, entry->my_mac_addr, sta->my_mac_addr, 6); - if (phydm_acting_determine(p_dm_odm, 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; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: BFee P_AID addressed to STA=%d\n", __func__, p_entry->p_aid)); - } else if (phydm_acting_determine(p_dm_odm, phydm_acting_as_ibss)) { - /*ad hoc mode*/ - p_entry->p_aid = 0; - p_entry->g_id = 63; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: BFee P_AID as IBSS=%d\n", __func__, p_entry->p_aid)); + if (phydm_acting_determine(dm, phydm_acting_as_ap)) { + /*@BSSID[44:47] xor BSSID[40:43]*/ + u16 bssid = ((sta->my_mac_addr[5] & 0xf0) >> 4) ^ (sta->my_mac_addr[5] & 0xf); + /*@(dec(A) + dec(B)*32) mod 512*/ + entry->p_aid = (sta->aid + bssid * 32) & 0x1ff; + entry->g_id = 63; + PHYDM_DBG(dm, DBG_TXBF, + "%s: BFee P_AID addressed to STA=%d\n", + __func__, entry->p_aid); + } else if (phydm_acting_determine(dm, phydm_acting_as_ibss)) { + /*@ad hoc mode*/ + entry->p_aid = 0; + entry->g_id = 63; + PHYDM_DBG(dm, DBG_TXBF, "%s: BFee P_AID as IBSS=%d\n", + __func__, 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; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: BFee P_AID addressed to AP=0x%X\n", __func__, p_entry->p_aid)); + /*@client mode*/ + entry->p_aid = sta->ra[5]; + /*@BSSID[39:47]*/ + entry->p_aid = (entry->p_aid << 1) | (sta->ra[4] >> 7); + entry->g_id = 0; + PHYDM_DBG(dm, DBG_TXBF, + "%s: BFee P_AID addressed to AP=0x%X\n", + __func__, 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; + cp_mac_addr(entry->mac_addr, sta->ra); + entry->is_txbf = false; + entry->is_sound = false; + entry->sound_period = 400; + entry->beamform_entry_cap = beamform_cap; + 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*/ + /* @entry->log_seq = 0xff; Move to beamforming_add_bfer_entry*/ + /* @entry->log_retry_cnt = 0; Move to beamforming_add_bfer_entry*/ + /* @entry->LogSuccessCnt = 0; Move to beamforming_add_bfer_entry*/ - p_entry->log_status_fail_cnt = 0; + 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; + entry->num_of_sounding_dim = num_of_sounding_dim; + entry->comp_steering_num_of_bfer = comp_steering_num_of_bfer; if (beamform_cap & BEAMFORMER_CAP_VHT_MU) { - p_dm_odm->beamforming_info.beamformee_mu_cnt += 1; - p_entry->is_mu_sta = true; - p_dm_odm->beamforming_info.first_mu_bfee_index = phydm_beamforming_get_first_mu_bfee_entry_idx(p_dm_odm); + dm->beamforming_info.beamformee_mu_cnt += 1; + entry->is_mu_sta = true; + dm->beamforming_info.first_mu_bfee_index = phydm_beamforming_get_first_mu_bfee_entry_idx(dm); } else if (beamform_cap & (BEAMFORMER_CAP_VHT_SU | BEAMFORMER_CAP_HT_EXPLICIT)) { - p_dm_odm->beamforming_info.beamformee_su_cnt += 1; - p_entry->is_mu_sta = false; + dm->beamforming_info.beamformee_su_cnt += 1; + entry->is_mu_sta = false; } - return p_entry; + return entry; } else return NULL; } -/*Add SU BFee and MU BFer*/ +/*@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 -) + void *dm_void, + struct _RT_BEAMFORM_STAINFO *sta, + enum beamforming_cap beamform_cap, + u8 num_of_sounding_dim, + u8 *idx) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_BEAMFORMER_ENTRY *p_entry = phydm_beamforming_get_free_bfer_entry(p_dm_odm, idx); + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _RT_BEAMFORMER_ENTRY *entry = phydm_beamforming_get_free_bfer_entry(dm, idx); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "%s Start!\n", __func__); - if (p_entry != NULL) { - p_entry->is_used = true; - odm_move_memory(p_dm_odm, p_entry->my_mac_addr, p_sta->my_mac_addr, 6); - if (phydm_acting_determine(p_dm_odm, 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); + if (entry != NULL) { + entry->is_used = true; + odm_move_memory(dm, entry->my_mac_addr, sta->my_mac_addr, 6); + if (phydm_acting_determine(dm, phydm_acting_as_ap)) { + /*@BSSID[44:47] xor BSSID[40:43]*/ + u16 bssid = ((sta->my_mac_addr[5] & 0xf0) >> 4) ^ (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_odm, phydm_acting_as_ibss)) { - p_entry->p_aid = 0; - p_entry->g_id = 63; + entry->p_aid = (sta->aid + bssid * 32) & 0x1ff; + entry->g_id = 63; + /*@(dec(A) + dec(B)*32) mod 512*/ + } else if (phydm_acting_determine(dm, phydm_acting_as_ibss)) { + entry->p_aid = 0; + 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; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: P_AID addressed to AP=0x%X\n", __func__, p_entry->p_aid)); + entry->p_aid = sta->ra[5]; + /*@BSSID[39:47]*/ + entry->p_aid = (entry->p_aid << 1) | (sta->ra[4] >> 7); + entry->g_id = 0; + PHYDM_DBG(dm, DBG_TXBF, + "%s: P_AID addressed to AP=0x%X\n", __func__, + entry->p_aid); } - cp_mac_addr(p_entry->mac_addr, p_sta->ra); - p_entry->beamform_entry_cap = beamform_cap; + cp_mac_addr(entry->mac_addr, sta->ra); + 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*/ + entry->pre_log_seq = 0; /*@Modified by Jeffery @2015-04-13*/ + entry->log_seq = 0; /*@Modified by Jeffery @2014-10-29*/ + entry->log_retry_cnt = 0; /*@Modified by Jeffery @2014-10-29*/ + entry->log_success = 0; /*@log_success is NOT needed to be accumulated, so LogSuccessCnt->log_success, 2015-04-13, Jeffery*/ + entry->clock_reset_times = 0; /*@Modified by Jeffery @2015-04-13*/ - p_entry->num_of_sounding_dim = num_of_sounding_dim; + entry->num_of_sounding_dim = num_of_sounding_dim; if (beamform_cap & BEAMFORMEE_CAP_VHT_MU) { - p_dm_odm->beamforming_info.beamformer_mu_cnt += 1; - p_entry->is_mu_ap = true; - p_entry->aid = p_sta->aid; + dm->beamforming_info.beamformer_mu_cnt += 1; + entry->is_mu_ap = true; + entry->aid = sta->aid; } else if (beamform_cap & (BEAMFORMEE_CAP_VHT_SU | BEAMFORMEE_CAP_HT_EXPLICIT)) { - p_dm_odm->beamforming_info.beamformer_su_cnt += 1; - p_entry->is_mu_ap = false; + dm->beamforming_info.beamformer_su_cnt += 1; + entry->is_mu_ap = false; } - return p_entry; + return entry; } else return NULL; } #if 0 -bool +boolean beamforming_remove_entry( - struct _ADAPTER *adapter, + void *adapter, u8 *RA, u8 *idx ) { - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + struct dm_struct *dm = &hal_data->DM_OutSrc; - struct _RT_BEAMFORMER_ENTRY *p_bfer_entry = phydm_beamforming_get_bfer_entry_by_addr(p_dm_odm, RA, idx); - struct _RT_BEAMFORMEE_ENTRY *p_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm_odm, RA, idx); - bool ret = false; + struct _RT_BEAMFORMER_ENTRY *bfer_entry = phydm_beamforming_get_bfer_entry_by_addr(dm, RA, idx); + struct _RT_BEAMFORMEE_ENTRY *entry = phydm_beamforming_get_bfee_entry_by_addr(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)); + RT_DISP(FBEAM, FBEAM_FUN, ("[Beamforming]@%s, bfer_entry=0x%x\n", __func__, bfer_entry)); + RT_DISP(FBEAM, FBEAM_FUN, ("[Beamforming]@%s, entry=0x%x\n", __func__, 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; + if (entry != NULL) { + entry->is_used = false; + entry->beamform_entry_cap = BEAMFORMING_CAP_NONE; + /*@entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_UNINITIALIZE;*/ + 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; + if (bfer_entry != NULL) { + bfer_entry->is_used = false; + 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, - CHANNEL_WIDTH BW, - u8 rate -) +void phydm_beamforming_ndpa_rate( + void *dm_void, + enum channel_width BW, + u8 rate) { - u16 ndpa_rate = rate; - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + u16 ndpa_rate = rate; + struct dm_struct *dm = (struct dm_struct *)dm_void; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "%s Start!\n", __func__); if (ndpa_rate == 0) { - if (p_dm_odm->rssi_min > 30) /* link RSSI > 30% */ + if (dm->rssi_min > 30) /* @link RSSI > 30% */ ndpa_rate = ODM_RATE24M; else ndpa_rate = ODM_RATE6M; } if (ndpa_rate < ODM_RATEMCS0) - BW = (CHANNEL_WIDTH)ODM_BW20M; + BW = (enum channel_width)CHANNEL_WIDTH_20; ndpa_rate = (ndpa_rate << 8) | BW; - hal_com_txbf_set(p_dm_odm, TXBF_SET_SOUNDING_RATE, (u8 *)&ndpa_rate); - + hal_com_txbf_set(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 -) +void phydm_beamforming_dym_ndpa_rate( + void *dm_void) { - u16 ndpa_rate = ODM_RATE6M, BW; - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + u16 ndpa_rate = ODM_RATE6M, BW; + struct dm_struct *dm = (struct dm_struct *)dm_void; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); + ndpa_rate = ODM_RATE6M; + BW = CHANNEL_WIDTH_20; - if (p_dm_odm->rssi_min > 30) /*link RSSI > 30%*/ - ndpa_rate = ODM_RATE24M; - else - ndpa_rate = ODM_RATE6M; - - BW = ODM_BW20M; ndpa_rate = ndpa_rate << 8 | BW; - hal_com_txbf_set(p_dm_odm, TXBF_SET_SOUNDING_RATE, (u8 *)&ndpa_rate); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s End, NDPA rate = 0x%X\n", __func__, ndpa_rate)); + hal_com_txbf_set(dm, TXBF_SET_SOUNDING_RATE, (u8 *)&ndpa_rate); + PHYDM_DBG(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 -) +void beamforming_dym_period( + void *dm_void, + u8 status) { - u8 idx; - bool is_change_period = false; - u16 sound_period_sw, sound_period_fw; - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 idx; + boolean is_change_period = false; + u16 sound_period_sw, sound_period_fw; + struct dm_struct *dm = (struct dm_struct *)dm_void; - struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry; - struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm_odm->beamforming_info); - struct _RT_SOUNDING_INFO *p_sound_info = &(p_beam_info->sounding_info); + struct _RT_BEAMFORMEE_ENTRY *beamform_entry; + struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; + struct _RT_SOUNDING_INFO *sound_info = &beam_info->sounding_info; - struct _RT_BEAMFORMEE_ENTRY *p_entry = &(p_beam_info->beamformee_entry[p_beam_info->beamformee_cur_idx]); + struct _RT_BEAMFORMEE_ENTRY *entry = &beam_info->beamformee_entry[beam_info->beamformee_cur_idx]; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); - /* 3 TODO per-client throughput caculation. */ + /* @3 TODO per-client throughput caculation. */ - if ((*(p_dm_odm->p_current_tx_tp) + *(p_dm_odm->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 */ + if ((*dm->current_tx_tp + *dm->current_rx_tp > 2) && (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_sw = 4000; /* @4s */ sound_period_fw = 400; } - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]sound_period_sw=%d, sound_period_fw=%d\n", __func__, sound_period_sw, sound_period_fw)); + PHYDM_DBG(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; + beamform_entry = beam_info->beamformee_entry + idx; - if (p_beamform_entry->default_csi_cnt > 20) { - /*Modified by David*/ + if (beamform_entry->default_csi_cnt > 20) { + /*@Modified by David*/ sound_period_sw = 4000; sound_period_fw = 400; } - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%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; - } + PHYDM_DBG(dm, DBG_TXBF, "[%s] period = %d\n", __func__, + sound_period_sw); + if ((beamform_entry->beamform_entry_cap & (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP_VHT_SU)) == 0) + continue; + + if (sound_info->sound_mode == SOUNDING_FW_VHT_TIMER || sound_info->sound_mode == SOUNDING_FW_HT_TIMER) { + if (beamform_entry->sound_period != sound_period_fw) { + 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 (beamform_entry->sound_period != sound_period_sw) + beamform_entry->sound_period = sound_period_sw; } if (is_change_period) - hal_com_txbf_set(p_dm_odm, TXBF_SET_SOUNDING_FW_NDPA, (u8 *)&idx); + hal_com_txbf_set(dm, TXBF_SET_SOUNDING_FW_NDPA, (u8 *)&idx); } - - - -bool +boolean beamforming_send_ht_ndpa_packet( - void *p_dm_void, - u8 *RA, - CHANNEL_WIDTH BW, - u8 q_idx -) + void *dm_void, + u8 *RA, + enum channel_width BW, + u8 q_idx) { - bool ret = true; - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + boolean ret = true; + struct dm_struct *dm = (struct dm_struct *)dm_void; if (q_idx == BEACON_QUEUE) - ret = send_fw_ht_ndpa_packet(p_dm_odm, RA, BW); + ret = send_fw_ht_ndpa_packet(dm, RA, BW); else - ret = send_sw_ht_ndpa_packet(p_dm_odm, RA, BW); + ret = send_sw_ht_ndpa_packet(dm, RA, BW); return ret; } - - -bool +boolean beamforming_send_vht_ndpa_packet( - void *p_dm_void, - u8 *RA, - u16 AID, - CHANNEL_WIDTH BW, - u8 q_idx -) + void *dm_void, + u8 *RA, + u16 AID, + enum channel_width BW, + u8 q_idx) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - bool ret = true; - struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm_odm->beamforming_info); + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; + boolean ret = true; - hal_com_txbf_set(p_dm_odm, TXBF_SET_GET_TX_RATE, NULL); + hal_com_txbf_set(dm, TXBF_SET_GET_TX_RATE, NULL); - if ((p_dm_odm->tx_bf_data_rate >= ODM_RATEVHTSS3MCS7) && (p_dm_odm->tx_bf_data_rate <= ODM_RATEVHTSS3MCS9) && (p_beam_info->snding3ss == false)) - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s: 3SS VHT 789 don't sounding\n", __func__)); + if (beam_info->tx_bf_data_rate >= ODM_RATEVHTSS3MCS7 && beam_info->tx_bf_data_rate <= ODM_RATEVHTSS3MCS9 && !beam_info->snding3ss) + PHYDM_DBG(dm, DBG_TXBF, "@%s: 3SS VHT 789 don't sounding\n", + __func__); - else { + else { if (q_idx == BEACON_QUEUE) /* Send to reserved page => FW NDPA */ - ret = send_fw_vht_ndpa_packet(p_dm_odm, RA, AID, BW); + ret = send_fw_vht_ndpa_packet(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_odm, BW); + beam_info->is_mu_sounding = true; + ret = send_sw_vht_mu_ndpa_packet(dm, BW); #else - p_beam_info->is_mu_sounding = false; - ret = send_sw_vht_ndpa_packet(p_dm_odm, RA, AID, BW); + beam_info->is_mu_sounding = false; + ret = send_sw_vht_ndpa_packet(dm, RA, AID, BW); #endif #else - p_beam_info->is_mu_sounding = false; - ret = send_sw_vht_ndpa_packet(p_dm_odm, RA, AID, BW); + beam_info->is_mu_sounding = false; + ret = send_sw_vht_ndpa_packet(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 -) + void *dm_void, + struct _RT_BEAMFORMING_INFO *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_odm = (struct PHY_DM_STRUCT *)p_dm_void; + enum beamforming_notify_state is_sounding = BEAMFORMING_NOTIFY_NONE; + struct _RT_BEAMFORMING_OID_INFO beam_oid_info = beam_info->beamforming_oid_info; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 i; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); + PHYDM_DBG(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) + /*@if(( Beamforming_GetBeamCap(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; + goto out; + } - for (i = 0 ; i < BEAMFORMEE_ENTRY_NUM ; i++) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%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)) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%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; - } + for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { + PHYDM_DBG(dm, DBG_TXBF, + "@%s: BFee Entry %d is_used=%d, is_sound=%d\n", + __func__, i, beam_info->beamformee_entry[i].is_used, + beam_info->beamformee_entry[i].is_sound); + if (beam_info->beamformee_entry[i].is_used && !beam_info->beamformee_entry[i].is_sound) { + PHYDM_DBG(dm, DBG_TXBF, "%s: Add BFee entry %d\n", + __func__, i); + *idx = i; + if (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) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%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; - } + if (!beam_info->beamformee_entry[i].is_used && beam_info->beamformee_entry[i].is_sound) { + PHYDM_DBG(dm, DBG_TXBF, "%s: Delete BFee entry %d\n", + __func__, i); + *idx = i; + if (beam_info->beamformee_entry[i].is_mu_sta) + is_sounding = BEAMFORMEE_NOTIFY_DELETE_MU; + else + is_sounding = BEAMFORMEE_NOTIFY_DELETE_SU; } } - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s End, is_sounding = %d\n", __func__, is_sounding)); +out: + PHYDM_DBG(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 phydm_beamforming_sounding_idx( + void *dm_void, + struct _RT_BEAMFORMING_INFO *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_odm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 idx = 0; + struct _RT_BEAMFORMING_OID_INFO beam_oid_info = beam_info->beamforming_oid_info; + struct dm_struct *dm = (struct dm_struct *)dm_void; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); + PHYDM_DBG(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; + 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)) { + if (beam_info->beamformee_entry[i].is_used && !beam_info->beamformee_entry[i].is_sound) { idx = i; break; } @@ -686,20 +734,18 @@ phydm_beamforming_sounding_idx( return idx; } - enum sounding_mode phydm_beamforming_sounding_mode( - void *p_dm_void, - struct _RT_BEAMFORMING_INFO *p_beam_info, - u8 idx -) + void *dm_void, + struct _RT_BEAMFORMING_INFO *beam_info, + u8 idx) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 support_interface = p_dm_odm->support_interface; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 support_interface = 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; + struct _RT_BEAMFORMEE_ENTRY beam_entry = beam_info->beamformee_entry[idx]; + struct _RT_BEAMFORMING_OID_INFO beam_oid_info = 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) @@ -712,231 +758,285 @@ phydm_beamforming_sounding_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_odm->support_ic_type & (ODM_RTL8814A | ODM_RTL8822B))) + if (support_interface == ODM_ITRF_USB && !(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_odm->support_ic_type & (ODM_RTL8814A | ODM_RTL8822B))) + if (support_interface == ODM_ITRF_USB && !(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; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] support_interface=%d, mode=%d\n", __func__, support_interface, mode)); + PHYDM_DBG(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 phydm_beamforming_sounding_time( + void *dm_void, + struct _RT_BEAMFORMING_INFO *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_odm = (struct PHY_DM_STRUCT *)p_dm_void; + u16 sounding_time = 0xffff; + struct _RT_BEAMFORMEE_ENTRY beam_entry = beam_info->beamformee_entry[idx]; + struct _RT_BEAMFORMING_OID_INFO beam_oid_info = beam_info->beamforming_oid_info; + struct dm_struct *dm = (struct dm_struct *)dm_void; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); + PHYDM_DBG(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;*/ + /*@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; } - -CHANNEL_WIDTH +enum channel_width phydm_beamforming_sounding_bw( - void *p_dm_void, - struct _RT_BEAMFORMING_INFO *p_beam_info, - enum sounding_mode mode, - u8 idx -) + void *dm_void, + struct _RT_BEAMFORMING_INFO *beam_info, + enum sounding_mode mode, + u8 idx) { - 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_odm = (struct PHY_DM_STRUCT *)p_dm_void; + enum channel_width sounding_bw = CHANNEL_WIDTH_20; + struct _RT_BEAMFORMEE_ENTRY beam_entry = beam_info->beamformee_entry[idx]; + struct _RT_BEAMFORMING_OID_INFO beam_oid_info = beam_info->beamforming_oid_info; + struct dm_struct *dm = (struct dm_struct *)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;*/ + /*@Modified by David*/ + sounding_bw = beam_entry.sound_bw; /*@beam_oid_info.sound_oid_bw;*/ else sounding_bw = beam_entry.sound_bw; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, sounding_bw=0x%X\n", __func__, sounding_bw)); + PHYDM_DBG(dm, DBG_TXBF, "%s, sounding_bw=0x%X\n", __func__, + sounding_bw); return sounding_bw; } - -bool +boolean phydm_beamforming_select_beam_entry( - void *p_dm_void, - struct _RT_BEAMFORMING_INFO *p_beam_info -) + void *dm_void, + struct _RT_BEAMFORMING_INFO *beam_info) { - struct _RT_SOUNDING_INFO *p_sound_info = &(p_beam_info->sounding_info); - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_SOUNDING_INFO *sound_info = &beam_info->sounding_info; + struct dm_struct *dm = (struct dm_struct *)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_odm, p_beam_info); - /*p_sound_info->sound_idx = 0;*/ + /*@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.*/ + sound_info->sound_idx = phydm_beamforming_sounding_idx(dm, beam_info); + /*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_odm, p_beam_info, p_sound_info->sound_idx); + if (sound_info->sound_idx < BEAMFORMEE_ENTRY_NUM) + sound_info->sound_mode = phydm_beamforming_sounding_mode(dm, beam_info, sound_info->sound_idx); else - p_sound_info->sound_mode = sounding_stop_all_timer; + sound_info->sound_mode = sounding_stop_all_timer; - if (sounding_stop_all_timer == p_sound_info->sound_mode) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Return because of sounding_stop_all_timer\n", __func__)); + if (sounding_stop_all_timer == sound_info->sound_mode) { + PHYDM_DBG(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_odm, p_beam_info, p_sound_info->sound_mode, p_sound_info->sound_idx); - p_sound_info->sound_period = phydm_beamforming_sounding_time(p_dm_odm, p_beam_info, p_sound_info->sound_mode, p_sound_info->sound_idx); + sound_info->sound_bw = phydm_beamforming_sounding_bw(dm, beam_info, sound_info->sound_mode, sound_info->sound_idx); + sound_info->sound_period = phydm_beamforming_sounding_time(dm, beam_info, sound_info->sound_mode, sound_info->sound_idx); return true; } } /*SU BFee Entry Only*/ -bool +boolean phydm_beamforming_start_period( - void *p_dm_void -) + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTER *adapter = p_dm_odm->adapter; - bool ret = true; - struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm_odm->beamforming_info; - struct _RT_SOUNDING_INFO *p_sound_info = &(p_beam_info->sounding_info); + struct dm_struct *dm = (struct dm_struct *)dm_void; + boolean ret = true; + struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; + struct _RT_SOUNDING_INFO *sound_info = &beam_info->sounding_info; - phydm_beamforming_dym_ndpa_rate(p_dm_odm); + phydm_beamforming_dym_ndpa_rate(dm); - phydm_beamforming_select_beam_entry(p_dm_odm, p_beam_info); /* Modified */ + phydm_beamforming_select_beam_entry(dm, 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_odm, &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) { + if (sound_info->sound_mode == SOUNDING_SW_VHT_TIMER || sound_info->sound_mode == SOUNDING_SW_HT_TIMER) + odm_set_timer(dm, &beam_info->beamforming_timer, sound_info->sound_period); + else if (sound_info->sound_mode == SOUNDING_HW_VHT_TIMER || sound_info->sound_mode == SOUNDING_HW_HT_TIMER || + sound_info->sound_mode == SOUNDING_AUTO_VHT_TIMER || 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)); + u32 val = (sound_info->sound_period | (timer_type << 16)); - /* HW timer stop: All IC has the same setting */ - phydm_set_hw_reg_handler_interface(p_dm_odm, HW_VAR_HW_REG_TIMER_STOP, (u8 *)(&timer_type)); - /* odm_write_1byte(p_dm_odm, 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_odm, HW_VAR_HW_REG_TIMER_INIT, (u8 *)(&val)); - /* odm_write_1byte(p_dm_odm, 0x164, 1); */ - /* odm_write_4byte(p_dm_odm, 0x15C, val); */ - /* HW timer start: All IC has the same setting */ - phydm_set_hw_reg_handler_interface(p_dm_odm, HW_VAR_HW_REG_TIMER_START, (u8 *)(&timer_type)); - /* odm_write_1byte(p_dm_odm, 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_odm, p_sound_info->sound_idx); + /* @HW timer stop: All IC has the same setting */ + phydm_set_hw_reg_handler_interface(dm, HW_VAR_HW_REG_TIMER_STOP, (u8 *)(&timer_type)); + /* odm_write_1byte(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(dm, HW_VAR_HW_REG_TIMER_INIT, (u8 *)(&val)); + /* odm_write_1byte(dm, 0x164, 1); */ + /* odm_write_4byte(dm, 0x15C, val); */ + /* @HW timer start: All IC has the same setting */ + phydm_set_hw_reg_handler_interface(dm, HW_VAR_HW_REG_TIMER_START, (u8 *)(&timer_type)); + /* odm_write_1byte(dm, 0x15F, 0x5); */ + } else if (sound_info->sound_mode == SOUNDING_FW_VHT_TIMER || sound_info->sound_mode == SOUNDING_FW_HT_TIMER) + ret = beamforming_start_fw(dm, sound_info->sound_idx); else ret = false; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%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)); + PHYDM_DBG(dm, DBG_TXBF, + "[%s] sound_idx=%d, sound_mode=%d, sound_bw=%d, sound_period=%d\n", + __func__, sound_info->sound_idx, sound_info->sound_mode, + sound_info->sound_bw, 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 -) +void phydm_beamforming_end_period_sw( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTER *adapter = p_dm_odm->adapter; - struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm_odm->beamforming_info; - struct _RT_SOUNDING_INFO *p_sound_info = &(p_beam_info->sounding_info); + struct dm_struct *dm = (struct dm_struct *)dm_void; + /*void *adapter = dm->adapter;*/ + struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; + struct _RT_SOUNDING_INFO *sound_info = &beam_info->sounding_info; HAL_HW_TIMER_TYPE timer_type = HAL_TIMER_TXBF; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); + PHYDM_DBG(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_odm, &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_odm, HW_VAR_HW_REG_TIMER_STOP, (u8 *)(&timer_type)); - /*odm_write_1byte(p_dm_odm, 0x15F, 0);*/ + if (sound_info->sound_mode == SOUNDING_SW_VHT_TIMER || sound_info->sound_mode == SOUNDING_SW_HT_TIMER) + odm_cancel_timer(dm, &beam_info->beamforming_timer); + else if (sound_info->sound_mode == SOUNDING_HW_VHT_TIMER || sound_info->sound_mode == SOUNDING_HW_HT_TIMER || + sound_info->sound_mode == SOUNDING_AUTO_VHT_TIMER || sound_info->sound_mode == SOUNDING_AUTO_HT_TIMER) + /*@HW timer stop: All IC has the same setting*/ + phydm_set_hw_reg_handler_interface(dm, HW_VAR_HW_REG_TIMER_STOP, (u8 *)(&timer_type)); + /*odm_write_1byte(dm, 0x15F, 0);*/ } -void -phydm_beamforming_end_period_fw( - void *p_dm_void -) +void phydm_beamforming_end_period_fw( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 idx = 0; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 idx = 0; - hal_com_txbf_set(p_dm_odm, TXBF_SET_SOUNDING_FW_NDPA, (u8 *)&idx); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]\n", __func__)); + hal_com_txbf_set(dm, TXBF_SET_SOUNDING_FW_NDPA, (u8 *)&idx); + PHYDM_DBG(dm, DBG_TXBF, "[%s]\n", __func__); } - /*SU BFee Entry Only*/ -void -phydm_beamforming_clear_entry_sw( - void *p_dm_void, - bool is_delete, - u8 delete_idx -) +void phydm_beamforming_clear_entry_sw( + void *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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm_odm->beamforming_info; + u8 idx = 0; + struct _RT_BEAMFORMEE_ENTRY *beamform_entry = NULL; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _RT_BEAMFORMING_INFO *beam_info = &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)) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] SW delete_idx is wrong!!!!!\n", __func__)); + beamform_entry = beam_info->beamformee_entry + delete_idx; + if (!(!beamform_entry->is_used && beamform_entry->is_sound)) { + PHYDM_DBG(dm, DBG_TXBF, + "[%s] SW delete_idx is wrong!!!!!\n", + __func__); return; } } - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%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_odm, TXBF_SET_SOUNDING_STATUS, (u8 *)&delete_idx); + PHYDM_DBG(dm, DBG_TXBF, "[%s] SW delete BFee entry %d\n", + __func__, delete_idx); + if (beamform_entry->beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSING) { + beamform_entry->is_beamforming_in_progress = false; + beamform_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; + } else if (beamform_entry->beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED) { + beamform_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; + hal_com_txbf_set(dm, TXBF_SET_SOUNDING_STATUS, (u8 *)&delete_idx); } - p_beamform_entry->is_sound = false; + beamform_entry->is_sound = false; + return; + } + + for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { + beamform_entry = 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 (!beamform_entry->is_sound) + continue; + + PHYDM_DBG(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 (beamform_entry->beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSING) + phydm_beamforming_end_sw(dm, 0); + else if (beamform_entry->beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED) { + beamform_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_INITIALIZED; + hal_com_txbf_set(dm, TXBF_SET_SOUNDING_STATUS, (u8 *)&idx); + } + + beamform_entry->is_sound = false; + } +} + +void phydm_beamforming_clear_entry_fw( + void *dm_void, + boolean is_delete, + u8 delete_idx) +{ + u8 idx = 0; + struct _RT_BEAMFORMEE_ENTRY *beamform_entry = NULL; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; + + if (is_delete) { + if (delete_idx < BEAMFORMEE_ENTRY_NUM) { + beamform_entry = beam_info->beamformee_entry + delete_idx; + + if (!(!beamform_entry->is_used && beamform_entry->is_sound)) { + PHYDM_DBG(dm, DBG_TXBF, + "[%s] FW delete_idx is wrong!!!!!\n", + __func__); + return; + } + } + PHYDM_DBG(dm, DBG_TXBF, "%s: FW delete BFee entry %d\n", + __func__, delete_idx); + beamform_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; + beamform_entry->is_sound = false; } else { for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { - p_beamform_entry = p_beam_info->beamformee_entry + idx; + beamform_entry = 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.*/ + /*@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) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] SW reset BFee entry %d\n", __func__, idx)); - /* + if (beamform_entry->is_sound) { + PHYDM_DBG(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. @@ -944,143 +1044,97 @@ phydm_beamforming_clear_entry_sw( * 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_odm, 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_odm, TXBF_SET_SOUNDING_STATUS, (u8 *)&idx); - } - - p_beamform_entry->is_sound = false; + beamform_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_INITIALIZED; + beamform_entry->is_sound = false; } } } } -void -phydm_beamforming_clear_entry_fw( - void *p_dm_void, - bool is_delete, - u8 delete_idx -) -{ - u8 idx = 0; - struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = NULL; - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm_odm->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)) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] FW delete_idx is wrong!!!!!\n", __func__)); - return; - } - } - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%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) { - ODM_RT_TRACE(p_dm_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. - */ - - 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 -) +void phydm_beamforming_notify( + void *dm_void) { - u8 idx = BEAMFORMEE_ENTRY_NUM; - enum beamforming_notify_state is_sounding = BEAMFORMING_NOTIFY_NONE; - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm_odm->beamforming_info; - struct _RT_SOUNDING_INFO *p_sound_info = &(p_beam_info->sounding_info); + u8 idx = BEAMFORMEE_ENTRY_NUM; + enum beamforming_notify_state is_sounding = BEAMFORMING_NOTIFY_NONE; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; + struct _RT_SOUNDING_INFO *sound_info = &beam_info->sounding_info; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "%s Start!\n", __func__); - is_sounding = phydm_beamfomring_is_sounding(p_dm_odm, p_beam_info, &idx); - - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, Before notify, is_sounding=%d, idx=%d\n", __func__, is_sounding, idx)); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: p_beam_info->beamformee_su_cnt = %d\n", __func__, p_beam_info->beamformee_su_cnt)); + is_sounding = phydm_beamfomring_is_sounding(dm, beam_info, &idx); + PHYDM_DBG(dm, DBG_TXBF, "%s, Before notify, is_sounding=%d, idx=%d\n", + __func__, is_sounding, idx); + PHYDM_DBG(dm, DBG_TXBF, "%s: beam_info->beamformee_su_cnt = %d\n", + __func__, beam_info->beamformee_su_cnt); switch (is_sounding) { case BEAMFORMEE_NOTIFY_ADD_SU: - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: BEAMFORMEE_NOTIFY_ADD_SU\n", __func__)); - phydm_beamforming_start_period(p_dm_odm); + PHYDM_DBG(dm, DBG_TXBF, "%s: BEAMFORMEE_NOTIFY_ADD_SU\n", + __func__); + phydm_beamforming_start_period(dm); break; case BEAMFORMEE_NOTIFY_DELETE_SU: - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%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_odm, 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_odm); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: No BFee left\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "%s: BEAMFORMEE_NOTIFY_DELETE_SU\n", + __func__); + if (sound_info->sound_mode == SOUNDING_FW_HT_TIMER || sound_info->sound_mode == SOUNDING_FW_VHT_TIMER) { + phydm_beamforming_clear_entry_fw(dm, true, idx); + if (beam_info->beamformee_su_cnt == 0) { /* @For 2->1 entry, we should not cancel SW timer */ + phydm_beamforming_end_period_fw(dm); + PHYDM_DBG(dm, DBG_TXBF, "%s: No BFee left\n", + __func__); } } else { - phydm_beamforming_clear_entry_sw(p_dm_odm, 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_odm); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: No BFee left\n", __func__)); + phydm_beamforming_clear_entry_sw(dm, true, idx); + if (beam_info->beamformee_su_cnt == 0) { /* @For 2->1 entry, we should not cancel SW timer */ + phydm_beamforming_end_period_sw(dm); + PHYDM_DBG(dm, DBG_TXBF, "%s: No BFee left\n", + __func__); } } break; case BEAMFORMEE_NOTIFY_ADD_MU: - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%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_odm, &p_beam_info->beamforming_timer, p_sound_info->sound_period);*/ - odm_set_timer(p_dm_odm, &p_beam_info->beamforming_timer, 1000); /*Do MU sounding every 1sec*/ + PHYDM_DBG(dm, DBG_TXBF, "%s: BEAMFORMEE_NOTIFY_ADD_MU\n", + __func__); + if (beam_info->beamformee_mu_cnt == 2) { + /*@if (sound_info->sound_mode == SOUNDING_SW_VHT_TIMER || sound_info->sound_mode == SOUNDING_SW_HT_TIMER) + odm_set_timer(dm, &beam_info->beamforming_timer, sound_info->sound_period);*/ + odm_set_timer(dm, &beam_info->beamforming_timer, 1000); /*@Do MU sounding every 1sec*/ } else - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: Less or larger than 2 MU STAs, not to set timer\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, + "%s: Less or larger than 2 MU STAs, not to set timer\n", + __func__); break; case BEAMFORMEE_NOTIFY_DELETE_MU: - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%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_odm, &p_beam_info->beamforming_timer); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: Less than 2 MU STAs, stop sounding\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "%s: BEAMFORMEE_NOTIFY_DELETE_MU\n", + __func__); + if (beam_info->beamformee_mu_cnt == 1) { + /*@if (sound_info->sound_mode == SOUNDING_SW_VHT_TIMER || sound_info->sound_mode == SOUNDING_SW_HT_TIMER)*/ { + odm_cancel_timer(dm, &beam_info->beamforming_timer); + PHYDM_DBG(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_odm, false, idx); - phydm_beamforming_end_period_fw(p_dm_odm); + if (sound_info->sound_mode == SOUNDING_FW_HT_TIMER || sound_info->sound_mode == SOUNDING_FW_VHT_TIMER) { + phydm_beamforming_clear_entry_fw(dm, false, idx); + phydm_beamforming_end_period_fw(dm); } else { - phydm_beamforming_clear_entry_sw(p_dm_odm, false, idx); - phydm_beamforming_end_period_sw(p_dm_odm); + phydm_beamforming_clear_entry_sw(dm, false, idx); + phydm_beamforming_end_period_sw(dm); } break; @@ -1088,597 +1142,637 @@ phydm_beamforming_notify( default: break; } - } - - -bool -beamforming_init_entry( - void *p_dm_void, - u16 sta_idx, - u8 *bfer_bfee_idx -) +boolean +beamforming_init_entry(void *dm_void, u16 sta_idx, u8 *bfer_bfee_idx, + u8 *my_mac_addr) { - struct PHY_DM_STRUCT *p_dm_odm = (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; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct cmn_sta_info *cmn_sta = dm->phydm_sta_info[sta_idx]; + struct _RT_BEAMFORMEE_ENTRY *beamform_entry = NULL; + struct _RT_BEAMFORMER_ENTRY *beamformer_entry = NULL; + struct _RT_BEAMFORM_STAINFO *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_odm, 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) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("The configuration disabled Beamforming! Skip...\n")); + if (!is_sta_active(cmn_sta)) { + PHYDM_DBG(dm, DBG_TXBF, "%s => sta_info(mac_id:%d) failed\n", + __func__, sta_idx); + #if (DM_ODM_SUPPORT_TYPE == ODM_CE) + rtw_warn_on(1); + #endif return false; } - if (p_sta->wireless_mode < WIRELESS_MODE_N_24G) + sta = phydm_sta_info_init(dm, sta_idx, my_mac_addr); + /*The current setting does not support Beaforming*/ + if (BEAMFORMING_CAP_NONE == sta->ht_beamform_cap && BEAMFORMING_CAP_NONE == sta->vht_beamform_cap) { + PHYDM_DBG(dm, DBG_TXBF, + "The configuration disabled Beamforming! Skip...\n"); + return false; + } + + if (!(cmn_sta->support_wireless_set & (WIRELESS_VHT | WIRELESS_HT))) 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*/ + if (cmn_sta->support_wireless_set & WIRELESS_HT) { /*@HT*/ + if (TEST_FLAG(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; + num_of_sounding_dim = (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)) { + if (TEST_FLAG(sta->cur_beamform, BEAMFORMING_HT_BEAMFORMEE_ENABLE) || + TEST_FLAG(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; + comp_steering_num_of_bfer = (sta->cur_beamform & BEAMFORMING_HT_BEAMFORMER_STEER_NUM) >> 4; } - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] HT cur_beamform=0x%X, beamform_cap=0x%X\n", __func__, p_sta->cur_beamform, beamform_cap)); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] HT num_of_sounding_dim=%d, comp_steering_num_of_bfer=%d\n", __func__, num_of_sounding_dim, comp_steering_num_of_bfer)); + PHYDM_DBG(dm, DBG_TXBF, + "[%s] HT cur_beamform=0x%X, beamform_cap=0x%X\n", + __func__, sta->cur_beamform, beamform_cap); + PHYDM_DBG(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*/ + if (cmn_sta->support_wireless_set & WIRELESS_VHT) { /*VHT*/ /* We are Beamformee because the STA is SU Beamformer*/ - if (TEST_FLAG(p_sta->cur_beamform_vht, BEAMFORMING_VHT_BEAMFORMER_ENABLE)) { + if (TEST_FLAG(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; + num_of_sounding_dim = (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)) { + if (TEST_FLAG(sta->cur_beamform_vht, BEAMFORMING_VHT_BEAMFORMEE_ENABLE) || + TEST_FLAG(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; + comp_steering_num_of_bfer = (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)) { + if (TEST_FLAG(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; + num_of_sounding_dim = (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_odm, 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)) { + if (phydm_acting_determine(dm, phydm_acting_as_ap)) { /* Only AP mode supports to act an MU beamformer */ + if (TEST_FLAG(sta->cur_beamform_vht, BEAMFORMING_VHT_MU_MIMO_STA_ENABLE) || + TEST_FLAG(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; + comp_steering_num_of_bfer = (sta->cur_beamform_vht & BEAMFORMING_VHT_BEAMFORMER_STS_CAP) >> 8; } } - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]VHT cur_beamform_vht=0x%X, beamform_cap=0x%X\n", __func__, p_sta->cur_beamform_vht, beamform_cap)); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%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)); - + PHYDM_DBG(dm, DBG_TXBF, + "[%s]VHT cur_beamform_vht=0x%X, beamform_cap=0x%X\n", + __func__, sta->cur_beamform_vht, + beamform_cap); + PHYDM_DBG(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; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Self BF Entry Cap = 0x%02X\n", __func__, beamform_cap)); + PHYDM_DBG(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_odm, p_sta->ra, &bfer_idx); + beamformer_entry = phydm_beamforming_get_bfer_entry_by_addr(dm, sta->ra, &bfer_idx); - if (p_beamformer_entry == NULL) { - p_beamformer_entry = beamforming_add_bfer_entry(p_dm_odm, p_sta, beamform_cap, num_of_sounding_dim, &bfer_idx); - if (p_beamformer_entry == NULL) - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]Not enough BFer entry!!!!!\n", __func__)); + if (beamformer_entry == NULL) { + beamformer_entry = beamforming_add_bfer_entry(dm, sta, beamform_cap, num_of_sounding_dim, &bfer_idx); + if (beamformer_entry == NULL) + PHYDM_DBG(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_odm, p_sta->ra, &bfee_idx); + beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(dm, sta->ra, &bfee_idx); - /*¦pªGBFeeIdx = 0xF «h¥Nªí¥Ø«eentry·í¤¤¨S¦³¬Û¦PªºMACID¦b¤º*/ - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%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_odm, p_sta, beamform_cap, num_of_sounding_dim, comp_steering_num_of_bfer, &bfee_idx); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]: p_sta->AID=%d, p_sta->mac_id=%d\n", __func__, p_sta->aid, p_sta->mac_id)); + /*@if BFeeIdx = 0xF, that represent for no matched MACID among all linked entrys */ + PHYDM_DBG(dm, DBG_TXBF, "[%s] Get BFee entry 0x%X by address\n", + __func__, bfee_idx); + if (beamform_entry == NULL) { + beamform_entry = beamforming_add_bfee_entry(dm, sta, beamform_cap, num_of_sounding_dim, comp_steering_num_of_bfer, &bfee_idx); + PHYDM_DBG(dm, DBG_TXBF, + "[%s]: sta->AID=%d, sta->mac_id=%d\n", + __func__, sta->aid, sta->mac_id); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]: Add BFee entry %d\n", __func__, bfee_idx)); + PHYDM_DBG(dm, DBG_TXBF, "[%s]: Add BFee entry %d\n", + __func__, bfee_idx); - if (p_beamform_entry == NULL) + if (beamform_entry == NULL) return false; else - p_beamform_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_INITIALIZEING; + 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) + /*@Entry has been created. If entry is initialing or progressing then errors occur.*/ + if (beamform_entry->beamform_entry_state != BEAMFORMING_ENTRY_STATE_INITIALIZED && + beamform_entry->beamform_entry_state != BEAMFORMING_ENTRY_STATE_PROGRESSED) return false; else - p_beamform_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_INITIALIZEING; + 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_odm, sta_idx, p_beamform_entry); + beamform_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_INITIALIZED; + phydm_sta_info_update(dm, sta_idx, beamform_entry); } *bfer_bfee_idx = (bfer_idx << 4) | bfee_idx; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] End: bfer_idx=0x%X, bfee_idx=0x%X, bfer_bfee_idx=0x%X\n", __func__, bfer_idx, bfee_idx, *bfer_bfee_idx)); + PHYDM_DBG(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 -) +void beamforming_deinit_entry( + void *dm_void, + u8 *RA) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 idx = 0; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 idx = 0; - struct _RT_BEAMFORMER_ENTRY *p_bfer_entry = phydm_beamforming_get_bfer_entry_by_addr(p_dm_odm, RA, &idx); - struct _RT_BEAMFORMEE_ENTRY *p_bfee_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm_odm, RA, &idx); - bool ret = false; + struct _RT_BEAMFORMER_ENTRY *bfer_entry = phydm_beamforming_get_bfer_entry_by_addr(dm, RA, &idx); + struct _RT_BEAMFORMEE_ENTRY *bfee_entry = phydm_beamforming_get_bfee_entry_by_addr(dm, RA, &idx); + boolean ret = false; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "%s Start!\n", __func__); - if (p_bfee_entry != NULL) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%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_odm->beamforming_info.beamformee_mu_cnt -= 1; - p_dm_odm->beamforming_info.first_mu_bfee_index = phydm_beamforming_get_first_mu_bfee_entry_idx(p_dm_odm); + if (bfee_entry != NULL) { + PHYDM_DBG(dm, DBG_TXBF, "%s, bfee_entry\n", __func__); + bfee_entry->is_used = false; + bfee_entry->beamform_entry_cap = BEAMFORMING_CAP_NONE; + bfee_entry->is_beamforming_in_progress = false; + if (bfee_entry->is_mu_sta) { + dm->beamforming_info.beamformee_mu_cnt -= 1; + dm->beamforming_info.first_mu_bfee_index = phydm_beamforming_get_first_mu_bfee_entry_idx(dm); } else - p_dm_odm->beamforming_info.beamformee_su_cnt -= 1; + dm->beamforming_info.beamformee_su_cnt -= 1; ret = true; } - if (p_bfer_entry != NULL) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%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_odm->beamforming_info.beamformer_mu_cnt -= 1; + if (bfer_entry != NULL) { + PHYDM_DBG(dm, DBG_TXBF, "%s, bfer_entry\n", __func__); + bfer_entry->is_used = false; + bfer_entry->beamform_entry_cap = BEAMFORMING_CAP_NONE; + if (bfer_entry->is_mu_ap) + dm->beamforming_info.beamformer_mu_cnt -= 1; else - p_dm_odm->beamforming_info.beamformer_su_cnt -= 1; + dm->beamforming_info.beamformer_su_cnt -= 1; ret = true; } if (ret == true) - hal_com_txbf_set(p_dm_odm, TXBF_SET_SOUNDING_LEAVE, (u8 *)&idx); + hal_com_txbf_set(dm, TXBF_SET_SOUNDING_LEAVE, (u8 *)&idx); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s End, idx = 0x%X\n", __func__, idx)); + PHYDM_DBG(dm, DBG_TXBF, "%s End, idx = 0x%X\n", __func__, idx); } - -bool +boolean beamforming_start_v1( - void *p_dm_void, - u8 *RA, - bool mode, - CHANNEL_WIDTH BW, - u8 rate -) + void *dm_void, + u8 *RA, + boolean mode, + enum channel_width BW, + u8 rate) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 idx = 0; - struct _RT_BEAMFORMEE_ENTRY *p_entry; - bool ret = true; - struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm_odm->beamforming_info); + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 idx = 0; + struct _RT_BEAMFORMEE_ENTRY *entry; + boolean ret = true; + struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; - p_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm_odm, RA, &idx); + entry = phydm_beamforming_get_bfee_entry_by_addr(dm, RA, &idx); - if (p_entry->is_used == false) { - p_entry->is_beamforming_in_progress = false; + if (entry->is_used == false) { + entry->is_beamforming_in_progress = false; return false; } else { - if (p_entry->is_beamforming_in_progress) + if (entry->is_beamforming_in_progress) return false; - p_entry->is_beamforming_in_progress = true; + 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; + if (!(entry->beamform_entry_cap & BEAMFORMER_CAP_HT_EXPLICIT)) { + 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; + if (!(entry->beamform_entry_cap & BEAMFORMER_CAP_VHT_SU)) { + 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; + if (entry->beamform_entry_state != BEAMFORMING_ENTRY_STATE_INITIALIZED && entry->beamform_entry_state != BEAMFORMING_ENTRY_STATE_PROGRESSED) { + entry->is_beamforming_in_progress = false; return false; } else { - p_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_PROGRESSING; - p_entry->is_sound = true; + entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_PROGRESSING; + entry->is_sound = true; } } - p_entry->sound_bw = BW; - p_beam_info->beamformee_cur_idx = idx; - phydm_beamforming_ndpa_rate(p_dm_odm, BW, rate); - hal_com_txbf_set(p_dm_odm, TXBF_SET_SOUNDING_STATUS, (u8 *)&idx); + entry->sound_bw = BW; + beam_info->beamformee_cur_idx = idx; + phydm_beamforming_ndpa_rate(dm, BW, rate); + hal_com_txbf_set(dm, TXBF_SET_SOUNDING_STATUS, (u8 *)&idx); if (mode == 1) - ret = beamforming_send_ht_ndpa_packet(p_dm_odm, RA, BW, NORMAL_QUEUE); + ret = beamforming_send_ht_ndpa_packet(dm, RA, BW, NORMAL_QUEUE); else - ret = beamforming_send_vht_ndpa_packet(p_dm_odm, RA, p_entry->aid, BW, NORMAL_QUEUE); + ret = beamforming_send_vht_ndpa_packet(dm, RA, entry->aid, BW, NORMAL_QUEUE); if (ret == false) { - beamforming_leave(p_dm_odm, RA); - p_entry->is_beamforming_in_progress = false; + beamforming_leave(dm, RA); + entry->is_beamforming_in_progress = false; return false; } - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s idx %d\n", __func__, idx)); + PHYDM_DBG(dm, DBG_TXBF, "%s idx %d\n", __func__, idx); return true; } - -bool +boolean beamforming_start_sw( - void *p_dm_void, - u8 idx, - u8 mode, - CHANNEL_WIDTH BW -) + void *dm_void, + u8 idx, + u8 mode, + enum channel_width BW) { - u8 *ra = NULL; - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_BEAMFORMEE_ENTRY *p_entry; - bool ret = true; - struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm_odm->beamforming_info); + u8 *ra = NULL; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _RT_BEAMFORMEE_ENTRY *entry; + boolean ret = true; + struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; +#ifdef SUPPORT_MU_BF +#if (SUPPORT_MU_BF == 1) + u8 i, poll_sta_cnt = 0; + boolean is_get_first_bfee = false; +#endif +#endif - 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; + if (beam_info->is_mu_sounding) { + beam_info->is_mu_sounding_in_progress = true; + entry = &beam_info->beamformee_entry[idx]; + ra = entry->mac_addr; } else { - p_entry = &(p_beam_info->beamformee_entry[idx]); + entry = &beam_info->beamformee_entry[idx]; - if (p_entry->is_used == false) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Skip Beamforming, no entry for idx =%d\n", idx)); - p_entry->is_beamforming_in_progress = false; + if (entry->is_used == false) { + PHYDM_DBG(dm, DBG_TXBF, + "Skip Beamforming, no entry for idx =%d\n", + idx); + entry->is_beamforming_in_progress = false; return false; - } else { - if (p_entry->is_beamforming_in_progress) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("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; - ODM_RT_TRACE(p_dm_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 (!(p_entry->beamform_entry_cap & BEAMFORMER_CAP_VHT_SU)) { - p_entry->is_beamforming_in_progress = false; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%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; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%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; + if (entry->is_beamforming_in_progress) { + PHYDM_DBG(dm, DBG_TXBF, + "is_beamforming_in_progress, skip...\n"); + return false; + } + + entry->is_beamforming_in_progress = true; + ra = entry->mac_addr; + + if (mode == SOUNDING_SW_HT_TIMER || mode == SOUNDING_HW_HT_TIMER || mode == SOUNDING_AUTO_HT_TIMER) { + if (!(entry->beamform_entry_cap & BEAMFORMER_CAP_HT_EXPLICIT)) { + entry->is_beamforming_in_progress = false; + PHYDM_DBG(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 (!(entry->beamform_entry_cap & BEAMFORMER_CAP_VHT_SU)) { + entry->is_beamforming_in_progress = false; + PHYDM_DBG(dm, DBG_TXBF, + "%s Return by not support BEAMFORMER_CAP_VHT_SU <==\n", + __func__); + return false; + } + } + if (entry->beamform_entry_state != BEAMFORMING_ENTRY_STATE_INITIALIZED && entry->beamform_entry_state != BEAMFORMING_ENTRY_STATE_PROGRESSED) { + entry->is_beamforming_in_progress = false; + PHYDM_DBG(dm, DBG_TXBF, + "%s Return by incorrect beamform_entry_state(%d) <==\n", + __func__, entry->beamform_entry_state); + return false; + } else { + entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_PROGRESSING; + entry->is_sound = true; + } + + 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);*/ + /*@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_odm, ra, BW, NORMAL_QUEUE); + ret = beamforming_send_ht_ndpa_packet(dm, ra, BW, NORMAL_QUEUE); else - ret = beamforming_send_vht_ndpa_packet(p_dm_odm, ra, p_entry->aid, BW, NORMAL_QUEUE); + ret = beamforming_send_vht_ndpa_packet(dm, ra, entry->aid, BW, NORMAL_QUEUE); if (ret == false) { - beamforming_leave(p_dm_odm, ra); - p_entry->is_beamforming_in_progress = false; + beamforming_leave(dm, ra); + 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; - bool is_get_first_bfee = false; + if (beam_info->beamformee_mu_cnt <= 1) + goto out; - if (p_beam_info->beamformee_mu_cnt > 1) { /* More than 1 MU STA*/ + /* @More than 1 MU STA*/ + for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { + entry = &beam_info->beamformee_entry[i]; + if (!entry->is_mu_sta) + continue; - 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_odm, p_entry->mac_addr, true); - else - send_sw_vht_bf_report_poll(p_dm_odm, p_entry->mac_addr, false); - } else - is_get_first_bfee = true; - } - } + if (!is_get_first_bfee) { + is_get_first_bfee = true; + continue; } + + poll_sta_cnt++; + if (poll_sta_cnt == (beam_info->beamformee_mu_cnt - 1)) /* The last STA*/ + send_sw_vht_bf_report_poll(dm, entry->mac_addr, true); + else + send_sw_vht_bf_report_poll(dm, entry->mac_addr, false); } +out: #endif #endif return true; } - -bool +boolean beamforming_start_fw( - void *p_dm_void, - u8 idx -) + void *dm_void, + u8 idx) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_BEAMFORMEE_ENTRY *p_entry; - struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm_odm->beamforming_info); + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _RT_BEAMFORMEE_ENTRY *entry; + struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; - p_entry = &(p_beam_info->beamformee_entry[idx]); - if (p_entry->is_used == false) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Skip Beamforming, no entry for idx =%d\n", idx)); + entry = &beam_info->beamformee_entry[idx]; + if (entry->is_used == false) { + PHYDM_DBG(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_odm, TXBF_SET_SOUNDING_FW_NDPA, (u8 *)&idx); + entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_PROGRESSING; + entry->is_sound = true; + hal_com_txbf_set(dm, TXBF_SET_SOUNDING_FW_NDPA, (u8 *)&idx); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] End, idx=0x%X\n", __func__, idx)); + PHYDM_DBG(dm, DBG_TXBF, "[%s] End, idx=0x%X\n", __func__, idx); return true; } -void -beamforming_check_sounding_success( - void *p_dm_void, - bool status -) +void beamforming_check_sounding_success( + void *dm_void, + boolean status) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm_odm->beamforming_info); - struct _RT_BEAMFORMEE_ENTRY *p_entry = &(p_beam_info->beamformee_entry[p_beam_info->beamformee_cur_idx]); + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; + struct _RT_BEAMFORMEE_ENTRY *entry = &beam_info->beamformee_entry[beam_info->beamformee_cur_idx]; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[David]@%s Start!\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "[David]@%s Start!\n", __func__); if (status == 1) { - if (p_entry->log_status_fail_cnt == 21) - beamforming_dym_period(p_dm_odm, status); - p_entry->log_status_fail_cnt = 0; - } else if (p_entry->log_status_fail_cnt <= 20) { - p_entry->log_status_fail_cnt++; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s log_status_fail_cnt %d\n", __func__, p_entry->log_status_fail_cnt)); + if (entry->log_status_fail_cnt == 21) + beamforming_dym_period(dm, status); + entry->log_status_fail_cnt = 0; + } else if (entry->log_status_fail_cnt <= 20) { + entry->log_status_fail_cnt++; + PHYDM_DBG(dm, DBG_TXBF, "%s log_status_fail_cnt %d\n", __func__, + entry->log_status_fail_cnt); } - if (p_entry->log_status_fail_cnt > 20) { - p_entry->log_status_fail_cnt = 21; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s log_status_fail_cnt > 20, Stop SOUNDING\n", __func__)); - beamforming_dym_period(p_dm_odm, status); + if (entry->log_status_fail_cnt > 20) { + entry->log_status_fail_cnt = 21; + PHYDM_DBG(dm, DBG_TXBF, + "%s log_status_fail_cnt > 20, Stop SOUNDING\n", + __func__); + beamforming_dym_period(dm, status); } } -void -phydm_beamforming_end_sw( - void *p_dm_void, - bool status -) +void phydm_beamforming_end_sw( + void *dm_void, + boolean status) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm_odm->beamforming_info; - struct _RT_BEAMFORMEE_ENTRY *p_entry = &(p_beam_info->beamformee_entry[p_beam_info->beamformee_cur_idx]); + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; + struct _RT_BEAMFORMEE_ENTRY *entry = &beam_info->beamformee_entry[beam_info->beamformee_cur_idx]; - if (p_beam_info->is_mu_sounding) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: MU sounding done\n", __func__)); - p_beam_info->is_mu_sounding_in_progress = false; - hal_com_txbf_set(p_dm_odm, TXBF_SET_SOUNDING_STATUS, (u8 *)&(p_beam_info->beamformee_cur_idx)); + if (beam_info->is_mu_sounding) { + PHYDM_DBG(dm, DBG_TXBF, "%s: MU sounding done\n", __func__); + beam_info->is_mu_sounding_in_progress = false; + hal_com_txbf_set(dm, TXBF_SET_SOUNDING_STATUS, + (u8 *)&beam_info->beamformee_cur_idx); } else { - if (p_entry->beamform_entry_state != BEAMFORMING_ENTRY_STATE_PROGRESSING) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] BeamformStatus %d\n", __func__, p_entry->beamform_entry_state)); + if (entry->beamform_entry_state != BEAMFORMING_ENTRY_STATE_PROGRESSING) { + PHYDM_DBG(dm, DBG_TXBF, "[%s] BeamformStatus %d\n", + __func__, entry->beamform_entry_state); return; } - if ((p_dm_odm->tx_bf_data_rate >= ODM_RATEVHTSS3MCS7) && (p_dm_odm->tx_bf_data_rate <= ODM_RATEVHTSS3MCS9) && (p_beam_info->snding3ss == false)) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%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_odm, TXBF_SET_SOUNDING_STATUS, (u8 *)&(p_beam_info->beamformee_cur_idx)); + if (beam_info->tx_bf_data_rate >= ODM_RATEVHTSS3MCS7 && beam_info->tx_bf_data_rate <= ODM_RATEVHTSS3MCS9 && !beam_info->snding3ss) { + PHYDM_DBG(dm, DBG_TXBF, + "[%s] VHT3SS 7,8,9, do not apply V matrix.\n", + __func__); + entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_INITIALIZED; + hal_com_txbf_set(dm, TXBF_SET_SOUNDING_STATUS, + (u8 *)&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_odm, TXBF_SET_SOUNDING_STATUS, (u8 *)&(p_beam_info->beamformee_cur_idx)); + entry->log_status_fail_cnt = 0; + entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_PROGRESSED; + hal_com_txbf_set(dm, TXBF_SET_SOUNDING_STATUS, + (u8 *)&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_odm, TXBF_SET_TX_PATH_RESET, (u8 *)&(p_beam_info->beamformee_cur_idx)); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] log_status_fail_cnt %d\n", __func__, p_entry->log_status_fail_cnt)); + entry->log_status_fail_cnt++; + entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_INITIALIZED; + hal_com_txbf_set(dm, TXBF_SET_TX_PATH_RESET, + (u8 *)&beam_info->beamformee_cur_idx); + PHYDM_DBG(dm, DBG_TXBF, "[%s] log_status_fail_cnt %d\n", + __func__, entry->log_status_fail_cnt); } - if (p_entry->log_status_fail_cnt > 50) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s log_status_fail_cnt > 50, Stop SOUNDING\n", __func__)); - p_entry->is_sound = false; - beamforming_deinit_entry(p_dm_odm, p_entry->mac_addr); + if (entry->log_status_fail_cnt > 50) { + PHYDM_DBG(dm, DBG_TXBF, + "%s log_status_fail_cnt > 50, Stop SOUNDING\n", + __func__); + entry->is_sound = false; + beamforming_deinit_entry(dm, entry->mac_addr); - /*Modified by David - Every action of deleting entry should follow by Notify*/ - phydm_beamforming_notify(p_dm_odm); + /*@Modified by David - Every action of deleting entry should follow by Notify*/ + phydm_beamforming_notify(dm); } - p_entry->is_beamforming_in_progress = false; + entry->is_beamforming_in_progress = false; } - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: status=%d\n", __func__, status)); + PHYDM_DBG(dm, DBG_TXBF, "%s: status=%d\n", __func__, status); } - -void -beamforming_timer_callback( +void beamforming_timer_callback( #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - void *p_dm_void + void *dm_void #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - void *p_context + void *context #endif -) + ) { #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTER *adapter = p_dm_odm->adapter; + struct dm_struct *dm = (struct dm_struct *)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_odm = &p_hal_data->odmpriv; + void *adapter = (void *)context; + PHAL_DATA_TYPE hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + struct dm_struct *dm = &hal_data->odmpriv; #endif - bool ret = false; - struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm_odm->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); - bool is_beamforming_in_progress; + boolean ret = false; + struct _RT_BEAMFORMING_INFO *beam_info = &(dm->beamforming_info); + struct _RT_BEAMFORMEE_ENTRY *entry = &(beam_info->beamformee_entry[beam_info->beamformee_cur_idx]); + struct _RT_SOUNDING_INFO *sound_info = &(beam_info->sounding_info); + boolean is_beamforming_in_progress; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); + PHYDM_DBG(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; + if (beam_info->is_mu_sounding) + is_beamforming_in_progress = beam_info->is_mu_sounding_in_progress; else - is_beamforming_in_progress = p_entry->is_beamforming_in_progress; + is_beamforming_in_progress = entry->is_beamforming_in_progress; if (is_beamforming_in_progress) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("is_beamforming_in_progress, reset it\n")); - phydm_beamforming_end_sw(p_dm_odm, 0); + PHYDM_DBG(dm, DBG_TXBF, + "is_beamforming_in_progress, reset it\n"); + phydm_beamforming_end_sw(dm, 0); } - ret = phydm_beamforming_select_beam_entry(p_dm_odm, p_beam_info); + ret = phydm_beamforming_select_beam_entry(dm, beam_info); #if (SUPPORT_MU_BF == 1) - if (ret && p_beam_info->beamformee_mu_cnt > 1) + if (ret && beam_info->beamformee_mu_cnt > 1) ret = 1; else ret = 0; #endif if (ret) - ret = beamforming_start_sw(p_dm_odm, p_sound_info->sound_idx, p_sound_info->sound_mode, p_sound_info->sound_bw); + ret = beamforming_start_sw(dm, sound_info->sound_idx, sound_info->sound_mode, sound_info->sound_bw); else - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, Error value return from BeamformingStart_V2\n", __func__)); + PHYDM_DBG(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_odm, &p_beam_info->beamforming_timer, p_sound_info->sound_period); + if (beam_info->beamformee_su_cnt != 0 || beam_info->beamformee_mu_cnt > 1) { + if (sound_info->sound_mode == SOUNDING_SW_VHT_TIMER || sound_info->sound_mode == SOUNDING_SW_HT_TIMER) + odm_set_timer(dm, &beam_info->beamforming_timer, sound_info->sound_period); else { - u32 val = (p_sound_info->sound_period << 16) | HAL_TIMER_TXBF; - phydm_set_hw_reg_handler_interface(p_dm_odm, HW_VAR_HW_REG_TIMER_RESTART, (u8 *)(&val)); + u32 val = (sound_info->sound_period << 16) | HAL_TIMER_TXBF; + phydm_set_hw_reg_handler_interface(dm, HW_VAR_HW_REG_TIMER_RESTART, (u8 *)(&val)); } } } - -void -beamforming_sw_timer_callback( +void beamforming_sw_timer_callback( #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct timer_list *p_timer + struct phydm_timer_list *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_odm = &p_hal_data->DM_OutSrc; + void *adapter = (void *)timer->Adapter; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + struct dm_struct *dm = &hal_data->DM_OutSrc; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); - beamforming_timer_callback(p_dm_odm); + PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); + beamforming_timer_callback(dm); #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)function_context; - struct _ADAPTER *adapter = p_dm_odm->adapter; + struct dm_struct *dm = (struct dm_struct *)function_context; + void *adapter = dm->adapter; - if (adapter->net_closed == true) + if (*dm->is_net_closed == true) return; - rtw_run_in_thread_cmd(adapter, beamforming_timer_callback, adapter); + phydm_run_in_thread_cmd(dm, beamforming_timer_callback, adapter); #endif - } - -void -phydm_beamforming_init( - void *p_dm_void -) +void phydm_beamforming_init( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm_odm->beamforming_info; - struct _RT_BEAMFORMING_OID_INFO *p_beam_oid_info = &(p_beam_info->beamforming_oid_info); + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; + struct _RT_BEAMFORMING_OID_INFO *beam_oid_info = &beam_info->beamforming_oid_info; +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + void *adapter = dm->adapter; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); - p_beam_oid_info->sound_oid_mode = SOUNDING_STOP_OID_TIMER; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s mode (%d)\n", __func__, p_beam_oid_info->sound_oid_mode)); +#ifdef BEAMFORMING_VERSION_1 + if (hal_data->beamforming_version != BEAMFORMING_VERSION_1) { + return; + } +#endif +#endif - 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; + beam_oid_info->sound_oid_mode = SOUNDING_STOP_OID_TIMER; + PHYDM_DBG(dm, DBG_TXBF, "%s mode (%d)\n", __func__, + beam_oid_info->sound_oid_mode); + + beam_info->beamformee_su_cnt = 0; + beam_info->beamformer_su_cnt = 0; + beam_info->beamformee_mu_cnt = 0; + beam_info->beamformer_mu_cnt = 0; + beam_info->beamformee_mu_reg_maping = 0; + beam_info->mu_ap_index = 0; + beam_info->is_mu_sounding = false; + beam_info->first_mu_bfee_index = 0xFF; + beam_info->apply_v_matrix = true; + beam_info->snding3ss = false; #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - p_beam_info->source_adapter = p_dm_odm->adapter; + beam_info->source_adapter = dm->adapter; #endif - hal_com_txbf_beamform_init(p_dm_odm); + hal_com_txbf_beamform_init(dm); } - -bool +boolean phydm_acting_determine( - void *p_dm_void, - enum phydm_acting_type type -) + void *dm_void, + enum phydm_acting_type type) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - bool ret = false; + struct dm_struct *dm = (struct dm_struct *)dm_void; + boolean ret = false; #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _ADAPTER *adapter = p_dm_odm->beamforming_info.source_adapter; + void *adapter = dm->beamforming_info.source_adapter; #else - struct _ADAPTER *adapter = p_dm_odm->adapter; + struct _ADAPTER *adapter = 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); + ret = ACTING_AS_IBSS(((PADAPTER)(adapter))); #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); + struct mlme_priv *pmlmepriv = &adapter->mlmepriv; if (type == phydm_acting_as_ap) ret = check_fwstate(pmlmepriv, WIFI_AP_STATE); @@ -1687,101 +1781,97 @@ phydm_acting_determine( #endif return ret; - } -void -beamforming_enter( - void *p_dm_void, - u16 sta_idx -) +void beamforming_enter(void *dm_void, u16 sta_idx, u8 *my_mac_addr) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 bfer_bfee_idx = 0xff; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 bfer_bfee_idx = 0xff; - if (beamforming_init_entry(p_dm_odm, sta_idx, &bfer_bfee_idx)) - hal_com_txbf_set(p_dm_odm, TXBF_SET_SOUNDING_ENTER, (u8 *)&bfer_bfee_idx); + if (beamforming_init_entry(dm, sta_idx, &bfer_bfee_idx, my_mac_addr)) + hal_com_txbf_set(dm, TXBF_SET_SOUNDING_ENTER, (u8 *)&bfer_bfee_idx); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] End!\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "[%s] End!\n", __func__); } - -void -beamforming_leave( - void *p_dm_void, - u8 *RA -) +void beamforming_leave( + void *dm_void, + u8 *RA) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; if (RA != NULL) { - beamforming_deinit_entry(p_dm_odm, RA); - phydm_beamforming_notify(p_dm_odm); + beamforming_deinit_entry(dm, RA); + phydm_beamforming_notify(dm); } - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] End!!\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "[%s] End!!\n", __func__); } #if 0 /* Nobody calls this function */ void phydm_beamforming_set_txbf_en( - void *p_dm_void, + void *dm_void, u8 mac_id, - bool is_txbf + boolean is_txbf ) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; u8 idx = 0; - struct _RT_BEAMFORMEE_ENTRY *p_entry; + struct _RT_BEAMFORMEE_ENTRY *entry; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "%s Start!\n", __func__); - p_entry = phydm_beamforming_get_entry_by_mac_id(p_dm_odm, mac_id, &idx); + entry = phydm_beamforming_get_entry_by_mac_id(dm, mac_id, &idx); - if (p_entry == NULL) + if (entry == NULL) return; else - p_entry->is_txbf = is_txbf; + entry->is_txbf = is_txbf; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s mac_id %d TxBF %d\n", __func__, p_entry->mac_id, p_entry->is_txbf)); + PHYDM_DBG(dm, DBG_TXBF, "%s mac_id %d TxBF %d\n", __func__, + entry->mac_id, entry->is_txbf); - phydm_beamforming_notify(p_dm_odm); + phydm_beamforming_notify(dm); } #endif enum beamforming_cap phydm_beamforming_get_beam_cap( - void *p_dm_void, - struct _RT_BEAMFORMING_INFO *p_beam_info -) + void *dm_void, + struct _RT_BEAMFORMING_INFO *beam_info) { - u8 i; - bool is_self_beamformer = false; - bool 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_odm = (struct PHY_DM_STRUCT *)p_dm_void; + 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 dm_struct *dm = (struct dm_struct *)dm_void; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { - beamformee_entry = p_beam_info->beamformee_entry[i]; + beamformee_entry = beam_info->beamformee_entry[i]; if (beamformee_entry.is_used) { is_self_beamformer = true; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] BFee entry %d is_used=true\n", __func__, i)); + PHYDM_DBG(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]; + beamformer_entry = beam_info->beamformer_entry[i]; if (beamformer_entry.is_used) { is_self_beamformee = true; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]: BFer entry %d is_used=true\n", __func__, i)); + PHYDM_DBG(dm, DBG_TXBF, + "[%s]: BFer entry %d is_used=true\n", + __func__, i); break; } } @@ -1794,88 +1884,168 @@ phydm_beamforming_get_beam_cap( return beamform_cap; } - -bool +boolean beamforming_control_v1( - void *p_dm_void, - u8 *RA, - u8 AID, - u8 mode, - CHANNEL_WIDTH BW, - u8 rate -) + void *dm_void, + u8 *RA, + u8 AID, + u8 mode, + enum channel_width BW, + u8 rate) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - bool ret = true; + struct dm_struct *dm = (struct dm_struct *)dm_void; + boolean ret = true; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "%s Start!\n", __func__); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("AID (%d), mode (%d), BW (%d)\n", AID, mode, BW)); + PHYDM_DBG(dm, DBG_TXBF, "AID (%d), mode (%d), BW (%d)\n", AID, mode, + BW); switch (mode) { case 0: - ret = beamforming_start_v1(p_dm_odm, RA, 0, BW, rate); + ret = beamforming_start_v1(dm, RA, 0, BW, rate); break; case 1: - ret = beamforming_start_v1(p_dm_odm, RA, 1, BW, rate); + ret = beamforming_start_v1(dm, RA, 1, BW, rate); break; case 2: - phydm_beamforming_ndpa_rate(p_dm_odm, BW, rate); - ret = beamforming_send_vht_ndpa_packet(p_dm_odm, RA, AID, BW, NORMAL_QUEUE); + phydm_beamforming_ndpa_rate(dm, BW, rate); + ret = beamforming_send_vht_ndpa_packet(dm, RA, AID, BW, NORMAL_QUEUE); break; case 3: - phydm_beamforming_ndpa_rate(p_dm_odm, BW, rate); - ret = beamforming_send_ht_ndpa_packet(p_dm_odm, RA, BW, NORMAL_QUEUE); + phydm_beamforming_ndpa_rate(dm, BW, rate); + ret = beamforming_send_ht_ndpa_packet(dm, RA, BW, NORMAL_QUEUE); break; } return ret; } /*Only OID uses this function*/ -bool +boolean phydm_beamforming_control_v2( - void *p_dm_void, - u8 idx, - u8 mode, - CHANNEL_WIDTH BW, - u16 period -) + void *dm_void, + u8 idx, + u8 mode, + enum channel_width BW, + u16 period) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm_odm->beamforming_info; - struct _RT_BEAMFORMING_OID_INFO *p_beam_oid_info = &(p_beam_info->beamforming_oid_info); + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; + struct _RT_BEAMFORMING_OID_INFO *beam_oid_info = &beam_info->beamforming_oid_info; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("idx (%d), mode (%d), BW (%d), period (%d)\n", idx, mode, BW, period)); + PHYDM_DBG(dm, DBG_TXBF, "%s Start!\n", __func__); + PHYDM_DBG(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; + beam_oid_info->sound_oid_idx = idx; + beam_oid_info->sound_oid_mode = (enum sounding_mode)mode; + beam_oid_info->sound_oid_bw = BW; + beam_oid_info->sound_oid_period = period; - phydm_beamforming_notify(p_dm_odm); + phydm_beamforming_notify(dm); return true; } - -void -phydm_beamforming_watchdog( - void *p_dm_void -) +void phydm_beamforming_watchdog( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm_odm->beamforming_info; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_TRACE, ("%s Start!\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "%s Start!\n", __func__); - if (p_beam_info->beamformee_su_cnt == 0) + if (beam_info->beamformee_su_cnt == 0) return; - beamforming_dym_period(p_dm_odm, 0); - phydm_beamforming_dym_ndpa_rate(p_dm_odm); - + beamforming_dym_period(dm, 0); } +enum beamforming_cap +phydm_get_beamform_cap( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct cmn_sta_info *sta = NULL; + struct bf_cmn_info *bf_info = NULL; + struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; + void *adapter = 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 = &(((PADAPTER)(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(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++) { + sta = dm->phydm_sta_info[macid]; + + if (!is_sta_active(sta)) + continue; + + bf_info = &sta->bf_info; + vht_curbeamformcap = bf_info->vht_beamform_cap; + ht_curbeamformcap = 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(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/rtl8188eu/hal/phydm/phydm_beamforming.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_beamforming.h index 043d4e3e1a60..98b81f44abae 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_beamforming.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_beamforming.h @@ -1,12 +1,33 @@ /* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + #ifndef __INC_PHYDM_BEAMFORMING_H #define __INC_PHYDM_BEAMFORMING_H -#ifndef BEAMFORMING_SUPPORT - #define BEAMFORMING_SUPPORT 0 -#endif - -/*Beamforming Related*/ +/*@Beamforming Related*/ #include "txbf/halcomtxbf.h" #include "txbf/haltxbfjaguar.h" #include "txbf/haltxbf8192e.h" @@ -14,34 +35,34 @@ #include "txbf/haltxbf8822b.h" #include "txbf/haltxbfinterface.h" -#if (BEAMFORMING_SUPPORT == 1) +#ifdef PHYDM_BEAMFORMING_SUPPORT #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]) +#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 +#define MAX_BEAMFORMEE_SU 2 +#define MAX_BEAMFORMER_SU 2 #if (RTL8822B_SUPPORT == 1) - #define MAX_BEAMFORMEE_MU 6 - #define MAX_BEAMFORMER_MU 1 +#define MAX_BEAMFORMEE_MU 6 +#define MAX_BEAMFORMER_MU 1 #else - #define MAX_BEAMFORMEE_MU 0 - #define MAX_BEAMFORMER_MU 0 +#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) +#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 +/*@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 { @@ -52,7 +73,6 @@ enum beamforming_entry_state { BEAMFORMING_ENTRY_STATE_PROGRESSED }; - enum beamforming_notify_state { BEAMFORMING_NOTIFY_NONE, BEAMFORMING_NOTIFY_ADD, @@ -68,15 +88,14 @@ 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_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, @@ -91,130 +110,131 @@ enum sounding_mode { }; struct _RT_BEAMFORM_STAINFO { - u8 *ra; - u16 aid; - u16 mac_id; - u8 my_mac_addr[6]; - WIRELESS_MODE wireless_mode; - CHANNEL_WIDTH bw; - enum beamforming_cap beamform_cap; - u8 ht_beamform_cap; - u16 vht_beamform_cap; - u8 cur_beamform; - u16 cur_beamform_vht; + 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 { - bool is_used; - bool is_txbf; - bool 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. */ - u16 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.*/ - CHANNEL_WIDTH sound_bw; /*Sounding band_width*/ - u16 sound_period; - enum beamforming_cap beamform_entry_cap; - enum beamforming_entry_state beamform_entry_state; - bool 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*/ - bool is_mu_sta; - u8 mu_reg_index; - u8 gid_valid[8]; - u8 user_position[16]; + 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 { - bool is_used; + 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. */ - u16 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*/ - bool is_mu_ap; - u8 gid_valid[8]; - u8 user_position[16]; - u16 aid; + 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; - CHANNEL_WIDTH sound_bw; - enum sounding_mode sound_mode; - u16 sound_period; + 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; - CHANNEL_WIDTH sound_oid_bw; - enum sounding_mode sound_oid_mode; - u16 sound_oid_period; + 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; - bool is_mu_sounding; - u8 first_mu_bfee_index; - bool is_mu_sounding_in_progress; - bool dbg_disable_mu_tx; - bool apply_v_matrix; - bool snding3ss; + 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 phydm_timer_list beamforming_timer; + struct phydm_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; + void *source_adapter; #endif - /* Control register */ - u32 reg_mu_tx_ctrl; /* For USB/SDIO interfaces aync I/O */ + /* @Control register */ + u32 reg_mu_tx_ctrl; /* @For USB/SDIO interfaces aync I/O */ + u8 tx_bf_data_rate; + u8 last_usb_hub; }; +void phydm_get_txbf_device_num( + void *dm_void, + u8 macid); struct _RT_NDPA_STA_INFO { - u16 aid:12; - u16 feedback_type:1; - u16 nc_index:3; + u16 aid : 12; + u16 feedback_type : 1; + u16 nc_index : 3; }; enum phydm_acting_type { @@ -222,154 +242,123 @@ enum phydm_acting_type { phydm_acting_as_ap = 1 }; - enum beamforming_cap phydm_beamforming_get_entry_beam_cap_by_mac_id( - void *p_dm_void, - u8 mac_id -); + void *dm_void, + u8 mac_id); struct _RT_BEAMFORMEE_ENTRY * phydm_beamforming_get_bfee_entry_by_addr( - void *p_dm_void, - u8 *RA, - u8 *idx -); + void *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 *dm_void, + u8 *TA, + u8 *idx); -void -phydm_beamforming_notify( - void *p_dm_void -); +void phydm_beamforming_notify( + void *dm_void); -bool +boolean phydm_acting_determine( - void *p_dm_void, - enum phydm_acting_type type -); + void *dm_void, + enum phydm_acting_type type); -void -beamforming_enter( - void *p_dm_void, - u16 sta_idx -); +void beamforming_enter(void *dm_void, u16 sta_idx, u8 *my_mac_addr); -void -beamforming_leave( - void *p_dm_void, - u8 *RA -); +void beamforming_leave( + void *dm_void, + u8 *RA); -bool +boolean beamforming_start_fw( - void *p_dm_void, - u8 idx -); + void *dm_void, + u8 idx); -void -beamforming_check_sounding_success( - void *p_dm_void, - bool status -); +void beamforming_check_sounding_success( + void *dm_void, + boolean status); -void -phydm_beamforming_end_sw( - void *p_dm_void, - bool status -); - -void -beamforming_timer_callback( - void *p_dm_void -); - -void -phydm_beamforming_init( - void *p_dm_void -); +void phydm_beamforming_end_sw( + void *dm_void, + boolean status); +void beamforming_timer_callback( + void *dm_void); +void phydm_beamforming_init( + void *dm_void); enum beamforming_cap phydm_beamforming_get_beam_cap( - void *p_dm_void, - struct _RT_BEAMFORMING_INFO *p_beam_info -); + void *dm_void, + struct _RT_BEAMFORMING_INFO *beam_info); +enum beamforming_cap +phydm_get_beamform_cap( + void *dm_void); -bool +boolean beamforming_control_v1( - void *p_dm_void, - u8 *RA, - u8 AID, - u8 mode, - CHANNEL_WIDTH BW, - u8 rate -); + void *dm_void, + u8 *RA, + u8 AID, + u8 mode, + enum channel_width BW, + u8 rate); - -bool +boolean phydm_beamforming_control_v2( - void *p_dm_void, - u8 idx, - u8 mode, - CHANNEL_WIDTH BW, - u16 period -); + void *dm_void, + u8 idx, + u8 mode, + enum channel_width BW, + u16 period); -void -phydm_beamforming_watchdog( - void *p_dm_void -); +void phydm_beamforming_watchdog( + void *dm_void); -void -beamforming_sw_timer_callback( +void beamforming_sw_timer_callback( #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct timer_list *p_timer + struct phydm_timer_list *timer #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) void *function_context #endif -); + ); -bool +boolean beamforming_send_ht_ndpa_packet( - void *p_dm_void, - u8 *RA, - CHANNEL_WIDTH BW, - u8 q_idx -); + void *dm_void, + u8 *RA, + enum channel_width BW, + u8 q_idx); - -bool +boolean beamforming_send_vht_ndpa_packet( - void *p_dm_void, - u8 *RA, - u16 AID, - CHANNEL_WIDTH BW, - u8 q_idx -); + void *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_odm, type) false -#define beamforming_enter(p_dm_odm, sta_idx) -#define beamforming_leave(p_dm_odm, RA) -#define beamforming_end_fw(p_dm_odm) -#define beamforming_control_v1(p_dm_odm, RA, AID, mode, BW, rate) true -#define beamforming_control_v2(p_dm_odm, idx, mode, BW, period) true -#define phydm_beamforming_end_sw(p_dm_odm, _status) -#define beamforming_timer_callback(p_dm_odm) -#define phydm_beamforming_init(p_dm_odm) -#define phydm_beamforming_control_v2(p_dm_odm, _idx, _mode, _BW, _period) false -#define beamforming_watchdog(p_dm_odm) -#define phydm_beamforming_watchdog(p_dm_odm) - - -#endif +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_AP)) +#define beamforming_gid_paid(adapter, tcb) +#define phydm_acting_determine(dm, type) false +#define beamforming_enter(dm, sta_idx, my_mac_addr) +#define beamforming_leave(dm, RA) +#define beamforming_end_fw(dm) +#define beamforming_control_v1(dm, RA, AID, mode, BW, rate) true +#define beamforming_control_v2(dm, idx, mode, BW, period) true +#define phydm_beamforming_end_sw(dm, _status) +#define beamforming_timer_callback(dm) +#define phydm_beamforming_init(dm) +#define phydm_beamforming_control_v2(dm, _idx, _mode, _BW, _period) false +#define beamforming_watchdog(dm) +#define phydm_beamforming_watchdog(dm) +#endif /*@(DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_AP))*/ +#endif /*@#ifdef PHYDM_BEAMFORMING_SUPPORT*/ #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_cck_pd.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_cck_pd.c new file mode 100644 index 000000000000..2d1f7472ac3d --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_cck_pd.c @@ -0,0 +1,1087 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +/*@************************************************************ + * include files + ************************************************************/ + +#include "mp_precomp.h" +#include "phydm_precomp.h" + +#ifdef PHYDM_SUPPORT_CCKPD +#ifdef PHYDM_COMPILE_CCKPD_TYPE1 +void phydm_write_cck_pd_type1(void *dm_void, u8 cca_th) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; + + PHYDM_DBG(dm, DBG_CCKPD, "[%s] cck_cca_th=((0x%x))\n", + __func__, cca_th); + + odm_write_1byte(dm, R_0xa0a, cca_th); + cckpd_t->cur_cck_cca_thres = cca_th; +} + +void phydm_set_cckpd_lv_type1(void *dm_void, enum cckpd_lv lv) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; + u8 pd_th = 0; + + PHYDM_DBG(dm, DBG_CCKPD, "%s ======>\n", __func__); + PHYDM_DBG(dm, DBG_CCKPD, "lv: (%d) -> (%d)\n", cckpd_t->cck_pd_lv, lv); + + if (cckpd_t->cck_pd_lv == lv) { + PHYDM_DBG(dm, DBG_CCKPD, "stay in lv=%d\n", lv); + return; + } + + cckpd_t->cck_pd_lv = lv; + cckpd_t->cck_fa_ma = CCK_FA_MA_RESET; + + if (lv == CCK_PD_LV_4) + pd_th = 0xed; + else if (lv == CCK_PD_LV_3) + pd_th = 0xdd; + else if (lv == CCK_PD_LV_2) + pd_th = 0xcd; + else if (lv == CCK_PD_LV_1) + pd_th = 0x83; + else if (lv == CCK_PD_LV_0) + pd_th = 0x40; + + phydm_write_cck_pd_type1(dm, pd_th); +} + +void phydm_cckpd_type1(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; + enum cckpd_lv lv = CCK_PD_LV_INIT; + boolean is_update = true; + + if (dm->is_linked) { + #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + if (dm->rssi_min > 60) { + lv = CCK_PD_LV_3; + } else if (dm->rssi_min > 35) { + lv = CCK_PD_LV_2; + } else if (dm->rssi_min > 20) { + if (cckpd_t->cck_fa_ma > 500) + lv = CCK_PD_LV_2; + else if (cckpd_t->cck_fa_ma < 250) + lv = CCK_PD_LV_1; + else + is_update = false; + } else { /*RSSI < 20*/ + lv = CCK_PD_LV_1; + } + #else /*ODM_AP*/ + if (dig_t->cur_ig_value > 0x32) + lv = CCK_PD_LV_4; + else if (dig_t->cur_ig_value > 0x2a) + lv = CCK_PD_LV_3; + else if (dig_t->cur_ig_value > 0x24) + lv = CCK_PD_LV_2; + else + lv = CCK_PD_LV_1; + #endif + } else { + if (cckpd_t->cck_fa_ma > 1000) + lv = CCK_PD_LV_1; + else if (cckpd_t->cck_fa_ma < 500) + lv = CCK_PD_LV_0; + else + is_update = false; + } + + /*[Abnormal case] =================================================*/ + #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + /*@HP 22B LPS power consumption issue & [PCIE-1596]*/ + if (dm->hp_hw_id && dm->traffic_load == TRAFFIC_ULTRA_LOW) { + lv = CCK_PD_LV_0; + PHYDM_DBG(dm, DBG_CCKPD, "CCKPD Abnormal case1\n"); + } else if ((dm->p_advance_ota & PHYDM_ASUS_OTA_SETTING) && + cckpd_t->cck_fa_ma > 200 && dm->rssi_min <= 20) { + lv = CCK_PD_LV_1; + cckpd_t->cck_pd_lv = lv; + phydm_write_cck_pd_type1(dm, 0xc3); /*@for ASUS OTA test*/ + is_update = false; + PHYDM_DBG(dm, DBG_CCKPD, "CCKPD Abnormal case2\n"); + } + #elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + #ifdef MCR_WIRELESS_EXTEND + lv = CCK_PD_LV_2; + cckpd_t->cck_pd_lv = lv; + phydm_write_cck_pd_type1(dm, 0x43); + is_update = false; + PHYDM_DBG(dm, DBG_CCKPD, "CCKPD Abnormal case3\n"); + #endif + #endif + /*=================================================================*/ + + if (is_update) + phydm_set_cckpd_lv_type1(dm, lv); + + PHYDM_DBG(dm, DBG_CCKPD, "is_linked=%d, lv=%d, pd_th=0x%x\n\n", + dm->is_linked, cckpd_t->cck_pd_lv, + cckpd_t->cur_cck_cca_thres); +} +#endif /*#ifdef PHYDM_COMPILE_CCKPD_TYPE1*/ + +#ifdef PHYDM_COMPILE_CCKPD_TYPE2 +void phydm_write_cck_pd_type2(void *dm_void, u8 cca_th, u8 cca_th_aaa) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; + + PHYDM_DBG(dm, DBG_CCKPD, "[%s] pd_th=0x%x, cs_ratio=0x%x\n", + __func__, cca_th, cca_th_aaa); + + odm_set_bb_reg(dm, R_0xa08, 0x3f0000, cca_th); + odm_set_bb_reg(dm, R_0xaa8, 0x1f0000, cca_th_aaa); + cckpd_t->cur_cck_cca_thres = cca_th; + cckpd_t->cck_cca_th_aaa = cca_th_aaa; +} + +void phydm_set_cckpd_lv_type2(void *dm_void, enum cckpd_lv lv) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; + u8 pd_th = 0, cs_ratio = 0, cs_2r_offset = 0; + u8 cck_n_rx = 1; + + PHYDM_DBG(dm, DBG_CCKPD, "%s ======>\n", __func__); + PHYDM_DBG(dm, DBG_CCKPD, "lv: (%d) -> (%d)\n", cckpd_t->cck_pd_lv, lv); + + /*@r_mrx & r_cca_mrc*/ + cck_n_rx = (odm_get_bb_reg(dm, R_0xa2c, BIT(18)) && + odm_get_bb_reg(dm, R_0xa2c, BIT(22))) ? 2 : 1; + + if (cckpd_t->cck_pd_lv == lv && cckpd_t->cck_n_rx == cck_n_rx) { + PHYDM_DBG(dm, DBG_CCKPD, "stay in lv=%d\n", lv); + return; + } + + cckpd_t->cck_n_rx = cck_n_rx; + cckpd_t->cck_pd_lv = lv; + cckpd_t->cck_fa_ma = CCK_FA_MA_RESET; + + if (lv == CCK_PD_LV_4) { + cs_ratio = cckpd_t->aaa_default + 8; + cs_2r_offset = 5; + pd_th = 0xd; + } else if (lv == CCK_PD_LV_3) { + cs_ratio = cckpd_t->aaa_default + 6; + cs_2r_offset = 4; + pd_th = 0xd; + } else if (lv == CCK_PD_LV_2) { + cs_ratio = cckpd_t->aaa_default + 4; + cs_2r_offset = 3; + pd_th = 0xd; + } else if (lv == CCK_PD_LV_1) { + cs_ratio = cckpd_t->aaa_default + 2; + cs_2r_offset = 1; + pd_th = 0x7; + } else if (lv == CCK_PD_LV_0) { + cs_ratio = cckpd_t->aaa_default; + cs_2r_offset = 0; + pd_th = 0x3; + } + + if (cckpd_t->cck_n_rx == 2) { + if (cs_ratio >= cs_2r_offset) + cs_ratio = cs_ratio - cs_2r_offset; + else + cs_ratio = 0; + } + phydm_write_cck_pd_type2(dm, pd_th, cs_ratio); +} + +void phydm_cckpd_type2(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; + enum cckpd_lv lv = CCK_PD_LV_INIT; + u8 igi = dig_t->cur_ig_value; + u8 rssi_min = dm->rssi_min; + boolean is_update = true; + + PHYDM_DBG(dm, DBG_CCKPD, "%s ======>\n", __func__); + + if (dm->is_linked) { + if (igi > 0x38 && rssi_min > 32) { + lv = CCK_PD_LV_4; + } else if (igi > 0x2a && rssi_min > 32) { + lv = CCK_PD_LV_3; + } else if (igi > 0x24 || (rssi_min > 24 && rssi_min <= 30)) { + lv = CCK_PD_LV_2; + } else if (igi <= 0x24 || rssi_min < 22) { + if (cckpd_t->cck_fa_ma > 1000) { + lv = CCK_PD_LV_1; + } else if (cckpd_t->cck_fa_ma < 500) { + lv = CCK_PD_LV_0; + } else { + is_update = false; + } + } else { + is_update = false; + } + } else { + if (cckpd_t->cck_fa_ma > 1000) { + lv = CCK_PD_LV_1; + } else if (cckpd_t->cck_fa_ma < 500) { + lv = CCK_PD_LV_0; + } else { + is_update = false; + } + } + + /*[Abnormal case] =================================================*/ + #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + /*@21C Miracast lag issue & [PCIE-3298]*/ + if (dm->support_ic_type & ODM_RTL8821C && rssi_min > 60) { + lv = CCK_PD_LV_4; + cckpd_t->cck_pd_lv = lv; + phydm_write_cck_pd_type2(dm, 0x1d, (cckpd_t->aaa_default + 8)); + is_update = false; + PHYDM_DBG(dm, DBG_CCKPD, "CCKPD Abnormal case1\n"); + } + #endif + /*=================================================================*/ + + if (is_update) { + phydm_set_cckpd_lv_type2(dm, lv); + } + + PHYDM_DBG(dm, DBG_CCKPD, + "is_linked=%d, lv=%d, n_rx=%d, cs_ratio=0x%x, pd_th=0x%x\n\n", + dm->is_linked, cckpd_t->cck_pd_lv, cckpd_t->cck_n_rx, + cckpd_t->cck_cca_th_aaa, cckpd_t->cur_cck_cca_thres); +} +#endif /*#ifdef PHYDM_COMPILE_CCKPD_TYPE2*/ + +#ifdef PHYDM_COMPILE_CCKPD_TYPE3 +void phydm_write_cck_pd_type3(void *dm_void, u8 pd_th, u8 cs_ratio, + enum cckpd_mode mode) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; + + PHYDM_DBG(dm, DBG_CCKPD, + "[%s] mode=%d, pd_th=0x%x, cs_ratio=0x%x\n", __func__, + mode, pd_th, cs_ratio); + + switch (mode) { + case CCK_BW20_1R: /*RFBW20_1R*/ + { + cckpd_t->cur_cck_pd_20m_1r = pd_th; + cckpd_t->cur_cck_cs_ratio_20m_1r = cs_ratio; + odm_set_bb_reg(dm, R_0xac8, 0xff, pd_th); + odm_set_bb_reg(dm, R_0xad0, 0x1f, cs_ratio); + } break; + case CCK_BW20_2R: /*RFBW20_2R*/ + { + cckpd_t->cur_cck_pd_20m_2r = pd_th; + cckpd_t->cur_cck_cs_ratio_20m_2r = cs_ratio; + odm_set_bb_reg(dm, R_0xac8, 0xff00, pd_th); + odm_set_bb_reg(dm, R_0xad0, 0x3e0, cs_ratio); + } break; + case CCK_BW40_1R: /*RFBW40_1R*/ + { + cckpd_t->cur_cck_pd_40m_1r = pd_th; + cckpd_t->cur_cck_cs_ratio_40m_1r = cs_ratio; + odm_set_bb_reg(dm, R_0xacc, 0xff, pd_th); + odm_set_bb_reg(dm, R_0xad0, 0x1f00000, cs_ratio); + } break; + case CCK_BW40_2R: /*RFBW40_2R*/ + { + cckpd_t->cur_cck_pd_40m_2r = pd_th; + cckpd_t->cur_cck_cs_ratio_40m_2r = cs_ratio; + odm_set_bb_reg(dm, R_0xacc, 0xff00, pd_th); + odm_set_bb_reg(dm, R_0xad0, 0x3e000000, cs_ratio); + } break; + + default: + /*@pr_debug("[%s] warning!\n", __func__);*/ + break; + } +} + +void phydm_set_cckpd_lv_type3(void *dm_void, enum cckpd_lv lv) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; + enum cckpd_mode cck_mode = CCK_BW20_2R; + enum channel_width cck_bw = CHANNEL_WIDTH_20; + u8 cck_n_rx = 1; + u8 pd_th; + u8 cs_ratio; + + PHYDM_DBG(dm, DBG_CCKPD, "%s ======>\n", __func__); + PHYDM_DBG(dm, DBG_CCKPD, "lv: (%d) -> (%d)\n", cckpd_t->cck_pd_lv, lv); + + /*[Check Nrx]*/ + cck_n_rx = (odm_get_bb_reg(dm, R_0xa2c, BIT(17))) ? 2 : 1; + + /*[Check BW]*/ + if (odm_get_bb_reg(dm, R_0x800, BIT(0))) + cck_bw = CHANNEL_WIDTH_40; + else + cck_bw = CHANNEL_WIDTH_20; + + /*[Check LV]*/ + if (cckpd_t->cck_pd_lv == lv && + cckpd_t->cck_n_rx == cck_n_rx && + cckpd_t->cck_bw == cck_bw) { + PHYDM_DBG(dm, DBG_CCKPD, "stay in lv=%d\n", lv); + return; + } + + cckpd_t->cck_bw = cck_bw; + cckpd_t->cck_n_rx = cck_n_rx; + cckpd_t->cck_pd_lv = lv; + cckpd_t->cck_fa_ma = CCK_FA_MA_RESET; + + if (cck_n_rx == 2) { + if (cck_bw == CHANNEL_WIDTH_20) { + pd_th = cckpd_t->cck_pd_20m_2r; + cs_ratio = cckpd_t->cck_cs_ratio_20m_2r; + cck_mode = CCK_BW20_2R; + } else { + pd_th = cckpd_t->cck_pd_40m_2r; + cs_ratio = cckpd_t->cck_cs_ratio_40m_2r; + cck_mode = CCK_BW40_2R; + } + } else { + if (cck_bw == CHANNEL_WIDTH_20) { + pd_th = cckpd_t->cck_pd_20m_1r; + cs_ratio = cckpd_t->cck_cs_ratio_20m_1r; + cck_mode = CCK_BW20_1R; + } else { + pd_th = cckpd_t->cck_pd_40m_1r; + cs_ratio = cckpd_t->cck_cs_ratio_40m_1r; + cck_mode = CCK_BW40_1R; + } + } + + if (lv == CCK_PD_LV_4) { + if (cck_n_rx == 2) { + pd_th += 4; + cs_ratio += 2; + } else { + pd_th += 4; + cs_ratio += 3; + } + } else if (lv == CCK_PD_LV_3) { + if (cck_n_rx == 2) { + pd_th += 3; + cs_ratio += 1; + } else { + pd_th += 3; + cs_ratio += 2; + } + } else if (lv == CCK_PD_LV_2) { + pd_th += 2; + cs_ratio += 1; + } else if (lv == CCK_PD_LV_1) { + pd_th += 1; + cs_ratio += 1; + } + #if 0 + else if (lv == CCK_PD_LV_0) { + pd_th += 0; + cs_ratio += 0; + } + #endif + + phydm_write_cck_pd_type3(dm, pd_th, cs_ratio, cck_mode); +} + +void phydm_cckpd_type3(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; + enum cckpd_lv lv = CCK_PD_LV_INIT; + u8 igi = dm->dm_dig_table.cur_ig_value; + boolean is_update = true; + u8 pd_th = 0; + u8 cs_ratio = 0; + + PHYDM_DBG(dm, DBG_CCKPD, "%s ======>\n", __func__); + + if (dm->is_linked) { + if (igi > 0x38 && dm->rssi_min > 32) { + lv = CCK_PD_LV_4; + } else if ((igi > 0x2a) && (dm->rssi_min > 32)) { + lv = CCK_PD_LV_3; + } else if ((igi > 0x24) || + (dm->rssi_min > 24 && dm->rssi_min <= 30)) { + lv = CCK_PD_LV_2; + } else if ((igi <= 0x24) || (dm->rssi_min < 22)) { + if (cckpd_t->cck_fa_ma > 1000) + lv = CCK_PD_LV_1; + else if (cckpd_t->cck_fa_ma < 500) + lv = CCK_PD_LV_0; + else + is_update = false; + } + } else { + if (cckpd_t->cck_fa_ma > 1000) + lv = CCK_PD_LV_1; + else if (cckpd_t->cck_fa_ma < 500) + lv = CCK_PD_LV_0; + else + is_update = false; + } + + if (is_update) + phydm_set_cckpd_lv_type3(dm, lv); + + if (cckpd_t->cck_n_rx == 2) { + if (cckpd_t->cck_bw == CHANNEL_WIDTH_20) { + pd_th = cckpd_t->cur_cck_pd_20m_2r; + cs_ratio = cckpd_t->cur_cck_cs_ratio_20m_2r; + } else { + pd_th = cckpd_t->cur_cck_pd_40m_2r; + cs_ratio = cckpd_t->cur_cck_cs_ratio_40m_2r; + } + } else { + if (cckpd_t->cck_bw == CHANNEL_WIDTH_20) { + pd_th = cckpd_t->cur_cck_pd_20m_1r; + cs_ratio = cckpd_t->cur_cck_cs_ratio_20m_1r; + } else { + pd_th = cckpd_t->cur_cck_pd_40m_1r; + cs_ratio = cckpd_t->cur_cck_cs_ratio_40m_1r; + } + } + PHYDM_DBG(dm, DBG_CCKPD, + "[%dR][%dM] is_linked=%d, lv=%d, cs_ratio=0x%x, pd_th=0x%x\n\n", + cckpd_t->cck_n_rx, 20 << cckpd_t->cck_bw, dm->is_linked, + cckpd_t->cck_pd_lv, cs_ratio, pd_th); +} + +void phydm_cck_pd_init_type3(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; + u32 reg_tmp = 0; + + /*Get Default value*/ + cckpd_t->cck_pd_20m_1r = (u8)odm_get_bb_reg(dm, R_0xac8, 0xff); + cckpd_t->cck_pd_20m_2r = (u8)odm_get_bb_reg(dm, R_0xac8, 0xff00); + cckpd_t->cck_pd_40m_1r = (u8)odm_get_bb_reg(dm, R_0xacc, 0xff); + cckpd_t->cck_pd_40m_2r = (u8)odm_get_bb_reg(dm, R_0xacc, 0xff00); + + reg_tmp = odm_get_bb_reg(dm, R_0xad0, MASKDWORD); + cckpd_t->cck_cs_ratio_20m_1r = (u8)(reg_tmp & 0x1f); + cckpd_t->cck_cs_ratio_20m_2r = (u8)((reg_tmp & 0x3e0) >> 5); + cckpd_t->cck_cs_ratio_40m_1r = (u8)((reg_tmp & 0x1f00000) >> 20); + cckpd_t->cck_cs_ratio_40m_2r = (u8)((reg_tmp & 0x3e000000) >> 25); + + phydm_set_cckpd_lv_type3(dm, CCK_PD_LV_0); +} +#endif /*#ifdef PHYDM_COMPILE_CCKPD_TYPE3*/ + +#ifdef PHYDM_COMPILE_CCKPD_TYPE4 +void phydm_write_cck_pd_type4(void *dm_void, enum cckpd_lv lv, + enum cckpd_mode mode) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; + u32 val = 0; + + PHYDM_DBG(dm, DBG_CCKPD, "write CCK CCA parameters(CS_ratio & PD)\n"); + switch (mode) { + case CCK_BW20_1R: /*RFBW20_1R*/ + { + val = cckpd_t->cck_pd_table_jgr3[0][0][0][lv]; + odm_set_bb_reg(dm, R_0x1ac8, 0xff, val); + val = cckpd_t->cck_pd_table_jgr3[0][0][1][lv]; + odm_set_bb_reg(dm, R_0x1ad0, 0x1f, val); + } break; + case CCK_BW40_1R: /*RFBW40_1R*/ + { + val = cckpd_t->cck_pd_table_jgr3[1][0][0][lv]; + odm_set_bb_reg(dm, R_0x1acc, 0xff, val); + val = cckpd_t->cck_pd_table_jgr3[1][0][1][lv]; + odm_set_bb_reg(dm, R_0x1ad0, 0x01F00000, val); + } break; + #if (defined(PHYDM_COMPILE_ABOVE_2SS)) + case CCK_BW20_2R: /*RFBW20_2R*/ + { + val = cckpd_t->cck_pd_table_jgr3[0][1][0][lv]; + odm_set_bb_reg(dm, R_0x1ac8, 0xff00, val); + val = cckpd_t->cck_pd_table_jgr3[0][1][1][lv]; + odm_set_bb_reg(dm, R_0x1ad0, 0x3e0, val); + } break; + case CCK_BW40_2R: /*RFBW40_2R*/ + { + val = cckpd_t->cck_pd_table_jgr3[1][1][0][lv]; + odm_set_bb_reg(dm, R_0x1acc, 0xff00, val); + val = cckpd_t->cck_pd_table_jgr3[1][1][1][lv]; + odm_set_bb_reg(dm, R_0x1ad0, 0x3E000000, val); + } break; + #endif + #if (defined(PHYDM_COMPILE_ABOVE_3SS)) + case CCK_BW20_3R: /*RFBW20_3R*/ + { + val = cckpd_t->cck_pd_table_jgr3[0][2][0][lv]; + odm_set_bb_reg(dm, R_0x1ac8, 0xff0000, val); + val = cckpd_t->cck_pd_table_jgr3[0][2][1][lv]; + odm_set_bb_reg(dm, R_0x1ad0, 0x7c00, val); + } break; + case CCK_BW40_3R: /*RFBW40_3R*/ + { + val = cckpd_t->cck_pd_table_jgr3[1][2][0][lv]; + odm_set_bb_reg(dm, R_0x1acc, 0xff0000, val); + val = cckpd_t->cck_pd_table_jgr3[1][2][1][lv] & 0x3; + odm_set_bb_reg(dm, R_0x1ad0, 0xC0000000, val); + val = (cckpd_t->cck_pd_table_jgr3[1][2][1][lv] & 0x1c) >> 2; + odm_set_bb_reg(dm, R_0x1ad4, 0x7, val); + } break; + #endif + #if (defined(PHYDM_COMPILE_ABOVE_4SS)) + case CCK_BW20_4R: /*RFBW20_4R*/ + { + val = cckpd_t->cck_pd_table_jgr3[0][3][0][lv]; + odm_set_bb_reg(dm, R_0x1ac8, 0xff000000, val); + val = cckpd_t->cck_pd_table_jgr3[0][3][1][lv]; + odm_set_bb_reg(dm, R_0x1ad0, 0xF8000, val); + } break; + case CCK_BW40_4R: /*RFBW40_4R*/ + { + val = cckpd_t->cck_pd_table_jgr3[1][3][0][lv]; + odm_set_bb_reg(dm, R_0x1acc, 0xff000000, val); + val = cckpd_t->cck_pd_table_jgr3[1][3][1][lv]; + odm_set_bb_reg(dm, R_0x1ad4, 0xf8, val); + } break; + #endif + default: + /*@pr_debug("[%s] warning!\n", __func__);*/ + break; + } +} + +void phydm_set_cck_pd_lv_type4(void *dm_void, enum cckpd_lv lv) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; + enum cckpd_mode cck_mode = CCK_BW20_2R; + enum channel_width cck_bw = CHANNEL_WIDTH_20; + u8 cck_n_rx = 0; + u32 val = 0; + /*u32 val_dbg = 0;*/ + + PHYDM_DBG(dm, DBG_CCKPD, "%s ======>\n", __func__); + PHYDM_DBG(dm, DBG_CCKPD, "lv: (%d) -> (%d)\n", cckpd_t->cck_pd_lv, lv); + + /*[Check Nrx]*/ + cck_n_rx = (u8)odm_get_bb_reg(dm, R_0x1a2c, 0x60000) + 1; + + /*[Check BW]*/ + val = odm_get_bb_reg(dm, R_0x9b0, 0xc); + if (val == 0) + cck_bw = CHANNEL_WIDTH_20; + else if (val == 1) + cck_bw = CHANNEL_WIDTH_40; + else + cck_bw = CHANNEL_WIDTH_80; + + /*[Check LV]*/ + if (cckpd_t->cck_pd_lv == lv && + cckpd_t->cck_n_rx == cck_n_rx && + cckpd_t->cck_bw == cck_bw) { + PHYDM_DBG(dm, DBG_CCKPD, "stay in lv=%d\n", lv); + return; + } + + cckpd_t->cck_bw = cck_bw; + cckpd_t->cck_n_rx = cck_n_rx; + cckpd_t->cck_pd_lv = lv; + cckpd_t->cck_fa_ma = CCK_FA_MA_RESET; + + switch (cck_n_rx) { + case 1: /*1R*/ + { + if (cck_bw == CHANNEL_WIDTH_20) + cck_mode = CCK_BW20_1R; + else if (cck_bw == CHANNEL_WIDTH_40) + cck_mode = CCK_BW40_1R; + } break; + #if (defined(PHYDM_COMPILE_ABOVE_2SS)) + case 2: /*2R*/ + { + if (cck_bw == CHANNEL_WIDTH_20) + cck_mode = CCK_BW20_2R; + else if (cck_bw == CHANNEL_WIDTH_40) + cck_mode = CCK_BW40_2R; + } break; + #endif + #if (defined(PHYDM_COMPILE_ABOVE_3SS)) + case 3: /*3R*/ + { + if (cck_bw == CHANNEL_WIDTH_20) + cck_mode = CCK_BW20_3R; + else if (cck_bw == CHANNEL_WIDTH_40) + cck_mode = CCK_BW40_3R; + } break; + #endif + #if (defined(PHYDM_COMPILE_ABOVE_4SS)) + case 4: /*4R*/ + { + if (cck_bw == CHANNEL_WIDTH_20) + cck_mode = CCK_BW20_4R; + else if (cck_bw == CHANNEL_WIDTH_40) + cck_mode = CCK_BW40_4R; + } break; + #endif + default: + /*@pr_debug("[%s] warning!\n", __func__);*/ + break; + } +phydm_write_cck_pd_type4(dm, lv, cck_mode); +} + +void phydm_read_cckpd_para_type4(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; + u8 bw = 0; /*r_RX_RF_BW*/ + u8 n_rx = 0; + u8 curr_cck_pd_t[2][4][2]; + u32 reg0 = 0; + u32 reg1 = 0; + u32 reg2 = 0; + u32 reg3 = 0; + + bw = (u8)odm_get_bb_reg(dm, R_0x9b0, 0xc); + n_rx = (u8)odm_get_bb_reg(dm, R_0x1a2c, 0x60000) + 1; + + reg0 = odm_get_bb_reg(dm, R_0x1ac8, MASKDWORD); + reg1 = odm_get_bb_reg(dm, R_0x1acc, MASKDWORD); + reg2 = odm_get_bb_reg(dm, R_0x1ad0, MASKDWORD); + reg3 = odm_get_bb_reg(dm, R_0x1ad4, MASKDWORD); + curr_cck_pd_t[0][0][0] = (u8)(reg0 & 0x000000ff); + curr_cck_pd_t[1][0][0] = (u8)(reg1 & 0x000000ff); + curr_cck_pd_t[0][0][1] = (u8)(reg2 & 0x0000001f); + curr_cck_pd_t[1][0][1] = (u8)((reg2 & 0x01f00000) >> 20); + #if (defined(PHYDM_COMPILE_ABOVE_2SS)) + if (dm->support_ic_type & PHYDM_IC_ABOVE_2SS) { + curr_cck_pd_t[0][1][0] = (u8)((reg0 & 0x0000ff00) >> 8); + curr_cck_pd_t[1][1][0] = (u8)((reg1 & 0x0000ff00) >> 8); + curr_cck_pd_t[0][1][1] = (u8)((reg2 & 0x000003E0) >> 5); + curr_cck_pd_t[1][1][1] = (u8)((reg2 & 0x3E000000) >> 25); + } + #endif + #if (defined(PHYDM_COMPILE_ABOVE_3SS)) + if (dm->support_ic_type & PHYDM_IC_ABOVE_3SS) { + curr_cck_pd_t[0][2][0] = (u8)((reg0 & 0x00ff0000) >> 16); + curr_cck_pd_t[1][2][0] = (u8)((reg1 & 0x00ff0000) >> 16); + curr_cck_pd_t[0][2][1] = (u8)((reg2 & 0x00007C00) >> 10); + curr_cck_pd_t[1][2][1] = (u8)((reg2 & 0xC0000000) >> 30) | + (u8)((reg3 & 0x00000007) << 3); + } + #endif + #if (defined(PHYDM_COMPILE_ABOVE_4SS)) + if (dm->support_ic_type & PHYDM_IC_ABOVE_4SS) { + curr_cck_pd_t[0][3][0] = (u8)((reg0 & 0xff000000) >> 24); + curr_cck_pd_t[1][3][0] = (u8)((reg1 & 0xff000000) >> 24); + curr_cck_pd_t[0][3][1] = (u8)((reg2 & 0x000F8000) >> 15); + curr_cck_pd_t[1][3][1] = (u8)((reg3 & 0x000000F8) >> 3); + } + #endif + + PHYDM_DBG(dm, DBG_CCKPD, "bw=%dM, Nrx=%d\n", 20 << bw, n_rx); + PHYDM_DBG(dm, DBG_CCKPD, "lv=%d, readback CS_th=0x%x, PD th=0x%x\n", + cckpd_t->cck_pd_lv, + curr_cck_pd_t[bw][n_rx - 1][1], + curr_cck_pd_t[bw][n_rx - 1][0]); +} + +void phydm_cckpd_type4(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; + u8 igi = dm->dm_dig_table.cur_ig_value; + enum cckpd_lv lv = 0; + boolean is_update = true; + + PHYDM_DBG(dm, DBG_CCKPD, "%s ======>\n", __func__); + + if (dm->is_linked) { + PHYDM_DBG(dm, DBG_CCKPD, "Linked!!!\n"); + if (igi > 0x38 && dm->rssi_min > 32) { + lv = CCK_PD_LV_4; + PHYDM_DBG(dm, DBG_CCKPD, "Order 1\n"); + } else if (igi > 0x2a && dm->rssi_min > 32) { + lv = CCK_PD_LV_3; + PHYDM_DBG(dm, DBG_CCKPD, "Order 2\n"); + } else if (igi > 0x24 || dm->rssi_min > 24) { + lv = CCK_PD_LV_2; + PHYDM_DBG(dm, DBG_CCKPD, "Order 3\n"); + } else { + if (cckpd_t->cck_fa_ma > 1000) { + lv = CCK_PD_LV_1; + PHYDM_DBG(dm, DBG_CCKPD, "Order 4-1\n"); + } else if (cckpd_t->cck_fa_ma < 500) { + lv = CCK_PD_LV_0; + PHYDM_DBG(dm, DBG_CCKPD, "Order 4-2\n"); + } else { + is_update = false; + PHYDM_DBG(dm, DBG_CCKPD, "Order 4-3\n"); + } + } + } else { + PHYDM_DBG(dm, DBG_CCKPD, "UnLinked!!!\n"); + if (cckpd_t->cck_fa_ma > 1000) { + lv = CCK_PD_LV_1; + PHYDM_DBG(dm, DBG_CCKPD, "Order 1\n"); + } else if (cckpd_t->cck_fa_ma < 500) { + lv = CCK_PD_LV_0; + PHYDM_DBG(dm, DBG_CCKPD, "Order 2\n"); + } else { + is_update = false; + PHYDM_DBG(dm, DBG_CCKPD, "Order 3\n"); + } + } + + if (is_update) { + phydm_set_cck_pd_lv_type4(dm, lv); + + PHYDM_DBG(dm, DBG_CCKPD, "setting CS_th = 0x%x, PD th = 0x%x\n", + cckpd_t->cck_pd_table_jgr3[cckpd_t->cck_bw] + [cckpd_t->cck_n_rx - 1][1][lv], + cckpd_t->cck_pd_table_jgr3[cckpd_t->cck_bw] + [cckpd_t->cck_n_rx - 1][0][lv]); + } + + phydm_read_cckpd_para_type4(dm); +} + +void phydm_cck_pd_init_type4(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; + u32 reg0 = 0; + u32 reg1 = 0; + u32 reg2 = 0; + u32 reg3 = 0; + u8 pd_step = 0; + u8 cck_bw = 0; /*r_RX_RF_BW*/ + u8 cck_n_rx = 0; + u8 val = 0; + u8 i = 0; + + PHYDM_DBG(dm, DBG_CCKPD, "[%s]======>\n", __func__); + + #if 0 + /*@ + *cckpd_t[0][0][0][0] = 1ac8[7:0] r_PD_lim_RFBW20_1R + *cckpd_t[0][1][0][0] = 1ac8[15:8] r_PD_lim_RFBW20_2R + *cckpd_t[0][2][0][0] = 1ac8[23:16] r_PD_lim_RFBW20_3R + *cckpd_t[0][3][0][0] = 1ac8[31:24] r_PD_lim_RFBW20_4R + *cckpd_t[1][0][0][0] = 1acc[7:0] r_PD_lim_RFBW40_1R + *cckpd_t[1][1][0][0] = 1acc[15:8] r_PD_lim_RFBW40_2R + *cckpd_t[1][2][0][0] = 1acc[23:16] r_PD_lim_RFBW40_3R + *cckpd_t[1][3][0][0] = 1acc[31:24] r_PD_lim_RFBW40_4R + * + * + *cckpd_t[0][0][1][0] = 1ad0[4:0] r_CS_ratio_RFBW20_1R[4:0] + *cckpd_t[0][1][1][0] = 1ad0[9:5] r_CS_ratio_RFBW20_2R[4:0] + *cckpd_t[0][2][1][0] = 1ad0[14:10] r_CS_ratio_RFBW20_3R[4:0] + *cckpd_t[0][3][1][0] = 1ad0[19:15] r_CS_ratio_RFBW20_4R[4:0] + *cckpd_t[1][0][1][0] = 1ad0[24:20] r_CS_ratio_RFBW40_1R[4:0] + *cckpd_t[1][1][1][0] = 1ad0[29:25] r_CS_ratio_RFBW40_2R[4:0] + *cckpd_t[1][2][1][0] = 1ad0[31:30] r_CS_ratio_RFBW40_3R[1:0] + * 1ad4[2:0] r_CS_ratio_RFBW40_3R[4:2] + *cckpd_t[1][3][1][0] = 1ad4[7:3] r_CS_ratio_RFBW40_4R[4:0] + */ + #endif + /*[Check Nrx]*/ + cck_n_rx = (u8)odm_get_bb_reg(dm, R_0x1a2c, 0x60000) + 1; + + /*[Check BW]*/ + val = (u8)odm_get_bb_reg(dm, R_0x9b0, 0xc); + if (val == 0) + cck_bw = CHANNEL_WIDTH_20; + else if (val == 1) + cck_bw = CHANNEL_WIDTH_40; + else + cck_bw = CHANNEL_WIDTH_80; + + cckpd_t->cck_bw = cck_bw; + cckpd_t->cck_n_rx = cck_n_rx; + reg0 = odm_get_bb_reg(dm, R_0x1ac8, MASKDWORD); + reg1 = odm_get_bb_reg(dm, R_0x1acc, MASKDWORD); + reg2 = odm_get_bb_reg(dm, R_0x1ad0, MASKDWORD); + reg3 = odm_get_bb_reg(dm, R_0x1ad4, MASKDWORD); + + for (i = 0 ; i < CCK_PD_LV_MAX ; i++) { + pd_step = i * 2; + + val = (u8)(reg0 & 0x000000ff) + pd_step; + PHYDM_DBG(dm, DBG_CCKPD, "lvl %d val = %x\n\n", i, val); + cckpd_t->cck_pd_table_jgr3[0][0][0][i] = val; + + val = (u8)(reg1 & 0x000000ff) + pd_step; + cckpd_t->cck_pd_table_jgr3[1][0][0][i] = val; + + val = (u8)(reg2 & 0x0000001F) + pd_step; + cckpd_t->cck_pd_table_jgr3[0][0][1][i] = val; + + val = (u8)((reg2 & 0x01F00000) >> 20) + pd_step; + cckpd_t->cck_pd_table_jgr3[1][0][1][i] = val; + + #ifdef PHYDM_COMPILE_ABOVE_2SS + if (dm->support_ic_type & PHYDM_IC_ABOVE_2SS) { + val = (u8)((reg0 & 0x0000ff00) >> 8) + pd_step; + cckpd_t->cck_pd_table_jgr3[0][1][0][i] = val; + + val = (u8)((reg1 & 0x0000ff00) >> 8) + pd_step; + cckpd_t->cck_pd_table_jgr3[1][1][0][i] = val; + + val = (u8)((reg2 & 0x000003E0) >> 5) + pd_step; + cckpd_t->cck_pd_table_jgr3[0][1][1][i] = val; + + val = (u8)((reg2 & 0x3E000000) >> 25) + pd_step; + cckpd_t->cck_pd_table_jgr3[1][1][1][i] = val; + } + #endif + + #ifdef PHYDM_COMPILE_ABOVE_3SS + if (dm->support_ic_type & PHYDM_IC_ABOVE_3SS) { + val = (u8)((reg0 & 0x00ff0000) >> 16) + pd_step; + cckpd_t->cck_pd_table_jgr3[0][2][0][i] = val; + + val = (u8)((reg1 & 0x00ff0000) >> 16) + pd_step; + cckpd_t->cck_pd_table_jgr3[1][2][0][i] = val; + val = (u8)((reg2 & 0x00007C00) >> 10) + pd_step; + cckpd_t->cck_pd_table_jgr3[0][2][1][i] = val; + val = (u8)(((reg2 & 0xC0000000) >> 30) | + ((reg3 & 0x7) << 3)) + pd_step; + cckpd_t->cck_pd_table_jgr3[1][2][1][i] = val; + } + #endif + + #ifdef PHYDM_COMPILE_ABOVE_4SS + if (dm->support_ic_type & PHYDM_IC_ABOVE_4SS) { + val = (u8)((reg0 & 0xff000000) >> 24) + pd_step; + cckpd_t->cck_pd_table_jgr3[0][3][0][i] = val; + + val = (u8)((reg1 & 0xff000000) >> 24) + pd_step; + cckpd_t->cck_pd_table_jgr3[1][3][0][i] = val; + + val = (u8)((reg2 & 0x000F8000) >> 15) + pd_step; + cckpd_t->cck_pd_table_jgr3[0][3][1][i] = val; + + val = (u8)((reg3 & 0x000000F8) >> 3) + pd_step; + cckpd_t->cck_pd_table_jgr3[1][3][1][i] = val; + } + #endif + } +} +#endif /*#ifdef PHYDM_COMPILE_CCKPD_TYPE4*/ + +void phydm_set_cckpd_val(void *dm_void, u32 *val_buf, u8 val_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; + enum cckpd_lv lv; + + if (val_len != 1) { + PHYDM_DBG(dm, ODM_COMP_API, "[Error][CCKPD]Need val_len=1\n"); + return; + } + + lv = (enum cckpd_lv)val_buf[0]; + + if (lv > CCK_PD_LV_4) { + pr_debug("[%s] warning! lv=%d\n", __func__, lv); + return; + } + + switch (cckpd_t->cckpd_hw_type) { + #ifdef PHYDM_COMPILE_CCKPD_TYPE1 + case 1: + phydm_set_cckpd_lv_type1(dm, lv); + break; + #endif + #ifdef PHYDM_COMPILE_CCKPD_TYPE2 + case 2: + phydm_set_cckpd_lv_type2(dm, lv); + break; + #endif + #ifdef PHYDM_COMPILE_CCKPD_TYPE3 + case 3: + phydm_set_cckpd_lv_type3(dm, lv); + break; + #endif + #ifdef PHYDM_COMPILE_CCKPD_TYPE4 + case 4: + phydm_set_cck_pd_lv_type4(dm, lv); + break; + #endif + default: + pr_debug("[%s]warning\n", __func__); + break; + } +} + +boolean +phydm_stop_cck_pd_th(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (!(dm->support_ability & (ODM_BB_CCK_PD | ODM_BB_FA_CNT))) { + PHYDM_DBG(dm, DBG_CCKPD, "Not Support\n"); + return true; + } + + if (dm->pause_ability & ODM_BB_CCK_PD) { + PHYDM_DBG(dm, DBG_CCKPD, "Return: Pause CCKPD in LV=%d\n", + dm->pause_lv_table.lv_cckpd); + return true; + } + + if (dm->is_linked && (*dm->channel > 36)) { + PHYDM_DBG(dm, DBG_CCKPD, "Return: 5G CH=%d\n", *dm->channel); + return true; + } + return false; +} + +void phydm_cck_pd_th(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fa_struct *fa_t = &dm->false_alm_cnt; + struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; + u32 cck_fa = fa_t->cnt_cck_fail; + #ifdef PHYDM_TDMA_DIG_SUPPORT + struct phydm_fa_acc_struct *fa_acc_t = &dm->false_alm_cnt_acc; + #endif + + PHYDM_DBG(dm, DBG_CCKPD, "[%s] ======>\n", __func__); + + if (phydm_stop_cck_pd_th(dm)) + return; + + #ifdef PHYDM_TDMA_DIG_SUPPORT + if (dm->original_dig_restore) + cck_fa = fa_t->cnt_cck_fail; + else + cck_fa = fa_acc_t->cnt_cck_fail_1sec; + #endif + + if (cckpd_t->cck_fa_ma == CCK_FA_MA_RESET) + cckpd_t->cck_fa_ma = cck_fa; + else + cckpd_t->cck_fa_ma = (cckpd_t->cck_fa_ma * 3 + cck_fa) >> 2; + + PHYDM_DBG(dm, DBG_CCKPD, + "IGI=0x%x, rssi_min=%d, cck_fa=%d, cck_fa_ma=%d\n", + dm->dm_dig_table.cur_ig_value, dm->rssi_min, + cck_fa, cckpd_t->cck_fa_ma); + + switch (cckpd_t->cckpd_hw_type) { + #ifdef PHYDM_COMPILE_CCKPD_TYPE1 + case 1: + phydm_cckpd_type1(dm); + break; + #endif + #ifdef PHYDM_COMPILE_CCKPD_TYPE2 + case 2: + phydm_cckpd_type2(dm); + break; + #endif + #ifdef PHYDM_COMPILE_CCKPD_TYPE3 + case 3: + phydm_cckpd_type3(dm); + break; + #endif + #ifdef PHYDM_COMPILE_CCKPD_TYPE4 + case 4: + phydm_cckpd_type4(dm); + break; + #endif + default: + pr_debug("[%s]warning\n", __func__); + break; + } +} + +void phydm_cck_pd_init(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_cckpd_struct *cckpd_t = &dm->dm_cckpd_table; + + if (dm->support_ic_type & CCK_PD_IC_TYPE1) + cckpd_t->cckpd_hw_type = 1; + else if (dm->support_ic_type & CCK_PD_IC_TYPE2) + cckpd_t->cckpd_hw_type = 2; + else if (dm->support_ic_type & CCK_PD_IC_TYPE3) + cckpd_t->cckpd_hw_type = 3; + else if (dm->support_ic_type & CCK_PD_IC_TYPE4) + cckpd_t->cckpd_hw_type = 4; + + PHYDM_DBG(dm, DBG_CCKPD, "[%s] cckpd_hw_type=%d\n", + __func__, cckpd_t->cckpd_hw_type); + + cckpd_t->cck_pd_lv = CCK_PD_LV_INIT; + cckpd_t->cck_n_rx = 0xff; + cckpd_t->cck_bw = CHANNEL_WIDTH_MAX; + + switch (cckpd_t->cckpd_hw_type) { + #ifdef PHYDM_COMPILE_CCKPD_TYPE1 + case 1: + phydm_set_cckpd_lv_type1(dm, CCK_PD_LV_0); + break; + #endif + #ifdef PHYDM_COMPILE_CCKPD_TYPE2 + case 2: + cckpd_t->aaa_default = odm_read_1byte(dm, 0xaaa) & 0x1f; + phydm_set_cckpd_lv_type2(dm, CCK_PD_LV_0); + break; + #endif + #ifdef PHYDM_COMPILE_CCKPD_TYPE3 + case 3: + phydm_cck_pd_init_type3(dm); + break; + #endif + #ifdef PHYDM_COMPILE_CCKPD_TYPE4 + case 4: + phydm_cck_pd_init_type4(dm); + break; + #endif + default: + pr_debug("[%s]warning\n", __func__); + break; + } +} +#endif /*#ifdef PHYDM_SUPPORT_CCKPD*/ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_cck_pd.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_cck_pd.h new file mode 100644 index 000000000000..845383d64a44 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_cck_pd.h @@ -0,0 +1,156 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +#ifndef __PHYDM_CCK_PD_H__ +#define __PHYDM_CCK_PD_H__ + +#define CCK_PD_VERSION "3.1" + +/*@ + * 1 ============================================================ + * 1 Definition + * 1 ============================================================ + */ +#define CCK_FA_MA_RESET 0xffffffff + +/*@Run time flag of CCK_PD HW type*/ +#define CCK_PD_IC_TYPE1 (ODM_RTL8188E | ODM_RTL8812 | ODM_RTL8821 |\ + ODM_RTL8192E | ODM_RTL8723B | ODM_RTL8814A |\ + ODM_RTL8881A | ODM_RTL8822B | ODM_RTL8703B |\ + ODM_RTL8195A | ODM_RTL8188F) + +#define CCK_PD_IC_TYPE2 (ODM_RTL8197F | ODM_RTL8821C | ODM_RTL8723D |\ + ODM_RTL8710B | ODM_RTL8195B) /*extend 0xaaa*/ + +#define CCK_PD_IC_TYPE3 (ODM_RTL8192F | ODM_RTL8721D) +/*@extend for different bw & path*/ + +#define CCK_PD_IC_TYPE4 ODM_IC_JGR3_SERIES /*@extend for different bw & path*/ + +/*@Compile time flag of CCK_PD HW type*/ +#if (RTL8188E_SUPPORT || RTL8812A_SUPPORT || RTL8821A_SUPPORT ||\ + RTL8192E_SUPPORT || RTL8723B_SUPPORT || RTL8814A_SUPPORT ||\ + RTL8881A_SUPPORT || RTL8822B_SUPPORT || RTL8703B_SUPPORT ||\ + RTL8195A_SUPPORT || RTL8188F_SUPPORT) + #define PHYDM_COMPILE_CCKPD_TYPE1 /*@only 0xa0a*/ +#endif + +#if (RTL8197F_SUPPORT || RTL8821C_SUPPORT || RTL8723D_SUPPORT ||\ + RTL8710B_SUPPORT || RTL8195B_SUPPORT) + #define PHYDM_COMPILE_CCKPD_TYPE2 /*@extend 0xaaa*/ +#endif + +#if (RTL8192F_SUPPORT || RTL8721D_SUPPORT) + #define PHYDM_COMPILE_CCKPD_TYPE3 /*@extend for different & path*/ +#endif + +#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + #define PHYDM_COMPILE_CCKPD_TYPE4 /*@extend for different bw & path*/ +#endif +/*@ + * 1 ============================================================ + * 1 enumeration + * 1 ============================================================ + */ +enum cckpd_lv { + CCK_PD_LV_INIT = 0xff, + CCK_PD_LV_0 = 0, + CCK_PD_LV_1 = 1, + CCK_PD_LV_2 = 2, + CCK_PD_LV_3 = 3, + CCK_PD_LV_4 = 4, + CCK_PD_LV_MAX = 5 +}; + +enum cckpd_mode { + CCK_BW20_1R = 0, + CCK_BW20_2R = 1, + CCK_BW20_3R = 2, + CCK_BW20_4R = 3, + CCK_BW40_1R = 4, + CCK_BW40_2R = 5, + CCK_BW40_3R = 6, + CCK_BW40_4R = 7 +}; + +/*@ + * 1 ============================================================ + * 1 structure + * 1 ============================================================ + */ + +#ifdef PHYDM_SUPPORT_CCKPD +struct phydm_cckpd_struct { + u8 cckpd_hw_type; + u8 cur_cck_cca_thres; /*@current cck_pd value 0xa0a*/ + u32 cck_fa_ma; + u8 rvrt_val; + u8 pause_lv; + u8 cck_n_rx; + enum channel_width cck_bw; + enum cckpd_lv cck_pd_lv; + #ifdef PHYDM_COMPILE_CCKPD_TYPE2 + u8 cck_cca_th_aaa; /*@current cs_ratio value 0xaaa*/ + u8 aaa_default; /*@Init cs_ratio value - 0xaaa*/ + #endif + #ifdef PHYDM_COMPILE_CCKPD_TYPE3 + /*Default value*/ + u8 cck_pd_20m_1r; + u8 cck_pd_20m_2r; + u8 cck_pd_40m_1r; + u8 cck_pd_40m_2r; + u8 cck_cs_ratio_20m_1r; + u8 cck_cs_ratio_20m_2r; + u8 cck_cs_ratio_40m_1r; + u8 cck_cs_ratio_40m_2r; + /*Current value*/ + u8 cur_cck_pd_20m_1r; + u8 cur_cck_pd_20m_2r; + u8 cur_cck_pd_40m_1r; + u8 cur_cck_pd_40m_2r; + u8 cur_cck_cs_ratio_20m_1r; + u8 cur_cck_cs_ratio_20m_2r; + u8 cur_cck_cs_ratio_40m_1r; + u8 cur_cck_cs_ratio_40m_2r; + #endif + #ifdef PHYDM_COMPILE_CCKPD_TYPE4 + /*@[bw][nrx][0:PD/1:CS][lv]*/ + u8 cck_pd_table_jgr3[2][4][2][CCK_PD_LV_MAX]; + #endif +}; +#endif + +/*@ + * 1 ============================================================ + * 1 function prototype + * 1 ============================================================ + */ +void phydm_set_cckpd_val(void *dm_void, u32 *val_buf, u8 val_len); + +void phydm_cck_pd_th(void *dm_void); + +void phydm_cck_pd_init(void *dm_void); +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_ccx.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_ccx.c index efa67bbcbcd8..ae3fbce8ed82 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_ccx.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_ccx.c @@ -1,393 +1,2192 @@ /* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + #include "mp_precomp.h" #include "phydm_precomp.h" -/*Set NHM period, threshold, disable ignore cca or not, disable ignore txon or not*/ -void -phydm_nhm_setting( - void *p_dm_void, - u8 nhm_setting -) +void phydm_ccx_hw_restart(void *dm_void) + /*@Will Restart NHM/CLM/FAHM simultaneously*/ { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _CCX_INFO *ccx_info = &p_dm_odm->dm_ccx_info; - - if (p_dm_odm->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, ODM_REG_NHM_TH9_TH10_11AC, BIT(9), ccx_info->nhm_inexclude_cca); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH9_TH10_11AC, BIT(10), ccx_info->nhm_inexclude_txon); - - /*Set NHM period*/ - odm_set_bb_reg(p_dm_odm, ODM_REG_CCX_PERIOD_11AC, MASKHWORD, ccx_info->NHM_period); - - /*Set NHM threshold*/ - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH3_TO_TH0_11AC, MASKBYTE0, ccx_info->NHM_th[0]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH3_TO_TH0_11AC, MASKBYTE1, ccx_info->NHM_th[1]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH3_TO_TH0_11AC, MASKBYTE2, ccx_info->NHM_th[2]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH3_TO_TH0_11AC, MASKBYTE3, ccx_info->NHM_th[3]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH7_TO_TH4_11AC, MASKBYTE0, ccx_info->NHM_th[4]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH7_TO_TH4_11AC, MASKBYTE1, ccx_info->NHM_th[5]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH7_TO_TH4_11AC, MASKBYTE2, ccx_info->NHM_th[6]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH7_TO_TH4_11AC, MASKBYTE3, ccx_info->NHM_th[7]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH8_11AC, MASKBYTE0, ccx_info->NHM_th[8]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH9_TH10_11AC, MASKBYTE2, ccx_info->NHM_th[9]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH9_TH10_11AC, MASKBYTE3, ccx_info->NHM_th[10]); - - /*CCX EN*/ - odm_set_bb_reg(p_dm_odm, 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, 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, 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, ODM_REG_CCX_PERIOD_11AC, MASKHWORD); - - /*Store NHM threshold*/ - ccx_info->NHM_th_restore[0] = (u8)odm_get_bb_reg(p_dm_odm, ODM_REG_NHM_TH3_TO_TH0_11AC, MASKBYTE0); - ccx_info->NHM_th_restore[1] = (u8)odm_get_bb_reg(p_dm_odm, ODM_REG_NHM_TH3_TO_TH0_11AC, MASKBYTE1); - ccx_info->NHM_th_restore[2] = (u8)odm_get_bb_reg(p_dm_odm, ODM_REG_NHM_TH3_TO_TH0_11AC, MASKBYTE2); - ccx_info->NHM_th_restore[3] = (u8)odm_get_bb_reg(p_dm_odm, ODM_REG_NHM_TH3_TO_TH0_11AC, MASKBYTE3); - ccx_info->NHM_th_restore[4] = (u8)odm_get_bb_reg(p_dm_odm, ODM_REG_NHM_TH7_TO_TH4_11AC, MASKBYTE0); - ccx_info->NHM_th_restore[5] = (u8)odm_get_bb_reg(p_dm_odm, ODM_REG_NHM_TH7_TO_TH4_11AC, MASKBYTE1); - ccx_info->NHM_th_restore[6] = (u8)odm_get_bb_reg(p_dm_odm, ODM_REG_NHM_TH7_TO_TH4_11AC, MASKBYTE2); - ccx_info->NHM_th_restore[7] = (u8)odm_get_bb_reg(p_dm_odm, ODM_REG_NHM_TH7_TO_TH4_11AC, MASKBYTE3); - ccx_info->NHM_th_restore[8] = (u8)odm_get_bb_reg(p_dm_odm, ODM_REG_NHM_TH8_11AC, MASKBYTE0); - ccx_info->NHM_th_restore[9] = (u8)odm_get_bb_reg(p_dm_odm, ODM_REG_NHM_TH9_TH10_11AC, MASKBYTE2); - ccx_info->NHM_th_restore[10] = (u8)odm_get_bb_reg(p_dm_odm, 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, ODM_REG_NHM_TH9_TH10_11AC, BIT(9), ccx_info->NHM_inexclude_cca_restore); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH9_TH10_11AC, BIT(10), ccx_info->NHM_inexclude_txon_restore); - - /*Set NHM period*/ - odm_set_bb_reg(p_dm_odm, ODM_REG_CCX_PERIOD_11AC, MASKHWORD, ccx_info->NHM_period); - - /*Set NHM threshold*/ - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH3_TO_TH0_11AC, MASKBYTE0, ccx_info->NHM_th_restore[0]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH3_TO_TH0_11AC, MASKBYTE1, ccx_info->NHM_th_restore[1]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH3_TO_TH0_11AC, MASKBYTE2, ccx_info->NHM_th_restore[2]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH3_TO_TH0_11AC, MASKBYTE3, ccx_info->NHM_th_restore[3]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH7_TO_TH4_11AC, MASKBYTE0, ccx_info->NHM_th_restore[4]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH7_TO_TH4_11AC, MASKBYTE1, ccx_info->NHM_th_restore[5]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH7_TO_TH4_11AC, MASKBYTE2, ccx_info->NHM_th_restore[6]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH7_TO_TH4_11AC, MASKBYTE3, ccx_info->NHM_th_restore[7]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH8_11AC, MASKBYTE0, ccx_info->NHM_th_restore[8]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH9_TH10_11AC, MASKBYTE2, ccx_info->NHM_th_restore[9]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH9_TH10_11AC, MASKBYTE3, ccx_info->NHM_th_restore[10]); - } else - return; - } - - else if (p_dm_odm->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, ODM_REG_NHM_TH9_TH10_11N, BIT(9), ccx_info->nhm_inexclude_cca); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH9_TH10_11N, BIT(10), ccx_info->nhm_inexclude_txon); - - /*Set NHM period*/ - odm_set_bb_reg(p_dm_odm, ODM_REG_CCX_PERIOD_11N, MASKHWORD, ccx_info->NHM_period); - - /*Set NHM threshold*/ - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH3_TO_TH0_11N, MASKBYTE0, ccx_info->NHM_th[0]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH3_TO_TH0_11N, MASKBYTE1, ccx_info->NHM_th[1]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH3_TO_TH0_11N, MASKBYTE2, ccx_info->NHM_th[2]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH3_TO_TH0_11N, MASKBYTE3, ccx_info->NHM_th[3]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH7_TO_TH4_11N, MASKBYTE0, ccx_info->NHM_th[4]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH7_TO_TH4_11N, MASKBYTE1, ccx_info->NHM_th[5]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH7_TO_TH4_11N, MASKBYTE2, ccx_info->NHM_th[6]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH7_TO_TH4_11N, MASKBYTE3, ccx_info->NHM_th[7]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH8_11N, MASKBYTE0, ccx_info->NHM_th[8]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH9_TH10_11N, MASKBYTE2, ccx_info->NHM_th[9]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH9_TH10_11N, MASKBYTE3, ccx_info->NHM_th[10]); - - /*CCX EN*/ - odm_set_bb_reg(p_dm_odm, 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, 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, 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, ODM_REG_CCX_PERIOD_11N, MASKHWORD); - - /*Store NHM threshold*/ - ccx_info->NHM_th_restore[0] = (u8)odm_get_bb_reg(p_dm_odm, ODM_REG_NHM_TH3_TO_TH0_11N, MASKBYTE0); - ccx_info->NHM_th_restore[1] = (u8)odm_get_bb_reg(p_dm_odm, ODM_REG_NHM_TH3_TO_TH0_11N, MASKBYTE1); - ccx_info->NHM_th_restore[2] = (u8)odm_get_bb_reg(p_dm_odm, ODM_REG_NHM_TH3_TO_TH0_11N, MASKBYTE2); - ccx_info->NHM_th_restore[3] = (u8)odm_get_bb_reg(p_dm_odm, ODM_REG_NHM_TH3_TO_TH0_11N, MASKBYTE3); - ccx_info->NHM_th_restore[4] = (u8)odm_get_bb_reg(p_dm_odm, ODM_REG_NHM_TH7_TO_TH4_11N, MASKBYTE0); - ccx_info->NHM_th_restore[5] = (u8)odm_get_bb_reg(p_dm_odm, ODM_REG_NHM_TH7_TO_TH4_11N, MASKBYTE1); - ccx_info->NHM_th_restore[6] = (u8)odm_get_bb_reg(p_dm_odm, ODM_REG_NHM_TH7_TO_TH4_11N, MASKBYTE2); - ccx_info->NHM_th_restore[7] = (u8)odm_get_bb_reg(p_dm_odm, ODM_REG_NHM_TH7_TO_TH4_11N, MASKBYTE3); - ccx_info->NHM_th_restore[8] = (u8)odm_get_bb_reg(p_dm_odm, ODM_REG_NHM_TH8_11N, MASKBYTE0); - ccx_info->NHM_th_restore[9] = (u8)odm_get_bb_reg(p_dm_odm, ODM_REG_NHM_TH9_TH10_11N, MASKBYTE2); - ccx_info->NHM_th_restore[10] = (u8)odm_get_bb_reg(p_dm_odm, 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, ODM_REG_NHM_TH9_TH10_11N, BIT(9), ccx_info->NHM_inexclude_cca_restore); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH9_TH10_11N, BIT(10), ccx_info->NHM_inexclude_txon_restore); - - /*Set NHM period*/ - odm_set_bb_reg(p_dm_odm, ODM_REG_CCX_PERIOD_11N, MASKHWORD, ccx_info->NHM_period_restore); - - /*Set NHM threshold*/ - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH3_TO_TH0_11N, MASKBYTE0, ccx_info->NHM_th_restore[0]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH3_TO_TH0_11N, MASKBYTE1, ccx_info->NHM_th_restore[1]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH3_TO_TH0_11N, MASKBYTE2, ccx_info->NHM_th_restore[2]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH3_TO_TH0_11N, MASKBYTE3, ccx_info->NHM_th_restore[3]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH7_TO_TH4_11N, MASKBYTE0, ccx_info->NHM_th_restore[4]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH7_TO_TH4_11N, MASKBYTE1, ccx_info->NHM_th_restore[5]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH7_TO_TH4_11N, MASKBYTE2, ccx_info->NHM_th_restore[6]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH7_TO_TH4_11N, MASKBYTE3, ccx_info->NHM_th_restore[7]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH8_11N, MASKBYTE0, ccx_info->NHM_th_restore[8]); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH9_TH10_11N, MASKBYTE2, ccx_info->NHM_th_restore[9]); - odm_set_bb_reg(p_dm_odm, 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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _CCX_INFO *ccx_info = &p_dm_odm->dm_ccx_info; - - if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) { - - /*Trigger NHM*/ - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH9_TH10_11AC, BIT(1), 0); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH9_TH10_11AC, BIT(1), 1); - } else if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) { - - /*Trigger NHM*/ - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH9_TH10_11N, BIT(1), 0); - odm_set_bb_reg(p_dm_odm, ODM_REG_NHM_TH9_TH10_11N, BIT(1), 1); - } -} - -void -phydm_get_nhm_result( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u32 value32; - struct _CCX_INFO *ccx_info = &p_dm_odm->dm_ccx_info; - - if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) { - - value32 = odm_read_4byte(p_dm_odm, 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, 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, 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, ODM_REG_NHM_DUR_READY_11AC); - ccx_info->NHM_duration = (u16)(value32 & MASKLWORD); - - } - - else if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) { - - value32 = odm_read_4byte(p_dm_odm, 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, 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, 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, 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, ODM_REG_NHM_CNT10_TO_CNT11_11N); - ccx_info->NHM_duration = (u16)(value32 & MASKLWORD); - - } - -} - -bool -phydm_check_nhm_ready( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u32 value32 = 0; - u8 i; - bool ret = false; - - if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) { - - value32 = odm_get_bb_reg(p_dm_odm, ODM_REG_CLM_RESULT_11AC, MASKDWORD); - - for (i = 0; i < 200; i++) { - - ODM_delay_ms(1); - if (odm_get_bb_reg(p_dm_odm, ODM_REG_NHM_DUR_READY_11AC, BIT(17))) { - ret = 1; - break; - } - } - } - - else if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) { - - value32 = odm_get_bb_reg(p_dm_odm, ODM_REG_CLM_READY_11N, MASKDWORD); - - for (i = 0; i < 200; i++) { - - ODM_delay_ms(1); - if (odm_get_bb_reg(p_dm_odm, ODM_REG_NHM_DUR_READY_11AC, BIT(17))) { - ret = 1; - break; - } - } - } - return ret; -} - -void -phydm_store_nhm_setting( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _CCX_INFO *ccx_info = &p_dm_odm->dm_ccx_info; - - if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) { - - - } else if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) { - - - - } -} - -void -phydm_clm_setting( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _CCX_INFO *ccx_info = &p_dm_odm->dm_ccx_info; - - - if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) { - - odm_set_bb_reg(p_dm_odm, ODM_REG_CCX_PERIOD_11AC, MASKLWORD, ccx_info->CLM_period); /*4us sample 1 time*/ - odm_set_bb_reg(p_dm_odm, ODM_REG_CLM_11AC, BIT(8), 0x1); /*Enable CCX for CLM*/ - - } else if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) { - - odm_set_bb_reg(p_dm_odm, ODM_REG_CCX_PERIOD_11N, MASKLWORD, ccx_info->CLM_period); /*4us sample 1 time*/ - odm_set_bb_reg(p_dm_odm, ODM_REG_CLM_11N, BIT(8), 0x1); /*Enable CCX for CLM*/ - } - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CCX, ODM_DBG_LOUD, ("[%s] : CLM period = %dus\n", __func__, ccx_info->CLM_period * 4)); - -} - -void -phydm_clm_trigger( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - - if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) { - odm_set_bb_reg(p_dm_odm, ODM_REG_CLM_11AC, BIT(0), 0x0); /*Trigger CLM*/ - odm_set_bb_reg(p_dm_odm, ODM_REG_CLM_11AC, BIT(0), 0x1); - } else if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) { - odm_set_bb_reg(p_dm_odm, ODM_REG_CLM_11N, BIT(0), 0x0); /*Trigger CLM*/ - odm_set_bb_reg(p_dm_odm, ODM_REG_CLM_11N, BIT(0), 0x1); - } -} - -bool -phydm_check_cl_mready( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u32 value32 = 0; - bool ret = false; - - if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) - value32 = odm_get_bb_reg(p_dm_odm, ODM_REG_CLM_RESULT_11AC, MASKDWORD); /*make sure CLM calc is ready*/ - else if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) - value32 = odm_get_bb_reg(p_dm_odm, ODM_REG_CLM_READY_11N, MASKDWORD); /*make sure CLM calc is ready*/ - - if ((p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) && (value32 & BIT(16))) - ret = true; - else if ((p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) && (value32 & BIT(16))) - ret = true; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 reg1 = 0; + + if (dm->support_ic_type & ODM_IC_11AC_SERIES) + reg1 = R_0x994; + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + reg1 = R_0x1e60; + #endif else - ret = false; + reg1 = R_0x890; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CCX, ODM_DBG_LOUD, ("[%s] : CLM ready = %d\n", __func__, ret)); + PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); + /*@disable NHM,CLM, FAHM*/ + odm_set_bb_reg(dm, reg1, 0x7, 0x0); + odm_set_bb_reg(dm, reg1, BIT(8), 0x0); + odm_set_bb_reg(dm, reg1, BIT(8), 0x1); +} - return ret; +#ifdef FAHM_SUPPORT + +u16 phydm_hw_divider(void *dm_void, u16 numerator, u16 denumerator) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u16 result = DEVIDER_ERROR; + u32 tmp_u32 = ((numerator << 16) | denumerator); + u32 reg_devider_input; + u32 reg; + u8 i; + + PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); + + if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + reg_devider_input = 0x1cbc; + reg = 0x1f98; + } else { + reg_devider_input = 0x980; + reg = 0x9f0; + } + + odm_set_bb_reg(dm, reg_devider_input, MASKDWORD, tmp_u32); + + for (i = 0; i < 10; i++) { + ODM_delay_ms(1); + if (odm_get_bb_reg(dm, reg, BIT(24))) { + /*@Chk HW rpt is ready*/ + + result = (u16)odm_get_bb_reg(dm, reg, MASKBYTE2); + break; + } + } + return result; +} + +void phydm_fahm_trigger(void *dm_void, u16 tgr_period) +{ /*@unit (4us)*/ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 fahm_reg1; + + if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + odm_set_bb_reg(dm, R_0x1cf8, 0xffff00, tgr_period); + + fahm_reg1 = 0x994; + } else { + odm_set_bb_reg(dm, R_0x978, 0xff000000, (tgr_period & 0xff)); + odm_set_bb_reg(dm, R_0x97c, 0xff, (tgr_period & 0xff00) >> 8); + + fahm_reg1 = 0x890; + } + + odm_set_bb_reg(dm, fahm_reg1, BIT(2), 0); + odm_set_bb_reg(dm, fahm_reg1, BIT(2), 1); +} + +void phydm_fahm_set_valid_cnt(void *dm_void, u8 numerator_sel, + u8 denominator_sel) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx_info = &dm->dm_ccx_info; + u32 fahm_reg1; + + PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); + + if (ccx_info->fahm_nume_sel == numerator_sel && + ccx_info->fahm_denom_sel == denominator_sel) { + PHYDM_DBG(dm, DBG_ENV_MNTR, "no need to update\n"); + return; + } + + ccx_info->fahm_nume_sel = numerator_sel; + ccx_info->fahm_denom_sel = denominator_sel; + + if (dm->support_ic_type & ODM_IC_11AC_SERIES) + fahm_reg1 = 0x994; + else + fahm_reg1 = 0x890; + + odm_set_bb_reg(dm, fahm_reg1, 0xe0, numerator_sel); + odm_set_bb_reg(dm, fahm_reg1, 0x7000, denominator_sel); +} + +void phydm_fahm_get_result(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u16 fahm_cnt[12]; /*packet count*/ + u16 fahm_rpt[12]; /*percentage*/ + u16 denominator; /*@fahm_denominator packet count*/ + u32 reg_rpt, reg_rpt_2; + u32 reg_tmp; + boolean is_ready = false; + u8 i; + + PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); + + if (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 < 3; i++) { + if (odm_get_bb_reg(dm, reg_rpt_2, BIT(31))) { + /*@Chk HW rpt is ready*/ + is_ready = true; + break; + } + ODM_delay_ms(1); + } + + if (!is_ready) + return; + + /*@Get FAHM Denominator*/ + denominator = (u16)odm_get_bb_reg(dm, reg_rpt_2, MASKLWORD); + + PHYDM_DBG(dm, DBG_ENV_MNTR, "Reg[0x%x] fahm_denmrtr = %d\n", reg_rpt_2, + denominator); + + /*@Get FAHM nemerator*/ + for (i = 0; i < 6; i++) { + reg_tmp = odm_get_bb_reg(dm, reg_rpt + (i << 2), MASKDWORD); + + PHYDM_DBG(dm, DBG_ENV_MNTR, "Reg[0x%x] fahm_denmrtr = %d\n", + reg_rpt + (i * 4), reg_tmp); + + fahm_cnt[i * 2] = (u16)(reg_tmp & MASKLWORD); + fahm_cnt[i * 2 + 1] = (u16)((reg_tmp & MASKHWORD) >> 16); + } + + for (i = 0; i < 12; i++) + fahm_rpt[i] = phydm_hw_divider(dm, fahm_cnt[i], denominator); + + PHYDM_DBG(dm, DBG_ENV_MNTR, + "FAHM_RPT_cnt[10:0]=[%d, %d, %d, %d, %d(IGI), %d, %d, %d, %d, %d, %d, %d]\n", + fahm_cnt[11], fahm_cnt[10], fahm_cnt[9], + fahm_cnt[8], fahm_cnt[7], fahm_cnt[6], + fahm_cnt[5], fahm_cnt[4], fahm_cnt[3], + fahm_cnt[2], fahm_cnt[1], fahm_cnt[0]); + + PHYDM_DBG(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_fahm_set_th_by_igi(void *dm_void, u8 igi) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx_info = &dm->dm_ccx_info; + u32 val = 0; + u8 f_th[11]; /*@FAHM Threshold*/ + u8 rssi_th[11]; /*@in RSSI scale*/ + u8 th_gap = 2 * IGI_TO_NHM_TH_MULTIPLIER; /*unit is 0.5dB for FAHM*/ + u8 i; + + PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); + + if (ccx_info->env_mntr_igi == igi) { + PHYDM_DBG(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) + f_th[0] = (igi - CCA_CAP) * IGI_TO_NHM_TH_MULTIPLIER; + else + f_th[0] = 0; + + rssi_th[0] = igi - 10 - CCA_CAP; + + for (i = 1; i <= 10; i++) { + f_th[i] = f_th[0] + th_gap * i; + rssi_th[i] = rssi_th[0] + (i << 1); + } + + PHYDM_DBG(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 (dm->support_ic_type & ODM_IC_11AC_SERIES) { + val = BYTE_2_DWORD(0, f_th[2], f_th[1], f_th[0]); + odm_set_bb_reg(dm, R_0x1c38, 0xffffff00, val); + val = BYTE_2_DWORD(0, f_th[5], f_th[4], f_th[3]); + odm_set_bb_reg(dm, R_0x1c78, 0xffffff00, val); + val = BYTE_2_DWORD(0, 0, f_th[7], f_th[6]); + odm_set_bb_reg(dm, R_0x1c7c, 0xffff0000, val); + val = BYTE_2_DWORD(0, f_th[10], f_th[9], f_th[8]); + odm_set_bb_reg(dm, R_0x1cb8, 0xffffff00, val); + } else { + val = BYTE_2_DWORD(f_th[3], f_th[2], f_th[1], f_th[0]); + odm_set_bb_reg(dm, R_0x970, MASKDWORD, val); + val = BYTE_2_DWORD(f_th[7], f_th[6], f_th[5], f_th[4]); + odm_set_bb_reg(dm, R_0x974, MASKDWORD, val); + val = BYTE_2_DWORD(0, f_th[10], f_th[9], f_th[8]); + odm_set_bb_reg(dm, R_0x978, 0xffffff, val); + } +} + +void phydm_fahm_init(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx_info = &dm->dm_ccx_info; + u32 fahm_reg1; + u8 denumerator_sel = 0; + + PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); + PHYDM_DBG(dm, DBG_ENV_MNTR, "IGI=0x%x\n", + dm->dm_dig_table.cur_ig_value); + + if (dm->support_ic_type & ODM_IC_11AC_SERIES) + fahm_reg1 = 0x994; + else + fahm_reg1 = 0x890; + + ccx_info->fahm_period = 65535; + + odm_set_bb_reg(dm, fahm_reg1, 0x6, 3); /*@FAHM HW block enable*/ + + denumerator_sel = FAHM_INCLD_FA | FAHM_INCLD_CRC_OK | FAHM_INCLD_CRC_ER; + phydm_fahm_set_valid_cnt(dm, FAHM_INCLD_FA, denumerator_sel); + phydm_fahm_set_th_by_igi(dm, dm->dm_dig_table.cur_ig_value); +} + +void phydm_fahm_dbg(void *dm_void, char input[][16], u32 *_used, char *output, + u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx_info = &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)) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "{1: trigger, 2:get result}\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{3: MNTR mode sel} {1: driver, 2. FW}\n"); + return; + } else if (var1[0] == 1) { /* Set & trigger CLM */ + + phydm_fahm_set_th_by_igi(dm, dm->dm_dig_table.cur_ig_value); + phydm_fahm_trigger(dm, ccx_info->fahm_period); + PDM_SNPF(out_len, used, output + used, out_len - used, + "Monitor FAHM for %d * 4us\n", ccx_info->fahm_period); + + } else if (var1[0] == 2) { /* @Get CLM results */ + + phydm_fahm_get_result(dm); + PDM_SNPF(out_len, used, output + used, out_len - used, + "FAHM_result=%d us\n", (ccx_info->clm_result << 2)); + + } else { + PDM_SNPF(out_len, used, output + used, out_len - used, + "Error\n"); + } + + *_used = used; + *_out_len = out_len; +} + +#endif /*@#ifdef FAHM_SUPPORT*/ + +#ifdef NHM_SUPPORT + +void phydm_nhm_racing_release(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx = &dm->dm_ccx_info; + u32 value32 = 0; + + PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); + PHYDM_DBG(dm, DBG_ENV_MNTR, "lv:(%d)->(0)\n", ccx->nhm_set_lv); + + ccx->nhm_ongoing = false; + ccx->nhm_set_lv = NHM_RELEASE; + + if (!(ccx->nhm_app == NHM_BACKGROUND || ccx->nhm_app == NHM_ACS)) { + phydm_pause_func(dm, F00_DIG, PHYDM_RESUME, + PHYDM_PAUSE_LEVEL_1, 1, &value32); + } + + ccx->nhm_app = NHM_BACKGROUND; +} + +u8 phydm_nhm_racing_ctrl(void *dm_void, enum phydm_nhm_level nhm_lv) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx = &dm->dm_ccx_info; + u8 set_result = PHYDM_SET_SUCCESS; + /*@acquire to control NHM API*/ + + PHYDM_DBG(dm, DBG_ENV_MNTR, "nhm_ongoing=%d, lv:(%d)->(%d)\n", + ccx->nhm_ongoing, ccx->nhm_set_lv, nhm_lv); + if (ccx->nhm_ongoing) { + if (nhm_lv <= ccx->nhm_set_lv) { + set_result = PHYDM_SET_FAIL; + } else { + phydm_ccx_hw_restart(dm); + ccx->nhm_ongoing = false; + } + } + + if (set_result) + ccx->nhm_set_lv = nhm_lv; + + PHYDM_DBG(dm, DBG_ENV_MNTR, "nhm racing success=%d\n", set_result); + return set_result; +} + +void phydm_nhm_trigger(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx = &dm->dm_ccx_info; + u32 nhm_reg1 = 0; + + if (dm->support_ic_type & ODM_IC_11AC_SERIES) + nhm_reg1 = R_0x994; + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + nhm_reg1 = R_0x1e60; + #endif + else + nhm_reg1 = R_0x890; + PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); + + /* @Trigger NHM*/ + pdm_set_reg(dm, nhm_reg1, BIT(1), 0); + pdm_set_reg(dm, nhm_reg1, BIT(1), 1); + ccx->nhm_trigger_time = dm->phydm_sys_up_time; + ccx->nhm_rpt_stamp++; + ccx->nhm_ongoing = true; +} + +boolean +phydm_nhm_check_rdy(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + boolean is_ready = false; + u32 reg1 = 0, reg1_bit = 0; +#if (ENV_MNTR_DBG || ENV_MNTR_DBG_1) + u16 i = 0; + u64 start_time = 0, progressing_time = 0; + u32 reg_val_start = 0, reg_val = 0; + u8 print_rpt = 0; +#endif + + if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + reg1 = R_0xfb4; + reg1_bit = 16; + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + reg1 = R_0x2d4c; + reg1_bit = 16; + #endif + } else { + reg1 = R_0x8b4; + if (dm->support_ic_type & (ODM_RTL8710B | ODM_RTL8721D)) { + reg1_bit = 25; + } else { + reg1_bit = 17; + } + } + +#if (ENV_MNTR_DBG_1) + start_time = odm_get_current_time(dm); + + if (dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821)) { + PHYDM_DBG(dm, DBG_ENV_MNTR, "NHM_period = %d\n", + odm_get_bb_reg(dm, R_0x990, MASKDWORD)); + + /*NHM trigger bit*/ + reg_val_start = odm_get_bb_reg(dm, R_0x994, BIT(1)); + PHYDM_DBG(dm, DBG_ENV_MNTR, "reg_val_start = %d\n", + reg_val_start); + + for (i = 0; i <= 400; i++) { + if (print_rpt == 0) { + reg_val = odm_get_bb_reg(dm, R_0x994, BIT(1)); + if (reg_val != reg_val_start) { + print_rpt = 1; + PHYDM_DBG(dm, DBG_ENV_MNTR, + "Trig[%d] (%d) -> (%d)\n", + i, reg_val_start, reg_val); + } + } + + if (odm_get_bb_reg(dm, reg1, BIT(reg1_bit))) { + is_ready = true; + break; + } + ODM_delay_ms(1); + } + } else { + if (odm_get_bb_reg(dm, reg1, BIT(reg1_bit))) + is_ready = true; + } + + progressing_time = odm_get_progressing_time(dm, start_time); + PHYDM_DBG(dm, DBG_ENV_MNTR, "NHM rdy=%d, i=%d, NHM_polling_time=%lld\n", + is_ready, i, progressing_time); + +#elif (ENV_MNTR_DBG) + start_time = odm_get_current_time(dm); + for (i = 0; i <= 400; i++) { + if (odm_get_bb_reg(dm, reg1, BIT(reg1_bit))) { + is_ready = true; + break; + } + ODM_delay_ms(1); + } + progressing_time = odm_get_progressing_time(dm, start_time); + PHYDM_DBG(dm, DBG_ENV_MNTR, "NHM rdy=%d, i=%d, NHM_polling_time=%lld\n", + is_ready, i, progressing_time); +#else + if (odm_get_bb_reg(dm, reg1, BIT(reg1_bit))) + is_ready = true; + + PHYDM_DBG(dm, DBG_ENV_MNTR, "NHM rdy=%d\n", is_ready); + +#endif + return is_ready; +} + +void phydm_nhm_get_utility(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx = &dm->dm_ccx_info; + u8 nhm_rpt_non_0 = 0; + + if (ccx->nhm_rpt_sum >= ccx->nhm_result[0]) { + nhm_rpt_non_0 = ccx->nhm_rpt_sum - ccx->nhm_result[0]; + ccx->nhm_ratio = (nhm_rpt_non_0 * 100) >> 8; + } else { + PHYDM_DBG(dm, DBG_ENV_MNTR, "[warning] nhm_rpt_sum invalid\n"); + ccx->nhm_ratio = 0; + } + + PHYDM_DBG(dm, DBG_ENV_MNTR, "nhm_ratio=%d\n", ccx->nhm_ratio); +} + +boolean +phydm_nhm_get_result(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx = &dm->dm_ccx_info; + u32 value32 = 0; + u8 i = 0; + u32 nhm_reg1 = 0; + u16 nhm_rpt_sum_tmp = 0; + + if (dm->support_ic_type & ODM_IC_11AC_SERIES) + nhm_reg1 = R_0x994; + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + nhm_reg1 = R_0x1e60; + #endif + else + nhm_reg1 = R_0x890; + PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); + + if (!(dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8812F | + ODM_RTL8197G))) + pdm_set_reg(dm, nhm_reg1, BIT(1), 0); + +#if (ENV_MNTR_DBG_2) + PHYDM_DBG(dm, DBG_ENV_MNTR, + "[DBG][3] 0xc50=0x%x, 0x994=0x%x, 0x998=0x%x\n", + odm_get_bb_reg(dm, R_0xc50, MASKDWORD), + odm_get_bb_reg(dm, R_0x994, MASKDWORD), + odm_get_bb_reg(dm, R_0x998, MASKDWORD)); +#endif + + if (!(phydm_nhm_check_rdy(dm))) { + PHYDM_DBG(dm, DBG_ENV_MNTR, "Get NHM report Fail\n"); + phydm_nhm_racing_release(dm); + return false; + } + + if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + value32 = odm_read_4byte(dm, R_0xfa8); + odm_move_memory(dm, &ccx->nhm_result[0], &value32, 4); + + value32 = odm_read_4byte(dm, R_0xfac); + odm_move_memory(dm, &ccx->nhm_result[4], &value32, 4); + + value32 = odm_read_4byte(dm, R_0xfb0); + odm_move_memory(dm, &ccx->nhm_result[8], &value32, 4); + + /*@Get NHM duration*/ + value32 = odm_read_4byte(dm, R_0xfb4); + ccx->nhm_duration = (u16)(value32 & MASKLWORD); + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + value32 = odm_read_4byte(dm, R_0x2d40); + odm_move_memory(dm, &ccx->nhm_result[0], &value32, 4); + + value32 = odm_read_4byte(dm, R_0x2d44); + odm_move_memory(dm, &ccx->nhm_result[4], &value32, 4); + + value32 = odm_read_4byte(dm, R_0x2d48); + odm_move_memory(dm, &ccx->nhm_result[8], &value32, 4); + + /*@Get NHM duration*/ + value32 = odm_read_4byte(dm, R_0x2d4c); + ccx->nhm_duration = (u16)(value32 & MASKLWORD); + #endif + } else { + value32 = odm_read_4byte(dm, R_0x8d8); + odm_move_memory(dm, &ccx->nhm_result[0], &value32, 4); + + value32 = odm_read_4byte(dm, R_0x8dc); + odm_move_memory(dm, &ccx->nhm_result[4], &value32, 4); + + value32 = odm_get_bb_reg(dm, R_0x8d0, 0xffff0000); + odm_move_memory(dm, &ccx->nhm_result[8], &value32, 2); + + value32 = odm_read_4byte(dm, R_0x8d4); + + ccx->nhm_result[10] = (u8)((value32 & MASKBYTE2) >> 16); + ccx->nhm_result[11] = (u8)((value32 & MASKBYTE3) >> 24); + + /*@Get NHM duration*/ + ccx->nhm_duration = (u16)(value32 & MASKLWORD); + } + + /* sum all nhm_result */ + if (ccx->nhm_period >= 65530) { + value32 = (ccx->nhm_duration * 100) >> 16; + PHYDM_DBG(dm, DBG_ENV_MNTR, + "NHM valid time = %d, valid: %d percent\n", + ccx->nhm_duration, value32); + } + + for (i = 0; i < NHM_RPT_NUM; i++) + nhm_rpt_sum_tmp += (u16)ccx->nhm_result[i]; + + ccx->nhm_rpt_sum = (u8)nhm_rpt_sum_tmp; + + PHYDM_DBG(dm, DBG_ENV_MNTR, + "NHM_Rpt[%d](H->L)[%d %d %d %d %d %d %d %d %d %d %d %d]\n", + ccx->nhm_rpt_stamp, ccx->nhm_result[11], ccx->nhm_result[10], + ccx->nhm_result[9], ccx->nhm_result[8], ccx->nhm_result[7], + ccx->nhm_result[6], ccx->nhm_result[5], ccx->nhm_result[4], + ccx->nhm_result[3], ccx->nhm_result[2], ccx->nhm_result[1], + ccx->nhm_result[0]); + + phydm_nhm_racing_release(dm); + +#if (ENV_MNTR_DBG_2) + PHYDM_DBG(dm, DBG_ENV_MNTR, + "[DBG][4] 0xc50=0x%x, 0x994=0x%x, 0x998=0x%x\n", + odm_get_bb_reg(dm, R_0xc50, MASKDWORD), + odm_get_bb_reg(dm, R_0x994, MASKDWORD), + odm_get_bb_reg(dm, R_0x998, MASKDWORD)); +#endif + + if (nhm_rpt_sum_tmp > 255) { + PHYDM_DBG(dm, DBG_ENV_MNTR, + "[Warning] Invalid NHM RPT, total=%d\n", + nhm_rpt_sum_tmp); + return false; + } + + return true; +} + +void phydm_nhm_set_th_reg(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx = &dm->dm_ccx_info; + u32 reg1 = 0, reg2 = 0, reg3 = 0, reg4 = 0, reg4_bit = 0; + u32 val = 0; + + PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); + + if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + reg1 = R_0x994; + reg2 = R_0x998; + reg3 = R_0x99c; + reg4 = R_0x9a0; + reg4_bit = MASKBYTE0; + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + reg1 = R_0x1e60; + reg2 = R_0x1e44; + reg3 = R_0x1e48; + reg4 = R_0x1e5c; + reg4_bit = MASKBYTE2; + #endif + } else { + reg1 = R_0x890; + reg2 = R_0x898; + reg3 = R_0x89c; + reg4 = R_0xe28; + reg4_bit = MASKBYTE0; + } + + /*Set NHM threshold*/ /*Unit: PWdB U(8,1)*/ + val = BYTE_2_DWORD(ccx->nhm_th[3], ccx->nhm_th[2], + ccx->nhm_th[1], ccx->nhm_th[0]); + pdm_set_reg(dm, reg2, MASKDWORD, val); + val = BYTE_2_DWORD(ccx->nhm_th[7], ccx->nhm_th[6], + ccx->nhm_th[5], ccx->nhm_th[4]); + pdm_set_reg(dm, reg3, MASKDWORD, val); + pdm_set_reg(dm, reg4, reg4_bit, ccx->nhm_th[8]); + val = BYTE_2_DWORD(0, 0, ccx->nhm_th[10], ccx->nhm_th[9]); + pdm_set_reg(dm, reg1, 0xffff0000, val); + + PHYDM_DBG(dm, DBG_ENV_MNTR, + "Update NHM_th[H->L]=[%d %d %d %d %d %d %d %d %d %d %d]\n", + ccx->nhm_th[10], ccx->nhm_th[9], ccx->nhm_th[8], + ccx->nhm_th[7], ccx->nhm_th[6], ccx->nhm_th[5], + ccx->nhm_th[4], ccx->nhm_th[3], ccx->nhm_th[2], + ccx->nhm_th[1], ccx->nhm_th[0]); +} + +boolean +phydm_nhm_th_update_chk(void *dm_void, enum nhm_application nhm_app, u8 *nhm_th, + u32 *igi_new) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx = &dm->dm_ccx_info; + boolean is_update = false; + u8 igi_curr = phydm_get_igi(dm, BB_PATH_A); + u8 nhm_igi_th_11k_low[NHM_TH_NUM] = {0x12, 0x15, 0x18, 0x1b, 0x1e, + 0x23, 0x28, 0x2c, 0x78, + 0x78, 0x78}; + u8 nhm_igi_th_11k_high[NHM_TH_NUM] = {0x1e, 0x23, 0x28, 0x2d, 0x32, + 0x37, 0x78, 0x78, 0x78, 0x78, + 0x78}; + u8 nhm_igi_th_xbox[NHM_TH_NUM] = {0x1a, 0x2c, 0x2e, 0x30, 0x32, 0x34, + 0x36, 0x38, 0x3a, 0x3c, 0x3d}; + u8 i = 0; + u8 th_tmp = igi_curr - CCA_CAP; + u8 th_step = 2; + + PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); + PHYDM_DBG(dm, DBG_ENV_MNTR, "App=%d, nhm_igi=0x%x, igi_curr=0x%x\n", + nhm_app, ccx->nhm_igi, igi_curr); + + if (igi_curr < 0x10) /* Protect for invalid IGI*/ + return false; + + switch (nhm_app) { + case NHM_BACKGROUND: /* @Get IGI form driver parameter(cur_ig_value)*/ + if (ccx->nhm_igi != igi_curr || ccx->nhm_app != nhm_app) { + is_update = true; + *igi_new = (u32)igi_curr; + + #ifdef NHM_DYM_PW_TH_SUPPORT + if ((dm->support_ic_type & ODM_IC_JGR3_SERIES) && + ccx->nhm_dym_pw_th_en) { + th_tmp = MAX_2(igi_curr - DYM_PWTH_CCA_CAP, 0); + th_step = 3; + } + #endif + + nhm_th[0] = (u8)IGI_2_NHM_TH(th_tmp); + + for (i = 1; i <= 10; i++) + nhm_th[i] = nhm_th[0] + + IGI_2_NHM_TH(th_step * i); + + } + break; + + case NHM_ACS: + if (ccx->nhm_igi != igi_curr || ccx->nhm_app != nhm_app) { + is_update = true; + *igi_new = (u32)igi_curr; + nhm_th[0] = (u8)IGI_2_NHM_TH(igi_curr - CCA_CAP); + for (i = 1; i <= 10; i++) + nhm_th[i] = nhm_th[0] + IGI_2_NHM_TH(2 * i); + } + break; + + case IEEE_11K_HIGH: + is_update = true; + *igi_new = 0x2c; + for (i = 0; i < NHM_TH_NUM; i++) + nhm_th[i] = IGI_2_NHM_TH(nhm_igi_th_11k_high[i]); + break; + + case IEEE_11K_LOW: + is_update = true; + *igi_new = 0x20; + for (i = 0; i < NHM_TH_NUM; i++) + nhm_th[i] = IGI_2_NHM_TH(nhm_igi_th_11k_low[i]); + break; + + case INTEL_XBOX: + is_update = true; + *igi_new = 0x36; + for (i = 0; i < NHM_TH_NUM; i++) + nhm_th[i] = IGI_2_NHM_TH(nhm_igi_th_xbox[i]); + break; + + case NHM_DBG: /*@Get IGI form register*/ + igi_curr = phydm_get_igi(dm, BB_PATH_A); + if (ccx->nhm_igi != igi_curr || ccx->nhm_app != nhm_app) { + is_update = true; + *igi_new = (u32)igi_curr; + nhm_th[0] = (u8)IGI_2_NHM_TH(igi_curr - CCA_CAP); + for (i = 1; i <= 10; i++) + nhm_th[i] = nhm_th[0] + IGI_2_NHM_TH(2 * i); + } + break; + } + + if (is_update) { + PHYDM_DBG(dm, DBG_ENV_MNTR, "[Update NHM_TH] igi_RSSI=%d\n", + IGI_2_RSSI(*igi_new)); + + for (i = 0; i < NHM_TH_NUM; i++) { + PHYDM_DBG(dm, DBG_ENV_MNTR, "NHM_th[%d](RSSI) = %d\n", + i, NTH_TH_2_RSSI(nhm_th[i])); + } + } else { + PHYDM_DBG(dm, DBG_ENV_MNTR, "No need to update NHM_TH\n"); + } + return is_update; +} + +void phydm_nhm_set(void *dm_void, enum nhm_option_txon_all include_tx, + enum nhm_option_cca_all include_cca, + enum nhm_divider_opt_all divi_opt, + enum nhm_application nhm_app, u16 period) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx = &dm->dm_ccx_info; + u8 nhm_th[NHM_TH_NUM] = {0}; + u32 igi = 0x20; + u32 reg1 = 0, reg2 = 0; + u32 val_tmp = 0; + + PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); + + PHYDM_DBG(dm, DBG_ENV_MNTR, + "incld{tx, cca}={%d, %d}, divi_opt=%d, period=%d\n", + include_tx, include_cca, divi_opt, period); + + if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + reg1 = R_0x994; + reg2 = R_0x990; + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + reg1 = R_0x1e60; + reg2 = R_0x1e40; + #endif + } else { + reg1 = R_0x890; + reg2 = R_0x894; + } + + /*Set disable_ignore_cca, disable_ignore_txon, ccx_en*/ + if (include_tx != ccx->nhm_include_txon || + include_cca != ccx->nhm_include_cca || + divi_opt != ccx->nhm_divider_opt) { + /* some old ic is not supported on NHM divider option */ + if (dm->support_ic_type & (ODM_RTL8188E | ODM_RTL8723B | + ODM_RTL8195A | ODM_RTL8192E)) { + val_tmp = (u32)((include_tx << 2) | + (include_cca << 1) | 1); + pdm_set_reg(dm, reg1, 0x700, val_tmp); + } else { + val_tmp = (u32)BIT_2_BYTE(divi_opt, include_tx, + include_cca, 1); + pdm_set_reg(dm, reg1, 0xf00, val_tmp); + } + ccx->nhm_include_txon = include_tx; + ccx->nhm_include_cca = include_cca; + ccx->nhm_divider_opt = divi_opt; + #if 0 + PHYDM_DBG(dm, DBG_ENV_MNTR, + "val_tmp=%d, incld{tx, cca}={%d, %d}, divi_opt=%d, period=%d\n", + val_tmp, include_tx, include_cca, divi_opt, period); + + PHYDM_DBG(dm, DBG_ENV_MNTR, "0x994=0x%x\n", + odm_get_bb_reg(dm, 0x994, 0xf00)); + #endif + } + + /*Set NHM period*/ + if (period != ccx->nhm_period) { + pdm_set_reg(dm, reg2, MASKHWORD, period); + PHYDM_DBG(dm, DBG_ENV_MNTR, + "Update NHM period ((%d)) -> ((%d))\n", + ccx->nhm_period, period); + + ccx->nhm_period = period; + } + + /*Set NHM threshold*/ + if (phydm_nhm_th_update_chk(dm, nhm_app, &(nhm_th[0]), &igi)) { + /*Pause IGI*/ + if (nhm_app == NHM_BACKGROUND || nhm_app == NHM_ACS) { + PHYDM_DBG(dm, DBG_ENV_MNTR, "DIG Free Run\n"); + } else if (phydm_pause_func(dm, F00_DIG, PHYDM_PAUSE, + PHYDM_PAUSE_LEVEL_1, 1, &igi) + == PAUSE_FAIL) { + PHYDM_DBG(dm, DBG_ENV_MNTR, "pause DIG Fail\n"); + return; + } else { + PHYDM_DBG(dm, DBG_ENV_MNTR, "pause DIG=0x%x\n", igi); + } + ccx->nhm_app = nhm_app; + ccx->nhm_igi = (u8)igi; + odm_move_memory(dm, &ccx->nhm_th[0], &nhm_th, NHM_TH_NUM); + + /*Set NHM th*/ + phydm_nhm_set_th_reg(dm); + } +} + +u8 phydm_nhm_mntr_set(void *dm_void, struct nhm_para_info *nhm_para) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u16 nhm_time = 0; /*unit: 4us*/ + + PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); + + if (nhm_para->mntr_time == 0) + return PHYDM_SET_FAIL; + + if (nhm_para->nhm_lv >= NHM_MAX_NUM) { + PHYDM_DBG(dm, DBG_ENV_MNTR, "Wrong LV=%d\n", nhm_para->nhm_lv); + return PHYDM_SET_FAIL; + } + + if (phydm_nhm_racing_ctrl(dm, nhm_para->nhm_lv) == PHYDM_SET_FAIL) + return PHYDM_SET_FAIL; + + if (nhm_para->mntr_time >= 262) + nhm_time = NHM_PERIOD_MAX; + else + nhm_time = nhm_para->mntr_time * MS_TO_4US_RATIO; + + phydm_nhm_set(dm, nhm_para->incld_txon, nhm_para->incld_cca, + nhm_para->div_opt, nhm_para->nhm_app, nhm_time); + + return PHYDM_SET_SUCCESS; +} + +#ifdef NHM_DYM_PW_TH_SUPPORT +void +phydm_nhm_restore_pw_th(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx = &dm->dm_ccx_info; + + odm_set_bb_reg(dm, R_0x82c, 0x3f, ccx->nhm_pw_th_rf20_dft); } void -phydm_get_cl_mresult( - void *p_dm_void -) +phydm_nhm_set_pw_th(void *dm_void, u8 noise, boolean chk_succ) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _CCX_INFO *ccx_info = &p_dm_odm->dm_ccx_info; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx = &dm->dm_ccx_info; + u8 pre_pw_th_rf20 = 0; + u8 new_pw_th_rf20 = 0; + u8 pw_th_u_bnd = 0; + s8 noise_diff = 0; + u8 point_mean = 15; - u32 value32 = 0; - u16 results = 0; + PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); - if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) - value32 = odm_get_bb_reg(p_dm_odm, ODM_REG_CLM_RESULT_11AC, MASKDWORD); /*read CLM calc result*/ - else if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) - value32 = odm_get_bb_reg(p_dm_odm, ODM_REG_CLM_RESULT_11N, MASKDWORD); /*read CLM calc result*/ + if (*dm->band_width != CHANNEL_WIDTH_20 || + *dm->band_type == ODM_BAND_5G) { + PHYDM_DBG(dm, DBG_ENV_MNTR, "bandwidth=((%d)), band=((%d))\n", + *dm->band_width, *dm->band_type); + phydm_nhm_restore_pw_th(dm); + return; + } - ccx_info->CLM_result = (u16)(value32 & MASKLWORD); + pre_pw_th_rf20 = (u8)odm_get_bb_reg(dm, R_0x82c, 0x3f); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CCX, ODM_DBG_LOUD, ("[%s] : CLM result = %dus\n", __func__, ccx_info->CLM_result * 4)); + /* @pre_pw_th can not be lower than default value*/ + if (pre_pw_th_rf20 < ccx->nhm_pw_th_rf20_dft) { + PHYDM_DBG(dm, DBG_ENV_MNTR, + "pre_pw_th=((%d)), new_pw_th=((%d))\n", + pre_pw_th_rf20, ccx->nhm_pw_th_rf20_dft); + phydm_nhm_restore_pw_th(dm); + return; + } + + if (chk_succ) { + noise_diff = noise - (ccx->nhm_igi - 10); + pw_th_u_bnd = (u8)(noise_diff + 32 + point_mean); + + pw_th_u_bnd = MIN_2(pw_th_u_bnd, ccx->nhm_pw_th_max); + + PHYDM_DBG(dm, DBG_ENV_MNTR, + "noise_diff=((%d)), max=((%d)), pw_th_u_bnd=((%d))\n", + noise_diff, ccx->nhm_pw_th_max, pw_th_u_bnd); + + if (pw_th_u_bnd > pre_pw_th_rf20) { + new_pw_th_rf20 = pre_pw_th_rf20 + 1; + } else if (pw_th_u_bnd == pre_pw_th_rf20) { + new_pw_th_rf20 = pre_pw_th_rf20; + } else { + if (pre_pw_th_rf20 > ccx->nhm_pw_th_rf20_dft) + new_pw_th_rf20 = pre_pw_th_rf20 - 1; + else /* @pre_pw_th = ccx->nhm_pw_th_dft*/ + new_pw_th_rf20 = pre_pw_th_rf20; + } + } else { + if (pre_pw_th_rf20 > ccx->nhm_pw_th_rf20_dft) + new_pw_th_rf20 = pre_pw_th_rf20 - 1; + else /* @pre_pw_th = ccx->nhm_pw_th_dft*/ + new_pw_th_rf20 = pre_pw_th_rf20; + } + + PHYDM_DBG(dm, DBG_ENV_MNTR, "pre_pw_th=((%d)), new_pw_th=((%d))\n", + pre_pw_th_rf20, new_pw_th_rf20); + + if (new_pw_th_rf20 != pre_pw_th_rf20) + odm_set_bb_reg(dm, R_0x82c, 0x3f, new_pw_th_rf20); } + +u8 +phydm_nhm_cal_noise(void *dm_void, u8 start_i, u8 end_i, u8 n_sum) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx = &dm->dm_ccx_info; + u8 i = 0; + u32 noise_tmp = 0; + u8 noise = 0; + + PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); + + for (i = start_i; i <= end_i; i++) + noise_tmp += ccx->nhm_result[i] * (ccx->nhm_th[0] - 3 + + 6 * i); + + noise = (u8)(NTH_TH_2_RSSI(noise_tmp / n_sum)); + PHYDM_DBG(dm, DBG_ENV_MNTR, "noise(RSSI)=((%d))\n", noise); + + return noise; +} + +void +phydm_nhm_dym_pw_th_1peak(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx = &dm->dm_ccx_info; + u8 i = 0; + u8 max_i = 0; + u8 m_dif_l1 = 0; + u8 m_dif_r1 = 0; + u8 patt_case = 0; + u8 l1_dif_r2 = 0; + u8 l2_dif_r1 = 0; + u8 l1_dif_r1 = 0; + u8 n_sum = 0; + u8 r1_dif_r2 = 0; + u8 l1_dif_l2 = 0; + u8 noise = 0; + boolean chk_succ = false; + + PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); + + /* @step1*/ + for (i = 1; i < NHM_RPT_NUM; i++) { + if (ccx->nhm_result[i] >= ccx->nhm_result[max_i]) + max_i = i; + } + + if (max_i == 0 || max_i == (NHM_RPT_NUM - 1)) { + PHYDM_DBG(dm, DBG_ENV_MNTR, "max index can not be 0 or 11\n"); + phydm_nhm_set_pw_th(dm, 0, chk_succ); + return; + } + + /* @step2*/ + m_dif_l1 = ccx->nhm_result[max_i] - ccx->nhm_result[max_i - 1]; + m_dif_r1 = ccx->nhm_result[max_i] - ccx->nhm_result[max_i + 1]; + + if (m_dif_r1 <= NHM_TH1 && (max_i != NHM_RPT_NUM - 1)) + patt_case = NHM_1PEAK_PS; + else if ((m_dif_l1 <= NHM_TH1) && (max_i != 0)) + patt_case = NHM_1PEAK_NS; + else + patt_case = NHM_1PEAK_SYM; + + switch (patt_case) { + case NHM_1PEAK_PS: + /* @step3*/ + l1_dif_r2 = DIFF_2(ccx->nhm_result[max_i - 1], + ccx->nhm_result[max_i + 2]); + if (l1_dif_r2 > NHM_TH2) { + PHYDM_DBG(dm, DBG_ENV_MNTR, "S3 fail:c1((%d))\n", + l1_dif_r2); + break; + } + /* @step4*/ + n_sum = ccx->nhm_result[max_i - 1] + ccx->nhm_result[max_i] + + ccx->nhm_result[max_i + 1] + ccx->nhm_result[max_i + 2]; + if (n_sum < NHM_TH4) { + PHYDM_DBG(dm, DBG_ENV_MNTR, "S4 fail:((%d))\n", n_sum); + break; + } + /* @step5*/ + r1_dif_r2 = DIFF_2(ccx->nhm_result[max_i + 1], + ccx->nhm_result[max_i + 2]); + if (m_dif_l1 < NHM_TH5 || r1_dif_r2 < NHM_TH5) { + PHYDM_DBG(dm, DBG_ENV_MNTR, "S5 fail:c1((%d, %d))\n", + m_dif_l1, r1_dif_r2); + break; + } + /* @step6*/ + chk_succ = true; + noise = phydm_nhm_cal_noise(dm, max_i - 1, max_i + 2, n_sum); + break; + case NHM_1PEAK_NS: + /* @step3*/ + l2_dif_r1 = DIFF_2(ccx->nhm_result[max_i - 2], + ccx->nhm_result[max_i + 1]); + if (l2_dif_r1 > NHM_TH2) { + PHYDM_DBG(dm, DBG_ENV_MNTR, "S3 fail:c2((%d))\n", + l2_dif_r1); + break; + } + /* @step4*/ + n_sum = ccx->nhm_result[max_i - 2] + + ccx->nhm_result[max_i - 1] + + ccx->nhm_result[max_i] + ccx->nhm_result[max_i + 1]; + if (n_sum < NHM_TH4) { + PHYDM_DBG(dm, DBG_ENV_MNTR, "S4 fail:((%d))\n", n_sum); + break; + } + /* @step5*/ + l1_dif_l2 = DIFF_2(ccx->nhm_result[max_i - 1], + ccx->nhm_result[max_i - 2]); + if (m_dif_r1 < NHM_TH5 || l1_dif_l2 < NHM_TH5) { + PHYDM_DBG(dm, DBG_ENV_MNTR, "S5 fail:c2((%d, %d))\n", + m_dif_r1, l1_dif_l2); + break; + } + /* @step6*/ + chk_succ = true; + noise = phydm_nhm_cal_noise(dm, max_i - 2, max_i + 1, n_sum); + + break; + case NHM_1PEAK_SYM: + /* @step3*/ + l1_dif_r1 = DIFF_2(ccx->nhm_result[max_i - 1], + ccx->nhm_result[max_i + 1]); + if (l1_dif_r1 > NHM_TH3) { + PHYDM_DBG(dm, DBG_ENV_MNTR, "S3 fail: c3((%d))\n", + l1_dif_r1); + break; + } + /* @step4*/ + n_sum = ccx->nhm_result[max_i - 1] + ccx->nhm_result[max_i] + + ccx->nhm_result[max_i + 1]; + if (n_sum < NHM_TH4) { + PHYDM_DBG(dm, DBG_ENV_MNTR, "S4 fail:((%d))\n", n_sum); + break; + } + /* @step5*/ + if (m_dif_l1 < NHM_TH6 || m_dif_r1 < NHM_TH6) { + PHYDM_DBG(dm, DBG_ENV_MNTR, "S5 fail:c3((%d, %d))\n", + m_dif_l1, m_dif_r1); + break; + } + /* @step6*/ + chk_succ = true; + noise = phydm_nhm_cal_noise(dm, max_i - 1, max_i + 1, n_sum); + + break; + } + phydm_nhm_set_pw_th(dm, noise, chk_succ); +} + +void +phydm_nhm_dym_pw_th_sl(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx = &dm->dm_ccx_info; + u8 i = 0; + u8 n_sum = 0; + u8 noise = 0; + boolean chk_succ = false; + + PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); + + for (i = 0; i < NHM_RPT_NUM - 3; i++) { + n_sum = ccx->nhm_result[i] + ccx->nhm_result[i + 1] + + ccx->nhm_result[i + 2] + ccx->nhm_result[i + 3]; + if (n_sum >= ccx->nhm_sl_pw_th) { + PHYDM_DBG(dm, DBG_ENV_MNTR, "Do sl[%d:%d]\n", i, i + 3); + chk_succ = true; + noise = phydm_nhm_cal_noise(dm, i, i + 3, n_sum); + break; + } + } + + if (!chk_succ) + PHYDM_DBG(dm, DBG_ENV_MNTR, "SL method failed!\n"); + + phydm_nhm_set_pw_th(dm, noise, chk_succ); +} + +void +phydm_nhm_dym_pw_th(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx = &dm->dm_ccx_info; + + if (ccx->nhm_dym_1_peak_en) + phydm_nhm_dym_pw_th_1peak(dm); + else + phydm_nhm_dym_pw_th_sl(dm); +} + +void +phydm_nhm_dym_pw_th_patch_id_chk(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx = &dm->dm_ccx_info; + + if (dm->iot_table.phydm_patch_id == 0x100f0401) { + ccx->nhm_dym_pw_th_en = true; + } else { + if (ccx->nhm_dym_pw_th_en) { + phydm_nhm_restore_pw_th(dm); + ccx->nhm_dym_pw_th_en = false; + } + } +} +#endif + +/*@Environment Monitor*/ +boolean +phydm_nhm_mntr_chk(void *dm_void, u16 monitor_time /*unit ms*/) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx = &dm->dm_ccx_info; + struct nhm_para_info nhm_para = {0}; + boolean nhm_chk_result = false; + u32 sys_return_time = 0; + + PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); + + if (ccx->nhm_manual_ctrl) { + PHYDM_DBG(dm, DBG_ENV_MNTR, "NHM in manual ctrl\n"); + return nhm_chk_result; + } + sys_return_time = ccx->nhm_trigger_time + MAX_ENV_MNTR_TIME; + if (ccx->nhm_app != NHM_BACKGROUND && + (sys_return_time > dm->phydm_sys_up_time)) { + PHYDM_DBG(dm, DBG_ENV_MNTR, + "nhm_app=%d, trigger_time %d, sys_time=%d\n", + ccx->nhm_app, ccx->nhm_trigger_time, + dm->phydm_sys_up_time); + + return nhm_chk_result; + } + + /*@[NHM get result & calculate Utility----------------------------*/ + #ifdef NHM_DYM_PW_TH_SUPPORT + phydm_nhm_dym_pw_th_patch_id_chk(dm); + #endif + + if (phydm_nhm_get_result(dm)) { + PHYDM_DBG(dm, DBG_ENV_MNTR, "Get NHM_rpt success\n"); + phydm_nhm_get_utility(dm); + + #ifdef NHM_DYM_PW_TH_SUPPORT + if ((dm->support_ic_type & ODM_IC_JGR3_SERIES) && + ccx->nhm_dym_pw_th_en) + phydm_nhm_dym_pw_th(dm); + #endif + } else { + #ifdef NHM_DYM_PW_TH_SUPPORT + if ((dm->support_ic_type & ODM_IC_JGR3_SERIES) && + ccx->nhm_dym_pw_th_en) + phydm_nhm_set_pw_th(dm, 0, false); + #endif + } + + /*@[NHM trigger setting]------------------------------------------*/ + nhm_para.incld_txon = NHM_EXCLUDE_TXON; + nhm_para.incld_cca = NHM_EXCLUDE_CCA; + #ifdef NHM_DYM_PW_TH_SUPPORT + if ((dm->support_ic_type & ODM_IC_JGR3_SERIES) && + ccx->nhm_app == NHM_BACKGROUND && ccx->nhm_dym_pw_th_en) + nhm_para.div_opt = NHM_VALID; + else + #endif + nhm_para.div_opt = NHM_CNT_ALL; + + nhm_para.nhm_app = NHM_BACKGROUND; + nhm_para.nhm_lv = NHM_LV_1; + #ifdef NHM_DYM_PW_TH_SUPPORT + if ((dm->support_ic_type & ODM_IC_JGR3_SERIES) && + ccx->nhm_app == NHM_BACKGROUND && ccx->nhm_dym_pw_th_en) + nhm_para.mntr_time = monitor_time >> ccx->nhm_period_decre; + else + #endif + nhm_para.mntr_time = monitor_time; + + nhm_chk_result = phydm_nhm_mntr_set(dm, &nhm_para); + + return nhm_chk_result; +} + +void phydm_nhm_init(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx = &dm->dm_ccx_info; + + PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); + PHYDM_DBG(dm, DBG_ENV_MNTR, "cur_igi=0x%x\n", + dm->dm_dig_table.cur_ig_value); + + ccx->nhm_app = NHM_BACKGROUND; + ccx->nhm_igi = 0xff; + + /*Set NHM threshold*/ + ccx->nhm_ongoing = false; + ccx->nhm_set_lv = NHM_RELEASE; + + if (phydm_nhm_th_update_chk(dm, ccx->nhm_app, &ccx->nhm_th[0], + (u32 *)&ccx->nhm_igi)) + phydm_nhm_set_th_reg(dm); + + ccx->nhm_period = 0; + + ccx->nhm_include_cca = NHM_CCA_INIT; + ccx->nhm_include_txon = NHM_TXON_INIT; + ccx->nhm_divider_opt = NHM_CNT_INIT; + + ccx->nhm_manual_ctrl = 0; + ccx->nhm_rpt_stamp = 0; + + #ifdef NHM_DYM_PW_TH_SUPPORT + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + ccx->nhm_dym_pw_th_en = false; + ccx->nhm_dym_1_peak_en = false; + ccx->nhm_pw_th_rf20_dft = (u8)odm_get_bb_reg(dm, R_0x82c, 0x3f); + ccx->nhm_pw_th_max = 63; + ccx->nhm_sl_pw_th = 100; /* @39%*/ + ccx->nhm_period_decre = 1; + } + #endif +} + +void phydm_nhm_dbg(void *dm_void, char input[][16], u32 *_used, char *output, + u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx = &dm->dm_ccx_info; + struct nhm_para_info nhm_para; + char help[] = "-h"; + u32 var1[10] = {0}; + u32 used = *_used; + u32 out_len = *_out_len; + boolean nhm_rpt_success = true; + u8 result_tmp = 0; + u8 i; + + PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); + + if ((strcmp(input[1], help) == 0)) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "NHM Basic-Trigger 262ms: {1}\n"); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "NHM Adv-Trigger: {2} {Include TXON} {Include CCA}\n{0:Cnt_all, 1:Cnt valid} {App} {LV} {0~262ms}\n"); + #ifdef NHM_DYM_PW_TH_SUPPORT + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "NHM dym_pw_th: {3} {en} {en_1-peak} {max} {period_decre} {sl_th}\n"); + } + #endif + + PDM_SNPF(out_len, used, output + used, out_len - used, + "NHM Get Result: {100}\n"); + } else if (var1[0] == 100) { /*@Get NHM results*/ + + PDM_SNPF(out_len, used, output + used, out_len - used, + "IGI=0x%x, rpt_stamp=%d\n", ccx->nhm_igi, + ccx->nhm_rpt_stamp); + + nhm_rpt_success = phydm_nhm_get_result(dm); + + if (nhm_rpt_success) { + for (i = 0; i <= 11; i++) { + result_tmp = ccx->nhm_result[i]; + PDM_SNPF(out_len, used, output + used, + out_len - used, + "nhm_rpt[%d] = %d (%d percent)\n", + i, result_tmp, + (((result_tmp * 100) + 128) >> 8)); + } + } else { + PDM_SNPF(out_len, used, output + used, out_len - used, + "Get NHM_rpt Fail\n"); + } + ccx->nhm_manual_ctrl = 0; + #ifdef NHM_DYM_PW_TH_SUPPORT + } else if (var1[0] == 3) { /* @NMH dym_pw_th*/ + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + for (i = 1; i < 7; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, + &var1[i]); + } + } + + if (var1[1] == 1) { + ccx->nhm_dym_pw_th_en = true; + ccx->nhm_dym_1_peak_en = (boolean)var1[2]; + ccx->nhm_pw_th_max = (u8)var1[3]; + ccx->nhm_period_decre = (u8)var1[4]; + ccx->nhm_sl_pw_th = (u8)var1[5]; + } else if (var1[1] == 0) { + ccx->nhm_dym_pw_th_en = false; + phydm_nhm_restore_pw_th(dm); + } else if (var1[1] == 2) { + ccx->nhm_dym_pw_th_en = true; + ccx->nhm_dym_1_peak_en = false; + ccx->nhm_pw_th_max = 63; + ccx->nhm_period_decre = 1; + ccx->nhm_sl_pw_th = 100; + } + } + #endif + } else { /*NMH trigger*/ + + ccx->nhm_manual_ctrl = 1; + + for (i = 1; i < 7; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, + &var1[i]); + } + } + + if (var1[0] == 1) { + nhm_para.incld_txon = NHM_EXCLUDE_TXON; + nhm_para.incld_cca = NHM_EXCLUDE_CCA; + nhm_para.div_opt = NHM_CNT_ALL; + nhm_para.nhm_app = NHM_DBG; + nhm_para.nhm_lv = NHM_LV_4; + nhm_para.mntr_time = 262; + } else { + nhm_para.incld_txon = (enum nhm_option_txon_all)var1[1]; + nhm_para.incld_cca = (enum nhm_option_cca_all)var1[2]; + nhm_para.div_opt = (enum nhm_divider_opt_all)var1[3]; + nhm_para.nhm_app = (enum nhm_application)var1[4]; + nhm_para.nhm_lv = (enum phydm_nhm_level)var1[5]; + nhm_para.mntr_time = (u16)var1[6]; + + /* some old ic is not supported on NHM divider option */ + if (dm->support_ic_type & (ODM_RTL8188E | ODM_RTL8723B | + ODM_RTL8195A | ODM_RTL8192E)) { + nhm_para.div_opt = NHM_CNT_ALL; + } + } + + PDM_SNPF(out_len, used, output + used, out_len - used, + "txon=%d, cca=%d, dev=%d, app=%d, lv=%d, time=%d ms\n", + nhm_para.incld_txon, nhm_para.incld_cca, + nhm_para.div_opt, nhm_para.nhm_app, + nhm_para.nhm_lv, nhm_para.mntr_time); + + if (phydm_nhm_mntr_set(dm, &nhm_para) == PHYDM_SET_SUCCESS) + phydm_nhm_trigger(dm); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "IGI=0x%x, rpt_stamp=%d\n", ccx->nhm_igi, + ccx->nhm_rpt_stamp); + + for (i = 0; i <= 10; i++) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "NHM_th[%d] RSSI = %d\n", i, + NTH_TH_2_RSSI(ccx->nhm_th[i])); + } + } + + *_used = used; + *_out_len = out_len; +} + +#endif /*@#ifdef NHM_SUPPORT*/ + +#ifdef CLM_SUPPORT + +void phydm_clm_racing_release(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx = &dm->dm_ccx_info; + + PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); + PHYDM_DBG(dm, DBG_ENV_MNTR, "lv:(%d)->(0)\n", ccx->clm_set_lv); + + ccx->clm_ongoing = false; + ccx->clm_set_lv = CLM_RELEASE; + ccx->clm_app = CLM_BACKGROUND; +} + +u8 phydm_clm_racing_ctrl(void *dm_void, enum phydm_clm_level clm_lv) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx = &dm->dm_ccx_info; + u8 set_result = PHYDM_SET_SUCCESS; + /*@acquire to control CLM API*/ + + PHYDM_DBG(dm, DBG_ENV_MNTR, "clm_ongoing=%d, lv:(%d)->(%d)\n", + ccx->clm_ongoing, ccx->clm_set_lv, clm_lv); + if (ccx->clm_ongoing) { + if (clm_lv <= ccx->clm_set_lv) { + set_result = PHYDM_SET_FAIL; + } else { + phydm_ccx_hw_restart(dm); + ccx->clm_ongoing = false; + } + } + + if (set_result) + ccx->clm_set_lv = clm_lv; + + PHYDM_DBG(dm, DBG_ENV_MNTR, "clm racing success=%d\n", set_result); + return set_result; +} + +void phydm_clm_c2h_report_handler(void *dm_void, u8 *cmd_buf, u8 cmd_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx_info = &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(dm, DBG_ENV_MNTR, "[%d] clm_report= %d\n", + ccx_info->clm_fw_result_cnt, clm_report); +} + +void phydm_clm_h2c(void *dm_void, u16 obs_time, u8 fw_clm_en) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 h2c_val[H2C_MAX_LENGTH] = {0}; + u8 i = 0; + u8 obs_time_idx = 0; + + PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s] ======>\n", __func__); + PHYDM_DBG(dm, DBG_ENV_MNTR, "obs_time_index=%d *4 us\n", obs_time); + + for (i = 1; i <= 16; i++) { + if (obs_time & BIT(16 - i)) { + obs_time_idx = 16 - i; + break; + } + } +#if 0 + 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 + +#endif + + h2c_val[0] = obs_time_idx | (((fw_clm_en) ? 1 : 0) << 7); + h2c_val[1] = CLM_MAX_REPORT_TIME; + + PHYDM_DBG(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(dm, PHYDM_H2C_FW_CLM_MNTR, H2C_MAX_LENGTH, h2c_val); +} + +void phydm_clm_setting(void *dm_void, u16 clm_period /*@4us sample 1 time*/) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx = &dm->dm_ccx_info; + + if (ccx->clm_period != clm_period) { + if (dm->support_ic_type & ODM_IC_11AC_SERIES) + odm_set_bb_reg(dm, R_0x990, MASKLWORD, clm_period); + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + odm_set_bb_reg(dm, R_0x1e40, MASKLWORD, clm_period); + #endif + else if (dm->support_ic_type & ODM_IC_11N_SERIES) + odm_set_bb_reg(dm, R_0x894, MASKLWORD, clm_period); + + ccx->clm_period = clm_period; + PHYDM_DBG(dm, DBG_ENV_MNTR, + "Update CLM period ((%d)) -> ((%d))\n", + ccx->clm_period, clm_period); + } + + PHYDM_DBG(dm, DBG_ENV_MNTR, "Set CLM period=%d * 4us\n", + ccx->clm_period); +} + +void phydm_clm_trigger(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx = &dm->dm_ccx_info; + u32 reg1 = 0; + + if (dm->support_ic_type & ODM_IC_11AC_SERIES) + reg1 = R_0x994; + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + reg1 = R_0x1e60; + #endif + else + reg1 = R_0x890; + PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); + + odm_set_bb_reg(dm, reg1, BIT(0), 0x0); + odm_set_bb_reg(dm, reg1, BIT(0), 0x1); + + ccx->clm_trigger_time = dm->phydm_sys_up_time; + ccx->clm_rpt_stamp++; + ccx->clm_ongoing = true; +} + +boolean +phydm_clm_check_rdy(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + boolean is_ready = false; + u32 reg1 = 0, reg1_bit = 0; +#if (ENV_MNTR_DBG) + u16 i = 0; + u64 start_time = 0, progressing_time = 0; +#endif + + if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + reg1 = R_0xfa4; + reg1_bit = 16; + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + reg1 = R_0x2d88; + reg1_bit = 16; + #endif + } else if (dm->support_ic_type & ODM_IC_11N_SERIES) { + if (dm->support_ic_type & (ODM_RTL8710B | ODM_RTL8721D)) { + reg1 = R_0x8b4; + reg1_bit = 24; + } else { + reg1 = R_0x8b4; + reg1_bit = 16; + } + } +#if (ENV_MNTR_DBG) + start_time = odm_get_current_time(dm); + for (i = 0; i <= 400; i++) { + if (odm_get_bb_reg(dm, reg1, BIT(reg1_bit))) { + is_ready = true; + break; + } + ODM_delay_ms(1); + } + progressing_time = odm_get_progressing_time(dm, start_time); + + PHYDM_DBG(dm, DBG_ENV_MNTR, "CLM rdy=%d, i=%d, CLM_polling_time=%lld\n", + is_ready, i, progressing_time); +#else + if (odm_get_bb_reg(dm, reg1, BIT(reg1_bit))) + is_ready = true; + + PHYDM_DBG(dm, DBG_ENV_MNTR, "CLM rdy=%d\n", is_ready); +#endif + return is_ready; +} + +void phydm_clm_get_utility(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx = &dm->dm_ccx_info; + u32 clm_result_tmp; + + if (ccx->clm_period == 0) { + PHYDM_DBG(dm, DBG_ENV_MNTR, "[warning] clm_period = 0\n"); + ccx->clm_ratio = 0; + } else if (ccx->clm_period >= 65530) { + clm_result_tmp = (u32)(ccx->clm_result * 100); + ccx->clm_ratio = (u8)((clm_result_tmp + (1 << 15)) >> 16); + } else { + clm_result_tmp = (u32)(ccx->clm_result * 100); + ccx->clm_ratio = (u8)(clm_result_tmp / (u32)ccx->clm_period); + } +} + +boolean +phydm_clm_get_result(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx_info = &dm->dm_ccx_info; + u32 reg1 = 0; + u32 val = 0; + + if (dm->support_ic_type & ODM_IC_11AC_SERIES) + reg1 = R_0x994; + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + reg1 = R_0x1e60; + #endif + else + reg1 = R_0x890; + if (!(dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8812F | + ODM_RTL8197G))) + odm_set_bb_reg(dm, reg1, BIT(0), 0x0); + if (!(phydm_clm_check_rdy(dm))) { + PHYDM_DBG(dm, DBG_ENV_MNTR, "Get CLM report Fail\n"); + phydm_clm_racing_release(dm); + return false; + } + + if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + val = odm_get_bb_reg(dm, R_0xfa4, MASKLWORD); + ccx_info->clm_result = (u16)val; + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + val = odm_get_bb_reg(dm, R_0x2d88, MASKLWORD); + ccx_info->clm_result = (u16)val; + #endif + } else if (dm->support_ic_type & ODM_IC_11N_SERIES) { + val = odm_get_bb_reg(dm, R_0x8d0, MASKLWORD); + ccx_info->clm_result = (u16)val; + } + + PHYDM_DBG(dm, DBG_ENV_MNTR, "CLM result = %d *4 us\n", + ccx_info->clm_result); + phydm_clm_racing_release(dm); + return true; +} + +void phydm_clm_mntr_fw(void *dm_void, u16 monitor_time /*unit ms*/) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx = &dm->dm_ccx_info; + u32 val = 0; + + /*@[Get CLM report]*/ + if (ccx->clm_fw_result_cnt != 0) { + val = ccx->clm_fw_result_acc / ccx->clm_fw_result_cnt; + ccx->clm_ratio = (u8)val; + } else { + ccx->clm_ratio = 0; + } + + PHYDM_DBG(dm, DBG_ENV_MNTR, + "clm_fw_result_acc=%d, clm_fw_result_cnt=%d\n", + ccx->clm_fw_result_acc, ccx->clm_fw_result_cnt); + + ccx->clm_fw_result_acc = 0; + ccx->clm_fw_result_cnt = 0; + + /*@[CLM trigger]*/ + if (monitor_time >= 262) + ccx->clm_period = 65535; + else + ccx->clm_period = monitor_time * MS_TO_4US_RATIO; + + phydm_clm_h2c(dm, ccx->clm_period, true); +} + +u8 phydm_clm_mntr_set(void *dm_void, struct clm_para_info *clm_para) +{ + /*@Driver Monitor CLM*/ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx = &dm->dm_ccx_info; + u16 clm_period = 0; + + if (clm_para->mntr_time == 0) + return PHYDM_SET_FAIL; + + if (clm_para->clm_lv >= CLM_MAX_NUM) { + PHYDM_DBG(dm, DBG_ENV_MNTR, "[WARNING] Wrong LV=%d\n", + clm_para->clm_lv); + return PHYDM_SET_FAIL; + } + + if (phydm_clm_racing_ctrl(dm, clm_para->clm_lv) == PHYDM_SET_FAIL) + return PHYDM_SET_FAIL; + + if (clm_para->mntr_time >= 262) + clm_period = CLM_PERIOD_MAX; + else + clm_period = clm_para->mntr_time * MS_TO_4US_RATIO; + + ccx->clm_app = clm_para->clm_app; + phydm_clm_setting(dm, clm_period); + + return PHYDM_SET_SUCCESS; +} + +boolean +phydm_clm_mntr_chk(void *dm_void, u16 monitor_time /*unit ms*/) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx = &dm->dm_ccx_info; + struct clm_para_info clm_para = {0}; + boolean clm_chk_result = false; + u32 sys_return_time = 0; + + PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s] ======>\n", __func__); + if (ccx->clm_manual_ctrl) { + PHYDM_DBG(dm, DBG_ENV_MNTR, "CLM in manual ctrl\n"); + return clm_chk_result; + } + + sys_return_time = ccx->clm_trigger_time + MAX_ENV_MNTR_TIME; + + if (ccx->clm_app != CLM_BACKGROUND && + sys_return_time > dm->phydm_sys_up_time) { + PHYDM_DBG(dm, DBG_ENV_MNTR, "trigger_time %d, sys_time=%d\n", + ccx->clm_trigger_time, dm->phydm_sys_up_time); + + return clm_chk_result; + } + + clm_para.clm_app = CLM_BACKGROUND; + clm_para.clm_lv = CLM_LV_1; + clm_para.mntr_time = monitor_time; + if (ccx->clm_mntr_mode == CLM_DRIVER_MNTR) { + /*@[Get CLM report]*/ + if (phydm_clm_get_result(dm)) { + PHYDM_DBG(dm, DBG_ENV_MNTR, "Get CLM_rpt success\n"); + phydm_clm_get_utility(dm); + } + + /*@[CLM trigger]----------------------------------------------*/ + if (phydm_clm_mntr_set(dm, &clm_para) == PHYDM_SET_SUCCESS) + clm_chk_result = true; + } else { + phydm_clm_mntr_fw(dm, monitor_time); + } + + PHYDM_DBG(dm, DBG_ENV_MNTR, "clm_ratio=%d\n", ccx->clm_ratio); + + /*@PHYDM_DBG(dm, DBG_ENV_MNTR, "clm_chk_result=%d\n",clm_chk_result);*/ + + return clm_chk_result; +} + +void phydm_set_clm_mntr_mode(void *dm_void, enum clm_monitor_mode mode) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx_info = &dm->dm_ccx_info; + + if (ccx_info->clm_mntr_mode != mode) { + ccx_info->clm_mntr_mode = mode; + phydm_ccx_hw_restart(dm); + + if (mode == CLM_DRIVER_MNTR) + phydm_clm_h2c(dm, 0, 0); + } +} + +void phydm_clm_init(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx = &dm->dm_ccx_info; + + PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); + ccx->clm_ongoing = false; + ccx->clm_manual_ctrl = 0; + ccx->clm_mntr_mode = CLM_DRIVER_MNTR; + ccx->clm_period = 0; + ccx->clm_rpt_stamp = 0; + phydm_clm_setting(dm, 65535); +} + +void phydm_clm_dbg(void *dm_void, char input[][16], u32 *_used, char *output, + u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx = &dm->dm_ccx_info; + char help[] = "-h"; + u32 var1[10] = {0}; + u32 used = *_used; + u32 out_len = *_out_len; + struct clm_para_info clm_para = {0}; + u32 i; + + for (i = 0; i < 4; i++) { + if (input[i + 1]) + PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); + } + + if ((strcmp(input[1], help) == 0)) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "CLM Driver Basic-Trigger 262ms: {1}\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "CLM Driver Adv-Trigger: {2} {app} {LV} {0~262ms}\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "CLM FW Trigger: {3} {1:drv, 2:fw}\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "CLM Get Result: {100}\n"); + } else if (var1[0] == 100) { /* @Get CLM results */ + + if (phydm_clm_get_result(dm)) + phydm_clm_get_utility(dm); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "clm_rpt_stamp=%d\n", ccx->clm_rpt_stamp); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "clm_ratio:((%d percent)) = (%d us/ %d us)\n", + ccx->clm_ratio, ccx->clm_result << 2, + ccx->clm_period << 2); + + ccx->clm_manual_ctrl = 0; + + } else if (var1[0] == 3) { + phydm_set_clm_mntr_mode(dm, (enum clm_monitor_mode)var1[1]); + PDM_SNPF(out_len, used, output + used, out_len - used, + "CLM mode: %s mode\n", + ((ccx->clm_mntr_mode == CLM_FW_MNTR) ? "FW" : "Drv")); + } else { /* Set & trigger CLM */ + ccx->clm_manual_ctrl = 1; + + if (var1[0] == 1) { + clm_para.clm_app = CLM_BACKGROUND; + clm_para.clm_lv = CLM_LV_4; + clm_para.mntr_time = 262; + ccx->clm_mntr_mode = CLM_DRIVER_MNTR; + + } else if (var1[0] == 2) { + clm_para.clm_app = (enum clm_application)var1[1]; + clm_para.clm_lv = (enum phydm_clm_level)var1[2]; + ccx->clm_mntr_mode = CLM_DRIVER_MNTR; + clm_para.mntr_time = (u16)var1[3]; + + } + + PDM_SNPF(out_len, used, output + used, out_len - used, + "app=%d, lv=%d, mode=%s, time=%d ms\n", + clm_para.clm_app, clm_para.clm_lv, + ((ccx->clm_mntr_mode == CLM_FW_MNTR) ? "FW" : + "driver"), clm_para.mntr_time); + + if (phydm_clm_mntr_set(dm, &clm_para) == PHYDM_SET_SUCCESS) + phydm_clm_trigger(dm); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "clm_rpt_stamp=%d\n", ccx->clm_rpt_stamp); + } + + *_used = used; + *_out_len = out_len; +} + +#endif /*@#ifdef CLM_SUPPORT*/ + +u8 phydm_env_mntr_trigger(void *dm_void, struct nhm_para_info *nhm_para, + struct clm_para_info *clm_para, + struct env_trig_rpt *trig_rpt) +{ +#if (defined(NHM_SUPPORT) && defined(CLM_SUPPORT)) + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx = &dm->dm_ccx_info; + boolean nhm_set_ok = false; + boolean clm_set_ok = false; + u8 trigger_result = 0; + + PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s] ======>\n", __func__); + +#if (ENV_MNTR_DBG_2) + if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + PHYDM_DBG(dm, DBG_ENV_MNTR, + "[DBG][2] 0xc50=0x%x, 0x994=0x%x, 0x998=0x%x\n", + odm_get_bb_reg(dm, R_0xc50, MASKDWORD), + odm_get_bb_reg(dm, R_0x994, MASKDWORD), + odm_get_bb_reg(dm, R_0x998, MASKDWORD)); + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + PHYDM_DBG(dm, DBG_ENV_MNTR, + "[DBG][2] 0x1d70=0x%x, 0x1e60=0x%x, 0x1e44=0x%x\n", + odm_get_bb_reg(dm, R_0x1d70, MASKDWORD), + odm_get_bb_reg(dm, R_0x1e60, MASKDWORD), + odm_get_bb_reg(dm, R_0x1e44, MASKDWORD)); + #endif + } +#endif + + /*@[NHM]*/ + nhm_set_ok = phydm_nhm_mntr_set(dm, nhm_para); + + /*@[CLM]*/ + if (ccx->clm_mntr_mode == CLM_DRIVER_MNTR) { + clm_set_ok = phydm_clm_mntr_set(dm, clm_para); + } else if (ccx->clm_mntr_mode == CLM_FW_MNTR) { + phydm_clm_h2c(dm, CLM_PERIOD_MAX, true); + trigger_result |= CLM_SUCCESS; + } + + if (nhm_set_ok) { + phydm_nhm_trigger(dm); + trigger_result |= NHM_SUCCESS; + } + + if (clm_set_ok) { + phydm_clm_trigger(dm); + trigger_result |= CLM_SUCCESS; + } + + /*@monitor for the test duration*/ + ccx->start_time = odm_get_current_time(dm); + + trig_rpt->nhm_rpt_stamp = ccx->nhm_rpt_stamp; + trig_rpt->clm_rpt_stamp = ccx->clm_rpt_stamp; + + PHYDM_DBG(dm, DBG_ENV_MNTR, "nhm_rpt_stamp=%d, clm_rpt_stamp=%d,\n\n", + trig_rpt->nhm_rpt_stamp, trig_rpt->clm_rpt_stamp); + + return trigger_result; +#endif +} + +u8 phydm_env_mntr_result(void *dm_void, struct env_mntr_rpt *rpt) +{ +#if (defined(NHM_SUPPORT) && defined(CLM_SUPPORT)) + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx = &dm->dm_ccx_info; + u8 env_mntr_rpt = 0; + u64 progressing_time = 0; + u32 val_tmp = 0; + + /*@monitor for the test duration*/ + progressing_time = odm_get_progressing_time(dm, ccx->start_time); + PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s] ======>\n", __func__); + PHYDM_DBG(dm, DBG_ENV_MNTR, "env_time=%lld\n", progressing_time); + +#if (ENV_MNTR_DBG_2) + if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + PHYDM_DBG(dm, DBG_ENV_MNTR, + "[DBG][2] 0xc50=0x%x, 0x994=0x%x, 0x998=0x%x\n", + odm_get_bb_reg(dm, R_0xc50, MASKDWORD), + odm_get_bb_reg(dm, R_0x994, MASKDWORD), + odm_get_bb_reg(dm, R_0x998, MASKDWORD)); + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + PHYDM_DBG(dm, DBG_ENV_MNTR, + "[DBG][2] 0x1d70=0x%x, 0x1e60=0x%x, 0x1e44=0x%x\n", + odm_get_bb_reg(dm, R_0x1d70, MASKDWORD), + odm_get_bb_reg(dm, R_0x1e60, MASKDWORD), + odm_get_bb_reg(dm, R_0x1e44, MASKDWORD)); + #endif + } +#endif + + /*@Get NHM result*/ + if (phydm_nhm_get_result(dm)) { + PHYDM_DBG(dm, DBG_ENV_MNTR, "Get NHM_rpt success\n"); + phydm_nhm_get_utility(dm); + rpt->nhm_ratio = ccx->nhm_ratio; + env_mntr_rpt |= NHM_SUCCESS; + + odm_move_memory(dm, &rpt->nhm_result[0], + &ccx->nhm_result[0], NHM_RPT_NUM); + } else { + rpt->nhm_ratio = ENV_MNTR_FAIL; + } + + /*@Get CLM result*/ + if (ccx->clm_mntr_mode == CLM_DRIVER_MNTR) { + if (phydm_clm_get_result(dm)) { + PHYDM_DBG(dm, DBG_ENV_MNTR, "Get CLM_rpt success\n"); + phydm_clm_get_utility(dm); + env_mntr_rpt |= CLM_SUCCESS; + rpt->clm_ratio = ccx->clm_ratio; + } else { + rpt->clm_ratio = ENV_MNTR_FAIL; + } + + } else { + if (ccx->clm_fw_result_cnt != 0) { + val_tmp = ccx->clm_fw_result_acc + / ccx->clm_fw_result_cnt; + ccx->clm_ratio = (u8)val_tmp; + } else { + ccx->clm_ratio = 0; + } + + rpt->clm_ratio = ccx->clm_ratio; + PHYDM_DBG(dm, DBG_ENV_MNTR, + "clm_fw_result_acc=%d, clm_fw_result_cnt=%d\n", + ccx->clm_fw_result_acc, ccx->clm_fw_result_cnt); + + ccx->clm_fw_result_acc = 0; + ccx->clm_fw_result_cnt = 0; + env_mntr_rpt |= CLM_SUCCESS; + } + + rpt->nhm_rpt_stamp = ccx->nhm_rpt_stamp; + rpt->clm_rpt_stamp = ccx->clm_rpt_stamp; + + PHYDM_DBG(dm, DBG_ENV_MNTR, + "IGI=0x%x, nhm_ratio=%d, clm_ratio=%d, nhm_rpt_stamp=%d, clm_rpt_stamp=%d\n\n", + ccx->nhm_igi, rpt->nhm_ratio, rpt->clm_ratio, + rpt->nhm_rpt_stamp, rpt->clm_rpt_stamp); + + return env_mntr_rpt; +#endif +} + +/*@Environment Monitor*/ +void phydm_env_mntr_watchdog(void *dm_void) +{ +#if (defined(NHM_SUPPORT) && defined(CLM_SUPPORT)) + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx = &dm->dm_ccx_info; + boolean nhm_chk_ok = false; + boolean clm_chk_ok = false; + + if (!(dm->support_ability & ODM_BB_ENV_MONITOR)) + return; + + PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); + nhm_chk_ok = phydm_nhm_mntr_chk(dm, 262); /*@monitor 262ms*/ + clm_chk_ok = phydm_clm_mntr_chk(dm, 262); /*@monitor 262ms*/ + + /*@PHYDM_DBG(dm, DBG_ENV_MNTR, "nhm_chk_ok %d\n\n",nhm_chk_ok);*/ + /*@PHYDM_DBG(dm, DBG_ENV_MNTR, "clm_chk_ok %d\n\n",clm_chk_ok);*/ + + if (nhm_chk_ok) + phydm_nhm_trigger(dm); + + if (clm_chk_ok) + phydm_clm_trigger(dm); + + PHYDM_DBG(dm, DBG_ENV_MNTR, + "Summary: nhm_ratio=((%d)) clm_ratio=((%d))\n\n", + ccx->nhm_ratio, ccx->clm_ratio); +#endif +} + +void phydm_env_monitor_init(void *dm_void) +{ +#if (defined(NHM_SUPPORT) && defined(CLM_SUPPORT)) + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (!(dm->support_ability & ODM_BB_ENV_MONITOR)) + return; + + PHYDM_DBG(dm, DBG_ENV_MNTR, "[%s]===>\n", __func__); + phydm_ccx_hw_restart(dm); + phydm_nhm_init(dm); + phydm_clm_init(dm); +#endif +} + +void phydm_env_mntr_dbg(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + char help[] = "-h"; + u32 var1[10] = {0}; + u32 used = *_used; + u32 out_len = *_out_len; + struct clm_para_info clm_para = {0}; + struct nhm_para_info nhm_para = {0}; + struct env_mntr_rpt rpt = {0}; + struct env_trig_rpt trig_rpt = {0}; + u8 set_result; + u8 i; + + PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); + + if ((strcmp(input[1], help) == 0)) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "Basic-Trigger 262ms: {1}\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "Get Result: {100}\n"); + } else if (var1[0] == 100) { /* @Get CLM results */ + + set_result = phydm_env_mntr_result(dm, &rpt); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "Set Result=%d\n nhm_ratio=%d clm_ratio=%d\n nhm_rpt_stamp=%d, clm_rpt_stamp=%d,\n", + set_result, rpt.nhm_ratio, rpt.clm_ratio, + rpt.nhm_rpt_stamp, rpt.clm_rpt_stamp); + + for (i = 0; i <= 11; i++) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "nhm_rpt[%d] = %d (%d percent)\n", i, + rpt.nhm_result[i], + (((rpt.nhm_result[i] * 100) + 128) >> 8)); + } + + } else { /* Set & trigger CLM */ + /*nhm para*/ + nhm_para.incld_txon = NHM_EXCLUDE_TXON; + nhm_para.incld_cca = NHM_EXCLUDE_CCA; + nhm_para.div_opt = NHM_CNT_ALL; + nhm_para.nhm_app = NHM_ACS; + nhm_para.nhm_lv = NHM_LV_2; + nhm_para.mntr_time = 262; + + /*@clm para*/ + clm_para.clm_app = CLM_ACS; + clm_para.clm_lv = CLM_LV_2; + clm_para.mntr_time = 262; + + set_result = phydm_env_mntr_trigger(dm, &nhm_para, + &clm_para, &trig_rpt); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "Set Result=%d, nhm_rpt_stamp=%d, clm_rpt_stamp=%d\n", + set_result, trig_rpt.nhm_rpt_stamp, + trig_rpt.clm_rpt_stamp); + } + + *_used = used; + *_out_len = out_len; +} + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_ccx.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_ccx.h index 123eaa5ae32b..132a553a479f 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_ccx.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_ccx.h @@ -1,103 +1,292 @@ /* SPDX-License-Identifier: GPL-2.0 */ -#ifndef __PHYDMCCX_H__ -#define __PHYDMCCX_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. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +#ifndef __PHYDMCCX_H__ +#define __PHYDMCCX_H__ + +#define CCX_VERSION "1.4" /* @ Remove r0 chk*/ + +/* @1 ============================================================ + * 1 Definition + * 1 ============================================================ + */ +#define ENV_MNTR_DBG 0 /*@debug for the HW processing time from NHM/CLM trigger and get result*/ +#define ENV_MNTR_DBG_1 0 /*@debug 8812A & 8821A P2P Fail to get result*/ +#define ENV_MNTR_DBG_2 0 /*@debug for read reister*/ #define CCX_EN 1 -#define SET_NHM_SETTING 0 -#define STORE_NHM_SETTING 1 -#define RESTORE_NHM_SETTING 2 +#define MAX_ENV_MNTR_TIME 8 /*second*/ +#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 +#define CLM_PERIOD_MAX 65535 +#define NHM_PERIOD_MAX 65534 +#define NHM_TH_NUM 11 /*threshold number of NHM*/ +#define NHM_RPT_NUM 12 +#ifdef NHM_DYM_PW_TH_SUPPORT +#define DYM_PWTH_CCA_CAP 25 +#define NHM_1PEAK_PS 1 /* @case1 : positive skew*/ +#define NHM_1PEAK_NS 2 /* @case2 : negative skew*/ +#define NHM_1PEAK_SYM 3 /* @case3 : symmetry*/ +#define NHM_TH1 33 /* @13%, for step2 decision*/ +#define NHM_TH2 35 /* @14%, for step3_c1_c2 decision*/ +#define NHM_TH3 31 /* @12%, for step3_c3 decision*/ +#define NHM_TH4 178 /* @70%, for step4 decision*/ +#define NHM_TH5 25 /* @10%, for step5_c1_c2 decision*/ +#define NHM_TH6 39 /* @15%, for step5_c3 decision*/ +#endif -/* -#define NHM_EXCLUDE_CCA 0 -#define NHM_INCLUDE_CCA 1 -#define NHM_EXCLUDE_TXON 0 -#define NHM_INCLUDE_TXON 1 -*/ +#define IGI_2_NHM_TH(igi) ((igi) << 1)/*NHM_threshold = IGI * 2*/ +#define NTH_TH_2_RSSI(th) ((th >> 1) - 10) -enum nhm_inexclude_cca { - NHM_EXCLUDE_CCA, - NHM_INCLUDE_CCA +/*@FAHM*/ +#define FAHM_INCLD_FA BIT(0) +#define FAHM_INCLD_CRC_OK BIT(1) +#define FAHM_INCLD_CRC_ER BIT(2) + +#define NHM_SUCCESS BIT(0) +#define CLM_SUCCESS BIT(1) +#define FAHM_SUCCESS BIT(2) +#define ENV_MNTR_FAIL 0xff + +/* @1 ============================================================ + * 1 enumrate + * 1 ============================================================ + */ +enum phydm_clm_level { + CLM_RELEASE = 0, + CLM_LV_1 = 1, /* @Low Priority function */ + CLM_LV_2 = 2, /* @Middle Priority function */ + CLM_LV_3 = 3, /* @High priority function (ex: Check hang function) */ + CLM_LV_4 = 4, /* @Debug function (the highest priority) */ + CLM_MAX_NUM = 5 }; -enum nhm_inexclude_txon { - NHM_EXCLUDE_TXON, - NHM_INCLUDE_TXON +enum phydm_nhm_level { + NHM_RELEASE = 0, + NHM_LV_1 = 1, /* @Low Priority function */ + NHM_LV_2 = 2, /* @Middle Priority function */ + NHM_LV_3 = 3, /* @High priority function (ex: Check hang function) */ + NHM_LV_4 = 4, /* @Debug function (the highest priority) */ + NHM_MAX_NUM = 5 +}; + +enum nhm_divider_opt_all { + NHM_CNT_ALL = 0, /*nhm SUM report <= 255*/ + NHM_VALID = 1, /*nhm SUM report = 255*/ + NHM_CNT_INIT +}; + +enum nhm_setting { + SET_NHM_SETTING, + STORE_NHM_SETTING, + RESTORE_NHM_SETTING +}; + +enum nhm_option_cca_all { + NHM_EXCLUDE_CCA = 0, + NHM_INCLUDE_CCA = 1, + NHM_CCA_INIT +}; + +enum nhm_option_txon_all { + NHM_EXCLUDE_TXON = 0, + NHM_INCLUDE_TXON = 1, + NHM_TXON_INIT +}; + +enum nhm_application { + NHM_BACKGROUND = 0,/*@default*/ + NHM_ACS = 1, + IEEE_11K_HIGH = 2, + IEEE_11K_LOW = 3, + INTEL_XBOX = 4, + NHM_DBG = 5, /*@manual trigger*/ +}; + +enum clm_application { + CLM_BACKGROUND = 0,/*@default*/ + CLM_ACS = 1, +}; + +enum clm_monitor_mode { + CLM_DRIVER_MNTR = 1, + CLM_FW_MNTR = 2 +}; + +/* @1 ============================================================ + * 1 structure + * 1 ============================================================ + */ +struct env_trig_rpt { + u8 nhm_rpt_stamp; + u8 clm_rpt_stamp; }; -struct _CCX_INFO { +struct env_mntr_rpt { + u8 nhm_ratio; + u8 nhm_result[NHM_RPT_NUM]; + u8 clm_ratio; + u8 nhm_rpt_stamp; + u8 clm_rpt_stamp; +}; - /*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; +struct nhm_para_info { + enum nhm_option_txon_all incld_txon; /*@Include TX on*/ + enum nhm_option_cca_all incld_cca; /*@Include CCA*/ + enum nhm_divider_opt_all div_opt; /*@divider option*/ + enum nhm_application nhm_app; + enum phydm_nhm_level nhm_lv; + u16 mntr_time; /*@0~262 unit ms*/ - /*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; +}; +struct clm_para_info { + enum clm_application clm_app; + enum phydm_clm_level clm_lv; + u16 mntr_time; /*@0~262 unit ms*/ +}; + +struct ccx_info { + u32 nhm_trigger_time; + u32 clm_trigger_time; + u64 start_time; /*@monitor for the test duration*/ +#ifdef NHM_SUPPORT + enum nhm_application nhm_app; + enum nhm_option_txon_all nhm_include_txon; + enum nhm_option_cca_all nhm_include_cca; + enum nhm_divider_opt_all nhm_divider_opt; /*Report*/ - u8 NHM_result[12]; - u16 NHM_duration; - u16 CLM_result; - - - bool echo_NHM_en; - bool echo_CLM_en; - u8 echo_IGI; + u8 nhm_th[NHM_TH_NUM]; + u8 nhm_result[NHM_RPT_NUM]; + u16 nhm_period; /* @4us per unit */ + u8 nhm_igi; + u8 nhm_manual_ctrl; + u8 nhm_ratio; /*@1% per nuit, it means the interference igi can't overcome.*/ + u8 nhm_rpt_sum; + u16 nhm_duration; /*@Real time of NHM_VALID */ + u8 nhm_set_lv; + boolean nhm_ongoing; + u8 nhm_rpt_stamp; +#ifdef NHM_DYM_PW_TH_SUPPORT + boolean nhm_dym_pw_th_en; + boolean nhm_dym_1_peak_en; + u8 nhm_pw_th_rf20_dft; + u8 nhm_pw_th_max; + u8 nhm_period_decre; + u8 nhm_sl_pw_th; +#endif +#endif +#ifdef CLM_SUPPORT + enum clm_application clm_app; + u8 clm_manual_ctrl; + u8 clm_set_lv; + boolean clm_ongoing; + u16 clm_period; /* @4us per unit */ + u16 clm_result; + u8 clm_ratio; + u32 clm_fw_result_acc; + u8 clm_fw_result_cnt; + enum clm_monitor_mode clm_mntr_mode; + u8 clm_rpt_stamp; +#endif +#ifdef FAHM_SUPPORT + boolean fahm_ongoing; + u8 env_mntr_igi; + u8 fahm_nume_sel; /*@fahm_numerator_sel: select {FA, CRCOK, CRC_fail} */ + u8 fahm_denom_sel; /*@fahm_denominator_sel: select {FA, CRCOK, CRC_fail} */ + u16 fahm_period; /*unit: 4us*/ +#endif }; -/*NHM*/ +/* @1 ============================================================ + * 1 Function Prototype + * 1 ============================================================ + */ -void -phydm_nhm_setting( - void *p_dm_void, - u8 nhm_setting -); +#ifdef FAHM_SUPPORT -void -phydm_nhm_trigger( - void *p_dm_void -); - -void -phydm_get_nhm_result( - void *p_dm_void -); - -bool -phydm_check_nhm_ready( - void *p_dm_void -); - -/*CLM*/ - -void -phydm_clm_setting( - void *p_dm_void -); - -void -phydm_clm_trigger( - void *p_dm_void -); - -bool -phydm_check_cl_mready( - void *p_dm_void -); - -void -phydm_get_cl_mresult( - void *p_dm_void -); +void phydm_fahm_init(void *dm_void); +void phydm_fahm_dbg(void *dm_void, char input[][16], u32 *_used, char *output, + u32 *_out_len); + +#endif + +/*@NHM*/ +#ifdef NHM_SUPPORT +void phydm_nhm_trigger(void *dm_void); + +void phydm_nhm_init(void *dm_void); + +void phydm_nhm_dbg(void *dm_void, char input[][16], u32 *_used, char *output, + u32 *_out_len); +u8 phydm_get_igi(void *dm_void, enum bb_path path); +#endif + +/*@CLM*/ +#ifdef CLM_SUPPORT +void phydm_clm_c2h_report_handler(void *dm_void, u8 *cmd_buf, u8 cmd_len); + +void phydm_clm_h2c(void *dm_void, u16 obs_time, u8 fw_clm_en); + +void phydm_clm_setting(void *dm_void, u16 clm_period); + +void phydm_clm_trigger(void *dm_void); + +boolean phydm_clm_check_rdy(void *dm_void); + +void phydm_clm_get_utility(void *dm_void); + +boolean phydm_clm_get_result(void *dm_void); + +u8 phydm_clm_mntr_set(void *dm_void, struct clm_para_info *clm_para); + +void phydm_set_clm_mntr_mode(void *dm_void, enum clm_monitor_mode mode); + +void phydm_clm_dbg(void *dm_void, char input[][16], u32 *_used, char *output, + u32 *_out_len); +#endif + +u8 phydm_env_mntr_trigger(void *dm_void, struct nhm_para_info *nhm_para, + struct clm_para_info *clm_para, + struct env_trig_rpt *rpt); + +u8 phydm_env_mntr_result(void *dm_void, struct env_mntr_rpt *rpt); + +void phydm_env_mntr_watchdog(void *dm_void); + +void phydm_env_monitor_init(void *dm_void); + +void phydm_env_mntr_dbg(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len); #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_cfotracking.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_cfotracking.c index 8eafb3a86695..ca870a7491d0 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_cfotracking.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_cfotracking.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,353 +9,589 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ #include "mp_precomp.h" #include "phydm_precomp.h" -void -odm_set_crystal_cap( - void *p_dm_void, - u8 crystal_cap -) +s32 phydm_get_cfo_hz(void *dm_void, u32 val, u8 bit_num, u8 frac_num) { -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _CFO_TRACKING_ *p_cfo_track = (struct _CFO_TRACKING_ *)phydm_get_structure(p_dm_odm, PHYDM_CFOTRACK); + s32 val_s = 0; - if (p_cfo_track->crystal_cap == crystal_cap) - return; + val_s = phydm_cnvrt_2_sign(val, bit_num); - p_cfo_track->crystal_cap = crystal_cap; + if (frac_num == 10) /*@ (X*312500)/1024 ~= X*305*/ + val_s *= 305; + else if (frac_num == 11) /*@ (X*312500)/2048 ~= X*152*/ + val_s *= 152; + else if (frac_num == 12) /*@ (X*312500)/4096 ~= X*76*/ + val_s *= 76; - if (p_dm_odm->support_ic_type & (ODM_RTL8188E | ODM_RTL8188F)) { - /* write 0x24[22:17] = 0x24[16:11] = crystal_cap */ - crystal_cap = crystal_cap & 0x3F; - odm_set_bb_reg(p_dm_odm, REG_AFE_XTAL_CTRL, 0x007ff800, (crystal_cap | (crystal_cap << 6))); - } else if (p_dm_odm->support_ic_type & ODM_RTL8812) { - /* write 0x2C[30:25] = 0x2C[24:19] = crystal_cap */ - crystal_cap = crystal_cap & 0x3F; - odm_set_bb_reg(p_dm_odm, REG_MAC_PHY_CTRL, 0x7FF80000, (crystal_cap | (crystal_cap << 6))); - } else if ((p_dm_odm->support_ic_type & (ODM_RTL8703B | ODM_RTL8723B | ODM_RTL8192E | ODM_RTL8821))) { - /* 0x2C[23:18] = 0x2C[17:12] = crystal_cap */ - crystal_cap = crystal_cap & 0x3F; - odm_set_bb_reg(p_dm_odm, REG_MAC_PHY_CTRL, 0x00FFF000, (crystal_cap | (crystal_cap << 6))); - } else if (p_dm_odm->support_ic_type & ODM_RTL8814A) { - /* write 0x2C[26:21] = 0x2C[20:15] = crystal_cap */ - crystal_cap = crystal_cap & 0x3F; - odm_set_bb_reg(p_dm_odm, REG_MAC_PHY_CTRL, 0x07FF8000, (crystal_cap | (crystal_cap << 6))); - } else if (p_dm_odm->support_ic_type & (ODM_RTL8822B | ODM_RTL8821C)) { - /* write 0x24[30:25] = 0x28[6:1] = crystal_cap */ - crystal_cap = crystal_cap & 0x3F; - odm_set_bb_reg(p_dm_odm, REG_AFE_XTAL_CTRL, 0x7e000000, crystal_cap); - odm_set_bb_reg(p_dm_odm, REG_AFE_PLL_CTRL, 0x7e, crystal_cap); + return val_s; +} + +#if (ODM_IC_11AC_SERIES_SUPPORT) +void phydm_get_cfo_info_ac(void *dm_void, struct phydm_cfo_rpt *cfo) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 i = 0; + u32 val[4] = {0}; + u32 val_1[4] = {0}; + u32 val_2[4] = {0}; + u32 val_tmp = 0; + + val[0] = odm_read_4byte(dm, R_0xd0c); + val_1[0] = odm_read_4byte(dm, R_0xd10); + val_2[0] = odm_get_bb_reg(dm, R_0xd14, 0x1fff0000); + + #if (defined(PHYDM_COMPILE_ABOVE_2SS)) + val[1] = odm_read_4byte(dm, R_0xd4c); + val_1[1] = odm_read_4byte(dm, R_0xd50); + val_2[1] = odm_get_bb_reg(dm, R_0xd54, 0x1fff0000); + #endif + + #if (defined(PHYDM_COMPILE_ABOVE_3SS)) + val[2] = odm_read_4byte(dm, R_0xd8c); + val_1[2] = odm_read_4byte(dm, R_0xd90); + val_2[2] = odm_get_bb_reg(dm, R_0xd94, 0x1fff0000); + #endif + + #if (defined(PHYDM_COMPILE_ABOVE_4SS)) + val[3] = odm_read_4byte(dm, R_0xdcc); + val_1[3] = odm_read_4byte(dm, R_0xdd0); + val_2[3] = odm_get_bb_reg(dm, R_0xdd4, 0x1fff0000); + #endif + + for (i = 0; i < dm->num_rf_path; i++) { + val_tmp = val[i] & 0xfff; /*@ Short CFO, S(12,11)*/ + cfo->cfo_rpt_s[i] = phydm_get_cfo_hz(dm, val_tmp, 12, 11); + + val_tmp = val[i] >> 16; /*@ Long CFO, S(13,12)*/ + cfo->cfo_rpt_l[i] = phydm_get_cfo_hz(dm, val_tmp, 13, 12); + + val_tmp = val_1[i] & 0x7ff; /*@ SCFO, S(11,10)*/ + cfo->cfo_rpt_sec[i] = phydm_get_cfo_hz(dm, val_tmp, 11, 10); + + val_tmp = val_1[i] >> 16; /*@ Acq CFO, S(13,12)*/ + cfo->cfo_rpt_acq[i] = phydm_get_cfo_hz(dm, val_tmp, 13, 12); + + val_tmp = val_2[i]; /*@ End CFO, S(13,12)*/ + cfo->cfo_rpt_end[i] = phydm_get_cfo_hz(dm, val_tmp, 13, 12); + } +} +#endif + +#if (ODM_IC_11N_SERIES_SUPPORT) +void phydm_get_cfo_info_n(void *dm_void, struct phydm_cfo_rpt *cfo) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 val[5] = {0}; + u32 val_tmp = 0; + + odm_set_bb_reg(dm, R_0xd00, BIT(26), 1); + + val[0] = odm_read_4byte(dm, R_0xdac); /*@ Short CFO*/ + val[1] = odm_read_4byte(dm, R_0xdb0); /*@ Long CFO*/ + val[2] = odm_read_4byte(dm, R_0xdb8); /*@ Sec CFO*/ + val[3] = odm_read_4byte(dm, R_0xde0); /*@ Acq CFO*/ + val[4] = odm_read_4byte(dm, R_0xdbc); /*@ End CFO*/ + + /*@[path-A]*/ + if (dm->support_ic_type == ODM_RTL8721D) { + val_tmp = (val[0] & 0x0fff0000) >> 16; /*@ Short CFO, S(12,11)*/ + cfo->cfo_rpt_s[0] = phydm_get_cfo_hz(dm, val_tmp, 12, 11); + val_tmp = (val[1] & 0x0fff0000) >> 16; /*@ Long CFO, S(12,11)*/ + cfo->cfo_rpt_l[0] = phydm_get_cfo_hz(dm, val_tmp, 12, 11); + val_tmp = (val[2] & 0x0fff0000) >> 16; /*@ Sec CFO, S(12,11)*/ + cfo->cfo_rpt_sec[0] = phydm_get_cfo_hz(dm, val_tmp, 12, 11); + val_tmp = (val[3] & 0x0fff0000) >> 16; /*@ Acq CFO, S(12,11)*/ + cfo->cfo_rpt_acq[0] = phydm_get_cfo_hz(dm, val_tmp, 12, 11); + val_tmp = (val[4] & 0x0fff0000) >> 16; /*@ Acq CFO, S(12,11)*/ + cfo->cfo_rpt_end[0] = phydm_get_cfo_hz(dm, val_tmp, 12, 11); } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("odm_set_crystal_cap(): Use default setting.\n")); - odm_set_bb_reg(p_dm_odm, REG_MAC_PHY_CTRL, 0xFFF000, (crystal_cap | (crystal_cap << 6))); + val_tmp = (val[0] & 0x0fff0000) >> 16; /*@ Short CFO, S(12,11)*/ + cfo->cfo_rpt_s[0] = phydm_get_cfo_hz(dm, val_tmp, 12, 11); + val_tmp = (val[1] & 0x1fff0000) >> 16; /*@ Long CFO, S(13,12)*/ + cfo->cfo_rpt_l[0] = phydm_get_cfo_hz(dm, val_tmp, 13, 12); + val_tmp = (val[2] & 0x7ff0000) >> 16; /*@ Sec CFO, S(11,10)*/ + cfo->cfo_rpt_sec[0] = phydm_get_cfo_hz(dm, val_tmp, 11, 10); + val_tmp = (val[3] & 0x1fff0000) >> 16; /*@ Acq CFO, S(13,12)*/ + cfo->cfo_rpt_acq[0] = phydm_get_cfo_hz(dm, val_tmp, 13, 12); + val_tmp = (val[4] & 0x1fff0000) >> 16; /*@ Acq CFO, S(13,12)*/ + cfo->cfo_rpt_end[0] = phydm_get_cfo_hz(dm, val_tmp, 13, 12); } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("odm_set_crystal_cap(): crystal_cap = 0x%x\n", crystal_cap)); -#endif + #if (defined(PHYDM_COMPILE_ABOVE_2SS)) + /*@[path-B]*/ + val_tmp = val[0] & 0xfff; /*@ Short CFO, S(12,11)*/ + cfo->cfo_rpt_s[1] = phydm_get_cfo_hz(dm, val_tmp, 12, 11); + val_tmp = val[1] & 0x1fff; /*@ Long CFO, S(13,12)*/ + cfo->cfo_rpt_l[1] = phydm_get_cfo_hz(dm, val_tmp, 13, 12); + val_tmp = val[2] & 0x7ff; /*@ Sec CFO, S(11,10)*/ + cfo->cfo_rpt_sec[1] = phydm_get_cfo_hz(dm, val_tmp, 11, 10); + val_tmp = val[3] & 0x1fff; /*@ Acq CFO, S(13,12)*/ + cfo->cfo_rpt_acq[1] = phydm_get_cfo_hz(dm, val_tmp, 13, 12); + val_tmp = val[4] & 0x1fff; /*@ Acq CFO, S(13,12)*/ + cfo->cfo_rpt_end[1] = phydm_get_cfo_hz(dm, val_tmp, 13, 12); + #endif } -u8 -odm_get_default_crytaltal_cap( - void *p_dm_void -) +void phydm_set_atc_status(void *dm_void, boolean atc_status) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 crystal_cap = 0x20; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_cfo_track_struct *cfo_track = &dm->dm_cfo_track; + u32 reg_tmp = 0; + u32 mask_tmp = 0; -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - struct _ADAPTER *adapter = p_dm_odm->adapter; - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + PHYDM_DBG(dm, DBG_CFO_TRK, "[%s]ATC_en=%d\n", __func__, atc_status); - crystal_cap = p_hal_data->crystal_cap; -#else - struct rtl8192cd_priv *priv = p_dm_odm->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, - bool atc_status -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _CFO_TRACKING_ *p_cfo_track = (struct _CFO_TRACKING_ *)phydm_get_structure(p_dm_odm, PHYDM_CFOTRACK); - - if (p_cfo_track->is_atc_status == atc_status) + if (cfo_track->is_atc_status == atc_status) return; - odm_set_bb_reg(p_dm_odm, ODM_REG(BB_ATC, p_dm_odm), ODM_BIT(BB_ATC, p_dm_odm), atc_status); - p_cfo_track->is_atc_status = atc_status; + reg_tmp = ODM_REG(BB_ATC, dm); + mask_tmp = ODM_BIT(BB_ATC, dm); + odm_set_bb_reg(dm, reg_tmp, mask_tmp, atc_status); + cfo_track->is_atc_status = atc_status; } -bool -odm_get_atc_status( - void *p_dm_void -) +boolean +phydm_get_atc_status(void *dm_void) { - bool atc_status; - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + boolean atc_status = false; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 reg_tmp = 0; + u32 mask_tmp = 0; - atc_status = (bool)odm_get_bb_reg(p_dm_odm, ODM_REG(BB_ATC, p_dm_odm), ODM_BIT(BB_ATC, p_dm_odm)); + reg_tmp = ODM_REG(BB_ATC, dm); + mask_tmp = ODM_BIT(BB_ATC, dm); + + atc_status = (boolean)odm_get_bb_reg(dm, reg_tmp, mask_tmp); + + PHYDM_DBG(dm, DBG_CFO_TRK, "[%s]atc_status=%d\n", __func__, atc_status); return atc_status; } - -void -odm_cfo_tracking_reset( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _CFO_TRACKING_ *p_cfo_track = (struct _CFO_TRACKING_ *)phydm_get_structure(p_dm_odm, PHYDM_CFOTRACK); - - p_cfo_track->def_x_cap = odm_get_default_crytaltal_cap(p_dm_odm); - p_cfo_track->is_adjust = true; - - if (p_cfo_track->crystal_cap > p_cfo_track->def_x_cap) { - odm_set_crystal_cap(p_dm_odm, p_cfo_track->crystal_cap - 1); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, - ("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) { - odm_set_crystal_cap(p_dm_odm, p_cfo_track->crystal_cap + 1); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, - ("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_odm, true); #endif + +void phydm_get_cfo_info(void *dm_void, struct phydm_cfo_rpt *cfo) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + switch (dm->ic_ip_series) { + #if (ODM_IC_11N_SERIES_SUPPORT) + case PHYDM_IC_N: + phydm_get_cfo_info_n(dm, cfo); + break; + #endif + #if (ODM_IC_11AC_SERIES_SUPPORT) + case PHYDM_IC_AC: + phydm_get_cfo_info_ac(dm, cfo); + break; + #endif + default: + break; + } } -void -odm_cfo_tracking_init( - void *p_dm_void -) +boolean +phydm_set_crystal_cap_reg(void *dm_void, u8 crystal_cap) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _CFO_TRACKING_ *p_cfo_track = (struct _CFO_TRACKING_ *)phydm_get_structure(p_dm_odm, PHYDM_CFOTRACK); + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_cfo_track_struct *cfo_track = &dm->dm_cfo_track; + u32 reg_val = 0; - p_cfo_track->def_x_cap = p_cfo_track->crystal_cap = odm_get_default_crytaltal_cap(p_dm_odm); - p_cfo_track->is_atc_status = odm_get_atc_status(p_dm_odm); - p_cfo_track->is_adjust = true; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking_init()=========>\n")); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("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_odm->support_ic_type & ODM_RTL8822B) - odm_set_bb_reg(p_dm_odm, 0x10, 0x40, 0x1); -#endif - -#if RTL8821C_SUPPORT - /* Crystal cap. control by WiFi */ - if (p_dm_odm->support_ic_type & ODM_RTL8821C) - odm_set_bb_reg(p_dm_odm, 0x10, 0x40, 0x1); -#endif -} - -void -odm_cfo_tracking( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _CFO_TRACKING_ *p_cfo_track = (struct _CFO_TRACKING_ *)phydm_get_structure(p_dm_odm, 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_odm->support_ability & ODM_BB_CFO_TRACKING)) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("odm_cfo_tracking(): Return: support_ability ODM_BB_CFO_TRACKING is disabled\n")); - return; - } - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("odm_cfo_tracking()=========>\n")); - - if (!p_dm_odm->is_linked || !p_dm_odm->is_one_entry_only) { - /* 4 No link or more than one entry */ - odm_cfo_tracking_reset(p_dm_odm); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("odm_cfo_tracking(): Reset: is_linked = %d, is_one_entry_only = %d\n", - p_dm_odm->is_linked, p_dm_odm->is_one_entry_only)); + if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8814B | + ODM_RTL8195B | ODM_RTL8812F | ODM_RTL8197G | ODM_RTL8721D)) { + crystal_cap &= 0x7F; + reg_val = crystal_cap | (crystal_cap << 7); } else { - /* 3 1. CFO Tracking */ - /* 4 1.1 No new packet */ - if (p_cfo_track->packet_count == p_cfo_track->packet_count_pre) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("odm_cfo_tracking(): packet counter doesn't change\n")); + crystal_cap &= 0x3F; + reg_val = crystal_cap | (crystal_cap << 6); + } + + cfo_track->crystal_cap = crystal_cap; + + if (dm->support_ic_type & (ODM_RTL8188E | ODM_RTL8188F)) { + #if (RTL8188E_SUPPORT || RTL8188F_SUPPORT) + /* write 0x24[22:17] = 0x24[16:11] = crystal_cap */ + odm_set_mac_reg(dm, R_0x24, 0x7ff800, reg_val); + #endif + } + #if (RTL8812A_SUPPORT) + else if (dm->support_ic_type & ODM_RTL8812) { + /* write 0x2C[30:25] = 0x2C[24:19] = crystal_cap */ + odm_set_mac_reg(dm, R_0x2c, 0x7FF80000, reg_val); + } + #endif + #if (RTL8703B_SUPPORT || RTL8723B_SUPPORT || RTL8192E_SUPPORT ||\ + RTL8821A_SUPPORT || RTL8723D_SUPPORT) + else if ((dm->support_ic_type & + (ODM_RTL8703B | ODM_RTL8723B | ODM_RTL8192E | ODM_RTL8821 | + ODM_RTL8723D))) { + /* @0x2C[23:18] = 0x2C[17:12] = crystal_cap */ + odm_set_mac_reg(dm, R_0x2c, 0x00FFF000, reg_val); + } + #endif + #if (RTL8814A_SUPPORT) + else if (dm->support_ic_type & ODM_RTL8814A) { + /* write 0x2C[26:21] = 0x2C[20:15] = crystal_cap */ + odm_set_mac_reg(dm, R_0x2c, 0x07FF8000, reg_val); + } + #endif + #if (RTL8822B_SUPPORT || RTL8821C_SUPPORT || RTL8197F_SUPPORT ||\ + RTL8192F_SUPPORT) + else if (dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8821C | + ODM_RTL8197F | ODM_RTL8192F)) { + /* write 0x24[30:25] = 0x28[6:1] = crystal_cap */ + odm_set_mac_reg(dm, R_0x24, 0x7e000000, crystal_cap); + odm_set_mac_reg(dm, R_0x28, 0x7e, crystal_cap); + } + #endif + #if (RTL8710B_SUPPORT) + else if (dm->support_ic_type & (ODM_RTL8710B)) { + #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + /* write 0x60[29:24] = 0x60[23:18] = crystal_cap */ + HAL_SetSYSOnReg(dm->adapter, R_0x60, 0x3FFC0000, reg_val); + #endif + } + #endif + #if (RTL8195B_SUPPORT) + else if (dm->support_ic_type & ODM_RTL8195B) { + phydm_set_crystalcap(dm, (u8)(reg_val & 0x7f)); + } + #endif + #if (RTL8721D_SUPPORT) + else if (dm->support_ic_type & (ODM_RTL8721D)) { + /* write 0x4800_0228[30:24] crystal_cap */ + /*HAL_SetSYSOnReg(dm->adapter, */ + /*REG_SYS_XTAL_8721d, 0x7F000000, crystal_cap);*/ + u32 temp_val = HAL_READ32(SYSTEM_CTRL_BASE_LP, + REG_SYS_EFUSE_SYSCFG2); + temp_val = ((crystal_cap << 24) & 0x7F000000) + | (temp_val & (~0x7F000000)); + HAL_WRITE32(SYSTEM_CTRL_BASE_LP, REG_SYS_EFUSE_SYSCFG2, + temp_val); + } + #endif +#if (RTL8822C_SUPPORT || RTL8814B_SUPPORT || RTL8812F_SUPPORT ||\ + RTL8197G_SUPPORT) + else if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8814B | + ODM_RTL8812F | ODM_RTL8197G)) { + /* write 0x1040[23:17] = 0x1040[16:10] = crystal_cap */ + odm_set_mac_reg(dm, R_0x1040, 0x00FFFC00, reg_val); + } else { + return false; + } +#endif + return true; +} + +void phydm_set_crystal_cap(void *dm_void, u8 crystal_cap) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_cfo_track_struct *cfo_track = &dm->dm_cfo_track; + + if (cfo_track->crystal_cap == crystal_cap) + return; + + if (phydm_set_crystal_cap_reg(dm, crystal_cap)) + PHYDM_DBG(dm, DBG_CFO_TRK, "Set crystal_cap = 0x%x\n", + cfo_track->crystal_cap); + else + PHYDM_DBG(dm, DBG_CFO_TRK, "Set fail\n"); +} + +void phydm_cfo_tracking_reset(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_cfo_track_struct *cfo_track = &dm->dm_cfo_track; + + PHYDM_DBG(dm, DBG_CFO_TRK, "%s ======>\n", __func__); + + if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8814B | ODM_RTL8195B | + ODM_RTL8812F | ODM_RTL8197G)) + cfo_track->def_x_cap = cfo_track->crystal_cap_default & 0x7f; + else + cfo_track->def_x_cap = cfo_track->crystal_cap_default & 0x3f; + + cfo_track->is_adjust = true; + + if (cfo_track->crystal_cap > cfo_track->def_x_cap) { + phydm_set_crystal_cap(dm, cfo_track->crystal_cap - 1); + PHYDM_DBG(dm, DBG_CFO_TRK, "approch to Init-val (0x%x)\n", + cfo_track->crystal_cap); + + } else if (cfo_track->crystal_cap < cfo_track->def_x_cap) { + phydm_set_crystal_cap(dm, cfo_track->crystal_cap + 1); + PHYDM_DBG(dm, DBG_CFO_TRK, "approch to init-val 0x%x\n", + cfo_track->crystal_cap); + } + +#if ODM_IC_11N_SERIES_SUPPORT +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + if (dm->support_ic_type & ODM_IC_11N_SERIES) + phydm_set_atc_status(dm, true); +#endif +#endif +} + +void phydm_cfo_tracking_init(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_cfo_track_struct *cfo_track = &dm->dm_cfo_track; + + PHYDM_DBG(dm, DBG_CFO_TRK, "[%s]=========>\n", __func__); + if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8814B | ODM_RTL8195B | + ODM_RTL8812F | ODM_RTL8197G)) + cfo_track->crystal_cap = cfo_track->crystal_cap_default & 0x7f; + else + cfo_track->crystal_cap = cfo_track->crystal_cap_default & 0x3f; + + cfo_track->def_x_cap = cfo_track->crystal_cap; + cfo_track->is_adjust = true; + PHYDM_DBG(dm, DBG_CFO_TRK, "crystal_cap=0x%x\n", cfo_track->def_x_cap); + +#if (RTL8822B_SUPPORT || RTL8821C_SUPPORT) + /* @Crystal cap. control by WiFi */ + if (dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8821C)) + odm_set_mac_reg(dm, R_0x10, 0x40, 0x1); +#endif +} + +void phydm_cfo_tracking(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_cfo_track_struct *cfo_track = &dm->dm_cfo_track; + s32 cfo_avg = 0, cfo_path_sum = 0, cfo_abs = 0; + u32 cfo_rpt_sum = 0, cfo_khz_avg[4] = {0}; + s8 crystal_cap = cfo_track->crystal_cap; + u8 i = 0, valid_path_cnt = 0; + + if (!(dm->support_ability & ODM_BB_CFO_TRACKING)) + return; + + PHYDM_DBG(dm, DBG_CFO_TRK, "%s ======>\n", __func__); + + if (!dm->is_linked || !dm->is_one_entry_only) { + phydm_cfo_tracking_reset(dm); + PHYDM_DBG(dm, DBG_CFO_TRK, "is_linked=%d, one_entry_only=%d\n", + dm->is_linked, dm->is_one_entry_only); + + } else { + /* No new packet */ + if (cfo_track->packet_count == cfo_track->packet_count_pre) { + PHYDM_DBG(dm, DBG_CFO_TRK, "Pkt cnt doesn't change\n"); return; } - p_cfo_track->packet_count_pre = p_cfo_track->packet_count; + cfo_track->packet_count_pre = cfo_track->packet_count; - /* 4 1.2 Calculate CFO */ - for (i = 0; i < p_dm_odm->num_rf_path; i++) { - - if (p_cfo_track->CFO_cnt[i] == 0) + /*@Calculate CFO */ + for (i = 0; i < dm->num_rf_path; i++) { + if (!(dm->rx_ant_status & BIT(i))) 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]; - ODM_RT_TRACE(p_dm_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, p_cfo_track->CFO_cnt[i], ((p_cfo_track->CFO_tail[i] < 0) ? "-" : " "), cfo_khz_avg[i])); - } + if (cfo_track->CFO_tail[i] < 0) + cfo_abs = 0 - cfo_track->CFO_tail[i]; + else + cfo_abs = cfo_track->CFO_tail[i]; - for (i = 0; i < valid_path_cnt; i++) { + cfo_rpt_sum = (u32)CFO_HW_RPT_2_KHZ(cfo_abs); + cfo_khz_avg[i] = PHYDM_DIV(cfo_rpt_sum, + cfo_track->CFO_cnt[i]); - /* ODM_RT_TRACE(p_dm_odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("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]); - /* ODM_RT_TRACE(p_dm_odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("CFO_ave = %d\n", CFO_ave)); */ - } else - CFO_ave += (s32)cfo_khz_avg[i]; + PHYDM_DBG(dm, DBG_CFO_TRK, + "[Path-%d] CFO_sum=((%d)), cnt=((%d)), CFO_avg=((%s%d))kHz\n", + i, cfo_rpt_sum, cfo_track->CFO_cnt[i], + ((cfo_track->CFO_tail[i] < 0) ? "-" : " "), + cfo_khz_avg[i]); + + if (cfo_track->CFO_tail[i] < 0) + cfo_path_sum += (0 - (s32)cfo_khz_avg[i]); + else + cfo_path_sum += (s32)cfo_khz_avg[i]; } if (valid_path_cnt >= 2) - CFO_ave = CFO_ave / valid_path_cnt; + cfo_avg = cfo_path_sum / valid_path_cnt; + else + cfo_avg = cfo_path_sum; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("valid_path_cnt = ((%d)), CFO_ave = ((%d kHz))\n", valid_path_cnt, CFO_ave)); + cfo_track->CFO_ave_pre = cfo_avg; + + PHYDM_DBG(dm, DBG_CFO_TRK, "path_cnt=%d, CFO_avg_path=%d kHz\n", + valid_path_cnt, cfo_avg); /*reset counter*/ - for (i = 0; i < p_dm_odm->num_rf_path; i++) { - p_cfo_track->CFO_tail[i] = 0; - p_cfo_track->CFO_cnt[i] = 0; + for (i = 0; i < dm->num_rf_path; i++) { + cfo_track->CFO_tail[i] = 0; + 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) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("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; + /* To adjust crystal cap or not */ + if (!cfo_track->is_adjust) { + if (cfo_avg > CFO_TRK_ENABLE_TH || + cfo_avg < (-CFO_TRK_ENABLE_TH)) + 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; + if (cfo_avg < CFO_TRK_STOP_TH && + cfo_avg > (-CFO_TRK_STOP_TH)) + cfo_track->is_adjust = false; } -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - /* 4 1.5 BT case: Disable CFO tracking */ - if (p_dm_odm->is_bt_enabled) { - p_cfo_track->is_adjust = false; - odm_set_crystal_cap(p_dm_odm, p_cfo_track->def_x_cap); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("odm_cfo_tracking(): Disable CFO tracking for BT!!\n")); + #ifdef ODM_CONFIG_BT_COEXIST + /*@BT case: Disable CFO tracking */ + if (dm->bt_info_table.is_bt_enabled) { + cfo_track->is_adjust = false; + phydm_set_crystal_cap(dm, cfo_track->def_x_cap); + PHYDM_DBG(dm, DBG_CFO_TRK, "[BT]Disable CFO_track\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); + #endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("odm_cfo_tracking(): Crystal cap offset = %d\n", adjust_xtal)); - } -#endif -#endif + /*@Adjust Crystal Cap. */ + if (cfo_track->is_adjust) { + if (cfo_avg > CFO_TRK_STOP_TH) + crystal_cap += 1; + else if (cfo_avg < (-CFO_TRK_STOP_TH)) + crystal_cap -= 1; - /* 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) + if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8814B | + ODM_RTL8195B | ODM_RTL8812F | ODM_RTL8197G)) { + if (crystal_cap > 0x7F) + crystal_cap = 0x7F; + } else { + if (crystal_cap > 0x3F) + crystal_cap = 0x3F; + } + if (crystal_cap < 0) crystal_cap = 0; - odm_set_crystal_cap(p_dm_odm, (u8)crystal_cap); + phydm_set_crystal_cap(dm, (u8)crystal_cap); } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("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_odm->support_ic_type & ODM_IC_11AC_SERIES) - return; + PHYDM_DBG(dm, DBG_CFO_TRK, "X_cap{Curr,Default}={0x%x,0x%x}\n", + cfo_track->crystal_cap, cfo_track->def_x_cap); + + /* @Dynamic ATC switch */ + #if ODM_IC_11N_SERIES_SUPPORT + #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + if (dm->support_ic_type & ODM_IC_11N_SERIES) { + if (cfo_avg < CFO_TH_ATC && cfo_avg > -CFO_TH_ATC) + phydm_set_atc_status(dm, false); + else + phydm_set_atc_status(dm, true); - /* 3 2. Dynamic ATC switch */ - if (CFO_ave < CFO_TH_ATC && CFO_ave > -CFO_TH_ATC) { - odm_set_atc_status(p_dm_odm, false); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("odm_cfo_tracking(): Disable ATC!!\n")); - } else { - odm_set_atc_status(p_dm_odm, true); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("odm_cfo_tracking(): Enable ATC!!\n")); } -#endif + #endif + #endif } } -void -odm_parsing_cfo( - void *p_dm_void, - void *p_pktinfo_void, - s8 *pcfotail, - u8 num_ss -) +void phydm_parsing_cfo(void *dm_void, void *pktinfo_void, s8 *pcfotail, + u8 num_ss) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _odm_per_pkt_info_ *p_pktinfo = (struct _odm_per_pkt_info_ *)p_pktinfo_void; - struct _CFO_TRACKING_ *p_cfo_track = (struct _CFO_TRACKING_ *)phydm_get_structure(p_dm_odm, PHYDM_CFOTRACK); - u8 i; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_perpkt_info_struct *pktinfo = NULL; + struct phydm_cfo_track_struct *cfo_track = &dm->dm_cfo_track; + boolean valid_info = false; + u8 i = 0; - if (!(p_dm_odm->support_ability & ODM_BB_CFO_TRACKING)) + if (!(dm->support_ability & ODM_BB_CFO_TRACKING)) return; -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - if (p_pktinfo->is_packet_match_bssid) + pktinfo = (struct phydm_perpkt_info_struct *)pktinfo_void; + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE | ODM_IOT)) + if (pktinfo->is_packet_match_bssid) + valid_info = true; #else - if (p_pktinfo->station_id != 0) + if (dm->number_active_client == 1) + valid_info = true; #endif - { - if (num_ss > p_dm_odm->num_rf_path) /*For fool proof*/ - num_ss = p_dm_odm->num_rf_path; + if (valid_info) { + if (num_ss > dm->num_rf_path) /*@For fool proof*/ + num_ss = dm->num_rf_path; + #if 0 + PHYDM_DBG(dm, DBG_CFO_TRK, "num_ss=%d, num_rf_path=%d\n", + num_ss, dm->num_rf_path); + #endif - /*ODM_RT_TRACE(p_dm_odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("num_ss = ((%d)), p_dm_odm->num_rf_path = ((%d))\n", num_ss, p_dm_odm->num_rf_path));*/ - - - /* 3 Update CFO report for path-A & path-B */ + /* @ 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]++; - /*ODM_RT_TRACE(p_dm_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", - p_pktinfo->station_id, i, p_pktinfo->data_rate, pcfotail[i], p_cfo_track->CFO_tail[i], p_cfo_track->CFO_cnt[i])); - */ + for (i = 0; i < dm->num_rf_path; i++) { + if (!(dm->rx_ant_status & BIT(i))) + continue; + cfo_track->CFO_tail[i] += pcfotail[i]; + cfo_track->CFO_cnt[i]++; + #if 0 + PHYDM_DBG(dm, DBG_CFO_TRK, + "[ID %d][path %d][rate 0x%x] CFO_tail = ((%d)), CFO_tail_sum = ((%d)), CFO_cnt = ((%d))\n", + pktinfo->station_id, i, pktinfo->data_rate, + pcfotail[i], cfo_track->CFO_tail[i], + cfo_track->CFO_cnt[i]); + #endif } - /* 3 Update packet counter */ - if (p_cfo_track->packet_count == 0xffffffff) - p_cfo_track->packet_count = 0; + /* @ Update packet counter */ + if (cfo_track->packet_count == 0xffffffff) + cfo_track->packet_count = 0; else - p_cfo_track->packet_count++; + cfo_track->packet_count++; } } + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +void phy_Init_crystal_capacity(void *dm_void, u8 crystal_cap) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (!phydm_set_crystal_cap_reg(dm, crystal_cap)) + RT_TRACE_F(COMP_INIT, DBG_SERIOUS, + ("Crystal is not initialized!\n")); +} +#endif + +void phydm_cfo_tracking_debug(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_cfo_track_struct *cfo_track = &dm->dm_cfo_track; + char help[] = "-h"; + u32 var1[10] = {0}; + u32 used = *_used; + u32 out_len = *_out_len; + + if ((strcmp(input[1], help) == 0)) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "set Xcap: {1}\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "show Xcap: {100}\n"); + } else { + PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); + + if (var1[0] == 1) { + PHYDM_SSCANF(input[2], DCMD_HEX, &var1[1]); + phydm_set_crystal_cap(dm, (u8)var1[1]); + PDM_SNPF(out_len, used, output + used, out_len - used, + "Set X_cap=0x%x\n", cfo_track->crystal_cap); + } else if (var1[0] == 100) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "X_cap=0x%x\n", cfo_track->crystal_cap); + } + } + *_used = used; + *_out_len = out_len; +} + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_cfotracking.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_cfotracking.h index 565c3dcf9e7c..ed5cef615c39 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_cfotracking.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_cfotracking.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,62 +9,66 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ -#ifndef __PHYDMCFOTRACK_H__ -#define __PHYDMCFOTRACK_H__ +#ifndef __PHYDMCFOTRACK_H__ +#define __PHYDMCFOTRACK_H__ -#define CFO_TRACKING_VERSION "1.4" /*2015.10.01 Stanley, Modify for 8822B*/ +#define CFO_TRACKING_VERSION "2.3" -#define CFO_TH_XTAL_HIGH 20 /* kHz */ -#define CFO_TH_XTAL_LOW 10 /* kHz */ -#define CFO_TH_ATC 80 /* kHz */ +#define CFO_TRK_ENABLE_TH 20 /* @kHz enable CFO_Track threshold*/ +#define CFO_TRK_STOP_TH 10 /* @kHz disable CFO_Track threshold*/ +#define CFO_TH_ATC 80 /* @kHz */ -struct _CFO_TRACKING_ { - bool is_atc_status; - bool large_cfo_hit; - bool 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; - - bool is_force_xtal_cap; - bool is_reset; +struct phydm_cfo_track_struct { + boolean is_atc_status; + boolean is_adjust; /*@already modify crystal cap*/ + u8 crystal_cap; + u8 crystal_cap_default; + u8 def_x_cap; + s32 CFO_tail[4]; + u32 CFO_cnt[4]; + s32 CFO_ave_pre; + u32 packet_count; + u32 packet_count_pre; }; -void -odm_cfo_tracking_reset( - void *p_dm_void -); +struct phydm_cfo_rpt { + s32 cfo_rpt_s[PHYDM_MAX_RF_PATH]; + s32 cfo_rpt_l[PHYDM_MAX_RF_PATH]; + s32 cfo_rpt_acq[PHYDM_MAX_RF_PATH]; + s32 cfo_rpt_sec[PHYDM_MAX_RF_PATH]; + s32 cfo_rpt_end[PHYDM_MAX_RF_PATH]; +}; -void -odm_cfo_tracking_init( - void *p_dm_void -); +void phydm_get_cfo_info(void *dm_void, struct phydm_cfo_rpt *cfo); -void -odm_cfo_tracking( - void *p_dm_void -); +boolean phydm_set_crystal_cap_reg(void *dm_void, u8 crystal_cap); -void -odm_parsing_cfo( - void *p_dm_void, - void *p_pktinfo_void, - s8 *pcfotail, - u8 num_ss -); +void phydm_set_crystal_cap(void *dm_void, u8 crystal_cap); +void phydm_cfo_tracking_init(void *dm_void); + +void phydm_cfo_tracking(void *dm_void); + +void phydm_parsing_cfo(void *dm_void, void *pktinfo_void, s8 *pcfotail, + u8 num_ss); +void phydm_cfo_tracking_debug(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len); +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +void phy_Init_crystal_capacity(void *dm_void, u8 crystal_cap); +#endif #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_debug.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_debug.c index fa8127f6d39f..ae10187bf668 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_debug.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_debug.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,279 +9,208 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ -/* ************************************************************ +/*@************************************************************ * include files - * ************************************************************ */ + ************************************************************/ #include "mp_precomp.h" #include "phydm_precomp.h" -void -phydm_init_debug_setting( - struct PHY_DM_STRUCT *p_dm_odm -) +void phydm_init_debug_setting(struct dm_struct *dm) { - p_dm_odm->debug_level = ODM_DBG_TRACE; + dm->fw_debug_components = 0; + dm->debug_components = - p_dm_odm->fw_debug_components = 0; - p_dm_odm->debug_components = - \ #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_COMP_DYNAMIC_RX_PATH |*/ - /* 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 |*/ - - + /*@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_LNA_SAT_CHK |*/ + /*@DBG_PHY_STATUS |*/ + /*@DBG_TMP |*/ + /*@DBG_FW_TRACE |*/ + /*@DBG_TXBF |*/ + /*@DBG_COMMON_FLOW |*/ + /*@ODM_PHY_CONFIG |*/ + /*@ODM_COMP_INIT |*/ + /*@DBG_CMN |*/ + /*@ODM_COMP_API |*/ #endif - 0; + 0; - p_dm_odm->fw_buff_is_enpty = true; - p_dm_odm->pre_c2h_seq = 0; + dm->fw_buff_is_enpty = true; + dm->pre_c2h_seq = 0; + dm->c2h_cmd_start = 0; + dm->cmn_dbg_msg_cnt = PHYDM_WATCH_DOG_PERIOD; + dm->cmn_dbg_msg_period = PHYDM_WATCH_DOG_PERIOD; + phydm_reset_rx_rate_distribution(dm); } -#if CONFIG_PHYDM_DEBUG_FUNCTION -void -phydm_bb_rx_hang_info( - void *p_dm_void, - u32 *_used, - char *output, - u32 *_out_len -) +void phydm_bb_dbg_port_header_sel(void *dm_void, u32 header_idx) { - u32 value32 = 0; - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u32 used = *_used; - u32 out_len = *_out_len; + struct dm_struct *dm = (struct dm_struct *)dm_void; - if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) - return; + if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + odm_set_bb_reg(dm, R_0x8f8, 0x3c00000, header_idx); - value32 = odm_get_bb_reg(p_dm_odm, 0xF80, MASKDWORD); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "rptreg of sc/bw/ht/...", value32)); - - if (p_dm_odm->support_ic_type & ODM_RTL8822B) - odm_set_bb_reg(p_dm_odm, 0x198c, BIT(2) | BIT(1) | BIT(0), 7); - - /* dbg_port = basic state machine */ - { - odm_set_bb_reg(p_dm_odm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0x000); - value32 = odm_get_bb_reg(p_dm_odm, 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, ODM_REG_RPT_11AC, MASKDWORD); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "basic state machine", value32)); + /*@ + * 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}' + */ } - - /* dbg_port = state machine */ - { - odm_set_bb_reg(p_dm_odm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0x007); - value32 = odm_get_bb_reg(p_dm_odm, 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, 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, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0x204); - value32 = odm_get_bb_reg(p_dm_odm, 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, 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, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0x278); - value32 = odm_get_bb_reg(p_dm_odm, 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, 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, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0x290); - value32 = odm_get_bb_reg(p_dm_odm, 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, 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, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0x2B2); - value32 = odm_get_bb_reg(p_dm_odm, 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, 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, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0x2B8); - value32 = odm_get_bb_reg(p_dm_odm, 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, 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, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xA03); - value32 = odm_get_bb_reg(p_dm_odm, 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, 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, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xA0B); - value32 = odm_get_bb_reg(p_dm_odm, 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, 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, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xA0D); - value32 = odm_get_bb_reg(p_dm_odm, 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, 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, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xAA0); - value32 = odm_get_bb_reg(p_dm_odm, 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, 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, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xAB0); - value32 = odm_get_bb_reg(p_dm_odm, 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, 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, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xAD0); - value32 = odm_get_bb_reg(p_dm_odm, 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, 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, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xAD1); - value32 = odm_get_bb_reg(p_dm_odm, 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, 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, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xAD2); - value32 = odm_get_bb_reg(p_dm_odm, 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, 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, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xAD3); - value32 = odm_get_bb_reg(p_dm_odm, 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, ODM_REG_RPT_11AC, MASKDWORD); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "rx plcp", value32)); - } - } -void -phydm_bb_debug_info_n_series( - void *p_dm_void, - u32 *_used, - char *output, - u32 *_out_len -) +void phydm_bb_dbg_port_clock_en(void *dm_void, u8 enable) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 reg_value = 0; + + if (dm->support_ic_type & + (ODM_RTL8822B | ODM_RTL8821C | ODM_RTL8814A | ODM_RTL8814B | + ODM_RTL8195B)) { + /*@enable/disable debug port clock, for power saving*/ + reg_value = enable ? 0x7 : 0; + odm_set_bb_reg(dm, R_0x198c, 0x7, reg_value); + } +} + +u32 phydm_get_bb_dbg_port_idx(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 val = 0; + + if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + phydm_bb_dbg_port_clock_en(dm, true); + val = odm_get_bb_reg(dm, R_0x8fc, MASKDWORD); + } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + val = odm_get_bb_reg(dm, R_0x1c3c, 0xfff00); + } else { /*@if (dm->support_ic_type & ODM_IC_11N_SERIES)*/ + val = odm_get_bb_reg(dm, R_0x908, MASKDWORD); + } + return val; +} + +u8 phydm_set_bb_dbg_port(void *dm_void, u8 curr_dbg_priority, u32 debug_port) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 dbg_port_result = false; + + if (curr_dbg_priority > dm->pre_dbg_priority) { + if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + phydm_bb_dbg_port_clock_en(dm, true); + + odm_set_bb_reg(dm, R_0x8fc, MASKDWORD, debug_port); + } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + odm_set_bb_reg(dm, R_0x1c3c, 0xfff00, debug_port); + + } else { /*@if (dm->support_ic_type & ODM_IC_11N_SERIES)*/ + odm_set_bb_reg(dm, R_0x908, MASKDWORD, debug_port); + } + PHYDM_DBG(dm, ODM_COMP_API, + "DbgPort ((0x%x)) set success, Cur_priority=((%d)), Pre_priority=((%d))\n", + debug_port, curr_dbg_priority, dm->pre_dbg_priority); + dm->pre_dbg_priority = curr_dbg_priority; + dbg_port_result = true; + } + + return dbg_port_result; +} + +void phydm_release_bb_dbg_port(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + phydm_bb_dbg_port_clock_en(dm, false); + phydm_bb_dbg_port_header_sel(dm, 0); + + dm->pre_dbg_priority = DBGPORT_RELEASE; + PHYDM_DBG(dm, ODM_COMP_API, "Release BB dbg_port\n"); +} + +u32 phydm_get_bb_dbg_port_val(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 dbg_port_value = 0; + + if (dm->support_ic_type & ODM_IC_11AC_SERIES) + dbg_port_value = odm_get_bb_reg(dm, R_0xfa0, MASKDWORD); + else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + dbg_port_value = odm_get_bb_reg(dm, R_0x2dbc, MASKDWORD); + else /*@if (dm->support_ic_type & ODM_IC_11N_SERIES)*/ + dbg_port_value = odm_get_bb_reg(dm, R_0xdf4, MASKDWORD); + + PHYDM_DBG(dm, ODM_COMP_API, "dbg_port_value = 0x%x\n", dbg_port_value); + return dbg_port_value; +} + +#ifdef CONFIG_PHYDM_DEBUG_FUNCTION +#if (ODM_IC_11N_SERIES_SUPPORT) +void phydm_bb_hw_dbg_info_n(void *dm_void, u32 *_used, char *output, + u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)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; + #if 1 + struct phydm_cfo_rpt cfo; + u8 i = 0; + #else + 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; + #endif - u32 value32 = 0, value32_1 = 0, value32_2 = 0, value32_3 = 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; + PDM_SNPF(out_len, used, output + used, out_len - used, "\r\n %-35s\n", + "BB Report Info"); - 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_odm, 0xdd0, MASKDWORD); + /*@AGC result*/ + value32 = odm_get_bb_reg(dm, R_0xdd0, MASKDWORD); rf_gain_a = (u8)(value32 & 0x3f); rf_gain_a = rf_gain_a << 1; @@ -293,10 +223,12 @@ phydm_bb_debug_info_n_series( 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)); + PDM_SNPF(out_len, used, 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_odm, 0xdd4, MASKDWORD); + value32 = odm_get_bb_reg(dm, R_0xdd4, MASKDWORD); rx_snr_a = (u8)(value32 & 0xff); rx_snr_a = rx_snr_a >> 1; @@ -309,10 +241,12 @@ phydm_bb_debug_info_n_series( 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)); + PDM_SNPF(out_len, used, 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_odm, 0xdd8, MASKDWORD); + value32 = odm_get_bb_reg(dm, R_0xdd8, MASKDWORD); rxevm_0 = (s8)((value32 & MASKBYTE2) >> 16); rxevm_0 /= 2; @@ -324,19 +258,30 @@ phydm_bb_debug_info_n_series( 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)); + PDM_SNPF(out_len, used, 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_odm, 0xd00, BIT(26), 1); +#if 1 + phydm_get_cfo_info(dm, &cfo); + for (i = 0; i < dm->num_rf_path; i++) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %s[%d] %-28s = {%d, %d, %d, %d, %d}", + "CFO", i, "{S, L, Sec, Acq, End}", + cfo.cfo_rpt_s[i], cfo.cfo_rpt_l[i], cfo.cfo_rpt_sec[i], + cfo.cfo_rpt_acq[i], cfo.cfo_rpt_end[i]); + } +#else + /*@CFO Report Info*/ + odm_set_bb_reg(dm, R_0xd00, BIT(26), 1); /*Short CFO*/ - value32 = odm_get_bb_reg(p_dm_odm, 0xdac, MASKDWORD); - value32_1 = odm_get_bb_reg(p_dm_odm, 0xdb0, MASKDWORD); + value32 = odm_get_bb_reg(dm, R_0xdac, MASKDWORD); + value32_1 = odm_get_bb_reg(dm, R_0xdb0, MASKDWORD); - short_cfo_b = (s32)(value32 & 0xfff); /*S(12,11)*/ + 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_b = (s32)(value32_1 & 0x1fff); /*S(13,12)*/ long_cfo_a = (s32)((value32_1 & 0x1fff0000) >> 16); /*SFO 2's to dec*/ @@ -348,7 +293,7 @@ phydm_bb_debug_info_n_series( short_cfo_a = (short_cfo_a * 312500) / 2048; short_cfo_b = (short_cfo_b * 312500) / 2048; - /*LFO 2's to dec*/ + /*@LFO 2's to dec*/ if (long_cfo_a > 4095) long_cfo_a = long_cfo_a - 8192; @@ -359,15 +304,20 @@ phydm_bb_debug_info_n_series( 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)); + PDM_SNPF(out_len, used, output + used, out_len - used, "\r\n %-35s", + "CFO Report Info"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = %d / %d", "Short CFO(Hz) ", short_cfo_a, + short_cfo_b); + PDM_SNPF(out_len, used, 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_odm, 0xdb8, MASKDWORD); - value32_1 = odm_get_bb_reg(p_dm_odm, 0xdb4, MASKDWORD); + value32 = odm_get_bb_reg(dm, R_0xdb8, MASKDWORD); + value32_1 = odm_get_bb_reg(dm, R_0xdb4, MASKDWORD); - scfo_b = (s32)(value32 & 0x7ff); /*S(11,10)*/ + scfo_b = (s32)(value32 & 0x7ff); /*S(11,10)*/ scfo_a = (s32)((value32 & 0x07ff0000) >> 16); if (scfo_a > 1023) @@ -379,7 +329,7 @@ phydm_bb_debug_info_n_series( scfo_a = scfo_a * 312500 / 1024; scfo_b = scfo_b * 312500 / 1024; - avg_cfo_b = (s32)(value32_1 & 0x1fff); /*S(13,12)*/ + avg_cfo_b = (s32)(value32_1 & 0x1fff); /*S(13,12)*/ avg_cfo_a = (s32)((value32_1 & 0x1fff0000) >> 16); if (avg_cfo_a > 4095) @@ -391,13 +341,17 @@ phydm_bb_debug_info_n_series( 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)); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = %d / %d", "value SCFO(Hz) ", scfo_a, + scfo_b); + PDM_SNPF(out_len, used, 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_odm, 0xdbc, MASKDWORD); - value32_1 = odm_get_bb_reg(p_dm_odm, 0xde0, MASKDWORD); + value32 = odm_get_bb_reg(dm, R_0xdbc, MASKDWORD); + value32_1 = odm_get_bb_reg(dm, R_0xde0, MASKDWORD); - cfo_end_b = (s32)(value32 & 0x1fff); /*S(13,12)*/ + cfo_end_b = (s32)(value32 & 0x1fff); /*S(13,12)*/ cfo_end_a = (s32)((value32 & 0x1fff0000) >> 16); if (cfo_end_a > 4095) @@ -409,7 +363,7 @@ phydm_bb_debug_info_n_series( 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_b = (s32)(value32_1 & 0x1fff); /*S(13,12)*/ acq_cfo_a = (s32)((value32_1 & 0x1fff0000) >> 16); if (acq_cfo_a > 4095) @@ -421,1424 +375,4208 @@ phydm_bb_debug_info_n_series( 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)); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = %d / %d", "End CFO(Hz) ", cfo_end_a, + cfo_end_b); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = %d / %d", "ACQ CFO(Hz) ", acq_cfo_a, + acq_cfo_b); +#endif +} +#endif +#if (ODM_IC_11AC_SERIES_SUPPORT) +#if (RTL8822B_SUPPORT) +void phydm_bb_hw_dbg_info_8822b(void *dm_void, u32 *_used, char *output, + u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 used = *_used; + u32 out_len = *_out_len; + u32 condi_num = 0; + u8 i = 0; + + if (!(dm->support_ic_type == ODM_RTL8822B)) + return; + + condi_num = phydm_get_condi_num_8822b(dm); + phydm_get_condi_num_acc_8822b(dm); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = %d.%.4d", "condi_num", + condi_num >> 4, phydm_show_fraction_num(condi_num & 0xf, 4)); + + for (i = 0; i < CN_CNT_MAX; i++) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n Tone_num[CN>%d]%-21s = %d", + i, " ", dm->phy_dbg_info.condi_num_cdf[i]); + } + + *_used = used; + *_out_len = out_len; +} +#endif + +void phydm_bb_hw_dbg_info_ac(void *dm_void, u32 *_used, char *output, + u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 used = *_used; + u32 out_len = *_out_len; + char *tmp_string = NULL; + u8 rx_ht_bw, rx_vht_bw, rxsc, rx_ht, bw_idx = 0; + static u8 v_rx_bw; + u32 value32, value32_1, value32_2, value32_3; + struct phydm_cfo_rpt cfo; + u8 i = 0; + static u8 tail, parity, rsv, vrsv, smooth, htsound, agg; + static u8 stbc, vstbc, fec, fecext, sgi, sgiext, htltf, vgid, v_nsts; + static u8 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[4]; + u8 rx_snr[4]; + s32 sig_power; + + PDM_SNPF(out_len, used, output + used, out_len - used, "\r\n %-35s\n", + "BB Report Info"); + + /*@ [BW & Mode] =====================================================*/ + + value32 = odm_get_bb_reg(dm, R_0xf80, MASKDWORD); + rx_ht = (u8)((value32 & 0x180) >> 7); + + if (rx_ht == AD_VHT_MODE) { + tmp_string = "VHT"; + bw_idx = (u8)((value32 >> 1) & 0x3); + } else if (rx_ht == AD_HT_MODE) { + tmp_string = "HT"; + bw_idx = (u8)(value32 & 0x1); + } else { + tmp_string = "Legacy"; + bw_idx = 0; + } + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s %s %dM", "mode", tmp_string, (20 << bw_idx)); + + if (rx_ht != AD_LEGACY_MODE) { + rxsc = (u8)(value32 & 0x78); + + 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"; + + PDM_SNPF(out_len, used, output + used, out_len - used, + " %-35s", tmp_string); + } + + /*@ [RX signal power and AGC related info] ==========================*/ + + pwdb = (u8)odm_get_bb_reg(dm, R_0xf90, MASKBYTE1); + sig_power = -110 + (pwdb >> 1); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = %d", "OFDM RX Signal Power(dB)", sig_power); + + value32 = odm_get_bb_reg(dm, R_0xd14, MASKDWORD); + rx_snr[RF_PATH_A] = (u8)(value32 & 0xFF) >> 1; /*@ S(8,1)*/ + rf_gain[RF_PATH_A] = (s8)(((value32 & MASKBYTE1) >> 8) * 2); + + value32 = odm_get_bb_reg(dm, R_0xd54, MASKDWORD); + rx_snr[RF_PATH_B] = (u8)(value32 & 0xFF) >> 1; /*@ S(8,1)*/ + rf_gain[RF_PATH_B] = (s8)(((value32 & MASKBYTE1) >> 8) * 2); + + value32 = odm_get_bb_reg(dm, R_0xd94, MASKDWORD); + rx_snr[RF_PATH_C] = (u8)(value32 & 0xFF) >> 1; /*@ S(8,1)*/ + rf_gain[RF_PATH_C] = (s8)(((value32 & MASKBYTE1) >> 8) * 2); + + value32 = odm_get_bb_reg(dm, R_0xdd4, MASKDWORD); + rx_snr[RF_PATH_D] = (u8)(value32 & 0xFF) >> 1; /*@ S(8,1)*/ + rf_gain[RF_PATH_D] = (s8)(((value32 & MASKBYTE1) >> 8) * 2); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = %d / %d / %d / %d", "OFDM RX RF Gain(A/B/C/D)", + rf_gain[RF_PATH_A], rf_gain[RF_PATH_B], + rf_gain[RF_PATH_C], rf_gain[RF_PATH_D]); + + /*@ [RX counter Info] ===============================================*/ + + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = %d", "OFDM CCA cnt", + odm_get_bb_reg(dm, R_0xf08, 0xFFFF0000)); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = %d", "OFDM SBD Fail cnt", + odm_get_bb_reg(dm, R_0xfd0, 0xFFFF)); + + value32 = odm_get_bb_reg(dm, R_0xfc4, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = %d / %d", "VHT SIGA/SIGB CRC8 Fail cnt", + value32 & 0xFFFF, ((value32 & 0xFFFF0000) >> 16)); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = %d", "CCK CCA cnt", + odm_get_bb_reg(dm, R_0xfcc, 0xFFFF)); + + value32 = odm_get_bb_reg(dm, R_0xfbc, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = %d / %d", + "LSIG (parity Fail/rate Illegal) cnt", value32 & 0xFFFF, + ((value32 & 0xFFFF0000) >> 16)); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = %d / %d", "HT/VHT MCS NOT SUPPORT cnt", + odm_get_bb_reg(dm, R_0xfc0, (0xFFFF0000 >> 16)), + odm_get_bb_reg(dm, R_0xfc8, 0xFFFF)); + + /*@ [PostFFT Info] =================================================*/ + value32 = odm_get_bb_reg(dm, R_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(dm, R_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; + + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = %d / %d / %d", "RXEVM (1ss/2ss/3ss)", rxevm_0, + rxevm_1, rxevm_2); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = %d / %d / %d / %d", "RXSNR(A/B/C/D dB)", + rx_snr[RF_PATH_A], rx_snr[RF_PATH_B], + rx_snr[RF_PATH_C], rx_snr[RF_PATH_D]); + + value32 = odm_get_bb_reg(dm, R_0xf8c, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = %d / %d", "CSI_1st /CSI_2nd", value32 & 0xFFFF, + ((value32 & 0xFFFF0000) >> 16)); + + /*@ [CFO Report Info] ===============================================*/ + phydm_get_cfo_info(dm, &cfo); + for (i = 0; i < dm->num_rf_path; i++) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %s[%d] %-28s = {%d, %d, %d, %d, %d}", + "CFO", i, "{S, L, Sec, Acq, End}", + cfo.cfo_rpt_s[i], cfo.cfo_rpt_l[i], cfo.cfo_rpt_sec[i], + cfo.cfo_rpt_acq[i], cfo.cfo_rpt_end[i]); + } + + /*@ [L-SIG Content] =================================================*/ + value32 = odm_get_bb_reg(dm, R_0xf20, MASKDWORD); + + tail = (u8)((value32 & 0xfc0000) >> 18);/*@[23:18]*/ + parity = (u8)((value32 & 0x20000) >> 17);/*@[17]*/ + length = (u16)((value32 & 0x1ffe0) >> 5);/*@[16:5]*/ + rsv = (u8)((value32 & 0x10) >> 4);/*@[4]*/ + + PDM_SNPF(out_len, used, output + used, out_len - used, "\r\n %-35s", + "L-SIG"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = %d M", "rate", + phydm_get_l_sig_rate(dm, (u8)(value32 & 0x0f))); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = %x / %d / %d", "Rsv/length/parity", rsv, length, + parity); + + if (rx_ht == AD_HT_MODE) { + /*@ [HT SIG 1] ======================================================*/ + value32 = odm_get_bb_reg(dm, R_0xf2c, MASKDWORD); + + hmcss = (u8)(value32 & 0x7F); + hrx_bw = (u8)((value32 & 0x80) >> 7); + h_length = (u16)((value32 & 0x0fff00) >> 8); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s", "HT-SIG1"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = %d / %d / %d", "MCS/BW/length", + hmcss, hrx_bw, h_length); + /*@ [HT SIG 2] ======================================================*/ + value32 = odm_get_bb_reg(dm, R_0xf30, MASKDWORD); + smooth = (u8)(value32 & 0x01); + htsound = (u8)((value32 & 0x02) >> 1); + rsv = (u8)((value32 & 0x04) >> 2); + agg = (u8)((value32 & 0x08) >> 3); + stbc = (u8)((value32 & 0x30) >> 4); + fec = (u8)((value32 & 0x40) >> 6); + sgi = (u8)((value32 & 0x80) >> 7); + htltf = (u8)((value32 & 0x300) >> 8); + htcrc8 = (u16)((value32 & 0x3fc00) >> 10); + tail = (u8)((value32 & 0xfc0000) >> 18); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s", + "HT-SIG2"); + PDM_SNPF(out_len, used, 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); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = %x / %x / %x / %x", + "SGI/E-HT-LTFs/CRC/tail", + sgi, htltf, htcrc8, tail); + } else if (rx_ht == AD_VHT_MODE) { + /*@ [VHT SIG A1] ====================================================*/ + value32 = odm_get_bb_reg(dm, R_0xf2c, MASKDWORD); + + v_rx_bw = (u8)(value32 & 0x03); + vrsv = (u8)((value32 & 0x04) >> 2); + vstbc = (u8)((value32 & 0x08) >> 3); + vgid = (u8)((value32 & 0x3f0) >> 4); + v_nsts = (u8)(((value32 & 0x1c00) >> 10) + 1); + vpaid = (u16)((value32 & 0x3fe000) >> 13); + vtxops = (u8)((value32 & 0x400000) >> 22); + vrsv2 = (u8)((value32 & 0x800000) >> 23); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s", + "VHT-SIG-A1"); + PDM_SNPF(out_len, used, 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); + + /*@ [VHT SIG A2] ====================================================*/ + value32 = odm_get_bb_reg(dm, R_0xf30, MASKDWORD); + + /* @sgi=(u8)(value32&0x01); */ + sgiext = (u8)(value32 & 0x03); + /* @fec = (u8)(value32&0x04); */ + fecext = (u8)((value32 & 0x0C) >> 2); + + v_mcss = (u8)((value32 & 0xf0) >> 4); + bf = (u8)((value32 & 0x100) >> 8); + vrsv = (u8)((value32 & 0x200) >> 9); + vhtcrc8 = (u16)((value32 & 0x3fc00) >> 10); + v_tail = (u8)((value32 & 0xfc0000) >> 18); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s", "VHT-SIG-A2"); + PDM_SNPF(out_len, used, 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); + + /*@ [VHT SIG B] ====================================================*/ + value32 = odm_get_bb_reg(dm, R_0xf34, MASKDWORD); + + #if 0 + v_length = (u16)(value32 & 0x1fffff); + vbrsv = (u8)((value32 & 0x600000) >> 21); + vb_tail = (u16)((value32 & 0x1f800000) >> 23); + vbcrc = (u8)((value32 & 0x80000000) >> 31); + #endif + + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s", "VHT-SIG-B"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = %x", + "Codeword", value32); + + #if 0 + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = %x / %x / %x / %x", + "length/Rsv/tail/CRC", + v_length, vbrsv, vb_tail, vbcrc); + #endif + } + + *_used = used; + *_out_len = out_len; +} +#endif + +#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT +void phydm_bb_hw_dbg_info_jgr3(void *dm_void, u32 *_used, char *output, + u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 used = *_used; + u32 out_len = *_out_len; + char *tmp_string = NULL; + u8 rx_ht_bw = 0, rx_vht_bw = 0, rx_ht = 0; + static u8 v_rx_bw; + u32 value32 = 0; + u8 i = 0; + static u8 tail, parity, rsv, vrsv, smooth, htsound, agg; + static u8 stbc, vstbc, fec, fecext, sgi, sgiext, htltf, vgid, v_nsts; + static u8 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; + + PDM_SNPF(out_len, used, output + used, out_len - used, "\r\n %-35s\n", + "BB Report Info"); + + /*@ [Mode] =====================================================*/ + + value32 = odm_get_bb_reg(dm, R_0x2c20, MASKDWORD); + rx_ht = (u8)((value32 & 0xC0000) >> 18); + if (rx_ht == AD_VHT_MODE) + tmp_string = "VHT"; + else if (rx_ht == AD_HT_MODE) + tmp_string = "HT"; + else + tmp_string = "Legacy"; + + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s %s", "mode", tmp_string); + /*@ [RX counter Info] ===============================================*/ + + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = %d", "CCK CCA cnt", + odm_get_bb_reg(dm, R_0x2c08, 0xFFFF)); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = %d", "OFDM CCA cnt", + odm_get_bb_reg(dm, R_0x2c08, 0xFFFF0000)); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = %d", "OFDM SBD Fail cnt", + odm_get_bb_reg(dm, R_0x2d20, 0xFFFF0000)); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = %d / %d", + "LSIG (parity Fail/rate Illegal) cnt", + odm_get_bb_reg(dm, R_0x2d04, 0xFFFF0000), + odm_get_bb_reg(dm, R_0x2d08, 0xFFFF)); + + value32 = odm_get_bb_reg(dm, R_0x2d10, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = %d / %d", "HT/VHT MCS NOT SUPPORT cnt", + value32 & 0xFFFF, ((value32 & 0xFFFF0000) >> 16)); + + value32 = odm_get_bb_reg(dm, R_0x2d0c, MASKDWORD); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = %d / %d", "VHT SIGA/SIGB CRC8 Fail cnt", + value32 & 0xFFFF, ((value32 & 0xFFFF0000) >> 16)); + /*@ [L-SIG Content] =================================================*/ + value32 = odm_get_bb_reg(dm, R_0x2c20, MASKDWORD); + + parity = (u8)((value32 & 0x20000) >> 17);/*@[17]*/ + length = (u16)((value32 & 0x1ffe0) >> 5);/*@[16:5]*/ + rsv = (u8)((value32 & 0x10) >> 4);/*@[4]*/ + + PDM_SNPF(out_len, used, output + used, out_len - used, "\r\n %-35s", + "L-SIG"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = %d M", "rate", + phydm_get_l_sig_rate(dm, (u8)(value32 & 0x0f))); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = %x / %d / %d", "Rsv/length/parity", rsv, length, + parity); + + if (rx_ht == AD_HT_MODE) { + /*@ [HT SIG 1] ======================================================*/ + value32 = odm_get_bb_reg(dm, R_0x2c2c, MASKDWORD); + + hmcss = (u8)(value32 & 0x7F); + hrx_bw = (u8)((value32 & 0x80) >> 7); + h_length = (u16)((value32 & 0x0fff00) >> 8); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s", "HT-SIG1"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = %d / %d / %d", "MCS/BW/length", + hmcss, hrx_bw, h_length); + /*@ [HT SIG 2] ======================================================*/ + value32 = odm_get_bb_reg(dm, R_0x2c30, MASKDWORD); + smooth = (u8)(value32 & 0x01); + htsound = (u8)((value32 & 0x02) >> 1); + rsv = (u8)((value32 & 0x04) >> 2); + agg = (u8)((value32 & 0x08) >> 3); + stbc = (u8)((value32 & 0x30) >> 4); + fec = (u8)((value32 & 0x40) >> 6); + sgi = (u8)((value32 & 0x80) >> 7); + htltf = (u8)((value32 & 0x300) >> 8); + htcrc8 = (u16)((value32 & 0x3fc00) >> 10); + tail = (u8)((value32 & 0xfc0000) >> 18); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s", + "HT-SIG2"); + PDM_SNPF(out_len, used, 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); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = %x / %x / %x / %x", + "SGI/E-HT-LTFs/CRC/tail", + sgi, htltf, htcrc8, tail); + } else if (rx_ht == AD_VHT_MODE) { + /*@ [VHT SIG A1] ====================================================*/ + value32 = odm_get_bb_reg(dm, R_0x2c2c, MASKDWORD); + + v_rx_bw = (u8)(value32 & 0x03); + vrsv = (u8)((value32 & 0x04) >> 2); + vstbc = (u8)((value32 & 0x08) >> 3); + vgid = (u8)((value32 & 0x3f0) >> 4); + v_nsts = (u8)(((value32 & 0x1c00) >> 10) + 1); + vpaid = (u16)((value32 & 0x3fe000) >> 13); + vtxops = (u8)((value32 & 0x400000) >> 22); + vrsv2 = (u8)((value32 & 0x800000) >> 23); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s", + "VHT-SIG-A1"); + PDM_SNPF(out_len, used, 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); + + /*@ [VHT SIG A2] ====================================================*/ + value32 = odm_get_bb_reg(dm, R_0x2c30, MASKDWORD); + + /* @sgi=(u8)(value32&0x01); */ + sgiext = (u8)(value32 & 0x03); + /* @fec = (u8)(value32&0x04); */ + fecext = (u8)((value32 & 0x0C) >> 2); + + v_mcss = (u8)((value32 & 0xf0) >> 4); + bf = (u8)((value32 & 0x100) >> 8); + vrsv = (u8)((value32 & 0x200) >> 9); + vhtcrc8 = (u16)((value32 & 0x3fc00) >> 10); + v_tail = (u8)((value32 & 0xfc0000) >> 18); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s", "VHT-SIG-A2"); + PDM_SNPF(out_len, used, 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); + + /*@ [VHT SIG B] ====================================================*/ + value32 = odm_get_bb_reg(dm, R_0x2c34, MASKDWORD); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s", "VHT-SIG-B"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = %x", + "Codeword", value32); + + if (v_rx_bw == 0) { + v_length = (u16)(value32 & 0x1ffff); + vbrsv = (u8)((value32 & 0xE0000) >> 17); + vb_tail = (u16)((value32 & 0x03F00000) >> 20); + } else if (v_rx_bw == 1) { + v_length = (u16)(value32 & 0x7FFFF); + vbrsv = (u8)((value32 & 0x180000) >> 19); + vb_tail = (u16)((value32 & 0x07E00000) >> 21); + } else if (v_rx_bw == 2) { + v_length = (u16)(value32 & 0x1fffff); + vbrsv = (u8)((value32 & 0x600000) >> 21); + vb_tail = (u16)((value32 & 0x1f800000) >> 23); + } + vbcrc = (u8)((value32 & 0x80000000) >> 31); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n %-35s = %x / %x / %x / %x", + "length/Rsv/tail/CRC", + v_length, vbrsv, vb_tail, vbcrc); + } + + *_used = used; + *_out_len = out_len; +} +#endif + +u8 phydm_get_l_sig_rate(void *dm_void, u8 rate_idx_l_sig) +{ + u8 rate_idx = 0xff; + + switch (rate_idx_l_sig) { + case 0x0b: + rate_idx = 6; + break; + case 0x0f: + rate_idx = 9; + break; + case 0x0a: + rate_idx = 12; + break; + case 0x0e: + rate_idx = 18; + break; + case 0x09: + rate_idx = 24; + break; + case 0x0d: + rate_idx = 36; + break; + case 0x08: + rate_idx = 48; + break; + case 0x0c: + rate_idx = 54; + break; + default: + rate_idx = 0xff; + break; + } + + return rate_idx; } - -void -phydm_bb_debug_info( - void *p_dm_void, - u32 *_used, - char *output, - u32 *_out_len -) +void phydm_bb_hw_dbg_info(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)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_odm->support_ic_type & ODM_IC_11N_SERIES) { - phydm_bb_debug_info_n_series(p_dm_odm, &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_odm, 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_odm, 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_odm, 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_odm, 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_odm, 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_odm, 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_odm, 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_odm, 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_odm, 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_odm, 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_odm, 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_odm, 0xFC8, MASKDWORD); - value32_2 = odm_get_bb_reg(p_dm_odm, 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_odm, 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_odm, 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_odm, 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_odm, 0xB58, BIT(0), 1); - odm_set_bb_reg(p_dm_odm, 0xB58, BIT(0), 0); - - /*CFO Report Info*/ - /*Short CFO*/ - value32 = odm_get_bb_reg(p_dm_odm, 0xd0c, MASKDWORD); - value32_1 = odm_get_bb_reg(p_dm_odm, 0xd4c, MASKDWORD); - value32_2 = odm_get_bb_reg(p_dm_odm, 0xd8c, MASKDWORD); - value32_3 = odm_get_bb_reg(p_dm_odm, 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_odm, 0xd10, MASKDWORD); - value32_1 = odm_get_bb_reg(p_dm_odm, 0xd50, MASKDWORD); - value32_2 = odm_get_bb_reg(p_dm_odm, 0xd90, MASKDWORD); - value32_3 = odm_get_bb_reg(p_dm_odm, 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_odm, 0xd14, MASKDWORD); - value32_1 = odm_get_bb_reg(p_dm_odm, 0xd54, MASKDWORD); - value32_2 = odm_get_bb_reg(p_dm_odm, 0xd94, MASKDWORD); - value32_3 = odm_get_bb_reg(p_dm_odm, 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_odm, 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; + switch (dm->ic_ip_series) { + #if (ODM_IC_11N_SERIES_SUPPORT) + case PHYDM_IC_N: + phydm_bb_hw_dbg_info_n(dm, &used, output, &out_len); break; - case 0x0f: - idx = 1; + #endif + + #if (ODM_IC_11AC_SERIES_SUPPORT) + case PHYDM_IC_AC: + phydm_bb_hw_dbg_info_ac(dm, &used, output, &out_len); + phydm_reset_bb_hw_cnt(dm); + #if (RTL8822B_SUPPORT) + phydm_bb_hw_dbg_info_8822b(dm, &used, output, &out_len); + #endif 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; + #endif + + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + case PHYDM_IC_JGR3: + phydm_bb_hw_dbg_info_jgr3(dm, &used, output, &out_len); + phydm_reset_bb_hw_cnt(dm); break; + #endif 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_odm, 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_odm, 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_odm, 0xf2c, MASKDWORD); /*VHT SIG A1*/ - if (RX_HT == 2) { - /* value32 = odm_get_bb_reg(p_dm_odm, 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_odm, 0xf30, MASKDWORD); /*VHT SIG*/ - - if (RX_HT == 2) { - /*value32 = odm_get_bb_reg(p_dm_odm, 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_odm, 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_odm->support_ic_type & ODM_RTL8822B) { - s32 condition_num = 0; - char *factor = NULL; - - odm_set_bb_reg(p_dm_odm, 0x1988, BIT(22), 0x1); /*enable report condition number*/ - - condition_num = odm_get_bb_reg(p_dm_odm, 0xf84, MASKDWORD); - condition_num = (condition_num & 0x3ffff) >> 4; - - if (*p_dm_odm->p_band_width == ODM_BW80M) - factor = "256/234"; - else if (*p_dm_odm->p_band_width == ODM_BW40M) - factor = "128/108"; - else if (*p_dm_odm->p_band_width == 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)); - } + *_used = used; + *_out_len = out_len; } -#endif /*#if CONFIG_PHYDM_DEBUG_FUNCTION*/ + +#endif /*@#ifdef CONFIG_PHYDM_DEBUG_FUNCTION*/ #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -#if CONFIG_PHYDM_DEBUG_FUNCTION -void phydm_sbd_check( - struct PHY_DM_STRUCT *p_dm_odm -) +void phydm_dm_summary_cli_win(void *dm_void, char *buf, u8 macid) { - static u32 pkt_cnt = 0; - static bool sbd_state = 0; - u32 sym_count, count, value32; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + struct phydm_cfo_track_struct *cfo_t = &dm->dm_cfo_track; + struct cmn_sta_info *sta = NULL; + struct ra_sta_info *ra = NULL; + struct dtp_info *dtp = NULL; + u64 comp = dm->support_ability; + u64 pause_comp = dm->pause_ability; - if (sbd_state == 0) { - pkt_cnt++; - if (pkt_cnt % 5 == 0) { /*read SBD conter once every 5 packets*/ - odm_set_timer(p_dm_odm, &p_dm_odm->sbdcnt_timer, 0); /*ms*/ - sbd_state = 1; - } - } else { /*read counter*/ - value32 = odm_get_bb_reg(p_dm_odm, 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; + if (!dm->is_linked) { + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "[%s]No Link !!!\n", __func__); + RT_PRINT(buf); + return; } -} -#endif /*#if CONFIG_PHYDM_DEBUG_FUNCTION*/ -void phydm_sbd_callback( - struct timer_list *p_timer -) -{ -#if 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_odm = &p_hal_data->DM_OutSrc; + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "00.(%s) %-12s: IGI=0x%x, Dyn_Rng=0x%x~0x%x, FA_th={%d,%d,%d}\n", + ((comp & ODM_BB_DIG) ? + ((pause_comp & ODM_BB_DIG) ? "P" : "V") : "."), + "DIG", + dig_t->cur_ig_value, + dig_t->rx_gain_range_min, dig_t->rx_gain_range_max, + dig_t->fa_th[0], dig_t->fa_th[1], dig_t->fa_th[2]); + RT_PRINT(buf); -#if USE_WORKITEM - odm_schedule_work_item(&p_dm_odm->sbdcnt_workitem); -#else - phydm_sbd_check(p_dm_odm); + sta = dm->phydm_sta_info[macid]; + if (is_sta_active(sta)) { + RT_PRINT(buf); + + ra = &sta->ra_info; + dtp = &sta->dtp_stat; + + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "01.(%s) %-12s: rssi_lv=%d, mask=0x%llx\n", + ((comp & ODM_BB_RA_MASK) ? + ((pause_comp & ODM_BB_RA_MASK) ? "P" : "V") : "."), + "RaMask", + ra->rssi_level, ra->ramask); + RT_PRINT(buf); + + #ifdef CONFIG_DYNAMIC_TX_TWR + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "02.(%s) %-12s: pwr_lv=%d\n", + ((comp & ODM_BB_DYNAMIC_TXPWR) ? + ((pause_comp & ODM_BB_DYNAMIC_TXPWR) ? "P" : "V") : "."), + "DynTxPwr", + dtp->sta_tx_high_power_lvl); + RT_PRINT(buf); + #endif + } + + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "05.(%s) %-12s: cck_pd_lv=%d\n", + ((comp & ODM_BB_CCK_PD) ? + ((pause_comp & ODM_BB_CCK_PD) ? "P" : "V") : "."), + "CCK_PD", dm->dm_cckpd_table.cck_pd_lv); + RT_PRINT(buf); + +#ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "06.(%s) %-12s: div_type=%d, curr_ant=%s\n", + ((comp & ODM_BB_ANT_DIV) ? + ((pause_comp & ODM_BB_ANT_DIV) ? "P" : "V") : "."), + "ANT_DIV", + dm->ant_div_type, + (dm->dm_fat_table.rx_idle_ant == MAIN_ANT) ? "MAIN" : "AUX"); + RT_PRINT(buf); #endif -#endif /*#if CONFIG_PHYDM_DEBUG_FUNCTION*/ -} -void phydm_sbd_workitem_callback( - void *p_context -) -{ -#if 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_odm = &p_hal_data->DM_OutSrc; - - phydm_sbd_check(p_dm_odm); -#endif /*#if CONFIG_PHYDM_DEBUG_FUNCTION*/ -} +#ifdef PHYDM_POWER_TRAINING_SUPPORT + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "08.(%s) %-12s: PT_score=%d, disable_PT=%d\n", + ((comp & ODM_BB_PWR_TRAIN) ? + ((pause_comp & ODM_BB_PWR_TRAIN) ? "P" : "V") : "."), + "PwrTrain", + dm->pow_train_table.pow_train_score, + dm->is_disable_power_training); + RT_PRINT(buf); #endif -void -phydm_basic_dbg_message -( - void *p_dm_void -) + +#ifdef CONFIG_PHYDM_DFS_MASTER + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "11.(%s) %-12s: dbg_mode=%d, region_domain=%d\n", + ((comp & ODM_BB_DFS) ? + ((pause_comp & ODM_BB_DFS) ? "P" : "V") : "."), + "DFS", + dm->dfs.dbg_mode, dm->dfs_region_domain); + RT_PRINT(buf); +#endif +#ifdef PHYDM_SUPPORT_ADAPTIVITY + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "13.(%s) %-12s: th{l2h, h2l}={%d, %d}, edcca_flag=%d\n", + ((comp & ODM_BB_ADAPTIVITY) ? + ((pause_comp & ODM_BB_ADAPTIVITY) ? "P" : "V") : "."), + "Adaptivity", + dm->adaptivity.th_l2h, dm->adaptivity.th_h2l, + dm->false_alm_cnt.edcca_flag); + RT_PRINT(buf); +#endif + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "14.(%s) %-12s: CFO_avg=%d kHz, CFO_traking=%s%d\n", + ((comp & ODM_BB_CFO_TRACKING) ? + ((pause_comp & ODM_BB_CFO_TRACKING) ? "P" : "V") : "."), + "CfoTrack", + cfo_t->CFO_ave_pre, + ((cfo_t->crystal_cap > cfo_t->def_x_cap) ? "+" : "-"), + DIFF_2(cfo_t->crystal_cap, cfo_t->def_x_cap)); + RT_PRINT(buf); + + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "15.(%s) %-12s: ratio{nhm, clm}={%d, %d}\n", + ((comp & ODM_BB_ENV_MONITOR) ? + ((pause_comp & ODM_BB_ENV_MONITOR) ? "P" : "V") : "."), + "EnvMntr", + dm->dm_ccx_info.nhm_ratio, dm->dm_ccx_info.clm_ratio); + RT_PRINT(buf); +#ifdef PHYDM_PRIMARY_CCA + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "16.(%s) %-12s: CCA @ (%s SB)\n", + ((comp & ODM_BB_PRIMARY_CCA) ? + ((pause_comp & ODM_BB_PRIMARY_CCA) ? "P" : "V") : "."), + "PriCCA", + ((dm->dm_pri_cca.mf_state == MF_USC_LSC) ? "D" : + ((dm->dm_pri_cca.mf_state == MF_LSC) ? "L" : "U"))); + RT_PRINT(buf); +#endif +#ifdef CONFIG_ADAPTIVE_SOML + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "17.(%s) %-12s: soml_en = %s\n", + ((comp & ODM_BB_ADAPTIVE_SOML) ? + ((pause_comp & ODM_BB_ADAPTIVE_SOML) ? "P" : "V") : "."), + "A-SOML", + (dm->dm_soml_table.soml_last_state == SOML_ON) ? + "ON" : "OFF"); + RT_PRINT(buf); +#endif +#ifdef PHYDM_LNA_SAT_CHK_SUPPORT + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "18.(%s) %-12s:\n", + ((comp & ODM_BB_LNA_SAT_CHK) ? + ((pause_comp & ODM_BB_LNA_SAT_CHK) ? "P" : "V") : "."), + "LNA_SAT_CHK"); + RT_PRINT(buf); +#endif +} + +void phydm_basic_dbg_msg_cli_win(void *dm_void, char *buf) { -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _FALSE_ALARM_STATISTICS *false_alm_cnt = (struct _FALSE_ALARM_STATISTICS *)phydm_get_structure(p_dm_odm, PHYDM_FALSEALMCNT); - struct _CFO_TRACKING_ *p_cfo_track = (struct _CFO_TRACKING_ *)phydm_get_structure(p_dm_odm, PHYDM_CFOTRACK); - struct _dynamic_initial_gain_threshold_ *p_dm_dig_table = &p_dm_odm->dm_dig_table; - struct _rate_adaptive_table_ *p_ra_table = &p_dm_odm->dm_ra_table; - u16 macid, phydm_macid, client_cnt = 0; - struct sta_info *p_entry; - s32 tmp_val = 0; - u8 tmp_val_u1 = 0; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fa_struct *fa_t = &dm->false_alm_cnt; + struct phydm_cfo_track_struct *cfo_t = &dm->dm_cfo_track; + struct odm_phy_dbg_info *dbg = &dm->phy_dbg_info; + struct phydm_phystatus_statistic *dbg_s = &dbg->physts_statistic_info; + struct phydm_phystatus_avg *dbg_avg = &dbg->phystatus_statistic_avg; + char *rate_type = NULL; + u8 tmp_rssi_avg[4]; + u8 tmp_snr_avg[4]; + u8 tmp_evm_avg[4]; + u32 tmp_cnt = 0; + u8 macid, target_macid = 0; + u8 i = 0; + u8 rate_num = dm->num_rf_path; + u8 ss_ofst = 0; + struct cmn_sta_info *entry = NULL; + char dbg_buf[PHYDM_SNPRINT_SIZE] = {0}; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("[PHYDM Common MSG] System up time: ((%d sec))----->\n", p_dm_odm->phydm_sys_up_time)); + if (dm->debug_components & DBG_CMN) + return; - if (p_dm_odm->is_linked) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("Curr_STA_ID = 0x%x\n", p_dm_odm->curr_station_id)); + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n PHYDM Common Dbg Msg --------->"); + RT_PRINT(buf); + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n System up time=%d", dm->phydm_sys_up_time); + RT_PRINT(buf); - /*Print RX rate*/ - if (p_dm_odm->rx_rate <= ODM_RATE11M) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("[CCK AGC Report] LNA_idx = 0x%x, VGA_idx = 0x%x\n", - p_dm_odm->cck_lna_idx, p_dm_odm->cck_vga_idx)); - } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("[OFDM AGC Report] { 0x%x, 0x%x, 0x%x, 0x%x }\n", - p_dm_odm->ofdm_agc_idx[0], p_dm_odm->ofdm_agc_idx[1], p_dm_odm->ofdm_agc_idx[2], p_dm_odm->ofdm_agc_idx[3])); + if (dm->is_linked) { + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n ID=((%d)), BW=((%d)), fc=((CH-%d))", + dm->curr_station_id, 20 << *dm->band_width, *dm->channel); + RT_PRINT(buf); + + if (((*dm->channel <= 14) && (*dm->band_width == CHANNEL_WIDTH_40)) && + (dm->support_ic_type & ODM_IC_11N_SERIES)) { + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n Primary CCA at ((%s SB))", + (*dm->sec_ch_offset == SECOND_CH_AT_LSB) ? "U" : "L"); + RT_PRINT(buf); } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("RSSI: { %d, %d, %d, %d }, rx_rate:", - (p_dm_odm->RSSI_A == 0xff) ? 0 : p_dm_odm->RSSI_A, - (p_dm_odm->RSSI_B == 0xff) ? 0 : p_dm_odm->RSSI_B, - (p_dm_odm->RSSI_C == 0xff) ? 0 : p_dm_odm->RSSI_C, - (p_dm_odm->RSSI_D == 0xff) ? 0 : p_dm_odm->RSSI_D)); + if ((dm->support_ic_type & PHYSTS_2ND_TYPE_IC) || dm->rx_rate > ODM_RATE11M) { + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n [AGC Idx] {0x%x, 0x%x, 0x%x, 0x%x}", + dm->ofdm_agc_idx[0], dm->ofdm_agc_idx[1], + dm->ofdm_agc_idx[2], dm->ofdm_agc_idx[3]); + RT_PRINT(buf); + } else { + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n [CCK AGC Idx] {LNA,VGA}={0x%x, 0x%x}", + dm->cck_lna_idx, dm->cck_vga_idx); + RT_PRINT(buf); + } - phydm_print_rate(p_dm_odm, p_dm_odm->rx_rate, ODM_COMP_COMMON); + phydm_print_rate_2_buff(dm, dm->rx_rate, dbg_buf, PHYDM_SNPRINT_SIZE); + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n RSSI:{%d, %d, %d, %d}, RxRate:%s (0x%x)", + (dm->rssi_a == 0xff) ? 0 : dm->rssi_a, + (dm->rssi_b == 0xff) ? 0 : dm->rssi_b, + (dm->rssi_c == 0xff) ? 0 : dm->rssi_c, + (dm->rssi_d == 0xff) ? 0 : dm->rssi_d, + dbg_buf, dm->rx_rate); + RT_PRINT(buf); - /*Print TX rate*/ - for (macid = 0; macid < ODM_ASSOCIATE_ENTRY_NUM; macid++) { + phydm_print_rate_2_buff(dm, dm->phy_dbg_info.beacon_phy_rate, dbg_buf, PHYDM_SNPRINT_SIZE); + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n Beacon_cnt=%d, rate_idx:%s (0x%x)", + dm->phy_dbg_info.beacon_cnt_in_period, + dbg_buf, + dm->phy_dbg_info.beacon_phy_rate); + RT_PRINT(buf); - p_entry = p_dm_odm->p_odm_sta_info[macid]; - if (IS_STA_VALID(p_entry)) { + /*Show phydm_rx_rate_distribution;*/ + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n [RxRate Cnt] =============>"); + RT_PRINT(buf); - phydm_macid = (p_dm_odm->platform2phydm_macid_table[macid]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("TXRate [%d]:", macid)); - phydm_print_rate(p_dm_odm, p_ra_table->link_tx_rate[macid], ODM_COMP_COMMON); + /*@======CCK=================================================*/ + if (*dm->channel <= 14) { + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n * CCK = {%d, %d, %d, %d}", + dbg->num_qry_legacy_pkt[0], dbg->num_qry_legacy_pkt[1], + dbg->num_qry_legacy_pkt[2], dbg->num_qry_legacy_pkt[3]); + RT_PRINT(buf); + } + /*@======OFDM================================================*/ + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n * OFDM = {%d, %d, %d, %d, %d, %d, %d, %d}", + dbg->num_qry_legacy_pkt[4], dbg->num_qry_legacy_pkt[5], + dbg->num_qry_legacy_pkt[6], dbg->num_qry_legacy_pkt[7], + dbg->num_qry_legacy_pkt[8], dbg->num_qry_legacy_pkt[9], + dbg->num_qry_legacy_pkt[10], dbg->num_qry_legacy_pkt[11]); + RT_PRINT(buf); - client_cnt++; + /*@======HT==================================================*/ + if (dbg->ht_pkt_not_zero) { + for (i = 0; i < rate_num; i++) { + ss_ofst = (i << 3); - if (client_cnt == p_dm_odm->number_linked_client) - break; + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n * HT MCS[%d :%d ] = {%d, %d, %d, %d, %d, %d, %d, %d}", + (ss_ofst), (ss_ofst + 7), + dbg->num_qry_ht_pkt[ss_ofst + 0], dbg->num_qry_ht_pkt[ss_ofst + 1], + dbg->num_qry_ht_pkt[ss_ofst + 2], dbg->num_qry_ht_pkt[ss_ofst + 3], + dbg->num_qry_ht_pkt[ss_ofst + 4], dbg->num_qry_ht_pkt[ss_ofst + 5], + dbg->num_qry_ht_pkt[ss_ofst + 6], dbg->num_qry_ht_pkt[ss_ofst + 7]); + RT_PRINT(buf); + } + + if (dbg->low_bw_20_occur) { + for (i = 0; i < rate_num; i++) { + ss_ofst = (i << 3); + + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n * [Low BW 20M] HT MCS[%d :%d ] = {%d, %d, %d, %d, %d, %d, %d, %d}", + (ss_ofst), (ss_ofst + 7), + dbg->num_qry_pkt_sc_20m[ss_ofst + 0], dbg->num_qry_pkt_sc_20m[ss_ofst + 1], + dbg->num_qry_pkt_sc_20m[ss_ofst + 2], dbg->num_qry_pkt_sc_20m[ss_ofst + 3], + dbg->num_qry_pkt_sc_20m[ss_ofst + 4], dbg->num_qry_pkt_sc_20m[ss_ofst + 5], + dbg->num_qry_pkt_sc_20m[ss_ofst + 6], dbg->num_qry_pkt_sc_20m[ss_ofst + 7]); + RT_PRINT(buf); + } } } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("TP { TX, RX, total} = {%d, %d, %d }Mbps, traffic_load = (%d))\n", - p_dm_odm->tx_tp, p_dm_odm->rx_tp, p_dm_odm->total_tp, p_dm_odm->traffic_load)); +#if (ODM_IC_11AC_SERIES_SUPPORT || defined(PHYDM_IC_JGR3_SERIES_SUPPORT)) + /*@======VHT=================================================*/ + if (dbg->vht_pkt_not_zero) { + for (i = 0; i < rate_num; i++) { + ss_ofst = 10 * i; - 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); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("CFO_avg = ((%d kHz)) , CrystalCap_tracking = ((%s%d))\n", - p_cfo_track->CFO_ave_pre, ((p_cfo_track->crystal_cap > p_cfo_track->def_x_cap) ? "+" : "-"), tmp_val_u1)); + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n * VHT-%d ss MCS[0:9] = {%d, %d, %d, %d, %d, %d, %d, %d, %d, %d}", + (i + 1), + dbg->num_qry_vht_pkt[ss_ofst + 0], dbg->num_qry_vht_pkt[ss_ofst + 1], + dbg->num_qry_vht_pkt[ss_ofst + 2], dbg->num_qry_vht_pkt[ss_ofst + 3], + dbg->num_qry_vht_pkt[ss_ofst + 4], dbg->num_qry_vht_pkt[ss_ofst + 5], + dbg->num_qry_vht_pkt[ss_ofst + 6], dbg->num_qry_vht_pkt[ss_ofst + 7], + dbg->num_qry_vht_pkt[ss_ofst + 8], dbg->num_qry_vht_pkt[ss_ofst + 9]); + RT_PRINT(buf); + } - /* Condition number */ -#if (RTL8822B_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8822B) { - tmp_val = phydm_get_condition_number_8822B(p_dm_odm); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("Condition number = ((%d))\n", tmp_val)); + if (dbg->low_bw_20_occur) { + for (i = 0; i < rate_num; i++) { + ss_ofst = 10 * i; + + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n *[Low BW 20M] VHT-%d ss MCS[0:9] = {%d, %d, %d, %d, %d, %d, %d, %d, %d, %d}", + (i + 1), + dbg->num_qry_pkt_sc_20m[ss_ofst + 0], dbg->num_qry_pkt_sc_20m[ss_ofst + 1], + dbg->num_qry_pkt_sc_20m[ss_ofst + 2], dbg->num_qry_pkt_sc_20m[ss_ofst + 3], + dbg->num_qry_pkt_sc_20m[ss_ofst + 4], dbg->num_qry_pkt_sc_20m[ss_ofst + 5], + dbg->num_qry_pkt_sc_20m[ss_ofst + 6], dbg->num_qry_pkt_sc_20m[ss_ofst + 7], + dbg->num_qry_pkt_sc_20m[ss_ofst + 8], dbg->num_qry_pkt_sc_20m[ss_ofst + 9]); + RT_PRINT(buf); + } + } + + if (dbg->low_bw_40_occur) { + for (i = 0; i < rate_num; i++) { + ss_ofst = 10 * i; + + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n *[Low BW 40M] VHT-%d ss MCS[0:9] = {%d, %d, %d, %d, %d, %d, %d, %d, %d, %d}", + (i + 1), + dbg->num_qry_pkt_sc_40m[ss_ofst + 0], dbg->num_qry_pkt_sc_40m[ss_ofst + 1], + dbg->num_qry_pkt_sc_40m[ss_ofst + 2], dbg->num_qry_pkt_sc_40m[ss_ofst + 3], + dbg->num_qry_pkt_sc_40m[ss_ofst + 4], dbg->num_qry_pkt_sc_40m[ss_ofst + 5], + dbg->num_qry_pkt_sc_40m[ss_ofst + 6], dbg->num_qry_pkt_sc_40m[ss_ofst + 7], + dbg->num_qry_pkt_sc_40m[ss_ofst + 8], dbg->num_qry_pkt_sc_40m[ss_ofst + 9]); + RT_PRINT(buf); + } + } } #endif -#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) + phydm_reset_rx_rate_distribution(dm); + + //1 Show phydm_avg_phystatus_val + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n [Avg PHY Statistic] ==============>"); + RT_PRINT(buf); +#if 1 + phydm_get_avg_phystatus_val(dm); + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "* %-8s Cnt=((%.3d)) RSSI:{%.2d}\n", + "[Beacon]", dbg_s->rssi_beacon_cnt, dbg_avg->rssi_beacon_avg); + RT_PRINT(buf); + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "* %-8s Cnt=((%.3d)) RSSI:{%.2d}\n", + "[CCK]", dbg_s->rssi_cck_cnt, dbg_avg->rssi_cck_avg); + RT_PRINT(buf); + + for (i = 0; i <= 4; i++) { + if (i > dm->num_rf_path) + break; + + odm_memory_set(dm, tmp_rssi_avg, 0, 4); + odm_memory_set(dm, tmp_snr_avg, 0, 4); + odm_memory_set(dm, tmp_evm_avg, 0, 4); + + #if (defined(PHYDM_COMPILE_ABOVE_4SS)) + if (i == 4) { + rate_type = "[4-SS]"; + tmp_cnt = dbg_s->rssi_4ss_cnt; + odm_move_memory(dm, tmp_rssi_avg, dbg_avg->rssi_4ss_avg, dm->num_rf_path); + odm_move_memory(dm, tmp_snr_avg, dbg_avg->snr_4ss_avg, dm->num_rf_path); + odm_move_memory(dm, tmp_evm_avg, dbg_avg->evm_4ss_avg, 4); + } else + #endif + #if (defined(PHYDM_COMPILE_ABOVE_3SS)) + if (i == 3) { + rate_type = "[3-SS]"; + tmp_cnt = dbg_s->rssi_3ss_cnt; + odm_move_memory(dm, tmp_rssi_avg, dbg_avg->rssi_3ss_avg, dm->num_rf_path); + odm_move_memory(dm, tmp_snr_avg, dbg_avg->snr_3ss_avg, dm->num_rf_path); + odm_move_memory(dm, tmp_evm_avg, dbg_avg->evm_3ss_avg, 3); + } else + #endif + #if (defined(PHYDM_COMPILE_ABOVE_2SS)) + if (i == 2) { + rate_type = "[2-SS]"; + tmp_cnt = dbg_s->rssi_2ss_cnt; + odm_move_memory(dm, tmp_rssi_avg, dbg_avg->rssi_2ss_avg, dm->num_rf_path); + odm_move_memory(dm, tmp_snr_avg, dbg_avg->snr_2ss_avg, dm->num_rf_path); + odm_move_memory(dm, tmp_evm_avg, dbg_avg->evm_2ss_avg, 2); + } else + #endif + if (i == 1) { + rate_type = "[1-SS]"; + tmp_cnt = dbg_s->rssi_1ss_cnt; + odm_move_memory(dm, tmp_rssi_avg, dbg_avg->rssi_1ss_avg, dm->num_rf_path); + odm_move_memory(dm, tmp_snr_avg, dbg_avg->snr_1ss_avg, dm->num_rf_path); + odm_move_memory(dm, tmp_evm_avg, &dbg_avg->evm_1ss_avg, 1); + } else { + rate_type = "[L-OFDM]"; + tmp_cnt = dbg_s->rssi_ofdm_cnt; + odm_move_memory(dm, tmp_rssi_avg, dbg_avg->rssi_ofdm_avg, dm->num_rf_path); + odm_move_memory(dm, tmp_snr_avg, dbg_avg->snr_ofdm_avg, dm->num_rf_path); + odm_move_memory(dm, tmp_evm_avg, &dbg_avg->evm_ofdm_avg, 1); + } + + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, + "* %-8s Cnt=((%.3d)) RSSI:{%.2d, %.2d, %.2d, %.2d} SNR:{%.2d, %.2d, %.2d, %.2d} EVM:{-%.2d, -%.2d, -%.2d, -%.2d}\n", + rate_type, tmp_cnt, + tmp_rssi_avg[0], tmp_rssi_avg[1], tmp_rssi_avg[2], tmp_rssi_avg[3], + tmp_snr_avg[0], tmp_snr_avg[1], tmp_snr_avg[2], tmp_snr_avg[3], + tmp_evm_avg[0], tmp_evm_avg[1], tmp_evm_avg[2], tmp_evm_avg[3]); + RT_PRINT(buf); + } +#else + phydm_reset_phystatus_avg(dm); + + /*@CCK*/ + dbg_avg->rssi_cck_avg = (u8)((dbg_s->rssi_cck_cnt != 0) ? (dbg_s->rssi_cck_sum / dbg_s->rssi_cck_cnt) : 0); + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n * cck Cnt= ((%d)) RSSI:{%d}", + dbg_s->rssi_cck_cnt, dbg_avg->rssi_cck_avg); + RT_PRINT(buf); + + /*OFDM*/ + if (dbg_s->rssi_ofdm_cnt != 0) { + dbg_avg->rssi_ofdm_avg = (u8)(dbg_s->rssi_ofdm_sum / dbg_s->rssi_ofdm_cnt); + dbg_avg->evm_ofdm_avg = (u8)(dbg_s->evm_ofdm_sum / dbg_s->rssi_ofdm_cnt); + dbg_avg->snr_ofdm_avg = (u8)(dbg_s->snr_ofdm_sum / dbg_s->rssi_ofdm_cnt); + } + + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n * ofdm Cnt= ((%d)) RSSI:{%d} EVM:{%d} SNR:{%d}", + dbg_s->rssi_ofdm_cnt, dbg_avg->rssi_ofdm_avg, + dbg_avg->evm_ofdm_avg, dbg_avg->snr_ofdm_avg); + RT_PRINT(buf); + + if (dbg_s->rssi_1ss_cnt != 0) { + dbg_avg->rssi_1ss_avg = (u8)(dbg_s->rssi_1ss_sum / dbg_s->rssi_1ss_cnt); + dbg_avg->evm_1ss_avg = (u8)(dbg_s->evm_1ss_sum / dbg_s->rssi_1ss_cnt); + dbg_avg->snr_1ss_avg = (u8)(dbg_s->snr_1ss_sum / dbg_s->rssi_1ss_cnt); + } + + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n * 1-ss Cnt= ((%d)) RSSI:{%d} EVM:{%d} SNR:{%d}", + dbg_s->rssi_1ss_cnt, dbg_avg->rssi_1ss_avg, + dbg_avg->evm_1ss_avg, dbg_avg->snr_1ss_avg); + RT_PRINT(buf); + +#if (defined(PHYDM_COMPILE_ABOVE_2SS)) + if (dm->support_ic_type & (PHYDM_IC_ABOVE_2SS)) { + if (dbg_s->rssi_2ss_cnt != 0) { + dbg_avg->rssi_2ss_avg[0] = (u8)(dbg_s->rssi_2ss_sum[0] / dbg_s->rssi_2ss_cnt); + dbg_avg->rssi_2ss_avg[1] = (u8)(dbg_s->rssi_2ss_sum[1] / dbg_s->rssi_2ss_cnt); + + dbg_avg->evm_2ss_avg[0] = (u8)(dbg_s->evm_2ss_sum[0] / dbg_s->rssi_2ss_cnt); + dbg_avg->evm_2ss_avg[1] = (u8)(dbg_s->evm_2ss_sum[1] / dbg_s->rssi_2ss_cnt); + + dbg_avg->snr_2ss_avg[0] = (u8)(dbg_s->snr_2ss_sum[0] / dbg_s->rssi_2ss_cnt); + dbg_avg->snr_2ss_avg[1] = (u8)(dbg_s->snr_2ss_sum[1] / dbg_s->rssi_2ss_cnt); + } + + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n * 2-ss Cnt= ((%d)) RSSI:{%d, %d}, EVM:{%d, %d}, SNR:{%d, %d}", + dbg_s->rssi_2ss_cnt, dbg_avg->rssi_2ss_avg[0], + dbg_avg->rssi_2ss_avg[1], dbg_avg->evm_2ss_avg[0], + dbg_avg->evm_2ss_avg[1], dbg_avg->snr_2ss_avg[0], + dbg_avg->snr_2ss_avg[1]); + RT_PRINT(buf); + } +#endif + +#if (defined(PHYDM_COMPILE_ABOVE_3SS)) + if (dm->support_ic_type & (PHYDM_IC_ABOVE_3SS)) { + if (dbg_s->rssi_3ss_cnt != 0) { + dbg_avg->rssi_3ss_avg[0] = (u8)(dbg_s->rssi_3ss_sum[0] / dbg_s->rssi_3ss_cnt); + dbg_avg->rssi_3ss_avg[1] = (u8)(dbg_s->rssi_3ss_sum[1] / dbg_s->rssi_3ss_cnt); + dbg_avg->rssi_3ss_avg[2] = (u8)(dbg_s->rssi_3ss_sum[2] / dbg_s->rssi_3ss_cnt); + + dbg_avg->evm_3ss_avg[0] = (u8)(dbg_s->evm_3ss_sum[0] / dbg_s->rssi_3ss_cnt); + dbg_avg->evm_3ss_avg[1] = (u8)(dbg_s->evm_3ss_sum[1] / dbg_s->rssi_3ss_cnt); + dbg_avg->evm_3ss_avg[2] = (u8)(dbg_s->evm_3ss_sum[2] / dbg_s->rssi_3ss_cnt); + + dbg_avg->snr_3ss_avg[0] = (u8)(dbg_s->snr_3ss_sum[0] / dbg_s->rssi_3ss_cnt); + dbg_avg->snr_3ss_avg[1] = (u8)(dbg_s->snr_3ss_sum[1] / dbg_s->rssi_3ss_cnt); + dbg_avg->snr_3ss_avg[2] = (u8)(dbg_s->snr_3ss_sum[2] / dbg_s->rssi_3ss_cnt); + } + + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n * 3-ss Cnt= ((%d)) RSSI:{%d, %d, %d} EVM:{%d, %d, %d} SNR:{%d, %d, %d}", + dbg_s->rssi_3ss_cnt, dbg_avg->rssi_3ss_avg[0], + dbg_avg->rssi_3ss_avg[1], dbg_avg->rssi_3ss_avg[2], + dbg_avg->evm_3ss_avg[0], dbg_avg->evm_3ss_avg[1], + dbg_avg->evm_3ss_avg[2], dbg_avg->snr_3ss_avg[0], + dbg_avg->snr_3ss_avg[1], dbg_avg->snr_3ss_avg[2]); + RT_PRINT(buf); + } +#endif + +#if (defined(PHYDM_COMPILE_ABOVE_4SS)) + if (dm->support_ic_type & PHYDM_IC_ABOVE_4SS) { + if (dbg_s->rssi_4ss_cnt != 0) { + dbg_avg->rssi_4ss_avg[0] = (u8)(dbg_s->rssi_4ss_sum[0] / dbg_s->rssi_4ss_cnt); + dbg_avg->rssi_4ss_avg[1] = (u8)(dbg_s->rssi_4ss_sum[1] / dbg_s->rssi_4ss_cnt); + dbg_avg->rssi_4ss_avg[2] = (u8)(dbg_s->rssi_4ss_sum[2] / dbg_s->rssi_4ss_cnt); + dbg_avg->rssi_4ss_avg[3] = (u8)(dbg_s->rssi_4ss_sum[3] / dbg_s->rssi_4ss_cnt); + + dbg_avg->evm_4ss_avg[0] = (u8)(dbg_s->evm_4ss_sum[0] / dbg_s->rssi_4ss_cnt); + dbg_avg->evm_4ss_avg[1] = (u8)(dbg_s->evm_4ss_sum[1] / dbg_s->rssi_4ss_cnt); + dbg_avg->evm_4ss_avg[2] = (u8)(dbg_s->evm_4ss_sum[2] / dbg_s->rssi_4ss_cnt); + dbg_avg->evm_4ss_avg[3] = (u8)(dbg_s->evm_4ss_sum[3] / dbg_s->rssi_4ss_cnt); + + dbg_avg->snr_4ss_avg[0] = (u8)(dbg_s->snr_4ss_sum[0] / dbg_s->rssi_4ss_cnt); + dbg_avg->snr_4ss_avg[1] = (u8)(dbg_s->snr_4ss_sum[1] / dbg_s->rssi_4ss_cnt); + dbg_avg->snr_4ss_avg[2] = (u8)(dbg_s->snr_4ss_sum[2] / dbg_s->rssi_4ss_cnt); + dbg_avg->snr_4ss_avg[3] = (u8)(dbg_s->snr_4ss_sum[3] / dbg_s->rssi_4ss_cnt); + } + + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n * 4-ss Cnt= ((%d)) RSSI:{%d, %d, %d, %d} EVM:{%d, %d, %d, %d} SNR:{%d, %d, %d, %d}", + dbg_s->rssi_4ss_cnt, dbg_avg->rssi_4ss_avg[0], + dbg_avg->rssi_4ss_avg[1], dbg_avg->rssi_4ss_avg[2], + dbg_avg->rssi_4ss_avg[3], dbg_avg->evm_4ss_avg[0], + dbg_avg->evm_4ss_avg[1], dbg_avg->evm_4ss_avg[2], + dbg_avg->evm_4ss_avg[3], dbg_avg->snr_4ss_avg[0], + dbg_avg->snr_4ss_avg[1], dbg_avg->snr_4ss_avg[2], + dbg_avg->snr_4ss_avg[3]); + RT_PRINT(buf); + } +#endif +#endif + phydm_reset_phystatus_statistic(dm); + /*@----------------------------------------------------------*/ + + /*Print TX rate*/ + for (macid = 0; macid < ODM_ASSOCIATE_ENTRY_NUM; macid++) { + entry = dm->phydm_sta_info[macid]; + + if (is_sta_active(entry)) { + phydm_print_rate_2_buff(dm, entry->ra_info.curr_tx_rate, dbg_buf, PHYDM_SNPRINT_SIZE); + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n TxRate[%d]=%s (0x%x)", macid, dbg_buf, entry->ra_info.curr_tx_rate); + RT_PRINT(buf); + target_macid = macid; + break; + } + } + + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, + "\r\n TP {Tx, Rx, Total} = {%d, %d, %d}Mbps, Traffic_Load=(%d))", + dm->tx_tp, dm->rx_tp, dm->total_tp, dm->traffic_load); + RT_PRINT(buf); + + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n CFO_avg=((%d kHz)), CFO_traking = ((%s%d))", + cfo_t->CFO_ave_pre, + ((cfo_t->crystal_cap > cfo_t->def_x_cap) ? "+" : "-"), + DIFF_2(cfo_t->crystal_cap, cfo_t->def_x_cap)); + RT_PRINT(buf); + + /* @Condition number */ + #if (RTL8822B_SUPPORT) + if (dm->support_ic_type == ODM_RTL8822B) { + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n Condi_Num=((%d.%.4d))", + dm->phy_dbg_info.condi_num >> 4, + phydm_show_fraction_num(dm->phy_dbg_info.condi_num & 0xf, 4)); + RT_PRINT(buf); + } + #endif + +#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT || defined(PHYSTS_3RD_TYPE_SUPPORT)) /*STBC or LDPC pkt*/ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("LDPC = %s, STBC = %s\n", (p_dm_odm->phy_dbg_info.is_ldpc_pkt) ? "Y" : "N", (p_dm_odm->phy_dbg_info.is_stbc_pkt) ? "Y" : "N")); + if (dm->support_ic_type & (PHYSTS_2ND_TYPE_IC | + PHYSTS_3RD_TYPE_IC)) + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n Coding: LDPC=((%s)), STBC=((%s))", + (dm->phy_dbg_info.is_ldpc_pkt) ? "Y" : "N", + (dm->phy_dbg_info.is_stbc_pkt) ? "Y" : "N"); + RT_PRINT(buf); #endif - } else - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("No Link !!!\n")); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("[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)); - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("[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_odm->support_ic_type & ODM_IC_11N_SERIES) { - ODM_RT_TRACE(p_dm_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", - 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)); + } else { + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n No Link !!!"); + RT_PRINT(buf); } + + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n [CCA Cnt] {CCK, OFDM, Total} = {%d, %d, %d}", + fa_t->cnt_cck_cca, fa_t->cnt_ofdm_cca, fa_t->cnt_cca_all); + RT_PRINT(buf); + + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, "\r\n [FA Cnt] {CCK, OFDM, Total} = {%d, %d, %d}", + fa_t->cnt_cck_fail, fa_t->cnt_ofdm_fail, fa_t->cnt_all); + RT_PRINT(buf); + + #if (ODM_IC_11N_SERIES_SUPPORT) + if (dm->support_ic_type & ODM_IC_11N_SERIES) { + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, + "\r\n [OFDM FA Detail] Parity_Fail=%d, Rate_Illegal=%d, CRC8=%d, MCS_fail=%d, Fast_sync=%d, SB_Search_fail=%d", + fa_t->cnt_parity_fail, fa_t->cnt_rate_illegal, + fa_t->cnt_crc8_fail, fa_t->cnt_mcs_fail, + fa_t->cnt_fast_fsync, fa_t->cnt_sb_search_fail); + RT_PRINT(buf); + } + #endif + RT_SPRINTF(buf, DBGM_CLI_BUF_SIZE, + "\r\n is_linked = %d, Num_client = %d, rssi_min = %d, IGI = 0x%x, bNoisy=%d\n", + dm->is_linked, dm->number_linked_client, dm->rssi_min, + dm->dm_dig_table.cur_ig_value, dm->noisy_decision); + RT_PRINT(buf); + + phydm_dm_summary_cli_win(dm, buf, target_macid); +} + +#ifdef CONFIG_PHYDM_DEBUG_FUNCTION +void phydm_sbd_check( + struct dm_struct *dm) +{ + static u32 pkt_cnt; + static boolean sbd_state; + u32 sym_count, count, value32; + + if (sbd_state == 0) { + pkt_cnt++; + /*read SBD conter once every 5 packets*/ + if (pkt_cnt % 5 == 0) { + odm_set_timer(dm, &dm->sbdcnt_timer, 0); /*@ms*/ + sbd_state = 1; + } + } else { /*read counter*/ + value32 = odm_get_bb_reg(dm, R_0xf98, MASKDWORD); + sym_count = (value32 & 0x7C000000) >> 26; + count = (value32 & 0x3F00000) >> 20; + pr_debug("#SBD# sym_count %d count %d\n", sym_count, count); + sbd_state = 0; + } +} #endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("is_linked = %d, Num_client = %d, rssi_min = %d, current_igi = 0x%x, bNoisy=%d\n\n", - p_dm_odm->is_linked, p_dm_odm->number_linked_client, p_dm_odm->rssi_min, p_dm_dig_table->cur_ig_value, p_dm_odm->noisy_decision)); - - /* - temp_reg = odm_get_bb_reg(p_dm_odm, 0xDD0, MASKBYTE0); - ODM_RT_TRACE(p_dm_odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("0xDD0 = 0x%x\n",temp_reg)); - - temp_reg = odm_get_bb_reg(p_dm_odm, 0xDDc, MASKBYTE1); - ODM_RT_TRACE(p_dm_odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("0xDDD = 0x%x\n",temp_reg)); - - temp_reg = odm_get_bb_reg(p_dm_odm, 0xc50, MASKBYTE0); - ODM_RT_TRACE(p_dm_odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("0xC50 = 0x%x\n",temp_reg)); - - temp_reg = odm_get_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x0, 0x3fe0); - ODM_RT_TRACE(p_dm_odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("RF 0x0[13:5] = 0x%x\n\n",temp_reg)); - */ +void phydm_sbd_callback( + struct phydm_timer_list *timer) +{ +#ifdef CONFIG_PHYDM_DEBUG_FUNCTION + void *adapter = timer->Adapter; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA((PADAPTER)adapter); + struct dm_struct *dm = &hal_data->DM_OutSrc; +#if USE_WORKITEM + odm_schedule_work_item(&dm->sbdcnt_workitem); +#else + phydm_sbd_check(dm); +#endif #endif } - -void phydm_basic_profile( - void *p_dm_void, - u32 *_used, - char *output, - u32 *_out_len -) +void phydm_sbd_workitem_callback( + void *context) { -#if CONFIG_PHYDM_DEBUG_FUNCTION - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - char *cut = NULL; +#ifdef CONFIG_PHYDM_DEBUG_FUNCTION + void *adapter = (void *)context; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA((PADAPTER)adapter); + struct dm_struct *dm = &hal_data->DM_OutSrc; + + phydm_sbd_check(dm); +#endif +} +#endif + +void phydm_reset_rx_rate_distribution(struct dm_struct *dm) +{ + struct odm_phy_dbg_info *dbg = &dm->phy_dbg_info; + + odm_memory_set(dm, &dbg->num_qry_legacy_pkt[0], 0, + (LEGACY_RATE_NUM * 2)); + odm_memory_set(dm, &dbg->num_qry_ht_pkt[0], 0, + (HT_RATE_NUM * 2)); + odm_memory_set(dm, &dbg->num_qry_pkt_sc_20m[0], 0, + (LOW_BW_RATE_NUM * 2)); + + dbg->ht_pkt_not_zero = false; + dbg->low_bw_20_occur = false; + +#if (ODM_IC_11AC_SERIES_SUPPORT || defined(PHYDM_IC_JGR3_SERIES_SUPPORT)) + odm_memory_set(dm, &dbg->num_qry_vht_pkt[0], 0, VHT_RATE_NUM * 2); + odm_memory_set(dm, &dbg->num_qry_pkt_sc_40m[0], 0, LOW_BW_RATE_NUM * 2); + #if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) || (defined(PHYSTS_3RD_TYPE_SUPPORT)) + odm_memory_set(dm, &dbg->num_mu_vht_pkt[0], 0, VHT_RATE_NUM * 2); + #endif + dbg->vht_pkt_not_zero = false; + dbg->low_bw_40_occur = false; +#endif +} + +void phydm_rx_rate_distribution(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct odm_phy_dbg_info *dbg = &dm->phy_dbg_info; + u8 i = 0; + u8 rate_num = dm->num_rf_path, ss_ofst = 0; + + PHYDM_DBG(dm, DBG_CMN, "[RxRate Cnt] =============>\n"); + + /*@======CCK=========================================================*/ + if (*dm->channel <= 14) { + PHYDM_DBG(dm, DBG_CMN, "* CCK = {%d, %d, %d, %d}\n", + dbg->num_qry_legacy_pkt[0], + dbg->num_qry_legacy_pkt[1], + dbg->num_qry_legacy_pkt[2], + dbg->num_qry_legacy_pkt[3]); + } + /*@======OFDM========================================================*/ + PHYDM_DBG(dm, DBG_CMN, "* OFDM = {%d, %d, %d, %d, %d, %d, %d, %d}\n", + dbg->num_qry_legacy_pkt[4], dbg->num_qry_legacy_pkt[5], + dbg->num_qry_legacy_pkt[6], dbg->num_qry_legacy_pkt[7], + dbg->num_qry_legacy_pkt[8], dbg->num_qry_legacy_pkt[9], + dbg->num_qry_legacy_pkt[10], dbg->num_qry_legacy_pkt[11]); + + /*@======HT==========================================================*/ + if (dbg->ht_pkt_not_zero) { + for (i = 0; i < rate_num; i++) { + ss_ofst = (i << 3); + + PHYDM_DBG(dm, DBG_CMN, + "* HT MCS[%d :%d ] = {%d, %d, %d, %d, %d, %d, %d, %d}\n", + (ss_ofst), (ss_ofst + 7), + dbg->num_qry_ht_pkt[ss_ofst + 0], + dbg->num_qry_ht_pkt[ss_ofst + 1], + dbg->num_qry_ht_pkt[ss_ofst + 2], + dbg->num_qry_ht_pkt[ss_ofst + 3], + dbg->num_qry_ht_pkt[ss_ofst + 4], + dbg->num_qry_ht_pkt[ss_ofst + 5], + dbg->num_qry_ht_pkt[ss_ofst + 6], + dbg->num_qry_ht_pkt[ss_ofst + 7]); + } + + if (dbg->low_bw_20_occur) { + for (i = 0; i < rate_num; i++) { + ss_ofst = (i << 3); + + PHYDM_DBG(dm, DBG_CMN, + "* [Low BW 20M] HT MCS[%d :%d ] = {%d, %d, %d, %d, %d, %d, %d, %d}\n", + (ss_ofst), (ss_ofst + 7), + dbg->num_qry_pkt_sc_20m[ss_ofst + 0], + dbg->num_qry_pkt_sc_20m[ss_ofst + 1], + dbg->num_qry_pkt_sc_20m[ss_ofst + 2], + dbg->num_qry_pkt_sc_20m[ss_ofst + 3], + dbg->num_qry_pkt_sc_20m[ss_ofst + 4], + dbg->num_qry_pkt_sc_20m[ss_ofst + 5], + dbg->num_qry_pkt_sc_20m[ss_ofst + 6], + dbg->num_qry_pkt_sc_20m[ss_ofst + 7]); + } + } + } + +#if (ODM_IC_11AC_SERIES_SUPPORT || defined(PHYDM_IC_JGR3_SERIES_SUPPORT)) + /*@======VHT==========================================================*/ + if (dbg->vht_pkt_not_zero) { + for (i = 0; i < rate_num; i++) { + ss_ofst = 10 * i; + + PHYDM_DBG(dm, DBG_CMN, + "* VHT-%d ss MCS[0:9] = {%d, %d, %d, %d, %d, %d, %d, %d, %d, %d}\n", + (i + 1), + dbg->num_qry_vht_pkt[ss_ofst + 0], + dbg->num_qry_vht_pkt[ss_ofst + 1], + dbg->num_qry_vht_pkt[ss_ofst + 2], + dbg->num_qry_vht_pkt[ss_ofst + 3], + dbg->num_qry_vht_pkt[ss_ofst + 4], + dbg->num_qry_vht_pkt[ss_ofst + 5], + dbg->num_qry_vht_pkt[ss_ofst + 6], + dbg->num_qry_vht_pkt[ss_ofst + 7], + dbg->num_qry_vht_pkt[ss_ofst + 8], + dbg->num_qry_vht_pkt[ss_ofst + 9]); + } + + if (dbg->low_bw_20_occur) { + for (i = 0; i < rate_num; i++) { + ss_ofst = 10 * i; + + PHYDM_DBG(dm, DBG_CMN, + "*[Low BW 20M] VHT-%d ss MCS[0:9] = {%d, %d, %d, %d, %d, %d, %d, %d, %d, %d}\n", + (i + 1), + dbg->num_qry_pkt_sc_20m[ss_ofst + 0], + dbg->num_qry_pkt_sc_20m[ss_ofst + 1], + dbg->num_qry_pkt_sc_20m[ss_ofst + 2], + dbg->num_qry_pkt_sc_20m[ss_ofst + 3], + dbg->num_qry_pkt_sc_20m[ss_ofst + 4], + dbg->num_qry_pkt_sc_20m[ss_ofst + 5], + dbg->num_qry_pkt_sc_20m[ss_ofst + 6], + dbg->num_qry_pkt_sc_20m[ss_ofst + 7], + dbg->num_qry_pkt_sc_20m[ss_ofst + 8], + dbg->num_qry_pkt_sc_20m[ss_ofst + 9]); + } + } + + if (dbg->low_bw_40_occur) { + for (i = 0; i < rate_num; i++) { + ss_ofst = 10 * i; + + PHYDM_DBG(dm, DBG_CMN, + "*[Low BW 40M] VHT-%d ss MCS[0:9] = {%d, %d, %d, %d, %d, %d, %d, %d, %d, %d}\n", + (i + 1), + dbg->num_qry_pkt_sc_40m[ss_ofst + 0], + dbg->num_qry_pkt_sc_40m[ss_ofst + 1], + dbg->num_qry_pkt_sc_40m[ss_ofst + 2], + dbg->num_qry_pkt_sc_40m[ss_ofst + 3], + dbg->num_qry_pkt_sc_40m[ss_ofst + 4], + dbg->num_qry_pkt_sc_40m[ss_ofst + 5], + dbg->num_qry_pkt_sc_40m[ss_ofst + 6], + dbg->num_qry_pkt_sc_40m[ss_ofst + 7], + dbg->num_qry_pkt_sc_40m[ss_ofst + 8], + dbg->num_qry_pkt_sc_40m[ss_ofst + 9]); + } + } + } +#endif +} + +u16 phydm_rx_utility(void *dm_void, u16 avg_phy_rate, u8 rx_max_ss, + enum channel_width bw) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct odm_phy_dbg_info *dbg = &dm->phy_dbg_info; + u16 utility_primitive = 0, utility = 0; + + if (dbg->ht_pkt_not_zero) { + /*@ MCS7 20M: tp = 65, 1000/65 = 15.38, 65*15.5 = 1007*/ + utility_primitive = avg_phy_rate * 15 + (avg_phy_rate >> 1); + } +#if (ODM_IC_11AC_SERIES_SUPPORT || defined(PHYDM_IC_JGR3_SERIES_SUPPORT)) + else if (dbg->vht_pkt_not_zero) { + /*@ VHT 1SS MCS9(fake) 20M: tp = 90, 1000/90 = 11.11, 65*11.125 = 1001*/ + utility_primitive = avg_phy_rate * 11 + (avg_phy_rate >> 3); + } +#endif + else { + /*@ 54M, 1000/54 = 18.5, 54*18.5 = 999*/ + utility_primitive = avg_phy_rate * 18 + (avg_phy_rate >> 1); + } + + utility = (utility_primitive / rx_max_ss) >> bw; + + if (utility > 1000) + utility = 1000; + + return utility; +} + +u16 phydm_rx_avg_phy_rate(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct odm_phy_dbg_info *dbg = &dm->phy_dbg_info; + u8 i = 0, rate_num = 0, rate_base = 0; + u16 rate = 0, avg_phy_rate = 0; + u32 pkt_cnt = 0, phy_rate_sum = 0; + + if (dbg->ht_pkt_not_zero) { + rate_num = HT_RATE_NUM; + rate_base = ODM_RATEMCS0; + for (i = 0; i < rate_num; i++) { + rate = phy_rate_table[i + rate_base] << *dm->band_width; + phy_rate_sum += dbg->num_qry_ht_pkt[i] * rate; + pkt_cnt += dbg->num_qry_ht_pkt[i]; + } + } +#if (ODM_IC_11AC_SERIES_SUPPORT || defined(PHYDM_IC_JGR3_SERIES_SUPPORT)) + else if (dbg->vht_pkt_not_zero) { + rate_num = VHT_RATE_NUM; + rate_base = ODM_RATEVHTSS1MCS0; + for (i = 0; i < rate_num; i++) { + rate = phy_rate_table[i + rate_base] << *dm->band_width; + phy_rate_sum += dbg->num_qry_vht_pkt[i] * rate; + pkt_cnt += dbg->num_qry_vht_pkt[i]; + } + } +#endif + else { + for (i = ODM_RATE1M; i <= ODM_RATE54M; i++) { + /*SKIP 1M & 6M for beacon case*/ + if (*dm->channel < 36 && i == ODM_RATE1M) + continue; + + if (*dm->channel >= 36 && i == ODM_RATE6M) + continue; + + rate = phy_rate_table[i]; + phy_rate_sum += dbg->num_qry_legacy_pkt[i] * rate; + pkt_cnt += dbg->num_qry_legacy_pkt[i]; + } + } + +#if (ODM_IC_11AC_SERIES_SUPPORT || defined(PHYDM_IC_JGR3_SERIES_SUPPORT)) + if (dbg->low_bw_40_occur) { + for (i = 0; i < LOW_BW_RATE_NUM; i++) { + rate = phy_rate_table[i + rate_base] + << CHANNEL_WIDTH_40; + phy_rate_sum += dbg->num_qry_pkt_sc_40m[i] * rate; + pkt_cnt += dbg->num_qry_pkt_sc_40m[i]; + } + } +#endif + + if (dbg->low_bw_20_occur) { + for (i = 0; i < LOW_BW_RATE_NUM; i++) { + rate = phy_rate_table[i + rate_base]; + phy_rate_sum += dbg->num_qry_pkt_sc_20m[i] * rate; + pkt_cnt += dbg->num_qry_pkt_sc_20m[i]; + } + } + + avg_phy_rate = (pkt_cnt == 0) ? 0 : (u16)(phy_rate_sum / pkt_cnt); + + return avg_phy_rate; +} + +void phydm_print_hist_2_buf(void *dm_void, u16 *val, u16 len, char *buf, + u16 buf_size) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (len == PHY_HIST_SIZE) { + PHYDM_SNPRINTF(buf, buf_size, + "[%.2d, %.2d, %.2d, %.2d, %.2d, %.2d, %.2d, %.2d, %.2d, %.2d, %.2d, %.2d]", + val[0], val[1], val[2], val[3], val[4], + val[5], val[6], val[7], val[8], val[9], + val[10], val[11]); + } else if (len == (PHY_HIST_SIZE - 1)) { + PHYDM_SNPRINTF(buf, buf_size, + "[%.2d, %.2d, %.2d, %.2d, %.2d, %.2d, %.2d, %.2d, %.2d, %.2d, %.2d]", + val[0], val[1], val[2], val[3], val[4], + val[5], val[6], val[7], val[8], val[9], + val[10]); + } +} + +void phydm_nss_hitogram(void *dm_void, enum PDM_RATE_TYPE rate_type) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct odm_phy_dbg_info *dbg_i = &dm->phy_dbg_info; + struct phydm_phystatus_statistic *dbg_s = &dbg_i->physts_statistic_info; + char buf[PHYDM_SNPRINT_SIZE] = {0}; + u16 buf_size = PHYDM_SNPRINT_SIZE; + u16 h_size = PHY_HIST_SIZE; + u16 *evm_hist = &dbg_s->evm_1ss_hist[0]; + u16 *snr_hist = &dbg_s->snr_1ss_hist[0]; + u8 i = 0; + u8 ss = phydm_rate_type_2_num_ss(dm, rate_type); + + for (i = 0; i < ss; i++) { + if (rate_type == PDM_1SS) { + evm_hist = &dbg_s->evm_1ss_hist[0]; + snr_hist = &dbg_s->snr_1ss_hist[0]; + } else if (rate_type == PDM_2SS) { + #if (defined(PHYDM_COMPILE_ABOVE_2SS)) + evm_hist = &dbg_s->evm_2ss_hist[i][0]; + snr_hist = &dbg_s->snr_2ss_hist[i][0]; + #endif + } else if (rate_type == PDM_3SS) { + #if (defined(PHYDM_COMPILE_ABOVE_3SS)) + evm_hist = &dbg_s->evm_3ss_hist[i][0]; + snr_hist = &dbg_s->snr_3ss_hist[i][0]; + #endif + } else if (rate_type == PDM_4SS) { + #if (defined(PHYDM_COMPILE_ABOVE_4SS)) + evm_hist = &dbg_s->evm_4ss_hist[i][0]; + snr_hist = &dbg_s->snr_4ss_hist[i][0]; + #endif + } + + phydm_print_hist_2_buf(dm, evm_hist, h_size, buf, buf_size); + PHYDM_DBG(dm, DBG_CMN, "[%d-SS][EVM][%d]=%s\n", ss, i, buf); + phydm_print_hist_2_buf(dm, snr_hist, h_size, buf, buf_size); + PHYDM_DBG(dm, DBG_CMN, "[%d-SS][SNR][%d]=%s\n", ss, i, buf); + } +} + +void phydm_show_phy_hitogram(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct odm_phy_dbg_info *dbg_i = &dm->phy_dbg_info; + struct phydm_phystatus_statistic *dbg_s = &dbg_i->physts_statistic_info; + char buf[PHYDM_SNPRINT_SIZE] = {0}; + u16 buf_size = PHYDM_SNPRINT_SIZE; + u16 th_size = PHY_HIST_SIZE - 1; + u8 i = 0; + + PHYDM_DBG(dm, DBG_CMN, "[PHY Histogram] ==============>\n"); +/*@===[Threshold]=============================================================*/ + phydm_print_hist_2_buf(dm, dbg_i->evm_hist_th, th_size, buf, buf_size); + PHYDM_DBG(dm, DBG_CMN, "%-16s=%s\n", "[EVM_TH]", buf); + + phydm_print_hist_2_buf(dm, dbg_i->snr_hist_th, th_size, buf, buf_size); + PHYDM_DBG(dm, DBG_CMN, "%-16s=%s\n", "[SNR_TH]", buf); +/*@===[OFDM]==================================================================*/ + if (dbg_s->rssi_ofdm_cnt) { + phydm_print_hist_2_buf(dm, dbg_s->evm_ofdm_hist, PHY_HIST_SIZE, + buf, buf_size); + PHYDM_DBG(dm, DBG_CMN, "%-14s=%s\n", "[OFDM][EVM]", buf); + + phydm_print_hist_2_buf(dm, dbg_s->snr_ofdm_hist, PHY_HIST_SIZE, + buf, buf_size); + PHYDM_DBG(dm, DBG_CMN, "%-14s=%s\n", "[OFDM][SNR]", buf); + } +/*@===[1-SS]==================================================================*/ + if (dbg_s->rssi_1ss_cnt) + phydm_nss_hitogram(dm, PDM_1SS); +/*@===[2-SS]==================================================================*/ + #if (defined(PHYDM_COMPILE_ABOVE_2SS)) + if ((dm->support_ic_type & PHYDM_IC_ABOVE_2SS) && dbg_s->rssi_2ss_cnt) + phydm_nss_hitogram(dm, PDM_2SS); + #endif +/*@===[3-SS]==================================================================*/ + #if (defined(PHYDM_COMPILE_ABOVE_3SS)) + if ((dm->support_ic_type & PHYDM_IC_ABOVE_3SS) && dbg_s->rssi_3ss_cnt) + phydm_nss_hitogram(dm, PDM_3SS); + #endif +/*@===[4-SS]==================================================================*/ + #if (defined(PHYDM_COMPILE_ABOVE_4SS)) + if (dm->support_ic_type & PHYDM_IC_ABOVE_4SS && dbg_s->rssi_4ss_cnt) + phydm_nss_hitogram(dm, PDM_4SS); + #endif +} + +void phydm_avg_phy_val_nss(void *dm_void, u8 nss) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct odm_phy_dbg_info *dbg_i = &dm->phy_dbg_info; + struct phydm_phystatus_statistic *dbg_s = &dbg_i->physts_statistic_info; + struct phydm_phystatus_avg *dbg_avg = &dbg_i->phystatus_statistic_avg; + char *rate_type = NULL; + u32 *tmp_cnt = NULL; + u8 *tmp_rssi_avg = NULL; + u32 *tmp_rssi_sum = NULL; + u8 *tmp_snr_avg = NULL; + u32 *tmp_snr_sum = NULL; + u8 *tmp_evm_avg = NULL; + u32 *tmp_evm_sum = NULL; + u8 evm_rpt_show[RF_PATH_MEM_SIZE]; + u8 i = 0; + + odm_memory_set(dm, &evm_rpt_show[0], 0, RF_PATH_MEM_SIZE); + + switch (nss) { + #if (defined(PHYDM_COMPILE_ABOVE_4SS)) + case 4: + rate_type = "[4-SS]"; + tmp_cnt = &dbg_s->rssi_4ss_cnt; + tmp_rssi_avg = &dbg_avg->rssi_4ss_avg[0]; + tmp_snr_avg = &dbg_avg->snr_4ss_avg[0]; + tmp_rssi_sum = &dbg_s->rssi_4ss_sum[0]; + tmp_snr_sum = &dbg_s->snr_4ss_sum[0]; + tmp_evm_avg = &dbg_avg->evm_4ss_avg[0]; + tmp_evm_sum = &dbg_s->evm_4ss_sum[0]; + break; + #endif + #if (defined(PHYDM_COMPILE_ABOVE_3SS)) + case 3: + rate_type = "[3-SS]"; + tmp_cnt = &dbg_s->rssi_3ss_cnt; + tmp_rssi_avg = &dbg_avg->rssi_3ss_avg[0]; + tmp_snr_avg = &dbg_avg->snr_3ss_avg[0]; + tmp_rssi_sum = &dbg_s->rssi_3ss_sum[0]; + tmp_snr_sum = &dbg_s->snr_3ss_sum[0]; + tmp_evm_avg = &dbg_avg->evm_3ss_avg[0]; + tmp_evm_sum = &dbg_s->evm_3ss_sum[0]; + break; + #endif + #if (defined(PHYDM_COMPILE_ABOVE_2SS)) + case 2: + rate_type = "[2-SS]"; + tmp_cnt = &dbg_s->rssi_2ss_cnt; + tmp_rssi_avg = &dbg_avg->rssi_2ss_avg[0]; + tmp_snr_avg = &dbg_avg->snr_2ss_avg[0]; + tmp_rssi_sum = &dbg_s->rssi_2ss_sum[0]; + tmp_snr_sum = &dbg_s->snr_2ss_sum[0]; + tmp_evm_avg = &dbg_avg->evm_2ss_avg[0]; + tmp_evm_sum = &dbg_s->evm_2ss_sum[0]; + break; + #endif + case 1: + rate_type = "[1-SS]"; + tmp_cnt = &dbg_s->rssi_1ss_cnt; + tmp_rssi_avg = &dbg_avg->rssi_1ss_avg[0]; + tmp_snr_avg = &dbg_avg->snr_1ss_avg[0]; + tmp_rssi_sum = &dbg_s->rssi_1ss_sum[0]; + tmp_snr_sum = &dbg_s->snr_1ss_sum[0]; + tmp_evm_avg = &dbg_avg->evm_1ss_avg; + tmp_evm_sum = &dbg_s->evm_1ss_sum; + break; + default: + rate_type = "[L-OFDM]"; + tmp_cnt = &dbg_s->rssi_ofdm_cnt; + tmp_rssi_avg = &dbg_avg->rssi_ofdm_avg[0]; + tmp_snr_avg = &dbg_avg->snr_ofdm_avg[0]; + tmp_rssi_sum = &dbg_s->rssi_ofdm_sum[0]; + tmp_snr_sum = &dbg_s->snr_ofdm_sum[0]; + tmp_evm_avg = &dbg_avg->evm_ofdm_avg; + tmp_evm_sum = &dbg_s->evm_ofdm_sum; + break; + } + + if (*tmp_cnt != 0) { + for (i = 0; i < dm->num_rf_path; i++) { + tmp_rssi_avg[i] = (u8)(tmp_rssi_sum[i] / *tmp_cnt); + tmp_snr_avg[i] = (u8)(tmp_snr_sum[i] / *tmp_cnt); + } + + if (nss > 1) { + for (i = 0; i < nss; i++) { + tmp_evm_avg[i] = (u8)(tmp_evm_sum[i] / + *tmp_cnt); + evm_rpt_show[i] = tmp_evm_avg[i]; + } + } else { + *tmp_evm_avg = (u8)(*tmp_evm_sum / *tmp_cnt); + evm_rpt_show[0] = *tmp_evm_avg; + } + } + +#if (defined(PHYDM_COMPILE_ABOVE_4SS)) + PHYDM_DBG(dm, DBG_CMN, + "* %-8s Cnt=((%.3d)) RSSI:{%.2d, %.2d, %.2d, %.2d} SNR:{%.2d, %.2d, %.2d, %.2d} EVM:{-%.2d, -%.2d, -%.2d, -%.2d}\n", + rate_type, *tmp_cnt, + tmp_rssi_avg[0], tmp_rssi_avg[1], tmp_rssi_avg[2], + tmp_rssi_avg[3], tmp_snr_avg[0], tmp_snr_avg[1], + tmp_snr_avg[2], tmp_snr_avg[3], evm_rpt_show[0], + evm_rpt_show[1], evm_rpt_show[2], evm_rpt_show[3]); +#elif (defined(PHYDM_COMPILE_ABOVE_3SS)) + PHYDM_DBG(dm, DBG_CMN, + "* %-8s Cnt=((%.3d)) RSSI:{%.2d, %.2d, %.2d} SNR:{%.2d, %.2d, %.2d} EVM:{-%.2d, -%.2d, -%.2d}\n", + rate_type, *tmp_cnt, + tmp_rssi_avg[0], tmp_rssi_avg[1], tmp_rssi_avg[2], + tmp_snr_avg[0], tmp_snr_avg[1], tmp_snr_avg[2], + evm_rpt_show[0], evm_rpt_show[1], evm_rpt_show[2]); +#elif (defined(PHYDM_COMPILE_ABOVE_2SS)) + PHYDM_DBG(dm, DBG_CMN, + "* %-8s Cnt= ((%.3d)) RSSI:{%.2d, %.2d} SNR:{%.2d, %.2d} EVM:{-%.2d, -%.2d}\n", + rate_type, *tmp_cnt, + tmp_rssi_avg[0], tmp_rssi_avg[1], + tmp_snr_avg[0], tmp_snr_avg[1], + evm_rpt_show[0], evm_rpt_show[1]); +#else + PHYDM_DBG(dm, DBG_CMN, + "* %-8s Cnt= ((%.3d)) RSSI:{%.2d} SNR:{%.2d} EVM:{-%.2d}\n", + rate_type, *tmp_cnt, + tmp_rssi_avg[0], tmp_snr_avg[0], evm_rpt_show[0]); +#endif +} + +void phydm_get_avg_phystatus_val(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct odm_phy_dbg_info *dbg_i = &dm->phy_dbg_info; + struct phydm_phystatus_statistic *dbg_s = &dbg_i->physts_statistic_info; + struct phydm_phystatus_avg *dbg_avg = &dbg_i->phystatus_statistic_avg; + u8 i = 0; + + PHYDM_DBG(dm, DBG_CMN, "[PHY Avg] ==============>\n"); + phydm_reset_phystatus_avg(dm); + + /*@===[Beacon]===*/ + if (dbg_s->rssi_beacon_cnt) { + dbg_avg->rssi_beacon_avg = (u8)(dbg_s->rssi_beacon_sum / + dbg_s->rssi_beacon_cnt); + } + PHYDM_DBG(dm, DBG_CMN, "* %-8s Cnt=((%.3d)) RSSI:{%.2d}\n", + "[Beacon]", dbg_s->rssi_beacon_cnt, dbg_avg->rssi_beacon_avg); + + /*@===[CCK]===*/ + if (dbg_s->rssi_cck_cnt) { + dbg_avg->rssi_cck_avg = (u8)(dbg_s->rssi_cck_sum / + dbg_s->rssi_cck_cnt); + } + PHYDM_DBG(dm, DBG_CMN, "* %-8s Cnt=((%.3d)) RSSI:{%.2d}\n", + "[CCK]", dbg_s->rssi_cck_cnt, dbg_avg->rssi_cck_avg); + +#if 1 + for (i = 0; i <= 4; i++) { + if (i > dm->num_rf_path) + break; + + phydm_avg_phy_val_nss(dm, i); + } +#else + /*@===[OFDM]===*/ + phydm_avg_phy_val_nss(dm, 0); + /*@===[1-SS]===*/ + phydm_avg_phy_val_nss(dm, 1); + /*@===[2-SS]===*/ + #if (defined(PHYDM_COMPILE_ABOVE_2SS)) + if (dm->support_ic_type & (PHYDM_IC_ABOVE_2SS)) + phydm_avg_phy_val_nss(dm, 2); + #endif + /*@===[3-SS]===*/ + #if (defined(PHYDM_COMPILE_ABOVE_3SS)) + if (dm->support_ic_type & (PHYDM_IC_ABOVE_3SS)) + phydm_avg_phy_val_nss(dm, 3); + #endif + /*@===[4-SS]===*/ + #if (defined(PHYDM_COMPILE_ABOVE_4SS)) + if (dm->support_ic_type & PHYDM_IC_ABOVE_4SS) + phydm_avg_phy_val_nss(dm, 4); + #endif +#endif +} + +void phydm_get_phy_statistic(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct cmn_sta_info *sta = dm->phydm_sta_info[dm->one_entry_macid]; + enum channel_width bw; + u16 avg_phy_rate = 0; + u16 utility = 0; + u8 rx_ss = 1; + + avg_phy_rate = phydm_rx_avg_phy_rate(dm); + + if (dm->is_one_entry_only && is_sta_active(sta)) { + rx_ss = phydm_get_rx_stream_num(dm, sta->mimo_type); + bw = sta->bw_mode; + utility = phydm_rx_utility(dm, avg_phy_rate, rx_ss, bw); + } + PHYDM_DBG(dm, DBG_CMN, "Avg_rx_rate = %d, rx_utility=( %d / 1000 )\n", + avg_phy_rate, utility); + + phydm_rx_rate_distribution(dm); + phydm_reset_rx_rate_distribution(dm); + + phydm_show_phy_hitogram(dm); + phydm_get_avg_phystatus_val(dm); + phydm_reset_phystatus_statistic(dm); +}; + +void phydm_basic_dbg_msg_linked(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_cfo_track_struct *cfo_t = &dm->dm_cfo_track; + struct odm_phy_dbg_info *dbg_t = &dm->phy_dbg_info; + u16 macid, client_cnt = 0; + u8 rate = 0; + struct cmn_sta_info *entry = NULL; + char dbg_buf[PHYDM_SNPRINT_SIZE] = {0}; + struct phydm_cfo_rpt cfo; + u8 i = 0; + + PHYDM_DBG(dm, DBG_CMN, "ID=((%d)), BW=((%d)), fc=((CH-%d))\n", + dm->curr_station_id, 20 << *dm->band_width, *dm->channel); + + #ifdef ODM_IC_11N_SERIES_SUPPORT + #ifdef PHYDM_PRIMARY_CCA + if (((*dm->channel <= 14) && (*dm->band_width == CHANNEL_WIDTH_40)) && + (dm->support_ic_type & ODM_IC_11N_SERIES)) { + PHYDM_DBG(dm, DBG_CMN, "Primary CCA at ((%s SB))\n", + ((*dm->sec_ch_offset == SECOND_CH_AT_LSB) ? "U" : + "L")); + } + #endif + #endif + + if ((dm->support_ic_type & PHYSTS_2ND_TYPE_IC) || + dm->rx_rate > ODM_RATE11M) { + PHYDM_DBG(dm, DBG_CMN, "[AGC Idx] {0x%x, 0x%x, 0x%x, 0x%x}\n", + dm->ofdm_agc_idx[0], dm->ofdm_agc_idx[1], + dm->ofdm_agc_idx[2], dm->ofdm_agc_idx[3]); + } else { + PHYDM_DBG(dm, DBG_CMN, "[CCK AGC Idx] {LNA,VGA}={0x%x, 0x%x}\n", + dm->cck_lna_idx, dm->cck_vga_idx); + } + + phydm_print_rate_2_buff(dm, dm->rx_rate, dbg_buf, PHYDM_SNPRINT_SIZE); + PHYDM_DBG(dm, DBG_CMN, "RSSI:{%d, %d, %d, %d}, RxRate:%s (0x%x)\n", + (dm->rssi_a == 0xff) ? 0 : dm->rssi_a, + (dm->rssi_b == 0xff) ? 0 : dm->rssi_b, + (dm->rssi_c == 0xff) ? 0 : dm->rssi_c, + (dm->rssi_d == 0xff) ? 0 : dm->rssi_d, + dbg_buf, dm->rx_rate); + + rate = dbg_t->beacon_phy_rate; + phydm_print_rate_2_buff(dm, rate, dbg_buf, PHYDM_SNPRINT_SIZE); + + PHYDM_DBG(dm, DBG_CMN, "Beacon_cnt=%d, rate_idx=%s (0x%x)\n", + dbg_t->num_qry_beacon_pkt, dbg_buf, dbg_t->beacon_phy_rate); + + phydm_get_phy_statistic(dm); + + PHYDM_DBG(dm, DBG_CMN, + "rxsc_idx {Legacy, 20, 40, 80} = {%d, %d, %d, %d}\n", + dm->rxsc_l, dm->rxsc_20, dm->rxsc_40, dm->rxsc_80); + + /*Print TX rate*/ + for (macid = 0; macid < ODM_ASSOCIATE_ENTRY_NUM; macid++) { + entry = dm->phydm_sta_info[macid]; + + if (!is_sta_active(entry)) + continue; + + rate = entry->ra_info.curr_tx_rate; + phydm_print_rate_2_buff(dm, rate, dbg_buf, PHYDM_SNPRINT_SIZE); + PHYDM_DBG(dm, DBG_CMN, "TxRate[%d]=%s (0x%x)\n", + macid, dbg_buf, entry->ra_info.curr_tx_rate); + + client_cnt++; + + if (client_cnt >= dm->number_linked_client) + break; + } + + PHYDM_DBG(dm, DBG_CMN, + "TP {Tx, Rx, Total} = {%d, %d, %d}Mbps, Traffic_Load=(%d))\n", + dm->tx_tp, dm->rx_tp, dm->total_tp, dm->traffic_load); + + PHYDM_DBG(dm, DBG_CMN, "CFO_avg=((%d kHz)), CFO_traking = ((%s%d))\n", + cfo_t->CFO_ave_pre, + ((cfo_t->crystal_cap > cfo_t->def_x_cap) ? "+" : "-"), + DIFF_2(cfo_t->crystal_cap, cfo_t->def_x_cap)); + + /* @CFO report */ + switch (dm->ic_ip_series) { + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + case PHYDM_IC_JGR3: + PHYDM_DBG(dm, DBG_CMN, "cfo_tail = {%d, %d, %d, %d}\n", + dbg_t->cfo_tail[0], dbg_t->cfo_tail[1], + dbg_t->cfo_tail[2], dbg_t->cfo_tail[3]); + break; + #endif + default: + phydm_get_cfo_info(dm, &cfo); + for (i = 0; i < dm->num_rf_path; i++) { + PHYDM_DBG(dm, DBG_CMN, + "CFO[%d] {S, L, Sec, Acq, End} = {%d, %d, %d, %d, %d}\n", + i, cfo.cfo_rpt_s[i], cfo.cfo_rpt_l[i], + cfo.cfo_rpt_sec[i], cfo.cfo_rpt_acq[i], + cfo.cfo_rpt_end[i]); + } + break; + } + +/* @Condition number */ +#if (RTL8822B_SUPPORT) + if (dm->support_ic_type == ODM_RTL8822B) { + PHYDM_DBG(dm, DBG_CMN, "Condi_Num=((%d.%.4d)), %d\n", + dbg_t->condi_num >> 4, + phydm_show_fraction_num(dbg_t->condi_num & 0xf, 4), + dbg_t->condi_num); + } +#endif +#ifdef PHYSTS_3RD_TYPE_SUPPORT + if (dm->support_ic_type & PHYSTS_3RD_TYPE_IC) { + PHYDM_DBG(dm, DBG_CMN, "Condi_Num=((%d.%4d dB))\n", + dbg_t->condi_num >> 1, + phydm_show_fraction_num(dbg_t->condi_num & 0x1, 1)); + } +#endif + +#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT || defined(PHYSTS_3RD_TYPE_SUPPORT)) + /*STBC or LDPC pkt*/ + if (dm->support_ic_type & (PHYSTS_2ND_TYPE_IC | PHYSTS_3RD_TYPE_IC)) + PHYDM_DBG(dm, DBG_CMN, "Coding: LDPC=((%s)), STBC=((%s))\n", + (dbg_t->is_ldpc_pkt) ? "Y" : "N", + (dbg_t->is_stbc_pkt) ? "Y" : "N"); +#endif +} + +void phydm_dm_summary(void *dm_void, u8 macid) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + struct phydm_cfo_track_struct *cfo_t = &dm->dm_cfo_track; + struct cmn_sta_info *sta = NULL; + struct ra_sta_info *ra = NULL; + struct dtp_info *dtp = NULL; + u64 comp = dm->support_ability; + u64 pause_comp = dm->pause_ability; + + if (!(dm->debug_components & DBG_DM_SUMMARY)) + return; + + if (!dm->is_linked) { + pr_debug("[%s]No Link !!!\n", __func__); + return; + } + + sta = dm->phydm_sta_info[macid]; + + if (!is_sta_active(sta)) { + pr_debug("[Warning] %s invalid STA, macid=%d\n", + __func__, macid); + return; + } + + ra = &sta->ra_info; + dtp = &sta->dtp_stat; + pr_debug("[%s]===========>\n", __func__); + + pr_debug("00.(%s) %-12s: IGI=0x%x, Dyn_Rng=0x%x~0x%x, FA_th={%d,%d,%d}\n", + ((comp & ODM_BB_DIG) ? + ((pause_comp & ODM_BB_DIG) ? "P" : "V") : "."), + "DIG", + dig_t->cur_ig_value, + dig_t->rx_gain_range_min, dig_t->rx_gain_range_max, + dig_t->fa_th[0], dig_t->fa_th[1], dig_t->fa_th[2]); + + pr_debug("01.(%s) %-12s: rssi_lv=%d, mask=0x%llx\n", + ((comp & ODM_BB_RA_MASK) ? + ((pause_comp & ODM_BB_RA_MASK) ? "P" : "V") : "."), + "RaMask", + ra->rssi_level, ra->ramask); + +#ifdef CONFIG_DYNAMIC_TX_TWR + pr_debug("02.(%s) %-12s: pwr_lv=%d\n", + ((comp & ODM_BB_DYNAMIC_TXPWR) ? + ((pause_comp & ODM_BB_DYNAMIC_TXPWR) ? "P" : "V") : "."), + "DynTxPwr", + dtp->sta_tx_high_power_lvl); +#endif + + pr_debug("05.(%s) %-12s: cck_pd_lv=%d\n", + ((comp & ODM_BB_CCK_PD) ? + ((pause_comp & ODM_BB_CCK_PD) ? "P" : "V") : "."), + "CCK_PD", dm->dm_cckpd_table.cck_pd_lv); + +#ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY + pr_debug("06.(%s) %-12s: div_type=%d, curr_ant=%s\n", + ((comp & ODM_BB_ANT_DIV) ? + ((pause_comp & ODM_BB_ANT_DIV) ? "P" : "V") : "."), + "ANT_DIV", + dm->ant_div_type, + (dm->dm_fat_table.rx_idle_ant == MAIN_ANT) ? "MAIN" : "AUX"); +#endif + +#ifdef PHYDM_POWER_TRAINING_SUPPORT + pr_debug("08.(%s) %-12s: PT_score=%d, disable_PT=%d\n", + ((comp & ODM_BB_PWR_TRAIN) ? + ((pause_comp & ODM_BB_PWR_TRAIN) ? "P" : "V") : "."), + "PwrTrain", + dm->pow_train_table.pow_train_score, + dm->is_disable_power_training); +#endif + +#ifdef CONFIG_PHYDM_DFS_MASTER + pr_debug("11.(%s) %-12s: dbg_mode=%d, region_domain=%d\n", + ((comp & ODM_BB_DFS) ? + ((pause_comp & ODM_BB_DFS) ? "P" : "V") : "."), + "DFS", + dm->dfs.dbg_mode, dm->dfs_region_domain); +#endif +#ifdef PHYDM_SUPPORT_ADAPTIVITY + pr_debug("13.(%s) %-12s: th{l2h, h2l}={%d, %d}, edcca_flag=%d\n", + ((comp & ODM_BB_ADAPTIVITY) ? + ((pause_comp & ODM_BB_ADAPTIVITY) ? "P" : "V") : "."), + "Adaptivity", + dm->adaptivity.th_l2h, dm->adaptivity.th_h2l, + dm->false_alm_cnt.edcca_flag); +#endif + pr_debug("14.(%s) %-12s: CFO_avg=%d kHz, CFO_traking=%s%d\n", + ((comp & ODM_BB_CFO_TRACKING) ? + ((pause_comp & ODM_BB_CFO_TRACKING) ? "P" : "V") : "."), + "CfoTrack", + cfo_t->CFO_ave_pre, + ((cfo_t->crystal_cap > cfo_t->def_x_cap) ? "+" : "-"), + DIFF_2(cfo_t->crystal_cap, cfo_t->def_x_cap)); + + pr_debug("15.(%s) %-12s: ratio{nhm, clm}={%d, %d}\n", + ((comp & ODM_BB_ENV_MONITOR) ? + ((pause_comp & ODM_BB_ENV_MONITOR) ? "P" : "V") : "."), + "EnvMntr", + dm->dm_ccx_info.nhm_ratio, dm->dm_ccx_info.clm_ratio); + +#ifdef PHYDM_PRIMARY_CCA + pr_debug("16.(%s) %-12s: CCA @ (%s SB)\n", + ((comp & ODM_BB_PRIMARY_CCA) ? + ((pause_comp & ODM_BB_PRIMARY_CCA) ? "P" : "V") : "."), + "PriCCA", + ((dm->dm_pri_cca.mf_state == MF_USC_LSC) ? "D" : + ((dm->dm_pri_cca.mf_state == MF_LSC) ? "L" : "U"))); +#endif +#ifdef CONFIG_ADAPTIVE_SOML + pr_debug("17.(%s) %-12s: soml_en = %s\n", + ((comp & ODM_BB_ADAPTIVE_SOML) ? + ((pause_comp & ODM_BB_ADAPTIVE_SOML) ? "P" : "V") : "."), + "A-SOML", + (dm->dm_soml_table.soml_last_state == SOML_ON) ? + "ON" : "OFF"); +#endif +#ifdef PHYDM_LNA_SAT_CHK_SUPPORT + pr_debug("18.(%s) %-12s:\n", + ((comp & ODM_BB_LNA_SAT_CHK) ? + ((pause_comp & ODM_BB_LNA_SAT_CHK) ? "P" : "V") : "."), + "LNA_SAT_CHK"); +#endif +} + +void phydm_basic_dbg_message(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fa_struct *fa_t = &dm->false_alm_cnt; + + if (!(dm->debug_components & DBG_CMN)) + return; + + + if (dm->cmn_dbg_msg_cnt >= dm->cmn_dbg_msg_period) { + dm->cmn_dbg_msg_cnt = PHYDM_WATCH_DOG_PERIOD; + } else { + dm->cmn_dbg_msg_cnt += PHYDM_WATCH_DOG_PERIOD; + return; + } + + PHYDM_DBG(dm, DBG_CMN, "[%s] System up time: ((%d sec))---->\n", + __func__, dm->phydm_sys_up_time); + + if (dm->is_linked) + phydm_basic_dbg_msg_linked(dm); + else + PHYDM_DBG(dm, DBG_CMN, "No Link !!!\n"); + + PHYDM_DBG(dm, DBG_CMN, "[CCA Cnt] {CCK, OFDM, Total} = {%d, %d, %d}\n", + fa_t->cnt_cck_cca, fa_t->cnt_ofdm_cca, fa_t->cnt_cca_all); + + PHYDM_DBG(dm, DBG_CMN, "[FA Cnt] {CCK, OFDM, Total} = {%d, %d, %d}\n", + fa_t->cnt_cck_fail, fa_t->cnt_ofdm_fail, fa_t->cnt_all); + + PHYDM_DBG(dm, DBG_CMN, + "[OFDM FA Detail] Parity_Fail=%d, Rate_Illegal=%d, CRC8=%d, MCS_fail=%d, Fast_sync=%d, SB_Search_fail=%d\n", + fa_t->cnt_parity_fail, fa_t->cnt_rate_illegal, + fa_t->cnt_crc8_fail, fa_t->cnt_mcs_fail, + fa_t->cnt_fast_fsync, fa_t->cnt_sb_search_fail); + +#if (ODM_IC_11AC_SERIES_SUPPORT || defined(PHYDM_IC_JGR3_SERIES_SUPPORT)) + if (dm->support_ic_type & (ODM_IC_11AC_SERIES | ODM_IC_JGR3_SERIES)) { + PHYDM_DBG(dm, DBG_CMN, + "[OFDM FA Detail VHT] CRC8_VHT=%d, MCS_Fail_VHT=%d\n", + fa_t->cnt_crc8_fail_vht, fa_t->cnt_mcs_fail_vht); + } +#endif + + PHYDM_DBG(dm, DBG_CMN, + "is_linked = %d, Num_client = %d, rssi_min = %d, IGI = 0x%x, bNoisy=%d\n\n", + dm->is_linked, dm->number_linked_client, dm->rssi_min, + dm->dm_dig_table.cur_ig_value, dm->noisy_decision); +} + +void phydm_basic_profile(void *dm_void, u32 *_used, char *output, u32 *_out_len) +{ +#ifdef CONFIG_PHYDM_DEBUG_FUNCTION + struct dm_struct *dm = (struct dm_struct *)dm_void; + char *cut = NULL; char *ic_type = NULL; u32 used = *_used; u32 out_len = *_out_len; - u32 commit_ver = 0; - u32 date = 0; - char *commit_by = NULL; - u32 release_ver = 0; + u32 date = 0; + char *commit_by = NULL; + u32 release_ver = 0; - PHYDM_SNPRINTF((output + used, out_len - used, "%-35s\n", "% Basic Profile %")); + PDM_SNPF(out_len, used, output + used, out_len - used, "%-35s\n", + "% Basic Profile %"); - if (p_dm_odm->support_ic_type == ODM_RTL8188E) { -#if (RTL8188E_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8188E) { +#if (RTL8188E_SUPPORT) 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_odm->support_ic_type == ODM_RTL8812) { +#if (RTL8812A_SUPPORT) + } else if (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_odm->support_ic_type == ODM_RTL8821) { +#if (RTL8821A_SUPPORT) + } else if (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_odm->support_ic_type == ODM_RTL8192E) { +#if (RTL8192E_SUPPORT) + } else if (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_odm->support_ic_type == ODM_RTL8723B) { +#if (RTL8723B_SUPPORT) + } else if (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_odm->support_ic_type == ODM_RTL8814A) { +#if (RTL8814A_SUPPORT) + } else if (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_odm->support_ic_type == ODM_RTL8881A) { +#if (RTL8881A_SUPPORT) + } else if (dm->support_ic_type == ODM_RTL8881A) { ic_type = "RTL8881A"; - /**/ - } #endif -#if (RTL8822B_SUPPORT == 1) - else if (p_dm_odm->support_ic_type == ODM_RTL8822B) { +#if (RTL8822B_SUPPORT) + } else if (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_odm->support_ic_type == ODM_RTL8197F) { +#if (RTL8197F_SUPPORT) + } else if (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_odm->support_ic_type == ODM_RTL8703B) { - +#if (RTL8703B_SUPPORT) + } else if (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_odm->support_ic_type == ODM_RTL8195A) { +#if (RTL8195A_SUPPORT) + } else if (dm->support_ic_type == ODM_RTL8195A) { ic_type = "RTL8195A"; - /**/ - } #endif -#if (RTL8188F_SUPPORT == 1) - else if (p_dm_odm->support_ic_type == ODM_RTL8188F) { +#if (RTL8188F_SUPPORT) + } else if (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_odm->support_ic_type == ODM_RTL8723D) { +#if (RTL8723D_SUPPORT) + } else if (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) + else if (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_odm->support_ic_type == ODM_RTL8821C) { + +#if (RTL8721D_SUPPORT) + else if (dm->support_ic_type == ODM_RTL8721D) { + ic_type = "RTL8721D"; + date = RELEASE_DATE_8721D; + commit_by = COMMIT_BY_8721D; + release_ver = RELEASE_VERSION_8721D; + } +#endif +#if (RTL8821C_SUPPORT) + else if (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_odm->is_mp_chip ? "Yes" : "No")); - if (p_dm_odm->cut_version == ODM_CUT_A) +/*@jj add 20170822*/ +#if (RTL8192F_SUPPORT) + else if (dm->support_ic_type == ODM_RTL8192F) { + ic_type = "RTL8192F"; + date = RELEASE_DATE_8192F; + commit_by = COMMIT_BY_8192F; + release_ver = RELEASE_VERSION_8192F; + } +#endif + +#if (RTL8198F_SUPPORT) + else if (dm->support_ic_type == ODM_RTL8198F) { + ic_type = "RTL8198F"; + date = RELEASE_DATE_8198F; + commit_by = COMMIT_BY_8198F; + release_ver = RELEASE_VERSION_8198F; + } +#endif + +#if (RTL8822C_SUPPORT) + else if (dm->support_ic_type == ODM_RTL8822C) { + ic_type = "RTL8822C"; + date = RELEASE_DATE_8822C; + commit_by = COMMIT_BY_8822C; + release_ver = RELEASE_VERSION_8822C; + } +#endif + +#if (RTL8812F_SUPPORT) + else if (dm->support_ic_type == ODM_RTL8812F) { + ic_type = "RTL8812F"; + date = RELEASE_DATE_8812F; + commit_by = COMMIT_BY_8812F; + release_ver = RELEASE_VERSION_8812F; + } +#endif + +#if (RTL8197G_SUPPORT) + else if (dm->support_ic_type == ODM_RTL8197G) { + ic_type = "RTL8197G"; + date = RELEASE_DATE_8197G; + commit_by = COMMIT_BY_8197G; + release_ver = RELEASE_VERSION_8197G; + } +#endif + +#if (RTL8814B_SUPPORT) + else if (dm->support_ic_type == ODM_RTL8814B) { + ic_type = "RTL8814B"; + date = RELEASE_DATE_8814B; + commit_by = COMMIT_BY_8814B; + release_ver = RELEASE_VERSION_8814B; + } +#endif + + PDM_SNPF(out_len, used, output + used, out_len - used, + " %-35s: %s (MP Chip: %s)\n", "IC type", ic_type, + dm->is_mp_chip ? "Yes" : "No"); + + if (dm->cut_version == ODM_CUT_A) cut = "A"; - else if (p_dm_odm->cut_version == ODM_CUT_B) + else if (dm->cut_version == ODM_CUT_B) cut = "B"; - else if (p_dm_odm->cut_version == ODM_CUT_C) + else if (dm->cut_version == ODM_CUT_C) cut = "C"; - else if (p_dm_odm->cut_version == ODM_CUT_D) + else if (dm->cut_version == ODM_CUT_D) cut = "D"; - else if (p_dm_odm->cut_version == ODM_CUT_E) + else if (dm->cut_version == ODM_CUT_E) cut = "E"; - else if (p_dm_odm->cut_version == ODM_CUT_F) + else if (dm->cut_version == ODM_CUT_F) cut = "F"; - else if (p_dm_odm->cut_version == ODM_CUT_I) + else if (dm->cut_version == ODM_CUT_G) + cut = "G"; + else if (dm->cut_version == ODM_CUT_H) + cut = "H"; + else if (dm->cut_version == 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_get_hw_img_version(p_dm_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)); + else if (dm->cut_version == ODM_CUT_J) + cut = "J"; + else if (dm->cut_version == ODM_CUT_K) + cut = "K"; + else if (dm->cut_version == ODM_CUT_L) + cut = "L"; + else if (dm->cut_version == ODM_CUT_M) + cut = "M"; + else if (dm->cut_version == ODM_CUT_N) + cut = "N"; + else if (dm->cut_version == ODM_CUT_O) + cut = "O"; + else if (dm->cut_version == ODM_CUT_TEST) + cut = "TEST"; + else + cut = "UNKNOWN"; + PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %d\n", + "RFE type", dm->rfe_type); + PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", + "Cut Ver", cut); + PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %d\n", + "PHY Para Ver", odm_get_hw_img_version(dm)); + PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %d\n", + "PHY Para Commit date", date); + PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", + "PHY Para Commit by", commit_by); + PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %d\n", + "PHY Para Release Ver", release_ver); + + PDM_SNPF(out_len, used, output + used, out_len - used, + " %-35s: %d (Subversion: %d)\n", "FW Ver", dm->fw_version, + dm->fw_sub_version); + + /* @1 PHY DM version List */ + PDM_SNPF(out_len, used, output + used, out_len - used, "%-35s\n", + "% PHYDM version %"); + PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", + "Code base", PHYDM_CODE_BASE); + PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", + "Release Date", PHYDM_RELEASE_DATE); + PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", + "Adaptivity", ADAPTIVITY_VERSION); + PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", + "DIG", DIG_VERSION); + PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", + "CFO Tracking", CFO_TRACKING_VERSION); +#ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY + PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", + "AntDiv", ANTDIV_VERSION); +#endif +#ifdef CONFIG_DYNAMIC_TX_TWR + PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", + "Dynamic TxPower", DYNAMIC_TXPWR_VERSION); +#endif + PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", + "RA Info", RAINFO_VERSION); #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - { - struct _ADAPTER *adapter = p_dm_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 = p_dm_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 - { - struct _ADAPTER *adapter = p_dm_odm->adapter; - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); - PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %d (Subversion: %d)\n", "FW version", p_hal_data->firmware_version, p_hal_data->firmware_sub_version)); - } + PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", + "AntDetect", ANTDECT_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", "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)); +#ifdef CONFIG_PATH_DIVERSITY + PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", + "PathDiv", PATHDIV_VERSION); #endif - PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Auto channel Selection", ACS_VERSION)); -#if PHYDM_SUPPORT_EDCA - PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "EDCA Turbo", EDCATURBO_VERSION)); +#ifdef CONFIG_ADAPTIVE_SOML + PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", + "Adaptive SOML", ADAPTIVE_SOML_VERSION); #endif - PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "path Diversity", 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", "Dynamic RX path", DYNAMIC_RX_PATH_VERSION)); +#if (PHYDM_LA_MODE_SUPPORT) + PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", + "LA mode", DYNAMIC_LA_MODE); +#endif +#ifdef PHYDM_PRIMARY_CCA + PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", + "Primary CCA", PRIMARYCCA_VERSION); +#endif + PDM_SNPF(out_len, used, output + used, out_len - used, " %-35s: %s\n", + "DFS", DFS_VERSION); -#if (RTL8822B_SUPPORT == 1) - if (p_dm_odm->support_ic_type & ODM_RTL8822B) - PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "PHY config 8822B", PHY_CONFIG_VERSION_8822B)); +#if (RTL8822B_SUPPORT) + if (dm->support_ic_type & ODM_RTL8822B) + PDM_SNPF(out_len, used, output + used, out_len - used, + " %-35s: %s\n", "PHY config 8822B", + PHY_CONFIG_VERSION_8822B); #endif -#if (RTL8197F_SUPPORT == 1) - if (p_dm_odm->support_ic_type & ODM_RTL8197F) - PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "PHY config 8197F", PHY_CONFIG_VERSION_8197F)); +#if (RTL8197F_SUPPORT) + if (dm->support_ic_type & ODM_RTL8197F) + PDM_SNPF(out_len, used, output + used, out_len - used, + " %-35s: %s\n", "PHY config 8197F", + PHY_CONFIG_VERSION_8197F); #endif + +/*@jj add 20170822*/ +#if (RTL8192F_SUPPORT) + if (dm->support_ic_type & ODM_RTL8192F) + PDM_SNPF(out_len, used, output + used, out_len - used, + " %-35s: %s\n", "PHY config 8192F", + PHY_CONFIG_VERSION_8192F); +#endif +#if (RTL8721D_SUPPORT) + if (dm->support_ic_type & ODM_RTL8721D) + PDM_SNPF(out_len, used, output + used, out_len - used, + " %-35s: %s\n", "PHY config 8721D", + PHY_CONFIG_VERSION_8721D); +#endif + *_used = used; *_out_len = out_len; -#endif /*#if CONFIG_PHYDM_DEBUG_FUNCTION*/ + +#endif /*@#if CONFIG_PHYDM_DEBUG_FUNCTION*/ } -#if CONFIG_PHYDM_DEBUG_FUNCTION -void -phydm_fw_trace_en_h2c( - void *p_dm_void, - bool enable, - u32 fw_debug_component, - u32 monitor_mode, - u32 macid -) +#ifdef CONFIG_PHYDM_DEBUG_FUNCTION +void phydm_fw_trace_en_h2c(void *dm_void, boolean enable, + u32 fw_dbg_comp, u32 monitor_mode, u32 macid) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 h2c_parameter[7] = {0}; - u8 cmd_length; - - if (p_dm_odm->support_ic_type & PHYDM_IC_3081_SERIES) { + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 h2c_parameter[7] = {0}; + u8 cmd_length; + if (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[1] = (u8)(fw_dbg_comp & MASKBYTE0); + h2c_parameter[2] = (u8)((fw_dbg_comp & MASKBYTE1) >> 8); + h2c_parameter[3] = (u8)((fw_dbg_comp & MASKBYTE2) >> 16); + h2c_parameter[4] = (u8)((fw_dbg_comp & 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(dm, DBG_FW_TRACE, + "[H2C] FW_debug_en: (( %d )), mode: (( %d )), macid: (( %d ))\n", + enable, monitor_mode, macid); - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("---->\n")); - if (monitor_mode == 0) - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[H2C] FW_debug_en: (( %d ))\n", enable)); - else - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[H2C] FW_debug_en: (( %d )), mode: (( %d )), macid: (( %d ))\n", enable, monitor_mode, macid)); - odm_fill_h2c_cmd(p_dm_odm, PHYDM_H2C_FW_TRACE_EN, cmd_length, h2c_parameter); + odm_fill_h2c_cmd(dm, PHYDM_H2C_FW_TRACE_EN, cmd_length, h2c_parameter); } - -#if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1 || RTL8821C_SUPPORT == 1) -bool -phydm_api_set_txagc( - struct PHY_DM_STRUCT *p_dm_odm, - u32 power_index, - enum odm_rf_radio_path_e path, - u8 hw_rate, - bool is_single_rate -) +void phydm_get_per_path_txagc(void *dm_void, u8 path, u32 *_used, char *output, + u32 *_out_len) { - bool ret = false; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 rate_idx = 0; + u8 txagc = 0; + u32 used = *_used; + u32 out_len = *_out_len; -#if ((RTL8822B_SUPPORT == 1) || (RTL8821C_SUPPORT == 1)) - if (p_dm_odm->support_ic_type & (ODM_RTL8822B | ODM_RTL8821C)) { - if (is_single_rate) { -#if (RTL8822B_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8822B) - ret = phydm_write_txagc_1byte_8822b(p_dm_odm, power_index, path, hw_rate); -#endif -#if (RTL8821C_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8821C) - ret = phydm_write_txagc_1byte_8821c(p_dm_odm, power_index, path, hw_rate); -#endif -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - set_current_tx_agc(p_dm_odm->priv, path, hw_rate, (u8)power_index); -#endif +#ifdef PHYDM_COMMON_API_SUPPORT + if (!(dm->support_ic_type & CMN_API_SUPPORT_IC)) + return; - } else { - u8 i; -#if (RTL8822B_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8822B) - ret = config_phydm_write_txagc_8822b(p_dm_odm, power_index, path, hw_rate); -#endif -#if (RTL8821C_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8821C) - ret = config_phydm_write_txagc_8821c(p_dm_odm, 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_odm->priv, path, (hw_rate + i), (u8)power_index); -#endif - } + if (dm->num_rf_path == 1 && path > RF_PATH_A) + return; + else if (dm->num_rf_path == 2 && path > RF_PATH_B) + return; + else if (dm->num_rf_path == 3 && path > RF_PATH_C) + return; + else if (dm->num_rf_path == 4 && path > RF_PATH_D) + return; + + for (rate_idx = 0; rate_idx <= 0x53; rate_idx++) { + if (!(dm->support_ic_type & PHYDM_IC_ABOVE_3SS) && + ((rate_idx >= ODM_RATEMCS16 && + rate_idx < ODM_RATEVHTSS1MCS0) || + rate_idx >= ODM_RATEVHTSS3MCS0)) + continue; + + if (rate_idx == ODM_RATE1M) + PDM_SNPF(out_len, used, output + used, out_len - used, + " %-35s\n", "CCK====>"); + else if (rate_idx == ODM_RATE6M) + PDM_SNPF(out_len, used, output + used, out_len - used, + "\n %-35s\n", "OFDM====>"); + else if (rate_idx == ODM_RATEMCS0) + PDM_SNPF(out_len, used, output + used, out_len - used, + "\n %-35s\n", "HT 1ss====>"); + else if (rate_idx == ODM_RATEMCS8) + PDM_SNPF(out_len, used, output + used, out_len - used, + "\n %-35s\n", "HT 2ss====>"); + else if (rate_idx == ODM_RATEMCS16) + PDM_SNPF(out_len, used, output + used, out_len - used, + "\n %-35s\n", "HT 3ss====>"); + else if (rate_idx == ODM_RATEMCS24) + PDM_SNPF(out_len, used, output + used, out_len - used, + "\n %-35s\n", "HT 4ss====>"); + else if (rate_idx == ODM_RATEVHTSS1MCS0) + PDM_SNPF(out_len, used, output + used, out_len - used, + "\n %-35s\n", "VHT 1ss====>"); + else if (rate_idx == ODM_RATEVHTSS2MCS0) + PDM_SNPF(out_len, used, output + used, out_len - used, + "\n %-35s\n", "VHT 2ss====>"); + else if (rate_idx == ODM_RATEVHTSS3MCS0) + PDM_SNPF(out_len, used, output + used, out_len - used, + "\n %-35s\n", "VHT 3ss====>"); + else if (rate_idx == ODM_RATEVHTSS4MCS0) + PDM_SNPF(out_len, used, output + used, out_len - used, + "\n %-35s\n", "VHT 4ss====>"); + + txagc = phydm_api_get_txagc(dm, (enum rf_path)path, rate_idx); + if (config_phydm_read_txagc_check(txagc)) + PDM_SNPF(out_len, used, output + used, + out_len - used, " 0x%02x ", txagc); + else + PDM_SNPF(out_len, used, output + used, + out_len - used, " 0x%s ", "xx"); } #endif - -#if (RTL8197F_SUPPORT == 1) - if (p_dm_odm->support_ic_type & ODM_RTL8197F) - ret = config_phydm_write_txagc_8197f(p_dm_odm, power_index, path, hw_rate); -#endif - - return ret; + *_used = used; + *_out_len = out_len; } -u8 -phydm_api_get_txagc( - struct PHY_DM_STRUCT *p_dm_odm, - enum odm_rf_radio_path_e path, - u8 hw_rate -) +void phydm_get_txagc(void *dm_void, u32 *_used, char *output, u32 *_out_len) { - u8 ret = 0; - -#if (RTL8822B_SUPPORT == 1) - if (p_dm_odm->support_ic_type & ODM_RTL8822B) - ret = config_phydm_read_txagc_8822b(p_dm_odm, path, hw_rate); -#endif - -#if (RTL8197F_SUPPORT == 1) - if (p_dm_odm->support_ic_type & ODM_RTL8197F) - ret = config_phydm_read_txagc_8197f(p_dm_odm, path, hw_rate); -#endif - -#if (RTL8821C_SUPPORT == 1) - if (p_dm_odm->support_ic_type & ODM_RTL8821C) - ret = config_phydm_read_txagc_8821c(p_dm_odm, path, hw_rate); -#endif - - return ret; -} - - -bool -phydm_api_switch_bw_channel( - struct PHY_DM_STRUCT *p_dm_odm, - u8 central_ch, - u8 primary_ch_idx, - enum odm_bw_e bandwidth -) -{ - bool ret = false; - -#if (RTL8822B_SUPPORT == 1) - if (p_dm_odm->support_ic_type & ODM_RTL8822B) - ret = config_phydm_switch_channel_bw_8822b(p_dm_odm, central_ch, primary_ch_idx, bandwidth); -#endif - -#if (RTL8197F_SUPPORT == 1) - if (p_dm_odm->support_ic_type & ODM_RTL8197F) - ret = config_phydm_switch_channel_bw_8197f(p_dm_odm, central_ch, primary_ch_idx, bandwidth); -#endif - -#if (RTL8821C_SUPPORT == 1) - if (p_dm_odm->support_ic_type & ODM_RTL8821C) - ret = config_phydm_switch_channel_bw_8821c(p_dm_odm, central_ch, primary_ch_idx, bandwidth); -#endif - - return ret; -} - -bool -phydm_api_trx_mode( - struct PHY_DM_STRUCT *p_dm_odm, - enum odm_rf_path_e tx_path, - enum odm_rf_path_e rx_path, - bool is_tx2_path -) -{ - bool ret = false; - -#if (RTL8822B_SUPPORT == 1) - if (p_dm_odm->support_ic_type & ODM_RTL8822B) - ret = config_phydm_trx_mode_8822b(p_dm_odm, tx_path, rx_path, is_tx2_path); -#endif - -#if (RTL8197F_SUPPORT == 1) - if (p_dm_odm->support_ic_type & ODM_RTL8197F) - ret = config_phydm_trx_mode_8197f(p_dm_odm, tx_path, rx_path, is_tx2_path); -#endif - - return ret; -} -#endif - -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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 rate_idx; - u8 txagc; - u32 used = *_used; - u32 out_len = *_out_len; - -#if ((RTL8822B_SUPPORT == 1) || (RTL8197F_SUPPORT == 1) || (RTL8821C_SUPPORT == 1)) - if (((p_dm_odm->support_ic_type & (ODM_RTL8822B | ODM_RTL8197F)) && (path <= ODM_RF_PATH_B)) || - ((p_dm_odm->support_ic_type & (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(p_dm_odm, (enum 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( - void *p_dm_void, - u32 *_used, - char *output, - u32 *_out_len -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u32 used = *_used; - u32 out_len = *_out_len; + struct dm_struct *dm = (struct dm_struct *)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_odm, ODM_RF_PATH_A, _used, output, _out_len); + PDM_SNPF(out_len, used, output + used, out_len - used, "%-35s\n", + "path-A===================="); + phydm_get_per_path_txagc(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_odm, ODM_RF_PATH_B, _used, output, _out_len); + PDM_SNPF(out_len, used, output + used, out_len - used, "\n%-35s\n", + "path-B===================="); + phydm_get_per_path_txagc(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_odm, ODM_RF_PATH_C, _used, output, _out_len); + PDM_SNPF(out_len, used, output + used, out_len - used, "\n%-35s\n", + "path-C===================="); + phydm_get_per_path_txagc(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_odm, ODM_RF_PATH_D, _used, output, _out_len); + PDM_SNPF(out_len, used, output + used, out_len - used, "\n%-35s\n", + "path-D===================="); + phydm_get_per_path_txagc(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 -) +void phydm_set_txagc(void *dm_void, u32 *const val, u32 *_used, + char *output, u32 *_out_len) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u32 used = *_used; - u32 out_len = *_out_len; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 used = *_used; + u32 out_len = *_out_len; + u8 i = 0; + u32 pow = 0; /*power index*/ + u8 vht_start_rate = ODM_RATEVHTSS1MCS0; + boolean rpt = true; + enum rf_path path = RF_PATH_A; - /*dm_value[1] = path*/ - /*dm_value[2] = hw_rate*/ - /*dm_value[3] = power_index*/ +/*@val[1] = path*/ +/*@val[2] = hw_rate*/ +/*@val[3] = power_index*/ -#if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1 || RTL8821C_SUPPORT == 1) - if (p_dm_odm->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_odm, dm_value[3], (enum odm_rf_radio_path_e) 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; - bool status = true; +#ifdef PHYDM_COMMON_API_SUPPORT + if (!(dm->support_ic_type & CMN_API_SUPPORT_IC)) + return; - power_index = (dm_value[3] & 0x3f); + path = (enum rf_path)val[1]; - if (p_dm_odm->support_ic_type & (ODM_RTL8822B | ODM_RTL8821C)) { - power_index = (power_index << 24) | (power_index << 16) | (power_index << 8) | (power_index); + if (val[1] >= dm->num_rf_path) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "Write path-%d rate_idx-0x%x fail\n", val[1], val[2]); + } else if ((u8)val[2] != 0xff) { + if (phydm_api_set_txagc(dm, val[3], path, (u8)val[2], true)) + PDM_SNPF(out_len, used, output + used, out_len - used, + "Write path-%d rate_idx-0x%x = 0x%x\n", + val[1], val[2], val[3]); + else + PDM_SNPF(out_len, used, output + used, out_len - used, + "Write path-%d rate index-0x%x fail\n", + val[1], val[2]); + } else { - for (i = 0; i < ODM_RATEVHTSS2MCS9; i += 4) - status = (status & phydm_api_set_txagc(p_dm_odm, power_index, (enum odm_rf_radio_path_e) dm_value[1], i, false)); - } else if (p_dm_odm->support_ic_type & ODM_RTL8197F) { - for (i = 0; i <= ODM_RATEMCS15; i++) - status = (status & phydm_api_set_txagc(p_dm_odm, power_index, (enum odm_rf_radio_path_e) dm_value[1], i, false)); - } + if (dm->support_ic_type & + (ODM_RTL8822B | ODM_RTL8821C | ODM_RTL8195B)) { + pow = (val[3] & 0x3f); + pow = BYTE_DUPLICATE_2_DWORD(pow); - 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")); + for (i = 0; i < ODM_RATEVHTSS2MCS9; i += 4) + rpt &= phydm_api_set_txagc(dm, pow, path, i, 0); + } else if (dm->support_ic_type & + (ODM_RTL8197F | ODM_RTL8192F)) { + pow = (val[3] & 0x3f); + for (i = 0; i <= ODM_RATEMCS15; i++) + rpt &= phydm_api_set_txagc(dm, pow, path, i, 0); + } else if (dm->support_ic_type & ODM_RTL8198F) { + pow = (val[3] & 0x7f); + for (i = 0; i <= ODM_RATEVHTSS4MCS9; i++) + rpt &= phydm_api_set_txagc(dm, pow, path, i, 0); + } else if (dm->support_ic_type & + (ODM_RTL8822C | ODM_RTL8812F | ODM_RTL8197G)) { + pow = (val[3] & 0x7f); + for (i = 0; i <= ODM_RATEMCS15; i++) + rpt &= phydm_api_set_txagc(dm, pow, path, i, 0); + for (i = vht_start_rate; i <= ODM_RATEVHTSS2MCS9; i++) + rpt &= phydm_api_set_txagc(dm, pow, path, i, 0); + } else if (dm->support_ic_type & + (ODM_RTL8721D)) { + pow = (val[3] & 0x3f); + for (i = 0; i <= ODM_RATEMCS7; i++) + rpt &= phydm_api_set_txagc(dm, pow, path, i, 0); + } + + if (rpt) + PDM_SNPF(out_len, used, output + used, out_len - used, + "Write all TXAGC of path-%d = 0x%x\n", + val[1], val[3]); + else + PDM_SNPF(out_len, used, output + used, out_len - used, + "Write all TXAGC of path-%d fail\n", val[1]); + } + +#endif + *_used = used; + *_out_len = out_len; +} + +void phydm_shift_txagc(void *dm_void, u32 *const val, u32 *_used, char *output, + u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 used = *_used; + u32 out_len = *_out_len; + u8 i = 0; + u32 pow = 0; /*Power index*/ + boolean rpt = true; + u8 vht_start_rate = ODM_RATEVHTSS1MCS0; + enum rf_path path = RF_PATH_A; + +#ifdef PHYDM_COMMON_API_SUPPORT + if (!(dm->support_ic_type & CMN_API_SUPPORT_IC)) + return; + + if (val[1] >= dm->num_rf_path) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "Write path-%d fail\n", val[1]); + return; + } + + path = (enum rf_path)val[1]; + + if ((u8)val[2] == 0) { + /*@{0:-, 1:+} {Pwr Offset}*/ + if (dm->support_ic_type & (ODM_RTL8195B | ODM_RTL8821C)) { + for (i = 0; i <= ODM_RATEMCS7; i++) { + pow = phydm_api_get_txagc(dm, path, i) - val[3]; + rpt &= phydm_api_set_txagc(dm, pow, path, i, 1); } - } 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")); + for (i = vht_start_rate; i <= ODM_RATEVHTSS1MCS9; i++) { + pow = phydm_api_get_txagc(dm, path, i) - val[3]; + rpt &= phydm_api_set_txagc(dm, pow, path, i, 1); + } + } else if (dm->support_ic_type & (ODM_RTL8822B)) { + for (i = 0; i <= ODM_RATEMCS15; i++) { + pow = phydm_api_get_txagc(dm, path, i) - val[3]; + rpt &= phydm_api_set_txagc(dm, pow, path, i, 1); + } + for (i = vht_start_rate; i <= ODM_RATEVHTSS2MCS9; i++) { + pow = phydm_api_get_txagc(dm, path, i) - val[3]; + rpt &= phydm_api_set_txagc(dm, pow, path, i, 1); + } + } else if (dm->support_ic_type & + (ODM_RTL8197F | ODM_RTL8192F)) { + for (i = 0; i <= ODM_RATEMCS15; i++) { + pow = phydm_api_get_txagc(dm, path, i) - val[3]; + rpt &= phydm_api_set_txagc(dm, pow, path, i, 1); + } + } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + rpt &= phydm_api_shift_txagc(dm, val[3], path, 0); + } else if (dm->support_ic_type & + (ODM_RTL8721D)) { + for (i = 0; i <= ODM_RATEMCS7; i++) { + pow = phydm_api_get_txagc(dm, path, i) - val[3]; + rpt &= phydm_api_set_txagc(dm, pow, path, i, 1); + } + } + } else if ((u8)val[2] == 1) { + /*@{0:-, 1:+} {Pwr Offset}*/ + if (dm->support_ic_type & (ODM_RTL8195B | ODM_RTL8821C)) { + for (i = 0; i <= ODM_RATEMCS7; i++) { + pow = phydm_api_get_txagc(dm, path, i) + val[3]; + rpt &= phydm_api_set_txagc(dm, pow, path, i, 1); + } + for (i = vht_start_rate; i <= ODM_RATEVHTSS1MCS9; i++) { + pow = phydm_api_get_txagc(dm, path, i) + val[3]; + rpt &= phydm_api_set_txagc(dm, pow, path, i, 1); + } + } else if (dm->support_ic_type & (ODM_RTL8822B)) { + for (i = 0; i <= ODM_RATEMCS15; i++) { + pow = phydm_api_get_txagc(dm, path, i) + val[3]; + rpt &= phydm_api_set_txagc(dm, pow, path, i, 1); + } + for (i = vht_start_rate; i <= ODM_RATEVHTSS2MCS9; i++) { + pow = phydm_api_get_txagc(dm, path, i) + val[3]; + rpt &= phydm_api_set_txagc(dm, pow, path, i, 1); + } + } else if (dm->support_ic_type & + (ODM_RTL8197F | ODM_RTL8192F)) { + for (i = 0; i <= ODM_RATEMCS15; i++) { + pow = phydm_api_get_txagc(dm, path, i) + val[3]; + rpt &= phydm_api_set_txagc(dm, pow, path, i, 1); + } + } else if (dm->support_ic_type & ODM_RTL8721D) { + for (i = 0; i <= ODM_RATEMCS7; i++) { + pow = phydm_api_get_txagc(dm, path, i) + val[3]; + rpt &= phydm_api_set_txagc(dm, pow, path, i, 1); + } + } else if (dm->support_ic_type & + (ODM_RTL8822C | ODM_RTL8812F | ODM_RTL8197G)) { + rpt &= phydm_api_shift_txagc(dm, val[3], path, 1); + } + } + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + PDM_SNPF(out_len, used, output + used, out_len - used, + "[All rate] Set Path-%d Pow_idx: %s %d\n", + val[1], (val[2] ? "+" : "-"), val[3]); + else + #endif + PDM_SNPF(out_len, used, output + used, out_len - used, + "[All rate] Set Path-%d Pow_idx: %s %d(%d.%s dB)\n", + val[1], (val[2] ? "+" : "-"), val[3], val[3] >> 1, + ((val[3] & 1) ? "5" : "0")); + +#endif + *_used = used; + *_out_len = out_len; +} + +void phydm_set_txagc_dbg(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 used = *_used; + u32 out_len = *_out_len; + u32 var1[10] = {0}; + char help[] = "-h"; + u8 i = 0, input_idx = 0; + + 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)) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "{Dis:0, En:1} {pathA~D(0~3)} {rate_idx(Hex), All_rate:0xff} {txagc_idx (Hex)}\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{Pwr Shift(All rate):2} {pathA~D(0~3)} {0:-, 1:+} {Pwr Offset(Hex)}\n"); + } else if (var1[0] == 0) { + dm->is_disable_phy_api = false; + PDM_SNPF(out_len, used, output + used, out_len - used, + "Disable API debug mode\n"); + } else if (var1[0] == 1) { + dm->is_disable_phy_api = false; + #ifdef CONFIG_TXAGC_DEBUG_8822C + config_phydm_write_txagc_8822c(dm, var1[3], + (enum rf_path)var1[1], + (u8)var1[2]); + #else + phydm_set_txagc(dm, (u32 *)var1, &used, output, &out_len); + #endif + dm->is_disable_phy_api = true; + } else if (var1[0] == 2) { + PHYDM_SSCANF(input[4], DCMD_HEX, &var1[3]); + dm->is_disable_phy_api = false; + phydm_shift_txagc(dm, (u32 *)var1, &used, output, &out_len); + dm->is_disable_phy_api = true; + } + #ifdef CONFIG_TXAGC_DEBUG_8822C + else if (var1[0] == 3) { + dm->is_disable_phy_api = false; + phydm_txagc_tab_buff_show_8822c(dm); + dm->is_disable_phy_api = true; + } else if (var1[0] == 4) { + dm->is_disable_phy_api = false; + config_phydm_set_txagc_to_hw_8822c(dm); + dm->is_disable_phy_api = true; + } + #endif + + *_used = used; + *_out_len = out_len; +} + +void phydm_debug_trace(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u64 pre_debug_components, one = 1; + u64 comp = 0; + u32 used = *_used; + u32 out_len = *_out_len; + u32 val[10] = {0}; + u8 i = 0; + + for (i = 0; i < 5; i++) { + if (input[i + 1]) + PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &val[i]); + } + comp = dm->debug_components; + pre_debug_components = dm->debug_components; + + PDM_SNPF(out_len, used, output + used, out_len - used, + "\n================================\n"); + if (val[0] == 100) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "[DBG MSG] Component Selection\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "================================\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "00. (( %s ))DIG\n", + ((comp & DBG_DIG) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "01. (( %s ))RA_MASK\n", + ((comp & DBG_RA_MASK) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "02. (( %s ))DYN_TXPWR\n", + ((comp & DBG_DYN_TXPWR) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "03. (( %s ))FA_CNT\n", + ((comp & DBG_FA_CNT) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "04. (( %s ))RSSI_MNTR\n", + ((comp & DBG_RSSI_MNTR) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "05. (( %s ))CCKPD\n", + ((comp & DBG_CCKPD) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "06. (( %s ))ANT_DIV\n", + ((comp & DBG_ANT_DIV) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "07. (( %s ))SMT_ANT\n", + ((comp & DBG_SMT_ANT) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "08. (( %s ))PWR_TRAIN\n", + ((comp & DBG_PWR_TRAIN) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "09. (( %s ))RA\n", + ((comp & DBG_RA) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "10. (( %s ))PATH_DIV\n", + ((comp & DBG_PATH_DIV) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "11. (( %s ))DFS\n", + ((comp & DBG_DFS) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "12. (( %s ))DYN_ARFR\n", + ((comp & DBG_DYN_ARFR) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "13. (( %s ))ADAPTIVITY\n", + ((comp & DBG_ADPTVTY) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "14. (( %s ))CFO_TRK\n", + ((comp & DBG_CFO_TRK) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "15. (( %s ))ENV_MNTR\n", + ((comp & DBG_ENV_MNTR) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "16. (( %s ))PRI_CCA\n", + ((comp & DBG_PRI_CCA) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "17. (( %s ))ADPTV_SOML\n", + ((comp & DBG_ADPTV_SOML) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "18. (( %s ))LNA_SAT_CHK\n", + ((comp & DBG_LNA_SAT_CHK) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "20. (( %s ))PHY_STATUS\n", + ((comp & DBG_PHY_STATUS) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "21. (( %s ))TMP\n", + ((comp & DBG_TMP) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "22. (( %s ))FW_DBG_TRACE\n", + ((comp & DBG_FW_TRACE) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "23. (( %s ))TXBF\n", + ((comp & DBG_TXBF) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "24. (( %s ))COMMON_FLOW\n", + ((comp & DBG_COMMON_FLOW) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "28. (( %s ))PHY_CONFIG\n", + ((comp & ODM_PHY_CONFIG) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "29. (( %s ))INIT\n", + ((comp & ODM_COMP_INIT) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "30. (( %s ))COMMON\n", + ((comp & DBG_CMN) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "31. (( %s ))API\n", + ((comp & ODM_COMP_API) ? ("V") : ("."))); + PDM_SNPF(out_len, used, output + used, out_len - used, + "================================\n"); + + } else if (val[0] == 101) { + dm->debug_components = 0; + PDM_SNPF(out_len, used, output + used, out_len - used, + "Disable all debug components\n"); + } else { + if (val[1] == 1) /*@enable*/ + dm->debug_components |= (one << val[0]); + else if (val[1] == 2) /*@disable*/ + dm->debug_components &= ~(one << val[0]); + else + PDM_SNPF(out_len, used, output + used, out_len - used, + "[Warning] 1:on, 2:off\n"); + + if ((BIT(val[0]) == DBG_PHY_STATUS) && val[1] == 1) { + dm->phy_dbg_info.show_phy_sts_all_pkt = (u8)val[2]; + dm->phy_dbg_info.show_phy_sts_max_cnt = (u16)val[3]; + + PDM_SNPF(out_len, used, output + used, out_len - used, + "show_all_pkt=%d, show_max_num=%d\n\n", + dm->phy_dbg_info.show_phy_sts_all_pkt, + dm->phy_dbg_info.show_phy_sts_max_cnt); + + } else if ((BIT(val[0]) == DBG_CMN) && (val[1] == 1)) { + dm->cmn_dbg_msg_period = (u8)val[2]; + + if (dm->cmn_dbg_msg_period < PHYDM_WATCH_DOG_PERIOD) + dm->cmn_dbg_msg_period = PHYDM_WATCH_DOG_PERIOD; + + PDM_SNPF(out_len, used, output + used, out_len - used, + "cmn_dbg_msg_period=%d\n", + dm->cmn_dbg_msg_period); + } + } + PDM_SNPF(out_len, used, output + used, out_len - used, + "pre-DbgComponents = 0x%llx\n", pre_debug_components); + PDM_SNPF(out_len, used, output + used, out_len - used, + "Curr-DbgComponents = 0x%llx\n", dm->debug_components); + PDM_SNPF(out_len, used, output + used, out_len - used, + "================================\n"); + + *_used = used; + *_out_len = out_len; +} + +void phydm_fw_debug_trace(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 used = *_used; + u32 out_len = *_out_len; + u32 val[10] = {0}; + u8 i, input_idx = 0; + char help[] = "-h"; + u32 pre_fw_debug_components = 0, one = 1; + u32 comp = 0; + + for (i = 0; i < 5; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &val[i]); + input_idx++; + } + } + + if (input_idx == 0) + return; + + pre_fw_debug_components = dm->fw_debug_components; + comp = dm->fw_debug_components; + + if ((strcmp(input[1], help) == 0)) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "{dbg_comp} {1:en, 2:dis} {mode} {macid}\n"); + } else { + if (val[0] == 101) { + dm->fw_debug_components = 0; + PDM_SNPF(out_len, used, output + used, out_len - used, + "%s\n", "Clear all fw debug components"); + } else { + if (val[1] == 1) /*@enable*/ + dm->fw_debug_components |= (one << val[0]); + else if (val[1] == 2) /*@disable*/ + dm->fw_debug_components &= ~(one << val[0]); + else + PDM_SNPF(out_len, used, output + used, + out_len - used, "%s\n", + "[Warning!!!] 1:enable, 2:disable"); + } + + comp = dm->fw_debug_components; + + if (comp == 0) { + dm->debug_components &= ~DBG_FW_TRACE; + /*@H2C to enable C2H Msg*/ + phydm_fw_trace_en_h2c(dm, false, comp, val[2], val[3]); + } else { + dm->debug_components |= DBG_FW_TRACE; + /*@H2C to enable C2H Msg*/ + phydm_fw_trace_en_h2c(dm, true, comp, val[2], val[3]); + } + } +} + +#if (ODM_IC_11N_SERIES_SUPPORT) +void phydm_dump_bb_reg_n(void *dm_void, u32 *_used, char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 addr = 0; + u32 used = *_used; + u32 out_len = *_out_len; + + /*@For Nseries IC we only need to dump page8 to pageF using 3 digits*/ + for (addr = 0x800; addr < 0xfff; addr += 4) { + PDM_VAST_SNPF(out_len, used, output + used, out_len - used, + "0x%03x 0x%08x\n", + addr, odm_get_bb_reg(dm, addr, MASKDWORD)); + } + + *_used = used; + *_out_len = out_len; +} +#endif + +#if (ODM_IC_11AC_SERIES_SUPPORT) +void phydm_dump_bb_reg_ac(void *dm_void, u32 *_used, char *output, + u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 addr = 0; + u32 used = *_used; + u32 out_len = *_out_len; + + for (addr = 0x800; addr < 0xfff; addr += 4) { + PDM_VAST_SNPF(out_len, used, output + used, out_len - used, + "0x%04x 0x%08x\n", + addr, odm_get_bb_reg(dm, addr, MASKDWORD)); + } + + if (!(dm->support_ic_type & + (ODM_RTL8822B | ODM_RTL8814A | ODM_RTL8821C))) + goto rpt_reg; + + if (dm->rf_type > RF_2T2R) { + for (addr = 0x1800; addr < 0x18ff; addr += 4) + PDM_VAST_SNPF(out_len, used, output + used, + out_len - used, "0x%04x 0x%08x\n", + addr, + odm_get_bb_reg(dm, addr, MASKDWORD)); + } + + if (dm->rf_type > RF_3T3R) { + for (addr = 0x1a00; addr < 0x1aff; addr += 4) + PDM_VAST_SNPF(out_len, used, output + used, + out_len - used, "0x%04x 0x%08x\n", + addr, + odm_get_bb_reg(dm, addr, MASKDWORD)); + } + + for (addr = 0x1900; addr < 0x19ff; addr += 4) + PDM_VAST_SNPF(out_len, used, output + used, out_len - used, + "0x%04x 0x%08x\n", + addr, odm_get_bb_reg(dm, addr, MASKDWORD)); + + for (addr = 0x1c00; addr < 0x1cff; addr += 4) + PDM_VAST_SNPF(out_len, used, output + used, out_len - used, + "0x%04x 0x%08x\n", + addr, odm_get_bb_reg(dm, addr, MASKDWORD)); + + for (addr = 0x1f00; addr < 0x1fff; addr += 4) + PDM_VAST_SNPF(out_len, used, output + used, out_len - used, + "0x%04x 0x%08x\n", + addr, odm_get_bb_reg(dm, addr, MASKDWORD)); + +rpt_reg: + + *_used = used; + *_out_len = out_len; +} + +#endif + +#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT +void phydm_dump_bb_reg_jgr3(void *dm_void, u32 *_used, char *output, + u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 addr = 0; + u32 used = *_used; + u32 out_len = *_out_len; + + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + for (addr = 0x800; addr < 0xdff; addr += 4) + PDM_VAST_SNPF(out_len, used, output + used, + out_len - used, "0x%04x 0x%08x\n", addr, + odm_get_bb_reg(dm, addr, MASKDWORD)); + + for (addr = 0x1800; addr < 0x1aff; addr += 4) + PDM_VAST_SNPF(out_len, used, output + used, + out_len - used, "0x%04x 0x%08x\n", addr, + odm_get_bb_reg(dm, addr, MASKDWORD)); + + for (addr = 0x1c00; addr < 0x1eff; addr += 4) + PDM_VAST_SNPF(out_len, used, output + used, + out_len - used, "0x%04x 0x%08x\n", addr, + odm_get_bb_reg(dm, addr, MASKDWORD)); + + for (addr = 0x4000; addr < 0x41ff; addr += 4) + PDM_VAST_SNPF(out_len, used, output + used, + out_len - used, "0x%04x 0x%08x\n", addr, + odm_get_bb_reg(dm, addr, MASKDWORD)); + } + *_used = used; + *_out_len = out_len; +} + +void phydm_dump_bb_reg2_jgr3(void *dm_void, u32 *_used, char *output, + u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 addr = 0; + u32 used = *_used; + u32 out_len = *_out_len; + + if (!(dm->support_ic_type & ODM_IC_JGR3_SERIES)) + return; + + #if (defined(PHYDM_COMPILE_ABOVE_4SS)) + if (dm->support_ic_type & PHYDM_IC_ABOVE_4SS) { + for (addr = 0x5000; addr < 0x53ff; addr += 4) { + PDM_VAST_SNPF(out_len, used, output + used, + out_len - used, "0x%04x 0x%08x\n", + addr, + odm_get_bb_reg(dm, addr, MASKDWORD)); + } + } + #endif + /* @Do not change the order of page-2C/2D*/ + PDM_VAST_SNPF(out_len, used, output + used, out_len - used, + "------ BB report-register start ------\n"); + for (addr = 0x2c00; addr < 0x2dff; addr += 4) { + PDM_VAST_SNPF(out_len, used, output + used, out_len - used, + "0x%04x 0x%08x\n", + addr, odm_get_bb_reg(dm, addr, MASKDWORD)); + } + + *_used = used; + *_out_len = out_len; +} + +void phydm_get_per_path_anapar_jgr3(void *dm_void, u8 path, u32 *_used, + char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 state = 0; + u8 state_bp = 0; + u32 control_bb = 0; + u32 control_pow = 0; + u32 used = *_used; + u32 out_len = *_out_len; + u32 reg_idx = 0; + u32 dbgport_idx = 0; + u32 dbgport_val = 0; + + PDM_SNPF(out_len, used, output + used, out_len - used, "path-%d:\n", + path); + + if (path == RF_PATH_A) { + reg_idx = R_0x1830; + dbgport_idx = 0x9F0; + } else if (path == RF_PATH_B) { + reg_idx = R_0x4130; + dbgport_idx = 0xBF0; + } else if (path == RF_PATH_C) { + reg_idx = R_0x5230; + dbgport_idx = 0xDF0; + } else if (path == RF_PATH_D) { + reg_idx = R_0x5330; + dbgport_idx = 0xFF0; + } + + state_bp = (u8)odm_get_bb_reg(dm, reg_idx, 0xf00000); + odm_set_bb_reg(dm, reg_idx, 0x38000000, 0x5); /* @read en*/ + + for (state = 0; state <= 0xf; state++) { + odm_set_bb_reg(dm, reg_idx, 0xF00000, state); + if (phydm_set_bb_dbg_port(dm, DBGPORT_PRI_3, dbgport_idx)) { + dbgport_val = phydm_get_bb_dbg_port_val(dm); + phydm_release_bb_dbg_port(dm); + } else { + PDM_SNPF(out_len, used, output + used, out_len - used, + "state:0x%x = read dbg_port error!\n", state); + } + control_bb = (dbgport_val & 0xFFFF0) >> 4; + control_pow = dbgport_val & 0xF; + PDM_SNPF(out_len, used, output + used, out_len - used, + "state:0x%x = control_bb:0x%x pow_bb:0x%x\n", + state, control_bb, control_pow); + } + odm_set_bb_reg(dm, reg_idx, 0xf00000, state_bp); + odm_set_bb_reg(dm, reg_idx, 0x38000000, 0x6); /* @write en*/ + + *_used = used; + *_out_len = out_len; +} + +#endif + +void phydm_dump_bb_reg(void *dm_void, u32 *_used, char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 used = *_used; + u32 out_len = *_out_len; + + PDM_VAST_SNPF(out_len, used, output + used, out_len - used, + "BB==========\n"); + PDM_VAST_SNPF(out_len, used, output + used, out_len - used, + "------ BB control register start ------\n"); + + switch (dm->ic_ip_series) { + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + case PHYDM_IC_JGR3: + phydm_dump_bb_reg_jgr3(dm, &used, output, &out_len); + break; + #endif + + #if (ODM_IC_11AC_SERIES_SUPPORT == 1) + case PHYDM_IC_AC: + phydm_dump_bb_reg_ac(dm, &used, output, &out_len); + break; + #endif + + #if (ODM_IC_11N_SERIES_SUPPORT == 1) + case PHYDM_IC_N: + phydm_dump_bb_reg_n(dm, &used, output, &out_len); + break; + #endif + + default: + break; + } + + *_used = used; + *_out_len = out_len; +} + +void phydm_dump_rf_reg(void *dm_void, u32 *_used, char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 addr = 0; + u32 used = *_used; + u32 out_len = *_out_len; + u32 reg = 0; + + /* @dump RF register */ + PDM_VAST_SNPF(out_len, used, output + used, out_len - used, + "RF-A==========\n"); + + for (addr = 0; addr <= 0xFF; addr++) { + reg = odm_get_rf_reg(dm, RF_PATH_A, addr, RFREG_MASK); + PDM_VAST_SNPF(out_len, used, output + used, out_len - used, + "0x%02x 0x%05x\n", addr, reg); + } + +#ifdef PHYDM_COMPILE_ABOVE_2SS + if (dm->rf_type > RF_1T1R) { + PDM_VAST_SNPF(out_len, used, output + used, out_len - used, + "RF-B==========\n"); + + for (addr = 0; addr <= 0xFF; addr++) { + reg = odm_get_rf_reg(dm, RF_PATH_B, addr, RFREG_MASK); + PDM_VAST_SNPF(out_len, used, output + used, + out_len - used, "0x%02x 0x%05x\n", + addr, reg); + } } #endif -} -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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u32 pre_debug_components, one = 1; - u32 used = *_used; - u32 out_len = *_out_len; +#ifdef PHYDM_COMPILE_ABOVE_3SS + if (dm->rf_type > RF_2T2R) { + PDM_VAST_SNPF(out_len, used, output + used, out_len - used, + "RF-C==========\n"); - pre_debug_components = p_dm_odm->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_odm->debug_components & ODM_COMP_DIG) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "01. (( %s ))RA_MASK\n", ((p_dm_odm->debug_components & ODM_COMP_RA_MASK) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "02. (( %s ))DYNAMIC_TXPWR\n", ((p_dm_odm->debug_components & ODM_COMP_DYNAMIC_TXPWR) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "03. (( %s ))FA_CNT\n", ((p_dm_odm->debug_components & ODM_COMP_FA_CNT) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "04. (( %s ))RSSI_MONITOR\n", ((p_dm_odm->debug_components & ODM_COMP_RSSI_MONITOR) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "05. (( %s ))SNIFFER\n", ((p_dm_odm->debug_components & ODM_COMP_SNIFFER) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "06. (( %s ))ANT_DIV\n", ((p_dm_odm->debug_components & ODM_COMP_ANT_DIV) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "07. (( %s ))DFS\n", ((p_dm_odm->debug_components & ODM_COMP_DFS) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "08. (( %s ))NOISY_DETECT\n", ((p_dm_odm->debug_components & ODM_COMP_NOISY_DETECT) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "09. (( %s ))RATE_ADAPTIVE\n", ((p_dm_odm->debug_components & ODM_COMP_RATE_ADAPTIVE) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "10. (( %s ))PATH_DIV\n", ((p_dm_odm->debug_components & ODM_COMP_PATH_DIV) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "12. (( %s ))DYNAMIC_PRICCA\n", ((p_dm_odm->debug_components & ODM_COMP_DYNAMIC_PRICCA) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "14. (( %s ))MP\n", ((p_dm_odm->debug_components & ODM_COMP_MP) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "15. (( %s ))struct _CFO_TRACKING_\n", ((p_dm_odm->debug_components & ODM_COMP_CFO_TRACKING) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "16. (( %s ))struct _ACS_\n", ((p_dm_odm->debug_components & ODM_COMP_ACS) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "17. (( %s ))ADAPTIVITY\n", ((p_dm_odm->debug_components & PHYDM_COMP_ADAPTIVITY) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "18. (( %s ))RA_DBG\n", ((p_dm_odm->debug_components & PHYDM_COMP_RA_DBG) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "19. (( %s ))TXBF\n", ((p_dm_odm->debug_components & PHYDM_COMP_TXBF) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "20. (( %s ))EDCA_TURBO\n", ((p_dm_odm->debug_components & ODM_COMP_EDCA_TURBO) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "22. (( %s ))FW_DEBUG_TRACE\n", ((p_dm_odm->debug_components & ODM_FW_DEBUG_TRACE) ? ("V") : (".")))); - - PHYDM_SNPRINTF((output + used, out_len - used, "24. (( %s ))TX_PWR_TRACK\n", ((p_dm_odm->debug_components & ODM_COMP_TX_PWR_TRACK) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "26. (( %s ))CALIBRATION\n", ((p_dm_odm->debug_components & ODM_COMP_CALIBRATION) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "28. (( %s ))PHY_CONFIG\n", ((p_dm_odm->debug_components & ODM_PHY_CONFIG) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "29. (( %s ))INIT\n", ((p_dm_odm->debug_components & ODM_COMP_INIT) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "30. (( %s ))COMMON\n", ((p_dm_odm->debug_components & ODM_COMP_COMMON) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "31. (( %s ))API\n", ((p_dm_odm->debug_components & ODM_COMP_API) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); - - } else if (dm_value[0] == 101) { - p_dm_odm->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_odm->debug_components |= (one << dm_value[0]); - else if (dm_value[1] == 2) /*disable*/ - p_dm_odm->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%x\n", pre_debug_components)); - PHYDM_SNPRINTF((output + used, out_len - used, "Curr-DbgComponents = 0x%x\n", p_dm_odm->debug_components)); - PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); -} - -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_odm = (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_odm->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_odm->fw_debug_components & PHYDM_FW_COMP_RA) ? ("V") : (".")))); - - if (p_dm_odm->support_ic_type & PHYDM_IC_3081_SERIES) { - PHYDM_SNPRINTF((output + used, out_len - used, "01. (( %s ))MU\n", ((p_dm_odm->fw_debug_components & PHYDM_FW_COMP_MU) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "02. (( %s ))path Div\n", ((p_dm_odm->fw_debug_components & PHYDM_FW_COMP_PHY_CONFIG) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "03. (( %s ))Phy Config\n", ((p_dm_odm->fw_debug_components & PHYDM_FW_COMP_PHY_CONFIG) ? ("V") : (".")))); - } - PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); - - } else { - if (dm_value[0] == 101) { - p_dm_odm->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_odm->fw_debug_components |= (one << dm_value[0]); - else if (dm_value[1] == 2) /*disable*/ - p_dm_odm->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_odm->fw_debug_components == 0) { - p_dm_odm->debug_components &= ~ODM_FW_DEBUG_TRACE; - phydm_fw_trace_en_h2c(p_dm_odm, false, p_dm_odm->fw_debug_components, dm_value[2], dm_value[3]); /*H2C to enable C2H Msg*/ - } else { - p_dm_odm->debug_components |= ODM_FW_DEBUG_TRACE; - phydm_fw_trace_en_h2c(p_dm_odm, true, p_dm_odm->fw_debug_components, dm_value[2], dm_value[3]); /*H2C to enable C2H Msg*/ + for (addr = 0; addr <= 0xFF; addr++) { + reg = odm_get_rf_reg(dm, RF_PATH_C, addr, RFREG_MASK); + PDM_VAST_SNPF(out_len, used, output + used, + out_len - used, "0x%02x 0x%05x\n", + addr, reg); } } +#endif + +#ifdef PHYDM_COMPILE_ABOVE_4SS + if (dm->rf_type > RF_3T3R) { + PDM_VAST_SNPF(out_len, used, output + used, out_len - used, + "RF-D==========\n"); + + for (addr = 0; addr <= 0xFF; addr++) { + reg = odm_get_rf_reg(dm, RF_PATH_D, addr, RFREG_MASK); + PDM_VAST_SNPF(out_len, used, output + used, + out_len - used, "0x%02x 0x%05x\n", + addr, reg); + } + } +#endif + + *_used = used; + *_out_len = out_len; } -void -phydm_dump_bb_reg( - void *p_dm_void, - u32 *_used, - char *output, - u32 *_out_len -) +void phydm_dump_mac_reg(void *dm_void, u32 *_used, char *output, u32 *_out_len) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u32 addr = 0; - u32 used = *_used; - u32 out_len = *_out_len; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 addr = 0; + u32 used = *_used; + u32 out_len = *_out_len; + /* @dump MAC register */ + PDM_VAST_SNPF(out_len, used, output + used, out_len - used, + "MAC==========\n"); - /* 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_odm->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_odm, addr, MASKDWORD))); - else - PHYDM_VAST_INFO_SNPRINTF((output + used, out_len - used, "0x%04x 0x%08x\n", addr, odm_get_bb_reg(p_dm_odm, addr, MASKDWORD))); - } - - if (p_dm_odm->support_ic_type & (ODM_RTL8822B | ODM_RTL8814A | ODM_RTL8821C)) { - - if (p_dm_odm->rf_type > 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_get_bb_reg(p_dm_odm, addr, MASKDWORD))); - } - - if (p_dm_odm->rf_type > 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_get_bb_reg(p_dm_odm, 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_odm, 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_odm, 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_odm, addr, MASKDWORD))); - } -} - -void -phydm_dump_all_reg( - void *p_dm_void, - u32 *_used, - char *output, - u32 *_out_len -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (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_odm, addr, MASKDWORD))); + PDM_VAST_SNPF(out_len, used, output + used, out_len - used, + "0x%04x 0x%08x\n", + addr, odm_get_bb_reg(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_odm, addr, MASKDWORD))); + PDM_VAST_SNPF(out_len, used, output + used, out_len - used, + "0x%04x 0x%08x\n", + addr, odm_get_bb_reg(dm, addr, MASKDWORD)); - /* dump BB register */ - PHYDM_VAST_INFO_SNPRINTF((output + used, out_len - used, "BB==========\n")); - phydm_dump_bb_reg(p_dm_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_get_rf_reg(p_dm_odm, ODM_RF_PATH_A, addr, RFREGOFFSETMASK))); - - if (p_dm_odm->rf_type > 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_get_rf_reg(p_dm_odm, ODM_RF_PATH_B, addr, RFREGOFFSETMASK))); - } - - if (p_dm_odm->rf_type > 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_get_rf_reg(p_dm_odm, ODM_RF_PATH_C, addr, RFREGOFFSETMASK))); - } - - if (p_dm_odm->rf_type > 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_get_rf_reg(p_dm_odm, ODM_RF_PATH_D, addr, RFREGOFFSETMASK))); - } + *_used = used; + *_out_len = out_len; } -void -phydm_enable_big_jump( - struct PHY_DM_STRUCT *p_dm_odm, - bool state -) +void phydm_dump_reg(void *dm_void, char input[][16], u32 *_used, char *output, + u32 *_out_len) { -#if (RTL8822B_SUPPORT == 1) - struct _dynamic_initial_gain_threshold_ *p_dm_dig_table = &p_dm_odm->dm_dig_table; + struct dm_struct *dm = (struct dm_struct *)dm_void; + char help[] = "-h"; + u32 var1[10] = {0}; + u32 used = *_used; + u32 out_len = *_out_len; + u32 addr = 0; - if (state == false) { - p_dm_odm->dm_dig_table.enable_adjust_big_jump = false; - odm_set_bb_reg(p_dm_odm, 0x8c8, 0xfe, ((p_dm_dig_table->big_jump_step3 << 5) | (p_dm_dig_table->big_jump_step2 << 3) | p_dm_dig_table->big_jump_step1)); - } else - p_dm_odm->dm_dig_table.enable_adjust_big_jump = true; + if (input[1]) + PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); + + if ((strcmp(input[1], help) == 0)) { + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + PDM_SNPF(out_len, used, output + used, out_len - used, + "dumpreg {0:all, 1:BB, 2:RF, 3:MAC 4:BB2 for jgr3}\n"); + else + #endif + PDM_SNPF(out_len, used, output + used, out_len - used, + "dumpreg {0:all, 1:BB, 2:RF, 3:MAC}\n"); + } else if (var1[0] == 0) { + phydm_dump_mac_reg(dm, &used, output, &out_len); + phydm_dump_bb_reg(dm, &used, output, &out_len); + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + if (dm->ic_ip_series == PHYDM_IC_JGR3) + phydm_dump_bb_reg2_jgr3(dm, &used, output, &out_len); + #endif + + phydm_dump_rf_reg(dm, &used, output, &out_len); + } else if (var1[0] == 1) { + phydm_dump_bb_reg(dm, &used, output, &out_len); + } else if (var1[0] == 2) { + phydm_dump_rf_reg(dm, &used, output, &out_len); + } else if (var1[0] == 3) { + phydm_dump_mac_reg(dm, &used, output, &out_len); + } else if (var1[0] == 4) { + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + if (dm->ic_ip_series == PHYDM_IC_JGR3) + phydm_dump_bb_reg2_jgr3(dm, &used, output, &out_len); + #endif + } + + *_used = used; + *_out_len = out_len; +} + +void phydm_enable_big_jump(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len) +{ +#if (RTL8822B_SUPPORT) + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + u32 dm_value[10] = {0}; + u8 i, input_idx = 0; + u32 val; + + if (!(dm->support_ic_type & ODM_RTL8822B)) + return; + + for (i = 0; i < 5; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_HEX, &dm_value[i]); + input_idx++; + } + } + + if (input_idx == 0) + return; + + if (dm_value[0] == 0) { + dm->dm_dig_table.enable_adjust_big_jump = false; + + val = (dig_t->big_jump_step3 << 5) | + (dig_t->big_jump_step2 << 3) | + dig_t->big_jump_step1; + + odm_set_bb_reg(dm, R_0x8c8, 0xfe, val); + } else { + dm->dm_dig_table.enable_adjust_big_jump = true; + } #endif } -#if (RTL8822B_SUPPORT == 1) - -void -phydm_show_rx_rate( - struct PHY_DM_STRUCT *p_dm_odm, - u32 *_used, - char *output, - u32 *_out_len -) +void phydm_show_rx_rate(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len) { - u32 used = *_used; - u32 out_len = *_out_len; +#if (RTL8822B_SUPPORT || RTL8821C_SUPPORT || RTL8814B_SUPPORT ||\ + RTL8195B_SUPPORT || RTL8822C_SUPPORT) + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct odm_phy_dbg_info *dbg = &dm->phy_dbg_info; + u32 used = *_used; + u32 out_len = *_out_len; + u32 var1[10] = {0}; + char help[] = "-h"; + u8 i, input_idx = 0; - 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_odm->phy_dbg_info.num_qry_vht_pkt[0], p_dm_odm->phy_dbg_info.num_qry_vht_pkt[1], p_dm_odm->phy_dbg_info.num_qry_vht_pkt[2], p_dm_odm->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_odm->phy_dbg_info.num_qry_vht_pkt[4], p_dm_odm->phy_dbg_info.num_qry_vht_pkt[5], p_dm_odm->phy_dbg_info.num_qry_vht_pkt[6], p_dm_odm->phy_dbg_info.num_qry_vht_pkt[7])); - PHYDM_SNPRINTF((output + used, out_len - used, "1SS MCS8 = %d, 1SS MCS9 = %d\n", - p_dm_odm->phy_dbg_info.num_qry_vht_pkt[8], p_dm_odm->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_odm->phy_dbg_info.num_qry_vht_pkt[10], p_dm_odm->phy_dbg_info.num_qry_vht_pkt[11], p_dm_odm->phy_dbg_info.num_qry_vht_pkt[12], p_dm_odm->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_odm->phy_dbg_info.num_qry_vht_pkt[14], p_dm_odm->phy_dbg_info.num_qry_vht_pkt[15], p_dm_odm->phy_dbg_info.num_qry_vht_pkt[16], p_dm_odm->phy_dbg_info.num_qry_vht_pkt[17])); - PHYDM_SNPRINTF((output + used, out_len - used, "2SS MCS8 = %d, 2SS MCS9 = %d\n", - p_dm_odm->phy_dbg_info.num_qry_vht_pkt[18], p_dm_odm->phy_dbg_info.num_qry_vht_pkt[19])); + for (i = 0; i < 5; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); + input_idx++; + } + } - 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_odm->phy_dbg_info.num_qry_mu_vht_pkt[0], p_dm_odm->phy_dbg_info.num_qry_mu_vht_pkt[1], p_dm_odm->phy_dbg_info.num_qry_mu_vht_pkt[2], p_dm_odm->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_odm->phy_dbg_info.num_qry_mu_vht_pkt[4], p_dm_odm->phy_dbg_info.num_qry_mu_vht_pkt[5], p_dm_odm->phy_dbg_info.num_qry_mu_vht_pkt[6], p_dm_odm->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_odm->phy_dbg_info.num_qry_mu_vht_pkt[8], p_dm_odm->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_odm->phy_dbg_info.num_qry_mu_vht_pkt[10], p_dm_odm->phy_dbg_info.num_qry_mu_vht_pkt[11], p_dm_odm->phy_dbg_info.num_qry_mu_vht_pkt[12], p_dm_odm->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_odm->phy_dbg_info.num_qry_mu_vht_pkt[14], p_dm_odm->phy_dbg_info.num_qry_mu_vht_pkt[15], p_dm_odm->phy_dbg_info.num_qry_mu_vht_pkt[16], p_dm_odm->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_odm->phy_dbg_info.num_qry_mu_vht_pkt[18], p_dm_odm->phy_dbg_info.num_qry_mu_vht_pkt[19])); + if (input_idx == 0) + return; + if ((strcmp(input[1], help) == 0)) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "{1: show Rx rate, 0:reset counter}\n"); + *_used = used; + *_out_len = out_len; + return; + + } else if (var1[0] == 0) { + phydm_reset_rx_rate_distribution(dm); + *_used = used; + *_out_len = out_len; + return; + } + + /* @==Show SU Rate====================================================*/ + PDM_SNPF(out_len, used, output + used, out_len - used, + "=====Rx SU rate Statistics=====\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "[SU][1SS] {%d, %d, %d, %d | %d, %d, %d, %d | %d, %d}\n", + dbg->num_qry_vht_pkt[0], dbg->num_qry_vht_pkt[1], + dbg->num_qry_vht_pkt[2], dbg->num_qry_vht_pkt[3], + dbg->num_qry_vht_pkt[4], dbg->num_qry_vht_pkt[5], + dbg->num_qry_vht_pkt[6], dbg->num_qry_vht_pkt[7], + dbg->num_qry_vht_pkt[8], dbg->num_qry_vht_pkt[9]); + + #if (defined(PHYDM_COMPILE_ABOVE_2SS)) + if (dm->support_ic_type & (PHYDM_IC_ABOVE_2SS)) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "[SU][2SS] {%d, %d, %d, %d | %d, %d, %d, %d | %d, %d}\n", + dbg->num_qry_vht_pkt[10], dbg->num_qry_vht_pkt[11], + dbg->num_qry_vht_pkt[12], dbg->num_qry_vht_pkt[13], + dbg->num_qry_vht_pkt[14], dbg->num_qry_vht_pkt[15], + dbg->num_qry_vht_pkt[16], dbg->num_qry_vht_pkt[17], + dbg->num_qry_vht_pkt[18], dbg->num_qry_vht_pkt[19]); + } + #endif + /* @==Show MU Rate====================================================*/ +#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT) || (defined(PHYSTS_3RD_TYPE_SUPPORT)) + PDM_SNPF(out_len, used, output + used, out_len - used, + "=====Rx MU rate Statistics=====\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "[MU][1SS] {%d, %d, %d, %d | %d, %d, %d, %d | %d, %d}\n", + dbg->num_mu_vht_pkt[0], dbg->num_mu_vht_pkt[1], + dbg->num_mu_vht_pkt[2], dbg->num_mu_vht_pkt[3], + dbg->num_mu_vht_pkt[4], dbg->num_mu_vht_pkt[5], + dbg->num_mu_vht_pkt[6], dbg->num_mu_vht_pkt[7], + dbg->num_mu_vht_pkt[8], dbg->num_mu_vht_pkt[9]); + + #if (defined(PHYDM_COMPILE_ABOVE_2SS)) + if (dm->support_ic_type & (PHYDM_IC_ABOVE_2SS)) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "[MU][2SS] {%d, %d, %d, %d | %d, %d, %d, %d | %d, %d}\n", + dbg->num_mu_vht_pkt[10], dbg->num_mu_vht_pkt[11], + dbg->num_mu_vht_pkt[12], dbg->num_mu_vht_pkt[13], + dbg->num_mu_vht_pkt[14], dbg->num_mu_vht_pkt[15], + dbg->num_mu_vht_pkt[16], dbg->num_mu_vht_pkt[17], + dbg->num_mu_vht_pkt[18], dbg->num_mu_vht_pkt[19]); + } + #endif +#endif + *_used = used; + *_out_len = out_len; +#endif } +void phydm_per_tone_evm(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 i, j; + u32 used = *_used; + u32 out_len = *_out_len; + u32 var1[4] = {0}; + u32 val, tone_num, round; + s8 rxevm_0, rxevm_1; + s32 avg_num, evm_tone_0[256] = {0}, evm_tone_1[256] = {0}; + s32 rxevm_sum_0, rxevm_sum_1; + + if (dm->support_ic_type & ODM_IC_11N_SERIES) { + pr_debug("n series not support yet !\n"); + return; + } + + for (i = 0; i < 4; i++) { + if (input[i + 1]) + PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); + } + + avg_num = var1[0]; + round = var1[1]; + + if (!dm->is_linked) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "No Link !!\n"); + + *_used = used; + *_out_len = out_len; + + return; + } + + pr_debug("ID=((%d)), BW=((%d)), fc=((CH-%d))\n", dm->curr_station_id, + 20 << *dm->band_width, *dm->channel); + pr_debug("avg_num =((%d)), round =((%d))\n", avg_num, round); +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + watchdog_stop(dm->priv); +#endif + for (j = 0; j < round; j++) { + pr_debug("\nround((%d))\n", (j + 1)); + if (*dm->band_width == CHANNEL_WIDTH_20) { + for (tone_num = 228; tone_num <= 255; tone_num++) { + odm_set_bb_reg(dm, R_0x8c4, 0xff8, tone_num); + rxevm_sum_0 = 0; + rxevm_sum_1 = 0; + for (i = 0; i < avg_num; i++) { + val = odm_read_4byte(dm, R_0xf8c); + + rxevm_0 = (s8)((val & MASKBYTE2) >> 16); + rxevm_0 = (rxevm_0 / 2); + if (rxevm_0 < -63) + rxevm_0 = 0; + + rxevm_1 = (s8)((val & MASKBYTE3) >> 24); + rxevm_1 = (rxevm_1 / 2); + if (rxevm_1 < -63) + rxevm_1 = 0; + rxevm_sum_0 += rxevm_0; + rxevm_sum_1 += rxevm_1; + ODM_delay_ms(1); + } + evm_tone_0[tone_num] = (rxevm_sum_0 / avg_num); + evm_tone_1[tone_num] = (rxevm_sum_1 / avg_num); + pr_debug("Tone(-%-3d) RXEVM(1ss/2ss)=%d, %d\n", + (256 - tone_num), evm_tone_0[tone_num], + evm_tone_1[tone_num]); + } + + for (tone_num = 1; tone_num <= 28; tone_num++) { + odm_set_bb_reg(dm, R_0x8c4, 0xff8, tone_num); + rxevm_sum_0 = 0; + rxevm_sum_1 = 0; + for (i = 0; i < avg_num; i++) { + val = odm_read_4byte(dm, R_0xf8c); + + rxevm_0 = (s8)((val & MASKBYTE2) >> 16); + rxevm_0 = (rxevm_0 / 2); + if (rxevm_0 < -63) + rxevm_0 = 0; + + rxevm_1 = (s8)((val & MASKBYTE3) >> 24); + rxevm_1 = (rxevm_1 / 2); + if (rxevm_1 < -63) + rxevm_1 = 0; + rxevm_sum_0 += rxevm_0; + rxevm_sum_1 += rxevm_1; + ODM_delay_ms(1); + } + evm_tone_0[tone_num] = (rxevm_sum_0 / avg_num); + evm_tone_1[tone_num] = (rxevm_sum_1 / avg_num); + pr_debug("Tone(%-3d) RXEVM(1ss/2ss)=%d, %d\n", + tone_num, evm_tone_0[tone_num], + evm_tone_1[tone_num]); + } + } else if (*dm->band_width == CHANNEL_WIDTH_40) { + for (tone_num = 198; tone_num <= 254; tone_num++) { + odm_set_bb_reg(dm, R_0x8c4, 0xff8, tone_num); + rxevm_sum_0 = 0; + rxevm_sum_1 = 0; + for (i = 0; i < avg_num; i++) { + val = odm_read_4byte(dm, R_0xf8c); + + rxevm_0 = (s8)((val & MASKBYTE2) >> 16); + rxevm_0 = (rxevm_0 / 2); + if (rxevm_0 < -63) + rxevm_0 = 0; + + rxevm_1 = (s8)((val & MASKBYTE3) >> 24); + rxevm_1 = (rxevm_1 / 2); + if (rxevm_1 < -63) + rxevm_1 = 0; + + rxevm_sum_0 += rxevm_0; + rxevm_sum_1 += rxevm_1; + ODM_delay_ms(1); + } + evm_tone_0[tone_num] = (rxevm_sum_0 / avg_num); + evm_tone_1[tone_num] = (rxevm_sum_1 / avg_num); + pr_debug("Tone(-%-3d) RXEVM(1ss/2ss)=%d, %d\n", + (256 - tone_num), evm_tone_0[tone_num], + evm_tone_1[tone_num]); + } + + for (tone_num = 2; tone_num <= 58; tone_num++) { + odm_set_bb_reg(dm, R_0x8c4, 0xff8, tone_num); + rxevm_sum_0 = 0; + rxevm_sum_1 = 0; + for (i = 0; i < avg_num; i++) { + val = odm_read_4byte(dm, R_0xf8c); + + rxevm_0 = (s8)((val & MASKBYTE2) >> 16); + rxevm_0 = (rxevm_0 / 2); + if (rxevm_0 < -63) + rxevm_0 = 0; + + rxevm_1 = (s8)((val & MASKBYTE3) >> 24); + rxevm_1 = (rxevm_1 / 2); + if (rxevm_1 < -63) + rxevm_1 = 0; + rxevm_sum_0 += rxevm_0; + rxevm_sum_1 += rxevm_1; + ODM_delay_ms(1); + } + evm_tone_0[tone_num] = (rxevm_sum_0 / avg_num); + evm_tone_1[tone_num] = (rxevm_sum_1 / avg_num); + pr_debug("Tone(%-3d) RXEVM(1ss/2ss)=%d, %d\n", + tone_num, evm_tone_0[tone_num], + evm_tone_1[tone_num]); + } + } else if (*dm->band_width == CHANNEL_WIDTH_80) { + for (tone_num = 134; tone_num <= 254; tone_num++) { + odm_set_bb_reg(dm, R_0x8c4, 0xff8, tone_num); + rxevm_sum_0 = 0; + rxevm_sum_1 = 0; + for (i = 0; i < avg_num; i++) { + val = odm_read_4byte(dm, R_0xf8c); + + rxevm_0 = (s8)((val & MASKBYTE2) >> 16); + rxevm_0 = (rxevm_0 / 2); + if (rxevm_0 < -63) + rxevm_0 = 0; + + rxevm_1 = (s8)((val & MASKBYTE3) >> 24); + rxevm_1 = (rxevm_1 / 2); + if (rxevm_1 < -63) + rxevm_1 = 0; + rxevm_sum_0 += rxevm_0; + rxevm_sum_1 += rxevm_1; + ODM_delay_ms(1); + } + evm_tone_0[tone_num] = (rxevm_sum_0 / avg_num); + evm_tone_1[tone_num] = (rxevm_sum_1 / avg_num); + pr_debug("Tone(-%-3d) RXEVM(1ss/2ss)=%d, %d\n", + (256 - tone_num), evm_tone_0[tone_num], + evm_tone_1[tone_num]); + } + + for (tone_num = 2; tone_num <= 122; tone_num++) { + odm_set_bb_reg(dm, R_0x8c4, 0xff8, tone_num); + rxevm_sum_0 = 0; + rxevm_sum_1 = 0; + for (i = 0; i < avg_num; i++) { + val = odm_read_4byte(dm, R_0xf8c); + + rxevm_0 = (s8)((val & MASKBYTE2) >> 16); + rxevm_0 = (rxevm_0 / 2); + if (rxevm_0 < -63) + rxevm_0 = 0; + + rxevm_1 = (s8)((val & MASKBYTE3) >> 24); + rxevm_1 = (rxevm_1 / 2); + if (rxevm_1 < -63) + rxevm_1 = 0; + rxevm_sum_0 += rxevm_0; + rxevm_sum_1 += rxevm_1; + ODM_delay_ms(1); + } + evm_tone_0[tone_num] = (rxevm_sum_0 / avg_num); + evm_tone_1[tone_num] = (rxevm_sum_1 / avg_num); + pr_debug("Tone(%-3d) RXEVM (1ss/2ss)=%d, %d\n", + tone_num, evm_tone_0[tone_num], + evm_tone_1[tone_num]); + } + } + } + *_used = used; + *_out_len = out_len; +} + +void phydm_bw_ch_adjust(void *dm_void, char input[][16], + u32 *_used, char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)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 bw; + +#ifdef PHYDM_COMMON_API_SUPPORT + + if ((strcmp(input[1], help) == 0)) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "{en} {CH} {pr_ch_idx 1/2/3/4/9/10} {0:20M,1:40M,2:80M}\n"); + goto out; + } + + if (!(dm->support_ic_type & CMN_API_SUPPORT_IC)) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "Not support this API\n"); + goto out; + } + + 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]; + bw = (enum channel_width)var1[3]; + + if (is_enable_dbg_mode) { + dm->is_disable_phy_api = false; + phydm_api_switch_bw_channel(dm, central_ch, primary_ch_idx, bw); + dm->is_disable_phy_api = true; + PDM_SNPF(out_len, used, output + used, out_len - used, + "central_ch = %d, primary_ch_idx = %d, bw = %d\n", + central_ch, primary_ch_idx, bw); + } +out: #endif + *_used = used; + *_out_len = out_len; +} -struct _PHYDM_COMMAND { +void phydm_ext_rf_element_ctrl(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 val[10] = {0}; + u8 i = 0, input_idx = 0; + + for (i = 0; i < 5; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &val[i]); + input_idx++; + } + } + + if (input_idx == 0) + return; + + if (val[0] == 1) /*@ext switch*/ { + phydm_set_ext_switch(dm, val[1]); + } +} + +void phydm_print_dbgport(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + char help[] = "-h"; + u32 var1[10] = {0}; + u32 used = *_used; + u32 out_len = *_out_len; + u32 dbg_port_value = 0; + u8 val[32]; + u8 tmp = 0; + u8 i; + + if (strcmp(input[1], help) == 0) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "{dbg_port_idx}\n"); + goto out; + } + + PHYDM_SSCANF(input[1], DCMD_HEX, &var1[0]); + + dm->debug_components |= ODM_COMP_API; + if (phydm_set_bb_dbg_port(dm, DBGPORT_PRI_3, var1[0])) { + dbg_port_value = phydm_get_bb_dbg_port_val(dm); + phydm_release_bb_dbg_port(dm); + + for (i = 0; i < 32; i++) + val[i] = (u8)((dbg_port_value & BIT(i)) >> i); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "Dbg Port[0x%x] = ((0x%x))\n", var1[0], + dbg_port_value); + + for (i = 4; i != 0; i--) { + tmp = 8 * (i - 1); + PDM_SNPF(out_len, used, output + used, out_len - used, + "val[%d:%d] = 8b'%d %d %d %d %d %d %d %d\n", + tmp + 7, tmp, val[tmp + 7], val[tmp + 6], + val[tmp + 5], val[tmp + 4], val[tmp + 3], + val[tmp + 2], val[tmp + 1], val[tmp + 0]); + } + } + dm->debug_components &= (~ODM_COMP_API); +out: + *_used = used; + *_out_len = out_len; +} + +void phydm_get_anapar_table(void *dm_void, u32 *_used, char *output, + u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 used = *_used; + u32 out_len = *_out_len; + enum rf_path i = RF_PATH_A; + +#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + if (!(dm->support_ic_type & ODM_IC_JGR3_SERIES)) + return; + + PDM_VAST_SNPF(out_len, used, output + used, out_len - used, + "------ Analog parameters start ------\n"); + + for (i = RF_PATH_A; i < (enum rf_path)dm->num_rf_path; i++) + phydm_get_per_path_anapar_jgr3(dm, i, &used, output, &out_len); +#endif + + *_used = used; + *_out_len = out_len; +} + +void phydm_dd_dbg_dump(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)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)) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "dump: {1}\n"); + return; + } else if (var1[0] == 1) { + /*[Reg]*/ + phydm_dump_mac_reg(dm, &used, output, &out_len); + phydm_dump_bb_reg(dm, &used, output, &out_len); + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + if (dm->ic_ip_series == PHYDM_IC_JGR3) + phydm_dump_bb_reg2_jgr3(dm, &used, output, &out_len); + #endif + + phydm_dump_rf_reg(dm, &used, output, &out_len); + /*[Dbg Port]*/ + #ifdef PHYDM_AUTO_DEGBUG + phydm_dbg_port_dump(dm, &used, output, &out_len); + #endif + /*[Analog Parameters]*/ + phydm_get_anapar_table(dm, &used, output, &out_len); + } +} + +void phydm_nss_hitogram_mp(void *dm_void, enum PDM_RATE_TYPE rate_type, + u32 *_used, char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct odm_phy_dbg_info *dbg_i = &dm->phy_dbg_info; + struct phydm_phystatus_statistic *dbg_s = &dbg_i->physts_statistic_info; + u32 used = *_used; + u32 out_len = *_out_len; + char buf[PHYDM_SNPRINT_SIZE] = {0}; + u16 buf_size = PHYDM_SNPRINT_SIZE; + u16 h_size = PHY_HIST_SIZE; + u16 *evm_hist = &dbg_s->evm_1ss_hist[0]; + u16 *snr_hist = &dbg_s->snr_1ss_hist[0]; + u8 i = 0; + u8 ss = phydm_rate_type_2_num_ss(dm, rate_type); + + if (rate_type == PDM_OFDM) { + phydm_print_hist_2_buf(dm, dbg_s->evm_ofdm_hist, PHY_HIST_SIZE, + buf, buf_size); + PDM_SNPF(out_len, used, output + used, out_len - used, + "%-14s=%s\n", "[OFDM][EVM]", buf); + + phydm_print_hist_2_buf(dm, dbg_s->snr_ofdm_hist, PHY_HIST_SIZE, + buf, buf_size); + PDM_SNPF(out_len, used, output + used, out_len - used, + "%-14s=%s\n", "[OFDM][SNR]", buf); + + *_used = used; + *_out_len = out_len; + return; + } + + for (i = 0; i < ss; i++) { + if (rate_type == PDM_1SS) { + evm_hist = &dbg_s->evm_1ss_hist[0]; + snr_hist = &dbg_s->snr_1ss_hist[0]; + } else if (rate_type == PDM_2SS) { + #if (defined(PHYDM_COMPILE_ABOVE_2SS)) + evm_hist = &dbg_s->evm_2ss_hist[i][0]; + snr_hist = &dbg_s->snr_2ss_hist[i][0]; + #endif + } else if (rate_type == PDM_3SS) { + #if (defined(PHYDM_COMPILE_ABOVE_3SS)) + evm_hist = &dbg_s->evm_3ss_hist[i][0]; + snr_hist = &dbg_s->snr_3ss_hist[i][0]; + #endif + } else if (rate_type == PDM_4SS) { + #if (defined(PHYDM_COMPILE_ABOVE_4SS)) + evm_hist = &dbg_s->evm_4ss_hist[i][0]; + snr_hist = &dbg_s->snr_4ss_hist[i][0]; + #endif + } + + phydm_print_hist_2_buf(dm, evm_hist, h_size, buf, buf_size); + PDM_SNPF(out_len, used, output + used, out_len - used, + "[%d-SS][EVM][%d]=%s\n", ss, i, buf); + phydm_print_hist_2_buf(dm, snr_hist, h_size, buf, buf_size); + PDM_SNPF(out_len, used, output + used, out_len - used, + "[%d-SS][SNR][%d]=%s\n", ss, i, buf); + } + *_used = used; + *_out_len = out_len; +} + +void phydm_mp_dbg(void *dm_void, char input[][16], u32 *_used, char *output, + u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct odm_phy_dbg_info *dbg_i = &dm->phy_dbg_info; + struct phydm_phystatus_statistic *dbg_s = &dbg_i->physts_statistic_info; + struct phydm_phystatus_avg *dbg_avg = &dbg_i->phystatus_statistic_avg; + char *rate_type = NULL; + u8 tmp_rssi_avg[4]; + u8 tmp_snr_avg[4]; + u8 tmp_evm_avg[4]; + u32 tmp_cnt = 0; + char buf[PHYDM_SNPRINT_SIZE] = {0}; + u32 used = *_used; + u32 out_len = *_out_len; + u32 var1[10] = {0}; + u16 buf_size = PHYDM_SNPRINT_SIZE; + u16 th_size = PHY_HIST_SIZE - 1; + u8 i = 0; + + if (!(*dm->mp_mode)) + return; + + PDM_SNPF(out_len, used, output + used, out_len - used, + "BW=((%d)), fc=((CH-%d))\n", + 20 << *dm->band_width, *dm->channel); + + /*@===[PHY Histogram]================================================*/ + PDM_SNPF(out_len, used, output + used, out_len - used, + "[PHY Histogram] ==============>\n"); + /*@===[Threshold]===*/ + phydm_print_hist_2_buf(dm, dbg_i->evm_hist_th, th_size, buf, buf_size); + PDM_SNPF(out_len, used, output + used, out_len - used, + "%-16s=%s\n", "[EVM_TH]", buf); + phydm_print_hist_2_buf(dm, dbg_i->snr_hist_th, th_size, buf, buf_size); + PDM_SNPF(out_len, used, output + used, out_len - used, + "%-16s=%s\n", "[SNR_TH]", buf); + /*@===[OFDM]===*/ + phydm_nss_hitogram_mp(dm, PDM_OFDM, &used, output, &out_len); + /*@===[1-SS]===*/ + phydm_nss_hitogram_mp(dm, PDM_1SS, &used, output, &out_len); + /*@===[2-SS]===*/ + #if (defined(PHYDM_COMPILE_ABOVE_2SS)) + if (dm->support_ic_type & PHYDM_IC_ABOVE_2SS) + phydm_nss_hitogram_mp(dm, PDM_2SS, &used, output, &out_len); + #endif + /*@===[3-SS]===*/ + #if (defined(PHYDM_COMPILE_ABOVE_3SS)) + if (dm->support_ic_type & PHYDM_IC_ABOVE_3SS) + phydm_nss_hitogram_mp(dm, PDM_3SS, &used, output, &out_len); + #endif + /*@===[4-SS]===*/ + #if (defined(PHYDM_COMPILE_ABOVE_4SS)) + if (dm->support_ic_type & PHYDM_IC_ABOVE_4SS) + phydm_nss_hitogram_mp(dm, PDM_4SS, &used, output, &out_len); + #endif + /*@===[PHY Avg]======================================================*/ + phydm_get_avg_phystatus_val(dm); + PDM_SNPF(out_len, used, output + used, out_len - used, + "[PHY Avg] ==============>\n"); + + phydm_get_avg_phystatus_val(dm); + PDM_SNPF(out_len, used, output + used, out_len - used, + "* %-8s Cnt=((%.3d)) RSSI:{%.2d}\n", + "[Beacon]", dbg_s->rssi_beacon_cnt, dbg_avg->rssi_beacon_avg); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "* %-8s Cnt=((%.3d)) RSSI:{%.2d}\n", + "[CCK]", dbg_s->rssi_cck_cnt, dbg_avg->rssi_cck_avg); + + for (i = 0; i <= 4; i++) { + if (i > dm->num_rf_path) + break; + + odm_memory_set(dm, tmp_rssi_avg, 0, 4); + odm_memory_set(dm, tmp_snr_avg, 0, 4); + odm_memory_set(dm, tmp_evm_avg, 0, 4); + + switch (i) { + #if (defined(PHYDM_COMPILE_ABOVE_4SS)) + case 4: + rate_type = "[4-SS]"; + tmp_cnt = dbg_s->rssi_4ss_cnt; + odm_move_memory(dm, tmp_rssi_avg, + dbg_avg->rssi_4ss_avg, dm->num_rf_path); + odm_move_memory(dm, tmp_snr_avg, + dbg_avg->snr_4ss_avg, dm->num_rf_path); + odm_move_memory(dm, tmp_evm_avg, dbg_avg->evm_4ss_avg, + 4); + break; + #endif + #if (defined(PHYDM_COMPILE_ABOVE_3SS)) + case 3: + rate_type = "[3-SS]"; + tmp_cnt = dbg_s->rssi_3ss_cnt; + odm_move_memory(dm, tmp_rssi_avg, + dbg_avg->rssi_3ss_avg, dm->num_rf_path); + odm_move_memory(dm, tmp_snr_avg, + dbg_avg->snr_3ss_avg, dm->num_rf_path); + odm_move_memory(dm, tmp_evm_avg, + dbg_avg->evm_3ss_avg, 3); + break; + #endif + #if (defined(PHYDM_COMPILE_ABOVE_2SS)) + case 2: + rate_type = "[2-SS]"; + tmp_cnt = dbg_s->rssi_2ss_cnt; + odm_move_memory(dm, tmp_rssi_avg, + dbg_avg->rssi_2ss_avg, dm->num_rf_path); + odm_move_memory(dm, tmp_snr_avg, dbg_avg->snr_2ss_avg, + dm->num_rf_path); + odm_move_memory(dm, tmp_evm_avg, + dbg_avg->evm_2ss_avg, 2); + break; + #endif + case 1: + rate_type = "[1-SS]"; + tmp_cnt = dbg_s->rssi_1ss_cnt; + odm_move_memory(dm, tmp_rssi_avg, + dbg_avg->rssi_1ss_avg, dm->num_rf_path); + odm_move_memory(dm, tmp_snr_avg, + dbg_avg->snr_1ss_avg, dm->num_rf_path); + odm_move_memory(dm, tmp_evm_avg, + &dbg_avg->evm_1ss_avg, 1); + break; + default: + rate_type = "[L-OFDM]"; + tmp_cnt = dbg_s->rssi_ofdm_cnt; + odm_move_memory(dm, tmp_rssi_avg, + dbg_avg->rssi_ofdm_avg, + dm->num_rf_path); + odm_move_memory(dm, tmp_snr_avg, + dbg_avg->snr_ofdm_avg, dm->num_rf_path); + odm_move_memory(dm, tmp_evm_avg, + &dbg_avg->evm_ofdm_avg, 1); + break; + } + + PDM_SNPF(out_len, used, output + used, out_len - used, + "* %-8s Cnt=((%.3d)) RSSI:{%.2d, %.2d, %.2d, %.2d} SNR:{%.2d, %.2d, %.2d, %.2d} EVM:{-%.2d, -%.2d, -%.2d, -%.2d}\n", + rate_type, tmp_cnt, + tmp_rssi_avg[0], tmp_rssi_avg[1], + tmp_rssi_avg[2], tmp_rssi_avg[3], + tmp_snr_avg[0], tmp_snr_avg[1], + tmp_snr_avg[2], tmp_snr_avg[3], + tmp_evm_avg[0], tmp_evm_avg[1], + tmp_evm_avg[2], tmp_evm_avg[3]); + } + + phydm_reset_phystatus_statistic(dm); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "rxsc_idx {Legacy, 20, 40, 80} = {%d, %d, %d, %d}\n", + dm->rxsc_l, dm->rxsc_20, dm->rxsc_40, dm->rxsc_80); + + *_used = used; + *_out_len = out_len; +} + +#if RTL8814B_SUPPORT +void phydm_spur_detect_dbg(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + char help[] = "-h"; + u32 var1[10] = {0}; + u32 used = *_used; + u32 out_len = *_out_len; + u32 i; + + if ((strcmp(input[1], help) == 0)) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "{0: Auto spur detect(NBI+CSI), 1:NBI only,"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "2: CSI only, 3: Disable}\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{NBI path(0~3) | CSI wgt (0~7)}\n"); + } else { + for (i = 0; i < 10; i++) { + if (input[i + 1]) + PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); + } + + if (var1[0] == 1) + dm->dsde_sel = DET_NBI; + else if (var1[0] == 2) + dm->dsde_sel = DET_CSI; + else if (var1[0] == 3) + dm->dsde_sel = DET_DISABLE; + else + dm->dsde_sel = DET_AUTO; + + PDM_SNPF(out_len, used, output + used, out_len - used, + "spur detect mode = %d\n", dm->dsde_sel); + + if (dm->dsde_sel == DET_NBI) { + if (var1[1] < 4) { + dm->nbi_path_sel = (u8)var1[1]; + PDM_SNPF(out_len, used, output + used, + out_len - used, "NBI set path %d\n", + dm->nbi_path_sel); + } else { + PDM_SNPF(out_len, used, output + used, + out_len - used, "path setting fail\n"); + } + } else if (dm->dsde_sel == DET_CSI) { + if (var1[1] < 8) { + dm->csi_wgt = (u8)var1[1]; + PDM_SNPF(out_len, used, output + used, + out_len - used, "CSI wgt %d\n", + dm->csi_wgt); + } else { + PDM_SNPF(out_len, used, output + used, + out_len - used, + "CSI wgt setting fail\n"); + } + } + } + + *_used = used; + *_out_len = out_len; +} +#endif + +struct phydm_command { char name[16]; u8 id; }; @@ -1846,103 +4584,137 @@ struct _PHYDM_COMMAND { enum PHYDM_CMD_ID { PHYDM_HELP, PHYDM_DEMO, + PHYDM_RF_CMD, + PHYDM_DIG, PHYDM_RA, PHYDM_PROFILE, PHYDM_ANTDIV, PHYDM_PATHDIV, PHYDM_DEBUG, + PHYDM_MP_DEBUG, PHYDM_FW_DEBUG, PHYDM_SUPPORT_ABILITY, PHYDM_GET_TXAGC, PHYDM_SET_TXAGC, PHYDM_SMART_ANT, - PHYDM_API, + PHYDM_CH_BW, PHYDM_TRX_PATH, PHYDM_LA_MODE, PHYDM_DUMP_REG, - PHYDM_MU_MIMO, - PHYDM_HANG, + PHYDM_AUTO_DBG, + PHYDM_DD_DBG, PHYDM_BIG_JUMP, PHYDM_SHOW_RXRATE, PHYDM_NBI_EN, PHYDM_CSI_MASK_EN, - PHYDM_DFS, - PHYDM_IQK, + PHYDM_DFS_DEBUG, + PHYDM_DFS_HIST, PHYDM_NHM, PHYDM_CLM, + PHYDM_FAHM, + PHYDM_ENV_MNTR, PHYDM_BB_INFO, - PHYDM_TXBF, - PHYDM_PAUSE_DIG_EN, + //PHYDM_TXBF, PHYDM_H2C, - PHYDM_ANT_SWITCH, - PHYDM_DYNAMIC_RA_PATH + PHYDM_EXT_RF_E_CTRL, + PHYDM_ADAPTIVE_SOML, + PHYDM_PSD, + PHYDM_DEBUG_PORT, + PHYDM_DIS_HTSTF_CONTROL, + PHYDM_CFO_TRK, + PHYDM_ADAPTIVITY_DEBUG, + PHYDM_DIS_DYM_ANT_WEIGHTING, + PHYDM_FORECE_PT_STATE, + PHYDM_STA_INFO, + PHYDM_PAUSE_FUNC, + PHYDM_PER_TONE_EVM, + PHYDM_DYN_TXPWR, + PHYDM_LNA_SAT, + PHYDM_ANAPAR, + PHYDM_BEAM_FORMING, +#if RTL8814B_SUPPORT + PHYDM_SPUR_DETECT +#endif }; -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*/ +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*/ + {"rf", PHYDM_RF_CMD}, + {"dig", PHYDM_DIG}, {"ra", PHYDM_RA}, {"profile", PHYDM_PROFILE}, {"antdiv", PHYDM_ANTDIV}, {"pathdiv", PHYDM_PATHDIV}, {"dbg", PHYDM_DEBUG}, + {"mp_dbg", PHYDM_MP_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}, + {"ch_bw", PHYDM_CH_BW}, {"trxpath", PHYDM_TRX_PATH}, {"lamode", PHYDM_LA_MODE}, {"dumpreg", PHYDM_DUMP_REG}, - {"mu", PHYDM_MU_MIMO}, - {"hang", PHYDM_HANG}, + {"auto_dbg", PHYDM_AUTO_DBG}, + {"dd_dbg", PHYDM_DD_DBG}, {"bigjump", PHYDM_BIG_JUMP}, {"rxrate", PHYDM_SHOW_RXRATE}, {"nbi", PHYDM_NBI_EN}, {"csi_mask", PHYDM_CSI_MASK_EN}, - {"dfs", PHYDM_DFS}, - {"iqk", PHYDM_IQK}, + {"dfs", PHYDM_DFS_DEBUG}, + {"dfs_hist", PHYDM_DFS_HIST}, {"nhm", PHYDM_NHM}, {"clm", PHYDM_CLM}, + {"fahm", PHYDM_FAHM}, + {"env_mntr", PHYDM_ENV_MNTR}, {"bbinfo", PHYDM_BB_INFO}, - {"txbf", PHYDM_TXBF}, - {"pause_dig", PHYDM_PAUSE_DIG_EN}, + //{"txbf", PHYDM_TXBF}, {"h2c", PHYDM_H2C}, - {"ant_switch", PHYDM_ANT_SWITCH}, - {"drp", PHYDM_DYNAMIC_RA_PATH} -}; + {"ext_rfe", PHYDM_EXT_RF_E_CTRL}, + {"soml", PHYDM_ADAPTIVE_SOML}, + {"psd", PHYDM_PSD}, + {"dbgport", PHYDM_DEBUG_PORT}, + {"dis_htstf", PHYDM_DIS_HTSTF_CONTROL}, + {"cfo_trk", PHYDM_CFO_TRK}, + {"adapt_debug", PHYDM_ADAPTIVITY_DEBUG}, + {"dis_dym_ant_wgt", PHYDM_DIS_DYM_ANT_WEIGHTING}, + {"force_pt_state", PHYDM_FORECE_PT_STATE}, + {"sta_info", PHYDM_STA_INFO}, + {"pause", PHYDM_PAUSE_FUNC}, + {"evm", PHYDM_PER_TONE_EVM}, + {"dyn_txpwr", PHYDM_DYN_TXPWR}, + {"lna_sat", PHYDM_LNA_SAT}, + {"anapar", PHYDM_ANAPAR}, + {"bf", PHYDM_BEAM_FORMING}, +#if RTL8814B_SUPPORT + {"spur_detect", PHYDM_SPUR_DETECT} +#endif + }; -#endif /*#if CONFIG_PHYDM_DEBUG_FUNCTION*/ +#endif /*@#ifdef CONFIG_PHYDM_DEBUG_FUNCTION*/ -void -phydm_cmd_parser( - struct PHY_DM_STRUCT *p_dm_odm, - char input[][MAX_ARGV], - u32 input_num, - u8 flag, - char *output, - u32 out_len -) +void phydm_cmd_parser(struct dm_struct *dm, char input[][MAX_ARGV], + u32 input_num, u8 flag, char *output, u32 out_len) { -#if CONFIG_PHYDM_DEBUG_FUNCTION +#ifdef CONFIG_PHYDM_DEBUG_FUNCTION u32 used = 0; u8 id = 0; - int var1[10] = {0}; - int i, input_idx = 0, phydm_ary_size; - char help[] = "-h"; + u32 var1[10] = {0}; + u32 i; + u32 phydm_ary_size = sizeof(phy_dm_ary) / sizeof(struct phydm_command); if (flag == 0) { - PHYDM_SNPRINTF((output + used, out_len - used, "GET, nothing to print\n")); + PDM_SNPF(out_len, used, output + used, out_len - used, + "GET, nothing to print\n"); return; } - PHYDM_SNPRINTF((output + used, out_len - used, "\n")); + PDM_SNPF(out_len, used, 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; @@ -1950,759 +4722,340 @@ phydm_cmd_parser( } } if (i == phydm_ary_size) { - PHYDM_SNPRINTF((output + used, out_len - used, "SET, command not found!\n")); + PDM_SNPF(out_len, used, output + used, out_len - used, + "PHYDM command not found!\n"); return; } } switch (id) { + case PHYDM_HELP: { + PDM_SNPF(out_len, used, output + used, out_len - used, + "BB cmd ==>\n"); - case PHYDM_HELP: - { - PHYDM_SNPRINTF((output + used, out_len - used, "BB cmd ==>\n")); - for (i = 0; i < phydm_ary_size - 2; i++) { + for (i = 0; i < phydm_ary_size - 2; i++) + PDM_SNPF(out_len, used, output + used, out_len - used, + " %-5d: %s\n", i, phy_dm_ary[i + 2].name); + } break; - 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*/ + case PHYDM_DEMO: { /*@echo demo 10 0x3a z abcde >cmd*/ u32 directory = 0; -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_AP)) + #if (DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_AP)) char char_temp; -#else + #else u32 char_temp = ' '; -#endif + #endif PHYDM_SSCANF(input[1], DCMD_DECIMAL, &directory); - PHYDM_SNPRINTF((output + used, out_len - used, "Decimal value = %d\n", directory)); + PDM_SNPF(out_len, used, 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)); + PDM_SNPF(out_len, used, 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; + PDM_SNPF(out_len, used, output + used, out_len - used, + "Char = %c\n", char_temp); + PDM_SNPF(out_len, used, output + used, out_len - used, + "String = %s\n", input[4]); + } break; + case PHYDM_RF_CMD: + halrf_cmd_parser(dm, input, &used, output, &out_len, input_num); + break; + + case PHYDM_DIG: + phydm_dig_debug(dm, input, &used, output, &out_len); + 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((void *)p_dm_odm, (u32 *) var1); -#else - phydm_RA_debug_PCR(p_dm_odm, (u32 *)var1, &used, output, &out_len); -#endif - } - - + phydm_ra_debug(dm, input, &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_odm, (u32 *)var1, &used, output, &out_len); -#endif - } - + #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) + phydm_antdiv_debug(dm, input, &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_odm, (u32 *)var1, &used, output, &out_len); -#endif - } - + #if (defined(CONFIG_PATH_DIVERSITY)) + phydm_pathdiv_debug(dm, input, &used, output, &out_len); + #endif break; case PHYDM_DEBUG: + phydm_debug_trace(dm, input, &used, output, &out_len); + break; - 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_odm, (u32 *)var1, &used, output, &out_len); - } - - + case PHYDM_MP_DEBUG: + phydm_mp_dbg(dm, input, &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_odm, (u32 *)var1, &used, output, &out_len); - + phydm_fw_debug_trace(dm, input, &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_odm, (u32 *)var1, &used, output, &out_len); - } - + phydm_supportability_en(dm, input, &used, output, &out_len); break; case PHYDM_SMART_ANT: + #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) - for (i = 0; i < 5; i++) { - if (input[i + 1]) { - PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); - input_idx++; - } - } + #ifdef CONFIG_HL_SMART_ANTENNA_TYPE2 + phydm_hl_smt_ant_dbg_type2(dm, input, &used, output, &out_len); + #elif (defined(CONFIG_HL_SMART_ANTENNA_TYPE1)) + phydm_hl_smart_ant_debug(dm, input, &used, output, &out_len); + #endif - if (input_idx >= 1) { -#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 - phydm_hl_smart_ant_debug(p_dm_odm, (u32 *)var1, &used, output, &out_len); -#endif -#endif - } + #elif (defined(CONFIG_CUMITEK_SMART_ANTENNA)) + phydm_cumitek_smt_ant_debug(dm, input, &used, output, &out_len); + #endif break; - case PHYDM_API: -#if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1 || RTL8821C_SUPPORT == 1) - { - if (p_dm_odm->support_ic_type & (ODM_RTL8822B | ODM_RTL8197F | ODM_RTL8821C)) { - bool is_enable_dbg_mode; - u8 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]); - } - - is_enable_dbg_mode = (bool)var1[0]; - central_ch = (u8) var1[1]; - primary_ch_idx = (u8) var1[2]; - bandwidth = (enum odm_bw_e) var1[3]; - - if (is_enable_dbg_mode) { - p_dm_odm->is_disable_phy_api = false; - phydm_api_switch_bw_channel(p_dm_odm, central_ch, primary_ch_idx, (enum odm_bw_e) bandwidth); - p_dm_odm->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_odm->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 + case PHYDM_CH_BW: + phydm_bw_ch_adjust(dm, input, &used, output, &out_len); break; - case PHYDM_PROFILE: /*echo profile, >cmd*/ - phydm_basic_profile(p_dm_odm, &used, output, &out_len); + case PHYDM_PROFILE: + phydm_basic_profile(dm, &used, output, &out_len); break; case PHYDM_GET_TXAGC: - phydm_get_txagc(p_dm_odm, &used, output, &out_len); + phydm_get_txagc(dm, &used, output, &out_len); break; case PHYDM_SET_TXAGC: - { - bool 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 = (bool)var1[0]; - if (is_enable_dbg_mode) { - p_dm_odm->is_disable_phy_api = false; - phydm_set_txagc(p_dm_odm, (u32 *)var1, &used, output, &out_len); - p_dm_odm->is_disable_phy_api = true; - } else { - p_dm_odm->is_disable_phy_api = false; - PHYDM_SNPRINTF((output + used, out_len - used, "Disable API debug mode\n")); - } - } - } - break; + phydm_set_txagc_dbg(dm, input, &used, output, &out_len); + 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_odm->support_ic_type & (ODM_RTL8822B | ODM_RTL8197F)) { - u8 tx_path, rx_path; - bool is_enable_dbg_mode, is_tx2_path; - - is_enable_dbg_mode = (bool)var1[0]; - tx_path = (u8) var1[1]; - rx_path = (u8) var1[2]; - is_tx2_path = (bool) var1[3]; - - if (is_enable_dbg_mode) { - p_dm_odm->is_disable_phy_api = false; - phydm_api_trx_mode(p_dm_odm, (enum odm_rf_path_e) tx_path, (enum odm_rf_path_e) rx_path, is_tx2_path); - p_dm_odm->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_odm->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_odm, (u32 *)var1, &used, output, &out_len); - + phydm_config_trx_path(dm, input, &used, output, &out_len); break; case PHYDM_LA_MODE: - -#if (PHYDM_LA_MODE_SUPPORT == 1) - p_dm_odm->support_ability &= ~(ODM_BB_FA_CNT); - phydm_lamode_trigger_setting(p_dm_odm, &input[0], &used, output, &out_len, input_num); - p_dm_odm->support_ability |= ODM_BB_FA_CNT; -#else - PHYDM_SNPRINTF((output + used, out_len - used, "This IC doesn't support LA mode\n")); -#endif - + #if (PHYDM_LA_MODE_SUPPORT) + phydm_la_cmd(dm, input, &used, output, &out_len); + #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_odm, &used, output, &out_len); - else if (type == 1) - phydm_dump_all_reg(p_dm_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; - u32 dword_h, dword_l; - - PHYDM_SNPRINTF((output + used, out_len - used, "Get MU BFee CSI\n")); - odm_set_bb_reg(p_dm_odm, 0x9e8, BIT(17) | BIT16, 2); /*Read BFee*/ - odm_set_bb_reg(p_dm_odm, 0x1910, BIT(15), 1); /*Select BFee's CSI report*/ - odm_set_bb_reg(p_dm_odm, 0x19b8, BIT(6), 1); /*set as CSI report*/ - odm_set_bb_reg(p_dm_odm, 0x19a8, 0xFFFF, 0xFFFF); /*disable gated_clk*/ - - for (index = 0; index < 80; index++) { - ptr = index + 256; - if (ptr > 311) - ptr -= 312; - odm_set_bb_reg(p_dm_odm, 0x1910, 0x03FF0000, ptr); /*Select Address*/ - dword_h = odm_get_bb_reg(p_dm_odm, 0xF74, MASKDWORD); - dword_l = odm_get_bb_reg(p_dm_odm, 0xF5C, MASKDWORD); - if (index % 2 == 0) - PHYDM_SNPRINTF((output + used, out_len - used, "%02x %02x %02x %02x %02x %02x %02x %02x\n", - dword_l & MASKBYTE0, (dword_l & MASKBYTE1) >> 8, (dword_l & MASKBYTE2) >> 16, (dword_l & MASKBYTE3) >> 24, - dword_h & MASKBYTE0, (dword_h & MASKBYTE1) >> 8, (dword_h & MASKBYTE2) >> 16, (dword_h & MASKBYTE3) >> 24)); - else - PHYDM_SNPRINTF((output + used, out_len - used, "%02x %02x %02x %02x %02x %02x %02x %02x\n", - dword_l & MASKBYTE0, (dword_l & MASKBYTE1) >> 8, (dword_l & MASKBYTE2) >> 16, (dword_l & MASKBYTE3) >> 24, - dword_h & MASKBYTE0, (dword_h & MASKBYTE1) >> 8, (dword_h & MASKBYTE2) >> 16, (dword_h & MASKBYTE3) >> 24)); - } - } else if (var1[0] == 2) { - int index, ptr; - u32 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_set_bb_reg(p_dm_odm, 0x9e8, BIT(24), 0); /*Read BFer*/ - odm_set_bb_reg(p_dm_odm, 0x9e8, BIT(25), 1); /*enable Read/Write RAM*/ - odm_set_bb_reg(p_dm_odm, 0x9e8, BIT(30) | BIT29 | BIT28, var1[1]); /*read which STA's CSI report*/ - odm_set_bb_reg(p_dm_odm, 0x1910, BIT(15), 0); /*select BFer's CSI*/ - odm_set_bb_reg(p_dm_odm, 0x19e0, 0x00003FC0, 0xFF); /*disable gated_clk*/ - - for (index = 0; index < 80; index++) { - ptr = index + 256; - if (ptr > 311) - ptr -= 312; - odm_set_bb_reg(p_dm_odm, 0x1910, 0x03FF0000, ptr); /*Select Address*/ - dword_h = odm_get_bb_reg(p_dm_odm, 0xF74, MASKDWORD); - dword_l = odm_get_bb_reg(p_dm_odm, 0xF5C, MASKDWORD); - if (index % 2 == 0) - PHYDM_SNPRINTF((output + used, out_len - used, "%02x %02x %02x %02x %02x %02x %02x %02x\n", - dword_l & MASKBYTE0, (dword_l & MASKBYTE1) >> 8, (dword_l & MASKBYTE2) >> 16, (dword_l & MASKBYTE3) >> 24, - dword_h & MASKBYTE0, (dword_h & MASKBYTE1) >> 8, (dword_h & MASKBYTE2) >> 16, (dword_h & MASKBYTE3) >> 24)); - else - PHYDM_SNPRINTF((output + used, out_len - used, "%02x %02x %02x %02x %02x %02x %02x %02x\n", - dword_l & MASKBYTE0, (dword_l & MASKBYTE1) >> 8, (dword_l & MASKBYTE2) >> 16, (dword_l & MASKBYTE3) >> 24, - dword_h & MASKBYTE0, (dword_h & MASKBYTE1) >> 8, (dword_h & MASKBYTE2) >> 16, (dword_h & MASKBYTE3) >> 24)); - - PHYDM_SNPRINTF((output + used, out_len - used, "ptr=%d : 0x%8x %8x\n", ptr, dword_h, dword_l)); - } - - } -#endif + phydm_dump_reg(dm, input, &used, output, &out_len); break; case PHYDM_BIG_JUMP: - { -#if (RTL8822B_SUPPORT == 1) - if (input[1]) { - PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); - phydm_enable_big_jump(p_dm_odm, (bool)(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 + phydm_enable_big_jump(dm, input, &used, output, &out_len); break; - } - case PHYDM_HANG: - phydm_bb_rx_hang_info(p_dm_odm, &used, output, &out_len); + case PHYDM_AUTO_DBG: + #ifdef PHYDM_AUTO_DEGBUG + phydm_auto_dbg_console(dm, input, &used, output, &out_len); + #endif + break; + + case PHYDM_DD_DBG: + phydm_dd_dbg_dump(dm, input, &used, output, &out_len); break; case PHYDM_SHOW_RXRATE: -#if (RTL8822B_SUPPORT == 1) - { - u8 rate_idx; - - if (input[1]) - PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); - - if (var1[0] == 1) - phydm_show_rx_rate(p_dm_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++) { - p_dm_odm->phy_dbg_info.num_qry_vht_pkt[rate_idx] = 0; - p_dm_odm->phy_dbg_info.num_qry_mu_vht_pkt[rate_idx] = 0; - } - } - } -#endif + phydm_show_rx_rate(dm, input, &used, output, &out_len); 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_odm, PHYDM_API_NBI, (u32 *)var1, &used, output, &out_len); - /**/ - } - - + phydm_nbi_debug(dm, input, &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_odm, PHYDM_API_CSI_MASK, (u32 *)var1, &used, output, &out_len); - /**/ - } - - + phydm_csi_debug(dm, input, &used, output, &out_len); break; - case PHYDM_DFS: -#if (DM_ODM_SUPPORT_TYPE & ODM_CE) - { - u32 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(p_dm_odm, var, &used, output, &out_len); - } -#endif + #ifdef CONFIG_PHYDM_DFS_MASTER + case PHYDM_DFS_DEBUG: + phydm_dfs_debug(dm, input, &used, output, &out_len); break; - case PHYDM_IQK: -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - phy_iq_calibrate(p_dm_odm->priv); - PHYDM_SNPRINTF((output + used, out_len - used, "IQK !!\n")); -#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) - phy_iq_calibrate(p_dm_odm->adapter, false); - PHYDM_SNPRINTF((output + used, out_len - used, "IQK !!\n")); -#endif + case PHYDM_DFS_HIST: + phydm_dfs_hist_dbg(dm, input, &used, output, &out_len); break; + #endif case PHYDM_NHM: - { - u8 target_rssi; - u32 value32; - u16 nhm_period = 0xC350; /* 200ms */ - u8 IGI; - struct _CCX_INFO *ccx_info = &p_dm_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 = (u8)odm_get_bb_reg(p_dm_odm, 0xC50, MASKBYTE0); - - 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_nhm_setting(p_dm_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_nhm_setting(p_dm_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_nhm_trigger(p_dm_odm); - - } - - /*Get NHM results*/ - else if (var1[0] == 3) { - - IGI = (u8)odm_get_bb_reg(p_dm_odm, 0xC50, MASKBYTE0); - - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n Cur_IGI = 0x%x", IGI)); - - phydm_get_nhm_result(p_dm_odm); - - /* 4 Resotre NHM setting */ - phydm_nhm_setting(p_dm_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; + #ifdef NHM_SUPPORT + phydm_nhm_dbg(dm, input, &used, output, &out_len); + #endif + break; case PHYDM_CLM: - { - struct _CCX_INFO *ccx_info = &p_dm_odm->dm_ccx_info; - PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); + #ifdef CLM_SUPPORT + phydm_clm_dbg(dm, input, &used, output, &out_len); + #endif + break; - /* PHYDM_SNPRINTF((output + used, out_len - used, "\r\n input_num = %d\n", input_num)); */ + #ifdef FAHM_SUPPORT + case PHYDM_FAHM: + phydm_fahm_dbg(dm, input, &used, output, &out_len); + break; + #endif - 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_clm_setting(p_dm_odm); - phydm_clm_trigger(p_dm_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_get_cl_mresult(p_dm_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_ENV_MNTR: + phydm_env_mntr_dbg(dm, input, &used, output, &out_len); + break; case PHYDM_BB_INFO: - { - s32 value32 = 0; + phydm_bb_hw_dbg_info(dm, input, &used, output, &out_len); + break; + /* + case PHYDM_TXBF: { + #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + #ifdef PHYDM_BEAMFORMING_SUPPORT + struct _RT_BEAMFORMING_INFO *beamforming_info = NULL; - phydm_bb_debug_info(p_dm_odm, &used, output, &out_len); - - if (p_dm_odm->support_ic_type & ODM_RTL8822B && input[1]) { - PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); - odm_set_bb_reg(p_dm_odm, 0x1988, 0x003fff00, var1[0]); - value32 = odm_get_bb_reg(p_dm_odm, 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_odm, 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_odm->beamforming_info; + beamforming_info = &dm->beamforming_info; PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); - if (var1[0] == 1) { - p_beamforming_info->apply_v_matrix = true; - p_beamforming_info->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) { - 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")); + if (var1[0] == 0) { + beamforming_info->apply_v_matrix = false; + beamforming_info->snding3ss = true; + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n dont apply V matrix and 3SS 789 snding\n"); + } else if (var1[0] == 1) { + beamforming_info->apply_v_matrix = true; + beamforming_info->snding3ss = true; + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n apply V matrix and 3SS 789 snding\n"); + } else if (var1[0] == 2) { + beamforming_info->apply_v_matrix = true; + beamforming_info->snding3ss = false; + PDM_SNPF(out_len, used, 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_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_pause_dig(p_dm_odm, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_7, (u8)var1[1]); - PHYDM_SNPRINTF((output + used, out_len - used, "Set IGI_value = ((%x))\n", var1[1])); - } else if (var1[0] == 1) { - odm_pause_dig(p_dm_odm, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_7, (u8)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; - + PDM_SNPF(out_len, used, output + used, out_len - used, + "\r\n unknown cmd!!\n"); + #endif + #endif + } break; + */ case PHYDM_H2C: + phydm_h2C_debug(dm, input, &used, output, &out_len); + break; - for (i = 0; i < 8; i++) { - if (input[i + 1]) { - PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); - input_idx++; - } - } + case PHYDM_EXT_RF_E_CTRL: + phydm_ext_rf_element_ctrl(dm, input, &used, output, &out_len); + break; - if (input_idx >= 1) - phydm_h2C_debug(p_dm_odm, (u32 *)var1, &used, output, &out_len); + case PHYDM_ADAPTIVE_SOML: + #ifdef CONFIG_ADAPTIVE_SOML + phydm_soml_debug(dm, input, &used, output, &out_len); + #endif + break; + case PHYDM_PSD: + + #ifdef CONFIG_PSD_TOOL + phydm_psd_debug(dm, input, &used, output, &out_len); + #endif break; - case PHYDM_ANT_SWITCH: + case PHYDM_DEBUG_PORT: + phydm_print_dbgport(dm, input, &used, output, &out_len); + break; - for (i = 0; i < 8; i++) { - if (input[i + 1]) { - PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); - input_idx++; - } + 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 */ + dm->bhtstfdisabled = true; + PDM_SNPF(out_len, used, output + used, out_len - used, + "Dynamic HT-STF Gain Control is Disable\n"); + } else { + /* @default setting should be true, + * always be dynamic control + */ + dm->bhtstfdisabled = false; + PDM_SNPF(out_len, used, output + used, out_len - used, + "Dynamic HT-STF Gain Control is Enable\n"); } + } break; - if (input_idx >= 1) { + case PHYDM_CFO_TRK: + phydm_cfo_tracking_debug(dm, input, &used, output, &out_len); + break; -#if (RTL8821A_SUPPORT == 1) - phydm_set_ext_switch(p_dm_odm, (u32 *)var1, &used, output, &out_len); -#else - PHYDM_SNPRINTF((output + used, out_len - used, "Not Support IC")); + case PHYDM_ADAPTIVITY_DEBUG: + #ifdef PHYDM_SUPPORT_ADAPTIVITY + phydm_adaptivity_debug(dm, input, &used, output, &out_len); + #endif + break; + + case PHYDM_DIS_DYM_ANT_WEIGHTING: + #ifdef DYN_ANT_WEIGHTING_SUPPORT + phydm_ant_weight_dbg(dm, input, &used, output, &out_len); + #endif + break; + + case PHYDM_FORECE_PT_STATE: + #ifdef PHYDM_POWER_TRAINING_SUPPORT + phydm_pow_train_debug(dm, input, &used, output, &out_len); + #endif + break; + + case PHYDM_STA_INFO: + phydm_show_sta_info(dm, input, &used, output, &out_len); + break; + + case PHYDM_PAUSE_FUNC: + phydm_pause_func_console(dm, input, &used, output, &out_len); + break; + + case PHYDM_PER_TONE_EVM: + phydm_per_tone_evm(dm, input, &used, output, &out_len); + break; + + #ifdef CONFIG_DYNAMIC_TX_TWR + case PHYDM_DYN_TXPWR: + phydm_dtp_debug(dm, input, &used, output, &out_len); + break; + #endif + + case PHYDM_LNA_SAT: + #ifdef PHYDM_LNA_SAT_CHK_SUPPORT + phydm_lna_sat_debug(dm, input, &used, output, &out_len); + #endif + break; + + case PHYDM_ANAPAR: + phydm_get_anapar_table(dm, &used, output, &out_len); + break; + case PHYDM_BEAM_FORMING: + #ifdef CONFIG_BB_TXBF_API + phydm_bf_debug(dm, input, &used, output, &out_len); + #endif + break; + +#if RTL8814B_SUPPORT + case PHYDM_SPUR_DETECT: + phydm_spur_detect_dbg(dm, input, &used, output, &out_len); + break; #endif - } - - - break; - - case PHYDM_DYNAMIC_RA_PATH: - -#if (CONFIG_DYNAMIC_RX_PATH == 1) - 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_odm, (u32 *)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")); + PDM_SNPF(out_len, used, output + used, out_len - used, + "Do not support this command\n"); break; - } -#endif /*#if CONFIG_PHYDM_DEBUG_FUNCTION*/ +#endif /*@#ifdef CONFIG_PHYDM_DEBUG_FUNCTION*/ } -#ifdef __ECOS +#if defined __ECOS || defined __ICCARM__ char *strsep(char **s, const char *ct) { char *sbegin = *s; char *end; - if (sbegin == NULL) + if (!sbegin) return NULL; end = strpbrk(sbegin, ct); @@ -2713,317 +5066,367 @@ char *strsep(char **s, const char *ct) } #endif -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_AP)) -s32 -phydm_cmd( - struct PHY_DM_STRUCT *p_dm_odm, - char *input, - u32 in_len, - u8 flag, - char *output, - u32 out_len -) +#if (DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_AP | ODM_IOT)) +s32 phydm_cmd(struct dm_struct *dm, char *input, u32 in_len, u8 flag, + char *output, u32 out_len) { char *token; - u32 argc = 0; - char argv[MAX_ARGC][MAX_ARGV]; + u32 argc = 0; + char argv[MAX_ARGC][MAX_ARGV]; do { token = strsep(&input, ", "); if (token) { - strcpy(argv[argc], token); + if (strlen(token) <= MAX_ARGV) + strcpy(argv[argc], token); + argc++; - } else + } else { break; + } } while (argc < MAX_ARGC); if (argc == 1) argv[0][strlen(argv[0]) - 1] = '\0'; - phydm_cmd_parser(p_dm_odm, argv, argc, flag, output, out_len); + phydm_cmd_parser(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 -) +void phydm_fw_trace_handler(void *dm_void, u8 *cmd_buf, u8 cmd_len) { -#if CONFIG_PHYDM_DEBUG_FUNCTION - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; +#ifdef CONFIG_PHYDM_DEBUG_FUNCTION + struct dm_struct *dm = (struct dm_struct *)dm_void; - /*u8 debug_trace_11byte[60];*/ - u8 freg_num, c2h_seq, buf_0 = 0; + /*@u8 debug_trace_11byte[60];*/ + u8 freg_num, c2h_seq, buf_0 = 0; - if (!(p_dm_odm->support_ic_type & PHYDM_IC_3081_SERIES)) + if (!(dm->support_ic_type & PHYDM_IC_3081_SERIES)) return; - if (cmd_len > 12) + if (cmd_len > 12 || cmd_len == 0) { + pr_debug("[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; - /*ODM_RT_TRACE(p_dm_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,&cmd_buf[1],(cmd_len-1));*/ - /*debug_trace_11byte[cmd_len-1] = '\0';*/ - /*ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW debug message] %s\n", debug_trace_11byte));*/ - /*ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW debug message] cmd_len = (( %d ))\n", cmd_len));*/ - /*ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW debug message] c2h_cmd_start = (( %d ))\n", p_dm_odm->c2h_cmd_start));*/ + #if 0 + PHYDM_DBG(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(dm, DBG_FW_TRACE, "[FW debug message] %s\n", + debug_trace_11byte); + PHYDM_DBG(dm, DBG_FW_TRACE, "[FW debug message] cmd_len = (( %d ))\n", + cmd_len); + PHYDM_DBG(dm, DBG_FW_TRACE, "[FW debug message] c2h_cmd_start=((%d))\n", + dm->c2h_cmd_start); + PHYDM_DBG(dm, DBG_FW_TRACE, "pre_seq = (( %d )), current_seq=((%d))\n", + dm->pre_c2h_seq, c2h_seq); + PHYDM_DBG(dm, DBG_FW_TRACE, "fw_buff_is_enpty = (( %d ))\n", + dm->fw_buff_is_enpty); + #endif - /*ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("pre_seq = (( %d )), current_seq = (( %d ))\n", p_dm_odm->pre_c2h_seq, c2h_seq));*/ - /*ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("fw_buff_is_enpty = (( %d ))\n", p_dm_odm->fw_buff_is_enpty));*/ - - if ((c2h_seq != p_dm_odm->pre_c2h_seq) && p_dm_odm->fw_buff_is_enpty == false) { - p_dm_odm->fw_debug_trace[p_dm_odm->c2h_cmd_start] = '\0'; - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW Dbg Queue Overflow] %s\n", p_dm_odm->fw_debug_trace)); - p_dm_odm->c2h_cmd_start = 0; + if (c2h_seq != dm->pre_c2h_seq && dm->fw_buff_is_enpty == false) { + dm->fw_debug_trace[dm->c2h_cmd_start] = '\0'; + PHYDM_DBG(dm, DBG_FW_TRACE, "[FW Dbg Queue Overflow] %s\n", + dm->fw_debug_trace); + dm->c2h_cmd_start = 0; } - if ((cmd_len - 1) > (60 - p_dm_odm->c2h_cmd_start)) { - p_dm_odm->fw_debug_trace[p_dm_odm->c2h_cmd_start] = '\0'; - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW Dbg Queue error: wrong C2H length] %s\n", p_dm_odm->fw_debug_trace)); - p_dm_odm->c2h_cmd_start = 0; + if ((cmd_len - 1) > (60 - dm->c2h_cmd_start)) { + dm->fw_debug_trace[dm->c2h_cmd_start] = '\0'; + PHYDM_DBG(dm, DBG_FW_TRACE, + "[FW Dbg Queue error: wrong C2H length] %s\n", + dm->fw_debug_trace); + dm->c2h_cmd_start = 0; return; } - strncpy((char *)&(p_dm_odm->fw_debug_trace[p_dm_odm->c2h_cmd_start]), (char *)&cmd_buf[1], (cmd_len - 1)); - p_dm_odm->c2h_cmd_start += (cmd_len - 1); - p_dm_odm->fw_buff_is_enpty = false; + strncpy((char *)&dm->fw_debug_trace[dm->c2h_cmd_start], + (char *)&cmd_buf[1], (cmd_len - 1)); + dm->c2h_cmd_start += (cmd_len - 1); + dm->fw_buff_is_enpty = false; - if (freg_num == 0 || p_dm_odm->c2h_cmd_start >= 60) { - if (p_dm_odm->c2h_cmd_start < 60) - p_dm_odm->fw_debug_trace[p_dm_odm->c2h_cmd_start] = '\0'; + if (freg_num == 0 || dm->c2h_cmd_start >= 60) { + if (dm->c2h_cmd_start < 60) + dm->fw_debug_trace[dm->c2h_cmd_start] = '\0'; else - p_dm_odm->fw_debug_trace[59] = '\0'; + dm->fw_debug_trace[59] = '\0'; - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW DBG Msg] %s\n", p_dm_odm->fw_debug_trace)); - /*dbg_print("[FW DBG Msg] %s\n", p_dm_odm->fw_debug_trace);*/ - p_dm_odm->c2h_cmd_start = 0; - p_dm_odm->fw_buff_is_enpty = true; + PHYDM_DBG(dm, DBG_FW_TRACE, "[FW DBG Msg] %s\n", + dm->fw_debug_trace); +#if 0 + /*@dbg_print("[FW DBG Msg] %s\n", dm->fw_debug_trace);*/ +#endif + dm->c2h_cmd_start = 0; + dm->fw_buff_is_enpty = true; } - p_dm_odm->pre_c2h_seq = c2h_seq; -#endif /*#if CONFIG_PHYDM_DEBUG_FUNCTION*/ + 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 -) +void phydm_fw_trace_handler_code(void *dm_void, u8 *buffer, u8 cmd_len) { -#if CONFIG_PHYDM_DEBUG_FUNCTION - struct PHY_DM_STRUCT *p_dm_odm = (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]); +#ifdef CONFIG_PHYDM_DEBUG_FUNCTION + struct dm_struct *dm = (struct dm_struct *)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) - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW Msg] Invalid cmd length (( %d )) >12\n", cmd_len)); - - /* ODM_RT_TRACE(p_dm_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) + PHYDM_DBG(dm, DBG_FW_TRACE, + "[FW Msg] Invalid cmd length (( %d )) >12\n", + cmd_len); +/*@--------------------------------------------*/ +#ifdef CONFIG_RA_FW_DBG_CODE if (function == RATE_DECISION) { if (dbg_num == 0) { if (content_0 == 1) - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] RA_CNT=((%d)) Max_device=((%d))--------------------------->\n", content_1, content_2)); + PHYDM_DBG(dm, DBG_FW_TRACE, + "[FW] RA_CNT=((%d)) Max_device=((%d))--------------------------->\n", + content_1, content_2); else if (content_0 == 2) - ODM_RT_TRACE(p_dm_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)); + PHYDM_DBG(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) - ODM_RT_TRACE(p_dm_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)); + PHYDM_DBG(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) - ODM_RT_TRACE(p_dm_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)); + PHYDM_DBG(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) { - ODM_RT_TRACE(p_dm_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(p_dm_odm, (u8)content_4, ODM_FW_DEBUG_TRACE); + PHYDM_DBG(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(dm, (u8)content_4, + DBG_FW_TRACE); } else if (content_0 == 3) - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] penality_idx=(( %d ))\n", content_1)); + PHYDM_DBG(dm, DBG_FW_TRACE, + "[FW] penality_idx=(( %d ))\n", + content_1); else if (content_0 == 4) - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] RSSI=(( %d )), ra_stage = (( %d ))\n", content_1, content_2)); - } - - else if (dbg_num == 3) { + PHYDM_DBG(dm, DBG_FW_TRACE, + "[FW] RSSI=(( %d )), ra_stage = (( %d ))\n", + content_1, content_2); + } else if (dbg_num == 3) { if (content_0 == 1) - ODM_RT_TRACE(p_dm_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)); + PHYDM_DBG(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) - ODM_RT_TRACE(p_dm_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)); + PHYDM_DBG(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) - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] Fast_RA (( UP )) ((rate Down Hold)) RA_CNT=((%d))\n", content_1)); + PHYDM_DBG(dm, DBG_FW_TRACE, + "[FW] Fast_RA (( UP )) ((rate Down Hold)) RA_CNT=((%d))\n", + content_1); else if (content_0 == 4) - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] Fast_RA (( UP )) ((tota_accl<5 skip)) RA_CNT=((%d))\n", content_1)); + PHYDM_DBG(dm, DBG_FW_TRACE, + "[FW] Fast_RA (( UP )) ((tota_accl<5 skip)) RA_CNT=((%d))\n", + content_1); else if (content_0 == 8) - ODM_RT_TRACE(p_dm_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(p_dm_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(p_dm_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(p_dm_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) { + PHYDM_DBG(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(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(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(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) - ODM_RT_TRACE(p_dm_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)); + PHYDM_DBG(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) - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] ((DOWN)) Nsc=(( %d )), N_Low=(( %d ))\n", content_1, content_2)); + PHYDM_DBG(dm, DBG_FW_TRACE, + "[FW] ((DOWN)) Nsc=(( %d )), N_Low=(( %d ))\n", + content_1, content_2); else if (content_0 == 3) - ODM_RT_TRACE(p_dm_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)); + PHYDM_DBG(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) - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] ((AP RPT)) macid=((%d)), BUPDATE[macid]=((%d))\n", content_1, content_2)); + PHYDM_DBG(dm, DBG_FW_TRACE, + "[FW] ((AP RPT)) macid=((%d)), BUPDATE[macid]=((%d))\n", + content_1, content_2); else if (content_0 == 4) - ODM_RT_TRACE(p_dm_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)); + PHYDM_DBG(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) - ODM_RT_TRACE(p_dm_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)); + PHYDM_DBG(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) { + } else if (function == INIT_RA_TABLE) { if (dbg_num == 3) - ODM_RT_TRACE(p_dm_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) { + PHYDM_DBG(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) - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][RateUp] ((Highest rate->return)), macid=((%d)) Nsc=((%d))\n", content_1, content_2)); + PHYDM_DBG(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) - ODM_RT_TRACE(p_dm_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)); + PHYDM_DBG(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) - ODM_RT_TRACE(p_dm_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)); + PHYDM_DBG(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) { + } else if (function == RATE_DOWN) { if (dbg_num == 5) { if (content_0 == 1) - ODM_RT_TRACE(p_dm_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)); + PHYDM_DBG(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) { - ODM_RT_TRACE(p_dm_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(p_dm_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(p_dm_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(p_dm_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(p_dm_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(p_dm_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(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][AP RPT] ((1)), SPE_STATIS=((0x%x))---------->\n", content_3)); + PHYDM_DBG(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) - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][AP RPT] RTY_all=((%d))\n", content_1)); + PHYDM_DBG(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(dm, DBG_FW_TRACE, + "[FW][H2C=0x49] fw_trace_en=((%d)), mode =((%d)), macid=((%d))\n", + content_1, content_2, content_3); + } + } else if (function == F_RATE_AP_RPT) { + if (dbg_num == 1) { + if (content_0 == 1) + PHYDM_DBG(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(dm, DBG_FW_TRACE, + "[FW][AP RPT] RTY_all=((%d))\n", + content_1); } else if (dbg_num == 3) { if (content_0 == 1) - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][AP RPT] MACID1[%d], TOTAL=((%d)), RTY=((%d))\n", content_3, content_1, content_2)); + PHYDM_DBG(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) - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][AP RPT] MACID2[%d], TOTAL=((%d)), RTY=((%d))\n", content_3, content_1, content_2)); + PHYDM_DBG(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) - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][AP RPT] MACID1[%d], PASS=((%d)), DROP=((%d))\n", content_3, content_1, content_2)); + PHYDM_DBG(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) - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][AP RPT] MACID2[%d],, PASS=((%d)), DROP=((%d))\n", content_3, content_1, content_2)); + PHYDM_DBG(dm, DBG_FW_TRACE, + "[FW][AP RPT] MACID2[%d],, PASS=((%d)), DROP=((%d))\n", + content_3, content_1, content_2); } + } else if (function == DBC_FW_CLM) { + PHYDM_DBG(dm, DBG_FW_TRACE, + "[FW][CLM][%d, %d] = {%d, %d, %d, %d}\n", dbg_num, + content_0, content_1, content_2, content_3, + content_4); } else { - ODM_RT_TRACE(p_dm_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)); - /**/ + PHYDM_DBG(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 - ODM_RT_TRACE(p_dm_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)); + PHYDM_DBG(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 /*#if CONFIG_PHYDM_DEBUG_FUNCTION*/ +#endif /*@#ifdef CONFIG_PHYDM_DEBUG_FUNCTION*/ } -void -phydm_fw_trace_handler_8051( - void *p_dm_void, - u8 *buffer, - u8 cmd_len -) +void phydm_fw_trace_handler_8051(void *dm_void, u8 *buffer, u8 cmd_len) { -#if CONFIG_PHYDM_DEBUG_FUNCTION - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; +#ifdef CONFIG_PHYDM_DEBUG_FUNCTION + struct dm_struct *dm = (struct dm_struct *)dm_void; #if 0 if (cmd_len >= 3) cmd_buf[cmd_len - 1] = '\0'; - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW DBG Msg] %s\n", &(cmd_buf[3]))); + PHYDM_DBG(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; + u8 extend_c2h_sub_id = 0, extend_c2h_dbg_len = 0; + u8 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*/ + 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", @@ -3041,21 +5444,22 @@ phydm_fw_trace_handler_8051( RT_DISP(FC2H, C2H_Summary, ("[RTKFW, SEQ= %d] :", extend_c2h_dbg_seq)); #endif - for (; ; i++) { + 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'; - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW DBG Msg] %s", &(fw_debug_trace[0]))); + PHYDM_DBG(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'; - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW DBG Msg] %s", &(fw_debug_trace[0]))); + PHYDM_DBG(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 /*#if CONFIG_PHYDM_DEBUG_FUNCTION*/ +#endif /*@#ifdef CONFIG_PHYDM_DEBUG_FUNCTION*/ } diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_debug.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_debug.h index e81a2cfda669..af7d2000f007 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_debug.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_debug.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,140 +9,101 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ - -#ifndef __ODM_DBG_H__ +#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 +/*@#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 DEBUG_VERSION "2.0" /*@2018.01.10 Dino*/ -/* - * 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 +/*@ + * ============================================================ + * Definition + * ============================================================ + */ -/* - * Abnormal, rare, or unexpeted cases. - * For example, IRP/Packet/OID canceled, device suprisely unremoved and so on. - * */ -#define ODM_DBG_WARNING 3 +/*@FW DBG MSG*/ +#define RATE_DECISION 1 +#define INIT_RA_TABLE 2 +#define RATE_UP 4 +#define RATE_DOWN 8 +#define TRY_DONE 16 +#define RA_H2C 32 +#define F_RATE_AP_RPT 64 +#define DBC_FW_CLM 9 -/* - * 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 PHYDM_SNPRINT_SIZE 64 +/* @---------------------------------------------------------------------------- * 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_PHY_CONFIG BIT(3) + * 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---------------------------*/ -/*BB Driver Functions*/ -#define ODM_COMP_DIG BIT(0) -#define ODM_COMP_RA_MASK BIT(1) -#define ODM_COMP_DYNAMIC_TXPWR BIT(2) -#define ODM_COMP_FA_CNT BIT(3) -#define ODM_COMP_RSSI_MONITOR BIT(4) -#define ODM_COMP_SNIFFER BIT(5) -#define ODM_COMP_ANT_DIV BIT(6) -#define ODM_COMP_DFS BIT(7) -#define ODM_COMP_NOISY_DETECT BIT(8) -#define ODM_COMP_RATE_ADAPTIVE BIT(9) -#define ODM_COMP_PATH_DIV BIT(10) -#define ODM_COMP_CCX BIT(11) - -#define ODM_COMP_DYNAMIC_PRICCA BIT(12) -/*BIT13 TBD*/ -#define ODM_COMP_MP BIT(14) -#define ODM_COMP_CFO_TRACKING BIT(15) -#define ODM_COMP_ACS BIT(16) -#define PHYDM_COMP_ADAPTIVITY BIT(17) -#define PHYDM_COMP_RA_DBG BIT(18) -#define PHYDM_COMP_TXBF BIT(19) -/* MAC Functions */ -#define ODM_COMP_EDCA_TURBO BIT(20) -#define ODM_COMP_DYNAMIC_RX_PATH BIT(21) -#define ODM_FW_DEBUG_TRACE BIT(22) -/* RF Functions */ -/*BIT23 TBD*/ -#define ODM_COMP_TX_PWR_TRACK BIT(24) -/*BIT25 TBD*/ -#define ODM_COMP_CALIBRATION BIT(26) -/* Common Functions */ -/*BIT27 TBD*/ -#define ODM_PHY_CONFIG BIT(28) -#define ODM_COMP_INIT BIT(29) -#define ODM_COMP_COMMON BIT(30) -#define ODM_COMP_API BIT(31) - - -/*------------------------Export Marco Definition---------------------------*/ - -#define config_phydm_read_txagc_check(data) (data != INVALID_TXAGC_DATA) +#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 + #if (DBG_CMD_SUPPORT == 1) + extern VOID DCMD_Printf(const char *pMsg); + #else + #define DCMD_Printf(_pMsg) + #endif + + #if OS_WIN_FROM_WIN10(OS_VERSION) + #define pr_debug(fmt, ...) DbgPrintEx(DPFLTR_IHVNETWORK_ID, DPFLTR_ERROR_LEVEL, fmt, ##__VA_ARGS__) + #else + #define pr_debug DbgPrint + #endif + + #define dcmd_printf DCMD_Printf + #define dcmd_scanf DCMD_Scanf + #define RT_PRINTK pr_debug + #define PRINT_MAX_SIZE 512 + #define PHYDM_SNPRINTF RT_SPRINTF + #define PHYDM_TRACE(_MSG_) EXhalPHYDMoutsrc_Print(_MSG_) +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) + #define PHYDM_SNPRINTF snprintf #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - #define dbg_print printk - #define RT_PRINTK(fmt, args...) dbg_print("%s(): " fmt, __FUNCTION__, ## args); + #undef pr_debug + #define pr_debug printk + #define RT_PRINTK(fmt, args...) pr_debug(fmt, ## args) #define RT_DISP(dbgtype, dbgflag, printstr) + #define RT_TRACE(adapter, comp, drv_level, fmt, args...) \ + RTW_INFO(fmt, ## args) + #define PHYDM_SNPRINTF snprintf +#elif (DM_ODM_SUPPORT_TYPE == ODM_IOT) + #define pr_debug(fmt, args...) RTW_PRINT_MSG(fmt, ## args) + #define RT_DEBUG(comp, drv_level, fmt, args...) \ + RTW_PRINT_MSG(fmt, ## args) + #define PHYDM_SNPRINTF snprintf #else - #define dbg_print panic_printk - #define RT_PRINTK(fmt, args...) dbg_print("%s(): " fmt, __FUNCTION__, ## args); + #define pr_debug panic_printk + /*@#define RT_PRINTK(fmt, args...) pr_debug("%s(): " fmt, __FUNCTION__, ## args);*/ + #define RT_PRINTK(fmt, args...) pr_debug(fmt, ## args) + #define PHYDM_SNPRINTF snprintf #endif #ifndef ASSERT @@ -149,211 +111,373 @@ #endif #if DBG -#define ODM_RT_TRACE(p_dm_odm, comp, level, fmt) \ - do { \ - if (((comp) & p_dm_odm->debug_components) && (level <= p_dm_odm->debug_level || level == ODM_DBG_SERIOUS)) { \ - \ - if (p_dm_odm->support_ic_type == ODM_RTL8188E) \ - dbg_print("[PhyDM-8188E] "); \ - else if (p_dm_odm->support_ic_type == ODM_RTL8192E) \ - dbg_print("[PhyDM-8192E] "); \ - else if (p_dm_odm->support_ic_type == ODM_RTL8812) \ - dbg_print("[PhyDM-8812A] "); \ - else if (p_dm_odm->support_ic_type == ODM_RTL8821) \ - dbg_print("[PhyDM-8821A] "); \ - else if (p_dm_odm->support_ic_type == ODM_RTL8814A) \ - dbg_print("[PhyDM-8814A] "); \ - else if (p_dm_odm->support_ic_type == ODM_RTL8703B) \ - dbg_print("[PhyDM-8703B] "); \ - else if (p_dm_odm->support_ic_type == ODM_RTL8822B) \ - dbg_print("[PhyDM-8822B] "); \ - else if (p_dm_odm->support_ic_type == ODM_RTL8188F) \ - dbg_print("[PhyDM-8188F] "); \ - RT_PRINTK fmt; \ +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) +#define PHYDM_DBG(dm, comp, fmt, args...) \ + do { \ + if ((comp) & dm->debug_components) { \ + pr_debug("[PHYDM] "); \ + RT_PRINTK(fmt, ## args); \ + } \ + } while (0) + +#define PHYDM_DBG_F(dm, comp, fmt, args...) \ + do { \ + if ((comp) & dm->debug_components) { \ + RT_PRINTK(fmt, ## args); \ + } \ + } while (0) + +#define PHYDM_PRINT_ADDR(dm, comp, title_str, addr) \ + do { \ + if ((comp) & dm->debug_components) { \ + int __i; \ + u8 *__ptr = (u8 *)addr; \ + pr_debug("[PHYDM] "); \ + pr_debug(title_str); \ + pr_debug(" "); \ + for (__i = 0; __i < 6; __i++) \ + pr_debug("%02X%s", __ptr[__i], (__i == 5) ? "" : "-");\ + pr_debug("\n"); \ + } \ + } while (0) +#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) + +static __inline void PHYDM_DBG(PDM_ODM_T dm, int comp, char *fmt, ...) +{ + RT_STATUS rt_status; + va_list args; + char buf[PRINT_MAX_SIZE] = {0}; + + if ((comp & dm->debug_components) == 0) + return; + + if (fmt == NULL) + return; + + va_start(args, fmt); + rt_status = (RT_STATUS)RtlStringCbVPrintfA(buf, PRINT_MAX_SIZE, fmt, args); + va_end(args); + + if (rt_status != RT_STATUS_SUCCESS) { + DbgPrint("Failed (%d) to print message to buffer\n", rt_status); + return; + } + + #if OS_WIN_FROM_WIN10(OS_VERSION) + DbgPrintEx(DPFLTR_IHVNETWORK_ID, DPFLTR_ERROR_LEVEL, "%s", buf); + #else + DbgPrint("%s", buf); + #endif +} + +static __inline void PHYDM_DBG_F(PDM_ODM_T dm, int comp, char *fmt, ...) +{ + RT_STATUS rt_status; + va_list args; + char buf[PRINT_MAX_SIZE] = {0}; + + if ((comp & dm->debug_components) == 0) + return; + + if (fmt == NULL) + return; + + va_start(args, fmt); + rt_status = (RT_STATUS)RtlStringCbVPrintfA(buf, PRINT_MAX_SIZE, fmt, args); + va_end(args); + + if (rt_status != RT_STATUS_SUCCESS) { + /*@DbgPrint("DM Print Fail\n");*/ + return; + } + + #if OS_WIN_FROM_WIN10(OS_VERSION) + DbgPrintEx(DPFLTR_IHVNETWORK_ID, DPFLTR_ERROR_LEVEL, "%s", buf); + #else + DbgPrint("%s", buf); + #endif +} + +#define PHYDM_PRINT_ADDR(p_dm, comp, title_str, ptr) \ + do { \ + if ((comp) & p_dm->debug_components) { \ + \ + int __i; \ + u8 *__ptr = (u8 *)ptr; \ + pr_debug("[PHYDM] "); \ + pr_debug(title_str); \ + pr_debug(" "); \ + for (__i = 0; __i < 6; __i++) \ + pr_debug("%02X%s", __ptr[__i], (__i == 5) ? "" : "-"); \ + pr_debug("\n"); \ + } \ + } while (0) +#elif (DM_ODM_SUPPORT_TYPE == ODM_IOT) + +#define PHYDM_DBG(dm, comp, fmt, args...) \ + do { \ + if ((comp) & dm->debug_components) { \ + RT_DEBUG(COMP_PHYDM, \ + DBG_DMESG, "[PHYDM] " fmt, ##args); \ + } \ + } while (0) + +#define PHYDM_DBG_F(dm, comp, fmt, args...) \ + do { \ + if ((comp) & dm->debug_components) { \ + RT_DEBUG(COMP_PHYDM, \ + DBG_DMESG, fmt, ##args); \ } \ } while (0) -#define ODM_RT_TRACE_F(p_dm_odm, comp, level, fmt) do {\ - if (((comp) & p_dm_odm->debug_components) && (level <= p_dm_odm->debug_level)) { \ - \ - RT_PRINTK fmt; \ - } \ +#define PHYDM_PRINT_ADDR(dm, comp, title_str, addr) \ + do { \ + if ((comp) & dm->debug_components) { \ + RT_DEBUG(COMP_PHYDM, \ + DBG_DMESG, "[PHYDM] " title_str "%pM\n", \ + addr); \ + } \ } while (0) +#elif defined(DM_ODM_CE_MAC80211_V2) -#define ODM_RT_ASSERT(p_dm_odm, expr, fmt) do {\ - if (!(expr)) { \ - dbg_print("Assertion failed! %s at ......\n", #expr); \ - dbg_print(" ......%s,%s, line=%d\n", __FILE__, __FUNCTION__, __LINE__); \ - RT_PRINTK fmt; \ - ASSERT(false); \ - } \ - } while (0) - -#define ODM_dbg_enter() { dbg_print(" == > %s\n", __FUNCTION__); } -#define ODM_dbg_exit() { dbg_print("< == %s\n", __FUNCTION__); } -#define ODM_dbg_trace(str) { dbg_print("%s:%s\n", __FUNCTION__, str); } - -#define ODM_PRINT_ADDR(p_dm_odm, comp, level, title_str, ptr) do {\ - if (((comp) & p_dm_odm->debug_components) && (level <= p_dm_odm->debug_level)) { \ - \ - int __i; \ - u8 *__ptr = (u8 *)ptr; \ - dbg_print("[ODM] "); \ - 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 PHYDM_DBG(dm, comp, fmt, args...) +#define PHYDM_DBG_F(dm, comp, fmt, args...) +#define PHYDM_PRINT_ADDR(dm, comp, title_str, addr) #else -#define ODM_RT_TRACE(p_dm_odm, comp, level, fmt) -#define ODM_RT_TRACE_F(p_dm_odm, comp, level, fmt) -#define ODM_RT_ASSERT(p_dm_odm, expr, fmt) -#define ODM_dbg_enter() -#define ODM_dbg_exit() -#define ODM_dbg_trace(str) -#define ODM_PRINT_ADDR(p_dm_odm, comp, level, title_str, ptr) + +#define PHYDM_DBG(dm, comp, fmt, args...) \ + do { \ + struct dm_struct *__dm = (dm); \ + if ((comp) & __dm->debug_components) { \ + RT_TRACE(((struct rtl_priv *)__dm->adapter),\ + COMP_PHYDM, DBG_DMESG, \ + "[PHYDM] " fmt, ##args); \ + } \ + } while (0) + +#define PHYDM_DBG_F(dm, comp, fmt, args...) \ + do { \ + struct dm_struct *__dm = (dm); \ + if ((comp) & __dm->debug_components) { \ + RT_TRACE(((struct rtl_priv *)__dm->adapter),\ + COMP_PHYDM, DBG_DMESG, fmt, ##args); \ + } \ + } while (0) + +#define PHYDM_PRINT_ADDR(dm, comp, title_str, addr) \ + do { \ + struct dm_struct *__dm = (dm); \ + if ((comp) & __dm->debug_components) { \ + RT_TRACE(((struct rtl_priv *)__dm->adapter),\ + COMP_PHYDM, DBG_DMESG, \ + "[PHYDM] " title_str "%pM\n", addr);\ + } \ + } while (0) #endif +#else /*@#if DBG*/ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +static __inline void PHYDM_DBG(struct dm_struct *dm, int comp, char *fmt, ...) +{ + RT_STATUS rt_status; + va_list args; + char buf[PRINT_MAX_SIZE] = {0}; -void -phydm_init_debug_setting(struct PHY_DM_STRUCT *p_dm_odm); + if ((comp & dm->debug_components) == 0) + return; -void phydm_basic_dbg_message(void *p_dm_void); + if (fmt == NULL) + return; + + va_start(args, fmt); + rt_status = (RT_STATUS)RtlStringCbVPrintfA(buf, PRINT_MAX_SIZE, fmt, args); + va_end(args); + + if (rt_status != RT_STATUS_SUCCESS) { + DbgPrint("Failed (%d) to print message to buffer\n", rt_status); + return; + } + + PHYDM_TRACE(buf); +} +static __inline void PHYDM_DBG_F(struct dm_struct *dm, int comp, char *fmt, ...) +{ +} +#else +#define PHYDM_DBG(dm, comp, fmt, args...) +#define PHYDM_DBG_F(dm, comp, fmt, args...) +#endif +#define PHYDM_PRINT_ADDR(dm, comp, title_str, ptr) + +#endif + +#define DBGPORT_PRI_3 3 /*@Debug function (the highest priority)*/ +#define DBGPORT_PRI_2 2 /*@Check hang function & Strong function*/ +#define DBGPORT_PRI_1 1 /*Watch dog function*/ +#define 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 +#define PDM_VAST_SNPF PDM_SNPF #if (PHYDM_DBGPRINT == 1) -#define PHYDM_SNPRINTF(msg) \ +#define PDM_SNPF(msg) \ do {\ rsprintf msg;\ - dbg_print(output);\ + pr_debug("%s", 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" + +static __inline void PDM_SNPF(u32 out_len, u32 used, char *buff, int len, + char *fmt, ...) +{ + RT_STATUS rt_status; + va_list args; + char buf[PRINT_MAX_SIZE] = {0}; + + if (fmt == NULL) + return; + + va_start(args, fmt); + rt_status = (RT_STATUS)RtlStringCbVPrintfA(buf, PRINT_MAX_SIZE, fmt, args); + va_end(args); + + if (rt_status != RT_STATUS_SUCCESS) { + /*@DbgPrint("DM Print Fail\n");*/ + return; + } + + DCMD_Printf(buf); +} + + + +#endif /*@#if (PHYDM_DBGPRINT == 1)*/ +#else /*@(DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_AP))*/ + #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);\ +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) +#define PDM_VAST_SNPF(out_len, used, buff, len, fmt, args...) RT_PRINTK(fmt, ## args) + +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) +#define PDM_VAST_SNPF(out_len, used, buff, len, fmt, args...) \ + do { \ + RT_DEBUG(COMP_PHYDM, DBG_DMESG, fmt, ##args); \ } while (0) +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) +#define PDM_VAST_SNPF(out_len, used, buff, len, fmt, args...) +#else +#define PDM_VAST_SNPF(out_len, used, buff, len, fmt, args...) \ + RT_TRACE(((struct rtl_priv *)dm->adapter), COMP_PHYDM, \ + DBG_DMESG, fmt, ##args) +#endif #if (PHYDM_DBGPRINT == 1) -#define PHYDM_SNPRINTF(msg)\ - do {\ - snprintf msg;\ - dbg_print(output);\ +#define PDM_SNPF(out_len, used, buff, len, fmt, args...) \ + do { \ + snprintf(buff, len, fmt, ##args); \ + pr_debug("%s", output); \ } while (0) #else -#define PHYDM_SNPRINTF(msg)\ - do {\ - if (out_len > used)\ - used += snprintf msg;\ +#define PDM_SNPF(out_len, used, buff, len, fmt, args...) \ + do { \ + u32 *__pdm_snpf_u = &(used); \ + if (out_len > *__pdm_snpf_u) \ + *__pdm_snpf_u += snprintf(buff, len, fmt, ##args);\ } while (0) #endif #endif +/* @1 ============================================================ + * 1 enumeration + * 1 ============================================================ + */ +enum auto_detection_state { /*@Fast antenna training*/ + AD_LEGACY_MODE = 0, + AD_HT_MODE = 1, + AD_VHT_MODE = 2 +}; -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_odm, - char *input, - u32 in_len, - u8 flag, - char *output, - u32 out_len -); +/*@ + * ============================================================ + * 1 structure + * ============================================================ + */ + +#ifdef CONFIG_PHYDM_DEBUG_FUNCTION +u8 phydm_get_l_sig_rate(void *dm_void, u8 rate_idx_l_sig); #endif -void -phydm_cmd_parser( - struct PHY_DM_STRUCT *p_dm_odm, - char input[][16], - u32 input_num, - u8 flag, - char *output, - u32 out_len -); -bool -phydm_api_trx_mode( - struct PHY_DM_STRUCT *p_dm_odm, - enum odm_rf_path_e tx_path, - enum odm_rf_path_e rx_path, - bool is_tx2_path -); +void phydm_init_debug_setting(struct dm_struct *dm); + +void phydm_bb_dbg_port_header_sel(void *dm_void, u32 header_idx); + +u32 phydm_get_bb_dbg_port_idx(void *dm_void); + +u8 phydm_set_bb_dbg_port(void *dm_void, u8 curr_dbg_priority, u32 debug_port); + +void phydm_release_bb_dbg_port(void *dm_void); + +u32 phydm_get_bb_dbg_port_val(void *dm_void); + +void phydm_reset_rx_rate_distribution(struct dm_struct *dm); + +void phydm_rx_rate_distribution(void *dm_void); + +u16 phydm_rx_avg_phy_rate(void *dm_void); + +void phydm_show_phy_hitogram(void *dm_void); + +void phydm_get_avg_phystatus_val(void *dm_void); + +void phydm_get_phy_statistic(void *dm_void); + +void phydm_dm_summary(void *dm_void, u8 macid); + +void phydm_basic_dbg_message(void *dm_void); + +void phydm_basic_profile(void *dm_void, u32 *_used, char *output, + u32 *_out_len); +#if (DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_AP)) +s32 phydm_cmd(struct dm_struct *dm, char *input, u32 in_len, u8 flag, + char *output, u32 out_len); +#endif +void phydm_cmd_parser(struct dm_struct *dm, char input[][16], u32 input_num, + u8 flag, char *output, u32 out_len); #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +void phydm_basic_dbg_msg_cli_win(void *dm_void, char *buf); + void phydm_sbd_check( - struct PHY_DM_STRUCT *p_dm_odm -); + struct dm_struct *dm); void phydm_sbd_callback( - struct timer_list *p_timer -); + struct phydm_timer_list *timer); void phydm_sbd_workitem_callback( - void *p_context -); + void *context); #endif -void -phydm_fw_trace_en_h2c( - void *p_dm_void, - bool enable, - u32 fw_debug_component, - u32 monitor_mode, - u32 macid -); +void phydm_fw_trace_en_h2c(void *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(void *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_code(void *dm_void, u8 *buffer, u8 cmd_len); -void -phydm_fw_trace_handler_8051( - void *p_dm_void, - u8 *cmd_buf, - u8 cmd_len -); +void phydm_fw_trace_handler_8051(void *dm_void, u8 *cmd_buf, u8 cmd_len); -#endif /* __ODM_DBG_H__ */ +#endif /* @__ODM_DBG_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dfs.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dfs.c index 68b3b364fbc7..c0a0a2334e49 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dfs.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dfs.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,250 +9,2437 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ -/* -============================================================ - include files -============================================================ -*/ +/*@ + * ============================================================ + * include files + * ============================================================ + */ #include "mp_precomp.h" #include "phydm_precomp.h" #if defined(CONFIG_PHYDM_DFS_MASTER) -void phydm_radar_detect_reset(void *p_dm_void) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - odm_set_bb_reg(p_dm_odm, 0x924, BIT(15), 0); - odm_set_bb_reg(p_dm_odm, 0x924, BIT(15), 1); +boolean phydm_dfs_is_meteorology_channel(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + u8 ch = *dm->channel; + u8 bw = *dm->band_width; + + return ((bw == CHANNEL_WIDTH_80 && (ch) >= 116 && (ch) <= 128) || + (bw == CHANNEL_WIDTH_40 && (ch) >= 116 && (ch) <= 128) || + (bw == CHANNEL_WIDTH_20 && (ch) >= 120 && (ch) <= 128)); } -void phydm_radar_detect_disable(void *p_dm_void) +void phydm_dfs_segment_distinguish(void *dm_void, enum rf_syn syn_path) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; - odm_set_bb_reg(p_dm_odm, 0x924, BIT(15), 0); -} - -static void phydm_radar_detect_with_dbg_parm(void *p_dm_void) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - - odm_set_bb_reg(p_dm_odm, 0x918, MASKDWORD, p_dm_odm->radar_detect_reg_918); - odm_set_bb_reg(p_dm_odm, 0x91c, MASKDWORD, p_dm_odm->radar_detect_reg_91c); - odm_set_bb_reg(p_dm_odm, 0x920, MASKDWORD, p_dm_odm->radar_detect_reg_920); - odm_set_bb_reg(p_dm_odm, 0x924, MASKDWORD, p_dm_odm->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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 region_domain = p_dm_odm->dfs_region_domain; - u8 c_channel = *(p_dm_odm->p_channel); - - if (region_domain == PHYDM_DFS_DOMAIN_UNKNOWN) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DFS, ODM_DBG_LOUD, ("PHYDM_DFS_DOMAIN_UNKNOWN\n")); + if (!(dm->support_ic_type & (ODM_RTL8814B))) return; + if (syn_path == RF_SYN1) + dm->seg1_dfs_flag = 1; + else + dm->seg1_dfs_flag = 0; +} + +void phydm_dfs_segment_flag_reset(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (!(dm->support_ic_type & (ODM_RTL8814B))) + return; + if (dm->seg1_dfs_flag) + dm->seg1_dfs_flag = 0; +} + +void phydm_radar_detect_reset(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (dm->support_ic_type & (ODM_RTL8198F | ODM_RTL8822C | ODM_RTL8812F | + ODM_RTL8197G)) { + odm_set_bb_reg(dm, R_0xa40, BIT(15), 0); + odm_set_bb_reg(dm, R_0xa40, BIT(15), 1); + #if (RTL8721D_SUPPORT) + } else if (dm->support_ic_type & (ODM_RTL8721D)) { + odm_set_bb_reg(dm, R_0xf58, BIT(29), 0); + odm_set_bb_reg(dm, R_0xf58, BIT(29), 1); + #endif + } else if (dm->support_ic_type & (ODM_RTL8814B)) { + if (dm->seg1_dfs_flag == 1) { + odm_set_bb_reg(dm, R_0xa6c, BIT(0), 0); + odm_set_bb_reg(dm, R_0xa6c, BIT(0), 1); + return; + } + odm_set_bb_reg(dm, R_0xa40, BIT(15), 0); + odm_set_bb_reg(dm, R_0xa40, BIT(15), 1); + } else { + odm_set_bb_reg(dm, R_0x924, BIT(15), 0); + odm_set_bb_reg(dm, R_0x924, BIT(15), 1); + } +} + +void phydm_radar_detect_disable(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (dm->support_ic_type & (ODM_RTL8198F | ODM_RTL8822C | ODM_RTL8812F | + ODM_RTL8197G)) + odm_set_bb_reg(dm, R_0xa40, BIT(15), 0); + else if (dm->support_ic_type & (ODM_RTL8814B)) { + if (dm->seg1_dfs_flag == 1) { + odm_set_bb_reg(dm, R_0xa6c, BIT(0), 0); + dm->seg1_dfs_flag = 0; + return; + } + odm_set_bb_reg(dm, R_0xa40, BIT(15), 0); + } + #if (RTL8721D_SUPPORT) + else if (dm->support_ic_type & (ODM_RTL8721D)) + odm_set_bb_reg(dm, R_0xf58, BIT(29), 0); + #endif + else + odm_set_bb_reg(dm, R_0x924, BIT(15), 0); + + PHYDM_DBG(dm, DBG_DFS, "\n"); +} + +static void phydm_radar_detect_with_dbg_parm(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (dm->support_ic_type & ODM_RTL8721D) { + odm_set_bb_reg(dm, R_0xf54, MASKDWORD, + dm->radar_detect_reg_f54); + odm_set_bb_reg(dm, R_0xf58, MASKDWORD, + dm->radar_detect_reg_f58); + odm_set_bb_reg(dm, R_0xf5c, MASKDWORD, + dm->radar_detect_reg_f5c); + odm_set_bb_reg(dm, R_0xf70, MASKDWORD, + dm->radar_detect_reg_f70); + odm_set_bb_reg(dm, R_0xf74, MASKDWORD, + dm->radar_detect_reg_f74); + } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + odm_set_bb_reg(dm, R_0xa40, MASKDWORD, + dm->radar_detect_reg_a40); + odm_set_bb_reg(dm, R_0xa44, MASKDWORD, + dm->radar_detect_reg_a44); + odm_set_bb_reg(dm, R_0xa48, MASKDWORD, + dm->radar_detect_reg_a48); + odm_set_bb_reg(dm, R_0xa4c, MASKDWORD, + dm->radar_detect_reg_a4c); + odm_set_bb_reg(dm, R_0xa50, MASKDWORD, + dm->radar_detect_reg_a50); + odm_set_bb_reg(dm, R_0xa54, MASKDWORD, + dm->radar_detect_reg_a54); + } else { + odm_set_bb_reg(dm, R_0x918, MASKDWORD, + dm->radar_detect_reg_918); + odm_set_bb_reg(dm, R_0x91c, MASKDWORD, + dm->radar_detect_reg_91c); + odm_set_bb_reg(dm, R_0x920, MASKDWORD, + dm->radar_detect_reg_920); + odm_set_bb_reg(dm, R_0x924, MASKDWORD, + dm->radar_detect_reg_924); + } +} + +/* @Init radar detection parameters, called after ch, bw is set */ + +void phydm_radar_detect_enable(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _DFS_STATISTICS *dfs = &dm->dfs; + u8 region_domain = dm->dfs_region_domain; + u8 c_channel = *dm->channel; + u8 band_width = *dm->band_width; + u8 enable = 0, i; + u8 short_pw_upperbound = 0; + + PHYDM_DBG(dm, DBG_DFS, "test, region_domain = %d\n", region_domain); + if (region_domain == PHYDM_DFS_DOMAIN_UNKNOWN) { + PHYDM_DBG(dm, DBG_DFS, "PHYDM_DFS_DOMAIN_UNKNOWN\n"); + goto exit; } - if (p_dm_odm->support_ic_type & (ODM_RTL8821 | ODM_RTL8812 | ODM_RTL8881A)) { + if (dm->support_ic_type & (ODM_RTL8821 | ODM_RTL8812 | ODM_RTL8881A)) { + odm_set_bb_reg(dm, R_0x814, 0x3fffffff, 0x04cc4d10); + odm_set_bb_reg(dm, R_0x834, MASKBYTE0, 0x06); - odm_set_bb_reg(p_dm_odm, 0x814, 0x3fffffff, 0x04cc4d10); - odm_set_bb_reg(p_dm_odm, 0x834, MASKBYTE0, 0x06); - - if (p_dm_odm->radar_detect_dbg_parm_en) { - phydm_radar_detect_with_dbg_parm(p_dm_odm); + if (dm->radar_detect_dbg_parm_en) { + phydm_radar_detect_with_dbg_parm(dm); + enable = 1; goto exit; } if (region_domain == PHYDM_DFS_DOMAIN_ETSI) { - odm_set_bb_reg(p_dm_odm, 0x918, MASKDWORD, 0x1c17ecdf); - odm_set_bb_reg(p_dm_odm, 0x924, MASKDWORD, 0x01528500); - odm_set_bb_reg(p_dm_odm, 0x91c, MASKDWORD, 0x0fa21a20); - odm_set_bb_reg(p_dm_odm, 0x920, MASKDWORD, 0xe0f69204); + odm_set_bb_reg(dm, R_0x918, MASKDWORD, 0x1c17ecdf); + odm_set_bb_reg(dm, R_0x924, MASKDWORD, 0x01528500); + odm_set_bb_reg(dm, R_0x91c, MASKDWORD, 0x0fa21a20); + odm_set_bb_reg(dm, R_0x920, MASKDWORD, 0xe0f69204); } else if (region_domain == PHYDM_DFS_DOMAIN_MKK) { - odm_set_bb_reg(p_dm_odm, 0x924, MASKDWORD, 0x01528500); - odm_set_bb_reg(p_dm_odm, 0x920, MASKDWORD, 0xe0d67234); + odm_set_bb_reg(dm, R_0x924, MASKDWORD, 0x01528500); + odm_set_bb_reg(dm, R_0x920, MASKDWORD, 0xe0d67234); if (c_channel >= 52 && c_channel <= 64) { - odm_set_bb_reg(p_dm_odm, 0x918, MASKDWORD, 0x1c16ecdf); - odm_set_bb_reg(p_dm_odm, 0x91c, MASKDWORD, 0x0f141a20); + odm_set_bb_reg(dm, R_0x918, MASKDWORD, + 0x1c16ecdf); + odm_set_bb_reg(dm, R_0x91c, MASKDWORD, + 0x0f141a20); } else { - odm_set_bb_reg(p_dm_odm, 0x918, MASKDWORD, 0x1c16acdf); - if (p_dm_odm->p_band_width == ODM_BW20M) - odm_set_bb_reg(p_dm_odm, 0x91c, MASKDWORD, 0x64721a20); + odm_set_bb_reg(dm, R_0x918, MASKDWORD, + 0x1c16acdf); + if (band_width == CHANNEL_WIDTH_20) + odm_set_bb_reg(dm, R_0x91c, MASKDWORD, + 0x64721a20); else - odm_set_bb_reg(p_dm_odm, 0x91c, MASKDWORD, 0x68721a20); + odm_set_bb_reg(dm, R_0x91c, MASKDWORD, + 0x68721a20); } } else if (region_domain == PHYDM_DFS_DOMAIN_FCC) { - odm_set_bb_reg(p_dm_odm, 0x918, MASKDWORD, 0x1c16acdf); - odm_set_bb_reg(p_dm_odm, 0x924, MASKDWORD, 0x01528500); - odm_set_bb_reg(p_dm_odm, 0x920, MASKDWORD, 0xe0d67231); - if (p_dm_odm->p_band_width == ODM_BW20M) - odm_set_bb_reg(p_dm_odm, 0x91c, MASKDWORD, 0x64741a20); + odm_set_bb_reg(dm, R_0x918, MASKDWORD, 0x1c16acdf); + odm_set_bb_reg(dm, R_0x924, MASKDWORD, 0x01528500); + odm_set_bb_reg(dm, R_0x920, MASKDWORD, 0xe0d67231); + if (band_width == CHANNEL_WIDTH_20) + odm_set_bb_reg(dm, R_0x91c, MASKDWORD, + 0x64741a20); else - odm_set_bb_reg(p_dm_odm, 0x91c, MASKDWORD, 0x68741a20); + odm_set_bb_reg(dm, R_0x91c, MASKDWORD, + 0x68741a20); + } else { /* not supported */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DFS, ODM_DBG_LOUD, ("Unsupported dfs_region_domain:%d\n", region_domain)); + PHYDM_DBG(dm, DBG_DFS, + "Unsupported dfs_region_domain:%d\n", + region_domain); + goto exit; } - } else if (p_dm_odm->support_ic_type & (ODM_RTL8814A | ODM_RTL8822B)) { + } else if (dm->support_ic_type & + (ODM_RTL8814A | ODM_RTL8822B | ODM_RTL8821C)) { - odm_set_bb_reg(p_dm_odm, 0x814, 0x3fffffff, 0x04cc4d10); - odm_set_bb_reg(p_dm_odm, 0x834, MASKBYTE0, 0x06); + odm_set_bb_reg(dm, R_0x814, 0x3fffffff, 0x04cc4d10); + odm_set_bb_reg(dm, R_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_odm->support_ic_type & ODM_RTL8822B) { - if (p_dm_odm->p_band_width == ODM_BW20M) - odm_set_bb_reg(p_dm_odm, 0x1984, BIT(26), 1); + /* @8822B only, when BW = 20M, DFIR output is 40Mhz, + * but DFS input is 80MMHz, so it need to upgrade to 80MHz + */ + if (dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8821C)) { + if (band_width == CHANNEL_WIDTH_20) + odm_set_bb_reg(dm, R_0x1984, BIT(26), 1); else - odm_set_bb_reg(p_dm_odm, 0x1984, BIT(26), 0); + odm_set_bb_reg(dm, R_0x1984, BIT(26), 0); } - if (p_dm_odm->radar_detect_dbg_parm_en) { - phydm_radar_detect_with_dbg_parm(p_dm_odm); + if (dm->radar_detect_dbg_parm_en) { + phydm_radar_detect_with_dbg_parm(dm); + enable = 1; goto exit; } if (region_domain == PHYDM_DFS_DOMAIN_ETSI) { - odm_set_bb_reg(p_dm_odm, 0x918, MASKDWORD, 0x1c16acdf); - odm_set_bb_reg(p_dm_odm, 0x924, MASKDWORD, 0x095a8500); - odm_set_bb_reg(p_dm_odm, 0x91c, MASKDWORD, 0x0fa21a20); - odm_set_bb_reg(p_dm_odm, 0x920, MASKDWORD, 0xe0f57204); + odm_set_bb_reg(dm, R_0x918, MASKDWORD, 0x1c16acdf); + odm_set_bb_reg(dm, R_0x924, MASKDWORD, 0x095a8500); + odm_set_bb_reg(dm, R_0x91c, MASKDWORD, 0x0fc01a1f); + odm_set_bb_reg(dm, R_0x920, MASKDWORD, 0xe0f57204); } else if (region_domain == PHYDM_DFS_DOMAIN_MKK) { - odm_set_bb_reg(p_dm_odm, 0x924, MASKDWORD, 0x095a8500); - odm_set_bb_reg(p_dm_odm, 0x920, MASKDWORD, 0xe0d67234); + odm_set_bb_reg(dm, R_0x924, MASKDWORD, 0x095a8500); + odm_set_bb_reg(dm, R_0x920, MASKDWORD, 0xe0d67234); if (c_channel >= 52 && c_channel <= 64) { - odm_set_bb_reg(p_dm_odm, 0x918, MASKDWORD, 0x1c16ecdf); - odm_set_bb_reg(p_dm_odm, 0x91c, MASKDWORD, 0x0f141a20); + odm_set_bb_reg(dm, R_0x918, MASKDWORD, + 0x1c16ecdf); + odm_set_bb_reg(dm, R_0x91c, MASKDWORD, + 0x0f141a1f); } else { - odm_set_bb_reg(p_dm_odm, 0x918, MASKDWORD, 0x1c166cdf); - if (p_dm_odm->p_band_width == ODM_BW20M) - odm_set_bb_reg(p_dm_odm, 0x91c, MASKDWORD, 0x64721a20); + odm_set_bb_reg(dm, R_0x918, MASKDWORD, + 0x1c166cdf); + if (band_width == CHANNEL_WIDTH_20) + odm_set_bb_reg(dm, R_0x91c, MASKDWORD, + 0x64721a1f); else - odm_set_bb_reg(p_dm_odm, 0x91c, MASKDWORD, 0x68721a20); + odm_set_bb_reg(dm, R_0x91c, MASKDWORD, + 0x68721a1f); } + } else if (region_domain == PHYDM_DFS_DOMAIN_FCC) { - odm_set_bb_reg(p_dm_odm, 0x918, MASKDWORD, 0x1c166cdf); - odm_set_bb_reg(p_dm_odm, 0x924, MASKDWORD, 0x095a8500); - odm_set_bb_reg(p_dm_odm, 0x920, MASKDWORD, 0xe0d67231); - if (p_dm_odm->p_band_width == ODM_BW20M) - odm_set_bb_reg(p_dm_odm, 0x91c, MASKDWORD, 0x64741a20); + odm_set_bb_reg(dm, R_0x918, MASKDWORD, 0x1c176cdf); + odm_set_bb_reg(dm, R_0x924, MASKDWORD, 0x095a8400); + odm_set_bb_reg(dm, R_0x920, MASKDWORD, 0xe076d231); + if (band_width == CHANNEL_WIDTH_20) + odm_set_bb_reg(dm, R_0x91c, MASKDWORD, + 0x64901a1f); else - odm_set_bb_reg(p_dm_odm, 0x91c, MASKDWORD, 0x68741a20); + odm_set_bb_reg(dm, R_0x91c, MASKDWORD, + 0x62901a1f); + } else { /* not supported */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DFS, ODM_DBG_LOUD, ("Unsupported dfs_region_domain:%d\n", region_domain)); + PHYDM_DBG(dm, DBG_DFS, + "Unsupported dfs_region_domain:%d\n", + region_domain); + goto exit; + } + /*RXHP low corner will extend the pulse width, + *so we need to increase the upper bound. + */ + if (dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8821C)) { + if (odm_get_bb_reg(dm, 0x8d8, + BIT28 | BIT27 | BIT26) == 0) { + short_pw_upperbound = + (u8)odm_get_bb_reg(dm, 0x91c, + BIT23 | BIT22 | + BIT21 | BIT20); + if ((short_pw_upperbound + 4) > 15) + odm_set_bb_reg(dm, 0x91c, + BIT23 | BIT22 | + BIT21 | BIT20, 15); + else + odm_set_bb_reg(dm, 0x91c, + BIT23 | BIT22 | + BIT21 | BIT20, + short_pw_upperbound + 4); + } + /*@if peak index -1~+1, use original NB method*/ + odm_set_bb_reg(dm, 0x19e4, 0x003C0000, 13); + odm_set_bb_reg(dm, 0x924, 0x70000, 0); + } + + if (dm->support_ic_type & (ODM_RTL8881A)) + odm_set_bb_reg(dm, 0xb00, 0xc0000000, 3); + + /*@for 8814 new dfs mechanism setting*/ + if (dm->support_ic_type & + (ODM_RTL8814A | ODM_RTL8822B | ODM_RTL8821C)) { + /*Turn off dfs scaling factor*/ + odm_set_bb_reg(dm, 0x19e4, 0x1fff, 0x0c00); + /*NonDC peak_th = 2times DC peak_th*/ + odm_set_bb_reg(dm, 0x19e4, 0x30000, 1); + /*power for debug and auto test flow latch after ST*/ + odm_set_bb_reg(dm, 0x9f8, 0xc0000000, 3); + + /*@low pulse width radar pattern will cause wrong drop*/ + /*@disable peak index should the same + *during the same short pulse (new mechan) + */ + odm_set_bb_reg(dm, 0x9f4, 0x80000000, 0); + + /*@disable peak index should the same + *during the same short pulse (old mechan) + */ + odm_set_bb_reg(dm, 0x924, 0x20000000, 0); + + /*@if peak index diff >=2, then drop the result*/ + odm_set_bb_reg(dm, 0x19e4, 0xe000, 2); + if (region_domain == 2) { + if ((c_channel >= 52) && (c_channel <= 64)) { + /*pulse width hist th setting*/ + /*th1=2*04us*/ + odm_set_bb_reg(dm, 0x19e4, + 0xff000000, 2); + /*th2 = 3*0.4us, th3 = 4*0.4us + *th4 = 7*0.4, th5 = 34*0.4 + */ + odm_set_bb_reg(dm, 0x19e8, + MASKDWORD, 0x22070403); + + /*PRI hist th setting*/ + /*th1=42*32us*/ + odm_set_bb_reg(dm, 0x19b8, + 0x00007f80, 42); + /*th2=47*32us, th3=115*32us, + *th4=123*32us, th5=130*32us + */ + odm_set_bb_reg(dm, 0x19ec, + MASKDWORD, 0x827b732f); + } else { + /*pulse width hist th setting*/ + /*th1=2*04us*/ + odm_set_bb_reg(dm, 0x19e4, + 0xff000000, 1); + /*th2 = 13*0.4us, th3 = 26*0.4us + *th4 = 75*0.4us, th5 = 255*0.4us + */ + odm_set_bb_reg(dm, 0x19e8, + MASKDWORD, 0xff4b1a0d); + /*PRI hist th setting*/ + /*th1=4*32us*/ + + odm_set_bb_reg(dm, 0x19b8, + 0x00007f80, 4); + /*th2=8*32us, th3=16*32us, + *th4=32*32us, th5=128*32=4096us + */ + odm_set_bb_reg(dm, 0x19ec, + MASKDWORD, 0x80201008); + } + } + /*@ETSI*/ + else if (region_domain == 3) { + /*pulse width hist th setting*/ + /*th1=2*04us*/ + odm_set_bb_reg(dm, 0x19e4, 0xff000000, 1); + odm_set_bb_reg(dm, 0x19e8, + MASKDWORD, 0x68260d06); + /*PRI hist th setting*/ + /*th1=7*32us*/ + odm_set_bb_reg(dm, 0x19b8, 0x00007f80, 7); + /*th2=40*32us, th3=80*32us, + *th4=110*32us, th5=157*32=5024 + */ + odm_set_bb_reg(dm, 0x19ec, + MASKDWORD, 0xc06e2010); + } + /*@FCC*/ + else if (region_domain == 1) { + /*pulse width hist th setting*/ + /*th1=2*04us*/ + odm_set_bb_reg(dm, 0x19e4, 0xff000000, 2); + /*th2 = 13*0.4us, th3 = 26*0.4us, + *th4 = 75*0.4us, th5 = 255*0.4us + */ + odm_set_bb_reg(dm, 0x19e8, + MASKDWORD, 0xff4b1a0d); + + /*PRI hist th setting*/ + /*th1=4*32us*/ + odm_set_bb_reg(dm, 0x19b8, 0x00007f80, 4); + /*th2=8*32us, th3=21*32us, + *th4=32*32us, th5=96*32=3072 + */ + if (band_width == CHANNEL_WIDTH_20) + odm_set_bb_reg(dm, 0x19ec, + MASKDWORD, 0x60282010); + else + odm_set_bb_reg(dm, 0x19ec, + MASKDWORD, 0x60282420); + } else { + } + } + } else if (dm->support_ic_type & + ODM_IC_JGR3_SERIES) { + if (dm->radar_detect_dbg_parm_en) { + phydm_radar_detect_with_dbg_parm(dm); + enable = 1; + goto exit; + } + if (region_domain == PHYDM_DFS_DOMAIN_ETSI) { + odm_set_bb_reg(dm, R_0xa40, MASKDWORD, 0xb359c5bd); + if (dm->support_ic_type & (ODM_RTL8814B)) { + if (dm->seg1_dfs_flag == 1) + odm_set_bb_reg(dm, R_0xa6c, BIT(0), 1); + } + odm_set_bb_reg(dm, R_0xa44, MASKDWORD, 0x3033bebd); + odm_set_bb_reg(dm, R_0xa48, MASKDWORD, 0x2a521254); + odm_set_bb_reg(dm, R_0xa4c, MASKDWORD, 0xa2533345); + odm_set_bb_reg(dm, R_0xa50, MASKDWORD, 0x605be003); + odm_set_bb_reg(dm, R_0xa54, MASKDWORD, 0x500089e8); + } else if (region_domain == PHYDM_DFS_DOMAIN_MKK) { + odm_set_bb_reg(dm, R_0xa40, MASKDWORD, 0xb359c5bd); + if (dm->support_ic_type & (ODM_RTL8814B)) { + if (dm->seg1_dfs_flag == 1) + odm_set_bb_reg(dm, R_0xa6c, BIT(0), 1); + } + odm_set_bb_reg(dm, R_0xa44, MASKDWORD, 0x3033bebd); + odm_set_bb_reg(dm, R_0xa48, MASKDWORD, 0x2a521254); + odm_set_bb_reg(dm, R_0xa4c, MASKDWORD, 0xa2533345); + odm_set_bb_reg(dm, R_0xa50, MASKDWORD, 0x605be003); + odm_set_bb_reg(dm, R_0xa54, MASKDWORD, 0x500089e8); + } else if (region_domain == PHYDM_DFS_DOMAIN_FCC) { + odm_set_bb_reg(dm, R_0xa40, MASKDWORD, 0xb359c5bd); + if (dm->support_ic_type & (ODM_RTL8814B)) { + if (dm->seg1_dfs_flag == 1) + odm_set_bb_reg(dm, R_0xa6c, BIT(0), 1); + } + odm_set_bb_reg(dm, R_0xa44, MASKDWORD, 0x3033bebd); + odm_set_bb_reg(dm, R_0xa48, MASKDWORD, 0x2a521254); + odm_set_bb_reg(dm, R_0xa4c, MASKDWORD, 0xa2533345); + odm_set_bb_reg(dm, R_0xa50, MASKDWORD, 0x605be003); + odm_set_bb_reg(dm, R_0xa54, MASKDWORD, 0x500089e8); + } else { + /* not supported */ + PHYDM_DBG(dm, DBG_DFS, + "Unsupported dfs_region_domain:%d\n", + region_domain); + goto exit; + } + #if (RTL8721D_SUPPORT) + } else if (dm->support_ic_type & ODM_RTL8721D) { + odm_set_bb_reg(dm, R_0x814, 0x3fffffff, 0x04cc4d10); + /*CCA MASK*/ + odm_set_bb_reg(dm, R_0xc38, 0x07c00000, 0x06); + /*CCA Threshold*/ + odm_set_bb_reg(dm, R_0xc3c, 0x00000007, 0x0); + + if (dm->radar_detect_dbg_parm_en) { + phydm_radar_detect_with_dbg_parm(dm); + enable = 1; + goto exit; + } + + if (region_domain == PHYDM_DFS_DOMAIN_ETSI) { + odm_set_bb_reg(dm, R_0xf54, MASKDWORD, 0x230006a8); + odm_set_bb_reg(dm, R_0xf58, MASKDWORD, 0x354cd7dd); + odm_set_bb_reg(dm, R_0xf5c, MASKDWORD, 0x9984ab25); + odm_set_bb_reg(dm, R_0xf70, MASKDWORD, 0xbd9fab98); + odm_set_bb_reg(dm, R_0xf74, MASKDWORD, 0xcc45029f); + + } else if (region_domain == PHYDM_DFS_DOMAIN_MKK) { + odm_set_bb_reg(dm, R_0xf54, MASKDWORD, 0x230006a8); + odm_set_bb_reg(dm, R_0xf5c, MASKDWORD, 0x9984ab25); + odm_set_bb_reg(dm, R_0xf70, MASKDWORD, 0xbd9fb398); + odm_set_bb_reg(dm, R_0xf74, MASKDWORD, 0xcc450e9d); + + if (c_channel >= 52 && c_channel <= 64) { + odm_set_bb_reg(dm, R_0xf58, MASKDWORD, + 0x354cd7fd); + } else { + odm_set_bb_reg(dm, R_0xf58, MASKDWORD, + 0x354cd7bd); + } + } else if (region_domain == PHYDM_DFS_DOMAIN_FCC) { + odm_set_bb_reg(dm, R_0xf54, MASKDWORD, 0x230006a8); + odm_set_bb_reg(dm, R_0xf58, MASKDWORD, 0x3558d7bd); + odm_set_bb_reg(dm, R_0xf5c, MASKDWORD, 0x9984ab35); + odm_set_bb_reg(dm, R_0xf70, MASKDWORD, 0xbd9fb398); + odm_set_bb_reg(dm, R_0xf74, MASKDWORD, 0xcc444e9d); + } else { + /* not supported */ + PHYDM_DBG(dm, DBG_DFS, + "Unsupported dfs_region_domain:%d\n", + region_domain); + goto exit; + } + + /*if peak index -1~+1, use original NB method*/ + odm_set_bb_reg(dm, R_0xf70, 0x00070000, 0x7); + odm_set_bb_reg(dm, R_0xf74, 0x000c0000, 0); + + /*Turn off dfs scaling factor*/ + odm_set_bb_reg(dm, R_0xf70, 0x00080000, 0x0); + /*NonDC peak_th = 2times DC peak_th*/ + odm_set_bb_reg(dm, R_0xf58, 0x00007800, 1); + + /*low pulse width radar pattern will cause wrong drop*/ + /*disable peak index should the same*/ + /*during the same short pulse (new mechan)*/ + odm_set_bb_reg(dm, R_0xf70, 0x00100000, 0x0); + /*if peak index diff >=2, then drop the result*/ + odm_set_bb_reg(dm, R_0xf70, 0x30000000, 0x2); + #endif + } else { + /*not supported IC type*/ + PHYDM_DBG(dm, DBG_DFS, "Unsupported IC type:%d\n", + dm->support_ic_type); + goto exit; + } + + enable = 1; + + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + dfs->st_l2h_cur = (u8)odm_get_bb_reg(dm, R_0xa40, 0x00007f00); + dfs->pwdb_th_cur = (u8)odm_get_bb_reg(dm, R_0xa50, 0x000000f0); + dfs->peak_th = (u8)odm_get_bb_reg(dm, R_0xa48, 0x00c00000); + dfs->short_pulse_cnt_th = (u8)odm_get_bb_reg(dm, R_0xa50, + 0x00f00000); + dfs->long_pulse_cnt_th = (u8)odm_get_bb_reg(dm, R_0xa4c, + 0xf0000000); + dfs->peak_window = (u8)odm_get_bb_reg(dm, R_0xa40, 0x00030000); + dfs->three_peak_opt = (u8)odm_get_bb_reg(dm, R_0xa40, + 0x30000000); + dfs->three_peak_th2 = (u8)odm_get_bb_reg(dm, R_0xa44, + 0x00000007); + #if (RTL8721D_SUPPORT) + } else if (dm->support_ic_type & (ODM_RTL8721D)) { + dfs->st_l2h_cur = (u8)odm_get_bb_reg(dm, R_0xf54, + 0x0000001f) << 2); + dfs->st_l2h_cur += (u8)odm_get_bb_reg(dm, R_0xf58, 0xc0000000); + dfs->pwdb_th_cur = (u8)odm_get_bb_reg(dm, R_0xf70, 0x03c00000); + dfs->peak_th = (u8)odm_get_bb_reg(dm, R_0xf5c, 0x00000030); + dfs->short_pulse_cnt_th = (u8)odm_get_bb_reg(dm, R_0xf70, + 0x00007800); + dfs->long_pulse_cnt_th = (u8)odm_get_bb_reg(dm, R_0xf74, + 0x0000000f); + dfs->peak_window = (u8)odm_get_bb_reg(dm, R_0xf58, 0x18000000); + dfs->three_peak_opt = (u8)odm_get_bb_reg(dm, R_0xf58, + 0x00030000); + dfs->three_peak_th2 = (u8)odm_get_bb_reg(dm, + R_0xf58, 0x00007c00); + #endif + } else { + dfs->st_l2h_cur = (u8)odm_get_bb_reg(dm, R_0x91c, 0x000000ff); + dfs->pwdb_th_cur = (u8)odm_get_bb_reg(dm, R_0x918, 0x00001f00); + dfs->peak_th = (u8)odm_get_bb_reg(dm, R_0x918, 0x00030000); + dfs->short_pulse_cnt_th = (u8)odm_get_bb_reg(dm, R_0x920, + 0x000f0000); + dfs->long_pulse_cnt_th = (u8)odm_get_bb_reg(dm, R_0x920, + 0x00f00000); + dfs->peak_window = (u8)odm_get_bb_reg(dm, R_0x920, 0x00000300); + dfs->three_peak_opt = (u8)odm_get_bb_reg(dm, 0x924, 0x00000180); + dfs->three_peak_th2 = (u8)odm_get_bb_reg(dm, 0x924, 0x00007000); + } + + phydm_dfs_parameter_init(dm); + +exit: + if (enable) { + phydm_radar_detect_reset(dm); + PHYDM_DBG(dm, DBG_DFS, "on cch:%u, bw:%u\n", c_channel, + band_width); + } else + phydm_radar_detect_disable(dm); +} + +void phydm_dfs_parameter_init(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _DFS_STATISTICS *dfs = &dm->dfs; + + u8 i; + for (i = 0; i < 5; i++) { + dfs->pulse_flag_hist[i] = 0; + dfs->pulse_type_hist[i] = 0; + dfs->radar_det_mask_hist[i] = 0; + dfs->fa_inc_hist[i] = 0; + } + + /*@for dfs mode*/ + dfs->force_TP_mode = 0; + dfs->sw_trigger_mode = 0; + dfs->det_print = 0; + dfs->det_print2 = 0; + dfs->print_hist_rpt = 0; + if (dm->support_ic_type & (ODM_RTL8814A | ODM_RTL8822B | ODM_RTL8821C)) + dfs->hist_cond_on = 1; + else + dfs->hist_cond_on = 0; + + /*@for dynamic dfs*/ + dfs->pwdb_th = 8; + dfs->fa_mask_th = 30; + dfs->st_l2h_min = 0x20; + dfs->st_l2h_max = 0x4e; + dfs->pwdb_scalar_factor = 12; + + /*@for dfs histogram*/ + dfs->pri_hist_th = 5; + dfs->pri_sum_g1_th = 9; + dfs->pri_sum_g5_th = 5; + dfs->pri_sum_g1_fcc_th = 4; /*@FCC Type6*/ + dfs->pri_sum_g3_fcc_th = 6; + dfs->pri_sum_safe_th = 50; + dfs->pri_sum_safe_fcc_th = 110; /*@30 for AP*/ + dfs->pri_sum_type4_th = 16; + dfs->pri_sum_type6_th = 12; + dfs->pri_sum_g5_under_g1_th = 4; + dfs->pri_pw_diff_th = 4; + dfs->pri_pw_diff_fcc_th = 8; + dfs->pri_pw_diff_fcc_idle_th = 2; + dfs->pri_pw_diff_w53_th = 10; + dfs->pw_std_th = 7; /*@FCC Type4*/ + dfs->pw_std_idle_th = 10; + dfs->pri_std_th = 6; /*@FCC Type3,4,6*/ + dfs->pri_std_idle_th = 10; + dfs->pri_type1_upp_fcc_th = 110; + dfs->pri_type1_low_fcc_th = 50; + dfs->pri_type1_cen_fcc_th = 70; + dfs->pw_g0_th = 8; + dfs->pw_long_lower_th = 6; /*@7->6*/ + dfs->pri_long_upper_th = 30; + dfs->pw_long_lower_20m_th = 7; /*@7 for AP*/ + dfs->pw_long_sum_upper_th = 60; + dfs->type4_pw_max_cnt = 7; + dfs->type4_safe_pri_sum_th = 5; +} + +void phydm_dfs_dynamic_setting( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _DFS_STATISTICS *dfs = &dm->dfs; + + u8 peak_th_cur = 0, short_pulse_cnt_th_cur = 0; + u8 long_pulse_cnt_th_cur = 0, three_peak_opt_cur = 0; + u8 three_peak_th2_cur = 0; + u8 peak_window_cur = 0; + u8 region_domain = dm->dfs_region_domain; + u8 c_channel = *dm->channel; + + if (dm->rx_tp + dm->tx_tp <= 2) { + dfs->idle_mode = 1; + if (dfs->force_TP_mode) + dfs->idle_mode = 0; + } else { + dfs->idle_mode = 0; + } + + if (dfs->idle_mode == 1) { /*@idle (no traffic)*/ + peak_th_cur = 3; + short_pulse_cnt_th_cur = 6; + long_pulse_cnt_th_cur = 9; + peak_window_cur = 2; + three_peak_opt_cur = 0; + 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; + three_peak_th2_cur = 0; + } else { + short_pulse_cnt_th_cur = 6; + 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(dm)) { + /*need to add check cac end condition*/ + peak_th_cur = 2; + three_peak_opt_cur = 0; + three_peak_th2_cur = 0; + short_pulse_cnt_th_cur = 7; + } else { + three_peak_opt_cur = 0; + three_peak_th2_cur = 0; + short_pulse_cnt_th_cur = 7; + } + } 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 = 7; + peak_window_cur = 2; + three_peak_opt_cur = 0; + 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; + /*@for high duty cycle*/ + short_pulse_cnt_th_cur = 5; + 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) { + long_pulse_cnt_th_cur = 5; /*for 80M FCC*/ + short_pulse_cnt_th_cur = 5; /*for 80M 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; + } + } + + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + if (dfs->peak_th != peak_th_cur) + odm_set_bb_reg(dm, R_0xa48, 0x00c00000, peak_th_cur); + if (dfs->short_pulse_cnt_th != short_pulse_cnt_th_cur) + odm_set_bb_reg(dm, R_0xa50, 0x00f00000, + short_pulse_cnt_th_cur); + if (dfs->long_pulse_cnt_th != long_pulse_cnt_th_cur) + odm_set_bb_reg(dm, R_0xa4c, 0xf0000000, + long_pulse_cnt_th_cur); + if (dfs->peak_window != peak_window_cur) + odm_set_bb_reg(dm, R_0xa40, 0x00030000, + peak_window_cur); + if (dfs->three_peak_opt != three_peak_opt_cur) + odm_set_bb_reg(dm, R_0xa40, 0x30000000, + three_peak_opt_cur); + if (dfs->three_peak_th2 != three_peak_th2_cur) + odm_set_bb_reg(dm, R_0xa44, 0x00000007, + three_peak_th2_cur); + #if (RTL8721D_SUPPORT) + } else if (dm->support_ic_type & (ODM_RTL8721D)) { + if (dfs->peak_th != peak_th_cur) + odm_set_bb_reg(dm, R_0xf5c, 0x00000030, peak_th_cur); + if (dfs->short_pulse_cnt_th != short_pulse_cnt_th_cur) + odm_set_bb_reg(dm, R_0xf70, 0x00007800, + short_pulse_cnt_th_cur); + if (dfs->long_pulse_cnt_th != long_pulse_cnt_th_cur) + odm_set_bb_reg(dm, R_0xf74, 0x0000000f, + long_pulse_cnt_th_cur); + if (dfs->peak_window != peak_window_cur) + odm_set_bb_reg(dm, R_0xf58, 0x18000000, + peak_window_cur); + if (dfs->three_peak_opt != three_peak_opt_cur) + odm_set_bb_reg(dm, R_0xf58, 0x00030000, + three_peak_opt_cur); + if (dfs->three_peak_th2 != three_peak_th2_cur) + odm_set_bb_reg(dm, R_0xf58, 0x00007c00, + three_peak_th2_cur); + #endif + } else { + if (dfs->peak_th != peak_th_cur) + odm_set_bb_reg(dm, R_0x918, 0x00030000, peak_th_cur); + if (dfs->short_pulse_cnt_th != short_pulse_cnt_th_cur) + odm_set_bb_reg(dm, R_0x920, 0x000f0000, + short_pulse_cnt_th_cur); + if (dfs->long_pulse_cnt_th != long_pulse_cnt_th_cur) + odm_set_bb_reg(dm, R_0x920, 0x00f00000, + long_pulse_cnt_th_cur); + if (dfs->peak_window != peak_window_cur) + odm_set_bb_reg(dm, R_0x920, 0x00000300, + peak_window_cur); + if (dfs->three_peak_opt != three_peak_opt_cur) + odm_set_bb_reg(dm, R_0x924, 0x00000180, + three_peak_opt_cur); + if (dfs->three_peak_th2 != three_peak_th2_cur) + odm_set_bb_reg(dm, R_0x924, 0x00007000, + three_peak_th2_cur); + } + + dfs->peak_th = peak_th_cur; + dfs->short_pulse_cnt_th = short_pulse_cnt_th_cur; + dfs->long_pulse_cnt_th = long_pulse_cnt_th_cur; + dfs->peak_window = peak_window_cur; + dfs->three_peak_opt = three_peak_opt_cur; + dfs->three_peak_th2 = three_peak_th2_cur; +} + +boolean +phydm_radar_detect_dm_check( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _DFS_STATISTICS *dfs = &dm->dfs; + u8 region_domain = dm->dfs_region_domain, index = 0; + + u16 i = 0, j = 0, k = 0, fa_count_cur = 0, fa_count_inc = 0; + u16 total_fa_in_hist = 0, pre_post_now_acc_fa_in_hist = 0; + u16 max_fa_in_hist = 0, vht_crc_ok_cnt_cur = 0; + u16 vht_crc_ok_cnt_inc = 0, ht_crc_ok_cnt_cur = 0; + u16 ht_crc_ok_cnt_inc = 0, leg_crc_ok_cnt_cur = 0; + u16 leg_crc_ok_cnt_inc = 0; + u16 total_crc_ok_cnt_inc = 0, short_pulse_cnt_cur = 0; + u16 short_pulse_cnt_inc = 0, long_pulse_cnt_cur = 0; + u16 long_pulse_cnt_inc = 0, total_pulse_count_inc = 0; + u32 regf98_value = 0, reg918_value = 0, reg91c_value = 0; + u32 reg920_value = 0, reg924_value = 0, radar_rpt_reg_value = 0; + u32 regf54_value = 0, regf58_value = 0, regf5c_value = 0; + u32 regdf4_value = 0, regf70_value = 0, regf74_value = 0; + u32 rega40_value = 0, rega44_value = 0, rega48_value = 0; + u32 rega4c_value = 0, rega50_value = 0, rega54_value = 0; + #if (RTL8721D_SUPPORT) + u32 reg908_value = 0, regdf4_value = 0; + u32 regf54_value = 0, regf58_value = 0, regf5c_value = 0; + u32 regf70_value = 0, regf74_value = 0; + #endif + boolean tri_short_pulse = 0, tri_long_pulse = 0, radar_type = 0; + boolean fault_flag_det = 0, fault_flag_psd = 0, fa_flag = 0; + boolean radar_detected = 0; + u8 st_l2h_new = 0, fa_mask_th = 0, sum = 0; + u8 c_channel = *dm->channel; + + /*@Get FA count during past 100ms, R_0xf48 for AC series*/ + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + fa_count_cur = (u16)odm_get_bb_reg(dm, R_0x2d00, MASKLWORD); + #if (RTL8721D_SUPPORT) + else if (dm->support_ic_type & (ODM_RTL8721D)) { + fa_count_cur = (u16)odm_get_bb_reg(dm, + ODM_REG_OFDM_FA_TYPE2_11N, + MASKHWORD); + fa_count_cur += (u16)odm_get_bb_reg(dm, + ODM_REG_OFDM_FA_TYPE3_11N, + MASKLWORD); + fa_count_cur += (u16)odm_get_bb_reg(dm, + ODM_REG_OFDM_FA_TYPE3_11N, + MASKHWORD); + fa_count_cur += (u16)odm_get_bb_reg(dm, + ODM_REG_OFDM_FA_TYPE4_11N, + MASKLWORD); + fa_count_cur += (u16)odm_get_bb_reg(dm, + ODM_REG_OFDM_FA_TYPE1_11N, + MASKLWORD); + fa_count_cur += (u16)odm_get_bb_reg(dm, + ODM_REG_OFDM_FA_TYPE1_11N, + MASKHWORD); + } + #endif + else + fa_count_cur = (u16)odm_get_bb_reg(dm, R_0xf48, 0x0000ffff); + + if (dfs->fa_count_pre == 0) + fa_count_inc = 0; + else if (fa_count_cur >= dfs->fa_count_pre) + fa_count_inc = fa_count_cur - dfs->fa_count_pre; + else + fa_count_inc = fa_count_cur; + dfs->fa_count_pre = fa_count_cur; + + dfs->fa_inc_hist[dfs->mask_idx] = fa_count_inc; + + for (i = 0; i < 5; i++) { + total_fa_in_hist = total_fa_in_hist + dfs->fa_inc_hist[i]; + if (dfs->fa_inc_hist[i] > max_fa_in_hist) + max_fa_in_hist = dfs->fa_inc_hist[i]; + } + if (dfs->mask_idx >= 2) + index = dfs->mask_idx - 2; + else + index = 5 + dfs->mask_idx - 2; + if (index == 0) { + pre_post_now_acc_fa_in_hist = dfs->fa_inc_hist[index] + + dfs->fa_inc_hist[index + 1] + + dfs->fa_inc_hist[4]; + } else if (index == 4) { + pre_post_now_acc_fa_in_hist = dfs->fa_inc_hist[index] + + dfs->fa_inc_hist[0] + + dfs->fa_inc_hist[index - 1]; + } else { + pre_post_now_acc_fa_in_hist = dfs->fa_inc_hist[index] + + dfs->fa_inc_hist[index + 1] + + dfs->fa_inc_hist[index - 1]; + } + + /*@Get VHT CRC32 ok count during past 100ms*/ + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + vht_crc_ok_cnt_cur = (u16)odm_get_bb_reg(dm, R_0x2c0c, 0xffff); + #if (RTL8721D_SUPPORT) + else if (dm->support_ic_type & ODM_RTL8721D) + vht_crc_ok_cnt_cur = 0; + #endif + else + vht_crc_ok_cnt_cur = (u16)odm_get_bb_reg(dm, R_0xf0c, + 0x00003fff); + + if (vht_crc_ok_cnt_cur >= dfs->vht_crc_ok_cnt_pre) { + vht_crc_ok_cnt_inc = vht_crc_ok_cnt_cur - + dfs->vht_crc_ok_cnt_pre; + } else { + vht_crc_ok_cnt_inc = vht_crc_ok_cnt_cur; + } + dfs->vht_crc_ok_cnt_pre = vht_crc_ok_cnt_cur; + + /*@Get HT CRC32 ok count during past 100ms*/ + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + ht_crc_ok_cnt_cur = (u16)odm_get_bb_reg(dm, R_0x2c10, 0xffff); + #if (RTL8721D_SUPPORT) + else if (dm->support_ic_type & (ODM_RTL8721D)) + ht_crc_ok_cnt_cur = (u16)odm_get_bb_reg(dm, R_0xf90, MASKLWORD); + #endif + else + ht_crc_ok_cnt_cur = (u16)odm_get_bb_reg(dm, R_0xf10, + 0x00003fff); + + if (ht_crc_ok_cnt_cur >= dfs->ht_crc_ok_cnt_pre) + ht_crc_ok_cnt_inc = ht_crc_ok_cnt_cur - dfs->ht_crc_ok_cnt_pre; + else + ht_crc_ok_cnt_inc = ht_crc_ok_cnt_cur; + dfs->ht_crc_ok_cnt_pre = ht_crc_ok_cnt_cur; + + /*@Get Legacy CRC32 ok count during past 100ms*/ + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + leg_crc_ok_cnt_cur = (u16)odm_get_bb_reg(dm, R_0x2c14, 0xffff); + #if (RTL8721D_SUPPORT) + else if (dm->support_ic_type & ODM_RTL8721D) + leg_crc_ok_cnt_cur = (u16)odm_get_bb_reg(dm, + R_0xf94, MASKLWORD); + #endif + else + leg_crc_ok_cnt_cur = (u16)odm_get_bb_reg(dm, R_0xf14, + 0x00003fff); + + if (leg_crc_ok_cnt_cur >= dfs->leg_crc_ok_cnt_pre) + leg_crc_ok_cnt_inc = leg_crc_ok_cnt_cur - dfs->leg_crc_ok_cnt_pre; + else + leg_crc_ok_cnt_inc = leg_crc_ok_cnt_cur; + dfs->leg_crc_ok_cnt_pre = leg_crc_ok_cnt_cur; + + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + if (vht_crc_ok_cnt_cur == 0xffff || + ht_crc_ok_cnt_cur == 0xffff || + leg_crc_ok_cnt_cur == 0xffff) { + phydm_reset_bb_hw_cnt(dm); + } + #if (RTL8721D_SUPPORT) + } else if (dm->support_ic_type & (ODM_RTL8721D)) { + if (ht_crc_ok_cnt_cur == 0xffff || + leg_crc_ok_cnt_cur == 0xffff) { + odm_set_bb_reg(dm, R_0xf14, BIT(16), 1); + odm_set_bb_reg(dm, R_0xf14, BIT(16), 0); + } + #endif + } else { + if (vht_crc_ok_cnt_cur == 0x3fff || + ht_crc_ok_cnt_cur == 0x3fff || + leg_crc_ok_cnt_cur == 0x3fff) { + phydm_reset_bb_hw_cnt(dm); + } + } + + total_crc_ok_cnt_inc = vht_crc_ok_cnt_inc + + ht_crc_ok_cnt_inc + + leg_crc_ok_cnt_inc; + + if (dm->support_ic_type & (ODM_RTL8198F | ODM_RTL8822C | ODM_RTL8812F | + ODM_RTL8197G)) { + /* if (phydm_set_bb_dbg_port(dm, DBGPORT_PRI_2, 0x3b0)) { + * odm_set_bb_reg(dm, 0x1e28, 0x03c00000, 8); + * dbgport2dbc_value = phydm_get_bb_dbg_port_val(dm); + * phydm_release_bb_dbg_port(dm); } + */ + radar_rpt_reg_value = odm_get_bb_reg(dm, R_0x2e00, 0xffffffff); + short_pulse_cnt_cur = (u16)((radar_rpt_reg_value & 0x000ff800) + >> 11); + long_pulse_cnt_cur = (u16)((radar_rpt_reg_value & 0x0fc00000) + >> 22); + #if (RTL8721D_SUPPORT) + } else if (dm->support_ic_type & (ODM_RTL8721D)) { + reg908_value = (u32)odm_get_bb_reg(dm, R_0x908, MASKDWORD); + odm_set_bb_reg(dm, R_0x908, MASKDWORD, 0x254); + regdf4_value = odm_get_bb_reg(dm, R_0xdf4, MASKDWORD); + short_pulse_cnt_cur = (u16)((regdf4_value & 0x000ff000) >> 12); + long_pulse_cnt_cur = (u16)((regdf4_value & 0x0fc00000) >> 22); + + tri_short_pulse = (regdf4_value & BIT(20)) ? 1 : 0; + tri_long_pulse = (regdf4_value & BIT(28)) ? 1 : 0; + if (tri_short_pulse || tri_long_pulse) { + odm_set_bb_reg(dm, R_0xf58, BIT(29), 0); + odm_set_bb_reg(dm, R_0xf58, BIT(29), 1); + } + #endif + } else if (dm->support_ic_type & (ODM_RTL8814B)) { + if (dm->seg1_dfs_flag == 1) + radar_rpt_reg_value = odm_get_bb_reg(dm, R_0x2e20, + 0xffffffff); + else + radar_rpt_reg_value = odm_get_bb_reg(dm, R_0x2e00, + 0xffffffff); + short_pulse_cnt_cur = (u16)((radar_rpt_reg_value & 0x000ff800) + >> 11); + long_pulse_cnt_cur = (u16)((radar_rpt_reg_value & 0x0fc00000) + >> 22); + } else { + regf98_value = odm_get_bb_reg(dm, R_0xf98, 0xffffffff); + short_pulse_cnt_cur = (u16)(regf98_value & 0x000000ff); + long_pulse_cnt_cur = (u16)((regf98_value & 0x0000ff00) >> 8); + } + + /*@Get short pulse count, need carefully handle the counter overflow*/ + + if (short_pulse_cnt_cur >= dfs->short_pulse_cnt_pre) { + short_pulse_cnt_inc = short_pulse_cnt_cur - + dfs->short_pulse_cnt_pre; + } else { + short_pulse_cnt_inc = short_pulse_cnt_cur; + } + dfs->short_pulse_cnt_pre = short_pulse_cnt_cur; + + /*@Get long pulse count, need carefully handle the counter overflow*/ + + if (long_pulse_cnt_cur >= dfs->long_pulse_cnt_pre) { + long_pulse_cnt_inc = long_pulse_cnt_cur - + dfs->long_pulse_cnt_pre; + } else { + long_pulse_cnt_inc = long_pulse_cnt_cur; + } + dfs->long_pulse_cnt_pre = long_pulse_cnt_cur; + + total_pulse_count_inc = short_pulse_cnt_inc + long_pulse_cnt_inc; + + if (dfs->det_print) { + PHYDM_DBG(dm, DBG_DFS, + "===============================================\n"); + PHYDM_DBG(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); + if (dm->support_ic_type & (ODM_RTL8721D)) { + PHYDM_DBG(dm, DBG_DFS, + "Init_Gain[%x] st_l2h_cur[%x] 0xdf4[%08x] short_pulse_cnt_inc[%d] long_pulse_cnt_inc[%d]\n", + dfs->igi_cur, dfs->st_l2h_cur, regdf4_value, + short_pulse_cnt_inc, long_pulse_cnt_inc); + regf54_value = odm_get_bb_reg(dm, R_0xf54, MASKDWORD); + regf58_value = odm_get_bb_reg(dm, R_0xf58, MASKDWORD); + regf5c_value = odm_get_bb_reg(dm, R_0xf5c, MASKDWORD); + regf70_value = odm_get_bb_reg(dm, R_0xf70, MASKDWORD); + regf74_value = odm_get_bb_reg(dm, R_0xf74, MASKDWORD); + PHYDM_DBG(dm, DBG_DFS, + "0xf54[%08x] 0xf58[%08x] 0xf5c[%08x] 0xf70[%08x] 0xf74[%08x]\n", + regf54_value, regf58_value, regf5c_value, + regf70_value, regf74_value); + } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + PHYDM_DBG(dm, DBG_DFS, + "Init_Gain[%x] st_l2h_cur[%x] 0x2dbc[%08x] short_pulse_cnt_inc[%d] long_pulse_cnt_inc[%d]\n", + dfs->igi_cur, dfs->st_l2h_cur, + radar_rpt_reg_value, short_pulse_cnt_inc, + long_pulse_cnt_inc); + rega40_value = odm_get_bb_reg(dm, R_0xa40, MASKDWORD); + rega44_value = odm_get_bb_reg(dm, R_0xa44, MASKDWORD); + rega48_value = odm_get_bb_reg(dm, R_0xa48, MASKDWORD); + rega4c_value = odm_get_bb_reg(dm, R_0xa4c, MASKDWORD); + rega50_value = odm_get_bb_reg(dm, R_0xa50, MASKDWORD); + rega54_value = odm_get_bb_reg(dm, R_0xa54, MASKDWORD); + PHYDM_DBG(dm, DBG_DFS, + "0xa40[%08x] 0xa44[%08x] 0xa48[%08x] 0xa4c[%08x] 0xa50[%08x] 0xa54[%08x]\n", + rega40_value, rega44_value, rega48_value, + rega4c_value, rega50_value, rega54_value); + } else { + PHYDM_DBG(dm, DBG_DFS, + "Init_Gain[%x] 0x91c[%x] 0xf98[%08x] short_pulse_cnt_inc[%d] long_pulse_cnt_inc[%d]\n", + dfs->igi_cur, dfs->st_l2h_cur, regf98_value, + short_pulse_cnt_inc, long_pulse_cnt_inc); + reg918_value = odm_get_bb_reg(dm, R_0x918, + 0xffffffff); + reg91c_value = odm_get_bb_reg(dm, R_0x91c, + 0xffffffff); + reg920_value = odm_get_bb_reg(dm, R_0x920, + 0xffffffff); + reg924_value = odm_get_bb_reg(dm, R_0x924, + 0xffffffff); + PHYDM_DBG(dm, DBG_DFS, + "0x918[%08x] 0x91c[%08x] 0x920[%08x] 0x924[%08x]\n", + reg918_value, reg91c_value, + reg920_value, reg924_value); + } + PHYDM_DBG(dm, DBG_DFS, "Throughput: %dMbps\n", + (dm->rx_tp + dm->tx_tp)); + + PHYDM_DBG(dm, DBG_DFS, + "dfs_regdomain = %d, dbg_mode = %d, idle_mode = %d, print_hist_rpt = %d, hist_cond_on = %d\n", + region_domain, dfs->dbg_mode, + dfs->idle_mode, dfs->print_hist_rpt, + dfs->hist_cond_on); + } + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + tri_short_pulse = (radar_rpt_reg_value & BIT(20)) ? 1 : 0; + tri_long_pulse = (radar_rpt_reg_value & BIT(28)) ? 1 : 0; + } else { + tri_short_pulse = (regf98_value & BIT(17)) ? 1 : 0; + tri_long_pulse = (regf98_value & BIT(19)) ? 1 : 0; + } + + if (tri_short_pulse) { + phydm_radar_detect_reset(dm); + } + if (tri_long_pulse) { + phydm_radar_detect_reset(dm); + 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 = dfs->st_l2h_cur; + dfs->pulse_flag_hist[dfs->mask_idx] = tri_short_pulse | tri_long_pulse; + dfs->pulse_type_hist[dfs->mask_idx] = (tri_long_pulse) ? 1 : 0; + + /* PSD(not ready) */ + + fault_flag_det = 0; + fault_flag_psd = 0; + fa_flag = 0; + if (region_domain == PHYDM_DFS_DOMAIN_ETSI) { + fa_mask_th = dfs->fa_mask_th + 20; + } else { + fa_mask_th = 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 || + dfs->igi_cur >= 0x30) { + st_l2h_new = dfs->st_l2h_max; + dfs->radar_det_mask_hist[index] = 1; + if (dfs->pulse_flag_hist[index] == 1) { + dfs->pulse_flag_hist[index] = 0; + if (dfs->det_print2) { + PHYDM_DBG(dm, DBG_DFS, + "Radar is masked : FA mask\n"); + } + } + fa_flag = 1; + } else { + dfs->radar_det_mask_hist[index] = 0; + } + + if (dfs->det_print) { + PHYDM_DBG(dm, DBG_DFS, "mask_idx: %d\n", dfs->mask_idx); + PHYDM_DBG(dm, DBG_DFS, "radar_det_mask_hist: "); + for (i = 0; i < 5; i++) + PHYDM_DBG(dm, DBG_DFS, "%d ", + dfs->radar_det_mask_hist[i]); + PHYDM_DBG(dm, DBG_DFS, "pulse_flag_hist: "); + for (i = 0; i < 5; i++) + PHYDM_DBG(dm, DBG_DFS, "%d ", dfs->pulse_flag_hist[i]); + PHYDM_DBG(dm, DBG_DFS, "fa_inc_hist: "); + for (i = 0; i < 5; i++) + PHYDM_DBG(dm, DBG_DFS, "%d ", dfs->fa_inc_hist[i]); + PHYDM_DBG(dm, DBG_DFS, + "\nfa_mask_th: %d max_fa_in_hist: %d total_fa_in_hist: %d pre_post_now_acc_fa_in_hist: %d ", + fa_mask_th, max_fa_in_hist, total_fa_in_hist, + pre_post_now_acc_fa_in_hist); + } + + sum = 0; + for (k = 0; k < 5; k++) { + if (dfs->radar_det_mask_hist[k] == 1) + sum++; + } + + if (dfs->mask_hist_checked <= 5) + dfs->mask_hist_checked++; + + if (dfs->mask_hist_checked >= 5 && dfs->pulse_flag_hist[index]) { + if (sum <= 2) { + if (dfs->hist_cond_on) { + /*return the value from hist_radar_detected*/ + radar_detected = phydm_dfs_hist_log(dm, index); + } else { + if (dfs->pulse_type_hist[index] == 0) + dfs->radar_type = 0; + else if (dfs->pulse_type_hist[index] == 1) + dfs->radar_type = 1; + radar_detected = 1; + PHYDM_DBG(dm, DBG_DFS, + "Detected type %d radar signal!\n", + dfs->radar_type); + } + } else { + fault_flag_det = 1; + if (dfs->det_print2) { + PHYDM_DBG(dm, DBG_DFS, + "Radar is masked : mask_hist large than thd\n"); + } + } + } + + dfs->mask_idx++; + if (dfs->mask_idx == 5) + dfs->mask_idx = 0; + + if (fault_flag_det == 0 && fault_flag_psd == 0 && fa_flag == 0) { + if (dfs->igi_cur < 0x30) { + st_l2h_new = dfs->st_l2h_min; + } + } + + if (st_l2h_new != dfs->st_l2h_cur) { + if (st_l2h_new < dfs->st_l2h_min) { + dfs->st_l2h_cur = dfs->st_l2h_min; + } else if (st_l2h_new > dfs->st_l2h_max) + dfs->st_l2h_cur = dfs->st_l2h_max; + else + dfs->st_l2h_cur = st_l2h_new; + /*odm_set_bb_reg(dm, R_0x91c, 0xff, dfs->st_l2h_cur);*/ + + dfs->pwdb_th_cur = ((int)dfs->st_l2h_cur - (int)dfs->igi_cur) + / 2 + dfs->pwdb_scalar_factor; + + /*@limit the pwdb value to absolute lower bound 8*/ + dfs->pwdb_th_cur = MAX_2(dfs->pwdb_th_cur, (int)dfs->pwdb_th); + + /*@limit the pwdb value to absolute upper bound 0x1f*/ + dfs->pwdb_th_cur = MIN_2(dfs->pwdb_th_cur, 0x1f); + + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + odm_set_bb_reg(dm, R_0xa50, 0x000000f0, + dfs->pwdb_th_cur); + #if (RTL8721D_SUPPORT) + else if (dm->support_ic_type & ODM_RTL8721D) { + odm_set_bb_reg(dm, R_0xf54, 0x0000001f, + ((dfs->st_l2h_cur & 0x0000007c) >> 2)); + odm_set_bb_reg(dm, R_0xf58, 0xc0000000, + (dfs->st_l2h_cur & 0x00000003)); + odm_set_bb_reg(dm, R_0xf70, 0x03c00000, + dfs->pwdb_th_cur); + } + #endif + else + odm_set_bb_reg(dm, R_0x918, 0x00001f00, + dfs->pwdb_th_cur); + } + + if (dfs->det_print) { + PHYDM_DBG(dm, DBG_DFS, + "fault_flag_det[%d], fault_flag_psd[%d], DFS_detected [%d]\n", + fault_flag_det, fault_flag_psd, radar_detected); + } + #if (RTL8721D_SUPPORT) + if (dm->support_ic_type & (ODM_RTL8721D)) + odm_set_bb_reg(dm, R_0x908, MASKDWORD, reg908_value); + #endif + + return radar_detected; +} + +void phydm_dfs_histogram_radar_distinguish( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _DFS_STATISTICS *dfs = &dm->dfs; + u8 region_domain = dm->dfs_region_domain; + u8 c_channel = *dm->channel; + u8 band_width = *dm->band_width; + + u8 dfs_pw_thd1 = 0, dfs_pw_thd2 = 0, dfs_pw_thd3 = 0; + u8 dfs_pw_thd4 = 0, dfs_pw_thd5 = 0; + u8 dfs_pri_thd1 = 0, dfs_pri_thd2 = 0, dfs_pri_thd3 = 0; + u8 dfs_pri_thd4 = 0, dfs_pri_thd5 = 0; + u8 pri_th = 0, i = 0; + u8 max_pri_idx = 0, max_pw_idx = 0, max_pri_cnt_th = 0; + u8 max_pri_cnt_fcc_g1_th = 0, max_pri_cnt_fcc_g3_th = 0; + u8 safe_pri_pw_diff_th = 0, safe_pri_pw_diff_fcc_th = 0; + u8 safe_pri_pw_diff_w53_th = 0, safe_pri_pw_diff_fcc_idle_th = 0; + u16 j = 0; + u32 dfs_hist1_peak_index = 0, dfs_hist2_peak_index = 0; + u32 dfs_hist1_pw = 0, dfs_hist2_pw = 0, g_pw[6] = {0}; + u32 g_peakindex[16] = {0}, g_mask_32 = 0, false_peak_hist1 = 0; + u32 false_peak_hist2_above10 = 0, false_peak_hist2_above0 = 0; + u32 dfs_hist1_pri = 0, dfs_hist2_pri = 0, g_pri[6] = {0}; + u32 pw_sum_g0g5 = 0, pw_sum_g1g2g3g4 = 0; + u32 pri_sum_g0g5 = 0, pri_sum_g1g2g3g4 = 0; + u32 pw_sum_ss_g1g2g3g4 = 0, pri_sum_ss_g1g2g3g4 = 0; + u32 max_pri_cnt = 0, max_pw_cnt = 0; + #if (RTL8721D_SUPPORT) + if (dm->support_ic_type & (ODM_RTL8721D)) + return; + #endif + + /*read peak index hist report*/ + odm_set_bb_reg(dm, 0x19e4, BIT(22) | BIT(23), 0x0); + dfs_hist1_peak_index = odm_get_bb_reg(dm, 0xf5c, 0xffffffff); + dfs_hist2_peak_index = odm_get_bb_reg(dm, 0xf74, 0xffffffff); + + g_peakindex[15] = ((dfs_hist1_peak_index & 0x0000000f) >> 0); + g_peakindex[14] = ((dfs_hist1_peak_index & 0x000000f0) >> 4); + g_peakindex[13] = ((dfs_hist1_peak_index & 0x00000f00) >> 8); + g_peakindex[12] = ((dfs_hist1_peak_index & 0x0000f000) >> 12); + g_peakindex[11] = ((dfs_hist1_peak_index & 0x000f0000) >> 16); + g_peakindex[10] = ((dfs_hist1_peak_index & 0x00f00000) >> 20); + g_peakindex[9] = ((dfs_hist1_peak_index & 0x0f000000) >> 24); + g_peakindex[8] = ((dfs_hist1_peak_index & 0xf0000000) >> 28); + g_peakindex[7] = ((dfs_hist2_peak_index & 0x0000000f) >> 0); + g_peakindex[6] = ((dfs_hist2_peak_index & 0x000000f0) >> 4); + g_peakindex[5] = ((dfs_hist2_peak_index & 0x00000f00) >> 8); + g_peakindex[4] = ((dfs_hist2_peak_index & 0x0000f000) >> 12); + g_peakindex[3] = ((dfs_hist2_peak_index & 0x000f0000) >> 16); + g_peakindex[2] = ((dfs_hist2_peak_index & 0x00f00000) >> 20); + g_peakindex[1] = ((dfs_hist2_peak_index & 0x0f000000) >> 24); + g_peakindex[0] = ((dfs_hist2_peak_index & 0xf0000000) >> 28); + + /*read pulse width hist report*/ + odm_set_bb_reg(dm, 0x19e4, BIT(22) | BIT(23), 0x1); + dfs_hist1_pw = odm_get_bb_reg(dm, 0xf5c, 0xffffffff); + dfs_hist2_pw = odm_get_bb_reg(dm, 0xf74, 0xffffffff); + + g_pw[0] = (unsigned int)((dfs_hist2_pw & 0xff000000) >> 24); + g_pw[1] = (unsigned int)((dfs_hist2_pw & 0x00ff0000) >> 16); + g_pw[2] = (unsigned int)((dfs_hist2_pw & 0x0000ff00) >> 8); + g_pw[3] = (unsigned int)dfs_hist2_pw & 0x000000ff; + g_pw[4] = (unsigned int)((dfs_hist1_pw & 0xff000000) >> 24); + g_pw[5] = (unsigned int)((dfs_hist1_pw & 0x00ff0000) >> 16); + + /*read pulse repetition interval hist report*/ + odm_set_bb_reg(dm, 0x19e4, BIT(22) | BIT(23), 0x3); + dfs_hist1_pri = odm_get_bb_reg(dm, 0xf5c, 0xffffffff); + dfs_hist2_pri = odm_get_bb_reg(dm, 0xf74, 0xffffffff); + odm_set_bb_reg(dm, 0x19b4, 0x10000000, 1); /*reset histo report*/ + odm_set_bb_reg(dm, 0x19b4, 0x10000000, 0); /*@continue histo report*/ + + g_pri[0] = (unsigned int)((dfs_hist2_pri & 0xff000000) >> 24); + g_pri[1] = (unsigned int)((dfs_hist2_pri & 0x00ff0000) >> 16); + g_pri[2] = (unsigned int)((dfs_hist2_pri & 0x0000ff00) >> 8); + g_pri[3] = (unsigned int)dfs_hist2_pri & 0x000000ff; + g_pri[4] = (unsigned int)((dfs_hist1_pri & 0xff000000) >> 24); + g_pri[5] = (unsigned int)((dfs_hist1_pri & 0x00ff0000) >> 16); + + dfs->pri_cond1 = 0; + dfs->pri_cond2 = 0; + dfs->pri_cond3 = 0; + dfs->pri_cond4 = 0; + dfs->pri_cond5 = 0; + dfs->pw_cond1 = 0; + dfs->pw_cond2 = 0; + dfs->pw_cond3 = 0; + dfs->pri_type3_4_cond1 = 0; /*@for ETSI*/ + dfs->pri_type3_4_cond2 = 0; /*@for ETSI*/ + dfs->pw_long_cond1 = 0; /*@for long radar*/ + dfs->pw_long_cond2 = 0; /*@for long radar*/ + dfs->pri_long_cond1 = 0; /*@for long radar*/ + dfs->pw_flag = 0; + dfs->pri_flag = 0; + dfs->pri_type3_4_flag = 0; /*@for ETSI*/ + dfs->long_radar_flag = 0; + dfs->pw_std = 0; /*The std(var) of reasonable num of pw group*/ + dfs->pri_std = 0; /*The std(var) of reasonable num of pri group*/ + + for (i = 0; i < 6; i++) { + dfs->pw_hold_sum[i] = 0; + dfs->pri_hold_sum[i] = 0; + dfs->pw_long_hold_sum[i] = 0; + dfs->pri_long_hold_sum[i] = 0; + } + + if (dfs->idle_mode == 1) + pri_th = dfs->pri_hist_th; + else + pri_th = dfs->pri_hist_th - 1; + + for (i = 0; i < 6; i++) { + dfs->pw_hold[dfs->hist_idx][i] = (u8)g_pw[i]; + dfs->pri_hold[dfs->hist_idx][i] = (u8)g_pri[i]; + /*@collect whole histogram report may take some time + *so we add the counter of 2 time slots in FCC and ETSI + */ + if (region_domain == 1 || region_domain == 3) { + dfs->pw_hold_sum[i] = dfs->pw_hold_sum[i] + + dfs->pw_hold[(dfs->hist_idx + 1) % 3][i] + + dfs->pw_hold[(dfs->hist_idx + 2) % 3][i]; + dfs->pri_hold_sum[i] = dfs->pri_hold_sum[i] + + dfs->pri_hold[(dfs->hist_idx + 1) % 3][i] + + dfs->pri_hold[(dfs->hist_idx + 2) % 3][i]; + } else{ + /*@collect whole histogram report may take some time, + *so we add the counter of 3 time slots in MKK or else + */ + dfs->pw_hold_sum[i] = dfs->pw_hold_sum[i] + + dfs->pw_hold[(dfs->hist_idx + 1) % 4][i] + + dfs->pw_hold[(dfs->hist_idx + 2) % 4][i] + + dfs->pw_hold[(dfs->hist_idx + 3) % 4][i]; + dfs->pri_hold_sum[i] = dfs->pri_hold_sum[i] + + dfs->pri_hold[(dfs->hist_idx + 1) % 4][i] + + dfs->pri_hold[(dfs->hist_idx + 2) % 4][i] + + dfs->pri_hold[(dfs->hist_idx + 3) % 4][i]; + } + } + /*@For long radar type*/ + for (i = 0; i < 6; i++) { + dfs->pw_long_hold[dfs->hist_long_idx][i] = (u8)g_pw[i]; + dfs->pri_long_hold[dfs->hist_long_idx][i] = (u8)g_pri[i]; + /*@collect whole histogram report may take some time, + *so we add the counter of 299 time slots for long radar + */ + for (j = 1; j < 300; j++) { + dfs->pw_long_hold_sum[i] = dfs->pw_long_hold_sum[i] + + dfs->pw_long_hold[(dfs->hist_long_idx + j) % 300][i]; + dfs->pri_long_hold_sum[i] = dfs->pri_long_hold_sum[i] + + dfs->pri_long_hold[(dfs->hist_long_idx + j) % 300][i]; + } + } + dfs->hist_idx++; + dfs->hist_long_idx++; + if (dfs->hist_long_idx == 300) + dfs->hist_long_idx = 0; + if (region_domain == 1 || region_domain == 3) { + if (dfs->hist_idx == 3) + dfs->hist_idx = 0; + } else if (dfs->hist_idx == 4) { + dfs->hist_idx = 0; + } + + max_pri_cnt = 0; + max_pri_idx = 0; + max_pw_cnt = 0; + max_pw_idx = 0; + max_pri_cnt_th = dfs->pri_sum_g1_th; + max_pri_cnt_fcc_g1_th = dfs->pri_sum_g1_fcc_th; + max_pri_cnt_fcc_g3_th = dfs->pri_sum_g3_fcc_th; + safe_pri_pw_diff_th = dfs->pri_pw_diff_th; + safe_pri_pw_diff_fcc_th = dfs->pri_pw_diff_fcc_th; + safe_pri_pw_diff_fcc_idle_th = dfs->pri_pw_diff_fcc_idle_th; + safe_pri_pw_diff_w53_th = dfs->pri_pw_diff_w53_th; + + /*@g1 to g4 is the reseasonable range of pri and pw*/ + for (i = 1; i <= 4; i++) { + if (dfs->pri_hold_sum[i] > max_pri_cnt) { + max_pri_cnt = dfs->pri_hold_sum[i]; + max_pri_idx = i; + } + if (dfs->pw_hold_sum[i] > max_pw_cnt) { + max_pw_cnt = dfs->pw_hold_sum[i]; + max_pw_idx = i; + } + if (dfs->pri_hold_sum[i] >= pri_th) + dfs->pri_cond1 = 1; + } + + pri_sum_g0g5 = dfs->pri_hold_sum[0]; + if (pri_sum_g0g5 == 0) + pri_sum_g0g5 = 1; + pri_sum_g1g2g3g4 = dfs->pri_hold_sum[1] + dfs->pri_hold_sum[2] + + dfs->pri_hold_sum[3] + dfs->pri_hold_sum[4]; + + /*pw will reduce because of dc, so we do not treat g0 as illegal group*/ + pw_sum_g0g5 = dfs->pw_hold_sum[5]; + if (pw_sum_g0g5 == 0) + pw_sum_g0g5 = 1; + pw_sum_g1g2g3g4 = dfs->pw_hold_sum[1] + dfs->pw_hold_sum[2] + + dfs->pw_hold_sum[3] + dfs->pw_hold_sum[4]; + + /*@Calculate the variation from g1 to g4*/ + for (i = 1; i < 5; i++) { + /*Sum of square*/ + pw_sum_ss_g1g2g3g4 = pw_sum_ss_g1g2g3g4 + + (dfs->pw_hold_sum[i] - (pw_sum_g1g2g3g4 / 4)) * + (dfs->pw_hold_sum[i] - (pw_sum_g1g2g3g4 / 4)); + pri_sum_ss_g1g2g3g4 = pri_sum_ss_g1g2g3g4 + + (dfs->pri_hold_sum[i] - (pri_sum_g1g2g3g4 / 4)) * + (dfs->pri_hold_sum[i] - (pri_sum_g1g2g3g4 / 4)); + } + /*The value may less than the normal variance, + *since the variable type is int (not float) + */ + dfs->pw_std = (u16)(pw_sum_ss_g1g2g3g4 / 4); + dfs->pri_std = (u16)(pri_sum_ss_g1g2g3g4 / 4); + + if (region_domain == 1) { + dfs->pri_type3_4_flag = 1; /*@ETSI flag*/ + + /*PRI judgment conditions for short radar type*/ + /*ratio of reasonable group and illegal group && + *pri variation of short radar should be large (=6) + */ + if (max_pri_idx != 4 && dfs->pri_hold_sum[5] > 0) + dfs->pri_cond2 = 0; + else + dfs->pri_cond2 = 1; + + /*reasonable group shouldn't large*/ + if ((pri_sum_g0g5 + pri_sum_g1g2g3g4) / pri_sum_g0g5 > 2 && + pri_sum_g1g2g3g4 <= dfs->pri_sum_safe_fcc_th) + dfs->pri_cond3 = 1; + + /*@Cancel the condition that the abs between pri and pw*/ + if (dfs->pri_std >= dfs->pri_std_th) + dfs->pri_cond4 = 1; + else if (max_pri_idx == 1 && + max_pri_cnt >= max_pri_cnt_fcc_g1_th) + dfs->pri_cond4 = 1; + + /*we set threshold = 7 (>4) for distinguishing type 3,4 (g3)*/ + if (max_pri_idx == 1 && dfs->pri_hold_sum[3] + + dfs->pri_hold_sum[4] + dfs->pri_hold_sum[5] > 0) + dfs->pri_cond5 = 0; + else + dfs->pri_cond5 = 1; + + if (dfs->pri_cond1 && dfs->pri_cond2 && dfs->pri_cond3 && + dfs->pri_cond4 && dfs->pri_cond5) + dfs->pri_flag = 1; + + /* PW judgment conditions for short radar type */ + /*ratio of reasonable and illegal group && g5 should be zero*/ + if (((pw_sum_g0g5 + pw_sum_g1g2g3g4) / pw_sum_g0g5 > 2) && + (dfs->pw_hold_sum[5] <= 1)) + dfs->pw_cond1 = 1; + /*unreasonable group*/ + if (dfs->pw_hold_sum[4] == 0 && dfs->pw_hold_sum[5] == 0) + dfs->pw_cond2 = 1; + /*pw's std (short radar) should be large(=7)*/ + if (dfs->pw_std >= dfs->pw_std_th) + dfs->pw_cond3 = 1; + if (dfs->pw_cond1 && dfs->pw_cond2 && dfs->pw_cond3) + dfs->pw_flag = 1; + + /* @Judgment conditions of long radar type */ + if (band_width == CHANNEL_WIDTH_20) { + if (dfs->pw_long_hold_sum[4] >= + dfs->pw_long_lower_20m_th) + dfs->pw_long_cond1 = 1; + } else{ + if (dfs->pw_long_hold_sum[4] >= dfs->pw_long_lower_th) + dfs->pw_long_cond1 = 1; + } + /* @Disable the condition that dfs->pw_long_hold_sum[1] */ + if (dfs->pw_long_hold_sum[2] + dfs->pw_long_hold_sum[3] + + dfs->pw_long_hold_sum[4] <= dfs->pw_long_sum_upper_th && + dfs->pw_long_hold_sum[2] <= dfs->pw_long_hold_sum[4] && + dfs->pw_long_hold_sum[3] <= dfs->pw_long_hold_sum[4]) + dfs->pw_long_cond2 = 1; + /*@g4 should be large for long radar*/ + if (dfs->pri_long_hold_sum[4] <= dfs->pri_long_upper_th) + dfs->pri_long_cond1 = 1; + if (dfs->pw_long_cond1 && dfs->pw_long_cond2 && + dfs->pri_long_cond1) + dfs->long_radar_flag = 1; + } else if (region_domain == 2) { + dfs->pri_type3_4_flag = 1; /*@ETSI flag*/ + + /*PRI judgment conditions for short radar type*/ + if ((pri_sum_g0g5 + pri_sum_g1g2g3g4) / pri_sum_g0g5 > 2) + dfs->pri_cond2 = 1; + + /*reasonable group shouldn't too large*/ + if (pri_sum_g1g2g3g4 <= dfs->pri_sum_safe_fcc_th) + dfs->pri_cond3 = 1; + + /*Cancel the abs diff between pri and pw for idle mode (thr=2)*/ + dfs->pri_cond4 = 1; + + if (dfs->idle_mode == 1) { + if (dfs->pri_std >= dfs->pri_std_idle_th) { + if (max_pw_idx == 3 && + pri_sum_g1g2g3g4 <= dfs->pri_sum_type4_th){ + /*To distinguish between type 4 radar and false detection*/ + dfs->pri_cond5 = 1; + } else if (max_pw_idx == 1 && + pri_sum_g1g2g3g4 >= + dfs->pri_sum_type6_th) { + /*To distinguish between type 6 radar and false detection*/ + dfs->pri_cond5 = 1; + } else { + /*pri variation of short radar should be large (idle mode)*/ + dfs->pri_cond5 = 1; + } + } + } else { + /*pri variation of short radar should be large (TP mode)*/ + if (dfs->pri_std >= dfs->pri_std_th) + dfs->pri_cond5 = 1; + } + + if (dfs->pri_cond1 && dfs->pri_cond2 && dfs->pri_cond3 && + dfs->pri_cond4 && dfs->pri_cond5) + dfs->pri_flag = 1; + + /* PW judgment conditions for short radar type */ + if (((pw_sum_g0g5 + pw_sum_g1g2g3g4) / pw_sum_g0g5 > 2) && + (dfs->pw_hold_sum[5] <= 1)) + /*ratio of reasonable and illegal group && g5 should be zero*/ + dfs->pw_cond1 = 1; + + if ((c_channel >= 52) && (c_channel <= 64)) + dfs->pw_cond2 = 1; + /*unreasonable group shouldn't too large*/ + else if (dfs->pw_hold_sum[0] <= dfs->pw_g0_th) + dfs->pw_cond2 = 1; + + if (dfs->idle_mode == 1) { + /*pw variation of short radar should be large (idle mode)*/ + if (dfs->pw_std >= dfs->pw_std_idle_th) + dfs->pw_cond3 = 1; + } else { + /*pw variation of short radar should be large (TP mode)*/ + if (dfs->pw_std >= dfs->pw_std_th) + dfs->pw_cond3 = 1; + } + if (dfs->pw_cond1 && dfs->pw_cond2 && dfs->pw_cond3) + dfs->pw_flag = 1; + + /* @Judgment conditions of long radar type */ + if (band_width == CHANNEL_WIDTH_20) { + if (dfs->pw_long_hold_sum[4] >= + dfs->pw_long_lower_20m_th) + dfs->pw_long_cond1 = 1; + } else{ + if (dfs->pw_long_hold_sum[4] >= dfs->pw_long_lower_th) + dfs->pw_long_cond1 = 1; + } + if (dfs->pw_long_hold_sum[1] + dfs->pw_long_hold_sum[2] + + dfs->pw_long_hold_sum[3] + dfs->pw_long_hold_sum[4] + <= dfs->pw_long_sum_upper_th) + dfs->pw_long_cond2 = 1; + /*@g4 should be large for long radar*/ + if (dfs->pri_long_hold_sum[4] <= dfs->pri_long_upper_th) + dfs->pri_long_cond1 = 1; + if (dfs->pw_long_cond1 && + dfs->pw_long_cond2 && dfs->pri_long_cond1) + dfs->long_radar_flag = 1; + } else if (region_domain == 3) { + /*ratio of reasonable group and illegal group */ + if ((pri_sum_g0g5 + pri_sum_g1g2g3g4) / pri_sum_g0g5 > 2) + dfs->pri_cond2 = 1; + + if (pri_sum_g1g2g3g4 <= dfs->pri_sum_safe_th) + dfs->pri_cond3 = 1; + + /*@Cancel the condition that the abs between pri and pw*/ + dfs->pri_cond4 = 1; + + if (dfs->pri_hold_sum[5] <= dfs->pri_sum_g5_th) + dfs->pri_cond5 = 1; + + if (band_width == CHANNEL_WIDTH_40) { + if (max_pw_idx == 4) { + if (max_pw_cnt >= dfs->type4_pw_max_cnt && + pri_sum_g1g2g3g4 >= + dfs->type4_safe_pri_sum_th) { + dfs->pri_cond1 = 1; + dfs->pri_cond4 = 1; + dfs->pri_type3_4_cond1 = 1; + } + } + } + + if (dfs->pri_cond1 && dfs->pri_cond2 && + dfs->pri_cond3 && dfs->pri_cond4 && dfs->pri_cond5) + dfs->pri_flag = 1; + + if (((pw_sum_g0g5 + pw_sum_g1g2g3g4) / pw_sum_g0g5 > 2)) + dfs->pw_flag = 1; + + /*@max num pri group is g1 means radar type3 or type4*/ + if (max_pri_idx == 1) { + if (max_pri_cnt >= max_pri_cnt_th) + dfs->pri_type3_4_cond1 = 1; + if (dfs->pri_hold_sum[4] <= + dfs->pri_sum_g5_under_g1_th && + dfs->pri_hold_sum[5] <= dfs->pri_sum_g5_under_g1_th) + dfs->pri_type3_4_cond2 = 1; + } else { + dfs->pri_type3_4_cond1 = 1; + dfs->pri_type3_4_cond2 = 1; + } + if (dfs->pri_type3_4_cond1 && dfs->pri_type3_4_cond2) + dfs->pri_type3_4_flag = 1; + } else { + } + + if (dfs->print_hist_rpt) { + dfs_pw_thd1 = (u8)odm_get_bb_reg(dm, 0x19e4, 0xff000000); + dfs_pw_thd2 = (u8)odm_get_bb_reg(dm, 0x19e8, 0x000000ff); + dfs_pw_thd3 = (u8)odm_get_bb_reg(dm, 0x19e8, 0x0000ff00); + dfs_pw_thd4 = (u8)odm_get_bb_reg(dm, 0x19e8, 0x00ff0000); + dfs_pw_thd5 = (u8)odm_get_bb_reg(dm, 0x19e8, 0xff000000); + + dfs_pri_thd1 = (u8)odm_get_bb_reg(dm, 0x19b8, 0x7F80); + dfs_pri_thd2 = (u8)odm_get_bb_reg(dm, 0x19ec, 0x000000ff); + dfs_pri_thd3 = (u8)odm_get_bb_reg(dm, 0x19ec, 0x0000ff00); + dfs_pri_thd4 = (u8)odm_get_bb_reg(dm, 0x19ec, 0x00ff0000); + dfs_pri_thd5 = (u8)odm_get_bb_reg(dm, 0x19ec, 0xff000000); + + PHYDM_DBG(dm, DBG_DFS, "peak index hist\n"); + PHYDM_DBG(dm, DBG_DFS, "dfs_hist_peak_index=%x %x\n", + dfs_hist1_peak_index, dfs_hist2_peak_index); + PHYDM_DBG(dm, DBG_DFS, "g_peak_index_hist = "); + for (i = 0; i < 16; i++) + PHYDM_DBG(dm, DBG_DFS, " %x", g_peakindex[i]); + PHYDM_DBG(dm, DBG_DFS, "\ndfs_pw_thd=%d %d %d %d %d\n", + dfs_pw_thd1, dfs_pw_thd2, dfs_pw_thd3, + dfs_pw_thd4, dfs_pw_thd5); + PHYDM_DBG(dm, DBG_DFS, "-----pulse width hist-----\n"); + PHYDM_DBG(dm, DBG_DFS, "dfs_hist_pw=%x %x\n", + dfs_hist1_pw, dfs_hist2_pw); + PHYDM_DBG(dm, DBG_DFS, "g_pw_hist = %x %x %x %x %x %x\n", + g_pw[0], g_pw[1], g_pw[2], g_pw[3], + g_pw[4], g_pw[5]); + PHYDM_DBG(dm, DBG_DFS, "dfs_pri_thd=%d %d %d %d %d\n", + dfs_pri_thd1, dfs_pri_thd2, dfs_pri_thd3, + dfs_pri_thd4, dfs_pri_thd5); + PHYDM_DBG(dm, DBG_DFS, "-----pulse interval hist-----\n"); + PHYDM_DBG(dm, DBG_DFS, "dfs_hist_pri=%x %x\n", + dfs_hist1_pri, dfs_hist2_pri); + PHYDM_DBG(dm, DBG_DFS, + "g_pri_hist = %x %x %x %x %x %x, pw_flag = %d, pri_flag = %d\n", + g_pri[0], g_pri[1], g_pri[2], g_pri[3], g_pri[4], + g_pri[5], dfs->pw_flag, dfs->pri_flag); + if (region_domain == 1 || region_domain == 3) { + PHYDM_DBG(dm, DBG_DFS, "hist_idx= %d\n", + (dfs->hist_idx + 2) % 3); + } else { + PHYDM_DBG(dm, DBG_DFS, "hist_idx= %d\n", + (dfs->hist_idx + 3) % 4); + } + PHYDM_DBG(dm, DBG_DFS, "hist_long_idx= %d\n", + (dfs->hist_long_idx + 299) % 300); + PHYDM_DBG(dm, DBG_DFS, + "pw_sum_g0g5 = %d, pw_sum_g1g2g3g4 = %d\n", + pw_sum_g0g5, pw_sum_g1g2g3g4); + PHYDM_DBG(dm, DBG_DFS, + "pri_sum_g0g5 = %d, pri_sum_g1g2g3g4 = %d\n", + pri_sum_g0g5, pri_sum_g1g2g3g4); + PHYDM_DBG(dm, DBG_DFS, "pw_hold_sum = %d %d %d %d %d %d\n", + dfs->pw_hold_sum[0], dfs->pw_hold_sum[1], + dfs->pw_hold_sum[2], dfs->pw_hold_sum[3], + dfs->pw_hold_sum[4], dfs->pw_hold_sum[5]); + PHYDM_DBG(dm, DBG_DFS, "pri_hold_sum = %d %d %d %d %d %d\n", + dfs->pri_hold_sum[0], dfs->pri_hold_sum[1], + dfs->pri_hold_sum[2], dfs->pri_hold_sum[3], + dfs->pri_hold_sum[4], dfs->pri_hold_sum[5]); + PHYDM_DBG(dm, DBG_DFS, "pw_long_hold_sum = %d %d %d %d %d %d\n", + dfs->pw_long_hold_sum[0], dfs->pw_long_hold_sum[1], + dfs->pw_long_hold_sum[2], dfs->pw_long_hold_sum[3], + dfs->pw_long_hold_sum[4], dfs->pw_long_hold_sum[5]); + PHYDM_DBG(dm, DBG_DFS, + "pri_long_hold_sum = %d %d %d %d %d %d\n", + dfs->pri_long_hold_sum[0], dfs->pri_long_hold_sum[1], + dfs->pri_long_hold_sum[2], dfs->pri_long_hold_sum[3], + dfs->pri_long_hold_sum[4], dfs->pri_long_hold_sum[5]); + PHYDM_DBG(dm, DBG_DFS, "idle_mode = %d\n", dfs->idle_mode); + PHYDM_DBG(dm, DBG_DFS, "pw_standard = %d\n", dfs->pw_std); + PHYDM_DBG(dm, DBG_DFS, "pri_standard = %d\n", dfs->pri_std); + for (j = 0; j < 4; j++) { + for (i = 0; i < 6; i++) { + PHYDM_DBG(dm, DBG_DFS, "pri_hold = %d ", + dfs->pri_hold[j][i]); + } + PHYDM_DBG(dm, DBG_DFS, "\n"); + } + PHYDM_DBG(dm, DBG_DFS, "\n"); + PHYDM_DBG(dm, DBG_DFS, + "pri_cond1 = %d, pri_cond2 = %d, pri_cond3 = %d, pri_cond4 = %d, pri_cond5 = %d\n", + dfs->pri_cond1, dfs->pri_cond2, dfs->pri_cond3, + dfs->pri_cond4, dfs->pri_cond5); + PHYDM_DBG(dm, DBG_DFS, + "bandwidth = %d, pri_th = %d, max_pri_cnt_th = %d, safe_pri_pw_diff_th = %d\n", + band_width, pri_th, max_pri_cnt_th, + safe_pri_pw_diff_th); + } +} + +boolean phydm_dfs_hist_log(void *dm_void, u8 index) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _DFS_STATISTICS *dfs = &dm->dfs; + u8 i = 0, j = 0; + boolean hist_radar_detected = 0; + + if (dfs->pulse_type_hist[index] == 0) { + dfs->radar_type = 0; + if (dfs->pw_flag && dfs->pri_flag && + dfs->pri_type3_4_flag) { + hist_radar_detected = 1; + PHYDM_DBG(dm, DBG_DFS, + "Detected type %d radar signal!\n", + dfs->radar_type); + if (dfs->det_print2) { + PHYDM_DBG(dm, DBG_DFS, + "hist_idx= %d\n", + (dfs->hist_idx + 3) % 4); + for (j = 0; j < 4; j++) { + for (i = 0; i < 6; i++) { + PHYDM_DBG(dm, DBG_DFS, + "pri_hold = %d ", + dfs->pri_hold[j][i]); + } + PHYDM_DBG(dm, DBG_DFS, "\n"); + } + PHYDM_DBG(dm, DBG_DFS, "\n"); + for (j = 0; j < 4; j++) { + for (i = 0; i < 6; i++) { + PHYDM_DBG(dm, DBG_DFS, "pw_hold = %d ", + dfs->pw_hold[j][i]); + } + PHYDM_DBG(dm, DBG_DFS, "\n"); + } + PHYDM_DBG(dm, DBG_DFS, "\n"); + PHYDM_DBG(dm, DBG_DFS, "idle_mode = %d\n", + dfs->idle_mode); + PHYDM_DBG(dm, DBG_DFS, + "pw_hold_sum = %d %d %d %d %d %d\n", + dfs->pw_hold_sum[0], + dfs->pw_hold_sum[1], + dfs->pw_hold_sum[2], + dfs->pw_hold_sum[3], + dfs->pw_hold_sum[4], + dfs->pw_hold_sum[5]); + PHYDM_DBG(dm, DBG_DFS, + "pri_hold_sum = %d %d %d %d %d %d\n", + dfs->pri_hold_sum[0], + dfs->pri_hold_sum[1], + dfs->pri_hold_sum[2], + dfs->pri_hold_sum[3], + dfs->pri_hold_sum[4], + dfs->pri_hold_sum[5]); + } + } else { + if (dfs->det_print2) { + if (dfs->pulse_flag_hist[index] && + dfs->pri_flag == 0) { + PHYDM_DBG(dm, DBG_DFS, "pri_variation = %d\n", + dfs->pri_std); + PHYDM_DBG(dm, DBG_DFS, + "PRI criterion is not satisfied!\n"); + if (dfs->pri_cond1 == 0) + PHYDM_DBG(dm, DBG_DFS, + "pri_cond1 is not satisfied!\n"); + if (dfs->pri_cond2 == 0) + PHYDM_DBG(dm, DBG_DFS, + "pri_cond2 is not satisfied!\n"); + if (dfs->pri_cond3 == 0) + PHYDM_DBG(dm, DBG_DFS, + "pri_cond3 is not satisfied!\n"); + if (dfs->pri_cond4 == 0) + PHYDM_DBG(dm, DBG_DFS, + "pri_cond4 is not satisfied!\n"); + if (dfs->pri_cond5 == 0) + PHYDM_DBG(dm, DBG_DFS, + "pri_cond5 is not satisfied!\n"); + } + if (dfs->pulse_flag_hist[index] && + dfs->pw_flag == 0) { + PHYDM_DBG(dm, DBG_DFS, "pw_variation = %d\n", + dfs->pw_std); + PHYDM_DBG(dm, DBG_DFS, + "PW criterion is not satisfied!\n"); + if (dfs->pw_cond1 == 0) + PHYDM_DBG(dm, DBG_DFS, + "pw_cond1 is not satisfied!\n"); + if (dfs->pw_cond2 == 0) + PHYDM_DBG(dm, DBG_DFS, + "pw_cond2 is not satisfied!\n"); + if (dfs->pw_cond3 == 0) + PHYDM_DBG(dm, DBG_DFS, + "pw_cond3 is not satisfied!\n"); + } + if (dfs->pulse_flag_hist[index] && + (dfs->pri_type3_4_flag == 0)) { + PHYDM_DBG(dm, DBG_DFS, + "pri_type3_4 criterion is not satisfied!\n"); + if (dfs->pri_type3_4_cond1 == 0) + PHYDM_DBG(dm, DBG_DFS, + "pri_type3_4_cond1 is not satisfied!\n"); + if (dfs->pri_type3_4_cond2 == 0) + PHYDM_DBG(dm, DBG_DFS, + "pri_type3_4_cond2 is not satisfied!\n"); + } + PHYDM_DBG(dm, DBG_DFS, "hist_idx= %d\n", + (dfs->hist_idx + 3) % 4); + for (j = 0; j < 4; j++) { + for (i = 0; i < 6; i++) { + PHYDM_DBG(dm, DBG_DFS, + "pri_hold = %d ", + dfs->pri_hold[j][i]); + } + PHYDM_DBG(dm, DBG_DFS, "\n"); + } + PHYDM_DBG(dm, DBG_DFS, "\n"); + for (j = 0; j < 4; j++) { + for (i = 0; i < 6; i++) + PHYDM_DBG(dm, DBG_DFS, + "pw_hold = %d ", + dfs->pw_hold[j][i]); + PHYDM_DBG(dm, DBG_DFS, "\n"); + } + PHYDM_DBG(dm, DBG_DFS, "\n"); + PHYDM_DBG(dm, DBG_DFS, "idle_mode = %d\n", + dfs->idle_mode); + PHYDM_DBG(dm, DBG_DFS, + "pw_hold_sum = %d %d %d %d %d %d\n", + dfs->pw_hold_sum[0], dfs->pw_hold_sum[1], + dfs->pw_hold_sum[2], dfs->pw_hold_sum[3], + dfs->pw_hold_sum[4], dfs->pw_hold_sum[5]); + PHYDM_DBG(dm, DBG_DFS, + "pri_hold_sum = %d %d %d %d %d %d\n", + dfs->pri_hold_sum[0], dfs->pri_hold_sum[1], + dfs->pri_hold_sum[2], dfs->pri_hold_sum[3], + dfs->pri_hold_sum[4], dfs->pri_hold_sum[5]); + } } } else { - /* not supported IC type*/ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DFS, ODM_DBG_LOUD, ("Unsupported IC type:%d\n", p_dm_odm->support_ic_type)); + dfs->radar_type = 1; + if (dfs->det_print2) { + PHYDM_DBG(dm, DBG_DFS, "\n"); + PHYDM_DBG(dm, DBG_DFS, "idle_mode = %d\n", + dfs->idle_mode); + PHYDM_DBG(dm, DBG_DFS, + "long_radar_pw_hold_sum = %d %d %d %d %d %d\n", + dfs->pw_long_hold_sum[0], + dfs->pw_long_hold_sum[1], + dfs->pw_long_hold_sum[2], + dfs->pw_long_hold_sum[3], + dfs->pw_long_hold_sum[4], + dfs->pw_long_hold_sum[5]); + PHYDM_DBG(dm, DBG_DFS, + "long_radar_pri_hold_sum = %d %d %d %d %d %d\n", + dfs->pri_long_hold_sum[0], + dfs->pri_long_hold_sum[1], + dfs->pri_long_hold_sum[2], + dfs->pri_long_hold_sum[3], + dfs->pri_long_hold_sum[4], + dfs->pri_long_hold_sum[5]); + } + /* @Long radar should satisfy three conditions */ + if (dfs->long_radar_flag == 1) { + hist_radar_detected = 1; + PHYDM_DBG(dm, DBG_DFS, + "Detected type %d radar signal!\n", + dfs->radar_type); + } else { + if (dfs->det_print2) { + if (dfs->pw_long_cond1 == 0) + PHYDM_DBG(dm, DBG_DFS, + "--pw_long_cond1 is not satisfied!--\n"); + if (dfs->pw_long_cond2 == 0) + PHYDM_DBG(dm, DBG_DFS, + "--pw_long_cond2 is not satisfied!--\n"); + if (dfs->pri_long_cond1 == 0) + PHYDM_DBG(dm, DBG_DFS, + "--pri_long_cond1 is not satisfied!--\n"); + } + } } - -exit: - phydm_radar_detect_reset(p_dm_odm); + return hist_radar_detected; } -bool phydm_radar_detect(void *p_dm_void) +boolean phydm_radar_detect(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - bool enable_DFS = false; - bool radar_detected = false; - u8 region_domain = p_dm_odm->dfs_region_domain; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _DFS_STATISTICS *dfs = &dm->dfs; + boolean enable_DFS = false; + boolean radar_detected = false; - if (region_domain == PHYDM_DFS_DOMAIN_UNKNOWN) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DFS, ODM_DBG_LOUD, ("PHYDM_DFS_DOMAIN_UNKNOWN\n")); - return false; + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + dfs->igi_cur = (u8)odm_get_bb_reg(dm, R_0x1d70, 0x0000007f); + dfs->st_l2h_cur = (u8)odm_get_bb_reg(dm, R_0xa40, 0x00007f00); + #if (RTL8721D_SUPPORT) + } else if (dm->support_ic_type & (ODM_RTL8721D)) { + dfs->st_l2h_cur = (u8)(odm_get_bb_reg(dm, R_0xf54, + 0x0000001f) << 2); + dfs->st_l2h_cur += (u8)odm_get_bb_reg(dm, R_0xf58, 0xc0000000); + #endif + } else { + dfs->igi_cur = (u8)odm_get_bb_reg(dm, R_0xc50, 0x0000007f); + dfs->st_l2h_cur = (u8)odm_get_bb_reg(dm, R_0x91c, 0x000000ff); } - if (odm_get_bb_reg(p_dm_odm, 0x924, BIT(15))) - enable_DFS = true; + /* @dynamic pwdb calibration */ + if (dfs->igi_pre != dfs->igi_cur) { + dfs->pwdb_th_cur = ((int)dfs->st_l2h_cur - (int)dfs->igi_cur) + / 2 + dfs->pwdb_scalar_factor; - if ((odm_get_bb_reg(p_dm_odm, 0xf98, BIT(17))) - || (!(region_domain == PHYDM_DFS_DOMAIN_ETSI) && (odm_get_bb_reg(p_dm_odm, 0xf98, BIT(19))))) - radar_detected = true; + /* @limit the pwdb value to absolute lower bound 0xa */ + dfs->pwdb_th_cur = MAX_2(dfs->pwdb_th_cur, (int)dfs->pwdb_th); + /* @limit the pwdb value to absolute upper bound 0x1f */ + dfs->pwdb_th_cur = MIN_2(dfs->pwdb_th_cur, 0x1f); + + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + odm_set_bb_reg(dm, R_0xa50, 0x000000f0, + dfs->pwdb_th_cur); + #if (RTL8721D_SUPPORT) + else if (dm->support_ic_type & (ODM_RTL8721D)) + odm_set_bb_reg(dm, R_0xf70, 0x03c00000, + dfs->pwdb_th_cur); + #endif + else + odm_set_bb_reg(dm, R_0x918, 0x00001f00, + dfs->pwdb_th_cur); + } + + dfs->igi_pre = dfs->igi_cur; + + phydm_dfs_dynamic_setting(dm); + if (dm->support_ic_type & (ODM_RTL8814A | ODM_RTL8822B | ODM_RTL8821C)) + phydm_dfs_histogram_radar_distinguish(dm); + radar_detected = phydm_radar_detect_dm_check(dm); + + if (dm->support_ic_type & (ODM_RTL8198F | ODM_RTL8822C | ODM_RTL8812F | + ODM_RTL8197G)) { + if (odm_get_bb_reg(dm, R_0xa40, BIT(15))) + enable_DFS = true; + #if (RTL8721D_SUPPORT) + } else if (dm->support_ic_type & (ODM_RTL8721D)) { + if (odm_get_bb_reg(dm, R_0xf58, BIT(29))) + enable_DFS = true; + #endif + } else if (dm->support_ic_type & (ODM_RTL8814B)) { + if (dm->seg1_dfs_flag == 1) { + if (odm_get_bb_reg(dm, R_0xa6c, BIT(15))) + enable_DFS = true; + } else if (odm_get_bb_reg(dm, R_0xa40, BIT(15))) + enable_DFS = true; + } else { + if (odm_get_bb_reg(dm, R_0x924, BIT(15))) + enable_DFS = true; + } if (enable_DFS && radar_detected) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DFS, ODM_DBG_LOUD - , ("Radar detect: enable_DFS:%d, radar_detected:%d\n" - , enable_DFS, radar_detected)); - - phydm_radar_detect_reset(p_dm_odm); + PHYDM_DBG(dm, DBG_DFS, + "Radar detect: enable_DFS:%d, radar_detected:%d\n", + enable_DFS, radar_detected); + phydm_radar_detect_reset(dm); + if (dfs->dbg_mode == 1) { + PHYDM_DBG(dm, DBG_DFS, + "Radar is detected in DFS dbg mode.\n"); + radar_detected = 0; + } + } + + if (enable_DFS && dfs->sw_trigger_mode == 1) { + radar_detected = 1; + PHYDM_DBG(dm, DBG_DFS, + "Radar is detected in DFS SW trigger mode.\n"); } -exit: return enable_DFS && radar_detected; } -#endif /* defined(CONFIG_PHYDM_DFS_MASTER) */ -bool -phydm_dfs_master_enabled( - void *p_dm_void -) +void phydm_dfs_hist_dbg(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _DFS_STATISTICS *dfs = &dm->dfs; + char help[] = "-h"; + u32 argv[30] = {0}; + u32 used = *_used; + u32 out_len = *_out_len; + u8 i; + + if ((strcmp(input[1], help) == 0)) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "{0} pri_hist_th = %d\n", dfs->pri_hist_th); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{1} pri_sum_g1_th = %d\n", dfs->pri_sum_g1_th); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{2} pri_sum_g5_th = %d\n", dfs->pri_sum_g5_th); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{3} pri_sum_g1_fcc_th = %d\n", + dfs->pri_sum_g1_fcc_th); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{4} pri_sum_g3_fcc_th = %d\n", + dfs->pri_sum_g3_fcc_th); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{5} pri_sum_safe_fcc_th = %d\n", + dfs->pri_sum_safe_fcc_th); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{6} pri_sum_type4_th = %d\n", dfs->pri_sum_type4_th); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{7} pri_sum_type6_th = %d\n", dfs->pri_sum_type6_th); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{8} pri_sum_safe_th = %d\n", dfs->pri_sum_safe_th); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{9} pri_sum_g5_under_g1_th = %d\n", + dfs->pri_sum_g5_under_g1_th); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{10} pri_pw_diff_th = %d\n", dfs->pri_pw_diff_th); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{11} pri_pw_diff_fcc_th = %d\n", + dfs->pri_pw_diff_fcc_th); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{12} pri_pw_diff_fcc_idle_th = %d\n", + dfs->pri_pw_diff_fcc_idle_th); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{13} pri_pw_diff_w53_th = %d\n", + dfs->pri_pw_diff_w53_th); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{14} pri_type1_low_fcc_th = %d\n", + dfs->pri_type1_low_fcc_th); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{15} pri_type1_upp_fcc_th = %d\n", + dfs->pri_type1_upp_fcc_th); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{16} pri_type1_cen_fcc_th = %d\n", + dfs->pri_type1_cen_fcc_th); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{17} pw_g0_th = %d\n", dfs->pw_g0_th); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{18} pw_long_lower_20m_th = %d\n", + dfs->pw_long_lower_20m_th); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{19} pw_long_lower_th = %d\n", + dfs->pw_long_lower_th); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{20} pri_long_upper_th = %d\n", + dfs->pri_long_upper_th); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{21} pw_long_sum_upper_th = %d\n", + dfs->pw_long_sum_upper_th); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{22} pw_std_th = %d\n", dfs->pw_std_th); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{23} pw_std_idle_th = %d\n", dfs->pw_std_idle_th); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{24} pri_std_th = %d\n", dfs->pri_std_th); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{25} pri_std_idle_th = %d\n", dfs->pri_std_idle_th); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{26} type4_pw_max_cnt = %d\n", dfs->type4_pw_max_cnt); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{27} type4_safe_pri_sum_th = %d\n", + dfs->type4_safe_pri_sum_th); + } else { + PHYDM_SSCANF(input[1], DCMD_DECIMAL, &argv[0]); + + for (i = 1; i < 30; i++) { + if (input[i + 1]) + PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, + &argv[i]); + } + if (argv[0] == 0) { + dfs->pri_hist_th = (u8)argv[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "pri_hist_th = %d\n", + dfs->pri_hist_th); + } else if (argv[0] == 1) { + dfs->pri_sum_g1_th = (u8)argv[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "pri_sum_g1_th = %d\n", + dfs->pri_sum_g1_th); + } else if (argv[0] == 2) { + dfs->pri_sum_g5_th = (u8)argv[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "pri_sum_g5_th = %d\n", + dfs->pri_sum_g5_th); + } else if (argv[0] == 3) { + dfs->pri_sum_g1_fcc_th = (u8)argv[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "pri_sum_g1_fcc_th = %d\n", + dfs->pri_sum_g1_fcc_th); + } else if (argv[0] == 4) { + dfs->pri_sum_g3_fcc_th = (u8)argv[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "pri_sum_g3_fcc_th = %d\n", + dfs->pri_sum_g3_fcc_th); + } else if (argv[0] == 5) { + dfs->pri_sum_safe_fcc_th = (u8)argv[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "pri_sum_safe_fcc_th = %d\n", + dfs->pri_sum_safe_fcc_th); + } else if (argv[0] == 6) { + dfs->pri_sum_type4_th = (u8)argv[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "pri_sum_type4_th = %d\n", + dfs->pri_sum_type4_th); + } else if (argv[0] == 7) { + dfs->pri_sum_type6_th = (u8)argv[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "pri_sum_type6_th = %d\n", + dfs->pri_sum_type6_th); + } else if (argv[0] == 8) { + dfs->pri_sum_safe_th = (u8)argv[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "pri_sum_safe_th = %d\n", + dfs->pri_sum_safe_th); + } else if (argv[0] == 9) { + dfs->pri_sum_g5_under_g1_th = (u8)argv[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "pri_sum_g5_under_g1_th = %d\n", + dfs->pri_sum_g5_under_g1_th); + } else if (argv[0] == 10) { + dfs->pri_pw_diff_th = (u8)argv[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "pri_pw_diff_th = %d\n", + dfs->pri_pw_diff_th); + } else if (argv[0] == 11) { + dfs->pri_pw_diff_fcc_th = (u8)argv[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "pri_pw_diff_fcc_th = %d\n", + dfs->pri_pw_diff_fcc_th); + } else if (argv[0] == 12) { + dfs->pri_pw_diff_fcc_idle_th = (u8)argv[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "pri_pw_diff_fcc_idle_th = %d\n", + dfs->pri_pw_diff_fcc_idle_th); + } else if (argv[0] == 13) { + dfs->pri_pw_diff_w53_th = (u8)argv[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "pri_pw_diff_w53_th = %d\n", + dfs->pri_pw_diff_w53_th); + } else if (argv[0] == 14) { + dfs->pri_type1_low_fcc_th = (u8)argv[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "pri_type1_low_fcc_th = %d\n", + dfs->pri_type1_low_fcc_th); + } else if (argv[0] == 15) { + dfs->pri_type1_upp_fcc_th = (u8)argv[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "pri_type1_upp_fcc_th = %d\n", + dfs->pri_type1_upp_fcc_th); + } else if (argv[0] == 16) { + dfs->pri_type1_cen_fcc_th = (u8)argv[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "pri_type1_cen_fcc_th = %d\n", + dfs->pri_type1_cen_fcc_th); + } else if (argv[0] == 17) { + dfs->pw_g0_th = (u8)argv[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "pw_g0_th = %d\n", + dfs->pw_g0_th); + } else if (argv[0] == 18) { + dfs->pw_long_lower_20m_th = (u8)argv[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "pw_long_lower_20m_th = %d\n", + dfs->pw_long_lower_20m_th); + } else if (argv[0] == 19) { + dfs->pw_long_lower_th = (u8)argv[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "pw_long_lower_th = %d\n", + dfs->pw_long_lower_th); + } else if (argv[0] == 20) { + dfs->pri_long_upper_th = (u8)argv[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "pri_long_upper_th = %d\n", + dfs->pri_long_upper_th); + } else if (argv[0] == 21) { + dfs->pw_long_sum_upper_th = (u8)argv[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "pw_long_sum_upper_th = %d\n", + dfs->pw_long_sum_upper_th); + } else if (argv[0] == 22) { + dfs->pw_std_th = (u8)argv[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "pw_std_th = %d\n", + dfs->pw_std_th); + } else if (argv[0] == 23) { + dfs->pw_std_idle_th = (u8)argv[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "pw_std_idle_th = %d\n", + dfs->pw_std_idle_th); + } else if (argv[0] == 24) { + dfs->pri_std_th = (u8)argv[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "pri_std_th = %d\n", + dfs->pri_std_th); + } else if (argv[0] == 25) { + dfs->pri_std_idle_th = (u8)argv[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "pri_std_idle_th = %d\n", + dfs->pri_std_idle_th); + } else if (argv[0] == 26) { + dfs->type4_pw_max_cnt = (u8)argv[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "type4_pw_max_cnt = %d\n", + dfs->type4_pw_max_cnt); + } else if (argv[0] == 27) { + dfs->type4_safe_pri_sum_th = (u8)argv[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "type4_safe_pri_sum_th = %d\n", + dfs->type4_safe_pri_sum_th); + } + } + *_used = used; + *_out_len = out_len; +} + +void phydm_dfs_debug(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _DFS_STATISTICS *dfs = &dm->dfs; + u32 used = *_used; + u32 out_len = *_out_len; + u32 argv[10] = {0}; + u8 i, input_idx = 0; + + for (i = 0; i < 7; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_HEX, &argv[i]); + input_idx++; + } + } + + if (input_idx == 0) + return; + + dfs->dbg_mode = (boolean)argv[0]; + dfs->sw_trigger_mode = (boolean)argv[1]; + dfs->force_TP_mode = (boolean)argv[2]; + dfs->det_print = (boolean)argv[3]; + dfs->det_print2 = (boolean)argv[4]; + dfs->print_hist_rpt = (boolean)argv[5]; + dfs->hist_cond_on = (boolean)argv[6]; + + PDM_SNPF(out_len, used, output + used, out_len - used, + "dbg_mode: %d, sw_trigger_mode: %d, force_TP_mode: %d, det_print: %d,det_print2: %d, print_hist_rpt: %d, hist_cond_on: %d\n", + dfs->dbg_mode, dfs->sw_trigger_mode, dfs->force_TP_mode, + dfs->det_print, dfs->det_print2, dfs->print_hist_rpt, + dfs->hist_cond_on); + + /*switch (argv[0]) { + case 1: +#if defined(CONFIG_PHYDM_DFS_MASTER) + set dbg parameters for radar detection instead of the default value + if (argv[1] == 1) { + dm->radar_detect_reg_918 = argv[2]; + dm->radar_detect_reg_91c = argv[3]; + dm->radar_detect_reg_920 = argv[4]; + dm->radar_detect_reg_924 = argv[5]; + dm->radar_detect_dbg_parm_en = 1; + + PDM_SNPF((output + used, out_len - used, "Radar detection with dbg parameter\n")); + PDM_SNPF((output + used, out_len - used, "reg918:0x%08X\n", dm->radar_detect_reg_918)); + PDM_SNPF((output + used, out_len - used, "reg91c:0x%08X\n", dm->radar_detect_reg_91c)); + PDM_SNPF((output + used, out_len - used, "reg920:0x%08X\n", dm->radar_detect_reg_920)); + PDM_SNPF((output + used, out_len - used, "reg924:0x%08X\n", dm->radar_detect_reg_924)); + } else { + dm->radar_detect_dbg_parm_en = 0; + PDM_SNPF((output + used, out_len - used, "Radar detection with default parameter\n")); + } + phydm_radar_detect_enable(dm); +#endif defined(CONFIG_PHYDM_DFS_MASTER) + + break; + default: + break; + }*/ +} + +u8 phydm_dfs_polling_time(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 dfs_polling_time = 0; + + if (dm->support_ic_type & (ODM_RTL8814A | ODM_RTL8822B | ODM_RTL8821C)) + dfs_polling_time = 40; + else + dfs_polling_time = 100; + + return dfs_polling_time; +} + +#endif /* @defined(CONFIG_PHYDM_DFS_MASTER) */ + +boolean +phydm_is_dfs_band(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (((*dm->channel >= 52) && (*dm->channel <= 64)) || + ((*dm->channel >= 100) && (*dm->channel <= 144))) + return true; + else + return false; +} + +boolean +phydm_dfs_master_enabled(void *dm_void) { #ifdef CONFIG_PHYDM_DFS_MASTER - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; + boolean ret_val = false; - return *p_dm_odm->dfs_master_enabled ? true : false; + if (dm->dfs_master_enabled) /*pointer protection*/ + ret_val = *dm->dfs_master_enabled ? true : false; + + return ret_val; #else return false; #endif } -void -phydm_dfs_debug( - void *p_dm_void, - u32 *const argv, - u32 *_used, - char *output, - u32 *_out_len -) +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) +#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT +void phydm_dfs_ap_reset_radar_detect_counter_and_flag(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u32 used = *_used; - u32 out_len = *_out_len; + struct dm_struct *dm = (struct dm_struct *)dm_void; - switch (argv[0]) { - case 1: -#if defined(CONFIG_PHYDM_DFS_MASTER) - /* set dbg parameters for radar detection instead of the default value */ - if (argv[1] == 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; + /* @Clear Radar Counter and Radar flag */ + odm_set_bb_reg(dm, R_0xa40, BIT(15), 0); + odm_set_bb_reg(dm, R_0xa40, BIT(15), 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", 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 { - 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(p_dm_odm); -#endif /* defined(CONFIG_PHYDM_DFS_MASTER) */ - - break; - default: - break; - } + /* RT_TRACE(COMP_DFS, DBG_LOUD, ("[DFS], After reset radar counter, 0xcf8 = 0x%x, 0xcf4 = 0x%x\n", */ + /* PHY_QueryBBReg(Adapter, 0xcf8, bMaskDWord), */ + /* PHY_QueryBBReg(Adapter, 0xcf4, bMaskDWord))); */ } +#endif +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dfs.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dfs.h index 3c06c496a798..8fbffa431af3 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dfs.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dfs.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,68 +9,189 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ #ifndef __PHYDM_DFS_H__ #define __PHYDM_DFS_H__ -#define DFS_VERSION "0.0" +#define DFS_VERSION "1.1" -/* ============================================================ - Definition - ============================================================ -*/ +/*@ + * ============================================================ + * Definition + * ============================================================ + */ -/* -============================================================ -1 structure - ============================================================ -*/ +/*@ + * ============================================================ + * 1 structure + * ============================================================ + */ -/* ============================================================ - 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, +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 three_peak_opt; + u8 three_peak_th2; + 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 pulse_type_hist[5]; + boolean radar_det_mask_hist[5]; + boolean idle_mode; + boolean force_TP_mode; + boolean dbg_mode; + boolean sw_trigger_mode; + boolean det_print; + boolean det_print2; + boolean radar_type; + /*@dfs histogram*/ + boolean print_hist_rpt; + boolean hist_cond_on; + boolean pri_cond1; + boolean pri_cond2; + boolean pri_cond3; + boolean pri_cond4; + boolean pri_cond5; + boolean pw_cond1; + boolean pw_cond2; + boolean pw_cond3; + boolean pri_type3_4_cond1; /*@for ETSI*/ + boolean pri_type3_4_cond2; /*@for ETSI*/ + boolean pw_long_cond1; /*@for long radar*/ + boolean pw_long_cond2; /*@for long radar*/ + boolean pri_long_cond1; /*@for long radar*/ + boolean pw_flag; + boolean pri_flag; + boolean pri_type3_4_flag; /*@for ETSI*/ + boolean long_radar_flag; + u16 pri_hold_sum[6]; + u16 pw_hold_sum[6]; + u16 pri_long_hold_sum[6]; + u16 pw_long_hold_sum[6]; + u8 hist_idx; + u8 hist_long_idx; + u8 pw_hold[4][6]; + u8 pri_hold[4][6]; + u8 pw_long_hold[300][6]; + u8 pri_long_hold[300][6]; + u16 pw_std; /*@The std(var) of reasonable num of pw group*/ + u16 pri_std;/*@The std(var) of reasonable num of pri group*/ + /*@dfs histogram threshold*/ + u8 pri_hist_th; + u8 pri_sum_g1_th; + u8 pri_sum_g5_th; + u8 pri_sum_g1_fcc_th; + u8 pri_sum_g3_fcc_th; + u8 pri_sum_safe_fcc_th; + u8 pri_sum_type4_th; + u8 pri_sum_type6_th; + u8 pri_sum_safe_th; + u8 pri_sum_g5_under_g1_th; + u8 pri_pw_diff_th; + u8 pri_pw_diff_fcc_th; + u8 pri_pw_diff_fcc_idle_th; + u8 pri_pw_diff_w53_th; + u8 pri_type1_low_fcc_th; + u8 pri_type1_upp_fcc_th; + u8 pri_type1_cen_fcc_th; + u8 pw_g0_th; + u8 pw_long_lower_20m_th; + u8 pw_long_lower_th; + u8 pri_long_upper_th; + u8 pw_long_sum_upper_th; + u8 pw_std_th; + u8 pw_std_idle_th; + u8 pri_std_th; + u8 pri_std_idle_th; + u8 type4_pw_max_cnt; + u8 type4_safe_pri_sum_th; }; -/* -============================================================ - 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); - bool phydm_radar_detect(void *p_dm_void); -#endif /* defined(CONFIG_PHYDM_DFS_MASTER) */ +/*@ + * ============================================================ + * enumeration + * ============================================================ + */ -bool -phydm_dfs_master_enabled( - void *p_dm_void -); +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 *dm_void); +void phydm_radar_detect_disable(void *dm_void); +void phydm_radar_detect_enable(void *dm_void); +boolean phydm_radar_detect(void *dm_void); +void phydm_dfs_histogram_radar_distinguish(void *dm_void); +boolean phydm_dfs_hist_log(void *dm_void, u8 index); +void phydm_dfs_parameter_init(void *dm_void); +void phydm_dfs_hist_dbg(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len); +void phydm_dfs_debug(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len); +u8 phydm_dfs_polling_time(void *dm_void); +#endif /* @defined(CONFIG_PHYDM_DFS_MASTER) */ + +boolean +phydm_dfs_is_meteorology_channel(void *dm_void); void -phydm_dfs_debug( - void *p_dm_void, - u32 *const argv, - u32 *_used, - char *output, - u32 *_out_len -); +phydm_dfs_segment_distinguish(void *dm_void, enum rf_syn syn_path); -#endif /*#ifndef __PHYDM_DFS_H__ */ +void +phydm_dfs_segment_flag_reset(void *dm_void); + +boolean +phydm_is_dfs_band(void *dm_void); + +boolean +phydm_dfs_master_enabled(void *dm_void); + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) +#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT +void phydm_dfs_ap_reset_radar_detect_counter_and_flag(void *dm_void); +#endif +#endif + +#endif /*@#ifndef __PHYDM_DFS_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dig.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dig.c index 914e0b246f14..b42a8a864ca3 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dig.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dig.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,2135 +9,2860 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ -/* ************************************************************ +/*@************************************************************ * include files - * ************************************************************ */ + * ************************************************************ + */ #include "mp_precomp.h" #include "phydm_precomp.h" - -void -odm_change_dynamic_init_gain_thresh( - void *p_dm_void, - u32 dm_type, - u32 dm_value -) +#ifdef CFG_DIG_DAMPING_CHK +void phydm_dig_recorder_reset(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _dynamic_initial_gain_threshold_ *p_dm_dig_table = &p_dm_odm->dm_dig_table; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + struct phydm_dig_recorder_strcut *dig_rc = &dig_t->dig_recorder_t; - if (dm_type == DIG_TYPE_THRESH_HIGH) - p_dm_dig_table->rssi_high_thresh = dm_value; - else if (dm_type == DIG_TYPE_THRESH_LOW) - p_dm_dig_table->rssi_low_thresh = dm_value; - else if (dm_type == DIG_TYPE_ENABLE) - p_dm_dig_table->dig_enable_flag = true; - else if (dm_type == DIG_TYPE_DISABLE) - p_dm_dig_table->dig_enable_flag = false; - else if (dm_type == DIG_TYPE_BACKOFF) { - if (dm_value > 30) - dm_value = 30; - p_dm_dig_table->backoff_val = (u8)dm_value; - } else if (dm_type == DIG_TYPE_RX_GAIN_MIN) { - if (dm_value == 0) - dm_value = 0x1; - p_dm_dig_table->rx_gain_range_min = (u8)dm_value; - } else if (dm_type == DIG_TYPE_RX_GAIN_MAX) { - if (dm_value > 0x50) - dm_value = 0x50; - p_dm_dig_table->rx_gain_range_max = (u8)dm_value; - } -} /* dm_change_dynamic_init_gain_thresh */ + PHYDM_DBG(dm, DBG_DIG, "%s ======>\n", __func__); -int -get_igi_for_diff(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; + odm_memory_set(dm, &dig_rc->igi_bitmap, 0, + sizeof(struct phydm_dig_recorder_strcut)); } -void -odm_fa_threshold_check( - void *p_dm_void, - bool is_dfs_band, - bool is_performance, - u32 rx_tp, - u32 tx_tp, - u32 *dm_FA_thres -) +void phydm_dig_recorder(void *dm_void, boolean first_connect, u8 igi_curr, + u32 fa_cnt) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + struct phydm_dig_recorder_strcut *dig_rc = &dig_t->dig_recorder_t; + u8 igi_pre = dig_rc->igi_history[0]; + u8 igi_up = 0; - if (p_dm_odm->is_linked && (is_performance || is_dfs_band)) { -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - /*For AP*/ - if ((rx_tp >> 2) > tx_tp && rx_tp < 10000 && rx_tp > 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 (is_dfs_band) { - /* 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; -} - -u8 -odm_forbidden_igi_check( - void *p_dm_void, - u8 dig_dynamic_min, - u8 current_igi -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _dynamic_initial_gain_threshold_ *p_dm_dig_table = &p_dm_odm->dm_dig_table; - struct _FALSE_ALARM_STATISTICS *p_false_alm_cnt = (struct _FALSE_ALARM_STATISTICS *)phydm_get_structure(p_dm_odm, PHYDM_FALSEALMCNT); - u8 rx_gain_range_min = p_dm_dig_table->rx_gain_range_min; - - if (p_dm_dig_table->large_fa_timeout) { - if (--p_dm_dig_table->large_fa_timeout == 0) - p_dm_dig_table->large_fa_hit = 0; - } - - if (p_false_alm_cnt->cnt_all > 10000) { - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Abnormally false alarm case.\n")); - - if (p_dm_dig_table->large_fa_hit != 3) - p_dm_dig_table->large_fa_hit++; - - if (p_dm_dig_table->forbidden_igi < current_igi) { /* if(p_dm_dig_table->forbidden_igi < p_dm_dig_table->cur_ig_value) */ - p_dm_dig_table->forbidden_igi = current_igi;/* p_dm_dig_table->forbidden_igi = p_dm_dig_table->cur_ig_value; */ - p_dm_dig_table->large_fa_hit = 1; - p_dm_dig_table->large_fa_timeout = LARGE_FA_TIMEOUT; - } - - if (p_dm_dig_table->large_fa_hit >= 3) { - if ((p_dm_dig_table->forbidden_igi + 2) > p_dm_dig_table->rx_gain_range_max) - rx_gain_range_min = p_dm_dig_table->rx_gain_range_max; - else - rx_gain_range_min = (p_dm_dig_table->forbidden_igi + 2); - p_dm_dig_table->recover_cnt = 1800; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Abnormally false alarm case: recover_cnt = %d\n", p_dm_dig_table->recover_cnt)); - } - } - - else if (p_false_alm_cnt->cnt_all > 2000) { - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("Abnormally false alarm case.\n")); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("cnt_all=%d, cnt_all_pre=%d, current_igi=0x%x, pre_ig_value=0x%x\n", - p_false_alm_cnt->cnt_all, p_false_alm_cnt->cnt_all_pre, current_igi, p_dm_dig_table->pre_ig_value)); - - /* p_false_alm_cnt->cnt_all = 1.1875*p_false_alm_cnt->cnt_all_pre */ - if ((p_false_alm_cnt->cnt_all > (p_false_alm_cnt->cnt_all_pre + (p_false_alm_cnt->cnt_all_pre >> 3) + (p_false_alm_cnt->cnt_all_pre >> 4))) && (current_igi < p_dm_dig_table->pre_ig_value)) { - if (p_dm_dig_table->large_fa_hit != 3) - p_dm_dig_table->large_fa_hit++; - - if (p_dm_dig_table->forbidden_igi < current_igi) { /*if(p_dm_dig_table->forbidden_igi < p_dm_dig_table->cur_ig_value)*/ - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("Updating forbidden_igi by current_igi, forbidden_igi=0x%x, current_igi=0x%x\n", - p_dm_dig_table->forbidden_igi, current_igi)); - - p_dm_dig_table->forbidden_igi = current_igi; /*p_dm_dig_table->forbidden_igi = p_dm_dig_table->cur_ig_value;*/ - p_dm_dig_table->large_fa_hit = 1; - p_dm_dig_table->large_fa_timeout = LARGE_FA_TIMEOUT; - } - - } - - if (p_dm_dig_table->large_fa_hit >= 3) { - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("FaHit is greater than 3, rx_gain_range_max=0x%x, rx_gain_range_min=0x%x, forbidden_igi=0x%x\n", - p_dm_dig_table->rx_gain_range_max, rx_gain_range_min, p_dm_dig_table->forbidden_igi)); - - if ((p_dm_dig_table->forbidden_igi + 1) > p_dm_dig_table->rx_gain_range_max) - rx_gain_range_min = p_dm_dig_table->rx_gain_range_max; - else - rx_gain_range_min = (p_dm_dig_table->forbidden_igi + 1); - - p_dm_dig_table->recover_cnt = 1200; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("Abnormally false alarm case: recover_cnt = %d, rx_gain_range_min = 0x%x\n", p_dm_dig_table->recover_cnt, rx_gain_range_min)); - } - } - - else { - if (p_dm_dig_table->recover_cnt != 0) { - - p_dm_dig_table->recover_cnt--; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Normal Case: recover_cnt = %d\n", p_dm_dig_table->recover_cnt)); - } else { - if (p_dm_dig_table->large_fa_hit < 3) { - if ((p_dm_dig_table->forbidden_igi - 2) < dig_dynamic_min) { /* DM_DIG_MIN) */ - p_dm_dig_table->forbidden_igi = dig_dynamic_min; /* DM_DIG_MIN; */ - rx_gain_range_min = dig_dynamic_min; /* DM_DIG_MIN; */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Normal Case: At Lower Bound\n")); - } else { - if (p_dm_dig_table->large_fa_hit == 0) { - p_dm_dig_table->forbidden_igi -= 2; - rx_gain_range_min = (p_dm_dig_table->forbidden_igi + 2); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Normal Case: Approach Lower Bound\n")); - } - } - } else - p_dm_dig_table->large_fa_hit = 0; - } - } - - return rx_gain_range_min; - -} - -void -odm_inband_noise_calculate( - void *p_dm_void -) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _dynamic_initial_gain_threshold_ *p_dm_dig_table = &p_dm_odm->dm_dig_table; - u8 igi_backup, time_cnt = 0, valid_cnt = 0; - bool is_timeout = true; - s8 s_noise_a, s_noise_b; - s32 noise_rpt_a = 0, noise_rpt_b = 0; - u32 tmp = 0; - static u8 fail_cnt = 0; - - if (!(p_dm_odm->support_ic_type & (ODM_RTL8192E))) + if (!dm->is_linked) return; - if (p_dm_odm->rf_type == ODM_1T1R || *(p_dm_odm->p_one_path_cca) != ODM_CCA_2R) - return; + PHYDM_DBG(dm, DBG_DIG, "%s ======>\n", __func__); - if (!p_dm_dig_table->is_noise_est) - return; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_InbandNoiseEstimate()========>\n")); - - /* 1 Set initial gain. */ - igi_backup = p_dm_dig_table->cur_ig_value; - p_dm_dig_table->igi_offset_a = 0; - p_dm_dig_table->igi_offset_b = 0; - odm_write_dig(p_dm_odm, 0x24); - - /* 1 Update idle time power report */ - if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) - odm_set_bb_reg(p_dm_odm, ODM_REG_TX_ANT_CTRL_11N, BIT(25), 0x0); - - delay_ms(2); - - /* 1 Get noise power level */ - while (1) { - /* 2 Read Noise Floor Report */ - if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) - tmp = odm_get_bb_reg(p_dm_odm, 0x8f8, MASKLWORD); - - s_noise_a = (s8)(tmp & 0xff); - s_noise_b = (s8)((tmp & 0xff00) >> 8); - - /* ODM_RT_TRACE(p_dm_odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("s_noise_a = %d, s_noise_b = %d\n",s_noise_a, s_noise_b)); */ - - if ((s_noise_a < 20 && s_noise_a >= -70) && (s_noise_b < 20 && s_noise_b >= -70)) { - valid_cnt++; - noise_rpt_a += s_noise_a; - noise_rpt_b += s_noise_b; - /* ODM_RT_TRACE(p_dm_odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("s_noise_a = %d, s_noise_b = %d\n",s_noise_a, s_noise_b)); */ - } - - time_cnt++; - is_timeout = (time_cnt >= 150) ? true : false; - - if (valid_cnt == 20 || is_timeout) - break; - - delay_ms(2); - - } - - /* 1 Keep idle time power report */ - if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) - odm_set_bb_reg(p_dm_odm, ODM_REG_TX_ANT_CTRL_11N, BIT(25), 0x1); - - /* 1 Recover IGI */ - odm_write_dig(p_dm_odm, igi_backup); - - /* 1 Calculate Noise Floor */ - if (valid_cnt != 0) { - noise_rpt_a /= (valid_cnt << 1); - noise_rpt_b /= (valid_cnt << 1); - } - - if (is_timeout) { - noise_rpt_a = 0; - noise_rpt_b = 0; - - fail_cnt++; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("Noise estimate fail time = %d\n", fail_cnt)); - - if (fail_cnt == 3) { - fail_cnt = 0; - p_dm_dig_table->is_noise_est = false; - } - } else { - noise_rpt_a = -110 + 0x24 + noise_rpt_a - 6; - noise_rpt_b = -110 + 0x24 + noise_rpt_b - 6; - p_dm_dig_table->is_noise_est = false; - fail_cnt = 0; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("noise_rpt_a = %d, noise_rpt_b = %d\n", noise_rpt_a, noise_rpt_b)); - } - - /* 1 Calculate IGI Offset */ - if (noise_rpt_a > noise_rpt_b) { - p_dm_dig_table->igi_offset_a = noise_rpt_a - noise_rpt_b; - p_dm_dig_table->igi_offset_b = 0; - } else { - p_dm_dig_table->igi_offset_a = 0; - p_dm_dig_table->igi_offset_b = noise_rpt_b - noise_rpt_a; - } - -#endif - return; -} - -void -odm_dig_for_bt_hs_mode( - void *p_dm_void -) -{ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _dynamic_initial_gain_threshold_ *p_dm_dig_table = &p_dm_odm->dm_dig_table; - u8 dig_for_bt_hs = 0; - u8 dig_up_bound = 0x5a; - - if (p_dm_odm->is_bt_connect_process) - dig_for_bt_hs = 0x22; - else { - /* */ - /* Decide DIG value by BT HS RSSI. */ - /* */ - dig_for_bt_hs = p_dm_odm->bt_hs_rssi + 4; - - /* DIG Bound */ - if (dig_for_bt_hs > dig_up_bound) - dig_for_bt_hs = dig_up_bound; - if (dig_for_bt_hs < 0x1c) - dig_for_bt_hs = 0x1c; - - /* update Current IGI */ - p_dm_dig_table->bt30_cur_igi = dig_for_bt_hs; - } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_dig_for_bt_hs_mode() : set DigValue=0x%x\n", dig_for_bt_hs)); -#endif -} - -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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _dynamic_initial_gain_threshold_ *p_dm_dig_table = &p_dm_odm->dm_dig_table; - u8 step1[8] = {24, 30, 40, 50, 60, 70, 80, 90}; - u8 i; - - if (p_dm_dig_table->enable_adjust_big_jump == 0) - return; - - for (i = 0; i <= p_dm_dig_table->big_jump_step1; i++) { - if ((current_igi + step1[i]) > p_dm_dig_table->big_jump_lmt[p_dm_dig_table->agc_table_idx]) { - if (i != 0) - i = i - 1; - break; - } else if (i == p_dm_dig_table->big_jump_step1) - break; - } - if (p_dm_odm->support_ic_type & ODM_RTL8822B) - odm_set_bb_reg(p_dm_odm, 0x8c8, 0xe, i); - else if (p_dm_odm->support_ic_type & ODM_RTL8197F) - odm_set_bb_reg(p_dm_odm, ODM_REG_BB_AGC_SET_2_11N, 0xe, i); - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("phydm_set_big_jump_step(): bigjump = %d (ori = 0x%x), LMT=0x%x\n", i, p_dm_dig_table->big_jump_step1, p_dm_dig_table->big_jump_lmt[p_dm_dig_table->agc_table_idx])); -#endif -} - -void -odm_write_dig( - void *p_dm_void, - u8 current_igi -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _dynamic_initial_gain_threshold_ *p_dm_dig_table = &p_dm_odm->dm_dig_table; - - if (p_dm_dig_table->is_stop_dig) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_write_dig(): Stop Writing IGI\n")); + if (first_connect) { + phydm_dig_recorder_reset(dm); + dig_rc->igi_history[0] = igi_curr; + dig_rc->fa_history[0] = fa_cnt; return; } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_TRACE, ("odm_write_dig(): ODM_REG(IGI_A,p_dm_odm)=0x%x, ODM_BIT(IGI,p_dm_odm)=0x%x\n", - ODM_REG(IGI_A, p_dm_odm), ODM_BIT(IGI, p_dm_odm))); + if (igi_curr % 2) + igi_curr--; - /* 1 Check initial gain by upper bound */ - if ((!p_dm_dig_table->is_psd_in_progress) && p_dm_odm->is_linked) { - if (current_igi > p_dm_dig_table->rx_gain_range_max) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_TRACE, ("odm_write_dig(): current_igi(0x%02x) is larger than upper bound !!\n", current_igi)); - current_igi = p_dm_dig_table->rx_gain_range_max; - } - if (p_dm_odm->support_ability & ODM_BB_ADAPTIVITY && p_dm_odm->adaptivity_flag == true) { - if (current_igi > p_dm_odm->adaptivity_igi_upper) - current_igi = p_dm_odm->adaptivity_igi_upper; + igi_pre = dig_rc->igi_history[0]; + igi_up = (igi_curr > igi_pre) ? 1 : 0; + dig_rc->igi_bitmap = ((dig_rc->igi_bitmap << 1) & 0xfe) | igi_up; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_write_dig(): adaptivity case: Force upper bound to 0x%x !!!!!!\n", current_igi)); - } - } + dig_rc->igi_history[3] = dig_rc->igi_history[2]; + dig_rc->igi_history[2] = dig_rc->igi_history[1]; + dig_rc->igi_history[1] = dig_rc->igi_history[0]; + dig_rc->igi_history[0] = igi_curr; - if (p_dm_dig_table->cur_ig_value != current_igi) { - -#if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1) - /* Modify big jump step for 8822B and 8197F */ - if (p_dm_odm->support_ic_type & (ODM_RTL8822B | ODM_RTL8197F)) - phydm_set_big_jump_step(p_dm_odm, current_igi); -#endif - -#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) - /* Set IGI value of CCK for new CCK AGC */ - if (p_dm_odm->cck_new_agc) { - if (p_dm_odm->support_ic_type & ODM_IC_PHY_STATUE_NEW_TYPE) - odm_set_bb_reg(p_dm_odm, 0xa0c, 0x00003f00, (current_igi >> 1)); - } -#endif - - /*Add by YuChen for USB IO too slow issue*/ - if ((p_dm_odm->support_ability & ODM_BB_ADAPTIVITY) && (current_igi > p_dm_dig_table->cur_ig_value)) { - p_dm_dig_table->cur_ig_value = current_igi; - phydm_adaptivity(p_dm_odm); - } - - /* 1 Set IGI value */ - if (p_dm_odm->support_platform & (ODM_WIN | ODM_CE)) { - odm_set_bb_reg(p_dm_odm, ODM_REG(IGI_A, p_dm_odm), ODM_BIT(IGI, p_dm_odm), current_igi); - - if (p_dm_odm->rf_type > ODM_1T1R) - odm_set_bb_reg(p_dm_odm, ODM_REG(IGI_B, p_dm_odm), ODM_BIT(IGI, p_dm_odm), current_igi); - -#if (RTL8814A_SUPPORT == 1) - if (p_dm_odm->support_ic_type & ODM_RTL8814A) { - odm_set_bb_reg(p_dm_odm, ODM_REG(IGI_C, p_dm_odm), ODM_BIT(IGI, p_dm_odm), current_igi); - odm_set_bb_reg(p_dm_odm, ODM_REG(IGI_D, p_dm_odm), ODM_BIT(IGI, p_dm_odm), current_igi); - } -#endif - } else if (p_dm_odm->support_platform & (ODM_AP)) { - switch (*(p_dm_odm->p_one_path_cca)) { - case ODM_CCA_2R: - odm_set_bb_reg(p_dm_odm, ODM_REG(IGI_A, p_dm_odm), ODM_BIT(IGI, p_dm_odm), current_igi); - - if (p_dm_odm->rf_type > ODM_1T1R) - odm_set_bb_reg(p_dm_odm, ODM_REG(IGI_B, p_dm_odm), ODM_BIT(IGI, p_dm_odm), current_igi); -#if (RTL8814A_SUPPORT == 1) - if (p_dm_odm->support_ic_type & ODM_RTL8814A) { - odm_set_bb_reg(p_dm_odm, ODM_REG(IGI_C, p_dm_odm), ODM_BIT(IGI, p_dm_odm), current_igi); - odm_set_bb_reg(p_dm_odm, ODM_REG(IGI_D, p_dm_odm), ODM_BIT(IGI, p_dm_odm), current_igi); - } -#endif - break; - case ODM_CCA_1R_A: - odm_set_bb_reg(p_dm_odm, ODM_REG(IGI_A, p_dm_odm), ODM_BIT(IGI, p_dm_odm), current_igi); - if (p_dm_odm->rf_type != ODM_1T1R) - odm_set_bb_reg(p_dm_odm, ODM_REG(IGI_B, p_dm_odm), ODM_BIT(IGI, p_dm_odm), get_igi_for_diff(current_igi)); - break; - case ODM_CCA_1R_B: - odm_set_bb_reg(p_dm_odm, ODM_REG(IGI_B, p_dm_odm), ODM_BIT(IGI, p_dm_odm), get_igi_for_diff(current_igi)); - if (p_dm_odm->rf_type != ODM_1T1R) - odm_set_bb_reg(p_dm_odm, ODM_REG(IGI_A, p_dm_odm), ODM_BIT(IGI, p_dm_odm), current_igi); - break; - } - } - - p_dm_dig_table->cur_ig_value = current_igi; - } - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_TRACE, ("odm_write_dig(): current_igi(0x%02x).\n", current_igi)); + dig_rc->fa_history[3] = dig_rc->fa_history[2]; + dig_rc->fa_history[2] = dig_rc->fa_history[1]; + dig_rc->fa_history[1] = dig_rc->fa_history[0]; + dig_rc->fa_history[0] = fa_cnt; + PHYDM_DBG(dm, DBG_DIG, "igi_history[3:0] = {0x%x, 0x%x, 0x%x, 0x%x}\n", + dig_rc->igi_history[3], dig_rc->igi_history[2], + dig_rc->igi_history[1], dig_rc->igi_history[0]); + PHYDM_DBG(dm, DBG_DIG, "fa_history[3:0] = {%d, %d, %d, %d}\n", + dig_rc->fa_history[3], dig_rc->fa_history[2], + dig_rc->fa_history[1], dig_rc->fa_history[0]); + PHYDM_DBG(dm, DBG_DIG, "igi_bitmap = {%d, %d, %d, %d} = 0x%x\n", + (u8)((dig_rc->igi_bitmap & BIT(3)) >> 3), + (u8)((dig_rc->igi_bitmap & BIT(2)) >> 2), + (u8)((dig_rc->igi_bitmap & BIT(1)) >> 1), + (u8)(dig_rc->igi_bitmap & BIT(0)), + dig_rc->igi_bitmap); } -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_damping_chk(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _dynamic_initial_gain_threshold_ *p_dm_dig_table = &p_dm_odm->dm_dig_table; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + struct phydm_dig_recorder_strcut *dig_rc = &dig_t->dig_recorder_t; + u8 igi_bitmap_4bit = dig_rc->igi_bitmap & 0xf; + u8 diff1 = 0, diff2 = 0; + u32 fa_low_th = dig_t->fa_th[0]; + u32 fa_high_th = dig_t->fa_th[1]; + u32 fa_high_th2 = dig_t->fa_th[2]; + u8 fa_pattern_match = 0; + u32 time_tmp = 0; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_pause_dig()=========> level = %d\n", pause_level)); - - if ((p_dm_dig_table->pause_dig_level == 0) && (!(p_dm_odm->support_ability & ODM_BB_DIG) || !(p_dm_odm->support_ability & ODM_BB_FA_CNT))) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, - ("odm_pause_dig(): Return: support_ability DIG or FA is disabled !!\n")); + if (!dm->is_linked) return; - } - if (pause_level > DM_DIG_MAX_PAUSE_TYPE) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, - ("odm_pause_dig(): Return: Wrong pause level !!\n")); - return; - } + PHYDM_DBG(dm, DBG_DIG, "%s ======>\n", __func__); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_pause_dig(): pause level = 0x%x, Current value = 0x%x\n", p_dm_dig_table->pause_dig_level, igi_value)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_pause_dig(): pause value = 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x\n", - p_dm_dig_table->pause_dig_value[7], p_dm_dig_table->pause_dig_value[6], p_dm_dig_table->pause_dig_value[5], p_dm_dig_table->pause_dig_value[4], - p_dm_dig_table->pause_dig_value[3], p_dm_dig_table->pause_dig_value[2], p_dm_dig_table->pause_dig_value[1], p_dm_dig_table->pause_dig_value[0])); + /*@== Release Damping ================================================*/ + if (dig_rc->damping_limit_en) { + PHYDM_DBG(dm, DBG_DIG, + "[Damping Limit!] limit_time=%d, phydm_sys_up_time=%d\n", + dig_rc->limit_time, dm->phydm_sys_up_time); - switch (pause_type) { - /* Pause DIG */ - case PHYDM_PAUSE: - { - /* Disable DIG */ - odm_cmn_info_update(p_dm_odm, ODM_CMNINFO_ABILITY, p_dm_odm->support_ability & (~ODM_BB_DIG)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_pause_dig(): Pause DIG !!\n")); + time_tmp = dig_rc->limit_time + DIG_LIMIT_PERIOD; - /* Backup IGI value */ - if (p_dm_dig_table->pause_dig_level == 0) { - p_dm_dig_table->igi_backup = p_dm_dig_table->cur_ig_value; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_pause_dig(): Backup IGI = 0x%x, new IGI = 0x%x\n", p_dm_dig_table->igi_backup, igi_value)); + if (DIFF_2(dm->rssi_min, dig_rc->limit_rssi) > 3 || + time_tmp < dm->phydm_sys_up_time) { + dig_rc->damping_limit_en = 0; + PHYDM_DBG(dm, DBG_DIG, "rssi_min=%d, limit_rssi=%d\n", + dm->rssi_min, dig_rc->limit_rssi); } + return; + } - /* Record IGI value */ - p_dm_dig_table->pause_dig_value[pause_level] = igi_value; + /*@== Damping Pattern Check===========================================*/ + PHYDM_DBG(dm, DBG_DIG, "fa_th{H, L}= {%d,%d}\n", fa_high_th, fa_low_th); - /* Update pause level */ - p_dm_dig_table->pause_dig_level = (p_dm_dig_table->pause_dig_level | BIT(pause_level)); + switch (igi_bitmap_4bit) { + case 0x5: + /*@ 4b'0101 + * IGI:[3]down(0x24)->[2]up(0x26)->[1]down(0x24)->[0]up(0x26)->[new](Lock @ 0x26) + * FA: [3] >high1 ->[2] [1] >high1 ->[0] [new] [2]up(0x28)->[1]down(0x24)->[0]up(0x28)->[new](Lock @ 0x28) + * FA: [3] >high2 ->[2] [1] >high2 ->[0] [new] igi_history[0] > dig_rc->igi_history[1]) + diff1 = dig_rc->igi_history[0] - dig_rc->igi_history[1]; - /* Write new IGI value */ - if (BIT(pause_level + 1) > p_dm_dig_table->pause_dig_level) { - odm_write_dig(p_dm_odm, igi_value); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_pause_dig(): IGI of higher level = 0x%x\n", igi_value)); + if (dig_rc->igi_history[2] > dig_rc->igi_history[3]) + diff2 = dig_rc->igi_history[2] - dig_rc->igi_history[3]; + + if (dig_rc->fa_history[0] < fa_low_th && + dig_rc->fa_history[1] > fa_high_th && + dig_rc->fa_history[2] < fa_low_th && + dig_rc->fa_history[3] > fa_high_th) { + /*@Check each fa element*/ + fa_pattern_match = 1; } break; - } - /* Resume DIG */ - case PHYDM_RESUME: - { - /* check if the level is illegal or not */ - if ((p_dm_dig_table->pause_dig_level & (BIT(pause_level))) != 0) { - p_dm_dig_table->pause_dig_level = p_dm_dig_table->pause_dig_level & (~(BIT(pause_level))); - p_dm_dig_table->pause_dig_value[pause_level] = 0; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_pause_dig(): Resume DIG !!\n")); - } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_pause_dig(): Wrong resume level !!\n")); - break; - } + case 0x9: + /*@ 4b'1001 + * IGI:[3]up(0x28)->[2]down(0x26)->[1]down(0x24)->[0]up(0x28)->[new](Lock @ 0x28) + * FA: [3] [2] [1] >high2 ->[0] [new] igi_history[0] > dig_rc->igi_history[1]) + diff1 = dig_rc->igi_history[0] - dig_rc->igi_history[1]; - /* Resume DIG */ - if (p_dm_dig_table->pause_dig_level == 0) { - /* Write backup IGI value */ - odm_write_dig(p_dm_odm, p_dm_dig_table->igi_backup); - p_dm_dig_table->is_ignore_dig = true; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_pause_dig(): Write original IGI = 0x%x\n", p_dm_dig_table->igi_backup)); + if (dig_rc->igi_history[2] < dig_rc->igi_history[3]) + diff2 = dig_rc->igi_history[3] - dig_rc->igi_history[2]; - /* Enable DIG */ - odm_cmn_info_update(p_dm_odm, ODM_CMNINFO_ABILITY, p_dm_odm->support_ability | ODM_BB_DIG); - break; - } - - if (BIT(pause_level) > p_dm_dig_table->pause_dig_level) { - s8 max_level; - - /* Calculate the maximum level now */ - for (max_level = (pause_level - 1); max_level >= 0; max_level--) { - if ((p_dm_dig_table->pause_dig_level & BIT(max_level)) > 0) - break; - } - - /* write IGI of lower level */ - odm_write_dig(p_dm_odm, p_dm_dig_table->pause_dig_value[max_level]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_pause_dig(): Write IGI (0x%x) of level (%d)\n", - p_dm_dig_table->pause_dig_value[max_level], max_level)); - break; + if (dig_rc->fa_history[0] < fa_low_th && + dig_rc->fa_history[1] > fa_high_th2 && + dig_rc->fa_history[2] < fa_low_th && + dig_rc->fa_history[3] < fa_low_th) { + /*@Check each fa element*/ + fa_pattern_match = 1; } break; - } default: - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_pause_dig(): Wrong type !!\n")); break; } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_pause_dig(): pause level = 0x%x, Current value = 0x%x\n", p_dm_dig_table->pause_dig_level, igi_value)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_pause_dig(): pause value = 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x\n", - p_dm_dig_table->pause_dig_value[7], p_dm_dig_table->pause_dig_value[6], p_dm_dig_table->pause_dig_value[5], p_dm_dig_table->pause_dig_value[4], - p_dm_dig_table->pause_dig_value[3], p_dm_dig_table->pause_dig_value[2], p_dm_dig_table->pause_dig_value[1], p_dm_dig_table->pause_dig_value[0])); + if (diff1 >= 2 && diff2 >= 2 && fa_pattern_match) { + dig_rc->damping_limit_en = 1; + dig_rc->damping_limit_val = dig_rc->igi_history[0]; + dig_rc->limit_time = dm->phydm_sys_up_time; + dig_rc->limit_rssi = dm->rssi_min; + PHYDM_DBG(dm, DBG_DIG, + "[Start damping_limit!] IGI_dyn_min=0x%x, limit_time=%d, limit_rssi=%d\n", + dig_rc->damping_limit_val, + dig_rc->limit_time, dig_rc->limit_rssi); + } + + PHYDM_DBG(dm, DBG_DIG, "damping_limit=%d\n", dig_rc->damping_limit_en); } +#endif -bool -odm_dig_abort( - void *p_dm_void -) +boolean +phydm_dig_go_up_check(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _dynamic_initial_gain_threshold_ *p_dm_dig_table = &p_dm_odm->dm_dig_table; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - struct rtl8192cd_priv *priv = p_dm_odm->priv; -#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) - struct _ADAPTER *p_adapter = p_dm_odm->adapter; -#endif - - /* support_ability */ - if (!(p_dm_odm->support_ability & ODM_BB_FA_CNT)) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: support_ability ODM_BB_FA_CNT is disabled\n")); - return true; - } - - /* support_ability */ - if (!(p_dm_odm->support_ability & ODM_BB_DIG)) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: support_ability ODM_BB_DIG is disabled\n")); - return true; - } - - /* ScanInProcess */ - if (*(p_dm_odm->p_is_scan_in_process)) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: In Scan Progress\n")); - return true; - } - - if (p_dm_dig_table->is_ignore_dig) { - p_dm_dig_table->is_ignore_dig = false; - ODM_RT_TRACE(p_dm_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 (p_dm_odm->is_dm_initial_gain_enable == false) { - ODM_RT_TRACE(p_dm_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(p_adapter) && p_adapter->bInHctTest) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: Is AP mode or In HCT Test\n")); - return true; - } -#endif - - if (p_dm_odm->is_bt_hs_operation) - odm_dig_for_bt_hs_mode(p_dm_odm); - -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -#ifdef CONFIG_SPECIAL_SETTING_FOR_FUNAI_TV - if ((p_dm_odm->is_linked) && (p_dm_odm->adapter->registrypriv.force_igi != 0)) { - printk("p_dm_odm->rssi_min=%d\n", p_dm_odm->rssi_min); - odm_write_dig(p_dm_odm, p_dm_odm->adapter->registrypriv.force_igi); - return true; - } -#endif -#else - if (!(priv->up_time > 5)) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: Not In DIG operation period\n")); - return true; - } -#endif - - return false; -} - -void -odm_dig_init( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _dynamic_initial_gain_threshold_ *p_dm_dig_table = &p_dm_odm->dm_dig_table; -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - struct _FALSE_ALARM_STATISTICS *false_alm_cnt = (struct _FALSE_ALARM_STATISTICS *)phydm_get_structure(p_dm_odm, PHYDM_FALSEALMCNT); -#endif - u32 ret_value; - u8 i; - - p_dm_dig_table->is_stop_dig = false; - p_dm_dig_table->is_ignore_dig = false; - p_dm_dig_table->is_psd_in_progress = false; - p_dm_dig_table->cur_ig_value = (u8) odm_get_bb_reg(p_dm_odm, ODM_REG(IGI_A, p_dm_odm), ODM_BIT(IGI, p_dm_odm)); - p_dm_dig_table->pre_ig_value = 0; - p_dm_dig_table->rssi_low_thresh = DM_DIG_THRESH_LOW; - p_dm_dig_table->rssi_high_thresh = DM_DIG_THRESH_HIGH; - p_dm_dig_table->fa_low_thresh = DM_FALSEALARM_THRESH_LOW; - p_dm_dig_table->fa_high_thresh = DM_FALSEALARM_THRESH_HIGH; - p_dm_dig_table->backoff_val = DM_DIG_BACKOFF_DEFAULT; - p_dm_dig_table->backoff_val_range_max = DM_DIG_BACKOFF_MAX; - p_dm_dig_table->backoff_val_range_min = DM_DIG_BACKOFF_MIN; - p_dm_dig_table->pre_cck_cca_thres = 0xFF; - p_dm_dig_table->cur_cck_cca_thres = 0x83; - p_dm_dig_table->forbidden_igi = DM_DIG_MIN_NIC; - p_dm_dig_table->large_fa_hit = 0; - p_dm_dig_table->large_fa_timeout = 0; - p_dm_dig_table->recover_cnt = 0; - p_dm_dig_table->is_media_connect_0 = false; - p_dm_dig_table->is_media_connect_1 = false; - - /* To Initialize p_dm_odm->is_dm_initial_gain_enable == false to avoid DIG error */ - p_dm_odm->is_dm_initial_gain_enable = true; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - p_dm_dig_table->dig_dynamic_min_0 = 0x25; - p_dm_dig_table->dig_dynamic_min_1 = 0x25; - - /* For AP\ ADSL modified DIG */ - p_dm_dig_table->is_tp_target = false; - p_dm_dig_table->is_noise_est = true; - p_dm_dig_table->igi_offset_a = 0; - p_dm_dig_table->igi_offset_b = 0; - p_dm_dig_table->tp_train_th_min = 0; - - /* For RTL8881A */ - false_alm_cnt->cnt_ofdm_fail_pre = 0; - - /* Dyanmic EDCCA */ - if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) - odm_set_bb_reg(p_dm_odm, 0xC50, 0xFFFF0000, 0xfafd); -#else - p_dm_dig_table->dig_dynamic_min_0 = DM_DIG_MIN_NIC; - p_dm_dig_table->dig_dynamic_min_1 = DM_DIG_MIN_NIC; - - /* To Initi BT30 IGI */ - p_dm_dig_table->bt30_cur_igi = 0x32; - - odm_memory_set(p_dm_odm, p_dm_dig_table->pause_dig_value, 0, (DM_DIG_MAX_PAUSE_TYPE + 1)); - p_dm_dig_table->pause_dig_level = 0; - odm_memory_set(p_dm_odm, p_dm_dig_table->pause_cckpd_value, 0, (DM_DIG_MAX_PAUSE_TYPE + 1)); - p_dm_dig_table->pause_cckpd_level = 0; -#endif - - if (p_dm_odm->board_type & (ODM_BOARD_EXT_PA | ODM_BOARD_EXT_LNA)) { - p_dm_dig_table->rx_gain_range_max = DM_DIG_MAX_NIC; - p_dm_dig_table->rx_gain_range_min = DM_DIG_MIN_NIC; - } else { - p_dm_dig_table->rx_gain_range_max = DM_DIG_MAX_NIC; - p_dm_dig_table->rx_gain_range_min = DM_DIG_MIN_NIC; - } - -#if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1) - p_dm_dig_table->enable_adjust_big_jump = 1; - if (p_dm_odm->support_ic_type & ODM_RTL8822B) { - ret_value = odm_get_bb_reg(p_dm_odm, 0x8c8, MASKLWORD); - p_dm_dig_table->big_jump_step1 = (u8)(ret_value & 0xe) >> 1; - p_dm_dig_table->big_jump_step2 = (u8)(ret_value & 0x30) >> 4; - p_dm_dig_table->big_jump_step3 = (u8)(ret_value & 0xc0) >> 6; - - } else if (p_dm_odm->support_ic_type & ODM_RTL8197F) { - ret_value = odm_get_bb_reg(p_dm_odm, ODM_REG_BB_AGC_SET_2_11N, MASKLWORD); - p_dm_dig_table->big_jump_step1 = (u8)(ret_value & 0xe) >> 1; - p_dm_dig_table->big_jump_step2 = (u8)(ret_value & 0x30) >> 4; - p_dm_dig_table->big_jump_step3 = (u8)(ret_value & 0xc0) >> 6; - } - if (p_dm_odm->support_ic_type & (ODM_RTL8822B | ODM_RTL8197F)) { - for (i = 0; i < sizeof(p_dm_dig_table->big_jump_lmt); i++) { - if (p_dm_dig_table->big_jump_lmt[i] == 0) - p_dm_dig_table->big_jump_lmt[i] = 0x64; /* Set -10dBm as default value */ - } - } -#endif -} - - -void -odm_DIG( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - struct _ADAPTER *p_adapter = p_dm_odm->adapter; - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_dm_odm->adapter); -#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - struct rtl8192cd_priv *priv = p_dm_odm->priv; - struct sta_info *p_entry; -#endif - - /* Common parameters */ - struct _dynamic_initial_gain_threshold_ *p_dm_dig_table = &p_dm_odm->dm_dig_table; - struct _FALSE_ALARM_STATISTICS *p_false_alm_cnt = (struct _FALSE_ALARM_STATISTICS *)phydm_get_structure(p_dm_odm, PHYDM_FALSEALMCNT); - bool first_connect, first_dis_connect; - u8 dig_max_of_min, dig_dynamic_min; - u8 dm_dig_max, dm_dig_min; - u8 current_igi = p_dm_dig_table->cur_ig_value; - u8 offset; - u32 dm_FA_thres[3]; - u32 tx_tp = 0, rx_tp = 0; - bool dig_go_up_check = true; - bool is_dfs_band = false; - bool is_performance = true, is_first_tp_target = false, is_first_coverage = false; -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - u32 tp_train_th_min = dm_dig_tp_target_th0; - static u8 time_cnt = 0; - u8 i; -#endif - - if (odm_dig_abort(p_dm_odm) == true) - return; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG()===========================>\n\n")); - - - /* 1 Update status */ - { - dig_dynamic_min = p_dm_dig_table->dig_dynamic_min_0; - first_connect = (p_dm_odm->is_linked) && (p_dm_dig_table->is_media_connect_0 == false); - first_dis_connect = (!p_dm_odm->is_linked) && (p_dm_dig_table->is_media_connect_0 == true); - } - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - /* 1 Noise Floor Estimate */ - /* p_dm_dig_table->is_noise_est = (first_connect)?true:p_dm_dig_table->is_noise_est; */ - /* odm_inband_noise_calculate (p_dm_odm); */ - - /* 1 mode decision */ - if (p_dm_odm->is_linked) { - /* 2 Calculate total TP */ - for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { - p_entry = p_dm_odm->p_odm_sta_info[i]; - if (IS_STA_VALID(p_entry)) { - rx_tp += (u32)(p_entry->rx_byte_cnt_low_maw >> 7); - tx_tp += (u32)(p_entry->tx_byte_cnt_low_maw >> 7); /* Kbps */ - } - } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): TX TP = %dkbps, RX TP = %dkbps\n", tx_tp, rx_tp)); - } - - switch (p_dm_odm->priv->pshare->rf_ft_var.dig_cov_enable) { - case 0: - { - is_performance = true; - break; - } - case 1: - { - is_performance = false; - break; - } - case 2: - { - if (p_dm_odm->is_linked) { - if (p_dm_dig_table->tp_train_th_min > dm_dig_tp_target_th0) - tp_train_th_min = p_dm_dig_table->tp_train_th_min; - - if (p_dm_dig_table->tp_train_th_min > dm_dig_tp_target_th1) - tp_train_th_min = dm_dig_tp_target_th1; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): TP training mode lower bound = %dkbps\n", tp_train_th_min)); - - /* 2 Decide DIG mode by total TP */ - if ((tx_tp + rx_tp) > dm_dig_tp_target_th1) { /* change to performance mode */ - is_first_tp_target = (!p_dm_dig_table->is_tp_target) ? true : false; - p_dm_dig_table->is_tp_target = true; - is_performance = true; - } else if ((tx_tp + rx_tp) < tp_train_th_min) { /* change to coverage mode */ - is_first_coverage = (p_dm_dig_table->is_tp_target) ? true : false; - - if (time_cnt < dm_dig_tp_training_period) { - p_dm_dig_table->is_tp_target = false; - is_performance = false; - time_cnt++; - } else { - p_dm_dig_table->is_tp_target = true; - is_performance = true; - is_first_tp_target = true; - time_cnt = 0; - } - } else { /* remain previous mode */ - is_performance = p_dm_dig_table->is_tp_target; - - if (!is_performance) { - if (time_cnt < dm_dig_tp_training_period) - time_cnt++; - else { - p_dm_dig_table->is_tp_target = true; - is_performance = true; - is_first_tp_target = true; - time_cnt = 0; - } - } - } - - if (!is_performance) - p_dm_dig_table->tp_train_th_min = rx_tp + tx_tp; - - } else { - is_performance = false; - p_dm_dig_table->tp_train_th_min = 0; - } - break; - } - default: - is_performance = true; - } - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("====== DIG mode = %d ======\n", p_dm_odm->priv->pshare->rf_ft_var.dig_cov_enable)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("====== is_performance = %d ======\n", is_performance)); -#endif - - /* 1 Boundary Decision */ - { -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - /* 2 For AP\ADSL */ - if (!is_performance) { - dm_dig_max = DM_DIG_MAX_AP_COVERAGR; - dm_dig_min = DM_DIG_MIN_AP_COVERAGE; - dig_max_of_min = DM_DIG_MAX_OF_MIN_COVERAGE; - } else { - if (p_dm_odm->rf_type == ODM_1T1R) - dm_dig_max = DM_DIG_MAX_AP - 6; - else - dm_dig_max = DM_DIG_MAX_AP; - - if ((*p_dm_odm->p_band_type == ODM_BAND_2_4G) && (p_dm_odm->support_ic_type & ODM_RTL8814A)) /* for 2G 8814 */ - dm_dig_min = 0x1c; - else if (p_dm_odm->support_ic_type & ODM_RTL8197F) - dm_dig_min = 0x1e; - else - dm_dig_min = DM_DIG_MIN_AP; - dig_max_of_min = DM_DIG_MAX_OF_MIN; - } - - /* 4 TX2path */ - if (priv->pmib->dot11RFEntry.tx2path && !is_dfs_band && (*(p_dm_odm->p_wireless_mode) == ODM_WM_B)) - dm_dig_max = 0x2A; - -#if RTL8192E_SUPPORT -#ifdef HIGH_POWER_EXT_LNA - if ((p_dm_odm->support_ic_type & (ODM_RTL8192E)) && (p_dm_odm->ext_lna)) - dm_dig_max = 0x42; -#endif -#endif - if (p_dm_odm->igi_lower_bound) { - if (dm_dig_min < p_dm_odm->igi_lower_bound) - dm_dig_min = p_dm_odm->igi_lower_bound; - if (dig_max_of_min < p_dm_odm->igi_lower_bound) - dig_max_of_min = p_dm_odm->igi_lower_bound; - } - if (p_dm_odm->igi_upper_bound) { - if (dm_dig_max > p_dm_odm->igi_upper_bound) - dm_dig_max = p_dm_odm->igi_upper_bound; - if (dig_max_of_min > p_dm_odm->igi_upper_bound) - dig_max_of_min = p_dm_odm->igi_upper_bound; - } -#else - /* 2 For WIN\CE */ - if (p_dm_odm->support_ic_type >= ODM_RTL8188E) - dm_dig_max = 0x5A; - else - dm_dig_max = DM_DIG_MAX_NIC; - - if (p_dm_odm->support_ic_type != ODM_RTL8821) - dm_dig_min = DM_DIG_MIN_NIC; - else - dm_dig_min = 0x1C; - - dig_max_of_min = DM_DIG_MAX_AP; -#endif - - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP | ODM_CE)) - /* Modify lower bound for DFS band */ - if ((((*p_dm_odm->p_channel >= 52) && (*p_dm_odm->p_channel <= 64)) || - ((*p_dm_odm->p_channel >= 100) && (*p_dm_odm->p_channel <= 140))) -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) - && phydm_dfs_master_enabled(p_dm_odm) == true -#endif - ) { - is_dfs_band = true; - if (*p_dm_odm->p_band_width == ODM_BW20M) - dm_dig_min = DM_DIG_MIN_AP_DFS + 2; - else - dm_dig_min = DM_DIG_MIN_AP_DFS; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): ====== In DFS band ======\n")); - } -#endif - } - ODM_RT_TRACE(p_dm_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 (p_dm_odm->pu1_forced_igi_lb && (0 < *p_dm_odm->pu1_forced_igi_lb)) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Force IGI lb to: 0x%02x !!!!!!\n", *p_dm_odm->pu1_forced_igi_lb)); - dm_dig_min = *p_dm_odm->pu1_forced_igi_lb; - dm_dig_max = (dm_dig_min <= dm_dig_max) ? (dm_dig_max) : (dm_dig_min + 1); - } -#endif - - /* 1 Adjust boundary by RSSI */ - if (p_dm_odm->is_linked && is_performance) { - /* 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 ((p_dm_odm->support_ic_type & (ODM_RTL8192E | ODM_RTL8723B | ODM_RTL8812 | ODM_RTL8821)) && (p_dm_odm->is_bt_limited_dig == 1)) { - offset = 10; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Coex. case: Force upper bound to RSSI + %d !!!!!!\n", offset)); - } else - offset = 15; -#endif - - if ((p_dm_odm->rssi_min + offset) > dm_dig_max) - p_dm_dig_table->rx_gain_range_max = dm_dig_max; - else if ((p_dm_odm->rssi_min + offset) < dm_dig_min) - p_dm_dig_table->rx_gain_range_max = dm_dig_min; - else - p_dm_dig_table->rx_gain_range_max = p_dm_odm->rssi_min + offset; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - /* 2 Modify DIG lower bound */ - /* if(p_dm_odm->is_one_entry_only) */ - { - if (p_dm_odm->rssi_min < dm_dig_min) - dig_dynamic_min = dm_dig_min; - else if (p_dm_odm->rssi_min > dig_max_of_min) - dig_dynamic_min = dig_max_of_min; - else - dig_dynamic_min = p_dm_odm->rssi_min; - -#if (DM_ODM_SUPPORT_TYPE & ODM_CE) - if (is_dfs_band) { - dig_dynamic_min = dm_dig_min; - ODM_RT_TRACE(p_dm_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 (is_dfs_band) { - dig_dynamic_min = dm_dig_min; - ODM_RT_TRACE(p_dm_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 (p_dm_odm->rssi_min < dm_dig_min) - dig_dynamic_min = dm_dig_min; - else if (p_dm_odm->rssi_min > dig_max_of_min) - dig_dynamic_min = dig_max_of_min; - else - dig_dynamic_min = p_dm_odm->rssi_min; - } - } -#endif - } else { -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP | ODM_CE)) - if (is_performance && is_dfs_band) { - p_dm_dig_table->rx_gain_range_max = 0x28; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): DFS band: Force upper bound to 0x%x before link !!!!!!\n", p_dm_dig_table->rx_gain_range_max)); - } else -#endif - { - if (is_performance) - p_dm_dig_table->rx_gain_range_max = DM_DIG_MAX_OF_MIN; - else - p_dm_dig_table->rx_gain_range_max = dm_dig_max; - } - dig_dynamic_min = dm_dig_min; - } - - /* 1 Force Lower Bound for AntDiv */ - if (p_dm_odm->is_linked && !p_dm_odm->is_one_entry_only) { - if ((p_dm_odm->support_ic_type & ODM_ANTDIV_SUPPORT) && (p_dm_odm->support_ability & ODM_BB_ANT_DIV)) { - if (p_dm_odm->ant_div_type == CG_TRX_HW_ANTDIV || p_dm_odm->ant_div_type == CG_TRX_SMART_ANTDIV) { - if (p_dm_dig_table->ant_div_rssi_max > dig_max_of_min) - dig_dynamic_min = dig_max_of_min; - else - dig_dynamic_min = (u8) p_dm_dig_table->ant_div_rssi_max; - ODM_RT_TRACE(p_dm_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(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Antenna diversity case: RSSI_max = 0x%x !!!!!!\n", p_dm_dig_table->ant_div_rssi_max)); - } - } - } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Adjust boundary by RSSI Upper bound = 0x%x, Lower bound = 0x%x\n", - p_dm_dig_table->rx_gain_range_max, dig_dynamic_min)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Link status: is_linked = %d, RSSI = %d, bFirstConnect = %d, bFirsrDisConnect = %d\n\n", - p_dm_odm->is_linked, p_dm_odm->rssi_min, first_connect, first_dis_connect)); - - /* 1 Modify DIG lower bound, deal with abnormal case */ - /* 2 Abnormal false alarm case */ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP | ODM_CE)) - if (is_dfs_band) - p_dm_dig_table->rx_gain_range_min = dig_dynamic_min; - else -#endif - { - if (!p_dm_odm->is_linked) { - p_dm_dig_table->rx_gain_range_min = dig_dynamic_min; - - if (first_dis_connect) - p_dm_dig_table->forbidden_igi = dig_dynamic_min; - } else - p_dm_dig_table->rx_gain_range_min = odm_forbidden_igi_check(p_dm_odm, dig_dynamic_min, current_igi); - } - - /* 2 Abnormal # beacon case */ -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - if (p_dm_odm->is_linked && !first_connect) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("Beacon Num (%d)\n", p_dm_odm->phy_dbg_info.num_qry_beacon_pkt)); - if ((p_dm_odm->phy_dbg_info.num_qry_beacon_pkt < 5) && (p_dm_odm->bsta_state)) { - p_dm_dig_table->rx_gain_range_min = 0x1c; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Abnrormal #beacon (%d) case in STA mode: Force lower bound to 0x%x !!!!!!\n\n", - p_dm_odm->phy_dbg_info.num_qry_beacon_pkt, p_dm_dig_table->rx_gain_range_min)); - } - } -#endif - - /* 2 Abnormal lower bound case */ - if (p_dm_dig_table->rx_gain_range_min > p_dm_dig_table->rx_gain_range_max) { - p_dm_dig_table->rx_gain_range_min = p_dm_dig_table->rx_gain_range_max; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Abnrormal lower bound case: Force lower bound to 0x%x !!!!!!\n\n", p_dm_dig_table->rx_gain_range_min)); - } - - - /* 1 False alarm threshold decision */ - odm_fa_threshold_check(p_dm_odm, is_dfs_band, is_performance, rx_tp, tx_tp, dm_FA_thres); - ODM_RT_TRACE(p_dm_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 (p_dm_odm->is_linked && is_performance) { - /* 2 After link */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Adjust IGI after link\n")); - - if (is_first_tp_target || (first_connect && is_performance)) { - p_dm_dig_table->large_fa_hit = 0; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP | ODM_CE)) - if (is_dfs_band) { - if (p_dm_odm->rssi_min > 0x28) - current_igi = 0x28; - else - current_igi = p_dm_odm->rssi_min; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): DFS band: One-shot to 0x28 upmost!!!!!!\n")); - } else -#endif - { - if (p_dm_odm->rssi_min < dig_max_of_min) { - if (current_igi < p_dm_odm->rssi_min) - current_igi = p_dm_odm->rssi_min; - } else { - if (current_igi < dig_max_of_min) - current_igi = dig_max_of_min; - } - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -#if (RTL8812A_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8812) - odm_config_bb_with_header_file(p_dm_odm, CONFIG_BB_AGC_TAB_DIFF); -#endif -#endif - } - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): First connect case: IGI does on-shot to 0x%x\n", current_igi)); - - } else { - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - - if (priv->pshare->rf_ft_var.dig_upcheck_enable) - dig_go_up_check = phydm_dig_go_up_check(p_dm_odm); -#endif - - if ((p_false_alm_cnt->cnt_all > dm_FA_thres[2]) && dig_go_up_check) - current_igi = current_igi + 4; - else if ((p_false_alm_cnt->cnt_all > dm_FA_thres[1]) && dig_go_up_check) - current_igi = current_igi + 2; - else if (p_false_alm_cnt->cnt_all < dm_FA_thres[0]) - current_igi = current_igi - 2; - - /* 4 Abnormal # beacon case */ -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - if ((p_dm_odm->phy_dbg_info.num_qry_beacon_pkt < 5) && (p_false_alm_cnt->cnt_all < DM_DIG_FA_TH1) && (p_dm_odm->bsta_state)) { - current_igi = p_dm_dig_table->rx_gain_range_min; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Abnormal #beacon (%d) case: IGI does one-shot to 0x%x\n", - p_dm_odm->phy_dbg_info.num_qry_beacon_pkt, current_igi)); - } -#endif - } - } else { - /* 2 Before link */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Adjust IGI before link\n")); - - if (first_dis_connect || is_first_coverage) { - current_igi = dm_dig_min; - ODM_RT_TRACE(p_dm_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_go_up_check = phydm_dig_go_up_check(p_dm_odm); -#endif - - if ((p_false_alm_cnt->cnt_all > dm_FA_thres[2]) && dig_go_up_check) - current_igi = current_igi + 4; - else if ((p_false_alm_cnt->cnt_all > dm_FA_thres[1]) && dig_go_up_check) - current_igi = current_igi + 2; - else if (p_false_alm_cnt->cnt_all < dm_FA_thres[0]) - current_igi = current_igi - 2; - } - } - - /* 1 Check initial gain by upper/lower bound */ - if (current_igi < p_dm_dig_table->rx_gain_range_min) - current_igi = p_dm_dig_table->rx_gain_range_min; - - if (current_igi > p_dm_dig_table->rx_gain_range_max) - current_igi = p_dm_dig_table->rx_gain_range_max; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): cur_ig_value=0x%x, TotalFA = %d\n\n", current_igi, p_false_alm_cnt->cnt_all)); - - /* 1 Update status */ - { -#if ((DM_ODM_SUPPORT_TYPE & ODM_WIN) || ((DM_ODM_SUPPORT_TYPE & ODM_CE) && (ODM_CONFIG_BT_COEXIST == 1))) - if (p_dm_odm->is_bt_hs_operation) { - if (p_dm_odm->is_linked) { - if (p_dm_dig_table->bt30_cur_igi > (current_igi)) - odm_write_dig(p_dm_odm, current_igi); - else - odm_write_dig(p_dm_odm, p_dm_dig_table->bt30_cur_igi); - - p_dm_dig_table->is_media_connect_0 = p_dm_odm->is_linked; - p_dm_dig_table->dig_dynamic_min_0 = dig_dynamic_min; - } else { - if (p_dm_odm->is_link_in_process) - odm_write_dig(p_dm_odm, 0x1c); - else if (p_dm_odm->is_bt_connect_process) - odm_write_dig(p_dm_odm, 0x28); - else - odm_write_dig(p_dm_odm, p_dm_dig_table->bt30_cur_igi);/* odm_write_dig(p_dm_odm, p_dm_dig_table->cur_ig_value); */ - } - } else /* BT is not using */ -#endif - { - odm_write_dig(p_dm_odm, current_igi);/* odm_write_dig(p_dm_odm, p_dm_dig_table->cur_ig_value); */ - p_dm_dig_table->is_media_connect_0 = p_dm_odm->is_linked; - p_dm_dig_table->dig_dynamic_min_0 = dig_dynamic_min; - } - } -} - -void -odm_dig_by_rssi_lps( - void *p_dm_void -) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _FALSE_ALARM_STATISTICS *p_false_alm_cnt = (struct _FALSE_ALARM_STATISTICS *)phydm_get_structure(p_dm_odm, PHYDM_FALSEALMCNT); - - u8 rssi_lower = DM_DIG_MIN_NIC; /* 0x1E or 0x1C */ - u8 current_igi = p_dm_odm->rssi_min; - - if (odm_dig_abort(p_dm_odm) == true) - return; - - current_igi = current_igi + RSSI_OFFSET_DIG; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_dig_by_rssi_lps()==>\n")); - - /* Using FW PS mode to make IGI */ - /* Adjust by FA in LPS MODE */ - if (p_false_alm_cnt->cnt_all > DM_DIG_FA_TH2_LPS) - current_igi = current_igi + 4; - else if (p_false_alm_cnt->cnt_all > DM_DIG_FA_TH1_LPS) - current_igi = current_igi + 2; - else if (p_false_alm_cnt->cnt_all < DM_DIG_FA_TH0_LPS) - current_igi = current_igi - 2; - - - /* Lower bound checking */ - - /* RSSI Lower bound check */ - if ((p_dm_odm->rssi_min - 10) > DM_DIG_MIN_NIC) - rssi_lower = (p_dm_odm->rssi_min - 10); - else - rssi_lower = DM_DIG_MIN_NIC; - - /* Upper and Lower Bound checking */ - if (current_igi > DM_DIG_MAX_NIC) - current_igi = DM_DIG_MAX_NIC; - else if (current_igi < rssi_lower) - current_igi = rssi_lower; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_dig_by_rssi_lps(): p_false_alm_cnt->cnt_all = %d\n", p_false_alm_cnt->cnt_all)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_dig_by_rssi_lps(): p_dm_odm->rssi_min = %d\n", p_dm_odm->rssi_min)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_dig_by_rssi_lps(): current_igi = 0x%x\n", current_igi)); - - odm_write_dig(p_dm_odm, current_igi);/* odm_write_dig(p_dm_odm, p_dm_dig_table->cur_ig_value); */ -#endif -} - -/* 3============================================================ - * 3 FASLE ALARM CHECK - * 3============================================================ */ - -void -odm_false_alarm_counter_statistics( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _FALSE_ALARM_STATISTICS *false_alm_cnt = (struct _FALSE_ALARM_STATISTICS *)phydm_get_structure(p_dm_odm, PHYDM_FALSEALMCNT); -#if (PHYDM_LA_MODE_SUPPORT == 1) - struct _RT_ADCSMP *adc_smp = &(p_dm_odm->adcsmp); -#endif - u32 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) */ - struct rtl8192cd_priv *priv = p_dm_odm->priv; - if ((priv->auto_channel != 0) && (priv->auto_channel != 2)) - return; -#endif -#endif - - if (!(p_dm_odm->support_ability & ODM_BB_FA_CNT)) - return; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_false_alarm_counter_statistics()======>\n")); - -#if (ODM_IC_11N_SERIES_SUPPORT == 1) - if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) { - - /* hold ofdm counter */ - odm_set_bb_reg(p_dm_odm, ODM_REG_OFDM_FA_HOLDC_11N, BIT(31), 1); /* hold page C counter */ - odm_set_bb_reg(p_dm_odm, ODM_REG_OFDM_FA_RSTD_11N, BIT(31), 1); /* hold page D counter */ - - ret_value = odm_get_bb_reg(p_dm_odm, 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, 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, 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, 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, ODM_REG_CCK_CRC32_ERROR_CNT_11N, MASKDWORD); - false_alm_cnt->cnt_cck_crc32_ok = odm_get_bb_reg(p_dm_odm, ODM_REG_CCK_CRC32_OK_CNT_11N, MASKDWORD); - - /* read OFDM CRC32 counter */ - ret_value = odm_get_bb_reg(p_dm_odm, 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, 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 (RTL8188E_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8188E) { - ret_value = odm_get_bb_reg(p_dm_odm, 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 - - { - /* hold cck counter */ - odm_set_bb_reg(p_dm_odm, ODM_REG_CCK_FA_RST_11N, BIT(12), 1); - odm_set_bb_reg(p_dm_odm, ODM_REG_CCK_FA_RST_11N, BIT(14), 1); - - ret_value = odm_get_bb_reg(p_dm_odm, ODM_REG_CCK_FA_LSB_11N, MASKBYTE0); - false_alm_cnt->cnt_cck_fail = ret_value; - - ret_value = odm_get_bb_reg(p_dm_odm, 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, 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; - - if (p_dm_odm->support_ic_type >= ODM_RTL8188E) { - /*reset false alarm counter registers*/ - odm_set_bb_reg(p_dm_odm, ODM_REG_OFDM_FA_RSTC_11N, BIT(31), 1); - odm_set_bb_reg(p_dm_odm, ODM_REG_OFDM_FA_RSTC_11N, BIT(31), 0); - odm_set_bb_reg(p_dm_odm, ODM_REG_OFDM_FA_RSTD_11N, BIT(27), 1); - odm_set_bb_reg(p_dm_odm, ODM_REG_OFDM_FA_RSTD_11N, BIT(27), 0); - - /*update ofdm counter*/ - odm_set_bb_reg(p_dm_odm, ODM_REG_OFDM_FA_HOLDC_11N, BIT(31), 0); /*update page C counter*/ - odm_set_bb_reg(p_dm_odm, ODM_REG_OFDM_FA_RSTD_11N, BIT(31), 0); /*update page D counter*/ - - /*reset CCK CCA counter*/ - odm_set_bb_reg(p_dm_odm, ODM_REG_CCK_FA_RST_11N, BIT(13) | BIT(12), 0); - odm_set_bb_reg(p_dm_odm, ODM_REG_CCK_FA_RST_11N, BIT(13) | BIT(12), 2); - - /*reset CCK FA counter*/ - odm_set_bb_reg(p_dm_odm, ODM_REG_CCK_FA_RST_11N, BIT(15) | BIT(14), 0); - odm_set_bb_reg(p_dm_odm, ODM_REG_CCK_FA_RST_11N, BIT(15) | BIT(14), 2); - - /*reset CRC32 counter*/ - odm_set_bb_reg(p_dm_odm, ODM_REG_PAGE_F_RST_11N, BIT(16), 1); - odm_set_bb_reg(p_dm_odm, ODM_REG_PAGE_F_RST_11N, BIT(16), 0); - } - - /* Get debug port 0 */ - odm_set_bb_reg(p_dm_odm, ODM_REG_DBG_RPT_11N, MASKDWORD, 0x0); - false_alm_cnt->dbg_port0 = odm_get_bb_reg(p_dm_odm, ODM_REG_RPT_11N, MASKDWORD); - - /* Get EDCCA flag */ - odm_set_bb_reg(p_dm_odm, ODM_REG_DBG_RPT_11N, MASKDWORD, 0x208); - false_alm_cnt->edcca_flag = (bool)odm_get_bb_reg(p_dm_odm, ODM_REG_RPT_11N, BIT(30)); - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_false_alarm_counter_statistics(): cnt_fast_fsync=%d, cnt_sb_search_fail=%d\n", - false_alm_cnt->cnt_fast_fsync, false_alm_cnt->cnt_sb_search_fail)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_false_alarm_counter_statistics(): cnt_parity_fail=%d, cnt_rate_illegal=%d\n", - false_alm_cnt->cnt_parity_fail, false_alm_cnt->cnt_rate_illegal)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_false_alarm_counter_statistics(): cnt_crc8_fail=%d, cnt_mcs_fail=%d\n", - false_alm_cnt->cnt_crc8_fail, false_alm_cnt->cnt_mcs_fail)); - } -#endif - -#if (ODM_IC_11AC_SERIES_SUPPORT == 1) - if (p_dm_odm->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, ODM_REG_OFDM_FA_11AC, MASKLWORD); - - /* Read CCK FA counter */ - false_alm_cnt->cnt_cck_fail = odm_get_bb_reg(p_dm_odm, ODM_REG_CCK_FA_11AC, MASKLWORD); - - /* read CCK/OFDM CCA counter */ - ret_value = odm_get_bb_reg(p_dm_odm, 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, 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, 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, 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, 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_odm->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; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_false_alarm_counter_statistics(): cnt_ofdm_fail=%d\n", false_alm_cnt->cnt_ofdm_fail_pre)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_false_alarm_counter_statistics(): cnt_ofdm_fail_pre=%d\n", cnt_ofdm_fail_temp)); - - /* Reset FA counter by enable/disable OFDM */ - if (false_alm_cnt->cnt_ofdm_fail_pre >= 0x7fff) { - /* reset OFDM */ - odm_set_bb_reg(p_dm_odm, ODM_REG_BB_RX_PATH_11AC, BIT(29), 0); - odm_set_bb_reg(p_dm_odm, ODM_REG_BB_RX_PATH_11AC, BIT(29), 1); - false_alm_cnt->cnt_ofdm_fail_pre = 0; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_false_alarm_counter_statistics(): Reset false alarm counter\n")); - } - } -#endif - - /* reset OFDM FA coutner */ - odm_set_bb_reg(p_dm_odm, ODM_REG_OFDM_FA_RST_11AC, BIT(17), 1); - odm_set_bb_reg(p_dm_odm, ODM_REG_OFDM_FA_RST_11AC, BIT(17), 0); - - /* reset CCK FA counter */ - odm_set_bb_reg(p_dm_odm, ODM_REG_CCK_FA_RST_11AC, BIT(15), 0); - odm_set_bb_reg(p_dm_odm, ODM_REG_CCK_FA_RST_11AC, BIT(15), 1); - - /* reset CCA counter */ - odm_set_bb_reg(p_dm_odm, ODM_REG_RST_RPT_11AC, BIT(0), 1); - odm_set_bb_reg(p_dm_odm, ODM_REG_RST_RPT_11AC, BIT(0), 0); - - cck_enable = odm_get_bb_reg(p_dm_odm, ODM_REG_BB_RX_PATH_11AC, BIT(28)); - if (cck_enable) { /* if(*p_dm_odm->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; - } - -#if (PHYDM_LA_MODE_SUPPORT == 1) - if (adc_smp->adc_smp_state == ADCSMP_STATE_IDLE) -#endif - { - /* Get debug port 0 */ - odm_set_bb_reg(p_dm_odm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0x0); - false_alm_cnt->dbg_port0 = odm_get_bb_reg(p_dm_odm, ODM_REG_RPT_11AC, MASKDWORD); - - /* Get EDCCA flag */ - odm_set_bb_reg(p_dm_odm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0x209); - false_alm_cnt->edcca_flag = (bool)odm_get_bb_reg(p_dm_odm, ODM_REG_RPT_11AC, BIT(30)); - } - - } -#endif - - - 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; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_false_alarm_counter_statistics(): cnt_ofdm_cca=%d\n", false_alm_cnt->cnt_ofdm_cca)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_false_alarm_counter_statistics(): cnt_cck_cca=%d\n", false_alm_cnt->cnt_cck_cca)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_false_alarm_counter_statistics(): cnt_cca_all=%d\n", false_alm_cnt->cnt_cca_all)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_false_alarm_counter_statistics(): cnt_ofdm_fail=%d\n", false_alm_cnt->cnt_ofdm_fail)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_false_alarm_counter_statistics(): cnt_cck_fail=%d\n", false_alm_cnt->cnt_cck_fail)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_false_alarm_counter_statistics(): cnt_ofdm_fail=%d\n", false_alm_cnt->cnt_ofdm_fail)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_false_alarm_counter_statistics(): Total False Alarm=%d\n", false_alm_cnt->cnt_all)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_false_alarm_counter_statistics(): CCK CRC32 fail: %d, ok: %d\n", false_alm_cnt->cnt_cck_crc32_error, false_alm_cnt->cnt_cck_crc32_ok)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_false_alarm_counter_statistics(): OFDM CRC32 fail: %d, ok: %d\n", false_alm_cnt->cnt_ofdm_crc32_error, false_alm_cnt->cnt_ofdm_crc32_ok)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_false_alarm_counter_statistics(): HT CRC32 fail: %d, ok: %d\n", false_alm_cnt->cnt_ht_crc32_error, false_alm_cnt->cnt_ht_crc32_ok)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_false_alarm_counter_statistics(): VHT CRC32 fail: %d, ok: %d\n", false_alm_cnt->cnt_vht_crc32_error, false_alm_cnt->cnt_vht_crc32_ok)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_false_alarm_counter_statistics(): Total CRC32 fail: %d, ok: %d\n", false_alm_cnt->cnt_crc32_error_all, false_alm_cnt->cnt_crc32_ok_all)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_false_alarm_counter_statistics(): dbg port 0x0 = 0x%x, EDCCA = %d\n\n", false_alm_cnt->dbg_port0, false_alm_cnt->edcca_flag)); -} - -/* 3============================================================ - * 3 CCK Packet Detect threshold - * 3============================================================ */ - -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 -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _dynamic_initial_gain_threshold_ *p_dm_dig_table = &p_dm_odm->dm_dig_table; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_pause_cck_packet_detection()=========> level = %d\n", pause_level)); - - if ((p_dm_dig_table->pause_cckpd_level == 0) && (!(p_dm_odm->support_ability & ODM_BB_CCK_PD) || !(p_dm_odm->support_ability & ODM_BB_FA_CNT))) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("Return: support_ability ODM_BB_CCK_PD or ODM_BB_FA_CNT is disabled\n")); - return; - } - - if (pause_level > DM_DIG_MAX_PAUSE_TYPE) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, - ("odm_pause_cck_packet_detection(): Return: Wrong pause level !!\n")); - return; - } - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_pause_cck_packet_detection(): pause level = 0x%x, Current value = 0x%x\n", p_dm_dig_table->pause_cckpd_level, cck_pd_threshold)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_pause_cck_packet_detection(): pause value = 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x\n", - p_dm_dig_table->pause_cckpd_value[7], p_dm_dig_table->pause_cckpd_value[6], p_dm_dig_table->pause_cckpd_value[5], p_dm_dig_table->pause_cckpd_value[4], - p_dm_dig_table->pause_cckpd_value[3], p_dm_dig_table->pause_cckpd_value[2], p_dm_dig_table->pause_cckpd_value[1], p_dm_dig_table->pause_cckpd_value[0])); - - switch (pause_type) { - /* Pause CCK Packet Detection threshold */ - case PHYDM_PAUSE: - { - /* Disable CCK PD */ - odm_cmn_info_update(p_dm_odm, ODM_CMNINFO_ABILITY, p_dm_odm->support_ability & (~ODM_BB_CCK_PD)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_pause_cck_packet_detection(): Pause CCK packet detection threshold !!\n")); - - /* Backup original CCK PD threshold decided by CCK PD mechanism */ - if (p_dm_dig_table->pause_cckpd_level == 0) { - p_dm_dig_table->cck_pd_backup = p_dm_dig_table->cur_cck_cca_thres; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, - ("odm_pause_cck_packet_detection(): Backup CCKPD = 0x%x, new CCKPD = 0x%x\n", p_dm_dig_table->cck_pd_backup, cck_pd_threshold)); - } - - /* Update pause level */ - p_dm_dig_table->pause_cckpd_level = (p_dm_dig_table->pause_cckpd_level | BIT(pause_level)); - - /* Record CCK PD threshold */ - p_dm_dig_table->pause_cckpd_value[pause_level] = cck_pd_threshold; - - /* Write new CCK PD threshold */ - if (BIT(pause_level + 1) > p_dm_dig_table->pause_cckpd_level) { - odm_write_cck_cca_thres(p_dm_odm, cck_pd_threshold); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_pause_cck_packet_detection(): CCKPD of higher level = 0x%x\n", cck_pd_threshold)); - } - break; - } - /* Resume CCK Packet Detection threshold */ - case PHYDM_RESUME: - { - /* check if the level is illegal or not */ - if ((p_dm_dig_table->pause_cckpd_level & (BIT(pause_level))) != 0) { - p_dm_dig_table->pause_cckpd_level = p_dm_dig_table->pause_cckpd_level & (~(BIT(pause_level))); - p_dm_dig_table->pause_cckpd_value[pause_level] = 0; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_pause_cck_packet_detection(): Resume CCK PD !!\n")); - } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_pause_cck_packet_detection(): Wrong resume level !!\n")); - break; - } - - /* Resume DIG */ - if (p_dm_dig_table->pause_cckpd_level == 0) { - /* Write backup IGI value */ - odm_write_cck_cca_thres(p_dm_odm, p_dm_dig_table->cck_pd_backup); - /* p_dm_dig_table->is_ignore_dig = true; */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_pause_cck_packet_detection(): Write original CCKPD = 0x%x\n", p_dm_dig_table->cck_pd_backup)); - - /* Enable DIG */ - odm_cmn_info_update(p_dm_odm, ODM_CMNINFO_ABILITY, p_dm_odm->support_ability | ODM_BB_CCK_PD); - break; - } - - if (BIT(pause_level) > p_dm_dig_table->pause_cckpd_level) { - s8 max_level; - - /* Calculate the maximum level now */ - for (max_level = (pause_level - 1); max_level >= 0; max_level--) { - if ((p_dm_dig_table->pause_cckpd_level & BIT(max_level)) > 0) - break; - } - - /* write CCKPD of lower level */ - odm_write_cck_cca_thres(p_dm_odm, p_dm_dig_table->pause_cckpd_value[max_level]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_pause_cck_packet_detection(): Write CCKPD (0x%x) of level (%d)\n", - p_dm_dig_table->pause_cckpd_value[max_level], max_level)); - break; - } - break; - } - default: - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_pause_cck_packet_detection(): Wrong type !!\n")); - break; - } - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_pause_cck_packet_detection(): pause level = 0x%x, Current value = 0x%x\n", p_dm_dig_table->pause_cckpd_level, cck_pd_threshold)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_pause_cck_packet_detection(): pause value = 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x\n", - p_dm_dig_table->pause_cckpd_value[7], p_dm_dig_table->pause_cckpd_value[6], p_dm_dig_table->pause_cckpd_value[5], p_dm_dig_table->pause_cckpd_value[4], - p_dm_dig_table->pause_cckpd_value[3], p_dm_dig_table->pause_cckpd_value[2], p_dm_dig_table->pause_cckpd_value[1], p_dm_dig_table->pause_cckpd_value[0])); -} - - -void -odm_cck_packet_detection_thresh( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _dynamic_initial_gain_threshold_ *p_dm_dig_table = &p_dm_odm->dm_dig_table; - struct _FALSE_ALARM_STATISTICS *false_alm_cnt = (struct _FALSE_ALARM_STATISTICS *)phydm_get_structure(p_dm_odm, PHYDM_FALSEALMCNT); - u8 cur_cck_cca_thres = p_dm_dig_table->cur_cck_cca_thres, RSSI_thd = 35; - - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - /* modify by Guo.Mingzhi 2011-12-29 */ - if (p_dm_odm->is_dual_mac_smart_concurrent == true) - /* if (p_dm_odm->is_dual_mac_smart_concurrent == false) */ - return; - if (p_dm_odm->is_bt_hs_operation) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_cck_packet_detection_thresh() write 0xcd for BT HS mode!!\n")); - odm_write_cck_cca_thres(p_dm_odm, 0xcd); - return; - } -#endif - - if ((!(p_dm_odm->support_ability & ODM_BB_CCK_PD)) || (!(p_dm_odm->support_ability & ODM_BB_FA_CNT))) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_cck_packet_detection_thresh() return==========\n")); -#ifdef MCR_WIRELESS_EXTEND - odm_write_cck_cca_thres(p_dm_odm, 0x43); -#endif - return; - } - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - if (p_dm_odm->ext_lna) - return; -#endif - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_cck_packet_detection_thresh() ==========>\n")); - - if (p_dm_dig_table->cck_fa_ma == 0xffffffff) - p_dm_dig_table->cck_fa_ma = false_alm_cnt->cnt_cck_fail; - else - p_dm_dig_table->cck_fa_ma = ((p_dm_dig_table->cck_fa_ma << 1) + p_dm_dig_table->cck_fa_ma + false_alm_cnt->cnt_cck_fail) >> 2; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_cck_packet_detection_thresh(): CCK FA moving average = %d\n", p_dm_dig_table->cck_fa_ma)); - - if (p_dm_odm->is_linked) { -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -#if 0 /*for [PCIE-1596]*/ - if (p_dm_odm->rssi_min > (RSSI_thd + 14)) - cur_cck_cca_thres = 0xed; - else if (p_dm_odm->rssi_min > (RSSI_thd + 6)) - cur_cck_cca_thres = 0xdd; - else -#endif - if (p_dm_odm->rssi_min > RSSI_thd) - cur_cck_cca_thres = 0xcd; - else if (p_dm_odm->rssi_min > 20) { - if (p_dm_dig_table->cck_fa_ma > ((DM_DIG_FA_TH1 >> 1) + (DM_DIG_FA_TH1 >> 3))) - cur_cck_cca_thres = 0xcd; - else if (p_dm_dig_table->cck_fa_ma < (DM_DIG_FA_TH0 >> 1)) - cur_cck_cca_thres = 0x83; - } else if (p_dm_odm->rssi_min > 7) - cur_cck_cca_thres = 0x83; - else - cur_cck_cca_thres = 0x40; -#else - if (p_dm_dig_table->cur_ig_value > (0x24 + 14)) - cur_cck_cca_thres = 0xed; - else if (p_dm_dig_table->cur_ig_value > (0x24 + 6)) - cur_cck_cca_thres = 0xdd; - else if (p_dm_dig_table->cur_ig_value > 0x24) - cur_cck_cca_thres = 0xcd; - else { - if (p_dm_dig_table->cck_fa_ma > 0x400) - cur_cck_cca_thres = 0x83; - else if (p_dm_dig_table->cck_fa_ma < 0x200) - cur_cck_cca_thres = 0x40; - } - -#endif - } else { - if (p_dm_dig_table->cck_fa_ma > 0x400) - cur_cck_cca_thres = 0x83; - else if (p_dm_dig_table->cck_fa_ma < 0x200) - cur_cck_cca_thres = 0x40; - } - - odm_write_cck_cca_thres(p_dm_odm, cur_cck_cca_thres); - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_cck_packet_detection_thresh() cur_cck_cca_thres = 0x%x\n", cur_cck_cca_thres)); -} - -void -odm_write_cck_cca_thres( - void *p_dm_void, - u8 cur_cck_cca_thres -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _dynamic_initial_gain_threshold_ *p_dm_dig_table = &p_dm_odm->dm_dig_table; - - if (p_dm_dig_table->cur_cck_cca_thres != cur_cck_cca_thres) { /* modify by Guo.Mingzhi 2012-01-03 */ - odm_write_1byte(p_dm_odm, ODM_REG(CCK_CCA, p_dm_odm), cur_cck_cca_thres); - p_dm_dig_table->cck_fa_ma = 0xffffffff; - } - p_dm_dig_table->pre_cck_cca_thres = p_dm_dig_table->cur_cck_cca_thres; - p_dm_dig_table->cur_cck_cca_thres = cur_cck_cca_thres; -} - -bool -phydm_dig_go_up_check( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _CCX_INFO *ccx_info = &p_dm_odm->dm_ccx_info; - struct _dynamic_initial_gain_threshold_ *p_dm_dig_table = &p_dm_odm->dm_dig_table; - u8 cur_ig_value = p_dm_dig_table->cur_ig_value; - u8 max_DIG_cover_bond; - u8 current_igi_max_up_resolution; - u8 rx_gain_range_max; - u8 i = 0; - - u32 total_NHM_cnt; - u32 DIG_cover_cnt; - u32 over_DIG_cover_cnt; - bool ret = true; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - struct rtl8192cd_priv *priv = p_dm_odm->priv; - - max_DIG_cover_bond = DM_DIG_MAX_AP - priv->pshare->rf_ft_var.dig_upcheck_initial_value; - current_igi_max_up_resolution = cur_ig_value + 6; - rx_gain_range_max = p_dm_dig_table->rx_gain_range_max; - - phydm_get_nhm_result(p_dm_odm); - - total_NHM_cnt = ccx_info->NHM_result[0] + ccx_info->NHM_result[1]; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("phydm_dig_go_up_check(): *****Get NHM results*****\n")); - - if (total_NHM_cnt != 0) { - - /* cur_ig_value < max_DIG_cover_bond - 6 */ - if (p_dm_dig_table->dig_go_up_check_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) <= cur_ig_value < DM_DIG_MAX_AP */ - else if (p_dm_dig_table->dig_go_up_check_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 p_dm_dig_table->rx_gain_range_max */ - p_dm_dig_table->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(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("phydm_dig_go_up_check(): Noise power is beyond DIG can filter, lock rx_gain_range_max to 0x%x\n", - p_dm_dig_table->rx_gain_range_max)); - } - } - - /* cur_ig_value > DM_DIG_MAX_AP, foolproof */ - else if (p_dm_dig_table->dig_go_up_check_level == DIG_GOUPCHECK_LEVEL_2) + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ccx_info *ccx_info = &dm->dm_ccx_info; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + u8 cur_ig_value = dig_t->cur_ig_value; + u8 max_cover_bond = 0; + u8 rx_gain_range_max = dig_t->rx_gain_range_max; + u8 i = 0, j = 0; + u8 total_nhm_cnt = ccx_info->nhm_rpt_sum; + u32 dig_cnt = 0; + u32 over_dig_cnt = 0; + boolean ret = true; + + if (*dm->bb_op_mode == PHYDM_PERFORMANCE_MODE) + return ret; + + max_cover_bond = DIG_MAX_BALANCE_MODE - dig_t->upcheck_init_val; + + if (cur_ig_value < max_cover_bond - 6) + dig_t->go_up_chk_lv = DIG_GOUPCHECK_LEVEL_0; + else if (cur_ig_value <= DIG_MAX_BALANCE_MODE) + dig_t->go_up_chk_lv = DIG_GOUPCHECK_LEVEL_1; + else /* @cur_ig_value > DM_DIG_MAX_AP, foolproof */ + dig_t->go_up_chk_lv = DIG_GOUPCHECK_LEVEL_2; + + PHYDM_DBG(dm, DBG_DIG, "check_lv = %d, max_cover_bond = 0x%x\n", + dig_t->go_up_chk_lv, max_cover_bond); + + if (total_nhm_cnt == 0) + return true; + + if (dig_t->go_up_chk_lv == DIG_GOUPCHECK_LEVEL_0) { + for (i = 3; i <= 11; i++) + dig_cnt += ccx_info->nhm_result[i]; + + if ((dig_t->lv0_ratio_reciprocal * dig_cnt) >= total_nhm_cnt) ret = true; + else + ret = false; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("phydm_dig_go_up_check(): DIG_GoUpCheck_level = %d\n, current_igi_max_up_resolution = 0x%x\n, max_DIG_cover_bond = 0x%x\n, rx_gain_range_max = 0x%x, ret = %d\n", - p_dm_dig_table->dig_go_up_check_level, - current_igi_max_up_resolution, - max_DIG_cover_bond, - p_dm_dig_table->rx_gain_range_max, - ret)); + } else if (dig_t->go_up_chk_lv == 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_cnt += ccx_info->nhm_result[j]; + break; + } + } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("phydm_dig_go_up_check(): 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])); + if (dig_t->lv1_ratio_reciprocal * over_dig_cnt < total_nhm_cnt) + ret = true; + else + ret = false; - } else - ret = true; + if (!ret) { + /* update dig_t->rx_gain_range_max */ + if (rx_gain_range_max + 6 >= max_cover_bond) + dig_t->rx_gain_range_max = max_cover_bond - 6; + else + dig_t->rx_gain_range_max = rx_gain_range_max; - for (i = 0 ; i <= 10 ; i++) - ccx_info->NHM_th[i] = 0xFF; - - if (cur_ig_value < max_DIG_cover_bond - 6) { - ccx_info->NHM_th[0] = 2 * (cur_ig_value - priv->pshare->rf_ft_var.dig_upcheck_initial_value); - p_dm_dig_table->dig_go_up_check_level = DIG_GOUPCHECK_LEVEL_0; - } else if (cur_ig_value <= DM_DIG_MAX_AP) { - ccx_info->NHM_th[0] = 2 * max_DIG_cover_bond; - p_dm_dig_table->dig_go_up_check_level = DIG_GOUPCHECK_LEVEL_1; - } - /* cur_ig_value > DM_DIG_MAX_AP, foolproof */ - else { - p_dm_dig_table->dig_go_up_check_level = DIG_GOUPCHECK_LEVEL_2; + PHYDM_DBG(dm, DBG_DIG, + "Noise pwr over DIG can filter, lock rx_gain_range_max to 0x%x\n", + dig_t->rx_gain_range_max); + } + } else if (dig_t->go_up_chk_lv == DIG_GOUPCHECK_LEVEL_2) { + /* @cur_ig_value > DM_DIG_MAX_AP, foolproof */ ret = true; } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("phydm_dig_go_up_check(): *****Set NHM settings*****\n")); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("phydm_dig_go_up_check(): DIG_GoUpCheck_level = %d\n", - p_dm_dig_table->dig_go_up_check_level)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("phydm_dig_go_up_check(): 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_nhm_setting(p_dm_odm, SET_NHM_SETTING); - phydm_nhm_trigger(p_dm_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_rfe_control( - struct PHY_DM_STRUCT *p_dm_odm, - u64 rssi_val -) +void phydm_fa_threshold_check(void *dm_void, boolean is_dfs_band) { - struct _ADAPTER *adapter = (struct _ADAPTER *)p_dm_odm->adapter; - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); - static u8 trsw_high_pwr = 0; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("===> odm_rfe_control, RSSI = %d, trsw_high_pwr = 0x%X, p_dm_odm->rfe_type = %d\n", - rssi_val, trsw_high_pwr, p_dm_odm->rfe_type)); - - if (p_dm_odm->rfe_type == 3) { - - p_dm_odm->RSSI_TRSW = rssi_val; - - if (p_dm_odm->RSSI_TRSW >= p_dm_odm->RSSI_TRSW_H) { - trsw_high_pwr = 1; /* Switch to */ - odm_set_bb_reg(p_dm_odm, REG_ANTSEL_SW_JAGUAR, BIT(1) | BIT0, 0x1); /* Set ANTSW=1/ANTSWB=0 for SW control */ - odm_set_bb_reg(p_dm_odm, REG_ANTSEL_SW_JAGUAR, BIT(9) | BIT8, 0x3); /* Set ANTSW=1/ANTSWB=0 for SW control */ - - } else if (p_dm_odm->RSSI_TRSW <= p_dm_odm->RSSI_TRSW_L) { - trsw_high_pwr = 0; /* Switched back */ - odm_set_bb_reg(p_dm_odm, REG_ANTSEL_SW_JAGUAR, BIT(1) | BIT0, 0x1); /* Set ANTSW=1/ANTSWB=0 for SW control */ - odm_set_bb_reg(p_dm_odm, REG_ANTSEL_SW_JAGUAR, BIT(9) | BIT8, 0x0); /* Set ANTSW=1/ANTSWB=0 for SW control */ - - } - } - - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("(p_dm_odm->RSSI_TRSW_H, p_dm_odm->RSSI_TRSW_L) = (%d, %d)\n", p_dm_odm->RSSI_TRSW_H, p_dm_odm->RSSI_TRSW_L)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("(rssi_val, rssi_val, p_dm_odm->RSSI_TRSW_iso) = (%d, %d, %d)\n", - rssi_val, p_dm_odm->RSSI_TRSW_iso, p_dm_odm->RSSI_TRSW)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("<=== odm_rfe_control, RSSI = %d, trsw_high_pwr = 0x%X\n", rssi_val, trsw_high_pwr)); -} - -void -odm_mpt_dig_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_odm = &p_hal_data->DM_OutSrc; - - ODM_MPT_DIG(p_dm_odm); -} - -void -odm_mpt_dig_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_odm = &p_hal_data->DM_OutSrc; - - -#if DEV_BUS_TYPE == RT_PCI_INTERFACE -#if USE_WORKITEM - odm_schedule_work_item(&p_dm_odm->mpt_dig_workitem); -#else - ODM_MPT_DIG(p_dm_odm); -#endif -#else - odm_schedule_work_item(&p_dm_odm->mpt_dig_workitem); -#endif - -} - -#endif - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -void -odm_mpt_dig_callback( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; -#if USE_WORKITEM - odm_schedule_work_item(&p_dm_odm->mpt_dig_workitem); -#else - ODM_MPT_DIG(p_dm_odm); -#endif -} -#endif - -#if (DM_ODM_SUPPORT_TYPE != ODM_CE) -void -odm_mpt_write_dig( - void *p_dm_void, - u8 cur_ig_value -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _dynamic_initial_gain_threshold_ *p_dm_dig_table = &p_dm_odm->dm_dig_table; - - odm_write_1byte(p_dm_odm, ODM_REG(IGI_A, p_dm_odm), cur_ig_value); - -#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) - /* Set IGI value of CCK for new CCK AGC */ - if (p_dm_odm->cck_new_agc) { - if (p_dm_odm->support_ic_type & ODM_IC_PHY_STATUE_NEW_TYPE) - odm_set_bb_reg(p_dm_odm, 0xa0c, 0x00003f00, (cur_ig_value >> 1)); - } - -#endif - - if (p_dm_odm->rf_type > ODM_1T1R) - odm_write_1byte(p_dm_odm, ODM_REG(IGI_B, p_dm_odm), cur_ig_value); - - if ((p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) && (p_dm_odm->rf_type > ODM_2T2R)) { - odm_write_1byte(p_dm_odm, ODM_REG(IGI_C, p_dm_odm), cur_ig_value); - odm_write_1byte(p_dm_odm, ODM_REG(IGI_D, p_dm_odm), cur_ig_value); - } - - p_dm_dig_table->cur_ig_value = cur_ig_value; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("cur_ig_value = 0x%x\n", cur_ig_value)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("p_dm_odm->rf_type = 0x%x\n", p_dm_odm->rf_type)); -} - -void -ODM_MPT_DIG( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _dynamic_initial_gain_threshold_ *p_dm_dig_table = &p_dm_odm->dm_dig_table; - struct _FALSE_ALARM_STATISTICS *p_false_alm_cnt = (struct _FALSE_ALARM_STATISTICS *)phydm_get_structure(p_dm_odm, PHYDM_FALSEALMCNT); - u8 current_igi = p_dm_dig_table->cur_ig_value; - u8 dig_upper = 0x40, dig_lower = 0x20; - u32 rx_ok_cal; - u32 rx_pwdb_ave_final; - u8 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 (!(p_dm_odm->priv->pshare->rf_ft_var.mp_specific && p_dm_odm->priv->pshare->mp_dig_on)) - return; - - if (*p_dm_odm->p_band_type == ODM_BAND_5G) - dig_lower = 0x22; -#endif - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("===> ODM_MPT_DIG, p_band_type = %d\n", *p_dm_odm->p_band_type)); - -#if (ODM_FIX_2G_DIG || (DM_ODM_SUPPORT_TYPE & ODM_AP)) - if (*p_dm_odm->p_band_type == ODM_BAND_5G || (p_dm_odm->support_ic_type & (ODM_RTL8814A | ODM_RTL8822B))) /* for 5G or 8814 */ -#else - if (1) /* for both 2G/5G */ -#endif - { - odm_false_alarm_counter_statistics(p_dm_odm); - - rx_ok_cal = p_dm_odm->phy_dbg_info.num_qry_phy_status_cck + p_dm_odm->phy_dbg_info.num_qry_phy_status_ofdm; - rx_pwdb_ave_final = (rx_ok_cal != 0) ? p_dm_odm->rx_pwdb_ave / rx_ok_cal : 0; - - p_dm_odm->phy_dbg_info.num_qry_phy_status_cck = 0; - p_dm_odm->phy_dbg_info.num_qry_phy_status_ofdm = 0; - p_dm_odm->rx_pwdb_ave = 0; - p_dm_odm->MPDIG_2G = false; - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - p_dm_odm->times_2g = 0; -#endif - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("RX OK = %d\n", rx_ok_cal)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("RSSI = %d\n", rx_pwdb_ave_final)); - - if (rx_ok_cal >= 70 && rx_pwdb_ave_final <= 40) { - if (current_igi > 0x24) - odm_mpt_write_dig(p_dm_odm, 0x24); + if (dig_t->is_dbg_fa_th) { + PHYDM_DBG(dm, DBG_DIG, "Manual Fix FA_th\n"); + } else if (dm->is_linked) { + if (dm->rssi_min < 20) { /*@[PHYDM-252]*/ + dig_t->fa_th[0] = 500; + dig_t->fa_th[1] = 750; + dig_t->fa_th[2] = 1000; + } else if (((dm->rx_tp >> 2) > dm->tx_tp) && /*Test RX TP*/ + (dm->rx_tp < 10) && (dm->rx_tp > 1)) { /*TP=1~10Mb*/ + dig_t->fa_th[0] = 125; + dig_t->fa_th[1] = 250; + dig_t->fa_th[2] = 500; } else { - if (p_false_alm_cnt->cnt_all > 1000) - current_igi = current_igi + 8; - else if (p_false_alm_cnt->cnt_all > 200) - current_igi = current_igi + 4; - else if (p_false_alm_cnt->cnt_all > 50) - current_igi = current_igi + 2; - else if (p_false_alm_cnt->cnt_all < 2) - current_igi = current_igi - 2; - - if (current_igi < dig_lower) - current_igi = dig_lower; - - if (current_igi > dig_upper) - current_igi = dig_upper; - - odm_mpt_write_dig(p_dm_odm, current_igi); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("DIG = 0x%x, cnt_all = %d, cnt_ofdm_fail = %d, cnt_cck_fail = %d\n", - current_igi, p_false_alm_cnt->cnt_all, p_false_alm_cnt->cnt_ofdm_fail, p_false_alm_cnt->cnt_cck_fail)); + dig_t->fa_th[0] = 250; + dig_t->fa_th[1] = 500; + dig_t->fa_th[2] = 750; } } else { - if (p_dm_odm->MPDIG_2G == false) { - if ((p_dm_odm->support_platform & ODM_WIN) && !(p_dm_odm->support_ic_type & (ODM_RTL8814A | ODM_RTL8822B))) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("===> Fix IGI\n")); - odm_write_1byte(p_dm_odm, ODM_REG(IGI_A, p_dm_odm), IGI_A); - odm_write_1byte(p_dm_odm, ODM_REG(IGI_B, p_dm_odm), IGI_B); - p_dm_dig_table->cur_ig_value = IGI_B; - } else - odm_mpt_write_dig(p_dm_odm, IGI_A); - } + if (is_dfs_band) { /* @For DFS band and no link */ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - p_dm_odm->times_2g++; - - if (p_dm_odm->times_2g == 3) -#endif - { - p_dm_odm->MPDIG_2G = true; + dig_t->fa_th[0] = 250; + dig_t->fa_th[1] = 1000; + dig_t->fa_th[2] = 2000; + } else { + dig_t->fa_th[0] = 2000; + dig_t->fa_th[1] = 4000; + dig_t->fa_th[2] = 5000; } } -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - if (p_dm_odm->support_ic_type == ODM_RTL8812) - odm_rfe_control(p_dm_odm, rx_pwdb_ave_final); + PHYDM_DBG(dm, DBG_DIG, "FA_th={%d,%d,%d}\n", dig_t->fa_th[0], + dig_t->fa_th[1], dig_t->fa_th[2]); +} + +void phydm_set_big_jump_step(void *dm_void, u8 curr_igi) +{ +#if (RTL8822B_SUPPORT || RTL8197F_SUPPORT || RTL8192F_SUPPORT) + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + u8 step1[8] = {24, 30, 40, 50, 60, 70, 80, 90}; + u8 big_jump_lmt = dig_t->big_jump_lmt[dig_t->agc_table_idx]; + u8 i; + + if (dig_t->enable_adjust_big_jump == 0) + return; + + for (i = 0; i <= dig_t->big_jump_step1; i++) { + if ((curr_igi + step1[i]) > big_jump_lmt) { + if (i != 0) + i = i - 1; + break; + } else if (i == dig_t->big_jump_step1) { + break; + } + } + if (dm->support_ic_type & ODM_RTL8822B) + odm_set_bb_reg(dm, R_0x8c8, 0xe, i); + else if (dm->support_ic_type & (ODM_RTL8197F | ODM_RTL8192F)) + odm_set_bb_reg(dm, ODM_REG_BB_AGC_SET_2_11N, 0xe, i); + + PHYDM_DBG(dm, DBG_DIG, "Bigjump = %d (ori = 0x%x), LMT=0x%x\n", i, + dig_t->big_jump_step1, big_jump_lmt); +#endif +} + +#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT +void phydm_write_dig_reg_jgr3(void *dm_void, u8 igi) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + + PHYDM_DBG(dm, DBG_DIG, "%s===>\n", __func__); + + /* Set IGI value */ + if (!(dm->support_ic_type & ODM_IC_JGR3_SERIES)) + return; + + odm_set_bb_reg(dm, R_0x1d70, ODM_BIT_IGI_11AC, igi); + + #if (defined(PHYDM_COMPILE_ABOVE_2SS)) + if (dm->support_ic_type & PHYDM_IC_ABOVE_2SS) + odm_set_bb_reg(dm, R_0x1d70, ODM_BIT_IGI_B_11AC3, igi); + #endif + + #if (defined(PHYDM_COMPILE_ABOVE_4SS)) + if (dm->support_ic_type & PHYDM_IC_ABOVE_4SS) { + odm_set_bb_reg(dm, R_0x1d70, ODM_BIT_IGI_C_11AC3, igi); + odm_set_bb_reg(dm, R_0x1d70, ODM_BIT_IGI_D_11AC3, igi); + } + #endif +} + +u8 phydm_get_igi_reg_val_jgr3(void *dm_void, enum bb_path path) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 val = 0; + + PHYDM_DBG(dm, DBG_DIG, "%s===>\n", __func__); + + /* Set IGI value */ + if (!(dm->support_ic_type & ODM_IC_JGR3_SERIES)) + return (u8)val; + + if (path == BB_PATH_A) + val = odm_get_bb_reg(dm, R_0x1d70, ODM_BIT_IGI_11AC); +#if (defined(PHYDM_COMPILE_ABOVE_2SS)) + else if (path == BB_PATH_B) + val = odm_get_bb_reg(dm, R_0x1d70, ODM_BIT_IGI_B_11AC3); #endif - odm_set_timer(p_dm_odm, &p_dm_odm->mpt_dig_timer, 700); +#if (defined(PHYDM_COMPILE_ABOVE_3SS)) + else if (path == BB_PATH_C) + val = odm_get_bb_reg(dm, R_0x1d70, ODM_BIT_IGI_C_11AC3); +#endif + +#if (defined(PHYDM_COMPILE_ABOVE_4SS)) + else if (path == BB_PATH_D) + val = odm_get_bb_reg(dm, R_0x1d70, ODM_BIT_IGI_D_11AC3); +#endif + return (u8)val; +} + +void phydm_fa_cnt_statistics_jgr3(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fa_struct *fa_t = &dm->false_alm_cnt; + u32 ret_value = 0; + u32 cck_enable = 0; + u16 ofdm_tx_counter = 0; + u16 cck_tx_counter = 0; + + if (!(dm->support_ic_type & ODM_IC_JGR3_SERIES)) + return; + + ofdm_tx_counter = (u16)odm_get_bb_reg(dm, R_0x2de0, MASKLWORD); + cck_tx_counter = (u16)odm_get_bb_reg(dm, R_0x2de4, MASKLWORD); + + ret_value = odm_get_bb_reg(dm, R_0x2d20, MASKDWORD); + fa_t->cnt_fast_fsync = (ret_value & 0xffff); + fa_t->cnt_sb_search_fail = ((ret_value & 0xffff0000) >> 16); + + ret_value = odm_get_bb_reg(dm, R_0x2d04, MASKDWORD); + fa_t->cnt_parity_fail = ((ret_value & 0xffff0000) >> 16); + + ret_value = odm_get_bb_reg(dm, R_0x2d08, MASKDWORD); + fa_t->cnt_rate_illegal = (ret_value & 0xffff); + fa_t->cnt_crc8_fail = ((ret_value & 0xffff0000) >> 16); + + ret_value = odm_get_bb_reg(dm, R_0x2d10, MASKDWORD); + fa_t->cnt_mcs_fail = (ret_value & 0xffff); + + /* read CCK CRC32 counter */ + ret_value = odm_get_bb_reg(dm, R_0x2c04, MASKDWORD); + fa_t->cnt_cck_crc32_error = ((ret_value & 0xffff0000) >> 16); + fa_t->cnt_cck_crc32_ok = ret_value & 0xffff; + + /* read OFDM CRC32 counter */ + ret_value = odm_get_bb_reg(dm, R_0x2c14, MASKDWORD); + fa_t->cnt_ofdm_crc32_error = ((ret_value & 0xffff0000) >> 16); + fa_t->cnt_ofdm_crc32_ok = ret_value & 0xffff; + + /* read HT CRC32 counter */ + ret_value = odm_get_bb_reg(dm, R_0x2c10, MASKDWORD); + fa_t->cnt_ht_crc32_error = ((ret_value & 0xffff0000) >> 16); + fa_t->cnt_ht_crc32_ok = ret_value & 0xffff; + + /* @for VHT part */ + if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8812F | + ODM_RTL8814B)) { + /* read VHT CRC32 counter */ + ret_value = odm_get_bb_reg(dm, R_0x2c0c, MASKDWORD); + fa_t->cnt_vht_crc32_error = ((ret_value & 0xffff0000) >> 16); + fa_t->cnt_vht_crc32_ok = ret_value & 0xffff; + + ret_value = odm_get_bb_reg(dm, R_0x2d10, MASKDWORD); + fa_t->cnt_mcs_fail_vht = ((ret_value & 0xffff0000) >> 16); + + ret_value = odm_get_bb_reg(dm, R_0x2d0c, MASKDWORD); + fa_t->cnt_crc8_fail_vht = (ret_value & 0xffff) + + ((ret_value & 0xffff0000) >> 16); + } else { + fa_t->cnt_vht_crc32_error = 0; + fa_t->cnt_vht_crc32_ok = 0; + fa_t->cnt_mcs_fail_vht = 0; + fa_t->cnt_crc8_fail_vht = 0; + } + + /* @calculate OFDM FA counter instead of reading brk_cnt*/ + fa_t->cnt_ofdm_fail = fa_t->cnt_parity_fail + fa_t->cnt_rate_illegal + + fa_t->cnt_crc8_fail + fa_t->cnt_mcs_fail + + fa_t->cnt_fast_fsync + fa_t->cnt_sb_search_fail + + fa_t->cnt_mcs_fail_vht + fa_t->cnt_crc8_fail_vht; + + /* Read CCK FA counter */ + fa_t->cnt_cck_fail = odm_get_bb_reg(dm, R_0x1a5c, MASKLWORD); + + /* read CCK/OFDM CCA counter */ + ret_value = odm_get_bb_reg(dm, R_0x2c08, MASKDWORD); + fa_t->cnt_ofdm_cca = ((ret_value & 0xffff0000) >> 16); + fa_t->cnt_cck_cca = ret_value & 0xffff; + + /* @CCK RxIQ weighting = 1 => 0x1a14[9:8]=0x0 */ + cck_enable = odm_get_bb_reg(dm, R_0x1a14, 0x300); + if (cck_enable == 0x0) { /* @if(*dm->band_type == ODM_BAND_2_4G) */ + fa_t->cnt_all = fa_t->cnt_ofdm_fail + fa_t->cnt_cck_fail; + fa_t->cnt_cca_all = fa_t->cnt_cck_cca + fa_t->cnt_ofdm_cca; + PHYDM_DBG(dm, DBG_FA_CNT, "ac3 OFDM FA = %d, CCK FA = %d\n", + fa_t->cnt_ofdm_fail, fa_t->cnt_cck_fail); + } else { + fa_t->cnt_all = fa_t->cnt_ofdm_fail; + fa_t->cnt_cca_all = fa_t->cnt_ofdm_cca; + PHYDM_DBG(dm, DBG_FA_CNT, "ac3 CCK disable OFDM FA = %d\n", + fa_t->cnt_ofdm_fail); + } + + PHYDM_DBG(dm, DBG_FA_CNT, + "ac3 [OFDM FA Detail] Parity_fail=((%d)), Rate_Illegal=((%d)), CRC8_fail=((%d)), Mcs_fail=((%d)), Fast_Fsync=((%d)), SBD_fail=((%d))\n", + fa_t->cnt_parity_fail, fa_t->cnt_rate_illegal, + fa_t->cnt_crc8_fail, fa_t->cnt_mcs_fail, fa_t->cnt_fast_fsync, + fa_t->cnt_sb_search_fail); +} + +#endif + +void phydm_write_dig_reg_c50(void *dm_void, u8 igi) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + PHYDM_DBG(dm, DBG_DIG, "%s===>\n", __func__); + + odm_set_bb_reg(dm, ODM_REG(IGI_A, dm), ODM_BIT(IGI, dm), igi); + + #if (defined(PHYDM_COMPILE_ABOVE_2SS)) + if (dm->support_ic_type & PHYDM_IC_ABOVE_2SS) + odm_set_bb_reg(dm, ODM_REG(IGI_B, dm), ODM_BIT(IGI, dm), igi); + #endif + + #if (defined(PHYDM_COMPILE_ABOVE_4SS)) + if (dm->support_ic_type & PHYDM_IC_ABOVE_4SS) { + odm_set_bb_reg(dm, ODM_REG(IGI_C, dm), ODM_BIT(IGI, dm), igi); + odm_set_bb_reg(dm, ODM_REG(IGI_D, dm), ODM_BIT(IGI, dm), igi); + } + #endif +} + +void phydm_write_dig_reg(void *dm_void, u8 igi) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + + PHYDM_DBG(dm, DBG_DIG, "%s===>\n", __func__); + + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + phydm_write_dig_reg_jgr3(dm, igi); + else + #endif + phydm_write_dig_reg_c50(dm, igi); + + dig_t->cur_ig_value = igi; +} + +void odm_write_dig(void *dm_void, u8 new_igi) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + struct phydm_adaptivity_struct *adaptivity = &dm->adaptivity; + + PHYDM_DBG(dm, DBG_DIG, "%s===>\n", __func__); + + /* @1 Check IGI by upper bound */ + if (adaptivity->igi_lmt_en && + new_igi > adaptivity->adapt_igi_up && dm->is_linked) { + new_igi = adaptivity->adapt_igi_up; + + PHYDM_DBG(dm, DBG_DIG, "Force Adaptivity Up-bound=((0x%x))\n", + new_igi); + } + + #if (RTL8192F_SUPPORT) + if ((dm->support_ic_type & ODM_RTL8192F) && + dm->cut_version == ODM_CUT_A && + new_igi > 0x38) { + new_igi = 0x38; + PHYDM_DBG(dm, DBG_DIG, + "Force 92F Adaptivity Up-bound=((0x%x))\n", new_igi); + } + #endif + + if (dig_t->cur_ig_value != new_igi) { + #if (RTL8822B_SUPPORT || RTL8197F_SUPPORT || RTL8192F_SUPPORT) + /* @Modify big jump step for 8822B and 8197F */ + if (dm->support_ic_type & + (ODM_RTL8822B | ODM_RTL8197F | ODM_RTL8192F)) + phydm_set_big_jump_step(dm, new_igi); + #endif + + #if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT) + /* Set IGI value of CCK for new CCK AGC */ + if (dm->cck_new_agc && + (dm->support_ic_type & PHYSTS_2ND_TYPE_IC)) + odm_set_bb_reg(dm, R_0xa0c, 0x3f00, (new_igi >> 1)); + #endif + + /*@Add by YuChen for USB IO too slow issue*/ + if (!(dm->support_ic_type & ODM_IC_PWDB_EDCCA)) { + if (dm->support_ability & ODM_BB_ADAPTIVITY && + new_igi < dig_t->cur_ig_value) { + dig_t->cur_ig_value = new_igi; + phydm_adaptivity(dm); + } + } else { + if (dm->support_ability & ODM_BB_ADAPTIVITY && + new_igi > dig_t->cur_ig_value) { + dig_t->cur_ig_value = new_igi; + phydm_adaptivity(dm); + } + } + phydm_write_dig_reg(dm, new_igi); + } + + PHYDM_DBG(dm, DBG_DIG, "New_igi=((0x%x))\n\n", new_igi); +} + +u8 phydm_get_igi_reg_val(void *dm_void, enum bb_path path) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 val = 0; + u32 bit_map = ODM_BIT(IGI, dm); + + switch (path) { + case BB_PATH_A: + val = odm_get_bb_reg(dm, ODM_REG(IGI_A, dm), bit_map); + break; + #if (defined(PHYDM_COMPILE_ABOVE_2SS)) + case BB_PATH_B: + val = odm_get_bb_reg(dm, ODM_REG(IGI_B, dm), bit_map); + break; + #endif + + #if (defined(PHYDM_COMPILE_ABOVE_3SS)) + case BB_PATH_C: + val = odm_get_bb_reg(dm, ODM_REG(IGI_C, dm), bit_map); + break; + #endif + + #if (defined(PHYDM_COMPILE_ABOVE_4SS)) + case BB_PATH_D: + val = odm_get_bb_reg(dm, ODM_REG(IGI_D, dm), bit_map); + break; + #endif + + default: + break; + } + + return (u8)val; +} + +u8 phydm_get_igi(void *dm_void, enum bb_path path) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 val = 0; + + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + val = phydm_get_igi_reg_val_jgr3(dm, path); + else + #endif + val = phydm_get_igi_reg_val(dm, path); + + return val; +} + +void phydm_set_dig_val(void *dm_void, u32 *val_buf, u8 val_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (val_len != 1) { + PHYDM_DBG(dm, ODM_COMP_API, "[Error][DIG]Need val_len=1\n"); + return; + } + + odm_write_dig(dm, (u8)(*val_buf)); +} + +void odm_pause_dig(void *dm_void, enum phydm_pause_type type, + enum phydm_pause_level lv, u8 igi_input) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 rpt = false; + u32 igi = (u32)igi_input; + + PHYDM_DBG(dm, DBG_DIG, "[%s]type=%d, LV=%d, igi=0x%x\n", __func__, type, + lv, igi); + + switch (type) { + case PHYDM_PAUSE: + case PHYDM_PAUSE_NO_SET: { + rpt = phydm_pause_func(dm, F00_DIG, PHYDM_PAUSE, lv, 1, &igi); + break; + } + + case PHYDM_RESUME: { + rpt = phydm_pause_func(dm, F00_DIG, PHYDM_RESUME, lv, 1, &igi); + break; + } + default: + PHYDM_DBG(dm, DBG_DIG, "Wrong type\n"); + break; + } + + PHYDM_DBG(dm, DBG_DIG, "pause_result=%d\n", rpt); +} + +boolean +phydm_dig_abort(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + void *adapter = dm->adapter; +#endif + + /* support_ability */ + if ((!(dm->support_ability & ODM_BB_FA_CNT)) || + (!(dm->support_ability & ODM_BB_DIG)) || + *dm->is_scan_in_process) { + PHYDM_DBG(dm, DBG_DIG, "Not Support\n"); + return true; + } + + if (dm->pause_ability & ODM_BB_DIG) { + PHYDM_DBG(dm, DBG_DIG, "Return: Pause DIG in LV=%d\n", + dm->pause_lv_table.lv_dig); + return true; + } + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +#if OS_WIN_FROM_WIN7(OS_VERSION) + if (IsAPModeExist(adapter) && ((PADAPTER)(adapter))->bInHctTest) { + PHYDM_DBG(dm, DBG_DIG, " Return: Is AP mode or In HCT Test\n"); + return true; + } +#endif +#endif + + return false; +} + +void phydm_dig_init(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + struct phydm_fa_struct *false_alm_cnt = &dm->false_alm_cnt; +#endif + u32 ret_value = 0; + u8 i; + + dig_t->dm_dig_max = DIG_MAX_BALANCE_MODE; + dig_t->dm_dig_min = DIG_MIN_PERFORMANCE; + dig_t->dig_max_of_min = DIG_MAX_OF_MIN_BALANCE_MODE; + + dig_t->cur_ig_value = phydm_get_igi(dm, BB_PATH_A); + + dig_t->is_media_connect = false; + + dig_t->fa_th[0] = 250; + dig_t->fa_th[1] = 500; + dig_t->fa_th[2] = 750; + 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 + + dig_t->rx_gain_range_max = DIG_MAX_BALANCE_MODE; + dig_t->rx_gain_range_min = dig_t->cur_ig_value; + +#if (RTL8822B_SUPPORT || RTL8197F_SUPPORT || RTL8192F_SUPPORT) + dig_t->enable_adjust_big_jump = 1; + if (dm->support_ic_type & ODM_RTL8822B) + ret_value = odm_get_bb_reg(dm, R_0x8c8, MASKLWORD); + else if (dm->support_ic_type & (ODM_RTL8197F | ODM_RTL8192F)) + ret_value = odm_get_bb_reg(dm, R_0xc74, MASKLWORD); + + dig_t->big_jump_step1 = (u8)(ret_value & 0xe) >> 1; + dig_t->big_jump_step2 = (u8)(ret_value & 0x30) >> 4; + dig_t->big_jump_step3 = (u8)(ret_value & 0xc0) >> 6; + + if (dm->support_ic_type & + (ODM_RTL8822B | ODM_RTL8197F | ODM_RTL8192F)) { + for (i = 0; i < sizeof(dig_t->big_jump_lmt); i++) { + if (dig_t->big_jump_lmt[i] == 0) + dig_t->big_jump_lmt[i] = 0x64; + /* Set -10dBm as default value */ + } + } +#endif + +#ifdef PHYDM_TDMA_DIG_SUPPORT + #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + dm->original_dig_restore = true; + dm->tdma_dig_state_number = DIG_NUM_OF_TDMA_STATES; + dm->tdma_dig_timer_ms = DIG_TIMER_MS; + #endif +#endif +#ifdef CFG_DIG_DAMPING_CHK + phydm_dig_recorder_reset(dm); + dig_t->dig_dl_en = 1; +#endif +} +void phydm_dig_abs_boundary_decision(struct dm_struct *dm, boolean is_dfs_band) +{ + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + struct phydm_adaptivity_struct *adapt = &dm->adaptivity; + + if (!dm->is_linked) { + dig_t->dm_dig_max = DIG_MAX_COVERAGR; + dig_t->dm_dig_min = DIG_MIN_COVERAGE; + } else if (is_dfs_band) { + if (*dm->band_width == CHANNEL_WIDTH_20) + dig_t->dm_dig_min = DIG_MIN_DFS + 2; + else + dig_t->dm_dig_min = DIG_MIN_DFS; + + dig_t->dig_max_of_min = DIG_MAX_OF_MIN_BALANCE_MODE; + dig_t->dm_dig_max = DIG_MAX_BALANCE_MODE; + } else { + if (*dm->bb_op_mode == PHYDM_BALANCE_MODE) { + /*service > 2 devices*/ + dig_t->dm_dig_max = DIG_MAX_BALANCE_MODE; + #if (DIG_HW == 1) + dig_t->dig_max_of_min = DIG_MIN_COVERAGE; + #else + dig_t->dig_max_of_min = DIG_MAX_OF_MIN_BALANCE_MODE; + #endif + } else if (*dm->bb_op_mode == PHYDM_PERFORMANCE_MODE) { + /*service 1 devices*/ + if (adapt->is_adapt_en && (dm->support_ic_type & + (ODM_RTL8197F | ODM_RTL8192F))) + /*dig_max shouldn't be too high because of adaptivity*/ + dig_t->dm_dig_max = + MIN_2((adapt->th_l2h + 40), + DIG_MAX_PERFORMANCE_MODE); + else + dig_t->dm_dig_max = DIG_MAX_PERFORMANCE_MODE; + + dig_t->dig_max_of_min = DIG_MAX_OF_MIN_PERFORMANCE_MODE; + } + + if (dm->support_ic_type & + (ODM_RTL8814A | ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8822B)) + dig_t->dm_dig_min = 0x1c; + else if (dm->support_ic_type & ODM_RTL8197F) + dig_t->dm_dig_min = 0x1e; /*@For HW setting*/ + else + dig_t->dm_dig_min = DIG_MIN_PERFORMANCE; + } + + PHYDM_DBG(dm, DBG_DIG, "Abs{Max, Min}={0x%x, 0x%x}, Max_of_min=0x%x\n", + dig_t->dm_dig_max, dig_t->dm_dig_min, dig_t->dig_max_of_min); +} + +void phydm_dig_dym_boundary_decision(struct dm_struct *dm) +{ + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; +#ifdef CFG_DIG_DAMPING_CHK + struct phydm_dig_recorder_strcut *dig_rc = &dig_t->dig_recorder_t; +#endif + u8 offset = 15, tmp_max = 0; + u8 max_of_rssi_min = 0; + + PHYDM_DBG(dm, DBG_DIG, "%s ======>\n", __func__); + + if (!dm->is_linked) { + /*@if no link, always stay at lower bound*/ + dig_t->rx_gain_range_max = dig_t->dig_max_of_min; + dig_t->rx_gain_range_min = dig_t->dm_dig_min; + + PHYDM_DBG(dm, DBG_DIG, "No-Link, Dyn{Max, Min}={0x%x, 0x%x}\n", + dig_t->rx_gain_range_max, dig_t->rx_gain_range_min); + return; + } + + PHYDM_DBG(dm, DBG_DIG, "rssi_min=%d, ofst=%d\n", dm->rssi_min, offset); + + /* @DIG lower bound */ + if (dm->rssi_min > dig_t->dig_max_of_min) + dig_t->rx_gain_range_min = dig_t->dig_max_of_min; + else if (dm->rssi_min < dig_t->dm_dig_min) + dig_t->rx_gain_range_min = dig_t->dm_dig_min; + else + dig_t->rx_gain_range_min = dm->rssi_min; + +#ifdef CFG_DIG_DAMPING_CHK + /*@Limit Dyn min by damping*/ + if (dig_t->dig_dl_en && + dig_rc->damping_limit_en && + dig_t->rx_gain_range_min < dig_rc->damping_limit_val) { + PHYDM_DBG(dm, DBG_DIG, + "[Limit by Damping] Dig_dyn_min=0x%x -> 0x%x\n", + dig_t->rx_gain_range_min, dig_rc->damping_limit_val); + + dig_t->rx_gain_range_min = dig_rc->damping_limit_val; + } +#endif + + /* @DIG upper bound */ + tmp_max = dig_t->rx_gain_range_min + offset; + if (dig_t->rx_gain_range_min != dm->rssi_min) { + max_of_rssi_min = dm->rssi_min + offset; + if (tmp_max > max_of_rssi_min) + tmp_max = max_of_rssi_min; + } + + if (tmp_max > dig_t->dm_dig_max) + dig_t->rx_gain_range_max = dig_t->dm_dig_max; + else if (tmp_max < dig_t->dm_dig_min) + dig_t->rx_gain_range_max = dig_t->dm_dig_min; + else + dig_t->rx_gain_range_max = tmp_max; + + #ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY + /* @1 Force Lower Bound for AntDiv */ + if (!dm->is_one_entry_only && + (dm->support_ability & ODM_BB_ANT_DIV) && + (dm->ant_div_type == CG_TRX_HW_ANTDIV || + dm->ant_div_type == CG_TRX_SMART_ANTDIV)) { + if (dig_t->ant_div_rssi_max > dig_t->dig_max_of_min) + dig_t->rx_gain_range_min = dig_t->dig_max_of_min; + else + dig_t->rx_gain_range_min = (u8)dig_t->ant_div_rssi_max; + + PHYDM_DBG(dm, DBG_DIG, "Force Dyn-Min=0x%x, RSSI_max=0x%x\n", + dig_t->rx_gain_range_min, dig_t->ant_div_rssi_max); + } + #endif + + PHYDM_DBG(dm, DBG_DIG, "Dyn{Max, Min}={0x%x, 0x%x}\n", + dig_t->rx_gain_range_max, dig_t->rx_gain_range_min); +} + +void phydm_dig_abnormal_case(struct dm_struct *dm) +{ + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + + /* @Abnormal lower bound case */ + if (dig_t->rx_gain_range_min > dig_t->rx_gain_range_max) + dig_t->rx_gain_range_min = dig_t->rx_gain_range_max; + + PHYDM_DBG(dm, DBG_DIG, "Abnoraml checked {Max, Min}={0x%x, 0x%x}\n", + dig_t->rx_gain_range_max, dig_t->rx_gain_range_min); +} + +u8 phydm_new_igi_by_fa(struct dm_struct *dm, u8 igi, u32 fa_cnt, u8 *step_size) +{ + boolean dig_go_up_check = true; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + +#if 0 + /*@dig_go_up_check = phydm_dig_go_up_check(dm);*/ +#endif + + if (fa_cnt > dig_t->fa_th[2] && dig_go_up_check) + igi = igi + step_size[0]; + else if ((fa_cnt > dig_t->fa_th[1]) && dig_go_up_check) + igi = igi + step_size[1]; + else if (fa_cnt < dig_t->fa_th[0]) + igi = igi - step_size[2]; + + return igi; +} + +u8 phydm_get_new_igi(struct dm_struct *dm, u8 igi, u32 fa_cnt, + boolean is_dfs_band) +{ + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + u8 step[3] = {0}; + boolean first_connect = false, first_dis_connect = false; + + first_connect = (dm->is_linked) && !dig_t->is_media_connect; + first_dis_connect = (!dm->is_linked) && dig_t->is_media_connect; + + if (dm->is_linked) { + if (dm->pre_rssi_min <= dm->rssi_min) { + PHYDM_DBG(dm, DBG_DIG, "pre_rssi_min <= rssi_min\n"); + step[0] = 2; + step[1] = 1; + step[2] = 2; + } else { + step[0] = 4; + step[1] = 2; + step[2] = 2; + } + } else { + step[0] = 2; + step[1] = 1; + step[2] = 2; + } + + PHYDM_DBG(dm, DBG_DIG, "step = {-%d, +%d, +%d}\n", step[2], step[1], + step[0]); + + if (first_connect) { + if (is_dfs_band) { + if (dm->rssi_min > DIG_MAX_DFS) + igi = DIG_MAX_DFS; + else + igi = dm->rssi_min; + PHYDM_DBG(dm, DBG_DIG, "DFS band:IgiMax=0x%x\n", + dig_t->rx_gain_range_max); + } else { + igi = dig_t->rx_gain_range_min; + } + + #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + #if (RTL8812A_SUPPORT) + if (dm->support_ic_type == ODM_RTL8812) + odm_config_bb_with_header_file(dm, + CONFIG_BB_AGC_TAB_DIFF); + #endif + #endif + PHYDM_DBG(dm, DBG_DIG, "First connect: foce IGI=0x%x\n", igi); + } else if (dm->is_linked) { + PHYDM_DBG(dm, DBG_DIG, "Adjust IGI @ linked\n"); + /* @4 Abnormal # beacon case */ + #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + if (dm->phy_dbg_info.num_qry_beacon_pkt < 5 && + fa_cnt < DM_DIG_FA_TH1 && dm->bsta_state && + dm->support_ic_type != ODM_RTL8723D) { + dig_t->rx_gain_range_min = 0x1c; + igi = dig_t->rx_gain_range_min; + PHYDM_DBG(dm, DBG_DIG, "Beacon_num=%d,force igi=0x%x\n", + dm->phy_dbg_info.num_qry_beacon_pkt, igi); + } else { + igi = phydm_new_igi_by_fa(dm, igi, fa_cnt, step); + } + #else + igi = phydm_new_igi_by_fa(dm, igi, fa_cnt, step); + #endif + } else { + /* @2 Before link */ + PHYDM_DBG(dm, DBG_DIG, "Adjust IGI before link\n"); + + if (first_dis_connect) { + igi = dig_t->dm_dig_min; + PHYDM_DBG(dm, DBG_DIG, + "First disconnect:foce IGI to lower bound\n"); + } else { + PHYDM_DBG(dm, DBG_DIG, "Pre_IGI=((0x%x)), FA=((%d))\n", + igi, fa_cnt); + + igi = phydm_new_igi_by_fa(dm, igi, fa_cnt, step); + } + } + + /*@Check IGI by dyn-upper/lower bound */ + if (igi < dig_t->rx_gain_range_min) + igi = dig_t->rx_gain_range_min; + + if (igi > dig_t->rx_gain_range_max) + igi = dig_t->rx_gain_range_max; + + PHYDM_DBG(dm, DBG_DIG, "fa_cnt = %d, IGI: 0x%x -> 0x%x\n", + fa_cnt, dig_t->cur_ig_value, igi); + + return igi; +} + +boolean phydm_dig_dfs_mode_en(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + boolean dfs_mode_en = false; + + /* @Modify lower bound for DFS band */ + if (dm->is_dfs_band) { + #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + dfs_mode_en = true; + #else + if (phydm_dfs_master_enabled(dm)) + dfs_mode_en = true; + #endif + PHYDM_DBG(dm, DBG_DIG, "In DFS band\n"); + } + return dfs_mode_en; +} + +void phydm_dig(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + struct phydm_fa_struct *falm_cnt = &dm->false_alm_cnt; +#ifdef PHYDM_TDMA_DIG_SUPPORT + struct phydm_fa_acc_struct *falm_cnt_acc = &dm->false_alm_cnt_acc; +#endif + boolean first_connect, first_disconnect; + u8 igi = dig_t->cur_ig_value; + u8 new_igi = 0x20; + u32 fa_cnt = falm_cnt->cnt_all; + boolean dfs_mode_en = false; + +#ifdef PHYDM_TDMA_DIG_SUPPORT + if (!(dm->original_dig_restore)) { + if (dig_t->cur_ig_value_tdma == 0) + dig_t->cur_ig_value_tdma = dig_t->cur_ig_value; + + igi = dig_t->cur_ig_value_tdma; + fa_cnt = falm_cnt_acc->cnt_all_1sec; + } +#endif + + if (phydm_dig_abort(dm)) { + dig_t->cur_ig_value = phydm_get_igi(dm, BB_PATH_A); + return; + } + + PHYDM_DBG(dm, DBG_DIG, "%s Start===>\n", __func__); + + /* @1 Update status */ + first_connect = (dm->is_linked) && !dig_t->is_media_connect; + first_disconnect = (!dm->is_linked) && dig_t->is_media_connect; + + PHYDM_DBG(dm, DBG_DIG, + "is_linked=%d, RSSI=%d, 1stConnect=%d, 1stDisconnect=%d\n", + dm->is_linked, dm->rssi_min, first_connect, first_disconnect); + + PHYDM_DBG(dm, DBG_DIG, "DIG ((%s)) mode\n", + (*dm->bb_op_mode ? "Balance" : "Performance")); + + /*@DFS mode enable check*/ + dfs_mode_en = phydm_dig_dfs_mode_en(dm); + +#ifdef CFG_DIG_DAMPING_CHK + /*Record IGI History*/ + phydm_dig_recorder(dm, first_connect, igi, fa_cnt); + + /*@DIG Damping Check*/ + phydm_dig_damping_chk(dm); +#endif + + /*@Absolute Boundary Decision */ + phydm_dig_abs_boundary_decision(dm, dfs_mode_en); + + /*@Dynamic Boundary Decision*/ + phydm_dig_dym_boundary_decision(dm); + + /*@Abnormal case check*/ + phydm_dig_abnormal_case(dm); + + /*@FA threshold decision */ + phydm_fa_threshold_check(dm, dfs_mode_en); + + /*Select new IGI by FA */ + new_igi = phydm_get_new_igi(dm, igi, fa_cnt, dfs_mode_en); + + /* @1 Update status */ + #ifdef PHYDM_TDMA_DIG_SUPPORT + if (!(dm->original_dig_restore)) { + dig_t->cur_ig_value_tdma = new_igi; + /*@It is possible fa_acc_1sec_tsf >= */ + /*@1sec while tdma_dig_state == 0*/ + if (dig_t->tdma_dig_state != 0) + odm_write_dig(dm, dig_t->cur_ig_value_tdma); + } else + #endif + odm_write_dig(dm, new_igi); + + dig_t->is_media_connect = dm->is_linked; +} + +void phydm_dig_lps_32k(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 current_igi = dm->rssi_min; + + odm_write_dig(dm, current_igi); +} + +void phydm_dig_by_rssi_lps(void *dm_void) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE | ODM_IOT)) + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fa_struct *falm_cnt; + + u8 rssi_lower = DIG_MIN_LPS; /* @0x1E or 0x1C */ + u8 current_igi = dm->rssi_min; + + falm_cnt = &dm->false_alm_cnt; + if (phydm_dig_abort(dm)) + return; + + current_igi = current_igi + RSSI_OFFSET_DIG_LPS; + PHYDM_DBG(dm, DBG_DIG, "%s==>\n", __func__); + + /* Using FW PS mode to make IGI */ + /* @Adjust by FA in LPS MODE */ + if (falm_cnt->cnt_all > DM_DIG_FA_TH2_LPS) + current_igi = current_igi + 4; + else if (falm_cnt->cnt_all > DM_DIG_FA_TH1_LPS) + current_igi = current_igi + 2; + else if (falm_cnt->cnt_all < DM_DIG_FA_TH0_LPS) + current_igi = current_igi - 2; + + /* @Lower bound checking */ + + /* RSSI Lower bound check */ + if ((dm->rssi_min - 10) > DIG_MIN_LPS) + rssi_lower = (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(dm, DBG_DIG, "fa_cnt_all=%d, rssi_min=%d, curr_igi=0x%x\n", + falm_cnt->cnt_all, dm->rssi_min, current_igi); + odm_write_dig(dm, current_igi); +#endif +} + +/* @3============================================================ + * 3 FASLE ALARM CHECK + * 3============================================================ + */ +void phydm_false_alarm_counter_reg_reset(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fa_struct *falm_cnt = &dm->false_alm_cnt; +#ifdef PHYDM_TDMA_DIG_SUPPORT + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + struct phydm_fa_acc_struct *falm_cnt_acc = &dm->false_alm_cnt_acc; +#endif + u32 false_alm_cnt = 0; + +#ifdef PHYDM_TDMA_DIG_SUPPORT + if (!(dm->original_dig_restore)) { + if (dig_t->cur_ig_value_tdma == 0) + dig_t->cur_ig_value_tdma = dig_t->cur_ig_value; + + false_alm_cnt = falm_cnt_acc->cnt_all_1sec; + } else +#endif + { + false_alm_cnt = falm_cnt->cnt_all; + } + +#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + /* @reset CCK FA counter */ + odm_set_bb_reg(dm, R_0x1a2c, BIT(15) | BIT(14), 0); + odm_set_bb_reg(dm, R_0x1a2c, BIT(15) | BIT(14), 2); + + /* @reset CCK CCA counter */ + odm_set_bb_reg(dm, R_0x1a2c, BIT(13) | BIT(12), 0); + odm_set_bb_reg(dm, R_0x1a2c, BIT(13) | BIT(12), 2); + + /* @Disable common rx clk gating => WLANBB-1106*/ + odm_set_bb_reg(dm, R_0x1d2c, BIT(31), 0); + /* @reset OFDM CCA counter, OFDM FA counter*/ + phydm_reset_bb_hw_cnt(dm); + /* @Enable common rx clk gating => WLANBB-1106*/ + odm_set_bb_reg(dm, R_0x1d2c, BIT(31), 1); + } +#endif +#if (ODM_IC_11N_SERIES_SUPPORT) + if (dm->support_ic_type & ODM_IC_11N_SERIES) { + /* @reset false alarm counter registers*/ + odm_set_bb_reg(dm, R_0xc0c, BIT(31), 1); + odm_set_bb_reg(dm, R_0xc0c, BIT(31), 0); + odm_set_bb_reg(dm, R_0xd00, BIT(27), 1); + odm_set_bb_reg(dm, R_0xd00, BIT(27), 0); + + /* @update ofdm counter*/ + /* @update page C counter*/ + odm_set_bb_reg(dm, R_0xc00, BIT(31), 0); + /* @update page D counter*/ + odm_set_bb_reg(dm, R_0xd00, BIT(31), 0); + + /* @reset CCK CCA counter*/ + odm_set_bb_reg(dm, R_0xa2c, BIT(13) | BIT(12), 0); + odm_set_bb_reg(dm, R_0xa2c, BIT(13) | BIT(12), 2); + + /* @reset CCK FA counter*/ + odm_set_bb_reg(dm, R_0xa2c, BIT(15) | BIT(14), 0); + odm_set_bb_reg(dm, R_0xa2c, BIT(15) | BIT(14), 2); + + /* @reset CRC32 counter*/ + odm_set_bb_reg(dm, R_0xf14, BIT(16), 1); + odm_set_bb_reg(dm, R_0xf14, BIT(16), 0); + } +#endif /* @#if (ODM_IC_11N_SERIES_SUPPORT) */ + +#if (ODM_IC_11AC_SERIES_SUPPORT) + if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + #if (RTL8881A_SUPPORT) + /* @Reset FA counter by enable/disable OFDM */ + if ((dm->support_ic_type == ODM_RTL8881A) && + false_alm_cnt->cnt_ofdm_fail_pre >= 0x7fff) { + /* reset OFDM */ + odm_set_bb_reg(dm, R_0x808, BIT(29), 0); + odm_set_bb_reg(dm, R_0x808, BIT(29), 1); + false_alm_cnt->cnt_ofdm_fail_pre = 0; + PHYDM_DBG(dm, DBG_FA_CNT, "Reset FA_cnt\n"); + } + #endif /* @#if (RTL8881A_SUPPORT) */ + + /* @reset OFDM FA countner */ + odm_set_bb_reg(dm, R_0x9a4, BIT(17), 1); + odm_set_bb_reg(dm, R_0x9a4, BIT(17), 0); + + /* @reset CCK FA counter */ + odm_set_bb_reg(dm, R_0xa2c, BIT(15), 0); + odm_set_bb_reg(dm, R_0xa2c, BIT(15), 1); + + /* @reset CCA counter */ + phydm_reset_bb_hw_cnt(dm); + } +#endif /* @#if (ODM_IC_11AC_SERIES_SUPPORT) */ +} + +void phydm_false_alarm_counter_reg_hold(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + /* @hold cck counter */ + odm_set_bb_reg(dm, R_0x1a2c, BIT(12), 1); + odm_set_bb_reg(dm, R_0x1a2c, BIT(14), 1); + } else if (dm->support_ic_type & ODM_IC_11N_SERIES) { + /*@hold ofdm counter*/ + /*@hold page C counter*/ + odm_set_bb_reg(dm, R_0xc00, BIT(31), 1); + /*@hold page D counter*/ + odm_set_bb_reg(dm, R_0xd00, BIT(31), 1); + + /*@hold cck counter*/ + odm_set_bb_reg(dm, R_0xa2c, BIT(12), 1); + odm_set_bb_reg(dm, R_0xa2c, BIT(14), 1); + } +} + +#if (ODM_IC_11N_SERIES_SUPPORT) +void phydm_fa_cnt_statistics_n(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fa_struct *fa_t = &dm->false_alm_cnt; + u32 reg = 0; + + if (!(dm->support_ic_type & ODM_IC_11N_SERIES)) + return; + + /* @hold ofdm & cck counter */ + phydm_false_alarm_counter_reg_hold(dm); + + reg = odm_get_bb_reg(dm, ODM_REG_OFDM_FA_TYPE1_11N, MASKDWORD); + fa_t->cnt_fast_fsync = (reg & 0xffff); + fa_t->cnt_sb_search_fail = ((reg & 0xffff0000) >> 16); + + reg = odm_get_bb_reg(dm, ODM_REG_OFDM_FA_TYPE2_11N, MASKDWORD); + fa_t->cnt_ofdm_cca = (reg & 0xffff); + fa_t->cnt_parity_fail = ((reg & 0xffff0000) >> 16); + + reg = odm_get_bb_reg(dm, ODM_REG_OFDM_FA_TYPE3_11N, MASKDWORD); + fa_t->cnt_rate_illegal = (reg & 0xffff); + fa_t->cnt_crc8_fail = ((reg & 0xffff0000) >> 16); + + reg = odm_get_bb_reg(dm, ODM_REG_OFDM_FA_TYPE4_11N, MASKDWORD); + fa_t->cnt_mcs_fail = (reg & 0xffff); + + fa_t->cnt_ofdm_fail = + fa_t->cnt_parity_fail + fa_t->cnt_rate_illegal + + fa_t->cnt_crc8_fail + fa_t->cnt_mcs_fail + + fa_t->cnt_fast_fsync + fa_t->cnt_sb_search_fail; + + /* read CCK CRC32 counter */ + fa_t->cnt_cck_crc32_error = odm_get_bb_reg(dm, R_0xf84, MASKDWORD); + fa_t->cnt_cck_crc32_ok = odm_get_bb_reg(dm, R_0xf88, MASKDWORD); + + /* read OFDM CRC32 counter */ + reg = odm_get_bb_reg(dm, ODM_REG_OFDM_CRC32_CNT_11N, MASKDWORD); + fa_t->cnt_ofdm_crc32_error = (reg & 0xffff0000) >> 16; + fa_t->cnt_ofdm_crc32_ok = reg & 0xffff; + + /* read HT CRC32 counter */ + reg = odm_get_bb_reg(dm, ODM_REG_HT_CRC32_CNT_11N, MASKDWORD); + fa_t->cnt_ht_crc32_error = (reg & 0xffff0000) >> 16; + fa_t->cnt_ht_crc32_ok = reg & 0xffff; + + /* read VHT CRC32 counter */ + fa_t->cnt_vht_crc32_error = 0; + fa_t->cnt_vht_crc32_ok = 0; + + #if (RTL8723D_SUPPORT) + if (dm->support_ic_type == ODM_RTL8723D) { + /* read HT CRC32 agg counter */ + reg = odm_get_bb_reg(dm, R_0xfb8, MASKDWORD); + fa_t->cnt_ht_crc32_error_agg = (reg & 0xffff0000) >> 16; + fa_t->cnt_ht_crc32_ok_agg = reg & 0xffff; + } + #endif + + #if (RTL8188E_SUPPORT) + if (dm->support_ic_type == ODM_RTL8188E) { + reg = odm_get_bb_reg(dm, ODM_REG_SC_CNT_11N, MASKDWORD); + fa_t->cnt_bw_lsc = (reg & 0xffff); + fa_t->cnt_bw_usc = ((reg & 0xffff0000) >> 16); + } + #endif + + reg = odm_get_bb_reg(dm, ODM_REG_CCK_FA_LSB_11N, MASKBYTE0); + fa_t->cnt_cck_fail = reg; + + reg = odm_get_bb_reg(dm, ODM_REG_CCK_FA_MSB_11N, MASKBYTE3); + fa_t->cnt_cck_fail += (reg & 0xff) << 8; + + reg = odm_get_bb_reg(dm, ODM_REG_CCK_CCA_CNT_11N, MASKDWORD); + fa_t->cnt_cck_cca = ((reg & 0xFF) << 8) | ((reg & 0xFF00) >> 8); + + fa_t->cnt_all_pre = fa_t->cnt_all; + + fa_t->cnt_all = fa_t->cnt_fast_fsync + + fa_t->cnt_sb_search_fail + + fa_t->cnt_parity_fail + + fa_t->cnt_rate_illegal + + fa_t->cnt_crc8_fail + + fa_t->cnt_mcs_fail + + fa_t->cnt_cck_fail; + + fa_t->cnt_cca_all = fa_t->cnt_ofdm_cca + fa_t->cnt_cck_cca; + + PHYDM_DBG(dm, DBG_FA_CNT, + "[OFDM FA Detail] Parity_Fail=((%d)), Rate_Illegal=((%d)), CRC8_fail=((%d)), Mcs_fail=((%d)), Fast_Fsync=(( %d )), SBD_fail=((%d))\n", + fa_t->cnt_parity_fail, fa_t->cnt_rate_illegal, + fa_t->cnt_crc8_fail, fa_t->cnt_mcs_fail, fa_t->cnt_fast_fsync, + fa_t->cnt_sb_search_fail); } #endif + +#if (ODM_IC_11AC_SERIES_SUPPORT) +void phydm_fa_cnt_statistics_ac(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fa_struct *fa_t = &dm->false_alm_cnt; + u32 ret_value = 0; + u32 cck_enable = 0; + + if (!(dm->support_ic_type & ODM_IC_11AC_SERIES)) + return; + + ret_value = odm_get_bb_reg(dm, ODM_REG_OFDM_FA_TYPE1_11AC, MASKDWORD); + fa_t->cnt_fast_fsync = ((ret_value & 0xffff0000) >> 16); + + ret_value = odm_get_bb_reg(dm, ODM_REG_OFDM_FA_TYPE2_11AC, MASKDWORD); + fa_t->cnt_sb_search_fail = (ret_value & 0xffff); + + ret_value = odm_get_bb_reg(dm, ODM_REG_OFDM_FA_TYPE3_11AC, MASKDWORD); + fa_t->cnt_parity_fail = (ret_value & 0xffff); + fa_t->cnt_rate_illegal = ((ret_value & 0xffff0000) >> 16); + + ret_value = odm_get_bb_reg(dm, ODM_REG_OFDM_FA_TYPE4_11AC, MASKDWORD); + fa_t->cnt_crc8_fail = (ret_value & 0xffff); + fa_t->cnt_mcs_fail = ((ret_value & 0xffff0000) >> 16); + + ret_value = odm_get_bb_reg(dm, ODM_REG_OFDM_FA_TYPE5_11AC, MASKDWORD); + fa_t->cnt_crc8_fail_vht = (ret_value & 0xffff) + + (ret_value & 0xffff0000 >> 16); + + ret_value = odm_get_bb_reg(dm, ODM_REG_OFDM_FA_TYPE6_11AC, MASKDWORD); + fa_t->cnt_mcs_fail_vht = (ret_value & 0xffff); + + /* read OFDM FA counter */ + fa_t->cnt_ofdm_fail = odm_get_bb_reg(dm, R_0xf48, MASKLWORD); + + /* Read CCK FA counter */ + fa_t->cnt_cck_fail = odm_get_bb_reg(dm, ODM_REG_CCK_FA_11AC, MASKLWORD); + + /* read CCK/OFDM CCA counter */ + ret_value = odm_get_bb_reg(dm, ODM_REG_CCK_CCA_CNT_11AC, MASKDWORD); + fa_t->cnt_ofdm_cca = (ret_value & 0xffff0000) >> 16; + fa_t->cnt_cck_cca = ret_value & 0xffff; + + /* read CCK CRC32 counter */ + ret_value = odm_get_bb_reg(dm, ODM_REG_CCK_CRC32_CNT_11AC, MASKDWORD); + fa_t->cnt_cck_crc32_error = (ret_value & 0xffff0000) >> 16; + fa_t->cnt_cck_crc32_ok = ret_value & 0xffff; + + /* read OFDM CRC32 counter */ + ret_value = odm_get_bb_reg(dm, ODM_REG_OFDM_CRC32_CNT_11AC, MASKDWORD); + fa_t->cnt_ofdm_crc32_error = (ret_value & 0xffff0000) >> 16; + fa_t->cnt_ofdm_crc32_ok = ret_value & 0xffff; + + /* read HT CRC32 counter */ + ret_value = odm_get_bb_reg(dm, ODM_REG_HT_CRC32_CNT_11AC, MASKDWORD); + fa_t->cnt_ht_crc32_error = (ret_value & 0xffff0000) >> 16; + fa_t->cnt_ht_crc32_ok = ret_value & 0xffff; + + /* read VHT CRC32 counter */ + ret_value = odm_get_bb_reg(dm, ODM_REG_VHT_CRC32_CNT_11AC, MASKDWORD); + fa_t->cnt_vht_crc32_error = (ret_value & 0xffff0000) >> 16; + fa_t->cnt_vht_crc32_ok = ret_value & 0xffff; + + #if (RTL8881A_SUPPORT) + if (dm->support_ic_type == ODM_RTL8881A) { + u32 tmp = 0; + + if (fa_t->cnt_ofdm_fail >= fa_t->cnt_ofdm_fail_pre) { + tmp = fa_t->cnt_ofdm_fail_pre; + fa_t->cnt_ofdm_fail_pre = fa_t->cnt_ofdm_fail; + fa_t->cnt_ofdm_fail = fa_t->cnt_ofdm_fail - tmp; + } else { + fa_t->cnt_ofdm_fail_pre = fa_t->cnt_ofdm_fail; + } + + PHYDM_DBG(dm, DBG_FA_CNT, + "[8881]cnt_ofdm_fail{curr,pre}={%d,%d}\n", + fa_t->cnt_ofdm_fail_pre, tmp); + } + #endif + + cck_enable = odm_get_bb_reg(dm, ODM_REG_BB_RX_PATH_11AC, BIT(28)); + + if (cck_enable) { /* @if(*dm->band_type == ODM_BAND_2_4G) */ + fa_t->cnt_all = fa_t->cnt_ofdm_fail + fa_t->cnt_cck_fail; + fa_t->cnt_cca_all = fa_t->cnt_cck_cca + fa_t->cnt_ofdm_cca; + } else { + fa_t->cnt_all = fa_t->cnt_ofdm_fail; + fa_t->cnt_cca_all = fa_t->cnt_ofdm_cca; + } +} +#endif + +void phydm_get_dbg_port_info(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fa_struct *fa_t = &dm->false_alm_cnt; + u32 dbg_port = dm->adaptivity.adaptivity_dbg_port; + u32 val = 0; + + /*set debug port to 0x0*/ + if (phydm_set_bb_dbg_port(dm, DBGPORT_PRI_1, 0x0)) { + fa_t->dbg_port0 = phydm_get_bb_dbg_port_val(dm); + phydm_release_bb_dbg_port(dm); + } + + if (dm->support_ic_type & ODM_RTL8723D) { + val = odm_get_bb_reg(dm, R_0x9a0, BIT(29)); + } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + val = odm_get_bb_reg(dm, R_0x2d38, BIT(24)); + } else if (phydm_set_bb_dbg_port(dm, DBGPORT_PRI_1, dbg_port)) { + if (dm->support_ic_type & (ODM_RTL8723B | ODM_RTL8188E)) + val = (phydm_get_bb_dbg_port_val(dm) & BIT(30)) >> 30; + else + val = (phydm_get_bb_dbg_port_val(dm) & BIT(29)) >> 29; + phydm_release_bb_dbg_port(dm); + } + + fa_t->edcca_flag = (boolean)val; + + PHYDM_DBG(dm, DBG_FA_CNT, "FA_Cnt: Dbg port 0x0 = 0x%x, EDCCA = %d\n\n", + fa_t->dbg_port0, fa_t->edcca_flag); +} + +void phydm_false_alarm_counter_statistics(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fa_struct *fa_t = &dm->false_alm_cnt; + + if (!(dm->support_ability & ODM_BB_FA_CNT)) + return; + + PHYDM_DBG(dm, DBG_FA_CNT, "%s======>\n", __func__); + + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + phydm_fa_cnt_statistics_jgr3(dm); + #endif + } else if (dm->support_ic_type & ODM_IC_11N_SERIES) { + #if (ODM_IC_11N_SERIES_SUPPORT) + phydm_fa_cnt_statistics_n(dm); + #endif + } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + #if (ODM_IC_11AC_SERIES_SUPPORT) + phydm_fa_cnt_statistics_ac(dm); + #endif + } + + phydm_get_dbg_port_info(dm); + phydm_false_alarm_counter_reg_reset(dm_void); + + fa_t->time_fa_all = fa_t->cnt_fast_fsync * 12 + + fa_t->cnt_sb_search_fail * 12 + + fa_t->cnt_parity_fail * 28 + + fa_t->cnt_rate_illegal * 28 + + fa_t->cnt_crc8_fail * 36 + + fa_t->cnt_crc8_fail_vht * 36 + + fa_t->cnt_mcs_fail_vht * 36 + + fa_t->cnt_mcs_fail * 32 + + fa_t->cnt_cck_fail * 80; + + fa_t->cnt_crc32_error_all = fa_t->cnt_vht_crc32_error + + fa_t->cnt_ht_crc32_error + + fa_t->cnt_ofdm_crc32_error + + fa_t->cnt_cck_crc32_error; + + fa_t->cnt_crc32_ok_all = fa_t->cnt_vht_crc32_ok + + fa_t->cnt_ht_crc32_ok + + fa_t->cnt_ofdm_crc32_ok + + fa_t->cnt_cck_crc32_ok; + + PHYDM_DBG(dm, DBG_FA_CNT, + "[OFDM FA Detail-1] Parity=((%d)), Rate_Illegal=((%d)), HT_CRC8=((%d)), HT_MCS=((%d))\n", + fa_t->cnt_parity_fail, fa_t->cnt_rate_illegal, + fa_t->cnt_crc8_fail, fa_t->cnt_mcs_fail); + PHYDM_DBG(dm, DBG_FA_CNT, + "[OFDM FA Detail-2] Fast_Fsync=((%d)), SBD=((%d)), VHT_CRC8=((%d)), VHT_MCS=((%d))\n", + fa_t->cnt_fast_fsync, fa_t->cnt_sb_search_fail, + fa_t->cnt_crc8_fail_vht, fa_t->cnt_mcs_fail_vht); + PHYDM_DBG(dm, DBG_FA_CNT, + "[CCA Cnt] {CCK, OFDM, Total} = {%d, %d, %d}\n", + fa_t->cnt_cck_cca, fa_t->cnt_ofdm_cca, fa_t->cnt_cca_all); + PHYDM_DBG(dm, DBG_FA_CNT, + "[FA Cnt] {CCK, OFDM, Total} = {%d, %d, %d}\n", + fa_t->cnt_cck_fail, fa_t->cnt_ofdm_fail, fa_t->cnt_all); + PHYDM_DBG(dm, DBG_FA_CNT, "[CCK] CRC32 {error, ok}= {%d, %d}\n", + fa_t->cnt_cck_crc32_error, fa_t->cnt_cck_crc32_ok); + PHYDM_DBG(dm, DBG_FA_CNT, "[OFDM]CRC32 {error, ok}= {%d, %d}\n", + fa_t->cnt_ofdm_crc32_error, fa_t->cnt_ofdm_crc32_ok); + PHYDM_DBG(dm, DBG_FA_CNT, "[ HT ] CRC32 {error, ok}= {%d, %d}\n", + fa_t->cnt_ht_crc32_error, fa_t->cnt_ht_crc32_ok); + PHYDM_DBG(dm, DBG_FA_CNT, "[VHT] CRC32 {error, ok}= {%d, %d}\n", + fa_t->cnt_vht_crc32_error, fa_t->cnt_vht_crc32_ok); + PHYDM_DBG(dm, DBG_FA_CNT, "[TOTAL] CRC32 {error, ok}= {%d, %d}\n", + fa_t->cnt_crc32_error_all, fa_t->cnt_crc32_ok_all); +} + +#ifdef PHYDM_TDMA_DIG_SUPPORT +void phydm_set_tdma_dig_timer(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 delta_time_us = dm->tdma_dig_timer_ms * 1000; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + u32 timeout = 0; + u32 current_time_stamp, diff_time_stamp, regb0 = 0; + + /*some IC has no FREERUN_CUNT register, like 92E*/ + if (dm->support_ic_type & ODM_RTL8197F) + current_time_stamp = odm_get_bb_reg(dm, R_0x568, 0xffffffff); + else + return; + + timeout = current_time_stamp + delta_time_us; + + diff_time_stamp = current_time_stamp - dig_t->cur_timestamp; + dig_t->pre_timestamp = dig_t->cur_timestamp; + dig_t->cur_timestamp = current_time_stamp; + + /*@HIMR0, it shows HW interrupt mask*/ + regb0 = odm_get_bb_reg(dm, R_0xb0, 0xffffffff); + + PHYDM_DBG(dm, DBG_DIG, "Set next timer\n"); + PHYDM_DBG(dm, DBG_DIG, + "curr_time_stamp=%d, delta_time_us=%d\n", + current_time_stamp, delta_time_us); + PHYDM_DBG(dm, DBG_DIG, + "timeout=%d, diff_time_stamp=%d, Reg0xb0 = 0x%x\n", + timeout, diff_time_stamp, regb0); + + if (dm->support_ic_type & ODM_RTL8197F) /*REG_PS_TIMER2*/ + odm_set_bb_reg(dm, R_0x588, 0xffffffff, timeout); + else { + PHYDM_DBG(dm, DBG_DIG, "NOT 97F, NOT start\n"); + return; + } +} + +void phydm_tdma_dig_timer_check(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + + PHYDM_DBG(dm, DBG_DIG, "tdma_dig_cnt=%d, pre_tdma_dig_cnt=%d\n", + dig_t->tdma_dig_cnt, dig_t->pre_tdma_dig_cnt); + + if (dig_t->tdma_dig_cnt == 0 || + dig_t->tdma_dig_cnt == dig_t->pre_tdma_dig_cnt) { + if (dm->support_ability & ODM_BB_DIG) { +#ifdef IS_USE_NEW_TDMA + if (dm->support_ic_type & (ODM_RTL8198F | ODM_RTL8814B | + ODM_RTL8812F | ODM_RTL8822B | ODM_RTL8192F | + ODM_RTL8821C | ODM_RTL8197G | ODM_RTL8822C | + ODM_RTL8723D)) { + PHYDM_DBG(dm, DBG_DIG, + "Check fail, Restart timer\n\n"); + phydm_false_alarm_counter_reset(dm); + odm_set_timer(dm, &dm->tdma_dig_timer, + dm->tdma_dig_timer_ms); + } else { + PHYDM_DBG(dm, DBG_DIG, + "Not support TDMADIG, no SW timer\n"); + } +#else + /*@if interrupt mask info is got.*/ + /*Reg0xb0 is no longer needed*/ +#if 0 + /*regb0 = odm_get_bb_reg(dm, R_0xb0, bMaskDWord);*/ +#endif + PHYDM_DBG(dm, DBG_DIG, + "Check fail, Mask[0]=0x%x, restart timer\n", + *dm->interrupt_mask); + + phydm_tdma_dig_add_interrupt_mask_handler(dm); + phydm_enable_rx_related_interrupt_handler(dm); + phydm_set_tdma_dig_timer(dm); +#endif + } + } else { + PHYDM_DBG(dm, DBG_DIG, "Check pass, update pre_tdma_dig_cnt\n"); + } + + dig_t->pre_tdma_dig_cnt = dig_t->tdma_dig_cnt; +} + +/*@different IC/team may use different timer for tdma-dig*/ +void phydm_tdma_dig_add_interrupt_mask_handler(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + +#if (DM_ODM_SUPPORT_TYPE == (ODM_AP)) + if (dm->support_ic_type & ODM_RTL8197F) { + /*@HAL_INT_TYPE_PSTIMEOUT2*/ + phydm_add_interrupt_mask_handler(dm, HAL_INT_TYPE_PSTIMEOUT2); + } +#elif (DM_ODM_SUPPORT_TYPE == (ODM_WIN)) +#elif (DM_ODM_SUPPORT_TYPE == (ODM_CE)) +#endif +} + +/* will be triggered by HW timer*/ +void phydm_tdma_dig(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + struct phydm_fa_struct *falm_cnt = &dm->false_alm_cnt; + u32 reg_c50 = 0; + +#if (RTL8198F_SUPPORT || RTL8814B_SUPPORT || RTL8812F_SUPPORT ||\ + RTL8822B_SUPPORT || RTL8192F_SUPPORT || RTL8821C_SUPPORT) +#ifdef IS_USE_NEW_TDMA + if (dm->support_ic_type & + (ODM_RTL8198F | ODM_RTL8814B | ODM_RTL8812F | ODM_RTL8822B | + ODM_RTL8192F | ODM_RTL8821C)) { + PHYDM_DBG(dm, DBG_DIG, "98F/14B/12F/22B/92F/21C, new tdma\n"); + return; + } +#endif +#endif + reg_c50 = odm_get_bb_reg(dm, R_0xc50, MASKBYTE0); + + dig_t->tdma_dig_state = + dig_t->tdma_dig_cnt % dm->tdma_dig_state_number; + + PHYDM_DBG(dm, DBG_DIG, "tdma_dig_state=%d, regc50=0x%x\n", + dig_t->tdma_dig_state, reg_c50); + + dig_t->tdma_dig_cnt++; + + if (dig_t->tdma_dig_state == 1) { + /* update IGI from tdma_dig_state == 0*/ + if (dig_t->cur_ig_value_tdma == 0) + dig_t->cur_ig_value_tdma = dig_t->cur_ig_value; + + odm_write_dig(dm, dig_t->cur_ig_value_tdma); + phydm_tdma_false_alarm_counter_check(dm); + PHYDM_DBG(dm, DBG_DIG, "tdma_dig_state=%d, reset FA counter\n", + dig_t->tdma_dig_state); + + } else if (dig_t->tdma_dig_state == 0) { + /* update dig_t->CurIGValue,*/ + /* @it may different from dig_t->cur_ig_value_tdma */ + /* TDMA IGI upperbond @ L-state = */ + /* rf_ft_var.tdma_dig_low_upper_bond = 0x26 */ + + if (dig_t->cur_ig_value >= dm->tdma_dig_low_upper_bond) + dig_t->low_ig_value = dm->tdma_dig_low_upper_bond; + else + dig_t->low_ig_value = dig_t->cur_ig_value; + + odm_write_dig(dm, dig_t->low_ig_value); + phydm_tdma_false_alarm_counter_check(dm); + } else { + phydm_tdma_false_alarm_counter_check(dm); + } +} + +/*@============================================================*/ +/*@FASLE ALARM CHECK*/ +/*@============================================================*/ +void phydm_tdma_false_alarm_counter_check(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fa_struct *falm_cnt = &dm->false_alm_cnt; + struct phydm_fa_acc_struct *falm_cnt_acc = &dm->false_alm_cnt_acc; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + boolean rssi_dump_en = 0; + u32 timestamp = 0; + u8 tdma_dig_state_number = 0; + u32 start_th = 0; + + if (dig_t->tdma_dig_state == 1) + phydm_false_alarm_counter_reset(dm); + /* Reset FalseAlarmCounterStatistics */ + /* @fa_acc_1sec_tsf = fa_acc_1sec_tsf, keep */ + /* @fa_end_tsf = fa_start_tsf = TSF */ + else { + phydm_false_alarm_counter_statistics(dm); + if (dm->support_ic_type & ODM_RTL8197F) /*REG_FREERUN_CNT*/ + timestamp = odm_get_bb_reg(dm, R_0x568, bMaskDWord); + else { + PHYDM_DBG(dm, DBG_DIG, "NOT 97F! NOT start\n"); + return; + } + dig_t->fa_end_timestamp = timestamp; + dig_t->fa_acc_1sec_timestamp += + (dig_t->fa_end_timestamp - dig_t->fa_start_timestamp); + + /*prevent dumb*/ + if (dm->tdma_dig_state_number == 1) + dm->tdma_dig_state_number = 2; + + tdma_dig_state_number = dm->tdma_dig_state_number; + dig_t->sec_factor = + tdma_dig_state_number / (tdma_dig_state_number - 1); + + /*@1sec = 1000000us*/ + if (dig_t->sec_factor) + start_th = (u32)(1000000 / dig_t->sec_factor); + + if (dig_t->fa_acc_1sec_timestamp >= start_th) { + rssi_dump_en = 1; + phydm_false_alarm_counter_acc(dm, rssi_dump_en); + PHYDM_DBG(dm, DBG_DIG, + "sec_factor=%d, total FA=%d, is_linked=%d\n", + dig_t->sec_factor, falm_cnt_acc->cnt_all, + dm->is_linked); + + phydm_noisy_detection(dm); + #ifdef PHYDM_SUPPORT_CCKPD + phydm_cck_pd_th(dm); + #endif + phydm_dig(dm); + phydm_false_alarm_counter_acc_reset(dm); + + /* Reset FalseAlarmCounterStatistics */ + /* @fa_end_tsf = fa_start_tsf = TSF, keep */ + /* @fa_acc_1sec_tsf = 0 */ + phydm_false_alarm_counter_reset(dm); + } else { + phydm_false_alarm_counter_acc(dm, rssi_dump_en); + } + } +} + +void phydm_false_alarm_counter_acc(void *dm_void, boolean rssi_dump_en) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fa_struct *falm_cnt = &dm->false_alm_cnt; + struct phydm_fa_acc_struct *falm_cnt_acc = &dm->false_alm_cnt_acc; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + + falm_cnt_acc->cnt_parity_fail += falm_cnt->cnt_parity_fail; + falm_cnt_acc->cnt_rate_illegal += falm_cnt->cnt_rate_illegal; + falm_cnt_acc->cnt_crc8_fail += falm_cnt->cnt_crc8_fail; + falm_cnt_acc->cnt_mcs_fail += falm_cnt->cnt_mcs_fail; + falm_cnt_acc->cnt_ofdm_fail += falm_cnt->cnt_ofdm_fail; + falm_cnt_acc->cnt_cck_fail += falm_cnt->cnt_cck_fail; + falm_cnt_acc->cnt_all += falm_cnt->cnt_all; + falm_cnt_acc->cnt_fast_fsync += falm_cnt->cnt_fast_fsync; + falm_cnt_acc->cnt_sb_search_fail += falm_cnt->cnt_sb_search_fail; + falm_cnt_acc->cnt_ofdm_cca += falm_cnt->cnt_ofdm_cca; + falm_cnt_acc->cnt_cck_cca += falm_cnt->cnt_cck_cca; + falm_cnt_acc->cnt_cca_all += falm_cnt->cnt_cca_all; + falm_cnt_acc->cnt_cck_crc32_error += falm_cnt->cnt_cck_crc32_error; + falm_cnt_acc->cnt_cck_crc32_ok += falm_cnt->cnt_cck_crc32_ok; + falm_cnt_acc->cnt_ofdm_crc32_error += falm_cnt->cnt_ofdm_crc32_error; + falm_cnt_acc->cnt_ofdm_crc32_ok += falm_cnt->cnt_ofdm_crc32_ok; + falm_cnt_acc->cnt_ht_crc32_error += falm_cnt->cnt_ht_crc32_error; + falm_cnt_acc->cnt_ht_crc32_ok += falm_cnt->cnt_ht_crc32_ok; + falm_cnt_acc->cnt_vht_crc32_error += falm_cnt->cnt_vht_crc32_error; + falm_cnt_acc->cnt_vht_crc32_ok += falm_cnt->cnt_vht_crc32_ok; + falm_cnt_acc->cnt_crc32_error_all += falm_cnt->cnt_crc32_error_all; + falm_cnt_acc->cnt_crc32_ok_all += falm_cnt->cnt_crc32_ok_all; + + if (rssi_dump_en == 1) { + falm_cnt_acc->cnt_all_1sec = + falm_cnt_acc->cnt_all * dig_t->sec_factor; + falm_cnt_acc->cnt_cca_all_1sec = + falm_cnt_acc->cnt_cca_all * dig_t->sec_factor; + falm_cnt_acc->cnt_cck_fail_1sec = + falm_cnt_acc->cnt_cck_fail * dig_t->sec_factor; + } +} + +void phydm_false_alarm_counter_acc_reset(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fa_acc_struct *falm_cnt_acc = NULL; + +#ifdef IS_USE_NEW_TDMA + struct phydm_fa_acc_struct *falm_cnt_acc_low = NULL; + u32 tmp_cca_1sec = 0; + u32 tmp_fa_1sec = 0; + + /*@clear L-fa_acc struct*/ + falm_cnt_acc_low = &dm->false_alm_cnt_acc_low; + tmp_cca_1sec = falm_cnt_acc_low->cnt_cca_all_1sec; + tmp_fa_1sec = falm_cnt_acc_low->cnt_all_1sec; + odm_memory_set(dm, falm_cnt_acc_low, 0, sizeof(dm->false_alm_cnt_acc)); + falm_cnt_acc_low->cnt_cca_all_1sec = tmp_cca_1sec; + falm_cnt_acc_low->cnt_all_1sec = tmp_fa_1sec; + + /*@clear H-fa_acc struct*/ + falm_cnt_acc = &dm->false_alm_cnt_acc; + tmp_cca_1sec = falm_cnt_acc->cnt_cca_all_1sec; + tmp_fa_1sec = falm_cnt_acc->cnt_all_1sec; + odm_memory_set(dm, falm_cnt_acc, 0, sizeof(dm->false_alm_cnt_acc)); + falm_cnt_acc->cnt_cca_all_1sec = tmp_cca_1sec; + falm_cnt_acc->cnt_all_1sec = tmp_fa_1sec; +#else + falm_cnt_acc = &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(dm, falm_cnt_acc, 0, sizeof(falm_cnt_acc)); +#endif +} + +void phydm_false_alarm_counter_reset(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fa_struct *falm_cnt; + struct phydm_dig_struct *dig_t; + u32 timestamp; + + falm_cnt = &dm->false_alm_cnt; + dig_t = &dm->dm_dig_table; + + memset(falm_cnt, 0, sizeof(dm->false_alm_cnt)); + phydm_false_alarm_counter_reg_reset(dm); + +#ifdef IS_USE_NEW_TDMA + return; +#endif + if (dig_t->tdma_dig_state != 1) + dig_t->fa_acc_1sec_timestamp = 0; + else + dig_t->fa_acc_1sec_timestamp = dig_t->fa_acc_1sec_timestamp; + + /*REG_FREERUN_CNT*/ + timestamp = odm_get_bb_reg(dm, R_0x568, bMaskDWord); + dig_t->fa_start_timestamp = timestamp; + dig_t->fa_end_timestamp = timestamp; +} + +void phydm_tdma_dig_para_upd(void *dm_void, enum upd_type type, u8 input) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + switch (type) { + case ENABLE_TDMA: + dm->original_dig_restore = !((boolean)input); + break; + case MODE_DECISION: + if (input == MODE_PERFORMANCE) + dm->tdma_dig_state_number = DIG_NUM_OF_TDMA_STATES + 2; + else if (input == MODE_COVERAGE) + dm->tdma_dig_state_number = DIG_NUM_OF_TDMA_STATES; + else + dm->tdma_dig_state_number = DIG_NUM_OF_TDMA_STATES; + break; + } +} + +#ifdef IS_USE_NEW_TDMA +void phydm_tdma_dig_timers(void *dm_void, u8 state) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + + if (state == INIT_TDMA_DIG_TIMMER) + odm_initialize_timer(dm, &dm->tdma_dig_timer, + (void *)phydm_tdma_dig_cbk, + NULL, "phydm_tdma_dig_timer"); + else if (state == CANCEL_TDMA_DIG_TIMMER) + odm_cancel_timer(dm, &dm->tdma_dig_timer); + else if (state == RELEASE_TDMA_DIG_TIMMER) + odm_release_timer(dm, &dm->tdma_dig_timer); +} + +u8 get_new_igi_bound(struct dm_struct *dm, u8 igi, u32 fa_cnt, u8 *rx_gain_max, + u8 *rx_gain_min, boolean is_dfs_band) +{ + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + u8 step[3] = {0}; + u8 cur_igi = igi; + boolean first_connect = false, first_dis_connect = false; + + first_connect = (dm->is_linked) && !dig_t->is_media_connect; + first_dis_connect = (!dm->is_linked) && dig_t->is_media_connect; + + if (dm->is_linked) { + if (dm->pre_rssi_min <= dm->rssi_min) { + PHYDM_DBG(dm, DBG_DIG, "pre_rssi_min <= rssi_min\n"); + step[0] = 2; + step[1] = 1; + step[2] = 2; + } else { + step[0] = 4; + step[1] = 2; + step[2] = 2; + } + } else { + step[0] = 2; + step[1] = 1; + step[2] = 2; + } + + PHYDM_DBG(dm, DBG_DIG, "step = {-%d, +%d, +%d}\n", step[2], step[1], + step[0]); + + if (first_connect) { + if (is_dfs_band) { + if (dm->rssi_min > DIG_MAX_DFS) + igi = DIG_MAX_DFS; + else + igi = dm->rssi_min; + PHYDM_DBG(dm, DBG_DIG, "DFS band:IgiMax=0x%x\n", + *rx_gain_max); + } else { + igi = *rx_gain_min; + } + + #if 0 + #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + #if (RTL8812A_SUPPORT) + if (dm->support_ic_type == ODM_RTL8812) + odm_config_bb_with_header_file(dm, + CONFIG_BB_AGC_TAB_DIFF); + #endif + #endif + #endif + PHYDM_DBG(dm, DBG_DIG, "First connect: foce IGI=0x%x\n", igi); + } else { + /* @2 Before link */ + PHYDM_DBG(dm, DBG_DIG, "Adjust IGI before link\n"); + + if (first_dis_connect) { + igi = dig_t->dm_dig_min; + PHYDM_DBG(dm, DBG_DIG, + "First disconnect:foce IGI to lower bound\n"); + } else { + PHYDM_DBG(dm, DBG_DIG, "Pre_IGI=((0x%x)), FA=((%d))\n", + igi, fa_cnt); + + igi = phydm_new_igi_by_fa(dm, igi, fa_cnt, step); + } + } + /*@Check IGI by dyn-upper/lower bound */ + if (igi < *rx_gain_min) + igi = *rx_gain_min; + + if (igi > *rx_gain_max) + igi = *rx_gain_max; + + PHYDM_DBG(dm, DBG_DIG, "fa_cnt = %d, IGI: 0x%x -> 0x%x\n", + fa_cnt, cur_igi, igi); + + return igi; +} + +/*@callback function triggered by SW timer*/ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +void phydm_tdma_dig_cbk(struct phydm_timer_list *timer) +{ + void *adapter = (void *)timer->Adapter; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + struct dm_struct *dm = &hal_data->DM_OutSrc; + + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + + if (phydm_dig_abort(dm) || dm->original_dig_restore) + return; + /*@ + *PHYDM_DBG(dm, DBG_DIG, "timer callback =======> tdma_dig_state=%d\n"); + * dig_t->tdma_dig_state); + *PHYDM_DBG(dm, DBG_DIG, "tdma_h_igi=0x%x, tdma_l_igi=0x%x\n", + * dig_t->cur_ig_value_tdma, + * dig_t->low_ig_value); + */ + phydm_tdma_fa_cnt_chk(dm); + + /*@prevent dumb*/ + if (dm->tdma_dig_state_number < 2) + dm->tdma_dig_state_number = 2; + + /*@update state*/ + dig_t->tdma_dig_cnt++; + dig_t->tdma_dig_state = dig_t->tdma_dig_cnt % dm->tdma_dig_state_number; + + /*@ + *PHYDM_DBG(dm, DBG_DIG, "enter state %d, dig count %d\n", + * dig_t->tdma_dig_state, dig_t->tdma_dig_cnt); + */ + + if (dig_t->tdma_dig_state == TDMA_DIG_LOW_STATE) + odm_write_dig(dm, dig_t->low_ig_value); + else if (dig_t->tdma_dig_state >= TDMA_DIG_HIGH_STATE) + odm_write_dig(dm, dig_t->cur_ig_value_tdma); + + odm_set_timer(dm, &dm->tdma_dig_timer, dm->tdma_dig_timer_ms); +} +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) +void phydm_tdma_dig_cbk(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + void *padapter = dm->adapter; + + if (dm->support_interface == ODM_ITRF_PCIE) + phydm_tdma_dig_workitem_callback(dm); + /* @Can't do I/O in timer callback*/ + else + phydm_run_in_thread_cmd(dm, phydm_tdma_dig_workitem_callback, + dm); +} + +void phydm_tdma_dig_workitem_callback(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + + if (phydm_dig_abort(dm) || (dm->original_dig_restore)) + return; + /*@ + *PHYDM_DBG(dm, DBG_DIG, "timer callback =======> tdma_dig_state=%d\n"); + * dig_t->tdma_dig_state); + *PHYDM_DBG(dm, DBG_DIG, "tdma_h_igi=0x%x, tdma_l_igi=0x%x\n", + * dig_t->cur_ig_value_tdma, + * dig_t->low_ig_value); + */ + phydm_tdma_fa_cnt_chk(dm); + + /*@prevent dumb*/ + if (dm->tdma_dig_state_number < 2) + dm->tdma_dig_state_number = 2; + + /*@update state*/ + dig_t->tdma_dig_cnt++; + dig_t->tdma_dig_state = dig_t->tdma_dig_cnt % dm->tdma_dig_state_number; + + /*@ + *PHYDM_DBG(dm, DBG_DIG, "enter state %d, dig count %d\n", + * dig_t->tdma_dig_state, dig_t->tdma_dig_cnt); + */ + + if (dig_t->tdma_dig_state == TDMA_DIG_LOW_STATE) + odm_write_dig(dm, dig_t->low_ig_value); + else if (dig_t->tdma_dig_state >= TDMA_DIG_HIGH_STATE) + odm_write_dig(dm, dig_t->cur_ig_value_tdma); + + odm_set_timer(dm, &dm->tdma_dig_timer, dm->tdma_dig_timer_ms); +} +#else +void phydm_tdma_dig_cbk(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + + if (phydm_dig_abort(dm) || dm->original_dig_restore) + return; + /*@ + *PHYDM_DBG(dm, DBG_DIG, "timer callback =======> tdma_dig_state=%d\n"); + * dig_t->tdma_dig_state); + *PHYDM_DBG(dm, DBG_DIG, "tdma_h_igi=0x%x, tdma_l_igi=0x%x\n", + * dig_t->cur_ig_value_tdma, + * dig_t->low_ig_value); + */ + phydm_tdma_fa_cnt_chk(dm); + + /*@prevent dumb*/ + if (dm->tdma_dig_state_number < 2) + dm->tdma_dig_state_number = 2; + + /*@update state*/ + dig_t->tdma_dig_cnt++; + dig_t->tdma_dig_state = dig_t->tdma_dig_cnt % dm->tdma_dig_state_number; + + /*@ + *PHYDM_DBG(dm, DBG_DIG, "enter state %d, dig count %d\n", + * dig_t->tdma_dig_state, dig_t->tdma_dig_cnt); + */ + + if (dig_t->tdma_dig_state == TDMA_DIG_LOW_STATE) + odm_write_dig(dm, dig_t->low_ig_value); + else if (dig_t->tdma_dig_state >= TDMA_DIG_HIGH_STATE) + odm_write_dig(dm, dig_t->cur_ig_value_tdma); + + odm_set_timer(dm, &dm->tdma_dig_timer, dm->tdma_dig_timer_ms); +} +#endif +/*@============================================================*/ +/*@FASLE ALARM CHECK*/ +/*@============================================================*/ +void phydm_tdma_fa_cnt_chk(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fa_struct *falm_cnt = &dm->false_alm_cnt; + struct phydm_fa_acc_struct *fa_t_acc = &dm->false_alm_cnt_acc; + struct phydm_fa_acc_struct *fa_t_acc_low = &dm->false_alm_cnt_acc_low; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + boolean rssi_dump_en = false; + u32 timestamp = 0; + u8 states_per_block = dm->tdma_dig_state_number; + u8 cur_tdma_dig_state = 0; + u32 start_th = 0; + u8 state_diff = 0; + u32 tdma_dig_block_period_ms = 0; + u32 tdma_dig_block_cnt_thd = 0; + u32 timestamp_diff = 0; + + /*@calculate duration of a tdma block*/ + tdma_dig_block_period_ms = dm->tdma_dig_timer_ms * states_per_block; + + /*@ + *caution!ONE_SEC_MS must be divisible by tdma_dig_block_period_ms, + *or FA will be fewer. + */ + tdma_dig_block_cnt_thd = ONE_SEC_MS / tdma_dig_block_period_ms; + + /*@tdma_dig_state == 0, collect H-state FA, else, collect L-state FA*/ + if (dig_t->tdma_dig_state == TDMA_DIG_LOW_STATE) + cur_tdma_dig_state = TDMA_DIG_LOW_STATE; + else if (dig_t->tdma_dig_state >= TDMA_DIG_HIGH_STATE) + cur_tdma_dig_state = TDMA_DIG_HIGH_STATE; + /*@ + *PHYDM_DBG(dm, DBG_DIG, "in state %d, dig count %d\n", + * cur_tdma_dig_state, dig_t->tdma_dig_cnt); + */ + if (cur_tdma_dig_state == 0) { + /*@L-state indicates next block*/ + dig_t->tdma_dig_block_cnt++; + + /*@1sec dump check*/ + if (dig_t->tdma_dig_block_cnt >= tdma_dig_block_cnt_thd) + rssi_dump_en = true; + + /*@ + *PHYDM_DBG(dm, DBG_DIG,"[L-state] tdma_dig_block_cnt=%d\n", + * dig_t->tdma_dig_block_cnt); + */ + + /*@collect FA till this block end*/ + phydm_false_alarm_counter_statistics(dm); + phydm_fa_cnt_acc(dm, rssi_dump_en, cur_tdma_dig_state); + /*@1s L-FA collect end*/ + + /*@1sec dump reached*/ + if (rssi_dump_en) { + /*@L-DIG*/ + phydm_noisy_detection(dm); + #ifdef PHYDM_SUPPORT_CCKPD + phydm_cck_pd_th(dm); + #endif + PHYDM_DBG(dm, DBG_DIG, "run tdma L-state dig ====>\n"); + phydm_tdma_low_dig(dm); + PHYDM_DBG(dm, DBG_DIG, "\n\n"); + } + } else if (cur_tdma_dig_state == 1) { + /*@1sec dump check*/ + if (dig_t->tdma_dig_block_cnt >= tdma_dig_block_cnt_thd) + rssi_dump_en = true; + + /*@ + *PHYDM_DBG(dm, DBG_DIG,"[H-state] tdma_dig_block_cnt=%d\n", + * dig_t->tdma_dig_block_cnt); + */ + + /*@collect FA till this block end*/ + phydm_false_alarm_counter_statistics(dm); + phydm_fa_cnt_acc(dm, rssi_dump_en, cur_tdma_dig_state); + /*@1s H-FA collect end*/ + + /*@1sec dump reached*/ + state_diff = dm->tdma_dig_state_number - dig_t->tdma_dig_state; + if (rssi_dump_en && (state_diff == 1)) { + /*@H-DIG*/ + phydm_noisy_detection(dm); + #ifdef PHYDM_SUPPORT_CCKPD + phydm_cck_pd_th(dm); + #endif + PHYDM_DBG(dm, DBG_DIG, "run tdma H-state dig ====>\n"); + phydm_tdma_high_dig(dm); + PHYDM_DBG(dm, DBG_DIG, "\n\n"); + PHYDM_DBG(dm, DBG_DIG, "1 sec reached, is_linked=%d\n", + dm->is_linked); + PHYDM_DBG(dm, DBG_DIG, "1 sec L-CCA=%d, L-FA=%d\n", + fa_t_acc_low->cnt_cca_all_1sec, + fa_t_acc_low->cnt_all_1sec); + PHYDM_DBG(dm, DBG_DIG, "1 sec H-CCA=%d, H-FA=%d\n", + fa_t_acc->cnt_cca_all_1sec, + fa_t_acc->cnt_all_1sec); + PHYDM_DBG(dm, DBG_DIG, + "1 sec TOTAL-CCA=%d, TOTAL-FA=%d\n\n", + fa_t_acc->cnt_cca_all + + fa_t_acc_low->cnt_cca_all, + fa_t_acc->cnt_all + fa_t_acc_low->cnt_all); + + /*@Reset AccFalseAlarmCounterStatistics */ + phydm_false_alarm_counter_acc_reset(dm); + dig_t->tdma_dig_block_cnt = 0; + } + } + /*@Reset FalseAlarmCounterStatistics */ + phydm_false_alarm_counter_reset(dm); +} + +void phydm_tdma_low_dig(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + struct phydm_fa_struct *falm_cnt = &dm->false_alm_cnt; + struct phydm_fa_acc_struct *falm_cnt_acc = &dm->false_alm_cnt_acc_low; +#ifdef CFG_DIG_DAMPING_CHK + struct phydm_dig_recorder_strcut *dig_rc = &dig_t->dig_recorder_t; +#endif + boolean first_connect, first_disconnect = false; + u8 igi = dig_t->cur_ig_value; + u8 new_igi = 0x20; + u8 tdma_l_igi = dig_t->low_ig_value; + u8 tdma_l_dym_min = dig_t->tdma_rx_gain_min[TDMA_DIG_LOW_STATE]; + u8 tdma_l_dym_max = dig_t->tdma_rx_gain_max[TDMA_DIG_LOW_STATE]; + u32 fa_cnt = falm_cnt->cnt_all; + boolean dfs_mode_en = false, is_performance = true; + u8 rssi_min = dm->rssi_min; + u8 igi_upper_rssi_min = 0; + u8 offset = 15; + + if (!(dm->original_dig_restore)) { + if (tdma_l_igi == 0) + tdma_l_igi = igi; + + fa_cnt = falm_cnt_acc->cnt_all_1sec; + } + + if (phydm_dig_abort(dm)) { + dig_t->low_ig_value = phydm_get_igi(dm, BB_PATH_A); + return; + } + + /*@Mode Decision*/ + dfs_mode_en = false; + is_performance = true; + + /* @Abs Boundary Decision*/ + dig_t->dm_dig_max = DIG_MAX_COVERAGR; //0x26 + dig_t->dm_dig_min = DIG_MIN_PERFORMANCE; //0x20 + dig_t->dig_max_of_min = DIG_MAX_OF_MIN_COVERAGE; //0x22 + + if (dfs_mode_en) { + if (*dm->band_width == CHANNEL_WIDTH_20) + dig_t->dm_dig_min = DIG_MIN_DFS + 2; + else + dig_t->dm_dig_min = DIG_MIN_DFS; + + } else { + #if 0 + if (dm->support_ic_type & + (ODM_RTL8814A | ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8822B)) + dig_t->dm_dig_min = 0x1c; + else if (dm->support_ic_type & ODM_RTL8197F) + dig_t->dm_dig_min = 0x1e; /*@For HW setting*/ + #endif + } + + PHYDM_DBG(dm, DBG_DIG, "Abs{Max, Min}={0x%x, 0x%x}, Max_of_min=0x%x\n", + dig_t->dm_dig_max, dig_t->dm_dig_min, dig_t->dig_max_of_min); + + /* @Dyn Boundary by RSSI*/ + if (!dm->is_linked) { + /*@if no link, always stay at lower bound*/ + tdma_l_dym_max = 0x26; + tdma_l_dym_min = dig_t->dm_dig_min; + + PHYDM_DBG(dm, DBG_DIG, "No-Link, Dyn{Max, Min}={0x%x, 0x%x}\n", + tdma_l_dym_max, tdma_l_dym_min); + } else { + PHYDM_DBG(dm, DBG_DIG, "rssi_min=%d, ofst=%d\n", + dm->rssi_min, offset); + + /* @DIG lower bound in L-state*/ + tdma_l_dym_min = dig_t->dm_dig_min; + +#ifdef CFG_DIG_DAMPING_CHK + /*@Limit Dyn min by damping*/ + if (dig_t->dig_dl_en && + dig_rc->damping_limit_en && + tdma_l_dym_min < dig_rc->damping_limit_val) { + PHYDM_DBG(dm, DBG_DIG, + "[Limit by Damping] dyn_min=0x%x -> 0x%x\n", + tdma_l_dym_min, dig_rc->damping_limit_val); + + tdma_l_dym_min = dig_rc->damping_limit_val; + } +#endif + + /*@DIG upper bound in L-state*/ + igi_upper_rssi_min = rssi_min + offset; + if (igi_upper_rssi_min > dig_t->dm_dig_max) + tdma_l_dym_max = dig_t->dm_dig_max; + else if (igi_upper_rssi_min < dig_t->dm_dig_min) + tdma_l_dym_max = dig_t->dm_dig_min; + else + tdma_l_dym_max = igi_upper_rssi_min; + + /* @1 Force Lower Bound for AntDiv */ + /*@ + *if (!dm->is_one_entry_only && + *(dm->support_ability & ODM_BB_ANT_DIV) && + *(dm->ant_div_type == CG_TRX_HW_ANTDIV || + *dm->ant_div_type == CG_TRX_SMART_ANTDIV)) { + *if (dig_t->ant_div_rssi_max > dig_t->dig_max_of_min) + * dig_t->rx_gain_range_min = dig_t->dig_max_of_min; + *else + * dig_t->rx_gain_range_min = (u8)dig_t->ant_div_rssi_max; + * + *PHYDM_DBG(dm, DBG_DIG, "Force Dyn-Min=0x%x, RSSI_max=0x%x\n", + * dig_t->rx_gain_range_min, dig_t->ant_div_rssi_max); + *} + */ + + PHYDM_DBG(dm, DBG_DIG, "Dyn{Max, Min}={0x%x, 0x%x}\n", + tdma_l_dym_max, tdma_l_dym_min); + } + + /*@Abnormal Case Check*/ + /*@Abnormal lower bound case*/ + if (tdma_l_dym_min > tdma_l_dym_max) + tdma_l_dym_min = tdma_l_dym_max; + + PHYDM_DBG(dm, DBG_DIG, + "Abnoraml chk, force {Max, Min}={0x%x, 0x%x}\n", + tdma_l_dym_max, tdma_l_dym_min); + + /*@False Alarm Threshold Decision*/ + phydm_fa_threshold_check(dm, dfs_mode_en); + + /*@Adjust Initial Gain by False Alarm*/ + /*Select new IGI by FA */ + if (!(dm->original_dig_restore)) { + tdma_l_igi = get_new_igi_bound(dm, tdma_l_igi, fa_cnt, + &tdma_l_dym_max, + &tdma_l_dym_min, + dfs_mode_en); + } else { + new_igi = phydm_get_new_igi(dm, igi, fa_cnt, dfs_mode_en); + } + + /*Update status*/ + if (!(dm->original_dig_restore)) { + dig_t->low_ig_value = tdma_l_igi; + dig_t->tdma_rx_gain_min[TDMA_DIG_LOW_STATE] = tdma_l_dym_min; + dig_t->tdma_rx_gain_max[TDMA_DIG_LOW_STATE] = tdma_l_dym_max; +#if 0 + /*odm_write_dig(dm, tdma_l_igi);*/ +#endif + } else { + odm_write_dig(dm, new_igi); + } + + dig_t->is_media_connect = dm->is_linked; +} + +void phydm_tdma_high_dig(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + struct phydm_fa_struct *falm_cnt = &dm->false_alm_cnt; + struct phydm_fa_acc_struct *falm_cnt_acc = &dm->false_alm_cnt_acc; +#ifdef CFG_DIG_DAMPING_CHK + struct phydm_dig_recorder_strcut *dig_rc = &dig_t->dig_recorder_t; +#endif + boolean first_connect, first_disconnect = false; + u8 igi = dig_t->cur_ig_value; + u8 new_igi = 0x20; + u8 tdma_h_igi = dig_t->cur_ig_value_tdma; + u8 tdma_h_dym_min = dig_t->tdma_rx_gain_min[TDMA_DIG_HIGH_STATE]; + u8 tdma_h_dym_max = dig_t->tdma_rx_gain_max[TDMA_DIG_HIGH_STATE]; + u32 fa_cnt = falm_cnt->cnt_all; + boolean dfs_mode_en = false, is_performance = true; + u8 rssi_min = dm->rssi_min; + u8 igi_upper_rssi_min = 0; + u8 offset = 15; + + if (!(dm->original_dig_restore)) { + if (tdma_h_igi == 0) + tdma_h_igi = igi; + + fa_cnt = falm_cnt_acc->cnt_all_1sec; + } + + if (phydm_dig_abort(dm)) { + dig_t->cur_ig_value_tdma = phydm_get_igi(dm, BB_PATH_A); + return; + } + + /*@Mode Decision*/ + dfs_mode_en = false; + is_performance = true; + + /*@Abs Boundary Decision*/ + dig_t->dig_max_of_min = DIG_MAX_OF_MIN_BALANCE_MODE; // 0x2a + + if (!dm->is_linked) { + dig_t->dm_dig_max = DIG_MAX_COVERAGR; + dig_t->dm_dig_min = DIG_MIN_PERFORMANCE; // 0x20 + } else if (dfs_mode_en) { + if (*dm->band_width == CHANNEL_WIDTH_20) + dig_t->dm_dig_min = DIG_MIN_DFS + 2; + else + dig_t->dm_dig_min = DIG_MIN_DFS; + + dig_t->dig_max_of_min = DIG_MAX_OF_MIN_BALANCE_MODE; + dig_t->dm_dig_max = DIG_MAX_BALANCE_MODE; + } else { + if (*dm->bb_op_mode == PHYDM_BALANCE_MODE) { + /*service > 2 devices*/ + dig_t->dm_dig_max = DIG_MAX_BALANCE_MODE; + #if (DIG_HW == 1) + dig_t->dig_max_of_min = DIG_MIN_COVERAGE; + #else + dig_t->dig_max_of_min = DIG_MAX_OF_MIN_BALANCE_MODE; + #endif + } else if (*dm->bb_op_mode == PHYDM_PERFORMANCE_MODE) { + /*service 1 devices*/ + dig_t->dm_dig_max = DIG_MAX_PERFORMANCE_MODE; + dig_t->dig_max_of_min = DIG_MAX_OF_MIN_PERFORMANCE_MODE; + } + + #if 0 + if (dm->support_ic_type & + (ODM_RTL8814A | ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8822B)) + dig_t->dm_dig_min = 0x1c; + else if (dm->support_ic_type & ODM_RTL8197F) + dig_t->dm_dig_min = 0x1e; /*@For HW setting*/ + else + #endif + dig_t->dm_dig_min = DIG_MIN_PERFORMANCE; + } + PHYDM_DBG(dm, DBG_DIG, "Abs{Max, Min}={0x%x, 0x%x}, Max_of_min=0x%x\n", + dig_t->dm_dig_max, dig_t->dm_dig_min, dig_t->dig_max_of_min); + + /*@Dyn Boundary by RSSI*/ + if (!dm->is_linked) { + /*@if no link, always stay at lower bound*/ + tdma_h_dym_max = dig_t->dig_max_of_min; + tdma_h_dym_min = dig_t->dm_dig_min; + + PHYDM_DBG(dm, DBG_DIG, "No-Link, Dyn{Max, Min}={0x%x, 0x%x}\n", + tdma_h_dym_max, tdma_h_dym_min); + } else { + PHYDM_DBG(dm, DBG_DIG, "rssi_min=%d, ofst=%d\n", + dm->rssi_min, offset); + + /* @DIG lower bound in H-state*/ + if (rssi_min < dig_t->dm_dig_min) + tdma_h_dym_min = dig_t->dm_dig_min; + else + tdma_h_dym_min = rssi_min; // turbo not considered yet + +#ifdef CFG_DIG_DAMPING_CHK + /*@Limit Dyn min by damping*/ + if (dig_t->dig_dl_en && + dig_rc->damping_limit_en && + tdma_h_dym_min < dig_rc->damping_limit_val) { + PHYDM_DBG(dm, DBG_DIG, + "[Limit by Damping] dyn_min=0x%x -> 0x%x\n", + tdma_h_dym_min, dig_rc->damping_limit_val); + + tdma_h_dym_min = dig_rc->damping_limit_val; + } +#endif + + /*@DIG upper bound in H-state*/ + igi_upper_rssi_min = rssi_min + offset; + if (igi_upper_rssi_min > dig_t->dm_dig_max) + tdma_h_dym_max = dig_t->dm_dig_max; + else + tdma_h_dym_max = igi_upper_rssi_min; + + /* @1 Force Lower Bound for AntDiv */ + /*@ + *if (!dm->is_one_entry_only && + *(dm->support_ability & ODM_BB_ANT_DIV) && + *(dm->ant_div_type == CG_TRX_HW_ANTDIV || + *dm->ant_div_type == CG_TRX_SMART_ANTDIV)) { + * if (dig_t->ant_div_rssi_max > dig_t->dig_max_of_min) + * dig_t->rx_gain_range_min = dig_t->dig_max_of_min; + * else + * dig_t->rx_gain_range_min = (u8)dig_t->ant_div_rssi_max; + */ + /*@ + *PHYDM_DBG(dm, DBG_DIG, "Force Dyn-Min=0x%x, RSSI_max=0x%x\n", + * dig_t->rx_gain_range_min, dig_t->ant_div_rssi_max); + *} + */ + PHYDM_DBG(dm, DBG_DIG, "Dyn{Max, Min}={0x%x, 0x%x}\n", + tdma_h_dym_max, tdma_h_dym_min); + } + + /*@Abnormal Case Check*/ + /*@Abnormal low higher bound case*/ + if (tdma_h_dym_max < dig_t->dm_dig_min) + tdma_h_dym_max = dig_t->dm_dig_min; + /*@Abnormal lower bound case*/ + if (tdma_h_dym_min > tdma_h_dym_max) + tdma_h_dym_min = tdma_h_dym_max; + + PHYDM_DBG(dm, DBG_DIG, "Abnoraml chk, force {Max, Min}={0x%x, 0x%x}\n", + tdma_h_dym_max, tdma_h_dym_min); + + /*@False Alarm Threshold Decision*/ + phydm_fa_threshold_check(dm, dfs_mode_en); + + /*@Adjust Initial Gain by False Alarm*/ + /*Select new IGI by FA */ + if (!(dm->original_dig_restore)) { + tdma_h_igi = get_new_igi_bound(dm, tdma_h_igi, fa_cnt, + &tdma_h_dym_max, + &tdma_h_dym_min, + dfs_mode_en); + } else { + new_igi = phydm_get_new_igi(dm, igi, fa_cnt, dfs_mode_en); + } + + /*Update status*/ + if (!(dm->original_dig_restore)) { + dig_t->cur_ig_value_tdma = tdma_h_igi; + dig_t->tdma_rx_gain_min[TDMA_DIG_HIGH_STATE] = tdma_h_dym_min; + dig_t->tdma_rx_gain_max[TDMA_DIG_HIGH_STATE] = tdma_h_dym_max; +#if 0 + /*odm_write_dig(dm, tdma_h_igi);*/ +#endif + } else { + odm_write_dig(dm, new_igi); + } + + dig_t->is_media_connect = dm->is_linked; +} + +void phydm_fa_cnt_acc(void *dm_void, boolean rssi_dump_en, + u8 cur_tdma_dig_state) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fa_struct *falm_cnt = &dm->false_alm_cnt; + struct phydm_fa_acc_struct *falm_cnt_acc = NULL; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + u8 factor_num = 0; + u8 factor_denum = 1; + u8 total_state_number = 0; + + if (cur_tdma_dig_state == TDMA_DIG_LOW_STATE) + falm_cnt_acc = &dm->false_alm_cnt_acc_low; + else if (cur_tdma_dig_state == TDMA_DIG_HIGH_STATE) + + falm_cnt_acc = &dm->false_alm_cnt_acc; + /*@ + *PHYDM_DBG(dm, DBG_DIG, + * "[%s] ==> dig_state=%d, one_sec=%d\n", __func__, + * cur_tdma_dig_state, rssi_dump_en); + */ + falm_cnt_acc->cnt_parity_fail += falm_cnt->cnt_parity_fail; + falm_cnt_acc->cnt_rate_illegal += falm_cnt->cnt_rate_illegal; + falm_cnt_acc->cnt_crc8_fail += falm_cnt->cnt_crc8_fail; + falm_cnt_acc->cnt_mcs_fail += falm_cnt->cnt_mcs_fail; + falm_cnt_acc->cnt_ofdm_fail += falm_cnt->cnt_ofdm_fail; + falm_cnt_acc->cnt_cck_fail += falm_cnt->cnt_cck_fail; + falm_cnt_acc->cnt_all += falm_cnt->cnt_all; + falm_cnt_acc->cnt_fast_fsync += falm_cnt->cnt_fast_fsync; + falm_cnt_acc->cnt_sb_search_fail += falm_cnt->cnt_sb_search_fail; + falm_cnt_acc->cnt_ofdm_cca += falm_cnt->cnt_ofdm_cca; + falm_cnt_acc->cnt_cck_cca += falm_cnt->cnt_cck_cca; + falm_cnt_acc->cnt_cca_all += falm_cnt->cnt_cca_all; + falm_cnt_acc->cnt_cck_crc32_error += falm_cnt->cnt_cck_crc32_error; + falm_cnt_acc->cnt_cck_crc32_ok += falm_cnt->cnt_cck_crc32_ok; + falm_cnt_acc->cnt_ofdm_crc32_error += falm_cnt->cnt_ofdm_crc32_error; + falm_cnt_acc->cnt_ofdm_crc32_ok += falm_cnt->cnt_ofdm_crc32_ok; + falm_cnt_acc->cnt_ht_crc32_error += falm_cnt->cnt_ht_crc32_error; + falm_cnt_acc->cnt_ht_crc32_ok += falm_cnt->cnt_ht_crc32_ok; + falm_cnt_acc->cnt_vht_crc32_error += falm_cnt->cnt_vht_crc32_error; + falm_cnt_acc->cnt_vht_crc32_ok += falm_cnt->cnt_vht_crc32_ok; + falm_cnt_acc->cnt_crc32_error_all += falm_cnt->cnt_crc32_error_all; + falm_cnt_acc->cnt_crc32_ok_all += falm_cnt->cnt_crc32_ok_all; + + /*@ + *PHYDM_DBG(dm, DBG_DIG, + * "[CCA Cnt] {CCK, OFDM, Total} = {%d, %d, %d}\n", + * falm_cnt->cnt_cck_cca, + * falm_cnt->cnt_ofdm_cca, + * falm_cnt->cnt_cca_all); + *PHYDM_DBG(dm, DBG_DIG, + * "[FA Cnt] {CCK, OFDM, Total} = {%d, %d, %d}\n", + * falm_cnt->cnt_cck_fail, + * falm_cnt->cnt_ofdm_fail, + * falm_cnt->cnt_all); + */ + if (rssi_dump_en == 1) { + total_state_number = dm->tdma_dig_state_number; + + if (cur_tdma_dig_state == TDMA_DIG_HIGH_STATE) { + factor_num = total_state_number; + factor_denum = total_state_number - 1; + } else if (cur_tdma_dig_state == TDMA_DIG_LOW_STATE) { + factor_num = total_state_number; + factor_denum = 1; + } + + falm_cnt_acc->cnt_all_1sec = + falm_cnt_acc->cnt_all * factor_num / factor_denum; + falm_cnt_acc->cnt_cca_all_1sec = + falm_cnt_acc->cnt_cca_all * factor_num / factor_denum; + falm_cnt_acc->cnt_cck_fail_1sec = + falm_cnt_acc->cnt_cck_fail * factor_num / factor_denum; + + PHYDM_DBG(dm, DBG_DIG, + "[ACC CCA Cnt] {CCK, OFDM, Total} = {%d, %d, %d}\n", + falm_cnt_acc->cnt_cck_cca, + falm_cnt_acc->cnt_ofdm_cca, + falm_cnt_acc->cnt_cca_all); + PHYDM_DBG(dm, DBG_DIG, + "[ACC FA Cnt] {CCK, OFDM, Total} = {%d, %d, %d}\n\n", + falm_cnt_acc->cnt_cck_fail, + falm_cnt_acc->cnt_ofdm_fail, + falm_cnt_acc->cnt_all); + + } +} +#endif /*@#ifdef IS_USE_NEW_TDMA*/ +#endif /*@#ifdef PHYDM_TDMA_DIG_SUPPORT*/ + +void phydm_dig_debug(void *dm_void, char input[][16], u32 *_used, char *output, + u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + char help[] = "-h"; + u32 var1[10] = {0}; + u32 used = *_used; + u32 out_len = *_out_len; + u8 i = 0; + + if ((strcmp(input[1], help) == 0)) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "{0} {en} fa_th[0] fa_th[1] fa_th[2]\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{1} {Damping Limit en}\n"); + #ifdef PHYDM_TDMA_DIG_SUPPORT + PDM_SNPF(out_len, used, output + used, out_len - used, + "{2} {original_dig_restore = %d}\n", + dm->original_dig_restore); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{3} {tdma_dig_timer_ms = %d}\n", + dm->tdma_dig_timer_ms); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{4} {tdma_dig_state_number = %d}\n", + dm->tdma_dig_state_number); + #endif + } else { + PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); + + for (i = 1; i < 10; i++) + PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); + + if (var1[0] == 0) { + if (var1[1] == 1) { + dig_t->is_dbg_fa_th = true; + dig_t->fa_th[0] = (u16)var1[2]; + dig_t->fa_th[1] = (u16)var1[3]; + dig_t->fa_th[2] = (u16)var1[4]; + + PDM_SNPF(out_len, used, output + used, + out_len - used, + "Set DIG fa_th[0:2]= {%d, %d, %d}\n", + dig_t->fa_th[0], dig_t->fa_th[1], + dig_t->fa_th[2]); + } else { + dig_t->is_dbg_fa_th = false; + } + #ifdef PHYDM_TDMA_DIG_SUPPORT + } else if (var1[0] == 2) { + dm->original_dig_restore = (u8)var1[1]; + if (dm->original_dig_restore == 1) { + PDM_SNPF(out_len, used, output + used, + out_len - used, "Disable TDMA-DIG\n"); + } else { + PDM_SNPF(out_len, used, output + used, + out_len - used, "Enable TDMA-DIG\n"); + } + } else if (var1[0] == 3) { + dm->tdma_dig_timer_ms = (u8)var1[1]; + PDM_SNPF(out_len, used, output + used, + out_len - used, "tdma_dig_timer_ms = %d\n", + dm->tdma_dig_timer_ms); + } else if (var1[0] == 4) { + dm->tdma_dig_state_number = (u8)var1[1]; + PDM_SNPF(out_len, used, output + used, + out_len - used, "tdma_dig_state_number = %d\n", + dm->tdma_dig_state_number); + #endif + } + + #ifdef CFG_DIG_DAMPING_CHK + else if (var1[0] == 1) { + dig_t->dig_dl_en = (u8)var1[1]; + /*@*/ + } + #endif + } + *_used = used; + *_out_len = out_len; +} + +#ifdef CONFIG_MCC_DM +#if (RTL8822B_SUPPORT || RTL8822C_SUPPORT) +void phydm_mcc_igi_clr(void *dm_void, u8 clr_port) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _phydm_mcc_dm_ *mcc_dm = &dm->mcc_dm; + + mcc_dm->mcc_rssi[clr_port] = 0xff; + mcc_dm->mcc_dm_val[0][clr_port] = 0xff; /* 0xc50 clr */ + mcc_dm->mcc_dm_val[1][clr_port] = 0xff; /* 0xe50 clr */ +} + +void phydm_mcc_igi_chk(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _phydm_mcc_dm_ *mcc_dm = &dm->mcc_dm; + + if (mcc_dm->mcc_dm_val[0][0] == 0xff && + mcc_dm->mcc_dm_val[0][1] == 0xff) { + mcc_dm->mcc_dm_reg[0] = 0xffff; + mcc_dm->mcc_reg_id[0] = 0xff; + } + if (mcc_dm->mcc_dm_val[1][0] == 0xff && + mcc_dm->mcc_dm_val[1][1] == 0xff) { + mcc_dm->mcc_dm_reg[1] = 0xffff; + mcc_dm->mcc_reg_id[1] = 0xff; + } +} + +void phydm_mcc_igi_cal(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _phydm_mcc_dm_ *mcc_dm = &dm->mcc_dm; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + u8 shift = 0; + u8 igi_val0, igi_val1; + + if (mcc_dm->mcc_rssi[0] == 0xff) + phydm_mcc_igi_clr(dm, 0); + if (mcc_dm->mcc_rssi[1] == 0xff) + phydm_mcc_igi_clr(dm, 1); + phydm_mcc_igi_chk(dm); + igi_val0 = mcc_dm->mcc_rssi[0] - shift; + igi_val1 = mcc_dm->mcc_rssi[1] - shift; + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + phydm_fill_mcccmd(dm, 0, R_0x1d70, igi_val0, igi_val1); + phydm_fill_mcccmd(dm, 1, R_0x1d70 + 1, igi_val0, igi_val1); + #else + phydm_fill_mcccmd(dm, 0, 0xc50, igi_val0, igi_val1); + phydm_fill_mcccmd(dm, 1, 0xe50, igi_val0, igi_val1); + #endif + PHYDM_DBG(dm, DBG_COMP_MCC, "RSSI_min: %d %d, MCC_igi: %d %d\n", + mcc_dm->mcc_rssi[0], mcc_dm->mcc_rssi[1], + mcc_dm->mcc_dm_val[0][0], mcc_dm->mcc_dm_val[0][1]); +} +#endif /*#if (RTL8822B_SUPPORT)*/ +#endif /*#ifdef CONFIG_MCC_DM*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dig.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dig.h index 5fe2b93396e1..48db150a4395 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dig.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dig.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,101 +9,157 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ -#ifndef __PHYDMDIG_H__ -#define __PHYDMDIG_H__ +#ifndef __PHYDMDIG_H__ +#define __PHYDMDIG_H__ -#define DIG_VERSION "1.3" /* 2016.08.16 YuChen. Modify IGI lower bound to 0x1e for 8197F asked by RF Arthur*/ +#define DIG_VERSION "2.3" -/* Pause DIG & CCKPD */ -#define DM_DIG_MAX_PAUSE_TYPE 0x7 +#define DIG_HW 0 +#define DIG_LIMIT_PERIOD 60 /*@60 sec*/ +/*@--------------------Define ---------------------------------------*/ + +/*@=== [DIG Boundary] ========================================*/ +/*@DIG coverage mode*/ +#define DIG_MAX_COVERAGR 0x26 +#define DIG_MIN_COVERAGE 0x1c +#define DIG_MAX_OF_MIN_COVERAGE 0x22 + +/*@[DIG Balance 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 + +/*@[DIG Performance mode]*/ +#define DIG_MAX_PERFORMANCE_MODE 0x5a +#define DIG_MAX_OF_MIN_PERFORMANCE_MODE 0x40 /*@[WLANBB-871]*/ +#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 + +#ifdef PHYDM_TDMA_DIG_SUPPORT +#define DIG_NUM_OF_TDMA_STATES 2 /*@L, H state*/ +#define DIG_TIMER_MS 250 +#define ONE_SEC_MS 1000 +#endif + +/*@=== [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 +#define DIG_RECORD_NUM 4 + +/*@--------------------Enum-----------------------------------*/ enum dig_goupcheck_level { - DIG_GOUPCHECK_LEVEL_0, DIG_GOUPCHECK_LEVEL_1, DIG_GOUPCHECK_LEVEL_2 - }; -struct _dynamic_initial_gain_threshold_ { - bool is_stop_dig; /* for debug */ - bool is_ignore_dig; - bool is_psd_in_progress; +enum phydm_dig_mode { + PHYDM_DIG_PERFORAMNCE_MODE = 0, + PHYDM_DIG_COVERAGE_MODE = 1, +}; - u8 dig_enable_flag; - u8 dig_ext_port_stage; +#ifdef PHYDM_TDMA_DIG_SUPPORT +enum upd_type { + ENABLE_TDMA, + MODE_DECISION +}; - int rssi_low_thresh; - int rssi_high_thresh; +enum tdma_opmode { + MODE_PERFORMANCE = 1, + MODE_COVERAGE = 2 +}; - u32 fa_low_thresh; - u32 fa_high_thresh; +#ifdef IS_USE_NEW_TDMA +enum tdma_dig_timer { + INIT_TDMA_DIG_TIMMER, + CANCEL_TDMA_DIG_TIMMER, + RELEASE_TDMA_DIG_TIMMER +}; - u8 cur_sta_connect_state; - u8 pre_sta_connect_state; - u8 cur_multi_sta_connect_state; - - u8 pre_ig_value; - u8 cur_ig_value; - u8 backup_ig_value; /* MP DIG */ - u8 bt30_cur_igi; - u8 igi_backup; - - s8 backoff_val; - s8 backoff_val_range_max; - s8 backoff_val_range_min; - u8 rx_gain_range_max; - u8 rx_gain_range_min; - u8 rssi_val_min; - - u8 pre_cck_cca_thres; - u8 cur_cck_cca_thres; - u8 pre_cck_pd_state; - u8 cur_cck_pd_state; - u8 cck_pd_backup; - u8 pause_cckpd_level; - u8 pause_cckpd_value[DM_DIG_MAX_PAUSE_TYPE + 1]; - - u8 large_fa_hit; - u8 large_fa_timeout; /*if (large_fa_hit), monitor "large_fa_timeout" sec, if timeout, large_fa_hit=0*/ - u8 forbidden_igi; - u32 recover_cnt; - - u8 dig_dynamic_min_0; - u8 dig_dynamic_min_1; - bool is_media_connect_0; - bool is_media_connect_1; - - u32 ant_div_rssi_max; - u32 RSSI_max; - - u8 *is_p2p_in_process; - - u8 pause_dig_level; - u8 pause_dig_value[DM_DIG_MAX_PAUSE_TYPE + 1]; - - u32 cck_fa_ma; - enum dig_goupcheck_level dig_go_up_check_level; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - bool is_tp_target; - bool is_noise_est; - u32 tp_train_th_min; - u8 igi_offset_a; - u8 igi_offset_b; +enum tdma_dig_state { + TDMA_DIG_LOW_STATE = 0, + TDMA_DIG_HIGH_STATE = 1, + NORMAL_DIG = 2 +}; +#endif #endif -#if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1 || RTL8821C_SUPPORT == 1) +/*@--------------------Define Struct-----------------------------------*/ +#ifdef CFG_DIG_DAMPING_CHK +struct phydm_dig_recorder_strcut { + u8 igi_bitmap; /*@Don't add any new parameter before this*/ + u8 igi_history[DIG_RECORD_NUM]; + u32 fa_history[DIG_RECORD_NUM]; + u8 damping_limit_en; + u8 damping_limit_val; /*@Limit IGI_dyn_min*/ + u32 limit_time; + u8 limit_rssi; +}; +#endif + +struct phydm_mcc_dig { + u8 mcc_rssi_A; + u8 mcc_rssi_B; +}; + +struct phydm_dig_struct { +#ifdef CFG_DIG_DAMPING_CHK + struct phydm_dig_recorder_strcut dig_recorder_t; + u8 dig_dl_en; /*@damping limit function enable*/ +#endif + boolean is_dbg_fa_th; + 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; + enum dig_goupcheck_level go_up_chk_lv; + u16 fa_th[3]; +#if (RTL8822B_SUPPORT || RTL8197F_SUPPORT || RTL8821C_SUPPORT ||\ + RTL8198F_SUPPORT || RTL8192F_SUPPORT || RTL8195B_SUPPORT ||\ + RTL8822C_SUPPORT || RTL8814B_SUPPORT || RTL8721D_SUPPORT ||\ + RTL8812F_SUPPORT || RTL8197G_SUPPORT) u8 rf_gain_idx; u8 agc_table_idx; u8 big_jump_lmt[16]; @@ -110,16 +167,80 @@ struct _dynamic_initial_gain_threshold_ { u8 big_jump_step1:3; u8 big_jump_step2:2; u8 big_jump_step3:2; +#endif + u8 upcheck_init_val; + u8 lv0_ratio_reciprocal; + u8 lv1_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; +#ifdef IS_USE_NEW_TDMA + u8 tdma_dig_block_cnt;/*@for 1 second dump indicator use*/ + /*@dynamic upper bound for L/H state*/ + u8 tdma_rx_gain_max[DIG_NUM_OF_TDMA_STATES]; + /*@dynamic lower bound for L/H state*/ + u8 tdma_rx_gain_min[DIG_NUM_OF_TDMA_STATES]; + /*To distinguish current state(L-sate or H-state)*/ +#endif #endif }; -struct _FALSE_ALARM_STATISTICS { +struct phydm_fa_struct { + u32 cnt_parity_fail; + u32 cnt_rate_illegal; + u32 cnt_crc8_fail; + u32 cnt_crc8_fail_vht; + u32 cnt_mcs_fail; + u32 cnt_mcs_fail_vht; + u32 cnt_ofdm_fail; + u32 cnt_ofdm_fail_pre; /* @For RTL8881A */ + u32 cnt_cck_fail; + u32 cnt_all; + u32 cnt_all_accumulated; + 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; + u32 time_fa_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_ofdm_fail_pre; /*@For RTL8881A*/ u32 cnt_cck_fail; u32 cnt_all; u32 cnt_all_pre; @@ -128,8 +249,6 @@ struct _FALSE_ALARM_STATISTICS { u32 cnt_ofdm_cca; u32 cnt_cck_cca; u32 cnt_cca_all; - u32 cnt_bw_usc; /* Gary */ - u32 cnt_bw_lsc; /* Gary */ u32 cnt_cck_crc32_error; u32 cnt_cck_crc32_ok; u32 cnt_ofdm_crc32_error; @@ -140,228 +259,79 @@ struct _FALSE_ALARM_STATISTICS { u32 cnt_vht_crc32_ok; u32 cnt_crc32_error_all; u32 cnt_crc32_ok_all; - bool cck_block_enable; - bool ofdm_block_enable; - u32 dbg_port0; - bool edcca_flag; + u32 cnt_all_1sec; + u32 cnt_cca_all_1sec; + u32 cnt_cck_fail_1sec; }; -enum dm_dig_op_e { - 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 -}; +#endif /*@#ifdef PHYDM_TDMA_DIG_SUPPORT*/ -/* -enum dm_cck_pdth_e -{ - CCK_PD_STAGE_LowRssi = 0, - CCK_PD_STAGE_HighRssi = 1, - CCK_PD_STAGE_MAX = 3, -}; +/*@--------------------Function declaration-----------------------------*/ +void phydm_write_dig_reg(void *dm_void, u8 igi); -enum dm_dig_ext_port_alg_e -{ - 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, -}; +void odm_write_dig(void *dm_void, u8 current_igi); -enum dm_dig_connect_e -{ - DIG_STA_DISCONNECT = 0, - DIG_STA_CONNECT = 1, - DIG_STA_BEFORE_CONNECT = 2, - dig_multi_sta_disconnect = 3, - dig_multi_sta_connect = 4, - DIG_CONNECT_MAX -}; +u8 phydm_get_igi(void *dm_void, enum bb_path path); +void phydm_set_dig_val(void *dm_void, u32 *val_buf, u8 val_len); -#define DM_MultiSTA_InitGainChangeNotify(Event) {dm_dig_table.cur_multi_sta_connect_state = Event;} +void odm_pause_dig(void *dm_void, enum phydm_pause_type pause_type, + enum phydm_pause_level pause_level, u8 igi_value); -#define DM_MultiSTA_InitGainChangeNotify_CONNECT(_ADAPTER) \ - DM_MultiSTA_InitGainChangeNotify(dig_multi_sta_connect) +void phydm_dig_init(void *dm_void); -#define DM_MultiSTA_InitGainChangeNotify_DISCONNECT(_ADAPTER) \ - DM_MultiSTA_InitGainChangeNotify(dig_multi_sta_disconnect) -*/ +void phydm_dig(void *dm_void); -enum phydm_pause_type { - PHYDM_PAUSE = BIT(0), - PHYDM_RESUME = BIT(1) -}; +void phydm_dig_lps_32k(void *dm_void); -enum 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 */ -}; +void phydm_dig_by_rssi_lps(void *dm_void); -#define DM_DIG_THRESH_HIGH 40 -#define DM_DIG_THRESH_LOW 35 +void phydm_false_alarm_counter_statistics(void *dm_void); -#define DM_FALSEALARM_THRESH_LOW 400 -#define DM_FALSEALARM_THRESH_HIGH 1000 +#ifdef PHYDM_TDMA_DIG_SUPPORT +void phydm_set_tdma_dig_timer(void *dm_void); -#define DM_DIG_MAX_NIC 0x3e -#define DM_DIG_MIN_NIC 0x20 -#define DM_DIG_MAX_OF_MIN_NIC 0x3e +void phydm_tdma_dig_timer_check(void *dm_void); -#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 +void phydm_tdma_dig(void *dm_void); -#define DM_DIG_MAX_NIC_HP 0x46 -#define DM_DIG_MIN_NIC_HP 0x2e +void phydm_tdma_false_alarm_counter_check(void *dm_void); -#define DM_DIG_MAX_AP_HP 0x42 -#define DM_DIG_MIN_AP_HP 0x30 +void phydm_tdma_dig_add_interrupt_mask_handler(void *dm_void); -#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 +void phydm_false_alarm_counter_reset(void *dm_void); - #define dm_dig_tp_target_th0 500 - #define dm_dig_tp_target_th1 1000 - #define dm_dig_tp_training_period 10 -#endif +void phydm_false_alarm_counter_acc(void *dm_void, boolean rssi_dump_en); -/* 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 +void phydm_false_alarm_counter_acc_reset(void *dm_void); -#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 +void phydm_tdma_dig_para_upd(void *dm_void, enum upd_type type, u8 input); -#define DM_DIG_BACKOFF_MAX 12 -#define DM_DIG_BACKOFF_MIN -4 -#define DM_DIG_BACKOFF_DEFAULT 10 +#ifdef IS_USE_NEW_TDMA +void phydm_tdma_dig_timers(void *dm_void, u8 state); -#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 phydm_tdma_dig_cbk(void *dm_void); +void phydm_tdma_dig_workitem_callback(void *dm_void); -void -odm_change_dynamic_init_gain_thresh( - void *p_dm_void, - u32 dm_type, - u32 dm_value -); +void phydm_tdma_fa_cnt_chk(void *dm_void); -void -odm_write_dig( - void *p_dm_void, - u8 current_igi -); +void phydm_tdma_low_dig(void *dm_void); -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_tdma_high_dig(void *dm_void); -void -odm_dig_init( - void *p_dm_void -); +void phydm_fa_cnt_acc(void *dm_void, boolean rssi_dump_en, + u8 cur_tdma_dig_state); +#endif /*@#ifdef IS_USE_NEW_TDMA*/ +#endif /*@#ifdef PHYDM_TDMA_DIG_SUPPORT*/ -void -odm_DIG( - void *p_dm_void -); +void phydm_set_ofdm_agc_tab(void *dm_void, u8 tab_sel); -void -odm_dig_by_rssi_lps( - void *p_dm_void -); +void phydm_dig_debug(void *dm_void, char input[][16], u32 *_used, char *output, + u32 *_out_len); -void -odm_false_alarm_counter_statistics( - 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 -odm_cck_packet_detection_thresh( - void *p_dm_void -); - -void -odm_write_cck_cca_thres( - void *p_dm_void, - u8 cur_cck_cca_thres -); - -bool -phydm_dig_go_up_check( - void *p_dm_void -); - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -void -odm_mpt_dig_callback( - struct timer_list *p_timer -); - -void -odm_mpt_dig_work_item_callback( - void *p_context -); - -#endif - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -void -odm_mpt_dig_callback( - void *p_dm_void -); -#endif - -#if (DM_ODM_SUPPORT_TYPE != ODM_CE) -void -ODM_MPT_DIG( - void *p_dm_void -); +#ifdef CONFIG_MCC_DM +void phydm_mcc_igi_cal(void *dm_void); #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_direct_bf.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_direct_bf.c new file mode 100644 index 000000000000..510dffbf2d7b --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_direct_bf.c @@ -0,0 +1,311 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +/*@************************************************************ + * include files + ***************************************************************/ + +#include "mp_precomp.h" +#include "phydm_precomp.h" +#ifdef CONFIG_DIRECTIONAL_BF +#ifdef PHYDM_COMPILE_IC_2SS +void phydm_iq_gen_en(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + enum rf_path i = RF_PATH_A; + enum rf_path path = RF_PATH_A; + + #if (ODM_IC_11AC_SERIES_SUPPORT) + if (dm->support_ic_type & ODM_RTL8822B) { + for (i = RF_PATH_A; i <= RF_PATH_B; i++) { + /*RF mode table write enable*/ + odm_set_rf_reg(dm, path, RF_0xef, BIT(19), 0x1); + /*Select RX mode*/ + odm_set_rf_reg(dm, path, RF_0x33, 0xF, 3); + /*Set Table data*/ + odm_set_rf_reg(dm, path, RF_0x3e, 0xfffff, 0x00036); + /*Set Table data*/ + odm_set_rf_reg(dm, path, RF_0x3f, 0xfffff, 0x5AFCE); + /*RF mode table write disable*/ + odm_set_rf_reg(dm, path, RF_0xef, BIT(19), 0x0); + } + } + #endif + + #if (ODM_IC_11N_SERIES_SUPPORT) + if (dm->support_ic_type & ODM_RTL8192F) { + /*RF mode table write enable*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, 0x80000, 0x1); + odm_set_rf_reg(dm, RF_PATH_B, RF_0xef, 0x80000, 0x1); + /* Path A */ + odm_set_rf_reg(dm, RF_PATH_A, RF_0x30, 0xfffff, 0x08000); + odm_set_rf_reg(dm, RF_PATH_A, RF_0x31, 0xfffff, 0x0005f); + odm_set_rf_reg(dm, RF_PATH_A, RF_0x32, 0xfffff, 0x01042); + odm_set_rf_reg(dm, RF_PATH_A, RF_0x30, 0xfffff, 0x18000); + odm_set_rf_reg(dm, RF_PATH_A, RF_0x31, 0xfffff, 0x0004f); + odm_set_rf_reg(dm, RF_PATH_A, RF_0x32, 0xfffff, 0x71fc2); + /* Path B */ + odm_set_rf_reg(dm, RF_PATH_B, RF_0x30, 0xfffff, 0x08000); + odm_set_rf_reg(dm, RF_PATH_B, RF_0x31, 0xfffff, 0x00050); + odm_set_rf_reg(dm, RF_PATH_B, RF_0x32, 0xfffff, 0x01042); + odm_set_rf_reg(dm, RF_PATH_B, RF_0x30, 0xfffff, 0x18000); + odm_set_rf_reg(dm, RF_PATH_B, RF_0x31, 0xfffff, 0x00040); + odm_set_rf_reg(dm, RF_PATH_B, RF_0x32, 0xfffff, 0x71fc2); + /*RF mode table write disable*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, 0x80000, 0x0); + odm_set_rf_reg(dm, RF_PATH_B, RF_0xef, 0x80000, 0x0); + } + #endif +} + +void phydm_dis_cdd(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + #if (ODM_IC_11AC_SERIES_SUPPORT) + if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + odm_set_bb_reg(dm, R_0x808, 0x3ffff00, 0); + odm_set_bb_reg(dm, R_0x9ac, 0x1fff, 0); + odm_set_bb_reg(dm, R_0x9ac, BIT(13), 1); + } + #endif + #if (ODM_IC_11N_SERIES_SUPPORT) + if (dm->support_ic_type & ODM_IC_11N_SERIES) { + odm_set_bb_reg(dm, R_0x90c, 0xffffffff, 0x83321333); + /* Set Tx delay setting for CCK pathA,B*/ + odm_set_bb_reg(dm, R_0xa2c, 0xf0000000, 0); + /*Enable Tx CDD for HT part when spatial expansion is applied*/ + odm_set_bb_reg(dm, R_0xd00, BIT(8), 0); + /* Tx CDD for Legacy*/ + odm_set_bb_reg(dm, R_0xd04, 0xf0000, 0); + /* Tx CDD for non-HT*/ + odm_set_bb_reg(dm, R_0xd0c, 0x3c0, 0); + /* Tx CDD for HT SS1*/ + odm_set_bb_reg(dm, R_0xd0c, 0xf8000, 0); + } + #endif +} + +void phydm_pathb_q_matrix_rotate_en(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + phydm_iq_gen_en(dm); + + /*#ifdef PHYDM_COMMON_API_SUPPORT*/ + /*path selection is controlled by driver*/ + #if 0 + if (!phydm_api_trx_mode(dm, BB_PATH_AB, BB_PATH_AB, BB_PATH_AB)) + return; + #endif + + phydm_dis_cdd(dm); + phydm_pathb_q_matrix_rotate(dm, 0); + + #if (ODM_IC_11AC_SERIES_SUPPORT) + if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + /*Set Q matrix r_v11 =1*/ + odm_set_bb_reg(dm, R_0x195c, MASKDWORD, 0x40000); + /*Set Q matrix enable*/ + odm_set_bb_reg(dm, R_0x191c, BIT(7), 1); + } + #endif +} + +void phydm_pathb_q_matrix_rotate(void *dm_void, u16 idx) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + #if (ODM_IC_11AC_SERIES_SUPPORT) + u32 phase_table_0[ANGLE_NUM] = {0x40000, 0x376CF, 0x20000, 0x00000, + 0xFE0000, 0xFC8930, 0xFC0000, + 0xFC8930, 0xFDFFFF, 0x000000, + 0x020000, 0x0376CF}; + u32 phase_table_1[ANGLE_NUM] = {0x00000, 0x1FFFF, 0x376CF, 0x40000, + 0x0376CF, 0x01FFFF, 0x000000, + 0xFDFFFF, 0xFC8930, 0xFC0000, + 0xFC8930, 0xFDFFFF}; + #endif + #if (ODM_IC_11N_SERIES_SUPPORT) + u32 phase_table_n_0[ANGLE_NUM] = {0x00, 0x0B, 0x02, 0x00, 0x02, 0x02, + 0x04, 0x02, 0x0D, 0x09, 0x04, 0x0B}; + u32 phase_table_n_1[ANGLE_NUM] = {0x40000100, 0x377F00DD, 0x201D8880, + 0x00000000, 0xE01D8B80, 0xC8BF0322, + 0xC000FF00, 0xC8BF0322, 0xDFE2777F, + 0xFFC003FF, 0x20227480, 0x377F00DD}; + u32 phase_table_n_2[ANGLE_NUM] = {0x00, 0x1E, 0x3C, 0x4C, 0x3C, 0x1E, + 0x0F, 0xD2, 0xC3, 0xC4, 0xC3, 0xD2}; + #endif + if (idx >= ANGLE_NUM) { + pr_debug("[%s]warning Phase Set Error: %d\n", __func__, idx); + return; + } + + switch (dm->ic_ip_series) { + #if (ODM_IC_11AC_SERIES_SUPPORT == 1) + case PHYDM_IC_AC: + /*Set Q matrix r_v21*/ + odm_set_bb_reg(dm, R_0x1954, 0xffffff, phase_table_0[idx]); + odm_set_bb_reg(dm, R_0x1950, 0xffffff, phase_table_1[idx]); + break; + #endif + + #if (ODM_IC_11N_SERIES_SUPPORT == 1) + case PHYDM_IC_N: + /*Set Q matrix r_v21*/ + odm_set_bb_reg(dm, R_0xc4c, 0xff000000, phase_table_n_0[idx]); + odm_set_bb_reg(dm, R_0xc88, 0xffffffff, phase_table_n_1[idx]); + odm_set_bb_reg(dm, R_0xc9c, 0xff000000, phase_table_n_2[idx]); + break; + #endif + + default: + break; + } +} + +/*Before use this API, Fill correct Tx Des. and Disable STBC in advance*/ +void phydm_set_direct_bfer(void *dm_void, u16 phs_idx, u8 su_idx) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; +#if (RTL8822B_SUPPORT) + if (dm->support_ic_type & ODM_RTL8822B) { +#if 0 + u8 phi[13] = {0x0, 0x5, 0xa, 0xf, 0x15, 0x1a, 0x1f, 0x25, + 0x2a, 0x2f, 0x35, 0x3a, 0x0}; + u8 psi[13] = {0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, 0x7, + 0x7, 0x7, 0x7, 0x7}; + u16 psiphi[13] = {0x1c0, 0x1c5, 0x1ca, 0x1cf, 0x1d5, 0x1da, + 0x1df, 0x1e5, 0x1ea, 0x1ef, 0x1f5, 0x1fa, + 0x1c0}; //{Psi_4bit, Phi_6bit} of 0~360 +#endif + u16 ns[3] = {52, 108, 234}; //20/40/80 MHz subcarrier number + u16 psiphi[13] = {0x1c0, 0x1c5, 0x1ca, 0x1cf, 0x1d5, 0x1da, + 0x1df, 0x1e5, 0x1ea, 0x1ef, 0x1f5, 0x1fa, + 0x1c0}; //{Psi_4bit, Phi_6bit} of 0~360 + u16 psiphiR; + u8 i; + u8 snr = 0x12; // for 1SS BF + u8 nc = 0x0; //bit 2-0 + u8 nr = 0x1; //bit 5-3 + u8 ng = 0x0; //bit 7-6 + u8 cb = 0x1; //bit 9-8; 1 => phi:6, psi:4; + u32 bw = odm_get_bb_reg(dm, R_0x8ac, 0x3); //bit 11-10 + u8 userid = su_idx; //bit 12 + u32 csi_report = 0x0; + u32 ndp_bw = odm_get_bb_reg(dm, R_0x8ac, 0x3); //bit 11-10 + u8 ndp_sc = 0; //bit 11-10 + u32 ndp_info = 0x0; + + u16 mem_num = 0; + u8 mem_move = 0; + u8 mem_sel = 0; + u16 mem_addr = 0; + u32 dw0, dw1; + u64 vm_info = 0; + u64 temp = 0; + u8 vm_cnt = 0; + + mem_num = ((8 + (6 + 4) * ns[bw]) >> 6) + 1; // SU codebook 1 + + /* setting NDP BW/SC info*/ + ndp_info = (ndp_bw & 0x3) | (ndp_bw & 0x3) << 6 | + (ndp_bw & 0x3) << 12 | (ndp_sc & 0xf) << 2 | + (ndp_sc & 0xf) << 8 | (ndp_sc & 0xf) << 14; + odm_set_bb_reg(dm, R_0xb58, 0x000FFFFC, ndp_info); + odm_set_bb_reg(dm, R_0x19f8, 0x00010000, 1); + ODM_delay_ms(1); // delay 1ms + odm_set_bb_reg(dm, R_0x19f8, 0x00010000, 0); + + /* setting CSI report info*/ + csi_report = (userid & 0x1) << 12 | (bw & 0x3) << 10 | + (cb & 0x3) << 8 | (ng & 0x3) << 6 | + (nr & 0x7) << 3 | (nc & 0x7); + odm_set_bb_reg(dm, R_0x72c, 0x1FFF, csi_report); + odm_set_bb_reg(dm, R_0x71c, 0x80000000, 1); + PHYDM_DBG(dm, DBG_TXBF, "[%s] direct BF csi report 0x%x\n", + __func__, csi_report); + /*========================*/ + + odm_set_bb_reg(dm, R_0x19b8, 0x40, 1); //0x19b8[6]:1 to csi_rpt + odm_set_bb_reg(dm, R_0x19e0, 0x3FC0, 0xFF); //gated_clk off + odm_set_bb_reg(dm, R_0x9e8, 0x2000000, 1); //abnormal txbf + odm_set_bb_reg(dm, R_0x9e8, 0x1000000, 0); //read phi psi + odm_set_bb_reg(dm, R_0x9e8, 0x70000000, su_idx); //SU user 0 + odm_set_bb_reg(dm, R_0x1910, 0x8000, 0); //BFer + + dw0 = 0; // for 0x9ec + dw1 = 0; // for 0x1900 + mem_addr = 0; + mem_sel = 0; + mem_move = 0; + vm_info = vm_info | (snr & 0xff); //V matrix info + vm_cnt = 8; // V matrix length counter + psiphiR = (psiphi[phs_idx] & 0x3ff); + + while (mem_addr < mem_num) { + while (vm_cnt <= 32) { + // shift only max. 32 bit + if (vm_cnt >= 20) { + temp = psiphiR << 20; + temp = temp << (vm_cnt - 20); + } else { + temp = psiphiR << vm_cnt; + } + vm_info |= temp; + vm_cnt += 10; + } + if (mem_sel == 0) { + dw0 = vm_info & 0xffffffff; + vm_info = vm_info >> 32; + vm_cnt -= 32; + mem_sel = 1; + mem_move = 0; + } else { + dw1 = vm_info & 0xffffffff; + vm_info = vm_info >> 32; + vm_cnt -= 32; + mem_sel = 0; + mem_move = 1; + } + if (mem_move == 1) { + odm_set_bb_reg(dm, 0x9e8, 0x1000000, 0); + //read phi psi + odm_set_bb_reg(dm, 0x1910, 0x3FF0000, + mem_addr); + odm_set_bb_reg(dm, 0x09ec, 0xFFFFFFFF, dw0); + odm_set_bb_reg(dm, 0x1900, 0xFFFFFFFF, dw1); + odm_set_bb_reg(dm, 0x9e8, 0x1000000, 1); + //write phi psi + mem_move = 0; + mem_addr += 1; + } + } + odm_set_bb_reg(dm, 0x9e8, 0x2000000, 0); //normal txbf + } +#endif +} //end function +#endif +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_direct_bf.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_direct_bf.h new file mode 100644 index 000000000000..f1efb6ea301a --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_direct_bf.h @@ -0,0 +1,43 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +#ifndef __PHYDM_DIR_BF_H__ +#define __PHYDM_DIR_BF_H__ + +#ifdef CONFIG_DIRECTIONAL_BF +#define ANGLE_NUM 12 + +/*@ + * ============================================================ + * function prototype + * ============================================================ + */ +void phydm_iq_gen_en(void *dm_void); +void phydm_dis_cdd(void *dm_void); +void phydm_pathb_q_matrix_rotate_en(void *dm_void); +void phydm_pathb_q_matrix_rotate(void *dm_void, u16 idx); +#endif +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dynamic_rx_path.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dynamic_rx_path.c deleted file mode 100644 index 4ef4b9f254a1..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dynamic_rx_path.c +++ /dev/null @@ -1,357 +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 (CONFIG_DYNAMIC_RX_PATH == 1) - -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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _odm_phy_status_info_ *p_phy_info = (struct _odm_phy_status_info_ *)p_phy_info_void; - struct _odm_per_pkt_info_ *p_pktinfo = (struct _odm_per_pkt_info_ *)p_pkt_info_void; - struct _DYNAMIC_RX_PATH_ *p_dm_drp_table = &(p_dm_odm->dm_drp_table); - /*u8 is_cck_rate=0;*/ - - - -} - -void -phydm_drp_get_statistic( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _DYNAMIC_RX_PATH_ *p_dm_drp_table = &(p_dm_odm->dm_drp_table); - struct _FALSE_ALARM_STATISTICS *false_alm_cnt = (struct _FALSE_ALARM_STATISTICS *)phydm_get_structure(p_dm_odm, PHYDM_FALSEALMCNT); - - odm_false_alarm_counter_statistics(p_dm_odm); - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_RX_PATH, ODM_DBG_LOUD, ("[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)); - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_RX_PATH, ODM_DBG_LOUD, ("[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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _DYNAMIC_RX_PATH_ *p_dm_drp_table = &(p_dm_odm->dm_drp_table); - u8 training_set_timmer_en; - u8 curr_drp_state; - u32 rx_ok_cal; - u32 RSSI = 0; - struct _FALSE_ALARM_STATISTICS *false_alm_cnt = (struct _FALSE_ALARM_STATISTICS *)phydm_get_structure(p_dm_odm, PHYDM_FALSEALMCNT); - - if (!(p_dm_odm->support_ability & ODM_BB_DYNAMIC_RX_PATH)) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_RX_PATH, ODM_DBG_LOUD, ("[Return Init] Not Support Dynamic RX PAth\n")); - return; - } - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_RX_PATH, ODM_DBG_LOUD, ("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_odm); - - if (false_alm_cnt->cnt_crc32_ok_all > 20) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_RX_PATH, ODM_DBG_LOUD, ("[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 { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_RX_PATH, ODM_DBG_LOUD, ("[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 = PHYDM_AB; - training_set_timmer_en = true; - } - - } else if (p_dm_drp_table->drp_state == DRP_TRAINING_STATE_0) { - - phydm_drp_get_statistic(p_dm_odm); - - 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 = PHYDM_B; - training_set_timmer_en = true; - - } else if (p_dm_drp_table->drp_state == DRP_TRAINING_STATE_1) { - - phydm_drp_get_statistic(p_dm_odm); - - 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_odm->mp_mode) { - rx_ok_cal = p_dm_odm->phy_dbg_info.num_qry_phy_status_cck + p_dm_odm->phy_dbg_info.num_qry_phy_status_ofdm; - RSSI = (rx_ok_cal != 0) ? p_dm_odm->rx_pwdb_ave / rx_ok_cal : 0; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_RX_PATH, ODM_DBG_LOUD, ("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 = PHYDM_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_odm); - - 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) { - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_RX_PATH, ODM_DBG_LOUD, ("Current drp_state = ((%d))\n", p_dm_drp_table->drp_state)); - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_RX_PATH, ODM_DBG_LOUD, ("[0] {CCA, FA} = {%d, %d}\n", p_dm_drp_table->curr_cca_all_cnt_0, p_dm_drp_table->curr_fa_all_cnt_0)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_RX_PATH, ODM_DBG_LOUD, ("[1] {CCA, FA} = {%d, %d}\n", p_dm_drp_table->curr_cca_all_cnt_1, p_dm_drp_table->curr_fa_all_cnt_1)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_RX_PATH, ODM_DBG_LOUD, ("[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 = PHYDM_B; - else - p_dm_drp_table->curr_rx_path = PHYDM_AB; - } else - p_dm_drp_table->curr_rx_path = PHYDM_AB; - - phydm_config_ofdm_rx_path(p_dm_odm, p_dm_drp_table->curr_rx_path); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_RX_PATH, ODM_DBG_LOUD, ("[Training Result] curr_rx_path = ((%s%s)),\n", - ((p_dm_drp_table->curr_rx_path & PHYDM_A) ? "A" : " "), ((p_dm_drp_table->curr_rx_path & PHYDM_B) ? "B" : " "))); - - p_dm_drp_table->drp_state = DRP_INIT_STATE; - training_set_timmer_en = false; - } - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_RX_PATH, ODM_DBG_LOUD, ("DRP_state: ((%d)) -> ((%d))\n", curr_drp_state, p_dm_drp_table->drp_state)); - - if (training_set_timmer_en) { - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_RX_PATH, ODM_DBG_LOUD, ("[Training en] curr_rx_path = ((%s%s)), training_time = ((%d ms))\n", - ((p_dm_drp_table->curr_rx_path & PHYDM_A) ? "A" : " "), ((p_dm_drp_table->curr_rx_path & PHYDM_B) ? "B" : " "), p_dm_drp_table->training_time)); - - phydm_config_ofdm_rx_path(p_dm_odm, p_dm_drp_table->curr_rx_path); - odm_set_timer(p_dm_odm, &(p_dm_drp_table->phydm_dynamic_rx_path_timer), p_dm_drp_table->training_time); /*ms*/ - } else - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_RX_PATH, ODM_DBG_LOUD, ("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_odm = &(p_hal_data->DM_OutSrc); - struct _DYNAMIC_RX_PATH_ *p_dm_drp_table = &(p_dm_odm->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_odm); - } -#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_odm = &(p_hal_data->DM_OutSrc); - - /* dbg_print("phydm_dynamic_rx_path\n"); */ - phydm_dynamic_rx_path(p_dm_odm); -} -#else if (DM_ODM_SUPPORT_TYPE == ODM_CE) - -void -phydm_dynamic_rx_path_callback( - void *function_context -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)function_context; - struct _ADAPTER *padapter = p_dm_odm->adapter; - - if (padapter->net_closed == _TRUE) - return; - -#if 0 /* Can't do I/O in timer callback*/ - odm_s0s1_sw_ant_div(p_dm_odm, 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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _DYNAMIC_RX_PATH_ *p_dm_drp_table = &(p_dm_odm->dm_drp_table); - - if (state == INIT_DRP_TIMMER) { - - odm_initialize_timer(p_dm_odm, &(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_odm, &(p_dm_drp_table->phydm_dynamic_rx_path_timer)); - - else if (state == RELEASE_DRP_TIMMER) - - odm_release_timer(p_dm_odm, &(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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _DYNAMIC_RX_PATH_ *p_dm_drp_table = &(p_dm_odm->dm_drp_table); - bool ret_value; - - if (!(p_dm_odm->support_ability & ODM_BB_DYNAMIC_RX_PATH)) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_RX_PATH, ODM_DBG_LOUD, ("[Return] Not Support Dynamic RX PAth\n")); - return; - } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_RX_PATH, ODM_DBG_LOUD, ("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_odm, (enum odm_rf_path_e)(ODM_RF_A | ODM_RF_B), (enum odm_rf_path_e)(ODM_RF_A | ODM_RF_B), 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_odm = (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_odm->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; -} -} - -void -phydm_dynamic_rx_path_caller( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _DYNAMIC_RX_PATH_ *p_dm_drp_table = &(p_dm_odm->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_odm); - -} -#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dynamic_rx_path.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dynamic_rx_path.h deleted file mode 100644 index b38f63b10084..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dynamic_rx_path.h +++ /dev/null @@ -1,137 +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 __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 (CONFIG_DYNAMIC_RX_PATH == 1) - -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/rtl8188eu/hal/phydm/phydm_dynamicbbpowersaving.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dynamicbbpowersaving.c deleted file mode 100644 index 50db60790f99..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dynamicbbpowersaving.c +++ /dev/null @@ -1,111 +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_dynamic_bb_power_saving_init( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _dynamic_power_saving *p_dm_ps_table = &p_dm_odm->dm_ps_table; - - p_dm_ps_table->pre_cca_state = CCA_MAX; - p_dm_ps_table->cur_cca_state = CCA_MAX; - p_dm_ps_table->pre_rf_state = RF_MAX; - p_dm_ps_table->cur_rf_state = RF_MAX; - p_dm_ps_table->rssi_val_min = 0; - p_dm_ps_table->initialize = 0; -} - -void -odm_rf_saving( - void *p_dm_void, - u8 is_force_in_normal -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; -#if (DM_ODM_SUPPORT_TYPE != ODM_AP) - struct _dynamic_power_saving *p_dm_ps_table = &p_dm_odm->dm_ps_table; - u8 rssi_up_bound = 30 ; - u8 rssi_low_bound = 25; -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - if (p_dm_odm->patch_id == 40) { /* RT_CID_819x_FUNAI_TV */ - rssi_up_bound = 50 ; - rssi_low_bound = 45; - } -#endif - if (p_dm_ps_table->initialize == 0) { - - p_dm_ps_table->reg874 = (odm_get_bb_reg(p_dm_odm, 0x874, MASKDWORD) & 0x1CC000) >> 14; - p_dm_ps_table->regc70 = (odm_get_bb_reg(p_dm_odm, 0xc70, MASKDWORD) & BIT(3)) >> 3; - p_dm_ps_table->reg85c = (odm_get_bb_reg(p_dm_odm, 0x85c, MASKDWORD) & 0xFF000000) >> 24; - p_dm_ps_table->rega74 = (odm_get_bb_reg(p_dm_odm, 0xa74, MASKDWORD) & 0xF000) >> 12; - /* Reg818 = phy_query_bb_reg(p_adapter, 0x818, MASKDWORD); */ - p_dm_ps_table->initialize = 1; - } - - if (!is_force_in_normal) { - if (p_dm_odm->rssi_min != 0xFF) { - if (p_dm_ps_table->pre_rf_state == rf_normal) { - if (p_dm_odm->rssi_min >= rssi_up_bound) - p_dm_ps_table->cur_rf_state = rf_save; - else - p_dm_ps_table->cur_rf_state = rf_normal; - } else { - if (p_dm_odm->rssi_min <= rssi_low_bound) - p_dm_ps_table->cur_rf_state = rf_normal; - else - p_dm_ps_table->cur_rf_state = rf_save; - } - } else - p_dm_ps_table->cur_rf_state = RF_MAX; - } else - p_dm_ps_table->cur_rf_state = rf_normal; - - if (p_dm_ps_table->pre_rf_state != p_dm_ps_table->cur_rf_state) { - if (p_dm_ps_table->cur_rf_state == rf_save) { - odm_set_bb_reg(p_dm_odm, 0x874, 0x1C0000, 0x2); /* reg874[20:18]=3'b010 */ - odm_set_bb_reg(p_dm_odm, 0xc70, BIT(3), 0); /* regc70[3]=1'b0 */ - odm_set_bb_reg(p_dm_odm, 0x85c, 0xFF000000, 0x63); /* reg85c[31:24]=0x63 */ - odm_set_bb_reg(p_dm_odm, 0x874, 0xC000, 0x2); /* reg874[15:14]=2'b10 */ - odm_set_bb_reg(p_dm_odm, 0xa74, 0xF000, 0x3); /* RegA75[7:4]=0x3 */ - odm_set_bb_reg(p_dm_odm, 0x818, BIT(28), 0x0); /* Reg818[28]=1'b0 */ - odm_set_bb_reg(p_dm_odm, 0x818, BIT(28), 0x1); /* Reg818[28]=1'b1 */ - } else { - odm_set_bb_reg(p_dm_odm, 0x874, 0x1CC000, p_dm_ps_table->reg874); - odm_set_bb_reg(p_dm_odm, 0xc70, BIT(3), p_dm_ps_table->regc70); - odm_set_bb_reg(p_dm_odm, 0x85c, 0xFF000000, p_dm_ps_table->reg85c); - odm_set_bb_reg(p_dm_odm, 0xa74, 0xF000, p_dm_ps_table->rega74); - odm_set_bb_reg(p_dm_odm, 0x818, BIT(28), 0x0); - } - p_dm_ps_table->pre_rf_state = p_dm_ps_table->cur_rf_state; - } -#endif -} - -#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dynamicbbpowersaving.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dynamicbbpowersaving.h deleted file mode 100644 index c4a7047dad64..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dynamicbbpowersaving.h +++ /dev/null @@ -1,57 +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)) - -struct _dynamic_power_saving { - u8 pre_cca_state; - u8 cur_cca_state; - - u8 pre_rf_state; - u8 cur_rf_state; - - int rssi_val_min; - - u8 initialize; - u32 reg874, regc70, reg85c, rega74; - -}; - -#define dm_rf_saving odm_rf_saving - -void odm_rf_saving( - void *p_dm_void, - u8 is_force_in_normal -); - -void -odm_dynamic_bb_power_saving_init( - void *p_dm_void -); -#else -#define dm_rf_saving(p_dm_void, is_force_in_normal) -#endif - -#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dynamictxpower.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dynamictxpower.c index 6876a7d28ba7..ec7f71af6c43 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dynamictxpower.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dynamictxpower.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,528 +9,545 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ -/* ************************************************************ +/************************************************************* * include files - * ************************************************************ */ + ************************************************************/ #include "mp_precomp.h" #include "phydm_precomp.h" +#ifdef CONFIG_DYNAMIC_TX_TWR + +#ifdef BB_RAM_SUPPORT + void -odm_dynamic_tx_power_init( - void *p_dm_void -) +phdm_2ndtype_rd_ram_pwr(void *dm_void, u8 macid) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _ADAPTER *adapter = p_dm_odm->adapter; - PMGNT_INFO p_mgnt_info = &adapter->MgntInfo; - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); +}; - /*if (!IS_HARDWARE_TYPE_8814A(adapter)) {*/ - /* ODM_RT_TRACE(p_dm_odm,ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, */ - /* ("odm_dynamic_tx_power_init DynamicTxPowerEnable=%d\n", p_mgnt_info->is_dynamic_tx_power_enable));*/ - /* return;*/ - /*} else*/ - { - p_mgnt_info->bDynamicTxPowerEnable = true; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, - ("odm_dynamic_tx_power_init DynamicTxPowerEnable=%d\n", p_mgnt_info->bDynamicTxPowerEnable)); +void +phdm_2ndtype_wt_ram_pwr(void *dm_void, u8 macid, boolean pwr_offset0_en, + boolean pwr_offset1_en, s8 pwr_offset0, s8 pwr_offset1) +{ + u32 reg_io_0x1e84 = 0; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_bb_ram_per_sta *dm_ram_per_sta = NULL; + dm_ram_per_sta = &dm->p_bb_ram_ctrl.pram_sta_ctrl[macid]; + dm_ram_per_sta->tx_pwr_offset0_en = pwr_offset0_en; + dm_ram_per_sta->tx_pwr_offset1_en = pwr_offset1_en; + dm_ram_per_sta->tx_pwr_offset0 = pwr_offset0; + dm_ram_per_sta->tx_pwr_offset1 = pwr_offset1; + reg_io_0x1e84 = (dm_ram_per_sta->hw_igi_en<<7) + dm_ram_per_sta->hw_igi; + reg_io_0x1e84 |= (pwr_offset0_en<<15) + ((pwr_offset0&0x7f)<<8); + reg_io_0x1e84 |= (pwr_offset1_en<<23) + ((pwr_offset1&0x7f)<<16); + reg_io_0x1e84 |= (macid&0x3f)<<24; + reg_io_0x1e84 |= BIT(30); + odm_set_bb_reg(dm, 0x1e84, 0xffffffff, reg_io_0x1e84); +}; + +u8 phydm_pwr_lv_mapping_2ndtype(u8 tx_pwr_lv) +{ + if (tx_pwr_lv == tx_high_pwr_level_level3) + /*PHYDM_2ND_OFFSET_MINUS_11DB;*/ + return PHYDM_2ND_OFFSET_MINUS_7DB; + else if (tx_pwr_lv == tx_high_pwr_level_level2) + return PHYDM_2ND_OFFSET_MINUS_7DB; + else if (tx_pwr_lv == tx_high_pwr_level_level1) + return PHYDM_2ND_OFFSET_MINUS_3DB; + else + return PHYDM_2ND_OFFSET_ZERO; +} + +#if CONFIG_PHY_CTRL_PWR +void phydm_pwr_lv_ctrl(void *dm_void, u8 macid, u8 tx_pwr_lv) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + s8 pwr_offset; + + if (tx_pwr_lv == tx_high_pwr_level_level3) + pwr_offset = PHYDM_BBRAM_OFFSET_MINUS_11DB; + else if (tx_pwr_lv == tx_high_pwr_level_level2) + pwr_offset = PHYDM_BBRAM_OFFSET_MINUS_7DB; + else if (tx_pwr_lv == tx_high_pwr_level_level1) + pwr_offset = PHYDM_BBRAM_OFFSET_MINUS_3DB; + else + pwr_offset = PHYDM_BBRAM_OFFSET_ZERO; + phdm_2ndtype_wt_ram_pwr(dm, macid, false, true, 0, pwr_offset); + odm_set_mac_reg(dm, ODM_REG_RESP_TX_11AC, BIT(19) | BIT(18), 1); +} +#endif + +void phydm_dtp_fill_cmninfo_2ndtype(void *dm_void, u8 macid, u8 dtp_lvl) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct dtp_info *dtp = NULL; + + dtp = &dm->phydm_sta_info[macid]->dtp_stat; + if (!(dm->support_ability & ODM_BB_DYNAMIC_TXPWR)) + return; + #if CONFIG_PHY_CTRL_PWR + dtp->dyn_tx_power = 1; + #else + dtp->dyn_tx_power = phydm_pwr_lv_mapping_2ndtype(dtp_lvl); + #endif + PHYDM_DBG(dm, DBG_DYN_TXPWR, + "Fill cmninfo TxPwr: macid=(%d), PwrLv (%d)\n", macid, + dtp->dyn_tx_power); + /* dyn_tx_power is 2 bit at 8822C/14B/98F/12F*/ +} + +void +phydm_2ndtype_dtp_init(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 pwr_offset_minus3, pwr_offset_minus7; + u8 i; + + #if 0 + /*@ 2's com, for offset 3dB and 7dB, which 1 step will be 1dB*/ + pwr_offset_minus3 = 0x0; + pwr_offset_minus7 = 0x0; + odm_set_bb_reg(dm, 0x1e70, 0x00ff0000, pwr_offset_minus3); + odm_set_bb_reg(dm, 0x1e70, 0xff000000, pwr_offset_minus7); + for (i = 0; i <= 63; i++) + phdm_2ndtype_wt_ram_pwr(dm, i, false, false, 0, 0); + #endif +}; + +#endif + +boolean +phydm_check_rates(void *dm_void, u8 rate_idx) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 check_rate_bitmap0 = 0x08080808; /* @check CCK11M, OFDM54M, MCS7, MCS15*/ + u32 check_rate_bitmap1 = 0x80200808; /* @check MCS23, MCS31, VHT1SS M9, VHT2SS M9*/ + u32 check_rate_bitmap2 = 0x00080200; /* @check VHT3SS M9, VHT4SS M9*/ + u32 bitmap_result; + +#if (RTL8822B_SUPPORT == 1) + if (dm->support_ic_type & ODM_RTL8822B) { + check_rate_bitmap2 &= 0; + check_rate_bitmap1 &= 0xfffff000; + check_rate_bitmap0 &= 0x0fffffff; } +#endif -#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_odm); - p_mgnt_info->bDynamicTxPowerEnable = true; - } else +#if (RTL8197F_SUPPORT == 1) + if (dm->support_ic_type & ODM_RTL8197F) { + check_rate_bitmap2 &= 0; + check_rate_bitmap1 &= 0; + check_rate_bitmap0 &= 0x0fffffff; + } +#endif + +#if (RTL8192E_SUPPORT == 1) + if (dm->support_ic_type & ODM_RTL8192E) { + check_rate_bitmap2 &= 0; + check_rate_bitmap1 &= 0; + check_rate_bitmap0 &= 0x0fffffff; + } +#endif + +/*@jj add 20170822*/ +#if (RTL8192F_SUPPORT == 1) + if (dm->support_ic_type & ODM_RTL8192F) { + check_rate_bitmap2 &= 0; + check_rate_bitmap1 &= 0; + check_rate_bitmap0 &= 0x0fffffff; + } +#endif +#if (RTL8721D_SUPPORT == 1) + if (dm->support_ic_type & ODM_RTL8721D) { + check_rate_bitmap2 &= 0; + check_rate_bitmap1 &= 0; + check_rate_bitmap0 &= 0x000fffff; + } +#endif +#if (RTL8821C_SUPPORT == 1) + if (dm->support_ic_type & ODM_RTL8821C) { + check_rate_bitmap2 &= 0; + check_rate_bitmap1 &= 0x003ff000; + check_rate_bitmap0 &= 0x000fffff; + } +#endif + + if (rate_idx >= 64) + bitmap_result = BIT(rate_idx - 64) & check_rate_bitmap2; + else if (rate_idx >= 32) + bitmap_result = BIT(rate_idx - 32) & check_rate_bitmap1; + else if (rate_idx <= 31) + bitmap_result = BIT(rate_idx) & check_rate_bitmap0; + + if (bitmap_result != 0) + return true; + else + return false; +} + +enum rf_path +phydm_check_paths(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + enum rf_path max_path = RF_PATH_A; + + if (dm->num_rf_path == 1) + max_path = RF_PATH_A; + if (dm->num_rf_path == 2) + max_path = RF_PATH_B; + if (dm->num_rf_path == 3) + max_path = RF_PATH_C; + if (dm->num_rf_path == 4) + max_path = RF_PATH_D; + + return max_path; +} + +#ifndef PHYDM_COMMON_API_SUPPORT +u8 phydm_dtp_get_txagc(void *dm_void, enum rf_path path, u8 hw_rate) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 ret = 0xff; + +#if (RTL8192E_SUPPORT == 1) + ret = config_phydm_read_txagc_n(dm, path, hw_rate); +#endif + return ret; +} +#endif + +u8 phydm_search_min_power_index(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + enum rf_path path; + enum rf_path max_path; + u8 min_gain_index = 0x3f; + u8 gain_index; + u8 rate_idx; + + PHYDM_DBG(dm, DBG_DYN_TXPWR, "%s\n", __func__); + max_path = phydm_check_paths(dm); + for (path = 0; path <= max_path; path++) + for (rate_idx = 0; rate_idx < 84; rate_idx++) + if (phydm_check_rates(dm, rate_idx)) { +#ifdef PHYDM_COMMON_API_SUPPORT + /*This is for API support IC : 97F,8822B,92F,8821C*/ + gain_index = phydm_api_get_txagc(dm, path, rate_idx); #else - /* so 92c pci do not need dynamic tx power? vivi check it later */ - p_mgnt_info->bDynamicTxPowerEnable = false; + /*This is for API non-support IC : 92E */ + gain_index = phydm_dtp_get_txagc(dm, path, rate_idx); #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_odm->last_dtp_lvl = tx_high_pwr_level_normal; - p_dm_odm->dynamic_tx_high_power_lvl = tx_high_pwr_level_normal; - p_dm_odm->tx_agc_ofdm_18_6 = odm_get_bb_reg(p_dm_odm, 0xC24, MASKDWORD); /*TXAGC {18M 12M 9M 6M}*/ - -#endif - -} - -void -odm_dynamic_tx_power_save_power_index( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_WIN)) - 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_odm->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 -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_WIN)) - u8 index; - struct _ADAPTER *adapter = p_dm_odm->adapter; - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); - u32 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], p_hal_data->PowerIndex_backup[index]); - - -#endif -#endif -} - -void -odm_dynamic_tx_power_write_power_index( - void *p_dm_void, - u8 value) -{ - struct PHY_DM_STRUCT *p_dm_odm = (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_odm, 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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 val; - u8 rssi_tmp = p_dm_odm->rssi_min; - - if (!(p_dm_odm->support_ability & ODM_BB_DYNAMIC_TXPWR)) - return; - - if (rssi_tmp >= TX_POWER_NEAR_FIELD_THRESH_LVL2) { - p_dm_odm->dynamic_tx_high_power_lvl = tx_high_pwr_level_level2; - /**/ - } else if (rssi_tmp >= TX_POWER_NEAR_FIELD_THRESH_LVL1) { - p_dm_odm->dynamic_tx_high_power_lvl = tx_high_pwr_level_level1; - /**/ - } else if (rssi_tmp < (TX_POWER_NEAR_FIELD_THRESH_LVL1 - 5)) { - p_dm_odm->dynamic_tx_high_power_lvl = tx_high_pwr_level_normal; - /**/ - } - - if (p_dm_odm->last_dtp_lvl != p_dm_odm->dynamic_tx_high_power_lvl) { - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_TXPWR, ODM_DBG_LOUD, ("update_DTP_lv: ((%d)) -> ((%d))\n", p_dm_odm->last_dtp_lvl, p_dm_odm->dynamic_tx_high_power_lvl)); - - p_dm_odm->last_dtp_lvl = p_dm_odm->dynamic_tx_high_power_lvl; - - if (p_dm_odm->support_ic_type & (ODM_RTL8821)) { - - if (p_dm_odm->dynamic_tx_high_power_lvl == tx_high_pwr_level_level2) { - - odm_set_mac_reg(p_dm_odm, 0x6D8, BIT(20) | BIT19 | BIT18, 1); /* Resp TXAGC offset = -3dB*/ - - val = p_dm_odm->tx_agc_ofdm_18_6 & 0xff; - if (val >= 0x20) - val -= 0x16; - - odm_set_bb_reg(p_dm_odm, 0xC24, 0xff, val); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_TXPWR, ODM_DBG_LOUD, ("Set TX power: level 2\n")); - } else if (p_dm_odm->dynamic_tx_high_power_lvl == tx_high_pwr_level_level1) { - - odm_set_mac_reg(p_dm_odm, 0x6D8, BIT(20) | BIT19 | BIT18, 1); /* Resp TXAGC offset = -3dB*/ - - val = p_dm_odm->tx_agc_ofdm_18_6 & 0xff; - if (val >= 0x20) - val -= 0x10; - - odm_set_bb_reg(p_dm_odm, 0xC24, 0xff, val); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_TXPWR, ODM_DBG_LOUD, ("Set TX power: level 1\n")); - } else if (p_dm_odm->dynamic_tx_high_power_lvl == tx_high_pwr_level_normal) { - - odm_set_mac_reg(p_dm_odm, 0x6D8, BIT(20) | BIT19 | BIT18, 0); /* Resp TXAGC offset = 0dB*/ - odm_set_bb_reg(p_dm_odm, 0xC24, MASKDWORD, p_dm_odm->tx_agc_ofdm_18_6); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_TXPWR, ODM_DBG_LOUD, ("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_odm->adapter; - * struct rtl8192cd_priv* priv = p_dm_odm->priv; */ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - if (!(p_dm_odm->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_odm->support_platform) { - case ODM_WIN: - odm_dynamic_tx_power_nic(p_dm_odm); - break; - case ODM_CE: - odm_dynamic_tx_power_nic_ce(p_dm_odm); - break; - case ODM_AP: - odm_dynamic_tx_power_ap(p_dm_odm); - break; - default: - break; - } - - -} - - -void -odm_dynamic_tx_power_nic( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - - if (!(p_dm_odm->support_ability & ODM_BB_DYNAMIC_TXPWR)) - return; - -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - - if (p_dm_odm->support_ic_type == ODM_RTL8814A) - odm_dynamic_tx_power_8814a(p_dm_odm); - else if (p_dm_odm->support_ic_type & ODM_RTL8821) { - struct _ADAPTER *adapter = p_dm_odm->adapter; - PMGNT_INFO p_mgnt_info = GetDefaultMgntInfo(adapter); - - if (p_mgnt_info->RegRspPwr == 1) { - if (p_dm_odm->rssi_min > 60) - odm_set_mac_reg(p_dm_odm, ODM_REG_RESP_TX_11AC, BIT(20) | BIT19 | BIT18, 1); /*Resp TXAGC offset = -3dB*/ - else if (p_dm_odm->rssi_min < 55) - odm_set_mac_reg(p_dm_odm, ODM_REG_RESP_TX_11AC, BIT(20) | BIT19 | BIT18, 0); /*Resp TXAGC offset = 0dB*/ - } - } -#endif -} - -void -odm_dynamic_tx_power_ap( - void *p_dm_void - -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) - - /* #if ((RTL8192C_SUPPORT==1) || (RTL8192D_SUPPORT==1) || (RTL8188E_SUPPORT==1) || (RTL8812E_SUPPORT==1)) */ - - - struct rtl8192cd_priv *priv = p_dm_odm->priv; - s32 i; - s16 pwr_thd = 63; - - if (!priv->pshare->rf_ft_var.tx_pwr_ctrl) - return; - -#if ((RTL8812A_SUPPORT == 1) || (RTL8881A_SUPPORT == 1) || (RTL8814A_SUPPORT == 1)) - if (p_dm_odm->support_ic_type & (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 = ((p_dm_odm->false_alm_cnt.cnt_all > 1000) || ((p_dm_odm->false_alm_cnt.cnt_all > 300) && ((RTL_R8(0xc50) & 0x7f) >= 0x32))) ? 1 : 0; - - for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { - struct sta_info *pstat = p_dm_odm->p_odm_sta_info[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 && (p_dm_odm->rssi_min != 0xff)) { - if (p_dm_odm->rssi_min > pwr_thd) - RRSR_power_control_11n(priv, 1); - else if (p_dm_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 && (p_dm_odm->rssi_min != 0xff)) { - if (p_dm_odm->rssi_min > pwr_thd) - RRSR_power_control_14(priv, 1); - else if (p_dm_odm->rssi_min < (pwr_thd - 8)) - RRSR_power_control_14(priv, 0); - } else - RRSR_power_control_14(priv, 0); - } -#endif - - } - /* #endif */ - -#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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct sta_info *p_entry; - u8 reg0xc56_byte; - u8 txpwr_offset = 0; - - p_entry = p_dm_odm->p_odm_sta_info[mac_id]; - - reg0xc56_byte = odm_read_1byte(p_dm_odm, 0xc56); - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("reg0xc56_byte=%d\n", reg0xc56_byte)); - - if (p_entry[mac_id].rssi_stat.undecorated_smoothed_pwdb > 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); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("odm_dynamic_tx_power_8821: RSSI=%d, txpwr_offset=%d\n", p_entry[mac_id].rssi_stat.undecorated_smoothed_pwdb, txpwr_offset)); - - } else { - SET_TX_DESC_TX_POWER_OFFSET_8812(p_desc, txpwr_offset); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("odm_dynamic_tx_power_8821: RSSI=%d, txpwr_offset=%d\n", p_entry[mac_id].rssi_stat.undecorated_smoothed_pwdb, 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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTER *adapter = p_dm_odm->adapter; - PMGNT_INFO p_mgnt_info = &adapter->MgntInfo; - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); - s32 undecorated_smoothed_pwdb; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, - ("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)) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("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; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("AP Client PWDB = 0x%x\n", undecorated_smoothed_pwdb)); - } else { - undecorated_smoothed_pwdb = p_hal_data->UndecoratedSmoothedPWDB; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("STA Default Port PWDB = 0x%x\n", undecorated_smoothed_pwdb)); - } - } else {/*associated entry pwdb*/ - undecorated_smoothed_pwdb = p_hal_data->EntryMinUndecoratedSmoothedPWDB; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("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; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("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; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("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; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("tx_high_pwr_level_normal\n")); - } - } - - - if (p_hal_data->DynamicTxHighPowerLvl != p_hal_data->LastDTPLvl) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("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); - } - - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, - ("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 = ODM_RF_PATH_A; path <= ODM_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 (gain_index == 0xff) { + min_gain_index = 0x20; + PHYDM_DBG(dm, DBG_DYN_TXPWR, + "Error Gain idx!! Rewite to: ((%d))\n", min_gain_index); + break; } + PHYDM_DBG(dm, DBG_DYN_TXPWR, + "Support Rate: ((%d)) -> Gain idx: ((%d))\n", + rate_idx, gain_index); + if (gain_index < min_gain_index) + min_gain_index = gain_index; + } - 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; + return min_gain_index; +} - txagc_table_wd |= (path << 8) | MRateToHwRate(jaguar2_rates[i][j]) | (power_index << 24); +void phydm_dynamic_tx_power_init(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 i; + dm->last_dtp_lvl = tx_high_pwr_level_normal; + dm->dynamic_tx_high_power_lvl = tx_high_pwr_level_normal; + for (i = 0; i < 3; i++) { + dm->enhance_pwr_th[i] = 0xff; + } + dm->set_pwr_th[0] = TX_POWER_NEAR_FIELD_THRESH_LVL1; + dm->set_pwr_th[1] = TX_POWER_NEAR_FIELD_THRESH_LVL2; + dm->set_pwr_th[2] = 0xff; + dm->min_power_index = phydm_search_min_power_index(dm); + PHYDM_DBG(dm, DBG_DYN_TXPWR, "DTP init: Min Gain idx: ((%d))\n", + dm->min_power_index); + #ifdef BB_RAM_SUPPORT + phydm_2ndtype_dtp_init(dm); + #endif +} - PHY_SetTxPowerIndexShadow(adapter, (u8)power_index, (u8)path, jaguar2_rates[i][j]); +void phydm_noisy_enhance_hp_th(void *dm_void, u8 noisy_state) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + if (noisy_state == 0) { + dm->enhance_pwr_th[0] = dm->set_pwr_th[0]; + dm->enhance_pwr_th[1] = dm->set_pwr_th[1]; + dm->enhance_pwr_th[2] = dm->set_pwr_th[2]; + } else { + dm->enhance_pwr_th[0] = dm->set_pwr_th[0] + 8; + dm->enhance_pwr_th[1] = dm->set_pwr_th[1] + 5; + dm->enhance_pwr_th[2] = dm->set_pwr_th[2]; + } + PHYDM_DBG(dm, DBG_DYN_TXPWR, + "DTP hp_th: Lv1_th =%d ,Lv2_th = %d ,Lv3_th = %d\n", + dm->enhance_pwr_th[0], dm->enhance_pwr_th[1], + dm->enhance_pwr_th[2]); +} - value[k++] = txagc_table_wd; +u8 phydm_pwr_lvl_check(void *dm_void, u8 input_rssi) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 th0,th1,th2; + th2 = dm->enhance_pwr_th[2]; + th1 = dm->enhance_pwr_th[1]; + th0 = dm->enhance_pwr_th[0]; + if (input_rssi >= th2) + return tx_high_pwr_level_level3; + else if (input_rssi < (th2 - 3) && input_rssi >= th1) + return tx_high_pwr_level_level2; + else if (input_rssi < (th1 - 3) && input_rssi >= th0) + return tx_high_pwr_level_level1; + else if (input_rssi < (th0 - 3)) + return tx_high_pwr_level_normal; + else + return tx_high_pwr_level_unchange; +} + +u8 phydm_pwr_lv_mapping(u8 tx_pwr_lv) +{ + if (tx_pwr_lv == tx_high_pwr_level_level3) + return PHYDM_OFFSET_MINUS_11DB; + else if (tx_pwr_lv == tx_high_pwr_level_level2) + return PHYDM_OFFSET_MINUS_7DB; + else if (tx_pwr_lv == tx_high_pwr_level_level1) + return PHYDM_OFFSET_MINUS_3DB; + else + return PHYDM_OFFSET_ZERO; +} + +void phydm_dynamic_response_power(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 rpwr; + +#if CONFIG_PHY_CTRL_PWR + return; +#endif + if (!(dm->support_ability & ODM_BB_DYNAMIC_TXPWR)) + return; + if (dm->dynamic_tx_high_power_lvl == tx_high_pwr_level_unchange) { + dm->dynamic_tx_high_power_lvl = dm->last_dtp_lvl; + PHYDM_DBG(dm, DBG_DYN_TXPWR, "RespPwr not change\n"); + return; + } + PHYDM_DBG(dm, DBG_DYN_TXPWR, + "RespPwr update_DTP_lv: ((%d)) -> ((%d))\n", dm->last_dtp_lvl, + dm->dynamic_tx_high_power_lvl); + dm->last_dtp_lvl = dm->dynamic_tx_high_power_lvl; + rpwr = phydm_pwr_lv_mapping(dm->dynamic_tx_high_power_lvl); + odm_set_mac_reg(dm, ODM_REG_RESP_TX_11AC, BIT(20) | BIT(19) | BIT(18), rpwr); + PHYDM_DBG(dm, DBG_DYN_TXPWR, "RespPwr Set TxPwr: Lv (%d)\n", + dm->dynamic_tx_high_power_lvl); +} + +void phydm_dtp_fill_cmninfo(void *dm_void, u8 macid, u8 dtp_lvl) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct dtp_info *dtp = NULL; + dtp = &dm->phydm_sta_info[macid]->dtp_stat; + if (!(dm->support_ability & ODM_BB_DYNAMIC_TXPWR)) + return; + dtp->dyn_tx_power = phydm_pwr_lv_mapping(dtp_lvl); + PHYDM_DBG(dm, DBG_DYN_TXPWR, + "Fill cmninfo TxPwr: macid=(%d), PwrLv (%d)\n", macid, + dtp->dyn_tx_power); +} + +void phydm_dtp_per_sta(void *dm_void, u8 macid) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct cmn_sta_info *sta = dm->phydm_sta_info[macid]; + struct dtp_info *dtp = NULL; + struct rssi_info *rssi = NULL; + if (is_sta_active(sta)) { + dtp = &sta->dtp_stat; + rssi = &sta->rssi_stat; + dtp->sta_tx_high_power_lvl = phydm_pwr_lvl_check(dm, rssi->rssi); + PHYDM_DBG(dm, DBG_DYN_TXPWR, + "STA=%d , RSSI: %d , GetPwrLv: %d\n", macid, + rssi->rssi, dtp->sta_tx_high_power_lvl); + if (dtp->sta_tx_high_power_lvl == tx_high_pwr_level_unchange + || dtp->sta_tx_high_power_lvl == dtp->sta_last_dtp_lvl) { + dtp->sta_tx_high_power_lvl = dtp->sta_last_dtp_lvl; + PHYDM_DBG(dm, DBG_DYN_TXPWR, + "DTP_lv not change: ((%d))\n", + dtp->sta_tx_high_power_lvl); + return; + } + + PHYDM_DBG(dm, DBG_DYN_TXPWR, + "DTP_lv update: ((%d)) -> ((%d))\n", dm->last_dtp_lvl, + dm->dynamic_tx_high_power_lvl); + dtp->sta_last_dtp_lvl = dtp->sta_tx_high_power_lvl; +#ifdef BB_RAM_SUPPORT + phydm_dtp_fill_cmninfo_2ndtype(dm, macid, dtp->sta_tx_high_power_lvl); +#else + phydm_dtp_fill_cmninfo(dm, macid, dtp->sta_tx_high_power_lvl); +#endif + } +} + + +void odm_set_dyntxpwr(void *dm_void, u8 *desc, u8 macid) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct dtp_info *dtp = NULL; + dtp = &dm->phydm_sta_info[macid]->dtp_stat; + if (!(dm->support_ability & ODM_BB_DYNAMIC_TXPWR)) + return; + if (dm->fill_desc_dyntxpwr) + dm->fill_desc_dyntxpwr(dm, desc, dtp->dyn_tx_power); + else + PHYDM_DBG(dm, DBG_DYN_TXPWR, + "%s: fill_desc_dyntxpwr is null!\n", __func__); + if (dtp->last_tx_power != dtp->dyn_tx_power) { + PHYDM_DBG(dm, DBG_DYN_TXPWR, + "%s: last_offset=%d, txpwr_offset=%d\n", __func__, + dtp->last_tx_power, dtp->dyn_tx_power); + dtp->last_tx_power = dtp->dyn_tx_power; + } +} + +void phydm_dtp_debug(void *dm_void, char input[][16], u32 *_used, char *output, + u32 *_out_len) +{ + u32 used = *_used; + u32 out_len = *_out_len; + + struct dm_struct *dm = (struct dm_struct *)dm_void; + char help[] = "-h"; + u32 var1[3] = {0}; + u8 set_pwr_th1, set_pwr_th2, set_pwr_th3; + u8 i; + + if ((strcmp(input[1], help) == 0)) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "Set DTP threhosld: {1} {TH[0]} {TH[1]} {TH[2]}\n"); + } else { + for (i = 0; i < 3; i++) { + if (input[i + 1]) + PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); + } + if (var1[0] == 1) { + for (i = 0; i < 3; i++) + if (var1[i] == 0 || var1[i] > 100) + dm->set_pwr_th[i] = 0xff; + else + dm->set_pwr_th[i] = (u8)var1[1 + i]; + + PDM_SNPF(out_len, used, output + used, out_len - used, + "DTP_TH[0:2] = {%d, %d, %d}\n", + dm->set_pwr_th[0], dm->set_pwr_th[1], + dm->set_pwr_th[2]); + } + } + *_used = used; + *_out_len = out_len; +} + + +void phydm_dynamic_tx_power(void *dm_void) +{ + + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct cmn_sta_info *sta = NULL; + u8 i; + u8 cnt = 0; + u8 rssi_min = dm->rssi_min; + u8 rssi_tmp = 0; + + if (!(dm->support_ability & ODM_BB_DYNAMIC_TXPWR)) + return; + + PHYDM_DBG(dm, DBG_DYN_TXPWR, + "[%s] RSSI_min = %d, Noisy_dec = %d\n", __func__, rssi_min, + dm->noisy_decision); + phydm_noisy_enhance_hp_th(dm, dm->noisy_decision); + /* Response Power */ + dm->dynamic_tx_high_power_lvl = phydm_pwr_lvl_check(dm, rssi_min); + phydm_dynamic_response_power(dm); + /* Per STA Tx power */ + for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { + phydm_dtp_per_sta(dm, i); + cnt++; + if (cnt >= dm->number_linked_client) + break; + } +} +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + +void phydm_dynamic_tx_power_init_win(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + void *adapter = dm->adapter; + PMGNT_INFO mgnt_info = &((PADAPTER)adapter)->MgntInfo; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA((PADAPTER)adapter); + + mgnt_info->bDynamicTxPowerEnable = false; + + #if DEV_BUS_TYPE == RT_USB_INTERFACE + if (RT_GetInterfaceSelection((PADAPTER)adapter) == + INTF_SEL1_USB_High_Power) { + mgnt_info->bDynamicTxPowerEnable = true; + } + #endif + + hal_data->LastDTPLvl = tx_high_pwr_level_normal; + hal_data->DynamicTxHighPowerLvl = tx_high_pwr_level_normal; + + PHYDM_DBG(dm, DBG_DYN_TXPWR, "[%s] DTP=%d\n", __func__, + mgnt_info->bDynamicTxPowerEnable); +} + +void phydm_dynamic_tx_power_win(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (!(dm->support_ability & ODM_BB_DYNAMIC_TXPWR)) + return; + + #if (RTL8814A_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8814A) + odm_dynamic_tx_power_8814a(dm); + #endif + + #if (RTL8821A_SUPPORT == 1) + if (dm->support_ic_type & ODM_RTL8821) { + void *adapter = dm->adapter; + PMGNT_INFO mgnt_info = GetDefaultMgntInfo((PADAPTER)adapter); + + if (mgnt_info->RegRspPwr == 1) { + if (dm->rssi_min > 60) { + /*Resp TXAGC offset = -3dB*/ + odm_set_mac_reg(dm, 0x6d8, 0x1C0000, 1); + } else if (dm->rssi_min < 55) { + /*Resp TXAGC offset = 0dB*/ + odm_set_mac_reg(dm, 0x6d8, 0x1C0000, 0); } } } - - if (adapter->MgntInfo.bScanInProgress == false && adapter->MgntInfo.RegFWOffload == 2) - HalDownloadTxPowerLevel8814(adapter, value); -#endif + #endif } -#endif +#endif /*@#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ +#endif /* @#ifdef CONFIG_DYNAMIC_TX_TWR */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dynamictxpower.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dynamictxpower.h index badae89d56cc..5a3842bf334c 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dynamictxpower.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_dynamictxpower.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,103 +9,103 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ -#ifndef __PHYDMDYNAMICTXPOWER_H__ -#define __PHYDMDYNAMICTXPOWER_H__ +#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*/ +#ifdef CONFIG_DYNAMIC_TX_TWR +/* @============================================================ + * Definition + * ============================================================ + */ + +/*@#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 +#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 +#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 +#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_normal 0 +#define tx_high_pwr_level_level1 1 +#define tx_high_pwr_level_level2 2 +#define tx_high_pwr_level_level3 3 +#define tx_high_pwr_level_unchange 4 -#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 +/* @============================================================ + * enumrate + * ============================================================ + */ +enum phydm_dtp_power_offset { + PHYDM_OFFSET_ZERO = 0, + PHYDM_OFFSET_MINUS_3DB = 1, + PHYDM_OFFSET_MINUS_7DB = 2, + PHYDM_OFFSET_MINUS_11DB = 3, + PHYDM_OFFSET_ADD_3DB = 4, + PHYDM_OFFSET_ADD_6DB = 5 +}; -void -odm_dynamic_tx_power_init( - void *p_dm_void -); +enum phydm_dtp_power_offset_2ndtype { + PHYDM_2ND_OFFSET_ZERO = 0, + PHYDM_2ND_OFFSET_MINUS_3DB = 2, + PHYDM_2ND_OFFSET_MINUS_7DB = 3, + PHYDM_2ND_OFFSET_MINUS_11DB = 1 +}; -void -odm_dynamic_tx_power_restore_power_index( - void *p_dm_void -); +enum phydm_dtp_power_offset_bbram { + /*@ HW min use 0.25*/ + PHYDM_BBRAM_OFFSET_ZERO = 0, + PHYDM_BBRAM_OFFSET_MINUS_3DB = -3, + PHYDM_BBRAM_OFFSET_MINUS_7DB = -7, + PHYDM_BBRAM_OFFSET_MINUS_11DB = -11 +}; -void -odm_dynamic_tx_power_nic( - void *p_dm_void -); +/* @============================================================ + * structure + * ============================================================ + */ -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -void -odm_dynamic_tx_power_save_power_index( - void *p_dm_void -); +/* @============================================================ + * Function Prototype + * ============================================================ + */ -void -odm_dynamic_tx_power_write_power_index( - void *p_dm_void, - u8 value); +extern void +odm_set_dyntxpwr(void *dm_void, u8 *desc, u8 mac_id); + +void phydm_dynamic_tx_power(void *dm_void); + +void phydm_dynamic_tx_power_init(void *dm_void); + +void phydm_dtp_debug(void *dm_void, char input[][16], u32 *_used, char *output, + u32 *_out_len); -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 +void odm_dynamic_tx_power_win(void *dm_void); #endif -void -odm_dynamic_tx_power( - void *p_dm_void -); - -void -odm_dynamic_tx_power_ap( - void *p_dm_void -); - +#endif #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_edcaturbocheck.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_edcaturbocheck.c deleted file mode 100644 index ef458bf52251..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_edcaturbocheck.c +++ /dev/null @@ -1,698 +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 PHYDM_SUPPORT_EDCA - -void -odm_edca_turbo_init( - void *p_dm_void) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _ADAPTER *adapter = NULL; - HAL_DATA_TYPE *p_hal_data = NULL; - - if (p_dm_odm->adapter == NULL) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_EDCA_TURBO, ODM_DBG_LOUD, ("EdcaTurboInit fail!!!\n")); - return; - } - - adapter = p_dm_odm->adapter; - p_hal_data = GET_HAL_DATA(adapter); - - p_dm_odm->dm_edca_table.is_current_turbo_edca = false; - p_dm_odm->dm_edca_table.is_cur_rdl_state = false; - p_hal_data->is_any_non_be_pkts = false; - -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - struct _ADAPTER *adapter = p_dm_odm->adapter; - p_dm_odm->dm_edca_table.is_current_turbo_edca = false; - p_dm_odm->dm_edca_table.is_cur_rdl_state = false; - adapter->recvpriv.is_any_non_be_pkts = false; - -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_EDCA_TURBO, ODM_DBG_LOUD, ("Orginial VO PARAM: 0x%x\n", odm_read_4byte(p_dm_odm, ODM_EDCA_VO_PARAM))); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_EDCA_TURBO, ODM_DBG_LOUD, ("Orginial VI PARAM: 0x%x\n", odm_read_4byte(p_dm_odm, ODM_EDCA_VI_PARAM))); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_EDCA_TURBO, ODM_DBG_LOUD, ("Orginial BE PARAM: 0x%x\n", odm_read_4byte(p_dm_odm, ODM_EDCA_BE_PARAM))); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_EDCA_TURBO, ODM_DBG_LOUD, ("Orginial BK PARAM: 0x%x\n", odm_read_4byte(p_dm_odm, ODM_EDCA_BK_PARAM))); - - -} /* ODM_InitEdcaTurbo */ - -void -odm_edca_turbo_check( - void *p_dm_void -) -{ - /* */ - /* For AP/ADSL use struct rtl8192cd_priv* */ - /* For CE/NIC use struct _ADAPTER* */ - /* */ - - /* */ - /* 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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_EDCA_TURBO, ODM_DBG_LOUD, ("odm_edca_turbo_check========================>\n")); - - if (!(p_dm_odm->support_ability & ODM_MAC_EDCA_TURBO)) - return; - - switch (p_dm_odm->support_platform) { - case ODM_WIN: - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - odm_edca_turbo_check_mp(p_dm_odm); -#endif - break; - - case ODM_CE: -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - odm_edca_turbo_check_ce(p_dm_odm); -#endif - break; - } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_EDCA_TURBO, ODM_DBG_LOUD, ("<========================odm_edca_turbo_check\n")); - -} /* odm_CheckEdcaTurbo */ - -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - - -void -odm_edca_turbo_check_ce( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTER *adapter = p_dm_odm->adapter; - u32 EDCA_BE_UL = 0x5ea42b;/* Parameter suggested by Scott */ /* edca_setting_UL[p_mgnt_info->iot_peer]; */ - u32 EDCA_BE_DL = 0x00a42b;/* Parameter suggested by Scott */ /* edca_setting_DL[p_mgnt_info->iot_peer]; */ - u32 ic_type = p_dm_odm->support_ic_type; - u32 iot_peer = 0; - u8 wireless_mode = 0xFF; /* invalid value */ - u32 traffic_index; - u32 edca_param; - u64 cur_tx_bytes = 0; - u64 cur_rx_bytes = 0; - u8 bbtchange = _TRUE; - u8 is_bias_on_rx = _FALSE; - HAL_DATA_TYPE *p_hal_data = 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 (p_dm_odm->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; - } - - if (p_dm_odm->p_wireless_mode != NULL) - wireless_mode = *(p_dm_odm->p_wireless_mode); - - iot_peer = pmlmeinfo->assoc_AP_vendor; - - if (iot_peer >= HT_IOT_PEER_MAX) { - precvpriv->is_any_non_be_pkts = _FALSE; - return; - } - - if (p_dm_odm->support_ic_type & ODM_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 = pdvobjpriv->traffic_stat.cur_tx_bytes; - cur_rx_bytes = pdvobjpriv->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 ((p_dm_odm->dm_edca_table.prv_traffic_idx != traffic_index) || (!p_dm_odm->dm_edca_table.is_current_turbo_edca)) */ - { - if (p_dm_odm->support_interface == ODM_ITRF_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 brunch v2445 20120215 */ - 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 == ODM_RTL8812) || (ic_type == ODM_RTL8821) || (ic_type == ODM_RTL8192E)) { /* add 8812AU/8812AE */ - EDCA_BE_UL = 0x5ea42b; - EDCA_BE_DL = 0x5ea42b; - - ODM_RT_TRACE(p_dm_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 (traffic_index == DOWN_LINK) - edca_param = EDCA_BE_DL; - else - edca_param = EDCA_BE_UL; - - rtw_write32(adapter, REG_EDCA_BE_PARAM, edca_param); - - p_dm_odm->dm_edca_table.prv_traffic_idx = traffic_index; - } - - p_dm_odm->dm_edca_table.is_current_turbo_edca = _TRUE; - } else { - /* */ - /* Turn Off EDCA turbo here. */ - /* Restore original EDCA according to the declaration of AP. */ - /* */ - if (p_dm_odm->dm_edca_table.is_current_turbo_edca) { - rtw_write32(adapter, REG_EDCA_BE_PARAM, p_hal_data->ac_param_be); - p_dm_odm->dm_edca_table.is_current_turbo_edca = _FALSE; - } - } - -} - - -#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) -void -odm_edca_turbo_check_mp( - void *p_dm_void -) -{ - - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTER *adapter = p_dm_odm->adapter; - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); - - struct _ADAPTER *p_default_adapter = get_default_adapter(adapter); - struct _ADAPTER *p_ext_adapter = get_first_ext_adapter(adapter); /* NULL; */ - PMGNT_INFO p_mgnt_info = &adapter->MgntInfo; - PSTA_QOS p_sta_qos = adapter->MgntInfo.p_sta_qos; - /* [Win7 count Tx/Rx statistic for Extension Port] odm_CheckEdcaTurbo's adapter is always Default. 2009.08.20, by Bohn */ - u64 ext_cur_tx_ok_cnt = 0; - u64 ext_cur_rx_ok_cnt = 0; - /* For future Win7 Enable Default Port to modify AMPDU size dynamically, 2009.08.20, Bohn. */ - u8 two_port_status = (u8)TWO_PORT_STATUS__WITHOUT_ANY_ASSOCIATE; - - /* Keep past Tx/Rx packet count for RT-to-RT EDCA turbo. */ - u64 cur_tx_ok_cnt = 0; - u64 cur_rx_ok_cnt = 0; - u32 EDCA_BE_UL = 0x5ea42b;/* Parameter suggested by Scott */ /* edca_setting_UL[p_mgnt_info->iot_peer]; */ - u32 EDCA_BE_DL = 0x5ea42b;/* Parameter suggested by Scott */ /* edca_setting_DL[p_mgnt_info->iot_peer]; */ - u32 EDCA_BE = 0x5ea42b; - u8 iot_peer = 0; - bool *p_is_cur_rdl_state = NULL; - bool is_last_is_cur_rdl_state = false; - bool is_bias_on_rx = false; - bool is_edca_turbo_on = false; - u8 tx_rate = 0xFF; - u64 value64; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_EDCA_TURBO, ODM_DBG_LOUD, ("odm_edca_turbo_check_mp========================>")); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_EDCA_TURBO, ODM_DBG_LOUD, ("Orginial BE PARAM: 0x%x\n", odm_read_4byte(p_dm_odm, ODM_EDCA_BE_PARAM))); - - /* ******************************* - * list paramter for different platform - * ******************************* */ - is_last_is_cur_rdl_state = p_dm_odm->dm_edca_table.is_cur_rdl_state; - p_is_cur_rdl_state = &(p_dm_odm->dm_edca_table.is_cur_rdl_state); - - /* 2012/09/14 MH Add */ - if (p_mgnt_info->num_non_be_pkt > p_mgnt_info->reg_edca_thresh && !(adapter->MgntInfo.wifi_confg & RT_WIFI_LOGO)) - p_hal_data->is_any_non_be_pkts = true; - - p_mgnt_info->num_non_be_pkt = 0; - - /* Caculate TX/RX TP: */ - cur_tx_ok_cnt = p_dm_odm->cur_tx_ok_cnt; - cur_rx_ok_cnt = p_dm_odm->cur_rx_ok_cnt; - - - if (p_ext_adapter == NULL) - p_ext_adapter = p_default_adapter; - - ext_cur_tx_ok_cnt = p_ext_adapter->tx_stats.num_tx_bytes_unicast - p_mgnt_info->ext_last_tx_ok_cnt; - ext_cur_rx_ok_cnt = p_ext_adapter->rx_stats.num_rx_bytes_unicast - p_mgnt_info->ext_last_rx_ok_cnt; - get_two_port_shared_resource(adapter, TWO_PORT_SHARED_OBJECT__STATUS, NULL, &two_port_status); - /* For future Win7 Enable Default Port to modify AMPDU size dynamically, 2009.08.20, Bohn. */ - if (two_port_status == TWO_PORT_STATUS__EXTENSION_ONLY) { - cur_tx_ok_cnt = ext_cur_tx_ok_cnt ; - cur_rx_ok_cnt = ext_cur_rx_ok_cnt ; - } - /* */ - iot_peer = p_mgnt_info->iot_peer; - is_bias_on_rx = (p_mgnt_info->iot_action & HT_IOT_ACT_EDCA_BIAS_ON_RX) ? true : false; - is_edca_turbo_on = ((!p_hal_data->is_any_non_be_pkts)) ? true : false; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_EDCA_TURBO, ODM_DBG_LOUD, ("is_any_non_be_pkts : 0x%lx\n", p_hal_data->is_any_non_be_pkts)); - - - /* ******************************* - * check if edca turbo is disabled - * ******************************* */ - if (odm_is_edca_turbo_disable(p_dm_odm)) { - p_hal_data->is_any_non_be_pkts = false; - p_mgnt_info->last_tx_ok_cnt = adapter->tx_stats.num_tx_bytes_unicast; - p_mgnt_info->last_rx_ok_cnt = adapter->rx_stats.num_rx_bytes_unicast; - p_mgnt_info->ext_last_tx_ok_cnt = p_ext_adapter->tx_stats.num_tx_bytes_unicast; - p_mgnt_info->ext_last_rx_ok_cnt = p_ext_adapter->rx_stats.num_rx_bytes_unicast; - - } - - /* ******************************* - * remove iot case out - * ******************************* */ - odm_edca_para_sel_by_iot(p_dm_odm, &EDCA_BE_UL, &EDCA_BE_DL); - - - /* ******************************* - * Check if the status needs to be changed. - * ******************************* */ - if (is_edca_turbo_on) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_EDCA_TURBO, ODM_DBG_LOUD, ("is_edca_turbo_on : 0x%x is_bias_on_rx : 0x%x\n", is_edca_turbo_on, is_bias_on_rx)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_EDCA_TURBO, ODM_DBG_LOUD, ("cur_tx_ok_cnt : 0x%lx\n", cur_tx_ok_cnt)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_EDCA_TURBO, ODM_DBG_LOUD, ("cur_rx_ok_cnt : 0x%lx\n", cur_rx_ok_cnt)); - if (is_bias_on_rx) - odm_edca_choose_traffic_idx(p_dm_odm, cur_tx_ok_cnt, cur_rx_ok_cnt, true, p_is_cur_rdl_state); - else - odm_edca_choose_traffic_idx(p_dm_odm, cur_tx_ok_cnt, cur_rx_ok_cnt, false, p_is_cur_rdl_state); - - /* 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 = ((*p_is_cur_rdl_state) == true) ? EDCA_BE_DL : EDCA_BE_UL; - - /*For TPLINK 8188EU test*/ - if ((IS_HARDWARE_TYPE_8188EU(adapter)) && (p_hal_data->UndecoratedSmoothedPWDB < 28)) { /* Set to origimal EDCA 0x5EA42B now need to update.*/ - - } else { /*Use TPLINK preferred EDCA parameters.*/ - EDCA_BE = p_mgnt_info->EDCABEPara; - } - - if (IS_HARDWARE_TYPE_8821U(adapter)) { - if (p_mgnt_info->reg_tx_duty_enable) { - /* 2013.01.23 LukeLee: debug for 8811AU thermal issue (reduce Tx duty cycle) */ - if (!p_mgnt_info->forced_data_rate) { /* auto rate */ - if (p_dm_odm->tx_rate != 0xFF) - tx_rate = adapter->HalFunc.GetHwRateFromMRateHandler(p_dm_odm->tx_rate); - } else /* force rate */ - tx_rate = (u8) p_mgnt_info->forced_data_rate; - - value64 = (cur_rx_ok_cnt << 2); - if (cur_tx_ok_cnt < value64) /* Downlink */ - odm_write_4byte(p_dm_odm, ODM_EDCA_BE_PARAM, EDCA_BE); - else { /* Uplink */ - /*dbg_print("p_rf_calibrate_info->thermal_value = 0x%X\n", p_rf_calibrate_info->thermal_value);*/ - /*if(p_rf_calibrate_info->thermal_value < p_hal_data->eeprom_thermal_meter)*/ - if ((p_dm_odm->rf_calibrate_info.thermal_value < 0x2c) || (*p_dm_odm->p_band_type == BAND_ON_2_4G)) - odm_write_4byte(p_dm_odm, ODM_EDCA_BE_PARAM, EDCA_BE); - else { - switch (tx_rate) { - case MGN_VHT1SS_MCS6: - case MGN_VHT1SS_MCS5: - case MGN_MCS6: - case MGN_MCS5: - case MGN_48M: - case MGN_54M: - odm_write_4byte(p_dm_odm, ODM_EDCA_BE_PARAM, 0x1ea42b); - break; - case MGN_VHT1SS_MCS4: - case MGN_MCS4: - case MGN_36M: - odm_write_4byte(p_dm_odm, ODM_EDCA_BE_PARAM, 0xa42b); - break; - case MGN_VHT1SS_MCS3: - case MGN_MCS3: - case MGN_24M: - odm_write_4byte(p_dm_odm, ODM_EDCA_BE_PARAM, 0xa47f); - break; - case MGN_VHT1SS_MCS2: - case MGN_MCS2: - case MGN_18M: - odm_write_4byte(p_dm_odm, ODM_EDCA_BE_PARAM, 0xa57f); - break; - case MGN_VHT1SS_MCS1: - case MGN_MCS1: - case MGN_9M: - case MGN_12M: - odm_write_4byte(p_dm_odm, ODM_EDCA_BE_PARAM, 0xa77f); - break; - case MGN_VHT1SS_MCS0: - case MGN_MCS0: - case MGN_6M: - odm_write_4byte(p_dm_odm, ODM_EDCA_BE_PARAM, 0xa87f); - break; - default: - odm_write_4byte(p_dm_odm, ODM_EDCA_BE_PARAM, EDCA_BE); - break; - } - } - } - } else - odm_write_4byte(p_dm_odm, ODM_EDCA_BE_PARAM, EDCA_BE); - - } else if (IS_HARDWARE_TYPE_8812AU(adapter)) { - if (p_mgnt_info->reg_tx_duty_enable) { - /* 2013.07.26 Wilson: debug for 8812AU thermal issue (reduce Tx duty cycle) */ - /* it;s the same issue as 8811AU */ - if (!p_mgnt_info->forced_data_rate) { /* auto rate */ - if (p_dm_odm->tx_rate != 0xFF) - tx_rate = adapter->HalFunc.GetHwRateFromMRateHandler(p_dm_odm->tx_rate); - } else /* force rate */ - tx_rate = (u8) p_mgnt_info->forced_data_rate; - - value64 = (cur_rx_ok_cnt << 2); - if (cur_tx_ok_cnt < value64) /* Downlink */ - odm_write_4byte(p_dm_odm, ODM_EDCA_BE_PARAM, EDCA_BE); - else { /* Uplink */ - /*dbg_print("p_rf_calibrate_info->thermal_value = 0x%X\n", p_rf_calibrate_info->thermal_value);*/ - /*if(p_rf_calibrate_info->thermal_value < p_hal_data->eeprom_thermal_meter)*/ - if ((p_dm_odm->rf_calibrate_info.thermal_value < 0x2c) || (*p_dm_odm->p_band_type == BAND_ON_2_4G)) - odm_write_4byte(p_dm_odm, ODM_EDCA_BE_PARAM, EDCA_BE); - else { - switch (tx_rate) { - case MGN_VHT2SS_MCS9: - case MGN_VHT1SS_MCS9: - case MGN_VHT1SS_MCS8: - case MGN_MCS15: - case MGN_MCS7: - odm_write_4byte(p_dm_odm, ODM_EDCA_BE_PARAM, 0x1ea44f); - case MGN_VHT2SS_MCS8: - case MGN_VHT1SS_MCS7: - case MGN_MCS14: - case MGN_MCS6: - case MGN_54M: - odm_write_4byte(p_dm_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_write_4byte(p_dm_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_write_4byte(p_dm_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_write_4byte(p_dm_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_write_4byte(p_dm_odm, ODM_EDCA_BE_PARAM, 0xa87f); - break; - default: - odm_write_4byte(p_dm_odm, ODM_EDCA_BE_PARAM, EDCA_BE); - break; - } - } - } - } else - odm_write_4byte(p_dm_odm, ODM_EDCA_BE_PARAM, EDCA_BE); - } else - odm_write_4byte(p_dm_odm, ODM_EDCA_BE_PARAM, EDCA_BE); - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_EDCA_TURBO, ODM_DBG_LOUD, ("EDCA Turbo on: EDCA_BE:0x%lx\n", EDCA_BE)); - - p_dm_odm->dm_edca_table.is_current_turbo_edca = true; - - ODM_RT_TRACE(p_dm_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 (p_dm_odm->dm_edca_table.is_current_turbo_edca) { - phydm_set_hw_reg_handler_interface(p_dm_odm, HW_VAR_AC_PARAM, GET_WMM_PARAM_ELE_SINGLE_AC_PARAM(p_sta_qos->wmm_param_ele, AC0_BE)); - - p_dm_odm->dm_edca_table.is_current_turbo_edca = false; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_EDCA_TURBO, ODM_DBG_LOUD, ("Restore EDCA BE: 0x%lx\n", p_dm_odm->WMMEDCA_BE)); - - } - } - -} - - -/* check if edca turbo is disabled */ -bool -odm_is_edca_turbo_disable( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTER *adapter = p_dm_odm->adapter; - PMGNT_INFO p_mgnt_info = &adapter->MgntInfo; - u32 iot_peer = p_mgnt_info->iot_peer; - - if (p_dm_odm->is_bt_disable_edca_turbo) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_EDCA_TURBO, ODM_DBG_LOUD, ("EdcaTurboDisable for BT!!\n")); - return true; - } - - if ((!(p_dm_odm->support_ability & ODM_MAC_EDCA_TURBO)) || - (p_dm_odm->wifi_test & RT_WIFI_LOGO) || - (iot_peer >= HT_IOT_PEER_MAX)) { - ODM_RT_TRACE(p_dm_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 (p_mgnt_info->iot_action & HT_IOT_ACT_DISABLE_EDCA_TURBO) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_EDCA_TURBO, ODM_DBG_LOUD, ("iot_action:EdcaTurboDisable\n")); - return true; - } - - return false; - - -} - -/* add iot case here: for MP/CE */ -void -odm_edca_para_sel_by_iot( - void *p_dm_void, - u32 *EDCA_BE_UL, - u32 *EDCA_BE_DL -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTER *adapter = p_dm_odm->adapter; - u32 iot_peer = 0; - u32 ic_type = p_dm_odm->support_ic_type; - u8 wireless_mode = 0xFF; /* invalid value */ - u32 iot_peer_sub_type = 0; - - PMGNT_INFO p_mgnt_info = &adapter->MgntInfo; - u8 two_port_status = (u8)TWO_PORT_STATUS__WITHOUT_ANY_ASSOCIATE; - - if (p_dm_odm->p_wireless_mode != NULL) - wireless_mode = *(p_dm_odm->p_wireless_mode); - - /* ========================================================= */ - /* list paramter for different platform */ - - iot_peer = p_mgnt_info->iot_peer; - iot_peer_sub_type = p_mgnt_info->iot_peer_subtype; - get_two_port_shared_resource(adapter, TWO_PORT_SHARED_OBJECT__STATUS, NULL, &two_port_status); - - /* **************************** - * / IOT case for MP - * **************************** */ - if (p_dm_odm->support_interface == ODM_ITRF_PCIE) { - (*EDCA_BE_UL) = 0x6ea42b; - (*EDCA_BE_DL) = 0x6ea42b; - } - - if (two_port_status == TWO_PORT_STATUS__EXTENSION_ONLY) { - (*EDCA_BE_UL) = 0x5ea42b;/* Parameter suggested by Scott */ /* edca_setting_UL[ExtAdapter->mgnt_info.iot_peer]; */ - (*EDCA_BE_DL) = 0x5ea42b;/* Parameter suggested by Scott */ /* edca_setting_DL[ExtAdapter->mgnt_info.iot_peer]; */ - } - -#if (INTEL_PROXIMITY_SUPPORT == 1) - if (p_mgnt_info->intel_class_mode_info.is_enable_ca == true) - (*EDCA_BE_UL) = (*EDCA_BE_DL) = 0xa44f; - else -#endif - { - if ((p_mgnt_info->iot_action & (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 ((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 brunch v2445 20120215 */ - 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 && iot_peer_sub_type != HT_IOT_PEER_TPLINK_AC1750) { - /* Set DL EDCA for Atheros peer to 0x3ea42b. Suggested by SD3 Wilson for ASUS TP issue. */ - if (wireless_mode == ODM_WM_G) - (*EDCA_BE_DL) = edca_setting_dl_g_mode[iot_peer]; - else - (*EDCA_BE_DL) = edca_setting_DL[iot_peer]; - - if (ic_type == ODM_RTL8821) - (*EDCA_BE_DL) = 0x5ea630; - - } - } - - if ((ic_type == ODM_RTL8812) || (ic_type == ODM_RTL8192E)) { /* add 8812AU/8812AE */ - (*EDCA_BE_UL) = 0x5ea42b; - (*EDCA_BE_DL) = 0x5ea42b; - - ODM_RT_TRACE(p_dm_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 ((ic_type == ODM_RTL8814A) && (iot_peer == HT_IOT_PEER_REALTEK)) { /*8814AU and 8814AR*/ - (*EDCA_BE_UL) = 0x5ea42b; - (*EDCA_BE_DL) = 0xa42b; - - ODM_RT_TRACE(p_dm_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(p_dm_odm, ODM_COMP_EDCA_TURBO, ODM_DBG_LOUD, ("Special: EDCA_BE_UL=0x%lx EDCA_BE_DL =0x%lx, iot_peer = %d\n", (*EDCA_BE_UL), (*EDCA_BE_DL), iot_peer)); - -} - - -void -odm_edca_choose_traffic_idx( - void *p_dm_void, - u64 cur_tx_bytes, - u64 cur_rx_bytes, - bool is_bias_on_rx, - bool *p_is_cur_rdl_state -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - - if (is_bias_on_rx) { - - if (cur_tx_bytes > (cur_rx_bytes * 4)) { - *p_is_cur_rdl_state = false; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_EDCA_TURBO, ODM_DBG_LOUD, ("Uplink Traffic\n ")); - - } else { - *p_is_cur_rdl_state = true; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_EDCA_TURBO, ODM_DBG_LOUD, ("Balance Traffic\n")); - - } - } else { - if (cur_rx_bytes > (cur_tx_bytes * 4)) { - *p_is_cur_rdl_state = true; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_EDCA_TURBO, ODM_DBG_LOUD, ("Downlink Traffic\n")); - - } else { - *p_is_cur_rdl_state = false; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_EDCA_TURBO, ODM_DBG_LOUD, ("Balance Traffic\n")); - } - } - - return ; -} - -#endif -#endif /*PHYDM_SUPPORT_EDCA*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_edcaturbocheck.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_edcaturbocheck.h deleted file mode 100644 index 0ebe3280814a..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_edcaturbocheck.h +++ /dev/null @@ -1,102 +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__ - -#if PHYDM_SUPPORT_EDCA -/*#define EDCATURBO_VERSION "2.1"*/ -#define EDCATURBO_VERSION "2.3" /*2015.07.29 by YuChen*/ - -struct _EDCA_TURBO_ { - bool is_current_turbo_edca; - bool is_cur_rdl_state; - -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - u32 prv_traffic_idx; /* edca turbo */ -#endif - -}; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -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}; - -#endif - - - -void -odm_edca_turbo_check( - void *p_dm_void -); -void -odm_edca_turbo_init( - void *p_dm_void -); - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -void -odm_edca_turbo_check_mp( - void *p_dm_void -); - -/* check if edca turbo is disabled */ -bool -odm_is_edca_turbo_disable( - void *p_dm_void -); -/* choose edca paramter for special IOT case */ -void -odm_edca_para_sel_by_iot( - void *p_dm_void, - u32 *EDCA_BE_UL, - u32 *EDCA_BE_DL -); -/* check if it is UL or DL */ -void -odm_edca_choose_traffic_idx( - void *p_dm_void, - u64 cur_tx_bytes, - u64 cur_rx_bytes, - bool is_bias_on_rx, - bool *p_is_cur_rdl_state -); - -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -void -odm_edca_turbo_check_ce( - void *p_dm_void -); -#endif - -#endif /*PHYDM_SUPPORT_EDCA*/ - -#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_features.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_features.h index f0b2636854f7..088cf2c6af72 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_features.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_features.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,182 +9,65 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ -#ifndef __PHYDM_FEATURES_H__ -#define __PHYDM_FEATURES +#ifndef __PHYDM_FEATURES_H__ +#define __PHYDM_FEATURES_H__ -#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 +#define CONFIG_RUN_IN_DRV +#define ODM_DC_CANCELLATION_SUPPORT (ODM_RTL8188F | \ + ODM_RTL8710B | \ + ODM_RTL8192F | \ + ODM_RTL8821C | \ + ODM_RTL8721D) +#define ODM_RECEIVER_BLOCKING_SUPPORT (ODM_RTL8188E | ODM_RTL8192E) + +/*@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 +#define PHYDM_FW_API_ENABLE_8195B 1 +#define PHYDM_FW_API_FUNC_ENABLE_8195B 1 +#define PHYDM_FW_API_ENABLE_8198F 1 +#define PHYDM_FW_API_FUNC_ENABLE_8198F 1 +#define PHYDM_FW_API_ENABLE_8822C 1 +#define PHYDM_FW_API_FUNC_ENABLE_8822C 1 +#define PHYDM_FW_API_ENABLE_8814B 1 +#define PHYDM_FW_API_FUNC_ENABLE_8814B 1 +#define PHYDM_FW_API_ENABLE_8812F 1 +#define PHYDM_FW_API_FUNC_ENABLE_8812F 1 + +#define CONFIG_POWERSAVING 0 + +#ifdef BEAMFORMING_SUPPORT +#if (BEAMFORMING_SUPPORT) + #define PHYDM_BEAMFORMING_SUPPORT +#endif #endif #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - - /*phydm debyg report & tools*/ - #define CONFIG_PHYDM_DEBUG_FUNCTION 1 - - /*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) || (RTL8822B_SUPPORT == 1) - /*#define CONFIG_HL_SMART_ANTENNA_TYPE1*/ - #define CONFIG_FAT_PATCH - #endif - #endif - - #if (RTL8822B_SUPPORT == 1) - #define CONFIG_DYNAMIC_RX_PATH 0 - #else - #define CONFIG_DYNAMIC_RX_PATH 0 - #endif - - #if (RTL8188E_SUPPORT == 1 || RTL8192E_SUPPORT == 1) - #define CONFIG_RECEIVER_BLOCKING - #endif - #define PHYDM_SUPPORT_EDCA 0 - #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) - - /*phydm debyg report & tools*/ - #if defined(CONFIG_DISABLE_PHYDM_DEBUG_FUNCTION) - #define CONFIG_PHYDM_DEBUG_FUNCTION 0 - #else - #define CONFIG_PHYDM_DEBUG_FUNCTION 1 - #endif - - #if (RTL8822B_SUPPORT == 1) - #define CONFIG_DYNAMIC_RX_PATH 0 - #else - #define CONFIG_DYNAMIC_RX_PATH 0 - #endif - - #define PHYDM_SUPPORT_EDCA 1 - #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 - + #include "phydm_features_win.h" #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - - /*phydm debyg report & tools*/ - #define CONFIG_PHYDM_DEBUG_FUNCTION 1 - - #if (RTL8822B_SUPPORT == 1) - #define CONFIG_DYNAMIC_RX_PATH 0 - #else - #define CONFIG_DYNAMIC_RX_PATH 0 - #endif - - #define PHYDM_SUPPORT_EDCA 1 - #define SUPPORTABLITY_PHYDMLIZE 1 - #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 - - #if (RTL8188E_SUPPORT == 1 || RTL8192E_SUPPORT == 1) - #define CONFIG_RECEIVER_BLOCKING - #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 - - + #include "phydm_features_ce.h" + /*@#include "phydm_features_ce2_kernel.h"*/ +#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) + #include "phydm_features_ap.h" +#elif (DM_ODM_SUPPORT_TYPE == ODM_IOT) + #include "phydm_features_iot.h" #endif - #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_features_ap.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_features_ap.h new file mode 100644 index 000000000000..e80c6fe6133a --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_features_ap.h @@ -0,0 +1,199 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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_H__ + +#if (RTL8814A_SUPPORT || RTL8821C_SUPPORT || RTL8822B_SUPPORT ||\ + RTL8197F_SUPPORT || RTL8192F_SUPPORT || RTL8198F_SUPPORT ||\ + RTL8822C_SUPPORT || RTL8812F_SUPPORT || RTL8814B_SUPPORT) + #define PHYDM_LA_MODE_SUPPORT 1 +#else + #define PHYDM_LA_MODE_SUPPORT 0 +#endif + +#if (RTL8822B_SUPPORT || RTL8812A_SUPPORT || RTL8197F_SUPPORT ||\ + RTL8192F_SUPPORT) + #define DYN_ANT_WEIGHTING_SUPPORT +#endif + +#if (RTL8822B_SUPPORT || RTL8821C_SUPPORT) + #define FAHM_SUPPORT +#endif + #define NHM_SUPPORT + #define CLM_SUPPORT + +#if (RTL8822B_SUPPORT) + /*#define PHYDM_PHYSTAUS_SMP_MODE*/ +#endif + +#if (RTL8197F_SUPPORT) + /*#define PHYDM_TDMA_DIG_SUPPORT*/ +#endif + +#if (RTL8198F_SUPPORT || RTL8814B_SUPPORT || RTL8812F_SUPPORT) + #define PHYDM_TDMA_DIG_SUPPORT 1 + #ifdef PHYDM_TDMA_DIG_SUPPORT + #define IS_USE_NEW_TDMA /*new tdma dig test*/ + #endif +#endif + +#if (RTL8197F_SUPPORT || RTL8822B_SUPPORT ||\ + RTL8198F_SUPPORT || RTL8814B_SUPPORT || RTL8812F_SUPPORT) + #define PHYDM_LNA_SAT_CHK_SUPPORT + #ifdef PHYDM_LNA_SAT_CHK_SUPPORT + + #if (RTL8197F_SUPPORT) + /*#define PHYDM_LNA_SAT_CHK_SUPPORT_TYPE1*/ + #endif + + #if (RTL8822B_SUPPORT) + /*#define PHYDM_LNA_SAT_CHK_TYPE2*/ + #endif + + #if (RTL8198F_SUPPORT || RTL8814B_SUPPORT || RTL8812F_SUPPORT) + #define PHYDM_LNA_SAT_CHK_TYPE1 + #endif + #endif +#endif + +#if (RTL8822B_SUPPORT) + /*#define PHYDM_POWER_TRAINING_SUPPORT*/ +#endif + +#if (RTL8814B_SUPPORT || RTL8198F_SUPPORT || RTL8822C_SUPPORT ||\ + RTL8812F_SUPPORT) + #define PHYDM_PMAC_TX_SETTING_SUPPORT +#endif + +#if (RTL8814B_SUPPORT || RTL8198F_SUPPORT || RTL8822C_SUPPORT ||\ + RTL8812F_SUPPORT) + #define PHYDM_MP_SUPPORT +#endif + +#if (RTL8822B_SUPPORT) + #define PHYDM_TXA_CALIBRATION +#endif + +#if (RTL8188E_SUPPORT || RTL8197F_SUPPORT || RTL8192F_SUPPORT) + #define PHYDM_PRIMARY_CCA +#endif + +#if (RTL8188F_SUPPORT || RTL8710B_SUPPORT || RTL8821C_SUPPORT ||\ + RTL8822B_SUPPORT || RTL8192F_SUPPORT) + #define PHYDM_DC_CANCELLATION +#endif + +#if (RTL8822B_SUPPORT || RTL8197F_SUPPORT || RTL8192F_SUPPORT) + #define CONFIG_ADAPTIVE_SOML +#endif + +#if (RTL8812A_SUPPORT || RTL8821A_SUPPORT || RTL8881A_SUPPORT ||\ + RTL8192E_SUPPORT || RTL8723B_SUPPORT) + /*#define CONFIG_RA_FW_DBG_CODE*/ +#endif + +#if (RTL8192F_SUPPORT == 1) + /*#define CONFIG_8912F_SPUR_CALIBRATION*/ +#endif + +#if (RTL8822B_SUPPORT == 1) + /* #define CONFIG_8822B_SPUR_CALIBRATION */ +#endif + +#ifdef CONFIG_SUPPORT_DYNAMIC_TXPWR +#define CONFIG_DYNAMIC_TX_TWR +#endif +/*#define CONFIG_PSD_TOOL*/ +#define PHYDM_SUPPORT_CCKPD +#define PHYDM_SUPPORT_ADAPTIVITY +/*#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_SUPPORT_RSSI_MONITOR +#if !defined(CONFIG_DISABLE_PHYDM_DEBUG_FUNCTION) + #define CONFIG_PHYDM_DEBUG_FUNCTION +#endif + +/* [ Configure Antenna Diversity ] */ +#if (RTL8188F_SUPPORT) + #ifdef CONFIG_ANTENNA_DIVERSITY + #define CONFIG_PHYDM_ANTENNA_DIVERSITY + #define CONFIG_S0S1_SW_ANTENNA_DIVERSITY + #endif +#endif + +#if defined(CONFIG_RTL_8881A_ANT_SWITCH) || defined(CONFIG_SLOT_0_ANT_SWITCH) || defined(CONFIG_SLOT_1_ANT_SWITCH) || defined(CONFIG_RTL_8197F_ANT_SWITCH) + #define CONFIG_PHYDM_ANTENNA_DIVERSITY + #define ODM_EVM_ENHANCE_ANTDIV + /*#define SKIP_EVM_ANTDIV_TRAINING_PATCH*/ + + /*----------*/ + #ifdef CONFIG_NO_2G_DIVERSITY_8197F + #define CONFIG_NO_2G_DIVERSITY + #elif defined(CONFIG_2G_CGCS_RX_DIVERSITY_8197F) + #define CONFIG_2G_CGCS_RX_DIVERSITY + #elif defined(CONFIG_2G_CG_TRX_DIVERSITY_8197F) + #define CONFIG_2G_CG_TRX_DIVERSITY + #endif + + #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 +#define CFG_DIG_DAMPING_CHK +/* --------------------------------------------------*/ +#ifdef PHYDM_BEAMFORMING_SUPPORT + #if (RTL8192F_SUPPORT || RTL8195B_SUPPORT || RTL8821C_SUPPORT ||\ + RTL8822B_SUPPORT || RTL8197F_SUPPORT || RTL8198F_SUPPORT ||\ + RTL8814B_SUPPORT || RTL8812F_SUPPORT) + #define DRIVER_BEAMFORMING_VERSION2 + #endif +#endif + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_features_ce.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_features_ce.h new file mode 100644 index 000000000000..7c9862d2e81a --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_features_ce.h @@ -0,0 +1,226 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +#ifndef __PHYDM_FEATURES_CE_H__ +#define __PHYDM_FEATURES_CE_H__ + +#if (RTL8814A_SUPPORT || RTL8821C_SUPPORT || RTL8822B_SUPPORT ||\ + RTL8197F_SUPPORT || RTL8192F_SUPPORT || RTL8198F_SUPPORT ||\ + RTL8822C_SUPPORT) + #define PHYDM_LA_MODE_SUPPORT 1 +#else + #define PHYDM_LA_MODE_SUPPORT 0 +#endif + +#if (RTL8822B_SUPPORT || RTL8812A_SUPPORT || RTL8197F_SUPPORT ||\ + RTL8192F_SUPPORT) + #define DYN_ANT_WEIGHTING_SUPPORT +#endif + +#if (RTL8822B_SUPPORT || RTL8821C_SUPPORT) + #define FAHM_SUPPORT +#endif + #define NHM_SUPPORT + #define CLM_SUPPORT + +#if (RTL8822C_SUPPORT) + #define NHM_DYM_PW_TH_SUPPORT +#endif + +#if (RTL8822B_SUPPORT) + /*@#define PHYDM_PHYSTAUS_SMP_MODE*/ +#endif + +/*@#define PHYDM_TDMA_DIG_SUPPORT*/ + +#if (RTL8822B_SUPPORT || RTL8192F_SUPPORT || RTL8821C_SUPPORT ||\ + RTL8822C_SUPPORT || RTL8723D_SUPPORT) + #ifdef CONFIG_TDMADIG + #define PHYDM_TDMA_DIG_SUPPORT + #ifdef PHYDM_TDMA_DIG_SUPPORT + #define IS_USE_NEW_TDMA /*new tdma dig test*/ + #endif + #endif +#endif + +#if (RTL8814B_SUPPORT) + /*@#define PHYDM_TDMA_DIG_SUPPORT*/ + #ifdef PHYDM_TDMA_DIG_SUPPORT + /*@#define IS_USE_NEW_TDMA*/ /*new tdma dig test*/ + #endif +#endif + +#if (RTL8197F_SUPPORT || RTL8822B_SUPPORT || RTL8814B_SUPPORT) + /*@#define PHYDM_LNA_SAT_CHK_SUPPORT*/ + #ifdef PHYDM_LNA_SAT_CHK_SUPPORT + + #if (RTL8197F_SUPPORT) + /*@#define PHYDM_LNA_SAT_CHK_SUPPORT_TYPE1*/ + #endif + + #if (RTL8822B_SUPPORT) + /*@#define PHYDM_LNA_SAT_CHK_TYPE2*/ + #endif + + #if (RTL8814B_SUPPORT) + /*@#define PHYDM_LNA_SAT_CHK_TYPE1*/ + #endif + #endif +#endif + +#if (RTL8822B_SUPPORT || RTL8192F_SUPPORT) + #define PHYDM_POWER_TRAINING_SUPPORT +#endif + +#if (RTL8822C_SUPPORT) + #define PHYDM_PMAC_TX_SETTING_SUPPORT +#endif + +#if (RTL8822C_SUPPORT) + #define PHYDM_MP_SUPPORT +#endif + +#if (RTL8822B_SUPPORT) + #define PHYDM_TXA_CALIBRATION +#endif + +#if (RTL8188E_SUPPORT) + #define PHYDM_PRIMARY_CCA +#endif + +#if (RTL8188F_SUPPORT || RTL8710B_SUPPORT || RTL8821C_SUPPORT ||\ + RTL8822B_SUPPORT || RTL8192F_SUPPORT) + #define PHYDM_DC_CANCELLATION +#endif + +#if (RTL8822B_SUPPORT || RTL8197F_SUPPORT || RTL8192F_SUPPORT) + #define CONFIG_ADAPTIVE_SOML +#endif + +#if (RTL8188E_SUPPORT || RTL8192E_SUPPORT) + #define CONFIG_RECEIVER_BLOCKING +#endif + +#if (RTL8192F_SUPPORT == 1) + /*#define CONFIG_8912F_SPUR_CALIBRATION*/ +#endif + +#if (RTL8822B_SUPPORT == 1) + #define CONFIG_8822B_SPUR_CALIBRATION +#endif + +#ifdef CONFIG_SUPPORT_DYNAMIC_TXPWR +#define CONFIG_DYNAMIC_TX_TWR +#endif +#define PHYDM_SUPPORT_CCKPD +#define PHYDM_SUPPORT_ADAPTIVITY + +/*@Antenna Diversity*/ +#ifdef CONFIG_ANTENNA_DIVERSITY + #define CONFIG_PHYDM_ANTENNA_DIVERSITY + + #ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY + + #if (RTL8723B_SUPPORT || RTL8821A_SUPPORT ||\ + RTL8188F_SUPPORT || RTL8821C_SUPPORT ||\ + RTL8723D_SUPPORT) + #define CONFIG_S0S1_SW_ANTENNA_DIVERSITY + #endif + + #if (RTL8821A_SUPPORT) + /*@#define CONFIG_HL_SMART_ANTENNA_TYPE1*/ + #endif + + #if (RTL8822B_SUPPORT) + /*@#define CONFIG_HL_SMART_ANTENNA_TYPE2*/ + #endif + + #endif +#endif + +#if (RTL8822C_SUPPORT) + #define CONFIG_PATH_DIVERSITY +#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 + +#if (RTL8812A_SUPPORT || RTL8821A_SUPPORT || RTL8881A_SUPPORT ||\ + RTL8192E_SUPPORT || RTL8723B_SUPPORT) + /*@#define CONFIG_RA_FW_DBG_CODE*/ +#endif + +#define CONFIG_PSD_TOOL +/*@#define CONFIG_ANT_DETECTION*/ +/*@#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_SUPPORT_RSSI_MONITOR +#define PHYDM_AUTO_DEGBUG +#define CFG_DIG_DAMPING_CHK + + +#ifdef PHYDM_BEAMFORMING_SUPPORT + #if (RTL8812A_SUPPORT || RTL8821A_SUPPORT || RTL8192E_SUPPORT ||\ + RTL8814A_SUPPORT || RTL8881A_SUPPORT) + #define PHYDM_BEAMFORMING_VERSION1 + #endif + #if (RTL8192F_SUPPORT || RTL8195B_SUPPORT || RTL8821C_SUPPORT ||\ + RTL8822B_SUPPORT || RTL8197F_SUPPORT || RTL8198F_SUPPORT ||\ + RTL8822C_SUPPORT || RTL8814B_SUPPORT) + #define DRIVER_BEAMFORMING_VERSION2 + #endif +#endif + +#if (RTL8822B_SUPPORT || RTL8822C_SUPPORT) + #ifdef CONFIG_MCC_MODE + #define CONFIG_MCC_DM + #endif +#endif + +#if (RTL8822B_SUPPORT) + #ifdef CONFIG_DYNAMIC_BYPASS_MODE + #define CONFIG_DYNAMIC_BYPASS + #endif +#endif + +#if (RTL8822B_SUPPORT || RTL8192F_SUPPORT) + #define CONFIG_DIRECTIONAL_BF +#endif + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_features_ce2_kernel.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_features_ce2_kernel.h new file mode 100644 index 000000000000..b7ee91548183 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_features_ce2_kernel.h @@ -0,0 +1,85 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +#ifndef __PHYDM_FEATURES_CE_H__ +#define __PHYDM_FEATURES_CE_H__ + +#define PHYDM_LA_MODE_SUPPORT 0 + +#if (RTL8822B_SUPPORT || RTL8812A_SUPPORT || RTL8197F_SUPPORT ||\ + RTL8192F_SUPPORT) + #define DYN_ANT_WEIGHTING_SUPPORT +#endif + +#if (RTL8822B_SUPPORT || RTL8821C_SUPPORT) + #define FAHM_SUPPORT +#endif + #define NHM_SUPPORT + #define CLM_SUPPORT + +#if (RTL8822B_SUPPORT) + #define PHYDM_TXA_CALIBRATION +#endif + +#if (RTL8188F_SUPPORT || RTL8710B_SUPPORT || RTL8821C_SUPPORT ||\ + RTL8822B_SUPPORT || RTL8192F_SUPPORT) + #define PHYDM_DC_CANCELLATION +#endif + +#if (RTL8192F_SUPPORT == 1) + /*#define CONFIG_8912F_SPUR_CALIBRATION*/ +#endif + +#if (RTL8822B_SUPPORT == 1) + /* #define CONFIG_8822B_SPUR_CALIBRATION */ +#endif + +#define PHYDM_SUPPORT_CCKPD +#define PHYDM_SUPPORT_ADAPTIVITY + +#ifdef CONFIG_DFS_MASTER + #define CONFIG_PHYDM_DFS_MASTER +#endif + +#define CONFIG_BB_TXBF_API +#define CONFIG_PHYDM_DEBUG_FUNCTION + +#ifdef CONFIG_BT_COEXIST + #define ODM_CONFIG_BT_COEXIST +#endif +#define PHYDM_SUPPORT_RSSI_MONITOR +#define CFG_DIG_DAMPING_CHK + + +#ifdef PHYDM_BEAMFORMING_SUPPORT + #if (RTL8192F_SUPPORT || RTL8195B_SUPPORT || RTL8821C_SUPPORT ||\ + RTL8822B_SUPPORT || RTL8197F_SUPPORT || RTL8198F_SUPPORT ||\ + RTL8822C_SUPPORT || RTL8814B_SUPPORT) + #define DRIVER_BEAMFORMING_VERSION2 + #endif +#endif + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_features_iot.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_features_iot.h new file mode 100644 index 000000000000..878fd6626a46 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_features_iot.h @@ -0,0 +1,175 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +#ifndef __PHYDM_FEATURES_IOT_H__ +#define __PHYDM_FEATURES_IOT_H__ + +#if (RTL8814A_SUPPORT || RTL8821C_SUPPORT || RTL8822B_SUPPORT ||\ + RTL8197F_SUPPORT || RTL8192F_SUPPORT || RTL8198F_SUPPORT ||\ + RTL8822C_SUPPORT || RTL8195B_SUPPORT) + #define PHYDM_LA_MODE_SUPPORT 1 +#else + #define PHYDM_LA_MODE_SUPPORT 0 +#endif + +#if (RTL8822B_SUPPORT || RTL8812A_SUPPORT || RTL8197F_SUPPORT ||\ + RTL8192F_SUPPORT) + #define DYN_ANT_WEIGHTING_SUPPORT +#endif + +#if (RTL8822B_SUPPORT || RTL8821C_SUPPORT) + #define FAHM_SUPPORT +#endif + #define NHM_SUPPORT + #define CLM_SUPPORT + +#if (RTL8822B_SUPPORT) + /*#define PHYDM_PHYSTAUS_SMP_MODE*/ +#endif + +/*#define PHYDM_TDMA_DIG_SUPPORT*/ + +#if (RTL8197F_SUPPORT || RTL8822B_SUPPORT) + /*#define PHYDM_LNA_SAT_CHK_SUPPORT*/ + #ifdef PHYDM_LNA_SAT_CHK_SUPPORT + #if (RTL8197F_SUPPORT) + /*#define PHYDM_LNA_SAT_CHK_SUPPORT_TYPE1*/ + #endif + + #if (RTL8822B_SUPPORT) + /*#define PHYDM_LNA_SAT_CHK_TYPE2*/ + #endif + #endif +#endif + +#if (RTL8822B_SUPPORT || RTL8721D_SUPPORT) + #define PHYDM_POWER_TRAINING_SUPPORT +#endif + +#if (RTL8822C_SUPPORT) + /* #define PHYDM_PMAC_TX_SETTING_SUPPORT */ +#endif + +#if (RTL8822C_SUPPORT) + /* #define PHYDM_MP_SUPPORT */ +#endif + +#if (RTL8822B_SUPPORT) + #define PHYDM_TXA_CALIBRATION +#endif + +#if (RTL8188E_SUPPORT) + #define PHYDM_PRIMARY_CCA +#endif + +#if (RTL8188F_SUPPORT || RTL8710B_SUPPORT || RTL8821C_SUPPORT ||\ + RTL8822B_SUPPORT || RTL8721D_SUPPORT) + #define PHYDM_DC_CANCELLATION +#endif + +#if (RTL8822B_SUPPORT || RTL8197F_SUPPORT || RTL8192F_SUPPORT) + #define CONFIG_ADAPTIVE_SOML +#endif + +#if (RTL8822B_SUPPORT) + /*#define CONFIG_DYNAMIC_RX_PATH*/ +#endif + +#if (RTL8822B_SUPPORT == 1) + /* #define CONFIG_8822B_SPUR_CALIBRATION */ +#endif + +#if (RTL8188E_SUPPORT || RTL8192E_SUPPORT) + #define CONFIG_RECEIVER_BLOCKING +#endif + +#ifdef CONFIG_SUPPORT_DYNAMIC_TXPWR +#define CONFIG_DYNAMIC_TX_TWR +#endif +#define PHYDM_SUPPORT_CCKPD +#define PHYDM_SUPPORT_ADAPTIVITY + +/*Antenna Diversity*/ +#ifdef CONFIG_ANTENNA_DIVERSITY + #define CONFIG_PHYDM_ANTENNA_DIVERSITY + + #ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY + + #if (RTL8723B_SUPPORT || RTL8821A_SUPPORT ||\ + RTL8188F_SUPPORT || RTL8821C_SUPPORT) + #define CONFIG_S0S1_SW_ANTENNA_DIVERSITY + #endif + + #if (RTL8821A_SUPPORT) + /*#define CONFIG_HL_SMART_ANTENNA_TYPE1*/ + #endif + + #if (RTL8822B_SUPPORT) + /*#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 + +#if (RTL8812A_SUPPORT || RTL8821A_SUPPORT || RTL8881A_SUPPORT ||\ + RTL8192E_SUPPORT || RTL8723B_SUPPORT) + /*#define CONFIG_RA_FW_DBG_CODE*/ +#endif + +#define CONFIG_PSD_TOOL +/*#define CONFIG_RA_DBG_CMD*/ +/*#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_SUPPORT_RSSI_MONITOR +/*#define PHYDM_AUTO_DEGBUG*/ +#define CFG_DIG_DAMPING_CHK + +#ifdef PHYDM_BEAMFORMING_SUPPORT + #if (RTL8192F_SUPPORT || RTL8195B_SUPPORT || RTL8821C_SUPPORT ||\ + RTL8822B_SUPPORT || RTL8197F_SUPPORT || RTL8198F_SUPPORT ||\ + RTL8822C_SUPPORT || RTL8814B_SUPPORT) + #define DRIVER_BEAMFORMING_VERSION2 + #endif +#endif + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_features_win.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_features_win.h new file mode 100644 index 000000000000..dcb00eba904e --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_features_win.h @@ -0,0 +1,197 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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_H__ + +#if (RTL8814A_SUPPORT || RTL8821C_SUPPORT || RTL8822B_SUPPORT ||\ + RTL8197F_SUPPORT || RTL8192F_SUPPORT || RTL8198F_SUPPORT ||\ + RTL8822C_SUPPORT || RTL8814B_SUPPORT) + #define PHYDM_LA_MODE_SUPPORT 1 +#else + #define PHYDM_LA_MODE_SUPPORT 0 +#endif + +#if (RTL8822B_SUPPORT || RTL8812A_SUPPORT || RTL8197F_SUPPORT ||\ + RTL8192F_SUPPORT) + #define DYN_ANT_WEIGHTING_SUPPORT +#endif + +#if (RTL8822B_SUPPORT || RTL8821C_SUPPORT) + #define FAHM_SUPPORT +#endif + #define NHM_SUPPORT + #define CLM_SUPPORT + +#if (RTL8822C_SUPPORT) + #define NHM_DYM_PW_TH_SUPPORT +#endif + +#if (RTL8822B_SUPPORT) + /*#define PHYDM_PHYSTAUS_SMP_MODE*/ +#endif + +/*#define PHYDM_TDMA_DIG_SUPPORT*/ + +#if (RTL8814B_SUPPORT) + /*#define PHYDM_TDMA_DIG_SUPPORT*/ + #ifdef PHYDM_TDMA_DIG_SUPPORT + /*#define IS_USE_NEW_TDMA*/ /*new tdma dig test*/ + #endif +#endif + +#if (RTL8197F_SUPPORT || RTL8822B_SUPPORT || RTL8814B_SUPPORT) + /*#define PHYDM_LNA_SAT_CHK_SUPPORT*/ + #ifdef PHYDM_LNA_SAT_CHK_SUPPORT + + #if (RTL8197F_SUPPORT) + /*#define PHYDM_LNA_SAT_CHK_SUPPORT_TYPE1*/ + #endif + + #if (RTL8822B_SUPPORT) + /*#define PHYDM_LNA_SAT_CHK_TYPE2*/ + #endif + + #if (RTL8814B_SUPPORT) + /*#define PHYDM_LNA_SAT_CHK_TYPE1*/ + #endif + #endif +#endif + +#if (RTL8822B_SUPPORT || RTL8710B_SUPPORT || RTL8723D_SUPPORT ||\ + RTL8192F_SUPPORT) + #define PHYDM_POWER_TRAINING_SUPPORT +#endif + +#if (RTL8822C_SUPPORT || RTL8814B_SUPPORT) + #define PHYDM_PMAC_TX_SETTING_SUPPORT +#endif + +#if (RTL8822C_SUPPORT || RTL8814B_SUPPORT) + #define PHYDM_MP_SUPPORT +#endif + +#if (RTL8822B_SUPPORT) + #define PHYDM_TXA_CALIBRATION +#endif + +#if (RTL8188E_SUPPORT || RTL8192E_SUPPORT) + #define PHYDM_PRIMARY_CCA +#endif + +#if (RTL8188F_SUPPORT || RTL8710B_SUPPORT || RTL8821C_SUPPORT ||\ + RTL8822B_SUPPORT || RTL8192F_SUPPORT) + #define PHYDM_DC_CANCELLATION +#endif + +#if (RTL8822B_SUPPORT || RTL8197F_SUPPORT || RTL8192F_SUPPORT) + #define CONFIG_ADAPTIVE_SOML +#endif + +#if (RTL8192F_SUPPORT == 1) + #define CONFIG_8912F_SPUR_CALIBRATION +#endif + +/*Antenna Diversity*/ +#define CONFIG_PHYDM_ANTENNA_DIVERSITY +#ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY + + #if (RTL8723B_SUPPORT || RTL8821A_SUPPORT || RTL8188F_SUPPORT ||\ + RTL8821C_SUPPORT || RTL8723D_SUPPORT) + #define CONFIG_S0S1_SW_ANTENNA_DIVERSITY + #endif + + #if (RTL8822B_SUPPORT) + /*#define ODM_EVM_ENHANCE_ANTDIV*/ + /*#define CONFIG_2T3R_ANTENNA*/ + /*#define CONFIG_2T4R_ANTENNA*/ + #endif + + /* --[SmtAnt]-----------------------------------------*/ + #if (RTL8821A_SUPPORT) + /*#define CONFIG_HL_SMART_ANTENNA_TYPE1*/ + #define CONFIG_FAT_PATCH + #endif + + #if (RTL8822B_SUPPORT) + /*#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 + +#if (RTL8822C_SUPPORT) + #define CONFIG_PATH_DIVERSITY +#endif + +/*[SmartAntenna]*/ +#define CONFIG_SMART_ANTENNA +#ifdef CONFIG_SMART_ANTENNA + /*#define CONFIG_CUMITEK_SMART_ANTENNA*/ +#endif + /* --------------------------------------------------*/ + +#if (RTL8188E_SUPPORT || RTL8192E_SUPPORT) + #define CONFIG_RECEIVER_BLOCKING +#endif + +#if (RTL8812A_SUPPORT || RTL8821A_SUPPORT || RTL8881A_SUPPORT ||\ + RTL8192E_SUPPORT || RTL8723B_SUPPORT) + #define CONFIG_RA_FW_DBG_CODE +#endif + +/* #ifdef CONFIG_SUPPORT_DYNAMIC_TXPWR */ +#define CONFIG_DYNAMIC_TX_TWR +/* #endif */ +#define CONFIG_PSD_TOOL +#define PHYDM_SUPPORT_ADAPTIVITY +#define PHYDM_SUPPORT_CCKPD +/*#define CONFIG_RA_DYNAMIC_RTY_LIMIT*/ +#define CONFIG_ANT_DETECTION +#define CONFIG_BB_TXBF_API +#define ODM_CONFIG_BT_COEXIST +#define CONFIG_PHYDM_DFS_MASTER +#define PHYDM_SUPPORT_RSSI_MONITOR +#define PHYDM_AUTO_DEGBUG +#define CONFIG_PHYDM_DEBUG_FUNCTION +#define CFG_DIG_DAMPING_CHK + +#ifdef PHYDM_BEAMFORMING_SUPPORT + #if (RTL8812A_SUPPORT || RTL8821A_SUPPORT || RTL8192E_SUPPORT ||\ + RTL8814A_SUPPORT || RTL8881A_SUPPORT) + #define PHYDM_BEAMFORMING_VERSION1 + #endif + #if (RTL8192F_SUPPORT || RTL8195B_SUPPORT || RTL8821C_SUPPORT ||\ + RTL8822B_SUPPORT || RTL8197F_SUPPORT || RTL8198F_SUPPORT ||\ + RTL8822C_SUPPORT || RTL8814B_SUPPORT) + #define DRIVER_BEAMFORMING_VERSION2 + #endif +#endif + +#if (RTL8822B_SUPPORT || RTL8192F_SUPPORT) + /*#define CONFIG_DIRECTIONAL_BF*/ +#endif + +#if (RTL8822C_SUPPORT) + #define CONFIG_MU_RSOML +#endif + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_hwconfig.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_hwconfig.c index 448d14056568..0e0839ef2bd2 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_hwconfig.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_hwconfig.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,1973 +9,84 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ -/* ************************************************************ +/*@************************************************************ * 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_odm)) -#define READ_AND_CONFIG_TC(ic, txt) (odm_read_and_config_tc_##ic##txt(p_dm_odm)) - +#define READ_AND_CONFIG_MP(ic, txt) (odm_read_and_config_mp_##ic##txt(dm)) +#define READ_AND_CONFIG_TC(ic, txt) (odm_read_and_config_tc_##ic##txt(dm)) #if (PHYDM_TESTCHIP_SUPPORT == 1) -#define READ_AND_CONFIG(ic, txt) do {\ - if (p_dm_odm->is_mp_chip)\ - READ_AND_CONFIG_MP(ic, txt);\ - else\ - READ_AND_CONFIG_TC(ic, txt);\ +#define READ_AND_CONFIG(ic, txt) \ + do { \ + if (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 +#define READ_AND_CONFIG READ_AND_CONFIG_MP #endif - -#define READ_FIRMWARE_MP(ic, txt) (odm_read_firmware_mp_##ic##txt(p_dm_odm, p_firmware, p_size)) -#define READ_FIRMWARE_TC(ic, txt) (odm_read_firmware_tc_##ic##txt(p_dm_odm, p_firmware, p_size)) +#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 READ_FIRMWARE(ic, txt) do {\ - if (p_dm_odm->is_mp_chip)\ - READ_FIRMWARE_MP(ic, txt);\ - else\ - READ_FIRMWARE_TC(ic, txt);\ - } while (0) +#define GET_VERSION(ic, txt) (dm->is_mp_chip ? GET_VERSION_MP(ic, txt) : GET_VERSION_TC(ic, txt)) #else -#define READ_FIRMWARE READ_FIRMWARE_MP +#define GET_VERSION(ic, txt) GET_VERSION_MP(ic, txt) #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_odm->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 - -u8 -odm_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; -} - - -/* - * 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.?? - * */ -s32 -odm_signal_scale_mapping_92c_series_patch_rt_cid_819x_lenovo( - struct PHY_DM_STRUCT *p_dm_odm, - s32 curr_sig -) -{ - s32 ret_sig = 0; -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - /* if(p_dm_odm->support_interface == 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 (curr_sig >= 54 && curr_sig <= 100) - ret_sig = 100; - else if (curr_sig >= 42 && curr_sig <= 53) - ret_sig = 95; - else if (curr_sig >= 36 && curr_sig <= 41) - ret_sig = 74 + ((curr_sig - 36) * 20) / 6; - else if (curr_sig >= 33 && curr_sig <= 35) - ret_sig = 65 + ((curr_sig - 33) * 8) / 2; - else if (curr_sig >= 18 && curr_sig <= 32) - ret_sig = 62 + ((curr_sig - 18) * 2) / 15; - else if (curr_sig >= 15 && curr_sig <= 17) - ret_sig = 33 + ((curr_sig - 15) * 28) / 2; - else if (curr_sig >= 10 && curr_sig <= 14) - ret_sig = 39; - else if (curr_sig >= 8 && curr_sig <= 9) - ret_sig = 33; - else if (curr_sig <= 8) - ret_sig = 19; - } -#endif /* ENDIF (DM_ODM_SUPPORT_TYPE == ODM_WIN) */ - return ret_sig; -} - -s32 -odm_signal_scale_mapping_92c_series_patch_rt_cid_819x_netcore( - struct PHY_DM_STRUCT *p_dm_odm, - s32 curr_sig -) -{ - s32 ret_sig = 0; -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - /* if(p_dm_odm->support_interface == ODM_ITRF_USB) */ - { - /* Netcore request this modification because 2009.04.13 SU driver use it. */ - if (curr_sig >= 31 && curr_sig <= 100) - ret_sig = 100; - else if (curr_sig >= 21 && curr_sig <= 30) - ret_sig = 90 + ((curr_sig - 20) / 1); - else if (curr_sig >= 11 && curr_sig <= 20) - ret_sig = 80 + ((curr_sig - 10) / 1); - else if (curr_sig >= 7 && curr_sig <= 10) - ret_sig = 69 + (curr_sig - 7); - else if (curr_sig == 6) - ret_sig = 54; - else if (curr_sig == 5) - ret_sig = 45; - 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 /* ENDIF (DM_ODM_SUPPORT_TYPE == ODM_WIN) */ - return ret_sig; -} - - -s32 -odm_signal_scale_mapping_92c_series( - struct PHY_DM_STRUCT *p_dm_odm, - s32 curr_sig -) -{ - s32 ret_sig = 0; -#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) - if (p_dm_odm->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_odm->support_interface == ODM_ITRF_USB) || (p_dm_odm->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 -odm_signal_scale_mapping( - struct PHY_DM_STRUCT *p_dm_odm, - s32 curr_sig -) -{ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - if ((p_dm_odm->support_platform == ODM_WIN) && - (p_dm_odm->support_interface != ODM_ITRF_PCIE) && /* USB & SDIO */ - (p_dm_odm->patch_id == 10)) /* p_mgnt_info->customer_id == RT_CID_819x_Netcore */ - return odm_signal_scale_mapping_92c_series_patch_rt_cid_819x_netcore(p_dm_odm, curr_sig); - else if ((p_dm_odm->support_platform == ODM_WIN) && - (p_dm_odm->support_interface == ODM_ITRF_PCIE) && - (p_dm_odm->patch_id == 19)) /* p_mgnt_info->customer_id == RT_CID_819X_LENOVO) */ - return odm_signal_scale_mapping_92c_series_patch_rt_cid_819x_lenovo(p_dm_odm, curr_sig); - else -#endif - { -#ifdef CONFIG_SIGNAL_SCALE_MAPPING - return odm_signal_scale_mapping_92c_series(p_dm_odm, curr_sig); -#else - return curr_sig; -#endif - } - -} - - - -static u8 odm_sq_process_patch_rt_cid_819x_lenovo( - struct PHY_DM_STRUCT *p_dm_odm, - u8 is_cck_rate, - u8 PWDB_ALL, - u8 path, - u8 RSSI -) -{ - u8 SQ = 0; -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - - if (is_cck_rate) { - - if (IS_HARDWARE_TYPE_8192E(p_dm_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(p_dm_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, ("is_cck_rate(%#d), PWDB_ALL(%#d), RSSI(%#d), SQ(%#d)\n", is_cck_rate, PWDB_ALL, RSSI, SQ)); - -#endif - return SQ; -} - -static u8 odm_sq_process_patch_rt_cid_819x_acer( - struct PHY_DM_STRUCT *p_dm_odm, - u8 is_cck_rate, - u8 PWDB_ALL, - u8 path, - u8 RSSI -) -{ - u8 SQ = 0; - -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - - 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_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, ("is_cck_rate(%#d), PWDB_ALL(%#d), RSSI(%#d), SQ(%#d)\n", is_cck_rate, PWDB_ALL, RSSI, SQ)); - -#endif - return SQ; -} - -static u8 -odm_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 -odm_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 -odm_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; -} - -u8 -phydm_rate_to_num_ss( - struct PHY_DM_STRUCT *p_dm_odm, - 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 (ODM_IC_11N_SERIES_SUPPORT == 1) - -#if (RTL8703B_SUPPORT == 1) -s8 -odm_CCKRSSI_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 -odm_CCKRSSI_8195A( - struct PHY_DM_STRUCT *p_dm_odm, - 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_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) -s8 -odm_CCKRSSI_8192E( - struct PHY_DM_STRUCT *p_dm_odm, - 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_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) -s8 -odm_CCKRSSI_8188E( - struct PHY_DM_STRUCT *p_dm_odm, - 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_odm->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 - -void -odm_rx_phy_status92c_series_parsing( - struct PHY_DM_STRUCT *p_dm_odm, - struct _odm_phy_status_info_ *p_phy_info, - u8 *p_phy_status, - struct _odm_per_pkt_info_ *p_pktinfo -) -{ - struct _sw_antenna_switch_ *p_dm_swat_table = &p_dm_odm->dm_swat_table; - 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; - bool is_cck_rate = false; - u8 rf_rx_num = 0; - u8 cck_highpwr = 0; - u8 LNA_idx = 0; - u8 VGA_idx = 0; - u8 cck_agc_rpt; - u8 num_ss; - 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; - - if (p_pktinfo->is_to_self) - p_dm_odm->curr_station_id = p_pktinfo->station_id; - - p_phy_info->rx_mimo_signal_quality[ODM_RF_PATH_A] = -1; - p_phy_info->rx_mimo_signal_quality[ODM_RF_PATH_B] = -1; - - - if (is_cck_rate) { - p_dm_odm->phy_dbg_info.num_qry_phy_status_cck++; - cck_agc_rpt = p_phy_sta_rpt->cck_agc_rpt_ofdm_cfosho_a ; - - if (p_dm_odm->support_ic_type & (ODM_RTL8703B)) { - -#if (RTL8703B_SUPPORT == 1) - if (p_dm_odm->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 = 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 (p_dm_odm->support_ic_type & (ODM_RTL8188E)) { - -#if (RTL8188E_SUPPORT == 1) - rx_pwr_all = odm_CCKRSSI_8188E(p_dm_odm, LNA_idx, VGA_idx); - /**/ -#endif - } -#if (RTL8192E_SUPPORT == 1) - else if (p_dm_odm->support_ic_type & (ODM_RTL8192E)) { - - rx_pwr_all = odm_CCKRSSI_8192E(p_dm_odm, LNA_idx, VGA_idx); - /**/ - } -#endif -#if (RTL8723B_SUPPORT == 1) - else if (p_dm_odm->support_ic_type & (ODM_RTL8723B)) { - - rx_pwr_all = odm_CCKRSSI_8723B(LNA_idx, VGA_idx); - /**/ - } -#endif -#if (RTL8188F_SUPPORT == 1) - else if (p_dm_odm->support_ic_type & (ODM_RTL8188F)) { - - rx_pwr_all = odm_CCKRSSI_8188F(LNA_idx, VGA_idx); - /**/ - } -#endif -#if (RTL8195A_SUPPORT == 1) - else if (p_dm_odm->support_ic_type & (ODM_RTL8195A)) { - - rx_pwr_all = odm_CCKRSSI_8195A(LNA_idx, VGA_idx); - /**/ - } -#endif - } - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("ext_lna_gain (( %d )), LNA_idx: (( 0x%x )), VGA_idx: (( 0x%x )), rx_pwr_all: (( %d ))\n", - p_dm_odm->ext_lna_gain, LNA_idx, VGA_idx, rx_pwr_all)); - - if (p_dm_odm->board_type & ODM_BOARD_EXT_LNA) - rx_pwr_all -= p_dm_odm->ext_lna_gain; - - PWDB_ALL = odm_query_rx_pwr_percentage(rx_pwr_all); - - if (p_pktinfo->is_to_self) { - p_dm_odm->cck_lna_idx = LNA_idx; - p_dm_odm->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) */ - /* */ - /* if(p_pktinfo->is_packet_match_bssid) */ - { - u8 SQ, SQ_rpt; - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - if ((p_dm_odm->support_platform == ODM_WIN) && - (p_dm_odm->patch_id == RT_CID_819X_LENOVO)) - SQ = odm_sq_process_patch_rt_cid_819x_lenovo(p_dm_odm, is_cck_rate, PWDB_ALL, 0, 0); - else if ((p_dm_odm->support_platform == ODM_WIN) && - (p_dm_odm->patch_id == RT_CID_819X_ACER)) - SQ = odm_sq_process_patch_rt_cid_819x_acer(p_dm_odm, is_cck_rate, PWDB_ALL, 0, 0); - else -#endif - if (p_phy_info->rx_pwdb_all > 40 && !p_dm_odm->is_in_hct_test) - SQ = 100; - else { - SQ_rpt = p_phy_sta_rpt->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; - - } - - /* dbg_print("cck SQ = %d\n", SQ); */ - p_phy_info->signal_quality = SQ; - p_phy_info->rx_mimo_signal_quality[ODM_RF_PATH_A] = SQ; - p_phy_info->rx_mimo_signal_quality[ODM_RF_PATH_B] = -1; - } - - for (i = ODM_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_odm->phy_dbg_info.num_qry_phy_status_ofdm++; - - /* */ - /* (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 (p_dm_odm->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_odm->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 = odm_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; - -#if (DM_ODM_SUPPORT_TYPE & (/*ODM_WIN|*/ODM_CE|ODM_AP)) - /* Get Rx snr value in DB */ - p_phy_info->rx_snr[i] = p_dm_odm->phy_dbg_info.rx_snr_db[i] = (s32)(p_phy_sta_rpt->path_rxsnr[i] / 2); -#endif - - /* Record Signal Strength for next packet */ - /* if(p_pktinfo->is_packet_match_bssid) */ - { -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - if ((p_dm_odm->support_platform == ODM_WIN) && - (p_dm_odm->patch_id == RT_CID_819X_LENOVO)) { - if (i == ODM_RF_PATH_A) - p_phy_info->signal_quality = odm_sq_process_patch_rt_cid_819x_lenovo(p_dm_odm, is_cck_rate, PWDB_ALL, i, RSSI); - - } else if ((p_dm_odm->support_platform == ODM_WIN) && - (p_dm_odm->patch_id == RT_CID_819X_ACER)) - p_phy_info->signal_quality = odm_sq_process_patch_rt_cid_819x_acer(p_dm_odm, is_cck_rate, PWDB_ALL, 0, RSSI); -#endif - } - } - - - /* */ - /* (2)PWDB, Average PWDB cacluated 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 = odm_query_rx_pwr_percentage(rx_pwr_all); - - - p_phy_info->rx_pwdb_all = PWDB_ALL; - /* ODM_RT_TRACE(p_dm_odm,ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("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 ((p_dm_odm->support_platform == ODM_WIN) && (p_dm_odm->patch_id == 19)) { - /* do nothing */ - } else if ((p_dm_odm->support_platform == ODM_WIN) && (p_dm_odm->patch_id == 25)) { - /* do nothing */ - } else { /* p_mgnt_info->customer_id != RT_CID_819X_LENOVO */ - /* */ - /* (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 = odm_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(p_pktinfo->is_packet_match_bssid) */ - { - if (i == ODM_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); - } - } - } - - num_ss = phydm_rate_to_num_ss(p_dm_odm, p_pktinfo->data_rate); - odm_parsing_cfo(p_dm_odm, 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_odm->adapter, PWDB_ALL, true, true); -#else - p_phy_info->signal_strength = (u8)(odm_signal_scale_mapping(p_dm_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/ */ - p_phy_info->signal_strength = SignalScaleProc(p_dm_odm->adapter, (total_rssi /= rf_rx_num), true, false); -#else - p_phy_info->signal_strength = (u8)(odm_signal_scale_mapping(p_dm_odm, 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_odm->dm_fat_table.antsel_rx_keep_0 = p_phy_sta_rpt->ant_sel; - p_dm_odm->dm_fat_table.antsel_rx_keep_1 = p_phy_sta_rpt->ant_sel_b; - p_dm_odm->dm_fat_table.antsel_rx_keep_2 = p_phy_sta_rpt->antsel_rx_keep_2; -#endif -} -#endif - -#if ODM_IC_11AC_SERIES_SUPPORT - -void -odm_rx_phy_bw_jaguar_series_parsing( - struct _odm_phy_status_info_ *p_phy_info, - struct _odm_per_pkt_info_ *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 -odm_rx_phy_status_jaguar_series_parsing( - struct PHY_DM_STRUCT *p_dm_odm, - struct _odm_phy_status_info_ *p_phy_info, - u8 *p_phy_status, - struct _odm_per_pkt_info_ *p_pktinfo -) -{ - u8 i, max_spatial_stream; - s8 rx_pwr[4], rx_pwr_all = 0; - u8 EVM, 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 _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; - u8 num_ss; - - odm_rx_phy_bw_jaguar_series_parsing(p_phy_info, p_pktinfo, p_phy_sta_rpt); - - if (p_pktinfo->data_rate <= ODM_RATE11M) - is_cck_rate = true; - else - is_cck_rate = false; - - if (p_pktinfo->is_to_self) - p_dm_odm->curr_station_id = p_pktinfo->station_id; - else - p_dm_odm->curr_station_id = 0xff; - - p_phy_info->rx_mimo_signal_quality[ODM_RF_PATH_A] = -1; - p_phy_info->rx_mimo_signal_quality[ODM_RF_PATH_B] = -1; - p_phy_info->rx_mimo_signal_quality[ODM_RF_PATH_C] = -1; - p_phy_info->rx_mimo_signal_quality[ODM_RF_PATH_D] = -1; - - if (is_cck_rate) { - u8 cck_agc_rpt; - p_dm_odm->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_odm->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_odm->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 = odm_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_odm->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 = odm_query_rx_pwr_percentage(rx_pwr_all); - } else if (p_dm_odm->support_ic_type == ODM_RTL8814A || p_dm_odm->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 = odm_query_rx_pwr_percentage(rx_pwr_all); - } - - p_dm_odm->cck_lna_idx = LNA_idx; - p_dm_odm->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 ((p_dm_odm->support_platform == ODM_WIN) && - (p_dm_odm->patch_id == RT_CID_819X_LENOVO)) - SQ = odm_sq_process_patch_rt_cid_819x_lenovo(p_dm_odm, is_cck_rate, PWDB_ALL, 0, 0); - else if (p_phy_info->rx_pwdb_all > 40 && !p_dm_odm->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[ODM_RF_PATH_A] = SQ; - } - - for (i = ODM_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_odm->phy_dbg_info.num_qry_phy_status_ofdm++; - - /*(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.*/ - /* dbg_print("p_dm_odm->rf_path_rx_enable = %x\n", p_dm_odm->rf_path_rx_enable); */ - if (p_dm_odm->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_odm->support_ic_type & (ODM_RTL8812|ODM_RTL8821)) && (!p_dm_odm->is_mp_chip)) */ - if (i < ODM_RF_PATH_C) - rx_pwr[i] = (p_phy_sta_rpt->gain_trsw[i] & 0x7F) - 110; - 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 = odm_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 < ODM_RF_PATH_C) - p_phy_info->rx_snr[i] = p_dm_odm->phy_dbg_info.rx_snr_db[i] = p_phy_sta_rpt->rxsnr[i] / 2; - else if (p_dm_odm->support_ic_type & (ODM_RTL8814A | ODM_RTL8822B)) - p_phy_info->rx_snr[i] = p_dm_odm->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 < ODM_RF_PATH_C) { - p_phy_info->cfo_short[i] = odm_cfo((p_phy_sta_rpt->cfosho[i])); - p_phy_info->cfo_tail[i] = odm_cfo((p_phy_sta_rpt->cfotail[i])); - } -#endif - /* Record Signal Strength for next packet */ - if (p_pktinfo->is_packet_match_bssid) { -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - if ((p_dm_odm->support_platform == ODM_WIN) && - (p_dm_odm->patch_id == RT_CID_819X_LENOVO)) { - if (i == ODM_RF_PATH_A) - p_phy_info->signal_quality = odm_sq_process_patch_rt_cid_819x_lenovo(p_dm_odm, 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_odm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8881A)) && (!p_dm_odm->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 = odm_query_rx_pwr_percentage(rx_pwr_all); - - p_phy_info->rx_pwdb_all = PWDB_ALL; - /*ODM_RT_TRACE(p_dm_odm,ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("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 ((p_dm_odm->support_platform == ODM_WIN) && (p_dm_odm->patch_id == 19)) { - /*do nothing*/ - } else { - /*p_mgnt_info->customer_id != RT_CID_819X_LENOVO*/ - - /*(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 == ODM_RF_PATH_A) { - EVM = odm_evm_db_to_percentage((p_phy_sta_rpt->sigevm)); /*dbm*/ - EVM += 20; - if (EVM > 100) - EVM = 100; - } - } else { - if (i < ODM_RF_PATH_C) { - if (p_phy_sta_rpt->rxevm[i] == -128) - p_phy_sta_rpt->rxevm[i] = -25; - EVM = odm_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 = odm_evm_db_to_percentage((p_phy_sta_rpt->rxevm_cd[i - 2])); /*dbm*/ - } - } - - if (i < ODM_RF_PATH_C) - evm_dbm = odm_evm_dbm_jaguar_series(p_phy_sta_rpt->rxevm[i]); - else - evm_dbm = odm_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 == ODM_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_odm, p_pktinfo->data_rate); - odm_parsing_cfo(p_dm_odm, 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_odm->adapter, PWDB_ALL, false, true); -#else - p_phy_info->signal_strength = (u8)(odm_signal_scale_mapping(p_dm_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/*/ - p_phy_info->signal_strength = SignalScaleProc(p_dm_odm->adapter, avg_rssi, false, false); -#else - p_phy_info->signal_strength = (u8)(odm_signal_scale_mapping(p_dm_odm, avg_rssi)); -#endif - } - } -#endif - p_dm_odm->rx_pwdb_ave = p_dm_odm->rx_pwdb_ave + p_phy_info->rx_pwdb_all; - - p_dm_odm->dm_fat_table.antsel_rx_keep_0 = p_phy_sta_rpt->antidx_anta; - p_dm_odm->dm_fat_table.antsel_rx_keep_1 = p_phy_sta_rpt->antidx_antb; - p_dm_odm->dm_fat_table.antsel_rx_keep_2 = p_phy_sta_rpt->antidx_antc; - p_dm_odm->dm_fat_table.antsel_rx_keep_3 = p_phy_sta_rpt->antidx_antd; - /*ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("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_odm, - u8 station_id -) -{ - struct sta_info *p_entry; -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) - struct _ADAPTER *adapter = p_dm_odm->adapter; - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); -#endif - - p_entry = p_dm_odm->p_odm_sta_info[station_id]; - - if (!IS_STA_VALID(p_entry)) { - /**/ - return; - } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("Reset RSSI for macid = (( %d ))\n", station_id)); - - - p_entry->rssi_stat.undecorated_smoothed_cck = -1; - p_entry->rssi_stat.undecorated_smoothed_ofdm = -1; - p_entry->rssi_stat.undecorated_smoothed_pwdb = -1; - p_entry->rssi_stat.ofdm_pkt = 0; - p_entry->rssi_stat.cck_pkt = 0; - p_entry->rssi_stat.cck_sum_power = 0; - p_entry->rssi_stat.is_send_rssi = RA_RSSI_STATE_INIT; - p_entry->rssi_stat.packet_map = 0; - p_entry->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_entry->bUsed = 0; - if (station_id == 0) { - - p_hal_data->UndecoratedSmoothedPWDB = -1; - /**/ - } -#endif - -} - -void -odm_init_rssi_for_dm( - struct PHY_DM_STRUCT *p_dm_odm -) -{ - -} - -void -odm_process_rssi_for_dm( - struct PHY_DM_STRUCT *p_dm_odm, - struct _odm_phy_status_info_ *p_phy_info, - struct _odm_per_pkt_info_ *p_pktinfo -) -{ - - s32 undecorated_smoothed_pwdb, undecorated_smoothed_cck, undecorated_smoothed_ofdm, rssi_ave, cck_pkt; - u8 i, is_cck_rate = 0; - u8 RSSI_max, RSSI_min; - u32 weighting = 0; - u8 send_rssi_2_fw = 0; - struct sta_info *p_entry; -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) - struct _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; - struct _ADAPTER *adapter = p_dm_odm->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_odm, p_phy_info, p_pktinfo); -#endif - - /* */ - /* 2012/05/30 MH/Luke.Lee Add some description */ - /* In windows driver: AP/IBSS mode STA */ - /* */ - /* if (p_dm_odm->support_platform == ODM_WIN) */ - /* { */ - /* p_entry = p_dm_odm->p_odm_sta_info[p_dm_odm->pAidMap[p_pktinfo->station_id-1]]; */ - /* } */ - /* else */ - p_entry = p_dm_odm->p_odm_sta_info[p_pktinfo->station_id]; - - if (!IS_STA_VALID(p_entry)) { - return; - /**/ - } - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) - if ((p_dm_odm->support_ability & ODM_BB_ANT_DIV) && - (p_dm_fat_table->enable_ctrl_frame_antdiv) - ) { - if (p_pktinfo->is_packet_match_bssid) - p_dm_odm->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_odm->phy_dbg_info.num_qry_beacon_pkt++; - - is_cck_rate = (p_pktinfo->data_rate <= ODM_RATE11M) ? true : false; - p_dm_odm->rx_rate = p_pktinfo->data_rate; - - /* --------------Statistic for antenna/path diversity------------------ */ - if (p_dm_odm->support_ability & ODM_BB_ANT_DIV) { -#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) - odm_process_rssi_for_ant_div(p_dm_odm, p_phy_info, p_pktinfo); -#endif - } -#if (defined(CONFIG_PATH_DIVERSITY)) - else if (p_dm_odm->support_ability & ODM_BB_PATH_DIV) - phydm_process_rssi_for_path_div(p_dm_odm, p_phy_info, p_pktinfo); -#endif - /* -----------------Smart Antenna Debug Message------------------ */ - - undecorated_smoothed_cck = p_entry->rssi_stat.undecorated_smoothed_cck; - undecorated_smoothed_ofdm = p_entry->rssi_stat.undecorated_smoothed_ofdm; - undecorated_smoothed_pwdb = p_entry->rssi_stat.undecorated_smoothed_pwdb; - - 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_odm->support_ic_type & (ODM_RTL8814A | ODM_RTL8822B)) { - u8 RX_count = 0; - u32 RSSI_linear = 0; - - if (p_dm_odm->rx_ant_status & ODM_RF_A) { - p_dm_odm->RSSI_A = p_phy_info->rx_mimo_signal_strength[ODM_RF_PATH_A]; - RX_count++; - RSSI_linear += odm_convert_to_linear(p_phy_info->rx_mimo_signal_strength[ODM_RF_PATH_A]); - } else - p_dm_odm->RSSI_A = 0; - - if (p_dm_odm->rx_ant_status & ODM_RF_B) { - p_dm_odm->RSSI_B = p_phy_info->rx_mimo_signal_strength[ODM_RF_PATH_B]; - RX_count++; - RSSI_linear += odm_convert_to_linear(p_phy_info->rx_mimo_signal_strength[ODM_RF_PATH_B]); - } else - p_dm_odm->RSSI_B = 0; - - if (p_dm_odm->rx_ant_status & ODM_RF_C) { - p_dm_odm->RSSI_C = p_phy_info->rx_mimo_signal_strength[ODM_RF_PATH_C]; - RX_count++; - RSSI_linear += odm_convert_to_linear(p_phy_info->rx_mimo_signal_strength[ODM_RF_PATH_C]); - } else - p_dm_odm->RSSI_C = 0; - - if (p_dm_odm->rx_ant_status & ODM_RF_D) { - p_dm_odm->RSSI_D = p_phy_info->rx_mimo_signal_strength[ODM_RF_PATH_D]; - RX_count++; - RSSI_linear += odm_convert_to_linear(p_phy_info->rx_mimo_signal_strength[ODM_RF_PATH_D]); - } else - p_dm_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_convert_to_db(RSSI_linear); - } else -#endif - { - if (p_phy_info->rx_mimo_signal_strength[ODM_RF_PATH_B] == 0) { - rssi_ave = p_phy_info->rx_mimo_signal_strength[ODM_RF_PATH_A]; - p_dm_odm->RSSI_A = p_phy_info->rx_mimo_signal_strength[ODM_RF_PATH_A]; - p_dm_odm->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_odm->RSSI_A = p_phy_info->rx_mimo_signal_strength[ODM_RF_PATH_A]; - p_dm_odm->RSSI_B = p_phy_info->rx_mimo_signal_strength[ODM_RF_PATH_B]; - - if (p_phy_info->rx_mimo_signal_strength[ODM_RF_PATH_A] > p_phy_info->rx_mimo_signal_strength[ODM_RF_PATH_B]) { - RSSI_max = p_phy_info->rx_mimo_signal_strength[ODM_RF_PATH_A]; - RSSI_min = p_phy_info->rx_mimo_signal_strength[ODM_RF_PATH_B]; - } else { - RSSI_max = p_phy_info->rx_mimo_signal_strength[ODM_RF_PATH_B]; - RSSI_min = p_phy_info->rx_mimo_signal_strength[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 (undecorated_smoothed_ofdm <= 0) { /* initialize */ - undecorated_smoothed_ofdm = p_phy_info->rx_pwdb_all; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("OFDM_INIT: (( %d ))\n", undecorated_smoothed_ofdm)); - } else { - if (p_phy_info->rx_pwdb_all > (u32)undecorated_smoothed_ofdm) { - undecorated_smoothed_ofdm = - (((undecorated_smoothed_ofdm)*(RX_SMOOTH_FACTOR - 1)) + - (rssi_ave)) / (RX_SMOOTH_FACTOR); - undecorated_smoothed_ofdm = undecorated_smoothed_ofdm + 1; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("OFDM_1: (( %d ))\n", undecorated_smoothed_ofdm)); - } else { - undecorated_smoothed_ofdm = - (((undecorated_smoothed_ofdm)*(RX_SMOOTH_FACTOR - 1)) + - (rssi_ave)) / (RX_SMOOTH_FACTOR); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("OFDM_2: (( %d ))\n", undecorated_smoothed_ofdm)); - } - } - if (p_entry->rssi_stat.ofdm_pkt != 64) { - i = 63; - p_entry->rssi_stat.ofdm_pkt -= (u8)(((p_entry->rssi_stat.packet_map >> i) & BIT(0)) - 1); - } - p_entry->rssi_stat.packet_map = (p_entry->rssi_stat.packet_map << 1) | BIT(0); - - } else { - rssi_ave = p_phy_info->rx_pwdb_all; - p_dm_odm->RSSI_A = (u8) p_phy_info->rx_pwdb_all; - p_dm_odm->RSSI_B = 0xFF; - p_dm_odm->RSSI_C = 0xFF; - p_dm_odm->RSSI_D = 0xFF; - - if (p_entry->rssi_stat.cck_pkt <= 63) - p_entry->rssi_stat.cck_pkt++; - - /* 1 Process CCK RSSI */ - if (undecorated_smoothed_cck <= 0) { /* initialize */ - undecorated_smoothed_cck = p_phy_info->rx_pwdb_all; - p_entry->rssi_stat.cck_sum_power = (u16)p_phy_info->rx_pwdb_all ; /*reset*/ - p_entry->rssi_stat.cck_pkt = 1; /*reset*/ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("CCK_INIT: (( %d ))\n", undecorated_smoothed_cck)); - } else if (p_entry->rssi_stat.cck_pkt <= CCK_RSSI_INIT_COUNT) { - - p_entry->rssi_stat.cck_sum_power = p_entry->rssi_stat.cck_sum_power + (u16)p_phy_info->rx_pwdb_all; - undecorated_smoothed_cck = p_entry->rssi_stat.cck_sum_power / p_entry->rssi_stat.cck_pkt; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("CCK_0: (( %d )), SumPow = (( %d )), cck_pkt = (( %d ))\n", - undecorated_smoothed_cck, p_entry->rssi_stat.cck_sum_power, p_entry->rssi_stat.cck_pkt)); - } else { - if (p_phy_info->rx_pwdb_all > (u32)undecorated_smoothed_cck) { - undecorated_smoothed_cck = - (((undecorated_smoothed_cck)*(RX_SMOOTH_FACTOR - 1)) + - (p_phy_info->rx_pwdb_all)) / (RX_SMOOTH_FACTOR); - undecorated_smoothed_cck = undecorated_smoothed_cck + 1; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("CCK_1: (( %d ))\n", undecorated_smoothed_cck)); - } else { - undecorated_smoothed_cck = - (((undecorated_smoothed_cck)*(RX_SMOOTH_FACTOR - 1)) + - (p_phy_info->rx_pwdb_all)) / (RX_SMOOTH_FACTOR); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("CCK_2: (( %d ))\n", undecorated_smoothed_cck)); - } - } - i = 63; - p_entry->rssi_stat.ofdm_pkt -= (u8)((p_entry->rssi_stat.packet_map >> i) & BIT(0)); - p_entry->rssi_stat.packet_map = p_entry->rssi_stat.packet_map << 1; - } - - /* if(p_entry) */ - { - /* 2011.07.28 LukeLee: modified to prevent unstable CCK RSSI */ - if (p_entry->rssi_stat.ofdm_pkt == 64) { /* speed up when all packets are OFDM*/ - undecorated_smoothed_pwdb = undecorated_smoothed_ofdm; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("PWDB_0[%d] = (( %d ))\n", p_pktinfo->station_id, undecorated_smoothed_cck)); - } else { - if (p_entry->rssi_stat.valid_bit < 64) - p_entry->rssi_stat.valid_bit++; - - if (p_entry->rssi_stat.valid_bit == 64) { - weighting = ((p_entry->rssi_stat.ofdm_pkt) > 4) ? 64 : (p_entry->rssi_stat.ofdm_pkt << 4); - undecorated_smoothed_pwdb = (weighting * undecorated_smoothed_ofdm + (64 - weighting) * undecorated_smoothed_cck) >> 6; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("PWDB_1[%d] = (( %d )), W = (( %d ))\n", p_pktinfo->station_id, undecorated_smoothed_cck, weighting)); - } else { - if (p_entry->rssi_stat.valid_bit != 0) - undecorated_smoothed_pwdb = (p_entry->rssi_stat.ofdm_pkt * undecorated_smoothed_ofdm + (p_entry->rssi_stat.valid_bit - p_entry->rssi_stat.ofdm_pkt) * undecorated_smoothed_cck) / p_entry->rssi_stat.valid_bit; - else - undecorated_smoothed_pwdb = 0; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("PWDB_2[%d] = (( %d )), ofdm_pkt = (( %d )), Valid_Bit = (( %d ))\n", p_pktinfo->station_id, undecorated_smoothed_cck, p_entry->rssi_stat.ofdm_pkt, p_entry->rssi_stat.valid_bit)); - } - } - - - if ((p_entry->rssi_stat.ofdm_pkt >= 1 || p_entry->rssi_stat.cck_pkt >= 5) && (p_entry->rssi_stat.is_send_rssi == RA_RSSI_STATE_INIT)) { - - send_rssi_2_fw = 1; - p_entry->rssi_stat.is_send_rssi = RA_RSSI_STATE_SEND; - } - - p_entry->rssi_stat.undecorated_smoothed_cck = undecorated_smoothed_cck; - p_entry->rssi_stat.undecorated_smoothed_ofdm = undecorated_smoothed_ofdm; - p_entry->rssi_stat.undecorated_smoothed_pwdb = undecorated_smoothed_pwdb; - - - - if (send_rssi_2_fw) { /* Trigger init rate by RSSI */ - - if (p_entry->rssi_stat.ofdm_pkt != 0) - p_entry->rssi_stat.undecorated_smoothed_pwdb = undecorated_smoothed_ofdm; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("[Send to FW] PWDB = (( %d )), ofdm_pkt = (( %d )), cck_pkt = (( %d ))\n", - undecorated_smoothed_pwdb, p_entry->rssi_stat.ofdm_pkt, p_entry->rssi_stat.cck_pkt)); - -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - phydm_ra_rssi_rpt_wk(p_dm_odm); -#endif - } - - - /*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, 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); */ - - } - - } -} - - -#if (ODM_IC_11N_SERIES_SUPPORT == 1) -/* - * Endianness before calling this API - * */ -void -odm_phy_status_query_92c_series( - struct PHY_DM_STRUCT *p_dm_odm, - struct _odm_phy_status_info_ *p_phy_info, - u8 *p_phy_status, - struct _odm_per_pkt_info_ *p_pktinfo -) -{ - odm_rx_phy_status92c_series_parsing(p_dm_odm, p_phy_info, p_phy_status, p_pktinfo); - odm_process_rssi_for_dm(p_dm_odm, p_phy_info, p_pktinfo); -} -#endif - - -/* - * Endianness before calling this API - * */ -#if ODM_IC_11AC_SERIES_SUPPORT - -void -odm_phy_status_query_jaguar_series( - struct PHY_DM_STRUCT *p_dm_odm, - struct _odm_phy_status_info_ *p_phy_info, - u8 *p_phy_status, - struct _odm_per_pkt_info_ *p_pktinfo -) -{ - odm_rx_phy_status_jaguar_series_parsing(p_dm_odm, p_phy_info, p_phy_status, p_pktinfo); - odm_process_rssi_for_dm(p_dm_odm, p_phy_info, p_pktinfo); - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - /*phydm_sbd_check(p_dm_odm);*/ -#endif -} -#endif - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -void -phydm_normal_driver_rx_sniffer( - struct PHY_DM_STRUCT *p_dm_odm, - 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 _FAST_ANTENNA_TRAINNING_ *p_dm_fat_table = &p_dm_odm->dm_fat_table; - - if (p_rt_rfd_status->packet_report_type != NORMAL_RX) - return; - - if (!p_dm_odm->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_odm->rx_pkt_type == type_block_ack) || (p_dm_odm->rx_pkt_type == type_rts) || (p_dm_odm->rx_pkt_type == type_cts)) - seq_num = 0; - else - seq_num = p_rt_rfd_status->seq_num; - - ODM_RT_TRACE_F(p_dm_odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, ("%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_odm->rx_pkt_type == type_asoc_req) { - ODM_RT_TRACE_F(p_dm_odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "AS_REQ")); - /**/ - } else if (p_dm_odm->rx_pkt_type == type_asoc_rsp) { - ODM_RT_TRACE_F(p_dm_odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "AS_RSP")); - /**/ - } else if (p_dm_odm->rx_pkt_type == type_probe_req) { - ODM_RT_TRACE_F(p_dm_odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "PR_REQ")); - /**/ - } else if (p_dm_odm->rx_pkt_type == type_probe_rsp) { - ODM_RT_TRACE_F(p_dm_odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "PR_RSP")); - /**/ - } else if (p_dm_odm->rx_pkt_type == type_deauth) { - ODM_RT_TRACE_F(p_dm_odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "DEAUTH")); - /**/ - } else if (p_dm_odm->rx_pkt_type == type_beacon) { - ODM_RT_TRACE_F(p_dm_odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "BEACON")); - /**/ - } else if (p_dm_odm->rx_pkt_type == type_block_ack_req) { - ODM_RT_TRACE_F(p_dm_odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "BA_REQ")); - /**/ - } else if (p_dm_odm->rx_pkt_type == type_rts) { - ODM_RT_TRACE_F(p_dm_odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "__RTS_")); - /**/ - } else if (p_dm_odm->rx_pkt_type == type_cts) { - ODM_RT_TRACE_F(p_dm_odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "__CTS_")); - /**/ - } else if (p_dm_odm->rx_pkt_type == type_ack) { - ODM_RT_TRACE_F(p_dm_odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "__ACK_")); - /**/ - } else if (p_dm_odm->rx_pkt_type == type_block_ack) { - ODM_RT_TRACE_F(p_dm_odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "__BA__")); - /**/ - } else if (p_dm_odm->rx_pkt_type == type_data) { - ODM_RT_TRACE_F(p_dm_odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "_DATA_")); - /**/ - } else if (p_dm_odm->rx_pkt_type == type_data_ack) { - ODM_RT_TRACE_F(p_dm_odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "Data_Ack")); - /**/ - } else if (p_dm_odm->rx_pkt_type == type_qos_data) { - ODM_RT_TRACE_F(p_dm_odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "QoS_Data")); - /**/ - } else { - ODM_RT_TRACE_F(p_dm_odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [0x%x]", p_dm_odm->rx_pkt_type)); - /**/ - } - - ODM_RT_TRACE_F(p_dm_odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [RSSI=%d,%d,%d,%d ]", - p_dm_odm->RSSI_A, - p_dm_odm->RSSI_B, - p_dm_odm->RSSI_C, - p_dm_odm->RSSI_D - )); - - p_msg = (u32 *)p_drv_info; - - ODM_RT_TRACE_F(p_dm_odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , 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 { - - ODM_RT_TRACE_F(p_dm_odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, ("%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 - -void -odm_phy_status_query( - struct PHY_DM_STRUCT *p_dm_odm, - struct _odm_phy_status_info_ *p_phy_info, - u8 *p_phy_status, - struct _odm_per_pkt_info_ *p_pktinfo -) -{ -#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) - if (p_dm_odm->support_ic_type & ODM_IC_PHY_STATUE_NEW_TYPE) { - phydm_rx_phy_status_new_type(p_dm_odm, p_phy_status, p_pktinfo, p_phy_info); - return; - } -#endif - -#if ODM_IC_11AC_SERIES_SUPPORT - if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) - odm_phy_status_query_jaguar_series(p_dm_odm, p_phy_info, p_phy_status, p_pktinfo); -#endif - -#if ODM_IC_11N_SERIES_SUPPORT - if (p_dm_odm->support_ic_type & ODM_IC_11N_SERIES) - odm_phy_status_query_92c_series(p_dm_odm, p_phy_info, p_phy_status, p_pktinfo); -#endif -} - -/* For future use. */ -void -odm_mac_status_query( - struct PHY_DM_STRUCT *p_dm_odm, - u8 *p_mac_status, - u8 mac_id, - bool is_packet_match_bssid, - bool is_packet_to_self, - bool is_packet_beacon -) -{ - /* 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. - * - * */ - enum hal_status -odm_config_rf_with_header_file( - struct PHY_DM_STRUCT *p_dm_odm, - enum odm_rf_config_type config_type, - enum odm_rf_radio_path_e e_rf_path -) +odm_config_rf_with_header_file(struct dm_struct *dm, + enum odm_rf_config_type config_type, + u8 e_rf_path) { #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - struct _ADAPTER *adapter = p_dm_odm->adapter; - PMGNT_INFO p_mgnt_info = &(adapter->MgntInfo); + void *adapter = dm->adapter; + PMGNT_INFO mgnt_info = &((PADAPTER)adapter)->MgntInfo; #endif + enum hal_status result = HAL_STATUS_SUCCESS; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, - ("===>odm_config_rf_with_header_file (%s)\n", (p_dm_odm->is_mp_chip) ? "MPChip" : "TestChip")); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, - ("p_dm_odm->support_platform: 0x%X, p_dm_odm->support_interface: 0x%X, p_dm_odm->board_type: 0x%X\n", - p_dm_odm->support_platform, p_dm_odm->support_interface, p_dm_odm->board_type)); + PHYDM_DBG(dm, ODM_COMP_INIT, "===>%s (%s)\n", __func__, + (dm->is_mp_chip) ? "MPChip" : "TestChip"); + PHYDM_DBG(dm, ODM_COMP_INIT, + "support_platform: 0x%X, support_interface: 0x%X, board_type: 0x%X\n", + dm->support_platform, dm->support_interface, dm->board_type); - /* 1 AP doesn't use PHYDM power tracking table in these ICs */ +/* @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_odm->support_ic_type == ODM_RTL8812) { + if (dm->support_ic_type == ODM_RTL8812) { if (config_type == CONFIG_RF_RADIO) { - if (e_rf_path == ODM_RF_PATH_A) + if (e_rf_path == RF_PATH_A) READ_AND_CONFIG_MP(8812a, _radioa); - else if (e_rf_path == ODM_RF_PATH_B) + 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)) + HAL_DATA_TYPE * hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + if ((hal_data->EEPROMSVID == 0x17AA && hal_data->EEPROMSMID == 0xA811) || + (hal_data->EEPROMSVID == 0x10EC && hal_data->EEPROMSMID == 0xA812) || + (hal_data->EEPROMSVID == 0x10EC && hal_data->EEPROMSMID == 0x8812)) READ_AND_CONFIG_MP(8812a, _txpwr_lmt_hm812a03); else #endif @@ -1983,43 +95,42 @@ odm_config_rf_with_header_file( } #endif #if (RTL8821A_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8821) { + if (dm->support_ic_type == ODM_RTL8821) { if (config_type == CONFIG_RF_RADIO) { - if (e_rf_path == ODM_RF_PATH_A) + if (e_rf_path == RF_PATH_A) READ_AND_CONFIG_MP(8821a, _radioa); } else if (config_type == CONFIG_RF_TXPWR_LMT) { - if (p_dm_odm->support_interface == ODM_ITRF_USB) { - if (p_dm_odm->ext_pa_5g || p_dm_odm->ext_lna_5g) + if (dm->support_interface == ODM_ITRF_USB) { + if (dm->ext_pa_5g || 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) + if (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) + else if (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); } } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("<===8821_ODM_ConfigRFWithHeaderFile\n")); } #endif #if (RTL8192E_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8192E) { + if (dm->support_ic_type == ODM_RTL8192E) { if (config_type == CONFIG_RF_RADIO) { - if (e_rf_path == ODM_RF_PATH_A) + if (e_rf_path == RF_PATH_A) READ_AND_CONFIG_MP(8192e, _radioa); - else if (e_rf_path == ODM_RF_PATH_B) + 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 (DM_ODM_SUPPORT_TYPE & ODM_WIN) && (DEV_BUS_TYPE == RT_PCI_INTERFACE) /*Refine by Vincent Lan for 5mm SAR pwr limit*/ + HAL_DATA_TYPE * hal_data = GET_HAL_DATA(((PADAPTER)adapter)); - if ((p_hal_data->EEPROMSVID == 0x11AD && p_hal_data->EEPROMSMID == 0x8192) || - (p_hal_data->EEPROMSVID == 0x11AD && p_hal_data->EEPROMSMID == 0x8193)) + if ((hal_data->EEPROMSVID == 0x11AD && hal_data->EEPROMSMID == 0x8192) || + (hal_data->EEPROMSVID == 0x11AD && hal_data->EEPROMSMID == 0x8193)) READ_AND_CONFIG_MP(8192e, _txpwr_lmt_8192e_sar_5mm); else #endif @@ -2028,28 +139,39 @@ odm_config_rf_with_header_file( } #endif #if (RTL8723D_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8723D) { + if (dm->support_ic_type == ODM_RTL8723D) { if (config_type == CONFIG_RF_RADIO) { - if (e_rf_path == ODM_RF_PATH_A) + if (e_rf_path == RF_PATH_A) READ_AND_CONFIG_MP(8723d, _radioa); - } else if (config_type == CONFIG_RF_TXPWR_LMT) + } else if (config_type == 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 (p_dm_odm->support_ic_type == ODM_RTL8188E) { +/* @JJ ADD 20161014 */ +#if (RTL8710B_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8710B) { if (config_type == CONFIG_RF_RADIO) { - if (e_rf_path == ODM_RF_PATH_A) + 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 (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_odm->support_ic_type == ODM_RTL8723B) { + if (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) @@ -2057,61 +179,79 @@ odm_config_rf_with_header_file( } #endif #if (RTL8814A_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8814A) { + if (dm->support_ic_type == ODM_RTL8814A) { if (config_type == CONFIG_RF_RADIO) { - if (e_rf_path == ODM_RF_PATH_A) + if (e_rf_path == RF_PATH_A) READ_AND_CONFIG_MP(8814a, _radioa); - else if (e_rf_path == ODM_RF_PATH_B) + else if (e_rf_path == RF_PATH_B) READ_AND_CONFIG_MP(8814a, _radiob); - else if (e_rf_path == ODM_RF_PATH_C) + else if (e_rf_path == RF_PATH_C) READ_AND_CONFIG_MP(8814a, _radioc); - else if (e_rf_path == ODM_RF_PATH_D) + 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_odm->rfe_type == 0) - READ_AND_CONFIG_MP(8814a,_txpwr_lmt); - else if (p_dm_odm->rfe_type == 1) - READ_AND_CONFIG_MP(8814a,_txpwr_lmt_type1); - else if (p_dm_odm->rfe_type == 2) - READ_AND_CONFIG_MP(8814a,_txpwr_lmt_type2); - else if (p_dm_odm->rfe_type == 3) - READ_AND_CONFIG_MP(8814a,_txpwr_lmt_type3); - else if (p_dm_odm->rfe_type == 5) - READ_AND_CONFIG_MP(8814a,_txpwr_lmt_type5); - else if (p_dm_odm->rfe_type == 7) - READ_AND_CONFIG_MP(8814a,_txpwr_lmt_type7); + if (dm->rfe_type == 0) + READ_AND_CONFIG_MP(8814a, _txpwr_lmt_type0); + else if (dm->rfe_type == 1) + READ_AND_CONFIG_MP(8814a, _txpwr_lmt_type1); + else if (dm->rfe_type == 2) + READ_AND_CONFIG_MP(8814a, _txpwr_lmt_type2); + else if (dm->rfe_type == 3) + READ_AND_CONFIG_MP(8814a, _txpwr_lmt_type3); + else if (dm->rfe_type == 5) + READ_AND_CONFIG_MP(8814a, _txpwr_lmt_type5); + else if (dm->rfe_type == 7) + READ_AND_CONFIG_MP(8814a, _txpwr_lmt_type7); + else if (dm->rfe_type == 8) + READ_AND_CONFIG_MP(8814a, _txpwr_lmt_type8); else - READ_AND_CONFIG_MP(8814a,_txpwr_lmt); + READ_AND_CONFIG_MP(8814a, _txpwr_lmt); } } #endif #if (RTL8703B_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8703B) { + if (dm->support_ic_type == ODM_RTL8703B) { if (config_type == CONFIG_RF_RADIO) { - if (e_rf_path == ODM_RF_PATH_A) + if (e_rf_path == RF_PATH_A) READ_AND_CONFIG_MP(8703b, _radioa); } } #endif #if (RTL8188F_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8188F) { + if (dm->support_ic_type == ODM_RTL8188F) { if (config_type == CONFIG_RF_RADIO) { - if (e_rf_path == ODM_RF_PATH_A) + 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_odm->support_ic_type == ODM_RTL8822B) { + if (dm->support_ic_type == ODM_RTL8822B) { if (config_type == CONFIG_RF_RADIO) { - if (e_rf_path == ODM_RF_PATH_A) + if (e_rf_path == RF_PATH_A) READ_AND_CONFIG_MP(8822b, _radioa); - else if (e_rf_path == ODM_RF_PATH_B) + 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_odm->rfe_type == 5) + if (dm->rfe_type == 5) READ_AND_CONFIG_MP(8822b, _txpwr_lmt_type5); + else if (dm->rfe_type == 2) + READ_AND_CONFIG_MP(8822b, _txpwr_lmt_type2); + else if (dm->rfe_type == 3) + READ_AND_CONFIG_MP(8822b, _txpwr_lmt_type3); + else if (dm->rfe_type == 4) + READ_AND_CONFIG_MP(8822b, _txpwr_lmt_type4); + else if (dm->rfe_type == 12) + READ_AND_CONFIG_MP(8822b, _txpwr_lmt_type12); + else if (dm->rfe_type == 15) + READ_AND_CONFIG_MP(8822b, _txpwr_lmt_type15); + else if (dm->rfe_type == 16) + READ_AND_CONFIG_MP(8822b, _txpwr_lmt_type16); + else if (dm->rfe_type == 17) + READ_AND_CONFIG_MP(8822b, _txpwr_lmt_type17); + else if (dm->rfe_type == 18) + READ_AND_CONFIG_MP(8822b, _txpwr_lmt_type18); else READ_AND_CONFIG_MP(8822b, _txpwr_lmt); } @@ -2119,129 +259,326 @@ odm_config_rf_with_header_file( #endif #if (RTL8197F_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8197F) { + if (dm->support_ic_type == ODM_RTL8197F) { if (config_type == CONFIG_RF_RADIO) { - if (e_rf_path == ODM_RF_PATH_A) + if (e_rf_path == RF_PATH_A) READ_AND_CONFIG_MP(8197f, _radioa); - else if (e_rf_path == ODM_RF_PATH_B) + else if (e_rf_path == RF_PATH_B) READ_AND_CONFIG_MP(8197f, _radiob); } } #endif - -#if (RTL8821C_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8821C) { +/*@jj add 20170822*/ +#if (RTL8192F_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8192F) { if (config_type == CONFIG_RF_RADIO) { - if (e_rf_path == ODM_RF_PATH_A) - READ_AND_CONFIG(8821c, _radioa); + if (e_rf_path == RF_PATH_A) + READ_AND_CONFIG_MP(8192f, _radioa); + else if (e_rf_path == RF_PATH_B) + READ_AND_CONFIG_MP(8192f, _radiob); + } else if (config_type == CONFIG_RF_TXPWR_LMT) { + if (dm->rfe_type == 0) + READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type0); + else if (dm->rfe_type == 1) + READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type1); + else if (dm->rfe_type == 2) + READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type2); + else if (dm->rfe_type == 3) + READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type3); + else if (dm->rfe_type == 4) + READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type4); + else if (dm->rfe_type == 5) + READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type5); + else if (dm->rfe_type == 6) + READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type6); + else if (dm->rfe_type == 7) + READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type7); + else if (dm->rfe_type == 8) + READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type8); + else if (dm->rfe_type == 9) + READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type9); + else if (dm->rfe_type == 10) + READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type10); + else if (dm->rfe_type == 11) + READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type11); + else if (dm->rfe_type == 12) + READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type12); + else if (dm->rfe_type == 13) + READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type13); + else if (dm->rfe_type == 14) + READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type14); + else if (dm->rfe_type == 15) + READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type15); + else if (dm->rfe_type == 16) + READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type16); + else if (dm->rfe_type == 17) + READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type17); + else if (dm->rfe_type == 18) + READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type18); + else if (dm->rfe_type == 19) + READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type19); + else if (dm->rfe_type == 20) + READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type20); + else if (dm->rfe_type == 21) + READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type21); + else if (dm->rfe_type == 22) + READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type22); + else if (dm->rfe_type == 23) + READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type23); + else if (dm->rfe_type == 24) + READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type24); + else if (dm->rfe_type == 25) + READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type25); + else if (dm->rfe_type == 26) + READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type26); + else if (dm->rfe_type == 27) + READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type27); + else if (dm->rfe_type == 28) + READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type28); + else if (dm->rfe_type == 29) + READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type29); + else if (dm->rfe_type == 30) + READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type30); + else if (dm->rfe_type == 31) + READ_AND_CONFIG_MP(8192f, _txpwr_lmt_type31); + else + READ_AND_CONFIG_MP(8192f, _txpwr_lmt); + } + } +#endif +#if (RTL8721D_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8721D) { + if (config_type == CONFIG_RF_RADIO) { + if (e_rf_path == RF_PATH_A) + READ_AND_CONFIG_MP(8721d, _radioa); } else if (config_type == CONFIG_RF_TXPWR_LMT) + READ_AND_CONFIG_MP(8721d, _txpwr_lmt); + } +#endif +#if (RTL8821C_SUPPORT == 1) + if (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 (RTL8195B_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8195B) { + if (config_type == CONFIG_RF_RADIO) { + if (e_rf_path == RF_PATH_A) + READ_AND_CONFIG(8195b, _radioa); + } + #if 0 + else if (config_type == CONFIG_RF_TXPWR_LMT) { + READ_AND_CONFIG(8821c, _txpwr_lmt); + /*@*/ + } + #endif + } +#endif +#if (RTL8198F_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8198F) { + if (config_type == CONFIG_RF_RADIO) { + if (e_rf_path == RF_PATH_A) + READ_AND_CONFIG_MP(8198f, _radioa); + else if (e_rf_path == RF_PATH_B) + READ_AND_CONFIG_MP(8198f, _radiob); + else if (e_rf_path == RF_PATH_C) + READ_AND_CONFIG_MP(8198f, _radioc); + else if (e_rf_path == RF_PATH_D) + READ_AND_CONFIG_MP(8198f, _radiod); + } + } +#endif +/*#if (RTL8814B_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8814B) { + if (config_type == CONFIG_RF_RADIO) { + if (e_rf_path == RF_PATH_A) + READ_AND_CONFIG_MP(8814b, _radioa); + else if (e_rf_path == RF_PATH_B) + READ_AND_CONFIG_MP(8814b, _radiob); + else if (e_rf_path == RF_PATH_C) + READ_AND_CONFIG_MP(8814b, _radioc); + else if (e_rf_path == RF_PATH_D) + READ_AND_CONFIG_MP(8814b, _radiod); + } + } +#endif +*/ +#if (RTL8822C_SUPPORT) + if (dm->support_ic_type == ODM_RTL8822C) { + if (config_type == CONFIG_RF_RADIO) { + if (e_rf_path == RF_PATH_A) + READ_AND_CONFIG_MP(8822c, _radioa); + else if (e_rf_path == RF_PATH_B) + READ_AND_CONFIG_MP(8822c, _radiob); + } else if (config_type == CONFIG_RF_TXPWR_LMT) { + READ_AND_CONFIG_MP(8822c, _txpwr_lmt); + } + } +#endif +#if (RTL8812F_SUPPORT) + if (dm->support_ic_type == ODM_RTL8812F) { + if (config_type == CONFIG_RF_RADIO) { + if (e_rf_path == RF_PATH_A) + READ_AND_CONFIG_MP(8812f, _radioa); + else if (e_rf_path == RF_PATH_B) + READ_AND_CONFIG_MP(8812f, _radiob); + } } #endif - return HAL_STATUS_SUCCESS; + /*8814B need review, when phydm has related files*/ + #if (RTL8814B_SUPPORT) + if (dm->support_ic_type == ODM_RTL8814B) { + if (config_type == CONFIG_RF_RADIO) { + if (e_rf_path == RF_PATH_A) + READ_AND_CONFIG_MP(8814b, _radioa); + else if (e_rf_path == RF_PATH_B) + READ_AND_CONFIG_MP(8814b, _radiob); + else if (e_rf_path == RF_PATH_C) + READ_AND_CONFIG_MP(8814b, _radioc); + else if (e_rf_path == RF_PATH_D) + READ_AND_CONFIG_MP(8814b, _radiod); + } + if (config_type == CONFIG_RF_SYN_RADIO) { + if (e_rf_path == RF_SYN0) + READ_AND_CONFIG_MP(8814b, _radiosyn0); + else if (e_rf_path == RF_SYN1) + READ_AND_CONFIG_MP(8814b, _radiosyn1); + } + } + #endif + + if (config_type == CONFIG_RF_RADIO) { + if (dm->fw_offload_ability & PHYDM_PHY_PARAM_OFFLOAD) { + result = phydm_set_reg_by_fw(dm, + PHYDM_HALMAC_CMD_END, + 0, + 0, + 0, + (enum rf_path)0, + 0); + PHYDM_DBG(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_odm -) +odm_config_rf_with_tx_pwr_track_header_file(struct dm_struct *dm) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, - ("===>odm_config_rf_with_tx_pwr_track_header_file (%s)\n", (p_dm_odm->is_mp_chip) ? "MPChip" : "TestChip")); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, - ("p_dm_odm->support_platform: 0x%X, p_dm_odm->support_interface: 0x%X, p_dm_odm->board_type: 0x%X\n", - p_dm_odm->support_platform, p_dm_odm->support_interface, p_dm_odm->board_type)); + PHYDM_DBG(dm, ODM_COMP_INIT, "===>%s (%s)\n", __func__, + (dm->is_mp_chip) ? "MPChip" : "TestChip"); + PHYDM_DBG(dm, ODM_COMP_INIT, + "support_platform: 0x%X, support_interface: 0x%X, board_type: 0x%X\n", + dm->support_platform, dm->support_interface, dm->board_type); - - /* 1 AP doesn't use PHYDM power tracking table in these ICs */ +/* @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_odm->support_ic_type == ODM_RTL8821) { - if (p_dm_odm->support_interface == ODM_ITRF_PCIE) + if (dm->support_ic_type == ODM_RTL8821) { + if (dm->support_interface == ODM_ITRF_PCIE) READ_AND_CONFIG_MP(8821a, _txpowertrack_pcie); - else if (p_dm_odm->support_interface == ODM_ITRF_USB) + else if (dm->support_interface == ODM_ITRF_USB) READ_AND_CONFIG_MP(8821a, _txpowertrack_usb); - else if (p_dm_odm->support_interface == ODM_ITRF_SDIO) + else if (dm->support_interface == ODM_ITRF_SDIO) READ_AND_CONFIG_MP(8821a, _txpowertrack_sdio); } #endif #if RTL8812A_SUPPORT - if (p_dm_odm->support_ic_type == ODM_RTL8812) { - if (p_dm_odm->support_interface == ODM_ITRF_PCIE) + if (dm->support_ic_type == ODM_RTL8812) { + if (dm->support_interface == ODM_ITRF_PCIE) READ_AND_CONFIG_MP(8812a, _txpowertrack_pcie); - else if (p_dm_odm->support_interface == ODM_ITRF_USB) { - if (p_dm_odm->rfe_type == 3 && p_dm_odm->is_mp_chip) + else if (dm->support_interface == ODM_ITRF_USB) { + if (dm->rfe_type == 3 && 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_odm->support_ic_type == ODM_RTL8192E) { - if (p_dm_odm->support_interface == ODM_ITRF_PCIE) + if (dm->support_ic_type == ODM_RTL8192E) { + if (dm->support_interface == ODM_ITRF_PCIE) READ_AND_CONFIG_MP(8192e, _txpowertrack_pcie); - else if (p_dm_odm->support_interface == ODM_ITRF_USB) + else if (dm->support_interface == ODM_ITRF_USB) READ_AND_CONFIG_MP(8192e, _txpowertrack_usb); - else if (p_dm_odm->support_interface == ODM_ITRF_SDIO) + else if (dm->support_interface == ODM_ITRF_SDIO) READ_AND_CONFIG_MP(8192e, _txpowertrack_sdio); } #endif #if RTL8723D_SUPPORT - if (p_dm_odm->support_ic_type == ODM_RTL8723D) { - if (p_dm_odm->support_interface == ODM_ITRF_PCIE) + if (dm->support_ic_type == ODM_RTL8723D) { + if (dm->support_interface == ODM_ITRF_PCIE) READ_AND_CONFIG_MP(8723d, _txpowertrack_pcie); - else if (p_dm_odm->support_interface == ODM_ITRF_USB) + else if (dm->support_interface == ODM_ITRF_USB) READ_AND_CONFIG_MP(8723d, _txpowertrack_usb); - else if (p_dm_odm->support_interface == ODM_ITRF_SDIO) + else if (dm->support_interface == ODM_ITRF_SDIO) READ_AND_CONFIG_MP(8723d, _txpowertrack_sdio); READ_AND_CONFIG_MP(8723d, _txxtaltrack); } #endif -#if RTL8188E_SUPPORT - if (p_dm_odm->support_ic_type == ODM_RTL8188E) { - if (odm_get_mac_reg(p_dm_odm, 0xF0, 0xF000) >= 8) { /*if 0xF0[15:12] >= 8, SMIC*/ - if (p_dm_odm->support_interface == ODM_ITRF_PCIE) - READ_AND_CONFIG_MP(8188e, _txpowertrack_pcie_icut); - else if (p_dm_odm->support_interface == ODM_ITRF_USB) - READ_AND_CONFIG_MP(8188e, _txpowertrack_usb_icut); - else if (p_dm_odm->support_interface == ODM_ITRF_SDIO) - READ_AND_CONFIG_MP(8188e, _txpowertrack_sdio_icut); - } else { /*else 0xF0[15:12] < 8, TSMC*/ - if (p_dm_odm->support_interface == ODM_ITRF_PCIE) - READ_AND_CONFIG_MP(8188e, _txpowertrack_pcie); - else if (p_dm_odm->support_interface == ODM_ITRF_USB) - READ_AND_CONFIG_MP(8188e, _txpowertrack_usb); - else if (p_dm_odm->support_interface == ODM_ITRF_SDIO) - READ_AND_CONFIG_MP(8188e, _txpowertrack_sdio); - } +/* @JJ ADD 20161014 */ +#if RTL8710B_SUPPORT + if (dm->support_ic_type == ODM_RTL8710B) { + if (dm->package_type == 1) + READ_AND_CONFIG_MP(8710b, _txpowertrack_qfn48m_smic); + else if (dm->package_type == 5) + READ_AND_CONFIG_MP(8710b, _txpowertrack_qfn48m_umc); + READ_AND_CONFIG_MP(8710b, _txxtaltrack); } #endif -#endif/* (DM_ODM_SUPPORT_TYPE != ODM_AP) */ - - /* 1 All platforms support */ +#if RTL8188E_SUPPORT + if (dm->support_ic_type == ODM_RTL8188E) { + if (odm_get_mac_reg(dm, R_0xf0, 0xF000) >= 8) { /*@if 0xF0[15:12] >= 8, SMIC*/ + if (dm->support_interface == ODM_ITRF_PCIE) + READ_AND_CONFIG_MP(8188e, _txpowertrack_pcie_icut); + else if (dm->support_interface == ODM_ITRF_USB) + READ_AND_CONFIG_MP(8188e, _txpowertrack_usb_icut); + else if (dm->support_interface == ODM_ITRF_SDIO) + READ_AND_CONFIG_MP(8188e, _txpowertrack_sdio_icut); + } else { /*@else 0xF0[15:12] < 8, TSMC*/ + if (dm->support_interface == ODM_ITRF_PCIE) + READ_AND_CONFIG_MP(8188e, _txpowertrack_pcie); + else if (dm->support_interface == ODM_ITRF_USB) + READ_AND_CONFIG_MP(8188e, _txpowertrack_usb); + else if (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_odm->support_ic_type == ODM_RTL8723B) { - if (p_dm_odm->support_interface == ODM_ITRF_PCIE) + if (dm->support_ic_type == ODM_RTL8723B) { + if (dm->support_interface == ODM_ITRF_PCIE) READ_AND_CONFIG_MP(8723b, _txpowertrack_pcie); - else if (p_dm_odm->support_interface == ODM_ITRF_USB) + else if (dm->support_interface == ODM_ITRF_USB) READ_AND_CONFIG_MP(8723b, _txpowertrack_usb); - else if (p_dm_odm->support_interface == ODM_ITRF_SDIO) + else if (dm->support_interface == ODM_ITRF_SDIO) READ_AND_CONFIG_MP(8723b, _txpowertrack_sdio); } #endif #if RTL8814A_SUPPORT - if (p_dm_odm->support_ic_type == ODM_RTL8814A) { - if (p_dm_odm->rfe_type == 0) + if (dm->support_ic_type == ODM_RTL8814A) { + if (dm->rfe_type == 0) READ_AND_CONFIG_MP(8814a, _txpowertrack_type0); - else if (p_dm_odm->rfe_type == 2) + else if (dm->rfe_type == 2) READ_AND_CONFIG_MP(8814a, _txpowertrack_type2); - else if (p_dm_odm->rfe_type == 5) + else if (dm->rfe_type == 5) READ_AND_CONFIG_MP(8814a, _txpowertrack_type5); + else if (dm->rfe_type == 7) + READ_AND_CONFIG_MP(8814a, _txpowertrack_type7); + else if (dm->rfe_type == 8) + READ_AND_CONFIG_MP(8814a, _txpowertrack_type8); else READ_AND_CONFIG_MP(8814a, _txpowertrack); @@ -2249,101 +586,239 @@ odm_config_rf_with_tx_pwr_track_header_file( } #endif #if RTL8703B_SUPPORT - if (p_dm_odm->support_ic_type == ODM_RTL8703B) { - if (p_dm_odm->support_interface == ODM_ITRF_USB) + if (dm->support_ic_type == ODM_RTL8703B) { + if (dm->support_interface == ODM_ITRF_USB) READ_AND_CONFIG_MP(8703b, _txpowertrack_usb); - else if (p_dm_odm->support_interface == ODM_ITRF_SDIO) + else if (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_odm->support_ic_type == ODM_RTL8188F) { - if (p_dm_odm->support_interface == ODM_ITRF_USB) + if (dm->support_ic_type == ODM_RTL8188F) { + if (dm->support_interface == ODM_ITRF_USB) READ_AND_CONFIG_MP(8188f, _txpowertrack_usb); - else if (p_dm_odm->support_interface == ODM_ITRF_SDIO) + else if (dm->support_interface == ODM_ITRF_SDIO) READ_AND_CONFIG_MP(8188f, _txpowertrack_sdio); } #endif - #if RTL8822B_SUPPORT - if (p_dm_odm->support_ic_type == ODM_RTL8822B) { - if (p_dm_odm->rfe_type == 0) + if (dm->support_ic_type == ODM_RTL8822B) { + if (dm->rfe_type == 0) READ_AND_CONFIG_MP(8822b, _txpowertrack_type0); - else if (p_dm_odm->rfe_type == 1) + else if (dm->rfe_type == 1) READ_AND_CONFIG_MP(8822b, _txpowertrack_type1); - else if (p_dm_odm->rfe_type == 2) + else if (dm->rfe_type == 2) READ_AND_CONFIG_MP(8822b, _txpowertrack_type2); - else if ((p_dm_odm->rfe_type == 3) || (p_dm_odm->rfe_type == 5)) + else if ((dm->rfe_type == 3) || (dm->rfe_type == 5)) READ_AND_CONFIG_MP(8822b, _txpowertrack_type3_type5); - else if (p_dm_odm->rfe_type == 4) + else if (dm->rfe_type == 4) READ_AND_CONFIG_MP(8822b, _txpowertrack_type4); - else if (p_dm_odm->rfe_type == 6) + else if (dm->rfe_type == 6) READ_AND_CONFIG_MP(8822b, _txpowertrack_type6); - else if (p_dm_odm->rfe_type == 7) + else if (dm->rfe_type == 7) READ_AND_CONFIG_MP(8822b, _txpowertrack_type7); - else if (p_dm_odm->rfe_type == 8) + else if (dm->rfe_type == 8) READ_AND_CONFIG_MP(8822b, _txpowertrack_type8); - else if (p_dm_odm->rfe_type == 9) + else if (dm->rfe_type == 9) READ_AND_CONFIG_MP(8822b, _txpowertrack_type9); + else if (dm->rfe_type == 10) + READ_AND_CONFIG_MP(8822b, _txpowertrack_type10); + else if (dm->rfe_type == 11) + READ_AND_CONFIG_MP(8822b, _txpowertrack_type11); + else if (dm->rfe_type == 12) + READ_AND_CONFIG_MP(8822b, _txpowertrack_type12); + else if (dm->rfe_type == 13) + READ_AND_CONFIG_MP(8822b, _txpowertrack_type13); + else if (dm->rfe_type == 14) + READ_AND_CONFIG_MP(8822b, _txpowertrack_type14); + else if (dm->rfe_type == 15) + READ_AND_CONFIG_MP(8822b, _txpowertrack_type15); + else if (dm->rfe_type == 16) + READ_AND_CONFIG_MP(8822b, _txpowertrack_type16); + else if (dm->rfe_type == 17) + READ_AND_CONFIG_MP(8822b, _txpowertrack_type17); + else if (dm->rfe_type == 18) + READ_AND_CONFIG_MP(8822b, _txpowertrack_type18); else READ_AND_CONFIG_MP(8822b, _txpowertrack); } #endif - #if RTL8197F_SUPPORT - if (p_dm_odm->support_ic_type == ODM_RTL8197F) { - if (p_dm_odm->rfe_type == 0) + if (dm->support_ic_type == ODM_RTL8197F) { + if (dm->rfe_type == 0) READ_AND_CONFIG_MP(8197f, _txpowertrack_type0); - else if (p_dm_odm->rfe_type == 1) + else if (dm->rfe_type == 1) READ_AND_CONFIG_MP(8197f, _txpowertrack_type1); else READ_AND_CONFIG_MP(8197f, _txpowertrack); } #endif +/*@jj add 20170822*/ +#if RTL8192F_SUPPORT + if (dm->support_ic_type == ODM_RTL8192F) { + if (dm->rfe_type == 0) + READ_AND_CONFIG_MP(8192f, _txpowertrack_type0); + else if (dm->rfe_type == 1) + READ_AND_CONFIG_MP(8192f, _txpowertrack_type1); + else if (dm->rfe_type == 2) + READ_AND_CONFIG_MP(8192f, _txpowertrack_type2); + else if (dm->rfe_type == 3) + READ_AND_CONFIG_MP(8192f, _txpowertrack_type3); + else if (dm->rfe_type == 4) + READ_AND_CONFIG_MP(8192f, _txpowertrack_type4); + else if (dm->rfe_type == 5) + READ_AND_CONFIG_MP(8192f, _txpowertrack_type5); + else if (dm->rfe_type == 6) + READ_AND_CONFIG_MP(8192f, _txpowertrack_type6); + else if (dm->rfe_type == 7) + READ_AND_CONFIG_MP(8192f, _txpowertrack_type7); + else if (dm->rfe_type == 8) + READ_AND_CONFIG_MP(8192f, _txpowertrack_type8); + else if (dm->rfe_type == 9) + READ_AND_CONFIG_MP(8192f, _txpowertrack_type9); + else if (dm->rfe_type == 10) + READ_AND_CONFIG_MP(8192f, _txpowertrack_type10); + else if (dm->rfe_type == 11) + READ_AND_CONFIG_MP(8192f, _txpowertrack_type11); + else if (dm->rfe_type == 12) + READ_AND_CONFIG_MP(8192f, _txpowertrack_type12); + else if (dm->rfe_type == 13) + READ_AND_CONFIG_MP(8192f, _txpowertrack_type13); + else if (dm->rfe_type == 14) + READ_AND_CONFIG_MP(8192f, _txpowertrack_type14); + else if (dm->rfe_type == 15) + READ_AND_CONFIG_MP(8192f, _txpowertrack_type15); + else if (dm->rfe_type == 16) + READ_AND_CONFIG_MP(8192f, _txpowertrack_type16); + else if (dm->rfe_type == 17) + READ_AND_CONFIG_MP(8192f, _txpowertrack_type17); + else if (dm->rfe_type == 18) + READ_AND_CONFIG_MP(8192f, _txpowertrack_type18); + else if (dm->rfe_type == 19) + READ_AND_CONFIG_MP(8192f, _txpowertrack_type19); + else if (dm->rfe_type == 20) + READ_AND_CONFIG_MP(8192f, _txpowertrack_type20); + else if (dm->rfe_type == 21) + READ_AND_CONFIG_MP(8192f, _txpowertrack_type21); + else if (dm->rfe_type == 22) + READ_AND_CONFIG_MP(8192f, _txpowertrack_type22); + else if (dm->rfe_type == 23) + READ_AND_CONFIG_MP(8192f, _txpowertrack_type23); + else if (dm->rfe_type == 24) + READ_AND_CONFIG_MP(8192f, _txpowertrack_type24); + else if (dm->rfe_type == 25) + READ_AND_CONFIG_MP(8192f, _txpowertrack_type25); + else if (dm->rfe_type == 26) + READ_AND_CONFIG_MP(8192f, _txpowertrack_type26); + else if (dm->rfe_type == 27) + READ_AND_CONFIG_MP(8192f, _txpowertrack_type27); + else if (dm->rfe_type == 28) + READ_AND_CONFIG_MP(8192f, _txpowertrack_type28); + else if (dm->rfe_type == 29) + READ_AND_CONFIG_MP(8192f, _txpowertrack_type29); + else if (dm->rfe_type == 30) + READ_AND_CONFIG_MP(8192f, _txpowertrack_type30); + else if (dm->rfe_type == 31) + READ_AND_CONFIG_MP(8192f, _txpowertrack_type31); + else + READ_AND_CONFIG_MP(8192f, _txpowertrack); + READ_AND_CONFIG_MP(8192f, _txxtaltrack); + } +#endif + +#if RTL8721D_SUPPORT + if (dm->support_ic_type == ODM_RTL8721D) { + #if 0 + if (dm->package_type == 1) + READ_AND_CONFIG_MP(8721d, _txpowertrack_qfn48m_smic); + else if (dm->package_type == 5) + READ_AND_CONFIG_MP(8721d, _txpowertrack_qfn48m_umc); + #endif + READ_AND_CONFIG_MP(8721d, _txpowertrack); + READ_AND_CONFIG_MP(8721d, _txxtaltrack); + } +#endif #if RTL8821C_SUPPORT - if (p_dm_odm->support_ic_type == ODM_RTL8821C) - READ_AND_CONFIG(8821c, _txpowertrack); + if (dm->support_ic_type == ODM_RTL8821C) { + if (dm->rfe_type == 0x5) + READ_AND_CONFIG(8821c, _txpowertrack_type0x28); + else if (dm->rfe_type == 0x4) + READ_AND_CONFIG(8821c, _txpowertrack_type0x20); + else + READ_AND_CONFIG(8821c, _txpowertrack); + } +#endif + +#if RTL8198F_SUPPORT + if (dm->support_ic_type == ODM_RTL8198F) { + if (dm->rfe_type == 0) + READ_AND_CONFIG_MP(8198f, _txpowertrack_type0); + else if (dm->rfe_type == 1) + READ_AND_CONFIG_MP(8198f, _txpowertrack_type1); + else + READ_AND_CONFIG_MP(8198f, _txpowertrack); + } +#endif + +#if RTL8195B_SUPPORT + if (dm->support_ic_type == ODM_RTL8195B) { + READ_AND_CONFIG_MP(8195b, _txpowertrack); + READ_AND_CONFIG_MP(8195b, _txxtaltrack); + } +#endif + +#if (RTL8822C_SUPPORT) + if (dm->support_ic_type == ODM_RTL8822C) + READ_AND_CONFIG_MP(8822c, _txpowertrack); +#endif + +#if (RTL8812F_SUPPORT) + if (dm->support_ic_type == ODM_RTL8812F) + READ_AND_CONFIG_MP(8812f, _txpowertrack); +#endif + +#if RTL8814B_SUPPORT + if (dm->support_ic_type == ODM_RTL8814B) + READ_AND_CONFIG_MP(8814b, _txpowertrack); #endif return HAL_STATUS_SUCCESS; } enum hal_status -odm_config_bb_with_header_file( - struct PHY_DM_STRUCT *p_dm_odm, - enum odm_bb_config_type config_type -) +odm_config_bb_with_header_file(struct dm_struct *dm, + enum odm_bb_config_type config_type) { #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - struct _ADAPTER *adapter = p_dm_odm->adapter; - PMGNT_INFO p_mgnt_info = &(adapter->MgntInfo); + void *adapter = dm->adapter; + PMGNT_INFO mgnt_info = &((PADAPTER)adapter)->MgntInfo; #endif + enum hal_status result = HAL_STATUS_SUCCESS; - /* 1 AP doesn't use PHYDM initialization in these ICs */ +/* @1 AP doesn't use PHYDM initialization in these ICs */ #if (DM_ODM_SUPPORT_TYPE != ODM_AP) #if (RTL8812A_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8812) { + if (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_odm->rfe_type == 3 && p_dm_odm->is_mp_chip) + if (dm->rfe_type == 3 && 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_odm->is_mp_chip) + else if (mgnt_info->CustomerID == RT_CID_WNC_NEC && 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) + /*@{1827}{1024} for BUFFALO power by rate table. Isaiah 2013-11-29*/ + else if (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"); + else if (mgnt_info->CustomerID == RT_CID_TPLINK_HPWR) { + pr_debug("RT_CID_TPLINK_HPWR:: _PHY_REG_PG_TPLINK\n"); READ_AND_CONFIG_MP(8812a, _phy_reg_pg_tplink); } #endif @@ -2353,17 +828,17 @@ odm_config_bb_with_header_file( } 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) { - if ((36 <= *p_dm_odm->p_channel) && (*p_dm_odm->p_channel <= 64)) + dm->fw_offload_ability &= ~PHYDM_PHY_PARAM_OFFLOAD; + /*@AGC_TAB DIFF dont support FW offload*/ + if ((*dm->channel >= 36) && (*dm->channel <= 64)) AGC_DIFF_CONFIG_MP(8812a, lb); - else if (100 <= *p_dm_odm->p_channel) + else if (*dm->channel >= 100) AGC_DIFF_CONFIG_MP(8812a, hb); } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, (" ===> phy_ConfigBBWithHeaderFile() phy:Rtl8812AGCTABArray\n")); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, (" ===> phy_ConfigBBWithHeaderFile() agc:Rtl8812PHY_REGArray\n")); } #endif #if (RTL8821A_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8821) { + if (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) @@ -2371,31 +846,29 @@ odm_config_bb_with_header_file( 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); + HAL_DATA_TYPE * hal_data = GET_HAL_DATA(((PADAPTER)adapter)); - if ((p_hal_data->EEPROMSVID == 0x1043 && p_hal_data->EEPROMSMID == 0x207F)) + if ((hal_data->EEPROMSVID == 0x1043 && 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->channel_plan == 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 + /*@ for BUFFALO pwr by rate table */ + if (mgnt_info->CustomerID == RT_CID_DNI_BUFFALO) { + /*@ for BUFFALO pwr by rate table (JP/US)*/ + if (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); + READ_AND_CONFIG_MP(8821a, _phy_reg_pg); } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, (" ===> phy_ConfigBBWithHeaderFile() phy:Rtl8821AGCTABArray\n")); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, (" ===> phy_ConfigBBWithHeaderFile() agc:Rtl8821PHY_REGArray\n")); } #endif #if (RTL8192E_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8192E) { + if (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) @@ -2405,7 +878,7 @@ odm_config_bb_with_header_file( } #endif #if (RTL8723D_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8723D) { + if (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) @@ -2414,12 +887,22 @@ odm_config_bb_with_header_file( READ_AND_CONFIG_MP(8723d, _phy_reg_pg); } #endif -#endif/* (DM_ODM_SUPPORT_TYPE != ODM_AP) */ +/* @JJ ADD 20161014 */ +#if (RTL8710B_SUPPORT == 1) + if (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 - - /* 1 All platforms support */ +#endif /* @(DM_ODM_SUPPORT_TYPE != ODM_AP) */ +/* @1 All platforms support */ #if (RTL8188E_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8188E) { + if (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) @@ -2429,7 +912,7 @@ odm_config_bb_with_header_file( } #endif #if (RTL8723B_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8723B) { + if (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) @@ -2439,33 +922,34 @@ odm_config_bb_with_header_file( } #endif #if (RTL8814A_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8814A) { + if (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_odm->rfe_type == 0) - READ_AND_CONFIG_MP(8814a,_phy_reg_pg); - else if (p_dm_odm->rfe_type == 2) - READ_AND_CONFIG_MP(8814a,_phy_reg_pg_type2); - else if (p_dm_odm->rfe_type == 3) - READ_AND_CONFIG_MP(8814a,_phy_reg_pg_type3); - else if (p_dm_odm->rfe_type == 4) - READ_AND_CONFIG_MP(8814a,_phy_reg_pg_type4); - else if (p_dm_odm->rfe_type == 5) - READ_AND_CONFIG_MP(8814a,_phy_reg_pg_type5); - else if (p_dm_odm->rfe_type == 7) - READ_AND_CONFIG_MP(8814a,_phy_reg_pg_type7); + if (dm->rfe_type == 0) + READ_AND_CONFIG_MP(8814a, _phy_reg_pg_type0); + else if (dm->rfe_type == 2) + READ_AND_CONFIG_MP(8814a, _phy_reg_pg_type2); + else if (dm->rfe_type == 3) + READ_AND_CONFIG_MP(8814a, _phy_reg_pg_type3); + else if (dm->rfe_type == 4) + READ_AND_CONFIG_MP(8814a, _phy_reg_pg_type4); + else if (dm->rfe_type == 5) + READ_AND_CONFIG_MP(8814a, _phy_reg_pg_type5); + else if (dm->rfe_type == 7) + READ_AND_CONFIG_MP(8814a, _phy_reg_pg_type7); + else if (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_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_odm->support_ic_type == ODM_RTL8703B) { + if (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) @@ -2475,7 +959,7 @@ odm_config_bb_with_header_file( } #endif #if (RTL8188F_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8188F) { + if (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) @@ -2485,55 +969,162 @@ odm_config_bb_with_header_file( } #endif #if (RTL8822B_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8822B) { - if (config_type == CONFIG_BB_PHY_REG) + if (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) + } else if (config_type == CONFIG_BB_AGC_TAB) { READ_AND_CONFIG_MP(8822b, _agc_tab); - else if (config_type == CONFIG_BB_PHY_REG_PG) - READ_AND_CONFIG_MP(8822b, _phy_reg_pg); - /*else if (config_type == CONFIG_BB_PHY_REG_MP)*/ - /*READ_AND_CONFIG_MP(8822b, _phy_reg_mp);*/ + } else if (config_type == CONFIG_BB_PHY_REG_PG) { + if (dm->rfe_type == 2) + READ_AND_CONFIG_MP(8822b, _phy_reg_pg_type2); + else if (dm->rfe_type == 3) + READ_AND_CONFIG_MP(8822b, _phy_reg_pg_type3); + else if (dm->rfe_type == 4) + READ_AND_CONFIG_MP(8822b, _phy_reg_pg_type4); + else if (dm->rfe_type == 5) + READ_AND_CONFIG_MP(8822b, _phy_reg_pg_type5); + else if (dm->rfe_type == 12) + READ_AND_CONFIG_MP(8822b, _phy_reg_pg_type12); + else if (dm->rfe_type == 15) + READ_AND_CONFIG_MP(8822b, _phy_reg_pg_type15); + else if (dm->rfe_type == 16) + READ_AND_CONFIG_MP(8822b, _phy_reg_pg_type16); + else if (dm->rfe_type == 17) + READ_AND_CONFIG_MP(8822b, _phy_reg_pg_type17); + else if (dm->rfe_type == 18) + READ_AND_CONFIG_MP(8822b, _phy_reg_pg_type18); + else + READ_AND_CONFIG_MP(8822b, _phy_reg_pg); + } } #endif #if (RTL8197F_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8197F) { + if (dm->support_ic_type == ODM_RTL8197F) { if (config_type == CONFIG_BB_PHY_REG) { READ_AND_CONFIG_MP(8197f, _phy_reg); - if (p_dm_odm->cut_version == ODM_CUT_A) - phydm_phypara_a_cut(p_dm_odm); + if (dm->cut_version == ODM_CUT_A) + phydm_phypara_a_cut(dm); } else if (config_type == CONFIG_BB_AGC_TAB) READ_AND_CONFIG_MP(8197f, _agc_tab); - /* else if(config_type == CONFIG_BB_PHY_REG_PG) - READ_AND_CONFIG_MP(8197f, _phy_reg_pg); - else if(config_type == CONFIG_BB_PHY_REG_MP) - READ_AND_CONFIG_MP(8197f, _phy_reg_mp); */ } #endif - -#if (RTL8821C_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8821C) { +/*@jj add 20170822*/ +#if (RTL8192F_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8192F) { + if (config_type == CONFIG_BB_PHY_REG) { + READ_AND_CONFIG_MP(8192f, _phy_reg); + } else if (config_type == CONFIG_BB_AGC_TAB) { + READ_AND_CONFIG_MP(8192f, _agc_tab); + } else if (config_type == CONFIG_BB_PHY_REG_PG) { + if (dm->rfe_type == 0) + READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type0); + else if (dm->rfe_type == 1) + READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type1); + else if (dm->rfe_type == 2) + READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type2); + else if (dm->rfe_type == 3) + READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type3); + else if (dm->rfe_type == 4) + READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type4); + else if (dm->rfe_type == 5) + READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type5); + else if (dm->rfe_type == 6) + READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type6); + else if (dm->rfe_type == 7) + READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type7); + else if (dm->rfe_type == 8) + READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type8); + else if (dm->rfe_type == 9) + READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type9); + else if (dm->rfe_type == 10) + READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type10); + else if (dm->rfe_type == 11) + READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type11); + else if (dm->rfe_type == 12) + READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type12); + else if (dm->rfe_type == 13) + READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type13); + else if (dm->rfe_type == 14) + READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type14); + else if (dm->rfe_type == 15) + READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type15); + else if (dm->rfe_type == 16) + READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type16); + else if (dm->rfe_type == 17) + READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type17); + else if (dm->rfe_type == 18) + READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type18); + else if (dm->rfe_type == 19) + READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type19); + else if (dm->rfe_type == 20) + READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type20); + else if (dm->rfe_type == 21) + READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type21); + else if (dm->rfe_type == 22) + READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type22); + else if (dm->rfe_type == 23) + READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type23); + else if (dm->rfe_type == 24) + READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type24); + else if (dm->rfe_type == 25) + READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type25); + else if (dm->rfe_type == 26) + READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type26); + else if (dm->rfe_type == 27) + READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type27); + else if (dm->rfe_type == 28) + READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type28); + else if (dm->rfe_type == 29) + READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type29); + else if (dm->rfe_type == 30) + READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type30); + else if (dm->rfe_type == 31) + READ_AND_CONFIG_MP(8192f, _phy_reg_pg_type31); + else + READ_AND_CONFIG_MP(8192f, _phy_reg_pg); + } + } +#endif +#if (RTL8721D_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8721D) { if (config_type == CONFIG_BB_PHY_REG) + READ_AND_CONFIG_MP(8721d, _phy_reg); + else if (config_type == CONFIG_BB_AGC_TAB) + READ_AND_CONFIG_MP(8721d, _agc_tab); + else if (config_type == CONFIG_BB_PHY_REG_PG) + READ_AND_CONFIG_MP(8721d, _phy_reg_pg); + } +#endif +#if (RTL8821C_SUPPORT == 1) + if (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) { + } else if (config_type == CONFIG_BB_AGC_TAB) { READ_AND_CONFIG(8821c, _agc_tab); - /* According to RFEtype, choosing correct AGC table*/ - if (p_dm_odm->rfe_type == 2 || p_dm_odm->rfe_type == 4 || p_dm_odm->rfe_type == 7) + /* @According to RFEtype, choosing correct AGC table*/ + if (dm->default_rf_set_8821c == SWITCH_TO_BTG) AGC_DIFF_CONFIG_MP(8821c, btg); - } else if (config_type == CONFIG_BB_PHY_REG_PG) - READ_AND_CONFIG(8821c, _phy_reg_pg); - else if (config_type == CONFIG_BB_AGC_TAB_DIFF) { - if (p_dm_odm->current_rf_set_8821c == SWITCH_TO_BTG) + } else if (config_type == CONFIG_BB_PHY_REG_PG) { + if (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) { + dm->fw_offload_ability &= ~PHYDM_PHY_PARAM_OFFLOAD; + /*@AGC_TAB DIFF dont support FW offload*/ + if (dm->current_rf_set_8821c == SWITCH_TO_BTG) AGC_DIFF_CONFIG_MP(8821c, btg); - else if (p_dm_odm->current_rf_set_8821c == SWITCH_TO_WLG) + else if (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_odm->support_ic_type == ODM_RTL8195A) { + if (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) @@ -2542,1087 +1133,359 @@ odm_config_bb_with_header_file( READ_AND_CONFIG(8195a, _phy_reg_pg); } #endif +#if (RTL8195B_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8195B) { + if (config_type == CONFIG_BB_PHY_REG) + READ_AND_CONFIG(8195b, _phy_reg); + else if (config_type == CONFIG_BB_AGC_TAB) + READ_AND_CONFIG(8195b, _agc_tab); + else if (config_type == CONFIG_BB_PHY_REG_PG) + READ_AND_CONFIG(8195b, _phy_reg_pg); + } +#endif +#if (RTL8198F_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8198F) { + if (config_type == CONFIG_BB_PHY_REG) + READ_AND_CONFIG_MP(8198f, _phy_reg); + else if (config_type == CONFIG_BB_AGC_TAB) + READ_AND_CONFIG_MP(8198f, _agc_tab); + } +#endif +#if (RTL8814B_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8814B) { + if (config_type == CONFIG_BB_PHY_REG) + READ_AND_CONFIG_MP(8814b, _phy_reg); + else if (config_type == CONFIG_BB_AGC_TAB) + READ_AND_CONFIG_MP(8814b, _agc_tab); + else if (config_type == CONFIG_BB_PHY_REG_PG) + READ_AND_CONFIG(8814b, _phy_reg_pg); + } +#endif +#if (RTL8822C_SUPPORT) + if (dm->support_ic_type == ODM_RTL8822C) { + if (config_type == CONFIG_BB_PHY_REG) + READ_AND_CONFIG_MP(8822c, _phy_reg); + else if (config_type == CONFIG_BB_AGC_TAB) + READ_AND_CONFIG_MP(8822c, _agc_tab); + else if (config_type == CONFIG_BB_PHY_REG_PG) + READ_AND_CONFIG(8822c, _phy_reg_pg); + } +#endif +#if (RTL8812F_SUPPORT) + if (dm->support_ic_type == ODM_RTL8812F) { + if (config_type == CONFIG_BB_PHY_REG) + READ_AND_CONFIG_MP(8812f, _phy_reg); + else if (config_type == CONFIG_BB_AGC_TAB) + READ_AND_CONFIG_MP(8812f, _agc_tab); + else if (config_type == CONFIG_BB_PHY_REG_PG) + READ_AND_CONFIG(8812f, _phy_reg_pg); + } +#endif - return HAL_STATUS_SUCCESS; + if (config_type == CONFIG_BB_PHY_REG || + config_type == CONFIG_BB_AGC_TAB) + if (dm->fw_offload_ability & PHYDM_PHY_PARAM_OFFLOAD) { + result = phydm_set_reg_by_fw(dm, + PHYDM_HALMAC_CMD_END, + 0, + 0, + 0, + (enum rf_path)0, + 0); + PHYDM_DBG(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_odm -) +odm_config_mac_with_header_file(struct dm_struct *dm) { -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - struct _ADAPTER *adapter = p_dm_odm->adapter; -#endif + enum hal_status result = HAL_STATUS_SUCCESS; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, - ("===>odm_config_mac_with_header_file (%s)\n", (p_dm_odm->is_mp_chip) ? "MPChip" : "TestChip")); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, - ("p_dm_odm->support_platform: 0x%X, p_dm_odm->support_interface: 0x%X, p_dm_odm->board_type: 0x%X\n", - p_dm_odm->support_platform, p_dm_odm->support_interface, p_dm_odm->board_type)); + PHYDM_DBG(dm, ODM_COMP_INIT, "===>%s (%s)\n", __func__, + (dm->is_mp_chip) ? "MPChip" : "TestChip"); + PHYDM_DBG(dm, ODM_COMP_INIT, + "support_platform: 0x%X, support_interface: 0x%X, board_type: 0x%X\n", + dm->support_platform, dm->support_interface, dm->board_type); - /* 1 AP doesn't use PHYDM initialization in these ICs */ +/* @1 AP doesn't use PHYDM initialization in these ICs */ #if (DM_ODM_SUPPORT_TYPE != ODM_AP) #if (RTL8812A_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8812) + if (dm->support_ic_type == ODM_RTL8812) READ_AND_CONFIG_MP(8812a, _mac_reg); #endif #if (RTL8821A_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8821) { + if (dm->support_ic_type == ODM_RTL8821) READ_AND_CONFIG_MP(8821a, _mac_reg); - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("<===8821_ODM_ConfigMACwithHeaderFile\n")); - } #endif #if (RTL8192E_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8192E) + if (dm->support_ic_type == ODM_RTL8192E) READ_AND_CONFIG_MP(8192e, _mac_reg); #endif #if (RTL8723D_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8723D) + if (dm->support_ic_type == ODM_RTL8723D) READ_AND_CONFIG_MP(8723d, _mac_reg); #endif -#endif/* (DM_ODM_SUPPORT_TYPE != ODM_AP) */ - - /* 1 All platforms support */ +/* @JJ ADD 20161014 */ +#if (RTL8710B_SUPPORT == 1) + if (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_odm->support_ic_type == ODM_RTL8188E) + if (dm->support_ic_type == ODM_RTL8188E) READ_AND_CONFIG_MP(8188e, _mac_reg); #endif #if (RTL8723B_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8723B) + if (dm->support_ic_type == ODM_RTL8723B) READ_AND_CONFIG_MP(8723b, _mac_reg); #endif #if (RTL8814A_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8814A) + if (dm->support_ic_type == ODM_RTL8814A) READ_AND_CONFIG_MP(8814a, _mac_reg); #endif #if (RTL8703B_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8703B) + if (dm->support_ic_type == ODM_RTL8703B) READ_AND_CONFIG_MP(8703b, _mac_reg); #endif #if (RTL8188F_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8188F) + if (dm->support_ic_type == ODM_RTL8188F) READ_AND_CONFIG_MP(8188f, _mac_reg); #endif #if (RTL8822B_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8822B) + if (dm->support_ic_type == ODM_RTL8822B) READ_AND_CONFIG_MP(8822b, _mac_reg); #endif - #if (RTL8197F_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8197F) + if (dm->support_ic_type == ODM_RTL8197F) READ_AND_CONFIG_MP(8197f, _mac_reg); #endif +/*@jj add 20170822*/ +#if (RTL8192F_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8192F) + READ_AND_CONFIG_MP(8192f, _mac_reg); +#endif + +#if (RTL8721D_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8721D) + READ_AND_CONFIG_MP(8721d, _mac_reg); +#endif #if (RTL8821C_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8821C) + if (dm->support_ic_type == ODM_RTL8821C) READ_AND_CONFIG(8821c, _mac_reg); #endif - #if (RTL8195A_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8195A) + if (dm->support_ic_type == ODM_RTL8195A) READ_AND_CONFIG_MP(8195a, _mac_reg); #endif +#if (RTL8195B_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8195B) + READ_AND_CONFIG_MP(8195b, _mac_reg); +#endif +#if (RTL8198F_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8198F) + READ_AND_CONFIG_MP(8198f, _mac_reg); +#endif +#if (RTL8814B_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8814B) + READ_AND_CONFIG_MP(8814b, _mac_reg); +#endif +#if 0 /*(RTL8822C_SUPPORT)*/ + if (dm->support_ic_type == ODM_RTL8822C) + READ_AND_CONFIG_MP(8822c, _mac_reg); +#endif +#if (RTL8812F_SUPPORT) + if (dm->support_ic_type == ODM_RTL8812F) + READ_AND_CONFIG_MP(8812f, _mac_reg); +#endif - return HAL_STATUS_SUCCESS; + if (dm->fw_offload_ability & PHYDM_PHY_PARAM_OFFLOAD) { + result = phydm_set_reg_by_fw(dm, + PHYDM_HALMAC_CMD_END, + 0, + 0, + 0, + (enum rf_path)0, + 0); + PHYDM_DBG(dm, ODM_COMP_INIT, + "mac param offload end!result = %d", result); + } + + return result; } -enum hal_status -odm_config_fw_with_header_file( - struct PHY_DM_STRUCT *p_dm_odm, - enum odm_fw_config_type config_type, - u8 *p_firmware, - u32 *p_size -) +u32 odm_get_hw_img_version(struct dm_struct *dm) { -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + u32 version = 0; -#if (RTL8188E_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8188E) { -#ifdef CONFIG_SFW_SUPPORTED - if (config_type == CONFIG_FW_NIC) - READ_FIRMWARE_MP(8188e_t, _fw_nic); - else if (config_type == CONFIG_FW_WOWLAN) - READ_FIRMWARE_MP(8188e_t, _fw_wowlan); - else if (config_type == CONFIG_FW_NIC_2) - READ_FIRMWARE_MP(8188e_s, _fw_nic); - else if (config_type == CONFIG_FW_WOWLAN_2) - READ_FIRMWARE_MP(8188e_s, _fw_wowlan); -#ifdef CONFIG_AP_WOWLAN - if (config_type == CONFIG_FW_AP) - READ_FIRMWARE_MP(8188e_t, _fw_ap); - else if (config_type == CONFIG_FW_AP_2) - READ_FIRMWARE_MP(8188e_s, _fw_ap); -#endif /* CONFIG_AP_WOWLAN */ -#else - if (config_type == CONFIG_FW_NIC) - READ_FIRMWARE_MP(8188e_t, _fw_nic); - else if (config_type == CONFIG_FW_WOWLAN) - READ_FIRMWARE_MP(8188e_t, _fw_wowlan); -#ifdef CONFIG_AP_WOWLAN - else if (config_type == CONFIG_FW_AP) - READ_FIRMWARE_MP(8188e_t, _fw_ap); -#endif /* CONFIG_AP_WOWLAN */ -#endif - } -#endif -#if (RTL8723B_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8723B) { - if (config_type == CONFIG_FW_NIC) - READ_FIRMWARE_MP(8723b, _fw_nic); - else if (config_type == CONFIG_FW_WOWLAN) - READ_FIRMWARE_MP(8723b, _fw_wowlan); -#ifdef CONFIG_AP_WOWLAN - else if (config_type == config_fw_ap_wowlan) - READ_FIRMWARE(8723b, _fw_ap); -#endif - - } -#endif /* #if (RTL8723B_SUPPORT == 1) */ -#if (RTL8812A_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8812) { - if (config_type == CONFIG_FW_NIC) - READ_FIRMWARE_MP(8812a, _fw_nic); - else if (config_type == CONFIG_FW_WOWLAN) - READ_FIRMWARE_MP(8812a, _fw_wowlan); - else if (config_type == CONFIG_FW_BT) - READ_FIRMWARE_MP(8812a, _fw_nic_bt); -#ifdef CONFIG_AP_WOWLAN - else if (config_type == config_fw_ap_wowlan) - READ_FIRMWARE(8812a, _fw_ap); -#endif - } -#endif -#if (RTL8821A_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8821) { - if (config_type == CONFIG_FW_NIC) - READ_FIRMWARE_MP(8821a, _fw_nic); - else if (config_type == CONFIG_FW_WOWLAN) - READ_FIRMWARE_MP(8821a, _fw_wowlan); -#ifdef CONFIG_AP_WOWLAN - else if (config_type == config_fw_ap_wowlan) - READ_FIRMWARE_MP(8821a, _fw_ap); -#endif /*CONFIG_AP_WOWLAN*/ - else if (config_type == CONFIG_FW_BT) - READ_FIRMWARE_MP(8821a, _fw_nic_bt); - } -#endif -#if (RTL8192E_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8192E) { - if (config_type == CONFIG_FW_NIC) - READ_FIRMWARE_MP(8192e, _fw_nic); - else if (config_type == CONFIG_FW_WOWLAN) - READ_FIRMWARE_MP(8192e, _fw_wowlan); -#ifdef CONFIG_AP_WOWLAN - else if (config_type == config_fw_ap_wowlan) - READ_FIRMWARE_MP(8192e, _fw_ap); -#endif - } -#endif -#if (RTL8723D_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8723D) { - if (config_type == CONFIG_FW_NIC) - READ_FIRMWARE_MP(8723d, _fw_nic); - else if (config_type == CONFIG_FW_WOWLAN) { - READ_FIRMWARE_MP(8723d, _fw_wowlan); -#ifdef CONFIG_AP_WOWLAN - else if (config_type == config_fw_ap_wowlan) - READ_FIRMWARE_MP(8723d, _fw_ap); -#endif - } - } -#endif - /*#if (RTL8814A_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8814A) - { - if (config_type == CONFIG_FW_NIC) - READ_FIRMWARE_MP(8814a, _fw_nic); - else if (config_type == config_fw_wowlan) - READ_FIRMWARE_MP(8814a, _fw_wowlan); - #ifdef CONFIG_AP_WOWLAN - else if (config_type == config_fw_ap_wowlan) - READ_FIRMWARE_MP(8814a, _fw_ap); - #endif - } - #endif */ - -#if (RTL8814A_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8814A) { - if (config_type == CONFIG_FW_NIC) - READ_FIRMWARE_MP(8814a, _fw_nic); -#ifdef CONFIG_AP_WOWLAN - else if (config_type == config_fw_ap_wowlan) - READ_FIRMWARE_MP(8814a, _fw_ap); -#endif - } -#endif - -#if (RTL8703B_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8703B) { - if (config_type == CONFIG_FW_NIC) - READ_FIRMWARE_MP(8703b, _fw_nic); - else if (config_type == CONFIG_FW_WOWLAN) - READ_FIRMWARE_MP(8703b, _fw_wowlan); -#ifdef CONFIG_AP_WOWLAN - else if (config_type == config_fw_ap_wowlan) - READ_FIRMWARE(8703b, _fw_ap); -#endif - } -#endif - -#if (RTL8188F_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8188F) { - if (config_type == CONFIG_FW_NIC) - READ_FIRMWARE_MP(8188f, _fw_nic); - else if (config_type == CONFIG_FW_WOWLAN) - READ_FIRMWARE_MP(8188f, _fw_wowlan); -#ifdef CONFIG_AP_WOWLAN - else if (config_type == CONFIG_FW_AP) - READ_FIRMWARE_MP(8188f, _fw_ap); -#endif - } -#endif - -#if (RTL8822B_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8822B) { - - if (config_type == CONFIG_FW_NIC) - READ_FIRMWARE_MP(8822b, _fw_nic); - else if (config_type == CONFIG_FW_WOWLAN) - READ_FIRMWARE_MP(8822b, _fw_wowlan); -#ifdef CONFIG_AP_WOWLAN - else if (config_type == config_fw_ap_wowlan) - READ_FIRMWARE(8822b, _fw_ap); -#endif - } -#endif - -#if (RTL8197F_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8197F) { - if (config_type == CONFIG_FW_NIC) - READ_FIRMWARE_MP(8197f, _fw_nic); -#ifdef CONFIG_AP_WOWLAN - else if (config_type == config_fw_ap_wowlan) - READ_FIRMWARE(8197f, _fw_ap); -#endif - } -#endif - -#if ((DM_ODM_SUPPORT_TYPE == ODM_WIN)) -#if (RTL8821C_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8821C) { - if (config_type == CONFIG_FW_NIC) - READ_FIRMWARE_MP(8821c, _fw_nic); - else if (config_type == CONFIG_FW_WOWLAN) - READ_FIRMWARE_MP(8821c, _fw_wowlan); -#ifdef CONFIG_AP_WOWLAN - else if (config_type == 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; -} - -u32 -odm_get_hw_img_version( - struct PHY_DM_STRUCT *p_dm_odm -) -{ - u32 version = 0; - - /* 1 AP doesn't use PHYDM initialization in these ICs */ +/* @1 AP doesn't use PHYDM initialization in these ICs */ #if (DM_ODM_SUPPORT_TYPE != ODM_AP) #if (RTL8821A_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8821) + if (dm->support_ic_type == ODM_RTL8821) version = GET_VERSION_MP(8821a, _mac_reg); #endif #if (RTL8192E_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8192E) + if (dm->support_ic_type == ODM_RTL8192E) version = GET_VERSION_MP(8192e, _mac_reg); #endif #if (RTL8812A_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8812) + if (dm->support_ic_type == ODM_RTL8812) version = GET_VERSION_MP(8812a, _mac_reg); #endif #if (RTL8723D_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8723D) + if (dm->support_ic_type == ODM_RTL8723D) version = GET_VERSION_MP(8723d, _mac_reg); #endif -#endif /* (DM_ODM_SUPPORT_TYPE != ODM_AP) */ +/* @JJ ADD 20161014 */ +#if (RTL8710B_SUPPORT == 1) + if (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*/ +/*@1 All platforms support*/ #if (RTL8188E_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8188E) + if (dm->support_ic_type == ODM_RTL8188E) version = GET_VERSION_MP(8188e, _mac_reg); #endif #if (RTL8723B_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8723B) + if (dm->support_ic_type == ODM_RTL8723B) version = GET_VERSION_MP(8723b, _mac_reg); #endif #if (RTL8814A_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8814A) + if (dm->support_ic_type == ODM_RTL8814A) version = GET_VERSION_MP(8814a, _mac_reg); #endif #if (RTL8703B_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8703B) + if (dm->support_ic_type == ODM_RTL8703B) version = GET_VERSION_MP(8703b, _mac_reg); #endif #if (RTL8188F_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8188F) + if (dm->support_ic_type == ODM_RTL8188F) version = GET_VERSION_MP(8188f, _mac_reg); #endif #if (RTL8822B_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8822B) + if (dm->support_ic_type == ODM_RTL8822B) version = GET_VERSION_MP(8822b, _mac_reg); #endif - #if (RTL8197F_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8197F) + if (dm->support_ic_type == ODM_RTL8197F) version = GET_VERSION_MP(8197f, _mac_reg); #endif +/*@jj add 20170822*/ +#if (RTL8192F_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8192F) + version = GET_VERSION_MP(8192f, _mac_reg); +#endif +#if (RTL8721D_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8721D) + version = GET_VERSION_MP(8721d, _mac_reg); +#endif #if (RTL8821C_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8821C) + if (dm->support_ic_type == ODM_RTL8821C) version = GET_VERSION(8821c, _mac_reg); #endif +#if (RTL8195B_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8195B) + version = GET_VERSION(8195b, _mac_reg); +#endif +#if (RTL8198F_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8198F) + version = GET_VERSION_MP(8198f, _mac_reg); +#endif +#if 0 /*(RTL8822C_SUPPORT)*/ + if (dm->support_ic_type == ODM_RTL8822C) + version = GET_VERSION_MP(8822c, _mac_reg); +#endif +#if (RTL8812F_SUPPORT) + if (dm->support_ic_type == ODM_RTL8812F) + version = GET_VERSION_MP(8812f, _mac_reg); +#endif +#if (RTL8814B_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8814B) + version = GET_VERSION_MP(8814b, _mac_reg); +#endif return version; } -#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) -/* For 8822B only!! need to move to FW finally */ -/*==============================================*/ - -bool -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; - bool 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_rx_statistic_cal( - struct PHY_DM_STRUCT *p_phydm, - u8 *p_phy_status, - struct _odm_per_pkt_info_ *p_pktinfo -) -{ - struct _phy_status_rpt_jaguar2_type1 *p_phy_sta_rpt = (struct _phy_status_rpt_jaguar2_type1 *)p_phy_status; - u8 date_rate = p_pktinfo->data_rate & ~(BIT(7)); - - if ((p_phy_sta_rpt->gid != 0) && (p_phy_sta_rpt->gid != 63)) { - if (date_rate >= ODM_RATEVHTSS1MCS0) { - p_phydm->phy_dbg_info.num_qry_mu_vht_pkt[date_rate - 0x2C]++; - 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 { - if (date_rate >= ODM_RATEVHTSS1MCS0) { - p_phydm->phy_dbg_info.num_qry_vht_pkt[date_rate - 0x2C]++; - 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; - } - } - -} - -void -phydm_reset_phy_info( - struct PHY_DM_STRUCT *p_phydm, - struct _odm_phy_status_info_ *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); - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - 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->bt_coex_pwr_adjust = 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); -#endif -} - -void -phydm_set_per_path_phy_info( - u8 rx_path, - s8 rx_pwr, - s8 rx_evm, - s8 cfo_tail, - s8 rx_snr, - struct _odm_phy_status_info_ *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 >= 33) - evm_percentage = 100; - else - evm_percentage = (evm_dbm << 1) + (evm_dbm); - } - - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - p_phy_info->rx_pwr[rx_path] = rx_pwr; - p_phy_info->rx_mimo_evm_dbm[rx_path] = evm_dbm; - - /* 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; -#endif - - p_phy_info->rx_mimo_signal_strength[rx_path] = odm_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, - bool is_beamformed, - bool is_mu_packet, - u8 bandwidth, - u8 signal_quality, - u8 rxsc, - struct _odm_phy_status_info_ *p_phy_info -) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - 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; -#endif - p_phy_info->rx_pwdb_all = odm_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_odm, - u8 *p_phy_status, - struct _odm_per_pkt_info_ *p_pktinfo, - struct _odm_phy_status_info_ *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 i, SQ = 0; - s8 rx_power = p_phy_sta_rpt->pwdb - 110; - - -#if (RTL8723D_SUPPORT == 1) - if (p_dm_odm->support_ic_type & ODM_RTL8723D) - rx_power = p_phy_sta_rpt->pwdb - 97; -#endif -#if (RTL8197F_SUPPORT == 1) - if (p_dm_odm->support_ic_type & ODM_RTL8197F) - rx_power = p_phy_sta_rpt->pwdb - 97; -#endif - - /* 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_odm->cck_new_agc == false) { - u8 lna_idx, vga_idx; - -#if (RTL8197F_SUPPORT == 1) - if (p_dm_odm->support_ic_type & ODM_RTL8197F) - lna_idx = p_phy_sta_rpt->lna_l; - else -#endif - 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_odm->support_ic_type & ODM_RTL8723D) - rx_power = odm_cckrssi_8723d(lna_idx, vga_idx); -#endif -#if (RTL8822B_SUPPORT == 1) - /* Need to do !! */ - /*if (p_dm_odm->support_ic_type & ODM_RTL8822B) */ - /*rx_power = odm_CCKRSSI_8822B(LNA_idx, VGA_idx);*/ -#endif -#if (RTL8197F_SUPPORT == 1) - if (p_dm_odm->support_ic_type & ODM_RTL8197F) - rx_power = odm_cckrssi_8197f(p_dm_odm, lna_idx, vga_idx); -#endif - } - - /* Update CCK packet counter */ - p_dm_odm->phy_dbg_info.num_qry_phy_status_cck++; - - /*CCK no STBC and LDPC*/ - p_dm_odm->phy_dbg_info.is_ldpc_pkt = false; - p_dm_odm->phy_dbg_info.is_stbc_pkt = false; - - /* Update Common information */ - phydm_set_common_phy_info(rx_power, p_phy_sta_rpt->channel, false, - false, ODM_BW20M, SQ, p_phy_sta_rpt->rxsc, p_phy_info); - - /* Update CCK pwdb */ - phydm_set_per_path_phy_info(ODM_RF_PATH_A, rx_power, 0, 0, 0, p_phy_info); /* Update per-path information */ - - p_dm_odm->dm_fat_table.antsel_rx_keep_0 = p_phy_sta_rpt->antidx_a; - p_dm_odm->dm_fat_table.antsel_rx_keep_1 = p_phy_sta_rpt->antidx_b; - p_dm_odm->dm_fat_table.antsel_rx_keep_2 = p_phy_sta_rpt->antidx_c; - p_dm_odm->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_odm, - u8 *p_phy_status, - struct _odm_per_pkt_info_ *p_pktinfo, - struct _odm_phy_status_info_ *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 = ODM_BW20M, rx_count = 0; - bool is_mu; - u8 num_ss; - - /* Update OFDM packet counter */ - p_dm_odm->phy_dbg_info.num_qry_phy_status_ofdm++; - - /* Update per-path information */ - for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX_JAGUAR; i++) { - if (p_dm_odm->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 */ - 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_odm->phy_dbg_info.num_qry_mu_pkt++; - } else - is_mu = false; - - /* count BF packet */ - p_dm_odm->phy_dbg_info.num_qry_bf_pkt = p_dm_odm->phy_dbg_info.num_qry_bf_pkt + p_phy_sta_rpt->beamformed; - - /*STBC or LDPC pkt*/ - p_dm_odm->phy_dbg_info.is_ldpc_pkt = p_phy_sta_rpt->ldpc; - p_dm_odm->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_odm->support_ic_type & 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 = p_phy_sta_rpt->rf_mode; - } else if (p_dm_odm->support_ic_type & (ODM_RTL8197F | ODM_RTL8723D)) { - if (p_phy_sta_rpt->rf_mode == 0) - bw = ODM_BW20M; - else if ((rxsc == 1) || (rxsc == 2)) - bw = ODM_BW20M; - else - bw = ODM_BW40M; - } - - /* Update packet information */ - phydm_set_common_phy_info(rx_pwr_db, p_phy_sta_rpt->channel, (bool)p_phy_sta_rpt->beamformed, - is_mu, bw, odm_evm_db_to_percentage(p_phy_sta_rpt->rxevm[0]), rxsc, p_phy_info); - - num_ss = phydm_rate_to_num_ss(p_dm_odm, p_pktinfo->data_rate); - - odm_parsing_cfo(p_dm_odm, p_pktinfo, p_phy_sta_rpt->cfo_tail, num_ss); - p_dm_odm->dm_fat_table.antsel_rx_keep_0 = p_phy_sta_rpt->antidx_a; - p_dm_odm->dm_fat_table.antsel_rx_keep_1 = p_phy_sta_rpt->antidx_b; - p_dm_odm->dm_fat_table.antsel_rx_keep_2 = p_phy_sta_rpt->antidx_c; - p_dm_odm->dm_fat_table.antsel_rx_keep_3 = p_phy_sta_rpt->antidx_d; - - 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); - */ - phydm_rx_statistic_cal(p_dm_odm, p_phy_status, p_pktinfo); - } - /* - 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); - */ -} - -void -phydm_get_rx_phy_status_type2( - struct PHY_DM_STRUCT *p_dm_odm, - u8 *p_phy_status, - struct _odm_per_pkt_info_ *p_pktinfo, - struct _odm_phy_status_info_ *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 = ODM_BW20M, rx_count = 0; - - /* Update OFDM packet counter */ - p_dm_odm->phy_dbg_info.num_qry_phy_status_ofdm++; - - /* Update per-path information */ - for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX_JAGUAR; i++) { - if (p_dm_odm->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_odm->support_ic_type & ODM_RTL8197F) && (p_phy_sta_rpt->pwdb[i] == 0x7f)) { /*for 97f workaround*/ - - if (i == ODM_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 == ODM_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_odm->phy_dbg_info.is_ldpc_pkt = p_phy_sta_rpt->ldpc; - p_dm_odm->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_odm->support_ic_type & 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 (p_dm_odm->support_ic_type & (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_set_common_phy_info(rx_pwr_db, p_phy_sta_rpt->channel, (bool)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_odm, - struct _odm_phy_status_info_ *p_phy_info, - struct _odm_per_pkt_info_ *p_pktinfo -) -{ - s32 undecorated_smoothed_pwdb, accumulate_pwdb; - u32 rssi_ave; - u8 i; - struct sta_info *p_entry; - u8 scaling_factor = 4; - - if (p_pktinfo->station_id >= ODM_ASSOCIATE_ENTRY_NUM) - return; - - p_entry = p_dm_odm->p_odm_sta_info[p_pktinfo->station_id]; - - if (!IS_STA_VALID(p_entry)) - return; - - if ((!p_pktinfo->is_packet_match_bssid))/*data frame only*/ - return; - - if (p_pktinfo->is_packet_beacon) - p_dm_odm->phy_dbg_info.num_qry_beacon_pkt++; - -#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) - if (p_dm_odm->support_ability & ODM_BB_ANT_DIV) - odm_process_rssi_for_ant_div(p_dm_odm, p_phy_info, p_pktinfo); -#endif - -#if (CONFIG_DYNAMIC_RX_PATH == 1) - phydm_process_phy_status_for_dynamic_rx_path(p_dm_odm, p_phy_info, p_pktinfo); - dbg_print("====>\n"); -#endif - - if (p_pktinfo->is_packet_to_self || p_pktinfo->is_packet_beacon) { - u32 RSSI_linear = 0; - - p_dm_odm->rx_rate = p_pktinfo->data_rate; - undecorated_smoothed_pwdb = p_entry->rssi_stat.undecorated_smoothed_pwdb; - accumulate_pwdb = p_dm_odm->accumulate_pwdb[p_pktinfo->station_id]; - p_dm_odm->RSSI_A = p_phy_info->rx_mimo_signal_strength[ODM_RF_PATH_A]; - p_dm_odm->RSSI_B = p_phy_info->rx_mimo_signal_strength[ODM_RF_PATH_B]; - p_dm_odm->RSSI_C = p_phy_info->rx_mimo_signal_strength[ODM_RF_PATH_C]; - p_dm_odm->RSSI_D = p_phy_info->rx_mimo_signal_strength[ODM_RF_PATH_D]; - - for (i = ODM_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; - } - -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - if (p_entry->rssi_stat.undecorated_smoothed_pwdb == -1) - phydm_ra_rssi_rpt_wk(p_dm_odm); -#endif - p_entry->rssi_stat.undecorated_smoothed_pwdb = undecorated_smoothed_pwdb; - p_dm_odm->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_odm->adapter); - - p_hal_data->UndecoratedSmoothedPWDB = undecorated_smoothed_pwdb; - } -#endif - } -} - -void -phydm_rx_phy_status_new_type( - struct PHY_DM_STRUCT *p_phydm, - u8 *p_phy_status, - struct _odm_per_pkt_info_ *p_pktinfo, - struct _odm_phy_status_info_ *p_phy_info -) -{ - u8 phy_status_type = (*p_phy_status & 0xf); - - /*dbg_print("phydm_rx_phy_status_new_type================> (page: %d)\n", phy_status_type);*/ - - /* Memory reset */ - phydm_reset_phy_info(p_phydm, p_phy_info); - - /* Phy status parsing */ - switch (phy_status_type) { - case 0: - { - phydm_get_rx_phy_status_type0(p_phydm, p_phy_status, p_pktinfo, p_phy_info); - break; - } - case 1: - { - phydm_get_rx_phy_status_type1(p_phydm, p_phy_status, p_pktinfo, p_phy_info); - break; - } - case 2: - { - phydm_get_rx_phy_status_type2(p_phydm, 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; - } - - /* 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_phydm->adapter, p_phy_info->rx_pwdb_all, false, false); -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - p_phy_info->signal_strength = (u8)(odm_signal_scale_mapping(p_phydm, p_phy_info->rx_pwdb_all)); -#endif - - /* Calculate average RSSI and smoothed RSSI */ - phydm_process_rssi_for_dm_new_type(p_phydm, p_phy_info, p_pktinfo); - -} -/*==============================================*/ -#endif - -u32 -query_phydm_trx_capability( - struct PHY_DM_STRUCT *p_dm_odm -) +u32 query_phydm_trx_capability(struct dm_struct *dm) { u32 value32 = 0xFFFFFFFF; #if (RTL8821C_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8821C) - value32 = query_phydm_trx_capability_8821c(p_dm_odm); + if (dm->support_ic_type == ODM_RTL8821C) + value32 = query_phydm_trx_capability_8821c(dm); +#endif +#if (RTL8195B_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8195B) + value32 = query_phydm_trx_capability_8195b(dm); +#endif + return value32; +} + +u32 query_phydm_stbc_capability(struct dm_struct *dm) +{ + u32 value32 = 0xFFFFFFFF; + +#if (RTL8821C_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8821C) + value32 = query_phydm_stbc_capability_8821c(dm); +#endif +#if (RTL8195B_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8195B) + value32 = query_phydm_stbc_capability_8195b(dm); #endif return value32; } -u32 -query_phydm_stbc_capability( - struct PHY_DM_STRUCT *p_dm_odm -) +u32 query_phydm_ldpc_capability(struct dm_struct *dm) { u32 value32 = 0xFFFFFFFF; #if (RTL8821C_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8821C) - value32 = query_phydm_stbc_capability_8821c(p_dm_odm); + if (dm->support_ic_type == ODM_RTL8821C) + value32 = query_phydm_ldpc_capability_8821c(dm); +#endif +#if (RTL8195B_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8195B) + value32 = query_phydm_ldpc_capability_8195b(dm); #endif - return value32; } -u32 -query_phydm_ldpc_capability( - struct PHY_DM_STRUCT *p_dm_odm -) +u32 query_phydm_txbf_parameters(struct dm_struct *dm) { u32 value32 = 0xFFFFFFFF; #if (RTL8821C_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8821C) - value32 = query_phydm_ldpc_capability_8821c(p_dm_odm); + if (dm->support_ic_type == ODM_RTL8821C) + value32 = query_phydm_txbf_parameters_8821c(dm); +#endif +#if (RTL8195B_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8195B) + value32 = query_phydm_txbf_parameters_8195b(dm); #endif - return value32; } -u32 -query_phydm_txbf_parameters( - struct PHY_DM_STRUCT *p_dm_odm -) +u32 query_phydm_txbf_capability(struct dm_struct *dm) { u32 value32 = 0xFFFFFFFF; #if (RTL8821C_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8821C) - value32 = query_phydm_txbf_parameters_8821c(p_dm_odm); + if (dm->support_ic_type == ODM_RTL8821C) + value32 = query_phydm_txbf_capability_8821c(dm); +#endif +#if (RTL8195B_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8195B) + value32 = query_phydm_txbf_capability_8195b(dm); #endif - - return value32; -} - -u32 -query_phydm_txbf_capability( - struct PHY_DM_STRUCT *p_dm_odm -) -{ - u32 value32 = 0xFFFFFFFF; - -#if (RTL8821C_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8821C) - value32 = query_phydm_txbf_capability_8821c(p_dm_odm); -#endif - return value32; } diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_hwconfig.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_hwconfig.h index 572e21d3f913..229d7c0fd502 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_hwconfig.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_hwconfig.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,567 +9,72 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ - -#ifndef __HALHWOUTSRC_H__ +#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_read_and_config_mp_##ic##_agc_tab_diff(p_dm_odm, 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_odm, 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_odm->is_mp_chip)\ - AGC_DIFF_CONFIG_MP(ic, band);\ - else\ - AGC_DIFF_CONFIG_TC(ic, band);\ +/*@--------------------------Define -------------------------------------------*/ +#define AGC_DIFF_CONFIG_MP(ic, band) \ + (odm_read_and_config_mp_##ic##_agc_tab_diff(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(dm, \ + array_tc_##ic##_agc_tab_diff_##band, \ + sizeof(array_tc_##ic##_agc_tab_diff_##band) / sizeof(u32))) +#if defined(DM_ODM_CE_MAC80211) +#else +#define AGC_DIFF_CONFIG(ic, band) \ + do { \ + if (dm->is_mp_chip) \ + AGC_DIFF_CONFIG_MP(ic, band); \ + else \ + AGC_DIFF_CONFIG_TC(ic, band); \ } while (0) - - -/* ************************************************************ +#endif +/*@************************************************************ * 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 -}; - -void -phydm_reset_rssi_for_dm( - struct PHY_DM_STRUCT *p_dm_odm, - u8 station_id -); - -void -odm_init_rssi_for_dm( - struct PHY_DM_STRUCT *p_dm_odm -); - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -void -phydm_normal_driver_rx_sniffer( - struct PHY_DM_STRUCT *p_dm_odm, - u8 *p_desc, - PRT_RFD_STATUS p_rt_rfd_status, - u8 *p_drv_info, - u8 phy_status -); -#endif - -void -odm_phy_status_query( - struct PHY_DM_STRUCT *p_dm_odm, - struct _odm_phy_status_info_ *p_phy_info, - u8 *p_phy_status, - struct _odm_per_pkt_info_ *p_pktinfo -); - -void -odm_mac_status_query( - struct PHY_DM_STRUCT *p_dm_odm, - u8 *p_mac_status, - u8 mac_id, - bool is_packet_match_bssid, - bool is_packet_to_self, - bool is_packet_beacon -); + ************************************************************/ enum hal_status -odm_config_rf_with_tx_pwr_track_header_file( - struct PHY_DM_STRUCT *p_dm_odm -); +odm_config_rf_with_tx_pwr_track_header_file(struct dm_struct *dm); enum hal_status -odm_config_rf_with_header_file( - struct PHY_DM_STRUCT *p_dm_odm, - enum odm_rf_config_type config_type, - enum odm_rf_radio_path_e e_rf_path -); +odm_config_rf_with_header_file(struct dm_struct *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_odm, - enum odm_bb_config_type config_type -); +odm_config_bb_with_header_file(struct dm_struct *dm, + enum odm_bb_config_type config_type); enum hal_status -odm_config_mac_with_header_file( - struct PHY_DM_STRUCT *p_dm_odm -); +odm_config_mac_with_header_file(struct dm_struct *dm); -enum hal_status -odm_config_fw_with_header_file( - struct PHY_DM_STRUCT *p_dm_odm, - enum odm_fw_config_type config_type, - u8 *p_firmware, - u32 *p_size -); +u32 odm_get_hw_img_version(struct dm_struct *dm); -u32 -odm_get_hw_img_version( - struct PHY_DM_STRUCT *p_dm_odm -); +u32 query_phydm_trx_capability(struct dm_struct *dm); -s32 -odm_signal_scale_mapping( - struct PHY_DM_STRUCT *p_dm_odm, - s32 curr_sig -); +u32 query_phydm_stbc_capability(struct dm_struct *dm); -#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) -/*For 8822B only!! need to move to FW finally */ -/*==============================================*/ -void -phydm_rx_phy_status_new_type( - struct PHY_DM_STRUCT *p_phydm, - u8 *p_phy_status, - struct _odm_per_pkt_info_ *p_pktinfo, - struct _odm_phy_status_info_ *p_phy_info -); +u32 query_phydm_ldpc_capability(struct dm_struct *dm); -bool -phydm_query_is_mu_api( - struct PHY_DM_STRUCT *p_phydm, - u8 ppdu_idx, - u8 *p_data_rate, - u8 *p_gid -); +u32 query_phydm_txbf_parameters(struct dm_struct *dm); -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; +u32 query_phydm_txbf_capability(struct dm_struct *dm); - /* 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; -}; - -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) */ -}; - -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 -}; -/*==============================================*/ -#endif /*#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1)*/ - -u32 -query_phydm_trx_capability( - struct PHY_DM_STRUCT *p_dm_odm -); - -u32 -query_phydm_stbc_capability( - struct PHY_DM_STRUCT *p_dm_odm -); - -u32 -query_phydm_ldpc_capability( - struct PHY_DM_STRUCT *p_dm_odm -); - -u32 -query_phydm_txbf_parameters( - struct PHY_DM_STRUCT *p_dm_odm -); - -u32 -query_phydm_txbf_capability( - struct PHY_DM_STRUCT *p_dm_odm -); - -#endif /*#ifndef __HALHWOUTSRC_H__*/ +#endif /*@#ifndef __HALHWOUTSRC_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_interface.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_interface.c index daabf67d2afe..bbb8ba5ea5f3 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_interface.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_interface.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,417 +9,523 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ -/* ************************************************************ +/*@************************************************************ * include files - * ************************************************************ */ + ************************************************************/ #include "mp_precomp.h" #include "phydm_precomp.h" -/* +/*@ * ODM IO Relative API. - * */ + */ -u8 -odm_read_1byte( - struct PHY_DM_STRUCT *p_dm_odm, - u32 reg_addr -) +u8 odm_read_1byte(struct dm_struct *dm, u32 reg_addr) { #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - struct rtl8192cd_priv *priv = p_dm_odm->priv; - return RTL_R8(reg_addr); + struct rtl8192cd_priv *priv = 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 *)dm->adapter; + + return rtl_read_byte(rtlpriv, reg_addr); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) + struct rtw_dev *rtwdev = dm->adapter; + + return rtw_read8(rtwdev, reg_addr); #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - struct _ADAPTER *adapter = p_dm_odm->adapter; + void *adapter = dm->adapter; return rtw_read8(adapter, reg_addr); #elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) - struct _ADAPTER *adapter = p_dm_odm->adapter; - return PlatformEFIORead1Byte(adapter, reg_addr); -#endif + void *adapter = dm->adapter; + return PlatformEFIORead1Byte(adapter, reg_addr); +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + void *adapter = dm->adapter; + return rtw_read8(adapter, reg_addr); +#endif } - -u16 -odm_read_2byte( - struct PHY_DM_STRUCT *p_dm_odm, - u32 reg_addr -) +u16 odm_read_2byte(struct dm_struct *dm, u32 reg_addr) { #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - struct rtl8192cd_priv *priv = p_dm_odm->priv; - return RTL_R16(reg_addr); + struct rtl8192cd_priv *priv = 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 *)dm->adapter; + + return rtl_read_word(rtlpriv, reg_addr); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) + struct rtw_dev *rtwdev = dm->adapter; + + return rtw_read16(rtwdev, reg_addr); #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - struct _ADAPTER *adapter = p_dm_odm->adapter; + void *adapter = dm->adapter; return rtw_read16(adapter, reg_addr); #elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) - struct _ADAPTER *adapter = p_dm_odm->adapter; - return PlatformEFIORead2Byte(adapter, reg_addr); -#endif + void *adapter = dm->adapter; + return PlatformEFIORead2Byte(adapter, reg_addr); +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + void *adapter = dm->adapter; + return rtw_read16(adapter, reg_addr); +#endif } - -u32 -odm_read_4byte( - struct PHY_DM_STRUCT *p_dm_odm, - u32 reg_addr -) +u32 odm_read_4byte(struct dm_struct *dm, u32 reg_addr) { #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - struct rtl8192cd_priv *priv = p_dm_odm->priv; - return RTL_R32(reg_addr); + struct rtl8192cd_priv *priv = 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 *)dm->adapter; + + return rtl_read_dword(rtlpriv, reg_addr); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) + struct rtw_dev *rtwdev = dm->adapter; + + return rtw_read32(rtwdev, reg_addr); #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - struct _ADAPTER *adapter = p_dm_odm->adapter; + void *adapter = dm->adapter; return rtw_read32(adapter, reg_addr); #elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) - struct _ADAPTER *adapter = p_dm_odm->adapter; - return PlatformEFIORead4Byte(adapter, reg_addr); -#endif + void *adapter = dm->adapter; + return PlatformEFIORead4Byte(adapter, reg_addr); +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + void *adapter = dm->adapter; + return rtw_read32(adapter, reg_addr); +#endif } - -void -odm_write_1byte( - struct PHY_DM_STRUCT *p_dm_odm, - u32 reg_addr, - u8 data -) +void odm_write_1byte(struct dm_struct *dm, u32 reg_addr, u8 data) { #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - struct rtl8192cd_priv *priv = p_dm_odm->priv; + struct rtl8192cd_priv *priv = 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 *)dm->adapter; + + rtl_write_byte(rtlpriv, reg_addr, data); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) + struct rtw_dev *rtwdev = dm->adapter; + + rtw_write8(rtwdev, reg_addr, data); #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - struct _ADAPTER *adapter = p_dm_odm->adapter; + void *adapter = dm->adapter; rtw_write8(adapter, reg_addr, data); #elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) - struct _ADAPTER *adapter = p_dm_odm->adapter; + void *adapter = dm->adapter; PlatformEFIOWrite1Byte(adapter, reg_addr, data); -#endif +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + void *adapter = dm->adapter; + rtw_write8(adapter, reg_addr, data); +#endif } - -void -odm_write_2byte( - struct PHY_DM_STRUCT *p_dm_odm, - u32 reg_addr, - u16 data -) +void odm_write_2byte(struct dm_struct *dm, u32 reg_addr, u16 data) { #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - struct rtl8192cd_priv *priv = p_dm_odm->priv; + struct rtl8192cd_priv *priv = 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 *)dm->adapter; + + rtl_write_word(rtlpriv, reg_addr, data); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) + struct rtw_dev *rtwdev = dm->adapter; + + rtw_write16(rtwdev, reg_addr, data); #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - struct _ADAPTER *adapter = p_dm_odm->adapter; + void *adapter = dm->adapter; rtw_write16(adapter, reg_addr, data); #elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) - struct _ADAPTER *adapter = p_dm_odm->adapter; + void *adapter = dm->adapter; PlatformEFIOWrite2Byte(adapter, reg_addr, data); -#endif +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + void *adapter = dm->adapter; + rtw_write16(adapter, reg_addr, data); +#endif } - -void -odm_write_4byte( - struct PHY_DM_STRUCT *p_dm_odm, - u32 reg_addr, - u32 data -) +void odm_write_4byte(struct dm_struct *dm, u32 reg_addr, u32 data) { #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - struct rtl8192cd_priv *priv = p_dm_odm->priv; + struct rtl8192cd_priv *priv = 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 *)dm->adapter; + + rtl_write_dword(rtlpriv, reg_addr, data); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) + struct rtw_dev *rtwdev = dm->adapter; + + rtw_write32(rtwdev, reg_addr, data); #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - struct _ADAPTER *adapter = p_dm_odm->adapter; + void *adapter = dm->adapter; rtw_write32(adapter, reg_addr, data); #elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) - struct _ADAPTER *adapter = p_dm_odm->adapter; + void *adapter = dm->adapter; PlatformEFIOWrite4Byte(adapter, reg_addr, data); -#endif +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + void *adapter = dm->adapter; + rtw_write32(adapter, reg_addr, data); +#endif } - -void -odm_set_mac_reg( - struct PHY_DM_STRUCT *p_dm_odm, - u32 reg_addr, - u32 bit_mask, - u32 data -) +void odm_set_mac_reg(struct dm_struct *dm, u32 reg_addr, u32 bit_mask, u32 data) { #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - phy_set_bb_reg(p_dm_odm->priv, reg_addr, bit_mask, data); + phy_set_bb_reg(dm->priv, reg_addr, bit_mask, data); #elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) - struct _ADAPTER *adapter = p_dm_odm->adapter; + void *adapter = 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 *)dm->adapter; + + rtl_set_bbreg(rtlpriv->hw, reg_addr, bit_mask, data); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) + struct rtw_dev *rtwdev = dm->adapter; + + rtw_set_reg_with_mask(rtwdev, reg_addr, bit_mask, data); +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + phy_set_bb_reg(dm->adapter, reg_addr, bit_mask, data); #else - phy_set_bb_reg(p_dm_odm->adapter, reg_addr, bit_mask, data); + phy_set_bb_reg(dm->adapter, reg_addr, bit_mask, data); #endif } - -u32 -odm_get_mac_reg( - struct PHY_DM_STRUCT *p_dm_odm, - u32 reg_addr, - u32 bit_mask -) +u32 odm_get_mac_reg(struct dm_struct *dm, u32 reg_addr, u32 bit_mask) { #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - return phy_query_bb_reg(p_dm_odm->priv, reg_addr, bit_mask); + return phy_query_bb_reg(dm->priv, reg_addr, bit_mask); #elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) - return PHY_QueryMacReg(p_dm_odm->adapter, reg_addr, bit_mask); + return PHY_QueryMacReg(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 *)dm->adapter; + + return rtl_get_bbreg(rtlpriv->hw, reg_addr, bit_mask); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) + struct rtw_dev *rtwdev = dm->adapter; + + return rtw_get_reg_with_mask(rtwdev, reg_addr, bit_mask); +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + return phy_query_bb_reg(dm->adapter, reg_addr, bit_mask); #else - return phy_query_mac_reg(p_dm_odm->adapter, reg_addr, bit_mask); + return phy_query_mac_reg(dm->adapter, reg_addr, bit_mask); #endif } - -void -odm_set_bb_reg( - struct PHY_DM_STRUCT *p_dm_odm, - u32 reg_addr, - u32 bit_mask, - u32 data -) +void odm_set_bb_reg(struct dm_struct *dm, u32 reg_addr, u32 bit_mask, u32 data) { #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - phy_set_bb_reg(p_dm_odm->priv, reg_addr, bit_mask, data); + phy_set_bb_reg(dm->priv, reg_addr, bit_mask, data); #elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) - struct _ADAPTER *adapter = p_dm_odm->adapter; + void *adapter = 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 *)dm->adapter; + + rtl_set_bbreg(rtlpriv->hw, reg_addr, bit_mask, data); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) + struct rtw_dev *rtwdev = dm->adapter; + + rtw_set_reg_with_mask(rtwdev, reg_addr, bit_mask, data); +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + phy_set_bb_reg(dm->adapter, reg_addr, bit_mask, data); #else - phy_set_bb_reg(p_dm_odm->adapter, reg_addr, bit_mask, data); + phy_set_bb_reg(dm->adapter, reg_addr, bit_mask, data); #endif } - -u32 -odm_get_bb_reg( - struct PHY_DM_STRUCT *p_dm_odm, - u32 reg_addr, - u32 bit_mask -) +u32 odm_get_bb_reg(struct dm_struct *dm, u32 reg_addr, u32 bit_mask) { #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - return phy_query_bb_reg(p_dm_odm->priv, reg_addr, bit_mask); + return phy_query_bb_reg(dm->priv, reg_addr, bit_mask); #elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) - struct _ADAPTER *adapter = p_dm_odm->adapter; + void *adapter = 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 *)dm->adapter; + + return rtl_get_bbreg(rtlpriv->hw, reg_addr, bit_mask); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) + struct rtw_dev *rtwdev = dm->adapter; + + return rtw_get_reg_with_mask(rtwdev, reg_addr, bit_mask); +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + return phy_query_bb_reg(dm->adapter, reg_addr, bit_mask); #else - return phy_query_bb_reg(p_dm_odm->adapter, reg_addr, bit_mask); + return phy_query_bb_reg(dm->adapter, reg_addr, bit_mask); #endif } - -void -odm_set_rf_reg( - struct PHY_DM_STRUCT *p_dm_odm, - enum odm_rf_radio_path_e e_rf_path, - u32 reg_addr, - u32 bit_mask, - u32 data -) +void odm_set_rf_reg(struct dm_struct *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_odm->priv, e_rf_path, reg_addr, bit_mask, data); + phy_set_rf_reg(dm->priv, e_rf_path, reg_addr, bit_mask, data); #elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) - struct _ADAPTER *adapter = p_dm_odm->adapter; + void *adapter = 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 *)dm->adapter; + + rtl_set_rfreg(rtlpriv->hw, e_rf_path, reg_addr, bit_mask, data); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) + struct rtw_dev *rtwdev = dm->adapter; + + rtw_write_rf(rtwdev, e_rf_path, reg_addr, bit_mask, data); #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - phy_set_rf_reg(p_dm_odm->adapter, e_rf_path, reg_addr, bit_mask, data); + phy_set_rf_reg(dm->adapter, e_rf_path, reg_addr, bit_mask, data); +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + phy_set_rf_reg(dm->adapter, e_rf_path, reg_addr, bit_mask, data); + ODM_delay_us(2); #endif } -u32 -odm_get_rf_reg( - struct PHY_DM_STRUCT *p_dm_odm, - enum odm_rf_radio_path_e e_rf_path, - u32 reg_addr, - u32 bit_mask -) +u32 odm_get_rf_reg(struct dm_struct *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_odm->priv, e_rf_path, reg_addr, bit_mask, 1); + return phy_query_rf_reg(dm->priv, e_rf_path, reg_addr, bit_mask, 1); #elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) - struct _ADAPTER *adapter = p_dm_odm->adapter; + void *adapter = 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 *)dm->adapter; + + return rtl_get_rfreg(rtlpriv->hw, e_rf_path, reg_addr, bit_mask); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) + struct rtw_dev *rtwdev = dm->adapter; + + return rtw_read_rf(rtwdev, e_rf_path, reg_addr, bit_mask); +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + return phy_query_rf_reg(dm->adapter, e_rf_path, reg_addr, bit_mask); #else - return phy_query_rf_reg(p_dm_odm->adapter, e_rf_path, reg_addr, bit_mask); + return phy_query_rf_reg(dm->adapter, e_rf_path, reg_addr, bit_mask); #endif } +enum hal_status +phydm_set_reg_by_fw(struct dm_struct *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(dm, + config_type, + offset, + data, + mask, + e_rf_path, + delay_time); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) +#if (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + PHYDM_DBG(dm, DBG_CMN, "Not support for CE MAC80211 driver!\n"); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) + return -ENOTSUPP; +#else + return rtw_phydm_cfg_phy_para(dm, + config_type, + offset, + data, + mask, + e_rf_path, + delay_time); +#endif +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + PHYDM_DBG(dm, DBG_CMN, "Not support for CE MAC80211 driver!\n"); +#endif +} - - -/* +/*@ * ODM Memory relative API. - * */ -void -odm_allocate_memory( - struct PHY_DM_STRUCT *p_dm_odm, - void **p_ptr, - u32 length -) + */ +void odm_allocate_memory(struct dm_struct *dm, void **ptr, u32 length) { #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - *p_ptr = kmalloc(length, GFP_ATOMIC); + *ptr = kmalloc(length, GFP_ATOMIC); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + *ptr = kmalloc(length, GFP_ATOMIC); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) + *ptr = kmalloc(length, GFP_ATOMIC); #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - *p_ptr = rtw_zvmalloc(length); + *ptr = rtw_zvmalloc(length); #elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) - struct _ADAPTER *adapter = p_dm_odm->adapter; - PlatformAllocateMemory(adapter, p_ptr, length); + void *adapter = dm->adapter; + PlatformAllocateMemory(adapter, ptr, length); +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + *ptr = rtw_zvmalloc(length); #endif } -/* length could be ignored, used to detect memory leakage. */ -void -odm_free_memory( - struct PHY_DM_STRUCT *p_dm_odm, - void *p_ptr, - u32 length -) +/* @length could be ignored, used to detect memory leakage. */ +void odm_free_memory(struct dm_struct *dm, void *ptr, u32 length) { #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - kfree(p_ptr); + kfree(ptr); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + kfree(ptr); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) + kfree(ptr); #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - rtw_vmfree(p_ptr, length); + rtw_vmfree(ptr, length); #elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) - /* struct _ADAPTER* adapter = p_dm_odm->adapter; */ - PlatformFreeMemory(p_ptr, length); + /* struct void* adapter = dm->adapter; */ + PlatformFreeMemory(ptr, length); +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + rtw_vmfree(ptr, length); #endif } -void -odm_move_memory( - struct PHY_DM_STRUCT *p_dm_odm, - void *p_dest, - void *p_src, - u32 length -) +void odm_move_memory(struct dm_struct *dm, void *dest, void *src, u32 length) { #if (DM_ODM_SUPPORT_TYPE & ODM_AP) - memcpy(p_dest, p_src, length); + memcpy(dest, src, length); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + memcpy(dest, src, length); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) + memcpy(dest, src, length); #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - _rtw_memcpy(p_dest, p_src, length); + _rtw_memcpy(dest, src, length); #elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) - PlatformMoveMemory(p_dest, p_src, length); + PlatformMoveMemory(dest, src, length); +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + rtw_memcpy(dest, src, length); #endif } -void odm_memory_set( - struct PHY_DM_STRUCT *p_dm_odm, - void *pbuf, - s8 value, - u32 length -) +void odm_memory_set(struct dm_struct *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) && defined(DM_ODM_CE_MAC80211_V2) + 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); +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + rtw_memset(pbuf, value, length); #endif } -s32 odm_compare_memory( - struct PHY_DM_STRUCT *p_dm_odm, - void *p_buf1, - void *p_buf2, - u32 length -) + +s32 odm_compare_memory(struct dm_struct *dm, void *buf1, void *buf2, u32 length) { #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - return memcmp(p_buf1, p_buf2, length); + return memcmp(buf1, buf2, length); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + return memcmp(buf1, buf2, length); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) + return memcmp(buf1, buf2, length); #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - return _rtw_memcmp(p_buf1, p_buf2, length); + return _rtw_memcmp(buf1, buf2, length); #elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) - return PlatformCompareMemory(p_buf1, p_buf2, length); + return PlatformCompareMemory(buf1, buf2, length); +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + return rtw_memcmp(buf1, buf2, length); #endif } - - -/* +/*@ * ODM MISC relative API. - * */ -void -odm_acquire_spin_lock( - struct PHY_DM_STRUCT *p_dm_odm, - enum rt_spinlock_type type -) + */ +void odm_acquire_spin_lock(struct dm_struct *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) + struct rtl_priv *rtlpriv = (struct rtl_priv *)dm->adapter; + + rtl_odm_acquirespinlock(rtlpriv, type); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) + struct rtw_dev *rtwdev = dm->adapter; + + spin_lock(&rtwdev->hal.dm_lock); #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - struct _ADAPTER *adapter = p_dm_odm->adapter; + void *adapter = dm->adapter; rtw_odm_acquirespinlock(adapter, type); #elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) - struct _ADAPTER *adapter = p_dm_odm->adapter; + void *adapter = dm->adapter; PlatformAcquireSpinLock(adapter, type); +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + void *adapter = dm->adapter; + + rtw_odm_acquirespinlock(adapter, type); #endif } -void -odm_release_spin_lock( - struct PHY_DM_STRUCT *p_dm_odm, - enum rt_spinlock_type type -) + +void odm_release_spin_lock(struct dm_struct *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) + struct rtl_priv *rtlpriv = (struct rtl_priv *)dm->adapter; + + rtl_odm_releasespinlock(rtlpriv, type); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) + struct rtw_dev *rtwdev = dm->adapter; + + spin_unlock(&rtwdev->hal.dm_lock); #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - struct _ADAPTER *adapter = p_dm_odm->adapter; + void *adapter = dm->adapter; rtw_odm_releasespinlock(adapter, type); #elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) - struct _ADAPTER *adapter = p_dm_odm->adapter; + void *adapter = dm->adapter; PlatformReleaseSpinLock(adapter, type); +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + void *adapter = dm->adapter; + + rtw_odm_releasespinlock(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_odm, - PRT_WORK_ITEM p_rt_work_item, - RT_WORKITEM_CALL_BACK rt_work_item_callback, - void *p_context, - const char *sz_id -) +void odm_initialize_work_item( + struct dm_struct *dm, + PRT_WORK_ITEM work_item, + RT_WORKITEM_CALL_BACK callback, + void *context, + const char *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_odm->adapter; - PlatformInitializeWorkItem(adapter, p_rt_work_item, rt_work_item_callback, p_context, sz_id); + void *adapter = dm->adapter; + PlatformInitializeWorkItem(adapter, work_item, callback, context, id); #endif } - -void -odm_start_work_item( - PRT_WORK_ITEM p_rt_work_item -) +void odm_start_work_item( + PRT_WORK_ITEM p_rt_work_item) { #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) @@ -429,11 +536,8 @@ odm_start_work_item( #endif } - -void -odm_stop_work_item( - PRT_WORK_ITEM p_rt_work_item -) +void odm_stop_work_item( + PRT_WORK_ITEM p_rt_work_item) { #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) @@ -444,11 +548,8 @@ odm_stop_work_item( #endif } - -void -odm_free_work_item( - PRT_WORK_ITEM p_rt_work_item -) +void odm_free_work_item( + PRT_WORK_ITEM p_rt_work_item) { #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) @@ -459,11 +560,8 @@ odm_free_work_item( #endif } - -void -odm_schedule_work_item( - PRT_WORK_ITEM p_rt_work_item -) +void odm_schedule_work_item( + PRT_WORK_ITEM p_rt_work_item) { #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) @@ -474,11 +572,9 @@ odm_schedule_work_item( #endif } - -bool +boolean odm_is_work_item_scheduled( - PRT_WORK_ITEM p_rt_work_item -) + PRT_WORK_ITEM p_rt_work_item) { #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) @@ -490,134 +586,144 @@ odm_is_work_item_scheduled( } #endif - -/* +/*@ * ODM Timer relative API. - * */ -void -odm_stall_execution( - u32 us_delay -) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + */ -#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - rtw_udelay_os(us_delay); -#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) - PlatformStallExecution(us_delay); -#endif -} - -void -ODM_delay_ms(u32 ms) +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) && defined(DM_ODM_CE_MAC80211_V2) + mdelay(ms); #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) rtw_mdelay_os(ms); #elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) delay_ms(ms); +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + rtw_mdelay_os(ms); #endif } -void -ODM_delay_us(u32 us) +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) && defined(DM_ODM_CE_MAC80211_V2) + udelay(us); #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) rtw_udelay_os(us); #elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) PlatformStallExecution(us); +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + rtw_udelay_os(us); #endif } -void -ODM_sleep_ms(u32 ms) +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) && defined(DM_ODM_CE_MAC80211_V2) + msleep(ms); #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) rtw_msleep_os(ms); #elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + delay_ms(ms); +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + rtw_msleep_os(ms); #endif } -void -ODM_sleep_us(u32 us) +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) && defined(DM_ODM_CE_MAC80211_V2) + 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); +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + rtw_usleep_os(us); #endif } -void -odm_set_timer( - struct PHY_DM_STRUCT *p_dm_odm, - struct timer_list *p_timer, - u32 ms_delay -) +void odm_set_timer(struct dm_struct *dm, struct phydm_timer_list *timer, + u32 ms_delay) { #if (DM_ODM_SUPPORT_TYPE & ODM_AP) - mod_timer(p_timer, jiffies + RTL_MILISECONDS_TO_JIFFIES(ms_delay)); + mod_timer(timer, jiffies + RTL_MILISECONDS_TO_JIFFIES(ms_delay)); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + mod_timer(timer, jiffies + msecs_to_jiffies(ms_delay)); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) + mod_timer(&timer->timer, jiffies + msecs_to_jiffies(ms_delay)); #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - _set_timer(p_timer, ms_delay); /* ms */ + _set_timer(timer, ms_delay); /* @ms */ #elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) - struct _ADAPTER *adapter = p_dm_odm->adapter; - PlatformSetTimer(adapter, p_timer, ms_delay); + void *adapter = dm->adapter; + PlatformSetTimer(adapter, timer, ms_delay); +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + rtw_set_timer(timer, ms_delay); /* @ms */ #endif - } -void -odm_initialize_timer( - struct PHY_DM_STRUCT *p_dm_odm, - struct timer_list *p_timer, - void *call_back_func, - void *p_context, - const char *sz_id -) +void odm_initialize_timer(struct dm_struct *dm, struct phydm_timer_list *timer, + void *call_back_func, void *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_odm; - /*mod_timer(p_timer, jiffies+RTL_MILISECONDS_TO_JIFFIES(10)); */ + init_timer(timer); + timer->function = call_back_func; + timer->data = (unsigned long)dm; +#if 0 + /*@mod_timer(timer, jiffies+RTL_MILISECONDS_TO_JIFFIES(10)); */ +#endif +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + timer_setup(timer, call_back_func, 0); #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - struct _ADAPTER *adapter = p_dm_odm->adapter; - _init_timer(p_timer, adapter->pnetdev, call_back_func, p_dm_odm); + struct _ADAPTER *adapter = dm->adapter; + + _init_timer(timer, adapter->pnetdev, call_back_func, dm); #elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) - struct _ADAPTER *adapter = p_dm_odm->adapter; - PlatformInitializeTimer(adapter, p_timer, call_back_func, p_context, sz_id); + void *adapter = dm->adapter; + + PlatformInitializeTimer(adapter, timer, (RT_TIMER_CALL_BACK)call_back_func, context, sz_id); +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + struct _ADAPTER *adapter = dm->adapter; + + rtw_init_timer(timer, adapter->pnetdev, (TIMER_FUN)call_back_func, dm, NULL); #endif } - -void -odm_cancel_timer( - struct PHY_DM_STRUCT *p_dm_odm, - struct timer_list *p_timer -) +void odm_cancel_timer(struct dm_struct *dm, struct phydm_timer_list *timer) { #if (DM_ODM_SUPPORT_TYPE & ODM_AP) - del_timer(p_timer); + del_timer(timer); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + del_timer(timer); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) + del_timer(&timer->timer); #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - _cancel_timer_ex(p_timer); + _cancel_timer_ex(timer); #elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) - struct _ADAPTER *adapter = p_dm_odm->adapter; - PlatformCancelTimer(adapter, p_timer); + void *adapter = dm->adapter; + PlatformCancelTimer(adapter, timer); +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + rtw_cancel_timer(timer); #endif } - -void -odm_release_timer( - struct PHY_DM_STRUCT *p_dm_odm, - struct timer_list *p_timer -) +void odm_release_timer(struct dm_struct *dm, struct phydm_timer_list *timer) { #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) @@ -625,60 +731,64 @@ odm_release_timer( #elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) - struct _ADAPTER *adapter = p_dm_odm->adapter; + void *adapter = 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) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_SERIOUS, ("=====>odm_release_timer(), The timer is NULL! Please check it!\n")); + /* @<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 (timer == 0) { + PHYDM_DBG(dm, ODM_COMP_INIT, + "[%s] Timer is NULL! Please check!\n", __func__); return; } - PlatformReleaseTimer(adapter, p_timer); + PlatformReleaseTimer(adapter, timer); +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + rtw_del_timer(timer); #endif } - -u8 -phydm_trans_h2c_id( - struct PHY_DM_STRUCT *p_dm_odm, - u8 phydm_h2c_id -) +u8 phydm_trans_h2c_id(struct dm_struct *dm, u8 phydm_h2c_id) { u8 platform_h2c_id = phydm_h2c_id; switch (phydm_h2c_id) { - /* 1 [0] */ + /* @1 [0] */ case ODM_H2C_RSSI_REPORT: #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - if (p_dm_odm->support_ic_type == ODM_RTL8188E) + #if (RTL8188E_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8188E) platform_h2c_id = H2C_88E_RSSI_REPORT; - else if (p_dm_odm->support_ic_type == ODM_RTL8814A) - platform_h2c_id = H2C_8814A_RSSI_REPORT; else + #endif 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) && defined(DM_ODM_CE_MAC80211_V2) #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_odm->support_ic_type == ODM_RTL8881A || p_dm_odm->support_ic_type == ODM_RTL8192E || p_dm_odm->support_ic_type & PHYDM_IC_3081_SERIES) +#if ((RTL8881A_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8814A_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) || (RTL8197F_SUPPORT == 1) || (RTL8192F_SUPPORT == 1)) /*@jj add 20170822*/ + if (dm->support_ic_type == ODM_RTL8881A || dm->support_ic_type == ODM_RTL8192E || dm->support_ic_type & PHYDM_IC_3081_SERIES) platform_h2c_id = H2C_88XX_RSSI_REPORT; else #endif #if (RTL8812A_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8812) - platform_h2c_id = H2C_8812_RSSI_REPORT; - else + if (dm->support_ic_type == ODM_RTL8812) + platform_h2c_id = H2C_8812_RSSI_REPORT; + else #endif - {} + { + } #endif break; - /* 1 [3] */ + /* @1 [3] */ case ODM_H2C_WIFI_CALIBRATION: #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) platform_h2c_id = H2C_WIFI_CALIBRATION; @@ -692,8 +802,7 @@ phydm_trans_h2c_id( #endif break; - - /* 1 [4] */ + /* @1 [4] */ case ODM_H2C_IQ_CALIBRATION: #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) platform_h2c_id = H2C_IQ_CALIBRATION; @@ -706,14 +815,13 @@ phydm_trans_h2c_id( #endif break; - /* 1 [5] */ + /* @1 [5] */ case ODM_H2C_RA_PARA_ADJUST: #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - if (p_dm_odm->support_ic_type & (ODM_RTL8814A | ODM_RTL8822B)) - platform_h2c_id = H2C_8814A_RA_PARA_ADJUST; - else - platform_h2c_id = H2C_RA_PARA_ADJUST; + 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) && defined(DM_ODM_CE_MAC80211_V2) #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) #if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) platform_h2c_id = H2C_8812_RA_PARA_ADJUST; @@ -726,36 +834,38 @@ phydm_trans_h2c_id( #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_odm->support_ic_type == ODM_RTL8881A || p_dm_odm->support_ic_type == ODM_RTL8192E || p_dm_odm->support_ic_type & PHYDM_IC_3081_SERIES) +#if ((RTL8881A_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8814A_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) || (RTL8197F_SUPPORT == 1) || (RTL8192F_SUPPORT == 1)) /*@jj add 20170822*/ + if (dm->support_ic_type == ODM_RTL8881A || dm->support_ic_type == ODM_RTL8192E || 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_odm->support_ic_type == ODM_RTL8812) - platform_h2c_id = H2C_8812_RA_PARA_ADJUST; - else + if (dm->support_ic_type == ODM_RTL8812) + platform_h2c_id = H2C_8812_RA_PARA_ADJUST; + else #endif - {} + { + } #endif break; - - /* 1 [6] */ + /* @1 [6] */ case PHYDM_H2C_DYNAMIC_TX_PATH: #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - if (p_dm_odm->support_ic_type == ODM_RTL8814A) + #if (RTL8814A_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8814A) platform_h2c_id = H2C_8814A_DYNAMIC_TX_PATH; + #endif #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) #if (RTL8814A_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8814A) + if (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_odm->support_ic_type == ODM_RTL8814A) + if (dm->support_ic_type == ODM_RTL8814A) platform_h2c_id = H2C_88XX_DYNAMIC_TX_PATH; #endif @@ -763,31 +873,30 @@ phydm_trans_h2c_id( break; - /* [7]*/ + /* @[7]*/ case PHYDM_H2C_FW_TRACE_EN: #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - if (p_dm_odm->support_ic_type & (ODM_RTL8814A | ODM_RTL8822B)) - platform_h2c_id = H2C_8814A_FW_TRACE_EN; - else - platform_h2c_id = H2C_FW_TRACE_EN; + + 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_odm->support_ic_type == ODM_RTL8881A || p_dm_odm->support_ic_type == ODM_RTL8192E || p_dm_odm->support_ic_type & PHYDM_IC_3081_SERIES) - platform_h2c_id = H2C_88XX_FW_TRACE_EN; +#if ((RTL8881A_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8814A_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) || (RTL8197F_SUPPORT == 1) || (RTL8192F_SUPPORT == 1)) /*@jj add 20170822*/ + if (dm->support_ic_type == ODM_RTL8881A || dm->support_ic_type == ODM_RTL8192E || 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_odm->support_ic_type == ODM_RTL8812) - platform_h2c_id = H2C_8812_FW_TRACE_EN; - else + if (dm->support_ic_type == ODM_RTL8812) + platform_h2c_id = H2C_8812_FW_TRACE_EN; + else #endif - {} + { + } #endif @@ -795,13 +904,13 @@ phydm_trans_h2c_id( case PHYDM_H2C_TXBF: #if ((RTL8192E_SUPPORT == 1) || (RTL8812A_SUPPORT == 1)) - platform_h2c_id = 0x41; /*H2C_TxBF*/ + platform_h2c_id = 0x41; /*@H2C_TxBF*/ #endif break; case PHYDM_H2C_MU: #if (RTL8822B_SUPPORT == 1) - platform_h2c_id = 0x4a; /*H2C_MU*/ + platform_h2c_id = 0x4a; /*@H2C_MU*/ #endif break; @@ -811,114 +920,133 @@ phydm_trans_h2c_id( } return platform_h2c_id; - } -/*ODM FW relative API.*/ +/*@ODM FW relative API.*/ -void -odm_fill_h2c_cmd( - struct PHY_DM_STRUCT *p_dm_odm, - u8 phydm_h2c_id, - u32 cmd_len, - u8 *p_cmd_buffer -) +void odm_fill_h2c_cmd(struct dm_struct *dm, u8 phydm_h2c_id, u32 cmd_len, + u8 *cmd_buf) { - struct _ADAPTER *adapter = p_dm_odm->adapter; - u8 platform_h2c_id; +#if (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + struct rtl_priv *rtlpriv = (struct rtl_priv *)dm->adapter; +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) + struct rtw_dev *rtwdev = dm->adapter; + u8 cmd_id, cmd_class; + u8 h2c_pkt[8]; +#else + void *adapter = dm->adapter; +#endif + u8 h2c_id = phydm_trans_h2c_id(dm, phydm_h2c_id); - platform_h2c_id = phydm_trans_h2c_id(p_dm_odm, phydm_h2c_id); - - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[H2C] platform_h2c_id = ((0x%x))\n", platform_h2c_id)); + PHYDM_DBG(dm, DBG_RA, "[H2C] h2c_id=((0x%x))\n", h2c_id); #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - if (p_dm_odm->support_ic_type == ODM_RTL8188E) { - if (!p_dm_odm->ra_support88e) - FillH2CCmd88E(adapter, platform_h2c_id, cmd_len, p_cmd_buffer); - } else if (p_dm_odm->support_ic_type == ODM_RTL8814A) - FillH2CCmd8814A(adapter, platform_h2c_id, cmd_len, p_cmd_buffer); - else if (p_dm_odm->support_ic_type == ODM_RTL8822B) -#if (RTL8822B_SUPPORT == 1) - FillH2CCmd8822B(adapter, platform_h2c_id, cmd_len, p_cmd_buffer); -#endif + if (dm->support_ic_type == ODM_RTL8188E) { + if (!dm->ra_support88e) + FillH2CCmd88E(adapter, h2c_id, cmd_len, cmd_buf); + } else if (dm->support_ic_type == ODM_RTL8814A) + FillH2CCmd8814A(adapter, h2c_id, cmd_len, cmd_buf); + else if (dm->support_ic_type == ODM_RTL8822B) + FillH2CCmd8822B(adapter, h2c_id, cmd_len, cmd_buf); else - FillH2CCmd(adapter, platform_h2c_id, cmd_len, p_cmd_buffer); + FillH2CCmd(adapter, h2c_id, cmd_len, cmd_buf); #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - rtw_hal_fill_h2c_cmd(adapter, platform_h2c_id, cmd_len, p_cmd_buffer); + + #ifdef DM_ODM_CE_MAC80211 + rtlpriv->cfg->ops->fill_h2c_cmd(rtlpriv->hw, h2c_id, cmd_len, cmd_buf); + #elif defined(DM_ODM_CE_MAC80211_V2) + cmd_id = phydm_h2c_id & 0x1f; + cmd_class = (phydm_h2c_id >> RTW_H2C_CLASS_OFFSET) & 0x7; + memcpy(h2c_pkt + 1, cmd_buf, 7); + h2c_pkt[0] = phydm_h2c_id; + rtw_fw_send_h2c_packet(rtwdev, h2c_pkt, cmd_id, cmd_class); + /* TODO: implement fill h2c command for rtwlan */ + #else + rtw_hal_fill_h2c_cmd(adapter, h2c_id, cmd_len, cmd_buf); + #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_odm->support_ic_type == ODM_RTL8881A || p_dm_odm->support_ic_type == ODM_RTL8192E || p_dm_odm->support_ic_type & PHYDM_IC_3081_SERIES) - GET_HAL_INTERFACE(p_dm_odm->priv)->fill_h2c_cmd_handler(p_dm_odm->priv, platform_h2c_id, cmd_len, p_cmd_buffer); - else -#endif -#if (RTL8812A_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8812) - fill_h2c_cmd8812(p_dm_odm->priv, platform_h2c_id, cmd_len, p_cmd_buffer); - else -#endif - {} + + #if (RTL8812A_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8812) { + fill_h2c_cmd8812(dm->priv, h2c_id, cmd_len, cmd_buf); + } else + #endif + { + GET_HAL_INTERFACE(dm->priv)->fill_h2c_cmd_handler(dm->priv, h2c_id, cmd_len, cmd_buf); + } + +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + rtw_hal_fill_h2c_cmd(adapter, h2c_id, cmd_len, cmd_buf); + #endif } -u8 -phydm_c2H_content_parsing( - void *p_dm_void, - u8 c2h_cmd_id, - u8 c2h_cmd_len, - u8 *tmp_buf -) +u8 phydm_c2H_content_parsing(void *dm_void, u8 c2h_cmd_id, u8 c2h_cmd_len, + u8 *tmp_buf) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _ADAPTER *adapter = p_dm_odm->adapter; + void *adapter = dm->adapter; #endif - u8 extend_c2h_sub_id = 0; - u8 find_c2h_cmd = true; + u8 extend_c2h_sub_id = 0; + u8 find_c2h_cmd = true; + + if (c2h_cmd_len > 12 || c2h_cmd_len == 0) { + pr_debug("[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_odm, tmp_buf, c2h_cmd_len); + phydm_fw_trace_handler(dm, tmp_buf, c2h_cmd_len); break; case PHYDM_C2H_RA_RPT: - phydm_c2h_ra_report_handler(p_dm_odm, tmp_buf, c2h_cmd_len); + phydm_c2h_ra_report_handler(dm, tmp_buf, c2h_cmd_len); break; case PHYDM_C2H_RA_PARA_RPT: - odm_c2h_ra_para_report_handler(p_dm_odm, tmp_buf, c2h_cmd_len); + odm_c2h_ra_para_report_handler(dm, tmp_buf, c2h_cmd_len); break; - +#ifdef CONFIG_PATH_DIVERSITY case PHYDM_C2H_DYNAMIC_TX_PATH_RPT: - if (p_dm_odm->support_ic_type & (ODM_RTL8814A)) - phydm_c2h_dtp_handler(p_dm_odm, tmp_buf, c2h_cmd_len); + if (dm->support_ic_type & (ODM_RTL8814A)) + phydm_c2h_dtp_handler(dm, tmp_buf, c2h_cmd_len); break; +#endif case PHYDM_C2H_IQK_FINISH: #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - if (p_dm_odm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821)) { - + if (dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821)) { RT_TRACE(COMP_MP, DBG_LOUD, ("== FW IQK Finish ==\n")); - odm_acquire_spin_lock(p_dm_odm, RT_IQK_SPINLOCK); - p_dm_odm->rf_calibrate_info.is_iqk_in_progress = false; - odm_release_spin_lock(p_dm_odm, RT_IQK_SPINLOCK); - p_dm_odm->rf_calibrate_info.iqk_progressing_time = 0; - p_dm_odm->rf_calibrate_info.iqk_progressing_time = odm_get_progressing_time(p_dm_odm, p_dm_odm->rf_calibrate_info.iqk_start_time); + odm_acquire_spin_lock(dm, RT_IQK_SPINLOCK); + dm->rf_calibrate_info.is_iqk_in_progress = false; + odm_release_spin_lock(dm, RT_IQK_SPINLOCK); + dm->rf_calibrate_info.iqk_progressing_time = 0; + dm->rf_calibrate_info.iqk_progressing_time = odm_get_progressing_time(dm, dm->rf_calibrate_info.iqk_start_time); } #endif break; + case PHYDM_C2H_CLM_MONITOR: + phydm_clm_c2h_report_handler(dm, tmp_buf, c2h_cmd_len); + break; + case PHYDM_C2H_DBG_CODE: - phydm_fw_trace_handler_code(p_dm_odm, tmp_buf, c2h_cmd_len); + phydm_fw_trace_handler_code(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_odm, tmp_buf, c2h_cmd_len); + phydm_fw_trace_handler_8051(dm, tmp_buf, c2h_cmd_len); break; @@ -928,77 +1056,436 @@ phydm_c2H_content_parsing( } return find_c2h_cmd; - } -u64 -odm_get_current_time( - struct PHY_DM_STRUCT *p_dm_odm -) +u64 odm_get_current_time(struct dm_struct *dm) { #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - return 0; -#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) 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) && defined(DM_ODM_CE_MAC80211_V2) + return jiffies; +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + return rtw_get_current_time(); #elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) - return PlatformGetCurrentTime(); + return PlatformGetCurrentTime(); +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + return rtw_get_current_time(); #endif } -u64 -odm_get_progressing_time( - struct PHY_DM_STRUCT *p_dm_odm, - u64 start_time -) +u64 odm_get_progressing_time(struct dm_struct *dm, u64 start_time) { #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - return 0; -#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) 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) && defined(DM_ODM_CE_MAC80211_V2) + 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); +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + return rtw_get_passing_time_ms(start_time); #endif } -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) && \ + (!defined(DM_ODM_CE_MAC80211) && !defined(DM_ODM_CE_MAC80211_V2)) -void -phydm_set_hw_reg_handler_interface ( - struct PHY_DM_STRUCT *p_dm_odm, - u8 RegName, - u8 *val - ) +void phydm_set_hw_reg_handler_interface(struct dm_struct *dm, u8 RegName, + u8 *val) { -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - struct _ADAPTER *adapter = p_dm_odm->adapter; +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + struct _ADAPTER *adapter = dm->adapter; #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - adapter->HalFunc.SetHwRegHandler(adapter, RegName, val); + ((PADAPTER)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_odm, - enum _HAL_DEF_VARIABLE e_variable, - void *p_value - ) +void phydm_get_hal_def_var_handler_interface(struct dm_struct *dm, + enum _HAL_DEF_VARIABLE e_variable, + void *value) { -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - struct _ADAPTER *adapter = p_dm_odm->adapter; +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + struct _ADAPTER *adapter = dm->adapter; #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - adapter->HalFunc.GetHalDefVarHandler(adapter, e_variable, p_value); + ((PADAPTER)adapter)->HalFunc.GetHalDefVarHandler(adapter, e_variable, value); #else - adapter->hal_func.get_hal_def_var_handler(adapter, e_variable, p_value); + adapter->hal_func.get_hal_def_var_handler(adapter, e_variable, value); #endif #endif } -#endif \ No newline at end of file +#endif + +void odm_set_tx_power_index_by_rate_section(struct dm_struct *dm, + enum rf_path path, u8 ch, + u8 section) +{ +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + void *adapter = dm->adapter; + PHY_SetTxPowerIndexByRateSection(adapter, path, ch, section); +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) + void *adapter = dm->adapter; + + phy_set_tx_power_index_by_rs(adapter, ch, path, section); +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + phy_set_tx_power_index_by_rate_section(dm->adapter, path, ch, section); +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + void *adapter = dm->adapter; + + PHY_SetTxPowerIndexByRateSection(adapter, path, ch, section); +#endif +} + +u8 odm_get_tx_power_index(struct dm_struct *dm, enum rf_path path, u8 rate, + u8 bw, u8 ch) +{ +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + void *adapter = dm->adapter; + + return PHY_GetTxPowerIndex(dm->adapter, path, rate, (CHANNEL_WIDTH)bw, ch); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + void *adapter = dm->adapter; + + return phy_get_tx_power_index(adapter, path, rate, bw, ch); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) + void *adapter = dm->adapter; + + return phy_get_tx_power_index(adapter, path, rate, bw, ch); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + return phy_get_tx_power_index(dm->adapter, path, rate, bw, ch); +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + void *adapter = dm->adapter; + + return PHY_GetTxPowerIndex(dm->adapter, path, rate, bw, ch); +#endif +} + +u8 odm_efuse_one_byte_read(struct dm_struct *dm, u16 addr, u8 *data, + boolean b_pseu_do_test) +{ +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + void *adapter = 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 = dm->adapter; + + return rtl_efuse_onebyte_read(adapter, addr, data, b_pseu_do_test); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) + return -1; +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + return efuse_onebyte_read(dm->adapter, addr, data, b_pseu_do_test); +#elif (DM_ODM_SUPPORT_TYPE & ODM_AP) + return Efuse_OneByteRead(dm, addr, data); +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + void *adapter = dm->adapter; + + return (u8)efuse_OneByteRead(adapter, addr, data, b_pseu_do_test); +#endif +} + +void odm_efuse_logical_map_read(struct dm_struct *dm, u8 type, u16 offset, + u32 *data) +{ +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + void *adapter = dm->adapter; + + EFUSE_ShadowRead(adapter, type, offset, data); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + void *adapter = dm->adapter; + + rtl_efuse_logical_map_read(adapter, type, offset, data); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + efuse_logical_map_read(dm->adapter, type, offset, data); +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + void *adapter = dm->adapter; + + EFUSE_ShadowRead(adapter, type, offset, data); +#endif +} + +enum hal_status +odm_iq_calibrate_by_fw(struct dm_struct *dm, u8 clear, u8 segment) +{ + enum hal_status iqk_result = HAL_STATUS_FAILURE; + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + struct _ADAPTER *adapter = 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) +#if (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + void *adapter = dm->adapter; + + iqk_result = rtl_phydm_fw_iqk(adapter, clear, segment); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) +#else + iqk_result = rtw_phydm_fw_iqk(dm, clear, segment); +#endif +#elif (DM_ODM_SUPPORT_TYPE & ODM_IOT) + iqk_result = rtw_phydm_fw_iqk(dm, clear, segment); +#endif + return iqk_result; +} + +void odm_cmn_info_ptr_array_hook(struct dm_struct *dm, + enum odm_cmninfo cmn_info, u16 index, + void *value) +{ + /*ODM_CMNINFO_STA_STATUS*/ +} + +void phydm_cmn_sta_info_hook(struct dm_struct *dm, u8 mac_id, + struct cmn_sta_info *pcmn_sta_info) +{ + dm->phydm_sta_info[mac_id] = pcmn_sta_info; + + if (is_sta_active(pcmn_sta_info)) + dm->phydm_macid_table[pcmn_sta_info->mac_id] = mac_id; +} + +void phydm_macid2sta_idx_table(struct dm_struct *dm, u8 entry_idx, + struct cmn_sta_info *pcmn_sta_info) +{ + if (is_sta_active(pcmn_sta_info)) + dm->phydm_macid_table[pcmn_sta_info->mac_id] = entry_idx; +} + +void phydm_add_interrupt_mask_handler(struct dm_struct *dm, u8 interrupt_type) +{ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) + + struct rtl8192cd_priv *priv = dm->priv; + + #if IS_EXIST_PCI || IS_EXIST_EMBEDDED + if (dm->support_interface == ODM_ITRF_PCIE) + 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 dm_struct *dm) +{ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) + + struct rtl8192cd_priv *priv = dm->priv; + + #if IS_EXIST_PCI || IS_EXIST_EMBEDDED + if (dm->support_interface == ODM_ITRF_PCIE) + GET_HAL_INTERFACE(priv)->EnableRxRelatedInterruptHandler(priv); + #endif + +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) +#endif +} + +#if 0 +boolean +phydm_get_txbf_en( + struct dm_struct *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; + void *adapter = dm->adapter; + #ifdef PHYDM_BEAMFORMING_SUPPORT + beamform_cap = + phydm_beamforming_get_entry_beam_cap_by_mac_id(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) + +#ifdef PHYDM_BEAMFORMING_SUPPORT + u8 idx = 0xff; + boolean act_bfer = false; + BEAMFORMING_CAP beamform_cap = BEAMFORMING_CAP_NONE; + PRT_BEAMFORMING_ENTRY entry = NULL; + struct rtl8192cd_priv *priv = dm->priv; + #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) + struct _BF_DIV_COEX_ *dm_bdc_table = &dm->dm_bdc_table; + + dm_bdc_table->num_txbfee_client = 0; + dm_bdc_table->num_txbfer_client = 0; + #endif +#endif + +#ifdef PHYDM_BEAMFORMING_SUPPORT + beamform_cap = Beamforming_GetEntryBeamCapByMacId(priv, mac_id); + entry = Beamforming_GetEntryByMacId(priv, mac_id, &idx); + if (beamform_cap & (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP_VHT_SU)) { + if (entry->Sounding_En) + txbf_en = true; + else + txbf_en = false; + act_bfer = true; + } + #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) /*@BDC*/ + if (act_bfer == true) { + dm_bdc_table->w_bfee_client[i] = true; /* @AP act as BFer */ + dm_bdc_table->num_txbfee_client++; + } else + dm_bdc_table->w_bfee_client[i] = false; /* @AP act as BFer */ + + if (beamform_cap & (BEAMFORMEE_CAP_HT_EXPLICIT | BEAMFORMEE_CAP_VHT_SU)) { + dm_bdc_table->w_bfer_client[i] = true; /* @AP act as BFee */ + dm_bdc_table->num_txbfer_client++; + } else + dm_bdc_table->w_bfer_client[i] = false; /* @AP act as BFer */ + + #endif +#endif + +#endif + return txbf_en; +} +#endif + +void phydm_iqk_wait(struct dm_struct *dm, u32 timeout) +{ +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) +#if (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + PHYDM_DBG(dm, DBG_CMN, "Not support for CE MAC80211 driver!\n"); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) +#else + void *adapter = dm->adapter; + + rtl8812_iqk_wait(adapter, timeout); +#endif +#endif +} + +u8 phydm_get_hwrate_to_mrate(struct dm_struct *dm, u8 rate) +{ +#if (DM_ODM_SUPPORT_TYPE == ODM_IOT) + return HwRateToMRate(rate); +#endif + return 0; +} + +void phydm_set_crystalcap(struct dm_struct *dm, u8 crystal_cap) +{ +#if (DM_ODM_SUPPORT_TYPE == ODM_IOT) + ROM_odm_SetCrystalCap(dm, crystal_cap); +#endif +} + +void phydm_run_in_thread_cmd(struct dm_struct *dm, void (*func)(void *), + void *context) +{ +#if (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + PHYDM_DBG(dm, DBG_CMN, "Not support for CE MAC80211 driver!\n"); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + void *adapter = dm->adapter; + + rtw_run_in_thread_cmd(adapter, func, context); +#endif +} + +u8 phydm_get_tx_rate(struct dm_struct *dm) +{ + struct _hal_rf_ *rf = &dm->rf_table; +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + struct _ADAPTER *adapter = dm->adapter; +#endif + u8 tx_rate = 0xff; + u8 mpt_rate_index = 0; + + if (*dm->mp_mode == 1) { +#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 + if (rf->mp_rate_index) + mpt_rate_index = *rf->mp_rate_index; + + tx_rate = mpt_to_mgnt_rate(mpt_rate_index); +#endif +#endif +#endif + } else { + u16 rate = *dm->forced_data_rate; + + if (!rate) { /*auto rate*/ +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + struct _ADAPTER *adapter = dm->adapter; + + tx_rate = ((PADAPTER)adapter)->HalFunc.GetHwRateFromMRateHandler(dm->tx_rate); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + tx_rate = dm->tx_rate; +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + if (dm->number_linked_client != 0) + tx_rate = hw_rate_to_m_rate(dm->tx_rate); + else + tx_rate = rf->p_rate_index; +#endif + } else { /*force rate*/ + tx_rate = (u8)rate; + } + } + + return tx_rate; +} + +u8 phydm_get_tx_power_dbm(struct dm_struct *dm, u8 rf_path, + u8 rate, u8 bandwidth, u8 channel) +{ + u8 tx_power_dbm = 0; +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *adapter = dm->adapter; + tx_power_dbm = PHY_GetTxPowerFinalAbsoluteValue(adapter, rf_path, rate, bandwidth, channel); +#endif + return tx_power_dbm; +} + +u64 phydm_division64(u64 x, u64 y) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + do_div(x, y); + return x; +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + return x / y; +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + return rtw_division64(x, y); +#endif +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_interface.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_interface.h index 3d7f4a3a5221..0f10eeb4b037 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_interface.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_interface.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,116 +9,63 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ - -#ifndef __ODM_INTERFACE_H__ +#ifndef __ODM_INTERFACE_H__ #define __ODM_INTERFACE_H__ -#define INTERFACE_VERSION "1.1" /*2015.07.29 YuChen*/ +#define INTERFACE_VERSION "1.2" -/* - * =========== Constant/Structure/Enum/... Define - * */ +#define pdm_set_reg odm_set_bb_reg +/*@=========== 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, p_dm_odm)" - * 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 enum phydm_h2c_cmd { + PHYDM_H2C_RA_MASK = 0x40, 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_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_MU = 0x4a, + PHYDM_H2C_FW_GENERAL_INIT = 0x4c, + PHYDM_H2C_FW_CLM_MNTR = 0x4d, + PHYDM_H2C_MCC = 0x4f, + PHYDM_H2C_RESP_TX_PATH_CTRL = 0x50, + PHYDM_H2C_RESP_TX_ANT_CTRL = 0x51, 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_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_IQK_FINISH = 17, /*@0x11*/ + PHYDM_C2H_CLM_MONITOR = 0x2a, + PHYDM_C2H_DBG_CODE = 0xFE, + PHYDM_C2H_EXTEND = 0xFF, }; enum phydm_extend_c2h_evt { @@ -125,292 +73,275 @@ enum phydm_extend_c2h_evt { }; +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 + +#if 0 + +#define ODM_REG_DIG_11N 0xC50 +#define ODM_REG_DIG_11AC 0xDDD + +ODM_REG(DIG,_pdm_odm) +#endif + +#if defined(DM_ODM_CE_MAC80211) +#define ODM_BIT(name, dm) \ + ((dm->support_ic_type & ODM_IC_11N_SERIES) ? \ + ODM_BIT_##name##_11N : ODM_BIT_##name##_11AC) + +#define ODM_REG(name, dm) \ + ((dm->support_ic_type & ODM_IC_11N_SERIES) ? \ + ODM_REG_##name##_11N : ODM_REG_##name##_11AC) +#else +#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, 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 + +#endif +/*@ * =========== Extern Variable ??? It should be forbidden. - * */ + */ - -/* +/*@ * =========== EXtern Function Prototype - * */ + */ +u8 odm_read_1byte(struct dm_struct *dm, u32 reg_addr); -u8 -odm_read_1byte( - struct PHY_DM_STRUCT *p_dm_odm, - u32 reg_addr -); +u16 odm_read_2byte(struct dm_struct *dm, u32 reg_addr); -u16 -odm_read_2byte( - struct PHY_DM_STRUCT *p_dm_odm, - u32 reg_addr -); +u32 odm_read_4byte(struct dm_struct *dm, u32 reg_addr); -u32 -odm_read_4byte( - struct PHY_DM_STRUCT *p_dm_odm, - u32 reg_addr -); +void odm_write_1byte(struct dm_struct *dm, u32 reg_addr, u8 data); -void -odm_write_1byte( - struct PHY_DM_STRUCT *p_dm_odm, - u32 reg_addr, - u8 data -); +void odm_write_2byte(struct dm_struct *dm, u32 reg_addr, u16 data); -void -odm_write_2byte( - struct PHY_DM_STRUCT *p_dm_odm, - u32 reg_addr, - u16 data -); +void odm_write_4byte(struct dm_struct *dm, u32 reg_addr, u32 data); -void -odm_write_4byte( - struct PHY_DM_STRUCT *p_dm_odm, - u32 reg_addr, - u32 data -); +void odm_set_mac_reg(struct dm_struct *dm, u32 reg_addr, u32 bit_mask, + u32 data); -void -odm_set_mac_reg( - struct PHY_DM_STRUCT *p_dm_odm, - u32 reg_addr, - u32 bit_mask, - u32 data -); +u32 odm_get_mac_reg(struct dm_struct *dm, u32 reg_addr, u32 bit_mask); -u32 -odm_get_mac_reg( - struct PHY_DM_STRUCT *p_dm_odm, - u32 reg_addr, - u32 bit_mask -); +void odm_set_bb_reg(struct dm_struct *dm, u32 reg_addr, u32 bit_mask, u32 data); -void -odm_set_bb_reg( - struct PHY_DM_STRUCT *p_dm_odm, - u32 reg_addr, - u32 bit_mask, - u32 data -); +u32 odm_get_bb_reg(struct dm_struct *dm, u32 reg_addr, u32 bit_mask); -u32 -odm_get_bb_reg( - struct PHY_DM_STRUCT *p_dm_odm, - u32 reg_addr, - u32 bit_mask -); +void odm_set_rf_reg(struct dm_struct *dm, u8 e_rf_path, u32 reg_addr, + u32 bit_mask, u32 data); -void -odm_set_rf_reg( - struct PHY_DM_STRUCT *p_dm_odm, - enum odm_rf_radio_path_e e_rf_path, - u32 reg_addr, - u32 bit_mask, - u32 data -); +u32 odm_get_rf_reg(struct dm_struct *dm, u8 e_rf_path, u32 reg_addr, + u32 bit_mask); -u32 -odm_get_rf_reg( - struct PHY_DM_STRUCT *p_dm_odm, - enum odm_rf_radio_path_e e_rf_path, - u32 reg_addr, - u32 bit_mask -); - - -/* +/*@ * Memory Relative Function. - * */ -void -odm_allocate_memory( - struct PHY_DM_STRUCT *p_dm_odm, - void **p_ptr, - u32 length -); -void -odm_free_memory( - struct PHY_DM_STRUCT *p_dm_odm, - void *p_ptr, - u32 length -); + */ +void odm_allocate_memory(struct dm_struct *dm, void **ptr, u32 length); +void odm_free_memory(struct dm_struct *dm, void *ptr, u32 length); -void -odm_move_memory( - struct PHY_DM_STRUCT *p_dm_odm, - void *p_dest, - void *p_src, - u32 length -); +void odm_move_memory(struct dm_struct *dm, void *dest, void *src, u32 length); -s32 odm_compare_memory( - struct PHY_DM_STRUCT *p_dm_odm, - void *p_buf1, - void *p_buf2, - u32 length -); +s32 odm_compare_memory(struct dm_struct *dm, void *buf1, void *buf2, + u32 length); -void odm_memory_set -(struct PHY_DM_STRUCT *p_dm_odm, - void *pbuf, - s8 value, - u32 length); +void odm_memory_set(struct dm_struct *dm, void *pbuf, s8 value, u32 length); -/* +/*@ * ODM MISC-spin lock relative API. - * */ -void -odm_acquire_spin_lock( - struct PHY_DM_STRUCT *p_dm_odm, - enum rt_spinlock_type type -); + */ +void odm_acquire_spin_lock(struct dm_struct *dm, enum rt_spinlock_type type); -void -odm_release_spin_lock( - struct PHY_DM_STRUCT *p_dm_odm, - enum rt_spinlock_type type -); +void odm_release_spin_lock(struct dm_struct *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_odm, - PRT_WORK_ITEM p_rt_work_item, - RT_WORKITEM_CALL_BACK rt_work_item_callback, - void *p_context, - const char *sz_id -); + */ +void odm_initialize_work_item( + struct dm_struct *dm, + PRT_WORK_ITEM p_rt_work_item, + RT_WORKITEM_CALL_BACK rt_work_item_callback, + void *context, + const char *sz_id); -void -odm_start_work_item( - PRT_WORK_ITEM p_rt_work_item -); +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_stop_work_item( + PRT_WORK_ITEM p_rt_work_item); -void -odm_free_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 -); +void odm_schedule_work_item( + PRT_WORK_ITEM p_rt_work_item); -bool +boolean odm_is_work_item_scheduled( - PRT_WORK_ITEM p_rt_work_item -); + PRT_WORK_ITEM p_rt_work_item); #endif -/* +/*@ * ODM Timer relative API. - * */ -void -odm_stall_execution( - u32 us_delay -); + */ +void ODM_delay_ms(u32 ms); -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_delay_us(u32 us); +void odm_set_timer(struct dm_struct *dm, struct phydm_timer_list *timer, + u32 ms_delay); -void -ODM_sleep_ms(u32 ms); +void odm_initialize_timer(struct dm_struct *dm, struct phydm_timer_list *timer, + void *call_back_func, void *context, + const char *sz_id); -void -ODM_sleep_us(u32 us); +void odm_cancel_timer(struct dm_struct *dm, struct phydm_timer_list *timer); -void -odm_set_timer( - struct PHY_DM_STRUCT *p_dm_odm, - struct timer_list *p_timer, - u32 ms_delay -); +void odm_release_timer(struct dm_struct *dm, struct phydm_timer_list *timer); -void -odm_initialize_timer( - struct PHY_DM_STRUCT *p_dm_odm, - struct timer_list *p_timer, - void *call_back_func, - void *p_context, - const char *sz_id -); +/*ODM FW relative API.*/ -void -odm_cancel_timer( - struct PHY_DM_STRUCT *p_dm_odm, - struct timer_list *p_timer -); +enum hal_status +phydm_set_reg_by_fw(struct dm_struct *dm, enum phydm_halmac_param config_type, + u32 offset, u32 data, u32 mask, enum rf_path e_rf_path, + u32 delay_time); -void -odm_release_timer( - struct PHY_DM_STRUCT *p_dm_odm, - struct timer_list *p_timer -); +void odm_fill_h2c_cmd(struct dm_struct *dm, u8 element_id, u32 cmd_len, + u8 *cmd_buffer); -/* - * ODM FW relative API. - * */ -void -odm_fill_h2c_cmd( - struct PHY_DM_STRUCT *p_dm_odm, - u8 element_id, - u32 cmd_len, - u8 *p_cmd_buffer -); +u8 phydm_c2H_content_parsing(void *dm_void, u8 c2h_cmd_id, u8 c2h_cmd_len, + u8 *tmp_buf); -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 dm_struct *dm); +u64 odm_get_progressing_time(struct dm_struct *dm, u64 start_time); -u64 -odm_get_current_time( - struct PHY_DM_STRUCT *p_dm_odm -); -u64 -odm_get_progressing_time( - struct PHY_DM_STRUCT *p_dm_odm, - u64 start_time -); +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) && \ + (!defined(DM_ODM_CE_MAC80211) && !defined(DM_ODM_CE_MAC80211_V2)) -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) +void phydm_set_hw_reg_handler_interface(struct dm_struct *dm, u8 reg_Name, + u8 *val); -void -phydm_set_hw_reg_handler_interface ( - struct PHY_DM_STRUCT *p_dm_odm, - u8 reg_Name, - u8 *val - ); - -void -phydm_get_hal_def_var_handler_interface ( - struct PHY_DM_STRUCT *p_dm_odm, - enum _HAL_DEF_VARIABLE e_variable, - void *p_value - ); +void phydm_get_hal_def_var_handler_interface(struct dm_struct *dm, + enum _HAL_DEF_VARIABLE e_variable, + void *value); #endif +void odm_set_tx_power_index_by_rate_section(struct dm_struct *dm, + enum rf_path path, u8 channel, + u8 rate_section); -#endif /* __ODM_INTERFACE_H__ */ +u8 odm_get_tx_power_index(struct dm_struct *dm, enum rf_path path, u8 tx_rate, + u8 band_width, u8 channel); +u8 odm_efuse_one_byte_read(struct dm_struct *dm, u16 addr, u8 *data, + boolean b_pseu_do_test); + +void odm_efuse_logical_map_read(struct dm_struct *dm, u8 type, u16 offset, + u32 *data); + +enum hal_status +odm_iq_calibrate_by_fw(struct dm_struct *dm, u8 clear, u8 segment); + +void odm_cmn_info_ptr_array_hook(struct dm_struct *dm, + enum odm_cmninfo cmn_info, u16 index, + void *value); + +void phydm_cmn_sta_info_hook(struct dm_struct *dm, u8 index, + struct cmn_sta_info *pcmn_sta_info); + +void phydm_macid2sta_idx_table(struct dm_struct *dm, u8 entry_idx, + struct cmn_sta_info *pcmn_sta_info); + +void phydm_add_interrupt_mask_handler(struct dm_struct *dm, u8 interrupt_type); + +void phydm_enable_rx_related_interrupt_handler(struct dm_struct *dm); + +#if 0 +boolean +phydm_get_txbf_en( + struct dm_struct *dm, + u16 mac_id, + u8 i +); +#endif + +void phydm_iqk_wait(struct dm_struct *dm, u32 timeout); +u8 phydm_get_hwrate_to_mrate(struct dm_struct *dm, u8 rate); + +void phydm_set_crystalcap(struct dm_struct *dm, u8 crystal_cap); +void phydm_run_in_thread_cmd(struct dm_struct *dm, void (*func)(void *), + void *context); +u8 phydm_get_tx_rate(struct dm_struct *dm); +u8 phydm_get_tx_power_dbm(struct dm_struct *dm, u8 rf_path, + u8 rate, u8 bandwidth, u8 channel); +u64 phydm_division64(u64 x, u64 y); + +#endif /* @__ODM_INTERFACE_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_iqk.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_iqk.h deleted file mode 100644 index 006b554c8a16..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_iqk.h +++ /dev/null @@ -1,65 +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 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; - - u32 iqk_channel[2]; - boolean IQK_fail_report[2][4][2]; /*channel/path/TRX(TX:0, RX:1) */ - u32 IQK_CFIR_real[2][4][2][8]; /*channel / path / TRX(TX:0, RX:1) / CFIR_real*/ - u32 IQK_CFIR_imag[2][4][2][8]; /*channel / path / TRX(TX:0, RX:1) / CFIR_imag*/ - 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 tmp_GNTWL; - boolean is_BTG; - boolean isbnd; -}; - -#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_kfree.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_kfree.c deleted file mode 100644 index f063b7864e4b..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_kfree.c +++ /dev/null @@ -1,190 +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_set_kfree_to_rf_8814a( - void *p_dm_void, - u8 e_rf_path, - u8 data -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm_odm->rf_calibrate_info); - bool is_odd; - - if ((data % 2) != 0) { /*odd->positive*/ - data = data - 1; - odm_set_rf_reg(p_dm_odm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(19), 1); - is_odd = true; - } else { /*even->negative*/ - odm_set_rf_reg(p_dm_odm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(19), 0); - is_odd = false; - } - ODM_RT_TRACE(p_dm_odm, 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_odm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(14), 0); - odm_set_rf_reg(p_dm_odm, 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_odm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(14), 1); - odm_set_rf_reg(p_dm_odm, 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_odm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(14), 0); - odm_set_rf_reg(p_dm_odm, 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_odm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(14), 1); - odm_set_rf_reg(p_dm_odm, 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_odm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(14), 0); - odm_set_rf_reg(p_dm_odm, 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_odm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(14), 1); - odm_set_rf_reg(p_dm_odm, 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_odm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(14), 0); - odm_set_rf_reg(p_dm_odm, 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_odm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(14), 1); - odm_set_rf_reg(p_dm_odm, 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_odm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(14), 0); - odm_set_rf_reg(p_dm_odm, 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_odm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(14), 1); - odm_set_rf_reg(p_dm_odm, 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_odm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(14), 0); - odm_set_rf_reg(p_dm_odm, 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, 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, ODM_COMP_MP, ODM_DBG_LOUD, ("phy_ConfigKFree8814A(): kfree_offset = %d\n", p_rf_calibrate_info->kfree_offset[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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - - if (p_dm_odm->support_ic_type & ODM_RTL8814A) - phydm_set_kfree_to_rf_8814a(p_dm_odm, e_rf_path, data); -} - -void -phydm_config_kfree( - void *p_dm_void, - u8 channel_to_sw, - u8 *kfree_table -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm_odm->rf_calibrate_info); - u8 rfpath = 0, max_rf_path = 0; - u8 channel_idx = 0; - - if (p_dm_odm->support_ic_type & ODM_RTL8814A) - max_rf_path = 4; /*0~3*/ - else if (p_dm_odm->support_ic_type & (ODM_RTL8812 | ODM_RTL8192E | ODM_RTL8822B)) - max_rf_path = 2; /*0~1*/ - else - max_rf_path = 1; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_MP, ODM_DBG_LOUD, ("===>phy_ConfigKFree8814A()\n")); - - if (p_rf_calibrate_info->reg_rf_kfree_enable == 2) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_MP, ODM_DBG_LOUD, ("phy_ConfigKFree8814A(): 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, ODM_COMP_MP, ODM_DBG_LOUD, ("phy_ConfigKFree8814A(): reg_rf_kfree_enable == true\n")); - /*Make sure the targetval is defined*/ - if (((p_rf_calibrate_info->reg_rf_kfree_enable == 1) && (kfree_table[0] != 0xFF)) || (p_rf_calibrate_info->rf_kfree_enable == true)) { - /*if kfree_table[0] == 0xff, means no Kfree*/ - if (*p_dm_odm->p_band_type == ODM_BAND_2_4G) { - if (channel_to_sw <= 14 && channel_to_sw >= 1) - channel_idx = PHYDM_2G; - } else if (*p_dm_odm->p_band_type == ODM_BAND_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 >= 124 && channel_to_sw <= 144) - channel_idx = PHYDM_5GMB2; - if (channel_to_sw >= 149 && channel_to_sw <= 177) - channel_idx = PHYDM_5GHB; - } - - for (rfpath = ODM_RF_PATH_A; rfpath < max_rf_path; rfpath++) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_MP, ODM_DBG_LOUD, ("phydm_kfree(): PATH_%d: %#x\n", rfpath, kfree_table[channel_idx * max_rf_path + rfpath])); - phydm_set_kfree_to_rf(p_dm_odm, rfpath, kfree_table[channel_idx * max_rf_path + rfpath]); - } - } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_MP, ODM_DBG_LOUD, ("phy_ConfigKFree8814A(): targetval not defined, Don't execute KFree Process.\n")); - return; - } - } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_MP, ODM_DBG_LOUD, ("<===phy_ConfigKFree8814A()\n")); -} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_lna_sat.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_lna_sat.c new file mode 100644 index 000000000000..464736e5bf9a --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_lna_sat.c @@ -0,0 +1,1340 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +/************************************************************* + * include files + * *************************************************************/ +#include "mp_precomp.h" +#include "phydm_precomp.h" + +#ifdef PHYDM_LNA_SAT_CHK_SUPPORT + +#ifdef PHYDM_LNA_SAT_CHK_TYPE1 +void phydm_lna_sat_chk_init( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_lna_sat_t *lna_info = &dm->dm_lna_sat_info; + + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "%s ==>\n", __func__); + + lna_info->check_time = 0; + lna_info->sat_cnt_acc_patha = 0; + lna_info->sat_cnt_acc_pathb = 0; + #ifdef PHYDM_IC_ABOVE_3SS + lna_info->sat_cnt_acc_pathc = 0; + #endif + #ifdef PHYDM_IC_ABOVE_4SS + lna_info->sat_cnt_acc_pathd = 0; + #endif + lna_info->cur_sat_status = 0; + lna_info->pre_sat_status = 0; + lna_info->cur_timer_check_cnt = 0; + lna_info->pre_timer_check_cnt = 0; + + #if (RTL8198F_SUPPORT || RTL8814B_SUPPORT) + if (dm->support_ic_type & + (ODM_RTL8198F | ODM_RTL8814B)) + phydm_lna_sat_chk_bb_init(dm); + #endif +} + +#if (RTL8198F_SUPPORT || RTL8814B_SUPPORT) +void phydm_lna_sat_chk_bb_init(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_lna_sat_t *lna_info = &dm->dm_lna_sat_info; + + boolean disable_bb_switch_tab = false; + + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "%s ==>\n", __func__); + + /*@set table switch mux r_6table_sel_anten*/ + odm_set_bb_reg(dm, 0x18ac, BIT(8), 0); + + /*@tab decision when idle*/ + odm_set_bb_reg(dm, 0x18ac, BIT(16), disable_bb_switch_tab); + odm_set_bb_reg(dm, 0x41ac, BIT(16), disable_bb_switch_tab); + odm_set_bb_reg(dm, 0x52ac, BIT(16), disable_bb_switch_tab); + odm_set_bb_reg(dm, 0x53ac, BIT(16), disable_bb_switch_tab); + /*@tab decision when ofdmcca*/ + odm_set_bb_reg(dm, 0x18ac, BIT(17), disable_bb_switch_tab); + odm_set_bb_reg(dm, 0x41ac, BIT(17), disable_bb_switch_tab); + odm_set_bb_reg(dm, 0x52ac, BIT(17), disable_bb_switch_tab); + odm_set_bb_reg(dm, 0x53ac, BIT(17), disable_bb_switch_tab); +} + +void phydm_set_ofdm_agc_tab_path( + void *dm_void, + u8 tab_sel, + enum rf_path path) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "%s ==>\n", __func__); + if (dm->support_ic_type & (ODM_RTL8198F | ODM_RTL8814B)) { + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "set AGC Tab%d\n", tab_sel); + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "r_6table_sel_anten = 0x%x\n", + odm_get_bb_reg(dm, 0x18ac, BIT(8))); + } + + if (dm->support_ic_type & ODM_RTL8198F) { + /*@table sel:0/2, mapping 2 to 1 */ + if (tab_sel == OFDM_AGC_TAB_0) { + odm_set_bb_reg(dm, 0x18ac, BIT(4), 0); + odm_set_bb_reg(dm, 0x41ac, BIT(4), 0); + odm_set_bb_reg(dm, 0x52ac, BIT(4), 0); + odm_set_bb_reg(dm, 0x53ac, BIT(4), 0); + } else if (tab_sel == OFDM_AGC_TAB_2) { + odm_set_bb_reg(dm, 0x18ac, BIT(4), 1); + odm_set_bb_reg(dm, 0x41ac, BIT(4), 1); + odm_set_bb_reg(dm, 0x52ac, BIT(4), 1); + odm_set_bb_reg(dm, 0x53ac, BIT(4), 1); + } else { + odm_set_bb_reg(dm, 0x18ac, BIT(4), 0); + odm_set_bb_reg(dm, 0x41ac, BIT(4), 0); + odm_set_bb_reg(dm, 0x52ac, BIT(4), 0); + odm_set_bb_reg(dm, 0x53ac, BIT(4), 0); + } + } else if (dm->support_ic_type & ODM_RTL8814B) { + if (tab_sel == OFDM_AGC_TAB_0) { + odm_set_bb_reg(dm, 0x18ac, 0xf0, 0); + odm_set_bb_reg(dm, 0x41ac, 0xf0, 0); + odm_set_bb_reg(dm, 0x52ac, 0xf0, 0); + odm_set_bb_reg(dm, 0x53ac, 0xf0, 0); + } else if (tab_sel == OFDM_AGC_TAB_2) { + odm_set_bb_reg(dm, 0x18ac, 0xf0, 2); + odm_set_bb_reg(dm, 0x41ac, 0xf0, 2); + odm_set_bb_reg(dm, 0x52ac, 0xf0, 2); + odm_set_bb_reg(dm, 0x53ac, 0xf0, 2); + } else { + odm_set_bb_reg(dm, 0x18ac, 0xf0, 0); + odm_set_bb_reg(dm, 0x41ac, 0xf0, 0); + odm_set_bb_reg(dm, 0x52ac, 0xf0, 0); + odm_set_bb_reg(dm, 0x53ac, 0xf0, 0); + } + } +} + +u8 phydm_get_ofdm_agc_tab_path( + void *dm_void, + enum rf_path path) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 tab_sel = 0; + + if (dm->support_ic_type & ODM_RTL8198F) { + tab_sel = (u8)odm_get_bb_reg(dm, R_0x18ac, BIT(4)); + if (tab_sel == 0) + tab_sel = OFDM_AGC_TAB_0; + else if (tab_sel == 1) + tab_sel = OFDM_AGC_TAB_2; + } else if (dm->support_ic_type & ODM_RTL8814B) { + tab_sel = (u8)odm_get_bb_reg(dm, R_0x18ac, 0xf0); + if (tab_sel == 0) + tab_sel = OFDM_AGC_TAB_0; + else if (tab_sel == 2) + tab_sel = OFDM_AGC_TAB_2; + } + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "get path %d AGC Tab %d\n", + path, tab_sel); + return tab_sel; +} +#endif /*@#if (RTL8198F_SUPPORT || RTL8814B_SUPPORT)*/ + +void phydm_set_ofdm_agc_tab( + void *dm_void, + u8 tab_sel) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + /*@table sel:0/2, 1 is used for CCK */ + if (tab_sel == OFDM_AGC_TAB_0) + odm_set_bb_reg(dm, R_0xc70, 0x1e00, OFDM_AGC_TAB_0); + else if (tab_sel == OFDM_AGC_TAB_2) + odm_set_bb_reg(dm, R_0xc70, 0x1e00, OFDM_AGC_TAB_2); + else + odm_set_bb_reg(dm, R_0xc70, 0x1e00, OFDM_AGC_TAB_0); +} + +u8 phydm_get_ofdm_agc_tab( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + return (u8)odm_get_bb_reg(dm, R_0xc70, 0x1e00); +} + +void phydm_lna_sat_chk( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_dig_struct *dig_t = &dm->dm_dig_table; + struct phydm_lna_sat_t *lna_info = &dm->dm_lna_sat_info; + u8 igi_rssi_min; + u8 rssi_min = dm->rssi_min; + u32 sat_status_a, sat_status_b; + #ifdef PHYDM_IC_ABOVE_3SS + u32 sat_status_c; + #endif + #ifdef PHYDM_IC_ABOVE_4SS + u32 sat_status_d; + #endif + u8 igi_restore = dig_t->cur_ig_value; + u8 i, chk_cnt = lna_info->chk_cnt; + u32 lna_sat_cnt_thd = 0; + u8 agc_tab; + u32 max_check_time = 0; + /*@use rssi_max if rssi_min is not stable;*/ + /*@rssi_min = dm->rssi_max;*/ + + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "\n%s ==>\n", __func__); + + if (!(dm->support_ability & ODM_BB_LNA_SAT_CHK)) { + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "Func disable\n"); + return; + } + + if (lna_info->is_disable_lna_sat_chk) { + phydm_lna_sat_chk_init(dm); + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "disable_lna_sat_chk\n"); + return; + } + + /*@move igi to target pin of rssi_min */ + if (rssi_min == 0 || rssi_min == 0xff) { + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, + "rssi_min=%d, set AGC Tab0\n", rssi_min); + /*@adapt agc table 0*/ + phydm_set_ofdm_agc_tab(dm, OFDM_AGC_TAB_0); + phydm_lna_sat_chk_init(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 ((lna_info->chk_period > 0) && (lna_info->chk_period <= ONE_SEC_MS)) + max_check_time = chk_cnt * (ONE_SEC_MS / (lna_info->chk_period)) * 5; + else + max_check_time = chk_cnt * 5; + + lna_sat_cnt_thd = (max_check_time * lna_info->chk_duty_cycle) / 100; + + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, + "check_time=%d, rssi_min=%d, igi_rssi_min=0x%x\nchk_cnt=%d, chk_period=%d, max_check_time=%d, lna_sat_cnt_thd=%d\n", + lna_info->check_time, + rssi_min, + igi_rssi_min, + chk_cnt, + lna_info->chk_period, + max_check_time, + lna_sat_cnt_thd); + + odm_write_dig(dm, igi_rssi_min); + + /*@adapt agc table 0 check saturation status*/ + #if (RTL8198F_SUPPORT || RTL8814B_SUPPORT) + if (dm->support_ic_type & (ODM_RTL8198F | ODM_RTL8814B)) + phydm_set_ofdm_agc_tab_path(dm, OFDM_AGC_TAB_0, RF_PATH_A); + else + #endif + phydm_set_ofdm_agc_tab(dm, OFDM_AGC_TAB_0); + /*@open rf power detection ckt & set detection range */ +#if (RTL8198F_SUPPORT) + if (dm->support_ic_type & ODM_RTL8198F) { + /*@set rf detection range (threshold)*/ + config_phydm_write_rf_reg_8198f(dm, RF_PATH_A, 0x85, + 0x3f, 0x3f); + config_phydm_write_rf_reg_8198f(dm, RF_PATH_B, 0x85, + 0x3f, 0x3f); + config_phydm_write_rf_reg_8198f(dm, RF_PATH_C, 0x85, + 0x3f, 0x3f); + config_phydm_write_rf_reg_8198f(dm, RF_PATH_D, 0x85, + 0x3f, 0x3f); + /*@open rf power detection ckt*/ + config_phydm_write_rf_reg_8198f(dm, RF_PATH_A, 0x86, 0x10, 1); + config_phydm_write_rf_reg_8198f(dm, RF_PATH_B, 0x86, 0x10, 1); + config_phydm_write_rf_reg_8198f(dm, RF_PATH_C, 0x86, 0x10, 1); + config_phydm_write_rf_reg_8198f(dm, RF_PATH_D, 0x86, 0x10, 1); + } +#elif (RTL8814B_SUPPORT) + if (dm->support_ic_type & ODM_RTL8814B) { + /*@set rf detection range (threshold)*/ + config_phydm_write_rf_reg_8814b(dm, RF_PATH_A, 0x8B, 0x3, 0x3); + config_phydm_write_rf_reg_8814b(dm, RF_PATH_B, 0x8B, 0x3, 0x3); + config_phydm_write_rf_reg_8814b(dm, RF_PATH_C, 0x8B, 0x3, 0x3); + config_phydm_write_rf_reg_8814b(dm, RF_PATH_D, 0x8B, 0x3, 0x3); + /*@open rf power detection ckt*/ + config_phydm_write_rf_reg_8814b(dm, RF_PATH_A, 0x8B, 0x4, 1); + config_phydm_write_rf_reg_8814b(dm, RF_PATH_B, 0x8B, 0x4, 1); + config_phydm_write_rf_reg_8814b(dm, RF_PATH_C, 0x8B, 0x4, 1); + config_phydm_write_rf_reg_8814b(dm, RF_PATH_D, 0x8B, 0x4, 1); + } +#else + odm_set_rf_reg(dm, RF_PATH_A, RF_0x86, 0x1f, 0x10); + odm_set_rf_reg(dm, RF_PATH_B, RF_0x86, 0x1f, 0x10); + #ifdef PHYDM_IC_ABOVE_3SS + odm_set_rf_reg(dm, RF_PATH_C, RF_0x86, 0x1f, 0x10); + #endif + #ifdef PHYDM_IC_ABOVE_4SS + odm_set_rf_reg(dm, RF_PATH_D, RF_0x86, 0x1f, 0x10); + #endif +#endif + + /*@check saturation status*/ + for (i = 0; i < chk_cnt; i++) { +#if (RTL8198F_SUPPORT) + if (dm->support_ic_type & ODM_RTL8198F) { + sat_status_a = config_phydm_read_rf_reg_8198f(dm, RF_PATH_A, + RF_0xae, + 0xe0000); + sat_status_b = config_phydm_read_rf_reg_8198f(dm, RF_PATH_B, + RF_0xae, + 0xe0000); + sat_status_c = config_phydm_read_rf_reg_8198f(dm, RF_PATH_C, + RF_0xae, + 0xe0000); + sat_status_d = config_phydm_read_rf_reg_8198f(dm, RF_PATH_D, + RF_0xae, + 0xe0000); + } +#elif (RTL8814B_SUPPORT) + if (dm->support_ic_type & ODM_RTL8814B) { + /*@read peak detector info from 8814B rf reg*/ + sat_status_a = config_phydm_read_rf_reg_8814b(dm, RF_PATH_A, + RF_0xae, + 0xc0000); + sat_status_b = config_phydm_read_rf_reg_8814b(dm, RF_PATH_B, + RF_0xae, + 0xc0000); + sat_status_c = config_phydm_read_rf_reg_8814b(dm, RF_PATH_C, + RF_0xae, + 0xc0000); + sat_status_d = config_phydm_read_rf_reg_8814b(dm, RF_PATH_D, + RF_0xae, + 0xc0000); + } +#else + sat_status_a = odm_get_rf_reg(dm, RF_PATH_A, RF_0xae, 0xc0000); + sat_status_b = odm_get_rf_reg(dm, RF_PATH_B, RF_0xae, 0xc0000); + #ifdef PHYDM_IC_ABOVE_3SS + sat_status_c = odm_get_rf_reg(dm, RF_PATH_C, RF_0xae, 0xc0000); + #endif + #ifdef PHYDM_IC_ABOVE_4SS + sat_status_d = odm_get_rf_reg(dm, RF_PATH_D, RF_0xae, 0xc0000); + #endif +#endif + + if (sat_status_a != 0) + lna_info->sat_cnt_acc_patha++; + if (sat_status_b != 0) + lna_info->sat_cnt_acc_pathb++; + #ifdef PHYDM_IC_ABOVE_3SS + if (sat_status_c != 0) + lna_info->sat_cnt_acc_pathc++; + #endif + #ifdef PHYDM_IC_ABOVE_4SS + if (sat_status_d != 0) + lna_info->sat_cnt_acc_pathd++; + #endif + + if (lna_info->sat_cnt_acc_patha >= lna_sat_cnt_thd || + lna_info->sat_cnt_acc_pathb >= lna_sat_cnt_thd || + #ifdef PHYDM_IC_ABOVE_3SS + lna_info->sat_cnt_acc_pathc >= lna_sat_cnt_thd || + #endif + #ifdef PHYDM_IC_ABOVE_4SS + lna_info->sat_cnt_acc_pathd >= lna_sat_cnt_thd || + #endif + 0) { + lna_info->cur_sat_status = 1; + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, + "cur_sat_status=%d, check_time=%d\n", + lna_info->cur_sat_status, + lna_info->check_time); + break; + } + lna_info->cur_sat_status = 0; + } + + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, + "cur_sat_status=%d, pre_sat_status=%d, sat_cnt_acc_patha=%d, sat_cnt_acc_pathb=%d\n", + lna_info->cur_sat_status, + lna_info->pre_sat_status, + lna_info->sat_cnt_acc_patha, + lna_info->sat_cnt_acc_pathb); + + #ifdef PHYDM_IC_ABOVE_4SS + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, + "cur_sat_status=%d, pre_sat_status=%d, sat_cnt_acc_pathc=%d, sat_cnt_acc_pathd=%d\n", + lna_info->cur_sat_status, + lna_info->pre_sat_status, + lna_info->sat_cnt_acc_pathc, + lna_info->sat_cnt_acc_pathd); + #endif + /*@agc table decision*/ + if (lna_info->cur_sat_status) { + if (!lna_info->dis_agc_table_swh) + #if (RTL8198F_SUPPORT || RTL8814B_SUPPORT) + if (dm->support_ic_type & (ODM_RTL8198F | ODM_RTL8814B)) + phydm_set_ofdm_agc_tab_path(dm, + OFDM_AGC_TAB_2, + RF_PATH_A); + else + #endif + phydm_set_ofdm_agc_tab(dm, OFDM_AGC_TAB_2); + else + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, + "disable set to AGC Tab%d\n", OFDM_AGC_TAB_2); + lna_info->check_time = 0; + lna_info->sat_cnt_acc_patha = 0; + lna_info->sat_cnt_acc_pathb = 0; + #ifdef PHYDM_IC_ABOVE_3SS + lna_info->sat_cnt_acc_pathc = 0; + #endif + #ifdef PHYDM_IC_ABOVE_4SS + lna_info->sat_cnt_acc_pathd = 0; + #endif + lna_info->pre_sat_status = lna_info->cur_sat_status; + + } else if (lna_info->check_time <= (max_check_time - 1)) { + if (lna_info->pre_sat_status && !lna_info->dis_agc_table_swh) + #if (RTL8198F_SUPPORT || RTL8814B_SUPPORT) + if (dm->support_ic_type & (ODM_RTL8198F | ODM_RTL8814B)) + phydm_set_ofdm_agc_tab_path(dm, + OFDM_AGC_TAB_2, + RF_PATH_A); + else + #endif + phydm_set_ofdm_agc_tab(dm, OFDM_AGC_TAB_2); + + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "ckeck time not reached\n"); + if (lna_info->dis_agc_table_swh) + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, + "disable set to AGC Tab%d\n", OFDM_AGC_TAB_2); + lna_info->check_time++; + + } else if (lna_info->check_time >= max_check_time) { + if (!lna_info->dis_agc_table_swh) + #if (RTL8198F_SUPPORT || RTL8814B_SUPPORT) + if (dm->support_ic_type & (ODM_RTL8198F | ODM_RTL8814B)) + phydm_set_ofdm_agc_tab_path(dm, + OFDM_AGC_TAB_0, + RF_PATH_A); + else + #endif + phydm_set_ofdm_agc_tab(dm, OFDM_AGC_TAB_0); + + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "ckeck time reached\n"); + if (lna_info->dis_agc_table_swh) + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, + "disable set to AGC Tab%d\n", OFDM_AGC_TAB_0); + lna_info->check_time = 0; + lna_info->sat_cnt_acc_patha = 0; + lna_info->sat_cnt_acc_pathb = 0; + #ifdef PHYDM_IC_ABOVE_3SS + lna_info->sat_cnt_acc_pathc = 0; + #endif + #ifdef PHYDM_IC_ABOVE_4SS + lna_info->sat_cnt_acc_pathd = 0; + #endif + lna_info->pre_sat_status = lna_info->cur_sat_status; + } + + #if (RTL8198F_SUPPORT || RTL8814B_SUPPORT) + if (dm->support_ic_type & (ODM_RTL8198F | ODM_RTL8814B)) + agc_tab = phydm_get_ofdm_agc_tab_path(dm, RF_PATH_A); + else + #endif + agc_tab = phydm_get_ofdm_agc_tab(dm); + + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "use AGC tab %d\n", agc_tab); + + /*@restore previous igi*/ + odm_write_dig(dm, igi_restore); + lna_info->cur_timer_check_cnt++; + odm_set_timer(dm, &lna_info->phydm_lna_sat_chk_timer, + lna_info->chk_period); +} + +void phydm_lna_sat_chk_callback( + void *dm_void + + ) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "\n%s ==>\n", __func__); + phydm_lna_sat_chk(dm); +} + +void phydm_lna_sat_chk_timers( + void *dm_void, + u8 state) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_lna_sat_t *lna_info = &dm->dm_lna_sat_info; + + if (state == INIT_LNA_SAT_CHK_TIMMER) { + odm_initialize_timer(dm, + &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(dm, &lna_info->phydm_lna_sat_chk_timer); + } else if (state == RELEASE_LNA_SAT_CHK_TIMMER) { + odm_release_timer(dm, &lna_info->phydm_lna_sat_chk_timer); + } +} + +void phydm_lna_sat_chk_watchdog_type1( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_lna_sat_t *lna_info = &dm->dm_lna_sat_info; + + u8 rssi_min = dm->rssi_min; + + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "\n%s ==>\n", __func__); + + if (!(dm->support_ability & ODM_BB_LNA_SAT_CHK)) { + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, + "func disable\n"); + return; + } + + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, + "pre_timer_check_cnt=%d, cur_timer_check_cnt=%d\n", + lna_info->pre_timer_check_cnt, + lna_info->cur_timer_check_cnt); + + if (lna_info->is_disable_lna_sat_chk) { + phydm_lna_sat_chk_init(dm); + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, + "is_disable_lna_sat_chk=%d, return\n", + lna_info->is_disable_lna_sat_chk); + return; + } + + if (!(dm->support_ic_type & + (ODM_RTL8197F | ODM_RTL8198F | ODM_RTL8814B))) { + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, + "support_ic_type not 97F/98F/14B, return\n"); + return; + } + + if (rssi_min == 0 || rssi_min == 0xff) { + /*@adapt agc table 0 */ + phydm_set_ofdm_agc_tab(dm, OFDM_AGC_TAB_0); + phydm_lna_sat_chk_init(dm); + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, + "rssi_min=%d, return\n", rssi_min); + return; + } + + if (lna_info->cur_timer_check_cnt == lna_info->pre_timer_check_cnt) { + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "fail, restart timer\n"); + odm_set_timer(dm, &lna_info->phydm_lna_sat_chk_timer, + lna_info->chk_period); + } else { + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "Timer check pass\n"); + } + lna_info->pre_timer_check_cnt = lna_info->cur_timer_check_cnt; +} + +#endif /*@#ifdef PHYDM_LNA_SAT_CHK_TYPE1*/ + +#ifdef PHYDM_LNA_SAT_CHK_TYPE2 + +void phydm_bubble_sort( + void *dm_void, + u8 *array, + u16 array_length) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u16 i, j; + u8 temp; + + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "%s ==>\n", __func__); + for (i = 0; i < (array_length - 1); i++) { + for (j = (i + 1); j < (array_length); j++) { + if (array[i] > array[j]) { + temp = array[i]; + array[i] = array[j]; + array[j] = temp; + } + } + } +} + +void phydm_lna_sat_chk_type2_init( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_lna_sat_t *pinfo = &dm->dm_lna_sat_info; + u8 real_shift = pinfo->total_bit_shift; + + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "%s ==>\n", __func__); + + pinfo->total_cnt_snr = 1 << real_shift; + pinfo->is_sm_done = TRUE; + pinfo->is_snr_done = FALSE; + pinfo->cur_snr_mean = 0; + pinfo->cur_snr_var = 0; + pinfo->cur_lower_snr_mean = 0; + pinfo->pre_snr_mean = 0; + pinfo->pre_snr_var = 0; + pinfo->pre_lower_snr_mean = 0; + pinfo->nxt_state = ORI_TABLE_MONITOR; + pinfo->pre_state = ORI_TABLE_MONITOR; +} + +void phydm_snr_collect( + void *dm_void, + u8 rx_snr) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_lna_sat_t *pinfo = &dm->dm_lna_sat_info; + + if (pinfo->is_sm_done) { +#if 0 + /*PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "%s ==>\n", __func__);*/ +#endif + + /* @adapt only path-A for calculation */ + pinfo->snr_statistic[pinfo->cnt_snr_statistic] = rx_snr; + + if (pinfo->cnt_snr_statistic == (pinfo->total_cnt_snr - 1)) { + pinfo->is_snr_done = TRUE; + pinfo->cnt_snr_statistic = 0; + } else { + pinfo->cnt_snr_statistic++; + } + } else { + return; + } +} + +void phydm_parsing_snr(void *dm_void, void *pktinfo_void, s8 *rx_snr) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_lna_sat_t *lna_t = &dm->dm_lna_sat_info; + struct phydm_perpkt_info_struct *pktinfo = NULL; + u8 target_macid = dm->rssi_min_macid; + + if (!(dm->support_ability & ODM_BB_LNA_SAT_CHK)) + return; + + pktinfo = (struct phydm_perpkt_info_struct *)pktinfo_void; + + if (!pktinfo->is_packet_match_bssid) + return; + + if (lna_t->force_traget_macid != 0) + target_macid = lna_t->force_traget_macid; + + if (target_macid != pktinfo->station_id) + return; + + phydm_snr_collect(dm, rx_snr[0]); /*path-A B C D???*/ +} + +void phydm_snr_data_processing( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_lna_sat_t *pinfo = &dm->dm_lna_sat_info; + u8 real_shift = pinfo->total_bit_shift; + u16 total_snr_cnt = pinfo->total_cnt_snr; + u16 total_loop_cnt = (total_snr_cnt - 1), i; + u32 temp; + u32 sum_snr_statistic = 0; + + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "%s ==>\n", __func__); + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, + "total_loop_cnt=%d\n", total_loop_cnt); + + for (i = 0; (i <= total_loop_cnt); i++) { + if (pinfo->is_snr_detail_en) { + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, + "snr[%d]=%d\n", i, pinfo->snr_statistic[i]); + } + + sum_snr_statistic += (u32)(pinfo->snr_statistic[i]); + + pinfo->snr_statistic_sqr[i] = (u16)(pinfo->snr_statistic[i] * pinfo->snr_statistic[i]); + } + + phydm_bubble_sort(dm, pinfo->snr_statistic, pinfo->total_cnt_snr); + + /*update SNR's cur mean*/ + pinfo->cur_snr_mean = (sum_snr_statistic >> real_shift); + + for (i = 0; (i <= total_loop_cnt); i++) { + if (pinfo->snr_statistic[i] >= pinfo->cur_snr_mean) + temp = pinfo->snr_statistic[i] - pinfo->cur_snr_mean; + else + temp = pinfo->cur_snr_mean - pinfo->snr_statistic[i]; + + pinfo->cur_snr_var += (temp * temp); + } + + /*update SNR's VAR*/ + pinfo->cur_snr_var = (pinfo->cur_snr_var >> real_shift); + + /*@acquire lower SNR's statistics*/ + temp = 0; + pinfo->cnt_lower_snr_statistic = (total_snr_cnt >> pinfo->lwr_snr_ratio_bit_shift); + pinfo->cnt_lower_snr_statistic = MAX_2(pinfo->cnt_lower_snr_statistic, SNR_RPT_MAX); + + for (i = 0; i < pinfo->cnt_lower_snr_statistic; i++) + temp += pinfo->snr_statistic[i]; + + pinfo->cur_lower_snr_mean = temp >> (real_shift - pinfo->lwr_snr_ratio_bit_shift); +} + +boolean phydm_is_snr_improve( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_lna_sat_t *pinfo = &dm->dm_lna_sat_info; + boolean is_snr_improve; + u8 cur_state = pinfo->nxt_state; + u32 cur_mean = pinfo->cur_snr_mean; + u32 pre_mean = pinfo->pre_snr_mean; + u32 cur_lower_mean = pinfo->cur_lower_snr_mean; + u32 pre_lower_mean = pinfo->pre_lower_snr_mean; + u32 cur_var = pinfo->cur_snr_var; + + /*special case, zero VAR, interference is gone*/ + /*@make sure pre_var is larger enough*/ + if (cur_state == SAT_TABLE_MONITOR || + cur_state == ORI_TABLE_TRAINING) { + if (cur_mean >= pre_mean) { + if (cur_var == 0) + return true; + } + } +#if 0 + /*special case, mean degrade less than VAR improvement*/ + /*@make sure pre_var is larger enough*/ + if (cur_state == ORI_TABLE_MONITOR && + cur_mean < pre_mean && + cur_var < pre_var) { + diff_mean = pre_mean - cur_mean; + diff_var = pre_var - cur_var; + return (diff_var > (2 * diff_mean * diff_mean)) ? true : false; + } + +#endif + if (cur_lower_mean >= (pre_lower_mean + pinfo->delta_snr_mean)) + is_snr_improve = true; + else + is_snr_improve = false; +#if 0 +/* @condition refine, mean is bigger enough or VAR is smaller enough*/ +/* @1. from mean's view, mean improve delta_snr_mean(2), VAR not degrade lot*/ + if (cur_mean > (pre_mean + pinfo->delta_snr_mean)) { + is_mean_improve = TRUE; + is_var_improve = (cur_var <= pre_var + dm->delta_snr_var) + ? TRUE : FALSE; + + } else if (cur_var + dm->delta_snr_var <= pre_var) { + is_var_improve = TRUE; + is_mean_improve = ((cur_mean + 1) >= pre_mean) ? TRUE : FALSE; + } else { + return false; + } +#endif + return is_snr_improve; +} + +boolean phydm_is_snr_degrade( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_lna_sat_t *pinfo = &dm->dm_lna_sat_info; + u32 cur_lower_mean = pinfo->cur_lower_snr_mean; + u32 pre_lower_mean = pinfo->pre_lower_snr_mean; + boolean is_degrade; + + if (cur_lower_mean <= (pre_lower_mean - pinfo->delta_snr_mean)) + is_degrade = TRUE; + else + is_degrade = FALSE; +#if 0 + is_mean_dgrade = (pinfo->cur_snr_mean + pinfo->delta_snr_mean <= pinfo->pre_snr_mean) ? TRUE : FALSE; + is_var_degrade = (pinfo->cur_snr_var > (pinfo->pre_snr_var + pinfo->delta_snr_mean)) ? TRUE : FALSE; + + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "%s: cur_mean=%d, pre_mean=%d, cur_var=%d, pre_var=%d\n", + __func__, + pinfo->cur_snr_mean, + pinfo->pre_snr_mean, + pinfo->cur_snr_var, + pinfo->pre_snr_var); + + return (is_mean_dgrade & is_var_degrade); +#endif + return is_degrade; +} + +boolean phydm_is_large_var( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_lna_sat_t *pinfo = &dm->dm_lna_sat_info; + boolean is_large_var = (pinfo->cur_snr_var >= pinfo->snr_var_thd) ? TRUE : FALSE; + + return is_large_var; +} + +void phydm_update_pre_status( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_lna_sat_t *pinfo = &dm->dm_lna_sat_info; + + pinfo->pre_lower_snr_mean = pinfo->cur_lower_snr_mean; + pinfo->pre_snr_mean = pinfo->cur_snr_mean; + pinfo->pre_snr_var = pinfo->cur_snr_var; +} + +void phydm_ori_table_monitor( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_lna_sat_t *pinfo = &dm->dm_lna_sat_info; + + if (phydm_is_large_var(dm)) { + pinfo->nxt_state = SAT_TABLE_TRAINING; + config_phydm_switch_agc_tab_8822b(dm, *dm->channel, LNA_SAT_AGC_TABLE); + } else { + pinfo->nxt_state = ORI_TABLE_MONITOR; + /*switch to anti-sat table*/ + config_phydm_switch_agc_tab_8822b(dm, *dm->channel, DEFAULT_AGC_TABLE); + } + phydm_update_pre_status(dm); + pinfo->pre_state = ORI_TABLE_MONITOR; +} + +void phydm_sat_table_training( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_lna_sat_t *pinfo = &dm->dm_lna_sat_info; + + #if 0 + if pre_state = ORI_TABLE_MONITOR || SAT_TABLE_TRY_FAIL, + /*@"pre" adapt ori-table, "cur" adapt sat-table*/ + /*@adapt ori table*/ + if (pinfo->pre_state == ORI_TABLE_MONITOR) { + pinfo->nxt_state = SAT_TABLE_TRAINING; + config_phydm_switch_agc_tab_8822b(dm, *dm->channel, LNA_SAT_AGC_TABLE); + } else { + #endif + if (phydm_is_snr_improve(dm)) { + pinfo->nxt_state = SAT_TABLE_MONITOR; + } else { + pinfo->nxt_state = SAT_TABLE_TRY_FAIL; + config_phydm_switch_agc_tab_8822b(dm, *dm->channel, DEFAULT_AGC_TABLE); + } + /*@}*/ + + phydm_update_pre_status(dm); + pinfo->pre_state = SAT_TABLE_TRAINING; +} + +void phydm_sat_table_try_fail( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_lna_sat_t *pinfo = &dm->dm_lna_sat_info; + + /* @if pre_state = SAT_TABLE_TRAINING, "pre" adapt sat-table, "cur" adapt ori-table */ + /* @if pre_state = SAT_TABLE_TRY_FAIL, "pre" adapt ori-table, "cur" adapt ori-table */ + + if (phydm_is_large_var(dm)) { + if (phydm_is_snr_degrade(dm)) { + pinfo->nxt_state = SAT_TABLE_TRAINING; + config_phydm_switch_agc_tab_8822b(dm, *dm->channel, LNA_SAT_AGC_TABLE); + } else { + pinfo->nxt_state = SAT_TABLE_TRY_FAIL; + } + } else { + pinfo->nxt_state = ORI_TABLE_MONITOR; + } + phydm_update_pre_status(dm); + pinfo->pre_state = SAT_TABLE_TRY_FAIL; +} + +void phydm_sat_table_monitor( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_lna_sat_t *pinfo = &dm->dm_lna_sat_info; + + if (phydm_is_snr_improve(dm)) { + pinfo->sat_table_monitor_times = 0; + + /* @if pre_state = SAT_TABLE_MONITOR, "pre" adapt sat-table, "cur" adapt sat-table */ + if (pinfo->pre_state == SAT_TABLE_MONITOR) { + pinfo->nxt_state = ORI_TABLE_TRAINING; + config_phydm_switch_agc_tab_8822b(dm, *dm->channel, DEFAULT_AGC_TABLE); + //phydm_update_pre_status(dm); + } else { + pinfo->nxt_state = SAT_TABLE_MONITOR; + } + + /* @if pre_state = SAT_TABLE_TRAINING, "pre" adapt sat-table, "cur" adapt sat-table */ + /* @if pre_state = ORI_TABLE_TRAINING, "pre" adapt ori-table, "cur" adapt sat-table */ + /*pre_state above is no need to update*/ + } else { + if (pinfo->sat_table_monitor_times == pinfo->force_change_period) { + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "%s: sat_table_monitor_times=%d\n", + __func__, pinfo->sat_table_monitor_times); + + pinfo->nxt_state = ORI_TABLE_TRAINING; + pinfo->sat_table_monitor_times = 0; + config_phydm_switch_agc_tab_8822b(dm, *dm->channel, DEFAULT_AGC_TABLE); + } else { + pinfo->nxt_state = SAT_TABLE_MONITOR; + pinfo->sat_table_monitor_times++; + } + } + phydm_update_pre_status(dm); + pinfo->pre_state = SAT_TABLE_MONITOR; +} + +void phydm_ori_table_training( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_lna_sat_t *pinfo = &dm->dm_lna_sat_info; + + /* pre_state = SAT_TABLE_MONITOR, "pre" adapt sat-table, "cur" adapt ori-table */ + + if (phydm_is_snr_degrade(dm) == FALSE) { + pinfo->nxt_state = ORI_TABLE_MONITOR; + } else { + if (pinfo->pre_snr_var == 0) + pinfo->nxt_state = ORI_TABLE_TRY_FAIL; + else + pinfo->nxt_state = SAT_TABLE_MONITOR; + + config_phydm_switch_agc_tab_8822b(dm, *dm->channel, LNA_SAT_AGC_TABLE); + } + phydm_update_pre_status(dm); + pinfo->pre_state = ORI_TABLE_TRAINING; +} + +void phydm_ori_table_try_fail( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_lna_sat_t *pinfo = &dm->dm_lna_sat_info; + + if (pinfo->pre_state == ORI_TABLE_TRY_FAIL) { + if (phydm_is_snr_improve(dm)) { + pinfo->nxt_state = ORI_TABLE_TRAINING; + pinfo->ori_table_try_fail_times = 0; + config_phydm_switch_agc_tab_8822b(dm, *dm->channel, DEFAULT_AGC_TABLE); + } else { + if (pinfo->ori_table_try_fail_times == pinfo->force_change_period) { + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, + "%s: ori_table_try_fail_times=%d\n", __func__, pinfo->ori_table_try_fail_times); + + pinfo->nxt_state = ORI_TABLE_TRY_FAIL; + pinfo->ori_table_try_fail_times = 0; + phydm_update_pre_status(dm); + } else { + pinfo->nxt_state = ORI_TABLE_TRY_FAIL; + pinfo->ori_table_try_fail_times++; + phydm_update_pre_status(dm); + //config_phydm_switch_agc_tab_8822b(dm, *dm->channel, LNA_SAT_AGC_TABLE); + } + } + } else { + pinfo->nxt_state = ORI_TABLE_TRY_FAIL; + pinfo->ori_table_try_fail_times = 0; + phydm_update_pre_status(dm); + //config_phydm_switch_agc_tab_8822b(dm, *dm->channel, LNA_SAT_AGC_TABLE); + } + +#if 0 + if (phydm_is_large_var(dm)) { + if (phydm_is_snr_degrade(dm)) { + pinfo->nxt_state = SAT_TABLE_TRAINING; + config_phydm_switch_agc_tab_8822b(dm, *dm->channel, LNA_SAT_AGC_TABLE); + } else { + pinfo->nxt_state = SAT_TABLE_TRY_FAIL; + } + } else { + pinfo->nxt_state = ORI_TABLE_MONITOR; + } + + phydm_update_pre_status(dm); +#endif + pinfo->pre_state = ORI_TABLE_TRY_FAIL; +} + +char *phydm_lna_sat_state_msg( + void *dm_void, + IN u8 state) +{ + char *dbg_message; + + switch (state) { + case ORI_TABLE_MONITOR: + dbg_message = "ORI_TABLE_MONITOR"; + break; + + case SAT_TABLE_TRAINING: + dbg_message = "SAT_TABLE_TRAINING"; + break; + + case SAT_TABLE_TRY_FAIL: + dbg_message = "SAT_TABLE_TRY_FAIL"; + break; + + case SAT_TABLE_MONITOR: + dbg_message = "SAT_TABLE_MONITOR"; + break; + + case ORI_TABLE_TRAINING: + dbg_message = "ORI_TABLE_TRAINING"; + break; + + case ORI_TABLE_TRY_FAIL: + dbg_message = "ORI_TABLE_TRY_FAIL"; + break; + + default: + dbg_message = "ORI_TABLE_MONITOR"; + break; + } + + return dbg_message; +} + +void phydm_lna_sat_type2_sm( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_lna_sat_t *pinfo = &dm->dm_lna_sat_info; + u8 state = pinfo->nxt_state; + u8 agc_tab = (u8)odm_get_bb_reg(dm, 0x958, 0x1f); + char *dbg_message, *nxt_dbg_message; + u8 real_shift = pinfo->total_bit_shift; + + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "\n\n%s ==>\n", __func__); + + if ((dm->support_ic_type & ODM_RTL8822B) == FALSE) { + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "ODM_BB_LNA_SAT_CHK_TYPE2 only support 22B.\n"); + return; + } + + if ((dm->support_ability & ODM_BB_LNA_SAT_CHK) == FALSE) { + phydm_lna_sat_chk_type2_init(dm); + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "ODM_BB_LNA_SAT_CHK_TYPE2 is NOT supported, cur table=%d\n", agc_tab); + return; + } + + if (pinfo->is_snr_done) + phydm_snr_data_processing(dm); + else + return; + + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "cur agc table %d\n", agc_tab); + + if (pinfo->is_force_lna_sat_table != AUTO_AGC_TABLE) { + /*reset state machine*/ + pinfo->nxt_state = ORI_TABLE_MONITOR; + if (pinfo->is_snr_done) { + if (pinfo->is_force_lna_sat_table == DEFAULT_AGC_TABLE) + config_phydm_switch_agc_tab_8822b(dm, *dm->channel, DEFAULT_AGC_TABLE); + else if (pinfo->is_force_lna_sat_table == LNA_SAT_AGC_TABLE) + config_phydm_switch_agc_tab_8822b(dm, *dm->channel, LNA_SAT_AGC_TABLE); + else + config_phydm_switch_agc_tab_8822b(dm, *dm->channel, DEFAULT_AGC_TABLE); + + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, + "%s: cur_mean=%d, pre_mean=%d, cur_var=%d, pre_var=%d,cur_lower_mean=%d, pre_lower_mean=%d, cnt_lower_snr=%d\n", + __func__, + pinfo->cur_snr_mean, + pinfo->pre_snr_mean, + pinfo->cur_snr_var, + pinfo->pre_snr_var, + pinfo->cur_lower_snr_mean, + pinfo->pre_lower_snr_mean, + pinfo->cnt_lower_snr_statistic); + + pinfo->is_snr_done = FALSE; + pinfo->is_sm_done = TRUE; + phydm_update_pre_status(dm); + } else { + return; + } + } else if (pinfo->is_snr_done) { + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, + "%s: cur_mean=%d, pre_mean=%d, cur_var=%d, pre_var=%d,cur_lower_mean=%d, pre_lower_mean=%d, cnt_lower_snr=%d\n", + __func__, + pinfo->cur_snr_mean, + pinfo->pre_snr_mean, + pinfo->cur_snr_var, + pinfo->pre_snr_var, + pinfo->cur_lower_snr_mean, + pinfo->pre_lower_snr_mean, + pinfo->cnt_lower_snr_statistic); + + switch (state) { + case ORI_TABLE_MONITOR: + dbg_message = "ORI_TABLE_MONITOR"; + phydm_ori_table_monitor(dm); + break; + + case SAT_TABLE_TRAINING: + dbg_message = "SAT_TABLE_TRAINING"; + phydm_sat_table_training(dm); + break; + + case SAT_TABLE_TRY_FAIL: + dbg_message = "SAT_TABLE_TRY_FAIL"; + phydm_sat_table_try_fail(dm); + break; + + case SAT_TABLE_MONITOR: + dbg_message = "SAT_TABLE_MONITOR"; + phydm_sat_table_monitor(dm); + break; + + case ORI_TABLE_TRAINING: + dbg_message = "ORI_TABLE_TRAINING"; + phydm_ori_table_training(dm); + break; + + case ORI_TABLE_TRY_FAIL: + dbg_message = "ORI_TABLE_TRAINING"; + phydm_ori_table_try_fail(dm); + break; + + default: + dbg_message = "ORI_TABLE_MONITOR"; + phydm_ori_table_monitor(dm); + break; + } + + dbg_message = phydm_lna_sat_state_msg(dm, state); + nxt_dbg_message = phydm_lna_sat_state_msg(dm, pinfo->nxt_state); + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "state: [%s]->[%s]\n", + dbg_message, nxt_dbg_message); + + pinfo->is_snr_done = FALSE; + pinfo->is_sm_done = TRUE; + pinfo->total_cnt_snr = 1 << real_shift; + + } else { + return; + } +} + + +#endif /*@#ifdef PHYDM_LNA_SAT_CHK_TYPE2*/ + +void phydm_lna_sat_debug( + void *dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_lna_sat_t *lna_t = &dm->dm_lna_sat_info; + char help[] = "-h"; + char monitor[] = "-m"; + u32 var1[10] = {0}; + u32 used = *_used; + u32 out_len = *_out_len; + u8 i; + u8 agc_tab = 0; + + if ((strcmp(input[1], help) == 0)) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "monitor: -m\n"); + #ifdef PHYDM_LNA_SAT_CHK_TYPE1 + PDM_SNPF(out_len, used, output + used, out_len - used, + "{0} {lna_sat_chk_en}\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{1} {agc_table_switch_en}\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{2} {chk_cnt per callback}\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{3} {chk_period(ms)}\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{4} {chk_duty_cycle(%)}\n"); + #endif + } else if ((strcmp(input[1], monitor) == 0)) { +#ifdef PHYDM_LNA_SAT_CHK_TYPE1 + #if (RTL8198F_SUPPORT || RTL8814B_SUPPORT) + if (dm->support_ic_type & (ODM_RTL8198F | ODM_RTL8814B)) + agc_tab = phydm_get_ofdm_agc_tab_path(dm, RF_PATH_A); + else + #endif + agc_tab = phydm_get_ofdm_agc_tab(dm); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "%s%d, %s%d, %s%d, %s%d\n", + "check_time = ", lna_t->check_time, + "pre_sat_status = ", lna_t->pre_sat_status, + "cur_sat_status = ", lna_t->cur_sat_status, + "current AGC tab = ", agc_tab); +#endif + } 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]); + } + #ifdef PHYDM_LNA_SAT_CHK_TYPE1 + if (var1[0] == 0) { + if (var1[1] == 1) + lna_t->is_disable_lna_sat_chk = false; + else if (var1[1] == 0) + lna_t->is_disable_lna_sat_chk = true; + + PDM_SNPF(out_len, used, output + used, out_len - used, + "dis_lna_sat_chk=%d\n", + lna_t->is_disable_lna_sat_chk); + } else if (var1[0] == 1) { + if (var1[1] == 1) + lna_t->dis_agc_table_swh = false; + else if (var1[1] == 0) + lna_t->dis_agc_table_swh = true; + + PDM_SNPF(out_len, used, output + used, out_len - used, + "dis_agc_table_swh=%d\n", + lna_t->dis_agc_table_swh); + + } else if (var1[0] == 2) { + lna_t->chk_cnt = (u8)var1[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "chk_cnt=%d\n", lna_t->chk_cnt); + } else if (var1[0] == 3) { + lna_t->chk_period = var1[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "chk_period=%d\n", lna_t->chk_period); + } else if (var1[0] == 4) { + lna_t->chk_duty_cycle = (u8)var1[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "chk_duty_cycle=%d\n", + lna_t->chk_duty_cycle); + } + #endif + #ifdef PHYDM_LNA_SAT_CHK_TYPE2 + if (var1[0] == 1) + lna_t->force_traget_macid = var1[1]; + #endif + } + *_used = used; + *_out_len = out_len; +} + +void phydm_lna_sat_chk_watchdog( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_lna_sat_t *lna_sat = &dm->dm_lna_sat_info; + + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "%s ==>\n", __func__); + + if (lna_sat->lna_sat_type == LNA_SAT_WITH_PEAK_DET) { + #ifdef PHYDM_LNA_SAT_CHK_TYPE1 + phydm_lna_sat_chk_watchdog_type1(dm); + #endif + } else if (lna_sat->lna_sat_type == LNA_SAT_WITH_TRAIN) { + #ifdef PHYDM_LNA_SAT_CHK_TYPE2 + + #endif + } + +} + +void phydm_lna_sat_config( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_lna_sat_t *lna_sat = &dm->dm_lna_sat_info; + + #if (RTL8822B_SUPPORT == 1) + if (dm->support_ic_type & (ODM_RTL8822B)) + lna_sat->lna_sat_type = LNA_SAT_WITH_TRAIN; + #endif + + #if (RTL8197F_SUPPORT || RTL8192F_SUPPORT ||\ + RTL8198F_SUPPORT || RTL8814B_SUPPORT) + if (dm->support_ic_type & + (ODM_RTL8197F | ODM_RTL8192F | ODM_RTL8198F | ODM_RTL8814B)) + lna_sat->lna_sat_type = LNA_SAT_WITH_PEAK_DET; + #endif + + PHYDM_DBG(dm, DBG_LNA_SAT_CHK, "[%s] lna_sat_type=%d\n", + __func__, lna_sat->lna_sat_type); +} + +void phydm_lna_sat_check_init( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_lna_sat_t *lna_sat = &dm->dm_lna_sat_info; + + if ((dm->support_ability & ODM_BB_LNA_SAT_CHK)) + return; + + /*@2018.04.17 Johnson*/ + phydm_lna_sat_config(dm); + #ifdef PHYDM_LNA_SAT_CHK_TYPE1 + lna_sat->chk_period = LNA_CHK_PERIOD; + lna_sat->chk_cnt = LNA_CHK_CNT; + lna_sat->chk_duty_cycle = LNA_CHK_DUTY_CYCLE; + lna_sat->dis_agc_table_swh = false; + #endif + /*@2018.04.17 Johnson end*/ + + if (lna_sat->lna_sat_type == LNA_SAT_WITH_PEAK_DET) { + #ifdef PHYDM_LNA_SAT_CHK_TYPE1 + phydm_lna_sat_chk_init(dm); + #endif + } else if (lna_sat->lna_sat_type == LNA_SAT_WITH_TRAIN) { + #ifdef PHYDM_LNA_SAT_CHK_TYPE2 + phydm_lna_sat_chk_type2_init(dm); + #endif + } +} + +#endif /*@#ifdef PHYDM_LNA_SAT_CHK_SUPPORT*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_lna_sat.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_lna_sat.h new file mode 100644 index 000000000000..10d21feb4526 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_lna_sat.h @@ -0,0 +1,174 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +#ifndef __PHYDM_LNA_SAT_H__ +#define __PHYDM_LNA_SAT_H__ +#ifdef PHYDM_LNA_SAT_CHK_SUPPORT +/* @1 ============================================================ + * 1 Definition + * 1 ============================================================ + */ + +#define LNA_SAT_VERSION "1.0" + +/*@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 + +#define LNA_CHK_PERIOD 100 /*@ms*/ +#define LNA_CHK_CNT 10 /*@checks per callback*/ +#define LNA_CHK_DUTY_CYCLE 5 /*@percentage*/ + +#define DELTA_STD 2 +#define DELTA_MEAN 2 +#define SNR_STATISTIC_SHIFT 8 +#define SNR_RPT_MAX 256 + +/* @1 ============================================================ + * 1 enumrate + * 1 ============================================================ + */ + +enum lna_sat_timer_state { + INIT_LNA_SAT_CHK_TIMMER, + CANCEL_LNA_SAT_CHK_TIMMER, + RELEASE_LNA_SAT_CHK_TIMMER +}; + +#ifdef PHYDM_LNA_SAT_CHK_TYPE2 +enum lna_sat_chk_type2_status { + ORI_TABLE_MONITOR, + ORI_TABLE_TRAINING, + SAT_TABLE_MONITOR, + SAT_TABLE_TRAINING, + SAT_TABLE_TRY_FAIL, + ORI_TABLE_TRY_FAIL +}; + +#endif + +enum lna_sat_type { + LNA_SAT_WITH_PEAK_DET = 1, /*type1*/ + LNA_SAT_WITH_TRAIN = 2, /*type2*/ +}; + +/* @1 ============================================================ + * 1 structure + * 1 ============================================================ + */ + +struct phydm_lna_sat_t { +#ifdef PHYDM_LNA_SAT_CHK_TYPE1 + u8 chk_cnt; + u8 chk_duty_cycle; + u32 chk_period;/*@ms*/ + boolean is_disable_lna_sat_chk; + boolean dis_agc_table_swh; +#endif +#ifdef PHYDM_LNA_SAT_CHK_TYPE2 + u8 force_traget_macid; + u32 snr_var_thd; + u32 delta_snr_mean; + u16 ori_table_try_fail_times; + u16 cnt_lower_snr_statistic; + u16 sat_table_monitor_times; + u16 force_change_period; + u8 is_snr_detail_en; + u8 is_force_lna_sat_table; + u8 lwr_snr_ratio_bit_shift; + u8 cnt_snr_statistic; + u16 snr_statistic_sqr[SNR_RPT_MAX]; + u8 snr_statistic[SNR_RPT_MAX]; + u8 is_sm_done; + u8 is_snr_done; + u32 cur_snr_var; + u8 total_bit_shift; + u8 total_cnt_snr; + u32 cur_snr_mean; + u8 cur_snr_var0; + u32 cur_lower_snr_mean; + u32 pre_snr_mean; + u32 pre_snr_var; + u32 pre_lower_snr_mean; + u8 nxt_state; + u8 pre_state; +#endif + enum lna_sat_type lna_sat_type; + u32 sat_cnt_acc_patha; + u32 sat_cnt_acc_pathb; +#ifdef PHYDM_IC_ABOVE_3SS + u32 sat_cnt_acc_pathc; +#endif +#ifdef PHYDM_IC_ABOVE_4SS + u32 sat_cnt_acc_pathd; +#endif + u32 check_time; + boolean pre_sat_status; + boolean cur_sat_status; + struct phydm_timer_list phydm_lna_sat_chk_timer; + u32 cur_timer_check_cnt; + u32 pre_timer_check_cnt; +}; + +/* @1 ============================================================ + * 1 function prototype + * 1 ============================================================ + */ +void phydm_lna_sat_chk_init(void *dm_void); + +u8 phydm_get_ofdm_agc_tab(void *dm_void); + +void phydm_lna_sat_chk(void *dm_void); + +void phydm_lna_sat_chk_timers(void *dm_void, u8 state); + +#ifdef PHYDM_LNA_SAT_CHK_TYPE1 +#if (RTL8198F_SUPPORT || RTL8814B_SUPPORT) +void phydm_lna_sat_chk_bb_init(void *dm_void); + +void phydm_set_ofdm_agc_tab_path(void *dm_void, + u8 tab_sel, enum rf_path path); + +u8 phydm_get_ofdm_agc_tab_path(void *dm_void, enum rf_path path); +#endif /*@#if (RTL8198F_SUPPORT || RTL8814B_SUPPORT)*/ +#endif + +#ifdef PHYDM_LNA_SAT_CHK_TYPE2 +void phydm_parsing_snr(void *dm_void, void *pktinfo_void, s8 *rx_snr); +#endif + +void phydm_lna_sat_debug(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len); + +void phydm_lna_sat_chk_watchdog(void *dm_void); + +void phydm_lna_sat_check_init(void *dm_void); + +#endif /*@#if (PHYDM_LNA_SAT_CHK_SUPPORT == 1)*/ +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_math_lib.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_math_lib.c new file mode 100644 index 000000000000..7935695c18b6 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_math_lib.c @@ -0,0 +1,271 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +/*@************************************************************ + * include files + ************************************************************/ + +#include "mp_precomp.h" +#include "phydm_precomp.h" + +const u32 db_invert_table[12][8] = { + {10, 13, 16, 20, 25, 32, 40, 50}, /* @U(32,3) */ + {64, 80, 101, 128, 160, 201, 256, 318}, /* @U(32,3) */ + {401, 505, 635, 800, 1007, 1268, 1596, 2010}, /* @U(32,3) */ + {316, 398, 501, 631, 794, 1000, 1259, 1585}, /* @U(32,0) */ + {1995, 2512, 3162, 3981, 5012, 6310, 7943, 10000}, /* @U(32,0) */ + {12589, 15849, 19953, 25119, 31623, 39811, 50119, 63098}, /* @U(32,0) */ + {79433, 100000, 125893, 158489, 199526, 251189, 316228, + 398107}, /* @U(32,0) */ + {501187, 630957, 794328, 1000000, 1258925, 1584893, 1995262, + 2511886}, /* @U(32,0) */ + {3162278, 3981072, 5011872, 6309573, 7943282, 1000000, 12589254, + 15848932}, /* @U(32,0) */ + {19952623, 25118864, 31622777, 39810717, 50118723, 63095734, + 79432823, 100000000}, /* @U(32,0) */ + {125892541, 158489319, 199526232, 251188643, 316227766, 398107171, + 501187234, 630957345}, /* @U(32,0) */ + {794328235, 1000000000, 1258925412, 1584893192, 1995262315, + 2511886432U, 3162277660U, 3981071706U} }; /* @U(32,0) */ + +/*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 is 0.5dB*3=1.5dB~=2dB */ + decimal = (X & BIT(i - 1)) ? 2 : 0; + } + 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; +} + +/*threshold must form low to high*/ +u16 phydm_find_intrvl(void *dm_void, u16 val, u16 *threshold, u16 th_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u16 i = 0; + u16 ret_val = 0; + u16 max_th = threshold[th_len - 1]; + + for (i = 0; i < th_len; i++) { + if (val < threshold[i]) { + ret_val = i; + break; + } else if (val >= max_th) { + ret_val = th_len; + break; + } + } + + return ret_val; +} + +void phydm_seq_sorting(void *dm_void, u32 *value, u32 *rank_idx, u32 *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 = value[j]; + tmp_b = value[j + 1]; + + tmp_idx_a = rank_idx[j]; + tmp_idx_b = rank_idx[j + 1]; + + if (tmp_a < tmp_b) { + value[j] = tmp_b; + 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++) + idx_out[rank_idx[i]] = i + 1; +} + +u32 odm_convert_to_db(u64 value) +{ + u8 i; + u8 j; + u32 dB; + + if (value >= db_invert_table[11][7]) + return 96; /* @maximum 96 dB */ + + for (i = 0; i < 12; i++) { + if (i <= 2 && (value << FRAC_BITS) <= db_invert_table[i][7]) + break; + else if (i > 2 && value <= db_invert_table[i][7]) + break; + } + + for (j = 0; j < 8; j++) { + if (i <= 2 && (value << FRAC_BITS) <= db_invert_table[i][j]) + break; + else if (i > 2 && i < 12 && value <= db_invert_table[i][j]) + break; + } + + if (j == 0 && i == 0) + goto end; + + if (j == 0) { + if (i != 3) { + if (db_invert_table[i][0] - value > + value - db_invert_table[i - 1][7]) { + i = i - 1; + j = 7; + } + } else { + if (db_invert_table[3][0] - value > + value - db_invert_table[2][7]) { + i = 2; + j = 7; + } + } + } else { + if (db_invert_table[i][j] - value > + value - db_invert_table[i][j - 1]) { + i = i; + j = j - 1; + } + } +end: + dB = (i << 3) + j + 1; + + return dB; +} + +u64 phydm_db_2_linear(u32 value) +{ + u8 i = 0; + u8 j = 0; + u64 linear = 0; + + value = value & 0xFF; + + /* @1dB~96dB */ + if (value > 96) { + value = 96; + } else if (value < 1) { + linear = 1; + return linear; + } + + i = (u8)((value - 1) >> 3); + j = (u8)(value - 1) - (i << 3); + + linear = db_invert_table[i][j]; + + if (i > 2) + linear = linear << FRAC_BITS; + + return linear; +} + +u16 phydm_show_fraction_num(u32 frac_val, u8 bit_num) +{ + u8 i = 0; + u16 val = 0; + u16 base = 5000; + + for (i = bit_num; i > 0; i--) { + if (frac_val & BIT(i - 1)) + val += (base >> (bit_num - i)); + } + return val; +} + +u64 phydm_gen_bitmask(u8 mask_num) +{ + u8 i = 0; + u64 bitmask = 0; + + if (mask_num > 64) + return 1; + + for (i = 0; i < mask_num; i++) + bitmask = (bitmask << 1) | BIT(0); + + return bitmask; +} + +s32 phydm_cnvrt_2_sign(u32 val, u8 bit_num) +{ + if (bit_num >= 32) + return (s32)val; + + if (val & BIT(bit_num - 1)) /*Sign BIT*/ + val -= (1 << bit_num); /*@2's*/ + + return val; +} + +s64 phydm_cnvrt_2_sign_64(u64 val, u8 bit_num) +{ + u64 one = 1; + s64 val_sign = (s64)val; + + if (bit_num >= 64) + return (s64)val; + + if (val & (one << (bit_num - 1))) /*Sign BIT*/ + val_sign = val - (one << bit_num); /*@2's*/ + + return val_sign; +} + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_math_lib.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_math_lib.h new file mode 100644 index 000000000000..06f989477217 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_math_lib.h @@ -0,0 +1,119 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +#ifndef __PHYDM_MATH_LIB_H__ +#define __PHYDM_MATH_LIB_H__ + +/* @2019.01.24 remove linear2db debug log*/ +#define AUTO_MATH_LIB_VERSION "1.2" + +/*@ + * 1 ============================================================ + * 1 Definition + * 1 ============================================================ + */ + +#define PHYDM_DIV(a, b) ((b) ? (a / b) : 0) +#define DIVIDED_2(X) ((X) >> 1) +/*@1/3 ~ 11/32*/ +#if defined(DM_ODM_CE_MAC80211) +#define DIVIDED_3(X) ({ \ + u32 div_3_tmp = (X); \ + (((div_3_tmp) + ((div_3_tmp) << 1) + ((div_3_tmp) << 3)) >> 5); }) +#else +#define DIVIDED_3(X) (((X) + ((X) << 1) + ((X) << 3)) >> 5) +#endif +#define DIVIDED_4(X) ((X) >> 2) + +/*Store Ori Value*/ +#if defined(DM_ODM_CE_MAC80211) +#define WEIGHTING_AVG(v1, w1, v2, w2) \ + __WEIGHTING_AVG(v1, w1, v2, w2, typeof(v1), typeof(w1), typeof(v2), \ + typeof(w2)) +#define __WEIGHTING_AVG(v1, w1, v2, w2, t1, t2, t3, t4) ({ \ + t1 __w_a_v1 = (v1); \ + t2 __w_a_w1 = (w1); \ + t3 __w_a_v2 = (v2); \ + t4 __w_a_w2 = (w2); \ + ((__w_a_v1) * (__w_a_w1) + (__w_a_v2) * (__w_a_w2)) \ + / ((__w_a_w2) + (__w_a_w1)); }) +#else +#define WEIGHTING_AVG(v1, w1, v2, w2) \ + (((v1) * (w1) + (v2) * (w2)) / ((w2) + (w1))) +#endif + +/*Store 2^ma x Value*/ +#if defined(DM_ODM_CE_MAC80211) +#define MA_ACC(old, new_val, ma) ({ \ + s16 __ma_acc_o = (old); \ + (__ma_acc_o) - ((__ma_acc_o) >> (ma)) + (new_val); }) +#define GET_MA_VAL(val, ma) ({ \ + s16 __get_ma_tmp = (ma);\ + ((val) + (1 << ((__get_ma_tmp) - 1))) >> (__get_ma_tmp); }) +#else +#define MA_ACC(old, new_val, ma) ((old) - ((old) >> (ma)) + (new_val)) +#define GET_MA_VAL(val, ma) (((val) + (1 << ((ma) - 1))) >> (ma)) +#endif +#define FRAC_BITS 3 +/*@ + * 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); + +u16 phydm_find_intrvl(void *dm_void, u16 val, u16 *threshold, u16 th_len); + +void phydm_seq_sorting(void *dm_void, u32 *value, u32 *rank_idx, u32 *idx_out, + u8 seq_length); + +u32 odm_convert_to_db(u64 value); + +u64 phydm_db_2_linear(u32 value); + +u16 phydm_show_fraction_num(u32 frac_val, u8 bit_num); + +u64 phydm_gen_bitmask(u8 mask_num); + +s32 phydm_cnvrt_2_sign(u32 val, u8 bit_num); + +s64 phydm_cnvrt_2_sign_64(u64 val, u8 bit_num); +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_mp.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_mp.c new file mode 100644 index 000000000000..ed26896341d9 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_mp.c @@ -0,0 +1,349 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +/*@************************************************************ + * include files + ************************************************************/ + +#include "mp_precomp.h" +#include "phydm_precomp.h" + +#ifdef PHYDM_MP_SUPPORT +#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + +void phydm_mp_set_single_tone_jgr3(void *dm_void, boolean is_single_tone, + u8 path) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_mp *mp = &dm->dm_mp_table; + u8 start = RF_PATH_A, end = RF_PATH_A; + u8 i = 0; + + switch (path) { + case RF_PATH_A: + case RF_PATH_B: + case RF_PATH_C: + case RF_PATH_D: + start = path; + end = path; + break; + case RF_PATH_AB: + start = RF_PATH_A; + end = RF_PATH_B; + break; +#if (RTL8814B_SUPPORT == 1 || RTL8198F_SUPPORT == 1) + case RF_PATH_AC: + start = RF_PATH_A; + end = RF_PATH_C; + break; + case RF_PATH_AD: + start = RF_PATH_A; + end = RF_PATH_D; + break; + case RF_PATH_BC: + start = RF_PATH_B; + end = RF_PATH_C; + break; + case RF_PATH_BD: + start = RF_PATH_B; + end = RF_PATH_D; + break; + case RF_PATH_CD: + start = RF_PATH_C; + end = RF_PATH_D; + break; + case RF_PATH_ABC: + start = RF_PATH_A; + end = RF_PATH_C; + break; + case RF_PATH_ABD: + start = RF_PATH_A; + end = RF_PATH_D; + break; + case RF_PATH_ACD: + start = RF_PATH_A; + end = RF_PATH_D; + break; + case RF_PATH_BCD: + start = RF_PATH_B; + end = RF_PATH_D; + break; + case RF_PATH_ABCD: + start = RF_PATH_A; + end = RF_PATH_D; + break; +#endif + } + if (is_single_tone) { + mp->rf_reg0 = odm_get_rf_reg(dm, RF_PATH_A, RF_0x00, 0xfffff); +#if 0 + mp->rfe_sel_a_0 = odm_get_bb_reg(dm, R_0x1840, MASKDWORD); + mp->rfe_sel_b_0 = odm_get_bb_reg(dm, R_0x4140, MASKDWORD); + mp->rfe_sel_c_0 = odm_get_bb_reg(dm, R_0x5240, MASKDWORD); + mp->rfe_sel_d_0 = odm_get_bb_reg(dm, R_0x5340, MASKDWORD); + mp->rfe_sel_a_1 = odm_get_bb_reg(dm, R_0x1844, MASKDWORD); + mp->rfe_sel_b_1 = odm_get_bb_reg(dm, R_0x4144, MASKDWORD); + mp->rfe_sel_c_1 = odm_get_bb_reg(dm, R_0x5244, MASKDWORD); + mp->rfe_sel_d_1 = odm_get_bb_reg(dm, R_0x5344, MASKDWORD); +#endif + /* Disable CCK and OFDM */ + odm_set_bb_reg(dm, R_0x1c3c, 0x3, 0x0); + for (i = start; i <= end; i++) { + /* @Tx mode: RF0x00[19:16]=4'b0010 */ + odm_set_rf_reg(dm, i, RF_0x0, 0xF0000, 0x2); + /* @Lowest RF gain index: RF_0x0[4:0] = 0*/ + odm_set_rf_reg(dm, i, RF_0x0, 0x1F, 0x0); + /* @RF LO enabled */ + odm_set_rf_reg(dm, i, RF_0x58, BIT(1), 0x1); + } + #if (RTL8814B_SUPPORT) + if (dm->support_ic_type & ODM_RTL8814B) { + /* @Tx mode: RF0x00[19:16]=4'b0010 */ + config_phydm_write_rf_syn_8814b(dm, RF_SYN0, RF_0x0, + 0xF0000, 0x2); + /* @Lowest RF gain index: RF_0x0[4:0] = 0*/ + config_phydm_write_rf_syn_8814b(dm, RF_SYN0, RF_0x0, + 0x1F, 0x0); + /* @RF LO enabled */ + config_phydm_write_rf_syn_8814b(dm, RF_SYN0, RF_0x58, + BIT(1), 0x1); + } + #endif + } else { + /* Eable CCK and OFDM */ + odm_set_bb_reg(dm, R_0x1c3c, 0x3, 0x3); + if (!(dm->support_ic_type & ODM_RTL8814B)) { + for (i = start; i <= end; i++) { + odm_set_rf_reg(dm, i, RF_0x00, 0xfffff, + mp->rf_reg0); + /* RF LO disabled */ + odm_set_rf_reg(dm, i, RF_0x58, BIT(1), 0x0); + } + } +#if 0 + odm_set_bb_reg(dm, R_0x1840, MASKDWORD, mp->rfe_sel_a_0); + odm_set_bb_reg(dm, R_0x4140, MASKDWORD, mp->rfe_sel_b_0); + odm_set_bb_reg(dm, R_0x5240, MASKDWORD, mp->rfe_sel_c_0); + odm_set_bb_reg(dm, R_0x5340, MASKDWORD, mp->rfe_sel_d_0); + odm_set_bb_reg(dm, R_0x1844, MASKDWORD, mp->rfe_sel_a_1); + odm_set_bb_reg(dm, R_0x4144, MASKDWORD, mp->rfe_sel_b_1); + odm_set_bb_reg(dm, R_0x5244, MASKDWORD, mp->rfe_sel_c_1); + odm_set_bb_reg(dm, R_0x5344, MASKDWORD, mp->rfe_sel_d_1); +#endif + } +} + +void phydm_mp_set_carrier_supp_jgr3(void *dm_void, boolean is_carrier_supp, + u32 rate_index) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_mp *mp = &dm->dm_mp_table; + + if (is_carrier_supp) { + if (phydm_is_cck_rate(dm, (u8)rate_index)) { + /* @if CCK block on? */ + if (!odm_get_bb_reg(dm, R_0x1c3c, BIT(1))) + odm_set_bb_reg(dm, R_0x1c3c, BIT(1), 1); + + /* @Turn Off All Test mode */ + odm_set_bb_reg(dm, R_0x1ca4, 0x7, 0x0); + + /* @transmit mode */ + odm_set_bb_reg(dm, R_0x1a00, 0x3, 0x2); + /* @turn off scramble setting */ + odm_set_bb_reg(dm, R_0x1a00, 0x8, 0x0); + /* @Set CCK Tx Test Rate, set FTxRate to 1Mbps */ + odm_set_bb_reg(dm, R_0x1a00, 0x3000, 0x0); + } + } else { /* @Stop Carrier Suppression. */ + if (phydm_is_cck_rate(dm, (u8)rate_index)) { + /* @normal mode */ + odm_set_bb_reg(dm, R_0x1a00, 0x3, 0x0); + /* @turn on scramble setting */ + odm_set_bb_reg(dm, R_0x1a00, 0x8, 0x1); + /* @BB Reset */ + odm_set_bb_reg(dm, R_0x1d0c, 0x10000, 0x0); + odm_set_bb_reg(dm, R_0x1d0c, 0x10000, 0x1); + } + } +} +#endif + +void phydm_mp_set_crystal_cap(void *dm_void, u8 crystal_cap) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + phydm_set_crystal_cap(dm, crystal_cap); +} + +void phydm_mp_set_single_tone(void *dm_void, boolean is_single_tone, u8 path) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + phydm_mp_set_single_tone_jgr3(dm, is_single_tone, path); +} + +void phydm_mp_set_carrier_supp(void *dm_void, boolean is_carrier_supp, + u32 rate_index) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + phydm_mp_set_carrier_supp_jgr3(dm, is_carrier_supp, rate_index); +} + +void phydm_mp_set_single_carrier(void *dm_void, boolean is_single_carrier) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_mp *mp = &dm->dm_mp_table; + + if (is_single_carrier) { + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + /* @1. if OFDM block on? */ + if (!odm_get_bb_reg(dm, R_0x1c3c, BIT(0))) + odm_set_bb_reg(dm, R_0x1c3c, BIT(0), 1); + + /* @2. set CCK test mode off, set to CCK normal mode */ + odm_set_bb_reg(dm, R_0x1a00, 0x3, 0); + + /* @3. turn on scramble setting */ + odm_set_bb_reg(dm, R_0x1a00, 0x8, 1); + + /* @4. Turn On single carrier. */ + odm_set_bb_reg(dm, R_0x1ca4, 0x7, OFDM_SINGLE_CARRIER); + } else { + /* @1. if OFDM block on? */ + if (!odm_get_bb_reg(dm, R_0x800, 0x2000000)) + odm_set_bb_reg(dm, R_0x800, 0x2000000, 1); + + /* @2. set CCK test mode off, set to CCK normal mode */ + odm_set_bb_reg(dm, R_0xa00, 0x3, 0); + + /* @3. turn on scramble setting */ + odm_set_bb_reg(dm, R_0xa00, 0x8, 1); + + /* @4. Turn On single carrier. */ + if (dm->support_ic_type & ODM_IC_11AC_SERIES) + odm_set_bb_reg(dm, R_0x914, 0x70000, + OFDM_SINGLE_CARRIER); + else if (dm->support_ic_type & ODM_IC_11N_SERIES) + odm_set_bb_reg(dm, R_0xd00, 0x70000000, + OFDM_SINGLE_CARRIER); + } + } else { /* @Stop Single Carrier. */ + /* @Turn off all test modes. */ + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + odm_set_bb_reg(dm, R_0x1ca4, 0x7, OFDM_OFF); + else if (dm->support_ic_type & ODM_IC_11AC_SERIES) + odm_set_bb_reg(dm, R_0x914, 0x70000, OFDM_OFF); + else if (dm->support_ic_type & ODM_IC_11N_SERIES) + odm_set_bb_reg(dm, R_0xd00, 0x70000000, OFDM_OFF); + /* @Delay 10 ms */ + ODM_delay_ms(10); + + /* @BB Reset */ + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + odm_set_bb_reg(dm, R_0x1d0c, 0x10000, 0x0); + odm_set_bb_reg(dm, R_0x1d0c, 0x10000, 0x1); + } else { + odm_set_bb_reg(dm, R_0x100, 0x100, 0x0); + odm_set_bb_reg(dm, R_0x100, 0x100, 0x1); + } + } +} +void phydm_mp_reset_rx_counters_phy(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + phydm_reset_bb_hw_cnt(dm); +} + +void phydm_mp_get_tx_ok(void *dm_void, u32 rate_index) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_mp *mp = &dm->dm_mp_table; + + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + if (phydm_is_cck_rate(dm, (u8)rate_index)) + mp->tx_phy_ok_cnt = odm_get_bb_reg(dm, R_0x2de4, + 0xffff); + else + mp->tx_phy_ok_cnt = odm_get_bb_reg(dm, R_0x2de0, + 0xffff); + } else { + if (phydm_is_cck_rate(dm, (u8)rate_index)) + mp->tx_phy_ok_cnt = odm_get_bb_reg(dm, R_0xf50, + 0xffff); + else + mp->tx_phy_ok_cnt = odm_get_bb_reg(dm, R_0xf50, + 0xffff0000); + } +} + +void phydm_mp_get_rx_ok(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_mp *mp = &dm->dm_mp_table; + + u32 cck_ok = 0, ofdm_ok = 0, ht_ok = 0, vht_ok = 0; + u32 cck_err = 0, ofdm_err = 0, ht_err = 0, vht_err = 0; + + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + cck_ok = odm_get_bb_reg(dm, R_0x2c04, 0xffff); + ofdm_ok = odm_get_bb_reg(dm, R_0x2c14, 0xffff); + ht_ok = odm_get_bb_reg(dm, R_0x2c10, 0xffff); + vht_ok = odm_get_bb_reg(dm, R_0x2c0c, 0xffff); + + cck_err = odm_get_bb_reg(dm, R_0x2c04, 0xffff0000); + ofdm_err = odm_get_bb_reg(dm, R_0x2c14, 0xffff0000); + ht_err = odm_get_bb_reg(dm, R_0x2c10, 0xffff0000); + vht_err = odm_get_bb_reg(dm, R_0x2c0c, 0xffff0000); + } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + cck_ok = odm_get_bb_reg(dm, R_0xf04, 0x3FFF); + ofdm_ok = odm_get_bb_reg(dm, R_0xf14, 0x3FFF); + ht_ok = odm_get_bb_reg(dm, R_0xf10, 0x3FFF); + vht_ok = odm_get_bb_reg(dm, R_0xf0c, 0x3FFF); + + cck_err = odm_get_bb_reg(dm, R_0xf04, 0x3FFF0000); + ofdm_err = odm_get_bb_reg(dm, R_0xf14, 0x3FFF0000); + ht_err = odm_get_bb_reg(dm, R_0xf10, 0x3FFF0000); + vht_err = odm_get_bb_reg(dm, R_0xf0c, 0x3FFF0000); + } else if (dm->support_ic_type & ODM_IC_11N_SERIES) { + cck_ok = odm_get_bb_reg(dm, R_0xf88, MASKDWORD); + ofdm_ok = odm_get_bb_reg(dm, R_0xf94, 0xffff); + ht_ok = odm_get_bb_reg(dm, R_0xf90, 0xffff); + + cck_err = odm_get_bb_reg(dm, R_0xf84, MASKDWORD); + ofdm_err = odm_get_bb_reg(dm, R_0xf94, 0xffff0000); + ht_err = odm_get_bb_reg(dm, R_0xf90, 0xffff0000); + } + + mp->rx_phy_ok_cnt = cck_ok + ofdm_ok + ht_ok + vht_ok; + mp->rx_phy_crc_err_cnt = cck_err + ofdm_err + ht_err + vht_err; + mp->io_value = (u32)mp->rx_phy_ok_cnt; +} +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_mp.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_mp.h new file mode 100644 index 000000000000..f4cbcd032d84 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_mp.h @@ -0,0 +1,87 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +#ifndef __PHYDM_MP_H__ +#define __PHYDM_MP_H__ + +#define MP_VERSION "1.3" + +/* @1 ============================================================ + * 1 Definition + * 1 ============================================================ + */ +/* @1 ============================================================ + * 1 structure + * 1 ============================================================ + */ +struct phydm_mp { + /* @Rx OK count, statistics used in Mass Production Test.*/ + u64 tx_phy_ok_cnt; + u64 rx_phy_ok_cnt; + /* @Rx CRC32 error count, statistics used in Mass Production Test.*/ + u64 rx_phy_crc_err_cnt; + /* @The Value of IO operation is depend of MptActType.*/ + u32 io_value; + u32 rf_reg0; + /* @u32 rfe_sel_a_0;*/ + /* @u32 rfe_sel_b_0;*/ + /* @u32 rfe_sel_c_0;*/ + /* @u32 rfe_sel_d_0;*/ + /* @u32 rfe_sel_a_1;*/ + /* @u32 rfe_sel_b_1;*/ + /* @u32 rfe_sel_c_1;*/ + /* @u32 rfe_sel_d_1;*/ +}; + +/* @1 ============================================================ + * 1 enumeration + * 1 ============================================================ + */ +enum TX_MODE_OFDM { + OFDM_OFF = 0, + OFDM_CONT_TX = 1, + OFDM_SINGLE_CARRIER = 2, + OFDM_SINGLE_TONE = 4, +}; +/* @1 ============================================================ + * 1 function prototype + * 1 ============================================================ + */ +void phydm_mp_set_crystal_cap(void *dm_void, u8 crystal_cap); + +void phydm_mp_set_single_tone(void *dm_void, boolean is_single_tone, u8 path); + +void phydm_mp_set_carrier_supp(void *dm_void, boolean is_carrier_supp, + u32 rate_index); + +void phydm_mp_set_single_carrier(void *dm_void, boolean is_single_carrier); + +void phydm_mp_reset_rx_counters_phy(void *dm_void); + +void phydm_mp_get_tx_ok(void *dm_void, u32 rate_index); + +void phydm_mp_get_rx_ok(void *dm_void); +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_noisemonitor.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_noisemonitor.c index 8501907abbd4..ddcab0c39969 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_noisemonitor.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_noisemonitor.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,24 +9,28 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ -/* ************************************************************ +/************************************************************* * 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 @@ -33,260 +38,421 @@ * 3. Stop updating idle time pwer report (for driver read) * - 0x80c[25] * - * ************************************************* */ + *************************************************/ -#define VALID_MIN -35 -#define VALID_MAX 10 -#define VALID_CNT 5 - -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_WIN)) - -s16 odm_inband_noise_monitor_n_series(struct PHY_DM_STRUCT *p_dm_odm, u8 is_pause_dig, u8 igi_value, u32 max_time) +void phydm_set_noise_data_sum(struct noise_level *noise_data, u8 max_rf_path) { - 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; + u8 i = 0; - func_start = odm_get_current_time(p_dm_odm); - p_dm_odm->noise_level.noise_all = 0; + for (i = RF_PATH_A; i < max_rf_path; i++) { + if (noise_data->valid_cnt[i]) + noise_data->sum[i] /= noise_data->valid_cnt[i]; + else + noise_data->sum[i] = 0; + } +} - if ((p_dm_odm->rf_type == ODM_1T2R) || (p_dm_odm->rf_type == ODM_2T2R)) +#if (ODM_IC_11N_SERIES_SUPPORT) +s16 odm_inband_noise_monitor_n(struct dm_struct *dm, u8 is_pause_dig, u8 igi, + u32 max_time) +{ + u32 tmp4b; + u8 max_rf_path = 0, i = 0; + u8 reg_c50, reg_c58, valid_done = 0; + struct noise_level noise_data; + u64 start = 0, func_start = 0, func_end = 0; + s8 val_s8 = 0; + + func_start = odm_get_current_time(dm); + dm->noise_level.noise_all = 0; + + if (dm->rf_type == RF_1T2R || dm->rf_type == RF_2T2R) max_rf_path = 2; else max_rf_path = 1; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("odm_DebugControlInbandNoise_Nseries() ==>\n")); + PHYDM_DBG(dm, DBG_ENV_MNTR, + "odm_DebugControlInbandNoise_Nseries() ==>\n"); - odm_memory_set(p_dm_odm, &noise_data, 0, sizeof(struct noise_level)); - - /* */ + odm_memory_set(dm, &noise_data, 0, sizeof(struct noise_level)); /* step 1. Disable DIG && Set initial gain. */ - /* */ if (is_pause_dig) - odm_pause_dig(p_dm_odm, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_1, igi_value); - /* */ - /* step 2. Disable all power save for read registers */ - /* */ - /* dcmd_DebugControlPowerSave(p_adapter, PSDisable); */ + odm_pause_dig(dm, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_1, igi); - /* */ /* step 3. Get noise power level */ - /* */ - start = odm_get_current_time(p_dm_odm); + start = odm_get_current_time(dm); while (1) { - /* Stop updating idle time pwer report (for driver read) */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_TX_GAIN_STAGE, BIT(25), 1); + odm_set_bb_reg(dm, REG_FPGA0_TX_GAIN_STAGE, BIT(25), 1); /* Read Noise Floor Report */ - tmp4b = odm_get_bb_reg(p_dm_odm, 0x8f8, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("Noise Floor Report (0x8f8) = 0x%08x\n", tmp4b)); - - /* odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XA_AGC_CORE1, MASKBYTE0, TestInitialGain); */ - /* if(max_rf_path == 2) */ - /* odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XB_AGC_CORE1, MASKBYTE0, TestInitialGain); */ + tmp4b = odm_get_bb_reg(dm, R_0x8f8, MASKDWORD); /* update idle time pwer report per 5us */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_TX_GAIN_STAGE, BIT(25), 0); + odm_set_bb_reg(dm, REG_FPGA0_TX_GAIN_STAGE, BIT(25), 0); - noise_data.value[ODM_RF_PATH_A] = (u8)(tmp4b & 0xff); - noise_data.value[ODM_RF_PATH_B] = (u8)((tmp4b & 0xff00) >> 8); + ODM_delay_us(5); - ODM_RT_TRACE(p_dm_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])); + noise_data.value[RF_PATH_A] = (u8)(tmp4b & 0xff); + noise_data.value[RF_PATH_B] = (u8)((tmp4b & 0xff00) >> 8); - for (rf_path = ODM_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 (i = RF_PATH_A; i < max_rf_path; i++) { + noise_data.sval[i] = (s8)noise_data.value[i]; + noise_data.sval[i] /= 2; } + for (i = RF_PATH_A; i < max_rf_path; i++) { + if (noise_data.valid_cnt[i] >= VALID_CNT) + continue; - ODM_RT_TRACE(p_dm_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] < VALID_CNT) && (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(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("rf_path:%d Valid sval = %d\n", rf_path, noise_data.sval[rf_path])); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("Sum of sval = %d,\n", noise_data.sum[rf_path])); - if (noise_data.valid_cnt[rf_path] == VALID_CNT) { - valid_done++; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("After divided, rf_path:%d,sum = %d\n", rf_path, noise_data.sum[rf_path])); - } - - } - + noise_data.valid_cnt[i]++; + noise_data.sum[i] += noise_data.sval[i]; + PHYDM_DBG(dm, DBG_ENV_MNTR, + "rf_path:%d Valid sval=%d\n", i, + noise_data.sval[i]); + PHYDM_DBG(dm, DBG_ENV_MNTR, "Sum of sval = %d,\n", + noise_data.sum[i]); + if (noise_data.valid_cnt[i] == VALID_CNT) + valid_done++; } - - /* printk("####### valid_done:%d #############\n",valid_done); */ - if ((valid_done == max_rf_path) || (odm_get_progressing_time(p_dm_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; - } + if (valid_done == max_rf_path || + (odm_get_progressing_time(dm, start) > max_time)) { + phydm_set_noise_data_sum(&noise_data, max_rf_path); break; } } - reg_c50 = (u8)odm_get_bb_reg(p_dm_odm, REG_OFDM_0_XA_AGC_CORE1, MASKBYTE0); + reg_c50 = (u8)odm_get_bb_reg(dm, REG_OFDM_0_XA_AGC_CORE1, MASKBYTE0); reg_c50 &= ~BIT(7); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("0x%x = 0x%02x(%d)\n", REG_OFDM_0_XA_AGC_CORE1, reg_c50, reg_c50)); - p_dm_odm->noise_level.noise[ODM_RF_PATH_A] = (u8)(-110 + reg_c50 + noise_data.sum[ODM_RF_PATH_A]); - p_dm_odm->noise_level.noise_all += p_dm_odm->noise_level.noise[ODM_RF_PATH_A]; + val_s8 = (s8)(-110 + reg_c50 + noise_data.sum[RF_PATH_A]); + dm->noise_level.noise[RF_PATH_A] = val_s8; + dm->noise_level.noise_all += dm->noise_level.noise[RF_PATH_A]; if (max_rf_path == 2) { - reg_c58 = (u8)odm_get_bb_reg(p_dm_odm, REG_OFDM_0_XB_AGC_CORE1, MASKBYTE0); + reg_c58 = (u8)odm_get_bb_reg(dm, R_0xc58, MASKBYTE0); reg_c58 &= ~BIT(7); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("0x%x = 0x%02x(%d)\n", REG_OFDM_0_XB_AGC_CORE1, reg_c58, reg_c58)); - p_dm_odm->noise_level.noise[ODM_RF_PATH_B] = (u8)(-110 + reg_c58 + noise_data.sum[ODM_RF_PATH_B]); - p_dm_odm->noise_level.noise_all += p_dm_odm->noise_level.noise[ODM_RF_PATH_B]; + val_s8 = (s8)(-110 + reg_c58 + noise_data.sum[RF_PATH_B]); + dm->noise_level.noise[RF_PATH_B] = val_s8; + dm->noise_level.noise_all += dm->noise_level.noise[RF_PATH_B]; } - p_dm_odm->noise_level.noise_all /= max_rf_path; + dm->noise_level.noise_all /= max_rf_path; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("noise_a = %d, noise_b = %d\n", - p_dm_odm->noise_level.noise[ODM_RF_PATH_A], - p_dm_odm->noise_level.noise[ODM_RF_PATH_B])); + PHYDM_DBG(dm, DBG_ENV_MNTR, + "noise_a = %d, noise_b = %d, noise_all = %d\n", + dm->noise_level.noise[RF_PATH_A], + dm->noise_level.noise[RF_PATH_B], dm->noise_level.noise_all); - /* */ /* step 4. Recover the Dig */ - /* */ if (is_pause_dig) - odm_pause_dig(p_dm_odm, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_1, igi_value); - func_end = odm_get_progressing_time(p_dm_odm, func_start) ; + odm_pause_dig(dm, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_1, igi); + func_end = odm_get_progressing_time(dm, func_start); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("odm_DebugControlInbandNoise_Nseries() <==\n")); - return p_dm_odm->noise_level.noise_all; + PHYDM_DBG(dm, DBG_ENV_MNTR, "end\n"); + return dm->noise_level.noise_all; +} +#endif +#if (ODM_IC_11AC_SERIES_SUPPORT) +s16 phydm_idle_noise_measure_ac(struct dm_struct *dm, u8 pause_dig, + u8 igi, u32 max_time) +{ + u32 tmp4b; + u8 max_rf_path = 0, i = 0; + u8 reg_c50, reg_e50, valid_done = 0; + u64 start = 0, func_start = 0, func_end = 0; + struct noise_level noise_data; + s8 val_s8 = 0; + + func_start = odm_get_current_time(dm); + dm->noise_level.noise_all = 0; + + if (dm->rf_type == RF_1T2R || dm->rf_type == RF_2T2R) + max_rf_path = 2; + else + max_rf_path = 1; + + PHYDM_DBG(dm, DBG_ENV_MNTR, "%s==>\n", __func__); + + odm_memory_set(dm, &noise_data, 0, sizeof(struct noise_level)); + + /*Step 1. Disable DIG && Set initial gain.*/ + + if (pause_dig) + odm_pause_dig(dm, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_1, igi); + + /*Step 2. Get noise power level*/ + start = odm_get_current_time(dm); + + while (1) { + /*Stop updating idle time pwer report (for driver read)*/ + odm_set_bb_reg(dm, R_0x9e4, BIT(30), 0x1); + + /*Read Noise Floor Report*/ + tmp4b = odm_get_bb_reg(dm, R_0xff0, MASKDWORD); + + /*update idle time pwer report per 5us*/ + odm_set_bb_reg(dm, R_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 (i = RF_PATH_A; i < max_rf_path; i++) { + noise_data.sval[i] = (s8)noise_data.value[i]; + noise_data.sval[i] = noise_data.sval[i] >> 1; + } + + for (i = RF_PATH_A; i < max_rf_path; i++) { + if (noise_data.valid_cnt[i] >= VALID_CNT) + continue; + + noise_data.valid_cnt[i]++; + noise_data.sum[i] += noise_data.sval[i]; + PHYDM_DBG(dm, DBG_ENV_MNTR, "Path:%d Valid sval = %d\n", + i, noise_data.sval[i]); + PHYDM_DBG(dm, DBG_ENV_MNTR, "Sum of sval = %d\n", + noise_data.sum[i]); + if (noise_data.valid_cnt[i] == VALID_CNT) + valid_done++; + } + + if (valid_done == max_rf_path || + (odm_get_progressing_time(dm, start) > max_time)) { + phydm_set_noise_data_sum(&noise_data, max_rf_path); + break; + } + } + reg_c50 = (u8)odm_get_bb_reg(dm, R_0xc50, MASKBYTE0); + reg_c50 &= ~BIT(7); + val_s8 = (s8)(-110 + reg_c50 + noise_data.sum[RF_PATH_A]); + dm->noise_level.noise[RF_PATH_A] = val_s8; + dm->noise_level.noise_all += dm->noise_level.noise[RF_PATH_A]; + + if (max_rf_path == 2) { + reg_e50 = (u8)odm_get_bb_reg(dm, R_0xe50, MASKBYTE0); + reg_e50 &= ~BIT(7); + val_s8 = (s8)(-110 + reg_e50 + noise_data.sum[RF_PATH_B]); + dm->noise_level.noise[RF_PATH_B] = val_s8; + dm->noise_level.noise_all += dm->noise_level.noise[RF_PATH_B]; + } + dm->noise_level.noise_all /= max_rf_path; + + PHYDM_DBG(dm, DBG_ENV_MNTR, + "noise_a = %d, noise_b = %d, noise_all = %d\n", + dm->noise_level.noise[RF_PATH_A], + dm->noise_level.noise[RF_PATH_B], dm->noise_level.noise_all); + + /*Step 3. Recover the Dig*/ + if (pause_dig) + odm_pause_dig(dm, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_1, igi); + func_end = odm_get_progressing_time(dm, func_start); + + PHYDM_DBG(dm, DBG_ENV_MNTR, "end\n"); + return dm->noise_level.noise_all; } -s16 -odm_inband_noise_monitor_ac_series(struct PHY_DM_STRUCT *p_dm_odm, u8 is_pause_dig, u8 igi_value, u32 max_time - ) +s16 odm_inband_noise_monitor_ac(struct dm_struct *dm, u8 pause_dig, u8 igi, + u32 max_time) { - s32 rxi_buf_anta, rxq_buf_anta; /*rxi_buf_antb, rxq_buf_antb;*/ - s32 value32, pwdb_A = 0, sval, noise, sum; - bool pd_flag; - u8 i, valid_cnt; - u64 start = 0, func_start = 0, func_end = 0; + 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; + s32 val_s32 = 0; + s16 rpt = 0; + u8 val_u8 = 0; + if (dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8821C)) { + rpt = phydm_idle_noise_measure_ac(dm, pause_dig, igi, max_time); + return rpt; + } - if (!(p_dm_odm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8814A))) + if (!(dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8814A))) return 0; - func_start = odm_get_current_time(p_dm_odm); - p_dm_odm->noise_level.noise_all = 0; + func_start = odm_get_current_time(dm); + dm->noise_level.noise_all = 0; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("odm_inband_noise_monitor_ac_series() ==>\n")); + PHYDM_DBG(dm, DBG_ENV_MNTR, "%s ==>\n", __func__); /* step 1. Disable DIG && Set initial gain. */ - if (is_pause_dig) - odm_pause_dig(p_dm_odm, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_1, igi_value); - - /* step 2. Disable all power save for read registers */ - /*dcmd_DebugControlPowerSave(p_adapter, PSDisable); */ + if (pause_dig) + odm_pause_dig(dm, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_1, igi); /* step 3. Get noise power level */ - start = odm_get_current_time(p_dm_odm); - - /* reset counters */ - sum = 0; - valid_cnt = 0; + start = odm_get_current_time(dm); /* step 3. Get noise power level */ while (1) { /*Set IGI=0x1C */ - odm_write_dig(p_dm_odm, 0x1C); + odm_write_dig(dm, 0x1C); /*stop CK320&CK88 */ - odm_set_bb_reg(p_dm_odm, 0x8B4, BIT(6), 1); + odm_set_bb_reg(dm, R_0x8b4, BIT(6), 1); /*Read path-A */ - odm_set_bb_reg(p_dm_odm, 0x8FC, MASKDWORD, 0x200); /*set debug port*/ - value32 = odm_get_bb_reg(p_dm_odm, 0xFA0, MASKDWORD); /*read debug port*/ - - rxi_buf_anta = (value32 & 0xFFC00) >> 10; /*rxi_buf_anta=RegFA0[19:10]*/ + /*set debug port*/ + odm_set_bb_reg(dm, R_0x8fc, MASKDWORD, 0x200); + /*read debug port*/ + value32 = odm_get_bb_reg(dm, R_0xfa0, MASKDWORD); + /*rxi_buf_anta=RegFA0[19:10]*/ + rxi_buf_anta = (value32 & 0xFFC00) >> 10; rxq_buf_anta = value32 & 0x3FF; /*rxq_buf_anta=RegFA0[19:10]*/ - pd_flag = (bool)((value32 & BIT(31)) >> 31); + pd_flag = (boolean)((value32 & BIT(31)) >> 31); /*Not in packet detection period or Tx state */ - if ((!pd_flag) || (rxi_buf_anta != 0x200)) { + 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)*/ + val_s32 = rxi_buf_anta * rxi_buf_anta + + rxq_buf_anta * rxq_buf_anta; + /*S(10,9)*S(10,9)=S(20,18)*/ + pwdb_A = odm_pwdb_conversion(val_s32, 20, 18); - ODM_RT_TRACE(p_dm_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)); + PHYDM_DBG(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_odm, 0x8B4, BIT(6), 0); - /*BB Reset*/ - odm_write_1byte(p_dm_odm, 0x02, odm_read_1byte(p_dm_odm, 0x02) & (~BIT(0))); - odm_write_1byte(p_dm_odm, 0x02, odm_read_1byte(p_dm_odm, 0x02) | BIT(0)); + odm_set_bb_reg(dm, R_0x8b4, BIT(6), 0); + /*@BB Reset*/ + val_u8 = odm_read_1byte(dm, 0x02) & (~BIT(0)); + odm_write_1byte(dm, 0x02, val_u8); + val_u8 = odm_read_1byte(dm, 0x02) | BIT(0); + odm_write_1byte(dm, 0x02, val_u8); /*PMAC Reset*/ - odm_write_1byte(p_dm_odm, 0xB03, odm_read_1byte(p_dm_odm, 0xB03) & (~BIT(0))); - odm_write_1byte(p_dm_odm, 0xB03, odm_read_1byte(p_dm_odm, 0xB03) | BIT(0)); - /*CCK Reset*/ - if (odm_read_1byte(p_dm_odm, 0x80B) & BIT(4)) { - odm_write_1byte(p_dm_odm, 0x80B, odm_read_1byte(p_dm_odm, 0x80B) & (~BIT(4))); - odm_write_1byte(p_dm_odm, 0x80B, odm_read_1byte(p_dm_odm, 0x80B) | BIT(4)); + val_u8 = odm_read_1byte(dm, 0xB03) & (~BIT(0)); + odm_write_1byte(dm, 0xB03, val_u8); + val_u8 = odm_read_1byte(dm, 0xB03) | BIT(0); + odm_write_1byte(dm, 0xB03, val_u8); + /*@CCK Reset*/ + if (odm_read_1byte(dm, 0x80B) & BIT(4)) { + val_u8 = odm_read_1byte(dm, 0x80B) & (~BIT(4)); + odm_write_1byte(dm, 0x80B, val_u8); + val_u8 = odm_read_1byte(dm, 0x80B) | BIT(4); + odm_write_1byte(dm, 0x80B, val_u8); } sval = pwdb_A; - if (sval < 0 && sval >= -27) { - if (valid_cnt < VALID_CNT) { - valid_cnt++; - sum += sval; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("Valid sval = %d\n", sval)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("Sum of sval = %d,\n", sum)); - if ((valid_cnt >= VALID_CNT) || (odm_get_progressing_time(p_dm_odm, start) > max_time)) { - sum /= VALID_CNT; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("After divided, sum = %d\n", sum)); - break; - } + if ((sval < 0 && sval >= -27) && valid_cnt < VALID_CNT) { + valid_cnt++; + sum += sval; + PHYDM_DBG(dm, DBG_ENV_MNTR, "Valid sval = %d\n", sval); + PHYDM_DBG(dm, DBG_ENV_MNTR, "Sum of sval = %d,\n", sum); + if (valid_cnt >= VALID_CNT || + (odm_get_progressing_time(dm, start) > max_time)) { + sum /= VALID_CNT; + PHYDM_DBG(dm, DBG_ENV_MNTR, + "After divided, sum = %d\n", sum); + break; } } } - /*ADC backoff is 12dB,*/ + /*@ADC backoff is 12dB,*/ /*Ptarget=0x1C-110=-82dBm*/ noise = sum + 12 + 0x1C - 110; /*Offset*/ noise = noise - 3; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("noise = %d\n", noise)); - p_dm_odm->noise_level.noise_all = (s16)noise; + PHYDM_DBG(dm, DBG_ENV_MNTR, "noise = %d\n", noise); + dm->noise_level.noise_all = (s16)noise; /* step 4. Recover the Dig*/ - if (is_pause_dig) - odm_pause_dig(p_dm_odm, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_1, igi_value); + if (pause_dig) + odm_pause_dig(dm, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_1, igi); - func_end = odm_get_progressing_time(p_dm_odm, func_start); + func_end = odm_get_progressing_time(dm, func_start); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("odm_inband_noise_monitor_ac_series() <==\n")); + PHYDM_DBG(dm, DBG_ENV_MNTR, "%s <==\n", __func__); - return p_dm_odm->noise_level.noise_all; + return 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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - if (p_dm_odm->support_ic_type & ODM_IC_11AC_SERIES) - return odm_inband_noise_monitor_ac_series(p_dm_odm, is_pause_dig, igi_value, max_time); - else - return odm_inband_noise_monitor_n_series(p_dm_odm, is_pause_dig, igi_value, max_time); -} - #endif + +s16 odm_inband_noise_monitor(void *dm_void, u8 pause_dig, u8 igi, + u32 max_time) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + s16 val = 0; + + igi = 0x32; + + /* since HW ability is about +15~-35, + * we fix IGI = -60 for maximum coverage + */ + #if (ODM_IC_11AC_SERIES_SUPPORT) + if (dm->support_ic_type & ODM_IC_11AC_SERIES) + val = odm_inband_noise_monitor_ac(dm, pause_dig, igi, max_time); + #endif + + #if (ODM_IC_11N_SERIES_SUPPORT) + if (dm->support_ic_type & ODM_IC_11N_SERIES) + val = odm_inband_noise_monitor_n(dm, pause_dig, igi, max_time); + #endif + + return val; +} + +void phydm_noisy_detection(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 total_fa_cnt, total_cca_cnt; + u32 score = 0, i, score_smooth; + + total_cca_cnt = dm->false_alm_cnt.cnt_cca_all; + total_fa_cnt = 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; */ + dm->noisy_decision_smooth = (dm->noisy_decision_smooth >> 1) + + (score << 2); + + /* Round the noisy_decision_smooth: +"3" comes from (2^3)/2-1 */ + if (total_cca_cnt >= 300) + score_smooth = (dm->noisy_decision_smooth + 3) >> 3; + else + score_smooth = 0; + + dm->noisy_decision = (score_smooth >= 3) ? 1 : 0; + + PHYDM_DBG(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, dm->noisy_decision_smooth, score, + score_smooth, dm->noisy_decision); +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_noisemonitor.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_noisemonitor.h index 3dbf1e87ccf7..b73b6e4b4781 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_noisemonitor.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_noisemonitor.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,40 +9,41 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger * *****************************************************************************/ -#ifndef __ODMNOISEMONITOR_H__ +#ifndef __ODMNOISEMONITOR_H__ #define __ODMNOISEMONITOR_H__ -#define ODM_MAX_CHANNEL_NUM 38/* 14+24 */ +#define VALID_CNT 5 + struct noise_level { - /* u8 value_a, value_b; */ - u8 value[MAX_RF_PATH]; - /* s8 sval_a, sval_b; */ - s8 sval[MAX_RF_PATH]; - - /* s32 noise_a=0, noise_b=0,sum_a=0, sum_b=0; */ - /* s32 noise[ODM_RF_PATH_MAX]; */ - s32 sum[MAX_RF_PATH]; - /* u8 valid_cnt_a=0, valid_cnt_b=0, */ - u8 valid[MAX_RF_PATH]; - u8 valid_cnt[MAX_RF_PATH]; - + 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[MAX_RF_PATH]; - s16 noise_all; +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); +s16 odm_inband_noise_monitor(void *dm_void, u8 is_pause_dig, u8 igi_value, + u32 max_time); + +void phydm_noisy_detection(void *dm_void); #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_pathdiv.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_pathdiv.c index aec5bbd74c3c..cd3e9fda55f0 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_pathdiv.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_pathdiv.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,689 +9,1084 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ -/* ************************************************************ +/************************************************************* * include files - * ************************************************************ */ + ************************************************************/ #include "mp_precomp.h" #include "phydm_precomp.h" -#if (defined(CONFIG_PATH_DIVERSITY)) +#ifdef CONFIG_PATH_DIVERSITY #if RTL8814A_SUPPORT - -void -phydm_dtp_fix_tx_path( - void *p_dm_void, - u8 path -) +void phydm_dtp_fix_tx_path( + void *dm_void, + u8 path) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ODM_PATH_DIVERSITY_ *p_dm_path_div = &p_dm_odm->dm_path_div; - u8 i, num_enable_path = 0; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; + u8 i, num_enable_path = 0; - if (path == p_dm_path_div->pre_tx_path) + if (path == p_div->pre_tx_path) return; else - p_dm_path_div->pre_tx_path = path; + p_div->pre_tx_path = path; - odm_set_bb_reg(p_dm_odm, 0x93c, BIT(18) | BIT(19), 3); + odm_set_bb_reg(dm, R_0x93c, BIT(18) | BIT(19), 3); for (i = 0; i < 4; i++) { if (path & BIT(i)) num_enable_path++; } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" number of trun-on path : (( %d ))\n", num_enable_path)); + PHYDM_DBG(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_odm, 0x93c, 0xf00000, path); + odm_set_bb_reg(dm, R_0x93c, 0xf00000, path); - if (path == PHYDM_A) { /* 1-1 */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A ))\n")); - odm_set_bb_reg(p_dm_odm, 0x93c, BIT(25) | BIT(24), 0); - } else if (path == PHYDM_B) { /* 1-2 */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( B ))\n")); - odm_set_bb_reg(p_dm_odm, 0x93c, BIT(27) | BIT(26), 0); - } else if (path == PHYDM_C) { /* 1-3 */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( C ))\n")); - odm_set_bb_reg(p_dm_odm, 0x93c, BIT(29) | BIT(28), 0); + if (path == BB_PATH_A) { /* @1-1 */ + PHYDM_DBG(dm, DBG_PATH_DIV, " Turn on path (( A ))\n"); + odm_set_bb_reg(dm, R_0x93c, BIT(25) | BIT(24), 0); + } else if (path == BB_PATH_B) { /* @1-2 */ + PHYDM_DBG(dm, DBG_PATH_DIV, " Turn on path (( B ))\n"); + odm_set_bb_reg(dm, R_0x93c, BIT(27) | BIT(26), 0); + } else if (path == BB_PATH_C) { /* @1-3 */ + PHYDM_DBG(dm, DBG_PATH_DIV, " Turn on path (( C ))\n"); + odm_set_bb_reg(dm, R_0x93c, BIT(29) | BIT(28), 0); - } else if (path == PHYDM_D) { /* 1-4 */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( D ))\n")); - odm_set_bb_reg(p_dm_odm, 0x93c, BIT(31) | BIT(30), 0); + } else if (path == BB_PATH_D) { /* @1-4 */ + PHYDM_DBG(dm, DBG_PATH_DIV, " Turn on path (( D ))\n"); + odm_set_bb_reg(dm, R_0x93c, BIT(31) | BIT(30), 0); } - } else if (num_enable_path == 2) { - odm_set_bb_reg(p_dm_odm, 0x93c, 0xf00000, path); - odm_set_bb_reg(p_dm_odm, 0x940, 0xf0, path); + } else if (num_enable_path == 2) { + odm_set_bb_reg(dm, R_0x93c, 0xf00000, path); + odm_set_bb_reg(dm, R_0x940, 0xf0, path); - if (path == PHYDM_AB) { /* 2-1 */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A B ))\n")); + if (path == (BB_PATH_AB)) { /* @2-1 */ + PHYDM_DBG(dm, DBG_PATH_DIV, + " Turn on path (( A B ))\n"); /* set for 1ss */ - odm_set_bb_reg(p_dm_odm, 0x93c, BIT(25) | BIT(24), 0); - odm_set_bb_reg(p_dm_odm, 0x93c, BIT(27) | BIT(26), 1); + odm_set_bb_reg(dm, R_0x93c, BIT(25) | BIT(24), 0); + odm_set_bb_reg(dm, R_0x93c, BIT(27) | BIT(26), 1); /* set for 2ss */ - odm_set_bb_reg(p_dm_odm, 0x940, BIT(9) | BIT(8), 0); - odm_set_bb_reg(p_dm_odm, 0x940, BIT(11) | BIT(10), 1); - } else if (path == PHYDM_AC) { /* 2-2 */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A C ))\n")); + odm_set_bb_reg(dm, R_0x940, BIT(9) | BIT(8), 0); + odm_set_bb_reg(dm, R_0x940, BIT(11) | BIT(10), 1); + } else if (path == BB_PATH_AC) { /* @2-2 */ + PHYDM_DBG(dm, DBG_PATH_DIV, + " Turn on path (( A C ))\n"); /* set for 1ss */ - odm_set_bb_reg(p_dm_odm, 0x93c, BIT(25) | BIT(24), 0); - odm_set_bb_reg(p_dm_odm, 0x93c, BIT(29) | BIT(28), 1); + odm_set_bb_reg(dm, R_0x93c, BIT(25) | BIT(24), 0); + odm_set_bb_reg(dm, R_0x93c, BIT(29) | BIT(28), 1); /* set for 2ss */ - odm_set_bb_reg(p_dm_odm, 0x940, BIT(9) | BIT(8), 0); - odm_set_bb_reg(p_dm_odm, 0x940, BIT(13) | BIT(12), 1); - } else if (path == PHYDM_AD) { /* 2-3 */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A D ))\n")); + odm_set_bb_reg(dm, R_0x940, BIT(9) | BIT(8), 0); + odm_set_bb_reg(dm, R_0x940, BIT(13) | BIT(12), 1); + } else if (path == BB_PATH_AD) { /* @2-3 */ + PHYDM_DBG(dm, DBG_PATH_DIV, + " Turn on path (( A D ))\n"); /* set for 1ss */ - odm_set_bb_reg(p_dm_odm, 0x93c, BIT(25) | BIT(24), 0); - odm_set_bb_reg(p_dm_odm, 0x93c, BIT(31) | BIT(30), 1); + odm_set_bb_reg(dm, R_0x93c, BIT(25) | BIT(24), 0); + odm_set_bb_reg(dm, R_0x93c, BIT(31) | BIT(30), 1); /* set for 2ss */ - odm_set_bb_reg(p_dm_odm, 0x940, BIT(9) | BIT(8), 0); - odm_set_bb_reg(p_dm_odm, 0x940, BIT(15) | BIT(14), 1); - } else if (path == PHYDM_BC) { /* 2-4 */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( B C ))\n")); + odm_set_bb_reg(dm, R_0x940, BIT(9) | BIT(8), 0); + odm_set_bb_reg(dm, R_0x940, BIT(15) | BIT(14), 1); + } else if (path == BB_PATH_BC) { /* @2-4 */ + PHYDM_DBG(dm, DBG_PATH_DIV, + " Turn on path (( B C ))\n"); /* set for 1ss */ - odm_set_bb_reg(p_dm_odm, 0x93c, BIT(27) | BIT(26), 0); - odm_set_bb_reg(p_dm_odm, 0x93c, BIT(29) | BIT(28), 1); + odm_set_bb_reg(dm, R_0x93c, BIT(27) | BIT(26), 0); + odm_set_bb_reg(dm, R_0x93c, BIT(29) | BIT(28), 1); /* set for 2ss */ - odm_set_bb_reg(p_dm_odm, 0x940, BIT(11) | BIT(10), 0); - odm_set_bb_reg(p_dm_odm, 0x940, BIT(13) | BIT(12), 1); - } else if (path == PHYDM_BD) { /* 2-5 */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( B D ))\n")); + odm_set_bb_reg(dm, R_0x940, BIT(11) | BIT(10), 0); + odm_set_bb_reg(dm, R_0x940, BIT(13) | BIT(12), 1); + } else if (path == BB_PATH_BD) { /* @2-5 */ + PHYDM_DBG(dm, DBG_PATH_DIV, + " Turn on path (( B D ))\n"); /* set for 1ss */ - odm_set_bb_reg(p_dm_odm, 0x93c, BIT(27) | BIT(26), 0); - odm_set_bb_reg(p_dm_odm, 0x93c, BIT(31) | BIT(30), 1); + odm_set_bb_reg(dm, R_0x93c, BIT(27) | BIT(26), 0); + odm_set_bb_reg(dm, R_0x93c, BIT(31) | BIT(30), 1); /* set for 2ss */ - odm_set_bb_reg(p_dm_odm, 0x940, BIT(11) | BIT(10), 0); - odm_set_bb_reg(p_dm_odm, 0x940, BIT(15) | BIT(14), 1); - } else if (path == PHYDM_CD) { /* 2-6 */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( C D ))\n")); + odm_set_bb_reg(dm, R_0x940, BIT(11) | BIT(10), 0); + odm_set_bb_reg(dm, R_0x940, BIT(15) | BIT(14), 1); + } else if (path == BB_PATH_CD) { /* @2-6 */ + PHYDM_DBG(dm, DBG_PATH_DIV, + " Turn on path (( C D ))\n"); /* set for 1ss */ - odm_set_bb_reg(p_dm_odm, 0x93c, BIT(29) | BIT(28), 0); - odm_set_bb_reg(p_dm_odm, 0x93c, BIT(31) | BIT(30), 1); + odm_set_bb_reg(dm, R_0x93c, BIT(29) | BIT(28), 0); + odm_set_bb_reg(dm, R_0x93c, BIT(31) | BIT(30), 1); /* set for 2ss */ - odm_set_bb_reg(p_dm_odm, 0x940, BIT(13) | BIT(12), 0); - odm_set_bb_reg(p_dm_odm, 0x940, BIT(15) | BIT(14), 1); + odm_set_bb_reg(dm, R_0x940, BIT(13) | BIT(12), 0); + odm_set_bb_reg(dm, R_0x940, BIT(15) | BIT(14), 1); } - } else if (num_enable_path == 3) { - odm_set_bb_reg(p_dm_odm, 0x93c, 0xf00000, path); - odm_set_bb_reg(p_dm_odm, 0x940, 0xf0, path); - odm_set_bb_reg(p_dm_odm, 0x940, 0xf0000, path); + } else if (num_enable_path == 3) { + odm_set_bb_reg(dm, R_0x93c, 0xf00000, path); + odm_set_bb_reg(dm, R_0x940, 0xf0, path); + odm_set_bb_reg(dm, R_0x940, 0xf0000, path); - if (path == PHYDM_ABC) { /* 3-1 */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A B C))\n")); + if (path == BB_PATH_ABC) { /* @3-1 */ + PHYDM_DBG(dm, DBG_PATH_DIV, + " Turn on path (( A B C))\n"); /* set for 1ss */ - odm_set_bb_reg(p_dm_odm, 0x93c, BIT(25) | BIT(24), 0); - odm_set_bb_reg(p_dm_odm, 0x93c, BIT(27) | BIT(26), 1); - odm_set_bb_reg(p_dm_odm, 0x93c, BIT(29) | BIT(28), 2); + odm_set_bb_reg(dm, R_0x93c, BIT(25) | BIT(24), 0); + odm_set_bb_reg(dm, R_0x93c, BIT(27) | BIT(26), 1); + odm_set_bb_reg(dm, R_0x93c, BIT(29) | BIT(28), 2); /* set for 2ss */ - odm_set_bb_reg(p_dm_odm, 0x940, BIT(9) | BIT(8), 0); - odm_set_bb_reg(p_dm_odm, 0x940, BIT(11) | BIT(10), 1); - odm_set_bb_reg(p_dm_odm, 0x940, BIT(13) | BIT(12), 2); + odm_set_bb_reg(dm, R_0x940, BIT(9) | BIT(8), 0); + odm_set_bb_reg(dm, R_0x940, BIT(11) | BIT(10), 1); + odm_set_bb_reg(dm, R_0x940, BIT(13) | BIT(12), 2); /* set for 3ss */ - odm_set_bb_reg(p_dm_odm, 0x940, BIT(21) | BIT(20), 0); - odm_set_bb_reg(p_dm_odm, 0x940, BIT(23) | BIT(22), 1); - odm_set_bb_reg(p_dm_odm, 0x940, BIT(25) | BIT(24), 2); - } else if (path == PHYDM_ABD) { /* 3-2 */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A B D ))\n")); + odm_set_bb_reg(dm, R_0x940, BIT(21) | BIT(20), 0); + odm_set_bb_reg(dm, R_0x940, BIT(23) | BIT(22), 1); + odm_set_bb_reg(dm, R_0x940, BIT(25) | BIT(24), 2); + } else if (path == BB_PATH_ABD) { /* @3-2 */ + PHYDM_DBG(dm, DBG_PATH_DIV, + " Turn on path (( A B D ))\n"); /* set for 1ss */ - odm_set_bb_reg(p_dm_odm, 0x93c, BIT(25) | BIT(24), 0); - odm_set_bb_reg(p_dm_odm, 0x93c, BIT(27) | BIT(26), 1); - odm_set_bb_reg(p_dm_odm, 0x93c, BIT(31) | BIT(30), 2); + odm_set_bb_reg(dm, R_0x93c, BIT(25) | BIT(24), 0); + odm_set_bb_reg(dm, R_0x93c, BIT(27) | BIT(26), 1); + odm_set_bb_reg(dm, R_0x93c, BIT(31) | BIT(30), 2); /* set for 2ss */ - odm_set_bb_reg(p_dm_odm, 0x940, BIT(9) | BIT(8), 0); - odm_set_bb_reg(p_dm_odm, 0x940, BIT(11) | BIT(10), 1); - odm_set_bb_reg(p_dm_odm, 0x940, BIT(15) | BIT(14), 2); + odm_set_bb_reg(dm, R_0x940, BIT(9) | BIT(8), 0); + odm_set_bb_reg(dm, R_0x940, BIT(11) | BIT(10), 1); + odm_set_bb_reg(dm, R_0x940, BIT(15) | BIT(14), 2); /* set for 3ss */ - odm_set_bb_reg(p_dm_odm, 0x940, BIT(21) | BIT(20), 0); - odm_set_bb_reg(p_dm_odm, 0x940, BIT(23) | BIT(22), 1); - odm_set_bb_reg(p_dm_odm, 0x940, BIT(27) | BIT(26), 2); + odm_set_bb_reg(dm, R_0x940, BIT(21) | BIT(20), 0); + odm_set_bb_reg(dm, R_0x940, BIT(23) | BIT(22), 1); + odm_set_bb_reg(dm, R_0x940, BIT(27) | BIT(26), 2); - } else if (path == PHYDM_ACD) { /* 3-3 */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A C D ))\n")); + } else if (path == BB_PATH_ACD) { /* @3-3 */ + PHYDM_DBG(dm, DBG_PATH_DIV, + " Turn on path (( A C D ))\n"); /* set for 1ss */ - odm_set_bb_reg(p_dm_odm, 0x93c, BIT(25) | BIT(24), 0); - odm_set_bb_reg(p_dm_odm, 0x93c, BIT(29) | BIT(28), 1); - odm_set_bb_reg(p_dm_odm, 0x93c, BIT(31) | BIT(30), 2); + odm_set_bb_reg(dm, R_0x93c, BIT(25) | BIT(24), 0); + odm_set_bb_reg(dm, R_0x93c, BIT(29) | BIT(28), 1); + odm_set_bb_reg(dm, R_0x93c, BIT(31) | BIT(30), 2); /* set for 2ss */ - odm_set_bb_reg(p_dm_odm, 0x940, BIT(9) | BIT(8), 0); - odm_set_bb_reg(p_dm_odm, 0x940, BIT(13) | BIT(12), 1); - odm_set_bb_reg(p_dm_odm, 0x940, BIT(15) | BIT(14), 2); + odm_set_bb_reg(dm, R_0x940, BIT(9) | BIT(8), 0); + odm_set_bb_reg(dm, R_0x940, BIT(13) | BIT(12), 1); + odm_set_bb_reg(dm, R_0x940, BIT(15) | BIT(14), 2); /* set for 3ss */ - odm_set_bb_reg(p_dm_odm, 0x940, BIT(21) | BIT(20), 0); - odm_set_bb_reg(p_dm_odm, 0x940, BIT(25) | BIT(24), 1); - odm_set_bb_reg(p_dm_odm, 0x940, BIT(27) | BIT(26), 2); - } else if (path == PHYDM_BCD) { /* 3-4 */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( B C D))\n")); + odm_set_bb_reg(dm, R_0x940, BIT(21) | BIT(20), 0); + odm_set_bb_reg(dm, R_0x940, BIT(25) | BIT(24), 1); + odm_set_bb_reg(dm, R_0x940, BIT(27) | BIT(26), 2); + } else if (path == BB_PATH_BCD) { /* @3-4 */ + PHYDM_DBG(dm, DBG_PATH_DIV, + " Turn on path (( B C D))\n"); /* set for 1ss */ - odm_set_bb_reg(p_dm_odm, 0x93c, BIT(27) | BIT(26), 0); - odm_set_bb_reg(p_dm_odm, 0x93c, BIT(29) | BIT(28), 1); - odm_set_bb_reg(p_dm_odm, 0x93c, BIT(31) | BIT(30), 2); + odm_set_bb_reg(dm, R_0x93c, BIT(27) | BIT(26), 0); + odm_set_bb_reg(dm, R_0x93c, BIT(29) | BIT(28), 1); + odm_set_bb_reg(dm, R_0x93c, BIT(31) | BIT(30), 2); /* set for 2ss */ - odm_set_bb_reg(p_dm_odm, 0x940, BIT(11) | BIT(10), 0); - odm_set_bb_reg(p_dm_odm, 0x940, BIT(13) | BIT(12), 1); - odm_set_bb_reg(p_dm_odm, 0x940, BIT(15) | BIT(14), 2); + odm_set_bb_reg(dm, R_0x940, BIT(11) | BIT(10), 0); + odm_set_bb_reg(dm, R_0x940, BIT(13) | BIT(12), 1); + odm_set_bb_reg(dm, R_0x940, BIT(15) | BIT(14), 2); /* set for 3ss */ - odm_set_bb_reg(p_dm_odm, 0x940, BIT(23) | BIT(22), 0); - odm_set_bb_reg(p_dm_odm, 0x940, BIT(25) | BIT(24), 1); - odm_set_bb_reg(p_dm_odm, 0x940, BIT(27) | BIT(26), 2); + odm_set_bb_reg(dm, R_0x940, BIT(23) | BIT(22), 0); + odm_set_bb_reg(dm, R_0x940, BIT(25) | BIT(24), 1); + odm_set_bb_reg(dm, R_0x940, BIT(27) | BIT(26), 2); } - } else if (num_enable_path == 4) - ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path ((A B C D))\n")); - + } else if (num_enable_path == 4) + PHYDM_DBG(dm, DBG_PATH_DIV, " Turn on path ((A B C D))\n"); } -void -phydm_find_default_path( - void *p_dm_void -) +void phydm_find_default_path( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ODM_PATH_DIVERSITY_ *p_dm_path_div = &p_dm_odm->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; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; + u32 rssi_a = 0, rssi_b = 0, rssi_c = 0, rssi_d = 0, rssi_bcd = 0; + u32 rssi_total_a = 0, rssi_total_b = 0; + u32 rssi_total_c = 0, rssi_total_d = 0; - /* 2 Default path Selection By RSSI */ + /* @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 ; + rssi_a = (p_div->path_a_cnt_all > 0) ? + (p_div->path_a_sum_all / p_div->path_a_cnt_all) : 0; + rssi_b = (p_div->path_b_cnt_all > 0) ? + (p_div->path_b_sum_all / p_div->path_b_cnt_all) : 0; + rssi_c = (p_div->path_c_cnt_all > 0) ? + (p_div->path_c_sum_all / p_div->path_c_cnt_all) : 0; + rssi_d = (p_div->path_d_cnt_all > 0) ? + (p_div->path_d_sum_all / p_div->path_d_cnt_all) : 0; + p_div->path_a_sum_all = 0; + p_div->path_a_cnt_all = 0; + p_div->path_b_sum_all = 0; + p_div->path_b_cnt_all = 0; + p_div->path_c_sum_all = 0; + p_div->path_c_cnt_all = 0; + p_div->path_d_sum_all = 0; + p_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_div->use_path_a_as_default_ant == 1) { + rssi_bcd = (rssi_b + rssi_c + rssi_d) / 3; - 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; + if ((rssi_a + ANT_DECT_RSSI_TH) > rssi_bcd) { + p_div->is_path_a_exist = true; + p_div->default_path = PATH_A; + } else { + p_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; + if (rssi_a >= rssi_b && + rssi_a >= rssi_c && + rssi_a >= rssi_d) + p_div->default_path = PATH_A; + else if ((rssi_b >= rssi_c) && (rssi_b >= rssi_d)) + p_div->default_path = PATH_B; + else if (rssi_c >= rssi_d) + p_div->default_path = PATH_C; else - p_dm_path_div->default_path = PATH_D; + p_div->default_path = PATH_D; } - - } - -void -phydm_candidate_dtp_update( - void *p_dm_void -) +void phydm_candidate_dtp_update( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ODM_PATH_DIVERSITY_ *p_dm_path_div = &p_dm_odm->dm_path_div; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; - p_dm_path_div->num_candidate = 3; + p_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 = PHYDM_ABC; - p_dm_path_div->ant_candidate_2 = PHYDM_ABD; - p_dm_path_div->ant_candidate_3 = PHYDM_ACD; + if (p_div->use_path_a_as_default_ant == 1) { + if (p_div->num_tx_path == 3) { + if (p_div->is_path_a_exist) { + p_div->ant_candidate_1 = BB_PATH_ABC; + p_div->ant_candidate_2 = BB_PATH_ABD; + p_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_odm, PHYDM_BCD); + p_div->num_candidate = 1; + phydm_dtp_fix_tx_path(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 = PHYDM_AB; - p_dm_path_div->ant_candidate_2 = PHYDM_AC; - p_dm_path_div->ant_candidate_3 = PHYDM_AD; + } else if (p_div->num_tx_path == 2) { + if (p_div->is_path_a_exist) { + p_div->ant_candidate_1 = BB_PATH_AB; + p_div->ant_candidate_2 = BB_PATH_AC; + p_div->ant_candidate_3 = BB_PATH_AD; } else { - p_dm_path_div->ant_candidate_1 = PHYDM_BC; - p_dm_path_div->ant_candidate_2 = PHYDM_BD; - p_dm_path_div->ant_candidate_3 = PHYDM_CD; + p_div->ant_candidate_1 = BB_PATH_BC; + p_div->ant_candidate_2 = BB_PATH_BD; + p_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 = PHYDM_ABC; - p_dm_path_div->ant_candidate_2 = PHYDM_ABD; - p_dm_path_div->ant_candidate_3 = PHYDM_ACD; - } else if (p_dm_path_div->default_path == PATH_B) { - p_dm_path_div->ant_candidate_1 = PHYDM_ABC; - p_dm_path_div->ant_candidate_2 = PHYDM_ABD; - p_dm_path_div->ant_candidate_3 = PHYDM_BCD; - } else if (p_dm_path_div->default_path == PATH_C) { - p_dm_path_div->ant_candidate_1 = PHYDM_ABC; - p_dm_path_div->ant_candidate_2 = PHYDM_ACD; - p_dm_path_div->ant_candidate_3 = PHYDM_BCD; - } else if (p_dm_path_div->default_path == PATH_D) { - p_dm_path_div->ant_candidate_1 = PHYDM_ABD; - p_dm_path_div->ant_candidate_2 = PHYDM_ACD; - p_dm_path_div->ant_candidate_3 = PHYDM_BCD; + /* @2 3 TX mode */ + if (p_div->num_tx_path == 3) { /* @choose 3 ant form 4 */ + if (p_div->default_path == PATH_A) { + /* @choose 2 ant form 3 */ + p_div->ant_candidate_1 = BB_PATH_ABC; + p_div->ant_candidate_2 = BB_PATH_ABD; + p_div->ant_candidate_3 = BB_PATH_ACD; + } else if (p_div->default_path == PATH_B) { + p_div->ant_candidate_1 = BB_PATH_ABC; + p_div->ant_candidate_2 = BB_PATH_ABD; + p_div->ant_candidate_3 = BB_PATH_BCD; + } else if (p_div->default_path == PATH_C) { + p_div->ant_candidate_1 = BB_PATH_ABC; + p_div->ant_candidate_2 = BB_PATH_ACD; + p_div->ant_candidate_3 = BB_PATH_BCD; + } else if (p_div->default_path == PATH_D) { + p_div->ant_candidate_1 = BB_PATH_ABD; + p_div->ant_candidate_2 = BB_PATH_ACD; + p_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 = PHYDM_AB; - p_dm_path_div->ant_candidate_2 = PHYDM_AC; - p_dm_path_div->ant_candidate_3 = PHYDM_AD; - } else if (p_dm_path_div->default_path == PATH_B) { - p_dm_path_div->ant_candidate_1 = PHYDM_AB; - p_dm_path_div->ant_candidate_2 = PHYDM_BC; - p_dm_path_div->ant_candidate_3 = PHYDM_BD; - } else if (p_dm_path_div->default_path == PATH_C) { - p_dm_path_div->ant_candidate_1 = PHYDM_AC; - p_dm_path_div->ant_candidate_2 = PHYDM_BC; - p_dm_path_div->ant_candidate_3 = PHYDM_CD; - } else if (p_dm_path_div->default_path == PATH_D) { - p_dm_path_div->ant_candidate_1 = PHYDM_AD; - p_dm_path_div->ant_candidate_2 = PHYDM_BD; - p_dm_path_div->ant_candidate_3 = PHYDM_CD; + /* @2 2 TX mode */ + else if (p_div->num_tx_path == 2) { /* @choose 2 ant form 4 */ + if (p_div->default_path == PATH_A) { + /* @choose 2 ant form 3 */ + p_div->ant_candidate_1 = BB_PATH_AB; + p_div->ant_candidate_2 = BB_PATH_AC; + p_div->ant_candidate_3 = BB_PATH_AD; + } else if (p_div->default_path == PATH_B) { + p_div->ant_candidate_1 = BB_PATH_AB; + p_div->ant_candidate_2 = BB_PATH_BC; + p_div->ant_candidate_3 = BB_PATH_BD; + } else if (p_div->default_path == PATH_C) { + p_div->ant_candidate_1 = BB_PATH_AC; + p_div->ant_candidate_2 = BB_PATH_BC; + p_div->ant_candidate_3 = BB_PATH_CD; + } else if (p_div->default_path == PATH_D) { + p_div->ant_candidate_1 = BB_PATH_AD; + p_div->ant_candidate_2 = BB_PATH_BD; + p_div->ant_candidate_3 = BB_PATH_CD; } } } } - -void -phydm_dynamic_tx_path( - void *p_dm_void -) +void phydm_dynamic_tx_path( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ODM_PATH_DIVERSITY_ *p_dm_path_div = &p_dm_odm->dm_path_div; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; - struct sta_info *p_entry; - u32 i; - u8 num_client = 0; - u8 h2c_parameter[6] = {0}; + struct sta_info *entry; + u32 i; + u8 num_client = 0; + u8 h2c_parameter[6] = {0}; + if (!dm->is_linked) { /* @is_linked==False */ + PHYDM_DBG(dm, DBG_PATH_DIV, "DTP_8814 [No Link!!!]\n"); - if (!p_dm_odm->is_linked) { /* is_linked==False */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("DTP_8814 [No Link!!!]\n")); - - if (p_dm_path_div->is_become_linked == true) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" [Be disconnected]----->\n")); - p_dm_path_div->is_become_linked = p_dm_odm->is_linked; + if (p_div->is_become_linked) { + PHYDM_DBG(dm, DBG_PATH_DIV, "[Be disconnected]---->\n"); + p_div->is_become_linked = dm->is_linked; } return; } else { - if (p_dm_path_div->is_become_linked == false) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" [Be Linked !!!]----->\n")); - p_dm_path_div->is_become_linked = p_dm_odm->is_linked; + if (!p_div->is_become_linked) { + PHYDM_DBG(dm, DBG_PATH_DIV, " [Be Linked !!!]----->\n"); + p_div->is_become_linked = dm->is_linked; } } - /* 2 [period CTRL] */ - if (p_dm_path_div->dtp_period >= 2) - p_dm_path_div->dtp_period = 0; - else { - /* ODM_RT_TRACE(p_dm_odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("Phydm_Dynamic_Tx_Path_8814A() Stay = (( %d ))\n",p_dm_path_div->dtp_period)); */ - p_dm_path_div->dtp_period++; + /* @2 [period CTRL] */ + if (p_div->dtp_period >= 2) { + p_div->dtp_period = 0; + } else { + p_div->dtp_period++; return; } - - /* 2 [Fix path] */ - if (p_dm_odm->path_select != PHYDM_AUTO_PATH) + /* @2 [Fix path] */ + if (dm->path_select != PHYDM_AUTO_PATH) return; - /* 2 [Check Bfer] */ +/* @2 [Check Bfer] */ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -#if (BEAMFORMING_SUPPORT == 1) +#ifdef PHYDM_BEAMFORMING_SUPPORT { - enum beamforming_cap beamform_cap = (p_dm_odm->beamforming_info.beamform_cap); + enum beamforming_cap beamform_cap = (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) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("[ PathDiv : OFF ] BFmer ==1\n")); - p_dm_path_div->fix_path_bfer = 1 ; + if (beamform_cap & BEAMFORMER_CAP) { /* @BFmer On && Div On->Div Off */ + if (p_div->fix_path_bfer == 0) { + PHYDM_DBG(dm, DBG_PATH_DIV, + "[ PathDiv : OFF ] BFmer ==1\n"); + p_div->fix_path_bfer = 1; } return; - } else { /* BFmer Off && Div Off->Div On */ - if (p_dm_path_div->fix_path_bfer == 1) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("[ PathDiv : ON ] BFmer ==0\n")); - p_dm_path_div->fix_path_bfer = 0; + } else { /* @BFmer Off && Div Off->Div On */ + if (p_div->fix_path_bfer == 1) { + PHYDM_DBG(dm, DBG_PATH_DIV, + "[ PathDiv : ON ] BFmer ==0\n"); + p_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_odm); - phydm_candidate_dtp_update(p_dm_odm); + if (p_div->use_path_a_as_default_ant == 1) { + phydm_find_default_path(dm); + phydm_candidate_dtp_update(dm); } else { - if (p_dm_path_div->phydm_dtp_state == PHYDM_DTP_INIT) { - phydm_find_default_path(p_dm_odm); - phydm_candidate_dtp_update(p_dm_odm); - p_dm_path_div->phydm_dtp_state = PHYDM_DTP_RUNNING_1; + if (p_div->phydm_dtp_state == PHYDM_DTP_INIT) { + phydm_find_default_path(dm); + phydm_candidate_dtp_update(dm); + p_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++; + else if (p_div->phydm_dtp_state == PHYDM_DTP_RUNNING_1) { + p_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; + if (p_div->dtp_check_patha_counter >= + NUM_RESET_DTP_PERIOD) { + p_div->dtp_check_patha_counter = 0; + p_div->phydm_dtp_state = PHYDM_DTP_INIT; } - /* 2 Search space update */ +#if 0 + /* @2 Search space update */ else { - /* 1. find the worst candidate */ + /* @1. find the worst candidate */ - /* 2. repalce the worst candidate */ + /* @2. repalce the worst candidate */ } +#endif } } - /* 2 Dynamic path Selection H2C */ + /* @2 Dynamic path Selection H2C */ - if (p_dm_path_div->num_candidate == 1) + if (p_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; + } else { + h2c_parameter[0] = p_div->num_candidate; + h2c_parameter[1] = p_div->num_tx_path; + h2c_parameter[2] = p_div->ant_candidate_1; + h2c_parameter[3] = p_div->ant_candidate_2; + h2c_parameter[4] = p_div->ant_candidate_3; - odm_fill_h2c_cmd(p_dm_odm, PHYDM_H2C_DYNAMIC_TX_PATH, 6, h2c_parameter); + odm_fill_h2c_cmd(dm, PHYDM_H2C_DYNAMIC_TX_PATH, 6, h2c_parameter); } - } - - -void -phydm_dynamic_tx_path_init( - void *p_dm_void -) +void phydm_dynamic_tx_path_init( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ODM_PATH_DIVERSITY_ *p_dm_path_div = &(p_dm_odm->dm_path_div); - struct _ADAPTER *p_adapter = p_dm_odm->adapter; -#if ((DM_ODM_SUPPORT_TYPE == ODM_WIN) && USB_SWITCH_SUPPORT) - USB_MODE_MECH *p_usb_mode_mech = &p_adapter->usb_mode_mechanism; -#endif - u8 search_space_2[NUM_CHOOSE2_FROM4] = {PHYDM_AB, PHYDM_AC, PHYDM_AD, PHYDM_BC, PHYDM_BD, PHYDM_CD }; - u8 search_space_3[NUM_CHOOSE3_FROM4] = {PHYDM_BCD, PHYDM_ACD, PHYDM_ABD, PHYDM_ABC}; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; + void *adapter = 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_usb_mode_mech->cur_usb_mode == USB_MODE_U3) ? 1 : 0 ; + p_div->is_u3_mode = (*dm->hub_usb_mode == 2) ? 1 : 0; + PHYDM_DBG(dm, DBG_PATH_DIV, "[WIN USB] is_u3_mode = (( %d ))\n", + p_div->is_u3_mode); #else - p_dm_path_div->is_u3_mode = 1; + p_div->is_u3_mode = 1; #endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("Dynamic TX path Init 8814\n")); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("is_u3_mode = (( %d ))\n", p_dm_path_div->is_u3_mode)); + PHYDM_DBG(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); + memcpy(&p_div->search_space_2[0], &search_space_2[0], + NUM_CHOOSE2_FROM4); + memcpy(&p_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_odm->path_select = PHYDM_AUTO_PATH; - p_dm_path_div->phydm_path_div_type = PHYDM_4R_PATH_DIV; + p_div->use_path_a_as_default_ant = 1; + p_div->phydm_dtp_state = PHYDM_DTP_INIT; + dm->path_select = PHYDM_AUTO_PATH; + p_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_odm, PHYDM_BCD);/* 3TX Set Init TX path*/ + if (p_div->is_u3_mode) { + p_div->num_tx_path = 3; + phydm_dtp_fix_tx_path(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_odm, PHYDM_BC);/* 2TX // Set Init TX path*/ + p_div->num_tx_path = 2; + phydm_dtp_fix_tx_path(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 -) +void phydm_process_rssi_for_path_div_8814a(void *dm_void, void *phy_info_void, + void *pkt_info_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _odm_phy_status_info_ *p_phy_info = (struct _odm_phy_status_info_ *)p_phy_info_void; - struct _odm_per_pkt_info_ *p_pktinfo = (struct _odm_per_pkt_info_ *)p_pkt_info_void; - struct _ODM_PATH_DIVERSITY_ *p_dm_path_div = &(p_dm_odm->dm_path_div); + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_phyinfo_struct *phy_info = NULL; + struct phydm_perpkt_info_struct *pktinfo = NULL; + struct _ODM_PATH_DIVERSITY_ *p_div = &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_odm->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++; + phy_info = (struct phydm_phyinfo_struct *)phy_info_void; + pktinfo = (struct phydm_perpkt_info_struct *)pkt_info_void; - p_dm_path_div->path_b_sum_all += p_phy_info->rx_mimo_signal_strength[1]; - p_dm_path_div->path_b_cnt_all++; + if (!(pktinfo->is_packet_to_self || pktinfo->is_packet_match_bssid)) + return; - p_dm_path_div->path_c_sum_all += p_phy_info->rx_mimo_signal_strength[2]; - p_dm_path_div->path_c_cnt_all++; + if (pktinfo->data_rate <= ODM_RATE11M) + return; - 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]++; + if (p_div->phydm_path_div_type == PHYDM_4R_PATH_DIV) { + p_div->path_a_sum_all += phy_info->rx_mimo_signal_strength[0]; + p_div->path_a_cnt_all++; - 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]++; - } - } + p_div->path_b_sum_all += phy_info->rx_mimo_signal_strength[1]; + p_div->path_b_cnt_all++; + + p_div->path_c_sum_all += phy_info->rx_mimo_signal_strength[2]; + p_div->path_c_cnt_all++; + + p_div->path_d_sum_all += phy_info->rx_mimo_signal_strength[3]; + p_div->path_d_cnt_all++; } - - } -#endif /* #if RTL8814A_SUPPORT */ - -void -odm_pathdiv_debug( - void *p_dm_void, - u32 *const dm_value, - u32 *_used, - char *output, - u32 *_out_len -) +void phydm_pathdiv_debug_8814a(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ODM_PATH_DIVERSITY_ *p_dm_path_div = &(p_dm_odm->dm_path_div); + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; u32 used = *_used; u32 out_len = *_out_len; + u32 dm_value[10] = {0}; + u8 i, input_idx = 0; - p_dm_odm->path_select = (dm_value[0] & 0xf); - PHYDM_SNPRINTF((output + used, out_len - used, "Path_select = (( 0x%x ))\n", p_dm_odm->path_select)); + for (i = 0; i < 5; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_HEX, &dm_value[i]); + input_idx++; + } + } - /* 2 [Fix path] */ - if (p_dm_odm->path_select != PHYDM_AUTO_PATH) { - PHYDM_SNPRINTF((output + used, out_len - used, "Trun on path [%s%s%s%s]\n", - ((p_dm_odm->path_select) & 0x1) ? "A" : "", - ((p_dm_odm->path_select) & 0x2) ? "B" : "", - ((p_dm_odm->path_select) & 0x4) ? "C" : "", - ((p_dm_odm->path_select) & 0x8) ? "D" : "")); + if (input_idx == 0) + return; - phydm_dtp_fix_tx_path(p_dm_odm, p_dm_odm->path_select); - } else - PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "Auto path")); + dm->path_select = (u8)(dm_value[0] & 0xf); + PDM_SNPF(out_len, used, output + used, out_len - used, + "Path_select = (( 0x%x ))\n", dm->path_select); + + /* @2 [Fix path] */ + if (dm->path_select != PHYDM_AUTO_PATH) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "Turn on path [%s%s%s%s]\n", + ((dm->path_select) & 0x1) ? "A" : "", + ((dm->path_select) & 0x2) ? "B" : "", + ((dm->path_select) & 0x4) ? "C" : "", + ((dm->path_select) & 0x8) ? "D" : ""); + + phydm_dtp_fix_tx_path(dm, dm->path_select); + } else { + PDM_SNPF(out_len, used, output + used, out_len - used, "%s\n", + "Auto path"); + } + + *_used = used; + *_out_len = out_len; } -#endif /* #if(defined(CONFIG_PATH_DIVERSITY)) */ +#endif /* @#if RTL8814A_SUPPORT */ -void -phydm_c2h_dtp_handler( - void *p_dm_void, - u8 *cmd_buf, - u8 cmd_len -) +#if RTL8812A_SUPPORT +void phydm_update_tx_path_8812a(void *dm_void, enum bb_path path) { -#if (defined(CONFIG_PATH_DIVERSITY)) - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ODM_PATH_DIVERSITY_ *p_dm_path_div = &(p_dm_odm->dm_path_div); + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _ODM_PATH_DIVERSITY_ *p_div = &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]; + if (p_div->default_tx_path != path) { + PHYDM_DBG(dm, DBG_PATH_DIV, "Need to Update Tx path\n"); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("Target_candidate = (( %d ))\n", target)); - /* + if (path == BB_PATH_A) { + /*Tx by Reg*/ + odm_set_bb_reg(dm, R_0x80c, 0xFFF0, 0x111); + /*Resp Tx by Txinfo*/ + odm_set_bb_reg(dm, R_0x6d8, 0xc0, 1); + } else { + /*Tx by Reg*/ + odm_set_bb_reg(dm, R_0x80c, 0xFFF0, 0x222); + /*Resp Tx by Txinfo*/ + odm_set_bb_reg(dm, R_0x6d8, 0xc0, 2); + } + } + p_div->default_tx_path = path; + + PHYDM_DBG(dm, DBG_PATH_DIV, "path=%s\n", + (path == BB_PATH_A) ? "A" : "B"); +} + +void phydm_path_diversity_init_8812a(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; + u32 i; + + odm_set_bb_reg(dm, R_0x80c, BIT(29), 1); /* Tx path from Reg */ + odm_set_bb_reg(dm, R_0x80c, 0xFFF0, 0x111); /* Tx by Reg */ + odm_set_bb_reg(dm, R_0x6d8, BIT(7) | BIT6, 1); /* Resp Tx by Txinfo */ + phydm_set_tx_path_by_bb_reg(dm, RF_PATH_A); + + for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) + p_div->path_sel[i] = 1; /* TxInfo default at path-A */ +} +#endif + +#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT +void phydm_set_resp_tx_path_by_fw_jgr3(void *dm_void, u8 macid, + enum bb_path path, boolean enable) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; + u8 h2c_para[7] = {0}; + u8 path_map[4] = {0}; /* tx logic map*/ + u8 num_enable_path = 0; + u8 n_tx_path_ctrl_map = 0; + u8 i = 0, n_sts = 0; + + /*Response TX is controlled in FW ctrl info*/ + + PHYDM_DBG(dm, DBG_PATH_DIV, "[%s] =====>\n", __func__); + + if (enable) { + n_tx_path_ctrl_map = path; + + for (i = 0; i < 4; i++) { + path_map[i] = 0; + if (path & BIT(i)) + num_enable_path++; + } + + for (i = 0; i < 4; i++) { + if (path & BIT(i)) { + path_map[i] = n_sts; + n_sts++; + + if (n_sts == num_enable_path) + break; + } + } + } + + PHYDM_DBG(dm, DBG_PATH_DIV, "ctrl_map=0x%x Map[D:A]={%d, %d, %d, %d}\n", + n_tx_path_ctrl_map, + path_map[3], path_map[2], path_map[1], path_map[0]); + + h2c_para[0] = macid; + h2c_para[1] = n_tx_path_ctrl_map; + h2c_para[2] = (path_map[3] << 6) | (path_map[2] << 4) | + (path_map[1] << 2) | path_map[0]; + + odm_fill_h2c_cmd(dm, PHYDM_H2C_DYNAMIC_TX_PATH, 7, h2c_para); +} + +void phydm_get_tx_path_txdesc_jgr3(void *dm_void, u8 macid, + struct path_txdesc_ctrl *desc) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; + u8 ant_map_a = 0, ant_map_b = 0; + u8 ntx_map = 0; + + if (p_div->path_sel[macid] == BB_PATH_A) { + desc->ant_map_a = 0; /*offest24[23:22]*/ + desc->ant_map_b = 0; /*offest24[25:24]*/ + desc->ntx_map = BB_PATH_A; /*offest28[23:20]*/ + } else if (p_div->path_sel[macid] == BB_PATH_B) { + desc->ant_map_a = 0; /*offest24[23:22]*/ + desc->ant_map_b = 0; /*offest24[25:24]*/ + desc->ntx_map = BB_PATH_B; /*offest28[23:20]*/ + } else { + desc->ant_map_a = 0; /*offest24[23:22]*/ + desc->ant_map_b = 1; /*offest24[25:24]*/ + desc->ntx_map = BB_PATH_AB; /*offest28[23:20]*/ + } +} +#endif + +void phydm_tx_path_by_mac_or_reg(void *dm_void, enum phydm_path_ctrl ctrl) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; + + PHYDM_DBG(dm, DBG_PATH_DIV, "[%s] ctrl=%s\n", + __func__, (ctrl == TX_PATH_BY_REG) ? "REG" : "DESC"); + + if (ctrl == p_div->tx_path_ctrl) + return; + + p_div->tx_path_ctrl = ctrl; + + switch (dm->support_ic_type) { + #if (RTL8822C_SUPPORT) + case ODM_RTL8822C: + if (ctrl == TX_PATH_BY_REG) { + odm_set_bb_reg(dm, R_0x1e24, BIT(16), 0); /*OFDM*/ + odm_set_bb_reg(dm, R_0x1a84, 0xe0, 0); /*CCK*/ + } else { + odm_set_bb_reg(dm, R_0x1e24, BIT(16), 1); /*OFDM*/ + odm_set_bb_reg(dm, R_0x1a84, 0xe0, 7); /*CCK*/ + } + + break; + #endif + #if 0 /*(RTL8822B_SUPPORT)*/ /*@ HW Bug*/ + case ODM_RTL8822B: + if (ctrl == TX_PATH_BY_REG) { + odm_set_bb_reg(dm, R_0x93c, BIT(18), 0); + odm_set_bb_reg(dm, R_0xa84, 0xe0, 0); /*CCK*/ + } else { + odm_set_bb_reg(dm, R_0x93c, BIT(18), 1); + odm_set_bb_reg(dm, R_0xa84, 0xe0, 7); /*CCK*/ + } + + break; + #endif + default: + break; + } +} + +void phydm_fix_1ss_tx_path_by_bb_reg(void *dm_void, + enum bb_path tx_path_sel_1ss, + enum bb_path tx_path_sel_cck) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; + + if (tx_path_sel_1ss != BB_PATH_AUTO) { + p_div->ofdm_fix_path_en = true; + p_div->ofdm_fix_path_sel = tx_path_sel_1ss; + } else { + p_div->ofdm_fix_path_en = false; + p_div->ofdm_fix_path_sel = dm->tx_1ss_status; + } + + if (tx_path_sel_cck != BB_PATH_AUTO) { + p_div->cck_fix_path_en = true; + p_div->cck_fix_path_sel = tx_path_sel_cck; + } else { + p_div->cck_fix_path_en = false; + p_div->cck_fix_path_sel = dm->tx_1ss_status; + } + + p_div->force_update = true; + + PHYDM_DBG(dm, DBG_PATH_DIV, + "{OFDM_fix_en=%d, path=%d} {CCK_fix_en=%d, path=%d}\n", + p_div->ofdm_fix_path_en, p_div->ofdm_fix_path_sel, + p_div->cck_fix_path_en, p_div->cck_fix_path_sel); +} + +void phydm_set_tx_path_by_bb_reg(void *dm_void, enum bb_path tx_path_sel_1ss) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; + enum bb_path tx_path_sel_cck = tx_path_sel_1ss; + + if (!p_div->force_update) { + if (tx_path_sel_1ss == p_div->default_tx_path) { + PHYDM_DBG(dm, DBG_PATH_DIV, "Stay in TX path=%s\n", + (tx_path_sel_1ss == BB_PATH_A) ? "A" : "B"); + return; + } + } + p_div->force_update = false; + + p_div->default_tx_path = tx_path_sel_1ss; + + PHYDM_DBG(dm, DBG_PATH_DIV, "Switch TX path=%s\n", + (tx_path_sel_1ss == BB_PATH_A) ? "A" : "B"); + + /*Adv-ctrl mode*/ + if (p_div->cck_fix_path_en) { + PHYDM_DBG(dm, DBG_PATH_DIV, "Fix CCK TX path=%d\n", + p_div->cck_fix_path_sel); + tx_path_sel_cck = p_div->cck_fix_path_sel; + } + + if (p_div->ofdm_fix_path_en) { + PHYDM_DBG(dm, DBG_PATH_DIV, "Fix OFDM TX path=%d\n", + p_div->ofdm_fix_path_sel); + tx_path_sel_1ss = p_div->ofdm_fix_path_sel; + } + + switch (dm->support_ic_type) { + #if RTL8822C_SUPPORT + case ODM_RTL8822C: + phydm_config_tx_path_8822c(dm, dm->tx_2ss_status, + tx_path_sel_1ss, tx_path_sel_cck); + break; + #endif + + #if 0 /*RTL8822B_SUPPORT*/ + case ODM_RTL8822B: + if (dm->tx_ant_status != BB_PATH_AB) + return; + + phydm_config_tx_path_8822b(dm, BB_PATH_AB, + tx_path_sel_1ss, tx_path_sel_cck); + break; + #endif + + #if RTL8812A_SUPPORT + case ODM_RTL8812: + phydm_update_tx_path_8812a(dm, tx_path_sel_1ss); + break; + #endif + default: + break; + } +} + +void phydm_tx_path_diversity_2ss(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; + struct cmn_sta_info *sta; + enum bb_path default_tx_path = BB_PATH_A, path = BB_PATH_A; + u32 rssi_a = 0, rssi_b = 0; + u32 local_max_rssi, glb_min_rssi = 0xff; + u8 i = 0; + + PHYDM_DBG(dm, DBG_PATH_DIV, "[%s] =======>\n", __func__); + + if (!dm->is_linked) { + if (dm->first_disconnect) + phydm_tx_path_by_mac_or_reg(dm, TX_PATH_BY_REG); + + PHYDM_DBG(dm, DBG_PATH_DIV, "No Link\n"); + return; + } + + #if 0/*def PHYDM_IC_JGR3_SERIES_SUPPORT*/ + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + if (dm->is_one_entry_only || p_div->cck_fix_path_en || + p_div->ofdm_fix_path_en) + phydm_tx_path_by_mac_or_reg(dm, TX_PATH_BY_REG); + else + phydm_tx_path_by_mac_or_reg(dm, TX_PATH_BY_DESC); + } + #endif + + for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { + sta = dm->phydm_sta_info[i]; + if (!is_sta_active(sta)) + continue; + + /* 2 Caculate RSSI per path */ + rssi_a = PHYDM_DIV(p_div->path_a_sum[i], p_div->path_a_cnt[i]); + rssi_b = PHYDM_DIV(p_div->path_b_sum[i], p_div->path_b_cnt[i]); + + if (rssi_a == rssi_b) + path = p_div->default_tx_path; + else + path = (rssi_a > rssi_b) ? BB_PATH_A : BB_PATH_B; + + local_max_rssi = (rssi_a > rssi_b) ? rssi_a : rssi_b; + + PHYDM_DBG(dm, DBG_PATH_DIV, + "[%d]PathA sum=%d, cnt=%d, avg_rssi=%d\n", + i, p_div->path_a_sum[i], + p_div->path_a_cnt[i], rssi_a); + PHYDM_DBG(dm, DBG_PATH_DIV, + "[%d]PathB sum=%d, cnt=%d, avg_rssi=%d\n", + i, p_div->path_b_sum[i], + p_div->path_b_cnt[i], rssi_b); + + /*Select default Tx path */ + if (local_max_rssi < glb_min_rssi) { + glb_min_rssi = local_max_rssi; + default_tx_path = path; + } + + if (p_div->path_sel[i] != path) { + p_div->path_sel[i] = path; + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + phydm_set_resp_tx_path_by_fw_jgr3(dm, i, + path, true); + #endif + } + + p_div->path_a_cnt[i] = 0; + p_div->path_a_sum[i] = 0; + p_div->path_b_cnt[i] = 0; + p_div->path_b_sum[i] = 0; + } + + /* 2 Update default Tx path */ + phydm_set_tx_path_by_bb_reg(dm, default_tx_path); + PHYDM_DBG(dm, DBG_PATH_DIV, "[%s] end\n\n", __func__); +} + +void phydm_tx_path_diversity(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; + + p_div->path_div_in_progress = false; + + if (!(dm->support_ability & ODM_BB_PATH_DIV)) + return; + + if (p_div->stop_path_div) { + PHYDM_DBG(dm, DBG_PATH_DIV, + "stop_path_div=1, tx_1ss_status=%d\n", + dm->tx_1ss_status); + return; + } + + switch (dm->support_ic_type) { + #if (RTL8822C_SUPPORT || RTL8822B_SUPPORT || RTL8812A_SUPPORT) + case ODM_RTL8812: + case ODM_RTL8822B: + case ODM_RTL8822C: + if (dm->rx_ant_status != BB_PATH_AB) { + PHYDM_DBG(dm, DBG_PATH_DIV, + "[Return] tx_Path_en=%d, rx_Path_en=%d\n", + dm->tx_ant_status, dm->rx_ant_status); + return; + } + + p_div->path_div_in_progress = true; + phydm_tx_path_diversity_2ss(dm); + break; + #endif + + #if RTL8814A_SUPPORT + case ODM_RTL8814A: + phydm_dynamic_tx_path(dm); + break; + #endif + } +} + +void phydm_tx_path_diversity_init_v2(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; + u32 i = 0; + + PHYDM_DBG(dm, DBG_PATH_DIV, "[%s] ====>\n", __func__); + + /*BB_PATH_AB is a invalid value used for init state*/ + p_div->default_tx_path = BB_PATH_A; + p_div->tx_path_ctrl = TX_PATH_CTRL_INIT; + p_div->path_div_in_progress = false; + + p_div->cck_fix_path_en = false; + p_div->ofdm_fix_path_en = false; + p_div->force_update = false; + + for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) + p_div->path_sel[i] = BB_PATH_A; /* TxInfo default at path-A */ + + phydm_tx_path_by_mac_or_reg(dm, TX_PATH_BY_REG); +} + +void phydm_tx_path_diversity_init(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (!(dm->support_ability & ODM_BB_PATH_DIV)) + return; + + switch (dm->support_ic_type) { + #if (RTL8822C_SUPPORT || RTL8822B_SUPPORT) + case ODM_RTL8822C: + case ODM_RTL8822B: + phydm_tx_path_diversity_init_v2(dm); /*@ After 8822B*/ + break; + #endif + + #if RTL8812A_SUPPORT + case ODM_RTL8812: + phydm_path_diversity_init_8812a(dm); + break; + #endif + + #if RTL8814A_SUPPORT + case ODM_RTL8814A: + phydm_dynamic_tx_path_init(dm); + break; + #endif + } +} + +void phydm_process_rssi_for_path_div(void *dm_void, void *phy_info_void, + void *pkt_info_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_phyinfo_struct *phy_info = NULL; + struct phydm_perpkt_info_struct *pktinfo = NULL; + struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; + u8 id = 0; + + phy_info = (struct phydm_phyinfo_struct *)phy_info_void; + pktinfo = (struct phydm_perpkt_info_struct *)pkt_info_void; + + if (!(pktinfo->is_packet_to_self || pktinfo->is_packet_match_bssid)) + return; + + if (pktinfo->is_cck_rate) + return; + + id = pktinfo->station_id; + p_div->path_a_sum[id] += phy_info->rx_mimo_signal_strength[0]; + p_div->path_a_cnt[id]++; + + p_div->path_b_sum[id] += phy_info->rx_mimo_signal_strength[1]; + p_div->path_b_cnt[id]++; +} + +void phydm_pathdiv_debug(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _ODM_PATH_DIVERSITY_ *p_div = &dm->dm_path_div; + char help[] = "-h"; + u32 used = *_used; + u32 out_len = *_out_len; + u32 val[10] = {0}; + u8 i, input_idx = 0; + + for (i = 0; i < 5; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_HEX, &val[i]); + input_idx++; + } + } + + if (input_idx == 0) + return; + + PHYDM_SSCANF(input[1], DCMD_HEX, &val[0]); + PHYDM_SSCANF(input[2], DCMD_HEX, &val[1]); + + if ((strcmp(input[1], help) == 0)) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "{1:TX Ctrl Sig} {0:BB, 1:MAC}\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{2:BB Default TX REG} {path}\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{3:MAC DESC TX} {path} {macid}\n"); + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + PDM_SNPF(out_len, used, output + used, out_len - used, + "{4:MAC Resp TX} {path} {macid}\n"); + #endif + PDM_SNPF(out_len, used, output + used, out_len - used, + "{5:Fix 1ss path} {ofdm path} {cck path}\n"); + } else if (val[0] == 1) { + phydm_tx_path_by_mac_or_reg(dm, (enum phydm_path_ctrl)val[1]); + } else if (val[0] == 2) { + phydm_set_tx_path_by_bb_reg(dm, (enum bb_path)val[1]); + } else if (val[0] == 3) { + p_div->path_sel[val[2]] = (enum bb_path)val[1]; + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + } else if (val[0] == 4) { + phydm_set_resp_tx_path_by_fw_jgr3(dm, (u8)val[2], + (enum bb_path)val[1], true); + #endif + } else if (val[0] == 5) { + phydm_fix_1ss_tx_path_by_bb_reg(dm, (enum bb_path)val[1], + (enum bb_path)val[2]); + } + *_used = used; + *_out_len = out_len; +} + +void phydm_c2h_dtp_handler(void *dm_void, u8 *cmd_buf, u8 cmd_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _ODM_PATH_DIVERSITY_ *p_div = &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(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_odm, p_dm_path_div->ant_candidate_1); + phydm_dtp_fix_tx_path(dm, p_div->ant_candidate_1); } else if( nsc_2 >= nsc_3) { - phydm_dtp_fix_tx_path(p_dm_odm, p_dm_path_div->ant_candidate_2); + phydm_dtp_fix_tx_path(dm, p_div->ant_candidate_2); } else { - phydm_dtp_fix_tx_path(p_dm_odm, p_dm_path_div->ant_candidate_3); + phydm_dtp_fix_tx_path(dm, p_div->ant_candidate_3); } */ -#endif } -void -odm_path_diversity( - void *p_dm_void -) -{ -#if (defined(CONFIG_PATH_DIVERSITY)) - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - if (!(p_dm_odm->support_ability & ODM_BB_PATH_DIV)) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("Return: Not Support PathDiv\n")); - return; - } - -#if RTL8812A_SUPPORT - - if (p_dm_odm->support_ic_type & ODM_RTL8812) - odm_path_diversity_8812a(p_dm_odm); - else -#endif - -#if RTL8814A_SUPPORT - if (p_dm_odm->support_ic_type & ODM_RTL8814A) - phydm_dynamic_tx_path(p_dm_odm); - else -#endif - {} -#endif -} - -void -odm_path_diversity_init( - void *p_dm_void -) -{ -#if (defined(CONFIG_PATH_DIVERSITY)) - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - - /*p_dm_odm->support_ability |= ODM_BB_PATH_DIV;*/ - - if (p_dm_odm->mp_mode == true) - return; - - if (!(p_dm_odm->support_ability & ODM_BB_PATH_DIV)) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("Return: Not Support PathDiv\n")); - return; - } - -#if RTL8812A_SUPPORT - if (p_dm_odm->support_ic_type & ODM_RTL8812) - odm_path_diversity_init_8812a(p_dm_odm); - else -#endif - -#if RTL8814A_SUPPORT - if (p_dm_odm->support_ic_type & ODM_RTL8814A) - phydm_dynamic_tx_path_init(p_dm_odm); - 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) */ +#endif /* @#ifdef CONFIG_PATH_DIVERSITY */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_pathdiv.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_pathdiv.h index 33e8f9ee7121..4821ffce34e3 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_pathdiv.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_pathdiv.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,62 +9,46 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ -#ifndef __PHYDMPATHDIV_H__ -#define __PHYDMPATHDIV_H__ -/*#define PATHDIV_VERSION "2.0" //2014.11.04*/ -#define PATHDIV_VERSION "3.1" /*2015.07.29 by YuChen*/ +#ifndef __PHYDMPATHDIV_H__ +#define __PHYDMPATHDIV_H__ -#if (defined(CONFIG_PATH_DIVERSITY)) -#define USE_PATH_A_AS_DEFAULT_ANT /* for 8814 dynamic TX path selection */ +#ifdef CONFIG_PATH_DIVERSITY +#define PATHDIV_VERSION "4.1" /* @ modify the condition of by reg*/ -#define NUM_RESET_DTP_PERIOD 5 -#define ANT_DECT_RSSI_TH 3 +#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 PHYDM_AUTO_PATH 0 +#define PHYDM_FIX_PATH 1 #define NUM_CHOOSE2_FROM4 6 #define NUM_CHOOSE3_FROM4 4 - -#define PHYDM_A BIT(0) -#define PHYDM_B BIT(1) -#define PHYDM_C BIT(2) -#define PHYDM_D BIT(3) -#define PHYDM_AB (BIT(0) | BIT1) /* 0 */ -#define PHYDM_AC (BIT(0) | BIT2) /* 1 */ -#define PHYDM_AD (BIT(0) | BIT3) /* 2 */ -#define PHYDM_BC (BIT(1) | BIT2) /* 3 */ -#define PHYDM_BD (BIT(1) | BIT3) /* 4 */ -#define PHYDM_CD (BIT(2) | BIT3) /* 5 */ - -#define PHYDM_ABC (BIT(0) | BIT1 | BIT2) /* 0*/ -#define PHYDM_ABD (BIT(0) | BIT1 | BIT3) /* 1*/ -#define PHYDM_ACD (BIT(0) | BIT2 | BIT3) /* 2*/ -#define PHYDM_BCD (BIT(1) | BIT2 | BIT3) /* 3*/ - -#define PHYDM_ABCD (BIT(0) | BIT(1) | BIT(2) | BIT(3)) - - enum phydm_dtp_state { PHYDM_DTP_INIT = 1, PHYDM_DTP_RUNNING_1 - }; enum phydm_path_div_type { @@ -71,21 +56,34 @@ enum phydm_path_div_type { 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 -); +enum phydm_path_ctrl { + TX_PATH_BY_REG = 0, + TX_PATH_BY_DESC = 1, + TX_PATH_CTRL_INIT +}; + +struct path_txdesc_ctrl { + u8 ant_map_a : 2; + u8 ant_map_b : 2; + u8 ntx_map : 4; +}; struct _ODM_PATH_DIVERSITY_ { - u8 resp_tx_path; - u8 path_sel[ODM_ASSOCIATE_ENTRY_NUM]; + boolean stop_path_div; /*@Limit by enabled path number*/ + boolean path_div_in_progress; + boolean cck_fix_path_en; /*@ BB Reg for Adv-Ctrl (or debug mode)*/ + boolean ofdm_fix_path_en; /*@ BB Reg for Adv-Ctrl (or debug mode)*/ + enum bb_path cck_fix_path_sel; /*@ BB Reg for Adv-Ctrl (or debug mode)*/ + enum bb_path ofdm_fix_path_sel;/*@ BB Reg for Adv-Ctrl (or debug mode)*/ + enum phydm_path_ctrl tx_path_ctrl; + enum bb_path default_tx_path; + enum bb_path 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; + boolean force_update; #if RTL8814A_SUPPORT u32 path_a_sum_all; @@ -99,8 +97,8 @@ struct _ODM_PATH_DIVERSITY_ { u32 path_d_cnt_all; u8 dtp_period; - bool is_become_linked; - bool is_u3_mode; + boolean is_become_linked; + boolean is_u3_mode; u8 num_tx_path; u8 default_path; u8 num_candidate; @@ -109,211 +107,34 @@ struct _ODM_PATH_DIVERSITY_ { u8 ant_candidate_3; u8 phydm_dtp_state; u8 dtp_check_patha_counter; - bool fix_path_bfer; + 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; - bool is_path_a_exist; + boolean is_path_a_exist; #endif }; +void phydm_set_tx_path_by_bb_reg(void *dm_void, enum bb_path tx_path_sel_1ss); -#endif /* #if(defined(CONFIG_PATH_DIVERSITY)) */ +void phydm_get_tx_path_txdesc_jgr3(void *dm_void, u8 macid, + struct path_txdesc_ctrl *desc); -void -phydm_c2h_dtp_handler( - void *p_dm_void, - u8 *cmd_buf, - u8 cmd_len -); +void phydm_c2h_dtp_handler(void *dm_void, u8 *cmd_buf, u8 cmd_len); -void -odm_path_diversity_init( - void *p_dm_void -); +void phydm_tx_path_diversity_init(void *dm_void); -void -odm_path_diversity( - void *p_dm_void -); +void phydm_tx_path_diversity(void *dm_void); -void -odm_pathdiv_debug( - void *p_dm_void, - u32 *const dm_value, - u32 *_used, - char *output, - u32 *_out_len -); +void phydm_process_rssi_for_path_div(void *dm_void, void *phy_info_void, + void *pkt_info_void); +void phydm_pathdiv_debug(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len); +#endif /* @#ifdef CONFIG_PATH_DIVERSITY */ +#endif /* @#ifndef __PHYDMPATHDIV_H__ */ -/* 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 -); - -bool -odm_is_connected_92c( - struct _ADAPTER *adapter -); - -bool -odm_path_diversity_before_link92c( - /* struct _ADAPTER* adapter */ - struct PHY_DM_STRUCT *p_dm_odm -); - -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_odm -); - -void -odm_cck_path_diversity_chk_per_pkt_rssi( - struct _ADAPTER *adapter, - bool is_def_port, - bool 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, - bool is_def_port, - bool 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_odm -); - -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_odm -); - -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/rtl8188eu/hal/phydm/phydm_phystatus.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_phystatus.c new file mode 100644 index 000000000000..7eaeda9abc97 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_phystatus.c @@ -0,0 +1,3236 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +/*@************************************************************ + * include files + ************************************************************/ + +#include "mp_precomp.h" +#include "phydm_precomp.h" + +#ifdef PHYDM_COMPILE_MU +u8 phydm_get_gid(struct dm_struct *dm, u8 *phy_status_inf) +{ +#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT) + struct phy_sts_rpt_jgr2_type1 *rpt_jgr2 = NULL; +#endif +#ifdef PHYSTS_3RD_TYPE_SUPPORT + struct phy_sts_rpt_jgr3_type1 *rpt_jgr3 = NULL; +#endif + u8 gid = 0; + + if (dm->ic_phy_sts_type == PHYDM_PHYSTS_TYPE_1) + return 0; + + if ((*phy_status_inf & 0xf) != 1) + return 0; + + switch (dm->ic_phy_sts_type) { + #if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT) + case PHYDM_PHYSTS_TYPE_2: + rpt_jgr2 = (struct phy_sts_rpt_jgr2_type1 *)phy_status_inf; + gid = rpt_jgr2->gid; + break; + #endif + #ifdef PHYSTS_3RD_TYPE_SUPPORT + case PHYDM_PHYSTS_TYPE_3: + rpt_jgr3 = (struct phy_sts_rpt_jgr3_type1 *)phy_status_inf; + gid = rpt_jgr3->gid; + break; + #endif + default: + break; + } + + return gid; +} +#endif + +void phydm_rx_statistic_cal(struct dm_struct *dm, + struct phydm_phyinfo_struct *phy_info, + u8 *phy_status_inf, + struct phydm_perpkt_info_struct *pktinfo) +{ + struct odm_phy_dbg_info *dbg_i = &dm->phy_dbg_info; + +#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + struct phydm_bf_rate_info_jgr3 *bfrateinfo = &dm->bf_rate_info_jgr3; +#endif + + u8 rate = (pktinfo->data_rate & 0x7f); + u8 bw_idx = phy_info->band_width; + u8 offset = 0; + u8 gid = 0; +#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT || defined(PHYSTS_3RD_TYPE_SUPPORT)) + u8 val = 0; +#endif + #ifdef PHYDM_COMPILE_MU + u8 is_mu_pkt = 0; + #endif + + if (rate <= ODM_RATE54M) { + dbg_i->num_qry_legacy_pkt[rate]++; + } else if (rate <= ODM_RATEMCS31) { + dbg_i->ht_pkt_not_zero = true; + offset = rate - ODM_RATEMCS0; + + if (offset > (HT_RATE_NUM - 1)) + offset = HT_RATE_NUM - 1; + + if (dm->support_ic_type & + (PHYSTS_2ND_TYPE_IC | PHYSTS_3RD_TYPE_IC)) { + if (bw_idx == *dm->band_width) { + dbg_i->num_qry_ht_pkt[offset]++; + + } else if (bw_idx == CHANNEL_WIDTH_20) { + dbg_i->num_qry_pkt_sc_20m[offset]++; + dbg_i->low_bw_20_occur = true; + } + } else { + dbg_i->num_qry_ht_pkt[offset]++; + } + } +#if (ODM_IC_11AC_SERIES_SUPPORT || defined(PHYSTS_3RD_TYPE_SUPPORT)) + else if (rate <= ODM_RATEVHTSS4MCS9) { + offset = rate - ODM_RATEVHTSS1MCS0; + + if (offset > (VHT_RATE_NUM - 1)) + offset = VHT_RATE_NUM - 1; + + #ifdef PHYDM_COMPILE_MU + gid = phydm_get_gid(dm, phy_status_inf); + + if (gid != 0 && gid != 63) + is_mu_pkt = true; + + if (is_mu_pkt) { + #if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT ||\ + (defined(PHYSTS_3RD_TYPE_SUPPORT))) + dbg_i->num_mu_vht_pkt[offset]++; + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + bfrateinfo->num_mu_vht_pkt[offset]++; + #endif + #else + dbg_i->num_qry_vht_pkt[offset]++; /*@for debug*/ + #endif + } else + #endif + { + dbg_i->vht_pkt_not_zero = true; + + if (dm->support_ic_type & + (PHYSTS_2ND_TYPE_IC | PHYSTS_3RD_TYPE_IC)) { + if (bw_idx == *dm->band_width) { + dbg_i->num_qry_vht_pkt[offset]++; + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + bfrateinfo->num_qry_vht_pkt[offset]++; + #endif + + } else if (bw_idx == CHANNEL_WIDTH_20) { + dbg_i->num_qry_pkt_sc_20m[offset]++; + dbg_i->low_bw_20_occur = true; + } else {/*@if (bw_idx == CHANNEL_WIDTH_40)*/ + dbg_i->num_qry_pkt_sc_40m[offset]++; + dbg_i->low_bw_40_occur = true; + } + } else { + dbg_i->num_qry_vht_pkt[offset]++; + } + } + + #if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT ||\ + (defined(PHYSTS_3RD_TYPE_SUPPORT))) + if (pktinfo->ppdu_cnt < 4) { + val = rate; + + #ifdef PHYDM_COMPILE_MU + if (is_mu_pkt) + val |= BIT(7); + #endif + + dbg_i->num_of_ppdu[pktinfo->ppdu_cnt] = val; + dbg_i->gid_num[pktinfo->ppdu_cnt] = gid; + } + #endif + } +#endif +} + +void phydm_reset_phystatus_avg(struct dm_struct *dm) +{ + struct phydm_phystatus_avg *dbg_avg = NULL; + + dbg_avg = &dm->phy_dbg_info.phystatus_statistic_avg; + odm_memory_set(dm, &dbg_avg->rssi_cck_avg, 0, + sizeof(struct phydm_phystatus_avg)); +} + +void phydm_reset_phystatus_statistic(struct dm_struct *dm) +{ + struct phydm_phystatus_statistic *dbg_s = NULL; + + dbg_s = &dm->phy_dbg_info.physts_statistic_info; + + odm_memory_set(dm, &dbg_s->rssi_cck_sum, 0, + sizeof(struct phydm_phystatus_statistic)); +} + +void phydm_avg_phystatus_index(void *dm_void, + struct phydm_phyinfo_struct *phy_info, + struct phydm_perpkt_info_struct *pktinfo) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct odm_phy_dbg_info *dbg_i = &dm->phy_dbg_info; + struct phydm_phystatus_statistic *dbg_s = &dbg_i->physts_statistic_info; + u8 rssi[PHYSTS_PATH_NUM] = {0}; + u8 evm[PHYSTS_PATH_NUM] = {0}; + s8 snr[PHYSTS_PATH_NUM] = {0}; + u32 size = PHYSTS_PATH_NUM; /*size of path=4*/ + u16 size_th = PHY_HIST_SIZE - 1; /*size of threshold*/ + u16 val = 0, intvl = 0; + u8 i = 0; + + odm_move_memory(dm, rssi, phy_info->rx_mimo_signal_strength, size); + odm_move_memory(dm, evm, phy_info->rx_mimo_evm_dbm, size); + odm_move_memory(dm, snr, phy_info->rx_snr, size); + + if (pktinfo->is_packet_beacon) { + dbg_s->rssi_beacon_sum += rssi[0]; + dbg_s->rssi_beacon_cnt++; + } + + if (pktinfo->data_rate <= ODM_RATE11M) { + /*RSSI*/ + dbg_s->rssi_cck_sum += rssi[0]; + dbg_s->rssi_cck_cnt++; + } else if (pktinfo->data_rate <= ODM_RATE54M) { + for (i = 0; i < dm->num_rf_path; i++) { + /*SNR & RSSI*/ + dbg_s->snr_ofdm_sum[i] += snr[i]; + dbg_s->rssi_ofdm_sum[i] += rssi[i]; + } + /*@evm*/ + dbg_s->evm_ofdm_sum += evm[0]; + dbg_s->rssi_ofdm_cnt++; + + val = (u16)evm[0]; + intvl = phydm_find_intrvl(dm, val, dbg_i->evm_hist_th, size_th); + dbg_s->evm_ofdm_hist[intvl]++; + + val = (u16)snr[0]; + intvl = phydm_find_intrvl(dm, val, dbg_i->snr_hist_th, size_th); + dbg_s->snr_ofdm_hist[intvl]++; + + } else if (pktinfo->rate_ss == 1) { +/*@===[1-SS]==================================================================*/ + for (i = 0; i < dm->num_rf_path; i++) { + /*SNR & RSSI*/ + dbg_s->snr_1ss_sum[i] += snr[i]; + dbg_s->rssi_1ss_sum[i] += rssi[i]; + } + + /*@evm*/ + dbg_s->evm_1ss_sum += evm[0]; + /*@EVM Histogram*/ + val = (u16)evm[0]; + intvl = phydm_find_intrvl(dm, val, dbg_i->evm_hist_th, size_th); + dbg_s->evm_1ss_hist[intvl]++; + + /*SNR Histogram*/ + val = (u16)snr[0]; + intvl = phydm_find_intrvl(dm, val, dbg_i->snr_hist_th, size_th); + dbg_s->snr_1ss_hist[intvl]++; + + dbg_s->rssi_1ss_cnt++; + } else if (pktinfo->rate_ss == 2) { +/*@===[2-SS]==================================================================*/ + #if (defined(PHYDM_COMPILE_ABOVE_2SS)) + for (i = 0; i < dm->num_rf_path; i++) { + /*SNR & RSSI*/ + dbg_s->snr_2ss_sum[i] += snr[i]; + dbg_s->rssi_2ss_sum[i] += rssi[i]; + } + + for (i = 0; i < pktinfo->rate_ss; i++) { + /*@evm*/ + dbg_s->evm_2ss_sum[i] += evm[i]; + /*@EVM Histogram*/ + val = (u16)evm[i]; + intvl = phydm_find_intrvl(dm, val, dbg_i->evm_hist_th, + size_th); + dbg_s->evm_2ss_hist[i][intvl]++; + + /*SNR Histogram*/ + val = (u16)snr[i]; + intvl = phydm_find_intrvl(dm, val, dbg_i->snr_hist_th, + size_th); + dbg_s->snr_2ss_hist[i][intvl]++; + } + dbg_s->rssi_2ss_cnt++; + #endif + } else if (pktinfo->rate_ss == 3) { +/*@===[3-SS]==================================================================*/ + #if (defined(PHYDM_COMPILE_ABOVE_3SS)) + for (i = 0; i < dm->num_rf_path; i++) { + /*SNR & RSSI*/ + dbg_s->snr_3ss_sum[i] += snr[i]; + dbg_s->rssi_3ss_sum[i] += rssi[i]; + } + + for (i = 0; i < pktinfo->rate_ss; i++) { + /*@evm*/ + dbg_s->evm_3ss_sum[i] += evm[i]; + /*@EVM Histogram*/ + val = (u16)evm[i]; + intvl = phydm_find_intrvl(dm, val, dbg_i->evm_hist_th, + size_th); + dbg_s->evm_3ss_hist[i][intvl]++; + + /*SNR Histogram*/ + val = (u16)snr[i]; + intvl = phydm_find_intrvl(dm, val, dbg_i->snr_hist_th, + size_th); + dbg_s->snr_3ss_hist[i][intvl]++; + } + dbg_s->rssi_3ss_cnt++; + #endif + } else if (pktinfo->rate_ss == 4) { +/*@===[4-SS]==================================================================*/ + #if (defined(PHYDM_COMPILE_ABOVE_4SS)) + for (i = 0; i < dm->num_rf_path; i++) { + /*SNR & RSSI*/ + dbg_s->snr_4ss_sum[i] += snr[i]; + dbg_s->rssi_4ss_sum[i] += rssi[i]; + } + + for (i = 0; i < pktinfo->rate_ss; i++) { + /*@evm*/ + dbg_s->evm_4ss_sum[i] += evm[i]; + + /*@EVM Histogram*/ + val = (u16)evm[i]; + intvl = phydm_find_intrvl(dm, val, dbg_i->evm_hist_th, + size_th); + dbg_s->evm_4ss_hist[i][intvl]++; + + /*SNR Histogram*/ + val = (u16)snr[i]; + intvl = phydm_find_intrvl(dm, val, dbg_i->snr_hist_th, + size_th); + dbg_s->snr_4ss_hist[i][intvl]++; + } + dbg_s->rssi_4ss_cnt++; + #endif + } +} + +void phydm_avg_phystatus_init(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct odm_phy_dbg_info *dbg_i = &dm->phy_dbg_info; + u16 snr_hist_th[PHY_HIST_SIZE - 1] = {5, 8, 11, 14, 17, 20, 23, 26, + 29, 32, 35}; + u16 evm_hist_th[PHY_HIST_SIZE - 1] = {5, 8, 11, 14, 17, 20, 23, 26, + 29, 32, 35}; + u32 size = (PHY_HIST_SIZE - 1) * 2; + + odm_move_memory(dm, dbg_i->snr_hist_th, snr_hist_th, size); + odm_move_memory(dm, dbg_i->evm_hist_th, evm_hist_th, size); +} + +u8 phydm_get_signal_quality(struct phydm_phyinfo_struct *phy_info, + struct dm_struct *dm, + struct phy_status_rpt_8192cd *phy_sts) +{ + u8 sq_rpt; + u8 result = 0; + + if (phy_info->rx_pwdb_all > 40 && !dm->is_in_hct_test) { + result = 100; + } else { + sq_rpt = phy_sts->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_pwr_2_percent(s8 ant_power) +{ + if ((ant_power <= -100) || ant_power >= 20) + return 0; + else if (ant_power >= 0) + return 100; + else + return 100 + ant_power; +} + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + +#if 0 /*(DM_ODM_SUPPORT_TYPE == ODM_CE)*/ +s32 phydm_signal_scale_mapping_92c_series(struct dm_struct *dm, s32 curr_sig) +{ + s32 ret_sig = 0; + +#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) + if (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 (dm->support_interface == ODM_ITRF_USB || + 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 dm_struct *dm, s32 curr_sig) +{ +#ifdef CONFIG_SIGNAL_SCALE_MAPPING + return phydm_signal_scale_mapping_92c_series(dm, curr_sig); +#else + return curr_sig; +#endif +} +#endif + +void phydm_process_signal_strength(struct dm_struct *dm, + struct phydm_phyinfo_struct *phy_info, + struct phydm_perpkt_info_struct *pktinfo) +{ + u8 avg_rssi = 0, tmp_rssi = 0, best_rssi = 0, second_rssi = 0; + u8 ss = 0; /*signal strenth after scale mapping*/ + u8 pwdb = phy_info->rx_pwdb_all; + u8 i; + + /*use the best two RSSI only*/ + for (i = RF_PATH_A; i < PHYDM_MAX_RF_PATH; i++) { + tmp_rssi = phy_info->rx_mimo_signal_strength[i]; + + /*@Get the best two RSSI*/ + if (tmp_rssi > best_rssi && tmp_rssi > second_rssi) { + second_rssi = best_rssi; + best_rssi = tmp_rssi; + } else if (tmp_rssi > second_rssi && tmp_rssi <= best_rssi) { + second_rssi = tmp_rssi; + } + } + + if (best_rssi == 0) + return; + + if (pktinfo->rate_ss == 1) + avg_rssi = best_rssi; + else + avg_rssi = (best_rssi + second_rssi) >> 1; + + if (dm->support_ic_type & PHYSTS_3RD_TYPE_IC) { + #ifdef PHYSTS_3RD_TYPE_SUPPORT + /* Update signal strength to UI, + * and phy_info->rx_pwdb_all is the maximum RSSI of all path + */ + #if 1 /*(DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ + ss = SignalScaleProc(dm->adapter, pwdb, false, false); + #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + ss = (u8)phydm_signal_scale_mapping(dm, pwdb); + #elif (DM_ODM_SUPPORT_TYPE == ODM_IOT) + ss = (u8)phydm_signal_scale_mapping(dm, pwdb); + #endif + + #endif + } else if (dm->support_ic_type & PHYSTS_2ND_TYPE_IC) { + #if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT) + /* Update signal strength to UI, + * and phy_info->rx_pwdb_all is the maximum RSSI of all path + */ + #if 1 /*(DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ + ss = SignalScaleProc(dm->adapter, pwdb, false, false); + #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + ss = (u8)phydm_signal_scale_mapping(dm, pwdb); + #endif + + #endif + } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + #if ODM_IC_11AC_SERIES_SUPPORT + if (pktinfo->is_cck_rate) + #if 1/*(DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ + ss = SignalScaleProc(dm->adapter, pwdb, 0, 1); + #else + ss = (u8)phydm_signal_scale_mapping(dm, pwdb); + #endif + else + #if 1 /*(DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ + ss = SignalScaleProc(dm->adapter, avg_rssi, 0, 1); + #else + ss = (u8)phydm_signal_scale_mapping(dm, avg_rssi); + #endif + #endif + } else if (dm->support_ic_type & ODM_IC_11N_SERIES) { + #if ODM_IC_11N_SERIES_SUPPORT + if (pktinfo->is_cck_rate) + #if 1/*(DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ + ss = SignalScaleProc(dm->adapter, pwdb, 1, 1); + #else + ss = (u8)phydm_signal_scale_mapping(dm, pwdb); + #endif + else + #if 1 /*(DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ + ss = SignalScaleProc(dm->adapter, avg_rssi, 1, 0); + #else + ss = (u8)phydm_signal_scale_mapping(dm, avg_rssi); + #endif + #endif + } + phy_info->signal_strength = ss; +} +#endif + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) +static u8 phydm_sq_patch_lenovo( + struct dm_struct *dm, + u8 is_cck_rate, + u8 pwdb_all, + u8 path, + u8 RSSI) +{ + u8 sq = 0; + + if (is_cck_rate) { + if (dm->support_ic_type & ODM_RTL8192E) { +/*@ + * + * 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 (dm->support_ic_type & ODM_RTL8192E) { + 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; + } + } + return sq; +} + +static u8 phydm_sq_patch_rt_cid_819x_acer( + struct dm_struct *dm, + u8 is_cck_rate, + u8 pwdb_all, + u8 path, + u8 RSSI) +{ + u8 sq = 0; + + if (is_cck_rate) { +#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; + + /* @Abnormal case, do not indicate the value above 20 on Win7 */ + if (pwdb_all == 0) + sq = 20; +#endif + + } else { + /* OFDM rate */ + if (dm->support_ic_type & ODM_RTL8192E) { + 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; + } + } + return sq; +} +#endif + +static u8 +phydm_evm_2_percent(s8 value) +{ + /* @-33dB~0dB to 0%~99% */ + s8 ret_val; + + ret_val = value; + ret_val /= 2; + +/*@dbg_print("value=%d\n", value);*/ +#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; +} + +s8 phydm_cck_rssi_convert(struct dm_struct *dm, u16 lna_idx, u8 vga_idx) +{ + /*@phydm_get_cck_rssi_table_from_reg*/ + return (dm->cck_lna_gain_table[lna_idx] - (vga_idx << 1)); +} + +void phydm_get_cck_rssi_table_from_reg(struct dm_struct *dm) +{ + u8 used_lna_idx_tmp; + u32 reg_0xa80 = 0x7431, reg_0xabc = 0xcbe5edfd; + u32 val = 0; + u8 i; + + /*@example: {-53, -43, -33, -27, -19, -13, -3, 1}*/ + /*@{0xCB, 0xD5, 0xDF, 0xE5, 0xED, 0xF3, 0xFD, 0x2}*/ + + PHYDM_DBG(dm, ODM_COMP_INIT, "CCK LNA Gain table init\n"); + + if (!(dm->support_ic_type & ODM_RTL8197F)) + return; + + reg_0xa80 = odm_get_bb_reg(dm, R_0xa80, 0xFFFF); + reg_0xabc = odm_get_bb_reg(dm, R_0xabc, MASKDWORD); + + PHYDM_DBG(dm, ODM_COMP_INIT, "reg_0xa80 = 0x%x\n", reg_0xa80); + PHYDM_DBG(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); + val = (reg_0xabc >> (8 * i)) & 0xff; + dm->cck_lna_gain_table[used_lna_idx_tmp] = (s8)val; + } + + PHYDM_DBG(dm, ODM_COMP_INIT, + "cck_lna_gain_table = {%d,%d,%d,%d,%d,%d,%d,%d}\n", + dm->cck_lna_gain_table[0], dm->cck_lna_gain_table[1], + dm->cck_lna_gain_table[2], dm->cck_lna_gain_table[3], + dm->cck_lna_gain_table[4], dm->cck_lna_gain_table[5], + dm->cck_lna_gain_table[6], dm->cck_lna_gain_table[7]); +} + +s8 phydm_get_cck_rssi(void *dm_void, u8 lna_idx, u8 vga_idx) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + s8 rx_pow = 0; + + switch (dm->support_ic_type) { + #if (RTL8197F_SUPPORT) + case ODM_RTL8197F: + rx_pow = phydm_cck_rssi_convert(dm, lna_idx, vga_idx); + break; + #endif + + #if (RTL8723D_SUPPORT) + case ODM_RTL8723D: + rx_pow = phydm_cckrssi_8723d(dm, lna_idx, vga_idx); + break; + #endif + + #if (RTL8710B_SUPPORT) + case ODM_RTL8710B: + rx_pow = phydm_cckrssi_8710b(dm, lna_idx, vga_idx); + break; + #endif + + #if (RTL8721D_SUPPORT) + case ODM_RTL8721D: + rx_pow = phydm_cckrssi_8721d(dm, lna_idx, vga_idx); + break; + #endif + + #if (RTL8192F_SUPPORT) + case ODM_RTL8192F: + rx_pow = phydm_cckrssi_8192f(dm, lna_idx, vga_idx); + break; + #endif + + #if (RTL8821C_SUPPORT) + case ODM_RTL8821C: + rx_pow = phydm_cck_rssi_8821c(dm, lna_idx, vga_idx); + break; + #endif + + #if (RTL8195B_SUPPORT) + case ODM_RTL8195B: + rx_pow = phydm_cck_rssi_8195B(dm, lna_idx, vga_idx); + break; + #endif + + #if (RTL8188E_SUPPORT) + case ODM_RTL8188E: + rx_pow = phydm_cck_rssi_8188e(dm, lna_idx, vga_idx); + break; + #endif + + #if (RTL8192E_SUPPORT) + case ODM_RTL8192E: + rx_pow = phydm_cck_rssi_8192e(dm, lna_idx, vga_idx); + break; + #endif + + #if (RTL8723B_SUPPORT) + case ODM_RTL8723B: + rx_pow = phydm_cck_rssi_8723b(dm, lna_idx, vga_idx); + break; + #endif + + #if (RTL8703B_SUPPORT) + case ODM_RTL8703B: + rx_pow = phydm_cck_rssi_8703b(dm, lna_idx, vga_idx); + break; + #endif + + #if (RTL8188F_SUPPORT) + case ODM_RTL8188F: + rx_pow = phydm_cck_rssi_8188f(dm, lna_idx, vga_idx); + break; + #endif + + #if (RTL8195A_SUPPORT) + case ODM_RTL8195A: + rx_pow = phydm_cck_rssi_8195a(dm, lna_idx, vga_idx); + break; + #endif + + #if (RTL8812A_SUPPORT) + case ODM_RTL8812: + rx_pow = phydm_cck_rssi_8812a(dm, lna_idx, vga_idx); + break; + #endif + + #if (RTL8821A_SUPPORT || RTL8881A_SUPPORT) + case ODM_RTL8821: + case ODM_RTL8881A: + rx_pow = phydm_cck_rssi_8821a(dm, lna_idx, vga_idx); + break; + #endif + + #if (RTL8814A_SUPPORT) + case ODM_RTL8814A: + rx_pow = phydm_cck_rssi_8814a(dm, lna_idx, vga_idx); + break; + #endif + + default: + break; + } + + return rx_pow; +} + +#if (ODM_IC_11N_SERIES_SUPPORT) +void phydm_phy_sts_n_parsing(struct dm_struct *dm, + struct phydm_phyinfo_struct *phy_info, + u8 *phy_status_inf, + struct phydm_perpkt_info_struct *pktinfo) +{ + u8 i = 0; + s8 rx_pwr[4], rx_pwr_all = 0; + u8 EVM, pwdb_all = 0, pwdb_all_bt = 0; + u8 RSSI, total_rssi = 0; + u8 rf_rx_num = 0; + u8 lna_idx = 0; + u8 vga_idx = 0; + u8 cck_agc_rpt; + s8 evm_tmp = 0; + u8 sq = 0; + u8 val_tmp = 0; + s8 val_s8 = 0; + struct phy_status_rpt_8192cd *phy_sts = NULL; + + phy_sts = (struct phy_status_rpt_8192cd *)phy_status_inf; + + if (pktinfo->is_cck_rate) { + cck_agc_rpt = phy_sts->cck_agc_rpt_ofdm_cfosho_a; + + /*@3 bit LNA*/ + lna_idx = ((cck_agc_rpt & 0xE0) >> 5); + vga_idx = (cck_agc_rpt & 0x1F); + + #if (RTL8703B_SUPPORT) + if (dm->support_ic_type & (ODM_RTL8703B) && + dm->cck_agc_report_type == 1) { + /*@4 bit LNA*/ + if (phy_sts->cck_rpt_b_ofdm_cfosho_b & BIT(7)) + val_tmp = 1; + else + val_tmp = 0; + lna_idx = (val_tmp << 3) | lna_idx; + } + #endif + + rx_pwr_all = phydm_get_cck_rssi(dm, lna_idx, vga_idx); + + PHYDM_DBG(dm, DBG_RSSI_MNTR, + "ext_lna_gain (( %d )), lna_idx: (( 0x%x )), vga_idx: (( 0x%x )), rx_pwr_all: (( %d ))\n", + dm->ext_lna_gain, lna_idx, vga_idx, rx_pwr_all); + + if (dm->board_type & ODM_BOARD_EXT_LNA) + rx_pwr_all -= dm->ext_lna_gain; + + pwdb_all = phydm_pwr_2_percent(rx_pwr_all); + + if (pktinfo->is_to_self) { + dm->cck_lna_idx = lna_idx; + dm->cck_vga_idx = vga_idx; + } + + phy_info->rx_pwdb_all = pwdb_all; + phy_info->bt_rx_rssi_percentage = pwdb_all; + phy_info->recv_signal_power = rx_pwr_all; + + /* @(3) Get Signal Quality (EVM) */ + #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + if (dm->iot_table.win_patch_id == RT_CID_819X_LENOVO) + sq = phydm_sq_patch_lenovo(dm, pktinfo->is_cck_rate, pwdb_all, 0, 0); + else if (dm->iot_table.win_patch_id == RT_CID_819X_ACER) + sq = phydm_sq_patch_rt_cid_819x_acer(dm, pktinfo->is_cck_rate, pwdb_all, 0, 0); + else + #endif + sq = phydm_get_signal_quality(phy_info, dm, phy_sts); + +#if 0 + /* @dbg_print("cck sq = %d\n", sq); */ +#endif + phy_info->signal_quality = sq; + phy_info->rx_mimo_signal_quality[RF_PATH_A] = sq; + phy_info->rx_mimo_signal_quality[RF_PATH_B] = -1; + + for (i = RF_PATH_A; i < PHYDM_MAX_RF_PATH; i++) { + if (i == 0) + phy_info->rx_mimo_signal_strength[0] = pwdb_all; + else + phy_info->rx_mimo_signal_strength[i] = 0; + } + } else { /* @2 is OFDM rate */ + + /* @(1)Get RSSI for HT rate */ + + for (i = RF_PATH_A; i < dm->num_rf_path; i++) { + if (dm->rf_path_rx_enable & BIT(i)) + rf_rx_num++; + + val_s8 = phy_sts->path_agc[i].gain & 0x3F; + rx_pwr[i] = (val_s8 * 2) - 110; + + if (pktinfo->is_to_self) + dm->ofdm_agc_idx[i] = val_s8; + + phy_info->rx_pwr[i] = rx_pwr[i]; + RSSI = phydm_pwr_2_percent(rx_pwr[i]); + total_rssi += RSSI; + + phy_info->rx_mimo_signal_strength[i] = (u8)RSSI; + + /* @Get Rx snr value in DB */ + val_s8 = (s8)(phy_sts->path_rxsnr[i] / 2); + phy_info->rx_snr[i] = val_s8; + + /* Record Signal Strength for next packet */ + + #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + if (i == RF_PATH_A) { + if (dm->iot_table.win_patch_id == RT_CID_819X_LENOVO) { + phy_info->signal_quality = phydm_sq_patch_lenovo(dm, pktinfo->is_cck_rate, pwdb_all, i, RSSI); + } else if (dm->iot_table.win_patch_id == RT_CID_819X_ACER) + phy_info->signal_quality = phydm_sq_patch_rt_cid_819x_acer(dm, pktinfo->is_cck_rate, pwdb_all, 0, RSSI); + } + #endif + } + + /* @(2)PWDB, Average PWDB calculated by hardware (for RA) */ + val_s8 = phy_sts->cck_sig_qual_ofdm_pwdb_all >> 1; + rx_pwr_all = (val_s8 & 0x7f) - 110; + + pwdb_all = phydm_pwr_2_percent(rx_pwr_all); + pwdb_all_bt = pwdb_all; + + phy_info->rx_pwdb_all = pwdb_all; + phy_info->bt_rx_rssi_percentage = pwdb_all_bt; + phy_info->rx_power = rx_pwr_all; + phy_info->recv_signal_power = rx_pwr_all; + + /* @(3)EVM of HT rate */ + for (i = 0; i < pktinfo->rate_ss; 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_2_percent(phy_sts->stream_rxevm[i]); + + /*@Fill value in RFD, Get the 1st spatial stream only*/ + if (i == RF_PATH_A) + phy_info->signal_quality = (u8)(EVM & 0xff); + + phy_info->rx_mimo_signal_quality[i] = (u8)(EVM & 0xff); + + if (phy_sts->stream_rxevm[i] < 0) + evm_tmp = 0 - phy_sts->stream_rxevm[i]; + + if (evm_tmp == 64) + evm_tmp = 0; + + phy_info->rx_mimo_evm_dbm[i] = (u8)evm_tmp; + } + phydm_parsing_cfo(dm, pktinfo, + phy_sts->path_cfotail, pktinfo->rate_ss); + } + + #ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY + dm->dm_fat_table.antsel_rx_keep_0 = phy_sts->ant_sel; + dm->dm_fat_table.antsel_rx_keep_1 = phy_sts->ant_sel_b; + dm->dm_fat_table.antsel_rx_keep_2 = phy_sts->antsel_rx_keep_2; + #endif +} +#endif + +#if ODM_IC_11AC_SERIES_SUPPORT +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; +} + +static u8 +phydm_evm_dbm(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; +} + +void phydm_rx_physts_bw_parsing(struct phydm_phyinfo_struct *phy_info, + struct phydm_perpkt_info_struct * + pktinfo, + struct phy_status_rpt_8812 * + phy_sts) +{ + if (pktinfo->data_rate <= ODM_RATE54M) { + switch (phy_sts->r_RFMOD) { + case 1: + if (phy_sts->sub_chnl == 0) + phy_info->band_width = 1; + else + phy_info->band_width = 0; + break; + + case 2: + if (phy_sts->sub_chnl == 0) + phy_info->band_width = 2; + else if (phy_sts->sub_chnl == 9 || + phy_sts->sub_chnl == 10) + phy_info->band_width = 1; + else + phy_info->band_width = 0; + break; + + default: + case 0: + phy_info->band_width = 0; + break; + } + } +} + +void phydm_get_sq(struct dm_struct *dm, struct phydm_phyinfo_struct *phy_info, + u8 is_cck_rate) +{ + u8 sq = 0; + u8 pwdb_all = phy_info->rx_pwdb_all; /*precentage*/ + #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + u8 rssi = phy_info->rx_mimo_signal_strength[0]; + #endif + + #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + if (dm->iot_table.win_patch_id == RT_CID_819X_LENOVO) { + if (is_cck_rate) + sq = phydm_sq_patch_lenovo(dm, 1, pwdb_all, 0, 0); + else + sq = phydm_sq_patch_lenovo(dm, 0, pwdb_all, 0, rssi); + } else + #endif + { + if (is_cck_rate) { + if (pwdb_all > 40 && !dm->is_in_hct_test) { + sq = 100; + } else { + if (pwdb_all > 64) + sq = 0; + else if (pwdb_all < 20) + sq = 100; + else + sq = ((64 - pwdb_all) * 100) / 44; + } + } else { + sq = phy_info->rx_mimo_signal_quality[0]; + } + } + +#if 0 + /* @dbg_print("cck sq = %d\n", sq); */ +#endif + phy_info->signal_quality = sq; +} + +void phydm_rx_physts_1st_type(struct dm_struct *dm, + struct phydm_phyinfo_struct *phy_info, + u8 *phy_status_inf, + struct phydm_perpkt_info_struct *pktinfo) +{ + u8 i = 0; + s8 rx_pwr_db = 0; + u8 val = 0; /*tmp value*/ + s8 val_s8 = 0; /*tmp value*/ + u8 rssi = 0; /*pre path RSSI*/ + u8 rf_rx_num = 0; + u8 lna_idx = 0, vga_idx = 0; + u8 cck_agc_rpt = 0; + struct phy_status_rpt_8812 *phy_sts = NULL; + #ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + #endif + + phy_sts = (struct phy_status_rpt_8812 *)phy_status_inf; + phydm_rx_physts_bw_parsing(phy_info, pktinfo, phy_sts); + + /* @== [CCK rate] ====================================================*/ + if (pktinfo->is_cck_rate) { + cck_agc_rpt = phy_sts->cfosho[0]; + lna_idx = (cck_agc_rpt & 0xE0) >> 5; + vga_idx = cck_agc_rpt & 0x1F; + + rx_pwr_db = phydm_get_cck_rssi(dm, lna_idx, vga_idx); + rssi = phydm_pwr_2_percent(rx_pwr_db); + + if (dm->support_ic_type == ODM_RTL8812 && + !dm->is_cck_high_power) { + if (rssi >= 80) { + rssi = ((rssi - 80) << 1) + + ((rssi - 80) >> 1) + 80; + } else if ((rssi <= 78) && (rssi >= 20)) { + rssi += 3; + } + } + dm->cck_lna_idx = lna_idx; + dm->cck_vga_idx = vga_idx; + + phy_info->rx_pwdb_all = rssi; + phy_info->rx_mimo_signal_strength[0] = rssi; + } else { + /* @== [OFDM rate] ===================================================*/ + for (i = RF_PATH_A; i < dm->num_rf_path; i++) { + /*@[RSSI]*/ + if (dm->rf_path_rx_enable & BIT(i)) + rf_rx_num++; + + if (i < RF_PATH_C) + val = phy_sts->gain_trsw[i]; + else + val = phy_sts->gain_trsw_cd[i - 2]; + + phy_info->rx_pwr[i] = (val & 0x7F) - 110; + rssi = phydm_pwr_2_percent(phy_info->rx_pwr[i]); + phy_info->rx_mimo_signal_strength[i] = rssi; + + /*@[SNR]*/ + if (i < RF_PATH_C) + val_s8 = phy_sts->rxsnr[i]; + else if (dm->support_ic_type & (ODM_RTL8814A)) + val_s8 = (s8)phy_sts->csi_current[i - 2]; + + phy_info->rx_snr[i] = val_s8 >> 1; + + /*@[CFO_short & CFO_tail]*/ + if (i < RF_PATH_C) { + val_s8 = phy_sts->cfosho[i]; + phy_info->cfo_short[i] = phydm_cfo(val_s8); + val_s8 = phy_sts->cfotail[i]; + phy_info->cfo_tail[i] = phydm_cfo(val_s8); + } + + if (i < RF_PATH_C && pktinfo->is_to_self) + dm->ofdm_agc_idx[i] = phy_sts->gain_trsw[i]; + } + + /* @== [PWDB] ========================================================*/ + + /*@(Avg PWDB calculated by hardware*/ + if (!dm->is_mp_chip) /*@8812, 8821*/ + val = phy_sts->pwdb_all; + else + val = phy_sts->pwdb_all >> 1; /*old fomula*/ + + rx_pwr_db = (val & 0x7f) - 110; + phy_info->rx_pwdb_all = phydm_pwr_2_percent(rx_pwr_db); + + /*@(4)EVM of OFDM rate*/ + for (i = 0; i < pktinfo->rate_ss; i++) { + if (!pktinfo->is_cck_rate && + pktinfo->data_rate <= ODM_RATE54M) { + val_s8 = phy_sts->sigevm; + } else if (i < RF_PATH_C) { + if (phy_sts->rxevm[i] == -128) + phy_sts->rxevm[i] = -25; + + val_s8 = phy_sts->rxevm[i]; + } else { + if (phy_sts->rxevm_cd[i - 2] == -128) + phy_sts->rxevm_cd[i - 2] = -25; + + val_s8 = phy_sts->rxevm_cd[i - 2]; + } + /*@[EVM to 0~100%]*/ + val = phydm_evm_2_percent(val_s8); + phy_info->rx_mimo_signal_quality[i] = val; + /*@[EVM dBm]*/ + phy_info->rx_mimo_evm_dbm[i] = phydm_evm_dbm(val_s8); + } + phydm_parsing_cfo(dm, pktinfo, + phy_sts->cfotail, pktinfo->rate_ss); + } + + /* @== [General Info] ================================================*/ + + phy_info->rx_power = rx_pwr_db; + phy_info->bt_rx_rssi_percentage = phy_info->rx_pwdb_all; + phy_info->recv_signal_power = phy_info->rx_power; + phydm_get_sq(dm, phy_info, pktinfo->is_cck_rate); + + dm->rx_pwdb_ave = dm->rx_pwdb_ave + phy_info->rx_pwdb_all; + + #ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY + fat_tab->hw_antsw_occur = phy_sts->hw_antsw_occur; + dm->dm_fat_table.antsel_rx_keep_0 = phy_sts->antidx_anta; + dm->dm_fat_table.antsel_rx_keep_1 = phy_sts->antidx_antb; + dm->dm_fat_table.antsel_rx_keep_2 = phy_sts->antidx_antc; + dm->dm_fat_table.antsel_rx_keep_3 = phy_sts->antidx_antd; + #endif +} + +#endif + +void phydm_reset_rssi_for_dm(struct dm_struct *dm, u8 station_id) +{ + struct cmn_sta_info *sta; + + sta = dm->phydm_sta_info[station_id]; + + if (!is_sta_active(sta)) + return; + PHYDM_DBG(dm, DBG_RSSI_MNTR, "Reset RSSI for macid = (( %d ))\n", + station_id); + + sta->rssi_stat.rssi_cck = -1; + sta->rssi_stat.rssi_ofdm = -1; + sta->rssi_stat.rssi = -1; + sta->rssi_stat.ofdm_pkt_cnt = 0; + sta->rssi_stat.cck_pkt_cnt = 0; + sta->rssi_stat.cck_sum_power = 0; + sta->rssi_stat.is_send_rssi = RA_RSSI_STATE_INIT; + sta->rssi_stat.packet_map = 0; + sta->rssi_stat.valid_bit = 0; +} + +#if (ODM_IC_11N_SERIES_SUPPORT || ODM_IC_11AC_SERIES_SUPPORT) + +s32 phydm_get_rssi_8814_ofdm(struct dm_struct *dm, u8 *rssi_in) +{ + s32 rssi_avg; + u8 rx_count = 0; + u64 rssi_linear = 0; + + if (dm->rx_ant_status & BB_PATH_A) { + rx_count++; + rssi_linear += phydm_db_2_linear(rssi_in[RF_PATH_A]); + } + + if (dm->rx_ant_status & BB_PATH_B) { + rx_count++; + rssi_linear += phydm_db_2_linear(rssi_in[RF_PATH_B]); + } + + if (dm->rx_ant_status & BB_PATH_C) { + rx_count++; + rssi_linear += phydm_db_2_linear(rssi_in[RF_PATH_C]); + } + + if (dm->rx_ant_status & BB_PATH_D) { + rx_count++; + rssi_linear += phydm_db_2_linear(rssi_in[RF_PATH_D]); + } + + /* @Rounding and removing fractional bits */ + rssi_linear = (rssi_linear + (1 << (FRAC_BITS - 1))) >> FRAC_BITS; + + /* @Calculate average RSSI */ + switch (rx_count) { + case 2: + rssi_linear = DIVIDED_2(rssi_linear); + break; + case 3: + rssi_linear = DIVIDED_3(rssi_linear); + break; + case 4: + rssi_linear = DIVIDED_4(rssi_linear); + break; + } + rssi_avg = odm_convert_to_db(rssi_linear); + + return rssi_avg; +} + +void phydm_process_rssi_for_dm(struct dm_struct *dm, + struct phydm_phyinfo_struct *phy_info, + struct phydm_perpkt_info_struct *pktinfo) +{ + s32 rssi_ave = 0; /*@average among all paths*/ + s8 rssi_all = 0; /*@average value of CCK & OFDM*/ + s8 rssi_cck_tmp = 0, rssi_ofdm_tmp = 0; + u8 i = 0; + u8 rssi_max = 0, rssi_min = 0; + u32 w1 = 0, w2 = 0; /*weighting*/ + u8 send_rssi_2_fw = 0; + u8 *rssi_tmp = NULL; + struct cmn_sta_info *sta = NULL; + struct rssi_info *rssi_t = NULL; + #ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY + #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + #endif + #endif + + if (pktinfo->station_id >= ODM_ASSOCIATE_ENTRY_NUM) + return; + + #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY + odm_s0s1_sw_ant_div_by_ctrl_frame_process_rssi(dm, phy_info, pktinfo); + #endif + #ifdef ODM_EVM_ENHANCE_ANTDIV + phydm_rx_rate_for_antdiv(dm, pktinfo); + #endif + + sta = dm->phydm_sta_info[pktinfo->station_id]; + + if (!is_sta_active(sta)) + return; + + rssi_t = &sta->rssi_stat; + + #ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY + #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) + if ((dm->support_ability & ODM_BB_ANT_DIV) && + fat_tab->enable_ctrl_frame_antdiv) { + if (pktinfo->is_packet_match_bssid) + dm->data_frame_num++; + + if (fat_tab->use_ctrl_frame_antdiv) { + if (!pktinfo->is_to_self) /*@data frame + CTRL frame*/ + return; + } else { + /*@data frame only*/ + if (!pktinfo->is_packet_match_bssid) + return; + } + } else + #endif + #endif + { + if (!pktinfo->is_packet_match_bssid) /*@data frame only*/ + return; + } + + if (pktinfo->is_packet_beacon) { + dm->phy_dbg_info.num_qry_beacon_pkt++; + dm->phy_dbg_info.beacon_phy_rate = pktinfo->data_rate; + } + + /* @--------------Statistic for antenna/path diversity--------------- */ + #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) + if (dm->support_ability & ODM_BB_ANT_DIV) + odm_process_rssi_for_ant_div(dm, phy_info, pktinfo); + #endif + + #if (defined(CONFIG_PATH_DIVERSITY)) + if (dm->support_ability & ODM_BB_PATH_DIV) + phydm_process_rssi_for_path_div(dm, phy_info, pktinfo); + #endif + /* @----------------------------------------------------------------- */ + + rssi_cck_tmp = rssi_t->rssi_cck; + rssi_ofdm_tmp = rssi_t->rssi_ofdm; + rssi_all = rssi_t->rssi; + + if (!(pktinfo->is_packet_to_self || pktinfo->is_packet_beacon)) + return; + + if (!pktinfo->is_cck_rate) { +/* @=== [ofdm RSSI] ======================================================== */ + rssi_tmp = phy_info->rx_mimo_signal_strength; + + #if (RTL8814A_SUPPORT == 1) + if (dm->support_ic_type & (ODM_RTL8814A)) { + rssi_ave = phydm_get_rssi_8814_ofdm(dm, rssi_tmp); + } else + #endif + { + if (rssi_tmp[RF_PATH_B] == 0) { + rssi_ave = rssi_tmp[RF_PATH_A]; + } else { + if (rssi_tmp[RF_PATH_A] > rssi_tmp[RF_PATH_B]) { + rssi_max = rssi_tmp[RF_PATH_A]; + rssi_min = rssi_tmp[RF_PATH_B]; + } else { + rssi_max = rssi_tmp[RF_PATH_B]; + rssi_min = rssi_tmp[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; + } + } + + /* OFDM MA RSSI */ + if (rssi_ofdm_tmp <= 0) { /* @initialize */ + rssi_ofdm_tmp = (s8)phy_info->rx_pwdb_all; + } else { + rssi_ofdm_tmp = (s8)WEIGHTING_AVG(rssi_ofdm_tmp, + (1 << RSSI_MA) - 1, + rssi_ave, 1); + if (phy_info->rx_pwdb_all > (u32)rssi_ofdm_tmp) + rssi_ofdm_tmp++; + } + + PHYDM_DBG(dm, DBG_RSSI_MNTR, "rssi_ofdm=%d\n", rssi_ofdm_tmp); + } else { +/* @=== [cck RSSI] ========================================================= */ + rssi_ave = phy_info->rx_pwdb_all; + + if (rssi_t->cck_pkt_cnt <= 63) + rssi_t->cck_pkt_cnt++; + + /* @1 Process CCK RSSI */ + if (rssi_cck_tmp <= 0) { /* @initialize */ + rssi_cck_tmp = (s8)phy_info->rx_pwdb_all; + rssi_t->cck_sum_power = (u16)phy_info->rx_pwdb_all; + rssi_t->cck_pkt_cnt = 1; /*reset*/ + PHYDM_DBG(dm, DBG_RSSI_MNTR, "[1]CCK_INIT\n"); + } else if (rssi_t->cck_pkt_cnt <= CCK_RSSI_INIT_COUNT) { + rssi_t->cck_sum_power = rssi_t->cck_sum_power + + (u16)phy_info->rx_pwdb_all; + + rssi_cck_tmp = rssi_t->cck_sum_power / + rssi_t->cck_pkt_cnt; + + PHYDM_DBG(dm, DBG_RSSI_MNTR, + "[2]SumPow=%d, cck_pkt=%d\n", + rssi_t->cck_sum_power, rssi_t->cck_pkt_cnt); + } else { + rssi_cck_tmp = (s8)WEIGHTING_AVG(rssi_cck_tmp, + (1 << RSSI_MA) - 1, + phy_info->rx_pwdb_all, + 1); + if (phy_info->rx_pwdb_all > (u32)rssi_cck_tmp) + rssi_cck_tmp++; + } + PHYDM_DBG(dm, DBG_RSSI_MNTR, "rssi_cck=%d\n", rssi_cck_tmp); + } + +/* @=== [ofdm + cck weighting RSSI] ========================================= */ + if (!pktinfo->is_cck_rate) { + if (rssi_t->ofdm_pkt_cnt < 8 && !(rssi_t->packet_map & BIT(7))) + rssi_t->ofdm_pkt_cnt++; /*OFDM packet cnt in bitmap*/ + + rssi_t->packet_map = (rssi_t->packet_map << 1) | BIT(0); + } else { + if (rssi_t->ofdm_pkt_cnt > 0 && rssi_t->packet_map & BIT(7)) + rssi_t->ofdm_pkt_cnt--; + + rssi_t->packet_map = rssi_t->packet_map << 1; + } + + if (rssi_t->ofdm_pkt_cnt == 8) { + rssi_all = rssi_ofdm_tmp; + } else { + if (rssi_t->valid_bit < 8) + rssi_t->valid_bit++; + + if (rssi_t->valid_bit == 8) { + if (rssi_t->ofdm_pkt_cnt > 4) + w1 = 64; + else + w1 = (u32)(rssi_t->ofdm_pkt_cnt << 4); + + w2 = 64 - w1; + + rssi_all = (s8)((w1 * (u32)rssi_ofdm_tmp + + w2 * (u32)rssi_cck_tmp) >> 6); + } else if (rssi_t->valid_bit != 0) { /*@(valid_bit > 8)*/ + w1 = (u32)rssi_t->ofdm_pkt_cnt; + w2 = (u32)(rssi_t->valid_bit - rssi_t->ofdm_pkt_cnt); + rssi_all = (s8)WEIGHTING_AVG((u32)rssi_ofdm_tmp, w1, + (u32)rssi_cck_tmp, w2); + } else { + rssi_all = 0; + } + } + PHYDM_DBG(dm, DBG_RSSI_MNTR, "rssi=%d,w1=%d,w2=%d\n", rssi_all, w1, w2); + + if ((rssi_t->ofdm_pkt_cnt >= 1 || rssi_t->cck_pkt_cnt >= 5) && + rssi_t->is_send_rssi == RA_RSSI_STATE_INIT) { + send_rssi_2_fw = 1; + rssi_t->is_send_rssi = RA_RSSI_STATE_SEND; + } + + rssi_t->rssi_cck = rssi_cck_tmp; + rssi_t->rssi_ofdm = rssi_ofdm_tmp; + rssi_t->rssi = rssi_all; + + if (send_rssi_2_fw) { /* Trigger init rate by RSSI */ + if (rssi_t->ofdm_pkt_cnt != 0) + rssi_t->rssi = rssi_ofdm_tmp; + + PHYDM_DBG(dm, DBG_RSSI_MNTR, + "[Send to FW] PWDB=%d, ofdm_pkt=%d, cck_pkt=%d\n", + rssi_all, rssi_t->ofdm_pkt_cnt, rssi_t->cck_pkt_cnt); + } + +#if 0 + /* @dbg_print("ofdm_pkt=%d, weighting=%d\n", ofdm_pkt_cnt, weighting);*/ + /* @dbg_print("rssi_ofdm_tmp=%d, rssi_all=%d, rssi_cck_tmp=%d\n", */ + /* rssi_ofdm_tmp, rssi_all, rssi_cck_tmp); */ +#endif +} +#endif + +#ifdef PHYSTS_3RD_TYPE_SUPPORT +void phydm_print_phystat_jaguar3(struct dm_struct *dm, u8 *phy_sts, + struct phydm_perpkt_info_struct *pktinfo, + struct phydm_phyinfo_struct *phy_info) +{ + struct phy_sts_rpt_jgr3_type0 *rpt0 = NULL; + struct phy_sts_rpt_jgr3_type1 *rpt1 = NULL; + struct phy_sts_rpt_jgr3_type2_3 *rpt2 = NULL; + struct phy_sts_rpt_jgr3_type4 *rpt3 = NULL; + struct phy_sts_rpt_jgr3_type5 *rpt4 = NULL; + struct odm_phy_dbg_info *dbg = &dm->phy_dbg_info; + u8 phy_status_page_num = (*phy_sts & 0xf); + u32 phy_status_tmp[PHY_STATUS_JRGUAR3_DW_LEN] = {0}; + u8 i = 0; + u32 size = PHY_STATUS_JRGUAR3_DW_LEN << 2; + + rpt0 = (struct phy_sts_rpt_jgr3_type0 *)phy_sts; + rpt1 = (struct phy_sts_rpt_jgr3_type1 *)phy_sts; + rpt2 = (struct phy_sts_rpt_jgr3_type2_3 *)phy_sts; + rpt3 = (struct phy_sts_rpt_jgr3_type4 *)phy_sts; + rpt4 = (struct phy_sts_rpt_jgr3_type5 *)phy_sts; + + odm_move_memory(dm, phy_status_tmp, phy_sts, size); + if (!(dm->debug_components & DBG_PHY_STATUS)) + return; + + if (dbg->show_phy_sts_all_pkt == 0) { + if (!pktinfo->is_packet_match_bssid) + return; + } + + dbg->show_phy_sts_cnt++; + + if (dbg->show_phy_sts_max_cnt != SHOW_PHY_STATUS_UNLIMITED) { + if (dbg->show_phy_sts_cnt > dbg->show_phy_sts_max_cnt) + return; + } + + if (phy_status_page_num == 0) + pr_debug("Phy Status Rpt: CCK\n"); + else + pr_debug("Phy Status Rpt: OFDM_%d\n", phy_status_page_num); + + pr_debug("StaID=%d, RxRate = 0x%x match_bssid=%d\n", + pktinfo->station_id, pktinfo->data_rate, + pktinfo->is_packet_match_bssid); + + for (i = 0; i < PHY_STATUS_JRGUAR3_DW_LEN; i++) + pr_debug("Offset[%d:%d] = 0x%x\n", + ((4 * i) + 3), (4 * i), phy_status_tmp[i]); + + if (phy_status_page_num == 0) { /* @CCK(default) */ + pr_debug("[0] Pkt_cnt=%d, Channel_msb=%d, Pwdb_a=%d, Gain_a=%d, TRSW=%d, AGC_table_b=%d, AGC_table_c=%d,\n", + rpt0->pkt_cnt, rpt0->channel_msb, rpt0->pwdb_a, + rpt0->gain_a, rpt0->trsw, rpt0->agc_table_b, + rpt0->agc_table_c); + pr_debug("[4] Path_Sel_o=%d, Gnt_BT_keep_cnt=%d, HW_AntSW_occur_keep_cck=%d,\n Band=%d, Channel=%d, AGC_table_a=%d, l_RXSC=%d, AGC_table_d=%d\n", + rpt0->path_sel_o, rpt0->gnt_bt_keep_cck, + rpt0->hw_antsw_occur_keep_cck, rpt0->band, + rpt0->channel, rpt0->agc_table_a, rpt0->l_rxsc, + rpt0->agc_table_d); + pr_debug("[8] AntIdx={%d, %d, %d, %d}, Length=%d\n", + rpt0->antidx_d, rpt0->antidx_c, rpt0->antidx_b, + rpt0->antidx_a, rpt0->length); + pr_debug("[12] MF_off=%d, SQloss=%d, lockbit=%d, raterr=%d, rxrate=%d, lna_h_a=%d, CCK_BB_power_a=%d, lna_l_a=%d, vga_a=%d, sq=%d\n", + rpt0->mf_off, rpt0->sqloss, rpt0->lockbit, + rpt0->raterr, rpt0->rxrate, rpt0->lna_h_a, + rpt0->bb_power_a, rpt0->lna_l_a, rpt0->vga_a, + rpt0->signal_quality); + pr_debug("[16] Gain_b=%d, lna_h_b=%d, CCK_BB_power_b=%d, lna_l_b=%d, vga_b=%d, Pwdb_b=%d\n", + rpt0->gain_b, rpt0->lna_h_b, rpt0->bb_power_b, + rpt0->lna_l_b, rpt0->vga_b, rpt0->pwdb_b); + pr_debug("[20] Gain_c=%d, lna_h_c=%d, CCK_BB_power_c=%d, lna_l_c=%d, vga_c=%d, Pwdb_c=%d\n", + rpt0->gain_c, rpt0->lna_h_c, rpt0->bb_power_c, + rpt0->lna_l_c, rpt0->vga_c, rpt0->pwdb_c); + pr_debug("[24] Gain_d=%d, lna_h_d=%d, CCK_BB_power_d=%d, lna_l_d=%d, vga_d=%d, Pwdb_d=%d\n", + rpt0->gain_c, rpt0->lna_h_c, rpt0->bb_power_c, + rpt0->lna_l_c, rpt0->vga_c, rpt0->pwdb_c); + } else if (phy_status_page_num == 1) { + pr_debug("[0] pwdb[C:A]={%d, %d, %d}, Channel_pri_msb=%d, Pkt_cnt=%d,\n", + rpt1->pwdb_c, rpt1->pwdb_b, rpt1->pwdb_a, + rpt1->channel_pri_msb, rpt1->pkt_cnt); + pr_debug("[4] BF: %d, stbc=%d, ldpc=%d, gnt_bt=%d, band=%d, Ch_pri_lsb=%d, rxsc[ht, l]={%d, %d}, pwdb[D]=%d\n", + rpt1->beamformed, rpt1->stbc, rpt1->ldpc, rpt1->gnt_bt, + rpt1->band, rpt1->channel_pri_lsb, rpt1->ht_rxsc, + rpt1->l_rxsc, rpt1->pwdb_d); + pr_debug("[8] AntIdx[D:A]={%d, %d, %d, %d}, HW_AntSW_occur[D:A]={%d, %d, %d, %d}, Channel_sec[msb,lsb]={%d, %d}\n", + rpt1->antidx_d, rpt1->antidx_c, + rpt1->antidx_b, rpt1->antidx_a, + rpt1->hw_antsw_occur_d, rpt1->hw_antsw_occur_c, + rpt1->hw_antsw_occur_b, rpt1->hw_antsw_occur_a, + rpt1->channel_sec_msb, rpt1->channel_sec_lsb); + pr_debug("[12] GID=%d, PAID[msb,lsb]={%d,%d}\n", + rpt1->gid, rpt1->paid_msb, rpt1->paid); + pr_debug("[16] RX_EVM[D:A]={%d, %d, %d, %d}\n", + rpt1->rxevm[3], rpt1->rxevm[2], + rpt1->rxevm[1], rpt1->rxevm[0]); + pr_debug("[20] CFO_tail[D:A]={%d, %d, %d, %d}\n", + rpt1->cfo_tail[3], rpt1->cfo_tail[2], + rpt1->cfo_tail[1], rpt1->cfo_tail[0]); + pr_debug("[24] RX_SNR[D:A]={%d, %d, %d, %d}\n\n", + rpt1->rxsnr[3], rpt1->rxsnr[2], + rpt1->rxsnr[1], rpt1->rxsnr[0]); + } else if (phy_status_page_num == 2 || phy_status_page_num == 3) { + pr_debug("[0] pwdb[C:A]={%d, %d, %d}, Channel_mdb=%d, Pkt_cnt=%d\n", + rpt2->pwdb[2], rpt2->pwdb[1], rpt2->pwdb[0], + rpt2->channel_msb, rpt2->pkt_cnt); + pr_debug("[4] BF=%d, STBC=%d, LDPC=%d, Gnt_BT=%d, band=%d, CH_lsb=%d, rxsc[ht, l]={%d, %d}, pwdb_D=%d\n", + rpt2->beamformed, rpt2->stbc, rpt2->ldpc, rpt2->gnt_bt, + rpt2->band, rpt2->channel_lsb, + rpt2->ht_rxsc, rpt2->l_rxsc, rpt2->pwdb[3]); + pr_debug("[8] AgcTab[D:A]={%d, %d, %d, %d}, pwed_th=%d, shift_l_map=%d\n", + rpt2->agc_table_d, rpt2->agc_table_c, + rpt2->agc_table_b, rpt2->agc_table_a, + rpt2->pwed_th, rpt2->shift_l_map); + pr_debug("[12] AvgNoisePowerdB=%d, mp_gain_c[msb, lsb]={%d, %d}, mp_gain_b[msb, lsb]={%d, %d}, mp_gain_a=%d, cnt_cca2agc_rdy=%d\n", + rpt2->avg_noise_pwr_lsb, rpt2->mp_gain_c_msb, + rpt2->mp_gain_c_lsb, rpt2->mp_gain_b_msb, + rpt2->mp_gain_b_lsb, rpt2->mp_gain_a, + rpt2->cnt_cca2agc_rdy); + pr_debug("[16] HT AAGC gain[B:A]={%d, %d}, AAGC step[D:A]={%d, %d, %d, %d}, IsFreqSelectFadimg=%d, mp_gain_d=%d\n", + rpt2->ht_aagc_gain[1], rpt2->ht_aagc_gain[0], + rpt2->aagc_step_d, rpt2->aagc_step_c, + rpt2->aagc_step_b, rpt2->aagc_step_a, + rpt2->is_freq_select_fading, rpt2->mp_gain_d); + pr_debug("[20] DAGC gain ant[B:A]={%d, %d}, HT AAGC gain[D:C]={%d, %d}\n", + rpt2->dagc_gain[1], rpt2->dagc_gain[0], + rpt2->ht_aagc_gain[3], rpt2->ht_aagc_gain[2]); + pr_debug("[24] AvgNoisePwerdB=%d, syn_count[msb, lsb]={%d, %d}, counter=%d, DAGC gain ant[D:C]={%d, %d}\n", + rpt2->avg_noise_pwr_msb, rpt2->syn_count_msb, + rpt2->syn_count_lsb, rpt2->counter, + rpt2->dagc_gain[3], rpt2->dagc_gain[2]); + } else if (phy_status_page_num == 4) { /*type 4*/ + pr_debug("[0] pwdb[C:A]={%d, %d, %d}, Channel_mdb=%d, Pkt_cnt=%d\n", + rpt3->pwdb[2], rpt3->pwdb[1], rpt3->pwdb[0], + rpt3->channel_msb, rpt3->pkt_cnt); + pr_debug("[4] BF=%d, STBC=%d, LDPC=%d, GNT_BT=%d, band=%d, CH_pri=%d, rxsc[ht, l]={%d, %d}, pwdb_D=%d\n", + rpt3->beamformed, rpt3->stbc, rpt3->ldpc, rpt3->gnt_bt, + rpt3->band, rpt3->channel_lsb, rpt3->ht_rxsc, + rpt3->l_rxsc, rpt3->pwdb[3]); + pr_debug("[8] AntIdx[D:A]={%d, %d, %d, %d}, HW_AntSW_occur[D:A]={%d, %d, %d, %d}, Training_done[D:A]={%d, %d, %d, %d},\n BadToneCnt_CN_excess_0=%d, BadToneCnt_min_eign_0=%d\n", + rpt3->antidx_d, rpt3->antidx_c, + rpt3->antidx_b, rpt3->antidx_a, + rpt3->hw_antsw_occur_d, rpt3->hw_antsw_occur_c, + rpt3->hw_antsw_occur_b, rpt3->hw_antsw_occur_a, + rpt3->training_done_d, rpt3->training_done_c, + rpt3->training_done_b, rpt3->training_done_a, + rpt3->bad_tone_cnt_cn_excess_0, + rpt3->bad_tone_cnt_min_eign_0); + pr_debug("[12] avg_cond_num_1_msb=%d, avg_cond_num_1_lsb=%d, avg_cond_num_0=%d, bad_tone_cnt_cn_excess_1=%d,\n bad_tone_cnt_min_eign_1=%d, Tx_pkt_cnt=%d\n", + rpt3->avg_cond_num_1_msb, rpt3->avg_cond_num_1_lsb, + rpt3->avg_cond_num_0, rpt3->bad_tone_cnt_cn_excess_1, + rpt3->bad_tone_cnt_min_eign_1, rpt3->tx_pkt_cnt); + pr_debug("[16] Stream RXEVM[D:A]={%d, %d, %d, %d}\n", + rpt3->rxevm[3], rpt3->rxevm[2], + rpt3->rxevm[1], rpt3->rxevm[0]); + pr_debug("[20] Eigenvalue[D:A]={%d, %d, %d, %d}\n", + rpt3->eigenvalue[3], rpt3->eigenvalue[2], + rpt3->eigenvalue[1], rpt3->eigenvalue[0]); + pr_debug("[24] RX SNR[D:A]={%d, %d, %d, %d}\n", + rpt3->rxsnr[3], rpt3->rxsnr[2], + rpt3->rxsnr[1], rpt3->rxsnr[0]); + } else if (phy_status_page_num == 5) { /*type 5*/ + pr_debug("[0] pwdb[C:A]={%d, %d, %d}, Channel_mdb=%d, Pkt_cnt=%d\n", + rpt4->pwdb[2], rpt4->pwdb[1], rpt4->pwdb[0], + rpt4->channel_msb, rpt4->pkt_cnt); + pr_debug("[4] BF=%d, STBC=%d, LDPC=%d, GNT_BT=%d, band=%d, CH_pri=%d, rxsc[ht, l]={%d, %d}, pwdb_D=%d\n", + rpt4->beamformed, rpt4->stbc, rpt4->ldpc, rpt4->gnt_bt, + rpt4->band, rpt4->channel_lsb, rpt4->ht_rxsc, + rpt4->l_rxsc, rpt4->pwdb[3]); + pr_debug("[8] AntIdx[D:A]={%d, %d, %d, %d}, HW_AntSW_occur[D:A]={%d, %d, %d, %d}\n", + rpt4->antidx_d, rpt4->antidx_c, + rpt4->antidx_b, rpt4->antidx_a, + rpt4->hw_antsw_occur_d, rpt4->hw_antsw_occur_c, + rpt4->hw_antsw_occur_b, rpt4->hw_antsw_occur_a); + pr_debug("[12] Inf_posD[1,0]={%d, %d}, Inf_posC[1,0]={%d, %d}, Inf_posB[1,0]={%d, %d}, Inf_posA[1,0]={%d, %d}, Tx_pkt_cnt=%d\n", + rpt4->inf_pos_1_D_flg, rpt4->inf_pos_0_D_flg, + rpt4->inf_pos_1_C_flg, rpt4->inf_pos_0_C_flg, + rpt4->inf_pos_1_B_flg, rpt4->inf_pos_0_B_flg, + rpt4->inf_pos_1_A_flg, rpt4->inf_pos_0_A_flg, + rpt4->tx_pkt_cnt); + pr_debug("[16] Inf_pos_B[1,0]={%d, %d}, Inf_pos_A[1,0]={%d, %d}\n", + rpt4->inf_pos_1_b, rpt4->inf_pos_0_b, + rpt4->inf_pos_1_a, rpt4->inf_pos_0_a); + pr_debug("[20] Inf_pos_D[1,0]={%d, %d}, Inf_pos_C[1,0]={%d, %d}\n", + rpt4->inf_pos_1_d, rpt4->inf_pos_0_d, + rpt4->inf_pos_1_c, rpt4->inf_pos_0_c); + } +} + +void phydm_reset_phy_info_3rd(struct dm_struct *phydm, + struct phydm_phyinfo_struct *phy_info) +{ + phy_info->rx_pwdb_all = 0; + phy_info->signal_quality = 0; + phy_info->band_width = 0; + phy_info->rx_count = 0; + odm_memory_set(phydm, phy_info->rx_mimo_signal_quality, 0, 4); + odm_memory_set(phydm, phy_info->rx_mimo_signal_strength, 0, 4); + odm_memory_set(phydm, phy_info->rx_snr, 0, 4); + + phy_info->rx_power = -110; + phy_info->recv_signal_power = -110; + phy_info->bt_rx_rssi_percentage = 0; + phy_info->signal_strength = 0; + phy_info->channel = 0; + phy_info->is_mu_packet = 0; + phy_info->is_beamformed = 0; + phy_info->rxsc = 0; + odm_memory_set(phydm, phy_info->rx_pwr, -110, 4); + odm_memory_set(phydm, phy_info->cfo_short, 0, 8); + odm_memory_set(phydm, phy_info->cfo_tail, 0, 8); + + odm_memory_set(phydm, phy_info->rx_mimo_evm_dbm, 0, 4); +} + +void phydm_per_path_info_3rd(u8 rx_path, s8 pwr, s8 rx_evm, s8 cfo_tail, + s8 rx_snr, struct phydm_phyinfo_struct *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); + + if (evm_dbm == 64) + evm_dbm = 0; /*@if 1SS rate, evm_dbm [2nd stream] =64*/ + + if (evm_dbm != 0) { + /* @Convert EVM to 0%~100% percentage */ + if (evm_dbm >= 34) + evm_percentage = 100; + else + evm_percentage = (evm_dbm << 1) + (evm_dbm); + } + } + + phy_info->rx_pwr[rx_path] = pwr; + + /*@CFO(kHz) = CFO_tail * 312.5(kHz) / 2^7 ~= CFO tail * 5/2 (kHz)*/ + phy_info->cfo_tail[rx_path] = (cfo_tail * 5) >> 1; + phy_info->rx_mimo_evm_dbm[rx_path] = evm_dbm; + phy_info->rx_mimo_signal_strength[rx_path] = phydm_pwr_2_percent(pwr); + phy_info->rx_mimo_signal_quality[rx_path] = evm_percentage; + phy_info->rx_snr[rx_path] = rx_snr >> 1; +} + +void phydm_common_phy_info_3rd(s8 rx_power, u8 channel, boolean is_beamformed, + boolean is_mu_packet, u8 bandwidth, + u8 signal_quality, u8 rxsc, + struct phydm_phyinfo_struct *phy_info) +{ + phy_info->rx_power = rx_power; /* RSSI in dB */ + phy_info->recv_signal_power = rx_power; /* RSSI in dB */ + phy_info->channel = channel; /* @channel number */ + phy_info->is_beamformed = is_beamformed; /* @apply BF */ + phy_info->is_mu_packet = is_mu_packet; /* @MU packet */ + phy_info->rxsc = rxsc; + + phy_info->rx_pwdb_all = phydm_pwr_2_percent(rx_power); /*percentage */ + phy_info->signal_quality = signal_quality; /* signal quality */ + phy_info->band_width = bandwidth; /* @bandwidth */ + +#if 0 + /* @if (pktinfo->is_packet_match_bssid) */ + { + dbg_print("rx_pwdb_all = %d, rx_power = %d, recv_signal_power = %d\n", phy_info->rx_pwdb_all, phy_info->rx_power, phy_info->recv_signal_power); + dbg_print("signal_quality = %d\n", phy_info->signal_quality); + dbg_print("is_beamformed = %d, is_mu_packet = %d, rx_count = %d\n", phy_info->is_beamformed, phy_info->is_mu_packet, phy_info->rx_count + 1); + dbg_print("channel = %d, rxsc = %d, band_width = %d\n", channel, rxsc, bandwidth); + } +#endif +} + +void phydm_get_physts_jarguar3_0(struct dm_struct *dm, u8 *phy_status_inf, + struct phydm_perpkt_info_struct *pktinfo, + struct phydm_phyinfo_struct *phy_info) +{ + /* type 0 is used for cck packet */ + struct phy_sts_rpt_jgr3_type0 *phy_sts = NULL; + struct odm_phy_dbg_info *dbg_i = &dm->phy_dbg_info; + u8 sq = 0, i; + s8 rx_power[4]; + s8 rx_pwr_db_max = -120; + + phy_sts = (struct phy_sts_rpt_jgr3_type0 *)phy_status_inf; + + rx_power[0] = phy_sts->pwdb_a; + rx_power[1] = phy_sts->pwdb_b; + rx_power[2] = phy_sts->pwdb_c; + rx_power[3] = phy_sts->pwdb_d; + + #if (RTL8822C_SUPPORT) + if (dm->support_ic_type & ODM_RTL8822C) { + struct phydm_physts *physts_table = &dm->dm_physts_table; + if (phy_sts->gain_a < physts_table->cck_gi_l_bnd) + rx_power[0] += ((physts_table->cck_gi_l_bnd - + phy_sts->gain_a) << 1); + else if (phy_sts->gain_a > physts_table->cck_gi_u_bnd) + rx_power[0] -= ((phy_sts->gain_a - + physts_table->cck_gi_u_bnd) << 1); + + if (phy_sts->gain_b < physts_table->cck_gi_l_bnd) + rx_power[1] += ((physts_table->cck_gi_l_bnd - + phy_sts->gain_b) << 1); + else if (phy_sts->gain_b > physts_table->cck_gi_u_bnd) + rx_power[1] -= ((phy_sts->gain_b - + physts_table->cck_gi_u_bnd) << 1); + } + #endif + + /* @Setting the RX power: agc_idx -110 dBm*/ + rx_power[0] -= 110; + rx_power[1] -= 110; + rx_power[2] -= 110; + rx_power[3] -= 110; + + for (i = RF_PATH_A; i < PHYDM_MAX_RF_PATH; i++) { + if (rx_power[i] > rx_pwr_db_max) + rx_pwr_db_max = rx_power[i]; + } + if (pktinfo->is_to_self) { + dm->ofdm_agc_idx[0] = phy_sts->pwdb_a; + dm->ofdm_agc_idx[1] = phy_sts->pwdb_b; + dm->ofdm_agc_idx[2] = phy_sts->pwdb_c; + dm->ofdm_agc_idx[3] = phy_sts->pwdb_d; + } + + /* @Calculate Signal Quality*/ + if (phy_sts->signal_quality >= 64) { + sq = 0; + } else if (phy_sts->signal_quality <= 20) { + sq = 100; + } else { + /* @mapping to 2~99% */ + sq = 64 - phy_sts->signal_quality; + sq = ((sq << 3) + sq) >> 2; + } + + /* @Modify CCK PWDB if old AGC */ + if (!dm->cck_new_agc) { + u8 lna_idx[4], vga_idx[4]; + + lna_idx[0] = ((phy_sts->lna_h_a << 3) | phy_sts->lna_l_a); + vga_idx[0] = phy_sts->vga_a; + lna_idx[1] = ((phy_sts->lna_h_b << 3) | phy_sts->lna_l_b); + vga_idx[1] = phy_sts->vga_b; + lna_idx[2] = ((phy_sts->lna_h_c << 3) | phy_sts->lna_l_c); + vga_idx[2] = phy_sts->vga_c; + lna_idx[3] = ((phy_sts->lna_h_d << 3) | phy_sts->lna_l_d); + vga_idx[3] = phy_sts->vga_d; + #if (RTL8198F_SUPPORT) + /*phydm_cck_rssi_8198f*/ + #endif + } + + /*@CCK no STBC and LDPC*/ + dbg_i->is_ldpc_pkt = false; + dbg_i->is_stbc_pkt = false; + + /* Update Common information */ + phydm_common_phy_info_3rd(rx_pwr_db_max, phy_sts->channel, false, + false, CHANNEL_WIDTH_20, sq, + phy_sts->l_rxsc, phy_info); + + /* Update CCK pwdb */ + /* Update per-path information */ + for (i = RF_PATH_A; i < PHYDM_MAX_RF_PATH; i++) + phydm_per_path_info_3rd(i, rx_power[i], 0, 0, 0, phy_info); + + #ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY + dm->dm_fat_table.antsel_rx_keep_0 = phy_sts->antidx_a; + dm->dm_fat_table.antsel_rx_keep_1 = phy_sts->antidx_b; + dm->dm_fat_table.antsel_rx_keep_2 = phy_sts->antidx_c; + dm->dm_fat_table.antsel_rx_keep_3 = phy_sts->antidx_d; + #endif +} + +void phydm_get_physts_jarguar3_1(struct dm_struct *dm, u8 *phy_status_inf, + struct phydm_perpkt_info_struct *pktinfo, + struct phydm_phyinfo_struct *phy_info) +{ + /* type 1 is used for ofdm packet */ + struct phy_sts_rpt_jgr3_type1 *phy_sts = NULL; + struct odm_phy_dbg_info *dbg_i = &dm->phy_dbg_info; + s8 rx_pwr_db = -120; + s8 rx_path_pwr_db; + u8 i, rxsc, bw = CHANNEL_WIDTH_20, rx_cnt = 0; + u8 pwdb[4]; + boolean is_mu; + + phy_sts = (struct phy_sts_rpt_jgr3_type1 *)phy_status_inf; + + pwdb[0] = phy_sts->pwdb_a; + pwdb[1] = phy_sts->pwdb_b; + pwdb[2] = phy_sts->pwdb_c; + pwdb[3] = phy_sts->pwdb_d; + + /* Update per-path information */ + for (i = RF_PATH_A; i < PHYDM_MAX_RF_PATH; i++) { + if (dm->rx_ant_status & BIT(i)) { + rx_cnt++; /* @check the number of the ant */ + + if (rx_cnt > dm->num_rf_path) + break; + + /* Update per-path information + * (RSSI_dB RSSI_percentage EVM SNR CFO sq) + */ + /* @EVM report is reported by stream, not path */ + /* @per-path pw (dB)*/ + rx_path_pwr_db = (s8)pwdb[i] - 110; + + if (pktinfo->is_to_self) + dm->ofdm_agc_idx[i] = pwdb[i]; + + phydm_per_path_info_3rd(i, rx_path_pwr_db, + phy_sts->rxevm[rx_cnt - 1], + phy_sts->cfo_tail[i], + phy_sts->rxsnr[i], phy_info); + + /*@CFO(kHz) = CFO_tail*312.5/2^7 ~= CFO tail*5/2*/ + dbg_i->cfo_tail[i] = (phy_sts->cfo_tail[i] * 5) >> 1; + /* 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_cnt > 0) + phy_info->rx_count = rx_cnt - 1; + + /* @Check if MU packet or not */ + if (phy_sts->gid != 0 && phy_sts->gid != 63) { + is_mu = true; + dbg_i->num_qry_mu_pkt++; + } else { + is_mu = false; + } + + /* @count BF packet */ + dbg_i->num_qry_bf_pkt = dbg_i->num_qry_bf_pkt + phy_sts->beamformed; + + /*STBC or LDPC pkt*/ + dbg_i->is_ldpc_pkt = phy_sts->ldpc; + dbg_i->is_stbc_pkt = phy_sts->stbc; + + /* @Check sub-channel */ + if (pktinfo->data_rate > ODM_RATE11M && + pktinfo->data_rate < ODM_RATEMCS0) + rxsc = phy_sts->l_rxsc; /*@Legacy*/ + else + rxsc = phy_sts->ht_rxsc; /* @HT and VHT */ + + /* @Check RX bandwidth */ + 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 = *dm->band_width; + + /* Update packet information */ + /* RX power choose the path with the maximum power */ + phydm_common_phy_info_3rd(rx_pwr_db, phy_sts->channel_pri_lsb, + (boolean)phy_sts->beamformed, is_mu, + bw, phy_info->rx_mimo_signal_quality[0], + rxsc, phy_info); + + phydm_parsing_cfo(dm, pktinfo, phy_sts->cfo_tail, pktinfo->rate_ss); + +#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) + dm->dm_fat_table.antsel_rx_keep_0 = phy_sts->antidx_a; + dm->dm_fat_table.antsel_rx_keep_1 = phy_sts->antidx_b; + dm->dm_fat_table.antsel_rx_keep_2 = phy_sts->antidx_c; + dm->dm_fat_table.antsel_rx_keep_3 = phy_sts->antidx_d; +#endif +} + +void phydm_get_physts_jarguar3_2_3(struct dm_struct *dm, u8 *phy_status_inf, + struct phydm_perpkt_info_struct *pktinfo, + struct phydm_phyinfo_struct *phy_info) +{ + /* type 2 & 3 is used for ofdm packet */ + struct phy_sts_rpt_jgr3_type2_3 *phy_sts = NULL; + struct odm_phy_dbg_info *dbg_i = &dm->phy_dbg_info; + s8 rx_pwr_db_max = -120; + s8 rx_path_pwr_db = 0; + u8 i, rxsc, bw = CHANNEL_WIDTH_20, rx_count = 0; + + phy_sts = (struct phy_sts_rpt_jgr3_type2_3 *)phy_status_inf; + + /* Update per-path information */ + for (i = RF_PATH_A; i < PHYDM_MAX_RF_PATH; i++) { + if (dm->rx_ant_status & BIT(i)) { + rx_count++; /* @check the number of the ant */ + + if (rx_count > dm->num_rf_path) + break; + + /* Update per-path information + * (RSSI_dB RSSI_percentage EVM SNR CFO sq) + */ + /* @EVM report is reported by stream, not path */ + rx_path_pwr_db = (s8)phy_sts->pwdb[i] - 110; /*@dB*/ + + if (pktinfo->is_to_self) + dm->ofdm_agc_idx[i] = phy_sts->pwdb[i]; + + phydm_per_path_info_3rd(i, rx_path_pwr_db, 0, + 0, 0, phy_info); + + /* search maximum pwdb */ + if (rx_path_pwr_db > rx_pwr_db_max) + rx_pwr_db_max = rx_path_pwr_db; + } + } + + /* @mapping RX counter from 1~4 to 0~3 */ + if (rx_count > 0) + phy_info->rx_count = rx_count - 1; + + /* @count BF packet */ + dbg_i->num_qry_bf_pkt = dm->phy_dbg_info.num_qry_bf_pkt + + phy_sts->beamformed; + + /*STBC or LDPC pkt*/ + dbg_i->is_ldpc_pkt = phy_sts->ldpc; + dbg_i->is_stbc_pkt = phy_sts->stbc; + + /* @Check sub-channel */ + if (pktinfo->data_rate > ODM_RATE11M && + pktinfo->data_rate < ODM_RATEMCS0) + rxsc = phy_sts->l_rxsc; /*@Legacy*/ + else + rxsc = phy_sts->ht_rxsc; /* @HT and VHT */ + + /* @Check RX bandwidth */ + 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 = *dm->band_width; + + /* Update packet information */ + /* RX power choose the path with the maximum power */ + phydm_common_phy_info_3rd(rx_pwr_db_max, phy_sts->channel_lsb, + (boolean)phy_sts->beamformed, + false, bw, 0, rxsc, phy_info); +} + +void phydm_get_physts_jarguar3_4(struct dm_struct *dm, u8 *phy_status_inf, + struct phydm_perpkt_info_struct *pktinfo, + struct phydm_phyinfo_struct *phy_info) +{ + /* type 4 is used for ofdm packet */ + struct phy_sts_rpt_jgr3_type4 *phy_sts = NULL; + struct odm_phy_dbg_info *dbg_i = &dm->phy_dbg_info; + s8 rx_pwr_db_max = -120; + s8 rx_path_pwr_db = 0; + u8 i, rxsc, bw = CHANNEL_WIDTH_20, rx_cnt = 0; + + phy_sts = (struct phy_sts_rpt_jgr3_type4 *)phy_status_inf; + + /* Update per-path information */ + for (i = RF_PATH_A; i < PHYDM_MAX_RF_PATH; i++) { + if (dm->rx_ant_status & BIT(i)) { + rx_cnt++; /* @check the number of the ant */ + + if (rx_cnt > dm->num_rf_path) + break; + + /* Update per-path information + * (RSSI_dB RSSI_percentage EVM SNR CFO sq) + */ + /* @EVM report is reported by stream, not path */ + rx_path_pwr_db = (s8)phy_sts->pwdb[i] - 110; /*@dB*/ + + if (pktinfo->is_to_self) + dm->ofdm_agc_idx[i] = phy_sts->pwdb[i]; + + phydm_per_path_info_3rd(i, rx_path_pwr_db, + phy_sts->rxevm[rx_cnt - 1], + 0, phy_sts->rxsnr[i], + phy_info); + + /* search maximum pwdb */ + if (rx_path_pwr_db > rx_pwr_db_max) + rx_pwr_db_max = rx_path_pwr_db; + } + } + + /* @mapping RX counter from 1~4 to 0~3 */ + if (rx_cnt > 0) + phy_info->rx_count = rx_cnt - 1; + + /* @count BF packet */ + dbg_i->num_qry_bf_pkt = dm->phy_dbg_info.num_qry_bf_pkt + + phy_sts->beamformed; + + /* @STBC or LDPC pkt*/ + dbg_i->is_ldpc_pkt = phy_sts->ldpc; + dbg_i->is_stbc_pkt = phy_sts->stbc; + + /* @Check sub-channel */ + if (pktinfo->data_rate > ODM_RATE11M && + pktinfo->data_rate < ODM_RATEMCS0) + rxsc = phy_sts->l_rxsc; /*@Legacy*/ + else + rxsc = phy_sts->ht_rxsc; /* @HT and VHT */ + + /* @Check RX bandwidth */ + 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 = *dm->band_width; + + /* @Conditional number */ + dbg_i->condi_num = (u32)phy_sts->avg_cond_num_0; + + /* Update packet information */ + /* RX power choose the path with the maximum power */ + phydm_common_phy_info_3rd(rx_pwr_db_max, phy_sts->channel_lsb, + (boolean)phy_sts->beamformed, + false, bw, 0, rxsc, phy_info); +} + +void phydm_get_physts_jarguar3_5(struct dm_struct *dm, u8 *phy_status_inf, + struct phydm_perpkt_info_struct *pktinfo, + struct phydm_phyinfo_struct *phy_info) +{ + /* type 5 is used for ofdm packet */ + struct phy_sts_rpt_jgr3_type5 *phy_sts = NULL; + struct odm_phy_dbg_info *dbg_i = &dm->phy_dbg_info; + s8 rx_pwr_db_max = -120; + s8 rx_path_pwr_db = 0; + u8 i, rxsc, bw = CHANNEL_WIDTH_20, rx_count = 0; + + phy_sts = (struct phy_sts_rpt_jgr3_type5 *)phy_status_inf; + + /* Update per-path information */ + for (i = RF_PATH_A; i < PHYDM_MAX_RF_PATH; i++) { + if (dm->rx_ant_status & BIT(i)) { + rx_count++; /* @check the number of the ant */ + + if (rx_count > dm->num_rf_path) + break; + + /* Update per-path information + * (RSSI_dB RSSI_percentage EVM SNR CFO sq) + */ + /* @EVM report is reported by stream, not path */ + rx_path_pwr_db = (s8)phy_sts->pwdb[i] - 110; /*@dB*/ + + if (pktinfo->is_to_self) + dm->ofdm_agc_idx[i] = phy_sts->pwdb[i]; + + phydm_per_path_info_3rd(i, rx_path_pwr_db, + 0, 0, 0, phy_info); + + /* search maximum pwdb */ + if (rx_path_pwr_db > rx_pwr_db_max) + rx_pwr_db_max = rx_path_pwr_db; + } + } + + /* @mapping RX counter from 1~4 to 0~3 */ + if (rx_count > 0) + phy_info->rx_count = rx_count - 1; + + /* @count BF packet */ + dbg_i->num_qry_bf_pkt = dm->phy_dbg_info.num_qry_bf_pkt + + phy_sts->beamformed; + + /*STBC or LDPC pkt*/ + dbg_i->is_ldpc_pkt = phy_sts->ldpc; + dbg_i->is_stbc_pkt = phy_sts->stbc; + + /* @Check sub-channel */ + if (pktinfo->data_rate > ODM_RATE11M && + pktinfo->data_rate < ODM_RATEMCS0) + rxsc = phy_sts->l_rxsc; /*@Legacy*/ + else + rxsc = phy_sts->ht_rxsc; /* @HT and VHT */ + + /* @Check RX bandwidth */ + 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 = *dm->band_width; + + /* Update packet information */ + /* RX power choose the path with the maximum power */ + phydm_common_phy_info_3rd(rx_pwr_db_max, phy_sts->channel_lsb, + (boolean)phy_sts->beamformed, + false, bw, 0, rxsc, phy_info); +} + +void phydm_process_dm_rssi_3rd_type(struct dm_struct *dm, + struct phydm_phyinfo_struct *phy_info, + struct phydm_perpkt_info_struct *pktinfo) +{ + struct cmn_sta_info *sta = NULL; + struct rssi_info *rssi_t = NULL; + u8 rssi_tmp = 0; + u64 rssi_linear = 0; + s16 rssi_db = 0; + u8 i = 0; + + /*@[Step4]*/ + + if (pktinfo->station_id >= ODM_ASSOCIATE_ENTRY_NUM) + return; + + sta = dm->phydm_sta_info[pktinfo->station_id]; + + if (!is_sta_active(sta)) + return; + + if (!pktinfo->is_packet_match_bssid) /*@data frame only*/ + return; + + if (!(pktinfo->is_packet_to_self) && !(pktinfo->is_packet_beacon)) + return; + + if (pktinfo->is_packet_beacon) { + dm->phy_dbg_info.num_qry_beacon_pkt++; + dm->phy_dbg_info.beacon_phy_rate = pktinfo->data_rate; + } + + #if (defined(CONFIG_PATH_DIVERSITY)) + if (dm->support_ability & ODM_BB_PATH_DIV) + phydm_process_rssi_for_path_div(dm, phy_info, pktinfo); + #endif + + rssi_t = &sta->rssi_stat; + + if (pktinfo->is_cck_rate) { + rssi_db = phy_info->rx_mimo_signal_strength[0]; /*Path-A*/ + if (rssi_t->rssi_acc == 0) { + rssi_t->rssi_acc = (s16)(rssi_db << RSSI_MA); + rssi_t->rssi = (s8)(rssi_db); + } else { + rssi_t->rssi_acc = MA_ACC(rssi_t->rssi_acc, + rssi_db, RSSI_MA); + rssi_t->rssi = (s8)GET_MA_VAL(rssi_t->rssi_acc, + RSSI_MA); + } + rssi_t->rssi_cck = (s8)rssi_db; + } else { + for (i = RF_PATH_A; i < PHYDM_MAX_RF_PATH; i++) { + rssi_tmp = phy_info->rx_mimo_signal_strength[i]; + if (rssi_tmp != 0) + rssi_linear += phydm_db_2_linear(rssi_tmp); + } + /* @Rounding and removing fractional bits */ + rssi_linear = (rssi_linear + + (1 << (FRAC_BITS - 1))) >> FRAC_BITS; + + switch (phy_info->rx_count + 1) { + case 2: + rssi_linear = DIVIDED_2(rssi_linear); + break; + case 3: + rssi_linear = DIVIDED_3(rssi_linear); + break; + case 4: + rssi_linear = DIVIDED_4(rssi_linear); + break; + } + rssi_db = (s16)odm_convert_to_db(rssi_linear); + + if (rssi_t->rssi_acc == 0) { + rssi_t->rssi_acc = (s16)(rssi_db << RSSI_MA); + rssi_t->rssi = (s8)(rssi_db); + } else { + rssi_t->rssi_acc = MA_ACC(rssi_t->rssi_acc, + rssi_db, RSSI_MA); + rssi_t->rssi = (s8)GET_MA_VAL(rssi_t->rssi_acc, + RSSI_MA); + } + rssi_t->rssi_ofdm = (s8)rssi_db; + } +} + +void phydm_rx_physts_3rd_type(void *dm_void, u8 *phy_sts, + struct phydm_perpkt_info_struct *pktinfo, + struct phydm_phyinfo_struct *phy_info) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; +#ifdef PHYDM_PHYSTAUS_SMP_MODE + struct pkt_process_info *pkt_process = &dm->pkt_proc_struct; +#endif + u8 phy_status_type = (*phy_sts & 0xf); + +#ifdef PHYDM_PHYSTAUS_SMP_MODE + if (pkt_process->phystatus_smp_mode_en && phy_status_type != 0) { + if (pkt_process->pre_ppdu_cnt == pktinfo->ppdu_cnt) + return; + pkt_process->pre_ppdu_cnt = pktinfo->ppdu_cnt; + } +#endif + + /*@[Step 2]*/ + phydm_reset_phy_info_3rd(dm, phy_info); /* @Memory reset */ + + /* Phy status parsing */ + switch (phy_status_type) { + case 0: /*@CCK*/ + phydm_get_physts_jarguar3_0(dm, phy_sts, pktinfo, phy_info); + break; + case 1: + phydm_get_physts_jarguar3_1(dm, phy_sts, pktinfo, phy_info); + break; + case 2: + case 3: + phydm_get_physts_jarguar3_2_3(dm, phy_sts, pktinfo, phy_info); + break; + case 4: + phydm_get_physts_jarguar3_4(dm, phy_sts, pktinfo, phy_info); + break; + case 5: + phydm_get_physts_jarguar3_5(dm, phy_sts, pktinfo, phy_info); + break; + default: + break; + } + + + /*@[Step 1]*/ + phydm_print_phystat_jaguar3(dm, phy_sts, pktinfo, phy_info); +} + +#endif + +#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT) +/* @For 8822B only!! need to move to FW finally */ +/*@==============================================*/ + +boolean +phydm_query_is_mu_api(struct dm_struct *phydm, u8 ppdu_idx, u8 *p_data_rate, + u8 *p_gid) +{ + u8 data_rate = 0, gid = 0; + boolean is_mu = false; + + data_rate = phydm->phy_dbg_info.num_of_ppdu[ppdu_idx]; + gid = 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 dm_struct *phydm, + struct phydm_phyinfo_struct *phy_info) +{ + phy_info->rx_pwdb_all = 0; + phy_info->signal_quality = 0; + phy_info->band_width = 0; + phy_info->rx_count = 0; + odm_memory_set(phydm, phy_info->rx_mimo_signal_quality, 0, 4); + odm_memory_set(phydm, phy_info->rx_mimo_signal_strength, 0, 4); + odm_memory_set(phydm, phy_info->rx_snr, 0, 4); + + phy_info->rx_power = -110; + phy_info->recv_signal_power = -110; + phy_info->bt_rx_rssi_percentage = 0; + phy_info->signal_strength = 0; + phy_info->channel = 0; + phy_info->is_mu_packet = 0; + phy_info->is_beamformed = 0; + phy_info->rxsc = 0; + odm_memory_set(phydm, phy_info->rx_pwr, -110, 4); + odm_memory_set(phydm, phy_info->cfo_short, 0, 8); + odm_memory_set(phydm, phy_info->cfo_tail, 0, 8); + odm_memory_set(phydm, phy_info->ant_idx, 0, 4); + + odm_memory_set(phydm, phy_info->rx_mimo_evm_dbm, 0, 4); +} + +void phydm_print_phy_sts_jgr2(struct dm_struct *dm, u8 *phy_status_inf, + struct phydm_perpkt_info_struct *pktinfo, + struct phydm_phyinfo_struct *phy_info) +{ + struct phy_sts_rpt_jgr2_type0 *rpt0 = NULL; + struct phy_sts_rpt_jgr2_type1 *rpt = NULL; + struct phy_sts_rpt_jgr2_type2 *rpt2 = NULL; + struct odm_phy_dbg_info *dbg = &dm->phy_dbg_info; + u8 phy_status_page_num = (*phy_status_inf & 0xf); + u32 phy_status[PHY_STATUS_JRGUAR2_DW_LEN] = {0}; + u8 i; + u32 size = PHY_STATUS_JRGUAR2_DW_LEN << 2; + + rpt0 = (struct phy_sts_rpt_jgr2_type0 *)phy_status_inf; + rpt = (struct phy_sts_rpt_jgr2_type1 *)phy_status_inf; + rpt2 = (struct phy_sts_rpt_jgr2_type2 *)phy_status_inf; + + odm_move_memory(dm, phy_status, phy_status_inf, size); + + if (!(dm->debug_components & DBG_PHY_STATUS)) + return; + + if (dbg->show_phy_sts_all_pkt == 0) { + if (!pktinfo->is_packet_match_bssid) + return; + } + + dbg->show_phy_sts_cnt++; + #if 0 + dbg_print("cnt=%d, max=%d\n", + dbg->show_phy_sts_cnt, dbg->show_phy_sts_max_cnt); + #endif + + if (dbg->show_phy_sts_max_cnt != SHOW_PHY_STATUS_UNLIMITED) { + if (dbg->show_phy_sts_cnt > dbg->show_phy_sts_max_cnt) + return; + } + + pr_debug("Phy Status Rpt: OFDM_%d\n", phy_status_page_num); + pr_debug("StaID=%d, RxRate = 0x%x match_bssid=%d\n", + pktinfo->station_id, pktinfo->data_rate, + pktinfo->is_packet_match_bssid); + + for (i = 0; i < PHY_STATUS_JRGUAR2_DW_LEN; i++) + pr_debug("Offset[%d:%d] = 0x%x\n", + ((4 * i) + 3), (4 * i), phy_status[i]); + + if (phy_status_page_num == 0) { + pr_debug("[0] TRSW=%d, MP_gain_idx=%d, pwdb=%d\n", + rpt0->trsw, rpt0->gain, rpt0->pwdb); + pr_debug("[4] band=%d, CH=%d, agc_table = %d, rxsc = %d\n", + rpt0->band, rpt0->channel, + rpt0->agc_table, rpt0->rxsc); + pr_debug("[8] AntIdx[D:A]={%d, %d, %d, %d}, LSIG_len=%d\n", + rpt0->antidx_d, rpt0->antidx_c, rpt0->antidx_b, + rpt0->antidx_a, rpt0->length); + pr_debug("[12] lna_h=%d, bb_pwr=%d, lna_l=%d, vga=%d, sq=%d\n", + rpt0->lna_h, rpt0->bb_power, rpt0->lna_l, + rpt0->vga, rpt0->signal_quality); + + } else if (phy_status_page_num == 1) { + pr_debug("[0] pwdb[D:A]={%d, %d, %d, %d}\n", + rpt->pwdb[3], rpt->pwdb[2], + rpt->pwdb[1], rpt->pwdb[0]); + pr_debug("[4] BF: %d, ldpc=%d, stbc=%d, g_bt=%d, antsw=%d, band=%d, CH=%d, rxsc[ht, l]={%d, %d}\n", + rpt->beamformed, rpt->ldpc, rpt->stbc, rpt->gnt_bt, + rpt->hw_antsw_occu, rpt->band, rpt->channel, + rpt->ht_rxsc, rpt->l_rxsc); + pr_debug("[8] AntIdx[D:A]={%d, %d, %d, %d}, LSIG_len=%d\n", + rpt->antidx_d, rpt->antidx_c, rpt->antidx_b, + rpt->antidx_a, rpt->lsig_length); + pr_debug("[12] rf_mode=%d, NBI=%d, Intf_pos=%d, GID=%d, PAID=%d\n", + rpt->rf_mode, rpt->nb_intf_flag, + (rpt->intf_pos + (rpt->intf_pos_msb << 8)), rpt->gid, + (rpt->paid + (rpt->paid_msb << 8))); + pr_debug("[16] EVM[D:A]={%d, %d, %d, %d}\n", + rpt->rxevm[3], rpt->rxevm[2], + rpt->rxevm[1], rpt->rxevm[0]); + pr_debug("[20] CFO[D:A]={%d, %d, %d, %d}\n", + rpt->cfo_tail[3], rpt->cfo_tail[2], rpt->cfo_tail[1], + rpt->cfo_tail[0]); + pr_debug("[24] SNR[D:A]={%d, %d, %d, %d}\n\n", + rpt->rxsnr[3], rpt->rxsnr[2], rpt->rxsnr[1], + rpt->rxsnr[0]); + + } else if (phy_status_page_num == 2) { + pr_debug("[0] pwdb[D:A]={%d, %d, %d, %d}\n", + rpt2->pwdb[3], rpt2->pwdb[2], rpt2->pwdb[1], + rpt2->pwdb[0]); + pr_debug("[4] BF: %d, ldpc=%d, stbc=%d, g_bt=%d, antsw=%d, band=%d, CH=%d, rxsc[ht,l]={%d, %d}\n", + rpt2->beamformed, rpt2->ldpc, rpt2->stbc, rpt2->gnt_bt, + rpt2->hw_antsw_occu, rpt2->band, rpt2->channel, + rpt2->ht_rxsc, rpt2->l_rxsc); + pr_debug("[8] AgcTab[D:A]={%d, %d, %d, %d}, cnt_pw2cca=%d, shift_l_map=%d\n", + rpt2->agc_table_d, rpt2->agc_table_c, + rpt2->agc_table_b, rpt2->agc_table_a, + rpt2->cnt_pw2cca, rpt2->shift_l_map); + pr_debug("[12] (TRSW|Gain)[D:A]={%d %d, %d %d, %d %d, %d %d}, cnt_cca2agc_rdy=%d\n", + rpt2->trsw_d, rpt2->gain_d, rpt2->trsw_c, rpt2->gain_c, + rpt2->trsw_b, rpt2->gain_b, rpt2->trsw_a, + rpt2->gain_a, rpt2->cnt_cca2agc_rdy); + pr_debug("[16] AAGC step[D:A]={%d, %d, %d, %d} HT AAGC gain[D:A]={%d, %d, %d, %d}\n", + rpt2->aagc_step_d, rpt2->aagc_step_c, + rpt2->aagc_step_b, rpt2->aagc_step_a, + rpt2->ht_aagc_gain[3], rpt2->ht_aagc_gain[2], + rpt2->ht_aagc_gain[1], rpt2->ht_aagc_gain[0]); + pr_debug("[20] DAGC gain[D:A]={%d, %d, %d, %d}\n", + rpt2->dagc_gain[3], + rpt2->dagc_gain[2], rpt2->dagc_gain[1], + rpt2->dagc_gain[0]); + pr_debug("[24] syn_cnt: %d, Cnt=%d\n\n", + rpt2->syn_count, rpt2->counter); + } +} + +void phydm_set_per_path_phy_info(u8 rx_path, s8 pwr, s8 rx_evm, s8 cfo_tail, + s8 rx_snr, u8 ant_idx, + struct phydm_phyinfo_struct *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); + + if (evm_dbm == 64) + evm_dbm = 0; /*@if 1SS rate, evm_dbm [2nd stream] =64*/ + + if (evm_dbm != 0) { + /* @Convert EVM to 0%~100% percentage */ + if (evm_dbm >= 34) + evm_percentage = 100; + else + evm_percentage = (evm_dbm << 1) + (evm_dbm); + } + } + + phy_info->rx_pwr[rx_path] = pwr; + + /*@CFO(kHz) = CFO_tail * 312.5(kHz) / 2^7 ~= CFO tail * 5/2 (kHz)*/ + phy_info->cfo_tail[rx_path] = (cfo_tail * 5) >> 1; + phy_info->rx_mimo_evm_dbm[rx_path] = evm_dbm; + phy_info->rx_mimo_signal_strength[rx_path] = phydm_pwr_2_percent(pwr); + phy_info->rx_mimo_signal_quality[rx_path] = evm_percentage; + phy_info->rx_snr[rx_path] = rx_snr >> 1; + phy_info->ant_idx[rx_path] = ant_idx; + +#if 0 + if (!pktinfo->is_packet_match_bssid) + return; + + dbg_print("path (%d)--------\n", rx_path); + dbg_print("rx_pwr = %d, Signal strength = %d\n", + phy_info->rx_pwr[rx_path], + phy_info->rx_mimo_signal_strength[rx_path]); + dbg_print("evm_dbm = %d, Signal quality = %d\n", + phy_info->rx_mimo_evm_dbm[rx_path], + phy_info->rx_mimo_signal_quality[rx_path]); + dbg_print("CFO = %d, SNR = %d\n", + phy_info->cfo_tail[rx_path], 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 *phy_info) +{ + phy_info->rx_power = rx_power; /* RSSI in dB */ + phy_info->recv_signal_power = rx_power; /* RSSI in dB */ + phy_info->channel = channel; /* @channel number */ + phy_info->is_beamformed = is_beamformed; /* @apply BF */ + phy_info->is_mu_packet = is_mu_packet; /* @MU packet */ + phy_info->rxsc = rxsc; + + /* RSSI in percentage */ + phy_info->rx_pwdb_all = phydm_pwr_2_percent(rx_power); + phy_info->signal_quality = signal_quality; /* signal quality */ + phy_info->band_width = bandwidth; /* @bandwidth */ + +#if 0 + if (!pktinfo->is_packet_match_bssid) + return; + + dbg_print("rx_pwdb_all = %d, rx_power = %d, recv_signal_power = %d\n", + phy_info->rx_pwdb_all, phy_info->rx_power, + phy_info->recv_signal_power); + dbg_print("signal_quality = %d\n", phy_info->signal_quality); + dbg_print("is_beamformed = %d, is_mu_packet = %d, rx_count = %d\n", + phy_info->is_beamformed, phy_info->is_mu_packet, + phy_info->rx_count + 1); + dbg_print("channel = %d, rxsc = %d, band_width = %d\n", channel, + rxsc, bandwidth); + +#endif +} + +void phydm_get_phy_sts_type0(struct dm_struct *dm, u8 *phy_status_inf, + struct phydm_perpkt_info_struct *pktinfo, + struct phydm_phyinfo_struct *phy_info) +{ + /* type 0 is used for cck packet */ + struct phy_sts_rpt_jgr2_type0 *phy_sts = NULL; + u8 sq = 0; + s8 rx_pow = 0; + u8 lna_idx = 0, vga_idx = 0; + u8 ant_idx; + + phy_sts = (struct phy_sts_rpt_jgr2_type0 *)phy_status_inf; + rx_pow = phy_sts->pwdb - 110; + + /* Fill in per-path antenna index */ + ant_idx = phy_sts->antidx_a; + + if (dm->support_ic_type & ODM_RTL8723D) { + #if (RTL8723D_SUPPORT) + rx_pow = phy_sts->pwdb - 97; + #endif + } + #if (RTL8821C_SUPPORT) + else if (dm->support_ic_type & ODM_RTL8821C) { + if (phy_sts->pwdb >= -57) + rx_pow = phy_sts->pwdb - 100; + else + rx_pow = phy_sts->pwdb - 102; + } + #endif + + if (pktinfo->is_to_self) { + dm->ofdm_agc_idx[0] = phy_sts->pwdb; + dm->ofdm_agc_idx[1] = 0; + dm->ofdm_agc_idx[2] = 0; + dm->ofdm_agc_idx[3] = 0; + } + + /* @Calculate Signal Quality*/ + if (phy_sts->signal_quality >= 64) { + sq = 0; + } else if (phy_sts->signal_quality <= 20) { + sq = 100; + } else { + /* @mapping to 2~99% */ + sq = 64 - phy_sts->signal_quality; + sq = ((sq << 3) + sq) >> 2; + } + + /* @Get RSSI for old CCK AGC */ + if (!dm->cck_new_agc) { + vga_idx = phy_sts->vga; + + if (dm->support_ic_type & ODM_RTL8197F) { + /*@3bit LNA*/ + lna_idx = phy_sts->lna_l; + } else { + /*@4bit LNA*/ + lna_idx = (phy_sts->lna_h << 3) | phy_sts->lna_l; + } + rx_pow = phydm_get_cck_rssi(dm, lna_idx, vga_idx); + } + + /* @Confirm CCK RSSI */ + #if (RTL8197F_SUPPORT) + if (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 (phy_sts->bb_power < bb_pwr_th_l || + phy_sts->bb_power > bb_pwr_th_h) + rx_pow = 0; /* @Error RSSI for CCK ; set 100*/ + } + #endif + + /*@CCK no STBC and LDPC*/ + dm->phy_dbg_info.is_ldpc_pkt = false; + dm->phy_dbg_info.is_stbc_pkt = false; + + /* Update Common information */ + phydm_set_common_phy_info(rx_pow, phy_sts->channel, false, + false, CHANNEL_WIDTH_20, sq, + phy_sts->rxsc, phy_info); + /* Update CCK pwdb */ + phydm_set_per_path_phy_info(RF_PATH_A, rx_pow, 0, 0, 0, ant_idx, + phy_info); + + #ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY + dm->dm_fat_table.antsel_rx_keep_0 = phy_sts->antidx_a; + dm->dm_fat_table.antsel_rx_keep_1 = phy_sts->antidx_b; + dm->dm_fat_table.antsel_rx_keep_2 = phy_sts->antidx_c; + dm->dm_fat_table.antsel_rx_keep_3 = phy_sts->antidx_d; + #endif +} + +void phydm_get_phy_sts_type1(struct dm_struct *dm, u8 *phy_status_inf, + struct phydm_perpkt_info_struct *pktinfo, + struct phydm_phyinfo_struct *phy_info) +{ + /* type 1 is used for ofdm packet */ + struct phy_sts_rpt_jgr2_type1 *phy_sts = NULL; + struct odm_phy_dbg_info *dbg_i = &dm->phy_dbg_info; + s8 rx_pwr_db = -120; + s8 rx_pwr = 0; + u8 i, rxsc, bw = CHANNEL_WIDTH_20, rx_count = 0; + boolean is_mu; + u8 ant_idx[4]; + + phy_sts = (struct phy_sts_rpt_jgr2_type1 *)phy_status_inf; + + /* Fill in per-path antenna index */ + ant_idx[0] = phy_sts->antidx_a; + ant_idx[1] = phy_sts->antidx_b; + ant_idx[2] = phy_sts->antidx_c; + ant_idx[3] = phy_sts->antidx_d; + + /* Update per-path information */ + for (i = RF_PATH_A; i < PHYDM_MAX_RF_PATH; i++) { + if (!(dm->rx_ant_status & BIT(i))) + continue; + rx_count++; + + if (rx_count > dm->num_rf_path) + break; + + /* Update per-path information + * (RSSI_dB RSSI_percentage EVM SNR CFO sq) + */ + /* @EVM report is reported by stream, not path */ + rx_pwr = phy_sts->pwdb[i] - 110; /* per-path pwdb(dB)*/ + + if (pktinfo->is_to_self) + dm->ofdm_agc_idx[i] = phy_sts->pwdb[i]; + + phydm_set_per_path_phy_info(i, rx_pwr, + phy_sts->rxevm[rx_count - 1], + phy_sts->cfo_tail[i], + phy_sts->rxsnr[i], + ant_idx[i], phy_info); + /* search maximum pwdb */ + if (rx_pwr > rx_pwr_db) + rx_pwr_db = rx_pwr; + } + + /* @mapping RX counter from 1~4 to 0~3 */ + if (rx_count > 0) + phy_info->rx_count = rx_count - 1; + + /* @Check if MU packet or not */ + if (phy_sts->gid != 0 && phy_sts->gid != 63) { + is_mu = true; + dbg_i->num_qry_mu_pkt++; + } else { + is_mu = false; + } + + /* @count BF packet */ + dbg_i->num_qry_bf_pkt = dbg_i->num_qry_bf_pkt + phy_sts->beamformed; + + /*STBC or LDPC pkt*/ + dbg_i->is_ldpc_pkt = phy_sts->ldpc; + dbg_i->is_stbc_pkt = phy_sts->stbc; + + /* @Check sub-channel */ + if (pktinfo->data_rate > ODM_RATE11M && + pktinfo->data_rate < ODM_RATEMCS0) + rxsc = phy_sts->l_rxsc; + else + rxsc = phy_sts->ht_rxsc; + + /* @Check RX bandwidth */ + if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + 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 = phy_sts->rf_mode; + + } else if (dm->support_ic_type & ODM_IC_11N_SERIES) { + if (phy_sts->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, phy_sts->channel, + (boolean)phy_sts->beamformed, is_mu, bw, + phy_info->rx_mimo_signal_quality[0], + rxsc, phy_info); + + phydm_parsing_cfo(dm, pktinfo, phy_sts->cfo_tail, pktinfo->rate_ss); + #ifdef PHYDM_LNA_SAT_CHK_TYPE2 + phydm_parsing_snr(dm, pktinfo, phy_sts->rxsnr); + #endif + + #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) + dm->dm_fat_table.antsel_rx_keep_0 = phy_sts->antidx_a; + dm->dm_fat_table.antsel_rx_keep_1 = phy_sts->antidx_b; + dm->dm_fat_table.antsel_rx_keep_2 = phy_sts->antidx_c; + dm->dm_fat_table.antsel_rx_keep_3 = phy_sts->antidx_d; + #endif +} + +void phydm_get_phy_sts_type2(struct dm_struct *dm, u8 *phy_status_inf, + struct phydm_perpkt_info_struct *pktinfo, + struct phydm_phyinfo_struct *phy_info) +{ + struct phy_sts_rpt_jgr2_type2 *phy_sts = NULL; + s8 rx_pwr_db_max = -120; + s8 rx_pwr = 0; + u8 i, rxsc, bw = CHANNEL_WIDTH_20, rx_count = 0; + + phy_sts = (struct phy_sts_rpt_jgr2_type2 *)phy_status_inf; + + for (i = RF_PATH_A; i < PHYDM_MAX_RF_PATH; i++) { + if (!(dm->rx_ant_status & BIT(i))) + continue; + rx_count++; + + if (rx_count > dm->num_rf_path) + break; + + /* Update per-path information*/ + /* RSSI_dB, RSSI_percentage, EVM, SNR, CFO, sq */ + #if (RTL8197F_SUPPORT) + if ((dm->support_ic_type & ODM_RTL8197F) && + phy_sts->pwdb[i] == 0x7f) { /*@97f workaround*/ + + if (i == RF_PATH_A) { + rx_pwr = (phy_sts->gain_a) << 1; + rx_pwr = rx_pwr - 110; + } else if (i == RF_PATH_B) { + rx_pwr = (phy_sts->gain_b) << 1; + rx_pwr = rx_pwr - 110; + } else { + rx_pwr = 0; + } + } else + #endif + rx_pwr = phy_sts->pwdb[i] - 110; /*@dBm*/ + + phydm_set_per_path_phy_info(i, rx_pwr, 0, 0, 0, 0, phy_info); + + if (rx_pwr > rx_pwr_db_max) /* search max pwdb */ + rx_pwr_db_max = rx_pwr; + } + + /* @mapping RX counter from 1~4 to 0~3 */ + if (rx_count > 0) + phy_info->rx_count = rx_count - 1; + + /* @Check RX sub-channel */ + if (pktinfo->data_rate > ODM_RATE11M && + pktinfo->data_rate < ODM_RATEMCS0) + rxsc = phy_sts->l_rxsc; + else + rxsc = phy_sts->ht_rxsc; + + /*STBC or LDPC pkt*/ + dm->phy_dbg_info.is_ldpc_pkt = phy_sts->ldpc; + dm->phy_dbg_info.is_stbc_pkt = phy_sts->stbc; + + /* @Check RX bandwidth */ + /* @BW information of sc=0 is useless, + *because there is no information of RF mode + */ + if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + 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 if (dm->support_ic_type & ODM_IC_11N_SERIES) { + if (rxsc == 3) + bw = CHANNEL_WIDTH_40; + else if ((rxsc == 1) || (rxsc == 2)) + bw = CHANNEL_WIDTH_20; + } + + /* Update packet information */ + phydm_set_common_phy_info(rx_pwr_db_max, phy_sts->channel, + (boolean)phy_sts->beamformed, + false, bw, 0, rxsc, phy_info); +} + +void phydm_process_rssi_for_dm_2nd_type(struct dm_struct *dm, + struct phydm_phyinfo_struct *phy_info, + struct phydm_perpkt_info_struct *pktinfo + ) +{ + struct cmn_sta_info *sta = NULL; + struct rssi_info *rssi_t = NULL; + u8 rssi_tmp = 0; + u64 rssi_linear = 0; + s16 rssi_db = 0; + u8 i = 0; + + if (pktinfo->station_id >= ODM_ASSOCIATE_ENTRY_NUM) + return; + + sta = dm->phydm_sta_info[pktinfo->station_id]; + + if (!is_sta_active(sta)) + return; + + if (!pktinfo->is_packet_match_bssid) /*@data frame only*/ + return; + +#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) + if (dm->support_ability & ODM_BB_ANT_DIV) + odm_process_rssi_for_ant_div(dm, phy_info, pktinfo); +#endif + +#ifdef CONFIG_ADAPTIVE_SOML + phydm_rx_qam_for_soml(dm, pktinfo); + phydm_rx_rate_for_soml(dm, pktinfo); +#endif + + if (!(pktinfo->is_packet_to_self) && !(pktinfo->is_packet_beacon)) + return; + + if (pktinfo->is_packet_beacon) { + dm->phy_dbg_info.num_qry_beacon_pkt++; + dm->phy_dbg_info.beacon_phy_rate = pktinfo->data_rate; + } + + rssi_t = &sta->rssi_stat; + + for (i = RF_PATH_A; i < PHYDM_MAX_RF_PATH; i++) { + rssi_tmp = phy_info->rx_mimo_signal_strength[i]; + if (rssi_tmp != 0) + rssi_linear += phydm_db_2_linear(rssi_tmp); + } + /* @Rounding and removing fractional bits */ + rssi_linear = (rssi_linear + (1 << (FRAC_BITS - 1))) >> FRAC_BITS; + + switch (phy_info->rx_count + 1) { + case 2: + rssi_linear = DIVIDED_2(rssi_linear); + break; + case 3: + rssi_linear = DIVIDED_3(rssi_linear); + break; + case 4: + rssi_linear = DIVIDED_4(rssi_linear); + break; + } + + rssi_db = (s16)odm_convert_to_db(rssi_linear); + + if (rssi_t->rssi_acc == 0) { + rssi_t->rssi_acc = (s16)(rssi_db << RSSI_MA); + rssi_t->rssi = (s8)(rssi_db); + } else { + rssi_t->rssi_acc = MA_ACC(rssi_t->rssi_acc, rssi_db, RSSI_MA); + rssi_t->rssi = (s8)GET_MA_VAL(rssi_t->rssi_acc, RSSI_MA); + } + + #if 0 + PHYDM_DBG(dm, DBG_TMP, "RSSI[%d]{A,B,C,D}={%d, %d, %d, %d} AVG=%d\n", + pktinfo->station_id, + phy_info->rx_mimo_signal_strength[0], + phy_info->rx_mimo_signal_strength[1], + phy_info->rx_mimo_signal_strength[2], + phy_info->rx_mimo_signal_strength[3], rssi_db); + PHYDM_DBG(dm, DBG_TMP, "rssi_acc = %d, rssi=%d\n", + rssi_t->rssi_acc, rssi_t->rssi); + #endif + + if (pktinfo->is_cck_rate) + rssi_t->rssi_cck = (s8)rssi_db; + else + rssi_t->rssi_ofdm = (s8)rssi_db; +} + +void phydm_rx_physts_2nd_type(void *dm_void, u8 *phy_sts, + struct phydm_perpkt_info_struct *pktinfo, + struct phydm_phyinfo_struct *phy_info) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; +#ifdef PHYDM_PHYSTAUS_SMP_MODE + struct pkt_process_info *pkt_process = &dm->pkt_proc_struct; +#endif + u8 page = (*phy_sts & 0xf); + +#ifdef PHYDM_PHYSTAUS_SMP_MODE + if (pkt_process->phystatus_smp_mode_en && page != 0) { + if (pkt_process->pre_ppdu_cnt == pktinfo->ppdu_cnt) + return; + + pkt_process->pre_ppdu_cnt = pktinfo->ppdu_cnt; + } +#endif + + phydm_reset_phy_info(dm, phy_info); /* @Memory reset */ + + /* Phy status parsing */ + switch (page) { + case 0: /*@CCK*/ + phydm_get_phy_sts_type0(dm, phy_sts, pktinfo, phy_info); + break; + case 1: + phydm_get_phy_sts_type1(dm, phy_sts, pktinfo, phy_info); + break; + case 2: + phydm_get_phy_sts_type2(dm, phy_sts, pktinfo, phy_info); + break; + default: + break; + } + +#if (RTL8822B_SUPPORT || RTL8821C_SUPPORT || RTL8195B_SUPPORT) + if (dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8821C | ODM_RTL8195B)) + phydm_print_phy_sts_jgr2(dm, phy_sts, pktinfo, phy_info); +#endif +} + +/*@==============================================*/ +#endif + +void odm_phy_status_query(struct dm_struct *dm, + struct phydm_phyinfo_struct *phy_info, + u8 *phy_status_inf, + struct phydm_perpkt_info_struct *pktinfo) +{ + u8 rate = pktinfo->data_rate; + + pktinfo->is_cck_rate = (rate <= ODM_RATE11M) ? true : false; + pktinfo->rate_ss = phydm_rate_to_num_ss(dm, rate); + dm->rate_ss = pktinfo->rate_ss; /*@For AP EVM SW antenna diversity use*/ + + if (pktinfo->is_cck_rate) + dm->phy_dbg_info.num_qry_phy_status_cck++; + else + dm->phy_dbg_info.num_qry_phy_status_ofdm++; + + /*Reset phy_info*/ + odm_memory_set(dm, phy_info->rx_mimo_signal_strength, 0, 4); + odm_memory_set(dm, phy_info->rx_mimo_signal_quality, 0, 4); + if (dm->support_ic_type & PHYSTS_3RD_TYPE_IC) { + #ifdef PHYSTS_3RD_TYPE_SUPPORT + phydm_rx_physts_3rd_type(dm, phy_status_inf, pktinfo, phy_info); + phydm_process_dm_rssi_3rd_type(dm, phy_info, pktinfo); + #endif + } else if (dm->support_ic_type & PHYSTS_2ND_TYPE_IC) { + #if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT) + phydm_rx_physts_2nd_type(dm, phy_status_inf, pktinfo, phy_info); + phydm_process_rssi_for_dm_2nd_type(dm, phy_info, pktinfo); + #endif + } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + #if ODM_IC_11AC_SERIES_SUPPORT + phydm_rx_physts_1st_type(dm, phy_info, phy_status_inf, pktinfo); + phydm_process_rssi_for_dm(dm, phy_info, pktinfo); + #endif + } else if (dm->support_ic_type & ODM_IC_11N_SERIES) { + #if ODM_IC_11N_SERIES_SUPPORT + phydm_phy_sts_n_parsing(dm, phy_info, phy_status_inf, pktinfo); + phydm_process_rssi_for_dm(dm, phy_info, pktinfo); + #endif + } + phy_info->signal_strength = phy_info->rx_pwdb_all; + #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + phydm_process_signal_strength(dm, phy_info, pktinfo); + #endif + + /*For basic debug message*/ + if (pktinfo->is_packet_match_bssid || pktinfo->is_packet_beacon || + *dm->mp_mode) { + dm->curr_station_id = pktinfo->station_id; + dm->rx_rate = rate; + dm->rssi_a = phy_info->rx_mimo_signal_strength[RF_PATH_A]; + dm->rssi_b = phy_info->rx_mimo_signal_strength[RF_PATH_B]; + dm->rssi_c = phy_info->rx_mimo_signal_strength[RF_PATH_C]; + dm->rssi_d = phy_info->rx_mimo_signal_strength[RF_PATH_D]; + + if (rate >= ODM_RATE6M && rate <= ODM_RATE54M) + dm->rxsc_l = (s8)phy_info->rxsc; + else if (phy_info->band_width == CHANNEL_WIDTH_20) + dm->rxsc_20 = (s8)phy_info->rxsc; + else if (phy_info->band_width == CHANNEL_WIDTH_40) + dm->rxsc_40 = (s8)phy_info->rxsc; + else if (phy_info->band_width == CHANNEL_WIDTH_80) + dm->rxsc_80 = (s8)phy_info->rxsc; + + phydm_avg_phystatus_index(dm, phy_info, pktinfo); + phydm_rx_statistic_cal(dm, phy_info, phy_status_inf, pktinfo); + } +} + +void phydm_rx_phy_status_init(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct odm_phy_dbg_info *dbg = &dm->phy_dbg_info; +#ifdef PHYDM_PHYSTAUS_SMP_MODE + struct pkt_process_info *pkt_process = &dm->pkt_proc_struct; + + if (dm->support_ic_type & ODM_RTL8822B) { + pkt_process->phystatus_smp_mode_en = 1; + pkt_process->pre_ppdu_cnt = 0xff; + /*phystatus sampling mode enable*/ + odm_set_mac_reg(dm, R_0x60f, BIT(7), 1); + /*@First update timming*/ + odm_set_bb_reg(dm, R_0x9e4, 0x3ff, 0x0); + /*Update Sampling time*/ + odm_set_bb_reg(dm, R_0x9e4, 0xfc00, 0x0); + } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + /*@First update timming*/ + odm_set_bb_reg(dm, R_0x8c0, 0x3ff0, 0x0); + /*Update Sampling time*/ + odm_set_bb_reg(dm, R_0x8c0, 0xfc000, 0x0); + } +#endif + + dbg->show_phy_sts_all_pkt = 0; + dbg->show_phy_sts_max_cnt = 1; + dbg->show_phy_sts_cnt = 0; + + phydm_avg_phystatus_init(dm); +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_phystatus.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_phystatus.h new file mode 100644 index 000000000000..0bcc3007e954 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_phystatus.h @@ -0,0 +1,1138 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +#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 + +#if defined(DM_ODM_CE_MAC80211) +#define CFO_HW_RPT_2_KHZ(val) ({ \ + s32 cfo_hw_rpt_2_khz_tmp = (val); \ + (cfo_hw_rpt_2_khz_tmp << 1) + (cfo_hw_rpt_2_khz_tmp >> 1); \ + }) +#else +#define CFO_HW_RPT_2_KHZ(val) ((val << 1) + (val >> 1)) +#endif + +/* @(X* 312.5 Khz)>>7 ~= X*2.5 Khz= (X<<1 + X>>1)Khz */ + +#define IGI_2_RSSI(igi) (igi - 10) + +#define PHY_STATUS_JRGUAR2_DW_LEN 7 /* @7*4 = 28 Byte */ +#define PHY_STATUS_JRGUAR3_DW_LEN 7 /* @7*4 = 28 Byte */ +#define SHOW_PHY_STATUS_UNLIMITED 0 +#define RSSI_MA 4 /*moving average factor for RSSI: 2^4=16 */ + +#define PHYSTS_PATH_NUM 4 + +/*@************************************************************ + * 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]; /*@CCK AGC report and CCK_BB_Power*/ + /*OFDM path-A and path-B short CFO*/ +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + 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]; /*@8812A: 16'b0*/ + /*@8814A: stream 3 and stream 4 RX EVM*/ + /* @DWORD 5*/ + u8 csi_current[2]; /*@8812A: stream 1 and 2 CSI*/ + /*@8814A: path-C and path-D RX SNR*/ + u8 gain_trsw_cd[2]; /*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_sts_rpt_jgr2_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_sts_rpt_jgr2_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_sts_rpt_jgr2_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 +}; +#endif + +/*@==============================================*/ +#ifdef PHYSTS_3RD_TYPE_SUPPORT +__PACK struct phy_sts_rpt_jgr3_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 : 1; + u8 path_sel_o : 2; +#else + u8 path_sel_o : 2; + u8 rsvd_2_2 : 1; + 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; +#else + u8 antidx_b : 4; + u8 antidx_a : 4; +#endif +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 antidx_c : 4; + u8 antidx_d : 4; +#else + 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; +#else + u8 lna_l_a : 3; + u8 vga_a : 5; +#endif +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 bb_power_a : 6; + u8 rsvd_3_1 : 1; + u8 lna_h_a : 1; +#else + + u8 lna_h_a : 1; + u8 rsvd_3_1 : 1; + u8 bb_power_a : 6; +#endif +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 rxrate : 2; + u8 raterr : 1; + u8 lockbit : 1; + u8 sqloss : 1; + u8 mf_off : 1; + u8 rsvd_3_2 : 2; +#else + u8 rsvd_3_2 : 2; + u8 mf_off : 1; + u8 sqloss : 1; + u8 lockbit : 1; + u8 raterr : 1; + u8 rxrate : 2; +#endif + + /* @DW4 : Offset 16 */ + u8 pwdb_b; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 vga_b : 5; + u8 lna_l_b : 3; +#else + u8 lna_l_b : 3; + u8 vga_b : 5; +#endif +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 bb_power_b : 6; + u8 rsvd_4_1 : 1; + u8 lna_h_b : 1; +#else + u8 lna_h_b : 1; + u8 rsvd_4_1 : 1; + u8 bb_power_b : 6; +#endif +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 gain_b : 6; + u8 rsvd_4_2 : 2; +#else + 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; +#else + u8 lna_l_c : 3; + u8 vga_c : 5; +#endif +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 bb_power_c : 6; + u8 rsvd_5_1 : 1; + u8 lna_h_c : 1; +#else + u8 lna_h_c : 1; + u8 rsvd_5_1 : 1; + u8 bb_power_c : 6; +#endif +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 gain_c : 6; + u8 rsvd_5_2 : 2; +#else + 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; +#else + u8 lna_l_d : 3; + u8 vga_d : 5; +#endif +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 bb_power_d : 6; + u8 rsvd_6_1 : 1; + u8 lna_h_d : 1; +#else + u8 lna_h_d : 1; + u8 rsvd_6_1 : 1; + u8 bb_power_d : 6; +#endif +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 gain_d : 6; + u8 rsvd_6_2 : 2; +#else + u8 rsvd_6_2 : 2; + u8 gain_d : 6; +#endif +}; + +__PACK struct phy_sts_rpt_jgr3_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; +#else + u8 antidx_b : 4; + u8 antidx_a : 4; +#endif +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 antidx_c : 4; + u8 antidx_d : 4; +#else + 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; +#if 0 + /*@ + 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 +*/ +#endif + /* @DW4 : Offset 16 */ + s8 rxevm[4]; /* s(8,1) */ + + /* @DW5 : Offset 20 */ + s8 cfo_tail[4]; /* s(8,7) */ + + /* @DW6 : Offset 24 */ + s8 rxsnr[4]; /* s(8,1) */ +}; + +__PACK struct phy_sts_rpt_jgr3_type2_3 { +/* Type2 is primary channel & type3 is secondary channel */ +/* @DW0 and DW1: Offest 0 and Offset 4 */ +#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 : 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 */ +#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; +#else + u8 agc_table_b : 4; + u8 agc_table_a : 4; +#endif +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 agc_table_c : 4; + u8 agc_table_d : 4; +#else + u8 agc_table_d : 4; + u8 agc_table_c : 4; +#endif + + /* @DW3 : Offset 12 */ + 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; +#else + u8 mp_gain_b_lsb : 2; + u8 mp_gain_a : 6; +#endif +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 mp_gain_b_msb : 4; + u8 mp_gain_c_lsb : 4; +#else + u8 mp_gain_c_lsb : 4; + u8 mp_gain_b_msb : 4; +#endif +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 mp_gain_c_msb : 2; + u8 avg_noise_pwr_lsb : 4; + u8 rsvd_3 : 2; + /* u8 r_rfmod:2; */ +#else + /* u8 r_rfmod:2; */ + u8 rsvd_3 : 2; + u8 avg_noise_pwr_lsb : 4; + u8 mp_gain_c_msb : 2; +#endif + /* @DW4 ~ 5: offset 16 ~20 */ +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 mp_gain_d : 6; + u8 is_freq_select_fading : 1; + u8 rsvd_2 : 1; +#else + u8 rsvd_2 : 1; + u8 is_freq_select_fading : 1; + u8 mp_gain_d : 6; +#endif +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 aagc_step_a : 2; + u8 aagc_step_b : 2; + u8 aagc_step_c : 2; + u8 aagc_step_d : 2; +#else + 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; +#else + u8 syn_count_lsb : 2; + u8 counter : 6; +#endif +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 syn_count_msb : 3; + u8 avg_noise_pwr_msb : 5; +#else + u8 avg_noise_pwr_msb : 5; + u8 syn_count_msb : 3; +#endif +}; + +__PACK struct phy_sts_rpt_jgr3_type4 { +/* smart antenna */ +/* @DW0 and DW1 : offset 0 and 4 */ +#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 : 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 : 1; + u8 band : 2; +#endif + +/* @DW2 : offset 8 */ +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 bad_tone_cnt_min_eign_0 : 4; + u8 bad_tone_cnt_cn_excess_0 : 4; +#else + u8 bad_tone_cnt_cn_excess_0 : 4; + u8 bad_tone_cnt_min_eign_0 : 4; +#endif +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + 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; +#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 training_done_d : 1; + u8 training_done_c : 1; + u8 training_done_b : 1; + u8 training_done_a : 1; +#endif +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 antidx_a : 4; + u8 antidx_b : 4; +#else + u8 antidx_b : 4; + u8 antidx_a : 4; +#endif +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 antidx_c : 4; + u8 antidx_d : 4; +#else + u8 antidx_d : 4; + u8 antidx_c : 4; +#endif +/* @DW3 : offset 12 */ + 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; +#else + u8 bad_tone_cnt_cn_excess_1 : 4; + u8 bad_tone_cnt_min_eign_1 : 4; +#endif +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 avg_cond_num_0 : 7; + u8 avg_cond_num_1_lsb : 1; +#else + u8 avg_cond_num_1_lsb : 1; + u8 avg_cond_num_0 : 7; +#endif +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 avg_cond_num_1_msb : 6; + u8 rsvd_1 : 2; +#else + u8 rsvd_1 : 2; + u8 avg_cond_num_1_msb : 6; +#endif + + /* @DW4 : offset 16 */ + s8 rxevm[4]; /* s(8,1) */ + + /* @DW5 : offset 20 */ + u8 eigenvalue[4]; /* @eigenvalue or eigenvalue of seg0 (in dB) */ + + /* @DW6 : ofset 24 */ + s8 rxsnr[4]; /* s(8,1) */ +}; + +__PACK struct phy_sts_rpt_jgr3_type5 { +/* @Debug */ +/* @DW0 ane DW1 : offset 0 and 4 */ +#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 : 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 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; +#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; +#endif +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 antidx_a : 4; + u8 antidx_b : 4; +#else + u8 antidx_b : 4; + u8 antidx_a : 4; +#endif +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 antidx_c : 4; + u8 antidx_d : 4; +#else + u8 antidx_d : 4; + u8 antidx_c : 4; +#endif + /* @DW3 : offset 12 */ + 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; + /* @DW4 : offset 16 */ + u8 inf_pos_0_a; + u8 inf_pos_1_a; + u8 inf_pos_0_b; + u8 inf_pos_1_b; + /* @DW5 : offset 20 */ + u8 inf_pos_0_c; + u8 inf_pos_1_c; + u8 inf_pos_0_d; + u8 inf_pos_1_d; +}; +#endif /*@#ifdef PHYSTS_3RD_TYPE_SUPPORT*/ + +#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) +boolean +phydm_query_is_mu_api(struct dm_struct *phydm, u8 ppdu_idx, u8 *p_data_rate, + u8 *p_gid); +#endif + +#ifdef PHYSTS_3RD_TYPE_SUPPORT +void phydm_rx_physts_3rd_type(void *dm_void, u8 *phy_sts, + struct phydm_perpkt_info_struct *pktinfo, + struct phydm_phyinfo_struct *phy_info); +#endif + +void phydm_reset_phystatus_avg(struct dm_struct *dm); + +void phydm_reset_phystatus_statistic(struct dm_struct *dm); + +void phydm_reset_rssi_for_dm(struct dm_struct *dm, u8 station_id); + +void phydm_get_cck_rssi_table_from_reg(struct dm_struct *dm); + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +void phydm_normal_driver_rx_sniffer( + struct dm_struct *dm, + u8 *desc, + PRT_RFD_STATUS rt_rfd_status, + u8 *drv_info, + u8 phy_status); +#endif + +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) +s32 phydm_signal_scale_mapping(struct dm_struct *dm, s32 curr_sig); +#endif + +void odm_phy_status_query(struct dm_struct *dm, + struct phydm_phyinfo_struct *phy_info, + u8 *phy_status_inf, + struct phydm_perpkt_info_struct *pktinfo); + +void phydm_rx_phy_status_init(void *dm_void); + +#endif /*@#ifndef __HALHWOUTSRC_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_pmac_tx_setting.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_pmac_tx_setting.c new file mode 100644 index 000000000000..033454ee5e5b --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_pmac_tx_setting.c @@ -0,0 +1,551 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +/*@************************************************************ + * include files + ************************************************************/ + +#include "mp_precomp.h" +#include "phydm_precomp.h" + +#ifdef PHYDM_PMAC_TX_SETTING_SUPPORT +#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + +void phydm_start_cck_cont_tx_jgr3(void *dm_void, + struct phydm_pmac_info *tx_info) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_pmac_tx *pmac_tx = &dm->dm_pmac_tx_table; + u8 rate = tx_info->tx_rate; /* @HW rate */ + + /* @if CCK block on? */ + if (!odm_get_bb_reg(dm, R_0x1c3c, BIT(1))) + odm_set_bb_reg(dm, R_0x1c3c, BIT(1), 1); + + /* @Turn Off All Test mode */ + odm_set_bb_reg(dm, R_0x1ca4, 0x7, 0x0); + + odm_set_bb_reg(dm, R_0x1a00, 0x3000, rate); + odm_set_bb_reg(dm, R_0x1a00, 0x3, 0x2); /* @transmit mode */ + odm_set_bb_reg(dm, R_0x1a00, 0x8, 0x1); /* @turn on scramble setting */ + + /* @Fix rate selection issue */ + odm_set_bb_reg(dm, R_0x1a70, 0x4000, 0x1); + /* @set RX weighting for path I & Q to 0 */ + odm_set_bb_reg(dm, R_0x1a14, 0x300, 0x3); + /* @set loopback mode */ + odm_set_bb_reg(dm, R_0x1c3c, 0x10, 0x1); + + pmac_tx->cck_cont_tx = true; + pmac_tx->ofdm_cont_tx = false; +} + +void phydm_stop_cck_cont_tx_jgr3(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_pmac_tx *pmac_tx = &dm->dm_pmac_tx_table; + + pmac_tx->cck_cont_tx = false; + pmac_tx->ofdm_cont_tx = false; + + odm_set_bb_reg(dm, R_0x1a00, 0x3, 0x0); /* @normal mode */ + odm_set_bb_reg(dm, R_0x1a00, 0x8, 0x1); /* @turn on scramble setting */ + + /* @back to default */ + odm_set_bb_reg(dm, R_0x1a70, 0x4000, 0x0); + odm_set_bb_reg(dm, R_0x1a14, 0x300, 0x0); + odm_set_bb_reg(dm, R_0x1c3c, 0x10, 0x0); + /* @BB Reset */ + odm_set_bb_reg(dm, R_0x1d0c, 0x10000, 0x0); + odm_set_bb_reg(dm, R_0x1d0c, 0x10000, 0x1); +} + +void phydm_start_ofdm_cont_tx_jgr3(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_pmac_tx *pmac_tx = &dm->dm_pmac_tx_table; + + /* @1. if OFDM block on */ + if (!odm_get_bb_reg(dm, R_0x1c3c, BIT(0))) + odm_set_bb_reg(dm, R_0x1c3c, BIT(0), 1); + + /* @2. set CCK test mode off, set to CCK normal mode */ + odm_set_bb_reg(dm, R_0x1a00, 0x3, 0); + + /* @3. turn on scramble setting */ + odm_set_bb_reg(dm, R_0x1a00, 0x8, 1); + + /* @4. Turn On Continue Tx and turn off the other test modes. */ + odm_set_bb_reg(dm, R_0x1ca4, 0x7, 0x1); + + pmac_tx->cck_cont_tx = false; + pmac_tx->ofdm_cont_tx = true; +} + +void phydm_stop_ofdm_cont_tx_jgr3(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_pmac_tx *pmac_tx = &dm->dm_pmac_tx_table; + + pmac_tx->cck_cont_tx = false; + pmac_tx->ofdm_cont_tx = false; + + /* @Turn Off All Test mode */ + odm_set_bb_reg(dm, R_0x1ca4, 0x7, 0x0); + + /* @Delay 10 ms */ + ODM_delay_ms(10); + + /* @BB Reset */ + odm_set_bb_reg(dm, R_0x1d0c, 0x10000, 0x0); + odm_set_bb_reg(dm, R_0x1d0c, 0x10000, 0x1); +} + +void phydm_set_single_tone_jgr3(void *dm_void, boolean is_single_tone, + boolean en_pmac_tx, u8 path) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_pmac_tx *pmac_tx = &dm->dm_pmac_tx_table; + u8 start = RF_PATH_A, end = RF_PATH_A; + u8 i = 0; + + switch (path) { + case RF_PATH_A: + case RF_PATH_B: + case RF_PATH_C: + case RF_PATH_D: + start = path; + end = path; + break; + case RF_PATH_AB: + start = RF_PATH_A; + end = RF_PATH_B; + break; +#if (RTL8814B_SUPPORT || RTL8198F_SUPPORT) + case RF_PATH_AC: + start = RF_PATH_A; + end = RF_PATH_C; + break; + case RF_PATH_AD: + start = RF_PATH_A; + end = RF_PATH_D; + break; + case RF_PATH_BC: + start = RF_PATH_B; + end = RF_PATH_C; + break; + case RF_PATH_BD: + start = RF_PATH_B; + end = RF_PATH_D; + break; + case RF_PATH_CD: + start = RF_PATH_C; + end = RF_PATH_D; + break; + case RF_PATH_ABC: + start = RF_PATH_A; + end = RF_PATH_C; + break; + case RF_PATH_ABD: + start = RF_PATH_A; + end = RF_PATH_D; + break; + case RF_PATH_ACD: + start = RF_PATH_A; + end = RF_PATH_D; + break; + case RF_PATH_BCD: + start = RF_PATH_B; + end = RF_PATH_D; + break; + case RF_PATH_ABCD: + start = RF_PATH_A; + end = RF_PATH_D; + break; +#endif + } + + if (is_single_tone) { + pmac_tx->tx_scailing = odm_get_bb_reg(dm, R_0x81c, MASKDWORD); + + if (!en_pmac_tx) { + phydm_start_ofdm_cont_tx_jgr3(dm); + /*SendPSPoll(pAdapter);*/ + } + + odm_set_bb_reg(dm, R_0x1c68, BIT(24), 0x1); /* @Disable CCA */ + + for (i = start; i <= end; i++) { + /* @Tx mode: RF0x00[19:16]=4'b0010 */ + /* @odm_set_rf_reg(dm, i, RF_0x0, 0xF0000, 0x2); */ + /* @Lowest RF gain index: RF_0x0[4:0] = 0*/ + odm_set_rf_reg(dm, i, RF_0x0, 0x1F, 0x0); + /* @RF LO enabled */ + odm_set_rf_reg(dm, i, RF_0x58, BIT(1), 0x1); + } + #if (RTL8814B_SUPPORT == 1) + if (dm->support_ic_type & ODM_RTL8814B) { + /* @Tx mode: RF0x00[19:16]=4'b0010 */ + /* config_phydm_write_rf_syn_8814b(dm, RF_SYN0, RF_0x0, + * 0xF0000, 0x2); + */ + /* @Lowest RF gain index: RF_0x0[4:0] = 0*/ + config_phydm_write_rf_syn_8814b(dm, RF_SYN0, RF_0x0, + 0x1F, 0x0); + /* @RF LO enabled */ + config_phydm_write_rf_syn_8814b(dm, RF_SYN0, RF_0x58, + BIT(1), 0x1); + } + #endif + odm_set_bb_reg(dm, R_0x81c, 0x001FC000, 0); + } else { + for (i = start; i <= end; i++) { + /* @RF LO disabled */ + odm_set_rf_reg(dm, i, RF_0x58, BIT(1), 0x0); + } + odm_set_bb_reg(dm, R_0x1c68, BIT(24), 0x0); /* @Enable CCA */ + + if (!en_pmac_tx) + phydm_stop_ofdm_cont_tx_jgr3(dm); + + odm_set_bb_reg(dm, R_0x81c, MASKDWORD, pmac_tx->tx_scailing); + } +} + +void phydm_stop_pmac_tx_jgr3(void *dm_void, struct phydm_pmac_info *tx_info) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_pmac_tx *pmac_tx = &dm->dm_pmac_tx_table; + u32 tmp = 0; + + if (tx_info->mode == CONT_TX) { + odm_set_bb_reg(dm, R_0x1e70, 0xf, 2); /* TX Stop */ + if (pmac_tx->is_cck_rate) + phydm_stop_cck_cont_tx_jgr3(dm); + else + phydm_stop_ofdm_cont_tx_jgr3(dm); + } else { + if (pmac_tx->is_cck_rate) { + tmp = odm_get_bb_reg(dm, R_0x2de4, MASKLWORD); + odm_set_bb_reg(dm, R_0x1e64, MASKLWORD, tmp + 50); + } + odm_set_bb_reg(dm, R_0x1e70, 0xf, 2); /* TX Stop */ + } + + if (tx_info->mode == OFDM_SINGLE_TONE_TX) { + /* Stop HW TX -> Stop Continuous TX -> Stop RF Setting */ + if (pmac_tx->is_cck_rate) + phydm_stop_cck_cont_tx_jgr3(dm); + else + phydm_stop_ofdm_cont_tx_jgr3(dm); + + phydm_set_single_tone_jgr3(dm, false, true, pmac_tx->path); + } +} + +void phydm_set_mac_phy_txinfo_jgr3(void *dm_void, + struct phydm_pmac_info *tx_info) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_pmac_tx *pmac_tx = &dm->dm_pmac_tx_table; + u32 tmp = 0; + + odm_set_bb_reg(dm, R_0xa58, 0x003F8000, tx_info->tx_rate); + + /* @0x900[1] ndp_sound */ + odm_set_bb_reg(dm, R_0x900, 0x2, tx_info->ndp_sound); + + /* @0x900[27:24] txsc [29:28] bw [31:30] m_stbc */ + if (dm->support_ic_type & ODM_RTL8812F) { + tmp = (tx_info->tx_sc) | ((tx_info->bw) << 4) | + ((tx_info->m_stbc) << 6); + } else { + tmp = (tx_info->tx_sc) | ((tx_info->bw) << 4) | + ((tx_info->m_stbc - 1) << 6); + } + odm_set_bb_reg(dm, R_0x900, 0xFF000000, tmp); + + if (pmac_tx->is_ofdm_rate) { + odm_set_bb_reg(dm, R_0x900, 0x1, 0); + odm_set_bb_reg(dm, R_0x900, 0x4, 0); + } else if (pmac_tx->is_ht_rate) { + odm_set_bb_reg(dm, R_0x900, 0x1, 1); + odm_set_bb_reg(dm, R_0x900, 0x4, 0); + } else if (pmac_tx->is_vht_rate) { + odm_set_bb_reg(dm, R_0x900, 0x1, 0); + odm_set_bb_reg(dm, R_0x900, 0x4, 1); + } + + tmp = tx_info->packet_period; /* @for TX interval */ + odm_set_bb_reg(dm, R_0x9b8, 0xffff0000, tmp); +} + +void phydm_set_sig_jgr3(void *dm_void, struct phydm_pmac_info *tx_info) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_pmac_tx *pmac_tx = &dm->dm_pmac_tx_table; + u32 tmp = 0; + + if (pmac_tx->is_cck_rate) + return; + + /* @L-SIG */ + odm_set_bb_reg(dm, R_0x1eb4, 0xfffff, tx_info->packet_count); + + tmp = BYTE_2_DWORD(0, tx_info->lsig[2], tx_info->lsig[1], + tx_info->lsig[0]); + odm_set_bb_reg(dm, R_0x908, 0xffffff, tmp); +#if 0 + /* @0x924[7:0] = Data init octet */ + tmp = tx_info->packet_pattern; + odm_set_bb_reg(dm, R_0x924, 0xff, tmp); + + if (tx_info->packet_pattern == RANDOM_BY_PN32) + tmp = 0x3; + else + tmp = 0x0; + + odm_set_bb_reg(dm, R_0x914, 0x60000000, tmp); +#endif + if (pmac_tx->is_ht_rate) { + /* @HT SIG */ + tmp = BYTE_2_DWORD(0, tx_info->ht_sig[2], tx_info->ht_sig[1], + tx_info->ht_sig[0]); + odm_set_bb_reg(dm, R_0x90c, 0xffffff, tmp); + tmp = BYTE_2_DWORD(0, tx_info->ht_sig[5], tx_info->ht_sig[4], + tx_info->ht_sig[3]); + odm_set_bb_reg(dm, R_0x910, 0xffffff, tmp); + } else if (pmac_tx->is_vht_rate) { + /* @VHT SIG A/B/serv_field/delimiter */ + tmp = BYTE_2_DWORD(0, tx_info->vht_sig_a[2], + tx_info->vht_sig_a[1], + tx_info->vht_sig_a[0]); + odm_set_bb_reg(dm, R_0x90c, 0xffffff, tmp); + tmp = BYTE_2_DWORD(0, tx_info->vht_sig_a[5], + tx_info->vht_sig_a[4], + tx_info->vht_sig_a[3]); + odm_set_bb_reg(dm, R_0x910, 0xffffff, tmp); + tmp = BYTE_2_DWORD(tx_info->vht_sig_b[3], tx_info->vht_sig_b[2], + tx_info->vht_sig_b[1], + tx_info->vht_sig_b[0]); + odm_set_bb_reg(dm, R_0x914, 0x1FFFFFFF, tmp); + + tmp = tx_info->vht_sig_b_crc; + odm_set_bb_reg(dm, R_0x938, 0xff00, tmp); + + tmp = BYTE_2_DWORD(tx_info->vht_delimiter[3], + tx_info->vht_delimiter[2], + tx_info->vht_delimiter[1], + tx_info->vht_delimiter[0]); + odm_set_bb_reg(dm, R_0x940, MASKDWORD, tmp); + } +} + +void phydm_set_cck_preamble_hdr_jgr3(void *dm_void, + struct phydm_pmac_info *tx_info) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_pmac_tx *pmac_tx = &dm->dm_pmac_tx_table; + u32 tmp = 0; + + if (!pmac_tx->is_cck_rate) + return; + + tmp = tx_info->packet_count | (tx_info->sfd << 16); + odm_set_bb_reg(dm, R_0x1e64, MASKDWORD, tmp); + tmp = tx_info->signal_field | (tx_info->service_field << 8) | + (tx_info->length << 16); + odm_set_bb_reg(dm, R_0x1e68, MASKDWORD, tmp); + tmp = BYTE_2_DWORD(0, 0, tx_info->crc16[1], tx_info->crc16[0]); + odm_set_bb_reg(dm, R_0x1e6c, 0xffff, tmp); + + if (tx_info->is_short_preamble) + odm_set_bb_reg(dm, R_0x1e6c, BIT(16), 0); + else + odm_set_bb_reg(dm, R_0x1e6c, BIT(16), 1); +} + +void phydm_set_mode_jgr3(void *dm_void, struct phydm_pmac_info *tx_info, + enum phydm_pmac_mode mode) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_pmac_tx *pmac_tx = &dm->dm_pmac_tx_table; + + if (mode == CONT_TX) { + tx_info->packet_count = 1; + + if (pmac_tx->is_cck_rate) + phydm_start_cck_cont_tx_jgr3(dm, tx_info); + else + phydm_start_ofdm_cont_tx_jgr3(dm); + } else if (mode == OFDM_SINGLE_TONE_TX) { + /* Continuous TX -> HW TX -> RF Setting */ + tx_info->packet_count = 1; + + if (pmac_tx->is_cck_rate) + phydm_start_cck_cont_tx_jgr3(dm, tx_info); + else + phydm_start_ofdm_cont_tx_jgr3(dm); + } else if (mode == PKTS_TX) { + if (pmac_tx->is_cck_rate && tx_info->packet_count == 0) + tx_info->packet_count = 0xffff; + } +} + +void phydm_set_pmac_txon_jgr3(void *dm_void, struct phydm_pmac_info *tx_info) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_pmac_tx *pmac_tx = &dm->dm_pmac_tx_table; + + odm_set_bb_reg(dm, R_0x1d08, BIT(0), 1); /* Turn on PMAC */ + + /* mac scramble seed setting, only in 8198F */ + #if (RTL8198F_SUPPORT) + if (dm->support_ic_type & ODM_RTL8198F) + if (!odm_get_bb_reg(dm, R_0x1d10, BIT(16))) + odm_set_bb_reg(dm, R_0x1d10, BIT(16), 1); + #endif + + if (pmac_tx->is_cck_rate) { + odm_set_bb_reg(dm, R_0x1e70, 0xf, 8); /* TX CCK ON */ + odm_set_bb_reg(dm, R_0x1a84, BIT(31), 0); + } else { + odm_set_bb_reg(dm, R_0x1e70, 0xf, 4); /* TX Ofdm ON */ + } + + if (tx_info->mode == OFDM_SINGLE_TONE_TX) + phydm_set_single_tone_jgr3(dm, true, true, pmac_tx->path); +} + +void phydm_set_pmac_tx_jgr3(void *dm_void, struct phydm_pmac_info *tx_info, + enum rf_path mpt_rf_path) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_pmac_tx *pmac_tx = &dm->dm_pmac_tx_table; + + pmac_tx->is_cck_rate = phydm_is_cck_rate(dm, tx_info->tx_rate); + pmac_tx->is_ofdm_rate = phydm_is_ofdm_rate(dm, tx_info->tx_rate); + pmac_tx->is_ht_rate = phydm_is_ht_rate(dm, tx_info->tx_rate); + pmac_tx->is_vht_rate = phydm_is_vht_rate(dm, tx_info->tx_rate); + pmac_tx->path = mpt_rf_path; + + if (!tx_info->en_pmac_tx) { + phydm_stop_pmac_tx_jgr3(dm, tx_info); + return; + } + + phydm_set_mode_jgr3(dm, tx_info, tx_info->mode); + + if (pmac_tx->is_cck_rate) + phydm_set_cck_preamble_hdr_jgr3(dm, tx_info); + else + phydm_set_sig_jgr3(dm, tx_info); + + phydm_set_mac_phy_txinfo_jgr3(dm, tx_info); + phydm_set_pmac_txon_jgr3(dm, tx_info); +} + +void phydm_set_tmac_tx_jgr3(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + /* Turn on TMAC */ + if (odm_get_bb_reg(dm, R_0x1d08, BIT(0))) + odm_set_bb_reg(dm, R_0x1d08, BIT(0), 0); + + /* mac scramble seed setting, only in 8198F */ + #if (RTL8198F_SUPPORT == 1) + if (dm->support_ic_type & ODM_RTL8198F) + if (odm_get_bb_reg(dm, R_0x1d10, BIT(16))) + odm_set_bb_reg(dm, R_0x1d10, BIT(16), 0); + #endif + + /* Turn on TMAC CCK */ + if ((odm_get_bb_reg(dm, R_0x1a84, BIT(31))) == 0) + odm_set_bb_reg(dm, R_0x1a84, BIT(31), 1); +} +#endif + +void phydm_start_cck_cont_tx(void *dm_void, struct phydm_pmac_info *tx_info) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + phydm_start_cck_cont_tx_jgr3(dm, tx_info); +} + +void phydm_stop_cck_cont_tx(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + phydm_stop_cck_cont_tx_jgr3(dm); +} + +void phydm_start_ofdm_cont_tx(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + phydm_start_ofdm_cont_tx_jgr3(dm); +} + +void phydm_stop_ofdm_cont_tx(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + phydm_stop_ofdm_cont_tx_jgr3(dm); +} + +void phydm_set_single_tone(void *dm_void, boolean is_single_tone, + boolean en_pmac_tx, u8 path) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + phydm_set_single_tone_jgr3(dm, is_single_tone, + en_pmac_tx, path); +} + +void phydm_set_pmac_tx(void *dm_void, struct phydm_pmac_info *tx_info, + enum rf_path mpt_rf_path) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + phydm_set_pmac_tx_jgr3(dm, tx_info, mpt_rf_path); +} + +void phydm_set_tmac_tx(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + phydm_set_tmac_tx_jgr3(dm); +} + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_pmac_tx_setting.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_pmac_tx_setting.h new file mode 100644 index 000000000000..54d851e3525e --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_pmac_tx_setting.h @@ -0,0 +1,118 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +#ifndef __PHYDM_PMAC_TX_SETTING_H__ +#define __PHYDM_PMAC_TX_SETTING_H__ + +#define PMAC_TX_SETTING_VERSION "1.3" + +/* @1 ============================================================ + * 1 Definition + * 1 ============================================================ + */ +#define RANDOM_BY_PN32 0x12 +/* @1 ============================================================ + * 1 structure + * 1 ============================================================ + */ +struct phydm_pmac_info { + u8 en_pmac_tx:1; /*@ disable pmac 1: enable pmac */ + u8 mode:3; /*@ 0: Packet TX 3:Continuous TX */ + /* @u8 Ntx:4; */ + u8 tx_rate; /* @should be HW rate*/ + /* @u8 TX_RATE_HEX; */ + u8 tx_sc; + /* @u8 bSGI:1; */ + u8 is_short_preamble:1; + /* @u8 bSTBC:1; */ + /* @u8 bLDPC:1; */ + u8 ndp_sound:1; + u8 bw:3; /* @0:20 1:40 2:80Mhz */ + u8 m_stbc; /* @bSTBC + 1 */ + u16 packet_period; + u32 packet_count; + /* @u32 PacketLength; */ + u8 packet_pattern; + u16 sfd; + u8 signal_field; + u8 service_field; + u16 length; + u8 crc16[2]; + u8 lsig[3]; + u8 ht_sig[6]; + u8 vht_sig_a[6]; + u8 vht_sig_b[4]; + u8 vht_sig_b_crc; + u8 vht_delimiter[4]; + /* @u8 mac_addr[6]; */ +}; + +struct phydm_pmac_tx { + boolean is_cck_rate; + boolean is_ofdm_rate; + boolean is_ht_rate; + boolean is_vht_rate; + boolean cck_cont_tx; + boolean ofdm_cont_tx; + u8 path; + u32 tx_scailing; +}; + +/* @1 ============================================================ + * 1 enumeration + * 1 ============================================================ + */ + +enum phydm_pmac_mode { + NONE_TEST, + PKTS_TX, + PKTS_RX, + CONT_TX, + OFDM_SINGLE_TONE_TX, + CCK_CARRIER_SIPPRESSION_TX +}; + +/* @1 ============================================================ + * 1 function prototype + * 1 ============================================================ + */ +void phydm_start_cck_cont_tx(void *dm_void, struct phydm_pmac_info *tx_info); + +void phydm_stop_cck_cont_tx(void *dm_void); + +void phydm_start_ofdm_cont_tx(void *dm_void); + +void phydm_stop_ofdm_cont_tx(void *dm_void); + +void phydm_set_single_tone(void *dm_void, boolean is_single_tone, + boolean en_pmac_tx, u8 path); + +void phydm_set_pmac_tx(void *dm_void, struct phydm_pmac_info *tx_info, + enum rf_path mpt_rf_path); + +void phydm_set_tmac_tx(void *dm_void); + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_pow_train.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_pow_train.c new file mode 100644 index 000000000000..2da2e4bae5b4 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_pow_train.c @@ -0,0 +1,172 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +/************************************************************* + * include files + ************************************************************/ + +#include "mp_precomp.h" +#include "phydm_precomp.h" + +#ifdef PHYDM_POWER_TRAINING_SUPPORT +void phydm_reset_pt_para(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_pow_train_stuc *pt_t = &dm->pow_train_table; + + pt_t->pow_train_score = 0; +} + +void phydm_update_power_training_state(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_pow_train_stuc *pt_t = &dm->pow_train_table; + struct phydm_fa_struct *fa_cnt = &dm->false_alm_cnt; + struct ccx_info *ccx = &dm->dm_ccx_info; + u32 pt_score_tmp = ENABLE_PT_SCORE; + u32 crc_ok_cnt = 0; + u32 cca_cnt = 0; + + /*@is_disable_power_training is the key to H2C to disable/enable PT*/ + /*@if is_disable_power_training == 1, it will use largest power*/ + if (!(dm->support_ability & ODM_BB_PWR_TRAIN) || !dm->is_linked) { + dm->is_disable_power_training = true; + phydm_reset_pt_para(dm); + return; + } + + PHYDM_DBG(dm, DBG_PWR_TRAIN, "%s ======>\n", __func__); + + if (pt_t->pt_state == DISABLE_POW_TRAIN) { + dm->is_disable_power_training = true; + phydm_reset_pt_para(dm); + PHYDM_DBG(dm, DBG_PWR_TRAIN, "Disable PT\n"); + return; + + } else if (pt_t->pt_state == ENABLE_POW_TRAIN) { + dm->is_disable_power_training = false; + phydm_reset_pt_para(dm); + PHYDM_DBG(dm, DBG_PWR_TRAIN, "Enable PT\n"); + return; + + } else if (pt_t->pt_state == DYNAMIC_POW_TRAIN) { + PHYDM_DBG(dm, DBG_PWR_TRAIN, "Dynamic PT\n"); + + /* @Compute score */ + crc_ok_cnt = dm->phy_dbg_info.num_qry_phy_status_ofdm + + dm->phy_dbg_info.num_qry_phy_status_cck; + cca_cnt = fa_cnt->cnt_cca_all; +#if 0 + if (crc_ok_cnt > cca_cnt) { /*invalid situation*/ + pt_score_tmp = KEEP_PRE_PT_SCORE; + return; + } else if ((crc_ok_cnt + (crc_ok_cnt >> 1)) <= cca_cnt) { + /* @???crc_ok <= (2/3)*cca */ + pt_score_tmp = DISABLE_PT_SCORE; + dm->is_disable_power_training = true; + } else if ((crc_ok_cnt + (crc_ok_cnt >> 2)) <= cca_cnt) { + /* @???crc_ok <= (4/5)*cca */ + pt_score_tmp = KEEP_PRE_PT_SCORE; + } else { + /* @???crc_ok > (4/5)*cca */ + pt_score_tmp = ENABLE_PT_SCORE; + dm->is_disable_power_training = false; + } +#endif + if (ccx->nhm_ratio > 10) { + pt_score_tmp = DISABLE_PT_SCORE; + dm->is_disable_power_training = true; + } else if (ccx->nhm_ratio < 5) { + pt_score_tmp = ENABLE_PT_SCORE; + dm->is_disable_power_training = false; + } else { + pt_score_tmp = KEEP_PRE_PT_SCORE; + } + + PHYDM_DBG(dm, DBG_PWR_TRAIN, + "pkt_cnt{ofdm,cck,all} = {%d, %d, %d}, cnt_cca_all=%d\n", + dm->phy_dbg_info.num_qry_phy_status_ofdm, + dm->phy_dbg_info.num_qry_phy_status_cck, + crc_ok_cnt, cca_cnt); + + PHYDM_DBG(dm, DBG_PWR_TRAIN, "pt_score_tmp=%d\n", pt_score_tmp); + + /* smoothing */ + pt_t->pow_train_score = (pt_score_tmp << 4) + + (pt_t->pow_train_score >> 1) + + (pt_t->pow_train_score >> 2); + + pt_score_tmp = (pt_t->pow_train_score + 32) >> 6; + + PHYDM_DBG(dm, DBG_PWR_TRAIN, + "pow_train_score = %d, score after smoothing = %d, is_disable_PT = %d\n", + pt_t->pow_train_score, pt_score_tmp, + dm->is_disable_power_training); + } else { + PHYDM_DBG(dm, DBG_PWR_TRAIN, "[%s]warning\n", __func__); + } +} + +void phydm_pow_train_debug( + void *dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_pow_train_stuc *pt_t = &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)) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "{0: Auto PT, 1:enable, 2: disable}\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) + pt_t->pt_state = DYNAMIC_POW_TRAIN; + else if (var1[0] == 1) + pt_t->pt_state = ENABLE_POW_TRAIN; + else if (var1[0] == 2) + pt_t->pt_state = DISABLE_POW_TRAIN; + + PDM_SNPF(out_len, used, output + used, out_len - used, + "PT state = %d\n", pt_t->pt_state); + } + + *_used = used; + *_out_len = out_len; +} + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_pow_train.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_pow_train.h new file mode 100644 index 000000000000..4458351703c7 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_pow_train.h @@ -0,0 +1,85 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +#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 pt_state; + u32 pow_train_score; +}; + +/**************************************************************** + * 1 ============================================================ + * 1 enumeration + * 1 ============================================================ + ***************************************************************/ + +enum pow_train_state { + 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 *dm_void); + +void phydm_pow_train_debug( + void *dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len); + +#endif +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_pre_define.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_pre_define.h index 11146e96e909..b994fa1f167f 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_pre_define.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_pre_define.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,98 +9,129 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ +#ifndef __PHYDMPREDEFINE_H__ +#define __PHYDMPREDEFINE_H__ -#ifndef __PHYDMPREDEFINE_H__ -#define __PHYDMPREDEFINE_H__ - -/* 1 ============================================================ +/**************************************************************** + * 1 ============================================================ * 1 Definition - * 1 ============================================================ */ + * 1 ============================================================ + ***************************************************************/ -#define PHYDM_CODE_BASE "PHYDM_012" -#define PHYDM_RELEASE_DATE "20160900" +#define PHYDM_CODE_BASE "PHYDM_V35" +#define PHYDM_RELEASE_DATE "20181109.0" -/* Max path of IC */ +/*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_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_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_8192F 2 #define MAX_PATH_NUM_8197F 2 +#define MAX_PATH_NUM_8198F 4 +#define MAX_PATH_NUM_8197G 2 +#define MAX_PATH_NUM_8721D 1 +/*@AC-IC*/ +#define MAX_PATH_NUM_8821A 1 +#define MAX_PATH_NUM_8881A 1 #define MAX_PATH_NUM_8821C 1 +#define MAX_PATH_NUM_8195B 1 +#define MAX_PATH_NUM_8812A 2 +#define MAX_PATH_NUM_8822B 2 +#define MAX_PATH_NUM_8822C 2 +#define MAX_PATH_NUM_8814A 4 +#define MAX_PATH_NUM_8814B 4 +#define MAX_PATH_NUM_8814C 4 +#define MAX_PATH_NUM_8195B 1 +#define MAX_PATH_NUM_8812F 2 -/* Max RF path */ -#define ODM_RF_PATH_MAX 2 -#define ODM_RF_PATH_MAX_JAGUAR 4 - -/*Bit define path*/ -#define PHYDM_A BIT(0) -#define PHYDM_B BIT(1) -#define PHYDM_C BIT(2) -#define PHYDM_D BIT(3) -#define PHYDM_AB (BIT(0) | BIT(1)) -#define PHYDM_AC (BIT(0) | BIT(2)) -#define PHYDM_AD (BIT(0) | BIT(3)) -#define PHYDM_BC (BIT(1) | BIT(2)) -#define PHYDM_BD (BIT(1) | BIT(3)) -#define PHYDM_CD (BIT(2) | BIT(3)) -#define PHYDM_ABC (BIT(0) | BIT(1) | BIT(2)) -#define PHYDM_ABD (BIT(0) | BIT(1) | BIT(3)) -#define PHYDM_ACD (BIT(0) | BIT(2) | BIT(3)) -#define PHYDM_BCD (BIT(1) | BIT(2) | BIT(3)) -#define PHYDM_ABCD (BIT(0) | BIT(1) | BIT(2) | BIT(3)) +/* @Max RF path */ +#define PHYDM_MAX_RF_PATH_N 2 /*@For old N-series IC*/ +#define PHYDM_MAX_RF_PATH 4 /* number of entry */ #if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) - #define ASSOCIATE_ENTRY_NUM MACID_NUM_SW_LIMIT /* Max size of asoc_entry[].*/ - #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) + #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) +#elif(DM_ODM_SUPPORT_TYPE & (ODM_IOT)) + #ifdef CONFIG_CONCURRENT_MODE + #define ASSOCIATE_ENTRY_NUM NUM_STA + 2 /*@2 is for station mod*/ + #else + #define ASSOCIATE_ENTRY_NUM NUM_STA /*@8 is for max size of asoc_entry[].*/ + #endif + #define ODM_ASSOCIATE_ENTRY_NUM ASSOCIATE_ENTRY_NUM #else - #define ODM_ASSOCIATE_ENTRY_NUM ((ASSOCIATE_ENTRY_NUM*3)+1) + #define ODM_ASSOCIATE_ENTRY_NUM (((ASSOCIATE_ENTRY_NUM + 1) * 3) + 1) #endif -/* -----MGN rate--------------------------------- */ +/* @-----MGN rate--------------------------------- */ + +enum PDM_RATE_TYPE { + PDM_1SS = 1, /*VHT/HT 1SS*/ + PDM_2SS = 2, /*VHT/HT 2SS*/ + PDM_3SS = 3, /*VHT/HT 3SS*/ + PDM_4SS = 4, /*VHT/HT 4SS*/ + PDM_CCK = 11, /*@B*/ + PDM_OFDM = 12 /*@G*/ +}; enum ODM_MGN_RATE { ODM_MGN_1M = 0x02, ODM_MGN_2M = 0x04, - ODM_MGN_5_5M = 0x0B, + 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_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, + ODM_MGN_MCS7 = 0x87, ODM_MGN_MCS8, ODM_MGN_MCS9, ODM_MGN_MCS10, @@ -108,7 +140,7 @@ enum ODM_MGN_RATE { ODM_MGN_MCS13, ODM_MGN_MCS14, ODM_MGN_MCS15, - ODM_MGN_MCS16, + ODM_MGN_MCS16 = 0x90, ODM_MGN_MCS17, ODM_MGN_MCS18, ODM_MGN_MCS19, @@ -116,7 +148,7 @@ enum ODM_MGN_RATE { ODM_MGN_MCS21, ODM_MGN_MCS22, ODM_MGN_MCS23, - ODM_MGN_MCS24, + ODM_MGN_MCS24 = 0x98, ODM_MGN_MCS25, ODM_MGN_MCS26, ODM_MGN_MCS27, @@ -124,7 +156,7 @@ enum ODM_MGN_RATE { ODM_MGN_MCS29, ODM_MGN_MCS30, ODM_MGN_MCS31, - ODM_MGN_VHT1SS_MCS0, + ODM_MGN_VHT1SS_MCS0 = 0xa0, ODM_MGN_VHT1SS_MCS1, ODM_MGN_VHT1SS_MCS2, ODM_MGN_VHT1SS_MCS3, @@ -134,27 +166,27 @@ enum ODM_MGN_RATE { ODM_MGN_VHT1SS_MCS7, ODM_MGN_VHT1SS_MCS8, ODM_MGN_VHT1SS_MCS9, - ODM_MGN_VHT2SS_MCS0, - ODM_MGN_VHT2SS_MCS1, + 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, - ODM_MGN_VHT2SS_MCS6, + ODM_MGN_VHT2SS_MCS5 = 0xaf, + ODM_MGN_VHT2SS_MCS6 = 0xb0, ODM_MGN_VHT2SS_MCS7, ODM_MGN_VHT2SS_MCS8, - ODM_MGN_VHT2SS_MCS9, - ODM_MGN_VHT3SS_MCS0, + 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, - ODM_MGN_VHT3SS_MCS8, - ODM_MGN_VHT3SS_MCS9, - ODM_MGN_VHT4SS_MCS0, + 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, @@ -163,7 +195,7 @@ enum ODM_MGN_RATE { ODM_MGN_VHT4SS_MCS6, ODM_MGN_VHT4SS_MCS7, ODM_MGN_VHT4SS_MCS8, - ODM_MGN_VHT4SS_MCS9, + ODM_MGN_VHT4SS_MCS9 = 0xc7, ODM_MGN_UNKNOWN }; @@ -177,144 +209,173 @@ enum ODM_MGN_RATE { #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 +#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--------------------------------- */ +/* @-----DESC rate--------------------------------- */ -#define ODM_RATEMCS15_SG 0x1c -#define ODM_RATEMCS32 0x20 +#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 +enum phydm_ctrl_info_rate { + ODM_RATE1M = 0x00, + ODM_RATE2M = 0x01, + ODM_RATE5_5M = 0x02, + 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 + 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, +}; -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - #define ODM_NUM_RATE_IDX (ODM_RATEVHTSS4MCS9+1) +#define NUM_RATE_AC_4SS (ODM_RATEVHTSS4MCS9 + 1) +#define NUM_RATE_AC_3SS (ODM_RATEVHTSS3MCS9 + 1) +#define NUM_RATE_AC_2SS (ODM_RATEVHTSS2MCS9 + 1) +#define NUM_RATE_AC_1SS (ODM_RATEVHTSS1MCS9 + 1) +#define NUM_RATE_N_4SS (ODM_RATEMCS31 + 1) +#define NUM_RATE_N_3SS (ODM_RATEMCS23 + 1) +#define NUM_RATE_N_2SS (ODM_RATEMCS15 + 1) +#define NUM_RATE_N_1SS (ODM_RATEMCS7 + 1) + +/*Define from larger rate size to small rate size, DO NOT change the position*/ +/*[AC-4SS]*/ +#if (RTL8814B_SUPPORT) + #define PHY_NUM_RATE_IDX NUM_RATE_AC_4SS +/*[AC-3SS]*/ +#elif (RTL8814A_SUPPORT) + #define PHY_NUM_RATE_IDX NUM_RATE_AC_3SS +/*[AC-2SS]*/ +#elif (RTL8812A_SUPPORT || RTL8822B_SUPPORT || RTL8822C_SUPPORT ||\ + RTL8812F_SUPPORT) + #define PHY_NUM_RATE_IDX NUM_RATE_AC_2SS +/*[AC-1SS]*/ +#elif (RTL8881A_SUPPORT || RTL8821A_SUPPORT || RTL8821C_SUPPORT ||\ + RTL8195B_SUPPORT) + #define PHY_NUM_RATE_IDX NUM_RATE_AC_1SS +/*[N-4SS]*/ +#elif (RTL8198F_SUPPORT) + #define PHY_NUM_RATE_IDX NUM_RATE_N_4SS +/*[N-2SS]*/ +#elif (RTL8192E_SUPPORT || RTL8197F_SUPPORT || RTL8192F_SUPPORT ||\ + RTL8197G_SUPPORT) + #define PHY_NUM_RATE_IDX NUM_RATE_N_2SS +/*[N-1SS]*/ +#elif (RTL8723B_SUPPORT || RTL8703B_SUPPORT || RTL8188E_SUPPORT || \ + RTL8188F_SUPPORT || RTL8723D_SUPPORT || RTL8195A_SUPPORT ||\ + RTL8710B_SUPPORT || RTL8721D_SUPPORT) + #define PHY_NUM_RATE_IDX NUM_RATE_N_1SS #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 + #define PHY_NUM_RATE_IDX NUM_RATE_AC_4SS #endif #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) #define CONFIG_SFW_SUPPORTED #endif -/* 1 ============================================================ +/**************************************************************** + * 1 ============================================================ * 1 enumeration - * 1 ============================================================ */ - + * 1 ============================================================ + ***************************************************************/ /* ODM_CMNINFO_INTERFACE */ -enum odm_interface_e { +enum odm_interface { ODM_ITRF_PCIE = 0x1, ODM_ITRF_USB = 0x2, ODM_ITRF_SDIO = 0x4, ODM_ITRF_ALL = 0x7, }; -/* ODM_CMNINFO_IC_TYPE */ -enum odm_ic_type_e { +enum phydm_api_host { + RUN_IN_FW = 0, + RUN_IN_DRIVER = 1, +}; + +/*@========[Run time IC flag] ===================================*/ + +enum phydm_ic { ODM_RTL8188E = BIT(0), ODM_RTL8812 = BIT(1), ODM_RTL8821 = BIT(2), @@ -330,348 +391,519 @@ enum odm_ic_type_e { ODM_RTL8197F = BIT(12), ODM_RTL8821C = BIT(13), ODM_RTL8814B = BIT(14), - ODM_RTL8198F = BIT(15) + ODM_RTL8198F = BIT(15), + ODM_RTL8710B = BIT(16), + ODM_RTL8192F = BIT(17), + ODM_RTL8822C = BIT(18), + ODM_RTL8195B = BIT(19), + ODM_RTL8812F = BIT(20), + ODM_RTL8197G = BIT(21), + ODM_RTL8721D = BIT(22) }; +#define ODM_IC_N_1SS (ODM_RTL8188E | ODM_RTL8188F | ODM_RTL8723B |\ + ODM_RTL8703B | ODM_RTL8723D | ODM_RTL8195A |\ + ODM_RTL8710B | ODM_RTL8721D) +#define ODM_IC_N_2SS (ODM_RTL8192E | ODM_RTL8197F | ODM_RTL8192F) +#define ODM_IC_N_3SS 0 +#define ODM_IC_N_4SS 0 -#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_AC_1SS (ODM_RTL8881A | ODM_RTL8821 | ODM_RTL8821C |\ + ODM_RTL8195B) +#define ODM_IC_AC_2SS (ODM_RTL8812 | ODM_RTL8822B) +#define ODM_IC_AC_3SS 0 +#define ODM_IC_AC_4SS (ODM_RTL8814A) +#define ODM_IC_JGR3_1SS 0 +#define ODM_IC_JGR3_2SS (ODM_RTL8822C | ODM_RTL8812F | ODM_RTL8197G) +#define ODM_IC_JGR3_3SS 0 +#define ODM_IC_JGR3_4SS (ODM_RTL8198F | ODM_RTL8814B) -#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) +/*@====the following macro DO NOT need to update when adding a new IC======= */ +#define ODM_IC_1SS (ODM_IC_N_1SS | ODM_IC_AC_1SS | ODM_IC_JGR3_1SS) +#define ODM_IC_2SS (ODM_IC_N_2SS | ODM_IC_AC_2SS | ODM_IC_JGR3_2SS) +#define ODM_IC_3SS (ODM_IC_N_3SS | ODM_IC_AC_3SS | ODM_IC_JGR3_3SS) +#define ODM_IC_4SS (ODM_IC_N_4SS | ODM_IC_AC_4SS | ODM_IC_JGR3_4SS) -#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_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 PHYDM_IC_SUPPORT_LA_MODE (ODM_RTL8814A | ODM_RTL8822B | ODM_RTL8197F | ODM_RTL8821C) +#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_JGR3_SERIES (ODM_IC_JGR3_1SS | ODM_IC_JGR3_2SS |\ + ODM_IC_JGR3_3SS | ODM_IC_JGR3_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 |\ + ODM_RTL8195B) + +/*@[Phy status type]*/ +#define PHYSTS_2ND_TYPE_IC (ODM_RTL8197F | ODM_RTL8822B | ODM_RTL8723D |\ + ODM_RTL8821C | ODM_RTL8710B | ODM_RTL8195B |\ + ODM_RTL8192F | ODM_RTL8721D) +#define PHYSTS_3RD_TYPE_IC (ODM_RTL8198F | ODM_RTL8814B | ODM_RTL8822C |\ + ODM_RTL8812F | ODM_RTL8197G) +/*@[FW Type]*/ +#define PHYDM_IC_8051_SERIES (ODM_RTL8881A | ODM_RTL8812 | ODM_RTL8821 |\ + ODM_RTL8192E | ODM_RTL8723B | ODM_RTL8703B |\ + ODM_RTL8188F | ODM_RTL8192F | ODM_RTL8721D) +#define PHYDM_IC_3081_SERIES (ODM_RTL8814A | ODM_RTL8822B | ODM_RTL8197F |\ + ODM_RTL8821C | ODM_RTL8195B | ODM_RTL8198F |\ + ODM_RTL8822C | ODM_RTL8812F | ODM_RTL8814B |\ + ODM_RTL8197G) +/*@[LA mode]*/ +#define PHYDM_IC_SUPPORT_LA_MODE (ODM_RTL8814A | ODM_RTL8822B | ODM_RTL8197F |\ + ODM_RTL8821C | ODM_RTL8195B | ODM_RTL8198F |\ + ODM_RTL8192F | ODM_RTL8822C | ODM_RTL8812F |\ + ODM_RTL8195B | ODM_RTL8814B | ODM_RTL8197G) +/*@[BF]*/ +#define ODM_IC_TXBF_SUPPORT (ODM_RTL8192E | ODM_RTL8812 | ODM_RTL8821 |\ + ODM_RTL8814A | ODM_RTL8881A | ODM_RTL8822B |\ + ODM_RTL8197F | ODM_RTL8821C | ODM_RTL8195B |\ + ODM_RTL8198F | ODM_RTL8822C | ODM_RTL8812F |\ + ODM_RTL8814B | ODM_RTL8197G) +#define PHYDM_IC_SUPPORT_MU_BFEE (ODM_RTL8822B | ODM_RTL8821C | ODM_RTL8814B |\ + ODM_RTL8195B | ODM_RTL8198F | ODM_RTL8822C |\ + ODM_RTL8812F) +#define PHYDM_IC_SUPPORT_MU_BFER (ODM_RTL8822B | ODM_RTL8814B | ODM_RTL8198F |\ + ODM_RTL8822C | ODM_RTL8812F) + +#define PHYDM_IC_SUPPORT_MU (PHYDM_IC_SUPPORT_MU_BFEE |\ + PHYDM_IC_SUPPORT_MU_BFER) +/*@[PHYDM API]*/ +#define CMN_API_SUPPORT_IC (ODM_RTL8822B | ODM_RTL8197F | ODM_RTL8192F |\ + ODM_RTL8821C | ODM_RTL8195B | ODM_RTL8822C |\ + ODM_RTL8198F | ODM_RTL8812F | ODM_RTL8814B |\ + ODM_RTL8197G | ODM_RTL8721D) + +/*@========[Compile time IC flag] ========================*/ +/*@========[AC-3/AC/N Support] ===========================*/ + +#if (RTL8814B_SUPPORT || RTL8198F_SUPPORT || RTL8822C_SUPPORT ||\ + RTL8812F_SUPPORT || RTL8197G_SUPPORT) + #define PHYDM_IC_JGR3_SERIES_SUPPORT + #if (RTL8814B_SUPPORT || RTL8822C_SUPPORT || RTL8812F_SUPPORT) + #define PHYDM_IC_JGR3_80M_SUPPORT + #endif +#endif #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 + #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 + #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 -#define ODM_CONFIG_BT_COEXIST 1 + #define ODM_IC_11AC_SERIES_SUPPORT 1 + #define ODM_IC_11N_SERIES_SUPPORT 1 -#else +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) -#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 + #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_V2) + + #define ODM_IC_11AC_SERIES_SUPPORT 1 + #define ODM_IC_11N_SERIES_SUPPORT 1 + +#else /*ODM_CE*/ + + #if (RTL8188E_SUPPORT || RTL8723B_SUPPORT || RTL8192E_SUPPORT ||\ + RTL8195A_SUPPORT || RTL8703B_SUPPORT || RTL8188F_SUPPORT ||\ + RTL8723D_SUPPORT || RTL8197F_SUPPORT || RTL8710B_SUPPORT ||\ + RTL8192F_SUPPORT || RTL8721D_SUPPORT) + #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 -#ifdef CONFIG_BT_COEXIST - #define ODM_CONFIG_BT_COEXIST 1 +/*@===IC SS Compile Flag, prepare for code size reduction==============*/ +#if (RTL8188E_SUPPORT || RTL8188F_SUPPORT || RTL8723B_SUPPORT ||\ + RTL8703B_SUPPORT || RTL8723D_SUPPORT || RTL8881A_SUPPORT ||\ + RTL8821A_SUPPORT || RTL8821C_SUPPORT || RTL8195A_SUPPORT ||\ + RTL8710B_SUPPORT || RTL8195B_SUPPORT || RTL8721D_SUPPORT) + + #define PHYDM_COMPILE_IC_1SS +#endif + +#if (RTL8192E_SUPPORT || RTL8197F_SUPPORT || RTL8812A_SUPPORT ||\ + RTL8822B_SUPPORT || RTL8192F_SUPPORT || RTL8822C_SUPPORT ||\ + RTL8812F_SUPPORT || RTL8197G_SUPPORT) + #define PHYDM_COMPILE_IC_2SS +#endif + +/*@#define PHYDM_COMPILE_IC_3SS*/ + +#if ((RTL8814B_SUPPORT) || (RTL8814A_SUPPORT) || (RTL8198F_SUPPORT)) + #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 + +/*@==[Max RF path number among all compiled ICs]==============================*/ +/*@ ex: support 8814B & 8821C => size=4 */ +/*@ ex: support 8822C & 8821C => size=2 */ +#if (defined(PHYDM_COMPILE_IC_4SS)) + #define RF_PATH_MEM_SIZE 4 +#elif (defined(PHYDM_COMPILE_IC_3SS)) + #define RF_PATH_MEM_SIZE 3 +#elif (defined(PHYDM_COMPILE_IC_2SS)) + #define RF_PATH_MEM_SIZE 2 #else - #define ODM_CONFIG_BT_COEXIST 0 + #define RF_PATH_MEM_SIZE 1 #endif -#endif - - -#if ((RTL8197F_SUPPORT == 1) || (RTL8723D_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) || (RTL8821C_SUPPORT == 1)) +/*@========[New Phy-Status Support] ========================*/ +#if (RTL8197F_SUPPORT || RTL8723D_SUPPORT || RTL8822B_SUPPORT ||\ + RTL8821C_SUPPORT || RTL8710B_SUPPORT || RTL8195B_SUPPORT ||\ + RTL8192F_SUPPORT || RTL8721D_SUPPORT) #define ODM_PHY_STATUS_NEW_TYPE_SUPPORT 1 #else #define ODM_PHY_STATUS_NEW_TYPE_SUPPORT 0 #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, +#if (RTL8198F_SUPPORT) || (RTL8814B_SUPPORT) || (RTL8822C_SUPPORT) ||\ + (RTL8812F_SUPPORT) || (RTL8197G_SUPPORT) + #define PHYSTS_3RD_TYPE_SUPPORT +#endif - ODM_CUT_I = 8, - ODM_CUT_J = 9, - ODM_CUT_K = 10, - ODM_CUT_TEST = 15, +#if (RTL8198F_SUPPORT || RTL8814B_SUPPORT || RTL8822C_SUPPORT ||\ + RTL8812F_SUPPORT || RTL8197G_SUPPORT) + #define BB_RAM_SUPPORT +#endif + +#if (RTL8821C_SUPPORT || RTL8822B_SUPPORT || RTL8822C_SUPPORT ||\ + RTL8812F_SUPPORT || RTL8814B_SUPPORT || RTL8195B_SUPPORT ||\ + RTL8198F_SUPPORT) + #define PHYDM_COMPILE_MU +#endif + +#if (RTL8822B_SUPPORT) + #define CONFIG_MU_JAGUAR_2 +#endif + +#if (RTL8814B_SUPPORT || RTL8822C_SUPPORT) + #define CONFIG_MU_JAGUAR_3 +#endif + +#if (defined(CONFIG_MU_JAGUAR_2) || defined(CONFIG_MU_JAGUAR_3)) +#if (RTL8814B_SUPPORT) + #define MU_EX_MACID 76 + #elif (RTL8822B_SUPPORT || RTL8822C_SUPPORT) + #define MU_EX_MACID 30 + #endif +#endif +/*@============================================================================*/ + +#if (RTL8822B_SUPPORT || RTL8197F_SUPPORT || RTL8821C_SUPPORT ||\ + RTL8192F_SUPPORT || RTL8195B_SUPPORT || RTL8822C_SUPPORT ||\ + RTL8198F_SUPPORT || RTL8812F_SUPPORT || RTL8814B_SUPPORT ||\ + RTL8197G_SUPPORT || RTL8721D_SUPPORT) +#define PHYDM_COMMON_API_SUPPORT +#endif + + +#define CCK_RATE_NUM 4 +#define OFDM_RATE_NUM 8 + +#define LEGACY_RATE_NUM 12 + +#define HT_RATE_NUM_4SS 32 +#define VHT_RATE_NUM_4SS 40 + +#define HT_RATE_NUM_3SS 24 +#define VHT_RATE_NUM_3SS 30 + +#define HT_RATE_NUM_2SS 16 +#define VHT_RATE_NUM_2SS 20 + +#define HT_RATE_NUM_1SS 8 +#define VHT_RATE_NUM_1SS 10 +#if (defined(PHYDM_COMPILE_ABOVE_4SS)) + #define HT_RATE_NUM HT_RATE_NUM_4SS + #define VHT_RATE_NUM VHT_RATE_NUM_4SS +#elif (defined(PHYDM_COMPILE_ABOVE_3SS)) + #define HT_RATE_NUM HT_RATE_NUM_3SS + #define VHT_RATE_NUM VHT_RATE_NUM_3SS +#elif (defined(PHYDM_COMPILE_ABOVE_2SS)) + #define HT_RATE_NUM HT_RATE_NUM_2SS + #define VHT_RATE_NUM VHT_RATE_NUM_2SS +#else + #define HT_RATE_NUM HT_RATE_NUM_1SS + #define VHT_RATE_NUM VHT_RATE_NUM_1SS +#endif + +#define LOW_BW_RATE_NUM VHT_RATE_NUM + +enum phydm_ic_ip { + PHYDM_IC_N = 0, + PHYDM_IC_AC = 1, + PHYDM_IC_JGR3 = 2 +}; + +enum phydm_phy_sts_type { + PHYDM_PHYSTS_TYPE_1 = 1, + PHYDM_PHYSTS_TYPE_2 = 2, + PHYDM_PHYSTS_TYPE_3 = 3 +}; + +/* ODM_CMNINFO_CUT_VER */ +enum odm_cut_version { + 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_L = 11, + ODM_CUT_M = 12, + ODM_CUT_N = 13, + ODM_CUT_O = 14, + ODM_CUT_TEST = 15, }; /* ODM_CMNINFO_FAB_VER */ -enum odm_fab_e { - ODM_TSMC = 0, - ODM_UMC = 1, -}; - -/* ODM_CMNINFO_RF_TYPE - * - * For example 1T2R (A+AB = BIT(0)|BIT(4)|BIT(5)) - * */ -enum odm_rf_path_e { - ODM_RF_A = BIT(0), - ODM_RF_B = BIT(1), - ODM_RF_C = BIT(2), - ODM_RF_D = BIT(3), -}; - -enum odm_rf_tx_num_e { - ODM_1T = 1, - ODM_2T = 2, - ODM_3T = 3, - ODM_4T = 4, -}; - -enum odm_rf_type_e { - ODM_1T1R, - ODM_1T2R, - ODM_2T2R, - ODM_2T2R_GREEN, - ODM_2T3R, - ODM_2T4R, - ODM_3T3R, - ODM_3T4R, - ODM_4T4R, - ODM_XTXR -}; - - -enum odm_mac_phy_mode_e { - ODM_SMSP = 0, - ODM_DMSP = 1, - ODM_DMDP = 2, -}; - - -enum odm_bt_coexist_e { - ODM_BT_BUSY = 1, - ODM_BT_ON = 2, - ODM_BT_OFF = 3, - ODM_BT_NONE = 4, +enum odm_fab { + ODM_TSMC = 0, + ODM_UMC = 1, }; /* ODM_CMNINFO_OP_MODE */ -enum odm_operation_mode_e { +enum odm_operation_mode { ODM_NO_LINK = BIT(0), - ODM_LINK = BIT(1), - ODM_SCAN = BIT(2), - ODM_POWERSAVE = BIT(3), + ODM_LINK = BIT(1), + ODM_SCAN = BIT(2), + ODM_POWERSAVE = BIT(3), ODM_AP_MODE = BIT(4), - ODM_CLIENT_MODE = BIT(5), + ODM_CLIENT_MODE = BIT(5), ODM_AD_HOC = BIT(6), - ODM_WIFI_DIRECT = BIT(7), + 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), +enum odm_wireless_mode { + 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*/ +enum odm_wireless_mode { + 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 { +enum odm_band_type { #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - ODM_BAND_2_4G = BIT(0), + ODM_BAND_2_4G = BIT(0), ODM_BAND_5G = BIT(1), #else - ODM_BAND_2_4G = 0, + 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, +enum phydm_sec_chnl_offset { + PHYDM_DONT_CARE = 0, PHYDM_BELOW = 1, PHYDM_ABOVE = 2 }; /* ODM_CMNINFO_SEC_MODE */ -enum odm_security_e { - ODM_SEC_OPEN = 0, +enum odm_security { + ODM_SEC_OPEN = 0, ODM_SEC_WEP40 = 1, - ODM_SEC_TKIP = 2, + 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_BW */ -enum odm_bw_e { - ODM_BW20M = 0, - ODM_BW40M = 1, - ODM_BW80M = 2, - ODM_BW160M = 3, - ODM_BW5M = 4, - ODM_BW10M = 5, - ODM_BW_MAX = 6 + 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_board_type { + 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_package_type { + 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_gpa { + 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_apa { + 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_glna { + 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, +enum odm_type_alna { + 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_rf_radio_path_e { - 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 */ +enum odm_parameter_init { + ODM_PRE_SETTING = 0, + ODM_POST_SETTING = 1, + ODM_INIT_FW_SETTING }; -enum odm_parameter_init_e { - ODM_PRE_SETTING = 0, - ODM_POST_SETTING = 1, +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 +}; + +enum phydm_dis_hw_fun { + HW_FUN_DIS = 0, /*@Disable a cetain HW function & backup the original value*/ + HW_FUN_RESUME = 1 /*Revert */ }; #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_precomp.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_precomp.h index 5ca623d440df..0fdfe62e9250 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_precomp.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_precomp.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,28 +9,34 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ -#ifndef __ODM_PRECOMP_H__ +#ifndef __ODM_PRECOMP_H__ #define __ODM_PRECOMP_H__ #include "phydm_types.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. */ + #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 */ +/* @2 Config Flags and Structs - defined by each ODM type */ #if (DM_ODM_SUPPORT_TYPE == ODM_AP) #include "../8192cd_cfg.h" @@ -37,18 +44,25 @@ #include "../8192cd.h" #include "../8192cd_util.h" + #include "../8192cd_hw.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 + #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" + #elif defined(DM_ODM_CE_MAC80211_V2) + #include "../main.h" + #include "../hw.h" + #include "../fw.h" + #endif #define __PACK #define __WLAN_ATTRIB_PACK__ #elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) @@ -56,40 +70,59 @@ #define ODM_ENDIAN_TYPE ODM_ENDIAN_LITTLE #define __PACK #define __WLAN_ATTRIB_PACK__ +#elif (DM_ODM_SUPPORT_TYPE == ODM_IOT) + #include + #include + #define ODM_ENDIAN_TYPE ODM_ENDIAN_LITTLE + #define __PACK #endif -/* 2 OutSrc Header Files */ +/* @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" +#include "halrf/halrf_debug.h" -#include "phydm_adc_sampling.h" +#if (DM_ODM_SUPPORT_TYPE & ODM_CE) && \ + (!defined(DM_ODM_CE_MAC80211) && !defined(DM_ODM_CE_MAC80211_V2)) -#if (DM_ODM_SUPPORT_TYPE & ODM_CE) +void phy_set_tx_power_limit( + struct dm_struct *dm, + u8 *regulation, + u8 *band, + u8 *bandwidth, + u8 *rate_section, + u8 *rf_path, + u8 *channel, + u8 *power_limit); -void -phy_set_tx_power_limit( - struct PHY_DM_STRUCT *p_dm_odm, - 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 dm_struct *dm, + u8 clear, + u8 segment); + +enum hal_status +rtw_phydm_cfg_phy_para( + struct dm_struct *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 +/* @Judy ADD 20180125 */ +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP | ODM_IOT)) +#define RTL8710B_SUPPORT 0 #endif #if RTL8188E_SUPPORT == 1 @@ -101,80 +134,84 @@ phy_set_tx_power_limit( #endif #endif +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) +#define RTL8197F_SUPPORT 0 /*@Just for PHYDM API development*/ +#define RTL8195B_SUPPORT 0 /*@Just for PHYDM API development*/ +#define RTL8198F_SUPPORT 0 /*@Just for PHYDM API development*/ +#define RTL8812F_SUPPORT 0 /*@Just for PHYDM API development*/ +#define RTL8197G_SUPPORT 0 /*@Just for PHYDM API development*/ +#endif + #if (RTL8188E_SUPPORT == 1) - #include "rtl8188e/hal8188erateadaptive.h" /* for RA,Power training */ + #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" + #include "halrf/rtl8188e/halrf_8188e_ce.h" #endif #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - #include "rtl8188e/halphyrf_8188e_win.h" + #include "halrf/rtl8188e/halrf_8188e_win.h" #endif #if (DM_ODM_SUPPORT_TYPE == ODM_AP) - #include "rtl8188e/halphyrf_8188e_ap.h" + #include "halrf/rtl8188e/halrf_8188e_ap.h" #endif -#endif /* 88E END */ +#endif /* @88E END */ #if (RTL8192E_SUPPORT == 1) #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - #include "rtl8192e/halphyrf_8192e_win.h" /*FOR_8192E_IQK*/ + #include "halrf/rtl8192e/halrf_8192e_win.h" /*@FOR_8192E_IQK*/ #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) - #include "rtl8192e/halphyrf_8192e_ap.h" /*FOR_8192E_IQK*/ + #include "halrf/rtl8192e/halrf_8192e_ap.h" /*@FOR_8192E_IQK*/ #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - #include "rtl8192e/halphyrf_8192e_ce.h" /*FOR_8192E_IQK*/ + #include "halrf/rtl8192e/halrf_8192e_ce.h" /*@FOR_8192E_IQK*/ #endif - #include "rtl8192e/phydm_rtl8192e.h" /* FOR_8192E_IQK */ + #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 */ +#endif /* @92E END */ #if (RTL8812A_SUPPORT == 1) #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - #include "rtl8812a/halphyrf_8812a_win.h" + #include "halrf/rtl8812a/halrf_8812a_win.h" #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) - #include "rtl8812a/halphyrf_8812a_ap.h" + #include "halrf/rtl8812a/halrf_8812a_ap.h" #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - #include "rtl8812a/halphyrf_8812a_ce.h" + #include "halrf/rtl8812a/halrf_8812a_ce.h" #endif - /* #include "rtl8812a/HalPhyRf_8812A.h" */ /* FOR_8812_IQK */ + /* @#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/halhwimg8812a_fw.h" - #include "rtl8812a/phydm_rtl8812a.h" #endif + #include "rtl8812a/phydm_rtl8812a.h" #if (DM_ODM_SUPPORT_TYPE == ODM_CE) #include "rtl8812a_hal.h" #endif #include "rtl8812a/version_rtl8812a.h" -#endif /* 8812 END */ +#endif /* @8812 END */ #if (RTL8814A_SUPPORT == 1) @@ -183,54 +220,50 @@ phy_set_tx_power_limit( #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" + #include "halrf/rtl8814a/halrf_8814a_win.h" #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - #include "rtl8814a/halphyrf_8814a_ce.h" + #include "halrf/rtl8814a/halrf_8814a_ce.h" #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) - #include "rtl8814a/halphyrf_8814a_ap.h" + #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 "rtl8814a/phydm_iqk_8814a.h" + #include "halrf/rtl8814a/halrf_iqk_8814a.h" #endif -#endif /* 8814 END */ +#endif /* @8814 END */ -#if (RTL8881A_SUPPORT == 1)/* FOR_8881_IQK */ +#if (RTL8881A_SUPPORT == 1)/* @FOR_8881_IQK */ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - #include "rtl8821a/phydm_iqk_8821a_win.h" + #include "halrf/rtl8821a/halrf_iqk_8821a_win.h" #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - #include "rtl8821a/phydm_iqk_8821a_ce.h" + #include "halrf/rtl8821a/halrf_iqk_8821a_ce.h" #else - #include "rtl8821a/phydm_iqk_8821a_ap.h" + #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" */ + /* @#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" + #include "halrf/rtl8723b/halrf_8723b_win.h" #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - #include "rtl8723b/halphyrf_8723b_ce.h" + #include "halrf/rtl8723b/halrf_8723b_ce.h" #include "rtl8723b/halhwimg8723b_mp.h" #include "rtl8723b_hal.h" #else - #include "rtl8723b/halphyrf_8723b_ap.h" + #include "halrf/rtl8723b/halrf_8723b_ap.h" #endif #endif @@ -238,48 +271,59 @@ phy_set_tx_power_limit( #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" + #include "halrf/rtl8821a/halrf_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 "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" +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211_V2) +#include "../halmac/halmac_reg2.h" +#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 "halrf/rtl8822b/halrf_8822b.h" + #include "halrf/rtl8822b/halhwimg8822b_rf.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.*/ + #ifdef DM_ODM_CE_MAC80211 + #include "../halmac/halmac_reg_8822b.h" + #elif defined(DM_ODM_CE_MAC80211_V2) + #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_rtl8703b.h" #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 "halrf/rtl8703b/halrf_8703b.h" #include "rtl8703b/version_rtl8703b.h" #if (DM_ODM_SUPPORT_TYPE == ODM_CE) #include "rtl8703b_hal.h" @@ -290,11 +334,10 @@ phy_set_tx_power_limit( #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 "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" @@ -308,44 +351,172 @@ phy_set_tx_power_limit( #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 "halrf/rtl8723d/halrf_8723d.h" #include "rtl8723d/version_rtl8723d.h" #endif #if (DM_ODM_SUPPORT_TYPE == ODM_CE) + #ifdef DM_ODM_CE_MAC80211 + #else #include "rtl8723d_hal.h" + #endif #endif -#endif /* 8723D End */ +#endif /* @8723D End */ + +#if (RTL8710B_SUPPORT == 1) + #if (DM_ODM_SUPPORT_TYPE != ODM_AP) + + #include "rtl8710b/halhwimg8710b_bb.h" + #include "rtl8710b/halhwimg8710b_mac.h" + #include "rtl8710b/phydm_regconfig8710b.h" + #include "rtl8710b/hal8710breg.h" + #include "rtl8710b/phydm_rtl8710b.h" + #include "halrf/rtl8710b/halrf_8710b.h" + #include "halrf/rtl8710b/halhwimg8710b_rf.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 "rtl8197f/halphyrf_8197f.h" - #include "rtl8197f/phydm_iqk_8197f.h" + #include "halrf/rtl8197f/halrf_8197f.h" + #include "halrf/rtl8197f/halrf_iqk_8197f.h" + #include "halrf/rtl8197f/halrf_dpk_8197f.h" + #include "halrf/rtl8197f/halhwimg8197f_rf.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 "halrf/rtl8821c/halrf_8821c.h" + #include "halrf/rtl8821c/halhwimg8821c_rf.h" #include "rtl8821c/version_rtl8821c.h" #if (DM_ODM_SUPPORT_TYPE == ODM_CE) + #ifdef DM_ODM_CE_MAC80211 + #include "../halmac/halmac_reg_8821c.h" + #else #include "rtl8821c_hal.h" + #endif #endif #endif -#endif /* __ODM_PRECOMP_H__ */ +#if (RTL8192F_SUPPORT == 1) + #if (DM_ODM_SUPPORT_TYPE == ODM_CE) + #include "rtl8192f_hal.h"/*need to before rf.h*/ + #endif + #include "rtl8192f/halhwimg8192f_mac.h" + #include "rtl8192f/halhwimg8192f_bb.h" + #include "rtl8192f/phydm_hal_api8192f.h" + #include "rtl8192f/version_rtl8192f.h" + #include "rtl8192f/phydm_rtl8192f.h" + #include "rtl8192f/phydm_regconfig8192f.h" + #include "halrf/rtl8192f/halrf_8192f.h" + #include "halrf/rtl8192f/halhwimg8192f_rf.h" + #if (DM_ODM_SUPPORT_TYPE == ODM_AP) + #include "halrf/rtl8192f/halrf_dpk_8192f.h" + #endif +#endif + +#if (RTL8721D_SUPPORT == 1) + #include "halrf/rtl8721d/halrf_8721d.h" + #include "halrf/rtl8721d/halhwimg8721d_rf.h" + + #include "rtl8721d/phydm_hal_api8721d.h" + #include "rtl8721d/phydm_regconfig8721d.h" + #include "rtl8721d/halhwimg8721d_mac.h" + #include "rtl8721d/halhwimg8721d_bb.h" + #include "rtl8721d/version_rtl8721d.h" + #include "rtl8721d/phydm_rtl8721d.h" + #include "rtl8721d/hal8721dreg.h" + #include + #if 0 + #if (DM_ODM_SUPPORT_TYPE == ODM_AP) + #include "halrf/rtl8721d/halrf_dpk_8721d.h" + #endif + #if (DM_ODM_SUPPORT_TYPE == ODM_CE) + #include "rtl8721d_hal.h" + #endif + #endif +#endif +#if (RTL8195B_SUPPORT == 1) + #include "halrf/rtl8195b/halrf_8195b.h" + #include "halrf/rtl8195b/halhwimg8195b_rf.h" + + #include "rtl8195b/phydm_hal_api8195b.h" + #include "rtl8195b/phydm_regconfig8195b.h" + #include "rtl8195b/halhwimg8195b_mac.h" + #include "rtl8195b/halhwimg8195b_bb.h" + #include "rtl8195b/version_rtl8195b.h" + #include /*@HAL_DATA_TYPE*/ +#endif + +#if (RTL8198F_SUPPORT == 1) + #include "rtl8198f/phydm_regconfig8198f.h" + #include "rtl8198f/phydm_hal_api8198f.h" + #include "rtl8198f/halhwimg8198f_mac.h" + #include "rtl8198f/halhwimg8198f_bb.h" + #include "rtl8198f/version_rtl8198f.h" + #include "halrf/rtl8198f/halrf_8198f.h" + #include "halrf/rtl8198f/halrf_iqk_8198f.h" + #include "halrf/rtl8198f/halhwimg8198f_rf.h" +#endif + +#if (RTL8822C_SUPPORT) + #include "rtl8822c/halhwimg8822c_mac.h" + #include "rtl8822c/halhwimg8822c_bb.h" + #include "rtl8822c/phydm_regconfig8822c.h" + #include "halrf/rtl8822c/halrf_8822c.h" + #include "halrf/rtl8822c/halhwimg8822c_rf.h" + #include "halrf/rtl8822c/version_rtl8822c_rf.h" + #include "rtl8822c/phydm_hal_api8822c.h" + #include "rtl8822c/version_rtl8822c.h" + #if (DM_ODM_SUPPORT_TYPE == ODM_CE) + /* @struct HAL_DATA_TYPE */ + #include + /* @RX_SMOOTH_FACTOR, reg definition and etc.*/ + #include + #endif +#endif +#if (RTL8814B_SUPPORT == 1) + #include "rtl8814b/halhwimg8814b_mac.h" + #include "rtl8814b/halhwimg8814b_bb.h" + #include "rtl8814b/phydm_regconfig8814b.h" + #include "halrf/rtl8814b/halrf_8814b.h" + #include "halrf/rtl8814b/halhwimg8814b_rf.h" + #include "rtl8814b/phydm_hal_api8814b.h" + #include "rtl8814b/version_rtl8814b.h" + #if (DM_ODM_SUPPORT_TYPE == ODM_CE) + #include /* @struct HAL_DATA_TYPE */ + #include /* @RX_SMOOTH_FACTOR, reg definition and etc.*/ + #endif +#endif +#if (RTL8812F_SUPPORT) + #include "rtl8812f/halhwimg8812f_mac.h" + #include "rtl8812f/halhwimg8812f_bb.h" + #include "rtl8812f/phydm_regconfig8812f.h" + #include "halrf/rtl8812f/halrf_8812f.h" + #include "halrf/rtl8812f/halhwimg8812f_rf.h" + #include "rtl8812f/phydm_hal_api8812f.h" + #include "rtl8812f/version_rtl8812f.h" +#endif +#if (RTL8197G_SUPPORT) + #include "rtl8197g/halhwimg8197g_mac.h" + #include "rtl8197g/halhwimg8197g_bb.h" + #include "rtl8197g/phydm_regconfig8197g.h" + #include "halrf/rtl8197g/halrf_8197g.h" + #include "halrf/rtl8197g/halhwimg8197g_rf.h" + #include "rtl8197g/phydm_hal_api8197g.h" + #include "rtl8197g/version_rtl8197g.h" +#endif +#endif /* @__ODM_PRECOMP_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_primary_cca.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_primary_cca.c new file mode 100644 index 000000000000..341dfe2b50b4 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_primary_cca.c @@ -0,0 +1,174 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +/************************************************************* + * include files + ************************************************************/ +#include "mp_precomp.h" +#include "phydm_precomp.h" +#ifdef PHYDM_PRIMARY_CCA + +void phydm_write_dynamic_cca( + void *dm_void, + u8 curr_mf_state + + ) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_pricca_struct *pri_cca = &dm->dm_pri_cca; + + if (pri_cca->mf_state == curr_mf_state) + return; + + if (dm->support_ic_type & ODM_IC_11N_SERIES) { + if (curr_mf_state == MF_USC_LSC) { + odm_set_bb_reg(dm, R_0xc6c, 0x180, MF_USC_LSC); + /*@40M OFDM MF CCA threshold*/ + odm_set_bb_reg(dm, R_0xc84, 0xf0000000, + pri_cca->cca_th_40m_bkp); + } else { + odm_set_bb_reg(dm, R_0xc6c, 0x180, curr_mf_state); + /*@40M OFDM MF CCA threshold*/ + odm_set_bb_reg(dm, R_0xc84, 0xf0000000, 0); + } + } + + pri_cca->mf_state = curr_mf_state; + PHYDM_DBG(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 *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_pricca_struct *pri_cca = &dm->dm_pri_cca; + + PHYDM_DBG(dm, DBG_PRI_CCA, "[PriCCA] Reset\n"); + pri_cca->mf_state = 0xff; + pri_cca->pre_bw = (enum channel_width)0xff; + phydm_write_dynamic_cca(dm, MF_USC_LSC); +} + +void phydm_primary_cca_11n( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_pricca_struct *pri_cca = &dm->dm_pri_cca; + enum channel_width curr_bw = (enum channel_width)*dm->band_width; + + if (!(dm->support_ability & ODM_BB_PRIMARY_CCA)) + return; + + if (!dm->is_linked) { + PHYDM_DBG(dm, DBG_PRI_CCA, "[PriCCA][No Link!!!]\n"); + + if (pri_cca->pri_cca_is_become_linked) { + phydm_primary_cca_reset(dm); + pri_cca->pri_cca_is_become_linked = dm->is_linked; + } + return; + } else { + if (!pri_cca->pri_cca_is_become_linked) { + PHYDM_DBG(dm, DBG_PRI_CCA, "[PriCCA][Linked !!!]\n"); + pri_cca->pri_cca_is_become_linked = dm->is_linked; + } + } + + if (curr_bw != pri_cca->pre_bw) { + PHYDM_DBG(dm, DBG_PRI_CCA, "[Primary CCA] start ==>\n"); + pri_cca->pre_bw = curr_bw; + + if (curr_bw == CHANNEL_WIDTH_40) { + if (*dm->sec_ch_offset == SECOND_CH_AT_LSB) { + /* Primary CH @ upper sideband*/ + PHYDM_DBG(dm, DBG_PRI_CCA, + "BW40M, Primary CH at USB\n"); + phydm_write_dynamic_cca(dm, MF_USC); + } else { + /*Primary CH @ lower sideband*/ + PHYDM_DBG(dm, DBG_PRI_CCA, + "BW40M, Primary CH at LSB\n"); + phydm_write_dynamic_cca(dm, MF_LSC); + } + } else { + PHYDM_DBG(dm, DBG_PRI_CCA, "Not BW40M, USB + LSB\n"); + phydm_primary_cca_reset(dm); + } + } +} + +boolean +odm_dynamic_primary_cca_dup_rts(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_pricca_struct *pri_cca = &dm->dm_pri_cca; + + return pri_cca->dup_rts_flag; +} + +void phydm_primary_cca_init(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_pricca_struct *pri_cca = &dm->dm_pri_cca; + + if (!(dm->support_ability & ODM_BB_PRIMARY_CCA)) + return; + + if (!(dm->support_ic_type & ODM_IC_11N_SERIES)) + return; + + PHYDM_DBG(dm, DBG_PRI_CCA, "[PriCCA] Init ==>\n"); +#if (RTL8188E_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) + pri_cca->dup_rts_flag = 0; + pri_cca->intf_flag = 0; + pri_cca->intf_type = 0; + pri_cca->monitor_flag = 0; + pri_cca->pri_cca_flag = 0; + pri_cca->ch_offset = 0; +#endif + pri_cca->mf_state = 0xff; + pri_cca->pre_bw = (enum channel_width)0xff; + pri_cca->cca_th_40m_bkp = (u8)odm_get_bb_reg(dm, R_0xc84, 0xf0000000); +} + +void phydm_primary_cca(void *dm_void) +{ +#ifdef PHYDM_PRIMARY_CCA + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (!(dm->support_ic_type & ODM_IC_11N_SERIES)) + return; + + if (!(dm->support_ability & ODM_BB_PRIMARY_CCA)) + return; + + phydm_primary_cca_11n(dm); + +#endif +} +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_primary_cca.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_primary_cca.h new file mode 100644 index 000000000000..867d69fd5f3c --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_primary_cca.h @@ -0,0 +1,88 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +#ifndef __PHYDM_PRIMARYCCA_H__ +#define __PHYDM_PRIMARYCCA_H__ + +#ifdef PHYDM_PRIMARY_CCA +#define PRIMARYCCA_VERSION "2.0" + +/*@============================================================*/ +/*@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 + +/*@============================================================*/ +/*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*/ +/*@============================================================*/ +void phydm_write_dynamic_cca(void *dm_void, u8 curr_mf_state); + +boolean odm_dynamic_primary_cca_dup_rts(void *dm_void); + +void phydm_primary_cca_init(void *dm_void); + +void phydm_primary_cca(void *dm_void); +#endif /*@#ifdef PHYDM_PRIMARY_CCA*/ +#endif /*@#ifndef __PHYDM_PRIMARYCCA_H__*/ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_psd.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_psd.c new file mode 100644 index 000000000000..5f9688ecff58 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_psd.c @@ -0,0 +1,459 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +/****************************************************************************** + * include files + *****************************************************************************/ +#include "mp_precomp.h" +#include "phydm_precomp.h" + +#ifdef CONFIG_PSD_TOOL +u32 phydm_get_psd_data(void *dm_void, u32 psd_tone_idx, u32 igi) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct psd_info *dm_psd_table = &dm->dm_psd_table; + u32 psd_report = 0; + + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + odm_set_bb_reg(dm, R_0x1e8c, 0x3ff, psd_tone_idx & 0x3ff); + odm_set_bb_reg(dm, R_0x1e88, BIT(27) | BIT(26), + psd_tone_idx >> 10); + /*PSD trigger start*/ + odm_set_bb_reg(dm, dm_psd_table->psd_reg, BIT(18), 1); + ODM_delay_us(10); + /*PSD trigger stop*/ + odm_set_bb_reg(dm, dm_psd_table->psd_reg, BIT(18), 0); + } else if (dm->support_ic_type == ODM_RTL8721D) { + odm_set_bb_reg(dm, dm_psd_table->psd_reg, 0xfff, psd_tone_idx); + odm_set_bb_reg(dm, dm_psd_table->psd_reg, BIT(28), 1); + /*PSD trigger start*/ + ODM_delay_us(10); + odm_set_bb_reg(dm, dm_psd_table->psd_reg, BIT(28), 0); + /*PSD trigger stop*/ + } else { + odm_set_bb_reg(dm, dm_psd_table->psd_reg, 0x3ff, psd_tone_idx); + /*PSD trigger start*/ + odm_set_bb_reg(dm, dm_psd_table->psd_reg, BIT(22), 1); + ODM_delay_us(10); + /*PSD trigger stop*/ + odm_set_bb_reg(dm, dm_psd_table->psd_reg, BIT(22), 0); + } + + /*Get PSD Report*/ + if (dm->support_ic_type & (ODM_RTL8821C | ODM_RTL8721D)) { + psd_report = odm_get_bb_reg(dm, dm_psd_table->psd_report_reg, + 0xffffff); + psd_report = psd_report >> 5; + } else if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + psd_report = odm_get_bb_reg(dm, dm_psd_table->psd_report_reg, + 0xffffff); + } else { + psd_report = odm_get_bb_reg(dm, dm_psd_table->psd_report_reg, + 0xffff); + } + psd_report = odm_convert_to_db((u64)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}; + +u8 phydm_psd(void *dm_void, u32 igi, u16 start_point, u16 stop_point) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct psd_info *dm_psd_table = &dm->dm_psd_table; + u32 i = 0, mod_tone_idx = 0; + u32 t = 0; + u16 fft_max_half_bw = 0; + u16 psd_fc_channel = dm_psd_table->psd_fc_channel; + u8 ag_rf_mode_reg = 0; + u8 is_5G = 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_idx = 0; + u8 set_result = 0; + u32 igi_tmp = 0x6e; + + if (dm->support_ic_type == ODM_RTL8821) { + odm_move_memory(dm, psd_result_cali_tone, + psd_result_cali_tone_8821, 7); + odm_move_memory(dm, psd_result_cali_val, + psd_result_cali_val_8821, 7); + } + + dm_psd_table->psd_in_progress = 1; + + PHYDM_DBG(dm, ODM_COMP_API, "PSD Start =>\n"); + + /* @[Stop DIG]*/ + /* @IGI target at 0dBm & make it can't CCA*/ + if (phydm_pause_func(dm, F00_DIG, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_3, 1, + &igi_tmp) == PAUSE_FAIL) { + return PHYDM_SET_FAIL; + } + + ODM_delay_us(10); + + if (phydm_stop_ic_trx(dm, PHYDM_SET) == PHYDM_SET_FAIL) { + phydm_pause_func(dm, F00_DIG, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_3, + 1, &igi_tmp); + return PHYDM_SET_FAIL; + } + + /* @[Set IGI]*/ + phydm_write_dig_reg(dm, (u8)igi); + + /* @[Backup RF Reg]*/ + dm_psd_table->rf_0x18_bkp = odm_get_rf_reg(dm, RF_PATH_A, RF_0x18, + RFREG_MASK); + dm_psd_table->rf_0x18_bkp_b = odm_get_rf_reg(dm, RF_PATH_B, RF_0x18, + RFREG_MASK); + + if (psd_fc_channel > 14) { + is_5G = 1; + if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8812F | + ODM_RTL8197G)) { + if (psd_fc_channel < 80) + ag_rf_mode_reg = 0x1; + else if (psd_fc_channel >= 80 && psd_fc_channel <= 140) + ag_rf_mode_reg = 0x3; + else if (psd_fc_channel > 140) + ag_rf_mode_reg = 0x5; + } else if (dm->support_ic_type == ODM_RTL8721D) { + if (psd_fc_channel >= 36 && psd_fc_channel <= 64) + ag_rf_mode_reg = 0x1; + else if (psd_fc_channel >= 100 && psd_fc_channel <= 140) + ag_rf_mode_reg = 0x5; + else if (psd_fc_channel > 140) + ag_rf_mode_reg = 0x9; + } else { + if (psd_fc_channel >= 36 && psd_fc_channel <= 64) + ag_rf_mode_reg = 0x1; + else if (psd_fc_channel >= 100 && psd_fc_channel <= 140) + ag_rf_mode_reg = 0x3; + else if (psd_fc_channel > 140) + ag_rf_mode_reg = 0x5; + } + } + + /* Set RF fc*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0x18, 0xff, psd_fc_channel); + odm_set_rf_reg(dm, RF_PATH_B, RF_0x18, 0xff, psd_fc_channel); + odm_set_rf_reg(dm, RF_PATH_A, RF_0x18, 0x300, is_5G); + odm_set_rf_reg(dm, RF_PATH_B, RF_0x18, 0x300, is_5G); + if (dm->support_ic_type & (ODM_RTL8822C | ODM_RTL8812F | + ODM_RTL8197G)) { + /* @2b'11: 20MHz, 2b'10: 40MHz, 2b'01: 80MHz */ + odm_set_rf_reg(dm, RF_PATH_A, RF_0x18, 0x3000, + dm_psd_table->psd_bw_rf_reg); + odm_set_rf_reg(dm, RF_PATH_B, RF_0x18, 0x3000, + dm_psd_table->psd_bw_rf_reg); + /* Set RF ag fc mode*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0x18, 0x70000, + ag_rf_mode_reg); + odm_set_rf_reg(dm, RF_PATH_B, RF_0x18, 0x70000, + ag_rf_mode_reg); + } else { + /* @2b'11: 20MHz, 2b'10: 40MHz, 2b'01: 80MHz */ + if (dm->support_ic_type == ODM_RTL8721D) { + odm_set_rf_reg(dm, RF_PATH_A, RF_0x18, 0x1c00, + dm_psd_table->psd_bw_rf_reg); + } else { + odm_set_rf_reg(dm, RF_PATH_A, RF_0x18, 0xc00, + dm_psd_table->psd_bw_rf_reg); + } + odm_set_rf_reg(dm, RF_PATH_B, RF_0x18, 0xc00, + dm_psd_table->psd_bw_rf_reg); + /* Set RF ag fc mode*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0x18, 0xf0000, + ag_rf_mode_reg); + odm_set_rf_reg(dm, RF_PATH_B, RF_0x18, 0xf0000, + ag_rf_mode_reg); + } + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + PHYDM_DBG(dm, ODM_COMP_API, "0x1d70=((0x%x))\n", + odm_get_bb_reg(dm, R_0x1d70, MASKDWORD)); + else + PHYDM_DBG(dm, ODM_COMP_API, "0xc50=((0x%x))\n", + odm_get_bb_reg(dm, R_0xc50, MASKDWORD)); + + PHYDM_DBG(dm, ODM_COMP_API, "RF0x18=((0x%x))\n", + odm_get_rf_reg(dm, RF_PATH_A, RF_0x18, RFREG_MASK)); + + /* @[Stop 3-wires]*/ + phydm_stop_3_wire(dm, PHYDM_SET); + + ODM_delay_us(10); + + if (stop_point > (dm_psd_table->fft_smp_point - 1)) + stop_point = (dm_psd_table->fft_smp_point - 1); + + if (start_point > (dm_psd_table->fft_smp_point - 1)) + start_point = (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 = (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 < dm_psd_table->sw_avg_time; t++) + psd_result_tmp += phydm_get_psd_data(dm, mod_tone_idx, + igi); + psd_result = + (u8)((psd_result_tmp / dm_psd_table->sw_avg_time)) - + dm_psd_table->psd_pwr_common_offset; + + if (dm_psd_table->fft_smp_point == 128 && + dm_psd_table->noise_k_en) { + if (i > psd_result_cali_tone[noise_idx]) + noise_idx++; + + if (noise_idx > 6) + noise_idx = 6; + + if (psd_result >= psd_result_cali_val[noise_idx]) + psd_result = psd_result - + psd_result_cali_val[noise_idx]; + else + psd_result = 0; + + dm_psd_table->psd_result[i] = psd_result; + } + + PHYDM_DBG(dm, ODM_COMP_API, "[%d] N_cali = %d, PSD = %d\n", + mod_tone_idx, psd_result_cali_val[noise_idx], + psd_result); + } + + /*@[Start 3-wires]*/ + phydm_stop_3_wire(dm, PHYDM_REVERT); + + ODM_delay_us(10); + + /*@[Revert Reg]*/ + set_result = phydm_stop_ic_trx(dm, PHYDM_REVERT); + + odm_set_rf_reg(dm, RF_PATH_A, RF_0x18, RFREG_MASK, + dm_psd_table->rf_0x18_bkp); + odm_set_rf_reg(dm, RF_PATH_B, RF_0x18, RFREG_MASK, + dm_psd_table->rf_0x18_bkp_b); + + PHYDM_DBG(dm, ODM_COMP_API, "PSD finished\n\n"); + + phydm_pause_func(dm, F00_DIG, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_3, 1, + &igi_tmp); + dm_psd_table->psd_in_progress = 0; + + return PHYDM_SET_SUCCESS; +} + +void phydm_psd_para_setting(void *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 dm_struct *dm = (struct dm_struct *)dm_void; + struct psd_info *dm_psd_table = &dm->dm_psd_table; + u8 fft_smp_point_idx = 0; + + dm_psd_table->fft_smp_point = fft_smp_point; + + if (sw_avg_time == 0) + sw_avg_time = 1; + + dm_psd_table->sw_avg_time = sw_avg_time; + dm_psd_table->psd_fc_channel = channel; + 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 (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + odm_set_bb_reg(dm, R_0x1e8c, BIT(11) | BIT(10), i_q_setting); + odm_set_bb_reg(dm, R_0x1e8c, BIT(13) | BIT(12), hw_avg_time); + + if (fft_smp_point == 4096) { + odm_set_bb_reg(dm, R_0x1e88, BIT(31) | BIT(30), 0x2); + } else if (fft_smp_point == 2048) { + odm_set_bb_reg(dm, R_0x1e88, BIT(31) | BIT(30), 0x1); + } else { + odm_set_bb_reg(dm, R_0x1e88, BIT(31) | BIT(30), 0x0); + odm_set_bb_reg(dm, R_0x1e8c, BIT(15) | BIT(14), + fft_smp_point_idx); + } + odm_set_bb_reg(dm, R_0x1e8c, BIT(17) | BIT(16), ant_sel); + odm_set_bb_reg(dm, R_0x1e8c, BIT(23) | BIT(22), psd_input); + } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + odm_set_bb_reg(dm, R_0x910, BIT(11) | BIT(10), i_q_setting); + odm_set_bb_reg(dm, R_0x910, BIT(13) | BIT(12), hw_avg_time); + odm_set_bb_reg(dm, R_0x910, BIT(15) | BIT(14), + fft_smp_point_idx); + odm_set_bb_reg(dm, R_0x910, BIT(17) | BIT(16), ant_sel); + odm_set_bb_reg(dm, R_0x910, BIT(23), psd_input); + } else if (dm->support_ic_type == ODM_RTL8721D) { + odm_set_bb_reg(dm, 0x808, BIT(19) | BIT(18), i_q_setting); + odm_set_bb_reg(dm, 0x808, BIT(21) | BIT(20), hw_avg_time); + odm_set_bb_reg(dm, 0x808, BIT(23) | BIT(22), fft_smp_point_idx); + odm_set_bb_reg(dm, 0x804, BIT(5) | BIT(4), ant_sel); + odm_set_bb_reg(dm, 0x80C, BIT(23), psd_input); + +#if 0 + } else { /*ODM_IC_11N_SERIES*/ +#endif + } + /*@bw = (*dm->band_width); //ODM_BW20M */ + /*@channel = *(dm->channel);*/ +} + +void phydm_psd_init(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct psd_info *dm_psd_table = &dm->dm_psd_table; + + PHYDM_DBG(dm, ODM_COMP_API, "PSD para init\n"); + + dm_psd_table->psd_in_progress = false; + + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) { + dm_psd_table->psd_reg = R_0x1e8c; + dm_psd_table->psd_report_reg = R_0x2d90; + + /*@2b'11: 20MHz, 2b'10: 40MHz, 2b'01: 80MHz */ + dm_psd_table->psd_bw_rf_reg = 1; + } else if (dm->support_ic_type & ODM_IC_11AC_SERIES) { + dm_psd_table->psd_reg = R_0x910; + dm_psd_table->psd_report_reg = R_0xf44; + + /*@2b'11: 20MHz, 2b'10: 40MHz, 2b'01: 80MHz */ + if (ODM_IC_11AC_2_SERIES) + dm_psd_table->psd_bw_rf_reg = 1; + else + dm_psd_table->psd_bw_rf_reg = 2; + } else { + dm_psd_table->psd_reg = R_0x808; + dm_psd_table->psd_report_reg = R_0x8b4; + /*@2b'11: 20MHz, 2b'10: 40MHz, 2b'01: 80MHz */ + dm_psd_table->psd_bw_rf_reg = 2; + } + + dm_psd_table->psd_pwr_common_offset = 0; + + phydm_psd_para_setting(dm, 1, 2, 3, 128, 0, 0, 7, 0); +#if 0 + /*phydm_psd(dm, 0x3c, 0, 127);*/ /* target at -50dBm */ +#endif +} + +void phydm_psd_debug(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + char help[] = "-h"; + u32 var1[10] = {0}; + u32 used = *_used; + u32 out_len = *_out_len; + u8 i = 0; + + if ((strcmp(input[1], help) == 0)) { + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + if (dm->support_ic_type & ODM_IC_JGR3_SERIES) + PDM_SNPF(out_len, used, output + used, out_len - used, + "{0} {sw_avg} {hw_avg 0:3} {1:I,2:Q,3:IQ} {fft_point: 128*(1:4) 2048 4096}\n{path_sel 0~3} {0:ADC, 1:rxdata_fir_in, 2:rx_nbi_nf_stage2} {CH} {noise_k}\n\n"); + else + #endif + PDM_SNPF(out_len, used, 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"); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "{1} {IGI(hex)} {start_point} {stop_point}\n"); + goto out; + } + + 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]); + } + PDM_SNPF(out_len, used, 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(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]); + PDM_SNPF(out_len, used, output + used, out_len - used, + "IGI=((0x%x)), start_point=((%d)), stop_point=((%d))\n", + var1[1], var1[2], var1[3]); + dm->debug_components |= ODM_COMP_API; + if (phydm_psd(dm, var1[1], (u16)var1[2], (u16)var1[3]) == + PHYDM_SET_FAIL) + PDM_SNPF(out_len, used, output + used, out_len - used, + "PSD_SET_FAIL\n"); + dm->debug_components &= ~(ODM_COMP_API); + } + +out: + *_used = used; + *_out_len = out_len; +} + +u8 phydm_get_psd_result_table(void *dm_void, int index) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct psd_info *dm_psd_table = &dm->dm_psd_table; + u8 result = 0; + + if (index < 128) + result = dm_psd_table->psd_result[index]; + + return result; +} + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_psd.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_psd.h new file mode 100644 index 000000000000..42063e79317c --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_psd.h @@ -0,0 +1,67 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +#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 psd_info { + 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 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 *dm_void, u32 psd_tone_idx, u32 igi); + +void phydm_psd_debug(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len); + +u8 phydm_psd(void *dm_void, u32 igi, u16 start_point, u16 stop_point); + +void phydm_psd_para_setting(void *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 *dm_void); + +u8 phydm_get_psd_result_table(void *dm_void, int index); + +#endif +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_rainfo.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_rainfo.c index 4599f9afd204..6749f6ccfeee 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_rainfo.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_rainfo.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,1869 +9,1502 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ -/* ************************************************************ +/*@************************************************************ * 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 -) +boolean phydm_is_vht_rate(void *dm_void, u8 rate) { - struct PHY_DM_STRUCT *p_dm_odm = (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_odm, phydm_h2c_id, H2C_MAX_LENGTH, h2c_parameter); - + return ((rate & 0x7f) >= ODM_RATEVHTSS1MCS0) ? true : false; } -#if (defined(CONFIG_RA_DBG_CMD)) -void -odm_ra_para_adjust_send_h2c( - void *p_dm_void -) +boolean phydm_is_ht_rate(void *dm_void, u8 rate) { - - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _rate_adaptive_table_ *p_ra_table = &p_dm_odm->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*/ - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[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 { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[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*/ - } - } - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" h2c_parameter[1] = 0x%x\n", h2c_parameter[1])); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" h2c_parameter[2] = 0x%x\n", h2c_parameter[2])); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" h2c_parameter[3] = 0x%x\n", h2c_parameter[3])); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" h2c_parameter[4] = 0x%x\n", h2c_parameter[4])); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" h2c_parameter[5] = 0x%x\n", h2c_parameter[5])); - - odm_fill_h2c_cmd(p_dm_odm, ODM_H2C_RA_PARA_ADJUST, 6, h2c_parameter); - + return (((rate & 0x7f) >= ODM_RATEMCS0) && + ((rate & 0x7f) <= ODM_RATEMCS31)) ? true : false; } - -void -odm_ra_para_adjust( - void *p_dm_void -) +boolean phydm_is_ofdm_rate(void *dm_void, u8 rate) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _rate_adaptive_table_ *p_ra_table = &p_dm_odm->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; - } - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("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_odm); + return (((rate & 0x7f) >= ODM_RATE6M) && + ((rate & 0x7f) <= ODM_RATE54M)) ? true : false; } -void -phydm_ra_print_msg( - void *p_dm_void, - u8 *value, - u8 *value_default, - u8 *modify_note -) +boolean phydm_is_cck_rate(void *dm_void, u8 rate) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _rate_adaptive_table_ *p_ra_table = &p_dm_odm->dm_ra_table; - u32 i; - - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" |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)) - ODM_RT_TRACE(p_dm_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(p_dm_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 - } - + return ((rate & 0x7f) <= ODM_RATE11M) ? true : false; } -void -odm_RA_debug( - void *p_dm_void, - u32 *const dm_value -) +u8 phydm_rate_2_rate_digit(void *dm_void, u8 rate) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _rate_adaptive_table_ *p_ra_table = &p_dm_odm->dm_ra_table; + 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 rate_digit = 0; - p_ra_table->is_ra_dbg_init = false; + if (rate_idx >= ODM_RATEVHTSS1MCS0) + rate_digit = (rate_idx - ODM_RATEVHTSS1MCS0) % 10; + else if (rate_idx >= ODM_RATEMCS0) + rate_digit = (rate_idx - ODM_RATEMCS0); + else if (rate_idx <= ODM_RATE54M) + rate_digit = legacy_table[rate_idx]; - 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; - - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("\n------------------------------------------------------------------------------------\n")); - - if (dm_value[1] == RADBG_RTY_PENALTY) { /* [1]*/ - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" [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]*/ - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" [2] N_HIGH\n")); - - else if (dm_value[1] == RADBG_N_LOW) /*[3]*/ - ODM_RT_TRACE(p_dm_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(p_dm_odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" [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]*/ - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" [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_odm, pvalue, pvalue_default, pmodify_note); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("\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_odm); - } 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_odm); - } + return rate_digit; } -void -odm_ra_para_adjust_init( - void *p_dm_void -) +u8 phydm_rate_type_2_num_ss(void *dm_void, enum PDM_RATE_TYPE type) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _rate_adaptive_table_ *p_ra_table = &p_dm_odm->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 */ + u8 num_ss = 1; -#endif - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("odm_ra_para_adjust_init\n")); - - if (p_dm_odm->support_ic_type & (ODM_RTL8188F | ODM_RTL8195A | ODM_RTL8703B | ODM_RTL8723B | ODM_RTL8188E | ODM_RTL8723D)) - p_ra_table->rate_length = rate_size_ht_1ss; - else if (p_dm_odm->support_ic_type & (ODM_RTL8192E | ODM_RTL8197F)) - p_ra_table->rate_length = rate_size_ht_2ss; - else if (p_dm_odm->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_odm->support_ic_type & (ODM_RTL8812 | ODM_RTL8822B)) - p_ra_table->rate_length = rate_size_ht_2ss + rate_size_vht_2ss; - else if (p_dm_odm->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_odm); + switch (type) { + case PDM_CCK: + case PDM_OFDM: + case PDM_1SS: + num_ss = 1; + break; + case PDM_2SS: + num_ss = 2; + break; + case PDM_3SS: + num_ss = 3; + break; + case PDM_4SS: + num_ss = 4; + break; + default: + break; } + + return num_ss; } -#else - -void -phydm_RA_debug_PCR( - void *p_dm_void, - u32 *const dm_value, - u32 *_used, - char *output, - u32 *_out_len -) +u8 phydm_rate_to_num_ss(void *dm_void, u8 data_rate) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _rate_adaptive_table_ *p_ra_table = &p_dm_odm->dm_ra_table; + 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; +} + +void phydm_h2C_debug(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; u32 used = *_used; u32 out_len = *_out_len; + u32 dm_value[10] = {0}; + u8 i = 0, input_idx = 0; + u8 h2c_parameter[H2C_MAX_LENGTH] = {0}; + u8 phydm_h2c_id = 0; - if (dm_value[0] == 100) { - PHYDM_SNPRINTF((output + used, out_len - used, "[Get] PCR 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)); - /**/ - } else if (dm_value[0] == 0) { - p_ra_table->RA_offset_direction = 0; - p_ra_table->RA_threshold_offset = (u8)dm_value[1]; - PHYDM_SNPRINTF((output + used, out_len - used, "[Set] PCR RA_threshold_offset = (( -%d ))\n", p_ra_table->RA_threshold_offset)); - } else if (dm_value[0] == 1) { - p_ra_table->RA_offset_direction = 1; - p_ra_table->RA_threshold_offset = (u8)dm_value[1]; - PHYDM_SNPRINTF((output + used, out_len - used, "[Set] PCR RA_threshold_offset = (( +%d ))\n", p_ra_table->RA_threshold_offset)); - } else { - PHYDM_SNPRINTF((output + used, out_len - used, "[Set] Error\n")); - /**/ + for (i = 0; i < 8; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_HEX, &dm_value[i]); + input_idx++; + } } -} - -#endif /*#if (defined(CONFIG_RA_DBG_CMD))*/ - -void -odm_c2h_ra_para_report_handler( - void *p_dm_void, - u8 *cmd_buf, - u8 cmd_len -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _rate_adaptive_table_ *p_ra_table = &p_dm_odm->dm_ra_table; - - u8 para_idx = cmd_buf[0]; /*Retry Penalty, NH, NL*/ - u8 rate_type_start = cmd_buf[1]; - u8 rate_type_length = cmd_len - 2; - u8 i; - - - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[ 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) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" |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]; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("%8d %15d\n", (rate_type_start + i), p_ra_table->RTY_P[rate_type_start + i])); - } - - } else if (para_idx == RADBG_N_HIGH) { - /**/ - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" |rate index| |N-High|\n")); - - - } else if (para_idx == RADBG_N_LOW) { - ODM_RT_TRACE(p_dm_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(p_dm_odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" |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]; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("%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) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" |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]; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("%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) { - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("-------------------------------\n")); - if (p_dm_odm->support_ic_type & PHYDM_IC_3081_SERIES) { - - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "RSSI =", cmd_buf[1])); - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "rate =", cmd_buf[2] & 0x7f)); - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "SGI =", (cmd_buf[2] & 0x80) >> 7)); - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "BW =", cmd_buf[3])); - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "BW_max =", cmd_buf[4])); - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "multi_rate0 =", cmd_buf[5])); - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "multi_rate1 =", cmd_buf[6])); - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "DISRA =", cmd_buf[7])); - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "VHT_EN =", cmd_buf[8])); - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "SGI_support =", cmd_buf[9])); - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "try_ness =", cmd_buf[10])); - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "pre_rate =", cmd_buf[11])); - } else { - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "RSSI =", cmd_buf[1])); - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %x\n", "BW =", cmd_buf[2])); - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "DISRA =", cmd_buf[3])); - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "VHT_EN =", cmd_buf[4])); - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "Hightest rate =", cmd_buf[5])); - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "Lowest rate =", cmd_buf[6])); - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "SGI_support =", cmd_buf[7])); - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "Rate_ID =", cmd_buf[8]));; - } - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("-------------------------------\n")); - } else if (para_idx == RADBG_DEBUG_MONITOR2) { - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("-------------------------------\n")); - if (p_dm_odm->support_ic_type & PHYDM_IC_3081_SERIES) { - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "rate_id =", cmd_buf[1])); - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "highest_rate =", cmd_buf[2])); - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "lowest_rate =", cmd_buf[3])); - - for (i = 4; i <= 11; i++) - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("RAMASK = 0x%x\n", cmd_buf[i])); - } else { - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%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])); - } - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("-------------------------------\n")); - } else if (para_idx == RADBG_DEBUG_MONITOR3) { - - for (i = 0; i < (cmd_len - 1); i++) - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("content[%d] = %d\n", i, cmd_buf[1 + i])); - } else if (para_idx == RADBG_DEBUG_MONITOR4) - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s {%d.%d}\n", "RA version =", cmd_buf[1], cmd_buf[2])); - else if (para_idx == RADBG_DEBUG_MONITOR5) { - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "Current rate =", cmd_buf[1])); - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "Retry ratio =", cmd_buf[2])); - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "rate down ratio =", cmd_buf[3])); - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "highest rate =", cmd_buf[4])); - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s {0x%x 0x%x}\n", "Muti-try =", cmd_buf[5], cmd_buf[6])); - ODM_RT_TRACE(p_dm_odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _rate_adaptive_table_ *p_ra_table = &p_dm_odm->dm_ra_table; - struct sta_info *p_entry; - u8 i, retry_offset; - u32 ma_rx_tp; - - if (!(p_dm_odm->support_ability & ODM_BB_DYNAMIC_ARFR)) + if (input_idx == 0) return; - /*ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("p_dm_odm->pre_b_noisy = %d\n", p_dm_odm->pre_b_noisy ));*/ - if (p_dm_odm->pre_b_noisy != p_dm_odm->noisy_decision) { + phydm_h2c_id = (u8)dm_value[0]; - if (p_dm_odm->noisy_decision) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("->Noisy Env. RA fallback value\n")); - odm_set_mac_reg(p_dm_odm, 0x430, MASKDWORD, 0x0); - odm_set_mac_reg(p_dm_odm, 0x434, MASKDWORD, 0x04030201); - } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("->Clean Env. RA fallback value\n")); - odm_set_mac_reg(p_dm_odm, 0x430, MASKDWORD, 0x01000000); - odm_set_mac_reg(p_dm_odm, 0x434, MASKDWORD, 0x06050402); + PDM_SNPF(out_len, used, 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]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "H2C: Byte[%d] = ((0x%x))\n", i, h2c_parameter[i]); + } + + odm_fill_h2c_cmd(dm, phydm_h2c_id, H2C_MAX_LENGTH, h2c_parameter); + + *_used = used; + *_out_len = out_len; +} + +void phydm_fw_fix_rate(void *dm_void, u8 en, u8 macid, u8 bw, u8 rate) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 reg_u32_tmp; + + if (dm->support_ic_type & PHYDM_IC_8051_SERIES) { + reg_u32_tmp = (bw << 24) | (rate << 16) | (macid << 8) | en; + odm_set_bb_reg(dm, R_0x4a0, MASKDWORD, reg_u32_tmp); + + } else { + if (en == 1) + reg_u32_tmp = BYTE_2_DWORD(0x60, macid, bw, rate); + else + reg_u32_tmp = 0x40000000; + if (dm->support_ic_type & ODM_RTL8814B) + odm_set_bb_reg(dm, R_0x448, MASKDWORD, reg_u32_tmp); + else + odm_set_bb_reg(dm, R_0x450, MASKDWORD, reg_u32_tmp); + } + if (en == 1) { + PHYDM_DBG(dm, ODM_COMP_API, + "FW fix TX rate[id =%d], %dM, Rate(%d)=", macid, + (20 << bw), rate); + phydm_print_rate(dm, rate, ODM_COMP_API); + } else { + PHYDM_DBG(dm, ODM_COMP_API, "Auto Rate\n"); + } +} + +void phydm_ra_debug(void *dm_void, char input[][16], u32 *_used, char *output, + u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ra_table *ra_tab = &dm->dm_ra_table; + u32 used = *_used; + u32 out_len = *_out_len; + char help[] = "-h"; + u32 var[5] = {0}; + u8 macid = 0, bw = 0, rate = 0; + u8 i = 0; + + for (i = 0; i < 5; i++) { + if (input[i + 1]) + PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var[i]); + } + + if ((strcmp(input[1], help) == 0)) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "{1} {0:-,1:+} {ofst}: set offset\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{1} {100}: show offset\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{2} {en} {macid} {bw} {rate}: fw fix rate\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{3} {en}: Dynamic RRSR\n"); + + } else if (var[0] == 1) { /*@Adjust PCR offset*/ + + if (var[1] == 100) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "[Get] RA_ofst=((%s%d))\n", + ((ra_tab->ra_ofst_direc) ? "+" : "-"), + ra_tab->ra_th_ofst); + + } else if (var[1] == 0) { + ra_tab->ra_ofst_direc = 0; + ra_tab->ra_th_ofst = (u8)var[2]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "[Set] RA_ofst=((-%d))\n", ra_tab->ra_th_ofst); + } else if (var[1] == 1) { + ra_tab->ra_ofst_direc = 1; + ra_tab->ra_th_ofst = (u8)var[2]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "[Set] RA_ofst=((+%d))\n", ra_tab->ra_th_ofst); } - p_dm_odm->pre_b_noisy = p_dm_odm->noisy_decision; + + } else if (var[0] == 2) { /*@FW fix rate*/ + macid = (u8)var[2]; + bw = (u8)var[3]; + rate = (u8)var[4]; + + PDM_SNPF(out_len, used, output + used, out_len - used, + "[FW fix TX Rate] {en, macid,bw,rate}={%d, %d, %d, 0x%x}", + var[1], macid, bw, rate); + + phydm_fw_fix_rate(dm, (u8)var[1], macid, bw, rate); + } else if (var[0] == 3) { /*@FW fix rate*/ + ra_tab->dynamic_rrsr_en = (boolean)var[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "[Dynamic RRSR] enable=%d", ra_tab->dynamic_rrsr_en); + } else { + PDM_SNPF(out_len, used, output + used, out_len - used, + "[Set] Error\n"); } + *_used = used; + *_out_len = out_len; } -#if (defined(CONFIG_RA_DYNAMIC_RTY_LIMIT)) - -void -phydm_retry_limit_table_bound( - void *p_dm_void, - u8 *retry_limit, - u8 offset -) +void odm_c2h_ra_para_report_handler(void *dm_void, u8 *cmd_buf, u8 cmd_len) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _rate_adaptive_table_ *p_ra_table = &p_dm_odm->dm_ra_table; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 mode = cmd_buf[0]; /*Retry Penalty, NH, NL*/ + u8 i; - if (*retry_limit > offset) { + PHYDM_DBG(dm, DBG_FW_TRACE, "[%s] [mode: %d]----------------------->\n", + __func__, mode); - *retry_limit -= offset; + if (mode == RADBG_DEBUG_MONITOR1) { + if (dm->support_ic_type & PHYDM_IC_3081_SERIES) { + PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "RSSI =", + cmd_buf[1]); + PHYDM_DBG(dm, DBG_FW_TRACE, "%5s 0x%x\n", "rate =", + cmd_buf[2] & 0x7f); + PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "SGI =", + (cmd_buf[2] & 0x80) >> 7); + PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "BW =", + cmd_buf[3]); + PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "BW_max =", + cmd_buf[4]); + PHYDM_DBG(dm, DBG_FW_TRACE, "%5s 0x%x\n", + "multi_rate0 =", cmd_buf[5]); + PHYDM_DBG(dm, DBG_FW_TRACE, "%5s 0x%x\n", + "multi_rate1 =", cmd_buf[6]); + PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "DISRA =", + cmd_buf[7]); + PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "VHT_EN =", + cmd_buf[8]); + PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", + "SGI_support =", cmd_buf[9]); + PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "try_ness =", + cmd_buf[10]); + PHYDM_DBG(dm, DBG_FW_TRACE, "%5s 0x%x\n", "pre_rate =", + cmd_buf[11]); + } else { + PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "RSSI =", + cmd_buf[1]); + PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %x\n", "BW =", + cmd_buf[2]); + PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "DISRA =", + cmd_buf[3]); + PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "VHT_EN =", + cmd_buf[4]); + PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", + "Hightest rate =", cmd_buf[5]); + PHYDM_DBG(dm, DBG_FW_TRACE, "%5s 0x%x\n", + "Lowest rate =", cmd_buf[6]); + PHYDM_DBG(dm, DBG_FW_TRACE, "%5s 0x%x\n", + "SGI_support =", cmd_buf[7]); + PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "Rate_ID =", + cmd_buf[8]); + } + } else if (mode == RADBG_DEBUG_MONITOR2) { + if (dm->support_ic_type & PHYDM_IC_3081_SERIES) { + PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "rate_id =", + cmd_buf[1]); + PHYDM_DBG(dm, DBG_FW_TRACE, "%5s 0x%x\n", + "highest_rate =", cmd_buf[2]); + PHYDM_DBG(dm, DBG_FW_TRACE, "%5s 0x%x\n", + "lowest_rate =", cmd_buf[3]); - 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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _rate_adaptive_table_ *p_ra_table = &p_dm_odm->dm_ra_table; - u8 i; - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) /*support all IC platform*/ - -#else -#if ((RTL8192E_SUPPORT == 1) || (RTL8723B_SUPPORT == 1) || (RTL8188E_SUPPORT == 1)) - 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*/ - }; - -#elif (RTL8821A_SUPPORT == 1) || (RTL8881A_SUPPORT == 1) - -#elif (RTL8812A_SUPPORT == 1) - -#elif (RTL8814A_SUPPORT == 1) - -#else - -#endif -#endif - - 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_odm, &(p_ra_table->per_rate_retrylimit_20M[i]), 0); - phydm_retry_limit_table_bound(p_dm_odm, &(p_ra_table->per_rate_retrylimit_40M[i]), 0); + for (i = 4; i <= 11; i++) + PHYDM_DBG(dm, DBG_FW_TRACE, "RAMASK = 0x%x\n", + cmd_buf[i]); + } else { + PHYDM_DBG(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]); + } + } else if (mode == RADBG_DEBUG_MONITOR3) { + for (i = 0; i < (cmd_len - 1); i++) + PHYDM_DBG(dm, DBG_FW_TRACE, "content[%d] = %d\n", i, + cmd_buf[1 + i]); + } else if (mode == RADBG_DEBUG_MONITOR4) + PHYDM_DBG(dm, DBG_FW_TRACE, "%5s {%d.%d}\n", "RA version =", + cmd_buf[1], cmd_buf[2]); + else if (mode == RADBG_DEBUG_MONITOR5) { + PHYDM_DBG(dm, DBG_FW_TRACE, "%5s 0x%x\n", "Current rate =", + cmd_buf[1]); + PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "Retry ratio =", + cmd_buf[2]); + PHYDM_DBG(dm, DBG_FW_TRACE, "%5s %d\n", "rate down ratio =", + cmd_buf[3]); + PHYDM_DBG(dm, DBG_FW_TRACE, "%5s 0x%x\n", "highest rate =", + cmd_buf[4]); + PHYDM_DBG(dm, DBG_FW_TRACE, "%5s {0x%x 0x%x}\n", "Muti-try =", + cmd_buf[5], cmd_buf[6]); + PHYDM_DBG(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]); } + PHYDM_DBG(dm, DBG_FW_TRACE, "-------------------------------\n"); } -void -phydm_ra_dynamic_retry_limit_init( - void *p_dm_void -) +void phydm_ra_dynamic_retry_count(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _rate_adaptive_table_ *p_ra_table = &p_dm_odm->dm_ra_table; + struct dm_struct *dm = (struct dm_struct *)dm_void; - 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_odm); - -} - -#endif - -void -phydm_ra_dynamic_retry_limit( - void *p_dm_void -) -{ -#if (defined(CONFIG_RA_DYNAMIC_RTY_LIMIT)) - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _rate_adaptive_table_ *p_ra_table = &p_dm_odm->dm_ra_table; - struct sta_info *p_entry; - u8 i, retry_offset; - u32 ma_rx_tp; - - - if (p_dm_odm->pre_number_active_client == p_dm_odm->number_active_client) { - - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" pre_number_active_client == number_active_client\n")); + if (!(dm->support_ability & ODM_BB_DYNAMIC_ARFR)) return; - } else { - if (p_dm_odm->number_active_client == 1) { - phydm_reset_retry_limit_table(p_dm_odm); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("one client only->reset to default value\n")); +#if 0 + /*PHYDM_DBG(dm, DBG_RA, "dm->pre_b_noisy = %d\n", dm->pre_b_noisy );*/ +#endif + if (dm->pre_b_noisy != dm->noisy_decision) { + if (dm->noisy_decision) { + PHYDM_DBG(dm, DBG_DYN_ARFR, "Noisy Env. RA fallback\n"); + odm_set_mac_reg(dm, R_0x430, MASKDWORD, 0x0); + odm_set_mac_reg(dm, R_0x434, MASKDWORD, 0x04030201); } else { - - retry_offset = p_dm_odm->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_odm, &(p_ra_table->per_rate_retrylimit_20M[i]), retry_offset); - phydm_retry_limit_table_bound(p_dm_odm, &(p_ra_table->per_rate_retrylimit_40M[i]), retry_offset); - } + PHYDM_DBG(dm, DBG_DYN_ARFR, "Clean Env. RA fallback\n"); + odm_set_mac_reg(dm, R_0x430, MASKDWORD, 0x01000000); + odm_set_mac_reg(dm, R_0x434, MASKDWORD, 0x06050402); } - } -#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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("[ON ASSOC] rf_mode = ((0x%x)), wireless_mode = ((0x%x)), init_rate_id = ((0x%x))\n", p_dm_odm->rf_type, wireless_mode, init_rate_id)); - - if ((p_dm_odm->rf_type == ODM_2T2R) | (p_dm_odm->rf_type == ODM_2T2R_GREEN) | (p_dm_odm->rf_type == ODM_2T3R) | (p_dm_odm->rf_type == ODM_2T4R)) { - - if ((p_dm_odm->support_ic_type & (ODM_RTL8812 | ODM_RTL8192E)) && - (wireless_mode & (ODM_WM_N24G | ODM_WM_N5G)) - ) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("[ON ASSOC] set N-2SS ARFR5 table\n")); - odm_set_mac_reg(p_dm_odm, 0x4a4, MASKDWORD, 0xfc1ffff); /*N-2SS, ARFR5, rate_id = 0xe*/ - odm_set_mac_reg(p_dm_odm, 0x4a8, MASKDWORD, 0x0); /*N-2SS, ARFR5, rate_id = 0xe*/ - } else if ((p_dm_odm->support_ic_type & (ODM_RTL8812)) && - (wireless_mode & (ODM_WM_AC_5G | ODM_WM_AC_24G | ODM_WM_AC_ONLY)) - ) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("[ON ASSOC] set AC-2SS ARFR0 table\n")); - odm_set_mac_reg(p_dm_odm, 0x444, MASKDWORD, 0x0fff); /*AC-2SS, ARFR0, rate_id = 0x9*/ - odm_set_mac_reg(p_dm_odm, 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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - - if (p_dm_odm->support_ic_type & (ODM_RTL8812 | ODM_RTL8192E)) { - - odm_set_mac_reg(p_dm_odm, 0x4a4, MASKDWORD, 0xfc1ffff); /*N-2SS, ARFR5, rate_id = 0xe*/ - odm_set_mac_reg(p_dm_odm, 0x4a8, MASKDWORD, 0x0); /*N-2SS, ARFR5, rate_id = 0xe*/ - - odm_set_mac_reg(p_dm_odm, 0x444, MASKDWORD, 0x0fff); /*AC-2SS, ARFR0, rate_id = 0x9*/ - odm_set_mac_reg(p_dm_odm, 0x448, MASKDWORD, 0xff01f000); /*AC-2SS, ARFR0, rate_id = 0x9*/ + dm->pre_b_noisy = dm->noisy_decision; } } -void -phydm_update_rate_id( - void *p_dm_void, - u8 rate, - u8 platform_macid -) +void phydm_print_rate(void *dm_void, u8 rate, u32 dbg_component) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _rate_adaptive_table_ *p_ra_table = &p_dm_odm->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 dm_struct *dm = (struct dm_struct *)dm_void; + u8 rate_idx = rate & 0x7f; /*remove bit7 SGI*/ + boolean vht_en = phydm_is_vht_rate(dm, rate_idx); + u8 b_sgi = (rate & 0x80) >> 7; + u8 rate_ss = phydm_rate_to_num_ss(dm, rate_idx); + u8 rate_digit = phydm_rate_2_rate_digit(dm, rate_idx); + PHYDM_DBG_F(dm, dbg_component, "( %s%s%s%s%s%d%s%s)\n", + (vht_en && (rate_ss == 1)) ? "VHT 1ss " : "", + (vht_en && (rate_ss == 2)) ? "VHT 2ss " : "", + (vht_en && (rate_ss == 3)) ? "VHT 3ss " : "", + (vht_en && (rate_ss == 4)) ? "VHT 4ss " : "", + (rate_idx >= ODM_RATEMCS0) ? "MCS " : "", + rate_digit, + (b_sgi) ? "-S" : " ", + (rate_idx >= ODM_RATEMCS0) ? "" : "M"); +} -#if 0 - if (rate_idx >= ODM_RATEVHTSS2MCS0) { - ODM_RT_TRACE(p_dm_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(p_dm_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(p_dm_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(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("rate[%d]: (( HT-MCS%d ))\n", platform_macid, rate_idx)); - /*dummy for SD4 check patch*/ +void phydm_print_rate_2_buff(void *dm_void, u8 rate, char *buf, u16 buf_size) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 rate_idx = rate & 0x7f; /*remove bit7 SGI*/ + boolean vht_en = phydm_is_vht_rate(dm, rate_idx); + u8 b_sgi = (rate & 0x80) >> 7; + u8 rate_ss = phydm_rate_to_num_ss(dm, rate_idx); + u8 rate_digit = phydm_rate_2_rate_digit(dm, rate_idx); + + PHYDM_SNPRINTF(buf, buf_size, "( %s%s%s%s%d%s%s)", + (vht_en && (rate_ss == 1)) ? "VHT 1ss " : "", + (vht_en && (rate_ss == 2)) ? "VHT 2ss " : "", + (vht_en && (rate_ss == 3)) ? "VHT 3ss " : "", + (rate_idx >= ODM_RATEMCS0) ? "MCS " : "", + rate_digit, + (b_sgi) ? "-S" : " ", + (rate_idx >= ODM_RATEMCS0) ? "" : "M"); +} + +void phydm_c2h_ra_report_handler(void *dm_void, u8 *cmd_buf, u8 cmd_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ra_table *ra_tab = &dm->dm_ra_table; + struct cmn_sta_info *sta = NULL; + u8 macid = cmd_buf[1]; + u8 rate = cmd_buf[0]; + u8 ra_ratio = 0xff; + u8 curr_bw = 0xff; + u8 rate_idx = rate & 0x7f; /*remove bit7 SGI*/ + u8 rate_order; + u8 gid_index = 0; + char dbg_buf[PHYDM_SNPRINT_SIZE] = {0}; + + #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + sta = dm->phydm_sta_info[dm->phydm_macid_table[macid]]; + #else + sta = dm->phydm_sta_info[macid]; + #endif + + if (cmd_len >= 7) { + ra_ratio = cmd_buf[5]; + curr_bw = cmd_buf[6]; + PHYDM_DBG(dm, DBG_RA, "[%d] PER=%d\n", macid, ra_ratio); + } + + if (cmd_buf[3] != 0) { + if (cmd_buf[3] == 0xff) + PHYDM_DBG(dm, DBG_RA, "FW Fix Rate\n"); + else if (cmd_buf[3] == 1) + PHYDM_DBG(dm, DBG_RA, "Try Success\n"); + else if (cmd_buf[3] == 2) + PHYDM_DBG(dm, DBG_RA, "Try Fail & Again\n"); + else if (cmd_buf[3] == 3) + PHYDM_DBG(dm, DBG_RA, "Rate Back\n"); + else if (cmd_buf[3] == 4) + PHYDM_DBG(dm, DBG_RA, "Start rate by RSSI\n"); + else if (cmd_buf[3] == 5) + PHYDM_DBG(dm, DBG_RA, "Try rate\n"); + } + phydm_print_rate_2_buff(dm, rate, dbg_buf, PHYDM_SNPRINT_SIZE); + PHYDM_DBG(dm, DBG_RA, "Tx Rate=%s (%d)", dbg_buf, rate); + +#ifdef MU_EX_MACID + if (macid >= 128 && macid < (128 + MU_EX_MACID)) { + gid_index = macid - 128; + ra_tab->mu1_rate[gid_index] = rate; } #endif - phydm_macid = p_dm_odm->platform2phydm_macid_table[platform_macid]; - p_entry = p_dm_odm->p_odm_sta_info[phydm_macid]; + /*@ra_tab->link_tx_rate[macid] = rate;*/ - if (IS_STA_VALID(p_entry)) { - wireless_mode = p_entry->wireless_mode; - - if ((p_dm_odm->rf_type == ODM_2T2R) | (p_dm_odm->rf_type == ODM_2T2R_GREEN) | (p_dm_odm->rf_type == ODM_2T3R) | (p_dm_odm->rf_type == ODM_2T4R)) { - - p_entry->ratr_idx = p_entry->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*/ - - p_entry->ratr_idx = ARFR_5_RATE_ID; - ODM_RT_TRACE(p_dm_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*/ - - p_entry->ratr_idx = ARFR_0_RATE_ID; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("ARFR_0\n")); - } - } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("UPdate_RateID[%d]: (( 0x%x ))\n", platform_macid, p_entry->ratr_idx)); - } + if (is_sta_active(sta)) { + sta->ra_info.curr_tx_rate = rate; + sta->ra_info.curr_tx_bw = (enum channel_width)curr_bw; + sta->ra_info.curr_retry_ratio = ra_ratio; } -} -#endif - -void -phydm_print_rate( - void *p_dm_void, - u8 rate, - u32 dbg_component -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (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; - - ODM_RT_TRACE_F(p_dm_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( - void *p_dm_void, - u8 *cmd_buf, - u8 cmd_len -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _rate_adaptive_table_ *p_ra_table = &p_dm_odm->dm_ra_table; - u8 legacy_table[12] = {1, 2, 5, 11, 6, 9, 12, 18, 24, 36, 48, 54}; - u8 macid = cmd_buf[1]; - u8 rate = cmd_buf[0]; - u8 rate_idx = rate & 0x7f; /*remove bit7 SGI*/ - u8 pre_rate = p_ra_table->link_tx_rate[macid]; - u8 rate_order; -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _ADAPTER *adapter = p_dm_odm->adapter; - - GET_HAL_DATA(adapter)->CurrentRARate = HwRateToMRate(rate_idx); -#endif - - - if (cmd_len >= 4) { - if (cmd_buf[3] == 0) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("TX Init-rate Update[%d]:", macid)); - /**/ - } else if (cmd_buf[3] == 0xff) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("FW Level: Fix rate[%d]:", macid)); - /**/ - } else if (cmd_buf[3] == 1) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Try Success[%d]:", macid)); - /**/ - } else if (cmd_buf[3] == 2) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Try Fail & Try Again[%d]:", macid)); - /**/ - } else if (cmd_buf[3] == 3) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("rate Back[%d]:", macid)); - /**/ - } else if (cmd_buf[3] == 4) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("start rate by RSSI[%d]:", macid)); - /**/ - } else if (cmd_buf[3] == 5) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Try rate[%d]:", macid)); - /**/ - } - } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Tx rate Update[%d]:", macid)); - /**/ - } - - /*phydm_print_rate(p_dm_odm, pre_rate_idx, ODM_COMP_RATE_ADAPTIVE);*/ - /*ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, (">\n",macid );*/ - phydm_print_rate(p_dm_odm, rate, ODM_COMP_RATE_ADAPTIVE); - - p_ra_table->link_tx_rate[macid] = rate; - /*trigger power training*/ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - rate_order = phydm_rate_order_compute(p_dm_odm, rate_idx); + rate_order = phydm_rate_order_compute(dm, rate_idx); - if ((p_dm_odm->is_one_entry_only) || - ((rate_order > p_ra_table->highest_client_tx_order) && (p_ra_table->power_tracking_flag == 1)) - ) { - phydm_update_pwr_track(p_dm_odm, rate_idx); - p_ra_table->power_tracking_flag = 0; + if (dm->is_one_entry_only || + (rate_order > ra_tab->highest_client_tx_order && + ra_tab->power_tracking_flag == 1)) { + halrf_update_pwr_track(dm, rate_idx); + ra_tab->power_tracking_flag = 0; } #endif +#if 0 /*trigger dynamic rate ID*/ -#if (defined(CONFIG_RA_DYNAMIC_RATE_ID)) - if (p_dm_odm->support_ic_type & (ODM_RTL8812 | ODM_RTL8192E)) - phydm_update_rate_id(p_dm_odm, rate, macid); -#endif - -} - -void -odm_rssi_monitor_init( - void *p_dm_void -) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _rate_adaptive_table_ *p_ra_table = &p_dm_odm->dm_ra_table; -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) - struct _ADAPTER *adapter = p_dm_odm->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; - - + if (dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8192E)) + phydm_update_rate_id(dm, rate, macid); #endif } -void -odm_ra_post_action_on_assoc( - void *p_dm_void -) +void odm_ra_post_action_on_assoc(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - /* - p_dm_odm->h2c_rarpt_connect = 1; - odm_rssi_monitor_check(p_dm_odm); - p_dm_odm->h2c_rarpt_connect = 0; - */ -} +#if 0 + struct dm_struct *dm = (struct dm_struct *)dm_void; -void -phydm_init_ra_info( - void *p_dm_void -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - -#if (RTL8822B_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8822B) { - u32 ret_value; - - ret_value = odm_get_bb_reg(p_dm_odm, 0x4c8, MASKBYTE2); - odm_set_bb_reg(p_dm_odm, 0x4cc, MASKBYTE3, (ret_value - 1)); - } + dm->h2c_rarpt_connect = 1; + phydm_rssi_monitor_check(dm); + dm->h2c_rarpt_connect = 0; #endif } -void -phydm_modify_RA_PCR_threshold( - void *p_dm_void, - u8 RA_offset_direction, - u8 RA_threshold_offset - -) +void phydm_modify_RA_PCR_threshold(void *dm_void, u8 ra_ofst_direc, + u8 ra_th_ofst) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _rate_adaptive_table_ *p_ra_table = &p_dm_odm->dm_ra_table; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ra_table *ra_tab = &dm->dm_ra_table; - p_ra_table->RA_offset_direction = RA_offset_direction; - p_ra_table->RA_threshold_offset = RA_threshold_offset; - ODM_RT_TRACE(p_dm_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)); + ra_tab->ra_ofst_direc = ra_ofst_direc; + ra_tab->ra_th_ofst = ra_th_ofst; + PHYDM_DBG(dm, DBG_RA_MASK, "Set ra_th_offset=(( %s%d ))\n", + ((ra_ofst_direc) ? "+" : "-"), ra_th_ofst); } -void -odm_rssi_monitor_check_mp( - void *p_dm_void -) -{ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _rate_adaptive_table_ *p_ra_table = &p_dm_odm->dm_ra_table; - u8 h2c_parameter[H2C_0X42_LENGTH] = {0}; - u32 i; - bool is_ext_ra_info = true; - u8 cmdlen = H2C_0X42_LENGTH; - u8 tx_bf_en = 0, stbc_en = 0; - - struct _ADAPTER *adapter = p_dm_odm->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_odm->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 ="), p_entry->MacAddr); - RT_DISP(FDM, DM_PWDB, ("p_entry->rssi = 0x%x(%d)\n", - p_entry->rssi_stat.undecorated_smoothed_pwdb, p_entry->rssi_stat.undecorated_smoothed_pwdb)); - - /* 2 BF_en */ -#if (BEAMFORMING_SUPPORT == 1) -#ifndef BEAMFORMING_VERSION_1 - beamform_cap = phydm_beamforming_get_entry_beam_cap_by_mac_id(p_dm_odm, p_entry->AssociatedMacId); - 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 (p_entry->rssi_stat.undecorated_smoothed_pwdb < tmp_entry_min_pwdb) - tmp_entry_min_pwdb = p_entry->rssi_stat.undecorated_smoothed_pwdb; - if (p_entry->rssi_stat.undecorated_smoothed_pwdb > tmp_entry_max_pwdb) - tmp_entry_max_pwdb = p_entry->rssi_stat.undecorated_smoothed_pwdb; - - h2c_parameter[4] = (p_ra_table->RA_threshold_offset & 0x7f) | (p_ra_table->RA_offset_direction << 7); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("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_odm->noisy_decision) - h2c_parameter[3] |= RAINFO_NOISY_STATE; - else - h2c_parameter[3] &= (~RAINFO_NOISY_STATE); -#if 1 - if (p_dm_odm->h2c_rarpt_connect) { - h2c_parameter[3] |= RAINFO_INIT_RSSI_RATE_STATE; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("h2c_rarpt_connect = (( %d ))\n", p_dm_odm->h2c_rarpt_connect)); - } -#else - - if (p_entry->rssi_stat.ra_rpt_linked == false) { - h2c_parameter[3] |= RAINFO_INIT_RSSI_RATE_STATE; - p_entry->rssi_stat.ra_rpt_linked = true; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("RA First Link, RSSI[%d] = ((%d))\n", - p_entry->associated_mac_id, p_entry->rssi_stat.undecorated_smoothed_pwdb)); - } -#endif - } - - h2c_parameter[2] = (u8)(p_entry->rssi_stat.undecorated_smoothed_pwdb & 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] = (p_entry->AssociatedMacId); - - odm_fill_h2c_cmd(p_dm_odm, 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) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("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_odm, 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); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("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 1 - if (p_dm_odm->h2c_rarpt_connect) { - h2c_parameter[3] |= RAINFO_INIT_RSSI_RATE_STATE; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("h2c_rarpt_connect = (( %d ))\n", p_dm_odm->h2c_rarpt_connect)); - } -#else - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("2 RA First Link, RSSI[%d] = ((%d)) , ra_rpt_linked = ((%d))\n", - WIN_DEFAULT_PORT_MACID, p_hal_data->undecorated_smoothed_pwdb, p_hal_data->ra_rpt_linked)); - - if (p_hal_data->ra_rpt_linked == false) { - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("3 RA First Link, RSSI[%d] = ((%d)) , ra_rpt_linked = ((%d))\n", - WIN_DEFAULT_PORT_MACID, p_hal_data->undecorated_smoothed_pwdb, p_hal_data->ra_rpt_linked)); - - h2c_parameter[3] |= RAINFO_INIT_RSSI_RATE_STATE; - p_hal_data->ra_rpt_linked = true; - - - } -#endif - - if (p_dm_odm->noisy_decision == 1) { - h2c_parameter[3] |= RAINFO_NOISY_STATE; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_NOISY_DETECT, ODM_DBG_LOUD, ("[RSSIMonitorCheckMP] Send H2C to FW\n")); - } else - h2c_parameter[3] &= (~RAINFO_NOISY_STATE); - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_NOISY_DETECT, ODM_DBG_LOUD, ("[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, ODM_H2C_RSSI_REPORT, cmdlen, h2c_parameter); - } - - /* BT 3.0 HS mode rssi */ - if (p_dm_odm->is_bt_hs_operation) { - h2c_parameter[2] = p_dm_odm->bt_hs_rssi; - /* h2c_parameter[1] = 0x0; */ - h2c_parameter[0] = WIN_BT_PORT_MACID; - - odm_fill_h2c_cmd(p_dm_odm, ODM_H2C_RSSI_REPORT, cmdlen, h2c_parameter); - } - } else - PlatformEFIOWrite1Byte(adapter, 0x4fe, (u8)p_hal_data->UndecoratedSmoothedPWDB); - - if ((p_dm_odm->support_ic_type == ODM_RTL8812) || (p_dm_odm->support_ic_type == ODM_RTL8192E)) - odm_rssi_dump_to_register(p_dm_odm); - - - { - struct _ADAPTER *p_loop_adapter = GetDefaultAdapter(adapter); - bool default_pointer_value, *p_is_link_temp = &default_pointer_value; - s32 global_rssi_min = 0xFF, local_rssi_min; - bool is_link = false; - - while (p_loop_adapter) { - local_rssi_min = phydm_find_minimum_rssi(p_dm_odm, 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; - odm_cmn_info_update(&p_hal_data->DM_OutSrc, ODM_CMNINFO_LINK, (u64)is_link); - - if (is_link) - odm_cmn_info_update(&p_hal_data->DM_OutSrc, ODM_CMNINFO_RSSI_MIN, (u64)global_rssi_min); - else - odm_cmn_info_update(&p_hal_data->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(struct PHY_DM_STRUCT *p_dm_odm, u8 mac_id) -{ - struct _ADAPTER *adapter = p_dm_odm->adapter; - struct _rate_adaptive_table_ *p_ra_table = &p_dm_odm->dm_ra_table; - struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(adapter); - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); - u8 h2c_parameter[H2C_0X42_LENGTH] = {0}; - u8 UL_DL_STATE = 0, STBC_TX = 0, tx_bf_en = 0; - u8 cmdlen = H2C_0X42_LENGTH, first_connect = _FALSE; - u64 cur_tx_ok_cnt = 0, cur_rx_ok_cnt = 0; - struct sta_info *p_entry = p_dm_odm->p_odm_sta_info[mac_id]; - - if (!IS_STA_VALID(p_entry)) - return _FAIL; - - if (mac_id != p_entry->mac_id) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("%s mac_id:%u:%u invalid\n", __func__, mac_id, p_entry->mac_id)); - rtw_warn_on(1); - return _FAIL; - } - - if (IS_MCAST(p_entry->hwaddr)) /*if(psta->mac_id ==1)*/ - return _FAIL; - - if (p_entry->rssi_stat.undecorated_smoothed_pwdb == (-1)) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("%s mac_id:%u, mac:"MAC_FMT", rssi == -1\n", __func__, p_entry->mac_id, MAC_ARG(p_entry->hwaddr))); - return _FAIL; - } - - cur_tx_ok_cnt = pdvobjpriv->traffic_stat.cur_tx_bytes; - cur_rx_ok_cnt = pdvobjpriv->traffic_stat.cur_rx_bytes; - if (cur_rx_ok_cnt > (cur_tx_ok_cnt * 6)) - UL_DL_STATE = 1; - else - UL_DL_STATE = 0; - -#ifdef CONFIG_BEAMFORMING - { -#if (BEAMFORMING_SUPPORT == 1) - enum beamforming_cap beamform_cap = phydm_beamforming_get_entry_beam_cap_by_mac_id(p_dm_odm, p_entry->mac_id); -#else/*for drv beamforming*/ - enum beamforming_cap beamform_cap = beamforming_get_entry_beam_cap_by_mac_id(&adapter->mlmepriv, p_entry->mac_id); -#endif - - if (beamform_cap & (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP_VHT_SU)) - tx_bf_en = 1; - else - tx_bf_en = 0; - } -#endif /*#ifdef CONFIG_BEAMFORMING*/ - - if (tx_bf_en) - STBC_TX = 0; - else { -#ifdef CONFIG_80211AC_VHT - if (is_supported_vht(p_entry->wireless_mode)) - STBC_TX = TEST_FLAG(p_entry->vhtpriv.stbc_cap, STBC_VHT_ENABLE_TX); - else -#endif - STBC_TX = TEST_FLAG(p_entry->htpriv.stbc_cap, STBC_HT_ENABLE_TX); - } - - h2c_parameter[0] = (u8)(p_entry->mac_id & 0xFF); - h2c_parameter[2] = p_entry->rssi_stat.undecorated_smoothed_pwdb & 0x7F; - - if (UL_DL_STATE) - h2c_parameter[3] |= RAINFO_BE_RX_STATE; - - if (tx_bf_en) - h2c_parameter[3] |= RAINFO_BF_STATE; - if (STBC_TX) - h2c_parameter[3] |= RAINFO_STBC_STATE; - if (p_dm_odm->noisy_decision) - h2c_parameter[3] |= RAINFO_NOISY_STATE; - - if ((p_entry->ra_rpt_linked == _FALSE) && (p_entry->rssi_stat.is_send_rssi == RA_RSSI_STATE_SEND)) { - h2c_parameter[3] |= RAINFO_INIT_RSSI_RATE_STATE; - p_entry->ra_rpt_linked = _TRUE; - p_entry->rssi_stat.is_send_rssi = RA_RSSI_STATE_HOLD; - first_connect = _TRUE; - } - - h2c_parameter[4] = (p_ra_table->RA_threshold_offset & 0x7f) | (p_ra_table->RA_offset_direction << 7); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("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 1 - if (first_connect) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("%s mac_id:%u, mac:"MAC_FMT", rssi:%d\n", __func__, - p_entry->mac_id, MAC_ARG(p_entry->hwaddr), p_entry->rssi_stat.undecorated_smoothed_pwdb)); - - ODM_RT_TRACE(p_dm_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", (tx_bf_en) ? "EN" : "DIS", (STBC_TX) ? "EN" : "DIS", - (p_dm_odm->noisy_decision) ? "True" : "False", (first_connect) ? "True" : "False")); - } -#endif - - if (p_hal_data->fw_ractrl == _TRUE) { -#if (RTL8188E_SUPPORT == 1) - if (p_dm_odm->support_ic_type == ODM_RTL8188E) - cmdlen = 3; -#endif - odm_fill_h2c_cmd(p_dm_odm, ODM_H2C_RSSI_REPORT, cmdlen, h2c_parameter); - } else { -#if ((RTL8188E_SUPPORT == 1) && (RATE_ADAPTIVE_SUPPORT == 1)) - if (p_dm_odm->support_ic_type == ODM_RTL8188E) - odm_ra_set_rssi_8188e(p_dm_odm, (u8)(p_entry->mac_id & 0xFF), p_entry->rssi_stat.undecorated_smoothed_pwdb & 0x7F); -#endif - } - return _SUCCESS; -} - -void phydm_ra_rssi_rpt_wk_hdl(void *p_context) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_context; - int i; - u8 mac_id = 0xFF; - struct sta_info *p_entry = NULL; - - for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { - p_entry = p_dm_odm->p_odm_sta_info[i]; - if (IS_STA_VALID(p_entry)) { - if (IS_MCAST(p_entry->hwaddr)) /*if(psta->mac_id ==1)*/ - continue; - if (p_entry->ra_rpt_linked == _FALSE) { - mac_id = i; - break; - } - } - } - if (mac_id != 0xFF) - phydm_rssi_report(p_dm_odm, mac_id); -} -void phydm_ra_rssi_rpt_wk(void *p_context) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_context; - - rtw_run_in_thread_cmd(p_dm_odm->adapter, phydm_ra_rssi_rpt_wk_hdl, p_dm_odm); -} -#endif - -void -odm_rssi_monitor_check_ce( - void *p_dm_void -) -{ -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTER *adapter = p_dm_odm->adapter; - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); - struct sta_info *p_entry; - int i; - int tmp_entry_max_pwdb = 0, tmp_entry_min_pwdb = 0xff; - u8 sta_cnt = 0; - - if (p_dm_odm->is_linked != _TRUE) - return; - - for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { - p_entry = p_dm_odm->p_odm_sta_info[i]; - if (IS_STA_VALID(p_entry)) { - if (IS_MCAST(p_entry->hwaddr)) /*if(psta->mac_id ==1)*/ - continue; - - if (p_entry->rssi_stat.undecorated_smoothed_pwdb == (-1)) - continue; - - if (p_entry->rssi_stat.undecorated_smoothed_pwdb < tmp_entry_min_pwdb) - tmp_entry_min_pwdb = p_entry->rssi_stat.undecorated_smoothed_pwdb; - - if (p_entry->rssi_stat.undecorated_smoothed_pwdb > tmp_entry_max_pwdb) - tmp_entry_max_pwdb = p_entry->rssi_stat.undecorated_smoothed_pwdb; - - if (phydm_rssi_report(p_dm_odm, i)) - sta_cnt++; - } - } - - if (tmp_entry_max_pwdb != 0) /* If associated entry is found */ - p_hal_data->entry_max_undecorated_smoothed_pwdb = tmp_entry_max_pwdb; - else - p_hal_data->entry_max_undecorated_smoothed_pwdb = 0; - - if (tmp_entry_min_pwdb != 0xff) /* If associated entry is found */ - p_hal_data->entry_min_undecorated_smoothed_pwdb = tmp_entry_min_pwdb; - else - p_hal_data->entry_min_undecorated_smoothed_pwdb = 0; - - find_minimum_rssi(adapter);/* get pdmpriv->min_undecorated_pwdb_for_dm */ - - p_dm_odm->rssi_min = p_hal_data->min_undecorated_pwdb_for_dm; - /* odm_cmn_info_update(&p_hal_data->odmpriv,ODM_CMNINFO_RSSI_MIN, pdmpriv->min_undecorated_pwdb_for_dm); */ -#endif/* if (DM_ODM_SUPPORT_TYPE == ODM_CE) */ -} - - -void -odm_rssi_monitor_check_ap( - void *p_dm_void -) -{ #if (DM_ODM_SUPPORT_TYPE == ODM_AP) -#if (RTL8812A_SUPPORT || RTL8881A_SUPPORT || RTL8192E_SUPPORT || RTL8814A_SUPPORT || RTL8197F_SUPPORT) - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _rate_adaptive_table_ *p_ra_table = &p_dm_odm->dm_ra_table; - u8 h2c_parameter[H2C_0X42_LENGTH] = {0}; - u32 i; - bool is_ext_ra_info = true; - u8 cmdlen = H2C_0X42_LENGTH; - u8 tx_bf_en = 0, stbc_en = 0; +void phydm_gen_ramask_h2c_AP( + void *dm_void, + struct rtl8192cd_priv *priv, + struct sta_info *entry, + u8 rssi_level) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; - struct rtl8192cd_priv *priv = p_dm_odm->priv; - struct sta_info *pstat; - bool act_bfer = false; - -#if (BEAMFORMING_SUPPORT == 1) - u8 idx = 0xff; -#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) - struct _BF_DIV_COEX_ *p_dm_bdc_table = &p_dm_odm->dm_bdc_table; - p_dm_bdc_table->num_txbfee_client = 0; - p_dm_bdc_table->num_txbfer_client = 0; -#endif -#endif - if (!p_dm_odm->h2c_rarpt_connect && (priv->up_time % 2)) - return; - - if (p_dm_odm->support_ic_type == ODM_RTL8188E) { - is_ext_ra_info = false; - cmdlen = 3; + if (dm->support_ic_type == ODM_RTL8812) { + #if (RTL8812A_SUPPORT == 1) + UpdateHalRAMask8812(priv, entry, rssi_level); + #endif + } else if (dm->support_ic_type == ODM_RTL8188E) { + #if (RTL8188E_SUPPORT == 1) + #ifdef TXREPORT + add_RATid(priv, entry); + #endif + #endif + } else { + #ifdef CONFIG_WLAN_HAL + GET_HAL_INTERFACE(priv)->UpdateHalRAMaskHandler(priv, entry, rssi_level); + #endif } - - for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { - pstat = p_dm_odm->p_odm_sta_info[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 p_entry = Beamforming_GetEntryByMacId(priv, pstat->aid, &idx); - - if (beamform_cap & (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP_VHT_SU)) { - - if (p_entry->Sounding_En) - tx_bf_en = 1; - else - tx_bf_en = 0; - - act_bfer = true; - } - -#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) /*BDC*/ - if (act_bfer == true) { - p_dm_bdc_table->w_bfee_client[i] = 1; /* AP act as BFer */ - p_dm_bdc_table->num_txbfee_client++; - } else { - p_dm_bdc_table->w_bfee_client[i] = 0; /* AP act as BFer */ - } - - if ((beamform_cap & BEAMFORMEE_CAP_HT_EXPLICIT) || (beamform_cap & BEAMFORMEE_CAP_VHT_SU)) { - p_dm_bdc_table->w_bfer_client[i] = 1; /* AP act as BFee */ - p_dm_bdc_table->num_txbfer_client++; - } else { - p_dm_bdc_table->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] = (p_ra_table->RA_threshold_offset & 0x7f) | (p_ra_table->RA_offset_direction << 7); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("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 ((pstat->rx_avarage) > ((pstat->tx_avarage) * 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_odm->noisy_decision) - 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(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("[RA Init] set Init rate by RSSI, STA %d\n", pstat->aid)); - } - - /*ODM_RT_TRACE(p_dm_odm,PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[RAINFO] H2C_Para[3] = %x\n",h2c_parameter[3]));*/ - } - - h2c_parameter[2] = (u8)(pstat->rssi & 0xFF); - h2c_parameter[0] = REMAP_AID(pstat); - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("h2c_parameter[3]=%d\n", h2c_parameter[3])); - - /* ODM_RT_TRACE(p_dm_odm,PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[RSSI] H2C_Para[2] = %x,\n",h2c_parameter[2])); */ - /* ODM_RT_TRACE(p_dm_odm,PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[MACID] H2C_Para[0] = %x,\n",h2c_parameter[0])); */ - - odm_fill_h2c_cmd(p_dm_odm, ODM_H2C_RSSI_REPORT, cmdlen, h2c_parameter); - - } - } - -#endif -#endif - } -void -odm_rssi_monitor_check( - void *p_dm_void -) +void phydm_update_hal_ra_mask( + void *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_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 ratr_bitmap = *ratr_bitmap_lsb_in; + u32 ratr_bitmap_msb = *ratr_bitmap_msb_in; - if (!(p_dm_odm->support_ability & ODM_BB_RSSI_MONITOR)) - return; +#if 0 + /*PHYDM_DBG(dm, DBG_RA_MASK, "phydm_rf_type = (( %x )), rf_type = (( %x ))\n", phydm_rf_type, rf_type);*/ +#endif + PHYDM_DBG(dm, DBG_RA_MASK, + "Platfoem original RA Mask = (( 0x %x | %x ))\n", + ratr_bitmap_msb, ratr_bitmap); - switch (p_dm_odm->support_platform) { - case ODM_WIN: - odm_rssi_monitor_check_mp(p_dm_odm); - break; + switch (wireless_mode) { + case PHYDM_WIRELESS_MODE_B: { + ratr_bitmap &= 0x0000000f; + } break; - case ODM_CE: - odm_rssi_monitor_check_ce(p_dm_odm); - break; + case PHYDM_WIRELESS_MODE_G: { + ratr_bitmap &= 0x00000ff5; + } break; - case ODM_AP: - odm_rssi_monitor_check_ap(p_dm_odm); - 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 not 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 not 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(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); + +#if 0 + /*PHYDM_DBG(dm, DBG_RA_MASK, "111 Phydm modified RA Mask = (( 0x %x | %x ))\n", ratr_bitmap_msb, ratr_bitmap);*/ +#endif + + *ratr_bitmap_lsb_in = ratr_bitmap; + *ratr_bitmap_msb_in = ratr_bitmap_msb; + PHYDM_DBG(dm, DBG_RA_MASK, + "Phydm modified RA Mask = (( 0x %x | %x ))\n", + *ratr_bitmap_msb_in, *ratr_bitmap_lsb_in); } -void -odm_rate_adaptive_mask_init( - void *p_dm_void -) +#endif + +void phydm_rate_adaptive_mask_init(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ODM_RATE_ADAPTIVE *p_odm_ra = &p_dm_odm->rate_adaptive; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ra_table *ra_t = &dm->dm_ra_table; #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PMGNT_INFO p_mgnt_info = &p_dm_odm->adapter->MgntInfo; - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_dm_odm->adapter); + PADAPTER adapter = dm->adapter; + PMGNT_INFO mgnt_info = &(adapter->MgntInfo); + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)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; + if (mgnt_info->DM_Type == dm_type_by_driver) + hal_data->bUseRAMask = true; else - p_hal_data->bUseRAMask = false; - -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - p_odm_ra->type = dm_type_by_driver; - if (p_odm_ra->type == dm_type_by_driver) - p_dm_odm->is_use_ra_mask = _TRUE; - else - p_dm_odm->is_use_ra_mask = _FALSE; -#endif - - p_odm_ra->ratr_state = DM_RATR_STA_INIT; - -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - if (p_dm_odm->support_ic_type == ODM_RTL8812) - p_odm_ra->ldpc_thres = 50; - else - p_odm_ra->ldpc_thres = 35; - - p_odm_ra->rts_thres = 35; - -#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - p_odm_ra->ldpc_thres = 35; - p_odm_ra->is_use_ldpc = false; - -#else - p_odm_ra->ultra_low_rssi_thresh = 9; + hal_data->bUseRAMask = false; #endif - p_odm_ra->high_rssi_thresh = 50; -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) && \ - ((DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE)) - p_odm_ra->low_rssi_thresh = 23; -#else - p_odm_ra->low_rssi_thresh = 20; -#endif + ra_t->ldpc_thres = 35; + ra_t->up_ramask_cnt = 0; + ra_t->up_ramask_cnt_tmp = 0; } -/*----------------------------------------------------------------------------- - * Function: odm_refresh_rate_adaptive_mask() - * - * 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_refresh_rate_adaptive_mask( - void *p_dm_void -) + +void phydm_refresh_rate_adaptive_mask(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _rate_adaptive_table_ *p_ra_table = &p_dm_odm->dm_ra_table; +/*@Will be removed*/ + struct dm_struct *dm = (struct dm_struct *)dm_void; - if (!p_dm_odm->is_linked) + phydm_ra_mask_watchdog(dm); +} + +void phydm_show_sta_info(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct cmn_sta_info *sta = NULL; + struct ra_sta_info *ra = NULL; +#ifdef CONFIG_BEAMFORMING + struct bf_cmn_info *bf = NULL; +#endif + char help[] = "-h"; + u32 var[10] = {0}; + u32 used = *_used; + u32 out_len = *_out_len; + u32 i, sta_idx_start, sta_idx_end; + u8 tatal_sta_num = 0; + + PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var[0]); + + if ((strcmp(input[1], help) == 0)) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "All STA: {1}\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "STA[macid]: {2} {macid}\n"); return; - - if (!(p_dm_odm->support_ability & ODM_BB_RA_MASK)) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_TRACE, ("odm_refresh_rate_adaptive_mask(): Return cos not supported\n")); + } else if (var[0] == 1) { + sta_idx_start = 0; + sta_idx_end = ODM_ASSOCIATE_ENTRY_NUM; + } else if (var[0] == 2) { + sta_idx_start = var[1]; + sta_idx_end = var[1]; + } else { + PDM_SNPF(out_len, used, output + used, out_len - used, + "Warning input value!\n"); return; } - p_ra_table->force_update_ra_mask_count++; - /* */ - /* 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_odm->support_platform) { - case ODM_WIN: - odm_refresh_rate_adaptive_mask_mp(p_dm_odm); - break; + for (i = sta_idx_start; i < sta_idx_end; i++) { + sta = dm->phydm_sta_info[i]; - case ODM_CE: - odm_refresh_rate_adaptive_mask_ce(p_dm_odm); - break; + if (!is_sta_active(sta)) + continue; - case ODM_AP: - odm_refresh_rate_adaptive_mask_apadsl(p_dm_odm); - break; + ra = &sta->ra_info; + #ifdef CONFIG_BEAMFORMING + bf = &sta->bf_info; + #endif + + tatal_sta_num++; + + PDM_SNPF(out_len, used, output + used, out_len - used, + "==[sta_idx: %d][MACID: %d]============>\n", i, + sta->mac_id); + PDM_SNPF(out_len, used, output + used, out_len - used, + "AID:%d\n", sta->aid); + PDM_SNPF(out_len, used, output + used, out_len - used, + "ADDR:%x-%x-%x-%x-%x-%x\n", sta->mac_addr[5], + sta->mac_addr[4], sta->mac_addr[3], sta->mac_addr[2], + sta->mac_addr[1], sta->mac_addr[0]); + PDM_SNPF(out_len, used, output + used, out_len - used, + "DM_ctrl:0x%x\n", sta->dm_ctrl); + PDM_SNPF(out_len, used, output + used, out_len - used, + "BW:%d, MIMO_Type:0x%x\n", sta->bw_mode, + sta->mimo_type); + PDM_SNPF(out_len, used, output + used, out_len - used, + "STBC_en:%d, LDPC_en=%d\n", sta->stbc_en, + sta->ldpc_en); + + /*@[RSSI Info]*/ + PDM_SNPF(out_len, used, output + used, out_len - used, + "RSSI{All, OFDM, CCK}={%d, %d, %d}\n", + sta->rssi_stat.rssi, sta->rssi_stat.rssi_ofdm, + sta->rssi_stat.rssi_cck); + + /*@[RA Info]*/ + PDM_SNPF(out_len, used, output + used, out_len - used, + "Rate_ID:%d, RSSI_LV:%d, ra_bw:%d, SGI_en:%d\n", + ra->rate_id, ra->rssi_level, ra->ra_bw_mode, + ra->is_support_sgi); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "VHT_en:%d, Wireless_set=0x%x, sm_ps=%d\n", + ra->is_vht_enable, sta->support_wireless_set, + sta->sm_ps); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "Dis{RA, PT}={%d, %d}, TxRx:%d, Noisy:%d\n", + ra->disable_ra, ra->disable_pt, ra->txrx_state, + ra->is_noisy); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "TX{Rate, BW}={0x%x, %d}, RTY:%d\n", ra->curr_tx_rate, + ra->curr_tx_bw, ra->curr_retry_ratio); + + PDM_SNPF(out_len, used, output + used, out_len - used, + "RA_Mask:0x%llx\n", ra->ramask); + + /*@[TP]*/ + PDM_SNPF(out_len, used, output + used, out_len - used, + "TP{TX,RX}={%d, %d}\n", sta->tx_moving_average_tp, + sta->rx_moving_average_tp); + +#ifdef CONFIG_BEAMFORMING + /*@[Beamforming]*/ + PDM_SNPF(out_len, used, output + used, out_len - used, + "BF CAP{HT,VHT}={0x%x, 0x%x}\n", bf->ht_beamform_cap, + bf->vht_beamform_cap); + PDM_SNPF(out_len, used, output + used, out_len - used, + "BF {p_aid,g_id}={0x%x, 0x%x}\n\n", bf->p_aid, + bf->g_id); +#endif } + if (tatal_sta_num == 0) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "No Linked STA\n"); + } + + *_used = used; + *_out_len = out_len; } -u8 -phydm_trans_platform_bw( - void *p_dm_void, - u8 BW -) +u8 phydm_get_rx_stream_num(void *dm_void, enum rf_type type) { -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - if (BW == CHANNEL_WIDTH_20) - BW = PHYDM_BW_20; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 rx_num = 1; - 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; - -} - -u8 -phydm_trans_platform_rf_type( - void *p_dm_void, - u8 rf_type -) -{ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - if (rf_type == RF_1T2R) - rf_type = PHYDM_RF_1T2R; - - else if (rf_type == RF_2T4R) - rf_type = PHYDM_RF_2T4R; - - else if (rf_type == RF_2T2R) - rf_type = PHYDM_RF_2T2R; - - else if (rf_type == RF_1T1R) - rf_type = PHYDM_RF_1T1R; - - else if (rf_type == RF_2T2R_GREEN) - rf_type = PHYDM_RF_2T2R_GREEN; - - else if (rf_type == RF_3T3R) - rf_type = PHYDM_RF_3T3R; - - else if (rf_type == RF_4T4R) - rf_type = PHYDM_RF_4T4R; - - else if (rf_type == RF_2T3R) - rf_type = PHYDM_RF_1T2R; - - else if (rf_type == RF_3T4R) - rf_type = PHYDM_RF_3T4R; - -#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) - - if (rf_type == MIMO_1T2R) - rf_type = PHYDM_RF_1T2R; - - else if (rf_type == MIMO_2T4R) - rf_type = PHYDM_RF_2T4R; - - else if (rf_type == MIMO_2T2R) - rf_type = PHYDM_RF_2T2R; - - else if (rf_type == MIMO_1T1R) - rf_type = PHYDM_RF_1T1R; - - else if (rf_type == MIMO_3T3R) - rf_type = PHYDM_RF_3T3R; - - else if (rf_type == MIMO_4T4R) - rf_type = PHYDM_RF_4T4R; - - else if (rf_type == MIMO_2T3R) - rf_type = PHYDM_RF_1T2R; - - else if (rf_type == MIMO_3T4R) - rf_type = PHYDM_RF_3T4R; - -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - - if (rf_type == RF_1T2R) - rf_type = PHYDM_RF_1T2R; - - else if (rf_type == RF_2T4R) - rf_type = PHYDM_RF_2T4R; - - else if (rf_type == RF_2T2R) - rf_type = PHYDM_RF_2T2R; - - else if (rf_type == RF_1T1R) - rf_type = PHYDM_RF_1T1R; - - else if (rf_type == RF_2T2R_GREEN) - rf_type = PHYDM_RF_2T2R_GREEN; - - else if (rf_type == RF_3T3R) - rf_type = PHYDM_RF_3T3R; - - else if (rf_type == RF_4T4R) - rf_type = PHYDM_RF_4T4R; - - else if (rf_type == RF_2T3R) - rf_type = PHYDM_RF_1T2R; - - else if (rf_type == RF_3T4R) - rf_type = PHYDM_RF_3T4R; - -#endif - - return rf_type; - -} - -u32 -phydm_trans_platform_wireless_mode( - void *p_dm_void, - u32 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; + if (type == RF_1T1R) + rx_num = 1; + else if (type == RF_2T2R || type == RF_1T2R) + rx_num = 2; + else if (type == RF_3T3R || type == RF_2T3R) + rx_num = 3; + else if (type == RF_4T4R || type == RF_3T4R || type == RF_2T4R) + rx_num = 4; else - wireless_mode = PHYDM_WIRELESS_MODE_UNKNOWN; -#endif - - return wireless_mode; + pr_debug("[Warrning] %s\n", __func__); + return rx_num; } -u8 -phydm_vht_en_mapping( - void *p_dm_void, - u32 wireless_mode -) +u8 phydm_get_tx_stream_num(void *dm_void, enum rf_type type) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 vht_en_out = 0; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 tx_num = 1; - if ((wireless_mode == PHYDM_WIRELESS_MODE_AC_5G) || - (wireless_mode == PHYDM_WIRELESS_MODE_AC_24G) || - (wireless_mode == PHYDM_WIRELESS_MODE_AC_ONLY) - ) { + if (type == RF_1T1R || type == RF_1T2R) + tx_num = 1; + else if (type == RF_2T2R || type == RF_2T3R || type == RF_2T4R) + tx_num = 2; + else if (type == RF_3T3R || type == RF_3T4R) + tx_num = 3; + else if (type == RF_4T4R) + tx_num = 4; + else + PHYDM_DBG(dm, DBG_RA, "[Warrning] no mimo_type is found\n"); + + return tx_num; +} + +u64 phydm_get_bb_mod_ra_mask(void *dm_void, u8 sta_idx) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct cmn_sta_info *sta = dm->phydm_sta_info[sta_idx]; + struct ra_sta_info *ra = NULL; + enum channel_width bw = 0; + enum wireless_set wrls_mode = 0; + u8 tx_stream_num = 1; + u8 rssi_lv = 0; + u64 ra_mask_bitmap = 0; + + if (is_sta_active(sta)) { + ra = &sta->ra_info; + bw = ra->ra_bw_mode; + wrls_mode = sta->support_wireless_set; + tx_stream_num = phydm_get_tx_stream_num(dm, sta->mimo_type); + rssi_lv = ra->rssi_level; + ra_mask_bitmap = ra->ramask; + } else { + PHYDM_DBG(dm, DBG_RA, "[Warning] %s invalid STA\n", __func__); + return 0; + } + + PHYDM_DBG(dm, DBG_RA, "macid=%d ori_RA_Mask= 0x%llx\n", sta->mac_id, + ra_mask_bitmap); + PHYDM_DBG(dm, DBG_RA, + "wireless_mode=0x%x, tx_ss=%d, BW=%d, MimoPs=%d, rssi_lv=%d\n", + wrls_mode, tx_stream_num, bw, sta->sm_ps, rssi_lv); + + if (sta->sm_ps == SM_PS_STATIC) /*@mimo_ps_enable*/ + tx_stream_num = 1; + + /*@[Modify RA Mask by Wireless Mode]*/ + + if (wrls_mode == WIRELESS_CCK) { /*@B mode*/ + ra_mask_bitmap &= 0x0000000f; + } else if (wrls_mode == WIRELESS_OFDM) { /*@G mode*/ + ra_mask_bitmap &= 0x00000ff0; + } else if (wrls_mode == (WIRELESS_CCK | WIRELESS_OFDM)) { /*@BG mode*/ + ra_mask_bitmap &= 0x00000ff5; + } else if (wrls_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 { + ra_mask_bitmap &= 0xffffffff015; + } + } else if (wrls_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 { + ra_mask_bitmap &= 0xffffffff010; + } + } else if (wrls_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 &= 0x3fffffff015; + else /*@AC_4SS 2G*/ + ra_mask_bitmap &= 0x000ffffffffff015; + if (bw == CHANNEL_WIDTH_20) { + /* @AC 20MHz doesn't support MCS9 except 3SS & 6SS*/ + ra_mask_bitmap &= 0x0007ffff7fdff015; + } else if (bw == CHANNEL_WIDTH_80) { + /* @AC 80MHz doesn't support 3SS MCS6*/ + ra_mask_bitmap &= 0x000fffbffffff015; + } + } else if (wrls_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; + else /*@AC_4SS 5G*/ + ra_mask_bitmap &= 0x000ffffffffff010; + + if (bw == CHANNEL_WIDTH_20) { + /* @AC 20MHz doesn't support MCS9 except 3SS & 6SS*/ + ra_mask_bitmap &= 0x0007ffff7fdff010; + } else if (bw == CHANNEL_WIDTH_80) { + /* @AC 80MHz doesn't support 3SS MCS6*/ + ra_mask_bitmap &= 0x000fffbffffff010; + } + } else { + PHYDM_DBG(dm, DBG_RA, "[Warrning] RA mask is Not found\n"); + } + + PHYDM_DBG(dm, DBG_RA, "Mod by mode=0x%llx\n", ra_mask_bitmap); + + /*@[Modify RA Mask by RSSI level]*/ + if (wrls_mode != WIRELESS_CCK) { + if (rssi_lv == 0) + ra_mask_bitmap &= 0xffffffffffffffff; + else if (rssi_lv == 1) + ra_mask_bitmap &= 0xfffffffffffffff0; + else if (rssi_lv == 2) + ra_mask_bitmap &= 0xffffffffffffefe0; + else if (rssi_lv == 3) + ra_mask_bitmap &= 0xffffffffffffcfc0; + else if (rssi_lv == 4) + ra_mask_bitmap &= 0xffffffffffff8f80; + else if (rssi_lv >= 5) + ra_mask_bitmap &= 0xffffffffffff0f00; + } + PHYDM_DBG(dm, DBG_RA, "Mod by RSSI=0x%llx\n", ra_mask_bitmap); + + return ra_mask_bitmap; +} + +u8 phydm_get_rate_from_rssi_lv(void *dm_void, u8 sta_idx) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct cmn_sta_info *sta = dm->phydm_sta_info[sta_idx]; + struct ra_sta_info *ra = NULL; + enum wireless_set wrls_set = 0; + u8 rssi_lv = 0; + u8 rate_idx = 0; + u8 rate_ofst = 0; + + if (is_sta_active(sta)) { + ra = &sta->ra_info; + wrls_set = sta->support_wireless_set; + rssi_lv = ra->rssi_level; + } else { + pr_debug("[Warning] %s: invalid STA\n", __func__); + return 0; + } + + PHYDM_DBG(dm, DBG_RA, "[%s]macid=%d, wireless_set=0x%x, rssi_lv=%d\n", + __func__, sta->mac_id, wrls_set, rssi_lv); + + rate_ofst = (rssi_lv <= 1) ? 0 : (rssi_lv - 1); + + if (wrls_set & WIRELESS_VHT) { + rate_idx = ODM_RATEVHTSS1MCS0 + rate_ofst; + } else if (wrls_set & WIRELESS_HT) { + rate_idx = ODM_RATEMCS0 + rate_ofst; + } else if (wrls_set & WIRELESS_OFDM) { + rate_idx = ODM_RATE6M + rate_ofst; + } else { + rate_idx = ODM_RATE1M + rate_ofst; + + if (rate_idx > ODM_RATE11M) + rate_idx = ODM_RATE11M; + } + return rate_idx; +} + +u8 phydm_get_rate_id(void *dm_void, u8 sta_idx) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct cmn_sta_info *sta = dm->phydm_sta_info[sta_idx]; + struct ra_sta_info *ra = NULL; + enum channel_width bw = 0; + enum wireless_set wrls_mode = 0; + u8 tx_stream_num = 1; + u8 rate_id_idx = PHYDM_BGN_20M_1SS; + + if (is_sta_active(sta)) { + ra = &sta->ra_info; + bw = ra->ra_bw_mode; + wrls_mode = sta->support_wireless_set; + tx_stream_num = phydm_get_tx_stream_num(dm, sta->mimo_type); + + } else { + PHYDM_DBG(dm, DBG_RA, "[Warning] %s: invalid STA\n", __func__); + return 0; + } + + PHYDM_DBG(dm, DBG_RA, "macid=%d,wireless_set=0x%x,tx_SS_num=%d,BW=%d\n", + sta->mac_id, wrls_mode, tx_stream_num, bw); + + if (wrls_mode == WIRELESS_CCK) { + /*@B mode*/ + rate_id_idx = PHYDM_B_20M; + } else if (wrls_mode == WIRELESS_OFDM) { + /*@G mode*/ + rate_id_idx = PHYDM_G; + } else if (wrls_mode == (WIRELESS_CCK | WIRELESS_OFDM)) { + /*@BG mode*/ + rate_id_idx = PHYDM_BG; + } else if (wrls_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 (wrls_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 == 4) + rate_id_idx = PHYDM_ARFR7_N_4SS; + + } 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 (tx_stream_num == 4) + rate_id_idx = PHYDM_ARFR7_N_4SS; + } + } else if (wrls_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 (tx_stream_num == 4) + rate_id_idx = PHYDM_ARFR6_AC_4SS; + } else if (wrls_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 == 4) + rate_id_idx = PHYDM_ARFR6_AC_4SS; + } 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 if (tx_stream_num == 4) + rate_id_idx = PHYDM_ARFR6_AC_4SS; + } + } else { + PHYDM_DBG(dm, DBG_RA, "[Warrning] No rate_id is found\n"); + rate_id_idx = 0; + } + + PHYDM_DBG(dm, DBG_RA, "Rate_ID=((0x%x))\n", rate_id_idx); + + return rate_id_idx; +} + +void phydm_ra_h2c(void *dm_void, u8 sta_idx, u8 dis_ra, u8 dis_pt, + u8 no_update_bw, u8 init_ra_lv, u64 ra_mask) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct cmn_sta_info *sta = dm->phydm_sta_info[sta_idx]; + struct ra_sta_info *ra = NULL; + u8 h2c_val[H2C_MAX_LENGTH] = {0}; + + if (is_sta_active(sta)) { + ra = &sta->ra_info; + } else { + PHYDM_DBG(dm, DBG_RA, "[Warning] %s invalid sta_info\n", + __func__); + return; + } + + PHYDM_DBG(dm, DBG_RA, "%s ======>\n", __func__); + PHYDM_DBG(dm, DBG_RA, "MACID=%d\n", sta->mac_id); + + if (dm->is_disable_power_training) + dis_pt = true; + else if (!dm->is_disable_power_training) + dis_pt = false; + + h2c_val[0] = sta->mac_id; + h2c_val[1] = (ra->rate_id & 0x1f) | ((init_ra_lv & 0x3) << 5) | + (ra->is_support_sgi << 7); + h2c_val[2] = (u8)((ra->ra_bw_mode) | (((sta->ldpc_en) ? 1 : 0) << 2) | + ((no_update_bw & 0x1) << 3) | + (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(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(dm, PHYDM_H2C_RA_MASK, H2C_MAX_LENGTH, h2c_val); + + #if (defined(PHYDM_COMPILE_ABOVE_3SS)) + if (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(dm, DBG_RA, "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(dm, PHYDM_RA_MASK_ABOVE_3SS, + H2C_MAX_LENGTH, h2c_val); + } + #endif +} + +void phydm_ra_registed(void *dm_void, u8 sta_idx, + /*@index of sta_info array, not MACID*/ + u8 rssi_from_assoc) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ra_table *ra_t = &dm->dm_ra_table; + struct cmn_sta_info *sta = dm->phydm_sta_info[sta_idx]; + struct ra_sta_info *ra = NULL; + u8 init_ra_lv = 0; + u64 ra_mask = 0; + /*@SD7 STA_idx != macid*/ + /*@SD4,8 STA_idx == macid, */ + + PHYDM_DBG(dm, DBG_RA_MASK, "%s ======>\n", __func__); + + if (is_sta_active(sta)) { + ra = &sta->ra_info; + PHYDM_DBG(dm, DBG_RA_MASK, "sta_idx=%d, macid=%d\n", sta_idx, + sta->mac_id); + } else { + PHYDM_DBG(dm, DBG_RA_MASK, "[Warning] %s invalid STA\n", + __func__); + PHYDM_DBG(dm, DBG_RA_MASK, "sta_idx=%d\n", sta_idx); + return; + } + + #if (RTL8188E_SUPPORT == 1) && (RATE_ADAPTIVE_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8188E) + ra->rate_id = phydm_get_rate_id_88e(dm, sta_idx); + else + #endif + { + ra->rate_id = phydm_get_rate_id(dm, sta_idx); + } + + ra_mask = phydm_get_bb_mod_ra_mask(dm, sta_idx); + + PHYDM_DBG(dm, DBG_RA_MASK, "rssi_assoc=%d\n", rssi_from_assoc); + + if (rssi_from_assoc > 40) + init_ra_lv = 1; + else if (rssi_from_assoc > 20) + init_ra_lv = 2; + else if (rssi_from_assoc > 1) + init_ra_lv = 3; + else + init_ra_lv = 0; + + if (ra_t->record_ra_info) + ra_t->record_ra_info(dm, sta_idx, sta, ra_mask); + + #if (RTL8188E_SUPPORT == 1) && (RATE_ADAPTIVE_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8188E) + /*@Driver RA*/ + phydm_ra_update_8188e(dm, sta_idx, ra->rate_id, + (u32)ra_mask, ra->is_support_sgi); + else + #endif + { + /*@FW RA*/ + phydm_ra_h2c(dm, sta_idx, ra->disable_ra, ra->disable_pt, 0, + init_ra_lv, ra_mask); + } +} + +void phydm_ra_offline(void *dm_void, u8 sta_idx) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ra_table *ra_t = &dm->dm_ra_table; + struct cmn_sta_info *sta = dm->phydm_sta_info[sta_idx]; + struct ra_sta_info *ra = NULL; + + if (is_sta_active(sta)) { + ra = &sta->ra_info; + } else { + PHYDM_DBG(dm, DBG_RA, "[Warning] %s invalid STA\n", __func__); + return; + } + + PHYDM_DBG(dm, DBG_RA, "%s ======>\n", __func__); + PHYDM_DBG(dm, DBG_RA, "MACID=%d\n", sta->mac_id); + + odm_memory_set(dm, &ra->rate_id, 0, sizeof(struct ra_sta_info)); + ra->disable_ra = 1; + ra->disable_pt = 1; + + if (ra_t->record_ra_info) + ra_t->record_ra_info(dm, sta->mac_id, sta, 0); + + if (dm->support_ic_type != ODM_RTL8188E) + phydm_ra_h2c(dm, sta->mac_id, 1, 1, 0, 0, 0); +} + +void phydm_ra_mask_watchdog(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ra_table *ra_t = &dm->dm_ra_table; + struct cmn_sta_info *sta = NULL; + struct ra_sta_info *ra = NULL; + boolean force_ra_mask_en = false; + u8 sta_idx; + u64 ra_mask; + u8 rssi_lv_new; + u8 rssi = 0; + + if (!(dm->support_ability & ODM_BB_RA_MASK)) + return; + + if (!dm->is_linked || (dm->phydm_sys_up_time % 2) == 1) + return; + + PHYDM_DBG(dm, DBG_RA_MASK, "%s ======>\n", __func__); + + ra_t->up_ramask_cnt++; + + if (ra_t->up_ramask_cnt >= FORCED_UPDATE_RAMASK_PERIOD) { + ra_t->up_ramask_cnt = 0; + force_ra_mask_en = true; + } + + for (sta_idx = 0; sta_idx < ODM_ASSOCIATE_ENTRY_NUM; sta_idx++) { + sta = dm->phydm_sta_info[sta_idx]; + + if (!is_sta_active(sta)) + continue; + + ra = &sta->ra_info; + + if (ra->disable_ra) + continue; + + PHYDM_DBG(dm, DBG_RA_MASK, "sta_idx=%d, macid=%d\n", sta_idx, + sta->mac_id); + + rssi = (u8)(sta->rssi_stat.rssi); + + /*@to be modified*/ + #if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) + if (dm->support_ic_type == ODM_RTL8812 || + (dm->support_ic_type == ODM_RTL8821 && + dm->cut_version == ODM_CUT_A) + ) { + if (rssi < ra_t->ldpc_thres) { + /*@LDPC TX enable*/ + #if (DM_ODM_SUPPORT_TYPE == ODM_CE) + set_ra_ldpc_8812(sta, true); + #elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) + MgntSet_TX_LDPC(dm->adapter, sta->mac_id, true); + #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) + /*to be added*/ + #endif + PHYDM_DBG(dm, DBG_RA_MASK, + "RSSI=%d, ldpc_en =TRUE\n", rssi); + + } else if (rssi > (ra_t->ldpc_thres + 3)) { + /*@LDPC TX disable*/ + #if (DM_ODM_SUPPORT_TYPE == ODM_CE) + set_ra_ldpc_8812(sta, false); + #elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) + MgntSet_TX_LDPC(dm->adapter, sta->mac_id, false); + #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) + /*to be added*/ + #endif + PHYDM_DBG(dm, DBG_RA_MASK, + "RSSI=%d, ldpc_en =FALSE\n", rssi); + } + } + #endif + + rssi_lv_new = phydm_rssi_lv_dec(dm, (u32)rssi, ra->rssi_level); + + if (ra->rssi_level != rssi_lv_new || force_ra_mask_en) { + PHYDM_DBG(dm, DBG_RA_MASK, "RSSI LV:((%d))->((%d))\n", + ra->rssi_level, rssi_lv_new); + + ra->rssi_level = rssi_lv_new; + + ra_mask = phydm_get_bb_mod_ra_mask(dm, sta_idx); + + if (ra_t->record_ra_info) + ra_t->record_ra_info(dm, sta_idx, sta, ra_mask); + + #if (RTL8188E_SUPPORT) && (RATE_ADAPTIVE_SUPPORT) + if (dm->support_ic_type == ODM_RTL8188E) + /*@Driver RA*/ + phydm_ra_update_8188e(dm, sta_idx, ra->rate_id, + (u32)ra_mask, + ra->is_support_sgi); + else + #endif + { + /*@FW RA*/ + phydm_ra_h2c(dm, sta_idx, ra->disable_ra, + ra->disable_pt, 1, 0, ra_mask); + } + } + } +} + +u8 phydm_vht_en_mapping(void *dm_void, u32 wireless_mode) +{ + struct dm_struct *dm = (struct dm_struct *)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; - /**/ - } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("wireless_mode= (( 0x%x )), VHT_EN= (( %d ))\n", wireless_mode, vht_en_out)); + PHYDM_DBG(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 -) +u8 phydm_rftype2rateid_2g_n20(void *dm_void, u8 rf_type) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 rate_id_idx = 0; - u8 phydm_BW; - u8 phydm_rf_type; + u8 rate_id_idx = 0; - phydm_BW = phydm_trans_platform_bw(p_dm_odm, bw); - phydm_rf_type = phydm_trans_platform_rf_type(p_dm_odm, rf_type); -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - wireless_mode = phydm_trans_platform_wireless_mode(p_dm_odm, wireless_mode); -#endif + 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 if (rf_type == RF_3T3R) + rate_id_idx = PHYDM_ARFR5_N_3SS; + else + rate_id_idx = PHYDM_ARFR7_N_4SS; + return rate_id_idx; +} - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("wireless_mode= (( 0x%x )), rf_type = (( 0x%x )), BW = (( 0x%x ))\n", - wireless_mode, phydm_rf_type, phydm_BW)); +u8 phydm_rftype2rateid_2g_n40(void *dm_void, u8 rf_type) +{ + u8 rate_id_idx = 0; + 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 if (rf_type == RF_3T3R) + rate_id_idx = PHYDM_ARFR5_N_3SS; + else + rate_id_idx = PHYDM_ARFR7_N_4SS; + return rate_id_idx; +} + +u8 phydm_rftype2rateid_5g_n(void *dm_void, u8 rf_type) +{ + u8 rate_id_idx = 0; + + if (rf_type == RF_1T1R) + rate_id_idx = PHYDM_GN_N1SS; + else if (rf_type == RF_2T2R) + rate_id_idx = PHYDM_GN_N2SS; + else if (rf_type == RF_3T3R) + rate_id_idx = PHYDM_ARFR5_N_3SS; + else + rate_id_idx = PHYDM_ARFR7_N_4SS; + return rate_id_idx; +} + +u8 phydm_rftype2rateid_ac80(void *dm_void, u8 rf_type) +{ + u8 rate_id_idx = 0; + + 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 if (rf_type == RF_3T3R) + rate_id_idx = PHYDM_ARFR4_AC_3SS; + else + rate_id_idx = PHYDM_ARFR6_AC_4SS; + return rate_id_idx; +} + +u8 phydm_rftype2rateid_ac40(void *dm_void, u8 rf_type) +{ + u8 rate_id_idx = 0; + + 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 if (rf_type == RF_3T3R) + rate_id_idx = PHYDM_ARFR4_AC_3SS; + else + rate_id_idx = PHYDM_ARFR6_AC_4SS; + return rate_id_idx; +} + +u8 phydm_rate_id_mapping(void *dm_void, u32 wireless_mode, u8 rf_type, u8 bw) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 rate_id_idx = 0; + + PHYDM_DBG(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 (phydm_BW == PHYDM_BW_40) { - - if (phydm_rf_type == PHYDM_RF_1T1R) - rate_id_idx = PHYDM_BGN_40M_1SS; - else if (phydm_rf_type == PHYDM_RF_2T2R) - rate_id_idx = PHYDM_BGN_40M_2SS; - else - rate_id_idx = PHYDM_ARFR5_N_3SS; - - } else { - - if (phydm_rf_type == PHYDM_RF_1T1R) - rate_id_idx = PHYDM_BGN_20M_1SS; - else if (phydm_rf_type == PHYDM_RF_2T2R) - rate_id_idx = PHYDM_BGN_20M_2SS; - else - rate_id_idx = PHYDM_ARFR5_N_3SS; - } - } - break; + if (bw == CHANNEL_WIDTH_40) + rate_id_idx = phydm_rftype2rateid_2g_n40(dm, rf_type); + else + rate_id_idx = phydm_rftype2rateid_2g_n20(dm, rf_type); + break; case PHYDM_WIRELESS_MODE_N_5G: - { - if (phydm_rf_type == PHYDM_RF_1T1R) - rate_id_idx = PHYDM_GN_N1SS; - else if (phydm_rf_type == PHYDM_RF_2T2R) - rate_id_idx = PHYDM_GN_N2SS; - else - rate_id_idx = PHYDM_ARFR5_N_3SS; - } - - break; + rate_id_idx = phydm_rftype2rateid_5g_n(dm, rf_type); + break; case PHYDM_WIRELESS_MODE_G: rate_id_idx = PHYDM_BG; @@ -1884,739 +1518,403 @@ phydm_rate_id_mapping( rate_id_idx = PHYDM_B_20M; break; - case PHYDM_WIRELESS_MODE_AC_5G: case PHYDM_WIRELESS_MODE_AC_ONLY: - { - if (phydm_rf_type == PHYDM_RF_1T1R) - rate_id_idx = PHYDM_ARFR1_AC_1SS; - else if (phydm_rf_type == PHYDM_RF_2T2R) - rate_id_idx = PHYDM_ARFR0_AC_2SS; - else - rate_id_idx = PHYDM_ARFR4_AC_3SS; - } - break; + rate_id_idx = phydm_rftype2rateid_ac80(dm, rf_type); + 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_rf_type == PHYDM_RF_1T1R) - rate_id_idx = PHYDM_ARFR1_AC_1SS; - else if (phydm_rf_type == PHYDM_RF_2T2R) - rate_id_idx = PHYDM_ARFR0_AC_2SS; - else - rate_id_idx = PHYDM_ARFR4_AC_3SS; - } else { - - if (phydm_rf_type == PHYDM_RF_1T1R) - rate_id_idx = PHYDM_ARFR2_AC_2G_1SS; - else if (phydm_rf_type == PHYDM_RF_2T2R) - rate_id_idx = PHYDM_ARFR3_AC_2G_2SS; - else - rate_id_idx = PHYDM_ARFR4_AC_3SS; - } - } - break; +/*@Becareful to set "Lowest rate" while using PHYDM_ARFR4_AC_3SS in 2.4G/5G*/ + if (bw >= CHANNEL_WIDTH_80) + rate_id_idx = phydm_rftype2rateid_ac80(dm, rf_type); + else + rate_id_idx = phydm_rftype2rateid_ac40(dm, rf_type); + break; default: rate_id_idx = 0; break; } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RA rate ID = (( 0x%x ))\n", rate_id_idx)); + PHYDM_DBG(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 -) +u8 phydm_rssi_lv_dec(void *dm_void, u32 rssi, u8 ratr_state) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u32 mask_rate_threshold; - u8 phydm_rf_type; - u8 phydm_BW; - u32 ratr_bitmap = *ratr_bitmap_lsb_in, ratr_bitmap_msb = *ratr_bitmap_msb_in; - /*struct _ODM_RATE_ADAPTIVE* p_ra = &(p_dm_odm->rate_adaptive);*/ + struct dm_struct *dm = (struct dm_struct *)dm_void; + /*@MCS0 ~ MCS4 , VHT1SS MCS0 ~ MCS4 , G 6M~24M*/ + u8 rssi_lv_t[RA_FLOOR_TABLE_SIZE] = {20, 34, 38, 42, 46, 50, 100}; + u8 new_rssi_lv = 0; + u8 i; -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - wireless_mode = phydm_trans_platform_wireless_mode(p_dm_odm, wireless_mode); -#endif - - phydm_rf_type = phydm_trans_platform_rf_type(p_dm_odm, rf_type); - phydm_BW = phydm_trans_platform_bw(p_dm_odm, BW); - - /*ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("phydm_rf_type = (( %x )), rf_type = (( %x ))\n", phydm_rf_type, rf_type));*/ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("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) - phydm_rf_type = PHYDM_RF_1T1R; - - if (phydm_rf_type == PHYDM_RF_1T1R) { - - if (phydm_BW == PHYDM_BW_40) - ratr_bitmap &= 0x000ff015; - else - ratr_bitmap &= 0x000ff005; - } else if (phydm_rf_type == PHYDM_RF_2T2R || phydm_rf_type == PHYDM_RF_2T4R || phydm_rf_type == 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_rf_type == PHYDM_RF_1T1R) - ratr_bitmap &= 0x003ff015; - else if (phydm_rf_type == PHYDM_RF_2T2R || phydm_rf_type == PHYDM_RF_2T4R || phydm_rf_type == 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_rf_type == PHYDM_RF_1T1R) - ratr_bitmap &= 0x003ff010; - else if (phydm_rf_type == PHYDM_RF_2T2R || phydm_rf_type == PHYDM_RF_2T4R || phydm_rf_type == 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 (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; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("wireless_mode= (( 0x%x )), rf_type = (( 0x%x )), BW = (( 0x%x )), MimoPs_en = (( %d )), tx_rate_level= (( 0x%x ))\n", - wireless_mode, phydm_rf_type, phydm_BW, mimo_ps_enable, tx_rate_level)); - - /*ODM_RT_TRACE(p_dm_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(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Phydm modified RA Mask = (( 0x %x | %x ))\n", *ratr_bitmap_msb_in, *ratr_bitmap_lsb_in)); - -} - -u8 -phydm_RA_level_decision( - void *p_dm_void, - u32 rssi, - u8 ratr_state -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 ra_lowest_rate; - u8 ra_rate_floor_table[RA_FLOOR_TABLE_SIZE] = {20, 34, 38, 42, 46, 50, 100}; /*MCS0 ~ MCS4 , VHT1SS MCS0 ~ MCS4 , G 6M~24M*/ - u8 new_ratr_state = 0; - u8 i; - - ODM_RT_TRACE(p_dm_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])); + PHYDM_DBG(dm, DBG_RA_MASK, + "curr RA level=(%d), Table_ori=[%d, %d, %d, %d, %d, %d]\n", + ratr_state, rssi_lv_t[0], rssi_lv_t[1], rssi_lv_t[2], + rssi_lv_t[3], rssi_lv_t[4], rssi_lv_t[5]); for (i = 0; i < RA_FLOOR_TABLE_SIZE; i++) { - if (i >= (ratr_state)) - ra_rate_floor_table[i] += RA_FLOOR_UP_GAP; + rssi_lv_t[i] += RA_FLOOR_UP_GAP; } - ODM_RT_TRACE(p_dm_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])); + PHYDM_DBG(dm, DBG_RA_MASK, + "RSSI=(%d), Table_mod=[%d, %d, %d, %d, %d, %d]\n", rssi, + rssi_lv_t[0], rssi_lv_t[1], rssi_lv_t[2], rssi_lv_t[3], + rssi_lv_t[4], rssi_lv_t[5]); for (i = 0; i < RA_FLOOR_TABLE_SIZE; i++) { - - if (rssi < ra_rate_floor_table[i]) { - new_ratr_state = i; + if (rssi < rssi_lv_t[i]) { + new_rssi_lv = i; break; } } - - - - return new_ratr_state; - + return new_rssi_lv; } -void -odm_refresh_rate_adaptive_mask_mp( - void *p_dm_void -) +enum phydm_qam_order phydm_get_ofdm_qam_order(void *dm_void, u8 rate_idx) { -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _rate_adaptive_table_ *p_ra_table = &p_dm_odm->dm_ra_table; - struct _ADAPTER *p_adapter = p_dm_odm->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); - u32 i; - struct sta_info *p_entry; - u8 ratr_state_new; + u8 tmp_idx = 0; + enum phydm_qam_order qam_order = PHYDM_QAM_BPSK; + enum phydm_qam_order qam[10] = {PHYDM_QAM_BPSK, PHYDM_QAM_QPSK, + PHYDM_QAM_QPSK, PHYDM_QAM_16QAM, + PHYDM_QAM_16QAM, PHYDM_QAM_64QAM, + PHYDM_QAM_64QAM, PHYDM_QAM_64QAM, + PHYDM_QAM_256QAM, PHYDM_QAM_256QAM}; - if (p_adapter->bDriverStopped) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_TRACE, ("<---- odm_refresh_rate_adaptive_mask(): driver is going to unload\n")); - return; - } + if (rate_idx <= ODM_RATE11M) + return PHYDM_QAM_CCK; - if (!p_hal_data->bUseRAMask) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("<---- odm_refresh_rate_adaptive_mask(): driver does not control rate adaptive mask\n")); - return; - } + if (rate_idx >= ODM_RATEVHTSS1MCS0) { + if (rate_idx >= ODM_RATEVHTSS4MCS0) + tmp_idx -= ODM_RATEVHTSS4MCS0; + else if (rate_idx >= ODM_RATEVHTSS3MCS0) + tmp_idx -= ODM_RATEVHTSS3MCS0; + else if (rate_idx >= ODM_RATEVHTSS2MCS0) + tmp_idx -= ODM_RATEVHTSS2MCS0; + else + tmp_idx -= ODM_RATEVHTSS1MCS0; - /* if default port is connected, update RA table for default port (infrastructure mode only) */ - if (p_mgnt_info->mAssoc && (!ACTING_AS_AP(p_adapter))) { - odm_refresh_ldpc_rts_mp(p_adapter, p_dm_odm, p_mgnt_info->mMacId, p_mgnt_info->IOTPeer, p_hal_data->UndecoratedSmoothedPWDB); - /*ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Infrasture mode\n"));*/ + qam_order = qam[tmp_idx]; + } else if (rate_idx >= ODM_RATEMCS0) { + if (rate_idx >= ODM_RATEMCS24) + tmp_idx -= ODM_RATEMCS24; + else if (rate_idx >= ODM_RATEMCS16) + tmp_idx -= ODM_RATEMCS16; + else if (rate_idx >= ODM_RATEMCS8) + tmp_idx -= ODM_RATEMCS8; + else + tmp_idx -= ODM_RATEMCS0; -#if RA_MASK_PHYDMLIZE_WIN - ratr_state_new = phydm_RA_level_decision(p_dm_odm, p_hal_data->UndecoratedSmoothedPWDB, p_mgnt_info->Ratr_State); - - if ((p_mgnt_info->Ratr_State != ratr_state_new) || (p_ra_table->force_update_ra_mask_count >= FORCED_UPDATE_RAMASK_PERIOD)) { - - p_ra_table->force_update_ra_mask_count = 0; - ODM_PRINT_ADDR(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target AP addr :"), p_mgnt_info->Bssid); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Update RA Level: ((%x)) -> ((%x)), RSSI = ((%d))\n\n", - p_mgnt_info->Ratr_State, ratr_state_new, p_hal_data->UndecoratedSmoothedPWDB)); - - p_mgnt_info->Ratr_State = ratr_state_new; - p_adapter->HalFunc.UpdateHalRAMaskHandler(p_adapter, p_mgnt_info->mMacId, NULL, ratr_state_new); - } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Stay in RA level = (( %d ))\n\n", ratr_state_new)); - /**/ - } - -#else - if (odm_ra_state_check(p_dm_odm, p_hal_data->UndecoratedSmoothedPWDB, p_mgnt_info->bSetTXPowerTrainingByOid, &p_mgnt_info->Ratr_State)) { - ODM_PRINT_ADDR(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target AP addr : "), p_mgnt_info->Bssid); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI:%d, RSSI_LEVEL:%d\n", p_hal_data->UndecoratedSmoothedPWDB, p_mgnt_info->Ratr_State)); - p_adapter->HalFunc.UpdateHalRAMaskHandler(p_adapter, p_mgnt_info->mMacId, NULL, p_mgnt_info->Ratr_State); - } else if (p_dm_odm->is_change_state) { - ODM_PRINT_ADDR(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target AP addr : "), p_mgnt_info->Bssid); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Change Power Training state, is_disable_power_training = %d\n", p_dm_odm->is_disable_power_training)); - p_adapter->HalFunc.UpdateHalRAMaskHandler(p_adapter, p_mgnt_info->mMacId, NULL, p_mgnt_info->Ratr_State); - } -#endif - } - - /* */ - /* 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_VALID(p_entry)) { - - odm_refresh_ldpc_rts_mp(p_adapter, p_dm_odm, p_entry->AssociatedMacId, p_entry->IOTPeer, p_entry->rssi_stat.undecorated_smoothed_pwdb); - -#if RA_MASK_PHYDMLIZE_WIN - ratr_state_new = phydm_RA_level_decision(p_dm_odm, p_entry->rssi_stat.undecorated_smoothed_pwdb, p_entry->Ratr_State); - - if ((p_entry->Ratr_State != ratr_state_new) || (p_ra_table->force_update_ra_mask_count >= FORCED_UPDATE_RAMASK_PERIOD)) { - - p_ra_table->force_update_ra_mask_count = 0; - ODM_PRINT_ADDR(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target AP addr :"), p_entry->MacAddr); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Update Tx RA Level: ((%x)) -> ((%x)), RSSI = ((%d))\n", - p_entry->Ratr_State, ratr_state_new, p_entry->rssi_stat.undecorated_smoothed_pwdb)); - - p_entry->Ratr_State = ratr_state_new; - p_adapter->HalFunc.UpdateHalRAMaskHandler(p_adapter, p_entry->AssociatedMacId, NULL, ratr_state_new); - } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Stay in RA level = (( %d ))\n\n", ratr_state_new)); - /**/ - } - - -#else - - if (odm_ra_state_check(p_dm_odm, p_entry->rssi_stat.undecorated_smoothed_pwdb, p_mgnt_info->bSetTXPowerTrainingByOid, &p_entry->Ratr_State)) { - ODM_PRINT_ADDR(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target STA addr : "), p_entry->mac_addr); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI:%d, RSSI_LEVEL:%d\n", p_entry->rssi_stat.undecorated_smoothed_pwdb, p_entry->Ratr_State)); - p_adapter->hal_func.update_hal_ra_mask_handler(p_target_adapter, p_entry->AssociatedMacId, p_entry, p_entry->Ratr_State); - } else if (p_dm_odm->is_change_state) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Change Power Training state, is_disable_power_training = %d\n", p_dm_odm->is_disable_power_training)); - p_adapter->HalFunc.UpdateHalRAMaskHandler(p_adapter, p_mgnt_info->mMacId, NULL, p_mgnt_info->Ratr_State); - } -#endif - - } - } - } - -#if RA_MASK_PHYDMLIZE_WIN - -#else - if (p_mgnt_info->bSetTXPowerTrainingByOid) - p_mgnt_info->bSetTXPowerTrainingByOid = false; -#endif -#endif /* #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) */ -} - - -void -odm_refresh_rate_adaptive_mask_ce( - void *p_dm_void -) -{ -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _rate_adaptive_table_ *p_ra_table = &p_dm_odm->dm_ra_table; - struct _ADAPTER *p_adapter = p_dm_odm->adapter; - struct _ODM_RATE_ADAPTIVE *p_ra = &p_dm_odm->rate_adaptive; - u32 i; - struct sta_info *p_entry; - u8 ratr_state_new; - - if (RTW_CANNOT_RUN(p_adapter)) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_TRACE, ("<---- odm_refresh_rate_adaptive_mask(): driver is going to unload\n")); - return; - } - - if (!p_dm_odm->is_use_ra_mask) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("<---- odm_refresh_rate_adaptive_mask(): driver does not control rate adaptive mask\n")); - return; - } - - for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { - - p_entry = p_dm_odm->p_odm_sta_info[i]; - - if (IS_STA_VALID(p_entry)) { - - if (IS_MCAST(p_entry->hwaddr)) - continue; - -#if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) - if ((p_dm_odm->support_ic_type == ODM_RTL8812) || (p_dm_odm->support_ic_type == ODM_RTL8821)) { - if (p_entry->rssi_stat.undecorated_smoothed_pwdb < p_ra->ldpc_thres) { - p_ra->is_use_ldpc = true; - p_ra->is_lower_rts_rate = true; - if ((p_dm_odm->support_ic_type == ODM_RTL8821) && (p_dm_odm->cut_version == ODM_CUT_A)) - set_ra_ldpc_8812(p_entry, true); - /* dbg_print("RSSI=%d, is_use_ldpc = true\n", p_hal_data->undecorated_smoothed_pwdb); */ - } else if (p_entry->rssi_stat.undecorated_smoothed_pwdb > (p_ra->ldpc_thres - 5)) { - p_ra->is_use_ldpc = false; - p_ra->is_lower_rts_rate = false; - if ((p_dm_odm->support_ic_type == ODM_RTL8821) && (p_dm_odm->cut_version == ODM_CUT_A)) - set_ra_ldpc_8812(p_entry, false); - /* dbg_print("RSSI=%d, is_use_ldpc = false\n", p_hal_data->undecorated_smoothed_pwdb); */ - } - } -#endif - -#if RA_MASK_PHYDMLIZE_CE - ratr_state_new = phydm_RA_level_decision(p_dm_odm, p_entry->rssi_stat.undecorated_smoothed_pwdb, p_entry->rssi_level); - - if ((p_entry->rssi_level != ratr_state_new) || (p_ra_table->force_update_ra_mask_count >= FORCED_UPDATE_RAMASK_PERIOD)) { - - p_ra_table->force_update_ra_mask_count = 0; - /*ODM_PRINT_ADDR(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target AP addr :"), pstat->hwaddr);*/ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Update Tx RA Level: ((%x)) -> ((%x)), RSSI = ((%d))\n", - p_entry->rssi_level, ratr_state_new, p_entry->rssi_stat.undecorated_smoothed_pwdb)); - - p_entry->rssi_level = ratr_state_new; - rtw_hal_update_ra_mask(p_entry, p_entry->rssi_level, _FALSE); - } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Stay in RA level = (( %d ))\n\n", ratr_state_new)); - /**/ - } -#else - if (true == odm_ra_state_check(p_dm_odm, p_entry->rssi_stat.undecorated_smoothed_pwdb, false, &p_entry->rssi_level)) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI:%d, RSSI_LEVEL:%d\n", p_entry->rssi_stat.undecorated_smoothed_pwdb, p_entry->rssi_level)); - /* printk("RSSI:%d, RSSI_LEVEL:%d\n", pstat->rssi_stat.undecorated_smoothed_pwdb, pstat->rssi_level); */ - rtw_hal_update_ra_mask(p_entry, p_entry->rssi_level, _FALSE); - } else if (p_dm_odm->is_change_state) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Change Power Training state, is_disable_power_training = %d\n", p_dm_odm->is_disable_power_training)); - rtw_hal_update_ra_mask(p_entry, p_entry->rssi_level, _FALSE); - } -#endif - - } - } - -#endif -} - -#if (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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - - if (p_dm_odm->support_ic_type == ODM_RTL8812) { - -#if (RTL8812A_SUPPORT == 1) - UpdateHalRAMask8812(priv, p_entry, rssi_level); - /**/ -#endif - } else if (p_dm_odm->support_ic_type == ODM_RTL8188E) { - -#if (RTL8188E_SUPPORT == 1) -#ifdef TXREPORT - add_RATid(priv, p_entry); - /**/ -#endif -#endif + qam_order = qam[tmp_idx]; } else { - -#ifdef CONFIG_WLAN_HAL - GET_HAL_INTERFACE(priv)->UpdateHalRAMaskHandler(priv, p_entry, rssi_level); -#endif - - } -} - -#endif - -void -odm_refresh_rate_adaptive_mask_apadsl( - void *p_dm_void -) -{ -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _rate_adaptive_table_ *p_ra_table = &p_dm_odm->dm_ra_table; - struct rtl8192cd_priv *priv = p_dm_odm->priv; - struct aid_obj *aidarray; - u32 i; - struct sta_info *p_entry; - u8 ratr_state_new; - - if (priv->up_time % 2) - return; - - for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { - p_entry = p_dm_odm->p_odm_sta_info[i]; - - if (IS_STA_VALID(p_entry)) { - -#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; - -#if RA_MASK_PHYDMLIZE_AP - ratr_state_new = phydm_RA_level_decision(p_dm_odm, (u32)p_entry->rssi, p_entry->rssi_level); - - if ((p_entry->rssi_level != ratr_state_new) || (p_ra_table->force_update_ra_mask_count >= FORCED_UPDATE_RAMASK_PERIOD)) { - - p_ra_table->force_update_ra_mask_count = 0; - ODM_PRINT_ADDR(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target AP addr :"), p_entry->hwaddr); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Update Tx RA Level: ((%x)) -> ((%x)), RSSI = ((%d))\n", p_entry->rssi_level, ratr_state_new, p_entry->rssi)); - - p_entry->rssi_level = ratr_state_new; - phydm_gen_ramask_h2c_AP(p_dm_odm, priv, p_entry, p_entry->rssi_level); - } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Stay in RA level = (( %d ))\n\n", ratr_state_new)); - /**/ - } - -#else - if (odm_ra_state_check(p_dm_odm, (s32)p_entry->rssi, false, &p_entry->rssi_level)) { - ODM_PRINT_ADDR(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target STA addr : "), p_entry->hwaddr); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI:%d, RSSI_LEVEL:%d\n", p_entry->rssi, p_entry->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)->update_hal_ra_mask_handler(priv, p_entry, p_entry->rssi_level); - } else -#endif - -#ifdef CONFIG_RTL_8812_SUPPORT - if (GET_CHIP_VER(priv) == VERSION_8812E) - update_hal_ra_mask8812(priv, p_entry, 3); - else -#endif - { -#ifdef CONFIG_RTL_88E_SUPPORT - if (GET_CHIP_VER(priv) == VERSION_8188E) { -#ifdef TXREPORT - add_ra_tid(priv, p_entry); -#endif - } -#endif - - - } - } -#endif /*#ifdef RA_MASK_PHYDMLIZE*/ - + if (rate_idx > ODM_RATE6M) { + tmp_idx -= ODM_RATE6M; + qam_order = qam[tmp_idx - 1]; + } else { + qam_order = PHYDM_QAM_BPSK; } } -#endif /*#if (DM_ODM_SUPPORT_TYPE & ODM_AP)*/ + + return qam_order; } -void -odm_refresh_basic_rate_mask( - void *p_dm_void -) +u8 phydm_rate_order_compute(void *dm_void, u8 rate_idx) { -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTER *adapter = p_dm_odm->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}; + u8 rate_order = rate_idx & 0x7f; - if (p_dm_odm->support_ic_type != ODM_RTL8812 && p_dm_odm->support_ic_type != ODM_RTL8821) - return; + rate_idx &= 0x7f; - if (p_dm_odm->is_linked == false) /* unlink Default port information */ - cur_stage = 0; - else if (p_dm_odm->rssi_min < 40) /* link RSSI < 40% */ - cur_stage = 1; - else if (p_dm_odm->rssi_min > 45) /* link RSSI > 45% */ - cur_stage = 3; + if (rate_idx >= ODM_RATEVHTSS4MCS0) + rate_order -= ODM_RATEVHTSS4MCS0; + else if (rate_idx >= ODM_RATEVHTSS3MCS0) + rate_order -= ODM_RATEVHTSS3MCS0; + else if (rate_idx >= ODM_RATEVHTSS2MCS0) + rate_order -= ODM_RATEVHTSS2MCS0; + else if (rate_idx >= ODM_RATEVHTSS1MCS0) + rate_order -= ODM_RATEVHTSS1MCS0; + else if (rate_idx >= ODM_RATEMCS24) + rate_order -= ODM_RATEMCS24; + else if (rate_idx >= ODM_RATEMCS16) + rate_order -= ODM_RATEMCS16; + else if (rate_idx >= ODM_RATEMCS8) + rate_order -= ODM_RATEMCS8; + else if (rate_idx >= ODM_RATEMCS0) + rate_order -= ODM_RATEMCS0; + else if (rate_idx >= ODM_RATE6M) + rate_order -= ODM_RATE6M; else - cur_stage = 2; /* link 25% <= RSSI <= 30% */ + rate_order -= ODM_RATE1M; - 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_odm, 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_odm, HW_VAR_BASIC_RATE, (u8 *)(&p_mgnt_info->mBrates)); - } - - stage = cur_stage; -#endif -} - -u8 -phydm_rate_order_compute( - void *p_dm_void, - u8 rate_idx -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - 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; + if (rate_idx >= ODM_RATEMCS0) + rate_order++; return rate_order; - } -void -phydm_ra_common_info_update( - void *p_dm_void -) +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) +u8 phydm_rate2ss(void *dm_void, u8 rate_idx) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _rate_adaptive_table_ *p_ra_table = &p_dm_odm->dm_ra_table; - 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_odm->number_linked_client != 0) { - for (macid = 0; macid < ODM_ASSOCIATE_ENTRY_NUM; macid++) { - - rate_order_tmp = phydm_rate_order_compute(p_dm_odm, ((p_ra_table->link_tx_rate[macid]) & 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_odm->number_linked_client) - break; - } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("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))); + u8 ret = 0xff; + u8 i, j; + u8 search_idx; + u32 ss_mapping_tab[4][3] = {{0x00000000, 0x003ff000, 0x000ff000}, + {0x00000000, 0xffc00000, 0x0ff00000}, + {0x000003ff, 0x0000000f, 0xf0000000}, + {0x000ffc00, 0x00000ff0, 0x00000000} }; + if (rate_idx < 32) { + search_idx = rate_idx; + j = 0; + } else if (rate_idx < 64) { + search_idx = rate_idx - 32; + j = 1; + } else { + search_idx = rate_idx - 64; + j = 2; } + for (i = 0; i < 4; i++) + if (ss_mapping_tab[i][j] & BIT(search_idx)) + ret = i; + return ret; } -void -phydm_ra_info_watchdog( - void *p_dm_void -) +u8 phydm_rate2plcp(void *dm_void, u8 rate_idx) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 rate2ss = 0; + u8 ltftime = 0; + u8 plcptime = 0xff; - phydm_ra_common_info_update(p_dm_odm); - phydm_ra_dynamic_retry_limit(p_dm_odm); - phydm_ra_dynamic_retry_count(p_dm_odm); - odm_refresh_rate_adaptive_mask(p_dm_odm); - odm_refresh_basic_rate_mask(p_dm_odm); + if (rate_idx < ODM_RATE6M) { + plcptime = 192; + /* @CCK PLCP = 192us (long preamble) */ + } else if (rate_idx < ODM_RATEMCS0) { + plcptime = 20; + /* @LegOFDM PLCP = 20us */ + } else { + if (rate_idx < ODM_RATEVHTSS1MCS0) + plcptime = 32; + /* @HT mode PLCP = 20us + 12us + 4us x Nss */ + else + plcptime = 36; + /* VHT mode PLCP = 20us + 16us + 4us x Nss */ + rate2ss = phydm_rate2ss(dm_void, rate_idx); + if (rate2ss != 0xff) + ltftime = (rate2ss + 1) * 4; + else + return 0xff; + + plcptime += ltftime; + } + return plcptime; } -void -phydm_ra_info_init( - void *p_dm_void -) +u8 phydm_get_plcp(void *dm_void, u16 macid) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _rate_adaptive_table_ *p_ra_table = &p_dm_odm->dm_ra_table; + u8 plcp_time = 0; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct cmn_sta_info *sta = NULL; + struct ra_sta_info *ra = NULL; - 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 (defined(CONFIG_RA_DYNAMIC_RTY_LIMIT)) - phydm_ra_dynamic_retry_limit_init(p_dm_odm); + sta = dm->phydm_sta_info[macid]; + ra = &sta->ra_info; + plcp_time = phydm_rate2plcp(dm, ra->curr_tx_rate); + return plcp_time; +} #endif -#if (defined(CONFIG_RA_DYNAMIC_RATE_ID)) - phydm_ra_dynamic_rate_id_init(p_dm_odm); -#endif -#if (defined(CONFIG_RA_DBG_CMD)) - odm_ra_para_adjust_init(p_dm_odm); -#endif +void phydm_ra_common_info_update(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ra_table *ra_tab = &dm->dm_ra_table; + struct cmn_sta_info *sta = NULL; + u16 macid; + u8 rate_order_tmp; + u8 rate_idx = 0; + u8 cnt = 0; + ra_tab->highest_client_tx_order = 0; + ra_tab->power_tracking_flag = 1; + + if (!dm->number_linked_client) + return; + + for (macid = 0; macid < ODM_ASSOCIATE_ENTRY_NUM; macid++) { + sta = dm->phydm_sta_info[macid]; + + if (!is_sta_active(sta)) + continue; + + rate_idx = sta->ra_info.curr_tx_rate & 0x7f; + rate_order_tmp = phydm_rate_order_compute(dm, rate_idx); + + if (rate_order_tmp >= ra_tab->highest_client_tx_order) { + ra_tab->highest_client_tx_order = rate_order_tmp; + ra_tab->highest_client_tx_rate_order = macid; + } + + cnt++; + + if (cnt == dm->number_linked_client) + break; + } + PHYDM_DBG(dm, DBG_RA, + "MACID[%d], Highest Tx order Update for power traking: %d\n", + ra_tab->highest_client_tx_rate_order, + ra_tab->highest_client_tx_order); } - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -u8 -odm_find_rts_rate( - void *p_dm_void, - u8 tx_rate, - bool is_erp_protect -) +void phydm_rrsr_set_register(void *dm_void, u32 rrsr_val) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 rts_ini_rate = ODM_RATE6M; + struct dm_struct *dm = (struct dm_struct *)dm_void; - if (is_erp_protect) /* use CCK rate as RTS*/ + odm_set_mac_reg(dm, R_0x440, 0xfffff, rrsr_val); +} + +void phydm_masked_rrsr_set_register(void *dm_void, u32 rrsr_val) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ra_table *ra_tab = &dm->dm_ra_table; + + if (ra_tab->rrsr_val_curr == rrsr_val) + return; + + ra_tab->rrsr_val_curr = rrsr_val; + odm_set_mac_reg(dm, R_0x440, 0xfffff, rrsr_val); +} + +void phydm_rrsr_mask(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ra_table *ra = &dm->dm_ra_table; + struct cmn_sta_info *sta = NULL; + u8 rate_order = 0; + u8 rate_order_min = 0xff; + u32 rrsr_mask = 0, rrsr_mask_ofdm = 0; + u8 tx_rate_idx = 0; + u8 i = 0, sta_cnt = 0; + + if (!ra->dynamic_rrsr_en) + return; + + if (!dm->is_linked) { + phydm_masked_rrsr_set_register(dm, ra->rrsr_val_init); + return; + } + +#if 1 + for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { + sta = dm->phydm_sta_info[i]; + if (!is_sta_active(sta)) + continue; + + sta_cnt++; + tx_rate_idx = sta->ra_info.curr_tx_rate & 0x7f; + rate_order = phydm_rate_order_compute(dm, tx_rate_idx); + if (rate_order < rate_order_min) + rate_order_min = rate_order; + + if (sta_cnt == dm->number_linked_client) + break; + } +#else + sta = dm->phydm_sta_info[dm->rssi_min_macid]; + + if (!is_sta_active(sta)) { + PHYDM_DBG(dm, DBG_DYN_ARFR, "[Warning] %s invalid STA\n", + __func__); + return; + } + + rate_order = phydm_rate_order_compute(dm, sta->ra_info.curr_tx_rate); +#endif + if (rate_order_min == 0) { + rrsr_mask = 0x1f; + } else { + rrsr_mask_ofdm = (u32)phydm_gen_bitmask(rate_order_min); + rrsr_mask = (rrsr_mask_ofdm << 4) | 0xf; + } + + /*ra->rrsr_val_init = 0x15d;*/ + + phydm_masked_rrsr_set_register(dm, ra->rrsr_val_init & rrsr_mask); + + PHYDM_DBG(dm, DBG_DYN_ARFR, + "tx{rate, rate_order_min}={0x%x, %d}, rrsr_init=0x%x, ofdm_rrsr_mask=0x%x, rrsr_val=0x%x\n", + tx_rate_idx, rate_order_min, ra->rrsr_val_init, + rrsr_mask, ra->rrsr_val_curr); +} + +void phydm_ra_info_watchdog(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + phydm_ra_common_info_update(dm); + phydm_ra_dynamic_retry_count(dm); + phydm_rrsr_mask(dm); + phydm_ra_mask_watchdog(dm); + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + odm_refresh_basic_rate_mask(dm); +#endif +} + +void phydm_rrsr_en(void *dm_void, boolean en_rrsr) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ra_table *ra_tab = &dm->dm_ra_table; + + ra_tab->dynamic_rrsr_en = en_rrsr; +} + +void phydm_ra_info_init(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ra_table *ra_tab = &dm->dm_ra_table; + + ra_tab->highest_client_tx_rate_order = 0; + ra_tab->highest_client_tx_order = 0; + ra_tab->ra_th_ofst = 0; + ra_tab->ra_ofst_direc = 0; + ra_tab->rrsr_val_init = odm_get_mac_reg(dm, R_0x440, MASKDWORD); + ra_tab->dynamic_rrsr_en = true; + +#if (RTL8822B_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8822B) { + u32 ret_value; + + ret_value = odm_get_bb_reg(dm, R_0x4c8, MASKBYTE2); + odm_set_bb_reg(dm, R_0x4cc, MASKBYTE3, (ret_value - 1)); + } +#endif + + #if 0 /*@CONFIG_RA_DYNAMIC_RTY_LIMIT*/ + phydm_ra_dynamic_retry_limit_init(dm); + #endif + + #if 0 /*@CONFIG_RA_DYNAMIC_RATE_ID*/ + phydm_ra_dynamic_rate_id_init(dm); + #endif + + phydm_rate_adaptive_mask_init(dm); +} + +u8 odm_find_rts_rate(void *dm_void, u8 tx_rate, boolean is_erp_protect) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 rts_ini_rate = ODM_RATE6M; + + if (is_erp_protect) { /* use CCK rate as RTS*/ rts_ini_rate = ODM_RATE1M; - else { + } else { switch (tx_rate) { + case ODM_RATEVHTSS4MCS9: + case ODM_RATEVHTSS4MCS8: + case ODM_RATEVHTSS4MCS7: + case ODM_RATEVHTSS4MCS6: + case ODM_RATEVHTSS4MCS5: + case ODM_RATEVHTSS4MCS4: + case ODM_RATEVHTSS4MCS3: case ODM_RATEVHTSS3MCS9: case ODM_RATEVHTSS3MCS8: case ODM_RATEVHTSS3MCS7: @@ -2638,6 +1936,16 @@ odm_find_rts_rate( case ODM_RATEVHTSS1MCS5: case ODM_RATEVHTSS1MCS4: case ODM_RATEVHTSS1MCS3: + case ODM_RATEMCS31: + case ODM_RATEMCS30: + case ODM_RATEMCS29: + case ODM_RATEMCS28: + case ODM_RATEMCS27: + case ODM_RATEMCS23: + case ODM_RATEMCS22: + case ODM_RATEMCS21: + case ODM_RATEMCS20: + case ODM_RATEMCS19: case ODM_RATEMCS15: case ODM_RATEMCS14: case ODM_RATEMCS13: @@ -2654,12 +1962,18 @@ odm_find_rts_rate( case ODM_RATE24M: rts_ini_rate = ODM_RATE24M; break; + case ODM_RATEVHTSS4MCS2: + case ODM_RATEVHTSS4MCS1: case ODM_RATEVHTSS3MCS2: case ODM_RATEVHTSS3MCS1: case ODM_RATEVHTSS2MCS2: case ODM_RATEVHTSS2MCS1: case ODM_RATEVHTSS1MCS2: case ODM_RATEVHTSS1MCS1: + case ODM_RATEMCS26: + case ODM_RATEMCS25: + case ODM_RATEMCS18: + case ODM_RATEMCS17: case ODM_RATEMCS10: case ODM_RATEMCS9: case ODM_RATEMCS2: @@ -2668,9 +1982,12 @@ odm_find_rts_rate( case ODM_RATE12M: rts_ini_rate = ODM_RATE12M; break; + case ODM_RATEVHTSS4MCS0: case ODM_RATEVHTSS3MCS0: case ODM_RATEVHTSS2MCS0: case ODM_RATEVHTSS1MCS0: + case ODM_RATEMCS24: + case ODM_RATEMCS16: case ODM_RATEMCS8: case ODM_RATEMCS0: case ODM_RATE9M: @@ -2689,741 +2006,260 @@ odm_find_rts_rate( } } - if (*p_dm_odm->p_band_type == 1) { + if (*dm->band_type == ODM_BAND_5G) { if (rts_ini_rate < ODM_RATE6M) rts_ini_rate = ODM_RATE6M; } return rts_ini_rate; - } -void -odm_set_ra_dm_arfb_by_noisy( - struct PHY_DM_STRUCT *p_dm_odm -) -{ -#if 0 +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + +void odm_refresh_basic_rate_mask( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + void *adapter = dm->adapter; + static u8 stage = 0; + u8 cur_stage = 0; + OCTET_STRING os_rate_set; + PMGNT_INFO mgnt_info = GetDefaultMgntInfo(((PADAPTER)adapter)); + u8 rate_set[5] = {MGN_1M, MGN_2M, MGN_5_5M, MGN_11M, MGN_6M}; + + if (dm->support_ic_type != ODM_RTL8812 && dm->support_ic_type != ODM_RTL8821) + return; + + if (dm->is_linked == false) /* unlink Default port information */ + cur_stage = 0; + else if (dm->rssi_min < 40) /* @link RSSI < 40% */ + cur_stage = 1; + else if (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(mgnt_info->mBrates, &os_rate_set, false); + phydm_set_hw_reg_handler_interface(dm, HW_VAR_BASIC_RATE, (u8 *)&os_rate_set); + } else if (cur_stage == 3 && (stage == 1 || stage == 2)) + phydm_set_hw_reg_handler_interface(dm, HW_VAR_BASIC_RATE, (u8 *)(&mgnt_info->mBrates)); + } + + stage = cur_stage; +} + +#endif + +#if 0 /*@CONFIG_RA_DYNAMIC_RTY_LIMIT*/ + +void phydm_retry_limit_table_bound( + void *dm_void, + u8 *retry_limit, + u8 offset) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ra_table *ra_tab = &dm->dm_ra_table; + + if (*retry_limit > offset) { + *retry_limit -= offset; + + if (*retry_limit < ra_tab->retrylimit_low) + *retry_limit = ra_tab->retrylimit_low; + else if (*retry_limit > ra_tab->retrylimit_high) + *retry_limit = ra_tab->retrylimit_high; + } else + *retry_limit = ra_tab->retrylimit_low; +} + +void phydm_reset_retry_limit_table( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ra_table *ra_t = &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(&ra_t->per_rate_retrylimit_20M[0], + &per_rate_retrylimit_table_20M[0], PHY_NUM_RATE_IDX); + memcpy(&ra_t->per_rate_retrylimit_40M[0], + &per_rate_retrylimit_table_40M[0], PHY_NUM_RATE_IDX); + + for (i = 0; i < PHY_NUM_RATE_IDX; i++) { + phydm_retry_limit_table_bound(dm, + &ra_t->per_rate_retrylimit_20M[i], + 0); + phydm_retry_limit_table_bound(dm, + &ra_t->per_rate_retrylimit_40M[i], + 0); + } +} + +void phydm_ra_dynamic_retry_limit_init( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ra_table *ra_tab = &dm->dm_ra_table; + + ra_tab->retry_descend_num = RA_RETRY_DESCEND_NUM; + ra_tab->retrylimit_low = RA_RETRY_LIMIT_LOW; + ra_tab->retrylimit_high = RA_RETRY_LIMIT_HIGH; + + phydm_reset_retry_limit_table(dm); +} + +void phydm_ra_dynamic_retry_limit( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ra_table *ra_tab = &dm->dm_ra_table; + u8 i, retry_offset; + u32 ma_rx_tp; + + if (dm->pre_number_active_client == dm->number_active_client) { + PHYDM_DBG(dm, DBG_RA, + "pre_number_active_client == number_active_client\n"); + return; - /*dbg_print("DM_ARFB ====>\n");*/ - if (p_dm_odm->is_noisy_state) { - odm_write_4byte(p_dm_odm, 0x430, 0x00000000); - odm_write_4byte(p_dm_odm, 0x434, 0x05040200); - /*dbg_print("DM_ARFB ====> Noisy state\n");*/ } else { - odm_write_4byte(p_dm_odm, 0x430, 0x02010000); - odm_write_4byte(p_dm_odm, 0x434, 0x07050403); - /*dbg_print("DM_ARFB ====> Clean state\n");*/ - } -#endif -} - -void -odm_update_noisy_state( - void *p_dm_void, - bool is_noisy_state_from_c2h -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - - /*dbg_print("Get C2H Command! NoisyState=0x%x\n ", is_noisy_state_from_c2h);*/ - if (p_dm_odm->support_ic_type == ODM_RTL8821 || p_dm_odm->support_ic_type == ODM_RTL8812 || - p_dm_odm->support_ic_type == ODM_RTL8723B || p_dm_odm->support_ic_type == ODM_RTL8192E || p_dm_odm->support_ic_type == ODM_RTL8188E || p_dm_odm->support_ic_type == ODM_RTL8723D) - p_dm_odm->is_noisy_state = is_noisy_state_from_c2h; - odm_set_ra_dm_arfb_by_noisy(p_dm_odm); -}; - -void -phydm_update_pwr_track( - void *p_dm_void, - u8 rate -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 path_idx = 0; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("Pwr Track Get rate=0x%x\n", rate)); - - p_dm_odm->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_odm->ra_rpt_workitem); -#else - if (p_dm_odm->support_ic_type == ODM_RTL8821) { -#if (RTL8821A_SUPPORT == 1) - odm_tx_pwr_track_set_pwr8821a(p_dm_odm, MIX_MODE, ODM_RF_PATH_A, 0); -#endif - } else if (p_dm_odm->support_ic_type == ODM_RTL8812) { - for (path_idx = ODM_RF_PATH_A; path_idx < MAX_PATH_NUM_8812A; path_idx++) { -#if (RTL8812A_SUPPORT == 1) - odm_tx_pwr_track_set_pwr8812a(p_dm_odm, MIX_MODE, path_idx, 0); -#endif - } - } else if (p_dm_odm->support_ic_type == ODM_RTL8723B) { -#if (RTL8723B_SUPPORT == 1) - odm_tx_pwr_track_set_pwr_8723b(p_dm_odm, MIX_MODE, ODM_RF_PATH_A, 0); -#endif - } else if (p_dm_odm->support_ic_type == ODM_RTL8192E) { - for (path_idx = ODM_RF_PATH_A; path_idx < MAX_PATH_NUM_8192E; path_idx++) { -#if (RTL8192E_SUPPORT == 1) - odm_tx_pwr_track_set_pwr92_e(p_dm_odm, MIX_MODE, path_idx, 0); -#endif - } - } else if (p_dm_odm->support_ic_type == ODM_RTL8188E) { -#if (RTL8188E_SUPPORT == 1) - odm_tx_pwr_track_set_pwr88_e(p_dm_odm, MIX_MODE, ODM_RF_PATH_A, 0); -#endif - } -#endif -#else - odm_schedule_work_item(&p_dm_odm->ra_rpt_workitem); -#endif -#endif - -} - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - -s32 -phydm_find_minimum_rssi( - struct PHY_DM_STRUCT *p_dm_odm, - struct _ADAPTER *p_adapter, - OUT bool *p_is_link_temp - -) -{ - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); - PMGNT_INFO p_mgnt_info = &(p_adapter->MgntInfo); - bool 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; - /**/ + if (dm->number_active_client == 1) { + phydm_reset_retry_limit_table(dm); + PHYDM_DBG(dm, DBG_RA, + "one client only->reset to default value\n"); } else { - p_hal_data->MinUndecoratedPWDBForDM = p_hal_data->UndecoratedSmoothedPWDB; - /**/ + retry_offset = dm->number_active_client * ra_tab->retry_descend_num; + + for (i = 0; i < PHY_NUM_RATE_IDX; i++) { + phydm_retry_limit_table_bound(dm, + &ra_tab->per_rate_retrylimit_20M[i], + retry_offset); + phydm_retry_limit_table_bound(dm, + &ra_tab->per_rate_retrylimit_40M[i], + retry_offset); + } } - } else { /* associated entry pwdb*/ - p_hal_data->MinUndecoratedPWDBForDM = p_hal_data->EntryMinUndecoratedSmoothedPWDB; - /**/ } - - return p_hal_data->MinUndecoratedPWDBForDM; } +#endif -void -odm_update_init_rate_work_item_callback( - void *p_context -) +#if 0 /*@CONFIG_RA_DYNAMIC_RATE_ID*/ +void phydm_ra_dynamic_rate_id_on_assoc( + void *dm_void, + u8 wireless_mode, + u8 init_rate_id) { - struct _ADAPTER *adapter = (struct _ADAPTER *)p_context; - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; - u8 p = 0; + struct dm_struct *dm = (struct dm_struct *)dm_void; - if (p_dm_odm->support_ic_type == ODM_RTL8821) { - odm_tx_pwr_track_set_pwr8821a(p_dm_odm, MIX_MODE, ODM_RF_PATH_A, 0); - /**/ - } else if (p_dm_odm->support_ic_type == ODM_RTL8812) { - for (p = ODM_RF_PATH_A; p < MAX_PATH_NUM_8812A; p++) { /*DOn't know how to include &c*/ + PHYDM_DBG(dm, DBG_RA, + "[ON ASSOC] rf_mode = ((0x%x)), wireless_mode = ((0x%x)), init_rate_id = ((0x%x))\n", + dm->rf_type, wireless_mode, init_rate_id); - odm_tx_pwr_track_set_pwr8812a(p_dm_odm, MIX_MODE, p, 0); - /**/ + if (dm->rf_type == RF_2T2R || dm->rf_type == RF_2T3R || dm->rf_type == RF_2T4R) { + if ((dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8192E)) && + (wireless_mode & (ODM_WM_N24G | ODM_WM_N5G))) { + PHYDM_DBG(dm, DBG_RA, + "[ON ASSOC] set N-2SS ARFR5 table\n"); + odm_set_mac_reg(dm, R_0x4a4, MASKDWORD, 0xfc1ffff); /*N-2SS, ARFR5, rate_id = 0xe*/ + odm_set_mac_reg(dm, R_0x4a8, MASKDWORD, 0x0); /*N-2SS, ARFR5, rate_id = 0xe*/ + } else if ((dm->support_ic_type & (ODM_RTL8812)) && + (wireless_mode & (ODM_WM_AC_5G | ODM_WM_AC_24G | ODM_WM_AC_ONLY))) { + PHYDM_DBG(dm, DBG_RA, + "[ON ASSOC] set AC-2SS ARFR0 table\n"); + odm_set_mac_reg(dm, R_0x444, MASKDWORD, 0x0fff); /*@AC-2SS, ARFR0, rate_id = 0x9*/ + odm_set_mac_reg(dm, R_0x448, MASKDWORD, 0xff01f000); /*@AC-2SS, ARFR0, rate_id = 0x9*/ } - } else if (p_dm_odm->support_ic_type == ODM_RTL8723B) { - odm_tx_pwr_track_set_pwr_8723b(p_dm_odm, MIX_MODE, ODM_RF_PATH_A, 0); - /**/ - } else if (p_dm_odm->support_ic_type == ODM_RTL8192E) { - for (p = ODM_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_odm, MIX_MODE, p, 0); - /**/ - } - } else if (p_dm_odm->support_ic_type == ODM_RTL8188E) { - odm_tx_pwr_track_set_pwr88_e(p_dm_odm, MIX_MODE, ODM_RF_PATH_A, 0); - /**/ } } -void -odm_rssi_dump_to_register( - void *p_dm_void -) +void phydm_ra_dynamic_rate_id_init( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTER *adapter = p_dm_odm->adapter; + struct dm_struct *dm = (struct dm_struct *)dm_void; - if (p_dm_odm->support_ic_type == ODM_RTL8812) { - PlatformEFIOWrite1Byte(adapter, REG_A_RSSI_DUMP_JAGUAR, adapter->RxStats.RxRSSIPercentage[0]); - PlatformEFIOWrite1Byte(adapter, REG_B_RSSI_DUMP_JAGUAR, adapter->RxStats.RxRSSIPercentage[1]); + if (dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8192E)) { + odm_set_mac_reg(dm, R_0x4a4, MASKDWORD, 0xfc1ffff); /*N-2SS, ARFR5, rate_id = 0xe*/ + odm_set_mac_reg(dm, R_0x4a8, MASKDWORD, 0x0); /*N-2SS, ARFR5, rate_id = 0xe*/ - /* Rx EVM*/ - PlatformEFIOWrite1Byte(adapter, REG_S1_RXEVM_DUMP_JAGUAR, adapter->RxStats.RxEVMdbm[0]); - PlatformEFIOWrite1Byte(adapter, REG_S2_RXEVM_DUMP_JAGUAR, adapter->RxStats.RxEVMdbm[1]); - - /* Rx SNR*/ - PlatformEFIOWrite1Byte(adapter, REG_A_RX_SNR_DUMP_JAGUAR, (u8)(adapter->RxStats.RxSNRdB[0])); - PlatformEFIOWrite1Byte(adapter, REG_B_RX_SNR_DUMP_JAGUAR, (u8)(adapter->RxStats.RxSNRdB[1])); - - /* Rx Cfo_Short*/ - PlatformEFIOWrite2Byte(adapter, REG_A_CFO_SHORT_DUMP_JAGUAR, adapter->RxStats.RxCfoShort[0]); - PlatformEFIOWrite2Byte(adapter, REG_B_CFO_SHORT_DUMP_JAGUAR, adapter->RxStats.RxCfoShort[1]); - - /* Rx Cfo_Tail*/ - PlatformEFIOWrite2Byte(adapter, REG_A_CFO_LONG_DUMP_JAGUAR, adapter->RxStats.RxCfoTail[0]); - PlatformEFIOWrite2Byte(adapter, REG_B_CFO_LONG_DUMP_JAGUAR, adapter->RxStats.RxCfoTail[1]); - } else if (p_dm_odm->support_ic_type == ODM_RTL8192E) { - PlatformEFIOWrite1Byte(adapter, REG_A_RSSI_DUMP_92E, adapter->RxStats.RxRSSIPercentage[0]); - PlatformEFIOWrite1Byte(adapter, REG_B_RSSI_DUMP_92E, adapter->RxStats.RxRSSIPercentage[1]); - /* Rx EVM*/ - PlatformEFIOWrite1Byte(adapter, REG_S1_RXEVM_DUMP_92E, adapter->RxStats.RxEVMdbm[0]); - PlatformEFIOWrite1Byte(adapter, REG_S2_RXEVM_DUMP_92E, adapter->RxStats.RxEVMdbm[1]); - /* Rx SNR*/ - PlatformEFIOWrite1Byte(adapter, REG_A_RX_SNR_DUMP_92E, (u8)(adapter->RxStats.RxSNRdB[0])); - PlatformEFIOWrite1Byte(adapter, REG_B_RX_SNR_DUMP_92E, (u8)(adapter->RxStats.RxSNRdB[1])); - /* Rx Cfo_Short*/ - PlatformEFIOWrite2Byte(adapter, REG_A_CFO_SHORT_DUMP_92E, adapter->RxStats.RxCfoShort[0]); - PlatformEFIOWrite2Byte(adapter, REG_B_CFO_SHORT_DUMP_92E, adapter->RxStats.RxCfoShort[1]); - /* Rx Cfo_Tail*/ - PlatformEFIOWrite2Byte(adapter, REG_A_CFO_LONG_DUMP_92E, adapter->RxStats.RxCfoTail[0]); - PlatformEFIOWrite2Byte(adapter, REG_B_CFO_LONG_DUMP_92E, adapter->RxStats.RxCfoTail[1]); + odm_set_mac_reg(dm, R_0x444, MASKDWORD, 0x0fff); /*@AC-2SS, ARFR0, rate_id = 0x9*/ + odm_set_mac_reg(dm, R_0x448, MASKDWORD, 0xff01f000); /*@AC-2SS, ARFR0, rate_id = 0x9*/ } } -void -odm_refresh_ldpc_rts_mp( - struct _ADAPTER *p_adapter, - struct PHY_DM_STRUCT *p_dm_odm, - u8 m_mac_id, - u8 iot_peer, - s32 undecorated_smoothed_pwdb -) +void phydm_update_rate_id( + void *dm_void, + u8 rate, + u8 platform_macid) { - bool is_ctl_ldpc = false; - struct _ODM_RATE_ADAPTIVE *p_ra = &p_dm_odm->rate_adaptive; +#if 0 - if (p_dm_odm->support_ic_type != ODM_RTL8821 && p_dm_odm->support_ic_type != ODM_RTL8812) - return; - - if ((p_dm_odm->support_ic_type == ODM_RTL8821) && (p_dm_odm->cut_version == ODM_CUT_A)) - is_ctl_ldpc = true; - else if (p_dm_odm->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->ldpc_thres - 5)) - MgntSet_TX_LDPC(p_adapter, m_mac_id, true); - else if (undecorated_smoothed_pwdb > p_ra->ldpc_thres) - MgntSet_TX_LDPC(p_adapter, m_mac_id, false); - } - - if (undecorated_smoothed_pwdb < (p_ra->rts_thres - 5)) - p_ra->is_lower_rts_rate = true; - else if (undecorated_smoothed_pwdb > p_ra->rts_thres) - p_ra->is_lower_rts_rate = false; -} + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ra_table *ra_tab = &dm->dm_ra_table; + u8 current_tx_ss; + u8 rate_idx = rate & 0x7f; /*remove bit7 SGI*/ + enum wireless_set wireless_set; + u8 phydm_macid; + struct cmn_sta_info *sta; #if 0 -void -odm_dynamic_arfb_select( - void *p_dm_void, - u8 rate, - bool collision_state -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _rate_adaptive_table_ *p_ra_table = &p_dm_odm->dm_ra_table; - - if (p_dm_odm->support_ic_type != ODM_RTL8192E) - return; - - if (collision_state == p_ra_table->PT_collision_pre) - return; - - if (rate >= DESC_RATEMCS8 && rate <= DESC_RATEMCS12) { - if (collision_state == 1) { - if (rate == DESC_RATEMCS12) { - - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E, 0x0); - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E+4, 0x07060501); - } else if (rate == DESC_RATEMCS11) { - - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E, 0x0); - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E+4, 0x07070605); - } else if (rate == DESC_RATEMCS10) { - - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E, 0x0); - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E+4, 0x08080706); - } else if (rate == DESC_RATEMCS9) { - - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E, 0x0); - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E+4, 0x08080707); - } else { - - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E, 0x0); - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E+4, 0x09090808); - } - } else { /* collision_state == 0*/ - if (rate == DESC_RATEMCS12) { - - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E, 0x05010000); - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E+4, 0x09080706); - } else if (rate == DESC_RATEMCS11) { - - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E, 0x06050000); - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E+4, 0x09080807); - } else if (rate == DESC_RATEMCS10) { - - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E, 0x07060000); - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E+4, 0x0a090908); - } else if (rate == DESC_RATEMCS9) { - - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E, 0x07070000); - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E+4, 0x0a090808); - } else { - - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E, 0x08080000); - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E+4, 0x0b0a0909); - } - } - } else { /* MCS13~MCS15, 1SS, G-mode*/ - if (collision_state == 1) { - if (rate == DESC_RATEMCS15) { - - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E, 0x00000000); - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E+4, 0x05040302); - } else if (rate == DESC_RATEMCS14) { - - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E, 0x00000000); - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E+4, 0x06050302); - } else if (rate == DESC_RATEMCS13) { - - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E, 0x00000000); - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E+4, 0x07060502); - } else { - - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E, 0x00000000); - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E+4, 0x06050402); - } - } else { /* collision_state == 0 */ - if (rate == DESC_RATEMCS15) { - - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E, 0x03020000); - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E+4, 0x07060504); - } else if (rate == DESC_RATEMCS14) { - - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E, 0x03020000); - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E+4, 0x08070605); - } else if (rate == DESC_RATEMCS13) { - - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E, 0x05020000); - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E+4, 0x09080706); - } else { - - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E, 0x04020000); - odm_write_4byte(p_dm_odm, REG_DARFRC_8192E+4, 0x08070605); - } - } + if (rate_idx >= ODM_RATEVHTSS2MCS0) { + PHYDM_DBG(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(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(dm, DBG_RA, "rate[%d]: (( HT-MCS%d ))\n", + platform_macid, (rate_idx - ODM_RATEMCS0)); + /*@dummy for SD4 check patch*/ + } else { + PHYDM_DBG(dm, DBG_RA, "rate[%d]: (( HT-MCS%d ))\n", + platform_macid, rate_idx); + /*@dummy for SD4 check patch*/ } - p_ra_table->PT_collision_pre = collision_state; -} #endif -void -odm_rate_adaptive_state_ap_init( - void *PADAPTER_VOID, - struct sta_info *p_entry -) -{ - struct _ADAPTER *adapter = (struct _ADAPTER *)PADAPTER_VOID; - p_entry->Ratr_State = DM_RATR_STA_INIT; -} -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) /*#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ + phydm_macid = dm->phydm_macid_table[platform_macid]; + sta = dm->phydm_sta_info[phydm_macid]; -static void -find_minimum_rssi( - struct _ADAPTER *p_adapter -) -{ - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); - struct PHY_DM_STRUCT *p_dm_odm = &(p_hal_data->odmpriv); + if (is_sta_active(sta)) { + wireless_set = sta->support_wireless_set; - /*Determine the minimum RSSI*/ + if (dm->rf_type == RF_2T2R || dm->rf_type == RF_2T3R || dm->rf_type == RF_2T4R) { + if (wireless_set & WIRELESS_HT) { /*N mode*/ + if (rate_idx >= ODM_RATEMCS8 && rate_idx <= ODM_RATEMCS15) { /*@2SS mode*/ - if ((p_dm_odm->is_linked != _TRUE) && - (p_hal_data->entry_min_undecorated_smoothed_pwdb == 0)) { - p_hal_data->min_undecorated_pwdb_for_dm = 0; - /*ODM_RT_TRACE(p_dm_odm,COMP_BB_POWERSAVING, DBG_LOUD, ("Not connected to any\n"));*/ - } else - p_hal_data->min_undecorated_pwdb_for_dm = p_hal_data->entry_min_undecorated_smoothed_pwdb; + sta->ra_info.rate_id = ARFR_5_RATE_ID; + PHYDM_DBG(dm, DBG_RA, "ARFR_5\n"); + } + } else if (wireless_set & WIRELESS_VHT) {/*@AC mode*/ + if (rate_idx >= ODM_RATEVHTSS2MCS0 && rate_idx <= ODM_RATEVHTSS2MCS9) {/*@2SS mode*/ - /*DBG_8192C("%s=>min_undecorated_pwdb_for_dm(%d)\n",__FUNCTION__,pdmpriv->min_undecorated_pwdb_for_dm);*/ - /*ODM_RT_TRACE(p_dm_odm,COMP_DIG, DBG_LOUD, ("min_undecorated_pwdb_for_dm =%d\n",p_hal_data->min_undecorated_pwdb_for_dm));*/ -} + sta->ra_info.rate_id = ARFR_0_RATE_ID; + PHYDM_DBG(dm, DBG_RA, "ARFR_0\n"); + } + } else + sta->ra_info.rate_id = ARFR_0_RATE_ID; -u64 -phydm_get_rate_bitmap_ex( - void *p_dm_void, - u32 macid, - u64 ra_mask, - u8 rssi_level, - u64 *dm_ra_mask, - u8 *dm_rte_id -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct sta_info *p_entry; - u64 rate_bitmap = 0; - u8 wireless_mode; - - p_entry = p_dm_odm->p_odm_sta_info[macid]; - if (!IS_STA_VALID(p_entry)) - return ra_mask; - wireless_mode = p_entry->wireless_mode; - switch (wireless_mode) { - 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 (p_dm_odm->rf_type == ODM_1T2R || p_dm_odm->rf_type == 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 (*(p_dm_odm->p_band_width) == ODM_BW40M) - rate_bitmap = 0x00000000000ff015; - else - rate_bitmap = 0x00000000000ff005; - } - } else if (p_dm_odm->rf_type == ODM_2T2R || p_dm_odm->rf_type == ODM_2T3R || p_dm_odm->rf_type == 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 (*(p_dm_odm->p_band_width) == 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 (*(p_dm_odm->p_band_width) == ODM_BW40M) - rate_bitmap = 0x0000000ffffff015; - else - rate_bitmap = 0x0000000ffffff005; - } + PHYDM_DBG(dm, DBG_RA, "UPdate_RateID[%d]: (( 0x%x ))\n", + platform_macid, sta->ra_info.rate_id); } } - 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 (p_dm_odm->rf_type == ODM_1T2R || p_dm_odm->rf_type == 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 (p_dm_odm->rf_type == ODM_2T2R || p_dm_odm->rf_type == ODM_2T3R || p_dm_odm->rf_type == 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 (p_dm_odm->rf_type == ODM_1T2R || p_dm_odm->rf_type == ODM_1T1R) - rate_bitmap = 0x00000000000fffff; - else if (p_dm_odm->rf_type == ODM_2T2R || p_dm_odm->rf_type == ODM_2T3R || p_dm_odm->rf_type == ODM_2T4R) - rate_bitmap = 0x000000000fffffff; - else - rate_bitmap = 0x0000003fffffffffULL; - break; - - } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, (" ==> rssi_level:0x%02x, wireless_mode:0x%02x, rate_bitmap:0x%016llx\n", rssi_level, wireless_mode, rate_bitmap)); - - return ra_mask & rate_bitmap; -} - - -u32 -odm_get_rate_bitmap( - void *p_dm_void, - u32 macid, - u32 ra_mask, - u8 rssi_level -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct sta_info *p_entry; - u32 rate_bitmap = 0; - u8 wireless_mode; - /* u8 wireless_mode =*(p_dm_odm->p_wireless_mode); */ - - - p_entry = p_dm_odm->p_odm_sta_info[macid]; - if (!IS_STA_VALID(p_entry)) - return ra_mask; - - wireless_mode = p_entry->wireless_mode; - - switch (wireless_mode) { - 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 (p_dm_odm->rf_type == ODM_1T2R || p_dm_odm->rf_type == 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 (*(p_dm_odm->p_band_width) == 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 (*(p_dm_odm->p_band_width) == 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 (p_dm_odm->rf_type == 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 (p_dm_odm->rf_type == RF_1T2R) - rate_bitmap = 0x000fffff; - else - rate_bitmap = 0x0fffffff; - break; - - } - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("%s ==> rssi_level:0x%02x, wireless_mode:0x%02x, rate_bitmap:0x%08x\n", __func__, rssi_level, wireless_mode, rate_bitmap)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, (" ==> rssi_level:0x%02x, wireless_mode:0x%02x, rate_bitmap:0x%08x\n", rssi_level, wireless_mode, rate_bitmap)); - - return ra_mask & rate_bitmap; - -} - -#endif /* #if (DM_ODM_SUPPORT_TYPE == ODM_CE) */ - -#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - - -#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) - -bool -odm_ra_state_check( - void *p_dm_void, - s32 RSSI, - bool is_force_update, - u8 *p_ra_tr_state -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ODM_RATE_ADAPTIVE *p_ra = &p_dm_odm->rate_adaptive; - const u8 go_up_gap = 5; - u8 high_rssi_thresh_for_ra = p_ra->high_rssi_thresh; - u8 low_rssi_thresh_for_ra = p_ra->low_rssi_thresh; - u8 ratr_state; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI= (( %d )), Current_RSSI_level = (( %d ))\n", RSSI, *p_ra_tr_state)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("[Ori RA RSSI Thresh] High= (( %d )), Low = (( %d ))\n", high_rssi_thresh_for_ra, low_rssi_thresh_for_ra)); - /* threshold Adjustment:*/ - /* when RSSI state trends to go up one or two levels, make sure RSSI is high enough.*/ - /* Here go_up_gap is added to solve the boundary's level alternation issue.*/ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - u8 ultra_low_rssi_thresh_for_ra = p_ra->ultra_low_rssi_thresh; - - if (p_dm_odm->support_ic_type == ODM_RTL8881A) - low_rssi_thresh_for_ra = 30; /* for LDPC / BCC switch*/ #endif - - switch (*p_ra_tr_state) { - case DM_RATR_STA_INIT: - case DM_RATR_STA_HIGH: - break; - - case DM_RATR_STA_MIDDLE: - high_rssi_thresh_for_ra += go_up_gap; - break; - - case DM_RATR_STA_LOW: - high_rssi_thresh_for_ra += go_up_gap; - low_rssi_thresh_for_ra += go_up_gap; - break; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - case DM_RATR_STA_ULTRA_LOW: - high_rssi_thresh_for_ra += go_up_gap; - low_rssi_thresh_for_ra += go_up_gap; - ultra_low_rssi_thresh_for_ra += go_up_gap; - break; -#endif - - default: - ODM_RT_ASSERT(p_dm_odm, false, ("wrong rssi level setting %d !", *p_ra_tr_state)); - break; - } - - /* Decide ratr_state by RSSI.*/ - if (RSSI > high_rssi_thresh_for_ra) - ratr_state = DM_RATR_STA_HIGH; - else if (RSSI > low_rssi_thresh_for_ra) - ratr_state = DM_RATR_STA_MIDDLE; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - else if (RSSI > ultra_low_rssi_thresh_for_ra) - ratr_state = DM_RATR_STA_LOW; - else - ratr_state = DM_RATR_STA_ULTRA_LOW; -#else - else - ratr_state = DM_RATR_STA_LOW; -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("[Mod RA RSSI Thresh] High= (( %d )), Low = (( %d ))\n", high_rssi_thresh_for_ra, low_rssi_thresh_for_ra)); - /*printk("==>%s,ratr_state:0x%02x,RSSI:%d\n",__FUNCTION__,ratr_state,RSSI);*/ - - if (*p_ra_tr_state != ratr_state || is_force_update) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("[RSSI Level Update] %d->%d\n", *p_ra_tr_state, ratr_state)); - *p_ra_tr_state = ratr_state; - return true; - } - - return false; } #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_rainfo.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_rainfo.h index 2ca1b0757c07..907997ba7221 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_rainfo.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_rainfo.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,113 +9,71 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ -#ifndef __PHYDMRAINFO_H__ -#define __PHYDMRAINFO_H__ +#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 "8.0" #define FORCED_UPDATE_RAMASK_PERIOD 5 -#define H2C_0X42_LENGTH 5 -#define H2C_MAX_LENGTH 7 +#define H2C_MAX_LENGTH 7 #define RA_FLOOR_UP_GAP 3 #define RA_FLOOR_TABLE_SIZE 7 -#define ACTIVE_TP_THRESHOLD 150 +#define ACTIVE_TP_THRESHOLD 1 #define RA_RETRY_DESCEND_NUM 2 #define RA_RETRY_LIMIT_LOW 4 #define RA_RETRY_LIMIT_HIGH 32 -#define RAINFO_BE_RX_STATE BIT(0) /* 1:RX */ /* ULDL */ -#define RAINFO_STBC_STATE BIT(1) -/* #define RAINFO_LDPC_STATE BIT2 */ -#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 */ - -#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 + #define FIRST_MACID 1 +#else + #define FIRST_MACID 0 #endif -#define ap_init_rate_adaptive_state odm_rate_adaptive_state_ap_init +/* @1 ============================================================ + * 1 enumrate + * 1 ============================================================ + */ -#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 +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 */ -enum phydm_ra_arfr_num_e { - 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 -}; - -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, + 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, +enum phydm_wireless_mode { + PHYDM_WIRELESS_MODE_UNKNOWN = 0x00, PHYDM_WIRELESS_MODE_A = 0x01, PHYDM_WIRELESS_MODE_B = 0x02, PHYDM_WIRELESS_MODE_G = 0x04, @@ -128,458 +87,211 @@ enum phydm_wireless_mode_e { PHYDM_WIRELESS_MODE_ALL = 0xFFFF }; -enum phydm_rateid_idx_e { - +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_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_ARFR5_N_3SS = 14, + PHYDM_ARFR7_N_4SS = 15, + PHYDM_ARFR6_AC_4SS = 16 }; -enum phydm_rf_type_def_e { - 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 +enum phydm_qam_order { + PHYDM_QAM_CCK = 0, + PHYDM_QAM_BPSK = 1, + PHYDM_QAM_QPSK = 2, + PHYDM_QAM_16QAM = 3, + PHYDM_QAM_64QAM = 4, + PHYDM_QAM_256QAM = 5 }; -enum phydm_bw_e { - PHYDM_BW_20 = 0, - PHYDM_BW_40, - PHYDM_BW_80, - PHYDM_BW_80_80, - PHYDM_BW_160, - PHYDM_BW_10, - PHYDM_BW_5 +#if (RATE_ADAPTIVE_SUPPORT == 1)/* @88E RA */ + +struct _phydm_txstatistic_ { + u32 hw_total_tx; + u32 hw_tx_success; + u32 hw_tx_rty; + u32 hw_tx_drop; }; - -#if (RATE_ADAPTIVE_SUPPORT == 1)/* 88E RA */ +/* @1 ============================================================ + * 1 structure + * 1 ============================================================ + */ 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; + 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; + 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; + 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) - bool PT_collision_pre; -#endif - -#if (defined(CONFIG_RA_DBG_CMD)) - bool is_ra_dbg_init; - - u8 RTY_P[ODM_NUM_RATE_IDX]; - u8 RTY_P_default[ODM_NUM_RATE_IDX]; - bool 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]; - bool 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]; - bool RATE_DOWN_RTY_RATIO_modify_note[ODM_NUM_RATE_IDX]; - - bool 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]; +struct ra_table { + u8 firstconnect; + /*@u8 link_tx_rate[ODM_ASSOCIATE_ENTRY_NUM];*/ + #ifdef MU_EX_MACID + u8 mu1_rate[MU_EX_MACID]; + #endif u8 highest_client_tx_order; u16 highest_client_tx_rate_order; u8 power_tracking_flag; - u8 RA_threshold_offset; - u8 RA_offset_direction; - u8 force_update_ra_mask_count; - -#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; + u8 ra_th_ofst; /*RA_threshold_offset*/ + u8 ra_ofst_direc; /*RA_offset_direction*/ + u8 up_ramask_cnt; /*@force update_ra_mask counter*/ + u8 up_ramask_cnt_tmp; /*@Just for debug, should be removed latter*/ + u32 rrsr_val_init; /*0x440*/ + u32 rrsr_val_curr; /*0x440*/ + boolean dynamic_rrsr_en; +#if 0 /*@CONFIG_RA_DYNAMIC_RTY_LIMIT*/ + u8 per_rate_retrylimit_20M[PHY_NUM_RATE_IDX]; + u8 per_rate_retrylimit_40M[PHY_NUM_RATE_IDX]; + u8 retry_descend_num; + u8 retrylimit_low; + u8 retrylimit_high; #endif - - + u8 ldpc_thres; /* @if RSSI > ldpc_th => switch from LPDC to BCC */ + void (*record_ra_info)(void *dm_void, u8 macid, + struct cmn_sta_info *sta, u64 ra_mask); }; -struct _ODM_RATE_ADAPTIVE { - u8 type; /* dm_type_by_fw/dm_type_by_driver */ - u8 high_rssi_thresh; /* if RSSI > high_rssi_thresh => ratr_state is DM_RATR_STA_HIGH */ - u8 low_rssi_thresh; /* if RSSI <= low_rssi_thresh => ratr_state is DM_RATR_STA_LOW */ - u8 ratr_state; /* Current RSSI level, DM_RATR_STA_HIGH/DM_RATR_STA_MIDDLE/DM_RATR_STA_LOW */ +/* @1 ============================================================ + * 1 Function Prototype + * 1 ============================================================ + */ +boolean phydm_is_cck_rate(void *dm_void, u8 rate); -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - u8 ldpc_thres; /* if RSSI > ldpc_thres => switch from LPDC to BCC */ - bool is_lower_rts_rate; +boolean phydm_is_ofdm_rate(void *dm_void, u8 rate); + +boolean phydm_is_ht_rate(void *dm_void, u8 rate); + +boolean phydm_is_vht_rate(void *dm_void, u8 rate); + +u8 phydm_rate_type_2_num_ss(void *dm_void, enum PDM_RATE_TYPE type); + +u8 phydm_rate_to_num_ss(void *dm_void, u8 data_rate); + +void phydm_h2C_debug(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len); + +void phydm_ra_debug(void *dm_void, char input[][16], u32 *_used, char *output, + u32 *_out_len); + +void odm_c2h_ra_para_report_handler(void *dm_void, u8 *cmd_buf, u8 cmd_len); + +void phydm_ra_dynamic_retry_count(void *dm_void); + + +void phydm_print_rate(void *dm_void, u8 rate, u32 dbg_component); + +void phydm_print_rate_2_buff(void *dm_void, u8 rate, char *buf, u16 buf_size); + +void phydm_c2h_ra_report_handler(void *dm_void, u8 *cmd_buf, u8 cmd_len); + +u8 phydm_rate_order_compute(void *dm_void, u8 rate_idx); + +void phydm_rrsr_set_register(void *dm_void, u32 rrsr_val); + +void phydm_ra_info_watchdog(void *dm_void); + +void phydm_rrsr_en(void *dm_void, boolean en_rrsr); + +void phydm_ra_info_init(void *dm_void); + +void phydm_modify_RA_PCR_threshold(void *dm_void, u8 ra_ofst_direc, + u8 ra_th_ofst); + +u8 phydm_vht_en_mapping(void *dm_void, u32 wireless_mode); + +u8 phydm_rate_id_mapping(void *dm_void, u32 wireless_mode, u8 rf_type, u8 bw); +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) +void phydm_update_hal_ra_mask( + void *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); #endif -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - u8 rts_thres; -#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - bool is_use_ldpc; -#else - u8 ultra_low_rssi_thresh; - u32 last_ratr; /* RATR Register Content */ +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) +u8 phydm_get_plcp(void *dm_void, u16 macid); #endif -}; +void phydm_refresh_rate_adaptive_mask(void *dm_void); -void -phydm_h2C_debug( - void *p_dm_void, - u32 *const dm_value, - u32 *_used, - char *output, - u32 *_out_len -); +u8 phydm_get_rx_stream_num(void *dm_void, enum rf_type type); -#if (defined(CONFIG_RA_DBG_CMD)) +u8 phydm_rssi_lv_dec(void *dm_void, u32 rssi, u8 ratr_state); -void -odm_RA_debug( - void *p_dm_void, - u32 *const dm_value -); +void odm_ra_post_action_on_assoc(void *dm); -void -odm_ra_para_adjust_init( - void *p_dm_void -); +u8 odm_find_rts_rate(void *dm_void, u8 tx_rate, boolean is_erp_protect); -#else +void phydm_show_sta_info(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len); -void -phydm_RA_debug_PCR( - void *p_dm_void, - u32 *const dm_value, - u32 *_used, - char *output, - u32 *_out_len -); +u8 phydm_get_rate_from_rssi_lv(void *dm_void, u8 sta_idx); -#endif +void phydm_ra_registed(void *dm_void, u8 macid, u8 rssi_from_assoc); -void -odm_c2h_ra_para_report_handler( - void *p_dm_void, - u8 *cmd_buf, - u8 cmd_len -); +void phydm_ra_offline(void *dm_void, u8 macid); -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_ra_dynamic_rate_id_on_assoc( - void *p_dm_void, - u8 wireless_mode, - u8 init_rate_id -); - -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 -odm_rssi_monitor_init( - void *p_dm_void -); - -void -phydm_modify_RA_PCR_threshold( - void *p_dm_void, - u8 RA_offset_direction, - u8 RA_threshold_offset -); - -void -odm_rssi_monitor_check( - void *p_dm_void -); - -void -phydm_init_ra_info( - void *p_dm_void -); - -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 -odm_rate_adaptive_mask_init( - void *p_dm_void -); - -void -odm_refresh_rate_adaptive_mask( - void *p_dm_void -); - -void -odm_refresh_rate_adaptive_mask_mp( - void *p_dm_void -); - -void -odm_refresh_rate_adaptive_mask_ce( - void *p_dm_void -); - -void -odm_refresh_rate_adaptive_mask_apadsl( - void *p_dm_void -); - -u8 -phydm_RA_level_decision( - void *p_dm_void, - u32 rssi, - u8 ratr_state -); - -bool -odm_ra_state_check( - void *p_dm_void, - s32 RSSI, - bool is_force_update, - u8 *p_ra_tr_state -); - -void -odm_refresh_basic_rate_mask( - void *p_dm_void -); -void -odm_ra_post_action_on_assoc( - void *p_dm_odm -); - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - -u8 -odm_find_rts_rate( - void *p_dm_void, - u8 tx_rate, - bool is_erp_protect -); - -void -odm_update_noisy_state( - void *p_dm_void, - bool is_noisy_state_from_c2h -); - -void -phydm_update_pwr_track( - void *p_dm_void, - u8 rate -); +void phydm_ra_mask_watchdog(void *dm_void); #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - -s32 -phydm_find_minimum_rssi( - struct PHY_DM_STRUCT *p_dm_odm, - struct _ADAPTER *p_adapter, - OUT bool *p_is_link_temp -); - -void -odm_update_init_rate_work_item_callback( - void *p_context -); - -void -odm_rssi_dump_to_register( - void *p_dm_void -); - -void -odm_refresh_ldpc_rts_mp( - struct _ADAPTER *p_adapter, - struct PHY_DM_STRUCT *p_dm_odm, - u8 m_mac_id, - u8 iot_peer, - s32 undecorated_smoothed_pwdb -); - -#if 0 -void -odm_dynamic_arfb_select( - void *p_dm_void, - u8 rate, - bool collision_state -); +void odm_refresh_basic_rate_mask( + void *dm_void); #endif - -void -odm_rate_adaptive_state_ap_init( - void *PADAPTER_VOID, - struct sta_info *p_entry -); -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - -static void -find_minimum_rssi( - struct _ADAPTER *p_adapter -); - -u64 -phydm_get_rate_bitmap_ex( - void *p_dm_void, - u32 macid, - u64 ra_mask, - u8 rssi_level, - u64 *dm_ra_mask, - u8 *dm_rte_id -); -u32 -odm_get_rate_bitmap( - void *p_dm_void, - u32 macid, - u32 ra_mask, - u8 rssi_level -); - -void phydm_ra_rssi_rpt_wk(void *p_context); -#endif/*#elif (DM_ODM_SUPPORT_TYPE == ODM_CE)*/ - -#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_WIN| ODM_CE))*/ - -#endif /*#ifndef __ODMRAINFO_H__*/ +#endif /*@#ifndef __PHYDMRAINFO_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_reg.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_reg.h index 16328fe87f05..85e0e294a0cb 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_reg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_reg.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,16 +9,21 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ -/* ************************************************************ + * Larry Finger + * + *****************************************************************************/ +/************************************************************* * File Name: odm_reg.h * * Description: @@ -25,17 +31,18 @@ * This file is for general register definition. * * - * ************************************************************ */ -#ifndef __HAL_ODM_REG_H__ + ************************************************************/ +#ifndef __HAL_ODM_REG_H__ #define __HAL_ODM_REG_H__ -/* +/*@ * Register Definition - * */ + * + */ -/* MAC REG */ -#define ODM_BB_RESET 0x002 -#define ODM_DUMMY 0x4fe +/* @MAC REG */ +#define ODM_BB_RESET 0x002 +#define ODM_DUMMY 0x4fe #define RF_T_METER_OLD 0x24 #define RF_T_METER_NEW 0x42 @@ -43,159 +50,159 @@ #define ODM_EDCA_VI_PARAM 0x504 #define ODM_EDCA_BE_PARAM 0x508 #define ODM_EDCA_BK_PARAM 0x50C -#define ODM_TXPAUSE 0x522 +#define ODM_TXPAUSE 0x522 -/* LTE_COEX */ +/* @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 +#define REG_LTECOEX_WRITE_DATA 0x07C4 +#define REG_LTECOEX_READ_DATA 0x07C8 +#define REG_LTECOEX_PATH_CONTROL 0x70 -/* BB REG */ +/* @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_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_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_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_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_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_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_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_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_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 +#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_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 +#define REG_RF_TX_GAIN_OFFSET 0x55 -/* ant Detect Reg */ -#define ODM_DPDT 0x300 +/* @ant Detect Reg */ +#define ODM_DPDT 0x300 /* PSD Init */ -#define ODM_PSDREG 0x808 +#define ODM_PSDREG 0x808 -/* 92D path Div */ -#define PATHDIV_REG 0xB30 -#define PATHDIV_TRI 0xBA0 +/* @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_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_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_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_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_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_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_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_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 @@ -205,10 +212,32 @@ #define is_tx_agc_byte1_jaguar 0xff00 #define is_tx_agc_byte2_jaguar 0xff0000 #define is_tx_agc_byte3_jaguar 0xff000000 +#if defined(CONFIG_WLAN_HAL_8198F) || defined(CONFIG_WLAN_HAL_8822CE) ||\ +defined(CONFIG_WLAN_HAL_8814BE) || defined(CONFIG_WLAN_HAL_8812FE) + #define REG_TX_AGC_CCK_11_CCK_1_JAGUAR3 0x3a00 + #define REG_TX_AGC_OFDM_18_CCK_6_JAGUAR3 0x3a04 + #define REG_TX_AGC_OFDM_54_CCK_24_JAGUAR3 0x3a08 + #define REG_TX_AGC_MCS3_0_JAGUAR3 0x3a0c + #define REG_TX_AGC_MCS7_4_JAGUAR3 0x3a10 + #define REG_TX_AGC_MCS11_8_JAGUAR3 0x3a14 + #define REG_TX_AGC_MCS15_12_JAGUAR3 0x3a18 + #define REG_TX_AGC_MCS19_16_JAGUAR3 0x3a1c + #define REG_TX_AGC_MCS23_20_JAGUAR3 0x3a20 + #define REG_TX_AGC_MCS27_24_JAGUAR3 0x3a24 + #define REG_TX_AGC_MCS31_28_JAGUAR3 0x3a28 + #define REG_TX_AGC_VHT_Nss1_MCS3_0_JAGUAR3 0x3a2c + #define REG_TX_AGC_VHT_Nss1_MCS7_4_JAGUAR3 0x3a30 + #define REG_TX_AGC_VHT_NSS2_MCS1_NSS1_MCS8_JAGUAR3 0x3a34 + #define REG_TX_AGC_VHT_Nss2_MCS5_2_JAGUAR3 0x3a38 + #define REG_TX_AGC_VHT_Nss2_MCS9_6_JAGUAR3 0x3a3c + #define REG_TX_AGC_VHT_Nss3_MCS3_0_JAGUAR3 0x3a40 + #define REG_TX_AGC_VHT_Nss3_MCS7_4_JAGUAR3 0x3a44 + #define REG_TX_AGC_VHT_Nss4_MCS1_Nss3_MCS8_JAGUAR3 0x3a48 + #define REG_TX_AGC_VHT_Nss4_MCS5_2_JAGUAR3 0x3a4c + #define REG_TX_AGC_VHT_Nss4_MCS9_6_JAGUAR3 0x3a50 +#endif #endif #define BIT_FA_RESET BIT(0) - - #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_regdefine11ac.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_regdefine11ac.h index 171348cd158c..93fbe3c78a15 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_regdefine11ac.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_regdefine11ac.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,86 +9,102 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ -#ifndef __ODM_REGDEFINE11AC_H__ +#ifndef __ODM_REGDEFINE11AC_H__ #define __ODM_REGDEFINE11AC_H__ -/* 2 RF REG LIST */ +/* @2 RF REG LIST */ -/* 2 BB REG LIST - * PAGE 8 */ -#define ODM_REG_CCK_RPT_FORMAT_11AC 0x804 +/* @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_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_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_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 +#define ODM_REG_CCK_FA_11AC 0xA5C /* PAGE B */ -#define ODM_REG_RST_RPT_11AC 0xB58 +#define ODM_REG_RST_RPT_11AC 0xB58 /* PAGE C */ -#define ODM_REG_TRMUX_11AC 0xC08 -#define ODM_REG_IGI_A_11AC 0xC50 +#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 +#define ODM_REG_IGI_B_11AC 0xE50 +#define ODM_REG_ANT_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_CRC32_CNT_11AC 0xF14 #define ODM_REG_OFDM_FA_11AC 0xF48 -#define ODM_REG_RPT_11AC 0xfa0 +#define ODM_REG_OFDM_FA_TYPE1_11AC 0xFCC +#define ODM_REG_OFDM_FA_TYPE2_11AC 0xFD0 +#define ODM_REG_OFDM_FA_TYPE3_11AC 0xFBC +#define ODM_REG_OFDM_FA_TYPE4_11AC 0xFC0 +#define ODM_REG_OFDM_FA_TYPE5_11AC 0xFC4 +#define ODM_REG_OFDM_FA_TYPE6_11AC 0xFC8 +#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_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 +#define ODM_REG_NHM_CNT7_TO_CNT4_11AC 0xfac +#define ODM_REG_NHM_CNT11_TO_CNT8_11AC 0xfb0 /* PAGE 18 */ -#define ODM_REG_IGI_C_11AC 0x1850 +#define ODM_REG_IGI_C_11AC 0x1850 /* PAGE 1A */ -#define ODM_REG_IGI_D_11AC 0x1A50 +#define ODM_REG_IGI_D_11AC 0x1A50 -/* 2 MAC REG LIST */ -#define ODM_REG_RESP_TX_11AC 0x6D8 +/* PAGE 1D */ +#define ODM_REG_IGI_11AC3 0x1D70 + +/* @2 MAC REG LIST */ +#define ODM_REG_RESP_TX_11AC 0x6D8 -/* DIG Related */ -#define ODM_BIT_IGI_11AC 0xFFFFFFFF +/* @DIG Related */ +#define ODM_BIT_IGI_11AC 0x0000007F +#define ODM_BIT_IGI_B_11AC3 0x00007F00 +#define ODM_BIT_IGI_C_11AC3 0x007F0000 +#define ODM_BIT_IGI_D_11AC3 0x7F000000 #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) +#define ODM_BIT_BB_ATC_11AC BIT(14) #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_regdefine11n.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_regdefine11n.h index 643f8b4f10fe..6e358670fe3d 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_regdefine11n.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_regdefine11n.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,95 +9,101 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ -#ifndef __ODM_REGDEFINE11N_H__ +#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 +/* @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 +/* @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_CCK_RPT_FORMAT_11N_B 0x82C +#define ODM_REG_RX_DEFAULT_A_11N 0x858 +#define ODM_REG_RX_DEFAULT_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_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_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_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_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 +#define ODM_REG_NHM_CNT_11N 0x8d8 -/* For struct _ACS_, Jeffery, 2014-12-26 */ +/* @For struct acs_info, 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 +#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_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_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_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_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 @@ -107,60 +114,60 @@ #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_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_TRMUX_11N 0xC08 #define ODM_REG_OFDM_FA_RSTC_11N 0xC0C -#define ODM_REG_DOWNSAM_FACTOR_11N 0xC10 +#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_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_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_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_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_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_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_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 +#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_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_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_TAP_UPD_97F 0xE24 #define ODM_REG_FPGA0_IQK_11N 0xE28 -#define ODM_REG_PAGE_B1_97F 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_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 @@ -169,44 +176,45 @@ #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_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_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_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 +/* @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 +#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 +/* @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) - +#define ODM_BIT_BB_ATC_11N BIT(11) #endif + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_regtable.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_regtable.h new file mode 100644 index 000000000000..b3361d0d297d --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_regtable.h @@ -0,0 +1,931 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +#define R_0x0 0x0 +#define R_0x00 0x00 +#define R_0x0106 0x0106 +#define R_0x0140 0x0140 +#define R_0x0144 0x0144 +#define R_0x0148 0x0148 +#define R_0x040 0x040 +#define R_0x10 0x10 +#define R_0x100 0x100 +#define R_0x1038 0x1038 +#define R_0x103c 0x103c +#define R_0x1040 0x1040 +#define R_0x1048 0x1048 +#define R_0x1080 0x1080 +#define R_0x14c0 0x14c0 +#define R_0x14c4 0x14c4 +#define R_0x14c8 0x14c8 +#define R_0x14cc 0x14cc +#define R_0x1518 0x1518 +#define R_0x1684 0x1684 +#define R_0x1688 0x1688 +#define R_0x168c 0x168c +#define R_0x1700 0x1700 +#define R_0x1704 0x1704 +#define R_0x1800 0x1800 +#define R_0x1804 0x1804 +#define R_0x1808 0x1808 +#define R_0x180c 0x180c +#define R_0x1810 0x1810 +#define R_0x1814 0x1814 +#define R_0x1818 0x1818 +#define R_0x181c 0x181c +#define R_0x1830 0x1830 +#define R_0x1834 0x1834 +#define R_0x1838 0x1838 +#define R_0x183c 0x183c +#define R_0x1840 0x1840 +#define R_0x1844 0x1844 +#define R_0x1848 0x1848 +#define R_0x1860 0x1860 +#define R_0x1864 0x1864 +#define R_0x186c 0x186c +#define R_0x1870 0x1870 +#define R_0x1880 0x1880 +#define R_0x1884 0x1884 +#define R_0x188c 0x188c +#define R_0x1894 0x1894 +#define R_0x189c 0x189c +#define R_0x18a0 0x18a0 +#define R_0x18a4 0x18a4 +#define R_0x18a8 0x18a8 +#define R_0x18ac 0x18ac +#define R_0x18e0 0x18e0 +#define R_0x18e8 0x18e8 +#define R_0x18ec 0x18ec +#define R_0x18f0 0x18f0 +#define R_0x18f8 0x18f8 +#define R_0x18fc 0x18fc +#define R_0x1900 0x1900 +#define R_0x1904 0x1904 +#define R_0x1908 0x1908 +#define R_0x1910 0x1910 +#define R_0x1918 0x1918 +#define R_0x191c 0x191c +#define R_0x1928 0x1928 +#define R_0x1940 0x1940 +#define R_0x1944 0x1944 +#define R_0x1950 0x1950 +#define R_0x1954 0x1954 +#define R_0x195c 0x195c +#define R_0x1970 0x1970 +#define R_0x1984 0x1984 +#define R_0x1988 0x1988 +#define R_0x198c 0x198c +#define R_0x1990 0x1990 +#define R_0x1991 0x1991 +#define R_0x1998 0x1998 +#define R_0x19a8 0x19a8 +#define R_0x19b8 0x19b8 +#define R_0x19d4 0x19d4 +#define R_0x19d8 0x19d8 +#define R_0x19e0 0x19e0 +#define R_0x19f0 0x19f0 +#define R_0x19f8 0x19f8 +#define R_0x1a00 0x1a00 +#define R_0x1a04 0x1a04 +#define R_0x1a14 0x1a14 +#define R_0x1a20 0x1a20 +#define R_0x1a24 0x1a24 +#define R_0x1a28 0x1a28 +#define R_0x1a2c 0x1a2c +#define R_0x1a5c 0x1a5c +#define R_0x1a70 0x1a70 +#define R_0x1a74 0x1a74 +#define R_0x1a80 0x1a80 +#define R_0x1a84 0x1a84 +#define R_0x1a8c 0x1a8c +#define R_0x1a94 0x1a94 +#define R_0x1a98 0x1a98 +#define R_0x1a9c 0x1a9c +#define R_0x1aa0 0x1aa0 +#define R_0x1aa8 0x1aa8 +#define R_0x1aac 0x1aac +#define R_0x1ab0 0x1ab0 +#define R_0x1abc 0x1abc +#define R_0x1ac0 0x1ac0 +#define R_0x1ac8 0x1ac8 +#define R_0x1acc 0x1acc +#define R_0x1ad0 0x1ad0 +#define R_0x1ad4 0x1ad4 +#define R_0x1ae8 0x1ae8 +#define R_0x1aec 0x1aec +#define R_0x1b00 0x1b00 +#define R_0x1b04 0x1b04 +#define R_0x1b08 0x1b08 +#define R_0x1b0c 0x1b0c +#define R_0x1b10 0x1b10 +#define R_0x1b14 0x1b14 +#define R_0x1b18 0x1b18 +#define R_0x1b1c 0x1b1c +#define R_0x1b20 0x1b20 +#define R_0x1b23 0x1b23 +#define R_0x1b24 0x1b24 +#define R_0x1b28 0x1b28 +#define R_0x1b2c 0x1b2c +#define R_0x1b30 0x1b30 +#define R_0x1b34 0x1b34 +#define R_0x1b38 0x1b38 +#define R_0x1b3c 0x1b3c +#define R_0x1b40 0x1b40 +#define R_0x1b44 0x1b44 +#define R_0x1b48 0x1b48 +#define R_0x1b4c 0x1b4c +#define R_0x1b50 0x1b50 +#define R_0x1b54 0x1b54 +#define R_0x1b58 0x1b58 +#define R_0x1b5c 0x1b5c +#define R_0x1b60 0x1b60 +#define R_0x1b64 0x1b64 +#define R_0x1b67 0x1b67 +#define R_0x1b68 0x1b68 +#define R_0x1b6c 0x1b6c +#define R_0x1b70 0x1b70 +#define R_0x1b74 0x1b74 +#define R_0x1b78 0x1b78 +#define R_0x1b7c 0x1b7c +#define R_0x1b80 0x1b80 +#define R_0x1b83 0x1b83 +#define R_0x1b84 0x1b84 +#define R_0x1b88 0x1b88 +#define R_0x1b8c 0x1b8c +#define R_0x1b90 0x1b90 +#define R_0x1b92 0x1b92 +#define R_0x1b94 0x1b94 +#define R_0x1b97 0x1b97 +#define R_0x1b98 0x1b98 +#define R_0x1b9c 0x1b9c +#define R_0x1ba0 0x1ba0 +#define R_0x1ba4 0x1ba4 +#define R_0x1ba8 0x1ba8 +#define R_0x1bac 0x1bac +#define R_0x1bb0 0x1bb0 +#define R_0x1bb4 0x1bb4 +#define R_0x1bb8 0x1bb8 +#define R_0x1bbc 0x1bbc +#define R_0x1bc0 0x1bc0 +#define R_0x1bc8 0x1bc8 +#define R_0x1bca 0x1bca +#define R_0x1bcb 0x1bcb +#define R_0x1bcc 0x1bcc +#define R_0x1bce 0x1bce +#define R_0x1bd0 0x1bd0 +#define R_0x1bd4 0x1bd4 +#define R_0x1bd6 0x1bd6 +#define R_0x1bd8 0x1bd8 +#define R_0x1bdc 0x1bdc +#define R_0x1be4 0x1be4 +#define R_0x1be8 0x1be8 +#define R_0x1beb 0x1beb +#define R_0x1bec 0x1bec +#define R_0x1bef 0x1bef +#define R_0x1bf0 0x1bf0 +#define R_0x1bf4 0x1bf4 +#define R_0x1bf8 0x1bf8 +#define R_0x1bfc 0x1bfc +#define R_0x1c 0x1c +#define R_0x1c20 0x1c20 +#define R_0x1c24 0x1c24 +#define R_0x1c28 0x1c28 +#define R_0x1c2c 0x1c2c +#define R_0x1c30 0x1c30 +#define R_0x1c34 0x1c34 +#define R_0x1c38 0x1c38 +#define R_0x1c3c 0x1c3c +#define R_0x1c64 0x1c64 +#define R_0x1c68 0x1c68 +#define R_0x1c74 0x1c74 +#define R_0x1c78 0x1c78 +#define R_0x1c7c 0x1c7c +#define R_0x1c80 0x1c80 +#define R_0x1c90 0x1c90 +#define R_0x1c94 0x1c94 +#define R_0x1c98 0x1c98 +#define R_0x1c9c 0x1c9c +#define R_0x1ca0 0x1ca0 +#define R_0x1ca4 0x1ca4 +#define R_0x1cb0 0x1cb0 +#define R_0x1cb8 0x1cb8 +#define R_0x1cc0 0x1cc0 +#define R_0x1cd0 0x1cd0 +#define R_0x1ce4 0x1ce4 +#define R_0x1ce8 0x1ce8 +#define R_0x1cec 0x1cec +#define R_0x1cf0 0x1cf0 +#define R_0x1cf4 0x1cf4 +#define R_0x1cf8 0x1cf8 +#define R_0x1d04 0x1d04 +#define R_0x1d08 0x1d08 +#define R_0x1d0c 0x1d0c +#define R_0x1d10 0x1d10 +#define R_0x1d2c 0x1d2c +#define R_0x1d30 0x1d30 +#define R_0x1d3c 0x1d3c +#define R_0x1d44 0x1d44 +#define R_0x1d48 0x1d48 +#define R_0x1d58 0x1d58 +#define R_0x1d60 0x1d60 +#define R_0x1d6c 0x1d6c +#define R_0x1d70 0x1d70 +#define R_0x1d90 0x1d90 +#define R_0x1d94 0x1d94 +#define R_0x1d9c 0x1d9c +#define R_0x1da4 0x1da4 +#define R_0x1da8 0x1da8 +#define R_0x1e14 0x1e14 +#define R_0x1e18 0x1e18 +#define R_0x1e1c 0x1e1c +#define R_0x1e24 0x1e24 +#define R_0x1e28 0x1e28 +#define R_0x1e2c 0x1e2c +#define R_0x1e28 0x1e28 +#define R_0x1e30 0x1e30 +#define R_0x1e40 0x1e40 +#define R_0x1e44 0x1e44 +#define R_0x1e48 0x1e48 +#define R_0x1e5c 0x1e5c +#define R_0x1e60 0x1e60 +#define R_0x1e64 0x1e64 +#define R_0x1e68 0x1e68 +#define R_0x1e6c 0x1e6c +#define R_0x1e70 0x1e70 +#define R_0x1e7c 0x1e7c +#define R_0x1e84 0x1e84 +#define R_0x1e88 0x1e88 +#define R_0x1e8c 0x1e8c +#define R_0x1ea4 0x1ea4 +#define R_0x1eb4 0x1eb4 +#define R_0x1ee8 0x1ee8 +#define R_0x1eec 0x1eec +#define R_0x1ef0 0x1ef0 +#define R_0x1ef4 0x1ef4 +#define R_0x1efc 0x1efc +#define R_0x24 0x24 +#define R_0x28 0x28 +#define R_0x2c 0x2c +#define R_0x28a4 0x28a4 +#define R_0x2c04 0x2c04 +#define R_0x2c08 0x2c08 +#define R_0x2c0c 0x2c0c +#define R_0x2c10 0x2c10 +#define R_0x2c14 0x2c14 +#define R_0x2c20 0x2c20 +#define R_0x2c2c 0x2c2c +#define R_0x2c30 0x2c30 +#define R_0x2c34 0x2c34 +#define R_0x2d00 0x2d00 +#define R_0x2d04 0x2d04 +#define R_0x2d08 0x2d08 +#define R_0x2d0c 0x2d0c +#define R_0x2d10 0x2d10 +#define R_0x2d20 0x2d20 +#define R_0x2d38 0x2d38 +#define R_0x2d40 0x2d40 +#define R_0x2d44 0x2d44 +#define R_0x2d48 0x2d48 +#define R_0x2d4c 0x2d4c +#define R_0x2d88 0x2d88 +#define R_0x2d90 0x2d90 +#define R_0x2d9c 0x2d9c +#define R_0x2db4 0x2db4 +#define R_0x2db8 0x2db8 +#define R_0x2dbc 0x2dbc +#define R_0x2de0 0x2de0 +#define R_0x2de4 0x2de4 +#define R_0x2de8 0x2de8 +#define R_0x2e00 0x2e00 +#define R_0x2e20 0x2e20 +#define R_0x300 0x300 +#define R_0x38 0x38 +#define R_0x3a00 0x3a00 +#define R_0x3a04 0x3a04 +#define R_0x3a08 0x3a08 +#define R_0x3a0c 0x3a0c +#define R_0x3a10 0x3a10 +#define R_0x3a14 0x3a14 +#define R_0x3a18 0x3a18 +#define R_0x3a1c 0x3a1c +#define R_0x3a20 0x3a20 +#define R_0x3a24 0x3a24 +#define R_0x3a28 0x3a28 +#define R_0x3a2c 0x3a2c +#define R_0x3a30 0x3a30 +#define R_0x3a34 0x3a34 +#define R_0x3a38 0x3a38 +#define R_0x3a3c 0x3a3c +#define R_0x3a40 0x3a40 +#define R_0x3a44 0x3a44 +#define R_0x3a48 0x3a48 +#define R_0x3a4c 0x3a4c +#define R_0x3a50 0x3a50 +#define R_0x3a54 0x3a54 +#define R_0x3a58 0x3a58 +#define R_0x3a5c 0x3a5c +#define R_0x3a60 0x3a60 +#define R_0x3a64 0x3a64 +#define R_0x3a68 0x3a68 +#define R_0x3a6c 0x3a6c +#define R_0x3a70 0x3a70 +#define R_0x3a74 0x3a74 +#define R_0x3a78 0x3a78 +#define R_0x3a7c 0x3a7c +#define R_0x3a80 0x3a80 +#define R_0x3a84 0x3a84 +#define R_0x3a88 0x3a88 +#define R_0x3a8c 0x3a8c +#define R_0x3a90 0x3a90 +#define R_0x3a94 0x3a94 +#define R_0x3a98 0x3a98 +#define R_0x3a9c 0x3a9c +#define R_0x3aa0 0x3aa0 +#define R_0x3aa4 0x3aa4 +#define R_0x3c00 0x3c00 +#define R_0x40 0x40 +#define R_0x4000 0x4000 +#define R_0x4008 0x4008 +#define R_0x4018 0x4018 +#define R_0x401c 0x401c +#define R_0x4028 0x4028 +#define R_0x4040 0x4040 +#define R_0x4044 0x4044 +#define R_0x4100 0x4100 +#define R_0x4104 0x4104 +#define R_0x4108 0x4108 +#define R_0x410c 0x410c +#define R_0x4110 0x4110 +#define R_0x4114 0x4114 +#define R_0x4118 0x4118 +#define R_0x411c 0x411c +#define R_0x4130 0x4130 +#define R_0x4134 0x4134 +#define R_0x4138 0x4138 +#define R_0x413c 0x413c +#define R_0x4140 0x4140 +#define R_0x4144 0x4144 +#define R_0x4148 0x4148 +#define R_0x4160 0x4160 +#define R_0x4164 0x4164 +#define R_0x416c 0x416c +#define R_0x4180 0x4180 +#define R_0x419c 0x419c +#define R_0x41a0 0x41a0 +#define R_0x41a4 0x41a4 +#define R_0x41a8 0x41a8 +#define R_0x41ac 0x41ac +#define R_0x41e0 0x41e0 +#define R_0x41e8 0x41e8 +#define R_0x41ec 0x41ec +#define R_0x41f0 0x41f0 +#define R_0x41f8 0x41f8 +#define R_0x41fc 0x41fc +#define R_0x42 0x42 +#define R_0x430 0x430 +#define R_0x434 0x434 +#define R_0x44 0x44 +#define R_0x440 0x440 +#define R_0x444 0x444 +#define R_0x448 0x448 +#define R_0x450 0x450 +#define R_0x454 0x454 +#define R_0x49c 0x49c +#define R_0x4a0 0x4a0 +#define R_0x4a4 0x4a4 +#define R_0x4a8 0x4a8 +#define R_0x4c 0x4c +#define R_0x4c8 0x4c8 +#define R_0x4cc 0x4cc +#define R_0x45a4 0x45a4 +#define R_0x4c00 0x4c00 +#define R_0x5000 0x5000 +#define R_0x5008 0x5008 +#define R_0x5018 0x5018 +#define R_0x501c 0x501c +#define R_0x5028 0x5028 +#define R_0x5040 0x5040 +#define R_0x5044 0x5044 +#define R_0x5100 0x5100 +#define R_0x5108 0x5108 +#define R_0x5118 0x5118 +#define R_0x511c 0x511c +#define R_0x5128 0x5128 +#define R_0x5140 0x5140 +#define R_0x5144 0x5144 +#define R_0x520 0x520 +#define R_0x5200 0x5200 +#define R_0x520c 0x520c +#define R_0x522 0x522 +#define R_0x524 0x524 +#define R_0x5230 0x5230 +#define R_0x5234 0x5234 +#define R_0x5238 0x5238 +#define R_0x523c 0x523c +#define R_0x5240 0x5240 +#define R_0x5244 0x5244 +#define R_0x5248 0x5248 +#define R_0x526c 0x526c +#define R_0x52a0 0x52a0 +#define R_0x52a4 0x52a4 +#define R_0x52ac 0x52ac +#define R_0x5300 0x5300 +#define R_0x530c 0x530c +#define R_0x5330 0x5330 +#define R_0x5334 0x5334 +#define R_0x5338 0x5338 +#define R_0x533c 0x533c +#define R_0x5340 0x5340 +#define R_0x5344 0x5344 +#define R_0x5348 0x5348 +#define R_0x536c 0x536c +#define R_0x53a0 0x53a0 +#define R_0x53a4 0x53a4 +#define R_0x53ac 0x53ac +#define R_0x550 0x550 +#define R_0x551 0x551 +#define R_0x568 0x568 +#define R_0x588 0x588 +#define R_0x60 0x60 +#define R_0x604 0x604 +#define R_0x608 0x608 +#define R_0x60f 0x60f +#define R_0x64 0x64 +#define R_0x66 0x66 +#define R_0x660 0x660 +#define R_0x668 0x668 +#define R_0x688 0x688 +#define R_0x6a0 0x6a0 +#define R_0x6d8 0x6d8 +#define R_0x6dc 0x6dc +#define R_0x70 0x70 +#define R_0x74 0x74 +#define R_0x700 0x700 +#define R_0x71c 0x71c +#define R_0x72c 0x72c +#define R_0x764 0x764 +#define R_0x7b0 0x7b0 +#define R_0x7b4 0x7b4 +#define R_0x7c0 0x7c0 +#define R_0x7c4 0x7c4 +#define R_0x7c8 0x7c8 +#define R_0x7cc 0x7cc +#define R_0x7f0 0x7f0 +#define R_0x7f4 0x7f4 +#define R_0x7f8 0x7f8 +#define R_0x7fc 0x7fc +#define R_0x800 0x800 +#define R_0x8000 0x8000 +#define R_0x804 0x804 +#define R_0x808 0x808 +#define R_0x80c 0x80c +#define R_0x810 0x810 +#define R_0x814 0x814 +#define R_0x818 0x818 +#define R_0x81c 0x81c +#define R_0x820 0x820 +#define R_0x824 0x824 +#define R_0x828 0x828 +#define R_0x82c 0x82c +#define R_0x830 0x830 +#define R_0x834 0x834 +#define R_0x838 0x838 +#define R_0x83c 0x83c +#define R_0x840 0x840 +#define R_0x844 0x840 +#define R_0x848 0x848 +#define R_0x84c 0x84c +#define R_0x850 0x850 +#define R_0x854 0x854 +#define R_0x858 0x858 +#define R_0x85c 0x85c +#define R_0x860 0x860 +#define R_0x864 0x864 +#define R_0x868 0x868 +#define R_0x86c 0x86c +#define R_0x870 0x870 +#define R_0x874 0x874 +#define R_0x878 0x878 +#define R_0x87c 0x87c +#define R_0x880 0x880 +#define R_0x884 0x884 +#define R_0x888 0x888 +#define R_0x88c 0x88c +#define R_0x890 0x890 +#define R_0x894 0x894 +#define R_0x898 0x898 +#define R_0x89c 0x89c +#define R_0x8a0 0x8a0 +#define R_0x8a4 0x8a4 +#define R_0x8ac 0x8ac +#define R_0x8b4 0x8b4 +#define R_0x8b8 0x8b8 +#define R_0x8c0 0x8c0 +#define R_0x8c4 0x8c4 +#define R_0x8c8 0x8c8 +#define R_0x8cc 0x8cc +#define R_0x8d0 0x8d0 +#define R_0x8d4 0x8d4 +#define R_0x8d8 0x8d8 +#define R_0x8dc 0x8dc +#define R_0x8f0 0x8f0 +#define R_0x8f8 0x8f8 +#define R_0x8fc 0x8fc +#define R_0x900 0x900 +#define R_0x908 0x908 +#define R_0x90c 0x90c +#define R_0x910 0x910 +#define R_0x914 0x914 +#define R_0x918 0x918 +#define R_0x91c 0x91c +#define R_0x920 0x920 +#define R_0x924 0x924 +#define R_0x92c 0x92c +#define R_0x930 0x930 +#define R_0x934 0x934 +#define R_0x938 0x938 +#define R_0x93c 0x93c +#define R_0x940 0x940 +#define R_0x944 0x944 +#define R_0x948 0x948 +#define R_0x94c 0x94c +#define R_0x950 0x950 +#define R_0x954 0x954 +#define R_0x958 0x958 +#define R_0x95c 0x95c +#define R_0x960 0x960 +#define R_0x964 0x964 +#define R_0x968 0x968 +#define R_0x970 0x970 +#define R_0x974 0x974 +#define R_0x978 0x978 +#define R_0x97c 0x97c +#define R_0x98c 0x98c +#define R_0x990 0x990 +#define R_0x994 0x994 +#define R_0x998 0x998 +#define R_0x99c 0x99c +#define R_0x9a0 0x9a0 +#define R_0x9a4 0x9a4 +#define R_0x9ac 0x9ac +#define R_0x9b0 0x9b0 +#define R_0x9b4 0x9b4 +#define R_0x9b8 0x9b8 +#define R_0x9cc 0x9cc +#define R_0x9d0 0x9d0 +#define R_0x9e4 0x9e4 +#define R_0x9e8 0x9e8 +#define R_0x9f0 0x9f0 +#define R_0xa0 0xa0 +#define R_0xa00 0xa00 +#define R_0xa04 0xa04 +#define R_0xa08 0xa08 +#define R_0xa0a 0xa0a +#define R_0xa0c 0xa0c +#define R_0xa10 0xa10 +#define R_0xa14 0xa14 +#define R_0xa20 0xa20 +#define R_0xa24 0xa24 +#define R_0xa28 0xa28 +#define R_0xa2c 0xa2c +#define R_0xa40 0xa40 +#define R_0xa44 0xa44 +#define R_0xa48 0xa48 +#define R_0xa4c 0xa4c +#define R_0xa50 0xa50 +#define R_0xa54 0xa54 +#define R_0xa58 0xa58 +#define R_0xa68 0xa68 +#define R_0xa6c 0xa6c +#define R_0xa70 0xa70 +#define R_0xa74 0xa74 +#define R_0xa78 0xa78 +#define R_0xa8 0xa8 +#define R_0xa80 0xa80 +#define R_0xa84 0xa84 +#define R_0xa98 0xa98 +#define R_0xa9c 0xa9c +#define R_0xaa8 0xaa8 +#define R_0xaac 0xaac +#define R_0xab4 0xab4 +#define R_0xabc 0xabc +#define R_0xac8 0xac8 +#define R_0xacc 0xacc +#define R_0xad0 0xad0 +#define R_0xb0 0xb0 +#define R_0xb00 0xb00 +#define R_0xb04 0xb04 +#define R_0xb07 0xb07 +#define R_0xb08 0xb08 +#define R_0xb0c 0xb0c +#define R_0xb10 0xb10 +#define R_0xb14 0xb14 +#define R_0xb18 0xb18 +#define R_0xb1c 0xb1c +#define R_0xb20 0xb20 +#define R_0xb24 0xb24 +#define R_0xb28 0xb28 +#define R_0xb2b 0xb2b +#define R_0xb2c 0xb2c +#define R_0xb30 0xb30 +#define R_0xb34 0xb34 +#define R_0xb38 0xb38 +#define R_0xb3c 0xb3c +#define R_0xb40 0xb40 +#define R_0xb44 0xb44 +#define R_0xb48 0xb48 +#define R_0xb54 0xb54 +#define R_0xb58 0xb58 +#define R_0xb60 0xb60 +#define R_0xb64 0xb64 +#define R_0xb68 0xb68 +#define R_0xb6a 0xb6a +#define R_0xb6c 0xb6c +#define R_0xb6e 0xb6e +#define R_0xb70 0xb70 +#define R_0xb74 0xb74 +#define R_0xb77 0xb77 +#define R_0xb78 0xb78 +#define R_0xb7c 0xb7c +#define R_0xb80 0xb80 +#define R_0xb84 0xb84 +#define R_0xb88 0xb88 +#define R_0xb8c 0xb8c +#define R_0xb90 0xb90 +#define R_0xb94 0xb94 +#define R_0xb98 0xb98 +#define R_0xb9b 0xb9b +#define R_0xb9c 0xb9c +#define R_0xba0 0xba0 +#define R_0xba4 0xba4 +#define R_0xba8 0xba8 +#define R_0xbac 0xbac +#define R_0xbad 0xbad +#define R_0xbc0 0xbc0 +#define R_0xbc4 0xbc4 +#define R_0xbc8 0xbc8 +#define R_0xbcc 0xbcc +#define R_0xbd8 0xbd8 +#define R_0xbdc 0xbdc +#define R_0xbe0 0xbe0 +#define R_0xbe4 0xbe4 +#define R_0xbe8 0xbe8 +#define R_0xbec 0xbec +#define R_0xbf0 0xbf0 +#define R_0xbf4 0xbf4 +#define R_0xbf8 0xbf8 +#define R_0xc00 0xc00 +#define R_0xc04 0xc04 +#define R_0xc08 0xc08 +#define R_0xc0c 0xc0c +#define R_0xc10 0xc10 +#define R_0xc14 0xc14 +#define R_0xc18 0xc18 +#define R_0xc1c 0xc1c +#define R_0xc20 0xc20 +#define R_0xc24 0xc24 +#define R_0xc30 0xc30 +#define R_0xc38 0xc38 +#define R_0xc3c 0xc3c +#define R_0xc40 0xc40 +#define R_0xc44 0xc44 +#define R_0xc4c 0xc4c +#define R_0xc50 0xc50 +#define R_0xc54 0xc54 +#define R_0xc58 0xc58 +#define R_0xc5c 0xc5c +#define R_0xc6c 0xc6c +#define R_0xc70 0xc70 +#define R_0xc74 0xc74 +#define R_0xc78 0xc78 +#define R_0xc7c 0xc7c +#define R_0xc80 0xc80 +#define R_0xc84 0xc84 +#define R_0xc88 0xc88 +#define R_0xc8c 0xc8c +#define R_0xc90 0xc90 +#define R_0xc94 0xc94 +#define R_0xc9c 0xc9c +#define R_0xca0 0xca0 +#define R_0xca4 0xca4 +#define R_0xca8 0xca8 +#define R_0xcac 0xcac +#define R_0xcb0 0xcb0 +#define R_0xcb4 0xcb4 +#define R_0xcb8 0xcb8 +#define R_0xcbc 0xcbc +#define R_0xcbd 0xcbd +#define R_0xcbe 0xcbe +#define R_0xcc0 0xcc0 +#define R_0xcc4 0xcc4 +#define R_0xcc8 0xcc8 +#define R_0xccc 0xccc +#define R_0xcd0 0xcd0 +#define R_0xcd4 0xcd4 +#define R_0xcd8 0xcd8 +#define R_0xce0 0xce0 +#define R_0xce4 0xce4 +#define R_0xce8 0xce8 +#define R_0xd00 0xd00 +#define R_0xd04 0xd04 +#define R_0xd08 0xd08 +#define R_0xd0c 0xd0c +#define R_0xd10 0xd10 +#define R_0xd14 0xd14 +#define R_0xd2c 0xd2c +#define R_0xd30 0xd30 +#define R_0xd40 0xd40 +#define R_0xd44 0xd44 +#define R_0xd48 0xd48 +#define R_0xd4c 0xd4c +#define R_0xd50 0xd50 +#define R_0xd54 0xd54 +#define R_0xd5c 0xd5c +#define R_0xd6c 0xd6c +#define R_0xd7c 0xd7c +#define R_0xd80 0xd80 +#define R_0xd84 0xd84 +#define R_0xd8c 0xd8c +#define R_0xd90 0xd90 +#define R_0xd94 0xd94 +#define R_0xdac 0xdac +#define R_0xdb0 0xdb0 +#define R_0xdb4 0xdb4 +#define R_0xdb8 0xdb8 +#define R_0xdbc 0xdbc +#define R_0xdcc 0xdcc +#define R_0xdd0 0xdd0 +#define R_0xdd4 0xdd4 +#define R_0xdd8 0xdd8 +#define R_0xde0 0xde0 +#define R_0xdec 0xdec +#define R_0xdf4 0xdf4 +#define R_0xe00 0xe00 +#define R_0xe04 0xe04 +#define R_0xe08 0xe08 +#define R_0xe10 0xe10 +#define R_0xe14 0xe14 +#define R_0xe18 0xe18 +#define R_0xe1c 0xe1c +#define R_0xe20 0xe20 +#define R_0xe24 0xe24 +#define R_0xe28 0xe28 +#define R_0xe30 0xe30 +#define R_0xe34 0xe34 +#define R_0xe38 0xe38 +#define R_0xe3c 0xe3c +#define R_0xe40 0xe40 +#define R_0xe44 0xe44 +#define R_0xe48 0xe48 +#define R_0xe4c 0xe4c +#define R_0xe50 0xe50 +#define R_0xe54 0xe54 +#define R_0xe5c 0xe5c +#define R_0xe64 0xe64 +#define R_0xe6c 0xe6c +#define R_0xe70 0xe70 +#define R_0xe74 0xe74 +#define R_0xe78 0xe78 +#define R_0xe7c 0xe7c +#define R_0xe80 0xe80 +#define R_0xe84 0xe84 +#define R_0xe88 0xe88 +#define R_0xe8c 0xe8c +#define R_0xe90 0xe90 +#define R_0xe94 0xe94 +#define R_0xe98 0xe98 +#define R_0xe9c 0xe9c +#define R_0xea0 0xea0 +#define R_0xea4 0xea4 +#define R_0xea8 0xea8 +#define R_0xeac 0xeac +#define R_0xeb0 0xeb0 +#define R_0xeb4 0xeb4 +#define R_0xeb8 0xeb8 +#define R_0xebc 0xebc +#define R_0xec 0xec +#define R_0xec0 0xec0 +#define R_0xec4 0xec4 +#define R_0xec8 0xec8 +#define R_0xecc 0xecc +#define R_0xed0 0xed0 +#define R_0xed4 0xed4 +#define R_0xed8 0xed8 +#define R_0xedc 0xedc +#define R_0xee0 0xee0 +#define R_0xee8 0xee8 +#define R_0xeec 0xeec +#define R_0xf0 0xf0 +#define R_0xf00 0xf00 +#define R_0xf04 0xf04 +#define R_0xf08 0xf08 +#define R_0xf0c 0xf0c +#define R_0xf10 0xf10 +#define R_0xf14 0xf14 +#define R_0xf20 0xf20 +#define R_0xf2c 0xf2c +#define R_0xf30 0xf30 +#define R_0xf34 0xf34 +#define R_0xf4 0xf4 +#define R_0xf44 0xf44 +#define R_0xf48 0xf48 +#define R_0xf4c 0xf4c +#define R_0xf50 0xf50 +#define R_0xf54 0xf54 +#define R_0xf58 0xf58 +#define R_0xf5c 0xf5c +#define R_0xf70 0xf70 +#define R_0xf74 0xf74 +#define R_0xf80 0xf80 +#define R_0xf84 0xf84 +#define R_0xf87 0xf87 +#define R_0xf88 0xf88 +#define R_0xf8c 0xf8c +#define R_0xf90 0xf90 +#define R_0xf94 0xf94 +#define R_0xf98 0xf98 +#define R_0xfa0 0xfa0 +#define R_0xfa4 0xfa4 +#define R_0xfa8 0xfa8 +#define R_0xfac 0xfac +#define R_0xfb0 0xfb0 +#define R_0xfb4 0xfb4 +#define R_0xfb8 0xfb8 +#define R_0xfbc 0xfbc +#define R_0xfc0 0xfc0 +#define R_0xfc4 0xfc4 +#define R_0xfc8 0xfc8 +#define R_0xfcc 0xfcc +#define R_0xfd0 0xfd0 +#define R_0xff0 0xff0 +#define RF_0x0 0x0 +#define RF_0x00 0x00 +#define RF_0x08 0x08 +#define RF_0x0c 0x0c +#define RF_0x0d 0x0d +#define RF_0x1 0x1 +#define RF_0x18 0x18 +#define RF_0x19 0x19 +#define RF_0x1a 0x1a +#define RF_0x1bf0 0x1bf0 +#define RF_0x2 0x2 +#define RF_0x3 0x3 +#define RF_0x30 0x30 +#define RF_0x31 0x31 +#define RF_0x32 0x32 +#define RF_0x33 0x33 +#define RF_0x35 0x35 +#define RF_0x3e 0x3e +#define RF_0x3f 0x3f +#define RF_0x4 0x4 +#define RF_0x42 0x42 +#define RF_0x43 0x43 +#define RF_0x51 0x51 +#define RF_0x52 0x52 +#define RF_0x54 0x54 +#define RF_0x55 0x55 +#define RF_0x56 0x56 +#define RF_0x58 0x58 +#define RF_0x5c 0x5c +#define RF_0x61 0x61 +#define RF_0x63 0x63 +#define RF_0x64 0x64 +#define RF_0x65 0x65 +#define RF_0x66 0x66 +#define RF_0x67 0x67 +#define RF_0x6e 0x6e +#define RF_0x6f 0x6f +#define RF_0x75 0x75 +#define RF_0x76 0x76 +#define RF_0x78 0x78 +#define RF_0x7f 0x7f +#define RF_0x8 0x8 +#define RF_0x80 0x80 +#define RF_0x81 0x81 +#define RF_0x82 0x82 +#define RF_0x83 0x83 +#define RF_0x85 0x85 +#define RF_0x86 0x86 +#define RF_0x87 0x87 +#define RF_0x8a 0x8a +#define RF_0x8d 0x8d +#define RF_0x8f 0x8f +#define RF_0x93 0x93 +#define RF_0xa9 0xa9 +#define RF_0xae 0xae +#define RF_0xb0 0xb0 +#define RF_0xb3 0xb3 +#define RF_0xb4 0xb4 +#define RF_0xb8 0xb8 +#define RF_0xbc 0xbc +#define RF_0xbe 0xbe +#define RF_0xc4 0xc4 +#define RF_0xc9 0xc9 +#define RF_0xca 0xca +#define RF_0xcc 0xcc +#define RF_0xd 0xd +#define RF_0xdd 0xdd +#define RF_0xde 0xde +#define RF_0xdf 0xdf +#define RF_0xed 0xed +#define RF_0xee 0xee +#define RF_0xef 0xef +#define RF_0xf5 0xf5 diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_rssi_monitor.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_rssi_monitor.c new file mode 100644 index 000000000000..6d59135fb1a4 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_rssi_monitor.c @@ -0,0 +1,171 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +/*@************************************************************ + * include files + ************************************************************/ + +#include "mp_precomp.h" +#include "phydm_precomp.h" + +#ifdef PHYDM_SUPPORT_RSSI_MONITOR + +void phydm_rssi_monitor_h2c(void *dm_void, u8 macid) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ra_table *ra_t = &dm->dm_ra_table; + struct cmn_sta_info *sta = dm->phydm_sta_info[macid]; + struct ra_sta_info *ra = NULL; + #ifdef CONFIG_BEAMFORMING + struct bf_cmn_info *bf = NULL; + #endif + u8 h2c[H2C_MAX_LENGTH] = {0}; + u8 stbc_en, ldpc_en; + u8 bf_en = 0; + u8 is_rx, is_tx; + + if (is_sta_active(sta)) { + ra = &sta->ra_info; + } else { + PHYDM_DBG(dm, DBG_RSSI_MNTR, "[Warning] %s\n", __func__); + return; + } + + PHYDM_DBG(dm, DBG_RSSI_MNTR, "%s ======>\n", __func__); + PHYDM_DBG(dm, DBG_RSSI_MNTR, "MACID=%d\n", sta->mac_id); + + is_rx = (ra->txrx_state == RX_STATE) ? 1 : 0; + is_tx = (ra->txrx_state == TX_STATE) ? 1 : 0; + stbc_en = (sta->stbc_en) ? 1 : 0; + ldpc_en = (sta->ldpc_en) ? 1 : 0; + + #ifdef CONFIG_BEAMFORMING + bf = &sta->bf_info; + + if ((bf->ht_beamform_cap & BEAMFORMING_HT_BEAMFORMEE_ENABLE) || + (bf->vht_beamform_cap & BEAMFORMING_VHT_BEAMFORMEE_ENABLE)) + bf_en = 1; + #endif + + PHYDM_DBG(dm, DBG_RSSI_MNTR, "RA_th_ofst=(( %s%d ))\n", + ((ra_t->ra_ofst_direc) ? "+" : "-"), ra_t->ra_th_ofst); + + h2c[0] = sta->mac_id; + h2c[1] = 0; + h2c[2] = sta->rssi_stat.rssi; + h2c[3] = is_rx | (stbc_en << 1) | + ((dm->noisy_decision & 0x1) << 2) | (bf_en << 6); + h2c[4] = (ra_t->ra_th_ofst & 0x7f) | + ((ra_t->ra_ofst_direc & 0x1) << 7); + h2c[5] = 0; + h2c[6] = 0; + + PHYDM_DBG(dm, DBG_RSSI_MNTR, "PHYDM h2c[0x42]=0x%x %x %x %x %x %x %x\n", + h2c[6], h2c[5], h2c[4], h2c[3], h2c[2], h2c[1], h2c[0]); + + #if (RTL8188E_SUPPORT) + if (dm->support_ic_type == ODM_RTL8188E) + odm_ra_set_rssi_8188e(dm, sta->mac_id, sta->rssi_stat.rssi); + else + #endif + { + odm_fill_h2c_cmd(dm, ODM_H2C_RSSI_REPORT, H2C_MAX_LENGTH, h2c); + } +} + +void phydm_calculate_rssi_min_max(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct cmn_sta_info *sta; + s8 rssi_max_tmp = 0, rssi_min_tmp = 100; + u8 i; + u8 sta_cnt = 0; + + if (!dm->is_linked) + return; + + PHYDM_DBG(dm, DBG_RSSI_MNTR, "%s ======>\n", __func__); + + for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { + sta = dm->phydm_sta_info[i]; + if (is_sta_active(sta)) { + sta_cnt++; + + if (sta->rssi_stat.rssi < rssi_min_tmp) { + rssi_min_tmp = sta->rssi_stat.rssi; + dm->rssi_min_macid = i; + } + + if (sta->rssi_stat.rssi > rssi_max_tmp) { + rssi_max_tmp = sta->rssi_stat.rssi; + dm->rssi_max_macid = i; + } + + /*@[Send RSSI to FW]*/ + if (!sta->ra_info.disable_ra) + phydm_rssi_monitor_h2c(dm, i); + + if (sta_cnt == dm->number_linked_client) + break; + } + } + dm->pre_rssi_min = dm->rssi_min; + + dm->rssi_max = (u8)rssi_max_tmp; + dm->rssi_min = (u8)rssi_min_tmp; +} + +void phydm_rssi_monitor_check(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (!(dm->support_ability & ODM_BB_RSSI_MONITOR)) + return; + + /*@for AP watchdog period = 1 sec*/ + if ((dm->phydm_sys_up_time % 2) == 1) + return; + + PHYDM_DBG(dm, DBG_RSSI_MNTR, "%s ======>\n", __func__); + + phydm_calculate_rssi_min_max(dm); + + PHYDM_DBG(dm, DBG_RSSI_MNTR, "RSSI {max, min} = {%d, %d}\n", + dm->rssi_max, dm->rssi_min); +} + +void phydm_rssi_monitor_init(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct ra_table *ra_tab = &dm->dm_ra_table; + + ra_tab->firstconnect = false; + dm->pre_rssi_min = 0; + dm->rssi_max = 0; + dm->rssi_min = 0; +} + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_rssi_monitor.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_rssi_monitor.h new file mode 100644 index 000000000000..e7d7d2a48c72 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_rssi_monitor.h @@ -0,0 +1,56 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +#ifndef __PHYDM_RSSI_MONITOR_H__ +#define __PHYDM_RSSI_MONITOR_H__ + +#define RSSI_MONITOR_VERSION "2.0" + +/* @1 ============================================================ + * 1 Definition + * 1 ============================================================ + */ + +/* @1 ============================================================ + * 1 structure + * 1 ============================================================ + */ + +/* @1 ============================================================ + * 1 enumeration + * 1 ============================================================ + */ + +/* @1 ============================================================ + * 1 function prototype + * 1 ============================================================ + */ + +void phydm_rssi_monitor_check(void *dm_void); + +void phydm_rssi_monitor_init(void *dm_void); + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_smt_ant.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_smt_ant.c new file mode 100644 index 000000000000..5ed1bb7c3157 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_smt_ant.c @@ -0,0 +1,2278 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +/* ************************************************************ + * 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)) + +#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT +#if (RTL8198F_SUPPORT == 1) +void phydm_smt_ant_init_98f(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 val = 0; + + #if 0 + odm_set_bb_reg(dm, R_0x1da4, 0x3c, 4); /*6.25*4 = 25ms*/ + odm_set_bb_reg(dm, R_0x1da4, BIT(6), 1); + odm_set_bb_reg(dm, R_0x1da4, BIT(7), 1); + #endif +} +#endif +#endif + +#if (defined(CONFIG_CUMITEK_SMART_ANTENNA)) +void phydm_cumitek_smt_ant_mapping_table_8822b( + void *dm_void, + u8 *table_path_a, + u8 *table_path_b) +{ + struct dm_struct *dm = (struct dm_struct *)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); + +#if 0 + /*PHYDM_DBG(dm, DBG_SMT_ANT, "mapping table{A, B} = {0x%x, 0x%x}\n", path_a_0to3_idx, path_b_0to3_idx);*/ +#endif + + /*pathA*/ + odm_set_bb_reg(dm, R_0xca4, MASKDWORD, path_a_0to3_idx); /*@ant map 1*/ + odm_set_bb_reg(dm, R_0xca8, MASKDWORD, path_a_4to7_idx); /*@ant map 2*/ + + /*pathB*/ + odm_set_bb_reg(dm, R_0xea4, MASKDWORD, path_b_0to3_idx); /*@ant map 1*/ + odm_set_bb_reg(dm, R_0xea8, MASKDWORD, path_b_4to7_idx); /*@ant map 2*/ +} + +void phydm_cumitek_smt_ant_init_8822b( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct smt_ant *smtant_table = &dm->smtant_table; + struct smt_ant_cumitek *cumi_smtant_table = &dm->smtant_table.cumi_smtant_table; + u32 value32; + + PHYDM_DBG(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(dm, R_0x4c, BIT(24) | BIT(23), 2); + odm_set_mac_reg(dm, R_0x44, BIT(27) | BIT(26), 0); + + /*@for RFE_CTRL 0*/ + odm_set_mac_reg(dm, R_0x4c, BIT(25), 0); + odm_set_mac_reg(dm, R_0x64, BIT(29), 1); + + /*@for RFE_CTRL 2 & 3*/ + odm_set_mac_reg(dm, R_0x4c, BIT(26), 0); + odm_set_mac_reg(dm, R_0x64, BIT(28), 1); + + /*@for RFE_CTRL 11*/ + odm_set_mac_reg(dm, R_0x40, BIT(3), 1); + + /*@0x604[25]=1 : 2bit mode for pathA&B&C&D*/ + /*@0x604[25]=0 : 3bit mode for pathA&B*/ + smtant_table->tx_desc_mode = 0; + odm_set_mac_reg(dm, R_0x604, BIT(25), (u32)smtant_table->tx_desc_mode); + + /*@========= BB RFE setting =================================*/ +#if 0 + /*path A*/ + odm_set_bb_reg(dm, R_0x1990, BIT(3), 0); /*RFE_CTRL_3*/ /*A_0*/ + odm_set_bb_reg(dm, R_0xcbc, BIT(3), 0); /*@inv*/ + odm_set_bb_reg(dm, R_0xcb0, 0xf000, 8); + + odm_set_bb_reg(dm, R_0x1990, BIT(0), 0); /*RFE_CTRL_0*/ /*A_1*/ + odm_set_bb_reg(dm, R_0xcbc, BIT(0), 0); /*@inv*/ + odm_set_bb_reg(dm, R_0xcb0, 0xf, 0x9); + + odm_set_bb_reg(dm, R_0x1990, BIT(8), 0); /*RFE_CTRL_8*/ /*A_2*/ + odm_set_bb_reg(dm, R_0xcbc, BIT(8), 0); /*@inv*/ + odm_set_bb_reg(dm, R_0xcb4, 0xf, 0xa); + + + /*path B*/ + odm_set_bb_reg(dm, R_0x1990, BIT(4), 1); /*RFE_CTRL_4*/ /*B_0*/ + odm_set_bb_reg(dm, R_0xdbc, BIT(4), 0); /*@inv*/ + odm_set_bb_reg(dm, R_0xdb0, 0xf0000, 0xb); + + odm_set_bb_reg(dm, R_0x1990, BIT(11), 1); /*RFE_CTRL_11*/ /*B_1*/ + odm_set_bb_reg(dm, R_0xdbc, BIT(11), 0); /*@inv*/ + odm_set_bb_reg(dm, R_0xdb4, 0xf000, 0xc); + + odm_set_bb_reg(dm, R_0x1990, BIT(9), 1); /*RFE_CTRL_9*/ /*B_2*/ + odm_set_bb_reg(dm, R_0xdbc, BIT(9), 0); /*@inv*/ + odm_set_bb_reg(dm, R_0xdb4, 0xf0, 0xd); +#endif + /*@========= BB SmtAnt setting =================================*/ + odm_set_mac_reg(dm, R_0x6d8, BIT(22) | BIT(21), 2); /*resp tx by register*/ + odm_set_mac_reg(dm, R_0x668, BIT(3), 1); + odm_set_bb_reg(dm, R_0x804, BIT(4), 0); /*@lathch antsel*/ + odm_set_bb_reg(dm, R_0x818, 0xf00000, 0); /*@keep tx by rx*/ + odm_set_bb_reg(dm, R_0x900, BIT(19), 0); /*@fast train*/ + odm_set_bb_reg(dm, R_0x900, BIT(18), 1); /*@1: by TXDESC*/ + + /*pathA*/ + odm_set_bb_reg(dm, R_0xca4, MASKDWORD, 0x03020100); /*@ant map 1*/ + odm_set_bb_reg(dm, R_0xca8, MASKDWORD, 0x07060504); /*@ant map 2*/ + odm_set_bb_reg(dm, R_0xcac, BIT(9), 0); /*@keep antsel map by GNT_BT*/ + + /*pathB*/ + odm_set_bb_reg(dm, R_0xea4, MASKDWORD, 0x30201000); /*@ant map 1*/ + odm_set_bb_reg(dm, R_0xea8, MASKDWORD, 0x70605040); /*@ant map 2*/ + odm_set_bb_reg(dm, R_0xeac, BIT(9), 0); /*@keep antsel map by GNT_BT*/ +} + +void phydm_cumitek_smt_ant_init_8197f( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct smt_ant *smtant_table = &dm->smtant_table; + struct smt_ant_cumitek *cumi_smtant_table = &dm->smtant_table.cumi_smtant_table; + u32 value32; + + PHYDM_DBG(dm, DBG_SMT_ANT, "[8197F Cumitek SmtAnt Int]\n"); + + /*@GPIO setting*/ +} + +void phydm_cumitek_smt_ant_init_8192f( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct smt_ant *smtant_table = &dm->smtant_table; + struct smt_ant_cumitek *cumi_smtant_table = &dm->smtant_table.cumi_smtant_table; + u32 value32; + PHYDM_DBG(dm, DBG_SMT_ANT, "[8192F Cumitek SmtAnt Int]\n"); + + /*@GPIO setting*/ +} + +void phydm_cumitek_smt_tx_ant_update( + void *dm_void, + u8 tx_ant_idx_path_a, + u8 tx_ant_idx_path_b, + u32 mac_id) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct smt_ant *smtant_table = &dm->smtant_table; + struct smt_ant_cumitek *cumi_smtant_table = &dm->smtant_table.cumi_smtant_table; + + PHYDM_DBG(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*/ + cumi_smtant_table->tx_ant_idx[0][mac_id] = tx_ant_idx_path_a; /*@fill this value into TXDESC*/ + + /*path-B*/ + 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 *dm_void, + u8 rx_ant_idx_path_a, + u8 rx_ant_idx_path_b) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct smt_ant *smtant_table = &dm->smtant_table; + struct smt_ant_cumitek *cumi_smtant_table = &dm->smtant_table.cumi_smtant_table; + + PHYDM_DBG(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 (cumi_smtant_table->rx_default_ant_idx[0] != rx_ant_idx_path_a) { + #if (RTL8822B_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8822B) { + odm_set_bb_reg(dm, R_0xc08, BIT(21) | BIT(20) | BIT(19), rx_ant_idx_path_a); /*@default RX antenna*/ + odm_set_mac_reg(dm, R_0x6d8, BIT(2) | BIT(1) | BIT(0), rx_ant_idx_path_a); /*@default response TX antenna*/ + } + #endif + + #if (RTL8197F_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8197F) { + } + #endif + + /*@jj add 20170822*/ + #if (RTL8192F_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8192F) { + } + #endif + cumi_smtant_table->rx_default_ant_idx[0] = rx_ant_idx_path_a; + } + + /*path-B*/ + if (cumi_smtant_table->rx_default_ant_idx[1] != rx_ant_idx_path_b) { + #if (RTL8822B_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8822B) { + odm_set_bb_reg(dm, R_0xe08, BIT(21) | BIT(20) | BIT(19), rx_ant_idx_path_b); /*@default antenna*/ + odm_set_mac_reg(dm, R_0x6d8, BIT(5) | BIT(4) | BIT(3), rx_ant_idx_path_b); /*@default response TX antenna*/ + } + #endif + + #if (RTL8197F_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8197F) { + } + #endif + + /*@jj add 20170822*/ + #if (RTL8192F_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8192F) { + } + #endif + cumi_smtant_table->rx_default_ant_idx[1] = rx_ant_idx_path_b; + } +} + +void phydm_cumitek_smt_ant_debug( + void *dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct smt_ant *smtant_table = &dm->smtant_table; + struct smt_ant_cumitek *cumi_smtant_table = &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) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "{1} {PathA rx_ant_idx} {pathB rx_ant_idx}\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{2} {PathA tx_ant_idx} {pathB tx_ant_idx} {macid}\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + "{3} {PathA mapping table} {PathB mapping table}\n"); + PDM_SNPF(out_len, used, 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(dm, (u8)dm_value[1], (u8)dm_value[2]); + PDM_SNPF(out_len, used, 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]); + } + + PDM_SNPF(out_len, used, 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(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]); + } + + PDM_SNPF(out_len, used, 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); + } + + PDM_SNPF(out_len, used, 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]); + PDM_SNPF(out_len, used, 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(dm, &table_path_a[0], &table_path_b[0]); + + } else if (dm_value[0] == 4) { + smtant_table->tx_desc_mode = (u8)dm_value[1]; + odm_set_mac_reg(dm, R_0x604, BIT(25), (u32)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 *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; + struct phydm_fat_struct *fat_tab = &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(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(dm, sat_tab->rfu_codeword_table_2g, rfu_codeword_table_init_2g, (SUPPORT_BEAM_SET_PATTERN_NUM * MAX_PATH_NUM_8822B)); + odm_move_memory(dm, sat_tab->rfu_codeword_table_5g, rfu_codeword_table_init_5g, (SUPPORT_BEAM_SET_PATTERN_NUM * MAX_PATH_NUM_8822B)); + + /*@GPIO setting*/ + odm_set_mac_reg(dm, R_0x64, (BIT(18) | BIT(17) | BIT(16)), 0); + odm_set_mac_reg(dm, R_0x44, BIT(25) | BIT(24), 0); /*@config P_GPIO[3:2] to data port*/ + odm_set_mac_reg(dm, R_0x44, BIT(17) | BIT(16), 0x3); /*@enable_output for P_GPIO[3:2]*/ +#if 0 + /*odm_set_mac_reg(dm, R_0x44, BIT(9)|BIT(8), 0);*/ /*P_GPIO[3:2] output value*/ +#endif + odm_set_mac_reg(dm, R_0x40, BIT(1) | BIT(0), 0); /*@GPIO function*/ + + /*@Hong_lin smart antenna HW setting*/ + sat_tab->rfu_protocol_type = 2; + sat_tab->rfu_protocol_delay_time = 45; + + sat_tab->rfu_codeword_total_bit_num = 16; /*@max=32bit*/ + sat_tab->rfu_each_ant_bit_num = 4; + + sat_tab->total_beam_set_num = 4; + sat_tab->total_beam_set_num_2g = 4; + sat_tab->total_beam_set_num_5g = 8; + +#if DEV_BUS_TYPE == RT_SDIO_INTERFACE + if (dm->support_interface == ODM_ITRF_SDIO) + sat_tab->latch_time = 100; /*@mu sec*/ +#endif +#if DEV_BUS_TYPE == RT_USB_INTERFACE + if (dm->support_interface == ODM_ITRF_USB) + sat_tab->latch_time = 100; /*@mu sec*/ +#endif + sat_tab->pkt_skip_statistic_en = 0; + + sat_tab->ant_num = 2; + sat_tab->ant_num_total = MAX_PATH_NUM_8822B; + sat_tab->first_train_ant = MAIN_ANT; + + sat_tab->fix_beam_pattern_en = 0; + sat_tab->decision_holding_period = 0; + + /*@beam training setting*/ + sat_tab->pkt_counter = 0; + sat_tab->per_beam_training_pkt_num = 10; + + /*set default beam*/ + sat_tab->fast_training_beam_num = 0; + sat_tab->pre_fast_training_beam_num = sat_tab->fast_training_beam_num; + + for (j = 0; j < SUPPORT_BEAM_SET_PATTERN_NUM; j++) { + sat_tab->beam_set_avg_rssi_pre[j] = 0; + sat_tab->beam_set_train_val_diff[j] = 0; + sat_tab->beam_set_train_cnt[j] = 0; + } + phydm_set_rfu_beam_pattern_type2(dm); + fat_tab->fat_state = FAT_BEFORE_LINK_STATE; +} +#endif + +u32 phydm_construct_hb_rfu_codeword_type2( + void *dm_void, + u32 beam_set_idx) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; + u32 sync_codeword = 0x7f; + u32 codeword = 0; + u32 data_tmp = 0; + u32 i; + + for (i = 0; i < sat_tab->ant_num_total; i++) { + if (*dm->band_type == ODM_BAND_5G) + data_tmp = sat_tab->rfu_codeword_table_5g[beam_set_idx][i]; + else + data_tmp = sat_tab->rfu_codeword_table_2g[beam_set_idx][i]; + + codeword |= (data_tmp << (i * sat_tab->rfu_each_ant_bit_num)); + } + + codeword = (codeword << 8) | sync_codeword; + + return codeword; +} + +void phydm_update_beam_pattern_type2( + void *dm_void, + u32 codeword, + u32 codeword_length) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct smt_ant_honbo *sat_tab = &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(dm, DBG_ANT_DIV, "Set codeword = ((0x%x))\n", codeword); + + reg44_ori = odm_get_mac_reg(dm, R_0x44, MASKDWORD); + reg44_tmp_p = reg44_ori; +#if 0 + /*PHYDM_DBG(dm, DBG_ANT_DIV, "reg44_ori =0x%x\n", reg44_ori);*/ +#endif + + /*@devide_num = (sat_tab->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 (dm->debug_components & DBG_ANT_DIV) { + if (i == (codeword_length - 1)) + pr_debug("%d ]\n", beam_ctrl_signal); + else if (i == 0) + pr_debug("Start sending codeword[1:%d] ---> [ %d ", codeword_length, beam_ctrl_signal); + else if ((i % devide_num) == (devide_num - 1)) + pr_debug("%d | ", beam_ctrl_signal); + else + pr_debug("%d ", beam_ctrl_signal); + } + #endif + + if (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))); + +#if 0 + /*PHYDM_DBG(dm, DBG_ANT_DIV, "reg44_tmp_p =(( 0x%x )), reg44_tmp_n = (( 0x%x ))\n", reg44_tmp_p, reg44_tmp_n);*/ +#endif + odm_set_mac_reg(dm, R_0x44, MASKDWORD, reg44_tmp_p); + odm_set_mac_reg(dm, R_0x44, MASKDWORD, reg44_tmp_n); + #endif + } + #if (RTL8822B_SUPPORT == 1) + else if (dm->support_ic_type == ODM_RTL8822B) { + if (sat_tab->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(dm, R_0x44, MASKDWORD, reg44_tmp_p); + ODM_delay_us(sat_tab->rfu_protocol_delay_time); +#if 0 + /*PHYDM_DBG(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);*/ +#endif + + } 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))); + +#if 0 + /*PHYDM_DBG(dm, DBG_ANT_DIV, "reg44_tmp_p =(( 0x%x )), reg44_tmp_n = (( 0x%x ))\n", reg44_tmp_p, reg44_tmp_n); */ +#endif + odm_set_mac_reg(dm, R_0x44, MASKDWORD, reg44_tmp_p); + ODM_delay_us(10); + odm_set_mac_reg(dm, R_0x44, MASKDWORD, reg44_tmp_n); + ODM_delay_us(10); + } + } + #endif + } +} + +void phydm_update_rx_idle_beam_type2( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; + u32 i; + + sat_tab->update_beam_codeword = phydm_construct_hb_rfu_codeword_type2(dm, sat_tab->rx_idle_beam_set_idx); + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ Update Rx-Idle-Beam ] BeamSet idx = ((%d))\n", + sat_tab->rx_idle_beam_set_idx); + +#if DEV_BUS_TYPE == RT_PCI_INTERFACE + if (dm->support_interface == ODM_ITRF_PCIE) + phydm_update_beam_pattern_type2(dm, sat_tab->update_beam_codeword, sat_tab->rfu_codeword_total_bit_num); +#endif +#if DEV_BUS_TYPE == RT_USB_INTERFACE || DEV_BUS_TYPE == RT_SDIO_INTERFACE + if (dm->support_interface == ODM_ITRF_USB || dm->support_interface == ODM_ITRF_SDIO) + odm_schedule_work_item(&sat_tab->hl_smart_antenna_workitem); +#if 0 + /*odm_stall_execution(1);*/ +#endif +#endif + + sat_tab->pre_codeword = sat_tab->update_beam_codeword; +} + +void phydm_hl_smt_ant_dbg_type2( + void *dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len +) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; + u32 used = *_used; + u32 out_len = *_out_len; + u32 one = 0x1; + u32 codeword_length = sat_tab->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) { + PDM_SNPF(out_len, used, output + used, out_len - used, + " 1 {fix_en} {codeword(Hex)}\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + " 3 {Fix_training_num_en} {Per_beam_training_pkt_num} {Decision_holding_period}\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + " 5 {0:show, 1:2G, 2:5G} {beam_num} {idxA(Hex)} {idxB(Hex)}\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + " 7 {0:show, 1:2G, 2:5G} {total_beam_set_num}\n"); + PDM_SNPF(out_len, used, output + used, out_len - used, + " 8 {0:show, 1:set} {RFU delay time(us)}\n"); + + } else if (dm_value[0] == 1) { /*@fix beam pattern*/ + + sat_tab->fix_beam_pattern_en = dm_value[1]; + + if (sat_tab->fix_beam_pattern_en == 1) { + PHYDM_SSCANF(input[3], DCMD_HEX, &dm_value[2]); + sat_tab->fix_beam_pattern_codeword = dm_value[2]; + + if (sat_tab->fix_beam_pattern_codeword > (one << codeword_length)) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ SmartAnt ] Codeword overflow, Current codeword is ((0x%x)), and should be less than ((%d))bit\n", + sat_tab->fix_beam_pattern_codeword, + codeword_length); + + (sat_tab->fix_beam_pattern_codeword) &= 0xffffff; + + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ SmartAnt ] Auto modify to (0x%x)\n", + sat_tab->fix_beam_pattern_codeword); + } + + sat_tab->update_beam_codeword = sat_tab->fix_beam_pattern_codeword; + + /*@---------------------------------------------------------*/ + PDM_SNPF(out_len, used, output + used, out_len - used, + "Fix Beam Pattern\n"); + + /*@devide_num = (sat_tab->rfu_protocol_type == 2) ? 8 : 4;*/ + + for (i = 0; i <= (codeword_length - 1); i++) { + beam_ctrl_signal = (boolean)((sat_tab->update_beam_codeword & BIT(i)) >> i); + + if (i == (codeword_length - 1)) + PDM_SNPF(out_len, used, + output + used, + out_len - used, + "%d]\n", + beam_ctrl_signal); + else if (i == 0) + PDM_SNPF(out_len, used, + output + used, + out_len - used, + "Send Codeword[1:%d] to RFU -> [%d", + sat_tab->rfu_codeword_total_bit_num, + beam_ctrl_signal); + else if ((i % devide_num) == (devide_num - 1)) + PDM_SNPF(out_len, used, + output + used, + out_len - used, "%d|", + beam_ctrl_signal); + else + PDM_SNPF(out_len, used, + output + used, + out_len - used, "%d", + beam_ctrl_signal); + } +/*@---------------------------------------------------------*/ + +#if DEV_BUS_TYPE == RT_PCI_INTERFACE + if (dm->support_interface == ODM_ITRF_PCIE) + phydm_update_beam_pattern_type2(dm, sat_tab->update_beam_codeword, sat_tab->rfu_codeword_total_bit_num); +#endif +#if DEV_BUS_TYPE == RT_USB_INTERFACE || DEV_BUS_TYPE == RT_SDIO_INTERFACE + if (dm->support_interface == ODM_ITRF_USB || dm->support_interface == ODM_ITRF_SDIO) + odm_schedule_work_item(&sat_tab->hl_smart_antenna_workitem); +#if 0 + /*odm_stall_execution(1);*/ +#endif +#endif + } else if (sat_tab->fix_beam_pattern_en == 0) + PDM_SNPF(out_len, used, output + used, out_len - used, + "[ SmartAnt ] Smart Antenna: Enable\n"); + + } else if (dm_value[0] == 2) { /*set latch time*/ + + sat_tab->latch_time = dm_value[1]; + PHYDM_DBG(dm, DBG_ANT_DIV, "[ SmartAnt ] latch_time =0x%x\n", + sat_tab->latch_time); + } else if (dm_value[0] == 3) { + sat_tab->fix_training_num_en = dm_value[1]; + + if (sat_tab->fix_training_num_en == 1) { + sat_tab->per_beam_training_pkt_num = (u8)dm_value[2]; + sat_tab->decision_holding_period = (u8)dm_value[3]; + + PDM_SNPF(out_len, used, output + used, out_len - used, + "[SmtAnt] Fix_train_en = (( %d )), train_pkt_num = (( %d )), holding_period = (( %d )),\n", + sat_tab->fix_training_num_en, + sat_tab->per_beam_training_pkt_num, + sat_tab->decision_holding_period); + + } else if (sat_tab->fix_training_num_en == 0) { + PDM_SNPF(out_len, used, 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) { + sat_tab->ant_num = 1; + sat_tab->first_train_ant = MAIN_ANT; + + } else if (dm_value[1] == 2) { + sat_tab->ant_num = 1; + sat_tab->first_train_ant = AUX_ANT; + + } else if (dm_value[1] == 3) { + sat_tab->ant_num = 2; + sat_tab->first_train_ant = MAIN_ANT; + } + + PDM_SNPF((output + used, out_len - used, + "[ SmartAnt ] Set ant Num = (( %d )), first_train_ant = (( %d ))\n", + sat_tab->ant_num, (sat_tab->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) { + sat_tab->rfu_codeword_table_2g[dm_value[2]][0] = (u8)dm_value[3]; + sat_tab->rfu_codeword_table_2g[dm_value[2]][1] = (u8)dm_value[4]; + PDM_SNPF(out_len, used, 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) { + sat_tab->rfu_codeword_table_5g[dm_value[2]][0] = (u8)dm_value[3]; + sat_tab->rfu_codeword_table_5g[dm_value[2]][1] = (u8)dm_value[4]; + PDM_SNPF(out_len, used, 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) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "[SmtAnt] 2G Beam Table==============>\n"); + for (i = 0; i < sat_tab->total_beam_set_num_2g; i++) { + PDM_SNPF(out_len, used, output + used, + out_len - used, + "2G Table[%d] = [A:0x%x, B:0x%x]\n", i, + sat_tab->rfu_codeword_table_2g[i][0], + sat_tab->rfu_codeword_table_2g[i][1]); + } + PDM_SNPF(out_len, used, output + used, out_len - used, + "[SmtAnt] 5G Beam Table==============>\n"); + for (i = 0; i < sat_tab->total_beam_set_num_5g; i++) { + PDM_SNPF(out_len, used, output + used, + out_len - used, + "5G Table[%d] = [A:0x%x, B:0x%x]\n", i, + sat_tab->rfu_codeword_table_5g[i][0], + sat_tab->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) { + sat_tab->rfu_codeword_table_5g[dm_value[2] ][0] = (u8)dm_value[3]; + sat_tab->rfu_codeword_table_5g[dm_value[2] ][1] = (u8)dm_value[4]; + PDM_SNPF((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 < sat_tab->total_beam_set_num_5g; i++) { + PDM_SNPF((output + used, out_len - used, + "[SmtAnt] Read 5G Table[%d] = [A:0x%x, B:0x%x]\n", + i, + sat_tab->rfu_codeword_table_5g[i][0], + sat_tab->rfu_codeword_table_5g[i][1])); + } + } +#endif + } else if (dm_value[0] == 7) { + if (dm_value[1] == 1) { + sat_tab->total_beam_set_num_2g = (u8)(dm_value[2]); + PDM_SNPF(out_len, used, output + used, out_len - used, + "[ SmartAnt ] total_beam_set_num_2g = ((%d))\n", + sat_tab->total_beam_set_num_2g); + + } else if (dm_value[1] == 2) { + sat_tab->total_beam_set_num_5g = (u8)(dm_value[2]); + PDM_SNPF(out_len, used, output + used, out_len - used, + "[ SmartAnt ] total_beam_set_num_5g = ((%d))\n", + sat_tab->total_beam_set_num_5g); + } else if (dm_value[1] == 0) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "[ SmartAnt ] Show total_beam_set_num{2g,5g} = {%d,%d}\n", + sat_tab->total_beam_set_num_2g, + sat_tab->total_beam_set_num_5g); + } + + } else if (dm_value[0] == 8) { + if (dm_value[1] == 1) { + sat_tab->rfu_protocol_delay_time = (u16)(dm_value[2]); + PDM_SNPF(out_len, used, output + used, out_len - used, + "[SmtAnt] Set rfu_protocol_delay_time = ((%d))\n", + sat_tab->rfu_protocol_delay_time); + } else if (dm_value[1] == 0) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "[SmtAnt] Read rfu_protocol_delay_time = ((%d))\n", + sat_tab->rfu_protocol_delay_time); + } + } + + *_used = used; + *_out_len = out_len; +} + +void phydm_set_rfu_beam_pattern_type2( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; + + if (dm->ant_div_type != HL_SW_SMART_ANT_TYPE2) + return; + + PHYDM_DBG(dm, DBG_ANT_DIV, "Training beam_set index = (( 0x%x ))\n", + sat_tab->fast_training_beam_num); + sat_tab->update_beam_codeword = phydm_construct_hb_rfu_codeword_type2(dm, sat_tab->fast_training_beam_num); + + #if DEV_BUS_TYPE == RT_PCI_INTERFACE + if (dm->support_interface == ODM_ITRF_PCIE) + phydm_update_beam_pattern_type2(dm, sat_tab->update_beam_codeword, sat_tab->rfu_codeword_total_bit_num); + #endif + #if DEV_BUS_TYPE == RT_USB_INTERFACE || DEV_BUS_TYPE == RT_SDIO_INTERFACE + if (dm->support_interface == ODM_ITRF_USB || dm->support_interface == ODM_ITRF_SDIO) + odm_schedule_work_item(&sat_tab->hl_smart_antenna_workitem); +#if 0 + /*odm_stall_execution(1);*/ +#endif + #endif +} + +void phydm_fast_ant_training_hl_smart_antenna_type2( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + struct sw_antenna_switch *dm_swat_table = &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 (!dm->is_linked) { + PHYDM_DBG(dm, DBG_ANT_DIV, "[No Link!!!]\n"); + + if (fat_tab->is_become_linked == true) { + sat_tab->decision_holding_period = 0; + PHYDM_DBG(dm, DBG_ANT_DIV, "Link->no Link\n"); + fat_tab->fat_state = FAT_BEFORE_LINK_STATE; + PHYDM_DBG(dm, DBG_ANT_DIV, + "change to (( %d )) FAT_state\n", + fat_tab->fat_state); + fat_tab->is_become_linked = dm->is_linked; + } + return; + + } else { + if (fat_tab->is_become_linked == false) { + PHYDM_DBG(dm, DBG_ANT_DIV, "[Linked !!!]\n"); + + fat_tab->fat_state = FAT_PREPARE_STATE; + PHYDM_DBG(dm, DBG_ANT_DIV, + "change to (( %d )) FAT_state\n", + fat_tab->fat_state); + + /*sat_tab->fast_training_beam_num = 0;*/ + /*phydm_set_rfu_beam_pattern_type2(dm);*/ + + fat_tab->is_become_linked = dm->is_linked; + } + } + +#if 0 + /*PHYDM_DBG(dm, DBG_ANT_DIV, "HL Smart ant Training: state (( %d ))\n", fat_tab->fat_state);*/ +#endif + + /* @[DECISION STATE] */ + /*@=======================================================================================*/ + if (fat_tab->fat_state == FAT_DECISION_STATE) { + PHYDM_DBG(dm, DBG_ANT_DIV, "[ 3. In Decision state]\n"); + + /*@compute target beam in each antenna*/ + + for (j = 0; j < (sat_tab->total_beam_set_num); j++) { + /*@[Decision1: RSSI]-------------------------------------------------------------------*/ + if (sat_tab->statistic_pkt_cnt[j] == 0) { /*@if new RSSI = 0 -> MA_RSSI-=2*/ + avg_rssi_tmp = sat_tab->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)((sat_tab->beam_set_rssi_avg_sum[j]) / (sat_tab->statistic_pkt_cnt[j])); + avg_rssi_tmp_ma = (avg_rssi_tmp + sat_tab->beam_set_avg_rssi_pre[j]) >> 1; + } + + sat_tab->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 (sat_tab->beam_path_evm_2ss_cnt[j] != 0) { + avg_evm2ss[0] = sat_tab->beam_path_evm_2ss_sum[j][0] / sat_tab->beam_path_evm_2ss_cnt[j]; + avg_evm2ss[1] = sat_tab->beam_path_evm_2ss_sum[j][1] / sat_tab->beam_path_evm_2ss_cnt[j]; + avg_evm2ss_sum = avg_evm2ss[0] + avg_evm2ss[1]; + beam_path_evm_2ss_cnt_all += sat_tab->beam_path_evm_2ss_cnt[j]; + + sat_tab->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 (sat_tab->beam_path_evm_1ss_cnt[j] != 0) { + avg_evm1ss = sat_tab->beam_path_evm_1ss_sum[j] / sat_tab->beam_path_evm_1ss_cnt[j]; + beam_path_evm_1ss_cnt_all += sat_tab->beam_path_evm_1ss_cnt[j]; + + sat_tab->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(dm, DBG_ANT_DIV, + "Beam[%d] Pkt_cnt=(( %d )), avg{MA,rssi}={%d, %d}, EVM1={%d}, EVM2={%d, %d, %d}\n", + j, sat_tab->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*/ + sat_tab->beam_set_rssi_avg_sum[j] = 0; + sat_tab->beam_path_rssi_sum[j][0] = 0; + sat_tab->beam_path_rssi_sum[j][1] = 0; + sat_tab->statistic_pkt_cnt[j] = 0; + + sat_tab->beam_path_evm_2ss_sum[j][0] = 0; + sat_tab->beam_path_evm_2ss_sum[j][1] = 0; + sat_tab->beam_path_evm_2ss_cnt[j] = 0; + + sat_tab->beam_path_evm_1ss_sum[j] = 0; + sat_tab->beam_path_evm_1ss_cnt[j] = 0; + } + + /*@[Joint Decision]-------------------------------------------------------------------*/ + PHYDM_DBG(dm, DBG_ANT_DIV, + "--->1.[RSSI] Target Beam(( %d )) RSSI_max=((%d))\n", + rssi_target_beam, target_beam_max_rssi); + PHYDM_DBG(dm, DBG_ANT_DIV, + "--->2.[Evm2SS] Target Beam(( %d )) EVM2SS_max=((%d))\n", + evm2ss_target_beam, target_beam_max_evm2ss); + PHYDM_DBG(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) { + sat_tab->rx_idle_beam_set_idx = rssi_target_beam; + decision_type = 1; + } else { + if (beam_path_evm_2ss_cnt_all != 0) { + sat_tab->rx_idle_beam_set_idx = evm2ss_target_beam; + decision_type = 2; + } else if (beam_path_evm_1ss_cnt_all != 0) { + sat_tab->rx_idle_beam_set_idx = evm1ss_target_beam; + decision_type = 3; + } else { + sat_tab->rx_idle_beam_set_idx = rssi_target_beam; + decision_type = 1; + } + } + + PHYDM_DBG(dm, DBG_ANT_DIV, + "---> Decision_type=((%d)), Final Target Beam(( %d ))\n", + decision_type, sat_tab->rx_idle_beam_set_idx); + + /*@Calculate packet counter offset*/ + for (j = 0; j < (sat_tab->total_beam_set_num); j++) { + if (decision_type == 1) { + per_beam_val_diff_tmp = target_beam_max_rssi - sat_tab->beam_set_avg_rssi_pre[j]; + + } else if (decision_type == 2) { + per_beam_val_diff_tmp = ((u8)target_beam_max_evm2ss - sat_tab->beam_set_avg_evm_2ss_pre[j]) >> 1; + } else if (decision_type == 3) { + per_beam_val_diff_tmp = (u8)target_beam_max_evm1ss - sat_tab->beam_set_avg_evm_1ss_pre[j]; + } + sat_tab->beam_set_train_val_diff[j] = per_beam_val_diff_tmp; + PHYDM_DBG(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(dm); + fat_tab->fat_state = FAT_PREPARE_STATE; + } + /* @[TRAINING STATE] */ + else if (fat_tab->fat_state == FAT_TRAINING_STATE) { + PHYDM_DBG(dm, DBG_ANT_DIV, "[ 2. In Training state]\n"); + + PHYDM_DBG(dm, DBG_ANT_DIV, + "curr_beam_idx = (( %d )), pre_beam_idx = (( %d ))\n", + sat_tab->fast_training_beam_num, + sat_tab->pre_fast_training_beam_num); + + if (sat_tab->fast_training_beam_num > sat_tab->pre_fast_training_beam_num) + + sat_tab->force_update_beam_en = 0; + + else { + sat_tab->force_update_beam_en = 1; + + sat_tab->pkt_counter = 0; + beam_tmp = sat_tab->fast_training_beam_num; + if (sat_tab->fast_training_beam_num >= ((u32)sat_tab->total_beam_set_num - 1)) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "[Timeout Update] Beam_num (( %d )) -> (( decision ))\n", + sat_tab->fast_training_beam_num); + fat_tab->fat_state = FAT_DECISION_STATE; + phydm_fast_ant_training_hl_smart_antenna_type2(dm); + + } else { + sat_tab->fast_training_beam_num++; + + PHYDM_DBG(dm, DBG_ANT_DIV, + "[Timeout Update] Beam_num (( %d )) -> (( %d ))\n", + beam_tmp, + sat_tab->fast_training_beam_num); + phydm_set_rfu_beam_pattern_type2(dm); + fat_tab->fat_state = FAT_TRAINING_STATE; + } + } + sat_tab->pre_fast_training_beam_num = sat_tab->fast_training_beam_num; + PHYDM_DBG(dm, DBG_ANT_DIV, "Update Pre_Beam =(( %d ))\n", + sat_tab->pre_fast_training_beam_num); + } + /* @[Prepare state] */ + /*@=======================================================================================*/ + else if (fat_tab->fat_state == FAT_PREPARE_STATE) { + PHYDM_DBG(dm, DBG_ANT_DIV, "\n\n[ 1. In Prepare state]\n"); + + if (dm->pre_traffic_load == dm->traffic_load) { + if (sat_tab->decision_holding_period != 0) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "Holding_period = (( %d )), return!!!\n", + sat_tab->decision_holding_period); + sat_tab->decision_holding_period--; + return; + } + } + + /* Set training packet number*/ + if (sat_tab->fix_training_num_en == 0) { + switch (dm->traffic_load) { + case TRAFFIC_HIGH: + sat_tab->per_beam_training_pkt_num = 8; + sat_tab->decision_holding_period = 2; + break; + case TRAFFIC_MID: + sat_tab->per_beam_training_pkt_num = 6; + sat_tab->decision_holding_period = 3; + break; + case TRAFFIC_LOW: + sat_tab->per_beam_training_pkt_num = 3; /*ping 60000*/ + sat_tab->decision_holding_period = 4; + break; + case TRAFFIC_ULTRA_LOW: + sat_tab->per_beam_training_pkt_num = 1; + sat_tab->decision_holding_period = 6; + break; + default: + break; + } + } + + PHYDM_DBG(dm, DBG_ANT_DIV, + "TrafficLoad = (( %d )), Fix_beam = (( %d )), per_beam_training_pkt_num = (( %d )), decision_holding_period = ((%d))\n", + dm->traffic_load, sat_tab->fix_training_num_en, + sat_tab->per_beam_training_pkt_num, + sat_tab->decision_holding_period); + + /*@Beam_set number*/ + if (*dm->band_type == ODM_BAND_5G) { + sat_tab->total_beam_set_num = sat_tab->total_beam_set_num_5g; + PHYDM_DBG(dm, DBG_ANT_DIV, "5G beam_set num = ((%d))\n", + sat_tab->total_beam_set_num); + } else { + sat_tab->total_beam_set_num = sat_tab->total_beam_set_num_2g; + PHYDM_DBG(dm, DBG_ANT_DIV, "2G beam_set num = ((%d))\n", + sat_tab->total_beam_set_num); + } + + for (j = 0; j < (sat_tab->total_beam_set_num); j++) { + training_pkt_num_offset = sat_tab->beam_set_train_val_diff[j]; + + if (sat_tab->per_beam_training_pkt_num > training_pkt_num_offset) + sat_tab->beam_set_train_cnt[j] = sat_tab->per_beam_training_pkt_num - training_pkt_num_offset; + else + sat_tab->beam_set_train_cnt[j] = 1; + + PHYDM_DBG(dm, DBG_ANT_DIV, + "Beam_Set[ %d ] training_pkt_offset = ((%d)), training_pkt_num = ((%d))\n", + j, sat_tab->beam_set_train_val_diff[j], + sat_tab->beam_set_train_cnt[j]); + } + + sat_tab->pre_beacon_counter = sat_tab->beacon_counter; + sat_tab->update_beam_idx = 0; + sat_tab->pkt_counter = 0; + + sat_tab->fast_training_beam_num = 0; + phydm_set_rfu_beam_pattern_type2(dm); + sat_tab->pre_fast_training_beam_num = sat_tab->fast_training_beam_num; + fat_tab->fat_state = FAT_TRAINING_STATE; + } +} + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + +void phydm_beam_switch_workitem_callback( + void *context) +{ + void *adapter = (void *)context; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + struct dm_struct *dm = &hal_data->DM_OutSrc; + struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; + +#if DEV_BUS_TYPE != RT_PCI_INTERFACE + sat_tab->pkt_skip_statistic_en = 1; +#endif + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ SmartAnt ] Beam Switch Workitem Callback, pkt_skip_statistic_en = (( %d ))\n", + sat_tab->pkt_skip_statistic_en); + + phydm_update_beam_pattern_type2(dm, sat_tab->update_beam_codeword, sat_tab->rfu_codeword_total_bit_num); + +#if DEV_BUS_TYPE != RT_PCI_INTERFACE +#if 0 + /*odm_stall_execution(sat_tab->latch_time);*/ +#endif + sat_tab->pkt_skip_statistic_en = 0; +#endif + PHYDM_DBG(dm, DBG_ANT_DIV, + "pkt_skip_statistic_en = (( %d )), latch_time = (( %d ))\n", + sat_tab->pkt_skip_statistic_en, sat_tab->latch_time); +} + +void phydm_beam_decision_workitem_callback( + void *context) +{ + void *adapter = (void *)context; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + struct dm_struct *dm = &hal_data->DM_OutSrc; + + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ SmartAnt ] Beam decision Workitem Callback\n"); + phydm_fast_ant_training_hl_smart_antenna_type2(dm); +} +#endif + +void phydm_process_rssi_for_hb_smtant_type2( + void *dm_void, + void *phy_info_void, + void *pkt_info_void, + u8 rssi_avg) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_phyinfo_struct *phy_info = (struct phydm_phyinfo_struct *)phy_info_void; + struct phydm_perpkt_info_struct *pktinfo = (struct phydm_perpkt_info_struct *)pkt_info_void; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; + u8 train_pkt_number; + u32 beam_tmp; + u8 rx_power_ant0 = phy_info->rx_mimo_signal_strength[0]; + u8 rx_power_ant1 = phy_info->rx_mimo_signal_strength[1]; + u8 rx_evm_ant0 = phy_info->rx_mimo_evm_dbm[0]; + u8 rx_evm_ant1 = phy_info->rx_mimo_evm_dbm[1]; + + /*@[Beacon]*/ + if (pktinfo->is_packet_beacon) { + sat_tab->beacon_counter++; + PHYDM_DBG(dm, DBG_ANT_DIV, + "MatchBSSID_beacon_counter = ((%d))\n", + sat_tab->beacon_counter); + + if (sat_tab->beacon_counter >= sat_tab->pre_beacon_counter + 2) { + sat_tab->update_beam_idx++; + PHYDM_DBG(dm, DBG_ANT_DIV, + "pre_beacon_counter = ((%d)), pkt_counter = ((%d)), update_beam_idx = ((%d))\n", + sat_tab->pre_beacon_counter, + sat_tab->pkt_counter, + sat_tab->update_beam_idx); + + sat_tab->pre_beacon_counter = sat_tab->beacon_counter; + sat_tab->pkt_counter = 0; + } + } + /*@[data]*/ + else if (pktinfo->is_packet_to_self) { + if (sat_tab->pkt_skip_statistic_en == 0) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "ID[%d] pkt_cnt=((%d)): Beam_set = ((%d)), RSSI{A,B,avg} = {%d, %d, %d}\n", + pktinfo->station_id, sat_tab->pkt_counter, + sat_tab->fast_training_beam_num, + rx_power_ant0, rx_power_ant1, rssi_avg); + + PHYDM_DBG(dm, DBG_ANT_DIV, + "Rate_ss = ((%d)), EVM{A,B} = {%d, %d}, RX Rate =", + pktinfo->rate_ss, rx_evm_ant0, rx_evm_ant1); + phydm_print_rate(dm, dm->rx_rate, DBG_ANT_DIV); + + if (sat_tab->pkt_counter >= 1) /*packet skip count*/ + { + sat_tab->beam_set_rssi_avg_sum[sat_tab->fast_training_beam_num] += rssi_avg; + sat_tab->statistic_pkt_cnt[sat_tab->fast_training_beam_num]++; + + sat_tab->beam_path_rssi_sum[sat_tab->fast_training_beam_num][0] += rx_power_ant0; + sat_tab->beam_path_rssi_sum[sat_tab->fast_training_beam_num][1] += rx_power_ant1; + + if (pktinfo->rate_ss == 2) { + sat_tab->beam_path_evm_2ss_sum[sat_tab->fast_training_beam_num][0] += rx_evm_ant0; + sat_tab->beam_path_evm_2ss_sum[sat_tab->fast_training_beam_num][1] += rx_evm_ant1; + sat_tab->beam_path_evm_2ss_cnt[sat_tab->fast_training_beam_num]++; + } else { + sat_tab->beam_path_evm_1ss_sum[sat_tab->fast_training_beam_num] += rx_evm_ant0; + sat_tab->beam_path_evm_1ss_cnt[sat_tab->fast_training_beam_num]++; + } + } + + sat_tab->pkt_counter++; + + train_pkt_number = sat_tab->beam_set_train_cnt[sat_tab->fast_training_beam_num]; + + if (sat_tab->pkt_counter >= train_pkt_number) { + sat_tab->update_beam_idx++; + PHYDM_DBG(dm, DBG_ANT_DIV, + "pre_beacon_counter = ((%d)), Update_new_beam = ((%d))\n", + sat_tab->pre_beacon_counter, + sat_tab->update_beam_idx); + + sat_tab->pre_beacon_counter = sat_tab->beacon_counter; + sat_tab->pkt_counter = 0; + } + } + } + + if (sat_tab->update_beam_idx > 0) { + sat_tab->update_beam_idx = 0; + + if (sat_tab->fast_training_beam_num >= ((u32)sat_tab->total_beam_set_num - 1)) { + fat_tab->fat_state = FAT_DECISION_STATE; + + #if DEV_BUS_TYPE == RT_PCI_INTERFACE + if (dm->support_interface == ODM_ITRF_PCIE) + phydm_fast_ant_training_hl_smart_antenna_type2(dm); /*@go to make decision*/ + #endif + #if DEV_BUS_TYPE == RT_USB_INTERFACE || DEV_BUS_TYPE == RT_SDIO_INTERFACE + if (dm->support_interface == ODM_ITRF_USB || dm->support_interface == ODM_ITRF_SDIO) + odm_schedule_work_item(&sat_tab->hl_smart_antenna_decision_workitem); + #endif + + } else { + beam_tmp = sat_tab->fast_training_beam_num; + sat_tab->fast_training_beam_num++; + PHYDM_DBG(dm, DBG_ANT_DIV, + "Update Beam_num (( %d )) -> (( %d ))\n", + beam_tmp, sat_tab->fast_training_beam_num); + phydm_set_rfu_beam_pattern_type2(dm); + sat_tab->pre_fast_training_beam_num = sat_tab->fast_training_beam_num; + + fat_tab->fat_state = FAT_TRAINING_STATE; + } + } +} +#endif + +#if (defined(CONFIG_HL_SMART_ANTENNA_TYPE1)) + +void phydm_hl_smart_ant_type1_init_8821a( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + u32 value32; + + PHYDM_DBG(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(dm, R_0x64, BIT(18), 0); + odm_set_mac_reg(dm, R_0x44, BIT(27) | BIT(26), 0); + odm_set_mac_reg(dm, R_0x44, BIT(19) | BIT(18), 0x3); /*@enable_output for P_GPIO[3:2]*/ +#if 0 + /*odm_set_mac_reg(dm, R_0x44, BIT(11)|BIT(10), 0);*/ /*output value*/ +#endif + odm_set_mac_reg(dm, R_0x40, BIT(1) | BIT(0), 0); /*@GPIO function*/ + + /*@Hong_lin smart antenna HW setting*/ + sat_tab->rfu_codeword_total_bit_num = 24; /*@max=32*/ + sat_tab->rfu_each_ant_bit_num = 4; + sat_tab->beam_patten_num_each_ant = 4; + +#if DEV_BUS_TYPE == RT_SDIO_INTERFACE + sat_tab->latch_time = 100; /*@mu sec*/ +#elif DEV_BUS_TYPE == RT_USB_INTERFACE + sat_tab->latch_time = 100; /*@mu sec*/ +#endif + sat_tab->pkt_skip_statistic_en = 0; + + sat_tab->ant_num = 1; /*@max=8*/ + sat_tab->ant_num_total = NUM_ANTENNA_8821A; + sat_tab->first_train_ant = MAIN_ANT; + + sat_tab->rfu_codeword_table[0] = 0x0; + sat_tab->rfu_codeword_table[1] = 0x4; + sat_tab->rfu_codeword_table[2] = 0x8; + sat_tab->rfu_codeword_table[3] = 0xc; + + sat_tab->rfu_codeword_table_5g[0] = 0x1; + sat_tab->rfu_codeword_table_5g[1] = 0x2; + sat_tab->rfu_codeword_table_5g[2] = 0x4; + sat_tab->rfu_codeword_table_5g[3] = 0x8; + + sat_tab->fix_beam_pattern_en = 0; + sat_tab->decision_holding_period = 0; + + /*@beam training setting*/ + sat_tab->pkt_counter = 0; + sat_tab->per_beam_training_pkt_num = 10; + + /*set default beam*/ + sat_tab->fast_training_beam_num = 0; + sat_tab->pre_fast_training_beam_num = sat_tab->fast_training_beam_num; + phydm_set_all_ant_same_beam_num(dm); + + fat_tab->fat_state = FAT_BEFORE_LINK_STATE; + + odm_set_bb_reg(dm, R_0xca4, MASKDWORD, 0x01000100); + odm_set_bb_reg(dm, R_0xca8, MASKDWORD, 0x01000100); + + /*@[BB] FAT setting*/ + odm_set_bb_reg(dm, R_0xc08, BIT(18) | BIT(17) | BIT(16), sat_tab->ant_num); + odm_set_bb_reg(dm, R_0xc08, BIT(31), 0); /*@increase ant num every FAT period 0:+1, 1+2*/ + odm_set_bb_reg(dm, R_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(dm, R_0x8c4, BIT(0), 1); /*@FAT_watchdog_en*/ + + value32 = odm_get_mac_reg(dm, R_0x7b4, MASKDWORD); + odm_set_mac_reg(dm, R_0x7b4, MASKDWORD, value32 | (BIT(16) | BIT(17))); /*Reg7B4[16]=1 enable antenna training */ + /*Reg7B4[17]=1 enable match MAC addr*/ + odm_set_mac_reg(dm, R_0x7b4, 0xFFFF, 0); /*@Match MAC ADDR*/ + odm_set_mac_reg(dm, R_0x7b0, MASKDWORD, 0); +} + +u32 phydm_construct_hl_beam_codeword( + void *dm_void, + u32 *beam_pattern_idx, + u32 ant_num) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; + u32 codeword = 0; + u32 data_tmp; + u32 i; + u32 break_counter = 0; + + if (ant_num < 8) { + for (i = 0; i < (sat_tab->ant_num_total); i++) { +#if 0 + /*PHYDM_DBG(dm,DBG_ANT_DIV, "beam_pattern_num[%x] = %x\n",i,beam_pattern_num[i] );*/ +#endif + if ((i < (sat_tab->first_train_ant - 1)) || break_counter >= sat_tab->ant_num) { + data_tmp = 0; + } else { + break_counter++; + + if (beam_pattern_idx[i] == 0) { + if (*dm->band_type == ODM_BAND_5G) + data_tmp = sat_tab->rfu_codeword_table_5g[0]; + else + data_tmp = sat_tab->rfu_codeword_table[0]; + + } else if (beam_pattern_idx[i] == 1) { + if (*dm->band_type == ODM_BAND_5G) + data_tmp = sat_tab->rfu_codeword_table_5g[1]; + else + data_tmp = sat_tab->rfu_codeword_table[1]; + + } else if (beam_pattern_idx[i] == 2) { + if (*dm->band_type == ODM_BAND_5G) + data_tmp = sat_tab->rfu_codeword_table_5g[2]; + else + data_tmp = sat_tab->rfu_codeword_table[2]; + + } else if (beam_pattern_idx[i] == 3) { + if (*dm->band_type == ODM_BAND_5G) + data_tmp = sat_tab->rfu_codeword_table_5g[3]; + else + data_tmp = sat_tab->rfu_codeword_table[3]; + } + } + + codeword |= (data_tmp << (i * 4)); + } + } + + return codeword; +} + +void phydm_update_beam_pattern( + void *dm_void, + u32 codeword, + u32 codeword_length) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct smt_ant_honbo *sat_tab = &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(dm, DBG_ANT_DIV, "[ SmartAnt ] Set Beam Pattern =0x%x\n", + codeword); + + reg44_ori = odm_get_mac_reg(dm, R_0x44, MASKDWORD); + reg44_tmp_p = reg44_ori; +#if 0 + /*PHYDM_DBG(dm, DBG_ANT_DIV, "reg44_ori =0x%x\n", reg44_ori);*/ +#endif + + devide_num = (sat_tab->rfu_protocol_type == 2) ? 6 : 4; + + for (i = 0; i <= (codeword_length - 1); i++) { + beam_ctrl_signal = (boolean)((codeword & BIT(i)) >> i); + + if (dm->debug_components & DBG_ANT_DIV) { + if (i == (codeword_length - 1)) + pr_debug("%d ]\n", beam_ctrl_signal); + else if (i == 0) + pr_debug("Send codeword[1:%d] ---> [ %d ", codeword_length, beam_ctrl_signal); + else if ((i % devide_num) == (devide_num - 1)) + pr_debug("%d | ", beam_ctrl_signal); + else + pr_debug("%d ", beam_ctrl_signal); + } + + if (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))); + +#if 0 + /*PHYDM_DBG(dm, DBG_ANT_DIV, "reg44_tmp_p =(( 0x%x )), reg44_tmp_n = (( 0x%x ))\n", reg44_tmp_p, reg44_tmp_n);*/ +#endif + odm_set_mac_reg(dm, R_0x44, MASKDWORD, reg44_tmp_p); + odm_set_mac_reg(dm, R_0x44, MASKDWORD, reg44_tmp_n); + #endif + } + #if (RTL8822B_SUPPORT == 1) + else if (dm->support_ic_type == ODM_RTL8822B) { + if (sat_tab->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(dm, R_0x44, MASKDWORD, reg44_tmp_p); + ODM_delay_us(10); +#if 0 + /*PHYDM_DBG(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);*/ +#endif + + } 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))); + +#if 0 + /*PHYDM_DBG(dm, DBG_ANT_DIV, "reg44_tmp_p =(( 0x%x )), reg44_tmp_n = (( 0x%x ))\n", reg44_tmp_p, reg44_tmp_n); */ +#endif + odm_set_mac_reg(dm, R_0x44, MASKDWORD, reg44_tmp_p); + ODM_delay_us(10); + odm_set_mac_reg(dm, R_0x44, MASKDWORD, reg44_tmp_n); + ODM_delay_us(10); + } + } + #endif + } +} + +void phydm_update_rx_idle_beam( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; + u32 i; + + sat_tab->update_beam_codeword = phydm_construct_hl_beam_codeword(dm, + &sat_tab->rx_idle_beam[0], + sat_tab->ant_num); + PHYDM_DBG(dm, DBG_ANT_DIV, + "Set target beam_pattern codeword = (( 0x%x ))\n", + sat_tab->update_beam_codeword); + + for (i = 0; i < (sat_tab->ant_num); i++) + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ Update Rx-Idle-Beam ] RxIdleBeam[%d] =%d\n", i, + sat_tab->rx_idle_beam[i]); + +#if DEV_BUS_TYPE == RT_PCI_INTERFACE + if (dm->support_interface == ODM_ITRF_PCIE) + phydm_update_beam_pattern(dm, sat_tab->update_beam_codeword, sat_tab->rfu_codeword_total_bit_num); +#endif +#if DEV_BUS_TYPE == RT_USB_INTERFACE || DEV_BUS_TYPE == RT_SDIO_INTERFACE + if (dm->support_interface == ODM_ITRF_USB || dm->support_interface == ODM_ITRF_SDIO) + odm_schedule_work_item(&sat_tab->hl_smart_antenna_workitem); +#if 0 + /*odm_stall_execution(1);*/ +#endif +#endif + + sat_tab->pre_codeword = sat_tab->update_beam_codeword; +} + +void phydm_hl_smart_ant_debug( + void *dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; + u32 used = *_used; + u32 out_len = *_out_len; + u32 one = 0x1; + u32 codeword_length = sat_tab->rfu_codeword_total_bit_num; + u32 beam_ctrl_signal, i; + u8 devide_num = 4; + + if (dm_value[0] == 1) { /*@fix beam pattern*/ + + sat_tab->fix_beam_pattern_en = dm_value[1]; + + if (sat_tab->fix_beam_pattern_en == 1) { + sat_tab->fix_beam_pattern_codeword = dm_value[2]; + + if (sat_tab->fix_beam_pattern_codeword > (one << codeword_length)) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ SmartAnt ] Codeword overflow, Current codeword is ((0x%x)), and should be less than ((%d))bit\n", + sat_tab->fix_beam_pattern_codeword, + codeword_length); + + (sat_tab->fix_beam_pattern_codeword) &= 0xffffff; + + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ SmartAnt ] Auto modify to (0x%x)\n", + sat_tab->fix_beam_pattern_codeword); + } + + sat_tab->update_beam_codeword = sat_tab->fix_beam_pattern_codeword; + + /*@---------------------------------------------------------*/ + PDM_SNPF(out_len, used, output + used, out_len - used, + "Fix Beam Pattern\n"); + + devide_num = (sat_tab->rfu_protocol_type == 2) ? 6 : 4; + + for (i = 0; i <= (codeword_length - 1); i++) { + beam_ctrl_signal = (boolean)((sat_tab->update_beam_codeword & BIT(i)) >> i); + + if (i == (codeword_length - 1)) + PDM_SNPF(out_len, used, + output + used, + out_len - used, + "%d]\n", + beam_ctrl_signal); + else if (i == 0) + PDM_SNPF(out_len, used, + output + used, + out_len - used, + "Send Codeword[1:24] to RFU -> [%d", + beam_ctrl_signal); + else if ((i % devide_num) == (devide_num - 1)) + PDM_SNPF(out_len, used, + output + used, + out_len - used, "%d|", + beam_ctrl_signal); + else + PDM_SNPF(out_len, used, + output + used, + out_len - used, "%d", + beam_ctrl_signal); + } +/*@---------------------------------------------------------*/ + + #if DEV_BUS_TYPE == RT_PCI_INTERFACE + if (dm->support_interface == ODM_ITRF_PCIE) + phydm_update_beam_pattern(dm, sat_tab->update_beam_codeword, sat_tab->rfu_codeword_total_bit_num); + #endif + #if DEV_BUS_TYPE == RT_USB_INTERFACE || DEV_BUS_TYPE == RT_SDIO_INTERFACE + if (dm->support_interface == ODM_ITRF_USB || dm->support_interface == ODM_ITRF_SDIO) + odm_schedule_work_item(&sat_tab->hl_smart_antenna_workitem); +#if 0 + /*odm_stall_execution(1);*/ +#endif + #endif + } else if (sat_tab->fix_beam_pattern_en == 0) + PDM_SNPF(out_len, used, output + used, out_len - used, + "[ SmartAnt ] Smart Antenna: Enable\n"); + + } else if (dm_value[0] == 2) { /*set latch time*/ + + sat_tab->latch_time = dm_value[1]; + PHYDM_DBG(dm, DBG_ANT_DIV, "[ SmartAnt ] latch_time =0x%x\n", + sat_tab->latch_time); + } else if (dm_value[0] == 3) { + sat_tab->fix_training_num_en = dm_value[1]; + + if (sat_tab->fix_training_num_en == 1) { + sat_tab->per_beam_training_pkt_num = (u8)dm_value[2]; + sat_tab->decision_holding_period = (u8)dm_value[3]; + + PDM_SNPF(out_len, used, output + used, out_len - used, + "[SmartAnt][Dbg] Fix_train_en = (( %d )), train_pkt_num = (( %d )), holding_period = (( %d )),\n", + sat_tab->fix_training_num_en, + sat_tab->per_beam_training_pkt_num, + sat_tab->decision_holding_period); + + } else if (sat_tab->fix_training_num_en == 0) { + PDM_SNPF(out_len, used, output + used, out_len - used, + "[ SmartAnt ] AUTO per_beam_training_pkt_num\n"); + } + } else if (dm_value[0] == 4) { + if (dm_value[1] == 1) { + sat_tab->ant_num = 1; + sat_tab->first_train_ant = MAIN_ANT; + + } else if (dm_value[1] == 2) { + sat_tab->ant_num = 1; + sat_tab->first_train_ant = AUX_ANT; + + } else if (dm_value[1] == 3) { + sat_tab->ant_num = 2; + sat_tab->first_train_ant = MAIN_ANT; + } + + PDM_SNPF(out_len, used, output + used, out_len - used, + "[ SmartAnt ] Set ant Num = (( %d )), first_train_ant = (( %d ))\n", + sat_tab->ant_num, (sat_tab->first_train_ant - 1)); + } else if (dm_value[0] == 5) { + if (dm_value[1] <= 3) { + sat_tab->rfu_codeword_table[dm_value[1]] = dm_value[2]; + PDM_SNPF(out_len, used, 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++) { + PDM_SNPF(out_len, used, output + used, + out_len - used, + "[ SmartAnt ] Show Beam_2G: (( %d )), RFU codeword table = (( 0x%x ))\n", + i, sat_tab->rfu_codeword_table[i]); + } + } + } else if (dm_value[0] == 6) { + if (dm_value[1] <= 3) { + sat_tab->rfu_codeword_table_5g[dm_value[1]] = dm_value[2]; + PDM_SNPF(out_len, used, 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++) { + PDM_SNPF(out_len, used, output + used, + out_len - used, + "[ SmartAnt ] Show Beam_5G: (( %d )), RFU codeword table = (( 0x%x ))\n", + i, sat_tab->rfu_codeword_table_5g[i]); + } + } + } else if (dm_value[0] == 7) { + if (dm_value[1] <= 4) { + sat_tab->beam_patten_num_each_ant = dm_value[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "[ SmartAnt ] Set Beam number = (( %d ))\n", + sat_tab->beam_patten_num_each_ant); + } else { + PDM_SNPF(out_len, used, output + used, out_len - used, + "[ SmartAnt ] Show Beam number = (( %d ))\n", + sat_tab->beam_patten_num_each_ant); + } + } + *_used = used; + *_out_len = out_len; +} + +void phydm_set_all_ant_same_beam_num( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; + + if (dm->ant_div_type == HL_SW_SMART_ANT_TYPE1) { /*@2ant for 8821A*/ + + sat_tab->rx_idle_beam[0] = sat_tab->fast_training_beam_num; + sat_tab->rx_idle_beam[1] = sat_tab->fast_training_beam_num; + } + + sat_tab->update_beam_codeword = phydm_construct_hl_beam_codeword(dm, + &sat_tab->rx_idle_beam[0], + sat_tab->ant_num); + + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ SmartAnt ] Set all ant beam_pattern: codeword = (( 0x%x ))\n", + sat_tab->update_beam_codeword); + +#if DEV_BUS_TYPE == RT_PCI_INTERFACE + if (dm->support_interface == ODM_ITRF_PCIE) + phydm_update_beam_pattern(dm, sat_tab->update_beam_codeword, sat_tab->rfu_codeword_total_bit_num); +#endif +#if DEV_BUS_TYPE == RT_USB_INTERFACE || DEV_BUS_TYPE == RT_SDIO_INTERFACE + if (dm->support_interface == ODM_ITRF_USB || dm->support_interface == ODM_ITRF_SDIO) + odm_schedule_work_item(&sat_tab->hl_smart_antenna_workitem); +/*odm_stall_execution(1);*/ +#endif +} + +void odm_fast_ant_training_hl_smart_antenna_type1( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; + struct phydm_fat_struct *fat_tab = &dm->dm_fat_table; + struct sw_antenna_switch *dm_swat_table = &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 (!dm->is_linked) { + PHYDM_DBG(dm, DBG_ANT_DIV, "[No Link!!!]\n"); + + if (fat_tab->is_become_linked == true) { + PHYDM_DBG(dm, DBG_ANT_DIV, "Link->no Link\n"); + fat_tab->fat_state = FAT_BEFORE_LINK_STATE; + odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_A); + odm_tx_by_tx_desc_or_reg(dm, TX_BY_REG); + PHYDM_DBG(dm, DBG_ANT_DIV, + "change to (( %d )) FAT_state\n", + fat_tab->fat_state); + + fat_tab->is_become_linked = dm->is_linked; + } + return; + + } else { + if (fat_tab->is_become_linked == false) { + PHYDM_DBG(dm, DBG_ANT_DIV, "[Linked !!!]\n"); + + fat_tab->fat_state = FAT_PREPARE_STATE; + PHYDM_DBG(dm, DBG_ANT_DIV, + "change to (( %d )) FAT_state\n", + fat_tab->fat_state); + +#if 0 + /*sat_tab->fast_training_beam_num = 0;*/ + /*phydm_set_all_ant_same_beam_num(dm);*/ +#endif + + fat_tab->is_become_linked = dm->is_linked; + } + } + + if (!(*fat_tab->p_force_tx_by_desc)) { + if (dm->is_one_entry_only == true) + odm_tx_by_tx_desc_or_reg(dm, TX_BY_REG); + else + odm_tx_by_tx_desc_or_reg(dm, TX_BY_DESC); + } + +#if 0 + /*PHYDM_DBG(dm, DBG_ANT_DIV, "HL Smart ant Training: state (( %d ))\n", fat_tab->fat_state);*/ +#endif + + /* @[DECISION STATE] */ + /*@=======================================================================================*/ + if (fat_tab->fat_state == FAT_DECISION_STATE) { + PHYDM_DBG(dm, DBG_ANT_DIV, "[ 3. In Decision state]\n"); + phydm_fast_training_enable(dm, FAT_OFF); + + break_counter = 0; + /*@compute target beam in each antenna*/ + for (i = (sat_tab->first_train_ant - 1); i < sat_tab->ant_num_total; i++) { + for (j = 0; j < (sat_tab->beam_patten_num_each_ant); j++) { + if (sat_tab->pkt_rssi_cnt[i][j] == 0) { + avg_rssi_tmp = sat_tab->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 = (sat_tab->pkt_rssi_sum[i][j]) / (sat_tab->pkt_rssi_cnt[i][j]); + avg_rssi_tmp_ma = (avg_rssi_tmp + sat_tab->pkt_rssi_pre[i][j]) >> 1; + } + + rssi_sorting_seq[j] = avg_rssi_tmp; + sat_tab->pkt_rssi_pre[i][j] = avg_rssi_tmp; + + PHYDM_DBG(dm, DBG_ANT_DIV, + "ant[%d], Beam[%d]: pkt_cnt=(( %d )), avg_rssi_MA=(( %d )), avg_rssi=(( %d ))\n", + i, j, sat_tab->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*/ + sat_tab->pkt_rssi_sum[i][j] = 0; + sat_tab->pkt_rssi_cnt[i][j] = 0; + } + sat_tab->rx_idle_beam[i] = target_ant_beam[i]; + PHYDM_DBG(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]); + +#if 0 + /*sorting*/ + /*@ + PHYDM_DBG(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(dm, &rssi_sorting_seq[0], &rank_idx_seq[0], &rank_idx_out[0], SUPPORT_BEAM_PATTERN_NUM);*/ + + /*@ + PHYDM_DBG(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(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(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]); + */ +#endif + + if (target_ant_beam_max_rssi[i] > max_beam_ant_rssi) { + target_ant = i; + max_beam_ant_rssi = target_ant_beam_max_rssi[i]; +#if + /*PHYDM_DBG(dm, DBG_ANT_DIV, "Target of ant = (( %d )) max_beam_ant_rssi = (( %d ))\n", + target_ant, max_beam_ant_rssi);*/ +#endif + } + break_counter++; + if (break_counter >= sat_tab->ant_num) + break; + } + +#ifdef CONFIG_FAT_PATCH + break_counter = 0; + for (i = (sat_tab->first_train_ant - 1); i < sat_tab->ant_num_total; i++) { + for (j = 0; j < (sat_tab->beam_patten_num_each_ant); j++) { + per_beam_rssi_diff_tmp = (u8)(max_beam_ant_rssi - sat_tab->pkt_rssi_pre[i][j]); + sat_tab->beam_train_rssi_diff[i][j] = per_beam_rssi_diff_tmp; + + PHYDM_DBG(dm, DBG_ANT_DIV, + "ant[%d], Beam[%d]: RSSI_diff= ((%d))\n", + i, j, per_beam_rssi_diff_tmp); + } + break_counter++; + if (break_counter >= sat_tab->ant_num) + break; + } +#endif + + if (target_ant == 0) + target_ant = MAIN_ANT; + else if (target_ant == 1) + target_ant = AUX_ANT; + + if (sat_tab->ant_num > 1) { + /* @[ update RX ant ]*/ + odm_update_rx_idle_ant(dm, (u8)target_ant); + + /* @[ update TX ant ]*/ + odm_update_tx_ant(dm, (u8)target_ant, (fat_tab->train_idx)); + } + + /*set beam in each antenna*/ + phydm_update_rx_idle_beam(dm); + + odm_ant_div_on_off(dm, ANTDIV_ON, ANT_PATH_A); + fat_tab->fat_state = FAT_PREPARE_STATE; + return; + } + /* @[TRAINING STATE] */ + else if (fat_tab->fat_state == FAT_TRAINING_STATE) { + PHYDM_DBG(dm, DBG_ANT_DIV, "[ 2. In Training state]\n"); + + PHYDM_DBG(dm, DBG_ANT_DIV, + "fat_beam_n = (( %d )), pre_fat_beam_n = (( %d ))\n", + sat_tab->fast_training_beam_num, + sat_tab->pre_fast_training_beam_num); + + if (sat_tab->fast_training_beam_num > sat_tab->pre_fast_training_beam_num) + + sat_tab->force_update_beam_en = 0; + + else { + sat_tab->force_update_beam_en = 1; + + sat_tab->pkt_counter = 0; + beam_tmp = sat_tab->fast_training_beam_num; + if (sat_tab->fast_training_beam_num >= (sat_tab->beam_patten_num_each_ant - 1)) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "[Timeout Update] Beam_num (( %d )) -> (( decision ))\n", + sat_tab->fast_training_beam_num); + fat_tab->fat_state = FAT_DECISION_STATE; + odm_fast_ant_training_hl_smart_antenna_type1(dm); + + } else { + sat_tab->fast_training_beam_num++; + + PHYDM_DBG(dm, DBG_ANT_DIV, + "[Timeout Update] Beam_num (( %d )) -> (( %d ))\n", + beam_tmp, + sat_tab->fast_training_beam_num); + phydm_set_all_ant_same_beam_num(dm); + fat_tab->fat_state = FAT_TRAINING_STATE; + } + } + sat_tab->pre_fast_training_beam_num = sat_tab->fast_training_beam_num; + PHYDM_DBG(dm, DBG_ANT_DIV, + "[prepare state] Update Pre_Beam =(( %d ))\n", + sat_tab->pre_fast_training_beam_num); + } + /* @[Prepare state] */ + /*@=======================================================================================*/ + else if (fat_tab->fat_state == FAT_PREPARE_STATE) { + PHYDM_DBG(dm, DBG_ANT_DIV, "\n\n[ 1. In Prepare state]\n"); + + if (dm->pre_traffic_load == dm->traffic_load) { + if (sat_tab->decision_holding_period != 0) { + PHYDM_DBG(dm, DBG_ANT_DIV, + "Holding_period = (( %d )), return!!!\n", + sat_tab->decision_holding_period); + sat_tab->decision_holding_period--; + return; + } + } + + /* Set training packet number*/ + if (sat_tab->fix_training_num_en == 0) { + switch (dm->traffic_load) { + case TRAFFIC_HIGH: + sat_tab->per_beam_training_pkt_num = 8; + sat_tab->decision_holding_period = 2; + break; + case TRAFFIC_MID: + sat_tab->per_beam_training_pkt_num = 6; + sat_tab->decision_holding_period = 3; + break; + case TRAFFIC_LOW: + sat_tab->per_beam_training_pkt_num = 3; /*ping 60000*/ + sat_tab->decision_holding_period = 4; + break; + case TRAFFIC_ULTRA_LOW: + sat_tab->per_beam_training_pkt_num = 1; + sat_tab->decision_holding_period = 6; + break; + default: + break; + } + } + PHYDM_DBG(dm, DBG_ANT_DIV, + "Fix_training_en = (( %d )), training_pkt_num_base = (( %d )), holding_period = ((%d))\n", + sat_tab->fix_training_num_en, + sat_tab->per_beam_training_pkt_num, + sat_tab->decision_holding_period); + +#ifdef CONFIG_FAT_PATCH + break_counter = 0; + for (i = (sat_tab->first_train_ant - 1); i < sat_tab->ant_num_total; i++) { + for (j = 0; j < (sat_tab->beam_patten_num_each_ant); j++) { + per_beam_rssi_diff_tmp = sat_tab->beam_train_rssi_diff[i][j]; + training_pkt_num_offset = per_beam_rssi_diff_tmp; + + if (sat_tab->per_beam_training_pkt_num > training_pkt_num_offset) + sat_tab->beam_train_cnt[i][j] = sat_tab->per_beam_training_pkt_num - training_pkt_num_offset; + else + sat_tab->beam_train_cnt[i][j] = 1; + + PHYDM_DBG(dm, DBG_ANT_DIV, + "ant[%d]: Beam_num-(( %d )) training_pkt_num = ((%d))\n", + i, j, sat_tab->beam_train_cnt[i][j]); + } + break_counter++; + if (break_counter >= sat_tab->ant_num) + break; + } + + phydm_fast_training_enable(dm, FAT_OFF); + sat_tab->pre_beacon_counter = sat_tab->beacon_counter; + sat_tab->update_beam_idx = 0; + + if (*dm->band_type == ODM_BAND_5G) { + PHYDM_DBG(dm, DBG_ANT_DIV, "Set 5G ant\n"); + /*used_ant = (sat_tab->first_train_ant == MAIN_ANT) ? AUX_ANT : MAIN_ANT;*/ + used_ant = sat_tab->first_train_ant; + } else { + PHYDM_DBG(dm, DBG_ANT_DIV, "Set 2.4G ant\n"); + used_ant = sat_tab->first_train_ant; + } + + odm_update_rx_idle_ant(dm, (u8)used_ant); + +#else + /* Set training MAC addr. of target */ + odm_set_next_mac_addr_target(dm); + phydm_fast_training_enable(dm, FAT_ON); +#endif + + odm_ant_div_on_off(dm, ANTDIV_OFF, ANT_PATH_A); + sat_tab->pkt_counter = 0; + sat_tab->fast_training_beam_num = 0; + phydm_set_all_ant_same_beam_num(dm); + sat_tab->pre_fast_training_beam_num = sat_tab->fast_training_beam_num; + fat_tab->fat_state = FAT_TRAINING_STATE; + } +} + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + +void phydm_beam_switch_workitem_callback( + void *context) +{ + void *adapter = (void *)context; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + struct dm_struct *dm = &hal_data->DM_OutSrc; + struct smt_ant_honbo *sat_tab = &dm->dm_sat_table; + +#if DEV_BUS_TYPE != RT_PCI_INTERFACE + sat_tab->pkt_skip_statistic_en = 1; +#endif + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ SmartAnt ] Beam Switch Workitem Callback, pkt_skip_statistic_en = (( %d ))\n", + sat_tab->pkt_skip_statistic_en); + + phydm_update_beam_pattern(dm, sat_tab->update_beam_codeword, sat_tab->rfu_codeword_total_bit_num); + +#if DEV_BUS_TYPE != RT_PCI_INTERFACE +#if 0 + /*odm_stall_execution(sat_tab->latch_time);*/ +#endif + sat_tab->pkt_skip_statistic_en = 0; +#endif + PHYDM_DBG(dm, DBG_ANT_DIV, + "pkt_skip_statistic_en = (( %d )), latch_time = (( %d ))\n", + sat_tab->pkt_skip_statistic_en, sat_tab->latch_time); +} + +void phydm_beam_decision_workitem_callback( + void *context) +{ + void *adapter = (void *)context; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + struct dm_struct *dm = &hal_data->DM_OutSrc; + + PHYDM_DBG(dm, DBG_ANT_DIV, + "[ SmartAnt ] Beam decision Workitem Callback\n"); + odm_fast_ant_training_hl_smart_antenna_type1(dm); +} +#endif + +#endif /*@#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1*/ + +#endif /*@#ifdef CONFIG_HL_SMART_ANTENNA*/ + +void phydm_smt_ant_config( + void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct smt_ant *smtant_table = &dm->smtant_table; + +#if (defined(CONFIG_CUMITEK_SMART_ANTENNA)) + + dm->support_ability |= ODM_BB_SMT_ANT; + smtant_table->smt_ant_vendor = SMTANT_CUMITEK; + smtant_table->smt_ant_type = 1; +#if (RTL8822B_SUPPORT == 1) + dm->rfe_type = SMTANT_TMP_RFE_TYPE; +#endif +#elif (defined(CONFIG_HL_SMART_ANTENNA)) + + dm->support_ability |= ODM_BB_SMT_ANT; + smtant_table->smt_ant_vendor = SMTANT_HON_BO; + +#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 + smtant_table->smt_ant_type = 1; +#endif + +#ifdef CONFIG_HL_SMART_ANTENNA_TYPE2 + smtant_table->smt_ant_type = 2; +#endif +#endif + + PHYDM_DBG(dm, DBG_SMT_ANT, + "[SmtAnt Config] Vendor=((%d)), Smt_ant_type =((%d))\n", + smtant_table->smt_ant_vendor, smtant_table->smt_ant_type); +} + +void phydm_smt_ant_init(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct smt_ant *smtant_table = &dm->smtant_table; + + phydm_smt_ant_config(dm); + + if (smtant_table->smt_ant_vendor == SMTANT_CUMITEK) { +#if (defined(CONFIG_CUMITEK_SMART_ANTENNA)) +#if (RTL8822B_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8822B) + phydm_cumitek_smt_ant_init_8822b(dm); +#endif + +#if (RTL8197F_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8197F) + phydm_cumitek_smt_ant_init_8197f(dm); +#endif +/*@jj add 20170822*/ +#if (RTL8192F_SUPPORT == 1) + if (dm->support_ic_type == ODM_RTL8192F) + phydm_cumitek_smt_ant_init_8192f(dm); +#endif +#endif /*@#if (defined(CONFIG_CUMITEK_SMART_ANTENNA))*/ + + } else if (smtant_table->smt_ant_vendor == SMTANT_HON_BO) { +#if (defined(CONFIG_HL_SMART_ANTENNA)) +#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 + if (dm->support_ic_type == ODM_RTL8821) + phydm_hl_smart_ant_type1_init_8821a(dm); +#endif + +#ifdef CONFIG_HL_SMART_ANTENNA_TYPE2 + if (dm->support_ic_type == ODM_RTL8822B) + phydm_hl_smart_ant_type2_init_8822b(dm); +#endif +#endif /*@#if (defined(CONFIG_HL_SMART_ANTENNA))*/ + } +} +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_smt_ant.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_smt_ant.h new file mode 100644 index 000000000000..60db8c33af58 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_smt_ant.h @@ -0,0 +1,211 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +#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 *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 *dm_void, + u8 rx_ant_idx_path_a, + u8 rx_ant_idx_path_b); + +void phydm_cumitek_smt_ant_debug( + void *dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len); + +#endif + +#if (defined(CONFIG_HL_SMART_ANTENNA)) +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +void phydm_beam_switch_workitem_callback( + void *context); + +void phydm_beam_decision_workitem_callback( + void *context); +#endif /*@#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ + +#ifdef CONFIG_HL_SMART_ANTENNA_TYPE2 +void phydm_hl_smart_ant_type2_init_8822b( + void *dm_void); + +void phydm_update_beam_pattern_type2( + void *dm_void, + u32 codeword, + u32 codeword_length); + +void phydm_set_rfu_beam_pattern_type2( + void *dm_void); + +void phydm_hl_smt_ant_dbg_type2( + void *dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len); + +void phydm_process_rssi_for_hb_smtant_type2( + void *dm_void, + void *phy_info_void, + void *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 *dm_void, + u32 codeword, + u32 codeword_length); + +void phydm_set_all_ant_same_beam_num( + void *dm_void); + +void phydm_hl_smart_ant_debug( + void *dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len); + +#endif /*@#if (defined(CONFIG_HL_SMART_ANTENNA_TYPE1))*/ +#endif /*@#if (defined(CONFIG_HL_SMART_ANTENNA))*/ +void phydm_smt_ant_init(void *dm_void); +#endif /*@#if (defined(CONFIG_SMART_ANTENNA))*/ +#endif \ No newline at end of file diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_soml.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_soml.c new file mode 100644 index 000000000000..8e9f0018c71a --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_soml.c @@ -0,0 +1,1447 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ + +/************************************************************* + * include files + ************************************************************/ + +#include "mp_precomp.h" +#include "phydm_precomp.h" + +#ifdef CONFIG_ADAPTIVE_SOML + +void phydm_dynamicsoftmletting(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 ret_val; + +#if (RTL8822B_SUPPORT == 1) + if (!*dm->mp_mode) { + if (dm->support_ic_type & ODM_RTL8822B) { + if (!dm->is_linked | dm->iot_table.is_linked_cmw500) + return; + + if (dm->bsomlenabled) { + PHYDM_DBG(dm, ODM_COMP_API, + "PHYDM_DynamicSoftMLSetting(): SoML has been enable, skip dynamic SoML switch\n"); + return; + } + + ret_val = odm_get_bb_reg(dm, R_0xf8c, MASKBYTE0); + PHYDM_DBG(dm, ODM_COMP_API, + "PHYDM_DynamicSoftMLSetting(): Read 0xF8C = 0x%08X\n", + ret_val); + + if (ret_val < 0x16) { + PHYDM_DBG(dm, ODM_COMP_API, + "PHYDM_DynamicSoftMLSetting(): 0xF8C(== 0x%08X) < 0x16, enable SoML\n", + ret_val); + phydm_somlrxhp_setting(dm, true); +#if 0 + /*odm_set_bb_reg(dm, R_0x19a8, MASKDWORD, 0xc10a0000);*/ +#endif + dm->bsomlenabled = true; + } + } + } +#endif +} + +void phydm_soml_on_off(void *dm_void, u8 swch) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct adaptive_soml *soml_tab = &dm->dm_soml_table; + + if (swch == SOML_ON) { + PHYDM_DBG(dm, DBG_ADPTV_SOML, "(( Turn on )) SOML\n"); + + if (dm->support_ic_type & (ODM_RTL8197F | ODM_RTL8192F)) + odm_set_bb_reg(dm, R_0x998, BIT(6), swch); +#if (RTL8822B_SUPPORT == 1) + else if (dm->support_ic_type == ODM_RTL8822B) + phydm_somlrxhp_setting(dm, true); +#endif + + } else if (swch == SOML_OFF) { + PHYDM_DBG(dm, DBG_ADPTV_SOML, "(( Turn off )) SOML\n"); + + if (dm->support_ic_type & (ODM_RTL8197F | ODM_RTL8192F)) + odm_set_bb_reg(dm, R_0x998, BIT(6), swch); +#if (RTL8822B_SUPPORT == 1) + else if (dm->support_ic_type == ODM_RTL8822B) + phydm_somlrxhp_setting(dm, false); +#endif + } + soml_tab->soml_on_off = swch; +} + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +void phydm_adaptive_soml_callback(struct phydm_timer_list *timer) +{ + void *adapter = (void *)timer->Adapter; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + struct dm_struct *dm = &hal_data->DM_OutSrc; + struct adaptive_soml *soml_tab = &dm->dm_soml_table; + + #if DEV_BUS_TYPE == RT_PCI_INTERFACE + #if USE_WORKITEM + odm_schedule_work_item(&soml_tab->phydm_adaptive_soml_workitem); + #else + { +#if 0 + /*@dbg_print("%s\n",__func__);*/ +#endif + phydm_adsl(dm); + } + #endif + #else + odm_schedule_work_item(&soml_tab->phydm_adaptive_soml_workitem); + #endif +} + +void phydm_adaptive_soml_workitem_callback(void *context) +{ +#ifdef CONFIG_ADAPTIVE_SOML + void *adapter = (void *)context; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + struct dm_struct *dm = &hal_data->DM_OutSrc; + +#if 0 + /*@dbg_print("%s\n",__func__);*/ +#endif + phydm_adsl(dm); +#endif +} + +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) +void phydm_adaptive_soml_callback(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + void *padapter = dm->adapter; + + if (*dm->is_net_closed == true) + return; + if (dm->support_interface == ODM_ITRF_PCIE) + phydm_adsl(dm); + else { + /* @Can't do I/O in timer callback*/ + phydm_run_in_thread_cmd(dm, + phydm_adaptive_soml_workitem_callback, + dm); + } +} + +void phydm_adaptive_soml_workitem_callback(void *context) +{ + struct dm_struct *dm = (void *)context; + +#if 0 + /*@dbg_print("%s\n",__func__);*/ +#endif + phydm_adsl(dm); +} + +#else +void phydm_adaptive_soml_callback(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + PHYDM_DBG(dm, DBG_ADPTV_SOML, "******SOML_Callback******\n"); + phydm_adsl(dm); +} +#endif + +void phydm_rx_rate_for_soml(void *dm_void, void *pkt_info_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct adaptive_soml *soml_tab = &dm->dm_soml_table; + struct phydm_perpkt_info_struct *pktinfo = NULL; + u8 data_rate; + + pktinfo = (struct phydm_perpkt_info_struct *)pkt_info_void; + data_rate = (pktinfo->data_rate & 0x7f); + + if (pktinfo->data_rate >= ODM_RATEMCS0 && + pktinfo->data_rate <= ODM_RATEMCS31) + soml_tab->ht_cnt[data_rate - ODM_RATEMCS0]++; + else if ((pktinfo->data_rate >= ODM_RATEVHTSS1MCS0) && + (pktinfo->data_rate <= ODM_RATEVHTSS4MCS9)) + soml_tab->vht_cnt[data_rate - ODM_RATEVHTSS1MCS0]++; +} + +void phydm_rx_qam_for_soml(void *dm_void, void *pkt_info_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct adaptive_soml *soml_tab = &dm->dm_soml_table; + struct phydm_perpkt_info_struct *pktinfo = NULL; + u8 date_rate; + + pktinfo = (struct phydm_perpkt_info_struct *)pkt_info_void; + date_rate = (pktinfo->data_rate & 0x7f); + if (soml_tab->soml_state_cnt < (soml_tab->soml_train_num << 1)) { + if (soml_tab->soml_on_off == SOML_ON) { + return; + } else if (soml_tab->soml_on_off == SOML_OFF) { + if (date_rate >= ODM_RATEMCS8 && + date_rate <= ODM_RATEMCS10) + soml_tab->num_ht_qam[BPSK_QPSK]++; + + else if ((date_rate >= ODM_RATEMCS11) && + (date_rate <= ODM_RATEMCS12)) + soml_tab->num_ht_qam[QAM16]++; + + else if ((date_rate >= ODM_RATEMCS13) && + (date_rate <= ODM_RATEMCS15)) + soml_tab->num_ht_qam[QAM64]++; + + else if ((date_rate >= ODM_RATEVHTSS2MCS0) && + (date_rate <= ODM_RATEVHTSS2MCS2)) + soml_tab->num_vht_qam[BPSK_QPSK]++; + + else if ((date_rate >= ODM_RATEVHTSS2MCS3) && + (date_rate <= ODM_RATEVHTSS2MCS4)) + soml_tab->num_vht_qam[QAM16]++; + + else if ((date_rate >= ODM_RATEVHTSS2MCS5) && + (date_rate <= ODM_RATEVHTSS2MCS5)) + soml_tab->num_vht_qam[QAM64]++; + + else if ((date_rate >= ODM_RATEVHTSS2MCS8) && + (date_rate <= ODM_RATEVHTSS2MCS9)) + soml_tab->num_vht_qam[QAM256]++; + } + } +} + +void phydm_soml_reset_rx_rate(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct adaptive_soml *soml_tab = &dm->dm_soml_table; + u8 order; + + for (order = 0; order < HT_RATE_IDX; order++) { + soml_tab->ht_cnt[order] = 0; + soml_tab->pre_ht_cnt[order] = 0; + soml_tab->ht_cnt_on[order] = 0; + soml_tab->ht_cnt_off[order] = 0; + soml_tab->ht_crc_ok_cnt_on[order] = 0; + soml_tab->ht_crc_fail_cnt_on[order] = 0; + soml_tab->ht_crc_ok_cnt_off[order] = 0; + soml_tab->ht_crc_fail_cnt_off[order] = 0; + } + + for (order = 0; order < VHT_RATE_IDX; order++) { + soml_tab->vht_cnt[order] = 0; + soml_tab->pre_vht_cnt[order] = 0; + soml_tab->vht_cnt_on[order] = 0; + soml_tab->vht_cnt_off[order] = 0; + soml_tab->vht_crc_ok_cnt_on[order] = 0; + soml_tab->vht_crc_fail_cnt_on[order] = 0; + soml_tab->vht_crc_ok_cnt_off[order] = 0; + soml_tab->vht_crc_fail_cnt_off[order] = 0; + } +} + +void phydm_soml_reset_qam(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct adaptive_soml *soml_tab = &dm->dm_soml_table; + u8 order; + + for (order = 0; order < HT_ORDER_TYPE; order++) + soml_tab->num_ht_qam[order] = 0; + + for (order = 0; order < VHT_ORDER_TYPE; order++) + soml_tab->num_vht_qam[order] = 0; +} + +void phydm_soml_cfo_process(void *dm_void, s32 *diff_a, s32 *diff_b) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 value32, value32_1, value32_2, value32_3; + s32 cfo_acq_a, cfo_acq_b, cfo_end_a, cfo_end_b; + + value32 = odm_get_bb_reg(dm, R_0xd10, MASKDWORD); + value32_1 = odm_get_bb_reg(dm, R_0xd14, MASKDWORD); + value32_2 = odm_get_bb_reg(dm, R_0xd50, MASKDWORD); + value32_3 = odm_get_bb_reg(dm, R_0xd54, MASKDWORD); + + cfo_acq_a = (s32)((value32 & 0x1fff0000) >> 16); + cfo_end_a = (s32)((value32_1 & 0x1fff0000) >> 16); + cfo_acq_b = (s32)((value32_2 & 0x1fff0000) >> 16); + cfo_end_b = (s32)((value32_3 & 0x1fff0000) >> 16); + + *diff_a = ((cfo_acq_a >= cfo_end_a) ? (cfo_acq_a - cfo_end_a) : + (cfo_end_a - cfo_acq_a)); + *diff_b = ((cfo_acq_b >= cfo_end_b) ? (cfo_acq_b - cfo_end_b) : + (cfo_end_b - cfo_acq_b)); + + *diff_a = ((*diff_a * 312) + (*diff_a >> 1)) >> 12; /* @312.5/2^12 */ + *diff_b = ((*diff_b * 312) + (*diff_b >> 1)) >> 12; /* @312.5/2^12 */ +} + +void phydm_soml_debug(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct adaptive_soml *soml_tab = &dm->dm_soml_table; + u32 used = *_used; + u32 out_len = *_out_len; + u32 dm_value[10] = {0}; + u8 i = 0, input_idx = 0; + + for (i = 0; i < 5; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &dm_value[i]); + input_idx++; + } + } + + if (input_idx == 0) + return; + + if (dm_value[0] == 1) { /*Turn on/off SOML*/ + soml_tab->soml_select = (u8)dm_value[1]; + + } else if (dm_value[0] == 2) { /*training number for SOML*/ + + soml_tab->soml_train_num = (u8)dm_value[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "soml_train_num = ((%d))\n", + soml_tab->soml_train_num); + } else if (dm_value[0] == 3) { /*training interval for SOML*/ + + soml_tab->soml_intvl = (u8)dm_value[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "soml_intvl = ((%d))\n", soml_tab->soml_intvl); + } else if (dm_value[0] == 4) { /*@function period for SOML*/ + + soml_tab->soml_period = (u8)dm_value[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "soml_period = ((%d))\n", soml_tab->soml_period); + } else if (dm_value[0] == 5) { /*@delay_time for SOML*/ + + soml_tab->soml_delay_time = (u8)dm_value[1]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "soml_delay_time = ((%d))\n", + soml_tab->soml_delay_time); + } else if (dm_value[0] == 6) { /* @for SOML Rx QAM distribution th*/ + if (dm_value[1] == 256) { + soml_tab->qam256_dist_th = (u8)dm_value[2]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "qam256_dist_th = ((%d))\n", + soml_tab->qam256_dist_th); + } else if (dm_value[1] == 64) { + soml_tab->qam64_dist_th = (u8)dm_value[2]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "qam64_dist_th = ((%d))\n", + soml_tab->qam64_dist_th); + } else if (dm_value[1] == 16) { + soml_tab->qam16_dist_th = (u8)dm_value[2]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "qam16_dist_th = ((%d))\n", + soml_tab->qam16_dist_th); + } else if (dm_value[1] == 4) { + soml_tab->bpsk_qpsk_dist_th = (u8)dm_value[2]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "bpsk_qpsk_dist_th = ((%d))\n", + soml_tab->bpsk_qpsk_dist_th); + } + } else if (dm_value[0] == 7) { /* @for SOML cfo th*/ + if (dm_value[1] == 256) { + soml_tab->cfo_qam256_th = (u8)dm_value[2]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "cfo_qam256_th = ((%d KHz))\n", + soml_tab->cfo_qam256_th); + } else if (dm_value[1] == 64) { + soml_tab->cfo_qam64_th = (u8)dm_value[2]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "cfo_qam64_th = ((%d KHz))\n", + soml_tab->cfo_qam64_th); + } else if (dm_value[1] == 16) { + soml_tab->cfo_qam16_th = (u8)dm_value[2]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "cfo_qam16_th = ((%d KHz))\n", + soml_tab->cfo_qam16_th); + } else if (dm_value[1] == 4) { + soml_tab->cfo_qpsk_th = (u8)dm_value[2]; + PDM_SNPF(out_len, used, output + used, out_len - used, + "cfo_qpsk_th = ((%d KHz))\n", + soml_tab->cfo_qpsk_th); + } + } else if (dm_value[0] == 100) { + /*show parameters*/ + PDM_SNPF(out_len, used, output + used, out_len - used, + "soml_select = ((%d))\n", soml_tab->soml_select); + PDM_SNPF(out_len, used, output + used, out_len - used, + "soml_train_num = ((%d))\n", + soml_tab->soml_train_num); + PDM_SNPF(out_len, used, output + used, out_len - used, + "soml_intvl = ((%d))\n", soml_tab->soml_intvl); + PDM_SNPF(out_len, used, output + used, out_len - used, + "soml_period = ((%d))\n", soml_tab->soml_period); + PDM_SNPF(out_len, used, output + used, out_len - used, + "soml_delay_time = ((%d))\n\n", + soml_tab->soml_delay_time); + PDM_SNPF(out_len, used, output + used, out_len - used, + "qam256_dist_th = ((%d)), qam64_dist_th = ((%d)), ", + soml_tab->qam256_dist_th, + soml_tab->qam64_dist_th); + PDM_SNPF(out_len, used, output + used, out_len - used, + "qam16_dist_th = ((%d)), bpsk_qpsk_dist_th = ((%d))\n", + soml_tab->qam16_dist_th, + soml_tab->bpsk_qpsk_dist_th); + PDM_SNPF(out_len, used, output + used, out_len - used, + "cfo_qam256_th = ((%d KHz)), cfo_qam64_th = ((%d KHz)), ", + soml_tab->cfo_qam256_th, + soml_tab->cfo_qam64_th); + PDM_SNPF(out_len, used, output + used, out_len - used, + "cfo_qam16_th = ((%d KHz)), cfo_qpsk_th = ((%d KHz))\n", + soml_tab->cfo_qam16_th, + soml_tab->cfo_qpsk_th); + } + *_used = used; + *_out_len = out_len; +} + +void phydm_soml_stats_ht_on(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct adaptive_soml *soml_tab = &dm->dm_soml_table; + u8 i, mcs0; + u16 num_bytes_diff, num_rate_diff; + + mcs0 = ODM_RATEMCS0; + for (i = mcs0; i <= ODM_RATEMCS15; i++) { + num_rate_diff = soml_tab->ht_cnt[i - mcs0] - + soml_tab->pre_ht_cnt[i - mcs0]; + soml_tab->ht_cnt_on[i - mcs0] += num_rate_diff; + soml_tab->pre_ht_cnt[i - mcs0] = soml_tab->ht_cnt[i - mcs0]; + num_bytes_diff = soml_tab->ht_byte[i - mcs0] - + soml_tab->pre_ht_byte[i - mcs0]; + soml_tab->ht_byte_on[i - mcs0] += num_bytes_diff; + soml_tab->pre_ht_byte[i - mcs0] = soml_tab->ht_byte[i - mcs0]; + } +} + +void phydm_soml_stats_ht_off(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct adaptive_soml *soml_tab = &dm->dm_soml_table; + u8 i, mcs0; + u16 num_bytes_diff, num_rate_diff; + + mcs0 = ODM_RATEMCS0; + for (i = mcs0; i <= ODM_RATEMCS15; i++) { + num_rate_diff = soml_tab->ht_cnt[i - mcs0] - + soml_tab->pre_ht_cnt[i - mcs0]; + soml_tab->ht_cnt_off[i - mcs0] += num_rate_diff; + soml_tab->pre_ht_cnt[i - mcs0] = soml_tab->ht_cnt[i - mcs0]; + num_bytes_diff = soml_tab->ht_byte[i - mcs0] - + soml_tab->pre_ht_byte[i - mcs0]; + soml_tab->ht_byte_off[i - mcs0] += num_bytes_diff; + soml_tab->pre_ht_byte[i - mcs0] = soml_tab->ht_byte[i - mcs0]; + } +} + +void phydm_soml_stats_vht_on(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct adaptive_soml *soml_tab = &dm->dm_soml_table; + u8 j, vht0; + u16 num_bytes_diff, num_rate_diff; + + vht0 = ODM_RATEVHTSS1MCS0; + for (j = vht0; j <= ODM_RATEVHTSS2MCS9; j++) { + num_rate_diff = soml_tab->vht_cnt[j - vht0] - + soml_tab->pre_vht_cnt[j - vht0]; + soml_tab->vht_cnt_on[j - vht0] += num_rate_diff; + soml_tab->pre_vht_cnt[j - vht0] = soml_tab->vht_cnt[j - vht0]; + num_bytes_diff = soml_tab->vht_byte[j - vht0] - + soml_tab->pre_vht_byte[j - vht0]; + soml_tab->vht_byte_on[j - vht0] += num_bytes_diff; + soml_tab->pre_vht_byte[j - vht0] = soml_tab->vht_byte[j - vht0]; + } +} + +void phydm_soml_stats_vht_off(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct adaptive_soml *soml_tab = &dm->dm_soml_table; + u8 j, vht0; + u16 num_bytes_diff, num_rate_diff; + + vht0 = ODM_RATEVHTSS1MCS0; + for (j = vht0; j <= ODM_RATEVHTSS2MCS9; j++) { + num_rate_diff = soml_tab->vht_cnt[j - vht0] - + soml_tab->pre_vht_cnt[j - vht0]; + soml_tab->vht_cnt_off[j - vht0] += num_rate_diff; + soml_tab->pre_vht_cnt[j - vht0] = soml_tab->vht_cnt[j - vht0]; + num_bytes_diff = soml_tab->vht_byte[j - vht0] - + soml_tab->pre_vht_byte[j - vht0]; + soml_tab->vht_byte_off[j - vht0] += num_bytes_diff; + soml_tab->pre_vht_byte[j - vht0] = soml_tab->vht_byte[j - vht0]; + } +} + +void phydm_soml_statistics(void *dm_void, u8 on_off_state) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct adaptive_soml *soml_tab = &dm->dm_soml_table; + + if (on_off_state == SOML_ON) { + if (*dm->channel <= 14) + phydm_soml_stats_ht_on(dm); + if (dm->support_ic_type == ODM_RTL8822B) + phydm_soml_stats_vht_on(dm); + } else if (on_off_state == SOML_OFF) { + if (*dm->channel <= 14) + phydm_soml_stats_ht_off(dm); + if (dm->support_ic_type == ODM_RTL8822B) + phydm_soml_stats_vht_off(dm); + } +} + +void phydm_adsl_init_state(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct adaptive_soml *soml_tab = &dm->dm_soml_table; + + u8 next_on_off; + u16 ht_reset[HT_RATE_IDX] = {0}, vht_reset[VHT_RATE_IDX] = {0}; + u8 size = sizeof(ht_reset[0]); + + phydm_soml_reset_rx_rate(dm); + odm_move_memory(dm, soml_tab->ht_byte, ht_reset, + HT_RATE_IDX * size); + odm_move_memory(dm, soml_tab->ht_byte_on, ht_reset, + HT_RATE_IDX * size); + odm_move_memory(dm, soml_tab->ht_byte_off, ht_reset, + HT_RATE_IDX * size); + odm_move_memory(dm, soml_tab->vht_byte, vht_reset, + VHT_RATE_IDX * size); + odm_move_memory(dm, soml_tab->vht_byte_on, vht_reset, + VHT_RATE_IDX * size); + odm_move_memory(dm, soml_tab->vht_byte_off, vht_reset, + VHT_RATE_IDX * size); + if (dm->support_ic_type == ODM_RTL8822B) { + soml_tab->cfo_cnt++; + phydm_soml_cfo_process(dm, + &soml_tab->cfo_diff_a, + &soml_tab->cfo_diff_b); + PHYDM_DBG(dm, DBG_ADPTV_SOML, + "[ (%d) cfo_diff_a = %d KHz; cfo_diff_b = %d KHz ]\n", + soml_tab->cfo_cnt, soml_tab->cfo_diff_a, + soml_tab->cfo_diff_b); + soml_tab->cfo_diff_sum_a += soml_tab->cfo_diff_a; + soml_tab->cfo_diff_sum_b += soml_tab->cfo_diff_b; + } + + soml_tab->is_soml_method_enable = 1; + #if (DM_ODM_SUPPORT_TYPE == ODM_AP) + odm_set_mac_reg(dm, R_0x608, BIT(8), 1); + /*RCR accepts CRC32-Error packets*/ + #endif + soml_tab->get_stats = false; + soml_tab->soml_state_cnt++; + next_on_off = (soml_tab->soml_on_off == SOML_ON) ? SOML_ON : SOML_OFF; + phydm_soml_on_off(dm, next_on_off); + odm_set_timer(dm, &soml_tab->phydm_adaptive_soml_timer, + soml_tab->soml_delay_time); /*@ms*/ +} + +void phydm_adsl_odd_state(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct adaptive_soml *soml_tab = &dm->dm_soml_table; + u16 ht_reset[HT_RATE_IDX] = {0}, vht_reset[VHT_RATE_IDX] = {0}; + u8 size = sizeof(ht_reset[0]); + + soml_tab->get_stats = true; + soml_tab->soml_state_cnt++; + odm_move_memory(dm, soml_tab->pre_ht_cnt, soml_tab->ht_cnt, + HT_RATE_IDX * size); + odm_move_memory(dm, soml_tab->pre_vht_cnt, soml_tab->vht_cnt, + VHT_RATE_IDX * size); + odm_move_memory(dm, soml_tab->pre_ht_byte, soml_tab->ht_byte, + HT_RATE_IDX * size); + odm_move_memory(dm, soml_tab->pre_vht_byte, soml_tab->vht_byte, + VHT_RATE_IDX * size); + + if (dm->support_ic_type == ODM_RTL8822B) { + soml_tab->cfo_cnt++; + phydm_soml_cfo_process(dm, + &soml_tab->cfo_diff_a, + &soml_tab->cfo_diff_b); + PHYDM_DBG(dm, DBG_ADPTV_SOML, + "[ (%d) cfo_diff_a = %d KHz; cfo_diff_b = %d KHz ]\n", + soml_tab->cfo_cnt, soml_tab->cfo_diff_a, + soml_tab->cfo_diff_b); + soml_tab->cfo_diff_sum_a += soml_tab->cfo_diff_a; + soml_tab->cfo_diff_sum_b += soml_tab->cfo_diff_b; + } + odm_set_timer(dm, &soml_tab->phydm_adaptive_soml_timer, + soml_tab->soml_intvl); /*@ms*/ +} + +void phydm_adsl_even_state(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct adaptive_soml *soml_tab = &dm->dm_soml_table; + u8 next_on_off; + + soml_tab->get_stats = false; + if (dm->support_ic_type == ODM_RTL8822B) { + soml_tab->cfo_cnt++; + phydm_soml_cfo_process(dm, + &soml_tab->cfo_diff_a, + &soml_tab->cfo_diff_b); + PHYDM_DBG(dm, DBG_ADPTV_SOML, + "[ (%d) cfo_diff_a = %d KHz; cfo_diff_b = %d KHz ]\n", + soml_tab->cfo_cnt, soml_tab->cfo_diff_a, + soml_tab->cfo_diff_b); + soml_tab->cfo_diff_sum_a += soml_tab->cfo_diff_a; + soml_tab->cfo_diff_sum_b += soml_tab->cfo_diff_b; + } + soml_tab->soml_state_cnt++; + phydm_soml_statistics(dm, soml_tab->soml_on_off); + next_on_off = (soml_tab->soml_on_off == SOML_ON) ? SOML_OFF : SOML_ON; + phydm_soml_on_off(dm, next_on_off); + odm_set_timer(dm, &soml_tab->phydm_adaptive_soml_timer, + soml_tab->soml_delay_time); /*@ms*/ +} + +void phydm_adsl_decision_state(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct adaptive_soml *soml_tab = &dm->dm_soml_table; + boolean on_above = false, off_above = false; + u8 i, max_idx_on = 0, max_idx_off = 0; + u8 next_on_off = soml_tab->soml_last_state; + u8 mcs0 = ODM_RATEMCS0, vht0 = ODM_RATEVHTSS1MCS0; + u8 crc_taget = soml_tab->soml_last_state; + u8 rate_num = 1, ss_shift = 0; + u16 ht_ok_max_on = 0, ht_fail_max_on = 0, utility_on = 0; + u16 ht_ok_max_off = 0, ht_fail_max_off = 0, utility_off = 0; + u16 vht_ok_max_on = 0, vht_fail_max_on = 0; + u16 vht_ok_max_off = 0, vht_fail_max_off = 0; + u16 num_total_qam = 0; + u16 cnt_max_on = 0, cnt_max_off = 0; + u32 ht_total_cnt_on = 0, ht_total_cnt_off = 0; + u32 total_ht_rate_on = 0, total_ht_rate_off = 0; + u32 vht_total_cnt_on = 0, vht_total_cnt_off = 0; + u32 total_vht_rate_on = 0, total_vht_rate_off = 0; + u32 rate_per_pkt_on = 0, rate_per_pkt_off = 0; + s32 cfo_diff_avg_a, cfo_diff_avg_b; + u16 vht_phy_rate_table[] = { + /*@20M*/ + 6, 13, 19, 26, 39, 52, 58, 65, 78, 90, /*@1SS MCS0~9*/ + 13, 26, 39, 52, 78, 104, 117, 130, 156, 180 /*@2SSMCS0~9*/ + }; + + if (dm->support_ic_type & ODM_IC_1SS) + rate_num = 1; + #ifdef PHYDM_COMPILE_ABOVE_2SS + else if (dm->support_ic_type & ODM_IC_2SS) + rate_num = 2; + #endif + #ifdef PHYDM_COMPILE_ABOVE_3SS + else if (dm->support_ic_type & ODM_IC_3SS) + rate_num = 3; + #endif + #ifdef PHYDM_COMPILE_ABOVE_4SS + else if (dm->support_ic_type & ODM_IC_4SS) + rate_num = 4; + #endif + else + pr_debug("%s: mismatch IC type %x\n", __func__, + dm->support_ic_type); + soml_tab->get_stats = false; + #if (DM_ODM_SUPPORT_TYPE == ODM_AP) + odm_set_mac_reg(dm, R_0x608, BIT(8), 0); + /* NOT Accept CRC32 Error packets. */ + #endif + PHYDM_DBG(dm, DBG_ADPTV_SOML, "[Decisoin state ]\n"); + phydm_soml_statistics(dm, soml_tab->soml_on_off); + if (*dm->channel <= 14) { + /* @[Search 1st and 2nd rate by counter] */ + for (i = 0; i < rate_num; i++) { + ss_shift = (i << 3); + PHYDM_DBG(dm, DBG_ADPTV_SOML, + "*ht_cnt_on HT MCS[%d :%d ] = {%d, %d, %d, %d, %d, %d, %d, %d}\n", + (ss_shift), (ss_shift + 7), + soml_tab->ht_cnt_on[ss_shift + 0], + soml_tab->ht_cnt_on[ss_shift + 1], + soml_tab->ht_cnt_on[ss_shift + 2], + soml_tab->ht_cnt_on[ss_shift + 3], + soml_tab->ht_cnt_on[ss_shift + 4], + soml_tab->ht_cnt_on[ss_shift + 5], + soml_tab->ht_cnt_on[ss_shift + 6], + soml_tab->ht_cnt_on[ss_shift + 7]); + } + + for (i = 0; i < rate_num; i++) { + ss_shift = (i << 3); + PHYDM_DBG(dm, DBG_ADPTV_SOML, + "*ht_cnt_off HT MCS[%d :%d ] = {%d, %d, %d, %d, %d, %d, %d, %d}\n", + (ss_shift), (ss_shift + 7), + soml_tab->ht_cnt_off[ss_shift + 0], + soml_tab->ht_cnt_off[ss_shift + 1], + soml_tab->ht_cnt_off[ss_shift + 2], + soml_tab->ht_cnt_off[ss_shift + 3], + soml_tab->ht_cnt_off[ss_shift + 4], + soml_tab->ht_cnt_off[ss_shift + 5], + soml_tab->ht_cnt_off[ss_shift + 6], + soml_tab->ht_cnt_off[ss_shift + 7]); + } + + for (i = 0; i < rate_num; i++) { + ss_shift = (i << 3); + PHYDM_DBG(dm, DBG_ADPTV_SOML, + "*ht_crc_ok_cnt_on HT MCS[%d :%d ] = {%d, %d, %d, %d, %d, %d, %d, %d}\n", + (ss_shift), (ss_shift + 7), + soml_tab->ht_crc_ok_cnt_on[ss_shift + 0], + soml_tab->ht_crc_ok_cnt_on[ss_shift + 1], + soml_tab->ht_crc_ok_cnt_on[ss_shift + 2], + soml_tab->ht_crc_ok_cnt_on[ss_shift + 3], + soml_tab->ht_crc_ok_cnt_on[ss_shift + 4], + soml_tab->ht_crc_ok_cnt_on[ss_shift + 5], + soml_tab->ht_crc_ok_cnt_on[ss_shift + 6], + soml_tab->ht_crc_ok_cnt_on[ss_shift + 7]); + } + + for (i = 0; i < rate_num; i++) { + ss_shift = (i << 3); + PHYDM_DBG(dm, DBG_ADPTV_SOML, + "*ht_crc_fail_cnt_on HT MCS[%d :%d ] = {%d, %d, %d, %d, %d, %d, %d, %d}\n", + (ss_shift), (ss_shift + 7), + soml_tab->ht_crc_fail_cnt_on[ss_shift + 0], + soml_tab->ht_crc_fail_cnt_on[ss_shift + 1], + soml_tab->ht_crc_fail_cnt_on[ss_shift + 2], + soml_tab->ht_crc_fail_cnt_on[ss_shift + 3], + soml_tab->ht_crc_fail_cnt_on[ss_shift + 4], + soml_tab->ht_crc_fail_cnt_on[ss_shift + 5], + soml_tab->ht_crc_fail_cnt_on[ss_shift + 6], + soml_tab->ht_crc_fail_cnt_on[ss_shift + 7]); + } + + for (i = 0; i < rate_num; i++) { + ss_shift = (i << 3); + PHYDM_DBG(dm, DBG_ADPTV_SOML, + "*ht_crc_ok_cnt_off HT MCS[%d :%d ] = {%d, %d, %d, %d, %d, %d, %d, %d}\n", + (ss_shift), (ss_shift + 7), + soml_tab->ht_crc_ok_cnt_off[ss_shift + 0], + soml_tab->ht_crc_ok_cnt_off[ss_shift + 1], + soml_tab->ht_crc_ok_cnt_off[ss_shift + 2], + soml_tab->ht_crc_ok_cnt_off[ss_shift + 3], + soml_tab->ht_crc_ok_cnt_off[ss_shift + 4], + soml_tab->ht_crc_ok_cnt_off[ss_shift + 5], + soml_tab->ht_crc_ok_cnt_off[ss_shift + 6], + soml_tab->ht_crc_ok_cnt_off[ss_shift + 7]); + } + + for (i = 0; i < rate_num; i++) { + ss_shift = (i << 3); + PHYDM_DBG(dm, DBG_ADPTV_SOML, + "*ht_crc_fail_cnt_off HT MCS[%d :%d ] = {%d, %d, %d, %d, %d, %d, %d, %d}\n", + (ss_shift), (ss_shift + 7), + soml_tab->ht_crc_fail_cnt_off[ss_shift + 0], + soml_tab->ht_crc_fail_cnt_off[ss_shift + 1], + soml_tab->ht_crc_fail_cnt_off[ss_shift + 2], + soml_tab->ht_crc_fail_cnt_off[ss_shift + 3], + soml_tab->ht_crc_fail_cnt_off[ss_shift + 4], + soml_tab->ht_crc_fail_cnt_off[ss_shift + 5], + soml_tab->ht_crc_fail_cnt_off[ss_shift + 6], + soml_tab->ht_crc_fail_cnt_off[ss_shift + 7]); + } + for (i = ODM_RATEMCS0; i <= ODM_RATEMCS15; i++) { + ht_total_cnt_on += soml_tab->ht_cnt_on[i - mcs0]; + ht_total_cnt_off += soml_tab->ht_cnt_off[i - mcs0]; + total_ht_rate_on += (soml_tab->ht_cnt_on[i - mcs0] * + phy_rate_table[i]); + total_ht_rate_off += (soml_tab->ht_cnt_off[i - mcs0] * + phy_rate_table[i]); + if (soml_tab->ht_cnt_on[i - mcs0] > cnt_max_on) { + cnt_max_on = soml_tab->ht_cnt_on[i - mcs0]; + max_idx_on = i - mcs0; + } + + if (soml_tab->ht_cnt_off[i - mcs0] > cnt_max_off) { + cnt_max_off = soml_tab->ht_cnt_off[i - mcs0]; + max_idx_off = i - mcs0; + } + } + total_ht_rate_on = total_ht_rate_on << 3; + total_ht_rate_off = total_ht_rate_off << 3; + rate_per_pkt_on = (ht_total_cnt_on != 0) ? + (total_ht_rate_on / ht_total_cnt_on) : 0; + rate_per_pkt_off = (ht_total_cnt_off != 0) ? + (total_ht_rate_off / ht_total_cnt_off) : 0; + #if (DM_ODM_SUPPORT_TYPE == ODM_AP) + ht_ok_max_on = soml_tab->ht_crc_ok_cnt_on[max_idx_on]; + ht_fail_max_on = soml_tab->ht_crc_fail_cnt_on[max_idx_on]; + ht_ok_max_off = soml_tab->ht_crc_ok_cnt_off[max_idx_off]; + ht_fail_max_off = soml_tab->ht_crc_fail_cnt_off[max_idx_off]; + + if (ht_fail_max_on == 0) + ht_fail_max_on = 1; + + if (ht_fail_max_off == 0) + ht_fail_max_off = 1; + + if (ht_ok_max_on > ht_fail_max_on) + on_above = true; + + if (ht_ok_max_off > ht_fail_max_off) + off_above = true; + + if (on_above && !off_above) { + crc_taget = SOML_ON; + } else if (!on_above && off_above) { + crc_taget = SOML_OFF; + } else if (on_above && off_above) { + utility_on = (ht_ok_max_on << 7) / ht_fail_max_on; + utility_off = (ht_ok_max_off << 7) / ht_fail_max_off; + crc_taget = (utility_on == utility_off) ? + (soml_tab->soml_last_state) : + ((utility_on > utility_off) ? SOML_ON : + SOML_OFF); + + } else if (!on_above && !off_above) { + if (ht_ok_max_on == 0) + ht_ok_max_on = 1; + if (ht_ok_max_off == 0) + ht_ok_max_off = 1; + utility_on = (ht_fail_max_on << 7) / ht_ok_max_on; + utility_off = (ht_fail_max_off << 7) / ht_ok_max_off; + crc_taget = (utility_on == utility_off) ? + (soml_tab->soml_last_state) : + ((utility_on < utility_off) ? SOML_ON : + SOML_OFF); + } + #endif + } else if (dm->support_ic_type == ODM_RTL8822B) { + cfo_diff_avg_a = soml_tab->cfo_diff_sum_a / soml_tab->cfo_cnt; + cfo_diff_avg_b = soml_tab->cfo_diff_sum_b / soml_tab->cfo_cnt; + soml_tab->cfo_diff_avg_a = (soml_tab->cfo_cnt != 0) ? + cfo_diff_avg_a : 0; + soml_tab->cfo_diff_avg_b = (soml_tab->cfo_cnt != 0) ? + cfo_diff_avg_b : 0; + PHYDM_DBG(dm, DBG_ADPTV_SOML, + "[ cfo_diff_avg_a = %d KHz; cfo_diff_avg_b = %d KHz]\n", + soml_tab->cfo_diff_avg_a, + soml_tab->cfo_diff_avg_b); + for (i = 0; i < VHT_ORDER_TYPE; i++) + num_total_qam += soml_tab->num_vht_qam[i]; + + PHYDM_DBG(dm, DBG_ADPTV_SOML, + "[ ((2SS)) BPSK_QPSK_count = %d ; 16QAM_count = %d ; 64QAM_count = %d ; 256QAM_count = %d ; num_total_qam = %d]\n", + soml_tab->num_vht_qam[BPSK_QPSK], + soml_tab->num_vht_qam[QAM16], + soml_tab->num_vht_qam[QAM64], + soml_tab->num_vht_qam[QAM256], + num_total_qam); + if (((soml_tab->num_vht_qam[QAM256] * 100) > + (num_total_qam * soml_tab->qam256_dist_th)) && + cfo_diff_avg_a > soml_tab->cfo_qam256_th && + cfo_diff_avg_b > soml_tab->cfo_qam256_th) { + PHYDM_DBG(dm, DBG_ADPTV_SOML, + "[ QAM256_ratio > %d ; cfo_diff_avg_a > %d KHz ==> SOML_OFF]\n", + soml_tab->qam256_dist_th, + soml_tab->cfo_qam256_th); + PHYDM_DBG(dm, DBG_ADPTV_SOML, "[ Final decisoin ] : "); + phydm_soml_on_off(dm, SOML_OFF); + return; + } else if (((soml_tab->num_vht_qam[QAM64] * 100) > + (num_total_qam * soml_tab->qam64_dist_th)) && + (cfo_diff_avg_a > soml_tab->cfo_qam64_th) && + (cfo_diff_avg_b > soml_tab->cfo_qam64_th)) { + PHYDM_DBG(dm, DBG_ADPTV_SOML, + "[ QAM64_ratio > %d ; cfo_diff_avg_a > %d KHz ==> SOML_OFF]\n", + soml_tab->qam64_dist_th, + soml_tab->cfo_qam64_th); + PHYDM_DBG(dm, DBG_ADPTV_SOML, "[ Final decisoin ] : "); + phydm_soml_on_off(dm, SOML_OFF); + return; + } else if (((soml_tab->num_vht_qam[QAM16] * 100) > + (num_total_qam * soml_tab->qam16_dist_th)) && + (cfo_diff_avg_a > soml_tab->cfo_qam16_th) && + (cfo_diff_avg_b > soml_tab->cfo_qam16_th)) { + PHYDM_DBG(dm, DBG_ADPTV_SOML, + "[ QAM16_ratio > %d ; cfo_diff_avg_a > %d KHz ==> SOML_OFF]\n", + soml_tab->qam16_dist_th, + soml_tab->cfo_qam16_th); + PHYDM_DBG(dm, DBG_ADPTV_SOML, "[ Final decisoin ] : "); + phydm_soml_on_off(dm, SOML_OFF); + return; + } else if (((soml_tab->num_vht_qam[BPSK_QPSK] * 100) > + (num_total_qam * soml_tab->bpsk_qpsk_dist_th)) && + (cfo_diff_avg_a > soml_tab->cfo_qpsk_th) && + (cfo_diff_avg_b > soml_tab->cfo_qpsk_th)) { + PHYDM_DBG(dm, DBG_ADPTV_SOML, + "[ BPSK_QPSK_ratio > %d ; cfo_diff_avg_a > %d KHz ==> SOML_OFF]\n", + soml_tab->bpsk_qpsk_dist_th, + soml_tab->cfo_qpsk_th); + PHYDM_DBG(dm, DBG_ADPTV_SOML, "[ Final decisoin ] : "); + phydm_soml_on_off(dm, SOML_OFF); + return; + } + + for (i = 0; i < rate_num; i++) { + ss_shift = 10 * i; + PHYDM_DBG(dm, DBG_ADPTV_SOML, + "[ vht_cnt_on VHT-%d ss MCS[0:9] = {%d, %d, %d, %d, %d, %d, %d, %d, %d, %d} ]\n", + (i + 1), + soml_tab->vht_cnt_on[ss_shift + 0], + soml_tab->vht_cnt_on[ss_shift + 1], + soml_tab->vht_cnt_on[ss_shift + 2], + soml_tab->vht_cnt_on[ss_shift + 3], + soml_tab->vht_cnt_on[ss_shift + 4], + soml_tab->vht_cnt_on[ss_shift + 5], + soml_tab->vht_cnt_on[ss_shift + 6], + soml_tab->vht_cnt_on[ss_shift + 7], + soml_tab->vht_cnt_on[ss_shift + 8], + soml_tab->vht_cnt_on[ss_shift + 9]); + } + + for (i = 0; i < rate_num; i++) { + ss_shift = 10 * i; + PHYDM_DBG(dm, DBG_ADPTV_SOML, + "[ vht_cnt_off VHT-%d ss MCS[0:9] = {%d, %d, %d, %d, %d, %d, %d, %d, %d, %d} ]\n", + (i + 1), + soml_tab->vht_cnt_off[ss_shift + 0], + soml_tab->vht_cnt_off[ss_shift + 1], + soml_tab->vht_cnt_off[ss_shift + 2], + soml_tab->vht_cnt_off[ss_shift + 3], + soml_tab->vht_cnt_off[ss_shift + 4], + soml_tab->vht_cnt_off[ss_shift + 5], + soml_tab->vht_cnt_off[ss_shift + 6], + soml_tab->vht_cnt_off[ss_shift + 7], + soml_tab->vht_cnt_off[ss_shift + 8], + soml_tab->vht_cnt_off[ss_shift + 9]); + } + + for (i = 0; i < rate_num; i++) { + ss_shift = 10 * i; + PHYDM_DBG(dm, DBG_ADPTV_SOML, + "*vht_crc_ok_cnt_on VHT-%d ss MCS[0:9] = {%d, %d, %d, %d, %d, %d, %d, %d, %d, %d}\n", + (i + 1), + soml_tab->vht_crc_ok_cnt_on[ss_shift + 0], + soml_tab->vht_crc_ok_cnt_on[ss_shift + 1], + soml_tab->vht_crc_ok_cnt_on[ss_shift + 2], + soml_tab->vht_crc_ok_cnt_on[ss_shift + 3], + soml_tab->vht_crc_ok_cnt_on[ss_shift + 4], + soml_tab->vht_crc_ok_cnt_on[ss_shift + 5], + soml_tab->vht_crc_ok_cnt_on[ss_shift + 6], + soml_tab->vht_crc_ok_cnt_on[ss_shift + 7], + soml_tab->vht_crc_ok_cnt_on[ss_shift + 8], + soml_tab->vht_crc_ok_cnt_on[ss_shift + 9]); + } + for (i = 0; i < rate_num; i++) { + ss_shift = 10 * i; + PHYDM_DBG(dm, DBG_ADPTV_SOML, + "*vht_crc_fail_cnt_on VHT-%d ss MCS[0:9] = {%d, %d, %d, %d, %d, %d, %d, %d, %d, %d}\n", + (i + 1), + soml_tab->vht_crc_fail_cnt_on[ss_shift + 0], + soml_tab->vht_crc_fail_cnt_on[ss_shift + 1], + soml_tab->vht_crc_fail_cnt_on[ss_shift + 2], + soml_tab->vht_crc_fail_cnt_on[ss_shift + 3], + soml_tab->vht_crc_fail_cnt_on[ss_shift + 4], + soml_tab->vht_crc_fail_cnt_on[ss_shift + 5], + soml_tab->vht_crc_fail_cnt_on[ss_shift + 6], + soml_tab->vht_crc_fail_cnt_on[ss_shift + 7], + soml_tab->vht_crc_fail_cnt_on[ss_shift + 8], + soml_tab->vht_crc_fail_cnt_on[ss_shift + 9]); + } + for (i = 0; i < rate_num; i++) { + ss_shift = 10 * i; + PHYDM_DBG(dm, DBG_ADPTV_SOML, + "*vht_crc_ok_cnt_off VHT-%d ss MCS[0:9] = {%d, %d, %d, %d, %d, %d, %d, %d, %d, %d}\n", + (i + 1), + soml_tab->vht_crc_ok_cnt_off[ss_shift + 0], + soml_tab->vht_crc_ok_cnt_off[ss_shift + 1], + soml_tab->vht_crc_ok_cnt_off[ss_shift + 2], + soml_tab->vht_crc_ok_cnt_off[ss_shift + 3], + soml_tab->vht_crc_ok_cnt_off[ss_shift + 4], + soml_tab->vht_crc_ok_cnt_off[ss_shift + 5], + soml_tab->vht_crc_ok_cnt_off[ss_shift + 6], + soml_tab->vht_crc_ok_cnt_off[ss_shift + 7], + soml_tab->vht_crc_ok_cnt_off[ss_shift + 8], + soml_tab->vht_crc_ok_cnt_off[ss_shift + 9]); + } + for (i = 0; i < rate_num; i++) { + ss_shift = 10 * i; + PHYDM_DBG(dm, DBG_ADPTV_SOML, + "*vht_crc_fail_cnt_off VHT-%d ss MCS[0:9] = {%d, %d, %d, %d, %d, %d, %d, %d, %d, %d}\n", + (i + 1), + soml_tab->vht_crc_fail_cnt_off[ss_shift + 0], + soml_tab->vht_crc_fail_cnt_off[ss_shift + 1], + soml_tab->vht_crc_fail_cnt_off[ss_shift + 2], + soml_tab->vht_crc_fail_cnt_off[ss_shift + 3], + soml_tab->vht_crc_fail_cnt_off[ss_shift + 4], + soml_tab->vht_crc_fail_cnt_off[ss_shift + 5], + soml_tab->vht_crc_fail_cnt_off[ss_shift + 6], + soml_tab->vht_crc_fail_cnt_off[ss_shift + 7], + soml_tab->vht_crc_fail_cnt_off[ss_shift + 8], + soml_tab->vht_crc_fail_cnt_off[ss_shift + 9]); + } + + for (i = ODM_RATEVHTSS2MCS0; i <= ODM_RATEVHTSS2MCS9; i++) { + vht_total_cnt_on += soml_tab->vht_cnt_on[i - vht0]; + vht_total_cnt_off += soml_tab->vht_cnt_off[i - vht0]; + total_vht_rate_on += (soml_tab->vht_cnt_on[i - vht0] * + vht_phy_rate_table[i - vht0]); + total_vht_rate_off += (soml_tab->vht_cnt_off[i - vht0] * + vht_phy_rate_table[i - vht0]); + + if (soml_tab->vht_cnt_on[i - vht0] > cnt_max_on) { + cnt_max_on = soml_tab->vht_cnt_on[i - vht0]; + max_idx_on = i - vht0; + } + + if (soml_tab->vht_cnt_off[i - vht0] > cnt_max_off) { + cnt_max_off = soml_tab->vht_cnt_off[i - vht0]; + max_idx_off = i - vht0; + } + } + total_vht_rate_on = total_vht_rate_on << 3; + total_vht_rate_off = total_vht_rate_off << 3; + rate_per_pkt_on = (vht_total_cnt_on != 0) ? + (total_vht_rate_on / vht_total_cnt_on) : 0; + rate_per_pkt_off = (vht_total_cnt_off != 0) ? + (total_vht_rate_off / vht_total_cnt_off) : 0; + #if (DM_ODM_SUPPORT_TYPE == ODM_AP) + vht_ok_max_on = soml_tab->vht_crc_ok_cnt_on[max_idx_on]; + vht_fail_max_on = soml_tab->vht_crc_fail_cnt_on[max_idx_on]; + vht_ok_max_off = soml_tab->vht_crc_ok_cnt_off[max_idx_off]; + vht_fail_max_off = soml_tab->vht_crc_fail_cnt_off[max_idx_off]; + + if (vht_fail_max_on == 0) + vht_fail_max_on = 1; + + if (vht_fail_max_off == 0) + vht_fail_max_off = 1; + + if (vht_ok_max_on > vht_fail_max_on) + on_above = true; + + if (vht_ok_max_off > vht_fail_max_off) + off_above = true; + + if (on_above && !off_above) { + crc_taget = SOML_ON; + } else if (!on_above && off_above) { + crc_taget = SOML_OFF; + } else if (on_above && off_above) { + utility_on = (vht_ok_max_on << 7) / vht_fail_max_on; + utility_off = (vht_ok_max_off << 7) / vht_fail_max_off; + crc_taget = (utility_on == utility_off) ? + (soml_tab->soml_last_state) : + ((utility_on > utility_off) ? SOML_ON : + SOML_OFF); + + } else if (!on_above && !off_above) { + if (vht_ok_max_on == 0) + vht_ok_max_on = 1; + if (vht_ok_max_off == 0) + vht_ok_max_off = 1; + utility_on = (vht_fail_max_on << 7) / vht_ok_max_on; + utility_off = (vht_fail_max_off << 7) / vht_ok_max_off; + crc_taget = (utility_on == utility_off) ? + (soml_tab->soml_last_state) : + ((utility_on < utility_off) ? SOML_ON : + SOML_OFF); + } + #endif + + } + + /* @[Decision] */ + PHYDM_DBG(dm, DBG_ADPTV_SOML, + "[ rate_per_pkt_on = %d ; rate_per_pkt_off = %d ]\n", + rate_per_pkt_on, rate_per_pkt_off); + #if (DM_ODM_SUPPORT_TYPE == ODM_AP) + if (max_idx_on == max_idx_off && max_idx_on != 0) { + PHYDM_DBG(dm, DBG_ADPTV_SOML, + "[ max_idx_on == max_idx_off ]\n"); + PHYDM_DBG(dm, DBG_ADPTV_SOML, + "[ max_idx = %d, crc_utility_on = %d, crc_utility_off = %d, crc_target = %d]\n", + max_idx_on, utility_on, utility_off, + crc_taget); + next_on_off = crc_taget; + } else + #endif + if (rate_per_pkt_on > rate_per_pkt_off) { + next_on_off = SOML_ON; + PHYDM_DBG(dm, DBG_ADPTV_SOML, + "[ rate_per_pkt_on > rate_per_pkt_off ==> SOML_ON ]\n"); + } else if (rate_per_pkt_on < rate_per_pkt_off) { + next_on_off = SOML_OFF; + PHYDM_DBG(dm, DBG_ADPTV_SOML, + "[ rate_per_pkt_on < rate_per_pkt_off ==> SOML_OFF ]\n"); + } else { + PHYDM_DBG(dm, DBG_ADPTV_SOML, + "[ stay at soml_last_state ]\n"); + next_on_off = soml_tab->soml_last_state; + } + + PHYDM_DBG(dm, DBG_ADPTV_SOML, "[ Final decisoin ] : "); + phydm_soml_on_off(dm, next_on_off); + soml_tab->soml_last_state = next_on_off; +} + +void phydm_adsl(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct adaptive_soml *soml_tab = &dm->dm_soml_table; + + if (dm->support_ic_type & PHYDM_ADAPTIVE_SOML_IC) { + PHYDM_DBG(dm, DBG_ADPTV_SOML, "soml_state_cnt =((%d))\n", + soml_tab->soml_state_cnt); + /*Traning state: 0(alt) 1(ori) 2(alt) 3(ori)===============*/ + if (soml_tab->soml_state_cnt < + (soml_tab->soml_train_num << 1)) { + if (soml_tab->soml_state_cnt == 0) + phydm_adsl_init_state(dm); + else if ((soml_tab->soml_state_cnt % 2) != 0) + phydm_adsl_odd_state(dm); + else if ((soml_tab->soml_state_cnt % 2) == 0) + phydm_adsl_even_state(dm); + } else { + phydm_adsl_decision_state(dm); + } + } +} + +void phydm_adaptive_soml_reset(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct adaptive_soml *soml_tab = &dm->dm_soml_table; + + soml_tab->soml_state_cnt = 0; + soml_tab->is_soml_method_enable = 0; + soml_tab->soml_counter = 0; +} + +void phydm_set_adsl_val(void *dm_void, u32 *val_buf, u8 val_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + if (val_len != 1) { + PHYDM_DBG(dm, ODM_COMP_API, "[Error][ADSL]Need val_len=1\n"); + return; + } + + phydm_soml_on_off(dm, (u8)val_buf[1]); +} + +void phydm_soml_crc_acq(void *dm_void, u8 rate_id, boolean crc32, u32 length) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct adaptive_soml *soml_tab = &dm->dm_soml_table; + u8 offset = 0; + + if (!soml_tab->get_stats) + return; + if (length < 1400) + return; + + if (soml_tab->soml_on_off == SOML_ON) { + if (rate_id >= ODM_RATEMCS0 && rate_id <= ODM_RATEMCS15) { + offset = rate_id - ODM_RATEMCS0; + if (crc32 == CRC_OK) + soml_tab->ht_crc_ok_cnt_on[offset]++; + else if (crc32 == CRC_FAIL) + soml_tab->ht_crc_fail_cnt_on[offset]++; + } else if (rate_id >= ODM_RATEVHTSS1MCS0 && + rate_id <= ODM_RATEVHTSS2MCS9) { + offset = rate_id - ODM_RATEVHTSS1MCS0; + if (crc32 == CRC_OK) + soml_tab->vht_crc_ok_cnt_on[offset]++; + else if (crc32 == CRC_FAIL) + soml_tab->vht_crc_fail_cnt_on[offset]++; + } + } else if (soml_tab->soml_on_off == SOML_OFF) { + if (rate_id >= ODM_RATEMCS0 && rate_id <= ODM_RATEMCS15) { + offset = rate_id - ODM_RATEMCS0; + if (crc32 == CRC_OK) + soml_tab->ht_crc_ok_cnt_off[offset]++; + else if (crc32 == CRC_FAIL) + soml_tab->ht_crc_fail_cnt_off[offset]++; + } else if (rate_id >= ODM_RATEVHTSS1MCS0 && + rate_id <= ODM_RATEVHTSS2MCS9) { + offset = rate_id - ODM_RATEVHTSS1MCS0; + if (crc32 == CRC_OK) + soml_tab->vht_crc_ok_cnt_off[offset]++; + else if (crc32 == CRC_FAIL) + soml_tab->vht_crc_fail_cnt_off[offset]++; + } + } +} + +void phydm_soml_bytes_acq(void *dm_void, u8 rate_id, u32 length) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct adaptive_soml *soml_tab = &dm->dm_soml_table; + u8 offset = 0; + + + if (rate_id >= ODM_RATEMCS0 && rate_id <= ODM_RATEMCS31) { + offset = rate_id - ODM_RATEMCS0; + if (offset > (HT_RATE_IDX - 1)) + offset = HT_RATE_IDX - 1; + + soml_tab->ht_byte[offset] += (u16)length; + } else if (rate_id >= ODM_RATEVHTSS1MCS0 && + rate_id <= ODM_RATEVHTSS4MCS9) { + offset = rate_id - ODM_RATEVHTSS1MCS0; + if (offset > (VHT_RATE_IDX - 1)) + offset = VHT_RATE_IDX - 1; + + soml_tab->vht_byte[offset] += (u16)length; + } +} + +#if defined(CONFIG_RTL_TRIBAND_SUPPORT) && defined(CONFIG_USB_HCI) +#define INIT_TIMER_EVENT_ENTRY(_entry, _func, _data) \ + do { \ + _rtw_init_listhead(&(_entry)->list); \ + (_entry)->data = (_data); \ + (_entry)->function = (_func); \ + } while (0) + +static void pre_phydm_adaptive_soml_callback(unsigned long task_dm) +{ + struct dm_struct *dm = (struct dm_struct *)task_dm; + struct rtl8192cd_priv *priv = dm->priv; + struct priv_shared_info *pshare = priv->pshare; + + if (pshare->bDriverStopped || pshare->bSurpriseRemoved) { + printk("[%s] bDriverStopped(%d) OR bSurpriseRemoved(%d)\n", + __FUNCTION__, pshare->bDriverStopped, + pshare->bSurpriseRemoved); + return; + } + + rtw_enqueue_timer_event(priv, &pshare->adaptive_soml_event, + ENQUEUE_TO_TAIL); +} + +void phydm_adaptive_soml_timers_usb(void *dm_void, u8 state) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct adaptive_soml *soml_tab = &dm->dm_soml_table; + struct rtl8192cd_priv *priv = dm->priv; + + if (state == INIT_SOML_TIMMER) { + init_timer(&soml_tab->phydm_adaptive_soml_timer); + soml_tab->phydm_adaptive_soml_timer.data = (unsigned long)dm; + soml_tab->phydm_adaptive_soml_timer.function = pre_phydm_adaptive_soml_callback; + INIT_TIMER_EVENT_ENTRY(&priv->pshare->adaptive_soml_event, + phydm_adaptive_soml_callback, + (unsigned long)dm); + } else if (state == CANCEL_SOML_TIMMER) { + odm_cancel_timer(dm, &soml_tab->phydm_adaptive_soml_timer); + } else if (state == RELEASE_SOML_TIMMER) { + odm_release_timer(dm, &soml_tab->phydm_adaptive_soml_timer); + } +} +#endif /* defined(CONFIG_RTL_TRIBAND_SUPPORT) && defined(CONFIG_USB_HCI) */ + +void phydm_adaptive_soml_timers(void *dm_void, u8 state) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct adaptive_soml *soml_tab = &dm->dm_soml_table; + +#if defined(CONFIG_RTL_TRIBAND_SUPPORT) && defined(CONFIG_USB_HCI) + struct rtl8192cd_priv *priv = dm->priv; + + if (priv->hci_type == RTL_HCI_USB) { + phydm_adaptive_soml_timers_usb(dm_void, state); + } else +#endif /* defined(CONFIG_RTL_TRIBAND_SUPPORT) && defined(CONFIG_USB_HCI) */ + { + if (state == INIT_SOML_TIMMER) { + odm_initialize_timer(dm, &soml_tab->phydm_adaptive_soml_timer, + (void *)phydm_adaptive_soml_callback, NULL, + "phydm_adaptive_soml_timer"); + } else if (state == CANCEL_SOML_TIMMER) { + odm_cancel_timer(dm, &soml_tab->phydm_adaptive_soml_timer); + } else if (state == RELEASE_SOML_TIMMER) { + odm_release_timer(dm, &soml_tab->phydm_adaptive_soml_timer); + } + } +} + +void phydm_adaptive_soml_init(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct adaptive_soml *soml_tab = &dm->dm_soml_table; +#if 0 + if (!(dm->support_ability & ODM_BB_ADAPTIVE_SOML)) { + PHYDM_DBG(dm, DBG_ADPTV_SOML, + "[Return] Not Support Adaptive SOML\n"); + return; + } +#endif + PHYDM_DBG(dm, DBG_ADPTV_SOML, "%s\n", __func__); + + soml_tab->soml_state_cnt = 0; + soml_tab->soml_delay_time = 40; + soml_tab->soml_intvl = 150; + soml_tab->soml_train_num = 4; + soml_tab->is_soml_method_enable = 0; + soml_tab->soml_counter = 0; +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + soml_tab->soml_period = 1; +#else + soml_tab->soml_period = 4; +#endif + soml_tab->soml_select = 0; + soml_tab->cfo_cnt = 0; + soml_tab->cfo_diff_sum_a = 0; + soml_tab->cfo_diff_sum_b = 0; + + soml_tab->cfo_qpsk_th = 94; + soml_tab->cfo_qam16_th = 38; + soml_tab->cfo_qam64_th = 17; + soml_tab->cfo_qam256_th = 7; + + soml_tab->bpsk_qpsk_dist_th = 20; + soml_tab->qam16_dist_th = 20; + soml_tab->qam64_dist_th = 20; + soml_tab->qam256_dist_th = 20; + + if (dm->support_ic_type & (ODM_RTL8197F | ODM_RTL8192F)) + odm_set_bb_reg(dm, 0x988, BIT(25), 1); +} + +void phydm_adaptive_soml(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct adaptive_soml *soml_tab = &dm->dm_soml_table; + + if (!(dm->support_ability & ODM_BB_ADAPTIVE_SOML)) { + PHYDM_DBG(dm, DBG_ADPTV_SOML, + "[Return!!!] Not Support Adaptive SOML Function\n"); + return; + } + + if (dm->pause_ability & ODM_BB_ADAPTIVE_SOML) { + PHYDM_DBG(dm, DBG_ADPTV_SOML, "Return: Pause ADSL in LV=%d\n", + dm->pause_lv_table.lv_adsl); + return; + } + + if (soml_tab->soml_counter < soml_tab->soml_period) { + soml_tab->soml_counter++; + return; + } + soml_tab->soml_counter = 0; + soml_tab->soml_state_cnt = 0; + soml_tab->cfo_cnt = 0; + soml_tab->cfo_diff_sum_a = 0; + soml_tab->cfo_diff_sum_b = 0; + + phydm_soml_reset_qam(dm); + + if (soml_tab->soml_select == 0) { + PHYDM_DBG(dm, DBG_ADPTV_SOML, + "[ Adaptive SOML Training !!!]\n"); + } else if (soml_tab->soml_select == 1) { + PHYDM_DBG(dm, DBG_ADPTV_SOML, "[ Stop Adaptive SOML !!!]\n"); + phydm_soml_on_off(dm, SOML_ON); + return; + } else if (soml_tab->soml_select == 2) { + PHYDM_DBG(dm, DBG_ADPTV_SOML, "[ Stop Adaptive SOML !!!]\n"); + phydm_soml_on_off(dm, SOML_OFF); + return; + } + + if (dm->support_ic_type & PHYDM_ADAPTIVE_SOML_IC) + phydm_adsl(dm); +} + +void phydm_enable_adaptive_soml(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + PHYDM_DBG(dm, DBG_ADPTV_SOML, "[%s]\n", __func__); + dm->support_ability |= ODM_BB_ADAPTIVE_SOML; + phydm_soml_on_off(dm, SOML_ON); +} + +void phydm_stop_adaptive_soml(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + PHYDM_DBG(dm, DBG_ADPTV_SOML, "[%s]\n", __func__); + dm->support_ability &= ~ODM_BB_ADAPTIVE_SOML; + phydm_soml_on_off(dm, SOML_ON); +} + +void phydm_adaptive_soml_para_set(void *dm_void, u8 train_num, u8 intvl, + u8 period, u8 delay_time) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct adaptive_soml *soml_tab = &dm->dm_soml_table; + + soml_tab->soml_train_num = train_num; + soml_tab->soml_intvl = intvl; + soml_tab->soml_period = period; + soml_tab->soml_delay_time = delay_time; +} +#endif /* @end of CONFIG_ADAPTIVE_SOML*/ + +void phydm_init_soft_ml_setting(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 soml_mask = BIT(31) | BIT(30) | BIT(29) | BIT(28); + +#if (RTL8822B_SUPPORT == 1) + if (!*dm->mp_mode) { + if (dm->support_ic_type & ODM_RTL8822B) { +#if 0 + /*odm_set_bb_reg(dm, R_0x19a8, MASKDWORD, 0xd10a0000);*/ +#endif + phydm_somlrxhp_setting(dm, true); + dm->bsomlenabled = true; + } + } +#endif +#if (RTL8821C_SUPPORT == 1) + if (!*dm->mp_mode) { + if (dm->support_ic_type & ODM_RTL8821C) + odm_set_bb_reg(dm, R_0x19a8, soml_mask, 0xd); + } +#endif +#if (RTL8195B_SUPPORT == 1) + if (!*dm->mp_mode) { + if (dm->support_ic_type & ODM_RTL8195B) + odm_set_bb_reg(dm, R_0x19a8, soml_mask, 0xd); + } +#endif +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_soml.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_soml.h new file mode 100644 index 000000000000..bb0eaf0475ed --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_soml.h @@ -0,0 +1,200 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ +#ifndef __PHYDMSOML_H__ +#define __PHYDMSOML_H__ + +/*@#define ADAPTIVE_SOML_VERSION "1.0" Byte counter version*/ +#define ADAPTIVE_SOML_VERSION "2.0" /*@add avg. phy rate decision 20180126*/ + +#define PHYDM_ADAPTIVE_SOML_IC (ODM_RTL8822B | ODM_RTL8197F | ODM_RTL8192F) +/*@jj add 20170822*/ + +#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 16 +#define VHT_RATE_IDX 20 + +#define HT_ORDER_TYPE 3 +#define VHT_ORDER_TYPE 4 + +#define CRC_FAIL 1 +#define CRC_OK 0 + +#if 0 +#define CFO_QPSK_TH 20 +#define CFO_QAM16_TH 20 +#define CFO_QAM64_TH 20 +#define CFO_QAM256_TH 20 + +#define BPSK_QPSK_DIST 20 +#define QAM16_DIST 30 +#define QAM64_DIST 30 +#define QAM256_DIST 20 +#endif +#define HT_TYPE 1 +#define VHT_TYPE 2 + +#define SOML_ON 1 +#define SOML_OFF 0 + +#ifdef CONFIG_ADAPTIVE_SOML + +struct adaptive_soml { + u8 rvrt_val; + boolean is_soml_method_enable; + boolean get_stats; + 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; + u8 cfo_qpsk_th; + u8 cfo_qam16_th; + u8 cfo_qam64_th; + u8 cfo_qam256_th; + u8 bpsk_qpsk_dist_th; + u8 qam16_dist_th; + u8 qam64_dist_th; + u8 qam256_dist_th; + u8 cfo_cnt; + s32 cfo_diff_a; + s32 cfo_diff_b; + s32 cfo_diff_sum_a; + s32 cfo_diff_sum_b; + s32 cfo_diff_avg_a; + s32 cfo_diff_avg_b; + u16 ht_cnt[HT_RATE_IDX]; + u16 pre_ht_cnt[HT_RATE_IDX]; + u16 ht_cnt_on[HT_RATE_IDX]; + u16 ht_cnt_off[HT_RATE_IDX]; + u16 ht_crc_ok_cnt_on[HT_RATE_IDX]; + u16 ht_crc_fail_cnt_on[HT_RATE_IDX]; + u16 ht_crc_ok_cnt_off[HT_RATE_IDX]; + u16 ht_crc_fail_cnt_off[HT_RATE_IDX]; + u16 vht_crc_ok_cnt_on[VHT_RATE_IDX]; + u16 vht_crc_fail_cnt_on[VHT_RATE_IDX]; + u16 vht_crc_ok_cnt_off[VHT_RATE_IDX]; + u16 vht_crc_fail_cnt_off[VHT_RATE_IDX]; + + u16 vht_cnt[VHT_RATE_IDX]; + u16 pre_vht_cnt[VHT_RATE_IDX]; + u16 vht_cnt_on[VHT_RATE_IDX]; + u16 vht_cnt_off[VHT_RATE_IDX]; + + u16 num_ht_qam[HT_ORDER_TYPE]; + u16 ht_byte[HT_RATE_IDX]; + u16 pre_ht_byte[HT_RATE_IDX]; + u16 ht_byte_on[HT_RATE_IDX]; + u16 ht_byte_off[HT_RATE_IDX]; + u16 num_vht_qam[VHT_ORDER_TYPE]; + u16 vht_byte[VHT_RATE_IDX]; + u16 pre_vht_byte[VHT_RATE_IDX]; + u16 vht_byte_on[VHT_RATE_IDX]; + u16 vht_byte_off[VHT_RATE_IDX]; + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +#if USE_WORKITEM + RT_WORK_ITEM phydm_adaptive_soml_workitem; +#endif +#endif + struct phydm_timer_list phydm_adaptive_soml_timer; + +}; + +enum qam_order { + BPSK_QPSK = 0, + QAM16 = 1, + QAM64 = 2, + QAM256 = 3 +}; + +void phydm_dynamicsoftmletting(void *dm_void); + +void phydm_soml_on_off(void *dm_void, u8 swch); + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +void phydm_adaptive_soml_callback(struct phydm_timer_list *timer); + +void phydm_adaptive_soml_workitem_callback(void *context); + +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) +void phydm_adaptive_soml_callback(void *dm_void); + +void phydm_adaptive_soml_workitem_callback(void *context); + +#else +void phydm_adaptive_soml_callback(void *dm_void); +#endif + +void phydm_rx_rate_for_soml(void *dm_void, void *pkt_info_void); + +void phydm_rx_qam_for_soml(void *dm_void, void *pkt_info_void); + +void phydm_soml_reset_rx_rate(void *dm_void); + +void phydm_soml_reset_qam(void *dm_void); + +void phydm_soml_cfo_process(void *dm_void, s32 *diff_a, s32 *diff_b); + +void phydm_soml_debug(void *dm_void, char input[][16], u32 *_used, + char *output, u32 *_out_len); + +void phydm_soml_statistics(void *dm_void, u8 on_off_state); + +void phydm_adsl(void *dm_void); + +void phydm_adaptive_soml_reset(void *dm_void); + +void phydm_set_adsl_val(void *dm_void, u32 *val_buf, u8 val_len); + +void phydm_soml_crc_acq(void *dm_void, u8 rate_id, boolean crc32, u32 length); + +void phydm_soml_bytes_acq(void *dm_void, u8 rate_id, u32 length); + +void phydm_adaptive_soml_timers(void *dm_void, u8 state); + +void phydm_adaptive_soml_init(void *dm_void); + +void phydm_adaptive_soml(void *dm_void); + +void phydm_enable_adaptive_soml(void *dm_void); + +void phydm_stop_adaptive_soml(void *dm_void); + +void phydm_adaptive_soml_para_set(void *dm_void, u8 train_num, u8 intvl, + u8 period, u8 delay_time); +#endif +void phydm_init_soft_ml_setting(void *dm_void); +#endif /*@#ifndef __PHYDMSOML_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_types.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_types.h index 6bb0890fc653..533c0956a126 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_types.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_types.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 @@ -8,63 +9,82 @@ * * This program is distributed in the hope that it will be useful, but WITHOUT * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or - * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 full GNU General Public License is included in this distribution in the + * file called LICENSE. * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. * - ******************************************************************************/ + * Larry Finger + * + *****************************************************************************/ #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*/ +#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__ +#define __odm_func__ +#define __odm_func_aon__ /*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))) + #define GET_PDM_ODM(__padapter) ((struct 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))) + #define GET_PDM_ODM(__padapter) ((struct dm_struct *)(&(GET_HAL_DATA(__padapter))->odmpriv)) +#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) + #define GET_PDM_ODM(__padapter) ((struct 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 + #if defined(CONFIG_RTL_TRIBAND_SUPPORT) && defined(CONFIG_USB_HCI) + /* enable PCI & USB HCI at the same time */ + #define RT_PCI_USB_INTERFACE 1 + #define RT_PCI_INTERFACE RT_PCI_USB_INTERFACE + #define RT_USB_INTERFACE RT_PCI_USB_INTERFACE + #define RT_SDIO_INTERFACE 3 + #else + #define RT_PCI_INTERFACE 1 + #define RT_USB_INTERFACE 2 + #define RT_SDIO_INTERFACE 3 + #endif #endif enum hal_status { HAL_STATUS_SUCCESS, HAL_STATUS_FAILURE, - /*RT_STATUS_PENDING, +#if 0 + 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_OS_API_FAILED, +#endif }; -#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. - * */ + * Declare for ODM spin lock definition temporarily fro compile pass. + */ enum rt_spinlock_type { RT_TX_SPINLOCK = 1, RT_RX_SPINLOCK = 2, @@ -76,16 +96,19 @@ enum rt_spinlock_type { 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. */ + 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 */ + 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_H2C_SPINLOCK = 20, + /* For H2C cmd. Added by tynli. 2009.11.09. */ rt_bt_data_spinlock = 25, @@ -114,7 +137,6 @@ enum rt_spinlock_type { #endif - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) #define sta_info _RT_WLAN_STA #define __func__ __FUNCTION__ @@ -135,45 +157,19 @@ enum rt_spinlock_type { #define u64 u8Byte #define s64 s8Byte - #define bool BOOLEAN + #define phydm_timer_list _RT_TIMER - #define timer_list _RT_TIMER - #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, *void *; - typedef unsigned char bool, *bool *; - typedef unsigned char u8, *u8 *; - typedef unsigned short u16, *u16 *; - typedef unsigned int u32, *u32 *; - typedef unsigned long long u64, *u64 *; - #if 1 - /* In ARM platform, system would use the type -- "char" as "unsigned char" - * And we only use s8/s8* as INT8 now, so changes the type of s8.*/ - typedef signed char s8, *s8 *; - #else - typedef char s8, *s8 *; - #endif - typedef short s16, *s16 *; - typedef long s32, *s32 *; - typedef long long s64, *s64 *; - #endif - + #include "../typedef.h" #ifdef CONFIG_PCI_HCI + #if defined(CONFIG_RTL_TRIBAND_SUPPORT) && defined(CONFIG_USB_HCI) + #define DEV_BUS_TYPE RT_PCI_USB_INTERFACE + #else #define DEV_BUS_TYPE RT_PCI_INTERFACE #endif - - #define _TRUE 1 - #define _FALSE 0 + #endif #if (defined(TESTCHIP_SUPPORT)) #define PHYDM_TESTCHIP_SUPPORT 1 @@ -182,44 +178,43 @@ enum rt_spinlock_type { #endif #define sta_info stat_info + #define boolean bool + + #define phydm_timer_list timer_list + +#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 + + + #define RATE_ADAPTIVE_SUPPORT 0 + #define POWER_TRAINING_ACTIVE 0 + + #define sta_info rtl_sta_info + #define boolean bool + + #define phydm_timer_list timer_list #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) #include - #if 0 - typedef u8 u8, *u8 *; - typedef u16 u16, *u16 *; - typedef u32 u32, *u32 *; - typedef u64 u64, *u64 *; - typedef s8 s8, *s8 *; - typedef s16 s16, *s16 *; - typedef s32 s32, *s32 *; - typedef s64 s64, *s64 *; - #elif 0 - #define u8 u8 - #define u8 *u8* - #define u16 u16 - #define u16 *u16* - - #define u32 u32 - #define u32 *u32* - - #define u64 u64 - #define u64* u64* - - #define s8 s8 - #define s8* s8* - - #define s16 s16 - #define s16* s16* - - #define s32 s32 - #define s32* s32* - - #define s64 s64 - #define s64* s64* - - #endif #ifdef CONFIG_USB_HCI #define DEV_BUS_TYPE RT_USB_INTERFACE #elif defined(CONFIG_PCI_HCI) @@ -233,22 +228,15 @@ enum rt_spinlock_type { #if defined(CONFIG_LITTLE_ENDIAN) #define ODM_ENDIAN_TYPE ODM_ENDIAN_LITTLE - #elif defined (CONFIG_BIG_ENDIAN) + #elif defined(CONFIG_BIG_ENDIAN) #define ODM_ENDIAN_TYPE ODM_ENDIAN_BIG #endif - //#define struct sta_info struct sta_info - //#define struct sta_info* struct sta_info * + #define boolean bool - - - #define true _TRUE - #define false _FALSE - - - #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 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 @@ -261,9 +249,57 @@ enum rt_spinlock_type { #else #define PHYDM_TESTCHIP_SUPPORT 0 #endif + + #define phydm_timer_list rtw_timer_list + +#elif (DM_ODM_SUPPORT_TYPE == ODM_IOT) + #define boolean bool + #define true _TRUE + #define false _FALSE + + // for power limit table + enum odm_pw_lmt_regulation_type { + PW_LMT_REGU_NULL = 0, + PW_LMT_REGU_FCC = 1, + PW_LMT_REGU_ETSI = 2, + PW_LMT_REGU_MKK = 3, + PW_LMT_REGU_WW13 = 4 + }; + + enum odm_pw_lmt_band_type { + PW_LMT_BAND_NULL = 0, + PW_LMT_BAND_2_4G = 1, + PW_LMT_BAND_5G = 2 + }; + + enum odm_pw_lmt_bandwidth_type { + PW_LMT_BW_NULL = 0, + PW_LMT_BW_20M = 1, + PW_LMT_BW_40M = 2, + PW_LMT_BW_80M = 3 + }; + + enum odm_pw_lmt_ratesection_type { + PW_LMT_RS_NULL = 0, + PW_LMT_RS_CCK = 1, + PW_LMT_RS_OFDM = 2, + PW_LMT_RS_HT = 3, + PW_LMT_RS_VHT = 4 + }; + + enum odm_pw_lmt_rfpath_type { + PW_LMT_PH_NULL = 0, + PW_LMT_PH_1T = 1, + PW_LMT_PH_2T = 2, + PW_LMT_PH_3T = 3, + PW_LMT_PH_4T = 4 + }; + + #define phydm_timer_list timer_list + #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 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 @@ -274,21 +310,22 @@ enum rt_spinlock_type { #define MASKHWORD 0xffff0000 #define MASKLWORD 0x0000ffff #define MASKDWORD 0xffffffff + #define MASK7BITS 0x7f #define MASK12BITS 0xfff #define MASKH4BITS 0xf0000000 #define MASK20BITS 0xfffff +#define MASK24BITS 0xffffff #define MASKOFDM_D 0xffc00000 #define MASKCCK 0x3f3f3f3f -#define RFREGOFFSETMASK 0xfffff + +#define RFREGOFFSETMASK 0xfffff +#define RFREG_MASK 0xfffff + #define MASKH3BYTES 0xffffff00 #define MASKL3BYTES 0x00ffffff -#define MASKBYTE2HIGHNIBBLE 0x00f00000 -#define MASKBYTE3LOWNIBBLE 0x0f000000 -#define MASKL3BYTES 0x00ffffff -#define RFREGOFFSETMASK 0xfffff - - -#include "phydm_features.h" +#define MASKBYTE2HIGHNIBBLE 0x00f00000 +#define MASKBYTE3LOWNIBBLE 0x0f000000 +#define MASKL3BYTES 0x00ffffff #endif /* __ODM_TYPES_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtchnlplan.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtchnlplan.c deleted file mode 100644 index d3e190f88675..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtchnlplan.c +++ /dev/null @@ -1,475 +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 struct _RT_CHANNEL_PLAN_MAXPWR chnl_plan_pwr_max_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. */ - /* ...... */ -}; - - -#if 0 -/* ===========================================1:(2G_WORLD, 5G_NULL) */ - -struct _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} - -#endif - -/* - * counter & Realtek channel plan transfer table. - * */ -struct _RT_CHANNEL_PLAN_COUNTRY_TRANSFER_TABLE rt_ctry_chnl_tbl[] = { - - { - 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 - -}; /* rt_ctry_chnl_tbl */ - -/* - * Realtek Defined channel plan. - * */ -#if 0 - -static struct _RT_CHANNEL_PLAN_NEW rt_chnl_plan[] = { - /* channel Plan 0x20. */ - { - &rt_ctry_chnl_tbl[1], /* struct _RT_CHANNEL_PLAN_COUNTRY_TRANSFER_TABLE Country & channel plan transfer table. */ - RT_CHANNEL_DOMAIN_EFUSE_0x20, /* RT_CHANNEL_DOMAIN RT channel Plan Define */ - RT_2G_WORLD, /* enum rt_regulation_2g */ - RT_5G_NULL, /* enum rt_regulation_5g */ - RT_WORLD, /* enum 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, - &chnl_plan_pwr_max_2g[0], - - CHNL_RT_5G_NULL, - CHNL_RT_5G_NULL_SCAN_TYPE, - - - }, - - /* channel Plan 0x26. */ - { - &rt_ctry_chnl_tbl[1], /* struct _RT_CHANNEL_PLAN_COUNTRY_TRANSFER_TABLE Country & channel plan transfer table. */ - RT_CHANNEL_DOMAIN_EFUSE_0x26, /* RT_CHANNEL_DOMAIN RT channel Plan Define */ - RT_2G_WORLD, /* enum rt_regulation_2g */ - RT_5G_ETSI1, /* enum rt_regulation_5g */ - RT_WORLD, /* enum 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, - &chnl_plan_pwr_max_2g[1], - - CHNL_RT_5G_ETSI1, - CHNL_RT_5G_ETSI1_SCAN_TYPE, - - } - - -}; -#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtchnlplan.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtchnlplan.h deleted file mode 100644 index 2e5a24cf78eb..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtchnlplan.h +++ /dev/null @@ -1,682 +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__ - -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, - -}; - - -#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«×" 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. */ -enum rt_country_name { - 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, - -}; - -/* Scan type including active and passive scan. */ -enum rt_scan_type_new { - SCAN_NULL, - SCAN_ACT, - SCAN_PAS, - SCAN_BOTH, -}; - - -/* Power table sample. */ - -struct _RT_CHNL_PLAN_LIMIT { - u16 chnl_start; - u16 chnl_end; - - u16 freq_start; - u16 freq_end; -}; - - -/* - * 2.4G Regulatory Domains - * */ -enum rt_regulation_2g { - RT_2G_NULL, - RT_2G_WORLD, - RT_2G_ETSI1, - RT_2G_FCC1, - RT_2G_MKK1, - RT_2G_ETSI2 - -}; - - -/* typedef struct _RT_CHANNEL_BEHAVIOR - * { - * u8 chnl; - * enum rt_scan_type_new - * - * }RT_CHANNEL_BEHAVIOR, *PRT_CHANNEL_BEHAVIOR; */ - -/* typedef struct _RT_CHANNEL_PLAN_TYPE - * { - * RT_CHANNEL_BEHAVIOR - * u8 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 - * */ -enum rt_regulation_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, - -}; - -/* - * 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 - * */ -enum rt_regulation_cmn { - RT_WORLD, - RT_FCC, - RT_MKK, - RT_ETSI, - RT_IC, - RT_CE, - RT_NCC, - -}; - - - -/* - * Special requirement for different regulation domain. - * For internal test or customerize special request. - * */ -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 */ - -}; - - -/* - * enum rt_country_name & enum rt_regulation_2g & enum rt_regulation_5g transfer table - * - * */ -struct _RT_CHANNEL_PLAN_COUNTRY_TRANSFER_TABLE { - /* */ - /* Define countery domain and corresponding */ - /* */ - enum rt_country_name country_enum; - char country_name[3]; - - /* char Domain_Name[12]; */ - enum rt_regulation_2g domain_2g; - - enum rt_regulation_5g domain_5g; - - RT_CHANNEL_DOMAIN rt_ch_domain; - /* u8 Country_Area; */ - -}; - - -#define RT_MAX_CHNL_NUM_2G 13 -#define RT_MAX_CHNL_NUM_5G 44 - -/* Power table sample. */ - -struct _RT_CHNL_PLAN_PWR_LIMIT { - u16 chnl_start; - u16 chnl_end; - u8 db_max; - u16 m_w_max; -}; - - -#define RT_MAX_BAND_NUM 5 - -struct _RT_CHANNEL_PLAN_MAXPWR { - /* STRING_T */ - struct _RT_CHNL_PLAN_PWR_LIMIT chnl[RT_MAX_BAND_NUM]; - u8 band_useful_num; - - -}; - - -/* - * Power By rate Table. - * */ - - - -struct _RT_CHANNEL_PLAN_NEW { - /* */ - /* Define countery domain and corresponding */ - /* */ - /* char country_name[36]; */ - /* u8 country_enum; */ - - /* char Domain_Name[12]; */ - - - struct _RT_CHANNEL_PLAN_COUNTRY_TRANSFER_TABLE *p_ctry_transfer; - - RT_CHANNEL_DOMAIN rt_ch_domain; - - enum rt_regulation_2g domain_2g; - - enum rt_regulation_5g domain_5g; - - enum rt_regulation_cmn regulator; - - enum rt_chnlplan_sreq chnl_sreq; - - /* struct _RT_CHNL_PLAN_LIMIT RtChnl; */ - - u8 chnl_2g[MAX_CHANNEL_NUM]; /* CHNL_RT_2G_WORLD */ - u8 len_2g; - u8 chnl_2g_scan_tp[MAX_CHANNEL_NUM]; /* CHNL_RT_2G_WORLD_SCAN_TYPE */ - /* u8 Freq2G[2]; */ /* FREQ_RT_2G_WORLD */ - - u8 chnl_5g[MAX_CHANNEL_NUM]; - u8 len_5g; - u8 chnl_5g_scan_tp[MAX_CHANNEL_NUM]; - /* u8 Freq2G[2]; */ /* FREQ_RT_2G_WORLD */ - - struct _RT_CHANNEL_PLAN_MAXPWR chnl_max_pwr; - - -}; - - -#endif /* __RT_CHANNELPLAN_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/hal8188erateadaptive.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/hal8188erateadaptive.c index a46399ab2080..954be411d36c 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/hal8188erateadaptive.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/hal8188erateadaptive.c @@ -1,76 +1,72 @@ /* SPDX-License-Identifier: GPL-2.0 */ -/*++ -Copyright (c) Realtek Semiconductor Corp. All rights reserved. - -Module Name: - rate_adaptive.c - -Abstract: - Implement rate Adaptive functions for common operations. - -Major Change History: - When Who What - ---------- --------------- ------------------------------- - 2011-08-12 Page Create. - 2015-04-23 Wilson Fine tune (SD9 Family) - ---*/ +/****************************************************************************** + * + * 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. + * + *****************************************************************************/ #include "mp_precomp.h" #include "../phydm_precomp.h" - #if (RATE_ADAPTIVE_SUPPORT == 1) /* rate adaptive parameters */ - static u8 RETRY_PENALTY[PERENTRY][RETRYSIZE + 1] = {{5, 4, 3, 2, 0, 3}, /* 92 , idx=0 */ - {6, 5, 4, 3, 0, 4}, /* 86 , idx=1 */ - {6, 5, 4, 2, 0, 4}, /* 81 , idx=2 */ - {8, 7, 6, 4, 0, 6}, /* 75 , idx=3 */ + {6, 5, 4, 3, 0, 4}, /* 86 , idx=1 */ + {6, 5, 4, 2, 0, 4}, /* 81 , idx=2 */ + {8, 7, 6, 4, 0, 6}, /* 75 , idx=3 */ #if (DM_ODM_SUPPORT_TYPE == ODM_AP) && \ ((DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE)) - {10, 9, 7, 6, 0, 8},/*71 , idx=4*/ - {10, 9, 7, 4, 0, 8},/*66 , idx=5*/ + {10, 9, 7, 6, 0, 8}, /*71 , idx=4*/ + {10, 9, 7, 4, 0, 8}, /*66 , idx=5*/ #else - {10, 9, 8, 6, 0, 8}, /* 71 , idx=4 */ - {10, 9, 8, 4, 0, 8}, /* 66 , idx=5 */ + {10, 9, 8, 6, 0, 8}, /* 71 , idx=4 */ + {10, 9, 8, 4, 0, 8}, /* 66 , idx=5 */ #endif - {10, 9, 8, 2, 0, 8}, /* 62 , idx=6 */ - {10, 9, 8, 0, 0, 8}, /* 59 , idx=7 */ - {18, 17, 16, 8, 0, 16}, /* 53 , idx=8 */ - {26, 25, 24, 16, 0, 24}, /* 50 , idx=9 */ - {34, 33, 32, 24, 0, 32}, /* 47 , idx=0x0a */ - /* {34,33,32,16,0,32}, */ /* 43 , idx=0x0b */ - /* {34,33,32,8,0,32}, */ /* 40 , idx=0x0c */ - /* {34,33,28,8,0,32}, */ /* 37 , idx=0x0d */ - /* {34,33,20,8,0,32}, */ /* 32 , idx=0x0e */ - /* {34,32,24,8,0,32}, */ /* 26 , idx=0x0f */ - /* {49,48,32,16,0,48}, */ /* 20 , idx=0x10 */ - /* {49,48,24,0,0,48}, */ /* 17 , idx=0x11 */ - /* {49,47,16,16,0,48}, */ /* 15 , idx=0x12 */ - /* {49,44,16,16,0,48}, */ /* 12 , idx=0x13 */ - /* {49,40,16,0,0,48}, */ /* 9 , idx=0x14 */ - {34, 31, 28, 20, 0, 32}, /* 43 , idx=0x0b */ - {34, 31, 27, 18, 0, 32}, /* 40 , idx=0x0c */ - {34, 31, 26, 16, 0, 32}, /* 37 , idx=0x0d */ - {34, 30, 22, 16, 0, 32}, /* 32 , idx=0x0e */ - {34, 30, 24, 16, 0, 32}, /* 26 , idx=0x0f */ - {49, 46, 40, 16, 0, 48}, /* 20 , idx=0x10 */ - {49, 45, 32, 0, 0, 48}, /* 17 , idx=0x11 */ - {49, 45, 22, 18, 0, 48}, /* 15 , idx=0x12 */ + {10, 9, 8, 2, 0, 8}, /* 62 , idx=6 */ + {10, 9, 8, 0, 0, 8}, /* 59 , idx=7 */ + {18, 17, 16, 8, 0, 16}, /* 53 , idx=8 */ + {26, 25, 24, 16, 0, 24}, /* 50 , idx=9 */ + {34, 33, 32, 24, 0, 32}, /* 47 , idx=0x0a */ + /* {34,33,32,16,0,32}, */ /* 43 , idx=0x0b */ + /* {34,33,32,8,0,32}, */ /* 40 , idx=0x0c */ + /* {34,33,28,8,0,32}, */ /* 37 , idx=0x0d */ + /* {34,33,20,8,0,32}, */ /* 32 , idx=0x0e */ + /* {34,32,24,8,0,32}, */ /* 26 , idx=0x0f */ + /* {49,48,32,16,0,48}, */ /* 20 , idx=0x10 */ + /* {49,48,24,0,0,48}, */ /* 17 , idx=0x11 */ + /* {49,47,16,16,0,48}, */ /* 15 , idx=0x12 */ + /* {49,44,16,16,0,48}, */ /* 12 , idx=0x13 */ + /* {49,40,16,0,0,48}, */ /* 9 , idx=0x14 */ + {34, 31, 28, 20, 0, 32}, /* 43 , idx=0x0b */ + {34, 31, 27, 18, 0, 32}, /* 40 , idx=0x0c */ + {34, 31, 26, 16, 0, 32}, /* 37 , idx=0x0d */ + {34, 30, 22, 16, 0, 32}, /* 32 , idx=0x0e */ + {34, 30, 24, 16, 0, 32}, /* 26 , idx=0x0f */ + {49, 46, 40, 16, 0, 48}, /* 20 , idx=0x10 */ + {49, 45, 32, 0, 0, 48}, /* 17 , idx=0x11 */ + {49, 45, 22, 18, 0, 48}, /* 15 , idx=0x12 */ #if (DM_ODM_SUPPORT_TYPE == ODM_AP) - {49, 40, 28, 18, 0, 48}, /* 12 , idx=0x13 */ - {49, 34, 20, 16, 0, 48}, /* 9 , idx=0x14 */ + {49, 40, 28, 18, 0, 48}, /* 12 , idx=0x13 */ + {49, 34, 20, 16, 0, 48}, /* 9 , idx=0x14 */ #else - {49, 40, 24, 16, 0, 48}, /* 12 , idx=0x13 */ - {49, 32, 18, 12, 0, 48}, /* 9 , idx=0x14 */ + {49, 40, 24, 16, 0, 48}, /* 12 , idx=0x13 */ + {49, 32, 18, 12, 0, 48}, /* 9 , idx=0x14 */ #endif - {49, 22, 18, 14, 0, 48}, /* 6 , idx=0x15 */ - {49, 16, 16, 0, 0, 48} -};/* 3 */ /* 3, idx=0x16 */ + {49, 22, 18, 14, 0, 48}, /* 6 , idx=0x15 */ + {49, 16, 16, 0, 0, 48}}; + /* 3 */ /* 3, idx=0x16 */ -static u8 RETRY_PENALTY_UP[RETRYSIZE + 1] = {49, 44, 16, 16, 0, 48}; /* 12% for rate up */ +static u8 RETRY_PENALTY_UP[RETRYSIZE + 1] = {49, 44, 16, 16, 0, 48}; /* 12% for rate up */ static u8 PT_PENALTY[RETRYSIZE + 1] = {34, 31, 30, 24, 0, 32}; @@ -88,34 +84,27 @@ static u8 RETRY_PENALTY_IDX[2][RATESIZE] = {{ }; #endif - #if (DM_ODM_SUPPORT_TYPE & ODM_AP) -static u8 RETRY_PENALTY_IDX[2][RATESIZE] = {{ - 4, 4, 4, 5, 4, 4, 5, 7, 7, 7, 8, 0x0a, /* SS>TH */ +static u8 RETRY_PENALTY_IDX[2][RATESIZE] = {{4, 4, 4, 5, 4, 4, 5, 7, 7, 7, 8, 0x0a, /* SS>TH */ #if (DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE) - 4, 4, 4, 4, 0x0d, 0x0d, 0x0f, 0x0f, + 4, 4, 4, 4, 0x0d, 0x0d, 0x0f, 0x0f, #else - 4, 4, 4, 4, 6, 0x0a, 0x0b, 0x0d, + 4, 4, 4, 4, 6, 0x0a, 0x0b, 0x0d, #endif - 5, 5, 7, 7, 8, 0x0b, 0x0d, 0x0f - }, /* 0329 R01 */ - { - 0x0a, 0x0a, 0x0a, 0x0a, 0x0c, 0x0c, 0x0e, 0x10, 0x11, 0x12, 0x12, 0x13, /* SSTH */ - 0x13, 0x13, 0x14, 0x14, 0x15, 0x15, 0x15, 0x15, - 0x11, 0x11, 0x12, 0x13, 0x13, 0x13, 0x14, 0x15 - }; +static u8 RETRY_PENALTY_UP_IDX[RATESIZE] = {0x10, 0x10, 0x10, 0x10, 0x11, 0x11, 0x12, 0x12, 0x12, 0x13, 0x13, 0x14, /* SS>TH */ + 0x13, 0x13, 0x14, 0x14, 0x15, 0x15, 0x15, 0x15, + 0x11, 0x11, 0x12, 0x13, 0x13, 0x13, 0x14, 0x15}; -static u8 RSSI_THRESHOLD[RATESIZE] = {0, 0, 0, 0, - 0, 0, 0, 0, 0, 0x24, 0x26, 0x2a, - 0x17, 0x1a, 0x1c, 0x1f, 0x23, 0x28, 0x2a, 0x2c, - 0, 0, 0, 0x1f, 0x23, 0x28, 0x2a, 0x2c - }; +static u8 RSSI_THRESHOLD[RATESIZE] = {0, 0, 0, 0, + 0, 0, 0, 0, 0, 0x24, 0x26, 0x2a, + 0x17, 0x1a, 0x1c, 0x1f, 0x23, 0x28, 0x2a, 0x2c, + 0, 0, 0, 0x1f, 0x23, 0x28, 0x2a, 0x2c}; #else /* wilson modify */ @@ -133,28 +122,22 @@ static u8 RETRY_PENALTY_IDX[2][RATESIZE] = {{ }; #endif -static u8 RETRY_PENALTY_IDX[2][RATESIZE] = {{ - 4, 4, 4, 5, 4, 4, 5, 7, 7, 7, 8, 0x0a, /* SS>TH */ - 4, 4, 4, 4, 6, 0x0a, 0x0b, 0x0d, - 5, 5, 7, 7, 8, 0x0b, 0x0d, 0x0f - }, /* 0329 R01 */ - { - 0x0a, 0x0a, 0x0b, 0x0c, 0x0a, 0x0a, 0x0b, 0x0c, 0x0d, 0x10, 0x13, 0x13, /* SSTH */ + 4, 4, 4, 4, 6, 0x0a, 0x0b, 0x0d, + 5, 5, 7, 7, 8, 0x0b, 0x0d, 0x0f}, /* 0329 R01 */ + { + 0x0a, 0x0a, 0x0b, 0x0c, 0x0a, 0x0a, 0x0b, 0x0c, 0x0d, 0x10, 0x13, 0x13, /* SSTH */ - 0x0f, 0x10, 0x10, 0x12, 0x12, 0x13, 0x14, 0x15, - 0x11, 0x11, 0x12, 0x13, 0x13, 0x13, 0x14, 0x15 - }; +static u8 RETRY_PENALTY_UP_IDX[RATESIZE] = {0x0c, 0x0d, 0x0d, 0x0f, 0x0d, 0x0e, 0x0f, 0x0f, 0x10, 0x12, 0x13, 0x14, /* SS>TH */ + 0x0f, 0x10, 0x10, 0x12, 0x12, 0x13, 0x14, 0x15, + 0x11, 0x11, 0x12, 0x13, 0x13, 0x13, 0x14, 0x15}; -static u8 RSSI_THRESHOLD[RATESIZE] = {0, 0, 0, 0, - 0, 0, 0, 0, 0, 0x24, 0x26, 0x2a, - 0x18, 0x1a, 0x1d, 0x1f, 0x21, 0x27, 0x29, 0x2a, - 0, 0, 0, 0x1f, 0x23, 0x28, 0x2a, 0x2c - }; +static u8 RSSI_THRESHOLD[RATESIZE] = {0, 0, 0, 0, + 0, 0, 0, 0, 0, 0x24, 0x26, 0x2a, + 0x18, 0x1a, 0x1d, 0x1f, 0x21, 0x27, 0x29, 0x2a, + 0, 0, 0, 0x1f, 0x23, 0x28, 0x2a, 0x2c}; #endif @@ -170,21 +153,19 @@ static u16 N_THRESHOLD_LOW[RATESIZE] = {2,2,4,8, 12,18,24,36,48,72,96,108, 30,40,50,80,120,200,280,320, 150,160,240,360,500,600,800,1000};*/ -static u16 N_THRESHOLD_HIGH[RATESIZE] = {4, 4, 8, 16, - 24, 36, 48, 72, 96, 144, 192, 216, - 60, 80, 100, 160, 240, 400, 600, 800, - 300, 320, 480, 720, 1000, 1200, 1600, 2000 - }; -static u16 N_THRESHOLD_LOW[RATESIZE] = {2, 2, 4, 8, - 12, 18, 24, 36, 48, 72, 96, 108, - 30, 40, 50, 80, 120, 200, 300, 400, - 150, 160, 240, 360, 500, 600, 800, 1000 - }; -static u8 TRYING_NECESSARY[RATESIZE] = {2, 2, 2, 2, - 2, 2, 3, 3, 4, 4, 5, 7, - 4, 4, 7, 10, 10, 12, 12, 18, - 5, 7, 7, 8, 11, 18, 36, 60 - }; /* 0329 */ /* 1207 */ +static u16 N_THRESHOLD_HIGH[RATESIZE] = {4, 4, 8, 16, + 24, 36, 48, 72, 96, 144, 192, 216, + 60, 80, 100, 160, 240, 400, 600, 800, + 300, 320, 480, 720, 1000, 1200, 1600, 2000}; +static u16 N_THRESHOLD_LOW[RATESIZE] = {2, 2, 4, 8, + 12, 18, 24, 36, 48, 72, 96, 108, + 30, 40, 50, 80, 120, 200, 300, 400, + 150, 160, 240, 360, 500, 600, 800, 1000}; +static u8 TRYING_NECESSARY[RATESIZE] = {2, 2, 2, 2, + 2, 2, 3, 3, 4, 4, 5, 7, + 4, 4, 7, 10, 10, 12, 12, 18, + 5, 7, 7, 8, 11, 18, 36, 60}; + /* 0329 */ /* 1207 */ #if 0 static u8 POOL_RETRY_TH[RATESIZE] = {30, 30, 30, 30, 30, 30, 25, 25, 20, 15, 15, 10, @@ -193,33 +174,32 @@ static u8 POOL_RETRY_TH[RATESIZE] = {30, 30, 30, 30, }; #endif -static u8 DROPING_NECESSARY[RATESIZE] = {1, 1, 1, 1, - 1, 2, 3, 4, 5, 6, 7, 8, - 1, 2, 3, 4, 5, 6, 7, 8, - 5, 6, 7, 8, 9, 10, 11, 12 - }; +static u8 DROPING_NECESSARY[RATESIZE] = {1, 1, 1, 1, + 1, 2, 3, 4, 5, 6, 7, 8, + 1, 2, 3, 4, 5, 6, 7, 8, + 5, 6, 7, 8, 9, 10, 11, 12}; +static u32 INIT_RATE_FALLBACK_TABLE[16] = { + 0x0f8ff015, /* 0: 40M BGN mode */ + 0x0f8ff010, /* 1: 40M GN mode */ + 0x0f8ff005, /* 2: BN mode/ 40M BGN mode */ + 0x0f8ff000, /* 3: N mode */ + 0x00000ff5, /* 4: BG mode */ + 0x00000ff0, /* 5: G mode */ + 0x0000000d, /* 6: B mode */ + 0, /* 7: */ + 0, /* 8: */ + 0, /* 9: */ + 0, /* 10: */ + 0, /* 11: */ + 0, /* 12: */ + 0, /* 13: */ + 0, /* 14: */ + 0, /* 15: */ -static u32 INIT_RATE_FALLBACK_TABLE[16] = {0x0f8ff015, /* 0: 40M BGN mode */ - 0x0f8ff010, /* 1: 40M GN mode */ - 0x0f8ff005, /* 2: BN mode/ 40M BGN mode */ - 0x0f8ff000, /* 3: N mode */ - 0x00000ff5, /* 4: BG mode */ - 0x00000ff0, /* 5: G mode */ - 0x0000000d, /* 6: B mode */ - 0, /* 7: */ - 0, /* 8: */ - 0, /* 9: */ - 0, /* 10: */ - 0, /* 11: */ - 0, /* 12: */ - 0, /* 13: */ - 0, /* 14: */ - 0, /* 15: */ - - }; +}; static u8 pending_for_rate_up_fail[5] = {2, 10, 24, 40, 60}; -static u16 dynamic_tx_rpt_timing[6] = {0x186a, 0x30d4, 0x493e, 0x61a8, 0x7a12, 0x927c}; /*200ms-1200ms*/ +static u16 dynamic_tx_rpt_timing[6] = {0x186a, 0x30d4, 0x493e, 0x61a8, 0x7a12, 0x927c}; /*200ms-1200ms*/ /* End rate adaptive parameters */ @@ -227,32 +207,27 @@ static u16 dynamic_tx_rpt_timing[6] = {0x186a, 0x30d4, 0x493e, 0x61a8, 0x7a12, 0 ((DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE)) static int odm_ra_learn_bounding( - struct PHY_DM_STRUCT *p_dm_odm, - struct _odm_ra_info_ *p_ra_info -) + struct dm_struct *dm, + struct _odm_ra_info_ *p_ra_info) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, (" odm_ra_learn_bounding\n")); + PHYDM_DBG(dm, DBG_RA, " %s\n", __func__); if (DM_RA_RATE_UP != p_ra_info->rate_direction) { /* Check if previous RA adjustment trend as +++--- or ++++----*/ - if (((3 == p_ra_info->rate_up_counter && p_ra_info->bounding_learning_time <= 10) - || (4 == p_ra_info->rate_up_counter && p_ra_info->bounding_learning_time <= 16)) - && (p_ra_info->rate_up_counter == p_ra_info->rate_down_counter)) { + if (((3 == p_ra_info->rate_up_counter && p_ra_info->bounding_learning_time <= 10) || (4 == p_ra_info->rate_up_counter && p_ra_info->bounding_learning_time <= 16)) && p_ra_info->rate_up_counter == p_ra_info->rate_down_counter) { if (1 != p_ra_info->bounding_type) { p_ra_info->bounding_type = 1; p_ra_info->bounding_counter = 0; } p_ra_info->bounding_counter++; /* Check if previous RA adjustment trend as ++--*/ - } else if ((2 == p_ra_info->rate_up_counter) && (p_ra_info->bounding_learning_time <= 7) - && (p_ra_info->rate_up_counter == p_ra_info->rate_down_counter)) { + } else if ((2 == p_ra_info->rate_up_counter) && (p_ra_info->bounding_learning_time <= 7) && (p_ra_info->rate_up_counter == p_ra_info->rate_down_counter)) { if (2 != p_ra_info->bounding_type) { p_ra_info->bounding_type = 2; p_ra_info->bounding_counter = 0; } p_ra_info->bounding_counter++; /* Check if previous RA adjustment trend as +++++-----*/ - } else if ((5 == p_ra_info->rate_up_counter) && (p_ra_info->bounding_learning_time <= 17) - && (p_ra_info->rate_up_counter == p_ra_info->rate_down_counter)) { + } else if ((5 == p_ra_info->rate_up_counter) && (p_ra_info->bounding_learning_time <= 17) && (p_ra_info->rate_up_counter == p_ra_info->rate_down_counter)) { if (3 != p_ra_info->bounding_type) { p_ra_info->bounding_type = 3; p_ra_info->bounding_counter = 0; @@ -266,20 +241,17 @@ odm_ra_learn_bounding( p_ra_info->bounding_learning_time = 1; } else if (p_ra_info->bounding_type) { /* Check if RA adjustment trend as +++---++(+) or ++++----++(+)*/ - if ((1 == p_ra_info->bounding_type) && (1 == p_ra_info->bounding_counter) - && (2 == p_ra_info->rate_up_counter)) { + if ((1 == p_ra_info->bounding_type) && (1 == p_ra_info->bounding_counter) && (2 == p_ra_info->rate_up_counter)) { p_ra_info->bounding_type = 0; if (p_ra_info->bounding_learning_time <= 5) return 1; /* Check if RA adjustment trend as ++--++--+(+)*/ - } else if ((2 == p_ra_info->bounding_type) && (2 == p_ra_info->bounding_counter) - && (1 == p_ra_info->rate_up_counter)) { + } else if ((2 == p_ra_info->bounding_type) && (2 == p_ra_info->bounding_counter) && (1 == p_ra_info->rate_up_counter)) { p_ra_info->bounding_type = 0; if (p_ra_info->bounding_learning_time <= 2) return 1; /* Check if RA adjustment trend as +++++-----++(+)*/ - } else if ((3 == p_ra_info->bounding_type) && (1 == p_ra_info->bounding_counter) - && (2 == p_ra_info->rate_up_counter)) { + } else if ((3 == p_ra_info->bounding_type) && (1 == p_ra_info->bounding_counter) && (2 == p_ra_info->rate_up_counter)) { p_ra_info->bounding_type = 0; if (p_ra_info->bounding_learning_time <= 4) return 1; @@ -292,10 +264,9 @@ odm_ra_learn_bounding( static void odm_set_tx_rpt_timing_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - struct _odm_ra_info_ *p_ra_info, - u8 extend -) + struct dm_struct *dm, + struct _odm_ra_info_ *p_ra_info, + u8 extend) { u8 idx = 0; @@ -315,30 +286,30 @@ odm_set_tx_rpt_timing_8188e( } p_ra_info->rpt_time = dynamic_tx_rpt_timing[idx]; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("p_ra_info->rpt_time=0x%x\n", p_ra_info->rpt_time)); + PHYDM_DBG(dm, DBG_RA, "p_ra_info->rpt_time=0x%x\n", + p_ra_info->rpt_time); } static int odm_rate_down_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - struct _odm_ra_info_ *p_ra_info -) + struct dm_struct *dm, + struct _odm_ra_info_ *p_ra_info) { u8 rate_id, lowest_rate, highest_rate; s8 i; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_TRACE, ("=====>odm_rate_down_8188e()\n")); + PHYDM_DBG(dm, DBG_RA, "=====>%s\n", __func__); if (NULL == p_ra_info) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("odm_rate_down_8188e(): p_ra_info is NULL\n")); + PHYDM_DBG(dm, DBG_RA, "%s: p_ra_info is NULL\n", __func__); return -1; } rate_id = p_ra_info->pre_rate; lowest_rate = p_ra_info->lowest_rate; highest_rate = p_ra_info->highest_rate; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_TRACE, - (" rate_id=%d lowest_rate=%d highest_rate=%d rate_sgi=%d\n", - rate_id, lowest_rate, highest_rate, p_ra_info->rate_sgi)); + PHYDM_DBG(dm, DBG_RA, + " rate_id=%d lowest_rate=%d highest_rate=%d rate_sgi=%d\n", + rate_id, lowest_rate, highest_rate, p_ra_info->rate_sgi); if (rate_id > highest_rate) rate_id = highest_rate; else if (p_ra_info->rate_sgi) @@ -362,7 +333,6 @@ odm_rate_down_8188e( #endif rate_id = i; goto rate_down_finish; - } } } @@ -374,10 +344,9 @@ odm_rate_down_8188e( /*if (p_ra_info->RTY[2] >= 100) { p_ra_info->ra_waiting_counter = 2; p_ra_info->ra_pending_counter += 1; - } else */if ((0 != p_ra_info->rate_down_start_time) && (0xFF != p_ra_info->rate_down_start_time)) { + } else */ if ((0 != p_ra_info->rate_down_start_time) && (0xFF != p_ra_info->rate_down_start_time)) { /* Learning +(0)-(-)(-)+ and ++(0)--(-)(-)(0)+ after the persistence of learned TX rate expire*/ if (p_ra_info->rate_down_counter < p_ra_info->rate_up_counter) { - } else if (p_ra_info->rate_down_counter == p_ra_info->rate_up_counter) { p_ra_info->ra_waiting_counter = 2; p_ra_info->ra_pending_counter += 1; @@ -391,45 +360,47 @@ odm_rate_down_8188e( } else #endif if (p_ra_info->ra_waiting_counter == 1) { - p_ra_info->ra_waiting_counter += 1; - p_ra_info->ra_pending_counter += 1; - } else if (p_ra_info->ra_waiting_counter == 0) { - } else { - p_ra_info->ra_waiting_counter = 0; - p_ra_info->ra_pending_counter = 0; - } + p_ra_info->ra_waiting_counter += 1; + p_ra_info->ra_pending_counter += 1; + } else if (p_ra_info->ra_waiting_counter == 0) { + } else { + p_ra_info->ra_waiting_counter = 0; + p_ra_info->ra_pending_counter = 0; + } if (p_ra_info->ra_pending_counter >= 4) p_ra_info->ra_pending_counter = 4; p_ra_info->ra_drop_after_down = 1; p_ra_info->decision_rate = rate_id; - odm_set_tx_rpt_timing_8188e(p_dm_odm, p_ra_info, 2); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("rate down, Decrease RPT Timing\n")); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_TRACE, ("ra_waiting_counter %d, ra_pending_counter %d RADrop %d", p_ra_info->ra_waiting_counter, p_ra_info->ra_pending_counter, p_ra_info->ra_drop_after_down)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("rate down to rate_id %d rate_sgi %d\n", rate_id, p_ra_info->rate_sgi)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_TRACE, ("<=====odm_rate_down_8188e()\n")); + odm_set_tx_rpt_timing_8188e(dm, p_ra_info, 2); + PHYDM_DBG(dm, DBG_RA, "rate down, Decrease RPT Timing\n"); + PHYDM_DBG(dm, DBG_RA, + "ra_waiting_counter %d, ra_pending_counter %d RADrop %d", + p_ra_info->ra_waiting_counter, p_ra_info->ra_pending_counter, + p_ra_info->ra_drop_after_down); + PHYDM_DBG(dm, DBG_RA, "rate down to rate_id %d rate_sgi %d\n", rate_id, + p_ra_info->rate_sgi); + PHYDM_DBG(dm, DBG_RA, "<=====%s\n", __func__); return 0; } static int odm_rate_up_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - struct _odm_ra_info_ *p_ra_info -) + struct dm_struct *dm, + struct _odm_ra_info_ *p_ra_info) { u8 rate_id, highest_rate; u8 i; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_TRACE, ("=====>odm_rate_up_8188e()\n")); + PHYDM_DBG(dm, DBG_RA, "=====>%s\n", __func__); if (NULL == p_ra_info) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("odm_rate_up_8188e(): p_ra_info is NULL\n")); + PHYDM_DBG(dm, DBG_RA, "%s: p_ra_info is NULL\n", __func__); return -1; } rate_id = p_ra_info->pre_rate; highest_rate = p_ra_info->highest_rate; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_TRACE, - (" rate_id=%d highest_rate=%d\n", - rate_id, highest_rate)); + PHYDM_DBG(dm, DBG_RA, " rate_id=%d highest_rate=%d\n", rate_id, + highest_rate); if (p_ra_info->ra_waiting_counter == 1) { p_ra_info->ra_waiting_counter = 0; p_ra_info->ra_pending_counter = 0; @@ -441,15 +412,15 @@ odm_rate_up_8188e( #endif goto rate_up_finish; } - odm_set_tx_rpt_timing_8188e(p_dm_odm, p_ra_info, 0); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("odm_rate_up_8188e(): default RPT Timing\n")); + odm_set_tx_rpt_timing_8188e(dm, p_ra_info, 0); + PHYDM_DBG(dm, DBG_RA, "%s: default RPT Timing\n", __func__); if (rate_id < highest_rate) { for (i = rate_id + 1; i <= highest_rate; i++) { if (p_ra_info->ra_use_rate & BIT(i)) { #if (DM_ODM_SUPPORT_TYPE == ODM_AP) && \ ((DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE)) - if (odm_ra_learn_bounding(p_dm_odm, p_ra_info)) { + if (odm_ra_learn_bounding(dm, p_ra_info)) { p_ra_info->ra_waiting_counter = 2; p_ra_info->ra_pending_counter = 1; goto rate_up_finish; @@ -462,7 +433,7 @@ odm_rate_up_8188e( } } } else if (rate_id == highest_rate) { - if (p_ra_info->sgi_enable && (p_ra_info->rate_sgi != 1)) + if (p_ra_info->sgi_enable && p_ra_info->rate_sgi != 1) p_ra_info->rate_sgi = 1; else if ((p_ra_info->sgi_enable) != 1) p_ra_info->rate_sgi = 0; @@ -486,13 +457,14 @@ odm_rate_up_8188e( p_ra_info->ra_waiting_counter++; p_ra_info->decision_rate = rate_id; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("rate up to rate_id %d\n", rate_id)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_TRACE, ("ra_waiting_counter %d, ra_pending_counter %d", p_ra_info->ra_waiting_counter, p_ra_info->ra_pending_counter)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_TRACE, ("<=====odm_rate_up_8188e()\n")); + PHYDM_DBG(dm, DBG_RA, "rate up to rate_id %d\n", rate_id); + PHYDM_DBG(dm, DBG_RA, "ra_waiting_counter %d, ra_pending_counter %d", + p_ra_info->ra_waiting_counter, p_ra_info->ra_pending_counter); + PHYDM_DBG(dm, DBG_RA, "<=====%s\n", __func__); return 0; } -static void odm_reset_ra_counter_8188e(struct _odm_ra_info_ *p_ra_info) +static void odm_reset_ra_counter_8188e(struct _odm_ra_info_ *p_ra_info) { u8 rate_id; rate_id = p_ra_info->decision_rate; @@ -502,42 +474,40 @@ static void odm_reset_ra_counter_8188e(struct _odm_ra_info_ *p_ra_info) static void odm_rate_decision_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - struct _odm_ra_info_ *p_ra_info -) + struct dm_struct *dm, + struct _odm_ra_info_ *p_ra_info, + u8 mac_id) { u8 rate_id = 0, rty_pt_id = 0, penalty_id1 = 0, penalty_id2 = 0; - /* u32 pool_retry; */ static u8 dynamic_tx_rpt_timing_counter = 0; + u8 cmd_buf[3]; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_TRACE, ("=====>odm_rate_decision_8188e()\n")); + PHYDM_DBG(dm, DBG_RA, "%s ======>\n", __func__); - if (p_ra_info->active && (p_ra_info->TOTAL > 0)) { /* STA used and data packet exits */ -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) && \ - ((DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE)) - if (((p_ra_info->rssi_sta_ra <= 17) && (p_ra_info->rssi_sta_ra > p_ra_info->pre_rssi_sta_ra)) - || ((p_ra_info->pre_rssi_sta_ra <= 17) && (p_ra_info->pre_rssi_sta_ra > p_ra_info->rssi_sta_ra))) { + if (p_ra_info->active && p_ra_info->TOTAL > 0) { /* STA used and data packet exits */ + +#if AP_USB_SDIO + if ((p_ra_info->rssi_sta_ra <= 17 && p_ra_info->rssi_sta_ra > p_ra_info->pre_rssi_sta_ra) || (p_ra_info->pre_rssi_sta_ra <= 17 && p_ra_info->pre_rssi_sta_ra > p_ra_info->rssi_sta_ra)) { /* don't reset state in low signal due to the power different between CCK and MCS is large.*/ } else #endif if (p_ra_info->ra_drop_after_down) { - p_ra_info->ra_drop_after_down--; - odm_reset_ra_counter_8188e(p_ra_info); - return; - } + p_ra_info->ra_drop_after_down--; + odm_reset_ra_counter_8188e(p_ra_info); + return; + } if ((p_ra_info->rssi_sta_ra < (p_ra_info->pre_rssi_sta_ra - 3)) || (p_ra_info->rssi_sta_ra > (p_ra_info->pre_rssi_sta_ra + 3))) { p_ra_info->pre_rssi_sta_ra = p_ra_info->rssi_sta_ra; p_ra_info->ra_waiting_counter = 0; p_ra_info->ra_pending_counter = 0; -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) && \ - ((DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE)) +#if AP_USB_SDIO p_ra_info->bounding_type = 0; #endif } #if (DM_ODM_SUPPORT_TYPE & ODM_AP) - if (0xff != p_dm_odm->priv->pshare->rf_ft_var.txforce) { - p_ra_info->pre_rate = p_dm_odm->priv->pshare->rf_ft_var.txforce; + if (dm->priv->pshare->rf_ft_var.txforce != 0xff) { + p_ra_info->pre_rate = dm->priv->pshare->rf_ft_var.txforce; odm_reset_ra_counter_8188e(p_ra_info); } #endif @@ -547,23 +517,26 @@ odm_rate_decision_8188e( rate_id = p_ra_info->highest_rate; else rate_id = p_ra_info->pre_rate; + if (p_ra_info->rssi_sta_ra > RSSI_THRESHOLD[rate_id]) rty_pt_id = 0; else rty_pt_id = 1; + penalty_id1 = RETRY_PENALTY_IDX[rty_pt_id][rate_id]; /* TODO by page */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_TRACE, - (" nsc_down init is %d\n", p_ra_info->nsc_down)); - /* pool_retry=p_ra_info->RTY[2]+p_ra_info->RTY[3]+p_ra_info->RTY[4]+p_ra_info->DROP; */ + PHYDM_DBG(dm, DBG_RA, "nsc_down=%d\n", p_ra_info->nsc_down); + p_ra_info->nsc_down += p_ra_info->RTY[0] * RETRY_PENALTY[penalty_id1][0]; p_ra_info->nsc_down += p_ra_info->RTY[1] * RETRY_PENALTY[penalty_id1][1]; p_ra_info->nsc_down += p_ra_info->RTY[2] * RETRY_PENALTY[penalty_id1][2]; p_ra_info->nsc_down += p_ra_info->RTY[3] * RETRY_PENALTY[penalty_id1][3]; p_ra_info->nsc_down += p_ra_info->RTY[4] * RETRY_PENALTY[penalty_id1][4]; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_TRACE, - (" nsc_down is %d, total*penalty[5] is %d\n", - p_ra_info->nsc_down, (p_ra_info->TOTAL * RETRY_PENALTY[penalty_id1][5]))); + + PHYDM_DBG(dm, DBG_RA, " nsc_down=%d, total*penalty[5]=%d\n", + p_ra_info->nsc_down, + (p_ra_info->TOTAL * RETRY_PENALTY[penalty_id1][5])); + if (p_ra_info->nsc_down > (p_ra_info->TOTAL * RETRY_PENALTY[penalty_id1][5])) p_ra_info->nsc_down -= p_ra_info->TOTAL * RETRY_PENALTY[penalty_id1][5]; else @@ -571,63 +544,83 @@ odm_rate_decision_8188e( /* rate up */ penalty_id2 = RETRY_PENALTY_UP_IDX[rate_id]; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_TRACE, - (" nsc_up init is %d\n", p_ra_info->nsc_up)); + + PHYDM_DBG(dm, DBG_RA, " nsc_up=%d\n", p_ra_info->nsc_up); + p_ra_info->nsc_up += p_ra_info->RTY[0] * RETRY_PENALTY[penalty_id2][0]; p_ra_info->nsc_up += p_ra_info->RTY[1] * RETRY_PENALTY[penalty_id2][1]; p_ra_info->nsc_up += p_ra_info->RTY[2] * RETRY_PENALTY[penalty_id2][2]; p_ra_info->nsc_up += p_ra_info->RTY[3] * RETRY_PENALTY[penalty_id2][3]; p_ra_info->nsc_up += p_ra_info->RTY[4] * RETRY_PENALTY[penalty_id2][4]; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_TRACE, - ("nsc_up is %d, total*up[5] is %d\n", - p_ra_info->nsc_up, (p_ra_info->TOTAL * RETRY_PENALTY[penalty_id2][5]))); + + PHYDM_DBG(dm, DBG_RA, "nsc_up=%d, total*up[5]=%d\n", + p_ra_info->nsc_up, + (p_ra_info->TOTAL * RETRY_PENALTY[penalty_id2][5])); + if (p_ra_info->nsc_up > (p_ra_info->TOTAL * RETRY_PENALTY[penalty_id2][5])) p_ra_info->nsc_up -= p_ra_info->TOTAL * RETRY_PENALTY[penalty_id2][5]; else p_ra_info->nsc_up = 0; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE | ODM_COMP_INIT, ODM_DBG_LOUD, - (" RssiStaRa= %d rty_pt_id=%d penalty_id1=0x%x penalty_id2=0x%x rate_id=%d nsc_down=%d nsc_up=%d SGI=%d\n", - p_ra_info->rssi_sta_ra, rty_pt_id, penalty_id1, penalty_id2, rate_id, p_ra_info->nsc_down, p_ra_info->nsc_up, p_ra_info->rate_sgi)); -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) && \ - ((DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE)) + PHYDM_DBG(dm, DBG_RA | ODM_COMP_INIT, + " RssiStaRa= %d rty_pt_id=%d penalty_id1=0x%x penalty_id2=0x%x rate_id=%d nsc_down=%d nsc_up=%d SGI=%d\n", + p_ra_info->rssi_sta_ra, rty_pt_id, penalty_id1, + penalty_id2, rate_id, p_ra_info->nsc_down, + p_ra_info->nsc_up, p_ra_info->rate_sgi); + +#if AP_USB_SDIO if (0xFF != p_ra_info->bounding_learning_time) p_ra_info->bounding_learning_time++; #endif + if ((p_ra_info->nsc_down < N_THRESHOLD_LOW[rate_id]) || (p_ra_info->DROP > DROPING_NECESSARY[rate_id])) - odm_rate_down_8188e(p_dm_odm, p_ra_info); + odm_rate_down_8188e(dm, p_ra_info); /* else if ((p_ra_info->nsc_up > N_THRESHOLD_HIGH[rate_id])&&(pool_retrynsc_up > N_THRESHOLD_HIGH[rate_id]) - odm_rate_up_8188e(p_dm_odm, p_ra_info); -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) && \ - ((DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE)) - else if ((p_ra_info->RTY[2] >= 100) && (ODM_BW20M == *p_dm_odm->p_band_width)) - odm_rate_down_8188e(p_dm_odm, p_ra_info); + odm_rate_up_8188e(dm, p_ra_info); + +#if AP_USB_SDIO + else if ((p_ra_info->RTY[2] >= 100) && (*dm->band_width == CHANNEL_WIDTH_20)) + odm_rate_down_8188e(dm, p_ra_info); #endif - if ((p_ra_info->decision_rate) == (p_ra_info->pre_rate)) + if (p_ra_info->decision_rate == p_ra_info->pre_rate) { + PHYDM_DBG(dm, DBG_RA, + "[Rate stay] macid=%d, dec_rate=0x%x, pre_rate=0x%x\n", + mac_id, p_ra_info->decision_rate, + p_ra_info->pre_rate); dynamic_tx_rpt_timing_counter += 1; - else + } else { /*rate update*/ + + PHYDM_DBG(dm, DBG_RA, + "[Rate update] macid=%d, dec_rate=0x%x, pre_rate=0x%x\n", + mac_id, p_ra_info->decision_rate, + p_ra_info->pre_rate); dynamic_tx_rpt_timing_counter = 0; + /*update rate information*/ + cmd_buf[0] = (p_ra_info->rate_sgi << 7) | (p_ra_info->decision_rate & 0x7f); + cmd_buf[1] = mac_id; + phydm_c2h_ra_report_handler(dm, &(cmd_buf[0]), 3); + } if (dynamic_tx_rpt_timing_counter >= 4) { - odm_set_tx_rpt_timing_8188e(p_dm_odm, p_ra_info, 1); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("<=====rate don't change 4 times, Extend RPT Timing\n")); + odm_set_tx_rpt_timing_8188e(dm, p_ra_info, 1); + PHYDM_DBG(dm, DBG_RA, + "<=====rate don't change 4 times, Extend RPT Timing\n"); dynamic_tx_rpt_timing_counter = 0; } - p_ra_info->pre_rate = p_ra_info->decision_rate; /* YJ,add,120120 */ + p_ra_info->pre_rate = p_ra_info->decision_rate; odm_reset_ra_counter_8188e(p_ra_info); } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_TRACE, ("<=====odm_rate_decision_8188e()\n")); + PHYDM_DBG(dm, DBG_RA, "RA end\n"); } static int odm_arfb_refresh_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - struct _odm_ra_info_ *p_ra_info -) + struct dm_struct *dm, + struct _odm_ra_info_ *p_ra_info) { /* Wilson 2011/10/26 */ u32 mask_from_reg; @@ -656,19 +649,19 @@ odm_arfb_refresh_8188e( p_ra_info->ra_use_rate = (p_ra_info->rate_mask) & 0x0000000d; break; case 12: - mask_from_reg = odm_read_4byte(p_dm_odm, REG_ARFR0); + mask_from_reg = odm_read_4byte(dm, REG_ARFR0); p_ra_info->ra_use_rate = (p_ra_info->rate_mask) & mask_from_reg; break; case 13: - mask_from_reg = odm_read_4byte(p_dm_odm, REG_ARFR1); + mask_from_reg = odm_read_4byte(dm, REG_ARFR1); p_ra_info->ra_use_rate = (p_ra_info->rate_mask) & mask_from_reg; break; case 14: - mask_from_reg = odm_read_4byte(p_dm_odm, REG_ARFR2); + mask_from_reg = odm_read_4byte(dm, REG_ARFR2); p_ra_info->ra_use_rate = (p_ra_info->rate_mask) & mask_from_reg; break; case 15: - mask_from_reg = odm_read_4byte(p_dm_odm, REG_ARFR3); + mask_from_reg = odm_read_4byte(dm, REG_ARFR3); p_ra_info->ra_use_rate = (p_ra_info->rate_mask) & mask_from_reg; break; @@ -678,8 +671,8 @@ odm_arfb_refresh_8188e( } /* Highest rate */ if (p_ra_info->ra_use_rate) - for (i = RATESIZE ; i >= 0 ; i--) { - if ((p_ra_info->ra_use_rate) & BIT(i)) { + for (i = RATESIZE; i >= 0; i--) { + if (p_ra_info->ra_use_rate & BIT(i)) { p_ra_info->highest_rate = i; break; } @@ -689,7 +682,7 @@ odm_arfb_refresh_8188e( /* Lowest rate */ if (p_ra_info->ra_use_rate) for (i = 0; i < RATESIZE; i++) { - if ((p_ra_info->ra_use_rate) & BIT(i)) { + if (p_ra_info->ra_use_rate & BIT(i)) { p_ra_info->lowest_rate = i; break; } @@ -706,22 +699,22 @@ odm_arfb_refresh_8188e( p_ra_info->pt_mode_ss = 1; else p_ra_info->pt_mode_ss = 0; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, - ("ODM_ARFBRefresh_8188E(): pt_mode_ss=%d\n", p_ra_info->pt_mode_ss)); + PHYDM_DBG(dm, DBG_RA, "ODM_ARFBRefresh_8188E(): pt_mode_ss=%d\n", + p_ra_info->pt_mode_ss); #endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, - ("ODM_ARFBRefresh_8188E(): rate_id=%d rate_mask=%8.8x ra_use_rate=%8.8x highest_rate=%d\n", - p_ra_info->rate_id, p_ra_info->rate_mask, p_ra_info->ra_use_rate, p_ra_info->highest_rate)); + PHYDM_DBG(dm, DBG_RA, + "ODM_ARFBRefresh_8188E(): rate_id=%d rate_mask=%8.8x ra_use_rate=%8.8x highest_rate=%d\n", + p_ra_info->rate_id, p_ra_info->rate_mask, + p_ra_info->ra_use_rate, p_ra_info->highest_rate); return 0; } #if POWER_TRAINING_ACTIVE == 1 static void odm_pt_try_state_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - struct _odm_ra_info_ *p_ra_info -) + struct dm_struct *dm, + struct _odm_ra_info_ *p_ra_info) { p_ra_info->pt_try_state = 0; switch (p_ra_info->pt_mode_ss) { @@ -748,8 +741,7 @@ odm_pt_try_state_8188e( if (p_ra_info->rssi_sta_ra < 48) p_ra_info->pt_stage = 0; else if (p_ra_info->pt_try_state == 1) { - if ((p_ra_info->pt_stop_count >= 10) || (p_ra_info->pt_pre_rssi > p_ra_info->rssi_sta_ra + 5) - || (p_ra_info->pt_pre_rssi < p_ra_info->rssi_sta_ra - 5) || (p_ra_info->decision_rate != p_ra_info->pt_pre_rate)) { + if (p_ra_info->pt_stop_count >= 10 || (p_ra_info->pt_pre_rssi > p_ra_info->rssi_sta_ra + 5) || (p_ra_info->pt_pre_rssi < p_ra_info->rssi_sta_ra - 5) || p_ra_info->decision_rate != p_ra_info->pt_pre_rate) { if (p_ra_info->pt_stage == 0) p_ra_info->pt_stage = 1; else if (p_ra_info->pt_stage == 1) @@ -772,8 +764,8 @@ odm_pt_try_state_8188e( #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) /* Disable power training when noisy environment */ - if (p_dm_odm->is_disable_power_training) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("odm_pt_try_state_8188e(): Disable power training when noisy environment\n")); + if (dm->is_disable_power_training) { + PHYDM_DBG(dm, DBG_PWR_TRAIN, "Disable pow train when noisy\n"); p_ra_info->pt_stage = 0; p_ra_info->ra_stage = 0; p_ra_info->pt_stop_count = 0; @@ -783,8 +775,7 @@ odm_pt_try_state_8188e( static void odm_pt_decision_8188e( - struct _odm_ra_info_ *p_ra_info -) + struct _odm_ra_info_ *p_ra_info) { u8 stage_BUF; u8 j; @@ -794,7 +785,7 @@ odm_pt_decision_8188e( u8 stage_id; stage_BUF = p_ra_info->pt_stage; - numsc = 0; + numsc = 0; num_total = p_ra_info->TOTAL * PT_PENALTY[5]; for (j = 0; j <= 4; j++) { numsc += p_ra_info->RTY[j] * PT_PENALTY[j]; @@ -819,83 +810,56 @@ odm_pt_decision_8188e( if (p_ra_info->DROP > 3) temp_stage = 0; p_ra_info->pt_stage = temp_stage; - } #endif static void odm_ra_tx_rpt_timer_setting( - struct PHY_DM_STRUCT *p_dm_odm, - u16 min_rpt_time -) + struct dm_struct *dm, + u16 min_rpt_time) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_TRACE, (" =====>odm_ra_tx_rpt_timer_setting()\n")); + PHYDM_DBG(dm, DBG_RA, " =====>%s\n", __func__); - - if (p_dm_odm->currmin_rpt_time != min_rpt_time) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, - (" currmin_rpt_time =0x%04x min_rpt_time=0x%04x\n", p_dm_odm->currmin_rpt_time, min_rpt_time)); + if (dm->currmin_rpt_time != min_rpt_time) { + PHYDM_DBG(dm, DBG_RA, + " currmin_rpt_time =0x%04x min_rpt_time=0x%04x\n", + dm->currmin_rpt_time, min_rpt_time); #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_AP)) - odm_ra_set_tx_rpt_time(p_dm_odm, min_rpt_time); + odm_ra_set_tx_rpt_time(dm, min_rpt_time); #else - rtw_rpt_timer_cfg_cmd(p_dm_odm->adapter, min_rpt_time); + rtw_rpt_timer_cfg_cmd(dm->adapter, min_rpt_time); #endif - p_dm_odm->currmin_rpt_time = min_rpt_time; + dm->currmin_rpt_time = min_rpt_time; } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_TRACE, (" <=====odm_ra_tx_rpt_timer_setting()\n")); + PHYDM_DBG(dm, DBG_RA, " <=====%s\n", __func__); } - -void -odm_ra_support_init( - struct PHY_DM_STRUCT *p_dm_odm -) +void odm_ra_support_init(struct dm_struct *dm) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("=====>odm_ra_support_init()\n")); + PHYDM_DBG(dm, DBG_RA, "=====>%s\n", __func__); /* 2012/02/14 MH Be noticed, the init must be after IC type is recognized!!!!! */ - if (p_dm_odm->support_ic_type == ODM_RTL8188E) - p_dm_odm->ra_support88e = true; - + if (dm->support_ic_type == ODM_RTL8188E) + dm->ra_support88e = true; } - - -int -odm_ra_info_init( - struct PHY_DM_STRUCT *p_dm_odm, - u32 mac_id -) +void phydm_tx_stats_rst(struct dm_struct *dm) { - struct _odm_ra_info_ *p_ra_info = &p_dm_odm->ra_info[mac_id]; -#if 0 - u8 wireless_mode = 0xFF; /* invalid value */ - u8 max_rate_idx = 0x13; /* MCS7 */ - if (p_dm_odm->p_wireless_mode != NULL) - wireless_mode = *(p_dm_odm->p_wireless_mode); + struct _phydm_txstatistic_ *tx_stats = NULL; + tx_stats = &(dm->hw_stats); + tx_stats->hw_total_tx = 0; + tx_stats->hw_tx_drop = 0; + tx_stats->hw_tx_rty = 0; + tx_stats->hw_tx_success = 0; +} - if (wireless_mode != 0xFF) { - if (wireless_mode & ODM_WM_N24G) - max_rate_idx = 0x13; - else if (wireless_mode & ODM_WM_G) - max_rate_idx = 0x0b; - else if (wireless_mode & ODM_WM_B) - max_rate_idx = 0x03; - } +int odm_ra_info_init(struct dm_struct *dm, u32 mac_id) +{ + struct _odm_ra_info_ *p_ra_info = &dm->ra_info[mac_id]; - /* printk("%s ==>wireless_mode:0x%08x,max_raid_idx:0x%02x\n ",__FUNCTION__,wireless_mode,max_rate_idx); */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, - ("odm_ra_info_init(): wireless_mode:0x%08x,max_raid_idx:0x%02x\n", - wireless_mode, max_rate_idx)); - - p_ra_info->decision_rate = max_rate_idx; - p_ra_info->pre_rate = max_rate_idx; - p_ra_info->highest_rate = max_rate_idx; -#else - p_ra_info->decision_rate = 0x13; - p_ra_info->pre_rate = 0x13; - p_ra_info->highest_rate = 0x13; -#endif + p_ra_info->decision_rate = ODM_RATEMCS7; + p_ra_info->pre_rate = ODM_RATEMCS7; + p_ra_info->highest_rate = ODM_RATEMCS7; p_ra_info->lowest_rate = 0; p_ra_info->rate_id = 0; p_ra_info->rate_mask = 0xffffffff; @@ -906,7 +870,7 @@ odm_ra_info_init( p_ra_info->nsc_down = (N_THRESHOLD_HIGH[0x13] + N_THRESHOLD_LOW[0x13]) / 2; p_ra_info->nsc_up = (N_THRESHOLD_HIGH[0x13] + N_THRESHOLD_LOW[0x13]) / 2; p_ra_info->rate_sgi = 0; - p_ra_info->active = 1; /* active is not used at present. by page, 110819 */ + p_ra_info->active = 1; /* active is not used at present. by page, 110819 */ p_ra_info->rpt_time = 0x927c; p_ra_info->DROP = 0; p_ra_info->RTY[0] = 0; @@ -929,8 +893,7 @@ odm_ra_info_init( p_ra_info->pt_mode_ss = 0; p_ra_info->ra_stage = 0; #endif -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) && \ - ((DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE)) +#if AP_USB_SDIO p_ra_info->rate_down_counter = 0; p_ra_info->rate_up_counter = 0; p_ra_info->rate_direction = 0; @@ -942,43 +905,41 @@ odm_ra_info_init( return 0; } -int -odm_ra_info_init_all( - struct PHY_DM_STRUCT *p_dm_odm -) +void odm_ra_info_init_all(struct dm_struct *dm) { u32 mac_id = 0; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("=====>\n")); - p_dm_odm->currmin_rpt_time = 0; + if (dm->support_ic_type != ODM_RTL8188E) + return; + + PHYDM_DBG(dm, DBG_RA, "=====>\n"); + dm->currmin_rpt_time = 0; for (mac_id = 0; mac_id < ODM_ASSOCIATE_ENTRY_NUM; mac_id++) - odm_ra_info_init(p_dm_odm, mac_id); + odm_ra_info_init(dm, mac_id); + + /* Init Tx stats*/ + phydm_tx_stats_rst(dm); /* Redifine arrays for I-cut NIC */ - if (p_dm_odm->cut_version == ODM_CUT_I) { + if (dm->cut_version == ODM_CUT_I) { #if !(DM_ODM_SUPPORT_TYPE & ODM_AP) u8 i; - u8 RETRY_PENALTY_IDX_S[2][RATESIZE] = {{ - 4, 4, 4, 5, - 4, 4, 5, 7, 7, 7, 8, 0x0a, /* SS>TH */ - 4, 4, 4, 4, 6, 0x0a, 0x0b, 0x0d, - 5, 5, 7, 7, 8, 0x0b, 0x0d, 0x0f - }, /* 0329 R01 */ - { - 0x0a, 0x0a, 0x0b, 0x0c, - 0x0a, 0x0a, 0x0b, 0x0c, 0x0d, 0x10, 0x13, 0x13, /* SSTH */ + 4, 4, 4, 4, 6, 0x0a, 0x0b, 0x0d, + 5, 5, 7, 7, 8, 0x0b, 0x0d, 0x0f}, /* 0329 R01 */ + { + 0x0a, 0x0a, 0x0b, 0x0c, + 0x0a, 0x0a, 0x0b, 0x0c, 0x0d, 0x10, 0x13, 0x13, /* SSTH */ - 0x0b, 0x0b, 0x11, 0x11, 0x12, 0x12, 0x12, 0x12, - 0x11, 0x11, 0x12, 0x13, 0x13, 0x13, 0x14, 0x15 - }; + 0x0d, 0x0e, 0x0f, 0x0f, 0x10, 0x12, 0x13, 0x14, /* SS>TH */ + 0x0b, 0x0b, 0x11, 0x11, 0x12, 0x12, 0x12, 0x12, + 0x11, 0x11, 0x12, 0x13, 0x13, 0x13, 0x14, 0x15}; for (i = 0; i < RATESIZE; i++) { RETRY_PENALTY_IDX[0][i] = RETRY_PENALTY_IDX_S[0][i]; @@ -986,23 +947,20 @@ odm_ra_info_init_all( RETRY_PENALTY_UP_IDX[i] = RETRY_PENALTY_UP_IDX_S[i]; } - return 0; + return; #endif } - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)/* This is for non-I-cut */ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) /* This is for non-I-cut */ { - struct _ADAPTER *adapter = p_dm_odm->adapter; + void *adapter = dm->adapter; /* dbg_print("adapter->mgnt_info.reg_ra_lvl = %d\n", adapter->mgnt_info.reg_ra_lvl); */ - /* */ /* 2012/09/14 MH Add for different Ra pattern init. For TPLINK case, we */ /* need to to adjust different RA pattern for middle range RA. 20-30dB degarde */ /* 88E rate adptve will raise too slow. */ - /* */ - if (adapter->MgntInfo.RegRALvl == 0) { + if (((PADAPTER)adapter)->MgntInfo.RegRALvl == 0) { RETRY_PENALTY_UP_IDX[11] = 0x14; RETRY_PENALTY_UP_IDX[17] = 0x13; @@ -1014,7 +972,7 @@ odm_ra_info_init_all( RETRY_PENALTY_UP_IDX[25] = 0x13; RETRY_PENALTY_UP_IDX[26] = 0x14; RETRY_PENALTY_UP_IDX[27] = 0x15; - } else if (adapter->MgntInfo.RegRALvl == 1) { + } else if (((PADAPTER)adapter)->MgntInfo.RegRALvl == 1) { RETRY_PENALTY_UP_IDX[17] = 0x13; RETRY_PENALTY_UP_IDX[18] = 0x13; RETRY_PENALTY_UP_IDX[19] = 0x14; @@ -1024,10 +982,10 @@ odm_ra_info_init_all( RETRY_PENALTY_UP_IDX[25] = 0x13; RETRY_PENALTY_UP_IDX[26] = 0x13; RETRY_PENALTY_UP_IDX[27] = 0x14; - } else if (adapter->MgntInfo.RegRALvl == 2) { + } else if (((PADAPTER)adapter)->MgntInfo.RegRALvl == 2) { /* Compile flag default is lvl2, we need not to update. */ - } else if (adapter->MgntInfo.RegRALvl >= 0x80) { - u8 index = 0, offset = adapter->MgntInfo.RegRALvl - 0x80; + } else if (((PADAPTER)adapter)->MgntInfo.RegRALvl >= 0x80) { + u8 index = 0, offset = ((PADAPTER)adapter)->MgntInfo.RegRALvl - 0x80; /* Reset to default rate adaptive value. */ RETRY_PENALTY_UP_IDX[11] = 0x14; @@ -1042,8 +1000,8 @@ odm_ra_info_init_all( RETRY_PENALTY_UP_IDX[26] = 0x14; RETRY_PENALTY_UP_IDX[27] = 0x15; - if (adapter->MgntInfo.RegRALvl >= 0x90) { - offset = adapter->MgntInfo.RegRALvl - 0x90; + if (((PADAPTER)adapter)->MgntInfo.RegRALvl >= 0x90) { + offset = ((PADAPTER)adapter)->MgntInfo.RegRALvl - 0x90; /* Lazy mode. */ for (index = 0; index < 28; index++) RETRY_PENALTY_UP_IDX[index] += (offset); @@ -1052,148 +1010,148 @@ odm_ra_info_init_all( for (index = 0; index < 28; index++) RETRY_PENALTY_UP_IDX[index] -= (offset); } - } } #endif - return 0; + return; } - -u8 -odm_ra_get_sgi_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u8 mac_id -) +u8 odm_ra_get_sgi_8188e(struct dm_struct *dm, u8 mac_id) { - if ((NULL == p_dm_odm) || (mac_id >= ASSOCIATE_ENTRY_NUM)) + if (dm == NULL || mac_id >= ASSOCIATE_ENTRY_NUM) return 0; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_TRACE, - ("mac_id=%d SGI=%d\n", mac_id, p_dm_odm->ra_info[mac_id].rate_sgi)); - return p_dm_odm->ra_info[mac_id].rate_sgi; + PHYDM_DBG(dm, DBG_RA, "mac_id=%d SGI=%d\n", mac_id, + dm->ra_info[mac_id].rate_sgi); + return dm->ra_info[mac_id].rate_sgi; } -u8 -odm_ra_get_decision_rate_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u8 mac_id -) +u8 odm_ra_get_decision_rate_8188e(struct dm_struct *dm, u8 mac_id) { - u8 decision_rate = 0; - struct _rate_adaptive_table_ *p_ra_table = &p_dm_odm->dm_ra_table; - u8 cmd_buf[3]; + u8 rate = 0; - if ((NULL == p_dm_odm) || (mac_id >= ASSOCIATE_ENTRY_NUM)) + if (dm == NULL || mac_id >= ASSOCIATE_ENTRY_NUM) return 0; - decision_rate = (p_dm_odm->ra_info[mac_id].decision_rate); - if (decision_rate != p_ra_table->link_tx_rate[mac_id]) { + rate = (dm->ra_info[mac_id].decision_rate); - cmd_buf[1] = mac_id; - cmd_buf[0] = decision_rate; - phydm_c2h_ra_report_handler(p_dm_odm, &(cmd_buf[0]), 3); - } - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_TRACE, - (" mac_id=%d decision_rate=0x%x\n", mac_id, decision_rate)); - return decision_rate; + /*PHYDM_DBG(dm, DBG_RA, "Rate[%d]=0x%x\n", mac_id, rate);*/ + return rate; } -u8 -odm_ra_get_hw_pwr_status_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u8 mac_id -) +u8 odm_ra_get_hw_pwr_status_8188e(struct dm_struct *dm, u8 mac_id) { u8 pt_stage = 5; - if ((NULL == p_dm_odm) || (mac_id >= ASSOCIATE_ENTRY_NUM)) + if (dm == NULL || mac_id >= ASSOCIATE_ENTRY_NUM) return 0; - pt_stage = (p_dm_odm->ra_info[mac_id].pt_stage); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_TRACE, - ("mac_id=%d pt_stage=0x%x\n", mac_id, pt_stage)); + pt_stage = (dm->ra_info[mac_id].pt_stage); + PHYDM_DBG(dm, DBG_RA, "mac_id=%d pt_stage=0x%x\n", mac_id, pt_stage); return pt_stage; } -void -odm_ra_update_rate_info_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u8 mac_id, - u8 rate_id, - u32 rate_mask, - u8 sgi_enable -) +u8 phydm_get_rate_id_88e(void *dm_void, u8 sta_idx) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct cmn_sta_info *sta = dm->phydm_sta_info[sta_idx]; + struct ra_sta_info *ra = NULL; + enum channel_width bw = (enum channel_width)0; + enum wireless_set wireless_mode = WIRELESS_HT; + u8 rate_id_idx = PHYDM_BGN_20M_1SS; + + if (is_sta_active(sta)) { + ra = &(sta->ra_info); + bw = sta->bw_mode; + wireless_mode = sta->support_wireless_set; + + } else { + PHYDM_DBG(dm, DBG_RA, "[Warning] %s: invalid sta_info\n", + __func__); + return 0; + } + + PHYDM_DBG(dm, DBG_RA, "[88E] macid=%d, wireless_set=0x%x, BW=0x%x\n", + sta->mac_id, wireless_mode, bw); + + if (wireless_mode == WIRELESS_CCK) /*B mode*/ + rate_id_idx = PHYDM_RAID_88E_B; + else if (wireless_mode == WIRELESS_OFDM) /*G mode*/ + rate_id_idx = PHYDM_RAID_88E_G; + else if (wireless_mode == (WIRELESS_CCK | WIRELESS_OFDM)) /*BG mode*/ + rate_id_idx = PHYDM_RAID_88E_GB; + else if (wireless_mode == WIRELESS_HT) /*N mode*/ + rate_id_idx = PHYDM_RAID_88E_N; + else if (wireless_mode == (WIRELESS_OFDM | WIRELESS_HT)) /*GN mode*/ + rate_id_idx = PHYDM_RAID_88E_NG; + else if (wireless_mode == (WIRELESS_CCK | WIRELESS_OFDM | WIRELESS_HT)) /*BGN mode*/ + rate_id_idx = PHYDM_RAID_88E_NGB; + else { + PHYDM_DBG(dm, DBG_RA, "[Warrning] No rate_id is found\n"); + rate_id_idx = RATR_INX_WIRELESS_GB; + } + + PHYDM_DBG(dm, DBG_RA, "88E Rate_ID=((0x%x))\n", rate_id_idx); + return rate_id_idx; +} + +void phydm_ra_update_8188e(struct dm_struct *dm, u8 sta_idx, u8 rate_id, + u32 rate_mask, u8 sgi_enable) { struct _odm_ra_info_ *p_ra_info = NULL; + struct cmn_sta_info *sta = dm->phydm_sta_info[sta_idx]; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, - ("mac_id=%d rate_id=0x%x rate_mask=0x%x sgi_enable=%d\n", - mac_id, rate_id, rate_mask, sgi_enable)); - if ((NULL == p_dm_odm) || (mac_id >= ASSOCIATE_ENTRY_NUM)) + PHYDM_DBG(dm, DBG_RA, + "mac_id=%d rate_id=0x%x rate_mask=0x%x sgi_enable=%d\n", + sta->mac_id, rate_id, rate_mask, sgi_enable); + if (dm == NULL || sta->mac_id >= ASSOCIATE_ENTRY_NUM) return; - p_ra_info = &(p_dm_odm->ra_info[mac_id]); + p_ra_info = &(dm->ra_info[sta->mac_id]); p_ra_info->rate_id = rate_id; p_ra_info->rate_mask = rate_mask; p_ra_info->sgi_enable = sgi_enable; - odm_arfb_refresh_8188e(p_dm_odm, p_ra_info); + odm_arfb_refresh_8188e(dm, p_ra_info); } -void -odm_ra_set_rssi_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u8 mac_id, - u8 rssi -) +void odm_ra_set_rssi_8188e(struct dm_struct *dm, u8 mac_id, u8 rssi) { struct _odm_ra_info_ *p_ra_info = NULL; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_TRACE, - (" mac_id=%d rssi=%d\n", mac_id, rssi)); - if ((NULL == p_dm_odm) || (mac_id >= ASSOCIATE_ENTRY_NUM)) + PHYDM_DBG(dm, DBG_RA, " mac_id=%d rssi=%d\n", mac_id, rssi); + if (dm == NULL || mac_id >= ASSOCIATE_ENTRY_NUM) return; - p_ra_info = &(p_dm_odm->ra_info[mac_id]); + p_ra_info = &(dm->ra_info[mac_id]); p_ra_info->rssi_sta_ra = rssi; } -void -odm_ra_set_tx_rpt_time( - struct PHY_DM_STRUCT *p_dm_odm, - u16 min_rpt_time -) +void odm_ra_set_tx_rpt_time(struct dm_struct *dm, u16 min_rpt_time) { #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) if (min_rpt_time != 0xffff) { #if defined(CONFIG_PCI_HCI) - odm_write_2byte(p_dm_odm, REG_TX_RPT_TIME, min_rpt_time); + odm_write_2byte(dm, REG_TX_RPT_TIME, min_rpt_time); #elif defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) - notify_tx_report_interval_change(p_dm_odm->priv, min_rpt_time); + notify_tx_report_interval_change(dm->priv, min_rpt_time); #endif } #else - odm_write_2byte(p_dm_odm, REG_TX_RPT_TIME, min_rpt_time); + odm_write_2byte(dm, REG_TX_RPT_TIME, min_rpt_time); #endif - } - -void -odm_ra_tx_rpt2_handle_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u8 *tx_rpt_buf, - u16 tx_rpt_len, - u32 mac_id_valid_entry0, - u32 mac_id_valid_entry1 -) +void odm_ra_tx_rpt2_handle_8188e(struct dm_struct *dm, u8 *tx_rpt_buf, + u16 tx_rpt_len, u32 mac_id_valid_entry0, + u32 mac_id_valid_entry1) { struct _odm_ra_info_ *p_ra_info = NULL; - u8 mac_id = 0; - u8 *p_buffer = NULL; - u32 valid = 0, item_num = 0; - u16 min_rpt_time = 0x927c; + struct _phydm_txstatistic_ *tx_stats = NULL; + u8 mac_id = 0; + u8 *p_buffer = NULL; + u32 valid = 0, item_num = 0; + u16 min_rpt_time = 0x927c; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("=====>odm_ra_tx_rpt2_handle_8188e(): valid0=%d valid1=%d BufferLength=%d\n", - mac_id_valid_entry0, mac_id_valid_entry1, tx_rpt_len)); + PHYDM_DBG(dm, DBG_RA, "=====>%s: valid0=%d valid1=%d BufferLength=%d\n", + __func__, mac_id_valid_entry0, mac_id_valid_entry1, + tx_rpt_len); item_num = tx_rpt_len >> 3; p_buffer = tx_rpt_buf; @@ -1202,13 +1160,13 @@ odm_ra_tx_rpt2_handle_8188e( valid = 0; if (mac_id < 32) valid = (1 << mac_id) & mac_id_valid_entry0; - else if (mac_id < 64) - valid = (1 << (mac_id - 32)) & mac_id_valid_entry1; + /*else if (mac_id < 64)*/ + /* valid = (1 << (mac_id - 32)) & mac_id_valid_entry1;*/ + + p_ra_info = &(dm->ra_info[mac_id]); + tx_stats = &(dm->hw_stats); - p_ra_info = &(p_dm_odm->ra_info[mac_id]); if (valid) { - - p_ra_info->RTY[0] = (u16)GET_TX_REPORT_TYPE1_RERTY_0(p_buffer); p_ra_info->RTY[1] = (u16)GET_TX_REPORT_TYPE1_RERTY_1(p_buffer); p_ra_info->RTY[2] = (u16)GET_TX_REPORT_TYPE1_RERTY_2(p_buffer); @@ -1216,17 +1174,21 @@ odm_ra_tx_rpt2_handle_8188e( p_ra_info->RTY[4] = (u16)GET_TX_REPORT_TYPE1_RERTY_4(p_buffer); p_ra_info->DROP = (u16)GET_TX_REPORT_TYPE1_DROP_0(p_buffer); - p_ra_info->TOTAL = p_ra_info->RTY[0] + \ - p_ra_info->RTY[1] + \ - p_ra_info->RTY[2] + \ - p_ra_info->RTY[3] + \ - p_ra_info->RTY[4] + \ + p_ra_info->TOTAL = p_ra_info->RTY[0] + + p_ra_info->RTY[1] + + p_ra_info->RTY[2] + + p_ra_info->RTY[3] + + p_ra_info->RTY[4] + p_ra_info->DROP; + tx_stats->hw_total_tx += p_ra_info->TOTAL; + tx_stats->hw_tx_success += p_ra_info->TOTAL - p_ra_info->DROP; + tx_stats->hw_tx_drop += p_ra_info->DROP; + tx_stats->hw_tx_rty += p_ra_info->RTY[1] + p_ra_info->RTY[2] * 2 + p_ra_info->RTY[3] * 3 + p_ra_info->RTY[4] * 4; #if defined(TXRETRY_CNT) - extern struct stat_info *get_macidinfo(struct rtl8192cd_priv *priv, unsigned int aid); + extern struct stat_info *get_macidinfo(struct rtl8192cd_priv * priv, unsigned int aid); { - struct stat_info *pstat = get_macidinfo(p_dm_odm->priv, mac_id); + struct stat_info *pstat = get_macidinfo(dm->priv, mac_id); if (pstat) { pstat->cur_tx_ok += p_ra_info->RTY[0]; pstat->cur_tx_retry_pkts += p_ra_info->RTY[1] + p_ra_info->RTY[2] + p_ra_info->RTY[3] + p_ra_info->RTY[4]; @@ -1238,25 +1200,21 @@ odm_ra_tx_rpt2_handle_8188e( } #endif if (p_ra_info->TOTAL != 0) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, - ("macid=%d Total=%d R0=%d R1=%d R2=%d R3=%d R4=%d D0=%d valid0=%x valid1=%x\n", - mac_id, - p_ra_info->TOTAL, - p_ra_info->RTY[0], - p_ra_info->RTY[1], - p_ra_info->RTY[2], - p_ra_info->RTY[3], - p_ra_info->RTY[4], - p_ra_info->DROP, - mac_id_valid_entry0, - mac_id_valid_entry1)); + PHYDM_DBG(dm, DBG_RA, + "macid=%d Total=%d R0=%d R1=%d R2=%d R3=%d R4=%d D0=%d valid0=%x valid1=%x\n", + mac_id, p_ra_info->TOTAL, + p_ra_info->RTY[0], p_ra_info->RTY[1], + p_ra_info->RTY[2], p_ra_info->RTY[3], + p_ra_info->RTY[4], p_ra_info->DROP, + mac_id_valid_entry0, + mac_id_valid_entry1); #if POWER_TRAINING_ACTIVE == 1 if (p_ra_info->pt_active) { if (p_ra_info->ra_stage < 5) - odm_rate_decision_8188e(p_dm_odm, p_ra_info); + odm_rate_decision_8188e(dm, p_ra_info, mac_id); else if (p_ra_info->ra_stage == 5) /* Power training try state */ - odm_pt_try_state_8188e(p_dm_odm, p_ra_info); - else /* ra_stage==6 */ + odm_pt_try_state_8188e(dm, p_ra_info); + else /* ra_stage==6 */ odm_pt_decision_8188e(p_ra_info); /* Stage_RA counter */ @@ -1265,154 +1223,105 @@ odm_ra_tx_rpt2_handle_8188e( else p_ra_info->ra_stage = 0; } else - odm_rate_decision_8188e(p_dm_odm, p_ra_info); + odm_rate_decision_8188e(dm, p_ra_info, mac_id); #else - odm_rate_decision_8188e(p_dm_odm, p_ra_info); + odm_rate_decision_8188e(dm, p_ra_info, mac_id); #endif #if (DM_ODM_SUPPORT_TYPE & ODM_AP) - extern void rtl8188e_set_station_tx_rate_info(struct PHY_DM_STRUCT *, struct _odm_ra_info_ *, int); - rtl8188e_set_station_tx_rate_info(p_dm_odm, p_ra_info, mac_id); -#ifdef DETECT_STA_EXISTANCE - void rtl8188e_detect_sta_existance(struct PHY_DM_STRUCT *p_dm_odm, struct _odm_ra_info_ *p_ra_info, int mac_id); - rtl8188e_detect_sta_existance(p_dm_odm, p_ra_info, mac_id); + extern void rtl8188e_set_station_tx_rate_info(struct dm_struct *, struct _odm_ra_info_ *, int); + rtl8188e_set_station_tx_rate_info(dm, p_ra_info, mac_id); +#if 0 + void rtl8188e_detect_sta_existance(struct dm_struct *dm, struct _odm_ra_info_ *p_ra_info, int mac_id); + rtl8188e_detect_sta_existance(dm, p_ra_info, mac_id); #endif #endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, - ("macid=%d R0=%d R1=%d R2=%d R3=%d R4=%d drop=%d valid0=%x rate_id=%d SGI=%d\n", - mac_id, - p_ra_info->RTY[0], - p_ra_info->RTY[1], - p_ra_info->RTY[2], - p_ra_info->RTY[3], - p_ra_info->RTY[4], - p_ra_info->DROP, - mac_id_valid_entry0, - p_ra_info->decision_rate, - p_ra_info->rate_sgi)); + PHYDM_DBG(dm, DBG_RA, + "macid=%d R0=%d R1=%d R2=%d R3=%d R4=%d drop=%d valid0=%x rate_id=%d SGI=%d\n", + mac_id, p_ra_info->RTY[0], + p_ra_info->RTY[1], p_ra_info->RTY[2], + p_ra_info->RTY[3], p_ra_info->RTY[4], + p_ra_info->DROP, mac_id_valid_entry0, + p_ra_info->decision_rate, + p_ra_info->rate_sgi); } else - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, (" TOTAL=0!!!!\n")); + PHYDM_DBG(dm, DBG_RA, " TOTAL=0!!!!\n"); + + if (min_rpt_time > p_ra_info->rpt_time) + min_rpt_time = p_ra_info->rpt_time; } - if (min_rpt_time > p_ra_info->rpt_time) - min_rpt_time = p_ra_info->rpt_time; - p_buffer += TX_RPT2_ITEM_SIZE; + mac_id++; } while (mac_id < item_num); - odm_ra_tx_rpt_timer_setting(p_dm_odm, min_rpt_time); + odm_ra_tx_rpt_timer_setting(dm, min_rpt_time); - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("<===== odm_ra_tx_rpt2_handle_8188e()\n")); + PHYDM_DBG(dm, DBG_RA, "<===== %s\n", __func__); } #else static void odm_ra_tx_rpt_timer_setting( - struct PHY_DM_STRUCT *p_dm_odm, - u16 min_rpt_time -) + struct dm_struct *dm, + u16 min_rpt_time) { return; } - -void -odm_ra_support_init( - struct PHY_DM_STRUCT *p_dm_odm -) +void odm_ra_support_init(struct dm_struct *dm) { return; } -int -odm_ra_info_init( - struct PHY_DM_STRUCT *p_dm_odm, - u32 mac_id -) +int odm_ra_info_init(struct dm_struct *dm, u32 mac_id) { return 0; } -int -odm_ra_info_init_all( - struct PHY_DM_STRUCT *p_dm_odm -) -{ - return 0; -} - -u8 -odm_ra_get_sgi_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u8 mac_id -) -{ - return 0; -} - -u8 -odm_ra_get_decision_rate_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u8 mac_id -) -{ - return 0; -} -u8 -odm_ra_get_hw_pwr_status_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u8 mac_id -) -{ - return 0; -} - -void -odm_ra_update_rate_info_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u8 mac_id, - u8 rate_id, - u32 rate_mask, - u8 sgi_enable -) +void odm_ra_info_init_all(struct dm_struct *dm) { return; } -void -odm_ra_set_rssi_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u8 mac_id, - u8 rssi -) +u8 odm_ra_get_sgi_8188e(struct dm_struct *dm, u8 mac_id) +{ + return 0; +} + +u8 odm_ra_get_decision_rate_8188e(struct dm_struct *dm, u8 mac_id) +{ + return 0; +} +u8 odm_ra_get_hw_pwr_status_8188e(struct dm_struct *dm, u8 mac_id) +{ + return 0; +} + +void phydm_ra_update_8188e(struct dm_struct *dm, u8 mac_id, u8 rate_id, + u32 rate_mask, u8 sgi_enable) { return; } -void -odm_ra_set_tx_rpt_time( - struct PHY_DM_STRUCT *p_dm_odm, - u16 min_rpt_time -) +void odm_ra_set_rssi_8188e(struct dm_struct *dm, u8 mac_id, u8 rssi) { return; } -void -odm_ra_tx_rpt2_handle_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u8 *tx_rpt_buf, - u16 tx_rpt_len, - u32 mac_id_valid_entry0, - u32 mac_id_valid_entry1 -) +void odm_ra_set_tx_rpt_time(struct dm_struct *dm, u16 min_rpt_time) { return; } +void odm_ra_tx_rpt2_handle_8188e(struct dm_struct *dm, u8 *tx_rpt_buf, + u16 tx_rpt_len, u32 mac_id_valid_entry0, + u32 mac_id_valid_entry1) +{ + return; +} #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/hal8188erateadaptive.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/hal8188erateadaptive.h index a62f8df45ff0..7dd12f451c9c 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/hal8188erateadaptive.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/hal8188erateadaptive.h @@ -1,111 +1,87 @@ /* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * 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. + * + *****************************************************************************/ #ifndef __INC_RA_H #define __INC_RA_H -/*++ -Copyright (c) Realtek Semiconductor Corp. All rights reserved. - -Module Name: - rate_adaptive.h - -Abstract: - Prototype of RA and related data structure. - -Major Change History: - When Who What - ---------- --------------- ------------------------------- - 2011-08-12 Page Create. ---*/ /* rate adaptive define */ -#define PERENTRY 23 -#define RETRYSIZE 5 -#define RATESIZE 28 -#define TX_RPT2_ITEM_SIZE 8 +#define PERENTRY 23 +#define RETRYSIZE 5 +#define RATESIZE 28 +#define TX_RPT2_ITEM_SIZE 8 -#define DM_RA_RATE_UP 1 -#define DM_RA_RATE_DOWN 2 +#define DM_RA_RATE_UP 1 +#define DM_RA_RATE_DOWN 2 + +#define AP_USB_SDIO ((DM_ODM_SUPPORT_TYPE == ODM_AP) && ((DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE))) #if (DM_ODM_SUPPORT_TYPE != ODM_WIN) - /* +/* * TX report 2 format in Rx desc * */ - #define GET_TX_RPT2_DESC_PKT_LEN_88E(__prx_status_desc) LE_BITS_TO_4BYTE(__prx_status_desc, 0, 9) - #define GET_TX_RPT2_DESC_MACID_VALID_1_88E(__prx_status_desc) LE_BITS_TO_4BYTE(__prx_status_desc+16, 0, 32) - #define GET_TX_RPT2_DESC_MACID_VALID_2_88E(__prx_status_desc) LE_BITS_TO_4BYTE(__prx_status_desc+20, 0, 32) +#define GET_TX_RPT2_DESC_PKT_LEN_88E(__prx_status_desc) LE_BITS_TO_4BYTE(__prx_status_desc, 0, 9) +#define GET_TX_RPT2_DESC_MACID_VALID_1_88E(__prx_status_desc) LE_BITS_TO_4BYTE(__prx_status_desc + 16, 0, 32) +#define GET_TX_RPT2_DESC_MACID_VALID_2_88E(__prx_status_desc) LE_BITS_TO_4BYTE(__prx_status_desc + 20, 0, 32) - #define GET_TX_REPORT_TYPE1_RERTY_0(__paddr) LE_BITS_TO_4BYTE(__paddr, 0, 16) - #define GET_TX_REPORT_TYPE1_RERTY_1(__paddr) LE_BITS_TO_1BYTE(__paddr+2, 0, 8) - #define GET_TX_REPORT_TYPE1_RERTY_2(__paddr) LE_BITS_TO_1BYTE(__paddr+3, 0, 8) - #define GET_TX_REPORT_TYPE1_RERTY_3(__paddr) LE_BITS_TO_1BYTE(__paddr+4, 0, 8) - #define GET_TX_REPORT_TYPE1_RERTY_4(__paddr) LE_BITS_TO_1BYTE(__paddr+4+1, 0, 8) - #define GET_TX_REPORT_TYPE1_DROP_0(__paddr) LE_BITS_TO_1BYTE(__paddr+4+2, 0, 8) - #define GET_TX_REPORT_TYPE1_DROP_1(__paddr) LE_BITS_TO_1BYTE(__paddr+4+3, 0, 8) +#define GET_TX_REPORT_TYPE1_RERTY_0(__paddr) LE_BITS_TO_4BYTE(__paddr, 0, 16) +#define GET_TX_REPORT_TYPE1_RERTY_1(__paddr) LE_BITS_TO_1BYTE(__paddr + 2, 0, 8) +#define GET_TX_REPORT_TYPE1_RERTY_2(__paddr) LE_BITS_TO_1BYTE(__paddr + 3, 0, 8) +#define GET_TX_REPORT_TYPE1_RERTY_3(__paddr) LE_BITS_TO_1BYTE(__paddr + 4, 0, 8) +#define GET_TX_REPORT_TYPE1_RERTY_4(__paddr) LE_BITS_TO_1BYTE(__paddr + 4 + 1, 0, 8) +#define GET_TX_REPORT_TYPE1_DROP_0(__paddr) LE_BITS_TO_1BYTE(__paddr + 4 + 2, 0, 8) +#define GET_TX_REPORT_TYPE1_DROP_1(__paddr) LE_BITS_TO_1BYTE(__paddr + 4 + 3, 0, 8) #endif +enum phydm_rateid_idx_88e_e { /*Copy From SD4 _RATR_TABLE_MODE*/ + PHYDM_RAID_88E_NGB = 0, /* BGN 40 Mhz 2SS 1SS */ + PHYDM_RAID_88E_NG = 1, /* GN or N */ + PHYDM_RAID_88E_NB = 2, /* BGN 20 Mhz 2SS 1SS or BN */ + PHYDM_RAID_88E_N = 3, + PHYDM_RAID_88E_GB = 4, + PHYDM_RAID_88E_G = 5, + PHYDM_RAID_88E_B = 6, + PHYDM_RAID_88E_MC = 7, + PHYDM_RAID_88E_AC_N = 8 +}; + /* End rate adaptive define */ -void -odm_ra_support_init( - struct PHY_DM_STRUCT *p_dm_odm -); +extern void phydm_tx_stats_rst(struct dm_struct *dm); -int -odm_ra_info_init_all( - struct PHY_DM_STRUCT *p_dm_odm -); +void odm_ra_support_init(struct dm_struct *dm); -int -odm_ra_info_init( - struct PHY_DM_STRUCT *p_dm_odm, - u32 mac_id -); +void odm_ra_info_init_all(struct dm_struct *dm); -u8 -odm_ra_get_sgi_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u8 mac_id -); +int odm_ra_info_init(struct dm_struct *dm, u32 mac_id); -u8 -odm_ra_get_decision_rate_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u8 mac_id -); +u8 odm_ra_get_sgi_8188e(struct dm_struct *dm, u8 mac_id); -u8 -odm_ra_get_hw_pwr_status_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u8 mac_id -); -void -odm_ra_update_rate_info_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u8 mac_id, - u8 rate_id, - u32 rate_mask, - u8 sgi_enable -); +u8 odm_ra_get_decision_rate_8188e(struct dm_struct *dm, u8 mac_id); -void -odm_ra_set_rssi_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u8 mac_id, - u8 rssi -); +u8 odm_ra_get_hw_pwr_status_8188e(struct dm_struct *dm, u8 mac_id); -void -odm_ra_tx_rpt2_handle_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u8 *tx_rpt_buf, - u16 tx_rpt_len, - u32 mac_id_valid_entry0, - u32 mac_id_valid_entry1 -); +u8 phydm_get_rate_id_88e(void *dm_void, u8 macid); +void phydm_ra_update_8188e(struct dm_struct *dm, u8 mac_id, u8 rate_id, + u32 rate_mask, u8 sgi_enable); -void -odm_ra_set_tx_rpt_time( - struct PHY_DM_STRUCT *p_dm_odm, - u16 min_rpt_time -); +void odm_ra_set_rssi_8188e(struct dm_struct *dm, u8 mac_id, u8 rssi); + +void odm_ra_tx_rpt2_handle_8188e(struct dm_struct *dm, u8 *tx_rpt_buf, + u16 tx_rpt_len, u32 mac_id_valid_entry0, + u32 mac_id_valid_entry1); + +void odm_ra_set_tx_rpt_time(struct dm_struct *dm, u16 min_rpt_time); #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/hal8188ereg.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/hal8188ereg.h index 8318e107b678..cb71015a0ae3 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/hal8188ereg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/hal8188ereg.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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: hal8188ereg.h * @@ -26,39 +22,38 @@ * * * ************************************************************ */ -#ifndef __HAL_8188E_REG_H__ +#ifndef __HAL_8188E_REG_H__ #define __HAL_8188E_REG_H__ /* * Register Definition * */ -#define TRX_ANTDIV_PATH 0x860 -#define RX_ANTDIV_PATH 0xb2c -#define ODM_R_A_AGC_CORE1_8188E 0xc50 +#define TRX_ANTDIV_PATH 0x860 +#define RX_ANTDIV_PATH 0xb2c +#define ODM_R_A_AGC_CORE1_8188E 0xc50 -#define REG_GPIO_EXT_CTRL 0x0060 +#define REG_GPIO_EXT_CTRL 0x0060 -#define REG_MCUFWDL_8188E 0x0080 -#define REG_FW_DBG_STATUS_8188E 0x0088 -#define REG_FW_DBG_CTRL_8188E 0x008F - -#define REG_CR_8188E 0x0100 +#define REG_MCUFWDL_8188E 0x0080 +#define REG_FW_DBG_STATUS_8188E 0x0088 +#define REG_FW_DBG_CTRL_8188E 0x008F +#define REG_CR_8188E 0x0100 /* * Bitmap Definition * */ -#define BIT_FA_RESET_8188E BIT(0) -#define REG_ADAPTIVE_DATA_RATE_0 0x2B0 -#define REG_DBI_WDATA_8188 0x0348 /* DBI Write data */ -#define REG_DBI_RDATA_8188 0x034C /* DBI Read data */ -#define REG_DBI_ADDR_8188 0x0350 /* DBI Address */ -#define REG_DBI_FLAG_8188 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 BIT_FA_RESET_8188E BIT(0) +#define REG_ADAPTIVE_DATA_RATE_0 0x2B0 +#define REG_DBI_WDATA_8188 0x0348 /* DBI Write data */ +#define REG_DBI_RDATA_8188 0x034C /* DBI Read data */ +#define REG_DBI_ADDR_8188 0x0350 /* DBI Address */ +#define REG_DBI_FLAG_8188 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 */ /* [0-63] */ -#define REG_MACID_NO_LINK 0x484 /* No Link register (bit[x] enabled means dropping packets for MACID in HW queue) */ +#define REG_MACID_NO_LINK 0x484 /* No Link register (bit[x] enabled means dropping packets for MACID in HW queue) */ #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_bb.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_bb.c index 3db6a8779ec1..586d17b461cc 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_bb.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_bb.c @@ -1,72 +1,78 @@ +/* SPDX-License-Identifier: GPL-2.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 -* -* -******************************************************************************/ + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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: 2.18*/ +/*Image2HeaderVersion: 3.5.2*/ #include "mp_precomp.h" #include "../phydm_precomp.h" #if (RTL8188E_SUPPORT == 1) -static bool +static boolean check_positive( - struct PHY_DM_STRUCT *p_dm_odm, - const u32 condition1, - const u32 condition2, - const u32 condition3, - const u32 condition4 + struct dm_struct *dm, + const u32 condition1, + const u32 condition2, + const u32 condition3, + const u32 condition4 ) { - u8 _board_type = ((p_dm_odm->board_type & BIT(4)) >> 4) << 0 | /* _GLNA*/ - ((p_dm_odm->board_type & BIT(3)) >> 3) << 1 | /* _GPA*/ - ((p_dm_odm->board_type & BIT(7)) >> 7) << 2 | /* _ALNA*/ - ((p_dm_odm->board_type & BIT(6)) >> 6) << 3 | /* _APA */ - ((p_dm_odm->board_type & BIT(2)) >> 2) << 4; /* _BT*/ + u8 _board_type = ((dm->board_type & BIT(4)) >> 4) << 0 | /* _GLNA*/ + ((dm->board_type & BIT(3)) >> 3) << 1 | /* _GPA*/ + ((dm->board_type & BIT(7)) >> 7) << 2 | /* _ALNA*/ + ((dm->board_type & BIT(6)) >> 6) << 3 | /* _APA */ + ((dm->board_type & BIT(2)) >> 2) << 4 | /* _BT*/ + ((dm->board_type & BIT(1)) >> 1) << 5 | /* _NGFF*/ + ((dm->board_type & BIT(5)) >> 5) << 6; /* _TRSWT*/ - u32 cond1 = condition1, cond2 = condition2, cond3 = condition3, cond4 = condition4; - u32 driver1 = p_dm_odm->cut_version << 24 | - (p_dm_odm->support_interface & 0xF0) << 16 | - p_dm_odm->support_platform << 16 | - p_dm_odm->package_type << 12 | - (p_dm_odm->support_interface & 0x0F) << 8 | - _board_type; + u32 cond1 = condition1, cond2 = condition2, cond3 = condition3, cond4 = condition4; - u32 driver2 = (p_dm_odm->type_glna & 0xFF) << 0 | - (p_dm_odm->type_gpa & 0xFF) << 8 | - (p_dm_odm->type_alna & 0xFF) << 16 | - (p_dm_odm->type_apa & 0xFF) << 24; + u8 cut_version_for_para = (dm->cut_version == ODM_CUT_A) ? 15 : dm->cut_version; + u8 pkg_type_for_para = (dm->package_type == 0) ? 15 : dm->package_type; - u32 driver3 = 0; + u32 driver1 = cut_version_for_para << 24 | + (dm->support_interface & 0xF0) << 16 | + dm->support_platform << 16 | + pkg_type_for_para << 12 | + (dm->support_interface & 0x0F) << 8 | + _board_type; - u32 driver4 = (p_dm_odm->type_glna & 0xFF00) >> 8 | - (p_dm_odm->type_gpa & 0xFF00) | - (p_dm_odm->type_alna & 0xFF00) << 8 | - (p_dm_odm->type_apa & 0xFF00) << 16; + u32 driver2 = (dm->type_glna & 0xFF) << 0 | + (dm->type_gpa & 0xFF) << 8 | + (dm->type_alna & 0xFF) << 16 | + (dm->type_apa & 0xFF) << 24; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_TRACE, - ("===> check_positive (cond1, cond2, cond3, cond4) = (0x%X 0x%X 0x%X 0x%X)\n", cond1, cond2, cond3, cond4)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_TRACE, - ("===> check_positive (driver1, driver2, driver3, driver4) = (0x%X 0x%X 0x%X 0x%X)\n", driver1, driver2, driver3, driver4)); + u32 driver3 = 0; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_TRACE, - (" (Platform, Interface) = (0x%X, 0x%X)\n", p_dm_odm->support_platform, p_dm_odm->support_interface)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_TRACE, - (" (Board, Package) = (0x%X, 0x%X)\n", p_dm_odm->board_type, p_dm_odm->package_type)); + u32 driver4 = (dm->type_glna & 0xFF00) >> 8 | + (dm->type_gpa & 0xFF00) | + (dm->type_alna & 0xFF00) << 8 | + (dm->type_apa & 0xFF00) << 16; + + PHYDM_DBG(dm, ODM_COMP_INIT, + "===> %s (cond1, cond2, cond3, cond4) = (0x%X 0x%X 0x%X 0x%X)\n", + __func__, cond1, cond2, cond3, cond4); + PHYDM_DBG(dm, ODM_COMP_INIT, + "===> %s (driver1, driver2, driver3, driver4) = (0x%X 0x%X 0x%X 0x%X)\n", + __func__, driver1, driver2, driver3, driver4); + + PHYDM_DBG(dm, ODM_COMP_INIT, + " (Platform, Interface) = (0x%X, 0x%X)\n", + dm->support_platform, dm->support_interface); + PHYDM_DBG(dm, ODM_COMP_INIT, + " (Board, Package) = (0x%X, 0x%X)\n", dm->board_type, + dm->package_type); /*============== value Defined Check ===============*/ @@ -80,11 +86,11 @@ check_positive( /*=============== Bit Defined Check ================*/ /* We don't care [31:28] */ - cond1 &= 0x00FF0FFF; + cond1 &= 0x00FF0FFF; driver1 &= 0x00FF0FFF; if ((cond1 & driver1) == cond1) { - u32 bit_mask = 0; + u32 bit_mask = 0; if ((cond1 & 0x0F) == 0) /* board_type is DONTCARE*/ return true; @@ -105,991 +111,980 @@ check_positive( } else return false; } -static bool -check_negative( - struct PHY_DM_STRUCT *p_dm_odm, - const u32 condition1, - const u32 condition2 -) -{ - return true; -} /****************************************************************************** -* AGC_TAB.TXT +* agc_tab.TXT ******************************************************************************/ u32 array_mp_8188e_agc_tab[] = { 0x88000001, 0x00000000, 0x40000000, 0x00000000, - 0xC78, 0xF6000001, - 0xC78, 0xF5010001, - 0xC78, 0xF4020001, - 0xC78, 0xF3030001, - 0xC78, 0xF2040001, + 0xC78, 0xF6000001, + 0xC78, 0xF5010001, + 0xC78, 0xF4020001, + 0xC78, 0xF3030001, + 0xC78, 0xF2040001, 0x90000001, 0x00000000, 0x40000000, 0x00000000, - 0xC78, 0xF7000001, - 0xC78, 0xF6010001, - 0xC78, 0xF5020001, - 0xC78, 0xF4030001, - 0xC78, 0xF3040001, + 0xC78, 0xF7000001, + 0xC78, 0xF6010001, + 0xC78, 0xF5020001, + 0xC78, 0xF4030001, + 0xC78, 0xF3040001, 0x90000001, 0x00000001, 0x40000000, 0x00000000, - 0xC78, 0xF9000001, - 0xC78, 0xF8010001, - 0xC78, 0xF7020001, - 0xC78, 0xF6030001, - 0xC78, 0xF5040001, + 0xC78, 0xF9000001, + 0xC78, 0xF8010001, + 0xC78, 0xF7020001, + 0xC78, 0xF6030001, + 0xC78, 0xF5040001, 0x98000001, 0x00000002, 0x40000000, 0x00000000, - 0xC78, 0xFB000001, - 0xC78, 0xFB010001, - 0xC78, 0xFA020001, - 0xC78, 0xF9030001, - 0xC78, 0xF8040001, + 0xC78, 0xFB000001, + 0xC78, 0xFB010001, + 0xC78, 0xFA020001, + 0xC78, 0xF9030001, + 0xC78, 0xF8040001, 0x90000001, 0x00000002, 0x40000000, 0x00000000, - 0xC78, 0xFF000001, - 0xC78, 0xFF010001, - 0xC78, 0xFE020001, - 0xC78, 0xFD030001, - 0xC78, 0xFC040001, + 0xC78, 0xFF000001, + 0xC78, 0xFF010001, + 0xC78, 0xFE020001, + 0xC78, 0xFD030001, + 0xC78, 0xFC040001, 0xA0000000, 0x00000000, - 0xC78, 0xFB000001, - 0xC78, 0xFB010001, - 0xC78, 0xFB020001, - 0xC78, 0xFB030001, - 0xC78, 0xFB040001, + 0xC78, 0xFB000001, + 0xC78, 0xFB010001, + 0xC78, 0xFB020001, + 0xC78, 0xFB030001, + 0xC78, 0xFB040001, 0xB0000000, 0x00000000, 0x88000001, 0x00000000, 0x40000000, 0x00000000, - 0xC78, 0xF1050001, - 0xC78, 0xF0060001, - 0xC78, 0xEF070001, - 0xC78, 0xEE080001, - 0xC78, 0xED090001, - 0xC78, 0xEC0A0001, - 0xC78, 0xEB0B0001, - 0xC78, 0xEA0C0001, - 0xC78, 0xE90D0001, - 0xC78, 0xE80E0001, - 0xC78, 0xE70F0001, - 0xC78, 0xE6100001, - 0xC78, 0xE5110001, - 0xC78, 0xE4120001, - 0xC78, 0xE3130001, - 0xC78, 0xE2140001, - 0xC78, 0xC5150001, - 0xC78, 0xC4160001, - 0xC78, 0xC3170001, - 0xC78, 0xC2180001, - 0xC78, 0x88190001, - 0xC78, 0x871A0001, - 0xC78, 0x861B0001, - 0xC78, 0x851C0001, - 0xC78, 0x841D0001, - 0xC78, 0x831E0001, - 0xC78, 0x821F0001, - 0xC78, 0x81200001, - 0xC78, 0x80210001, + 0xC78, 0xF1050001, + 0xC78, 0xF0060001, + 0xC78, 0xEF070001, + 0xC78, 0xEE080001, + 0xC78, 0xED090001, + 0xC78, 0xEC0A0001, + 0xC78, 0xEB0B0001, + 0xC78, 0xEA0C0001, + 0xC78, 0xE90D0001, + 0xC78, 0xE80E0001, + 0xC78, 0xE70F0001, + 0xC78, 0xE6100001, + 0xC78, 0xE5110001, + 0xC78, 0xE4120001, + 0xC78, 0xE3130001, + 0xC78, 0xE2140001, + 0xC78, 0xC5150001, + 0xC78, 0xC4160001, + 0xC78, 0xC3170001, + 0xC78, 0xC2180001, + 0xC78, 0x88190001, + 0xC78, 0x871A0001, + 0xC78, 0x861B0001, + 0xC78, 0x851C0001, + 0xC78, 0x841D0001, + 0xC78, 0x831E0001, + 0xC78, 0x821F0001, + 0xC78, 0x81200001, + 0xC78, 0x80210001, 0x90000001, 0x00000000, 0x40000000, 0x00000000, - 0xC78, 0xF2050001, - 0xC78, 0xF1060001, - 0xC78, 0xF0070001, - 0xC78, 0xEF080001, - 0xC78, 0xEE090001, - 0xC78, 0xED0A0001, - 0xC78, 0xEC0B0001, - 0xC78, 0xEB0C0001, - 0xC78, 0xEA0D0001, - 0xC78, 0xE90E0001, - 0xC78, 0xE80F0001, - 0xC78, 0xE7100001, - 0xC78, 0xE6110001, - 0xC78, 0xE5120001, - 0xC78, 0xE4130001, - 0xC78, 0xE3140001, - 0xC78, 0xE2150001, - 0xC78, 0xE1160001, - 0xC78, 0x89170001, - 0xC78, 0x88180001, - 0xC78, 0x87190001, - 0xC78, 0x861A0001, - 0xC78, 0x851B0001, - 0xC78, 0x841C0001, - 0xC78, 0x831D0001, - 0xC78, 0x821E0001, - 0xC78, 0x811F0001, - 0xC78, 0x6B200001, - 0xC78, 0x6A210001, + 0xC78, 0xF2050001, + 0xC78, 0xF1060001, + 0xC78, 0xF0070001, + 0xC78, 0xEF080001, + 0xC78, 0xEE090001, + 0xC78, 0xED0A0001, + 0xC78, 0xEC0B0001, + 0xC78, 0xEB0C0001, + 0xC78, 0xEA0D0001, + 0xC78, 0xE90E0001, + 0xC78, 0xE80F0001, + 0xC78, 0xE7100001, + 0xC78, 0xE6110001, + 0xC78, 0xE5120001, + 0xC78, 0xE4130001, + 0xC78, 0xE3140001, + 0xC78, 0xE2150001, + 0xC78, 0xE1160001, + 0xC78, 0x89170001, + 0xC78, 0x88180001, + 0xC78, 0x87190001, + 0xC78, 0x861A0001, + 0xC78, 0x851B0001, + 0xC78, 0x841C0001, + 0xC78, 0x831D0001, + 0xC78, 0x821E0001, + 0xC78, 0x811F0001, + 0xC78, 0x6B200001, + 0xC78, 0x6A210001, 0x90000001, 0x00000001, 0x40000000, 0x00000000, - 0xC78, 0xF4050001, - 0xC78, 0xF3060001, - 0xC78, 0xF2070001, - 0xC78, 0xF1080001, - 0xC78, 0xF0090001, - 0xC78, 0xEF0A0001, - 0xC78, 0xEE0B0001, - 0xC78, 0xED0C0001, - 0xC78, 0xEC0D0001, - 0xC78, 0xEB0E0001, - 0xC78, 0xEA0F0001, - 0xC78, 0xE9100001, - 0xC78, 0xE8110001, - 0xC78, 0xE7120001, - 0xC78, 0xE6130001, - 0xC78, 0xE5140001, - 0xC78, 0xE4150001, - 0xC78, 0xE3160001, - 0xC78, 0xE2170001, - 0xC78, 0xE1180001, - 0xC78, 0x8A190001, - 0xC78, 0x891A0001, - 0xC78, 0x881B0001, - 0xC78, 0x871C0001, - 0xC78, 0x861D0001, - 0xC78, 0x851E0001, - 0xC78, 0x841F0001, - 0xC78, 0x83200001, - 0xC78, 0x82210001, + 0xC78, 0xF4050001, + 0xC78, 0xF3060001, + 0xC78, 0xF2070001, + 0xC78, 0xF1080001, + 0xC78, 0xF0090001, + 0xC78, 0xEF0A0001, + 0xC78, 0xEE0B0001, + 0xC78, 0xED0C0001, + 0xC78, 0xEC0D0001, + 0xC78, 0xEB0E0001, + 0xC78, 0xEA0F0001, + 0xC78, 0xE9100001, + 0xC78, 0xE8110001, + 0xC78, 0xE7120001, + 0xC78, 0xE6130001, + 0xC78, 0xE5140001, + 0xC78, 0xE4150001, + 0xC78, 0xE3160001, + 0xC78, 0xE2170001, + 0xC78, 0xE1180001, + 0xC78, 0x8A190001, + 0xC78, 0x891A0001, + 0xC78, 0x881B0001, + 0xC78, 0x871C0001, + 0xC78, 0x861D0001, + 0xC78, 0x851E0001, + 0xC78, 0x841F0001, + 0xC78, 0x83200001, + 0xC78, 0x82210001, 0x98000001, 0x00000002, 0x40000000, 0x00000000, - 0xC78, 0xF7050001, - 0xC78, 0xF6060001, - 0xC78, 0xF5070001, - 0xC78, 0xF4080001, - 0xC78, 0xF3090001, - 0xC78, 0xF20A0001, - 0xC78, 0xF10B0001, - 0xC78, 0xF00C0001, - 0xC78, 0xEF0D0001, - 0xC78, 0xEE0E0001, - 0xC78, 0xED0F0001, - 0xC78, 0xEC100001, - 0xC78, 0xEB110001, - 0xC78, 0xEA120001, - 0xC78, 0xE9130001, - 0xC78, 0xE8140001, - 0xC78, 0xE7150001, - 0xC78, 0xE6160001, - 0xC78, 0xE5170001, - 0xC78, 0xE4180001, - 0xC78, 0xC7190001, - 0xC78, 0xC61A0001, - 0xC78, 0xC51B0001, - 0xC78, 0xC41C0001, - 0xC78, 0xC31D0001, - 0xC78, 0xC21E0001, - 0xC78, 0x871F0001, - 0xC78, 0x86200001, - 0xC78, 0x85210001, + 0xC78, 0xF7050001, + 0xC78, 0xF6060001, + 0xC78, 0xF5070001, + 0xC78, 0xF4080001, + 0xC78, 0xF3090001, + 0xC78, 0xF20A0001, + 0xC78, 0xF10B0001, + 0xC78, 0xF00C0001, + 0xC78, 0xEF0D0001, + 0xC78, 0xEE0E0001, + 0xC78, 0xED0F0001, + 0xC78, 0xEC100001, + 0xC78, 0xEB110001, + 0xC78, 0xEA120001, + 0xC78, 0xE9130001, + 0xC78, 0xE8140001, + 0xC78, 0xE7150001, + 0xC78, 0xE6160001, + 0xC78, 0xE5170001, + 0xC78, 0xE4180001, + 0xC78, 0xC7190001, + 0xC78, 0xC61A0001, + 0xC78, 0xC51B0001, + 0xC78, 0xC41C0001, + 0xC78, 0xC31D0001, + 0xC78, 0xC21E0001, + 0xC78, 0x871F0001, + 0xC78, 0x86200001, + 0xC78, 0x85210001, 0x90000001, 0x00000002, 0x40000000, 0x00000000, - 0xC78, 0xFB050001, - 0xC78, 0xFA060001, - 0xC78, 0xF9070001, - 0xC78, 0xF8080001, - 0xC78, 0xF7090001, - 0xC78, 0xF60A0001, - 0xC78, 0xF50B0001, - 0xC78, 0xF40C0001, - 0xC78, 0xF30D0001, - 0xC78, 0xF20E0001, - 0xC78, 0xF10F0001, - 0xC78, 0xF0100001, - 0xC78, 0xEF110001, - 0xC78, 0xEE120001, - 0xC78, 0xED130001, - 0xC78, 0xEC140001, - 0xC78, 0xEB150001, - 0xC78, 0xEA160001, - 0xC78, 0xE9170001, - 0xC78, 0xE8180001, - 0xC78, 0xE7190001, - 0xC78, 0xE61A0001, - 0xC78, 0xC51B0001, - 0xC78, 0xC41C0001, - 0xC78, 0xC31D0001, - 0xC78, 0xC21E0001, - 0xC78, 0x881F0001, - 0xC78, 0x87200001, - 0xC78, 0x86210001, + 0xC78, 0xFB050001, + 0xC78, 0xFA060001, + 0xC78, 0xF9070001, + 0xC78, 0xF8080001, + 0xC78, 0xF7090001, + 0xC78, 0xF60A0001, + 0xC78, 0xF50B0001, + 0xC78, 0xF40C0001, + 0xC78, 0xF30D0001, + 0xC78, 0xF20E0001, + 0xC78, 0xF10F0001, + 0xC78, 0xF0100001, + 0xC78, 0xEF110001, + 0xC78, 0xEE120001, + 0xC78, 0xED130001, + 0xC78, 0xEC140001, + 0xC78, 0xEB150001, + 0xC78, 0xEA160001, + 0xC78, 0xE9170001, + 0xC78, 0xE8180001, + 0xC78, 0xE7190001, + 0xC78, 0xE61A0001, + 0xC78, 0xC51B0001, + 0xC78, 0xC41C0001, + 0xC78, 0xC31D0001, + 0xC78, 0xC21E0001, + 0xC78, 0x881F0001, + 0xC78, 0x87200001, + 0xC78, 0x86210001, 0x98000000, 0x00000000, 0x40000000, 0x00000000, - 0xC78, 0xFA050001, - 0xC78, 0xF9060001, - 0xC78, 0xF8070001, - 0xC78, 0xF7080001, - 0xC78, 0xF6090001, - 0xC78, 0xF50A0001, - 0xC78, 0xF40B0001, - 0xC78, 0xF30C0001, - 0xC78, 0xF20D0001, - 0xC78, 0xF10E0001, - 0xC78, 0xF00F0001, - 0xC78, 0xEF100001, - 0xC78, 0xEE110001, - 0xC78, 0xED120001, - 0xC78, 0xEC130001, - 0xC78, 0xEB140001, - 0xC78, 0xEA150001, - 0xC78, 0xE9160001, - 0xC78, 0xE8170001, - 0xC78, 0xE7180001, - 0xC78, 0xE6190001, - 0xC78, 0xE51A0001, - 0xC78, 0xE41B0001, - 0xC78, 0xC71C0001, - 0xC78, 0xC61D0001, - 0xC78, 0xC51E0001, - 0xC78, 0xC41F0001, - 0xC78, 0xC3200001, - 0xC78, 0xC2210001, + 0xC78, 0xFA050001, + 0xC78, 0xF9060001, + 0xC78, 0xF8070001, + 0xC78, 0xF7080001, + 0xC78, 0xF6090001, + 0xC78, 0xF50A0001, + 0xC78, 0xF40B0001, + 0xC78, 0xF30C0001, + 0xC78, 0xF20D0001, + 0xC78, 0xF10E0001, + 0xC78, 0xF00F0001, + 0xC78, 0xEF100001, + 0xC78, 0xEE110001, + 0xC78, 0xED120001, + 0xC78, 0xEC130001, + 0xC78, 0xEB140001, + 0xC78, 0xEA150001, + 0xC78, 0xE9160001, + 0xC78, 0xE8170001, + 0xC78, 0xE7180001, + 0xC78, 0xE6190001, + 0xC78, 0xE51A0001, + 0xC78, 0xE41B0001, + 0xC78, 0xC71C0001, + 0xC78, 0xC61D0001, + 0xC78, 0xC51E0001, + 0xC78, 0xC41F0001, + 0xC78, 0xC3200001, + 0xC78, 0xC2210001, 0xA0000000, 0x00000000, - 0xC78, 0xFB050001, - 0xC78, 0xFA060001, - 0xC78, 0xF9070001, - 0xC78, 0xF8080001, - 0xC78, 0xF7090001, - 0xC78, 0xF60A0001, - 0xC78, 0xF50B0001, - 0xC78, 0xF40C0001, - 0xC78, 0xF30D0001, - 0xC78, 0xF20E0001, - 0xC78, 0xF10F0001, - 0xC78, 0xF0100001, - 0xC78, 0xEF110001, - 0xC78, 0xEE120001, - 0xC78, 0xED130001, - 0xC78, 0xEC140001, - 0xC78, 0xEB150001, - 0xC78, 0xEA160001, - 0xC78, 0xE9170001, - 0xC78, 0xE8180001, - 0xC78, 0xE7190001, - 0xC78, 0xE61A0001, - 0xC78, 0xE51B0001, - 0xC78, 0xE41C0001, - 0xC78, 0xE31D0001, - 0xC78, 0xE21E0001, - 0xC78, 0xE11F0001, - 0xC78, 0x8A200001, - 0xC78, 0x89210001, + 0xC78, 0xFB050001, + 0xC78, 0xFA060001, + 0xC78, 0xF9070001, + 0xC78, 0xF8080001, + 0xC78, 0xF7090001, + 0xC78, 0xF60A0001, + 0xC78, 0xF50B0001, + 0xC78, 0xF40C0001, + 0xC78, 0xF30D0001, + 0xC78, 0xF20E0001, + 0xC78, 0xF10F0001, + 0xC78, 0xF0100001, + 0xC78, 0xEF110001, + 0xC78, 0xEE120001, + 0xC78, 0xED130001, + 0xC78, 0xEC140001, + 0xC78, 0xEB150001, + 0xC78, 0xEA160001, + 0xC78, 0xE9170001, + 0xC78, 0xE8180001, + 0xC78, 0xE7190001, + 0xC78, 0xE61A0001, + 0xC78, 0xE51B0001, + 0xC78, 0xE41C0001, + 0xC78, 0xE31D0001, + 0xC78, 0xE21E0001, + 0xC78, 0xE11F0001, + 0xC78, 0x8A200001, + 0xC78, 0x89210001, 0xB0000000, 0x00000000, 0x88000001, 0x00000000, 0x40000000, 0x00000000, - 0xC78, 0x66220001, - 0xC78, 0x65230001, - 0xC78, 0x64240001, - 0xC78, 0x63250001, - 0xC78, 0x62260001, - 0xC78, 0x61270001, - 0xC78, 0x60280001, + 0xC78, 0x66220001, + 0xC78, 0x65230001, + 0xC78, 0x64240001, + 0xC78, 0x63250001, + 0xC78, 0x62260001, + 0xC78, 0x61270001, + 0xC78, 0x60280001, 0x90000001, 0x00000000, 0x40000000, 0x00000000, - 0xC78, 0x69220001, - 0xC78, 0x68230001, - 0xC78, 0x67240001, - 0xC78, 0x66250001, - 0xC78, 0x65260001, - 0xC78, 0x64270001, - 0xC78, 0x63280001, + 0xC78, 0x69220001, + 0xC78, 0x68230001, + 0xC78, 0x67240001, + 0xC78, 0x66250001, + 0xC78, 0x65260001, + 0xC78, 0x64270001, + 0xC78, 0x63280001, 0x90000001, 0x00000001, 0x40000000, 0x00000000, - 0xC78, 0x6B220001, - 0xC78, 0x6A230001, - 0xC78, 0x69240001, - 0xC78, 0x68250001, - 0xC78, 0x67260001, - 0xC78, 0x66270001, - 0xC78, 0x65280001, + 0xC78, 0x6B220001, + 0xC78, 0x6A230001, + 0xC78, 0x69240001, + 0xC78, 0x68250001, + 0xC78, 0x67260001, + 0xC78, 0x66270001, + 0xC78, 0x65280001, 0x98000001, 0x00000002, 0x40000000, 0x00000000, - 0xC78, 0x84220001, - 0xC78, 0x83230001, - 0xC78, 0x82240001, - 0xC78, 0x81250001, - 0xC78, 0x67260001, - 0xC78, 0x66270001, - 0xC78, 0x65280001, + 0xC78, 0x84220001, + 0xC78, 0x83230001, + 0xC78, 0x82240001, + 0xC78, 0x81250001, + 0xC78, 0x67260001, + 0xC78, 0x66270001, + 0xC78, 0x65280001, 0x90000001, 0x00000002, 0x40000000, 0x00000000, - 0xC78, 0x85220001, - 0xC78, 0x84230001, - 0xC78, 0x83240001, - 0xC78, 0x82250001, - 0xC78, 0x6A260001, - 0xC78, 0x69270001, - 0xC78, 0x68280001, + 0xC78, 0x85220001, + 0xC78, 0x84230001, + 0xC78, 0x83240001, + 0xC78, 0x82250001, + 0xC78, 0x6A260001, + 0xC78, 0x69270001, + 0xC78, 0x68280001, 0xA0000000, 0x00000000, - 0xC78, 0x88220001, - 0xC78, 0x87230001, - 0xC78, 0x86240001, - 0xC78, 0x85250001, - 0xC78, 0x84260001, - 0xC78, 0x83270001, - 0xC78, 0x82280001, + 0xC78, 0x88220001, + 0xC78, 0x87230001, + 0xC78, 0x86240001, + 0xC78, 0x85250001, + 0xC78, 0x84260001, + 0xC78, 0x83270001, + 0xC78, 0x82280001, 0xB0000000, 0x00000000, 0x88000001, 0x00000000, 0x40000000, 0x00000000, - 0xC78, 0x4A290001, - 0xC78, 0x492A0001, - 0xC78, 0x482B0001, - 0xC78, 0x472C0001, + 0xC78, 0x4A290001, + 0xC78, 0x492A0001, + 0xC78, 0x482B0001, + 0xC78, 0x472C0001, 0x90000001, 0x00000000, 0x40000000, 0x00000000, - 0xC78, 0x62290001, - 0xC78, 0x612A0001, - 0xC78, 0x462B0001, - 0xC78, 0x452C0001, + 0xC78, 0x62290001, + 0xC78, 0x612A0001, + 0xC78, 0x462B0001, + 0xC78, 0x452C0001, 0x90000001, 0x00000001, 0x40000000, 0x00000000, - 0xC78, 0x64290001, - 0xC78, 0x632A0001, - 0xC78, 0x622B0001, - 0xC78, 0x612C0001, + 0xC78, 0x64290001, + 0xC78, 0x632A0001, + 0xC78, 0x622B0001, + 0xC78, 0x612C0001, 0x98000001, 0x00000002, 0x40000000, 0x00000000, - 0xC78, 0x64290001, - 0xC78, 0x632A0001, - 0xC78, 0x622B0001, - 0xC78, 0x612C0001, + 0xC78, 0x64290001, + 0xC78, 0x632A0001, + 0xC78, 0x622B0001, + 0xC78, 0x612C0001, 0x90000001, 0x00000002, 0x40000000, 0x00000000, - 0xC78, 0x67290001, - 0xC78, 0x662A0001, - 0xC78, 0x652B0001, - 0xC78, 0x642C0001, + 0xC78, 0x67290001, + 0xC78, 0x662A0001, + 0xC78, 0x652B0001, + 0xC78, 0x642C0001, 0x98000000, 0x00000000, 0x40000000, 0x00000000, - 0xC78, 0x81290001, - 0xC78, 0x242A0001, - 0xC78, 0x232B0001, - 0xC78, 0x222C0001, + 0xC78, 0x81290001, + 0xC78, 0x242A0001, + 0xC78, 0x232B0001, + 0xC78, 0x222C0001, 0xA0000000, 0x00000000, - 0xC78, 0x6B290001, - 0xC78, 0x6A2A0001, - 0xC78, 0x692B0001, - 0xC78, 0x682C0001, + 0xC78, 0x6B290001, + 0xC78, 0x6A2A0001, + 0xC78, 0x692B0001, + 0xC78, 0x682C0001, 0xB0000000, 0x00000000, 0x88000001, 0x00000000, 0x40000000, 0x00000000, - 0xC78, 0x462D0001, - 0xC78, 0x452E0001, - 0xC78, 0x442F0001, - 0xC78, 0x43300001, - 0xC78, 0x42310001, - 0xC78, 0x41320001, - 0xC78, 0x40330001, + 0xC78, 0x462D0001, + 0xC78, 0x452E0001, + 0xC78, 0x442F0001, + 0xC78, 0x43300001, + 0xC78, 0x42310001, + 0xC78, 0x41320001, + 0xC78, 0x40330001, 0x90000001, 0x00000000, 0x40000000, 0x00000000, - 0xC78, 0x442D0001, - 0xC78, 0x432E0001, - 0xC78, 0x422F0001, - 0xC78, 0x41300001, - 0xC78, 0x40310001, - 0xC78, 0x40320001, - 0xC78, 0x40330001, + 0xC78, 0x442D0001, + 0xC78, 0x432E0001, + 0xC78, 0x422F0001, + 0xC78, 0x41300001, + 0xC78, 0x40310001, + 0xC78, 0x40320001, + 0xC78, 0x40330001, 0x90000001, 0x00000001, 0x40000000, 0x00000000, - 0xC78, 0x462D0001, - 0xC78, 0x452E0001, - 0xC78, 0x442F0001, - 0xC78, 0x43300001, - 0xC78, 0x42310001, - 0xC78, 0x41320001, - 0xC78, 0x40330001, + 0xC78, 0x462D0001, + 0xC78, 0x452E0001, + 0xC78, 0x442F0001, + 0xC78, 0x43300001, + 0xC78, 0x42310001, + 0xC78, 0x41320001, + 0xC78, 0x40330001, 0x98000001, 0x00000002, 0x40000000, 0x00000000, - 0xC78, 0x4B2D0001, - 0xC78, 0x4A2E0001, - 0xC78, 0x492F0001, - 0xC78, 0x48300001, - 0xC78, 0x47310001, - 0xC78, 0x46320001, - 0xC78, 0x45330001, + 0xC78, 0x4B2D0001, + 0xC78, 0x4A2E0001, + 0xC78, 0x492F0001, + 0xC78, 0x48300001, + 0xC78, 0x47310001, + 0xC78, 0x46320001, + 0xC78, 0x45330001, 0x90000001, 0x00000002, 0x40000000, 0x00000000, - 0xC78, 0x4A2D0001, - 0xC78, 0x492E0001, - 0xC78, 0x482F0001, - 0xC78, 0x47300001, - 0xC78, 0x46310001, - 0xC78, 0x45320001, - 0xC78, 0x44330001, + 0xC78, 0x4A2D0001, + 0xC78, 0x492E0001, + 0xC78, 0x482F0001, + 0xC78, 0x47300001, + 0xC78, 0x46310001, + 0xC78, 0x45320001, + 0xC78, 0x44330001, 0xA0000000, 0x00000000, - 0xC78, 0x672D0001, - 0xC78, 0x662E0001, - 0xC78, 0x652F0001, - 0xC78, 0x64300001, - 0xC78, 0x63310001, - 0xC78, 0x62320001, - 0xC78, 0x61330001, + 0xC78, 0x672D0001, + 0xC78, 0x662E0001, + 0xC78, 0x652F0001, + 0xC78, 0x64300001, + 0xC78, 0x63310001, + 0xC78, 0x62320001, + 0xC78, 0x61330001, 0xB0000000, 0x00000000, 0x88000001, 0x00000000, 0x40000000, 0x00000000, - 0xC78, 0x40340001, - 0xC78, 0x40350001, - 0xC78, 0x40360001, - 0xC78, 0x40370001, - 0xC78, 0x40380001, - 0xC78, 0x40390001, - 0xC78, 0x403A0001, - 0xC78, 0x403B0001, - 0xC78, 0x403C0001, - 0xC78, 0x403D0001, - 0xC78, 0x403E0001, + 0xC78, 0x40340001, + 0xC78, 0x40350001, + 0xC78, 0x40360001, + 0xC78, 0x40370001, + 0xC78, 0x40380001, + 0xC78, 0x40390001, + 0xC78, 0x403A0001, + 0xC78, 0x403B0001, + 0xC78, 0x403C0001, + 0xC78, 0x403D0001, + 0xC78, 0x403E0001, 0x90000001, 0x00000000, 0x40000000, 0x00000000, - 0xC78, 0x40340001, - 0xC78, 0x40350001, - 0xC78, 0x40360001, - 0xC78, 0x40370001, - 0xC78, 0x40380001, - 0xC78, 0x40390001, - 0xC78, 0x403A0001, - 0xC78, 0x403B0001, - 0xC78, 0x403C0001, - 0xC78, 0x403D0001, - 0xC78, 0x403E0001, + 0xC78, 0x40340001, + 0xC78, 0x40350001, + 0xC78, 0x40360001, + 0xC78, 0x40370001, + 0xC78, 0x40380001, + 0xC78, 0x40390001, + 0xC78, 0x403A0001, + 0xC78, 0x403B0001, + 0xC78, 0x403C0001, + 0xC78, 0x403D0001, + 0xC78, 0x403E0001, 0x90000001, 0x00000001, 0x40000000, 0x00000000, - 0xC78, 0x40340001, - 0xC78, 0x40350001, - 0xC78, 0x40360001, - 0xC78, 0x40370001, - 0xC78, 0x40380001, - 0xC78, 0x40390001, - 0xC78, 0x403A0001, - 0xC78, 0x403B0001, - 0xC78, 0x403C0001, - 0xC78, 0x403D0001, - 0xC78, 0x403E0001, + 0xC78, 0x40340001, + 0xC78, 0x40350001, + 0xC78, 0x40360001, + 0xC78, 0x40370001, + 0xC78, 0x40380001, + 0xC78, 0x40390001, + 0xC78, 0x403A0001, + 0xC78, 0x403B0001, + 0xC78, 0x403C0001, + 0xC78, 0x403D0001, + 0xC78, 0x403E0001, 0x98000001, 0x00000002, 0x40000000, 0x00000000, - 0xC78, 0x44340001, - 0xC78, 0x43350001, - 0xC78, 0x42360001, - 0xC78, 0x41370001, - 0xC78, 0x40380001, - 0xC78, 0x40390001, - 0xC78, 0x403A0001, - 0xC78, 0x403B0001, - 0xC78, 0x403C0001, - 0xC78, 0x403D0001, - 0xC78, 0x403E0001, + 0xC78, 0x44340001, + 0xC78, 0x43350001, + 0xC78, 0x42360001, + 0xC78, 0x41370001, + 0xC78, 0x40380001, + 0xC78, 0x40390001, + 0xC78, 0x403A0001, + 0xC78, 0x403B0001, + 0xC78, 0x403C0001, + 0xC78, 0x403D0001, + 0xC78, 0x403E0001, 0x90000001, 0x00000002, 0x40000000, 0x00000000, - 0xC78, 0x43340001, - 0xC78, 0x42350001, - 0xC78, 0x41360001, - 0xC78, 0x40370001, - 0xC78, 0x40380001, - 0xC78, 0x40390001, - 0xC78, 0x403A0001, - 0xC78, 0x403B0001, - 0xC78, 0x403C0001, - 0xC78, 0x403D0001, - 0xC78, 0x403E0001, + 0xC78, 0x43340001, + 0xC78, 0x42350001, + 0xC78, 0x41360001, + 0xC78, 0x40370001, + 0xC78, 0x40380001, + 0xC78, 0x40390001, + 0xC78, 0x403A0001, + 0xC78, 0x403B0001, + 0xC78, 0x403C0001, + 0xC78, 0x403D0001, + 0xC78, 0x403E0001, 0x98000000, 0x00000000, 0x40000000, 0x00000000, - 0xC78, 0x60340001, - 0xC78, 0x4A350001, - 0xC78, 0x49360001, - 0xC78, 0x48370001, - 0xC78, 0x47380001, - 0xC78, 0x46390001, - 0xC78, 0x453A0001, - 0xC78, 0x443B0001, - 0xC78, 0x433C0001, - 0xC78, 0x423D0001, - 0xC78, 0x413E0001, + 0xC78, 0x60340001, + 0xC78, 0x4A350001, + 0xC78, 0x49360001, + 0xC78, 0x48370001, + 0xC78, 0x47380001, + 0xC78, 0x46390001, + 0xC78, 0x453A0001, + 0xC78, 0x443B0001, + 0xC78, 0x433C0001, + 0xC78, 0x423D0001, + 0xC78, 0x413E0001, 0xA0000000, 0x00000000, - 0xC78, 0x46340001, - 0xC78, 0x45350001, - 0xC78, 0x44360001, - 0xC78, 0x43370001, - 0xC78, 0x42380001, - 0xC78, 0x41390001, - 0xC78, 0x403A0001, - 0xC78, 0x403B0001, - 0xC78, 0x403C0001, - 0xC78, 0x403D0001, - 0xC78, 0x403E0001, + 0xC78, 0x46340001, + 0xC78, 0x45350001, + 0xC78, 0x44360001, + 0xC78, 0x43370001, + 0xC78, 0x42380001, + 0xC78, 0x41390001, + 0xC78, 0x403A0001, + 0xC78, 0x403B0001, + 0xC78, 0x403C0001, + 0xC78, 0x403D0001, + 0xC78, 0x403E0001, 0xB0000000, 0x00000000, 0x80000001, 0x00000001, 0x40000000, 0x00000000, - 0xC78, 0x403F0001, + 0xC78, 0x403F0001, 0x98000001, 0x00000002, 0x40000000, 0x00000000, - 0xC78, 0x403F0001, + 0xC78, 0x403F0001, 0x90000001, 0x00000002, 0x40000000, 0x00000000, - 0xC78, 0x403F0001, + 0xC78, 0x403F0001, 0xA0000000, 0x00000000, - 0xC78, 0x403F0001, + 0xC78, 0x403F0001, 0xB0000000, 0x00000000, 0x88000001, 0x00000000, 0x40000000, 0x00000000, - 0xC78, 0xFB400001, - 0xC78, 0xFA410001, - 0xC78, 0xF9420001, - 0xC78, 0xF8430001, - 0xC78, 0xF7440001, - 0xC78, 0xF6450001, - 0xC78, 0xF5460001, - 0xC78, 0xF4470001, - 0xC78, 0xF3480001, - 0xC78, 0xF2490001, - 0xC78, 0xF14A0001, - 0xC78, 0xF04B0001, - 0xC78, 0xEF4C0001, - 0xC78, 0xEE4D0001, - 0xC78, 0xED4E0001, - 0xC78, 0xEC4F0001, - 0xC78, 0xEB500001, - 0xC78, 0xEA510001, - 0xC78, 0xE9520001, - 0xC78, 0xE8530001, - 0xC78, 0xE7540001, - 0xC78, 0xE6550001, - 0xC78, 0xE5560001, - 0xC78, 0xC6570001, - 0xC78, 0xC5580001, - 0xC78, 0xC4590001, - 0xC78, 0xC35A0001, - 0xC78, 0xC25B0001, - 0xC78, 0xC15C0001, - 0xC78, 0xC05D0001, - 0xC78, 0xA35E0001, - 0xC78, 0xA25F0001, - 0xC78, 0xA1600001, - 0xC78, 0x88610001, - 0xC78, 0x87620001, - 0xC78, 0x86630001, - 0xC78, 0x85640001, - 0xC78, 0x84650001, - 0xC78, 0x83660001, - 0xC78, 0x82670001, - 0xC78, 0x66680001, - 0xC78, 0x65690001, - 0xC78, 0x646A0001, - 0xC78, 0x636B0001, - 0xC78, 0x626C0001, - 0xC78, 0x616D0001, - 0xC78, 0x486E0001, - 0xC78, 0x476F0001, - 0xC78, 0x46700001, - 0xC78, 0x45710001, - 0xC78, 0x44720001, - 0xC78, 0x43730001, - 0xC78, 0x42740001, - 0xC78, 0x41750001, - 0xC78, 0x40760001, - 0xC78, 0x40770001, - 0xC78, 0x40780001, - 0xC78, 0x40790001, - 0xC78, 0x407A0001, - 0xC78, 0x407B0001, - 0xC78, 0x407C0001, + 0xC78, 0xFB400001, + 0xC78, 0xFA410001, + 0xC78, 0xF9420001, + 0xC78, 0xF8430001, + 0xC78, 0xF7440001, + 0xC78, 0xF6450001, + 0xC78, 0xF5460001, + 0xC78, 0xF4470001, + 0xC78, 0xF3480001, + 0xC78, 0xF2490001, + 0xC78, 0xF14A0001, + 0xC78, 0xF04B0001, + 0xC78, 0xEF4C0001, + 0xC78, 0xEE4D0001, + 0xC78, 0xED4E0001, + 0xC78, 0xEC4F0001, + 0xC78, 0xEB500001, + 0xC78, 0xEA510001, + 0xC78, 0xE9520001, + 0xC78, 0xE8530001, + 0xC78, 0xE7540001, + 0xC78, 0xE6550001, + 0xC78, 0xE5560001, + 0xC78, 0xC6570001, + 0xC78, 0xC5580001, + 0xC78, 0xC4590001, + 0xC78, 0xC35A0001, + 0xC78, 0xC25B0001, + 0xC78, 0xC15C0001, + 0xC78, 0xC05D0001, + 0xC78, 0xA35E0001, + 0xC78, 0xA25F0001, + 0xC78, 0xA1600001, + 0xC78, 0x88610001, + 0xC78, 0x87620001, + 0xC78, 0x86630001, + 0xC78, 0x85640001, + 0xC78, 0x84650001, + 0xC78, 0x83660001, + 0xC78, 0x82670001, + 0xC78, 0x66680001, + 0xC78, 0x65690001, + 0xC78, 0x646A0001, + 0xC78, 0x636B0001, + 0xC78, 0x626C0001, + 0xC78, 0x616D0001, + 0xC78, 0x486E0001, + 0xC78, 0x476F0001, + 0xC78, 0x46700001, + 0xC78, 0x45710001, + 0xC78, 0x44720001, + 0xC78, 0x43730001, + 0xC78, 0x42740001, + 0xC78, 0x41750001, + 0xC78, 0x40760001, + 0xC78, 0x40770001, + 0xC78, 0x40780001, + 0xC78, 0x40790001, + 0xC78, 0x407A0001, + 0xC78, 0x407B0001, + 0xC78, 0x407C0001, 0x90000001, 0x00000000, 0x40000000, 0x00000000, - 0xC78, 0xFB400001, - 0xC78, 0xFA410001, - 0xC78, 0xF9420001, - 0xC78, 0xF8430001, - 0xC78, 0xF7440001, - 0xC78, 0xF6450001, - 0xC78, 0xF5460001, - 0xC78, 0xF4470001, - 0xC78, 0xF3480001, - 0xC78, 0xF2490001, - 0xC78, 0xF14A0001, - 0xC78, 0xF04B0001, - 0xC78, 0xEF4C0001, - 0xC78, 0xEE4D0001, - 0xC78, 0xED4E0001, - 0xC78, 0xEC4F0001, - 0xC78, 0xEB500001, - 0xC78, 0xEA510001, - 0xC78, 0xE9520001, - 0xC78, 0xE8530001, - 0xC78, 0xE7540001, - 0xC78, 0xE6550001, - 0xC78, 0xE5560001, - 0xC78, 0xE4570001, - 0xC78, 0xE3580001, - 0xC78, 0xE2590001, - 0xC78, 0xC35A0001, - 0xC78, 0xC25B0001, - 0xC78, 0xC15C0001, - 0xC78, 0x8B5D0001, - 0xC78, 0x8A5E0001, - 0xC78, 0x895F0001, - 0xC78, 0x88600001, - 0xC78, 0x87610001, - 0xC78, 0x86620001, - 0xC78, 0x85630001, - 0xC78, 0x84640001, - 0xC78, 0x67650001, - 0xC78, 0x66660001, - 0xC78, 0x65670001, - 0xC78, 0x64680001, - 0xC78, 0x63690001, - 0xC78, 0x626A0001, - 0xC78, 0x616B0001, - 0xC78, 0x606C0001, - 0xC78, 0x466D0001, - 0xC78, 0x456E0001, - 0xC78, 0x446F0001, - 0xC78, 0x43700001, - 0xC78, 0x42710001, - 0xC78, 0x41720001, - 0xC78, 0x40730001, - 0xC78, 0x40740001, - 0xC78, 0x40750001, - 0xC78, 0x40760001, - 0xC78, 0x40770001, - 0xC78, 0x40780001, - 0xC78, 0x40790001, - 0xC78, 0x407A0001, - 0xC78, 0x407B0001, - 0xC78, 0x407C0001, + 0xC78, 0xFB400001, + 0xC78, 0xFA410001, + 0xC78, 0xF9420001, + 0xC78, 0xF8430001, + 0xC78, 0xF7440001, + 0xC78, 0xF6450001, + 0xC78, 0xF5460001, + 0xC78, 0xF4470001, + 0xC78, 0xF3480001, + 0xC78, 0xF2490001, + 0xC78, 0xF14A0001, + 0xC78, 0xF04B0001, + 0xC78, 0xEF4C0001, + 0xC78, 0xEE4D0001, + 0xC78, 0xED4E0001, + 0xC78, 0xEC4F0001, + 0xC78, 0xEB500001, + 0xC78, 0xEA510001, + 0xC78, 0xE9520001, + 0xC78, 0xE8530001, + 0xC78, 0xE7540001, + 0xC78, 0xE6550001, + 0xC78, 0xE5560001, + 0xC78, 0xE4570001, + 0xC78, 0xE3580001, + 0xC78, 0xE2590001, + 0xC78, 0xC35A0001, + 0xC78, 0xC25B0001, + 0xC78, 0xC15C0001, + 0xC78, 0x8B5D0001, + 0xC78, 0x8A5E0001, + 0xC78, 0x895F0001, + 0xC78, 0x88600001, + 0xC78, 0x87610001, + 0xC78, 0x86620001, + 0xC78, 0x85630001, + 0xC78, 0x84640001, + 0xC78, 0x67650001, + 0xC78, 0x66660001, + 0xC78, 0x65670001, + 0xC78, 0x64680001, + 0xC78, 0x63690001, + 0xC78, 0x626A0001, + 0xC78, 0x616B0001, + 0xC78, 0x606C0001, + 0xC78, 0x466D0001, + 0xC78, 0x456E0001, + 0xC78, 0x446F0001, + 0xC78, 0x43700001, + 0xC78, 0x42710001, + 0xC78, 0x41720001, + 0xC78, 0x40730001, + 0xC78, 0x40740001, + 0xC78, 0x40750001, + 0xC78, 0x40760001, + 0xC78, 0x40770001, + 0xC78, 0x40780001, + 0xC78, 0x40790001, + 0xC78, 0x407A0001, + 0xC78, 0x407B0001, + 0xC78, 0x407C0001, 0x90000001, 0x00000001, 0x40000000, 0x00000000, - 0xC78, 0xFB400001, - 0xC78, 0xFB410001, - 0xC78, 0xFB420001, - 0xC78, 0xFB430001, - 0xC78, 0xFB440001, - 0xC78, 0xFB450001, - 0xC78, 0xFA460001, - 0xC78, 0xF9470001, - 0xC78, 0xF8480001, - 0xC78, 0xF7490001, - 0xC78, 0xF64A0001, - 0xC78, 0xF54B0001, - 0xC78, 0xF44C0001, - 0xC78, 0xF34D0001, - 0xC78, 0xF24E0001, - 0xC78, 0xF14F0001, - 0xC78, 0xF0500001, - 0xC78, 0xEF510001, - 0xC78, 0xEE520001, - 0xC78, 0xED530001, - 0xC78, 0xEC540001, - 0xC78, 0xEB550001, - 0xC78, 0xEA560001, - 0xC78, 0xE9570001, - 0xC78, 0xE8580001, - 0xC78, 0xE7590001, - 0xC78, 0xE65A0001, - 0xC78, 0xE55B0001, - 0xC78, 0xC65C0001, - 0xC78, 0xC55D0001, - 0xC78, 0xC45E0001, - 0xC78, 0xC35F0001, - 0xC78, 0xC2600001, - 0xC78, 0xC1610001, - 0xC78, 0xC0620001, - 0xC78, 0xA3630001, - 0xC78, 0xA2640001, - 0xC78, 0xA1650001, - 0xC78, 0x88660001, - 0xC78, 0x87670001, - 0xC78, 0x86680001, - 0xC78, 0x85690001, - 0xC78, 0x846A0001, - 0xC78, 0x836B0001, - 0xC78, 0x826C0001, - 0xC78, 0x666D0001, - 0xC78, 0x656E0001, - 0xC78, 0x646F0001, - 0xC78, 0x63700001, - 0xC78, 0x62710001, - 0xC78, 0x61720001, - 0xC78, 0x48730001, - 0xC78, 0x47740001, - 0xC78, 0x46750001, - 0xC78, 0x45760001, - 0xC78, 0x44770001, - 0xC78, 0x43780001, - 0xC78, 0x42790001, - 0xC78, 0x417A0001, - 0xC78, 0x407B0001, - 0xC78, 0x407C0001, + 0xC78, 0xFB400001, + 0xC78, 0xFB410001, + 0xC78, 0xFB420001, + 0xC78, 0xFB430001, + 0xC78, 0xFB440001, + 0xC78, 0xFB450001, + 0xC78, 0xFA460001, + 0xC78, 0xF9470001, + 0xC78, 0xF8480001, + 0xC78, 0xF7490001, + 0xC78, 0xF64A0001, + 0xC78, 0xF54B0001, + 0xC78, 0xF44C0001, + 0xC78, 0xF34D0001, + 0xC78, 0xF24E0001, + 0xC78, 0xF14F0001, + 0xC78, 0xF0500001, + 0xC78, 0xEF510001, + 0xC78, 0xEE520001, + 0xC78, 0xED530001, + 0xC78, 0xEC540001, + 0xC78, 0xEB550001, + 0xC78, 0xEA560001, + 0xC78, 0xE9570001, + 0xC78, 0xE8580001, + 0xC78, 0xE7590001, + 0xC78, 0xE65A0001, + 0xC78, 0xE55B0001, + 0xC78, 0xC65C0001, + 0xC78, 0xC55D0001, + 0xC78, 0xC45E0001, + 0xC78, 0xC35F0001, + 0xC78, 0xC2600001, + 0xC78, 0xC1610001, + 0xC78, 0xC0620001, + 0xC78, 0xA3630001, + 0xC78, 0xA2640001, + 0xC78, 0xA1650001, + 0xC78, 0x88660001, + 0xC78, 0x87670001, + 0xC78, 0x86680001, + 0xC78, 0x85690001, + 0xC78, 0x846A0001, + 0xC78, 0x836B0001, + 0xC78, 0x826C0001, + 0xC78, 0x666D0001, + 0xC78, 0x656E0001, + 0xC78, 0x646F0001, + 0xC78, 0x63700001, + 0xC78, 0x62710001, + 0xC78, 0x61720001, + 0xC78, 0x48730001, + 0xC78, 0x47740001, + 0xC78, 0x46750001, + 0xC78, 0x45760001, + 0xC78, 0x44770001, + 0xC78, 0x43780001, + 0xC78, 0x42790001, + 0xC78, 0x417A0001, + 0xC78, 0x407B0001, + 0xC78, 0x407C0001, 0x98000001, 0x00000002, 0x40000000, 0x00000000, - 0xC78, 0xFB400001, - 0xC78, 0xFB410001, - 0xC78, 0xFB420001, - 0xC78, 0xFB430001, - 0xC78, 0xFB440001, - 0xC78, 0xFB450001, - 0xC78, 0xFB460001, - 0xC78, 0xFB470001, - 0xC78, 0xFB480001, - 0xC78, 0xFA490001, - 0xC78, 0xF94A0001, - 0xC78, 0xF84B0001, - 0xC78, 0xF74C0001, - 0xC78, 0xF64D0001, - 0xC78, 0xF54E0001, - 0xC78, 0xF44F0001, - 0xC78, 0xF3500001, - 0xC78, 0xF2510001, - 0xC78, 0xF1520001, - 0xC78, 0xF0530001, - 0xC78, 0xEF540001, - 0xC78, 0xEE550001, - 0xC78, 0xED560001, - 0xC78, 0xEC570001, - 0xC78, 0xEB580001, - 0xC78, 0xEA590001, - 0xC78, 0xE95A0001, - 0xC78, 0xE85B0001, - 0xC78, 0xE75C0001, - 0xC78, 0xE65D0001, - 0xC78, 0xE55E0001, - 0xC78, 0xE45F0001, - 0xC78, 0xE3600001, - 0xC78, 0xE2610001, - 0xC78, 0xC3620001, - 0xC78, 0xC2630001, - 0xC78, 0xC1640001, - 0xC78, 0x8B650001, - 0xC78, 0x8A660001, - 0xC78, 0x89670001, - 0xC78, 0x88680001, - 0xC78, 0x87690001, - 0xC78, 0x866A0001, - 0xC78, 0x856B0001, - 0xC78, 0x846C0001, - 0xC78, 0x676D0001, - 0xC78, 0x666E0001, - 0xC78, 0x656F0001, - 0xC78, 0x64700001, - 0xC78, 0x63710001, - 0xC78, 0x62720001, - 0xC78, 0x61730001, - 0xC78, 0x60740001, - 0xC78, 0x46750001, - 0xC78, 0x45760001, - 0xC78, 0x44770001, - 0xC78, 0x43780001, - 0xC78, 0x42790001, - 0xC78, 0x417A0001, - 0xC78, 0x407B0001, - 0xC78, 0x407C0001, + 0xC78, 0xFB400001, + 0xC78, 0xFB410001, + 0xC78, 0xFB420001, + 0xC78, 0xFB430001, + 0xC78, 0xFB440001, + 0xC78, 0xFB450001, + 0xC78, 0xFB460001, + 0xC78, 0xFB470001, + 0xC78, 0xFB480001, + 0xC78, 0xFA490001, + 0xC78, 0xF94A0001, + 0xC78, 0xF84B0001, + 0xC78, 0xF74C0001, + 0xC78, 0xF64D0001, + 0xC78, 0xF54E0001, + 0xC78, 0xF44F0001, + 0xC78, 0xF3500001, + 0xC78, 0xF2510001, + 0xC78, 0xF1520001, + 0xC78, 0xF0530001, + 0xC78, 0xEF540001, + 0xC78, 0xEE550001, + 0xC78, 0xED560001, + 0xC78, 0xEC570001, + 0xC78, 0xEB580001, + 0xC78, 0xEA590001, + 0xC78, 0xE95A0001, + 0xC78, 0xE85B0001, + 0xC78, 0xE75C0001, + 0xC78, 0xE65D0001, + 0xC78, 0xE55E0001, + 0xC78, 0xE45F0001, + 0xC78, 0xE3600001, + 0xC78, 0xE2610001, + 0xC78, 0xC3620001, + 0xC78, 0xC2630001, + 0xC78, 0xC1640001, + 0xC78, 0x8B650001, + 0xC78, 0x8A660001, + 0xC78, 0x89670001, + 0xC78, 0x88680001, + 0xC78, 0x87690001, + 0xC78, 0x866A0001, + 0xC78, 0x856B0001, + 0xC78, 0x846C0001, + 0xC78, 0x676D0001, + 0xC78, 0x666E0001, + 0xC78, 0x656F0001, + 0xC78, 0x64700001, + 0xC78, 0x63710001, + 0xC78, 0x62720001, + 0xC78, 0x61730001, + 0xC78, 0x60740001, + 0xC78, 0x46750001, + 0xC78, 0x45760001, + 0xC78, 0x44770001, + 0xC78, 0x43780001, + 0xC78, 0x42790001, + 0xC78, 0x417A0001, + 0xC78, 0x407B0001, + 0xC78, 0x407C0001, 0x90000001, 0x00000002, 0x40000000, 0x00000000, - 0xC78, 0xFB400001, - 0xC78, 0xFB410001, - 0xC78, 0xFB420001, - 0xC78, 0xFB430001, - 0xC78, 0xFB440001, - 0xC78, 0xFB450001, - 0xC78, 0xFB460001, - 0xC78, 0xFB470001, - 0xC78, 0xFB480001, - 0xC78, 0xFA490001, - 0xC78, 0xF94A0001, - 0xC78, 0xF84B0001, - 0xC78, 0xF74C0001, - 0xC78, 0xF64D0001, - 0xC78, 0xF54E0001, - 0xC78, 0xF44F0001, - 0xC78, 0xF3500001, - 0xC78, 0xF2510001, - 0xC78, 0xF1520001, - 0xC78, 0xF0530001, - 0xC78, 0xEF540001, - 0xC78, 0xEE550001, - 0xC78, 0xED560001, - 0xC78, 0xEC570001, - 0xC78, 0xEB580001, - 0xC78, 0xEA590001, - 0xC78, 0xE95A0001, - 0xC78, 0xE85B0001, - 0xC78, 0xE75C0001, - 0xC78, 0xE65D0001, - 0xC78, 0xE55E0001, - 0xC78, 0xE45F0001, - 0xC78, 0xE3600001, - 0xC78, 0xE2610001, - 0xC78, 0xC3620001, - 0xC78, 0xC2630001, - 0xC78, 0xC1640001, - 0xC78, 0x8B650001, - 0xC78, 0x8A660001, - 0xC78, 0x89670001, - 0xC78, 0x88680001, - 0xC78, 0x87690001, - 0xC78, 0x866A0001, - 0xC78, 0x856B0001, - 0xC78, 0x846C0001, - 0xC78, 0x676D0001, - 0xC78, 0x666E0001, - 0xC78, 0x656F0001, - 0xC78, 0x64700001, - 0xC78, 0x63710001, - 0xC78, 0x62720001, - 0xC78, 0x61730001, - 0xC78, 0x60740001, - 0xC78, 0x46750001, - 0xC78, 0x45760001, - 0xC78, 0x44770001, - 0xC78, 0x43780001, - 0xC78, 0x42790001, - 0xC78, 0x417A0001, - 0xC78, 0x407B0001, - 0xC78, 0x407C0001, + 0xC78, 0xFB400001, + 0xC78, 0xFB410001, + 0xC78, 0xFB420001, + 0xC78, 0xFB430001, + 0xC78, 0xFB440001, + 0xC78, 0xFB450001, + 0xC78, 0xFB460001, + 0xC78, 0xFB470001, + 0xC78, 0xFB480001, + 0xC78, 0xFA490001, + 0xC78, 0xF94A0001, + 0xC78, 0xF84B0001, + 0xC78, 0xF74C0001, + 0xC78, 0xF64D0001, + 0xC78, 0xF54E0001, + 0xC78, 0xF44F0001, + 0xC78, 0xF3500001, + 0xC78, 0xF2510001, + 0xC78, 0xF1520001, + 0xC78, 0xF0530001, + 0xC78, 0xEF540001, + 0xC78, 0xEE550001, + 0xC78, 0xED560001, + 0xC78, 0xEC570001, + 0xC78, 0xEB580001, + 0xC78, 0xEA590001, + 0xC78, 0xE95A0001, + 0xC78, 0xE85B0001, + 0xC78, 0xE75C0001, + 0xC78, 0xE65D0001, + 0xC78, 0xE55E0001, + 0xC78, 0xE45F0001, + 0xC78, 0xE3600001, + 0xC78, 0xE2610001, + 0xC78, 0xC3620001, + 0xC78, 0xC2630001, + 0xC78, 0xC1640001, + 0xC78, 0x8B650001, + 0xC78, 0x8A660001, + 0xC78, 0x89670001, + 0xC78, 0x88680001, + 0xC78, 0x87690001, + 0xC78, 0x866A0001, + 0xC78, 0x856B0001, + 0xC78, 0x846C0001, + 0xC78, 0x676D0001, + 0xC78, 0x666E0001, + 0xC78, 0x656F0001, + 0xC78, 0x64700001, + 0xC78, 0x63710001, + 0xC78, 0x62720001, + 0xC78, 0x61730001, + 0xC78, 0x60740001, + 0xC78, 0x46750001, + 0xC78, 0x45760001, + 0xC78, 0x44770001, + 0xC78, 0x43780001, + 0xC78, 0x42790001, + 0xC78, 0x417A0001, + 0xC78, 0x407B0001, + 0xC78, 0x407C0001, 0x98000000, 0x00000000, 0x40000000, 0x00000000, - 0xC78, 0xFF400001, - 0xC78, 0xFF410001, - 0xC78, 0xFE420001, - 0xC78, 0xFD430001, - 0xC78, 0xFC440001, - 0xC78, 0xFB450001, - 0xC78, 0xFA460001, - 0xC78, 0xF9470001, - 0xC78, 0xF8480001, - 0xC78, 0xF7490001, - 0xC78, 0xF64A0001, - 0xC78, 0xF54B0001, - 0xC78, 0xF44C0001, - 0xC78, 0xF34D0001, - 0xC78, 0xF24E0001, - 0xC78, 0xF14F0001, - 0xC78, 0xF0500001, - 0xC78, 0xEF510001, - 0xC78, 0xEE520001, - 0xC78, 0xED530001, - 0xC78, 0xEC540001, - 0xC78, 0xEB550001, - 0xC78, 0xEA560001, - 0xC78, 0xE9570001, - 0xC78, 0xE8580001, - 0xC78, 0xE7590001, - 0xC78, 0xE65A0001, - 0xC78, 0xE55B0001, - 0xC78, 0xE45C0001, - 0xC78, 0xA85D0001, - 0xC78, 0xA75E0001, - 0xC78, 0xA65F0001, - 0xC78, 0xA5600001, - 0xC78, 0xA4610001, - 0xC78, 0xA3620001, - 0xC78, 0xA2630001, - 0xC78, 0xA1640001, - 0xC78, 0x28650001, - 0xC78, 0x27660001, - 0xC78, 0x26670001, - 0xC78, 0x07680001, - 0xC78, 0x06690001, - 0xC78, 0x056A0001, - 0xC78, 0x046B0001, - 0xC78, 0x036C0001, - 0xC78, 0x026D0001, - 0xC78, 0x016E0001, - 0xC78, 0x646F0001, - 0xC78, 0x63700001, - 0xC78, 0x62710001, - 0xC78, 0x61720001, - 0xC78, 0x47730001, - 0xC78, 0x46740001, - 0xC78, 0x45750001, - 0xC78, 0x44760001, - 0xC78, 0x43770001, - 0xC78, 0x42780001, - 0xC78, 0x41790001, - 0xC78, 0x407A0001, - 0xC78, 0x407B0001, - 0xC78, 0x407C0001, + 0xC78, 0xFF400001, + 0xC78, 0xFF410001, + 0xC78, 0xFE420001, + 0xC78, 0xFD430001, + 0xC78, 0xFC440001, + 0xC78, 0xFB450001, + 0xC78, 0xFA460001, + 0xC78, 0xF9470001, + 0xC78, 0xF8480001, + 0xC78, 0xF7490001, + 0xC78, 0xF64A0001, + 0xC78, 0xF54B0001, + 0xC78, 0xF44C0001, + 0xC78, 0xF34D0001, + 0xC78, 0xF24E0001, + 0xC78, 0xF14F0001, + 0xC78, 0xF0500001, + 0xC78, 0xEF510001, + 0xC78, 0xEE520001, + 0xC78, 0xED530001, + 0xC78, 0xEC540001, + 0xC78, 0xEB550001, + 0xC78, 0xEA560001, + 0xC78, 0xE9570001, + 0xC78, 0xE8580001, + 0xC78, 0xE7590001, + 0xC78, 0xE65A0001, + 0xC78, 0xE55B0001, + 0xC78, 0xE45C0001, + 0xC78, 0xA85D0001, + 0xC78, 0xA75E0001, + 0xC78, 0xA65F0001, + 0xC78, 0xA5600001, + 0xC78, 0xA4610001, + 0xC78, 0xA3620001, + 0xC78, 0xA2630001, + 0xC78, 0xA1640001, + 0xC78, 0x28650001, + 0xC78, 0x27660001, + 0xC78, 0x26670001, + 0xC78, 0x07680001, + 0xC78, 0x06690001, + 0xC78, 0x056A0001, + 0xC78, 0x046B0001, + 0xC78, 0x036C0001, + 0xC78, 0x026D0001, + 0xC78, 0x016E0001, + 0xC78, 0x646F0001, + 0xC78, 0x63700001, + 0xC78, 0x62710001, + 0xC78, 0x61720001, + 0xC78, 0x47730001, + 0xC78, 0x46740001, + 0xC78, 0x45750001, + 0xC78, 0x44760001, + 0xC78, 0x43770001, + 0xC78, 0x42780001, + 0xC78, 0x41790001, + 0xC78, 0x407A0001, + 0xC78, 0x407B0001, + 0xC78, 0x407C0001, 0xA0000000, 0x00000000, - 0xC78, 0xFB400001, - 0xC78, 0xFB410001, - 0xC78, 0xFB420001, - 0xC78, 0xFB430001, - 0xC78, 0xFB440001, - 0xC78, 0xFB450001, - 0xC78, 0xFB460001, - 0xC78, 0xFB470001, - 0xC78, 0xFB480001, - 0xC78, 0xFA490001, - 0xC78, 0xF94A0001, - 0xC78, 0xF84B0001, - 0xC78, 0xF74C0001, - 0xC78, 0xF64D0001, - 0xC78, 0xF54E0001, - 0xC78, 0xF44F0001, - 0xC78, 0xF3500001, - 0xC78, 0xF2510001, - 0xC78, 0xF1520001, - 0xC78, 0xF0530001, - 0xC78, 0xEF540001, - 0xC78, 0xEE550001, - 0xC78, 0xED560001, - 0xC78, 0xEC570001, - 0xC78, 0xEB580001, - 0xC78, 0xEA590001, - 0xC78, 0xE95A0001, - 0xC78, 0xE85B0001, - 0xC78, 0xE75C0001, - 0xC78, 0xE65D0001, - 0xC78, 0xE55E0001, - 0xC78, 0xE45F0001, - 0xC78, 0xE3600001, - 0xC78, 0xE2610001, - 0xC78, 0xC3620001, - 0xC78, 0xC2630001, - 0xC78, 0xC1640001, - 0xC78, 0x8B650001, - 0xC78, 0x8A660001, - 0xC78, 0x89670001, - 0xC78, 0x88680001, - 0xC78, 0x87690001, - 0xC78, 0x866A0001, - 0xC78, 0x856B0001, - 0xC78, 0x846C0001, - 0xC78, 0x676D0001, - 0xC78, 0x666E0001, - 0xC78, 0x656F0001, - 0xC78, 0x64700001, - 0xC78, 0x63710001, - 0xC78, 0x62720001, - 0xC78, 0x61730001, - 0xC78, 0x60740001, - 0xC78, 0x46750001, - 0xC78, 0x45760001, - 0xC78, 0x44770001, - 0xC78, 0x43780001, - 0xC78, 0x42790001, - 0xC78, 0x417A0001, - 0xC78, 0x407B0001, - 0xC78, 0x407C0001, + 0xC78, 0xFB400001, + 0xC78, 0xFB410001, + 0xC78, 0xFB420001, + 0xC78, 0xFB430001, + 0xC78, 0xFB440001, + 0xC78, 0xFB450001, + 0xC78, 0xFB460001, + 0xC78, 0xFB470001, + 0xC78, 0xFB480001, + 0xC78, 0xFA490001, + 0xC78, 0xF94A0001, + 0xC78, 0xF84B0001, + 0xC78, 0xF74C0001, + 0xC78, 0xF64D0001, + 0xC78, 0xF54E0001, + 0xC78, 0xF44F0001, + 0xC78, 0xF3500001, + 0xC78, 0xF2510001, + 0xC78, 0xF1520001, + 0xC78, 0xF0530001, + 0xC78, 0xEF540001, + 0xC78, 0xEE550001, + 0xC78, 0xED560001, + 0xC78, 0xEC570001, + 0xC78, 0xEB580001, + 0xC78, 0xEA590001, + 0xC78, 0xE95A0001, + 0xC78, 0xE85B0001, + 0xC78, 0xE75C0001, + 0xC78, 0xE65D0001, + 0xC78, 0xE55E0001, + 0xC78, 0xE45F0001, + 0xC78, 0xE3600001, + 0xC78, 0xE2610001, + 0xC78, 0xC3620001, + 0xC78, 0xC2630001, + 0xC78, 0xC1640001, + 0xC78, 0x8B650001, + 0xC78, 0x8A660001, + 0xC78, 0x89670001, + 0xC78, 0x88680001, + 0xC78, 0x87690001, + 0xC78, 0x866A0001, + 0xC78, 0x856B0001, + 0xC78, 0x846C0001, + 0xC78, 0x676D0001, + 0xC78, 0x666E0001, + 0xC78, 0x656F0001, + 0xC78, 0x64700001, + 0xC78, 0x63710001, + 0xC78, 0x62720001, + 0xC78, 0x61730001, + 0xC78, 0x60740001, + 0xC78, 0x46750001, + 0xC78, 0x45760001, + 0xC78, 0x44770001, + 0xC78, 0x43780001, + 0xC78, 0x42790001, + 0xC78, 0x417A0001, + 0xC78, 0x407B0001, + 0xC78, 0x407C0001, 0xB0000000, 0x00000000, 0x80000001, 0x00000001, 0x40000000, 0x00000000, - 0xC78, 0x407D0001, - 0xC78, 0x407E0001, - 0xC78, 0x407F0001, + 0xC78, 0x407D0001, + 0xC78, 0x407E0001, + 0xC78, 0x407F0001, 0x98000001, 0x00000002, 0x40000000, 0x00000000, - 0xC78, 0x407D0001, - 0xC78, 0x407E0001, - 0xC78, 0x407F0001, + 0xC78, 0x407D0001, + 0xC78, 0x407E0001, + 0xC78, 0x407F0001, 0x90000001, 0x00000002, 0x40000000, 0x00000000, - 0xC78, 0x407D0001, - 0xC78, 0x407E0001, - 0xC78, 0x407F0001, + 0xC78, 0x407D0001, + 0xC78, 0x407E0001, + 0xC78, 0x407F0001, 0xA0000000, 0x00000000, - 0xC78, 0x407D0001, - 0xC78, 0x407E0001, - 0xC78, 0x407F0001, + 0xC78, 0x407D0001, + 0xC78, 0x407E0001, + 0xC78, 0x407F0001, 0xB0000000, 0x00000000, - 0xC50, 0x69553422, - 0xC50, 0x69553420, + 0xC50, 0x69553422, + 0xC50, 0x69553420, }; void -odm_read_and_config_mp_8188e_agc_tab( - struct PHY_DM_STRUCT *p_dm_odm -) +odm_read_and_config_mp_8188e_agc_tab(struct dm_struct *dm) { - u32 i = 0; - u8 c_cond; - bool is_matched = true, is_skipped = false; - u32 array_len = sizeof(array_mp_8188e_agc_tab) / sizeof(u32); - u32 *array = array_mp_8188e_agc_tab; + u32 i = 0; + u8 c_cond; + boolean is_matched = true, is_skipped = false; + u32 array_len = sizeof(array_mp_8188e_agc_tab) / sizeof(u32); + u32 *array = array_mp_8188e_agc_tab; u32 v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> odm_read_and_config_mp_8188e_agc_tab\n")); + PHYDM_DBG(dm, ODM_COMP_INIT, "===> %s\n", __func__); while ((i + 1) < array_len) { v1 = array[i]; v2 = array[i + 1]; - if (v1 & (BIT(31) | BIT30)) {/*positive & negative condition*/ + 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; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ENDIF\n")); + PHYDM_DBG(dm, ODM_COMP_INIT, "ENDIF\n"); } else if (c_cond == COND_ELSE) { /*else*/ is_matched = is_skipped ? false : true; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ELSE\n")); + PHYDM_DBG(dm, ODM_COMP_INIT, "ELSE\n"); } else {/*if , else if*/ pre_v1 = v1; pre_v2 = v2; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("IF or ELSE IF\n")); + PHYDM_DBG(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_odm, pre_v1, pre_v2, v1, v2)) { + if (check_positive(dm, pre_v1, pre_v2, v1, v2)) { is_matched = true; is_skipped = true; } else { @@ -1101,7 +1096,7 @@ odm_read_and_config_mp_8188e_agc_tab( } } else { if (is_matched) - odm_config_bb_agc_8188e(p_dm_odm, v1, MASKDWORD, v2); + odm_config_bb_agc_8188e(dm, v1, MASKDWORD, v2); } i = i + 2; } @@ -1110,580 +1105,602 @@ odm_read_and_config_mp_8188e_agc_tab( u32 odm_get_version_mp_8188e_agc_tab(void) { - return 70; + return 71; } /****************************************************************************** -* PHY_REG.TXT +* phy_reg.TXT ******************************************************************************/ u32 array_mp_8188e_phy_reg[] = { - 0x800, 0x80040000, - 0x804, 0x00000003, - 0x808, 0x0000FC00, - 0x80C, 0x0000000A, - 0x810, 0x10001331, - 0x814, 0x020C3D10, - 0x818, 0x02200385, - 0x81C, 0x00000000, - 0x820, 0x01000100, + 0x800, 0x80040000, + 0x804, 0x00000003, + 0x808, 0x0000FC00, + 0x80C, 0x0000000A, + 0x810, 0x10001331, + 0x814, 0x020C3D10, + 0x818, 0x02200385, + 0x81C, 0x00000000, + 0x820, 0x01000100, 0x88000003, 0x00000000, 0x40000000, 0x00000000, - 0x824, 0x00390204, + 0x824, 0x00390204, 0x98000003, 0x00000001, 0x40000000, 0x00000000, - 0x824, 0x00390204, + 0x824, 0x00390204, 0x98000003, 0x00000002, 0x40000000, 0x00000000, - 0x824, 0x00390204, + 0x824, 0x00390204, 0x98000001, 0x00000000, 0x40000000, 0x00000000, - 0x824, 0x00390204, + 0x824, 0x00390204, 0x98000001, 0x00000001, 0x40000000, 0x00000000, - 0x824, 0x00390204, + 0x824, 0x00390204, 0x98000001, 0x00000002, 0x40000000, 0x00000000, - 0x824, 0x00390204, + 0x824, 0x00390204, 0x90000003, 0x00000002, 0x40000000, 0x00000000, - 0x824, 0x00390004, + 0x824, 0x00390004, + 0x98000002, 0x00000000, 0x40000000, 0x00000000, + 0x824, 0x00390204, 0x90000002, 0x00000000, 0x40000000, 0x00000000, - 0x824, 0x00390204, + 0x824, 0x00390204, 0x90000001, 0x00000000, 0x40000000, 0x00000000, - 0x824, 0x00390204, + 0x824, 0x00390204, 0x90000001, 0x00000001, 0x40000000, 0x00000000, - 0x824, 0x00390204, + 0x824, 0x00390204, 0x90000001, 0x00000002, 0x40000000, 0x00000000, - 0x824, 0x00390004, + 0x824, 0x00390004, 0x98000400, 0x00000000, 0x40000000, 0x00000000, - 0x824, 0x00390204, + 0x824, 0x00390204, 0x98000000, 0x00000000, 0x40000000, 0x00000000, - 0x824, 0x00390004, + 0x824, 0x00390004, 0xA0000000, 0x00000000, - 0x824, 0x00390204, + 0x824, 0x00390204, 0xB0000000, 0x00000000, - 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, 0x061F0649, - 0x868, 0x00000000, - 0x86C, 0x27272700, + 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, 0x061F0649, + 0x868, 0x00000000, + 0x86C, 0x27272700, 0x88000003, 0x00000000, 0x40000000, 0x00000000, - 0x870, 0x07000300, + 0x870, 0x07000300, 0x98000003, 0x00000001, 0x40000000, 0x00000000, - 0x870, 0x07000300, + 0x870, 0x07000300, 0x98000003, 0x00000002, 0x40000000, 0x00000000, - 0x870, 0x07000300, + 0x870, 0x07000300, 0x98000001, 0x00000000, 0x40000000, 0x00000000, - 0x870, 0x07000300, + 0x870, 0x07000300, 0x98000001, 0x00000001, 0x40000000, 0x00000000, - 0x870, 0x07000300, + 0x870, 0x07000300, 0x98000001, 0x00000002, 0x40000000, 0x00000000, - 0x870, 0x07000300, + 0x870, 0x07000300, 0x90000003, 0x00000002, 0x40000000, 0x00000000, - 0x870, 0x07000300, + 0x870, 0x07000300, + 0x98000002, 0x00000000, 0x40000000, 0x00000000, + 0x870, 0x07000300, 0x90000002, 0x00000000, 0x40000000, 0x00000000, - 0x870, 0x07000300, + 0x870, 0x07000300, 0x90000001, 0x00000000, 0x40000000, 0x00000000, - 0x870, 0x07000300, + 0x870, 0x07000300, 0x90000001, 0x00000001, 0x40000000, 0x00000000, - 0x870, 0x07000300, + 0x870, 0x07000300, 0x90000001, 0x00000002, 0x40000000, 0x00000000, - 0x870, 0x07000300, + 0x870, 0x07000300, 0x98000400, 0x00000000, 0x40000000, 0x00000000, - 0x870, 0x07000760, + 0x870, 0x07000760, 0x98000000, 0x00000000, 0x40000000, 0x00000000, - 0x870, 0x07000760, + 0x870, 0x07000760, 0xA0000000, 0x00000000, - 0x870, 0x07000760, + 0x870, 0x07000760, 0xB0000000, 0x00000000, - 0x874, 0x25004000, - 0x878, 0x00000808, - 0x87C, 0x00000000, - 0x880, 0xB0000C1C, - 0x884, 0x00000001, - 0x888, 0x00000000, - 0x88C, 0xCCC000C0, - 0x890, 0x00000800, - 0x894, 0xFFFFFFFE, - 0x898, 0x40302010, - 0x89C, 0x00706050, - 0x900, 0x00000000, - 0x904, 0x00000023, - 0x908, 0x00000000, - 0x90C, 0x81121111, - 0x910, 0x00000002, - 0x914, 0x00000201, - 0xA00, 0x00D047C8, - 0xA04, 0x80FF800C, - 0xA08, 0x8C838300, + 0x874, 0x25004000, + 0x878, 0x00000808, + 0x87C, 0x00000000, + 0x880, 0xB0000C1C, + 0x884, 0x00000001, + 0x888, 0x00000000, + 0x88C, 0xCCC000C0, + 0x890, 0x00000800, + 0x894, 0xFFFFFFFE, + 0x898, 0x40302010, + 0x89C, 0x00706050, + 0x900, 0x00000000, + 0x904, 0x00000023, + 0x908, 0x00000000, + 0x90C, 0x81121111, + 0x910, 0x00000002, + 0x914, 0x00000201, + 0xA00, 0x00D047C8, + 0xA04, 0x80FF800C, + 0xA08, 0x8C838300, 0x88000003, 0x00000000, 0x40000000, 0x00000000, - 0xA0C, 0x2E7F120F, + 0xA0C, 0x2E7F120F, 0x98000003, 0x00000001, 0x40000000, 0x00000000, - 0xA0C, 0x2E7F120F, + 0xA0C, 0x2E7F120F, 0x98000003, 0x00000002, 0x40000000, 0x00000000, - 0xA0C, 0x2E7F120F, + 0xA0C, 0x2E7F120F, 0x98000001, 0x00000000, 0x40000000, 0x00000000, - 0xA0C, 0x2E7F120F, + 0xA0C, 0x2E7F120F, 0x98000001, 0x00000001, 0x40000000, 0x00000000, - 0xA0C, 0x2E7F120F, + 0xA0C, 0x2E7F120F, 0x98000001, 0x00000002, 0x40000000, 0x00000000, - 0xA0C, 0x2E7F120F, + 0xA0C, 0x2E7F120F, 0x90000003, 0x00000002, 0x40000000, 0x00000000, - 0xA0C, 0x2D38120F, + 0xA0C, 0x2D38120F, + 0x98000002, 0x00000000, 0x40000000, 0x00000000, + 0xA0C, 0x2E7F120F, 0x90000002, 0x00000000, 0x40000000, 0x00000000, - 0xA0C, 0x2E7F120F, + 0xA0C, 0x2E7F120F, 0x90000001, 0x00000000, 0x40000000, 0x00000000, - 0xA0C, 0x2E7F120F, + 0xA0C, 0x2E7F120F, 0x90000001, 0x00000001, 0x40000000, 0x00000000, - 0xA0C, 0x2E7F120F, + 0xA0C, 0x2E7F120F, 0x90000001, 0x00000002, 0x40000000, 0x00000000, - 0xA0C, 0x2D38120F, + 0xA0C, 0x2D38120F, 0x98000400, 0x00000000, 0x40000000, 0x00000000, - 0xA0C, 0x2E7F120F, + 0xA0C, 0x2E7F120F, 0x98000000, 0x00000000, 0x40000000, 0x00000000, - 0xA0C, 0x2E34120F, + 0xA0C, 0x2E34120F, 0xA0000000, 0x00000000, - 0xA0C, 0x2E7F120F, + 0xA0C, 0x2E7F120F, 0xB0000000, 0x00000000, - 0xA10, 0x9500BB7E, - 0xA14, 0x1114D028, - 0xA18, 0x00881117, - 0xA1C, 0x89140F00, + 0xA10, 0x9500BB7E, + 0xA14, 0x1114D028, + 0xA18, 0x00881117, + 0xA1C, 0x89140F00, 0x88000003, 0x00000000, 0x40000000, 0x00000000, - 0xA20, 0x13130000, - 0xA24, 0x060A0D10, - 0xA28, 0x00000103, + 0xA20, 0x13130000, + 0xA24, 0x060A0D10, + 0xA28, 0x00000103, 0x98000003, 0x00000001, 0x40000000, 0x00000000, - 0xA20, 0x13130000, - 0xA24, 0x060A0D10, - 0xA28, 0x00000103, + 0xA20, 0x13130000, + 0xA24, 0x060A0D10, + 0xA28, 0x00000103, 0x98000003, 0x00000002, 0x40000000, 0x00000000, - 0xA20, 0x13130000, - 0xA24, 0x060A0D10, - 0xA28, 0x00000103, + 0xA20, 0x13130000, + 0xA24, 0x060A0D10, + 0xA28, 0x00000103, 0x98000001, 0x00000000, 0x40000000, 0x00000000, - 0xA20, 0x1A1B0000, - 0xA24, 0x090E1317, - 0xA28, 0x00000204, + 0xA20, 0x1A1B0000, + 0xA24, 0x090E1317, + 0xA28, 0x00000204, 0x98000001, 0x00000001, 0x40000000, 0x00000000, - 0xA20, 0x1A1B0000, - 0xA24, 0x090E1317, - 0xA28, 0x00000204, + 0xA20, 0x1A1B0000, + 0xA24, 0x090E1317, + 0xA28, 0x00000204, 0x98000001, 0x00000002, 0x40000000, 0x00000000, - 0xA20, 0x1A1B0000, - 0xA24, 0x090E1317, - 0xA28, 0x00000204, + 0xA20, 0x1A1B0000, + 0xA24, 0x090E1317, + 0xA28, 0x00000204, 0x90000003, 0x00000002, 0x40000000, 0x00000000, - 0xA20, 0x13130000, - 0xA24, 0x060A0D10, - 0xA28, 0x00000103, + 0xA20, 0x13130000, + 0xA24, 0x060A0D10, + 0xA28, 0x00000103, + 0x98000002, 0x00000000, 0x40000000, 0x00000000, + 0xA20, 0x13130000, + 0xA24, 0x060A0D10, + 0xA28, 0x00000103, 0x90000002, 0x00000000, 0x40000000, 0x00000000, - 0xA20, 0x13130000, - 0xA24, 0x060A0D10, - 0xA28, 0x00000103, + 0xA20, 0x13130000, + 0xA24, 0x060A0D10, + 0xA28, 0x00000103, 0x90000001, 0x00000000, 0x40000000, 0x00000000, - 0xA20, 0x1A1B0000, - 0xA24, 0x090E1317, - 0xA28, 0x00000204, + 0xA20, 0x1A1B0000, + 0xA24, 0x090E1317, + 0xA28, 0x00000204, 0x90000001, 0x00000001, 0x40000000, 0x00000000, - 0xA20, 0x1A1B0000, - 0xA24, 0x090E1317, - 0xA28, 0x00000204, + 0xA20, 0x1A1B0000, + 0xA24, 0x090E1317, + 0xA28, 0x00000204, 0x90000001, 0x00000002, 0x40000000, 0x00000000, - 0xA20, 0x1A1B0000, - 0xA24, 0x090E1317, - 0xA28, 0x00000204, + 0xA20, 0x1A1B0000, + 0xA24, 0x090E1317, + 0xA28, 0x00000204, 0x98000400, 0x00000000, 0x40000000, 0x00000000, - 0xA20, 0x1A1B0000, - 0xA24, 0x090E1317, - 0xA28, 0x00000204, + 0xA20, 0x1A1B0000, + 0xA24, 0x090E1317, + 0xA28, 0x00000204, 0x98000000, 0x00000000, 0x40000000, 0x00000000, - 0xA20, 0x1A1B0000, - 0xA24, 0x090E1317, - 0xA28, 0x00000204, + 0xA20, 0x1A1B0000, + 0xA24, 0x090E1317, + 0xA28, 0x00000204, 0xA0000000, 0x00000000, - 0xA20, 0x1A1B0000, - 0xA24, 0x090E1317, - 0xA28, 0x00000204, + 0xA20, 0x1A1B0000, + 0xA24, 0x090E1317, + 0xA28, 0x00000204, 0xB0000000, 0x00000000, - 0xA2C, 0x00D30000, - 0xA70, 0x101FBF00, - 0xA74, 0x00000007, - 0xA78, 0x00000900, - 0xA7C, 0x225B0606, + 0xA2C, 0x00D30000, + 0xA70, 0x101FBF00, + 0xA74, 0x00000007, + 0xA78, 0x00000900, + 0xA7C, 0x225B0606, 0x88000003, 0x00000000, 0x40000000, 0x00000000, - 0xA80, 0x218075B1, + 0xA80, 0x218075B1, 0x98000003, 0x00000001, 0x40000000, 0x00000000, - 0xA80, 0x218075B1, + 0xA80, 0x218075B1, 0x98000003, 0x00000002, 0x40000000, 0x00000000, - 0xA80, 0x218075B1, + 0xA80, 0x218075B1, 0x98000001, 0x00000000, 0x40000000, 0x00000000, - 0xA80, 0x218075B1, + 0xA80, 0x218075B1, 0x98000001, 0x00000001, 0x40000000, 0x00000000, - 0xA80, 0x218075B1, + 0xA80, 0x218075B1, 0x98000001, 0x00000002, 0x40000000, 0x00000000, - 0xA80, 0x218075B1, + 0xA80, 0x218075B1, 0x90000003, 0x00000002, 0x40000000, 0x00000000, - 0xA80, 0x21807530, + 0xA80, 0x21807530, + 0x98000002, 0x00000000, 0x40000000, 0x00000000, + 0xA80, 0x218075B1, 0x90000002, 0x00000000, 0x40000000, 0x00000000, - 0xA80, 0x218075B1, + 0xA80, 0x218075B1, 0x90000001, 0x00000000, 0x40000000, 0x00000000, - 0xA80, 0x218075B1, + 0xA80, 0x218075B1, 0x90000001, 0x00000001, 0x40000000, 0x00000000, - 0xA80, 0x218075B1, + 0xA80, 0x218075B1, 0x90000001, 0x00000002, 0x40000000, 0x00000000, - 0xA80, 0x21807530, + 0xA80, 0x21807530, 0x98000400, 0x00000000, 0x40000000, 0x00000000, - 0xA80, 0x218075B1, + 0xA80, 0x218075B1, 0x98000000, 0x00000000, 0x40000000, 0x00000000, - 0xA80, 0x21807531, + 0xA80, 0x21807531, 0xA0000000, 0x00000000, - 0xA80, 0x218075B1, + 0xA80, 0x218075B1, 0xB0000000, 0x00000000, 0x88000003, 0x00000000, 0x40000000, 0x00000000, - 0xB2C, 0x00000000, + 0xB2C, 0x00000000, 0x98000003, 0x00000001, 0x40000000, 0x00000000, - 0xB2C, 0x00000000, + 0xB2C, 0x00000000, 0x98000003, 0x00000002, 0x40000000, 0x00000000, - 0xB2C, 0x00000000, + 0xB2C, 0x00000000, 0x98000001, 0x00000000, 0x40000000, 0x00000000, - 0xB2C, 0x00000000, + 0xB2C, 0x00000000, 0x98000001, 0x00000001, 0x40000000, 0x00000000, - 0xB2C, 0x00000000, + 0xB2C, 0x00000000, 0x98000001, 0x00000002, 0x40000000, 0x00000000, - 0xB2C, 0x00000000, + 0xB2C, 0x00000000, 0x90000003, 0x00000002, 0x40000000, 0x00000000, - 0xB2C, 0x00000000, + 0xB2C, 0x00000000, + 0x98000002, 0x00000000, 0x40000000, 0x00000000, + 0xB2C, 0x00000000, 0x90000002, 0x00000000, 0x40000000, 0x00000000, - 0xB2C, 0x00000000, + 0xB2C, 0x00000000, 0x90000001, 0x00000000, 0x40000000, 0x00000000, - 0xB2C, 0x00000000, + 0xB2C, 0x00000000, 0x90000001, 0x00000001, 0x40000000, 0x00000000, - 0xB2C, 0x00000000, + 0xB2C, 0x00000000, 0x90000001, 0x00000002, 0x40000000, 0x00000000, - 0xB2C, 0x00000000, + 0xB2C, 0x00000000, 0x98000400, 0x00000000, 0x40000000, 0x00000000, - 0xB2C, 0x80000000, + 0xB2C, 0x80000000, 0x98000000, 0x00000000, 0x40000000, 0x00000000, - 0xB2C, 0x80000000, + 0xB2C, 0x80000000, 0xA0000000, 0x00000000, - 0xB2C, 0x80000000, + 0xB2C, 0x80000000, 0xB0000000, 0x00000000, - 0xC00, 0x48071D40, - 0xC04, 0x03A05611, - 0xC08, 0x000000E4, - 0xC0C, 0x6C6C6C6C, - 0xC10, 0x08800000, - 0xC14, 0x40000100, - 0xC18, 0x08800000, - 0xC1C, 0x40000100, - 0xC20, 0x00000000, - 0xC24, 0x00000000, - 0xC28, 0x00000000, - 0xC2C, 0x00000000, - 0xC30, 0x69E9AC47, - 0xC34, 0x469652AF, - 0xC38, 0x49795994, - 0xC3C, 0x0A97971C, - 0xC40, 0x1F7C403F, - 0xC44, 0x000100B7, - 0xC48, 0xEC020107, - 0xC4C, 0x007F037F, - 0xC50, 0x69553420, - 0xC54, 0x43BC0094, + 0xC00, 0x48071D40, + 0xC04, 0x03A05611, + 0xC08, 0x000000E4, + 0xC0C, 0x6C6C6C6C, + 0xC10, 0x08800000, + 0xC14, 0x40000100, + 0xC18, 0x08800000, + 0xC1C, 0x40000100, + 0xC20, 0x00000000, + 0xC24, 0x00000000, + 0xC28, 0x00000000, + 0xC2C, 0x00000000, + 0xC30, 0x69E9AC47, + 0xC34, 0x469652AF, + 0xC38, 0x49795994, + 0xC3C, 0x0A97971C, + 0xC40, 0x1F7C403F, + 0xC44, 0x000100B7, + 0xC48, 0xEC020107, + 0xC4C, 0x007F037F, + 0xC50, 0x69553420, + 0xC54, 0x43BC0094, 0x88000003, 0x00000000, 0x40000000, 0x00000000, - 0xC58, 0x00013159, + 0xC58, 0x00013159, 0x98000003, 0x00000001, 0x40000000, 0x00000000, - 0xC58, 0x00013159, + 0xC58, 0x00013159, 0x98000003, 0x00000002, 0x40000000, 0x00000000, - 0xC58, 0x00013959, + 0xC58, 0x00013959, 0x98000001, 0x00000000, 0x40000000, 0x00000000, - 0xC58, 0x00013159, + 0xC58, 0x00013159, 0x98000001, 0x00000001, 0x40000000, 0x00000000, - 0xC58, 0x00013159, + 0xC58, 0x00013159, 0x98000001, 0x00000002, 0x40000000, 0x00000000, - 0xC58, 0x00013959, + 0xC58, 0x00013959, 0x90000003, 0x00000002, 0x40000000, 0x00000000, - 0xC58, 0x00013169, + 0xC58, 0x00013169, + 0x98000002, 0x00000000, 0x40000000, 0x00000000, + 0xC58, 0x00013159, 0x90000002, 0x00000000, 0x40000000, 0x00000000, - 0xC58, 0x00013169, + 0xC58, 0x00013169, 0x90000001, 0x00000000, 0x40000000, 0x00000000, - 0xC58, 0x00013169, + 0xC58, 0x00013169, 0x90000001, 0x00000001, 0x40000000, 0x00000000, - 0xC58, 0x00013169, + 0xC58, 0x00013169, 0x90000001, 0x00000002, 0x40000000, 0x00000000, - 0xC58, 0x00013169, + 0xC58, 0x00013169, 0x98000400, 0x00000000, 0x40000000, 0x00000000, - 0xC58, 0x00013159, + 0xC58, 0x00013159, 0x98000000, 0x00000000, 0x40000000, 0x00000000, - 0xC58, 0x00013159, + 0xC58, 0x00013159, 0xA0000000, 0x00000000, - 0xC58, 0x00013169, + 0xC58, 0x00013169, 0xB0000000, 0x00000000, - 0xC5C, 0x00250492, - 0xC60, 0x00000000, - 0xC64, 0x7112848B, - 0xC68, 0x47C00BFF, - 0xC6C, 0x00000036, - 0xC70, 0x2C7F000D, + 0xC5C, 0x00250492, + 0xC60, 0x00000000, + 0xC64, 0x7112848B, + 0xC68, 0x47C00BFF, + 0xC6C, 0x00000036, + 0xC70, 0x2C7F000D, 0x88000003, 0x00000000, 0x40000000, 0x00000000, - 0xC74, 0x028610DB, + 0xC74, 0x028610DB, 0x98000003, 0x00000001, 0x40000000, 0x00000000, - 0xC74, 0x028610DB, + 0xC74, 0x028610DB, 0x98000003, 0x00000002, 0x40000000, 0x00000000, - 0xC74, 0x028610DB, + 0xC74, 0x028610DB, 0x98000001, 0x00000000, 0x40000000, 0x00000000, - 0xC74, 0x028610DB, + 0xC74, 0x028610DB, 0x98000001, 0x00000001, 0x40000000, 0x00000000, - 0xC74, 0x028610DB, + 0xC74, 0x028610DB, 0x98000001, 0x00000002, 0x40000000, 0x00000000, - 0xC74, 0x028610DB, + 0xC74, 0x028610DB, 0x90000003, 0x00000002, 0x40000000, 0x00000000, - 0xC74, 0x020610DB, + 0xC74, 0x020610DB, + 0x98000002, 0x00000000, 0x40000000, 0x00000000, + 0xC74, 0x028610DB, 0x90000002, 0x00000000, 0x40000000, 0x00000000, - 0xC74, 0x020610DB, + 0xC74, 0x020610DB, 0x90000001, 0x00000000, 0x40000000, 0x00000000, - 0xC74, 0x020610DB, + 0xC74, 0x020610DB, 0x90000001, 0x00000001, 0x40000000, 0x00000000, - 0xC74, 0x020610DB, + 0xC74, 0x020610DB, 0x90000001, 0x00000002, 0x40000000, 0x00000000, - 0xC74, 0x020610DB, + 0xC74, 0x020610DB, 0x98000400, 0x00000000, 0x40000000, 0x00000000, - 0xC74, 0x028610DB, + 0xC74, 0x028610DB, 0x98000000, 0x00000000, 0x40000000, 0x00000000, - 0xC74, 0x028610DB, + 0xC74, 0x028610DB, 0xA0000000, 0x00000000, - 0xC74, 0x020610DB, + 0xC74, 0x020610DB, 0xB0000000, 0x00000000, - 0xC78, 0x0000001F, - 0xC7C, 0x00B91612, + 0xC78, 0x0000001F, + 0xC7C, 0x00B91612, 0x88000003, 0x00000000, 0x40000000, 0x00000000, - 0xC80, 0x2D4000B5, + 0xC80, 0x2D4000B5, 0x98000003, 0x00000001, 0x40000000, 0x00000000, - 0xC80, 0x2D4000B5, + 0xC80, 0x2D4000B5, 0x98000003, 0x00000002, 0x40000000, 0x00000000, - 0xC80, 0x2D4000B5, + 0xC80, 0x2D4000B5, 0x98000001, 0x00000000, 0x40000000, 0x00000000, - 0xC80, 0x390000E4, + 0xC80, 0x390000E4, 0x98000001, 0x00000001, 0x40000000, 0x00000000, - 0xC80, 0x390000E4, + 0xC80, 0x390000E4, 0x98000001, 0x00000002, 0x40000000, 0x00000000, - 0xC80, 0x390000E4, + 0xC80, 0x390000E4, 0x90000003, 0x00000002, 0x40000000, 0x00000000, - 0xC80, 0x2D4000B5, + 0xC80, 0x2D4000B5, + 0x98000002, 0x00000000, 0x40000000, 0x00000000, + 0xC80, 0x2D4000B5, 0x90000002, 0x00000000, 0x40000000, 0x00000000, - 0xC80, 0x2D4000B5, + 0xC80, 0x2D4000B5, 0x90000001, 0x00000000, 0x40000000, 0x00000000, - 0xC80, 0x390000E4, + 0xC80, 0x390000E4, 0x90000001, 0x00000001, 0x40000000, 0x00000000, - 0xC80, 0x390000E4, + 0xC80, 0x390000E4, 0x90000001, 0x00000002, 0x40000000, 0x00000000, - 0xC80, 0x390000E4, + 0xC80, 0x390000E4, 0x98000400, 0x00000000, 0x40000000, 0x00000000, - 0xC80, 0x390000E4, + 0xC80, 0x390000E4, 0x98000000, 0x00000000, 0x40000000, 0x00000000, - 0xC80, 0x390000E4, + 0xC80, 0x390000E4, 0xA0000000, 0x00000000, - 0xC80, 0x390000E4, + 0xC80, 0x390000E4, 0xB0000000, 0x00000000, - 0xC84, 0x21F60000, - 0xC88, 0x40000100, - 0xC8C, 0x20200000, - 0xC90, 0x00091521, - 0xC94, 0x00000000, - 0xC98, 0x00121820, - 0xC9C, 0x00007F7F, - 0xCA0, 0x00000000, - 0xCA4, 0x000300A0, + 0xC84, 0x21F60000, + 0xC88, 0x40000100, + 0xC8C, 0x20200000, + 0xC90, 0x00091521, + 0xC94, 0x00000000, + 0xC98, 0x00121820, + 0xC9C, 0x00007F7F, + 0xCA0, 0x00000000, + 0xCA4, 0x000300A0, 0x88000003, 0x00000000, 0x40000000, 0x00000000, - 0xCA8, 0xFFFF0000, + 0xCA8, 0xFFFF0000, 0x98000003, 0x00000001, 0x40000000, 0x00000000, - 0xCA8, 0xFFFF0000, + 0xCA8, 0xFFFF0000, 0x98000003, 0x00000002, 0x40000000, 0x00000000, - 0xCA8, 0xFFFF0000, + 0xCA8, 0xFFFF0000, 0x98000001, 0x00000000, 0x40000000, 0x00000000, - 0xCA8, 0xFFFF0000, + 0xCA8, 0xFFFF0000, 0x98000001, 0x00000001, 0x40000000, 0x00000000, - 0xCA8, 0xFFFF0000, + 0xCA8, 0xFFFF0000, 0x98000001, 0x00000002, 0x40000000, 0x00000000, - 0xCA8, 0xFFFF0000, + 0xCA8, 0xFFFF0000, 0x90000003, 0x00000002, 0x40000000, 0x00000000, - 0xCA8, 0x00000000, + 0xCA8, 0x00000000, + 0x98000002, 0x00000000, 0x40000000, 0x00000000, + 0xCA8, 0xFFFF0000, 0x90000002, 0x00000000, 0x40000000, 0x00000000, - 0xCA8, 0x00000000, + 0xCA8, 0x00000000, 0x90000001, 0x00000000, 0x40000000, 0x00000000, - 0xCA8, 0x00000000, + 0xCA8, 0x00000000, 0x90000001, 0x00000001, 0x40000000, 0x00000000, - 0xCA8, 0x00000000, + 0xCA8, 0x00000000, 0x90000001, 0x00000002, 0x40000000, 0x00000000, - 0xCA8, 0x00000000, + 0xCA8, 0x00000000, 0x98000400, 0x00000000, 0x40000000, 0x00000000, - 0xCA8, 0xFFFF0000, + 0xCA8, 0xFFFF0000, 0x98000000, 0x00000000, 0x40000000, 0x00000000, - 0xCA8, 0xFFFF0000, + 0xCA8, 0xFFFF0000, 0xA0000000, 0x00000000, - 0xCA8, 0x00000000, + 0xCA8, 0x00000000, 0xB0000000, 0x00000000, - 0xCAC, 0x00000000, - 0xCB0, 0x00000000, - 0xCB4, 0x00000000, - 0xCB8, 0x00000000, - 0xCBC, 0x28000000, - 0xCC0, 0x00000000, - 0xCC4, 0x00000000, - 0xCC8, 0x00000000, - 0xCCC, 0x00000000, - 0xCD0, 0x00000000, - 0xCD4, 0x00000000, - 0xCD8, 0x64B22427, - 0xCDC, 0x00766932, - 0xCE0, 0x00222222, - 0xCE4, 0x00000000, - 0xCE8, 0x37644302, - 0xCEC, 0x2F97D40C, - 0xD00, 0x00000740, - 0xD04, 0x00020401, - 0xD08, 0x0000907F, - 0xD0C, 0x20010201, - 0xD10, 0xA0633333, - 0xD14, 0x3333BC43, - 0xD18, 0x7A8F5B6F, - 0xD2C, 0xCC979975, - 0xD30, 0x00000000, - 0xD34, 0x80608000, - 0xD38, 0x00000000, - 0xD3C, 0x00127353, - 0xD40, 0x00000000, - 0xD44, 0x00000000, - 0xD48, 0x00000000, - 0xD4C, 0x00000000, - 0xD50, 0x6437140A, - 0xD54, 0x00000000, - 0xD58, 0x00000282, - 0xD5C, 0x30032064, - 0xD60, 0x4653DE68, - 0xD64, 0x04518A3C, - 0xD68, 0x00002101, - 0xD6C, 0x2A201C16, - 0xD70, 0x1812362E, - 0xD74, 0x322C2220, - 0xD78, 0x000E3C24, - 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, 0x00000048, - 0xE68, 0x001B25A4, - 0xE6C, 0x00C00014, - 0xE70, 0x00C00014, - 0xE74, 0x01000014, - 0xE78, 0x01000014, - 0xE7C, 0x01000014, - 0xE80, 0x01000014, - 0xE84, 0x00C00014, - 0xE88, 0x01000014, - 0xE8C, 0x00C00014, - 0xED0, 0x00C00014, - 0xED4, 0x00C00014, - 0xED8, 0x00C00014, - 0xEDC, 0x00000014, - 0xEE0, 0x00000014, + 0xCAC, 0x00000000, + 0xCB0, 0x00000000, + 0xCB4, 0x00000000, + 0xCB8, 0x00000000, + 0xCBC, 0x28000000, + 0xCC0, 0x00000000, + 0xCC4, 0x00000000, + 0xCC8, 0x00000000, + 0xCCC, 0x00000000, + 0xCD0, 0x00000000, + 0xCD4, 0x00000000, + 0xCD8, 0x64B22427, + 0xCDC, 0x00766932, + 0xCE0, 0x00222222, + 0xCE4, 0x00000000, + 0xCE8, 0x37644302, + 0xCEC, 0x2F97D40C, + 0xD00, 0x00000740, + 0xD04, 0x00020401, + 0xD08, 0x0000907F, + 0xD0C, 0x20010201, + 0xD10, 0xA0633333, + 0xD14, 0x3333BC43, + 0xD18, 0x7A8F5B6F, + 0xD2C, 0xCC979975, + 0xD30, 0x00000000, + 0xD34, 0x80608000, + 0xD38, 0x00000000, + 0xD3C, 0x00127353, + 0xD40, 0x00000000, + 0xD44, 0x00000000, + 0xD48, 0x00000000, + 0xD4C, 0x00000000, + 0xD50, 0x6437140A, + 0xD54, 0x00000000, + 0xD58, 0x00000282, + 0xD5C, 0x30032064, + 0xD60, 0x4653DE68, + 0xD64, 0x04518A3C, + 0xD68, 0x00002101, + 0xD6C, 0x2A201C16, + 0xD70, 0x1812362E, + 0xD74, 0x322C2220, + 0xD78, 0x000E3C24, + 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, 0x00000048, + 0xE68, 0x001B25A4, + 0xE6C, 0x00C00014, + 0xE70, 0x00C00014, + 0xE74, 0x01000014, + 0xE78, 0x01000014, + 0xE7C, 0x01000014, + 0xE80, 0x01000014, + 0xE84, 0x00C00014, + 0xE88, 0x01000014, + 0xE8C, 0x00C00014, + 0xED0, 0x00C00014, + 0xED4, 0x00C00014, + 0xED8, 0x00C00014, + 0xEDC, 0x00000014, + 0xEE0, 0x00000014, 0x88000003, 0x00000000, 0x40000000, 0x00000000, - 0xEE8, 0x32555448, + 0xEE8, 0x32555448, 0x98000003, 0x00000001, 0x40000000, 0x00000000, - 0xEE8, 0x32555448, + 0xEE8, 0x32555448, 0x98000003, 0x00000002, 0x40000000, 0x00000000, - 0xEE8, 0x32555448, + 0xEE8, 0x32555448, 0x98000001, 0x00000000, 0x40000000, 0x00000000, - 0xEE8, 0x32555448, + 0xEE8, 0x32555448, 0x98000001, 0x00000001, 0x40000000, 0x00000000, - 0xEE8, 0x32555448, + 0xEE8, 0x32555448, 0x98000001, 0x00000002, 0x40000000, 0x00000000, - 0xEE8, 0x32555448, + 0xEE8, 0x32555448, 0x90000003, 0x00000002, 0x40000000, 0x00000000, - 0xEE8, 0x32555448, + 0xEE8, 0x32555448, + 0x98000002, 0x00000000, 0x40000000, 0x00000000, + 0xEE8, 0x32555448, 0x90000002, 0x00000000, 0x40000000, 0x00000000, - 0xEE8, 0x32555448, + 0xEE8, 0x32555448, 0x90000001, 0x00000000, 0x40000000, 0x00000000, - 0xEE8, 0x32555448, + 0xEE8, 0x32555448, 0x90000001, 0x00000001, 0x40000000, 0x00000000, - 0xEE8, 0x32555448, + 0xEE8, 0x32555448, 0x90000001, 0x00000002, 0x40000000, 0x00000000, - 0xEE8, 0x32555448, + 0xEE8, 0x32555448, 0x98000400, 0x00000000, 0x40000000, 0x00000000, - 0xEE8, 0x21555448, + 0xEE8, 0x21555448, 0x98000000, 0x00000000, 0x40000000, 0x00000000, - 0xEE8, 0x21555448, + 0xEE8, 0x21555448, 0xA0000000, 0x00000000, - 0xEE8, 0x21555448, + 0xEE8, 0x21555448, 0xB0000000, 0x00000000, - 0xEEC, 0x01C00014, - 0xF14, 0x00000003, - 0xF4C, 0x00000000, - 0xF00, 0x00000300, + 0xEEC, 0x01C00014, + 0xF14, 0x00000003, + 0xF4C, 0x00000000, + 0xF00, 0x00000300, }; void -odm_read_and_config_mp_8188e_phy_reg( - struct PHY_DM_STRUCT *p_dm_odm -) +odm_read_and_config_mp_8188e_phy_reg(struct dm_struct *dm) { - u32 i = 0; - u8 c_cond; - bool is_matched = true, is_skipped = false; - u32 array_len = sizeof(array_mp_8188e_phy_reg) / sizeof(u32); - u32 *array = array_mp_8188e_phy_reg; + u32 i = 0; + u8 c_cond; + boolean is_matched = true, is_skipped = false; + u32 array_len = sizeof(array_mp_8188e_phy_reg) / sizeof(u32); + u32 *array = array_mp_8188e_phy_reg; u32 v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> odm_read_and_config_mp_8188e_phy_reg\n")); + PHYDM_DBG(dm, ODM_COMP_INIT, "===> %s\n", __func__); while ((i + 1) < array_len) { v1 = array[i]; v2 = array[i + 1]; - if (v1 & (BIT(31) | BIT30)) {/*positive & negative condition*/ + 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; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ENDIF\n")); + PHYDM_DBG(dm, ODM_COMP_INIT, "ENDIF\n"); } else if (c_cond == COND_ELSE) { /*else*/ is_matched = is_skipped ? false : true; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ELSE\n")); + PHYDM_DBG(dm, ODM_COMP_INIT, "ELSE\n"); } else {/*if , else if*/ pre_v1 = v1; pre_v2 = v2; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("IF or ELSE IF\n")); + PHYDM_DBG(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_odm, pre_v1, pre_v2, v1, v2)) { + if (check_positive(dm, pre_v1, pre_v2, v1, v2)) { is_matched = true; is_skipped = true; } else { @@ -1695,7 +1712,7 @@ odm_read_and_config_mp_8188e_phy_reg( } } else { if (is_matched) - odm_config_bb_phy_8188e(p_dm_odm, v1, MASKDWORD, v2); + odm_config_bb_phy_8188e(dm, v1, MASKDWORD, v2); } i = i + 2; } @@ -1704,11 +1721,11 @@ odm_read_and_config_mp_8188e_phy_reg( u32 odm_get_version_mp_8188e_phy_reg(void) { - return 70; + return 71; } /****************************************************************************** -* PHY_REG_PG.TXT +* phy_reg_pg.TXT ******************************************************************************/ u32 array_mp_8188e_phy_reg_pg[] = { @@ -1721,40 +1738,38 @@ u32 array_mp_8188e_phy_reg_pg[] = { }; void -odm_read_and_config_mp_8188e_phy_reg_pg( - struct PHY_DM_STRUCT *p_dm_odm -) +odm_read_and_config_mp_8188e_phy_reg_pg(struct dm_struct *dm) { - u32 i = 0; - u32 array_len = sizeof(array_mp_8188e_phy_reg_pg) / sizeof(u32); - u32 *array = array_mp_8188e_phy_reg_pg; + u32 i = 0; + u32 array_len = sizeof(array_mp_8188e_phy_reg_pg) / sizeof(u32); + u32 *array = array_mp_8188e_phy_reg_pg; #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _ADAPTER *adapter = p_dm_odm->adapter; - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + void *adapter = dm->adapter; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); - PlatformZeroMemory(p_hal_data->BufOfLinesPwrByRate, MAX_LINES_HWCONFIG_TXT * MAX_BYTES_LINE_HWCONFIG_TXT); - p_hal_data->nLinesReadPwrByRate = array_len / 6; + PlatformZeroMemory(hal_data->BufOfLinesPwrByRate, MAX_LINES_HWCONFIG_TXT * MAX_BYTES_LINE_HWCONFIG_TXT); + hal_data->nLinesReadPwrByRate = array_len / 6; #endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> odm_read_and_config_mp_8188e_phy_reg_pg\n")); + PHYDM_DBG(dm, ODM_COMP_INIT, "===> %s\n", __func__); - p_dm_odm->phy_reg_pg_version = 1; - p_dm_odm->phy_reg_pg_value_type = PHY_REG_PG_EXACT_VALUE; + dm->phy_reg_pg_version = 1; + 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]; + 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_8188e(p_dm_odm, v1, v2, v3, v4, v5, v6); + odm_config_bb_phy_reg_pg_8188e(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); + rsprintf((char *)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 } } @@ -1762,3 +1777,4 @@ odm_read_and_config_mp_8188e_phy_reg_pg( #endif /* end of HWIMG_SUPPORT*/ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_bb.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_bb.h index 55b978592034..a2f19aa7d282 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_bb.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_bb.h @@ -1,58 +1,52 @@ +/* SPDX-License-Identifier: GPL-2.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 -* -* -******************************************************************************/ + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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: 2.18*/ +/*Image2HeaderVersion: 3.5.2*/ #if (RTL8188E_SUPPORT == 1) #ifndef __INC_MP_BB_HW_IMG_8188E_H #define __INC_MP_BB_HW_IMG_8188E_H /****************************************************************************** -* AGC_TAB.TXT +* agc_tab.TXT ******************************************************************************/ void -odm_read_and_config_mp_8188e_agc_tab(/* TC: Test Chip, MP: MP Chip*/ - struct PHY_DM_STRUCT *p_dm_odm -); +odm_read_and_config_mp_8188e_agc_tab( /* tc: Test Chip, mp: mp Chip*/ + struct dm_struct *dm); u32 odm_get_version_mp_8188e_agc_tab(void); /****************************************************************************** -* PHY_REG.TXT +* phy_reg.TXT ******************************************************************************/ void -odm_read_and_config_mp_8188e_phy_reg(/* TC: Test Chip, MP: MP Chip*/ - struct PHY_DM_STRUCT *p_dm_odm -); +odm_read_and_config_mp_8188e_phy_reg( /* tc: Test Chip, mp: mp Chip*/ + struct dm_struct *dm); u32 odm_get_version_mp_8188e_phy_reg(void); /****************************************************************************** -* PHY_REG_PG.TXT +* phy_reg_pg.TXT ******************************************************************************/ void -odm_read_and_config_mp_8188e_phy_reg_pg(/* TC: Test Chip, MP: MP Chip*/ - struct PHY_DM_STRUCT *p_dm_odm -); -u32 odm_get_version_mp_8188e_phy_reg_pg(void); +odm_read_and_config_mp_8188e_phy_reg_pg( /* tc: Test Chip, mp: mp Chip*/ + struct dm_struct *dm); +u32 odm_get_version_mp_8188e_phy_reg_pg(void); #endif #endif /* end of HWIMG_SUPPORT*/ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_mac.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_mac.c index 71cc9aea745a..ff87380e6f78 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_mac.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_mac.c @@ -1,72 +1,78 @@ +/* SPDX-License-Identifier: GPL-2.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 -* -* -******************************************************************************/ + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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: 2.18*/ +/*Image2HeaderVersion: 3.5.2*/ #include "mp_precomp.h" #include "../phydm_precomp.h" #if (RTL8188E_SUPPORT == 1) -static bool +static boolean check_positive( - struct PHY_DM_STRUCT *p_dm_odm, - const u32 condition1, - const u32 condition2, - const u32 condition3, - const u32 condition4 + struct dm_struct *dm, + const u32 condition1, + const u32 condition2, + const u32 condition3, + const u32 condition4 ) { - u8 _board_type = ((p_dm_odm->board_type & BIT(4)) >> 4) << 0 | /* _GLNA*/ - ((p_dm_odm->board_type & BIT(3)) >> 3) << 1 | /* _GPA*/ - ((p_dm_odm->board_type & BIT(7)) >> 7) << 2 | /* _ALNA*/ - ((p_dm_odm->board_type & BIT(6)) >> 6) << 3 | /* _APA */ - ((p_dm_odm->board_type & BIT(2)) >> 2) << 4; /* _BT*/ + u8 _board_type = ((dm->board_type & BIT(4)) >> 4) << 0 | /* _GLNA*/ + ((dm->board_type & BIT(3)) >> 3) << 1 | /* _GPA*/ + ((dm->board_type & BIT(7)) >> 7) << 2 | /* _ALNA*/ + ((dm->board_type & BIT(6)) >> 6) << 3 | /* _APA */ + ((dm->board_type & BIT(2)) >> 2) << 4 | /* _BT*/ + ((dm->board_type & BIT(1)) >> 1) << 5 | /* _NGFF*/ + ((dm->board_type & BIT(5)) >> 5) << 6; /* _TRSWT*/ - u32 cond1 = condition1, cond2 = condition2, cond3 = condition3, cond4 = condition4; - u32 driver1 = p_dm_odm->cut_version << 24 | - (p_dm_odm->support_interface & 0xF0) << 16 | - p_dm_odm->support_platform << 16 | - p_dm_odm->package_type << 12 | - (p_dm_odm->support_interface & 0x0F) << 8 | - _board_type; + u32 cond1 = condition1, cond2 = condition2, cond3 = condition3, cond4 = condition4; - u32 driver2 = (p_dm_odm->type_glna & 0xFF) << 0 | - (p_dm_odm->type_gpa & 0xFF) << 8 | - (p_dm_odm->type_alna & 0xFF) << 16 | - (p_dm_odm->type_apa & 0xFF) << 24; + u8 cut_version_for_para = (dm->cut_version == ODM_CUT_A) ? 15 : dm->cut_version; + u8 pkg_type_for_para = (dm->package_type == 0) ? 15 : dm->package_type; - u32 driver3 = 0; + u32 driver1 = cut_version_for_para << 24 | + (dm->support_interface & 0xF0) << 16 | + dm->support_platform << 16 | + pkg_type_for_para << 12 | + (dm->support_interface & 0x0F) << 8 | + _board_type; - u32 driver4 = (p_dm_odm->type_glna & 0xFF00) >> 8 | - (p_dm_odm->type_gpa & 0xFF00) | - (p_dm_odm->type_alna & 0xFF00) << 8 | - (p_dm_odm->type_apa & 0xFF00) << 16; + u32 driver2 = (dm->type_glna & 0xFF) << 0 | + (dm->type_gpa & 0xFF) << 8 | + (dm->type_alna & 0xFF) << 16 | + (dm->type_apa & 0xFF) << 24; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_TRACE, - ("===> check_positive (cond1, cond2, cond3, cond4) = (0x%X 0x%X 0x%X 0x%X)\n", cond1, cond2, cond3, cond4)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_TRACE, - ("===> check_positive (driver1, driver2, driver3, driver4) = (0x%X 0x%X 0x%X 0x%X)\n", driver1, driver2, driver3, driver4)); + u32 driver3 = 0; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_TRACE, - (" (Platform, Interface) = (0x%X, 0x%X)\n", p_dm_odm->support_platform, p_dm_odm->support_interface)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_TRACE, - (" (Board, Package) = (0x%X, 0x%X)\n", p_dm_odm->board_type, p_dm_odm->package_type)); + u32 driver4 = (dm->type_glna & 0xFF00) >> 8 | + (dm->type_gpa & 0xFF00) | + (dm->type_alna & 0xFF00) << 8 | + (dm->type_apa & 0xFF00) << 16; + + PHYDM_DBG(dm, ODM_COMP_INIT, + "===> %s (cond1, cond2, cond3, cond4) = (0x%X 0x%X 0x%X 0x%X)\n", + __func__, cond1, cond2, cond3, cond4); + PHYDM_DBG(dm, ODM_COMP_INIT, + "===> %s (driver1, driver2, driver3, driver4) = (0x%X 0x%X 0x%X 0x%X)\n", + __func__, driver1, driver2, driver3, driver4); + + PHYDM_DBG(dm, ODM_COMP_INIT, + " (Platform, Interface) = (0x%X, 0x%X)\n", + dm->support_platform, dm->support_interface); + PHYDM_DBG(dm, ODM_COMP_INIT, + " (Board, Package) = (0x%X, 0x%X)\n", dm->board_type, + dm->package_type); /*============== value Defined Check ===============*/ @@ -80,11 +86,11 @@ check_positive( /*=============== Bit Defined Check ================*/ /* We don't care [31:28] */ - cond1 &= 0x00FF0FFF; + cond1 &= 0x00FF0FFF; driver1 &= 0x00FF0FFF; if ((cond1 & driver1) == cond1) { - u32 bit_mask = 0; + u32 bit_mask = 0; if ((cond1 & 0x0F) == 0) /* board_type is DONTCARE*/ return true; @@ -105,163 +111,152 @@ check_positive( } else return false; } -static bool -check_negative( - struct PHY_DM_STRUCT *p_dm_odm, - const u32 condition1, - const u32 condition2 -) -{ - return true; -} /****************************************************************************** -* MAC_REG.TXT +* mac_reg.TXT ******************************************************************************/ u32 array_mp_8188e_mac_reg[] = { - 0x026, 0x00000041, - 0x027, 0x00000035, + 0x026, 0x00000041, + 0x027, 0x00000035, 0x80000002, 0x00000000, 0x40000000, 0x00000000, - 0x040, 0x0000000C, + 0x040, 0x0000000C, 0x90000001, 0x00000000, 0x40000000, 0x00000000, - 0x040, 0x0000000C, + 0x040, 0x0000000C, 0x90000001, 0x00000001, 0x40000000, 0x00000000, - 0x040, 0x0000000C, + 0x040, 0x0000000C, 0x90000001, 0x00000002, 0x40000000, 0x00000000, - 0x040, 0x0000000C, + 0x040, 0x0000000C, 0xA0000000, 0x00000000, - 0x040, 0x00000000, + 0x040, 0x00000000, 0xB0000000, 0x00000000, - 0x421, 0x0000000F, - 0x428, 0x0000000A, - 0x429, 0x00000010, - 0x430, 0x00000000, - 0x431, 0x00000001, - 0x432, 0x00000002, - 0x433, 0x00000004, - 0x434, 0x00000005, - 0x435, 0x00000006, - 0x436, 0x00000007, - 0x437, 0x00000008, - 0x438, 0x00000000, - 0x439, 0x00000000, - 0x43A, 0x00000001, - 0x43B, 0x00000002, - 0x43C, 0x00000004, - 0x43D, 0x00000005, - 0x43E, 0x00000006, - 0x43F, 0x00000007, - 0x440, 0x0000005D, - 0x441, 0x00000001, - 0x442, 0x00000000, - 0x444, 0x00000015, - 0x445, 0x000000F0, - 0x446, 0x0000000F, - 0x447, 0x00000000, - 0x458, 0x00000041, - 0x459, 0x000000A8, - 0x45A, 0x00000072, - 0x45B, 0x000000B9, - 0x460, 0x00000066, - 0x461, 0x00000066, - 0x480, 0x00000008, - 0x4C8, 0x000000FF, - 0x4C9, 0x00000008, - 0x4CC, 0x000000FF, - 0x4CD, 0x000000FF, - 0x4CE, 0x00000001, - 0x4D3, 0x00000001, - 0x500, 0x00000026, - 0x501, 0x000000A2, - 0x502, 0x0000002F, - 0x503, 0x00000000, - 0x504, 0x00000028, - 0x505, 0x000000A3, - 0x506, 0x0000005E, - 0x507, 0x00000000, - 0x508, 0x0000002B, - 0x509, 0x000000A4, - 0x50A, 0x0000005E, - 0x50B, 0x00000000, - 0x50C, 0x0000004F, - 0x50D, 0x000000A4, - 0x50E, 0x00000000, - 0x50F, 0x00000000, - 0x512, 0x0000001C, - 0x514, 0x0000000A, - 0x516, 0x0000000A, - 0x525, 0x0000004F, - 0x550, 0x00000010, - 0x551, 0x00000010, - 0x559, 0x00000002, - 0x55D, 0x000000FF, - 0x605, 0x00000030, - 0x608, 0x0000000E, - 0x609, 0x0000002A, - 0x620, 0x000000FF, - 0x621, 0x000000FF, - 0x622, 0x000000FF, - 0x623, 0x000000FF, - 0x624, 0x000000FF, - 0x625, 0x000000FF, - 0x626, 0x000000FF, - 0x627, 0x000000FF, - 0x63C, 0x00000008, - 0x63D, 0x00000008, - 0x63E, 0x0000000C, - 0x63F, 0x0000000C, - 0x640, 0x00000040, - 0x652, 0x00000020, - 0x66E, 0x00000005, - 0x700, 0x00000021, - 0x701, 0x00000043, - 0x702, 0x00000065, - 0x703, 0x00000087, - 0x708, 0x00000021, - 0x709, 0x00000043, - 0x70A, 0x00000065, - 0x70B, 0x00000087, + 0x421, 0x0000000F, + 0x428, 0x0000000A, + 0x429, 0x00000010, + 0x430, 0x00000000, + 0x431, 0x00000001, + 0x432, 0x00000002, + 0x433, 0x00000004, + 0x434, 0x00000005, + 0x435, 0x00000006, + 0x436, 0x00000007, + 0x437, 0x00000008, + 0x438, 0x00000000, + 0x439, 0x00000000, + 0x43A, 0x00000001, + 0x43B, 0x00000002, + 0x43C, 0x00000004, + 0x43D, 0x00000005, + 0x43E, 0x00000006, + 0x43F, 0x00000007, + 0x440, 0x0000005D, + 0x441, 0x00000001, + 0x442, 0x00000000, + 0x444, 0x00000015, + 0x445, 0x000000F0, + 0x446, 0x0000000F, + 0x447, 0x00000000, + 0x458, 0x00000041, + 0x459, 0x000000A8, + 0x45A, 0x00000072, + 0x45B, 0x000000B9, + 0x460, 0x00000066, + 0x461, 0x00000066, + 0x480, 0x00000008, + 0x4C8, 0x000000FF, + 0x4C9, 0x00000008, + 0x4CC, 0x000000FF, + 0x4CD, 0x000000FF, + 0x4CE, 0x00000001, + 0x4D3, 0x00000001, + 0x500, 0x00000026, + 0x501, 0x000000A2, + 0x502, 0x0000002F, + 0x503, 0x00000000, + 0x504, 0x00000028, + 0x505, 0x000000A3, + 0x506, 0x0000005E, + 0x507, 0x00000000, + 0x508, 0x0000002B, + 0x509, 0x000000A4, + 0x50A, 0x0000005E, + 0x50B, 0x00000000, + 0x50C, 0x0000004F, + 0x50D, 0x000000A4, + 0x50E, 0x00000000, + 0x50F, 0x00000000, + 0x512, 0x0000001C, + 0x514, 0x0000000A, + 0x516, 0x0000000A, + 0x525, 0x0000004F, + 0x550, 0x00000010, + 0x551, 0x00000010, + 0x559, 0x00000002, + 0x55D, 0x000000FF, + 0x605, 0x00000030, + 0x608, 0x0000000E, + 0x609, 0x0000002A, + 0x620, 0x000000FF, + 0x621, 0x000000FF, + 0x622, 0x000000FF, + 0x623, 0x000000FF, + 0x624, 0x000000FF, + 0x625, 0x000000FF, + 0x626, 0x000000FF, + 0x627, 0x000000FF, + 0x63C, 0x00000008, + 0x63D, 0x00000008, + 0x63E, 0x0000000C, + 0x63F, 0x0000000C, + 0x640, 0x00000040, + 0x652, 0x00000020, + 0x66E, 0x00000005, + 0x700, 0x00000021, + 0x701, 0x00000043, + 0x702, 0x00000065, + 0x703, 0x00000087, + 0x708, 0x00000021, + 0x709, 0x00000043, + 0x70A, 0x00000065, + 0x70B, 0x00000087, }; void -odm_read_and_config_mp_8188e_mac_reg( - struct PHY_DM_STRUCT *p_dm_odm -) +odm_read_and_config_mp_8188e_mac_reg(struct dm_struct *dm) { - u32 i = 0; - u8 c_cond; - bool is_matched = true, is_skipped = false; - u32 array_len = sizeof(array_mp_8188e_mac_reg) / sizeof(u32); - u32 *array = array_mp_8188e_mac_reg; + u32 i = 0; + u8 c_cond; + boolean is_matched = true, is_skipped = false; + u32 array_len = sizeof(array_mp_8188e_mac_reg) / sizeof(u32); + u32 *array = array_mp_8188e_mac_reg; u32 v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> odm_read_and_config_mp_8188e_mac_reg\n")); + PHYDM_DBG(dm, ODM_COMP_INIT, "===> %s\n", __func__); while ((i + 1) < array_len) { v1 = array[i]; v2 = array[i + 1]; - if (v1 & (BIT(31) | BIT30)) {/*positive & negative condition*/ + 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; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ENDIF\n")); + PHYDM_DBG(dm, ODM_COMP_INIT, "ENDIF\n"); } else if (c_cond == COND_ELSE) { /*else*/ is_matched = is_skipped ? false : true; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ELSE\n")); + PHYDM_DBG(dm, ODM_COMP_INIT, "ELSE\n"); } else {/*if , else if*/ pre_v1 = v1; pre_v2 = v2; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("IF or ELSE IF\n")); + PHYDM_DBG(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_odm, pre_v1, pre_v2, v1, v2)) { + if (check_positive(dm, pre_v1, pre_v2, v1, v2)) { is_matched = true; is_skipped = true; } else { @@ -273,7 +268,7 @@ odm_read_and_config_mp_8188e_mac_reg( } } else { if (is_matched) - odm_config_mac_8188e(p_dm_odm, v1, (u8)v2); + odm_config_mac_8188e(dm, v1, (u8)v2); } i = i + 2; } @@ -282,7 +277,8 @@ odm_read_and_config_mp_8188e_mac_reg( u32 odm_get_version_mp_8188e_mac_reg(void) { - return 70; + return 71; } #endif /* end of HWIMG_SUPPORT*/ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_mac.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_mac.h index 63758bc7c4a0..6147fb18cc4a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_mac.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_mac.h @@ -1,38 +1,34 @@ +/* SPDX-License-Identifier: GPL-2.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 -* -* -******************************************************************************/ + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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: 2.18*/ +/*Image2HeaderVersion: 3.5.2*/ #if (RTL8188E_SUPPORT == 1) #ifndef __INC_MP_MAC_HW_IMG_8188E_H #define __INC_MP_MAC_HW_IMG_8188E_H /****************************************************************************** -* MAC_REG.TXT +* mac_reg.TXT ******************************************************************************/ void -odm_read_and_config_mp_8188e_mac_reg(/* TC: Test Chip, MP: MP Chip*/ - struct PHY_DM_STRUCT *p_dm_odm -); +odm_read_and_config_mp_8188e_mac_reg( /* tc: Test Chip, mp: mp Chip*/ + struct dm_struct *dm); u32 odm_get_version_mp_8188e_mac_reg(void); #endif #endif /* end of HWIMG_SUPPORT*/ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_rf.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_rf.c index 5cb8d3c1c4b0..94c2d135e22a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_rf.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_rf.c @@ -1,72 +1,78 @@ +/* SPDX-License-Identifier: GPL-2.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 -* -* -******************************************************************************/ + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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: 2.18*/ +/*Image2HeaderVersion: 3.5.2*/ #include "mp_precomp.h" #include "../phydm_precomp.h" #if (RTL8188E_SUPPORT == 1) -static bool +static boolean check_positive( - struct PHY_DM_STRUCT *p_dm_odm, - const u32 condition1, - const u32 condition2, - const u32 condition3, - const u32 condition4 + struct dm_struct *dm, + const u32 condition1, + const u32 condition2, + const u32 condition3, + const u32 condition4 ) { - u8 _board_type = ((p_dm_odm->board_type & BIT(4)) >> 4) << 0 | /* _GLNA*/ - ((p_dm_odm->board_type & BIT(3)) >> 3) << 1 | /* _GPA*/ - ((p_dm_odm->board_type & BIT(7)) >> 7) << 2 | /* _ALNA*/ - ((p_dm_odm->board_type & BIT(6)) >> 6) << 3 | /* _APA */ - ((p_dm_odm->board_type & BIT(2)) >> 2) << 4; /* _BT*/ + u8 _board_type = ((dm->board_type & BIT(4)) >> 4) << 0 | /* _GLNA*/ + ((dm->board_type & BIT(3)) >> 3) << 1 | /* _GPA*/ + ((dm->board_type & BIT(7)) >> 7) << 2 | /* _ALNA*/ + ((dm->board_type & BIT(6)) >> 6) << 3 | /* _APA */ + ((dm->board_type & BIT(2)) >> 2) << 4 | /* _BT*/ + ((dm->board_type & BIT(1)) >> 1) << 5 | /* _NGFF*/ + ((dm->board_type & BIT(5)) >> 5) << 6; /* _TRSWT*/ - u32 cond1 = condition1, cond2 = condition2, cond3 = condition3, cond4 = condition4; - u32 driver1 = p_dm_odm->cut_version << 24 | - (p_dm_odm->support_interface & 0xF0) << 16 | - p_dm_odm->support_platform << 16 | - p_dm_odm->package_type << 12 | - (p_dm_odm->support_interface & 0x0F) << 8 | - _board_type; + u32 cond1 = condition1, cond2 = condition2, cond3 = condition3, cond4 = condition4; - u32 driver2 = (p_dm_odm->type_glna & 0xFF) << 0 | - (p_dm_odm->type_gpa & 0xFF) << 8 | - (p_dm_odm->type_alna & 0xFF) << 16 | - (p_dm_odm->type_apa & 0xFF) << 24; + u8 cut_version_for_para = (dm->cut_version == ODM_CUT_A) ? 15 : dm->cut_version; + u8 pkg_type_for_para = (dm->package_type == 0) ? 15 : dm->package_type; - u32 driver3 = 0; + u32 driver1 = cut_version_for_para << 24 | + (dm->support_interface & 0xF0) << 16 | + dm->support_platform << 16 | + pkg_type_for_para << 12 | + (dm->support_interface & 0x0F) << 8 | + _board_type; - u32 driver4 = (p_dm_odm->type_glna & 0xFF00) >> 8 | - (p_dm_odm->type_gpa & 0xFF00) | - (p_dm_odm->type_alna & 0xFF00) << 8 | - (p_dm_odm->type_apa & 0xFF00) << 16; + u32 driver2 = (dm->type_glna & 0xFF) << 0 | + (dm->type_gpa & 0xFF) << 8 | + (dm->type_alna & 0xFF) << 16 | + (dm->type_apa & 0xFF) << 24; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_TRACE, - ("===> check_positive (cond1, cond2, cond3, cond4) = (0x%X 0x%X 0x%X 0x%X)\n", cond1, cond2, cond3, cond4)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_TRACE, - ("===> check_positive (driver1, driver2, driver3, driver4) = (0x%X 0x%X 0x%X 0x%X)\n", driver1, driver2, driver3, driver4)); + u32 driver3 = 0; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_TRACE, - (" (Platform, Interface) = (0x%X, 0x%X)\n", p_dm_odm->support_platform, p_dm_odm->support_interface)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_TRACE, - (" (Board, Package) = (0x%X, 0x%X)\n", p_dm_odm->board_type, p_dm_odm->package_type)); + u32 driver4 = (dm->type_glna & 0xFF00) >> 8 | + (dm->type_gpa & 0xFF00) | + (dm->type_alna & 0xFF00) << 8 | + (dm->type_apa & 0xFF00) << 16; + + PHYDM_DBG(dm, ODM_COMP_INIT, + "===> %s (cond1, cond2, cond3, cond4) = (0x%X 0x%X 0x%X 0x%X)\n", + __func__, cond1, cond2, cond3, cond4); + PHYDM_DBG(dm, ODM_COMP_INIT, + "===> %s (driver1, driver2, driver3, driver4) = (0x%X 0x%X 0x%X 0x%X)\n", + __func__, driver1, driver2, driver3, driver4); + + PHYDM_DBG(dm, ODM_COMP_INIT, + " (Platform, Interface) = (0x%X, 0x%X)\n", + dm->support_platform, dm->support_interface); + PHYDM_DBG(dm, ODM_COMP_INIT, + " (Board, Package) = (0x%X, 0x%X)\n", dm->board_type, + dm->package_type); /*============== value Defined Check ===============*/ @@ -80,11 +86,11 @@ check_positive( /*=============== Bit Defined Check ================*/ /* We don't care [31:28] */ - cond1 &= 0x00FF0FFF; + cond1 &= 0x00FF0FFF; driver1 &= 0x00FF0FFF; if ((cond1 & driver1) == cond1) { - u32 bit_mask = 0; + u32 bit_mask = 0; if ((cond1 & 0x0F) == 0) /* board_type is DONTCARE*/ return true; @@ -105,600 +111,628 @@ check_positive( } else return false; } -static bool -check_negative( - struct PHY_DM_STRUCT *p_dm_odm, - const u32 condition1, - const u32 condition2 -) -{ - return true; -} /****************************************************************************** -* RadioA.TXT +* radioa.TXT ******************************************************************************/ u32 array_mp_8188e_radioa[] = { - 0x000, 0x00030000, - 0x008, 0x00084000, - 0x018, 0x00000407, - 0x019, 0x00000012, + 0x000, 0x00030000, + 0x008, 0x00084000, + 0x018, 0x00000407, + 0x019, 0x00000012, 0x88000003, 0x00000000, 0x40000000, 0x00000000, - 0x01B, 0x00000084, + 0x01B, 0x00000084, 0x98000003, 0x00000001, 0x40000000, 0x00000000, - 0x01B, 0x00000084, + 0x01B, 0x00000084, 0x98000003, 0x00000002, 0x40000000, 0x00000000, - 0x01B, 0x00000084, + 0x01B, 0x00000084, 0x90000003, 0x00000002, 0x40000000, 0x00000000, 0x98000001, 0x00000000, 0x40000000, 0x00000000, - 0x01B, 0x00000084, + 0x01B, 0x00000084, 0x98000001, 0x00000001, 0x40000000, 0x00000000, - 0x01B, 0x00000084, + 0x01B, 0x00000084, 0x98000001, 0x00000002, 0x40000000, 0x00000000, - 0x01B, 0x00000084, + 0x01B, 0x00000084, 0x98000400, 0x00000000, 0x40000000, 0x00000000, - 0x01B, 0x00000084, + 0x01B, 0x00000084, + 0x98000002, 0x00000000, 0x40000000, 0x00000000, + 0x01B, 0x00000084, 0x90000002, 0x00000000, 0x40000000, 0x00000000, 0x90000001, 0x00000000, 0x40000000, 0x00000000, 0x90000001, 0x00000001, 0x40000000, 0x00000000, 0x90000001, 0x00000002, 0x40000000, 0x00000000, 0x98000000, 0x00000000, 0x40000000, 0x00000000, - 0x01B, 0x00000084, + 0x01B, 0x00000084, 0x90000400, 0x00000000, 0x40000000, 0x00000000, 0xA0000000, 0x00000000, 0xB0000000, 0x00000000, - 0x01E, 0x00080009, - 0x01F, 0x00000880, - 0x02F, 0x0001A060, + 0x01E, 0x00080009, + 0x01F, 0x00000880, + 0x02F, 0x0001A060, 0x88000003, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x000C0000, + 0x03F, 0x000C0000, 0x98000003, 0x00000001, 0x40000000, 0x00000000, - 0x03F, 0x000C0000, + 0x03F, 0x000C0000, 0x98000003, 0x00000002, 0x40000000, 0x00000000, - 0x03F, 0x000C0000, + 0x03F, 0x000C0000, 0x90000003, 0x00000002, 0x40000000, 0x00000000, - 0x03F, 0x00000000, + 0x03F, 0x00000000, 0x98000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x000C0000, + 0x03F, 0x000C0000, 0x98000001, 0x00000001, 0x40000000, 0x00000000, - 0x03F, 0x000C0000, + 0x03F, 0x000C0000, 0x98000001, 0x00000002, 0x40000000, 0x00000000, - 0x03F, 0x000C0000, + 0x03F, 0x000C0000, 0x98000400, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x000C0000, + 0x03F, 0x000C0000, + 0x98000002, 0x00000000, 0x40000000, 0x00000000, + 0x03F, 0x000C0000, 0x90000002, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00000000, + 0x03F, 0x00000000, 0x90000001, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00000000, + 0x03F, 0x00000000, 0x90000001, 0x00000001, 0x40000000, 0x00000000, - 0x03F, 0x00000000, + 0x03F, 0x00000000, 0x90000001, 0x00000002, 0x40000000, 0x00000000, - 0x03F, 0x00000000, + 0x03F, 0x00000000, 0x98000000, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x000C0000, + 0x03F, 0x000C0000, 0x90000400, 0x00000000, 0x40000000, 0x00000000, - 0x03F, 0x00000000, + 0x03F, 0x00000000, 0xA0000000, 0x00000000, - 0x03F, 0x00000000, + 0x03F, 0x00000000, 0xB0000000, 0x00000000, - 0x042, 0x000060C0, - 0x057, 0x000D0000, - 0x058, 0x000BE180, - 0x067, 0x00001552, - 0x083, 0x00000000, - 0x0B0, 0x000FF8FC, - 0x0B1, 0x00054400, - 0x0B2, 0x000CCC19, - 0x0B4, 0x00043003, - 0x0B6, 0x0004953E, - 0x0B7, 0x0001C718, - 0x0B8, 0x000060FF, - 0x0B9, 0x00080001, - 0x0BA, 0x00040000, - 0x0BB, 0x00000400, - 0x0BF, 0x000C0000, - 0x0C2, 0x00002400, - 0x0C3, 0x00000009, - 0x0C4, 0x00040C91, - 0x0C5, 0x00099999, - 0x0C6, 0x000000A3, - 0x0C7, 0x00088820, - 0x0C8, 0x00076C06, - 0x0C9, 0x00000000, - 0x0CA, 0x00080000, - 0x0DF, 0x00000180, - 0x0EF, 0x000001A0, - 0x051, 0x0006B27D, + 0x042, 0x000060C0, + 0x057, 0x000D0000, + 0x058, 0x000BE180, + 0x067, 0x00001552, + 0x083, 0x00000000, + 0x0B0, 0x000FF8FC, + 0x0B1, 0x00054400, + 0x0B2, 0x000CCC19, + 0x0B4, 0x00043003, + 0x0B6, 0x0004953E, + 0x0B7, 0x0001C718, + 0x0B8, 0x000060FF, + 0x0B9, 0x00080001, + 0x0BA, 0x00040000, + 0x0BB, 0x00000400, + 0x0BF, 0x000C0000, + 0x0C2, 0x00002400, + 0x0C3, 0x00000009, + 0x0C4, 0x00040C91, + 0x0C5, 0x00099999, + 0x0C6, 0x000000A3, + 0x0C7, 0x00088820, + 0x0C8, 0x00076C06, + 0x0C9, 0x00000000, + 0x0CA, 0x00080000, + 0x0DF, 0x00000180, + 0x0EF, 0x000001A0, + 0x051, 0x0006B27D, 0x88000003, 0x00000000, 0x40000000, 0x00000000, - 0x052, 0x0007E49D, + 0x052, 0x0007E49D, 0x98000003, 0x00000001, 0x40000000, 0x00000000, - 0x052, 0x0007E49D, + 0x052, 0x0007E49D, 0x98000003, 0x00000002, 0x40000000, 0x00000000, - 0x052, 0x0007E49D, + 0x052, 0x0007E49D, 0x90000003, 0x00000002, 0x40000000, 0x00000000, - 0x052, 0x0007E49D, + 0x052, 0x0007E49D, 0x98000001, 0x00000000, 0x40000000, 0x00000000, - 0x052, 0x0007E49D, + 0x052, 0x0007E49D, 0x98000001, 0x00000001, 0x40000000, 0x00000000, - 0x052, 0x0007E49D, + 0x052, 0x0007E49D, 0x98000001, 0x00000002, 0x40000000, 0x00000000, - 0x052, 0x0007E49D, + 0x052, 0x0007E49D, 0x98000400, 0x00000000, 0x40000000, 0x00000000, - 0x052, 0x0007E4DD, + 0x052, 0x0007E4DD, + 0x98000002, 0x00000000, 0x40000000, 0x00000000, + 0x052, 0x0007E49D, 0x90000002, 0x00000000, 0x40000000, 0x00000000, - 0x052, 0x0007E49D, + 0x052, 0x0007E49D, 0x90000001, 0x00000000, 0x40000000, 0x00000000, - 0x052, 0x0007E49D, + 0x052, 0x0007E49D, 0x90000001, 0x00000001, 0x40000000, 0x00000000, - 0x052, 0x0007E49D, + 0x052, 0x0007E49D, 0x90000001, 0x00000002, 0x40000000, 0x00000000, - 0x052, 0x0007E49D, + 0x052, 0x0007E49D, 0x98000000, 0x00000000, 0x40000000, 0x00000000, - 0x052, 0x0007E49D, + 0x052, 0x0007E49D, 0x90000400, 0x00000000, 0x40000000, 0x00000000, - 0x052, 0x0007E4DD, + 0x052, 0x0007E4DD, 0xA0000000, 0x00000000, - 0x052, 0x0007E49D, + 0x052, 0x0007E49D, 0xB0000000, 0x00000000, - 0x053, 0x00000073, - 0x056, 0x00051FF3, - 0x035, 0x00000086, - 0x035, 0x00000186, - 0x035, 0x00000286, - 0x036, 0x00001C25, - 0x036, 0x00009C25, - 0x036, 0x00011C25, - 0x036, 0x00019C25, - 0x0B6, 0x00048538, - 0x018, 0x00000C07, - 0x05A, 0x0004BD00, - 0x019, 0x000739D0, + 0x053, 0x00000073, + 0x056, 0x00051FF3, + 0x035, 0x00000086, + 0x035, 0x00000186, + 0x035, 0x00000286, + 0x036, 0x00001C25, + 0x036, 0x00009C25, + 0x036, 0x00011C25, + 0x036, 0x00019C25, + 0x0B6, 0x00048538, + 0x018, 0x00000C07, + 0x05A, 0x0004BD00, + 0x019, 0x000739D0, 0x88000003, 0x00000000, 0x40000000, 0x00000000, - 0x034, 0x0000A095, - 0x034, 0x00009092, - 0x034, 0x0000808E, - 0x034, 0x0000704F, - 0x034, 0x0000604C, - 0x034, 0x00005049, - 0x034, 0x0000400C, - 0x034, 0x00003009, - 0x034, 0x00002006, - 0x034, 0x00001003, - 0x034, 0x00000000, + 0x034, 0x0000A095, + 0x034, 0x00009092, + 0x034, 0x0000808E, + 0x034, 0x0000704F, + 0x034, 0x0000604C, + 0x034, 0x00005049, + 0x034, 0x0000400C, + 0x034, 0x00003009, + 0x034, 0x00002006, + 0x034, 0x00001003, + 0x034, 0x00000000, 0x98000003, 0x00000001, 0x40000000, 0x00000000, - 0x034, 0x0000A095, - 0x034, 0x00009092, - 0x034, 0x0000808E, - 0x034, 0x0000704F, - 0x034, 0x0000604C, - 0x034, 0x00005049, - 0x034, 0x0000400C, - 0x034, 0x00003009, - 0x034, 0x00002006, - 0x034, 0x00001003, - 0x034, 0x00000000, + 0x034, 0x0000A095, + 0x034, 0x00009092, + 0x034, 0x0000808E, + 0x034, 0x0000704F, + 0x034, 0x0000604C, + 0x034, 0x00005049, + 0x034, 0x0000400C, + 0x034, 0x00003009, + 0x034, 0x00002006, + 0x034, 0x00001003, + 0x034, 0x00000000, 0x98000003, 0x00000002, 0x40000000, 0x00000000, - 0x034, 0x0000A095, - 0x034, 0x00009092, - 0x034, 0x0000808E, - 0x034, 0x0000704F, - 0x034, 0x0000604C, - 0x034, 0x00005049, - 0x034, 0x0000400C, - 0x034, 0x00003009, - 0x034, 0x00002006, - 0x034, 0x00001003, - 0x034, 0x00000000, + 0x034, 0x0000A095, + 0x034, 0x00009092, + 0x034, 0x0000808E, + 0x034, 0x0000704F, + 0x034, 0x0000604C, + 0x034, 0x00005049, + 0x034, 0x0000400C, + 0x034, 0x00003009, + 0x034, 0x00002006, + 0x034, 0x00001003, + 0x034, 0x00000000, 0x90000003, 0x00000002, 0x40000000, 0x00000000, - 0x034, 0x0000A095, - 0x034, 0x00009092, - 0x034, 0x0000808E, - 0x034, 0x0000704F, - 0x034, 0x0000604C, - 0x034, 0x00005049, - 0x034, 0x0000400C, - 0x034, 0x00003009, - 0x034, 0x00002006, - 0x034, 0x00001003, - 0x034, 0x00000000, + 0x034, 0x0000A095, + 0x034, 0x00009092, + 0x034, 0x0000808E, + 0x034, 0x0000704F, + 0x034, 0x0000604C, + 0x034, 0x00005049, + 0x034, 0x0000400C, + 0x034, 0x00003009, + 0x034, 0x00002006, + 0x034, 0x00001003, + 0x034, 0x00000000, + 0x98000002, 0x00000000, 0x40000000, 0x00000000, + 0x034, 0x0000A095, + 0x034, 0x00009092, + 0x034, 0x0000808E, + 0x034, 0x0000704F, + 0x034, 0x0000604C, + 0x034, 0x00005049, + 0x034, 0x0000400C, + 0x034, 0x00003009, + 0x034, 0x00002006, + 0x034, 0x00001003, + 0x034, 0x00000000, 0x90000002, 0x00000000, 0x40000000, 0x00000000, - 0x034, 0x0000A095, - 0x034, 0x00009092, - 0x034, 0x0000808E, - 0x034, 0x0000704F, - 0x034, 0x0000604C, - 0x034, 0x00005049, - 0x034, 0x0000400C, - 0x034, 0x00003009, - 0x034, 0x00002006, - 0x034, 0x00001003, - 0x034, 0x00000000, + 0x034, 0x0000A095, + 0x034, 0x00009092, + 0x034, 0x0000808E, + 0x034, 0x0000704F, + 0x034, 0x0000604C, + 0x034, 0x00005049, + 0x034, 0x0000400C, + 0x034, 0x00003009, + 0x034, 0x00002006, + 0x034, 0x00001003, + 0x034, 0x00000000, 0xA0000000, 0x00000000, - 0x034, 0x0000ADF3, - 0x034, 0x00009DF0, - 0x034, 0x00008DED, - 0x034, 0x00007DEA, - 0x034, 0x00006DE7, - 0x034, 0x000054EE, - 0x034, 0x000044EB, - 0x034, 0x000034E8, - 0x034, 0x0000246B, - 0x034, 0x00001468, - 0x034, 0x0000006D, + 0x034, 0x0000ADF3, + 0x034, 0x00009DF0, + 0x034, 0x00008DED, + 0x034, 0x00007DEA, + 0x034, 0x00006DE7, + 0x034, 0x000054EE, + 0x034, 0x000044EB, + 0x034, 0x000034E8, + 0x034, 0x0000246B, + 0x034, 0x00001468, + 0x034, 0x0000006D, 0xB0000000, 0x00000000, - 0x000, 0x00030159, - 0x084, 0x00068200, + 0x000, 0x00030159, + 0x084, 0x00068200, 0x88000003, 0x00000000, 0x40000000, 0x00000000, - 0x086, 0x000000CE, - 0x087, 0x00048A00, + 0x086, 0x000000CE, + 0x087, 0x00048A00, 0x98000003, 0x00000001, 0x40000000, 0x00000000, - 0x086, 0x000000CE, - 0x087, 0x00048A00, + 0x086, 0x000000CE, + 0x087, 0x00048A00, 0x98000003, 0x00000002, 0x40000000, 0x00000000, - 0x086, 0x000000CE, - 0x087, 0x00048A00, + 0x086, 0x000000CE, + 0x087, 0x00048A00, 0x90000003, 0x00000002, 0x40000000, 0x00000000, - 0x086, 0x000000CE, - 0x087, 0x00079F80, + 0x086, 0x000000CE, + 0x087, 0x00079F80, 0x98000001, 0x00000000, 0x40000000, 0x00000000, - 0x086, 0x000000CE, - 0x087, 0x00048A00, + 0x086, 0x000000CE, + 0x087, 0x00048A00, 0x98000001, 0x00000001, 0x40000000, 0x00000000, - 0x086, 0x000000CE, - 0x087, 0x00048A00, + 0x086, 0x000000CE, + 0x087, 0x00048A00, 0x98000001, 0x00000002, 0x40000000, 0x00000000, - 0x086, 0x000000CE, - 0x087, 0x00048A00, + 0x086, 0x000000CE, + 0x087, 0x00048A00, 0x98000400, 0x00000000, 0x40000000, 0x00000000, - 0x086, 0x000000CE, - 0x087, 0x00048A00, + 0x086, 0x000000CE, + 0x087, 0x00048A00, + 0x98000002, 0x00000000, 0x40000000, 0x00000000, + 0x086, 0x000000CE, + 0x087, 0x00048A00, 0x90000002, 0x00000000, 0x40000000, 0x00000000, - 0x086, 0x000000CE, - 0x087, 0x00048A00, + 0x086, 0x000000CE, + 0x087, 0x00048A00, 0x90000001, 0x00000000, 0x40000000, 0x00000000, - 0x086, 0x000000CE, - 0x087, 0x00048A00, + 0x086, 0x000000CE, + 0x087, 0x00048A00, 0x90000001, 0x00000001, 0x40000000, 0x00000000, - 0x086, 0x000000CE, - 0x087, 0x00048A00, + 0x086, 0x000000CE, + 0x087, 0x00048A00, 0x90000001, 0x00000002, 0x40000000, 0x00000000, - 0x086, 0x000000CE, - 0x087, 0x00079F80, + 0x086, 0x000000CE, + 0x087, 0x00079F80, 0x98000000, 0x00000000, 0x40000000, 0x00000000, - 0x086, 0x0008014E, - 0x087, 0x0004DF80, + 0x086, 0x0008014E, + 0x087, 0x0004DF80, 0x90000400, 0x00000000, 0x40000000, 0x00000000, - 0x086, 0x000000CE, - 0x087, 0x00048A00, + 0x086, 0x000000CE, + 0x087, 0x00048A00, 0xA0000000, 0x00000000, - 0x086, 0x000000CE, - 0x087, 0x00048A00, + 0x086, 0x000000CE, + 0x087, 0x00048A00, 0xB0000000, 0x00000000, - 0x08E, 0x00065540, - 0x08F, 0x00088000, - 0x0EF, 0x000020A0, + 0x08E, 0x00065540, + 0x08F, 0x00088000, + 0x0EF, 0x000020A0, 0x88000003, 0x00000000, 0x40000000, 0x00000000, - 0x03B, 0x000F02B0, - 0x03B, 0x000EF7B0, - 0x03B, 0x000D4FB0, - 0x03B, 0x000CF060, - 0x03B, 0x000B0090, - 0x03B, 0x000A0080, - 0x03B, 0x00090080, - 0x03B, 0x0008F780, - 0x03B, 0x000722B0, - 0x03B, 0x0006F7B0, - 0x03B, 0x00054FB0, - 0x03B, 0x0004F060, - 0x03B, 0x00030090, - 0x03B, 0x00020080, - 0x03B, 0x00010080, - 0x03B, 0x0000F780, - 0x0EF, 0x000000A0, + 0x03B, 0x000F02B0, + 0x03B, 0x000EF7B0, + 0x03B, 0x000D4FB0, + 0x03B, 0x000CF060, + 0x03B, 0x000B0090, + 0x03B, 0x000A0080, + 0x03B, 0x00090080, + 0x03B, 0x0008F780, + 0x03B, 0x000722B0, + 0x03B, 0x0006F7B0, + 0x03B, 0x00054FB0, + 0x03B, 0x0004F060, + 0x03B, 0x00030090, + 0x03B, 0x00020080, + 0x03B, 0x00010080, + 0x03B, 0x0000F780, + 0x0EF, 0x000000A0, 0x98000003, 0x00000001, 0x40000000, 0x00000000, - 0x03B, 0x000F02B0, - 0x03B, 0x000EF7B0, - 0x03B, 0x000D4FB0, - 0x03B, 0x000CF060, - 0x03B, 0x000B0090, - 0x03B, 0x000A0080, - 0x03B, 0x00090080, - 0x03B, 0x0008F780, - 0x03B, 0x000722B0, - 0x03B, 0x0006F7B0, - 0x03B, 0x00054FB0, - 0x03B, 0x0004F060, - 0x03B, 0x00030090, - 0x03B, 0x00020080, - 0x03B, 0x00010080, - 0x03B, 0x0000F780, - 0x0EF, 0x000000A0, + 0x03B, 0x000F02B0, + 0x03B, 0x000EF7B0, + 0x03B, 0x000D4FB0, + 0x03B, 0x000CF060, + 0x03B, 0x000B0090, + 0x03B, 0x000A0080, + 0x03B, 0x00090080, + 0x03B, 0x0008F780, + 0x03B, 0x000722B0, + 0x03B, 0x0006F7B0, + 0x03B, 0x00054FB0, + 0x03B, 0x0004F060, + 0x03B, 0x00030090, + 0x03B, 0x00020080, + 0x03B, 0x00010080, + 0x03B, 0x0000F780, + 0x0EF, 0x000000A0, 0x98000003, 0x00000002, 0x40000000, 0x00000000, - 0x03B, 0x000F02B0, - 0x03B, 0x000EF7B0, - 0x03B, 0x000D4FB0, - 0x03B, 0x000CF060, - 0x03B, 0x000B0090, - 0x03B, 0x000A0080, - 0x03B, 0x00090080, - 0x03B, 0x0008F780, - 0x03B, 0x000722B0, - 0x03B, 0x0006F7B0, - 0x03B, 0x00054FB0, - 0x03B, 0x0004F060, - 0x03B, 0x00030090, - 0x03B, 0x00020080, - 0x03B, 0x00010080, - 0x03B, 0x0000F780, - 0x0EF, 0x000000A0, + 0x03B, 0x000F02B0, + 0x03B, 0x000EF7B0, + 0x03B, 0x000D4FB0, + 0x03B, 0x000CF060, + 0x03B, 0x000B0090, + 0x03B, 0x000A0080, + 0x03B, 0x00090080, + 0x03B, 0x0008F780, + 0x03B, 0x000722B0, + 0x03B, 0x0006F7B0, + 0x03B, 0x00054FB0, + 0x03B, 0x0004F060, + 0x03B, 0x00030090, + 0x03B, 0x00020080, + 0x03B, 0x00010080, + 0x03B, 0x0000F780, + 0x0EF, 0x000000A0, 0x90000003, 0x00000002, 0x40000000, 0x00000000, - 0x03B, 0x000F07B0, - 0x03B, 0x000EF7B0, - 0x03B, 0x000D0020, - 0x03B, 0x000CF060, - 0x03B, 0x000B07E0, - 0x03B, 0x000A0010, - 0x03B, 0x00090000, - 0x03B, 0x0008F780, - 0x03B, 0x000727B0, - 0x03B, 0x0006F7B0, - 0x03B, 0x00054FB0, - 0x03B, 0x0004F060, - 0x03B, 0x00030090, - 0x03B, 0x00020080, - 0x03B, 0x00010080, - 0x03B, 0x0000F780, - 0x0EF, 0x000000A0, + 0x03B, 0x000F07B0, + 0x03B, 0x000EF7B0, + 0x03B, 0x000D0020, + 0x03B, 0x000CF060, + 0x03B, 0x000B07E0, + 0x03B, 0x000A0010, + 0x03B, 0x00090000, + 0x03B, 0x0008F780, + 0x03B, 0x000727B0, + 0x03B, 0x0006F7B0, + 0x03B, 0x00054FB0, + 0x03B, 0x0004F060, + 0x03B, 0x00030090, + 0x03B, 0x00020080, + 0x03B, 0x00010080, + 0x03B, 0x0000F780, + 0x0EF, 0x000000A0, 0x98000001, 0x00000000, 0x40000000, 0x00000000, - 0x03B, 0x000F02B0, - 0x03B, 0x000EF7B0, - 0x03B, 0x000D4FB0, - 0x03B, 0x000CF060, - 0x03B, 0x000B0090, - 0x03B, 0x000A0080, - 0x03B, 0x00090080, - 0x03B, 0x0008F780, - 0x03B, 0x000722B0, - 0x03B, 0x0006F7B0, - 0x03B, 0x00054FB0, - 0x03B, 0x0004F060, - 0x03B, 0x00030090, - 0x03B, 0x00020080, - 0x03B, 0x00010080, - 0x03B, 0x0000F780, - 0x0EF, 0x000000A0, + 0x03B, 0x000F02B0, + 0x03B, 0x000EF7B0, + 0x03B, 0x000D4FB0, + 0x03B, 0x000CF060, + 0x03B, 0x000B0090, + 0x03B, 0x000A0080, + 0x03B, 0x00090080, + 0x03B, 0x0008F780, + 0x03B, 0x000722B0, + 0x03B, 0x0006F7B0, + 0x03B, 0x00054FB0, + 0x03B, 0x0004F060, + 0x03B, 0x00030090, + 0x03B, 0x00020080, + 0x03B, 0x00010080, + 0x03B, 0x0000F780, + 0x0EF, 0x000000A0, 0x98000001, 0x00000001, 0x40000000, 0x00000000, - 0x03B, 0x000F02B0, - 0x03B, 0x000EF7B0, - 0x03B, 0x000D4FB0, - 0x03B, 0x000CF060, - 0x03B, 0x000B0090, - 0x03B, 0x000A0080, - 0x03B, 0x00090080, - 0x03B, 0x0008F780, - 0x03B, 0x000722B0, - 0x03B, 0x0006F7B0, - 0x03B, 0x00054FB0, - 0x03B, 0x0004F060, - 0x03B, 0x00030090, - 0x03B, 0x00020080, - 0x03B, 0x00010080, - 0x03B, 0x0000F780, - 0x0EF, 0x000000A0, + 0x03B, 0x000F02B0, + 0x03B, 0x000EF7B0, + 0x03B, 0x000D4FB0, + 0x03B, 0x000CF060, + 0x03B, 0x000B0090, + 0x03B, 0x000A0080, + 0x03B, 0x00090080, + 0x03B, 0x0008F780, + 0x03B, 0x000722B0, + 0x03B, 0x0006F7B0, + 0x03B, 0x00054FB0, + 0x03B, 0x0004F060, + 0x03B, 0x00030090, + 0x03B, 0x00020080, + 0x03B, 0x00010080, + 0x03B, 0x0000F780, + 0x0EF, 0x000000A0, 0x98000001, 0x00000002, 0x40000000, 0x00000000, - 0x03B, 0x000F02B0, - 0x03B, 0x000EF7B0, - 0x03B, 0x000D4FB0, - 0x03B, 0x000CF060, - 0x03B, 0x000B0090, - 0x03B, 0x000A0080, - 0x03B, 0x00090080, - 0x03B, 0x0008F780, - 0x03B, 0x000722B0, - 0x03B, 0x0006F7B0, - 0x03B, 0x00054FB0, - 0x03B, 0x0004F060, - 0x03B, 0x00030090, - 0x03B, 0x00020080, - 0x03B, 0x00010080, - 0x03B, 0x0000F780, - 0x0EF, 0x000000A0, + 0x03B, 0x000F02B0, + 0x03B, 0x000EF7B0, + 0x03B, 0x000D4FB0, + 0x03B, 0x000CF060, + 0x03B, 0x000B0090, + 0x03B, 0x000A0080, + 0x03B, 0x00090080, + 0x03B, 0x0008F780, + 0x03B, 0x000722B0, + 0x03B, 0x0006F7B0, + 0x03B, 0x00054FB0, + 0x03B, 0x0004F060, + 0x03B, 0x00030090, + 0x03B, 0x00020080, + 0x03B, 0x00010080, + 0x03B, 0x0000F780, + 0x0EF, 0x000000A0, 0x98000400, 0x00000000, 0x40000000, 0x00000000, - 0x03B, 0x000F02B0, - 0x03B, 0x000EF7B0, - 0x03B, 0x000D4FB0, - 0x03B, 0x000CF060, - 0x03B, 0x000B0090, - 0x03B, 0x000A0080, - 0x03B, 0x00090080, - 0x03B, 0x0008F780, - 0x03B, 0x000722B0, - 0x03B, 0x0006F7B0, - 0x03B, 0x00054FB0, - 0x03B, 0x0004F060, - 0x03B, 0x00030090, - 0x03B, 0x00020080, - 0x03B, 0x00010080, - 0x03B, 0x0000F780, - 0x0EF, 0x000000A0, + 0x03B, 0x000F02B0, + 0x03B, 0x000EF7B0, + 0x03B, 0x000D4FB0, + 0x03B, 0x000CF060, + 0x03B, 0x000B0090, + 0x03B, 0x000A0080, + 0x03B, 0x00090080, + 0x03B, 0x0008F780, + 0x03B, 0x000722B0, + 0x03B, 0x0006F7B0, + 0x03B, 0x00054FB0, + 0x03B, 0x0004F060, + 0x03B, 0x00030090, + 0x03B, 0x00020080, + 0x03B, 0x00010080, + 0x03B, 0x0000F780, + 0x0EF, 0x000000A0, + 0x98000002, 0x00000000, 0x40000000, 0x00000000, + 0x03B, 0x000F02B0, + 0x03B, 0x000EF7B0, + 0x03B, 0x000D4FB0, + 0x03B, 0x000CF060, + 0x03B, 0x000B0090, + 0x03B, 0x000A0080, + 0x03B, 0x00090080, + 0x03B, 0x0008F780, + 0x03B, 0x000722B0, + 0x03B, 0x0006F7B0, + 0x03B, 0x00054FB0, + 0x03B, 0x0004F060, + 0x03B, 0x00030090, + 0x03B, 0x00020080, + 0x03B, 0x00010080, + 0x03B, 0x0000F780, + 0x0EF, 0x000000A0, 0x90000002, 0x00000000, 0x40000000, 0x00000000, - 0x03B, 0x000F02B0, - 0x03B, 0x000EF7B0, - 0x03B, 0x000D4FB0, - 0x03B, 0x000CF060, - 0x03B, 0x000B0090, - 0x03B, 0x000A0080, - 0x03B, 0x00090080, - 0x03B, 0x0008F780, - 0x03B, 0x000722B0, - 0x03B, 0x0006F7B0, - 0x03B, 0x00054FB0, - 0x03B, 0x0004F060, - 0x03B, 0x00030090, - 0x03B, 0x00020080, - 0x03B, 0x00010080, - 0x03B, 0x0000F780, - 0x0EF, 0x000000A0, + 0x03B, 0x000F02B0, + 0x03B, 0x000EF7B0, + 0x03B, 0x000D4FB0, + 0x03B, 0x000CF060, + 0x03B, 0x000B0090, + 0x03B, 0x000A0080, + 0x03B, 0x00090080, + 0x03B, 0x0008F780, + 0x03B, 0x000722B0, + 0x03B, 0x0006F7B0, + 0x03B, 0x00054FB0, + 0x03B, 0x0004F060, + 0x03B, 0x00030090, + 0x03B, 0x00020080, + 0x03B, 0x00010080, + 0x03B, 0x0000F780, + 0x0EF, 0x000000A0, 0x90000001, 0x00000000, 0x40000000, 0x00000000, - 0x03B, 0x000F02B0, - 0x03B, 0x000EF7B0, - 0x03B, 0x000D4FB0, - 0x03B, 0x000CF060, - 0x03B, 0x000B0090, - 0x03B, 0x000A0080, - 0x03B, 0x00090080, - 0x03B, 0x0008F780, - 0x03B, 0x000722B0, - 0x03B, 0x0006F7B0, - 0x03B, 0x00054FB0, - 0x03B, 0x0004F060, - 0x03B, 0x00030090, - 0x03B, 0x00020080, - 0x03B, 0x00010080, - 0x03B, 0x0000F780, - 0x0EF, 0x000000A0, + 0x03B, 0x000F02B0, + 0x03B, 0x000EF7B0, + 0x03B, 0x000D4FB0, + 0x03B, 0x000CF060, + 0x03B, 0x000B0090, + 0x03B, 0x000A0080, + 0x03B, 0x00090080, + 0x03B, 0x0008F780, + 0x03B, 0x000722B0, + 0x03B, 0x0006F7B0, + 0x03B, 0x00054FB0, + 0x03B, 0x0004F060, + 0x03B, 0x00030090, + 0x03B, 0x00020080, + 0x03B, 0x00010080, + 0x03B, 0x0000F780, + 0x0EF, 0x000000A0, 0x90000001, 0x00000001, 0x40000000, 0x00000000, - 0x03B, 0x000F02B0, - 0x03B, 0x000EF7B0, - 0x03B, 0x000D4FB0, - 0x03B, 0x000CF060, - 0x03B, 0x000B0090, - 0x03B, 0x000A0080, - 0x03B, 0x00090080, - 0x03B, 0x0008F780, - 0x03B, 0x000722B0, - 0x03B, 0x0006F7B0, - 0x03B, 0x00054FB0, - 0x03B, 0x0004F060, - 0x03B, 0x00030090, - 0x03B, 0x00020080, - 0x03B, 0x00010080, - 0x03B, 0x0000F780, - 0x0EF, 0x000000A0, + 0x03B, 0x000F02B0, + 0x03B, 0x000EF7B0, + 0x03B, 0x000D4FB0, + 0x03B, 0x000CF060, + 0x03B, 0x000B0090, + 0x03B, 0x000A0080, + 0x03B, 0x00090080, + 0x03B, 0x0008F780, + 0x03B, 0x000722B0, + 0x03B, 0x0006F7B0, + 0x03B, 0x00054FB0, + 0x03B, 0x0004F060, + 0x03B, 0x00030090, + 0x03B, 0x00020080, + 0x03B, 0x00010080, + 0x03B, 0x0000F780, + 0x0EF, 0x000000A0, 0x90000001, 0x00000002, 0x40000000, 0x00000000, - 0x03B, 0x000F07B0, - 0x03B, 0x000EF7B0, - 0x03B, 0x000D0020, - 0x03B, 0x000CF060, - 0x03B, 0x000B07E0, - 0x03B, 0x000A0010, - 0x03B, 0x00090000, - 0x03B, 0x0008F780, - 0x03B, 0x000727B0, - 0x03B, 0x0006F7B0, - 0x03B, 0x00054FB0, - 0x03B, 0x0004F060, - 0x03B, 0x00030090, - 0x03B, 0x00020080, - 0x03B, 0x00010080, - 0x03B, 0x0000F780, - 0x0EF, 0x000000A0, + 0x03B, 0x000F07B0, + 0x03B, 0x000EF7B0, + 0x03B, 0x000D0020, + 0x03B, 0x000CF060, + 0x03B, 0x000B07E0, + 0x03B, 0x000A0010, + 0x03B, 0x00090000, + 0x03B, 0x0008F780, + 0x03B, 0x000727B0, + 0x03B, 0x0006F7B0, + 0x03B, 0x00054FB0, + 0x03B, 0x0004F060, + 0x03B, 0x00030090, + 0x03B, 0x00020080, + 0x03B, 0x00010080, + 0x03B, 0x0000F780, + 0x0EF, 0x000000A0, 0x98000000, 0x00000000, 0x40000000, 0x00000000, - 0x03B, 0x000F6030, - 0x03B, 0x000E6030, - 0x03B, 0x000D6030, - 0x03B, 0x000C6030, - 0x03B, 0x000BF030, - 0x03B, 0x000A0020, - 0x03B, 0x00090090, - 0x03B, 0x0008F080, - 0x03B, 0x0007A730, - 0x03B, 0x000607B0, - 0x03B, 0x0005F770, - 0x03B, 0x00040060, - 0x03B, 0x00030090, - 0x03B, 0x00020780, - 0x03B, 0x000107A0, - 0x03B, 0x0000F760, - 0x0EF, 0x000000A0, + 0x03B, 0x000F6030, + 0x03B, 0x000E6030, + 0x03B, 0x000D6030, + 0x03B, 0x000C6030, + 0x03B, 0x000BF030, + 0x03B, 0x000A0020, + 0x03B, 0x00090090, + 0x03B, 0x0008F080, + 0x03B, 0x0007A730, + 0x03B, 0x000607B0, + 0x03B, 0x0005F770, + 0x03B, 0x00040060, + 0x03B, 0x00030090, + 0x03B, 0x00020780, + 0x03B, 0x000107A0, + 0x03B, 0x0000F760, + 0x0EF, 0x000000A0, 0x90000400, 0x00000000, 0x40000000, 0x00000000, - 0x03B, 0x000F02B0, - 0x03B, 0x000EF7B0, - 0x03B, 0x000D4FB0, - 0x03B, 0x000CF060, - 0x03B, 0x000B0090, - 0x03B, 0x000A0080, - 0x03B, 0x00090080, - 0x03B, 0x0008F780, - 0x03B, 0x000722B0, - 0x03B, 0x0006F7B0, - 0x03B, 0x00054FB0, - 0x03B, 0x0004F060, - 0x03B, 0x00030090, - 0x03B, 0x00020080, - 0x03B, 0x00010080, - 0x03B, 0x0000F780, - 0x0EF, 0x000000A0, + 0x03B, 0x000F02B0, + 0x03B, 0x000EF7B0, + 0x03B, 0x000D4FB0, + 0x03B, 0x000CF060, + 0x03B, 0x000B0090, + 0x03B, 0x000A0080, + 0x03B, 0x00090080, + 0x03B, 0x0008F780, + 0x03B, 0x000722B0, + 0x03B, 0x0006F7B0, + 0x03B, 0x00054FB0, + 0x03B, 0x0004F060, + 0x03B, 0x00030090, + 0x03B, 0x00020080, + 0x03B, 0x00010080, + 0x03B, 0x0000F780, + 0x0EF, 0x000000A0, 0xA0000000, 0x00000000, - 0x03B, 0x000F02B0, - 0x03B, 0x000EF7B0, - 0x03B, 0x000D4FB0, - 0x03B, 0x000CF060, - 0x03B, 0x000B0090, - 0x03B, 0x000A0080, - 0x03B, 0x00090080, - 0x03B, 0x0008F780, - 0x03B, 0x000722B0, - 0x03B, 0x0006F7B0, - 0x03B, 0x00054FB0, - 0x03B, 0x0004F060, - 0x03B, 0x00030090, - 0x03B, 0x00020080, - 0x03B, 0x00010080, - 0x03B, 0x0000F780, - 0x0EF, 0x000000A0, + 0x03B, 0x000F02B0, + 0x03B, 0x000EF7B0, + 0x03B, 0x000D4FB0, + 0x03B, 0x000CF060, + 0x03B, 0x000B0090, + 0x03B, 0x000A0080, + 0x03B, 0x00090080, + 0x03B, 0x0008F780, + 0x03B, 0x000722B0, + 0x03B, 0x0006F7B0, + 0x03B, 0x00054FB0, + 0x03B, 0x0004F060, + 0x03B, 0x00030090, + 0x03B, 0x00020080, + 0x03B, 0x00010080, + 0x03B, 0x0000F780, + 0x0EF, 0x000000A0, 0xB0000000, 0x00000000, - 0x000, 0x00010159, - 0x018, 0x0000F407, - 0xFFE, 0x00000000, - 0xFFE, 0x00000000, - 0x01F, 0x00080003, - 0xFFE, 0x00000000, - 0xFFE, 0x00000000, - 0x01E, 0x00000001, - 0x01F, 0x00080000, - 0x000, 0x00033E60, + 0x000, 0x00010159, + 0x018, 0x0000F407, + 0xFFE, 0x00000000, + 0xFFE, 0x00000000, + 0x01F, 0x00080003, + 0xFFE, 0x00000000, + 0xFFE, 0x00000000, + 0x01E, 0x00000001, + 0x01F, 0x00080000, + 0x000, 0x00033E60, }; void -odm_read_and_config_mp_8188e_radioa( - struct PHY_DM_STRUCT *p_dm_odm -) +odm_read_and_config_mp_8188e_radioa(struct dm_struct *dm) { - u32 i = 0; - u8 c_cond; - bool is_matched = true, is_skipped = false; - u32 array_len = sizeof(array_mp_8188e_radioa) / sizeof(u32); - u32 *array = array_mp_8188e_radioa; + u32 i = 0; + u8 c_cond; + boolean is_matched = true, is_skipped = false; + u32 array_len = sizeof(array_mp_8188e_radioa) / sizeof(u32); + u32 *array = array_mp_8188e_radioa; u32 v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> odm_read_and_config_mp_8188e_radioa\n")); + PHYDM_DBG(dm, ODM_COMP_INIT, "===> %s\n", __func__); while ((i + 1) < array_len) { v1 = array[i]; v2 = array[i + 1]; - if (v1 & (BIT(31) | BIT30)) {/*positive & negative condition*/ + 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; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ENDIF\n")); + PHYDM_DBG(dm, ODM_COMP_INIT, "ENDIF\n"); } else if (c_cond == COND_ELSE) { /*else*/ is_matched = is_skipped ? false : true; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ELSE\n")); + PHYDM_DBG(dm, ODM_COMP_INIT, "ELSE\n"); } else {/*if , else if*/ pre_v1 = v1; pre_v2 = v2; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("IF or ELSE IF\n")); + PHYDM_DBG(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_odm, pre_v1, pre_v2, v1, v2)) { + if (check_positive(dm, pre_v1, pre_v2, v1, v2)) { is_matched = true; is_skipped = true; } else { @@ -710,7 +744,7 @@ odm_read_and_config_mp_8188e_radioa( } } else { if (is_matched) - odm_config_rf_radio_a_8188e(p_dm_odm, v1, v2); + odm_config_rf_radio_a_8188e(dm, v1, v2); } i = i + 2; } @@ -719,11 +753,11 @@ odm_read_and_config_mp_8188e_radioa( u32 odm_get_version_mp_8188e_radioa(void) { - return 70; + return 71; } /****************************************************************************** -* TxPowerTrack_AP.TXT +* txpowertrack_ap.TXT ******************************************************************************/ #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) @@ -758,35 +792,33 @@ u8 g_delta_swing_table_idx_mp_2g_cck_a_p_txpowertrack_ap_8188e[] = {0, 0, 1, 1, #endif void -odm_read_and_config_mp_8188e_txpowertrack_ap( - struct PHY_DM_STRUCT *p_dm_odm -) +odm_read_and_config_mp_8188e_txpowertrack_ap(struct dm_struct *dm) { #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm_odm->rf_calibrate_info); + struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_MP_8188E\n")); + PHYDM_DBG(dm, ODM_COMP_INIT, "===> ODM_ReadAndConfig_MP_mp_8188e\n"); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2ga_p, g_delta_swing_table_idx_mp_2ga_p_txpowertrack_ap_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2ga_n, g_delta_swing_table_idx_mp_2ga_n_txpowertrack_ap_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2gb_p, g_delta_swing_table_idx_mp_2gb_p_txpowertrack_ap_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2gb_n, g_delta_swing_table_idx_mp_2gb_n_txpowertrack_ap_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2ga_p, g_delta_swing_table_idx_mp_2ga_p_txpowertrack_ap_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2ga_n, g_delta_swing_table_idx_mp_2ga_n_txpowertrack_ap_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2gb_p, g_delta_swing_table_idx_mp_2gb_p_txpowertrack_ap_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2gb_n, g_delta_swing_table_idx_mp_2gb_n_txpowertrack_ap_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_a_p, g_delta_swing_table_idx_mp_2g_cck_a_p_txpowertrack_ap_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_a_n, g_delta_swing_table_idx_mp_2g_cck_a_n_txpowertrack_ap_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_b_p, g_delta_swing_table_idx_mp_2g_cck_b_p_txpowertrack_ap_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_b_n, g_delta_swing_table_idx_mp_2g_cck_b_n_txpowertrack_ap_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_a_p, g_delta_swing_table_idx_mp_2g_cck_a_p_txpowertrack_ap_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_a_n, g_delta_swing_table_idx_mp_2g_cck_a_n_txpowertrack_ap_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_b_p, g_delta_swing_table_idx_mp_2g_cck_b_p_txpowertrack_ap_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_b_n, g_delta_swing_table_idx_mp_2g_cck_b_n_txpowertrack_ap_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_5ga_p, g_delta_swing_table_idx_mp_5ga_p_txpowertrack_ap_8188e, DELTA_SWINGIDX_SIZE * 3); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_5ga_n, g_delta_swing_table_idx_mp_5ga_n_txpowertrack_ap_8188e, DELTA_SWINGIDX_SIZE * 3); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_5gb_p, g_delta_swing_table_idx_mp_5gb_p_txpowertrack_ap_8188e, DELTA_SWINGIDX_SIZE * 3); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_5gb_n, g_delta_swing_table_idx_mp_5gb_n_txpowertrack_ap_8188e, DELTA_SWINGIDX_SIZE * 3); + odm_move_memory(dm, cali_info->delta_swing_table_idx_5ga_p, g_delta_swing_table_idx_mp_5ga_p_txpowertrack_ap_8188e, DELTA_SWINGIDX_SIZE * 3); + odm_move_memory(dm, cali_info->delta_swing_table_idx_5ga_n, g_delta_swing_table_idx_mp_5ga_n_txpowertrack_ap_8188e, DELTA_SWINGIDX_SIZE * 3); + odm_move_memory(dm, cali_info->delta_swing_table_idx_5gb_p, g_delta_swing_table_idx_mp_5gb_p_txpowertrack_ap_8188e, DELTA_SWINGIDX_SIZE * 3); + odm_move_memory(dm, cali_info->delta_swing_table_idx_5gb_n, g_delta_swing_table_idx_mp_5gb_n_txpowertrack_ap_8188e, DELTA_SWINGIDX_SIZE * 3); #endif } /****************************************************************************** -* TxPowerTrack_PCIE.TXT +* txpowertrack_pcie.TXT ******************************************************************************/ #if DEV_BUS_TYPE == RT_PCI_INTERFACE @@ -821,35 +853,33 @@ u8 g_delta_swing_table_idx_mp_2g_cck_a_p_txpowertrack_pcie_8188e[] = {0, 0, 0, 0 #endif void -odm_read_and_config_mp_8188e_txpowertrack_pcie( - struct PHY_DM_STRUCT *p_dm_odm -) +odm_read_and_config_mp_8188e_txpowertrack_pcie(struct dm_struct *dm) { #if DEV_BUS_TYPE == RT_PCI_INTERFACE - struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm_odm->rf_calibrate_info); + struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_MP_8188E\n")); + PHYDM_DBG(dm, ODM_COMP_INIT, "===> ODM_ReadAndConfig_MP_mp_8188e\n"); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2ga_p, g_delta_swing_table_idx_mp_2ga_p_txpowertrack_pcie_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2ga_n, g_delta_swing_table_idx_mp_2ga_n_txpowertrack_pcie_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2gb_p, g_delta_swing_table_idx_mp_2gb_p_txpowertrack_pcie_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2gb_n, g_delta_swing_table_idx_mp_2gb_n_txpowertrack_pcie_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2ga_p, g_delta_swing_table_idx_mp_2ga_p_txpowertrack_pcie_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2ga_n, g_delta_swing_table_idx_mp_2ga_n_txpowertrack_pcie_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2gb_p, g_delta_swing_table_idx_mp_2gb_p_txpowertrack_pcie_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2gb_n, g_delta_swing_table_idx_mp_2gb_n_txpowertrack_pcie_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_a_p, g_delta_swing_table_idx_mp_2g_cck_a_p_txpowertrack_pcie_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_a_n, g_delta_swing_table_idx_mp_2g_cck_a_n_txpowertrack_pcie_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_b_p, g_delta_swing_table_idx_mp_2g_cck_b_p_txpowertrack_pcie_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_b_n, g_delta_swing_table_idx_mp_2g_cck_b_n_txpowertrack_pcie_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_a_p, g_delta_swing_table_idx_mp_2g_cck_a_p_txpowertrack_pcie_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_a_n, g_delta_swing_table_idx_mp_2g_cck_a_n_txpowertrack_pcie_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_b_p, g_delta_swing_table_idx_mp_2g_cck_b_p_txpowertrack_pcie_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_b_n, g_delta_swing_table_idx_mp_2g_cck_b_n_txpowertrack_pcie_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_5ga_p, g_delta_swing_table_idx_mp_5ga_p_txpowertrack_pcie_8188e, DELTA_SWINGIDX_SIZE * 3); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_5ga_n, g_delta_swing_table_idx_mp_5ga_n_txpowertrack_pcie_8188e, DELTA_SWINGIDX_SIZE * 3); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_5gb_p, g_delta_swing_table_idx_mp_5gb_p_txpowertrack_pcie_8188e, DELTA_SWINGIDX_SIZE * 3); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_5gb_n, g_delta_swing_table_idx_mp_5gb_n_txpowertrack_pcie_8188e, DELTA_SWINGIDX_SIZE * 3); + odm_move_memory(dm, cali_info->delta_swing_table_idx_5ga_p, g_delta_swing_table_idx_mp_5ga_p_txpowertrack_pcie_8188e, DELTA_SWINGIDX_SIZE * 3); + odm_move_memory(dm, cali_info->delta_swing_table_idx_5ga_n, g_delta_swing_table_idx_mp_5ga_n_txpowertrack_pcie_8188e, DELTA_SWINGIDX_SIZE * 3); + odm_move_memory(dm, cali_info->delta_swing_table_idx_5gb_p, g_delta_swing_table_idx_mp_5gb_p_txpowertrack_pcie_8188e, DELTA_SWINGIDX_SIZE * 3); + odm_move_memory(dm, cali_info->delta_swing_table_idx_5gb_n, g_delta_swing_table_idx_mp_5gb_n_txpowertrack_pcie_8188e, DELTA_SWINGIDX_SIZE * 3); #endif } /****************************************************************************** -* TxPowerTrack_PCIE_ICUT.TXT +* txpowertrack_pcie_icut.TXT ******************************************************************************/ u8 g_delta_swing_table_idx_mp_5gb_n_txpowertrack_pcie_icut_8188e[][DELTA_SWINGIDX_SIZE] = { @@ -882,33 +912,31 @@ u8 g_delta_swing_table_idx_mp_2g_cck_a_n_txpowertrack_pcie_icut_8188e[] = {0, 1, u8 g_delta_swing_table_idx_mp_2g_cck_a_p_txpowertrack_pcie_icut_8188e[] = {0, 0, 0, 1, 1, 1, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 8, 8, 8, 9, 9, 10, 10, 11, 12, 12, 12, 12}; void -odm_read_and_config_mp_8188e_txpowertrack_pcie_icut( - struct PHY_DM_STRUCT *p_dm_odm -) +odm_read_and_config_mp_8188e_txpowertrack_pcie_icut(struct dm_struct *dm) { - struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm_odm->rf_calibrate_info); + struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_MP_8188E\n")); + PHYDM_DBG(dm, ODM_COMP_INIT, "===> ODM_ReadAndConfig_MP_mp_8188e\n"); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2ga_p, g_delta_swing_table_idx_mp_2ga_p_txpowertrack_pcie_icut_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2ga_n, g_delta_swing_table_idx_mp_2ga_n_txpowertrack_pcie_icut_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2gb_p, g_delta_swing_table_idx_mp_2gb_p_txpowertrack_pcie_icut_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2gb_n, g_delta_swing_table_idx_mp_2gb_n_txpowertrack_pcie_icut_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2ga_p, g_delta_swing_table_idx_mp_2ga_p_txpowertrack_pcie_icut_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2ga_n, g_delta_swing_table_idx_mp_2ga_n_txpowertrack_pcie_icut_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2gb_p, g_delta_swing_table_idx_mp_2gb_p_txpowertrack_pcie_icut_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2gb_n, g_delta_swing_table_idx_mp_2gb_n_txpowertrack_pcie_icut_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_a_p, g_delta_swing_table_idx_mp_2g_cck_a_p_txpowertrack_pcie_icut_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_a_n, g_delta_swing_table_idx_mp_2g_cck_a_n_txpowertrack_pcie_icut_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_b_p, g_delta_swing_table_idx_mp_2g_cck_b_p_txpowertrack_pcie_icut_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_b_n, g_delta_swing_table_idx_mp_2g_cck_b_n_txpowertrack_pcie_icut_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_a_p, g_delta_swing_table_idx_mp_2g_cck_a_p_txpowertrack_pcie_icut_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_a_n, g_delta_swing_table_idx_mp_2g_cck_a_n_txpowertrack_pcie_icut_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_b_p, g_delta_swing_table_idx_mp_2g_cck_b_p_txpowertrack_pcie_icut_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_b_n, g_delta_swing_table_idx_mp_2g_cck_b_n_txpowertrack_pcie_icut_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_5ga_p, g_delta_swing_table_idx_mp_5ga_p_txpowertrack_pcie_icut_8188e, DELTA_SWINGIDX_SIZE * 3); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_5ga_n, g_delta_swing_table_idx_mp_5ga_n_txpowertrack_pcie_icut_8188e, DELTA_SWINGIDX_SIZE * 3); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_5gb_p, g_delta_swing_table_idx_mp_5gb_p_txpowertrack_pcie_icut_8188e, DELTA_SWINGIDX_SIZE * 3); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_5gb_n, g_delta_swing_table_idx_mp_5gb_n_txpowertrack_pcie_icut_8188e, DELTA_SWINGIDX_SIZE * 3); + odm_move_memory(dm, cali_info->delta_swing_table_idx_5ga_p, g_delta_swing_table_idx_mp_5ga_p_txpowertrack_pcie_icut_8188e, DELTA_SWINGIDX_SIZE * 3); + odm_move_memory(dm, cali_info->delta_swing_table_idx_5ga_n, g_delta_swing_table_idx_mp_5ga_n_txpowertrack_pcie_icut_8188e, DELTA_SWINGIDX_SIZE * 3); + odm_move_memory(dm, cali_info->delta_swing_table_idx_5gb_p, g_delta_swing_table_idx_mp_5gb_p_txpowertrack_pcie_icut_8188e, DELTA_SWINGIDX_SIZE * 3); + odm_move_memory(dm, cali_info->delta_swing_table_idx_5gb_n, g_delta_swing_table_idx_mp_5gb_n_txpowertrack_pcie_icut_8188e, DELTA_SWINGIDX_SIZE * 3); } /****************************************************************************** -* TxPowerTrack_SDIO.TXT +* txpowertrack_sdio.TXT ******************************************************************************/ #if DEV_BUS_TYPE == RT_SDIO_INTERFACE @@ -943,35 +971,33 @@ u8 g_delta_swing_table_idx_mp_2g_cck_a_p_txpowertrack_sdio_8188e[] = {0, 0, 0, 0 #endif void -odm_read_and_config_mp_8188e_txpowertrack_sdio( - struct PHY_DM_STRUCT *p_dm_odm -) +odm_read_and_config_mp_8188e_txpowertrack_sdio(struct dm_struct *dm) { #if DEV_BUS_TYPE == RT_SDIO_INTERFACE - struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm_odm->rf_calibrate_info); + struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_MP_8188E\n")); + PHYDM_DBG(dm, ODM_COMP_INIT, "===> ODM_ReadAndConfig_MP_mp_8188e\n"); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2ga_p, g_delta_swing_table_idx_mp_2ga_p_txpowertrack_sdio_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2ga_n, g_delta_swing_table_idx_mp_2ga_n_txpowertrack_sdio_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2gb_p, g_delta_swing_table_idx_mp_2gb_p_txpowertrack_sdio_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2gb_n, g_delta_swing_table_idx_mp_2gb_n_txpowertrack_sdio_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2ga_p, g_delta_swing_table_idx_mp_2ga_p_txpowertrack_sdio_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2ga_n, g_delta_swing_table_idx_mp_2ga_n_txpowertrack_sdio_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2gb_p, g_delta_swing_table_idx_mp_2gb_p_txpowertrack_sdio_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2gb_n, g_delta_swing_table_idx_mp_2gb_n_txpowertrack_sdio_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_a_p, g_delta_swing_table_idx_mp_2g_cck_a_p_txpowertrack_sdio_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_a_n, g_delta_swing_table_idx_mp_2g_cck_a_n_txpowertrack_sdio_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_b_p, g_delta_swing_table_idx_mp_2g_cck_b_p_txpowertrack_sdio_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_b_n, g_delta_swing_table_idx_mp_2g_cck_b_n_txpowertrack_sdio_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_a_p, g_delta_swing_table_idx_mp_2g_cck_a_p_txpowertrack_sdio_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_a_n, g_delta_swing_table_idx_mp_2g_cck_a_n_txpowertrack_sdio_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_b_p, g_delta_swing_table_idx_mp_2g_cck_b_p_txpowertrack_sdio_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_b_n, g_delta_swing_table_idx_mp_2g_cck_b_n_txpowertrack_sdio_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_5ga_p, g_delta_swing_table_idx_mp_5ga_p_txpowertrack_sdio_8188e, DELTA_SWINGIDX_SIZE * 3); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_5ga_n, g_delta_swing_table_idx_mp_5ga_n_txpowertrack_sdio_8188e, DELTA_SWINGIDX_SIZE * 3); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_5gb_p, g_delta_swing_table_idx_mp_5gb_p_txpowertrack_sdio_8188e, DELTA_SWINGIDX_SIZE * 3); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_5gb_n, g_delta_swing_table_idx_mp_5gb_n_txpowertrack_sdio_8188e, DELTA_SWINGIDX_SIZE * 3); + odm_move_memory(dm, cali_info->delta_swing_table_idx_5ga_p, g_delta_swing_table_idx_mp_5ga_p_txpowertrack_sdio_8188e, DELTA_SWINGIDX_SIZE * 3); + odm_move_memory(dm, cali_info->delta_swing_table_idx_5ga_n, g_delta_swing_table_idx_mp_5ga_n_txpowertrack_sdio_8188e, DELTA_SWINGIDX_SIZE * 3); + odm_move_memory(dm, cali_info->delta_swing_table_idx_5gb_p, g_delta_swing_table_idx_mp_5gb_p_txpowertrack_sdio_8188e, DELTA_SWINGIDX_SIZE * 3); + odm_move_memory(dm, cali_info->delta_swing_table_idx_5gb_n, g_delta_swing_table_idx_mp_5gb_n_txpowertrack_sdio_8188e, DELTA_SWINGIDX_SIZE * 3); #endif } /****************************************************************************** -* TxPowerTrack_SDIO_ICUT.TXT +* txpowertrack_sdio_icut.TXT ******************************************************************************/ u8 g_delta_swing_table_idx_mp_5gb_n_txpowertrack_sdio_icut_8188e[][DELTA_SWINGIDX_SIZE] = { @@ -1004,33 +1030,31 @@ u8 g_delta_swing_table_idx_mp_2g_cck_a_n_txpowertrack_sdio_icut_8188e[] = {0, 1, u8 g_delta_swing_table_idx_mp_2g_cck_a_p_txpowertrack_sdio_icut_8188e[] = {0, 0, 0, 1, 1, 1, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 8, 8, 8, 9, 9, 10, 10, 11, 12, 12, 12, 12}; void -odm_read_and_config_mp_8188e_txpowertrack_sdio_icut( - struct PHY_DM_STRUCT *p_dm_odm -) +odm_read_and_config_mp_8188e_txpowertrack_sdio_icut(struct dm_struct *dm) { - struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm_odm->rf_calibrate_info); + struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_MP_8188E\n")); + PHYDM_DBG(dm, ODM_COMP_INIT, "===> ODM_ReadAndConfig_MP_mp_8188e\n"); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2ga_p, g_delta_swing_table_idx_mp_2ga_p_txpowertrack_sdio_icut_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2ga_n, g_delta_swing_table_idx_mp_2ga_n_txpowertrack_sdio_icut_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2gb_p, g_delta_swing_table_idx_mp_2gb_p_txpowertrack_sdio_icut_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2gb_n, g_delta_swing_table_idx_mp_2gb_n_txpowertrack_sdio_icut_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2ga_p, g_delta_swing_table_idx_mp_2ga_p_txpowertrack_sdio_icut_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2ga_n, g_delta_swing_table_idx_mp_2ga_n_txpowertrack_sdio_icut_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2gb_p, g_delta_swing_table_idx_mp_2gb_p_txpowertrack_sdio_icut_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2gb_n, g_delta_swing_table_idx_mp_2gb_n_txpowertrack_sdio_icut_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_a_p, g_delta_swing_table_idx_mp_2g_cck_a_p_txpowertrack_sdio_icut_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_a_n, g_delta_swing_table_idx_mp_2g_cck_a_n_txpowertrack_sdio_icut_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_b_p, g_delta_swing_table_idx_mp_2g_cck_b_p_txpowertrack_sdio_icut_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_b_n, g_delta_swing_table_idx_mp_2g_cck_b_n_txpowertrack_sdio_icut_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_a_p, g_delta_swing_table_idx_mp_2g_cck_a_p_txpowertrack_sdio_icut_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_a_n, g_delta_swing_table_idx_mp_2g_cck_a_n_txpowertrack_sdio_icut_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_b_p, g_delta_swing_table_idx_mp_2g_cck_b_p_txpowertrack_sdio_icut_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_b_n, g_delta_swing_table_idx_mp_2g_cck_b_n_txpowertrack_sdio_icut_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_5ga_p, g_delta_swing_table_idx_mp_5ga_p_txpowertrack_sdio_icut_8188e, DELTA_SWINGIDX_SIZE * 3); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_5ga_n, g_delta_swing_table_idx_mp_5ga_n_txpowertrack_sdio_icut_8188e, DELTA_SWINGIDX_SIZE * 3); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_5gb_p, g_delta_swing_table_idx_mp_5gb_p_txpowertrack_sdio_icut_8188e, DELTA_SWINGIDX_SIZE * 3); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_5gb_n, g_delta_swing_table_idx_mp_5gb_n_txpowertrack_sdio_icut_8188e, DELTA_SWINGIDX_SIZE * 3); + odm_move_memory(dm, cali_info->delta_swing_table_idx_5ga_p, g_delta_swing_table_idx_mp_5ga_p_txpowertrack_sdio_icut_8188e, DELTA_SWINGIDX_SIZE * 3); + odm_move_memory(dm, cali_info->delta_swing_table_idx_5ga_n, g_delta_swing_table_idx_mp_5ga_n_txpowertrack_sdio_icut_8188e, DELTA_SWINGIDX_SIZE * 3); + odm_move_memory(dm, cali_info->delta_swing_table_idx_5gb_p, g_delta_swing_table_idx_mp_5gb_p_txpowertrack_sdio_icut_8188e, DELTA_SWINGIDX_SIZE * 3); + odm_move_memory(dm, cali_info->delta_swing_table_idx_5gb_n, g_delta_swing_table_idx_mp_5gb_n_txpowertrack_sdio_icut_8188e, DELTA_SWINGIDX_SIZE * 3); } /****************************************************************************** -* TxPowerTrack_USB.TXT +* txpowertrack_usb.TXT ******************************************************************************/ #if DEV_BUS_TYPE == RT_USB_INTERFACE @@ -1065,35 +1089,33 @@ u8 g_delta_swing_table_idx_mp_2g_cck_a_p_txpowertrack_usb_8188e[] = {0, 0, 0, 0, #endif void -odm_read_and_config_mp_8188e_txpowertrack_usb( - struct PHY_DM_STRUCT *p_dm_odm -) +odm_read_and_config_mp_8188e_txpowertrack_usb(struct dm_struct *dm) { #if DEV_BUS_TYPE == RT_USB_INTERFACE - struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm_odm->rf_calibrate_info); + struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_MP_8188E\n")); + PHYDM_DBG(dm, ODM_COMP_INIT, "===> ODM_ReadAndConfig_MP_mp_8188e\n"); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2ga_p, g_delta_swing_table_idx_mp_2ga_p_txpowertrack_usb_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2ga_n, g_delta_swing_table_idx_mp_2ga_n_txpowertrack_usb_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2gb_p, g_delta_swing_table_idx_mp_2gb_p_txpowertrack_usb_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2gb_n, g_delta_swing_table_idx_mp_2gb_n_txpowertrack_usb_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2ga_p, g_delta_swing_table_idx_mp_2ga_p_txpowertrack_usb_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2ga_n, g_delta_swing_table_idx_mp_2ga_n_txpowertrack_usb_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2gb_p, g_delta_swing_table_idx_mp_2gb_p_txpowertrack_usb_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2gb_n, g_delta_swing_table_idx_mp_2gb_n_txpowertrack_usb_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_a_p, g_delta_swing_table_idx_mp_2g_cck_a_p_txpowertrack_usb_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_a_n, g_delta_swing_table_idx_mp_2g_cck_a_n_txpowertrack_usb_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_b_p, g_delta_swing_table_idx_mp_2g_cck_b_p_txpowertrack_usb_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_b_n, g_delta_swing_table_idx_mp_2g_cck_b_n_txpowertrack_usb_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_a_p, g_delta_swing_table_idx_mp_2g_cck_a_p_txpowertrack_usb_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_a_n, g_delta_swing_table_idx_mp_2g_cck_a_n_txpowertrack_usb_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_b_p, g_delta_swing_table_idx_mp_2g_cck_b_p_txpowertrack_usb_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_b_n, g_delta_swing_table_idx_mp_2g_cck_b_n_txpowertrack_usb_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_5ga_p, g_delta_swing_table_idx_mp_5ga_p_txpowertrack_usb_8188e, DELTA_SWINGIDX_SIZE * 3); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_5ga_n, g_delta_swing_table_idx_mp_5ga_n_txpowertrack_usb_8188e, DELTA_SWINGIDX_SIZE * 3); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_5gb_p, g_delta_swing_table_idx_mp_5gb_p_txpowertrack_usb_8188e, DELTA_SWINGIDX_SIZE * 3); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_5gb_n, g_delta_swing_table_idx_mp_5gb_n_txpowertrack_usb_8188e, DELTA_SWINGIDX_SIZE * 3); + odm_move_memory(dm, cali_info->delta_swing_table_idx_5ga_p, g_delta_swing_table_idx_mp_5ga_p_txpowertrack_usb_8188e, DELTA_SWINGIDX_SIZE * 3); + odm_move_memory(dm, cali_info->delta_swing_table_idx_5ga_n, g_delta_swing_table_idx_mp_5ga_n_txpowertrack_usb_8188e, DELTA_SWINGIDX_SIZE * 3); + odm_move_memory(dm, cali_info->delta_swing_table_idx_5gb_p, g_delta_swing_table_idx_mp_5gb_p_txpowertrack_usb_8188e, DELTA_SWINGIDX_SIZE * 3); + odm_move_memory(dm, cali_info->delta_swing_table_idx_5gb_n, g_delta_swing_table_idx_mp_5gb_n_txpowertrack_usb_8188e, DELTA_SWINGIDX_SIZE * 3); #endif } /****************************************************************************** -* TxPowerTrack_USB_ICUT.TXT +* txpowertrack_usb_icut.TXT ******************************************************************************/ u8 g_delta_swing_table_idx_mp_5gb_n_txpowertrack_usb_icut_8188e[][DELTA_SWINGIDX_SIZE] = { @@ -1126,33 +1148,31 @@ u8 g_delta_swing_table_idx_mp_2g_cck_a_n_txpowertrack_usb_icut_8188e[] = {0, 1, u8 g_delta_swing_table_idx_mp_2g_cck_a_p_txpowertrack_usb_icut_8188e[] = {0, 0, 0, 1, 1, 1, 2, 3, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 8, 8, 8, 9, 9, 10, 10, 11, 12, 12, 12, 12}; void -odm_read_and_config_mp_8188e_txpowertrack_usb_icut( - struct PHY_DM_STRUCT *p_dm_odm -) +odm_read_and_config_mp_8188e_txpowertrack_usb_icut(struct dm_struct *dm) { - struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm_odm->rf_calibrate_info); + struct dm_rf_calibration_struct *cali_info = &(dm->rf_calibrate_info); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_MP_8188E\n")); + PHYDM_DBG(dm, ODM_COMP_INIT, "===> ODM_ReadAndConfig_MP_mp_8188e\n"); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2ga_p, g_delta_swing_table_idx_mp_2ga_p_txpowertrack_usb_icut_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2ga_n, g_delta_swing_table_idx_mp_2ga_n_txpowertrack_usb_icut_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2gb_p, g_delta_swing_table_idx_mp_2gb_p_txpowertrack_usb_icut_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2gb_n, g_delta_swing_table_idx_mp_2gb_n_txpowertrack_usb_icut_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2ga_p, g_delta_swing_table_idx_mp_2ga_p_txpowertrack_usb_icut_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2ga_n, g_delta_swing_table_idx_mp_2ga_n_txpowertrack_usb_icut_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2gb_p, g_delta_swing_table_idx_mp_2gb_p_txpowertrack_usb_icut_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2gb_n, g_delta_swing_table_idx_mp_2gb_n_txpowertrack_usb_icut_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_a_p, g_delta_swing_table_idx_mp_2g_cck_a_p_txpowertrack_usb_icut_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_a_n, g_delta_swing_table_idx_mp_2g_cck_a_n_txpowertrack_usb_icut_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_b_p, g_delta_swing_table_idx_mp_2g_cck_b_p_txpowertrack_usb_icut_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_b_n, g_delta_swing_table_idx_mp_2g_cck_b_n_txpowertrack_usb_icut_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_a_p, g_delta_swing_table_idx_mp_2g_cck_a_p_txpowertrack_usb_icut_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_a_n, g_delta_swing_table_idx_mp_2g_cck_a_n_txpowertrack_usb_icut_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_b_p, g_delta_swing_table_idx_mp_2g_cck_b_p_txpowertrack_usb_icut_8188e, DELTA_SWINGIDX_SIZE); + odm_move_memory(dm, cali_info->delta_swing_table_idx_2g_cck_b_n, g_delta_swing_table_idx_mp_2g_cck_b_n_txpowertrack_usb_icut_8188e, DELTA_SWINGIDX_SIZE); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_5ga_p, g_delta_swing_table_idx_mp_5ga_p_txpowertrack_usb_icut_8188e, DELTA_SWINGIDX_SIZE * 3); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_5ga_n, g_delta_swing_table_idx_mp_5ga_n_txpowertrack_usb_icut_8188e, DELTA_SWINGIDX_SIZE * 3); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_5gb_p, g_delta_swing_table_idx_mp_5gb_p_txpowertrack_usb_icut_8188e, DELTA_SWINGIDX_SIZE * 3); - odm_move_memory(p_dm_odm, p_rf_calibrate_info->delta_swing_table_idx_5gb_n, g_delta_swing_table_idx_mp_5gb_n_txpowertrack_usb_icut_8188e, DELTA_SWINGIDX_SIZE * 3); + odm_move_memory(dm, cali_info->delta_swing_table_idx_5ga_p, g_delta_swing_table_idx_mp_5ga_p_txpowertrack_usb_icut_8188e, DELTA_SWINGIDX_SIZE * 3); + odm_move_memory(dm, cali_info->delta_swing_table_idx_5ga_n, g_delta_swing_table_idx_mp_5ga_n_txpowertrack_usb_icut_8188e, DELTA_SWINGIDX_SIZE * 3); + odm_move_memory(dm, cali_info->delta_swing_table_idx_5gb_p, g_delta_swing_table_idx_mp_5gb_p_txpowertrack_usb_icut_8188e, DELTA_SWINGIDX_SIZE * 3); + odm_move_memory(dm, cali_info->delta_swing_table_idx_5gb_n, g_delta_swing_table_idx_mp_5gb_n_txpowertrack_usb_icut_8188e, DELTA_SWINGIDX_SIZE * 3); } /****************************************************************************** -* TXPWR_LMT.TXT +* txpwr_lmt.TXT ******************************************************************************/ const char *array_mp_8188e_txpwr_lmt[] = { @@ -1723,44 +1743,56 @@ const char *array_mp_8188e_txpwr_lmt[] = { }; void -odm_read_and_config_mp_8188e_txpwr_lmt( - struct PHY_DM_STRUCT *p_dm_odm -) +odm_read_and_config_mp_8188e_txpwr_lmt(struct dm_struct *dm) { - u32 i = 0; - u32 array_len = sizeof(array_mp_8188e_txpwr_lmt) / sizeof(u8 *); - u8 **array = (u8 **)array_mp_8188e_txpwr_lmt; - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _ADAPTER *adapter = p_dm_odm->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; + u32 i = 0; +#if (DM_ODM_SUPPORT_TYPE == ODM_IOT) + u32 array_len = sizeof(array_mp_8188e_txpwr_lmt) / sizeof(u8); + u8 *array = (u8 *)array_mp_8188e_txpwr_lmt; +#else + u32 array_len = sizeof(array_mp_8188e_txpwr_lmt) / sizeof(u8 *); + u8 **array = (u8 **)array_mp_8188e_txpwr_lmt; #endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> odm_read_and_config_mp_8188e_txpwr_lmt\n")); +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + void *adapter = dm->adapter; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + + PlatformZeroMemory(hal_data->BufOfLinesPwrLmt, MAX_LINES_HWCONFIG_TXT * MAX_BYTES_LINE_HWCONFIG_TXT); + hal_data->nLinesReadPwrLmt = array_len / 7; +#endif + + PHYDM_DBG(dm, ODM_COMP_INIT, "===> %s\n", __func__); for (i = 0; i < array_len; i += 7) { - 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]; +#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_8188e(p_dm_odm, regulation, band, bandwidth, rate, rf_path, chnl, val); + odm_config_bb_txpwr_lmt_8188e(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); + rsprintf((char *)hal_data->BufOfLinesPwrLmt[i / 7], 100, "\"%s\", \"%s\", \"%s\", \"%s\", \"%s\", \"%s\", \"%s\",", + regulation, band, bandwidth, rate, rf_path, chnl, val); #endif } - } /****************************************************************************** -* TXPWR_LMT_88EE_M2_for_MSI.TXT +* txpwr_lmt_88ee_m2_for_msi.TXT ******************************************************************************/ const char *array_mp_8188e_txpwr_lmt_88ee_m2_for_msi[] = { @@ -2331,40 +2363,53 @@ const char *array_mp_8188e_txpwr_lmt_88ee_m2_for_msi[] = { }; void -odm_read_and_config_mp_8188e_txpwr_lmt_88e_e_m2_for_msi( - struct PHY_DM_STRUCT *p_dm_odm -) +odm_read_and_config_mp_8188e_txpwr_lmt_88ee_m2_for_msi(struct dm_struct *dm) { - u32 i = 0; - u32 array_len = sizeof(array_mp_8188e_txpwr_lmt_88ee_m2_for_msi) / sizeof(u8 *); - u8 **array = (u8 **)array_mp_8188e_txpwr_lmt_88ee_m2_for_msi; - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _ADAPTER *adapter = p_dm_odm->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; + u32 i = 0; +#if (DM_ODM_SUPPORT_TYPE == ODM_IOT) + u32 array_len = sizeof(array_mp_8188e_txpwr_lmt_88ee_m2_for_msi) / sizeof(u8); + u8 *array = (u8 *)array_mp_8188e_txpwr_lmt_88ee_m2_for_msi; +#else + u32 array_len = sizeof(array_mp_8188e_txpwr_lmt_88ee_m2_for_msi) / sizeof(u8 *); + u8 **array = (u8 **)array_mp_8188e_txpwr_lmt_88ee_m2_for_msi; #endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> odm_read_and_config_mp_8188e_txpwr_lmt_88e_e_m2_for_msi\n")); +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + void *adapter = dm->adapter; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + + PlatformZeroMemory(hal_data->BufOfLinesPwrLmt, MAX_LINES_HWCONFIG_TXT * MAX_BYTES_LINE_HWCONFIG_TXT); + hal_data->nLinesReadPwrLmt = array_len / 7; +#endif + + PHYDM_DBG(dm, ODM_COMP_INIT, "===> %s\n", __func__); for (i = 0; i < array_len; i += 7) { - 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]; +#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_8188e(p_dm_odm, regulation, band, bandwidth, rate, rf_path, chnl, val); + odm_config_bb_txpwr_lmt_8188e(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); + rsprintf((char *)hal_data->BufOfLinesPwrLmt[i / 7], 100, "\"%s\", \"%s\", \"%s\", \"%s\", \"%s\", \"%s\", \"%s\",", + regulation, band, bandwidth, rate, rf_path, chnl, val); #endif } - } #endif /* end of HWIMG_SUPPORT*/ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_rf.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_rf.h index 0367a9beec71..e248be6756cc 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_rf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_rf.h @@ -1,128 +1,119 @@ +/* SPDX-License-Identifier: GPL-2.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 -* -* -******************************************************************************/ + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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: 2.18*/ +/*Image2HeaderVersion: 3.5.2*/ #if (RTL8188E_SUPPORT == 1) #ifndef __INC_MP_RF_HW_IMG_8188E_H #define __INC_MP_RF_HW_IMG_8188E_H /****************************************************************************** -* RadioA.TXT +* radioa.TXT ******************************************************************************/ void -odm_read_and_config_mp_8188e_radioa(/* TC: Test Chip, MP: MP Chip*/ - struct PHY_DM_STRUCT *p_dm_odm -); +odm_read_and_config_mp_8188e_radioa( /* tc: Test Chip, mp: mp Chip*/ + struct dm_struct *dm); u32 odm_get_version_mp_8188e_radioa(void); /****************************************************************************** -* TxPowerTrack_AP.TXT +* txpowertrack_ap.TXT ******************************************************************************/ void -odm_read_and_config_mp_8188e_txpowertrack_ap(/* TC: Test Chip, MP: MP Chip*/ - struct PHY_DM_STRUCT *p_dm_odm -); -u32 odm_get_version_mp_8188e_txpowertrack_ap(void); +odm_read_and_config_mp_8188e_txpowertrack_ap( /* tc: Test Chip, mp: mp Chip*/ + struct dm_struct *dm); +u32 odm_get_version_mp_8188e_txpowertrack_ap(void); /****************************************************************************** -* TxPowerTrack_PCIE.TXT +* txpowertrack_pcie.TXT ******************************************************************************/ void -odm_read_and_config_mp_8188e_txpowertrack_pcie(/* TC: Test Chip, MP: MP Chip*/ - struct PHY_DM_STRUCT *p_dm_odm -); -u32 odm_get_version_mp_8188e_txpowertrack_pcie(void); +odm_read_and_config_mp_8188e_txpowertrack_pcie( /* tc: Test Chip, mp: mp Chip*/ + struct dm_struct *dm); +u32 odm_get_version_mp_8188e_txpowertrack_pcie(void); /****************************************************************************** -* TxPowerTrack_PCIE_ICUT.TXT +* txpowertrack_pcie_icut.TXT ******************************************************************************/ void -odm_read_and_config_mp_8188e_txpowertrack_pcie_icut(/* TC: Test Chip, MP: MP Chip*/ - struct PHY_DM_STRUCT *p_dm_odm -); -u32 odm_get_version_mp_8188e_txpowertrack_pcie_icut(void); +odm_read_and_config_mp_8188e_txpowertrack_pcie_icut( + /* tc: Test Chip, mp: mp Chip*/ + struct dm_struct *dm); +u32 odm_get_version_mp_8188e_txpowertrack_pcie_icut(void); /****************************************************************************** -* TxPowerTrack_SDIO.TXT +* txpowertrack_sdio.TXT ******************************************************************************/ void -odm_read_and_config_mp_8188e_txpowertrack_sdio(/* TC: Test Chip, MP: MP Chip*/ - struct PHY_DM_STRUCT *p_dm_odm -); -u32 odm_get_version_mp_8188e_txpowertrack_sdio(void); +odm_read_and_config_mp_8188e_txpowertrack_sdio( /* tc: Test Chip, mp: mp Chip*/ + struct dm_struct *dm); +u32 odm_get_version_mp_8188e_txpowertrack_sdio(void); /****************************************************************************** -* TxPowerTrack_SDIO_ICUT.TXT +* txpowertrack_sdio_icut.TXT ******************************************************************************/ void -odm_read_and_config_mp_8188e_txpowertrack_sdio_icut(/* TC: Test Chip, MP: MP Chip*/ - struct PHY_DM_STRUCT *p_dm_odm -); -u32 odm_get_version_mp_8188e_txpowertrack_sdio_icut(void); +odm_read_and_config_mp_8188e_txpowertrack_sdio_icut( + /* tc: Test Chip, mp: mp Chip*/ + struct dm_struct *dm); +u32 odm_get_version_mp_8188e_txpowertrack_sdio_icut(void); /****************************************************************************** -* TxPowerTrack_USB.TXT +* txpowertrack_usb.TXT ******************************************************************************/ void -odm_read_and_config_mp_8188e_txpowertrack_usb(/* TC: Test Chip, MP: MP Chip*/ - struct PHY_DM_STRUCT *p_dm_odm -); -u32 odm_get_version_mp_8188e_txpowertrack_usb(void); +odm_read_and_config_mp_8188e_txpowertrack_usb( /* tc: Test Chip, mp: mp Chip*/ + struct dm_struct *dm); +u32 odm_get_version_mp_8188e_txpowertrack_usb(void); /****************************************************************************** -* TxPowerTrack_USB_ICUT.TXT +* txpowertrack_usb_icut.TXT ******************************************************************************/ void -odm_read_and_config_mp_8188e_txpowertrack_usb_icut(/* TC: Test Chip, MP: MP Chip*/ - struct PHY_DM_STRUCT *p_dm_odm -); -u32 odm_get_version_mp_8188e_txpowertrack_usb_icut(void); +odm_read_and_config_mp_8188e_txpowertrack_usb_icut( + /* tc: Test Chip, mp: mp Chip*/ + struct dm_struct *dm); +u32 odm_get_version_mp_8188e_txpowertrack_usb_icut(void); /****************************************************************************** -* TXPWR_LMT.TXT +* txpwr_lmt.TXT ******************************************************************************/ void -odm_read_and_config_mp_8188e_txpwr_lmt(/* TC: Test Chip, MP: MP Chip*/ - struct PHY_DM_STRUCT *p_dm_odm -); -u32 odm_get_version_mp_8188e_txpwr_lmt(void); +odm_read_and_config_mp_8188e_txpwr_lmt( /* tc: Test Chip, mp: mp Chip*/ + struct dm_struct *dm); +u32 odm_get_version_mp_8188e_txpwr_lmt(void); /****************************************************************************** -* TXPWR_LMT_88EE_M2_for_MSI.TXT +* txpwr_lmt_88ee_m2_for_msi.TXT ******************************************************************************/ void -odm_read_and_config_mp_8188e_txpwr_lmt_88e_e_m2_for_msi(/* TC: Test Chip, MP: MP Chip*/ - struct PHY_DM_STRUCT *p_dm_odm -); -u32 odm_get_version_mp_8188e_txpwr_lmt_88ee_m2_for_msi(void); +odm_read_and_config_mp_8188e_txpwr_lmt_88ee_m2_for_msi( + /* tc: Test Chip, mp: mp Chip*/ + struct dm_struct *dm); +u32 odm_get_version_mp_8188e_txpwr_lmt_88ee_m2_for_msi(void); #endif #endif /* end of HWIMG_SUPPORT*/ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_s_fw.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_s_fw.c deleted file mode 100644 index b2952974bc2e..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_s_fw.c +++ /dev/null @@ -1,3647 +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 "../../rtl8188e/hal8188e_s_fw.h" -#endif - - -#if (RTL8188E_S_SUPPORT == 1) -#if (defined(CONFIG_AP_WOWLAN) || (DM_ODM_SUPPORT_TYPE & (ODM_AP))) - - -#ifndef LOAD_FW_HEADER_FROM_DRIVER -u8 array_mp_8188e_s_fw_ap[] = { - 0xE3, 0x88, 0x20, 0x00, 0x17, 0x00, 0x00, 0x00, 0x10, 0x27, 0x15, 0x22, 0xEE, 0x3C, 0x02, 0x00, - 0x0C, 0x27, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x02, 0x47, 0x42, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x02, 0x48, 0x77, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x02, 0x58, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0xE1, 0xEE, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x50, 0x02, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 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, 0x43, 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, 0x47, 0xE8, 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, 0x47, 0xE8, 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, 0x43, 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, 0x43, 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, 0x43, 0x4D, 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, - 0xC2, 0xAF, 0x56, 0xC6, 0xD2, 0xAF, 0xD2, 0xA9, 0x54, 0x80, 0x4F, 0xFF, 0x22, 0xE7, 0x09, 0xF6, - 0x08, 0xDF, 0xFA, 0x80, 0x46, 0xE7, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x3E, 0x88, 0x82, 0x8C, - 0x83, 0xE7, 0x09, 0xF0, 0xA3, 0xDF, 0xFA, 0x80, 0x32, 0xE3, 0x09, 0xF6, 0x08, 0xDF, 0xFA, 0x80, - 0x78, 0xE3, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x70, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0x09, 0xF0, - 0xA3, 0xDF, 0xFA, 0x80, 0x64, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF6, 0x08, 0xDF, 0xFA, 0x80, - 0x58, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x4C, 0x80, 0xD2, 0x80, - 0xFA, 0x80, 0xC6, 0x80, 0xD4, 0x80, 0x69, 0x80, 0xF2, 0x80, 0x33, 0x80, 0x10, 0x80, 0xA6, 0x80, - 0xEA, 0x80, 0x9A, 0x80, 0xA8, 0x80, 0xDA, 0x80, 0xE2, 0x80, 0xCA, 0x80, 0x33, 0x89, 0x82, 0x8A, - 0x83, 0xEC, 0xFA, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xF0, 0xA3, - 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, 0x0D, 0x89, 0x82, - 0x8A, 0x83, 0xE4, 0x93, 0xA3, 0xF6, 0x08, 0xDF, 0xF9, 0xEC, 0xFA, 0xA9, 0xF0, 0xED, 0xFB, 0x22, - 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, - 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xEA, 0xDE, 0xE8, 0x80, 0xDB, - 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xA3, 0xF2, 0x08, 0xDF, 0xF9, 0x80, 0xCC, 0x88, 0xF0, 0xEF, - 0x60, 0x01, 0x0E, 0x4E, 0x60, 0xC3, 0x88, 0xF0, 0xED, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0xB9, - 0xF5, 0x82, 0xEB, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0xAF, 0x23, 0x23, 0x45, 0x82, 0x23, 0x90, - 0x45, 0xFD, 0x73, 0xC5, 0xF0, 0xF8, 0xA3, 0xE0, 0x28, 0xF0, 0xC5, 0xF0, 0xF8, 0xE5, 0x82, 0x15, - 0x82, 0x70, 0x02, 0x15, 0x83, 0xE0, 0x38, 0xF0, 0x22, 0xEF, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, 0xED, - 0x49, 0xFD, 0xEC, 0x48, 0xFC, 0x22, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFE, 0xA3, 0xE0, - 0xFF, 0x22, 0xA4, 0x25, 0x82, 0xF5, 0x82, 0xE5, 0xF0, 0x35, 0x83, 0xF5, 0x83, 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, 0xEF, 0x4E, 0x60, 0x12, 0xEF, 0x60, 0x01, 0x0E, 0xED, 0xBB, - 0x01, 0x0B, 0x89, 0x82, 0x8A, 0x83, 0xF0, 0xA3, 0xDF, 0xFC, 0xDE, 0xFA, 0x22, 0x89, 0xF0, 0x50, - 0x07, 0xF7, 0x09, 0xDF, 0xFC, 0xA9, 0xF0, 0x22, 0xBB, 0xFE, 0xFC, 0xF3, 0x09, 0xDF, 0xFC, 0xA9, - 0xF0, 0x22, 0x02, 0x47, 0x80, 0x02, 0x43, 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, 0x47, 0xC5, 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, 0x82, 0xE1, 0x00, 0x41, 0x82, 0xE2, 0x00, 0x41, 0x82, 0xEF, - 0x00, 0x41, 0x82, 0xF2, 0x00, 0x44, 0x82, 0xB5, 0x41, 0x4E, 0x59, 0x00, 0x44, 0x82, 0xB1, 0x61, - 0x6E, 0x79, 0x00, 0x41, 0x82, 0xF3, 0x00, 0x00, 0x5F, 0xFD, 0x60, 0xFE, 0x67, 0xEC, 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, 0xEE, - 0xF0, 0x74, 0x47, 0xA3, 0xF0, 0x11, 0x3D, 0x74, 0xEE, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x47, - 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, 0x54, - 0xE0, 0x55, 0x35, 0xF5, 0x39, 0xA3, 0xE0, 0x55, 0x36, 0xF5, 0x3A, 0xA3, 0xE0, 0x55, 0x37, 0xF5, - 0x3B, 0xA3, 0xE0, 0x55, 0x38, 0xF5, 0x3C, 0xAD, 0x39, 0x7F, 0x54, 0x12, 0x32, 0x1E, 0xAD, 0x3A, - 0x7F, 0x55, 0x12, 0x32, 0x1E, 0xAD, 0x3B, 0x7F, 0x56, 0x12, 0x32, 0x1E, 0xAD, 0x3C, 0x7F, 0x57, - 0x12, 0x32, 0x1E, 0x53, 0x91, 0xEF, 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, 0x77, 0xF0, 0x74, 0x48, 0xA3, 0xF0, 0x12, 0x6D, - 0x67, 0xE5, 0x41, 0x30, 0xE3, 0x03, 0x12, 0x6D, 0xC4, 0xE5, 0x41, 0x30, 0xE4, 0x02, 0x31, 0x25, - 0xE5, 0x43, 0x30, 0xE0, 0x03, 0x12, 0x5C, 0xCC, 0xE5, 0x43, 0x30, 0xE1, 0x03, 0x12, 0x6E, 0x0D, - 0xE5, 0x43, 0x30, 0xE2, 0x03, 0x12, 0x6F, 0x72, 0xE5, 0x43, 0x30, 0xE3, 0x02, 0x91, 0x98, 0xE5, - 0x43, 0x30, 0xE4, 0x03, 0x12, 0x65, 0xFA, 0xE5, 0x43, 0x30, 0xE5, 0x03, 0x12, 0x62, 0x7E, 0xE5, - 0x43, 0x30, 0xE6, 0x03, 0x12, 0x61, 0x47, 0xE5, 0x43, 0x30, 0xE7, 0x03, 0x12, 0x6E, 0xF3, 0xE5, - 0x44, 0x30, 0xE0, 0x03, 0x12, 0x6E, 0xEB, 0xE5, 0x44, 0x30, 0xE1, 0x03, 0x12, 0x6F, 0x8A, 0x74, - 0x77, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x48, 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, 0x31, 0x38, 0x7F, 0x02, 0x8F, 0x0D, 0x7F, 0x02, 0x12, 0x45, 0x27, - 0x90, 0x80, 0x01, 0xE0, 0x45, 0x0D, 0xF0, 0x22, 0x90, 0x01, 0xCC, 0xE0, 0x54, 0x0F, 0x90, 0x82, - 0xE3, 0xF0, 0x90, 0x82, 0xE3, 0xE0, 0xFD, 0x70, 0x02, 0x41, 0x32, 0x90, 0x80, 0xA1, 0xE0, 0xFF, - 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, 0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0x80, 0xA2, 0xE0, 0xB5, - 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x08, 0x90, 0x01, 0xC1, 0xE0, 0x44, - 0x01, 0xF0, 0x22, 0x90, 0x82, 0xE1, 0x12, 0x57, 0xF8, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, - 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x70, 0x02, 0x41, 0x14, 0xE4, 0x90, 0x82, 0xE4, 0xF0, 0x90, 0x82, - 0xE4, 0xE0, 0xF9, 0xC3, 0x94, 0x04, 0x50, 0x31, 0x71, 0x0C, 0xA4, 0xFF, 0xE9, 0xFD, 0x7C, 0x00, - 0x2F, 0xFF, 0xEC, 0x35, 0xF0, 0xFE, 0x74, 0xD0, 0x71, 0xEA, 0x90, 0x80, 0x51, 0x71, 0xC9, 0x71, - 0x0C, 0xA4, 0x2D, 0xFF, 0xEC, 0x35, 0xF0, 0xFE, 0x74, 0xF0, 0x71, 0xEA, 0x90, 0x80, 0x55, 0x71, - 0xC9, 0x90, 0x82, 0xE4, 0xE0, 0x04, 0xF0, 0x80, 0xC5, 0x90, 0x82, 0xE3, 0xE0, 0xFF, 0x90, 0x82, - 0xE1, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, - 0x90, 0x82, 0xE3, 0xF0, 0x90, 0x82, 0xE1, 0x51, 0x39, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x90, - 0x01, 0xCC, 0xF0, 0x90, 0x82, 0xE1, 0xE0, 0x04, 0xF0, 0xE0, 0x54, 0x03, 0xF0, 0x90, 0x80, 0xA2, - 0x12, 0x69, 0x08, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x70, 0x02, 0x21, 0x42, 0xE4, 0x90, 0x80, - 0xA2, 0xF0, 0x21, 0x42, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x82, 0xE1, 0xE0, 0x44, - 0x80, 0x90, 0x00, 0x8A, 0xF0, 0x71, 0x0C, 0x90, 0x01, 0xD0, 0x12, 0x46, 0xD2, 0xE0, 0x90, 0x01, - 0xC3, 0xF0, 0x22, 0x12, 0x32, 0x1E, 0x90, 0x82, 0xE5, 0xE0, 0xFF, 0x74, 0x01, 0xA8, 0x07, 0x08, - 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x82, 0xE6, 0xED, 0xF0, 0x90, 0x82, 0xE5, - 0xEF, 0xF0, 0xD3, 0x94, 0x07, 0x50, 0x4B, 0x51, 0x39, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, - 0xFF, 0x90, 0x00, 0x47, 0xE0, 0x5F, 0xFD, 0x7F, 0x47, 0x51, 0x33, 0x80, 0x02, 0xC3, 0x33, 0xD8, - 0xFC, 0xFF, 0x90, 0x00, 0x46, 0xE0, 0x4F, 0xFD, 0x7F, 0x46, 0x71, 0xB5, 0x60, 0x10, 0x51, 0x36, - 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xFF, 0x90, 0x00, 0x45, 0xE0, 0x4F, 0x80, 0x0F, 0x51, 0x36, - 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0xFF, 0x90, 0x00, 0x45, 0xE0, 0x5F, 0xFD, 0x7F, 0x45, - 0x80, 0x62, 0x90, 0x82, 0xE5, 0xE0, 0x24, 0xF8, 0xF0, 0xE0, 0x24, 0x04, 0x51, 0x3A, 0x80, 0x02, - 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0xFF, 0x90, 0x00, 0x43, 0xE0, 0x5F, 0xFD, 0x7F, 0x43, 0x51, 0x33, - 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xFF, 0x90, 0x00, 0x43, 0xE0, 0x4F, 0xFD, 0x7F, 0x43, 0x71, - 0xB5, 0x60, 0x19, 0x90, 0x82, 0xE5, 0xE0, 0x24, 0x04, 0x51, 0x3A, 0x80, 0x02, 0xC3, 0x33, 0xD8, - 0xFC, 0xFF, 0x90, 0x00, 0x42, 0xE0, 0x4F, 0xFD, 0x7F, 0x42, 0x80, 0x18, 0x90, 0x82, 0xE5, 0xE0, - 0x24, 0x04, 0x51, 0x3A, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0xFF, 0x90, 0x00, 0x42, 0xE0, - 0x5F, 0xFD, 0x7F, 0x42, 0x12, 0x32, 0x1E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x82, 0xE1, 0xE0, - 0x75, 0xF0, 0x04, 0x22, 0xAD, 0x07, 0x90, 0x81, 0xEC, 0xE0, 0x75, 0xF0, 0x20, 0xA4, 0xFF, 0x90, - 0x82, 0xBF, 0xE5, 0xF0, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x81, 0xED, 0xE0, 0x75, 0xF0, 0x08, 0xA4, - 0xAE, 0xF0, 0x90, 0x82, 0xC1, 0xF0, 0xEE, 0xA3, 0xF0, 0x71, 0xAD, 0x90, 0x82, 0xC3, 0xF0, 0xEE, - 0xA3, 0xF0, 0xED, 0x64, 0x01, 0x60, 0x5E, 0x90, 0x81, 0xEA, 0xE0, 0xFE, 0xF1, 0xDD, 0x30, 0xE0, - 0x54, 0xEE, 0x71, 0xDE, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x71, 0xA6, 0xFE, 0x54, 0x0F, 0xFF, 0xEE, - 0xC4, 0x13, 0x13, 0x54, 0x01, 0xFD, 0x71, 0xA6, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x21, 0xA3, - 0xE0, 0x30, 0xE0, 0x0D, 0x90, 0x82, 0xC4, 0xE0, 0xF5, 0x1D, 0x90, 0x82, 0xC3, 0x71, 0xBD, 0x80, - 0x0F, 0x71, 0xAD, 0xFF, 0x12, 0x32, 0xAA, 0x71, 0xD9, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x51, 0x41, - 0x90, 0x81, 0xEA, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x0B, 0x90, 0x82, 0xC2, 0xE0, 0xF5, 0x1D, - 0x90, 0x82, 0xC1, 0x71, 0xBD, 0x22, 0x51, 0x41, 0x90, 0x81, 0xEA, 0xE0, 0x22, 0x90, 0x82, 0xBF, - 0xE0, 0xFE, 0xA3, 0xE0, 0x22, 0x12, 0x32, 0x1E, 0x90, 0x82, 0xE6, 0xE0, 0x22, 0xE0, 0xF5, 0x1E, - 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, 0x01, 0x80, 0x67, 0x12, 0x46, 0xD2, 0xE5, 0x82, 0x29, 0xF5, - 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xEF, 0xF0, 0x22, 0x90, 0x81, 0xEA, 0xE0, 0xFE, 0x54, 0x0F, - 0xFF, 0xEE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x7D, 0x00, 0x22, 0x2F, 0xF5, 0x82, 0x74, 0x01, 0x3E, - 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0x80, 0xA2, 0xE0, 0x75, 0xF0, 0x08, 0x22, 0x90, 0x81, 0xEA, 0xF1, - 0xDB, 0x30, 0xE0, 0x1A, 0xEF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x03, 0x12, 0x69, 0x78, 0x90, 0x81, - 0xEB, 0xE0, 0x30, 0xE0, 0x09, 0x71, 0xD9, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x51, 0x41, 0x22, 0xF0, - 0xE4, 0xF5, 0x1D, 0x90, 0x81, 0xCF, 0xE0, 0xF5, 0x1E, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, - 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8E, 0x19, 0x8F, 0x1A, 0xE5, 0x1E, 0x54, 0x07, 0xC4, - 0x33, 0x54, 0xE0, 0x85, 0x19, 0x83, 0x85, 0x1A, 0x82, 0xF0, 0xE5, 0x1D, 0x91, 0x90, 0xE5, 0x1E, - 0x13, 0x13, 0x13, 0x54, 0x1F, 0x4F, 0xA3, 0xF0, 0xEB, 0x91, 0x90, 0xE5, 0x1D, 0x13, 0x13, 0x13, - 0x54, 0x1F, 0x4F, 0x91, 0x87, 0xF0, 0xBD, 0x01, 0x0D, 0x85, 0x1A, 0x82, 0x8E, 0x83, 0xA3, 0xA3, - 0xA3, 0x74, 0x03, 0xF0, 0x80, 0x06, 0x91, 0x87, 0xA3, 0x74, 0x01, 0xF0, 0x91, 0x87, 0xA3, 0x74, - 0x05, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x85, 0x1A, 0x82, 0x85, 0x19, 0x83, 0xA3, 0xA3, 0x22, - 0x54, 0x07, 0xC4, 0x33, 0x54, 0xE0, 0xFF, 0x22, 0xF1, 0x9E, 0x70, 0x0B, 0x90, 0x81, 0x71, 0xE0, - 0x60, 0x05, 0x12, 0x5F, 0xDA, 0x91, 0x1F, 0x22, 0x90, 0x81, 0xD5, 0xE0, 0x30, 0xE0, 0x4E, 0x13, - 0x13, 0x54, 0x3F, 0x20, 0xE0, 0x19, 0xE4, 0xF5, 0x1D, 0x90, 0x81, 0xD7, 0x91, 0x26, 0x91, 0xFE, - 0x12, 0x6E, 0xD4, 0x30, 0xE0, 0x06, 0x7D, 0x0C, 0x7F, 0x01, 0xF1, 0x1F, 0x02, 0x6E, 0xDB, 0x90, - 0x81, 0xD5, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x23, 0xE4, 0xF5, 0x1D, 0x90, 0x81, 0xD8, - 0x91, 0x26, 0x90, 0x81, 0xD5, 0xE0, 0x54, 0xFB, 0xF0, 0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x09, 0x12, - 0x6F, 0x27, 0x7D, 0x04, 0x7F, 0x01, 0xE1, 0x1F, 0x7D, 0x31, 0x12, 0x67, 0x00, 0x22, 0x12, 0x67, - 0x72, 0xE4, 0xFD, 0xFF, 0x90, 0x05, 0x22, 0xEF, 0xF0, 0x90, 0x80, 0x05, 0xED, 0xF0, 0x22, 0x90, - 0x81, 0x6D, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x04, 0x7D, 0x0C, 0x80, 0x05, 0x12, 0x7C, 0xA7, 0x7D, - 0x04, 0x7F, 0x01, 0xF1, 0x1F, 0xE4, 0xFD, 0xFF, 0x80, 0xDA, 0x7D, 0x01, 0x7F, 0x04, 0xD3, 0x10, - 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x82, 0xEE, 0xED, 0xF0, 0x90, 0x81, 0x6C, 0xE0, 0xFE, 0xC4, - 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0xC1, 0x74, 0xEE, 0xF1, 0xDD, 0x30, 0xE0, 0x02, 0xC1, - 0x74, 0x90, 0x81, 0x74, 0xE0, 0xFE, 0x6F, 0x70, 0x02, 0xC1, 0x74, 0xEF, 0x70, 0x02, 0xA1, 0xEA, - 0x24, 0xFE, 0x70, 0x02, 0xC1, 0x24, 0x24, 0xFE, 0x60, 0x48, 0x24, 0xFC, 0x70, 0x02, 0xC1, 0x5F, - 0x24, 0xFC, 0x60, 0x02, 0xC1, 0x6E, 0xEE, 0xB4, 0x0E, 0x02, 0xB1, 0x0F, 0x90, 0x81, 0x74, 0xE0, - 0x70, 0x04, 0x7F, 0x01, 0xF1, 0x87, 0x90, 0x81, 0x74, 0xE0, 0xB4, 0x06, 0x02, 0xD1, 0xD1, 0x90, - 0x81, 0x74, 0xE0, 0xB4, 0x04, 0x0E, 0x90, 0x82, 0xEE, 0xE0, 0xFF, 0x60, 0x04, 0xF1, 0xA7, 0x80, - 0x03, 0x12, 0x65, 0x14, 0x90, 0x81, 0x74, 0xE0, 0x64, 0x08, 0x60, 0x02, 0xC1, 0x6E, 0xF1, 0xE4, - 0xC1, 0x6E, 0x90, 0x81, 0x74, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0xF1, 0x87, 0x90, 0x81, 0x74, 0xE0, - 0xB4, 0x06, 0x02, 0xD1, 0xD1, 0x90, 0x81, 0x74, 0xE0, 0xB4, 0x0E, 0x07, 0xD1, 0x79, 0xBF, 0x01, - 0x02, 0xB1, 0x0F, 0x90, 0x81, 0x74, 0xE0, 0x64, 0x0C, 0x60, 0x02, 0xC1, 0x6E, 0xD1, 0x79, 0xEF, - 0x64, 0x01, 0x60, 0x02, 0xC1, 0x6E, 0xD1, 0xF2, 0xC1, 0x6E, 0x90, 0x81, 0x74, 0xE0, 0xB4, 0x0E, - 0x07, 0xD1, 0x79, 0xBF, 0x01, 0x02, 0xB1, 0x0F, 0x90, 0x81, 0x74, 0xE0, 0xB4, 0x06, 0x02, 0xD1, - 0xD1, 0x90, 0x81, 0x74, 0xE0, 0xB4, 0x0C, 0x07, 0xD1, 0x79, 0xBF, 0x01, 0x02, 0xD1, 0xF2, 0x90, - 0x81, 0x74, 0xE0, 0x64, 0x04, 0x70, 0x57, 0x12, 0x71, 0xF6, 0xEF, 0x64, 0x01, 0x70, 0x4F, 0x12, - 0x66, 0xE7, 0x80, 0x4A, 0x90, 0x81, 0x74, 0xE0, 0xB4, 0x0E, 0x07, 0xD1, 0x79, 0xBF, 0x01, 0x02, - 0xB1, 0x0F, 0x90, 0x81, 0x74, 0xE0, 0xB4, 0x06, 0x02, 0xD1, 0xD1, 0x90, 0x81, 0x74, 0xE0, 0xB4, - 0x0C, 0x07, 0xD1, 0x79, 0xBF, 0x01, 0x02, 0xD1, 0xF2, 0x90, 0x81, 0x74, 0xE0, 0x70, 0x04, 0x7F, - 0x01, 0xF1, 0x87, 0x90, 0x81, 0x74, 0xE0, 0xB4, 0x04, 0x14, 0x12, 0x72, 0xE8, 0x80, 0x0F, 0x90, - 0x81, 0x74, 0xE0, 0xB4, 0x0C, 0x08, 0x12, 0x7C, 0x2E, 0x30, 0xE0, 0x02, 0xF1, 0xEC, 0x90, 0x81, - 0x74, 0x12, 0x7C, 0x80, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, - 0x12, 0x71, 0xDD, 0xEF, 0x64, 0x01, 0x60, 0x05, 0x75, 0x0E, 0x01, 0x80, 0x31, 0x12, 0x6F, 0x1D, - 0x30, 0xE0, 0x05, 0x75, 0x0E, 0x02, 0x80, 0x26, 0x90, 0x81, 0x73, 0xE0, 0xD3, 0x94, 0x04, 0x40, - 0x05, 0x75, 0x0E, 0x08, 0x80, 0x18, 0x90, 0x81, 0xD5, 0xE0, 0x30, 0xE0, 0x0C, 0x13, 0x13, 0x54, - 0x3F, 0x30, 0xE0, 0x05, 0x75, 0x0E, 0x11, 0x80, 0x05, 0x12, 0x72, 0x6D, 0x80, 0x0E, 0x90, 0x01, - 0xB9, 0x74, 0x02, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x0E, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, - 0x22, 0x90, 0x81, 0x6D, 0xE0, 0x90, 0x06, 0x04, 0x20, 0xE0, 0x08, 0xE0, 0x44, 0x40, 0xF0, 0x7D, - 0x04, 0x80, 0x06, 0xE0, 0x54, 0x7F, 0xF0, 0x7D, 0x0C, 0x7F, 0x01, 0xF1, 0x1F, 0xE4, 0xFD, 0xFF, - 0xA1, 0x04, 0xF1, 0x9E, 0x70, 0x28, 0x90, 0x81, 0x6D, 0xE0, 0x54, 0xFD, 0xF0, 0x7D, 0x2C, 0x7F, - 0x6F, 0xB1, 0x04, 0x7D, 0x08, 0x7F, 0x01, 0x12, 0x63, 0x71, 0xBF, 0x01, 0x0D, 0x90, 0x81, 0x6C, - 0xE0, 0x44, 0x80, 0xF0, 0x7D, 0x0E, 0x7F, 0x01, 0x80, 0x05, 0xF1, 0xF8, 0x04, 0xF0, 0x22, 0xD3, - 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAC, 0x07, 0xEF, 0x14, 0x60, 0x15, 0x14, 0x60, 0x19, 0x24, - 0x02, 0x70, 0x1A, 0xED, 0x54, 0x01, 0xFE, 0x90, 0x81, 0x6C, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0x80, - 0x0C, 0x90, 0x81, 0x74, 0xED, 0xF0, 0x80, 0x05, 0x90, 0x81, 0x73, 0xED, 0xF0, 0x90, 0x00, 0x8F, - 0xE0, 0x30, 0xE4, 0x2E, 0xEC, 0x14, 0x60, 0x07, 0x14, 0x60, 0x1D, 0x24, 0x02, 0x70, 0x23, 0x90, - 0x81, 0x6C, 0xE0, 0x54, 0x01, 0xC4, 0x33, 0x33, 0x33, 0x54, 0x80, 0xFF, 0x90, 0x81, 0x74, 0xE0, - 0x54, 0x7F, 0x4F, 0xFD, 0x7F, 0x88, 0x80, 0x07, 0x90, 0x81, 0x73, 0xE0, 0xFD, 0x7F, 0x89, 0x12, - 0x32, 0x1E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x82, 0xED, 0xEF, 0xF0, 0x12, 0x67, 0x72, 0x90, - 0x82, 0xED, 0xE0, 0x60, 0x03, 0x12, 0x65, 0x0E, 0x7D, 0x04, 0x7F, 0x01, 0x80, 0x81, 0xE4, 0xFF, - 0x12, 0x57, 0x75, 0xEF, 0x64, 0x01, 0x22, 0xEF, 0x60, 0x30, 0xF1, 0x9E, 0x70, 0x2C, 0x90, 0x81, - 0x6D, 0xE0, 0x54, 0xFE, 0xF0, 0x7D, 0x2B, 0x7F, 0x0F, 0xB1, 0x04, 0x90, 0x06, 0x04, 0xE0, 0x54, - 0xBF, 0xF0, 0x12, 0x63, 0x6D, 0xBF, 0x01, 0x0D, 0x90, 0x81, 0x6C, 0xE0, 0x44, 0x40, 0xF0, 0x7D, - 0x06, 0x7F, 0x01, 0xE1, 0x1F, 0xF1, 0xF8, 0x74, 0x08, 0xF0, 0x22, 0xE0, 0xFF, 0xC4, 0x13, 0x13, - 0x13, 0x54, 0x01, 0x22, 0x91, 0xFE, 0x7D, 0x0C, 0x7F, 0x01, 0xE1, 0x1F, 0x7D, 0x2F, 0x12, 0x67, - 0x00, 0x7D, 0x08, 0x7F, 0x01, 0xE1, 0x1F, 0xF0, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, - 0xB8, 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, 0x02, 0xF0, 0x74, 0x50, 0xA3, 0xF0, 0x12, 0x6D, 0x94, 0xE5, 0x49, 0x30, 0xE1, - 0x02, 0x11, 0xAC, 0xE5, 0x49, 0x30, 0xE2, 0x03, 0x12, 0x62, 0x38, 0xE5, 0x49, 0x30, 0xE3, 0x02, - 0x11, 0xC3, 0xE5, 0x49, 0x30, 0xE4, 0x02, 0x11, 0x9F, 0xE5, 0x4A, 0x30, 0xE0, 0x03, 0x12, 0x6F, - 0x94, 0xE5, 0x4B, 0x30, 0xE5, 0x02, 0x31, 0x7F, 0xE5, 0x4C, 0x30, 0xE1, 0x05, 0x7F, 0x04, 0x12, - 0x49, 0x29, 0xE5, 0x4C, 0x30, 0xE4, 0x02, 0x11, 0xA3, 0xE5, 0x4C, 0x30, 0xE5, 0x03, 0x12, 0x66, - 0x21, 0xE5, 0x4C, 0x30, 0xE6, 0x03, 0x12, 0x66, 0x4C, 0x74, 0x02, 0x04, 0x90, 0x01, 0xC4, 0xF0, - 0x74, 0x50, 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, 0x11, - 0xBA, 0x80, 0x7C, 0xF1, 0xAA, 0x7D, 0x02, 0x7F, 0x02, 0x02, 0x5E, 0x0D, 0x90, 0x81, 0x71, 0xE0, - 0x60, 0x03, 0x12, 0x61, 0xC6, 0x02, 0x4C, 0xA8, 0x11, 0xDF, 0x90, 0x01, 0xC7, 0x74, 0x66, 0xF0, - 0xE4, 0xFF, 0x22, 0x31, 0xA4, 0x30, 0xE0, 0x16, 0xE4, 0x90, 0x81, 0x40, 0xF0, 0x90, 0x81, 0x3D, - 0xE0, 0x30, 0xE0, 0x0A, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x04, 0x11, 0xB8, 0x31, 0x1F, 0x22, 0xC2, - 0xAF, 0x90, 0x81, 0x3D, 0xE0, 0x54, 0xFE, 0xF0, 0x7D, 0x08, 0xE4, 0xFF, 0x12, 0x5F, 0x35, 0x90, - 0x02, 0x09, 0xE0, 0x90, 0x04, 0x24, 0xF0, 0x90, 0x02, 0x09, 0xE0, 0x90, 0x04, 0x25, 0xF0, 0x12, - 0x7C, 0xDC, 0xD2, 0xAF, 0x22, 0x90, 0x81, 0x40, 0xE0, 0x60, 0x08, 0x90, 0x81, 0x3D, 0xE0, 0x44, - 0x10, 0xF0, 0x22, 0x11, 0xB8, 0x80, 0x08, 0x90, 0x01, 0xC7, 0x74, 0x10, 0xF0, 0x7F, 0x01, 0x90, - 0x82, 0xF1, 0xEF, 0xF0, 0x90, 0x80, 0x07, 0xE0, 0xB4, 0x02, 0x12, 0x90, 0x82, 0xF1, 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, 0x32, 0xAA, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x01, - 0xF0, 0x90, 0x82, 0xF1, 0xE0, 0xFF, 0x12, 0x4B, 0x14, 0x71, 0xBB, 0xF0, 0x22, 0x31, 0xA4, 0x30, - 0xE0, 0x1C, 0xEF, 0x30, 0xE0, 0x18, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x10, 0x90, 0x81, - 0x41, 0xE0, 0x70, 0x04, 0x11, 0xB8, 0x80, 0xA7, 0x90, 0x81, 0x41, 0xE0, 0x14, 0xF0, 0x22, 0x12, - 0x70, 0xF8, 0x90, 0x81, 0xF4, 0xEE, 0xF0, 0xA3, 0xEF, 0x31, 0xA3, 0x30, 0xE0, 0x14, 0x90, 0x81, - 0xF5, 0xE0, 0x20, 0xE0, 0x0D, 0x11, 0xDF, 0x90, 0x02, 0x86, 0xE0, 0x30, 0xE2, 0x04, 0xE0, 0x54, - 0xFB, 0xF0, 0x22, 0xF0, 0x90, 0x81, 0x3D, 0xE0, 0xFF, 0xC3, 0x13, 0x22, 0xF1, 0x61, 0xFC, 0x54, - 0x02, 0xFE, 0x90, 0x81, 0x3D, 0xE0, 0x54, 0xFD, 0x4E, 0xF0, 0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, - 0x08, 0x71, 0x59, 0xB1, 0x75, 0x90, 0x81, 0x40, 0xF0, 0xEC, 0x30, 0xE0, 0x14, 0x12, 0x5D, 0x73, - 0x90, 0x80, 0x07, 0xE0, 0x64, 0x01, 0x70, 0x38, 0x90, 0xFE, 0x10, 0xE0, 0x44, 0x04, 0xF0, 0x80, - 0x2F, 0x90, 0x81, 0x5F, 0xE0, 0x60, 0x16, 0x7D, 0x10, 0xE4, 0xFF, 0x12, 0x5E, 0x3B, 0x90, 0x01, - 0x3C, 0xE0, 0x30, 0xE4, 0x03, 0x74, 0x10, 0xF0, 0x90, 0x01, 0x63, 0xE4, 0xF0, 0x11, 0xDF, 0x12, - 0x5D, 0xE4, 0x30, 0xE0, 0x0B, 0x90, 0x02, 0x86, 0xE0, 0x30, 0xE2, 0x04, 0xE0, 0x54, 0xFB, 0xF0, - 0x90, 0x82, 0x0E, 0x91, 0x45, 0x90, 0x81, 0x3E, 0xB1, 0xBC, 0x90, 0x81, 0x3F, 0x31, 0xA3, 0x30, - 0xE0, 0x36, 0x71, 0x59, 0x12, 0x1F, 0xA4, 0xFE, 0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x4D, 0xFF, - 0x90, 0x81, 0x3D, 0xF0, 0xEE, 0x54, 0x08, 0xFE, 0xEF, 0x54, 0xF7, 0x4E, 0xD1, 0xC1, 0x90, 0x81, - 0x41, 0xF0, 0x70, 0x03, 0x74, 0x14, 0xF0, 0x71, 0x59, 0x90, 0x00, 0x05, 0x12, 0x1F, 0xBD, 0x90, - 0x81, 0x42, 0xF1, 0xE3, 0x90, 0x81, 0x43, 0xF0, 0x90, 0x81, 0x3E, 0xE0, 0x54, 0x01, 0x90, 0x81, - 0x4B, 0xF0, 0x90, 0x81, 0x3E, 0xE0, 0x54, 0x02, 0x90, 0x81, 0x4C, 0xF0, 0x90, 0x81, 0x3E, 0xE0, - 0x54, 0x04, 0x90, 0x81, 0x4D, 0xF0, 0x90, 0x81, 0x3E, 0xE0, 0x54, 0x08, 0x90, 0x81, 0x4E, 0xF0, - 0x90, 0x81, 0x3E, 0xE0, 0x54, 0x10, 0x90, 0x81, 0x4F, 0xF0, 0x90, 0x81, 0x3F, 0xE0, 0x54, 0x01, - 0x90, 0x81, 0x50, 0xF0, 0x90, 0x81, 0x3F, 0xE0, 0x54, 0x02, 0x90, 0x81, 0x51, 0xF0, 0x90, 0x81, - 0x3F, 0xE0, 0x54, 0x04, 0x90, 0x81, 0x52, 0xF0, 0x90, 0x81, 0x3F, 0xE0, 0x54, 0x08, 0x90, 0x81, - 0x53, 0xF0, 0x90, 0x81, 0x3F, 0xE0, 0x54, 0x10, 0x90, 0x81, 0x54, 0xF0, 0x22, 0x90, 0x82, 0x0B, - 0x12, 0x46, 0xE7, 0x90, 0x82, 0x0A, 0xEF, 0xF0, 0x12, 0x46, 0xF0, 0x52, 0xFC, 0x00, 0x53, 0x00, - 0x01, 0x53, 0x04, 0x03, 0x53, 0x09, 0x04, 0x53, 0x0D, 0x08, 0x53, 0x11, 0x09, 0x53, 0x15, 0x0A, - 0x53, 0x19, 0x12, 0x53, 0x1E, 0x13, 0x53, 0x22, 0x14, 0x53, 0x27, 0x20, 0x53, 0x2B, 0x25, 0x53, - 0x30, 0x26, 0x53, 0x34, 0xC2, 0x53, 0x39, 0xC4, 0x00, 0x00, 0x53, 0x3D, 0x71, 0x4D, 0xA1, 0x7B, - 0x71, 0x4D, 0xC1, 0x64, 0x71, 0x4D, 0x02, 0x73, 0xA8, 0x71, 0x4D, 0x80, 0x6A, 0x71, 0x4D, 0x21, - 0xAC, 0x71, 0x4D, 0x80, 0x4A, 0x71, 0x4D, 0x80, 0x52, 0x71, 0x4D, 0x02, 0x6A, 0x64, 0x71, 0x4D, - 0xA1, 0xC3, 0x71, 0x4D, 0x02, 0x6C, 0x7D, 0x71, 0x4D, 0xA1, 0x14, 0x71, 0x4D, 0x02, 0x6C, 0x8C, - 0x71, 0x4D, 0x81, 0x4E, 0x71, 0x4D, 0x02, 0x6C, 0x94, 0x71, 0x4D, 0xE1, 0x97, 0x90, 0x01, 0xC0, - 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x82, 0x0A, 0xE0, 0x90, 0x01, 0xC2, 0xF0, 0x22, 0x90, 0x82, 0x0B, - 0x02, 0x46, 0xDE, 0x90, 0x82, 0x0E, 0x12, 0x46, 0xE7, 0x90, 0x82, 0x0E, 0x02, 0x46, 0xDE, 0x71, - 0x53, 0x12, 0x7C, 0x9B, 0x7A, 0x81, 0x79, 0x55, 0x02, 0x2B, 0xED, 0x71, 0x53, 0x12, 0x7C, 0x9B, - 0x7A, 0x81, 0x79, 0x5A, 0x02, 0x2B, 0xED, 0x90, 0x82, 0x0E, 0x12, 0x46, 0xE7, 0x12, 0x74, 0x0F, - 0x71, 0x59, 0x12, 0x73, 0xC7, 0x71, 0xBB, 0x4E, 0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x2B, 0x91, - 0x48, 0x90, 0x81, 0xE2, 0xB1, 0xBC, 0x90, 0x81, 0xE3, 0xF0, 0x12, 0x1F, 0xA4, 0xFF, 0x54, 0x04, - 0xFE, 0x90, 0x81, 0xE1, 0xE0, 0x54, 0xFB, 0x4E, 0xB1, 0x74, 0x90, 0x81, 0xE4, 0xF0, 0xEF, 0x54, - 0x08, 0xFF, 0x90, 0x81, 0xE1, 0xE0, 0x54, 0xF7, 0x4F, 0xF0, 0x22, 0x90, 0x81, 0xE1, 0xE0, 0x54, - 0xFE, 0x22, 0x90, 0x81, 0xE1, 0xE0, 0x30, 0xE0, 0x7B, 0x90, 0x81, 0xE5, 0xE0, 0x04, 0xF0, 0x90, - 0x81, 0xE8, 0xE0, 0x64, 0x01, 0x70, 0x30, 0x90, 0x81, 0xE1, 0x12, 0x7C, 0x31, 0x30, 0xE0, 0x27, - 0x90, 0x81, 0xE7, 0xE0, 0x70, 0x21, 0x90, 0x81, 0xE4, 0xE0, 0xFE, 0xA3, 0xE0, 0xC3, 0x9E, 0x40, - 0x16, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x07, 0xD1, 0xC8, 0x71, 0xBB, 0xF0, 0x80, - 0x06, 0x31, 0x17, 0x71, 0xBB, 0xF0, 0x22, 0x90, 0x81, 0xE5, 0xE0, 0xFF, 0x90, 0x81, 0xE2, 0xE0, - 0xD3, 0x9F, 0x50, 0x30, 0x90, 0x06, 0x92, 0xE0, 0x20, 0xE2, 0x1A, 0x90, 0x81, 0xE7, 0xE0, 0x70, - 0x14, 0x7D, 0x08, 0xFF, 0x12, 0x63, 0x71, 0x90, 0x81, 0xE6, 0xE0, 0x04, 0xF0, 0x90, 0x81, 0xE0, - 0xE0, 0x04, 0xF0, 0x80, 0x06, 0x90, 0x06, 0x92, 0x74, 0x04, 0xF0, 0xE4, 0x90, 0x81, 0xE5, 0xF0, - 0x90, 0x81, 0xE7, 0xF0, 0x22, 0x12, 0x46, 0xDE, 0x90, 0x00, 0x01, 0x02, 0x1F, 0xBD, 0xF1, 0x61, - 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x81, 0xD5, 0x12, 0x73, 0xCF, 0x54, 0x02, 0xFF, 0xEE, 0x54, 0xFD, - 0xF1, 0xEA, 0x54, 0x04, 0x25, 0xE0, 0xFD, 0xEF, 0x54, 0xF7, 0x4D, 0xFF, 0x90, 0x81, 0xD5, 0xF0, - 0xEE, 0x54, 0x08, 0x25, 0xE0, 0xFE, 0xEF, 0x54, 0xEF, 0x4E, 0xF0, 0x90, 0x05, 0x52, 0xE0, 0x54, - 0x07, 0xFF, 0x90, 0x82, 0x0E, 0x60, 0x12, 0x91, 0x45, 0xFD, 0x90, 0x05, 0x56, 0xE0, 0xC3, 0x9D, - 0x90, 0x81, 0xD7, 0xF0, 0xA3, 0xED, 0xF0, 0x80, 0x22, 0x91, 0x45, 0xFB, 0xFF, 0x90, 0x05, 0x54, - 0xE0, 0xC3, 0x9F, 0xFF, 0xE4, 0x94, 0x00, 0xFE, 0x7C, 0x00, 0x7D, 0x05, 0x12, 0x20, 0x30, 0x90, - 0x81, 0xD7, 0xEF, 0xF0, 0xEB, 0x75, 0xF0, 0x05, 0x84, 0xA3, 0xF0, 0x71, 0x59, 0x12, 0x1F, 0xA4, - 0x20, 0xE0, 0x0A, 0x12, 0x4C, 0xFE, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x80, 0x0A, 0x7D, 0x0C, 0x7F, - 0x01, 0x12, 0x4F, 0x1F, 0x12, 0x6E, 0xDB, 0x12, 0x6F, 0x14, 0x20, 0xE0, 0x04, 0xEF, 0x54, 0xDF, - 0xF0, 0x12, 0x6E, 0xD4, 0x30, 0xE0, 0x15, 0x90, 0x81, 0x71, 0x74, 0x01, 0xF0, 0xE4, 0x90, 0x81, - 0x73, 0xF0, 0x12, 0x5F, 0xC2, 0x90, 0x05, 0x58, 0x74, 0x05, 0xF0, 0x22, 0xE4, 0x90, 0x81, 0x71, - 0xF0, 0x90, 0x81, 0x73, 0x74, 0x0C, 0xF0, 0x90, 0x81, 0x6C, 0xE0, 0x54, 0xFE, 0xF0, 0xA3, 0xE0, - 0x54, 0xFB, 0xF0, 0x22, 0xF1, 0x61, 0xFF, 0x54, 0x7F, 0x90, 0x81, 0x71, 0xF0, 0xEF, 0x12, 0x4F, - 0xDD, 0xA3, 0xF0, 0x91, 0x48, 0xFF, 0x54, 0xF0, 0xC4, 0x54, 0x0F, 0xFE, 0x90, 0x81, 0x6F, 0xE0, - 0x54, 0xF0, 0x4E, 0xB1, 0x74, 0x54, 0x01, 0x25, 0xE0, 0xFE, 0x90, 0x81, 0x6C, 0xE0, 0x54, 0xFD, - 0x4E, 0xF0, 0xEF, 0x54, 0x0F, 0xC4, 0x54, 0xF0, 0xFF, 0xB1, 0x6D, 0xB1, 0xBB, 0x90, 0x81, 0x70, - 0xD1, 0xC1, 0xFD, 0x7F, 0x02, 0x12, 0x4F, 0x1F, 0x71, 0x59, 0xD1, 0x35, 0x12, 0x4F, 0xF8, 0xF0, - 0x90, 0x81, 0x71, 0x12, 0x7C, 0x80, 0xB1, 0x6D, 0x90, 0x01, 0xBE, 0xF0, 0x22, 0x90, 0x81, 0x6F, - 0xE0, 0x54, 0x0F, 0x22, 0xF0, 0x90, 0x00, 0x03, 0x02, 0x1F, 0xBD, 0x90, 0x02, 0x09, 0xE0, 0xF5, - 0x53, 0x12, 0x1F, 0xA4, 0x25, 0x53, 0x90, 0x80, 0x4A, 0xF0, 0x91, 0x48, 0x25, 0x53, 0x90, 0x80, - 0x4B, 0xB1, 0xBC, 0x25, 0x53, 0x90, 0x80, 0x4C, 0xB1, 0x74, 0x25, 0x53, 0x90, 0x80, 0x4D, 0xD1, - 0xC1, 0x25, 0x53, 0x90, 0x80, 0x4E, 0xF0, 0x90, 0x00, 0x05, 0x12, 0x1F, 0xBD, 0x25, 0x53, 0x90, - 0x80, 0x4F, 0xF1, 0xE3, 0x25, 0x53, 0x90, 0x80, 0x50, 0xF0, 0x22, 0x4F, 0xF0, 0x90, 0x00, 0x02, - 0x02, 0x1F, 0xBD, 0x12, 0x1F, 0xA4, 0xFF, 0x54, 0x80, 0xFE, 0x90, 0x81, 0xEA, 0xE0, 0x54, 0x7F, - 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x40, 0xFF, 0xEE, 0x54, 0xBF, 0xF1, 0xEA, 0x54, 0x20, 0xFD, 0xEF, - 0x54, 0xDF, 0x4D, 0xFF, 0x90, 0x81, 0xEA, 0xF0, 0xEE, 0x54, 0x10, 0xFE, 0xEF, 0x54, 0xEF, 0x4E, - 0xFF, 0xF0, 0x12, 0x1F, 0xA4, 0x54, 0x0F, 0xFE, 0xEF, 0x54, 0xF0, 0x4E, 0x90, 0x81, 0xEA, 0xF0, - 0x91, 0x48, 0xFF, 0x54, 0x7F, 0x90, 0x81, 0xEC, 0xF0, 0xEF, 0x54, 0x80, 0x12, 0x4F, 0xDD, 0xFF, - 0x90, 0x81, 0xEB, 0xE0, 0x54, 0xFE, 0xB1, 0xBB, 0x90, 0x81, 0xED, 0xB1, 0x74, 0x54, 0x01, 0x25, - 0xE0, 0xFF, 0x90, 0x81, 0xEB, 0xE0, 0x54, 0xFD, 0x4F, 0xF0, 0x12, 0x4B, 0xD9, 0x20, 0xE0, 0x02, - 0x7D, 0x01, 0x02, 0x4A, 0x41, 0x90, 0x82, 0x11, 0x12, 0x46, 0xE7, 0x12, 0x5E, 0x19, 0x90, 0x81, - 0x71, 0xE0, 0xFF, 0x12, 0x5F, 0x3F, 0x90, 0x81, 0x71, 0xE0, 0x60, 0x17, 0x90, 0x82, 0x11, 0x91, - 0x45, 0x54, 0x0F, 0xFF, 0xB1, 0xBD, 0xFD, 0x12, 0x72, 0xBB, 0x12, 0x7C, 0x6F, 0x74, 0x01, 0xF0, - 0x12, 0x6F, 0xDC, 0x22, 0x8B, 0x53, 0x8A, 0x54, 0x89, 0x55, 0x91, 0x48, 0xFF, 0xF5, 0x57, 0x12, - 0x1F, 0xA4, 0xFE, 0xC3, 0x13, 0x30, 0xE0, 0x06, 0xB1, 0xBD, 0xF5, 0x58, 0x80, 0x02, 0x8F, 0x58, - 0x85, 0x57, 0x56, 0xE5, 0x56, 0xD3, 0x95, 0x58, 0x50, 0x23, 0xAB, 0x53, 0xAA, 0x54, 0xA9, 0x55, - 0x12, 0x1F, 0xA4, 0x54, 0x01, 0xFD, 0xAF, 0x56, 0xD1, 0xD0, 0xAF, 0x56, 0xF1, 0x75, 0xEF, 0xAF, - 0x56, 0x70, 0x04, 0xD1, 0xCF, 0x80, 0x02, 0xF1, 0xF2, 0x05, 0x56, 0x80, 0xD6, 0xE5, 0x57, 0x70, - 0x0F, 0xFF, 0xF1, 0x75, 0xEF, 0x70, 0x09, 0x12, 0x5F, 0xAE, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, - 0x22, 0xF0, 0x90, 0x00, 0x04, 0x02, 0x1F, 0xBD, 0xE4, 0xFD, 0xFF, 0xD1, 0xD0, 0xE4, 0xFF, 0x22, - 0x12, 0x7C, 0xB3, 0xED, 0x70, 0x12, 0xF1, 0x6A, 0xC0, 0x83, 0xC0, 0x82, 0xF1, 0x59, 0x80, 0x02, - 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5E, 0x80, 0x0F, 0xF1, 0x6A, 0xC0, 0x83, 0xC0, 0x82, 0xF1, 0x59, - 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x12, 0x6C, 0xAA, 0x90, - 0x81, 0x6B, 0xEF, 0xF0, 0x22, 0x90, 0x81, 0xE1, 0xE0, 0xFD, 0x30, 0xE0, 0x4B, 0x90, 0x81, 0xE6, - 0xE0, 0xFC, 0x60, 0x44, 0xF1, 0xFA, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, - 0x90, 0x04, 0xE0, 0xE0, 0xFB, 0xEF, 0x5B, 0x60, 0x0B, 0xE4, 0x90, 0x81, 0xE6, 0xF0, 0x90, 0x81, - 0xE8, 0x04, 0xF0, 0x22, 0x90, 0x81, 0xE3, 0xE0, 0xD3, 0x9C, 0x50, 0x13, 0xED, 0x13, 0x13, 0x13, - 0x54, 0x1F, 0x30, 0xE0, 0x04, 0xD1, 0xC8, 0x80, 0x02, 0x31, 0x17, 0x71, 0xBB, 0xF0, 0x22, 0x12, - 0x63, 0x6D, 0x90, 0x81, 0xE6, 0xE0, 0x04, 0xF0, 0x22, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x07, 0x08, - 0x22, 0x90, 0x82, 0x0E, 0x12, 0x46, 0xE7, 0x02, 0x1F, 0xA4, 0x74, 0x63, 0x2E, 0xF5, 0x82, 0xE4, - 0x34, 0x81, 0xF5, 0x83, 0x22, 0x12, 0x7C, 0xB3, 0xF1, 0x6A, 0xE0, 0xFD, 0x7C, 0x00, 0xF1, 0xFA, - 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5C, 0xFE, 0xEF, 0x5D, 0x4E, - 0x7F, 0x00, 0x60, 0x02, 0x7F, 0x01, 0x22, 0x12, 0x1F, 0xA4, 0x90, 0x81, 0x5F, 0xF0, 0x91, 0x48, - 0x90, 0x81, 0x60, 0xB1, 0xBC, 0x90, 0x81, 0x61, 0xF0, 0x22, 0xE4, 0x90, 0x81, 0xF4, 0xF0, 0x90, - 0x81, 0x71, 0xE0, 0x60, 0x2D, 0x12, 0x4F, 0x9E, 0x70, 0x28, 0x12, 0x7C, 0xE4, 0xF0, 0x90, 0x81, - 0xF4, 0x74, 0x01, 0xF0, 0xE4, 0x90, 0x81, 0x78, 0xF0, 0x04, 0x60, 0x16, 0x12, 0x73, 0x8F, 0xE4, - 0xF5, 0x1D, 0x90, 0x81, 0x79, 0x12, 0x4C, 0x26, 0x90, 0x81, 0x74, 0xE0, 0x20, 0xE2, 0x03, 0x12, - 0x4D, 0x2A, 0x22, 0xF0, 0x90, 0x00, 0x06, 0x02, 0x1F, 0xBD, 0x4F, 0xFF, 0xF0, 0x12, 0x1F, 0xA4, - 0xFE, 0x22, 0x22, 0xE4, 0xFD, 0xFF, 0xC1, 0xD0, 0xE0, 0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, - 0x08, 0x22, 0xC0, 0xE0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x05, 0xC0, - 0x07, 0x7D, 0x02, 0x90, 0x01, 0xC4, 0xED, 0xF0, 0x74, 0x58, 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, 0x00, 0xF7, 0xE0, 0x20, 0xE7, 0x09, 0xE0, 0x7F, 0x01, 0x20, 0xE6, 0x0C, - 0x7F, 0x02, 0x22, 0x90, 0x00, 0xF7, 0xE0, 0x30, 0xE6, 0x02, 0x7F, 0x03, 0x22, 0x11, 0x33, 0x90, - 0x80, 0x07, 0xEF, 0xF0, 0x11, 0x6D, 0x90, 0x01, 0x64, 0x74, 0x01, 0xF0, 0x90, 0x00, 0x12, 0xE0, - 0x54, 0xC7, 0x44, 0x20, 0xFD, 0x7F, 0x12, 0x12, 0x32, 0x1E, 0x02, 0x2D, 0xA7, 0x11, 0x9D, 0x11, - 0xD5, 0x12, 0x6D, 0x02, 0x12, 0x6D, 0x21, 0xE4, 0xF5, 0x35, 0xF5, 0x36, 0xF5, 0x37, 0x75, 0x38, - 0x80, 0xAD, 0x35, 0x7F, 0x50, 0x12, 0x32, 0x1E, 0xAD, 0x36, 0x7F, 0x51, 0x12, 0x32, 0x1E, 0xAD, - 0x37, 0x7F, 0x52, 0x12, 0x32, 0x1E, 0xAD, 0x38, 0x7F, 0x53, 0x02, 0x32, 0x1E, 0x90, 0x01, 0x30, - 0xE4, 0x11, 0xCD, 0x90, 0x01, 0x38, 0x11, 0xCD, 0xFD, 0x7F, 0x50, 0x12, 0x32, 0x1E, 0xE4, 0xFD, - 0x7F, 0x51, 0x12, 0x32, 0x1E, 0xE4, 0xFD, 0x7F, 0x52, 0x12, 0x32, 0x1E, 0xE4, 0xFD, 0x7F, 0x53, - 0x02, 0x32, 0x1E, 0xE4, 0x90, 0x82, 0x16, 0xF0, 0x90, 0x82, 0x81, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, - 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x01, 0x34, 0x74, 0xFF, 0x11, 0xCD, 0x90, 0x01, 0x3C, 0x11, - 0xCD, 0xFD, 0x7F, 0x54, 0x12, 0x32, 0x1E, 0x7D, 0xFF, 0x7F, 0x55, 0x12, 0x32, 0x1E, 0x7D, 0xFF, - 0x7F, 0x56, 0x12, 0x32, 0x1E, 0x7D, 0xFF, 0x7F, 0x57, 0x02, 0x32, 0x1E, 0x90, 0x81, 0x3D, 0xE0, - 0x54, 0xFE, 0x71, 0x02, 0x90, 0x81, 0x3D, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0xFB, 0xF0, 0x54, 0xF7, - 0xF0, 0x54, 0xEF, 0xF0, 0xE4, 0x90, 0x81, 0x40, 0x11, 0xCB, 0x11, 0xCE, 0x90, 0x81, 0x5F, 0xF0, - 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x82, 0x91, 0x71, 0x4B, 0xE4, 0x11, 0xCE, 0xFC, 0xA3, 0xF0, - 0x31, 0xD2, 0x90, 0x82, 0x96, 0xEF, 0xF0, 0x51, 0xAD, 0xA3, 0xE0, 0x04, 0xFD, 0x31, 0xD2, 0xAC, - 0x07, 0x90, 0x82, 0x96, 0xE0, 0x30, 0xE7, 0x08, 0x90, 0x82, 0x94, 0x74, 0x02, 0xF0, 0x80, 0x05, - 0xE4, 0x90, 0x82, 0x94, 0xF0, 0xEC, 0x30, 0xE6, 0x34, 0x51, 0xAD, 0x7D, 0x02, 0x31, 0xD2, 0xEF, - 0x54, 0x70, 0xC4, 0x54, 0x0F, 0x90, 0x82, 0x97, 0xF0, 0x14, 0x60, 0x11, 0x14, 0x60, 0x16, 0x24, - 0xFE, 0x60, 0x12, 0x14, 0x60, 0x07, 0x14, 0x60, 0x04, 0x24, 0x06, 0x80, 0x10, 0x90, 0x82, 0x95, - 0x74, 0x04, 0xF0, 0x80, 0x0D, 0x90, 0x82, 0x95, 0x74, 0x08, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x82, - 0x95, 0xF0, 0x90, 0x82, 0x94, 0xE0, 0x24, 0x18, 0xFF, 0xA3, 0xE0, 0x2F, 0xFF, 0x22, 0x90, 0x82, - 0x8D, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x31, 0x25, 0x90, 0x82, 0x90, 0xEF, 0xF0, - 0x90, 0x82, 0x8F, 0xE0, 0xFD, 0x90, 0x82, 0x8E, 0xE0, 0x2D, 0xFD, 0x90, 0x82, 0x8D, 0xE0, 0x34, - 0x00, 0xFC, 0x7E, 0x00, 0xED, 0x2F, 0xFF, 0xEE, 0x3C, 0xCF, 0x24, 0x06, 0xCF, 0x34, 0x00, 0xFE, - 0xE4, 0xFD, 0xAB, 0x07, 0xAA, 0x06, 0xED, 0x2B, 0xFB, 0xE4, 0x3A, 0xFA, 0xC3, 0x90, 0x81, 0x3C, - 0xE0, 0x9B, 0x90, 0x81, 0x3B, 0xE0, 0x9A, 0x50, 0x0A, 0xA3, 0x12, 0x7C, 0x8E, 0xEB, 0x9F, 0xFB, - 0xEA, 0x9E, 0xFA, 0xEA, 0x90, 0xFD, 0x11, 0xF0, 0xAF, 0x03, 0x74, 0x00, 0x2F, 0x12, 0x7C, 0xCA, - 0xFF, 0x22, 0x31, 0x9E, 0xEF, 0x64, 0x08, 0x70, 0x34, 0x51, 0x40, 0x24, 0x07, 0x31, 0xCC, 0xEF, - 0x70, 0x2B, 0x51, 0x40, 0x24, 0x1D, 0x31, 0xCC, 0xBF, 0x44, 0x0B, 0x51, 0x40, 0x24, 0x1F, 0x31, - 0xCC, 0xEF, 0x64, 0x43, 0x60, 0x14, 0x51, 0x40, 0x24, 0x1D, 0x31, 0xCC, 0xEF, 0x64, 0x43, 0x70, - 0x0C, 0x51, 0x40, 0x24, 0x1F, 0x31, 0xCC, 0xBF, 0x44, 0x03, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, - 0x90, 0x82, 0x8F, 0xE0, 0xFF, 0x90, 0x82, 0x8E, 0xE0, 0x2F, 0xFF, 0x90, 0x82, 0x8D, 0xE0, 0x34, - 0x00, 0xFE, 0x90, 0x82, 0x90, 0xE0, 0x7C, 0x00, 0x2F, 0xFF, 0xEC, 0x3E, 0xCF, 0x22, 0x31, 0x9E, - 0xEF, 0x64, 0x08, 0x70, 0x20, 0x51, 0x40, 0x24, 0x07, 0x31, 0xCC, 0xEF, 0x64, 0x06, 0x70, 0x15, - 0x51, 0x40, 0x24, 0x0E, 0x31, 0xCC, 0xEF, 0x70, 0x0C, 0x51, 0x40, 0x24, 0x0F, 0x31, 0xCC, 0xBF, - 0x01, 0x03, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, 0x24, 0x0A, 0xFC, 0xED, 0x2C, 0xFD, 0x31, 0xD2, - 0x90, 0x82, 0x0E, 0xA3, 0xE0, 0xFE, 0x90, 0x82, 0x14, 0xE0, 0x2E, 0x24, 0x24, 0xF5, 0x82, 0xE4, - 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x82, 0x14, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x82, 0x91, - 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x24, 0x04, 0xFD, 0x90, 0x82, 0x14, 0xE0, 0x2D, 0xFD, 0x21, - 0xD2, 0x24, 0x1A, 0xFC, 0xED, 0x2C, 0xFD, 0x31, 0xD2, 0x90, 0x82, 0x14, 0xE0, 0x24, 0x2C, 0xF5, - 0x82, 0xE4, 0x34, 0x82, 0x22, 0x12, 0x57, 0xF3, 0x12, 0x6C, 0x9C, 0x12, 0x65, 0x27, 0x12, 0x73, - 0x97, 0x51, 0xF2, 0x12, 0x74, 0x0F, 0x11, 0xFC, 0x12, 0x71, 0xC0, 0x90, 0x81, 0xE9, 0x74, 0x01, - 0xF0, 0x22, 0x90, 0x81, 0xDD, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0x7F, 0xF0, 0x54, 0xFB, 0xF0, 0xA3, - 0x74, 0x0A, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x82, 0x8D, 0x71, 0x4B, 0x31, 0xD2, - 0xEF, 0x54, 0x0C, 0x64, 0x08, 0x70, 0x2B, 0x90, 0x82, 0x90, 0xF0, 0x90, 0x82, 0x90, 0xE0, 0xFD, - 0xC3, 0x94, 0x06, 0x50, 0x1D, 0x90, 0x82, 0x8D, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0x24, - 0x10, 0x71, 0x45, 0xEF, 0xF4, 0x60, 0x03, 0x7F, 0x01, 0x22, 0x90, 0x82, 0x90, 0xE0, 0x04, 0xF0, - 0x80, 0xD9, 0x7F, 0x00, 0x22, 0xFC, 0xED, 0x2C, 0xFD, 0x21, 0xD2, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, - 0xA3, 0xED, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x82, 0xCA, 0xEE, 0xF0, - 0xA3, 0xEF, 0x71, 0x02, 0x90, 0x82, 0xCA, 0xE0, 0xFE, 0xA3, 0xE0, 0xF5, 0x82, 0x8E, 0x83, 0xE0, - 0x60, 0x23, 0xC3, 0x90, 0x82, 0xCD, 0xE0, 0x94, 0xE8, 0x90, 0x82, 0xCC, 0xE0, 0x94, 0x03, 0x40, - 0x0B, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x80, 0xF0, 0x7F, 0x00, 0x80, 0x0B, 0x90, 0x82, 0xCC, 0x71, - 0x9F, 0xB1, 0xEB, 0x80, 0xCF, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x82, 0x8B, 0xE4, - 0x75, 0xF0, 0x01, 0x02, 0x46, 0xA3, 0x90, 0x82, 0x06, 0xEF, 0x71, 0x02, 0x90, 0x01, 0x09, 0xE0, - 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0x90, 0x82, 0x06, 0xE0, 0x6F, 0x60, 0x35, 0xC3, 0x90, - 0x82, 0x08, 0xE0, 0x94, 0x88, 0x90, 0x82, 0x07, 0xE0, 0x94, 0x13, 0x40, 0x08, 0x90, 0x01, 0xC0, - 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x82, 0x07, 0x71, 0x9F, 0x12, 0x60, 0xB0, 0xD3, 0x90, 0x82, - 0x08, 0xE0, 0x94, 0x32, 0x90, 0x82, 0x07, 0xE0, 0x94, 0x00, 0x40, 0xC0, 0x90, 0x01, 0xC6, 0xE0, - 0x30, 0xE0, 0xB9, 0x22, 0xE4, 0xFD, 0xFB, 0xFA, 0xB1, 0xE4, 0x30, 0xE0, 0x73, 0x90, 0x00, 0xB6, - 0xE0, 0xFC, 0x90, 0x00, 0xBF, 0xE0, 0xFE, 0x90, 0x00, 0xBE, 0xE0, 0x24, 0x00, 0xFB, 0xEA, 0x3E, - 0xFA, 0xC4, 0xF8, 0x54, 0xF0, 0xC8, 0xEB, 0xC4, 0x54, 0x0F, 0x48, 0x54, 0x1E, 0xFF, 0xEC, 0xC4, - 0x54, 0x01, 0x4F, 0x90, 0x81, 0xF0, 0xF0, 0xB1, 0xF2, 0xEC, 0x30, 0xE4, 0x0A, 0x90, 0x81, 0x55, - 0xE0, 0xFD, 0x12, 0x7C, 0xDC, 0x80, 0x35, 0xEB, 0x30, 0xE5, 0x09, 0x90, 0x81, 0x56, 0x91, 0xBD, - 0x04, 0xF0, 0x80, 0x28, 0xEB, 0x30, 0xE6, 0x0A, 0x90, 0x81, 0x57, 0x91, 0xBD, 0x74, 0x02, 0xF0, - 0x80, 0x1A, 0xEB, 0x30, 0xE7, 0x0A, 0x90, 0x81, 0x58, 0x91, 0xBD, 0x74, 0x03, 0xF0, 0x80, 0x0C, - 0xEA, 0x30, 0xE0, 0x08, 0x90, 0x81, 0x59, 0x91, 0xBD, 0x74, 0x04, 0xF0, 0xAF, 0x05, 0x80, 0x56, - 0x90, 0x81, 0x48, 0xE0, 0xFD, 0x7C, 0x00, 0xA3, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x20, 0x30, - 0xED, 0x4C, 0x70, 0x05, 0x90, 0x81, 0x55, 0x80, 0x2A, 0xED, 0x64, 0x01, 0x4C, 0x70, 0x05, 0x90, - 0x81, 0x56, 0x80, 0x1F, 0xED, 0x64, 0x02, 0x4C, 0x70, 0x05, 0x90, 0x81, 0x57, 0x80, 0x14, 0xED, - 0x64, 0x03, 0x4C, 0x70, 0x05, 0x90, 0x81, 0x58, 0x80, 0x09, 0xED, 0x64, 0x04, 0x4C, 0x70, 0x0C, - 0x90, 0x81, 0x59, 0xE0, 0xFF, 0x91, 0xC6, 0x90, 0x81, 0x49, 0x71, 0x9F, 0x22, 0xE0, 0xFD, 0x90, - 0x81, 0x49, 0xE4, 0xF0, 0xA3, 0x22, 0x90, 0x04, 0x24, 0xEF, 0xF0, 0x22, 0x12, 0x6F, 0x04, 0x12, - 0x73, 0x01, 0x90, 0x81, 0x3D, 0xE0, 0x30, 0xE0, 0x02, 0x71, 0xF4, 0x90, 0x81, 0xD5, 0xE0, 0x30, - 0xE0, 0x18, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x12, 0x4C, 0xFE, 0x12, 0x6E, 0xD4, 0x30, 0xE0, 0x07, - 0x7D, 0x0C, 0x7F, 0x01, 0x12, 0x4F, 0x1F, 0x12, 0x6E, 0xDB, 0x22, 0x12, 0x71, 0x56, 0x90, 0x00, - 0x08, 0xE0, 0x54, 0xEF, 0xFD, 0x7F, 0x08, 0x12, 0x32, 0x1E, 0xE4, 0xFF, 0x71, 0xA6, 0x90, 0x81, - 0x6D, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x71, 0x73, - 0x91, 0xFB, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x81, 0x74, 0xE0, 0xFF, 0x60, 0x03, 0xB4, 0x08, - 0x0E, 0x12, 0x72, 0x75, 0xBF, 0x01, 0x08, 0xB1, 0x16, 0x90, 0x01, 0xE5, 0xE0, 0x04, 0xF0, 0x22, - 0xE4, 0x90, 0x82, 0xE7, 0xF0, 0xA3, 0xF0, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x22, 0xC3, 0x90, - 0x82, 0xE8, 0xE0, 0x94, 0xD0, 0x90, 0x82, 0xE7, 0xE0, 0x94, 0x07, 0x40, 0x0A, 0x90, 0x01, 0xC1, - 0xE0, 0x44, 0x04, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0x82, 0xE7, 0x71, 0x9F, 0xB1, 0xEB, 0x80, 0xD7, - 0x7F, 0x01, 0x22, 0x90, 0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, 0x16, 0x12, 0x7C, 0xD3, 0x90, 0x81, - 0x3B, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x02, 0x86, 0xE0, 0x44, 0x04, 0x12, 0x51, 0xA3, 0x30, 0xE0, - 0x2B, 0x90, 0x01, 0xC7, 0xE4, 0xF0, 0xB1, 0x40, 0x90, 0x81, 0x3D, 0xE0, 0xBF, 0x01, 0x05, 0x54, - 0xEF, 0xF0, 0x80, 0x03, 0x44, 0x10, 0xF0, 0x90, 0x81, 0x40, 0xE0, 0xFF, 0x60, 0x0E, 0xE4, 0xF5, - 0x1D, 0x8F, 0x1E, 0xFB, 0xFD, 0x7F, 0x5C, 0x7E, 0x01, 0x12, 0x4C, 0x30, 0x90, 0x81, 0x3D, 0xE0, - 0x44, 0x01, 0xF0, 0x7D, 0x08, 0xE4, 0xFF, 0xD1, 0x0D, 0x90, 0x05, 0x52, 0xE0, 0x54, 0x07, 0x04, - 0x90, 0x81, 0x48, 0x71, 0x02, 0x90, 0x04, 0x22, 0xE0, 0x54, 0xEF, 0xF0, 0xB1, 0xE4, 0x30, 0xE0, - 0x02, 0xB1, 0xF2, 0x22, 0x90, 0x81, 0x3D, 0xE0, 0xC3, 0x13, 0x22, 0x7F, 0x0A, 0x7E, 0x00, 0x02, - 0x32, 0xAA, 0x90, 0x00, 0xB6, 0x74, 0x10, 0xF0, 0x90, 0x00, 0xBE, 0x74, 0xE0, 0xF0, 0xA3, 0x74, - 0x01, 0xF0, 0x22, 0x7D, 0x01, 0x7F, 0x02, 0xD1, 0x0D, 0x7D, 0x02, 0x7F, 0x02, 0x74, 0x3D, 0x2F, - 0xF8, 0xE6, 0x4D, 0xFE, 0xF6, 0x74, 0x30, 0x80, 0x2A, 0x90, 0x81, 0x6C, 0xE0, 0x54, 0xFB, 0xF0, - 0xE4, 0x90, 0x81, 0x7A, 0xF0, 0xA3, 0xF0, 0x90, 0x81, 0x75, 0xF0, 0x90, 0x81, 0x6D, 0xE0, 0x54, - 0xF7, 0xF0, 0x54, 0xBF, 0xF0, 0xD1, 0x03, 0x7D, 0x10, 0x7F, 0x03, 0x74, 0x45, 0xF1, 0xCA, 0xFE, - 0xF6, 0x74, 0x38, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x90, 0x05, - 0x62, 0xE0, 0xFE, 0x90, 0x05, 0x61, 0xE0, 0xFD, 0xED, 0x78, 0x02, 0xCE, 0xC3, 0x13, 0xCE, 0x13, - 0xD8, 0xF9, 0xFF, 0x90, 0x81, 0xF0, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x4F, 0x9E, 0x60, 0x02, - 0xE1, 0x15, 0x90, 0x81, 0x71, 0xE0, 0x70, 0x02, 0xE1, 0x15, 0xF1, 0x16, 0x64, 0x01, 0x70, 0x22, - 0x90, 0x06, 0xAB, 0xE0, 0x90, 0x81, 0x78, 0xF0, 0x90, 0x06, 0xAA, 0xE0, 0x90, 0x81, 0x77, 0xF0, - 0xA3, 0xE0, 0xFF, 0x70, 0x08, 0x90, 0x81, 0x77, 0xE0, 0xFE, 0xFF, 0x80, 0x00, 0x90, 0x81, 0x78, - 0xEF, 0xF0, 0xE4, 0x90, 0x81, 0x7A, 0xF1, 0xEB, 0xF1, 0xDA, 0x12, 0x66, 0x18, 0x54, 0xEF, 0xF0, - 0x90, 0x81, 0x6F, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x24, 0xFD, 0x50, 0x02, 0x80, 0x03, 0x12, 0x61, - 0x66, 0x12, 0x7C, 0xBF, 0x30, 0xE0, 0x4C, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x1F, - 0xF1, 0x1E, 0x6F, 0x70, 0x3E, 0x90, 0x81, 0x6D, 0xE0, 0x44, 0x40, 0xF0, 0x12, 0x7C, 0xE4, 0xF1, - 0x26, 0xF1, 0xD2, 0xF1, 0xBC, 0xF1, 0x31, 0x90, 0x81, 0x78, 0xE0, 0x14, 0xF0, 0x80, 0x24, 0xF1, - 0x16, 0x64, 0x01, 0x70, 0x1E, 0xF1, 0x1E, 0xFE, 0x6F, 0x60, 0x18, 0x90, 0x05, 0x73, 0xE0, 0xFF, - 0xEE, 0x6F, 0x60, 0x0F, 0x12, 0x7C, 0x2E, 0x30, 0xE0, 0x09, 0xEF, 0x54, 0xBF, 0xF1, 0x26, 0xD1, - 0x3B, 0xD1, 0x03, 0xF1, 0xC2, 0x22, 0x90, 0x81, 0x6F, 0xE0, 0xC4, 0x54, 0x0F, 0x22, 0x90, 0x81, - 0x77, 0xE0, 0xFF, 0xA3, 0xE0, 0x22, 0xF0, 0x90, 0x01, 0x3F, 0x74, 0x10, 0xF0, 0xFD, 0x7F, 0x03, - 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x74, 0x3D, 0xF1, 0xCA, 0xFE, 0xF6, 0x74, 0x30, 0xC1, 0x43, 0xEF, - 0x70, 0x33, 0x7D, 0x78, 0x7F, 0x02, 0xF1, 0x35, 0x7D, 0x02, 0x7F, 0x03, 0xF1, 0x35, 0x7D, 0xC8, - 0x7F, 0x02, 0xD1, 0x3B, 0xF1, 0xDA, 0xF0, 0xE4, 0xFF, 0x12, 0x57, 0x75, 0xEF, 0x70, 0x0A, 0xF1, - 0xAE, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x80, 0x07, 0x7D, 0x01, 0x7F, 0x0C, 0x12, 0x4D, 0x2E, - 0xF1, 0xB4, 0x02, 0x67, 0xE4, 0x90, 0x01, 0x36, 0x74, 0x78, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x7D, - 0x78, 0xFF, 0xD1, 0x0D, 0x7D, 0x02, 0x7F, 0x03, 0xD1, 0x0D, 0x90, 0x06, 0x0A, 0xE0, 0x44, 0x07, - 0xF1, 0xEB, 0xE4, 0xFF, 0x12, 0x57, 0x75, 0xBF, 0x01, 0x11, 0x12, 0x62, 0x30, 0x90, 0x81, 0x74, - 0xE0, 0x20, 0xE2, 0x09, 0x7D, 0x01, 0x7F, 0x04, 0x02, 0x4D, 0x2E, 0xF1, 0xC2, 0x22, 0x12, 0x67, - 0x72, 0x12, 0x65, 0x14, 0x90, 0x81, 0x6C, 0xE0, 0x54, 0xF7, 0xF0, 0x22, 0x7D, 0x01, 0x7F, 0x02, - 0xE1, 0x35, 0x90, 0x81, 0x6D, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, - 0x5E, 0x22, 0x74, 0x45, 0x2F, 0xF8, 0xE6, 0x4D, 0xC1, 0x3F, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, - 0x01, 0x3C, 0x74, 0x02, 0x22, 0xE4, 0x90, 0x80, 0x01, 0x01, 0xCB, 0xF0, 0x90, 0x81, 0x7D, 0xA3, - 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x22, 0x75, 0xE8, 0x03, 0x75, 0xA8, 0x84, 0x22, 0x90, 0x00, 0x80, - 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x12, 0x32, 0x1E, 0x90, 0xFD, 0x00, 0xE0, 0x54, 0xBF, 0xF0, - 0x11, 0xC1, 0x12, 0x32, 0x77, 0x11, 0xCE, 0x12, 0x5F, 0xE5, 0x7F, 0x01, 0x12, 0x44, 0x15, 0x90, - 0x81, 0xDC, 0x74, 0x02, 0xF0, 0xFF, 0x12, 0x44, 0x15, 0x90, 0x81, 0xDC, 0xE0, 0x04, 0xF0, 0x12, - 0x58, 0x4D, 0x12, 0x5A, 0xD5, 0x90, 0x01, 0xCC, 0x74, 0x0F, 0xF0, 0x90, 0x00, 0x80, 0xE0, 0x44, - 0x40, 0xFD, 0x7F, 0x80, 0x12, 0x32, 0x1E, 0x75, 0x20, 0xFF, 0x12, 0x5F, 0xF6, 0x11, 0x56, 0x11, - 0xB7, 0xE4, 0xFF, 0x02, 0x44, 0x9E, 0xE4, 0x90, 0x82, 0x03, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x98, - 0xE0, 0x7F, 0x00, 0x30, 0xE4, 0x02, 0x7F, 0x01, 0xEF, 0x64, 0x01, 0x60, 0x3C, 0xC3, 0x90, 0x82, - 0x04, 0xE0, 0x94, 0x88, 0x90, 0x82, 0x03, 0xE0, 0x94, 0x13, 0x40, 0x0F, 0x90, 0x01, 0xC1, 0xE0, - 0x44, 0x10, 0xF0, 0x90, 0x01, 0xC7, 0x74, 0xFD, 0xF0, 0x80, 0x1E, 0x90, 0x82, 0x03, 0x12, 0x5B, - 0x9F, 0x11, 0xB0, 0xD3, 0x90, 0x82, 0x04, 0xE0, 0x94, 0x32, 0x90, 0x82, 0x03, 0xE0, 0x94, 0x00, - 0x40, 0xBB, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE3, 0xB4, 0x90, 0x01, 0xC7, 0x74, 0xFE, 0xF0, 0x22, - 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x32, 0xAA, 0x90, 0x01, 0xE4, 0x74, 0x17, 0xF0, 0xA3, 0xE4, 0xF0, - 0x22, 0x90, 0x01, 0x94, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x01, 0xC7, 0xE4, 0xF0, 0x22, 0x90, 0x01, - 0x01, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x01, 0x9C, 0x74, 0x7E, 0xF0, 0xA3, 0x74, 0x92, 0xF0, 0xA3, - 0x74, 0xA0, 0xF0, 0xA3, 0x74, 0x24, 0xF0, 0x90, 0x01, 0x9B, 0x74, 0x49, 0xF0, 0x90, 0x01, 0x9A, - 0x74, 0xE0, 0xF0, 0x90, 0x01, 0x99, 0xE4, 0xF0, 0x90, 0x01, 0x98, 0x04, 0xF0, 0x22, 0xE4, 0x90, - 0x82, 0x05, 0xF0, 0x90, 0x82, 0x05, 0xE0, 0x64, 0x01, 0xF0, 0x24, 0xFE, 0x90, 0x01, 0xC4, 0xF0, - 0x74, 0x60, 0xA3, 0xF0, 0x90, 0x81, 0x71, 0xE0, 0x60, 0x0E, 0x90, 0x81, 0x74, 0xE0, 0xFF, 0x90, - 0x81, 0x73, 0xE0, 0x6F, 0x60, 0x02, 0x31, 0x3D, 0xC2, 0xAF, 0x12, 0x6D, 0x40, 0xBF, 0x01, 0x03, - 0x12, 0x72, 0xF6, 0xD2, 0xAF, 0x31, 0x3C, 0x12, 0x43, 0x4D, 0x80, 0xC7, 0x22, 0x90, 0x81, 0x73, - 0xE0, 0xFF, 0x7D, 0x01, 0x02, 0x4D, 0x2E, 0xE4, 0xFF, 0x12, 0x57, 0x75, 0xBF, 0x01, 0x0E, 0x90, - 0x81, 0x71, 0xE0, 0x60, 0x08, 0x31, 0x5E, 0x54, 0x07, 0x70, 0x02, 0x31, 0x3D, 0x22, 0x90, 0x81, - 0x75, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0x90, 0x06, 0xA9, 0xE0, 0xF5, 0x4E, 0x54, 0xC0, 0x70, 0x07, - 0x31, 0x5E, 0x54, 0xFD, 0xF0, 0x80, 0xC6, 0xE5, 0x4E, 0x30, 0xE6, 0x1E, 0x90, 0x81, 0x71, 0xE0, - 0x64, 0x01, 0x70, 0x18, 0x90, 0x81, 0x75, 0xE0, 0x44, 0x01, 0xF0, 0x12, 0x55, 0x6D, 0x64, 0x02, - 0x60, 0x04, 0x51, 0x98, 0x80, 0x06, 0x31, 0xB7, 0x80, 0x02, 0x31, 0x5E, 0xE5, 0x4E, 0x90, 0x81, - 0x75, 0x30, 0xE7, 0x0E, 0xE0, 0x44, 0x02, 0x12, 0x4C, 0x1F, 0x90, 0x81, 0x6C, 0xE0, 0x44, 0x04, - 0xF0, 0x22, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x51, 0x51, 0x90, 0x81, 0x74, 0xE0, 0x64, 0x0C, 0x60, - 0x04, 0xB1, 0x07, 0x71, 0x6D, 0x22, 0x12, 0x7C, 0xBF, 0x30, 0xE0, 0x0C, 0xEF, 0xC4, 0x13, 0x13, - 0x54, 0x03, 0x30, 0xE0, 0x03, 0x12, 0x5F, 0x31, 0x90, 0x81, 0x6C, 0x12, 0x7C, 0x31, 0x30, 0xE0, - 0x09, 0xEF, 0xD1, 0x16, 0x54, 0x07, 0x70, 0x47, 0x80, 0x43, 0x90, 0x81, 0x7A, 0xE0, 0x04, 0xF0, - 0x90, 0x81, 0x75, 0xE0, 0x54, 0xEF, 0xF0, 0x90, 0x81, 0xCE, 0xE0, 0xFF, 0x90, 0x81, 0x7A, 0xE0, - 0xD3, 0x9F, 0x40, 0x29, 0x12, 0x4F, 0x9E, 0x70, 0x26, 0x12, 0x55, 0x6D, 0x70, 0x02, 0x80, 0x20, - 0x90, 0x81, 0x7B, 0xE0, 0x04, 0xF0, 0xE0, 0xD3, 0x94, 0x02, 0x40, 0x09, 0x51, 0x30, 0xE4, 0x90, - 0x81, 0x7B, 0xF0, 0x80, 0x02, 0x31, 0xB7, 0xE4, 0x90, 0x81, 0x7A, 0xF0, 0x22, 0x31, 0x3D, 0x22, - 0x90, 0x81, 0x6D, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x90, 0x81, 0x71, 0xE0, 0x60, 0x10, 0x90, 0x06, - 0x92, 0xE0, 0x30, 0xE1, 0x04, 0x51, 0x51, 0x80, 0x05, 0x12, 0x5F, 0xB4, 0x31, 0x3D, 0x02, 0x4B, - 0xFC, 0x12, 0x6F, 0x1D, 0x30, 0xE0, 0x05, 0x90, 0x01, 0x5B, 0xE4, 0xF0, 0x90, 0x06, 0x92, 0x74, - 0x02, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x04, 0xF0, 0xE4, 0xF5, 0x1D, 0x90, 0x81, 0xD0, 0xE0, 0xC3, - 0x13, 0x54, 0x7F, 0x12, 0x4B, 0xBE, 0x90, 0x81, 0x6C, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0xE4, 0xFF, - 0x12, 0x57, 0x75, 0xBF, 0x01, 0x11, 0x90, 0x81, 0x71, 0xE0, 0x60, 0x0B, 0x12, 0x55, 0x6D, 0x64, - 0x02, 0x60, 0x02, 0x80, 0x03, 0x31, 0xB7, 0x22, 0x90, 0x04, 0x1D, 0xE0, 0x70, 0x1B, 0x90, 0x80, - 0x4B, 0xE0, 0xFF, 0x90, 0x82, 0xD1, 0x74, 0x09, 0xF0, 0x7B, 0x18, 0xE4, 0xFD, 0x51, 0xBA, 0x90, - 0x81, 0xF2, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xB1, 0x00, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, - 0xD0, 0x90, 0x82, 0xCF, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x82, 0xCE, 0xEF, 0xF0, 0xE4, 0xFD, - 0xFC, 0x71, 0x59, 0x7C, 0x00, 0xAD, 0x07, 0x90, 0x82, 0xCE, 0xE0, 0x90, 0x04, 0x25, 0xF0, 0x90, - 0x82, 0xCF, 0xE0, 0x60, 0x0E, 0x74, 0x0F, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, - 0x44, 0x80, 0xF0, 0xAF, 0x05, 0x74, 0x08, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE4, - 0xF0, 0x74, 0x09, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xF0, 0xF0, 0xAF, - 0x05, 0x91, 0x66, 0xE0, 0x54, 0x01, 0xFE, 0x90, 0x82, 0xD0, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0xFB, - 0xEE, 0x44, 0x02, 0x4B, 0xFE, 0x91, 0x66, 0xEE, 0xF0, 0x90, 0x82, 0xD1, 0xE0, 0xFF, 0xAE, 0x05, - 0x74, 0x1E, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x21, 0x2E, 0x91, - 0x74, 0x54, 0xF7, 0xF0, 0xAE, 0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x74, 0x6D, 0x2E, - 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0xE0, 0xFF, 0xE4, 0xFE, 0xEF, 0xC3, 0x13, 0xFD, 0xEF, - 0x30, 0xE0, 0x02, 0x7E, 0x80, 0x90, 0xFD, 0x10, 0xED, 0xF0, 0xAF, 0x06, 0x22, 0x7D, 0x08, 0xE4, - 0xFF, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x82, 0xC5, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, - 0x90, 0x80, 0x03, 0xE0, 0x04, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x21, 0x90, 0x05, 0x22, 0xE0, - 0x90, 0x82, 0xC9, 0xF0, 0x7D, 0x26, 0xD1, 0x81, 0xEF, 0x64, 0x01, 0x70, 0x02, 0x71, 0xBA, 0x90, - 0x82, 0xC9, 0xE0, 0xFF, 0x7D, 0x27, 0x12, 0x4D, 0x04, 0x91, 0x9E, 0x80, 0x04, 0x91, 0x9E, 0x71, - 0xBA, 0xB1, 0x00, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x80, 0x4C, 0xE0, 0xFF, 0x90, - 0x82, 0xC6, 0xE0, 0xFB, 0x90, 0x82, 0xD1, 0x74, 0x0A, 0xF0, 0x7D, 0x01, 0x51, 0xBA, 0x90, 0x82, - 0xC7, 0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0x82, 0xC5, 0xE0, 0xFF, 0x91, 0x4A, 0x90, - 0x82, 0xC7, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x04, 0x80, 0xE0, 0x54, 0x0F, 0xFD, 0xAC, 0x07, - 0x91, 0x92, 0x44, 0x01, 0xF0, 0x91, 0x92, 0x54, 0xFB, 0xF0, 0xAC, 0x07, 0x74, 0x16, 0x2C, 0x91, - 0x69, 0xE0, 0x44, 0xFA, 0xF0, 0x74, 0x15, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, - 0x44, 0x1F, 0xF0, 0xAC, 0x07, 0x74, 0x06, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, - 0x44, 0x0F, 0xF0, 0x90, 0x04, 0x53, 0xE4, 0xF0, 0x90, 0x04, 0x52, 0xF0, 0x90, 0x04, 0x51, 0x74, - 0xFF, 0xF0, 0x90, 0x04, 0x50, 0x74, 0xFD, 0xF0, 0x74, 0x14, 0x2C, 0x91, 0x8A, 0xE0, 0x54, 0xC0, - 0x4D, 0xFD, 0x74, 0x14, 0x2F, 0x91, 0x8A, 0xED, 0xF0, 0x22, 0x91, 0x7E, 0x54, 0x3F, 0xF0, 0xEF, - 0x60, 0x0A, 0x91, 0x71, 0x44, 0x10, 0x91, 0x7D, 0x44, 0x80, 0xF0, 0x22, 0x91, 0x71, 0x54, 0xEF, - 0x91, 0x7D, 0x44, 0x40, 0xF0, 0x22, 0x74, 0x16, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, - 0x22, 0x74, 0x21, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xF0, 0x74, 0x1F, - 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, - 0x83, 0x22, 0x74, 0x11, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0x90, 0x82, - 0xC5, 0xE0, 0xFF, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x82, 0xF0, 0xEF, 0xF0, 0x90, - 0x80, 0x4C, 0xE0, 0xFF, 0x90, 0x04, 0x1C, 0xE0, 0x6F, 0x70, 0x40, 0x90, 0x81, 0x74, 0xE0, 0x64, - 0x0E, 0x70, 0x18, 0x90, 0x82, 0xF0, 0xE0, 0x70, 0x32, 0x90, 0x81, 0x6C, 0xE0, 0x54, 0x7F, 0xF0, - 0xB1, 0x1F, 0x7D, 0x0C, 0x7F, 0x01, 0x12, 0x4F, 0x1F, 0x80, 0x1E, 0x90, 0x81, 0x74, 0xE0, 0x64, - 0x06, 0x70, 0x18, 0x90, 0x82, 0xF0, 0xE0, 0x60, 0x12, 0x90, 0x81, 0x6C, 0xE0, 0x54, 0xBF, 0xF0, - 0x12, 0x7C, 0xA7, 0x90, 0x81, 0x74, 0x74, 0x04, 0xF0, 0xB1, 0x0E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, - 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x22, 0xE4, 0xFD, 0x7F, 0x0C, 0x12, 0x4D, 0x2E, 0xE4, 0xFD, - 0xFF, 0x02, 0x4D, 0x04, 0xB1, 0x1F, 0xB1, 0x0E, 0x7D, 0x0C, 0x7F, 0x01, 0x02, 0x4F, 0x1F, 0x90, - 0x06, 0x04, 0xE0, 0x54, 0x7F, 0xF0, 0x22, 0x7E, 0x00, 0x7F, 0x62, 0x7D, 0x00, 0x7B, 0x01, 0x7A, - 0x81, 0x79, 0x6C, 0x12, 0x47, 0x16, 0x90, 0x81, 0x70, 0x74, 0x02, 0xF0, 0x90, 0x81, 0x77, 0x14, - 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0x90, 0x81, 0x7D, 0xE4, 0xF0, 0xA3, 0x74, 0x02, 0xB1, - 0xCF, 0xE4, 0xFD, 0xFF, 0x12, 0x4F, 0x1F, 0x7D, 0x0C, 0x7F, 0x02, 0x12, 0x4F, 0x1F, 0x7D, 0x0C, - 0x7F, 0x01, 0x12, 0x4F, 0x1F, 0x90, 0x80, 0x07, 0xE0, 0xFF, 0xB4, 0x01, 0x08, 0x90, 0x81, 0x7C, - 0x74, 0x99, 0xF0, 0x80, 0x29, 0xEF, 0xB4, 0x03, 0x08, 0x90, 0x81, 0x7C, 0x74, 0x90, 0xF0, 0x80, - 0x1D, 0x90, 0x81, 0x7C, 0x74, 0x40, 0xF0, 0x90, 0x00, 0x2C, 0xE0, 0x54, 0x0F, 0xFF, 0xBF, 0x05, - 0x08, 0x90, 0x81, 0x8E, 0x74, 0x02, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x81, 0x8E, 0xF0, 0x90, 0x81, - 0xCE, 0x74, 0x02, 0xF0, 0xA3, 0x74, 0x0F, 0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, - 0x74, 0x07, 0xB1, 0xCF, 0x7E, 0x00, 0x7F, 0x02, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x81, 0x79, 0xD2, - 0x12, 0x47, 0x16, 0xB1, 0x1F, 0xF1, 0xE4, 0xB1, 0x0E, 0xE4, 0x90, 0x81, 0xD4, 0xF0, 0x22, 0xF0, - 0x90, 0x81, 0x8E, 0xE0, 0x24, 0x04, 0x90, 0x81, 0x89, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0x22, 0x90, - 0x81, 0x71, 0xE0, 0x64, 0x01, 0x70, 0x12, 0x12, 0x55, 0x6D, 0x60, 0x04, 0xB1, 0x07, 0x41, 0x51, - 0x90, 0x81, 0x74, 0xE0, 0x70, 0x03, 0x12, 0x4D, 0x2A, 0x22, 0x12, 0x4F, 0x9E, 0x70, 0x16, 0x90, - 0x81, 0x71, 0xE0, 0x60, 0x10, 0x12, 0x5F, 0xDA, 0xF0, 0x90, 0x81, 0x6C, 0xE0, 0xD1, 0x16, 0x54, - 0x07, 0x70, 0x02, 0x31, 0x3D, 0x22, 0x54, 0xFB, 0xF0, 0x90, 0x81, 0x75, 0xE0, 0x54, 0xFD, 0xF0, - 0x22, 0x90, 0x81, 0x6C, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x19, 0xEF, 0x54, - 0xBF, 0xD1, 0x78, 0x30, 0xE0, 0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x09, 0xE0, 0x54, 0xFE, 0x12, - 0x4F, 0xF7, 0x74, 0x04, 0xF0, 0x31, 0x3D, 0xE4, 0xFF, 0x02, 0x57, 0x05, 0x90, 0x81, 0x6C, 0x12, - 0x4F, 0xDB, 0x30, 0xE0, 0x1E, 0xEF, 0x54, 0x7F, 0xD1, 0x78, 0x30, 0xE1, 0x06, 0xE0, 0x44, 0x02, - 0xF0, 0x80, 0x08, 0xE0, 0x54, 0xFD, 0x12, 0x4F, 0xF7, 0x04, 0xF0, 0x90, 0x81, 0x71, 0xE0, 0x60, - 0x02, 0x31, 0x3D, 0x7F, 0x01, 0x02, 0x57, 0x05, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0x81, 0x6D, - 0x22, 0x7F, 0xFF, 0x12, 0x4D, 0x04, 0xE4, 0x90, 0x82, 0xDE, 0xF0, 0xA3, 0xF0, 0x90, 0x05, 0x22, - 0xE0, 0x90, 0x82, 0xE0, 0xF0, 0x7D, 0x47, 0x7F, 0xFF, 0x12, 0x4D, 0x04, 0x90, 0x05, 0xF8, 0xE0, - 0x70, 0x11, 0xA3, 0xE0, 0x70, 0x0D, 0xA3, 0xE0, 0x70, 0x09, 0xA3, 0xE0, 0x70, 0x05, 0xD1, 0xDD, - 0x7F, 0x01, 0x22, 0xD3, 0x90, 0x82, 0xDF, 0xE0, 0x94, 0xE8, 0x90, 0x82, 0xDE, 0xE0, 0x94, 0x03, - 0x40, 0x0C, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x20, 0xF0, 0xD1, 0xDD, 0x7F, 0x00, 0x22, 0x7F, 0x32, - 0x7E, 0x00, 0x12, 0x32, 0xAA, 0x90, 0x82, 0xDE, 0x12, 0x5B, 0x9F, 0x80, 0xBF, 0x90, 0x82, 0xE0, - 0xE0, 0xFF, 0x7D, 0x48, 0x02, 0x4D, 0x04, 0x7D, 0x2D, 0xD1, 0x81, 0x90, 0x01, 0x37, 0x74, 0x02, - 0xF0, 0xFD, 0x7F, 0x03, 0x12, 0x5E, 0x0D, 0xF1, 0x05, 0xE4, 0xFD, 0x7F, 0x01, 0x02, 0x4F, 0x1F, - 0x7F, 0xFF, 0x12, 0x4D, 0x04, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xD1, 0x86, 0x90, 0x85, - 0xBB, 0x12, 0x20, 0xDA, 0xCC, 0xF0, 0x00, 0xC0, 0xF1, 0x67, 0x12, 0x20, 0xDA, 0x00, 0x00, 0x00, - 0x14, 0xF1, 0xD3, 0x12, 0x20, 0xDA, 0x00, 0x00, 0x00, 0x00, 0xE4, 0xFD, 0xFF, 0x12, 0x6C, 0x5B, - 0xF1, 0xCA, 0x44, 0x80, 0xFC, 0x90, 0x82, 0xD6, 0x12, 0x20, 0xCE, 0x90, 0x82, 0xD6, 0xF1, 0x5E, - 0x7F, 0x7C, 0x7E, 0x08, 0x12, 0x2E, 0xA2, 0x90, 0x01, 0x00, 0x74, 0x3F, 0xF0, 0xA3, 0xE0, 0x54, - 0xFD, 0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, 0x20, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x46, - 0xC6, 0x90, 0x85, 0xBB, 0x02, 0x20, 0xCE, 0x7F, 0x8C, 0x7E, 0x08, 0x12, 0x2E, 0xA2, 0x90, 0x85, - 0xBB, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 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, 0xF1, 0xCA, 0x54, 0x7F, 0xFC, 0x90, 0x82, 0xD2, 0x12, 0x20, 0xCE, 0x90, 0x82, 0xD2, - 0xF1, 0x5E, 0x7F, 0x7C, 0xF1, 0x69, 0x12, 0x20, 0xDA, 0xCC, 0xC0, 0x00, 0xC0, 0xF1, 0x67, 0x12, - 0x20, 0xDA, 0x00, 0xC0, 0x00, 0x14, 0xF1, 0xD3, 0x12, 0x20, 0xDA, 0x00, 0x03, 0x3E, 0x60, 0xE4, - 0xFD, 0xFF, 0x12, 0x6C, 0x5B, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x7C, 0x7E, 0x08, 0x12, 0x2D, - 0x5C, 0xEC, 0x22, 0x7F, 0x70, 0x7E, 0x0E, 0x12, 0x2E, 0xA2, 0x90, 0x82, 0xBB, 0x22, 0x7D, 0x08, - 0xE4, 0xFF, 0x61, 0x71, 0x90, 0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x22, 0xE4, 0xFB, 0xFA, 0xFD, - 0x7F, 0x01, 0x12, 0x45, 0x4E, 0x90, 0x82, 0x09, 0xEF, 0xF0, 0x60, 0xF0, 0x90, 0x80, 0x01, 0xE0, - 0xFF, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0xE5, 0xC2, 0xAF, 0xEF, 0x30, 0xE1, 0x09, 0x90, 0x80, 0x01, - 0xE0, 0x54, 0xFD, 0xF0, 0x11, 0x40, 0x11, 0x37, 0xFF, 0x30, 0xE2, 0x05, 0x54, 0xFB, 0xF0, 0x11, - 0xA1, 0x11, 0x37, 0xFF, 0x30, 0xE5, 0x0C, 0x54, 0xDF, 0xF0, 0x12, 0x5D, 0x40, 0xBF, 0x01, 0x03, - 0x12, 0x74, 0x8E, 0xD2, 0xAF, 0x80, 0xC5, 0xD2, 0xAF, 0xC2, 0xAF, 0x90, 0x80, 0x01, 0xE0, 0x22, - 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x80, 0xA2, 0xE0, 0xFF, 0x90, 0x80, 0xA1, 0xE0, - 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x70, 0x40, 0x90, 0x80, 0xA1, 0xE0, - 0xFE, 0x75, 0xF0, 0x08, 0x90, 0x80, 0x51, 0x12, 0x46, 0xD2, 0xE0, 0xFD, 0xEE, 0x75, 0xF0, 0x08, - 0xA4, 0x24, 0x52, 0xF9, 0x74, 0x80, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xAF, 0x05, 0x12, 0x52, 0xBD, - 0x90, 0x80, 0xA1, 0x31, 0x08, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0x80, - 0xA1, 0xF0, 0x12, 0x49, 0x38, 0x90, 0x80, 0x01, 0xE0, 0x44, 0x02, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, - 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x90, 0x81, 0x3A, 0xE0, 0xFE, 0x90, - 0x81, 0x39, 0xE0, 0xFD, 0xB5, 0x06, 0x04, 0x7E, 0x01, 0x80, 0x02, 0x7E, 0x00, 0xEE, 0x64, 0x01, - 0x60, 0x41, 0x90, 0x01, 0xAF, 0xE0, 0x70, 0x0A, 0xED, 0x31, 0x6C, 0xFA, 0x7B, 0x01, 0x51, 0x77, - 0x7F, 0x01, 0xEF, 0x60, 0x2E, 0x90, 0x81, 0x39, 0x31, 0x08, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, - 0x60, 0x05, 0xE4, 0x90, 0x81, 0x39, 0xF0, 0x90, 0x81, 0x3A, 0xE0, 0xFF, 0x90, 0x81, 0x39, 0xE0, - 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x70, 0x07, 0x90, 0x80, 0x01, 0xE0, - 0x44, 0x04, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0x22, 0xD3, - 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x81, 0x39, 0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, - 0x09, 0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0x81, 0x3A, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, - 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x09, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x28, 0xC0, - 0x01, 0x90, 0x81, 0x3A, 0xE0, 0x31, 0x6C, 0xA8, 0x01, 0xFC, 0x7D, 0x01, 0xD0, 0x01, 0x7E, 0x00, - 0x7F, 0x0F, 0x12, 0x46, 0x7D, 0x90, 0x81, 0x3A, 0x31, 0x08, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, - 0x60, 0x05, 0xE4, 0x90, 0x81, 0x3A, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x75, 0xF0, 0x0F, 0xA4, - 0x24, 0xA3, 0xF9, 0x74, 0x80, 0x35, 0xF0, 0x22, 0xE4, 0x90, 0x81, 0xF6, 0xF0, 0x90, 0x81, 0xF4, - 0x74, 0x14, 0xF0, 0x90, 0x82, 0x02, 0x74, 0x01, 0xF0, 0xFB, 0x7A, 0x81, 0x79, 0xF4, 0x31, 0x0F, - 0x7F, 0x04, 0x90, 0x82, 0xE9, 0xEF, 0xF0, 0x7F, 0x02, 0x12, 0x45, 0x27, 0x90, 0x80, 0x01, 0xE0, - 0xFF, 0x90, 0x82, 0xE9, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x80, 0x01, 0xF0, 0x22, 0x90, 0x82, 0x19, - 0x74, 0x12, 0xF0, 0x90, 0x82, 0x27, 0x74, 0x05, 0xF0, 0x90, 0x82, 0x1B, 0xEF, 0xF0, 0xA3, 0xED, - 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x82, 0x17, 0xE0, 0x90, 0x82, 0x1E, 0xF0, 0x90, 0x82, 0x18, 0xE0, - 0x90, 0x82, 0x1F, 0xF0, 0x7B, 0x01, 0x7A, 0x82, 0x79, 0x19, 0x31, 0x0F, 0x7F, 0x04, 0x80, 0xB2, - 0x51, 0x5D, 0x7F, 0xF5, 0x7E, 0x00, 0x12, 0x2B, 0x27, 0xBF, 0x01, 0x06, 0x90, 0x82, 0x0E, 0xE0, - 0xA3, 0xF0, 0x51, 0x5D, 0x7F, 0xF6, 0x7E, 0x00, 0x12, 0x2B, 0x27, 0xBF, 0x01, 0x08, 0x90, 0x82, - 0x0E, 0xE0, 0x90, 0x82, 0x10, 0xF0, 0x51, 0x5D, 0x7F, 0xF4, 0x7E, 0x00, 0x12, 0x2B, 0x27, 0xBF, - 0x01, 0x08, 0x90, 0x82, 0x0E, 0xE0, 0x90, 0x82, 0x11, 0xF0, 0x51, 0x5D, 0x7F, 0xF3, 0x7E, 0x00, - 0x12, 0x2B, 0x27, 0xBF, 0x01, 0x08, 0x90, 0x82, 0x0E, 0xE0, 0x90, 0x82, 0x12, 0xF0, 0x51, 0x5D, - 0x7F, 0xF2, 0x7E, 0x00, 0x12, 0x2B, 0x27, 0xBF, 0x01, 0x08, 0x90, 0x82, 0x0E, 0xE0, 0x90, 0x82, - 0x13, 0xF0, 0x90, 0x82, 0x0F, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, - 0x82, 0x17, 0xF0, 0x90, 0x82, 0x13, 0xE0, 0x90, 0x82, 0x18, 0xF0, 0x21, 0xAD, 0x7B, 0x01, 0x7A, - 0x82, 0x79, 0x0E, 0x22, 0x12, 0x1F, 0xA4, 0xFF, 0x90, 0x81, 0x62, 0xF0, 0xBF, 0x01, 0x07, 0x31, - 0xE0, 0xE4, 0x90, 0x81, 0x62, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x82, - 0x0A, 0x12, 0x46, 0xE7, 0x90, 0x82, 0xE2, 0xE0, 0xFF, 0x04, 0xF0, 0x90, 0x00, 0x01, 0xEF, 0x12, - 0x1F, 0xFC, 0x7F, 0xAF, 0x7E, 0x01, 0x12, 0x5B, 0x54, 0xEF, 0x60, 0x3A, 0x90, 0x82, 0x0A, 0x12, - 0x46, 0xDE, 0x8B, 0x13, 0x8A, 0x14, 0x89, 0x15, 0x90, 0x00, 0x0E, 0x12, 0x1F, 0xBD, 0x24, 0x02, - 0xF5, 0x16, 0x7B, 0x01, 0x7A, 0x01, 0x79, 0xA0, 0x12, 0x2B, 0xED, 0x90, 0x82, 0x0A, 0x12, 0x46, - 0xDE, 0x90, 0x00, 0x0E, 0x12, 0x1F, 0xBD, 0x90, 0x01, 0xAE, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0x90, - 0x01, 0xCB, 0xE0, 0x64, 0x80, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x82, 0x98, 0xEF, 0xF0, - 0xA3, 0xED, 0xF0, 0xA3, 0x12, 0x20, 0xDA, 0x00, 0x00, 0x00, 0x00, 0xE4, 0x90, 0x82, 0xA6, 0xF0, - 0x7F, 0x24, 0x7E, 0x08, 0x12, 0x2D, 0x5C, 0x90, 0x82, 0x9E, 0x12, 0x20, 0xCE, 0x90, 0x82, 0x98, - 0xE0, 0xFB, 0x70, 0x08, 0x90, 0x82, 0x9E, 0x12, 0x46, 0xC6, 0x80, 0x06, 0xEB, 0x71, 0xC4, 0x12, - 0x2D, 0x5C, 0x90, 0x82, 0xA2, 0x12, 0x20, 0xCE, 0x90, 0x82, 0x99, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, - 0xFE, 0x78, 0x17, 0x91, 0x41, 0x90, 0x82, 0xA2, 0x12, 0x46, 0xC6, 0xED, 0x54, 0x7F, 0xFD, 0xEC, - 0x54, 0x80, 0xFC, 0x12, 0x46, 0xB9, 0xEC, 0x44, 0x80, 0xFC, 0x90, 0x82, 0xA2, 0x12, 0x20, 0xCE, - 0x71, 0xD7, 0x54, 0x7F, 0xFC, 0x12, 0x67, 0x61, 0x71, 0xDF, 0x71, 0xC4, 0xC0, 0x06, 0xC0, 0x07, - 0x90, 0x82, 0xA2, 0x12, 0x67, 0x5E, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x2E, 0xA2, 0x71, 0xD7, 0x44, - 0x80, 0xFC, 0x12, 0x67, 0x61, 0x71, 0xDF, 0x70, 0x04, 0x7F, 0x20, 0x80, 0x09, 0x90, 0x82, 0x98, - 0xE0, 0xB4, 0x01, 0x16, 0x7F, 0x28, 0x7E, 0x08, 0x12, 0x2D, 0x5C, 0x78, 0x08, 0x12, 0x20, 0xA8, - 0xEF, 0x54, 0x01, 0xFF, 0xE4, 0x90, 0x82, 0xA6, 0xEF, 0xF0, 0x90, 0x82, 0xA6, 0xE0, 0x90, 0x82, - 0x98, 0x60, 0x0E, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x66, 0xF5, 0x82, 0xE4, 0x34, 0x87, 0x80, - 0x0C, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x64, 0xF5, 0x82, 0xE4, 0x34, 0x87, 0x71, 0xCF, 0x12, - 0x2D, 0x5C, 0xED, 0x54, 0x0F, 0xFD, 0xE4, 0xFC, 0x90, 0x82, 0x9A, 0x12, 0x20, 0xCE, 0x90, 0x82, - 0x9A, 0x02, 0x46, 0xC6, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x62, 0xF5, 0x82, 0xE4, 0x34, 0x87, 0xF5, - 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x90, 0x82, 0x9E, 0x12, 0x46, 0xC6, 0xEC, 0x22, 0x7F, - 0x24, 0x7E, 0x08, 0x12, 0x2E, 0xA2, 0x90, 0x82, 0x98, 0xE0, 0x22, 0x90, 0x82, 0xA7, 0xEF, 0xF0, - 0xAB, 0x05, 0x90, 0x82, 0xAD, 0x12, 0x20, 0xDA, 0x00, 0x00, 0x00, 0x00, 0xAF, 0x03, 0xE4, 0xFC, - 0xFD, 0xFE, 0x78, 0x14, 0x91, 0x41, 0x90, 0x82, 0xA9, 0x12, 0x46, 0xC6, 0xED, 0x54, 0x0F, 0xFD, - 0xE4, 0xFC, 0x12, 0x46, 0xB9, 0xEC, 0x54, 0x0F, 0xFC, 0x90, 0x82, 0xAD, 0x12, 0x20, 0xCE, 0x90, - 0x82, 0xA7, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x60, 0xF5, 0x82, 0xE4, 0x34, 0x87, 0x71, 0xCF, - 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x82, 0xAD, 0x12, 0x67, 0x5E, 0xD0, 0x07, 0xD0, 0x06, 0x02, 0x2E, - 0xA2, 0x12, 0x20, 0xBB, 0xA8, 0x04, 0xA9, 0x05, 0xAA, 0x06, 0xAB, 0x07, 0x22, 0xD3, 0x10, 0xAF, - 0x01, 0xC3, 0xC0, 0xD0, 0x51, 0xDB, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, - 0xC0, 0xD0, 0xC0, 0x07, 0xC0, 0x05, 0x90, 0x82, 0xBB, 0x12, 0x46, 0xC6, 0x90, 0x82, 0xA9, 0x12, - 0x20, 0xCE, 0xD0, 0x05, 0xD0, 0x07, 0x71, 0xEB, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x1F, 0xA4, - 0x54, 0x01, 0xFF, 0x90, 0x81, 0xEF, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x22, 0x12, 0x1F, 0xA4, 0x90, - 0x81, 0xD4, 0xF0, 0x22, 0x12, 0x1F, 0xA4, 0x90, 0x81, 0xE9, 0xF0, 0x22, 0xE4, 0x90, 0x81, 0x39, - 0xF0, 0xA3, 0xF0, 0x90, 0x80, 0xA1, 0xF0, 0xA3, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, - 0xD0, 0x7D, 0x08, 0xED, 0x14, 0xF9, 0x24, 0x63, 0x12, 0x57, 0x6D, 0xE0, 0x60, 0x3B, 0x7C, 0x08, - 0xEC, 0x14, 0x90, 0x82, 0xEA, 0xF0, 0x74, 0x63, 0x29, 0x12, 0x57, 0x6D, 0xE0, 0xFB, 0x7A, 0x00, - 0x90, 0x82, 0xEA, 0x12, 0x57, 0xF8, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, - 0xEE, 0x5A, 0xFE, 0xEF, 0x5B, 0x4E, 0x60, 0x0F, 0xE9, 0x75, 0xF0, 0x08, 0xA4, 0xFF, 0x90, 0x82, - 0xEA, 0xE0, 0x2F, 0x04, 0xFF, 0x80, 0x06, 0xDC, 0xC7, 0xDD, 0xB8, 0x7F, 0x00, 0xD0, 0xD0, 0x92, - 0xAF, 0x22, 0x75, 0x3D, 0x10, 0xE4, 0xF5, 0x3E, 0x75, 0x3F, 0x87, 0x75, 0x40, 0x03, 0x90, 0x01, - 0x30, 0xE5, 0x3D, 0xF0, 0xA3, 0xE5, 0x3E, 0xF0, 0xA3, 0xE5, 0x3F, 0xF0, 0xA3, 0xE5, 0x40, 0xF0, - 0x22, 0x75, 0x45, 0x0E, 0x75, 0x46, 0x01, 0x75, 0x47, 0x23, 0x75, 0x48, 0x62, 0x90, 0x01, 0x38, - 0xE5, 0x45, 0xF0, 0xA3, 0xE5, 0x46, 0xF0, 0xA3, 0xE5, 0x47, 0xF0, 0xA3, 0xE5, 0x48, 0xF0, 0x22, - 0x7F, 0x02, 0x90, 0x81, 0xDC, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x18, 0xEF, 0x25, 0xE0, 0x24, - 0x81, 0xF8, 0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0xA3, 0xF0, 0x7F, 0x00, - 0x22, 0x0F, 0x80, 0xDE, 0x7F, 0x01, 0x22, 0x90, 0x01, 0x34, 0xE0, 0x55, 0x3D, 0xF5, 0x41, 0xA3, - 0xE0, 0x55, 0x3E, 0xF5, 0x42, 0xA3, 0xE0, 0x55, 0x3F, 0xF5, 0x43, 0xA3, 0xE0, 0x55, 0x40, 0xF5, - 0x44, 0x90, 0x01, 0x34, 0xE5, 0x41, 0xF0, 0xA3, 0xE5, 0x42, 0xF0, 0xA3, 0xE5, 0x43, 0xF0, 0xA3, - 0xE5, 0x44, 0xF0, 0x22, 0x90, 0x01, 0x3C, 0xE0, 0x55, 0x45, 0xF5, 0x49, 0xA3, 0xE0, 0x55, 0x46, - 0xF5, 0x4A, 0xA3, 0xE0, 0x55, 0x47, 0xF5, 0x4B, 0xA3, 0xE0, 0x55, 0x48, 0xF5, 0x4C, 0x90, 0x01, - 0x3C, 0xE5, 0x49, 0xF0, 0xA3, 0xE5, 0x4A, 0xF0, 0xA3, 0xE5, 0x4B, 0xF0, 0xA3, 0xE5, 0x4C, 0xF0, - 0x53, 0x91, 0xDF, 0x22, 0x90, 0x81, 0x3D, 0xE0, 0x30, 0xE0, 0x05, 0x7F, 0x20, 0x12, 0x49, 0x29, - 0x22, 0x90, 0x01, 0xCF, 0xE0, 0x90, 0x82, 0xEC, 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, 0x58, 0x9D, 0x90, 0x00, - 0x03, 0xE0, 0x54, 0xFB, 0xFD, 0x7F, 0x03, 0x12, 0x32, 0x1E, 0x80, 0xFE, 0x22, 0xF1, 0x04, 0x90, - 0x81, 0x71, 0xE0, 0x60, 0x2C, 0x90, 0x81, 0x6D, 0xF1, 0x20, 0x30, 0xE0, 0x0D, 0x90, 0x01, 0x3B, - 0xE0, 0x30, 0xE4, 0x06, 0x12, 0x5F, 0x31, 0x12, 0x5F, 0xBC, 0x90, 0x82, 0xEB, 0xE0, 0x04, 0xF0, - 0xE0, 0xC3, 0x94, 0x80, 0x40, 0x0B, 0x90, 0x01, 0x98, 0xE0, 0x54, 0xFE, 0xF0, 0xE0, 0x44, 0x01, - 0xF0, 0xD1, 0xE3, 0xBF, 0x03, 0x14, 0x90, 0x81, 0xE9, 0xE0, 0xB4, 0x01, 0x0D, 0x90, 0x01, 0xB8, - 0xE0, 0x04, 0xF0, 0x90, 0x05, 0x21, 0xE0, 0x44, 0x80, 0xF0, 0x12, 0x53, 0xC2, 0xF1, 0x35, 0xE4, - 0x90, 0x81, 0xE0, 0xF0, 0x12, 0x51, 0x5D, 0x90, 0x81, 0xD5, 0xE0, 0x30, 0xE0, 0x0B, 0xE4, 0xF5, - 0x1D, 0x90, 0x81, 0xD7, 0x12, 0x4C, 0x26, 0xD1, 0xDB, 0x90, 0x80, 0x07, 0xE0, 0xB4, 0x01, 0x0F, - 0xF1, 0x14, 0x20, 0xE0, 0x0C, 0xEF, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x04, 0x80, 0x00, 0xD1, - 0x92, 0x22, 0x90, 0x81, 0xD5, 0xE0, 0xFF, 0x30, 0xE0, 0x39, 0x90, 0x80, 0x07, 0xE0, 0x64, 0x01, - 0x70, 0x2A, 0xEF, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x29, 0x90, 0x82, 0xEF, 0xE0, 0x04, 0xF0, - 0xE0, 0xD3, 0x94, 0xC8, 0x40, 0x1D, 0x90, 0x81, 0xD5, 0xE0, 0x44, 0x20, 0xF0, 0xE4, 0x90, 0x82, - 0xEF, 0xF0, 0x90, 0x81, 0xD5, 0xE0, 0x13, 0x30, 0xE0, 0x09, 0x80, 0x05, 0xD1, 0xD4, 0x30, 0xE0, - 0x02, 0xF1, 0x27, 0x22, 0x90, 0x81, 0xD5, 0xE0, 0xC3, 0x13, 0x22, 0x90, 0x81, 0xD5, 0xE0, 0x44, - 0x04, 0xF0, 0x22, 0x90, 0x01, 0x02, 0xE0, 0x54, 0x03, 0xFF, 0x22, 0xD1, 0xE3, 0xBF, 0x03, 0x02, - 0xF1, 0x0C, 0x22, 0xF1, 0x04, 0x90, 0x05, 0x50, 0xE0, 0x44, 0x01, 0xF0, 0xD1, 0xE3, 0xBF, 0x03, - 0x02, 0xF1, 0x0C, 0x22, 0xE4, 0xF5, 0x4E, 0xF5, 0x4F, 0xF5, 0x50, 0x22, 0x90, 0x05, 0x21, 0xE0, - 0x54, 0x7F, 0xF0, 0x22, 0x90, 0x81, 0xD5, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x22, 0x90, 0x81, 0x6C, - 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0x90, 0x81, 0x6C, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x81, - 0x7C, 0x74, 0xD0, 0xF0, 0x22, 0x90, 0x81, 0xDD, 0xE0, 0x30, 0xE0, 0x35, 0x12, 0x4F, 0x9E, 0x70, - 0x30, 0x90, 0x82, 0xF2, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x0A, 0x0B, 0x90, 0x81, 0xDF, 0xE0, 0x04, - 0xF0, 0xE4, 0x90, 0x82, 0xF2, 0xF0, 0x90, 0x81, 0xDF, 0xE0, 0xFF, 0x90, 0x81, 0xDE, 0xE0, 0xD3, - 0x9F, 0x50, 0x0E, 0x90, 0x81, 0xE0, 0xE0, 0x70, 0x08, 0xE4, 0x90, 0x81, 0xDF, 0xF0, 0x12, 0x67, - 0xDE, 0x22, 0x90, 0x81, 0xE7, 0xE0, 0x04, 0xF0, 0x90, 0x81, 0x74, 0xE0, 0x64, 0x02, 0x60, 0x09, - 0x12, 0x5E, 0x4E, 0x90, 0x01, 0xE6, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x81, 0x71, 0xE0, 0x60, 0x03, - 0x12, 0x65, 0xDF, 0x22, 0x12, 0x70, 0xB4, 0x90, 0x81, 0xF4, 0xEF, 0xF0, 0x30, 0xE0, 0x05, 0x7D, - 0x01, 0xE4, 0x80, 0x02, 0xE4, 0xFD, 0xFF, 0x12, 0x4F, 0x1F, 0x90, 0x81, 0xF4, 0xE0, 0x30, 0xE6, - 0x11, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x04, 0xE4, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, - 0x80, 0xF0, 0x90, 0x81, 0x6C, 0xE0, 0x90, 0x04, 0xEC, 0x30, 0xE0, 0x06, 0xE0, 0x54, 0xDD, 0xF0, - 0x80, 0x04, 0xE0, 0x44, 0x22, 0xF0, 0x12, 0x7C, 0x6F, 0x74, 0x02, 0xF0, 0xD3, 0x10, 0xAF, 0x01, - 0xC3, 0xC0, 0xD0, 0xAC, 0x07, 0x90, 0x81, 0x6D, 0xE0, 0x12, 0x4F, 0xDD, 0x30, 0xE0, 0x03, 0x02, - 0x70, 0x9D, 0x90, 0x81, 0x6C, 0xE0, 0x30, 0xE0, 0x16, 0x90, 0x81, 0x8E, 0xE0, 0x24, 0x04, 0x90, - 0x81, 0x86, 0xF0, 0x90, 0x81, 0x8E, 0xE0, 0x24, 0x03, 0x90, 0x81, 0x85, 0xF0, 0x80, 0x0D, 0x90, - 0x81, 0x86, 0x74, 0x02, 0xF0, 0x90, 0x81, 0x85, 0x14, 0xF0, 0x0B, 0x0B, 0x90, 0x81, 0x85, 0xE0, - 0xFA, 0x90, 0x81, 0x84, 0xE0, 0xD3, 0x9A, 0x50, 0x0E, 0x90, 0x81, 0x79, 0xEB, 0xF0, 0x90, 0x81, - 0x86, 0xE0, 0xC3, 0x9D, 0x2C, 0x80, 0x11, 0xC3, 0xED, 0x9A, 0x2B, 0x90, 0x81, 0x79, 0xF0, 0x90, - 0x81, 0x85, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, 0x81, 0x89, 0xF0, 0x90, 0x81, 0x86, 0xE0, - 0xFF, 0x24, 0x0A, 0xFD, 0xE4, 0x33, 0xFC, 0x90, 0x81, 0x89, 0x11, 0xA9, 0x40, 0x04, 0xEF, 0x24, - 0x0A, 0xF0, 0x90, 0x81, 0x89, 0xE0, 0xFF, 0x24, 0x23, 0xFD, 0xE4, 0x33, 0xFC, 0x90, 0x81, 0x79, - 0x11, 0xA9, 0x40, 0x04, 0xEF, 0x24, 0x23, 0xF0, 0x90, 0x81, 0x89, 0xE0, 0xFF, 0x7E, 0x00, 0x90, - 0x81, 0x7D, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x05, 0x58, 0xE0, 0x6F, 0x70, 0x01, 0xE4, 0x60, - 0x03, 0x12, 0x5F, 0xEC, 0x90, 0x81, 0x6E, 0xE0, 0x54, 0xFE, 0xF0, 0x80, 0x07, 0x90, 0x81, 0x6E, - 0xE0, 0x44, 0x01, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xD3, 0x9D, 0xEC, 0x64, 0x80, 0xF8, - 0x74, 0x80, 0x98, 0x22, 0xE4, 0x90, 0x81, 0xF6, 0xF0, 0xA3, 0xF0, 0x90, 0x00, 0x83, 0xE0, 0x90, - 0x81, 0xF5, 0xF0, 0x90, 0x00, 0x83, 0xE0, 0xFE, 0x90, 0x81, 0xF5, 0xE0, 0xFF, 0xB5, 0x06, 0x01, - 0x22, 0xC3, 0x90, 0x81, 0xF7, 0xE0, 0x94, 0x64, 0x90, 0x81, 0xF6, 0xE0, 0x94, 0x00, 0x40, 0x08, - 0x11, 0xF0, 0x90, 0x81, 0xF5, 0xE0, 0xFF, 0x22, 0x90, 0x81, 0xF6, 0x12, 0x5B, 0x9F, 0x80, 0xCB, - 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x40, 0xF0, 0x22, 0xE4, 0x90, 0x81, 0xF8, 0xF0, 0xA3, 0xF0, 0x90, - 0x00, 0x9E, 0xE0, 0x90, 0x81, 0xFA, 0xF0, 0x90, 0x00, 0x9F, 0xE0, 0x90, 0x81, 0xFB, 0xF0, 0xE0, - 0xFD, 0xFE, 0x90, 0x81, 0xFA, 0xE0, 0xFC, 0xFB, 0xEB, 0xFF, 0x90, 0x81, 0xF6, 0xEE, 0xF0, 0xA3, - 0xEF, 0xF0, 0x90, 0x00, 0x9E, 0xE0, 0xFF, 0xEC, 0xB5, 0x07, 0x09, 0xA3, 0xE0, 0xFF, 0xED, 0xB5, - 0x07, 0x02, 0x80, 0x11, 0xC3, 0x90, 0x81, 0xF9, 0xE0, 0x94, 0x64, 0x90, 0x81, 0xF8, 0xE0, 0x94, - 0x00, 0x40, 0x0B, 0x11, 0xF0, 0x90, 0x81, 0xF6, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x90, 0x81, - 0xF8, 0x12, 0x5B, 0x9F, 0x80, 0xA9, 0x90, 0x01, 0xC4, 0x74, 0x56, 0xF0, 0x74, 0x71, 0xA3, 0xF0, - 0x90, 0x00, 0x90, 0xE0, 0x20, 0xE0, 0xF9, 0x74, 0x56, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x71, - 0xA3, 0xF0, 0x22, 0x90, 0x81, 0x6D, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x81, 0x7C, 0xE0, 0xFD, 0x7F, - 0x93, 0x12, 0x32, 0x1E, 0x90, 0x81, 0x72, 0xE0, 0x60, 0x12, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, - 0x05, 0x74, 0x10, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, 0x90, 0x00, 0x08, 0xE0, - 0x44, 0x10, 0xFD, 0x7F, 0x08, 0x12, 0x32, 0x1E, 0x7F, 0x01, 0x12, 0x5B, 0xA6, 0x90, 0x00, 0x90, - 0xE0, 0x44, 0x01, 0xFD, 0x7F, 0x90, 0x12, 0x32, 0x1E, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x32, 0xAA, - 0x90, 0x81, 0xEA, 0xE0, 0x54, 0x7F, 0xF0, 0x54, 0xBF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xF0, 0xF0, - 0xE4, 0x90, 0x81, 0xEC, 0xF0, 0x90, 0x81, 0xEA, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0x90, 0x04, 0x1A, - 0xE0, 0xF4, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x90, 0x04, 0x1B, 0xE0, 0x54, 0x07, 0x64, 0x07, 0x7F, - 0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x31, 0xDD, 0xEF, - 0x64, 0x01, 0x60, 0x05, 0x75, 0x0F, 0x01, 0x80, 0x51, 0x90, 0x81, 0x75, 0xE0, 0xFF, 0x54, 0x03, - 0x60, 0x05, 0x75, 0x0F, 0x02, 0x80, 0x43, 0x90, 0x81, 0x73, 0xE0, 0xFE, 0xE4, 0xC3, 0x9E, 0x50, - 0x05, 0x75, 0x0F, 0x04, 0x80, 0x34, 0xEF, 0x30, 0xE2, 0x05, 0x75, 0x0F, 0x08, 0x80, 0x2B, 0x90, - 0x81, 0x75, 0xE0, 0x30, 0xE4, 0x05, 0x75, 0x0F, 0x10, 0x80, 0x1F, 0x90, 0x81, 0x6D, 0xE0, 0x13, - 0x13, 0x54, 0x3F, 0x20, 0xE0, 0x05, 0x75, 0x0F, 0x20, 0x80, 0x0F, 0x90, 0x81, 0xD4, 0xE0, 0x60, - 0x05, 0x75, 0x0F, 0x80, 0x80, 0x04, 0x51, 0x6D, 0x80, 0x0E, 0x90, 0x01, 0xB9, 0x74, 0x04, 0xF0, - 0x90, 0x01, 0xB8, 0xE5, 0x0F, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x01, 0xB8, - 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x02, 0x87, 0xE0, 0x60, 0x02, 0x80, 0x08, 0x90, 0x01, 0x00, - 0xE0, 0x64, 0x3F, 0x60, 0x05, 0x75, 0x52, 0x01, 0x80, 0x22, 0x90, 0x02, 0x96, 0xE0, 0x60, 0x05, - 0x75, 0x52, 0x10, 0x80, 0x17, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x02, 0x80, 0x07, 0x90, 0x02, - 0x86, 0xE0, 0x30, 0xE3, 0x05, 0x75, 0x52, 0x04, 0x80, 0x02, 0x80, 0xC1, 0x90, 0x01, 0xB9, 0x74, - 0x08, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x52, 0xF0, 0x7F, 0x00, 0x22, 0xEF, 0x24, 0xFE, 0x60, 0x0B, - 0x04, 0x70, 0x24, 0x90, 0x81, 0x77, 0x74, 0x02, 0xF0, 0x80, 0x13, 0xED, 0x70, 0x06, 0x90, 0x81, - 0xD1, 0xE0, 0x80, 0x02, 0xED, 0x14, 0x90, 0x81, 0x77, 0xF0, 0x90, 0x81, 0x77, 0xE0, 0xA3, 0xF0, - 0x90, 0x81, 0x6D, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0x7D, 0x2E, 0x7F, 0x6F, 0x12, 0x4D, 0x04, 0x7D, - 0x02, 0x7F, 0x01, 0x02, 0x4F, 0x1F, 0x90, 0x81, 0x6C, 0xE0, 0x30, 0xE0, 0x03, 0x12, 0x5D, 0x27, - 0x22, 0xE4, 0xF5, 0x51, 0x90, 0x81, 0x71, 0xE0, 0x60, 0x79, 0x12, 0x4F, 0x9E, 0x70, 0x74, 0x12, - 0x5F, 0x16, 0x60, 0x22, 0x24, 0xFE, 0x60, 0x03, 0x04, 0x70, 0x1E, 0x90, 0x81, 0x78, 0xE0, 0x14, - 0xF0, 0xE0, 0xFF, 0x60, 0x06, 0x90, 0x81, 0x7A, 0xE0, 0x60, 0x0E, 0xEF, 0x70, 0x08, 0x90, 0x81, - 0x77, 0xE0, 0xA3, 0xF0, 0x80, 0x00, 0x75, 0x51, 0x01, 0xE5, 0x51, 0x60, 0x46, 0x71, 0x8F, 0x90, - 0x81, 0x7A, 0xE0, 0x60, 0x04, 0x64, 0x01, 0x70, 0x16, 0xE4, 0xF5, 0x1D, 0x90, 0x81, 0x7A, 0xE0, - 0xFF, 0x90, 0x81, 0x79, 0xE0, 0x2F, 0x12, 0x4C, 0x27, 0x90, 0x81, 0x7A, 0xE0, 0x80, 0x10, 0xE4, - 0xF5, 0x1D, 0x71, 0x84, 0xFF, 0x90, 0x81, 0x79, 0xE0, 0x2F, 0x12, 0x4C, 0x27, 0x71, 0x84, 0xFF, - 0x90, 0x81, 0x79, 0xE0, 0x2F, 0x90, 0x81, 0x8A, 0xF0, 0x90, 0x81, 0x74, 0xE0, 0x20, 0xE2, 0x03, - 0x12, 0x4D, 0x2A, 0x22, 0x90, 0x81, 0x7A, 0xE0, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, 0x22, 0x90, - 0x81, 0x75, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x81, 0xD5, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, - 0xF0, 0x54, 0xFB, 0xF0, 0x44, 0x10, 0xF0, 0x22, 0x71, 0xC7, 0x90, 0x81, 0xDD, 0x71, 0xCF, 0x54, - 0x04, 0xFF, 0xEE, 0x54, 0xFB, 0x4F, 0xF0, 0x12, 0x1F, 0xA4, 0xC3, 0x13, 0x30, 0xE0, 0x07, 0x12, - 0x54, 0x48, 0x90, 0x81, 0xDE, 0xF0, 0x22, 0x12, 0x1F, 0xA4, 0xFF, 0x54, 0x01, 0xFE, 0x22, 0xE0, - 0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, 0x22, 0x90, 0x82, 0x0A, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, - 0x02, 0x84, 0xEF, 0xF0, 0xEE, 0xA3, 0xF0, 0xA3, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x7D, 0x7F, 0xEF, - 0x5D, 0xC3, 0x60, 0x0A, 0x91, 0x02, 0x24, 0x80, 0xFF, 0xE4, 0x3E, 0xFE, 0x80, 0x03, 0x91, 0x02, - 0xFF, 0x22, 0x74, 0xFF, 0x9D, 0xFD, 0x74, 0xFF, 0x94, 0x00, 0x5E, 0xFE, 0xED, 0x5F, 0x22, 0x7E, - 0x00, 0x7F, 0x08, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x81, 0x79, 0xE1, 0x12, 0x47, 0x16, 0x90, 0x81, - 0xE2, 0x74, 0x08, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0x22, 0x90, 0x82, 0x8D, 0x12, 0x46, 0xE7, 0xE4, - 0xFF, 0x90, 0x82, 0x93, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x1E, 0x90, 0x82, 0x90, 0x12, 0x46, - 0xDE, 0x8F, 0x82, 0x91, 0x72, 0xFE, 0x90, 0x82, 0x8D, 0x12, 0x46, 0xDE, 0x8F, 0x82, 0x91, 0x72, - 0x6E, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x0F, 0x80, 0xD8, 0x7F, 0x01, 0x22, 0x75, 0xF0, 0x03, 0xA4, - 0x24, 0x5E, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0x12, 0x46, 0xDE, 0x90, 0x82, 0x14, 0xE0, - 0xF5, 0x82, 0x75, 0x83, 0x00, 0x02, 0x1F, 0xBD, 0x74, 0x03, 0xF0, 0x7A, 0x82, 0x79, 0xB5, 0x91, - 0x29, 0xEF, 0x22, 0x74, 0x03, 0xF0, 0x7A, 0x82, 0x79, 0xB1, 0x91, 0x29, 0xEF, 0x22, 0x12, 0x5D, - 0xE4, 0x30, 0xE0, 0x0A, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x03, 0x02, 0x7B, 0x3A, 0x90, 0x81, - 0x5A, 0xE0, 0x90, 0x82, 0x6D, 0xF0, 0x90, 0x81, 0x5B, 0xE0, 0x90, 0x82, 0x6E, 0xF0, 0x90, 0x81, - 0x5C, 0xE0, 0x90, 0x82, 0x6F, 0xF0, 0x90, 0x81, 0x5D, 0xE0, 0x90, 0x82, 0x70, 0xF0, 0x90, 0x81, - 0x5E, 0xE0, 0x90, 0x82, 0x71, 0xF0, 0x90, 0x81, 0x4B, 0xE0, 0x90, 0x82, 0x72, 0xF0, 0x90, 0x81, - 0x4C, 0xE0, 0x90, 0x82, 0x73, 0xF0, 0x90, 0x81, 0x4D, 0xE0, 0x90, 0x82, 0x74, 0xF0, 0x90, 0x81, - 0x4E, 0xE0, 0x90, 0x82, 0x75, 0xF0, 0x90, 0x81, 0x4F, 0xE0, 0x90, 0x82, 0x76, 0xF0, 0x90, 0x81, - 0x50, 0xE0, 0x90, 0x82, 0x77, 0xF0, 0x90, 0x81, 0x51, 0xE0, 0x90, 0x82, 0x78, 0xF0, 0x90, 0x81, - 0x52, 0xE0, 0x90, 0x82, 0x79, 0xF0, 0x90, 0x81, 0x53, 0xE0, 0x90, 0x82, 0x7A, 0xF0, 0x90, 0x81, - 0x54, 0xE0, 0x90, 0x82, 0x7B, 0xF0, 0x12, 0x58, 0xC3, 0x90, 0x82, 0x15, 0xF0, 0x12, 0x7B, 0x5C, - 0x50, 0x05, 0x12, 0x7B, 0x48, 0x80, 0xF6, 0x90, 0x01, 0x1F, 0xE0, 0xFE, 0x90, 0x01, 0x1E, 0x12, - 0x7C, 0xD3, 0x90, 0x82, 0x0A, 0xF0, 0xA3, 0x12, 0x7B, 0xE1, 0x12, 0x7B, 0x5C, 0x50, 0x51, 0x12, - 0x63, 0x4D, 0x90, 0x82, 0x15, 0xE0, 0xFE, 0x24, 0x7C, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0x12, 0x7C, - 0x60, 0xE0, 0x24, 0x45, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x17, 0x2E, - 0xF5, 0x82, 0xE4, 0x34, 0x82, 0x12, 0x7C, 0x60, 0xE0, 0x24, 0x46, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, - 0x7B, 0x01, 0xEE, 0x12, 0x7B, 0xF8, 0x12, 0x46, 0xE7, 0x12, 0x7C, 0x64, 0xE0, 0x24, 0x30, 0xF9, - 0xE4, 0x34, 0xFC, 0xFA, 0xEE, 0x12, 0x7B, 0xE9, 0x12, 0x46, 0xE7, 0x12, 0x7B, 0x55, 0x80, 0xAA, - 0x90, 0x02, 0x87, 0xE0, 0x70, 0x03, 0x02, 0x7B, 0x3A, 0x90, 0x81, 0x3D, 0xE0, 0x20, 0xE0, 0x03, - 0x02, 0x7B, 0x3A, 0xC3, 0x13, 0x30, 0xE0, 0x0A, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x03, 0x02, - 0x7B, 0x3A, 0xE4, 0x90, 0x82, 0x86, 0x12, 0x58, 0xCB, 0x90, 0x82, 0x0A, 0xE0, 0xFF, 0xA3, 0xE0, - 0xA3, 0xCF, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x82, 0x0C, 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, 0x12, 0x7C, 0xCA, 0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x54, 0x3F, 0x90, 0x82, - 0x0E, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, - 0x54, 0x0F, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0x82, 0x11, 0xF0, 0xFC, 0x74, 0x07, 0x2D, 0xF5, - 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0xC0, 0x90, 0x82, 0x13, 0xF0, 0xEC, 0x24, 0x18, - 0x90, 0x82, 0x10, 0xF0, 0xFD, 0x90, 0x82, 0x0C, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x59, 0xD2, - 0xEF, 0x54, 0xFC, 0x90, 0x82, 0x12, 0xF0, 0x90, 0x82, 0x11, 0xE0, 0x24, 0x18, 0xFF, 0xE4, 0x33, - 0x90, 0x82, 0x0E, 0x8F, 0xF0, 0x12, 0x46, 0xA3, 0x90, 0x82, 0x0E, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, - 0x71, 0xED, 0x90, 0x82, 0x0A, 0xEE, 0x8F, 0xF0, 0x12, 0x46, 0xA3, 0x90, 0x81, 0x3B, 0xE0, 0xFE, - 0xA3, 0xE0, 0xFF, 0x90, 0x82, 0x0A, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xD3, 0x9F, 0xEC, 0x9E, 0x40, - 0x12, 0x90, 0x81, 0x3C, 0x12, 0x7C, 0x8E, 0xED, 0x9F, 0xFF, 0xEC, 0x9E, 0x90, 0x82, 0x0A, 0xF0, - 0xA3, 0xEF, 0xF0, 0x90, 0x81, 0xD5, 0xE0, 0x30, 0xE0, 0x0A, 0x13, 0x13, 0x54, 0x3F, 0x20, 0xE0, - 0x03, 0x02, 0x7B, 0x34, 0x12, 0x5D, 0xE4, 0x20, 0xE0, 0x03, 0x02, 0x78, 0xCA, 0xE4, 0x90, 0x82, - 0x16, 0xF0, 0x90, 0x82, 0x15, 0xF0, 0x12, 0x7B, 0x5C, 0x50, 0x39, 0x12, 0x63, 0x4D, 0xE4, 0x90, - 0x82, 0x14, 0xF0, 0x12, 0x7B, 0x8C, 0x94, 0x06, 0x50, 0x16, 0x12, 0x7B, 0x3B, 0x24, 0x04, 0x12, - 0x5B, 0x45, 0x90, 0x82, 0x15, 0xE0, 0x91, 0x5C, 0xB5, 0x07, 0x05, 0x12, 0x5A, 0xA6, 0x80, 0xE3, - 0x90, 0x82, 0x14, 0xE0, 0xB4, 0x06, 0x08, 0x90, 0x82, 0x16, 0x74, 0x01, 0xF0, 0x80, 0x05, 0x12, - 0x7B, 0x55, 0x80, 0xC2, 0x90, 0x82, 0x12, 0xE0, 0x24, 0x60, 0x70, 0x03, 0x02, 0x78, 0x76, 0x24, - 0xFC, 0x70, 0x03, 0x02, 0x78, 0x76, 0x24, 0xF4, 0x70, 0x03, 0x02, 0x78, 0x6B, 0x24, 0xF0, 0x70, - 0x03, 0x02, 0x78, 0x76, 0x24, 0x80, 0x60, 0x03, 0x02, 0x78, 0x89, 0x12, 0x7B, 0x3B, 0x24, 0x18, - 0xFD, 0x12, 0x59, 0xD2, 0xEF, 0x60, 0x03, 0x02, 0x7A, 0x13, 0x12, 0x7B, 0x3B, 0x24, 0x19, 0xFD, - 0x12, 0x59, 0xD2, 0x90, 0x82, 0x2B, 0x12, 0x7B, 0x9E, 0x12, 0x7B, 0x87, 0x9F, 0x50, 0x0B, 0x12, - 0x7B, 0x3B, 0x12, 0x5A, 0xC1, 0x12, 0x5A, 0xA2, 0x80, 0xEF, 0x90, 0x82, 0x2B, 0xE0, 0x70, 0x02, - 0xE1, 0xCC, 0xE4, 0x90, 0x82, 0x15, 0xF0, 0x12, 0x7B, 0x5C, 0x50, 0x67, 0x12, 0x63, 0x4D, 0x12, - 0x7C, 0x16, 0x70, 0x1E, 0x12, 0x7B, 0xF7, 0x12, 0x46, 0xDE, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, - 0x12, 0x7B, 0x77, 0xED, 0xF0, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x91, 0x29, 0xEF, 0x60, 0x02, - 0x80, 0x27, 0x90, 0x82, 0x2B, 0xE0, 0x64, 0x03, 0x70, 0x2C, 0x12, 0x7B, 0x77, 0x91, 0x78, 0x70, - 0x07, 0x12, 0x7B, 0x77, 0x91, 0x83, 0x60, 0x19, 0x12, 0x7C, 0x06, 0x60, 0x02, 0x80, 0x05, 0x12, - 0x7B, 0xAD, 0x60, 0x05, 0x74, 0x86, 0x2F, 0x80, 0x10, 0x12, 0x7B, 0x69, 0x74, 0x01, 0xF0, 0x80, - 0x0D, 0x12, 0x7B, 0xA6, 0x80, 0x03, 0x12, 0x7B, 0xA6, 0x12, 0x7B, 0x6F, 0xE4, 0xF0, 0x12, 0x7B, - 0x55, 0x80, 0x94, 0x90, 0x82, 0x86, 0xE0, 0x70, 0x55, 0xA3, 0xE0, 0x70, 0x51, 0xA3, 0xE0, 0x70, - 0x4D, 0xA3, 0xE0, 0x70, 0x49, 0xA3, 0xE0, 0x70, 0x45, 0x02, 0x7A, 0x13, 0xE4, 0x90, 0x82, 0x15, - 0xF0, 0x12, 0x7B, 0x5C, 0x50, 0x20, 0x74, 0x72, 0x2E, 0x12, 0x7B, 0xB4, 0x60, 0x0A, 0x74, 0x86, - 0x2E, 0x12, 0x7B, 0x6F, 0xE4, 0xF0, 0x80, 0x09, 0x74, 0x86, 0x2E, 0x12, 0x7B, 0x6F, 0x74, 0x01, - 0xF0, 0x12, 0x7B, 0x55, 0x80, 0xDB, 0x90, 0x82, 0x86, 0xE0, 0x70, 0x12, 0xA3, 0xE0, 0x70, 0x0E, - 0xA3, 0xE0, 0x70, 0x0A, 0xA3, 0xE0, 0x70, 0x06, 0xA3, 0xE0, 0x70, 0x02, 0x41, 0x13, 0xE4, 0x90, - 0x82, 0x15, 0xF0, 0x71, 0x5C, 0x40, 0x02, 0x41, 0x13, 0x12, 0x63, 0x4D, 0x71, 0x69, 0xE0, 0x60, - 0x46, 0x71, 0xBD, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x1B, 0xD3, 0x90, 0x82, 0x8C, 0xE0, 0x94, 0x28, - 0x90, 0x82, 0x8B, 0xE0, 0x94, 0x00, 0x50, 0x0C, 0x7F, 0xFA, 0x7E, 0x00, 0x12, 0x32, 0xAA, 0x12, - 0x5B, 0x9C, 0x80, 0xDF, 0x90, 0x04, 0x1D, 0xE0, 0x70, 0x1D, 0x71, 0xCE, 0x74, 0x0A, 0xF0, 0xE4, - 0xFB, 0x71, 0x93, 0x71, 0x8C, 0x94, 0x06, 0x50, 0x07, 0x71, 0x3B, 0x12, 0x5A, 0x88, 0x80, 0xF3, - 0x12, 0x65, 0x00, 0x90, 0x06, 0x35, 0xF0, 0x71, 0x55, 0x80, 0xA8, 0x90, 0x82, 0x16, 0xE0, 0xB4, - 0x01, 0x02, 0x80, 0x4E, 0x61, 0x34, 0x90, 0x82, 0x16, 0xE0, 0xB4, 0x01, 0x0A, 0x90, 0x81, 0x3D, - 0x91, 0x31, 0x30, 0xE0, 0x02, 0x80, 0x3B, 0x61, 0x34, 0x90, 0x82, 0x13, 0xE0, 0x70, 0x12, 0x90, - 0x82, 0x16, 0xE0, 0xB4, 0x01, 0x0B, 0x90, 0x81, 0x3D, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x20, 0xE0, - 0x02, 0x61, 0x34, 0x71, 0x3B, 0xFD, 0x12, 0x5B, 0x09, 0xEF, 0x60, 0x02, 0x80, 0x14, 0x71, 0x3B, - 0xFD, 0x12, 0x5A, 0x5E, 0xEF, 0x60, 0x02, 0x80, 0x09, 0x71, 0x3B, 0xFD, 0x12, 0x5A, 0x02, 0xEF, - 0x60, 0x06, 0x12, 0x51, 0x05, 0x02, 0x75, 0x90, 0x61, 0x34, 0x90, 0x82, 0x12, 0xE0, 0x24, 0xC0, - 0x60, 0x02, 0x41, 0x1F, 0x71, 0x3B, 0x24, 0x18, 0xFD, 0x12, 0x59, 0xD2, 0xEF, 0x60, 0x02, 0x41, - 0x13, 0x71, 0x3B, 0x24, 0x19, 0xFD, 0x12, 0x59, 0xD2, 0x90, 0x82, 0x2B, 0x71, 0x9E, 0x71, 0x87, - 0x9F, 0x50, 0x0A, 0x71, 0x3B, 0x12, 0x5A, 0xC1, 0x12, 0x5A, 0xA2, 0x80, 0xF1, 0x90, 0x82, 0x2B, - 0xE0, 0x70, 0x02, 0x21, 0x84, 0xE4, 0x90, 0x82, 0x15, 0xF0, 0x71, 0x5C, 0x50, 0x5E, 0x12, 0x63, - 0x4D, 0x91, 0x16, 0x70, 0x1D, 0x71, 0xF7, 0x12, 0x46, 0xDE, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, - 0x71, 0x77, 0xED, 0xF0, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x12, 0x74, 0x29, 0xEF, 0x60, 0x02, - 0x80, 0x25, 0x90, 0x82, 0x2B, 0xE0, 0x64, 0x03, 0x70, 0x28, 0x71, 0x77, 0x12, 0x74, 0x78, 0x70, - 0x07, 0x71, 0x77, 0x12, 0x74, 0x83, 0x60, 0x16, 0x91, 0x06, 0x60, 0x02, 0x80, 0x04, 0x71, 0xAD, - 0x60, 0x05, 0x74, 0x86, 0x2F, 0x80, 0x0D, 0x71, 0x69, 0x74, 0x01, 0xF0, 0x80, 0x0A, 0x71, 0xA6, - 0x80, 0x02, 0x71, 0xA6, 0x71, 0x6F, 0xE4, 0xF0, 0x71, 0x55, 0x80, 0x9E, 0x90, 0x82, 0x86, 0xE0, - 0x70, 0x4D, 0xA3, 0xE0, 0x70, 0x49, 0xA3, 0xE0, 0x70, 0x45, 0xA3, 0xE0, 0x70, 0x41, 0xA3, 0xE0, - 0x70, 0x3D, 0x41, 0x13, 0xE4, 0x90, 0x82, 0x15, 0xF0, 0x71, 0x5C, 0x50, 0x1C, 0x74, 0x72, 0x2E, - 0x71, 0xB4, 0x60, 0x09, 0x74, 0x86, 0x2E, 0x71, 0x6F, 0xE4, 0xF0, 0x80, 0x08, 0x74, 0x86, 0x2E, - 0x71, 0x6F, 0x74, 0x01, 0xF0, 0x71, 0x55, 0x80, 0xE0, 0x90, 0x82, 0x86, 0xE0, 0x70, 0x10, 0xA3, - 0xE0, 0x70, 0x0C, 0xA3, 0xE0, 0x70, 0x08, 0xA3, 0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0x54, 0xE4, - 0x90, 0x82, 0x15, 0xF0, 0x71, 0x5C, 0x50, 0x4B, 0x12, 0x63, 0x4D, 0x71, 0x69, 0xE0, 0x60, 0x3F, - 0x71, 0xBD, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x14, 0xD3, 0x90, 0x82, 0x8C, 0xE0, 0x94, 0xE8, 0x90, - 0x82, 0x8B, 0xE0, 0x94, 0x03, 0x50, 0x05, 0x12, 0x5B, 0x9C, 0x80, 0xE6, 0x90, 0x04, 0x1D, 0xE0, - 0x70, 0x1D, 0x71, 0xCE, 0x74, 0x06, 0xF0, 0x7B, 0x08, 0x71, 0x93, 0x71, 0x8C, 0x94, 0x06, 0x50, - 0x07, 0x71, 0x3B, 0x12, 0x5A, 0x88, 0x80, 0xF3, 0x12, 0x65, 0x00, 0x90, 0x06, 0x35, 0xF0, 0x71, - 0x55, 0x80, 0xB1, 0x12, 0x73, 0xD7, 0x90, 0x06, 0x36, 0x74, 0xDD, 0xF0, 0x02, 0x75, 0x90, 0x90, - 0x82, 0x13, 0xE0, 0x60, 0x02, 0x61, 0x34, 0x71, 0x3B, 0x24, 0x16, 0xFD, 0x12, 0x59, 0xD2, 0x90, - 0x06, 0x34, 0xEF, 0xF0, 0x71, 0x3B, 0x24, 0x17, 0xFD, 0x12, 0x59, 0xD2, 0x90, 0x06, 0x37, 0x71, - 0xE1, 0x71, 0x5C, 0x50, 0x64, 0x12, 0x63, 0x4D, 0xE4, 0x90, 0x82, 0x14, 0xF0, 0x90, 0x82, 0x14, - 0xE0, 0xFF, 0xC3, 0x94, 0x06, 0x50, 0x4E, 0xEF, 0x60, 0x04, 0x64, 0x01, 0x70, 0x24, 0x71, 0x3B, - 0x12, 0x5A, 0xB6, 0x90, 0x82, 0x14, 0xE0, 0xFE, 0x24, 0x44, 0x71, 0xC5, 0xF0, 0x90, 0x82, 0x15, - 0xE0, 0x71, 0xE9, 0x12, 0x46, 0xDE, 0x8E, 0x82, 0x12, 0x74, 0x72, 0xFF, 0x74, 0x46, 0x2E, 0x71, - 0xC5, 0xF0, 0x71, 0x3B, 0x12, 0x5A, 0xB6, 0x90, 0x82, 0x15, 0xE0, 0xFE, 0x12, 0x74, 0x5C, 0x6F, - 0x60, 0x0E, 0x74, 0x81, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0xE4, 0xF0, 0x80, 0x05, - 0x12, 0x5A, 0xA6, 0x80, 0xA8, 0x71, 0x55, 0x80, 0x98, 0x90, 0x82, 0x81, 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, 0x82, 0x16, 0x74, 0x01, 0xF0, 0x90, 0x82, - 0x16, 0xE0, 0x64, 0x01, 0x70, 0x4F, 0x12, 0x50, 0xB8, 0x12, 0x51, 0x1F, 0x90, 0x81, 0x5F, 0xE0, - 0x70, 0x03, 0x02, 0x75, 0x90, 0x90, 0x01, 0x3C, 0xE0, 0x30, 0xE4, 0x03, 0x74, 0x10, 0xF0, 0x7D, - 0x10, 0xE4, 0xFF, 0x12, 0x5F, 0xD2, 0x90, 0x81, 0x60, 0xE0, 0x60, 0x08, 0xF5, 0x2D, 0xE4, 0xF5, - 0x2E, 0xFB, 0x80, 0x15, 0x90, 0x81, 0x61, 0xE0, 0x60, 0x08, 0xFB, 0xE4, 0xF5, 0x2D, 0xF5, 0x2E, - 0x80, 0x07, 0x75, 0x2D, 0x20, 0xE4, 0xF5, 0x2E, 0xFB, 0x7D, 0x01, 0x7F, 0x60, 0x7E, 0x01, 0x12, - 0x31, 0x21, 0x02, 0x75, 0x90, 0x12, 0x58, 0xC3, 0x90, 0x82, 0x15, 0xF0, 0x71, 0x5C, 0x50, 0x04, - 0x71, 0x48, 0x80, 0xF8, 0x12, 0x73, 0xD7, 0x02, 0x75, 0x90, 0x22, 0x90, 0x82, 0x0C, 0xE0, 0xFE, - 0xA3, 0xE0, 0xFF, 0x90, 0x82, 0x10, 0xE0, 0x22, 0x74, 0x81, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x82, - 0xF5, 0x83, 0x74, 0x01, 0xF0, 0x90, 0x82, 0x15, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x81, 0x48, 0xE0, - 0xFF, 0x90, 0x82, 0x15, 0xE0, 0xFE, 0xC3, 0x9F, 0x22, 0x90, 0x82, 0x15, 0xE0, 0x24, 0x86, 0xF5, - 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0x22, 0x7B, 0x01, 0x7A, 0x82, 0x79, 0x2C, 0x90, 0x82, 0x90, - 0x12, 0x46, 0xE7, 0x90, 0x82, 0x93, 0x22, 0x90, 0x82, 0x2B, 0xE0, 0xFF, 0x90, 0x82, 0x14, 0xE0, - 0xFD, 0xC3, 0x22, 0x7D, 0x01, 0x12, 0x62, 0xBA, 0x90, 0x82, 0x0E, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, - 0xE4, 0x90, 0x82, 0x14, 0xF0, 0x22, 0x90, 0x82, 0x15, 0xE0, 0x24, 0x86, 0x22, 0x90, 0x82, 0x15, - 0xE0, 0xFF, 0x24, 0x72, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0xE0, 0x22, 0xE4, 0x90, 0x82, - 0x8B, 0xF0, 0xA3, 0xF0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x04, 0xF5, 0x83, 0xEF, 0x22, 0x90, 0x82, - 0x15, 0xE0, 0x24, 0x6D, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0x82, 0xD1, - 0x22, 0xEF, 0xF0, 0xE4, 0x90, 0x82, 0x15, 0xF0, 0x22, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0x5E, 0xF5, - 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0x22, 0xEF, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0x1C, 0xF5, 0x82, - 0xE4, 0x34, 0x82, 0xF5, 0x83, 0x22, 0x90, 0x82, 0x15, 0xE0, 0xFF, 0x24, 0x77, 0xF5, 0x82, 0xE4, - 0x34, 0x82, 0xF5, 0x83, 0xE0, 0x22, 0x90, 0x82, 0x15, 0xE0, 0xFF, 0x24, 0x17, 0xF5, 0x82, 0xE4, - 0x34, 0x82, 0xF5, 0x83, 0xE0, 0xFE, 0x90, 0x82, 0x2B, 0xE0, 0xFD, 0xEE, 0x6D, 0x22, 0x90, 0x81, - 0x6D, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x22, 0xEF, 0x30, 0xE7, 0x04, 0x7E, 0x02, 0x80, 0x02, - 0xE4, 0xFE, 0xED, 0x30, 0xE6, 0x12, 0xEB, 0x20, 0xE0, 0x07, 0x90, 0x81, 0x42, 0xE0, 0xFC, 0x80, - 0x09, 0x90, 0x81, 0x43, 0xE0, 0xFC, 0x80, 0x02, 0xE4, 0xFC, 0xEE, 0x24, 0x18, 0x2C, 0xFF, 0x22, - 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x7C, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0x22, 0x90, - 0x81, 0x83, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x81, 0x8A, 0xE0, 0xFB, 0x90, 0x82, 0xDD, 0x22, - 0xE0, 0x90, 0x01, 0xBA, 0xF0, 0x90, 0x81, 0x73, 0xE0, 0x90, 0x01, 0xBB, 0xF0, 0x22, 0xE0, 0x24, - 0x01, 0xFF, 0x90, 0x81, 0x3B, 0xE0, 0x34, 0x00, 0xFE, 0xC3, 0x22, 0x8B, 0x13, 0x8A, 0x14, 0x89, - 0x15, 0x75, 0x16, 0x05, 0x7B, 0x01, 0x22, 0x90, 0x06, 0x04, 0xE0, 0x44, 0x40, 0xF0, 0xE0, 0x44, - 0x80, 0xF0, 0x22, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xFE, 0xEF, 0x54, 0x07, 0xFF, 0x22, 0x90, - 0x81, 0x6D, 0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, - 0x83, 0xE0, 0x22, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x22, 0xE4, 0x90, 0x81, 0x49, - 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x81, 0x77, 0xE0, 0x90, 0x05, 0x73, 0x22, 0x72, 0x75, -}; -u32 array_length_mp_8188e_s_fw_ap = 15630; - -#endif - -void -odm_read_firmware_mp_8188e_s_fw_ap( - struct PHY_DM_STRUCT *p_dm_odm, - u8 *p_firmware, - u32 *p_firmware_size -) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) - *((SIZE_PTR *)p_firmware) = (SIZE_PTR)array_mp_8188e_s_fw_ap; -#else - odm_move_memory(p_dm_odm, p_firmware, array_mp_8188e_s_fw_ap, array_length_mp_8188e_s_fw_ap); -#endif - *p_firmware_size = array_length_mp_8188e_s_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_8188e_s_fw_nic[] = { - 0xE3, 0x88, 0x10, 0x00, 0x17, 0x00, 0x00, 0x00, 0x10, 0x27, 0x15, 0x22, 0x68, 0x4A, 0x02, 0x00, - 0x0C, 0x27, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x02, 0x48, 0x4E, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x02, 0x49, 0x7C, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x02, 0x57, 0xF7, 0x00, 0x00, 0x00, 0x00, 0x00, 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, 0x48, 0xF3, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x50, 0x01, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x05, 0x04, 0x03, 0x02, 0x00, 0x03, 0x06, 0x05, 0x04, 0x03, 0x00, 0x04, 0x06, 0x05, 0x04, 0x02, - 0x00, 0x04, 0x08, 0x07, 0x06, 0x04, 0x00, 0x06, 0x0A, 0x09, 0x08, 0x06, 0x00, 0x08, 0x0A, 0x09, - 0x08, 0x04, 0x00, 0x08, 0x0A, 0x09, 0x08, 0x02, 0x00, 0x08, 0x0A, 0x09, 0x08, 0x00, 0x00, 0x08, - 0x12, 0x11, 0x10, 0x08, 0x00, 0x10, 0x1A, 0x19, 0x18, 0x10, 0x00, 0x18, 0x22, 0x21, 0x20, 0x18, - 0x00, 0x20, 0x22, 0x21, 0x20, 0x10, 0x00, 0x20, 0x22, 0x21, 0x20, 0x08, 0x00, 0x20, 0x22, 0x21, - 0x1C, 0x08, 0x00, 0x20, 0x22, 0x21, 0x14, 0x08, 0x00, 0x20, 0x22, 0x20, 0x18, 0x08, 0x00, 0x20, - 0x31, 0x30, 0x20, 0x10, 0x00, 0x30, 0x31, 0x30, 0x18, 0x00, 0x00, 0x30, 0x31, 0x2F, 0x10, 0x10, - 0x00, 0x30, 0x31, 0x2C, 0x10, 0x10, 0x00, 0x30, 0x31, 0x28, 0x10, 0x00, 0x00, 0x30, 0x31, 0x20, - 0x10, 0x00, 0x00, 0x30, 0x31, 0x10, 0x10, 0x00, 0x00, 0x30, 0x04, 0x04, 0x04, 0x05, 0x04, 0x04, - 0x05, 0x07, 0x07, 0x07, 0x08, 0x0A, 0x04, 0x04, 0x04, 0x04, 0x06, 0x0A, 0x0B, 0x0D, 0x05, 0x05, - 0x07, 0x07, 0x08, 0x0B, 0x0D, 0x0F, 0x04, 0x04, 0x04, 0x05, 0x07, 0x07, 0x09, 0x09, 0x0C, 0x0E, - 0x10, 0x12, 0x07, 0x07, 0x08, 0x08, 0x0B, 0x0F, 0x10, 0x12, 0x09, 0x09, 0x09, 0x09, 0x0C, 0x0E, - 0x11, 0x13, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x24, 0x26, 0x2A, 0x18, 0x1A, - 0x1D, 0x1F, 0x21, 0x27, 0x29, 0x2A, 0x00, 0x00, 0x00, 0x1F, 0x23, 0x28, 0x2A, 0x2C, 0x00, 0x04, - 0x00, 0x04, 0x00, 0x08, 0x00, 0x10, 0x00, 0x18, 0x00, 0x24, 0x00, 0x30, 0x00, 0x48, 0x00, 0x60, - 0x00, 0x90, 0x00, 0xC0, 0x00, 0xD8, 0x00, 0x50, 0x00, 0x64, 0x00, 0xA0, 0x00, 0xDC, 0x01, 0x18, - 0x01, 0x90, 0x01, 0xE0, 0x02, 0x30, 0x01, 0x2C, 0x01, 0x40, 0x01, 0xE0, 0x02, 0xD0, 0x03, 0xE8, - 0x04, 0xB0, 0x06, 0x40, 0x07, 0xD0, 0x00, 0x02, 0x00, 0x02, 0x00, 0x04, 0x00, 0x08, 0x00, 0x0C, - 0x00, 0x12, 0x00, 0x18, 0x00, 0x24, 0x00, 0x30, 0x00, 0x48, 0x00, 0x60, 0x00, 0x6C, 0x00, 0x28, - 0x00, 0x32, 0x00, 0x50, 0x00, 0x6E, 0x00, 0x8C, 0x00, 0xC8, 0x00, 0xF0, 0x01, 0x18, 0x00, 0x64, - 0x00, 0xA0, 0x00, 0xF0, 0x01, 0x68, 0x01, 0xF4, 0x02, 0x58, 0x03, 0x20, 0x03, 0xE8, 0x02, 0x02, - 0x02, 0x02, 0x02, 0x02, 0x03, 0x03, 0x04, 0x04, 0x05, 0x07, 0x04, 0x05, 0x08, 0x08, 0x0C, 0x0E, - 0x10, 0x12, 0x05, 0x07, 0x07, 0x08, 0x0B, 0x12, 0x24, 0x3C, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, - 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x05, 0x06, - 0x07, 0x08, 0x09, 0x0A, 0x0B, 0x0C, 0x20, 0x1E, 0x1C, 0x18, 0x10, 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, - 0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x43, 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, 0x48, 0xED, 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, 0x48, 0xED, 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, 0x43, 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, 0x43, 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, 0x43, 0x4D, 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, - 0xC2, 0xAF, 0x56, 0xC6, 0xD2, 0xAF, 0xD2, 0xA9, 0x54, 0x80, 0x4F, 0xFF, 0x22, 0xE7, 0x09, 0xF6, - 0x08, 0xDF, 0xFA, 0x80, 0x46, 0xE7, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x3E, 0x88, 0x82, 0x8C, - 0x83, 0xE7, 0x09, 0xF0, 0xA3, 0xDF, 0xFA, 0x80, 0x32, 0xE3, 0x09, 0xF6, 0x08, 0xDF, 0xFA, 0x80, - 0x78, 0xE3, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x70, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0x09, 0xF0, - 0xA3, 0xDF, 0xFA, 0x80, 0x64, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF6, 0x08, 0xDF, 0xFA, 0x80, - 0x58, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x4C, 0x80, 0xD2, 0x80, - 0xFA, 0x80, 0xC6, 0x80, 0xD4, 0x80, 0x69, 0x80, 0xF2, 0x80, 0x33, 0x80, 0x10, 0x80, 0xA6, 0x80, - 0xEA, 0x80, 0x9A, 0x80, 0xA8, 0x80, 0xDA, 0x80, 0xE2, 0x80, 0xCA, 0x80, 0x33, 0x89, 0x82, 0x8A, - 0x83, 0xEC, 0xFA, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xF0, 0xA3, - 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, 0x0D, 0x89, 0x82, - 0x8A, 0x83, 0xE4, 0x93, 0xA3, 0xF6, 0x08, 0xDF, 0xF9, 0xEC, 0xFA, 0xA9, 0xF0, 0xED, 0xFB, 0x22, - 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, - 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xEA, 0xDE, 0xE8, 0x80, 0xDB, - 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xA3, 0xF2, 0x08, 0xDF, 0xF9, 0x80, 0xCC, 0x88, 0xF0, 0xEF, - 0x60, 0x01, 0x0E, 0x4E, 0x60, 0xC3, 0x88, 0xF0, 0xED, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0xB9, - 0xF5, 0x82, 0xEB, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0xAF, 0x23, 0x23, 0x45, 0x82, 0x23, 0x90, - 0x45, 0xFD, 0x73, 0xC5, 0xF0, 0xF8, 0xA3, 0xE0, 0x28, 0xF0, 0xC5, 0xF0, 0xF8, 0xE5, 0x82, 0x15, - 0x82, 0x70, 0x02, 0x15, 0x83, 0xE0, 0x38, 0xF0, 0x22, 0xBB, 0x01, 0x0A, 0x89, 0x82, 0x8A, 0x83, - 0xE0, 0xF5, 0xF0, 0xA3, 0xE0, 0x22, 0x50, 0x06, 0x87, 0xF0, 0x09, 0xE7, 0x19, 0x22, 0xBB, 0xFE, - 0x07, 0xE3, 0xF5, 0xF0, 0x09, 0xE3, 0x19, 0x22, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xF5, 0xF0, - 0x74, 0x01, 0x93, 0x22, 0xBB, 0x01, 0x10, 0xE5, 0x82, 0x29, 0xF5, 0x82, 0xE5, 0x83, 0x3A, 0xF5, - 0x83, 0xE0, 0xF5, 0xF0, 0xA3, 0xE0, 0x22, 0x50, 0x09, 0xE9, 0x25, 0x82, 0xF8, 0x86, 0xF0, 0x08, - 0xE6, 0x22, 0xBB, 0xFE, 0x0A, 0xE9, 0x25, 0x82, 0xF8, 0xE2, 0xF5, 0xF0, 0x08, 0xE2, 0x22, 0xE5, - 0x83, 0x2A, 0xF5, 0x83, 0xE9, 0x93, 0xF5, 0xF0, 0xA3, 0xE9, 0x93, 0x22, 0xBB, 0x01, 0x0A, 0x89, - 0x82, 0x8A, 0x83, 0xF0, 0xE5, 0xF0, 0xA3, 0xF0, 0x22, 0x50, 0x06, 0xF7, 0x09, 0xA7, 0xF0, 0x19, - 0x22, 0xBB, 0xFE, 0x06, 0xF3, 0xE5, 0xF0, 0x09, 0xF3, 0x19, 0x22, 0xF8, 0xBB, 0x01, 0x11, 0xE5, - 0x82, 0x29, 0xF5, 0x82, 0xE5, 0x83, 0x3A, 0xF5, 0x83, 0xE8, 0xF0, 0xE5, 0xF0, 0xA3, 0xF0, 0x22, - 0x50, 0x09, 0xE9, 0x25, 0x82, 0xC8, 0xF6, 0x08, 0xA6, 0xF0, 0x22, 0xBB, 0xFE, 0x09, 0xE9, 0x25, - 0x82, 0xC8, 0xF2, 0xE5, 0xF0, 0x08, 0xF2, 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, - 0xEB, 0x9F, 0xF5, 0xF0, 0xEA, 0x9E, 0x42, 0xF0, 0xE9, 0x9D, 0x42, 0xF0, 0xE8, 0x9C, 0x45, 0xF0, - 0x22, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0xE2, 0xFC, 0x08, - 0xE2, 0xFD, 0x08, 0xE2, 0xFE, 0x08, 0xE2, 0xFF, 0x22, 0xE0, 0xF8, 0xA3, 0xE0, 0xF9, 0xA3, 0xE0, - 0xFA, 0xA3, 0xE0, 0xFB, 0x22, 0xE2, 0xFB, 0x08, 0xE2, 0xF9, 0x08, 0xE2, 0xFA, 0x08, 0xE2, 0xCB, - 0xF8, 0x22, 0xEC, 0xF2, 0x08, 0xED, 0xF2, 0x08, 0xEE, 0xF2, 0x08, 0xEF, 0xF2, 0x22, 0xA4, 0x25, - 0x82, 0xF5, 0x82, 0xE5, 0xF0, 0x35, 0x83, 0xF5, 0x83, 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, 0xEF, 0x4E, 0x60, 0x12, 0xEF, 0x60, 0x01, 0x0E, 0xED, 0xBB, 0x01, 0x0B, 0x89, 0x82, - 0x8A, 0x83, 0xF0, 0xA3, 0xDF, 0xFC, 0xDE, 0xFA, 0x22, 0x89, 0xF0, 0x50, 0x07, 0xF7, 0x09, 0xDF, - 0xFC, 0xA9, 0xF0, 0x22, 0xBB, 0xFE, 0xFC, 0xF3, 0x09, 0xDF, 0xFC, 0xA9, 0xF0, 0x22, 0x02, 0x48, - 0x8C, 0x02, 0x43, 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, 0x48, 0xD1, 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, 0x82, 0xDE, 0x00, 0x41, 0x82, 0xDF, 0x00, 0x48, 0x91, 0x43, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x41, 0x82, 0xE8, 0x00, 0x41, 0x82, 0xEA, 0x00, 0x00, 0x59, 0x26, 0x69, - 0x2C, 0x77, 0xDA, 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, 0xF3, 0xF0, 0x74, 0x48, 0xA3, 0xF0, 0x31, 0x42, 0x74, 0xF3, 0x04, 0x90, - 0x01, 0xC4, 0xF0, 0x74, 0x48, 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, 0x54, 0xE0, 0x55, 0x35, 0xF5, 0x39, 0xA3, 0xE0, 0x55, 0x36, 0xF5, 0x3A, - 0xA3, 0xE0, 0x55, 0x37, 0xF5, 0x3B, 0xA3, 0xE0, 0x55, 0x38, 0xF5, 0x3C, 0xAD, 0x39, 0x7F, 0x54, - 0x12, 0x32, 0x1E, 0xAD, 0x3A, 0x7F, 0x55, 0x12, 0x32, 0x1E, 0xAD, 0x3B, 0x7F, 0x56, 0x12, 0x32, - 0x1E, 0xAD, 0x3C, 0x7F, 0x57, 0x12, 0x32, 0x1E, 0x53, 0x91, 0xEF, 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, 0x7C, 0xF0, 0x74, - 0x49, 0xA3, 0xF0, 0x12, 0x83, 0x8D, 0xE5, 0x41, 0x30, 0xE4, 0x03, 0x12, 0x7A, 0x29, 0xE5, 0x41, - 0x30, 0xE6, 0x03, 0x12, 0x83, 0xEA, 0xE5, 0x43, 0x30, 0xE0, 0x03, 0x12, 0x83, 0xF7, 0xE5, 0x43, - 0x30, 0xE1, 0x02, 0x51, 0x23, 0xE5, 0x43, 0x30, 0xE2, 0x03, 0x12, 0x85, 0x5A, 0xE5, 0x43, 0x30, - 0xE3, 0x03, 0x12, 0x84, 0xE9, 0xE5, 0x43, 0x30, 0xE4, 0x03, 0x12, 0x84, 0xC1, 0xE5, 0x43, 0x30, - 0xE5, 0x03, 0x12, 0x85, 0x83, 0xE5, 0x43, 0x30, 0xE6, 0x03, 0x12, 0x85, 0x9F, 0xE5, 0x44, 0x30, - 0xE1, 0x03, 0x12, 0x85, 0xB8, 0xE5, 0x44, 0x30, 0xE5, 0x03, 0x12, 0x7B, 0x73, 0x74, 0x7C, 0x04, - 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x49, 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, 0x81, 0x82, 0xE0, 0x30, 0xE0, 0x06, 0x90, 0x81, 0x84, 0x74, 0x01, 0xF0, - 0x90, 0x81, 0x8C, 0xE0, 0x70, 0x02, 0x41, 0xC1, 0x90, 0x81, 0xA3, 0xE0, 0x04, 0x51, 0xDA, 0x12, - 0x47, 0x83, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, 0x51, 0xF4, 0x78, - 0x10, 0x12, 0x20, 0xBB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x47, 0x83, 0xC0, - 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x51, 0xF4, 0x78, 0x18, 0x12, 0x20, 0xBB, 0xD0, - 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x47, 0x83, 0x90, 0x81, 0xD7, 0x12, 0x20, 0xCE, - 0x90, 0x81, 0x88, 0xE0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, 0x30, 0xE0, 0x0C, 0x12, 0x75, 0xCF, 0x74, - 0x05, 0xF0, 0x12, 0x72, 0xB5, 0x12, 0x8A, 0x30, 0x90, 0x81, 0x88, 0x12, 0x86, 0xE4, 0x30, 0xE0, - 0x09, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x02, 0xB1, 0xDD, 0x90, 0x82, 0xE4, 0xE0, 0x04, 0xF0, - 0xE0, 0xC3, 0x94, 0x80, 0x40, 0x0B, 0x90, 0x01, 0x98, 0xE0, 0x54, 0xFE, 0xF0, 0xE0, 0x44, 0x01, - 0xF0, 0x7F, 0x01, 0x12, 0x7A, 0x2D, 0x12, 0x88, 0x0F, 0x90, 0x81, 0xF7, 0xE0, 0x30, 0xE0, 0x09, - 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x02, 0xB1, 0xDD, 0x22, 0xF0, 0x90, 0x05, 0x61, 0xE0, 0xFF, - 0xE4, 0xFC, 0xFD, 0xFE, 0x78, 0x08, 0x12, 0x20, 0xBB, 0xA8, 0x04, 0xA9, 0x05, 0xAA, 0x06, 0xAB, - 0x07, 0x90, 0x05, 0x60, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x22, 0xE4, 0x90, 0x82, 0x2A, 0xF0, - 0x90, 0x87, 0x5F, 0xE0, 0x90, 0x82, 0x29, 0xF0, 0xE4, 0x90, 0x82, 0x36, 0xF0, 0x90, 0x82, 0x26, - 0xF0, 0x90, 0x82, 0x26, 0xE0, 0xFF, 0xC3, 0x94, 0x40, 0x50, 0x11, 0x74, 0x39, 0x2F, 0x12, 0x8A, - 0x5E, 0x74, 0xFF, 0xF0, 0x90, 0x82, 0x26, 0xE0, 0x04, 0xF0, 0x80, 0xE5, 0xE4, 0x90, 0x82, 0x26, - 0xF0, 0x90, 0x82, 0x29, 0xE0, 0xFF, 0x90, 0x82, 0x26, 0xE0, 0xFE, 0xC3, 0x9F, 0x40, 0x02, 0x61, - 0xFD, 0x74, 0xDF, 0x2E, 0xF9, 0xE4, 0x34, 0x86, 0x12, 0x89, 0x69, 0x75, 0x16, 0x0A, 0x7B, 0x01, - 0x7A, 0x82, 0x79, 0x1B, 0x12, 0x2B, 0xED, 0x90, 0x82, 0x1C, 0xE0, 0xFF, 0x12, 0x2F, 0x27, 0xEF, - 0x04, 0x90, 0x82, 0x36, 0xF0, 0x90, 0x82, 0x1B, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x12, 0x31, 0xEA, - 0xEF, 0x24, 0xC8, 0x90, 0x82, 0x38, 0xF0, 0x75, 0xF0, 0x08, 0xA4, 0xF0, 0x90, 0x82, 0x1C, 0xE0, - 0x54, 0x0F, 0x90, 0x82, 0x37, 0xF0, 0xE4, 0x90, 0x82, 0x25, 0xF0, 0x90, 0x82, 0x27, 0xF0, 0x90, - 0x82, 0x27, 0xE0, 0xFF, 0xC3, 0x94, 0x04, 0x50, 0x57, 0x90, 0x82, 0x37, 0xE0, 0xFE, 0xA8, 0x07, - 0x08, 0x80, 0x02, 0xC3, 0x13, 0xD8, 0xFC, 0x20, 0xE0, 0x3E, 0x90, 0x82, 0x27, 0xE0, 0x25, 0xE0, - 0xFF, 0x90, 0x82, 0x38, 0xE0, 0x2F, 0x24, 0x39, 0xF9, 0xE4, 0x34, 0x82, 0xFA, 0x7B, 0x01, 0xC0, - 0x03, 0xC0, 0x01, 0x90, 0x82, 0x25, 0xE0, 0x75, 0xF0, 0x02, 0xA4, 0x24, 0x1D, 0xF9, 0x74, 0x82, - 0x35, 0xF0, 0x8B, 0x13, 0xF5, 0x14, 0x89, 0x15, 0x75, 0x16, 0x02, 0xD0, 0x01, 0xD0, 0x03, 0x12, - 0x2B, 0xED, 0x90, 0x82, 0x25, 0xE0, 0x04, 0xF0, 0x90, 0x82, 0x27, 0xE0, 0x04, 0xF0, 0x80, 0x9F, - 0x90, 0x82, 0x36, 0xE0, 0xFF, 0x90, 0x82, 0x26, 0xE0, 0x2F, 0xF0, 0x61, 0x31, 0xE4, 0x90, 0x82, - 0x2A, 0xF0, 0x90, 0x82, 0x2A, 0xE0, 0xC3, 0x94, 0x40, 0x40, 0x02, 0xA1, 0xC1, 0xE0, 0xFF, 0x24, - 0x39, 0x12, 0x8A, 0x5E, 0xE0, 0x90, 0x82, 0x2C, 0xF0, 0xE0, 0xFE, 0x54, 0xF0, 0xC4, 0x54, 0x0F, - 0xFD, 0x90, 0x82, 0x2B, 0xF0, 0xEE, 0x54, 0x0F, 0xFE, 0xA3, 0xF0, 0x74, 0x3A, 0x2F, 0xF5, 0x82, - 0xE4, 0x34, 0x82, 0xF5, 0x83, 0xE0, 0x90, 0x82, 0x2D, 0xF0, 0xFC, 0xEE, 0xFE, 0xEC, 0xFB, 0xEB, - 0xFF, 0x90, 0x82, 0x32, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xED, 0x12, 0x47, 0xFC, 0x4C, 0x72, 0x00, - 0x4C, 0x9E, 0x01, 0x4D, 0x17, 0x02, 0x4D, 0xB2, 0x03, 0x4D, 0x27, 0x04, 0x4D, 0x3D, 0x05, 0x4D, - 0x3D, 0x06, 0x4D, 0x3D, 0x07, 0x4D, 0x3D, 0x08, 0x4D, 0x8D, 0x09, 0x4D, 0x9F, 0x0A, 0x00, 0x00, - 0x4D, 0xC1, 0x90, 0x82, 0x2A, 0xE0, 0xFD, 0x12, 0x89, 0x75, 0xE0, 0xFE, 0x74, 0x3B, 0x2D, 0xB1, - 0xD5, 0xE0, 0xFD, 0xED, 0xFF, 0x90, 0x82, 0x34, 0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, 0x90, 0x82, - 0x2D, 0xE0, 0xFF, 0x12, 0x2F, 0x96, 0x90, 0x82, 0x28, 0x74, 0x02, 0xF0, 0xA1, 0xB2, 0x12, 0x89, - 0x71, 0x51, 0xF4, 0xB1, 0xC2, 0x51, 0xF4, 0x12, 0x47, 0x83, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, - 0xC0, 0x07, 0x90, 0x82, 0x2A, 0xE0, 0x24, 0x3D, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0x51, - 0xF4, 0x78, 0x10, 0x12, 0x20, 0xBB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x47, - 0x83, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x82, 0x2A, 0xE0, 0x24, 0x3E, 0xF5, - 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0x51, 0xF4, 0x78, 0x18, 0x12, 0x20, 0xBB, 0xD0, 0x03, 0xD0, - 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x8A, 0x00, 0x90, 0x82, 0x2E, 0x12, 0x47, 0xA1, 0x90, 0x85, - 0x96, 0x12, 0x20, 0xCE, 0x90, 0x82, 0x32, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x2E, 0xE4, 0x90, - 0x82, 0x28, 0x74, 0x04, 0xF0, 0xA1, 0xB2, 0x90, 0x82, 0x2D, 0xE0, 0xFD, 0xB1, 0xCF, 0xE0, 0xFB, - 0xE4, 0xFF, 0x12, 0x30, 0xC7, 0x80, 0x0E, 0x90, 0x82, 0x2D, 0xE0, 0xFD, 0xB1, 0xCF, 0xE0, 0xFB, - 0xE4, 0xFF, 0x12, 0x30, 0x6A, 0x90, 0x82, 0x28, 0x74, 0x01, 0xF0, 0x80, 0x75, 0x90, 0x82, 0x28, - 0x74, 0x02, 0xF0, 0x12, 0x89, 0x71, 0x51, 0xF4, 0xB1, 0xC2, 0x51, 0xF4, 0x12, 0x47, 0x83, 0xC0, - 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x82, 0x2C, 0x51, 0xF4, 0x78, 0x10, 0x12, 0x20, - 0xBB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x8A, 0x00, 0x90, 0x82, 0x2B, 0xE0, - 0x24, 0xFB, 0xFF, 0xC0, 0x07, 0x90, 0x82, 0x2E, 0x12, 0x47, 0xA1, 0x90, 0x82, 0xBA, 0x12, 0x20, - 0xCE, 0x90, 0x82, 0x2D, 0xE0, 0xFD, 0xD0, 0x07, 0x12, 0x7E, 0x1C, 0x80, 0x25, 0x90, 0x82, 0x28, - 0x74, 0x01, 0x12, 0x89, 0x5E, 0x75, 0x16, 0x01, 0x12, 0x89, 0x45, 0x7B, 0x04, 0x80, 0x10, 0x90, - 0x82, 0x28, 0x74, 0x04, 0x12, 0x89, 0x5E, 0x75, 0x16, 0x04, 0x12, 0x89, 0x45, 0x7B, 0x06, 0x12, - 0x7E, 0x40, 0x90, 0x82, 0x28, 0xE0, 0x24, 0x02, 0xFF, 0x90, 0x82, 0x2A, 0xE0, 0x2F, 0xF0, 0x81, - 0x02, 0x22, 0x78, 0x08, 0x12, 0x20, 0xBB, 0xA8, 0x04, 0xA9, 0x05, 0xAA, 0x06, 0xAB, 0x07, 0x90, - 0x82, 0x2A, 0xE0, 0x24, 0x3B, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0x22, 0x7D, 0x02, 0x7F, - 0x02, 0xB1, 0xE7, 0x7D, 0x01, 0x7F, 0x02, 0x74, 0x3D, 0xF1, 0xF9, 0xFE, 0xF6, 0x74, 0x30, 0xE1, - 0xC9, 0xE4, 0xF5, 0x4E, 0x90, 0x81, 0x8C, 0xE0, 0x70, 0x02, 0xC1, 0xC8, 0xF1, 0xD4, 0x60, 0x02, - 0xC1, 0xC8, 0x51, 0xDB, 0x12, 0x47, 0x83, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, - 0x05, 0x62, 0x51, 0xF4, 0x78, 0x10, 0x12, 0x20, 0xBB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, - 0x00, 0x12, 0x47, 0x83, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x51, 0xF4, 0x78, - 0x18, 0x12, 0x20, 0xBB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x89, 0x7F, 0x12, - 0x70, 0xF4, 0x54, 0x0F, 0x60, 0x22, 0x24, 0xFE, 0x60, 0x03, 0x04, 0x70, 0x1E, 0x90, 0x81, 0x93, - 0xE0, 0x14, 0xF0, 0xE0, 0xFF, 0x60, 0x06, 0x90, 0x81, 0x95, 0xE0, 0x60, 0x0E, 0xEF, 0x70, 0x08, - 0x90, 0x81, 0x92, 0xE0, 0xA3, 0xF0, 0x80, 0x00, 0x75, 0x4E, 0x01, 0x90, 0x81, 0x82, 0xE0, 0x30, - 0xE0, 0x12, 0x90, 0x81, 0x86, 0xE0, 0xB4, 0x02, 0x03, 0xE4, 0xF5, 0x4E, 0x12, 0x6B, 0xF6, 0xEF, - 0x70, 0x02, 0xF5, 0x4E, 0xE5, 0x4E, 0x60, 0x40, 0xF1, 0xF1, 0x90, 0x81, 0x95, 0xE0, 0x60, 0x04, - 0x64, 0x01, 0x70, 0x12, 0xE4, 0xF5, 0x1D, 0x90, 0x81, 0x95, 0xE0, 0xD1, 0xD3, 0x12, 0x51, 0x38, - 0x90, 0x81, 0x95, 0xE0, 0x80, 0x12, 0xE4, 0xF5, 0x1D, 0xD1, 0xC9, 0x12, 0x51, 0x38, 0x90, 0x81, - 0x95, 0xE0, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, 0xD1, 0xD3, 0x90, 0x81, 0xA5, 0xF0, 0x90, 0x81, - 0x8F, 0xE0, 0x20, 0xE2, 0x03, 0x12, 0x51, 0xC9, 0x22, 0x90, 0x81, 0x95, 0xE0, 0x75, 0xF0, 0x03, - 0xA4, 0x24, 0xFE, 0xFF, 0x90, 0x81, 0x94, 0xE0, 0x2F, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, - 0xD0, 0xEF, 0x64, 0x01, 0x70, 0x19, 0xF1, 0xE9, 0x60, 0x0A, 0xF1, 0x23, 0xF1, 0xE1, 0x12, 0x8A, - 0x28, 0xF0, 0x80, 0x06, 0xF1, 0x23, 0xF1, 0xC1, 0xB1, 0xDD, 0x12, 0x51, 0xB8, 0x80, 0x1B, 0xF1, - 0xE9, 0x60, 0x06, 0xF1, 0x23, 0xF1, 0xE1, 0x80, 0x04, 0xF1, 0x23, 0xF1, 0xC1, 0x12, 0x71, 0x09, - 0x7D, 0x01, 0x7F, 0x02, 0x12, 0x71, 0x0D, 0x12, 0x55, 0x12, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, - 0x90, 0x01, 0x3F, 0x74, 0x10, 0xF0, 0xFD, 0x7F, 0x03, 0x22, 0xE4, 0x90, 0x82, 0x0D, 0xF0, 0x90, - 0x81, 0x8C, 0xE0, 0x70, 0x02, 0xE1, 0xC0, 0xF1, 0xD4, 0x60, 0x02, 0xE1, 0xC0, 0x12, 0x8A, 0x38, - 0x51, 0xDA, 0x12, 0x47, 0x83, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, - 0x51, 0xF4, 0x78, 0x10, 0x12, 0x20, 0xBB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, - 0x47, 0x83, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x51, 0xF4, 0x78, 0x18, 0x12, - 0x20, 0xBB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x89, 0x7F, 0x90, 0x82, 0x0D, - 0x74, 0x01, 0xF0, 0xE4, 0x90, 0x81, 0x93, 0xF0, 0x90, 0x81, 0x82, 0xE0, 0x30, 0xE0, 0x16, 0x90, - 0x81, 0x86, 0xE0, 0xB4, 0x02, 0x05, 0xE4, 0x90, 0x82, 0x0D, 0xF0, 0x12, 0x6B, 0xF6, 0xEF, 0x70, - 0x04, 0x90, 0x82, 0x0D, 0xF0, 0x90, 0x82, 0x0D, 0xE0, 0x60, 0x15, 0xF1, 0xF1, 0xE4, 0xF5, 0x1D, - 0x90, 0x81, 0x94, 0x12, 0x51, 0x37, 0x90, 0x81, 0x8F, 0xE0, 0x20, 0xE2, 0x03, 0x12, 0x51, 0xC9, - 0x22, 0x74, 0x45, 0xF1, 0xF9, 0xFE, 0xF6, 0x74, 0x38, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, - 0x83, 0xEE, 0xF0, 0x22, 0xE4, 0xFF, 0x12, 0x65, 0xE3, 0xEF, 0x64, 0x01, 0x22, 0x7D, 0x03, 0x7F, - 0x02, 0x74, 0x45, 0x2F, 0xF8, 0xE6, 0x4D, 0x80, 0xDC, 0x90, 0x81, 0xF9, 0xE0, 0x90, 0x01, 0x3F, - 0x22, 0x90, 0x81, 0x90, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, - 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, 0x01, 0xF0, 0x74, 0x50, 0xA3, 0xF0, 0x12, 0x83, 0xBA, 0xE5, 0x49, 0x30, 0xE1, 0x02, - 0x11, 0xCC, 0xE5, 0x49, 0x30, 0xE2, 0x03, 0x12, 0x6F, 0x5C, 0xE5, 0x4A, 0x30, 0xE0, 0x03, 0x12, - 0x75, 0x87, 0xE5, 0x4A, 0x30, 0xE4, 0x03, 0x12, 0x86, 0xEB, 0xE5, 0x4B, 0x30, 0xE1, 0x03, 0x12, - 0x84, 0x44, 0xE5, 0x4B, 0x30, 0xE0, 0x03, 0x12, 0x85, 0x13, 0xE5, 0x4B, 0x30, 0xE4, 0x02, 0xF1, - 0xEF, 0xE5, 0x4C, 0x30, 0xE1, 0x05, 0x7F, 0x04, 0x12, 0x7A, 0x2D, 0xE5, 0x4C, 0x30, 0xE4, 0x02, - 0x11, 0xA8, 0xE5, 0x4C, 0x30, 0xE5, 0x03, 0x12, 0x6C, 0x27, 0xE5, 0x4C, 0x30, 0xE6, 0x03, 0x12, - 0x87, 0x01, 0x74, 0x01, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x50, 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, 0x4F, 0x2A, 0x12, 0x71, 0x09, 0x90, 0x81, - 0xF7, 0xE0, 0x30, 0xE0, 0x16, 0x12, 0x8A, 0x28, 0xF0, 0x90, 0x81, 0xFA, 0xE0, 0x60, 0x04, 0x14, - 0xF0, 0x21, 0xB8, 0x12, 0x89, 0xED, 0xE4, 0xFF, 0x12, 0x4E, 0xDA, 0x22, 0x90, 0x81, 0x8C, 0xE0, - 0x60, 0x03, 0x12, 0x6C, 0x4F, 0x90, 0x81, 0xF0, 0xE0, 0x30, 0xE0, 0x50, 0x13, 0x13, 0x54, 0x3F, - 0x20, 0xE0, 0x16, 0xE4, 0xF5, 0x1D, 0x90, 0x81, 0xF2, 0x31, 0x37, 0x31, 0xA8, 0xF1, 0xF0, 0x30, - 0xE0, 0x02, 0x71, 0xF2, 0x12, 0x67, 0xE4, 0xF0, 0x22, 0x90, 0x81, 0xF0, 0xE0, 0x13, 0x13, 0x54, - 0x3F, 0x30, 0xE0, 0x28, 0xE4, 0xF5, 0x1D, 0x90, 0x81, 0xF3, 0x31, 0x37, 0x90, 0x81, 0xF0, 0xE0, - 0x54, 0xFB, 0xF0, 0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x0A, 0x12, 0x88, 0x86, 0xF0, 0x7D, 0x04, 0x7F, - 0x01, 0x61, 0xF6, 0x7D, 0x31, 0x7F, 0xFF, 0x31, 0xAD, 0x12, 0x6C, 0xFB, 0x22, 0xE0, 0x44, 0x02, - 0xF0, 0xE4, 0xF5, 0x1D, 0x90, 0x81, 0xEA, 0xE0, 0xF5, 0x1E, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, - 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8E, 0x19, 0x8F, 0x1A, 0xE5, 0x1E, 0x31, 0x99, - 0x85, 0x19, 0x83, 0x85, 0x1A, 0x82, 0xF0, 0xE5, 0x1D, 0x31, 0x99, 0xFF, 0xE5, 0x1E, 0x13, 0x13, - 0x13, 0x54, 0x1F, 0x4F, 0xA3, 0xF0, 0xEB, 0x31, 0x99, 0xFF, 0xE5, 0x1D, 0x13, 0x13, 0x13, 0x54, - 0x1F, 0x4F, 0x31, 0xA0, 0xA3, 0xF0, 0xBD, 0x01, 0x0D, 0x85, 0x1A, 0x82, 0x8E, 0x83, 0xA3, 0xA3, - 0xA3, 0x74, 0x03, 0xF0, 0x80, 0x07, 0x31, 0xA0, 0xA3, 0xA3, 0x74, 0x01, 0xF0, 0x31, 0xA0, 0xA3, - 0xA3, 0x74, 0x05, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x54, 0x07, 0xC4, 0x33, 0x54, 0xE0, 0x22, - 0x85, 0x1A, 0x82, 0x85, 0x19, 0x83, 0xA3, 0x22, 0xB1, 0x1D, 0xE4, 0xFD, 0xFF, 0x90, 0x05, 0x22, - 0xEF, 0xF0, 0x90, 0x80, 0x40, 0xED, 0xF0, 0x22, 0x7D, 0x2F, 0x7F, 0xFF, 0x31, 0xAD, 0x12, 0x6C, - 0xFB, 0x7D, 0x08, 0x91, 0x75, 0x74, 0x08, 0xF0, 0x22, 0x7D, 0x01, 0x7F, 0x04, 0xD3, 0x10, 0xAF, - 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x82, 0xE7, 0xED, 0xF0, 0x90, 0x81, 0x87, 0xE0, 0xFE, 0xC4, 0x13, - 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0x61, 0x18, 0xEE, 0x12, 0x67, 0xA3, 0x30, 0xE0, 0x02, 0x61, - 0x18, 0x90, 0x81, 0x8F, 0xE0, 0xFE, 0x6F, 0x70, 0x02, 0x61, 0x18, 0xEF, 0x70, 0x02, 0x41, 0x89, - 0x24, 0xFE, 0x70, 0x02, 0x41, 0xC2, 0x24, 0xFE, 0x60, 0x47, 0x24, 0xFC, 0x70, 0x02, 0x41, 0xFC, - 0x24, 0xFC, 0x60, 0x02, 0x61, 0x11, 0xEE, 0xB4, 0x0E, 0x02, 0x71, 0x75, 0x90, 0x81, 0x8F, 0xE0, - 0x70, 0x04, 0x7F, 0x01, 0x91, 0x5E, 0x90, 0x81, 0x8F, 0xE0, 0xB4, 0x06, 0x02, 0x71, 0x99, 0x90, - 0x81, 0x8F, 0xE0, 0xB4, 0x04, 0x0D, 0x90, 0x82, 0xE7, 0xE0, 0xFF, 0x60, 0x04, 0x91, 0x7D, 0x80, - 0x02, 0xF1, 0xAE, 0x90, 0x81, 0x8F, 0xE0, 0x64, 0x08, 0x60, 0x02, 0x61, 0x11, 0xB1, 0x12, 0x61, - 0x11, 0x90, 0x81, 0x8F, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0x91, 0x5E, 0x90, 0x81, 0x8F, 0xE0, 0xB4, - 0x06, 0x02, 0x71, 0x99, 0x90, 0x81, 0x8F, 0xE0, 0xB4, 0x0E, 0x07, 0x71, 0x1D, 0xBF, 0x01, 0x02, - 0x71, 0x75, 0x90, 0x81, 0x8F, 0xE0, 0x64, 0x0C, 0x60, 0x02, 0x61, 0x11, 0x71, 0x1D, 0xEF, 0x64, - 0x01, 0x60, 0x02, 0x61, 0x11, 0x71, 0xBE, 0x61, 0x11, 0x90, 0x81, 0x8F, 0xE0, 0xB4, 0x0E, 0x07, - 0x71, 0x1D, 0xBF, 0x01, 0x02, 0x71, 0x75, 0x90, 0x81, 0x8F, 0xE0, 0xB4, 0x06, 0x02, 0x71, 0x99, - 0x90, 0x81, 0x8F, 0xE0, 0xB4, 0x0C, 0x07, 0x71, 0x1D, 0xBF, 0x01, 0x02, 0x71, 0xBE, 0x90, 0x81, - 0x8F, 0xE0, 0x64, 0x04, 0x70, 0x5B, 0x12, 0x86, 0x62, 0xEF, 0x64, 0x01, 0x70, 0x53, 0xB1, 0xB2, - 0x80, 0x4F, 0x90, 0x81, 0x8F, 0xE0, 0xB4, 0x0E, 0x07, 0x71, 0x1D, 0xBF, 0x01, 0x02, 0x71, 0x75, - 0x90, 0x81, 0x8F, 0xE0, 0xB4, 0x06, 0x02, 0x71, 0x99, 0x90, 0x81, 0x8F, 0xE0, 0xB4, 0x0C, 0x07, - 0x71, 0x1D, 0xBF, 0x01, 0x02, 0x71, 0xBE, 0x90, 0x81, 0x8F, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0x91, - 0x5E, 0x90, 0x81, 0x8F, 0xE0, 0xB4, 0x04, 0x19, 0xB1, 0x82, 0x80, 0x15, 0x90, 0x81, 0x8F, 0xE0, - 0xB4, 0x0C, 0x0E, 0x90, 0x81, 0x88, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x02, 0x31, - 0xB8, 0x90, 0x81, 0x8F, 0x12, 0x89, 0xAA, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, - 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x86, 0x14, 0xEF, 0x64, 0x01, 0x60, 0x05, 0x75, 0x0E, 0x01, 0x80, - 0x31, 0x12, 0x86, 0xE1, 0x30, 0xE0, 0x05, 0x75, 0x0E, 0x02, 0x80, 0x26, 0x90, 0x81, 0x8E, 0xE0, - 0xD3, 0x94, 0x04, 0x40, 0x05, 0x75, 0x0E, 0x08, 0x80, 0x18, 0x90, 0x81, 0xF0, 0xE0, 0x30, 0xE0, - 0x0C, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x05, 0x75, 0x0E, 0x11, 0x80, 0x05, 0x12, 0x86, 0xD9, - 0x80, 0x0E, 0x90, 0x01, 0xB9, 0x74, 0x02, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x0E, 0xF0, 0x7F, 0x00, - 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x81, 0x88, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x04, 0x71, 0xF2, - 0x80, 0x12, 0x12, 0x89, 0x26, 0xF1, 0xA7, 0x90, 0x05, 0x27, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0x81, - 0x86, 0x74, 0x04, 0xF0, 0xE4, 0xFD, 0xFF, 0x21, 0xAD, 0x90, 0x81, 0x88, 0xE0, 0x90, 0x06, 0x04, - 0x20, 0xE0, 0x07, 0xE0, 0x44, 0x40, 0xF1, 0xA7, 0x80, 0x0F, 0x71, 0xEE, 0x90, 0x05, 0x27, 0xE0, - 0x54, 0x7F, 0xF0, 0x90, 0x81, 0x86, 0x74, 0x0C, 0xF0, 0xE4, 0xFD, 0xFF, 0x21, 0xAD, 0x12, 0x4F, - 0xD4, 0x70, 0x2A, 0x90, 0x81, 0x88, 0xE0, 0x54, 0xFD, 0xF0, 0x7D, 0x2C, 0x7F, 0x6F, 0x31, 0xAD, - 0x7D, 0x08, 0x7F, 0x01, 0x91, 0xB8, 0xBF, 0x01, 0x0F, 0x90, 0x81, 0x87, 0xE0, 0x44, 0x80, 0xF0, - 0x7D, 0x0E, 0x91, 0x75, 0x74, 0x0E, 0xF0, 0x22, 0x12, 0x87, 0x32, 0x04, 0xF0, 0x22, 0xE0, 0x54, - 0x7F, 0xF0, 0x7D, 0x0C, 0x7F, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAC, 0x07, 0xEF, - 0x14, 0x60, 0x15, 0x14, 0x60, 0x19, 0x24, 0x02, 0x70, 0x1A, 0xED, 0x54, 0x01, 0xFE, 0x90, 0x81, - 0x87, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0x80, 0x0C, 0x90, 0x81, 0x8F, 0xED, 0xF0, 0x80, 0x05, 0x90, - 0x81, 0x8E, 0xED, 0xF0, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE4, 0x2E, 0xEC, 0x14, 0x60, 0x07, 0x14, - 0x60, 0x1D, 0x24, 0x02, 0x70, 0x23, 0x90, 0x81, 0x87, 0xE0, 0x54, 0x01, 0xC4, 0x33, 0x33, 0x33, - 0x54, 0x80, 0xFF, 0x90, 0x81, 0x8F, 0xE0, 0x54, 0x7F, 0x4F, 0xFD, 0x7F, 0x88, 0x80, 0x07, 0x90, - 0x81, 0x8E, 0xE0, 0xFD, 0x7F, 0x89, 0x12, 0x32, 0x1E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x82, - 0xE6, 0xEF, 0xF0, 0xB1, 0x1D, 0x90, 0x82, 0xE6, 0xE0, 0x60, 0x02, 0xF1, 0xBF, 0x7D, 0x04, 0x91, - 0x75, 0x74, 0x04, 0xF0, 0x22, 0x7F, 0x01, 0x71, 0xF6, 0x90, 0x81, 0x86, 0x22, 0xEF, 0x60, 0x33, - 0x12, 0x4F, 0xD4, 0x70, 0x2E, 0x90, 0x81, 0x88, 0xE0, 0x54, 0xFE, 0xF0, 0x7D, 0x2B, 0x7F, 0x0F, - 0x31, 0xAD, 0x90, 0x06, 0x04, 0xE0, 0x54, 0xBF, 0xF0, 0x91, 0xB4, 0xBF, 0x01, 0x0F, 0x90, 0x81, - 0x87, 0xE0, 0x44, 0x40, 0xF0, 0x7D, 0x06, 0x91, 0x75, 0x74, 0x06, 0xF0, 0x22, 0x12, 0x87, 0x32, - 0x74, 0x08, 0xF0, 0x22, 0x7D, 0x08, 0xE4, 0xFF, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, - 0x82, 0xBE, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x80, 0x3E, 0xE0, 0x04, 0xF0, 0x90, 0x04, 0x1D, - 0xE0, 0x60, 0x2B, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x82, 0xC2, 0xF0, 0x7D, 0x26, 0x7F, 0xFF, 0x31, - 0xAD, 0x12, 0x87, 0x3C, 0xEF, 0x64, 0x01, 0x70, 0x02, 0xD1, 0xE9, 0x90, 0x82, 0xC2, 0xE0, 0xFF, - 0x7D, 0x27, 0x31, 0xAD, 0x90, 0x82, 0xBE, 0xE0, 0xFF, 0x12, 0x88, 0xCB, 0x80, 0x0A, 0x90, 0x82, - 0xBE, 0xE0, 0xFF, 0x12, 0x88, 0xCB, 0xD1, 0xE9, 0x12, 0x77, 0xCC, 0x7F, 0x01, 0xD0, 0xD0, 0x92, - 0xAF, 0x22, 0x31, 0xA8, 0x71, 0xF2, 0x90, 0x81, 0x86, 0x74, 0x0C, 0xF0, 0x22, 0xD3, 0x10, 0xAF, - 0x01, 0xC3, 0xC0, 0xD0, 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, 0x8A, 0x50, - 0xEC, 0x54, 0x7F, 0xFC, 0x90, 0x82, 0xCB, 0x12, 0x20, 0xCE, 0x90, 0x82, 0xCB, 0x12, 0x47, 0xA1, - 0x12, 0x6D, 0xB1, 0x12, 0x8A, 0x11, 0x90, 0x85, 0xBB, 0x12, 0x20, 0xDA, 0xCC, 0xC0, 0x00, 0xC0, - 0x12, 0x8A, 0x57, 0x90, 0x85, 0xBB, 0x12, 0x20, 0xDA, 0x00, 0xC0, 0x00, 0x14, 0x12, 0x89, 0xE2, - 0x12, 0x20, 0xDA, 0x00, 0x03, 0x3E, 0x60, 0xE4, 0xFD, 0xFF, 0x12, 0x7E, 0x1C, 0xD0, 0xD0, 0x92, - 0xAF, 0x22, 0x7D, 0x2E, 0x7F, 0x6F, 0x31, 0xAD, 0x7D, 0x02, 0x7F, 0x01, 0x71, 0xF6, 0x12, 0x8A, - 0x18, 0x90, 0x81, 0x86, 0x74, 0x02, 0xF0, 0x22, 0x90, 0x81, 0xF0, 0xE0, 0x30, 0xE0, 0x12, 0x90, - 0x01, 0x57, 0xE4, 0xF0, 0x31, 0xA8, 0xF1, 0xF0, 0x30, 0xE0, 0x02, 0x71, 0xF2, 0x12, 0x67, 0xE4, - 0xF0, 0x22, 0x7D, 0x2D, 0x7F, 0xFF, 0x31, 0xAD, 0x12, 0x87, 0x3C, 0x90, 0x01, 0x37, 0x74, 0x02, - 0xF0, 0xFD, 0x7F, 0x03, 0x12, 0x71, 0x0D, 0x12, 0x6C, 0xFB, 0xE4, 0xFD, 0x7F, 0x01, 0x71, 0xF6, - 0xE4, 0x90, 0x81, 0x86, 0xF0, 0x22, 0x90, 0x80, 0x88, 0xE0, 0xFF, 0x90, 0x82, 0xCA, 0x74, 0x0B, - 0xF0, 0x7B, 0x08, 0x7D, 0x01, 0xD1, 0x4F, 0x90, 0x82, 0xD8, 0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, - 0xFD, 0x90, 0x82, 0xD7, 0xE0, 0xFF, 0xF1, 0x92, 0x54, 0x3F, 0xF0, 0xEF, 0x60, 0x0A, 0xF1, 0x85, - 0x44, 0x10, 0xF1, 0x91, 0x44, 0x80, 0xF0, 0x22, 0xF1, 0x85, 0x54, 0xEF, 0xF1, 0x91, 0x44, 0x40, - 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x82, 0xD7, 0xEF, 0xF0, 0x90, 0x04, - 0x1D, 0xE0, 0x60, 0x21, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x82, 0xDA, 0xF0, 0x7D, 0x29, 0x7F, 0xFF, - 0x31, 0xAD, 0x12, 0x87, 0x3C, 0xBF, 0x01, 0x02, 0xB1, 0xD6, 0x90, 0x82, 0xDA, 0xE0, 0xFF, 0x7D, - 0x2A, 0x31, 0xAD, 0x80, 0x02, 0xB1, 0xD6, 0x12, 0x77, 0xCC, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, - 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x82, 0xC8, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x82, - 0xC7, 0xEF, 0xF0, 0xE4, 0xFD, 0xFC, 0x12, 0x89, 0x31, 0x7C, 0x00, 0xAD, 0x07, 0x90, 0x82, 0xC7, - 0xE0, 0x90, 0x04, 0x25, 0xF0, 0x90, 0x82, 0xC8, 0xE0, 0x60, 0x0E, 0x74, 0x0F, 0x2F, 0xF5, 0x82, - 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0xAF, 0x05, 0x74, 0x08, 0x2F, 0xF5, 0x82, - 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x09, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, - 0x83, 0xE0, 0x54, 0xF0, 0xF0, 0xAF, 0x05, 0x74, 0x16, 0x2F, 0xF1, 0x7D, 0xE0, 0x54, 0x01, 0xFE, - 0x90, 0x82, 0xC9, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0xFB, 0xEE, 0x44, 0x02, 0x4B, 0xFE, 0x74, 0x16, - 0x2F, 0xF1, 0x7D, 0xEE, 0xF0, 0x90, 0x82, 0xCA, 0xE0, 0xFF, 0xAE, 0x05, 0x74, 0x1E, 0x2E, 0xF5, - 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x21, 0x2E, 0xF1, 0x88, 0x54, 0xF7, 0xF0, - 0xAE, 0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x80, 0x87, 0xE0, 0xFF, 0x90, 0x82, - 0xBF, 0xE0, 0xFB, 0x90, 0x82, 0xCA, 0x74, 0x0A, 0xF0, 0x7D, 0x01, 0xD1, 0x4F, 0x90, 0x82, 0xC0, - 0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0x82, 0xBE, 0xE0, 0xFF, 0xB1, 0xF6, 0x90, 0x82, - 0xC0, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x04, 0x80, 0xE0, 0x54, 0x0F, 0xFD, 0xAC, 0x07, 0x12, - 0x89, 0xB7, 0x44, 0x01, 0xF0, 0x12, 0x89, 0xB7, 0x54, 0xFB, 0xF0, 0xAC, 0x07, 0x74, 0x16, 0x2C, - 0xF1, 0x7D, 0xE0, 0x44, 0xFA, 0xF0, 0x74, 0x15, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, - 0xE0, 0x44, 0x1F, 0xF0, 0xAC, 0x07, 0x74, 0x06, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, - 0xE0, 0x44, 0x0F, 0xF0, 0x90, 0x04, 0x53, 0xE4, 0xF0, 0x90, 0x04, 0x52, 0xF0, 0x90, 0x04, 0x51, - 0x74, 0xFF, 0xF0, 0x90, 0x04, 0x50, 0x74, 0xFD, 0xF0, 0x74, 0x14, 0x2C, 0x12, 0x8A, 0x20, 0xE0, - 0x54, 0xC0, 0x4D, 0xFD, 0x74, 0x14, 0x2F, 0x12, 0x8A, 0x20, 0xED, 0xF0, 0x22, 0xF5, 0x82, 0xE4, - 0x34, 0xFC, 0xF5, 0x83, 0x22, 0x74, 0x21, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, - 0x22, 0xF0, 0x74, 0x1F, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0x31, 0xA8, - 0x90, 0x81, 0x85, 0x74, 0x01, 0xF0, 0x22, 0xF0, 0x7D, 0x04, 0x7F, 0x01, 0x61, 0xF6, 0x12, 0x8A, - 0x09, 0xF1, 0xBF, 0x7D, 0x0C, 0x7F, 0x01, 0x61, 0xF6, 0xE4, 0xFD, 0x7F, 0x0C, 0x31, 0xCD, 0xE4, - 0xFD, 0xFF, 0x21, 0xAD, 0x12, 0x86, 0x2D, 0x90, 0x81, 0x8F, 0xE0, 0x64, 0x0C, 0x60, 0x04, 0xF1, - 0xB9, 0x91, 0xB4, 0x22, 0xF1, 0xBF, 0x12, 0x6D, 0x83, 0x80, 0xC5, 0x7D, 0x1F, 0x7F, 0x6F, 0x31, - 0xAD, 0x90, 0x05, 0x27, 0xE0, 0x54, 0xBF, 0xF0, 0x90, 0x81, 0x85, 0x74, 0x04, 0xF0, 0x22, 0x22, - 0x90, 0x81, 0xF0, 0xE0, 0xC3, 0x13, 0x22, 0xC0, 0xE0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, - 0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, 0xF7, 0x90, 0x01, 0xC4, 0xED, 0xF0, 0x74, 0x57, 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, 0x01, 0xC8, 0xE4, 0xF0, 0xA3, 0xF0, 0xA3, - 0xF0, 0x7B, 0x01, 0x7A, 0x82, 0x79, 0x11, 0x7F, 0xFF, 0xFE, 0x12, 0x2B, 0x27, 0xBF, 0x01, 0x09, - 0x90, 0x82, 0x11, 0xE0, 0x64, 0x03, 0x60, 0x03, 0x22, 0x01, 0xEA, 0xE4, 0x90, 0x82, 0x16, 0xF0, - 0x90, 0x82, 0x16, 0xE0, 0xFF, 0xC3, 0x94, 0x02, 0x40, 0x02, 0x21, 0x25, 0xC3, 0x74, 0xFE, 0x9F, - 0xFF, 0xE4, 0x94, 0x00, 0xFE, 0x7B, 0x01, 0x7A, 0x82, 0x79, 0x12, 0x12, 0x2B, 0x27, 0xEF, 0x64, - 0x01, 0x70, 0x77, 0x90, 0x82, 0x12, 0xE0, 0xFF, 0x54, 0xC0, 0xFE, 0x60, 0x05, 0xEF, 0x54, 0x0C, - 0x70, 0x16, 0x90, 0x82, 0x12, 0xE0, 0xFF, 0x54, 0x30, 0x60, 0x67, 0xEF, 0x54, 0x03, 0x60, 0x62, - 0x90, 0x82, 0x13, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x82, 0x13, 0xF0, 0x90, 0x82, 0x13, - 0xE0, 0x90, 0x82, 0x12, 0x70, 0x16, 0xE0, 0xFF, 0xEE, 0x13, 0x13, 0x54, 0x3F, 0x90, 0x82, 0x14, - 0xF0, 0xEF, 0x54, 0x0C, 0x13, 0x13, 0x54, 0x3F, 0xA3, 0xF0, 0x80, 0x0D, 0xE0, 0xFE, 0x54, 0x30, - 0x90, 0x82, 0x14, 0xF0, 0xEE, 0x54, 0x03, 0xA3, 0xF0, 0x90, 0x82, 0x14, 0xE0, 0x64, 0x30, 0x70, - 0x54, 0xA3, 0xE0, 0x64, 0x02, 0x70, 0x4E, 0x90, 0x00, 0xF5, 0xE0, 0x54, 0x40, 0x90, 0x82, 0x17, - 0xF0, 0xE0, 0x70, 0x41, 0xA3, 0x74, 0x02, 0xF0, 0x80, 0x10, 0x90, 0x82, 0x18, 0x74, 0x01, 0xF0, - 0x80, 0x08, 0x90, 0x82, 0x16, 0xE0, 0x04, 0xF0, 0x01, 0x50, 0x90, 0x01, 0xC4, 0x74, 0x28, 0xF0, - 0x74, 0x58, 0xA3, 0xF0, 0x90, 0x82, 0x18, 0xE0, 0x90, 0x01, 0xC8, 0xF0, 0x90, 0x82, 0x12, 0xE0, - 0x90, 0x01, 0xC9, 0xF0, 0x90, 0x82, 0x13, 0xE0, 0x90, 0x01, 0xCA, 0xF0, 0xE4, 0xFD, 0x7F, 0x1F, - 0x12, 0x32, 0x1E, 0x80, 0xD5, 0x22, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x12, - 0x32, 0x1E, 0x90, 0xFD, 0x00, 0xE0, 0x54, 0xBF, 0xF0, 0x11, 0x28, 0x12, 0x82, 0xC0, 0x12, 0x32, - 0x77, 0x12, 0x82, 0xCD, 0x31, 0x83, 0x7F, 0x01, 0x12, 0x44, 0x15, 0x90, 0x81, 0xFB, 0x74, 0x02, - 0xF0, 0xFF, 0x12, 0x44, 0x15, 0x90, 0x81, 0xFB, 0xE0, 0x04, 0xF0, 0x12, 0x68, 0x05, 0x31, 0x94, - 0x90, 0x01, 0xCC, 0x74, 0x0F, 0xF0, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x40, 0xFD, 0x7F, 0x80, 0x12, - 0x32, 0x1E, 0x75, 0x20, 0xFF, 0x12, 0x69, 0x25, 0x12, 0x82, 0xFD, 0x12, 0x83, 0x83, 0xE4, 0xFF, - 0x02, 0x44, 0x9E, 0xE4, 0x90, 0x80, 0x3C, 0xF0, 0x31, 0x8C, 0xF0, 0x22, 0xA3, 0xF0, 0xA3, 0xF0, - 0xA3, 0xF0, 0xA3, 0x22, 0xF1, 0xE7, 0x12, 0x82, 0xB2, 0x31, 0xAA, 0x12, 0x88, 0x93, 0x12, 0x73, - 0x82, 0x12, 0x87, 0xFE, 0x12, 0x89, 0x9D, 0x02, 0x48, 0x22, 0x90, 0x04, 0x44, 0x74, 0x11, 0xF0, - 0xA3, 0x74, 0xF0, 0xF0, 0xA3, 0x74, 0x0F, 0xF0, 0xA3, 0xE4, 0xF0, 0x90, 0x82, 0x11, 0xF0, 0x90, - 0x81, 0x81, 0xE0, 0xFF, 0x90, 0x82, 0x11, 0xE0, 0xC3, 0x9F, 0x40, 0x02, 0x41, 0x98, 0xE0, 0xFF, - 0x75, 0xF0, 0x0A, 0x90, 0x89, 0x00, 0x51, 0x99, 0x90, 0x89, 0x02, 0x51, 0x99, 0x90, 0x89, 0x04, - 0x51, 0x99, 0x90, 0x89, 0x06, 0x51, 0x99, 0x90, 0x89, 0x08, 0x12, 0x47, 0xDE, 0xE4, 0xF0, 0xA3, - 0xF0, 0xEF, 0x51, 0xA5, 0x25, 0xE0, 0x24, 0x4B, 0xF5, 0x82, 0xE4, 0x34, 0x92, 0x51, 0xBE, 0x25, - 0xE0, 0x24, 0xCB, 0xF5, 0x82, 0xE4, 0x34, 0x91, 0x51, 0xBE, 0x25, 0xE0, 0x24, 0x0C, 0xF5, 0x82, - 0xE4, 0x34, 0x93, 0x51, 0xBE, 0x25, 0xE0, 0x24, 0x8C, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, - 0xE4, 0xF0, 0xA3, 0xF0, 0x74, 0x8C, 0x2F, 0x12, 0x8A, 0x48, 0xE4, 0xF0, 0x90, 0x41, 0xFC, 0xD1, - 0xAC, 0x90, 0x41, 0xC4, 0x12, 0x89, 0x90, 0x13, 0xFF, 0x90, 0x82, 0x11, 0xE0, 0xFD, 0xB1, 0x3B, - 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x08, 0xED, 0x12, 0x89, 0xCE, 0x44, 0x20, 0xF0, 0x74, - 0x81, 0x2D, 0x12, 0x67, 0xAA, 0x74, 0x0C, 0xF0, 0x75, 0xF0, 0x08, 0xED, 0x90, 0x8F, 0x49, 0x12, - 0x47, 0xDE, 0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x08, 0xED, 0x90, 0x8F, 0x47, 0x12, 0x47, - 0xDE, 0xE4, 0xF0, 0xA3, 0x74, 0x0F, 0xF0, 0x75, 0xF0, 0x08, 0xED, 0xD1, 0xEE, 0x74, 0x13, 0xF0, - 0x75, 0xF0, 0x08, 0xED, 0xF1, 0xE1, 0xE4, 0xF0, 0x74, 0xB0, 0x2D, 0x12, 0x64, 0x5A, 0xE4, 0xF0, - 0x90, 0x82, 0x11, 0xE0, 0x04, 0xF0, 0x21, 0xBF, 0x22, 0x12, 0x47, 0xDE, 0xE4, 0xF0, 0xA3, 0xF0, - 0x75, 0xF0, 0x0A, 0xEF, 0x22, 0x25, 0xE0, 0x24, 0x80, 0xF5, 0x82, 0xE4, 0x34, 0x8C, 0xF5, 0x83, - 0xE4, 0xF0, 0xA3, 0xF0, 0xEF, 0x25, 0xE0, 0x24, 0x4B, 0xF5, 0x82, 0xE4, 0x34, 0x91, 0xF5, 0x83, - 0xE4, 0xF0, 0xA3, 0xF0, 0xEF, 0x22, 0xE4, 0x90, 0x82, 0x7E, 0xF0, 0x90, 0x81, 0x81, 0xE0, 0xFE, - 0x90, 0x82, 0x7E, 0xE0, 0xFF, 0xC3, 0x9E, 0x40, 0x02, 0x81, 0xE3, 0x12, 0x65, 0xE3, 0xEF, 0x70, - 0x02, 0x81, 0xDB, 0x90, 0x82, 0x7E, 0x12, 0x89, 0xC3, 0x12, 0x67, 0xA2, 0x30, 0xE0, 0x02, 0x81, - 0xDB, 0x12, 0x7C, 0x8A, 0xE0, 0xFE, 0xA3, 0xE0, 0xD3, 0x94, 0x00, 0xEE, 0x94, 0x00, 0x50, 0x02, - 0x81, 0xDB, 0x90, 0x82, 0x7E, 0xE0, 0x75, 0xF0, 0x0A, 0xA4, 0x24, 0x00, 0xF9, 0x74, 0x89, 0x35, - 0xF0, 0xFA, 0x7B, 0x01, 0x90, 0x82, 0x83, 0x12, 0x47, 0xF3, 0x90, 0x82, 0x7E, 0xE0, 0xFF, 0x12, - 0x7C, 0x8B, 0xE0, 0xFD, 0xA3, 0xE0, 0x90, 0x82, 0x88, 0xCD, 0xF0, 0xA3, 0xED, 0xF0, 0xEF, 0x12, - 0x7C, 0x7E, 0xE0, 0xFF, 0xA3, 0xE0, 0x90, 0x82, 0x8A, 0xCF, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x82, - 0x7E, 0xE0, 0xFD, 0x24, 0xB0, 0x12, 0x64, 0x5A, 0xE0, 0x54, 0x3F, 0x90, 0x82, 0x7F, 0xF0, 0xE0, - 0xFF, 0x54, 0x1F, 0xFE, 0x75, 0xF0, 0x08, 0xED, 0xD1, 0xEE, 0xE0, 0xFD, 0x90, 0x82, 0x7E, 0xE0, - 0xF9, 0x24, 0x8C, 0x12, 0x8A, 0x48, 0xE0, 0xC3, 0x94, 0x05, 0x40, 0x02, 0x81, 0x7B, 0xEE, 0x9D, - 0x40, 0x0B, 0xAE, 0x05, 0xEF, 0x54, 0x40, 0x90, 0x82, 0x7F, 0xF0, 0x4D, 0xF0, 0xEE, 0x90, 0x41, - 0x82, 0x93, 0xFF, 0x74, 0xCB, 0x29, 0x12, 0x8A, 0x40, 0xE0, 0xC3, 0x9F, 0xEE, 0x40, 0x05, 0x90, - 0x41, 0x4A, 0x80, 0x03, 0x90, 0x41, 0x66, 0x93, 0x90, 0x82, 0x8C, 0xF0, 0x90, 0x82, 0x8C, 0xE0, - 0x75, 0xF0, 0x06, 0xA4, 0x24, 0xC0, 0xF9, 0x74, 0x40, 0x35, 0xF0, 0xFA, 0x7B, 0xFF, 0x90, 0x82, - 0x80, 0x12, 0x47, 0xF3, 0x90, 0x82, 0x7F, 0xE0, 0x90, 0x42, 0x2A, 0x93, 0xFF, 0xD3, 0x90, 0x82, - 0x8B, 0xE0, 0x9F, 0x90, 0x82, 0x8A, 0xE0, 0x94, 0x00, 0x40, 0x02, 0x81, 0x72, 0x90, 0x82, 0x7E, - 0xE0, 0xB1, 0x3B, 0xE0, 0xFF, 0xA3, 0xE0, 0x90, 0x82, 0x86, 0xCF, 0xF0, 0xA3, 0xEF, 0xF0, 0xB1, - 0x02, 0x12, 0x1F, 0xA4, 0x91, 0xE7, 0x12, 0x46, 0xB9, 0x91, 0xF3, 0x12, 0x64, 0x4F, 0x91, 0xE7, - 0x90, 0x00, 0x02, 0x91, 0xF0, 0x90, 0x00, 0x02, 0x91, 0xE4, 0x90, 0x00, 0x04, 0x91, 0xF0, 0x90, - 0x00, 0x03, 0x91, 0xE4, 0x90, 0x00, 0x06, 0x91, 0xF0, 0x90, 0x00, 0x04, 0x91, 0xE4, 0x90, 0x00, - 0x08, 0x91, 0xF0, 0x12, 0x67, 0x9C, 0xFF, 0x7E, 0x00, 0x90, 0x82, 0x88, 0xE0, 0xFC, 0xA3, 0xE0, - 0xFD, 0x12, 0x20, 0x1E, 0xD1, 0x93, 0x40, 0x0C, 0xA3, 0xE0, 0x9F, 0xF0, 0x90, 0x82, 0x86, 0xE0, - 0x9E, 0xF0, 0x80, 0x07, 0xE4, 0x90, 0x82, 0x86, 0xF0, 0xA3, 0xF0, 0x90, 0x82, 0x86, 0xE0, 0xFC, - 0xA3, 0xE0, 0xFD, 0x90, 0x82, 0x7E, 0xE0, 0xFF, 0xB1, 0x3B, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x12, - 0x7A, 0x99, 0x90, 0x82, 0x7F, 0xE0, 0xD1, 0x7E, 0xD1, 0xA9, 0xD1, 0x93, 0x40, 0x09, 0x90, 0x82, - 0x7E, 0xE0, 0xFF, 0xB1, 0x47, 0x80, 0x14, 0x90, 0x82, 0x7F, 0xE0, 0xD1, 0xA0, 0xC3, 0xD1, 0x94, - 0x50, 0x09, 0x90, 0x82, 0x7E, 0xE0, 0xFF, 0x7D, 0x01, 0xD1, 0xF4, 0x91, 0xEA, 0xE4, 0xF5, 0xF0, - 0x12, 0x47, 0x1C, 0x91, 0xEA, 0x90, 0x00, 0x02, 0xB1, 0x08, 0x90, 0x00, 0x04, 0xB1, 0x08, 0x90, - 0x00, 0x06, 0xB1, 0x08, 0x90, 0x00, 0x08, 0xB1, 0x08, 0x90, 0x82, 0x7E, 0xE0, 0xFF, 0x51, 0xA5, - 0x12, 0x7C, 0xFC, 0xF0, 0xA3, 0xF0, 0x90, 0x82, 0x7F, 0xE0, 0xFF, 0x25, 0xE0, 0x24, 0xD6, 0xF5, - 0x82, 0xE4, 0x34, 0x41, 0xF5, 0x83, 0xE4, 0x93, 0xFC, 0x74, 0x01, 0x93, 0xFD, 0xEF, 0xD1, 0x7E, - 0xF5, 0x83, 0x74, 0x01, 0x93, 0x2D, 0xFF, 0xE4, 0x93, 0x3C, 0xC3, 0x13, 0xFE, 0xEF, 0x13, 0xFF, - 0x90, 0x82, 0x7E, 0xE0, 0xB1, 0x3B, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x82, 0x7E, 0xE0, 0x04, - 0xF0, 0x41, 0xCB, 0x22, 0x12, 0x1F, 0xBD, 0xFF, 0x7E, 0x00, 0x90, 0x82, 0x83, 0x02, 0x47, 0xEA, - 0x12, 0x46, 0xE4, 0xFD, 0xAC, 0xF0, 0x12, 0x20, 0x1E, 0x90, 0x82, 0x86, 0xEE, 0x8F, 0xF0, 0x12, - 0x46, 0xA3, 0x90, 0x82, 0x80, 0x02, 0x47, 0xEA, 0xE4, 0xF5, 0xF0, 0x02, 0x47, 0x3B, 0x25, 0xE0, - 0x24, 0xD6, 0xF5, 0x82, 0xE4, 0x34, 0x41, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, - 0xED, 0x25, 0xE0, 0x24, 0x9E, 0xF5, 0x82, 0xE4, 0x34, 0x41, 0xF5, 0x83, 0x74, 0x01, 0x93, 0x2F, - 0xFF, 0xE4, 0x93, 0x3E, 0xC3, 0x13, 0xFE, 0xEF, 0x13, 0xFF, 0xE9, 0x25, 0xE0, 0x24, 0xC1, 0xF5, - 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, 0x12, 0x64, 0x55, 0xE0, 0x54, 0x7F, 0x90, 0x82, 0x8D, - 0xF0, 0xE0, 0x54, 0x1F, 0xFD, 0xD1, 0xEA, 0xE0, 0xFF, 0x90, 0x82, 0x8E, 0xF0, 0xE9, 0x12, 0x63, - 0x88, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, 0x82, 0x8F, 0xCB, 0xF0, 0xA3, 0xEB, 0xF0, 0xE9, 0x12, 0x63, - 0x6D, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, 0x82, 0x91, 0xCB, 0xF0, 0xA3, 0xEB, 0xF0, 0xED, 0xD1, 0x7E, - 0xF5, 0x83, 0xE4, 0x93, 0xFA, 0x74, 0x01, 0x93, 0xFB, 0xB1, 0x3A, 0xEA, 0xF0, 0xA3, 0xEB, 0xF0, - 0xED, 0xC3, 0x9F, 0x50, 0x76, 0xD1, 0x88, 0xED, 0xF0, 0x04, 0xFC, 0x90, 0x82, 0x8E, 0xE0, 0xFF, - 0xEC, 0xD3, 0x9F, 0x40, 0x02, 0xC1, 0x38, 0xEC, 0xC3, 0x94, 0x10, 0x40, 0x15, 0xEC, 0x12, 0x60, - 0x89, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x82, 0x8F, 0xF1, 0xD9, - 0x70, 0x1E, 0xEC, 0xC3, 0x94, 0x10, 0x50, 0x40, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x04, 0x08, 0x80, - 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x82, 0x91, 0xF1, 0xD9, 0x60, 0x28, - 0xEC, 0xB4, 0x11, 0x09, 0x90, 0x82, 0x90, 0xE0, 0x30, 0xE7, 0x02, 0x7C, 0x17, 0xEC, 0x64, 0x13, - 0x60, 0x04, 0xEC, 0xB4, 0x12, 0x09, 0x90, 0x82, 0x8F, 0xE0, 0x30, 0xE0, 0x02, 0x7C, 0x18, 0xAD, - 0x04, 0x90, 0x82, 0x8D, 0xED, 0xF0, 0x80, 0x30, 0x0C, 0x80, 0x90, 0x90, 0x82, 0x8E, 0xE0, 0xFC, - 0x6D, 0x70, 0x2F, 0xD1, 0x88, 0xED, 0xF0, 0x75, 0xF0, 0x08, 0xE9, 0x12, 0x89, 0xCE, 0xC4, 0x13, - 0x54, 0x07, 0x30, 0xE0, 0x0D, 0x90, 0x82, 0x8D, 0xE0, 0x20, 0xE6, 0x06, 0xED, 0x44, 0x40, 0xF0, - 0x80, 0x06, 0x90, 0x82, 0x8D, 0xE0, 0xFF, 0x22, 0xED, 0xB1, 0x0E, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, - 0x80, 0x20, 0xED, 0xD3, 0x9C, 0x40, 0x1B, 0x90, 0x82, 0x8E, 0xE0, 0xFF, 0xD1, 0x88, 0xEF, 0xF0, - 0xAD, 0x07, 0x90, 0x82, 0x8D, 0xEF, 0xF0, 0xFC, 0xB1, 0x0E, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xAF, - 0x04, 0x22, 0x74, 0x01, 0x29, 0x12, 0x7C, 0xE1, 0xE4, 0xF0, 0xAF, 0x01, 0x90, 0x82, 0x8D, 0xE0, - 0x44, 0x80, 0xFD, 0x12, 0x63, 0x57, 0x90, 0x82, 0x8D, 0xE0, 0x44, 0x80, 0xFF, 0x22, 0x25, 0xE0, - 0x24, 0x9E, 0xF5, 0x82, 0xE4, 0x34, 0x41, 0x22, 0x74, 0xCD, 0x29, 0xF5, 0x82, 0xE4, 0x34, 0x94, - 0xF5, 0x83, 0x22, 0xD3, 0x90, 0x82, 0x87, 0xE0, 0x9F, 0x90, 0x82, 0x86, 0xE0, 0x9E, 0x22, 0xEC, - 0x25, 0xE0, 0x24, 0xD6, 0xF5, 0x82, 0xE4, 0x34, 0x41, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, - 0x93, 0xFF, 0x22, 0xAD, 0x07, 0x75, 0xF0, 0x08, 0xED, 0xD1, 0xEE, 0xE0, 0xFF, 0x74, 0xCD, 0x2D, - 0xD1, 0x8B, 0xE0, 0x54, 0x1F, 0xFC, 0xD3, 0x9F, 0x40, 0x02, 0xAC, 0x07, 0xD1, 0x9F, 0xEC, 0xD1, - 0x7E, 0xF5, 0x83, 0x12, 0x89, 0x90, 0x13, 0xFF, 0xED, 0xB1, 0x3B, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, - 0xAF, 0x05, 0xAD, 0x04, 0x12, 0x63, 0x57, 0xAF, 0x04, 0x22, 0x75, 0xF0, 0x08, 0xE9, 0x90, 0x8F, - 0x43, 0x02, 0x47, 0xDE, 0x12, 0x64, 0x55, 0xE0, 0x54, 0x7F, 0xFC, 0x54, 0x1F, 0xFF, 0x75, 0xF0, - 0x08, 0xE9, 0xF1, 0xE1, 0xE0, 0x90, 0x82, 0x8F, 0xF0, 0xD1, 0xEA, 0xE0, 0xFE, 0xE9, 0x12, 0x63, - 0x6D, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, 0x82, 0x90, 0xCB, 0xF0, 0xA3, 0xEB, 0xF0, 0xE9, 0x12, 0x63, - 0x88, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, 0x82, 0x92, 0xCB, 0xF0, 0xA3, 0xEB, 0xF0, 0xEF, 0xD3, 0x9E, - 0x40, 0x04, 0xAF, 0x06, 0xAC, 0x06, 0xED, 0x70, 0x02, 0xE1, 0xCB, 0x90, 0x82, 0x8E, 0xED, 0xF0, - 0xEC, 0x30, 0xE6, 0x05, 0xAC, 0x07, 0xE0, 0x14, 0xF0, 0x90, 0x82, 0x8E, 0xE0, 0x60, 0x7C, 0xEF, - 0xD3, 0x94, 0x00, 0x40, 0x76, 0xE4, 0x90, 0x82, 0x8D, 0xF0, 0xEF, 0x14, 0xFD, 0x90, 0x82, 0x8F, - 0xE0, 0xFF, 0xED, 0xD3, 0x9F, 0x40, 0x4D, 0xED, 0x94, 0x10, 0x40, 0x15, 0xED, 0x12, 0x60, 0x89, - 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x82, 0x92, 0xF1, 0xD9, 0x70, - 0x1E, 0xED, 0xC3, 0x94, 0x10, 0x50, 0x2A, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x05, 0x08, 0x80, 0x05, - 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x82, 0x90, 0xF1, 0xD9, 0x60, 0x12, 0xAC, - 0x05, 0x90, 0x82, 0x8D, 0xE0, 0x04, 0xF0, 0xA3, 0xE0, 0xFF, 0x90, 0x82, 0x8D, 0xE0, 0x6F, 0x60, - 0x03, 0x1D, 0x80, 0xA9, 0x90, 0x82, 0x8E, 0xE0, 0xFF, 0x90, 0x82, 0x8D, 0xE0, 0xC3, 0x9F, 0x50, - 0x0A, 0x90, 0x82, 0x8F, 0xE0, 0xFF, 0xB5, 0x05, 0x02, 0xAC, 0x07, 0xD1, 0x9F, 0xEC, 0xB1, 0x21, - 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xAF, 0x01, 0xC1, 0xE2, 0xE0, 0x5E, 0xFE, 0xA3, 0xE0, 0x5F, 0x4E, - 0x22, 0x90, 0x8F, 0x44, 0x02, 0x47, 0xDE, 0xE4, 0xFD, 0xFF, 0x12, 0x89, 0xD6, 0xED, 0x70, 0x14, - 0x12, 0x60, 0x28, 0xC0, 0x83, 0xC0, 0x82, 0x12, 0x60, 0x20, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, - 0xF4, 0x5E, 0x80, 0x0F, 0x11, 0x28, 0xC0, 0x83, 0xC0, 0x82, 0x11, 0x20, 0x80, 0x02, 0xC3, 0x33, - 0xD8, 0xFC, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x11, 0x33, 0x90, 0x81, 0x81, 0xEF, 0xF0, 0x22, - 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x07, 0x08, 0x22, 0x74, 0x79, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x81, - 0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x7D, 0x08, 0xED, 0x14, 0xF9, 0x24, - 0x79, 0x11, 0x2B, 0xE0, 0x60, 0x3A, 0x7C, 0x08, 0xEC, 0x14, 0x90, 0x82, 0xE3, 0xF0, 0x74, 0x79, - 0x29, 0x11, 0x2B, 0xE0, 0xFB, 0x7A, 0x00, 0x90, 0x82, 0xE3, 0xE0, 0x11, 0x8B, 0x80, 0x05, 0xC3, - 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5A, 0xFE, 0xEF, 0x5B, 0x4E, 0x60, 0x0F, 0xE9, - 0x75, 0xF0, 0x08, 0xA4, 0xFF, 0x90, 0x82, 0xE3, 0xE0, 0x2F, 0x04, 0xFF, 0x80, 0x06, 0xDC, 0xC8, - 0xDD, 0xBA, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x24, 0xF0, 0xFF, 0x74, 0x01, 0x7E, 0x00, - 0xA8, 0x07, 0x08, 0x22, 0x8F, 0x55, 0xEF, 0x75, 0xF0, 0x02, 0xA4, 0xFF, 0xAE, 0xF0, 0x24, 0x0C, - 0xF9, 0x74, 0x94, 0x3E, 0xFA, 0x7B, 0x01, 0x90, 0x82, 0x90, 0x12, 0x47, 0xF3, 0x74, 0x01, 0x2F, - 0xF9, 0x74, 0x8E, 0x3E, 0xFA, 0x90, 0x82, 0x93, 0x12, 0x47, 0xF3, 0xE5, 0x55, 0xF1, 0xD5, 0x3E, - 0xFA, 0x90, 0x82, 0x96, 0xF1, 0xBD, 0x90, 0x82, 0x99, 0x12, 0x47, 0xF3, 0x74, 0x81, 0x25, 0x55, - 0xF1, 0xAA, 0xE0, 0x12, 0x47, 0xFC, 0x60, 0xFB, 0x00, 0x61, 0x05, 0x01, 0x61, 0x0F, 0x02, 0x61, - 0x19, 0x03, 0x61, 0x2C, 0x04, 0x61, 0x36, 0x05, 0x61, 0x40, 0x06, 0x61, 0x50, 0x0C, 0x61, 0x69, - 0x0D, 0x61, 0x82, 0x0E, 0x61, 0x9B, 0x0F, 0x00, 0x00, 0x61, 0xB9, 0x71, 0x6B, 0x74, 0xF0, 0xF0, - 0xA3, 0x74, 0x15, 0x80, 0x1B, 0x71, 0x6B, 0x74, 0xF0, 0xF0, 0xA3, 0x74, 0x10, 0x80, 0x11, 0x71, - 0x6B, 0x74, 0xF0, 0xF0, 0xA3, 0x74, 0x05, 0x80, 0x07, 0x71, 0x6B, 0x74, 0xF0, 0xF0, 0xA3, 0xE4, - 0xF0, 0x71, 0x86, 0x74, 0x0F, 0xF0, 0xA3, 0x74, 0x8F, 0xF0, 0x21, 0xB9, 0x71, 0x6B, 0x74, 0x0F, - 0xF0, 0xA3, 0x74, 0xF5, 0x80, 0x11, 0x71, 0x6B, 0x74, 0x0F, 0xF0, 0xA3, 0x74, 0xF0, 0x80, 0x07, - 0x71, 0x6B, 0xE4, 0xF0, 0xA3, 0x74, 0x0D, 0xF0, 0x71, 0x86, 0xE4, 0xF0, 0xA3, 0xF0, 0x80, 0x69, - 0x90, 0x04, 0x47, 0xE0, 0xFF, 0x90, 0x82, 0x93, 0x71, 0x7E, 0x90, 0x04, 0x46, 0x71, 0x94, 0x90, - 0x04, 0x45, 0x71, 0x79, 0x90, 0x04, 0x44, 0x80, 0x49, 0x90, 0x04, 0x4B, 0xE0, 0xFF, 0x90, 0x82, - 0x93, 0x71, 0x7E, 0x90, 0x04, 0x4A, 0x71, 0x94, 0x90, 0x04, 0x49, 0x71, 0x79, 0x90, 0x04, 0x48, - 0x80, 0x30, 0x90, 0x04, 0x4F, 0xE0, 0xFF, 0x90, 0x82, 0x93, 0x71, 0x7E, 0x90, 0x04, 0x4E, 0x71, - 0x94, 0x90, 0x04, 0x4D, 0x71, 0x79, 0x90, 0x04, 0x4C, 0x80, 0x17, 0x90, 0x04, 0x53, 0xE0, 0xFF, - 0x90, 0x82, 0x93, 0x71, 0x7E, 0x90, 0x04, 0x52, 0x71, 0x94, 0x90, 0x04, 0x51, 0x71, 0x79, 0x90, - 0x04, 0x50, 0xE0, 0xFF, 0x90, 0x82, 0x90, 0x71, 0x99, 0x90, 0x82, 0x93, 0x12, 0x47, 0xEA, 0xC0, - 0x03, 0xC0, 0x02, 0xC0, 0x01, 0xB1, 0xD0, 0x91, 0x62, 0x5F, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, - 0x12, 0x1F, 0xEA, 0x90, 0x82, 0x93, 0xB1, 0xD8, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0xB1, 0xD0, - 0x91, 0x4C, 0x5F, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x12, 0x1F, 0xEA, 0x90, 0x82, 0x90, 0x12, - 0x47, 0xEA, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0xB1, 0xC8, 0x91, 0x62, 0x5F, 0xD0, 0x01, 0xD0, - 0x02, 0xD0, 0x03, 0x12, 0x1F, 0xEA, 0x90, 0x82, 0x90, 0xB1, 0xD8, 0xC0, 0x03, 0xC0, 0x02, 0xC0, - 0x01, 0xB1, 0xC8, 0x91, 0x4C, 0x5F, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x12, 0x1F, 0xEA, 0x71, - 0x86, 0xE0, 0xFE, 0xA3, 0xE0, 0x4E, 0x60, 0x2E, 0x90, 0x82, 0x8F, 0x74, 0x0B, 0xF0, 0x91, 0x45, - 0x94, 0x00, 0x40, 0x5C, 0x11, 0x8C, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x71, - 0x85, 0x12, 0x5F, 0xD9, 0x60, 0x08, 0x90, 0x82, 0x8F, 0xE0, 0x24, 0x10, 0x80, 0x3E, 0x90, 0x82, - 0x8F, 0xE0, 0x14, 0xF0, 0x80, 0xD8, 0x71, 0x6B, 0xE0, 0xFE, 0xA3, 0xE0, 0x4E, 0x60, 0x2C, 0x90, - 0x82, 0x8F, 0x74, 0x0F, 0xF0, 0x91, 0x45, 0x94, 0x00, 0x40, 0x25, 0x11, 0x8C, 0x80, 0x05, 0xC3, - 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x71, 0x6A, 0x12, 0x5F, 0xD9, 0x60, 0x06, 0x90, 0x82, 0x8F, - 0xE0, 0x80, 0x09, 0x90, 0x82, 0x8F, 0xE0, 0x14, 0xF0, 0x80, 0xDA, 0xE4, 0x90, 0x82, 0x9C, 0xF0, - 0x71, 0x6B, 0xE0, 0xFE, 0xA3, 0xE0, 0x4E, 0x60, 0x2B, 0xE4, 0x90, 0x82, 0x8F, 0xF0, 0x91, 0x45, - 0x94, 0x10, 0x50, 0x5B, 0x11, 0x8C, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x71, - 0x6A, 0x12, 0x5F, 0xD9, 0x60, 0x06, 0x90, 0x82, 0x8F, 0xE0, 0x80, 0x3F, 0x90, 0x82, 0x8F, 0xE0, - 0x04, 0xF0, 0x80, 0xDA, 0x71, 0x86, 0xE0, 0xFE, 0xA3, 0xE0, 0x4E, 0x60, 0x2D, 0xE4, 0x90, 0x82, - 0x8F, 0xF0, 0x91, 0x45, 0x94, 0x0C, 0x50, 0x27, 0x11, 0x8C, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, - 0xCE, 0xD8, 0xF9, 0x71, 0x85, 0x12, 0x5F, 0xD9, 0x60, 0x08, 0x90, 0x82, 0x8F, 0xE0, 0x24, 0x10, - 0x80, 0x09, 0x90, 0x82, 0x8F, 0xE0, 0x04, 0xF0, 0x80, 0xD8, 0xE4, 0x90, 0x82, 0x9D, 0xF0, 0x90, - 0x82, 0x9C, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xE5, 0x55, 0x12, 0x5E, 0xEE, 0xEF, 0xF0, 0x90, 0x82, - 0x9D, 0xE0, 0xFE, 0x75, 0xF0, 0x08, 0xE5, 0x55, 0x12, 0x5F, 0xE1, 0xEE, 0xF0, 0x90, 0x81, 0x81, - 0xE0, 0xFD, 0xE5, 0x55, 0xC3, 0x9D, 0x50, 0x28, 0x74, 0xB0, 0x25, 0x55, 0x91, 0x5A, 0xE0, 0xD3, - 0x9F, 0x40, 0x02, 0x80, 0x13, 0x74, 0xB0, 0x25, 0x55, 0x91, 0x5A, 0xE0, 0xC3, 0x9E, 0x50, 0x08, - 0x90, 0x82, 0x9D, 0xE0, 0xA3, 0xF0, 0x80, 0x08, 0x90, 0x82, 0x9C, 0xE0, 0x90, 0x82, 0x9E, 0xF0, - 0x90, 0x82, 0x9E, 0xE0, 0xFD, 0xAF, 0x55, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x74, 0xB0, - 0x2F, 0x91, 0x5A, 0xED, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xFF, 0xE5, 0x55, 0x25, 0xE0, 0x24, - 0x0C, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0x22, 0xE0, 0xFF, 0x90, 0x82, 0x90, 0x12, 0x47, - 0xEA, 0xEF, 0x02, 0x1F, 0xEA, 0xFF, 0xE5, 0x55, 0x25, 0xE0, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, - 0x8E, 0xF5, 0x83, 0x22, 0xE0, 0xFF, 0x90, 0x82, 0x93, 0x12, 0x47, 0xEA, 0x90, 0x00, 0x01, 0xEF, - 0x02, 0x1F, 0xFC, 0x90, 0x82, 0x82, 0x12, 0x7C, 0xF5, 0x12, 0x47, 0xF3, 0x91, 0x4F, 0x54, 0x0F, - 0x90, 0x82, 0x87, 0xF0, 0xD1, 0x5D, 0x54, 0x40, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x90, 0x82, 0x88, - 0xF0, 0x90, 0x82, 0x82, 0xE0, 0xF1, 0xD5, 0x3E, 0xFA, 0x7B, 0x01, 0x90, 0x82, 0x89, 0xF1, 0xBD, - 0x90, 0x82, 0x8C, 0x12, 0x47, 0xF3, 0x91, 0x3F, 0x90, 0x00, 0x06, 0x12, 0x1F, 0xBD, 0xFF, 0x90, - 0x82, 0x8C, 0x71, 0x7E, 0x91, 0x3F, 0xF1, 0x9C, 0xFF, 0x90, 0x82, 0x8C, 0x71, 0x99, 0x91, 0x3F, - 0x90, 0x00, 0x04, 0xB1, 0xC0, 0x71, 0x7E, 0x91, 0x3F, 0x90, 0x00, 0x03, 0xB1, 0xC0, 0x71, 0x99, - 0x90, 0x82, 0x87, 0xE0, 0xFF, 0x90, 0x82, 0x82, 0xE0, 0xFE, 0x24, 0x81, 0xF1, 0xAA, 0xEF, 0xF0, - 0x90, 0x82, 0x83, 0xE0, 0x54, 0x01, 0xC4, 0x33, 0x54, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0xEE, 0x12, - 0x89, 0xCE, 0x54, 0xDF, 0x4F, 0xF0, 0x90, 0x82, 0x88, 0xE0, 0x54, 0x01, 0xC4, 0x33, 0x33, 0x54, - 0xC0, 0xFE, 0x90, 0x82, 0x82, 0x12, 0x89, 0xC3, 0xE0, 0x54, 0xBF, 0x4E, 0xF0, 0x01, 0x94, 0x90, - 0x82, 0x84, 0x02, 0x47, 0xEA, 0x90, 0x82, 0x8F, 0xE0, 0xFF, 0xC3, 0x22, 0x12, 0x47, 0xEA, 0x90, - 0x00, 0x01, 0x02, 0x1F, 0xBD, 0xA9, 0x07, 0x74, 0xB0, 0x29, 0xF5, 0x82, 0xE4, 0x34, 0x02, 0xF5, - 0x83, 0x22, 0x12, 0x47, 0xEA, 0x02, 0x1F, 0xA4, 0xF1, 0xB2, 0x54, 0x01, 0xFE, 0x90, 0x81, 0xF0, - 0xF1, 0xC9, 0x54, 0xFD, 0x4F, 0xFF, 0xF0, 0x12, 0x1F, 0xA4, 0xFE, 0x54, 0x04, 0x25, 0xE0, 0xFD, - 0xEF, 0x54, 0xF7, 0x4D, 0xFF, 0x90, 0x81, 0xF0, 0xF0, 0xEE, 0x54, 0x08, 0x25, 0xE0, 0xFE, 0xEF, - 0x54, 0xEF, 0x4E, 0xF0, 0x90, 0x05, 0x52, 0xE0, 0x54, 0x07, 0xFF, 0x90, 0x82, 0x82, 0x60, 0x12, - 0x91, 0x4C, 0xFD, 0x90, 0x05, 0x56, 0xE0, 0xC3, 0x9D, 0x90, 0x81, 0xF2, 0xF0, 0xA3, 0xED, 0xF0, - 0x80, 0x22, 0x91, 0x4C, 0xFB, 0xFF, 0x90, 0x05, 0x54, 0xE0, 0xC3, 0x9F, 0xFF, 0xE4, 0x94, 0x00, - 0xFE, 0x7C, 0x00, 0x7D, 0x05, 0x12, 0x20, 0x30, 0x90, 0x81, 0xF2, 0xEF, 0xF0, 0xEB, 0x75, 0xF0, - 0x05, 0x84, 0xA3, 0xF0, 0x90, 0x82, 0x82, 0x91, 0x62, 0x20, 0xE0, 0x0A, 0x12, 0x51, 0xA8, 0x90, - 0x01, 0x57, 0xE4, 0xF0, 0x80, 0x06, 0x12, 0x53, 0xF2, 0xF1, 0xE4, 0xF0, 0x90, 0x81, 0xF0, 0xE0, - 0xFF, 0xC4, 0x54, 0x0F, 0x20, 0xE0, 0x04, 0xEF, 0x54, 0xDF, 0xF0, 0x12, 0x57, 0xF0, 0x30, 0xE0, - 0x16, 0x90, 0x81, 0x8C, 0x74, 0x01, 0xF0, 0xE4, 0x90, 0x81, 0x8E, 0xF0, 0x12, 0x6F, 0xFB, 0xF0, - 0x90, 0x05, 0x58, 0x74, 0x05, 0xF0, 0x22, 0xE4, 0x90, 0x81, 0x8C, 0xF0, 0x90, 0x81, 0x8E, 0x74, - 0x0C, 0xF0, 0x90, 0x81, 0x87, 0xE0, 0x54, 0xFE, 0xF0, 0xA3, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x90, - 0x82, 0x7F, 0x12, 0x47, 0xF3, 0x90, 0x82, 0x7E, 0xEF, 0xF0, 0x12, 0x47, 0xFC, 0x65, 0x65, 0x00, - 0x65, 0x69, 0x01, 0x65, 0x6D, 0x12, 0x65, 0x72, 0x14, 0x65, 0x77, 0x20, 0x65, 0x7B, 0x24, 0x65, - 0x80, 0x25, 0x65, 0x85, 0x26, 0x65, 0x89, 0x27, 0x65, 0x8D, 0x40, 0x65, 0x91, 0x42, 0x65, 0x95, - 0xC0, 0x00, 0x00, 0x65, 0x9A, 0xB1, 0xAA, 0xC1, 0xAC, 0xB1, 0xAA, 0xC1, 0x05, 0xB1, 0xAA, 0x02, - 0x7D, 0xFA, 0xB1, 0xAA, 0x02, 0x82, 0x8C, 0xB1, 0xAA, 0xC1, 0xF8, 0xB1, 0xAA, 0x02, 0x69, 0x89, - 0xB1, 0xAA, 0x02, 0x82, 0x9B, 0xB1, 0xAA, 0x81, 0x68, 0xB1, 0xAA, 0xC1, 0x83, 0xB1, 0xAA, 0x80, - 0x1F, 0xB1, 0xAA, 0xC1, 0x63, 0xB1, 0xAA, 0x02, 0x82, 0xA3, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x01, - 0xF0, 0x90, 0x82, 0x7E, 0xE0, 0x90, 0x01, 0xC2, 0xF0, 0x22, 0x90, 0x82, 0x7F, 0x02, 0x47, 0xEA, - 0x12, 0x1F, 0xA4, 0x54, 0x3F, 0xFF, 0x91, 0x4F, 0x54, 0x80, 0xF1, 0xA3, 0xFE, 0xFD, 0x61, 0xA3, - 0x12, 0x1F, 0xBD, 0xFF, 0x90, 0x82, 0x89, 0x22, 0x12, 0x1F, 0xA4, 0xFF, 0x90, 0x82, 0x96, 0x22, - 0x12, 0x1F, 0xA4, 0xFF, 0x90, 0x82, 0x99, 0x22, 0x12, 0x47, 0xEA, 0xE9, 0x24, 0x01, 0xF9, 0xE4, - 0x3A, 0xFA, 0x22, 0x12, 0x89, 0xD6, 0x11, 0x28, 0xE0, 0xFD, 0x7C, 0x00, 0x11, 0x8C, 0x80, 0x05, - 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5C, 0xFE, 0xEF, 0x5D, 0x4E, 0x7F, 0x00, - 0x60, 0x02, 0x7F, 0x01, 0x22, 0x8B, 0x55, 0x8A, 0x56, 0x89, 0x57, 0x91, 0x4F, 0xFF, 0xF5, 0x59, - 0x12, 0x1F, 0xA4, 0xFE, 0xC3, 0x13, 0x30, 0xE0, 0x06, 0xD1, 0x5D, 0xF5, 0x5A, 0x80, 0x02, 0x8F, - 0x5A, 0x85, 0x59, 0x58, 0xE5, 0x58, 0xD3, 0x95, 0x5A, 0x50, 0x1E, 0x12, 0x89, 0xF7, 0x54, 0x01, - 0xFD, 0xAF, 0x58, 0x12, 0x5F, 0xEA, 0xAF, 0x58, 0xB1, 0xE3, 0xEF, 0xAF, 0x58, 0x70, 0x04, 0xF1, - 0xE3, 0x80, 0x02, 0xF1, 0xE2, 0x05, 0x58, 0x80, 0xDB, 0xE5, 0x59, 0x70, 0x0F, 0xFF, 0xB1, 0xE3, - 0xEF, 0x70, 0x09, 0x12, 0x6F, 0x71, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x22, 0x90, 0x00, 0x02, - 0x02, 0x1F, 0xBD, 0x12, 0x1F, 0xA4, 0xFF, 0xC3, 0x94, 0x40, 0x50, 0x0C, 0xD1, 0x5D, 0xFE, 0x74, - 0xCB, 0x2F, 0x12, 0x8A, 0x40, 0xEE, 0xF0, 0x22, 0xEF, 0xB4, 0x40, 0x06, 0xD1, 0x5D, 0x90, 0x8F, - 0x41, 0xF0, 0x22, 0x12, 0x1F, 0xA4, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x81, 0xF7, 0xF1, 0xC9, 0x54, - 0xFD, 0x4F, 0xF0, 0x91, 0x4F, 0x90, 0x81, 0xF8, 0xF0, 0xD1, 0x5D, 0x90, 0x81, 0xF9, 0xF0, 0x12, - 0x89, 0xED, 0x90, 0x81, 0xF7, 0xE0, 0x54, 0x01, 0xFF, 0x02, 0x4E, 0xDA, 0x90, 0x02, 0x09, 0xE0, - 0xF5, 0x55, 0x12, 0x1F, 0xA4, 0x25, 0x55, 0x90, 0x80, 0x85, 0xF0, 0x91, 0x4F, 0x25, 0x55, 0x90, - 0x80, 0x86, 0xF0, 0xD1, 0x5D, 0x25, 0x55, 0x90, 0x80, 0x87, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x1F, - 0xBD, 0x25, 0x55, 0x90, 0x80, 0x88, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x1F, 0xBD, 0x25, 0x55, 0x90, - 0x80, 0x89, 0xF0, 0xF1, 0x9C, 0x25, 0x55, 0x90, 0x80, 0x8A, 0xF0, 0x90, 0x00, 0x06, 0x12, 0x1F, - 0xBD, 0x25, 0x55, 0x90, 0x80, 0x8B, 0xF0, 0x22, 0xF1, 0xB2, 0x54, 0x7F, 0x90, 0x81, 0x8C, 0xF0, - 0xEF, 0xF1, 0xA3, 0xA3, 0xF0, 0x91, 0x4F, 0xFF, 0x54, 0xF0, 0xC4, 0x54, 0x0F, 0xFE, 0x90, 0x81, - 0x8A, 0xE0, 0x54, 0xF0, 0x4E, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x1F, 0xBD, 0x54, 0x01, 0x25, 0xE0, - 0xFE, 0x90, 0x81, 0x87, 0xE0, 0x54, 0xFD, 0x4E, 0xF0, 0xEF, 0x54, 0x0F, 0xC4, 0x54, 0xF0, 0xFF, - 0xF1, 0x95, 0x4F, 0xF0, 0xD1, 0x5D, 0x90, 0x81, 0x8B, 0xF0, 0x90, 0x00, 0x04, 0x12, 0x1F, 0xBD, - 0xFD, 0x7F, 0x02, 0x12, 0x53, 0xF6, 0x90, 0x82, 0x82, 0x12, 0x47, 0xEA, 0xF1, 0x5F, 0x12, 0x87, - 0x32, 0xF0, 0x90, 0x81, 0x8C, 0x12, 0x89, 0xAA, 0xF1, 0x94, 0x90, 0x01, 0xBE, 0xF0, 0x22, 0x90, - 0x82, 0x85, 0x12, 0x47, 0xF3, 0x12, 0x74, 0x80, 0x90, 0x81, 0x8C, 0xE0, 0xFF, 0x12, 0x6F, 0x7F, - 0x90, 0x81, 0x8C, 0xE0, 0x60, 0x17, 0x90, 0x82, 0x85, 0x91, 0x4C, 0x54, 0x0F, 0xFF, 0xD1, 0x5D, - 0xFD, 0x12, 0x87, 0xBA, 0x12, 0x75, 0xCF, 0x74, 0x01, 0xF0, 0x12, 0x72, 0xB5, 0x22, 0x90, 0x81, - 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x81, 0x8A, 0xE0, 0x54, 0x0F, 0x22, 0x90, 0x00, 0x05, 0x02, - 0x1F, 0xBD, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, - 0x83, 0x22, 0x90, 0x82, 0x82, 0x12, 0x47, 0xF3, 0x12, 0x1F, 0xA4, 0xFF, 0x22, 0x12, 0x47, 0xF3, - 0x74, 0x47, 0x2F, 0xF9, 0x74, 0x8F, 0x3E, 0xFA, 0x22, 0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, - 0x54, 0x02, 0xFF, 0xEE, 0x22, 0x75, 0xF0, 0x08, 0xA4, 0xFF, 0xAE, 0xF0, 0x24, 0x49, 0xF9, 0x74, - 0x8F, 0x22, 0x22, 0x22, 0x90, 0x81, 0xF0, 0xE0, 0x44, 0x04, 0x22, 0x90, 0x00, 0xF7, 0xE0, 0x20, - 0xE7, 0x09, 0xE0, 0x7F, 0x01, 0x20, 0xE6, 0x0C, 0x7F, 0x02, 0x22, 0x90, 0x00, 0xF7, 0xE0, 0x30, - 0xE6, 0x02, 0x7F, 0x03, 0x22, 0x12, 0x67, 0xEB, 0x90, 0x80, 0x42, 0xEF, 0xF0, 0x11, 0x26, 0x90, - 0x01, 0x64, 0x74, 0x01, 0xF0, 0x90, 0x00, 0x12, 0xE0, 0x54, 0xC7, 0x44, 0x20, 0xFD, 0x7F, 0x12, - 0x12, 0x32, 0x1E, 0x02, 0x2D, 0xA7, 0x11, 0x95, 0x11, 0xBF, 0x11, 0x54, 0x11, 0x73, 0xE4, 0xF5, - 0x35, 0xF5, 0x36, 0xF5, 0x37, 0x75, 0x38, 0x80, 0xAD, 0x35, 0x7F, 0x50, 0x12, 0x32, 0x1E, 0xAD, - 0x36, 0x7F, 0x51, 0x12, 0x32, 0x1E, 0xAD, 0x37, 0x7F, 0x52, 0x12, 0x32, 0x1E, 0xAD, 0x38, 0x7F, - 0x53, 0x02, 0x32, 0x1E, 0x75, 0x3D, 0x10, 0xE4, 0xF5, 0x3E, 0x75, 0x3F, 0x07, 0x75, 0x40, 0x22, - 0x90, 0x01, 0x30, 0xE5, 0x3D, 0xF0, 0xA3, 0xE5, 0x3E, 0xF0, 0xA3, 0xE5, 0x3F, 0xF0, 0xA3, 0xE5, - 0x40, 0xF0, 0x22, 0x75, 0x45, 0x06, 0x75, 0x46, 0x01, 0x43, 0x46, 0x10, 0x75, 0x47, 0x03, 0x75, - 0x48, 0x62, 0x90, 0x01, 0x38, 0xE5, 0x45, 0xF0, 0xA3, 0xE5, 0x46, 0xF0, 0xA3, 0xE5, 0x47, 0xF0, - 0xA3, 0xE5, 0x48, 0xF0, 0x22, 0x90, 0x01, 0x30, 0xE4, 0x12, 0x59, 0x8D, 0xF0, 0x90, 0x01, 0x38, - 0x12, 0x59, 0x8D, 0xF0, 0xFD, 0x7F, 0x50, 0x12, 0x32, 0x1E, 0xE4, 0xFD, 0x7F, 0x51, 0x12, 0x32, - 0x1E, 0xE4, 0xFD, 0x7F, 0x52, 0x12, 0x32, 0x1E, 0xE4, 0xFD, 0x7F, 0x53, 0x02, 0x32, 0x1E, 0x90, - 0x01, 0x34, 0x74, 0xFF, 0x12, 0x59, 0x8D, 0xF0, 0x90, 0x01, 0x3C, 0x12, 0x59, 0x8D, 0xF0, 0xFD, - 0x7F, 0x54, 0x12, 0x32, 0x1E, 0x7D, 0xFF, 0x7F, 0x55, 0x12, 0x32, 0x1E, 0x7D, 0xFF, 0x7F, 0x56, - 0x12, 0x32, 0x1E, 0x7D, 0xFF, 0x7F, 0x57, 0x02, 0x32, 0x1E, 0x90, 0x01, 0xCF, 0xE0, 0x90, 0x82, - 0xE5, 0xF0, 0xE0, 0xFF, 0x30, 0xE0, 0x07, 0x90, 0x01, 0xCF, 0xE0, 0x54, 0xFE, 0xF0, 0xEF, 0x30, - 0xE5, 0x22, 0x90, 0x01, 0xCF, 0xE0, 0x54, 0xDF, 0xF0, 0x90, 0x01, 0x34, 0x74, 0x20, 0xF0, 0xE4, - 0xF5, 0xA8, 0xF5, 0xE8, 0x11, 0x95, 0x90, 0x00, 0x03, 0xE0, 0x54, 0xFB, 0xFD, 0x7F, 0x03, 0x12, - 0x32, 0x1E, 0x80, 0xFE, 0x22, 0x75, 0xE8, 0x03, 0x75, 0xA8, 0x84, 0x22, 0xE4, 0x90, 0x82, 0x19, - 0xF0, 0x90, 0x82, 0x19, 0xE0, 0x64, 0x01, 0xF0, 0x24, 0x2C, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x69, - 0xA3, 0xF0, 0x90, 0x81, 0x8C, 0xE0, 0x60, 0x0E, 0x90, 0x81, 0x8F, 0xE0, 0xFF, 0x90, 0x81, 0x8E, - 0xE0, 0x6F, 0x60, 0x02, 0x31, 0x74, 0xC2, 0xAF, 0x12, 0x83, 0x5C, 0xBF, 0x01, 0x03, 0x12, 0x77, - 0x0F, 0xD2, 0xAF, 0x12, 0x7E, 0x3F, 0x12, 0x32, 0x9E, 0xBF, 0x01, 0x03, 0x12, 0x82, 0x01, 0x12, - 0x43, 0x4D, 0x80, 0xBD, 0x90, 0x81, 0x82, 0xE0, 0x90, 0x81, 0x8E, 0x30, 0xE0, 0x04, 0xE0, 0xFF, - 0x81, 0x0E, 0xE0, 0xFF, 0x7D, 0x01, 0x02, 0x51, 0xCD, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, - 0x8B, 0x55, 0x8A, 0x56, 0x89, 0x57, 0x90, 0x05, 0x27, 0xE0, 0xF5, 0x58, 0x8B, 0x13, 0x8A, 0x14, - 0x89, 0x15, 0x75, 0x16, 0x01, 0x7B, 0x01, 0x7A, 0x81, 0x79, 0x82, 0x12, 0x2B, 0xED, 0x12, 0x89, - 0xF7, 0xFF, 0xC3, 0x13, 0x20, 0xE0, 0x02, 0x41, 0x48, 0x90, 0x81, 0x82, 0xE0, 0x30, 0xE0, 0x74, - 0x12, 0x4F, 0xDD, 0x75, 0x58, 0x21, 0x90, 0x81, 0x82, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, - 0x07, 0x91, 0x02, 0x43, 0x58, 0x08, 0x80, 0x0D, 0xE4, 0x90, 0x81, 0x83, 0xF0, 0xA3, 0xF0, 0x7D, - 0x40, 0xFF, 0x12, 0x4D, 0xE7, 0x90, 0x81, 0x82, 0x71, 0xEE, 0x30, 0xE0, 0x03, 0x43, 0x58, 0x12, - 0xEF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x03, 0x43, 0x58, 0x14, 0x90, 0x81, 0x82, 0xE0, 0xC4, 0x13, - 0x54, 0x07, 0x30, 0xE0, 0x03, 0x43, 0x58, 0x80, 0xF1, 0x39, 0x20, 0xE0, 0x03, 0x43, 0x58, 0x40, - 0x51, 0xF5, 0x90, 0x81, 0x85, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0x51, 0xFC, 0x71, 0xE0, 0x30, 0xE0, - 0x04, 0x7F, 0x04, 0x80, 0x0B, 0x71, 0xF6, 0xEF, 0x60, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x02, - 0x51, 0xFC, 0x41, 0xBD, 0x75, 0x58, 0x01, 0x51, 0xF5, 0x90, 0x81, 0x85, 0xE0, 0x64, 0x04, 0x60, - 0x02, 0x41, 0xF0, 0xFF, 0x51, 0xFC, 0x41, 0xF0, 0x90, 0x81, 0x82, 0xE0, 0x30, 0xE0, 0x76, 0x12, - 0x4F, 0xDD, 0x43, 0x58, 0x31, 0x90, 0x81, 0x82, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x07, - 0x91, 0x02, 0x43, 0x58, 0x08, 0x80, 0x07, 0x7D, 0x40, 0xE4, 0xFF, 0x12, 0x4D, 0xE7, 0x90, 0x81, - 0x82, 0x71, 0xEE, 0x30, 0xE0, 0x03, 0x43, 0x58, 0x02, 0xEF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x03, - 0x43, 0x58, 0x04, 0x51, 0xF5, 0x71, 0xE0, 0x30, 0xE0, 0x0A, 0xF1, 0x1A, 0x60, 0x2F, 0xE4, 0xFD, - 0x7F, 0x02, 0x80, 0x1C, 0xB1, 0x83, 0x90, 0x81, 0x86, 0xE0, 0xB4, 0x02, 0x18, 0xF1, 0x4D, 0x71, - 0xF6, 0xBF, 0x01, 0x09, 0x90, 0x81, 0x8E, 0xE0, 0xFF, 0x7D, 0x01, 0x80, 0x03, 0xE4, 0xFD, 0xFF, - 0x12, 0x51, 0xCD, 0x80, 0x08, 0x90, 0x81, 0x8F, 0xE0, 0x90, 0x81, 0x86, 0xF0, 0x90, 0x05, 0x40, - 0x74, 0x22, 0xF0, 0x80, 0x2B, 0x75, 0x58, 0x01, 0x51, 0xF5, 0x90, 0x81, 0x86, 0xE0, 0xB4, 0x02, - 0x06, 0x7D, 0x01, 0x7F, 0x04, 0x80, 0x0B, 0x90, 0x81, 0x86, 0xE0, 0xB4, 0x08, 0x07, 0x7D, 0x01, - 0x7F, 0x0C, 0x12, 0x51, 0xCD, 0x12, 0x86, 0x0C, 0x90, 0x81, 0x8E, 0x31, 0x82, 0x12, 0x88, 0x93, - 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x05, 0x27, 0xE5, 0x58, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, - 0xC3, 0xC0, 0xD0, 0x90, 0x81, 0x85, 0xE0, 0xF5, 0x1F, 0xE5, 0x1F, 0x6F, 0x70, 0x02, 0x61, 0xDB, - 0xEF, 0x14, 0x60, 0x38, 0x14, 0x60, 0x5A, 0x14, 0x60, 0x7A, 0x14, 0x70, 0x02, 0x61, 0xB7, 0x24, - 0x04, 0x60, 0x02, 0x61, 0xDB, 0xE5, 0x1F, 0xB4, 0x04, 0x04, 0xB1, 0x90, 0x61, 0xDB, 0xE5, 0x1F, - 0xB4, 0x02, 0x04, 0xB1, 0xA0, 0x61, 0xDB, 0xE5, 0x1F, 0xB4, 0x03, 0x04, 0xB1, 0x9C, 0x61, 0xDB, - 0xE5, 0x1F, 0x64, 0x01, 0x60, 0x02, 0x61, 0xDB, 0xB1, 0x93, 0x61, 0xDB, 0xE5, 0x1F, 0xB4, 0x04, - 0x05, 0x12, 0x57, 0xD4, 0x61, 0xDB, 0xE5, 0x1F, 0xB4, 0x02, 0x05, 0x12, 0x57, 0x9E, 0x80, 0x7B, - 0xE5, 0x1F, 0xB4, 0x03, 0x04, 0xB1, 0xAA, 0x80, 0x72, 0xE5, 0x1F, 0x70, 0x6E, 0xB1, 0x65, 0x80, - 0x6A, 0xE5, 0x1F, 0xB4, 0x04, 0x04, 0xB1, 0x5B, 0x80, 0x61, 0xE5, 0x1F, 0xB4, 0x01, 0x04, 0x91, - 0xEB, 0x80, 0x58, 0xE5, 0x1F, 0xB4, 0x03, 0x04, 0x91, 0xE9, 0x80, 0x4F, 0xE5, 0x1F, 0x70, 0x4B, - 0xB1, 0x61, 0x80, 0x47, 0xE5, 0x1F, 0xB4, 0x04, 0x04, 0xB1, 0x78, 0x80, 0x3E, 0xE5, 0x1F, 0xB4, - 0x01, 0x04, 0xB1, 0x6A, 0x80, 0x35, 0xE5, 0x1F, 0xB4, 0x02, 0x04, 0xB1, 0xA5, 0x80, 0x2C, 0xE5, - 0x1F, 0x70, 0x28, 0xB1, 0x68, 0x80, 0x24, 0xE5, 0x1F, 0xB4, 0x03, 0x05, 0x12, 0x88, 0xB9, 0x80, - 0x1A, 0xE5, 0x1F, 0xB4, 0x01, 0x05, 0x12, 0x57, 0xDB, 0x80, 0x10, 0xE5, 0x1F, 0xB4, 0x02, 0x05, - 0x12, 0x88, 0xB1, 0x80, 0x06, 0xE5, 0x1F, 0x70, 0x02, 0xB1, 0x8B, 0xD0, 0xD0, 0x92, 0xAF, 0x22, - 0x90, 0x81, 0x82, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x22, 0x90, 0x81, 0x88, 0xE0, 0xFF, - 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0x90, 0x05, 0x43, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, - 0x01, 0x22, 0x90, 0x01, 0x34, 0x74, 0x40, 0xF0, 0xFD, 0xE4, 0xFF, 0x02, 0x71, 0x0D, 0xAE, 0x07, - 0x71, 0xF6, 0xBF, 0x01, 0x0F, 0xF1, 0x39, 0x20, 0xE0, 0x0A, 0xAF, 0x06, 0x7D, 0x01, 0x12, 0x51, - 0xCD, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, 0x90, 0x81, 0x87, 0x71, 0xE3, 0x30, 0xE0, 0x1F, 0xEF, - 0x54, 0xBF, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0x81, 0x88, 0x30, 0xE0, 0x06, 0xE0, 0x44, 0x01, - 0xF0, 0x80, 0x09, 0xE0, 0x54, 0xFE, 0x12, 0x87, 0x31, 0x74, 0x04, 0xF0, 0x31, 0x74, 0x22, 0x71, - 0xEB, 0x30, 0xE0, 0x0C, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x03, 0x12, 0x77, 0xD3, - 0x12, 0x84, 0xAE, 0x54, 0x3F, 0x30, 0xE0, 0x09, 0x12, 0x84, 0xDD, 0x54, 0x07, 0x70, 0x3A, 0x80, - 0x36, 0x12, 0x84, 0xFA, 0x40, 0x31, 0x12, 0x4F, 0xD4, 0x70, 0x2E, 0x12, 0x67, 0x95, 0x70, 0x06, - 0x91, 0xB1, 0x91, 0xAA, 0xF0, 0x22, 0x91, 0xB1, 0x90, 0x81, 0x96, 0xE0, 0x04, 0xF0, 0xE0, 0xD3, - 0x94, 0x02, 0x40, 0x0A, 0x91, 0xAA, 0xF0, 0xE4, 0x90, 0x81, 0x96, 0xF0, 0x80, 0x03, 0x12, 0x57, - 0xC4, 0xE4, 0x90, 0x81, 0x95, 0xF0, 0x22, 0x31, 0x74, 0x22, 0x90, 0x81, 0x88, 0xE0, 0x54, 0xFB, - 0x22, 0x12, 0x85, 0x07, 0x40, 0x32, 0x90, 0x81, 0xA6, 0xE0, 0x04, 0xF0, 0x90, 0x81, 0xE8, 0xE0, - 0xFF, 0x90, 0x81, 0xA6, 0xE0, 0xD3, 0x9F, 0x50, 0x1F, 0x90, 0x81, 0x9E, 0xE0, 0x04, 0xF0, 0x12, - 0x4E, 0xC9, 0x90, 0x81, 0xA5, 0xF0, 0xFB, 0x90, 0x81, 0x9E, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, - 0x82, 0xD6, 0x74, 0x04, 0xF0, 0x12, 0x72, 0xB5, 0x22, 0x80, 0x07, 0x7D, 0x20, 0x7F, 0xFF, 0x12, - 0x51, 0xAD, 0x91, 0xFB, 0x90, 0x81, 0x85, 0x74, 0x02, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, - 0xC0, 0xD0, 0x12, 0x87, 0x3C, 0x90, 0x85, 0xBB, 0x12, 0x20, 0xDA, 0xCC, 0xF0, 0x00, 0xC0, 0x12, - 0x8A, 0x57, 0x90, 0x85, 0xBB, 0x12, 0x20, 0xDA, 0x00, 0x00, 0x00, 0x14, 0x12, 0x89, 0xE2, 0x12, - 0x20, 0xDA, 0x00, 0x00, 0x00, 0x00, 0xE4, 0xFD, 0xFF, 0x12, 0x7E, 0x1C, 0x12, 0x8A, 0x50, 0xEC, - 0x44, 0x80, 0xFC, 0x90, 0x82, 0xCF, 0x12, 0x20, 0xCE, 0x90, 0x82, 0xCF, 0x12, 0x47, 0xA1, 0xB1, - 0xB1, 0x12, 0x8A, 0x11, 0x90, 0x01, 0x00, 0x74, 0x3F, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, 0xF0, 0x90, - 0x05, 0x53, 0xE0, 0x44, 0x20, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xB1, 0x83, 0x7D, 0x23, 0x80, - 0x8C, 0xB1, 0x65, 0x80, 0x86, 0x02, 0x57, 0xA0, 0xB1, 0x65, 0x7D, 0x21, 0x7F, 0xFF, 0x12, 0x51, - 0xAD, 0x90, 0x81, 0x85, 0x74, 0x03, 0xF0, 0x22, 0x7D, 0x22, 0x7F, 0xFF, 0x12, 0x51, 0xAD, 0xB1, - 0x83, 0x80, 0xEE, 0x90, 0x05, 0x27, 0xE0, 0x44, 0x40, 0xF0, 0x22, 0xB1, 0x65, 0x02, 0x57, 0xDB, - 0x12, 0x57, 0xD4, 0x12, 0x8A, 0x18, 0xE4, 0x90, 0x81, 0x85, 0xF0, 0x22, 0xB1, 0xAA, 0x80, 0xF3, - 0x12, 0x57, 0x9E, 0x80, 0xEE, 0x12, 0x55, 0x1D, 0x80, 0xC7, 0x12, 0x57, 0xBF, 0x02, 0x57, 0xA0, - 0xFC, 0x90, 0x85, 0xBB, 0x02, 0x20, 0xCE, 0x90, 0x82, 0x9F, 0x12, 0x7C, 0xF5, 0x12, 0x20, 0xDA, - 0x00, 0x00, 0x00, 0x00, 0xE4, 0x90, 0x82, 0xAD, 0xF0, 0x7F, 0x24, 0x7E, 0x08, 0x12, 0x2D, 0x5C, - 0x90, 0x82, 0xA5, 0x12, 0x20, 0xCE, 0x90, 0x82, 0x9F, 0xE0, 0xFB, 0x70, 0x04, 0xD1, 0x9B, 0x80, - 0x07, 0xEB, 0xD1, 0xA1, 0xFF, 0x12, 0x2D, 0x5C, 0x90, 0x82, 0xA9, 0x12, 0x20, 0xCE, 0x90, 0x82, - 0xA0, 0x12, 0x4A, 0xF4, 0x78, 0x17, 0xF1, 0x43, 0xAB, 0x07, 0x90, 0x82, 0xA9, 0x12, 0x47, 0xA1, - 0xED, 0x54, 0x7F, 0xFD, 0xEC, 0x54, 0x80, 0xFC, 0x12, 0x47, 0x83, 0xEC, 0x44, 0x80, 0xFC, 0x90, - 0x82, 0xA9, 0x12, 0x20, 0xCE, 0xD1, 0x9B, 0xEC, 0x54, 0x7F, 0xB1, 0xB0, 0xD1, 0xB3, 0xD1, 0xA1, - 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x82, 0xA9, 0x12, 0x47, 0xA1, 0xB1, 0xB1, 0xD0, 0x07, 0xD0, - 0x06, 0x12, 0x2E, 0xA2, 0xD1, 0x9B, 0xEC, 0x44, 0x80, 0xB1, 0xB0, 0xD1, 0xB3, 0x70, 0x04, 0x7F, - 0x20, 0x80, 0x09, 0x90, 0x82, 0x9F, 0xE0, 0xB4, 0x01, 0x16, 0x7F, 0x28, 0x7E, 0x08, 0x12, 0x2D, - 0x5C, 0x78, 0x08, 0x12, 0x20, 0xA8, 0xEF, 0x54, 0x01, 0xFF, 0xE4, 0x90, 0x82, 0xAD, 0xEF, 0xF0, - 0x90, 0x82, 0xAD, 0xE0, 0x90, 0x82, 0x9F, 0x60, 0x0E, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x66, - 0xF5, 0x82, 0xE4, 0x34, 0x87, 0x80, 0x0C, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x64, 0xF5, 0x82, - 0xE4, 0x34, 0x87, 0xD1, 0xAC, 0xFF, 0x12, 0x2D, 0x5C, 0xED, 0x54, 0x0F, 0xFD, 0xE4, 0xFC, 0x90, - 0x82, 0xA1, 0x12, 0x20, 0xCE, 0x90, 0x82, 0xA1, 0x02, 0x47, 0xA1, 0x90, 0x82, 0xA5, 0x02, 0x47, - 0xA1, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x62, 0xF5, 0x82, 0xE4, 0x34, 0x87, 0xF5, 0x83, 0xE0, 0xFE, - 0xA3, 0xE0, 0x22, 0x7F, 0x24, 0x7E, 0x08, 0x12, 0x2E, 0xA2, 0x90, 0x82, 0x9F, 0xE0, 0x22, 0x90, - 0x82, 0xAE, 0xEF, 0xF0, 0xAB, 0x05, 0x90, 0x82, 0xB4, 0x12, 0x20, 0xDA, 0x00, 0x00, 0x00, 0x00, - 0xAF, 0x03, 0xE4, 0xFC, 0xFD, 0xFE, 0x78, 0x14, 0xF1, 0x43, 0xAB, 0x07, 0x90, 0x82, 0xB0, 0x12, - 0x47, 0xA1, 0xED, 0x54, 0x0F, 0xFD, 0xE4, 0xFC, 0x12, 0x47, 0x83, 0xEC, 0x54, 0x0F, 0xFC, 0x90, - 0x82, 0xB4, 0x12, 0x20, 0xCE, 0x90, 0x82, 0xAE, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x60, 0xF5, - 0x82, 0xE4, 0x34, 0x87, 0xD1, 0xAC, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x82, 0xB4, 0x12, 0x47, - 0xA1, 0xB1, 0xB1, 0xD0, 0x07, 0xD0, 0x06, 0x02, 0x2E, 0xA2, 0x90, 0x81, 0x86, 0xE0, 0x64, 0x02, - 0x22, 0x71, 0xE0, 0x30, 0xE0, 0x0B, 0xF1, 0x1A, 0x60, 0x07, 0x7D, 0x01, 0x7F, 0x02, 0x12, 0x51, - 0xCD, 0xF1, 0x1A, 0x60, 0x03, 0x12, 0x85, 0xD7, 0x22, 0x90, 0x81, 0x82, 0xE0, 0xC4, 0x13, 0x13, - 0x54, 0x03, 0x22, 0x12, 0x20, 0xBB, 0xA8, 0x04, 0xA9, 0x05, 0xAA, 0x06, 0x22, 0x12, 0x57, 0xBF, - 0x12, 0x57, 0xA8, 0xB1, 0x83, 0x90, 0x81, 0x86, 0x74, 0x04, 0xF0, 0x22, 0x90, 0x81, 0x8C, 0xE0, - 0x60, 0x0E, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, 0x03, 0x02, 0x86, 0x2D, 0xF1, 0x77, 0x31, 0x74, - 0x22, 0x12, 0x55, 0x1D, 0x12, 0x57, 0xAE, 0x90, 0x81, 0x87, 0xE0, 0x54, 0xF7, 0xF0, 0x22, 0xEF, - 0x70, 0x3C, 0x7D, 0x78, 0x7F, 0x02, 0x12, 0x4D, 0xE7, 0x7D, 0x02, 0x7F, 0x03, 0x12, 0x4D, 0xE7, - 0x7D, 0xC8, 0x7F, 0x02, 0x12, 0x4F, 0xC1, 0x12, 0x84, 0xB6, 0xF0, 0xE4, 0xFF, 0x12, 0x65, 0xE3, - 0xEF, 0x70, 0x0A, 0xF1, 0x71, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x80, 0x07, 0x7D, 0x01, 0x7F, - 0x0C, 0x12, 0x51, 0xCD, 0xF1, 0x77, 0x90, 0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x22, 0x90, 0x01, - 0x36, 0x74, 0x78, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x7D, 0x78, 0xFF, 0x12, 0x71, 0x0D, 0x7D, 0x02, - 0x7F, 0x03, 0x12, 0x71, 0x0D, 0x90, 0x06, 0x0A, 0xE0, 0x44, 0x07, 0x12, 0x74, 0x75, 0xE4, 0xFF, - 0x12, 0x65, 0xE3, 0xBF, 0x01, 0x11, 0x91, 0xAA, 0xF0, 0x90, 0x81, 0x8F, 0xE0, 0x20, 0xE2, 0x0A, - 0x7D, 0x01, 0x7F, 0x04, 0x02, 0x51, 0xCD, 0xF1, 0xFB, 0xF0, 0x22, 0x90, 0x81, 0x88, 0xE0, 0x44, - 0x04, 0x22, 0x90, 0x05, 0x62, 0xE0, 0xFE, 0x90, 0x05, 0x61, 0xE0, 0xFD, 0xED, 0x78, 0x02, 0xCE, - 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, 0x81, 0xFF, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, - 0x4F, 0xD4, 0x60, 0x02, 0x01, 0xE6, 0x90, 0x81, 0x8C, 0xE0, 0x70, 0x02, 0x01, 0xE6, 0x11, 0xF4, - 0x54, 0x0F, 0x64, 0x01, 0x70, 0x22, 0x90, 0x06, 0xAB, 0xE0, 0x90, 0x81, 0x93, 0xF0, 0x90, 0x06, - 0xAA, 0xE0, 0x90, 0x81, 0x92, 0xF0, 0xA3, 0xE0, 0xFF, 0x70, 0x08, 0x90, 0x81, 0x92, 0xE0, 0xFE, - 0xFF, 0x80, 0x00, 0x90, 0x81, 0x93, 0xEF, 0xF0, 0x31, 0x1A, 0xE4, 0x90, 0x81, 0x95, 0x91, 0x75, - 0x12, 0x84, 0xB6, 0x12, 0x84, 0xE0, 0x54, 0xEF, 0xF0, 0x11, 0xF4, 0x54, 0x0F, 0x24, 0xFD, 0x50, - 0x02, 0x80, 0x0D, 0x90, 0x81, 0x82, 0xE0, 0x30, 0xE0, 0x04, 0x91, 0xF0, 0x80, 0x02, 0x91, 0xA5, - 0x12, 0x6B, 0xEB, 0x30, 0xE0, 0x5C, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x22, 0x11, - 0xFB, 0x6F, 0x70, 0x4E, 0x90, 0x81, 0x88, 0xE0, 0x44, 0x40, 0xF0, 0x12, 0x8A, 0x38, 0x12, 0x4F, - 0x1F, 0x12, 0x4F, 0xE1, 0x12, 0x4D, 0xE3, 0xF1, 0xD3, 0x90, 0x81, 0x93, 0xE0, 0x14, 0xF0, 0x80, - 0x31, 0x90, 0x81, 0x8A, 0xE0, 0xC4, 0x54, 0x0F, 0x64, 0x01, 0x70, 0x26, 0x11, 0xFB, 0xFE, 0x6F, - 0x60, 0x20, 0x90, 0x05, 0x73, 0xE0, 0xFF, 0xEE, 0x6F, 0x60, 0x17, 0x90, 0x81, 0x88, 0xE0, 0xFF, - 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x0B, 0xEF, 0x54, 0xBF, 0x12, 0x4F, 0x1F, 0x12, 0x4F, 0xC1, - 0x31, 0x03, 0x12, 0x6F, 0xFB, 0xF0, 0x90, 0x81, 0x82, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x04, 0x12, - 0x6F, 0xFB, 0xF0, 0x22, 0x90, 0x81, 0x8A, 0xE0, 0xFF, 0xC4, 0x22, 0x90, 0x81, 0x92, 0xE0, 0xFF, - 0xA3, 0xE0, 0x22, 0x7D, 0x01, 0x7F, 0x02, 0x31, 0x0D, 0x7D, 0x02, 0x7F, 0x02, 0x74, 0x3D, 0x2F, - 0xF8, 0xE6, 0x4D, 0xFE, 0xF6, 0x74, 0x30, 0x02, 0x4F, 0xC9, 0x12, 0x4A, 0xDB, 0x12, 0x47, 0x83, - 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, 0x12, 0x4A, 0xF4, 0x78, 0x10, - 0x12, 0x20, 0xBB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x47, 0x83, 0xC0, 0x04, - 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x12, 0x4A, 0xF4, 0x78, 0x18, 0x12, 0x20, 0xBB, 0xD0, - 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x47, 0x83, 0x90, 0x81, 0xDB, 0x12, 0x20, 0xCE, - 0x90, 0x81, 0xDF, 0x12, 0x47, 0xA1, 0x90, 0x81, 0xDB, 0x12, 0x47, 0xB9, 0xC3, 0x12, 0x47, 0x90, - 0x40, 0x3B, 0x90, 0x81, 0x87, 0xE0, 0x90, 0x81, 0xDF, 0x30, 0xE0, 0x0B, 0x51, 0x91, 0x51, 0xAE, - 0x2F, 0xFF, 0x90, 0x81, 0xE3, 0x80, 0x05, 0x51, 0x91, 0x90, 0x81, 0xE4, 0xE0, 0xFE, 0xC3, 0xEF, - 0x9E, 0x90, 0x82, 0x01, 0xF0, 0x90, 0x82, 0x01, 0xE0, 0xFF, 0xC3, 0x94, 0x2D, 0x50, 0x0E, 0x74, - 0xAA, 0x2F, 0x51, 0x81, 0xE0, 0x04, 0xF0, 0x90, 0x81, 0xA2, 0xE0, 0x04, 0xF0, 0x90, 0x81, 0xA2, - 0xE0, 0xFF, 0xD3, 0x90, 0x81, 0xE6, 0xE0, 0x9F, 0x90, 0x81, 0xE5, 0xE0, 0x94, 0x00, 0x40, 0x02, - 0x41, 0x7D, 0xE4, 0xFF, 0xFE, 0x51, 0x7E, 0xE0, 0x2F, 0xFF, 0x90, 0x81, 0xE7, 0xE0, 0xFD, 0xEF, - 0xD3, 0x9D, 0x40, 0x07, 0x90, 0x82, 0x02, 0xEE, 0xF0, 0x80, 0x05, 0x0E, 0xEE, 0xB4, 0x2D, 0xE5, - 0xE4, 0xFF, 0xFE, 0x51, 0x7E, 0xE0, 0x2F, 0xFF, 0x90, 0x81, 0xE7, 0xE0, 0xFD, 0xC3, 0x90, 0x81, - 0xE6, 0xE0, 0x9D, 0xFD, 0x90, 0x81, 0xE5, 0xE0, 0x94, 0x00, 0xFC, 0xEF, 0xD3, 0x9D, 0xE4, 0x9C, - 0x40, 0x07, 0x90, 0x82, 0x03, 0xEE, 0xF0, 0x80, 0x05, 0x0E, 0xEE, 0xB4, 0x2D, 0xD5, 0x90, 0x82, - 0x02, 0xE0, 0x90, 0x81, 0xA7, 0xF0, 0x90, 0x82, 0x03, 0xE0, 0x90, 0x81, 0xA8, 0x51, 0x89, 0x94, - 0x0A, 0x40, 0x0A, 0xEF, 0x24, 0xF6, 0x90, 0x81, 0x9F, 0xF0, 0xE4, 0x80, 0x09, 0xE4, 0x90, 0x81, - 0x9F, 0x51, 0x89, 0x74, 0x0A, 0x9F, 0x90, 0x81, 0x9E, 0xF0, 0x90, 0x81, 0xA7, 0xE0, 0xFF, 0xA3, - 0xE0, 0xC3, 0x9F, 0x90, 0x81, 0xA5, 0xF0, 0x90, 0x81, 0x87, 0xE0, 0x30, 0xE0, 0x05, 0x90, 0x81, - 0xE3, 0x80, 0x03, 0x90, 0x81, 0xE4, 0xE0, 0x04, 0xFF, 0x90, 0x81, 0xA5, 0xE0, 0x2F, 0xF0, 0x90, - 0x81, 0xA5, 0xE0, 0xC3, 0x94, 0x0A, 0x50, 0x03, 0x74, 0x0A, 0xF0, 0x90, 0x81, 0xA5, 0xE0, 0x24, - 0x02, 0xF0, 0xB1, 0xCF, 0x74, 0x03, 0xF0, 0x51, 0xB5, 0xE4, 0xFF, 0x91, 0x51, 0x22, 0x74, 0xAA, - 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, 0xF0, 0x90, 0x81, 0xA7, 0xE0, 0xFF, 0xC3, - 0x22, 0x12, 0x47, 0xB9, 0x90, 0x81, 0xDB, 0x12, 0x47, 0xA1, 0x12, 0x47, 0x68, 0x78, 0x0A, 0x12, - 0x20, 0xA8, 0x90, 0x81, 0xA4, 0xE0, 0xFE, 0xC3, 0x74, 0x0A, 0x9E, 0x2F, 0xFF, 0x22, 0x90, 0x81, - 0xA9, 0xE0, 0x24, 0x04, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAC, 0x07, 0x90, 0x81, - 0x88, 0x12, 0x67, 0xA2, 0x30, 0xE0, 0x02, 0x61, 0x6B, 0x90, 0x81, 0x87, 0xE0, 0x30, 0xE0, 0x12, - 0x51, 0xAE, 0x90, 0x81, 0xA1, 0xF0, 0x90, 0x81, 0xA9, 0xE0, 0x24, 0x03, 0x90, 0x81, 0xA0, 0xF0, - 0x80, 0x0D, 0x90, 0x81, 0xA1, 0x74, 0x02, 0xF0, 0x90, 0x81, 0xA0, 0x14, 0xF0, 0x0B, 0x0B, 0x90, - 0x81, 0xA0, 0xE0, 0xFA, 0x90, 0x81, 0x9F, 0xE0, 0xD3, 0x9A, 0x50, 0x0E, 0x90, 0x81, 0x94, 0xEB, - 0xF0, 0x90, 0x81, 0xA1, 0xE0, 0xC3, 0x9D, 0x2C, 0x80, 0x11, 0xC3, 0xED, 0x9A, 0x2B, 0x90, 0x81, - 0x94, 0xF0, 0x90, 0x81, 0xA0, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, 0x81, 0xA4, 0xF0, 0x90, - 0x81, 0xA1, 0xE0, 0xFF, 0x24, 0x0A, 0xFD, 0xE4, 0x33, 0xFC, 0x90, 0x81, 0xA4, 0x71, 0x77, 0x40, - 0x04, 0xEF, 0x24, 0x0A, 0xF0, 0x90, 0x81, 0xA4, 0xE0, 0xFF, 0x24, 0x23, 0xFD, 0xE4, 0x33, 0xFC, - 0x90, 0x81, 0x94, 0x71, 0x77, 0x40, 0x04, 0xEF, 0x24, 0x23, 0xF0, 0x90, 0x81, 0xA4, 0xE0, 0xFF, - 0x7E, 0x00, 0x90, 0x81, 0x98, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x05, 0x58, 0xE0, 0x6F, 0x70, - 0x01, 0xE4, 0x60, 0x02, 0x91, 0x76, 0x12, 0x8A, 0x30, 0x80, 0x07, 0x90, 0x81, 0x89, 0xE0, 0x44, - 0x01, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xD3, 0x9D, 0xEC, 0x64, 0x80, 0xF8, 0x74, 0x80, - 0x98, 0x22, 0x7E, 0x00, 0x7F, 0x62, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x81, 0x79, 0x87, 0x12, 0x48, - 0x22, 0x12, 0x89, 0x9D, 0x12, 0x48, 0x22, 0x90, 0x81, 0x8B, 0x74, 0x02, 0xF0, 0x90, 0x81, 0x92, - 0x14, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0x90, 0x81, 0x98, 0xE4, 0xF0, 0xA3, 0x74, 0x02, - 0xF0, 0x51, 0xAE, 0x90, 0x81, 0xA4, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0x12, 0x87, 0xE7, 0xE4, 0xFD, - 0xFF, 0x12, 0x53, 0xF6, 0x7D, 0x0C, 0x7F, 0x02, 0x12, 0x53, 0xF6, 0x12, 0x53, 0xF2, 0x90, 0x80, - 0x42, 0xE0, 0xFF, 0xB4, 0x01, 0x08, 0x90, 0x81, 0x97, 0x74, 0x99, 0xF0, 0x80, 0x29, 0xEF, 0xB4, - 0x03, 0x08, 0x90, 0x81, 0x97, 0x74, 0x90, 0xF0, 0x80, 0x1D, 0x90, 0x81, 0x97, 0x74, 0x40, 0xF0, - 0x90, 0x00, 0x2C, 0xE0, 0x54, 0x0F, 0xFF, 0xBF, 0x05, 0x08, 0x90, 0x81, 0xA9, 0x74, 0x02, 0xF0, - 0x80, 0x05, 0xE4, 0x90, 0x81, 0xA9, 0xF0, 0x90, 0x81, 0xE9, 0x74, 0x02, 0xF0, 0xA3, 0x74, 0x0F, - 0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, 0x07, 0xF0, 0x51, 0xAE, 0x90, 0x81, - 0xA4, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0x7F, 0x01, 0x91, 0x51, 0x90, 0x05, 0x58, 0x74, 0x02, 0xF0, - 0x7E, 0x00, 0xFF, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x81, 0x79, 0xED, 0x12, 0x48, 0x22, 0x12, 0x8A, - 0x09, 0x90, 0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x12, 0x57, 0xBF, 0xE4, 0x90, 0x81, 0xEF, 0xF0, - 0x22, 0xE4, 0xFE, 0x51, 0x7E, 0xE4, 0xF0, 0x0E, 0xEE, 0xB4, 0x2D, 0xF7, 0xE4, 0x90, 0x81, 0xA3, - 0xF0, 0x90, 0x81, 0xA2, 0xF0, 0x90, 0x81, 0xA6, 0xF0, 0xEF, 0xB4, 0x01, 0x07, 0xA3, 0x74, 0x2D, - 0xF0, 0xE4, 0xA3, 0xF0, 0x22, 0xF0, 0x90, 0x81, 0x98, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x22, - 0x90, 0x81, 0x87, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0x81, 0x95, 0xF0, 0xA3, 0xF0, 0x90, 0x81, - 0x90, 0xF0, 0x90, 0x81, 0x88, 0xE0, 0x54, 0xF7, 0xF0, 0x54, 0xBF, 0xF0, 0x31, 0x03, 0x7D, 0x10, - 0x7F, 0x03, 0x02, 0x4F, 0xC1, 0x90, 0x06, 0xA9, 0xE0, 0xF5, 0x4E, 0x54, 0xC0, 0x70, 0x08, 0x91, - 0xE8, 0x54, 0xFD, 0xF0, 0x02, 0x69, 0x74, 0xE5, 0x4E, 0x30, 0xE6, 0x18, 0x90, 0x81, 0x8C, 0xE0, - 0x64, 0x01, 0x70, 0x12, 0x12, 0x67, 0x8E, 0x64, 0x02, 0x60, 0x04, 0xB1, 0x5C, 0x80, 0x07, 0x12, - 0x57, 0xC4, 0x80, 0x02, 0x91, 0xE8, 0xE5, 0x4E, 0x90, 0x81, 0x90, 0x30, 0xE7, 0x05, 0x12, 0x51, - 0x2D, 0xA1, 0x7F, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, 0x81, 0x90, 0xE0, 0x54, 0xFE, 0xF0, 0x22, - 0x90, 0x06, 0xA9, 0xE0, 0x90, 0x82, 0x01, 0xF0, 0xE0, 0xFD, 0x54, 0xC0, 0x70, 0x04, 0x91, 0xE8, - 0x80, 0x56, 0xED, 0x30, 0xE6, 0x40, 0x90, 0x81, 0x8C, 0xE0, 0x64, 0x02, 0x70, 0x28, 0x90, 0x81, - 0x87, 0xE0, 0xFF, 0xC3, 0x13, 0x20, 0xE0, 0x09, 0x90, 0x81, 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x80, - 0x1C, 0x12, 0x67, 0x95, 0x64, 0x01, 0x70, 0x20, 0x90, 0x81, 0x90, 0xE0, 0x44, 0x04, 0xF0, 0x7F, - 0x01, 0x12, 0x56, 0x12, 0x80, 0x12, 0x12, 0x67, 0x8E, 0x64, 0x02, 0x60, 0x04, 0xB1, 0x5C, 0x80, - 0x07, 0x12, 0x57, 0xC4, 0x80, 0x02, 0x91, 0xE8, 0x90, 0x82, 0x01, 0xE0, 0x90, 0x81, 0x90, 0x30, - 0xE7, 0x05, 0x12, 0x51, 0x2D, 0x80, 0x28, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, 0x04, 0x1D, 0xE0, - 0x70, 0x1C, 0x90, 0x80, 0x86, 0xE0, 0xFF, 0x90, 0x82, 0xCA, 0x74, 0x09, 0xF0, 0x7B, 0x18, 0xE4, - 0xFD, 0x12, 0x56, 0x4F, 0x90, 0x82, 0x02, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xF1, 0xCC, 0x22, 0x90, - 0x81, 0x87, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xB1, 0xE0, 0x90, 0x82, 0x0D, 0xEF, 0xF0, 0x30, 0xE0, - 0x05, 0x7D, 0x01, 0xE4, 0x80, 0x02, 0xE4, 0xFD, 0xFF, 0x12, 0x53, 0xF6, 0x90, 0x82, 0x0D, 0xE0, - 0x30, 0xE6, 0x11, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x04, 0xE4, 0xF0, 0x80, 0x06, 0x90, 0x01, - 0x2F, 0x74, 0x80, 0xF0, 0x90, 0x81, 0x87, 0xE0, 0x90, 0x04, 0xEC, 0x30, 0xE0, 0x06, 0xE0, 0x54, - 0xDD, 0xF0, 0x80, 0x04, 0xE0, 0x44, 0x22, 0xF0, 0xB1, 0xCF, 0x74, 0x02, 0xF0, 0x41, 0xB5, 0x90, - 0x81, 0x9E, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x81, 0xA5, 0xE0, 0xFB, 0x90, 0x82, 0xD6, 0x22, - 0xE4, 0x90, 0x82, 0x0F, 0xF0, 0xA3, 0xF0, 0x90, 0x00, 0x83, 0xE0, 0x90, 0x82, 0x0E, 0xF0, 0x90, - 0x00, 0x83, 0xE0, 0xFE, 0x90, 0x82, 0x0E, 0xE0, 0xFF, 0xB5, 0x06, 0x01, 0x22, 0xC3, 0x90, 0x82, - 0x10, 0xE0, 0x94, 0x64, 0x90, 0x82, 0x0F, 0xE0, 0x94, 0x00, 0x40, 0x0D, 0x90, 0x01, 0xC0, 0xE0, - 0x44, 0x40, 0xF0, 0x90, 0x82, 0x0E, 0xE0, 0xFF, 0x22, 0x90, 0x82, 0x0F, 0xD1, 0x20, 0x80, 0xC7, - 0xE4, 0x75, 0xF0, 0x01, 0x02, 0x46, 0xA3, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x82, - 0xC3, 0xEE, 0xF0, 0xA3, 0xD1, 0xC4, 0x90, 0x82, 0xC3, 0xE0, 0xFE, 0xA3, 0xE0, 0xF5, 0x82, 0x8E, - 0x83, 0xE0, 0x60, 0x28, 0xC3, 0x90, 0x82, 0xC6, 0xE0, 0x94, 0xE8, 0x90, 0x82, 0xC5, 0xE0, 0x94, - 0x03, 0x40, 0x0B, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x80, 0xF0, 0x7F, 0x00, 0x80, 0x10, 0x90, 0x82, - 0xC5, 0xD1, 0x20, 0x7F, 0x0A, 0x7E, 0x00, 0x12, 0x32, 0xAA, 0x80, 0xCA, 0x7F, 0x01, 0xD0, 0xD0, - 0x92, 0xAF, 0x22, 0x90, 0x82, 0x1A, 0xD1, 0xC4, 0x90, 0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, - 0x02, 0x7F, 0x01, 0x90, 0x82, 0x1A, 0xE0, 0x6F, 0x60, 0x39, 0xC3, 0x90, 0x82, 0x1C, 0xE0, 0x94, - 0x88, 0x90, 0x82, 0x1B, 0xE0, 0x94, 0x13, 0x40, 0x08, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, - 0x22, 0x90, 0x82, 0x1B, 0xD1, 0x20, 0x7F, 0x14, 0x7E, 0x00, 0x12, 0x32, 0xAA, 0xD3, 0x90, 0x82, - 0x1C, 0xE0, 0x94, 0x32, 0x90, 0x82, 0x1B, 0xE0, 0x94, 0x00, 0x40, 0xBC, 0x90, 0x01, 0xC6, 0xE0, - 0x30, 0xE0, 0xB5, 0x22, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x12, 0x87, 0x9D, 0x90, - 0x00, 0x08, 0xE0, 0x54, 0xEF, 0xFD, 0x7F, 0x08, 0x12, 0x32, 0x1E, 0xE4, 0xFF, 0xD1, 0x73, 0x90, - 0x81, 0x88, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xF1, 0x30, - 0xD1, 0xCC, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x81, 0x8F, 0xE0, 0xFF, 0x60, 0x03, 0xB4, 0x08, - 0x0D, 0xF1, 0x7C, 0xBF, 0x01, 0x08, 0xD1, 0xE7, 0x90, 0x01, 0xE5, 0xE0, 0x04, 0xF0, 0x22, 0x90, - 0x81, 0x87, 0xE0, 0x30, 0xE0, 0x19, 0x90, 0x81, 0x82, 0xE0, 0xFF, 0x30, 0xE0, 0x0F, 0xC3, 0x13, - 0x30, 0xE0, 0x08, 0x12, 0x88, 0xBE, 0xBF, 0x01, 0x06, 0x80, 0x02, 0x80, 0x00, 0xD1, 0xF7, 0x22, - 0x90, 0x81, 0x88, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x81, 0x97, 0xE0, 0xFD, 0x7F, 0x93, 0x12, 0x32, - 0x1E, 0x90, 0x81, 0x8D, 0xE0, 0x60, 0x12, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x05, 0x74, 0x10, - 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, 0x90, 0x00, 0x08, 0xE0, 0x44, 0x10, 0xFD, - 0x7F, 0x08, 0x12, 0x32, 0x1E, 0x7F, 0x01, 0xD1, 0x73, 0x90, 0x00, 0x90, 0xE0, 0x44, 0x01, 0xFD, - 0x7F, 0x90, 0x12, 0x32, 0x1E, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x32, 0xAA, 0x90, 0x81, 0xF7, 0xE0, - 0xC3, 0x13, 0x20, 0xE0, 0x35, 0x90, 0x02, 0x87, 0xE0, 0x60, 0x02, 0x80, 0x08, 0x90, 0x01, 0x00, - 0xE0, 0x64, 0x3F, 0x60, 0x05, 0x75, 0x52, 0x01, 0x80, 0x23, 0x90, 0x02, 0x96, 0xE0, 0x60, 0x05, - 0x75, 0x52, 0x10, 0x80, 0x18, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x02, 0x80, 0x07, 0x90, 0x02, - 0x86, 0xE0, 0x30, 0xE3, 0x05, 0x75, 0x52, 0x04, 0x80, 0x03, 0x02, 0x86, 0xD9, 0x90, 0x01, 0xB9, - 0x74, 0x08, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x52, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0x04, 0x1F, 0x74, - 0x20, 0xF0, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x02, 0x4D, 0xE7, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, - 0x12, 0x45, 0x4E, 0x90, 0x82, 0x7D, 0xEF, 0xF0, 0x60, 0xF0, 0x90, 0x80, 0x3C, 0xE0, 0xFF, 0x70, - 0x04, 0xA3, 0xE0, 0x60, 0xE5, 0xC2, 0xAF, 0xEF, 0x30, 0xE0, 0x0A, 0x90, 0x80, 0x3C, 0xE0, 0x54, - 0xFE, 0xF0, 0x12, 0x5A, 0xC6, 0x11, 0x1D, 0x30, 0xE1, 0x05, 0x54, 0xFD, 0xF0, 0x11, 0x27, 0x11, - 0x1D, 0x30, 0xE2, 0x05, 0x54, 0xFB, 0xF0, 0x31, 0xC2, 0xD2, 0xAF, 0x80, 0xCD, 0xD2, 0xAF, 0xC2, - 0xAF, 0x90, 0x80, 0x3C, 0xE0, 0xFF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x80, - 0xDD, 0xE0, 0xFF, 0x90, 0x80, 0xDC, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, - 0xEF, 0x70, 0x3F, 0x90, 0x80, 0xDC, 0xE0, 0xFE, 0x75, 0xF0, 0x08, 0x90, 0x80, 0x8C, 0x12, 0x47, - 0xDE, 0xE0, 0xFD, 0xEE, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x8D, 0xF9, 0x74, 0x80, 0x35, 0xF0, 0xFA, - 0x7B, 0x01, 0xAF, 0x05, 0x12, 0x65, 0x2F, 0x90, 0x80, 0xDC, 0x31, 0xBB, 0xB4, 0x0A, 0x02, 0x7F, - 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0x80, 0xDC, 0xF0, 0x11, 0x87, 0x90, 0x80, 0x3C, 0xE0, 0x44, - 0x02, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x01, 0xCC, 0xE0, 0x54, 0x0F, 0x90, 0x82, 0xE0, - 0xF0, 0x90, 0x82, 0xE0, 0xE0, 0xFD, 0x70, 0x02, 0x21, 0x9A, 0x90, 0x80, 0xDC, 0xE0, 0xFF, 0x70, - 0x06, 0xA3, 0xE0, 0x64, 0x09, 0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0x80, 0xDD, 0xE0, 0xB5, 0x07, - 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x08, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x01, - 0xF0, 0x22, 0x90, 0x82, 0xDE, 0xE0, 0x12, 0x60, 0x8B, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, - 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x70, 0x02, 0x21, 0x7D, 0xE4, 0x90, 0x82, 0xE1, 0xF0, 0x90, 0x82, - 0xE1, 0xE0, 0xF9, 0xC3, 0x94, 0x04, 0x50, 0x46, 0x31, 0x9C, 0xA4, 0xFF, 0xE9, 0xFD, 0x7C, 0x00, - 0x2F, 0xFF, 0xEC, 0x35, 0xF0, 0xFE, 0x74, 0xD0, 0x31, 0xA4, 0x90, 0x80, 0xDD, 0xE0, 0x75, 0xF0, - 0x08, 0x90, 0x80, 0x8C, 0x31, 0xAF, 0xF5, 0x83, 0xEF, 0x31, 0x9B, 0xA4, 0x2D, 0xFF, 0xEC, 0x35, - 0xF0, 0xFE, 0x74, 0xF0, 0x31, 0xA4, 0x90, 0x80, 0xDD, 0xE0, 0x75, 0xF0, 0x08, 0x90, 0x80, 0x90, - 0x31, 0xAF, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x82, 0xE1, 0xE0, 0x04, 0xF0, 0x80, 0xB0, 0x90, 0x82, - 0xE0, 0xE0, 0xFF, 0x90, 0x82, 0xDE, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, - 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0x90, 0x82, 0xE0, 0xF0, 0x90, 0x82, 0xDE, 0xE0, 0xFF, 0x74, 0x01, - 0xA8, 0x07, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x90, 0x01, 0xCC, 0xF0, 0x90, 0x82, 0xDE, - 0xE0, 0x04, 0xF0, 0xE0, 0x54, 0x03, 0xF0, 0x90, 0x80, 0xDD, 0x31, 0xBB, 0xB4, 0x0A, 0x02, 0x7F, - 0x01, 0xEF, 0x70, 0x02, 0x01, 0x91, 0xE4, 0x90, 0x80, 0xDD, 0xF0, 0x01, 0x91, 0x90, 0x01, 0xC0, - 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x82, 0xDE, 0xE0, 0x44, 0x80, 0x90, 0x00, 0x8A, 0x31, 0x9B, 0x90, - 0x01, 0xD0, 0x12, 0x47, 0xDE, 0xE0, 0x90, 0x01, 0xC3, 0xF0, 0x22, 0xF0, 0x90, 0x82, 0xDE, 0xE0, - 0x75, 0xF0, 0x04, 0x22, 0x2F, 0xF5, 0x82, 0x74, 0x01, 0x3E, 0xF5, 0x83, 0xE0, 0xFF, 0x22, 0x12, - 0x47, 0xDE, 0xE5, 0x82, 0x29, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0x22, 0xE0, 0x04, 0xF0, 0xE0, 0x7F, - 0x00, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x90, 0x81, 0x75, 0xE0, 0xFE, - 0x90, 0x81, 0x74, 0xE0, 0xFD, 0xB5, 0x06, 0x04, 0x7E, 0x01, 0x80, 0x02, 0x7E, 0x00, 0xEE, 0x64, - 0x01, 0x60, 0x41, 0x90, 0x01, 0xAF, 0xE0, 0x70, 0x0A, 0xED, 0x91, 0xE9, 0xFA, 0x7B, 0x01, 0xB1, - 0x09, 0x7F, 0x01, 0xEF, 0x60, 0x2E, 0x90, 0x81, 0x74, 0x31, 0xBB, 0xB4, 0x0A, 0x02, 0x7F, 0x01, - 0xEF, 0x60, 0x05, 0xE4, 0x90, 0x81, 0x74, 0xF0, 0x90, 0x81, 0x75, 0xE0, 0xFF, 0x90, 0x81, 0x74, - 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x70, 0x07, 0x90, 0x80, 0x3C, - 0xE0, 0x44, 0x04, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x11, 0x87, 0x7F, 0x02, 0x8F, 0x0D, 0x7F, - 0x02, 0x12, 0x45, 0x27, 0x90, 0x80, 0x3C, 0xE0, 0x45, 0x0D, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, - 0xC3, 0xC0, 0xD0, 0x90, 0x81, 0x74, 0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, 0x60, 0x0A, - 0xEF, 0x14, 0xFF, 0x90, 0x81, 0x75, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, - 0xEF, 0x60, 0x09, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x28, 0xC0, 0x01, 0x90, 0x81, - 0x75, 0xE0, 0x91, 0xE9, 0xA8, 0x01, 0xFC, 0x7D, 0x01, 0xD0, 0x01, 0x7E, 0x00, 0x7F, 0x0F, 0x12, - 0x46, 0x7D, 0x90, 0x81, 0x75, 0x31, 0xBB, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, - 0x90, 0x81, 0x75, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xAD, 0x07, 0x90, 0x82, 0x8D, 0x74, 0x13, - 0xF0, 0x90, 0x82, 0x9B, 0x74, 0x0C, 0xF0, 0x90, 0x82, 0x8F, 0xED, 0xF0, 0x12, 0x5D, 0x3B, 0xE0, - 0xFA, 0xA3, 0xE0, 0xFB, 0xEA, 0x90, 0x82, 0x90, 0xF0, 0xA3, 0xEB, 0xF0, 0xED, 0x91, 0x8B, 0xE0, - 0xFA, 0xA3, 0xE0, 0xFB, 0xEA, 0x90, 0x82, 0x92, 0x71, 0x30, 0xED, 0x71, 0x6D, 0xE0, 0xFA, 0xA3, - 0xE0, 0xFB, 0xEA, 0x90, 0x82, 0x94, 0x71, 0x30, 0xED, 0x90, 0x89, 0x02, 0x12, 0x47, 0xDE, 0xE0, - 0xFA, 0xA3, 0xE0, 0xFB, 0xEA, 0x90, 0x82, 0x96, 0x71, 0x30, 0xED, 0x90, 0x89, 0x04, 0x12, 0x47, - 0xDE, 0xE0, 0x90, 0x82, 0x98, 0xF0, 0x75, 0xF0, 0x0A, 0xED, 0x90, 0x89, 0x06, 0x12, 0x47, 0xDE, - 0xE0, 0x90, 0x82, 0x99, 0xF0, 0x75, 0xF0, 0x0A, 0xEF, 0x90, 0x89, 0x08, 0x12, 0x47, 0xDE, 0xE0, - 0x90, 0x82, 0x9A, 0x71, 0x5E, 0x90, 0x82, 0xE2, 0xEF, 0xF0, 0x7F, 0x02, 0x12, 0x45, 0x27, 0x90, - 0x80, 0x3C, 0xE0, 0xFF, 0x90, 0x82, 0xE2, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x80, 0x3C, 0xF0, 0x22, - 0xF0, 0xA3, 0xEB, 0xF0, 0x75, 0xF0, 0x0A, 0x22, 0x90, 0x82, 0x8D, 0x74, 0x12, 0xF0, 0x90, 0x82, - 0x9B, 0x74, 0x05, 0xF0, 0x90, 0x82, 0x8F, 0x91, 0xF5, 0xEB, 0xF0, 0x90, 0x82, 0x8B, 0xE0, 0x90, - 0x82, 0x92, 0xF0, 0x90, 0x82, 0x8C, 0xE0, 0x90, 0x82, 0x93, 0x71, 0x5E, 0x80, 0xB7, 0xF0, 0x7B, - 0x01, 0x7A, 0x82, 0x79, 0x8D, 0x51, 0x3C, 0x7F, 0x04, 0x22, 0x75, 0xF0, 0x0A, 0x90, 0x89, 0x00, - 0x02, 0x47, 0xDE, 0x90, 0x81, 0xFF, 0xE5, 0xD1, 0xF0, 0xA3, 0xE5, 0xD2, 0xF0, 0xA3, 0xE5, 0xD3, - 0xF0, 0xA3, 0xE5, 0xD4, 0xF0, 0xA3, 0xE5, 0xD5, 0xF0, 0xA3, 0xE5, 0xD6, 0xF0, 0xA3, 0xE5, 0xD7, - 0xF0, 0xA3, 0xE5, 0xD9, 0xF0, 0x75, 0x13, 0x01, 0x75, 0x14, 0x81, 0x75, 0x15, 0xFF, 0x75, 0x16, - 0x08, 0x7B, 0x01, 0x7A, 0x91, 0x79, 0x43, 0x12, 0x2B, 0xED, 0x90, 0x91, 0x44, 0xE0, 0xFF, 0x12, - 0x67, 0xA3, 0x30, 0xE0, 0x02, 0x81, 0x6E, 0xEF, 0x54, 0x3F, 0xFF, 0x90, 0x82, 0x07, 0xF0, 0x90, - 0x91, 0x45, 0xE0, 0x54, 0x3F, 0xFE, 0x90, 0x82, 0x08, 0xF0, 0x91, 0x6F, 0xFD, 0x91, 0x8A, 0x91, - 0x76, 0xD3, 0x94, 0x04, 0x40, 0x06, 0x90, 0x82, 0x08, 0x74, 0x04, 0xF0, 0x90, 0x91, 0x44, 0x12, - 0x6F, 0x3C, 0x30, 0xE0, 0x67, 0x90, 0x82, 0x07, 0xE0, 0x71, 0x6A, 0xC0, 0x83, 0xC0, 0x82, 0x90, - 0x82, 0x08, 0xE0, 0xD0, 0x82, 0xD0, 0x83, 0x75, 0xF0, 0x02, 0x12, 0x47, 0xDE, 0xE0, 0xFE, 0xA3, - 0xE0, 0xFF, 0x91, 0x6F, 0x2F, 0xFF, 0xE4, 0x3E, 0xFE, 0x90, 0x82, 0x07, 0xE0, 0xFC, 0x71, 0x6A, - 0xC0, 0x83, 0xC0, 0x82, 0x90, 0x82, 0x08, 0xE0, 0xFB, 0xD0, 0x82, 0xD0, 0x83, 0x75, 0xF0, 0x02, - 0x12, 0x47, 0xDE, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x91, 0x6F, 0xFA, 0xFF, 0xEC, 0x91, 0xFC, 0x8F, - 0xF0, 0x12, 0x46, 0xA3, 0x90, 0x91, 0x46, 0xE0, 0xFD, 0x12, 0x67, 0xA3, 0x30, 0xE0, 0x2F, 0x90, - 0x82, 0x07, 0xE0, 0xFF, 0xED, 0x54, 0x7F, 0xFD, 0x8A, 0x51, 0x80, 0x4B, 0x91, 0x6F, 0xFD, 0x90, - 0x82, 0x07, 0xE0, 0xFE, 0x91, 0x7E, 0x91, 0x76, 0x91, 0x7E, 0xA3, 0xE0, 0x90, 0x07, 0x00, 0xF0, - 0x90, 0x91, 0x46, 0x12, 0x67, 0xA2, 0x30, 0xE0, 0x05, 0xAF, 0x06, 0x12, 0x5E, 0xB3, 0x22, 0x90, - 0x91, 0x47, 0xE0, 0x54, 0x1F, 0x22, 0xE4, 0x8D, 0xF0, 0x12, 0x46, 0xA3, 0xEE, 0x22, 0x25, 0xE0, - 0x24, 0x4B, 0xF5, 0x82, 0xE4, 0x34, 0x91, 0xF5, 0x83, 0x22, 0xEF, 0x25, 0xE0, 0x24, 0x80, 0xF5, - 0x82, 0xE4, 0x34, 0x8C, 0xF5, 0x83, 0x22, 0xAA, 0x07, 0xED, 0x54, 0x1F, 0x90, 0x82, 0x0B, 0xF0, - 0x91, 0xDE, 0xE0, 0x90, 0x82, 0x09, 0xF0, 0x90, 0x82, 0x0C, 0x74, 0x01, 0xF0, 0xEB, 0xC3, 0x94, - 0x01, 0x40, 0x03, 0x02, 0x5E, 0xB3, 0x90, 0x82, 0x09, 0xE0, 0x25, 0x51, 0xFF, 0xA3, 0xF0, 0xA3, - 0xE0, 0x90, 0x42, 0x0E, 0x93, 0xFE, 0xEF, 0xD3, 0x9E, 0x40, 0x09, 0x91, 0xDE, 0xE4, 0xF0, 0xAF, - 0x02, 0x02, 0x63, 0x57, 0x90, 0x82, 0x0A, 0xE0, 0xFF, 0x91, 0xDE, 0xEF, 0xF0, 0x22, 0x74, 0x01, - 0x2A, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0xDE, 0xF9, - 0x74, 0x80, 0x35, 0xF0, 0x22, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0x22, 0x25, 0xE0, 0x24, 0xCB, - 0xF5, 0x82, 0xE4, 0x34, 0x91, 0xF5, 0x83, 0xE4, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, - 0x90, 0x82, 0x7E, 0x12, 0x47, 0xF3, 0x90, 0x82, 0xDF, 0xE0, 0xFF, 0x04, 0xF0, 0x12, 0x63, 0x9C, - 0x7F, 0xAF, 0x7E, 0x01, 0x12, 0x76, 0x27, 0xEF, 0x60, 0x3A, 0x90, 0x82, 0x7E, 0x12, 0x47, 0xEA, - 0x8B, 0x13, 0x8A, 0x14, 0x89, 0x15, 0x90, 0x00, 0x0E, 0x12, 0x1F, 0xBD, 0x24, 0x02, 0xF5, 0x16, - 0x7B, 0x01, 0x7A, 0x01, 0x79, 0xA0, 0x12, 0x2B, 0xED, 0x90, 0x82, 0x7E, 0x12, 0x47, 0xEA, 0x90, - 0x00, 0x0E, 0x12, 0x1F, 0xBD, 0x90, 0x01, 0xAE, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0x90, 0x01, 0xCB, - 0xE0, 0x64, 0x80, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7B, 0x01, 0x7A, 0x82, 0x79, 0x82, 0x7F, - 0xF5, 0x7E, 0x00, 0x12, 0x2B, 0x27, 0xBF, 0x01, 0x06, 0x90, 0x82, 0x82, 0xE0, 0xA3, 0xF0, 0x7B, - 0x01, 0x7A, 0x82, 0x79, 0x82, 0x7F, 0xF6, 0x7E, 0x00, 0x12, 0x2B, 0x27, 0xBF, 0x01, 0x08, 0x90, - 0x82, 0x82, 0xE0, 0x90, 0x82, 0x84, 0xF0, 0x7B, 0x01, 0x7A, 0x82, 0x79, 0x82, 0x7F, 0xF4, 0x7E, - 0x00, 0x12, 0x2B, 0x27, 0xBF, 0x01, 0x08, 0x90, 0x82, 0x82, 0xE0, 0x90, 0x82, 0x85, 0xF0, 0x7B, - 0x01, 0x7A, 0x82, 0x79, 0x82, 0x7F, 0xF3, 0x7E, 0x00, 0x12, 0x2B, 0x27, 0xBF, 0x01, 0x08, 0x90, - 0x82, 0x82, 0xE0, 0x90, 0x82, 0x86, 0xF0, 0x7B, 0x01, 0x7A, 0x82, 0x79, 0x82, 0x7F, 0xF2, 0x7E, - 0x00, 0x12, 0x2B, 0x27, 0xBF, 0x01, 0x08, 0x90, 0x82, 0x82, 0xE0, 0x90, 0x82, 0x87, 0xF0, 0x90, - 0x82, 0x83, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, 0x82, 0x8B, 0xF0, - 0x90, 0x82, 0x87, 0xE0, 0x90, 0x82, 0x8C, 0xF0, 0x61, 0x38, 0x12, 0x1F, 0xA4, 0xFF, 0x90, 0x81, - 0x78, 0xF0, 0xBF, 0x01, 0x07, 0xB1, 0x69, 0xE4, 0x90, 0x81, 0x78, 0xF0, 0x22, 0xD3, 0x10, 0xAF, - 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x6D, 0xB7, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, - 0xC3, 0xC0, 0xD0, 0xC0, 0x07, 0xC0, 0x05, 0x90, 0x82, 0xBA, 0x12, 0x47, 0xA1, 0x90, 0x82, 0xB0, - 0x12, 0x20, 0xCE, 0xD0, 0x05, 0xD0, 0x07, 0x12, 0x6E, 0xBF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x22, - 0xAC, 0x07, 0xED, 0xAD, 0x04, 0x78, 0x24, 0xF2, 0xED, 0x08, 0xF2, 0xEB, 0xB4, 0x04, 0x07, 0x78, - 0x27, 0x74, 0x01, 0xF2, 0x80, 0x0E, 0xEB, 0x78, 0x27, 0xB4, 0x05, 0x05, 0x74, 0x02, 0xF2, 0x80, - 0x03, 0x74, 0x04, 0xF2, 0xF1, 0x88, 0xE2, 0x94, 0x00, 0x50, 0x46, 0xE4, 0x78, 0x26, 0xF2, 0xF1, - 0x63, 0xC3, 0x9F, 0x40, 0x02, 0xE1, 0x62, 0xF1, 0x6B, 0x60, 0x1F, 0x74, 0x37, 0x2E, 0xF8, 0xE2, - 0x78, 0x32, 0xF2, 0xEE, 0xFF, 0x78, 0x25, 0xE2, 0x2F, 0xFF, 0x18, 0xE2, 0x34, 0x00, 0x8F, 0x82, - 0xF5, 0x83, 0xE0, 0x78, 0x29, 0xF2, 0x78, 0x32, 0xF1, 0x9C, 0x78, 0x24, 0x08, 0xE2, 0xFF, 0x08, - 0xE2, 0x2F, 0xFF, 0x78, 0x28, 0xE2, 0xFD, 0x12, 0x32, 0x1E, 0x78, 0x26, 0xE2, 0x04, 0xF2, 0x80, - 0xBE, 0xF1, 0x88, 0xE2, 0x94, 0x07, 0x50, 0x35, 0xE4, 0x78, 0x26, 0xF2, 0xF1, 0x63, 0xC3, 0x9F, - 0x40, 0x02, 0xE1, 0x62, 0xF1, 0x6B, 0x60, 0x16, 0x78, 0x26, 0xE2, 0xFF, 0xF1, 0x90, 0xF5, 0x83, - 0xE0, 0x78, 0x29, 0xF2, 0x74, 0x37, 0x2F, 0xF8, 0xE2, 0x78, 0x32, 0xF2, 0xF1, 0x9C, 0xF1, 0x80, - 0xF1, 0x90, 0xF5, 0x83, 0xEF, 0xF0, 0x78, 0x26, 0xE2, 0x04, 0xF2, 0x80, 0xCF, 0x90, 0x82, 0x7C, - 0xE0, 0x60, 0x0A, 0xF1, 0x78, 0x12, 0x2D, 0x5C, 0x78, 0x2E, 0x12, 0x47, 0xD2, 0xE4, 0x78, 0x26, - 0xF2, 0xF1, 0x63, 0xC3, 0x9F, 0x50, 0x4E, 0xF1, 0x6B, 0x60, 0x2B, 0x78, 0x2E, 0x12, 0x47, 0xAD, - 0x78, 0x26, 0xE2, 0xFB, 0x75, 0xF0, 0x08, 0xA4, 0xF9, 0xF8, 0x12, 0x20, 0xA8, 0x78, 0x29, 0xEF, - 0xF2, 0x74, 0x37, 0x2B, 0xF8, 0xE2, 0x78, 0x32, 0xF2, 0xE2, 0xFE, 0xF4, 0x5F, 0xFF, 0x78, 0x28, - 0xE2, 0xFD, 0xEE, 0x5D, 0x4F, 0xF2, 0xF1, 0x80, 0xFD, 0xC3, 0x74, 0x03, 0x9D, 0xFD, 0xE4, 0x94, - 0x00, 0xFC, 0x7B, 0xFE, 0x74, 0x2A, 0x2D, 0xF9, 0x74, 0x80, 0x3C, 0xFA, 0xEF, 0x12, 0x1F, 0xEA, - 0xE2, 0x04, 0xF2, 0x80, 0xAC, 0x78, 0x2A, 0x12, 0x47, 0xAD, 0x12, 0x6D, 0xB1, 0xF1, 0x78, 0x12, - 0x2E, 0xA2, 0x22, 0x78, 0x27, 0xE2, 0xFF, 0x18, 0xE2, 0xFE, 0x22, 0x74, 0x33, 0x2E, 0xF8, 0xE2, - 0x78, 0x28, 0xF2, 0x90, 0x82, 0x7C, 0xE0, 0x22, 0x78, 0x24, 0xE2, 0xFE, 0x08, 0xE2, 0xFF, 0x22, - 0x78, 0x28, 0xE2, 0xFF, 0x78, 0x26, 0xE2, 0x22, 0xD3, 0x78, 0x25, 0xE2, 0x94, 0xFF, 0x18, 0x22, - 0xFD, 0x18, 0xE2, 0x2D, 0xFD, 0x18, 0xE2, 0x34, 0x00, 0x8D, 0x82, 0x22, 0xE2, 0xFF, 0xF4, 0xFE, - 0x78, 0x29, 0xE2, 0x5E, 0xFE, 0x18, 0xE2, 0xFD, 0xEF, 0x5D, 0x4E, 0xF2, 0x22, 0x78, 0x10, 0x74, - 0x01, 0xF2, 0x90, 0x02, 0x09, 0xE0, 0x78, 0x00, 0xF2, 0x08, 0x74, 0x20, 0xF2, 0x18, 0xE2, 0xFF, - 0x30, 0xE0, 0x05, 0x08, 0xE2, 0x24, 0x80, 0xF2, 0xEF, 0xC3, 0x13, 0x90, 0xFD, 0x10, 0xF0, 0x78, - 0x01, 0xE2, 0x12, 0x81, 0xF6, 0x78, 0x03, 0xF2, 0x64, 0x04, 0x60, 0x0E, 0xE2, 0xFF, 0x64, 0x08, - 0x60, 0x08, 0xEF, 0x64, 0x0C, 0x60, 0x03, 0x02, 0x81, 0xD9, 0xE4, 0x78, 0x02, 0xF2, 0x78, 0x03, - 0xE2, 0xFF, 0x18, 0xE2, 0xC3, 0x9F, 0x50, 0x25, 0xE2, 0xFD, 0x18, 0xE2, 0x2D, 0x90, 0x82, 0x1A, - 0xF0, 0xE0, 0xFF, 0x31, 0xF6, 0xFE, 0x74, 0x04, 0x2D, 0xF8, 0xEE, 0xF2, 0xEF, 0xB4, 0xFF, 0x06, - 0x90, 0xFD, 0x10, 0xE0, 0x04, 0xF0, 0x78, 0x02, 0xE2, 0x04, 0xF2, 0x80, 0xD1, 0x78, 0x04, 0xE2, - 0x78, 0x12, 0xF2, 0xFF, 0x78, 0x05, 0xE2, 0x78, 0x11, 0xF2, 0x78, 0x06, 0xE2, 0x78, 0x13, 0xF2, - 0x78, 0x07, 0xE2, 0x78, 0x14, 0xF2, 0x78, 0x08, 0xE2, 0x78, 0x33, 0xF2, 0x78, 0x09, 0xE2, 0x78, - 0x34, 0xF2, 0x78, 0x0A, 0xE2, 0x78, 0x35, 0xF2, 0x78, 0x0B, 0xE2, 0x78, 0x36, 0xF2, 0x78, 0x0C, - 0xE2, 0x78, 0x37, 0xF2, 0x78, 0x0D, 0xE2, 0x78, 0x38, 0xF2, 0x78, 0x0E, 0xE2, 0x78, 0x39, 0xF2, - 0x78, 0x0F, 0xE2, 0x78, 0x3A, 0xF2, 0xE4, 0x78, 0x15, 0xF2, 0xEF, 0x24, 0xF8, 0x60, 0x56, 0x24, - 0xFC, 0x60, 0x4D, 0x24, 0x08, 0x60, 0x02, 0x21, 0xBA, 0x78, 0x11, 0xE2, 0xB4, 0x01, 0x05, 0x12, - 0x29, 0xC5, 0x21, 0xBF, 0x78, 0x11, 0xE2, 0xB4, 0x02, 0x05, 0x12, 0x11, 0xBD, 0x21, 0xBF, 0x78, - 0x11, 0xE2, 0xB4, 0x03, 0x05, 0x12, 0x4A, 0xFB, 0x21, 0xBF, 0x78, 0x11, 0xE2, 0xB4, 0x10, 0x07, - 0x31, 0xE3, 0x12, 0x32, 0xAA, 0x21, 0xBF, 0x78, 0x11, 0xE2, 0xB4, 0x11, 0x07, 0x31, 0xE3, 0x12, - 0x32, 0x06, 0x21, 0xBF, 0x78, 0x11, 0xE2, 0xF4, 0x60, 0x02, 0x21, 0xBF, 0x18, 0xF2, 0x21, 0xBF, - 0x78, 0x15, 0x74, 0x01, 0xF2, 0x78, 0x11, 0xE2, 0x64, 0x07, 0x60, 0x02, 0x21, 0xA3, 0x78, 0x34, - 0x31, 0xDC, 0x78, 0x08, 0x12, 0x20, 0xBB, 0xC0, 0x04, 0xA9, 0x05, 0xAA, 0x06, 0xAB, 0x07, 0x78, - 0x33, 0x31, 0xDC, 0xD0, 0x00, 0x12, 0x47, 0x83, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, - 0x78, 0x35, 0x31, 0xDC, 0x78, 0x10, 0x12, 0x20, 0xBB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, - 0x00, 0x12, 0x47, 0x83, 0x78, 0x18, 0x12, 0x47, 0xD2, 0x78, 0x15, 0xE2, 0x60, 0x7E, 0x18, 0xE2, - 0xFF, 0x18, 0xE2, 0xFD, 0x12, 0x7E, 0x0D, 0x78, 0x1C, 0x12, 0x47, 0xD2, 0x78, 0x38, 0x31, 0xDC, - 0x78, 0x08, 0x12, 0x20, 0xBB, 0xC0, 0x04, 0xA9, 0x05, 0xAA, 0x06, 0xAB, 0x07, 0x78, 0x37, 0x31, - 0xDC, 0xD0, 0x00, 0x12, 0x47, 0x83, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x78, 0x39, - 0x31, 0xDC, 0x78, 0x10, 0x12, 0x20, 0xBB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, - 0x47, 0x83, 0x78, 0x20, 0x12, 0x47, 0xD2, 0x78, 0x20, 0x12, 0x47, 0xAD, 0x12, 0x20, 0x9B, 0x78, - 0x1C, 0x12, 0x47, 0xC5, 0x12, 0x47, 0x76, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x78, - 0x18, 0x12, 0x47, 0xAD, 0x78, 0x20, 0x12, 0x47, 0xC5, 0x12, 0x47, 0x76, 0xD0, 0x03, 0xD0, 0x02, - 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x47, 0x83, 0x78, 0x18, 0x12, 0x47, 0xD2, 0x78, 0x18, 0x12, 0x47, - 0xAD, 0x90, 0x82, 0xBA, 0x12, 0x20, 0xCE, 0x78, 0x13, 0xE2, 0xFD, 0x08, 0xE2, 0xFF, 0x12, 0x7E, - 0x1C, 0x80, 0x1C, 0x78, 0x13, 0xE2, 0xFF, 0x08, 0xE2, 0xFD, 0x78, 0x11, 0xE2, 0xFB, 0x78, 0x15, - 0xE2, 0x90, 0x82, 0x7C, 0xF0, 0x12, 0x7E, 0x40, 0x80, 0x05, 0x78, 0x10, 0x74, 0x02, 0xF2, 0x78, - 0x10, 0xE2, 0xFF, 0xC3, 0x94, 0x02, 0x50, 0x11, 0xEF, 0x60, 0x0B, 0x78, 0x02, 0xE2, 0xFF, 0x18, - 0xE2, 0x2F, 0xF2, 0x02, 0x7F, 0xCF, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, 0xE2, 0xFF, 0xE4, 0xFC, - 0xFD, 0xFE, 0x22, 0x78, 0x14, 0xE2, 0xFE, 0x18, 0xE2, 0xFD, 0xED, 0xFF, 0x78, 0x16, 0xEE, 0xF2, - 0xFE, 0x08, 0xEF, 0xF2, 0xFF, 0x22, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, - 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x2D, 0xA7, 0xE4, 0xF5, 0x54, 0x12, 0x32, - 0x9E, 0xEF, 0x60, 0x73, 0x63, 0x54, 0x01, 0xE5, 0x54, 0x24, 0x01, 0x90, 0x01, 0xC4, 0xF0, 0x74, - 0x82, 0xA3, 0xF0, 0x90, 0x00, 0x88, 0xE0, 0xF5, 0x52, 0xF5, 0x53, 0x54, 0x0F, 0x60, 0xDF, 0xE5, - 0x52, 0x30, 0xE0, 0x0B, 0x20, 0xE4, 0x03, 0x12, 0x29, 0xC5, 0x53, 0x53, 0xEE, 0x80, 0x3F, 0xE5, - 0x52, 0x30, 0xE1, 0x16, 0x20, 0xE5, 0x0E, 0x12, 0x11, 0xBD, 0xEF, 0x70, 0x03, 0x43, 0x53, 0x20, - 0x90, 0x01, 0x06, 0xE4, 0xF0, 0x53, 0x53, 0xFD, 0x80, 0x24, 0xE5, 0x52, 0x30, 0xE2, 0x0B, 0x20, - 0xE6, 0x03, 0x12, 0x4A, 0xFB, 0x53, 0x53, 0xFB, 0x80, 0x14, 0xE5, 0x52, 0x30, 0xE3, 0x0F, 0x20, - 0xE7, 0x09, 0x12, 0x7F, 0xAD, 0xEF, 0x70, 0x03, 0x43, 0x53, 0x80, 0x53, 0x53, 0xF7, 0xAD, 0x53, - 0x7F, 0x88, 0x12, 0x32, 0x1E, 0x80, 0x87, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x1F, 0xA4, 0x54, - 0x01, 0xFF, 0x90, 0x81, 0xFE, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x22, 0x12, 0x1F, 0xA4, 0x90, 0x81, - 0xEF, 0xF0, 0x22, 0x12, 0x1F, 0xA4, 0x90, 0x81, 0xFC, 0xF0, 0x12, 0x64, 0x4F, 0x90, 0x81, 0xFD, - 0xF0, 0x22, 0xE4, 0x90, 0x81, 0x74, 0xF0, 0xA3, 0xF0, 0x90, 0x80, 0xDC, 0xF0, 0xA3, 0xF0, 0x22, - 0x90, 0x01, 0x94, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x01, 0xC7, 0xE4, 0xF0, 0x22, 0x90, 0x01, 0x01, - 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x01, 0x9C, 0x74, 0x7E, 0xF0, 0xA3, 0x74, 0x92, 0xF0, 0xA3, 0x74, - 0xA0, 0xF0, 0xA3, 0x74, 0x24, 0xF0, 0x90, 0x01, 0x9B, 0x74, 0x49, 0xF0, 0x90, 0x01, 0x9A, 0x74, - 0xE0, 0xF0, 0x90, 0x01, 0x99, 0xE4, 0xF0, 0x90, 0x01, 0x98, 0x04, 0xF0, 0x22, 0xE4, 0x90, 0x82, - 0x11, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x98, 0xE0, 0x7F, 0x00, 0x30, 0xE4, 0x02, 0x7F, 0x01, 0xEF, - 0x64, 0x01, 0x60, 0x41, 0xC3, 0x90, 0x82, 0x12, 0xE0, 0x94, 0x88, 0x90, 0x82, 0x11, 0xE0, 0x94, - 0x13, 0x40, 0x0F, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x01, 0xC7, 0x74, 0xFD, 0xF0, - 0x80, 0x23, 0x90, 0x82, 0x11, 0x12, 0x76, 0x20, 0x7F, 0x14, 0x7E, 0x00, 0x12, 0x32, 0xAA, 0xD3, - 0x90, 0x82, 0x12, 0xE0, 0x94, 0x32, 0x90, 0x82, 0x11, 0xE0, 0x94, 0x00, 0x40, 0xB6, 0x90, 0x01, - 0xC6, 0xE0, 0x30, 0xE3, 0xAF, 0x90, 0x01, 0xC7, 0x74, 0xFE, 0xF0, 0x22, 0x7F, 0x02, 0x90, 0x81, - 0xFB, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x18, 0xEF, 0x25, 0xE0, 0x24, 0x81, 0xF8, 0xE6, 0x30, - 0xE4, 0x0B, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0xA3, 0xF0, 0x7F, 0x00, 0x22, 0x0F, 0x80, 0xDE, - 0x7F, 0x01, 0x22, 0x90, 0x01, 0xE4, 0x74, 0x17, 0xF0, 0xA3, 0xE4, 0xF0, 0x22, 0x90, 0x01, 0x34, - 0xE0, 0x55, 0x3D, 0xF5, 0x41, 0xA3, 0xE0, 0x55, 0x3E, 0xF5, 0x42, 0xA3, 0xE0, 0x55, 0x3F, 0xF5, - 0x43, 0xA3, 0xE0, 0x55, 0x40, 0xF5, 0x44, 0x90, 0x01, 0x34, 0xE5, 0x41, 0xF0, 0xA3, 0xE5, 0x42, - 0xF0, 0xA3, 0xE5, 0x43, 0xF0, 0xA3, 0xE5, 0x44, 0xF0, 0x22, 0x90, 0x01, 0x3C, 0xE0, 0x55, 0x45, - 0xF5, 0x49, 0xA3, 0xE0, 0x55, 0x46, 0xF5, 0x4A, 0xA3, 0xE0, 0x55, 0x47, 0xF5, 0x4B, 0xA3, 0xE0, - 0x55, 0x48, 0xF5, 0x4C, 0x90, 0x01, 0x3C, 0xE5, 0x49, 0xF0, 0xA3, 0xE5, 0x4A, 0xF0, 0xA3, 0xE5, - 0x4B, 0xF0, 0xA3, 0xE5, 0x4C, 0xF0, 0x53, 0x91, 0xDF, 0x22, 0x90, 0x81, 0x82, 0xE0, 0x30, 0xE0, - 0x05, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x81, 0xFD, 0xE0, 0x60, 0x0F, 0xE4, 0xF0, 0x90, - 0x05, 0x53, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x05, 0xFC, 0xE0, 0x04, 0xF0, 0x90, 0x81, 0x82, 0xE0, - 0x30, 0xE0, 0x10, 0xA3, 0x74, 0x01, 0xF0, 0x90, 0x81, 0x82, 0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, - 0x02, 0x91, 0x29, 0x12, 0x4D, 0xF1, 0x02, 0x55, 0x98, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, - 0x12, 0x6B, 0xF6, 0xBF, 0x01, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x02, 0x12, 0x6A, 0xFC, 0xD0, - 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x81, 0x82, 0xE0, 0xFF, 0x30, 0xE0, 0x3E, 0x90, 0x81, 0x86, 0xE0, - 0x7E, 0x00, 0xB4, 0x02, 0x02, 0x7E, 0x01, 0x90, 0x81, 0x85, 0xE0, 0x7D, 0x00, 0xB4, 0x04, 0x02, - 0x7D, 0x01, 0xED, 0x4E, 0x70, 0x24, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x02, 0x80, 0xBB, 0x91, 0x8B, - 0x90, 0x81, 0x86, 0xE0, 0xB4, 0x0C, 0x06, 0xE4, 0xFD, 0x7F, 0x08, 0x80, 0x0A, 0x90, 0x81, 0x86, - 0xE0, 0xB4, 0x04, 0x06, 0xE4, 0xFD, 0xFF, 0x12, 0x51, 0xCD, 0x22, 0x90, 0x01, 0x57, 0xE0, 0x60, - 0x1C, 0x91, 0xB9, 0xF0, 0x91, 0xAE, 0x54, 0x3F, 0x30, 0xE0, 0x02, 0x80, 0x40, 0x91, 0xFA, 0x40, - 0x0C, 0xE4, 0xFF, 0x12, 0x65, 0xE3, 0xBF, 0x01, 0x04, 0x12, 0x6C, 0xAA, 0xF0, 0x22, 0x90, 0x81, - 0x87, 0xE0, 0xFF, 0x13, 0x13, 0x22, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, - 0x22, 0x12, 0x4F, 0xD4, 0x70, 0x16, 0x90, 0x81, 0x8C, 0xE0, 0x60, 0x10, 0x91, 0xB6, 0xF0, 0x90, - 0x81, 0x87, 0xE0, 0x91, 0xDE, 0x54, 0x07, 0x70, 0x03, 0x12, 0x69, 0x74, 0x22, 0xEF, 0x54, 0xFB, - 0xF0, 0x90, 0x81, 0x90, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x12, 0x4F, 0xD4, 0x70, 0x0B, 0x90, 0x81, - 0x8C, 0xE0, 0x60, 0x05, 0x91, 0xB6, 0x12, 0x51, 0x30, 0x22, 0x90, 0x81, 0x95, 0xE0, 0x04, 0xF0, - 0x90, 0x81, 0x90, 0xE0, 0x54, 0xEF, 0xF0, 0x90, 0x81, 0xE9, 0xE0, 0xFF, 0x90, 0x81, 0x95, 0xE0, - 0xD3, 0x9F, 0x22, 0x90, 0x81, 0x82, 0xE0, 0xFF, 0x30, 0xE0, 0x3E, 0x90, 0x81, 0x86, 0xE0, 0x7E, - 0x00, 0xB4, 0x02, 0x02, 0x7E, 0x01, 0x90, 0x81, 0x85, 0xE0, 0x7D, 0x00, 0xB4, 0x04, 0x02, 0x7D, - 0x01, 0xED, 0x4E, 0x70, 0x24, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x02, 0x81, 0x29, 0x12, 0x6F, 0x21, - 0x90, 0x81, 0x86, 0xE0, 0xB4, 0x08, 0x06, 0xE4, 0xFD, 0x7F, 0x0C, 0x80, 0x09, 0x90, 0x81, 0x86, - 0xE0, 0x70, 0x06, 0xFD, 0x7F, 0x04, 0x12, 0x51, 0xCD, 0x22, 0x90, 0x81, 0x82, 0xE0, 0xFF, 0x30, - 0xE0, 0x05, 0x12, 0x6F, 0x1A, 0x60, 0x1B, 0x90, 0x81, 0x8C, 0xE0, 0x70, 0x04, 0xEF, 0x30, 0xE0, - 0x0B, 0x90, 0x81, 0x8F, 0xE0, 0x64, 0x02, 0x60, 0x09, 0x12, 0x70, 0x02, 0x90, 0x01, 0xE6, 0xE0, - 0x04, 0xF0, 0x22, 0xE4, 0xFF, 0x12, 0x65, 0xE3, 0xBF, 0x01, 0x13, 0x90, 0x81, 0x8C, 0xE0, 0x60, - 0x0D, 0x12, 0x67, 0x95, 0x64, 0x02, 0x60, 0x03, 0x02, 0x75, 0x5C, 0x12, 0x57, 0xC4, 0x22, 0xE4, - 0xFF, 0x12, 0x65, 0xE3, 0xBF, 0x01, 0x10, 0x90, 0x81, 0x8C, 0xE0, 0x60, 0x0A, 0x12, 0x74, 0xE8, - 0x54, 0x07, 0x70, 0x03, 0x12, 0x69, 0x74, 0x22, 0x90, 0x81, 0x8C, 0xE0, 0x70, 0x07, 0x90, 0x81, - 0x82, 0xE0, 0x30, 0xE0, 0x11, 0x90, 0x81, 0x82, 0xE0, 0x30, 0xE0, 0x08, 0x12, 0x6B, 0xF6, 0xBF, - 0x01, 0x04, 0x80, 0x03, 0xB1, 0xF0, 0x22, 0x90, 0x81, 0x8C, 0xE0, 0x64, 0x02, 0x60, 0x10, 0x12, - 0x67, 0x95, 0x60, 0x0B, 0xD1, 0x14, 0xEF, 0x70, 0x06, 0xFD, 0x7F, 0x0C, 0x12, 0x51, 0xCD, 0x22, - 0x90, 0x81, 0x8C, 0xE0, 0x64, 0x01, 0x70, 0x13, 0x12, 0x67, 0x95, 0x60, 0x05, 0x12, 0x57, 0xB9, - 0x80, 0x2B, 0x90, 0x81, 0x8F, 0xE0, 0x70, 0x03, 0x12, 0x51, 0xC9, 0x22, 0xD1, 0x14, 0xEF, 0x70, - 0x02, 0xB1, 0xF0, 0x22, 0x90, 0x04, 0x1A, 0xE0, 0xF4, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x90, 0x04, - 0x1B, 0xE0, 0x54, 0x07, 0x64, 0x07, 0x7F, 0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, 0xD1, 0xE1, 0x30, - 0xE0, 0x05, 0x90, 0x01, 0x5B, 0xE4, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x02, 0xF0, 0x90, 0x01, 0x3C, - 0x74, 0x04, 0xF0, 0xE4, 0xF5, 0x1D, 0x90, 0x81, 0xEB, 0xE0, 0xC3, 0x13, 0x54, 0x7F, 0xF5, 0x1E, - 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, 0x01, 0x12, 0x51, 0x41, 0x90, 0x81, 0x87, 0xE0, 0x44, 0x08, - 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xD1, 0x14, 0xEF, 0x64, 0x01, 0x60, 0x05, - 0x75, 0x0F, 0x01, 0x80, 0x51, 0x90, 0x81, 0x90, 0xE0, 0xFF, 0x54, 0x03, 0x60, 0x05, 0x75, 0x0F, - 0x02, 0x80, 0x43, 0x90, 0x81, 0x8E, 0xE0, 0xFE, 0xE4, 0xC3, 0x9E, 0x50, 0x05, 0x75, 0x0F, 0x04, - 0x80, 0x34, 0xEF, 0x30, 0xE2, 0x05, 0x75, 0x0F, 0x08, 0x80, 0x2B, 0x90, 0x81, 0x90, 0xE0, 0x30, - 0xE4, 0x05, 0x75, 0x0F, 0x10, 0x80, 0x1F, 0x90, 0x81, 0x88, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x20, - 0xE0, 0x05, 0x75, 0x0F, 0x20, 0x80, 0x0F, 0x90, 0x81, 0xEF, 0xE0, 0x60, 0x05, 0x75, 0x0F, 0x80, - 0x80, 0x04, 0xD1, 0xD9, 0x80, 0x0E, 0x90, 0x01, 0xB9, 0x74, 0x04, 0xF0, 0x90, 0x01, 0xB8, 0xE5, - 0x0F, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, - 0x22, 0x90, 0x81, 0x87, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0x90, 0x81, 0xFC, 0xE0, 0x60, - 0x0F, 0xE4, 0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x05, 0xFD, 0xE0, 0x04, 0xF0, - 0x22, 0x90, 0x81, 0x87, 0xE0, 0xFF, 0x12, 0x67, 0xA3, 0x30, 0xE0, 0x24, 0xEF, 0x54, 0x7F, 0xF0, - 0x90, 0x04, 0xE0, 0xE0, 0x90, 0x81, 0x88, 0x30, 0xE1, 0x06, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x07, - 0xE0, 0x54, 0xFD, 0xF1, 0x31, 0x04, 0xF0, 0x90, 0x81, 0x8C, 0xE0, 0x60, 0x03, 0x12, 0x69, 0x74, - 0x22, 0xF0, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x22, 0xE4, 0x90, 0x82, 0xDB, - 0xF0, 0xA3, 0xF0, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x82, 0xDD, 0xF0, 0x7D, 0x47, 0x7F, 0xFF, 0x12, - 0x51, 0xAD, 0x90, 0x05, 0xF8, 0xE0, 0x70, 0x11, 0xA3, 0xE0, 0x70, 0x0D, 0xA3, 0xE0, 0x70, 0x09, - 0xA3, 0xE0, 0x70, 0x05, 0xF1, 0x93, 0x7F, 0x01, 0x22, 0xD3, 0x90, 0x82, 0xDC, 0xE0, 0x94, 0xE8, - 0x90, 0x82, 0xDB, 0xE0, 0x94, 0x03, 0x40, 0x0C, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x20, 0xF0, 0xF1, - 0x93, 0x7F, 0x00, 0x22, 0x7F, 0x32, 0x7E, 0x00, 0x12, 0x32, 0xAA, 0x90, 0x82, 0xDB, 0x12, 0x76, - 0x20, 0x80, 0xBF, 0x90, 0x82, 0xDD, 0xE0, 0xFF, 0x7D, 0x48, 0x02, 0x51, 0xAD, 0x90, 0x01, 0xC4, - 0x74, 0x9D, 0xF0, 0x74, 0x87, 0xA3, 0xF0, 0x90, 0x00, 0x90, 0xE0, 0x20, 0xE0, 0xF9, 0x74, 0x9D, - 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x87, 0xA3, 0xF0, 0x22, 0xEF, 0x24, 0xFE, 0x60, 0x0B, 0x04, - 0x70, 0x24, 0x90, 0x81, 0x92, 0x74, 0x02, 0xF0, 0x80, 0x13, 0xED, 0x70, 0x06, 0x90, 0x81, 0xEC, - 0xE0, 0x80, 0x02, 0xED, 0x14, 0x90, 0x81, 0x92, 0xF0, 0x90, 0x81, 0x92, 0xE0, 0xA3, 0xF0, 0x90, - 0x81, 0x88, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0x90, 0x81, 0xE3, 0x74, 0x04, 0xF0, 0xA3, 0x14, 0xF0, - 0xA3, 0xE4, 0xF0, 0xA3, 0x74, 0x64, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x81, - 0xF0, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x54, 0xFB, 0xF0, 0x44, 0x10, 0xF0, 0x22, 0x90, - 0x81, 0xF0, 0xE0, 0x30, 0xE0, 0x0D, 0xE4, 0xF5, 0x1D, 0x90, 0x81, 0xF2, 0x12, 0x51, 0x37, 0x12, - 0x67, 0xE4, 0xF0, 0x90, 0x80, 0x42, 0xE0, 0xB4, 0x01, 0x15, 0x90, 0x81, 0xF0, 0xE0, 0xFF, 0xC4, - 0x54, 0x0F, 0x20, 0xE0, 0x0C, 0xEF, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x04, 0x80, 0x00, 0x11, - 0x42, 0x22, 0x90, 0x81, 0xF0, 0xE0, 0xFF, 0x30, 0xE0, 0x3B, 0x90, 0x80, 0x42, 0xE0, 0x64, 0x01, - 0x70, 0x2A, 0xEF, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x2B, 0x90, 0x82, 0xE8, 0xE0, 0x04, 0xF0, - 0xE0, 0xD3, 0x94, 0xC8, 0x40, 0x1F, 0x90, 0x81, 0xF0, 0xE0, 0x44, 0x20, 0xF0, 0xE4, 0x90, 0x82, - 0xE8, 0xF0, 0x90, 0x81, 0xF0, 0xE0, 0x13, 0x30, 0xE0, 0x0B, 0x80, 0x06, 0x12, 0x57, 0xF0, 0x30, - 0xE0, 0x03, 0x11, 0x86, 0xF0, 0x22, 0x90, 0x81, 0x87, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x81, 0x97, - 0x74, 0xD0, 0x22, 0x7E, 0x00, 0x7F, 0x01, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x81, 0x79, 0x82, 0x12, - 0x48, 0x22, 0x90, 0x81, 0x82, 0xE0, 0x54, 0xFD, 0xF0, 0xE4, 0x12, 0x59, 0x8C, 0x74, 0x0C, 0xF0, - 0x22, 0x12, 0x55, 0x1D, 0x7D, 0x24, 0x02, 0x57, 0xDD, 0x7D, 0x25, 0x02, 0x57, 0xDD, 0x90, 0x81, - 0x85, 0xE0, 0x64, 0x02, 0x7F, 0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, - 0xC0, 0xD0, 0x90, 0x82, 0xE9, 0xEF, 0xF0, 0x90, 0x80, 0x87, 0xE0, 0xFF, 0x90, 0x04, 0x1C, 0xE0, - 0x6F, 0x70, 0x3E, 0x90, 0x81, 0x8F, 0xE0, 0x64, 0x0E, 0x70, 0x15, 0x90, 0x82, 0xE9, 0xE0, 0x70, - 0x30, 0x90, 0x81, 0x87, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x06, 0x04, 0x12, 0x53, 0xEE, 0x80, 0x1E, - 0x90, 0x81, 0x8F, 0xE0, 0x64, 0x06, 0x70, 0x19, 0x90, 0x82, 0xE9, 0xE0, 0x60, 0x13, 0x90, 0x81, - 0x87, 0xE0, 0x54, 0xBF, 0xF0, 0x31, 0x26, 0xF0, 0x90, 0x81, 0x8F, 0x74, 0x04, 0xF0, 0x12, 0x57, - 0xBF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x06, 0x04, 0xE0, 0x44, 0x40, 0xF0, 0xE0, 0x44, 0x80, - 0x22, 0xE4, 0xFE, 0xEF, 0xC3, 0x13, 0xFD, 0xEF, 0x30, 0xE0, 0x02, 0x7E, 0x80, 0x90, 0xFD, 0x10, - 0xED, 0xF0, 0xAF, 0x06, 0x22, 0x7B, 0xFE, 0x7A, 0x80, 0x79, 0x33, 0x12, 0x2B, 0xED, 0x90, 0x82, - 0x2D, 0xE0, 0xFF, 0x90, 0x82, 0x2C, 0xE0, 0xFD, 0xE4, 0x90, 0x82, 0x7C, 0xF0, 0x22, 0xF0, 0x90, - 0x82, 0x2A, 0xE0, 0x24, 0x3B, 0xF9, 0xE4, 0x34, 0x82, 0x75, 0x13, 0x01, 0xF5, 0x14, 0x89, 0x15, - 0x22, 0x90, 0x82, 0x2A, 0xE0, 0x24, 0x3C, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0x22, 0x12, - 0x47, 0x83, 0x90, 0x81, 0xDF, 0x12, 0x20, 0xCE, 0x90, 0x81, 0x88, 0xE0, 0x44, 0x80, 0xF0, 0x22, - 0x74, 0x01, 0x93, 0x2F, 0xFF, 0xE4, 0x93, 0x3E, 0xC3, 0x13, 0xFE, 0xEF, 0x22, 0x7E, 0x00, 0x7F, - 0x04, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x81, 0x79, 0xF7, 0x22, 0xE0, 0x90, 0x01, 0xBA, 0xF0, 0x90, - 0x81, 0x8E, 0xE0, 0x90, 0x01, 0xBB, 0x22, 0x74, 0x11, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, - 0x83, 0xE0, 0x22, 0xE0, 0xFF, 0x75, 0xF0, 0x08, 0x90, 0x8F, 0x46, 0x02, 0x47, 0xDE, 0x90, 0x8F, - 0x45, 0x12, 0x47, 0xDE, 0xE0, 0x22, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xFE, 0xEF, 0x54, 0x07, - 0xFF, 0x22, 0x7F, 0x70, 0x7E, 0x0E, 0x12, 0x2E, 0xA2, 0x90, 0x82, 0xBA, 0x22, 0x90, 0x81, 0xF8, - 0xE0, 0x14, 0x90, 0x81, 0xFA, 0xF0, 0x22, 0xAB, 0x55, 0xAA, 0x56, 0xA9, 0x57, 0x02, 0x1F, 0xA4, - 0x12, 0x47, 0x83, 0x90, 0x82, 0x2E, 0x02, 0x20, 0xCE, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, 0xF0, - 0x22, 0x7F, 0x7C, 0x7E, 0x08, 0x02, 0x2E, 0xA2, 0x90, 0x05, 0x27, 0xE0, 0x54, 0xBF, 0xF0, 0x22, - 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0x90, 0x81, 0xF9, 0xE0, 0x90, 0x05, 0x73, 0x22, - 0x90, 0x81, 0x89, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0x90, 0x81, 0x92, 0xE0, 0x90, 0x05, 0x73, 0x22, - 0xF5, 0x82, 0xE4, 0x34, 0x92, 0xF5, 0x83, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0x22, - 0x7F, 0x7C, 0x7E, 0x08, 0x02, 0x2D, 0x5C, 0x7F, 0x8C, 0x7E, 0x08, 0x02, 0x2E, 0xA2, 0xF5, 0x82, - 0xE4, 0x34, 0x82, 0xF5, 0x83, 0x22, 0x82, 0xEE, -}; -u32 array_length_mp_8188e_s_fw_nic = 19080; - - -#endif - -void -odm_read_firmware_mp_8188e_s_fw_nic( - struct PHY_DM_STRUCT *p_dm_odm, - u8 *p_firmware, - u32 *p_firmware_size -) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) - *((SIZE_PTR *)p_firmware) = (SIZE_PTR)array_mp_8188e_s_fw_nic; -#else - odm_move_memory(p_dm_odm, p_firmware, array_mp_8188e_s_fw_nic, array_length_mp_8188e_s_fw_nic); -#endif - *p_firmware_size = array_length_mp_8188e_s_fw_nic; -} - -#ifndef LOAD_FW_HEADER_FROM_DRIVER -u8 array_mp_8188e_s_fw_wowlan[] = { - 0xE3, 0x88, 0x30, 0x00, 0x17, 0x00, 0x00, 0x00, 0x10, 0x27, 0x15, 0x22, 0x38, 0x55, 0x02, 0x00, - 0x0C, 0x27, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x02, 0x49, 0x24, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x02, 0x4A, 0x47, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x02, 0x57, 0xFD, 0x00, 0x00, 0x00, 0x00, 0x00, 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, 0x49, 0xBE, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x50, 0x03, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 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, - 0xE7, 0x09, 0xF6, 0x08, 0xDF, 0xFA, 0x80, 0x46, 0xE7, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x3E, - 0x88, 0x82, 0x8C, 0x83, 0xE7, 0x09, 0xF0, 0xA3, 0xDF, 0xFA, 0x80, 0x32, 0xE3, 0x09, 0xF6, 0x08, - 0xDF, 0xFA, 0x80, 0x78, 0xE3, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x70, 0x88, 0x82, 0x8C, 0x83, - 0xE3, 0x09, 0xF0, 0xA3, 0xDF, 0xFA, 0x80, 0x64, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF6, 0x08, - 0xDF, 0xFA, 0x80, 0x58, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x4C, - 0x80, 0xD2, 0x80, 0xFA, 0x80, 0xC6, 0x80, 0xD4, 0x80, 0x69, 0x80, 0xF2, 0x80, 0x33, 0x80, 0x10, - 0x80, 0xA6, 0x80, 0xEA, 0x80, 0x9A, 0x80, 0xA8, 0x80, 0xDA, 0x80, 0xE2, 0x80, 0xCA, 0x80, 0x33, - 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, - 0xCC, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, - 0x0D, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xA3, 0xF6, 0x08, 0xDF, 0xF9, 0xEC, 0xFA, 0xA9, 0xF0, - 0xED, 0xFB, 0x22, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, - 0xC5, 0x83, 0xCC, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xEA, 0xDE, - 0xE8, 0x80, 0xDB, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xA3, 0xF2, 0x08, 0xDF, 0xF9, 0x80, 0xCC, - 0x88, 0xF0, 0xEF, 0x60, 0x01, 0x0E, 0x4E, 0x60, 0xC3, 0x88, 0xF0, 0xED, 0x24, 0x02, 0xB4, 0x04, - 0x00, 0x50, 0xB9, 0xF5, 0x82, 0xEB, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0xAF, 0x23, 0x23, 0x45, - 0x82, 0x23, 0x90, 0x43, 0x50, 0x73, 0xC5, 0xF0, 0xF8, 0xA3, 0xE0, 0x28, 0xF0, 0xC5, 0xF0, 0xF8, - 0xE5, 0x82, 0x15, 0x82, 0x70, 0x02, 0x15, 0x83, 0xE0, 0x38, 0xF0, 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, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, 0xED, 0x49, 0xFD, - 0xEC, 0x48, 0xFC, 0x22, 0xEB, 0x9F, 0xF5, 0xF0, 0xEA, 0x9E, 0x42, 0xF0, 0xE9, 0x9D, 0x42, 0xF0, - 0xE8, 0x9C, 0x45, 0xF0, 0x22, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, - 0x22, 0xE0, 0xF8, 0xA3, 0xE0, 0xF9, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0x22, 0xA4, 0x25, 0x82, - 0xF5, 0x82, 0xE5, 0xF0, 0x35, 0x83, 0xF5, 0x83, 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, 0x45, 0xD0, 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, 0x45, 0xDC, 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, 0x45, 0x18, 0x73, 0xEF, 0x4E, 0x60, 0x12, 0xEF, - 0x60, 0x01, 0x0E, 0xED, 0xBB, 0x01, 0x0B, 0x89, 0x82, 0x8A, 0x83, 0xF0, 0xA3, 0xDF, 0xFC, 0xDE, - 0xFA, 0x22, 0x89, 0xF0, 0x50, 0x07, 0xF7, 0x09, 0xDF, 0xFC, 0xA9, 0xF0, 0x22, 0xBB, 0xFE, 0xFC, - 0xF3, 0x09, 0xDF, 0xFC, 0xA9, 0xF0, 0x22, 0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x46, 0x7B, 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, 0x49, 0xB8, 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, 0x49, 0xB8, 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, 0x46, 0xC4, 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, 0x46, 0xC3, 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, 0x46, 0xC4, - 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, 0xC2, 0xAF, 0x56, 0xC6, 0xD2, 0xAF, 0xD2, 0xA9, 0x54, - 0x80, 0x4F, 0xFF, 0x22, 0x02, 0x49, 0x62, 0x02, 0x47, 0x54, 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, 0x49, 0xA7, 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, 0x84, 0x87, 0x00, 0x41, 0x84, 0x88, 0x00, 0x41, - 0x84, 0x97, 0x00, 0x41, 0x84, 0x98, 0x00, 0x00, 0x60, 0x03, 0x67, 0xF5, 0x6F, 0x96, 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, 0xBE, - 0xF0, 0x74, 0x49, 0xA3, 0xF0, 0x51, 0x0D, 0x74, 0xBE, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x49, - 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, 0x54, - 0xE0, 0x55, 0x35, 0xF5, 0x39, 0xA3, 0xE0, 0x55, 0x36, 0xF5, 0x3A, 0xA3, 0xE0, 0x55, 0x37, 0xF5, - 0x3B, 0xA3, 0xE0, 0x55, 0x38, 0xF5, 0x3C, 0xAD, 0x39, 0x7F, 0x54, 0x12, 0x32, 0x1E, 0xAD, 0x3A, - 0x7F, 0x55, 0x12, 0x32, 0x1E, 0xAD, 0x3B, 0x7F, 0x56, 0x12, 0x32, 0x1E, 0xAD, 0x3C, 0x7F, 0x57, - 0x12, 0x32, 0x1E, 0x53, 0x91, 0xEF, 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, 0x47, 0xF0, 0x74, 0x4A, 0xA3, 0xF0, 0x12, 0x85, - 0x8E, 0xE5, 0x41, 0x30, 0xE3, 0x03, 0x12, 0x81, 0x60, 0xE5, 0x41, 0x30, 0xE4, 0x03, 0x12, 0x81, - 0x43, 0xE5, 0x43, 0x30, 0xE0, 0x02, 0x51, 0xE4, 0xE5, 0x43, 0x30, 0xE1, 0x03, 0x12, 0x52, 0xB6, - 0xE5, 0x43, 0x30, 0xE2, 0x03, 0x12, 0x86, 0x27, 0xE5, 0x43, 0x30, 0xE3, 0x02, 0xF1, 0x65, 0xE5, - 0x43, 0x30, 0xE4, 0x02, 0xF1, 0x79, 0xE5, 0x43, 0x30, 0xE5, 0x03, 0x12, 0x79, 0x15, 0xE5, 0x43, - 0x30, 0xE6, 0x03, 0x12, 0x86, 0x3F, 0xE5, 0x44, 0x30, 0xE1, 0x03, 0x12, 0x86, 0x59, 0x74, 0x47, - 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x4A, 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, 0xF5, 0x4E, 0x90, 0x81, 0x4B, 0xE0, 0x70, 0x02, 0x61, 0x9A, 0xF1, - 0x34, 0x60, 0x02, 0x61, 0x9A, 0x12, 0x55, 0xF2, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, - 0x12, 0x53, 0xCB, 0x78, 0x10, 0x12, 0x20, 0xBB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, - 0x12, 0x44, 0x27, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x12, 0x53, 0xCE, 0x78, - 0x18, 0x12, 0x20, 0xBB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x94, 0xC1, 0x44, - 0x80, 0xF0, 0x12, 0x95, 0x26, 0x60, 0x22, 0x24, 0xFE, 0x60, 0x03, 0x04, 0x70, 0x1E, 0x90, 0x81, - 0x52, 0xE0, 0x14, 0xF0, 0xE0, 0xFF, 0x60, 0x06, 0x90, 0x81, 0x54, 0xE0, 0x60, 0x0E, 0xEF, 0x70, - 0x08, 0x90, 0x81, 0x51, 0xE0, 0xA3, 0xF0, 0x80, 0x00, 0x75, 0x4E, 0x01, 0xE5, 0x4E, 0x60, 0x3A, - 0x12, 0x95, 0x2E, 0x90, 0x81, 0x54, 0xE0, 0x60, 0x04, 0x64, 0x01, 0x70, 0x10, 0xE4, 0xF5, 0x1D, - 0x90, 0x81, 0x54, 0xE0, 0x12, 0x77, 0xF4, 0x90, 0x81, 0x54, 0xE0, 0x80, 0x0C, 0xE4, 0xF5, 0x1D, - 0x12, 0x94, 0xB6, 0x12, 0x77, 0xF4, 0x12, 0x94, 0xB6, 0x12, 0x94, 0xEE, 0xF0, 0x90, 0x81, 0x4E, - 0xE0, 0x20, 0xE2, 0x06, 0x7D, 0x01, 0x7F, 0x04, 0x71, 0x9F, 0x22, 0xE4, 0xFD, 0x7F, 0x0C, 0xD3, - 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x84, 0x94, 0xED, 0xF0, 0x90, 0x81, 0x46, 0xE0, 0xFE, - 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0x81, 0xEA, 0xEE, 0x12, 0x86, 0xF0, 0x30, 0xE0, - 0x02, 0x81, 0xEA, 0x90, 0x81, 0x4E, 0xE0, 0xFE, 0x6F, 0x70, 0x02, 0x81, 0xEA, 0xEF, 0x70, 0x02, - 0x81, 0x5C, 0x24, 0xFE, 0x70, 0x02, 0x81, 0x95, 0x24, 0xFE, 0x60, 0x48, 0x24, 0xFC, 0x70, 0x02, - 0x81, 0xCF, 0x24, 0xFC, 0x60, 0x02, 0x81, 0xE0, 0xEE, 0xB4, 0x0E, 0x02, 0xB1, 0x3B, 0x90, 0x81, - 0x4E, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0xB1, 0x7A, 0x90, 0x81, 0x4E, 0xE0, 0xB4, 0x06, 0x02, 0xB1, - 0x59, 0x90, 0x81, 0x4E, 0xE0, 0xB4, 0x04, 0x0E, 0x90, 0x84, 0x94, 0xE0, 0xFF, 0x60, 0x04, 0xF1, - 0x01, 0x80, 0x03, 0x12, 0x55, 0xB4, 0x90, 0x81, 0x4E, 0xE0, 0x64, 0x08, 0x60, 0x02, 0x81, 0xE0, - 0xF1, 0xC0, 0x81, 0xE0, 0x90, 0x81, 0x4E, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0xB1, 0x7A, 0x90, 0x81, - 0x4E, 0xE0, 0xB4, 0x06, 0x02, 0xB1, 0x59, 0x90, 0x81, 0x4E, 0xE0, 0xB4, 0x0E, 0x07, 0x91, 0xEF, - 0xBF, 0x01, 0x02, 0xB1, 0x3B, 0x90, 0x81, 0x4E, 0xE0, 0x64, 0x0C, 0x60, 0x02, 0x81, 0xE0, 0x91, - 0xEF, 0xEF, 0x64, 0x01, 0x60, 0x02, 0x81, 0xE0, 0xB1, 0x90, 0x81, 0xE0, 0x90, 0x81, 0x4E, 0xE0, - 0xB4, 0x0E, 0x07, 0x91, 0xEF, 0xBF, 0x01, 0x02, 0xB1, 0x3B, 0x90, 0x81, 0x4E, 0xE0, 0xB4, 0x06, - 0x02, 0xB1, 0x59, 0x90, 0x81, 0x4E, 0xE0, 0xB4, 0x0C, 0x07, 0x91, 0xEF, 0xBF, 0x01, 0x02, 0xB1, - 0x90, 0x90, 0x81, 0x4E, 0xE0, 0x64, 0x04, 0x70, 0x57, 0x12, 0x89, 0x15, 0xEF, 0x64, 0x01, 0x70, - 0x4F, 0xD1, 0xE8, 0x80, 0x4B, 0x90, 0x81, 0x4E, 0xE0, 0xB4, 0x0E, 0x07, 0x91, 0xEF, 0xBF, 0x01, - 0x02, 0xB1, 0x3B, 0x90, 0x81, 0x4E, 0xE0, 0xB4, 0x06, 0x02, 0xB1, 0x59, 0x90, 0x81, 0x4E, 0xE0, - 0xB4, 0x0C, 0x07, 0x91, 0xEF, 0xBF, 0x01, 0x02, 0xB1, 0x90, 0x90, 0x81, 0x4E, 0xE0, 0x70, 0x04, - 0x7F, 0x01, 0xB1, 0x7A, 0x90, 0x81, 0x4E, 0xE0, 0xB4, 0x04, 0x15, 0xF1, 0xDE, 0x80, 0x11, 0x90, - 0x81, 0x4E, 0xE0, 0xB4, 0x0C, 0x0A, 0x12, 0x52, 0x37, 0x54, 0x3F, 0x30, 0xE0, 0x02, 0xF1, 0xD3, - 0x90, 0x81, 0x4E, 0x12, 0x94, 0xF8, 0x90, 0x01, 0xBB, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, - 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x88, 0xFC, 0xEF, 0x64, 0x01, 0x60, 0x05, 0x75, 0x1F, - 0x01, 0x80, 0x25, 0x90, 0x81, 0x46, 0x12, 0x79, 0x53, 0x30, 0xE0, 0x05, 0x75, 0x1F, 0x02, 0x80, - 0x17, 0x90, 0x81, 0x4D, 0xE0, 0xD3, 0x94, 0x04, 0x40, 0x05, 0x75, 0x1F, 0x08, 0x80, 0x09, 0x90, - 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x80, 0x0E, 0x90, 0x01, 0xB9, 0x74, 0x02, 0xF0, 0x90, 0x01, - 0xB8, 0xE5, 0x1F, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x81, 0x47, 0xE0, 0xC3, - 0x13, 0x20, 0xE0, 0x04, 0x7D, 0x0C, 0x80, 0x08, 0x12, 0x88, 0xF3, 0x44, 0x80, 0xF0, 0x7D, 0x04, - 0x7F, 0x01, 0xD1, 0x80, 0xE4, 0xFD, 0xFF, 0x80, 0x69, 0x90, 0x81, 0x47, 0xE0, 0x90, 0x06, 0x04, - 0x20, 0xE0, 0x08, 0xE0, 0x44, 0x40, 0xF0, 0x7D, 0x04, 0x80, 0x06, 0xE0, 0x54, 0x7F, 0xF0, 0x7D, - 0x0C, 0x7F, 0x01, 0xD1, 0x80, 0xE4, 0xFD, 0xFF, 0x80, 0x48, 0x90, 0x84, 0x93, 0xEF, 0xF0, 0x12, - 0x71, 0x62, 0x90, 0x84, 0x93, 0xE0, 0x60, 0x02, 0xF1, 0xEB, 0x7D, 0x04, 0x7F, 0x01, 0xC1, 0x80, - 0xF1, 0x34, 0x70, 0x27, 0x90, 0x81, 0x47, 0xE0, 0x54, 0xFD, 0xF0, 0x7D, 0x2C, 0x7F, 0x6F, 0xB1, - 0xC2, 0x7D, 0x08, 0x7F, 0x01, 0xD1, 0x2F, 0xBF, 0x01, 0x0D, 0x90, 0x81, 0x46, 0xE0, 0x44, 0x80, - 0xF0, 0x7D, 0x0E, 0x7F, 0x01, 0xC1, 0x80, 0xF1, 0xF9, 0x04, 0xF0, 0x22, 0x12, 0x71, 0x62, 0xE4, - 0xFD, 0xFF, 0x90, 0x05, 0x22, 0xEF, 0xF0, 0x90, 0x80, 0x05, 0xED, 0xF0, 0x22, 0x7F, 0xFF, 0xB1, - 0xC2, 0xE4, 0x90, 0x84, 0x81, 0xF0, 0xA3, 0xF0, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x84, 0x83, 0xF0, - 0x7D, 0x47, 0x7F, 0xFF, 0xB1, 0xC2, 0x90, 0x05, 0xF8, 0xE0, 0x70, 0x13, 0xA3, 0xE0, 0x70, 0x0F, - 0xA3, 0xE0, 0x70, 0x0B, 0xA3, 0xE0, 0x70, 0x07, 0xF1, 0xF0, 0xB1, 0xC2, 0x7F, 0x01, 0x22, 0xD3, - 0x90, 0x84, 0x82, 0xE0, 0x94, 0xE8, 0x90, 0x84, 0x81, 0xE0, 0x94, 0x03, 0x40, 0x0E, 0x90, 0x01, - 0xC0, 0xE0, 0x44, 0x20, 0xF0, 0xF1, 0xF0, 0xB1, 0xC2, 0x7F, 0x00, 0x22, 0x7F, 0x32, 0x7E, 0x00, - 0x12, 0x32, 0xAA, 0x90, 0x84, 0x81, 0x12, 0x69, 0x1F, 0x80, 0xBB, 0x7D, 0x08, 0xE4, 0xFF, 0xD3, - 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x84, 0x68, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x80, - 0x03, 0xE0, 0x04, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x22, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x84, - 0x6C, 0xF0, 0x7D, 0x26, 0xB1, 0xCD, 0xEF, 0x64, 0x01, 0x70, 0x03, 0x12, 0x8A, 0x3F, 0x90, 0x84, - 0x6C, 0xE0, 0xFF, 0x7D, 0x27, 0xB1, 0xC2, 0x12, 0x88, 0x89, 0x80, 0x06, 0x12, 0x88, 0x89, 0x12, - 0x8A, 0x3F, 0x12, 0x5B, 0x22, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7D, 0x0C, 0x7F, 0x01, - 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAC, 0x07, 0xEF, 0x14, 0x60, 0x15, 0x14, 0x60, 0x19, - 0x24, 0x02, 0x70, 0x1A, 0xED, 0x54, 0x01, 0xFE, 0x90, 0x81, 0x46, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, - 0x80, 0x0C, 0x90, 0x81, 0x4E, 0xED, 0xF0, 0x80, 0x05, 0x90, 0x81, 0x4D, 0xED, 0xF0, 0x90, 0x00, - 0x8F, 0xE0, 0x30, 0xE4, 0x2E, 0xEC, 0x14, 0x60, 0x07, 0x14, 0x60, 0x1D, 0x24, 0x02, 0x70, 0x23, - 0x90, 0x81, 0x46, 0xE0, 0x54, 0x01, 0xC4, 0x33, 0x33, 0x33, 0x54, 0x80, 0xFF, 0x90, 0x81, 0x4E, - 0xE0, 0x54, 0x7F, 0x4F, 0xFD, 0x7F, 0x88, 0x80, 0x07, 0x90, 0x81, 0x4D, 0xE0, 0xFD, 0x7F, 0x89, - 0x12, 0x32, 0x1E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7D, 0x2D, 0xB1, 0xCD, 0x90, 0x01, 0x37, 0x74, - 0x02, 0xF0, 0xFD, 0x7F, 0x03, 0x12, 0x50, 0xB9, 0x12, 0x71, 0xCC, 0xE4, 0xFD, 0x7F, 0x01, 0xC1, - 0x80, 0xEF, 0x60, 0x2F, 0xF1, 0x34, 0x70, 0x2B, 0x90, 0x81, 0x47, 0xE0, 0x54, 0xFE, 0xF0, 0x7D, - 0x2B, 0x7F, 0x0F, 0xB1, 0xC2, 0x90, 0x06, 0x04, 0xE0, 0x54, 0xBF, 0xF0, 0xD1, 0x2B, 0xBF, 0x01, - 0x0D, 0x90, 0x81, 0x46, 0xE0, 0x44, 0x40, 0xF0, 0x7D, 0x06, 0x7F, 0x01, 0xC1, 0x80, 0xF1, 0xF9, - 0x74, 0x08, 0xF0, 0x22, 0xE4, 0xFF, 0xF1, 0x3C, 0xEF, 0x64, 0x01, 0x22, 0x12, 0x92, 0x8D, 0xFE, - 0xEF, 0x54, 0x07, 0xFF, 0x12, 0x60, 0xCF, 0xE0, 0xFD, 0x7C, 0x00, 0x12, 0x81, 0x58, 0x80, 0x05, - 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5C, 0xFE, 0xEF, 0x5D, 0x4E, 0x7F, 0x00, - 0x60, 0x02, 0x7F, 0x01, 0x22, 0xF1, 0x34, 0x70, 0x0F, 0x90, 0x81, 0x4B, 0xE0, 0x60, 0x09, 0x12, - 0x94, 0xAA, 0x12, 0x7F, 0xCD, 0x12, 0x77, 0xFA, 0x22, 0xF1, 0x34, 0x70, 0x17, 0x90, 0x81, 0x4B, - 0xE0, 0x60, 0x11, 0x12, 0x94, 0xAA, 0x90, 0x81, 0x46, 0xE0, 0x12, 0x94, 0xCF, 0x54, 0x07, 0x70, - 0x03, 0x12, 0x57, 0xE2, 0x22, 0xF1, 0xB4, 0x54, 0x3F, 0xF0, 0xEF, 0x60, 0x0B, 0xF1, 0xC8, 0xE0, - 0x44, 0x10, 0xF1, 0xB3, 0x44, 0x80, 0xF0, 0x22, 0xF1, 0xC8, 0xE0, 0x54, 0xEF, 0xF1, 0xB3, 0x44, - 0x40, 0xF0, 0x22, 0xF0, 0x74, 0x1F, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, - 0xB1, 0xBC, 0x7D, 0x0C, 0x7F, 0x01, 0xC1, 0x80, 0x74, 0x21, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, - 0xF5, 0x83, 0x22, 0x7D, 0x2F, 0x12, 0x71, 0xC7, 0x7D, 0x08, 0x7F, 0x01, 0xC1, 0x80, 0x7D, 0x2E, - 0x7F, 0x6F, 0xB1, 0xC2, 0x7D, 0x02, 0x7F, 0x01, 0xC1, 0x80, 0xF0, 0xE4, 0xFD, 0xFF, 0xA1, 0xC2, - 0x90, 0x84, 0x83, 0xE0, 0xFF, 0x7D, 0x48, 0x22, 0xF0, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, - 0x01, 0xB8, 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, 0x03, 0xF0, 0x74, 0x50, 0xA3, 0xF0, 0x12, 0x85, 0xBB, 0xE5, 0x49, 0x30, - 0xE1, 0x02, 0x11, 0x89, 0xE5, 0x49, 0x30, 0xE2, 0x02, 0x11, 0x9A, 0xE5, 0x4A, 0x30, 0xE0, 0x02, - 0xF1, 0x69, 0xE5, 0x4C, 0x30, 0xE1, 0x05, 0x7F, 0x04, 0x12, 0x81, 0x47, 0xE5, 0x4C, 0x30, 0xE4, - 0x02, 0x11, 0x92, 0xE5, 0x4C, 0x30, 0xE5, 0x03, 0x12, 0x86, 0x86, 0xE5, 0x4C, 0x30, 0xE6, 0x03, - 0x12, 0x86, 0xBE, 0x74, 0x03, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x50, 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, 0x81, 0x4B, 0xE0, 0x60, 0x02, 0x51, - 0x3F, 0x22, 0x71, 0xD5, 0x7D, 0x02, 0x7F, 0x02, 0x80, 0x1F, 0x90, 0x81, 0x4B, 0xE0, 0x60, 0x0E, - 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, 0x03, 0x02, 0x78, 0x6D, 0xF1, 0xB2, 0xF1, 0xE2, 0x22, 0x7D, - 0x01, 0x7F, 0x02, 0x11, 0xB9, 0x7D, 0x02, 0x7F, 0x02, 0x74, 0x3D, 0x2F, 0xF8, 0xE6, 0x4D, 0xFE, - 0xF6, 0x74, 0x30, 0x80, 0x25, 0x90, 0x81, 0x46, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0x81, 0x54, - 0xF0, 0xA3, 0xF0, 0x90, 0x81, 0x4F, 0xF0, 0x90, 0x81, 0x47, 0xB1, 0xAC, 0x11, 0xAF, 0x7D, 0x10, - 0x7F, 0x03, 0x74, 0x45, 0xF1, 0xD2, 0xFE, 0xF6, 0x74, 0x38, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, - 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x90, 0x05, 0x62, 0xE0, 0xFE, 0x90, 0x05, 0x61, 0xE0, 0xFD, 0xED, - 0x78, 0x02, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x12, 0x95, 0x0B, 0x12, 0x4F, 0x34, - 0x60, 0x02, 0x21, 0xBF, 0x90, 0x81, 0x4B, 0xE0, 0x70, 0x02, 0x21, 0xBF, 0x71, 0xC2, 0x64, 0x01, - 0x70, 0x22, 0x90, 0x06, 0xAB, 0xE0, 0x90, 0x81, 0x52, 0xF0, 0x90, 0x06, 0xAA, 0xE0, 0x90, 0x81, - 0x51, 0xF0, 0xA3, 0xE0, 0xFF, 0x70, 0x08, 0x90, 0x81, 0x51, 0xE0, 0xFE, 0xFF, 0x80, 0x00, 0x90, - 0x81, 0x52, 0xEF, 0xF0, 0x91, 0x4B, 0xE4, 0x90, 0x81, 0x54, 0xF1, 0x4D, 0x12, 0x94, 0xAA, 0x12, - 0x94, 0xD2, 0x54, 0xEF, 0xF0, 0x71, 0xC2, 0x24, 0xFD, 0x50, 0x02, 0x80, 0x03, 0x12, 0x78, 0xA4, - 0x51, 0x37, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x55, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, - 0x24, 0x71, 0xAA, 0x6F, 0x70, 0x47, 0x90, 0x81, 0x47, 0xE0, 0x44, 0x40, 0xF0, 0xF1, 0xCA, 0x71, - 0xB9, 0x7F, 0x03, 0xF1, 0xDA, 0x7D, 0x01, 0x71, 0xB2, 0x7F, 0x02, 0x31, 0xC0, 0x90, 0x81, 0x52, - 0xE0, 0x14, 0xF0, 0x80, 0x28, 0x12, 0x95, 0x26, 0x64, 0x01, 0x70, 0x21, 0x71, 0xAA, 0xFE, 0x6F, - 0x60, 0x1B, 0x90, 0x05, 0x73, 0xE0, 0xFF, 0xEE, 0x6F, 0x60, 0x12, 0x51, 0x37, 0x54, 0x3F, 0x30, - 0xE0, 0x0B, 0xEF, 0x54, 0xBF, 0x71, 0xB9, 0x7F, 0x03, 0x11, 0xE2, 0x11, 0xAF, 0xF1, 0xC2, 0x22, - 0x74, 0x3D, 0xF1, 0xD2, 0xFE, 0xF6, 0x74, 0x30, 0x01, 0xEA, 0xEF, 0x70, 0x31, 0x7D, 0x78, 0x71, - 0xB2, 0x7F, 0x03, 0x31, 0xC0, 0x7D, 0xC8, 0x7F, 0x02, 0x11, 0xE2, 0x12, 0x94, 0xAA, 0xE4, 0xFF, - 0x12, 0x4F, 0x3C, 0xEF, 0x70, 0x07, 0xB1, 0xA4, 0x54, 0x7F, 0xF0, 0x80, 0x07, 0x7D, 0x01, 0x7F, - 0x0C, 0x12, 0x4B, 0x9F, 0xF1, 0xB2, 0x90, 0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x22, 0x90, 0x01, - 0x36, 0x74, 0x78, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x7D, 0x78, 0xFF, 0x11, 0xB9, 0x7D, 0x02, 0x7F, - 0x03, 0x11, 0xB9, 0x90, 0x06, 0x0A, 0xE0, 0x44, 0x07, 0xF1, 0x4D, 0xE4, 0xFF, 0x12, 0x4F, 0x3C, - 0xBF, 0x01, 0x11, 0x51, 0xAF, 0xF0, 0x90, 0x81, 0x4E, 0xE0, 0x20, 0xE2, 0x09, 0x7D, 0x01, 0x7F, - 0x04, 0x02, 0x4B, 0x9F, 0xF1, 0xC2, 0x22, 0x90, 0x81, 0x47, 0xE0, 0xFF, 0x13, 0x13, 0x22, 0x51, - 0x37, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x0F, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x06, - 0x7D, 0x02, 0x7F, 0x02, 0x31, 0xC0, 0x90, 0x81, 0x46, 0xF1, 0xEC, 0x30, 0xE0, 0x0A, 0xEF, 0x12, - 0x94, 0xCF, 0x54, 0x07, 0x70, 0x48, 0x80, 0x44, 0x90, 0x81, 0x54, 0xE0, 0x04, 0xF0, 0x90, 0x81, - 0x4F, 0xE0, 0x54, 0xEF, 0xF0, 0xF1, 0xF3, 0xD3, 0x9F, 0x40, 0x31, 0x12, 0x4F, 0x34, 0x70, 0x2E, - 0x12, 0x67, 0x5A, 0x70, 0x06, 0xF1, 0x0B, 0x51, 0xAF, 0xF0, 0x22, 0xF1, 0x0B, 0x90, 0x81, 0x55, - 0xE0, 0x04, 0xF0, 0xE0, 0xD3, 0x94, 0x02, 0x40, 0x0A, 0x51, 0xAF, 0xF0, 0xE4, 0x90, 0x81, 0x55, - 0xF0, 0x80, 0x03, 0x12, 0x79, 0x01, 0xE4, 0x90, 0x81, 0x54, 0xF0, 0x22, 0xF1, 0xE2, 0x22, 0x90, - 0x81, 0x47, 0xE0, 0x54, 0xFB, 0x22, 0x90, 0x81, 0x4B, 0xE0, 0x70, 0x02, 0x61, 0x43, 0x90, 0x81, - 0x62, 0xE0, 0x04, 0xB1, 0xF1, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x71, 0xCB, 0x78, - 0x10, 0x12, 0x20, 0xBB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x44, 0x27, 0xC0, - 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x71, 0xCE, 0x78, 0x18, 0x12, 0x20, 0xBB, 0xD0, - 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x44, 0x27, 0x90, 0x81, 0x96, 0x12, 0x94, 0xC7, - 0x54, 0x7F, 0xF0, 0xA3, 0xE0, 0x30, 0xE0, 0x09, 0xF1, 0x58, 0x74, 0x05, 0xF0, 0xD1, 0x44, 0xF1, - 0xBA, 0x51, 0x37, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x13, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x0C, - 0x7D, 0x02, 0x7F, 0x02, 0x31, 0xC0, 0x7D, 0x01, 0x7F, 0x02, 0x31, 0xC0, 0x90, 0x84, 0x91, 0xE0, - 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x80, 0x40, 0x0B, 0x90, 0x01, 0x98, 0xE0, 0x54, 0xFE, 0xF0, 0xE0, - 0x44, 0x01, 0xF0, 0x12, 0x92, 0x08, 0x12, 0x8C, 0x07, 0xE4, 0x90, 0x83, 0xFA, 0xF0, 0x12, 0x8F, - 0x7F, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x52, 0x90, 0x83, 0x8E, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x7C, - 0x00, 0x7D, 0x64, 0x12, 0x20, 0x30, 0x90, 0x83, 0xE2, 0xE0, 0x6E, 0x70, 0x03, 0xA3, 0xE0, 0x6F, - 0x60, 0x0A, 0x90, 0x83, 0xE2, 0xE4, 0x75, 0xF0, 0x01, 0x02, 0x43, 0xF6, 0x90, 0x83, 0x92, 0xE0, - 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x83, 0xA0, 0xE0, 0xB5, 0x06, 0x14, 0xA3, 0xE0, 0xB5, 0x07, 0x0F, - 0xEF, 0x4E, 0x60, 0x0B, 0x90, 0x01, 0xC7, 0x74, 0x31, 0xF0, 0x7F, 0x01, 0x02, 0x75, 0xAD, 0x12, - 0x5E, 0xA9, 0xE4, 0x90, 0x83, 0xE2, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x81, 0x51, 0xE0, 0xFF, 0xA3, - 0xE0, 0x22, 0x7F, 0x02, 0x31, 0xC0, 0x7D, 0x02, 0x22, 0xF0, 0x90, 0x01, 0x3F, 0x74, 0x10, 0xF0, - 0xFD, 0x22, 0x90, 0x81, 0x49, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x22, 0x90, 0x05, 0x62, 0xE0, 0xFF, - 0xE4, 0xFC, 0xFD, 0xFE, 0x22, 0xE4, 0x90, 0x89, 0x05, 0xF0, 0x90, 0x81, 0x4B, 0xE0, 0x60, 0x6A, - 0x12, 0x4F, 0x34, 0x70, 0x65, 0xF1, 0xCA, 0xB1, 0xF1, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, - 0x07, 0x71, 0xCB, 0x78, 0x10, 0x12, 0x20, 0xBB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, - 0x12, 0x44, 0x27, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x71, 0xCE, 0x78, 0x18, - 0x12, 0x20, 0xBB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x94, 0xC1, 0x44, 0x80, - 0xF0, 0x90, 0x89, 0x05, 0x74, 0x01, 0xF0, 0xE4, 0x90, 0x81, 0x52, 0xF0, 0x04, 0x60, 0x1B, 0x12, - 0x95, 0x2E, 0xE4, 0xF5, 0x1D, 0x90, 0x81, 0x53, 0xE0, 0x12, 0x77, 0xFA, 0x90, 0x81, 0x4E, 0xE0, - 0x20, 0xE2, 0x07, 0x7D, 0x01, 0x7F, 0x04, 0x12, 0x4B, 0x9F, 0x22, 0xB1, 0xF2, 0xC0, 0x04, 0xC0, - 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x71, 0xCB, 0x78, 0x10, 0x12, 0x20, 0xBB, 0xD0, 0x03, 0xD0, 0x02, - 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x44, 0x27, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, - 0x71, 0xCE, 0x78, 0x18, 0x12, 0x20, 0xBB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, - 0x44, 0x27, 0x90, 0x81, 0x9A, 0x12, 0x20, 0xCE, 0x90, 0x81, 0x9E, 0x12, 0x44, 0x45, 0x90, 0x81, - 0x9A, 0x12, 0x44, 0x51, 0xC3, 0x12, 0x44, 0x34, 0x40, 0x40, 0x90, 0x81, 0x46, 0xE0, 0x90, 0x81, - 0x9E, 0x30, 0xE0, 0x0F, 0xB1, 0xD4, 0x90, 0x81, 0x68, 0xE0, 0x24, 0x04, 0x2F, 0xFF, 0x90, 0x81, - 0xA2, 0x80, 0x05, 0xB1, 0xD4, 0x90, 0x81, 0xA3, 0xE0, 0xFE, 0xC3, 0xEF, 0x9E, 0x90, 0x89, 0x02, - 0xF0, 0x90, 0x89, 0x02, 0xE0, 0xFF, 0xC3, 0x94, 0x2D, 0x50, 0x0F, 0x74, 0x69, 0x2F, 0x12, 0x88, - 0xEB, 0xE0, 0x04, 0xF0, 0x90, 0x81, 0x61, 0xE0, 0x04, 0xF0, 0x90, 0x81, 0x61, 0xE0, 0xFF, 0xD3, - 0x90, 0x81, 0xA5, 0xE0, 0x9F, 0x90, 0x81, 0xA4, 0xE0, 0x94, 0x00, 0x40, 0x02, 0xA1, 0x9B, 0xE4, - 0xFF, 0xFE, 0xB1, 0xC1, 0xEF, 0xD3, 0x9D, 0x40, 0x07, 0x90, 0x89, 0x03, 0xEE, 0xF0, 0x80, 0x05, - 0x0E, 0xEE, 0xB4, 0x2D, 0xED, 0xE4, 0xFF, 0xFE, 0xB1, 0xC1, 0xC3, 0x90, 0x81, 0xA5, 0xE0, 0x9D, - 0xFD, 0x90, 0x81, 0xA4, 0xE0, 0x94, 0x00, 0xFC, 0xEF, 0xD3, 0x9D, 0xE4, 0x9C, 0x40, 0x07, 0x90, - 0x89, 0x04, 0xEE, 0xF0, 0x80, 0x05, 0x0E, 0xEE, 0xB4, 0x2D, 0xDD, 0x90, 0x89, 0x03, 0xE0, 0x90, - 0x81, 0x66, 0xF0, 0x90, 0x89, 0x04, 0xE0, 0x90, 0x81, 0x67, 0xB1, 0x9C, 0x94, 0x0A, 0x40, 0x0A, - 0xEF, 0x24, 0xF6, 0x90, 0x81, 0x5E, 0xF0, 0xE4, 0x80, 0x09, 0xE4, 0x90, 0x81, 0x5E, 0xB1, 0x9C, - 0x74, 0x0A, 0x9F, 0x90, 0x81, 0x5D, 0xF0, 0x90, 0x81, 0x66, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, - 0x90, 0x81, 0x64, 0xF0, 0x90, 0x81, 0x46, 0xE0, 0x30, 0xE0, 0x05, 0x90, 0x81, 0xA2, 0x80, 0x03, - 0x90, 0x81, 0xA3, 0xE0, 0x04, 0xFF, 0x90, 0x81, 0x64, 0xE0, 0x2F, 0xF0, 0x90, 0x81, 0x64, 0xE0, - 0xC3, 0x94, 0x0A, 0x50, 0x03, 0x74, 0x0A, 0xF0, 0x90, 0x81, 0x64, 0xE0, 0x24, 0x02, 0xF0, 0xF1, - 0x58, 0x74, 0x03, 0xF0, 0xD1, 0x44, 0xE4, 0xFF, 0x12, 0x88, 0x5B, 0x22, 0xF0, 0x90, 0x81, 0x66, - 0xE0, 0xFF, 0xC3, 0x22, 0x12, 0x71, 0x62, 0xB1, 0xB4, 0x90, 0x81, 0x46, 0xE0, 0x54, 0xF7, 0xF0, - 0x54, 0xBF, 0xF0, 0x22, 0x12, 0x88, 0x82, 0x12, 0x4F, 0xEA, 0x7D, 0x0C, 0x7F, 0x01, 0x02, 0x4E, - 0x80, 0x74, 0x69, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0xE0, 0x2F, 0xFF, 0x90, 0x81, - 0xA6, 0xE0, 0xFD, 0x22, 0x12, 0x44, 0x51, 0x90, 0x81, 0x9A, 0x12, 0x44, 0x45, 0x12, 0x44, 0x19, - 0x78, 0x0A, 0x12, 0x20, 0xA8, 0x90, 0x81, 0x63, 0xE0, 0xFE, 0xC3, 0x74, 0x0A, 0x9E, 0x2F, 0xFF, - 0x22, 0xF0, 0x90, 0x05, 0x61, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x78, 0x08, 0x12, 0x20, 0xBB, - 0xA8, 0x04, 0xA9, 0x05, 0xAA, 0x06, 0xAB, 0x07, 0x90, 0x05, 0x60, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, - 0xFE, 0x02, 0x44, 0x27, 0x90, 0x89, 0x17, 0x12, 0x44, 0x72, 0x11, 0xC5, 0x90, 0x81, 0x4B, 0xE0, - 0xFF, 0x31, 0xCA, 0x90, 0x81, 0x4B, 0xE0, 0x60, 0x1A, 0x90, 0x89, 0x17, 0x12, 0x44, 0x69, 0x12, - 0x5F, 0xE8, 0x54, 0x0F, 0xFF, 0x12, 0x62, 0x87, 0xFD, 0x12, 0x89, 0x91, 0xF1, 0x58, 0x74, 0x01, - 0xF0, 0xD1, 0x44, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAC, 0x07, 0x90, 0x81, 0x47, - 0x12, 0x86, 0xEF, 0x30, 0xE0, 0x02, 0xC1, 0xFF, 0x90, 0x81, 0x46, 0xE0, 0x30, 0xE0, 0x16, 0x90, - 0x81, 0x68, 0xE0, 0x24, 0x04, 0x90, 0x81, 0x60, 0xF0, 0x90, 0x81, 0x68, 0xE0, 0x24, 0x03, 0x90, - 0x81, 0x5F, 0xF0, 0x80, 0x0D, 0x90, 0x81, 0x60, 0x74, 0x02, 0xF0, 0x90, 0x81, 0x5F, 0x14, 0xF0, - 0x0B, 0x0B, 0x90, 0x81, 0x5F, 0xE0, 0xFA, 0x90, 0x81, 0x5E, 0xE0, 0xD3, 0x9A, 0x50, 0x0E, 0x90, - 0x81, 0x53, 0xEB, 0xF0, 0x90, 0x81, 0x60, 0xE0, 0xC3, 0x9D, 0x2C, 0x80, 0x11, 0xC3, 0xED, 0x9A, - 0x2B, 0x90, 0x81, 0x53, 0xF0, 0x90, 0x81, 0x5F, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, 0x81, - 0x63, 0xF0, 0x90, 0x81, 0x60, 0xE0, 0xFF, 0x24, 0x0A, 0xFD, 0xE4, 0x33, 0xFC, 0x90, 0x81, 0x63, - 0xF1, 0x43, 0x98, 0x40, 0x04, 0xEF, 0x24, 0x0A, 0xF0, 0x90, 0x81, 0x63, 0xE0, 0xFF, 0x24, 0x23, - 0xFD, 0xE4, 0x33, 0xFC, 0x90, 0x81, 0x53, 0xF1, 0x43, 0x98, 0x40, 0x04, 0xEF, 0x24, 0x23, 0xF0, - 0x90, 0x81, 0x63, 0xE0, 0xFF, 0x7E, 0x00, 0x90, 0x81, 0x57, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, - 0x05, 0x58, 0xE0, 0x6F, 0x70, 0x01, 0xE4, 0x60, 0x02, 0xF1, 0x4E, 0xF1, 0xBA, 0x80, 0x07, 0x90, - 0x81, 0x48, 0xE0, 0x44, 0x01, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF1, 0xF3, 0xD3, 0x9F, 0x40, - 0x31, 0x90, 0x81, 0x65, 0xE0, 0x04, 0xF0, 0x90, 0x81, 0xA7, 0xE0, 0xFF, 0x90, 0x81, 0x65, 0xE0, - 0xD3, 0x9F, 0x50, 0x1E, 0x90, 0x81, 0x5D, 0xE0, 0x04, 0xF0, 0x12, 0x94, 0xB6, 0x12, 0x94, 0xEE, - 0xF0, 0xFB, 0x90, 0x81, 0x5D, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x84, 0x80, 0x74, 0x04, 0xF0, - 0xD1, 0x44, 0x22, 0xE0, 0xD3, 0x9D, 0xEC, 0x64, 0x80, 0xF8, 0x74, 0x80, 0x22, 0xF0, 0x90, 0x81, - 0x57, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x22, 0x90, 0x81, 0x5D, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, - 0x90, 0x81, 0x64, 0xE0, 0xFB, 0x90, 0x84, 0x80, 0x22, 0x12, 0x87, 0x36, 0x90, 0x89, 0x05, 0xEF, - 0xF0, 0x30, 0xE0, 0x05, 0x7D, 0x01, 0xE4, 0x80, 0x02, 0xE4, 0xFD, 0xFF, 0x12, 0x4E, 0x80, 0x90, - 0x89, 0x05, 0xE0, 0x30, 0xE6, 0x11, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x04, 0xE4, 0xF0, 0x80, - 0x06, 0x90, 0x01, 0x2F, 0x74, 0x80, 0xF0, 0x90, 0x81, 0x46, 0xE0, 0x90, 0x04, 0xEC, 0x30, 0xE0, - 0x06, 0xE0, 0x54, 0xDD, 0xF0, 0x80, 0x04, 0xE0, 0x44, 0x22, 0xF0, 0xF1, 0x58, 0x74, 0x02, 0xF0, - 0xC1, 0x44, 0x90, 0x81, 0x46, 0xE0, 0x54, 0xF7, 0xF0, 0x22, 0x90, 0x81, 0x48, 0xE0, 0x54, 0xFE, - 0xF0, 0x22, 0x90, 0x81, 0x47, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x90, 0x81, 0x51, 0xE0, 0x90, 0x05, - 0x73, 0x22, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, 0x22, 0x74, 0x45, 0x2F, 0xF8, 0xE6, 0x4D, - 0x01, 0xE6, 0x90, 0x81, 0x4D, 0xE0, 0xFF, 0x7D, 0x01, 0x02, 0x4B, 0x9F, 0xE0, 0xFF, 0x13, 0x13, - 0x54, 0x3F, 0x22, 0x90, 0x81, 0xA8, 0xE0, 0xFF, 0x90, 0x81, 0x54, 0xE0, 0x22, 0xC0, 0xE0, 0xC0, - 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, 0xFD, 0x90, 0x01, - 0xC4, 0xED, 0xF0, 0x74, 0x57, 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, 0x00, - 0xF7, 0xE0, 0x20, 0xE7, 0x09, 0xE0, 0x7F, 0x01, 0x20, 0xE6, 0x0C, 0x7F, 0x02, 0x22, 0x90, 0x00, - 0xF7, 0xE0, 0x30, 0xE6, 0x02, 0x7F, 0x03, 0x22, 0x11, 0x2E, 0x90, 0x80, 0x07, 0xEF, 0xF0, 0x11, - 0x68, 0x90, 0x01, 0x64, 0x74, 0x01, 0xF0, 0x90, 0x00, 0x12, 0xE0, 0x54, 0xC7, 0x44, 0x20, 0xFD, - 0x7F, 0x12, 0x12, 0x32, 0x1E, 0x02, 0x2D, 0xA7, 0x11, 0x99, 0x12, 0x84, 0x51, 0x12, 0x84, 0x7A, - 0x12, 0x84, 0x99, 0xE4, 0xF5, 0x35, 0xF5, 0x36, 0xF5, 0x37, 0x75, 0x38, 0x80, 0xAD, 0x35, 0x7F, - 0x50, 0x12, 0x32, 0x1E, 0xAD, 0x36, 0x7F, 0x51, 0x12, 0x32, 0x1E, 0xAD, 0x37, 0x7F, 0x52, 0x12, - 0x32, 0x1E, 0xAD, 0x38, 0x7F, 0x53, 0x02, 0x32, 0x1E, 0x90, 0x01, 0x30, 0xE4, 0x11, 0xC1, 0x90, - 0x01, 0x38, 0x11, 0xC1, 0xFD, 0x7F, 0x50, 0x12, 0x32, 0x1E, 0xE4, 0xFD, 0x7F, 0x51, 0x12, 0x32, - 0x1E, 0xE4, 0xFD, 0x7F, 0x52, 0x12, 0x32, 0x1E, 0xE4, 0xFD, 0x7F, 0x53, 0x02, 0x32, 0x1E, 0xF0, - 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x12, 0x75, 0xF9, 0xE4, 0x90, 0x83, 0xF0, - 0x11, 0xC1, 0x90, 0x83, 0x8E, 0x11, 0xBF, 0xA3, 0x11, 0xBF, 0x90, 0x83, 0xA0, 0xF0, 0xA3, 0xF0, - 0x90, 0x83, 0xE2, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x89, 0x65, 0xEF, 0xF0, 0xA3, 0x12, 0x44, 0x72, - 0x90, 0x89, 0x66, 0x31, 0xA6, 0x31, 0x88, 0x24, 0x02, 0x31, 0x4A, 0x31, 0x9D, 0xE9, 0x24, 0x04, - 0x31, 0x7F, 0x24, 0x03, 0x31, 0x4A, 0x31, 0x9D, 0xE9, 0x24, 0x08, 0x31, 0x7F, 0x24, 0x04, 0x31, - 0x4A, 0x31, 0x9D, 0xE9, 0x24, 0x0C, 0x31, 0x7F, 0x24, 0x05, 0x31, 0x4A, 0x90, 0x89, 0x65, 0xE0, - 0xFE, 0x44, 0x50, 0x90, 0x89, 0x69, 0xF0, 0xA3, 0x74, 0x80, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0xA3, - 0xF0, 0xEE, 0x75, 0xF0, 0x08, 0xA4, 0x31, 0x4A, 0x90, 0x89, 0x69, 0x74, 0xFF, 0x11, 0xC1, 0x31, - 0x94, 0x04, 0x31, 0x4A, 0x90, 0x06, 0x72, 0xE4, 0xF0, 0x22, 0xFF, 0x7B, 0x01, 0x7A, 0x89, 0x79, - 0x69, 0x12, 0x1F, 0xA4, 0x90, 0x06, 0x74, 0xF1, 0xE7, 0x90, 0x06, 0x75, 0x12, 0x62, 0x86, 0x90, - 0x06, 0x76, 0x12, 0x66, 0x68, 0x90, 0x06, 0x77, 0xF0, 0x90, 0x06, 0x70, 0xEF, 0xF0, 0xA3, 0xE4, - 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x74, 0x80, 0xF0, 0x7F, 0x01, 0x7E, 0x00, 0x02, 0x32, 0xAA, 0xF9, - 0xE4, 0x3A, 0x8B, 0x13, 0xF5, 0x14, 0x89, 0x15, 0x75, 0x16, 0x04, 0x7B, 0x01, 0x7A, 0x89, 0x79, - 0x69, 0x12, 0x2B, 0xED, 0x90, 0x89, 0x65, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x22, 0x90, 0x89, 0x66, - 0x02, 0x44, 0x69, 0x90, 0x89, 0xD3, 0x12, 0x44, 0x69, 0x8B, 0x13, 0x8A, 0x14, 0x89, 0x15, 0x22, - 0x90, 0x89, 0x4F, 0x12, 0x44, 0x72, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x89, 0x60, 0xF0, 0x90, 0x04, - 0x1D, 0xE0, 0x60, 0x0C, 0x7D, 0x39, 0x12, 0x4D, 0xCD, 0xEF, 0x64, 0x01, 0x70, 0x16, 0x80, 0x00, - 0x90, 0x83, 0xE8, 0xE0, 0xFF, 0x90, 0x84, 0x74, 0x74, 0x11, 0xB1, 0xFE, 0x90, 0x89, 0x5D, 0xEE, - 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x89, 0x5D, 0xB1, 0xB7, 0x90, 0x89, 0x5F, 0xEF, 0xF0, 0x90, 0x89, - 0x5D, 0xF1, 0xC2, 0x90, 0x89, 0x5B, 0xE0, 0xFD, 0xF1, 0x2B, 0x90, 0x89, 0x5C, 0xE0, 0x60, 0x02, - 0x41, 0x89, 0x91, 0x5A, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x89, 0x52, 0x31, 0xA6, 0x75, - 0x16, 0x06, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x71, 0x29, 0xD1, 0x9F, 0xC0, 0x03, 0xC0, 0x02, - 0xC0, 0x01, 0x90, 0x89, 0x4F, 0x31, 0xA6, 0x75, 0x16, 0x10, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, - 0x71, 0x29, 0x91, 0x5D, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x89, 0x55, 0x31, 0xA6, 0x75, - 0x16, 0x10, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x71, 0x29, 0x24, 0x58, 0xF9, 0xE4, 0x34, 0xFC, - 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x89, 0x55, 0x31, 0xA6, 0x75, 0x16, - 0x10, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x71, 0x29, 0x24, 0x6A, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, - 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x89, 0x58, 0x31, 0xA6, 0x75, 0x16, 0x06, - 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x12, 0x2B, 0xED, 0x90, 0x89, 0x55, 0x12, 0x44, 0x69, 0x90, - 0x89, 0x8C, 0x12, 0x44, 0x72, 0x90, 0x89, 0x8F, 0x12, 0x20, 0xDA, 0x00, 0x00, 0x00, 0x20, 0x90, - 0x89, 0x93, 0x74, 0x3A, 0xF0, 0x90, 0x89, 0x4F, 0x12, 0x44, 0x69, 0x12, 0x91, 0x7B, 0x71, 0x2C, - 0x24, 0x28, 0xF9, 0xE4, 0x34, 0xFC, 0x91, 0xDA, 0x75, 0x16, 0x28, 0x7B, 0x01, 0x7A, 0x89, 0x79, - 0x61, 0x71, 0x29, 0x12, 0x94, 0xDA, 0xC0, 0x03, 0x8B, 0x13, 0x75, 0x14, 0x82, 0x75, 0x15, 0x58, - 0x75, 0x16, 0x28, 0xD0, 0x03, 0x12, 0x2B, 0xED, 0x90, 0x89, 0x5F, 0xE0, 0xFF, 0x90, 0x89, 0x5E, - 0xE0, 0x2F, 0xFF, 0x90, 0x89, 0x5D, 0xE0, 0x34, 0x00, 0xCF, 0x24, 0x28, 0xFD, 0xE4, 0x3F, 0xFC, - 0x90, 0x83, 0xE8, 0xE0, 0xFB, 0x7F, 0x3A, 0x12, 0x72, 0xE1, 0x71, 0x2C, 0x12, 0x94, 0xDA, 0xC0, - 0x03, 0x8B, 0x13, 0x75, 0x14, 0x89, 0x75, 0x15, 0x61, 0x75, 0x16, 0x28, 0xD0, 0x03, 0x12, 0x2B, - 0xED, 0x90, 0x06, 0x33, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x89, 0x60, 0xE0, 0xFF, 0x7D, 0x3A, 0x12, - 0x4D, 0xC2, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x22, 0x12, 0x2B, 0xED, 0x90, 0x89, 0x5D, 0xA3, - 0xE0, 0xFF, 0xA3, 0xE0, 0x2F, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x84, 0x09, - 0x12, 0x44, 0x72, 0x78, 0x15, 0x7C, 0x84, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x40, 0x79, 0xCE, 0x12, - 0x7D, 0x2F, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x84, 0x14, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x0C, - 0x7D, 0x33, 0x12, 0x4D, 0xCD, 0xEF, 0x64, 0x01, 0x70, 0x16, 0x80, 0x00, 0x90, 0x83, 0xE7, 0xE0, - 0xFF, 0x90, 0x84, 0x74, 0x74, 0x10, 0xB1, 0xFE, 0x90, 0x84, 0x11, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, - 0x90, 0x84, 0x11, 0xB1, 0xB7, 0x90, 0x84, 0x13, 0xEF, 0xF0, 0x90, 0x84, 0x11, 0xF1, 0xC2, 0x90, - 0x84, 0x0F, 0xE0, 0xFD, 0xF1, 0x2B, 0x90, 0x84, 0x10, 0xE0, 0x70, 0x55, 0x91, 0x5A, 0xC0, 0x03, - 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x84, 0x0C, 0x31, 0xA6, 0x75, 0x16, 0x06, 0xD0, 0x01, 0xD0, 0x02, - 0xD0, 0x03, 0x12, 0x2B, 0xED, 0x90, 0x84, 0x11, 0x71, 0x2F, 0xD1, 0x91, 0xFA, 0x7B, 0x01, 0xC0, - 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x84, 0x0C, 0x31, 0xA6, 0x75, 0x16, 0x06, 0xD0, 0x01, 0xD0, - 0x02, 0xD0, 0x03, 0x12, 0x2B, 0xED, 0x90, 0x84, 0x11, 0x71, 0x2F, 0xD1, 0x9F, 0xC0, 0x03, 0xC0, - 0x02, 0xC0, 0x01, 0x90, 0x84, 0x09, 0x31, 0xA6, 0x75, 0x16, 0x04, 0xD0, 0x01, 0xD0, 0x02, 0x80, - 0x4C, 0x90, 0x84, 0x10, 0xE0, 0x64, 0x01, 0x70, 0x49, 0x91, 0x5A, 0xC0, 0x03, 0x8B, 0x13, 0x75, - 0x14, 0x81, 0x75, 0x15, 0xD4, 0x75, 0x16, 0x06, 0xD0, 0x03, 0x12, 0x2B, 0xED, 0x90, 0x84, 0x11, - 0x71, 0x2F, 0xD1, 0x91, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0x8B, 0x13, 0x75, 0x14, 0x81, 0x75, 0x15, - 0xDE, 0x75, 0x16, 0x06, 0xD0, 0x03, 0x12, 0x2B, 0xED, 0x90, 0x84, 0x11, 0x71, 0x2F, 0xD1, 0x9F, - 0xC0, 0x03, 0x8B, 0x13, 0x75, 0x14, 0x81, 0x75, 0x15, 0xE4, 0x75, 0x16, 0x04, 0xD0, 0x03, 0x12, - 0x2B, 0xED, 0x90, 0x06, 0x30, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x84, 0x14, 0xE0, 0xFF, 0x7D, 0x34, - 0x12, 0x4D, 0xC2, 0x71, 0x22, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xA3, 0xA3, 0xE0, 0x24, 0x30, 0xF9, - 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0x22, 0xB1, 0x99, 0x90, 0x84, 0x84, 0xE4, 0xF0, 0xA3, 0xEF, - 0xF0, 0x90, 0x84, 0x84, 0xB1, 0xB7, 0x90, 0x84, 0x86, 0xEF, 0xF0, 0x90, 0x84, 0x84, 0xA3, 0xE0, - 0x24, 0x30, 0xF9, 0xE4, 0x34, 0xFC, 0x91, 0xDA, 0x75, 0x16, 0x06, 0x7B, 0x01, 0x7A, 0x81, 0x79, - 0xD4, 0xD1, 0x98, 0x71, 0x2F, 0x24, 0x36, 0xF9, 0xE4, 0x34, 0xFC, 0x91, 0xDA, 0x75, 0x16, 0x04, - 0x7B, 0x01, 0x7A, 0x81, 0x79, 0xDA, 0xD1, 0x98, 0x71, 0x2F, 0xD1, 0x91, 0x91, 0xDA, 0x75, 0x16, - 0x06, 0x7B, 0x01, 0x7A, 0x81, 0x79, 0xDE, 0xD1, 0x98, 0x71, 0x2F, 0x24, 0x40, 0xF9, 0xE4, 0x34, - 0xFC, 0x91, 0xDA, 0x75, 0x16, 0x04, 0x7B, 0x01, 0x7A, 0x81, 0x79, 0xE4, 0x02, 0x2B, 0xED, 0xB1, - 0x99, 0x7E, 0x00, 0x74, 0x00, 0x2F, 0xF9, 0xE4, 0x34, 0xFC, 0x75, 0x13, 0x01, 0xF5, 0x14, 0x89, - 0x15, 0x22, 0x90, 0x83, 0xF1, 0xB1, 0xAD, 0xE0, 0xFE, 0x24, 0x20, 0xF5, 0x82, 0xE4, 0x34, 0xFC, - 0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x21, 0x2E, 0x12, 0x4F, 0xCB, 0xE0, 0xFD, 0x90, 0x89, 0x14, 0xE0, - 0x24, 0x24, 0xB1, 0xD4, 0x90, 0x89, 0x14, 0xE0, 0x2F, 0x24, 0x28, 0xA3, 0xF0, 0xE0, 0xFD, 0x24, - 0x04, 0x12, 0x77, 0xCD, 0xE0, 0xFE, 0x74, 0x05, 0x2D, 0x12, 0x72, 0xD1, 0x90, 0x83, 0x98, 0xF0, - 0xA3, 0xEF, 0xF0, 0x90, 0x89, 0x15, 0xE0, 0x24, 0x0C, 0xF9, 0xE4, 0x34, 0xFC, 0x91, 0xDA, 0x75, - 0x16, 0x04, 0x7B, 0x01, 0x7A, 0x83, 0x79, 0x9A, 0x12, 0x2B, 0xED, 0x90, 0x89, 0x15, 0xE0, 0x24, - 0x14, 0xF0, 0xE0, 0xFD, 0x24, 0x01, 0x12, 0x74, 0xAD, 0xE0, 0xFE, 0x74, 0x00, 0x2D, 0xF5, 0x82, - 0xE4, 0x34, 0xFC, 0x12, 0x72, 0xD6, 0x90, 0x83, 0x9E, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x83, 0xF2, - 0xB1, 0xAD, 0x90, 0x83, 0x94, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x4E, 0x60, 0x13, 0x90, 0x89, 0x14, - 0xE0, 0x24, 0x00, 0x91, 0xD6, 0x8F, 0x16, 0x7B, 0x01, 0x7A, 0x83, 0x79, 0xA2, 0x12, 0x2B, 0xED, - 0x90, 0x83, 0xF3, 0xB1, 0xAD, 0x24, 0x00, 0x91, 0xD6, 0x90, 0x83, 0x96, 0xA3, 0xE0, 0xF5, 0x16, - 0x7B, 0x01, 0x7A, 0x83, 0x79, 0xC2, 0x02, 0x2B, 0xED, 0xE4, 0xFE, 0xEF, 0xC3, 0x13, 0xFD, 0xEF, - 0x30, 0xE0, 0x02, 0x7E, 0x80, 0x90, 0xFD, 0x10, 0xED, 0xF0, 0xAF, 0x06, 0x22, 0xE0, 0xFF, 0xB1, - 0x99, 0x90, 0x89, 0x14, 0xEF, 0xF0, 0x22, 0xA3, 0xE0, 0xFE, 0x24, 0x20, 0xF5, 0x82, 0xE4, 0x34, - 0xFC, 0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x21, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, - 0xFD, 0x74, 0x24, 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, - 0x90, 0xD9, 0xAE, 0x07, 0x80, 0x02, 0xE4, 0xFE, 0xEC, 0x24, 0x18, 0x2E, 0xFF, 0x22, 0xF0, 0x7B, - 0x18, 0x7D, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x84, 0x72, 0xED, 0xF0, 0xA3, - 0xEB, 0xF0, 0x90, 0x84, 0x71, 0xEF, 0xF0, 0xE4, 0xFD, 0xFC, 0xB1, 0x99, 0x7C, 0x00, 0xAD, 0x07, - 0x90, 0x84, 0x71, 0xE0, 0x90, 0x04, 0x25, 0xF0, 0x90, 0x84, 0x72, 0xE0, 0x60, 0x0E, 0x74, 0x0F, - 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0xAF, 0x05, 0x74, 0x08, - 0x2F, 0x12, 0x8B, 0x9A, 0xE4, 0xF0, 0x74, 0x09, 0x2F, 0x12, 0x8B, 0xAA, 0x54, 0xF0, 0xF0, 0xAF, - 0x05, 0x12, 0x8A, 0xE2, 0xE0, 0x54, 0x01, 0xFE, 0x90, 0x84, 0x73, 0xE0, 0x25, 0xE0, 0x25, 0xE0, - 0xFB, 0xEE, 0x44, 0x02, 0x4B, 0xFE, 0x12, 0x8A, 0xE2, 0xEE, 0xF0, 0x90, 0x84, 0x74, 0xE0, 0xFF, - 0xAE, 0x05, 0x74, 0x1E, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x21, - 0x2E, 0x12, 0x4F, 0xCB, 0xE0, 0x54, 0xF7, 0xF0, 0xAE, 0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, - 0x22, 0x24, 0x3A, 0xF9, 0xE4, 0x34, 0xFC, 0x22, 0x12, 0x2B, 0xED, 0x90, 0x84, 0x84, 0x22, 0x24, - 0x40, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0x22, 0xE4, 0x90, 0x89, 0x03, 0xF0, 0xA3, 0xF0, - 0x90, 0x06, 0x32, 0xE0, 0x44, 0x20, 0xF0, 0x12, 0x86, 0xF7, 0xEF, 0x64, 0x01, 0x70, 0x6B, 0x90, - 0x83, 0xF1, 0xE0, 0xFF, 0x90, 0x84, 0x74, 0x74, 0x0D, 0xF0, 0x7B, 0x08, 0x7D, 0x01, 0xD1, 0x03, - 0x12, 0x95, 0x0B, 0x90, 0x89, 0x00, 0xB1, 0xB7, 0x90, 0x89, 0x02, 0xEF, 0xF0, 0x90, 0x89, 0x00, - 0xF1, 0xC2, 0xE4, 0xFD, 0xF1, 0x2B, 0x90, 0x89, 0x02, 0xE0, 0xFF, 0x90, 0x89, 0x01, 0xE0, 0x2F, - 0xFF, 0x90, 0x89, 0x00, 0xE0, 0x34, 0x00, 0xCF, 0x24, 0x28, 0xCF, 0x34, 0x00, 0xFE, 0x90, 0x89, - 0x03, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x6F, 0x3D, 0x12, 0x95, 0x02, 0x90, 0x83, 0xF1, 0xE0, 0xFB, - 0xE4, 0xFF, 0x12, 0x72, 0xE1, 0x12, 0x95, 0x02, 0x90, 0x83, 0xED, 0xE0, 0xFB, 0x7F, 0x11, 0x12, - 0x72, 0xE1, 0x71, 0x22, 0x90, 0x83, 0xA0, 0x12, 0x69, 0x1F, 0x22, 0x90, 0x84, 0x60, 0xED, 0xF0, - 0x90, 0x84, 0x5D, 0x12, 0x44, 0x72, 0xE4, 0x90, 0x84, 0x61, 0xF0, 0xA3, 0xF0, 0x12, 0x1F, 0xA4, - 0xFF, 0xF1, 0xE8, 0xFD, 0xF1, 0xCF, 0xFB, 0xB1, 0xDD, 0x90, 0x84, 0x61, 0xEF, 0xF0, 0x90, 0x84, - 0x5D, 0x12, 0x44, 0x69, 0xF1, 0xCF, 0xFF, 0x12, 0x90, 0xD9, 0x90, 0x84, 0x62, 0xEF, 0xF0, 0x90, - 0x83, 0x8D, 0xE0, 0x24, 0xFE, 0x60, 0x1A, 0x24, 0xFE, 0x60, 0x16, 0x14, 0x60, 0x07, 0x14, 0x60, - 0x04, 0x24, 0x05, 0x70, 0x4C, 0xF1, 0xD5, 0x90, 0x84, 0x60, 0xE0, 0xFD, 0x12, 0x93, 0x7F, 0x80, - 0x12, 0xF1, 0xD5, 0x90, 0x84, 0x60, 0xE0, 0xFD, 0x90, 0x83, 0x8D, 0xE0, 0x90, 0x84, 0x2E, 0xF0, - 0x12, 0x82, 0xF9, 0x90, 0x84, 0x62, 0xE0, 0xFF, 0x90, 0x84, 0x5D, 0x12, 0x44, 0x69, 0x90, 0x84, - 0x61, 0xE0, 0x7C, 0x00, 0x29, 0xF9, 0xEC, 0x3A, 0xFA, 0xC3, 0xE9, 0x9F, 0xF9, 0xEA, 0x94, 0x00, - 0xFA, 0x75, 0x13, 0x01, 0x75, 0x14, 0x83, 0x75, 0x15, 0x5C, 0xA3, 0xE0, 0xF5, 0x16, 0x12, 0x2B, - 0xED, 0x22, 0xA3, 0xE0, 0x24, 0x20, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0x22, 0xF0, 0x90, - 0x00, 0x04, 0x02, 0x1F, 0xBD, 0x7B, 0x01, 0x7A, 0x83, 0x79, 0x5C, 0x22, 0x91, 0xCF, 0x75, 0x16, - 0x08, 0xF1, 0xD5, 0x02, 0x2B, 0xED, 0x4E, 0xF0, 0x90, 0x00, 0x01, 0x02, 0x1F, 0xBD, 0x91, 0xCF, - 0x75, 0x16, 0x70, 0x7B, 0x01, 0x7A, 0x81, 0x79, 0xE8, 0x02, 0x2B, 0xED, 0x75, 0xE8, 0x03, 0x75, - 0xA8, 0x84, 0x22, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x12, 0x32, 0x1E, 0x90, - 0xFD, 0x00, 0xE0, 0x54, 0xBF, 0xF0, 0x12, 0x84, 0xB8, 0x12, 0x32, 0x77, 0x12, 0x84, 0xC5, 0x12, - 0x85, 0x7D, 0x7F, 0x01, 0x12, 0x47, 0x8C, 0x90, 0x83, 0xF6, 0x74, 0x02, 0xF0, 0xFF, 0x12, 0x47, - 0x8C, 0x90, 0x83, 0xF6, 0xE0, 0x04, 0xF0, 0x12, 0x58, 0x48, 0x11, 0x5F, 0x90, 0x01, 0xCC, 0x74, - 0x0F, 0xF0, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x40, 0xFD, 0x7F, 0x80, 0x12, 0x32, 0x1E, 0x75, 0x20, - 0xFF, 0x12, 0x5F, 0xFC, 0x12, 0x84, 0xF5, 0x12, 0x85, 0x84, 0xE4, 0xFF, 0x02, 0x48, 0x15, 0x11, - 0x8B, 0x12, 0x81, 0xD0, 0x12, 0x87, 0x94, 0x31, 0x44, 0x12, 0x8C, 0x43, 0x31, 0x30, 0x90, 0x84, - 0x03, 0xE0, 0x54, 0x7F, 0xF0, 0x54, 0xBF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xF0, 0xF0, 0xE4, 0x90, - 0x84, 0x05, 0xF0, 0x90, 0x84, 0x03, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0xE4, 0xFD, 0xFF, 0x12, 0x92, - 0x8D, 0xFE, 0xEF, 0x54, 0x07, 0xFF, 0xED, 0x70, 0x12, 0x11, 0xCF, 0xC0, 0x83, 0xC0, 0x82, 0x11, - 0xC7, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5E, 0x80, 0x0F, 0x11, 0xCF, 0xC0, 0x83, 0xC0, - 0x82, 0x11, 0xC7, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x11, - 0xDA, 0x90, 0x81, 0x45, 0xEF, 0xF0, 0x22, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x07, 0x08, 0x22, 0x74, - 0x3D, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, - 0xD0, 0x7D, 0x08, 0xED, 0x14, 0xF9, 0x24, 0x3D, 0x11, 0xD2, 0xE0, 0x60, 0x3A, 0x7C, 0x08, 0xEC, - 0x14, 0x90, 0x84, 0x90, 0xF0, 0x74, 0x3D, 0x29, 0x11, 0xD2, 0xE0, 0xFB, 0x7A, 0x00, 0x90, 0x84, - 0x90, 0x12, 0x81, 0x56, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5A, - 0xFE, 0xEF, 0x5B, 0x4E, 0x60, 0x0F, 0xE9, 0x75, 0xF0, 0x08, 0xA4, 0xFF, 0x90, 0x84, 0x90, 0xE0, - 0x2F, 0x04, 0xFF, 0x80, 0x06, 0xDC, 0xC8, 0xDD, 0xBA, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, - 0xF1, 0xEC, 0x7A, 0x83, 0x79, 0xFB, 0x12, 0x46, 0x4B, 0x90, 0x83, 0xFC, 0x74, 0x08, 0xF0, 0xA3, - 0x74, 0x03, 0xF0, 0x22, 0x7E, 0x00, 0x7F, 0x25, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x81, 0x79, 0xAF, - 0x12, 0x46, 0x4B, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x20, 0xF0, 0x12, 0x90, 0xAF, 0x02, 0x58, 0xC9, - 0x90, 0x89, 0x14, 0x12, 0x44, 0x72, 0x31, 0x30, 0xB1, 0xFE, 0xFE, 0xF1, 0x67, 0x4E, 0xF0, 0xEF, - 0xC3, 0x13, 0x30, 0xE0, 0x2B, 0x12, 0x5F, 0xE8, 0x90, 0x83, 0xFC, 0x51, 0x86, 0x90, 0x83, 0xFD, - 0xF0, 0x12, 0x1F, 0xA4, 0xFF, 0x54, 0x04, 0xFE, 0x90, 0x83, 0xFB, 0xE0, 0x54, 0xFB, 0xD1, 0x67, - 0x90, 0x83, 0xFE, 0xF0, 0xEF, 0x54, 0x08, 0xFF, 0x90, 0x83, 0xFB, 0xE0, 0x54, 0xF7, 0x4F, 0xF0, - 0x22, 0x90, 0x89, 0x11, 0x12, 0x44, 0x72, 0x90, 0x89, 0x10, 0xEF, 0xF0, 0x12, 0x44, 0x7B, 0x61, - 0xDA, 0x00, 0x61, 0xDE, 0x01, 0x61, 0xE2, 0x03, 0x61, 0xE6, 0x04, 0x61, 0xEA, 0x14, 0x61, 0xEF, - 0x20, 0x61, 0xF3, 0x25, 0x61, 0xFC, 0x80, 0x61, 0xF8, 0x81, 0x62, 0x00, 0x82, 0x62, 0x05, 0x83, - 0x62, 0x09, 0x84, 0x62, 0x0D, 0x88, 0x00, 0x00, 0x62, 0x12, 0x51, 0x22, 0xC1, 0x2B, 0x51, 0x22, - 0x80, 0x46, 0x51, 0x22, 0xC1, 0x0B, 0x51, 0x22, 0x21, 0x60, 0x51, 0x22, 0x02, 0x80, 0x00, 0x51, - 0x22, 0xC1, 0xE7, 0x51, 0x22, 0x02, 0x80, 0x0F, 0x51, 0x22, 0x41, 0x8D, 0x51, 0x22, 0x61, 0x4C, - 0x51, 0x22, 0x02, 0x91, 0xBA, 0x51, 0x22, 0xC1, 0x6F, 0x51, 0x22, 0xC1, 0xAB, 0x51, 0x22, 0x02, - 0x91, 0xD0, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x89, 0x10, 0xE0, 0x90, 0x01, 0xC2, - 0xF0, 0x22, 0x90, 0x89, 0x11, 0x02, 0x44, 0x69, 0x8B, 0x50, 0x8A, 0x51, 0x89, 0x52, 0x12, 0x5F, - 0xE8, 0xFF, 0xF5, 0x54, 0x12, 0x1F, 0xA4, 0xFE, 0xC3, 0x13, 0x30, 0xE0, 0x06, 0x51, 0x87, 0xF5, - 0x55, 0x80, 0x02, 0x8F, 0x55, 0x85, 0x54, 0x53, 0xE5, 0x53, 0xD3, 0x95, 0x55, 0x50, 0x24, 0xAB, - 0x50, 0xAA, 0x51, 0xA9, 0x52, 0x12, 0x1F, 0xA4, 0x54, 0x01, 0xFD, 0xAF, 0x53, 0x11, 0x8E, 0xAF, - 0x53, 0x12, 0x4F, 0x3C, 0xEF, 0xAF, 0x53, 0x70, 0x04, 0xF1, 0xC7, 0x80, 0x02, 0xF1, 0xEB, 0x05, - 0x53, 0x80, 0xD5, 0xE5, 0x54, 0x70, 0x0D, 0xFF, 0x12, 0x4F, 0x3C, 0xEF, 0x70, 0x06, 0x12, 0x55, - 0xA4, 0x54, 0x7F, 0xF0, 0x22, 0x4F, 0xF0, 0x90, 0x00, 0x02, 0x02, 0x1F, 0xBD, 0xD3, 0x10, 0xAF, - 0x01, 0xC3, 0xC0, 0xD0, 0xD1, 0x04, 0xFE, 0x90, 0x81, 0xAF, 0xB1, 0xEE, 0xF1, 0xC8, 0x71, 0x45, - 0xF1, 0xE2, 0x90, 0x81, 0xAF, 0x12, 0x95, 0x1D, 0x71, 0x44, 0xF1, 0xD0, 0x90, 0x81, 0xAF, 0x71, - 0x3C, 0xF1, 0xD9, 0x90, 0x81, 0xAF, 0x12, 0x95, 0x14, 0x4E, 0x51, 0x86, 0xFF, 0x54, 0x01, 0xFE, - 0x90, 0x81, 0xB1, 0xE0, 0x54, 0xFE, 0x12, 0x5F, 0xE6, 0xFE, 0x54, 0x01, 0xFD, 0x90, 0x81, 0xB0, - 0xE0, 0x54, 0xFE, 0x4D, 0xFD, 0xF0, 0xEE, 0x54, 0x04, 0xFE, 0xED, 0x54, 0xFB, 0x4E, 0xF0, 0xEF, - 0x54, 0x10, 0xFF, 0xA3, 0xE0, 0x54, 0xEF, 0x4F, 0xFF, 0x51, 0x86, 0x54, 0x20, 0xFE, 0xEF, 0x54, - 0xDF, 0x4E, 0x90, 0x81, 0xB1, 0x12, 0x94, 0xE4, 0x12, 0x72, 0xD8, 0x12, 0x77, 0xDD, 0x90, 0x81, - 0xAF, 0xE0, 0xC3, 0x13, 0x54, 0x01, 0xFF, 0x12, 0x91, 0xF0, 0x90, 0x81, 0xAF, 0xE0, 0x13, 0x13, - 0x54, 0x01, 0xFF, 0x12, 0x91, 0xFC, 0x90, 0x81, 0xAF, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFF, - 0x12, 0x8B, 0xBC, 0x12, 0x8F, 0x7F, 0x13, 0x54, 0x01, 0xFF, 0x12, 0x8B, 0xB3, 0x90, 0x81, 0xAF, - 0xE0, 0x54, 0x01, 0xFF, 0x12, 0x72, 0x4A, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, 0xEE, 0x54, 0x20, - 0xFE, 0xEF, 0x54, 0xDF, 0x4E, 0xFF, 0xF0, 0x12, 0x1F, 0xA4, 0xFE, 0x22, 0xD3, 0x10, 0xAF, 0x01, - 0xC3, 0xC0, 0xD0, 0x90, 0x89, 0x14, 0xF1, 0x61, 0x20, 0xE0, 0x05, 0x12, 0x74, 0xF8, 0x81, 0x24, - 0xB1, 0xFE, 0xFE, 0x90, 0x81, 0xB2, 0xB1, 0xEE, 0xF1, 0xC8, 0x71, 0x45, 0xF1, 0xE2, 0x90, 0x81, - 0xB2, 0x12, 0x95, 0x1D, 0x71, 0x44, 0xF1, 0xD0, 0x90, 0x81, 0xB2, 0x71, 0x3C, 0xF1, 0xD9, 0x90, - 0x81, 0xB2, 0x12, 0x95, 0x14, 0x12, 0x5F, 0xE6, 0x54, 0x80, 0xFF, 0x90, 0x81, 0xB3, 0xE0, 0x54, - 0x7F, 0x4F, 0xF0, 0x12, 0x1F, 0xA4, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x07, 0x90, 0x06, 0x90, - 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x89, 0x14, 0x12, 0x44, 0x69, 0x12, 0x1F, 0xA4, 0x13, 0x13, 0x13, - 0x54, 0x1F, 0x30, 0xE0, 0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x08, 0xF0, 0x90, 0x80, 0x07, 0xE0, - 0xB4, 0x02, 0x06, 0x12, 0x86, 0xEC, 0x20, 0xE0, 0x3E, 0x12, 0x5F, 0xE8, 0x54, 0x7F, 0xFF, 0x90, - 0x81, 0xB3, 0xE0, 0x54, 0x80, 0x51, 0x85, 0x90, 0x81, 0xB4, 0xD1, 0x68, 0xFF, 0x54, 0x01, 0xFE, - 0x90, 0x81, 0xB5, 0xB1, 0xEE, 0x54, 0xFE, 0xFF, 0xEE, 0x54, 0x01, 0x4F, 0x12, 0x5F, 0xCE, 0x54, - 0x04, 0xFF, 0x90, 0x81, 0xB6, 0xE0, 0x54, 0xFB, 0x4F, 0xF0, 0xB1, 0xB0, 0x54, 0x07, 0x7D, 0x00, - 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x91, 0x29, 0x90, 0x80, 0x07, 0xE0, 0xB4, 0x01, 0x16, 0x90, 0xFE, - 0x10, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x83, 0x8C, 0x74, 0x05, 0xF0, 0xF1, 0xEC, 0x7A, 0x82, 0x79, - 0xCB, 0x12, 0x46, 0x4B, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, - 0x90, 0x84, 0x8C, 0xED, 0xF0, 0x90, 0x84, 0x8B, 0xEF, 0xF0, 0xD3, 0x94, 0x07, 0x50, 0x4B, 0x91, - 0xFA, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0xFF, 0x90, 0x00, 0x47, 0xE0, 0x5F, 0xFD, 0x7F, - 0x47, 0x91, 0xF4, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xFF, 0x90, 0x00, 0x46, 0xE0, 0x4F, 0xFD, - 0x7F, 0x46, 0xB1, 0xF6, 0x60, 0x10, 0x91, 0xF7, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xFF, 0x90, - 0x00, 0x45, 0xE0, 0x4F, 0x80, 0x0F, 0x91, 0xF7, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0xFF, - 0x90, 0x00, 0x45, 0xE0, 0x5F, 0xFD, 0x7F, 0x45, 0x80, 0x62, 0x90, 0x84, 0x8B, 0xE0, 0x24, 0xF8, - 0xF0, 0xE0, 0x24, 0x04, 0x91, 0xFB, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0xFF, 0x90, 0x00, - 0x43, 0xE0, 0x5F, 0xFD, 0x7F, 0x43, 0x91, 0xF4, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xFF, 0x90, - 0x00, 0x43, 0xE0, 0x4F, 0xFD, 0x7F, 0x43, 0xB1, 0xF6, 0x60, 0x19, 0x90, 0x84, 0x8B, 0xE0, 0x24, - 0x04, 0x91, 0xFB, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xFF, 0x90, 0x00, 0x42, 0xE0, 0x4F, 0xFD, - 0x7F, 0x42, 0x80, 0x18, 0x90, 0x84, 0x8B, 0xE0, 0x24, 0x04, 0x91, 0xFB, 0x80, 0x02, 0xC3, 0x33, - 0xD8, 0xFC, 0xF4, 0xFF, 0x90, 0x00, 0x42, 0xE0, 0x5F, 0xFD, 0x7F, 0x42, 0x12, 0x32, 0x1E, 0xD0, - 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x32, 0x1E, 0x90, 0x84, 0x8B, 0xE0, 0xFF, 0x74, 0x01, 0xA8, 0x07, - 0x08, 0x22, 0xAD, 0x07, 0x90, 0x81, 0xB4, 0xE0, 0x75, 0xF0, 0x40, 0xA4, 0xFF, 0x90, 0x84, 0x63, - 0xE5, 0xF0, 0x12, 0x83, 0xDC, 0x90, 0x81, 0xB5, 0xE0, 0xC3, 0x13, 0x54, 0x7F, 0x90, 0x84, 0x66, - 0xF0, 0x90, 0x81, 0xB6, 0xE0, 0x13, 0x13, 0x54, 0x01, 0x90, 0x84, 0x67, 0xF0, 0xED, 0x64, 0x01, - 0x70, 0x6E, 0xE0, 0x70, 0x15, 0x90, 0x84, 0x63, 0xE0, 0x70, 0x02, 0xA3, 0xE0, 0x60, 0x0B, 0x90, - 0x84, 0x63, 0x74, 0xFF, 0x75, 0xF0, 0xD0, 0x12, 0x43, 0xF6, 0xB1, 0xB0, 0x54, 0x07, 0x7D, 0x00, - 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x91, 0x29, 0xB1, 0xB0, 0x54, 0x01, 0xFD, 0x91, 0x29, 0x90, 0x81, - 0xB5, 0xE0, 0x30, 0xE0, 0x3B, 0xB1, 0xA1, 0x54, 0x07, 0x7D, 0x00, 0x20, 0xE0, 0x02, 0x7D, 0x01, - 0x91, 0x29, 0xE4, 0x90, 0x84, 0x65, 0xF0, 0x90, 0x84, 0x66, 0xE0, 0xFF, 0x90, 0x84, 0x65, 0xE0, - 0xC3, 0x9F, 0x50, 0x1C, 0xB1, 0xA1, 0x54, 0x01, 0xFD, 0x91, 0x29, 0xB1, 0xA1, 0x54, 0x07, 0x7D, - 0x00, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x91, 0x29, 0x90, 0x84, 0x65, 0xE0, 0x04, 0xF0, 0x80, 0xD7, - 0x22, 0x90, 0x84, 0x63, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x84, 0x67, 0xE0, 0xFD, 0xB1, 0xBF, - 0x90, 0x81, 0xB3, 0xE0, 0x54, 0x7F, 0xFF, 0x90, 0x81, 0xB2, 0xE0, 0xFE, 0xC4, 0x13, 0x22, 0xD3, - 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8E, 0x0D, 0x8F, 0x0E, 0xBD, 0x01, 0x15, 0xE5, 0x0E, 0x78, - 0x03, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xEE, 0x54, 0x1F, 0xFE, 0x12, 0x32, 0x06, - 0x80, 0x07, 0xAF, 0x0E, 0xAE, 0x0D, 0x12, 0x32, 0xAA, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0x54, - 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, 0x22, 0x12, 0x32, 0x1E, 0x90, 0x84, 0x8C, 0xE0, 0x22, 0x90, 0x89, - 0x14, 0x12, 0x44, 0x69, 0x12, 0x1F, 0xA4, 0xFF, 0x54, 0x01, 0x22, 0xD1, 0x04, 0xFE, 0x90, 0x83, - 0xF7, 0xB1, 0xEE, 0x54, 0x04, 0xFF, 0xEE, 0x54, 0xFB, 0x4F, 0xF0, 0x12, 0x1F, 0xA4, 0xC3, 0x13, - 0x30, 0xE0, 0x07, 0x12, 0x5F, 0xE8, 0x90, 0x83, 0xF8, 0xF0, 0x22, 0x90, 0x02, 0x09, 0xE0, 0xF5, - 0x50, 0x12, 0x1F, 0xA4, 0x25, 0x50, 0x90, 0x80, 0x4A, 0x12, 0x5F, 0xE7, 0x25, 0x50, 0x90, 0x80, - 0x4B, 0x51, 0x86, 0x25, 0x50, 0x90, 0x80, 0x4C, 0xD1, 0x68, 0x25, 0x50, 0x90, 0x80, 0x4D, 0x12, - 0x5F, 0xCE, 0x25, 0x50, 0x90, 0x80, 0x4E, 0xF1, 0x52, 0x25, 0x50, 0x90, 0x80, 0x4F, 0xF1, 0x4B, - 0x25, 0x50, 0x90, 0x80, 0x50, 0xF0, 0x22, 0x4E, 0xF0, 0x90, 0x00, 0x03, 0x02, 0x1F, 0xBD, 0x12, - 0x91, 0xE2, 0x90, 0x83, 0xE6, 0x12, 0x5F, 0xE7, 0xFF, 0xED, 0x2F, 0x90, 0x83, 0xE7, 0x51, 0x86, - 0xFF, 0xED, 0x2F, 0x90, 0x83, 0xE8, 0xD1, 0x68, 0xFF, 0xED, 0x2F, 0x90, 0x83, 0xE9, 0x12, 0x5F, - 0xCE, 0xFF, 0xED, 0x2F, 0x90, 0x83, 0xEA, 0xF1, 0x52, 0xFF, 0xED, 0x2F, 0x90, 0x83, 0xEB, 0xF1, - 0x4B, 0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x90, 0x83, 0xEC, 0xF0, 0x22, 0x12, 0x91, 0xE2, 0x90, 0x83, - 0xED, 0x12, 0x5F, 0xE7, 0xFF, 0xED, 0x2F, 0x90, 0x83, 0xEE, 0x51, 0x86, 0xFF, 0xED, 0x2F, 0x90, - 0x83, 0xEF, 0xD1, 0x68, 0xFF, 0xED, 0x2F, 0x90, 0x83, 0xF0, 0x12, 0x5F, 0xCE, 0xFF, 0xED, 0x2F, - 0x90, 0x83, 0xF1, 0xF1, 0x52, 0xFF, 0xED, 0x2F, 0x90, 0x83, 0xF2, 0xF1, 0x4B, 0xFF, 0xAE, 0x05, - 0xED, 0x2F, 0x90, 0x83, 0xF3, 0xF0, 0x22, 0x90, 0x89, 0x14, 0xF1, 0x61, 0xFF, 0x54, 0x7F, 0x90, - 0x81, 0x4B, 0xF0, 0xEF, 0x12, 0x86, 0xF0, 0xA3, 0x12, 0x5F, 0xE7, 0xFF, 0x54, 0xF0, 0xC4, 0x54, - 0x0F, 0xFE, 0x90, 0x81, 0x49, 0xE0, 0x54, 0xF0, 0xD1, 0x67, 0x54, 0x01, 0x25, 0xE0, 0xFE, 0x90, - 0x81, 0x46, 0xE0, 0x54, 0xFD, 0x4E, 0xF0, 0xEF, 0x54, 0x0F, 0xC4, 0x54, 0xF0, 0xFF, 0xF1, 0x5A, - 0x51, 0x85, 0x90, 0x81, 0x4A, 0x12, 0x5F, 0xCE, 0xFD, 0x7F, 0x02, 0x12, 0x4E, 0x80, 0x90, 0x89, - 0x14, 0x12, 0x44, 0x69, 0x12, 0x56, 0x14, 0x12, 0x4F, 0xF9, 0xF0, 0x90, 0x81, 0x4B, 0x12, 0x94, - 0xF8, 0x90, 0x01, 0xBB, 0xF1, 0x59, 0x90, 0x01, 0xBE, 0xF0, 0x22, 0xF0, 0x90, 0x00, 0x06, 0x02, - 0x1F, 0xBD, 0xF0, 0x90, 0x00, 0x05, 0x02, 0x1F, 0xBD, 0xF0, 0x90, 0x81, 0x49, 0xE0, 0x54, 0x0F, - 0x22, 0x12, 0x44, 0x72, 0x02, 0x1F, 0xA4, 0x90, 0x83, 0xFB, 0xE0, 0x54, 0xFE, 0x22, 0x90, 0x83, - 0xFB, 0xE0, 0xFD, 0x30, 0xE0, 0x50, 0x90, 0x84, 0x00, 0xE0, 0xFC, 0x60, 0x49, 0x12, 0x81, 0x58, - 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x04, 0xE0, 0xE0, 0xFB, 0xEF, - 0x5B, 0x60, 0x0B, 0xE4, 0x90, 0x84, 0x00, 0xF0, 0x90, 0x84, 0x02, 0x04, 0xF0, 0x22, 0x90, 0x83, - 0xFD, 0xE0, 0xD3, 0x9C, 0x50, 0x17, 0xED, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x07, 0x12, - 0x92, 0x94, 0xF1, 0xC7, 0x80, 0x03, 0x12, 0x75, 0xA5, 0xF1, 0x67, 0xF0, 0x22, 0x12, 0x4E, 0x2B, - 0x90, 0x84, 0x00, 0xE0, 0x04, 0xF0, 0x22, 0x22, 0x54, 0x02, 0xFF, 0xEE, 0x54, 0xFD, 0x4F, 0x22, - 0x54, 0x10, 0xFD, 0xEF, 0x54, 0xEF, 0x4D, 0xFF, 0x22, 0x54, 0x40, 0xFD, 0xEF, 0x54, 0xBF, 0x4D, - 0xFF, 0x22, 0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x4D, 0xFF, 0x22, 0x22, 0x7E, 0x00, 0x7F, 0x08, - 0x7D, 0x00, 0x7B, 0x01, 0x22, 0xE4, 0x90, 0x89, 0x0B, 0xF0, 0x90, 0x89, 0x0B, 0xE0, 0x64, 0x01, - 0xF0, 0x24, 0xF5, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x67, 0xA3, 0xF0, 0x90, 0x81, 0x4B, 0xE0, 0x60, - 0x0F, 0x90, 0x81, 0x4E, 0xE0, 0xFF, 0x90, 0x81, 0x4D, 0xE0, 0x6F, 0x60, 0x03, 0x12, 0x57, 0xE2, - 0xC2, 0xAF, 0x12, 0x85, 0x56, 0xBF, 0x01, 0x02, 0x11, 0x33, 0xD2, 0xAF, 0xF1, 0xEA, 0x12, 0x46, - 0xC4, 0x80, 0xC7, 0x90, 0x81, 0x46, 0xE0, 0x30, 0xE0, 0x02, 0x11, 0x3D, 0x22, 0x90, 0x81, 0x4E, - 0xE0, 0xFF, 0x60, 0x03, 0xB4, 0x08, 0x0E, 0x12, 0x89, 0xBE, 0xBF, 0x01, 0x08, 0x11, 0x56, 0x90, - 0x01, 0xE5, 0xE0, 0x04, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x11, 0x81, 0x11, - 0x66, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x87, 0x77, 0x90, 0x00, 0x08, 0xE0, 0x54, 0xEF, 0xFD, - 0x7F, 0x08, 0x12, 0x32, 0x1E, 0xE4, 0xFF, 0x11, 0xCD, 0x90, 0x81, 0x47, 0xE0, 0x54, 0xEF, 0xF0, - 0x22, 0x90, 0x81, 0x47, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x81, 0x56, 0xE0, 0xFD, 0x7F, 0x93, 0x12, - 0x32, 0x1E, 0x90, 0x81, 0x4C, 0xE0, 0x60, 0x12, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x05, 0x74, - 0x10, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, 0x90, 0x00, 0x08, 0xE0, 0x44, 0x10, - 0xFD, 0x7F, 0x08, 0x12, 0x32, 0x1E, 0x7F, 0x01, 0x11, 0xCD, 0x90, 0x00, 0x90, 0xE0, 0x44, 0x01, - 0xFD, 0x7F, 0x90, 0x12, 0x32, 0x1E, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x32, 0xAA, 0x90, 0x89, 0x0C, - 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, - 0x7F, 0x01, 0x90, 0x89, 0x0C, 0xE0, 0x6F, 0x60, 0x35, 0xC3, 0x90, 0x89, 0x0E, 0xE0, 0x94, 0x88, - 0x90, 0x89, 0x0D, 0xE0, 0x94, 0x13, 0x40, 0x08, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, 0x22, - 0x90, 0x89, 0x0D, 0x31, 0x1F, 0x12, 0x85, 0x4F, 0xD3, 0x90, 0x89, 0x0E, 0xE0, 0x94, 0x32, 0x90, - 0x89, 0x0D, 0xE0, 0x94, 0x00, 0x40, 0xC0, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE0, 0xB9, 0x22, 0xE4, - 0x75, 0xF0, 0x01, 0x02, 0x43, 0xF6, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x89, 0xD3, - 0x12, 0x44, 0x72, 0x90, 0x89, 0xD6, 0xED, 0xF0, 0xE4, 0x90, 0x8A, 0x22, 0xF0, 0xD1, 0x69, 0x50, - 0x06, 0x71, 0x02, 0xD1, 0x4E, 0x80, 0xF6, 0x12, 0x59, 0xA3, 0xD1, 0x95, 0x90, 0x89, 0xDE, 0xF0, - 0x71, 0x35, 0x94, 0x40, 0x50, 0x0A, 0x71, 0x02, 0xE0, 0x64, 0x36, 0xF0, 0x51, 0xF0, 0x80, 0xF0, - 0x51, 0xE7, 0x90, 0x89, 0xDA, 0xD1, 0x46, 0x74, 0x80, 0x12, 0x1F, 0xFC, 0xEF, 0x75, 0xF0, 0x08, - 0xA4, 0x24, 0x00, 0xFF, 0xE5, 0xF0, 0x34, 0x02, 0xFC, 0x90, 0x00, 0x7E, 0x12, 0x1F, 0xFC, 0xEF, - 0x90, 0x00, 0x7F, 0xD1, 0x7C, 0xF0, 0xD1, 0x60, 0xC3, 0x94, 0xC0, 0xEE, 0x94, 0x00, 0x50, 0x60, - 0xD1, 0x3E, 0x50, 0x08, 0xD1, 0xB9, 0xD1, 0x16, 0x7B, 0x01, 0x80, 0x05, 0x12, 0x94, 0x2D, 0xD1, - 0x1E, 0xD1, 0xA6, 0xE4, 0x90, 0x8A, 0x23, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x8C, 0xE0, 0x30, 0xE4, - 0x0C, 0x71, 0x0D, 0x94, 0x03, 0x50, 0x06, 0x51, 0xF7, 0x31, 0x1F, 0x80, 0xED, 0x71, 0x26, 0x40, - 0x08, 0x90, 0x06, 0x31, 0xE0, 0x44, 0x01, 0x71, 0x1F, 0xD1, 0x57, 0x70, 0x1F, 0x90, 0x8A, 0x23, - 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x8C, 0xE0, 0x20, 0xE5, 0x0C, 0x71, 0x0D, 0x94, 0x03, 0x50, 0x06, - 0x51, 0xF7, 0x31, 0x1F, 0x80, 0xED, 0x71, 0x26, 0x40, 0x02, 0x71, 0x19, 0xB1, 0xF8, 0x80, 0x96, - 0x71, 0x3C, 0x7D, 0x84, 0x12, 0x2A, 0x8F, 0xE4, 0x90, 0x8A, 0x22, 0xF0, 0xD1, 0x69, 0x50, 0x06, - 0x71, 0x02, 0xD1, 0x4E, 0x80, 0xF6, 0x12, 0x59, 0xA3, 0xD1, 0x95, 0x90, 0x89, 0xDE, 0xF0, 0x71, - 0x35, 0x94, 0x40, 0x50, 0x0A, 0x71, 0x02, 0xE0, 0x64, 0x5C, 0xF0, 0x51, 0xF0, 0x80, 0xF0, 0xE4, - 0x90, 0x89, 0xDE, 0xF0, 0x71, 0x84, 0x90, 0x89, 0xDE, 0xD1, 0x46, 0x12, 0x1F, 0xBD, 0xFE, 0x51, - 0xE7, 0x8F, 0x82, 0x75, 0x83, 0x00, 0xEE, 0x51, 0xED, 0xE0, 0xB4, 0x14, 0xE7, 0x51, 0xE7, 0x90, - 0x00, 0x14, 0x74, 0x80, 0x12, 0x1F, 0xFC, 0x90, 0x89, 0xDE, 0x74, 0x15, 0xF0, 0x71, 0x35, 0x94, - 0x3E, 0x50, 0x0C, 0x51, 0xE7, 0x8F, 0x82, 0x75, 0x83, 0x00, 0xE4, 0x51, 0xED, 0x80, 0xEE, 0x51, - 0xE7, 0x90, 0x00, 0x3E, 0x74, 0x02, 0x12, 0x1F, 0xFC, 0x90, 0x00, 0x3F, 0x74, 0xA0, 0xD1, 0x7C, - 0xF0, 0xD1, 0x60, 0xC3, 0x94, 0x80, 0xEE, 0x94, 0x00, 0x50, 0x60, 0xD1, 0x3E, 0x50, 0x08, 0xD1, - 0xB9, 0xD1, 0x16, 0x7B, 0x01, 0x80, 0x05, 0x12, 0x94, 0x2D, 0xD1, 0x1E, 0xD1, 0xA6, 0xE4, 0x90, - 0x8A, 0x23, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x8C, 0xE0, 0x30, 0xE4, 0x0C, 0x71, 0x0D, 0x94, 0x03, - 0x50, 0x06, 0x51, 0xF7, 0x31, 0x1F, 0x80, 0xED, 0x71, 0x26, 0x40, 0x08, 0x90, 0x06, 0x31, 0xE0, - 0x44, 0x01, 0x71, 0x1F, 0xD1, 0x57, 0x70, 0x1F, 0x90, 0x8A, 0x23, 0xF0, 0xA3, 0xF0, 0x90, 0x01, - 0x8C, 0xE0, 0x20, 0xE5, 0x0C, 0x71, 0x0D, 0x94, 0x03, 0x50, 0x06, 0x51, 0xF7, 0x31, 0x1F, 0x80, - 0xED, 0x71, 0x26, 0x40, 0x02, 0x71, 0x19, 0xB1, 0xF8, 0x80, 0x96, 0x71, 0x3C, 0x7D, 0x84, 0x12, - 0x2A, 0x8F, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x89, 0xD7, 0x02, 0x44, 0x69, 0x12, 0x1F, 0xFC, - 0x90, 0x89, 0xDE, 0xE0, 0x04, 0xF0, 0x22, 0x7F, 0x01, 0x7E, 0x00, 0x12, 0x32, 0xAA, 0x90, 0x8A, - 0x23, 0x22, 0x74, 0xDF, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x89, 0xF5, 0x83, 0x22, 0xC3, 0x90, 0x8A, - 0x24, 0xE0, 0x94, 0xE8, 0x90, 0x8A, 0x23, 0xE0, 0x22, 0x90, 0x06, 0x31, 0xE0, 0x44, 0x02, 0xF0, - 0xEE, 0x90, 0x06, 0x36, 0xF0, 0x22, 0x90, 0x8A, 0x23, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x94, - 0xE8, 0xEE, 0x94, 0x03, 0x22, 0x90, 0x89, 0xDE, 0xE0, 0xFF, 0xC3, 0x22, 0x90, 0x89, 0xDB, 0x12, - 0x44, 0x69, 0xE9, 0x24, 0x10, 0xF9, 0xE4, 0x3A, 0xFA, 0x7D, 0x80, 0x12, 0x2A, 0x8F, 0x90, 0x89, - 0xDB, 0x12, 0x44, 0x69, 0xE9, 0x24, 0x0C, 0xF9, 0xE4, 0x3A, 0xFA, 0x7D, 0x81, 0x12, 0x2A, 0x8F, - 0x90, 0x89, 0xDB, 0x12, 0x44, 0x69, 0xE9, 0x24, 0x08, 0xF9, 0xE4, 0x3A, 0xFA, 0x7D, 0x82, 0x12, - 0x2A, 0x8F, 0x90, 0x89, 0xDB, 0x12, 0x44, 0x69, 0xE9, 0x24, 0x04, 0xF9, 0xE4, 0x3A, 0xFA, 0x7D, - 0x83, 0x12, 0x2A, 0x8F, 0x90, 0x89, 0xDB, 0x02, 0x44, 0x69, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, - 0xD0, 0x90, 0x89, 0x30, 0x12, 0x7D, 0xEB, 0x90, 0x89, 0x48, 0x74, 0x18, 0xF0, 0x7E, 0x00, 0x7F, - 0x80, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x89, 0x79, 0x50, 0x12, 0x46, 0x4B, 0x90, 0x01, 0xC4, 0x74, - 0x8A, 0xF0, 0x74, 0x6B, 0xA3, 0xF0, 0x90, 0x83, 0xE9, 0xE0, 0xFF, 0x12, 0x5D, 0x99, 0x90, 0x89, - 0x47, 0xEF, 0xF0, 0xF9, 0xE0, 0xFE, 0x24, 0x21, 0x12, 0x4F, 0xCB, 0x74, 0x41, 0xF0, 0xEE, 0x24, - 0x20, 0xFD, 0xE4, 0x33, 0xFC, 0x90, 0x89, 0x48, 0xE0, 0x7A, 0x00, 0x2D, 0xFE, 0xEA, 0x3C, 0x90, - 0x89, 0x4C, 0xF0, 0xA3, 0xCE, 0xF0, 0x74, 0x20, 0x29, 0x12, 0x5F, 0xC6, 0x90, 0x89, 0x32, 0xE0, - 0xFD, 0x12, 0x5F, 0x2B, 0xD1, 0x02, 0x90, 0x89, 0x4C, 0xE0, 0xFF, 0xA3, 0xE0, 0x90, 0x89, 0x4A, - 0xCF, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x89, 0x50, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0xE4, - 0xA3, 0xF0, 0xA3, 0x74, 0x5F, 0xF0, 0x90, 0x89, 0x4C, 0xE4, 0x75, 0xF0, 0x04, 0x12, 0x43, 0xF6, - 0x90, 0x82, 0xC6, 0xE0, 0xFF, 0x7E, 0x02, 0xB4, 0xFE, 0x02, 0x7E, 0xFE, 0x90, 0x89, 0x4C, 0xA3, - 0xE0, 0xFD, 0xB1, 0xEE, 0xEE, 0xF0, 0x74, 0x00, 0x2D, 0xB1, 0xF0, 0xE0, 0x90, 0x89, 0x54, 0xF0, - 0x90, 0x89, 0x4C, 0x31, 0x1F, 0x90, 0x83, 0x5B, 0xE0, 0x90, 0x89, 0x30, 0xB4, 0x01, 0x0B, 0xE0, - 0x44, 0x03, 0xFC, 0xA3, 0xE0, 0x44, 0x10, 0xFD, 0x80, 0x09, 0xE0, 0x44, 0x03, 0xFC, 0xA3, 0xE0, - 0x44, 0x20, 0xFD, 0x90, 0x89, 0x4E, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x89, 0x55, 0x74, 0x03, - 0xF0, 0xA3, 0x74, 0x12, 0xF0, 0xD1, 0x2E, 0x12, 0x43, 0xF6, 0xEF, 0x64, 0xFE, 0x70, 0x25, 0x90, - 0x89, 0x4C, 0xA3, 0xE0, 0x24, 0x00, 0x12, 0x77, 0xD5, 0xC0, 0x03, 0x8B, 0x13, 0xD1, 0x72, 0xD0, - 0x03, 0x12, 0x2B, 0xED, 0x75, 0x13, 0x01, 0xD1, 0x72, 0x7B, 0x01, 0x7A, 0x89, 0x79, 0x57, 0x12, - 0x2B, 0xED, 0x80, 0x56, 0x90, 0x83, 0xE4, 0xE0, 0xFF, 0xB4, 0x02, 0x26, 0x90, 0x89, 0x4C, 0xE0, - 0xFC, 0xA3, 0xE0, 0xFD, 0x24, 0x00, 0xF5, 0x82, 0x74, 0xFC, 0x3C, 0xF5, 0x83, 0xE4, 0xF0, 0x74, - 0x01, 0x2D, 0xF5, 0x82, 0x74, 0xFC, 0x3C, 0xF5, 0x83, 0x74, 0x20, 0xD1, 0x36, 0x74, 0x20, 0xF0, - 0x80, 0x28, 0xEF, 0xB4, 0x04, 0x24, 0x90, 0x89, 0x4C, 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, 0x74, 0x10, 0xD1, 0x36, 0x74, 0x10, 0xF0, 0xD1, 0x2E, 0x12, 0x43, 0xF6, 0xE4, - 0x90, 0x89, 0x49, 0xF0, 0xD1, 0x86, 0xE0, 0xFE, 0x90, 0x89, 0x4C, 0xA3, 0xE0, 0xFD, 0xEF, 0x2D, - 0xB1, 0xEE, 0xEE, 0xF0, 0xD1, 0x86, 0xE0, 0xFE, 0x74, 0x59, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x89, - 0xF5, 0x83, 0xEE, 0xD1, 0x26, 0xE0, 0xB4, 0x08, 0xDB, 0xD1, 0x0C, 0x90, 0x89, 0x4C, 0xE4, 0x75, - 0xF0, 0x20, 0x12, 0x43, 0xF6, 0x90, 0x89, 0x4C, 0xB1, 0xFB, 0xD1, 0x02, 0x7B, 0x01, 0x7A, 0x89, - 0x79, 0x50, 0x90, 0x89, 0xD7, 0x12, 0x44, 0x72, 0x90, 0x89, 0xDA, 0x74, 0x63, 0xF0, 0x7A, 0x89, - 0x79, 0x33, 0xA3, 0x12, 0x44, 0x72, 0x7A, 0x82, 0x79, 0x82, 0x7D, 0x10, 0x31, 0x26, 0xE4, 0x90, - 0x89, 0x49, 0xF0, 0x90, 0x89, 0x49, 0xE0, 0xFF, 0xC3, 0x94, 0x10, 0x50, 0x3B, 0x90, 0x89, 0x4D, - 0xE0, 0x2F, 0xFF, 0x90, 0x89, 0x4C, 0xE0, 0x34, 0x00, 0xFE, 0x90, 0x89, 0xD0, 0xF0, 0xA3, 0xEF, - 0xF0, 0x90, 0x83, 0xE9, 0xE0, 0xFD, 0x12, 0x87, 0x25, 0x90, 0x89, 0x47, 0xEF, 0xF0, 0x90, 0x89, - 0x49, 0xE0, 0x24, 0x33, 0xF5, 0x82, 0xE4, 0x34, 0x89, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0x89, 0x47, - 0xE0, 0xB1, 0xEE, 0xEF, 0xD1, 0x26, 0x80, 0xBB, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x1F, 0x90, 0x05, - 0x22, 0xE0, 0x90, 0x89, 0xD2, 0xF0, 0x7D, 0x1D, 0x12, 0x4D, 0xCD, 0xBF, 0x01, 0x03, 0xF1, 0x1E, - 0xF0, 0x90, 0x89, 0xD2, 0xE0, 0xFF, 0x7D, 0x1E, 0x12, 0x4D, 0xC2, 0x80, 0x03, 0xF1, 0x1E, 0xF0, - 0x12, 0x5B, 0x22, 0x90, 0x81, 0x4E, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x4D, 0x7A, 0x74, 0x8A, - 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x6B, 0xA3, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x24, 0x00, - 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0x90, 0x8A, 0x1F, 0xE4, 0x75, 0xF0, 0x10, 0x02, - 0x43, 0xF6, 0x90, 0x89, 0x4C, 0xE4, 0x75, 0xF0, 0x08, 0x12, 0x43, 0xF6, 0x90, 0x89, 0x4C, 0xE4, - 0x75, 0xF0, 0x08, 0x02, 0x43, 0xF6, 0x24, 0xEB, 0xF9, 0xE4, 0x34, 0x89, 0xFA, 0x22, 0x24, 0xCC, - 0xF9, 0xEA, 0x34, 0xFF, 0xFA, 0x22, 0xF0, 0x90, 0x89, 0x49, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x89, - 0x4C, 0xE4, 0x75, 0xF0, 0x02, 0x22, 0xF0, 0xE4, 0x90, 0x89, 0x57, 0xF0, 0xA3, 0x22, 0xC3, 0xEF, - 0x94, 0x40, 0xEE, 0x94, 0x00, 0x22, 0xE0, 0xFF, 0xF5, 0x82, 0x75, 0x83, 0x00, 0x22, 0xE4, 0xF0, - 0x90, 0x8A, 0x22, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x8A, 0x20, 0xE0, 0x54, 0x3F, 0x64, 0x30, 0x22, - 0x90, 0x8A, 0x1F, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x90, 0x8A, 0x22, 0xE0, 0xFF, 0xC3, 0x94, - 0x40, 0x22, 0x75, 0x14, 0x82, 0x75, 0x15, 0xC9, 0x75, 0x16, 0x02, 0x22, 0x12, 0x1F, 0xFC, 0xE4, - 0x90, 0x8A, 0x1F, 0xF0, 0xA3, 0x22, 0x90, 0x89, 0x49, 0xE0, 0xFF, 0x24, 0xCB, 0xF5, 0x82, 0xE4, - 0x34, 0x82, 0xF5, 0x83, 0x22, 0x90, 0x89, 0xD6, 0xE0, 0xF5, 0x16, 0x7B, 0x01, 0x7A, 0x89, 0x79, - 0xDF, 0x12, 0x2B, 0xED, 0xE4, 0x22, 0xA3, 0xE0, 0x44, 0x8B, 0xFD, 0x12, 0x28, 0x08, 0x90, 0x8A, - 0x21, 0xE0, 0x44, 0x90, 0x90, 0x01, 0x8C, 0xF0, 0x22, 0xA3, 0x74, 0x40, 0xF0, 0x74, 0xDF, 0x2F, - 0xF9, 0xE4, 0x34, 0x89, 0xFA, 0x7B, 0x01, 0x74, 0x40, 0x44, 0x88, 0xFD, 0x12, 0x28, 0x08, 0x90, - 0x8A, 0x1F, 0xA3, 0xE0, 0x24, 0xE3, 0xF9, 0xE4, 0x34, 0x89, 0xFA, 0x7B, 0x01, 0xA3, 0xE0, 0x44, - 0x89, 0xFD, 0x12, 0x28, 0x08, 0x90, 0x8A, 0x1F, 0xA3, 0xE0, 0x24, 0xE7, 0xF9, 0xE4, 0x34, 0x89, - 0xFA, 0x7B, 0x01, 0xA3, 0xE0, 0x44, 0x8A, 0xFD, 0x12, 0x28, 0x08, 0x90, 0x8A, 0x1F, 0xA3, 0xE0, - 0x22, 0x90, 0x89, 0x2F, 0xED, 0xF0, 0x90, 0x89, 0x2D, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x92, - 0x9D, 0x90, 0x89, 0x2D, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x61, 0x8A, 0x90, 0x83, - 0xE9, 0xE0, 0xFF, 0x90, 0x84, 0x74, 0x74, 0x08, 0xF0, 0x7B, 0x18, 0x7D, 0x01, 0x12, 0x5E, 0x03, - 0x90, 0x89, 0x47, 0xEF, 0xF0, 0x90, 0x83, 0xE9, 0xE0, 0x90, 0x04, 0x25, 0x22, 0xAD, 0x07, 0x90, - 0x83, 0x98, 0x31, 0x1F, 0x90, 0x83, 0x98, 0xE0, 0xFF, 0xAE, 0x05, 0x74, 0x04, 0x2E, 0x12, 0x77, - 0xCD, 0xEF, 0xF0, 0x90, 0x83, 0x98, 0xA3, 0xE0, 0xFF, 0x74, 0x05, 0x2E, 0x12, 0x8B, 0x92, 0xEF, - 0xF0, 0x22, 0xE4, 0x90, 0x84, 0x8D, 0xF0, 0xA3, 0xF0, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x23, - 0xC3, 0x90, 0x84, 0x8E, 0xE0, 0x94, 0xD0, 0x90, 0x84, 0x8D, 0xE0, 0x94, 0x07, 0x40, 0x0A, 0x90, - 0x01, 0xC1, 0xE0, 0x44, 0x04, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0x84, 0x8D, 0x31, 0x1F, 0x12, 0x82, - 0xEB, 0x80, 0xD6, 0x7F, 0x01, 0x22, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, 0x48, 0xC5, 0x90, - 0x89, 0x0F, 0xEF, 0xF0, 0x60, 0xF0, 0x90, 0x80, 0x01, 0xE0, 0xFF, 0x70, 0x04, 0xA3, 0xE0, 0x60, - 0xE5, 0xC2, 0xAF, 0xEF, 0x30, 0xE1, 0x0A, 0x90, 0x80, 0x01, 0xE0, 0x54, 0xFD, 0xF0, 0x12, 0x81, - 0x6C, 0xF1, 0xE0, 0x30, 0xE2, 0x06, 0x54, 0xFB, 0xF0, 0x12, 0x82, 0x7E, 0xF1, 0xE0, 0x30, 0xE4, - 0x0B, 0x54, 0xEF, 0xF0, 0xF1, 0x62, 0xBF, 0x01, 0x03, 0x12, 0x8C, 0x6D, 0xD2, 0xAF, 0x80, 0xC6, - 0xD2, 0xAF, 0xC2, 0xAF, 0x90, 0x80, 0x01, 0xE0, 0xFF, 0x22, 0x22, 0x90, 0x84, 0x1B, 0xEF, 0xF0, - 0xA3, 0xED, 0xF0, 0xA3, 0x12, 0x20, 0xDA, 0x00, 0x00, 0x00, 0x00, 0xE4, 0x90, 0x84, 0x29, 0xF0, - 0x7F, 0x24, 0x7E, 0x08, 0x12, 0x2D, 0x5C, 0x90, 0x84, 0x21, 0x12, 0x20, 0xCE, 0x90, 0x84, 0x1B, - 0xE0, 0xFB, 0x70, 0x04, 0x11, 0xD8, 0x80, 0x06, 0xEB, 0x11, 0xE7, 0x12, 0x2D, 0x5C, 0x90, 0x84, - 0x25, 0x12, 0x20, 0xCE, 0x90, 0x84, 0x1C, 0x12, 0x53, 0xCE, 0x78, 0x17, 0x31, 0x5A, 0xAA, 0x06, - 0xAB, 0x07, 0x90, 0x84, 0x25, 0x12, 0x44, 0x45, 0xED, 0x54, 0x7F, 0xFD, 0xEC, 0x54, 0x80, 0xFC, - 0x12, 0x44, 0x27, 0xEC, 0x44, 0x80, 0xFC, 0x90, 0x84, 0x25, 0x12, 0x20, 0xCE, 0x11, 0xD8, 0xEC, - 0x54, 0x7F, 0xFC, 0x11, 0xE1, 0x11, 0xFA, 0x90, 0x84, 0x1B, 0xE0, 0x11, 0xE7, 0xC0, 0x06, 0xC0, - 0x07, 0x90, 0x84, 0x25, 0x11, 0xDE, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x2E, 0xA2, 0x11, 0xD8, 0xEC, - 0x44, 0x80, 0xFC, 0x11, 0xE1, 0x11, 0xFA, 0x90, 0x84, 0x1B, 0xE0, 0x70, 0x04, 0x7F, 0x20, 0x80, - 0x09, 0x90, 0x84, 0x1B, 0xE0, 0xB4, 0x01, 0x16, 0x7F, 0x28, 0x7E, 0x08, 0x12, 0x2D, 0x5C, 0x78, - 0x08, 0x12, 0x20, 0xA8, 0xEF, 0x54, 0x01, 0xFF, 0xE4, 0x90, 0x84, 0x29, 0xEF, 0xF0, 0x90, 0x84, - 0x29, 0xE0, 0x90, 0x84, 0x1B, 0x60, 0x0E, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x66, 0xF5, 0x82, - 0xE4, 0x34, 0x87, 0x80, 0x0C, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x64, 0xF5, 0x82, 0xE4, 0x34, - 0x87, 0x11, 0xF2, 0x12, 0x2D, 0x5C, 0xED, 0x54, 0x0F, 0xFD, 0xE4, 0xFC, 0x90, 0x84, 0x1D, 0x12, - 0x20, 0xCE, 0x90, 0x84, 0x1D, 0x02, 0x44, 0x45, 0x90, 0x84, 0x21, 0x02, 0x44, 0x45, 0x12, 0x44, - 0x45, 0x90, 0x85, 0xBB, 0x02, 0x20, 0xCE, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x62, 0xF5, 0x82, 0xE4, - 0x34, 0x87, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x7F, 0x24, 0x7E, 0x08, 0x02, 0x2E, - 0xA2, 0x90, 0x84, 0x45, 0xEF, 0xF0, 0xAB, 0x05, 0x90, 0x84, 0x4B, 0x12, 0x20, 0xDA, 0x00, 0x00, - 0x00, 0x00, 0xAF, 0x03, 0xE4, 0xFC, 0xFD, 0xFE, 0x78, 0x14, 0x31, 0x5A, 0xAA, 0x06, 0xAB, 0x07, - 0x90, 0x84, 0x47, 0x12, 0x44, 0x45, 0xED, 0x54, 0x0F, 0xFD, 0xE4, 0xFC, 0x12, 0x44, 0x27, 0xEC, - 0x54, 0x0F, 0xFC, 0x90, 0x84, 0x4B, 0x12, 0x20, 0xCE, 0x90, 0x84, 0x45, 0xE0, 0x75, 0xF0, 0x08, - 0xA4, 0x24, 0x60, 0xF5, 0x82, 0xE4, 0x34, 0x87, 0x11, 0xF2, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x84, - 0x4B, 0x11, 0xDE, 0xD0, 0x07, 0xD0, 0x06, 0x02, 0x2E, 0xA2, 0x12, 0x20, 0xBB, 0xA8, 0x04, 0xA9, - 0x05, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 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, 0x51, 0xC8, 0x54, 0x7F, 0xFC, 0x90, 0x84, 0x75, 0x12, 0x20, 0xCE, 0x90, 0x84, 0x75, - 0x11, 0xDE, 0x7F, 0x7C, 0x31, 0xBE, 0x12, 0x20, 0xDA, 0xCC, 0xC0, 0x00, 0xC0, 0x31, 0xBC, 0x12, - 0x20, 0xDA, 0x00, 0xC0, 0x00, 0x14, 0x51, 0xC1, 0x90, 0x84, 0x59, 0x12, 0x20, 0xDA, 0x00, 0x03, - 0x3E, 0x60, 0xE4, 0xFD, 0xFF, 0x51, 0x28, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x8C, 0x7E, 0x08, - 0x12, 0x2E, 0xA2, 0x90, 0x85, 0xBB, 0x22, 0x7F, 0xFF, 0x12, 0x4D, 0xC2, 0xD3, 0x10, 0xAF, 0x01, - 0xC3, 0xC0, 0xD0, 0x12, 0x4D, 0xD1, 0x90, 0x85, 0xBB, 0x12, 0x20, 0xDA, 0xCC, 0xF0, 0x00, 0xC0, - 0x31, 0xBC, 0x12, 0x20, 0xDA, 0x00, 0x00, 0x00, 0x14, 0x51, 0xC1, 0x90, 0x84, 0x59, 0x12, 0x20, - 0xDA, 0x00, 0x00, 0x00, 0x00, 0xE4, 0xFD, 0xFF, 0x51, 0x28, 0x51, 0xC8, 0x44, 0x80, 0xFC, 0x90, - 0x84, 0x79, 0x12, 0x20, 0xCE, 0x90, 0x84, 0x79, 0x11, 0xDE, 0x7F, 0x7C, 0x7E, 0x08, 0x12, 0x2E, - 0xA2, 0x90, 0x01, 0x00, 0x74, 0x3F, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x05, 0x53, 0xE0, - 0x44, 0x20, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xC0, - 0x07, 0xC0, 0x05, 0x90, 0x84, 0x59, 0x12, 0x44, 0x45, 0x90, 0x84, 0x47, 0x12, 0x20, 0xCE, 0xD0, - 0x05, 0xD0, 0x07, 0x31, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEF, 0x60, 0x43, 0x90, 0x04, 0xEC, - 0xE0, 0x54, 0xDD, 0xF0, 0x90, 0x83, 0xE6, 0xE0, 0xFF, 0x60, 0x03, 0x12, 0x5F, 0xDC, 0x90, 0x01, - 0xC7, 0xE4, 0x12, 0x94, 0xE4, 0x51, 0xD8, 0xF1, 0xDD, 0x90, 0x06, 0x09, 0xE0, 0x54, 0xFE, 0xF0, - 0x7D, 0x35, 0x31, 0xC7, 0x90, 0x02, 0x86, 0xE0, 0x44, 0x04, 0xF0, 0xB1, 0x58, 0x51, 0xB3, 0x12, - 0x4D, 0xBC, 0xB1, 0x24, 0x90, 0x01, 0x34, 0x74, 0x08, 0xF0, 0xFD, 0xE4, 0xFF, 0x02, 0x50, 0xB9, - 0x90, 0x04, 0xEC, 0xE0, 0x44, 0x22, 0xF0, 0x7D, 0x08, 0xE4, 0xFF, 0x12, 0x51, 0xC0, 0x90, 0x06, - 0x90, 0xE0, 0x54, 0xF0, 0xF0, 0x90, 0x02, 0x86, 0xE0, 0x54, 0xFB, 0xF0, 0x91, 0xF8, 0x51, 0xB4, - 0x02, 0x61, 0x44, 0x22, 0x90, 0x81, 0xAF, 0x12, 0x86, 0xAD, 0x30, 0xE0, 0x03, 0x12, 0x58, 0xC9, - 0x22, 0x7F, 0x70, 0x7E, 0x0E, 0x02, 0x2E, 0xA2, 0x7F, 0x7C, 0x7E, 0x08, 0x12, 0x2D, 0x5C, 0xEC, - 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, - 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x84, 0x38, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, - 0xA3, 0xEB, 0xF0, 0xAA, 0x07, 0x90, 0x84, 0x3F, 0x12, 0x20, 0xDA, 0x00, 0x00, 0x00, 0x00, 0x91, - 0xDC, 0xF0, 0xEA, 0x24, 0xEF, 0x60, 0x30, 0x24, 0xD7, 0x70, 0x02, 0x81, 0x39, 0x24, 0x3A, 0x60, - 0x02, 0x81, 0x6E, 0x91, 0xB5, 0x24, 0x0A, 0x91, 0x94, 0xE4, 0xF0, 0xFE, 0x74, 0x00, 0x2F, 0x91, - 0xD4, 0x7D, 0x14, 0x7C, 0x00, 0x91, 0x8B, 0x7B, 0x00, 0x7A, 0x00, 0x79, 0x00, 0x91, 0xE6, 0x7D, - 0x14, 0x7C, 0x00, 0xE4, 0xFF, 0x81, 0x34, 0x90, 0x84, 0x38, 0xE4, 0x75, 0xF0, 0x14, 0x12, 0x43, - 0xF6, 0x90, 0x84, 0x38, 0xA3, 0xE0, 0xFB, 0xFF, 0x24, 0x06, 0xFC, 0xE4, 0x33, 0x90, 0x84, 0x43, - 0xF0, 0xA3, 0xCC, 0xF0, 0x90, 0x84, 0x43, 0xA3, 0xE0, 0x91, 0x9E, 0xE4, 0xF0, 0x74, 0x04, 0x2F, - 0xF1, 0xCD, 0xE0, 0xFE, 0xA9, 0x03, 0x74, 0x05, 0x29, 0x51, 0xD1, 0xFE, 0x90, 0x84, 0x3D, 0xF0, - 0xA3, 0xEF, 0xF0, 0x90, 0x84, 0x38, 0xE0, 0xFC, 0xA3, 0xE0, 0x2F, 0xFF, 0xEC, 0x3E, 0xFE, 0xD3, - 0xEF, 0x94, 0x00, 0xEE, 0x94, 0x01, 0x90, 0x84, 0x38, 0x40, 0x6B, 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, 0x91, 0x8B, 0x90, 0x84, 0x3A, 0xE0, 0x24, 0x01, 0xFF, 0xE4, 0x33, 0xA2, - 0xE7, 0x13, 0xEF, 0x13, 0x90, 0xFD, 0x10, 0xF0, 0x91, 0xCE, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, - 0xC0, 0x03, 0x7B, 0x01, 0x7A, 0xFC, 0x79, 0x00, 0x90, 0x84, 0x38, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, - 0xC3, 0xE4, 0x9F, 0xFF, 0x74, 0x01, 0x9E, 0xFE, 0x91, 0xBC, 0xE0, 0xC3, 0x9F, 0xFD, 0xEC, 0x9E, - 0xFC, 0x12, 0x24, 0xE4, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x44, 0x0C, 0x91, - 0x8E, 0x91, 0xDC, 0xF0, 0x80, 0x0E, 0xA3, 0xE0, 0x7E, 0x00, 0x24, 0x00, 0x91, 0xD4, 0x91, 0xBC, - 0xE0, 0xFD, 0x91, 0x8B, 0x90, 0x84, 0x38, 0x74, 0xFF, 0x75, 0xF0, 0xEC, 0x12, 0x43, 0xF6, 0x91, - 0xB5, 0x7E, 0x00, 0x24, 0x0C, 0xF9, 0xEE, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xC0, 0x02, 0xC0, 0x01, - 0x74, 0x10, 0x2F, 0xF9, 0xEE, 0x34, 0xFC, 0xFA, 0x91, 0xE6, 0x91, 0xBC, 0xE0, 0xFD, 0xD0, 0x01, - 0xD0, 0x02, 0x7F, 0x11, 0x12, 0x1C, 0x34, 0x80, 0x2D, 0x91, 0xB5, 0x24, 0x2A, 0x91, 0x94, 0xE4, - 0xF0, 0x74, 0x00, 0x2F, 0xF1, 0xD5, 0x7D, 0x48, 0x7C, 0x00, 0x91, 0x8B, 0x91, 0xC3, 0x12, 0x44, - 0x0C, 0xE4, 0xFD, 0xFC, 0x91, 0x8E, 0x91, 0xC3, 0x12, 0x44, 0x0C, 0x91, 0x8E, 0x90, 0x84, 0x3F, - 0x12, 0x44, 0x45, 0x12, 0x20, 0x9B, 0x90, 0x84, 0x3B, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x84, - 0x3B, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xEC, 0xFF, 0x90, 0x84, 0x43, 0xA3, 0xE0, 0xFE, 0x12, 0x6D, - 0xEE, 0xEF, 0x91, 0xA9, 0xED, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x24, 0xE4, 0x90, 0x84, - 0x3F, 0x02, 0x20, 0xCE, 0xFD, 0xE4, 0x33, 0x90, 0x84, 0x43, 0xF0, 0xA3, 0xED, 0xF0, 0xFE, 0x24, - 0x00, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x01, 0x2E, 0xF5, 0x82, 0xE4, - 0x34, 0xFC, 0xF5, 0x83, 0x22, 0x90, 0x84, 0x38, 0xA3, 0xE0, 0xFF, 0x22, 0x90, 0x84, 0x3D, 0xE0, - 0xFC, 0xA3, 0x22, 0x90, 0x84, 0x3F, 0x12, 0x44, 0x45, 0x78, 0x10, 0x12, 0x20, 0xA8, 0x90, 0x84, - 0x3F, 0x02, 0x44, 0x51, 0xF9, 0xEE, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0x22, 0x90, 0x84, 0x3A, 0xE0, - 0xC3, 0x13, 0x90, 0xFD, 0x10, 0x22, 0x90, 0x86, 0x55, 0x12, 0x44, 0x72, 0x90, 0x84, 0x3F, 0x12, - 0x44, 0x45, 0x90, 0x86, 0x58, 0x02, 0x20, 0xCE, 0x12, 0x90, 0xAF, 0x90, 0x83, 0xF5, 0xE0, 0xFF, - 0x12, 0x91, 0x18, 0x90, 0x01, 0x3F, 0x74, 0x04, 0xF0, 0x90, 0x80, 0x07, 0xE0, 0xFF, 0xB4, 0x01, - 0x07, 0x90, 0xFD, 0x00, 0xE0, 0x54, 0xEF, 0xF0, 0xEF, 0xB4, 0x01, 0x07, 0x90, 0xFE, 0x10, 0xE0, - 0x54, 0xFB, 0xF0, 0x22, 0xE4, 0xFF, 0x74, 0x18, 0xB1, 0x4E, 0xFE, 0x74, 0xBF, 0x2F, 0xF5, 0x82, - 0xE4, 0x34, 0x81, 0xF5, 0x83, 0xEE, 0xF0, 0x74, 0x10, 0xB1, 0x4E, 0xFE, 0x74, 0xB9, 0x2F, 0xF5, - 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0xB4, 0x06, 0xD9, 0x22, 0x2F, 0xF5, - 0x82, 0xE4, 0x34, 0x06, 0xF5, 0x83, 0xE0, 0x22, 0x12, 0x8F, 0xCB, 0xAD, 0x07, 0x90, 0x01, 0xC4, - 0x74, 0x58, 0xF0, 0x74, 0x75, 0xA3, 0xF0, 0xED, 0x64, 0x01, 0x60, 0x1D, 0xF1, 0x8B, 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, 0x80, 0x24, 0x12, 0x8F, 0xE1, 0x90, 0x02, 0x87, 0xE0, - 0x70, 0xF7, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x02, 0xF0, 0x74, 0x58, 0x04, 0x90, 0x01, 0xC4, 0xF0, - 0x74, 0x75, 0xA3, 0xF0, 0x22, 0x90, 0x01, 0xC7, 0x74, 0x10, 0xF0, 0x7F, 0x01, 0x90, 0x84, 0x96, - 0xEF, 0xF0, 0x90, 0x80, 0x07, 0xE0, 0x64, 0x02, 0x70, 0x1F, 0x90, 0x84, 0x96, 0xE0, 0xFD, 0x64, - 0x01, 0x70, 0x32, 0xF1, 0x8B, 0xF0, 0x12, 0x86, 0xEC, 0x30, 0xE0, 0x09, 0x90, 0x01, 0x4D, 0xE0, - 0x64, 0x80, 0xF0, 0x80, 0x20, 0xAF, 0x05, 0x80, 0x19, 0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, 0x7F, - 0x64, 0x7E, 0x00, 0x12, 0x32, 0xAA, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x84, 0x96, - 0xE0, 0xFF, 0x12, 0x65, 0x02, 0x12, 0x67, 0x67, 0xF0, 0x90, 0x81, 0xAF, 0xE0, 0x54, 0xBF, 0xF0, - 0x22, 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, - 0x89, 0x2B, 0xF0, 0xA3, 0xEF, 0xF0, 0x7E, 0x00, 0x7F, 0x83, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x82, - 0x79, 0xC2, 0x12, 0x46, 0x4B, 0x90, 0x89, 0x2C, 0xE0, 0x24, 0x01, 0xF1, 0x28, 0x90, 0x82, 0xC3, - 0xF1, 0x34, 0x24, 0x04, 0xF1, 0x28, 0x90, 0x82, 0xC6, 0xF1, 0x34, 0x24, 0x05, 0xF1, 0x28, 0x90, - 0x82, 0xC7, 0xF1, 0x34, 0x24, 0x06, 0xF1, 0x28, 0x90, 0x82, 0xC8, 0xF1, 0x34, 0x24, 0x07, 0xF1, - 0x28, 0x90, 0x82, 0xC9, 0xF1, 0x34, 0x24, 0x08, 0xF1, 0x28, 0x90, 0x82, 0xCA, 0xEF, 0xF0, 0xE4, - 0x90, 0x89, 0x2A, 0xF0, 0x90, 0x89, 0x2A, 0xE0, 0xFF, 0xC3, 0x94, 0x08, 0x50, 0x19, 0x90, 0x89, - 0x2C, 0xE0, 0x24, 0x09, 0xFD, 0x90, 0x89, 0x2B, 0xE0, 0xF1, 0x50, 0x90, 0x89, 0x2A, 0xE0, 0x12, - 0x6E, 0x8B, 0xF1, 0x92, 0xF0, 0x80, 0xDD, 0xE4, 0x90, 0x89, 0x2A, 0xF0, 0x90, 0x89, 0x2A, 0xE0, - 0xFF, 0xC3, 0x94, 0x20, 0x50, 0x1F, 0x90, 0x89, 0x2C, 0xE0, 0x24, 0x63, 0xFD, 0x90, 0x89, 0x2B, - 0xE0, 0xF1, 0x50, 0x90, 0x89, 0x2A, 0xE0, 0x24, 0x25, 0xF5, 0x82, 0xE4, 0x34, 0x83, 0xF5, 0x83, - 0xF1, 0x92, 0xF0, 0x80, 0xD7, 0x90, 0x82, 0xC7, 0x12, 0x93, 0x77, 0x90, 0x89, 0x28, 0xEE, 0xF0, - 0xA3, 0xEF, 0xF0, 0x30, 0xE3, 0x0C, 0x7F, 0x01, 0xB1, 0xAD, 0x90, 0x01, 0xC7, 0x74, 0x03, 0xF0, - 0x80, 0x3F, 0x90, 0x89, 0x28, 0xA3, 0xE0, 0xFF, 0x7C, 0x00, 0x54, 0x07, 0xFD, 0x64, 0x01, 0x60, - 0x05, 0xED, 0x64, 0x02, 0x70, 0x2B, 0xED, 0x64, 0x02, 0x4C, 0x70, 0x25, 0xEF, 0x54, 0x30, 0xFF, - 0xE4, 0xC4, 0xF8, 0x54, 0xF0, 0xC8, 0xEF, 0xC4, 0x54, 0x0F, 0x48, 0x90, 0x83, 0x5B, 0xF0, 0xAE, - 0x04, 0xAF, 0x05, 0xE4, 0xFD, 0x12, 0x6F, 0x01, 0x90, 0x06, 0x31, 0xE0, 0x54, 0xF7, 0x44, 0x10, - 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xFF, 0x90, 0x89, 0x2B, 0xE0, 0x34, 0x00, 0xFE, - 0xE4, 0xFD, 0x80, 0x29, 0xEF, 0xF0, 0x90, 0x89, 0x2C, 0xE0, 0x22, 0x90, 0x89, 0x24, 0xE0, 0xFD, - 0x90, 0x89, 0x23, 0xE0, 0x2D, 0xFD, 0x90, 0x89, 0x22, 0xE0, 0x34, 0x00, 0xCD, 0x24, 0x10, 0xCD, - 0x34, 0x00, 0xFC, 0x7E, 0x00, 0xED, 0x2F, 0xFF, 0xEE, 0x3C, 0xFE, 0xE4, 0xFD, 0xAB, 0x07, 0xAA, - 0x06, 0xED, 0x2B, 0xFB, 0xE4, 0x3A, 0xFA, 0xC3, 0x90, 0x81, 0x3C, 0xE0, 0x9B, 0x90, 0x81, 0x3B, - 0xE0, 0x9A, 0x50, 0x0E, 0xA3, 0x12, 0x90, 0xA6, 0x34, 0x00, 0xFE, 0xC3, 0xEB, 0x9F, 0xFB, 0xEA, - 0x9E, 0xFA, 0x12, 0x90, 0x9E, 0x12, 0x7F, 0x82, 0xFF, 0x22, 0xF0, 0x90, 0x81, 0xB8, 0xE0, 0x44, - 0x01, 0x22, 0xEF, 0xF0, 0x90, 0x89, 0x2A, 0xE0, 0x04, 0x22, 0x90, 0x89, 0x4F, 0x12, 0x7D, 0xEB, - 0x2F, 0xFF, 0xE4, 0x3E, 0xCF, 0x24, 0x06, 0xCF, 0xF1, 0x2D, 0xBF, 0x86, 0x1D, 0x90, 0x89, 0x51, - 0xE0, 0xFF, 0x90, 0x89, 0x50, 0xE0, 0x2F, 0xFF, 0x90, 0x89, 0x4F, 0xE0, 0x34, 0x00, 0xCF, 0x24, - 0x07, 0xCF, 0xF1, 0x2D, 0xBF, 0xDD, 0x03, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, 0xF5, 0x82, 0xE4, - 0x34, 0xFC, 0xF5, 0x83, 0x22, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0x22, 0x90, 0x81, 0x3B, - 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x6F, 0xEB, 0xD0, - 0xD0, 0x92, 0xAF, 0x22, 0xFF, 0x90, 0x81, 0x53, 0xE0, 0x2F, 0xF5, 0x1E, 0xE4, 0xFB, 0xFD, 0x7F, - 0x54, 0x7E, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8E, 0x19, 0x8F, 0x1A, 0xE5, 0x1E, - 0x11, 0x5C, 0x85, 0x19, 0x83, 0x85, 0x1A, 0x82, 0xF0, 0xE5, 0x1D, 0x11, 0x5C, 0xFF, 0xE5, 0x1E, - 0x13, 0x13, 0x13, 0x54, 0x1F, 0x4F, 0xA3, 0xF0, 0xEB, 0x11, 0x5C, 0xFF, 0xE5, 0x1D, 0x13, 0x13, - 0x13, 0x54, 0x1F, 0x4F, 0x85, 0x1A, 0x82, 0x85, 0x19, 0x83, 0xA3, 0xA3, 0xF0, 0xBD, 0x01, 0x0D, - 0x85, 0x1A, 0x82, 0x8E, 0x83, 0xA3, 0xA3, 0xA3, 0x74, 0x03, 0xF0, 0x80, 0x05, 0x11, 0x63, 0x74, - 0x01, 0xF0, 0x11, 0x63, 0x74, 0x05, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x54, 0x07, 0xC4, 0x33, - 0x54, 0xE0, 0x22, 0x85, 0x1A, 0x82, 0x85, 0x19, 0x83, 0xA3, 0xA3, 0xA3, 0x22, 0x90, 0x81, 0x46, - 0x31, 0x53, 0x30, 0xE0, 0x05, 0x90, 0x01, 0x5B, 0xE4, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x02, 0xF0, - 0x90, 0x01, 0x3C, 0x74, 0x04, 0xF0, 0xE4, 0xF5, 0x1D, 0x90, 0x81, 0xAA, 0xE0, 0xC3, 0x13, 0x54, - 0x7F, 0xF5, 0x1E, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, 0x01, 0x11, 0x03, 0x90, 0x81, 0x46, 0xE0, - 0x44, 0x08, 0xF0, 0x22, 0x90, 0x06, 0xA9, 0xE0, 0xF5, 0x4E, 0x54, 0xC0, 0x70, 0x09, 0x11, 0xFA, - 0xF0, 0x54, 0xFD, 0xF0, 0x02, 0x57, 0xE2, 0xE5, 0x4E, 0x30, 0xE6, 0x1D, 0x90, 0x81, 0x4B, 0xE0, - 0x64, 0x01, 0x70, 0x18, 0x90, 0x81, 0x4F, 0xE0, 0x44, 0x01, 0x12, 0x67, 0x59, 0x64, 0x02, 0x60, - 0x04, 0x31, 0x2F, 0x80, 0x07, 0x31, 0x01, 0x80, 0x03, 0x11, 0xFA, 0xF0, 0xE5, 0x4E, 0x90, 0x81, - 0x4F, 0x30, 0xE7, 0x11, 0xE0, 0x44, 0x02, 0xF0, 0xF1, 0xCD, 0x12, 0x77, 0xFA, 0x90, 0x81, 0x46, - 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, 0x81, 0x4F, 0xE0, 0x54, 0xFE, - 0x22, 0x11, 0x6D, 0x90, 0x81, 0x4E, 0xE0, 0x64, 0x0C, 0x60, 0x09, 0x12, 0x4B, 0x9B, 0x12, 0x4F, - 0xEB, 0x12, 0x4E, 0x2B, 0x22, 0xE4, 0xFF, 0x12, 0x4F, 0x3C, 0xBF, 0x01, 0x11, 0x90, 0x81, 0x4B, - 0xE0, 0x60, 0x0B, 0x12, 0x67, 0x5A, 0x64, 0x02, 0x60, 0x02, 0x80, 0x03, 0x31, 0x01, 0x22, 0x90, - 0x04, 0x1D, 0xE0, 0x70, 0x1D, 0x90, 0x80, 0x4B, 0xE0, 0xFF, 0x90, 0x84, 0x74, 0x74, 0x09, 0xF0, - 0x7B, 0x18, 0xE4, 0xFD, 0x12, 0x5E, 0x03, 0x90, 0x89, 0x02, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, - 0x5B, 0x22, 0x22, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0x90, 0x89, 0x24, 0xED, 0xF0, 0xA3, - 0xEB, 0xF0, 0x90, 0x89, 0x22, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0x90, 0x89, 0x27, 0xF0, 0x90, - 0x89, 0x26, 0xF0, 0xFD, 0x12, 0x77, 0x5D, 0xEF, 0x54, 0x0C, 0x64, 0x08, 0x70, 0x64, 0x31, 0xE9, - 0xA3, 0xE0, 0x31, 0xF2, 0x64, 0x88, 0x70, 0x5A, 0x31, 0xE9, 0xA3, 0xE0, 0x24, 0x07, 0xFD, 0x12, - 0x77, 0x5D, 0xEF, 0x64, 0x8E, 0x70, 0x4B, 0x90, 0x89, 0x27, 0x04, 0x31, 0xE8, 0x31, 0xFA, 0x2D, - 0x04, 0xFD, 0x12, 0x77, 0x5D, 0xEF, 0x64, 0x03, 0x70, 0x38, 0x31, 0xE9, 0x31, 0xFA, 0x2D, 0x31, - 0xF2, 0x30, 0xE3, 0x07, 0x90, 0x01, 0xC7, 0x74, 0x01, 0x80, 0x23, 0x90, 0x81, 0xAF, 0x31, 0x53, - 0x30, 0xE0, 0x0A, 0x31, 0xE9, 0xA3, 0xE0, 0xFD, 0x12, 0x76, 0x01, 0x80, 0x15, 0x90, 0x81, 0xB2, - 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x09, 0x90, 0x01, 0xC7, 0x74, 0x02, 0x12, 0x77, - 0x8A, 0xF0, 0x90, 0x89, 0x27, 0xE0, 0xFF, 0x22, 0xF0, 0x90, 0x89, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, - 0xFF, 0x22, 0x24, 0x06, 0xFD, 0x12, 0x77, 0x5D, 0xEF, 0x22, 0x90, 0x89, 0x25, 0xE0, 0xFD, 0x90, - 0x89, 0x24, 0xE0, 0x22, 0xB1, 0xE8, 0xB1, 0xE1, 0x7B, 0xFF, 0x7A, 0x40, 0x79, 0xD4, 0xB1, 0x2F, - 0xD1, 0xD8, 0x7A, 0x40, 0x79, 0xDA, 0x91, 0xFC, 0x78, 0x3B, 0x7C, 0x89, 0x7D, 0x01, 0x7B, 0xFF, - 0x7A, 0x40, 0x79, 0xEA, 0x91, 0xFC, 0xE4, 0x90, 0x89, 0x4E, 0x31, 0xE8, 0xA3, 0xE0, 0xFD, 0x12, - 0x77, 0x9A, 0xEF, 0x64, 0x01, 0x60, 0x02, 0x61, 0x91, 0x71, 0x97, 0xCF, 0x24, 0x0E, 0xCF, 0x12, - 0x77, 0x2D, 0xEF, 0x64, 0x3A, 0x60, 0x02, 0x61, 0x91, 0x71, 0x97, 0xCF, 0x24, 0x30, 0xCF, 0x12, - 0x77, 0x2D, 0xEF, 0x64, 0x87, 0x60, 0x02, 0x61, 0x91, 0x90, 0x89, 0x4E, 0x04, 0xF0, 0xE4, 0x90, - 0x89, 0x4B, 0xF0, 0x91, 0xEA, 0x94, 0x10, 0x50, 0x19, 0x91, 0xDE, 0x71, 0xA2, 0xCD, 0x24, 0x38, - 0x12, 0x77, 0x4F, 0x90, 0x89, 0x4B, 0xE0, 0x24, 0x3B, 0xF5, 0x82, 0xE4, 0x34, 0x89, 0x91, 0xF1, - 0x80, 0xE1, 0xE4, 0x90, 0x89, 0x4C, 0xF0, 0x90, 0x89, 0x4C, 0xE0, 0xFF, 0xC3, 0x94, 0x02, 0x40, - 0x02, 0x61, 0x91, 0x75, 0xF0, 0x38, 0xEF, 0xB1, 0x03, 0x20, 0xE0, 0x02, 0x61, 0x91, 0xE4, 0x90, - 0x89, 0x4D, 0xF0, 0xB1, 0x14, 0x90, 0x81, 0xE9, 0x12, 0x44, 0x5D, 0xE0, 0xFE, 0x90, 0x89, 0x4D, - 0xE0, 0xC3, 0x9E, 0x40, 0x02, 0x61, 0x89, 0xEF, 0x75, 0xF0, 0x38, 0xA4, 0x24, 0x00, 0xF9, 0x74, - 0x82, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xE0, 0x75, 0xF0, 0x10, 0xA4, 0x29, 0xF9, 0xEA, 0x35, 0xF0, - 0xFA, 0x78, 0x3B, 0x7C, 0x89, 0xB1, 0x0B, 0xEF, 0x60, 0x02, 0x61, 0x7A, 0x90, 0x06, 0x33, 0xE0, - 0x44, 0x01, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0x89, 0x4B, 0xF0, 0x91, 0xEA, 0x94, 0x06, 0x50, 0x13, - 0x91, 0xDE, 0x71, 0xA2, 0xCD, 0x24, 0x4A, 0x12, 0x77, 0x4F, 0x90, 0x89, 0x4B, 0xD1, 0xCF, 0x91, - 0xF1, 0x80, 0xE7, 0xE4, 0x90, 0x89, 0x4B, 0xF0, 0x91, 0xEA, 0x94, 0x10, 0x50, 0x0C, 0x12, 0x77, - 0x3B, 0x90, 0x89, 0x4B, 0xD1, 0xC6, 0x91, 0xF1, 0x80, 0xEE, 0xB1, 0x14, 0xB1, 0x03, 0xFE, 0xC3, - 0x13, 0x30, 0xE0, 0x1A, 0xEF, 0x75, 0xF0, 0x38, 0xA4, 0x24, 0xF0, 0xF9, 0x74, 0x81, 0x35, 0xF0, - 0xFA, 0x7B, 0x01, 0x78, 0x2B, 0x7C, 0x89, 0xB1, 0x0B, 0xEF, 0x70, 0x45, 0x80, 0x00, 0x7B, 0x01, - 0x7A, 0x89, 0x79, 0x25, 0x90, 0x89, 0x52, 0x12, 0x44, 0x72, 0x7A, 0x89, 0x79, 0x3B, 0x90, 0x89, - 0x55, 0x12, 0x44, 0x72, 0x90, 0x89, 0x4C, 0xE0, 0x75, 0xF0, 0x38, 0xA4, 0x24, 0xEA, 0xF9, 0x74, - 0x81, 0x35, 0xF0, 0xFA, 0x90, 0x89, 0x58, 0x12, 0x44, 0x72, 0xE4, 0x90, 0x89, 0x5B, 0xF0, 0xA3, - 0xF0, 0x7A, 0x89, 0x79, 0x2B, 0x12, 0x59, 0xB0, 0x80, 0x07, 0x90, 0x06, 0x33, 0xE0, 0x44, 0x05, - 0xF0, 0x90, 0x89, 0x4D, 0xE0, 0x04, 0xF0, 0x41, 0xA3, 0x90, 0x89, 0x4C, 0xE0, 0x04, 0xF0, 0x41, - 0x87, 0x90, 0x89, 0x4E, 0xE0, 0xFF, 0x22, 0x90, 0x89, 0x24, 0xE0, 0xFF, 0x90, 0x89, 0x23, 0xE0, - 0x2F, 0xFF, 0x90, 0x89, 0x22, 0xE0, 0x34, 0x00, 0x22, 0xB1, 0xE8, 0xD1, 0xD8, 0x7A, 0x40, 0x79, - 0xC0, 0xB1, 0x2F, 0x78, 0x31, 0x7C, 0x89, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x40, 0x79, 0xC6, 0x7E, - 0x00, 0x7F, 0x04, 0x12, 0x43, 0xD0, 0x78, 0x35, 0x7C, 0x89, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x40, - 0x79, 0xCA, 0x7E, 0x00, 0x7F, 0x04, 0x12, 0x43, 0xD0, 0xE4, 0x90, 0x89, 0x3A, 0xF0, 0x71, 0x97, - 0xCF, 0x24, 0x06, 0xCF, 0x12, 0x77, 0x2D, 0xEF, 0x64, 0x08, 0x60, 0x02, 0x81, 0xCD, 0x71, 0x97, - 0xCF, 0x24, 0x07, 0xCF, 0x12, 0x77, 0x2D, 0xEF, 0x64, 0x06, 0x60, 0x02, 0x81, 0xCD, 0x90, 0x89, - 0x3A, 0x04, 0xF0, 0xE4, 0x90, 0x89, 0x39, 0xF0, 0xB1, 0x26, 0x50, 0x17, 0x90, 0x89, 0x23, 0xE0, - 0x24, 0x0A, 0xFD, 0x90, 0x89, 0x22, 0xE0, 0x12, 0x77, 0x50, 0x90, 0x89, 0x39, 0xD1, 0xCF, 0x91, - 0xD3, 0x80, 0xE5, 0xB1, 0xE1, 0x7B, 0x01, 0x7A, 0x81, 0x79, 0xBF, 0xF1, 0xC4, 0x60, 0x02, 0x81, - 0xCD, 0x90, 0x89, 0x39, 0xF0, 0xB1, 0x1D, 0x50, 0x19, 0x91, 0xDE, 0x71, 0xA2, 0xCD, 0x24, 0x20, - 0x12, 0x77, 0x4F, 0x90, 0x89, 0x39, 0xE0, 0x24, 0x35, 0xF5, 0x82, 0xE4, 0x34, 0x89, 0x91, 0xD3, - 0x80, 0xE3, 0x78, 0x35, 0x7C, 0x89, 0xD1, 0xE1, 0xEF, 0x70, 0x69, 0x90, 0x06, 0x30, 0xE0, 0x44, - 0x01, 0x54, 0xDF, 0xF0, 0x90, 0x81, 0xB1, 0xE0, 0x30, 0xE0, 0x0B, 0x90, 0x01, 0xC7, 0x74, 0x09, - 0x12, 0x77, 0x8A, 0xF0, 0x80, 0x57, 0xE4, 0x90, 0x89, 0x39, 0xF0, 0xB1, 0x26, 0x50, 0x0C, 0x12, - 0x77, 0x3B, 0x90, 0x89, 0x39, 0xD1, 0xC6, 0x91, 0xD3, 0x80, 0xF0, 0xE4, 0x90, 0x89, 0x39, 0xF0, - 0xB1, 0x1D, 0x50, 0x19, 0x91, 0xDE, 0x71, 0xA2, 0xCD, 0x24, 0x16, 0x12, 0x77, 0x4F, 0x90, 0x89, - 0x39, 0xE0, 0x24, 0x31, 0xF5, 0x82, 0xE4, 0x34, 0x89, 0x91, 0xD3, 0x80, 0xE3, 0x7B, 0x01, 0x7A, - 0x89, 0x79, 0x2B, 0xF1, 0xDD, 0x90, 0x84, 0x0F, 0xF0, 0xA3, 0xF0, 0x7A, 0x89, 0x79, 0x31, 0x12, - 0x5B, 0x36, 0x80, 0x09, 0x90, 0x06, 0x30, 0xE0, 0x44, 0x21, 0x54, 0xEF, 0xF0, 0x90, 0x89, 0x3A, - 0xE0, 0xFF, 0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x89, 0x39, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x89, - 0x24, 0xE0, 0xFD, 0x90, 0x89, 0x23, 0xE0, 0x2D, 0xFD, 0x22, 0x90, 0x89, 0x4B, 0xE0, 0xFF, 0xC3, - 0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x89, 0x4B, 0xE0, 0x04, 0xF0, 0x22, 0x7E, 0x00, 0x7F, 0x10, - 0x02, 0x43, 0xD0, 0x90, 0x81, 0xE8, 0x12, 0x44, 0x5D, 0xE0, 0x22, 0x7D, 0x01, 0x7E, 0x00, 0x7F, - 0x10, 0x02, 0x46, 0x27, 0x90, 0x89, 0x4C, 0xE0, 0xFF, 0x75, 0xF0, 0x38, 0x22, 0x90, 0x89, 0x39, - 0xE0, 0xFF, 0xC3, 0x94, 0x04, 0x22, 0x90, 0x89, 0x39, 0xE0, 0xFF, 0xC3, 0x94, 0x06, 0x22, 0x7E, - 0x00, 0x7F, 0x06, 0x02, 0x43, 0xD0, 0xB1, 0xE8, 0xB1, 0xE1, 0x7B, 0xFF, 0x7A, 0x40, 0x79, 0xFA, - 0xB1, 0x2F, 0x78, 0x2C, 0x7C, 0x89, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x41, 0x79, 0x00, 0x7E, 0x00, - 0x7F, 0x04, 0x12, 0x43, 0xD0, 0x90, 0x89, 0x22, 0xA3, 0xF1, 0x8E, 0x70, 0x02, 0xA1, 0xE0, 0x71, - 0x97, 0xFE, 0x90, 0x89, 0x30, 0xF0, 0xA3, 0xEF, 0xF0, 0x24, 0x06, 0xFF, 0xE4, 0x3E, 0x12, 0x77, - 0x2F, 0xEF, 0x64, 0x08, 0x70, 0x6A, 0x90, 0x89, 0x31, 0xE0, 0x24, 0x07, 0xFF, 0x90, 0x89, 0x30, - 0x12, 0x77, 0x2C, 0xEF, 0x70, 0x5A, 0x90, 0x89, 0x2B, 0xF0, 0x90, 0x89, 0x2B, 0xE0, 0xFF, 0xC3, - 0x94, 0x04, 0x50, 0x25, 0x90, 0x89, 0x31, 0xE0, 0x24, 0x18, 0xFD, 0x90, 0x89, 0x30, 0xE0, 0x12, - 0x77, 0x50, 0x90, 0x89, 0x2B, 0xE0, 0x24, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0x89, 0xF5, 0x83, 0xEF, - 0xF0, 0x90, 0x89, 0x2B, 0xE0, 0x04, 0xF0, 0x80, 0xD1, 0x78, 0x2C, 0x7C, 0x89, 0xD1, 0xE1, 0xEF, - 0x70, 0x1E, 0x90, 0x89, 0x31, 0xE0, 0x24, 0x08, 0xFF, 0x90, 0x89, 0x30, 0xE0, 0x34, 0x00, 0xFE, - 0xD1, 0x3A, 0xEF, 0x64, 0x01, 0x60, 0x09, 0x90, 0x01, 0xC7, 0x74, 0x22, 0x12, 0x77, 0x8A, 0xF0, - 0x22, 0x78, 0x25, 0x7C, 0x89, 0x7D, 0x01, 0x22, 0x90, 0x89, 0x22, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, - 0xA3, 0xED, 0xF0, 0x22, 0xB1, 0xE8, 0xE4, 0xA3, 0xF0, 0x90, 0x89, 0x25, 0xE0, 0xFF, 0xC3, 0x94, - 0x02, 0x50, 0x1F, 0xF1, 0x76, 0x71, 0xA2, 0xFC, 0x7E, 0x00, 0xED, 0x2F, 0xD1, 0xF0, 0x24, 0xC2, - 0xF5, 0x82, 0xE4, 0x34, 0x83, 0xF1, 0x7E, 0xB5, 0x06, 0x1D, 0x90, 0x89, 0x25, 0xE0, 0x04, 0xF0, - 0x80, 0xD7, 0x90, 0x06, 0x32, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0x01, 0xC7, 0x74, 0x30, 0xF0, 0x7F, - 0x01, 0x12, 0x75, 0xAD, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, 0x90, 0x89, 0x32, 0xEE, 0xF0, 0xA3, - 0xEF, 0xF0, 0x7D, 0x09, 0x12, 0x77, 0x5D, 0xEF, 0x64, 0x06, 0x70, 0x27, 0xD1, 0xBD, 0x7D, 0x14, - 0x12, 0x77, 0x5D, 0xEF, 0x70, 0x1D, 0xD1, 0xBD, 0x7D, 0x15, 0x12, 0x77, 0x5D, 0xEF, 0x64, 0x50, - 0x70, 0x11, 0xD1, 0xBD, 0x7D, 0x21, 0x12, 0x77, 0x5D, 0xEF, 0x20, 0xE0, 0x03, 0x30, 0xE2, 0x03, - 0x7F, 0x01, 0x22, 0x90, 0x81, 0xB0, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x3C, 0xD1, 0xBD, - 0x7D, 0x09, 0x12, 0x77, 0x5D, 0xEF, 0x64, 0x11, 0x70, 0x30, 0x90, 0x89, 0x33, 0xE0, 0x24, 0x14, - 0xFF, 0x90, 0x89, 0x32, 0xE0, 0x34, 0x00, 0xFE, 0x90, 0x89, 0x34, 0xF0, 0xA3, 0xEF, 0xF0, 0x7D, - 0x02, 0x12, 0x77, 0x5D, 0xEF, 0x70, 0x13, 0x90, 0x89, 0x34, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x7D, - 0x03, 0x12, 0x77, 0x5D, 0xBF, 0x89, 0x03, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, 0x90, 0x89, 0x32, - 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0xE0, 0x24, 0x2B, 0xF5, 0x82, 0xE4, 0x34, 0x89, 0x22, 0xE0, - 0x24, 0x25, 0xF5, 0x82, 0xE4, 0x34, 0x89, 0x22, 0x78, 0x2B, 0x7C, 0x89, 0x7D, 0x01, 0x7B, 0xFF, - 0x22, 0x7D, 0x01, 0x7B, 0x01, 0x7A, 0x81, 0x79, 0xDA, 0x7E, 0x00, 0x7F, 0x04, 0x02, 0x46, 0x27, - 0xFF, 0xEE, 0x3C, 0xFE, 0x90, 0x89, 0x24, 0xE0, 0xFD, 0xF1, 0x51, 0x90, 0x89, 0x25, 0xE0, 0x22, - 0xB1, 0xE8, 0x90, 0x83, 0x94, 0xE0, 0x70, 0x02, 0xA3, 0xE0, 0x60, 0x31, 0xE4, 0x90, 0x89, 0x25, - 0xF0, 0x90, 0x89, 0x25, 0xE0, 0xFE, 0xC3, 0x94, 0x02, 0x50, 0x25, 0xF1, 0x76, 0x71, 0xA2, 0xFC, - 0xEE, 0x7E, 0x00, 0x2D, 0xD1, 0xF0, 0x24, 0xA2, 0xF5, 0x82, 0xE4, 0x34, 0x83, 0xF1, 0x7E, 0x6E, - 0x60, 0x03, 0x7F, 0x00, 0x22, 0x90, 0x89, 0x25, 0xE0, 0x04, 0xF0, 0x80, 0xD4, 0x7F, 0x00, 0x22, - 0x90, 0x06, 0x32, 0xE0, 0x44, 0x40, 0xF0, 0xE4, 0x90, 0x83, 0xA0, 0xF0, 0xA3, 0xF0, 0x7F, 0x01, - 0x22, 0xC3, 0xEE, 0x94, 0x01, 0x40, 0x1E, 0x90, 0xFD, 0x11, 0xE0, 0xB5, 0x05, 0x14, 0x90, 0x01, - 0x17, 0xE0, 0xB5, 0x05, 0x07, 0x90, 0xFD, 0x11, 0xE4, 0xF0, 0x80, 0x06, 0xED, 0x04, 0x90, 0xFD, - 0x11, 0xF0, 0xE4, 0x2F, 0xFF, 0x22, 0x90, 0x89, 0x23, 0xE0, 0x24, 0x1C, 0xFD, 0x22, 0xF5, 0x83, - 0xE0, 0xFE, 0x74, 0x00, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x22, 0xE0, 0xFF, - 0xF1, 0x94, 0xEF, 0x22, 0xE4, 0xFE, 0xEF, 0x2E, 0xF1, 0xD5, 0xF5, 0x83, 0xE0, 0xFD, 0x74, 0x32, - 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x89, 0xF5, 0x83, 0xED, 0xF0, 0x0E, 0xEE, 0xB4, 0x06, 0xE7, 0x78, - 0xB9, 0x7C, 0x81, 0x7D, 0x01, 0x7B, 0x01, 0x7A, 0x89, 0x79, 0x32, 0xF1, 0xC4, 0x7F, 0x00, 0x70, - 0x02, 0x7F, 0x01, 0x22, 0x7E, 0x00, 0x7F, 0x06, 0x12, 0x46, 0x27, 0xEF, 0x22, 0xE4, 0xF5, 0x1D, - 0x90, 0x81, 0xA9, 0xE0, 0x22, 0x24, 0x04, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0x22, 0x90, 0x84, 0x0C, - 0x12, 0x44, 0x72, 0xE4, 0x22, 0x90, 0x84, 0x8F, 0xEF, 0xF0, 0x7F, 0x02, 0x12, 0x48, 0x9E, 0x90, - 0x80, 0x01, 0xE0, 0xFF, 0x90, 0x84, 0x8F, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x80, 0x01, 0xF0, 0x22, - 0x12, 0x1F, 0xA4, 0x54, 0x01, 0xFF, 0x90, 0x84, 0x08, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x22, 0x12, - 0x1F, 0xA4, 0x90, 0x81, 0xAE, 0xF0, 0x22, 0x90, 0x01, 0xCC, 0xE0, 0x54, 0x0F, 0x90, 0x84, 0x89, - 0xF0, 0x90, 0x84, 0x89, 0xE0, 0xFD, 0x70, 0x02, 0x21, 0x17, 0x90, 0x80, 0xA1, 0xE0, 0xFF, 0x70, - 0x06, 0xA3, 0xE0, 0x64, 0x09, 0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0x80, 0xA2, 0xE0, 0xB5, 0x07, - 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x08, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x01, - 0xF0, 0x22, 0x90, 0x84, 0x87, 0x31, 0x56, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, - 0xFF, 0xEF, 0x5D, 0x70, 0x02, 0x01, 0xF4, 0xE4, 0x90, 0x84, 0x8A, 0xF0, 0x90, 0x84, 0x8A, 0xE0, - 0xF9, 0xC3, 0x94, 0x04, 0x50, 0x2F, 0x31, 0x18, 0xFF, 0xE9, 0xFD, 0x7C, 0x00, 0x2F, 0xFF, 0xEC, - 0x35, 0xF0, 0xFE, 0x74, 0xD0, 0x31, 0x31, 0x90, 0x80, 0x51, 0x31, 0x21, 0x31, 0x18, 0x2D, 0xFF, - 0xEC, 0x35, 0xF0, 0xFE, 0x74, 0xF0, 0x31, 0x31, 0x90, 0x80, 0x55, 0x31, 0x21, 0x90, 0x84, 0x8A, - 0xE0, 0x04, 0xF0, 0x80, 0xC7, 0x90, 0x84, 0x89, 0xE0, 0xFF, 0x90, 0x84, 0x87, 0xE0, 0xFE, 0x74, - 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0x90, 0x84, 0x89, 0xF0, - 0x90, 0x84, 0x87, 0x12, 0x64, 0xFA, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x90, 0x01, 0xCC, 0xF0, - 0x90, 0x84, 0x87, 0xE0, 0x04, 0xF0, 0xE0, 0x54, 0x03, 0xF0, 0x90, 0x80, 0xA2, 0xE0, 0x04, 0xF0, - 0xE0, 0x7F, 0x00, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x70, 0x02, 0x01, 0x21, 0xE4, 0x90, 0x80, - 0xA2, 0xF0, 0x01, 0x21, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x84, 0x87, 0xE0, 0x44, - 0x80, 0x90, 0x00, 0x8A, 0xF0, 0x90, 0x84, 0x87, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD0, 0x12, - 0x44, 0x5D, 0xE0, 0x90, 0x01, 0xC3, 0xF0, 0x22, 0x90, 0x84, 0x87, 0xE0, 0x75, 0xF0, 0x04, 0xA4, - 0x22, 0x12, 0x44, 0x5D, 0xE5, 0x82, 0x29, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xEF, 0xF0, - 0x22, 0x2F, 0xF5, 0x82, 0x74, 0x01, 0x3E, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0x80, 0xA2, 0xE0, 0x75, - 0xF0, 0x08, 0x22, 0x11, 0x17, 0x7F, 0x02, 0x8F, 0x0F, 0x7F, 0x02, 0x12, 0x48, 0x9E, 0x90, 0x80, - 0x01, 0xE0, 0x45, 0x0F, 0xF0, 0x22, 0xE0, 0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x22, - 0x90, 0x81, 0xAF, 0xE0, 0x30, 0xE0, 0x04, 0x7F, 0x10, 0x31, 0x47, 0x22, 0xD3, 0x10, 0xAF, 0x01, - 0xC3, 0xC0, 0xD0, 0x90, 0x80, 0xA2, 0xE0, 0xFF, 0x90, 0x80, 0xA1, 0xE0, 0xB5, 0x07, 0x04, 0x7F, - 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x70, 0x43, 0x90, 0x80, 0xA1, 0xE0, 0xFE, 0x75, 0xF0, 0x08, - 0x90, 0x80, 0x51, 0x12, 0x44, 0x5D, 0xE0, 0xFD, 0xEE, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x52, 0xF9, - 0x74, 0x80, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xAF, 0x05, 0x12, 0x61, 0xA1, 0x90, 0x80, 0xA1, 0xE0, - 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0x80, - 0xA1, 0xF0, 0x11, 0x17, 0x90, 0x80, 0x01, 0xE0, 0x44, 0x02, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, - 0xE4, 0x90, 0x81, 0x39, 0xF0, 0xA3, 0xF0, 0x90, 0x80, 0xA1, 0xF0, 0xA3, 0xF0, 0x22, 0xD3, 0x10, - 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x84, 0x6D, 0xEE, 0x71, 0xDC, 0xA3, 0xF0, 0x90, 0x84, 0x6D, - 0xE0, 0xFE, 0xA3, 0xE0, 0xF5, 0x82, 0x8E, 0x83, 0xE0, 0x60, 0x24, 0xC3, 0x90, 0x84, 0x70, 0xE0, - 0x94, 0xE8, 0x90, 0x84, 0x6F, 0xE0, 0x94, 0x03, 0x40, 0x0B, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x80, - 0xF0, 0x7F, 0x00, 0x80, 0x0C, 0x90, 0x84, 0x6F, 0x12, 0x69, 0x1F, 0x51, 0xEB, 0x80, 0xCE, 0x7F, - 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x89, 0x10, - 0x12, 0x44, 0x72, 0x90, 0x84, 0x88, 0xE0, 0xFF, 0x04, 0xF0, 0x51, 0xF2, 0x7F, 0xAF, 0x7E, 0x01, - 0x31, 0xDE, 0xEF, 0x60, 0x34, 0x90, 0x89, 0x10, 0x12, 0x59, 0xA6, 0x90, 0x00, 0x0E, 0x12, 0x1F, - 0xBD, 0x24, 0x02, 0xF5, 0x16, 0x7B, 0x01, 0x7A, 0x01, 0x79, 0xA0, 0x12, 0x2B, 0xED, 0x90, 0x89, - 0x10, 0x12, 0x44, 0x69, 0x90, 0x00, 0x0E, 0x12, 0x1F, 0xBD, 0x90, 0x01, 0xAE, 0xF0, 0xA3, 0x74, - 0xFF, 0xF0, 0x90, 0x01, 0xCB, 0xE0, 0x64, 0x80, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, - 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x90, 0x81, 0x3A, 0xE0, 0xFE, 0x90, 0x81, 0x39, 0xE0, - 0xFD, 0xB5, 0x06, 0x04, 0x7E, 0x01, 0x80, 0x02, 0x7E, 0x00, 0xEE, 0x64, 0x01, 0x60, 0x47, 0x90, - 0x01, 0xAF, 0xE0, 0x70, 0x0C, 0xED, 0x71, 0xE4, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x51, 0x26, 0x7F, - 0x01, 0xEF, 0x60, 0x32, 0x90, 0x81, 0x39, 0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0xB4, 0x0A, 0x02, - 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0x81, 0x39, 0xF0, 0x90, 0x81, 0x3A, 0xE0, 0xFF, 0x90, - 0x81, 0x39, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x70, 0x07, 0x90, - 0x80, 0x01, 0xE0, 0x44, 0x04, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x0A, 0x7E, 0x00, 0x02, - 0x32, 0xAA, 0x90, 0x00, 0x01, 0xEF, 0x02, 0x1F, 0xFC, 0x90, 0x84, 0x2A, 0x12, 0x67, 0x61, 0x90, - 0x84, 0x2F, 0x12, 0x5F, 0xE7, 0x90, 0x84, 0x30, 0x12, 0x5F, 0xCE, 0x90, 0x84, 0x31, 0x12, 0x67, - 0x52, 0x90, 0x84, 0x32, 0x12, 0x67, 0x4B, 0x90, 0x84, 0x33, 0xF0, 0x90, 0x00, 0x07, 0x12, 0x1F, - 0xBD, 0x90, 0x84, 0x34, 0x12, 0x66, 0x68, 0x90, 0x84, 0x37, 0xF0, 0xED, 0x70, 0x19, 0xFF, 0x71, - 0xC9, 0xE0, 0xB4, 0xFF, 0x06, 0x71, 0xC9, 0xE4, 0xF0, 0x80, 0x07, 0x71, 0xC9, 0xE0, 0x04, 0xF0, - 0x80, 0x05, 0x0F, 0xEF, 0xB4, 0x06, 0xE8, 0x90, 0x84, 0x2E, 0xE0, 0xFF, 0xB4, 0x04, 0x18, 0xA3, - 0xE0, 0xFE, 0x71, 0xC3, 0xEE, 0x71, 0xD4, 0xFE, 0x71, 0xC3, 0x90, 0x00, 0x01, 0xEE, 0x12, 0x1F, - 0xFC, 0x90, 0x00, 0x02, 0xE4, 0x80, 0x1C, 0xEF, 0xB4, 0x02, 0x1B, 0x90, 0x84, 0x30, 0xE0, 0x71, - 0xC2, 0xEF, 0x71, 0xD4, 0x44, 0x20, 0x54, 0x7F, 0x71, 0xC2, 0x51, 0xF2, 0x90, 0x84, 0x2F, 0xE0, - 0x90, 0x00, 0x02, 0x12, 0x1F, 0xFC, 0x71, 0xC3, 0xE9, 0x24, 0x03, 0xF9, 0xE4, 0x3A, 0xFA, 0x12, - 0x1F, 0xA4, 0x44, 0x20, 0x12, 0x1F, 0xEA, 0x90, 0x84, 0x31, 0xE0, 0x71, 0xC2, 0x90, 0x00, 0x04, - 0xEF, 0x12, 0x1F, 0xFC, 0x90, 0x84, 0x32, 0xE0, 0x90, 0x00, 0x05, 0x12, 0x1F, 0xFC, 0x90, 0x84, - 0x33, 0xE0, 0x90, 0x00, 0x06, 0x12, 0x1F, 0xFC, 0x90, 0x84, 0x34, 0xE0, 0x90, 0x00, 0x07, 0x02, - 0x1F, 0xFC, 0xFF, 0x90, 0x84, 0x2A, 0x02, 0x44, 0x69, 0x74, 0x2F, 0x2F, 0xF5, 0x82, 0xE4, 0x34, - 0x84, 0xF5, 0x83, 0x22, 0x12, 0x1F, 0xEA, 0x90, 0x84, 0x30, 0xE0, 0x22, 0xF0, 0xA3, 0xEF, 0xF0, - 0xE4, 0xA3, 0xF0, 0x22, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0xA3, 0xF9, 0x74, 0x80, 0x22, 0xD3, 0x10, - 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x81, 0x39, 0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, - 0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0x81, 0x3A, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, - 0x7F, 0x00, 0xEF, 0x60, 0x09, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x2E, 0xC0, 0x01, - 0x90, 0x81, 0x3A, 0xE0, 0x71, 0xE4, 0x35, 0xF0, 0xA8, 0x01, 0xFC, 0x7D, 0x01, 0xD0, 0x01, 0x7E, - 0x00, 0x7F, 0x0F, 0x12, 0x43, 0xD0, 0x90, 0x81, 0x3A, 0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0xB4, - 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0x81, 0x3A, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, - 0x22, 0x90, 0x01, 0x34, 0x74, 0xFF, 0x12, 0x58, 0xC1, 0x90, 0x01, 0x3C, 0x12, 0x58, 0xC1, 0xFD, - 0x7F, 0x54, 0x12, 0x32, 0x1E, 0x7D, 0xFF, 0x7F, 0x55, 0x12, 0x32, 0x1E, 0x7D, 0xFF, 0x7F, 0x56, - 0x12, 0x32, 0x1E, 0x7D, 0xFF, 0x7F, 0x57, 0x02, 0x32, 0x1E, 0x75, 0x3D, 0x10, 0xE4, 0xF5, 0x3E, - 0x75, 0x3F, 0x07, 0x75, 0x40, 0x02, 0x90, 0x01, 0x30, 0xE5, 0x3D, 0xF0, 0xA3, 0xE5, 0x3E, 0xF0, - 0xA3, 0xE5, 0x3F, 0xF0, 0xA3, 0xE5, 0x40, 0xF0, 0x22, 0x75, 0x45, 0x06, 0x75, 0x46, 0x01, 0x75, - 0x47, 0x03, 0x75, 0x48, 0x62, 0x90, 0x01, 0x38, 0xE5, 0x45, 0xF0, 0xA3, 0xE5, 0x46, 0xF0, 0xA3, - 0xE5, 0x47, 0xF0, 0xA3, 0xE5, 0x48, 0xF0, 0x22, 0x90, 0x01, 0x94, 0xE0, 0x44, 0x01, 0xF0, 0x90, - 0x01, 0xC7, 0xE4, 0xF0, 0x22, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x01, 0x9C, 0x74, - 0x7E, 0xF0, 0xA3, 0x74, 0x92, 0xF0, 0xA3, 0x74, 0xA0, 0xF0, 0xA3, 0x74, 0x24, 0xF0, 0x90, 0x01, - 0x9B, 0x74, 0x49, 0xF0, 0x90, 0x01, 0x9A, 0x74, 0xE0, 0xF0, 0x90, 0x01, 0x99, 0xE4, 0xF0, 0x90, - 0x01, 0x98, 0x04, 0xF0, 0x22, 0xE4, 0x90, 0x89, 0x09, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x98, 0xE0, - 0x7F, 0x00, 0x30, 0xE4, 0x02, 0x7F, 0x01, 0xEF, 0x64, 0x01, 0x60, 0x3C, 0xC3, 0x90, 0x89, 0x0A, - 0xE0, 0x94, 0x88, 0x90, 0x89, 0x09, 0xE0, 0x94, 0x13, 0x40, 0x0F, 0x90, 0x01, 0xC1, 0xE0, 0x44, - 0x10, 0xF0, 0x90, 0x01, 0xC7, 0x74, 0xFD, 0xF0, 0x80, 0x1E, 0x90, 0x89, 0x09, 0x12, 0x69, 0x1F, - 0xB1, 0x4F, 0xD3, 0x90, 0x89, 0x0A, 0xE0, 0x94, 0x32, 0x90, 0x89, 0x09, 0xE0, 0x94, 0x00, 0x40, - 0xBB, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE3, 0xB4, 0x90, 0x01, 0xC7, 0x74, 0xFE, 0xF0, 0x22, 0x7F, - 0x14, 0x7E, 0x00, 0x02, 0x32, 0xAA, 0x7F, 0x02, 0x90, 0x83, 0xF6, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, - 0x50, 0x18, 0xEF, 0x25, 0xE0, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, 0xB8, 0x74, - 0x08, 0xF0, 0xA3, 0xF0, 0x7F, 0x00, 0x22, 0x0F, 0x80, 0xDE, 0x7F, 0x01, 0x22, 0xE4, 0x90, 0x80, - 0x01, 0x02, 0x58, 0xBF, 0x90, 0x01, 0xE4, 0x74, 0x17, 0xF0, 0xA3, 0xE4, 0xF0, 0x22, 0x90, 0x01, - 0x34, 0xE0, 0x55, 0x3D, 0xF5, 0x41, 0xA3, 0xE0, 0x55, 0x3E, 0xF5, 0x42, 0xA3, 0xE0, 0x55, 0x3F, - 0xF5, 0x43, 0xA3, 0xE0, 0x55, 0x40, 0xF5, 0x44, 0x90, 0x01, 0x34, 0xE5, 0x41, 0xF0, 0xA3, 0xE5, - 0x42, 0xF0, 0xA3, 0xE5, 0x43, 0xF0, 0xA3, 0xE5, 0x44, 0xF0, 0x22, 0x90, 0x01, 0x3C, 0xE0, 0x55, - 0x45, 0xF5, 0x49, 0xA3, 0xE0, 0x55, 0x46, 0xF5, 0x4A, 0xA3, 0xE0, 0x55, 0x47, 0xF5, 0x4B, 0xA3, - 0xE0, 0x55, 0x48, 0xF5, 0x4C, 0x90, 0x01, 0x3C, 0xE5, 0x49, 0xF0, 0xA3, 0xE5, 0x4A, 0xF0, 0xA3, - 0xE5, 0x4B, 0xF0, 0xA3, 0xE5, 0x4C, 0xF0, 0x53, 0x91, 0xDF, 0x22, 0x90, 0x01, 0xCF, 0xE0, 0x90, - 0x84, 0x92, 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, 0x58, 0x99, 0x90, 0x00, 0x03, 0xE0, 0x54, 0xFB, 0xFD, 0x7F, - 0x03, 0x12, 0x32, 0x1E, 0x80, 0xFE, 0x22, 0x90, 0x84, 0x01, 0xE0, 0x04, 0xF0, 0x90, 0x81, 0x4E, - 0xE0, 0x64, 0x02, 0x60, 0x09, 0x12, 0x50, 0xF5, 0x90, 0x01, 0xE6, 0xE0, 0x04, 0xF0, 0x22, 0xE4, - 0xFF, 0x12, 0x4F, 0x3C, 0xBF, 0x01, 0x11, 0x90, 0x81, 0x4B, 0xE0, 0x60, 0x0B, 0x12, 0x78, 0xFA, - 0xF0, 0x54, 0x07, 0x70, 0x03, 0x12, 0x57, 0xE2, 0x22, 0x90, 0x81, 0x4B, 0xE0, 0x60, 0x02, 0xD1, - 0x62, 0x22, 0x90, 0x81, 0x4B, 0xE0, 0x64, 0x01, 0x70, 0x1B, 0x12, 0x67, 0x5A, 0x60, 0x09, 0x12, - 0x4B, 0x9B, 0x12, 0x4F, 0xEB, 0x02, 0x78, 0x6D, 0x90, 0x81, 0x4E, 0xE0, 0x70, 0x07, 0x7D, 0x01, - 0x7F, 0x04, 0x12, 0x4B, 0x9F, 0x22, 0x90, 0x81, 0x46, 0xD1, 0xAD, 0x30, 0xE0, 0x1A, 0xEF, 0x54, - 0xBF, 0xD1, 0xB5, 0x30, 0xE0, 0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x09, 0xE0, 0x54, 0xFE, 0x12, - 0x4F, 0xF8, 0x74, 0x04, 0xF0, 0x12, 0x57, 0xE2, 0xE4, 0xFF, 0x02, 0x67, 0x6E, 0xE0, 0xFF, 0xC4, - 0x13, 0x13, 0x54, 0x03, 0x22, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0x81, 0x47, 0x22, 0x90, 0x81, - 0x46, 0xE0, 0xFF, 0xD1, 0xF0, 0x30, 0xE0, 0x1F, 0xEF, 0x54, 0x7F, 0xD1, 0xB5, 0x30, 0xE1, 0x06, - 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x08, 0xE0, 0x54, 0xFD, 0x12, 0x4F, 0xF8, 0x04, 0xF0, 0x90, 0x81, - 0x4B, 0xE0, 0x60, 0x03, 0x12, 0x57, 0xE2, 0x7F, 0x01, 0x02, 0x67, 0x6E, 0x90, 0x81, 0xB3, 0xE0, - 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x04, - 0x1D, 0xE0, 0x60, 0x1A, 0x90, 0x05, 0x22, 0xE0, 0x54, 0x90, 0x60, 0x07, 0x90, 0x01, 0xC0, 0xE0, - 0x44, 0x08, 0xF0, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE1, 0xE4, 0x7F, 0x00, 0x80, 0x02, 0x7F, 0x01, - 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xC3, 0xEE, 0x94, 0x01, 0x40, 0x0A, 0x0D, 0xED, 0x13, 0x90, 0xFD, - 0x10, 0xF0, 0xE4, 0x2F, 0xFF, 0x22, 0xE4, 0x90, 0x89, 0x07, 0xF0, 0xA3, 0xF0, 0x90, 0x00, 0x83, - 0xE0, 0x90, 0x89, 0x06, 0xF0, 0x90, 0x00, 0x83, 0xE0, 0xFE, 0x90, 0x89, 0x06, 0xE0, 0xFF, 0xB5, - 0x06, 0x01, 0x22, 0xC3, 0x90, 0x89, 0x08, 0xE0, 0x94, 0x64, 0x90, 0x89, 0x07, 0xE0, 0x94, 0x00, - 0x40, 0x0D, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0x89, 0x06, 0xE0, 0xFF, 0x22, 0x90, - 0x89, 0x07, 0x12, 0x69, 0x1F, 0x80, 0xC6, 0x90, 0x01, 0xC4, 0x74, 0x77, 0xF0, 0x74, 0x87, 0xA3, - 0xF0, 0x90, 0x00, 0x90, 0xE0, 0x20, 0xE0, 0xF9, 0x74, 0x77, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, - 0x87, 0xA3, 0xF0, 0x22, 0x7E, 0x00, 0x7F, 0x62, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x81, 0x79, 0x46, - 0x12, 0x46, 0x4B, 0x90, 0x81, 0x4A, 0x74, 0x02, 0xF0, 0x90, 0x81, 0x51, 0x14, 0xF0, 0xA3, 0xF0, - 0xA3, 0x74, 0x0A, 0xF0, 0x90, 0x81, 0x57, 0xE4, 0xF0, 0xA3, 0x74, 0x02, 0x12, 0x88, 0x4B, 0x12, - 0x8A, 0x28, 0xE4, 0xFD, 0xFF, 0x12, 0x4E, 0x80, 0x7D, 0x0C, 0x7F, 0x02, 0x12, 0x4E, 0x80, 0x12, - 0x4E, 0x7C, 0x90, 0x80, 0x07, 0xE0, 0xFF, 0xB4, 0x01, 0x08, 0x90, 0x81, 0x56, 0x74, 0x99, 0xF0, - 0x80, 0x29, 0xEF, 0xB4, 0x03, 0x08, 0x90, 0x81, 0x56, 0x74, 0x90, 0xF0, 0x80, 0x1D, 0x90, 0x81, - 0x56, 0x74, 0x40, 0xF0, 0x90, 0x00, 0x2C, 0xE0, 0x54, 0x0F, 0xFF, 0xBF, 0x05, 0x08, 0x90, 0x81, - 0x68, 0x74, 0x02, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x81, 0x68, 0xF0, 0x90, 0x81, 0xA8, 0x74, 0x03, - 0xF0, 0xA3, 0x74, 0x0F, 0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, 0x07, 0x11, - 0x4B, 0x7F, 0x01, 0x11, 0x5B, 0x90, 0x05, 0x58, 0x74, 0x02, 0xF0, 0x7E, 0x00, 0xFF, 0x7D, 0x00, - 0x7B, 0x01, 0x7A, 0x81, 0x79, 0xAC, 0x12, 0x46, 0x4B, 0x11, 0x82, 0xF0, 0x90, 0x06, 0x0A, 0xE0, - 0x54, 0xF8, 0x12, 0x4F, 0xEA, 0xE4, 0x90, 0x81, 0xAE, 0xF0, 0x22, 0xF0, 0x90, 0x81, 0x68, 0xE0, - 0x24, 0x04, 0x90, 0x81, 0x63, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0x22, 0xE4, 0xFE, 0x74, 0x69, 0x2E, - 0x11, 0xEB, 0xE4, 0xF0, 0x0E, 0xEE, 0xB4, 0x2D, 0xF4, 0xE4, 0x90, 0x81, 0x62, 0xF0, 0x90, 0x81, - 0x61, 0xF0, 0x90, 0x81, 0x65, 0xF0, 0xEF, 0xB4, 0x01, 0x07, 0xA3, 0x74, 0x2D, 0xF0, 0xE4, 0xA3, - 0xF0, 0x22, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, 0x22, 0x90, 0x84, 0x68, 0xE0, 0xFF, 0xD3, 0x10, - 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x84, 0x95, 0xEF, 0xF0, 0x90, 0x80, 0x4C, 0xE0, 0xFF, 0x90, - 0x04, 0x1C, 0xE0, 0x6F, 0x70, 0x40, 0x90, 0x81, 0x4E, 0xE0, 0x64, 0x0E, 0x70, 0x15, 0x90, 0x84, - 0x95, 0xE0, 0x70, 0x32, 0x90, 0x81, 0x46, 0xE0, 0x54, 0x7F, 0xF0, 0x11, 0x82, 0xF0, 0x12, 0x4E, - 0x7C, 0x80, 0x20, 0x90, 0x81, 0x4E, 0xE0, 0x64, 0x06, 0x70, 0x1B, 0x90, 0x84, 0x95, 0xE0, 0x60, - 0x15, 0x90, 0x81, 0x46, 0xE0, 0x54, 0xBF, 0xF0, 0x11, 0xF3, 0x44, 0x80, 0xF0, 0x90, 0x81, 0x4E, - 0x74, 0x04, 0xF0, 0x12, 0x4F, 0xEB, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x81, - 0xF5, 0x83, 0x22, 0x90, 0x06, 0x04, 0xE0, 0x44, 0x40, 0xF0, 0xE0, 0x22, 0x90, 0x04, 0x1A, 0xE0, - 0xF4, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x90, 0x04, 0x1B, 0xE0, 0x54, 0x07, 0x64, 0x07, 0x7F, 0x01, - 0x60, 0x02, 0x7F, 0x00, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x11, 0xFC, 0xEF, 0x64, - 0x01, 0x60, 0x05, 0x75, 0x56, 0x01, 0x80, 0x56, 0x90, 0x81, 0x4F, 0xE0, 0xFF, 0x54, 0x03, 0x60, - 0x05, 0x75, 0x56, 0x02, 0x80, 0x48, 0x90, 0x81, 0x4D, 0xE0, 0xFE, 0xE4, 0xC3, 0x9E, 0x50, 0x05, - 0x75, 0x56, 0x04, 0x80, 0x39, 0xEF, 0x30, 0xE2, 0x05, 0x75, 0x56, 0x08, 0x80, 0x30, 0x90, 0x81, - 0x4F, 0xE0, 0x30, 0xE4, 0x05, 0x75, 0x56, 0x10, 0x80, 0x24, 0x90, 0x81, 0x47, 0xE0, 0x13, 0x13, - 0x54, 0x3F, 0x20, 0xE0, 0x05, 0x75, 0x56, 0x20, 0x80, 0x14, 0x90, 0x81, 0xAE, 0xE0, 0x60, 0x05, - 0x75, 0x56, 0x80, 0x80, 0x09, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x80, 0x0E, 0x90, 0x01, - 0xB9, 0x74, 0x04, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x56, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, - 0x22, 0xEF, 0x24, 0xFE, 0x60, 0x0B, 0x04, 0x70, 0x24, 0x90, 0x81, 0x51, 0x74, 0x02, 0xF0, 0x80, - 0x13, 0xED, 0x70, 0x06, 0x90, 0x81, 0xAB, 0xE0, 0x80, 0x02, 0xED, 0x14, 0x90, 0x81, 0x51, 0xF0, - 0x90, 0x81, 0x51, 0xE0, 0xA3, 0xF0, 0x90, 0x81, 0x47, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0x90, 0x02, - 0x87, 0xE0, 0x60, 0x02, 0x80, 0x08, 0x90, 0x01, 0x00, 0xE0, 0x64, 0x3F, 0x60, 0x05, 0x75, 0x4F, - 0x01, 0x80, 0x46, 0x90, 0x81, 0xAF, 0xE0, 0x30, 0xE0, 0x0B, 0x90, 0x02, 0x82, 0xE0, 0x60, 0x05, - 0x75, 0x4F, 0x02, 0x80, 0x34, 0x90, 0x81, 0xB8, 0xE0, 0x30, 0xE0, 0x05, 0x75, 0x4F, 0x08, 0x80, - 0x28, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x02, 0x80, 0x07, 0x90, 0x02, 0x86, 0xE0, 0x30, 0xE3, - 0x05, 0x75, 0x4F, 0x04, 0x80, 0x13, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x05, 0x75, 0x4F, 0x40, 0x80, - 0x08, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x08, 0xF0, 0x90, - 0x01, 0xB8, 0xE5, 0x4F, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0x81, 0xA2, 0x74, 0x04, 0xF0, 0xA3, 0x14, - 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0x74, 0x64, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xF0, 0x22, 0x90, - 0x80, 0x4C, 0xE0, 0xFF, 0x90, 0x84, 0x69, 0xE0, 0xFB, 0x90, 0x84, 0x74, 0x74, 0x0A, 0xF0, 0x7D, - 0x01, 0x12, 0x5E, 0x03, 0x90, 0x84, 0x6A, 0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0x84, - 0x68, 0xE0, 0xFF, 0x12, 0x4F, 0x95, 0x90, 0x84, 0x6A, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x04, - 0x80, 0xE0, 0x54, 0x0F, 0xFD, 0xAC, 0x07, 0x51, 0xD9, 0xF5, 0x83, 0xE0, 0x44, 0x01, 0xF0, 0x51, - 0xD9, 0xF5, 0x83, 0xE0, 0x54, 0xFB, 0xF0, 0xAC, 0x07, 0x74, 0x16, 0x2C, 0x51, 0xE5, 0xE0, 0x44, - 0xFA, 0xF0, 0x74, 0x15, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x1F, 0xF0, - 0xAC, 0x07, 0x74, 0x06, 0x2C, 0x51, 0xED, 0x44, 0x0F, 0xF0, 0x90, 0x04, 0x53, 0xE4, 0xF0, 0x90, - 0x04, 0x52, 0xF0, 0x90, 0x04, 0x51, 0x74, 0xFF, 0xF0, 0x90, 0x04, 0x50, 0x74, 0xFD, 0xF0, 0x74, - 0x14, 0x2C, 0x51, 0xD1, 0xE0, 0x54, 0xC0, 0x4D, 0xFD, 0x74, 0x14, 0x2F, 0x51, 0xD1, 0xED, 0xF0, - 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0x74, 0x11, 0x2C, 0xF5, 0x82, 0xE4, 0x34, - 0xFC, 0x22, 0x74, 0x16, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0xF5, 0x82, 0xE4, - 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xE4, 0xFD, 0xFC, 0x90, 0x83, 0xF0, 0x71, 0xA2, 0xAD, 0x07, - 0xAB, 0x05, 0x74, 0x01, 0x2B, 0x12, 0x74, 0xAD, 0xE0, 0xFE, 0x74, 0x00, 0x2B, 0x12, 0x6D, 0xF0, - 0xE0, 0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x90, 0x83, 0x8E, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, - 0x03, 0x2B, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFE, 0x74, 0x02, 0x2B, 0xF5, 0x82, - 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x90, 0x83, 0x90, 0xF0, 0xA3, - 0xEF, 0xF0, 0x74, 0x05, 0x2B, 0x71, 0x92, 0xE0, 0xFE, 0x74, 0x04, 0x2B, 0x12, 0x77, 0xCD, 0xE0, - 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x90, 0x83, 0x92, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x07, 0x2B, 0xF5, - 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFE, 0x74, 0x06, 0x2B, 0x51, 0xED, 0x24, 0x00, 0xFF, - 0xEA, 0x3E, 0x90, 0x83, 0x94, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x09, 0x2B, 0x71, 0xAA, 0xFE, 0x74, - 0x08, 0x2B, 0x71, 0x9A, 0xE0, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x90, 0x83, 0x96, 0xF0, 0xA3, 0xEF, - 0xF0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, - 0x83, 0x22, 0xE0, 0xFF, 0x12, 0x5D, 0x99, 0x7C, 0x00, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, - 0x83, 0xE0, 0x22, 0xEF, 0x60, 0x05, 0x51, 0xF6, 0x12, 0x5C, 0xE2, 0x22, 0xE4, 0xFD, 0xFC, 0xEF, - 0x60, 0x25, 0x90, 0x83, 0xEA, 0x71, 0xA2, 0xAD, 0x07, 0x74, 0x00, 0x2F, 0x12, 0x77, 0xD5, 0x90, - 0x89, 0x14, 0x12, 0x44, 0x72, 0x90, 0x89, 0x14, 0x12, 0x59, 0xA6, 0x75, 0x16, 0x42, 0x7B, 0x01, - 0x7A, 0x82, 0x79, 0x80, 0x12, 0x2B, 0xED, 0x22, 0x90, 0x83, 0xF7, 0x12, 0x57, 0xEC, 0x30, 0xE0, - 0x13, 0x7B, 0x00, 0x7A, 0x00, 0x79, 0x00, 0x12, 0x7F, 0xDD, 0x90, 0x84, 0x0F, 0xF0, 0xA3, 0x04, - 0xF0, 0x02, 0x5B, 0x36, 0x02, 0x4E, 0x2B, 0x90, 0x83, 0xF7, 0xE0, 0x30, 0xE0, 0x34, 0x12, 0x4F, - 0x34, 0x70, 0x2F, 0x90, 0x84, 0x97, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x0A, 0x0B, 0x90, 0x83, 0xF9, - 0xE0, 0x04, 0xF0, 0xE4, 0x90, 0x84, 0x97, 0xF0, 0x90, 0x83, 0xF9, 0xE0, 0xFF, 0x90, 0x83, 0xF8, - 0xE0, 0xD3, 0x9F, 0x50, 0x0D, 0x90, 0x83, 0xFA, 0xE0, 0x70, 0x07, 0xE4, 0x90, 0x83, 0xF9, 0xF0, - 0x71, 0xE8, 0x22, 0x90, 0x83, 0xF7, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0x7F, 0xF0, 0x54, 0xFB, 0xF0, - 0xA3, 0x74, 0x0A, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, - 0x02, 0x84, 0xEF, 0xF0, 0xEE, 0xA3, 0xF0, 0xA3, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0xD3, 0x10, 0xAF, - 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x89, 0x18, 0x74, 0x08, 0xF0, 0xE4, 0x12, 0x58, 0xC0, 0x90, 0x89, - 0x1F, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xF1, 0x8F, 0x12, 0x72, 0xD8, 0xF1, 0x3E, 0x90, 0x02, 0x82, - 0xE0, 0x90, 0x89, 0x17, 0xF0, 0x90, 0x81, 0xAF, 0xE0, 0x20, 0xE0, 0x02, 0xE1, 0x21, 0x90, 0x81, - 0xB8, 0xE0, 0x20, 0xE0, 0x07, 0x90, 0x01, 0x3F, 0xE0, 0x30, 0xE2, 0x1A, 0x90, 0x80, 0x07, 0xE0, - 0xB4, 0x01, 0x0E, 0x90, 0xFD, 0x01, 0xE0, 0x20, 0xE6, 0x07, 0x90, 0xFD, 0x00, 0xE0, 0x44, 0x10, - 0xF0, 0x7F, 0x01, 0x12, 0x75, 0xAD, 0xE4, 0x90, 0x89, 0x16, 0xF0, 0x90, 0x89, 0x17, 0xE0, 0xFF, - 0x90, 0x89, 0x16, 0xE0, 0xC3, 0x9F, 0x40, 0x02, 0xE1, 0x21, 0xF1, 0x46, 0xFD, 0xEC, 0xFF, 0x90, - 0xFD, 0x11, 0xF0, 0xAE, 0x05, 0xAA, 0x06, 0x90, 0x89, 0x1A, 0xEF, 0xF0, 0x74, 0x02, 0x2A, 0xF1, - 0xA7, 0xFF, 0x74, 0x03, 0x2A, 0xF1, 0x86, 0x54, 0x03, 0xFE, 0xEF, 0x24, 0x18, 0x2E, 0x90, 0x89, - 0x1F, 0xF0, 0xE0, 0xFF, 0x2A, 0x90, 0x89, 0x12, 0xF0, 0x7E, 0x00, 0xF1, 0x46, 0x2F, 0xFF, 0xEE, - 0x3C, 0x90, 0x89, 0x13, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x89, 0x12, 0xE0, 0xFD, 0x24, 0x00, 0x12, - 0x7F, 0x85, 0xFE, 0x54, 0xFC, 0x90, 0x89, 0x15, 0xF0, 0xAF, 0x06, 0xF1, 0x4E, 0xFD, 0x90, 0x89, - 0x12, 0xE0, 0x12, 0x7F, 0xD5, 0x12, 0x5D, 0xD9, 0x90, 0x89, 0x19, 0xEF, 0xF0, 0x74, 0x01, 0x2A, - 0xF1, 0x51, 0xFE, 0x74, 0x00, 0x2A, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0x12, 0x72, 0xD6, 0x54, 0x3F, - 0xFE, 0x90, 0x89, 0x1B, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x89, 0x1F, 0xE0, 0x2F, 0xFF, 0xEC, 0x3E, - 0xFE, 0xF1, 0x5A, 0x74, 0x0F, 0x2A, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0xFD, 0x90, - 0x89, 0x10, 0xF1, 0x98, 0x90, 0x89, 0x10, 0xE0, 0xFA, 0xA3, 0xE0, 0xD3, 0x9F, 0xEA, 0x9E, 0x40, - 0x1D, 0x90, 0x89, 0x10, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x81, 0x3B, 0xE0, 0xFA, 0xA3, 0xE0, - 0x24, 0x01, 0xFB, 0xE4, 0x3A, 0xFA, 0xC3, 0xEF, 0x9B, 0xFF, 0xEE, 0x9A, 0xF1, 0x3E, 0xED, 0x30, - 0xE7, 0x06, 0x90, 0x01, 0xC7, 0x74, 0x21, 0xF0, 0xED, 0x30, 0xE6, 0x06, 0x90, 0x01, 0xC7, 0x74, - 0x22, 0xF0, 0xED, 0x30, 0xE5, 0x06, 0x90, 0x01, 0xC7, 0x74, 0x23, 0xF0, 0x90, 0x89, 0x15, 0xE0, - 0x24, 0xF8, 0x60, 0x2E, 0x24, 0x80, 0x60, 0x2A, 0x24, 0xC8, 0x60, 0x06, 0x24, 0x20, 0x60, 0x02, - 0xC1, 0xBE, 0x90, 0x81, 0xB2, 0xE0, 0xFF, 0x12, 0x86, 0xF0, 0x20, 0xE0, 0x02, 0xC1, 0xBE, 0x90, - 0x89, 0x12, 0x12, 0x7F, 0x8E, 0x70, 0x02, 0xC1, 0xBE, 0x90, 0x89, 0x15, 0xE0, 0xFF, 0xF1, 0xB7, - 0xC1, 0xBE, 0xF1, 0x7F, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x5A, 0x90, 0x89, 0x19, 0xE0, 0xFF, 0x90, - 0x89, 0x12, 0xE0, 0x2F, 0xFF, 0xE4, 0x33, 0xCF, 0x24, 0x08, 0xCF, 0x34, 0x00, 0x90, 0x89, 0x1D, - 0xF0, 0xA3, 0xEF, 0xF0, 0x24, 0x00, 0x12, 0x7F, 0x85, 0x64, 0x45, 0x70, 0x37, 0xF1, 0x27, 0x12, - 0x93, 0xE3, 0xEF, 0x64, 0x01, 0x70, 0x2D, 0xF1, 0x27, 0x12, 0x94, 0x00, 0xEF, 0x64, 0x01, 0x70, - 0x23, 0x90, 0x89, 0x21, 0x04, 0xF1, 0x26, 0x90, 0x89, 0x1A, 0xE0, 0xFD, 0x12, 0x7F, 0x00, 0x90, - 0x89, 0x1A, 0xE0, 0xFD, 0x90, 0xFD, 0x11, 0xF1, 0x26, 0x12, 0x7D, 0xF4, 0x90, 0x89, 0x1A, 0xE0, - 0x90, 0xFD, 0x11, 0xF0, 0x90, 0x89, 0x12, 0x12, 0x7F, 0x8E, 0x60, 0x1B, 0xF1, 0x30, 0x90, 0x89, - 0x18, 0xE0, 0xFB, 0x90, 0x89, 0x1A, 0xE0, 0x90, 0x89, 0x26, 0xF0, 0x12, 0x79, 0x5A, 0xEF, 0x60, - 0x06, 0x90, 0x89, 0x21, 0x74, 0x01, 0xF0, 0x90, 0x81, 0xAF, 0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x0E, - 0xF1, 0x30, 0x12, 0x7B, 0xA9, 0xEF, 0x60, 0x06, 0x90, 0x89, 0x21, 0x74, 0x01, 0xF0, 0x90, 0x81, - 0xAF, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x0F, 0x90, 0x89, 0x12, 0xE0, 0xFF, 0x7E, 0x00, - 0x90, 0x89, 0x19, 0xE0, 0xFD, 0x12, 0x7A, 0x04, 0x90, 0x81, 0xAF, 0xE0, 0xFF, 0x12, 0x86, 0xF0, - 0x30, 0xE0, 0x0B, 0x90, 0x89, 0x21, 0xE0, 0x70, 0x05, 0xF1, 0x30, 0x12, 0x7D, 0x36, 0x90, 0x81, - 0xB8, 0xE0, 0x20, 0xE0, 0x07, 0x90, 0x01, 0x3F, 0xE0, 0x30, 0xE2, 0x05, 0x7F, 0x01, 0x12, 0x75, - 0xAD, 0x90, 0x01, 0x3F, 0xE0, 0x30, 0xE2, 0x04, 0x12, 0x77, 0x8B, 0xF0, 0x12, 0x90, 0xC2, 0xEF, - 0x64, 0x01, 0x70, 0x3D, 0xF1, 0xCB, 0x90, 0x89, 0x20, 0xEF, 0xF0, 0x64, 0x01, 0x60, 0x25, 0x12, - 0x77, 0x8B, 0xF0, 0x90, 0x89, 0x20, 0xE0, 0xFF, 0xB4, 0x02, 0x08, 0x90, 0x01, 0xC7, 0x74, 0x42, - 0xF0, 0x80, 0x0A, 0xEF, 0xB4, 0x04, 0x06, 0x90, 0x01, 0xC7, 0x74, 0x43, 0xF0, 0x7F, 0x01, 0x12, - 0x75, 0xAD, 0x80, 0x0D, 0x90, 0x89, 0x10, 0x91, 0x5A, 0x90, 0x89, 0x16, 0xE0, 0x04, 0xF0, 0x81, - 0xCB, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, 0x90, 0x89, 0x1D, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, - 0x90, 0x89, 0x13, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x89, 0x19, 0xE0, 0xFD, 0x22, 0x90, 0x89, - 0x10, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0x90, 0x89, 0x10, 0xE0, 0xFC, 0xA3, 0xE0, 0x22, 0x74, 0x01, - 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x22, 0x7D, 0x7F, 0xEF, 0x5D, 0xC3, 0x60, - 0x0D, 0xF1, 0x75, 0xFE, 0xED, 0x5F, 0x24, 0x80, 0xFF, 0xE4, 0x3E, 0xFE, 0x80, 0x06, 0xF1, 0x75, - 0xFE, 0xED, 0x5F, 0xFF, 0x22, 0x74, 0xFF, 0x9D, 0xFD, 0x74, 0xFF, 0x94, 0x00, 0x5E, 0x22, 0x90, - 0x81, 0xAF, 0xE0, 0xC4, 0x13, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x22, 0x90, - 0x01, 0x1F, 0xE0, 0xFE, 0x90, 0x01, 0x1E, 0x22, 0xEE, 0x8F, 0xF0, 0x12, 0x43, 0xF6, 0x90, 0x81, - 0x3B, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, - 0x0F, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x22, 0xEF, 0x90, 0x01, 0xC7, 0xB4, 0xA0, 0x05, 0x74, 0x04, - 0xF0, 0x80, 0x03, 0x74, 0x08, 0xF0, 0x12, 0x77, 0x8B, 0xF0, 0x22, 0x90, 0x02, 0x86, 0xE0, 0x20, - 0xE2, 0x03, 0x7F, 0x04, 0x22, 0x90, 0x02, 0x86, 0xE0, 0x7F, 0x01, 0x20, 0xE1, 0x02, 0x7F, 0x02, - 0x22, 0xF1, 0x8F, 0x12, 0x72, 0xD8, 0x90, 0x89, 0x14, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x02, 0x87, - 0xE0, 0x90, 0x89, 0x18, 0xF0, 0x90, 0x81, 0xAF, 0xE0, 0x20, 0xE0, 0x03, 0x02, 0x90, 0x9D, 0x90, - 0x89, 0x18, 0xE0, 0xFF, 0xEC, 0xC3, 0x9F, 0x40, 0x02, 0x01, 0x9D, 0x90, 0x89, 0x14, 0xE0, 0xFA, - 0xA3, 0xE0, 0xFB, 0x11, 0x9E, 0xAD, 0x07, 0x74, 0x02, 0x2D, 0x12, 0x8F, 0xA7, 0xF9, 0x12, 0x8F, - 0x4E, 0xFE, 0x74, 0x00, 0x2D, 0x12, 0x7F, 0x85, 0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x54, - 0x3F, 0x90, 0x89, 0x16, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x03, 0x2D, 0x12, 0x8F, 0x86, 0x54, 0x03, - 0xFF, 0x7E, 0x00, 0xAD, 0x01, 0xED, 0x24, 0x18, 0xFB, 0xEA, 0x33, 0xCB, 0x2F, 0xFF, 0xEE, 0x3B, - 0x90, 0x89, 0x16, 0x8F, 0xF0, 0x12, 0x43, 0xF6, 0x90, 0x89, 0x16, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, - 0x12, 0x8F, 0x5A, 0x90, 0x89, 0x16, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x89, 0x14, 0x12, 0x8F, - 0x98, 0xD3, 0x90, 0x89, 0x15, 0xE0, 0x9F, 0x90, 0x89, 0x14, 0xE0, 0x9E, 0x40, 0x15, 0x90, 0x81, - 0x3C, 0x11, 0xA6, 0x34, 0x00, 0xFE, 0xC3, 0x90, 0x89, 0x15, 0xE0, 0x9F, 0xF0, 0x90, 0x89, 0x14, - 0xE0, 0x9E, 0xF0, 0x90, 0x89, 0x14, 0x12, 0x8C, 0x5A, 0x0C, 0x02, 0x8F, 0xFF, 0x22, 0xEA, 0x90, - 0xFD, 0x11, 0xF0, 0xAF, 0x03, 0x22, 0xE0, 0x24, 0x01, 0xFF, 0x90, 0x81, 0x3B, 0xE0, 0x22, 0xD3, - 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFD, 0x7F, 0x8F, 0x12, 0x32, 0x1E, 0xD0, 0xD0, 0x92, - 0xAF, 0x22, 0x90, 0x81, 0xB8, 0xE0, 0x30, 0xE0, 0x0D, 0x90, 0x81, 0xB2, 0xE0, 0xC4, 0x54, 0x0F, - 0x20, 0xE0, 0x03, 0x7F, 0x00, 0x22, 0x7F, 0x01, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, - 0xEF, 0x20, 0xE0, 0x05, 0x90, 0x83, 0xE4, 0x80, 0x03, 0x90, 0x83, 0xE5, 0xE0, 0x90, 0x83, 0x8D, - 0xF0, 0x90, 0x83, 0x8D, 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, 0x89, 0x17, 0xEF, 0xF0, 0xE4, 0xFF, 0x74, - 0x5C, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x83, 0xF5, 0x83, 0xE0, 0xFE, 0x74, 0xA4, 0x12, 0x50, 0xEA, - 0x0F, 0xEF, 0xB4, 0x08, 0xEA, 0x90, 0x83, 0x8C, 0xE0, 0x90, 0x04, 0x4C, 0xF0, 0x75, 0x13, 0x01, - 0x75, 0x14, 0x82, 0x75, 0x15, 0xCB, 0x75, 0x16, 0x08, 0x7B, 0x01, 0x7A, 0x83, 0x79, 0x64, 0x12, - 0x2B, 0xED, 0x90, 0x83, 0xF5, 0xE0, 0x60, 0x22, 0x90, 0x89, 0x17, 0xE0, 0xFF, 0x12, 0x5D, 0x99, - 0x7E, 0x00, 0x74, 0x00, 0x2F, 0x12, 0x77, 0xD5, 0xC0, 0x03, 0x8B, 0x13, 0x75, 0x14, 0x83, 0x75, - 0x15, 0x5C, 0x75, 0x16, 0x32, 0xD0, 0x03, 0x12, 0x2B, 0xED, 0x22, 0x90, 0x89, 0x89, 0x12, 0x44, - 0x72, 0x90, 0x89, 0x8C, 0x12, 0x59, 0xA6, 0x75, 0x16, 0x10, 0x7B, 0x01, 0x7A, 0x82, 0x79, 0x58, - 0x12, 0x2B, 0xED, 0x90, 0x89, 0x89, 0x12, 0x59, 0xA6, 0x75, 0x16, 0x10, 0x7B, 0x01, 0x7A, 0x82, - 0x79, 0x68, 0x12, 0x2B, 0xED, 0x90, 0x89, 0x8F, 0x12, 0x44, 0x45, 0x90, 0x82, 0x78, 0x12, 0x20, - 0xCE, 0x90, 0x89, 0x93, 0xE0, 0x90, 0x82, 0x7F, 0xF0, 0x22, 0x90, 0x02, 0x09, 0xE0, 0x90, 0x89, - 0x14, 0xF0, 0x12, 0x1F, 0xA4, 0x90, 0x83, 0xE4, 0x12, 0x5F, 0xE7, 0x90, 0x83, 0xE5, 0xF0, 0x22, - 0x31, 0xE2, 0x90, 0x83, 0xF4, 0x12, 0x5F, 0xE7, 0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x90, 0x83, 0xF5, - 0xF0, 0x22, 0x90, 0x02, 0x09, 0xE0, 0xFD, 0x12, 0x1F, 0xA4, 0xFE, 0xAF, 0x05, 0xED, 0x2E, 0x22, - 0xEF, 0x60, 0x08, 0x90, 0x83, 0xE7, 0xE0, 0xFF, 0x12, 0x5C, 0x67, 0x22, 0xEF, 0x60, 0x08, 0x90, - 0x83, 0xEC, 0xE0, 0xFF, 0x12, 0x5F, 0xEE, 0x22, 0x90, 0x83, 0xFB, 0xE0, 0x30, 0xE0, 0x7D, 0x90, - 0x83, 0xFF, 0xE0, 0x04, 0xF0, 0x90, 0x84, 0x02, 0xE0, 0x64, 0x01, 0x70, 0x32, 0x90, 0x83, 0xFB, - 0x12, 0x57, 0xEC, 0x30, 0xE0, 0x29, 0x90, 0x84, 0x01, 0xE0, 0x70, 0x23, 0x90, 0x83, 0xFE, 0xE0, - 0xFE, 0xA3, 0xE0, 0xC3, 0x9E, 0x40, 0x18, 0x51, 0x8D, 0x30, 0xE0, 0x0B, 0x51, 0x94, 0x12, 0x67, - 0xC7, 0x12, 0x67, 0x67, 0xF0, 0x80, 0x08, 0x12, 0x75, 0xA5, 0x12, 0x67, 0x67, 0xF0, 0x22, 0x90, - 0x83, 0xFF, 0xE0, 0xFF, 0x90, 0x83, 0xFC, 0xE0, 0xD3, 0x9F, 0x50, 0x30, 0x90, 0x06, 0x92, 0xE0, - 0x20, 0xE2, 0x1A, 0x90, 0x84, 0x01, 0xE0, 0x70, 0x14, 0x7D, 0x08, 0xFF, 0x12, 0x4E, 0x2F, 0x90, - 0x84, 0x00, 0xE0, 0x04, 0xF0, 0x90, 0x83, 0xFA, 0xE0, 0x04, 0xF0, 0x80, 0x06, 0x90, 0x06, 0x92, - 0x74, 0x04, 0xF0, 0xE4, 0x90, 0x83, 0xFF, 0xF0, 0x90, 0x84, 0x01, 0xF0, 0x22, 0xEF, 0x13, 0x13, - 0x13, 0x54, 0x1F, 0x22, 0xE4, 0xFD, 0xFF, 0x12, 0x60, 0x8E, 0xE4, 0xFF, 0x22, 0xD3, 0x10, 0xAF, - 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x83, 0xE5, 0xE0, 0xFD, 0xB4, 0x02, 0x07, 0x71, 0x6F, 0x74, 0x08, - 0xF0, 0x80, 0x09, 0xED, 0xB4, 0x04, 0x05, 0x71, 0x6F, 0x74, 0x10, 0xF0, 0xEF, 0x64, 0x02, 0x4E, - 0x60, 0x02, 0x61, 0x6A, 0x90, 0x82, 0xC3, 0xE0, 0xFF, 0x64, 0xFE, 0x70, 0x02, 0x61, 0x6A, 0xEF, - 0x64, 0x02, 0x60, 0x07, 0xEF, 0x64, 0x03, 0x60, 0x02, 0x61, 0x6A, 0x90, 0x83, 0x23, 0x71, 0x77, - 0x90, 0x89, 0x63, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x7E, 0x00, 0x7F, 0x20, 0x7D, 0x00, 0x7B, 0x01, - 0x7A, 0x89, 0x79, 0x41, 0x12, 0x46, 0x4B, 0x7B, 0x01, 0x7A, 0x83, 0x79, 0x25, 0x90, 0x86, 0x67, - 0x12, 0x44, 0x72, 0x7A, 0x89, 0x79, 0x41, 0x90, 0x86, 0x6A, 0x12, 0x44, 0x72, 0x7A, 0x82, 0x79, - 0x92, 0x7D, 0x03, 0x12, 0x02, 0x00, 0x75, 0x13, 0x01, 0x75, 0x14, 0x89, 0x75, 0x15, 0x49, 0x75, - 0x16, 0x10, 0x7B, 0x01, 0x7A, 0x89, 0x79, 0x30, 0x12, 0x2B, 0xED, 0x90, 0x89, 0x47, 0xE0, 0x54, - 0x03, 0x90, 0x89, 0x40, 0xF0, 0xC3, 0x94, 0x04, 0x50, 0x1C, 0xE0, 0x90, 0x83, 0x8C, 0xF0, 0x75, - 0x13, 0x01, 0x75, 0x14, 0x89, 0x75, 0x15, 0x30, 0x75, 0x16, 0x10, 0x7B, 0x01, 0x7A, 0x83, 0x79, - 0x6C, 0x12, 0x2B, 0xED, 0x80, 0x06, 0x90, 0x83, 0x8C, 0x74, 0x05, 0xF0, 0x90, 0x89, 0x40, 0xE0, - 0xFF, 0x7B, 0x01, 0x7A, 0x89, 0x79, 0x30, 0x12, 0x58, 0xE7, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, - 0x89, 0x61, 0x74, 0x80, 0xF0, 0xA3, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFD, 0xED, 0xFF, 0x22, 0x90, - 0x84, 0x52, 0xED, 0xF0, 0x90, 0x84, 0x4F, 0x12, 0x44, 0x72, 0x12, 0x66, 0x69, 0x90, 0x84, 0x56, - 0xF0, 0x90, 0x84, 0x4F, 0x12, 0x59, 0xA6, 0x75, 0x16, 0x03, 0x7B, 0x01, 0x7A, 0x84, 0x79, 0x53, - 0x12, 0x2B, 0xED, 0x90, 0x84, 0x52, 0xE0, 0x70, 0x2E, 0xFF, 0x71, 0xD8, 0xE0, 0xB4, 0xFF, 0x06, - 0x71, 0xD8, 0xE4, 0xF0, 0x80, 0x07, 0x71, 0xD8, 0xE0, 0x04, 0xF0, 0x80, 0x05, 0x0F, 0xEF, 0xB4, - 0x03, 0xE8, 0x75, 0x13, 0x01, 0x75, 0x14, 0x84, 0x75, 0x15, 0x53, 0x75, 0x16, 0x03, 0x90, 0x84, - 0x4F, 0x12, 0x44, 0x69, 0x12, 0x2B, 0xED, 0x22, 0x74, 0x53, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x84, - 0xF5, 0x83, 0x22, 0x74, 0x10, 0x2F, 0xF9, 0xE4, 0x34, 0xFB, 0xA8, 0x01, 0xFC, 0x7D, 0x01, 0x7B, - 0x01, 0x7A, 0x83, 0x79, 0x9A, 0x12, 0x7E, 0xE9, 0xEF, 0x7F, 0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, - 0xAD, 0x07, 0xAB, 0x05, 0x74, 0x17, 0x2B, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0xFE, - 0x74, 0x16, 0x2B, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0x12, 0x72, 0xD6, 0xFE, 0x90, 0x83, 0x9E, 0xE0, - 0x6E, 0x70, 0x03, 0xA3, 0xE0, 0x6F, 0x7F, 0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, 0xE4, 0x90, 0x8A, - 0x21, 0xF0, 0x90, 0x89, 0xD7, 0x12, 0x44, 0x69, 0x90, 0x8A, 0x1F, 0xE0, 0xFE, 0xA3, 0xE0, 0x29, - 0xF9, 0xEA, 0x3E, 0xFA, 0xE9, 0x24, 0xC0, 0xF9, 0xEA, 0x34, 0xFF, 0xFA, 0x74, 0x88, 0xFD, 0x12, - 0x28, 0x08, 0x90, 0x89, 0xD7, 0x12, 0x44, 0x69, 0x90, 0x8A, 0x1F, 0xE0, 0xFE, 0xA3, 0xE0, 0x29, - 0xF9, 0xEA, 0x3E, 0xFA, 0xE9, 0x24, 0xC4, 0xF9, 0xEA, 0x34, 0xFF, 0xFA, 0xA3, 0xE0, 0x44, 0x89, - 0xFD, 0x12, 0x28, 0x08, 0x90, 0x89, 0xD7, 0x12, 0x44, 0x69, 0x90, 0x8A, 0x1F, 0xE0, 0xFE, 0xA3, - 0xE0, 0x29, 0xF9, 0xEA, 0x3E, 0xFA, 0xE9, 0x24, 0xC8, 0xF9, 0xEA, 0x34, 0xFF, 0xFA, 0xA3, 0xE0, - 0x44, 0x8A, 0xFD, 0x12, 0x28, 0x08, 0x90, 0x89, 0xD7, 0x12, 0x44, 0x69, 0x90, 0x8A, 0x1F, 0xE0, - 0xFE, 0xA3, 0xE0, 0x29, 0xF9, 0xEA, 0x3E, 0xFA, 0xE9, 0x22, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, - 0x01, 0x3C, 0x74, 0x02, 0xF0, 0x22, 0x90, 0x81, 0x54, 0xE0, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, - 0x22, 0x12, 0x44, 0x27, 0x90, 0x81, 0x9E, 0x12, 0x20, 0xCE, 0x90, 0x81, 0x47, 0xE0, 0x22, 0x54, - 0xFB, 0xF0, 0x90, 0x81, 0x4F, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x24, 0x28, 0xF9, 0xE4, 0x34, 0xFC, - 0xFA, 0x7B, 0x01, 0x22, 0xF0, 0x90, 0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, 0x16, 0x22, 0xFF, 0x90, - 0x81, 0x53, 0xE0, 0x2F, 0x90, 0x81, 0x64, 0x22, 0xE0, 0x90, 0x01, 0xBA, 0xF0, 0x90, 0x81, 0x4D, - 0xE0, 0x22, 0x90, 0x89, 0x03, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0x22, 0x90, 0x89, 0x00, 0xEE, 0xF0, - 0xA3, 0xEF, 0xF0, 0x22, 0xF0, 0xEE, 0x54, 0x80, 0xFE, 0xEF, 0x54, 0x7F, 0x22, 0xF0, 0xEE, 0x54, - 0x08, 0xFE, 0xEF, 0x54, 0xF7, 0x22, 0x90, 0x81, 0x49, 0xE0, 0xC4, 0x54, 0x0F, 0x22, 0x90, 0x81, - 0x4F, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x53, 0xA5, -}; -u32 array_length_mp_8188e_s_fw_wowlan = 21848; - -#endif - -void -odm_read_firmware_mp_8188e_s_fw_wowlan( - struct PHY_DM_STRUCT *p_dm_odm, - u8 *p_firmware, - u32 *p_firmware_size -) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) - *((SIZE_PTR *)p_firmware) = (SIZE_PTR)array_mp_8188e_s_fw_wowlan; -#else - odm_move_memory(p_dm_odm, p_firmware, array_mp_8188e_s_fw_wowlan, array_length_mp_8188e_s_fw_wowlan); -#endif - *p_firmware_size = array_length_mp_8188e_s_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/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_s_fw.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_s_fw.h deleted file mode 100644 index a90798e6e97d..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_s_fw.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 -* -* -******************************************************************************/ - -/*Image2HeaderVersion: 2.16*/ -#if (RTL8188E_S_SUPPORT == 1) -#ifndef __INC_MP_FW_HW_IMG_8188E_S_H -#define __INC_MP_FW_HW_IMG_8188E_S_H - - -/****************************************************************************** -* FW_AP.TXT -******************************************************************************/ - -void -odm_read_firmware_mp_8188e_s_fw_ap( - struct PHY_DM_STRUCT *p_dm_odm, - u8 *p_firmware, - u32 *p_firmware_size -); - -/****************************************************************************** -* FW_NIC.TXT -******************************************************************************/ - -void -odm_read_firmware_mp_8188e_s_fw_nic( - struct PHY_DM_STRUCT *p_dm_odm, - u8 *p_firmware, - u32 *p_firmware_size -); - -/****************************************************************************** -* FW_WoWLAN.TXT -******************************************************************************/ - -void -odm_read_firmware_mp_8188e_s_fw_wowlan( - struct PHY_DM_STRUCT *p_dm_odm, - u8 *p_firmware, - u32 *p_firmware_size -); - -#endif -#endif /* end of HWIMG_SUPPORT*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_t_fw.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_t_fw.c deleted file mode 100644 index 97dcf09a1a46..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_t_fw.c +++ /dev/null @@ -1,3901 +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 "../../rtl8188e/hal8188e_t_fw.h" -#endif - - -#if (RTL8188E_T_SUPPORT == 1) -#if (defined(CONFIG_AP_WOWLAN) || (DM_ODM_SUPPORT_TYPE & (ODM_AP))) - - -#ifndef LOAD_FW_HEADER_FROM_DRIVER -u8 array_mp_8188e_t_fw_ap[] = { - 0xE1, 0x88, 0x20, 0x00, 0x17, 0x00, 0x00, 0x00, 0x03, 0x25, 0x13, 0x14, 0xEC, 0x3A, 0x00, 0x00, - 0x0C, 0x27, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x02, 0x45, 0x42, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0xC1, 0x77, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0xA1, 0xEE, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE1, 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, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 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, 0x41, 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, 0x45, 0xE8, 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, 0x45, 0xE8, 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, 0x41, 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, 0x41, 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, 0x41, 0x4D, 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, - 0xC2, 0xAF, 0x56, 0xC6, 0xD2, 0xAF, 0xD2, 0xA9, 0x54, 0x80, 0x4F, 0xFF, 0x22, 0xE7, 0x09, 0xF6, - 0x08, 0xDF, 0xFA, 0x80, 0x46, 0xE7, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x3E, 0x88, 0x82, 0x8C, - 0x83, 0xE7, 0x09, 0xF0, 0xA3, 0xDF, 0xFA, 0x80, 0x32, 0xE3, 0x09, 0xF6, 0x08, 0xDF, 0xFA, 0x80, - 0x78, 0xE3, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x70, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0x09, 0xF0, - 0xA3, 0xDF, 0xFA, 0x80, 0x64, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF6, 0x08, 0xDF, 0xFA, 0x80, - 0x58, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x4C, 0x80, 0xD2, 0x80, - 0xFA, 0x80, 0xC6, 0x80, 0xD4, 0x80, 0x69, 0x80, 0xF2, 0x80, 0x33, 0x80, 0x10, 0x80, 0xA6, 0x80, - 0xEA, 0x80, 0x9A, 0x80, 0xA8, 0x80, 0xDA, 0x80, 0xE2, 0x80, 0xCA, 0x80, 0x33, 0x89, 0x82, 0x8A, - 0x83, 0xEC, 0xFA, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xF0, 0xA3, - 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, 0x0D, 0x89, 0x82, - 0x8A, 0x83, 0xE4, 0x93, 0xA3, 0xF6, 0x08, 0xDF, 0xF9, 0xEC, 0xFA, 0xA9, 0xF0, 0xED, 0xFB, 0x22, - 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, - 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xEA, 0xDE, 0xE8, 0x80, 0xDB, - 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xA3, 0xF2, 0x08, 0xDF, 0xF9, 0x80, 0xCC, 0x88, 0xF0, 0xEF, - 0x60, 0x01, 0x0E, 0x4E, 0x60, 0xC3, 0x88, 0xF0, 0xED, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0xB9, - 0xF5, 0x82, 0xEB, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0xAF, 0x23, 0x23, 0x45, 0x82, 0x23, 0x90, - 0x43, 0xFD, 0x73, 0xC5, 0xF0, 0xF8, 0xA3, 0xE0, 0x28, 0xF0, 0xC5, 0xF0, 0xF8, 0xE5, 0x82, 0x15, - 0x82, 0x70, 0x02, 0x15, 0x83, 0xE0, 0x38, 0xF0, 0x22, 0xEF, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, 0xED, - 0x49, 0xFD, 0xEC, 0x48, 0xFC, 0x22, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFE, 0xA3, 0xE0, - 0xFF, 0x22, 0xA4, 0x25, 0x82, 0xF5, 0x82, 0xE5, 0xF0, 0x35, 0x83, 0xF5, 0x83, 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, 0xEF, 0x4E, 0x60, 0x12, 0xEF, 0x60, 0x01, 0x0E, 0xED, 0xBB, - 0x01, 0x0B, 0x89, 0x82, 0x8A, 0x83, 0xF0, 0xA3, 0xDF, 0xFC, 0xDE, 0xFA, 0x22, 0x89, 0xF0, 0x50, - 0x07, 0xF7, 0x09, 0xDF, 0xFC, 0xA9, 0xF0, 0x22, 0xBB, 0xFE, 0xFC, 0xF3, 0x09, 0xDF, 0xFC, 0xA9, - 0xF0, 0x22, 0x02, 0x45, 0x80, 0x02, 0x41, 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, 0x45, 0xC5, 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, 0x82, 0xE1, 0x00, 0x41, 0x82, 0xE2, 0x00, 0x41, 0x82, 0xEF, - 0x00, 0x41, 0x82, 0xF2, 0x00, 0x44, 0x82, 0xB5, 0x41, 0x4E, 0x59, 0x00, 0x44, 0x82, 0xB1, 0x61, - 0x6E, 0x79, 0x00, 0x41, 0x82, 0xF3, 0x00, 0x00, 0x57, 0xFB, 0x59, 0x02, 0x5F, 0xE8, 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, 0xEE, - 0xF0, 0x74, 0x45, 0xA3, 0xF0, 0xD1, 0x3D, 0x74, 0xEE, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x45, - 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, 0x54, - 0xE0, 0x55, 0x35, 0xF5, 0x39, 0xA3, 0xE0, 0x55, 0x36, 0xF5, 0x3A, 0xA3, 0xE0, 0x55, 0x37, 0xF5, - 0x3B, 0xA3, 0xE0, 0x55, 0x38, 0xF5, 0x3C, 0xAD, 0x39, 0x7F, 0x54, 0x12, 0x32, 0x1E, 0xAD, 0x3A, - 0x7F, 0x55, 0x12, 0x32, 0x1E, 0xAD, 0x3B, 0x7F, 0x56, 0x12, 0x32, 0x1E, 0xAD, 0x3C, 0x7F, 0x57, - 0x12, 0x32, 0x1E, 0x53, 0x91, 0xEF, 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, 0x77, 0xF0, 0x74, 0x46, 0xA3, 0xF0, 0x12, 0x68, - 0x77, 0xE5, 0x41, 0x30, 0xE3, 0x02, 0xF1, 0x47, 0xE5, 0x41, 0x30, 0xE4, 0x02, 0xF1, 0x21, 0xE5, - 0x43, 0x30, 0xE0, 0x03, 0x12, 0x55, 0x3B, 0xE5, 0x43, 0x30, 0xE1, 0x03, 0x12, 0x69, 0x10, 0xE5, - 0x43, 0x30, 0xE2, 0x03, 0x12, 0x6D, 0x75, 0xE5, 0x43, 0x30, 0xE3, 0x02, 0xF1, 0x53, 0xE5, 0x43, - 0x30, 0xE4, 0x02, 0xF1, 0x6B, 0xE5, 0x43, 0x30, 0xE5, 0x03, 0x12, 0x6D, 0x8D, 0xE5, 0x43, 0x30, - 0xE6, 0x03, 0x12, 0x59, 0x4B, 0xE5, 0x43, 0x30, 0xE7, 0x03, 0x12, 0x6B, 0x6F, 0xE5, 0x44, 0x30, - 0xE0, 0x02, 0xF1, 0x34, 0xE5, 0x44, 0x30, 0xE1, 0x02, 0xF1, 0x3D, 0x74, 0x77, 0x04, 0x90, 0x01, - 0xC4, 0xF0, 0x74, 0x46, 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, 0x60, 0x9C, 0x7F, 0x02, 0x8F, 0x0D, 0x7F, 0x02, 0x71, 0x27, 0x90, 0x80, 0x01, 0xE0, - 0x45, 0x0D, 0xF0, 0x22, 0xF1, 0xEE, 0xBF, 0x03, 0x03, 0x12, 0x6B, 0x91, 0x22, 0x90, 0x81, 0x71, - 0xE0, 0x60, 0x03, 0x12, 0x4F, 0x9F, 0x22, 0x90, 0x81, 0x3D, 0xE0, 0x30, 0xE0, 0x04, 0x7F, 0x20, - 0xF1, 0x26, 0x22, 0xF1, 0x63, 0x70, 0x0B, 0x90, 0x81, 0x71, 0xE0, 0x60, 0x05, 0xF1, 0xE3, 0x12, - 0x49, 0x01, 0x22, 0xE4, 0xFF, 0xF1, 0x87, 0xEF, 0x64, 0x01, 0x22, 0xF1, 0x63, 0x70, 0x17, 0x90, - 0x81, 0x71, 0xE0, 0x60, 0x11, 0xF1, 0xE3, 0xF0, 0x90, 0x81, 0x6C, 0xE0, 0x12, 0x7A, 0x82, 0x54, - 0x07, 0x70, 0x03, 0x12, 0x59, 0x41, 0x22, 0x12, 0x7A, 0xB8, 0x12, 0x53, 0x00, 0xE0, 0xFD, 0x7C, - 0x00, 0x12, 0x63, 0x85, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5C, - 0xFE, 0xEF, 0x5D, 0x4E, 0x7F, 0x00, 0x60, 0x02, 0x7F, 0x01, 0x22, 0xE4, 0x90, 0x81, 0xF4, 0xF0, - 0x90, 0x81, 0x71, 0xE0, 0x60, 0x2C, 0xF1, 0x63, 0x70, 0x28, 0x12, 0x67, 0xCE, 0xF0, 0x90, 0x81, - 0xF4, 0x74, 0x01, 0xF0, 0xE4, 0x90, 0x81, 0x78, 0xF0, 0x04, 0x60, 0x16, 0x12, 0x71, 0x34, 0xE4, - 0xF5, 0x1D, 0x90, 0x81, 0x79, 0x12, 0x49, 0x08, 0x90, 0x81, 0x74, 0xE0, 0x20, 0xE2, 0x03, 0x12, - 0x49, 0xA5, 0x22, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0x22, 0x90, 0x01, - 0x02, 0xE0, 0x54, 0x03, 0xFF, 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, 0x47, 0xA3, 0xF0, 0x12, 0x68, 0xA4, - 0xE5, 0x49, 0x30, 0xE1, 0x02, 0x11, 0xA5, 0xE5, 0x49, 0x30, 0xE2, 0x03, 0x12, 0x5B, 0xBF, 0xE5, - 0x49, 0x30, 0xE3, 0x03, 0x12, 0x69, 0xFC, 0xE5, 0x49, 0x30, 0xE4, 0x02, 0x11, 0x95, 0xE5, 0x4A, - 0x30, 0xE0, 0x03, 0x12, 0x6C, 0x00, 0xE5, 0x4B, 0x30, 0xE5, 0x03, 0x12, 0x6A, 0x1A, 0xE5, 0x4C, - 0x30, 0xE1, 0x05, 0x7F, 0x04, 0x12, 0x47, 0x26, 0xE5, 0x4C, 0x30, 0xE4, 0x02, 0x11, 0x9B, 0xE5, - 0x4C, 0x30, 0xE5, 0x03, 0x12, 0x5E, 0xBA, 0xE5, 0x4C, 0x30, 0xE6, 0x03, 0x12, 0x5E, 0x3D, 0x74, - 0xF6, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x47, 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, 0x69, 0xBB, 0x02, 0x5F, 0x83, 0x12, 0x47, 0xAB, 0x7D, 0x02, - 0x7F, 0x02, 0x02, 0x57, 0xB2, 0x90, 0x81, 0x71, 0xE0, 0x60, 0x03, 0x12, 0x5A, 0xBB, 0x90, 0x81, - 0xD5, 0xE0, 0x30, 0xE0, 0x4B, 0x13, 0x13, 0x54, 0x3F, 0x20, 0xE0, 0x17, 0xE4, 0xF5, 0x1D, 0x90, - 0x81, 0xD7, 0x31, 0x08, 0x31, 0x7A, 0xF1, 0xC6, 0x30, 0xE0, 0x06, 0x7D, 0x0C, 0x7F, 0x01, 0x71, - 0x98, 0xE1, 0xCD, 0x90, 0x81, 0xD5, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x22, 0xE4, 0xF5, - 0x1D, 0x90, 0x81, 0xD8, 0x31, 0x08, 0x90, 0x81, 0xD5, 0xE0, 0x54, 0xFB, 0xF0, 0xE0, 0xC3, 0x13, - 0x30, 0xE0, 0x09, 0x12, 0x6B, 0xB6, 0x7D, 0x04, 0x7F, 0x01, 0x61, 0x98, 0x7D, 0x31, 0x91, 0x97, - 0x22, 0xF0, 0xE4, 0xF5, 0x1D, 0x90, 0x81, 0xCF, 0xE0, 0xF5, 0x1E, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, - 0x7E, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8E, 0x19, 0x8F, 0x1A, 0xE5, 0x1E, 0x54, - 0x07, 0xC4, 0x33, 0x54, 0xE0, 0x85, 0x19, 0x83, 0x85, 0x1A, 0x82, 0xF0, 0xE5, 0x1D, 0x31, 0x72, - 0xE5, 0x1E, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x4F, 0xA3, 0xF0, 0xEB, 0x31, 0x72, 0xE5, 0x1D, 0x13, - 0x13, 0x13, 0x54, 0x1F, 0x4F, 0x31, 0x69, 0xF0, 0xBD, 0x01, 0x0D, 0x85, 0x1A, 0x82, 0x8E, 0x83, - 0xA3, 0xA3, 0xA3, 0x74, 0x03, 0xF0, 0x80, 0x06, 0x31, 0x69, 0xA3, 0x74, 0x01, 0xF0, 0x31, 0x69, - 0xA3, 0x74, 0x05, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x85, 0x1A, 0x82, 0x85, 0x19, 0x83, 0xA3, - 0xA3, 0x22, 0x54, 0x07, 0xC4, 0x33, 0x54, 0xE0, 0xFF, 0x22, 0x91, 0x1D, 0xE4, 0xFD, 0xFF, 0x90, - 0x05, 0x22, 0xEF, 0xF0, 0x90, 0x80, 0x05, 0xED, 0xF0, 0x22, 0x90, 0x81, 0x6D, 0xE0, 0xC3, 0x13, - 0x20, 0xE0, 0x04, 0x7D, 0x0C, 0x80, 0x05, 0x12, 0x6F, 0x84, 0x7D, 0x04, 0x7F, 0x01, 0x71, 0x98, - 0xE4, 0xFD, 0xFF, 0x80, 0xDA, 0x7D, 0x01, 0x7F, 0x04, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, - 0x90, 0x82, 0xEE, 0xED, 0xF0, 0x90, 0x81, 0x6C, 0xE0, 0xFE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, - 0xE0, 0x02, 0x41, 0xED, 0xEE, 0x12, 0x5D, 0xED, 0x30, 0xE0, 0x02, 0x41, 0xED, 0x90, 0x81, 0x74, - 0xE0, 0xFE, 0x6F, 0x70, 0x02, 0x41, 0xED, 0xEF, 0x70, 0x02, 0x41, 0x65, 0x24, 0xFE, 0x70, 0x02, - 0x41, 0x9E, 0x24, 0xFE, 0x60, 0x47, 0x24, 0xFC, 0x70, 0x02, 0x41, 0xD8, 0x24, 0xFC, 0x60, 0x02, - 0x41, 0xE7, 0xEE, 0xB4, 0x0E, 0x02, 0x31, 0x8A, 0x90, 0x81, 0x74, 0xE0, 0x70, 0x04, 0x7F, 0x01, - 0x91, 0x00, 0x90, 0x81, 0x74, 0xE0, 0xB4, 0x06, 0x02, 0x71, 0x4A, 0x90, 0x81, 0x74, 0xE0, 0xB4, - 0x04, 0x0D, 0x90, 0x82, 0xEE, 0xE0, 0xFF, 0x60, 0x04, 0xB1, 0x9D, 0x80, 0x02, 0xF1, 0x79, 0x90, - 0x81, 0x74, 0xE0, 0x64, 0x08, 0x60, 0x02, 0x41, 0xE7, 0x91, 0x15, 0x41, 0xE7, 0x90, 0x81, 0x74, - 0xE0, 0x70, 0x04, 0x7F, 0x01, 0x91, 0x00, 0x90, 0x81, 0x74, 0xE0, 0xB4, 0x06, 0x02, 0x71, 0x4A, - 0x90, 0x81, 0x74, 0xE0, 0xB4, 0x0E, 0x07, 0x51, 0xF2, 0xBF, 0x01, 0x02, 0x31, 0x8A, 0x90, 0x81, - 0x74, 0xE0, 0x64, 0x0C, 0x60, 0x02, 0x41, 0xE7, 0x51, 0xF2, 0xEF, 0x64, 0x01, 0x60, 0x02, 0x41, - 0xE7, 0x71, 0x6B, 0x41, 0xE7, 0x90, 0x81, 0x74, 0xE0, 0xB4, 0x0E, 0x07, 0x51, 0xF2, 0xBF, 0x01, - 0x02, 0x31, 0x8A, 0x90, 0x81, 0x74, 0xE0, 0xB4, 0x06, 0x02, 0x71, 0x4A, 0x90, 0x81, 0x74, 0xE0, - 0xB4, 0x0C, 0x07, 0x51, 0xF2, 0xBF, 0x01, 0x02, 0x71, 0x6B, 0x90, 0x81, 0x74, 0xE0, 0x64, 0x04, - 0x70, 0x55, 0x12, 0x6F, 0xD6, 0xEF, 0x64, 0x01, 0x70, 0x4D, 0x91, 0x7F, 0x80, 0x49, 0x90, 0x81, - 0x74, 0xE0, 0xB4, 0x0E, 0x07, 0x51, 0xF2, 0xBF, 0x01, 0x02, 0x31, 0x8A, 0x90, 0x81, 0x74, 0xE0, - 0xB4, 0x06, 0x02, 0x71, 0x4A, 0x90, 0x81, 0x74, 0xE0, 0xB4, 0x0C, 0x07, 0x51, 0xF2, 0xBF, 0x01, - 0x02, 0x71, 0x6B, 0x90, 0x81, 0x74, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0x91, 0x00, 0x90, 0x81, 0x74, - 0xE0, 0xB4, 0x04, 0x13, 0xF1, 0xBA, 0x80, 0x0F, 0x90, 0x81, 0x74, 0xE0, 0xB4, 0x0C, 0x08, 0x12, - 0x6B, 0xA2, 0x30, 0xE0, 0x02, 0x91, 0x75, 0x90, 0x81, 0x74, 0x12, 0x7A, 0x96, 0xD0, 0xD0, 0x92, - 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x6F, 0x90, 0xEF, 0x64, 0x01, 0x60, - 0x05, 0x75, 0x0E, 0x01, 0x80, 0x31, 0x12, 0x6B, 0xAC, 0x30, 0xE0, 0x05, 0x75, 0x0E, 0x02, 0x80, - 0x26, 0x90, 0x81, 0x73, 0xE0, 0xD3, 0x94, 0x04, 0x40, 0x05, 0x75, 0x0E, 0x08, 0x80, 0x18, 0x90, - 0x81, 0xD5, 0xE0, 0x30, 0xE0, 0x0C, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x05, 0x75, 0x0E, 0x11, - 0x80, 0x05, 0x12, 0x70, 0x4D, 0x80, 0x0E, 0x90, 0x01, 0xB9, 0x74, 0x02, 0xF0, 0x90, 0x01, 0xB8, - 0xE5, 0x0E, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x81, 0x6D, 0xE0, 0x90, 0x06, - 0x04, 0x20, 0xE0, 0x08, 0xE0, 0x44, 0x40, 0xF0, 0x7D, 0x04, 0x80, 0x06, 0xE0, 0x54, 0x7F, 0xF0, - 0x7D, 0x0C, 0x7F, 0x01, 0x71, 0x98, 0xE4, 0xFD, 0xFF, 0x21, 0x7F, 0x12, 0x47, 0x63, 0x70, 0x27, - 0x90, 0x81, 0x6D, 0xE0, 0x54, 0xFD, 0xF0, 0x7D, 0x2C, 0x7F, 0x6F, 0x31, 0x7F, 0x7D, 0x08, 0x7F, - 0x01, 0xB1, 0x52, 0xBF, 0x01, 0x0D, 0x90, 0x81, 0x6C, 0xE0, 0x44, 0x80, 0xF0, 0x7D, 0x0E, 0x7F, - 0x01, 0x80, 0x05, 0xF1, 0xE8, 0x04, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAC, - 0x07, 0xEF, 0x14, 0x60, 0x15, 0x14, 0x60, 0x19, 0x24, 0x02, 0x70, 0x1A, 0xED, 0x54, 0x01, 0xFE, - 0x90, 0x81, 0x6C, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0x80, 0x0C, 0x90, 0x81, 0x74, 0xED, 0xF0, 0x80, - 0x05, 0x90, 0x81, 0x73, 0xED, 0xF0, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE4, 0x2E, 0xEC, 0x14, 0x60, - 0x07, 0x14, 0x60, 0x1D, 0x24, 0x02, 0x70, 0x23, 0x90, 0x81, 0x6C, 0xE0, 0x54, 0x01, 0xC4, 0x33, - 0x33, 0x33, 0x54, 0x80, 0xFF, 0x90, 0x81, 0x74, 0xE0, 0x54, 0x7F, 0x4F, 0xFD, 0x7F, 0x88, 0x80, - 0x07, 0x90, 0x81, 0x73, 0xE0, 0xFD, 0x7F, 0x89, 0x12, 0x32, 0x1E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, - 0x90, 0x82, 0xED, 0xEF, 0xF0, 0x91, 0x1D, 0x90, 0x82, 0xED, 0xE0, 0x60, 0x02, 0xF1, 0x8A, 0x7D, - 0x04, 0x7F, 0x01, 0x80, 0x83, 0x31, 0x7A, 0x7D, 0x0C, 0x7F, 0x01, 0x61, 0x98, 0xD3, 0x10, 0xAF, - 0x01, 0xC3, 0xC0, 0xD0, 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, 0xF1, 0xDE, 0x54, - 0x7F, 0xFC, 0x90, 0x82, 0xD2, 0x12, 0x20, 0xCE, 0x90, 0x82, 0xD2, 0xF1, 0xD5, 0x7F, 0x7C, 0xB1, - 0xDC, 0x12, 0x20, 0xDA, 0xCC, 0xC0, 0x00, 0xC0, 0xB1, 0xDA, 0x12, 0x20, 0xDA, 0x00, 0xC0, 0x00, - 0x14, 0xF1, 0xF8, 0x12, 0x20, 0xDA, 0x00, 0x03, 0x3E, 0x60, 0xE4, 0xFD, 0xFF, 0x12, 0x65, 0x84, - 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7D, 0x2F, 0x91, 0x97, 0x7D, 0x08, 0x7F, 0x01, 0x61, 0x98, 0x7D, - 0x2D, 0x91, 0xF4, 0x90, 0x01, 0x37, 0x74, 0x02, 0xF0, 0xFD, 0x7F, 0x03, 0x12, 0x57, 0xB2, 0x91, - 0x9B, 0xE4, 0xFD, 0x7F, 0x01, 0x61, 0x98, 0x7F, 0xFF, 0x31, 0x7F, 0xD3, 0x10, 0xAF, 0x01, 0xC3, - 0xC0, 0xD0, 0x91, 0xF8, 0x90, 0x85, 0xBB, 0x12, 0x20, 0xDA, 0xCC, 0xF0, 0x00, 0xC0, 0xB1, 0xDA, - 0x12, 0x20, 0xDA, 0x00, 0x00, 0x00, 0x14, 0xF1, 0xF8, 0x12, 0x20, 0xDA, 0x00, 0x00, 0x00, 0x00, - 0xE4, 0xFD, 0xFF, 0x12, 0x65, 0x84, 0xF1, 0xDE, 0x44, 0x80, 0xFC, 0x90, 0x82, 0xD6, 0x12, 0x20, - 0xCE, 0x90, 0x82, 0xD6, 0xF1, 0xD5, 0x7F, 0x7C, 0x7E, 0x08, 0x12, 0x2E, 0xA2, 0x90, 0x01, 0x00, - 0x74, 0x3F, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, 0x20, 0xF0, 0xD0, - 0xD0, 0x92, 0xAF, 0x22, 0x7F, 0xFF, 0x31, 0x7F, 0xE4, 0x90, 0x82, 0xDE, 0xF0, 0xA3, 0xF0, 0x90, - 0x05, 0x22, 0xE0, 0x90, 0x82, 0xE0, 0xF0, 0x7D, 0x47, 0x7F, 0xFF, 0x31, 0x7F, 0x90, 0x05, 0xF8, - 0xE0, 0x70, 0x11, 0xA3, 0xE0, 0x70, 0x0D, 0xA3, 0xE0, 0x70, 0x09, 0xA3, 0xE0, 0x70, 0x05, 0xB1, - 0xD1, 0x7F, 0x01, 0x22, 0xD3, 0x90, 0x82, 0xDF, 0xE0, 0x94, 0xE8, 0x90, 0x82, 0xDE, 0xE0, 0x94, - 0x03, 0x40, 0x0C, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x20, 0xF0, 0xB1, 0xD1, 0x7F, 0x00, 0x22, 0x7F, - 0x32, 0x7E, 0x00, 0x12, 0x32, 0xAA, 0x90, 0x82, 0xDE, 0x12, 0x54, 0x5C, 0x80, 0xBF, 0x7D, 0x08, - 0xE4, 0xFF, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x82, 0xC5, 0xEF, 0xF0, 0xA3, 0xED, - 0xF0, 0x90, 0x80, 0x03, 0xE0, 0x04, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x21, 0x90, 0x05, 0x22, - 0xE0, 0x90, 0x82, 0xC9, 0xF0, 0x7D, 0x26, 0x91, 0xF4, 0xEF, 0x64, 0x01, 0x70, 0x02, 0xD1, 0x1D, - 0x90, 0x82, 0xC9, 0xE0, 0xFF, 0x7D, 0x27, 0x31, 0x7F, 0x12, 0x6F, 0x1A, 0x80, 0x05, 0x12, 0x6F, - 0x1A, 0xD1, 0x1D, 0x12, 0x6D, 0xCB, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEF, 0x60, 0x30, - 0x12, 0x47, 0x63, 0x70, 0x2B, 0x90, 0x81, 0x6D, 0xE0, 0x54, 0xFE, 0xF0, 0x7D, 0x2B, 0x7F, 0x0F, - 0x31, 0x7F, 0x90, 0x06, 0x04, 0xE0, 0x54, 0xBF, 0xF0, 0xB1, 0x4E, 0xBF, 0x01, 0x0D, 0x90, 0x81, - 0x6C, 0xE0, 0x44, 0x40, 0xF0, 0x7D, 0x06, 0x7F, 0x01, 0x61, 0x98, 0xF1, 0xE8, 0x74, 0x08, 0xF0, - 0x22, 0x90, 0x82, 0xE0, 0xE0, 0xFF, 0x7D, 0x48, 0x21, 0x7F, 0x7F, 0x8C, 0x7E, 0x08, 0x12, 0x2E, - 0xA2, 0x90, 0x85, 0xBB, 0x22, 0x90, 0x81, 0xD5, 0xE0, 0x30, 0xE0, 0x14, 0x90, 0x01, 0x57, 0xE4, - 0xF0, 0x31, 0x7A, 0xF1, 0xC6, 0x30, 0xE0, 0x06, 0x7D, 0x0C, 0x7F, 0x01, 0x71, 0x98, 0xF1, 0xCD, - 0x22, 0xF1, 0x59, 0x54, 0x3F, 0xF0, 0xEF, 0x60, 0x0A, 0xF1, 0x4C, 0x44, 0x10, 0xF1, 0x58, 0x44, - 0x80, 0xF0, 0x22, 0xF1, 0x4C, 0x54, 0xEF, 0xF1, 0x58, 0x44, 0x40, 0xF0, 0x22, 0x90, 0x80, 0x4C, - 0xE0, 0xFF, 0x90, 0x82, 0xC6, 0xE0, 0xFB, 0x90, 0x82, 0xD1, 0x74, 0x0A, 0xF0, 0x7D, 0x01, 0xD1, - 0xAD, 0x90, 0x82, 0xC7, 0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0x82, 0xC5, 0xE0, 0xFF, - 0xD1, 0x01, 0x90, 0x82, 0xC7, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x04, 0x80, 0xE0, 0x54, 0x0F, - 0xFD, 0xAC, 0x07, 0xF1, 0x6D, 0x44, 0x01, 0xF0, 0xF1, 0x6D, 0x54, 0xFB, 0xF0, 0xAC, 0x07, 0x74, - 0x16, 0x2C, 0xF1, 0x44, 0xE0, 0x44, 0xFA, 0xF0, 0x74, 0x15, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, - 0xF5, 0x83, 0xE0, 0x44, 0x1F, 0xF0, 0xAC, 0x07, 0x74, 0x06, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, - 0xF5, 0x83, 0xE0, 0x44, 0x0F, 0xF0, 0x90, 0x04, 0x53, 0xE4, 0xF0, 0x90, 0x04, 0x52, 0xF0, 0x90, - 0x04, 0x51, 0x74, 0xFF, 0xF0, 0x90, 0x04, 0x50, 0x74, 0xFD, 0xF0, 0x74, 0x14, 0x2C, 0xF1, 0x65, - 0xE0, 0x54, 0xC0, 0x4D, 0xFD, 0x74, 0x14, 0x2F, 0xF1, 0x65, 0xED, 0xF0, 0x22, 0xD3, 0x10, 0xAF, - 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x82, 0xCF, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x82, 0xCE, 0xEF, - 0xF0, 0xE4, 0xFD, 0xFC, 0x12, 0x71, 0x59, 0x7C, 0x00, 0xAD, 0x07, 0x90, 0x82, 0xCE, 0xE0, 0x90, - 0x04, 0x25, 0xF0, 0x90, 0x82, 0xCF, 0xE0, 0x60, 0x0E, 0x74, 0x0F, 0x2F, 0xF5, 0x82, 0xE4, 0x34, - 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0xAF, 0x05, 0x74, 0x08, 0x2F, 0xF5, 0x82, 0xE4, 0x34, - 0xFC, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x09, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, - 0x54, 0xF0, 0xF0, 0xAF, 0x05, 0xF1, 0x41, 0xE0, 0x54, 0x01, 0xFE, 0x90, 0x82, 0xD0, 0xE0, 0x25, - 0xE0, 0x25, 0xE0, 0xFB, 0xEE, 0x44, 0x02, 0x4B, 0xFE, 0xF1, 0x41, 0xEE, 0xF0, 0x90, 0x82, 0xD1, - 0xE0, 0xFF, 0xAE, 0x05, 0x74, 0x1E, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, - 0x74, 0x21, 0x2E, 0xF1, 0x4F, 0x54, 0xF7, 0xF0, 0xAE, 0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, - 0x22, 0x74, 0x16, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0x74, 0x21, 0x2D, 0xF5, - 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xF0, 0x74, 0x1F, 0x2D, 0xF5, 0x82, 0xE4, 0x34, - 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0x74, 0x11, 0x2C, - 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0x12, 0x6F, 0x12, 0xF1, 0x8A, 0x7D, 0x0C, - 0x7F, 0x01, 0x61, 0x98, 0xE4, 0xFD, 0x7F, 0x0C, 0x31, 0xA9, 0xE4, 0xFD, 0xFF, 0x21, 0x7F, 0x12, - 0x5E, 0x11, 0x90, 0x81, 0x74, 0xE0, 0x64, 0x0C, 0x60, 0x04, 0xF1, 0x84, 0xB1, 0x4E, 0x22, 0x90, - 0x81, 0x71, 0xE0, 0x64, 0x01, 0x70, 0x12, 0x12, 0x59, 0xBC, 0x60, 0x05, 0xF1, 0x84, 0x02, 0x5E, - 0x11, 0x90, 0x81, 0x74, 0xE0, 0x70, 0x02, 0x31, 0xA5, 0x22, 0x7D, 0x2E, 0x7F, 0x6F, 0x31, 0x7F, - 0x7D, 0x02, 0x7F, 0x01, 0x61, 0x98, 0x90, 0x81, 0xD5, 0xE0, 0xC3, 0x13, 0x22, 0x90, 0x81, 0xD5, - 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x12, 0x44, 0xC6, 0x90, 0x85, 0xBB, 0x02, 0x20, 0xCE, 0x7F, 0x7C, - 0x7E, 0x08, 0x12, 0x2D, 0x5C, 0xEC, 0x22, 0xF0, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, - 0xB8, 0x22, 0x7D, 0x08, 0xE4, 0xFF, 0xA1, 0x52, 0x7F, 0x70, 0x7E, 0x0E, 0x12, 0x2E, 0xA2, 0x90, - 0x82, 0xBB, 0x22, 0x90, 0x00, 0xF7, 0xE0, 0x20, 0xE7, 0x09, 0xE0, 0x7F, 0x01, 0x20, 0xE6, 0x0C, - 0x7F, 0x02, 0x22, 0x90, 0x00, 0xF7, 0xE0, 0x30, 0xE6, 0x02, 0x7F, 0x03, 0x22, 0x11, 0x03, 0x90, - 0x80, 0x07, 0xEF, 0xF0, 0x11, 0x3D, 0x90, 0x01, 0x64, 0x74, 0x01, 0xF0, 0x90, 0x00, 0x12, 0xE0, - 0x54, 0xC7, 0x44, 0x20, 0xFD, 0x7F, 0x12, 0x12, 0x32, 0x1E, 0x02, 0x2D, 0xA7, 0x11, 0x6D, 0x11, - 0xA5, 0x12, 0x68, 0x12, 0x12, 0x68, 0x31, 0xE4, 0xF5, 0x35, 0xF5, 0x36, 0xF5, 0x37, 0x75, 0x38, - 0x80, 0xAD, 0x35, 0x7F, 0x50, 0x12, 0x32, 0x1E, 0xAD, 0x36, 0x7F, 0x51, 0x12, 0x32, 0x1E, 0xAD, - 0x37, 0x7F, 0x52, 0x12, 0x32, 0x1E, 0xAD, 0x38, 0x7F, 0x53, 0x02, 0x32, 0x1E, 0x90, 0x01, 0x30, - 0xE4, 0x11, 0x9D, 0x90, 0x01, 0x38, 0x11, 0x9D, 0xFD, 0x7F, 0x50, 0x12, 0x32, 0x1E, 0xE4, 0xFD, - 0x7F, 0x51, 0x12, 0x32, 0x1E, 0xE4, 0xFD, 0x7F, 0x52, 0x12, 0x32, 0x1E, 0xE4, 0xFD, 0x7F, 0x53, - 0x02, 0x32, 0x1E, 0xE4, 0x90, 0x82, 0x16, 0xF0, 0x90, 0x82, 0x81, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, - 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x01, 0x34, 0x74, 0xFF, 0x11, 0x9D, 0x90, 0x01, 0x3C, 0x11, - 0x9D, 0xFD, 0x7F, 0x54, 0x12, 0x32, 0x1E, 0x7D, 0xFF, 0x7F, 0x55, 0x12, 0x32, 0x1E, 0x7D, 0xFF, - 0x7F, 0x56, 0x12, 0x32, 0x1E, 0x7D, 0xFF, 0x7F, 0x57, 0x02, 0x32, 0x1E, 0x90, 0x81, 0x3D, 0xE0, - 0x54, 0xFE, 0x71, 0x71, 0x90, 0x81, 0x3D, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0xFB, 0xF0, 0x54, 0xF7, - 0xF0, 0x54, 0xEF, 0xF0, 0xE4, 0x90, 0x81, 0x40, 0x11, 0x9B, 0x11, 0x9E, 0x90, 0x81, 0x5F, 0xF0, - 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x82, 0x91, 0x71, 0xBA, 0xE4, 0x11, 0x9E, 0xFC, 0xA3, 0xF0, - 0x31, 0xA2, 0x90, 0x82, 0x96, 0xEF, 0xF0, 0x51, 0x7D, 0xA3, 0xE0, 0x04, 0xFD, 0x31, 0xA2, 0xAC, - 0x07, 0x90, 0x82, 0x96, 0xE0, 0x30, 0xE7, 0x08, 0x90, 0x82, 0x94, 0x74, 0x02, 0xF0, 0x80, 0x05, - 0xE4, 0x90, 0x82, 0x94, 0xF0, 0xEC, 0x30, 0xE6, 0x34, 0x51, 0x7D, 0x7D, 0x02, 0x31, 0xA2, 0xEF, - 0x54, 0x70, 0xC4, 0x54, 0x0F, 0x90, 0x82, 0x97, 0xF0, 0x14, 0x60, 0x11, 0x14, 0x60, 0x16, 0x24, - 0xFE, 0x60, 0x12, 0x14, 0x60, 0x07, 0x14, 0x60, 0x04, 0x24, 0x06, 0x80, 0x10, 0x90, 0x82, 0x95, - 0x74, 0x04, 0xF0, 0x80, 0x0D, 0x90, 0x82, 0x95, 0x74, 0x08, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x82, - 0x95, 0xF0, 0x90, 0x82, 0x94, 0xE0, 0x24, 0x18, 0xFF, 0xA3, 0xE0, 0x2F, 0xFF, 0x22, 0x90, 0x82, - 0x8D, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x11, 0xF5, 0x90, 0x82, 0x90, 0xEF, 0xF0, - 0x90, 0x82, 0x8F, 0xE0, 0xFD, 0x90, 0x82, 0x8E, 0xE0, 0x2D, 0xFD, 0x90, 0x82, 0x8D, 0xE0, 0x34, - 0x00, 0xFC, 0x7E, 0x00, 0xED, 0x2F, 0xFF, 0xEE, 0x3C, 0xCF, 0x24, 0x06, 0xCF, 0x34, 0x00, 0xFE, - 0xE4, 0xFD, 0xAB, 0x07, 0xAA, 0x06, 0xED, 0x2B, 0xFB, 0xE4, 0x3A, 0xFA, 0xC3, 0x90, 0x81, 0x3C, - 0xE0, 0x9B, 0x90, 0x81, 0x3B, 0xE0, 0x9A, 0x50, 0x0A, 0xA3, 0x12, 0x7A, 0xAB, 0xEB, 0x9F, 0xFB, - 0xEA, 0x9E, 0xFA, 0xEA, 0x90, 0xFD, 0x11, 0xF0, 0xAF, 0x03, 0x74, 0x00, 0x2F, 0x12, 0x7A, 0xCF, - 0xFF, 0x22, 0x31, 0x6E, 0xEF, 0x64, 0x08, 0x70, 0x34, 0x51, 0x10, 0x24, 0x07, 0x31, 0x9C, 0xEF, - 0x70, 0x2B, 0x51, 0x10, 0x24, 0x1D, 0x31, 0x9C, 0xBF, 0x44, 0x0B, 0x51, 0x10, 0x24, 0x1F, 0x31, - 0x9C, 0xEF, 0x64, 0x43, 0x60, 0x14, 0x51, 0x10, 0x24, 0x1D, 0x31, 0x9C, 0xEF, 0x64, 0x43, 0x70, - 0x0C, 0x51, 0x10, 0x24, 0x1F, 0x31, 0x9C, 0xBF, 0x44, 0x03, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, - 0x90, 0x82, 0x8F, 0xE0, 0xFF, 0x90, 0x82, 0x8E, 0xE0, 0x2F, 0xFF, 0x90, 0x82, 0x8D, 0xE0, 0x34, - 0x00, 0xFE, 0x90, 0x82, 0x90, 0xE0, 0x7C, 0x00, 0x2F, 0xFF, 0xEC, 0x3E, 0xCF, 0x22, 0x31, 0x6E, - 0xEF, 0x64, 0x08, 0x70, 0x20, 0x51, 0x10, 0x24, 0x07, 0x31, 0x9C, 0xEF, 0x64, 0x06, 0x70, 0x15, - 0x51, 0x10, 0x24, 0x0E, 0x31, 0x9C, 0xEF, 0x70, 0x0C, 0x51, 0x10, 0x24, 0x0F, 0x31, 0x9C, 0xBF, - 0x01, 0x03, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, 0x24, 0x0A, 0xFC, 0xED, 0x2C, 0xFD, 0x31, 0xA2, - 0x90, 0x82, 0x0E, 0xA3, 0xE0, 0xFE, 0x90, 0x82, 0x14, 0xE0, 0x2E, 0x24, 0x24, 0xF5, 0x82, 0xE4, - 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x82, 0x14, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x82, 0x91, - 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x24, 0x04, 0xFD, 0x90, 0x82, 0x14, 0xE0, 0x2D, 0xFD, 0x21, - 0xA2, 0x24, 0x1A, 0xFC, 0xED, 0x2C, 0xFD, 0x31, 0xA2, 0x90, 0x82, 0x14, 0xE0, 0x24, 0x2C, 0xF5, - 0x82, 0xE4, 0x34, 0x82, 0x22, 0x51, 0xC1, 0x12, 0x68, 0x04, 0x12, 0x6E, 0x59, 0x12, 0x71, 0x3C, - 0x71, 0x61, 0x12, 0x71, 0xDC, 0x11, 0xCC, 0x12, 0x6E, 0x3C, 0x90, 0x81, 0xE9, 0x74, 0x01, 0xF0, - 0x22, 0xE4, 0xFD, 0xFF, 0x12, 0x7A, 0xB8, 0xED, 0x70, 0x12, 0x71, 0x00, 0xC0, 0x83, 0xC0, 0x82, - 0x51, 0xF8, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5E, 0x80, 0x0F, 0x71, 0x00, 0xC0, 0x83, - 0xC0, 0x82, 0x51, 0xF8, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xF0, - 0x71, 0x0B, 0x90, 0x81, 0x6B, 0xEF, 0xF0, 0x22, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x07, 0x08, 0x22, - 0x74, 0x63, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, - 0xC0, 0xD0, 0x7D, 0x08, 0xED, 0x14, 0xF9, 0x24, 0x63, 0x71, 0x03, 0xE0, 0x60, 0x3A, 0x7C, 0x08, - 0xEC, 0x14, 0x90, 0x82, 0xEA, 0xF0, 0x74, 0x63, 0x29, 0x71, 0x03, 0xE0, 0xFB, 0x7A, 0x00, 0x90, - 0x82, 0xEA, 0x12, 0x63, 0x83, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, - 0x5A, 0xFE, 0xEF, 0x5B, 0x4E, 0x60, 0x0F, 0xE9, 0x75, 0xF0, 0x08, 0xA4, 0xFF, 0x90, 0x82, 0xEA, - 0xE0, 0x2F, 0x04, 0xFF, 0x80, 0x06, 0xDC, 0xC8, 0xDD, 0xBA, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, - 0x22, 0x90, 0x81, 0xDD, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0x7F, 0xF0, 0x54, 0xFB, 0xF0, 0xA3, 0x74, - 0x0A, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x82, 0x8D, 0x71, 0xBA, 0x31, 0xA2, 0xEF, - 0x54, 0x0C, 0x64, 0x08, 0x70, 0x2B, 0x90, 0x82, 0x90, 0xF0, 0x90, 0x82, 0x90, 0xE0, 0xFD, 0xC3, - 0x94, 0x06, 0x50, 0x1D, 0x90, 0x82, 0x8D, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0x24, 0x10, - 0x71, 0xB4, 0xEF, 0xF4, 0x60, 0x03, 0x7F, 0x01, 0x22, 0x90, 0x82, 0x90, 0xE0, 0x04, 0xF0, 0x80, - 0xD9, 0x7F, 0x00, 0x22, 0xFC, 0xED, 0x2C, 0xFD, 0x21, 0xA2, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xA3, - 0xED, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x82, 0xCA, 0xEE, 0xF0, 0xA3, - 0xEF, 0x71, 0x71, 0x90, 0x82, 0xCA, 0xE0, 0xFE, 0xA3, 0xE0, 0xF5, 0x82, 0x8E, 0x83, 0xE0, 0x60, - 0x23, 0xC3, 0x90, 0x82, 0xCD, 0xE0, 0x94, 0xE8, 0x90, 0x82, 0xCC, 0xE0, 0x94, 0x03, 0x40, 0x0B, - 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x80, 0xF0, 0x7F, 0x00, 0x80, 0x0B, 0x90, 0x82, 0xCC, 0x91, 0x5C, - 0xF1, 0x5C, 0x80, 0xCF, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x82, 0x06, 0xEF, 0x71, - 0x71, 0x90, 0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0x90, 0x82, 0x06, 0xE0, - 0x6F, 0x60, 0x35, 0xC3, 0x90, 0x82, 0x08, 0xE0, 0x94, 0x88, 0x90, 0x82, 0x07, 0xE0, 0x94, 0x13, - 0x40, 0x08, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x82, 0x07, 0x91, 0x5C, 0x12, - 0x58, 0xB4, 0xD3, 0x90, 0x82, 0x08, 0xE0, 0x94, 0x32, 0x90, 0x82, 0x07, 0xE0, 0x94, 0x00, 0x40, - 0xC0, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE0, 0xB9, 0x22, 0x90, 0x82, 0x8B, 0xE4, 0x75, 0xF0, 0x01, - 0x02, 0x44, 0xA3, 0xE4, 0xFD, 0xFB, 0xFA, 0xF1, 0x55, 0x30, 0xE0, 0x73, 0x90, 0x00, 0xB6, 0xE0, - 0xFC, 0x90, 0x00, 0xBF, 0xE0, 0xFE, 0x90, 0x00, 0xBE, 0xE0, 0x24, 0x00, 0xFB, 0xEA, 0x3E, 0xFA, - 0xC4, 0xF8, 0x54, 0xF0, 0xC8, 0xEB, 0xC4, 0x54, 0x0F, 0x48, 0x54, 0x1E, 0xFF, 0xEC, 0xC4, 0x54, - 0x01, 0x4F, 0x90, 0x81, 0xF0, 0xF0, 0xF1, 0x97, 0xEC, 0x30, 0xE4, 0x0A, 0x90, 0x81, 0x55, 0xE0, - 0xFD, 0x12, 0x6B, 0x81, 0x80, 0x35, 0xEB, 0x30, 0xE5, 0x09, 0x90, 0x81, 0x56, 0xB1, 0x2C, 0x04, - 0xF0, 0x80, 0x28, 0xEB, 0x30, 0xE6, 0x0A, 0x90, 0x81, 0x57, 0xB1, 0x2C, 0x74, 0x02, 0xF0, 0x80, - 0x1A, 0xEB, 0x30, 0xE7, 0x0A, 0x90, 0x81, 0x58, 0xB1, 0x2C, 0x74, 0x03, 0xF0, 0x80, 0x0C, 0xEA, - 0x30, 0xE0, 0x08, 0x90, 0x81, 0x59, 0xB1, 0x2C, 0x74, 0x04, 0xF0, 0xAF, 0x05, 0x80, 0x56, 0x90, - 0x81, 0x48, 0xE0, 0xFD, 0x7C, 0x00, 0xA3, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x20, 0x30, 0xED, - 0x4C, 0x70, 0x05, 0x90, 0x81, 0x55, 0x80, 0x2A, 0xED, 0x64, 0x01, 0x4C, 0x70, 0x05, 0x90, 0x81, - 0x56, 0x80, 0x1F, 0xED, 0x64, 0x02, 0x4C, 0x70, 0x05, 0x90, 0x81, 0x57, 0x80, 0x14, 0xED, 0x64, - 0x03, 0x4C, 0x70, 0x05, 0x90, 0x81, 0x58, 0x80, 0x09, 0xED, 0x64, 0x04, 0x4C, 0x70, 0x0C, 0x90, - 0x81, 0x59, 0xE0, 0xFF, 0xB1, 0x35, 0x90, 0x81, 0x49, 0x91, 0x5C, 0x22, 0xE0, 0xFD, 0x90, 0x81, - 0x49, 0xE4, 0xF0, 0xA3, 0x22, 0x90, 0x04, 0x24, 0xEF, 0xF0, 0x22, 0x12, 0x6B, 0x67, 0x12, 0x70, - 0xA6, 0x90, 0x81, 0x3D, 0xE0, 0x30, 0xE0, 0x02, 0x91, 0x63, 0x02, 0x4D, 0xE5, 0x12, 0x6D, 0xD2, - 0x90, 0x00, 0x08, 0xE0, 0x54, 0xEF, 0xFD, 0x7F, 0x08, 0x12, 0x32, 0x1E, 0xE4, 0xFF, 0x91, 0x0B, - 0x90, 0x81, 0x6D, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, - 0x6D, 0xEF, 0xB1, 0x4D, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x81, 0x74, 0xE0, 0xFF, 0x60, 0x03, - 0xB4, 0x08, 0x0E, 0x12, 0x70, 0x55, 0xBF, 0x01, 0x08, 0xB1, 0x68, 0x90, 0x01, 0xE5, 0xE0, 0x04, - 0xF0, 0x22, 0xE4, 0x90, 0x82, 0xE7, 0xF0, 0xA3, 0xF0, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x22, - 0xC3, 0x90, 0x82, 0xE8, 0xE0, 0x94, 0xD0, 0x90, 0x82, 0xE7, 0xE0, 0x94, 0x07, 0x40, 0x0A, 0x90, - 0x01, 0xC1, 0xE0, 0x44, 0x04, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0x82, 0xE7, 0x91, 0x5C, 0xF1, 0x5C, - 0x80, 0xD7, 0x7F, 0x01, 0x22, 0x90, 0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, 0x16, 0x12, 0x7A, 0xD8, - 0x90, 0x81, 0x3B, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x02, 0x86, 0xE0, 0x44, 0x04, 0xF1, 0x6C, 0x30, - 0xE0, 0x2B, 0x90, 0x01, 0xC7, 0xE4, 0xF0, 0xB1, 0x92, 0x90, 0x81, 0x3D, 0xE0, 0xBF, 0x01, 0x05, - 0x54, 0xEF, 0xF0, 0x80, 0x03, 0x44, 0x10, 0xF0, 0x90, 0x81, 0x40, 0xE0, 0xFF, 0x60, 0x0E, 0xE4, - 0xF5, 0x1D, 0x8F, 0x1E, 0xFB, 0xFD, 0x7F, 0x5C, 0x7E, 0x01, 0x12, 0x49, 0x12, 0x90, 0x81, 0x3D, - 0xE0, 0x44, 0x01, 0xF0, 0x7D, 0x08, 0xE4, 0xFF, 0xF1, 0xB2, 0x90, 0x05, 0x52, 0xE0, 0x54, 0x07, - 0x04, 0x90, 0x81, 0x48, 0x71, 0x71, 0x90, 0x04, 0x22, 0xE0, 0x54, 0xEF, 0xF0, 0xF1, 0x55, 0x30, - 0xE0, 0x02, 0xF1, 0x97, 0x22, 0x12, 0x7A, 0x8D, 0xFC, 0x54, 0x02, 0xFE, 0x90, 0x81, 0x3D, 0xE0, - 0x54, 0xFD, 0x4E, 0xF0, 0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x09, 0xF1, 0x4F, 0x12, 0x5F, 0xC1, - 0x90, 0x81, 0x40, 0xF0, 0xEC, 0x30, 0xE0, 0x13, 0xB1, 0xC5, 0x90, 0x80, 0x07, 0xE0, 0x64, 0x01, - 0x70, 0x37, 0x90, 0xFE, 0x10, 0xE0, 0x44, 0x04, 0xF0, 0x80, 0x2E, 0x90, 0x81, 0x5F, 0xE0, 0x60, - 0x15, 0x7D, 0x10, 0xE4, 0xFF, 0xF1, 0xE0, 0x90, 0x01, 0x3C, 0xE0, 0x30, 0xE4, 0x03, 0x74, 0x10, - 0xF0, 0x90, 0x01, 0x63, 0xE4, 0xF0, 0x12, 0x69, 0xC4, 0xF1, 0x55, 0x30, 0xE0, 0x0B, 0x90, 0x02, - 0x86, 0xE0, 0x30, 0xE2, 0x04, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x82, 0x0E, 0xF1, 0x63, 0x90, 0x81, - 0x3E, 0x12, 0x5F, 0x14, 0x90, 0x81, 0x3F, 0xF1, 0x6C, 0x30, 0xE0, 0x38, 0xF1, 0x4F, 0x12, 0x1F, - 0xA4, 0xFE, 0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x4D, 0xFF, 0x90, 0x81, 0x3D, 0xF0, 0xEE, 0x54, - 0x08, 0xFE, 0xEF, 0x54, 0xF7, 0x4E, 0x12, 0x5F, 0xE1, 0x90, 0x81, 0x41, 0xF0, 0x70, 0x03, 0x74, - 0x14, 0xF0, 0xF1, 0x4F, 0x90, 0x00, 0x05, 0x12, 0x1F, 0xBD, 0x90, 0x81, 0x42, 0x12, 0x65, 0xEA, - 0x90, 0x81, 0x43, 0xF0, 0x90, 0x81, 0x3E, 0xE0, 0x54, 0x01, 0x90, 0x81, 0x4B, 0xF0, 0x90, 0x81, - 0x3E, 0xE0, 0x54, 0x02, 0x90, 0x81, 0x4C, 0xF0, 0x90, 0x81, 0x3E, 0xE0, 0x54, 0x04, 0x90, 0x81, - 0x4D, 0xF0, 0x90, 0x81, 0x3E, 0xE0, 0x54, 0x08, 0x90, 0x81, 0x4E, 0xF0, 0x90, 0x81, 0x3E, 0xE0, - 0x54, 0x10, 0x90, 0x81, 0x4F, 0xF0, 0x90, 0x81, 0x3F, 0xE0, 0x54, 0x01, 0x90, 0x81, 0x50, 0xF0, - 0x90, 0x81, 0x3F, 0xE0, 0x54, 0x02, 0x90, 0x81, 0x51, 0xF0, 0x90, 0x81, 0x3F, 0xE0, 0x54, 0x04, - 0x90, 0x81, 0x52, 0xF0, 0x90, 0x81, 0x3F, 0xE0, 0x54, 0x08, 0x90, 0x81, 0x53, 0xF0, 0x90, 0x81, - 0x3F, 0xE0, 0x54, 0x10, 0x90, 0x81, 0x54, 0xF0, 0x22, 0x90, 0x82, 0x0E, 0x12, 0x44, 0xE7, 0x90, - 0x82, 0x0E, 0x02, 0x44, 0xDE, 0x90, 0x81, 0x3D, 0xE0, 0xC3, 0x13, 0x22, 0x7F, 0x0A, 0x7E, 0x00, - 0x02, 0x32, 0xAA, 0x12, 0x44, 0xDE, 0x90, 0x00, 0x01, 0x02, 0x1F, 0xBD, 0xF0, 0x90, 0x81, 0x3D, - 0xE0, 0xFF, 0xC3, 0x13, 0x22, 0xF1, 0x49, 0xF1, 0x8B, 0x7A, 0x81, 0x79, 0x55, 0x02, 0x2B, 0xED, - 0xF1, 0x49, 0xF1, 0x8B, 0x7A, 0x81, 0x79, 0x5A, 0x02, 0x2B, 0xED, 0x8B, 0x13, 0x8A, 0x14, 0x89, - 0x15, 0x75, 0x16, 0x05, 0x7B, 0x01, 0x22, 0x90, 0x00, 0xB6, 0x74, 0x10, 0xF0, 0x90, 0x00, 0xBE, - 0x74, 0xE0, 0xF0, 0xA3, 0x74, 0x01, 0xF0, 0x22, 0x7D, 0x01, 0x7F, 0x02, 0xF1, 0xB2, 0x7D, 0x02, - 0x7F, 0x02, 0x74, 0x3D, 0x2F, 0xF8, 0xE6, 0x4D, 0xFE, 0xF6, 0x74, 0x30, 0x80, 0x2B, 0x90, 0x81, - 0x6C, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0x81, 0x7A, 0xF0, 0xA3, 0xF0, 0x90, 0x81, 0x75, 0xF0, - 0x90, 0x81, 0x6D, 0xE0, 0x54, 0xF7, 0xF0, 0x54, 0xBF, 0xF0, 0xF1, 0xA8, 0x7D, 0x10, 0x7F, 0x03, - 0x74, 0x45, 0x12, 0x7A, 0xE1, 0xFE, 0xF6, 0x74, 0x38, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, - 0x83, 0xEE, 0xF0, 0x22, 0x75, 0xE8, 0x03, 0x75, 0xA8, 0x84, 0x22, 0x90, 0x00, 0x80, 0xE0, 0x44, - 0x80, 0xFD, 0x7F, 0x80, 0x12, 0x32, 0x1E, 0x90, 0xFD, 0x00, 0xE0, 0x54, 0xBF, 0xF0, 0x11, 0xC5, - 0x12, 0x32, 0x77, 0x11, 0xD2, 0x11, 0xAD, 0x7F, 0x01, 0x12, 0x42, 0x15, 0x90, 0x81, 0xDC, 0x74, - 0x02, 0xF0, 0xFF, 0x12, 0x42, 0x15, 0x90, 0x81, 0xDC, 0xE0, 0x04, 0xF0, 0x12, 0x50, 0x1D, 0x12, - 0x52, 0xA5, 0x90, 0x01, 0xCC, 0x74, 0x0F, 0xF0, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x40, 0xFD, 0x7F, - 0x80, 0x12, 0x32, 0x1E, 0x75, 0x20, 0xFF, 0x12, 0x57, 0xF4, 0x11, 0x53, 0x11, 0xBB, 0xE4, 0xFF, - 0x02, 0x42, 0x9E, 0xE4, 0x90, 0x82, 0x03, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x98, 0xE0, 0x7F, 0x00, - 0x30, 0xE4, 0x02, 0x7F, 0x01, 0xEF, 0x64, 0x01, 0x60, 0x3C, 0xC3, 0x90, 0x82, 0x04, 0xE0, 0x94, - 0x88, 0x90, 0x82, 0x03, 0xE0, 0x94, 0x13, 0x40, 0x0F, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x10, 0xF0, - 0x90, 0x01, 0xC7, 0x74, 0xFD, 0xF0, 0x80, 0x1E, 0x90, 0x82, 0x03, 0x12, 0x54, 0x5C, 0x11, 0xB4, - 0xD3, 0x90, 0x82, 0x04, 0xE0, 0x94, 0x32, 0x90, 0x82, 0x03, 0xE0, 0x94, 0x00, 0x40, 0xBB, 0x90, - 0x01, 0xC6, 0xE0, 0x30, 0xE3, 0xB4, 0x90, 0x01, 0xC7, 0x74, 0xFE, 0xF0, 0x22, 0xE4, 0x90, 0x80, - 0x01, 0x02, 0x50, 0x9B, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x32, 0xAA, 0x90, 0x01, 0xE4, 0x74, 0x17, - 0xF0, 0xA3, 0xE4, 0xF0, 0x22, 0x90, 0x01, 0x94, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x01, 0xC7, 0xE4, - 0xF0, 0x22, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x01, 0x9C, 0x74, 0x7E, 0xF0, 0xA3, - 0x74, 0x92, 0xF0, 0xA3, 0x74, 0xA0, 0xF0, 0xA3, 0x74, 0x24, 0xF0, 0x90, 0x01, 0x9B, 0x74, 0x49, - 0xF0, 0x90, 0x01, 0x9A, 0x74, 0xE0, 0xF0, 0x90, 0x01, 0x99, 0xE4, 0xF0, 0x90, 0x01, 0x98, 0x04, - 0xF0, 0x22, 0xE4, 0x90, 0x82, 0x05, 0xF0, 0x90, 0x82, 0x05, 0xE0, 0x64, 0x01, 0xF0, 0x24, 0x02, - 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x59, 0xA3, 0xF0, 0x90, 0x81, 0x71, 0xE0, 0x60, 0x0E, 0x90, 0x81, - 0x74, 0xE0, 0xFF, 0x90, 0x81, 0x73, 0xE0, 0x6F, 0x60, 0x02, 0x31, 0x41, 0xC2, 0xAF, 0x12, 0x68, - 0x50, 0xBF, 0x01, 0x03, 0x12, 0x70, 0x9B, 0xD2, 0xAF, 0x31, 0x40, 0x12, 0x41, 0x4D, 0x80, 0xC7, - 0x22, 0x90, 0x81, 0x73, 0xE0, 0xFF, 0x7D, 0x01, 0x02, 0x49, 0xA9, 0xE4, 0xFF, 0x12, 0x47, 0x87, - 0xBF, 0x01, 0x0E, 0x90, 0x81, 0x71, 0xE0, 0x60, 0x08, 0x31, 0x62, 0x54, 0x07, 0x70, 0x02, 0x31, - 0x41, 0x22, 0x90, 0x81, 0x75, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0x90, 0x06, 0xA9, 0xE0, 0xF5, 0x4E, - 0x54, 0xC0, 0x70, 0x07, 0x31, 0x62, 0x54, 0xFD, 0xF0, 0x80, 0xC6, 0xE5, 0x4E, 0x30, 0xE6, 0x1F, - 0x90, 0x81, 0x71, 0xE0, 0x64, 0x01, 0x70, 0x19, 0x90, 0x81, 0x75, 0xE0, 0x44, 0x01, 0xF0, 0x31, - 0xBC, 0x64, 0x02, 0x60, 0x05, 0x12, 0x6D, 0xA8, 0x80, 0x07, 0x12, 0x4F, 0x8F, 0x80, 0x02, 0x31, - 0x62, 0xE5, 0x4E, 0x90, 0x81, 0x75, 0x30, 0xE7, 0x0E, 0xE0, 0x44, 0x02, 0x12, 0x49, 0x01, 0x90, - 0x81, 0x6C, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, 0x81, 0x6F, 0xE0, - 0x54, 0x0F, 0x22, 0x12, 0x7A, 0x8D, 0xFF, 0x54, 0x7F, 0x90, 0x81, 0x71, 0xF0, 0xEF, 0xB1, 0xED, - 0xA3, 0xF0, 0x12, 0x57, 0x66, 0xFF, 0x54, 0xF0, 0xC4, 0x54, 0x0F, 0xFE, 0x90, 0x81, 0x6F, 0xE0, - 0x54, 0xF0, 0x4E, 0xF1, 0xC0, 0x54, 0x01, 0x25, 0xE0, 0xFE, 0x90, 0x81, 0x6C, 0xE0, 0x54, 0xFD, - 0x4E, 0xF0, 0xEF, 0x54, 0x0F, 0xC4, 0x54, 0xF0, 0xFF, 0x31, 0xBC, 0xF1, 0x13, 0x90, 0x81, 0x70, - 0xF1, 0xE1, 0xFD, 0x7F, 0x02, 0x12, 0x4B, 0x98, 0x12, 0x57, 0x4F, 0xD1, 0xE4, 0x12, 0x4F, 0xE8, - 0xF0, 0x90, 0x81, 0x71, 0x12, 0x7A, 0x96, 0x31, 0xBC, 0x90, 0x01, 0xBE, 0xF0, 0x22, 0x90, 0x82, - 0x0B, 0x12, 0x44, 0xE7, 0x90, 0x82, 0x0A, 0xEF, 0xF0, 0x12, 0x44, 0xF0, 0x5A, 0x5D, 0x00, 0x5A, - 0x62, 0x01, 0x5A, 0x66, 0x03, 0x5A, 0x6B, 0x04, 0x5A, 0x70, 0x08, 0x5A, 0x75, 0x09, 0x5A, 0x7A, - 0x0A, 0x5A, 0x7F, 0x12, 0x5A, 0x84, 0x13, 0x5A, 0x88, 0x14, 0x5A, 0x8D, 0x20, 0x5A, 0x91, 0x25, - 0x5A, 0x96, 0x26, 0x5A, 0x9B, 0xC2, 0x5A, 0xA0, 0xC4, 0x00, 0x00, 0x5A, 0xA5, 0x51, 0xB5, 0x02, - 0x65, 0xA6, 0x51, 0xB5, 0xE1, 0x1B, 0x51, 0xB5, 0x02, 0x71, 0x6D, 0x51, 0xB5, 0x02, 0x71, 0x95, - 0x51, 0xB5, 0x02, 0x56, 0x35, 0x51, 0xB5, 0x02, 0x57, 0x75, 0x51, 0xB5, 0x02, 0x57, 0x80, 0x51, - 0xB5, 0x02, 0x63, 0x8D, 0x51, 0xB5, 0xA1, 0x7A, 0x51, 0xB5, 0x02, 0x65, 0xF1, 0x51, 0xB5, 0x21, - 0xC3, 0x51, 0xB5, 0x02, 0x66, 0x00, 0x51, 0xB5, 0x02, 0x66, 0x08, 0x51, 0xB5, 0x02, 0x67, 0xE7, - 0x51, 0xB5, 0x02, 0x67, 0xEF, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x82, 0x0A, 0xE0, - 0x90, 0x01, 0xC2, 0xF0, 0x22, 0x90, 0x82, 0x0B, 0x02, 0x44, 0xDE, 0x12, 0x7A, 0xC4, 0x30, 0xE0, - 0x0B, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0x71, 0x2D, 0x90, 0x81, 0x6C, 0x12, - 0x6B, 0xA5, 0x30, 0xE0, 0x0A, 0xEF, 0x12, 0x7A, 0x82, 0x54, 0x07, 0x70, 0x47, 0x80, 0x43, 0x90, - 0x81, 0x7A, 0xE0, 0x04, 0xF0, 0x90, 0x81, 0x75, 0xE0, 0x54, 0xEF, 0xF0, 0x90, 0x81, 0xCE, 0xE0, - 0xFF, 0x90, 0x81, 0x7A, 0xE0, 0xD3, 0x9F, 0x40, 0x29, 0x12, 0x47, 0x63, 0x70, 0x26, 0x31, 0xBC, - 0x70, 0x02, 0x80, 0x21, 0x90, 0x81, 0x7B, 0xE0, 0x04, 0xF0, 0xE0, 0xD3, 0x94, 0x02, 0x40, 0x09, - 0x71, 0x25, 0xE4, 0x90, 0x81, 0x7B, 0xF0, 0x80, 0x03, 0x12, 0x4F, 0x8F, 0xE4, 0x90, 0x81, 0x7A, - 0xF0, 0x22, 0x31, 0x41, 0x22, 0x90, 0x81, 0x6D, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x7D, 0x02, 0x7F, - 0x02, 0x74, 0x3D, 0x12, 0x7A, 0xE1, 0xFE, 0xF6, 0x74, 0x30, 0x02, 0x57, 0xE9, 0xEF, 0x70, 0x35, - 0x7D, 0x78, 0x7F, 0x02, 0x71, 0x31, 0x7D, 0x02, 0x7F, 0x03, 0x71, 0x31, 0x7D, 0xC8, 0x7F, 0x02, - 0x12, 0x57, 0xE0, 0x12, 0x47, 0xE3, 0xF0, 0xE4, 0xFF, 0x12, 0x47, 0x87, 0xEF, 0x70, 0x0A, 0x71, - 0xB1, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x80, 0x07, 0x7D, 0x01, 0x7F, 0x0C, 0x12, 0x49, 0xA9, - 0x71, 0xB7, 0x02, 0x6F, 0x7C, 0x90, 0x01, 0x36, 0x74, 0x78, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x7D, - 0x78, 0xFF, 0x12, 0x57, 0xB2, 0x7D, 0x02, 0x7F, 0x03, 0x12, 0x57, 0xB2, 0x90, 0x06, 0x0A, 0xE0, - 0x44, 0x07, 0x12, 0x6D, 0x1C, 0xE4, 0xFF, 0x12, 0x47, 0x87, 0xBF, 0x01, 0x10, 0x71, 0x25, 0x90, - 0x81, 0x74, 0xE0, 0x20, 0xE2, 0x0A, 0x7D, 0x01, 0x7F, 0x04, 0x02, 0x49, 0xA9, 0x12, 0x66, 0xD0, - 0x22, 0x12, 0x4C, 0x1D, 0x12, 0x4F, 0x79, 0x90, 0x81, 0x6C, 0xE0, 0x54, 0xF7, 0xF0, 0x22, 0x90, - 0x81, 0x71, 0xE0, 0x60, 0x0F, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, 0x04, 0xD1, 0x11, 0x80, 0x04, - 0x71, 0xB7, 0x31, 0x41, 0x90, 0x81, 0xEA, 0xB1, 0xEB, 0x30, 0xE0, 0x1A, 0xEF, 0xC4, 0x54, 0x0F, - 0x30, 0xE0, 0x03, 0x12, 0x62, 0x97, 0x90, 0x81, 0xEB, 0xE0, 0x30, 0xE0, 0x09, 0xB1, 0x69, 0x20, - 0xE0, 0x02, 0x7D, 0x01, 0x71, 0xF7, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x82, - 0xE6, 0xED, 0xF0, 0x90, 0x82, 0xE5, 0xEF, 0xF0, 0xD3, 0x94, 0x07, 0x50, 0x4B, 0x91, 0xC8, 0x80, - 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0xFF, 0x90, 0x00, 0x47, 0xE0, 0x5F, 0xFD, 0x7F, 0x47, 0x91, - 0xC2, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xFF, 0x90, 0x00, 0x46, 0xE0, 0x4F, 0xFD, 0x7F, 0x46, - 0xB1, 0xFC, 0x60, 0x10, 0x91, 0xC5, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xFF, 0x90, 0x00, 0x45, - 0xE0, 0x4F, 0x80, 0x0F, 0x91, 0xC5, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0xFF, 0x90, 0x00, - 0x45, 0xE0, 0x5F, 0xFD, 0x7F, 0x45, 0x80, 0x62, 0x90, 0x82, 0xE5, 0xE0, 0x24, 0xF8, 0xF0, 0xE0, - 0x24, 0x04, 0x91, 0xC9, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0xFF, 0x90, 0x00, 0x43, 0xE0, - 0x5F, 0xFD, 0x7F, 0x43, 0x91, 0xC2, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xFF, 0x90, 0x00, 0x43, - 0xE0, 0x4F, 0xFD, 0x7F, 0x43, 0xB1, 0xFC, 0x60, 0x19, 0x90, 0x82, 0xE5, 0xE0, 0x24, 0x04, 0x91, - 0xC9, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xFF, 0x90, 0x00, 0x42, 0xE0, 0x4F, 0xFD, 0x7F, 0x42, - 0x80, 0x18, 0x90, 0x82, 0xE5, 0xE0, 0x24, 0x04, 0x91, 0xC9, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, - 0xF4, 0xFF, 0x90, 0x00, 0x42, 0xE0, 0x5F, 0xFD, 0x7F, 0x42, 0x12, 0x32, 0x1E, 0xD0, 0xD0, 0x92, - 0xAF, 0x22, 0x12, 0x32, 0x1E, 0x90, 0x82, 0xE5, 0xE0, 0xFF, 0x74, 0x01, 0xA8, 0x07, 0x08, 0x22, - 0xAD, 0x07, 0x90, 0x81, 0xEC, 0xE0, 0x75, 0xF0, 0x20, 0xA4, 0xFF, 0x90, 0x82, 0xBF, 0xE5, 0xF0, - 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x81, 0xED, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0xAE, 0xF0, 0x90, 0x82, - 0xC1, 0xF0, 0xEE, 0xA3, 0xF0, 0xB1, 0xF4, 0x90, 0x82, 0xC3, 0xF0, 0xEE, 0xA3, 0xF0, 0xED, 0x64, - 0x01, 0x60, 0x5E, 0x90, 0x81, 0xEA, 0xE0, 0xFE, 0xB1, 0xED, 0x30, 0xE0, 0x54, 0xEE, 0xB1, 0x6E, - 0x20, 0xE0, 0x02, 0x7D, 0x01, 0xB1, 0x62, 0xFE, 0x54, 0x0F, 0xFF, 0xEE, 0xC4, 0x13, 0x13, 0x54, - 0x01, 0xFD, 0xB1, 0x62, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x21, 0xA3, 0xE0, 0x30, 0xE0, 0x0D, - 0x90, 0x82, 0xC4, 0xE0, 0xF5, 0x1D, 0x90, 0x82, 0xC3, 0xD1, 0x04, 0x80, 0x0F, 0xB1, 0xF4, 0xFF, - 0x12, 0x32, 0xAA, 0xB1, 0x69, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x71, 0xF7, 0x90, 0x81, 0xEA, 0xE0, - 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x0B, 0x90, 0x82, 0xC2, 0xE0, 0xF5, 0x1D, 0x90, 0x82, 0xC1, 0xD1, - 0x04, 0x22, 0x71, 0xF7, 0x90, 0x81, 0xEA, 0xE0, 0x22, 0x90, 0x81, 0xEA, 0xE0, 0xFE, 0x54, 0x0F, - 0xFF, 0xEE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x7D, 0x00, 0x22, 0x12, 0x1F, 0xA4, 0xFF, 0x54, 0x80, - 0xFE, 0x90, 0x81, 0xEA, 0xE0, 0x54, 0x7F, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x40, 0xFF, 0xEE, 0x54, - 0xBF, 0x12, 0x67, 0xD6, 0x54, 0x20, 0xFD, 0xEF, 0x54, 0xDF, 0x4D, 0xFF, 0x90, 0x81, 0xEA, 0xF0, - 0xEE, 0x54, 0x10, 0xFE, 0xEF, 0x54, 0xEF, 0x4E, 0xFF, 0xF0, 0x12, 0x1F, 0xA4, 0x54, 0x0F, 0xFE, - 0xEF, 0x54, 0xF0, 0x4E, 0x90, 0x81, 0xEA, 0xF0, 0x12, 0x57, 0x66, 0xFF, 0x54, 0x7F, 0x90, 0x81, - 0xEC, 0xF0, 0xEF, 0x54, 0x80, 0xB1, 0xED, 0xFF, 0x90, 0x81, 0xEB, 0xE0, 0x54, 0xFE, 0xF1, 0x13, - 0x90, 0x81, 0xED, 0xF1, 0xC0, 0x54, 0x01, 0x25, 0xE0, 0xFF, 0x90, 0x81, 0xEB, 0xE0, 0x54, 0xFD, - 0x4F, 0xF0, 0xB1, 0x69, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x61, 0xF7, 0xE0, 0xFF, 0xC4, 0x13, 0x13, - 0x13, 0x54, 0x01, 0x22, 0x90, 0x82, 0xBF, 0xE0, 0xFE, 0xA3, 0xE0, 0x22, 0x12, 0x32, 0x1E, 0x90, - 0x82, 0xE6, 0xE0, 0x22, 0xE0, 0xF5, 0x1E, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, 0x01, 0x02, 0x49, - 0x12, 0x12, 0x6B, 0xAC, 0x30, 0xE0, 0x05, 0x90, 0x01, 0x5B, 0xE4, 0xF0, 0x90, 0x06, 0x92, 0x74, - 0x02, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x04, 0xF0, 0xE4, 0xF5, 0x1D, 0x90, 0x81, 0xD0, 0xE0, 0xC3, - 0x13, 0x54, 0x7F, 0xD1, 0x05, 0x90, 0x81, 0x6C, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0x90, 0x81, 0x6C, - 0xB1, 0xEB, 0x30, 0xE0, 0x1E, 0xEF, 0x54, 0x7F, 0xF1, 0xD7, 0x30, 0xE1, 0x06, 0xE0, 0x44, 0x02, - 0xF0, 0x80, 0x08, 0xE0, 0x54, 0xFD, 0x12, 0x4F, 0xE7, 0x04, 0xF0, 0x90, 0x81, 0x71, 0xE0, 0x60, - 0x02, 0x31, 0x41, 0x7F, 0x01, 0x90, 0x81, 0xE1, 0xE0, 0xFD, 0x30, 0xE0, 0x4C, 0x90, 0x81, 0xE6, - 0xE0, 0xFC, 0x60, 0x45, 0x12, 0x63, 0x85, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, - 0xFF, 0x90, 0x04, 0xE0, 0xE0, 0xFB, 0xEF, 0x5B, 0x60, 0x0B, 0xE4, 0x90, 0x81, 0xE6, 0xF0, 0x90, - 0x81, 0xE8, 0x04, 0xF0, 0x22, 0x90, 0x81, 0xE3, 0xE0, 0xD3, 0x9C, 0x50, 0x13, 0xED, 0x13, 0x13, - 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x04, 0xF1, 0xCE, 0x80, 0x02, 0xF1, 0x7B, 0xF1, 0xC7, 0xF0, 0x22, - 0x12, 0x4D, 0x4E, 0x90, 0x81, 0xE6, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x81, 0x6C, 0xE0, 0xFF, 0xC4, - 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x19, 0xEF, 0x54, 0xBF, 0xF1, 0xD7, 0x30, 0xE0, 0x06, 0xE0, - 0x44, 0x01, 0xF0, 0x80, 0x09, 0xE0, 0x54, 0xFE, 0x12, 0x4F, 0xE7, 0x74, 0x04, 0xF0, 0x31, 0x41, - 0xE4, 0xFF, 0x80, 0x81, 0x90, 0x82, 0x11, 0x12, 0x44, 0xE7, 0x12, 0x57, 0xBE, 0x90, 0x81, 0x71, - 0xE0, 0xFF, 0x71, 0x3D, 0x90, 0x81, 0x71, 0xE0, 0x60, 0x18, 0x90, 0x82, 0x11, 0x12, 0x57, 0x63, - 0x54, 0x0F, 0xFF, 0xF1, 0x15, 0xFD, 0x12, 0x6F, 0xA9, 0x12, 0x6D, 0x27, 0x74, 0x01, 0xF0, 0x12, - 0x6C, 0x46, 0x22, 0x4F, 0xF0, 0x90, 0x00, 0x02, 0x02, 0x1F, 0xBD, 0x8B, 0x53, 0x8A, 0x54, 0x89, - 0x55, 0x12, 0x57, 0x66, 0xFF, 0xF5, 0x57, 0x12, 0x1F, 0xA4, 0xFE, 0xC3, 0x13, 0x30, 0xE0, 0x06, - 0xF1, 0x15, 0xF5, 0x58, 0x80, 0x02, 0x8F, 0x58, 0x85, 0x57, 0x56, 0xE5, 0x56, 0xD3, 0x95, 0x58, - 0x50, 0x25, 0xAB, 0x53, 0xAA, 0x54, 0xA9, 0x55, 0x12, 0x1F, 0xA4, 0x54, 0x01, 0xFD, 0xAF, 0x56, - 0x12, 0x52, 0xC4, 0xAF, 0x56, 0x12, 0x47, 0x87, 0xEF, 0xAF, 0x56, 0x70, 0x04, 0xF1, 0xD6, 0x80, - 0x02, 0xF1, 0xE0, 0x05, 0x56, 0x80, 0xD4, 0xE5, 0x57, 0x70, 0x0F, 0xFF, 0x12, 0x47, 0x87, 0xEF, - 0x70, 0x08, 0x71, 0xB1, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x22, 0x90, 0x01, 0xC7, 0x74, 0x10, - 0xF0, 0x7F, 0x01, 0x90, 0x82, 0xF1, 0xEF, 0xF0, 0x90, 0x80, 0x07, 0xE0, 0xB4, 0x02, 0x12, 0x90, - 0x82, 0xF1, 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, 0x32, 0xAA, 0x90, 0x06, - 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x82, 0xF1, 0xE0, 0xFF, 0x91, 0xD0, 0xF1, 0xC7, 0xF0, 0x22, - 0xF0, 0x90, 0x00, 0x03, 0x02, 0x1F, 0xBD, 0x90, 0x81, 0xE1, 0xE0, 0x54, 0xFE, 0x22, 0xE4, 0xFD, - 0xFF, 0x12, 0x52, 0xC4, 0xE4, 0xFF, 0x22, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0x81, 0x6D, 0x22, - 0x22, 0xF0, 0x90, 0x00, 0x04, 0x02, 0x1F, 0xBD, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, 0x43, - 0x4E, 0x90, 0x82, 0x09, 0xEF, 0xF0, 0x60, 0xF0, 0x90, 0x80, 0x01, 0xE0, 0xFF, 0x70, 0x04, 0xA3, - 0xE0, 0x60, 0xE5, 0xC2, 0xAF, 0xEF, 0x30, 0xE1, 0x09, 0x90, 0x80, 0x01, 0xE0, 0x54, 0xFD, 0xF0, - 0x11, 0x3C, 0x11, 0x33, 0xFF, 0x30, 0xE2, 0x05, 0x54, 0xFB, 0xF0, 0x31, 0xC7, 0x11, 0x33, 0xFF, - 0x30, 0xE5, 0x0C, 0x54, 0xDF, 0xF0, 0x12, 0x55, 0x92, 0xBF, 0x01, 0x03, 0x12, 0x72, 0x93, 0xD2, - 0xAF, 0x80, 0xC5, 0xD2, 0xAF, 0xC2, 0xAF, 0x90, 0x80, 0x01, 0xE0, 0x22, 0xD3, 0x10, 0xAF, 0x01, - 0xC3, 0xC0, 0xD0, 0x90, 0x80, 0xA2, 0xE0, 0xFF, 0x90, 0x80, 0xA1, 0xE0, 0xB5, 0x07, 0x04, 0x7F, - 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x70, 0x3F, 0x90, 0x80, 0xA1, 0xE0, 0xFE, 0x75, 0xF0, 0x08, - 0x90, 0x80, 0x51, 0x12, 0x44, 0xD2, 0xE0, 0xFD, 0xEE, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x52, 0xF9, - 0x74, 0x80, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xAF, 0x05, 0x12, 0x5A, 0x1E, 0x90, 0x80, 0xA1, 0x31, - 0xC0, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0x80, 0xA1, 0xF0, 0x11, 0x9C, - 0x90, 0x80, 0x01, 0xE0, 0x44, 0x02, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x01, 0xCC, 0xE0, - 0x54, 0x0F, 0x90, 0x82, 0xE3, 0xF0, 0x90, 0x82, 0xE3, 0xE0, 0xFD, 0x70, 0x02, 0x21, 0x95, 0x90, - 0x80, 0xA1, 0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, 0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, - 0x80, 0xA2, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x08, 0x90, - 0x01, 0xC1, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x82, 0xE1, 0x71, 0x83, 0x80, 0x05, 0xC3, 0x33, - 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x70, 0x02, 0x21, 0x77, 0xE4, 0x90, 0x82, 0xE4, - 0xF0, 0x90, 0x82, 0xE4, 0xE0, 0xF9, 0xC3, 0x94, 0x04, 0x50, 0x31, 0x31, 0x96, 0xA4, 0xFF, 0xE9, - 0xFD, 0x7C, 0x00, 0x2F, 0xFF, 0xEC, 0x35, 0xF0, 0xFE, 0x74, 0xD0, 0x31, 0xAE, 0x90, 0x80, 0x51, - 0x31, 0x9E, 0x31, 0x96, 0xA4, 0x2D, 0xFF, 0xEC, 0x35, 0xF0, 0xFE, 0x74, 0xF0, 0x31, 0xAE, 0x90, - 0x80, 0x55, 0x31, 0x9E, 0x90, 0x82, 0xE4, 0xE0, 0x04, 0xF0, 0x80, 0xC5, 0x90, 0x82, 0xE3, 0xE0, - 0xFF, 0x90, 0x82, 0xE1, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, - 0xFC, 0xF4, 0x5F, 0x90, 0x82, 0xE3, 0xF0, 0x90, 0x82, 0xE1, 0x12, 0x5C, 0xC8, 0x80, 0x02, 0xC3, - 0x33, 0xD8, 0xFC, 0x90, 0x01, 0xCC, 0xF0, 0x90, 0x82, 0xE1, 0xE0, 0x04, 0xF0, 0xE0, 0x54, 0x03, - 0xF0, 0x90, 0x80, 0xA2, 0x31, 0xC0, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x70, 0x02, 0x01, 0xA6, - 0xE4, 0x90, 0x80, 0xA2, 0xF0, 0x01, 0xA6, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x82, - 0xE1, 0xE0, 0x44, 0x80, 0x90, 0x00, 0x8A, 0xF0, 0x31, 0x96, 0x90, 0x01, 0xD0, 0x12, 0x44, 0xD2, - 0xE0, 0x90, 0x01, 0xC3, 0xF0, 0x22, 0x90, 0x82, 0xE1, 0xE0, 0x75, 0xF0, 0x04, 0x22, 0x12, 0x44, - 0xD2, 0xE5, 0x82, 0x29, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xEF, 0xF0, 0x22, 0x2F, 0xF5, - 0x82, 0x74, 0x01, 0x3E, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0x80, 0xA2, 0xE0, 0x75, 0xF0, 0x08, 0x22, - 0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, - 0x90, 0x81, 0x3A, 0xE0, 0xFE, 0x90, 0x81, 0x39, 0xE0, 0xFD, 0xB5, 0x06, 0x04, 0x7E, 0x01, 0x80, - 0x02, 0x7E, 0x00, 0xEE, 0x64, 0x01, 0x60, 0x41, 0x90, 0x01, 0xAF, 0xE0, 0x70, 0x0A, 0xED, 0x51, - 0x8B, 0xFA, 0x7B, 0x01, 0x71, 0xA0, 0x7F, 0x01, 0xEF, 0x60, 0x2E, 0x90, 0x81, 0x39, 0x31, 0xC0, - 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0x81, 0x39, 0xF0, 0x90, 0x81, 0x3A, - 0xE0, 0xFF, 0x90, 0x81, 0x39, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, - 0x70, 0x07, 0x90, 0x80, 0x01, 0xE0, 0x44, 0x04, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, - 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x81, 0x39, 0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, - 0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0x81, 0x3A, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, - 0x7F, 0x00, 0xEF, 0x60, 0x09, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x28, 0xC0, 0x01, - 0x90, 0x81, 0x3A, 0xE0, 0x51, 0x8B, 0xA8, 0x01, 0xFC, 0x7D, 0x01, 0xD0, 0x01, 0x7E, 0x00, 0x7F, - 0x0F, 0x12, 0x44, 0x7D, 0x90, 0x81, 0x3A, 0x31, 0xC0, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, - 0x05, 0xE4, 0x90, 0x81, 0x3A, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x75, 0xF0, 0x0F, 0xA4, 0x24, - 0xA3, 0xF9, 0x74, 0x80, 0x35, 0xF0, 0x22, 0xE4, 0x90, 0x81, 0xF6, 0xF0, 0x90, 0x81, 0xF4, 0x74, - 0x14, 0xF0, 0x90, 0x82, 0x02, 0x74, 0x01, 0xF0, 0xFB, 0x7A, 0x81, 0x79, 0xF4, 0x51, 0x2E, 0x7F, - 0x04, 0x90, 0x82, 0xE9, 0xEF, 0xF0, 0x7F, 0x02, 0x12, 0x43, 0x27, 0x90, 0x80, 0x01, 0xE0, 0xFF, - 0x90, 0x82, 0xE9, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x80, 0x01, 0xF0, 0x22, 0x90, 0x82, 0x19, 0x74, - 0x12, 0xF0, 0x90, 0x82, 0x27, 0x74, 0x05, 0xF0, 0x90, 0x82, 0x1B, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, - 0xA3, 0xEB, 0xF0, 0x90, 0x82, 0x17, 0xE0, 0x90, 0x82, 0x1E, 0xF0, 0x90, 0x82, 0x18, 0xE0, 0x90, - 0x82, 0x1F, 0xF0, 0x7B, 0x01, 0x7A, 0x82, 0x79, 0x19, 0x51, 0x2E, 0x7F, 0x04, 0x80, 0xB2, 0x71, - 0x7C, 0x7F, 0xF5, 0x7E, 0x00, 0x12, 0x2B, 0x27, 0xBF, 0x01, 0x06, 0x90, 0x82, 0x0E, 0xE0, 0xA3, - 0xF0, 0x71, 0x7C, 0x7F, 0xF6, 0x7E, 0x00, 0x12, 0x2B, 0x27, 0xBF, 0x01, 0x08, 0x90, 0x82, 0x0E, - 0xE0, 0x90, 0x82, 0x10, 0xF0, 0x71, 0x7C, 0x7F, 0xF4, 0x7E, 0x00, 0x12, 0x2B, 0x27, 0xBF, 0x01, - 0x08, 0x90, 0x82, 0x0E, 0xE0, 0x90, 0x82, 0x11, 0xF0, 0x71, 0x7C, 0x7F, 0xF3, 0x7E, 0x00, 0x12, - 0x2B, 0x27, 0xBF, 0x01, 0x08, 0x90, 0x82, 0x0E, 0xE0, 0x90, 0x82, 0x12, 0xF0, 0x71, 0x7C, 0x7F, - 0xF2, 0x7E, 0x00, 0x12, 0x2B, 0x27, 0xBF, 0x01, 0x08, 0x90, 0x82, 0x0E, 0xE0, 0x90, 0x82, 0x13, - 0xF0, 0x90, 0x82, 0x0F, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, 0x82, - 0x17, 0xF0, 0x90, 0x82, 0x13, 0xE0, 0x90, 0x82, 0x18, 0xF0, 0x41, 0xCC, 0x7B, 0x01, 0x7A, 0x82, - 0x79, 0x0E, 0x22, 0xE0, 0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x22, 0x12, 0x1F, 0xA4, - 0xFF, 0x90, 0x81, 0x62, 0xF0, 0xBF, 0x01, 0x07, 0x51, 0xFF, 0xE4, 0x90, 0x81, 0x62, 0xF0, 0x22, - 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x82, 0x0A, 0x12, 0x44, 0xE7, 0x90, 0x82, 0xE2, - 0xE0, 0xFF, 0x04, 0xF0, 0x90, 0x00, 0x01, 0xEF, 0x12, 0x1F, 0xFC, 0x7F, 0xAF, 0x7E, 0x01, 0x12, - 0x53, 0xC3, 0xEF, 0x60, 0x3A, 0x90, 0x82, 0x0A, 0x12, 0x44, 0xDE, 0x8B, 0x13, 0x8A, 0x14, 0x89, - 0x15, 0x90, 0x00, 0x0E, 0x12, 0x1F, 0xBD, 0x24, 0x02, 0xF5, 0x16, 0x7B, 0x01, 0x7A, 0x01, 0x79, - 0xA0, 0x12, 0x2B, 0xED, 0x90, 0x82, 0x0A, 0x12, 0x44, 0xDE, 0x90, 0x00, 0x0E, 0x12, 0x1F, 0xBD, - 0x90, 0x01, 0xAE, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0x90, 0x01, 0xCB, 0xE0, 0x64, 0x80, 0xF0, 0xD0, - 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x82, 0x98, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0x12, 0x20, 0xDA, - 0x00, 0x00, 0x00, 0x00, 0xE4, 0x90, 0x82, 0xA6, 0xF0, 0x7F, 0x24, 0x7E, 0x08, 0x12, 0x2D, 0x5C, - 0x90, 0x82, 0x9E, 0x12, 0x20, 0xCE, 0x90, 0x82, 0x98, 0xE0, 0xFB, 0x70, 0x08, 0x90, 0x82, 0x9E, - 0x12, 0x44, 0xC6, 0x80, 0x06, 0xEB, 0x91, 0xED, 0x12, 0x2D, 0x5C, 0x90, 0x82, 0xA2, 0x12, 0x20, - 0xCE, 0x90, 0x82, 0x99, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x78, 0x17, 0xB1, 0x6A, 0x90, 0x82, - 0xA2, 0x12, 0x44, 0xC6, 0xED, 0x54, 0x7F, 0xFD, 0xEC, 0x54, 0x80, 0xFC, 0x12, 0x44, 0xB9, 0xEC, - 0x44, 0x80, 0xFC, 0x90, 0x82, 0xA2, 0x12, 0x20, 0xCE, 0xB1, 0x00, 0x54, 0x7F, 0xFC, 0x12, 0x4F, - 0xD8, 0xB1, 0x08, 0x91, 0xED, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x82, 0xA2, 0x12, 0x4F, 0xD5, 0xD0, - 0x07, 0xD0, 0x06, 0x12, 0x2E, 0xA2, 0xB1, 0x00, 0x44, 0x80, 0xFC, 0x12, 0x4F, 0xD8, 0xB1, 0x08, - 0x70, 0x04, 0x7F, 0x20, 0x80, 0x09, 0x90, 0x82, 0x98, 0xE0, 0xB4, 0x01, 0x16, 0x7F, 0x28, 0x7E, - 0x08, 0x12, 0x2D, 0x5C, 0x78, 0x08, 0x12, 0x20, 0xA8, 0xEF, 0x54, 0x01, 0xFF, 0xE4, 0x90, 0x82, - 0xA6, 0xEF, 0xF0, 0x90, 0x82, 0xA6, 0xE0, 0x90, 0x82, 0x98, 0x60, 0x0E, 0xE0, 0x75, 0xF0, 0x08, - 0xA4, 0x24, 0x66, 0xF5, 0x82, 0xE4, 0x34, 0x87, 0x80, 0x0C, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, - 0x64, 0xF5, 0x82, 0xE4, 0x34, 0x87, 0x91, 0xF8, 0x12, 0x2D, 0x5C, 0xED, 0x54, 0x0F, 0xFD, 0xE4, - 0xFC, 0x90, 0x82, 0x9A, 0x12, 0x20, 0xCE, 0x90, 0x82, 0x9A, 0x02, 0x44, 0xC6, 0x75, 0xF0, 0x08, - 0xA4, 0x24, 0x62, 0xF5, 0x82, 0xE4, 0x34, 0x87, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, - 0x90, 0x82, 0x9E, 0x12, 0x44, 0xC6, 0xEC, 0x22, 0x7F, 0x24, 0x7E, 0x08, 0x12, 0x2E, 0xA2, 0x90, - 0x82, 0x98, 0xE0, 0x22, 0x90, 0x82, 0xA7, 0xEF, 0xF0, 0xAB, 0x05, 0x90, 0x82, 0xAD, 0x12, 0x20, - 0xDA, 0x00, 0x00, 0x00, 0x00, 0xAF, 0x03, 0xE4, 0xFC, 0xFD, 0xFE, 0x78, 0x14, 0xB1, 0x6A, 0x90, - 0x82, 0xA9, 0x12, 0x44, 0xC6, 0xED, 0x54, 0x0F, 0xFD, 0xE4, 0xFC, 0x12, 0x44, 0xB9, 0xEC, 0x54, - 0x0F, 0xFC, 0x90, 0x82, 0xAD, 0x12, 0x20, 0xCE, 0x90, 0x82, 0xA7, 0xE0, 0x75, 0xF0, 0x08, 0xA4, - 0x24, 0x60, 0xF5, 0x82, 0xE4, 0x34, 0x87, 0x91, 0xF8, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x82, 0xAD, - 0x12, 0x4F, 0xD5, 0xD0, 0x07, 0xD0, 0x06, 0x02, 0x2E, 0xA2, 0x12, 0x20, 0xBB, 0xA8, 0x04, 0xA9, - 0x05, 0xAA, 0x06, 0xAB, 0x07, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x91, 0x04, 0xD0, - 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xC0, 0x07, 0xC0, 0x05, 0x90, - 0x82, 0xBB, 0x12, 0x44, 0xC6, 0x90, 0x82, 0xA9, 0x12, 0x20, 0xCE, 0xD0, 0x05, 0xD0, 0x07, 0xB1, - 0x14, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x02, 0x09, 0xE0, 0xF5, 0x53, 0x12, 0x1F, 0xA4, 0x25, - 0x53, 0x90, 0x80, 0x4A, 0xF0, 0x12, 0x57, 0x66, 0x25, 0x53, 0x90, 0x80, 0x4B, 0x12, 0x5F, 0x14, - 0x25, 0x53, 0x90, 0x80, 0x4C, 0x12, 0x5F, 0xC0, 0x25, 0x53, 0x90, 0x80, 0x4D, 0x12, 0x5F, 0xE1, - 0x25, 0x53, 0x90, 0x80, 0x4E, 0xF0, 0x90, 0x00, 0x05, 0x12, 0x1F, 0xBD, 0x25, 0x53, 0x90, 0x80, - 0x4F, 0xB1, 0xEA, 0x25, 0x53, 0x90, 0x80, 0x50, 0xF0, 0x22, 0xF0, 0x90, 0x00, 0x06, 0x02, 0x1F, - 0xBD, 0x12, 0x1F, 0xA4, 0x54, 0x01, 0xFF, 0x90, 0x81, 0xEF, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x22, - 0x12, 0x1F, 0xA4, 0x90, 0x81, 0xD4, 0xF0, 0x22, 0x12, 0x7A, 0x8D, 0xFF, 0x54, 0x01, 0xFE, 0x90, - 0x81, 0xD5, 0xF1, 0xC6, 0x54, 0x02, 0xFF, 0xEE, 0x54, 0xFD, 0xF1, 0xD6, 0x54, 0x04, 0x25, 0xE0, - 0xFD, 0xEF, 0x54, 0xF7, 0x4D, 0xFF, 0x90, 0x81, 0xD5, 0xF0, 0xEE, 0x54, 0x08, 0x25, 0xE0, 0xFE, - 0xEF, 0x54, 0xEF, 0x4E, 0xF0, 0x90, 0x05, 0x52, 0xE0, 0x54, 0x07, 0xFF, 0x90, 0x82, 0x0E, 0x60, - 0x13, 0x12, 0x57, 0x63, 0xFD, 0x90, 0x05, 0x56, 0xE0, 0xC3, 0x9D, 0x90, 0x81, 0xD7, 0xF0, 0xA3, - 0xED, 0xF0, 0x80, 0x23, 0x12, 0x57, 0x63, 0xFB, 0xFF, 0x90, 0x05, 0x54, 0xE0, 0xC3, 0x9F, 0xFF, - 0xE4, 0x94, 0x00, 0xFE, 0x7C, 0x00, 0x7D, 0x05, 0x12, 0x20, 0x30, 0x90, 0x81, 0xD7, 0xEF, 0xF0, - 0xEB, 0x75, 0xF0, 0x05, 0x84, 0xA3, 0xF0, 0x12, 0x57, 0x4F, 0x12, 0x1F, 0xA4, 0x20, 0xE0, 0x0A, - 0x12, 0x49, 0x7A, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x80, 0x0A, 0x7D, 0x0C, 0x7F, 0x01, 0x12, 0x4B, - 0x98, 0x12, 0x4F, 0xCD, 0x12, 0x6B, 0x99, 0x20, 0xE0, 0x04, 0xEF, 0x54, 0xDF, 0xF0, 0x12, 0x4F, - 0xC6, 0x30, 0xE0, 0x14, 0x90, 0x81, 0x71, 0x74, 0x01, 0xF0, 0xE4, 0x90, 0x81, 0x73, 0xF0, 0xD1, - 0xD0, 0x90, 0x05, 0x58, 0x74, 0x05, 0xF0, 0x22, 0xE4, 0x90, 0x81, 0x71, 0xF0, 0x90, 0x81, 0x73, - 0x74, 0x0C, 0xF0, 0x90, 0x81, 0x6C, 0xE0, 0x54, 0xFE, 0xF0, 0xA3, 0xE0, 0x54, 0xFB, 0xF0, 0x22, - 0x90, 0x81, 0x6D, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x90, 0x05, 0x62, 0xE0, 0xFE, 0x90, 0x05, 0x61, - 0xE0, 0xFD, 0xED, 0x78, 0x02, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, 0x81, 0xF0, - 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x47, 0x63, 0x60, 0x02, 0xE1, 0xA3, 0x90, 0x81, 0x71, 0xE0, - 0x70, 0x02, 0xE1, 0xA3, 0xF1, 0xA4, 0x64, 0x01, 0x70, 0x22, 0x90, 0x06, 0xAB, 0xE0, 0x90, 0x81, - 0x78, 0xF0, 0x90, 0x06, 0xAA, 0xE0, 0x90, 0x81, 0x77, 0xF0, 0xA3, 0xE0, 0xFF, 0x70, 0x08, 0x90, - 0x81, 0x77, 0xE0, 0xFE, 0xFF, 0x80, 0x00, 0x90, 0x81, 0x78, 0xEF, 0xF0, 0xE4, 0x90, 0x81, 0x7A, - 0x12, 0x6D, 0x1C, 0x12, 0x47, 0xE3, 0x12, 0x7A, 0x84, 0x54, 0xEF, 0xF0, 0x90, 0x81, 0x6F, 0xE0, - 0xFF, 0xC4, 0x54, 0x0F, 0x24, 0xFD, 0x50, 0x02, 0x80, 0x03, 0x12, 0x59, 0x6A, 0x12, 0x7A, 0xC4, - 0x30, 0xE0, 0x4E, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x1F, 0xF1, 0xAC, 0x6F, 0x70, - 0x40, 0x90, 0x81, 0x6D, 0xE0, 0x44, 0x40, 0xF0, 0xF1, 0xCE, 0xF1, 0xB4, 0xF1, 0xDE, 0xF1, 0xBF, - 0x12, 0x5B, 0x2D, 0x90, 0x81, 0x78, 0xE0, 0x14, 0xF0, 0x80, 0x26, 0xF1, 0xA4, 0x64, 0x01, 0x70, - 0x20, 0xF1, 0xAC, 0xFE, 0x6F, 0x60, 0x1A, 0x90, 0x05, 0x73, 0xE0, 0xFF, 0xEE, 0x6F, 0x60, 0x11, - 0x12, 0x6B, 0xA2, 0x30, 0xE0, 0x0B, 0xEF, 0x54, 0xBF, 0xF1, 0xB4, 0x12, 0x57, 0xE0, 0x12, 0x57, - 0xA8, 0xD1, 0xD0, 0x22, 0x90, 0x81, 0x6F, 0xE0, 0xC4, 0x54, 0x0F, 0x22, 0x90, 0x81, 0x77, 0xE0, - 0xFF, 0xA3, 0xE0, 0x22, 0xF0, 0x90, 0x01, 0x3F, 0x74, 0x10, 0xF0, 0xFD, 0x7F, 0x03, 0x22, 0x7D, - 0x01, 0x7F, 0x02, 0x02, 0x5B, 0x31, 0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, 0x22, 0x90, 0x81, - 0x77, 0xE0, 0x90, 0x05, 0x73, 0x22, 0x4F, 0xFF, 0xF0, 0x12, 0x1F, 0xA4, 0xFE, 0x22, 0x74, 0x45, - 0x2F, 0xF8, 0xE6, 0x4D, 0x02, 0x57, 0xE5, 0x12, 0x1F, 0xA4, 0x90, 0x81, 0xE9, 0xF0, 0x22, 0x12, - 0x1F, 0xA4, 0x90, 0x81, 0x5F, 0xF0, 0x12, 0x57, 0x66, 0x90, 0x81, 0x60, 0x12, 0x5F, 0x14, 0x90, - 0x81, 0x61, 0xF0, 0x22, 0xE4, 0x90, 0x81, 0x39, 0xF0, 0xA3, 0xF0, 0x90, 0x80, 0xA1, 0xF0, 0xA3, - 0xF0, 0x22, 0x75, 0x3D, 0x10, 0xE4, 0xF5, 0x3E, 0x75, 0x3F, 0x87, 0x75, 0x40, 0x03, 0x90, 0x01, - 0x30, 0xE5, 0x3D, 0xF0, 0xA3, 0xE5, 0x3E, 0xF0, 0xA3, 0xE5, 0x3F, 0xF0, 0xA3, 0xE5, 0x40, 0xF0, - 0x22, 0x75, 0x45, 0x0E, 0x75, 0x46, 0x01, 0x75, 0x47, 0x23, 0x75, 0x48, 0x62, 0x90, 0x01, 0x38, - 0xE5, 0x45, 0xF0, 0xA3, 0xE5, 0x46, 0xF0, 0xA3, 0xE5, 0x47, 0xF0, 0xA3, 0xE5, 0x48, 0xF0, 0x22, - 0x7F, 0x02, 0x90, 0x81, 0xDC, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x18, 0xEF, 0x25, 0xE0, 0x24, - 0x81, 0xF8, 0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0xA3, 0xF0, 0x7F, 0x00, - 0x22, 0x0F, 0x80, 0xDE, 0x7F, 0x01, 0x22, 0x90, 0x01, 0x34, 0xE0, 0x55, 0x3D, 0xF5, 0x41, 0xA3, - 0xE0, 0x55, 0x3E, 0xF5, 0x42, 0xA3, 0xE0, 0x55, 0x3F, 0xF5, 0x43, 0xA3, 0xE0, 0x55, 0x40, 0xF5, - 0x44, 0x90, 0x01, 0x34, 0xE5, 0x41, 0xF0, 0xA3, 0xE5, 0x42, 0xF0, 0xA3, 0xE5, 0x43, 0xF0, 0xA3, - 0xE5, 0x44, 0xF0, 0x22, 0x90, 0x01, 0x3C, 0xE0, 0x55, 0x45, 0xF5, 0x49, 0xA3, 0xE0, 0x55, 0x46, - 0xF5, 0x4A, 0xA3, 0xE0, 0x55, 0x47, 0xF5, 0x4B, 0xA3, 0xE0, 0x55, 0x48, 0xF5, 0x4C, 0x90, 0x01, - 0x3C, 0xE5, 0x49, 0xF0, 0xA3, 0xE5, 0x4A, 0xF0, 0xA3, 0xE5, 0x4B, 0xF0, 0xA3, 0xE5, 0x4C, 0xF0, - 0x53, 0x91, 0xDF, 0x22, 0x90, 0x01, 0xCF, 0xE0, 0x90, 0x82, 0xEC, 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, 0x50, - 0x6D, 0x90, 0x00, 0x03, 0xE0, 0x54, 0xFB, 0xFD, 0x7F, 0x03, 0x12, 0x32, 0x1E, 0x80, 0xFE, 0x22, - 0x71, 0x67, 0x90, 0x81, 0x71, 0xE0, 0x60, 0x2C, 0x90, 0x81, 0x6D, 0x71, 0xAF, 0x30, 0xE0, 0x0D, - 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x06, 0x12, 0x5B, 0x2D, 0x12, 0x67, 0xBF, 0x90, 0x82, 0xEB, - 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x80, 0x40, 0x0B, 0x90, 0x01, 0x98, 0xE0, 0x54, 0xFE, 0xF0, - 0xE0, 0x44, 0x01, 0xF0, 0x12, 0x47, 0xEE, 0xBF, 0x03, 0x14, 0x90, 0x81, 0xE9, 0xE0, 0xB4, 0x01, - 0x0D, 0x90, 0x01, 0xB8, 0xE0, 0x04, 0xF0, 0x90, 0x05, 0x21, 0xE0, 0x44, 0x80, 0xF0, 0x51, 0xDF, - 0xB1, 0x38, 0xE4, 0x90, 0x81, 0xE0, 0xF0, 0x31, 0x95, 0x90, 0x81, 0xD5, 0xE0, 0x30, 0xE0, 0x0C, - 0xE4, 0xF5, 0x1D, 0x90, 0x81, 0xD7, 0x12, 0x49, 0x08, 0x12, 0x4F, 0xCD, 0x90, 0x80, 0x07, 0xE0, - 0xB4, 0x01, 0x0F, 0x71, 0x99, 0x20, 0xE0, 0x0C, 0xEF, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x04, - 0x80, 0x00, 0x51, 0x3E, 0x22, 0x12, 0x57, 0x6D, 0x30, 0xE0, 0x1D, 0xEF, 0x30, 0xE0, 0x19, 0x13, - 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x11, 0x90, 0x81, 0x41, 0xE0, 0x70, 0x05, 0x31, 0xB9, 0x02, - 0x5F, 0x83, 0x90, 0x81, 0x41, 0xE0, 0x14, 0xF0, 0x22, 0x31, 0xC4, 0x90, 0x01, 0xC7, 0x74, 0x66, - 0xF0, 0xE4, 0xFF, 0x22, 0xC2, 0xAF, 0x90, 0x81, 0x3D, 0xE0, 0x54, 0xFE, 0xF0, 0x7D, 0x08, 0xE4, - 0xFF, 0x12, 0x5B, 0x31, 0x90, 0x02, 0x09, 0xE0, 0x90, 0x04, 0x24, 0xF0, 0x90, 0x02, 0x09, 0xE0, - 0x90, 0x04, 0x25, 0xF0, 0x71, 0x81, 0xD2, 0xAF, 0x22, 0x90, 0x81, 0x40, 0xE0, 0x60, 0x08, 0x90, - 0x81, 0x3D, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x31, 0xB9, 0x02, 0x5F, 0x83, 0x12, 0x57, 0x6D, 0x30, - 0xE0, 0x17, 0xE4, 0x90, 0x81, 0x40, 0xF0, 0x90, 0x81, 0x3D, 0xE0, 0x30, 0xE0, 0x0B, 0xC4, 0x54, - 0x0F, 0x30, 0xE0, 0x05, 0x31, 0xB9, 0x12, 0x5F, 0x83, 0x22, 0x51, 0x81, 0x90, 0x81, 0xF4, 0xEE, - 0xF0, 0xA3, 0xEF, 0x12, 0x57, 0x6C, 0x30, 0xE0, 0x14, 0x90, 0x81, 0xF5, 0xE0, 0x20, 0xE0, 0x0D, - 0x31, 0xC4, 0x90, 0x02, 0x86, 0xE0, 0x30, 0xE2, 0x04, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x90, 0x81, - 0xD5, 0xE0, 0xFF, 0x30, 0xE0, 0x3A, 0x90, 0x80, 0x07, 0xE0, 0x64, 0x01, 0x70, 0x2A, 0xEF, 0xC4, - 0x13, 0x54, 0x07, 0x20, 0xE0, 0x2A, 0x90, 0x82, 0xEF, 0xE0, 0x04, 0xF0, 0xE0, 0xD3, 0x94, 0xC8, - 0x40, 0x1E, 0x90, 0x81, 0xD5, 0xE0, 0x44, 0x20, 0xF0, 0xE4, 0x90, 0x82, 0xEF, 0xF0, 0x90, 0x81, - 0xD5, 0xE0, 0x13, 0x30, 0xE0, 0x0A, 0x80, 0x06, 0x12, 0x4F, 0xC6, 0x30, 0xE0, 0x02, 0x71, 0xB6, - 0x22, 0xE4, 0x90, 0x81, 0xF8, 0xF0, 0xA3, 0xF0, 0x90, 0x00, 0x9E, 0xE0, 0x90, 0x81, 0xFA, 0xF0, - 0x90, 0x00, 0x9F, 0xE0, 0x90, 0x81, 0xFB, 0xF0, 0xE0, 0xFD, 0xFE, 0x90, 0x81, 0xFA, 0xE0, 0xFC, - 0xFB, 0xEB, 0xFF, 0x90, 0x81, 0xF6, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x00, 0x9E, 0xE0, 0xFF, - 0xEC, 0xB5, 0x07, 0x09, 0xA3, 0xE0, 0xFF, 0xED, 0xB5, 0x07, 0x02, 0x80, 0x11, 0xC3, 0x90, 0x81, - 0xF9, 0xE0, 0x94, 0x64, 0x90, 0x81, 0xF8, 0xE0, 0x94, 0x00, 0x40, 0x0B, 0x71, 0x89, 0x90, 0x81, - 0xF6, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x90, 0x81, 0xF8, 0x12, 0x54, 0x5C, 0x80, 0xA9, 0x90, - 0x81, 0xE1, 0xE0, 0x20, 0xE0, 0x02, 0x61, 0x66, 0x90, 0x81, 0xE5, 0xE0, 0x04, 0xF0, 0x90, 0x81, - 0xE8, 0xE0, 0x64, 0x01, 0x70, 0x33, 0x90, 0x81, 0xE1, 0x71, 0xA5, 0x30, 0xE0, 0x2B, 0x90, 0x81, - 0xE7, 0xE0, 0x70, 0x25, 0x90, 0x81, 0xE4, 0xE0, 0xFE, 0xA3, 0xE0, 0xC3, 0x9E, 0x40, 0x1A, 0xEF, - 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x09, 0x12, 0x5F, 0xCE, 0x12, 0x5F, 0xC7, 0xF0, 0x80, - 0x08, 0x12, 0x5F, 0x7B, 0x12, 0x5F, 0xC7, 0xF0, 0x22, 0x90, 0x81, 0xE5, 0xE0, 0xFF, 0x90, 0x81, - 0xE2, 0xE0, 0xD3, 0x9F, 0x50, 0x30, 0x90, 0x06, 0x92, 0xE0, 0x20, 0xE2, 0x1A, 0x90, 0x81, 0xE7, - 0xE0, 0x70, 0x14, 0x7D, 0x08, 0xFF, 0x12, 0x4D, 0x52, 0x90, 0x81, 0xE6, 0xE0, 0x04, 0xF0, 0x90, - 0x81, 0xE0, 0xE0, 0x04, 0xF0, 0x80, 0x06, 0x90, 0x06, 0x92, 0x74, 0x04, 0xF0, 0xE4, 0x90, 0x81, - 0xE5, 0xF0, 0x90, 0x81, 0xE7, 0xF0, 0x22, 0xE4, 0xF5, 0x4E, 0xF5, 0x4F, 0xF5, 0x50, 0x22, 0x71, - 0x67, 0x90, 0x05, 0x50, 0xE0, 0x44, 0x01, 0xF0, 0x12, 0x47, 0xEE, 0xBF, 0x03, 0x02, 0x71, 0x91, - 0x22, 0xE4, 0x90, 0x81, 0x49, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x40, 0xF0, - 0x22, 0x90, 0x05, 0x21, 0xE0, 0x54, 0x7F, 0xF0, 0x22, 0x90, 0x81, 0xD5, 0xE0, 0xFF, 0xC4, 0x54, - 0x0F, 0x22, 0x90, 0x81, 0x6D, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x22, 0x90, 0x81, 0x6C, 0xE0, - 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0x90, 0x81, 0x6C, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x81, 0x7C, - 0x74, 0xD0, 0xF0, 0x22, 0xE4, 0x90, 0x81, 0xF6, 0xF0, 0xA3, 0xF0, 0x90, 0x00, 0x83, 0xE0, 0x90, - 0x81, 0xF5, 0xF0, 0x90, 0x00, 0x83, 0xE0, 0xFE, 0x90, 0x81, 0xF5, 0xE0, 0xFF, 0xB5, 0x06, 0x01, - 0x22, 0xC3, 0x90, 0x81, 0xF7, 0xE0, 0x94, 0x64, 0x90, 0x81, 0xF6, 0xE0, 0x94, 0x00, 0x40, 0x08, - 0x71, 0x89, 0x90, 0x81, 0xF5, 0xE0, 0xFF, 0x22, 0x90, 0x81, 0xF6, 0x12, 0x54, 0x5C, 0x80, 0xCB, - 0x71, 0xC4, 0x90, 0x81, 0xF4, 0xEF, 0xF0, 0x30, 0xE0, 0x05, 0x7D, 0x01, 0xE4, 0x80, 0x02, 0xE4, - 0xFD, 0xFF, 0x12, 0x4B, 0x98, 0x90, 0x81, 0xF4, 0xE0, 0x30, 0xE6, 0x11, 0x90, 0x01, 0x2F, 0xE0, - 0x30, 0xE7, 0x04, 0xE4, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x80, 0xF0, 0x90, 0x81, 0x6C, - 0xE0, 0x90, 0x04, 0xEC, 0x30, 0xE0, 0x06, 0xE0, 0x54, 0xDD, 0xF0, 0x80, 0x04, 0xE0, 0x44, 0x22, - 0xF0, 0xB1, 0x27, 0x74, 0x02, 0xF0, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAC, 0x07, 0x90, - 0x81, 0x6D, 0xE0, 0x12, 0x5D, 0xED, 0x30, 0xE0, 0x02, 0xA1, 0x05, 0x90, 0x81, 0x6C, 0xE0, 0x30, - 0xE0, 0x16, 0x90, 0x81, 0x8E, 0xE0, 0x24, 0x04, 0x90, 0x81, 0x86, 0xF0, 0x90, 0x81, 0x8E, 0xE0, - 0x24, 0x03, 0x90, 0x81, 0x85, 0xF0, 0x80, 0x0D, 0x90, 0x81, 0x86, 0x74, 0x02, 0xF0, 0x90, 0x81, - 0x85, 0x14, 0xF0, 0x0B, 0x0B, 0x90, 0x81, 0x85, 0xE0, 0xFA, 0x90, 0x81, 0x84, 0xE0, 0xD3, 0x9A, - 0x50, 0x0E, 0x90, 0x81, 0x79, 0xEB, 0xF0, 0x90, 0x81, 0x86, 0xE0, 0xC3, 0x9D, 0x2C, 0x80, 0x11, - 0xC3, 0xED, 0x9A, 0x2B, 0x90, 0x81, 0x79, 0xF0, 0x90, 0x81, 0x85, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, - 0x9F, 0x90, 0x81, 0x89, 0xF0, 0x90, 0x81, 0x86, 0xE0, 0xFF, 0x24, 0x0A, 0xFD, 0xE4, 0x33, 0xFC, - 0x90, 0x81, 0x89, 0xB1, 0x11, 0x40, 0x04, 0xEF, 0x24, 0x0A, 0xF0, 0x90, 0x81, 0x89, 0xE0, 0xFF, - 0x24, 0x23, 0xFD, 0xE4, 0x33, 0xFC, 0x90, 0x81, 0x79, 0xB1, 0x11, 0x40, 0x04, 0xEF, 0x24, 0x23, - 0xF0, 0x90, 0x81, 0x89, 0xE0, 0xFF, 0x7E, 0x00, 0x90, 0x81, 0x7D, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, - 0x90, 0x05, 0x58, 0xE0, 0x6F, 0x70, 0x01, 0xE4, 0x60, 0x02, 0xB1, 0x1D, 0x90, 0x81, 0x6E, 0xE0, - 0x54, 0xFE, 0xF0, 0x80, 0x07, 0x90, 0x81, 0x6E, 0xE0, 0x44, 0x01, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, - 0x22, 0xE0, 0xD3, 0x9D, 0xEC, 0x64, 0x80, 0xF8, 0x74, 0x80, 0x98, 0x22, 0xF0, 0x90, 0x81, 0x7D, - 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x22, 0x90, 0x81, 0x83, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, - 0x81, 0x8A, 0xE0, 0xFB, 0x90, 0x82, 0xDD, 0x22, 0x90, 0x81, 0xDD, 0xE0, 0x30, 0xE0, 0x35, 0x12, - 0x47, 0x63, 0x70, 0x30, 0x90, 0x82, 0xF2, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x0A, 0x0B, 0x90, 0x81, - 0xDF, 0xE0, 0x04, 0xF0, 0xE4, 0x90, 0x82, 0xF2, 0xF0, 0x90, 0x81, 0xDF, 0xE0, 0xFF, 0x90, 0x81, - 0xDE, 0xE0, 0xD3, 0x9F, 0x50, 0x0E, 0x90, 0x81, 0xE0, 0xE0, 0x70, 0x08, 0xE4, 0x90, 0x81, 0xDF, - 0xF0, 0x12, 0x4F, 0xF2, 0x22, 0x90, 0x81, 0xE7, 0xE0, 0x04, 0xF0, 0x90, 0x81, 0x74, 0xE0, 0x64, - 0x02, 0x60, 0x09, 0x12, 0x66, 0xD8, 0x90, 0x01, 0xE6, 0xE0, 0x04, 0xF0, 0x22, 0xE4, 0xFF, 0x12, - 0x47, 0x87, 0xBF, 0x01, 0x12, 0x90, 0x81, 0x71, 0xE0, 0x60, 0x0C, 0x12, 0x59, 0xBC, 0x64, 0x02, - 0x60, 0x02, 0x80, 0x04, 0x12, 0x4F, 0x8F, 0x22, 0x90, 0x04, 0x1D, 0xE0, 0x70, 0x1C, 0x90, 0x80, - 0x4B, 0xE0, 0xFF, 0x90, 0x82, 0xD1, 0x74, 0x09, 0xF0, 0x7B, 0x18, 0xE4, 0xFD, 0x12, 0x4E, 0xAD, - 0x90, 0x81, 0xF2, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xB1, 0xCB, 0x22, 0x90, 0x04, 0x1F, 0x74, 0x20, - 0xF0, 0x22, 0x90, 0x01, 0xC4, 0x74, 0xD2, 0xF0, 0x74, 0x6D, 0xA3, 0xF0, 0x90, 0x00, 0x90, 0xE0, - 0x20, 0xE0, 0xF9, 0x74, 0xD2, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x6D, 0xA3, 0xF0, 0x22, 0x90, - 0x81, 0x6D, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x81, 0x7C, 0xE0, 0xFD, 0x7F, 0x93, 0x12, 0x32, 0x1E, - 0x90, 0x81, 0x72, 0xE0, 0x60, 0x12, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x05, 0x74, 0x10, 0xF0, - 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, 0x90, 0x00, 0x08, 0xE0, 0x44, 0x10, 0xFD, 0x7F, - 0x08, 0x12, 0x32, 0x1E, 0x7F, 0x01, 0x12, 0x54, 0x0B, 0x90, 0x00, 0x90, 0xE0, 0x44, 0x01, 0xFD, - 0x7F, 0x90, 0x12, 0x32, 0x1E, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x32, 0xAA, 0x90, 0x81, 0xEA, 0xE0, - 0x54, 0x7F, 0xF0, 0x54, 0xBF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xF0, 0xF0, 0xE4, 0x90, 0x81, 0xEC, - 0xF0, 0x90, 0x81, 0xEA, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0x7E, 0x00, 0x7F, 0x62, 0x7D, 0x00, 0x7B, - 0x01, 0x7A, 0x81, 0x79, 0x6C, 0x12, 0x45, 0x16, 0x90, 0x81, 0x70, 0x74, 0x02, 0xF0, 0x90, 0x81, - 0x77, 0x14, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0x90, 0x81, 0x7D, 0xE4, 0xF0, 0xA3, 0x74, - 0x02, 0xF1, 0x02, 0xE4, 0xFD, 0xFF, 0x12, 0x4B, 0x98, 0x7D, 0x0C, 0x7F, 0x02, 0x12, 0x4B, 0x98, - 0x7D, 0x0C, 0x7F, 0x01, 0x12, 0x4B, 0x98, 0x90, 0x80, 0x07, 0xE0, 0xFF, 0xB4, 0x01, 0x08, 0x90, - 0x81, 0x7C, 0x74, 0x99, 0xF0, 0x80, 0x29, 0xEF, 0xB4, 0x03, 0x08, 0x90, 0x81, 0x7C, 0x74, 0x90, - 0xF0, 0x80, 0x1D, 0x90, 0x81, 0x7C, 0x74, 0x40, 0xF0, 0x90, 0x00, 0x2C, 0xE0, 0x54, 0x0F, 0xFF, - 0xBF, 0x05, 0x08, 0x90, 0x81, 0x8E, 0x74, 0x02, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x81, 0x8E, 0xF0, - 0x90, 0x81, 0xCE, 0x74, 0x02, 0xF0, 0xA3, 0x74, 0x0F, 0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, - 0xF0, 0xA3, 0x74, 0x07, 0xF1, 0x02, 0x7E, 0x00, 0x7F, 0x02, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x81, - 0x79, 0xD2, 0x12, 0x45, 0x16, 0xF1, 0x12, 0xF1, 0x7C, 0x12, 0x4F, 0x8A, 0xE4, 0x90, 0x81, 0xD4, - 0xF0, 0x22, 0xF0, 0x90, 0x81, 0x8E, 0xE0, 0x24, 0x04, 0x90, 0x81, 0x89, 0xF0, 0xA3, 0x74, 0x0A, - 0xF0, 0x22, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, 0xF0, 0x22, 0x90, 0x82, 0xC5, 0xE0, 0xFF, 0xD3, - 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x82, 0xF0, 0xEF, 0xF0, 0x90, 0x80, 0x4C, 0xE0, 0xFF, - 0x90, 0x04, 0x1C, 0xE0, 0x6F, 0x70, 0x40, 0x90, 0x81, 0x74, 0xE0, 0x64, 0x0E, 0x70, 0x18, 0x90, - 0x82, 0xF0, 0xE0, 0x70, 0x32, 0x90, 0x81, 0x6C, 0xE0, 0x54, 0x7F, 0xF0, 0xF1, 0x12, 0x7D, 0x0C, - 0x7F, 0x01, 0x12, 0x4B, 0x98, 0x80, 0x1D, 0x90, 0x81, 0x74, 0xE0, 0x64, 0x06, 0x70, 0x18, 0x90, - 0x82, 0xF0, 0xE0, 0x60, 0x12, 0x90, 0x81, 0x6C, 0xE0, 0x54, 0xBF, 0xF0, 0xF1, 0x84, 0x90, 0x81, - 0x74, 0x74, 0x04, 0xF0, 0x12, 0x4F, 0x8A, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x06, 0x0A, 0xE0, - 0x54, 0xF8, 0xF0, 0x22, 0x90, 0x06, 0x04, 0xE0, 0x44, 0x40, 0xF0, 0xE0, 0x44, 0x80, 0xF0, 0x22, - 0x90, 0x04, 0x1A, 0xE0, 0xF4, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x90, 0x04, 0x1B, 0xE0, 0x54, 0x07, - 0x64, 0x07, 0x7F, 0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, 0xEF, 0x24, 0xFE, 0x60, 0x0B, 0x04, 0x70, - 0x24, 0x90, 0x81, 0x77, 0x74, 0x02, 0xF0, 0x80, 0x13, 0xED, 0x70, 0x06, 0x90, 0x81, 0xD1, 0xE0, - 0x80, 0x02, 0xED, 0x14, 0x90, 0x81, 0x77, 0xF0, 0x90, 0x81, 0x77, 0xE0, 0xA3, 0xF0, 0x90, 0x81, - 0x6D, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xF1, 0x90, 0xEF, - 0x64, 0x01, 0x60, 0x05, 0x75, 0x0F, 0x01, 0x80, 0x51, 0x90, 0x81, 0x75, 0xE0, 0xFF, 0x54, 0x03, - 0x60, 0x05, 0x75, 0x0F, 0x02, 0x80, 0x43, 0x90, 0x81, 0x73, 0xE0, 0xFE, 0xE4, 0xC3, 0x9E, 0x50, - 0x05, 0x75, 0x0F, 0x04, 0x80, 0x34, 0xEF, 0x30, 0xE2, 0x05, 0x75, 0x0F, 0x08, 0x80, 0x2B, 0x90, - 0x81, 0x75, 0xE0, 0x30, 0xE4, 0x05, 0x75, 0x0F, 0x10, 0x80, 0x1F, 0x90, 0x81, 0x6D, 0xE0, 0x13, - 0x13, 0x54, 0x3F, 0x20, 0xE0, 0x05, 0x75, 0x0F, 0x20, 0x80, 0x0F, 0x90, 0x81, 0xD4, 0xE0, 0x60, - 0x05, 0x75, 0x0F, 0x80, 0x80, 0x04, 0x11, 0x4D, 0x80, 0x0E, 0x90, 0x01, 0xB9, 0x74, 0x04, 0xF0, - 0x90, 0x01, 0xB8, 0xE5, 0x0F, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x01, 0xB8, - 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x02, 0x87, 0xE0, 0x60, 0x02, 0x80, 0x08, 0x90, 0x01, 0x00, - 0xE0, 0x64, 0x3F, 0x60, 0x05, 0x75, 0x52, 0x01, 0x80, 0x22, 0x90, 0x02, 0x96, 0xE0, 0x60, 0x05, - 0x75, 0x52, 0x10, 0x80, 0x17, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x02, 0x80, 0x07, 0x90, 0x02, - 0x86, 0xE0, 0x30, 0xE3, 0x05, 0x75, 0x52, 0x04, 0x80, 0x02, 0x80, 0xC1, 0x90, 0x01, 0xB9, 0x74, - 0x08, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x52, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0x81, 0x6C, 0xE0, 0x30, - 0xE0, 0x03, 0x12, 0x55, 0x79, 0x22, 0xE4, 0xF5, 0x51, 0x90, 0x81, 0x71, 0xE0, 0x60, 0x79, 0x12, - 0x47, 0x63, 0x70, 0x74, 0x12, 0x67, 0xA4, 0x60, 0x22, 0x24, 0xFE, 0x60, 0x03, 0x04, 0x70, 0x1E, - 0x90, 0x81, 0x78, 0xE0, 0x14, 0xF0, 0xE0, 0xFF, 0x60, 0x06, 0x90, 0x81, 0x7A, 0xE0, 0x60, 0x0E, - 0xEF, 0x70, 0x08, 0x90, 0x81, 0x77, 0xE0, 0xA3, 0xF0, 0x80, 0x00, 0x75, 0x51, 0x01, 0xE5, 0x51, - 0x60, 0x46, 0x31, 0x34, 0x90, 0x81, 0x7A, 0xE0, 0x60, 0x04, 0x64, 0x01, 0x70, 0x16, 0xE4, 0xF5, - 0x1D, 0x90, 0x81, 0x7A, 0xE0, 0xFF, 0x90, 0x81, 0x79, 0xE0, 0x2F, 0x12, 0x49, 0x09, 0x90, 0x81, - 0x7A, 0xE0, 0x80, 0x10, 0xE4, 0xF5, 0x1D, 0x31, 0x29, 0xFF, 0x90, 0x81, 0x79, 0xE0, 0x2F, 0x12, - 0x49, 0x09, 0x31, 0x29, 0xFF, 0x90, 0x81, 0x79, 0xE0, 0x2F, 0x90, 0x81, 0x8A, 0xF0, 0x90, 0x81, - 0x74, 0xE0, 0x20, 0xE2, 0x03, 0x12, 0x49, 0xA5, 0x22, 0x90, 0x81, 0x7A, 0xE0, 0x75, 0xF0, 0x03, - 0xA4, 0x24, 0xFE, 0x22, 0x90, 0x81, 0x75, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x81, 0xD5, 0xE0, - 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x54, 0xFB, 0xF0, 0x44, 0x10, 0xF0, 0x22, 0x74, 0x6D, 0x2E, - 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0xE0, 0xFF, 0xE4, 0xFE, 0xEF, 0xC3, 0x13, 0xFD, 0xEF, - 0x30, 0xE0, 0x02, 0x7E, 0x80, 0x90, 0xFD, 0x10, 0xED, 0xF0, 0xAF, 0x06, 0x22, 0x31, 0x8D, 0x90, - 0x81, 0xDD, 0x12, 0x67, 0xC6, 0x54, 0x04, 0xFF, 0xEE, 0x54, 0xFB, 0x4F, 0xF0, 0x12, 0x1F, 0xA4, - 0xC3, 0x13, 0x30, 0xE0, 0x07, 0x12, 0x57, 0x66, 0x90, 0x81, 0xDE, 0xF0, 0x22, 0x12, 0x1F, 0xA4, - 0xFF, 0x54, 0x01, 0xFE, 0x22, 0x90, 0x82, 0x0E, 0x12, 0x44, 0xE7, 0x31, 0xDC, 0x12, 0x57, 0x4F, - 0x31, 0x8D, 0x12, 0x5F, 0xC7, 0x4E, 0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x2E, 0x12, 0x57, 0x66, - 0x90, 0x81, 0xE2, 0x12, 0x5F, 0x14, 0x90, 0x81, 0xE3, 0xF0, 0x12, 0x1F, 0xA4, 0xFF, 0x54, 0x04, - 0xFE, 0x90, 0x81, 0xE1, 0xE0, 0x54, 0xFB, 0x4E, 0x12, 0x5F, 0xC0, 0x90, 0x81, 0xE4, 0xF0, 0xEF, - 0x54, 0x08, 0xFF, 0x90, 0x81, 0xE1, 0xE0, 0x54, 0xF7, 0x4F, 0xF0, 0x22, 0x7E, 0x00, 0x7F, 0x08, - 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x81, 0x79, 0xE1, 0x12, 0x45, 0x16, 0x90, 0x81, 0xE2, 0x74, 0x08, - 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0x22, 0x90, 0x82, 0x0A, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x02, - 0x84, 0xEF, 0xF0, 0xEE, 0xA3, 0xF0, 0xA3, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x7D, 0x7F, 0xEF, 0x5D, - 0xC3, 0x60, 0x0A, 0x51, 0x21, 0x24, 0x80, 0xFF, 0xE4, 0x3E, 0xFE, 0x80, 0x03, 0x51, 0x21, 0xFF, - 0x22, 0x74, 0xFF, 0x9D, 0xFD, 0x74, 0xFF, 0x94, 0x00, 0x5E, 0xFE, 0xED, 0x5F, 0x22, 0x90, 0x82, - 0x8D, 0x12, 0x44, 0xE7, 0xE4, 0xFF, 0x90, 0x82, 0x93, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x1E, - 0x90, 0x82, 0x90, 0x12, 0x44, 0xDE, 0x8F, 0x82, 0x51, 0x77, 0xFE, 0x90, 0x82, 0x8D, 0x12, 0x44, - 0xDE, 0x8F, 0x82, 0x51, 0x77, 0x6E, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x0F, 0x80, 0xD8, 0x7F, 0x01, - 0x22, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0x5E, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0x12, 0x44, - 0xDE, 0x90, 0x82, 0x14, 0xE0, 0xF5, 0x82, 0x75, 0x83, 0x00, 0x02, 0x1F, 0xBD, 0x74, 0x03, 0xF0, - 0x7A, 0x82, 0x79, 0xB5, 0x51, 0x2E, 0xEF, 0x22, 0x74, 0x03, 0xF0, 0x7A, 0x82, 0x79, 0xB1, 0x51, - 0x2E, 0xEF, 0x22, 0x12, 0x57, 0x55, 0x30, 0xE0, 0x0A, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x03, - 0x02, 0x79, 0x5E, 0x90, 0x81, 0x5A, 0xE0, 0x90, 0x82, 0x6D, 0xF0, 0x90, 0x81, 0x5B, 0xE0, 0x90, - 0x82, 0x6E, 0xF0, 0x90, 0x81, 0x5C, 0xE0, 0x90, 0x82, 0x6F, 0xF0, 0x90, 0x81, 0x5D, 0xE0, 0x90, - 0x82, 0x70, 0xF0, 0x90, 0x81, 0x5E, 0xE0, 0x90, 0x82, 0x71, 0xF0, 0x90, 0x81, 0x4B, 0xE0, 0x90, - 0x82, 0x72, 0xF0, 0x90, 0x81, 0x4C, 0xE0, 0x90, 0x82, 0x73, 0xF0, 0x90, 0x81, 0x4D, 0xE0, 0x90, - 0x82, 0x74, 0xF0, 0x90, 0x81, 0x4E, 0xE0, 0x90, 0x82, 0x75, 0xF0, 0x90, 0x81, 0x4F, 0xE0, 0x90, - 0x82, 0x76, 0xF0, 0x90, 0x81, 0x50, 0xE0, 0x90, 0x82, 0x77, 0xF0, 0x90, 0x81, 0x51, 0xE0, 0x90, - 0x82, 0x78, 0xF0, 0x90, 0x81, 0x52, 0xE0, 0x90, 0x82, 0x79, 0xF0, 0x90, 0x81, 0x53, 0xE0, 0x90, - 0x82, 0x7A, 0xF0, 0x90, 0x81, 0x54, 0xE0, 0x90, 0x82, 0x7B, 0xF0, 0x12, 0x50, 0x93, 0x90, 0x82, - 0x15, 0xF0, 0x12, 0x79, 0x80, 0x50, 0x05, 0x12, 0x79, 0x6C, 0x80, 0xF6, 0x90, 0x01, 0x1F, 0xE0, - 0xFE, 0x90, 0x01, 0x1E, 0x12, 0x7A, 0xD8, 0x90, 0x82, 0x0A, 0xF0, 0xA3, 0x12, 0x79, 0xC3, 0x12, - 0x79, 0x80, 0x50, 0x50, 0x31, 0x4D, 0x90, 0x82, 0x15, 0xE0, 0xFE, 0x24, 0x7C, 0xF5, 0x82, 0xE4, - 0x34, 0x82, 0x12, 0x7A, 0x3C, 0xE0, 0x24, 0x45, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, - 0xFF, 0x74, 0x17, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0x12, 0x7A, 0x3C, 0xE0, 0x24, 0x46, 0xF9, - 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xEE, 0x12, 0x7A, 0x4C, 0x12, 0x44, 0xE7, 0x12, 0x7A, 0x40, - 0xE0, 0x24, 0x30, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0xEE, 0x12, 0x79, 0xD3, 0x12, 0x44, 0xE7, 0x12, - 0x79, 0x79, 0x80, 0xAB, 0x90, 0x02, 0x87, 0xE0, 0x70, 0x03, 0x02, 0x79, 0x5E, 0x90, 0x81, 0x3D, - 0xE0, 0x20, 0xE0, 0x03, 0x02, 0x79, 0x5E, 0xC3, 0x13, 0x30, 0xE0, 0x0A, 0xE0, 0xC4, 0x54, 0x0F, - 0x30, 0xE0, 0x03, 0x02, 0x79, 0x5E, 0xE4, 0x90, 0x82, 0x86, 0x12, 0x50, 0x9B, 0x90, 0x82, 0x0A, - 0xE0, 0xFF, 0xA3, 0xE0, 0xA3, 0xCF, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x82, 0x0C, 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, 0x12, 0x7A, 0xCF, 0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, 0x3E, - 0x54, 0x3F, 0x90, 0x82, 0x0E, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, 0x34, - 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0x0F, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0x82, 0x11, 0xF0, 0xFC, - 0x74, 0x07, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0xC0, 0x90, 0x82, 0x13, - 0xF0, 0xEC, 0x24, 0x18, 0x90, 0x82, 0x10, 0xF0, 0xFD, 0x90, 0x82, 0x0C, 0xE0, 0xFE, 0xA3, 0xE0, - 0xFF, 0x12, 0x51, 0xA2, 0xEF, 0x54, 0xFC, 0x90, 0x82, 0x12, 0xF0, 0x90, 0x82, 0x11, 0xE0, 0x24, - 0x18, 0xFF, 0xE4, 0x33, 0x90, 0x82, 0x0E, 0x8F, 0xF0, 0x12, 0x44, 0xA3, 0x90, 0x82, 0x0E, 0xE0, - 0xFE, 0xA3, 0xE0, 0xFF, 0x51, 0x0C, 0x90, 0x82, 0x0A, 0xEE, 0x8F, 0xF0, 0x12, 0x44, 0xA3, 0x90, - 0x81, 0x3B, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x82, 0x0A, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xD3, - 0x9F, 0xEC, 0x9E, 0x40, 0x12, 0x90, 0x81, 0x3C, 0x12, 0x7A, 0xAB, 0xED, 0x9F, 0xFF, 0xEC, 0x9E, - 0x90, 0x82, 0x0A, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x81, 0xD5, 0xE0, 0x30, 0xE0, 0x0A, 0x13, 0x13, - 0x54, 0x3F, 0x20, 0xE0, 0x03, 0x02, 0x79, 0x58, 0x12, 0x57, 0x55, 0x20, 0xE0, 0x02, 0xC1, 0xD6, - 0xE4, 0x90, 0x82, 0x16, 0xF0, 0x90, 0x82, 0x15, 0xF0, 0x12, 0x79, 0x80, 0x50, 0x38, 0x31, 0x4D, - 0xE4, 0x90, 0x82, 0x14, 0xF0, 0x12, 0x79, 0xA9, 0x94, 0x06, 0x50, 0x16, 0x12, 0x79, 0x5F, 0x24, - 0x04, 0x12, 0x53, 0xB4, 0x90, 0x82, 0x15, 0xE0, 0x51, 0x61, 0xB5, 0x07, 0x05, 0x12, 0x52, 0x76, - 0x80, 0xE3, 0x90, 0x82, 0x14, 0xE0, 0xB4, 0x06, 0x08, 0x90, 0x82, 0x16, 0x74, 0x01, 0xF0, 0x80, - 0x05, 0x12, 0x79, 0x79, 0x80, 0xC3, 0x90, 0x82, 0x12, 0xE0, 0x24, 0x60, 0x70, 0x02, 0xC1, 0x7C, - 0x24, 0xFC, 0x70, 0x02, 0xC1, 0x7C, 0x24, 0xF4, 0x70, 0x02, 0xC1, 0x70, 0x24, 0xF0, 0x70, 0x02, - 0xC1, 0x7C, 0x24, 0x80, 0x60, 0x02, 0xC1, 0x91, 0x12, 0x79, 0x5F, 0x24, 0x18, 0xFD, 0x12, 0x51, - 0xA2, 0xEF, 0x60, 0x03, 0x02, 0x78, 0x37, 0x12, 0x79, 0x5F, 0x24, 0x19, 0xFD, 0x12, 0x51, 0xA2, - 0x90, 0x82, 0x2B, 0x12, 0x79, 0xBB, 0x12, 0x79, 0xA4, 0x9F, 0x50, 0x0B, 0x12, 0x79, 0x5F, 0x12, - 0x52, 0x91, 0x12, 0x52, 0x72, 0x80, 0xEF, 0x90, 0x82, 0x2B, 0xE0, 0x70, 0x02, 0xA1, 0xC8, 0xE4, - 0x90, 0x82, 0x15, 0xF0, 0x12, 0x79, 0x80, 0x50, 0x66, 0x31, 0x4D, 0x12, 0x7A, 0x5A, 0x70, 0x1E, - 0x12, 0x7A, 0x4B, 0x12, 0x44, 0xDE, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x12, 0x7A, 0x1C, 0xED, - 0xF0, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x51, 0x2E, 0xEF, 0x60, 0x02, 0x80, 0x27, 0x90, 0x82, - 0x2B, 0xE0, 0x64, 0x03, 0x70, 0x2C, 0x12, 0x7A, 0x1C, 0x51, 0x7D, 0x70, 0x07, 0x12, 0x7A, 0x1C, - 0x51, 0x88, 0x60, 0x19, 0x12, 0x7A, 0x72, 0x60, 0x02, 0x80, 0x05, 0x12, 0x7A, 0x2C, 0x60, 0x05, - 0x74, 0x86, 0x2F, 0x80, 0x10, 0x12, 0x79, 0x8D, 0x74, 0x01, 0xF0, 0x80, 0x0D, 0x12, 0x7A, 0xA4, - 0x80, 0x03, 0x12, 0x7A, 0xA4, 0x12, 0x79, 0x93, 0xE4, 0xF0, 0x12, 0x79, 0x79, 0x80, 0x95, 0x90, - 0x82, 0x86, 0xE0, 0x70, 0x56, 0xA3, 0xE0, 0x70, 0x52, 0xA3, 0xE0, 0x70, 0x4E, 0xA3, 0xE0, 0x70, - 0x4A, 0xA3, 0xE0, 0x70, 0x46, 0x02, 0x78, 0x37, 0xE4, 0x90, 0x82, 0x15, 0xF0, 0x12, 0x79, 0x80, - 0x50, 0x20, 0x74, 0x72, 0x2E, 0x12, 0x7A, 0x33, 0x60, 0x0A, 0x74, 0x86, 0x2E, 0x12, 0x79, 0x93, - 0xE4, 0xF0, 0x80, 0x09, 0x74, 0x86, 0x2E, 0x12, 0x79, 0x93, 0x74, 0x01, 0xF0, 0x12, 0x79, 0x79, - 0x80, 0xDB, 0x90, 0x82, 0x86, 0xE0, 0x70, 0x13, 0xA3, 0xE0, 0x70, 0x0F, 0xA3, 0xE0, 0x70, 0x0B, - 0xA3, 0xE0, 0x70, 0x07, 0xA3, 0xE0, 0x70, 0x03, 0x02, 0x78, 0x37, 0xE4, 0x90, 0x82, 0x15, 0xF0, - 0x12, 0x79, 0x80, 0x40, 0x03, 0x02, 0x78, 0x37, 0x31, 0x4D, 0x12, 0x79, 0x8D, 0xE0, 0x60, 0x4B, - 0x12, 0x79, 0xCB, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x1B, 0xD3, 0x90, 0x82, 0x8C, 0xE0, 0x94, 0x28, - 0x90, 0x82, 0x8B, 0xE0, 0x94, 0x00, 0x50, 0x0C, 0x7F, 0xFA, 0x7E, 0x00, 0x12, 0x32, 0xAA, 0x12, - 0x54, 0x59, 0x80, 0xDF, 0x90, 0x04, 0x1D, 0xE0, 0x70, 0x21, 0x12, 0x79, 0xE1, 0x74, 0x0A, 0xF0, - 0xE4, 0xFB, 0x12, 0x79, 0xB0, 0x12, 0x79, 0xA9, 0x94, 0x06, 0x50, 0x08, 0x12, 0x79, 0x5F, 0x12, - 0x52, 0x58, 0x80, 0xF1, 0x12, 0x6D, 0xCB, 0x90, 0x06, 0x35, 0xF0, 0x12, 0x79, 0x79, 0x80, 0xA0, - 0x90, 0x82, 0x16, 0xE0, 0xB4, 0x01, 0x02, 0x80, 0x55, 0x02, 0x79, 0x58, 0x90, 0x82, 0x16, 0xE0, - 0xB4, 0x01, 0x0B, 0x90, 0x81, 0x3D, 0x12, 0x6B, 0xA5, 0x30, 0xE0, 0x02, 0x80, 0x40, 0x02, 0x79, - 0x58, 0x90, 0x82, 0x13, 0xE0, 0x70, 0x12, 0x90, 0x82, 0x16, 0xE0, 0xB4, 0x01, 0x0B, 0x90, 0x81, - 0x3D, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x20, 0xE0, 0x03, 0x02, 0x79, 0x58, 0x12, 0x79, 0x5F, 0xFD, - 0x12, 0x53, 0x78, 0xEF, 0x60, 0x02, 0x80, 0x16, 0x12, 0x79, 0x5F, 0xFD, 0x12, 0x52, 0x2E, 0xEF, - 0x60, 0x02, 0x80, 0x0A, 0x12, 0x79, 0x5F, 0xFD, 0x12, 0x51, 0xD2, 0xEF, 0x60, 0x05, 0x12, 0x69, - 0xE9, 0x61, 0x94, 0x02, 0x79, 0x58, 0x90, 0x82, 0x12, 0xE0, 0x24, 0xC0, 0x60, 0x03, 0x02, 0x78, - 0x43, 0x12, 0x79, 0x5F, 0x24, 0x18, 0xFD, 0x12, 0x51, 0xA2, 0xEF, 0x60, 0x03, 0x02, 0x78, 0x37, - 0x12, 0x79, 0x5F, 0x24, 0x19, 0xFD, 0x12, 0x51, 0xA2, 0x90, 0x82, 0x2B, 0x12, 0x79, 0xBB, 0x12, - 0x79, 0xA4, 0x9F, 0x50, 0x0B, 0x12, 0x79, 0x5F, 0x12, 0x52, 0x91, 0x12, 0x52, 0x72, 0x80, 0xEF, - 0x90, 0x82, 0x2B, 0xE0, 0x70, 0x02, 0xE1, 0xA1, 0xE4, 0x90, 0x82, 0x15, 0xF0, 0x12, 0x79, 0x80, - 0x50, 0x66, 0x31, 0x4D, 0x12, 0x7A, 0x5A, 0x70, 0x1E, 0x12, 0x7A, 0x4B, 0x12, 0x44, 0xDE, 0xC0, - 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x12, 0x7A, 0x1C, 0xED, 0xF0, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, - 0x51, 0x2E, 0xEF, 0x60, 0x02, 0x80, 0x27, 0x90, 0x82, 0x2B, 0xE0, 0x64, 0x03, 0x70, 0x2C, 0x12, - 0x7A, 0x1C, 0x51, 0x7D, 0x70, 0x07, 0x12, 0x7A, 0x1C, 0x51, 0x88, 0x60, 0x19, 0x12, 0x7A, 0x72, - 0x60, 0x02, 0x80, 0x05, 0x12, 0x7A, 0x2C, 0x60, 0x05, 0x74, 0x86, 0x2F, 0x80, 0x10, 0x12, 0x79, - 0x8D, 0x74, 0x01, 0xF0, 0x80, 0x0D, 0x12, 0x7A, 0xA4, 0x80, 0x03, 0x12, 0x7A, 0xA4, 0x12, 0x79, - 0x93, 0xE4, 0xF0, 0x12, 0x79, 0x79, 0x80, 0x95, 0x90, 0x82, 0x86, 0xE0, 0x70, 0x53, 0xA3, 0xE0, - 0x70, 0x4F, 0xA3, 0xE0, 0x70, 0x4B, 0xA3, 0xE0, 0x70, 0x47, 0xA3, 0xE0, 0x70, 0x43, 0x02, 0x78, - 0x37, 0xE4, 0x90, 0x82, 0x15, 0xF0, 0x12, 0x79, 0x80, 0x50, 0x20, 0x74, 0x72, 0x2E, 0x12, 0x7A, - 0x33, 0x60, 0x0A, 0x74, 0x86, 0x2E, 0x12, 0x79, 0x93, 0xE4, 0xF0, 0x80, 0x09, 0x74, 0x86, 0x2E, - 0x12, 0x79, 0x93, 0x74, 0x01, 0xF0, 0x12, 0x79, 0x79, 0x80, 0xDB, 0x90, 0x82, 0x86, 0xE0, 0x70, - 0x10, 0xA3, 0xE0, 0x70, 0x0C, 0xA3, 0xE0, 0x70, 0x08, 0xA3, 0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x60, - 0x56, 0xE4, 0x90, 0x82, 0x15, 0xF0, 0x12, 0x79, 0x80, 0x50, 0x4C, 0x31, 0x4D, 0x12, 0x79, 0x8D, - 0xE0, 0x60, 0x40, 0x12, 0x79, 0xCB, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x14, 0xD3, 0x90, 0x82, 0x8C, - 0xE0, 0x94, 0xE8, 0x90, 0x82, 0x8B, 0xE0, 0x94, 0x03, 0x50, 0x05, 0x12, 0x54, 0x59, 0x80, 0xE6, - 0x90, 0x04, 0x1D, 0xE0, 0x70, 0x1D, 0x31, 0xE1, 0x74, 0x06, 0xF0, 0x7B, 0x08, 0x31, 0xB0, 0x31, - 0xA9, 0x94, 0x06, 0x50, 0x07, 0x31, 0x5F, 0x12, 0x52, 0x58, 0x80, 0xF3, 0x12, 0x6D, 0xCB, 0x90, - 0x06, 0x35, 0xF0, 0x31, 0x79, 0x80, 0xAF, 0x12, 0x71, 0xF6, 0x90, 0x06, 0x36, 0x74, 0xDD, 0xF0, - 0x02, 0x73, 0x94, 0x90, 0x82, 0x13, 0xE0, 0x60, 0x02, 0x21, 0x58, 0x31, 0x5F, 0x24, 0x16, 0xFD, - 0x12, 0x51, 0xA2, 0x90, 0x06, 0x34, 0xEF, 0xF0, 0x31, 0x5F, 0x24, 0x17, 0xFD, 0x12, 0x51, 0xA2, - 0x90, 0x06, 0x37, 0x31, 0xC3, 0x31, 0x80, 0x50, 0x64, 0x12, 0x71, 0x4D, 0xE4, 0x90, 0x82, 0x14, - 0xF0, 0x90, 0x82, 0x14, 0xE0, 0xFF, 0xC3, 0x94, 0x06, 0x50, 0x4E, 0xEF, 0x60, 0x04, 0x64, 0x01, - 0x70, 0x24, 0x31, 0x5F, 0x12, 0x52, 0x86, 0x90, 0x82, 0x14, 0xE0, 0xFE, 0x24, 0x44, 0x31, 0x9B, - 0xF0, 0x90, 0x82, 0x15, 0xE0, 0x31, 0xD3, 0x12, 0x44, 0xDE, 0x8E, 0x82, 0x12, 0x72, 0x77, 0xFF, - 0x74, 0x46, 0x2E, 0x31, 0x9B, 0xF0, 0x31, 0x5F, 0x12, 0x52, 0x86, 0x90, 0x82, 0x15, 0xE0, 0xFE, - 0x12, 0x72, 0x61, 0x6F, 0x60, 0x0E, 0x74, 0x81, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, - 0xE4, 0xF0, 0x80, 0x05, 0x12, 0x52, 0x76, 0x80, 0xA8, 0x31, 0x79, 0x80, 0x98, 0x90, 0x82, 0x81, - 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, 0x82, 0x16, 0x74, - 0x01, 0xF0, 0x90, 0x82, 0x16, 0xE0, 0x64, 0x01, 0x70, 0x4F, 0x12, 0x69, 0xB9, 0x12, 0x5F, 0x83, - 0x90, 0x81, 0x5F, 0xE0, 0x70, 0x03, 0x02, 0x73, 0x94, 0x90, 0x01, 0x3C, 0xE0, 0x30, 0xE4, 0x03, - 0x74, 0x10, 0xF0, 0x7D, 0x10, 0xE4, 0xFF, 0x12, 0x67, 0xDE, 0x90, 0x81, 0x60, 0xE0, 0x60, 0x08, - 0xF5, 0x2D, 0xE4, 0xF5, 0x2E, 0xFB, 0x80, 0x15, 0x90, 0x81, 0x61, 0xE0, 0x60, 0x08, 0xFB, 0xE4, - 0xF5, 0x2D, 0xF5, 0x2E, 0x80, 0x07, 0x75, 0x2D, 0x20, 0xE4, 0xF5, 0x2E, 0xFB, 0x7D, 0x01, 0x7F, - 0x60, 0x7E, 0x01, 0x12, 0x31, 0x21, 0x02, 0x73, 0x94, 0x12, 0x50, 0x93, 0x90, 0x82, 0x15, 0xF0, - 0x31, 0x80, 0x50, 0x04, 0x31, 0x6C, 0x80, 0xF8, 0x12, 0x71, 0xF6, 0x02, 0x73, 0x94, 0x22, 0x90, - 0x82, 0x0C, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x82, 0x10, 0xE0, 0x22, 0x74, 0x81, 0x2E, 0xF5, - 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0x74, 0x01, 0xF0, 0x90, 0x82, 0x15, 0xE0, 0x04, 0xF0, 0x22, - 0x90, 0x81, 0x48, 0xE0, 0xFF, 0x90, 0x82, 0x15, 0xE0, 0xFE, 0xC3, 0x9F, 0x22, 0x90, 0x82, 0x15, - 0xE0, 0x24, 0x86, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x04, - 0xF5, 0x83, 0xEF, 0x22, 0x90, 0x82, 0x2B, 0xE0, 0xFF, 0x90, 0x82, 0x14, 0xE0, 0xFD, 0xC3, 0x22, - 0x7D, 0x01, 0x12, 0x4E, 0xAD, 0x90, 0x82, 0x0E, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0x90, 0x82, - 0x14, 0xF0, 0x22, 0xEF, 0xF0, 0xE4, 0x90, 0x82, 0x15, 0xF0, 0x22, 0xE4, 0x90, 0x82, 0x8B, 0xF0, - 0xA3, 0xF0, 0x22, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0x5E, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, - 0x22, 0x90, 0x82, 0x15, 0xE0, 0x24, 0x6D, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0xE0, 0xFF, - 0x90, 0x82, 0xD1, 0x22, 0xEF, 0x30, 0xE7, 0x04, 0x7E, 0x02, 0x80, 0x02, 0xE4, 0xFE, 0xED, 0x30, - 0xE6, 0x12, 0xEB, 0x20, 0xE0, 0x07, 0x90, 0x81, 0x42, 0xE0, 0xFC, 0x80, 0x09, 0x90, 0x81, 0x43, - 0xE0, 0xFC, 0x80, 0x02, 0xE4, 0xFC, 0xEE, 0x24, 0x18, 0x2C, 0xFF, 0x22, 0x7B, 0x01, 0x7A, 0x82, - 0x79, 0x2C, 0x90, 0x82, 0x90, 0x12, 0x44, 0xE7, 0x90, 0x82, 0x93, 0x22, 0x90, 0x82, 0x15, 0xE0, - 0xFF, 0x24, 0x72, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0xE0, 0x22, 0xF5, 0x83, 0xEF, 0xF0, - 0x74, 0x7C, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0x22, 0xEF, 0x75, 0xF0, 0x03, 0xA4, - 0x24, 0x1C, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0x22, 0x90, 0x82, 0x15, 0xE0, 0xFF, 0x24, - 0x17, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0xE0, 0xFE, 0x90, 0x82, 0x2B, 0xE0, 0xFD, 0xEE, - 0x6D, 0x22, 0x90, 0x82, 0x15, 0xE0, 0xFF, 0x24, 0x77, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, - 0xE0, 0x22, 0x54, 0xFB, 0xF0, 0x90, 0x81, 0x75, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, 0x82, 0x0E, - 0x12, 0x44, 0xE7, 0x02, 0x1F, 0xA4, 0xE0, 0x90, 0x01, 0xBA, 0xF0, 0x90, 0x81, 0x73, 0xE0, 0x90, - 0x01, 0xBB, 0xF0, 0x22, 0x90, 0x82, 0x15, 0xE0, 0x24, 0x86, 0x22, 0xE0, 0x24, 0x01, 0xFF, 0x90, - 0x81, 0x3B, 0xE0, 0x34, 0x00, 0xFE, 0xC3, 0x22, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xFE, 0xEF, - 0x54, 0x07, 0xFF, 0x22, 0x90, 0x81, 0x6D, 0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0xF5, - 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x22, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, - 0x22, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, 0x22, 0x00, 0x00, 0x66, -}; -u32 array_length_mp_8188e_t_fw_ap = 15116; - -#endif - -void -odm_read_firmware_mp_8188e_t_fw_ap( - struct PHY_DM_STRUCT *p_dm_odm, - u8 *p_firmware, - u32 *p_firmware_size -) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) - *((SIZE_PTR *)p_firmware) = (SIZE_PTR)array_mp_8188e_t_fw_ap; -#else - odm_move_memory(p_dm_odm, p_firmware, array_mp_8188e_t_fw_ap, array_length_mp_8188e_t_fw_ap); -#endif - *p_firmware_size = array_length_mp_8188e_t_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_8188e_t_fw_nic[] = { - 0xE1, 0x88, 0x10, 0x00, 0x17, 0x00, 0x00, 0x00, 0x03, 0x25, 0x13, 0x14, 0x94, 0x3A, 0x00, 0x00, - 0x0C, 0x27, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x02, 0x45, 0x9F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0xC1, 0xC2, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0xC1, 0x39, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE1, 0xFC, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 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, 0x41, 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, 0x46, 0x33, 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, 0x46, 0x33, 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, 0x41, 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, 0x41, 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, 0x41, 0x4D, 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, - 0xC2, 0xAF, 0x56, 0xC6, 0xD2, 0xAF, 0xD2, 0xA9, 0x54, 0x80, 0x4F, 0xFF, 0x22, 0xE7, 0x09, 0xF6, - 0x08, 0xDF, 0xFA, 0x80, 0x46, 0xE7, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x3E, 0x88, 0x82, 0x8C, - 0x83, 0xE7, 0x09, 0xF0, 0xA3, 0xDF, 0xFA, 0x80, 0x32, 0xE3, 0x09, 0xF6, 0x08, 0xDF, 0xFA, 0x80, - 0x78, 0xE3, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x70, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0x09, 0xF0, - 0xA3, 0xDF, 0xFA, 0x80, 0x64, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF6, 0x08, 0xDF, 0xFA, 0x80, - 0x58, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x4C, 0x80, 0xD2, 0x80, - 0xFA, 0x80, 0xC6, 0x80, 0xD4, 0x80, 0x69, 0x80, 0xF2, 0x80, 0x33, 0x80, 0x10, 0x80, 0xA6, 0x80, - 0xEA, 0x80, 0x9A, 0x80, 0xA8, 0x80, 0xDA, 0x80, 0xE2, 0x80, 0xCA, 0x80, 0x33, 0x89, 0x82, 0x8A, - 0x83, 0xEC, 0xFA, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xF0, 0xA3, - 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, 0x0D, 0x89, 0x82, - 0x8A, 0x83, 0xE4, 0x93, 0xA3, 0xF6, 0x08, 0xDF, 0xF9, 0xEC, 0xFA, 0xA9, 0xF0, 0xED, 0xFB, 0x22, - 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, - 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xEA, 0xDE, 0xE8, 0x80, 0xDB, - 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xA3, 0xF2, 0x08, 0xDF, 0xF9, 0x80, 0xCC, 0x88, 0xF0, 0xEF, - 0x60, 0x01, 0x0E, 0x4E, 0x60, 0xC3, 0x88, 0xF0, 0xED, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0xB9, - 0xF5, 0x82, 0xEB, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0xAF, 0x23, 0x23, 0x45, 0x82, 0x23, 0x90, - 0x43, 0xFD, 0x73, 0xC5, 0xF0, 0xF8, 0xA3, 0xE0, 0x28, 0xF0, 0xC5, 0xF0, 0xF8, 0xE5, 0x82, 0x15, - 0x82, 0x70, 0x02, 0x15, 0x83, 0xE0, 0x38, 0xF0, 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, 0xEB, 0x9F, 0xF5, 0xF0, 0xEA, 0x9E, 0x42, 0xF0, 0xE9, 0x9D, 0x42, 0xF0, 0xE8, 0x9C, 0x45, - 0xF0, 0x22, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0xE2, 0xFC, - 0x08, 0xE2, 0xFD, 0x08, 0xE2, 0xFE, 0x08, 0xE2, 0xFF, 0x22, 0xE0, 0xF8, 0xA3, 0xE0, 0xF9, 0xA3, - 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0x22, 0xE2, 0xFB, 0x08, 0xE2, 0xF9, 0x08, 0xE2, 0xFA, 0x08, 0xE2, - 0xCB, 0xF8, 0x22, 0xEC, 0xF2, 0x08, 0xED, 0xF2, 0x08, 0xEE, 0xF2, 0x08, 0xEF, 0xF2, 0x22, 0xA4, - 0x25, 0x82, 0xF5, 0x82, 0xE5, 0xF0, 0x35, 0x83, 0xF5, 0x83, 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, 0xEF, 0x4E, 0x60, 0x12, 0xEF, 0x60, 0x01, 0x0E, 0xED, 0xBB, 0x01, 0x0B, 0x89, - 0x82, 0x8A, 0x83, 0xF0, 0xA3, 0xDF, 0xFC, 0xDE, 0xFA, 0x22, 0x89, 0xF0, 0x50, 0x07, 0xF7, 0x09, - 0xDF, 0xFC, 0xA9, 0xF0, 0x22, 0xBB, 0xFE, 0xFC, 0xF3, 0x09, 0xDF, 0xFC, 0xA9, 0xF0, 0x22, 0x02, - 0x45, 0xDD, 0x02, 0x41, 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, 0x46, 0x22, - 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, 0x82, 0xD2, 0x00, 0x41, 0x82, 0xD3, 0x00, 0x41, 0x82, 0xDC, 0x00, 0x41, 0x82, - 0xDE, 0x00, 0x00, 0x50, 0xF7, 0x58, 0x1B, 0x60, 0x0C, 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, 0x39, 0xF0, 0x74, 0x46, 0xA3, 0xF0, - 0xD1, 0x88, 0x74, 0x39, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x46, 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, 0x54, 0xE0, 0x55, 0x35, 0xF5, 0x39, - 0xA3, 0xE0, 0x55, 0x36, 0xF5, 0x3A, 0xA3, 0xE0, 0x55, 0x37, 0xF5, 0x3B, 0xA3, 0xE0, 0x55, 0x38, - 0xF5, 0x3C, 0xAD, 0x39, 0x7F, 0x54, 0x12, 0x32, 0x1E, 0xAD, 0x3A, 0x7F, 0x55, 0x12, 0x32, 0x1E, - 0xAD, 0x3B, 0x7F, 0x56, 0x12, 0x32, 0x1E, 0xAD, 0x3C, 0x7F, 0x57, 0x12, 0x32, 0x1E, 0x53, 0x91, - 0xEF, 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, 0xC2, 0xF0, 0x74, 0x46, 0xA3, 0xF0, 0x12, 0x6F, 0x3C, 0xE5, 0x41, 0x30, 0xE4, - 0x02, 0xF1, 0x5E, 0xE5, 0x41, 0x30, 0xE6, 0x03, 0x12, 0x6F, 0xD5, 0xE5, 0x43, 0x30, 0xE0, 0x03, - 0x12, 0x6F, 0xE2, 0xE5, 0x43, 0x30, 0xE1, 0x03, 0x12, 0x5E, 0xC4, 0xE5, 0x43, 0x30, 0xE2, 0x03, - 0x12, 0x77, 0x7C, 0xE5, 0x43, 0x30, 0xE3, 0x02, 0xF1, 0x71, 0xE5, 0x43, 0x30, 0xE4, 0x02, 0xF1, - 0x89, 0xE5, 0x43, 0x30, 0xE5, 0x03, 0x12, 0x57, 0x51, 0xE5, 0x43, 0x30, 0xE6, 0x02, 0xF1, 0xD3, - 0xE5, 0x44, 0x30, 0xE1, 0x03, 0x12, 0x71, 0x5F, 0x74, 0xC2, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, - 0x46, 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, 0x60, - 0xAB, 0x7F, 0x02, 0x8F, 0x0D, 0x7F, 0x02, 0x71, 0x27, 0x90, 0x80, 0x3C, 0xE0, 0x45, 0x0D, 0xF0, - 0x22, 0xF1, 0x81, 0x70, 0x0B, 0x90, 0x81, 0x8C, 0xE0, 0x60, 0x05, 0xF1, 0xC8, 0x12, 0x56, 0x85, - 0x22, 0xE4, 0xFF, 0xF1, 0xA5, 0xEF, 0x64, 0x01, 0x22, 0xF1, 0x81, 0x70, 0x17, 0x90, 0x81, 0x8C, - 0xE0, 0x60, 0x11, 0xF1, 0xC8, 0xF0, 0x90, 0x81, 0x87, 0xE0, 0x12, 0x72, 0xD2, 0x54, 0x07, 0x70, - 0x03, 0x12, 0x58, 0x62, 0x22, 0x12, 0x7A, 0x45, 0x12, 0x51, 0xB6, 0xE0, 0xFD, 0x7C, 0x00, 0xF1, - 0xF4, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5C, 0xFE, 0xEF, 0x5D, - 0x4E, 0x7F, 0x00, 0x60, 0x02, 0x7F, 0x01, 0x22, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, - 0x74, 0x02, 0x22, 0xE4, 0xFF, 0xF1, 0xA5, 0xBF, 0x01, 0x0F, 0x90, 0x81, 0x8C, 0xE0, 0x60, 0x09, - 0xF1, 0xEA, 0x54, 0x07, 0x70, 0x03, 0x12, 0x58, 0x62, 0x22, 0x90, 0x81, 0x90, 0xE0, 0x54, 0xFE, - 0xF0, 0x22, 0xE0, 0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 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, 0xFC, 0xF0, 0x74, - 0x47, 0xA3, 0xF0, 0x12, 0x6F, 0x69, 0xE5, 0x49, 0x30, 0xE1, 0x03, 0x12, 0x77, 0x1F, 0xE5, 0x49, - 0x30, 0xE2, 0x03, 0x12, 0x58, 0x77, 0xE5, 0x4A, 0x30, 0xE0, 0x03, 0x12, 0x73, 0xAD, 0xE5, 0x4A, - 0x30, 0xE4, 0x03, 0x12, 0x77, 0xA4, 0xE5, 0x4B, 0x30, 0xE1, 0x03, 0x12, 0x71, 0xA6, 0xE5, 0x4B, - 0x30, 0xE0, 0x03, 0x12, 0x70, 0xD7, 0xE5, 0x4B, 0x30, 0xE4, 0x03, 0x12, 0x77, 0xBA, 0xE5, 0x4C, - 0x30, 0xE1, 0x05, 0x7F, 0x04, 0x12, 0x47, 0x63, 0xE5, 0x4C, 0x30, 0xE4, 0x02, 0x11, 0xA5, 0xE5, - 0x4C, 0x30, 0xE5, 0x03, 0x12, 0x71, 0x7E, 0xE5, 0x4C, 0x30, 0xE6, 0x03, 0x12, 0x73, 0xFD, 0x74, - 0xFC, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x47, 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, 0x58, 0xCE, 0x31, 0x21, 0x90, 0x81, 0xF7, 0xE0, 0x30, 0xE0, - 0x1B, 0x12, 0x7A, 0x69, 0xF0, 0x90, 0x81, 0xFA, 0xE0, 0x60, 0x04, 0x14, 0xF0, 0xE1, 0x01, 0x90, - 0x81, 0xF8, 0xE0, 0x14, 0x90, 0x81, 0xFA, 0xF0, 0xE4, 0xFF, 0x11, 0xCD, 0x22, 0xD3, 0x10, 0xAF, - 0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x64, 0x01, 0x70, 0x19, 0x12, 0x7A, 0x61, 0x60, 0x0A, 0x31, 0x14, - 0x51, 0x35, 0x12, 0x7A, 0x69, 0xF0, 0x80, 0x06, 0x31, 0x14, 0x51, 0x1D, 0x51, 0x3D, 0xF1, 0x01, - 0x80, 0x19, 0x12, 0x7A, 0x61, 0x60, 0x06, 0x31, 0x14, 0x51, 0x35, 0x80, 0x04, 0x31, 0x14, 0x51, - 0x1D, 0x31, 0x21, 0x7D, 0x01, 0x7F, 0x02, 0x31, 0x25, 0xF1, 0x22, 0xD0, 0xD0, 0x92, 0xAF, 0x22, - 0xF0, 0x90, 0x01, 0x3F, 0x74, 0x10, 0xF0, 0xFD, 0x7F, 0x03, 0x22, 0x7D, 0x01, 0x7F, 0x02, 0x31, - 0x25, 0x7D, 0x02, 0x7F, 0x02, 0x74, 0x3D, 0x2F, 0xF8, 0xE6, 0x4D, 0xFE, 0xF6, 0x74, 0x30, 0x41, - 0x26, 0x90, 0x05, 0x62, 0xE0, 0xFE, 0x90, 0x05, 0x61, 0xE0, 0xFD, 0xED, 0x78, 0x02, 0xCE, 0xC3, - 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, 0x81, 0xFF, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x47, - 0x81, 0x60, 0x02, 0x41, 0x10, 0x90, 0x81, 0x8C, 0xE0, 0x70, 0x02, 0x41, 0x10, 0x12, 0x7A, 0x23, - 0x64, 0x01, 0x70, 0x22, 0x90, 0x06, 0xAB, 0xE0, 0x90, 0x81, 0x93, 0xF0, 0x90, 0x06, 0xAA, 0xE0, - 0x90, 0x81, 0x92, 0xF0, 0xA3, 0xE0, 0xFF, 0x70, 0x08, 0x90, 0x81, 0x92, 0xE0, 0xFE, 0xFF, 0x80, - 0x00, 0x90, 0x81, 0x93, 0xEF, 0xF0, 0x12, 0x5D, 0x40, 0xE4, 0x90, 0x81, 0x95, 0x12, 0x77, 0x09, - 0x12, 0x47, 0xC8, 0x12, 0x72, 0xD4, 0x54, 0xEF, 0xF0, 0x12, 0x7A, 0x23, 0x24, 0xFD, 0x50, 0x02, - 0x80, 0x0F, 0x90, 0x81, 0x82, 0xE0, 0x30, 0xE0, 0x05, 0x12, 0x56, 0x18, 0x80, 0x03, 0x12, 0x56, - 0xFE, 0x12, 0x72, 0xC6, 0x30, 0xE0, 0x56, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x21, - 0x12, 0x7A, 0x71, 0x6F, 0x70, 0x47, 0x90, 0x81, 0x88, 0xE0, 0x44, 0x40, 0xF0, 0x12, 0x7A, 0x79, - 0x31, 0x10, 0x51, 0x35, 0x51, 0x43, 0x12, 0x76, 0xFA, 0x90, 0x81, 0x93, 0xE0, 0x14, 0xF0, 0x80, - 0x2C, 0x90, 0x81, 0x8A, 0xE0, 0xC4, 0x54, 0x0F, 0x64, 0x01, 0x70, 0x21, 0x12, 0x7A, 0x71, 0xFE, - 0x6F, 0x60, 0x1A, 0x90, 0x05, 0x73, 0xE0, 0xFF, 0xEE, 0x6F, 0x60, 0x11, 0x12, 0x7A, 0x51, 0x54, - 0x3F, 0x30, 0xE0, 0x09, 0xEF, 0x54, 0xBF, 0x31, 0x10, 0x51, 0x1D, 0x31, 0x1B, 0xF1, 0xEA, 0xF0, - 0x90, 0x81, 0x82, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x03, 0xF1, 0xEA, 0xF0, 0x22, 0x74, 0x45, 0x12, - 0x7A, 0x89, 0xFE, 0xF6, 0x74, 0x38, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, - 0x22, 0x7D, 0x03, 0x7F, 0x02, 0x74, 0x45, 0x2F, 0xF8, 0xE6, 0x4D, 0x80, 0xE5, 0x7D, 0x02, 0x7F, - 0x02, 0x51, 0x47, 0x7D, 0x01, 0x7F, 0x02, 0x74, 0x3D, 0x12, 0x7A, 0x89, 0xFE, 0xF6, 0x74, 0x30, - 0x80, 0xD4, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8B, 0x52, 0x8A, 0x53, 0x89, 0x54, 0x90, - 0x05, 0x27, 0xE0, 0xF5, 0x55, 0x8B, 0x13, 0x8A, 0x14, 0x89, 0x15, 0x75, 0x16, 0x01, 0x7B, 0x01, - 0x7A, 0x81, 0x79, 0x82, 0x12, 0x2B, 0xED, 0xAB, 0x52, 0xAA, 0x53, 0xA9, 0x54, 0x12, 0x1F, 0xA4, - 0xFF, 0xC3, 0x13, 0x20, 0xE0, 0x02, 0x61, 0x1F, 0x90, 0x81, 0x82, 0xE0, 0x30, 0xE0, 0x7B, 0x51, - 0x31, 0x75, 0x55, 0x21, 0x90, 0x81, 0x82, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x08, 0x12, - 0x7A, 0x39, 0x43, 0x55, 0x08, 0x80, 0x0C, 0xE4, 0x90, 0x81, 0x83, 0xF0, 0xA3, 0xF0, 0x7D, 0x40, - 0xFF, 0x51, 0x47, 0x90, 0x81, 0x82, 0x12, 0x72, 0xC9, 0x30, 0xE0, 0x03, 0x43, 0x55, 0x12, 0xEF, - 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x03, 0x43, 0x55, 0x14, 0x90, 0x81, 0x82, 0xE0, 0xC4, 0x13, 0x54, - 0x07, 0x30, 0xE0, 0x03, 0x43, 0x55, 0x80, 0x12, 0x7A, 0x59, 0x54, 0x03, 0x20, 0xE0, 0x03, 0x43, - 0x55, 0x40, 0x71, 0xD0, 0x90, 0x81, 0x85, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x65, 0xE7, 0x12, - 0x71, 0x3B, 0x30, 0xE0, 0x04, 0x7F, 0x04, 0x80, 0x0C, 0x12, 0x58, 0xC2, 0xEF, 0x60, 0x04, 0x7F, - 0x01, 0x80, 0x02, 0x7F, 0x02, 0x12, 0x65, 0xE7, 0x61, 0x98, 0x75, 0x55, 0x01, 0x71, 0xD0, 0x90, - 0x81, 0x85, 0xE0, 0x64, 0x04, 0x60, 0x02, 0x61, 0xCB, 0xFF, 0x12, 0x65, 0xE7, 0x61, 0xCB, 0x90, - 0x81, 0x82, 0xE0, 0x30, 0xE0, 0x7A, 0x51, 0x31, 0x43, 0x55, 0x31, 0x90, 0x81, 0x82, 0xE0, 0x13, - 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x08, 0x12, 0x7A, 0x39, 0x43, 0x55, 0x08, 0x80, 0x06, 0x7D, 0x40, - 0xE4, 0xFF, 0x51, 0x47, 0x90, 0x81, 0x82, 0x12, 0x72, 0xC9, 0x30, 0xE0, 0x03, 0x43, 0x55, 0x02, - 0xEF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x03, 0x43, 0x55, 0x04, 0x71, 0xD0, 0x12, 0x71, 0x3B, 0x30, - 0xE0, 0x0B, 0x12, 0x71, 0x34, 0x60, 0x31, 0xE4, 0xFD, 0x7F, 0x02, 0x80, 0x1F, 0x12, 0x67, 0x2D, - 0x90, 0x81, 0x86, 0xE0, 0xB4, 0x02, 0x19, 0x12, 0x67, 0x66, 0x12, 0x58, 0xC2, 0xBF, 0x01, 0x09, - 0x90, 0x81, 0x8E, 0xE0, 0xFF, 0x7D, 0x01, 0x80, 0x03, 0xE4, 0xFD, 0xFF, 0x71, 0xDB, 0x80, 0x08, - 0x90, 0x81, 0x8F, 0xE0, 0x90, 0x81, 0x86, 0xF0, 0x90, 0x05, 0x40, 0x74, 0x22, 0xF0, 0x80, 0x2B, - 0x75, 0x55, 0x01, 0x71, 0xD0, 0x90, 0x81, 0x86, 0xE0, 0xB4, 0x02, 0x06, 0x7D, 0x01, 0x7F, 0x04, - 0x80, 0x0B, 0x90, 0x81, 0x86, 0xE0, 0xB4, 0x08, 0x06, 0x7D, 0x01, 0x7F, 0x0C, 0x71, 0xDB, 0x12, - 0x77, 0x57, 0x90, 0x81, 0x8E, 0x12, 0x58, 0x70, 0x12, 0x52, 0x17, 0xD0, 0xD0, 0x92, 0xAF, 0x22, - 0x90, 0x05, 0x27, 0xE5, 0x55, 0xF0, 0x22, 0x7D, 0x01, 0x7F, 0x04, 0xD3, 0x10, 0xAF, 0x01, 0xC3, - 0xC0, 0xD0, 0x90, 0x82, 0xDB, 0xED, 0xF0, 0x90, 0x81, 0x87, 0xE0, 0xFE, 0xC4, 0x13, 0x13, 0x54, - 0x03, 0x30, 0xE0, 0x02, 0xA1, 0x26, 0xEE, 0x12, 0x73, 0xF6, 0x30, 0xE0, 0x02, 0xA1, 0x26, 0x90, - 0x81, 0x8F, 0xE0, 0xFE, 0x6F, 0x70, 0x02, 0xA1, 0x26, 0xEF, 0x70, 0x02, 0x81, 0x99, 0x24, 0xFE, - 0x70, 0x02, 0x81, 0xD3, 0x24, 0xFE, 0x60, 0x49, 0x24, 0xFC, 0x70, 0x02, 0xA1, 0x0E, 0x24, 0xFC, - 0x60, 0x02, 0xA1, 0x1F, 0xEE, 0xB4, 0x0E, 0x02, 0xB1, 0x85, 0x90, 0x81, 0x8F, 0xE0, 0x70, 0x04, - 0x7F, 0x01, 0xB1, 0xD0, 0x90, 0x81, 0x8F, 0xE0, 0xB4, 0x06, 0x02, 0xB1, 0xAA, 0x90, 0x81, 0x8F, - 0xE0, 0xB4, 0x04, 0x0F, 0x90, 0x82, 0xDB, 0xE0, 0xFF, 0x60, 0x05, 0x12, 0x74, 0x37, 0x80, 0x03, - 0x12, 0x58, 0x99, 0x90, 0x81, 0x8F, 0xE0, 0x64, 0x08, 0x60, 0x02, 0xA1, 0x1F, 0xF1, 0x22, 0xA1, - 0x1F, 0x90, 0x81, 0x8F, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0xB1, 0xD0, 0x90, 0x81, 0x8F, 0xE0, 0xB4, - 0x06, 0x02, 0xB1, 0xAA, 0x90, 0x81, 0x8F, 0xE0, 0xB4, 0x0E, 0x07, 0xB1, 0x2B, 0xBF, 0x01, 0x02, - 0xB1, 0x85, 0x90, 0x81, 0x8F, 0xE0, 0x64, 0x0C, 0x60, 0x02, 0xA1, 0x1F, 0xB1, 0x2B, 0xEF, 0x64, - 0x01, 0x60, 0x02, 0xA1, 0x1F, 0xB1, 0xE8, 0xA1, 0x1F, 0x90, 0x81, 0x8F, 0xE0, 0xB4, 0x0E, 0x07, - 0xB1, 0x2B, 0xBF, 0x01, 0x02, 0xB1, 0x85, 0x90, 0x81, 0x8F, 0xE0, 0xB4, 0x06, 0x02, 0xB1, 0xAA, - 0x90, 0x81, 0x8F, 0xE0, 0xB4, 0x0C, 0x07, 0xB1, 0x2B, 0xBF, 0x01, 0x02, 0xB1, 0xE8, 0x90, 0x81, - 0x8F, 0xE0, 0x64, 0x04, 0x70, 0x59, 0x12, 0x79, 0x64, 0xEF, 0x64, 0x01, 0x70, 0x51, 0x12, 0x65, - 0x67, 0x80, 0x4C, 0x90, 0x81, 0x8F, 0xE0, 0xB4, 0x0E, 0x07, 0xB1, 0x2B, 0xBF, 0x01, 0x02, 0xB1, - 0x85, 0x90, 0x81, 0x8F, 0xE0, 0xB4, 0x06, 0x02, 0xB1, 0xAA, 0x90, 0x81, 0x8F, 0xE0, 0xB4, 0x0C, - 0x07, 0xB1, 0x2B, 0xBF, 0x01, 0x02, 0xB1, 0xE8, 0x90, 0x81, 0x8F, 0xE0, 0x70, 0x04, 0x7F, 0x01, - 0xB1, 0xD0, 0x90, 0x81, 0x8F, 0xE0, 0xB4, 0x04, 0x16, 0x12, 0x79, 0xDD, 0x80, 0x11, 0x90, 0x81, - 0x8F, 0xE0, 0xB4, 0x0C, 0x0A, 0x12, 0x7A, 0x51, 0x54, 0x3F, 0x30, 0xE0, 0x02, 0xF1, 0x01, 0x90, - 0x81, 0x8F, 0x12, 0x7A, 0x2C, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, - 0xC0, 0xD0, 0x12, 0x77, 0x3E, 0xEF, 0x64, 0x01, 0x60, 0x05, 0x75, 0x0E, 0x01, 0x80, 0x33, 0x12, - 0x7A, 0x81, 0x54, 0x1F, 0x30, 0xE0, 0x05, 0x75, 0x0E, 0x02, 0x80, 0x26, 0x90, 0x81, 0x8E, 0xE0, - 0xD3, 0x94, 0x04, 0x40, 0x05, 0x75, 0x0E, 0x08, 0x80, 0x18, 0x90, 0x81, 0xF0, 0xE0, 0x30, 0xE0, - 0x0C, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x05, 0x75, 0x0E, 0x11, 0x80, 0x05, 0x12, 0x67, 0x99, - 0x80, 0x0E, 0x90, 0x01, 0xB9, 0x74, 0x02, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x0E, 0xF0, 0x7F, 0x00, - 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x81, 0x88, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x04, 0xD1, 0x95, - 0x80, 0x13, 0x12, 0x77, 0x14, 0x12, 0x67, 0x91, 0x90, 0x05, 0x27, 0xE0, 0x44, 0x80, 0xF0, 0x90, - 0x81, 0x86, 0x74, 0x04, 0xF0, 0xE4, 0xFD, 0xFF, 0xE1, 0x17, 0x90, 0x81, 0x88, 0xE0, 0x90, 0x06, - 0x04, 0x20, 0xE0, 0x08, 0xE0, 0x44, 0x40, 0x12, 0x67, 0x91, 0x80, 0x0F, 0xD1, 0x91, 0x90, 0x05, - 0x27, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x81, 0x86, 0x74, 0x0C, 0xF0, 0xE4, 0xFD, 0xFF, 0xE1, 0x17, - 0x90, 0x82, 0xDA, 0xEF, 0xF0, 0xF1, 0x87, 0x90, 0x82, 0xDA, 0xE0, 0x60, 0x03, 0x12, 0x67, 0x60, - 0x7D, 0x04, 0xF1, 0xF1, 0x74, 0x04, 0xF0, 0x22, 0x12, 0x47, 0x81, 0x70, 0x2B, 0x90, 0x81, 0x88, - 0xE0, 0x54, 0xFD, 0xF0, 0x7D, 0x2C, 0x7F, 0x6F, 0xF1, 0x17, 0x7D, 0x08, 0x7F, 0x01, 0x12, 0x74, - 0x73, 0xBF, 0x01, 0x0F, 0x90, 0x81, 0x87, 0xE0, 0x44, 0x80, 0xF0, 0x7D, 0x0E, 0xF1, 0xF1, 0x74, - 0x0E, 0xF0, 0x22, 0x12, 0x74, 0x2D, 0x04, 0xF0, 0x22, 0xEF, 0x70, 0x3A, 0x7D, 0x78, 0x7F, 0x02, - 0x51, 0x47, 0x7D, 0x02, 0x7F, 0x03, 0x51, 0x47, 0x7D, 0xC8, 0x7F, 0x02, 0x51, 0x1D, 0x12, 0x47, - 0xC8, 0xF0, 0xE4, 0xFF, 0x12, 0x47, 0xA5, 0xEF, 0x70, 0x0B, 0x12, 0x58, 0x8C, 0x54, 0xBF, 0xF0, - 0x54, 0x7F, 0xF0, 0x80, 0x06, 0x7D, 0x01, 0x7F, 0x0C, 0x71, 0xDB, 0x12, 0x58, 0x91, 0x90, 0x06, - 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x22, 0x90, 0x01, 0x36, 0x74, 0x78, 0xF0, 0xA3, 0x74, 0x02, 0xF0, - 0x7D, 0x78, 0xFF, 0x31, 0x25, 0x7D, 0x02, 0x7F, 0x03, 0x31, 0x25, 0x90, 0x06, 0x0A, 0xE0, 0x44, - 0x07, 0x12, 0x77, 0x09, 0xE4, 0xFF, 0x12, 0x47, 0xA5, 0xBF, 0x01, 0x11, 0x12, 0x72, 0x10, 0xF0, - 0x90, 0x81, 0x8F, 0xE0, 0x20, 0xE2, 0x09, 0x7D, 0x01, 0x7F, 0x04, 0x61, 0xDB, 0xF1, 0xEA, 0xF0, - 0x22, 0xE0, 0x54, 0x7F, 0xF0, 0x7D, 0x0C, 0x7F, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, - 0xAC, 0x07, 0xEF, 0x14, 0x60, 0x15, 0x14, 0x60, 0x19, 0x24, 0x02, 0x70, 0x1A, 0xED, 0x54, 0x01, - 0xFE, 0x90, 0x81, 0x87, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0x80, 0x0C, 0x90, 0x81, 0x8F, 0xED, 0xF0, - 0x80, 0x05, 0x90, 0x81, 0x8E, 0xED, 0xF0, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE4, 0x2E, 0xEC, 0x14, - 0x60, 0x07, 0x14, 0x60, 0x1D, 0x24, 0x02, 0x70, 0x23, 0x90, 0x81, 0x87, 0xE0, 0x54, 0x01, 0xC4, - 0x33, 0x33, 0x33, 0x54, 0x80, 0xFF, 0x90, 0x81, 0x8F, 0xE0, 0x54, 0x7F, 0x4F, 0xFD, 0x7F, 0x88, - 0x80, 0x07, 0x90, 0x81, 0x8E, 0xE0, 0xFD, 0x7F, 0x89, 0x12, 0x32, 0x1E, 0xD0, 0xD0, 0x92, 0xAF, - 0x22, 0x7D, 0x2F, 0x7F, 0xFF, 0xF1, 0x17, 0x12, 0x65, 0x86, 0x7D, 0x08, 0xF1, 0xF1, 0x74, 0x08, - 0xF0, 0x22, 0xF1, 0x87, 0xE4, 0xFD, 0xFF, 0x90, 0x05, 0x22, 0xEF, 0xF0, 0x90, 0x80, 0x40, 0xED, - 0xF0, 0x22, 0xF1, 0x12, 0xD1, 0x95, 0x90, 0x81, 0x86, 0x74, 0x0C, 0xF0, 0x22, 0x90, 0x81, 0xF0, - 0xE0, 0x30, 0xE0, 0x52, 0x13, 0x13, 0x54, 0x3F, 0x20, 0xE0, 0x18, 0xE4, 0xF5, 0x1D, 0x90, 0x81, - 0xF2, 0x12, 0x56, 0x8C, 0xF1, 0x12, 0x12, 0x70, 0x2C, 0x30, 0xE0, 0x02, 0xD1, 0x95, 0x12, 0x70, - 0xA7, 0xF0, 0x22, 0x90, 0x81, 0xF0, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x28, 0xE4, 0xF5, - 0x1D, 0x90, 0x81, 0xF3, 0x12, 0x56, 0x8C, 0x90, 0x81, 0xF0, 0xE0, 0x54, 0xFB, 0xF0, 0xE0, 0xC3, - 0x13, 0x30, 0xE0, 0x09, 0x12, 0x70, 0xAE, 0x7D, 0x04, 0x7F, 0x01, 0xC1, 0x99, 0x7D, 0x31, 0x7F, - 0xFF, 0xF1, 0x17, 0x12, 0x65, 0x86, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 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, 0x67, 0x8A, 0xEC, 0x54, 0x7F, 0xFC, 0x90, 0x82, - 0xBF, 0x12, 0x20, 0xCE, 0x90, 0x82, 0xBF, 0x12, 0x44, 0xF2, 0x12, 0x67, 0x27, 0x7F, 0x7C, 0x12, - 0x67, 0x35, 0x12, 0x20, 0xDA, 0xCC, 0xC0, 0x00, 0xC0, 0x7F, 0x8C, 0x12, 0x67, 0x35, 0x12, 0x20, - 0xDA, 0x00, 0xC0, 0x00, 0x14, 0x12, 0x67, 0xB3, 0x12, 0x20, 0xDA, 0x00, 0x03, 0x3E, 0x60, 0xE4, - 0xFD, 0xFF, 0x12, 0x69, 0x43, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x81, 0x88, 0xE0, 0x44, 0x04, - 0x22, 0x7F, 0x01, 0xD1, 0x99, 0x90, 0x81, 0x86, 0x22, 0x90, 0x01, 0xC8, 0xE4, 0xF0, 0xA3, 0xF0, - 0xA3, 0xF0, 0x7B, 0x01, 0x7A, 0x82, 0x79, 0x08, 0x7F, 0xFF, 0xFE, 0x12, 0x2B, 0x27, 0xBF, 0x01, - 0x09, 0x90, 0x82, 0x08, 0xE0, 0x64, 0x03, 0x60, 0x03, 0x22, 0x01, 0xBB, 0xE4, 0x90, 0x82, 0x0D, - 0xF0, 0x90, 0x82, 0x0D, 0xE0, 0xFF, 0xC3, 0x94, 0x02, 0x40, 0x02, 0x01, 0xF6, 0xC3, 0x74, 0xFE, - 0x9F, 0xFF, 0xE4, 0x94, 0x00, 0xFE, 0x7B, 0x01, 0x7A, 0x82, 0x79, 0x09, 0x12, 0x2B, 0x27, 0xEF, - 0x64, 0x01, 0x70, 0x77, 0x90, 0x82, 0x09, 0xE0, 0xFF, 0x54, 0xC0, 0xFE, 0x60, 0x05, 0xEF, 0x54, - 0x0C, 0x70, 0x16, 0x90, 0x82, 0x09, 0xE0, 0xFF, 0x54, 0x30, 0x60, 0x67, 0xEF, 0x54, 0x03, 0x60, - 0x62, 0x90, 0x82, 0x0A, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x82, 0x0A, 0xF0, 0x90, 0x82, - 0x0A, 0xE0, 0x90, 0x82, 0x09, 0x70, 0x16, 0xE0, 0xFF, 0xEE, 0x13, 0x13, 0x54, 0x3F, 0x90, 0x82, - 0x0B, 0xF0, 0xEF, 0x54, 0x0C, 0x13, 0x13, 0x54, 0x3F, 0xA3, 0xF0, 0x80, 0x0D, 0xE0, 0xFE, 0x54, - 0x30, 0x90, 0x82, 0x0B, 0xF0, 0xEE, 0x54, 0x03, 0xA3, 0xF0, 0x90, 0x82, 0x0B, 0xE0, 0x64, 0x30, - 0x70, 0x54, 0xA3, 0xE0, 0x64, 0x02, 0x70, 0x4E, 0x90, 0x00, 0xF5, 0xE0, 0x54, 0x40, 0x90, 0x82, - 0x0E, 0xF0, 0xE0, 0x70, 0x41, 0xA3, 0x74, 0x02, 0xF0, 0x80, 0x10, 0x90, 0x82, 0x0F, 0x74, 0x01, - 0xF0, 0x80, 0x08, 0x90, 0x82, 0x0D, 0xE0, 0x04, 0xF0, 0x01, 0x21, 0x90, 0x01, 0xC4, 0x74, 0xF9, - 0xF0, 0x74, 0x4F, 0xA3, 0xF0, 0x90, 0x82, 0x0F, 0xE0, 0x90, 0x01, 0xC8, 0xF0, 0x90, 0x82, 0x09, - 0xE0, 0x90, 0x01, 0xC9, 0xF0, 0x90, 0x82, 0x0A, 0xE0, 0x90, 0x01, 0xCA, 0xF0, 0xE4, 0xFD, 0x7F, - 0x1F, 0x12, 0x32, 0x1E, 0x80, 0xD5, 0x22, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x80, - 0x12, 0x32, 0x1E, 0x90, 0xFD, 0x00, 0xE0, 0x54, 0xBF, 0xF0, 0x12, 0x4F, 0xF9, 0x12, 0x6E, 0xCE, - 0x12, 0x32, 0x77, 0x12, 0x6E, 0xDB, 0x31, 0x53, 0x7F, 0x01, 0x12, 0x42, 0x15, 0x90, 0x81, 0xFB, - 0x74, 0x02, 0xF0, 0xFF, 0x12, 0x42, 0x15, 0x90, 0x81, 0xFB, 0xE0, 0x04, 0xF0, 0x51, 0x35, 0x31, - 0x64, 0x90, 0x01, 0xCC, 0x74, 0x0F, 0xF0, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x40, 0xFD, 0x7F, 0x80, - 0x12, 0x32, 0x1E, 0x75, 0x20, 0xFF, 0x12, 0x58, 0x14, 0x51, 0xD2, 0x12, 0x6F, 0x32, 0xE4, 0xFF, - 0x02, 0x42, 0x9E, 0xE4, 0x90, 0x80, 0x3C, 0x31, 0x5C, 0xA3, 0xF0, 0x22, 0xF0, 0xA3, 0xF0, 0xA3, - 0xF0, 0xA3, 0xF0, 0x22, 0x31, 0x77, 0x12, 0x6E, 0x7F, 0x51, 0x17, 0x12, 0x78, 0x19, 0x12, 0x79, - 0xF5, 0x12, 0x78, 0xED, 0x02, 0x45, 0x73, 0xE4, 0xFD, 0xFF, 0x12, 0x7A, 0x45, 0xED, 0x70, 0x12, - 0x31, 0xB6, 0xC0, 0x83, 0xC0, 0x82, 0x31, 0xAE, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5E, - 0x80, 0x0F, 0x31, 0xB6, 0xC0, 0x83, 0xC0, 0x82, 0x31, 0xAE, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, - 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x31, 0xC1, 0x90, 0x81, 0x81, 0xEF, 0xF0, 0x22, 0xE0, 0xFE, - 0x74, 0x01, 0xA8, 0x07, 0x08, 0x22, 0x74, 0x79, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, - 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x7D, 0x08, 0xED, 0x14, 0xF9, 0x24, 0x79, 0x31, - 0xB9, 0xE0, 0x60, 0x3A, 0x7C, 0x08, 0xEC, 0x14, 0x90, 0x82, 0xD7, 0xF0, 0x74, 0x79, 0x29, 0x31, - 0xB9, 0xE0, 0xFB, 0x7A, 0x00, 0x90, 0x82, 0xD7, 0x12, 0x47, 0xF2, 0x80, 0x05, 0xC3, 0x33, 0xCE, - 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5A, 0xFE, 0xEF, 0x5B, 0x4E, 0x60, 0x0F, 0xE9, 0x75, 0xF0, - 0x08, 0xA4, 0xFF, 0x90, 0x82, 0xD7, 0xE0, 0x2F, 0x04, 0xFF, 0x80, 0x06, 0xDC, 0xC8, 0xDD, 0xBA, - 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7E, 0x00, 0x7F, 0x01, 0x7D, 0x00, 0x7B, 0x01, 0x7A, - 0x81, 0x79, 0x82, 0x12, 0x45, 0x73, 0x90, 0x81, 0x82, 0xE0, 0x54, 0xFD, 0xF0, 0xE4, 0x31, 0x5D, - 0xA3, 0x74, 0x0C, 0xF0, 0x22, 0xF1, 0xFA, 0x90, 0x80, 0x42, 0xEF, 0xF0, 0x51, 0x55, 0x90, 0x01, - 0x64, 0x74, 0x01, 0xF0, 0x90, 0x00, 0x12, 0xE0, 0x54, 0xC7, 0x44, 0x20, 0xFD, 0x7F, 0x12, 0x12, - 0x32, 0x1E, 0x02, 0x2D, 0xA7, 0x51, 0x85, 0x51, 0xAB, 0x12, 0x6E, 0x8D, 0x12, 0x6E, 0xAC, 0xE4, - 0xF5, 0x35, 0xF5, 0x36, 0xF5, 0x37, 0x75, 0x38, 0x80, 0xAD, 0x35, 0x7F, 0x50, 0x12, 0x32, 0x1E, - 0xAD, 0x36, 0x7F, 0x51, 0x12, 0x32, 0x1E, 0xAD, 0x37, 0x7F, 0x52, 0x12, 0x32, 0x1E, 0xAD, 0x38, - 0x7F, 0x53, 0x02, 0x32, 0x1E, 0x90, 0x01, 0x30, 0xE4, 0x31, 0x5C, 0x90, 0x01, 0x38, 0x31, 0x5C, - 0xFD, 0x7F, 0x50, 0x12, 0x32, 0x1E, 0xE4, 0xFD, 0x7F, 0x51, 0x12, 0x32, 0x1E, 0xE4, 0xFD, 0x7F, - 0x52, 0x12, 0x32, 0x1E, 0xE4, 0xFD, 0x7F, 0x53, 0x02, 0x32, 0x1E, 0x90, 0x01, 0x34, 0x74, 0xFF, - 0x31, 0x5C, 0x90, 0x01, 0x3C, 0x31, 0x5C, 0xFD, 0x7F, 0x54, 0x12, 0x32, 0x1E, 0x7D, 0xFF, 0x7F, - 0x55, 0x12, 0x32, 0x1E, 0x7D, 0xFF, 0x7F, 0x56, 0x12, 0x32, 0x1E, 0x7D, 0xFF, 0x7F, 0x57, 0x02, - 0x32, 0x1E, 0xE4, 0x90, 0x82, 0x08, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x98, 0xE0, 0x7F, 0x00, 0x30, - 0xE4, 0x02, 0x7F, 0x01, 0xEF, 0x64, 0x01, 0x60, 0x3D, 0xC3, 0x90, 0x82, 0x09, 0xE0, 0x94, 0x88, - 0x90, 0x82, 0x08, 0xE0, 0x94, 0x13, 0x40, 0x0F, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x10, 0xF0, 0x90, - 0x01, 0xC7, 0x74, 0xFD, 0xF0, 0x80, 0x1F, 0x90, 0x82, 0x08, 0x12, 0x63, 0xA9, 0x12, 0x67, 0x83, - 0xD3, 0x90, 0x82, 0x09, 0xE0, 0x94, 0x32, 0x90, 0x82, 0x08, 0xE0, 0x94, 0x00, 0x40, 0xBA, 0x90, - 0x01, 0xC6, 0xE0, 0x30, 0xE3, 0xB3, 0x90, 0x01, 0xC7, 0x74, 0xFE, 0xF0, 0x22, 0x8B, 0x52, 0x8A, - 0x53, 0x89, 0x54, 0x71, 0x91, 0xFF, 0xF5, 0x56, 0x12, 0x1F, 0xA4, 0xFE, 0xC3, 0x13, 0x30, 0xE0, - 0x0A, 0x90, 0x00, 0x02, 0x12, 0x1F, 0xBD, 0xF5, 0x57, 0x80, 0x02, 0x8F, 0x57, 0x85, 0x56, 0x55, - 0xE5, 0x55, 0xD3, 0x95, 0x57, 0x50, 0x24, 0xAB, 0x52, 0xAA, 0x53, 0xA9, 0x54, 0x12, 0x1F, 0xA4, - 0x54, 0x01, 0xFD, 0xAF, 0x55, 0x31, 0x7A, 0xAF, 0x55, 0x12, 0x47, 0xA5, 0xEF, 0xAF, 0x55, 0x70, - 0x04, 0xF1, 0xEA, 0x80, 0x02, 0xF1, 0xE9, 0x05, 0x55, 0x80, 0xD5, 0xE5, 0x56, 0x70, 0x10, 0xFF, - 0x12, 0x47, 0xA5, 0xEF, 0x70, 0x09, 0x12, 0x58, 0x8C, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x22, - 0xF0, 0x90, 0x00, 0x01, 0x02, 0x1F, 0xBD, 0xF1, 0xDE, 0x54, 0x01, 0xFE, 0x90, 0x81, 0xF0, 0xF1, - 0xEB, 0xFF, 0xF0, 0x12, 0x1F, 0xA4, 0xFE, 0x54, 0x04, 0x25, 0xE0, 0xFD, 0xEF, 0x54, 0xF7, 0x4D, - 0xFF, 0x90, 0x81, 0xF0, 0xF0, 0xEE, 0x54, 0x08, 0x25, 0xE0, 0xFE, 0xEF, 0x54, 0xEF, 0x4E, 0xF0, - 0x90, 0x05, 0x52, 0xE0, 0x54, 0x07, 0xFF, 0x90, 0x82, 0x79, 0x60, 0x15, 0x12, 0x45, 0x3B, 0x71, - 0x91, 0xFD, 0x90, 0x05, 0x56, 0xE0, 0xC3, 0x9D, 0x90, 0x81, 0xF2, 0xF0, 0xA3, 0xED, 0xF0, 0x80, - 0x25, 0x12, 0x45, 0x3B, 0x71, 0x91, 0xFB, 0xFF, 0x90, 0x05, 0x54, 0xE0, 0xC3, 0x9F, 0xFF, 0xE4, - 0x94, 0x00, 0xFE, 0x7C, 0x00, 0x7D, 0x05, 0x12, 0x20, 0x30, 0x90, 0x81, 0xF2, 0xEF, 0xF0, 0xEB, - 0x75, 0xF0, 0x05, 0x84, 0xA3, 0xF0, 0x90, 0x82, 0x79, 0x12, 0x45, 0x3B, 0x12, 0x1F, 0xA4, 0x20, - 0xE0, 0x0A, 0x12, 0x4F, 0x12, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x80, 0x07, 0x12, 0x4E, 0x95, 0x12, - 0x70, 0xA7, 0xF0, 0x90, 0x81, 0xF0, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x20, 0xE0, 0x04, 0xEF, 0x54, - 0xDF, 0xF0, 0x12, 0x70, 0x2C, 0x30, 0xE0, 0x16, 0x90, 0x81, 0x8C, 0x74, 0x01, 0xF0, 0xE4, 0x90, - 0x81, 0x8E, 0xF0, 0x12, 0x4F, 0xEA, 0xF0, 0x90, 0x05, 0x58, 0x74, 0x05, 0xF0, 0x22, 0xE4, 0x90, - 0x81, 0x8C, 0xF0, 0x90, 0x81, 0x8E, 0x74, 0x0C, 0xF0, 0x90, 0x81, 0x87, 0xE0, 0x54, 0xFE, 0xF0, - 0xA3, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x90, 0x82, 0x76, 0x12, 0x45, 0x44, 0x90, 0x82, 0x75, 0xEF, - 0xF0, 0x12, 0x45, 0x4D, 0x54, 0x96, 0x00, 0x54, 0x9E, 0x01, 0x54, 0xA6, 0x12, 0x54, 0xAF, 0x14, - 0x54, 0xB8, 0x20, 0x54, 0xC0, 0x24, 0x54, 0xC9, 0x25, 0x54, 0xD2, 0x26, 0x54, 0xDA, 0x27, 0x54, - 0xE2, 0xC0, 0x00, 0x00, 0x54, 0xEB, 0x90, 0x82, 0x76, 0x12, 0x45, 0x3B, 0xA1, 0x2A, 0x90, 0x82, - 0x76, 0x12, 0x45, 0x3B, 0x61, 0x2D, 0x90, 0x82, 0x76, 0x12, 0x45, 0x3B, 0x02, 0x6D, 0xB5, 0x90, - 0x82, 0x76, 0x12, 0x45, 0x3B, 0x02, 0x6E, 0x5A, 0x90, 0x82, 0x76, 0x12, 0x45, 0x3B, 0xA1, 0x73, - 0x90, 0x82, 0x76, 0x12, 0x45, 0x3B, 0x02, 0x4A, 0x52, 0x90, 0x82, 0x76, 0x12, 0x45, 0x3B, 0x02, - 0x6E, 0x69, 0x90, 0x82, 0x76, 0x12, 0x45, 0x3B, 0x61, 0x97, 0x90, 0x82, 0x76, 0x12, 0x45, 0x3B, - 0x80, 0x19, 0x90, 0x82, 0x76, 0x12, 0x45, 0x3B, 0x02, 0x6E, 0x71, 0x90, 0x01, 0xC0, 0xE0, 0x44, - 0x01, 0xF0, 0x90, 0x82, 0x75, 0xE0, 0x90, 0x01, 0xC2, 0xF0, 0x22, 0x12, 0x1F, 0xA4, 0xFF, 0x54, - 0x01, 0xFE, 0x90, 0x81, 0xF7, 0xF1, 0xEB, 0x71, 0x90, 0x90, 0x81, 0xF8, 0xF0, 0x90, 0x00, 0x02, - 0x12, 0x1F, 0xBD, 0x90, 0x81, 0xF9, 0xF0, 0x90, 0x81, 0xF8, 0xE0, 0x14, 0x90, 0x81, 0xFA, 0xF0, - 0x90, 0x81, 0xF7, 0xE0, 0x54, 0x01, 0xFF, 0x02, 0x48, 0xCD, 0x90, 0x02, 0x09, 0xE0, 0xF5, 0x52, - 0x12, 0x1F, 0xA4, 0x25, 0x52, 0x90, 0x80, 0x85, 0x71, 0x90, 0x25, 0x52, 0x90, 0x80, 0x86, 0xF0, - 0x90, 0x00, 0x02, 0x12, 0x1F, 0xBD, 0x25, 0x52, 0x90, 0x80, 0x87, 0xF1, 0xCF, 0x25, 0x52, 0x90, - 0x80, 0x88, 0xF1, 0xC8, 0x25, 0x52, 0x90, 0x80, 0x89, 0xF0, 0x90, 0x00, 0x05, 0x12, 0x1F, 0xBD, - 0x25, 0x52, 0x90, 0x80, 0x8A, 0xF0, 0x90, 0x00, 0x06, 0x12, 0x1F, 0xBD, 0x25, 0x52, 0x90, 0x80, - 0x8B, 0xF0, 0x22, 0xF1, 0xDE, 0x54, 0x7F, 0x90, 0x81, 0x8C, 0xF0, 0xEF, 0x12, 0x73, 0xF6, 0xA3, - 0x71, 0x90, 0xFF, 0x54, 0xF0, 0xC4, 0x54, 0x0F, 0xFE, 0x90, 0x81, 0x8A, 0xE0, 0x54, 0xF0, 0x4E, - 0xF1, 0xCF, 0x54, 0x01, 0x25, 0xE0, 0xFE, 0x90, 0x81, 0x87, 0xE0, 0x54, 0xFD, 0x4E, 0xF0, 0xEF, - 0x54, 0x0F, 0xC4, 0x54, 0xF0, 0xFF, 0xB1, 0xDB, 0x4F, 0xF0, 0x90, 0x00, 0x02, 0x12, 0x1F, 0xBD, - 0x90, 0x81, 0x8B, 0xF1, 0xC8, 0xFD, 0x7F, 0x02, 0x12, 0x4E, 0x99, 0x90, 0x82, 0x79, 0x12, 0x45, - 0x3B, 0xB1, 0xE2, 0x12, 0x74, 0x2D, 0xF0, 0x90, 0x81, 0x8C, 0x12, 0x7A, 0x2C, 0xB1, 0xDA, 0x90, - 0x01, 0xBE, 0xF0, 0x22, 0x90, 0x81, 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x81, 0x8A, 0xE0, 0x54, - 0x0F, 0x22, 0x90, 0x82, 0x7C, 0x12, 0x45, 0x44, 0x12, 0x79, 0x11, 0x90, 0x81, 0x8C, 0xE0, 0xFF, - 0x12, 0x4E, 0x19, 0x90, 0x81, 0x8C, 0xE0, 0x60, 0x1E, 0x90, 0x82, 0x7C, 0x12, 0x45, 0x3B, 0x71, - 0x91, 0x54, 0x0F, 0xFF, 0x90, 0x00, 0x02, 0x12, 0x1F, 0xBD, 0xFD, 0x12, 0x79, 0x37, 0x12, 0x5F, - 0xAD, 0x74, 0x01, 0xF0, 0x12, 0x72, 0xDD, 0x22, 0x90, 0x06, 0xA9, 0xE0, 0x90, 0x82, 0x01, 0xF0, - 0xE0, 0xFD, 0x54, 0xC0, 0x70, 0x05, 0x12, 0x47, 0xEA, 0x80, 0x53, 0xED, 0x30, 0xE6, 0x3D, 0x90, - 0x81, 0x8C, 0xE0, 0x64, 0x02, 0x70, 0x27, 0x90, 0x81, 0x87, 0xE0, 0xFF, 0xC3, 0x13, 0x20, 0xE0, - 0x09, 0x90, 0x81, 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x1A, 0xB1, 0xDB, 0x64, 0x01, 0x70, 0x1F, - 0x90, 0x81, 0x90, 0xE0, 0x44, 0x04, 0xF0, 0x7F, 0x01, 0x12, 0x76, 0x4E, 0x80, 0x11, 0xB1, 0xD4, - 0x64, 0x02, 0x60, 0x04, 0xF1, 0x6A, 0x80, 0x07, 0xF1, 0x40, 0x80, 0x03, 0x12, 0x47, 0xEA, 0x90, - 0x82, 0x01, 0xE0, 0x90, 0x81, 0x90, 0x30, 0xE7, 0x04, 0xD1, 0x82, 0xE1, 0xD6, 0xE0, 0x54, 0xFD, - 0xF0, 0x22, 0xE0, 0x44, 0x02, 0xF0, 0xE4, 0xF5, 0x1D, 0x90, 0x81, 0xEA, 0xE0, 0xF5, 0x1E, 0xE4, - 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8E, 0x19, 0x8F, - 0x1A, 0xE5, 0x1E, 0x54, 0x07, 0xC4, 0x33, 0x54, 0xE0, 0x85, 0x19, 0x83, 0x85, 0x1A, 0x82, 0xF0, - 0xE5, 0x1D, 0xD1, 0xF6, 0xE5, 0x1E, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x4F, 0xA3, 0xF0, 0xEB, 0xD1, - 0xF6, 0xE5, 0x1D, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x4F, 0xD1, 0xED, 0xF0, 0xBD, 0x01, 0x0D, 0x85, - 0x1A, 0x82, 0x8E, 0x83, 0xA3, 0xA3, 0xA3, 0x74, 0x03, 0xF0, 0x80, 0x06, 0xD1, 0xED, 0xA3, 0x74, - 0x01, 0xF0, 0xD1, 0xED, 0xA3, 0x74, 0x05, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x85, 0x1A, 0x82, - 0x85, 0x19, 0x83, 0xA3, 0xA3, 0x22, 0x54, 0x07, 0xC4, 0x33, 0x54, 0xE0, 0xFF, 0x22, 0x90, 0x06, - 0xA9, 0xE0, 0xF5, 0x4E, 0x54, 0xC0, 0x70, 0x09, 0x12, 0x47, 0xEA, 0x54, 0xFD, 0xF0, 0x02, 0x58, - 0x62, 0xE5, 0x4E, 0x30, 0xE6, 0x16, 0x90, 0x81, 0x8C, 0xE0, 0x64, 0x01, 0x70, 0x11, 0xB1, 0xD4, - 0x64, 0x02, 0x60, 0x04, 0xF1, 0x6A, 0x80, 0x07, 0xF1, 0x40, 0x80, 0x03, 0x12, 0x47, 0xEA, 0xE5, - 0x4E, 0x90, 0x81, 0x90, 0x30, 0xE7, 0x04, 0xD1, 0x82, 0xE1, 0xD6, 0xE0, 0x54, 0xFD, 0xF0, 0x22, - 0xF1, 0x91, 0x90, 0x81, 0x8F, 0xE0, 0x64, 0x0C, 0x60, 0x06, 0x12, 0x67, 0x59, 0x12, 0x74, 0x6F, - 0x22, 0xE4, 0xFF, 0x12, 0x47, 0xA5, 0xBF, 0x01, 0x10, 0x90, 0x81, 0x8C, 0xE0, 0x60, 0x0A, 0xB1, - 0xDB, 0x64, 0x02, 0x60, 0x02, 0x80, 0x03, 0xF1, 0x40, 0x22, 0x90, 0x04, 0x1D, 0xE0, 0x70, 0x20, - 0x90, 0x80, 0x86, 0xE0, 0xFF, 0x90, 0x82, 0xBE, 0x74, 0x09, 0xF0, 0x7B, 0x18, 0xE4, 0xFD, 0x12, - 0x75, 0x07, 0x90, 0x82, 0x02, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, - 0x22, 0x12, 0x7A, 0x81, 0x54, 0x1F, 0x30, 0xE0, 0x05, 0x90, 0x01, 0x5B, 0xE4, 0xF0, 0x90, 0x06, - 0x92, 0x74, 0x02, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x04, 0xF0, 0xE4, 0xF5, 0x1D, 0x90, 0x81, 0xEB, - 0xE0, 0xC3, 0x13, 0x54, 0x7F, 0xF5, 0x1E, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, 0x01, 0xD1, 0x96, - 0x90, 0x81, 0x87, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0xF0, 0x90, 0x00, 0x04, 0x02, 0x1F, 0xBD, 0xF0, - 0x90, 0x00, 0x03, 0x02, 0x1F, 0xBD, 0x90, 0x81, 0x87, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x90, 0x82, - 0x79, 0x12, 0x45, 0x44, 0x12, 0x1F, 0xA4, 0xFF, 0x22, 0x22, 0x22, 0xE0, 0x54, 0xFE, 0x4E, 0xFE, - 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xEE, 0x54, 0xFD, 0x4F, 0x22, 0x90, 0x00, 0xF7, 0xE0, 0x20, 0xE7, - 0x09, 0xE0, 0x7F, 0x01, 0x20, 0xE6, 0x0C, 0x7F, 0x02, 0x22, 0x90, 0x00, 0xF7, 0xE0, 0x30, 0xE6, - 0x02, 0x7F, 0x03, 0x22, 0x75, 0xE8, 0x03, 0x75, 0xA8, 0x84, 0x22, 0xE4, 0x90, 0x82, 0x10, 0xF0, - 0x90, 0x82, 0x10, 0xE0, 0x64, 0x01, 0xF0, 0x24, 0x1B, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x58, 0xA3, - 0xF0, 0x90, 0x81, 0x8C, 0xE0, 0x60, 0x0E, 0x90, 0x81, 0x8F, 0xE0, 0xFF, 0x90, 0x81, 0x8E, 0xE0, - 0x6F, 0x60, 0x02, 0x11, 0x62, 0xC2, 0xAF, 0x12, 0x6F, 0x0B, 0xBF, 0x01, 0x03, 0x12, 0x64, 0x47, - 0xD2, 0xAF, 0xF1, 0xE7, 0x12, 0x32, 0x9E, 0xBF, 0x01, 0x03, 0x12, 0x6D, 0x2B, 0x12, 0x41, 0x4D, - 0x80, 0xBE, 0x90, 0x81, 0x82, 0xE0, 0x90, 0x81, 0x8E, 0x30, 0xE0, 0x04, 0xE0, 0xFF, 0x80, 0x36, - 0xE0, 0xFF, 0x7D, 0x01, 0x02, 0x4B, 0xDB, 0x90, 0x81, 0x8C, 0xE0, 0x60, 0x0E, 0x90, 0x06, 0x92, - 0xE0, 0x30, 0xE1, 0x03, 0x02, 0x57, 0x91, 0x11, 0x91, 0x11, 0x62, 0x22, 0x12, 0x4F, 0x87, 0x11, - 0x99, 0x90, 0x81, 0x87, 0xE0, 0x54, 0xF7, 0xF0, 0x22, 0x12, 0x78, 0xE5, 0x12, 0x67, 0x60, 0x7D, - 0x0C, 0x7F, 0x01, 0x02, 0x4E, 0x99, 0xAE, 0x07, 0x11, 0xC2, 0xBF, 0x01, 0x12, 0x12, 0x7A, 0x59, - 0x54, 0x03, 0x20, 0xE0, 0x0A, 0xAF, 0x06, 0x7D, 0x01, 0x12, 0x4B, 0xDB, 0x7F, 0x01, 0x22, 0x7F, - 0x00, 0x22, 0x90, 0x05, 0x43, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0x22, 0xE4, 0x90, - 0x82, 0x04, 0xF0, 0x90, 0x81, 0x8C, 0xE0, 0x70, 0x02, 0x21, 0x63, 0x12, 0x47, 0x81, 0x60, 0x02, - 0x21, 0x63, 0x12, 0x7A, 0x79, 0x31, 0x64, 0x12, 0x44, 0xD4, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, - 0xC0, 0x07, 0x90, 0x05, 0x62, 0x31, 0x7E, 0x78, 0x10, 0x12, 0x20, 0xBB, 0xD0, 0x03, 0xD0, 0x02, - 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x44, 0xD4, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, - 0x31, 0x7E, 0x78, 0x18, 0x12, 0x20, 0xBB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xF1, - 0xBE, 0x90, 0x82, 0x04, 0x74, 0x01, 0xF0, 0xE4, 0x90, 0x81, 0x93, 0xF0, 0x90, 0x81, 0x82, 0xE0, - 0x30, 0xE0, 0x15, 0x90, 0x81, 0x86, 0xE0, 0xB4, 0x02, 0x05, 0xE4, 0x90, 0x82, 0x04, 0xF0, 0x11, - 0xC2, 0xEF, 0x70, 0x04, 0x90, 0x82, 0x04, 0xF0, 0x90, 0x82, 0x04, 0xE0, 0x60, 0x15, 0xF1, 0x9D, - 0xE4, 0xF5, 0x1D, 0x90, 0x81, 0x94, 0x12, 0x56, 0x8C, 0x90, 0x81, 0x8F, 0xE0, 0x20, 0xE2, 0x03, - 0x12, 0x4B, 0xD7, 0x22, 0xF0, 0x90, 0x05, 0x61, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x78, 0x08, - 0x12, 0x20, 0xBB, 0xA8, 0x04, 0xA9, 0x05, 0xAA, 0x06, 0xAB, 0x07, 0x90, 0x05, 0x60, 0xE0, 0xFF, - 0xE4, 0xFC, 0xFD, 0xFE, 0x22, 0xE4, 0x90, 0x82, 0x21, 0xF0, 0x90, 0x87, 0x5F, 0xE0, 0x90, 0x82, - 0x20, 0xF0, 0xE4, 0x90, 0x82, 0x2D, 0xF0, 0x90, 0x82, 0x1D, 0xF0, 0x90, 0x82, 0x1D, 0xE0, 0xFF, - 0xC3, 0x94, 0x40, 0x50, 0x10, 0x74, 0x30, 0x2F, 0xF1, 0xA5, 0x74, 0xFF, 0xF0, 0x90, 0x82, 0x1D, - 0xE0, 0x04, 0xF0, 0x80, 0xE6, 0xE4, 0x90, 0x82, 0x1D, 0xF0, 0x90, 0x82, 0x20, 0xE0, 0xFF, 0x90, - 0x82, 0x1D, 0xE0, 0xFE, 0xC3, 0x9F, 0x40, 0x02, 0x41, 0x85, 0x74, 0xDF, 0x2E, 0xF9, 0xE4, 0x34, - 0x86, 0xF1, 0x8D, 0x75, 0x16, 0x0A, 0x7B, 0x01, 0x7A, 0x82, 0x79, 0x12, 0x12, 0x2B, 0xED, 0x90, - 0x82, 0x13, 0xE0, 0xFF, 0x12, 0x2F, 0x27, 0xEF, 0x04, 0x90, 0x82, 0x2D, 0xF0, 0x90, 0x82, 0x12, - 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x12, 0x31, 0xEA, 0xEF, 0x24, 0xC8, 0x90, 0x82, 0x2F, 0xF0, 0x75, - 0xF0, 0x08, 0xA4, 0xF0, 0x90, 0x82, 0x13, 0xE0, 0x54, 0x0F, 0x90, 0x82, 0x2E, 0xF0, 0xE4, 0x90, - 0x82, 0x1C, 0xF0, 0x90, 0x82, 0x1E, 0xF0, 0x90, 0x82, 0x1E, 0xE0, 0xFF, 0xC3, 0x94, 0x04, 0x50, - 0x57, 0x90, 0x82, 0x2E, 0xE0, 0xFE, 0xA8, 0x07, 0x08, 0x80, 0x02, 0xC3, 0x13, 0xD8, 0xFC, 0x20, - 0xE0, 0x3E, 0x90, 0x82, 0x1E, 0xE0, 0x25, 0xE0, 0xFF, 0x90, 0x82, 0x2F, 0xE0, 0x2F, 0x24, 0x30, - 0xF9, 0xE4, 0x34, 0x82, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x01, 0x90, 0x82, 0x1C, 0xE0, 0x75, - 0xF0, 0x02, 0xA4, 0x24, 0x14, 0xF9, 0x74, 0x82, 0x35, 0xF0, 0x8B, 0x13, 0xF5, 0x14, 0x89, 0x15, - 0x75, 0x16, 0x02, 0xD0, 0x01, 0xD0, 0x03, 0x12, 0x2B, 0xED, 0x90, 0x82, 0x1C, 0xE0, 0x04, 0xF0, - 0x90, 0x82, 0x1E, 0xE0, 0x04, 0xF0, 0x80, 0x9F, 0x90, 0x82, 0x2D, 0xE0, 0xFF, 0x90, 0x82, 0x1D, - 0xE0, 0x2F, 0xF0, 0x21, 0xBA, 0xE4, 0x90, 0x82, 0x21, 0xF0, 0x90, 0x82, 0x21, 0xE0, 0xC3, 0x94, - 0x40, 0x40, 0x02, 0x81, 0x4F, 0xE0, 0xFF, 0x24, 0x30, 0xF1, 0xA5, 0xE0, 0x90, 0x82, 0x23, 0xF0, - 0xE0, 0xFE, 0x54, 0xF0, 0xC4, 0x54, 0x0F, 0xFD, 0x90, 0x82, 0x22, 0xF0, 0xEE, 0x54, 0x0F, 0xFE, - 0xA3, 0xF0, 0x74, 0x31, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0xE0, 0x90, 0x82, 0x24, - 0xF0, 0xFC, 0xEE, 0xFE, 0xEC, 0xFB, 0xEB, 0xFF, 0x90, 0x82, 0x29, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, - 0xED, 0x12, 0x45, 0x4D, 0x5A, 0xF9, 0x00, 0x5B, 0x24, 0x01, 0x5B, 0xA2, 0x02, 0x5C, 0x40, 0x03, - 0x5B, 0xB2, 0x04, 0x5B, 0xC8, 0x05, 0x5B, 0xC8, 0x06, 0x5B, 0xC8, 0x07, 0x5B, 0xC8, 0x08, 0x5C, - 0x1D, 0x09, 0x5C, 0x2E, 0x0A, 0x00, 0x00, 0x5C, 0x4F, 0x90, 0x82, 0x21, 0xE0, 0xFD, 0xF1, 0x78, - 0xE0, 0xFE, 0x74, 0x32, 0x2D, 0x91, 0x63, 0xE0, 0xFD, 0xED, 0xFF, 0x90, 0x82, 0x2B, 0xEE, 0xF0, - 0xFC, 0xA3, 0xEF, 0xF0, 0x90, 0x82, 0x24, 0xE0, 0xFF, 0x12, 0x2F, 0x96, 0x90, 0x82, 0x1F, 0x74, - 0x02, 0xF0, 0x81, 0x40, 0xF1, 0x74, 0x31, 0x7E, 0x91, 0x50, 0x31, 0x7E, 0x12, 0x44, 0xD4, 0xC0, - 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x82, 0x21, 0xE0, 0x24, 0x34, 0xF5, 0x82, 0xE4, - 0x34, 0x82, 0xF5, 0x83, 0x31, 0x7E, 0x78, 0x10, 0x12, 0x20, 0xBB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, - 0x01, 0xD0, 0x00, 0x12, 0x44, 0xD4, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x82, - 0x21, 0xE0, 0x24, 0x35, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0x31, 0x7E, 0x78, 0x18, 0x12, - 0x20, 0xBB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x44, 0xD4, 0x90, 0x82, 0x25, - 0x12, 0x20, 0xCE, 0x90, 0x82, 0x25, 0x12, 0x44, 0xF2, 0x90, 0x85, 0x96, 0x12, 0x20, 0xCE, 0x90, - 0x82, 0x29, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x2E, 0xE4, 0x90, 0x82, 0x1F, 0x74, 0x04, 0xF0, - 0x81, 0x40, 0x90, 0x82, 0x24, 0xE0, 0xFD, 0x91, 0x5D, 0xE0, 0xFB, 0xE4, 0xFF, 0x12, 0x30, 0xC7, - 0x80, 0x0E, 0x90, 0x82, 0x24, 0xE0, 0xFD, 0x91, 0x5D, 0xE0, 0xFB, 0xE4, 0xFF, 0x12, 0x30, 0x6A, - 0x90, 0x82, 0x1F, 0x74, 0x01, 0xF0, 0x80, 0x78, 0x90, 0x82, 0x1F, 0x74, 0x02, 0xF0, 0xF1, 0x74, - 0x31, 0x7E, 0x91, 0x50, 0x31, 0x7E, 0x12, 0x44, 0xD4, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, - 0x07, 0x90, 0x82, 0x23, 0x31, 0x7E, 0x78, 0x10, 0x12, 0x20, 0xBB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, - 0x01, 0xD0, 0x00, 0x12, 0x44, 0xD4, 0x90, 0x82, 0x25, 0x12, 0x20, 0xCE, 0x90, 0x82, 0x22, 0xE0, - 0x24, 0xFB, 0xFF, 0xC0, 0x07, 0x90, 0x82, 0x25, 0x12, 0x44, 0xF2, 0x90, 0x82, 0xAE, 0x12, 0x20, - 0xCE, 0x90, 0x82, 0x24, 0xE0, 0xFD, 0xD0, 0x07, 0x12, 0x69, 0x43, 0x80, 0x23, 0x90, 0x82, 0x1F, - 0x74, 0x01, 0xF1, 0x82, 0x75, 0x16, 0x01, 0xF1, 0xCF, 0xF0, 0x7B, 0x04, 0x80, 0x0F, 0x90, 0x82, - 0x1F, 0x74, 0x04, 0xF1, 0x82, 0x75, 0x16, 0x04, 0xF1, 0xCF, 0xF0, 0x7B, 0x06, 0x12, 0x6B, 0xB3, - 0x90, 0x82, 0x1F, 0xE0, 0x24, 0x02, 0xFF, 0x90, 0x82, 0x21, 0xE0, 0x2F, 0xF0, 0x41, 0x8A, 0x22, - 0x78, 0x08, 0x12, 0x20, 0xBB, 0xA8, 0x04, 0xA9, 0x05, 0xAA, 0x06, 0xAB, 0x07, 0x90, 0x82, 0x21, - 0xE0, 0x24, 0x32, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0x22, 0xE4, 0xF5, 0x4E, 0x90, 0x81, - 0x8C, 0xE0, 0x70, 0x02, 0xA1, 0x3F, 0x12, 0x47, 0x81, 0x60, 0x02, 0xA1, 0x3F, 0x31, 0x65, 0x12, - 0x44, 0xD4, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, 0x31, 0x7E, 0x78, - 0x10, 0x12, 0x20, 0xBB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x44, 0xD4, 0xC0, - 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x31, 0x7E, 0x78, 0x18, 0x12, 0x20, 0xBB, 0xD0, - 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xF1, 0xBE, 0x12, 0x7A, 0x23, 0x60, 0x22, 0x24, 0xFE, - 0x60, 0x03, 0x04, 0x70, 0x1E, 0x90, 0x81, 0x93, 0xE0, 0x14, 0xF0, 0xE0, 0xFF, 0x60, 0x06, 0x90, - 0x81, 0x95, 0xE0, 0x60, 0x0E, 0xEF, 0x70, 0x08, 0x90, 0x81, 0x92, 0xE0, 0xA3, 0xF0, 0x80, 0x00, - 0x75, 0x4E, 0x01, 0x90, 0x81, 0x82, 0xE0, 0x30, 0xE0, 0x11, 0x90, 0x81, 0x86, 0xE0, 0xB4, 0x02, - 0x03, 0xE4, 0xF5, 0x4E, 0x11, 0xC2, 0xEF, 0x70, 0x02, 0xF5, 0x4E, 0xE5, 0x4E, 0x60, 0x40, 0xF1, - 0x9D, 0x90, 0x81, 0x95, 0xE0, 0x60, 0x04, 0x64, 0x01, 0x70, 0x12, 0xE4, 0xF5, 0x1D, 0x90, 0x81, - 0x95, 0xE0, 0xD1, 0xBD, 0x12, 0x56, 0x8D, 0x90, 0x81, 0x95, 0xE0, 0x80, 0x12, 0xE4, 0xF5, 0x1D, - 0xD1, 0xB3, 0x12, 0x56, 0x8D, 0x90, 0x81, 0x95, 0xE0, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, 0xD1, - 0xBD, 0x90, 0x81, 0xA5, 0xF0, 0x90, 0x81, 0x8F, 0xE0, 0x20, 0xE2, 0x03, 0x12, 0x4B, 0xD7, 0x22, - 0x31, 0x65, 0x12, 0x44, 0xD4, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, - 0x31, 0x7E, 0x78, 0x10, 0x12, 0x20, 0xBB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, - 0x44, 0xD4, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x31, 0x7E, 0x78, 0x18, 0x12, - 0x20, 0xBB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x44, 0xD4, 0x90, 0x81, 0xDB, - 0x12, 0x20, 0xCE, 0x90, 0x81, 0xDF, 0x12, 0x44, 0xF2, 0x90, 0x81, 0xDB, 0x12, 0x45, 0x0A, 0xC3, - 0x12, 0x44, 0xE1, 0x40, 0x41, 0x90, 0x81, 0x87, 0xE0, 0x90, 0x81, 0xDF, 0x30, 0xE0, 0x10, 0x12, - 0x7A, 0x06, 0x90, 0x81, 0xA9, 0xE0, 0x24, 0x04, 0x2F, 0xFF, 0x90, 0x81, 0xE3, 0x80, 0x06, 0x12, - 0x7A, 0x06, 0x90, 0x81, 0xE4, 0xE0, 0xFE, 0xC3, 0xEF, 0x9E, 0x90, 0x82, 0x01, 0xF0, 0x90, 0x82, - 0x01, 0xE0, 0xFF, 0xC3, 0x94, 0x2D, 0x50, 0x0E, 0x74, 0xAA, 0x2F, 0xD1, 0xAB, 0xE0, 0x04, 0xF0, - 0x90, 0x81, 0xA2, 0xE0, 0x04, 0xF0, 0x90, 0x81, 0xA2, 0xE0, 0xFF, 0xD3, 0x90, 0x81, 0xE6, 0xE0, - 0x9F, 0x90, 0x81, 0xE5, 0xE0, 0x94, 0x00, 0x40, 0x02, 0xC1, 0xA7, 0xE4, 0xFF, 0xFE, 0xD1, 0xA8, - 0xE0, 0x2F, 0xFF, 0x90, 0x81, 0xE7, 0xE0, 0xFD, 0xEF, 0xD3, 0x9D, 0x40, 0x07, 0x90, 0x82, 0x02, - 0xEE, 0xF0, 0x80, 0x05, 0x0E, 0xEE, 0xB4, 0x2D, 0xE5, 0xE4, 0xFF, 0xFE, 0xD1, 0xA8, 0xE0, 0x2F, - 0xFF, 0x90, 0x81, 0xE7, 0xE0, 0xFD, 0xC3, 0x90, 0x81, 0xE6, 0xE0, 0x9D, 0xFD, 0x90, 0x81, 0xE5, - 0xE0, 0x94, 0x00, 0xFC, 0xEF, 0xD3, 0x9D, 0xE4, 0x9C, 0x40, 0x07, 0x90, 0x82, 0x03, 0xEE, 0xF0, - 0x80, 0x05, 0x0E, 0xEE, 0xB4, 0x2D, 0xD5, 0x90, 0x82, 0x02, 0xE0, 0x90, 0x81, 0xA7, 0xF0, 0x90, - 0x82, 0x03, 0xE0, 0x90, 0x81, 0xA8, 0xF1, 0x95, 0x94, 0x0A, 0x40, 0x0A, 0xEF, 0x24, 0xF6, 0x90, - 0x81, 0x9F, 0xF0, 0xE4, 0x80, 0x09, 0xE4, 0x90, 0x81, 0x9F, 0xF1, 0x95, 0x74, 0x0A, 0x9F, 0x90, - 0x81, 0x9E, 0xF0, 0x90, 0x81, 0xA7, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, 0x81, 0xA5, 0xF0, - 0x90, 0x81, 0x87, 0xE0, 0x30, 0xE0, 0x05, 0x90, 0x81, 0xE3, 0x80, 0x03, 0x90, 0x81, 0xE4, 0xE0, - 0x04, 0xFF, 0x90, 0x81, 0xA5, 0xE0, 0x2F, 0xF0, 0x90, 0x81, 0xA5, 0xE0, 0xC3, 0x94, 0x0A, 0x50, - 0x03, 0x74, 0x0A, 0xF0, 0x90, 0x81, 0xA5, 0xE0, 0x24, 0x02, 0xF0, 0xF1, 0xAD, 0x74, 0x03, 0xF0, - 0x12, 0x72, 0xDD, 0xE4, 0xFF, 0xF1, 0xE8, 0x22, 0x74, 0xAA, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x81, - 0xF5, 0x83, 0x22, 0x90, 0x81, 0x95, 0xE0, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, 0xFF, 0x90, 0x81, - 0x94, 0xE0, 0x2F, 0x22, 0x90, 0x81, 0x82, 0xE0, 0x30, 0xE0, 0x06, 0x90, 0x81, 0x84, 0x74, 0x01, - 0xF0, 0x90, 0x81, 0x8C, 0xE0, 0x70, 0x02, 0xE1, 0x5F, 0x90, 0x81, 0xA3, 0xE0, 0x04, 0x31, 0x64, - 0x12, 0x44, 0xD4, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, 0x31, 0x7E, - 0x78, 0x10, 0x12, 0x20, 0xBB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x44, 0xD4, - 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x31, 0x7E, 0x78, 0x18, 0x12, 0x20, 0xBB, - 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x44, 0xD4, 0x90, 0x81, 0xD7, 0x12, 0x20, - 0xCE, 0x90, 0x81, 0x88, 0xE0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, 0x30, 0xE0, 0x0B, 0xF1, 0xAD, 0x74, - 0x05, 0xF0, 0x12, 0x72, 0xDD, 0x12, 0x77, 0x01, 0x12, 0x72, 0xC6, 0x30, 0xE0, 0x0A, 0x90, 0x01, - 0x3B, 0xE0, 0x30, 0xE4, 0x03, 0x12, 0x4A, 0x3D, 0x90, 0x82, 0xD8, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, - 0x94, 0x80, 0x40, 0x0B, 0x90, 0x01, 0x98, 0xE0, 0x54, 0xFE, 0xF0, 0xE0, 0x44, 0x01, 0xF0, 0x12, - 0x70, 0x75, 0x90, 0x81, 0xF7, 0xE0, 0x30, 0xE0, 0x0A, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x03, - 0x12, 0x4A, 0x3D, 0x22, 0x90, 0x82, 0x21, 0xE0, 0x24, 0x33, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, - 0x83, 0x22, 0xF0, 0x90, 0x82, 0x21, 0xE0, 0x24, 0x32, 0xF9, 0xE4, 0x34, 0x82, 0x75, 0x13, 0x01, - 0xF5, 0x14, 0x89, 0x15, 0x22, 0xF0, 0x90, 0x81, 0xA7, 0xE0, 0xFF, 0xC3, 0x22, 0x90, 0x81, 0x90, - 0xE0, 0x44, 0x10, 0xF0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0x22, 0x90, 0x81, 0x9E, - 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x81, 0xA5, 0xE0, 0xFB, 0x90, 0x82, 0xCA, 0x22, 0x12, 0x44, - 0xD4, 0x90, 0x81, 0xDF, 0x12, 0x20, 0xCE, 0x90, 0x81, 0x88, 0xE0, 0x44, 0x80, 0xF0, 0x22, 0x7B, - 0xFE, 0x7A, 0x80, 0x79, 0x33, 0x12, 0x2B, 0xED, 0x90, 0x82, 0x24, 0xE0, 0xFF, 0x90, 0x82, 0x23, - 0xE0, 0xFD, 0xE4, 0x90, 0x82, 0x73, 0x22, 0x22, 0xE4, 0xFE, 0xD1, 0xA8, 0xE4, 0xF0, 0x0E, 0xEE, - 0xB4, 0x2D, 0xF7, 0xE4, 0x90, 0x81, 0xA3, 0xF0, 0x90, 0x81, 0xA2, 0xF0, 0x90, 0x81, 0xA6, 0xF0, - 0xEF, 0xB4, 0x01, 0x07, 0xA3, 0x74, 0x2D, 0xF0, 0xE4, 0xA3, 0xF0, 0x22, 0xE4, 0xFB, 0xFA, 0xFD, - 0x7F, 0x01, 0x12, 0x43, 0x4E, 0x90, 0x82, 0x74, 0xEF, 0xF0, 0x60, 0xF0, 0x90, 0x80, 0x3C, 0xE0, - 0xFF, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0xE5, 0xC2, 0xAF, 0xEF, 0x30, 0xE1, 0x09, 0x90, 0x80, 0x3C, - 0xE0, 0x54, 0xFD, 0xF0, 0x11, 0x4B, 0xD2, 0xAF, 0xC2, 0xAF, 0x90, 0x80, 0x3C, 0xE0, 0xFF, 0x30, - 0xE2, 0x05, 0x54, 0xFB, 0xF0, 0x31, 0xDE, 0xD2, 0xAF, 0x80, 0xD1, 0xD3, 0x10, 0xAF, 0x01, 0xC3, - 0xC0, 0xD0, 0x90, 0x80, 0xDD, 0xE0, 0xFF, 0x90, 0x80, 0xDC, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, - 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x70, 0x3F, 0x90, 0x80, 0xDC, 0xE0, 0xFE, 0x75, 0xF0, 0x08, 0x90, - 0x80, 0x8C, 0x12, 0x45, 0x2F, 0xE0, 0xFD, 0xEE, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x8D, 0xF9, 0x74, - 0x80, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xAF, 0x05, 0x12, 0x54, 0x66, 0x90, 0x80, 0xDC, 0x31, 0xD7, - 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0x80, 0xDC, 0xF0, 0x11, 0xAB, 0x90, - 0x80, 0x3C, 0xE0, 0x44, 0x02, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x01, 0xCC, 0xE0, 0x54, - 0x0F, 0x90, 0x82, 0xD4, 0xF0, 0x90, 0x82, 0xD4, 0xE0, 0xFD, 0x70, 0x02, 0x21, 0xAF, 0x90, 0x80, - 0xDC, 0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, 0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0x80, - 0xDD, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x08, 0x90, 0x01, - 0xC1, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x82, 0xD2, 0x12, 0x47, 0xF2, 0x80, 0x05, 0xC3, 0x33, - 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x70, 0x02, 0x21, 0x92, 0xE4, 0x90, 0x82, 0xD5, - 0xF0, 0x90, 0x82, 0xD5, 0xE0, 0xF9, 0xC3, 0x94, 0x04, 0x50, 0x38, 0x31, 0xB1, 0xA4, 0xFF, 0xE9, - 0xFD, 0x7C, 0x00, 0x2F, 0xFF, 0xEC, 0x35, 0xF0, 0xFE, 0x74, 0xD0, 0x31, 0xC8, 0x75, 0xF0, 0x08, - 0x90, 0x80, 0x8C, 0x31, 0xB9, 0x31, 0xB0, 0xA4, 0x2D, 0xFF, 0xEC, 0x35, 0xF0, 0xFE, 0x74, 0xF0, - 0x31, 0xC8, 0x75, 0xF0, 0x08, 0x90, 0x80, 0x90, 0x31, 0xB9, 0xF0, 0x90, 0x82, 0xD5, 0xE0, 0x04, - 0xF0, 0x80, 0xBE, 0x90, 0x82, 0xD4, 0xE0, 0xFF, 0x90, 0x82, 0xD2, 0xE0, 0xFE, 0x74, 0x01, 0xA8, - 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0x90, 0x82, 0xD4, 0xF0, 0x90, 0x82, - 0xD2, 0xE0, 0xFF, 0x74, 0x01, 0xA8, 0x07, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x90, 0x01, - 0xCC, 0xF0, 0x90, 0x82, 0xD2, 0xE0, 0x04, 0xF0, 0xE0, 0x54, 0x03, 0xF0, 0x90, 0x80, 0xDD, 0x31, - 0xD7, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x70, 0x02, 0x01, 0xB5, 0xE4, 0x90, 0x80, 0xDD, 0xF0, - 0x01, 0xB5, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x82, 0xD2, 0xE0, 0x44, 0x80, 0x90, - 0x00, 0x8A, 0x31, 0xB0, 0x90, 0x01, 0xD0, 0x12, 0x45, 0x2F, 0xE0, 0x90, 0x01, 0xC3, 0xF0, 0x22, - 0xF0, 0x90, 0x82, 0xD2, 0xE0, 0x75, 0xF0, 0x04, 0x22, 0x12, 0x45, 0x2F, 0xE5, 0x82, 0x29, 0xF5, - 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xEF, 0x22, 0x2F, 0xF5, 0x82, 0x74, 0x01, 0x3E, 0xF5, 0x83, - 0xE0, 0xFF, 0x90, 0x80, 0xDD, 0xE0, 0x22, 0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0x22, 0xD3, 0x10, - 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x90, 0x81, 0x75, 0xE0, 0xFE, 0x90, 0x81, 0x74, 0xE0, - 0xFD, 0xB5, 0x06, 0x04, 0x7E, 0x01, 0x80, 0x02, 0x7E, 0x00, 0xEE, 0x64, 0x01, 0x60, 0x41, 0x90, - 0x01, 0xAF, 0xE0, 0x70, 0x0A, 0xED, 0x51, 0xA2, 0xFA, 0x7B, 0x01, 0x51, 0xFA, 0x7F, 0x01, 0xEF, - 0x60, 0x2E, 0x90, 0x81, 0x74, 0x31, 0xD7, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, - 0x90, 0x81, 0x74, 0xF0, 0x90, 0x81, 0x75, 0xE0, 0xFF, 0x90, 0x81, 0x74, 0xE0, 0xB5, 0x07, 0x04, - 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x70, 0x07, 0x90, 0x80, 0x3C, 0xE0, 0x44, 0x04, 0xF0, - 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x81, 0x74, 0xE0, - 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, 0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0x81, 0x75, 0xE0, - 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x09, 0x90, 0x01, 0xC1, 0xE0, - 0x44, 0x02, 0xF0, 0x80, 0x28, 0xC0, 0x01, 0x90, 0x81, 0x75, 0xE0, 0x51, 0xA2, 0xA8, 0x01, 0xFC, - 0x7D, 0x01, 0xD0, 0x01, 0x7E, 0x00, 0x7F, 0x0F, 0x12, 0x44, 0x7D, 0x90, 0x81, 0x75, 0x31, 0xD7, - 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0x81, 0x75, 0xF0, 0xD0, 0xD0, 0x92, - 0xAF, 0x22, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0xDE, 0xF9, 0x74, 0x80, 0x35, 0xF0, 0x22, 0x90, 0x82, - 0x84, 0x74, 0x12, 0xF0, 0x90, 0x82, 0x92, 0x74, 0x05, 0xF0, 0x90, 0x82, 0x86, 0xEF, 0xF0, 0xA3, - 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x82, 0x82, 0xE0, 0x90, 0x82, 0x89, 0xF0, 0x90, 0x82, 0x83, - 0xE0, 0x90, 0x82, 0x8A, 0xF0, 0x7B, 0x01, 0x7A, 0x82, 0x79, 0x84, 0x51, 0x45, 0x7F, 0x04, 0x90, - 0x82, 0xD6, 0xEF, 0xF0, 0x7F, 0x02, 0x12, 0x43, 0x27, 0x90, 0x80, 0x3C, 0xE0, 0xFF, 0x90, 0x82, - 0xD6, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x80, 0x3C, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, - 0xD0, 0x90, 0x82, 0x75, 0x12, 0x45, 0x44, 0x90, 0x82, 0xD3, 0xE0, 0xFF, 0x04, 0xF0, 0x90, 0x00, - 0x01, 0xEF, 0x12, 0x1F, 0xFC, 0x7F, 0xAF, 0x7E, 0x01, 0x71, 0x5D, 0xEF, 0x60, 0x3A, 0x90, 0x82, - 0x75, 0x12, 0x45, 0x3B, 0x8B, 0x13, 0x8A, 0x14, 0x89, 0x15, 0x90, 0x00, 0x0E, 0x12, 0x1F, 0xBD, - 0x24, 0x02, 0xF5, 0x16, 0x7B, 0x01, 0x7A, 0x01, 0x79, 0xA0, 0x12, 0x2B, 0xED, 0x90, 0x82, 0x75, - 0x12, 0x45, 0x3B, 0x90, 0x00, 0x0E, 0x12, 0x1F, 0xBD, 0x90, 0x01, 0xAE, 0xF0, 0xA3, 0x74, 0xFF, - 0xF0, 0x90, 0x01, 0xCB, 0xE0, 0x64, 0x80, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, - 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x82, 0xB7, 0xEE, 0xF0, 0xA3, 0x71, 0xFC, 0x90, 0x82, 0xB7, 0xE0, - 0xFE, 0xA3, 0xE0, 0xF5, 0x82, 0x8E, 0x83, 0xE0, 0x60, 0x28, 0xC3, 0x90, 0x82, 0xBA, 0xE0, 0x94, - 0xE8, 0x90, 0x82, 0xB9, 0xE0, 0x94, 0x03, 0x40, 0x0B, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x80, 0xF0, - 0x7F, 0x00, 0x80, 0x10, 0x90, 0x82, 0xB9, 0x71, 0xA9, 0x7F, 0x0A, 0x7E, 0x00, 0x12, 0x32, 0xAA, - 0x80, 0xCA, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0x75, 0xF0, 0x01, 0x02, 0x44, 0xA3, - 0x90, 0x82, 0x11, 0x71, 0xFC, 0x90, 0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, - 0x90, 0x82, 0x11, 0xE0, 0x6F, 0x60, 0x34, 0xC3, 0x90, 0x82, 0x13, 0xE0, 0x94, 0x88, 0x90, 0x82, - 0x12, 0xE0, 0x94, 0x13, 0x40, 0x08, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x82, - 0x12, 0x71, 0xA9, 0xF1, 0x83, 0xD3, 0x90, 0x82, 0x13, 0xE0, 0x94, 0x32, 0x90, 0x82, 0x12, 0xE0, - 0x94, 0x00, 0x40, 0xC1, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE0, 0xBA, 0x22, 0xEF, 0xF0, 0xE4, 0xA3, - 0xF0, 0xA3, 0xF0, 0x22, 0x12, 0x77, 0xFC, 0x90, 0x00, 0x08, 0xE0, 0x54, 0xEF, 0xFD, 0x7F, 0x08, - 0x12, 0x32, 0x1E, 0xE4, 0xFF, 0x71, 0xB0, 0x90, 0x81, 0x88, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0xD3, - 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x91, 0x67, 0x91, 0x04, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, - 0x81, 0x8F, 0xE0, 0xFF, 0x60, 0x03, 0xB4, 0x08, 0x0D, 0x91, 0xB3, 0xBF, 0x01, 0x08, 0x91, 0x1F, - 0x90, 0x01, 0xE5, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x81, 0x87, 0xE0, 0x30, 0xE0, 0x18, 0x90, 0x81, - 0x82, 0xE0, 0xFF, 0x30, 0xE0, 0x0E, 0xC3, 0x13, 0x30, 0xE0, 0x07, 0xF1, 0xBE, 0xBF, 0x01, 0x06, - 0x80, 0x02, 0x80, 0x00, 0x91, 0x2F, 0x22, 0x90, 0x81, 0x88, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x81, - 0x97, 0xE0, 0xFD, 0x7F, 0x93, 0x12, 0x32, 0x1E, 0x90, 0x81, 0x8D, 0xE0, 0x60, 0x12, 0x90, 0x01, - 0x2F, 0xE0, 0x30, 0xE7, 0x05, 0x74, 0x10, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, - 0x90, 0x00, 0x08, 0xE0, 0x44, 0x10, 0xFD, 0x7F, 0x08, 0x12, 0x32, 0x1E, 0x7F, 0x01, 0x71, 0xB0, - 0x90, 0x00, 0x90, 0xE0, 0x44, 0x01, 0xFD, 0x7F, 0x90, 0x12, 0x32, 0x1E, 0x7F, 0x14, 0x7E, 0x00, - 0x02, 0x32, 0xAA, 0x90, 0x81, 0xF7, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x35, 0x90, 0x02, 0x87, 0xE0, - 0x60, 0x02, 0x80, 0x08, 0x90, 0x01, 0x00, 0xE0, 0x64, 0x3F, 0x60, 0x05, 0x75, 0x4F, 0x01, 0x80, - 0x22, 0x90, 0x02, 0x96, 0xE0, 0x60, 0x05, 0x75, 0x4F, 0x10, 0x80, 0x17, 0x90, 0x02, 0x86, 0xE0, - 0x20, 0xE1, 0x02, 0x80, 0x07, 0x90, 0x02, 0x86, 0xE0, 0x30, 0xE3, 0x05, 0x75, 0x4F, 0x04, 0x80, - 0x02, 0xE1, 0x99, 0x90, 0x01, 0xB9, 0x74, 0x08, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x4F, 0xF0, 0x7F, - 0x00, 0x22, 0x7F, 0xFF, 0x12, 0x4F, 0x17, 0xE4, 0x90, 0x82, 0xCF, 0xF0, 0xA3, 0xF0, 0x90, 0x05, - 0x22, 0xE0, 0x90, 0x82, 0xD1, 0xF0, 0x7D, 0x47, 0x7F, 0xFF, 0x12, 0x4F, 0x17, 0x90, 0x05, 0xF8, - 0xE0, 0x70, 0x11, 0xA3, 0xE0, 0x70, 0x0D, 0xA3, 0xE0, 0x70, 0x09, 0xA3, 0xE0, 0x70, 0x05, 0xB1, - 0x5D, 0x7F, 0x01, 0x22, 0xD3, 0x90, 0x82, 0xD0, 0xE0, 0x94, 0xE8, 0x90, 0x82, 0xCF, 0xE0, 0x94, - 0x03, 0x40, 0x0C, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x20, 0xF0, 0xB1, 0x5D, 0x7F, 0x00, 0x22, 0x7F, - 0x32, 0x7E, 0x00, 0x12, 0x32, 0xAA, 0x90, 0x82, 0xCF, 0x71, 0xA9, 0x80, 0xC0, 0x90, 0x82, 0xD1, - 0xE0, 0xFF, 0x7D, 0x48, 0x02, 0x4F, 0x17, 0x7D, 0x2D, 0xB1, 0x02, 0x90, 0x01, 0x37, 0x74, 0x02, - 0xF0, 0xFD, 0x7F, 0x03, 0x12, 0x49, 0x25, 0xB1, 0x86, 0xE4, 0xFD, 0x7F, 0x01, 0x12, 0x4E, 0x99, - 0xE4, 0x90, 0x81, 0x86, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xB1, 0x07, 0x90, - 0x85, 0xBB, 0x12, 0x20, 0xDA, 0xCC, 0xF0, 0x00, 0xC0, 0x7F, 0x8C, 0xF1, 0x35, 0x12, 0x20, 0xDA, - 0x00, 0x00, 0x00, 0x14, 0xF1, 0xB3, 0x12, 0x20, 0xDA, 0x00, 0x00, 0x00, 0x00, 0xE4, 0xFD, 0xFF, - 0x12, 0x69, 0x43, 0xF1, 0x8A, 0xEC, 0x44, 0x80, 0xFC, 0x90, 0x82, 0xC3, 0x12, 0x20, 0xCE, 0x90, - 0x82, 0xC3, 0x12, 0x44, 0xF2, 0xF1, 0x27, 0x7F, 0x7C, 0x7E, 0x08, 0x12, 0x2E, 0xA2, 0x90, 0x01, - 0x00, 0x74, 0x3F, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, 0x20, 0xF0, - 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xC1, 0xCD, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x81, - 0x85, 0xE0, 0xF5, 0x1F, 0xE5, 0x1F, 0x6F, 0x70, 0x02, 0xC1, 0xC1, 0xEF, 0x14, 0x60, 0x38, 0x14, - 0x60, 0x58, 0x14, 0x60, 0x78, 0x14, 0x70, 0x02, 0xC1, 0xA0, 0x24, 0x04, 0x60, 0x02, 0xC1, 0xC1, - 0xE5, 0x1F, 0xB4, 0x04, 0x04, 0xF1, 0x0D, 0xC1, 0xC1, 0xE5, 0x1F, 0xB4, 0x02, 0x04, 0xF1, 0x17, - 0xC1, 0xC1, 0xE5, 0x1F, 0xB4, 0x03, 0x04, 0xF1, 0x03, 0xC1, 0xC1, 0xE5, 0x1F, 0x64, 0x01, 0x60, - 0x02, 0xC1, 0xC1, 0xF1, 0x05, 0xC1, 0xC1, 0xE5, 0x1F, 0xB4, 0x04, 0x04, 0xF1, 0x11, 0xC1, 0xC1, - 0xE5, 0x1F, 0xB4, 0x02, 0x04, 0xF1, 0x1B, 0x80, 0x78, 0xE5, 0x1F, 0xB4, 0x03, 0x04, 0xD1, 0xFF, - 0x80, 0x6F, 0xE5, 0x1F, 0x70, 0x6B, 0xD1, 0xE0, 0x80, 0x67, 0xE5, 0x1F, 0xB4, 0x04, 0x04, 0xD1, - 0xD6, 0x80, 0x5E, 0xE5, 0x1F, 0xB4, 0x01, 0x04, 0xD1, 0xC6, 0x80, 0x55, 0xE5, 0x1F, 0xB4, 0x03, - 0x04, 0xB1, 0xE5, 0x80, 0x4C, 0xE5, 0x1F, 0x70, 0x48, 0xD1, 0xDC, 0x80, 0x44, 0xE5, 0x1F, 0xB4, - 0x04, 0x04, 0xF1, 0x73, 0x80, 0x3B, 0xE5, 0x1F, 0xB4, 0x01, 0x04, 0xD1, 0xF1, 0x80, 0x32, 0xE5, - 0x1F, 0xB4, 0x02, 0x04, 0xF1, 0xA9, 0x80, 0x29, 0xE5, 0x1F, 0x70, 0x25, 0xD1, 0xEF, 0x80, 0x21, - 0xE5, 0x1F, 0xB4, 0x03, 0x04, 0xF1, 0x20, 0x80, 0x18, 0xE5, 0x1F, 0xB4, 0x01, 0x04, 0xD1, 0xE9, - 0x80, 0x0F, 0xE5, 0x1F, 0xB4, 0x02, 0x04, 0xF1, 0x3E, 0x80, 0x06, 0xE5, 0x1F, 0x70, 0x02, 0xD1, - 0xE7, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7D, 0x20, 0x7F, 0xFF, 0x12, 0x4F, 0x17, 0xB1, 0x86, 0x90, - 0x81, 0x85, 0x74, 0x02, 0xF0, 0x22, 0xF1, 0x2D, 0x7D, 0x23, 0x80, 0xEC, 0xD1, 0xE0, 0x80, 0xE6, - 0x90, 0x81, 0x85, 0x74, 0x01, 0xF0, 0x22, 0xD1, 0xE0, 0x7D, 0x1F, 0xF1, 0x47, 0xF0, 0x22, 0xD1, - 0xE0, 0x7D, 0x21, 0x7F, 0xFF, 0x12, 0x4F, 0x17, 0x90, 0x81, 0x85, 0x74, 0x03, 0xF0, 0x22, 0xF1, - 0x60, 0x80, 0xDD, 0xD1, 0xFF, 0xF1, 0xA1, 0xE4, 0x90, 0x81, 0x85, 0xF0, 0x22, 0xF1, 0x11, 0x80, - 0xF4, 0xF1, 0x60, 0xF1, 0x2D, 0x80, 0xC9, 0xF1, 0x1B, 0x80, 0xEA, 0x12, 0x4F, 0x12, 0x80, 0xC0, - 0x7D, 0x25, 0xF1, 0x47, 0xF0, 0x22, 0xFC, 0x90, 0x85, 0xBB, 0x02, 0x20, 0xCE, 0x90, 0x05, 0x27, - 0xE0, 0x44, 0x40, 0xF0, 0x22, 0x7E, 0x08, 0x12, 0x2E, 0xA2, 0x90, 0x85, 0xBB, 0x22, 0x12, 0x4F, - 0x87, 0x7D, 0x24, 0xF1, 0x47, 0xF0, 0x22, 0x7F, 0x6F, 0x12, 0x4F, 0x17, 0x90, 0x05, 0x27, 0xE0, - 0x54, 0xBF, 0xF0, 0x90, 0x81, 0x85, 0x74, 0x04, 0x22, 0xE4, 0xFD, 0x7F, 0x0C, 0x12, 0x4B, 0xDB, - 0xE4, 0xFD, 0xFF, 0x02, 0x4F, 0x17, 0xF1, 0x60, 0xF1, 0x92, 0xF1, 0x2D, 0x90, 0x81, 0x86, 0x74, - 0x04, 0xF0, 0x22, 0x7D, 0x22, 0x7F, 0xFF, 0x12, 0x4F, 0x17, 0xF1, 0x2D, 0x90, 0x81, 0x85, 0x74, - 0x03, 0xF0, 0x22, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x32, 0xAA, 0x7F, 0x7C, 0x7E, 0x08, 0x02, 0x2D, - 0x5C, 0xF0, 0x7D, 0x04, 0x7F, 0x01, 0x02, 0x4E, 0x99, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, - 0x22, 0x90, 0x05, 0x27, 0xE0, 0x54, 0xBF, 0xF0, 0x22, 0x12, 0x4F, 0x87, 0x90, 0x81, 0x85, 0x74, - 0x03, 0xF0, 0x22, 0x7F, 0x70, 0x7E, 0x0E, 0x12, 0x2E, 0xA2, 0x90, 0x82, 0xAE, 0x22, 0x90, 0x81, - 0x85, 0xE0, 0x64, 0x02, 0x7F, 0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, 0x90, 0x82, 0x93, 0xEF, 0xF0, - 0xA3, 0xED, 0xF0, 0xA3, 0x12, 0x20, 0xDA, 0x00, 0x00, 0x00, 0x00, 0xE4, 0x90, 0x82, 0xA1, 0xF0, - 0x7F, 0x24, 0x7E, 0x08, 0x12, 0x2D, 0x5C, 0x90, 0x82, 0x99, 0x12, 0x20, 0xCE, 0x90, 0x82, 0x93, - 0xE0, 0xFB, 0x70, 0x08, 0x90, 0x82, 0x99, 0x12, 0x44, 0xF2, 0x80, 0x07, 0xEB, 0x12, 0x68, 0xB7, - 0x12, 0x2D, 0x5C, 0x90, 0x82, 0x9D, 0x12, 0x20, 0xCE, 0x90, 0x82, 0x94, 0x12, 0x59, 0x7E, 0x78, - 0x17, 0x31, 0x3B, 0xAA, 0x06, 0xAB, 0x07, 0x90, 0x82, 0x9D, 0x12, 0x44, 0xF2, 0xED, 0x54, 0x7F, - 0xFD, 0xEC, 0x54, 0x80, 0xFC, 0x12, 0x44, 0xD4, 0xEC, 0x44, 0x80, 0xFC, 0x90, 0x82, 0x9D, 0x12, - 0x20, 0xCE, 0x11, 0xCA, 0x54, 0x7F, 0x12, 0x67, 0x26, 0x11, 0xD2, 0x11, 0xB7, 0xC0, 0x06, 0xC0, - 0x07, 0x90, 0x82, 0x9D, 0x12, 0x44, 0xF2, 0x12, 0x67, 0x27, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x2E, - 0xA2, 0x11, 0xCA, 0x44, 0x80, 0x12, 0x67, 0x26, 0x11, 0xD2, 0x70, 0x04, 0x7F, 0x20, 0x80, 0x09, - 0x90, 0x82, 0x93, 0xE0, 0xB4, 0x01, 0x16, 0x7F, 0x28, 0x7E, 0x08, 0x12, 0x2D, 0x5C, 0x78, 0x08, - 0x12, 0x20, 0xA8, 0xEF, 0x54, 0x01, 0xFF, 0xE4, 0x90, 0x82, 0xA1, 0xEF, 0xF0, 0x90, 0x82, 0xA1, - 0xE0, 0x90, 0x82, 0x93, 0x60, 0x0E, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x66, 0xF5, 0x82, 0xE4, - 0x34, 0x87, 0x80, 0x0C, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x64, 0xF5, 0x82, 0xE4, 0x34, 0x87, - 0x11, 0xC2, 0x12, 0x2D, 0x5C, 0xED, 0x54, 0x0F, 0xFD, 0xE4, 0xFC, 0x90, 0x82, 0x95, 0x12, 0x20, - 0xCE, 0x90, 0x82, 0x95, 0x02, 0x44, 0xF2, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x62, 0xF5, 0x82, 0xE4, - 0x34, 0x87, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x90, 0x82, 0x99, 0x12, 0x44, 0xF2, - 0xEC, 0x22, 0x7F, 0x24, 0x7E, 0x08, 0x12, 0x2E, 0xA2, 0x90, 0x82, 0x93, 0xE0, 0x22, 0x90, 0x82, - 0xA2, 0xEF, 0xF0, 0xAB, 0x05, 0x90, 0x82, 0xA8, 0x12, 0x20, 0xDA, 0x00, 0x00, 0x00, 0x00, 0xAF, - 0x03, 0xE4, 0xFC, 0xFD, 0xFE, 0x78, 0x14, 0x31, 0x3B, 0xAA, 0x06, 0xAB, 0x07, 0x90, 0x82, 0xA4, - 0x12, 0x44, 0xF2, 0xED, 0x54, 0x0F, 0xFD, 0xE4, 0xFC, 0x12, 0x44, 0xD4, 0xEC, 0x54, 0x0F, 0xFC, - 0x90, 0x82, 0xA8, 0x12, 0x20, 0xCE, 0x90, 0x82, 0xA2, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x60, - 0xF5, 0x82, 0xE4, 0x34, 0x87, 0x11, 0xC2, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x82, 0xA8, 0x12, 0x44, - 0xF2, 0x12, 0x67, 0x27, 0xD0, 0x07, 0xD0, 0x06, 0x02, 0x2E, 0xA2, 0x12, 0x20, 0xBB, 0xA8, 0x04, - 0xA9, 0x05, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xC0, 0x07, 0xC0, 0x05, 0x90, 0x82, - 0xAE, 0x12, 0x44, 0xF2, 0x90, 0x82, 0xA4, 0x12, 0x20, 0xCE, 0xD0, 0x05, 0xD0, 0x07, 0x11, 0xDE, - 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x78, 0x10, 0x74, 0x01, 0xF2, 0x90, 0x02, 0x09, 0xE0, 0x78, 0x00, - 0xF2, 0x08, 0x74, 0x20, 0xF2, 0x18, 0xE2, 0xFF, 0x30, 0xE0, 0x05, 0x08, 0xE2, 0x24, 0x80, 0xF2, - 0xEF, 0xC3, 0x13, 0x90, 0xFD, 0x10, 0xF0, 0x78, 0x01, 0xE2, 0x71, 0x95, 0x78, 0x03, 0xF2, 0x64, - 0x04, 0x60, 0x0D, 0xE2, 0xFF, 0x64, 0x08, 0x60, 0x07, 0xEF, 0x64, 0x0C, 0x60, 0x02, 0x61, 0x8B, - 0xE4, 0x78, 0x02, 0xF2, 0x78, 0x03, 0xE2, 0xFF, 0x18, 0xE2, 0xC3, 0x9F, 0x50, 0x25, 0xE2, 0xFD, - 0x18, 0xE2, 0x2D, 0x90, 0x82, 0x11, 0xF0, 0xE0, 0xFF, 0x71, 0x95, 0xFE, 0x74, 0x04, 0x2D, 0xF8, - 0xEE, 0xF2, 0xEF, 0xB4, 0xFF, 0x06, 0x90, 0xFD, 0x10, 0xE0, 0x04, 0xF0, 0x78, 0x02, 0xE2, 0x04, - 0xF2, 0x80, 0xD1, 0x78, 0x04, 0xE2, 0x78, 0x12, 0xF2, 0xFF, 0x78, 0x05, 0xE2, 0x78, 0x11, 0xF2, - 0x78, 0x06, 0xE2, 0x78, 0x13, 0xF2, 0x78, 0x07, 0xE2, 0x78, 0x14, 0xF2, 0x78, 0x08, 0xE2, 0x78, - 0x33, 0xF2, 0x78, 0x09, 0xE2, 0x78, 0x34, 0xF2, 0x78, 0x0A, 0xE2, 0x78, 0x35, 0xF2, 0x78, 0x0B, - 0xE2, 0x78, 0x36, 0xF2, 0x78, 0x0C, 0xE2, 0x78, 0x37, 0xF2, 0x78, 0x0D, 0xE2, 0x78, 0x38, 0xF2, - 0x78, 0x0E, 0xE2, 0x78, 0x39, 0xF2, 0x78, 0x0F, 0xE2, 0x78, 0x3A, 0xF2, 0xE4, 0x78, 0x15, 0xF2, - 0xEF, 0x24, 0xF8, 0x60, 0x56, 0x24, 0xFC, 0x60, 0x4D, 0x24, 0x08, 0x60, 0x02, 0x61, 0x6D, 0x78, - 0x11, 0xE2, 0xB4, 0x01, 0x05, 0x12, 0x29, 0xC5, 0x61, 0x72, 0x78, 0x11, 0xE2, 0xB4, 0x02, 0x05, - 0x12, 0x11, 0xBD, 0x61, 0x72, 0x78, 0x11, 0xE2, 0xB4, 0x03, 0x05, 0x12, 0x59, 0x85, 0x61, 0x72, - 0x78, 0x11, 0xE2, 0xB4, 0x10, 0x07, 0x71, 0xA0, 0x12, 0x32, 0xAA, 0x61, 0x72, 0x78, 0x11, 0xE2, - 0xB4, 0x11, 0x07, 0x71, 0xA0, 0x12, 0x32, 0x06, 0x61, 0x72, 0x78, 0x11, 0xE2, 0xF4, 0x60, 0x02, - 0x61, 0x72, 0x18, 0xF2, 0x61, 0x72, 0x78, 0x15, 0x74, 0x01, 0xF2, 0x78, 0x11, 0xE2, 0x64, 0x07, - 0x60, 0x02, 0x61, 0x57, 0x78, 0x34, 0x71, 0x8E, 0x78, 0x08, 0x12, 0x20, 0xBB, 0xC0, 0x04, 0xA9, - 0x05, 0xAA, 0x06, 0xAB, 0x07, 0x78, 0x33, 0x71, 0x8E, 0xD0, 0x00, 0x12, 0x44, 0xD4, 0xC0, 0x04, - 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x78, 0x35, 0x71, 0x8E, 0x78, 0x10, 0x12, 0x20, 0xBB, 0xD0, - 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x44, 0xD4, 0x78, 0x18, 0x12, 0x45, 0x23, 0x78, - 0x15, 0xE2, 0x60, 0x7D, 0x18, 0xE2, 0xFF, 0x18, 0xE2, 0xFD, 0xB1, 0x1C, 0x78, 0x1C, 0x12, 0x45, - 0x23, 0x78, 0x38, 0x71, 0x8E, 0x78, 0x08, 0x12, 0x20, 0xBB, 0xC0, 0x04, 0xA9, 0x05, 0xAA, 0x06, - 0xAB, 0x07, 0x78, 0x37, 0x71, 0x8E, 0xD0, 0x00, 0x12, 0x44, 0xD4, 0xC0, 0x04, 0xC0, 0x05, 0xC0, - 0x06, 0xC0, 0x07, 0x78, 0x39, 0x71, 0x8E, 0x78, 0x10, 0x12, 0x20, 0xBB, 0xD0, 0x03, 0xD0, 0x02, - 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x44, 0xD4, 0x78, 0x20, 0x12, 0x45, 0x23, 0x78, 0x20, 0x12, 0x44, - 0xFE, 0x12, 0x20, 0x9B, 0x78, 0x1C, 0x12, 0x45, 0x16, 0x12, 0x44, 0xC7, 0xC0, 0x04, 0xC0, 0x05, - 0xC0, 0x06, 0xC0, 0x07, 0x78, 0x18, 0x12, 0x44, 0xFE, 0x78, 0x20, 0x12, 0x45, 0x16, 0x12, 0x44, - 0xC7, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x44, 0xD4, 0x78, 0x18, 0x12, 0x45, - 0x23, 0x78, 0x18, 0x12, 0x44, 0xFE, 0x90, 0x82, 0xAE, 0x12, 0x20, 0xCE, 0x78, 0x13, 0xE2, 0xFD, - 0x08, 0xE2, 0xFF, 0x31, 0x43, 0x80, 0x1B, 0x78, 0x13, 0xE2, 0xFF, 0x08, 0xE2, 0xFD, 0x78, 0x11, - 0xE2, 0xFB, 0x78, 0x15, 0xE2, 0x90, 0x82, 0x73, 0xF0, 0x71, 0xB3, 0x80, 0x05, 0x78, 0x10, 0x74, - 0x02, 0xF2, 0x78, 0x10, 0xE2, 0xFF, 0xC3, 0x94, 0x02, 0x50, 0x10, 0xEF, 0x60, 0x0A, 0x78, 0x02, - 0xE2, 0xFF, 0x18, 0xE2, 0x2F, 0xF2, 0x21, 0x87, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, 0xE2, 0xFF, - 0xE4, 0xFC, 0xFD, 0xFE, 0x22, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, - 0x78, 0x14, 0xE2, 0xFE, 0x18, 0xE2, 0xFD, 0xED, 0xFF, 0x78, 0x16, 0xEE, 0xF2, 0xFE, 0x08, 0xEF, - 0xF2, 0xFF, 0x22, 0xAC, 0x07, 0xED, 0xAD, 0x04, 0x78, 0x24, 0xF2, 0xED, 0x08, 0xF2, 0xEB, 0xB4, - 0x04, 0x07, 0x78, 0x27, 0x74, 0x01, 0xF2, 0x80, 0x0E, 0xEB, 0x78, 0x27, 0xB4, 0x05, 0x05, 0x74, - 0x02, 0xF2, 0x80, 0x03, 0x74, 0x04, 0xF2, 0x91, 0xF5, 0xE2, 0x94, 0x00, 0x50, 0x45, 0xE4, 0x78, - 0x26, 0xF2, 0x91, 0xCF, 0x9F, 0x40, 0x02, 0x81, 0xCE, 0x91, 0xD8, 0x60, 0x1F, 0x74, 0x37, 0x2E, - 0xF8, 0xE2, 0x78, 0x32, 0xF2, 0xEE, 0xFF, 0x78, 0x25, 0xE2, 0x2F, 0xFF, 0x18, 0xE2, 0x34, 0x00, - 0x8F, 0x82, 0xF5, 0x83, 0xE0, 0x78, 0x29, 0xF2, 0x78, 0x32, 0xB1, 0x0B, 0x78, 0x24, 0x08, 0xE2, - 0xFF, 0x08, 0xE2, 0x2F, 0xFF, 0x78, 0x28, 0xE2, 0xFD, 0x12, 0x32, 0x1E, 0x78, 0x26, 0xE2, 0x04, - 0xF2, 0x80, 0xBF, 0x91, 0xF5, 0xE2, 0x94, 0x07, 0x50, 0x30, 0xE4, 0x78, 0x26, 0xF2, 0x91, 0xCF, - 0x9F, 0x40, 0x02, 0x81, 0xCE, 0x91, 0xD8, 0x60, 0x14, 0x78, 0x26, 0xE2, 0xFF, 0x91, 0xFD, 0xE0, - 0x78, 0x29, 0xF2, 0x74, 0x37, 0x2F, 0xF8, 0xE2, 0x78, 0x32, 0xF2, 0xB1, 0x0B, 0x91, 0xED, 0x91, - 0xFD, 0xEF, 0xF0, 0x78, 0x26, 0xE2, 0x04, 0xF2, 0x80, 0xD4, 0x90, 0x82, 0x73, 0xE0, 0x60, 0x0A, - 0x91, 0xE5, 0x12, 0x2D, 0x5C, 0x78, 0x2E, 0x12, 0x45, 0x23, 0xE4, 0x78, 0x26, 0xF2, 0x91, 0xCF, - 0x9F, 0x50, 0x4E, 0x91, 0xD8, 0x60, 0x2B, 0x78, 0x2E, 0x12, 0x44, 0xFE, 0x78, 0x26, 0xE2, 0xFB, - 0x75, 0xF0, 0x08, 0xA4, 0xF9, 0xF8, 0x12, 0x20, 0xA8, 0x78, 0x29, 0xEF, 0xF2, 0x74, 0x37, 0x2B, - 0xF8, 0xE2, 0x78, 0x32, 0xF2, 0xE2, 0xFE, 0xF4, 0x5F, 0xFF, 0x78, 0x28, 0xE2, 0xFD, 0xEE, 0x5D, - 0x4F, 0xF2, 0x91, 0xED, 0xFD, 0xC3, 0x74, 0x03, 0x9D, 0xFD, 0xE4, 0x94, 0x00, 0xFC, 0x7B, 0xFE, - 0x74, 0x2A, 0x2D, 0xF9, 0x74, 0x80, 0x3C, 0xFA, 0xEF, 0x12, 0x1F, 0xEA, 0xE2, 0x04, 0xF2, 0x80, - 0xAD, 0x78, 0x2A, 0x12, 0x44, 0xFE, 0x12, 0x67, 0x27, 0x91, 0xE5, 0x12, 0x2E, 0xA2, 0x22, 0x78, - 0x27, 0xE2, 0xFF, 0x18, 0xE2, 0xFE, 0xC3, 0x22, 0x74, 0x33, 0x2E, 0xF8, 0xE2, 0x78, 0x28, 0xF2, - 0x90, 0x82, 0x73, 0xE0, 0x22, 0x78, 0x24, 0xE2, 0xFE, 0x08, 0xE2, 0xFF, 0x22, 0x78, 0x28, 0xE2, - 0xFF, 0x78, 0x26, 0xE2, 0x22, 0xD3, 0x78, 0x25, 0xE2, 0x94, 0xFF, 0x18, 0x22, 0xFD, 0x18, 0xE2, - 0x2D, 0xFD, 0x18, 0xE2, 0x34, 0x00, 0x8D, 0x82, 0xF5, 0x83, 0x22, 0xE2, 0xFF, 0xF4, 0xFE, 0x78, - 0x29, 0xE2, 0x5E, 0xFE, 0x18, 0xE2, 0xFD, 0xEF, 0x5D, 0x4E, 0xF2, 0x22, 0xD3, 0x10, 0xAF, 0x01, - 0xC3, 0xC0, 0xD0, 0x12, 0x67, 0xCB, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, - 0xC0, 0xD0, 0x12, 0x2D, 0xA7, 0xE4, 0xF5, 0x51, 0x12, 0x32, 0x9E, 0xEF, 0x60, 0x72, 0x63, 0x51, - 0x01, 0xE5, 0x51, 0x24, 0x2B, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x6D, 0xA3, 0xF0, 0x90, 0x00, 0x88, - 0xE0, 0xF5, 0x4F, 0xF5, 0x50, 0x54, 0x0F, 0x60, 0xDF, 0xE5, 0x4F, 0x30, 0xE0, 0x0B, 0x20, 0xE4, - 0x03, 0x12, 0x29, 0xC5, 0x53, 0x50, 0xEE, 0x80, 0x3E, 0xE5, 0x4F, 0x30, 0xE1, 0x16, 0x20, 0xE5, - 0x0E, 0x12, 0x11, 0xBD, 0xEF, 0x70, 0x03, 0x43, 0x50, 0x20, 0x90, 0x01, 0x06, 0xE4, 0xF0, 0x53, - 0x50, 0xFD, 0x80, 0x23, 0xE5, 0x4F, 0x30, 0xE2, 0x0B, 0x20, 0xE6, 0x03, 0x12, 0x59, 0x85, 0x53, - 0x50, 0xFB, 0x80, 0x13, 0xE5, 0x4F, 0x30, 0xE3, 0x0E, 0x20, 0xE7, 0x08, 0x31, 0x65, 0xEF, 0x70, - 0x03, 0x43, 0x50, 0x80, 0x53, 0x50, 0xF7, 0xAD, 0x50, 0x7F, 0x88, 0x12, 0x32, 0x1E, 0x80, 0x88, - 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x1F, 0xA4, 0xFF, 0x90, 0x81, 0x78, 0xF0, 0xBF, 0x01, 0x07, - 0xB1, 0xC8, 0xE4, 0x90, 0x81, 0x78, 0xF0, 0x22, 0x7B, 0x01, 0x7A, 0x82, 0x79, 0x79, 0x7F, 0xF5, - 0x7E, 0x00, 0x12, 0x2B, 0x27, 0xBF, 0x01, 0x06, 0x90, 0x82, 0x79, 0xE0, 0xA3, 0xF0, 0x7B, 0x01, - 0x7A, 0x82, 0x79, 0x79, 0x7F, 0xF6, 0x7E, 0x00, 0x12, 0x2B, 0x27, 0xBF, 0x01, 0x08, 0x90, 0x82, - 0x79, 0xE0, 0x90, 0x82, 0x7B, 0xF0, 0x7B, 0x01, 0x7A, 0x82, 0x79, 0x79, 0x7F, 0xF4, 0x7E, 0x00, - 0x12, 0x2B, 0x27, 0xBF, 0x01, 0x08, 0x90, 0x82, 0x79, 0xE0, 0x90, 0x82, 0x7C, 0xF0, 0x7B, 0x01, - 0x7A, 0x82, 0x79, 0x79, 0x7F, 0xF3, 0x7E, 0x00, 0x12, 0x2B, 0x27, 0xBF, 0x01, 0x08, 0x90, 0x82, - 0x79, 0xE0, 0x90, 0x82, 0x7D, 0xF0, 0x7B, 0x01, 0x7A, 0x82, 0x79, 0x79, 0x7F, 0xF2, 0x7E, 0x00, - 0x12, 0x2B, 0x27, 0xBF, 0x01, 0x08, 0x90, 0x82, 0x79, 0xE0, 0x90, 0x82, 0x7E, 0xF0, 0x90, 0x82, - 0x7A, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, 0x82, 0x82, 0xF0, 0x90, - 0x82, 0x7E, 0xE0, 0x90, 0x82, 0x83, 0xF0, 0x02, 0x62, 0xAE, 0x12, 0x1F, 0xA4, 0x54, 0x01, 0xFF, - 0x90, 0x81, 0xFE, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x22, 0x12, 0x1F, 0xA4, 0x90, 0x81, 0xEF, 0xF0, - 0x22, 0x12, 0x1F, 0xA4, 0x90, 0x81, 0xFC, 0x12, 0x53, 0x90, 0x90, 0x81, 0xFD, 0xF0, 0x22, 0xE4, - 0x90, 0x81, 0x74, 0xF0, 0xA3, 0xF0, 0x90, 0x80, 0xDC, 0xF0, 0xA3, 0xF0, 0x22, 0x75, 0x3D, 0x10, - 0xE4, 0xF5, 0x3E, 0x75, 0x3F, 0x07, 0x75, 0x40, 0x02, 0x90, 0x01, 0x30, 0xE5, 0x3D, 0xF0, 0xA3, - 0xE5, 0x3E, 0xF0, 0xA3, 0xE5, 0x3F, 0xF0, 0xA3, 0xE5, 0x40, 0xF0, 0x22, 0x75, 0x45, 0x06, 0x75, - 0x46, 0x01, 0x43, 0x46, 0x10, 0x75, 0x47, 0x03, 0x75, 0x48, 0x62, 0x90, 0x01, 0x38, 0xE5, 0x45, - 0xF0, 0xA3, 0xE5, 0x46, 0xF0, 0xA3, 0xE5, 0x47, 0xF0, 0xA3, 0xE5, 0x48, 0xF0, 0x22, 0x90, 0x01, - 0x94, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x01, 0xC7, 0xE4, 0xF0, 0x22, 0x90, 0x01, 0x01, 0xE0, 0x44, - 0x04, 0xF0, 0x90, 0x01, 0x9C, 0x74, 0x7E, 0xF0, 0xA3, 0x74, 0x92, 0xF0, 0xA3, 0x74, 0xA0, 0xF0, - 0xA3, 0x74, 0x24, 0xF0, 0x90, 0x01, 0x9B, 0x74, 0x49, 0xF0, 0x90, 0x01, 0x9A, 0x74, 0xE0, 0xF0, - 0x90, 0x01, 0x99, 0xE4, 0xF0, 0x90, 0x01, 0x98, 0x04, 0xF0, 0x22, 0x7F, 0x02, 0x90, 0x81, 0xFB, - 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x18, 0xEF, 0x25, 0xE0, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE4, - 0x0B, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0xA3, 0xF0, 0x7F, 0x00, 0x22, 0x0F, 0x80, 0xDE, 0x7F, - 0x01, 0x22, 0x90, 0x01, 0xE4, 0x74, 0x17, 0xF0, 0xA3, 0xE4, 0xF0, 0x22, 0x90, 0x01, 0x34, 0xE0, - 0x55, 0x3D, 0xF5, 0x41, 0xA3, 0xE0, 0x55, 0x3E, 0xF5, 0x42, 0xA3, 0xE0, 0x55, 0x3F, 0xF5, 0x43, - 0xA3, 0xE0, 0x55, 0x40, 0xF5, 0x44, 0x90, 0x01, 0x34, 0xE5, 0x41, 0xF0, 0xA3, 0xE5, 0x42, 0xF0, - 0xA3, 0xE5, 0x43, 0xF0, 0xA3, 0xE5, 0x44, 0xF0, 0x22, 0x90, 0x01, 0x3C, 0xE0, 0x55, 0x45, 0xF5, - 0x49, 0xA3, 0xE0, 0x55, 0x46, 0xF5, 0x4A, 0xA3, 0xE0, 0x55, 0x47, 0xF5, 0x4B, 0xA3, 0xE0, 0x55, - 0x48, 0xF5, 0x4C, 0x90, 0x01, 0x3C, 0xE5, 0x49, 0xF0, 0xA3, 0xE5, 0x4A, 0xF0, 0xA3, 0xE5, 0x4B, - 0xF0, 0xA3, 0xE5, 0x4C, 0xF0, 0x53, 0x91, 0xDF, 0x22, 0x90, 0x01, 0xCF, 0xE0, 0x90, 0x82, 0xD9, - 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, 0x52, 0x85, 0x90, 0x00, 0x03, 0xE0, 0x54, 0xFB, 0xFD, 0x7F, 0x03, 0x12, - 0x32, 0x1E, 0x80, 0xFE, 0x22, 0x90, 0x81, 0x82, 0xE0, 0x30, 0xE0, 0x05, 0xE4, 0xA3, 0xF0, 0xA3, - 0xF0, 0x22, 0x90, 0x81, 0xFD, 0xE0, 0x60, 0x0F, 0xE4, 0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, 0x02, - 0xF0, 0x90, 0x05, 0xFC, 0xE0, 0x04, 0xF0, 0x90, 0x81, 0x82, 0xE0, 0x30, 0xE0, 0x10, 0xA3, 0x74, - 0x01, 0xF0, 0x90, 0x81, 0x82, 0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x02, 0x11, 0xBC, 0x12, 0x5C, - 0x6B, 0x90, 0x81, 0xF0, 0xE0, 0x30, 0xE0, 0x13, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x12, 0x4F, 0x12, - 0x11, 0x2C, 0x30, 0xE0, 0x03, 0x12, 0x4E, 0x95, 0x11, 0xA7, 0xF0, 0x22, 0x90, 0x81, 0xF0, 0xE0, - 0xC3, 0x13, 0x22, 0x90, 0x81, 0xF0, 0xE0, 0xFF, 0x30, 0xE0, 0x39, 0x90, 0x80, 0x42, 0xE0, 0x64, - 0x01, 0x70, 0x2A, 0xEF, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x29, 0x90, 0x82, 0xDC, 0xE0, 0x04, - 0xF0, 0xE0, 0xD3, 0x94, 0xC8, 0x40, 0x1D, 0x90, 0x81, 0xF0, 0xE0, 0x44, 0x20, 0xF0, 0xE4, 0x90, - 0x82, 0xDC, 0xF0, 0x90, 0x81, 0xF0, 0xE0, 0x13, 0x30, 0xE0, 0x09, 0x80, 0x05, 0x11, 0x2C, 0x30, - 0xE0, 0x02, 0x11, 0xAE, 0x22, 0x90, 0x81, 0xF0, 0xE0, 0x30, 0xE0, 0x0C, 0xE4, 0xF5, 0x1D, 0x90, - 0x81, 0xF2, 0x12, 0x56, 0x8C, 0x11, 0xA7, 0xF0, 0x90, 0x80, 0x42, 0xE0, 0xB4, 0x01, 0x15, 0x90, - 0x81, 0xF0, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x20, 0xE0, 0x0C, 0xEF, 0xC4, 0x13, 0x54, 0x07, 0x20, - 0xE0, 0x04, 0x80, 0x00, 0x11, 0x33, 0x22, 0x90, 0x81, 0xF0, 0xE0, 0x44, 0x04, 0x22, 0x90, 0x81, - 0x87, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x81, 0x97, 0x74, 0xD0, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, - 0xC3, 0xC0, 0xD0, 0x12, 0x58, 0xC2, 0xBF, 0x01, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x02, 0x12, - 0x65, 0xE7, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x81, 0x82, 0xE0, 0xFF, 0x30, 0xE0, 0x3D, 0x90, - 0x81, 0x86, 0xE0, 0x7E, 0x00, 0xB4, 0x02, 0x02, 0x7E, 0x01, 0x90, 0x81, 0x85, 0xE0, 0x7D, 0x00, - 0xB4, 0x04, 0x02, 0x7D, 0x01, 0xED, 0x4E, 0x70, 0x23, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x02, 0x80, - 0xBB, 0x31, 0x1D, 0x90, 0x81, 0x86, 0xE0, 0xB4, 0x08, 0x06, 0xE4, 0xFD, 0x7F, 0x0C, 0x80, 0x09, - 0x90, 0x81, 0x86, 0xE0, 0x70, 0x06, 0xFD, 0x7F, 0x04, 0x12, 0x4B, 0xDB, 0x22, 0x31, 0x3B, 0x30, - 0xE0, 0x0B, 0x31, 0x34, 0x60, 0x07, 0x7D, 0x01, 0x7F, 0x02, 0x12, 0x4B, 0xDB, 0x31, 0x34, 0x60, - 0x02, 0x31, 0x46, 0x22, 0x90, 0x81, 0x86, 0xE0, 0x64, 0x02, 0x22, 0x90, 0x81, 0x82, 0xE0, 0xFF, - 0xC4, 0x13, 0x13, 0x54, 0x03, 0x22, 0x90, 0x81, 0x8C, 0xE0, 0x64, 0x02, 0x60, 0x10, 0x12, 0x55, - 0xDB, 0x60, 0x0B, 0xF1, 0x3E, 0xEF, 0x70, 0x06, 0xFD, 0x7F, 0x0C, 0x12, 0x4B, 0xDB, 0x22, 0x90, - 0x81, 0x8C, 0xE0, 0x70, 0x07, 0x90, 0x81, 0x82, 0xE0, 0x30, 0xE0, 0x11, 0x90, 0x81, 0x82, 0xE0, - 0x30, 0xE0, 0x08, 0x12, 0x58, 0xC2, 0xBF, 0x01, 0x04, 0x80, 0xCB, 0xF1, 0x5F, 0x22, 0x90, 0x81, - 0x87, 0x31, 0x3E, 0x30, 0xE0, 0x1F, 0xEF, 0x54, 0xBF, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0x81, - 0x88, 0x30, 0xE0, 0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x08, 0xE0, 0x54, 0xFE, 0x91, 0x2C, 0x74, - 0x04, 0xF0, 0x12, 0x58, 0x62, 0x22, 0x90, 0x81, 0x82, 0xE0, 0xFF, 0x30, 0xE0, 0x3E, 0x90, 0x81, - 0x86, 0xE0, 0x7E, 0x00, 0xB4, 0x02, 0x02, 0x7E, 0x01, 0x90, 0x81, 0x85, 0xE0, 0x7D, 0x00, 0xB4, - 0x04, 0x02, 0x7D, 0x01, 0xED, 0x4E, 0x70, 0x24, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x02, 0x01, 0xBC, - 0x31, 0xED, 0x90, 0x81, 0x86, 0xE0, 0xB4, 0x0C, 0x06, 0xE4, 0xFD, 0x7F, 0x08, 0x80, 0x0A, 0x90, - 0x81, 0x86, 0xE0, 0xB4, 0x04, 0x06, 0xE4, 0xFD, 0xFF, 0x12, 0x4B, 0xDB, 0x22, 0x90, 0x01, 0x57, - 0xE0, 0x60, 0x1C, 0x12, 0x47, 0xCB, 0xF0, 0x51, 0xBE, 0x54, 0x3F, 0x30, 0xE0, 0x02, 0x41, 0xD1, - 0x51, 0xA5, 0x40, 0x0B, 0xE4, 0xFF, 0x12, 0x47, 0xA5, 0xBF, 0x01, 0x03, 0x51, 0x10, 0xF0, 0x22, - 0x90, 0x81, 0x88, 0xE0, 0x54, 0xFB, 0x22, 0x51, 0xC6, 0x30, 0xE0, 0x0B, 0xEF, 0xC4, 0x13, 0x13, - 0x54, 0x03, 0x30, 0xE0, 0x02, 0xD1, 0xFA, 0x51, 0xBE, 0x54, 0x3F, 0x30, 0xE0, 0x08, 0x51, 0xD1, - 0x54, 0x07, 0x70, 0x3A, 0x80, 0x35, 0x51, 0xA5, 0x40, 0x31, 0x12, 0x47, 0x81, 0x70, 0x2F, 0x12, - 0x55, 0xDB, 0x70, 0x06, 0x51, 0x6F, 0x51, 0x10, 0xF0, 0x22, 0x51, 0x6F, 0x90, 0x81, 0x96, 0xE0, - 0x04, 0xF0, 0xE0, 0xD3, 0x94, 0x02, 0x40, 0x0A, 0x51, 0x10, 0xF0, 0xE4, 0x90, 0x81, 0x96, 0xF0, - 0x80, 0x03, 0x12, 0x57, 0x40, 0xE4, 0x90, 0x81, 0x95, 0xF0, 0x22, 0x12, 0x58, 0x62, 0x22, 0x51, - 0xB2, 0x40, 0x31, 0x90, 0x81, 0xA6, 0xE0, 0x04, 0xF0, 0x90, 0x81, 0xE8, 0xE0, 0xFF, 0x90, 0x81, - 0xA6, 0xE0, 0xD3, 0x9F, 0x50, 0x1E, 0x90, 0x81, 0x9E, 0xE0, 0x04, 0xF0, 0x12, 0x5E, 0xB3, 0x90, - 0x81, 0xA5, 0xF0, 0xFB, 0x90, 0x81, 0x9E, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x82, 0xCA, 0x74, - 0x04, 0xF0, 0x51, 0xDD, 0x22, 0x90, 0x81, 0x95, 0xE0, 0x04, 0xF0, 0x90, 0x81, 0x90, 0xE0, 0x54, - 0xEF, 0xF0, 0x90, 0x81, 0xE9, 0xE0, 0xFF, 0x90, 0x81, 0x95, 0xE0, 0xD3, 0x9F, 0x22, 0x90, 0x81, - 0x87, 0xE0, 0xFF, 0x13, 0x13, 0x22, 0x90, 0x81, 0x88, 0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, - 0x22, 0xEF, 0x54, 0xFB, 0xF0, 0x90, 0x81, 0x90, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0xD3, 0x10, 0xAF, - 0x01, 0xC3, 0xC0, 0xD0, 0xAC, 0x07, 0x90, 0x81, 0x88, 0xE0, 0x71, 0xF6, 0x30, 0xE0, 0x02, 0x61, - 0x96, 0x90, 0x81, 0x87, 0xE0, 0x30, 0xE0, 0x16, 0x90, 0x81, 0xA9, 0xE0, 0x24, 0x04, 0x90, 0x81, - 0xA1, 0xF0, 0x90, 0x81, 0xA9, 0xE0, 0x24, 0x03, 0x90, 0x81, 0xA0, 0xF0, 0x80, 0x0D, 0x90, 0x81, - 0xA1, 0x74, 0x02, 0xF0, 0x90, 0x81, 0xA0, 0x14, 0xF0, 0x0B, 0x0B, 0x90, 0x81, 0xA0, 0xE0, 0xFA, - 0x90, 0x81, 0x9F, 0xE0, 0xD3, 0x9A, 0x50, 0x0E, 0x90, 0x81, 0x94, 0xEB, 0xF0, 0x90, 0x81, 0xA1, - 0xE0, 0xC3, 0x9D, 0x2C, 0x80, 0x11, 0xC3, 0xED, 0x9A, 0x2B, 0x90, 0x81, 0x94, 0xF0, 0x90, 0x81, - 0xA0, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, 0x81, 0xA4, 0xF0, 0x90, 0x81, 0xA1, 0xE0, 0xFF, - 0x24, 0x0A, 0xFD, 0xE4, 0x33, 0xFC, 0x90, 0x81, 0xA4, 0x71, 0xA2, 0x40, 0x04, 0xEF, 0x24, 0x0A, - 0xF0, 0x90, 0x81, 0xA4, 0xE0, 0xFF, 0x24, 0x23, 0xFD, 0xE4, 0x33, 0xFC, 0x90, 0x81, 0x94, 0x71, - 0xA2, 0x40, 0x04, 0xEF, 0x24, 0x23, 0xF0, 0x90, 0x81, 0xA4, 0xE0, 0xFF, 0x7E, 0x00, 0x90, 0x81, - 0x98, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x05, 0x58, 0xE0, 0x6F, 0x70, 0x01, 0xE4, 0x60, 0x02, - 0xF1, 0x0A, 0xF1, 0x01, 0x80, 0x07, 0x90, 0x81, 0x89, 0xE0, 0x44, 0x01, 0xF0, 0xD0, 0xD0, 0x92, - 0xAF, 0x22, 0xE0, 0xD3, 0x9D, 0xEC, 0x64, 0x80, 0xF8, 0x74, 0x80, 0x98, 0x22, 0xF1, 0xBB, 0x90, - 0x82, 0x04, 0xEF, 0xF0, 0x30, 0xE0, 0x05, 0x7D, 0x01, 0xE4, 0x80, 0x02, 0xE4, 0xFD, 0xFF, 0x12, - 0x4E, 0x99, 0x90, 0x82, 0x04, 0xE0, 0x30, 0xE6, 0x11, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x04, - 0xE4, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x80, 0xF0, 0x90, 0x81, 0x87, 0xE0, 0x90, 0x04, - 0xEC, 0x30, 0xE0, 0x06, 0xE0, 0x54, 0xDD, 0xF0, 0x80, 0x04, 0xE0, 0x44, 0x22, 0xF0, 0x12, 0x5F, - 0xAD, 0x74, 0x02, 0xF0, 0x41, 0xDD, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x22, 0x90, 0x81, 0x87, - 0xE0, 0xFF, 0x71, 0xF6, 0x30, 0xE0, 0x24, 0xEF, 0x54, 0x7F, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, - 0x81, 0x88, 0x30, 0xE1, 0x06, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x07, 0xE0, 0x54, 0xFD, 0x91, 0x2C, - 0x04, 0xF0, 0x90, 0x81, 0x8C, 0xE0, 0x60, 0x03, 0x12, 0x58, 0x62, 0x22, 0xF0, 0x90, 0x01, 0xB9, - 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x22, 0xEF, 0x60, 0x34, 0x12, 0x47, 0x81, 0x70, 0x2F, 0x90, - 0x81, 0x88, 0xE0, 0x54, 0xFE, 0xF0, 0x7D, 0x2B, 0x7F, 0x0F, 0x12, 0x4F, 0x17, 0x90, 0x06, 0x04, - 0xE0, 0x54, 0xBF, 0xF0, 0x91, 0x6F, 0xBF, 0x01, 0x10, 0x90, 0x81, 0x87, 0xE0, 0x44, 0x40, 0xF0, - 0x7D, 0x06, 0x12, 0x4F, 0xF1, 0x74, 0x06, 0xF0, 0x22, 0x91, 0x2D, 0x74, 0x08, 0xF0, 0x22, 0x7D, - 0x08, 0xE4, 0xFF, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x82, 0xB2, 0xEF, 0xF0, 0xA3, - 0xED, 0xF0, 0x90, 0x80, 0x3E, 0xE0, 0x04, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x27, 0x90, 0x05, - 0x22, 0xE0, 0x90, 0x82, 0xB6, 0xF0, 0x7D, 0x26, 0x12, 0x65, 0x02, 0xEF, 0x64, 0x01, 0x70, 0x02, - 0xB1, 0x9A, 0x90, 0x82, 0xB6, 0xE0, 0xFF, 0x7D, 0x27, 0x12, 0x4F, 0x17, 0x90, 0x82, 0xB2, 0xE0, - 0xFF, 0xD1, 0x9F, 0x80, 0x09, 0x90, 0x82, 0xB2, 0xE0, 0xFF, 0xD1, 0x9F, 0xB1, 0x9A, 0x90, 0x04, - 0x1F, 0x74, 0x20, 0xF0, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x80, 0x88, 0xE0, 0xFF, - 0x90, 0x82, 0xBE, 0x74, 0x0B, 0xF0, 0x7B, 0x08, 0x7D, 0x01, 0xB1, 0x07, 0x90, 0x82, 0xCC, 0xEE, - 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0x82, 0xCB, 0xE0, 0xFF, 0xD1, 0x42, 0x54, 0x3F, 0xF0, - 0xEF, 0x60, 0x0A, 0xD1, 0x35, 0x44, 0x10, 0xD1, 0x41, 0x44, 0x80, 0xF0, 0x22, 0xD1, 0x35, 0x54, - 0xEF, 0xD1, 0x41, 0x44, 0x40, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x82, - 0xBC, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x82, 0xBB, 0xEF, 0xF0, 0xE4, 0xFD, 0xFC, 0xF1, 0x2A, - 0x7C, 0x00, 0xAD, 0x07, 0x90, 0x82, 0xBB, 0xE0, 0x90, 0x04, 0x25, 0xF0, 0x90, 0x82, 0xBC, 0xE0, - 0x60, 0x0E, 0x74, 0x0F, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, - 0xAF, 0x05, 0x74, 0x08, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x09, - 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xF0, 0xF0, 0xAF, 0x05, 0xD1, 0x2A, - 0xE0, 0x54, 0x01, 0xFE, 0x90, 0x82, 0xBD, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0xFB, 0xEE, 0x44, 0x02, - 0x4B, 0xFE, 0xD1, 0x2A, 0xEE, 0xF0, 0x90, 0x82, 0xBE, 0xE0, 0xFF, 0xAE, 0x05, 0x74, 0x1E, 0x2E, - 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x21, 0x2E, 0xD1, 0x38, 0x54, 0xF7, - 0xF0, 0xAE, 0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x80, 0x87, 0xE0, 0xFF, 0x90, - 0x82, 0xB3, 0xE0, 0xFB, 0x90, 0x82, 0xBE, 0x74, 0x0A, 0xF0, 0x7D, 0x01, 0xB1, 0x07, 0x90, 0x82, - 0xB4, 0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0x82, 0xB2, 0xE0, 0xFF, 0x91, 0xEB, 0x90, - 0x82, 0xB4, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x04, 0x80, 0xE0, 0x54, 0x0F, 0xFD, 0xAC, 0x07, - 0xD1, 0x93, 0x44, 0x01, 0xF0, 0xD1, 0x93, 0x54, 0xFB, 0xF0, 0xAC, 0x07, 0x74, 0x16, 0x2C, 0xD1, - 0x2D, 0xE0, 0x44, 0xFA, 0xF0, 0x74, 0x15, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, - 0x44, 0x1F, 0xF0, 0xAC, 0x07, 0x74, 0x06, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, - 0x44, 0x0F, 0xF0, 0x90, 0x04, 0x53, 0xE4, 0xF0, 0x90, 0x04, 0x52, 0xF0, 0x90, 0x04, 0x51, 0x74, - 0xFF, 0xF0, 0x90, 0x04, 0x50, 0x74, 0xFD, 0xF0, 0x74, 0x14, 0x2C, 0xD1, 0x8B, 0xE0, 0x54, 0xC0, - 0x4D, 0xFD, 0x74, 0x14, 0x2F, 0xD1, 0x8B, 0xED, 0xF0, 0x22, 0x74, 0x16, 0x2F, 0xF5, 0x82, 0xE4, - 0x34, 0xFC, 0xF5, 0x83, 0x22, 0x74, 0x21, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, - 0x22, 0xF0, 0x74, 0x1F, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xD3, 0x10, - 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x82, 0xCB, 0xEF, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x1E, - 0x90, 0x05, 0x22, 0xE0, 0x90, 0x82, 0xCE, 0xF0, 0x7D, 0x29, 0x12, 0x65, 0x02, 0xBF, 0x01, 0x02, - 0x91, 0xCB, 0x90, 0x82, 0xCE, 0xE0, 0xFF, 0x7D, 0x2A, 0x12, 0x4F, 0x17, 0x80, 0x02, 0x91, 0xCB, - 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, - 0xF5, 0x83, 0x22, 0x74, 0x11, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xD3, - 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x82, 0xDD, 0xEF, 0xF0, 0x90, 0x80, 0x87, 0xE0, 0xFF, - 0x90, 0x04, 0x1C, 0xE0, 0x6F, 0x70, 0x3E, 0x90, 0x81, 0x8F, 0xE0, 0x64, 0x0E, 0x70, 0x15, 0x90, - 0x82, 0xDD, 0xE0, 0x70, 0x30, 0x90, 0x81, 0x87, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x06, 0x04, 0x12, - 0x4E, 0x91, 0x80, 0x1E, 0x90, 0x81, 0x8F, 0xE0, 0x64, 0x06, 0x70, 0x19, 0x90, 0x82, 0xDD, 0xE0, - 0x60, 0x13, 0x90, 0x81, 0x87, 0xE0, 0x54, 0xBF, 0xF0, 0xF1, 0x14, 0xF0, 0x90, 0x81, 0x8F, 0x74, - 0x04, 0xF0, 0x12, 0x67, 0x60, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x02, 0x4A, - 0x47, 0x90, 0x81, 0x89, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0xF0, 0x90, 0x81, 0x98, 0xA3, 0xE0, 0x90, - 0x05, 0x58, 0xF0, 0x22, 0x90, 0x06, 0x04, 0xE0, 0x44, 0x40, 0xF0, 0xE0, 0x44, 0x80, 0x22, 0x90, - 0x81, 0x8C, 0xE0, 0x60, 0x02, 0x51, 0x17, 0x02, 0x4F, 0x2D, 0xE4, 0xFE, 0xEF, 0xC3, 0x13, 0xFD, - 0xEF, 0x30, 0xE0, 0x02, 0x7E, 0x80, 0x90, 0xFD, 0x10, 0xED, 0xF0, 0xAF, 0x06, 0x22, 0x90, 0x04, - 0x1A, 0xE0, 0xF4, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x90, 0x04, 0x1B, 0xE0, 0x54, 0x07, 0x64, 0x07, - 0x7F, 0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, 0xF1, 0x3E, 0xEF, 0x70, 0x02, 0xF1, 0x5F, 0x22, 0x90, - 0x81, 0x8C, 0xE0, 0x64, 0x01, 0x70, 0x14, 0x12, 0x55, 0xDB, 0x60, 0x06, 0x12, 0x67, 0x59, 0x02, - 0x57, 0x91, 0x90, 0x81, 0x8F, 0xE0, 0x70, 0x03, 0x12, 0x4B, 0xD7, 0x22, 0x90, 0x81, 0x82, 0xE0, - 0xFF, 0x30, 0xE0, 0x04, 0x31, 0x34, 0x60, 0x1B, 0x90, 0x81, 0x8C, 0xE0, 0x70, 0x04, 0xEF, 0x30, - 0xE0, 0x0B, 0x90, 0x81, 0x8F, 0xE0, 0x64, 0x02, 0x60, 0x09, 0x12, 0x49, 0x31, 0x90, 0x01, 0xE6, - 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x81, 0xFC, 0xE0, 0x60, 0x0F, 0xE4, 0xF0, 0x90, 0x05, 0x53, 0xE0, - 0x44, 0x01, 0xF0, 0x90, 0x05, 0xFD, 0xE0, 0x04, 0xF0, 0x22, 0x22, 0xE4, 0x90, 0x82, 0x06, 0xF0, - 0xA3, 0xF0, 0x90, 0x00, 0x83, 0xE0, 0x90, 0x82, 0x05, 0xF0, 0x90, 0x00, 0x83, 0xE0, 0xFE, 0x90, - 0x82, 0x05, 0xE0, 0xFF, 0xB5, 0x06, 0x01, 0x22, 0xC3, 0x90, 0x82, 0x07, 0xE0, 0x94, 0x64, 0x90, - 0x82, 0x06, 0xE0, 0x94, 0x00, 0x40, 0x0D, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0x82, - 0x05, 0xE0, 0xFF, 0x22, 0x90, 0x82, 0x06, 0x12, 0x63, 0xA9, 0x80, 0xC6, 0x90, 0x01, 0xC4, 0x74, - 0xFC, 0xF0, 0x74, 0x77, 0xA3, 0xF0, 0x90, 0x00, 0x90, 0xE0, 0x20, 0xE0, 0xF9, 0x74, 0xFC, 0x04, - 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x77, 0xA3, 0xF0, 0x22, 0x7E, 0x00, 0x7F, 0x62, 0x7D, 0x00, 0x7B, - 0x01, 0x7A, 0x81, 0x79, 0x87, 0x12, 0x45, 0x73, 0x11, 0xED, 0x12, 0x45, 0x73, 0x90, 0x81, 0x8B, - 0x74, 0x02, 0xF0, 0x90, 0x81, 0x92, 0x14, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0x90, 0x81, - 0x98, 0xE4, 0xF0, 0xA3, 0x74, 0x02, 0x11, 0xD6, 0xF0, 0x11, 0xFA, 0xE4, 0xFD, 0xFF, 0x12, 0x4E, - 0x99, 0x7D, 0x0C, 0x7F, 0x02, 0x12, 0x4E, 0x99, 0x12, 0x4E, 0x95, 0x90, 0x80, 0x42, 0xE0, 0xFF, - 0xB4, 0x01, 0x08, 0x90, 0x81, 0x97, 0x74, 0x99, 0xF0, 0x80, 0x29, 0xEF, 0xB4, 0x03, 0x08, 0x90, - 0x81, 0x97, 0x74, 0x90, 0xF0, 0x80, 0x1D, 0x90, 0x81, 0x97, 0x74, 0x40, 0xF0, 0x90, 0x00, 0x2C, - 0xE0, 0x54, 0x0F, 0xFF, 0xBF, 0x05, 0x08, 0x90, 0x81, 0xA9, 0x74, 0x02, 0xF0, 0x80, 0x05, 0xE4, - 0x90, 0x81, 0xA9, 0xF0, 0x90, 0x81, 0xE9, 0x74, 0x02, 0xF0, 0xA3, 0x74, 0x0F, 0xF0, 0xA3, 0xE0, - 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, 0x07, 0x11, 0xD6, 0xF0, 0x7F, 0x01, 0x12, 0x5F, 0xE8, - 0x90, 0x05, 0x58, 0x74, 0x02, 0xF0, 0x7E, 0x00, 0xFF, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x81, 0x79, - 0xED, 0x12, 0x45, 0x73, 0x11, 0xE5, 0x90, 0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x12, 0x67, 0x60, - 0xE4, 0x90, 0x81, 0xEF, 0xF0, 0x22, 0xF0, 0x90, 0x81, 0xA9, 0xE0, 0x24, 0x04, 0x90, 0x81, 0xA4, - 0xF0, 0xA3, 0x74, 0x0A, 0x22, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, 0xF0, 0x22, 0x7E, 0x00, 0x7F, - 0x04, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x81, 0x79, 0xF7, 0x22, 0x90, 0x81, 0xE3, 0x74, 0x04, 0xF0, - 0xA3, 0x14, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0x74, 0x64, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xF0, - 0x22, 0x90, 0x81, 0x87, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0x81, 0x95, 0xF0, 0xA3, 0xF0, 0x90, - 0x81, 0x90, 0xF0, 0x90, 0x81, 0x88, 0xE0, 0x54, 0xF7, 0xF0, 0x54, 0xBF, 0xF0, 0x12, 0x49, 0x1B, - 0x7D, 0x10, 0x7F, 0x03, 0x02, 0x4A, 0x1D, 0xEF, 0x24, 0xFE, 0x60, 0x0B, 0x04, 0x70, 0x24, 0x90, - 0x81, 0x92, 0x74, 0x02, 0xF0, 0x80, 0x13, 0xED, 0x70, 0x06, 0x90, 0x81, 0xEC, 0xE0, 0x80, 0x02, - 0xED, 0x14, 0x90, 0x81, 0x92, 0xF0, 0x90, 0x81, 0x92, 0xE0, 0xA3, 0xF0, 0x90, 0x81, 0x88, 0xE0, - 0x44, 0x08, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x77, 0x3E, 0xEF, 0x64, - 0x01, 0x60, 0x05, 0x75, 0x0F, 0x01, 0x80, 0x52, 0x90, 0x81, 0x90, 0xE0, 0xFF, 0x54, 0x03, 0x60, - 0x05, 0x75, 0x0F, 0x02, 0x80, 0x44, 0x90, 0x81, 0x8E, 0xE0, 0xFE, 0xE4, 0xC3, 0x9E, 0x50, 0x05, - 0x75, 0x0F, 0x04, 0x80, 0x35, 0xEF, 0x30, 0xE2, 0x05, 0x75, 0x0F, 0x08, 0x80, 0x2C, 0x90, 0x81, - 0x90, 0xE0, 0x30, 0xE4, 0x05, 0x75, 0x0F, 0x10, 0x80, 0x20, 0x90, 0x81, 0x88, 0xE0, 0x13, 0x13, - 0x54, 0x3F, 0x20, 0xE0, 0x05, 0x75, 0x0F, 0x20, 0x80, 0x10, 0x90, 0x81, 0xEF, 0xE0, 0x60, 0x05, - 0x75, 0x0F, 0x80, 0x80, 0x05, 0x12, 0x67, 0x99, 0x80, 0x0E, 0x90, 0x01, 0xB9, 0x74, 0x04, 0xF0, - 0x90, 0x01, 0xB8, 0xE5, 0x0F, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7D, 0x2E, 0x7F, - 0x6F, 0x12, 0x4F, 0x17, 0x7D, 0x02, 0x7F, 0x01, 0x12, 0x4E, 0x99, 0x12, 0x67, 0xA1, 0x90, 0x81, - 0x86, 0x74, 0x02, 0xF0, 0x22, 0x90, 0x81, 0xF0, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x54, - 0xFB, 0xF0, 0x44, 0x10, 0xF0, 0x22, 0x12, 0x45, 0x0A, 0x90, 0x81, 0xDB, 0x12, 0x44, 0xF2, 0x12, - 0x44, 0xB9, 0x78, 0x0A, 0x12, 0x20, 0xA8, 0x90, 0x81, 0xA4, 0xE0, 0xFE, 0xC3, 0x74, 0x0A, 0x9E, - 0x2F, 0xFF, 0x22, 0x90, 0x81, 0x8A, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x22, 0xE0, 0x90, 0x01, 0xBA, - 0xF0, 0x90, 0x81, 0x8E, 0xE0, 0x90, 0x01, 0xBB, 0x22, 0x90, 0x01, 0x34, 0x74, 0x40, 0xF0, 0xFD, - 0xE4, 0xFF, 0x02, 0x49, 0x25, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xFE, 0xEF, 0x54, 0x07, 0xFF, - 0x22, 0x90, 0x81, 0x88, 0xE0, 0xFF, 0x13, 0x13, 0x22, 0x90, 0x81, 0x82, 0xE0, 0xC4, 0x13, 0x13, - 0x22, 0x90, 0x81, 0xF9, 0xE0, 0x90, 0x01, 0x3F, 0x22, 0x90, 0x81, 0xF9, 0xE0, 0x90, 0x05, 0x73, - 0x22, 0x90, 0x81, 0x92, 0xE0, 0xFF, 0xA3, 0xE0, 0x22, 0x90, 0x81, 0x92, 0xE0, 0x90, 0x05, 0x73, - 0x22, 0x90, 0x81, 0x87, 0xE0, 0x13, 0x13, 0x13, 0x22, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, - 0x22, 0x00, 0x7C, 0xBD, -}; -u32 array_length_mp_8188e_t_fw_nic = 15028; - - -#endif - -void -odm_read_firmware_mp_8188e_t_fw_nic( - struct PHY_DM_STRUCT *p_dm_odm, - u8 *p_firmware, - u32 *p_firmware_size -) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) - *((SIZE_PTR *)p_firmware) = (SIZE_PTR)array_mp_8188e_t_fw_nic; -#else - odm_move_memory(p_dm_odm, p_firmware, array_mp_8188e_t_fw_nic, array_length_mp_8188e_t_fw_nic); -#endif - *p_firmware_size = array_length_mp_8188e_t_fw_nic; -} - -#ifndef LOAD_FW_HEADER_FROM_DRIVER -u8 array_mp_8188e_t_fw_nic_89em[] = { - 0xE1, 0x88, 0x40, 0x00, 0x17, 0x00, 0x00, 0x00, 0x03, 0x25, 0x13, 0x14, 0x40, 0x37, 0x00, 0x00, - 0x0C, 0x27, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x02, 0x45, 0x74, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0xC1, 0x97, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0xC1, 0x0E, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xE1, 0xF7, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 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, 0x41, 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, 0x46, 0x08, 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, 0x46, 0x08, 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, 0x41, 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, 0x41, 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, 0x41, 0x4D, 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, - 0xC2, 0xAF, 0x56, 0xC6, 0xD2, 0xAF, 0xD2, 0xA9, 0x54, 0x80, 0x4F, 0xFF, 0x22, 0xE7, 0x09, 0xF6, - 0x08, 0xDF, 0xFA, 0x80, 0x46, 0xE7, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x3E, 0x88, 0x82, 0x8C, - 0x83, 0xE7, 0x09, 0xF0, 0xA3, 0xDF, 0xFA, 0x80, 0x32, 0xE3, 0x09, 0xF6, 0x08, 0xDF, 0xFA, 0x80, - 0x78, 0xE3, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x70, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0x09, 0xF0, - 0xA3, 0xDF, 0xFA, 0x80, 0x64, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF6, 0x08, 0xDF, 0xFA, 0x80, - 0x58, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x4C, 0x80, 0xD2, 0x80, - 0xFA, 0x80, 0xC6, 0x80, 0xD4, 0x80, 0x69, 0x80, 0xF2, 0x80, 0x33, 0x80, 0x10, 0x80, 0xA6, 0x80, - 0xEA, 0x80, 0x9A, 0x80, 0xA8, 0x80, 0xDA, 0x80, 0xE2, 0x80, 0xCA, 0x80, 0x33, 0x89, 0x82, 0x8A, - 0x83, 0xEC, 0xFA, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xF0, 0xA3, - 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, 0x0D, 0x89, 0x82, - 0x8A, 0x83, 0xE4, 0x93, 0xA3, 0xF6, 0x08, 0xDF, 0xF9, 0xEC, 0xFA, 0xA9, 0xF0, 0xED, 0xFB, 0x22, - 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, - 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xEA, 0xDE, 0xE8, 0x80, 0xDB, - 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xA3, 0xF2, 0x08, 0xDF, 0xF9, 0x80, 0xCC, 0x88, 0xF0, 0xEF, - 0x60, 0x01, 0x0E, 0x4E, 0x60, 0xC3, 0x88, 0xF0, 0xED, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0xB9, - 0xF5, 0x82, 0xEB, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0xAF, 0x23, 0x23, 0x45, 0x82, 0x23, 0x90, - 0x43, 0xFD, 0x73, 0xC5, 0xF0, 0xF8, 0xA3, 0xE0, 0x28, 0xF0, 0xC5, 0xF0, 0xF8, 0xE5, 0x82, 0x15, - 0x82, 0x70, 0x02, 0x15, 0x83, 0xE0, 0x38, 0xF0, 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, 0xFC, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0xE2, - 0xFC, 0x08, 0xE2, 0xFD, 0x08, 0xE2, 0xFE, 0x08, 0xE2, 0xFF, 0x22, 0xE2, 0xFB, 0x08, 0xE2, 0xF9, - 0x08, 0xE2, 0xFA, 0x08, 0xE2, 0xCB, 0xF8, 0x22, 0xEC, 0xF2, 0x08, 0xED, 0xF2, 0x08, 0xEE, 0xF2, - 0x08, 0xEF, 0xF2, 0x22, 0xA4, 0x25, 0x82, 0xF5, 0x82, 0xE5, 0xF0, 0x35, 0x83, 0xF5, 0x83, 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, 0xEF, 0x4E, 0x60, 0x12, 0xEF, 0x60, 0x01, 0x0E, - 0xED, 0xBB, 0x01, 0x0B, 0x89, 0x82, 0x8A, 0x83, 0xF0, 0xA3, 0xDF, 0xFC, 0xDE, 0xFA, 0x22, 0x89, - 0xF0, 0x50, 0x07, 0xF7, 0x09, 0xDF, 0xFC, 0xA9, 0xF0, 0x22, 0xBB, 0xFE, 0xFC, 0xF3, 0x09, 0xDF, - 0xFC, 0xA9, 0xF0, 0x22, 0x02, 0x45, 0xB2, 0x02, 0x41, 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, 0x45, 0xF7, 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, 0x82, 0xD2, 0x00, 0x41, 0x82, 0xD3, 0x00, 0x41, - 0x82, 0xDC, 0x00, 0x41, 0x82, 0xDE, 0x00, 0x00, 0x50, 0xEF, 0x58, 0x17, 0x5F, 0xE2, 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, 0x46, 0xA3, 0xF0, 0xD1, 0x5D, 0x74, 0x0E, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x46, - 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, 0x54, - 0xE0, 0x55, 0x35, 0xF5, 0x39, 0xA3, 0xE0, 0x55, 0x36, 0xF5, 0x3A, 0xA3, 0xE0, 0x55, 0x37, 0xF5, - 0x3B, 0xA3, 0xE0, 0x55, 0x38, 0xF5, 0x3C, 0xAD, 0x39, 0x7F, 0x54, 0x12, 0x32, 0x1E, 0xAD, 0x3A, - 0x7F, 0x55, 0x12, 0x32, 0x1E, 0xAD, 0x3B, 0x7F, 0x56, 0x12, 0x32, 0x1E, 0xAD, 0x3C, 0x7F, 0x57, - 0x12, 0x32, 0x1E, 0x53, 0x91, 0xEF, 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, 0x46, 0xA3, 0xF0, 0x12, 0x6D, - 0x7F, 0xE5, 0x41, 0x30, 0xE4, 0x02, 0xF1, 0x33, 0xE5, 0x41, 0x30, 0xE6, 0x03, 0x12, 0x6E, 0x18, - 0xE5, 0x43, 0x30, 0xE0, 0x03, 0x12, 0x6E, 0x25, 0xE5, 0x43, 0x30, 0xE1, 0x03, 0x12, 0x6F, 0xB7, - 0xE5, 0x43, 0x30, 0xE2, 0x03, 0x12, 0x70, 0x05, 0xE5, 0x43, 0x30, 0xE3, 0x02, 0xF1, 0x46, 0xE5, - 0x43, 0x30, 0xE4, 0x02, 0xF1, 0x5E, 0xE5, 0x43, 0x30, 0xE5, 0x03, 0x12, 0x57, 0x40, 0xE5, 0x43, - 0x30, 0xE6, 0x02, 0xF1, 0xD8, 0xE5, 0x44, 0x30, 0xE1, 0x03, 0x12, 0x70, 0x6F, 0x74, 0x97, 0x04, - 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x46, 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, 0x60, 0x81, 0x7F, 0x02, 0x8F, 0x0D, 0x7F, 0x02, 0x71, 0x27, 0x90, 0x80, - 0x3C, 0xE0, 0x45, 0x0D, 0xF0, 0x22, 0xF1, 0x56, 0x70, 0x0B, 0x90, 0x81, 0x8C, 0xE0, 0x60, 0x05, - 0xF1, 0x9D, 0x12, 0x56, 0xB4, 0x22, 0xE4, 0xFF, 0xF1, 0x79, 0xEF, 0x64, 0x01, 0x22, 0xF1, 0x56, - 0x70, 0x16, 0x90, 0x81, 0x8C, 0xE0, 0x60, 0x10, 0xF1, 0x9D, 0xF0, 0x90, 0x81, 0x87, 0xE0, 0xF1, - 0xCD, 0x54, 0x07, 0x70, 0x03, 0x12, 0x58, 0x5D, 0x22, 0x12, 0x76, 0xE6, 0x12, 0x51, 0xAE, 0xE0, - 0xFD, 0x7C, 0x00, 0x12, 0x67, 0x48, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, - 0xEE, 0x5C, 0xFE, 0xEF, 0x5D, 0x4E, 0x7F, 0x00, 0x60, 0x02, 0x7F, 0x01, 0x22, 0x90, 0x01, 0x57, - 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0x22, 0x90, 0x01, 0x57, 0xE0, 0x60, 0x1D, 0xF1, 0xA0, - 0xF0, 0x12, 0x74, 0x72, 0x54, 0x3F, 0x30, 0xE0, 0x02, 0x80, 0x11, 0x12, 0x74, 0x7A, 0x9F, 0x40, - 0x0A, 0xE4, 0xFF, 0xF1, 0x79, 0xBF, 0x01, 0x03, 0xF1, 0xF0, 0xF0, 0x22, 0xEF, 0x54, 0xFB, 0xF0, - 0x90, 0x81, 0x90, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0xE4, 0xFF, 0xF1, 0x79, 0xBF, 0x01, 0x10, 0x90, - 0x81, 0x8C, 0xE0, 0x60, 0x0A, 0x12, 0x56, 0x69, 0x54, 0x07, 0x70, 0x03, 0x12, 0x58, 0x5D, 0x22, - 0x90, 0x81, 0x88, 0xE0, 0x54, 0xFB, 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, 0xF7, 0xF0, 0x74, 0x47, 0xA3, 0xF0, 0x12, 0x6D, - 0xAC, 0xE5, 0x49, 0x30, 0xE1, 0x03, 0x12, 0x73, 0xFD, 0xE5, 0x49, 0x30, 0xE2, 0x03, 0x12, 0x58, - 0x72, 0xE5, 0x4A, 0x30, 0xE0, 0x03, 0x12, 0x71, 0xCC, 0xE5, 0x4A, 0x30, 0xE4, 0x03, 0x12, 0x74, - 0x92, 0xE5, 0x4B, 0x30, 0xE1, 0x03, 0x12, 0x74, 0xA8, 0xE5, 0x4B, 0x30, 0xE0, 0x03, 0x12, 0x73, - 0x67, 0xE5, 0x4B, 0x30, 0xE4, 0x03, 0x12, 0x74, 0xF1, 0xE5, 0x4C, 0x30, 0xE1, 0x05, 0x7F, 0x04, - 0x12, 0x47, 0x38, 0xE5, 0x4C, 0x30, 0xE4, 0x02, 0x11, 0xA0, 0xE5, 0x4C, 0x30, 0xE5, 0x03, 0x12, - 0x70, 0x8E, 0xE5, 0x4C, 0x30, 0xE6, 0x03, 0x12, 0x70, 0xC1, 0x74, 0xF7, 0x04, 0x90, 0x01, 0xC4, - 0xF0, 0x74, 0x47, 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, 0x76, 0x3E, 0x31, 0x1C, 0x90, 0x81, 0xF7, 0xE0, 0x30, 0xE0, 0x1B, 0x12, 0x77, 0x15, 0xF0, - 0x90, 0x81, 0xFA, 0xE0, 0x60, 0x04, 0x14, 0xF0, 0xC1, 0xFD, 0x90, 0x81, 0xF8, 0xE0, 0x14, 0x90, - 0x81, 0xFA, 0xF0, 0xE4, 0xFF, 0x11, 0xC8, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, - 0x64, 0x01, 0x70, 0x19, 0x12, 0x77, 0x0D, 0x60, 0x0A, 0x31, 0x0F, 0x51, 0x30, 0x12, 0x77, 0x15, - 0xF0, 0x80, 0x06, 0x31, 0x0F, 0x51, 0x18, 0x51, 0x38, 0xD1, 0xFD, 0x80, 0x19, 0x12, 0x77, 0x0D, - 0x60, 0x06, 0x31, 0x0F, 0x51, 0x30, 0x80, 0x04, 0x31, 0x0F, 0x51, 0x18, 0x31, 0x1C, 0x7D, 0x01, - 0x7F, 0x02, 0x31, 0x20, 0xF1, 0x1E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, 0x90, 0x01, 0x3F, 0x74, - 0x10, 0xF0, 0xFD, 0x7F, 0x03, 0x22, 0x7D, 0x01, 0x7F, 0x02, 0x31, 0x20, 0x7D, 0x02, 0x7F, 0x02, - 0x74, 0x3D, 0x2F, 0xF8, 0xE6, 0x4D, 0xFE, 0xF6, 0x74, 0x30, 0x41, 0x21, 0x90, 0x05, 0x62, 0xE0, - 0xFE, 0x90, 0x05, 0x61, 0xE0, 0xFD, 0xED, 0x78, 0x02, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, - 0xFF, 0x90, 0x81, 0xFF, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x47, 0x56, 0x60, 0x02, 0x41, 0x0A, - 0x90, 0x81, 0x8C, 0xE0, 0x70, 0x02, 0x41, 0x0A, 0x12, 0x77, 0x25, 0x64, 0x01, 0x70, 0x22, 0x90, - 0x06, 0xAB, 0xE0, 0x90, 0x81, 0x93, 0xF0, 0x90, 0x06, 0xAA, 0xE0, 0x90, 0x81, 0x92, 0xF0, 0xA3, - 0xE0, 0xFF, 0x70, 0x08, 0x90, 0x81, 0x92, 0xE0, 0xFE, 0xFF, 0x80, 0x00, 0x90, 0x81, 0x93, 0xEF, - 0xF0, 0xE4, 0x90, 0x81, 0x95, 0x12, 0x72, 0x14, 0x12, 0x47, 0x9D, 0x12, 0x47, 0xCF, 0x54, 0xEF, - 0xF0, 0x90, 0x81, 0x8A, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x24, 0xFD, 0x50, 0x02, 0x80, 0x0F, 0x90, - 0x81, 0x82, 0xE0, 0x30, 0xE0, 0x05, 0x12, 0x56, 0x01, 0x80, 0x03, 0x12, 0x56, 0x71, 0x12, 0x74, - 0x60, 0x30, 0xE0, 0x52, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x21, 0x12, 0x77, 0x1D, - 0x6F, 0x70, 0x43, 0x90, 0x81, 0x88, 0xE0, 0x44, 0x40, 0xF0, 0x12, 0x76, 0x96, 0x31, 0x0B, 0x51, - 0x30, 0x51, 0x3E, 0x12, 0x74, 0x6B, 0x90, 0x81, 0x93, 0xE0, 0x14, 0xF0, 0x80, 0x28, 0x12, 0x77, - 0x25, 0x64, 0x01, 0x70, 0x21, 0x12, 0x77, 0x1D, 0xFE, 0x6F, 0x60, 0x1A, 0x90, 0x05, 0x73, 0xE0, - 0xFF, 0xEE, 0x6F, 0x60, 0x11, 0x12, 0x76, 0xFD, 0x54, 0x3F, 0x30, 0xE0, 0x09, 0xEF, 0x54, 0xBF, - 0x31, 0x0B, 0x51, 0x18, 0x31, 0x16, 0x12, 0x76, 0xC6, 0xF0, 0x90, 0x81, 0x82, 0xE0, 0xC3, 0x13, - 0x20, 0xE0, 0x04, 0x12, 0x76, 0xC6, 0xF0, 0x22, 0x74, 0x45, 0x12, 0x77, 0x35, 0xFE, 0xF6, 0x74, - 0x38, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x7D, 0x03, 0x7F, 0x02, - 0x74, 0x45, 0x2F, 0xF8, 0xE6, 0x4D, 0x80, 0xE5, 0x7D, 0x02, 0x7F, 0x02, 0x51, 0x42, 0x7D, 0x01, - 0x7F, 0x02, 0x74, 0x3D, 0x12, 0x77, 0x35, 0xFE, 0xF6, 0x74, 0x30, 0x80, 0xD4, 0xD3, 0x10, 0xAF, - 0x01, 0xC3, 0xC0, 0xD0, 0x8B, 0x52, 0x8A, 0x53, 0x89, 0x54, 0x90, 0x05, 0x27, 0xE0, 0xF5, 0x55, - 0x8B, 0x13, 0x8A, 0x14, 0x89, 0x15, 0x75, 0x16, 0x01, 0x7B, 0x01, 0x7A, 0x81, 0x79, 0x82, 0x12, - 0x2B, 0xED, 0xAB, 0x52, 0xAA, 0x53, 0xA9, 0x54, 0x12, 0x1F, 0xA4, 0xFF, 0xC3, 0x13, 0x20, 0xE0, - 0x02, 0x61, 0x1A, 0x90, 0x81, 0x82, 0xE0, 0x30, 0xE0, 0x7B, 0x51, 0x2C, 0x75, 0x55, 0x21, 0x90, - 0x81, 0x82, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x08, 0x12, 0x76, 0xDA, 0x43, 0x55, 0x08, - 0x80, 0x0C, 0xE4, 0x90, 0x81, 0x83, 0xF0, 0xA3, 0xF0, 0x7D, 0x40, 0xFF, 0x51, 0x42, 0x90, 0x81, - 0x82, 0x12, 0x74, 0x63, 0x30, 0xE0, 0x03, 0x43, 0x55, 0x12, 0xEF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, - 0x03, 0x43, 0x55, 0x14, 0x90, 0x81, 0x82, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x03, 0x43, - 0x55, 0x80, 0x12, 0x77, 0x05, 0x54, 0x03, 0x20, 0xE0, 0x03, 0x43, 0x55, 0x40, 0x71, 0xCB, 0x90, - 0x81, 0x85, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x58, 0xE1, 0x12, 0x70, 0x4B, 0x30, 0xE0, 0x04, - 0x7F, 0x04, 0x80, 0x0C, 0x12, 0x58, 0xBC, 0xEF, 0x60, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x02, - 0x12, 0x58, 0xE1, 0x61, 0x93, 0x75, 0x55, 0x01, 0x71, 0xCB, 0x90, 0x81, 0x85, 0xE0, 0x64, 0x04, - 0x60, 0x02, 0x61, 0xC6, 0xFF, 0x12, 0x58, 0xE1, 0x61, 0xC6, 0x90, 0x81, 0x82, 0xE0, 0x30, 0xE0, - 0x7A, 0x51, 0x2C, 0x43, 0x55, 0x31, 0x90, 0x81, 0x82, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, - 0x08, 0x12, 0x76, 0xDA, 0x43, 0x55, 0x08, 0x80, 0x06, 0x7D, 0x40, 0xE4, 0xFF, 0x51, 0x42, 0x90, - 0x81, 0x82, 0x12, 0x74, 0x63, 0x30, 0xE0, 0x03, 0x43, 0x55, 0x02, 0xEF, 0xC4, 0x54, 0x0F, 0x30, - 0xE0, 0x03, 0x43, 0x55, 0x04, 0x71, 0xCB, 0x12, 0x70, 0x4B, 0x30, 0xE0, 0x0B, 0x12, 0x70, 0x2D, - 0x60, 0x31, 0xE4, 0xFD, 0x7F, 0x02, 0x80, 0x1F, 0x12, 0x5F, 0x38, 0x90, 0x81, 0x86, 0xE0, 0xB4, - 0x02, 0x19, 0x12, 0x5F, 0x54, 0x12, 0x58, 0xBC, 0xBF, 0x01, 0x09, 0x90, 0x81, 0x8E, 0xE0, 0xFF, - 0x7D, 0x01, 0x80, 0x03, 0xE4, 0xFD, 0xFF, 0x71, 0xD6, 0x80, 0x08, 0x90, 0x81, 0x8F, 0xE0, 0x90, - 0x81, 0x86, 0xF0, 0x90, 0x05, 0x40, 0x74, 0x22, 0xF0, 0x80, 0x2B, 0x75, 0x55, 0x01, 0x71, 0xCB, - 0x90, 0x81, 0x86, 0xE0, 0xB4, 0x02, 0x06, 0x7D, 0x01, 0x7F, 0x04, 0x80, 0x0B, 0x90, 0x81, 0x86, - 0xE0, 0xB4, 0x08, 0x06, 0x7D, 0x01, 0x7F, 0x0C, 0x71, 0xD6, 0x12, 0x72, 0x49, 0x90, 0x81, 0x8E, - 0x12, 0x58, 0x6B, 0x12, 0x52, 0x11, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x05, 0x27, 0xE5, 0x55, - 0xF0, 0x22, 0x7D, 0x01, 0x7F, 0x04, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x82, 0xDB, - 0xED, 0xF0, 0x90, 0x81, 0x87, 0xE0, 0xFE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0xA1, - 0x21, 0xEE, 0x12, 0x70, 0xF0, 0x30, 0xE0, 0x02, 0xA1, 0x21, 0x90, 0x81, 0x8F, 0xE0, 0xFE, 0x6F, - 0x70, 0x02, 0xA1, 0x21, 0xEF, 0x70, 0x02, 0x81, 0x94, 0x24, 0xFE, 0x70, 0x02, 0x81, 0xCE, 0x24, - 0xFE, 0x60, 0x49, 0x24, 0xFC, 0x70, 0x02, 0xA1, 0x09, 0x24, 0xFC, 0x60, 0x02, 0xA1, 0x1A, 0xEE, - 0xB4, 0x0E, 0x02, 0xB1, 0x80, 0x90, 0x81, 0x8F, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0xB1, 0xCB, 0x90, - 0x81, 0x8F, 0xE0, 0xB4, 0x06, 0x02, 0xB1, 0xA5, 0x90, 0x81, 0x8F, 0xE0, 0xB4, 0x04, 0x0F, 0x90, - 0x82, 0xDB, 0xE0, 0xFF, 0x60, 0x05, 0x12, 0x72, 0xED, 0x80, 0x03, 0x12, 0x58, 0x94, 0x90, 0x81, - 0x8F, 0xE0, 0x64, 0x08, 0x60, 0x02, 0xA1, 0x1A, 0xF1, 0x1E, 0xA1, 0x1A, 0x90, 0x81, 0x8F, 0xE0, - 0x70, 0x04, 0x7F, 0x01, 0xB1, 0xCB, 0x90, 0x81, 0x8F, 0xE0, 0xB4, 0x06, 0x02, 0xB1, 0xA5, 0x90, - 0x81, 0x8F, 0xE0, 0xB4, 0x0E, 0x07, 0xB1, 0x26, 0xBF, 0x01, 0x02, 0xB1, 0x80, 0x90, 0x81, 0x8F, - 0xE0, 0x64, 0x0C, 0x60, 0x02, 0xA1, 0x1A, 0xB1, 0x26, 0xEF, 0x64, 0x01, 0x60, 0x02, 0xA1, 0x1A, - 0xB1, 0xE3, 0xA1, 0x1A, 0x90, 0x81, 0x8F, 0xE0, 0xB4, 0x0E, 0x07, 0xB1, 0x26, 0xBF, 0x01, 0x02, - 0xB1, 0x80, 0x90, 0x81, 0x8F, 0xE0, 0xB4, 0x06, 0x02, 0xB1, 0xA5, 0x90, 0x81, 0x8F, 0xE0, 0xB4, - 0x0C, 0x07, 0xB1, 0x26, 0xBF, 0x01, 0x02, 0xB1, 0xE3, 0x90, 0x81, 0x8F, 0xE0, 0x64, 0x04, 0x70, - 0x59, 0x12, 0x72, 0x6E, 0xEF, 0x64, 0x01, 0x70, 0x51, 0x12, 0x67, 0x8C, 0x80, 0x4C, 0x90, 0x81, - 0x8F, 0xE0, 0xB4, 0x0E, 0x07, 0xB1, 0x26, 0xBF, 0x01, 0x02, 0xB1, 0x80, 0x90, 0x81, 0x8F, 0xE0, - 0xB4, 0x06, 0x02, 0xB1, 0xA5, 0x90, 0x81, 0x8F, 0xE0, 0xB4, 0x0C, 0x07, 0xB1, 0x26, 0xBF, 0x01, - 0x02, 0xB1, 0xE3, 0x90, 0x81, 0x8F, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0xB1, 0xCB, 0x90, 0x81, 0x8F, - 0xE0, 0xB4, 0x04, 0x16, 0x12, 0x76, 0x1F, 0x80, 0x11, 0x90, 0x81, 0x8F, 0xE0, 0xB4, 0x0C, 0x0A, - 0x12, 0x76, 0xFD, 0x54, 0x3F, 0x30, 0xE0, 0x02, 0xD1, 0xFD, 0x90, 0x81, 0x8F, 0x12, 0x76, 0xCD, - 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x72, 0x30, - 0xEF, 0x64, 0x01, 0x60, 0x05, 0x75, 0x0E, 0x01, 0x80, 0x33, 0x12, 0x77, 0x2D, 0x54, 0x1F, 0x30, - 0xE0, 0x05, 0x75, 0x0E, 0x02, 0x80, 0x26, 0x90, 0x81, 0x8E, 0xE0, 0xD3, 0x94, 0x04, 0x40, 0x05, - 0x75, 0x0E, 0x08, 0x80, 0x18, 0x90, 0x81, 0xF0, 0xE0, 0x30, 0xE0, 0x0C, 0x13, 0x13, 0x54, 0x3F, - 0x30, 0xE0, 0x05, 0x75, 0x0E, 0x11, 0x80, 0x05, 0x12, 0x72, 0xE5, 0x80, 0x0E, 0x90, 0x01, 0xB9, - 0x74, 0x02, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x0E, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, - 0x90, 0x81, 0x88, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x04, 0xD1, 0x91, 0x80, 0x13, 0x12, 0x67, 0x50, - 0x12, 0x5F, 0xDA, 0x90, 0x05, 0x27, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0x81, 0x86, 0x74, 0x04, 0xF0, - 0xE4, 0xFD, 0xFF, 0xE1, 0x13, 0x90, 0x81, 0x88, 0xE0, 0x90, 0x06, 0x04, 0x20, 0xE0, 0x08, 0xE0, - 0x44, 0x40, 0x12, 0x5F, 0xDA, 0x80, 0x0F, 0xD1, 0x8D, 0x90, 0x05, 0x27, 0xE0, 0x54, 0x7F, 0xF0, - 0x90, 0x81, 0x86, 0x74, 0x0C, 0xF0, 0xE4, 0xFD, 0xFF, 0xE1, 0x13, 0x90, 0x82, 0xDA, 0xEF, 0xF0, - 0xF1, 0x84, 0x90, 0x82, 0xDA, 0xE0, 0x60, 0x03, 0x12, 0x5A, 0x8A, 0x7D, 0x04, 0xF1, 0xE9, 0x74, - 0x04, 0xF0, 0x22, 0x12, 0x47, 0x56, 0x70, 0x2B, 0x90, 0x81, 0x88, 0xE0, 0x54, 0xFD, 0xF0, 0x7D, - 0x2C, 0x7F, 0x6F, 0xF1, 0x13, 0x7D, 0x08, 0x7F, 0x01, 0x12, 0x65, 0xC2, 0xBF, 0x01, 0x0F, 0x90, - 0x81, 0x87, 0xE0, 0x44, 0x80, 0xF0, 0x7D, 0x0E, 0xF1, 0xE9, 0x74, 0x0E, 0xF0, 0x22, 0x12, 0x70, - 0xB7, 0x04, 0xF0, 0x22, 0xEF, 0x70, 0x3A, 0x7D, 0x78, 0x7F, 0x02, 0x51, 0x42, 0x7D, 0x02, 0x7F, - 0x03, 0x51, 0x42, 0x7D, 0xC8, 0x7F, 0x02, 0x51, 0x18, 0x12, 0x47, 0x9D, 0xF0, 0xE4, 0xFF, 0x12, - 0x47, 0x79, 0xEF, 0x70, 0x0B, 0x12, 0x58, 0x87, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x80, 0x06, - 0x7D, 0x01, 0x7F, 0x0C, 0x71, 0xD6, 0x12, 0x58, 0x8C, 0x90, 0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, - 0x22, 0x90, 0x01, 0x36, 0x74, 0x78, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x7D, 0x78, 0xFF, 0x31, 0x20, - 0x7D, 0x02, 0x7F, 0x03, 0x31, 0x20, 0x90, 0x06, 0x0A, 0xE0, 0x44, 0x07, 0x12, 0x72, 0x14, 0xE4, - 0xFF, 0x12, 0x47, 0x79, 0xBF, 0x01, 0x11, 0x12, 0x47, 0xF0, 0xF0, 0x90, 0x81, 0x8F, 0xE0, 0x20, - 0xE2, 0x0A, 0x7D, 0x01, 0x7F, 0x04, 0x61, 0xD6, 0x12, 0x76, 0xC6, 0xF0, 0x22, 0xE0, 0x54, 0x7F, - 0xF0, 0x7D, 0x0C, 0x7F, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAC, 0x07, 0xEF, 0x14, - 0x60, 0x15, 0x14, 0x60, 0x19, 0x24, 0x02, 0x70, 0x1A, 0xED, 0x54, 0x01, 0xFE, 0x90, 0x81, 0x87, - 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0x80, 0x0C, 0x90, 0x81, 0x8F, 0xED, 0xF0, 0x80, 0x05, 0x90, 0x81, - 0x8E, 0xED, 0xF0, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE4, 0x2E, 0xEC, 0x14, 0x60, 0x07, 0x14, 0x60, - 0x1D, 0x24, 0x02, 0x70, 0x23, 0x90, 0x81, 0x87, 0xE0, 0x54, 0x01, 0xC4, 0x33, 0x33, 0x33, 0x54, - 0x80, 0xFF, 0x90, 0x81, 0x8F, 0xE0, 0x54, 0x7F, 0x4F, 0xFD, 0x7F, 0x88, 0x80, 0x07, 0x90, 0x81, - 0x8E, 0xE0, 0xFD, 0x7F, 0x89, 0x12, 0x32, 0x1E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7D, 0x2F, 0x7F, - 0xFF, 0xF1, 0x13, 0x12, 0x59, 0xF2, 0x7D, 0x08, 0xF1, 0xE9, 0x74, 0x08, 0xF0, 0x22, 0xF1, 0x84, - 0xE4, 0xFD, 0xFF, 0x90, 0x05, 0x22, 0xEF, 0xF0, 0x90, 0x80, 0x40, 0xED, 0xF0, 0x22, 0xF1, 0x0E, - 0xD1, 0x91, 0x90, 0x81, 0x86, 0x74, 0x0C, 0xF0, 0x22, 0x90, 0x81, 0xF0, 0xE0, 0x30, 0xE0, 0x53, - 0x13, 0x13, 0x54, 0x3F, 0x20, 0xE0, 0x18, 0xE4, 0xF5, 0x1D, 0x90, 0x81, 0xF2, 0x12, 0x56, 0xBB, - 0xF1, 0x0E, 0x12, 0x6F, 0x1F, 0x30, 0xE0, 0x02, 0xD1, 0x91, 0x12, 0x6F, 0x9B, 0xF0, 0x22, 0x90, - 0x81, 0xF0, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x29, 0xE4, 0xF5, 0x1D, 0x90, 0x81, 0xF3, - 0x12, 0x56, 0xBB, 0x90, 0x81, 0xF0, 0xE0, 0x54, 0xFB, 0xF0, 0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x0A, - 0x12, 0x6F, 0xAA, 0xF0, 0x7D, 0x04, 0x7F, 0x01, 0xC1, 0x95, 0x7D, 0x31, 0x7F, 0xFF, 0xF1, 0x13, - 0x12, 0x59, 0xF2, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 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, 0x5F, 0xCC, 0xEC, 0x54, 0x7F, 0xFC, 0x90, 0x82, 0xBF, 0x12, 0x20, - 0xCE, 0x90, 0x82, 0xBF, 0x12, 0x44, 0xD3, 0x12, 0x5A, 0x96, 0x12, 0x5F, 0xC5, 0x90, 0x85, 0xBB, - 0x12, 0x20, 0xDA, 0xCC, 0xC0, 0x00, 0xC0, 0x12, 0x5F, 0xD3, 0x90, 0x85, 0xBB, 0x12, 0x20, 0xDA, - 0x00, 0xC0, 0x00, 0x14, 0x12, 0x76, 0xF2, 0x12, 0x20, 0xDA, 0x00, 0x03, 0x3E, 0x60, 0xE4, 0xFD, - 0xFF, 0x12, 0x5F, 0x0F, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x01, 0xD1, 0x95, 0x90, 0x81, 0x86, - 0x22, 0xF1, 0x0E, 0x90, 0x81, 0x85, 0x74, 0x01, 0xF0, 0x22, 0x90, 0x01, 0xC8, 0xE4, 0xF0, 0xA3, - 0xF0, 0xA3, 0xF0, 0x7B, 0x01, 0x7A, 0x82, 0x79, 0x08, 0x7F, 0xFF, 0xFE, 0x12, 0x2B, 0x27, 0xBF, - 0x01, 0x0A, 0x90, 0x82, 0x08, 0xE0, 0x64, 0x03, 0x60, 0x04, 0x01, 0xAB, 0x01, 0xB3, 0xE4, 0x90, - 0x82, 0x0D, 0xF0, 0x90, 0x82, 0x0D, 0xE0, 0xFF, 0xC3, 0x94, 0x02, 0x40, 0x02, 0x01, 0xEE, 0xC3, - 0x74, 0xFE, 0x9F, 0xFF, 0xE4, 0x94, 0x00, 0xFE, 0x7B, 0x01, 0x7A, 0x82, 0x79, 0x09, 0x12, 0x2B, - 0x27, 0xEF, 0x64, 0x01, 0x70, 0x6D, 0x90, 0x82, 0x09, 0xE0, 0xFF, 0x54, 0xC0, 0xFE, 0x60, 0x05, - 0xEF, 0x54, 0x0C, 0x70, 0x16, 0x90, 0x82, 0x09, 0xE0, 0xFF, 0x54, 0x30, 0x60, 0x5D, 0xEF, 0x54, - 0x03, 0x60, 0x58, 0x90, 0x82, 0x0A, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x82, 0x0A, 0xF0, - 0x90, 0x82, 0x0A, 0xE0, 0x90, 0x82, 0x09, 0x70, 0x16, 0xE0, 0xFF, 0xEE, 0x13, 0x13, 0x54, 0x3F, - 0x90, 0x82, 0x0B, 0xF0, 0xEF, 0x54, 0x0C, 0x13, 0x13, 0x54, 0x3F, 0xA3, 0xF0, 0x80, 0x0D, 0xE0, - 0xFE, 0x54, 0x30, 0x90, 0x82, 0x0B, 0xF0, 0xEE, 0x54, 0x03, 0xA3, 0xF0, 0x90, 0x82, 0x0C, 0xE0, - 0xB4, 0x01, 0x08, 0x90, 0x82, 0x0B, 0xE0, 0x64, 0x30, 0x60, 0x43, 0x90, 0x82, 0x0F, 0x74, 0x02, - 0xF0, 0x80, 0x10, 0x90, 0x82, 0x0F, 0x74, 0x01, 0xF0, 0x80, 0x08, 0x90, 0x82, 0x0D, 0xE0, 0x04, - 0xF0, 0x01, 0x23, 0x90, 0x01, 0xC4, 0x74, 0xFA, 0xF0, 0x74, 0x4F, 0xA3, 0xF0, 0x90, 0x82, 0x0F, - 0xE0, 0x90, 0x01, 0xC8, 0xF0, 0x90, 0x82, 0x09, 0xE0, 0x90, 0x01, 0xC9, 0xF0, 0x90, 0x82, 0x0A, - 0xE0, 0x90, 0x01, 0xCA, 0xF0, 0xE4, 0xFD, 0x7F, 0x1F, 0x12, 0x32, 0x1E, 0x80, 0xD5, 0x22, 0x90, - 0x00, 0x80, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x12, 0x32, 0x1E, 0x90, 0xFD, 0x00, 0xE0, 0x54, - 0xBF, 0xF0, 0x12, 0x4F, 0xFA, 0x12, 0x6D, 0x11, 0x12, 0x32, 0x77, 0x12, 0x6D, 0x1E, 0x31, 0x4B, - 0x7F, 0x01, 0x12, 0x42, 0x15, 0x90, 0x81, 0xFB, 0x74, 0x02, 0xF0, 0xFF, 0x12, 0x42, 0x15, 0x90, - 0x81, 0xFB, 0xE0, 0x04, 0xF0, 0x51, 0x2F, 0x31, 0x5C, 0x90, 0x01, 0xCC, 0x74, 0x0F, 0xF0, 0x90, - 0x00, 0x80, 0xE0, 0x44, 0x40, 0xFD, 0x7F, 0x80, 0x12, 0x32, 0x1E, 0x75, 0x20, 0xFF, 0x12, 0x58, - 0x10, 0x51, 0xCC, 0x12, 0x6D, 0x75, 0xE4, 0xFF, 0x02, 0x42, 0x9E, 0xE4, 0x90, 0x80, 0x3C, 0x31, - 0x54, 0xA3, 0xF0, 0x22, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x31, 0x6F, 0x12, 0x6C, - 0xC2, 0x51, 0x11, 0x12, 0x74, 0xF2, 0x12, 0x76, 0x9E, 0x12, 0x75, 0xBF, 0x02, 0x45, 0x48, 0xE4, - 0xFD, 0xFF, 0x12, 0x76, 0xE6, 0xED, 0x70, 0x12, 0x31, 0xAE, 0xC0, 0x83, 0xC0, 0x82, 0x31, 0xA6, - 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5E, 0x80, 0x0F, 0x31, 0xAE, 0xC0, 0x83, 0xC0, 0x82, - 0x31, 0xA6, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4E, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x31, 0xB9, - 0x90, 0x81, 0x81, 0xEF, 0xF0, 0x22, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x07, 0x08, 0x22, 0x74, 0x79, - 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, - 0x7D, 0x08, 0xED, 0x14, 0xF9, 0x24, 0x79, 0x31, 0xB1, 0xE0, 0x60, 0x3C, 0x7C, 0x08, 0xEC, 0x14, - 0x90, 0x82, 0xD7, 0xF0, 0x74, 0x79, 0x29, 0x31, 0xB1, 0xE0, 0xFB, 0x7A, 0x00, 0x90, 0x82, 0xD7, - 0xE0, 0xFF, 0x12, 0x67, 0x48, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, - 0x5A, 0xFE, 0xEF, 0x5B, 0x4E, 0x60, 0x0F, 0xE9, 0x75, 0xF0, 0x08, 0xA4, 0xFF, 0x90, 0x82, 0xD7, - 0xE0, 0x2F, 0x04, 0xFF, 0x80, 0x06, 0xDC, 0xC6, 0xDD, 0xB8, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, - 0x22, 0x7E, 0x00, 0x7F, 0x01, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x81, 0x79, 0x82, 0x12, 0x45, 0x48, - 0x90, 0x81, 0x82, 0xE0, 0x54, 0xFD, 0xF0, 0xE4, 0x31, 0x55, 0xA3, 0x74, 0x0C, 0xF0, 0x22, 0xF1, - 0xF6, 0x90, 0x80, 0x42, 0xEF, 0xF0, 0x51, 0x4F, 0x90, 0x01, 0x64, 0x74, 0x01, 0xF0, 0x90, 0x00, - 0x12, 0xE0, 0x54, 0xC7, 0x44, 0x20, 0xFD, 0x7F, 0x12, 0x12, 0x32, 0x1E, 0x02, 0x2D, 0xA7, 0x51, - 0x7F, 0x51, 0xA5, 0x12, 0x6C, 0xD0, 0x12, 0x6C, 0xEF, 0xE4, 0xF5, 0x35, 0xF5, 0x36, 0xF5, 0x37, - 0x75, 0x38, 0x80, 0xAD, 0x35, 0x7F, 0x50, 0x12, 0x32, 0x1E, 0xAD, 0x36, 0x7F, 0x51, 0x12, 0x32, - 0x1E, 0xAD, 0x37, 0x7F, 0x52, 0x12, 0x32, 0x1E, 0xAD, 0x38, 0x7F, 0x53, 0x02, 0x32, 0x1E, 0x90, - 0x01, 0x30, 0xE4, 0x31, 0x54, 0x90, 0x01, 0x38, 0x31, 0x54, 0xFD, 0x7F, 0x50, 0x12, 0x32, 0x1E, - 0xE4, 0xFD, 0x7F, 0x51, 0x12, 0x32, 0x1E, 0xE4, 0xFD, 0x7F, 0x52, 0x12, 0x32, 0x1E, 0xE4, 0xFD, - 0x7F, 0x53, 0x02, 0x32, 0x1E, 0x90, 0x01, 0x34, 0x74, 0xFF, 0x31, 0x54, 0x90, 0x01, 0x3C, 0x31, - 0x54, 0xFD, 0x7F, 0x54, 0x12, 0x32, 0x1E, 0x7D, 0xFF, 0x7F, 0x55, 0x12, 0x32, 0x1E, 0x7D, 0xFF, - 0x7F, 0x56, 0x12, 0x32, 0x1E, 0x7D, 0xFF, 0x7F, 0x57, 0x02, 0x32, 0x1E, 0xE4, 0x90, 0x82, 0x08, - 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x98, 0xE0, 0x7F, 0x00, 0x30, 0xE4, 0x02, 0x7F, 0x01, 0xEF, 0x64, - 0x01, 0x60, 0x3D, 0xC3, 0x90, 0x82, 0x09, 0xE0, 0x94, 0x88, 0x90, 0x82, 0x08, 0xE0, 0x94, 0x13, - 0x40, 0x0F, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x01, 0xC7, 0x74, 0xFD, 0xF0, 0x80, - 0x1F, 0x90, 0x82, 0x08, 0x12, 0x63, 0x7D, 0x12, 0x67, 0x41, 0xD3, 0x90, 0x82, 0x09, 0xE0, 0x94, - 0x32, 0x90, 0x82, 0x08, 0xE0, 0x94, 0x00, 0x40, 0xBA, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE3, 0xB3, - 0x90, 0x01, 0xC7, 0x74, 0xFE, 0xF0, 0x22, 0x8B, 0x52, 0x8A, 0x53, 0x89, 0x54, 0x71, 0x87, 0xFF, - 0xF5, 0x56, 0x12, 0x1F, 0xA4, 0xFE, 0xC3, 0x13, 0x30, 0xE0, 0x06, 0xB1, 0x5F, 0xF5, 0x57, 0x80, - 0x02, 0x8F, 0x57, 0x85, 0x56, 0x55, 0xE5, 0x55, 0xD3, 0x95, 0x57, 0x50, 0x24, 0xAB, 0x52, 0xAA, - 0x53, 0xA9, 0x54, 0x12, 0x1F, 0xA4, 0x54, 0x01, 0xFD, 0xAF, 0x55, 0x31, 0x72, 0xAF, 0x55, 0x12, - 0x47, 0x79, 0xEF, 0xAF, 0x55, 0x70, 0x04, 0xF1, 0xE6, 0x80, 0x02, 0xF1, 0xE5, 0x05, 0x55, 0x80, - 0xD5, 0xE5, 0x56, 0x70, 0x10, 0xFF, 0x12, 0x47, 0x79, 0xEF, 0x70, 0x09, 0x12, 0x58, 0x87, 0x54, - 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x22, 0xF0, 0x90, 0x00, 0x01, 0x02, 0x1F, 0xBD, 0xF1, 0xCD, 0x54, - 0x01, 0xFE, 0x90, 0x81, 0xF0, 0xF1, 0xE7, 0xFF, 0xF0, 0x12, 0x1F, 0xA4, 0xFE, 0x54, 0x04, 0x25, - 0xE0, 0xFD, 0xEF, 0x54, 0xF7, 0x4D, 0xFF, 0x90, 0x81, 0xF0, 0xF0, 0xEE, 0x54, 0x08, 0x25, 0xE0, - 0xFE, 0xEF, 0x54, 0xEF, 0x4E, 0xF0, 0x90, 0x05, 0x52, 0xE0, 0x54, 0x07, 0xFF, 0x90, 0x82, 0x79, - 0x60, 0x15, 0x12, 0x45, 0x10, 0x71, 0x87, 0xFD, 0x90, 0x05, 0x56, 0xE0, 0xC3, 0x9D, 0x90, 0x81, - 0xF2, 0xF0, 0xA3, 0xED, 0xF0, 0x80, 0x25, 0x12, 0x45, 0x10, 0x71, 0x87, 0xFB, 0xFF, 0x90, 0x05, - 0x54, 0xE0, 0xC3, 0x9F, 0xFF, 0xE4, 0x94, 0x00, 0xFE, 0x7C, 0x00, 0x7D, 0x05, 0x12, 0x20, 0x30, - 0x90, 0x81, 0xF2, 0xEF, 0xF0, 0xEB, 0x75, 0xF0, 0x05, 0x84, 0xA3, 0xF0, 0x90, 0x82, 0x79, 0x12, - 0x45, 0x10, 0x12, 0x1F, 0xA4, 0x20, 0xE0, 0x0A, 0x12, 0x4F, 0x0E, 0x90, 0x01, 0x57, 0xE4, 0xF0, - 0x80, 0x07, 0x12, 0x4E, 0x91, 0x12, 0x6F, 0x9B, 0xF0, 0x90, 0x81, 0xF0, 0xE0, 0xFF, 0xC4, 0x54, - 0x0F, 0x20, 0xE0, 0x04, 0xEF, 0x54, 0xDF, 0xF0, 0x12, 0x6F, 0x1F, 0x30, 0xE0, 0x16, 0x90, 0x81, - 0x8C, 0x74, 0x01, 0xF0, 0xE4, 0x90, 0x81, 0x8E, 0xF0, 0x12, 0x76, 0xC6, 0xF0, 0x90, 0x05, 0x58, - 0x74, 0x05, 0xF0, 0x22, 0xE4, 0x90, 0x81, 0x8C, 0xF0, 0x90, 0x81, 0x8E, 0x74, 0x0C, 0xF0, 0x90, - 0x81, 0x87, 0xE0, 0x54, 0xFE, 0xF0, 0xA3, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x90, 0x82, 0x76, 0x12, - 0x45, 0x19, 0x90, 0x82, 0x75, 0xEF, 0xF0, 0x12, 0x45, 0x22, 0x54, 0x8C, 0x00, 0x54, 0x94, 0x01, - 0x54, 0x9C, 0x12, 0x54, 0xA5, 0x14, 0x54, 0xAE, 0x20, 0x54, 0xB6, 0x24, 0x54, 0xBF, 0x25, 0x54, - 0xC8, 0x26, 0x54, 0xD0, 0x27, 0x54, 0xD8, 0xC0, 0x00, 0x00, 0x54, 0xE0, 0x90, 0x82, 0x76, 0x12, - 0x45, 0x10, 0xA1, 0x1A, 0x90, 0x82, 0x76, 0x12, 0x45, 0x10, 0x61, 0x27, 0x90, 0x82, 0x76, 0x12, - 0x45, 0x10, 0x02, 0x6C, 0x06, 0x90, 0x82, 0x76, 0x12, 0x45, 0x10, 0x02, 0x6C, 0xAB, 0x90, 0x82, - 0x76, 0x12, 0x45, 0x10, 0xA1, 0x65, 0x90, 0x82, 0x76, 0x12, 0x45, 0x10, 0x02, 0x4A, 0x4D, 0x90, - 0x82, 0x76, 0x12, 0x45, 0x10, 0x02, 0x6C, 0xBA, 0x90, 0x82, 0x76, 0x12, 0x45, 0x10, 0x61, 0x8D, - 0x90, 0x82, 0x76, 0x12, 0x45, 0x10, 0x80, 0x18, 0x90, 0x82, 0x76, 0x12, 0x45, 0x10, 0xE1, 0xD8, - 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x82, 0x75, 0xE0, 0x90, 0x01, 0xC2, 0xF0, 0x22, - 0x12, 0x1F, 0xA4, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x81, 0xF7, 0xF1, 0xE7, 0x71, 0x86, 0x90, 0x81, - 0xF8, 0xB1, 0x5E, 0x90, 0x81, 0xF9, 0xF0, 0x90, 0x81, 0xF8, 0xE0, 0x14, 0x90, 0x81, 0xFA, 0xF0, - 0x90, 0x81, 0xF7, 0xE0, 0x54, 0x01, 0xFF, 0x02, 0x48, 0xC8, 0x90, 0x02, 0x09, 0xE0, 0xF5, 0x52, - 0x12, 0x1F, 0xA4, 0x25, 0x52, 0x90, 0x80, 0x85, 0x71, 0x86, 0x25, 0x52, 0x90, 0x80, 0x86, 0xB1, - 0x5E, 0x25, 0x52, 0x90, 0x80, 0x87, 0xF1, 0xBE, 0x25, 0x52, 0x90, 0x80, 0x88, 0xF1, 0xB7, 0x25, - 0x52, 0x90, 0x80, 0x89, 0xF0, 0x90, 0x00, 0x05, 0x12, 0x1F, 0xBD, 0x25, 0x52, 0x90, 0x80, 0x8A, - 0xF0, 0x90, 0x00, 0x06, 0x12, 0x1F, 0xBD, 0x25, 0x52, 0x90, 0x80, 0x8B, 0xF0, 0x22, 0xF0, 0x90, - 0x00, 0x02, 0x02, 0x1F, 0xBD, 0xF1, 0xCD, 0x54, 0x7F, 0x90, 0x81, 0x8C, 0xF0, 0xEF, 0x12, 0x70, - 0xF0, 0xA3, 0x71, 0x86, 0xFF, 0x54, 0xF0, 0xC4, 0x54, 0x0F, 0xFE, 0x90, 0x81, 0x8A, 0xE0, 0x54, - 0xF0, 0x4E, 0xF1, 0xBE, 0x54, 0x01, 0x25, 0xE0, 0xFE, 0x90, 0x81, 0x87, 0xE0, 0x54, 0xFD, 0x4E, - 0xF0, 0xEF, 0x54, 0x0F, 0xC4, 0x54, 0xF0, 0xFF, 0xB1, 0xFA, 0x4F, 0xB1, 0x5E, 0x90, 0x81, 0x8B, - 0xF1, 0xB7, 0xFD, 0x7F, 0x02, 0x12, 0x4E, 0x95, 0x90, 0x82, 0x79, 0x12, 0x45, 0x10, 0xB1, 0xC1, - 0x12, 0x70, 0xB7, 0xF0, 0x90, 0x81, 0x8C, 0x12, 0x76, 0xCD, 0xB1, 0xF9, 0x90, 0x01, 0xBE, 0xF0, - 0x22, 0x90, 0x82, 0x7C, 0x12, 0x45, 0x19, 0x12, 0x75, 0xCC, 0x90, 0x81, 0x8C, 0xE0, 0xFF, 0x12, - 0x4E, 0x14, 0x90, 0x81, 0x8C, 0xE0, 0x60, 0x1A, 0x90, 0x82, 0x7C, 0x12, 0x45, 0x10, 0x71, 0x87, - 0x54, 0x0F, 0xFF, 0xB1, 0x5F, 0xFD, 0x12, 0x75, 0xF2, 0x12, 0x72, 0x1F, 0x74, 0x01, 0xF0, 0x12, - 0x70, 0xF7, 0x22, 0x90, 0x81, 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x81, 0x8A, 0xE0, 0x54, 0x0F, - 0x22, 0x90, 0x06, 0xA9, 0xE0, 0x90, 0x82, 0x01, 0xF0, 0xE0, 0xFD, 0x54, 0xC0, 0x70, 0x04, 0xD1, - 0x69, 0x80, 0x52, 0xED, 0x30, 0xE6, 0x3D, 0x90, 0x81, 0x8C, 0xE0, 0x64, 0x02, 0x70, 0x27, 0x90, - 0x81, 0x87, 0xE0, 0xFF, 0xC3, 0x13, 0x20, 0xE0, 0x09, 0x90, 0x81, 0x90, 0xE0, 0x44, 0x01, 0xF0, - 0x80, 0x1A, 0xB1, 0xFA, 0x64, 0x01, 0x70, 0x1E, 0x90, 0x81, 0x90, 0xE0, 0x44, 0x04, 0xF0, 0x7F, - 0x01, 0x12, 0x64, 0xAE, 0x80, 0x10, 0xB1, 0xF3, 0x64, 0x02, 0x60, 0x04, 0xF1, 0x59, 0x80, 0x06, - 0xF1, 0x2F, 0x80, 0x02, 0xD1, 0x69, 0x90, 0x82, 0x01, 0xE0, 0x90, 0x81, 0x90, 0x30, 0xE7, 0x04, - 0xD1, 0xB1, 0xE1, 0xC5, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, 0x81, 0x90, 0xE0, 0x54, 0xFE, 0xF0, - 0x22, 0x90, 0x06, 0xA9, 0xE0, 0xF5, 0x4E, 0x54, 0xC0, 0x70, 0x08, 0xD1, 0x69, 0x54, 0xFD, 0xF0, - 0x02, 0x58, 0x5D, 0xE5, 0x4E, 0x30, 0xE6, 0x16, 0x90, 0x81, 0x8C, 0xE0, 0x64, 0x01, 0x70, 0x10, - 0xB1, 0xF3, 0x64, 0x02, 0x60, 0x04, 0xF1, 0x59, 0x80, 0x06, 0xF1, 0x2F, 0x80, 0x02, 0xD1, 0x69, - 0xE5, 0x4E, 0x90, 0x81, 0x90, 0x30, 0xE7, 0x04, 0xD1, 0xB1, 0xE1, 0xC5, 0xE0, 0x54, 0xFD, 0xF0, - 0x22, 0xE0, 0x44, 0x02, 0xF0, 0xE4, 0xF5, 0x1D, 0x90, 0x81, 0xEA, 0xE0, 0xF5, 0x1E, 0xE4, 0xFB, - 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8E, 0x19, 0x8F, 0x1A, - 0xE5, 0x1E, 0x54, 0x07, 0xC4, 0x33, 0x54, 0xE0, 0x85, 0x19, 0x83, 0x85, 0x1A, 0x82, 0xF0, 0xE5, - 0x1D, 0xF1, 0x27, 0xE5, 0x1E, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x4F, 0xA3, 0xF0, 0xEB, 0xF1, 0x27, - 0xE5, 0x1D, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x4F, 0xF1, 0x1F, 0xA3, 0xF0, 0xBD, 0x01, 0x0D, 0x85, - 0x1A, 0x82, 0x8E, 0x83, 0xA3, 0xA3, 0xA3, 0x74, 0x03, 0xF0, 0x80, 0x07, 0xF1, 0x1F, 0xA3, 0xA3, - 0x74, 0x01, 0xF0, 0xF1, 0x1F, 0xA3, 0xA3, 0x74, 0x05, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x85, - 0x1A, 0x82, 0x85, 0x19, 0x83, 0xA3, 0x22, 0x54, 0x07, 0xC4, 0x33, 0x54, 0xE0, 0xFF, 0x22, 0xF1, - 0x80, 0x90, 0x81, 0x8F, 0xE0, 0x64, 0x0C, 0x60, 0x06, 0x12, 0x5A, 0x83, 0x12, 0x65, 0xBE, 0x22, - 0xE4, 0xFF, 0x12, 0x47, 0x79, 0xBF, 0x01, 0x10, 0x90, 0x81, 0x8C, 0xE0, 0x60, 0x0A, 0xB1, 0xFA, - 0x64, 0x02, 0x60, 0x02, 0x80, 0x03, 0xF1, 0x2F, 0x22, 0x90, 0x04, 0x1D, 0xE0, 0x70, 0x20, 0x90, - 0x80, 0x86, 0xE0, 0xFF, 0x90, 0x82, 0xBE, 0x74, 0x09, 0xF0, 0x7B, 0x18, 0xE4, 0xFD, 0x12, 0x65, - 0x2B, 0x90, 0x82, 0x02, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x22, - 0x12, 0x77, 0x2D, 0x54, 0x1F, 0x30, 0xE0, 0x05, 0x90, 0x01, 0x5B, 0xE4, 0xF0, 0x90, 0x06, 0x92, - 0x74, 0x02, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x04, 0xF0, 0xE4, 0xF5, 0x1D, 0x90, 0x81, 0xEB, 0xE0, - 0xC3, 0x13, 0x54, 0x7F, 0xF5, 0x1E, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, 0x01, 0xD1, 0xC5, 0x90, - 0x81, 0x87, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0xF0, 0x90, 0x00, 0x04, 0x02, 0x1F, 0xBD, 0xF0, 0x90, - 0x00, 0x03, 0x02, 0x1F, 0xBD, 0x90, 0x81, 0x87, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x90, 0x82, 0x79, - 0x12, 0x45, 0x19, 0x12, 0x1F, 0xA4, 0xFF, 0x22, 0x12, 0x1F, 0xA4, 0x90, 0x81, 0xFC, 0x71, 0x86, - 0x90, 0x81, 0xFD, 0xF0, 0x22, 0x22, 0x22, 0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x02, - 0xFF, 0xEE, 0x54, 0xFD, 0x4F, 0x22, 0x90, 0x00, 0xF7, 0xE0, 0x20, 0xE7, 0x09, 0xE0, 0x7F, 0x01, - 0x20, 0xE6, 0x0C, 0x7F, 0x02, 0x22, 0x90, 0x00, 0xF7, 0xE0, 0x30, 0xE6, 0x02, 0x7F, 0x03, 0x22, - 0x75, 0xE8, 0x03, 0x75, 0xA8, 0x84, 0x22, 0xE4, 0x90, 0x82, 0x10, 0xF0, 0x90, 0x82, 0x10, 0xE0, - 0x64, 0x01, 0xF0, 0x24, 0x17, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x58, 0xA3, 0xF0, 0x90, 0x81, 0x8C, - 0xE0, 0x60, 0x0E, 0x90, 0x81, 0x8F, 0xE0, 0xFF, 0x90, 0x81, 0x8E, 0xE0, 0x6F, 0x60, 0x02, 0x11, - 0x5D, 0xC2, 0xAF, 0x12, 0x6D, 0x4E, 0xBF, 0x01, 0x02, 0xF1, 0x89, 0xD2, 0xAF, 0xF1, 0xC4, 0x12, - 0x32, 0x9E, 0xBF, 0x01, 0x03, 0x12, 0x6B, 0x7C, 0x12, 0x41, 0x4D, 0x80, 0xBF, 0x90, 0x81, 0x82, - 0xE0, 0x90, 0x81, 0x8E, 0x30, 0xE0, 0x04, 0xE0, 0xFF, 0x80, 0x35, 0xE0, 0xFF, 0x7D, 0x01, 0x02, - 0x4B, 0xD6, 0x90, 0x81, 0x8C, 0xE0, 0x60, 0x0E, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, 0x03, 0x02, - 0x57, 0x80, 0x11, 0x8C, 0x11, 0x5D, 0x22, 0x12, 0x4F, 0x84, 0x11, 0x94, 0x90, 0x81, 0x87, 0xE0, - 0x54, 0xF7, 0xF0, 0x22, 0x12, 0x75, 0xB7, 0x51, 0x8A, 0x7D, 0x0C, 0x7F, 0x01, 0x02, 0x4E, 0x95, - 0xAE, 0x07, 0x11, 0xBC, 0xBF, 0x01, 0x12, 0x12, 0x77, 0x05, 0x54, 0x03, 0x20, 0xE0, 0x0A, 0xAF, - 0x06, 0x7D, 0x01, 0x12, 0x4B, 0xD6, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, 0x90, 0x05, 0x43, 0xE0, - 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x11, - 0xBC, 0xBF, 0x01, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x02, 0x11, 0xE1, 0xD0, 0xD0, 0x92, 0xAF, - 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x81, 0x85, 0xE0, 0xF5, 0x1F, 0xE5, 0x1F, - 0x6F, 0x70, 0x02, 0x21, 0xBD, 0xEF, 0x14, 0x60, 0x38, 0x14, 0x60, 0x59, 0x14, 0x60, 0x79, 0x14, - 0x70, 0x02, 0x21, 0x9C, 0x24, 0x04, 0x60, 0x02, 0x21, 0xBD, 0xE5, 0x1F, 0xB4, 0x04, 0x04, 0x51, - 0x68, 0x21, 0xBD, 0xE5, 0x1F, 0xB4, 0x02, 0x04, 0x51, 0x90, 0x21, 0xBD, 0xE5, 0x1F, 0xB4, 0x03, - 0x04, 0x51, 0x73, 0x21, 0xBD, 0xE5, 0x1F, 0x64, 0x01, 0x60, 0x02, 0x21, 0xBD, 0x51, 0x6A, 0x21, - 0xBD, 0xE5, 0x1F, 0xB4, 0x04, 0x04, 0x51, 0x7C, 0x21, 0xBD, 0xE5, 0x1F, 0xB4, 0x02, 0x05, 0x12, - 0x4F, 0xF1, 0x80, 0x79, 0xE5, 0x1F, 0xB4, 0x03, 0x04, 0x51, 0x77, 0x80, 0x70, 0xE5, 0x1F, 0x70, - 0x6C, 0x31, 0xDD, 0x80, 0x68, 0xE5, 0x1F, 0xB4, 0x04, 0x04, 0x51, 0x4E, 0x80, 0x5F, 0xE5, 0x1F, - 0xB4, 0x01, 0x04, 0x31, 0xE2, 0x80, 0x56, 0xE5, 0x1F, 0xB4, 0x03, 0x04, 0x31, 0xC2, 0x80, 0x4D, - 0xE5, 0x1F, 0x70, 0x49, 0x31, 0xE0, 0x80, 0x45, 0xE5, 0x1F, 0xB4, 0x04, 0x04, 0xF1, 0x61, 0x80, - 0x3C, 0xE5, 0x1F, 0xB4, 0x01, 0x04, 0x51, 0x56, 0x80, 0x33, 0xE5, 0x1F, 0xB4, 0x02, 0x05, 0x12, - 0x76, 0xAF, 0x80, 0x29, 0xE5, 0x1F, 0x70, 0x25, 0x51, 0x54, 0x80, 0x21, 0xE5, 0x1F, 0xB4, 0x03, - 0x04, 0x51, 0x64, 0x80, 0x18, 0xE5, 0x1F, 0xB4, 0x01, 0x04, 0x31, 0xC4, 0x80, 0x0F, 0xE5, 0x1F, - 0xB4, 0x02, 0x04, 0xF1, 0x31, 0x80, 0x06, 0xE5, 0x1F, 0x70, 0x02, 0x31, 0xD9, 0xD0, 0xD0, 0x92, - 0xAF, 0x22, 0x80, 0x25, 0x7D, 0x1F, 0x7F, 0x6F, 0x12, 0x4F, 0x13, 0x90, 0x05, 0x27, 0xE0, 0x54, - 0xBF, 0xF0, 0x90, 0x81, 0x85, 0x74, 0x04, 0xF0, 0x22, 0x31, 0xDD, 0x80, 0xE7, 0x02, 0x4F, 0xF3, - 0x31, 0xDD, 0x7D, 0x20, 0x7F, 0xFF, 0x12, 0x4F, 0x13, 0x31, 0xF2, 0x90, 0x81, 0x85, 0x74, 0x02, - 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x64, 0x4E, 0x90, 0x85, 0xBB, 0x12, - 0x20, 0xDA, 0xCC, 0xF0, 0x00, 0xC0, 0xF1, 0xD3, 0x90, 0x85, 0xBB, 0x12, 0x20, 0xDA, 0x00, 0x00, - 0x00, 0x14, 0x12, 0x76, 0xF2, 0x12, 0x20, 0xDA, 0x00, 0x00, 0x00, 0x00, 0xE4, 0xFD, 0xFF, 0xF1, - 0x0F, 0xF1, 0xCC, 0xEC, 0x44, 0x80, 0xFC, 0x90, 0x82, 0xC3, 0x12, 0x20, 0xCE, 0x90, 0x82, 0xC3, - 0x12, 0x44, 0xD3, 0x51, 0x96, 0xF1, 0xC5, 0x90, 0x01, 0x00, 0x74, 0x3F, 0xF0, 0xA3, 0xE0, 0x54, - 0xFD, 0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, 0x20, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF1, 0x38, - 0x7D, 0x23, 0x80, 0x90, 0x31, 0xDD, 0x7D, 0x21, 0x7F, 0xFF, 0x12, 0x4F, 0x13, 0x90, 0x81, 0x85, - 0x74, 0x03, 0xF0, 0x22, 0x7D, 0x25, 0x21, 0xC6, 0x51, 0x7C, 0x12, 0x76, 0x36, 0xE4, 0x90, 0x81, - 0x85, 0xF0, 0x22, 0x51, 0x77, 0x80, 0xF3, 0x51, 0x8A, 0x02, 0x4F, 0xF3, 0x51, 0x8A, 0xF1, 0x38, - 0x02, 0x4F, 0xF3, 0xE4, 0xFD, 0x7F, 0x0C, 0x12, 0x4B, 0xD6, 0xE4, 0xFD, 0xFF, 0x02, 0x4F, 0x13, - 0x12, 0x4F, 0xF1, 0x80, 0xD5, 0xFC, 0x90, 0x85, 0xBB, 0x02, 0x20, 0xCE, 0x90, 0x82, 0x93, 0xEF, - 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0x12, 0x20, 0xDA, 0x00, 0x00, 0x00, 0x00, 0xE4, 0x90, 0x82, 0xA1, - 0xF0, 0x7F, 0x24, 0x7E, 0x08, 0x12, 0x2D, 0x5C, 0x90, 0x82, 0x99, 0x12, 0x20, 0xCE, 0x90, 0x82, - 0x93, 0xE0, 0xFB, 0x70, 0x08, 0x90, 0x82, 0x99, 0x12, 0x44, 0xD3, 0x80, 0x06, 0xEB, 0x71, 0x7F, - 0x12, 0x2D, 0x5C, 0x90, 0x82, 0x9D, 0x12, 0x20, 0xCE, 0x90, 0x82, 0x94, 0x71, 0xD3, 0x78, 0x17, - 0xF1, 0x48, 0x90, 0x82, 0x9D, 0x12, 0x44, 0xD3, 0xED, 0x54, 0x7F, 0xFD, 0xEC, 0x54, 0x80, 0xFC, - 0x12, 0x44, 0xC6, 0xEC, 0x44, 0x80, 0xFC, 0x90, 0x82, 0x9D, 0x12, 0x20, 0xCE, 0x71, 0x92, 0x54, - 0x7F, 0x51, 0x95, 0x71, 0x9A, 0x71, 0x7F, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x82, 0x9D, 0x12, 0x44, - 0xD3, 0x51, 0x96, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x2E, 0xA2, 0x71, 0x92, 0x44, 0x80, 0x51, 0x95, - 0x71, 0x9A, 0x70, 0x04, 0x7F, 0x20, 0x80, 0x09, 0x90, 0x82, 0x93, 0xE0, 0xB4, 0x01, 0x16, 0x7F, - 0x28, 0x7E, 0x08, 0x12, 0x2D, 0x5C, 0x78, 0x08, 0x12, 0x20, 0xA8, 0xEF, 0x54, 0x01, 0xFF, 0xE4, - 0x90, 0x82, 0xA1, 0xEF, 0xF0, 0x90, 0x82, 0xA1, 0xE0, 0x90, 0x82, 0x93, 0x60, 0x0E, 0xE0, 0x75, - 0xF0, 0x08, 0xA4, 0x24, 0x66, 0xF5, 0x82, 0xE4, 0x34, 0x87, 0x80, 0x0C, 0xE0, 0x75, 0xF0, 0x08, - 0xA4, 0x24, 0x64, 0xF5, 0x82, 0xE4, 0x34, 0x87, 0x71, 0x8A, 0x12, 0x2D, 0x5C, 0xED, 0x54, 0x0F, - 0xFD, 0xE4, 0xFC, 0x90, 0x82, 0x95, 0x12, 0x20, 0xCE, 0x90, 0x82, 0x95, 0x02, 0x44, 0xD3, 0x75, - 0xF0, 0x08, 0xA4, 0x24, 0x62, 0xF5, 0x82, 0xE4, 0x34, 0x87, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0xE0, - 0xFF, 0x22, 0x90, 0x82, 0x99, 0x12, 0x44, 0xD3, 0xEC, 0x22, 0x7F, 0x24, 0x7E, 0x08, 0x12, 0x2E, - 0xA2, 0x90, 0x82, 0x93, 0xE0, 0x22, 0x90, 0x82, 0x21, 0xE0, 0x24, 0x33, 0xF5, 0x82, 0xE4, 0x34, - 0x82, 0xF5, 0x83, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x78, 0x08, 0x12, 0x20, 0xBB, 0xA8, 0x04, - 0xA9, 0x05, 0xAA, 0x06, 0xAB, 0x07, 0x90, 0x82, 0x21, 0xE0, 0x24, 0x32, 0xF5, 0x82, 0xE4, 0x34, - 0x82, 0xF5, 0x83, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x22, 0xE4, 0x90, 0x82, 0x21, 0xF0, 0x90, - 0x87, 0x5F, 0xE0, 0x90, 0x82, 0x20, 0xF0, 0xE4, 0x90, 0x82, 0x2D, 0xF0, 0x90, 0x82, 0x1D, 0xF0, - 0x90, 0x82, 0x1D, 0xE0, 0xFF, 0xC3, 0x94, 0x40, 0x50, 0x10, 0x74, 0x30, 0x2F, 0xF1, 0x40, 0x74, - 0xFF, 0xF0, 0x90, 0x82, 0x1D, 0xE0, 0x04, 0xF0, 0x80, 0xE6, 0xE4, 0x90, 0x82, 0x1D, 0xF0, 0x90, - 0x82, 0x20, 0xE0, 0xFF, 0x90, 0x82, 0x1D, 0xE0, 0xFE, 0xC3, 0x9F, 0x40, 0x02, 0x81, 0xDA, 0x74, - 0xDF, 0x2E, 0xF9, 0xE4, 0x34, 0x86, 0xD1, 0xAF, 0x75, 0x16, 0x0A, 0x7B, 0x01, 0x7A, 0x82, 0x79, - 0x12, 0x12, 0x2B, 0xED, 0x90, 0x82, 0x13, 0xE0, 0xFF, 0x12, 0x2F, 0x27, 0xEF, 0x04, 0x90, 0x82, - 0x2D, 0xF0, 0x90, 0x82, 0x12, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x12, 0x31, 0xEA, 0xEF, 0x24, 0xC8, - 0x90, 0x82, 0x2F, 0xF0, 0x75, 0xF0, 0x08, 0xA4, 0xF0, 0x90, 0x82, 0x13, 0xE0, 0x54, 0x0F, 0x90, - 0x82, 0x2E, 0xF0, 0xE4, 0x90, 0x82, 0x1C, 0xF0, 0x90, 0x82, 0x1E, 0xF0, 0x90, 0x82, 0x1E, 0xE0, - 0xFF, 0xC3, 0x94, 0x04, 0x50, 0x57, 0x90, 0x82, 0x2E, 0xE0, 0xFE, 0xA8, 0x07, 0x08, 0x80, 0x02, - 0xC3, 0x13, 0xD8, 0xFC, 0x20, 0xE0, 0x3E, 0x90, 0x82, 0x1E, 0xE0, 0x25, 0xE0, 0xFF, 0x90, 0x82, - 0x2F, 0xE0, 0x2F, 0x24, 0x30, 0xF9, 0xE4, 0x34, 0x82, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x01, - 0x90, 0x82, 0x1C, 0xE0, 0x75, 0xF0, 0x02, 0xA4, 0x24, 0x14, 0xF9, 0x74, 0x82, 0x35, 0xF0, 0x8B, - 0x13, 0xF5, 0x14, 0x89, 0x15, 0x75, 0x16, 0x02, 0xD0, 0x01, 0xD0, 0x03, 0x12, 0x2B, 0xED, 0x90, - 0x82, 0x1C, 0xE0, 0x04, 0xF0, 0x90, 0x82, 0x1E, 0xE0, 0x04, 0xF0, 0x80, 0x9F, 0x90, 0x82, 0x2D, - 0xE0, 0xFF, 0x90, 0x82, 0x1D, 0xE0, 0x2F, 0xF0, 0x81, 0x0F, 0xE4, 0x90, 0x82, 0x21, 0xF0, 0x90, - 0x82, 0x21, 0xE0, 0xC3, 0x94, 0x40, 0x40, 0x02, 0xC1, 0x90, 0xE0, 0xFF, 0x24, 0x30, 0xF1, 0x40, - 0xE0, 0x90, 0x82, 0x23, 0xF0, 0xE0, 0xFE, 0x54, 0xF0, 0xC4, 0x54, 0x0F, 0xFD, 0x90, 0x82, 0x22, - 0xF0, 0xEE, 0x54, 0x0F, 0xFE, 0xA3, 0xF0, 0x74, 0x31, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, - 0x83, 0xE0, 0x90, 0x82, 0x24, 0xF0, 0xFC, 0xEE, 0xFE, 0xEC, 0xFB, 0xEB, 0xFF, 0x90, 0x82, 0x29, - 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xED, 0x12, 0x45, 0x22, 0x5D, 0x4E, 0x00, 0x5D, 0x80, 0x01, 0x5D, - 0xF4, 0x02, 0x5E, 0x81, 0x03, 0x5D, 0xFF, 0x04, 0x5E, 0x10, 0x05, 0x5E, 0x10, 0x06, 0x5E, 0x10, - 0x07, 0x5E, 0x10, 0x08, 0x5E, 0x5E, 0x09, 0x5E, 0x6F, 0x0A, 0x00, 0x00, 0x5E, 0x90, 0x90, 0x82, - 0x21, 0xE0, 0xFD, 0x24, 0x33, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0xE0, 0xFE, 0x74, 0x32, - 0x2D, 0xD1, 0x9C, 0xE0, 0xFD, 0xED, 0xFF, 0x90, 0x82, 0x2B, 0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, - 0x90, 0x82, 0x24, 0xE0, 0xFF, 0x12, 0x2F, 0x96, 0x90, 0x82, 0x1F, 0x74, 0x02, 0xF0, 0xC1, 0x81, - 0x71, 0xA6, 0x12, 0x44, 0xC6, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x82, 0x21, - 0xE0, 0x24, 0x34, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0x71, 0xD1, 0x78, 0x10, 0x12, 0x20, 0xBB, 0xD0, - 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x44, 0xC6, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, - 0xC0, 0x07, 0x90, 0x82, 0x21, 0xE0, 0x24, 0x35, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0x71, 0xD1, 0x78, - 0x18, 0x12, 0x20, 0xBB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x44, 0xC6, 0x90, - 0x82, 0x25, 0x12, 0x20, 0xCE, 0x90, 0x82, 0x25, 0x12, 0x44, 0xD3, 0x90, 0x85, 0x96, 0x12, 0x20, - 0xCE, 0x90, 0x82, 0x29, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x2E, 0xE4, 0x90, 0x82, 0x1F, 0x74, - 0x04, 0xF0, 0xC1, 0x81, 0xD1, 0x91, 0xE0, 0xFB, 0xE4, 0xFF, 0x12, 0x30, 0xC7, 0x80, 0x09, 0xD1, - 0x91, 0xE0, 0xFB, 0xE4, 0xFF, 0x12, 0x30, 0x6A, 0x90, 0x82, 0x1F, 0x74, 0x01, 0xF0, 0x80, 0x71, - 0x90, 0x82, 0x1F, 0x74, 0x02, 0xF0, 0x71, 0xA6, 0x12, 0x44, 0xC6, 0xC0, 0x04, 0xC0, 0x05, 0xC0, - 0x06, 0xC0, 0x07, 0x90, 0x82, 0x23, 0x71, 0xD3, 0x78, 0x10, 0x12, 0x20, 0xBB, 0xD0, 0x03, 0xD0, - 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x44, 0xC6, 0x90, 0x82, 0x25, 0x12, 0x20, 0xCE, 0x90, 0x82, - 0x22, 0xE0, 0x24, 0xFB, 0xFF, 0xC0, 0x07, 0x90, 0x82, 0x25, 0x12, 0x44, 0xD3, 0x90, 0x82, 0xAE, - 0x12, 0x20, 0xCE, 0x90, 0x82, 0x24, 0xE0, 0xFD, 0xD0, 0x07, 0xF1, 0x0F, 0x80, 0x23, 0x90, 0x82, - 0x1F, 0x74, 0x01, 0xD1, 0xA4, 0x75, 0x16, 0x01, 0xF1, 0x71, 0xF0, 0x7B, 0x04, 0x80, 0x0F, 0x90, - 0x82, 0x1F, 0x74, 0x04, 0xD1, 0xA4, 0x75, 0x16, 0x04, 0xF1, 0x71, 0xF0, 0x7B, 0x06, 0x12, 0x67, - 0xC0, 0x90, 0x82, 0x1F, 0xE0, 0x24, 0x02, 0xFF, 0x90, 0x82, 0x21, 0xE0, 0x2F, 0xF0, 0x81, 0xDF, - 0x22, 0x90, 0x82, 0x24, 0xE0, 0xFD, 0x90, 0x82, 0x21, 0xE0, 0x24, 0x32, 0xF5, 0x82, 0xE4, 0x34, - 0x82, 0xF5, 0x83, 0x22, 0xF0, 0x90, 0x82, 0x21, 0xE0, 0x24, 0x32, 0xF9, 0xE4, 0x34, 0x82, 0x75, - 0x13, 0x01, 0xF5, 0x14, 0x89, 0x15, 0x22, 0x90, 0x82, 0xA2, 0xEF, 0xF0, 0xAB, 0x05, 0x90, 0x82, - 0xA8, 0x12, 0x20, 0xDA, 0x00, 0x00, 0x00, 0x00, 0xAF, 0x03, 0xE4, 0xFC, 0xFD, 0xFE, 0x78, 0x14, - 0xF1, 0x48, 0x90, 0x82, 0xA4, 0x12, 0x44, 0xD3, 0xED, 0x54, 0x0F, 0xFD, 0xE4, 0xFC, 0x12, 0x44, - 0xC6, 0xEC, 0x54, 0x0F, 0xFC, 0x90, 0x82, 0xA8, 0x12, 0x20, 0xCE, 0x90, 0x82, 0xA2, 0xE0, 0x75, - 0xF0, 0x08, 0xA4, 0x24, 0x60, 0xF5, 0x82, 0xE4, 0x34, 0x87, 0x71, 0x8A, 0xC0, 0x06, 0xC0, 0x07, - 0x90, 0x82, 0xA8, 0x12, 0x44, 0xD3, 0x51, 0x96, 0xD0, 0x07, 0xD0, 0x06, 0x02, 0x2E, 0xA2, 0xD3, - 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xC0, 0x07, 0xC0, 0x05, 0x90, 0x82, 0xAE, 0x12, 0x44, 0xD3, - 0x90, 0x82, 0xA4, 0x12, 0x20, 0xCE, 0xD0, 0x05, 0xD0, 0x07, 0xD1, 0xB7, 0xD0, 0xD0, 0x92, 0xAF, - 0x22, 0x12, 0x4F, 0x84, 0x7D, 0x24, 0x21, 0xC6, 0x90, 0x05, 0x27, 0xE0, 0x44, 0x40, 0xF0, 0x22, - 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0x22, 0x12, 0x20, 0xBB, 0xA8, 0x04, 0xA9, 0x05, 0xAA, - 0x06, 0xAB, 0x07, 0x22, 0x51, 0x8A, 0xF1, 0xDB, 0xF1, 0x38, 0x90, 0x81, 0x86, 0x74, 0x04, 0xF0, - 0x22, 0x7D, 0x22, 0x7F, 0xFF, 0x12, 0x4F, 0x13, 0xF1, 0x38, 0x90, 0x81, 0x85, 0x74, 0x03, 0xF0, - 0x22, 0x7B, 0xFE, 0x7A, 0x80, 0x79, 0x33, 0x12, 0x2B, 0xED, 0x90, 0x82, 0x24, 0xE0, 0xFF, 0x90, - 0x82, 0x23, 0xE0, 0xFD, 0xE4, 0x90, 0x82, 0x73, 0x22, 0x90, 0x81, 0x87, 0xE0, 0x30, 0xE0, 0x19, - 0x90, 0x81, 0x82, 0xE0, 0xFF, 0x30, 0xE0, 0x0F, 0xC3, 0x13, 0x30, 0xE0, 0x08, 0x12, 0x76, 0xB9, - 0xBF, 0x01, 0x06, 0x80, 0x02, 0x80, 0x00, 0xF1, 0xAA, 0x22, 0x90, 0x81, 0x8F, 0xE0, 0xFF, 0x60, - 0x03, 0xB4, 0x08, 0x0F, 0x12, 0x73, 0xAE, 0xBF, 0x01, 0x09, 0x12, 0x63, 0xF2, 0x90, 0x01, 0xE5, - 0xE0, 0x04, 0xF0, 0x22, 0x22, 0x7F, 0x7C, 0x7E, 0x08, 0x02, 0x2E, 0xA2, 0x7F, 0x7C, 0x7E, 0x08, - 0x02, 0x2D, 0x5C, 0x7F, 0x8C, 0x7E, 0x08, 0x02, 0x2E, 0xA2, 0xF0, 0x7D, 0x04, 0x7F, 0x01, 0x02, - 0x4E, 0x95, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, 0x43, 0x4E, 0x90, 0x82, 0x74, 0xEF, 0xF0, - 0x60, 0xF0, 0x90, 0x80, 0x3C, 0xE0, 0xFF, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0xE5, 0xC2, 0xAF, 0xEF, - 0x30, 0xE1, 0x09, 0x90, 0x80, 0x3C, 0xE0, 0x54, 0xFD, 0xF0, 0x11, 0x21, 0xD2, 0xAF, 0xC2, 0xAF, - 0x90, 0x80, 0x3C, 0xE0, 0xFF, 0x30, 0xE2, 0x05, 0x54, 0xFB, 0xF0, 0x31, 0xB2, 0xD2, 0xAF, 0x80, - 0xD1, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x80, 0xDD, 0xE0, 0xFF, 0x90, 0x80, 0xDC, - 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x70, 0x3F, 0x90, 0x80, 0xDC, - 0xE0, 0xFE, 0x75, 0xF0, 0x08, 0x90, 0x80, 0x8C, 0x12, 0x45, 0x04, 0xE0, 0xFD, 0xEE, 0x75, 0xF0, - 0x08, 0xA4, 0x24, 0x8D, 0xF9, 0x74, 0x80, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xAF, 0x05, 0x12, 0x54, - 0x5C, 0x90, 0x80, 0xDC, 0x31, 0xAB, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, - 0x80, 0xDC, 0xF0, 0x11, 0x81, 0x90, 0x80, 0x3C, 0xE0, 0x44, 0x02, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, - 0x22, 0x90, 0x01, 0xCC, 0xE0, 0x54, 0x0F, 0x90, 0x82, 0xD4, 0xF0, 0x90, 0x82, 0xD4, 0xE0, 0xFD, - 0x70, 0x02, 0x21, 0x80, 0x90, 0x80, 0xDC, 0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, 0x60, - 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0x80, 0xDD, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, - 0x00, 0xEF, 0x60, 0x08, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x82, 0xD2, 0xE0, - 0xFF, 0xF1, 0x48, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x70, - 0x02, 0x21, 0x63, 0xE4, 0x90, 0x82, 0xD5, 0xF0, 0x90, 0x82, 0xD5, 0xE0, 0xF9, 0xC3, 0x94, 0x04, - 0x50, 0x32, 0x31, 0x82, 0xA4, 0xFF, 0xE9, 0xFD, 0x7C, 0x00, 0x2F, 0xFF, 0xEC, 0x35, 0xF0, 0xFE, - 0x74, 0xD0, 0x31, 0x99, 0x90, 0x80, 0x8C, 0x31, 0x8A, 0x31, 0x81, 0xA4, 0x2D, 0xFF, 0xEC, 0x35, - 0xF0, 0xFE, 0x74, 0xF0, 0x31, 0x99, 0x90, 0x80, 0x90, 0x31, 0x8A, 0xF0, 0x90, 0x82, 0xD5, 0xE0, - 0x04, 0xF0, 0x80, 0xC4, 0x90, 0x82, 0xD4, 0xE0, 0xFF, 0x90, 0x82, 0xD2, 0xE0, 0xFE, 0x74, 0x01, - 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0x90, 0x82, 0xD4, 0xF0, 0x90, - 0x82, 0xD2, 0xE0, 0xFF, 0x74, 0x01, 0xA8, 0x07, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x90, - 0x01, 0xCC, 0xF0, 0x90, 0x82, 0xD2, 0xE0, 0x04, 0xF0, 0xE0, 0x54, 0x03, 0xF0, 0x90, 0x80, 0xDD, - 0x31, 0xAB, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x70, 0x02, 0x01, 0x8B, 0xE4, 0x90, 0x80, 0xDD, - 0xF0, 0x01, 0x8B, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x82, 0xD2, 0xE0, 0x44, 0x80, - 0x90, 0x00, 0x8A, 0x31, 0x81, 0x90, 0x01, 0xD0, 0x12, 0x45, 0x04, 0xE0, 0x90, 0x01, 0xC3, 0xF0, - 0x22, 0xF0, 0x90, 0x82, 0xD2, 0xE0, 0x75, 0xF0, 0x04, 0x22, 0x12, 0x45, 0x04, 0xE5, 0x82, 0x29, - 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xEF, 0x22, 0x2F, 0xF5, 0x82, 0x74, 0x01, 0x3E, 0xF5, - 0x83, 0xE0, 0xFF, 0x90, 0x80, 0xDD, 0xE0, 0x75, 0xF0, 0x08, 0x22, 0xE0, 0x04, 0xF0, 0xE0, 0x7F, - 0x00, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x90, 0x81, 0x75, 0xE0, 0xFE, - 0x90, 0x81, 0x74, 0xE0, 0xFD, 0xB5, 0x06, 0x04, 0x7E, 0x01, 0x80, 0x02, 0x7E, 0x00, 0xEE, 0x64, - 0x01, 0x60, 0x41, 0x90, 0x01, 0xAF, 0xE0, 0x70, 0x0A, 0xED, 0x51, 0x76, 0xFA, 0x7B, 0x01, 0x51, - 0xCE, 0x7F, 0x01, 0xEF, 0x60, 0x2E, 0x90, 0x81, 0x74, 0x31, 0xAB, 0xB4, 0x0A, 0x02, 0x7F, 0x01, - 0xEF, 0x60, 0x05, 0xE4, 0x90, 0x81, 0x74, 0xF0, 0x90, 0x81, 0x75, 0xE0, 0xFF, 0x90, 0x81, 0x74, - 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x70, 0x07, 0x90, 0x80, 0x3C, - 0xE0, 0x44, 0x04, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, - 0x90, 0x81, 0x74, 0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, 0x60, 0x0A, 0xEF, 0x14, 0xFF, - 0x90, 0x81, 0x75, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x09, - 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x28, 0xC0, 0x01, 0x90, 0x81, 0x75, 0xE0, 0x51, - 0x76, 0xA8, 0x01, 0xFC, 0x7D, 0x01, 0xD0, 0x01, 0x7E, 0x00, 0x7F, 0x0F, 0x12, 0x44, 0x7D, 0x90, - 0x81, 0x75, 0x31, 0xAB, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0x81, 0x75, - 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0xDE, 0xF9, 0x74, 0x80, 0x35, - 0xF0, 0x22, 0x90, 0x82, 0x84, 0x74, 0x12, 0xF0, 0x90, 0x82, 0x92, 0x74, 0x05, 0xF0, 0x90, 0x82, - 0x86, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x82, 0x82, 0xE0, 0x90, 0x82, 0x89, - 0xF0, 0x90, 0x82, 0x83, 0xE0, 0x90, 0x82, 0x8A, 0xF0, 0x7B, 0x01, 0x7A, 0x82, 0x79, 0x84, 0x51, - 0x19, 0x7F, 0x04, 0x90, 0x82, 0xD6, 0xEF, 0xF0, 0x7F, 0x02, 0x12, 0x43, 0x27, 0x90, 0x80, 0x3C, - 0xE0, 0xFF, 0x90, 0x82, 0xD6, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x80, 0x3C, 0xF0, 0x22, 0xD3, 0x10, - 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x82, 0x75, 0x12, 0x45, 0x19, 0x90, 0x82, 0xD3, 0xE0, 0xFF, - 0x04, 0xF0, 0x90, 0x00, 0x01, 0xEF, 0x12, 0x1F, 0xFC, 0x7F, 0xAF, 0x7E, 0x01, 0x71, 0x31, 0xEF, - 0x60, 0x3A, 0x90, 0x82, 0x75, 0x12, 0x45, 0x10, 0x8B, 0x13, 0x8A, 0x14, 0x89, 0x15, 0x90, 0x00, - 0x0E, 0x12, 0x1F, 0xBD, 0x24, 0x02, 0xF5, 0x16, 0x7B, 0x01, 0x7A, 0x01, 0x79, 0xA0, 0x12, 0x2B, - 0xED, 0x90, 0x82, 0x75, 0x12, 0x45, 0x10, 0x90, 0x00, 0x0E, 0x12, 0x1F, 0xBD, 0x90, 0x01, 0xAE, - 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0x90, 0x01, 0xCB, 0xE0, 0x64, 0x80, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, - 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x82, 0xB7, 0xEE, 0xF0, 0xA3, 0x71, 0xD0, - 0x90, 0x82, 0xB7, 0xE0, 0xFE, 0xA3, 0xE0, 0xF5, 0x82, 0x8E, 0x83, 0xE0, 0x60, 0x28, 0xC3, 0x90, - 0x82, 0xBA, 0xE0, 0x94, 0xE8, 0x90, 0x82, 0xB9, 0xE0, 0x94, 0x03, 0x40, 0x0B, 0x90, 0x01, 0xC0, - 0xE0, 0x44, 0x80, 0xF0, 0x7F, 0x00, 0x80, 0x10, 0x90, 0x82, 0xB9, 0x71, 0x7D, 0x7F, 0x0A, 0x7E, - 0x00, 0x12, 0x32, 0xAA, 0x80, 0xCA, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0x75, 0xF0, - 0x01, 0x02, 0x44, 0xA3, 0x90, 0x82, 0x11, 0x71, 0xD0, 0x90, 0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, - 0xE7, 0x02, 0x7F, 0x01, 0x90, 0x82, 0x11, 0xE0, 0x6F, 0x60, 0x34, 0xC3, 0x90, 0x82, 0x13, 0xE0, - 0x94, 0x88, 0x90, 0x82, 0x12, 0xE0, 0x94, 0x13, 0x40, 0x08, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x10, - 0xF0, 0x22, 0x90, 0x82, 0x12, 0x71, 0x7D, 0xF1, 0x41, 0xD3, 0x90, 0x82, 0x13, 0xE0, 0x94, 0x32, - 0x90, 0x82, 0x12, 0xE0, 0x94, 0x00, 0x40, 0xC1, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE0, 0xBA, 0x22, - 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0xF1, 0x6F, 0x90, 0x00, 0x08, 0xE0, 0x54, 0xEF, - 0xFD, 0x7F, 0x08, 0x12, 0x32, 0x1E, 0xE4, 0xFF, 0x71, 0x84, 0x90, 0x81, 0x88, 0xE0, 0x54, 0xEF, - 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x91, 0x02, 0x71, 0xD8, 0xD0, 0xD0, 0x92, - 0xAF, 0x22, 0x90, 0x81, 0x88, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x81, 0x97, 0xE0, 0xFD, 0x7F, 0x93, - 0x12, 0x32, 0x1E, 0x90, 0x81, 0x8D, 0xE0, 0x60, 0x12, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x05, - 0x74, 0x10, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, 0x90, 0x00, 0x08, 0xE0, 0x44, - 0x10, 0xFD, 0x7F, 0x08, 0x12, 0x32, 0x1E, 0x7F, 0x01, 0x71, 0x84, 0x90, 0x00, 0x90, 0xE0, 0x44, - 0x01, 0xFD, 0x7F, 0x90, 0x12, 0x32, 0x1E, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x32, 0xAA, 0xE4, 0x90, - 0x82, 0xCF, 0xF0, 0xA3, 0xF0, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x82, 0xD1, 0xF0, 0x7D, 0x47, 0x7F, - 0xFF, 0x12, 0x4F, 0x13, 0x90, 0x05, 0xF8, 0xE0, 0x70, 0x11, 0xA3, 0xE0, 0x70, 0x0D, 0xA3, 0xE0, - 0x70, 0x09, 0xA3, 0xE0, 0x70, 0x05, 0x91, 0xA4, 0x7F, 0x01, 0x22, 0xD3, 0x90, 0x82, 0xD0, 0xE0, - 0x94, 0xE8, 0x90, 0x82, 0xCF, 0xE0, 0x94, 0x03, 0x40, 0x0C, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x20, - 0xF0, 0x91, 0xA4, 0x7F, 0x00, 0x22, 0x7F, 0x32, 0x7E, 0x00, 0x12, 0x32, 0xAA, 0x90, 0x82, 0xCF, - 0x71, 0x7D, 0x80, 0xC0, 0x90, 0x82, 0xD1, 0xE0, 0xFF, 0x7D, 0x48, 0x02, 0x4F, 0x13, 0xD3, 0x10, - 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x82, 0xCB, 0xEF, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x22, - 0x90, 0x05, 0x22, 0xE0, 0x90, 0x82, 0xCE, 0xF0, 0x7D, 0x29, 0x7F, 0xFF, 0x12, 0x4F, 0x13, 0x91, - 0x4E, 0xBF, 0x01, 0x02, 0x91, 0xEF, 0x90, 0x82, 0xCE, 0xE0, 0xFF, 0x7D, 0x2A, 0x12, 0x4F, 0x13, - 0x80, 0x02, 0x91, 0xEF, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, - 0x80, 0x88, 0xE0, 0xFF, 0x90, 0x82, 0xBE, 0x74, 0x0B, 0xF0, 0x7B, 0x08, 0x7D, 0x01, 0xB1, 0x2B, - 0x90, 0x82, 0xCC, 0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0x82, 0xCB, 0xE0, 0xFF, 0xD1, - 0xC6, 0x54, 0x3F, 0xF0, 0xEF, 0x60, 0x0A, 0xD1, 0xB9, 0x44, 0x10, 0xD1, 0xC5, 0x44, 0x80, 0xF0, - 0x22, 0xD1, 0xB9, 0x54, 0xEF, 0xD1, 0xC5, 0x44, 0x40, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, - 0xC0, 0xD0, 0x90, 0x82, 0xBC, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x82, 0xBB, 0xEF, 0xF0, 0xE4, - 0xFD, 0xFC, 0xF1, 0x5B, 0x7C, 0x00, 0xAD, 0x07, 0x90, 0x82, 0xBB, 0xE0, 0x90, 0x04, 0x25, 0xF0, - 0x90, 0x82, 0xBC, 0xE0, 0x60, 0x0E, 0x74, 0x0F, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, - 0xE0, 0x44, 0x80, 0xF0, 0xAF, 0x05, 0x74, 0x08, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, - 0xE4, 0xF0, 0x74, 0x09, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xF0, 0xF0, - 0xAF, 0x05, 0xD1, 0xAE, 0xE0, 0x54, 0x01, 0xFE, 0x90, 0x82, 0xBD, 0xE0, 0x25, 0xE0, 0x25, 0xE0, - 0xFB, 0xEE, 0x44, 0x02, 0x4B, 0xFE, 0xD1, 0xAE, 0xEE, 0xF0, 0x90, 0x82, 0xBE, 0xE0, 0xFF, 0xAE, - 0x05, 0x74, 0x1E, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x21, 0x2E, - 0xD1, 0xBC, 0x54, 0xF7, 0xF0, 0xAE, 0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7D, 0x08, - 0xE4, 0xFF, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x82, 0xB2, 0xEF, 0xF0, 0xA3, 0xED, - 0xF0, 0x90, 0x80, 0x3E, 0xE0, 0x04, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x2B, 0x90, 0x05, 0x22, - 0xE0, 0x90, 0x82, 0xB6, 0xF0, 0x7D, 0x26, 0x7F, 0xFF, 0x12, 0x4F, 0x13, 0x91, 0x4E, 0xEF, 0x64, - 0x01, 0x70, 0x02, 0xD1, 0x1E, 0x90, 0x82, 0xB6, 0xE0, 0xFF, 0x7D, 0x27, 0x12, 0x4F, 0x13, 0x90, - 0x82, 0xB2, 0xE0, 0xFF, 0xD1, 0xE6, 0x80, 0x09, 0x90, 0x82, 0xB2, 0xE0, 0xFF, 0xD1, 0xE6, 0xD1, - 0x1E, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x80, - 0x87, 0xE0, 0xFF, 0x90, 0x82, 0xB3, 0xE0, 0xFB, 0x90, 0x82, 0xBE, 0x74, 0x0A, 0xF0, 0x7D, 0x01, - 0xB1, 0x2B, 0x90, 0x82, 0xB4, 0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0x82, 0xB2, 0xE0, - 0xFF, 0xB1, 0x0F, 0x90, 0x82, 0xB4, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x04, 0x80, 0xE0, 0x54, - 0x0F, 0xFD, 0xAC, 0x07, 0xD1, 0xDA, 0x44, 0x01, 0xF0, 0xD1, 0xDA, 0x54, 0xFB, 0xF0, 0xAC, 0x07, - 0x74, 0x16, 0x2C, 0xD1, 0xB1, 0xE0, 0x44, 0xFA, 0xF0, 0x74, 0x15, 0x2C, 0xF5, 0x82, 0xE4, 0x34, - 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x1F, 0xF0, 0xAC, 0x07, 0x74, 0x06, 0x2C, 0xF5, 0x82, 0xE4, 0x34, - 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x0F, 0xF0, 0x90, 0x04, 0x53, 0xE4, 0xF0, 0x90, 0x04, 0x52, 0xF0, - 0x90, 0x04, 0x51, 0x74, 0xFF, 0xF0, 0x90, 0x04, 0x50, 0x74, 0xFD, 0xF0, 0x74, 0x14, 0x2C, 0xD1, - 0xD2, 0xE0, 0x54, 0xC0, 0x4D, 0xFD, 0x74, 0x14, 0x2F, 0xD1, 0xD2, 0xED, 0xF0, 0x22, 0x74, 0x16, - 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0x74, 0x21, 0x2D, 0xF5, 0x82, 0xE4, 0x34, - 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xF0, 0x74, 0x1F, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, - 0xE0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0x74, 0x11, 0x2C, 0xF5, 0x82, 0xE4, - 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x82, 0xDD, - 0xEF, 0xF0, 0x90, 0x80, 0x87, 0xE0, 0xFF, 0x90, 0x04, 0x1C, 0xE0, 0x6F, 0x70, 0x3E, 0x90, 0x81, - 0x8F, 0xE0, 0x64, 0x0E, 0x70, 0x15, 0x90, 0x82, 0xDD, 0xE0, 0x70, 0x30, 0x90, 0x81, 0x87, 0xE0, - 0x54, 0x7F, 0xF0, 0x90, 0x06, 0x04, 0x12, 0x4E, 0x8D, 0x80, 0x1E, 0x90, 0x81, 0x8F, 0xE0, 0x64, - 0x06, 0x70, 0x19, 0x90, 0x82, 0xDD, 0xE0, 0x60, 0x13, 0x90, 0x81, 0x87, 0xE0, 0x54, 0xBF, 0xF0, - 0xF1, 0x50, 0xF0, 0x90, 0x81, 0x8F, 0x74, 0x04, 0xF0, 0x12, 0x5A, 0x8A, 0xD0, 0xD0, 0x92, 0xAF, - 0x22, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x32, 0xAA, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x22, - 0x90, 0x06, 0x04, 0xE0, 0x44, 0x40, 0xF0, 0xE0, 0x44, 0x80, 0x22, 0xE4, 0xFE, 0xEF, 0xC3, 0x13, - 0xFD, 0xEF, 0x30, 0xE0, 0x02, 0x7E, 0x80, 0x90, 0xFD, 0x10, 0xED, 0xF0, 0xAF, 0x06, 0x22, 0x90, - 0x01, 0xC4, 0x74, 0x6F, 0xF0, 0x74, 0x67, 0xA3, 0xF0, 0x90, 0x00, 0x90, 0xE0, 0x20, 0xE0, 0xF9, - 0x74, 0x6F, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x67, 0xA3, 0xF0, 0x22, 0x7D, 0x2D, 0x7F, 0xFF, - 0x12, 0x4F, 0x13, 0x91, 0x4E, 0x90, 0x01, 0x37, 0x74, 0x02, 0xF0, 0xFD, 0x7F, 0x03, 0x12, 0x49, - 0x20, 0x12, 0x59, 0xF2, 0xE4, 0xFD, 0x7F, 0x01, 0x12, 0x4E, 0x95, 0xE4, 0x90, 0x81, 0x86, 0xF0, - 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0x5A, 0x9C, 0xD0, 0xD0, 0x92, 0xAF, 0x22, - 0xAC, 0x07, 0xED, 0xAD, 0x04, 0x78, 0x24, 0xF2, 0xED, 0x08, 0xF2, 0xEB, 0xB4, 0x04, 0x07, 0x78, - 0x27, 0x74, 0x01, 0xF2, 0x80, 0x0E, 0xEB, 0x78, 0x27, 0xB4, 0x05, 0x05, 0x74, 0x02, 0xF2, 0x80, - 0x03, 0x74, 0x04, 0xF2, 0x12, 0x69, 0x0C, 0xE2, 0x94, 0x00, 0x50, 0x49, 0xE4, 0x78, 0x26, 0xF2, - 0x12, 0x68, 0xE7, 0xC3, 0x9F, 0x40, 0x03, 0x02, 0x68, 0xE6, 0x12, 0x68, 0xEF, 0x60, 0x1F, 0x74, - 0x37, 0x2E, 0xF8, 0xE2, 0x78, 0x32, 0xF2, 0xEE, 0xFF, 0x78, 0x25, 0xE2, 0x2F, 0xFF, 0x18, 0xE2, - 0x34, 0x00, 0x8F, 0x82, 0xF5, 0x83, 0xE0, 0x78, 0x29, 0xF2, 0x78, 0x32, 0x31, 0x20, 0x78, 0x24, - 0x08, 0xE2, 0xFF, 0x08, 0xE2, 0x2F, 0xFF, 0x78, 0x28, 0xE2, 0xFD, 0x12, 0x32, 0x1E, 0x78, 0x26, - 0xE2, 0x04, 0xF2, 0x80, 0xBB, 0x31, 0x0C, 0xE2, 0x94, 0x07, 0x50, 0x35, 0xE4, 0x78, 0x26, 0xF2, - 0x11, 0xE7, 0xC3, 0x9F, 0x40, 0x02, 0x01, 0xE6, 0x11, 0xEF, 0x60, 0x16, 0x78, 0x26, 0xE2, 0xFF, - 0x31, 0x14, 0xF5, 0x83, 0xE0, 0x78, 0x29, 0xF2, 0x74, 0x37, 0x2F, 0xF8, 0xE2, 0x78, 0x32, 0xF2, - 0x31, 0x20, 0x31, 0x04, 0x31, 0x14, 0xF5, 0x83, 0xEF, 0xF0, 0x78, 0x26, 0xE2, 0x04, 0xF2, 0x80, - 0xCF, 0x90, 0x82, 0x73, 0xE0, 0x60, 0x0A, 0x11, 0xFC, 0x12, 0x2D, 0x5C, 0x78, 0x2E, 0x12, 0x44, - 0xF8, 0xE4, 0x78, 0x26, 0xF2, 0x11, 0xE7, 0xC3, 0x9F, 0x50, 0x4E, 0x11, 0xEF, 0x60, 0x2B, 0x78, - 0x2E, 0x12, 0x44, 0xDF, 0x78, 0x26, 0xE2, 0xFB, 0x75, 0xF0, 0x08, 0xA4, 0xF9, 0xF8, 0x12, 0x20, - 0xA8, 0x78, 0x29, 0xEF, 0xF2, 0x74, 0x37, 0x2B, 0xF8, 0xE2, 0x78, 0x32, 0xF2, 0xE2, 0xFE, 0xF4, - 0x5F, 0xFF, 0x78, 0x28, 0xE2, 0xFD, 0xEE, 0x5D, 0x4F, 0xF2, 0x31, 0x04, 0xFD, 0xC3, 0x74, 0x03, - 0x9D, 0xFD, 0xE4, 0x94, 0x00, 0xFC, 0x7B, 0xFE, 0x74, 0x2A, 0x2D, 0xF9, 0x74, 0x80, 0x3C, 0xFA, - 0xEF, 0x12, 0x1F, 0xEA, 0xE2, 0x04, 0xF2, 0x80, 0xAC, 0x78, 0x2A, 0x12, 0x44, 0xDF, 0x12, 0x5A, - 0x96, 0x11, 0xFC, 0x12, 0x2E, 0xA2, 0x22, 0x78, 0x27, 0xE2, 0xFF, 0x18, 0xE2, 0xFE, 0x22, 0x74, - 0x33, 0x2E, 0xF8, 0xE2, 0x78, 0x28, 0xF2, 0x90, 0x82, 0x73, 0xE0, 0x22, 0x78, 0x24, 0xE2, 0xFE, - 0x08, 0xE2, 0xFF, 0x22, 0x78, 0x28, 0xE2, 0xFF, 0x78, 0x26, 0xE2, 0x22, 0xD3, 0x78, 0x25, 0xE2, - 0x94, 0xFF, 0x18, 0x22, 0xFD, 0x18, 0xE2, 0x2D, 0xFD, 0x18, 0xE2, 0x34, 0x00, 0x8D, 0x82, 0x22, - 0xE2, 0xFF, 0xF4, 0xFE, 0x78, 0x29, 0xE2, 0x5E, 0xFE, 0x18, 0xE2, 0xFD, 0xEF, 0x5D, 0x4E, 0xF2, - 0x22, 0x78, 0x10, 0x74, 0x01, 0xF2, 0x90, 0x02, 0x09, 0xE0, 0x78, 0x00, 0xF2, 0x08, 0x74, 0x20, - 0xF2, 0x18, 0xE2, 0xFF, 0x30, 0xE0, 0x05, 0x08, 0xE2, 0x24, 0x80, 0xF2, 0xEF, 0xC3, 0x13, 0x90, - 0xFD, 0x10, 0xF0, 0x78, 0x01, 0xE2, 0x71, 0x5E, 0x78, 0x03, 0xF2, 0x64, 0x04, 0x60, 0x0D, 0xE2, - 0xFF, 0x64, 0x08, 0x60, 0x07, 0xEF, 0x64, 0x0C, 0x60, 0x02, 0x61, 0x54, 0xE4, 0x78, 0x02, 0xF2, - 0x78, 0x03, 0xE2, 0xFF, 0x18, 0xE2, 0xC3, 0x9F, 0x50, 0x25, 0xE2, 0xFD, 0x18, 0xE2, 0x2D, 0x90, - 0x82, 0x11, 0xF0, 0xE0, 0xFF, 0x71, 0x5E, 0xFE, 0x74, 0x04, 0x2D, 0xF8, 0xEE, 0xF2, 0xEF, 0xB4, - 0xFF, 0x06, 0x90, 0xFD, 0x10, 0xE0, 0x04, 0xF0, 0x78, 0x02, 0xE2, 0x04, 0xF2, 0x80, 0xD1, 0x78, - 0x04, 0xE2, 0x78, 0x12, 0xF2, 0xFF, 0x78, 0x05, 0xE2, 0x78, 0x11, 0xF2, 0x78, 0x06, 0xE2, 0x78, - 0x13, 0xF2, 0x78, 0x07, 0xE2, 0x78, 0x14, 0xF2, 0x78, 0x08, 0xE2, 0x78, 0x33, 0xF2, 0x78, 0x09, - 0xE2, 0x78, 0x34, 0xF2, 0x78, 0x0A, 0xE2, 0x78, 0x35, 0xF2, 0x78, 0x0B, 0xE2, 0x78, 0x36, 0xF2, - 0x78, 0x0C, 0xE2, 0x78, 0x37, 0xF2, 0x78, 0x0D, 0xE2, 0x78, 0x38, 0xF2, 0x78, 0x0E, 0xE2, 0x78, - 0x39, 0xF2, 0x78, 0x0F, 0xE2, 0x78, 0x3A, 0xF2, 0xE4, 0x78, 0x15, 0xF2, 0xEF, 0x24, 0xF8, 0x60, - 0x56, 0x24, 0xFC, 0x60, 0x4D, 0x24, 0x08, 0x60, 0x02, 0x61, 0x36, 0x78, 0x11, 0xE2, 0xB4, 0x01, - 0x05, 0x12, 0x29, 0xC5, 0x61, 0x3B, 0x78, 0x11, 0xE2, 0xB4, 0x02, 0x05, 0x12, 0x11, 0xBD, 0x61, - 0x3B, 0x78, 0x11, 0xE2, 0xB4, 0x03, 0x05, 0x12, 0x5B, 0xDA, 0x61, 0x3B, 0x78, 0x11, 0xE2, 0xB4, - 0x10, 0x07, 0x71, 0x69, 0x12, 0x32, 0xAA, 0x61, 0x3B, 0x78, 0x11, 0xE2, 0xB4, 0x11, 0x07, 0x71, - 0x69, 0x12, 0x32, 0x06, 0x61, 0x3B, 0x78, 0x11, 0xE2, 0xF4, 0x60, 0x02, 0x61, 0x3B, 0x18, 0xF2, - 0x61, 0x3B, 0x78, 0x15, 0x74, 0x01, 0xF2, 0x78, 0x11, 0xE2, 0x64, 0x07, 0x60, 0x02, 0x61, 0x1F, - 0x78, 0x34, 0x71, 0x57, 0x78, 0x08, 0x12, 0x20, 0xBB, 0xC0, 0x04, 0x12, 0x5F, 0x4D, 0x78, 0x33, - 0x71, 0x57, 0xD0, 0x00, 0x12, 0x44, 0xC6, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x78, - 0x35, 0x71, 0x57, 0x78, 0x10, 0x12, 0x20, 0xBB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, - 0x12, 0x44, 0xC6, 0x78, 0x18, 0x12, 0x44, 0xF8, 0x78, 0x15, 0xE2, 0x60, 0x7B, 0x18, 0xE2, 0xFF, - 0x18, 0xE2, 0xFD, 0x12, 0x67, 0xB1, 0x78, 0x1C, 0x12, 0x44, 0xF8, 0x78, 0x38, 0x71, 0x57, 0x78, - 0x08, 0x12, 0x20, 0xBB, 0xC0, 0x04, 0x12, 0x5F, 0x4D, 0x78, 0x37, 0x71, 0x57, 0xD0, 0x00, 0x12, - 0x44, 0xC6, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x78, 0x39, 0x71, 0x57, 0x78, 0x10, - 0x12, 0x20, 0xBB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x44, 0xC6, 0x78, 0x20, - 0x12, 0x44, 0xF8, 0x78, 0x20, 0x12, 0x44, 0xDF, 0x12, 0x20, 0x9B, 0x78, 0x1C, 0x12, 0x44, 0xEB, - 0x12, 0x44, 0xB9, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x78, 0x18, 0x12, 0x44, 0xDF, - 0x78, 0x20, 0x12, 0x44, 0xEB, 0x12, 0x44, 0xB9, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, - 0x12, 0x44, 0xC6, 0x78, 0x18, 0x12, 0x44, 0xF8, 0x78, 0x18, 0x12, 0x44, 0xDF, 0x90, 0x82, 0xAE, - 0x12, 0x20, 0xCE, 0x78, 0x13, 0xE2, 0xFD, 0x08, 0xE2, 0xFF, 0x12, 0x5F, 0x0F, 0x80, 0x1C, 0x78, - 0x13, 0xE2, 0xFF, 0x08, 0xE2, 0xFD, 0x78, 0x11, 0xE2, 0xFB, 0x78, 0x15, 0xE2, 0x90, 0x82, 0x73, - 0xF0, 0x12, 0x67, 0xC0, 0x80, 0x05, 0x78, 0x10, 0x74, 0x02, 0xF2, 0x78, 0x10, 0xE2, 0xFF, 0xC3, - 0x94, 0x02, 0x50, 0x10, 0xEF, 0x60, 0x0A, 0x78, 0x02, 0xE2, 0xFF, 0x18, 0xE2, 0x2F, 0xF2, 0x21, - 0x53, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, 0xE2, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x22, 0x24, 0x00, - 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0x78, 0x14, 0xE2, 0xFE, 0x18, 0xE2, 0xFD, - 0xED, 0xFF, 0x78, 0x16, 0xEE, 0xF2, 0xFE, 0x08, 0xEF, 0xF2, 0xFF, 0x22, 0xD3, 0x10, 0xAF, 0x01, - 0xC3, 0xC0, 0xD0, 0x12, 0x2D, 0xA7, 0xE4, 0xF5, 0x51, 0x12, 0x32, 0x9E, 0xEF, 0x60, 0x72, 0x63, - 0x51, 0x01, 0xE5, 0x51, 0x24, 0x7C, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x6B, 0xA3, 0xF0, 0x90, 0x00, - 0x88, 0xE0, 0xF5, 0x4F, 0xF5, 0x50, 0x54, 0x0F, 0x60, 0xDF, 0xE5, 0x4F, 0x30, 0xE0, 0x0B, 0x20, - 0xE4, 0x03, 0x12, 0x29, 0xC5, 0x53, 0x50, 0xEE, 0x80, 0x3E, 0xE5, 0x4F, 0x30, 0xE1, 0x16, 0x20, - 0xE5, 0x0E, 0x12, 0x11, 0xBD, 0xEF, 0x70, 0x03, 0x43, 0x50, 0x20, 0x90, 0x01, 0x06, 0xE4, 0xF0, - 0x53, 0x50, 0xFD, 0x80, 0x23, 0xE5, 0x4F, 0x30, 0xE2, 0x0B, 0x20, 0xE6, 0x03, 0x12, 0x5B, 0xDA, - 0x53, 0x50, 0xFB, 0x80, 0x13, 0xE5, 0x4F, 0x30, 0xE3, 0x0E, 0x20, 0xE7, 0x08, 0x31, 0x31, 0xEF, - 0x70, 0x03, 0x43, 0x50, 0x80, 0x53, 0x50, 0xF7, 0xAD, 0x50, 0x7F, 0x88, 0x12, 0x32, 0x1E, 0x80, - 0x88, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x1F, 0xA4, 0xFF, 0x90, 0x81, 0x78, 0xF0, 0xBF, 0x01, - 0x07, 0x91, 0x19, 0xE4, 0x90, 0x81, 0x78, 0xF0, 0x22, 0x7B, 0x01, 0x7A, 0x82, 0x79, 0x79, 0x7F, - 0xF5, 0x7E, 0x00, 0x12, 0x2B, 0x27, 0xBF, 0x01, 0x06, 0x90, 0x82, 0x79, 0xE0, 0xA3, 0xF0, 0x7B, - 0x01, 0x7A, 0x82, 0x79, 0x79, 0x7F, 0xF6, 0x7E, 0x00, 0x12, 0x2B, 0x27, 0xBF, 0x01, 0x08, 0x90, - 0x82, 0x79, 0xE0, 0x90, 0x82, 0x7B, 0xF0, 0x7B, 0x01, 0x7A, 0x82, 0x79, 0x79, 0x7F, 0xF4, 0x7E, - 0x00, 0x12, 0x2B, 0x27, 0xBF, 0x01, 0x08, 0x90, 0x82, 0x79, 0xE0, 0x90, 0x82, 0x7C, 0xF0, 0x7B, - 0x01, 0x7A, 0x82, 0x79, 0x79, 0x7F, 0xF3, 0x7E, 0x00, 0x12, 0x2B, 0x27, 0xBF, 0x01, 0x08, 0x90, - 0x82, 0x79, 0xE0, 0x90, 0x82, 0x7D, 0xF0, 0x7B, 0x01, 0x7A, 0x82, 0x79, 0x79, 0x7F, 0xF2, 0x7E, - 0x00, 0x12, 0x2B, 0x27, 0xBF, 0x01, 0x08, 0x90, 0x82, 0x79, 0xE0, 0x90, 0x82, 0x7E, 0xF0, 0x90, - 0x82, 0x7A, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, 0x82, 0x82, 0xF0, - 0x90, 0x82, 0x7E, 0xE0, 0x90, 0x82, 0x83, 0xF0, 0x02, 0x62, 0x82, 0x12, 0x1F, 0xA4, 0x54, 0x01, - 0xFF, 0x90, 0x81, 0xFE, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x22, 0x12, 0x1F, 0xA4, 0x90, 0x81, 0xEF, - 0xF0, 0x22, 0xE4, 0x90, 0x81, 0x74, 0xF0, 0xA3, 0xF0, 0x90, 0x80, 0xDC, 0xF0, 0xA3, 0xF0, 0x22, - 0x75, 0x3D, 0x10, 0xE4, 0xF5, 0x3E, 0x75, 0x3F, 0x07, 0x75, 0x40, 0x02, 0x90, 0x01, 0x30, 0xE5, - 0x3D, 0xF0, 0xA3, 0xE5, 0x3E, 0xF0, 0xA3, 0xE5, 0x3F, 0xF0, 0xA3, 0xE5, 0x40, 0xF0, 0x22, 0x75, - 0x45, 0x06, 0x75, 0x46, 0x01, 0x43, 0x46, 0x10, 0x75, 0x47, 0x03, 0x75, 0x48, 0x62, 0x90, 0x01, - 0x38, 0xE5, 0x45, 0xF0, 0xA3, 0xE5, 0x46, 0xF0, 0xA3, 0xE5, 0x47, 0xF0, 0xA3, 0xE5, 0x48, 0xF0, - 0x22, 0x90, 0x01, 0x94, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x01, 0xC7, 0xE4, 0xF0, 0x22, 0x90, 0x01, - 0x01, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x01, 0x9C, 0x74, 0x7E, 0xF0, 0xA3, 0x74, 0x92, 0xF0, 0xA3, - 0x74, 0xA0, 0xF0, 0xA3, 0x74, 0x24, 0xF0, 0x90, 0x01, 0x9B, 0x74, 0x49, 0xF0, 0x90, 0x01, 0x9A, - 0x74, 0xE0, 0xF0, 0x90, 0x01, 0x99, 0xE4, 0xF0, 0x90, 0x01, 0x98, 0x04, 0xF0, 0x22, 0x7F, 0x02, - 0x90, 0x81, 0xFB, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x18, 0xEF, 0x25, 0xE0, 0x24, 0x81, 0xF8, - 0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0xA3, 0xF0, 0x7F, 0x00, 0x22, 0x0F, - 0x80, 0xDE, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xE4, 0x74, 0x17, 0xF0, 0xA3, 0xE4, 0xF0, 0x22, 0x90, - 0x01, 0x34, 0xE0, 0x55, 0x3D, 0xF5, 0x41, 0xA3, 0xE0, 0x55, 0x3E, 0xF5, 0x42, 0xA3, 0xE0, 0x55, - 0x3F, 0xF5, 0x43, 0xA3, 0xE0, 0x55, 0x40, 0xF5, 0x44, 0x90, 0x01, 0x34, 0xE5, 0x41, 0xF0, 0xA3, - 0xE5, 0x42, 0xF0, 0xA3, 0xE5, 0x43, 0xF0, 0xA3, 0xE5, 0x44, 0xF0, 0x22, 0x90, 0x01, 0x3C, 0xE0, - 0x55, 0x45, 0xF5, 0x49, 0xA3, 0xE0, 0x55, 0x46, 0xF5, 0x4A, 0xA3, 0xE0, 0x55, 0x47, 0xF5, 0x4B, - 0xA3, 0xE0, 0x55, 0x48, 0xF5, 0x4C, 0x90, 0x01, 0x3C, 0xE5, 0x49, 0xF0, 0xA3, 0xE5, 0x4A, 0xF0, - 0xA3, 0xE5, 0x4B, 0xF0, 0xA3, 0xE5, 0x4C, 0xF0, 0x53, 0x91, 0xDF, 0x22, 0x90, 0x01, 0xCF, 0xE0, - 0x90, 0x82, 0xD9, 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, 0x52, 0x7F, 0x90, 0x00, 0x03, 0xE0, 0x54, 0xFB, 0xFD, - 0x7F, 0x03, 0x12, 0x32, 0x1E, 0x80, 0xFE, 0x22, 0x90, 0x81, 0x82, 0xE0, 0x30, 0xE0, 0x05, 0xE4, - 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x81, 0xFD, 0xE0, 0x60, 0x0F, 0xE4, 0xF0, 0x90, 0x05, 0x53, - 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x05, 0xFC, 0xE0, 0x04, 0xF0, 0x90, 0x81, 0x82, 0xE0, 0x30, 0xE0, - 0x11, 0xA3, 0x74, 0x01, 0xF0, 0x90, 0x81, 0x82, 0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x03, 0x12, - 0x58, 0xC8, 0xD1, 0x6F, 0x90, 0x81, 0xF0, 0xE0, 0x30, 0xE0, 0x13, 0x90, 0x01, 0x57, 0xE4, 0xF0, - 0x12, 0x4F, 0x0E, 0xF1, 0x1F, 0x30, 0xE0, 0x03, 0x12, 0x4E, 0x91, 0xF1, 0x9B, 0xF0, 0x22, 0xE4, - 0xF5, 0x4E, 0x90, 0x81, 0x8C, 0xE0, 0x70, 0x02, 0xE1, 0x13, 0x12, 0x47, 0x56, 0x60, 0x02, 0xE1, - 0x13, 0x90, 0x81, 0x8A, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x60, 0x22, 0x24, 0xFE, 0x60, 0x03, 0x04, - 0x70, 0x1E, 0x90, 0x81, 0x93, 0xE0, 0x14, 0xF0, 0xE0, 0xFF, 0x60, 0x06, 0x90, 0x81, 0x95, 0xE0, - 0x60, 0x0E, 0xEF, 0x70, 0x08, 0x90, 0x81, 0x92, 0xE0, 0xA3, 0xF0, 0x80, 0x00, 0x75, 0x4E, 0x01, - 0x90, 0x81, 0x82, 0xE0, 0x30, 0xE0, 0x12, 0x90, 0x81, 0x86, 0xE0, 0xB4, 0x02, 0x03, 0xE4, 0xF5, - 0x4E, 0x12, 0x58, 0xBC, 0xEF, 0x70, 0x02, 0xF5, 0x4E, 0xE5, 0x4E, 0x60, 0x46, 0xF1, 0xA2, 0x90, - 0x81, 0x95, 0xE0, 0x60, 0x04, 0x64, 0x01, 0x70, 0x16, 0xE4, 0xF5, 0x1D, 0x90, 0x81, 0x95, 0xE0, - 0xFF, 0x90, 0x81, 0x94, 0xE0, 0x2F, 0x12, 0x56, 0xBC, 0x90, 0x81, 0x95, 0xE0, 0x80, 0x10, 0xE4, - 0xF5, 0x1D, 0xF1, 0x14, 0xFF, 0x90, 0x81, 0x94, 0xE0, 0x2F, 0x12, 0x56, 0xBC, 0xF1, 0x14, 0xFF, - 0x90, 0x81, 0x94, 0xE0, 0x2F, 0x90, 0x81, 0xA5, 0xF0, 0x90, 0x81, 0x8F, 0xE0, 0x20, 0xE2, 0x03, - 0x12, 0x4B, 0xD2, 0x22, 0x90, 0x81, 0x95, 0xE0, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, 0x22, 0x90, - 0x81, 0xF0, 0xE0, 0xC3, 0x13, 0x22, 0x90, 0x81, 0xF0, 0xE0, 0xFF, 0x30, 0xE0, 0x3A, 0x90, 0x80, - 0x42, 0xE0, 0x64, 0x01, 0x70, 0x2A, 0xEF, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x2A, 0x90, 0x82, - 0xDC, 0xE0, 0x04, 0xF0, 0xE0, 0xD3, 0x94, 0xC8, 0x40, 0x1E, 0x90, 0x81, 0xF0, 0xE0, 0x44, 0x20, - 0xF0, 0xE4, 0x90, 0x82, 0xDC, 0xF0, 0x90, 0x81, 0xF0, 0xE0, 0x13, 0x30, 0xE0, 0x0A, 0x80, 0x05, - 0xF1, 0x1F, 0x30, 0xE0, 0x03, 0xF1, 0xAA, 0xF0, 0x22, 0x90, 0x81, 0xF0, 0xE0, 0x30, 0xE0, 0x0C, - 0xE4, 0xF5, 0x1D, 0x90, 0x81, 0xF2, 0x12, 0x56, 0xBB, 0xF1, 0x9B, 0xF0, 0x90, 0x80, 0x42, 0xE0, - 0xB4, 0x01, 0x15, 0x90, 0x81, 0xF0, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x20, 0xE0, 0x0C, 0xEF, 0xC4, - 0x13, 0x54, 0x07, 0x20, 0xE0, 0x04, 0x80, 0x00, 0xF1, 0x26, 0x22, 0x90, 0x81, 0xF0, 0xE0, 0x44, - 0x04, 0x22, 0x90, 0x81, 0x90, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x81, 0x87, 0xE0, 0x44, 0x01, - 0xF0, 0x90, 0x81, 0x97, 0x74, 0xD0, 0x22, 0x90, 0x81, 0x82, 0xE0, 0x30, 0xE0, 0x06, 0x90, 0x81, - 0x84, 0x74, 0x01, 0xF0, 0x90, 0x81, 0x8C, 0xE0, 0x60, 0x27, 0x12, 0x74, 0x60, 0x30, 0xE0, 0x0A, - 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x03, 0x12, 0x4A, 0x38, 0x90, 0x82, 0xD8, 0xE0, 0x04, 0xF0, - 0xE0, 0xC3, 0x94, 0x80, 0x40, 0x0B, 0x90, 0x01, 0x98, 0xE0, 0x54, 0xFE, 0xF0, 0xE0, 0x44, 0x01, - 0xF0, 0xF1, 0x69, 0x90, 0x81, 0xF7, 0xE0, 0x30, 0xE0, 0x0A, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, - 0x03, 0x12, 0x4A, 0x38, 0x22, 0x90, 0x81, 0x82, 0xE0, 0xFF, 0x30, 0xE0, 0x04, 0x11, 0x2D, 0x60, - 0x1B, 0x90, 0x81, 0x8C, 0xE0, 0x70, 0x04, 0xEF, 0x30, 0xE0, 0x0B, 0x90, 0x81, 0x8F, 0xE0, 0x64, - 0x02, 0x60, 0x09, 0x12, 0x49, 0x2C, 0x90, 0x01, 0xE6, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x81, 0x86, - 0xE0, 0x64, 0x02, 0x22, 0x11, 0x4B, 0x30, 0xE0, 0x0B, 0x11, 0x2D, 0x60, 0x07, 0x7D, 0x01, 0x7F, - 0x02, 0x12, 0x4B, 0xD6, 0x11, 0x2D, 0x60, 0x02, 0x11, 0x56, 0x22, 0x90, 0x81, 0x82, 0xE0, 0xFF, - 0xC4, 0x13, 0x13, 0x54, 0x03, 0x22, 0x90, 0x81, 0x8C, 0xE0, 0x64, 0x02, 0x60, 0x10, 0x12, 0x55, - 0xFA, 0x60, 0x0B, 0x51, 0x30, 0xEF, 0x70, 0x06, 0xFD, 0x7F, 0x0C, 0x12, 0x4B, 0xD6, 0x22, 0x90, - 0x81, 0x8C, 0xE0, 0x70, 0x07, 0x90, 0x81, 0x82, 0xE0, 0x30, 0xE0, 0x11, 0x90, 0x81, 0x82, 0xE0, - 0x30, 0xE0, 0x08, 0x12, 0x58, 0xBC, 0xBF, 0x01, 0x04, 0x80, 0xCB, 0x51, 0x51, 0x22, 0x90, 0x81, - 0x87, 0x11, 0x4E, 0x30, 0xE0, 0x1F, 0xEF, 0x54, 0xBF, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0x81, - 0x88, 0x30, 0xE0, 0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x08, 0xE0, 0x54, 0xFE, 0x11, 0xB6, 0x74, - 0x04, 0xF0, 0x12, 0x58, 0x5D, 0x22, 0xF0, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, - 0x22, 0x90, 0x81, 0x87, 0xE0, 0xFF, 0x11, 0xF0, 0x30, 0xE0, 0x24, 0xEF, 0x54, 0x7F, 0xF0, 0x90, - 0x04, 0xE0, 0xE0, 0x90, 0x81, 0x88, 0x30, 0xE1, 0x06, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x07, 0xE0, - 0x54, 0xFD, 0x11, 0xB6, 0x04, 0xF0, 0x90, 0x81, 0x8C, 0xE0, 0x60, 0x03, 0x12, 0x58, 0x5D, 0x22, - 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAC, 0x07, - 0x90, 0x81, 0x88, 0xE0, 0x11, 0xF0, 0x30, 0xE0, 0x02, 0x21, 0xB5, 0x90, 0x81, 0x87, 0xE0, 0x30, - 0xE0, 0x16, 0x90, 0x81, 0xA9, 0xE0, 0x24, 0x04, 0x90, 0x81, 0xA1, 0xF0, 0x90, 0x81, 0xA9, 0xE0, - 0x24, 0x03, 0x90, 0x81, 0xA0, 0xF0, 0x80, 0x0D, 0x90, 0x81, 0xA1, 0x74, 0x02, 0xF0, 0x90, 0x81, - 0xA0, 0x14, 0xF0, 0x0B, 0x0B, 0x90, 0x81, 0xA0, 0xE0, 0xFA, 0x90, 0x81, 0x9F, 0xE0, 0xD3, 0x9A, - 0x50, 0x0E, 0x90, 0x81, 0x94, 0xEB, 0xF0, 0x90, 0x81, 0xA1, 0xE0, 0xC3, 0x9D, 0x2C, 0x80, 0x11, - 0xC3, 0xED, 0x9A, 0x2B, 0x90, 0x81, 0x94, 0xF0, 0x90, 0x81, 0xA0, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, - 0x9F, 0x90, 0x81, 0xA4, 0xF0, 0x90, 0x81, 0xA1, 0xE0, 0xFF, 0x24, 0x0A, 0xFD, 0xE4, 0x33, 0xFC, - 0x90, 0x81, 0xA4, 0x31, 0xC1, 0x40, 0x04, 0xEF, 0x24, 0x0A, 0xF0, 0x90, 0x81, 0xA4, 0xE0, 0xFF, - 0x24, 0x23, 0xFD, 0xE4, 0x33, 0xFC, 0x90, 0x81, 0x94, 0x31, 0xC1, 0x40, 0x04, 0xEF, 0x24, 0x23, - 0xF0, 0x90, 0x81, 0xA4, 0xE0, 0xFF, 0x7E, 0x00, 0x90, 0x81, 0x98, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, - 0x90, 0x05, 0x58, 0xE0, 0x6F, 0x70, 0x01, 0xE4, 0x60, 0x02, 0x51, 0x15, 0x90, 0x81, 0x89, 0xE0, - 0x54, 0xFE, 0xF0, 0x80, 0x07, 0x90, 0x81, 0x89, 0xE0, 0x44, 0x01, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, - 0x22, 0xE0, 0xD3, 0x9D, 0xEC, 0x64, 0x80, 0xF8, 0x74, 0x80, 0x98, 0x22, 0x71, 0x26, 0x90, 0x82, - 0x04, 0xEF, 0xF0, 0x30, 0xE0, 0x05, 0x7D, 0x01, 0xE4, 0x80, 0x02, 0xE4, 0xFD, 0xFF, 0x12, 0x4E, - 0x95, 0x90, 0x82, 0x04, 0xE0, 0x30, 0xE6, 0x11, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x04, 0xE4, - 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x80, 0xF0, 0x90, 0x81, 0x87, 0xE0, 0x90, 0x04, 0xEC, - 0x30, 0xE0, 0x06, 0xE0, 0x54, 0xDD, 0xF0, 0x80, 0x04, 0xE0, 0x44, 0x22, 0xF0, 0x51, 0x1F, 0x74, - 0x02, 0xF0, 0x01, 0xF7, 0xF0, 0x90, 0x81, 0x98, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x22, 0x90, - 0x81, 0x9E, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x81, 0xA5, 0xE0, 0xFB, 0x90, 0x82, 0xCA, 0x22, - 0x90, 0x04, 0x1A, 0xE0, 0xF4, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x90, 0x04, 0x1B, 0xE0, 0x54, 0x07, - 0x64, 0x07, 0x7F, 0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, 0x51, 0x30, 0xEF, 0x70, 0x02, 0x51, 0x51, - 0x22, 0x90, 0x81, 0x8C, 0xE0, 0x64, 0x01, 0x70, 0x14, 0x12, 0x55, 0xFA, 0x60, 0x06, 0x12, 0x5A, - 0x83, 0x02, 0x57, 0x80, 0x90, 0x81, 0x8F, 0xE0, 0x70, 0x03, 0x12, 0x4B, 0xD2, 0x22, 0xD3, 0x10, - 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x51, 0x30, 0xEF, 0x64, 0x01, 0x60, 0x05, 0x75, 0x0F, 0x01, 0x80, - 0x51, 0x90, 0x81, 0x90, 0xE0, 0xFF, 0x54, 0x03, 0x60, 0x05, 0x75, 0x0F, 0x02, 0x80, 0x43, 0x90, - 0x81, 0x8E, 0xE0, 0xFE, 0xE4, 0xC3, 0x9E, 0x50, 0x05, 0x75, 0x0F, 0x04, 0x80, 0x34, 0xEF, 0x30, - 0xE2, 0x05, 0x75, 0x0F, 0x08, 0x80, 0x2B, 0x90, 0x81, 0x90, 0xE0, 0x30, 0xE4, 0x05, 0x75, 0x0F, - 0x10, 0x80, 0x1F, 0x90, 0x81, 0x88, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x20, 0xE0, 0x05, 0x75, 0x0F, - 0x20, 0x80, 0x0F, 0x90, 0x81, 0xEF, 0xE0, 0x60, 0x05, 0x75, 0x0F, 0x80, 0x80, 0x04, 0x51, 0xE5, - 0x80, 0x0E, 0x90, 0x01, 0xB9, 0x74, 0x04, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x0F, 0xF0, 0x7F, 0x00, - 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0xEF, 0x60, 0x35, - 0x12, 0x47, 0x56, 0x70, 0x30, 0x90, 0x81, 0x88, 0xE0, 0x54, 0xFE, 0xF0, 0x7D, 0x2B, 0x7F, 0x0F, - 0x12, 0x4F, 0x13, 0x90, 0x06, 0x04, 0xE0, 0x54, 0xBF, 0xF0, 0x12, 0x65, 0xBE, 0xBF, 0x01, 0x10, - 0x90, 0x81, 0x87, 0xE0, 0x44, 0x40, 0xF0, 0x7D, 0x06, 0x12, 0x4F, 0xE9, 0x74, 0x06, 0xF0, 0x22, - 0x11, 0xB7, 0x74, 0x08, 0xF0, 0x22, 0xE4, 0x90, 0x82, 0x06, 0xF0, 0xA3, 0xF0, 0x90, 0x00, 0x83, - 0xE0, 0x90, 0x82, 0x05, 0xF0, 0x90, 0x00, 0x83, 0xE0, 0xFE, 0x90, 0x82, 0x05, 0xE0, 0xFF, 0xB5, - 0x06, 0x01, 0x22, 0xC3, 0x90, 0x82, 0x07, 0xE0, 0x94, 0x64, 0x90, 0x82, 0x06, 0xE0, 0x94, 0x00, - 0x40, 0x0D, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0x82, 0x05, 0xE0, 0xFF, 0x22, 0x90, - 0x82, 0x06, 0x12, 0x63, 0x7D, 0x80, 0xC6, 0x90, 0x81, 0x82, 0xE0, 0xFF, 0x30, 0xE0, 0x3E, 0x90, - 0x81, 0x86, 0xE0, 0x7E, 0x00, 0xB4, 0x02, 0x02, 0x7E, 0x01, 0x90, 0x81, 0x85, 0xE0, 0x7D, 0x00, - 0xB4, 0x04, 0x02, 0x7D, 0x01, 0xED, 0x4E, 0x70, 0x24, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x03, 0x02, - 0x58, 0xC8, 0x11, 0x34, 0x90, 0x81, 0x86, 0xE0, 0xB4, 0x08, 0x06, 0xE4, 0xFD, 0x7F, 0x0C, 0x80, - 0x09, 0x90, 0x81, 0x86, 0xE0, 0x70, 0x06, 0xFD, 0x7F, 0x04, 0x12, 0x4B, 0xD6, 0x22, 0x90, 0x81, - 0xF7, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x35, 0x90, 0x02, 0x87, 0xE0, 0x60, 0x02, 0x80, 0x08, 0x90, - 0x01, 0x00, 0xE0, 0x64, 0x3F, 0x60, 0x05, 0x75, 0x4F, 0x01, 0x80, 0x22, 0x90, 0x02, 0x96, 0xE0, - 0x60, 0x05, 0x75, 0x4F, 0x10, 0x80, 0x17, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x02, 0x80, 0x07, - 0x90, 0x02, 0x86, 0xE0, 0x30, 0xE3, 0x05, 0x75, 0x4F, 0x04, 0x80, 0x02, 0x41, 0xE5, 0x90, 0x01, - 0xB9, 0x74, 0x08, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x4F, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0x81, 0x8C, - 0xE0, 0x60, 0x02, 0x91, 0x08, 0x02, 0x4F, 0x29, 0x91, 0x60, 0x30, 0xE0, 0x0B, 0xEF, 0xC4, 0x13, - 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0x91, 0x6B, 0x91, 0x72, 0x54, 0x3F, 0x30, 0xE0, 0x09, 0x12, - 0x47, 0xCC, 0x54, 0x07, 0x70, 0x39, 0x80, 0x34, 0x91, 0x7A, 0x9F, 0x40, 0x2F, 0x12, 0x47, 0x56, - 0x70, 0x2D, 0x12, 0x55, 0xFA, 0x70, 0x05, 0x12, 0x47, 0xF0, 0xF0, 0x22, 0x90, 0x81, 0x96, 0xE0, - 0x04, 0xF0, 0xE0, 0xD3, 0x94, 0x02, 0x40, 0x0B, 0x12, 0x47, 0xF0, 0xF0, 0xE4, 0x90, 0x81, 0x96, - 0xF0, 0x80, 0x03, 0x12, 0x57, 0x2F, 0xE4, 0x90, 0x81, 0x95, 0xF0, 0x22, 0x12, 0x58, 0x5D, 0x22, - 0x90, 0x81, 0x88, 0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x02, - 0x4A, 0x42, 0x90, 0x81, 0x87, 0xE0, 0xFF, 0x13, 0x13, 0x22, 0x90, 0x81, 0x95, 0xE0, 0x04, 0xF0, - 0x90, 0x81, 0x90, 0xE0, 0x54, 0xEF, 0xF0, 0x90, 0x81, 0xE9, 0xE0, 0xFF, 0x90, 0x81, 0x95, 0xE0, - 0xD3, 0x22, 0x90, 0x81, 0xFC, 0xE0, 0x60, 0x0F, 0xE4, 0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, 0x01, - 0xF0, 0x90, 0x05, 0xFD, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x81, 0x82, 0xE0, 0xFF, 0x30, 0xE0, 0x40, - 0x90, 0x81, 0x86, 0xE0, 0x7E, 0x00, 0xB4, 0x02, 0x02, 0x7E, 0x01, 0x90, 0x81, 0x85, 0xE0, 0x7D, - 0x00, 0xB4, 0x04, 0x02, 0x7D, 0x01, 0xED, 0x4E, 0x70, 0x26, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x03, - 0x02, 0x58, 0xC8, 0x12, 0x47, 0xA8, 0x90, 0x81, 0x86, 0xE0, 0xB4, 0x0C, 0x06, 0xE4, 0xFD, 0x7F, - 0x08, 0x80, 0x0A, 0x90, 0x81, 0x86, 0xE0, 0xB4, 0x04, 0x06, 0xE4, 0xFD, 0xFF, 0x12, 0x4B, 0xD6, - 0x22, 0x22, 0x7E, 0x00, 0x7F, 0x62, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x81, 0x79, 0x87, 0x12, 0x45, - 0x48, 0xB1, 0xBF, 0x12, 0x45, 0x48, 0x90, 0x81, 0x8B, 0x74, 0x02, 0xF0, 0x90, 0x81, 0x92, 0x14, - 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0x90, 0x81, 0x98, 0xE4, 0xF0, 0xA3, 0x74, 0x02, 0xB1, - 0xA8, 0xF0, 0xE4, 0xFD, 0xFF, 0x12, 0x4E, 0x95, 0x7D, 0x0C, 0x7F, 0x02, 0x12, 0x4E, 0x95, 0x12, - 0x4E, 0x91, 0x90, 0x80, 0x42, 0xE0, 0xFF, 0xB4, 0x01, 0x08, 0x90, 0x81, 0x97, 0x74, 0x99, 0xF0, - 0x80, 0x29, 0xEF, 0xB4, 0x03, 0x08, 0x90, 0x81, 0x97, 0x74, 0x90, 0xF0, 0x80, 0x1D, 0x90, 0x81, - 0x97, 0x74, 0x40, 0xF0, 0x90, 0x00, 0x2C, 0xE0, 0x54, 0x0F, 0xFF, 0xBF, 0x05, 0x08, 0x90, 0x81, - 0xA9, 0x74, 0x02, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x81, 0xA9, 0xF0, 0x90, 0x81, 0xE9, 0x74, 0x02, - 0xF0, 0xA3, 0x74, 0x0F, 0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, 0x07, 0xB1, - 0xA8, 0xF0, 0x90, 0x05, 0x58, 0x74, 0x02, 0xF0, 0x7E, 0x00, 0xFF, 0x7D, 0x00, 0x7B, 0x01, 0x7A, - 0x81, 0x79, 0xED, 0x12, 0x45, 0x48, 0xB1, 0xB7, 0x90, 0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x12, - 0x5A, 0x8A, 0xE4, 0x90, 0x81, 0xEF, 0xF0, 0x22, 0xF0, 0x90, 0x81, 0xA9, 0xE0, 0x24, 0x04, 0x90, - 0x81, 0xA4, 0xF0, 0xA3, 0x74, 0x0A, 0x22, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, 0xF0, 0x22, 0x7E, - 0x00, 0x7F, 0x04, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x81, 0x79, 0xF7, 0x22, 0x90, 0x81, 0x87, 0xE0, - 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0x81, 0x95, 0xF0, 0xA3, 0xF0, 0x90, 0x81, 0x90, 0xF0, 0x90, 0x81, - 0x88, 0xE0, 0x54, 0xF7, 0xF0, 0x54, 0xBF, 0xF0, 0x12, 0x49, 0x16, 0x7D, 0x10, 0x7F, 0x03, 0x02, - 0x4A, 0x18, 0xEF, 0x24, 0xFE, 0x60, 0x0B, 0x04, 0x70, 0x24, 0x90, 0x81, 0x92, 0x74, 0x02, 0xF0, - 0x80, 0x13, 0xED, 0x70, 0x06, 0x90, 0x81, 0xEC, 0xE0, 0x80, 0x02, 0xED, 0x14, 0x90, 0x81, 0x92, - 0xF0, 0x90, 0x81, 0x92, 0xE0, 0xA3, 0xF0, 0x90, 0x81, 0x88, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0x7D, - 0x2E, 0x7F, 0x6F, 0x12, 0x4F, 0x13, 0x7D, 0x02, 0x7F, 0x01, 0x12, 0x4E, 0x95, 0xD1, 0x36, 0x90, - 0x81, 0x86, 0x74, 0x02, 0xF0, 0x22, 0x90, 0x05, 0x27, 0xE0, 0x54, 0xBF, 0xF0, 0x22, 0xE4, 0x90, - 0x82, 0x04, 0xF0, 0x90, 0x81, 0x8C, 0xE0, 0x60, 0x4C, 0x12, 0x47, 0x56, 0x70, 0x47, 0xD1, 0x96, - 0xF0, 0x90, 0x82, 0x04, 0x74, 0x01, 0xF0, 0xE4, 0x90, 0x81, 0x93, 0xF0, 0x90, 0x81, 0x82, 0xE0, - 0x30, 0xE0, 0x16, 0x90, 0x81, 0x86, 0xE0, 0xB4, 0x02, 0x05, 0xE4, 0x90, 0x82, 0x04, 0xF0, 0x12, - 0x58, 0xBC, 0xEF, 0x70, 0x04, 0x90, 0x82, 0x04, 0xF0, 0x90, 0x82, 0x04, 0xE0, 0x60, 0x16, 0x12, - 0x6F, 0xA2, 0xE4, 0xF5, 0x1D, 0x90, 0x81, 0x94, 0x12, 0x56, 0xBB, 0x90, 0x81, 0x8F, 0xE0, 0x20, - 0xE2, 0x03, 0x12, 0x4B, 0xD2, 0x22, 0x90, 0x81, 0x92, 0xE0, 0x90, 0x05, 0x73, 0x22, 0x90, 0x81, - 0xF0, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x54, 0xFB, 0xF0, 0x44, 0x10, 0xF0, 0x22, 0x12, - 0x4F, 0x84, 0x90, 0x81, 0x85, 0x74, 0x03, 0xF0, 0x22, 0x90, 0x81, 0x85, 0xE0, 0x64, 0x02, 0x7F, - 0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, 0x90, 0x81, 0x88, 0xE0, 0x44, 0x04, 0x22, 0xE0, 0x90, 0x01, - 0xBA, 0xF0, 0x90, 0x81, 0x8E, 0xE0, 0x90, 0x01, 0xBB, 0x22, 0x90, 0x01, 0x34, 0x74, 0x40, 0xF0, - 0xFD, 0xE4, 0xFF, 0x02, 0x49, 0x20, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xFE, 0xEF, 0x54, 0x07, - 0xFF, 0x22, 0x7F, 0x70, 0x7E, 0x0E, 0x12, 0x2E, 0xA2, 0x90, 0x82, 0xAE, 0x22, 0x90, 0x81, 0x88, - 0xE0, 0xFF, 0x13, 0x13, 0x22, 0x90, 0x81, 0x82, 0xE0, 0xC4, 0x13, 0x13, 0x22, 0x90, 0x81, 0xF9, - 0xE0, 0x90, 0x01, 0x3F, 0x22, 0x90, 0x81, 0xF9, 0xE0, 0x90, 0x05, 0x73, 0x22, 0x90, 0x81, 0x92, - 0xE0, 0xFF, 0xA3, 0xE0, 0x22, 0x90, 0x81, 0x8A, 0xE0, 0xC4, 0x54, 0x0F, 0x22, 0x90, 0x81, 0x87, - 0xE0, 0x13, 0x13, 0x13, 0x22, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, 0x22, 0x00, 0xB0, 0x4D, - -}; -u32 array_length_mp_8188e_t_fw_nic_89em = 14176; - - -#endif - -void -odm_read_firmware_mp_8188e_t_fw_nic_89e_m( - struct PHY_DM_STRUCT *p_dm_odm, - u8 *p_firmware, - u32 *p_firmware_size -) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) - *((SIZE_PTR *)p_firmware) = (SIZE_PTR)array_mp_8188e_t_fw_nic_89em; -#else - odm_move_memory(p_dm_odm, p_firmware, array_mp_8188e_t_fw_nic_89em, array_length_mp_8188e_t_fw_nic_89em); -#endif - *p_firmware_size = array_length_mp_8188e_t_fw_nic_89em; -} - -#ifndef LOAD_FW_HEADER_FROM_DRIVER -u8 array_mp_8188e_t_fw_wowlan[] = { - 0xE1, 0x88, 0x30, 0x00, 0x17, 0x00, 0x00, 0x00, 0x03, 0x25, 0x13, 0x14, 0x0E, 0x3E, 0x00, 0x00, - 0x0C, 0x27, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x02, 0x47, 0x17, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x02, 0x48, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0xE1, 0xB1, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x50, 0x03, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 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, - 0xE7, 0x09, 0xF6, 0x08, 0xDF, 0xFA, 0x80, 0x46, 0xE7, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x3E, - 0x88, 0x82, 0x8C, 0x83, 0xE7, 0x09, 0xF0, 0xA3, 0xDF, 0xFA, 0x80, 0x32, 0xE3, 0x09, 0xF6, 0x08, - 0xDF, 0xFA, 0x80, 0x78, 0xE3, 0x09, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x70, 0x88, 0x82, 0x8C, 0x83, - 0xE3, 0x09, 0xF0, 0xA3, 0xDF, 0xFA, 0x80, 0x64, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF6, 0x08, - 0xDF, 0xFA, 0x80, 0x58, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xA3, 0xF2, 0x08, 0xDF, 0xFA, 0x80, 0x4C, - 0x80, 0xD2, 0x80, 0xFA, 0x80, 0xC6, 0x80, 0xD4, 0x80, 0x69, 0x80, 0xF2, 0x80, 0x33, 0x80, 0x10, - 0x80, 0xA6, 0x80, 0xEA, 0x80, 0x9A, 0x80, 0xA8, 0x80, 0xDA, 0x80, 0xE2, 0x80, 0xCA, 0x80, 0x33, - 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, - 0xCC, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, - 0x0D, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xA3, 0xF6, 0x08, 0xDF, 0xF9, 0xEC, 0xFA, 0xA9, 0xF0, - 0xED, 0xFB, 0x22, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, - 0xC5, 0x83, 0xCC, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xDF, 0xEA, 0xDE, - 0xE8, 0x80, 0xDB, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xA3, 0xF2, 0x08, 0xDF, 0xF9, 0x80, 0xCC, - 0x88, 0xF0, 0xEF, 0x60, 0x01, 0x0E, 0x4E, 0x60, 0xC3, 0x88, 0xF0, 0xED, 0x24, 0x02, 0xB4, 0x04, - 0x00, 0x50, 0xB9, 0xF5, 0x82, 0xEB, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0xAF, 0x23, 0x23, 0x45, - 0x82, 0x23, 0x90, 0x41, 0x50, 0x73, 0xC5, 0xF0, 0xF8, 0xA3, 0xE0, 0x28, 0xF0, 0xC5, 0xF0, 0xF8, - 0xE5, 0x82, 0x15, 0x82, 0x70, 0x02, 0x15, 0x83, 0xE0, 0x38, 0xF0, 0x22, 0xC3, 0xEF, 0x9B, 0xFF, - 0xEE, 0x9A, 0xFE, 0xED, 0x99, 0xFD, 0xEC, 0x98, 0xFC, 0x22, 0xEF, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, - 0xED, 0x49, 0xFD, 0xEC, 0x48, 0xFC, 0x22, 0xEB, 0x9F, 0xF5, 0xF0, 0xEA, 0x9E, 0x42, 0xF0, 0xE9, - 0x9D, 0x42, 0xF0, 0xE8, 0x9C, 0x45, 0xF0, 0x22, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFE, - 0xA3, 0xE0, 0xFF, 0x22, 0xE0, 0xF8, 0xA3, 0xE0, 0xF9, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0x22, - 0xA4, 0x25, 0x82, 0xF5, 0x82, 0xE5, 0xF0, 0x35, 0x83, 0xF5, 0x83, 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, 0x43, 0xC3, 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, 0x43, 0xCF, 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, 0x43, 0x0B, 0x73, 0xEF, 0x4E, - 0x60, 0x12, 0xEF, 0x60, 0x01, 0x0E, 0xED, 0xBB, 0x01, 0x0B, 0x89, 0x82, 0x8A, 0x83, 0xF0, 0xA3, - 0xDF, 0xFC, 0xDE, 0xFA, 0x22, 0x89, 0xF0, 0x50, 0x07, 0xF7, 0x09, 0xDF, 0xFC, 0xA9, 0xF0, 0x22, - 0xBB, 0xFE, 0xFC, 0xF3, 0x09, 0xDF, 0xFC, 0xA9, 0xF0, 0x22, 0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, - 0x44, 0x6E, 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, 0x47, 0xAB, 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, 0x47, 0xAB, 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, 0x44, - 0xB7, 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, 0x44, 0xB6, 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, 0x44, 0xB7, 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, 0xC2, 0xAF, 0x56, 0xC6, 0xD2, 0xAF, - 0xD2, 0xA9, 0x54, 0x80, 0x4F, 0xFF, 0x22, 0x02, 0x47, 0x55, 0x02, 0x45, 0x47, 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, 0x47, 0x9A, 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, 0x84, 0x5F, 0x00, 0x41, 0x84, - 0x60, 0x00, 0x41, 0x84, 0x6F, 0x00, 0x41, 0x84, 0x70, 0x00, 0x00, 0x5F, 0xFF, 0x67, 0xEF, 0x6A, - 0x62, 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, 0xB1, 0xF0, 0x74, 0x47, 0xA3, 0xF0, 0x12, 0x74, 0xB8, 0x74, 0xB1, 0x04, 0x90, 0x01, - 0xC4, 0xF0, 0x74, 0x47, 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, 0x01, 0xF0, 0x74, 0x48, 0xA3, 0xF0, 0x12, 0x74, 0xF2, 0xE5, 0x41, 0x30, 0xE3, 0x03, - 0x12, 0x75, 0x4F, 0xE5, 0x41, 0x30, 0xE4, 0x03, 0x12, 0x64, 0x74, 0xE5, 0x43, 0x30, 0xE0, 0x02, - 0xF1, 0xF9, 0xE5, 0x43, 0x30, 0xE1, 0x02, 0x11, 0x9E, 0xE5, 0x43, 0x30, 0xE2, 0x03, 0x12, 0x75, - 0x98, 0xE5, 0x43, 0x30, 0xE3, 0x02, 0xF1, 0x30, 0xE5, 0x43, 0x30, 0xE4, 0x03, 0x12, 0x65, 0x6C, - 0xE5, 0x43, 0x30, 0xE5, 0x03, 0x12, 0x75, 0xB0, 0xE5, 0x43, 0x30, 0xE6, 0x03, 0x12, 0x64, 0xFA, - 0xE5, 0x44, 0x30, 0xE1, 0x03, 0x12, 0x75, 0xCC, 0x74, 0x01, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, - 0x48, 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, 0x81, - 0x4B, 0xE0, 0x70, 0x02, 0x21, 0x32, 0x90, 0x81, 0x62, 0xE0, 0x04, 0x31, 0x3E, 0x12, 0x42, 0x1A, - 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, 0x31, 0x58, 0x78, 0x10, 0x12, - 0x20, 0xBB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x42, 0x1A, 0xC0, 0x04, 0xC0, - 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x31, 0x58, 0x78, 0x18, 0x12, 0x20, 0xBB, 0xD0, 0x03, 0xD0, - 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x42, 0x1A, 0x90, 0x81, 0x96, 0x12, 0x7D, 0x5B, 0x54, 0x7F, - 0xF0, 0xA3, 0xE0, 0x30, 0xE0, 0x0F, 0x12, 0x77, 0x5C, 0x90, 0x84, 0x58, 0x74, 0x05, 0xF0, 0x12, - 0x76, 0x79, 0x12, 0x77, 0x49, 0x12, 0x52, 0x3F, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x0D, 0x90, 0x01, - 0x3B, 0xE0, 0x30, 0xE4, 0x06, 0x12, 0x51, 0x4D, 0x12, 0x7D, 0xF5, 0x90, 0x84, 0x69, 0xE0, 0x04, - 0xF0, 0xE0, 0xC3, 0x94, 0x80, 0x40, 0x0B, 0x90, 0x01, 0x98, 0xE0, 0x54, 0xFE, 0xF0, 0xE0, 0x44, - 0x01, 0xF0, 0x12, 0x61, 0x82, 0x12, 0x79, 0xB2, 0xE4, 0x90, 0x83, 0xA4, 0xF0, 0x22, 0xF0, 0x90, - 0x05, 0x61, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x78, 0x08, 0x12, 0x20, 0xBB, 0xA8, 0x04, 0xA9, - 0x05, 0xAA, 0x06, 0xAB, 0x07, 0x90, 0x05, 0x60, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x22, 0x31, - 0x3F, 0x12, 0x42, 0x1A, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, 0x31, - 0x58, 0x78, 0x10, 0x12, 0x20, 0xBB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x42, - 0x1A, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x31, 0x58, 0x78, 0x18, 0x12, 0x20, - 0xBB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x42, 0x1A, 0x90, 0x81, 0x9A, 0x12, - 0x20, 0xCE, 0x90, 0x81, 0x9E, 0x12, 0x42, 0x38, 0x90, 0x81, 0x9A, 0x12, 0x42, 0x44, 0xC3, 0x12, - 0x42, 0x27, 0x40, 0x41, 0x90, 0x81, 0x46, 0xE0, 0x90, 0x81, 0x9E, 0x30, 0xE0, 0x10, 0x12, 0x7D, - 0x2D, 0x90, 0x81, 0x68, 0xE0, 0x24, 0x04, 0x2F, 0xFF, 0x90, 0x81, 0xA2, 0x80, 0x06, 0x12, 0x7D, - 0x2D, 0x90, 0x81, 0xA3, 0xE0, 0xFE, 0xC3, 0xEF, 0x9E, 0x90, 0x83, 0xB5, 0xF0, 0x90, 0x83, 0xB5, - 0xE0, 0xFF, 0xC3, 0x94, 0x2D, 0x50, 0x0E, 0x74, 0x69, 0x2F, 0x51, 0xC7, 0xE0, 0x04, 0xF0, 0x90, - 0x81, 0x61, 0xE0, 0x04, 0xF0, 0x90, 0x81, 0x61, 0xE0, 0xFF, 0xD3, 0x90, 0x81, 0xA5, 0xE0, 0x9F, - 0x90, 0x81, 0xA4, 0xE0, 0x94, 0x00, 0x40, 0x02, 0x41, 0xC3, 0xE4, 0xFF, 0xFE, 0x51, 0xC4, 0x12, - 0x7D, 0xA1, 0xEF, 0xD3, 0x9D, 0x40, 0x07, 0x90, 0x83, 0xB6, 0xEE, 0xF0, 0x80, 0x05, 0x0E, 0xEE, - 0xB4, 0x2D, 0xEA, 0xE4, 0xFF, 0xFE, 0x51, 0xC4, 0x12, 0x7D, 0xA1, 0xC3, 0x90, 0x81, 0xA5, 0xE0, - 0x9D, 0xFD, 0x90, 0x81, 0xA4, 0xE0, 0x94, 0x00, 0xFC, 0xEF, 0xD3, 0x9D, 0xE4, 0x9C, 0x40, 0x07, - 0x90, 0x83, 0xB7, 0xEE, 0xF0, 0x80, 0x05, 0x0E, 0xEE, 0xB4, 0x2D, 0xDA, 0x90, 0x83, 0xB6, 0xE0, - 0x90, 0x81, 0x66, 0xF0, 0x90, 0x83, 0xB7, 0xE0, 0x90, 0x81, 0x67, 0x12, 0x7D, 0xDD, 0x94, 0x0A, - 0x40, 0x0A, 0xEF, 0x24, 0xF6, 0x90, 0x81, 0x5E, 0xF0, 0xE4, 0x80, 0x0A, 0xE4, 0x90, 0x81, 0x5E, - 0x12, 0x7D, 0xDD, 0x74, 0x0A, 0x9F, 0x90, 0x81, 0x5D, 0xF0, 0x90, 0x81, 0x66, 0xE0, 0xFF, 0xA3, - 0xE0, 0xC3, 0x9F, 0x90, 0x81, 0x64, 0xF0, 0x90, 0x81, 0x46, 0xE0, 0x30, 0xE0, 0x05, 0x90, 0x81, - 0xA2, 0x80, 0x03, 0x90, 0x81, 0xA3, 0xE0, 0x04, 0xFF, 0x90, 0x81, 0x64, 0xE0, 0x2F, 0xF0, 0x90, - 0x81, 0x64, 0xE0, 0xC3, 0x94, 0x0A, 0x50, 0x03, 0x74, 0x0A, 0xF0, 0x90, 0x81, 0x64, 0xE0, 0x24, - 0x02, 0xF0, 0x12, 0x77, 0x5C, 0x90, 0x84, 0x58, 0x74, 0x03, 0xF0, 0x12, 0x76, 0x79, 0xE4, 0xFF, - 0x12, 0x79, 0x3F, 0x22, 0x74, 0x69, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, 0xE4, - 0x90, 0x83, 0xB8, 0xF0, 0x90, 0x81, 0x4B, 0xE0, 0x60, 0x6B, 0xF1, 0x06, 0x64, 0x01, 0x70, 0x65, - 0x12, 0x7D, 0xFC, 0x31, 0x3E, 0x12, 0x42, 0x1A, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, - 0x90, 0x05, 0x62, 0x31, 0x58, 0x78, 0x10, 0x12, 0x20, 0xBB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, - 0xD0, 0x00, 0x12, 0x42, 0x1A, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x31, 0x58, - 0x78, 0x18, 0x12, 0x20, 0xBB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x7D, 0x55, - 0x44, 0x80, 0xF0, 0x90, 0x83, 0xB8, 0x74, 0x01, 0xF0, 0xE4, 0x90, 0x81, 0x52, 0xF0, 0x04, 0x60, - 0x14, 0xF1, 0xFB, 0xE4, 0xF5, 0x1D, 0x90, 0x81, 0x53, 0xE0, 0xD1, 0x9D, 0x90, 0x81, 0x4E, 0xE0, - 0x20, 0xE2, 0x02, 0x71, 0x46, 0x22, 0x7D, 0x01, 0x7F, 0x04, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, - 0xD0, 0x90, 0x84, 0x6C, 0xED, 0xF0, 0x90, 0x81, 0x46, 0xE0, 0xFE, 0xC4, 0x13, 0x13, 0x54, 0x03, - 0x30, 0xE0, 0x02, 0x81, 0x97, 0xEE, 0x12, 0x5F, 0x80, 0x30, 0xE0, 0x02, 0x81, 0x97, 0x90, 0x81, - 0x4E, 0xE0, 0xFE, 0x6F, 0x70, 0x02, 0x81, 0x97, 0xEF, 0x70, 0x02, 0x81, 0x08, 0x24, 0xFE, 0x70, - 0x02, 0x81, 0x42, 0x24, 0xFE, 0x60, 0x49, 0x24, 0xFC, 0x70, 0x02, 0x81, 0x7C, 0x24, 0xFC, 0x60, - 0x02, 0x81, 0x8D, 0xEE, 0xB4, 0x0E, 0x02, 0x91, 0xE1, 0x90, 0x81, 0x4E, 0xE0, 0x70, 0x04, 0x7F, - 0x01, 0xB1, 0x1D, 0x90, 0x81, 0x4E, 0xE0, 0xB4, 0x06, 0x02, 0x91, 0xFC, 0x90, 0x81, 0x4E, 0xE0, - 0xB4, 0x04, 0x0E, 0x90, 0x84, 0x6C, 0xE0, 0xFF, 0x60, 0x04, 0xF1, 0x45, 0x80, 0x03, 0x12, 0x51, - 0x41, 0x90, 0x81, 0x4E, 0xE0, 0x64, 0x08, 0x60, 0x02, 0x81, 0x8D, 0x12, 0x79, 0x91, 0x81, 0x8D, - 0x90, 0x81, 0x4E, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0xB1, 0x1D, 0x90, 0x81, 0x4E, 0xE0, 0xB4, 0x06, - 0x02, 0x91, 0xFC, 0x90, 0x81, 0x4E, 0xE0, 0xB4, 0x0E, 0x07, 0x91, 0x9C, 0xBF, 0x01, 0x02, 0x91, - 0xE1, 0x90, 0x81, 0x4E, 0xE0, 0x64, 0x0C, 0x60, 0x02, 0x81, 0x8D, 0x91, 0x9C, 0xEF, 0x64, 0x01, - 0x60, 0x02, 0x81, 0x8D, 0xB1, 0x34, 0x81, 0x8D, 0x90, 0x81, 0x4E, 0xE0, 0xB4, 0x0E, 0x07, 0x91, - 0x9C, 0xBF, 0x01, 0x02, 0x91, 0xE1, 0x90, 0x81, 0x4E, 0xE0, 0xB4, 0x06, 0x02, 0x91, 0xFC, 0x90, - 0x81, 0x4E, 0xE0, 0xB4, 0x0C, 0x07, 0x91, 0x9C, 0xBF, 0x01, 0x02, 0xB1, 0x34, 0x90, 0x81, 0x4E, - 0xE0, 0x64, 0x04, 0x70, 0x58, 0x12, 0x69, 0x80, 0xEF, 0x64, 0x01, 0x70, 0x50, 0x12, 0x72, 0x09, - 0x80, 0x4B, 0x90, 0x81, 0x4E, 0xE0, 0xB4, 0x0E, 0x07, 0x91, 0x9C, 0xBF, 0x01, 0x02, 0x91, 0xE1, - 0x90, 0x81, 0x4E, 0xE0, 0xB4, 0x06, 0x02, 0x91, 0xFC, 0x90, 0x81, 0x4E, 0xE0, 0xB4, 0x0C, 0x07, - 0x91, 0x9C, 0xBF, 0x01, 0x02, 0xB1, 0x34, 0x90, 0x81, 0x4E, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0xB1, - 0x1D, 0x90, 0x81, 0x4E, 0xE0, 0xB4, 0x04, 0x15, 0xF1, 0xED, 0x80, 0x11, 0x90, 0x81, 0x4E, 0xE0, - 0xB4, 0x0C, 0x0A, 0x12, 0x52, 0x3F, 0x54, 0x3F, 0x30, 0xE0, 0x02, 0xF1, 0xE2, 0x90, 0x81, 0x4E, - 0x12, 0x7D, 0x97, 0x90, 0x01, 0xBB, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, - 0xC3, 0xC0, 0xD0, 0x12, 0x6A, 0x05, 0xEF, 0x64, 0x01, 0x60, 0x05, 0x75, 0x1F, 0x01, 0x80, 0x1E, - 0x12, 0x76, 0x26, 0x30, 0xE0, 0x05, 0x75, 0x1F, 0x02, 0x80, 0x13, 0x90, 0x81, 0x4D, 0xE0, 0xD3, - 0x94, 0x04, 0x40, 0x05, 0x75, 0x1F, 0x08, 0x80, 0x05, 0x12, 0x69, 0x78, 0x80, 0x0E, 0x90, 0x01, - 0xB9, 0x74, 0x02, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x1F, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, - 0x22, 0x90, 0x81, 0x47, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x04, 0x7D, 0x0C, 0x80, 0x05, 0x12, 0x79, - 0x1C, 0x7D, 0x04, 0x7F, 0x01, 0xB1, 0x7B, 0xE4, 0xFD, 0xFF, 0x80, 0x70, 0x90, 0x81, 0x47, 0xE0, - 0x90, 0x06, 0x04, 0x20, 0xE0, 0x08, 0xE0, 0x44, 0x40, 0xF0, 0x7D, 0x04, 0x80, 0x06, 0xE0, 0x54, - 0x7F, 0xF0, 0x7D, 0x0C, 0x7F, 0x01, 0xB1, 0x7B, 0xE4, 0xFD, 0xFF, 0x80, 0x4F, 0x90, 0x84, 0x6B, - 0xEF, 0xF0, 0x12, 0x53, 0x64, 0x90, 0x84, 0x6B, 0xE0, 0x60, 0x03, 0x12, 0x57, 0xBE, 0x7D, 0x04, - 0x7F, 0x01, 0x80, 0x47, 0xF1, 0x06, 0x64, 0x01, 0x70, 0x28, 0x90, 0x81, 0x47, 0xE0, 0x54, 0xFD, - 0xF0, 0x7D, 0x2C, 0x7F, 0x6F, 0xB1, 0x6C, 0x7D, 0x08, 0x7F, 0x01, 0xF1, 0x7F, 0xBF, 0x01, 0x0D, - 0x90, 0x81, 0x46, 0xE0, 0x44, 0x80, 0xF0, 0x7D, 0x0E, 0x7F, 0x01, 0x80, 0x1E, 0x12, 0x64, 0xF0, - 0x04, 0xF0, 0x22, 0xE4, 0xFD, 0x7F, 0x0C, 0x71, 0x4A, 0xE4, 0xFD, 0xFF, 0x90, 0x05, 0x22, 0xEF, - 0xF0, 0x90, 0x80, 0x05, 0xED, 0xF0, 0x22, 0x7D, 0x0C, 0x7F, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, - 0xC0, 0xD0, 0xAC, 0x07, 0xEF, 0x14, 0x60, 0x15, 0x14, 0x60, 0x19, 0x24, 0x02, 0x70, 0x1A, 0xED, - 0x54, 0x01, 0xFE, 0x90, 0x81, 0x46, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0x80, 0x0C, 0x90, 0x81, 0x4E, - 0xED, 0xF0, 0x80, 0x05, 0x90, 0x81, 0x4D, 0xED, 0xF0, 0x90, 0x00, 0x8F, 0xE0, 0x30, 0xE4, 0x2E, - 0xEC, 0x14, 0x60, 0x07, 0x14, 0x60, 0x1D, 0x24, 0x02, 0x70, 0x23, 0x90, 0x81, 0x46, 0xE0, 0x54, - 0x01, 0xC4, 0x33, 0x33, 0x33, 0x54, 0x80, 0xFF, 0x90, 0x81, 0x4E, 0xE0, 0x54, 0x7F, 0x4F, 0xFD, - 0x7F, 0x88, 0x80, 0x07, 0x90, 0x81, 0x4D, 0xE0, 0xFD, 0x7F, 0x89, 0x12, 0x32, 0x1E, 0xD0, 0xD0, - 0x92, 0xAF, 0x22, 0xE4, 0xF5, 0x4E, 0x90, 0x81, 0x4B, 0xE0, 0x70, 0x02, 0xC1, 0x96, 0xF1, 0x06, - 0x64, 0x01, 0x60, 0x02, 0xC1, 0x96, 0x31, 0x3F, 0x12, 0x42, 0x1A, 0xC0, 0x04, 0xC0, 0x05, 0xC0, - 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, 0x31, 0x58, 0x78, 0x10, 0x12, 0x20, 0xBB, 0xD0, 0x03, 0xD0, - 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x42, 0x1A, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, - 0xA3, 0x31, 0x58, 0x78, 0x18, 0x12, 0x20, 0xBB, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, - 0x12, 0x7D, 0x55, 0x44, 0x80, 0xF0, 0x12, 0x7D, 0xED, 0x60, 0x22, 0x24, 0xFE, 0x60, 0x03, 0x04, - 0x70, 0x1E, 0x90, 0x81, 0x52, 0xE0, 0x14, 0xF0, 0xE0, 0xFF, 0x60, 0x06, 0x90, 0x81, 0x54, 0xE0, - 0x60, 0x0E, 0xEF, 0x70, 0x08, 0x90, 0x81, 0x51, 0xE0, 0xA3, 0xF0, 0x80, 0x00, 0x75, 0x4E, 0x01, - 0xE5, 0x4E, 0x60, 0x32, 0xF1, 0xFB, 0x90, 0x81, 0x54, 0xE0, 0x60, 0x04, 0x64, 0x01, 0x70, 0x0F, - 0xE4, 0xF5, 0x1D, 0x90, 0x81, 0x54, 0xE0, 0xD1, 0x97, 0x90, 0x81, 0x54, 0xE0, 0x80, 0x0B, 0xE4, - 0xF5, 0x1D, 0x12, 0x7D, 0x4A, 0xD1, 0x97, 0x12, 0x7D, 0x4A, 0x12, 0x7D, 0x8C, 0x90, 0x81, 0x4E, - 0xE0, 0x20, 0xE2, 0x02, 0x71, 0x46, 0x22, 0xFF, 0x90, 0x81, 0x53, 0xE0, 0x2F, 0xF5, 0x1E, 0xE4, - 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8E, 0x19, 0x8F, - 0x1A, 0xE5, 0x1E, 0xD1, 0xFE, 0x85, 0x19, 0x83, 0x85, 0x1A, 0x82, 0xF0, 0xE5, 0x1D, 0xD1, 0xFE, - 0xFF, 0xE5, 0x1E, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x4F, 0xA3, 0xF0, 0xEB, 0xD1, 0xFE, 0xFF, 0xE5, - 0x1D, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x4F, 0xF1, 0xDA, 0xA3, 0xF0, 0xBD, 0x01, 0x0D, 0x85, 0x1A, - 0x82, 0x8E, 0x83, 0xA3, 0xA3, 0xA3, 0x74, 0x03, 0xF0, 0x80, 0x07, 0xF1, 0xDA, 0xA3, 0xA3, 0x74, - 0x01, 0xF0, 0xF1, 0xDA, 0xA3, 0xA3, 0x74, 0x05, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x54, 0x07, - 0xC4, 0x33, 0x54, 0xE0, 0x22, 0xF0, 0xE4, 0xFF, 0xF1, 0x0C, 0xEF, 0x22, 0x12, 0x7D, 0x80, 0x12, - 0x60, 0xC4, 0xE0, 0xFD, 0x7C, 0x00, 0x12, 0x62, 0x64, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, - 0xD8, 0xF9, 0xFF, 0xEE, 0x5C, 0xFE, 0xEF, 0x5D, 0x4E, 0x7F, 0x00, 0x60, 0x02, 0x7F, 0x01, 0x22, - 0xF1, 0x06, 0x64, 0x01, 0x70, 0x0E, 0x90, 0x81, 0x4B, 0xE0, 0x60, 0x08, 0x12, 0x67, 0xCD, 0x12, - 0x67, 0xB0, 0xD1, 0x9D, 0x22, 0xEF, 0x60, 0x32, 0xF1, 0x06, 0x64, 0x01, 0x70, 0x2C, 0x90, 0x81, - 0x47, 0xE0, 0x54, 0xFE, 0xF0, 0x7D, 0x2B, 0x7F, 0x0F, 0xB1, 0x6C, 0x90, 0x06, 0x04, 0xE0, 0x54, - 0xBF, 0xF0, 0xF1, 0x7B, 0xBF, 0x01, 0x0D, 0x90, 0x81, 0x46, 0xE0, 0x44, 0x40, 0xF0, 0x7D, 0x06, - 0x7F, 0x01, 0xA1, 0x7B, 0x12, 0x64, 0xF0, 0x74, 0x08, 0xF0, 0x22, 0x7D, 0x08, 0xE4, 0xFF, 0xD3, - 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x84, 0x40, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x80, - 0x03, 0xE0, 0x04, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x20, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x84, - 0x44, 0xF0, 0x7D, 0x26, 0x12, 0x6F, 0x91, 0x70, 0x03, 0x12, 0x66, 0x4B, 0x90, 0x84, 0x44, 0xE0, - 0xFF, 0x7D, 0x27, 0xB1, 0x6C, 0x12, 0x78, 0xB6, 0x80, 0x06, 0x12, 0x78, 0xB6, 0x12, 0x66, 0x4B, - 0x12, 0x67, 0xA0, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x75, 0xF1, 0x90, 0x81, 0x4E, - 0xE0, 0x64, 0x0C, 0x60, 0x04, 0xB1, 0x63, 0xF1, 0x7B, 0x22, 0x85, 0x1A, 0x82, 0x85, 0x19, 0x83, - 0xA3, 0x22, 0x7D, 0x2F, 0x12, 0x71, 0xA1, 0x7D, 0x08, 0x7F, 0x01, 0xA1, 0x7B, 0x7D, 0x2E, 0x7F, - 0x6F, 0xB1, 0x6C, 0x7D, 0x02, 0x7F, 0x01, 0xA1, 0x7B, 0xA1, 0xE3, 0x90, 0x81, 0x4F, 0xE0, 0x44, - 0x10, 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, 0x03, 0xF0, 0x74, 0x50, 0xA3, 0xF0, 0x12, 0x75, 0x1F, 0xE5, 0x49, 0x30, - 0xE1, 0x02, 0x11, 0x8A, 0xE5, 0x49, 0x30, 0xE2, 0x02, 0x11, 0x9C, 0xE5, 0x4A, 0x30, 0xE0, 0x03, - 0x12, 0x76, 0x30, 0xE5, 0x4C, 0x30, 0xE1, 0x05, 0x7F, 0x04, 0x12, 0x64, 0x78, 0xE5, 0x4C, 0x30, - 0xE4, 0x02, 0x11, 0x93, 0xE5, 0x4C, 0x30, 0xE5, 0x03, 0x12, 0x64, 0x87, 0xE5, 0x4C, 0x30, 0xE6, - 0x03, 0x12, 0x64, 0xB0, 0x74, 0x03, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x50, 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, 0x81, 0x4B, 0xE0, 0x60, 0x02, - 0x51, 0x47, 0x22, 0x12, 0x4A, 0xCF, 0x7D, 0x02, 0x7F, 0x02, 0x21, 0x35, 0x90, 0x81, 0x4B, 0xE0, - 0x60, 0x0F, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, 0x03, 0x02, 0x75, 0xF1, 0x11, 0xB6, 0x12, 0x64, - 0xE5, 0x22, 0x71, 0x64, 0x31, 0x41, 0x90, 0x81, 0x46, 0xE0, 0x54, 0xF7, 0xF0, 0x22, 0xEF, 0x70, - 0x30, 0x7D, 0x78, 0x7F, 0x02, 0x31, 0x51, 0x7D, 0x02, 0x7F, 0x03, 0x31, 0x51, 0x7D, 0xC8, 0x7F, - 0x02, 0x51, 0x2B, 0x12, 0x67, 0xCD, 0x12, 0x4F, 0x05, 0x70, 0x0A, 0x11, 0xB2, 0x54, 0xBF, 0xF0, - 0x54, 0x7F, 0xF0, 0x80, 0x07, 0x7D, 0x01, 0x7F, 0x0C, 0x12, 0x4B, 0x4A, 0x11, 0xB6, 0x02, 0x79, - 0x14, 0x90, 0x01, 0x36, 0x74, 0x78, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x7D, 0x78, 0xFF, 0x31, 0x35, - 0x7D, 0x02, 0x7F, 0x03, 0x31, 0x35, 0x90, 0x06, 0x0A, 0xE0, 0x44, 0x07, 0x12, 0x77, 0x51, 0xE4, - 0xFF, 0x12, 0x4F, 0x0C, 0xBF, 0x01, 0x10, 0x51, 0xB2, 0x90, 0x81, 0x4E, 0xE0, 0x20, 0xE2, 0x0A, - 0x7D, 0x01, 0x7F, 0x04, 0x02, 0x4B, 0x4A, 0x12, 0x7D, 0xE5, 0x22, 0x7D, 0x01, 0x7F, 0x02, 0x31, - 0x35, 0x7D, 0x02, 0x7F, 0x02, 0x74, 0x3D, 0x2F, 0xF8, 0xE6, 0x4D, 0xFE, 0xF6, 0x74, 0x30, 0x41, - 0x34, 0x12, 0x78, 0xAE, 0xF1, 0xBE, 0x7D, 0x0C, 0x7F, 0x01, 0x02, 0x4D, 0x7B, 0x7D, 0x02, 0x7F, - 0x02, 0x74, 0x3D, 0x12, 0x7E, 0x04, 0xFE, 0xF6, 0x74, 0x30, 0x41, 0x34, 0x90, 0x05, 0x62, 0xE0, - 0xFE, 0x90, 0x05, 0x61, 0xE0, 0xFD, 0xED, 0x78, 0x02, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, - 0xFF, 0x90, 0x83, 0xB3, 0xEE, 0xF0, 0xA3, 0xEF, 0x12, 0x4F, 0x05, 0x64, 0x01, 0x60, 0x02, 0x41, - 0x2A, 0x90, 0x81, 0x4B, 0xE0, 0x70, 0x02, 0x41, 0x2A, 0x51, 0xC2, 0x64, 0x01, 0x70, 0x22, 0x90, - 0x06, 0xAB, 0xE0, 0x90, 0x81, 0x52, 0xF0, 0x90, 0x06, 0xAA, 0xE0, 0x90, 0x81, 0x51, 0xF0, 0xA3, - 0xE0, 0xFF, 0x70, 0x08, 0x90, 0x81, 0x51, 0xE0, 0xFE, 0xFF, 0x80, 0x00, 0x90, 0x81, 0x52, 0xEF, - 0xF0, 0x12, 0x49, 0x5F, 0xE4, 0x90, 0x81, 0x54, 0x12, 0x77, 0x51, 0x12, 0x67, 0xCD, 0x12, 0x67, - 0xDA, 0x54, 0xEF, 0xF0, 0x51, 0xC2, 0x24, 0xFD, 0x50, 0x02, 0x80, 0x03, 0x12, 0x65, 0x19, 0x51, - 0x3F, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x50, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x21, - 0x51, 0xBA, 0x6F, 0x70, 0x42, 0x90, 0x81, 0x47, 0xE0, 0x44, 0x40, 0xF0, 0x12, 0x7D, 0xFC, 0x51, - 0xCB, 0x12, 0x77, 0xE5, 0x12, 0x7D, 0xF5, 0x31, 0x4D, 0x90, 0x81, 0x52, 0xE0, 0x14, 0xF0, 0x80, - 0x26, 0x12, 0x7D, 0xED, 0x64, 0x01, 0x70, 0x1F, 0x51, 0xBA, 0xFE, 0x6F, 0x60, 0x19, 0x90, 0x05, - 0x73, 0xE0, 0xFF, 0xEE, 0x6F, 0x60, 0x10, 0x51, 0x3F, 0x54, 0x3F, 0x30, 0xE0, 0x09, 0xEF, 0x54, - 0xBF, 0x51, 0xCB, 0x51, 0x2B, 0x31, 0x2B, 0x12, 0x7D, 0xE5, 0x22, 0x74, 0x45, 0x12, 0x7E, 0x04, - 0xFE, 0xF6, 0x74, 0x38, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x01, 0xF5, 0x83, 0xEE, 0xF0, 0x22, 0x90, - 0x81, 0x47, 0xE0, 0xFF, 0x13, 0x13, 0x22, 0x51, 0x3F, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x0B, 0xEF, - 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0x31, 0x4D, 0x90, 0x81, 0x46, 0x12, 0x67, 0x80, - 0x30, 0xE0, 0x0A, 0xEF, 0x12, 0x67, 0xD8, 0x54, 0x07, 0x70, 0x46, 0x80, 0x41, 0x90, 0x81, 0x54, - 0xE0, 0x04, 0xF0, 0x90, 0x81, 0x4F, 0xE0, 0x54, 0xEF, 0xF0, 0x12, 0x7D, 0x74, 0x40, 0x2F, 0x12, - 0x4F, 0x06, 0x64, 0x01, 0x70, 0x2B, 0xF1, 0x33, 0x70, 0x04, 0x71, 0x2D, 0x80, 0x24, 0x71, 0x2D, - 0x90, 0x81, 0x55, 0xE0, 0x04, 0xF0, 0xE0, 0xD3, 0x94, 0x02, 0x40, 0x09, 0x51, 0xB2, 0xE4, 0x90, - 0x81, 0x55, 0xF0, 0x80, 0x03, 0x12, 0x4F, 0xCA, 0xE4, 0x90, 0x81, 0x54, 0xF0, 0x22, 0x12, 0x64, - 0xE5, 0x22, 0x90, 0x81, 0x47, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x90, 0x81, 0x51, 0xE0, 0xFF, 0xA3, - 0xE0, 0x22, 0x90, 0x81, 0x49, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x22, 0xF0, 0x90, 0x01, 0x3F, 0x74, - 0x10, 0xF0, 0xFD, 0x7F, 0x03, 0x22, 0x90, 0x81, 0x46, 0xE0, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0x81, - 0x54, 0xF0, 0xA3, 0xF0, 0x90, 0x81, 0x4F, 0xF0, 0x90, 0x81, 0x47, 0xE0, 0x54, 0xF7, 0xF0, 0x54, - 0xBF, 0xF0, 0x31, 0x2B, 0x7D, 0x10, 0x7F, 0x03, 0x41, 0x2B, 0x90, 0x83, 0xCA, 0x12, 0x42, 0x65, - 0x51, 0xD6, 0x90, 0x81, 0x4B, 0xE0, 0xFF, 0x11, 0xBE, 0x90, 0x81, 0x4B, 0xE0, 0x60, 0x1D, 0x90, - 0x83, 0xCA, 0x12, 0x42, 0x5C, 0xB1, 0xD0, 0x54, 0x0F, 0xFF, 0xB1, 0xC8, 0xFD, 0x12, 0x79, 0x64, - 0x12, 0x77, 0x5C, 0x90, 0x84, 0x58, 0x74, 0x01, 0xF0, 0x12, 0x76, 0x79, 0x22, 0x12, 0x7D, 0x74, - 0x40, 0x31, 0x90, 0x81, 0x65, 0xE0, 0x04, 0xF0, 0x90, 0x81, 0xA7, 0xE0, 0xFF, 0x90, 0x81, 0x65, - 0xE0, 0xD3, 0x9F, 0x50, 0x1E, 0x90, 0x81, 0x5D, 0xE0, 0x04, 0xF0, 0x12, 0x7D, 0x4A, 0x12, 0x7D, - 0x8C, 0xFB, 0x90, 0x81, 0x5D, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x84, 0x58, 0x74, 0x04, 0xF0, - 0x12, 0x76, 0x79, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 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, 0x72, 0xAE, 0x54, 0x7F, 0xFC, 0x90, 0x84, 0x4D, 0x12, 0x20, 0xCE, - 0x90, 0x84, 0x4D, 0x12, 0x71, 0x12, 0x7F, 0x7C, 0x12, 0x72, 0x00, 0x12, 0x20, 0xDA, 0xCC, 0xC0, - 0x00, 0xC0, 0x12, 0x71, 0xFE, 0x12, 0x20, 0xDA, 0x00, 0xC0, 0x00, 0x14, 0x12, 0x72, 0xB7, 0x12, - 0x20, 0xDA, 0x00, 0x03, 0x3E, 0x60, 0xE4, 0xFD, 0xFF, 0x12, 0x72, 0x8C, 0xD0, 0xD0, 0x92, 0xAF, - 0x22, 0x8B, 0x50, 0x8A, 0x51, 0x89, 0x52, 0xB1, 0xD0, 0xFF, 0xF5, 0x54, 0x12, 0x1F, 0xA4, 0xFE, - 0xC3, 0x13, 0x30, 0xE0, 0x06, 0xB1, 0xC8, 0xF5, 0x55, 0x80, 0x02, 0x8F, 0x55, 0x85, 0x54, 0x53, - 0xE5, 0x53, 0xD3, 0x95, 0x55, 0x50, 0x26, 0xAB, 0x50, 0xAA, 0x51, 0xA9, 0x52, 0x12, 0x1F, 0xA4, - 0x54, 0x01, 0xFD, 0xAF, 0x53, 0x12, 0x60, 0x88, 0xAF, 0x53, 0x12, 0x4F, 0x0C, 0xEF, 0xAF, 0x53, - 0x70, 0x05, 0x12, 0x62, 0x61, 0x80, 0x02, 0xF1, 0xEF, 0x05, 0x53, 0x80, 0xD3, 0xE5, 0x54, 0x70, - 0x0F, 0xFF, 0x12, 0x4F, 0x0C, 0xEF, 0x70, 0x08, 0x11, 0xB2, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, - 0x22, 0x90, 0x83, 0xC4, 0x12, 0x42, 0x65, 0x90, 0x83, 0xC3, 0xEF, 0xF0, 0x12, 0x42, 0x6E, 0x54, - 0x5A, 0x00, 0x54, 0x5E, 0x01, 0x54, 0x62, 0x03, 0x54, 0x67, 0x04, 0x54, 0x6C, 0x14, 0x54, 0x71, - 0x20, 0x54, 0x75, 0x25, 0x54, 0x7E, 0x80, 0x54, 0x7A, 0x81, 0x54, 0x82, 0x82, 0x54, 0x87, 0x83, - 0x54, 0x8C, 0x84, 0x54, 0x91, 0x88, 0x00, 0x00, 0x54, 0x96, 0x91, 0xA6, 0xE1, 0x78, 0x91, 0xA6, - 0x61, 0xC1, 0x91, 0xA6, 0x02, 0x79, 0xF1, 0x91, 0xA6, 0x02, 0x61, 0x38, 0x91, 0xA6, 0x02, 0x72, - 0xEB, 0x91, 0xA6, 0xC1, 0xD1, 0x91, 0xA6, 0x02, 0x72, 0xFA, 0x91, 0xA6, 0xA1, 0x3A, 0x91, 0xA6, - 0xA1, 0xD6, 0x91, 0xA6, 0x02, 0x7C, 0x44, 0x91, 0xA6, 0x02, 0x7C, 0x5A, 0x91, 0xA6, 0x02, 0x7C, - 0xBA, 0x91, 0xA6, 0x02, 0x7C, 0xA7, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x83, 0xC3, - 0xE0, 0x90, 0x01, 0xC2, 0xF0, 0x22, 0x90, 0x83, 0xC4, 0x02, 0x42, 0x5C, 0xEF, 0x60, 0x43, 0x90, - 0x04, 0xEC, 0xE0, 0x54, 0xDD, 0xF0, 0x90, 0x83, 0x90, 0xE0, 0xFF, 0x60, 0x03, 0x12, 0x6F, 0x9D, - 0x90, 0x01, 0xC7, 0xE4, 0x12, 0x7A, 0xF5, 0x12, 0x7D, 0xCD, 0x90, 0x06, 0x09, 0xE0, 0x54, 0xFE, - 0xF0, 0x7D, 0x35, 0x12, 0x71, 0xA1, 0x90, 0x02, 0x86, 0xE0, 0x44, 0x04, 0xF0, 0x12, 0x7B, 0x2A, - 0xF1, 0xF0, 0xF1, 0xBC, 0x12, 0x7C, 0xFA, 0x90, 0x01, 0x34, 0x74, 0x08, 0xF0, 0xFD, 0xE4, 0xFF, - 0x21, 0x35, 0x90, 0x04, 0xEC, 0xE0, 0x44, 0x22, 0xF0, 0x7D, 0x08, 0xE4, 0xFF, 0x31, 0x51, 0x90, - 0x06, 0x90, 0xE0, 0x54, 0xF0, 0xF0, 0x90, 0x02, 0x86, 0xE0, 0x54, 0xFB, 0xF0, 0xF1, 0xC4, 0xF1, - 0xF1, 0x7E, 0x00, 0x7F, 0x25, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x81, 0x79, 0xAF, 0x12, 0x44, 0x3E, - 0x90, 0x06, 0x90, 0xE0, 0x44, 0x20, 0xF0, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFD, - 0x7F, 0x8F, 0x12, 0x32, 0x1E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, - 0xD0, 0x12, 0x7A, 0x1E, 0x90, 0x81, 0xAF, 0xD1, 0xBC, 0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0xF1, - 0x42, 0x12, 0x7D, 0xC5, 0xD1, 0xCA, 0x54, 0x10, 0xFD, 0xEF, 0x54, 0xEF, 0xF1, 0x42, 0xF1, 0x3A, - 0xD1, 0xCA, 0x54, 0x40, 0xFD, 0xEF, 0x54, 0xBF, 0xF1, 0x42, 0x54, 0x80, 0xFE, 0xEF, 0x54, 0x7F, - 0x4E, 0xB1, 0xC7, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x81, 0xB1, 0xE0, 0x54, 0xFE, 0xB1, 0xCE, 0xFE, - 0x54, 0x01, 0xFD, 0x90, 0x81, 0xB0, 0xE0, 0x54, 0xFE, 0x4D, 0xFD, 0xF0, 0xEE, 0x54, 0x04, 0xFE, - 0xED, 0x54, 0xFB, 0x4E, 0xF0, 0xEF, 0x54, 0x10, 0xFF, 0xA3, 0xE0, 0x54, 0xEF, 0x4F, 0xFF, 0xB1, - 0xC7, 0xF1, 0x3A, 0x90, 0x81, 0xB1, 0x12, 0x7A, 0xF5, 0x12, 0x7D, 0xCD, 0x90, 0x81, 0xAF, 0xE0, - 0xC3, 0x13, 0x54, 0x01, 0xFF, 0x12, 0x6F, 0xDB, 0x90, 0x81, 0xAF, 0xE0, 0x54, 0x01, 0xFF, 0x91, - 0xAC, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x4F, 0xF0, 0x90, 0x00, 0x02, 0x02, 0x1F, 0xBD, 0x4E, 0xF0, - 0x90, 0x00, 0x01, 0x02, 0x1F, 0xBD, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x83, 0xC7, - 0xF1, 0xF2, 0x20, 0xE0, 0x04, 0xF1, 0xC4, 0xC1, 0xB7, 0x12, 0x7A, 0x18, 0x90, 0x81, 0xB2, 0xD1, - 0xBC, 0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0xF1, 0x4A, 0x12, 0x7D, 0xC5, 0xD1, 0xCA, 0x54, 0x10, - 0xFD, 0xEF, 0x54, 0xEF, 0xF1, 0x4A, 0xF1, 0x3A, 0xD1, 0xCA, 0x54, 0x40, 0xFD, 0xEF, 0x54, 0xBF, - 0xF1, 0x4A, 0x54, 0x80, 0xFE, 0xEF, 0x54, 0x7F, 0xB1, 0xCE, 0x54, 0x80, 0xFF, 0x90, 0x81, 0xB3, - 0xE0, 0x54, 0x7F, 0x4F, 0xF0, 0x12, 0x1F, 0xA4, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x07, 0x90, - 0x06, 0x90, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x83, 0xC7, 0x12, 0x42, 0x5C, 0x12, 0x1F, 0xA4, 0x13, - 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x08, 0xF0, 0x90, 0x80, - 0x07, 0xE0, 0xB4, 0x02, 0x06, 0x12, 0x5F, 0x7C, 0x20, 0xE0, 0x3E, 0xB1, 0xD0, 0x54, 0x7F, 0xFF, - 0x90, 0x81, 0xB3, 0xE0, 0x54, 0x80, 0xB1, 0xC6, 0x90, 0x81, 0xB4, 0xF1, 0xB5, 0xFF, 0x54, 0x01, - 0xFE, 0x90, 0x81, 0xB5, 0x12, 0x7A, 0x10, 0x54, 0xFE, 0xFF, 0xEE, 0x54, 0x01, 0x4F, 0xF1, 0x71, - 0x54, 0x04, 0xFF, 0x90, 0x81, 0xB6, 0xE0, 0x54, 0xFB, 0x4F, 0xF0, 0xF1, 0x62, 0x54, 0x07, 0x7D, - 0x00, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x12, 0x63, 0x77, 0x90, 0x80, 0x07, 0xE0, 0xB4, 0x01, 0x17, - 0x90, 0xFE, 0x10, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x83, 0x8C, 0x74, 0x05, 0xF0, 0x12, 0x67, 0xA7, - 0x7A, 0x82, 0x79, 0xCB, 0x12, 0x44, 0x3E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0x54, 0xFE, 0x4E, - 0xFE, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xEE, 0x54, 0xFD, 0x4F, 0xFF, 0xF0, 0x12, 0x1F, 0xA4, 0xFE, - 0x22, 0x90, 0x83, 0xC7, 0xF1, 0xF2, 0xFF, 0x54, 0x7F, 0x90, 0x81, 0x4B, 0xF0, 0xEF, 0x12, 0x5F, - 0x80, 0xA3, 0xB1, 0xCF, 0xFF, 0x54, 0xF0, 0xC4, 0x54, 0x0F, 0xFE, 0x90, 0x81, 0x49, 0xE0, 0x54, - 0xF0, 0xF1, 0xB4, 0x54, 0x01, 0x25, 0xE0, 0xFE, 0x90, 0x81, 0x46, 0xE0, 0x54, 0xFD, 0x4E, 0xF0, - 0xEF, 0x54, 0x0F, 0xC4, 0x54, 0xF0, 0xFF, 0xF1, 0x33, 0xB1, 0xC6, 0x90, 0x81, 0x4A, 0xF1, 0x71, - 0xFD, 0x7F, 0x02, 0x12, 0x4D, 0x7B, 0x90, 0x83, 0xC7, 0x12, 0x42, 0x5C, 0x51, 0xFA, 0x12, 0x64, - 0xF0, 0xF0, 0x90, 0x81, 0x4B, 0x12, 0x7D, 0x97, 0x90, 0x01, 0xBB, 0xF1, 0x32, 0x90, 0x01, 0xBE, - 0xF0, 0x22, 0xF0, 0x90, 0x81, 0x49, 0xE0, 0x54, 0x0F, 0x22, 0x54, 0x20, 0xFE, 0xEF, 0x54, 0xDF, - 0x4E, 0x22, 0x4D, 0xFF, 0x90, 0x81, 0xAF, 0xF0, 0xEE, 0x22, 0x4D, 0xFF, 0x90, 0x81, 0xB2, 0xF0, - 0xEE, 0x22, 0x90, 0x84, 0x3B, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x84, 0x3F, 0xE0, 0xFD, 0x12, - 0x5F, 0xB2, 0x90, 0x81, 0xB3, 0xE0, 0x54, 0x7F, 0xFF, 0x90, 0x81, 0xB2, 0xE0, 0xFE, 0xC4, 0x13, - 0x22, 0xF0, 0x90, 0x00, 0x04, 0x02, 0x1F, 0xBD, 0x90, 0x02, 0x09, 0xE0, 0xF5, 0x50, 0x12, 0x1F, - 0xA4, 0x25, 0x50, 0x90, 0x80, 0x4A, 0xB1, 0xCF, 0x25, 0x50, 0x90, 0x80, 0x4B, 0xB1, 0xC7, 0x25, - 0x50, 0x90, 0x80, 0x4C, 0xF1, 0xB5, 0x25, 0x50, 0x90, 0x80, 0x4D, 0xF1, 0x71, 0x25, 0x50, 0x90, - 0x80, 0x4E, 0x12, 0x6F, 0xD4, 0x25, 0x50, 0x90, 0x80, 0x4F, 0x12, 0x6F, 0xCD, 0x25, 0x50, 0x90, - 0x80, 0x50, 0xF0, 0x22, 0x4E, 0xF0, 0x90, 0x00, 0x03, 0x02, 0x1F, 0xBD, 0x71, 0x64, 0xE4, 0xFD, - 0xFF, 0x02, 0x4D, 0x6C, 0xB1, 0x27, 0x90, 0x83, 0x9F, 0xE0, 0xFF, 0x12, 0x7B, 0xFC, 0x90, 0x01, - 0x3F, 0x74, 0x04, 0xF0, 0x90, 0x80, 0x07, 0xE0, 0xFF, 0xB4, 0x01, 0x07, 0x90, 0xFD, 0x00, 0xE0, - 0x54, 0xEF, 0xF0, 0xEF, 0xB4, 0x01, 0x07, 0x90, 0xFE, 0x10, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x22, - 0x22, 0x22, 0x12, 0x42, 0x65, 0x02, 0x1F, 0xA4, 0x90, 0x00, 0xF7, 0xE0, 0x20, 0xE7, 0x09, 0xE0, - 0x7F, 0x01, 0x20, 0xE6, 0x0C, 0x7F, 0x02, 0x22, 0x90, 0x00, 0xF7, 0xE0, 0x30, 0xE6, 0x02, 0x7F, - 0x03, 0x22, 0x12, 0x57, 0xF8, 0x90, 0x80, 0x07, 0xEF, 0xF0, 0x11, 0x33, 0x90, 0x01, 0x64, 0x74, - 0x01, 0xF0, 0x90, 0x00, 0x12, 0xE0, 0x54, 0xC7, 0x44, 0x20, 0xFD, 0x7F, 0x12, 0x12, 0x32, 0x1E, - 0x02, 0x2D, 0xA7, 0x11, 0x63, 0x11, 0x91, 0x12, 0x74, 0x3D, 0x12, 0x74, 0x5C, 0xE4, 0xF5, 0x35, - 0xF5, 0x36, 0xF5, 0x37, 0x75, 0x38, 0x80, 0xAD, 0x35, 0x7F, 0x50, 0x12, 0x32, 0x1E, 0xAD, 0x36, - 0x7F, 0x51, 0x12, 0x32, 0x1E, 0xAD, 0x37, 0x7F, 0x52, 0x12, 0x32, 0x1E, 0xAD, 0x38, 0x7F, 0x53, - 0x02, 0x32, 0x1E, 0x90, 0x01, 0x30, 0xE4, 0x11, 0x89, 0x90, 0x01, 0x38, 0x11, 0x89, 0xFD, 0x7F, - 0x50, 0x12, 0x32, 0x1E, 0xE4, 0xFD, 0x7F, 0x51, 0x12, 0x32, 0x1E, 0xE4, 0xFD, 0x7F, 0x52, 0x12, - 0x32, 0x1E, 0xE4, 0xFD, 0x7F, 0x53, 0x02, 0x32, 0x1E, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, - 0x22, 0x90, 0x01, 0x34, 0x74, 0xFF, 0x11, 0x89, 0x90, 0x01, 0x3C, 0x11, 0x89, 0xFD, 0x7F, 0x54, - 0x12, 0x32, 0x1E, 0x7D, 0xFF, 0x7F, 0x55, 0x12, 0x32, 0x1E, 0x7D, 0xFF, 0x7F, 0x56, 0x12, 0x32, - 0x1E, 0x7D, 0xFF, 0x7F, 0x57, 0x02, 0x32, 0x1E, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, - 0x83, 0xCB, 0x74, 0x08, 0xF0, 0xE4, 0xA3, 0x11, 0x89, 0x90, 0x83, 0xD2, 0xF0, 0xA3, 0xF0, 0xA3, - 0xF0, 0x12, 0x7B, 0x7E, 0x12, 0x7A, 0xFE, 0xF1, 0xE8, 0x90, 0x02, 0x82, 0xE0, 0x90, 0x83, 0xCA, - 0xF0, 0x90, 0x81, 0xAF, 0xE0, 0x20, 0xE0, 0x02, 0x41, 0xE5, 0x90, 0x81, 0xB8, 0xE0, 0x20, 0xE0, - 0x07, 0x90, 0x01, 0x3F, 0xE0, 0x30, 0xE2, 0x19, 0x90, 0x80, 0x07, 0xE0, 0xB4, 0x01, 0x0E, 0x90, - 0xFD, 0x01, 0xE0, 0x20, 0xE6, 0x07, 0x90, 0xFD, 0x00, 0xE0, 0x44, 0x10, 0xF0, 0x7F, 0x01, 0x51, - 0xF2, 0xE4, 0x90, 0x83, 0xC9, 0xF0, 0x90, 0x83, 0xCA, 0xE0, 0xFF, 0x90, 0x83, 0xC9, 0xE0, 0xC3, - 0x9F, 0x40, 0x02, 0x41, 0xE5, 0x12, 0x7D, 0xD5, 0xFD, 0xEC, 0xFF, 0x90, 0xFD, 0x11, 0xF0, 0xAE, - 0x05, 0xAA, 0x06, 0x90, 0x83, 0xCD, 0xEF, 0xF0, 0x74, 0x02, 0x2A, 0x12, 0x7B, 0xAD, 0xFF, 0x74, - 0x03, 0x2A, 0x12, 0x7B, 0x87, 0xFE, 0xEF, 0x24, 0x18, 0x2E, 0x90, 0x83, 0xD2, 0xF0, 0xE0, 0xFF, - 0x2A, 0x90, 0x83, 0xC5, 0xF0, 0x7E, 0x00, 0x12, 0x7D, 0xD5, 0x2F, 0xFF, 0xEE, 0x3C, 0x90, 0x83, - 0xC6, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x83, 0xC5, 0xE0, 0xFD, 0x24, 0x00, 0xD1, 0xB0, 0xE0, 0xFE, - 0x54, 0xFC, 0x90, 0x83, 0xC8, 0xF0, 0xAF, 0x06, 0x12, 0x7A, 0xE9, 0xFD, 0x90, 0x83, 0xC5, 0xE0, - 0xF1, 0xF0, 0x12, 0x6D, 0x8A, 0x90, 0x83, 0xCC, 0xEF, 0xF0, 0x74, 0x01, 0x2A, 0x12, 0x7A, 0xEC, - 0xFE, 0x74, 0x00, 0x2A, 0xD1, 0xB0, 0x12, 0x7A, 0xFE, 0x54, 0x3F, 0xFE, 0x90, 0x83, 0xCE, 0xF0, - 0xA3, 0xEF, 0xF0, 0x90, 0x83, 0xD2, 0xE0, 0x2F, 0xFF, 0xEC, 0x3E, 0xFE, 0x12, 0x7B, 0x07, 0x74, - 0x0F, 0x2A, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0xFD, 0x90, 0x83, 0xC3, 0x12, 0x7B, - 0x9E, 0x90, 0x83, 0xC3, 0xE0, 0xFA, 0xA3, 0xE0, 0xD3, 0x9F, 0xEA, 0x9E, 0x40, 0x1D, 0x90, 0x83, - 0xC3, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x81, 0x3B, 0xE0, 0xFA, 0xA3, 0xE0, 0x24, 0x01, 0xFB, - 0xE4, 0x3A, 0xFA, 0xC3, 0xEF, 0x9B, 0xFF, 0xEE, 0x9A, 0xF1, 0xE8, 0xED, 0x30, 0xE7, 0x06, 0x90, - 0x01, 0xC7, 0x74, 0x21, 0xF0, 0xED, 0x30, 0xE6, 0x06, 0x90, 0x01, 0xC7, 0x74, 0x22, 0xF0, 0xED, - 0x30, 0xE5, 0x06, 0x90, 0x01, 0xC7, 0x74, 0x23, 0xF0, 0x90, 0x83, 0xC8, 0xE0, 0x24, 0xF8, 0x60, - 0x27, 0x24, 0x80, 0x60, 0x23, 0x24, 0xC8, 0x60, 0x04, 0x24, 0x20, 0x70, 0x69, 0x90, 0x81, 0xB2, - 0xE0, 0xFF, 0xF1, 0x80, 0x30, 0xE0, 0x5F, 0x90, 0x83, 0xC5, 0xD1, 0x79, 0x60, 0x58, 0x90, 0x83, - 0xC8, 0xE0, 0xFF, 0x12, 0x7B, 0xEA, 0x80, 0x4E, 0x90, 0x83, 0xC5, 0xD1, 0x79, 0x60, 0x1B, 0xF1, - 0x92, 0xFD, 0x90, 0x83, 0xCB, 0xE0, 0xFB, 0x90, 0x83, 0xCD, 0xE0, 0x90, 0x83, 0xD9, 0xF0, 0x71, - 0x45, 0xEF, 0x60, 0x06, 0x90, 0x83, 0xD4, 0x74, 0x01, 0xF0, 0x90, 0x81, 0xAF, 0xE0, 0xC3, 0x13, - 0x30, 0xE0, 0x0E, 0xF1, 0x92, 0xFD, 0x71, 0xE9, 0xEF, 0x60, 0x06, 0x90, 0x83, 0xD4, 0x74, 0x01, - 0xF0, 0x90, 0x81, 0xAF, 0xE0, 0xFF, 0xF1, 0x80, 0x30, 0xE0, 0x0B, 0x90, 0x83, 0xD4, 0xE0, 0x70, - 0x05, 0xF1, 0x92, 0xFD, 0xB1, 0xAE, 0x90, 0x81, 0xB8, 0xE0, 0x20, 0xE0, 0x07, 0x90, 0x01, 0x3F, - 0xE0, 0x30, 0xE2, 0x04, 0x7F, 0x01, 0x51, 0xF2, 0x90, 0x01, 0x3F, 0xE0, 0x30, 0xE2, 0x02, 0x71, - 0x3D, 0x12, 0x7B, 0xD3, 0xEF, 0x64, 0x01, 0x70, 0x3C, 0x12, 0x7B, 0xBD, 0x90, 0x83, 0xD3, 0xEF, - 0xF0, 0x64, 0x01, 0x60, 0x22, 0x71, 0x3D, 0x90, 0x83, 0xD3, 0xE0, 0xFF, 0xB4, 0x02, 0x08, 0x90, - 0x01, 0xC7, 0x74, 0x42, 0xF0, 0x80, 0x0A, 0xEF, 0xB4, 0x04, 0x06, 0x90, 0x01, 0xC7, 0x74, 0x43, - 0xF0, 0x7F, 0x01, 0x51, 0xF2, 0x80, 0x0E, 0x90, 0x83, 0xC3, 0x12, 0x7A, 0x26, 0x90, 0x83, 0xC9, - 0xE0, 0x04, 0xF0, 0x21, 0x16, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x01, 0xC7, 0x74, 0x10, 0xF0, - 0x7F, 0x01, 0x90, 0x84, 0x6E, 0xEF, 0xF0, 0x90, 0x80, 0x07, 0xE0, 0x64, 0x02, 0x70, 0x1D, 0x90, - 0x84, 0x6E, 0xE0, 0xFD, 0x64, 0x01, 0x70, 0x2F, 0x71, 0x3D, 0xF1, 0x7C, 0x30, 0xE0, 0x09, 0x90, - 0x01, 0x4D, 0xE0, 0x64, 0x80, 0xF0, 0x80, 0x1F, 0xAF, 0x05, 0x80, 0x19, 0x90, 0x01, 0x00, 0x74, - 0xFF, 0xF0, 0x7F, 0x64, 0x7E, 0x00, 0x12, 0x32, 0xAA, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x01, 0xF0, - 0x90, 0x84, 0x6E, 0xE0, 0xFF, 0xD1, 0xCB, 0x12, 0x61, 0x7B, 0xF0, 0x22, 0xF0, 0x90, 0x81, 0xB8, - 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x83, 0xD7, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0xF1, 0x74, 0xF0, - 0xE4, 0x90, 0x83, 0xDA, 0xF0, 0x90, 0x83, 0xD9, 0xF0, 0xFD, 0x71, 0xBC, 0xEF, 0x54, 0x0C, 0x64, - 0x08, 0x70, 0x45, 0xF1, 0x87, 0xD1, 0xB8, 0x64, 0x88, 0x70, 0x3D, 0xF1, 0x87, 0x24, 0x07, 0xFD, - 0x71, 0xBC, 0xEF, 0x64, 0x8E, 0x70, 0x31, 0x90, 0x83, 0xDA, 0x04, 0xF0, 0xF1, 0x9F, 0x04, 0xFD, - 0x71, 0xBC, 0xEF, 0x64, 0x03, 0x70, 0x21, 0xF1, 0x9F, 0xD1, 0xB8, 0x30, 0xE3, 0x07, 0x90, 0x01, - 0xC7, 0x74, 0x01, 0x80, 0x11, 0x90, 0x81, 0xB2, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, - 0x07, 0x90, 0x01, 0xC7, 0x74, 0x02, 0x71, 0x3C, 0x90, 0x83, 0xDA, 0xE0, 0xFF, 0x22, 0xCD, 0x34, - 0x00, 0xFC, 0x7E, 0x00, 0xED, 0x2F, 0xFF, 0xEE, 0x3C, 0xFE, 0xE4, 0xFD, 0xAB, 0x07, 0xAA, 0x06, - 0xED, 0x2B, 0xFB, 0xE4, 0x3A, 0xFA, 0xC3, 0x90, 0x81, 0x3C, 0xE0, 0x9B, 0x90, 0x81, 0x3B, 0xE0, - 0x9A, 0x50, 0x0B, 0xA3, 0x12, 0x7B, 0x92, 0xC3, 0xEB, 0x9F, 0xFB, 0xEA, 0x9E, 0xFA, 0x12, 0x7B, - 0x76, 0x74, 0x00, 0x2F, 0xD1, 0xB0, 0xE0, 0xFF, 0x22, 0xF1, 0x74, 0xF0, 0xA3, 0xED, 0xF0, 0x78, - 0xDE, 0x7C, 0x83, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x40, 0x79, 0xC0, 0xF1, 0xE1, 0x78, 0xE4, 0x7C, - 0x83, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x40, 0x79, 0xC6, 0xD1, 0x72, 0x78, 0xE8, 0x7C, 0x83, 0x7D, - 0x01, 0x7B, 0xFF, 0x7A, 0x40, 0x79, 0xCA, 0xD1, 0x72, 0xE4, 0x90, 0x83, 0xED, 0xF0, 0xB1, 0x9C, - 0xCF, 0x24, 0x06, 0xD1, 0x68, 0x64, 0x08, 0x60, 0x02, 0xA1, 0x1A, 0xB1, 0x9C, 0xCF, 0x24, 0x07, - 0xD1, 0x68, 0x64, 0x06, 0x60, 0x02, 0xA1, 0x1A, 0x90, 0x83, 0xED, 0x04, 0xF0, 0xE4, 0x90, 0x83, - 0xEC, 0xF0, 0x12, 0x7D, 0xB3, 0x50, 0x1C, 0x90, 0x83, 0xD6, 0xE0, 0x24, 0x0A, 0xFD, 0x90, 0x83, - 0xD5, 0xE0, 0x71, 0xAF, 0x90, 0x83, 0xEC, 0xE0, 0x24, 0xD8, 0xF5, 0x82, 0xE4, 0x34, 0x83, 0xD1, - 0x5D, 0x80, 0xDF, 0x78, 0xD8, 0x7C, 0x83, 0x7D, 0x01, 0x7B, 0x01, 0x7A, 0x81, 0x79, 0xBF, 0x12, - 0x7D, 0xBC, 0x60, 0x02, 0xA1, 0x1A, 0x90, 0x83, 0xEC, 0xF0, 0x12, 0x7D, 0xAA, 0x50, 0x18, 0xD1, - 0xBF, 0xB1, 0xA7, 0xCD, 0x24, 0x20, 0x71, 0xAE, 0x90, 0x83, 0xEC, 0xE0, 0x24, 0xE8, 0xF5, 0x82, - 0xE4, 0x34, 0x83, 0xD1, 0x5D, 0x80, 0xE3, 0x78, 0xE8, 0x7C, 0x83, 0x12, 0x7D, 0x63, 0x70, 0x71, - 0x90, 0x06, 0x30, 0xE0, 0x44, 0x01, 0x54, 0xDF, 0xF0, 0x90, 0x81, 0xB1, 0xE0, 0x30, 0xE0, 0x09, - 0x90, 0x01, 0xC7, 0x74, 0x09, 0x71, 0x3C, 0x80, 0x61, 0xE4, 0x90, 0x83, 0xEC, 0xF0, 0x12, 0x7D, - 0xB3, 0x50, 0x18, 0xD1, 0xBF, 0xB1, 0xA7, 0xCD, 0x24, 0x10, 0x71, 0xAE, 0x90, 0x83, 0xEC, 0xE0, - 0x24, 0xDE, 0xF5, 0x82, 0xE4, 0x34, 0x83, 0xD1, 0x5D, 0x80, 0xE3, 0xE4, 0x90, 0x83, 0xEC, 0xF0, - 0x12, 0x7D, 0xAA, 0x50, 0x18, 0xD1, 0xBF, 0xB1, 0xA7, 0xCD, 0x24, 0x16, 0x71, 0xAE, 0x90, 0x83, - 0xEC, 0xE0, 0x24, 0xE4, 0xF5, 0x82, 0xE4, 0x34, 0x83, 0xD1, 0x5D, 0x80, 0xE3, 0x7B, 0x01, 0x7A, - 0x83, 0x79, 0xDE, 0x12, 0x67, 0xE3, 0xA3, 0xF0, 0x7A, 0x83, 0x79, 0xE4, 0x12, 0x6B, 0xB8, 0x80, - 0x09, 0x90, 0x06, 0x30, 0xE0, 0x44, 0x21, 0x54, 0xEF, 0xF0, 0x90, 0x83, 0xED, 0xE0, 0xFF, 0x22, - 0x90, 0x83, 0xE5, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x7D, 0x09, 0x71, 0xBC, 0xEF, 0x64, 0x06, 0x70, - 0x24, 0xD1, 0x54, 0x7D, 0x14, 0x71, 0xBC, 0xEF, 0x70, 0x1B, 0xD1, 0x54, 0x7D, 0x15, 0x71, 0xBC, - 0xEF, 0x64, 0x50, 0x70, 0x10, 0xD1, 0x54, 0x7D, 0x21, 0x71, 0xBC, 0xEF, 0x20, 0xE0, 0x03, 0x30, - 0xE2, 0x03, 0x7F, 0x01, 0x22, 0x90, 0x81, 0xB0, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x39, - 0xD1, 0x54, 0x7D, 0x09, 0x71, 0xBC, 0xEF, 0x64, 0x11, 0x70, 0x2E, 0x90, 0x83, 0xE6, 0xE0, 0x24, - 0x14, 0xFF, 0x90, 0x83, 0xE5, 0xE0, 0x34, 0x00, 0xFE, 0x90, 0x83, 0xE7, 0xF0, 0xA3, 0xEF, 0xF0, - 0x7D, 0x02, 0x71, 0xBC, 0xEF, 0x70, 0x12, 0x90, 0x83, 0xE7, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x7D, - 0x03, 0x71, 0xBC, 0xBF, 0x89, 0x03, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, 0x90, 0x83, 0xD7, 0xE0, - 0xFF, 0x90, 0x83, 0xD6, 0xE0, 0x2F, 0xFF, 0x90, 0x83, 0xD5, 0xE0, 0x34, 0x00, 0x22, 0xF1, 0x74, - 0xF0, 0xA3, 0xED, 0xF0, 0x78, 0xD8, 0x7C, 0x83, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x40, 0x79, 0xD4, - 0xF1, 0xE1, 0x78, 0xDF, 0x7C, 0x83, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x40, 0x79, 0xDA, 0xD1, 0x72, - 0x90, 0x83, 0xD5, 0xA3, 0xD1, 0x79, 0x60, 0x7B, 0xB1, 0x9C, 0xFE, 0x90, 0x83, 0xE3, 0xF0, 0xA3, - 0xEF, 0xF0, 0x24, 0x06, 0xFF, 0xE4, 0x3E, 0xD1, 0x6B, 0x64, 0x08, 0x70, 0x66, 0x90, 0x83, 0xE4, - 0xE0, 0x24, 0x07, 0xFF, 0x90, 0x83, 0xE3, 0xE0, 0xD1, 0x69, 0x70, 0x57, 0x90, 0x83, 0xDE, 0xF0, - 0x90, 0x83, 0xDE, 0xE0, 0xFF, 0xC3, 0x94, 0x04, 0x50, 0x24, 0x90, 0x83, 0xE4, 0xE0, 0x24, 0x18, - 0xFD, 0x90, 0x83, 0xE3, 0xE0, 0x71, 0xAF, 0x90, 0x83, 0xDE, 0xE0, 0x24, 0xDF, 0xF5, 0x82, 0xE4, - 0x34, 0x83, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x83, 0xDE, 0xE0, 0x04, 0xF0, 0x80, 0xD2, 0x78, 0xDF, - 0x7C, 0x83, 0x12, 0x7D, 0x63, 0x70, 0x1C, 0x90, 0x83, 0xE4, 0xE0, 0x24, 0x08, 0xFF, 0x90, 0x83, - 0xE3, 0xE0, 0x34, 0x00, 0xFE, 0xB1, 0x20, 0xEF, 0x64, 0x01, 0x60, 0x07, 0x90, 0x01, 0xC7, 0x74, - 0x22, 0x71, 0x3C, 0x22, 0x90, 0x83, 0xE5, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0xF5, 0x83, 0xEF, - 0xF0, 0x90, 0x83, 0xEC, 0xE0, 0x04, 0xF0, 0x22, 0xCF, 0x34, 0x00, 0xFE, 0xE4, 0xFD, 0x71, 0xBC, - 0xEF, 0x22, 0x7E, 0x00, 0x7F, 0x04, 0x02, 0x41, 0xD0, 0xE0, 0xFF, 0xD1, 0x7F, 0xEF, 0x22, 0xE4, - 0xFE, 0xEF, 0x2E, 0xF1, 0xF0, 0xF5, 0x83, 0xE0, 0xFD, 0x74, 0xE5, 0x2E, 0xF5, 0x82, 0xE4, 0x34, - 0x83, 0xF5, 0x83, 0xED, 0xF0, 0x0E, 0xEE, 0xB4, 0x06, 0xE7, 0x78, 0xB9, 0x7C, 0x81, 0x7D, 0x01, - 0x7B, 0x01, 0x7A, 0x83, 0x79, 0xE5, 0x12, 0x7D, 0xBC, 0x7F, 0x00, 0x70, 0x02, 0x7F, 0x01, 0x22, - 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0x22, 0x24, 0x06, 0xFD, 0x71, 0xBC, 0xEF, 0x22, 0x90, - 0x83, 0xD7, 0xE0, 0xFD, 0x90, 0x83, 0xD6, 0xE0, 0x2D, 0xFD, 0x22, 0xAD, 0x07, 0x90, 0x81, 0xB4, - 0xE0, 0x75, 0xF0, 0x40, 0xA4, 0xFF, 0x90, 0x84, 0x3B, 0xE5, 0xF0, 0x12, 0x73, 0xBA, 0x90, 0x81, - 0xB5, 0xE0, 0xC3, 0x13, 0x54, 0x7F, 0x90, 0x84, 0x3E, 0xF0, 0x90, 0x81, 0xB6, 0xE0, 0x13, 0x13, - 0x54, 0x01, 0x90, 0x84, 0x3F, 0xF0, 0xED, 0x64, 0x01, 0x70, 0x78, 0xE0, 0x70, 0x15, 0x90, 0x84, - 0x3B, 0xE0, 0x70, 0x02, 0xA3, 0xE0, 0x60, 0x0B, 0x90, 0x84, 0x3B, 0x74, 0xFF, 0x75, 0xF0, 0xD0, - 0x12, 0x41, 0xF6, 0x12, 0x57, 0x62, 0x54, 0x07, 0x7D, 0x00, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x12, - 0x63, 0x77, 0x12, 0x57, 0x62, 0x54, 0x01, 0xFD, 0x12, 0x63, 0x77, 0x90, 0x81, 0xB5, 0xE0, 0x30, - 0xE0, 0x41, 0x12, 0x57, 0x52, 0x54, 0x07, 0x7D, 0x00, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x12, 0x63, - 0x77, 0xE4, 0x90, 0x84, 0x3D, 0xF0, 0x90, 0x84, 0x3E, 0xE0, 0xFF, 0x90, 0x84, 0x3D, 0xE0, 0xC3, - 0x9F, 0x50, 0x20, 0x12, 0x57, 0x52, 0x54, 0x01, 0xFD, 0x12, 0x63, 0x77, 0x12, 0x57, 0x52, 0x54, - 0x07, 0x7D, 0x00, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x12, 0x63, 0x77, 0x90, 0x84, 0x3D, 0xE0, 0x04, - 0xF0, 0x80, 0xD3, 0x22, 0x90, 0x83, 0xD5, 0xEE, 0xF0, 0xA3, 0xEF, 0x22, 0x90, 0x81, 0xB3, 0xE0, - 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x22, 0x90, 0x83, 0xD5, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xA3, - 0xE0, 0x22, 0x90, 0x83, 0xC6, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x83, 0xCC, 0xE0, 0x22, 0x90, - 0x83, 0xD5, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x83, 0xD8, 0xE0, 0xFD, 0x90, 0x83, 0xD7, 0xE0, - 0x2D, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8E, 0x0D, 0x8F, 0x0E, 0xBD, 0x01, 0x15, - 0xE5, 0x0E, 0x78, 0x03, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xEE, 0x54, 0x1F, 0xFE, - 0x12, 0x32, 0x06, 0x80, 0x07, 0xAF, 0x0E, 0xAE, 0x0D, 0x12, 0x32, 0xAA, 0xD0, 0xD0, 0x92, 0xAF, - 0x22, 0x7E, 0x00, 0x7F, 0x06, 0x02, 0x41, 0xD0, 0x90, 0x83, 0xC3, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, - 0x24, 0x04, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0x22, 0x75, 0xE8, 0x03, 0x75, 0xA8, 0x84, 0x22, 0x90, - 0x00, 0x80, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x12, 0x32, 0x1E, 0x90, 0xFD, 0x00, 0xE0, 0x54, - 0xBF, 0xF0, 0x12, 0x74, 0x7B, 0x12, 0x32, 0x77, 0x12, 0x74, 0x88, 0xF1, 0xB9, 0x7F, 0x01, 0x12, - 0x45, 0x7F, 0x90, 0x83, 0xA0, 0x74, 0x02, 0xF0, 0xFF, 0x12, 0x45, 0x7F, 0x90, 0x83, 0xA0, 0xE0, - 0x04, 0xF0, 0x12, 0x58, 0x12, 0x11, 0x58, 0x90, 0x01, 0xCC, 0x74, 0x0F, 0xF0, 0x90, 0x00, 0x80, - 0xE0, 0x44, 0x40, 0xFD, 0x7F, 0x80, 0x12, 0x32, 0x1E, 0x75, 0x20, 0xFF, 0x12, 0x5F, 0xF8, 0xF1, - 0x28, 0xF1, 0xC3, 0xE4, 0xFF, 0x02, 0x46, 0x08, 0x11, 0x85, 0x12, 0x73, 0x67, 0x12, 0x77, 0xEE, - 0x12, 0x55, 0x11, 0x12, 0x79, 0x9B, 0x31, 0x24, 0x90, 0x83, 0xAD, 0xE0, 0x54, 0x7F, 0xF0, 0x54, - 0xBF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xF0, 0xF0, 0xE4, 0x90, 0x83, 0xAF, 0xF0, 0x90, 0x83, 0xAD, - 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0xE4, 0xFD, 0xFF, 0x12, 0x7D, 0x80, 0xED, 0x70, 0x12, 0x11, 0xC4, - 0xC0, 0x83, 0xC0, 0x82, 0x11, 0xBC, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5E, 0x80, 0x0F, - 0x11, 0xC4, 0xC0, 0x83, 0xC0, 0x82, 0x11, 0xBC, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4E, 0xD0, - 0x82, 0xD0, 0x83, 0xF0, 0x11, 0xCF, 0x90, 0x81, 0x45, 0xEF, 0xF0, 0x22, 0xE0, 0xFE, 0x74, 0x01, - 0xA8, 0x07, 0x08, 0x22, 0x74, 0x3D, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, 0xD3, - 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x7D, 0x08, 0xED, 0x14, 0xF9, 0x24, 0x3D, 0x11, 0xC7, 0xE0, - 0x60, 0x39, 0x7C, 0x08, 0xEC, 0x14, 0x90, 0x84, 0x68, 0xF0, 0x74, 0x3D, 0x29, 0x11, 0xC7, 0xE0, - 0xFB, 0x7A, 0x00, 0x90, 0x84, 0x68, 0x51, 0x62, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, - 0xF9, 0xFF, 0xEE, 0x5A, 0xFE, 0xEF, 0x5B, 0x4E, 0x60, 0x0F, 0xE9, 0x75, 0xF0, 0x08, 0xA4, 0xFF, - 0x90, 0x84, 0x68, 0xE0, 0x2F, 0x04, 0xFF, 0x80, 0x06, 0xDC, 0xC9, 0xDD, 0xBB, 0x7F, 0x00, 0xD0, - 0xD0, 0x92, 0xAF, 0x22, 0xF1, 0xA7, 0x7A, 0x83, 0x79, 0xA5, 0x12, 0x44, 0x3E, 0x90, 0x83, 0xA6, - 0x74, 0x08, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0x22, 0x90, 0x83, 0xC7, 0x12, 0x42, 0x65, 0x31, 0x24, - 0x12, 0x7A, 0x18, 0x31, 0x7B, 0x4E, 0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x2D, 0x12, 0x55, 0xD0, - 0x90, 0x83, 0xA6, 0x12, 0x55, 0xC7, 0x90, 0x83, 0xA7, 0xF0, 0x12, 0x1F, 0xA4, 0xFF, 0x54, 0x04, - 0xFE, 0x90, 0x83, 0xA5, 0xE0, 0x54, 0xFB, 0x12, 0x57, 0xB4, 0x90, 0x83, 0xA8, 0xF0, 0xEF, 0x54, - 0x08, 0xFF, 0x90, 0x83, 0xA5, 0xE0, 0x54, 0xF7, 0x4F, 0xF0, 0x22, 0x90, 0x83, 0xA5, 0xE0, 0x54, - 0xFE, 0x22, 0x90, 0x83, 0xA5, 0xE0, 0x30, 0xE0, 0x7B, 0x90, 0x83, 0xA9, 0xE0, 0x04, 0xF0, 0x90, - 0x83, 0xAC, 0xE0, 0x64, 0x01, 0x70, 0x30, 0x90, 0x83, 0xA5, 0xF1, 0x80, 0x30, 0xE0, 0x28, 0x90, - 0x83, 0xAB, 0xE0, 0x70, 0x22, 0x90, 0x83, 0xA8, 0xE0, 0xFE, 0xA3, 0xE0, 0xC3, 0x9E, 0x40, 0x17, - 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x07, 0x51, 0x5A, 0x31, 0x7B, 0xF0, 0x80, 0x07, - 0x12, 0x5A, 0xEA, 0x31, 0x7B, 0xF0, 0x22, 0x90, 0x83, 0xA9, 0xE0, 0xFF, 0x90, 0x83, 0xA6, 0xE0, - 0xD3, 0x9F, 0x50, 0x30, 0x90, 0x06, 0x92, 0xE0, 0x20, 0xE2, 0x1A, 0x90, 0x83, 0xAB, 0xE0, 0x70, - 0x14, 0x7D, 0x08, 0xFF, 0x12, 0x4F, 0x7F, 0x90, 0x83, 0xAA, 0xE0, 0x04, 0xF0, 0x90, 0x83, 0xA4, - 0xE0, 0x04, 0xF0, 0x80, 0x06, 0x90, 0x06, 0x92, 0x74, 0x04, 0xF0, 0xE4, 0x90, 0x83, 0xA9, 0xF0, - 0x90, 0x83, 0xAB, 0xF0, 0x22, 0x90, 0x83, 0xA5, 0xE0, 0xFD, 0x30, 0xE0, 0x4C, 0x90, 0x83, 0xAA, - 0xE0, 0xFC, 0x60, 0x45, 0x51, 0x64, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, - 0x90, 0x04, 0xE0, 0xE0, 0xFB, 0xEF, 0x5B, 0x60, 0x0B, 0xE4, 0x90, 0x83, 0xAA, 0xF0, 0x90, 0x83, - 0xAC, 0x04, 0xF0, 0x22, 0x90, 0x83, 0xA7, 0xE0, 0xD3, 0x9C, 0x50, 0x14, 0xED, 0x13, 0x13, 0x13, - 0x54, 0x1F, 0x30, 0xE0, 0x04, 0x51, 0x5A, 0x80, 0x03, 0x12, 0x5A, 0xEA, 0x31, 0x7B, 0xF0, 0x22, - 0x12, 0x4F, 0x7B, 0x90, 0x83, 0xAA, 0xE0, 0x04, 0xF0, 0x22, 0xE4, 0xFD, 0xFF, 0x11, 0x88, 0xE4, - 0xFF, 0x22, 0xE0, 0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x22, 0x90, 0x01, 0xCC, 0xE0, - 0x54, 0x0F, 0x90, 0x84, 0x61, 0xF0, 0x90, 0x84, 0x61, 0xE0, 0xFD, 0x70, 0x02, 0x61, 0x68, 0x90, - 0x80, 0xA1, 0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, 0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, - 0x80, 0xA2, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x08, 0x90, - 0x01, 0xC1, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x90, 0x84, 0x5F, 0x51, 0x62, 0x80, 0x05, 0xC3, 0x33, - 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x70, 0x02, 0x61, 0x4A, 0xE4, 0x90, 0x84, 0x62, - 0xF0, 0x90, 0x84, 0x62, 0xE0, 0xF9, 0xC3, 0x94, 0x04, 0x50, 0x31, 0x91, 0x42, 0xA4, 0xFF, 0xE9, - 0xFD, 0x7C, 0x00, 0x2F, 0xFF, 0xEC, 0x35, 0xF0, 0xFE, 0x74, 0xD0, 0x91, 0x62, 0x90, 0x80, 0x51, - 0x91, 0x52, 0x91, 0x42, 0xA4, 0x2D, 0xFF, 0xEC, 0x35, 0xF0, 0xFE, 0x74, 0xF0, 0x91, 0x62, 0x90, - 0x80, 0x55, 0x91, 0x52, 0x90, 0x84, 0x62, 0xE0, 0x04, 0xF0, 0x80, 0xC5, 0x90, 0x84, 0x61, 0xE0, - 0xFF, 0x90, 0x84, 0x5F, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, - 0xFC, 0xF4, 0x5F, 0x90, 0x84, 0x61, 0xF0, 0x90, 0x84, 0x5F, 0x71, 0x6F, 0x80, 0x02, 0xC3, 0x33, - 0xD8, 0xFC, 0x90, 0x01, 0xCC, 0xF0, 0x90, 0x84, 0x5F, 0xE0, 0x04, 0xF0, 0xE0, 0x54, 0x03, 0xF0, - 0x90, 0x80, 0xA2, 0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x70, - 0x02, 0x41, 0x76, 0xE4, 0x90, 0x80, 0xA2, 0xF0, 0x41, 0x76, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x02, - 0xF0, 0x90, 0x84, 0x5F, 0xE0, 0x44, 0x80, 0x90, 0x00, 0x8A, 0xF0, 0x91, 0x42, 0x90, 0x01, 0xD0, - 0x12, 0x42, 0x50, 0xE0, 0x90, 0x01, 0xC3, 0xF0, 0x22, 0x12, 0x32, 0x1E, 0x90, 0x84, 0x63, 0xE0, - 0xFF, 0x74, 0x01, 0xA8, 0x07, 0x08, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x84, - 0x64, 0xED, 0xF0, 0x90, 0x84, 0x63, 0xEF, 0xF0, 0xD3, 0x94, 0x07, 0x50, 0x4B, 0x71, 0x6F, 0x80, - 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0xFF, 0x90, 0x00, 0x47, 0xE0, 0x5F, 0xFD, 0x7F, 0x47, 0x71, - 0x69, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xFF, 0x90, 0x00, 0x46, 0xE0, 0x4F, 0xFD, 0x7F, 0x46, - 0x91, 0x4A, 0x60, 0x10, 0x71, 0x6C, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xFF, 0x90, 0x00, 0x45, - 0xE0, 0x4F, 0x80, 0x0F, 0x71, 0x6C, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0xFF, 0x90, 0x00, - 0x45, 0xE0, 0x5F, 0xFD, 0x7F, 0x45, 0x80, 0x62, 0x90, 0x84, 0x63, 0xE0, 0x24, 0xF8, 0xF0, 0xE0, - 0x24, 0x04, 0x71, 0x70, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0xFF, 0x90, 0x00, 0x43, 0xE0, - 0x5F, 0xFD, 0x7F, 0x43, 0x71, 0x69, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xFF, 0x90, 0x00, 0x43, - 0xE0, 0x4F, 0xFD, 0x7F, 0x43, 0x91, 0x4A, 0x60, 0x19, 0x90, 0x84, 0x63, 0xE0, 0x24, 0x04, 0x71, - 0x70, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xFF, 0x90, 0x00, 0x42, 0xE0, 0x4F, 0xFD, 0x7F, 0x42, - 0x80, 0x18, 0x90, 0x84, 0x63, 0xE0, 0x24, 0x04, 0x71, 0x70, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, - 0xF4, 0xFF, 0x90, 0x00, 0x42, 0xE0, 0x5F, 0xFD, 0x7F, 0x42, 0x12, 0x32, 0x1E, 0xD0, 0xD0, 0x92, - 0xAF, 0x22, 0x90, 0x84, 0x5F, 0xE0, 0x75, 0xF0, 0x04, 0x22, 0x12, 0x32, 0x1E, 0x90, 0x84, 0x64, - 0xE0, 0x22, 0x12, 0x42, 0x50, 0xE5, 0x82, 0x29, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xEF, - 0xF0, 0x22, 0x2F, 0xF5, 0x82, 0x74, 0x01, 0x3E, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0x80, 0xA2, 0xE0, - 0x75, 0xF0, 0x08, 0x22, 0x51, 0x6C, 0x7F, 0x02, 0x8F, 0x0F, 0x7F, 0x02, 0x12, 0x46, 0x91, 0x90, - 0x80, 0x01, 0xE0, 0x45, 0x0F, 0xF0, 0x22, 0x90, 0x81, 0x46, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, - 0x03, 0x30, 0xE0, 0x18, 0xEF, 0x54, 0xBF, 0x91, 0xDC, 0x30, 0xE0, 0x06, 0xE0, 0x44, 0x01, 0xF0, - 0x80, 0x08, 0xE0, 0x54, 0xFE, 0x91, 0xEF, 0x74, 0x04, 0xF0, 0x91, 0xE5, 0xE4, 0xFF, 0x41, 0x05, - 0x90, 0x81, 0x46, 0xE0, 0xFF, 0x12, 0x5F, 0x80, 0x30, 0xE0, 0x1D, 0xEF, 0x54, 0x7F, 0x91, 0xDC, - 0x30, 0xE1, 0x06, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x07, 0xE0, 0x54, 0xFD, 0x91, 0xEF, 0x04, 0xF0, - 0x90, 0x81, 0x4B, 0xE0, 0x60, 0x02, 0x91, 0xE5, 0x7F, 0x01, 0x41, 0x05, 0xF0, 0x90, 0x04, 0xE0, - 0xE0, 0x90, 0x81, 0x47, 0x22, 0x90, 0x81, 0x4D, 0xE0, 0xFF, 0x7D, 0x01, 0x02, 0x4B, 0x4A, 0xF0, - 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x22, 0xE4, 0xFF, 0x12, 0x4F, 0x0C, 0xBF, - 0x01, 0x0E, 0x90, 0x81, 0x4B, 0xE0, 0x60, 0x08, 0xB1, 0x11, 0x54, 0x07, 0x70, 0x02, 0x91, 0xE5, - 0x22, 0x90, 0x81, 0x4F, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0x90, 0x06, 0xA9, 0xE0, 0xF5, 0x4E, 0x54, - 0xC0, 0x70, 0x07, 0xB1, 0x11, 0x54, 0xFD, 0xF0, 0x80, 0xBB, 0xE5, 0x4E, 0x30, 0xE6, 0x1E, 0x90, - 0x81, 0x4B, 0xE0, 0x64, 0x01, 0x70, 0x18, 0x90, 0x81, 0x4F, 0xE0, 0x44, 0x01, 0x12, 0x57, 0x32, - 0x64, 0x02, 0x60, 0x04, 0xB1, 0x89, 0x80, 0x07, 0x12, 0x4F, 0xCA, 0x80, 0x02, 0xB1, 0x11, 0xE5, - 0x4E, 0x90, 0x81, 0x4F, 0x30, 0xE7, 0x10, 0xE0, 0x44, 0x02, 0xF1, 0xB0, 0x12, 0x4E, 0x9D, 0x90, - 0x81, 0x46, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x12, 0x4F, 0x06, 0x64, - 0x01, 0x70, 0x15, 0x90, 0x81, 0x4B, 0xE0, 0x60, 0x0F, 0xF1, 0xCD, 0xF0, 0x90, 0x81, 0x46, 0xE0, - 0xF1, 0xD8, 0x54, 0x07, 0x70, 0x02, 0x91, 0xE5, 0x22, 0x90, 0x04, 0x1D, 0xE0, 0x70, 0x1B, 0x90, - 0x80, 0x4B, 0xE0, 0xFF, 0x90, 0x84, 0x4C, 0x74, 0x09, 0xF0, 0x7B, 0x18, 0xE4, 0xFD, 0xB1, 0xAB, - 0x90, 0x83, 0xB5, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xF1, 0xA0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, - 0xC0, 0xD0, 0x90, 0x84, 0x4A, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x84, 0x49, 0xEF, 0xF0, 0xE4, - 0xFD, 0xFC, 0x12, 0x6F, 0xB9, 0x7C, 0x00, 0xAD, 0x07, 0x90, 0x84, 0x49, 0xE0, 0x90, 0x04, 0x25, - 0xF0, 0x90, 0x84, 0x4A, 0xE0, 0x60, 0x0E, 0x74, 0x0F, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, - 0x83, 0xE0, 0x44, 0x80, 0xF0, 0xAF, 0x05, 0x74, 0x08, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, - 0x83, 0xE4, 0xF0, 0x74, 0x09, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xF0, - 0xF0, 0xAF, 0x05, 0xD1, 0x40, 0xE0, 0x54, 0x01, 0xFE, 0x90, 0x84, 0x4B, 0xE0, 0x25, 0xE0, 0x25, - 0xE0, 0xFB, 0xEE, 0x44, 0x02, 0x4B, 0xFE, 0xD1, 0x40, 0xEE, 0xF0, 0x90, 0x84, 0x4C, 0xE0, 0xFF, - 0xAE, 0x05, 0x74, 0x1E, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x21, - 0x2E, 0xF1, 0x13, 0xE0, 0x54, 0xF7, 0xF0, 0xAE, 0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, - 0x74, 0x16, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0x90, 0x80, 0x4C, 0xE0, 0xFF, - 0x90, 0x84, 0x41, 0xE0, 0xFB, 0x90, 0x84, 0x4C, 0x74, 0x0A, 0xF0, 0x7D, 0x01, 0xB1, 0xAB, 0x90, - 0x84, 0x42, 0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0x84, 0x40, 0xE0, 0xFF, 0xD1, 0xEF, - 0x90, 0x84, 0x42, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x04, 0x80, 0xE0, 0x54, 0x0F, 0xFD, 0xAC, - 0x07, 0xD1, 0xE3, 0x44, 0x01, 0xF0, 0xD1, 0xE3, 0x54, 0xFB, 0xF0, 0xAC, 0x07, 0x74, 0x16, 0x2C, - 0xD1, 0x43, 0xE0, 0x44, 0xFA, 0xF0, 0x74, 0x15, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, - 0xE0, 0x44, 0x1F, 0xF0, 0xAC, 0x07, 0x74, 0x06, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, - 0xE0, 0x44, 0x0F, 0xF0, 0x90, 0x04, 0x53, 0xE4, 0xF0, 0x90, 0x04, 0x52, 0xF0, 0x90, 0x04, 0x51, - 0x74, 0xFF, 0xF0, 0x90, 0x04, 0x50, 0x74, 0xFD, 0xF0, 0x74, 0x14, 0x2C, 0xD1, 0xDB, 0xE0, 0x54, - 0xC0, 0x4D, 0xFD, 0x74, 0x14, 0x2F, 0xD1, 0xDB, 0xED, 0xF0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, - 0xF5, 0x83, 0x22, 0x74, 0x11, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xF1, - 0x1C, 0x54, 0x3F, 0xF0, 0xEF, 0x60, 0x0E, 0x74, 0x21, 0x2D, 0xF1, 0x13, 0xE0, 0x44, 0x10, 0xF1, - 0x1B, 0x44, 0x80, 0xF0, 0x22, 0x74, 0x21, 0x2D, 0xF1, 0x13, 0xE0, 0x54, 0xEF, 0xF1, 0x1B, 0x44, - 0x40, 0xF0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0xF0, 0x74, 0x1F, 0x2D, 0xF5, - 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xE4, 0x90, 0x83, 0xBC, 0xF0, 0xA3, 0xF0, 0x90, - 0x01, 0x98, 0xE0, 0x7F, 0x00, 0x30, 0xE4, 0x02, 0x7F, 0x01, 0xEF, 0x64, 0x01, 0x60, 0x3A, 0xC3, - 0x90, 0x83, 0xBD, 0xE0, 0x94, 0x88, 0x90, 0x83, 0xBC, 0xE0, 0x94, 0x13, 0x40, 0x0F, 0x90, 0x01, - 0xC1, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x01, 0xC7, 0x74, 0xFD, 0xF0, 0x80, 0x1C, 0x90, 0x83, 0xBC, - 0x12, 0x69, 0xF7, 0xD3, 0x90, 0x83, 0xBD, 0xE0, 0x94, 0x32, 0x90, 0x83, 0xBC, 0xE0, 0x94, 0x00, - 0x40, 0xBD, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE3, 0xB6, 0x90, 0x01, 0xC7, 0x74, 0xFE, 0xF0, 0x22, - 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x22, 0x90, 0x83, 0xA1, 0xF1, 0x80, 0x30, 0xE0, 0x0E, 0x7B, - 0x00, 0x7A, 0x00, 0x79, 0x00, 0xF1, 0xE3, 0xA3, 0x04, 0xF0, 0x02, 0x6B, 0xB8, 0x02, 0x4F, 0x7B, - 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x22, 0x7E, 0x00, 0x7F, 0x08, 0x7D, 0x00, 0x7B, 0x01, 0x22, - 0xF0, 0xE4, 0xF5, 0x1D, 0x90, 0x81, 0xA9, 0xE0, 0x22, 0xE4, 0x90, 0x80, 0x01, 0x12, 0x58, 0x89, - 0xA3, 0xF0, 0x22, 0x90, 0x01, 0xE4, 0x74, 0x17, 0xF0, 0xA3, 0xE4, 0xF0, 0x22, 0x90, 0x01, 0x57, - 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0x22, 0x54, 0xFB, 0xF0, 0x90, 0x81, 0x4F, 0xE0, 0x54, - 0xFD, 0xF0, 0x22, 0x90, 0x83, 0xF1, 0x12, 0x42, 0x65, 0xE4, 0x90, 0x83, 0xF4, 0xF0, 0x22, 0xE4, - 0x90, 0x83, 0xBE, 0xF0, 0x90, 0x83, 0xBE, 0xE0, 0x64, 0x01, 0xF0, 0x24, 0xEF, 0x90, 0x01, 0xC4, - 0xF0, 0x74, 0x67, 0xA3, 0xF0, 0x90, 0x81, 0x4B, 0xE0, 0x60, 0x0F, 0x90, 0x81, 0x4E, 0xE0, 0xFF, - 0x90, 0x81, 0x4D, 0xE0, 0x6F, 0x60, 0x03, 0x12, 0x64, 0xE5, 0xC2, 0xAF, 0x51, 0x3B, 0xBF, 0x01, - 0x02, 0x11, 0x2C, 0xD2, 0xAF, 0x31, 0x77, 0x12, 0x44, 0xB7, 0x80, 0xC8, 0x90, 0x81, 0x46, 0xE0, - 0x30, 0xE0, 0x02, 0x11, 0x36, 0x22, 0x90, 0x81, 0x4E, 0xE0, 0xFF, 0x60, 0x03, 0xB4, 0x08, 0x0D, - 0x31, 0x13, 0xBF, 0x01, 0x08, 0x11, 0x4E, 0x90, 0x01, 0xE5, 0xE0, 0x04, 0xF0, 0x22, 0xD3, 0x10, - 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x11, 0x78, 0x11, 0x5E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x51, 0x1E, - 0x90, 0x00, 0x08, 0xE0, 0x54, 0xEF, 0xFD, 0x7F, 0x08, 0x12, 0x32, 0x1E, 0xE4, 0xFF, 0x11, 0xC4, - 0x90, 0x81, 0x47, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0x90, 0x81, 0x47, 0xE0, 0x44, 0x10, 0xF0, 0x90, - 0x81, 0x56, 0xE0, 0xFD, 0x7F, 0x93, 0x12, 0x32, 0x1E, 0x90, 0x81, 0x4C, 0xE0, 0x60, 0x12, 0x90, - 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x05, 0x74, 0x10, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, - 0xF0, 0x90, 0x00, 0x08, 0xE0, 0x44, 0x10, 0xFD, 0x7F, 0x08, 0x12, 0x32, 0x1E, 0x7F, 0x01, 0x11, - 0xC4, 0x90, 0x00, 0x90, 0xE0, 0x44, 0x01, 0xFD, 0x7F, 0x90, 0x12, 0x32, 0x1E, 0x7F, 0x14, 0x7E, - 0x00, 0x02, 0x32, 0xAA, 0x90, 0x83, 0xBF, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x01, - 0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0x90, 0x83, 0xBF, 0xE0, 0x6F, 0x60, 0x32, - 0xC3, 0x90, 0x83, 0xC1, 0xE0, 0x94, 0x88, 0x90, 0x83, 0xC0, 0xE0, 0x94, 0x13, 0x40, 0x08, 0x90, - 0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x83, 0xC0, 0x31, 0xF7, 0xD3, 0x90, 0x83, 0xC1, - 0xE0, 0x94, 0x32, 0x90, 0x83, 0xC0, 0xE0, 0x94, 0x00, 0x40, 0xC3, 0x90, 0x01, 0xC6, 0xE0, 0x30, - 0xE0, 0xBC, 0x22, 0x90, 0x02, 0x87, 0xE0, 0x60, 0x02, 0x80, 0x08, 0x90, 0x01, 0x00, 0xE0, 0x64, - 0x3F, 0x60, 0x05, 0x75, 0x4F, 0x01, 0x80, 0x40, 0x90, 0x81, 0xAF, 0xE0, 0x30, 0xE0, 0x0B, 0x90, - 0x02, 0x82, 0xE0, 0x60, 0x05, 0x75, 0x4F, 0x02, 0x80, 0x2E, 0x90, 0x81, 0xB8, 0xE0, 0x30, 0xE0, - 0x05, 0x75, 0x4F, 0x08, 0x80, 0x22, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x02, 0x80, 0x07, 0x90, - 0x02, 0x86, 0xE0, 0x30, 0xE3, 0x05, 0x75, 0x4F, 0x04, 0x80, 0x0D, 0x90, 0x04, 0x1D, 0xE0, 0x60, - 0x05, 0x75, 0x4F, 0x40, 0x80, 0x02, 0x80, 0x10, 0x90, 0x01, 0xB9, 0x74, 0x08, 0xF0, 0x90, 0x01, - 0xB8, 0xE5, 0x4F, 0xF0, 0x7F, 0x00, 0x22, 0x22, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, - 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x51, 0x05, 0xEF, 0x64, 0x01, 0x60, 0x05, 0x75, 0x56, - 0x01, 0x80, 0x51, 0x90, 0x81, 0x4F, 0xE0, 0xFF, 0x54, 0x03, 0x60, 0x05, 0x75, 0x56, 0x02, 0x80, - 0x43, 0x90, 0x81, 0x4D, 0xE0, 0xFE, 0xE4, 0xC3, 0x9E, 0x50, 0x05, 0x75, 0x56, 0x04, 0x80, 0x34, - 0xEF, 0x30, 0xE2, 0x05, 0x75, 0x56, 0x08, 0x80, 0x2B, 0x90, 0x81, 0x4F, 0xE0, 0x30, 0xE4, 0x05, - 0x75, 0x56, 0x10, 0x80, 0x1F, 0x90, 0x81, 0x47, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x20, 0xE0, 0x05, - 0x75, 0x56, 0x20, 0x80, 0x0F, 0x90, 0x81, 0xAE, 0xE0, 0x60, 0x05, 0x75, 0x56, 0x80, 0x80, 0x04, - 0x31, 0x78, 0x80, 0x0E, 0x90, 0x01, 0xB9, 0x74, 0x04, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x56, 0xF0, - 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x41, 0xF6, 0x7F, 0x14, - 0x7E, 0x00, 0x02, 0x32, 0xAA, 0x90, 0x04, 0x1A, 0xE0, 0xF4, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x90, - 0x04, 0x1B, 0xE0, 0x54, 0x07, 0x64, 0x07, 0x7F, 0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, 0x90, 0x01, - 0xC4, 0x74, 0x1E, 0xF0, 0x74, 0x6A, 0xA3, 0xF0, 0x90, 0x00, 0x90, 0xE0, 0x20, 0xE0, 0xF9, 0x74, - 0x1E, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0x6A, 0xA3, 0xF0, 0x22, 0x7F, 0x02, 0x90, 0x83, 0xA0, - 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x18, 0xEF, 0x25, 0xE0, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE4, - 0x0B, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0xA3, 0xF0, 0x7F, 0x00, 0x22, 0x0F, 0x80, 0xDE, 0x7F, - 0x01, 0x22, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, 0x46, 0xB8, 0x90, 0x83, 0xC2, 0xEF, 0xF0, - 0x60, 0xF0, 0x90, 0x80, 0x01, 0xE0, 0xFF, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0xE5, 0xC2, 0xAF, 0xEF, - 0x30, 0xE1, 0x0A, 0x90, 0x80, 0x01, 0xE0, 0x54, 0xFD, 0xF0, 0x12, 0x73, 0x02, 0x51, 0xAB, 0x30, - 0xE2, 0x05, 0x54, 0xFB, 0xF0, 0x51, 0xE7, 0x51, 0xAB, 0x30, 0xE4, 0x0B, 0x54, 0xEF, 0xF0, 0x51, - 0xB5, 0xBF, 0x01, 0x03, 0x12, 0x58, 0xB8, 0xD2, 0xAF, 0x80, 0xC7, 0xD2, 0xAF, 0xC2, 0xAF, 0x90, - 0x80, 0x01, 0xE0, 0xFF, 0x22, 0xE4, 0x90, 0x84, 0x65, 0xF0, 0xA3, 0xF0, 0x90, 0x02, 0x86, 0xE0, - 0x20, 0xE1, 0x21, 0xC3, 0x90, 0x84, 0x66, 0xE0, 0x94, 0xD0, 0x90, 0x84, 0x65, 0xE0, 0x94, 0x07, - 0x40, 0x0A, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x04, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0x84, 0x65, 0x12, - 0x73, 0xC2, 0x80, 0xD8, 0x7F, 0x01, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, - 0x90, 0x81, 0x3A, 0xE0, 0xFE, 0x90, 0x81, 0x39, 0xE0, 0xFD, 0xB5, 0x06, 0x04, 0x7E, 0x01, 0x80, - 0x02, 0x7E, 0x00, 0xEE, 0x64, 0x01, 0x60, 0x46, 0x90, 0x01, 0xAF, 0xE0, 0x70, 0x0B, 0xED, 0x12, - 0x74, 0x31, 0xFA, 0x7B, 0x01, 0x71, 0x53, 0x7F, 0x01, 0xEF, 0x60, 0x32, 0x90, 0x81, 0x39, 0xE0, - 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0x81, - 0x39, 0xF0, 0x90, 0x81, 0x3A, 0xE0, 0xFF, 0x90, 0x81, 0x39, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, - 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x70, 0x07, 0x90, 0x80, 0x01, 0xE0, 0x44, 0x04, 0xF0, 0xD0, 0xD0, - 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x83, 0xC3, 0x12, 0x42, 0x65, - 0x90, 0x84, 0x60, 0xE0, 0xFF, 0x04, 0xF0, 0xF1, 0x8A, 0x7F, 0xAF, 0x7E, 0x01, 0x12, 0x73, 0x75, - 0xEF, 0x60, 0x33, 0x90, 0x83, 0xC3, 0x71, 0xAE, 0x90, 0x00, 0x0E, 0x12, 0x1F, 0xBD, 0x24, 0x02, - 0xF5, 0x16, 0x7B, 0x01, 0x7A, 0x01, 0x79, 0xA0, 0x12, 0x2B, 0xED, 0x90, 0x83, 0xC3, 0x12, 0x42, - 0x5C, 0x90, 0x00, 0x0E, 0x12, 0x1F, 0xBD, 0x90, 0x01, 0xAE, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0x90, - 0x01, 0xCB, 0xE0, 0x64, 0x80, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x83, 0xF1, 0x12, 0x42, - 0x5C, 0x8B, 0x13, 0x8A, 0x14, 0x89, 0x15, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, - 0x83, 0xEE, 0x12, 0x42, 0x65, 0x78, 0xFA, 0x7C, 0x83, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x40, 0x79, - 0xCE, 0x12, 0x5F, 0xE1, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x83, 0xF9, 0xF0, 0x90, 0x04, 0x1D, 0xE0, - 0x60, 0x08, 0x7D, 0x33, 0xF1, 0x91, 0x70, 0x1C, 0x80, 0x00, 0x90, 0x83, 0x91, 0xE0, 0xFF, 0x90, - 0x84, 0x4C, 0x74, 0x10, 0xF0, 0x7B, 0x18, 0x7D, 0x01, 0x12, 0x65, 0xAB, 0x90, 0x83, 0xF6, 0xEE, - 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x83, 0xF6, 0xB1, 0x68, 0x90, 0x83, 0xF8, 0xEF, 0xF0, 0x90, 0x83, - 0xF6, 0xA3, 0xE0, 0x24, 0x20, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0x90, 0x83, 0xF4, 0xE0, - 0xFD, 0xD1, 0x11, 0x90, 0x83, 0xF5, 0xE0, 0x70, 0x49, 0xB1, 0x5E, 0xFA, 0x7B, 0x01, 0xC0, 0x03, - 0xC0, 0x02, 0xC0, 0x01, 0x71, 0xAB, 0x75, 0x16, 0x06, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x91, - 0xD6, 0xB1, 0x49, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x71, 0xAB, 0x75, 0x16, - 0x06, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x91, 0xD6, 0xB1, 0x50, 0xFA, 0x7B, 0x01, 0xC0, 0x03, - 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x83, 0xEE, 0x71, 0xAE, 0x75, 0x16, 0x04, 0xD0, 0x01, 0xD0, 0x02, - 0x80, 0x46, 0x90, 0x83, 0xF5, 0xE0, 0x64, 0x01, 0x70, 0x43, 0xB1, 0x5E, 0xFA, 0x7B, 0x01, 0xC0, - 0x03, 0x8B, 0x13, 0x75, 0x14, 0x81, 0x75, 0x15, 0xD4, 0x75, 0x16, 0x06, 0xD0, 0x03, 0x91, 0xD6, - 0xB1, 0x49, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0x8B, 0x13, 0x75, 0x14, 0x81, 0x75, 0x15, 0xDE, 0x75, - 0x16, 0x06, 0xD0, 0x03, 0x91, 0xD6, 0xB1, 0x50, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0x8B, 0x13, 0x75, - 0x14, 0x81, 0x75, 0x15, 0xE4, 0x75, 0x16, 0x04, 0xD0, 0x03, 0x12, 0x2B, 0xED, 0x90, 0x06, 0x30, - 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x83, 0xF9, 0xE0, 0xFF, 0x7D, 0x34, 0x12, 0x4D, 0x6C, 0x12, 0x67, - 0xA0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x2B, 0xED, 0x90, 0x83, 0xF6, 0xA3, 0xE0, 0xFF, 0xA3, - 0xE0, 0x2F, 0x22, 0xF1, 0xB9, 0x90, 0x84, 0x5C, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x84, 0x5C, - 0xB1, 0x68, 0x90, 0x84, 0x5E, 0xEF, 0xF0, 0x90, 0x84, 0x5C, 0xB1, 0x5F, 0xB1, 0x41, 0x75, 0x16, - 0x06, 0x7B, 0x01, 0x7A, 0x81, 0x79, 0xD4, 0xB1, 0x57, 0x91, 0xDC, 0x24, 0x36, 0xF9, 0xE4, 0x34, - 0xFC, 0xB1, 0x41, 0x75, 0x16, 0x04, 0x7B, 0x01, 0x7A, 0x81, 0x79, 0xDA, 0xB1, 0x57, 0x91, 0xDC, - 0xB1, 0x49, 0xB1, 0x41, 0x75, 0x16, 0x06, 0x7B, 0x01, 0x7A, 0x81, 0x79, 0xDE, 0xB1, 0x57, 0x91, - 0xDC, 0xB1, 0x50, 0xB1, 0x41, 0x75, 0x16, 0x04, 0x7B, 0x01, 0x7A, 0x81, 0x79, 0xE4, 0x02, 0x2B, - 0xED, 0x75, 0x13, 0x01, 0xF5, 0x14, 0x89, 0x15, 0x22, 0x24, 0x3A, 0xF9, 0xE4, 0x34, 0xFC, 0x22, - 0x24, 0x40, 0xF9, 0xE4, 0x34, 0xFC, 0x22, 0x12, 0x2B, 0xED, 0x90, 0x84, 0x5C, 0x22, 0xA3, 0xA3, - 0xE0, 0x24, 0x30, 0xF9, 0xE4, 0x34, 0xFC, 0x22, 0xA3, 0xE0, 0xFE, 0x24, 0x20, 0xF5, 0x82, 0xE4, - 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x21, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, - 0xE0, 0xFD, 0x74, 0x24, 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, - 0xF1, 0xE6, 0xAE, 0x07, 0x80, 0x02, 0xE4, 0xFE, 0xEC, 0x24, 0x18, 0x2E, 0xFF, 0x22, 0x90, 0x84, - 0x2A, 0xED, 0xF0, 0x90, 0x84, 0x27, 0x12, 0x42, 0x65, 0x12, 0x57, 0xB6, 0x90, 0x84, 0x2E, 0xF0, - 0x90, 0x84, 0x27, 0x71, 0xAE, 0x75, 0x16, 0x03, 0x7B, 0x01, 0x7A, 0x84, 0x79, 0x2B, 0x12, 0x2B, - 0xED, 0x90, 0x84, 0x2A, 0xE0, 0x70, 0x2E, 0xFF, 0xD1, 0x06, 0xE0, 0xB4, 0xFF, 0x06, 0xD1, 0x06, - 0xE4, 0xF0, 0x80, 0x07, 0xD1, 0x06, 0xE0, 0x04, 0xF0, 0x80, 0x05, 0x0F, 0xEF, 0xB4, 0x03, 0xE8, - 0x75, 0x13, 0x01, 0x75, 0x14, 0x84, 0x75, 0x15, 0x2B, 0x75, 0x16, 0x03, 0x90, 0x84, 0x27, 0x12, - 0x42, 0x5C, 0x12, 0x2B, 0xED, 0x22, 0x74, 0x2B, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x84, 0xF5, 0x83, - 0x22, 0x90, 0x84, 0x38, 0xED, 0xF0, 0x90, 0x84, 0x35, 0x12, 0x42, 0x65, 0xE4, 0x90, 0x84, 0x39, - 0xF0, 0xA3, 0xF0, 0x12, 0x1F, 0xA4, 0xFF, 0x12, 0x55, 0xD0, 0xFD, 0x12, 0x57, 0x72, 0xFB, 0xB1, - 0x8E, 0x90, 0x84, 0x39, 0xEF, 0xF0, 0x90, 0x84, 0x35, 0x12, 0x42, 0x5C, 0x12, 0x57, 0x72, 0xFF, - 0xF1, 0xE6, 0x90, 0x84, 0x3A, 0xEF, 0xF0, 0x90, 0x83, 0x8D, 0xE0, 0x24, 0xFE, 0x60, 0x14, 0x24, - 0xFE, 0x60, 0x10, 0x14, 0x60, 0x07, 0x14, 0x60, 0x04, 0x24, 0x05, 0x70, 0x40, 0xF1, 0x7E, 0xB1, - 0xAE, 0x80, 0x0C, 0xF1, 0x7E, 0x90, 0x83, 0x8D, 0xE0, 0x90, 0x84, 0x13, 0xF0, 0xD1, 0x9E, 0x90, - 0x84, 0x3A, 0xE0, 0xFF, 0x90, 0x84, 0x35, 0x12, 0x42, 0x5C, 0x90, 0x84, 0x39, 0xE0, 0x7C, 0x00, - 0x29, 0xF9, 0xEC, 0x3A, 0xFA, 0xC3, 0xE9, 0x9F, 0xF9, 0xEA, 0x94, 0x00, 0xFA, 0x75, 0x13, 0x01, - 0x75, 0x14, 0x83, 0x75, 0x15, 0x5C, 0xA3, 0xE0, 0xF5, 0x16, 0x12, 0x2B, 0xED, 0x22, 0x90, 0x84, - 0x0F, 0x12, 0x57, 0xF2, 0x90, 0x84, 0x14, 0x12, 0x55, 0xCF, 0x90, 0x84, 0x15, 0x12, 0x57, 0x71, - 0x90, 0x84, 0x16, 0xF1, 0xD4, 0x90, 0x84, 0x17, 0xF1, 0xCD, 0x90, 0x84, 0x18, 0xF0, 0x90, 0x00, - 0x07, 0x12, 0x1F, 0xBD, 0x90, 0x84, 0x19, 0x12, 0x57, 0xB5, 0x90, 0x84, 0x1C, 0xF0, 0xED, 0x70, - 0x19, 0xFF, 0xF1, 0x6B, 0xE0, 0xB4, 0xFF, 0x06, 0xF1, 0x6B, 0xE4, 0xF0, 0x80, 0x07, 0xF1, 0x6B, - 0xE0, 0x04, 0xF0, 0x80, 0x05, 0x0F, 0xEF, 0xB4, 0x06, 0xE8, 0x90, 0x84, 0x13, 0xE0, 0xFF, 0xB4, - 0x04, 0x18, 0xA3, 0xE0, 0xFE, 0xF1, 0x65, 0xEE, 0xF1, 0x76, 0xFE, 0xF1, 0x65, 0x90, 0x00, 0x01, - 0xEE, 0x12, 0x1F, 0xFC, 0x90, 0x00, 0x02, 0xE4, 0x80, 0x1B, 0xEF, 0xB4, 0x02, 0x1A, 0x90, 0x84, - 0x15, 0xF1, 0x63, 0xEF, 0xF1, 0x76, 0x44, 0x20, 0x54, 0x7F, 0xF1, 0x64, 0xF1, 0x8A, 0x90, 0x84, - 0x14, 0xE0, 0x90, 0x00, 0x02, 0x12, 0x1F, 0xFC, 0xF1, 0x65, 0xE9, 0x24, 0x03, 0xF9, 0xE4, 0x3A, - 0xFA, 0x12, 0x1F, 0xA4, 0x44, 0x20, 0x12, 0x1F, 0xEA, 0x90, 0x84, 0x16, 0xF1, 0x63, 0x90, 0x00, - 0x04, 0xEF, 0x12, 0x1F, 0xFC, 0x90, 0x84, 0x17, 0xE0, 0x90, 0x00, 0x05, 0x12, 0x1F, 0xFC, 0x90, - 0x84, 0x18, 0xE0, 0x90, 0x00, 0x06, 0x12, 0x1F, 0xFC, 0x90, 0x84, 0x19, 0xE0, 0x90, 0x00, 0x07, - 0x02, 0x1F, 0xFC, 0xE0, 0xFF, 0x90, 0x84, 0x0F, 0x02, 0x42, 0x5C, 0x74, 0x14, 0x2F, 0xF5, 0x82, - 0xE4, 0x34, 0x84, 0xF5, 0x83, 0x22, 0x12, 0x1F, 0xEA, 0x90, 0x84, 0x15, 0xE0, 0x22, 0x7B, 0x01, - 0x7A, 0x83, 0x79, 0x5C, 0x90, 0x84, 0x38, 0xE0, 0xFD, 0x22, 0x90, 0x00, 0x01, 0xEF, 0x02, 0x1F, - 0xFC, 0x7F, 0xFF, 0x12, 0x4D, 0x6C, 0x12, 0x72, 0x27, 0xEF, 0x64, 0x01, 0x22, 0xF1, 0xAF, 0x34, - 0xFC, 0xB1, 0x41, 0x75, 0x16, 0x08, 0x7B, 0x01, 0x7A, 0x83, 0x79, 0x5C, 0x02, 0x2B, 0xED, 0xF1, - 0xB9, 0x7E, 0x00, 0x74, 0x00, 0x2F, 0xF9, 0xE4, 0x22, 0xE4, 0xFE, 0xEF, 0xC3, 0x13, 0xFD, 0xEF, - 0x30, 0xE0, 0x02, 0x7E, 0x80, 0x90, 0xFD, 0x10, 0xED, 0xF0, 0xAF, 0x06, 0x22, 0xF0, 0x90, 0x00, - 0x06, 0x02, 0x1F, 0xBD, 0xF0, 0x90, 0x00, 0x05, 0x02, 0x1F, 0xBD, 0xEF, 0x60, 0x07, 0x90, 0x83, - 0x91, 0xE0, 0xFF, 0x91, 0xE3, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x20, 0xE0, - 0x05, 0x90, 0x83, 0x8E, 0x80, 0x03, 0x90, 0x83, 0x8F, 0xE0, 0x90, 0x83, 0x8D, 0xF0, 0x90, 0x83, - 0x8D, 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, 0x84, 0x00, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0x12, 0x20, - 0xDA, 0x00, 0x00, 0x00, 0x00, 0xE4, 0x90, 0x84, 0x0E, 0xF0, 0x7F, 0x24, 0x7E, 0x08, 0x12, 0x2D, - 0x5C, 0x90, 0x84, 0x06, 0x12, 0x20, 0xCE, 0x90, 0x84, 0x00, 0xE0, 0xFB, 0x70, 0x04, 0x31, 0x0C, - 0x80, 0x08, 0xEB, 0x31, 0x27, 0xE0, 0xFF, 0x12, 0x2D, 0x5C, 0x90, 0x84, 0x0A, 0x12, 0x20, 0xCE, - 0x90, 0x84, 0x01, 0x12, 0x49, 0x58, 0x78, 0x17, 0x31, 0x97, 0xAB, 0x07, 0x90, 0x84, 0x0A, 0x12, - 0x42, 0x38, 0xED, 0x54, 0x7F, 0xFD, 0xEC, 0x54, 0x80, 0xFC, 0x12, 0x42, 0x1A, 0xEC, 0x44, 0x80, - 0xFC, 0x90, 0x84, 0x0A, 0x12, 0x20, 0xCE, 0x31, 0x0C, 0xEC, 0x54, 0x7F, 0xFC, 0x31, 0x15, 0x31, - 0x1B, 0x31, 0x27, 0xE0, 0xFF, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x84, 0x0A, 0x31, 0x12, 0xD0, 0x07, - 0xD0, 0x06, 0x12, 0x2E, 0xA2, 0x31, 0x0C, 0xEC, 0x44, 0x80, 0xFC, 0x31, 0x15, 0x31, 0x1B, 0x70, - 0x04, 0x7F, 0x20, 0x80, 0x09, 0x90, 0x84, 0x00, 0xE0, 0xB4, 0x01, 0x16, 0x7F, 0x28, 0x7E, 0x08, - 0x12, 0x2D, 0x5C, 0x78, 0x08, 0x12, 0x20, 0xA8, 0xEF, 0x54, 0x01, 0xFF, 0xE4, 0x90, 0x84, 0x0E, - 0xEF, 0xF0, 0x90, 0x84, 0x0E, 0xE0, 0x90, 0x84, 0x00, 0x60, 0x0E, 0xE0, 0x75, 0xF0, 0x08, 0xA4, - 0x24, 0x66, 0xF5, 0x82, 0xE4, 0x34, 0x87, 0x80, 0x0C, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x64, - 0xF5, 0x82, 0xE4, 0x34, 0x87, 0x31, 0x8F, 0x12, 0x2D, 0x5C, 0xED, 0x54, 0x0F, 0xFD, 0xE4, 0xFC, - 0x90, 0x84, 0x02, 0x12, 0x20, 0xCE, 0x90, 0x84, 0x02, 0x02, 0x42, 0x38, 0x90, 0x84, 0x06, 0x02, - 0x42, 0x38, 0x12, 0x42, 0x38, 0x90, 0x85, 0xBB, 0x02, 0x20, 0xCE, 0x7F, 0x24, 0x7E, 0x08, 0x12, - 0x2E, 0xA2, 0x90, 0x84, 0x00, 0xE0, 0x22, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x62, 0xF5, 0x82, 0xE4, - 0x34, 0x87, 0xF5, 0x83, 0xE0, 0xFE, 0xA3, 0x22, 0x90, 0x84, 0x1D, 0xEF, 0xF0, 0xAB, 0x05, 0x90, - 0x84, 0x23, 0x12, 0x20, 0xDA, 0x00, 0x00, 0x00, 0x00, 0xAF, 0x03, 0xE4, 0xFC, 0xFD, 0xFE, 0x78, - 0x14, 0x31, 0x97, 0xAB, 0x07, 0x90, 0x84, 0x1F, 0x12, 0x42, 0x38, 0xED, 0x54, 0x0F, 0xFD, 0xE4, - 0xFC, 0x12, 0x42, 0x1A, 0xEC, 0x54, 0x0F, 0xFC, 0x90, 0x84, 0x23, 0x12, 0x20, 0xCE, 0x90, 0x84, - 0x1D, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x60, 0xF5, 0x82, 0xE4, 0x34, 0x87, 0x31, 0x8F, 0xC0, - 0x06, 0xC0, 0x07, 0x90, 0x84, 0x23, 0x31, 0x12, 0xD0, 0x07, 0xD0, 0x06, 0x02, 0x2E, 0xA2, 0xF5, - 0x83, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x12, 0x20, 0xBB, 0xA8, 0x04, 0xA9, 0x05, 0xAA, 0x06, - 0x22, 0x7F, 0xFF, 0x12, 0x4D, 0x6C, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x51, 0x27, 0x90, - 0x85, 0xBB, 0x12, 0x20, 0xDA, 0xCC, 0xF0, 0x00, 0xC0, 0x31, 0xFE, 0x12, 0x20, 0xDA, 0x00, 0x00, - 0x00, 0x14, 0x51, 0xB7, 0x12, 0x20, 0xDA, 0x00, 0x00, 0x00, 0x00, 0xE4, 0xFD, 0xFF, 0x51, 0x8C, - 0x51, 0xAE, 0x44, 0x80, 0xFC, 0x90, 0x84, 0x51, 0x12, 0x20, 0xCE, 0x90, 0x84, 0x51, 0x31, 0x12, - 0x7F, 0x7C, 0x7E, 0x08, 0x12, 0x2E, 0xA2, 0x90, 0x01, 0x00, 0x74, 0x3F, 0xF0, 0xA3, 0xE0, 0x54, - 0xFD, 0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, 0x20, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x8C, - 0x7E, 0x08, 0x12, 0x2E, 0xA2, 0x90, 0x85, 0xBB, 0x22, 0x7D, 0x2D, 0x7F, 0xFF, 0x12, 0x4D, 0x6C, - 0x51, 0x27, 0x90, 0x01, 0x37, 0x74, 0x02, 0xF0, 0xFD, 0x7F, 0x03, 0x12, 0x51, 0x35, 0x31, 0xA6, - 0xE4, 0xFD, 0x7F, 0x01, 0x02, 0x4D, 0x7B, 0xE4, 0x90, 0x84, 0x59, 0xF0, 0xA3, 0xF0, 0x90, 0x05, - 0x22, 0xE0, 0x90, 0x84, 0x5B, 0xF0, 0x7D, 0x47, 0x7F, 0xFF, 0x12, 0x4D, 0x6C, 0x90, 0x05, 0xF8, - 0xE0, 0x70, 0x11, 0xA3, 0xE0, 0x70, 0x0D, 0xA3, 0xE0, 0x70, 0x09, 0xA3, 0xE0, 0x70, 0x05, 0x51, - 0x82, 0x7F, 0x01, 0x22, 0xD3, 0x90, 0x84, 0x5A, 0xE0, 0x94, 0xE8, 0x90, 0x84, 0x59, 0xE0, 0x94, - 0x03, 0x40, 0x0C, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x20, 0xF0, 0x51, 0x82, 0x7F, 0x00, 0x22, 0x7F, - 0x32, 0x7E, 0x00, 0x12, 0x32, 0xAA, 0x90, 0x84, 0x59, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x41, 0xF6, - 0x80, 0xBB, 0x90, 0x84, 0x5B, 0xE0, 0xFF, 0x7D, 0x48, 0x02, 0x4D, 0x6C, 0xD3, 0x10, 0xAF, 0x01, - 0xC3, 0xC0, 0xD0, 0xC0, 0x07, 0xC0, 0x05, 0x90, 0x84, 0x31, 0x12, 0x42, 0x38, 0x90, 0x84, 0x1F, - 0x12, 0x20, 0xCE, 0xD0, 0x05, 0xD0, 0x07, 0x31, 0x38, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x7C, - 0x7E, 0x08, 0x12, 0x2D, 0x5C, 0xEC, 0x22, 0x7F, 0x70, 0x7E, 0x0E, 0x12, 0x2E, 0xA2, 0x90, 0x84, - 0x31, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x11, 0x25, 0xD0, 0xD0, 0x92, 0xAF, 0x22, - 0x90, 0x84, 0x67, 0xEF, 0xF0, 0x7F, 0x02, 0x12, 0x46, 0x91, 0x90, 0x80, 0x01, 0xE0, 0xFF, 0x90, - 0x84, 0x67, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x80, 0x01, 0xF0, 0x22, 0x12, 0x1F, 0xA4, 0x54, 0x01, - 0xFF, 0x90, 0x83, 0xB2, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x22, 0x12, 0x1F, 0xA4, 0x90, 0x81, 0xAE, - 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x80, 0xA2, 0xE0, 0xFF, 0x90, 0x80, - 0xA1, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x70, 0x44, 0x90, 0x80, - 0xA1, 0xE0, 0xFE, 0x75, 0xF0, 0x08, 0x90, 0x80, 0x51, 0x12, 0x42, 0x50, 0xE0, 0xFD, 0xEE, 0x75, - 0xF0, 0x08, 0xA4, 0x24, 0x52, 0xF9, 0x74, 0x80, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xAF, 0x05, 0x12, - 0x54, 0x21, 0x90, 0x80, 0xA1, 0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0xB4, 0x0A, 0x02, 0x7F, 0x01, - 0xEF, 0x60, 0x05, 0xE4, 0x90, 0x80, 0xA1, 0xF0, 0x12, 0x62, 0x6C, 0x90, 0x80, 0x01, 0xE0, 0x44, - 0x02, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0x90, 0x81, 0x39, 0xF0, 0xA3, 0xF0, 0x90, 0x80, - 0xA1, 0xF0, 0xA3, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x84, 0x45, 0xEE, - 0x71, 0xBA, 0xA3, 0xF0, 0x90, 0x84, 0x45, 0xE0, 0xFE, 0xA3, 0xE0, 0xF5, 0x82, 0x8E, 0x83, 0xE0, - 0x60, 0x21, 0xC3, 0x90, 0x84, 0x48, 0xE0, 0x94, 0xE8, 0x90, 0x84, 0x47, 0xE0, 0x94, 0x03, 0x40, - 0x0B, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x80, 0xF0, 0x7F, 0x00, 0x80, 0x09, 0x90, 0x84, 0x47, 0x71, - 0xC2, 0x80, 0xD1, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xA3, - 0xF0, 0x22, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x41, 0xF6, 0x7F, 0x0A, 0x7E, 0x00, 0x02, 0x32, 0xAA, - 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x81, 0x39, 0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, - 0x64, 0x09, 0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0x81, 0x3A, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, - 0x80, 0x02, 0x7F, 0x00, 0xEF, 0x60, 0x09, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x2C, - 0xC0, 0x01, 0x90, 0x81, 0x3A, 0xE0, 0x91, 0x31, 0xA8, 0x01, 0xFC, 0x7D, 0x01, 0xD0, 0x01, 0x7E, - 0x00, 0x7F, 0x0F, 0x12, 0x41, 0xD0, 0x90, 0x81, 0x3A, 0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0xB4, - 0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x60, 0x05, 0xE4, 0x90, 0x81, 0x3A, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, - 0x22, 0x75, 0xF0, 0x0F, 0xA4, 0x24, 0xA3, 0xF9, 0x74, 0x80, 0x35, 0xF0, 0x22, 0x75, 0x3D, 0x10, - 0xE4, 0xF5, 0x3E, 0x75, 0x3F, 0x07, 0x75, 0x40, 0x02, 0x90, 0x01, 0x30, 0xE5, 0x3D, 0xF0, 0xA3, - 0xE5, 0x3E, 0xF0, 0xA3, 0xE5, 0x3F, 0xF0, 0xA3, 0xE5, 0x40, 0xF0, 0x22, 0x75, 0x45, 0x06, 0x75, - 0x46, 0x01, 0x75, 0x47, 0x03, 0x75, 0x48, 0x62, 0x90, 0x01, 0x38, 0xE5, 0x45, 0xF0, 0xA3, 0xE5, - 0x46, 0xF0, 0xA3, 0xE5, 0x47, 0xF0, 0xA3, 0xE5, 0x48, 0xF0, 0x22, 0x90, 0x01, 0x94, 0xE0, 0x44, - 0x01, 0xF0, 0x90, 0x01, 0xC7, 0xE4, 0xF0, 0x22, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x04, 0xF0, 0x90, - 0x01, 0x9C, 0x74, 0x7E, 0xF0, 0xA3, 0x74, 0x92, 0xF0, 0xA3, 0x74, 0xA0, 0xF0, 0xA3, 0x74, 0x24, - 0xF0, 0x90, 0x01, 0x9B, 0x74, 0x49, 0xF0, 0x90, 0x01, 0x9A, 0x74, 0xE0, 0xF0, 0x90, 0x01, 0x99, - 0xE4, 0xF0, 0x90, 0x01, 0x98, 0x04, 0xF0, 0x22, 0x90, 0x00, 0x54, 0xE0, 0x55, 0x35, 0xF5, 0x39, - 0xA3, 0xE0, 0x55, 0x36, 0xF5, 0x3A, 0xA3, 0xE0, 0x55, 0x37, 0xF5, 0x3B, 0xA3, 0xE0, 0x55, 0x38, - 0xF5, 0x3C, 0xAD, 0x39, 0x7F, 0x54, 0x12, 0x32, 0x1E, 0xAD, 0x3A, 0x7F, 0x55, 0x12, 0x32, 0x1E, - 0xAD, 0x3B, 0x7F, 0x56, 0x12, 0x32, 0x1E, 0xAD, 0x3C, 0x7F, 0x57, 0x12, 0x32, 0x1E, 0x53, 0x91, - 0xEF, 0x22, 0x90, 0x01, 0x34, 0xE0, 0x55, 0x3D, 0xF5, 0x41, 0xA3, 0xE0, 0x55, 0x3E, 0xF5, 0x42, - 0xA3, 0xE0, 0x55, 0x3F, 0xF5, 0x43, 0xA3, 0xE0, 0x55, 0x40, 0xF5, 0x44, 0x90, 0x01, 0x34, 0xE5, - 0x41, 0xF0, 0xA3, 0xE5, 0x42, 0xF0, 0xA3, 0xE5, 0x43, 0xF0, 0xA3, 0xE5, 0x44, 0xF0, 0x22, 0x90, - 0x01, 0x3C, 0xE0, 0x55, 0x45, 0xF5, 0x49, 0xA3, 0xE0, 0x55, 0x46, 0xF5, 0x4A, 0xA3, 0xE0, 0x55, - 0x47, 0xF5, 0x4B, 0xA3, 0xE0, 0x55, 0x48, 0xF5, 0x4C, 0x90, 0x01, 0x3C, 0xE5, 0x49, 0xF0, 0xA3, - 0xE5, 0x4A, 0xF0, 0xA3, 0xE5, 0x4B, 0xF0, 0xA3, 0xE5, 0x4C, 0xF0, 0x53, 0x91, 0xDF, 0x22, 0x90, - 0x81, 0xAF, 0xE0, 0x30, 0xE0, 0x05, 0x7F, 0x10, 0x12, 0x64, 0x78, 0x22, 0x90, 0x01, 0xCF, 0xE0, - 0x90, 0x84, 0x6A, 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, 0x58, 0x63, 0x90, 0x00, 0x03, 0xE0, 0x54, 0xFB, 0xFD, - 0x7F, 0x03, 0x12, 0x32, 0x1E, 0x80, 0xFE, 0x22, 0x90, 0x83, 0xAB, 0xE0, 0x04, 0xF0, 0x90, 0x81, - 0x4E, 0xE0, 0x64, 0x02, 0x60, 0x09, 0x12, 0x51, 0x5C, 0x90, 0x01, 0xE6, 0xE0, 0x04, 0xF0, 0x22, - 0xE4, 0xFF, 0x12, 0x4F, 0x0C, 0xBF, 0x01, 0x13, 0x90, 0x81, 0x4B, 0xE0, 0x60, 0x0D, 0x12, 0x57, - 0x33, 0x64, 0x02, 0x60, 0x03, 0x02, 0x65, 0x89, 0x12, 0x4F, 0xCA, 0x22, 0x90, 0x81, 0x4B, 0xE0, - 0x60, 0x02, 0xB1, 0xD5, 0x22, 0x90, 0x81, 0x4B, 0xE0, 0x64, 0x01, 0x70, 0x13, 0x12, 0x57, 0x33, - 0x60, 0x05, 0x12, 0x4D, 0x63, 0x80, 0x0A, 0x90, 0x81, 0x4E, 0xE0, 0x70, 0x03, 0x12, 0x4B, 0x46, - 0x22, 0xD1, 0x26, 0x30, 0xE0, 0x05, 0x90, 0x01, 0x5B, 0xE4, 0xF0, 0x90, 0x06, 0x92, 0x74, 0x02, - 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x04, 0xF0, 0xE4, 0xF5, 0x1D, 0x90, 0x81, 0xAA, 0xE0, 0xC3, 0x13, - 0x54, 0x7F, 0xF5, 0x1E, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, 0x01, 0x12, 0x4E, 0xA6, 0x90, 0x81, - 0x46, 0xE0, 0x44, 0x08, 0xF0, 0x22, 0x90, 0x81, 0x46, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, - 0xF1, 0x6A, 0x90, 0x83, 0xB8, 0xEF, 0xF0, 0x30, 0xE0, 0x05, 0x7D, 0x01, 0xE4, 0x80, 0x02, 0xE4, - 0xFD, 0xFF, 0x12, 0x4D, 0x7B, 0x90, 0x83, 0xB8, 0xE0, 0x30, 0xE6, 0x11, 0x90, 0x01, 0x2F, 0xE0, - 0x30, 0xE7, 0x04, 0xE4, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x80, 0xF0, 0x90, 0x81, 0x46, - 0xE0, 0x90, 0x04, 0xEC, 0x30, 0xE0, 0x06, 0xE0, 0x54, 0xDD, 0xF0, 0x80, 0x04, 0xE0, 0x44, 0x22, - 0xF0, 0xF1, 0x5C, 0x90, 0x84, 0x58, 0x74, 0x02, 0xF0, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, - 0xAC, 0x07, 0x90, 0x81, 0x47, 0x12, 0x5F, 0x7F, 0x30, 0xE0, 0x02, 0xE1, 0x32, 0x90, 0x81, 0x46, - 0xE0, 0x30, 0xE0, 0x16, 0x90, 0x81, 0x68, 0xE0, 0x24, 0x04, 0x90, 0x81, 0x60, 0xF0, 0x90, 0x81, - 0x68, 0xE0, 0x24, 0x03, 0x90, 0x81, 0x5F, 0xF0, 0x80, 0x0D, 0x90, 0x81, 0x60, 0x74, 0x02, 0xF0, - 0x90, 0x81, 0x5F, 0x14, 0xF0, 0x0B, 0x0B, 0x90, 0x81, 0x5F, 0xE0, 0xFA, 0x90, 0x81, 0x5E, 0xE0, - 0xD3, 0x9A, 0x50, 0x0E, 0x90, 0x81, 0x53, 0xEB, 0xF0, 0x90, 0x81, 0x60, 0xE0, 0xC3, 0x9D, 0x2C, - 0x80, 0x11, 0xC3, 0xED, 0x9A, 0x2B, 0x90, 0x81, 0x53, 0xF0, 0x90, 0x81, 0x5F, 0xE0, 0xFF, 0xA3, - 0xE0, 0xC3, 0x9F, 0x90, 0x81, 0x63, 0xF0, 0x90, 0x81, 0x60, 0xE0, 0xFF, 0x24, 0x0A, 0xFD, 0xE4, - 0x33, 0xFC, 0x90, 0x81, 0x63, 0xF1, 0x3E, 0x40, 0x04, 0xEF, 0x24, 0x0A, 0xF0, 0x90, 0x81, 0x63, - 0xE0, 0xFF, 0x24, 0x23, 0xFD, 0xE4, 0x33, 0xFC, 0x90, 0x81, 0x53, 0xF1, 0x3E, 0x40, 0x04, 0xEF, - 0x24, 0x23, 0xF0, 0x90, 0x81, 0x63, 0xE0, 0xFF, 0x7E, 0x00, 0x90, 0x81, 0x57, 0xEE, 0xF0, 0xA3, - 0xEF, 0xF0, 0x90, 0x05, 0x58, 0xE0, 0x6F, 0x70, 0x01, 0xE4, 0x60, 0x02, 0xF1, 0x52, 0xF1, 0x49, - 0x80, 0x07, 0x90, 0x81, 0x48, 0xE0, 0x44, 0x01, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xD3, - 0x9D, 0xEC, 0x64, 0x80, 0xF8, 0x74, 0x80, 0x98, 0x22, 0x90, 0x81, 0x48, 0xE0, 0x54, 0xFE, 0xF0, - 0x22, 0xF0, 0x90, 0x81, 0x57, 0xA3, 0xE0, 0x90, 0x05, 0x58, 0xF0, 0x22, 0x90, 0x81, 0x5D, 0xE0, - 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x81, 0x64, 0xE0, 0xFB, 0x22, 0xE4, 0x90, 0x83, 0xBA, 0xF0, 0xA3, - 0xF0, 0x90, 0x00, 0x83, 0xE0, 0x90, 0x83, 0xB9, 0xF0, 0x90, 0x00, 0x83, 0xE0, 0xFE, 0x90, 0x83, - 0xB9, 0xE0, 0xFF, 0xB5, 0x06, 0x01, 0x22, 0xC3, 0x90, 0x83, 0xBB, 0xE0, 0x94, 0x64, 0x90, 0x83, - 0xBA, 0xE0, 0x94, 0x00, 0x40, 0x0D, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0x83, 0xB9, - 0xE0, 0xFF, 0x22, 0x90, 0x83, 0xBA, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x41, 0xF6, 0x80, 0xC2, 0xC3, - 0xEE, 0x94, 0x01, 0x40, 0x0A, 0x0D, 0xED, 0x13, 0x90, 0xFD, 0x10, 0xF0, 0xE4, 0x2F, 0xFF, 0x22, - 0xC3, 0xEE, 0x94, 0x01, 0x40, 0x1E, 0x90, 0xFD, 0x11, 0xE0, 0xB5, 0x05, 0x14, 0x90, 0x01, 0x17, - 0xE0, 0xB5, 0x05, 0x07, 0x90, 0xFD, 0x11, 0xE4, 0xF0, 0x80, 0x06, 0xED, 0x04, 0x90, 0xFD, 0x11, - 0xF0, 0xE4, 0x2F, 0xFF, 0x22, 0x74, 0x45, 0x2F, 0xF8, 0xE6, 0x4D, 0x02, 0x52, 0x30, 0x7E, 0x00, - 0x7F, 0x62, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x81, 0x79, 0x46, 0x12, 0x44, 0x3E, 0x90, 0x81, 0x4A, - 0x74, 0x02, 0xF0, 0x90, 0x81, 0x51, 0x14, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0x90, 0x81, - 0x57, 0xE4, 0xF0, 0xA3, 0x74, 0x02, 0x11, 0x9E, 0x31, 0x28, 0xE4, 0xFD, 0xFF, 0x12, 0x4D, 0x7B, - 0x7D, 0x0C, 0x7F, 0x02, 0x12, 0x4D, 0x7B, 0x12, 0x4D, 0x77, 0x90, 0x80, 0x07, 0xE0, 0xFF, 0xB4, - 0x01, 0x08, 0x90, 0x81, 0x56, 0x74, 0x99, 0xF0, 0x80, 0x29, 0xEF, 0xB4, 0x03, 0x08, 0x90, 0x81, - 0x56, 0x74, 0x90, 0xF0, 0x80, 0x1D, 0x90, 0x81, 0x56, 0x74, 0x40, 0xF0, 0x90, 0x00, 0x2C, 0xE0, - 0x54, 0x0F, 0xFF, 0xBF, 0x05, 0x08, 0x90, 0x81, 0x68, 0x74, 0x02, 0xF0, 0x80, 0x05, 0xE4, 0x90, - 0x81, 0x68, 0xF0, 0x90, 0x81, 0xA8, 0x74, 0x03, 0xF0, 0xA3, 0x74, 0x0F, 0xF0, 0xA3, 0xE0, 0x54, - 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, 0x07, 0x11, 0x9E, 0x7F, 0x01, 0x31, 0x3F, 0x90, 0x05, 0x58, - 0x74, 0x02, 0xF0, 0x7E, 0x00, 0xFF, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x81, 0x79, 0xAC, 0x12, 0x44, - 0x3E, 0x11, 0xAE, 0x31, 0x14, 0x12, 0x57, 0xBE, 0xE4, 0x90, 0x81, 0xAE, 0xF0, 0x22, 0xF0, 0x90, - 0x81, 0x68, 0xE0, 0x24, 0x04, 0x90, 0x81, 0x63, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0x22, 0x90, 0x06, - 0x04, 0xE0, 0x54, 0x7F, 0xF0, 0x22, 0x90, 0x84, 0x40, 0xE0, 0xFF, 0xD3, 0x10, 0xAF, 0x01, 0xC3, - 0xC0, 0xD0, 0x90, 0x84, 0x6D, 0xEF, 0xF0, 0x90, 0x80, 0x4C, 0xE0, 0xFF, 0x90, 0x04, 0x1C, 0xE0, - 0x6F, 0x70, 0x3C, 0x90, 0x81, 0x4E, 0xE0, 0x64, 0x0E, 0x70, 0x14, 0x90, 0x84, 0x6D, 0xE0, 0x70, - 0x2E, 0x90, 0x81, 0x46, 0xE0, 0x54, 0x7F, 0xF0, 0x11, 0xAE, 0x12, 0x4D, 0x77, 0x80, 0x1D, 0x90, - 0x81, 0x4E, 0xE0, 0x64, 0x06, 0x70, 0x18, 0x90, 0x84, 0x6D, 0xE0, 0x60, 0x12, 0x90, 0x81, 0x46, - 0xE0, 0x54, 0xBF, 0xF0, 0x31, 0x1C, 0x90, 0x81, 0x4E, 0x74, 0x04, 0xF0, 0x12, 0x57, 0xBE, 0xD0, - 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x22, 0x90, 0x06, 0x04, 0xE0, - 0x44, 0x40, 0xF0, 0xE0, 0x44, 0x80, 0xF0, 0x22, 0x90, 0x81, 0xA2, 0x74, 0x04, 0xF0, 0xA3, 0x14, - 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0x74, 0x64, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xF0, 0x22, 0xE4, - 0xFE, 0x12, 0x4A, 0xC4, 0xE4, 0xF0, 0x0E, 0xEE, 0xB4, 0x2D, 0xF6, 0xE4, 0x90, 0x81, 0x62, 0xF0, - 0x90, 0x81, 0x61, 0xF0, 0x90, 0x81, 0x65, 0xF0, 0xEF, 0xB4, 0x01, 0x07, 0xA3, 0x74, 0x2D, 0xF0, - 0xE4, 0xA3, 0xF0, 0x22, 0xEF, 0x24, 0xFE, 0x60, 0x0B, 0x04, 0x70, 0x24, 0x90, 0x81, 0x51, 0x74, - 0x02, 0xF0, 0x80, 0x13, 0xED, 0x70, 0x06, 0x90, 0x81, 0xAB, 0xE0, 0x80, 0x02, 0xED, 0x14, 0x90, - 0x81, 0x51, 0xF0, 0x90, 0x81, 0x51, 0xE0, 0xA3, 0xF0, 0x90, 0x81, 0x47, 0xE0, 0x44, 0x08, 0xF0, - 0x22, 0x12, 0x57, 0xBC, 0x7D, 0x0C, 0x7F, 0x01, 0x02, 0x4D, 0x7B, 0x90, 0x83, 0xA1, 0xE0, 0x54, - 0xFE, 0xF0, 0x54, 0x7F, 0xF0, 0x54, 0xFB, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, - 0xF0, 0x22, 0x90, 0x83, 0xA1, 0xE0, 0x30, 0xE0, 0x37, 0x12, 0x4F, 0x06, 0x64, 0x01, 0x70, 0x30, - 0x90, 0x84, 0x6F, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x0A, 0x0B, 0x90, 0x83, 0xA3, 0xE0, 0x04, 0xF0, - 0xE4, 0x90, 0x84, 0x6F, 0xF0, 0x90, 0x83, 0xA3, 0xE0, 0xFF, 0x90, 0x83, 0xA2, 0xE0, 0xD3, 0x9F, - 0x50, 0x0E, 0x90, 0x83, 0xA4, 0xE0, 0x70, 0x08, 0xE4, 0x90, 0x83, 0xA3, 0xF0, 0x12, 0x67, 0x87, - 0x22, 0x51, 0x1E, 0x90, 0x83, 0xA1, 0x51, 0x10, 0x54, 0x04, 0xFF, 0xEE, 0x54, 0xFB, 0x4F, 0xF0, - 0x12, 0x1F, 0xA4, 0xC3, 0x13, 0x30, 0xE0, 0x07, 0x12, 0x55, 0xD0, 0x90, 0x83, 0xA2, 0xF0, 0x22, - 0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, 0x22, 0x90, 0x83, 0xC7, 0x12, 0x42, 0x5C, 0x12, 0x1F, - 0xA4, 0xFF, 0x54, 0x01, 0xFE, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x02, 0x84, 0xEF, 0xF0, - 0xEE, 0xA3, 0xF0, 0xA3, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x71, 0x7E, 0x51, 0xFE, 0x90, 0x83, 0xC7, - 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x02, 0x87, 0xE0, 0x90, 0x83, 0xCB, 0xF0, 0x90, 0x81, 0xAF, 0xE0, - 0x20, 0xE0, 0x02, 0x41, 0xE8, 0x90, 0x83, 0xCB, 0xE0, 0xFF, 0xEC, 0xC3, 0x9F, 0x40, 0x02, 0x41, - 0xE8, 0x90, 0x83, 0xC7, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0x71, 0x76, 0xAD, 0x07, 0x74, 0x02, 0x2D, - 0x71, 0xAD, 0xF9, 0x51, 0xE9, 0xFE, 0x74, 0x00, 0x2D, 0x12, 0x5E, 0xB0, 0xE0, 0x7A, 0x00, 0x24, - 0x00, 0xFF, 0xEA, 0x3E, 0x54, 0x3F, 0x90, 0x83, 0xC9, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x03, 0x2D, - 0x71, 0x87, 0xFF, 0x7E, 0x00, 0xAD, 0x01, 0xED, 0x24, 0x18, 0xFB, 0xEA, 0x33, 0xCB, 0x2F, 0xFF, - 0xEE, 0x3B, 0x90, 0x83, 0xC9, 0x8F, 0xF0, 0x12, 0x41, 0xF6, 0x90, 0x83, 0xC9, 0xE0, 0xFE, 0xA3, - 0xE0, 0xFF, 0x71, 0x07, 0x90, 0x83, 0xC9, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x83, 0xC7, 0x71, - 0x9E, 0xD3, 0x90, 0x83, 0xC8, 0xE0, 0x9F, 0x90, 0x83, 0xC7, 0xE0, 0x9E, 0x40, 0x12, 0x90, 0x81, - 0x3C, 0x71, 0x92, 0xC3, 0x90, 0x83, 0xC8, 0xE0, 0x9F, 0xF0, 0x90, 0x83, 0xC7, 0xE0, 0x9E, 0xF0, - 0x90, 0x83, 0xC7, 0x51, 0x26, 0x0C, 0x41, 0x55, 0x22, 0x74, 0x01, 0x2D, 0xF5, 0x82, 0xE4, 0x34, - 0xFB, 0xF5, 0x83, 0xE0, 0x22, 0xF0, 0x90, 0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, 0x16, 0xE0, 0x7C, - 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x22, 0x7D, 0x7F, 0xEF, 0x5D, 0xC3, 0x60, 0x0B, 0x71, 0x1E, - 0x5F, 0x24, 0x80, 0xFF, 0xE4, 0x3E, 0xFE, 0x80, 0x04, 0x71, 0x1E, 0x5F, 0xFF, 0x22, 0x74, 0xFF, - 0x9D, 0xFD, 0x74, 0xFF, 0x94, 0x00, 0x5E, 0xFE, 0xED, 0x22, 0x71, 0xBD, 0xAD, 0x07, 0x90, 0x01, - 0xC4, 0x74, 0x2A, 0xF0, 0x74, 0x7B, 0xA3, 0xF0, 0xED, 0x64, 0x01, 0x60, 0x1E, 0x12, 0x5B, 0x3D, - 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, 0x5A, 0xF2, 0x51, 0x39, 0x90, 0x02, 0x87, - 0xE0, 0x70, 0xF8, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x02, 0xF0, 0x74, 0x2A, 0x04, 0x90, 0x01, 0xC4, - 0xF0, 0x74, 0x7B, 0xA3, 0xF0, 0x22, 0xEA, 0x90, 0xFD, 0x11, 0xF0, 0xAF, 0x03, 0x22, 0x90, 0x01, - 0x1F, 0xE0, 0xFE, 0x90, 0x01, 0x1E, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, - 0x03, 0x22, 0xE0, 0x24, 0x01, 0xFF, 0x90, 0x81, 0x3B, 0xE0, 0x34, 0x00, 0xFE, 0x22, 0xEE, 0x8F, - 0xF0, 0x12, 0x41, 0xF6, 0x90, 0x81, 0x3B, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0xF5, 0x82, 0xE4, - 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0x0F, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x22, 0x90, 0x02, 0x86, - 0xE0, 0x20, 0xE2, 0x03, 0x7F, 0x04, 0x22, 0x90, 0x02, 0x86, 0xE0, 0x7F, 0x01, 0x20, 0xE1, 0x02, - 0x7F, 0x02, 0x22, 0x90, 0x81, 0xB8, 0xE0, 0x30, 0xE0, 0x0D, 0x90, 0x81, 0xB2, 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, 0x5B, 0x3D, 0xE4, 0xFE, 0x74, 0x5C, - 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x83, 0xF5, 0x83, 0xE0, 0xFD, 0x74, 0xA4, 0x2E, 0xF5, 0x82, 0xE4, - 0x34, 0x01, 0xF5, 0x83, 0xED, 0xF0, 0x0E, 0xEE, 0xB4, 0x08, 0xE3, 0x90, 0x83, 0x8C, 0xE0, 0x90, - 0x04, 0x4C, 0xF0, 0x90, 0x83, 0x9F, 0xE0, 0x60, 0x1A, 0x12, 0x6F, 0xAF, 0x34, 0xFC, 0xFA, 0x7B, - 0x01, 0xC0, 0x03, 0x8B, 0x13, 0x75, 0x14, 0x83, 0x75, 0x15, 0x5C, 0x75, 0x16, 0x32, 0xD0, 0x03, - 0x12, 0x2B, 0xED, 0x22, 0x90, 0x02, 0x09, 0xE0, 0x90, 0x83, 0xC7, 0xF0, 0x12, 0x1F, 0xA4, 0x90, - 0x83, 0x8E, 0x12, 0x55, 0xCF, 0x90, 0x83, 0x8F, 0xF0, 0x22, 0x91, 0x9A, 0x2E, 0x90, 0x83, 0x90, - 0x12, 0x55, 0xCF, 0xFF, 0xED, 0x2F, 0x90, 0x83, 0x91, 0x12, 0x55, 0xC7, 0xFF, 0xED, 0x2F, 0x90, - 0x83, 0x92, 0x12, 0x57, 0xB5, 0xFF, 0xED, 0x2F, 0x90, 0x83, 0x93, 0x12, 0x57, 0x71, 0xFF, 0xED, - 0x2F, 0x90, 0x83, 0x94, 0x12, 0x6F, 0xD4, 0xFF, 0xED, 0x2F, 0x90, 0x83, 0x95, 0x12, 0x6F, 0xCD, - 0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x90, 0x83, 0x96, 0xF0, 0x22, 0x90, 0x02, 0x09, 0xE0, 0xFD, 0x12, - 0x1F, 0xA4, 0xFE, 0xAF, 0x05, 0xED, 0x22, 0x91, 0x9A, 0x2E, 0x90, 0x83, 0x9E, 0x12, 0x55, 0xCF, - 0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x90, 0x83, 0x9F, 0xF0, 0x22, 0x91, 0x9A, 0x2E, 0x90, 0x83, 0x97, - 0x12, 0x55, 0xCF, 0xFF, 0xED, 0x2F, 0x90, 0x83, 0x98, 0x12, 0x55, 0xC7, 0xFF, 0xED, 0x2F, 0x90, - 0x83, 0x99, 0x12, 0x57, 0xB5, 0xFF, 0xED, 0x2F, 0x90, 0x83, 0x9A, 0x12, 0x57, 0x71, 0xFF, 0xED, - 0x2F, 0x90, 0x83, 0x9B, 0x12, 0x6F, 0xD4, 0xFF, 0xED, 0x2F, 0x90, 0x83, 0x9C, 0x12, 0x6F, 0xCD, - 0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x90, 0x83, 0x9D, 0xF0, 0x22, 0xE4, 0xFF, 0x74, 0x18, 0xB1, 0x22, - 0x74, 0xBF, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0xEE, 0xF0, 0x74, 0x10, 0xB1, 0x22, - 0x74, 0xB9, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0xB4, 0x06, - 0xDB, 0x22, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x06, 0xF5, 0x83, 0xE0, 0xFE, 0x22, 0x12, 0x42, 0x44, - 0x90, 0x81, 0x9A, 0x12, 0x42, 0x38, 0x12, 0x42, 0x0C, 0x78, 0x0A, 0x12, 0x20, 0xA8, 0x90, 0x81, - 0x63, 0xE0, 0xFE, 0xC3, 0x74, 0x0A, 0x9E, 0x2F, 0xFF, 0x22, 0x90, 0x81, 0x54, 0xE0, 0x75, 0xF0, - 0x03, 0xA4, 0x24, 0xFE, 0x22, 0x12, 0x42, 0x1A, 0x90, 0x81, 0x9E, 0x12, 0x20, 0xCE, 0x90, 0x81, - 0x47, 0xE0, 0x22, 0x7D, 0x01, 0x7B, 0x01, 0x7A, 0x81, 0x79, 0xDA, 0x7E, 0x00, 0x7F, 0x04, 0x12, - 0x44, 0x1A, 0xEF, 0x22, 0x90, 0x81, 0xA8, 0xE0, 0xFF, 0x90, 0x81, 0x54, 0xE0, 0xD3, 0x9F, 0x22, - 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0xFE, 0xEF, 0x54, 0x07, 0xFF, 0x22, 0xFF, 0x90, 0x81, 0x53, - 0xE0, 0x2F, 0x90, 0x81, 0x64, 0xF0, 0x22, 0xE0, 0x90, 0x01, 0xBA, 0xF0, 0x90, 0x81, 0x4D, 0xE0, - 0x22, 0xE0, 0x2F, 0xFF, 0x90, 0x81, 0xA6, 0xE0, 0xFD, 0x22, 0x90, 0x83, 0xEC, 0xE0, 0xFF, 0xC3, - 0x94, 0x04, 0x22, 0x90, 0x83, 0xEC, 0xE0, 0xFF, 0xC3, 0x94, 0x06, 0x22, 0x7E, 0x00, 0x7F, 0x06, - 0x12, 0x44, 0x1A, 0xEF, 0x22, 0x54, 0x08, 0xFE, 0xEF, 0x54, 0xF7, 0x4E, 0x22, 0x90, 0x81, 0x3B, - 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0x90, 0x83, 0xC3, 0xE0, 0xFC, 0xA3, 0xE0, 0x22, 0xF0, 0x90, 0x81, - 0x66, 0xE0, 0xFF, 0xC3, 0x22, 0x90, 0x81, 0x47, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x90, 0x81, 0x49, - 0xE0, 0xC4, 0x54, 0x0F, 0x22, 0x7D, 0x01, 0x7F, 0x02, 0x02, 0x51, 0x51, 0x90, 0x81, 0x51, 0xE0, - 0x90, 0x05, 0x73, 0x22, 0x2F, 0xF8, 0xE6, 0xFE, 0xED, 0xF4, 0x5E, 0x22, 0xC4, 0x11, -}; -u32 array_length_mp_8188e_t_fw_wowlan = 15918; - -#endif - -void -odm_read_firmware_mp_8188e_t_fw_wowlan( - struct PHY_DM_STRUCT *p_dm_odm, - u8 *p_firmware, - u32 *p_firmware_size -) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) - *((SIZE_PTR *)p_firmware) = (SIZE_PTR)array_mp_8188e_t_fw_wowlan; -#else - odm_move_memory(p_dm_odm, p_firmware, array_mp_8188e_t_fw_wowlan, array_length_mp_8188e_t_fw_wowlan); -#endif - *p_firmware_size = array_length_mp_8188e_t_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/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_t_fw.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_t_fw.h deleted file mode 100644 index 62722ad26927..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halhwimg8188e_t_fw.h +++ /dev/null @@ -1,72 +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 (RTL8188E_T_SUPPORT == 1) -#ifndef __INC_MP_FW_HW_IMG_8188E_T_H -#define __INC_MP_FW_HW_IMG_8188E_T_H - - -/****************************************************************************** -* FW_AP.TXT -******************************************************************************/ - -void -odm_read_firmware_mp_8188e_t_fw_ap( - struct PHY_DM_STRUCT *p_dm_odm, - u8 *p_firmware, - u32 *p_firmware_size -); - -/****************************************************************************** -* FW_NIC.TXT -******************************************************************************/ - -void -odm_read_firmware_mp_8188e_t_fw_nic( - struct PHY_DM_STRUCT *p_dm_odm, - u8 *p_firmware, - u32 *p_firmware_size -); - -/****************************************************************************** -* FW_NIC_89EM.TXT -******************************************************************************/ - -void -odm_read_firmware_mp_8188e_t_fw_nic_89e_m( - struct PHY_DM_STRUCT *p_dm_odm, - u8 *p_firmware, - u32 *p_firmware_size -); - -/****************************************************************************** -* FW_WoWLAN.TXT -******************************************************************************/ - -void -odm_read_firmware_mp_8188e_t_fw_wowlan( - struct PHY_DM_STRUCT *p_dm_odm, - u8 *p_firmware, - u32 *p_firmware_size -); - -#endif -#endif /* end of HWIMG_SUPPORT*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halphyrf_8188e_ap.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halphyrf_8188e_ap.c deleted file mode 100644 index d090f14b9e7b..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halphyrf_8188e_ap.c +++ /dev/null @@ -1,2996 +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 Local Constant---------------------------*/ -/* 2010/04/25 MH Define the max tx power tracking tx agc power. */ -#define ODM_TXPWRTRACK_MAX_IDX_88E 6 - -/*---------------------------Define Local Constant---------------------------*/ - - -/* 3============================================================ - * 3 Tx Power Tracking - * 3============================================================ */ - - -void set_iqk_matrix_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u8 OFDM_index, - u8 rf_path, - s32 iqk_result_x, - s32 iqk_result_y -) -{ - s32 ele_A = 0, ele_D, ele_C = 0, /*TempCCk,*/ value32; - - ele_D = (ofdm_swing_table_new[OFDM_index] & 0xFFC00000) >> 22; - - /* new element A = element D x X */ - if ((iqk_result_x != 0) && (*(p_dm_odm->p_band_type) == ODM_BAND_2_4G)) { - if ((iqk_result_x & 0x00000200) != 0) /* consider minus */ - iqk_result_x = iqk_result_x | 0xFFFFFC00; - ele_A = ((iqk_result_x * ele_D) >> 8) & 0x000003FF; - - /* new element C = element D x Y */ - if ((iqk_result_y & 0x00000200) != 0) - iqk_result_y = iqk_result_y | 0xFFFFFC00; - ele_C = ((iqk_result_y * ele_D) >> 8) & 0x000003FF; - - if (rf_path == RF_PATH_A) - switch (rf_path) { - case RF_PATH_A: - /* 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; - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKDWORD, value32); - - value32 = (ele_C & 0x000003C0) >> 6; - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XC_TX_AFE, MASKH4BITS, value32); - - value32 = ((iqk_result_x * ele_D) >> 7) & 0x01; - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_ECCA_THRESHOLD, BIT(24), value32); - break; - case RF_PATH_B: - /* 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; - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XB_TX_IQ_IMBALANCE, MASKDWORD, value32); - - value32 = (ele_C & 0x000003C0) >> 6; - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XD_TX_AFE, MASKH4BITS, value32); - - value32 = ((iqk_result_x * ele_D) >> 7) & 0x01; - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_ECCA_THRESHOLD, BIT(28), value32); - - break; - default: - break; - } - } else { - switch (rf_path) { - case RF_PATH_A: - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKDWORD, ofdm_swing_table_new[OFDM_index]); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XC_TX_AFE, MASKH4BITS, 0x00); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_ECCA_THRESHOLD, BIT(24), 0x00); - break; - - case RF_PATH_B: - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XB_TX_IQ_IMBALANCE, MASKDWORD, ofdm_swing_table_new[OFDM_index]); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XD_TX_AFE, MASKH4BITS, 0x00); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_ECCA_THRESHOLD, BIT(28), 0x00); - break; - - default: - break; - } - } - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("TxPwrTracking path B: X = 0x%x, Y = 0x%x ele_A = 0x%x ele_C = 0x%x ele_D = 0x%x 0xeb4 = 0x%x 0xebc = 0x%x\n", - (u32)iqk_result_x, (u32)iqk_result_y, (u32)ele_A, (u32)ele_C, (u32)ele_D, (u32)iqk_result_x, (u32)iqk_result_y)); -} - -void do_iqk_8188e( - void *p_dm_void, - u8 delta_thermal_index, - u8 thermal_value, - u8 threshold -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - struct _ADAPTER *adapter = p_dm_odm->adapter; - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); -#endif - - odm_reset_iqk_result(p_dm_odm); - -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) -#if USE_WORKITEM - platform_acquire_mutex(&p_hal_data->mx_chnl_bw_control); -#else - platform_acquire_spin_lock(adapter, RT_CHANNEL_AND_BANDWIDTH_SPINLOCK); -#endif -#elif ((DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE)) - platform_acquire_mutex(&p_hal_data->mx_chnl_bw_control); -#endif -#endif - - - p_dm_odm->rf_calibrate_info.thermal_value_iqk = thermal_value; -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - phy_iq_calibrate_8188e(p_dm_odm, false); -#else - phy_iq_calibrate_8188e(adapter, false); -#endif - -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) -#if USE_WORKITEM - platform_release_mutex(&p_hal_data->mx_chnl_bw_control); -#else - platform_release_spin_lock(adapter, RT_CHANNEL_AND_BANDWIDTH_SPINLOCK); -#endif -#elif ((DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE)) - platform_release_mutex(&p_hal_data->mx_chnl_bw_control); -#endif -#endif -} - -/*----------------------------------------------------------------------------- - * Function: odm_TxPwrTrackSetPwr88E() - * - * Overview: 88E 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_pwr88_e( - struct PHY_DM_STRUCT *p_dm_odm, - enum pwrtrack_method method, - u8 rf_path, - u8 channel_mapped_index -) -{ - if (method == TXAGC) { - /* u8 cck_power_level[MAX_TX_COUNT], ofdm_power_level[MAX_TX_COUNT]; - * u8 bw20_power_level[MAX_TX_COUNT], bw40_power_level[MAX_TX_COUNT]; - * u8 rf = 0; */ -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - u32 pwr = 0, tx_agc = 0; - struct _ADAPTER *adapter = p_dm_odm->adapter; -#endif - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("odm_TxPwrTrackSetPwr88E CH=%d\n", *(p_dm_odm->p_channel))); -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - -#if (MP_DRIVER != 1) - phy_set_tx_power_level8188e(p_dm_odm->adapter, *p_dm_odm->p_channel); -#else - pwr = phy_query_bb_reg(adapter, REG_TX_AGC_A_RATE18_06, 0xFF); - pwr += (p_dm_odm->bb_swing_idx_cck - p_dm_odm->bb_swing_idx_cck_base); - phy_set_bb_reg(adapter, REG_TX_AGC_A_CCK_1_MCS32, MASKBYTE1, pwr); - tx_agc = (pwr << 16) | (pwr << 8) | (pwr); - phy_set_bb_reg(adapter, REG_TX_AGC_B_CCK_11_A_CCK_2_11, 0xffffff00, tx_agc); - RTPRINT(FPHY, PHY_TXPWR, ("odm_tx_pwr_track_set_pwr88_e: CCK Tx-rf(A) Power = 0x%x\n", tx_agc)); - - pwr = phy_query_bb_reg(adapter, REG_TX_AGC_A_RATE18_06, 0xFF); - pwr += (p_dm_odm->bb_swing_idx_ofdm[RF_PATH_A] - p_dm_odm->bb_swing_idx_ofdm_base); - tx_agc |= ((pwr << 24) | (pwr << 16) | (pwr << 8) | pwr); - phy_set_bb_reg(adapter, REG_TX_AGC_A_RATE18_06, MASKDWORD, tx_agc); - phy_set_bb_reg(adapter, REG_TX_AGC_A_RATE54_24, MASKDWORD, tx_agc); - phy_set_bb_reg(adapter, REG_TX_AGC_A_MCS03_MCS00, MASKDWORD, tx_agc); - phy_set_bb_reg(adapter, REG_TX_AGC_A_MCS07_MCS04, MASKDWORD, tx_agc); - phy_set_bb_reg(adapter, REG_TX_AGC_A_MCS11_MCS08, MASKDWORD, tx_agc); - phy_set_bb_reg(adapter, REG_TX_AGC_A_MCS15_MCS12, MASKDWORD, tx_agc); - RTPRINT(FPHY, PHY_TXPWR, ("odm_tx_pwr_track_set_pwr88_e: OFDM Tx-rf(A) Power = 0x%x\n", tx_agc)); -#endif - -#endif -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - phy_rf6052_set_cck_tx_power(p_dm_odm->priv, *(p_dm_odm->p_channel)); - phy_rf6052_set_ofdm_tx_power(p_dm_odm->priv, *(p_dm_odm->p_channel)); -#endif - - } else if (method == BBSWING) { - /* Adjust BB swing by OFDM IQ matrix */ - if (rf_path == RF_PATH_A) { - set_iqk_matrix_8188e(p_dm_odm, p_dm_odm->rf_calibrate_info.bb_swing_idx_ofdm[RF_PATH_A], RF_PATH_A, - p_dm_odm->rf_calibrate_info.iqk_matrix_reg_setting[channel_mapped_index].value[0][0], - p_dm_odm->rf_calibrate_info.iqk_matrix_reg_setting[channel_mapped_index].value[0][1]); - } else if (rf_path == RF_PATH_B) { - set_iqk_matrix_8188e(p_dm_odm, p_dm_odm->rf_calibrate_info.bb_swing_idx_ofdm[RF_PATH_B], RF_PATH_B, - p_dm_odm->rf_calibrate_info.iqk_matrix_reg_setting[channel_mapped_index].value[0][4], - p_dm_odm->rf_calibrate_info.iqk_matrix_reg_setting[channel_mapped_index].value[0][5]); - } - /*Adjust BB swing by CCK filter coefficient*/ - if (!p_dm_odm->rf_calibrate_info.is_cck_in_ch14) { - odm_write_1byte(p_dm_odm, 0xa22, cck_swing_table_ch1_ch13_new[p_dm_odm->rf_calibrate_info.bb_swing_idx_cck][0]); - odm_write_1byte(p_dm_odm, 0xa23, cck_swing_table_ch1_ch13_new[p_dm_odm->rf_calibrate_info.bb_swing_idx_cck][1]); - odm_write_1byte(p_dm_odm, 0xa24, cck_swing_table_ch1_ch13_new[p_dm_odm->rf_calibrate_info.bb_swing_idx_cck][2]); - odm_write_1byte(p_dm_odm, 0xa25, cck_swing_table_ch1_ch13_new[p_dm_odm->rf_calibrate_info.bb_swing_idx_cck][3]); - odm_write_1byte(p_dm_odm, 0xa26, cck_swing_table_ch1_ch13_new[p_dm_odm->rf_calibrate_info.bb_swing_idx_cck][4]); - odm_write_1byte(p_dm_odm, 0xa27, cck_swing_table_ch1_ch13_new[p_dm_odm->rf_calibrate_info.bb_swing_idx_cck][5]); - odm_write_1byte(p_dm_odm, 0xa28, cck_swing_table_ch1_ch13_new[p_dm_odm->rf_calibrate_info.bb_swing_idx_cck][6]); - odm_write_1byte(p_dm_odm, 0xa29, cck_swing_table_ch1_ch13_new[p_dm_odm->rf_calibrate_info.bb_swing_idx_cck][7]); - } else { - odm_write_1byte(p_dm_odm, 0xa22, cck_swing_table_ch14_new[p_dm_odm->rf_calibrate_info.bb_swing_idx_cck][0]); - odm_write_1byte(p_dm_odm, 0xa23, cck_swing_table_ch14_new[p_dm_odm->rf_calibrate_info.bb_swing_idx_cck][1]); - odm_write_1byte(p_dm_odm, 0xa24, cck_swing_table_ch14_new[p_dm_odm->rf_calibrate_info.bb_swing_idx_cck][2]); - odm_write_1byte(p_dm_odm, 0xa25, cck_swing_table_ch14_new[p_dm_odm->rf_calibrate_info.bb_swing_idx_cck][3]); - odm_write_1byte(p_dm_odm, 0xa26, cck_swing_table_ch14_new[p_dm_odm->rf_calibrate_info.bb_swing_idx_cck][4]); - odm_write_1byte(p_dm_odm, 0xa27, cck_swing_table_ch14_new[p_dm_odm->rf_calibrate_info.bb_swing_idx_cck][5]); - odm_write_1byte(p_dm_odm, 0xa28, cck_swing_table_ch14_new[p_dm_odm->rf_calibrate_info.bb_swing_idx_cck][6]); - odm_write_1byte(p_dm_odm, 0xa29, cck_swing_table_ch14_new[p_dm_odm->rf_calibrate_info.bb_swing_idx_cck][7]); - } - } else - return; - - - - -} /* odm_TxPwrTrackSetPwr88E */ - -void configure_txpower_track_8188e( - struct _TXPWRTRACK_CFG *p_config -) -{ - p_config->swing_table_size_cck = CCK_TABLE_SIZE; - p_config->swing_table_size_ofdm = OFDM_TABLE_SIZE_92D; - p_config->threshold_iqk = 8; - p_config->average_thermal_num = AVG_THERMAL_NUM_88E; - p_config->rf_path_count = 1; - p_config->thermal_reg_addr = RF_T_METER_88E; - - p_config->odm_tx_pwr_track_set_pwr = odm_tx_pwr_track_set_pwr88_e; - p_config->do_iqk = do_iqk_8188e; - p_config->phy_lc_calibrate = phy_lc_calibrate_8188e; -} - -/* 1 7. IQK */ -#define MAX_TOLERANCE 5 -#define IQK_DELAY_TIME 1 /* ms */ - -u8 /* bit0 = 1 => Tx OK, bit1 = 1 => Rx OK */ -phy_path_a_iqk_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - bool config_path_b -) -{ - u32 reg_eac, reg_e94, reg_e9c, reg_ea4; - u8 result = 0x00; -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -#ifndef SMP_SYNC - unsigned long x; -#endif - struct rtl8192cd_priv *priv = p_dm_odm->priv; - SAVE_INT_AND_CLI(x); -#endif -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A IQK!\n")); - - /* 1 Tx IQK */ - /* path-A IQK setting */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path-A IQK setting!\n")); - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_TONE_A, MASKDWORD, 0x10008c1c); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_TONE_A, MASKDWORD, 0x30008c1c); - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_PI_A, MASKDWORD, 0x8214032a); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_PI_A, MASKDWORD, 0x28160000); - - /* LO calibration setting */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LO calibration setting!\n")); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_RSP, MASKDWORD, 0x00462911); - - /* One shot, path A LOK & IQK */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("One shot, path A LOK & IQK!\n")); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_PTS, MASKDWORD, 0xf9000000); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_PTS, MASKDWORD, 0xf8000000); - - /* delay x ms */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("delay %d ms for One shot, path A LOK & IQK.\n", IQK_DELAY_TIME_88E)); - /* platform_stall_execution(IQK_DELAY_TIME_88E*1000); */ -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - RESTORE_INT(x); - ODM_delay_ms(IQK_DELAY_TIME_88E); - SAVE_INT_AND_CLI(x); -#else - ODM_delay_ms(IQK_DELAY_TIME_88E); -#endif - - /* Check failed */ - reg_eac = odm_get_bb_reg(p_dm_odm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xeac = 0x%x\n", reg_eac)); - reg_e94 = odm_get_bb_reg(p_dm_odm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe94 = 0x%x\n", reg_e94)); - reg_e9c = odm_get_bb_reg(p_dm_odm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe9c = 0x%x\n", reg_e9c)); - reg_ea4 = odm_get_bb_reg(p_dm_odm, REG_RX_POWER_BEFORE_IQK_A_2, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xea4 = 0x%x\n", reg_ea4)); - - if (!(reg_eac & BIT(28)) && - (((reg_e94 & 0x03FF0000) >> 16) != 0x142) && - (((reg_e9c & 0x03FF0000) >> 16) != 0x42)) - result |= 0x01; - /* else */ /* if Tx not OK, ignore Rx */ - /* return result; */ -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - RESTORE_INT(x); -#endif - -#if 0 - if (!(reg_eac & BIT(27)) && /* if Tx is OK, check whether Rx is OK */ - (((reg_ea4 & 0x03FF0000) >> 16) != 0x132) && - (((reg_eac & 0x03FF0000) >> 16) != 0x36)) - result |= 0x02; - else - RTPRINT(FINIT, INIT_IQK, ("path A Rx IQK fail!!\n")); -#endif - - return result; - - -} - -u8 /* bit0 = 1 => Tx OK, bit1 = 1 => Rx OK */ -phy_path_a_rx_iqk( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - bool config_path_b -) -{ - u32 reg_eac, reg_e94, reg_e9c, reg_ea4, u4tmp; - u8 result = 0x00; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -#ifndef SMP_SYNC - unsigned long x; -#endif - struct rtl8192cd_priv *priv = p_dm_odm->priv; - SAVE_INT_AND_CLI(x); -#endif - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A Rx IQK!\n")); - - /* 1 Get TXIMR setting */ - /* modify RXIQK mode table */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path-A Rx IQK modify RXIQK mode table!\n")); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0); - odm_set_rf_reg(p_dm_odm, RF_PATH_A, RF_WE_LUT, RFREGOFFSETMASK, 0x800a0); - odm_set_rf_reg(p_dm_odm, RF_PATH_A, RF_RCK_OS, RFREGOFFSETMASK, 0x30000); - odm_set_rf_reg(p_dm_odm, RF_PATH_A, RF_TXPA_G1, RFREGOFFSETMASK, 0x0000f); - odm_set_rf_reg(p_dm_odm, RF_PATH_A, RF_TXPA_G2, RFREGOFFSETMASK, 0xf117B); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x808000); - - /* IQK setting */ - odm_set_bb_reg(p_dm_odm, REG_TX_IQK, MASKDWORD, 0x01007c00); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK, MASKDWORD, 0x81004800); - - /* path-A IQK setting */ - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_TONE_A, MASKDWORD, 0x10008c1c); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_TONE_A, MASKDWORD, 0x30008c1c); - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_PI_A, MASKDWORD, 0x82160804); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_PI_A, MASKDWORD, 0x28160000); - - /* LO calibration setting */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LO calibration setting!\n")); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_RSP, MASKDWORD, 0x0046a911); - - /* One shot, path A LOK & IQK */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("One shot, path A LOK & IQK!\n")); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_PTS, MASKDWORD, 0xf9000000); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_PTS, MASKDWORD, 0xf8000000); - - /* delay x ms */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("delay %d ms for One shot, path A LOK & IQK.\n", IQK_DELAY_TIME_88E)); - /* platform_stall_execution(IQK_DELAY_TIME_88E*1000); */ -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - RESTORE_INT(x); - ODM_delay_ms(IQK_DELAY_TIME_88E); - SAVE_INT_AND_CLI(x); -#else - ODM_delay_ms(IQK_DELAY_TIME_88E); -#endif - - /* Check failed */ - reg_eac = odm_get_bb_reg(p_dm_odm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xeac = 0x%x\n", reg_eac)); - reg_e94 = odm_get_bb_reg(p_dm_odm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe94 = 0x%x\n", reg_e94)); - reg_e9c = odm_get_bb_reg(p_dm_odm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe9c = 0x%x\n", reg_e9c)); - - if (!(reg_eac & BIT(28)) && - (((reg_e94 & 0x03FF0000) >> 16) != 0x142) && - (((reg_e9c & 0x03FF0000) >> 16) != 0x42)) - result |= 0x01; - else { /* if Tx not OK, ignore Rx */ -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - RESTORE_INT(x); -#endif - return result; - } - - u4tmp = 0x80007C00 | (reg_e94 & 0x3FF0000) | ((reg_e9c & 0x3FF0000) >> 16); - odm_set_bb_reg(p_dm_odm, REG_TX_IQK, MASKDWORD, u4tmp); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe40 = 0x%x u4tmp = 0x%x\n", odm_get_bb_reg(p_dm_odm, REG_TX_IQK, MASKDWORD), u4tmp)); - - - /* 1 RX IQK */ - /* modify RXIQK mode table */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path-A Rx IQK modify RXIQK mode table 2!\n")); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0); - odm_set_rf_reg(p_dm_odm, RF_PATH_A, RF_WE_LUT, RFREGOFFSETMASK, 0x800a0); - odm_set_rf_reg(p_dm_odm, RF_PATH_A, RF_RCK_OS, RFREGOFFSETMASK, 0x30000); - odm_set_rf_reg(p_dm_odm, RF_PATH_A, RF_TXPA_G1, RFREGOFFSETMASK, 0x0000f); - odm_set_rf_reg(p_dm_odm, RF_PATH_A, RF_TXPA_G2, RFREGOFFSETMASK, 0xf7ffa); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x808000); - - /* IQK setting */ - odm_set_bb_reg(p_dm_odm, REG_RX_IQK, MASKDWORD, 0x01004800); - - /* path-A IQK setting */ - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_TONE_A, MASKDWORD, 0x30008c1c); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_TONE_A, MASKDWORD, 0x10008c1c); - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_PI_A, MASKDWORD, 0x82160c05); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_PI_A, MASKDWORD, 0x28160c05); - - /* LO calibration setting */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LO calibration setting!\n")); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_RSP, MASKDWORD, 0x0046a911); - - /* One shot, path A LOK & IQK */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("One shot, path A LOK & IQK!\n")); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_PTS, MASKDWORD, 0xf9000000); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_PTS, MASKDWORD, 0xf8000000); - - /* delay x ms */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("delay %d ms for One shot, path A LOK & IQK.\n", IQK_DELAY_TIME_88E)); - /* platform_stall_execution(IQK_DELAY_TIME_88E*1000); */ - -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - RESTORE_INT(x); - ODM_delay_ms(IQK_DELAY_TIME_88E); - SAVE_INT_AND_CLI(x); -#else - ODM_delay_ms(IQK_DELAY_TIME_88E); -#endif - - /* Check failed */ - reg_eac = odm_get_bb_reg(p_dm_odm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xeac = 0x%x\n", reg_eac)); - reg_e94 = odm_get_bb_reg(p_dm_odm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe94 = 0x%x\n", reg_e94)); - reg_e9c = odm_get_bb_reg(p_dm_odm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe9c = 0x%x\n", reg_e9c)); - reg_ea4 = odm_get_bb_reg(p_dm_odm, REG_RX_POWER_BEFORE_IQK_A_2, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xea4 = 0x%x\n", reg_ea4)); - -#if 0 - if (!(reg_eac & BIT(28)) && - (((reg_e94 & 0x03FF0000) >> 16) != 0x142) && - (((reg_e9c & 0x03FF0000) >> 16) != 0x42)) - result |= 0x01; - else /* if Tx not OK, ignore Rx */ - return result; -#endif - - if (!(reg_eac & BIT(27)) && /* if Tx is OK, check whether Rx is OK */ - (((reg_ea4 & 0x03FF0000) >> 16) != 0x132) && - (((reg_eac & 0x03FF0000) >> 16) != 0x36)) - result |= 0x02; - else - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A Rx IQK fail!!\n")); - - -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - RESTORE_INT(x); -#endif - return result; - - -} - -u8 /* bit0 = 1 => Tx OK, bit1 = 1 => Rx OK */ -phy_path_b_iqk_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm -#else - struct _ADAPTER *p_adapter -#endif -) -{ - u32 reg_eac, reg_eb4, reg_ebc, reg_ec4, reg_ecc; - u8 result = 0x00; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B IQK!\n")); - - /* One shot, path B LOK & IQK */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("One shot, path A LOK & IQK!\n")); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_CONT, MASKDWORD, 0x00000002); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_CONT, MASKDWORD, 0x00000000); - - /* delay x ms */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("delay %d ms for One shot, path B LOK & IQK.\n", IQK_DELAY_TIME_88E)); - /* platform_stall_execution(IQK_DELAY_TIME_88E*1000); */ - ODM_delay_ms(IQK_DELAY_TIME_88E); - - /* Check failed */ - reg_eac = odm_get_bb_reg(p_dm_odm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xeac = 0x%x\n", reg_eac)); - reg_eb4 = odm_get_bb_reg(p_dm_odm, REG_TX_POWER_BEFORE_IQK_B, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xeb4 = 0x%x\n", reg_eb4)); - reg_ebc = odm_get_bb_reg(p_dm_odm, REG_TX_POWER_AFTER_IQK_B, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xebc = 0x%x\n", reg_ebc)); - reg_ec4 = odm_get_bb_reg(p_dm_odm, REG_RX_POWER_BEFORE_IQK_B_2, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xec4 = 0x%x\n", reg_ec4)); - reg_ecc = odm_get_bb_reg(p_dm_odm, REG_RX_POWER_AFTER_IQK_B_2, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xecc = 0x%x\n", reg_ecc)); - - if (!(reg_eac & BIT(31)) && - (((reg_eb4 & 0x03FF0000) >> 16) != 0x142) && - (((reg_ebc & 0x03FF0000) >> 16) != 0x42)) - result |= 0x01; - else - return result; - - if (!(reg_eac & BIT(30)) && - (((reg_ec4 & 0x03FF0000) >> 16) != 0x132) && - (((reg_ecc & 0x03FF0000) >> 16) != 0x36)) - result |= 0x02; - else - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B Rx IQK fail!!\n")); - - - return result; - -} - -void -_phy_path_a_fill_iqk_matrix( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - bool is_iqk_ok, - s32 result[][8], - u8 final_candidate, - bool is_tx_only -) -{ - u32 oldval_0, X, TX0_A, reg; - s32 Y, TX0_C; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A 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_odm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKDWORD) >> 22) & 0x3FF; - - X = result[final_candidate][0]; - if ((X & 0x00000200) != 0) - X = X | 0xFFFFFC00; - TX0_A = (X * oldval_0) >> 8; - ODM_RT_TRACE(p_dm_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_set_bb_reg(p_dm_odm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, 0x3FF, TX0_A); - - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_ECCA_THRESHOLD, BIT(31), ((X * oldval_0 >> 7) & 0x1)); - - Y = result[final_candidate][1]; - if ((Y & 0x00000200) != 0) - Y = Y | 0xFFFFFC00; - - - TX0_C = (Y * oldval_0) >> 8; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Y = 0x%x, TX = 0x%x\n", Y, TX0_C)); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XC_TX_AFE, 0xF0000000, ((TX0_C & 0x3C0) >> 6)); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, 0x003F0000, (TX0_C & 0x3F)); - - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_ECCA_THRESHOLD, BIT(29), ((Y * oldval_0 >> 7) & 0x1)); - - if (is_tx_only) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_path_a_fill_iqk_matrix 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_odm, REG_OFDM_0_XA_RX_IQ_IMBALANCE, 0x3FF, reg); - - reg = result[final_candidate][3] & 0x3F; - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XA_RX_IQ_IMBALANCE, 0xFC00, reg); - - reg = (result[final_candidate][3] >> 6) & 0xF; - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_RX_IQ_EXT_ANTA, 0xF0000000, reg); - } -} - -void -_phy_path_b_fill_iqk_matrix( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - bool is_iqk_ok, - s32 result[][8], - u8 final_candidate, - bool is_tx_only /* do Tx only */ -) -{ - u32 oldval_1, X, TX1_A, reg; - s32 Y, TX1_C; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B 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_odm, REG_OFDM_0_XB_TX_IQ_IMBALANCE, MASKDWORD) >> 22) & 0x3FF; - - X = result[final_candidate][4]; - if ((X & 0x00000200) != 0) - X = X | 0xFFFFFC00; - TX1_A = (X * oldval_1) >> 8; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("X = 0x%x, TX1_A = 0x%x\n", X, TX1_A)); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XB_TX_IQ_IMBALANCE, 0x3FF, TX1_A); - - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_ECCA_THRESHOLD, BIT(27), ((X * oldval_1 >> 7) & 0x1)); - - Y = result[final_candidate][5]; - if ((Y & 0x00000200) != 0) - Y = Y | 0xFFFFFC00; - - TX1_C = (Y * oldval_1) >> 8; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Y = 0x%x, TX1_C = 0x%x\n", Y, TX1_C)); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XD_TX_AFE, 0xF0000000, ((TX1_C & 0x3C0) >> 6)); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XB_TX_IQ_IMBALANCE, 0x003F0000, (TX1_C & 0x3F)); - - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_ECCA_THRESHOLD, BIT(25), ((Y * oldval_1 >> 7) & 0x1)); - - if (is_tx_only) - return; - - reg = result[final_candidate][6]; - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XB_RX_IQ_IMBALANCE, 0x3FF, reg); - - reg = result[final_candidate][7] & 0x3F; - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XB_RX_IQ_IMBALANCE, 0xFC00, reg); - - reg = (result[final_candidate][7] >> 6) & 0xF; - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_AGC_RSSI_TABLE, 0x0000F000, reg); - } -} - -/* - * 2011/07/26 MH Add an API for testing IQK fail case. - * - * MP Already declare in odm.c */ -#if 0 /* !(DM_ODM_SUPPORT_TYPE & ODM_WIN) */ /* 0824 */ -bool -odm_check_power_status( - struct _ADAPTER *adapter) -{ -#if 0 - /* HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); */ - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; - RT_RF_POWER_STATE rt_state; - PMGNT_INFO p_mgnt_info = &(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) { - ODM_RT_TRACE(p_dm_odm, COMP_INIT, DBG_LOUD, ("odm_check_power_status Return true, due to initadapter")); - return true; - } - - /* */ - /* 2011/07/19 MH We can not execute tx pwoer tracking/ LLC calibrate or IQK. */ - /* */ - phydm_get_hw_reg_interface(p_dm_odm, HW_VAR_RF_STATE, (u8 *)(&rt_state)); - if (adapter->is_driver_stopped || adapter->is_driver_is_going_to_pnp_set_power_sleep || rt_state == eRfOff) { - ODM_RT_TRACE(p_dm_odm, COMP_INIT, DBG_LOUD, ("odm_check_power_status Return false, due to %d/%d/%d\n", - adapter->is_driver_stopped, adapter->is_driver_is_going_to_pnp_set_power_sleep, rt_state)); - return false; - } -#endif - return true; -} -#endif - -void -_phy_save_adda_registers( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - u32 *adda_reg, - u32 *adda_backup, - u32 register_num -) -{ - u32 i; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif - - if (odm_check_power_status(p_adapter) == false) - return; -#endif - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Save ADDA parameters.\n")); - for (i = 0 ; i < register_num ; i++) - adda_backup[i] = odm_get_bb_reg(p_dm_odm, adda_reg[i], MASKDWORD); -} - - -void -_phy_save_mac_registers( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - u32 *mac_reg, - u32 *mac_backup -) -{ - u32 i; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Save MAC parameters.\n")); - for (i = 0 ; i < (IQK_MAC_REG_NUM - 1); i++) - mac_backup[i] = odm_read_1byte(p_dm_odm, mac_reg[i]); - mac_backup[i] = odm_read_4byte(p_dm_odm, mac_reg[i]); - -} - - -void -_phy_reload_adda_registers( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - u32 *adda_reg, - u32 *adda_backup, - u32 regiester_num -) -{ - u32 i; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - - ODM_RT_TRACE(p_dm_odm, 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_odm, adda_reg[i], MASKDWORD, adda_backup[i]); -} - -void -_phy_reload_mac_registers( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - u32 *mac_reg, - u32 *mac_backup -) -{ - u32 i; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - ODM_RT_TRACE(p_dm_odm, 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_odm, mac_reg[i], (u8)mac_backup[i]); - odm_write_4byte(p_dm_odm, mac_reg[i], mac_backup[i]); -} - - -void -_phy_path_adda_on( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - u32 *adda_reg, - bool is_path_a_on, - bool is2T -) -{ - u32 path_on; - u32 i; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("ADDA ON.\n")); - - path_on = is_path_a_on ? 0x04db25a4 : 0x0b1b25a4; - if (false == is2T) { - path_on = 0x0bdb25a0; - odm_set_bb_reg(p_dm_odm, adda_reg[0], MASKDWORD, 0x0b1b25a0); - } else - odm_set_bb_reg(p_dm_odm, adda_reg[0], MASKDWORD, path_on); - - for (i = 1 ; i < IQK_ADDA_REG_NUM ; i++) - odm_set_bb_reg(p_dm_odm, adda_reg[i], MASKDWORD, path_on); - -} - -void -_phy_mac_setting_calibration( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - u32 *mac_reg, - u32 *mac_backup -) -{ - u32 i = 0; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("MAC settings for Calibration.\n")); - - odm_write_1byte(p_dm_odm, mac_reg[i], 0x3F); - - for (i = 1 ; i < (IQK_MAC_REG_NUM - 1); i++) - odm_write_1byte(p_dm_odm, mac_reg[i], (u8)(mac_backup[i] & (~BIT(3)))); - odm_write_1byte(p_dm_odm, mac_reg[i], (u8)(mac_backup[i] & (~BIT(5)))); - -} - -void -_phy_path_a_stand_by( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm -#else - struct _ADAPTER *p_adapter -#endif -) -{ -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path-A standby mode!\n")); - - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x0); - odm_set_bb_reg(p_dm_odm, 0x840, MASKDWORD, 0x00010000); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x808000); -} - -void -_phy_pi_mode_switch( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - bool pi_mode -) -{ - u32 mode; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BB Switch to %s mode!\n", (pi_mode ? "PI" : "SI"))); - - mode = pi_mode ? 0x01000100 : 0x01000000; - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XA_HSSI_PARAMETER1, MASKDWORD, mode); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XB_HSSI_PARAMETER1, MASKDWORD, mode); -} - -bool -phy_simularity_compare_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - s32 result[][8], - u8 c1, - u8 c2 -) -{ - u32 i, j, diff, simularity_bit_map, bound = 0; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - u8 final_candidate[2] = {0xFF, 0xFF}; /* for path A and path B */ - bool is_result = true; -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - bool is2T = IS_92C_SERIAL(p_hal_data->version_id); -#else - bool is2T = 0; -#endif - - if (is2T) - bound = 8; - else - bound = 4; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("===> IQK:phy_simularity_compare_8188e c1 %d c2 %d!!!\n", c1, c2)); - - - simularity_bit_map = 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) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK:phy_simularity_compare_8188e differnece overflow index %d compare1 0x%x compare2 0x%x!!!\n", 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, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK:phy_simularity_compare_8188e simularity_bit_map %d !!!\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 & 0x0F)) { /* path A OK */ - for (i = 0; i < 4; i++) - result[3][i] = result[c1][i]; - return false; - } else if (!(simularity_bit_map & 0xF0) && is2T) { /* path B OK */ - for (i = 4; i < 8; i++) - result[3][i] = result[c1][i]; - return false; - } else - return false; - -} - - - -void -_phy_iq_calibrate_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - s32 result[][8], - u8 t, - bool 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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - u32 i; - u8 path_aok, path_bok; - 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 - }; - - /* since 92C & 92D have the different define in IQK_BB_REG */ - 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_FPGA0_RFMOD*/ REG_CCK_0_AFE_SETTING - }; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -#ifndef SMP_SYNC - unsigned long x; -#endif - struct rtl8192cd_priv *priv = p_dm_odm->priv; - u32 retry_count = 2; -#else -#if MP_DRIVER - const u32 retry_count = 9; -#else - const u32 retry_count = 2; -#endif -#endif - - /* Note: IQ calibration must be performed after loading */ - /* PHY_REG.txt , and radio_a, radio_b.txt */ - - /* u32 bbvalue; */ - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -#ifdef MP_TEST - if (p_dm_odm->priv->pshare->rf_ft_var.mp_specific) - retry_count = 9; -#endif - SAVE_INT_AND_CLI(x); -#endif - - - if (t == 0) { - /* bbvalue = odm_get_bb_reg(p_dm_odm, REG_FPGA0_RFMOD, MASKDWORD); - * RTPRINT(FINIT, INIT_IQK, ("_phy_iq_calibrate_8188e()==>0x%08x\n",bbvalue)); */ - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQ Calibration for %s for %d times\n", (is2T ? "2T2R" : "1T1R"), t)); - - /* Save ADDA parameters, turn path A ADDA on */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_save_adda_registers(p_adapter, ADDA_REG, p_dm_odm->rf_calibrate_info.ADDA_backup, IQK_ADDA_REG_NUM); - _phy_save_mac_registers(p_adapter, IQK_MAC_REG, p_dm_odm->rf_calibrate_info.IQK_MAC_backup); - _phy_save_adda_registers(p_adapter, IQK_BB_REG_92C, p_dm_odm->rf_calibrate_info.IQK_BB_backup, IQK_BB_REG_NUM); -#else - _phy_save_adda_registers(p_dm_odm, ADDA_REG, p_dm_odm->rf_calibrate_info.ADDA_backup, IQK_ADDA_REG_NUM); - _phy_save_mac_registers(p_dm_odm, IQK_MAC_REG, p_dm_odm->rf_calibrate_info.IQK_MAC_backup); - _phy_save_adda_registers(p_dm_odm, IQK_BB_REG_92C, p_dm_odm->rf_calibrate_info.IQK_BB_backup, IQK_BB_REG_NUM); -#endif - } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQ Calibration for %s for %d times\n", (is2T ? "2T2R" : "1T1R"), t)); - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - - _phy_path_adda_on(p_adapter, ADDA_REG, true, is2T); -#else - _phy_path_adda_on(p_dm_odm, ADDA_REG, true, is2T); -#endif - - - if (t == 0) - p_dm_odm->rf_calibrate_info.is_rf_pi_enable = (u8)odm_get_bb_reg(p_dm_odm, REG_FPGA0_XA_HSSI_PARAMETER1, BIT(8)); - - if (!p_dm_odm->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(p_adapter, true); -#else - _phy_pi_mode_switch(p_dm_odm, true); -#endif - } - - /* MAC settings */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_mac_setting_calibration(p_adapter, IQK_MAC_REG, p_dm_odm->rf_calibrate_info.IQK_MAC_backup); -#else - _phy_mac_setting_calibration(p_dm_odm, IQK_MAC_REG, p_dm_odm->rf_calibrate_info.IQK_MAC_backup); -#endif - - /* BB setting */ - /* odm_set_bb_reg(p_dm_odm, REG_FPGA0_RFMOD, BIT24, 0x00); */ - odm_set_bb_reg(p_dm_odm, REG_CCK_0_AFE_SETTING, MASKDWORD, (0x0f000000 | (odm_get_bb_reg(p_dm_odm, REG_CCK_0_AFE_SETTING, MASKDWORD)))); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_TRX_PATH_ENABLE, MASKDWORD, 0x03a05600); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_TR_MUX_PAR, MASKDWORD, 0x000800e4); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XCD_RF_INTERFACE_SW, MASKDWORD, 0x22204000); - - - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XAB_RF_INTERFACE_SW, BIT(10), 0x01); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XAB_RF_INTERFACE_SW, BIT(26), 0x01); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XA_RF_INTERFACE_OE, BIT(10), 0x00); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(10), 0x00); - - - if (is2T) { - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XA_LSSI_PARAMETER, MASKDWORD, 0x00010000); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XB_LSSI_PARAMETER, MASKDWORD, 0x00010000); - } - - /* Page B init */ - /* AP or IQK */ - odm_set_bb_reg(p_dm_odm, REG_CONFIG_ANT_A, MASKDWORD, 0x0f600000); - - if (is2T) - odm_set_bb_reg(p_dm_odm, REG_CONFIG_ANT_B, MASKDWORD, 0x0f600000); - - /* IQ calibration setting */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK setting!\n")); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x808000); - odm_set_bb_reg(p_dm_odm, REG_TX_IQK, MASKDWORD, 0x01007c00); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK, MASKDWORD, 0x81004800); - -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - RESTORE_INT(x); -#endif - - for (i = 0 ; i < retry_count ; i++) { -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - path_aok = phy_path_a_iqk_8188e(p_adapter, is2T); -#else - path_aok = phy_path_a_iqk_8188e(p_dm_odm, is2T); -#endif - /* if(path_aok == 0x03){ */ - if (path_aok == 0x01) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A Tx IQK Success!!\n")); - result[t][0] = (odm_get_bb_reg(p_dm_odm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD) & 0x3FF0000) >> 16; - result[t][1] = (odm_get_bb_reg(p_dm_odm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD) & 0x3FF0000) >> 16; - break; - } -#if 0 - else if (i == (retry_count - 1) && path_aok == 0x01) { /* Tx IQK OK */ - RTPRINT(FINIT, INIT_IQK, ("path A IQK Only Tx Success!!\n")); - - result[t][0] = (odm_get_bb_reg(p_dm_odm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD) & 0x3FF0000) >> 16; - result[t][1] = (odm_get_bb_reg(p_dm_odm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD) & 0x3FF0000) >> 16; - } -#endif - } - - for (i = 0 ; i < retry_count ; i++) { -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - path_aok = phy_path_a_rx_iqk(p_adapter, is2T); -#else - path_aok = phy_path_a_rx_iqk(p_dm_odm, is2T); -#endif - if (path_aok == 0x03) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A Rx IQK Success!!\n")); - /* result[t][0] = (odm_get_bb_reg(p_dm_odm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD)&0x3FF0000)>>16; - * result[t][1] = (odm_get_bb_reg(p_dm_odm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD)&0x3FF0000)>>16; */ - result[t][2] = (odm_get_bb_reg(p_dm_odm, REG_RX_POWER_BEFORE_IQK_A_2, MASKDWORD) & 0x3FF0000) >> 16; - result[t][3] = (odm_get_bb_reg(p_dm_odm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD) & 0x3FF0000) >> 16; - break; - } else - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A Rx IQK Fail!!\n")); - } - -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - SAVE_INT_AND_CLI(x); -#endif - - if (0x00 == path_aok) - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A IQK failed!!\n")); - - if (is2T) { -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_path_a_stand_by(p_adapter); - - /* Turn path B ADDA on */ - _phy_path_adda_on(p_adapter, ADDA_REG, false, is2T); -#else - _phy_path_a_stand_by(p_dm_odm); - - /* Turn path B ADDA on */ - _phy_path_adda_on(p_dm_odm, ADDA_REG, false, is2T); -#endif - - for (i = 0 ; i < retry_count ; i++) { -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - path_bok = phy_path_b_iqk_8188e(p_adapter); -#else - path_bok = phy_path_b_iqk_8188e(p_dm_odm); -#endif - if (path_bok == 0x03) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B IQK Success!!\n")); - result[t][4] = (odm_get_bb_reg(p_dm_odm, REG_TX_POWER_BEFORE_IQK_B, MASKDWORD) & 0x3FF0000) >> 16; - result[t][5] = (odm_get_bb_reg(p_dm_odm, REG_TX_POWER_AFTER_IQK_B, MASKDWORD) & 0x3FF0000) >> 16; - result[t][6] = (odm_get_bb_reg(p_dm_odm, REG_RX_POWER_BEFORE_IQK_B_2, MASKDWORD) & 0x3FF0000) >> 16; - result[t][7] = (odm_get_bb_reg(p_dm_odm, REG_RX_POWER_AFTER_IQK_B_2, MASKDWORD) & 0x3FF0000) >> 16; - break; - } else if (i == (retry_count - 1) && path_bok == 0x01) { /* Tx IQK OK */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B Only Tx IQK Success!!\n")); - result[t][4] = (odm_get_bb_reg(p_dm_odm, REG_TX_POWER_BEFORE_IQK_B, MASKDWORD) & 0x3FF0000) >> 16; - result[t][5] = (odm_get_bb_reg(p_dm_odm, REG_TX_POWER_AFTER_IQK_B, MASKDWORD) & 0x3FF0000) >> 16; - } - } - - if (0x00 == path_bok) - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B IQK failed!!\n")); - } - - /* Back to BB mode, load original value */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK:Back to BB mode, load original value!\n")); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0); - - if (t != 0) { - if (!p_dm_odm->rf_calibrate_info.is_rf_pi_enable) { - /* Switch back BB to SI mode after finish IQ Calibration. */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_pi_mode_switch(p_adapter, false); -#else - _phy_pi_mode_switch(p_dm_odm, false); -#endif - } -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - - /* Reload ADDA power saving parameters */ - _phy_reload_adda_registers(p_adapter, ADDA_REG, p_dm_odm->rf_calibrate_info.ADDA_backup, IQK_ADDA_REG_NUM); - - /* Reload MAC parameters */ - _phy_reload_mac_registers(p_adapter, IQK_MAC_REG, p_dm_odm->rf_calibrate_info.IQK_MAC_backup); - - _phy_reload_adda_registers(p_adapter, IQK_BB_REG_92C, p_dm_odm->rf_calibrate_info.IQK_BB_backup, IQK_BB_REG_NUM); -#else - /* Reload ADDA power saving parameters */ - _phy_reload_adda_registers(p_dm_odm, ADDA_REG, p_dm_odm->rf_calibrate_info.ADDA_backup, IQK_ADDA_REG_NUM); - - /* Reload MAC parameters */ - _phy_reload_mac_registers(p_dm_odm, IQK_MAC_REG, p_dm_odm->rf_calibrate_info.IQK_MAC_backup); - - _phy_reload_adda_registers(p_dm_odm, IQK_BB_REG_92C, p_dm_odm->rf_calibrate_info.IQK_BB_backup, IQK_BB_REG_NUM); -#endif - - - /* Restore RX initial gain */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XA_LSSI_PARAMETER, MASKDWORD, 0x00032ed3); - if (is2T) - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XB_LSSI_PARAMETER, MASKDWORD, 0x00032ed3); - - /* load 0xe30 IQC default value */ - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_TONE_A, MASKDWORD, 0x01008c00); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_TONE_A, MASKDWORD, 0x01008c00); - - } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_iq_calibrate_8188e() <==\n")); - - -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - RESTORE_INT(x); -#endif - -} - - -void -_phy_lc_calibrate_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - bool is2T -) -{ - u8 tmp_reg; - u32 rf_amode = 0, rf_bmode = 0, lc_cal; -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -#ifndef SMP_SYNC - unsigned long x; -#endif - struct rtl8192cd_priv *priv = p_dm_odm->priv; - SAVE_INT_AND_CLI(x); -#endif -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - /* Check continuous TX and Packet TX */ - tmp_reg = odm_read_1byte(p_dm_odm, 0xd03); - - if ((tmp_reg & 0x70) != 0) /* Deal with contisuous TX case */ - ;/* odm_write_1byte(p_dm_odm, 0xd03, tmp_reg&0x8F); */ /* disable all continuous TX */ - else /* Deal with Packet TX case */ - odm_write_1byte(p_dm_odm, REG_TXPAUSE, 0xFF); /* block all queues */ - - if ((tmp_reg & 0x70) != 0) { - /* 1. Read original RF mode */ - /* path-A */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - rf_amode = phy_query_rf_reg(p_adapter, RF_PATH_A, RF_AC, MASK20BITS); - - /* path-B */ - if (is2T) - rf_bmode = phy_query_rf_reg(p_adapter, RF_PATH_B, RF_AC, MASK20BITS); -#else - rf_amode = odm_get_rf_reg(p_dm_odm, RF_PATH_A, RF_AC, MASK20BITS); - - /* path-B */ - if (is2T) - rf_bmode = odm_get_rf_reg(p_dm_odm, RF_PATH_B, RF_AC, MASK12BITS); -#endif - - /* 2. Set RF mode = standby mode */ - /* path-A */ - odm_set_rf_reg(p_dm_odm, RF_PATH_A, RF_AC, MASK20BITS, (rf_amode & 0x8FFFF) | 0x10000); - - /* path-B */ - if (is2T) - odm_set_rf_reg(p_dm_odm, RF_PATH_B, RF_AC, MASK20BITS, (rf_bmode & 0x8FFFF) | 0x10000); - } - - /* 3. Read RF reg18 */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - lc_cal = phy_query_rf_reg(p_adapter, RF_PATH_A, RF_CHNLBW, MASK20BITS); -#else - lc_cal = odm_get_rf_reg(p_dm_odm, RF_PATH_A, RF_CHNLBW, MASK20BITS); -#endif - - /* 4. Set LC calibration begin bit15 */ - odm_set_rf_reg(p_dm_odm, RF_PATH_A, RF_CHNLBW, MASK20BITS, lc_cal | 0x08000); - -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) - RESTORE_INT(x); - ODM_delay_ms(100); - SAVE_INT_AND_CLI(x); -#else - ODM_delay_ms(100); -#endif - - /* Restore original situation */ - if ((tmp_reg & 0x70) != 0) { /* Deal with contisuous TX case */ - /* path-A */ - /* odm_write_1byte(p_dm_odm, 0xd03, tmp_reg); */ - odm_set_rf_reg(p_dm_odm, RF_PATH_A, RF_AC, MASK20BITS, rf_amode); - - /* path-B */ - if (is2T) - odm_set_rf_reg(p_dm_odm, RF_PATH_B, RF_AC, MASK20BITS, rf_bmode); - } else /* Deal with Packet TX case */ - odm_write_1byte(p_dm_odm, REG_TXPAUSE, 0x00); -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) - RESTORE_INT(x); -#endif -} - -/* Analog Pre-distortion calibration */ -#define APK_BB_REG_NUM 8 -#define APK_CURVE_REG_NUM 4 -#define PATH_NUM 2 - -void -_phy_ap_calibrate_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - s8 delta, - bool 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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - u32 reg_d[PATH_NUM]; - u32 tmp_reg, index, offset, apkbound; - u8 path, i, pathbound = PATH_NUM; - u32 BB_backup[APK_BB_REG_NUM]; - u32 BB_REG[APK_BB_REG_NUM] = { - REG_FPGA1_TX_BLOCK, REG_OFDM_0_TRX_PATH_ENABLE, - REG_FPGA0_RFMOD, REG_OFDM_0_TR_MUX_PAR, - REG_FPGA0_XCD_RF_INTERFACE_SW, REG_FPGA0_XAB_RF_INTERFACE_SW, - REG_FPGA0_XA_RF_INTERFACE_OE, REG_FPGA0_XB_RF_INTERFACE_OE - }; - u32 BB_AP_MODE[APK_BB_REG_NUM] = { - 0x00000020, 0x00a05430, 0x02040000, - 0x000800e4, 0x00204000 - }; - u32 BB_normal_AP_MODE[APK_BB_REG_NUM] = { - 0x00000020, 0x00a05430, 0x02040000, - 0x000800e4, 0x22204000 - }; - - u32 AFE_backup[IQK_ADDA_REG_NUM]; - u32 AFE_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 MAC_backup[IQK_MAC_REG_NUM]; - u32 MAC_REG[IQK_MAC_REG_NUM] = { - REG_TXPAUSE, REG_BCN_CTRL, - REG_BCN_CTRL_1, REG_GPIO_MUXCFG - }; - - u32 APK_RF_init_value[PATH_NUM][APK_BB_REG_NUM] = { - {0x0852c, 0x1852c, 0x5852c, 0x1852c, 0x5852c}, - {0x2852e, 0x0852e, 0x3852e, 0x0852e, 0x0852e} - }; - - u32 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} - }; - - u32 APK_RF_value_0[PATH_NUM][APK_BB_REG_NUM] = { - {0x52019, 0x52014, 0x52013, 0x5200f, 0x5208d}, - {0x5201a, 0x52019, 0x52016, 0x52033, 0x52050} - }; - - u32 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} - }; - - u32 AFE_on_off[PATH_NUM] = { - 0x04db25a4, 0x0b1b25a4 - }; /* path A on path B off / path A off path B on */ - - u32 APK_offset[PATH_NUM] = { - REG_CONFIG_ANT_A, REG_CONFIG_ANT_B - }; - - u32 APK_normal_offset[PATH_NUM] = { - REG_CONFIG_PMPD_ANT_A, REG_CONFIG_PMPD_ANT_B - }; - - u32 APK_value[PATH_NUM] = { - 0x92fc0000, 0x12fc0000 - }; - - u32 APK_normal_value[PATH_NUM] = { - 0x92680000, 0x12680000 - }; - - s8 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} - }; - - u32 APK_normal_setting_value_1[13] = { - 0x01017018, 0xf7ed8f84, 0x1b1a1816, 0x2522201e, 0x322e2b28, - 0x433f3a36, 0x5b544e49, 0x7b726a62, 0xa69a8f84, 0xdfcfc0b3, - 0x12680000, 0x00880000, 0x00880000 - }; - - u32 APK_normal_setting_value_2[16] = { - 0x01c7021d, 0x01670183, 0x01000123, 0x00bf00e2, 0x008d00a3, - 0x0068007b, 0x004d0059, 0x003a0042, 0x002b0031, 0x001f0025, - 0x0017001b, 0x00110014, 0x000c000f, 0x0009000b, 0x00070008, - 0x00050006 - }; - - u32 APK_result[PATH_NUM][APK_BB_REG_NUM]; /* val_1_1a, val_1_2a, val_2a, val_3a, val_4a - * u32 AP_curve[PATH_NUM][APK_CURVE_REG_NUM]; */ - - s32 BB_offset, delta_V, delta_offset; - -#if MP_DRIVER == 1 -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - PMPT_CONTEXT p_mpt_ctx = &(p_adapter->mppriv.mpt_ctx); -#else - PMPT_CONTEXT p_mpt_ctx = &(p_adapter->mpt_ctx); -#endif - p_mpt_ctx->APK_bound[0] = 45; - p_mpt_ctx->APK_bound[1] = 52; - -#endif - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("==>_phy_ap_calibrate_8188e() delta %d\n", delta)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("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] = odm_get_bb_reg(p_dm_odm, BB_REG[index], MASKDWORD); - } - - /* save MAC default value */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_save_mac_registers(p_adapter, MAC_REG, MAC_backup); - - /* save AFE default value */ - _phy_save_adda_registers(p_adapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -#else - _phy_save_mac_registers(p_dm_odm, MAC_REG, MAC_backup); - - /* save AFE default value */ - _phy_save_adda_registers(p_dm_odm, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -#endif - - for (path = 0; path < pathbound; path++) { - - - if (path == RF_PATH_A) { - /* path A APK */ - /* load APK setting */ - /* path-A */ - offset = REG_PDP_ANT_A; - for (index = 0; index < 11; index++) { - odm_set_bb_reg(p_dm_odm, offset, MASKDWORD, APK_normal_setting_value_1[index]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0x%x value 0x%x\n", offset, odm_get_bb_reg(p_dm_odm, offset, MASKDWORD))); - - offset += 0x04; - } - - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x12680000); - - offset = REG_CONFIG_ANT_A; - for (; index < 13; index++) { - odm_set_bb_reg(p_dm_odm, offset, MASKDWORD, APK_normal_setting_value_1[index]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0x%x value 0x%x\n", offset, odm_get_bb_reg(p_dm_odm, offset, MASKDWORD))); - - offset += 0x04; - } - - /* page-B1 */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x400000); - - /* path A */ - offset = REG_PDP_ANT_A; - for (index = 0; index < 16; index++) { - odm_set_bb_reg(p_dm_odm, offset, MASKDWORD, APK_normal_setting_value_2[index]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0x%x value 0x%x\n", offset, odm_get_bb_reg(p_dm_odm, offset, MASKDWORD))); - - offset += 0x04; - } - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0); - } else if (path == RF_PATH_B) { - /* path B APK */ - /* load APK setting */ - /* path-B */ - offset = REG_PDP_ANT_B; - for (index = 0; index < 10; index++) { - odm_set_bb_reg(p_dm_odm, offset, MASKDWORD, APK_normal_setting_value_1[index]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0x%x value 0x%x\n", offset, odm_get_bb_reg(p_dm_odm, offset, MASKDWORD))); - - offset += 0x04; - } - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_A, MASKDWORD, 0x12680000); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x12680000); - - offset = REG_CONFIG_ANT_A; - index = 11; - for (; index < 13; index++) { /* offset 0xb68, 0xb6c */ - odm_set_bb_reg(p_dm_odm, offset, MASKDWORD, APK_normal_setting_value_1[index]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0x%x value 0x%x\n", offset, odm_get_bb_reg(p_dm_odm, offset, MASKDWORD))); - - offset += 0x04; - } - - /* page-B1 */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x400000); - - /* path B */ - offset = 0xb60; - for (index = 0; index < 16; index++) { - odm_set_bb_reg(p_dm_odm, offset, MASKDWORD, APK_normal_setting_value_2[index]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0x%x value 0x%x\n", offset, odm_get_bb_reg(p_dm_odm, offset, MASKDWORD))); - - offset += 0x04; - } - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0); - } - - /* save RF default value */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - reg_d[path] = phy_query_rf_reg(p_adapter, path, RF_TXBIAS_A, MASKDWORD); -#else - reg_d[path] = odm_get_rf_reg(p_dm_odm, path, RF_TXBIAS_A, MASKDWORD); -#endif - - /* path A AFE all on, path B AFE All off or vise versa */ - for (index = 0; index < IQK_ADDA_REG_NUM ; index++) - odm_set_bb_reg(p_dm_odm, AFE_REG[index], MASKDWORD, AFE_on_off[path]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0xe70 %x\n", odm_get_bb_reg(p_dm_odm, REG_RX_WAIT_CCA, MASKDWORD))); - - /* 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) - odm_set_bb_reg(p_dm_odm, BB_REG[index], MASKDWORD, BB_AP_MODE[index]); - else if (BB_REG[index] == 0x870) - odm_set_bb_reg(p_dm_odm, BB_REG[index], MASKDWORD, BB_backup[index] | BIT(10) | BIT(26)); - else - odm_set_bb_reg(p_dm_odm, BB_REG[index], BIT(10), 0x0); - } - - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_TONE_A, MASKDWORD, 0x01008c00); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_TONE_A, MASKDWORD, 0x01008c00); - } else { /* path B */ - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_TONE_B, MASKDWORD, 0x01008c00); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_TONE_B, MASKDWORD, 0x01008c00); - - } - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0x800 %x\n", odm_get_bb_reg(p_dm_odm, 0x800, MASKDWORD))); - - /* MAC settings */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_mac_setting_calibration(p_adapter, MAC_REG, MAC_backup); -#else - _phy_mac_setting_calibration(p_dm_odm, MAC_REG, MAC_backup); -#endif - - if (path == RF_PATH_A) /* path B to standby mode */ - odm_set_rf_reg(p_dm_odm, RF_PATH_B, RF_AC, MASKDWORD, 0x10000); - else { /* path A to standby mode */ - odm_set_rf_reg(p_dm_odm, RF_PATH_A, RF_AC, MASKDWORD, 0x10000); - odm_set_rf_reg(p_dm_odm, RF_PATH_A, RF_MODE1, MASKDWORD, 0x1000f); - odm_set_rf_reg(p_dm_odm, RF_PATH_A, RF_MODE2, MASKDWORD, 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; - - tmp_reg = APK_RF_init_value[path][index]; -#if 1 - if (!p_dm_odm->rf_calibrate_info.is_apk_thermal_meter_ignore) { - BB_offset = (tmp_reg & 0xF0000) >> 16; - - if (!(tmp_reg & BIT(15))) /* sign bit 0 */ - BB_offset = -BB_offset; - - delta_V = APK_delta_mapping[index][delta_offset]; - - BB_offset += delta_V; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() APK index %d tmp_reg 0x%x delta_V %d delta_offset %d\n", index, tmp_reg, delta_V, delta_offset)); - - if (BB_offset < 0) { - tmp_reg = tmp_reg & (~BIT(15)); - BB_offset = -BB_offset; - } else - tmp_reg = tmp_reg | BIT(15); - tmp_reg = (tmp_reg & 0xFFF0FFFF) | (BB_offset << 16); - } -#endif - - odm_set_rf_reg(p_dm_odm, path, RF_IPA_A, MASKDWORD, 0x8992e); -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0xc %x\n", phy_query_rf_reg(p_adapter, path, RF_IPA_A, MASKDWORD))); - odm_set_rf_reg(p_dm_odm, path, RF_AC, MASKDWORD, APK_RF_value_0[path][index]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0x0 %x\n", phy_query_rf_reg(p_adapter, path, RF_AC, MASKDWORD))); - odm_set_rf_reg(p_dm_odm, path, RF_TXBIAS_A, MASKDWORD, tmp_reg); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0xd %x\n", phy_query_rf_reg(p_adapter, path, RF_TXBIAS_A, MASKDWORD))); -#else - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0xc %x\n", odm_get_rf_reg(p_dm_odm, path, RF_IPA_A, MASKDWORD))); - odm_set_rf_reg(p_dm_odm, path, RF_AC, MASKDWORD, APK_RF_value_0[path][index]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0x0 %x\n", odm_get_rf_reg(p_dm_odm, path, RF_AC, MASKDWORD))); - odm_set_rf_reg(p_dm_odm, path, RF_TXBIAS_A, MASKDWORD, tmp_reg); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0xd %x\n", odm_get_rf_reg(p_dm_odm, path, RF_TXBIAS_A, MASKDWORD))); -#endif - - /* PA11+PAD01111, one shot */ - i = 0; - do { - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x800000); - { - odm_set_bb_reg(p_dm_odm, APK_offset[path], MASKDWORD, APK_value[0]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0x%x value 0x%x\n", APK_offset[path], odm_get_bb_reg(p_dm_odm, APK_offset[path], MASKDWORD))); - ODM_delay_ms(3); - odm_set_bb_reg(p_dm_odm, APK_offset[path], MASKDWORD, APK_value[1]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0x%x value 0x%x\n", APK_offset[path], odm_get_bb_reg(p_dm_odm, APK_offset[path], MASKDWORD))); - - ODM_delay_ms(20); - } - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0); - - if (path == RF_PATH_A) - tmp_reg = odm_get_bb_reg(p_dm_odm, REG_APK, 0x03E00000); - else - tmp_reg = odm_get_bb_reg(p_dm_odm, REG_APK, 0xF8000000); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0xbd8[25:21] %x\n", tmp_reg)); - - - i++; - } while (tmp_reg > apkbound && i < 4); - - APK_result[path][index] = tmp_reg; - } - } - - /* reload MAC default value */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_reload_mac_registers(p_adapter, MAC_REG, MAC_backup); -#else - _phy_reload_mac_registers(p_dm_odm, MAC_REG, MAC_backup); -#endif - - /* reload BB default value */ - for (index = 0; index < APK_BB_REG_NUM ; index++) { - - if (index == 0) /* skip */ - continue; - odm_set_bb_reg(p_dm_odm, BB_REG[index], MASKDWORD, BB_backup[index]); - } - - /* reload AFE default value */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_reload_adda_registers(p_adapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -#else - _phy_reload_adda_registers(p_dm_odm, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -#endif - - /* reload RF path default value */ - for (path = 0; path < pathbound; path++) { - odm_set_rf_reg(p_dm_odm, path, 0xd, MASKDWORD, reg_d[path]); - if (path == RF_PATH_B) { - odm_set_rf_reg(p_dm_odm, RF_PATH_A, RF_MODE1, MASKDWORD, 0x1000f); - odm_set_rf_reg(p_dm_odm, RF_PATH_A, RF_MODE2, MASKDWORD, 0x20101); - } - - /* note no index == 0 */ - if (APK_result[path][1] > 6) - APK_result[path][1] = 6; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("apk path %d result %d 0x%x \t", path, 1, APK_result[path][1])); - } - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("\n")); - - - for (path = 0; path < pathbound; path++) { - odm_set_rf_reg(p_dm_odm, path, 0x3, MASKDWORD, - ((APK_result[path][1] << 15) | (APK_result[path][1] << 10) | (APK_result[path][1] << 5) | APK_result[path][1])); - if (path == RF_PATH_A) - odm_set_rf_reg(p_dm_odm, path, 0x4, MASKDWORD, - ((APK_result[path][1] << 15) | (APK_result[path][1] << 10) | (0x00 << 5) | 0x05)); - else - odm_set_rf_reg(p_dm_odm, path, 0x4, MASKDWORD, - ((APK_result[path][1] << 15) | (APK_result[path][1] << 10) | (0x02 << 5) | 0x05)); -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - odm_set_rf_reg(p_dm_odm, path, RF_BS_PA_APSET_G9_G11, MASKDWORD, - ((0x08 << 15) | (0x08 << 10) | (0x08 << 5) | 0x08)); -#endif - } - - p_dm_odm->rf_calibrate_info.is_ap_kdone = true; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<==_phy_ap_calibrate_8188e()\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_iq_calibrate_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - bool is_recovery -) -{ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#else /* (DM_ODM_SUPPORT_TYPE == ODM_CE) */ - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->odmpriv; -#endif - -#if (MP_DRIVER == 1) -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PMPT_CONTEXT p_mpt_ctx = &(p_adapter->mpt_ctx); -#else/* (DM_ODM_SUPPORT_TYPE == ODM_CE) */ - PMPT_CONTEXT p_mpt_ctx = &(p_adapter->mppriv.mpt_ctx); -#endif -#endif/* (MP_DRIVER == 1) */ -#endif - - s32 result[4][8]; /* last is final result */ - u8 i, final_candidate, indexforchannel; - /* u8 channel_to_iqk = 7; */ - bool is_patha_ok, is_pathb_ok; - s32 rege94, rege9c, regea4, regeac, regeb4, regebc, regec4, regecc, reg_tmp = 0; - bool is12simular, is13simular, is23simular; - bool /*is_start_cont_tx = false,*/ is_single_tone = false, is_carrier_suppression = false; - 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 - }; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - if (odm_check_power_status(p_adapter) == false) - return; -#else -#ifndef SMP_SYNC - unsigned long x; -#endif - struct rtl8192cd_priv *priv = p_dm_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) - is_recovery = 1; - priv->pshare->IQK_88E_done = 1; - -#endif - -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_AP)) - if (!(p_dm_odm->support_ability & ODM_RF_CALIBRATION)) - return; -#endif - -#if MP_DRIVER == 1 - /* is_start_cont_tx = p_mpt_ctx->is_start_cont_tx; */ - is_single_tone = p_mpt_ctx->is_single_tone; - is_carrier_suppression = p_mpt_ctx->is_carrier_suppression; -#endif - - /* 20120213 Turn on when continuous Tx to pass lab testing. (required by Edlu) */ - if (is_single_tone || is_carrier_suppression) - return; - -#ifdef DISABLE_BB_RF - return; -#endif - -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_AP)) - if (is_recovery) -#else/* for ODM_WIN */ - if (is_recovery && (!p_adapter->is_in_hct_test)) /* YJ,add for PowerTest,120405 */ -#endif - { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("phy_iq_calibrate_8188e: Return due to is_recovery!\n")); -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_reload_adda_registers(p_adapter, IQK_BB_REG_92C, p_dm_odm->rf_calibrate_info.IQK_BB_backup_recover, 9); -#else - _phy_reload_adda_registers(p_dm_odm, IQK_BB_REG_92C, p_dm_odm->rf_calibrate_info.IQK_BB_backup_recover, 9); -#endif - return; - } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK:Start!!!\n")); - priv->pshare->IQK_total_cnt++; -#if 0/* Suggested by Edlu,120413 */ - - /* IQK on channel 7, should switch back when completed. */ - /* origin_channel = p_hal_data->current_channel; */ - origin_channel = *(p_dm_odm->p_channel); - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - p_adapter->hal_func.sw_chnl_by_timer_handler(p_adapter, channel_to_iqk); -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - p_adapter->hal_func.set_channel_handler(p_adapter, channel_to_iqk); -#endif - -#endif - - 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_patha_ok = false; - is_pathb_ok = false; - is12simular = false; - is23simular = false; - is13simular = false; - - - for (i = 0; i < 3; i++) { -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - - if (IS_92C_SERIAL(p_hal_data->version_id)) - _phy_iq_calibrate_8188e(p_adapter, result, i, true); - else -#endif - { - /* For 88C 1T1R */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_iq_calibrate_8188e(p_adapter, result, i, false); -#else - _phy_iq_calibrate_8188e(p_dm_odm, result, i, false); -#endif - } - - if (i == 1) { -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - is12simular = phy_simularity_compare_8188e(p_adapter, result, 0, 1); -#else - is12simular = phy_simularity_compare_8188e(p_dm_odm, result, 0, 1); -#endif - if (is12simular) { - final_candidate = 0; - ODM_RT_TRACE(p_dm_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_simularity_compare_8188e(p_adapter, result, 0, 2); -#else - is13simular = phy_simularity_compare_8188e(p_dm_odm, result, 0, 2); -#endif - if (is13simular) { - final_candidate = 0; - ODM_RT_TRACE(p_dm_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_simularity_compare_8188e(p_adapter, result, 1, 2); -#else - is23simular = phy_simularity_compare_8188e(p_dm_odm, result, 1, 2); -#endif - if (is23simular) { - final_candidate = 1; - ODM_RT_TRACE(p_dm_odm, 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; - } - } - } - /* RT_TRACE(COMP_INIT,DBG_LOUD,("Release Mutex in IQCalibrate\n")); */ - -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) - SAVE_INT_AND_CLI(x); -#endif - - 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]; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("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) { - p_dm_odm->rf_calibrate_info.rege94 = rege94 = result[final_candidate][0]; - p_dm_odm->rf_calibrate_info.rege9c = rege9c = result[final_candidate][1]; - regea4 = result[final_candidate][2]; - regeac = result[final_candidate][3]; - p_dm_odm->rf_calibrate_info.regeb4 = regeb4 = result[final_candidate][4]; - p_dm_odm->rf_calibrate_info.regebc = regebc = result[final_candidate][5]; - regec4 = result[final_candidate][6]; - regecc = result[final_candidate][7]; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK: final_candidate is %x\n", final_candidate)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("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)); - is_patha_ok = is_pathb_ok = true; - } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK: FAIL use default value\n")); - - p_dm_odm->rf_calibrate_info.rege94 = p_dm_odm->rf_calibrate_info.regeb4 = 0x100; /* X default value */ - p_dm_odm->rf_calibrate_info.rege9c = p_dm_odm->rf_calibrate_info.regebc = 0x0; /* Y default value */ - priv->pshare->IQK_fail_cnt++; - } - - if ((rege94 != 0)/*&&(regea4 != 0)*/) { -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_path_a_fill_iqk_matrix(p_adapter, is_patha_ok, result, final_candidate, (regea4 == 0)); -#else - _phy_path_a_fill_iqk_matrix(p_dm_odm, is_patha_ok, result, final_candidate, (regea4 == 0)); -#endif - } - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - if (IS_92C_SERIAL(p_hal_data->version_id)) { - if ((regeb4 != 0)/*&&(regec4 != 0)*/) - _phy_path_b_fill_iqk_matrix(p_adapter, is_pathb_ok, result, final_candidate, (regec4 == 0)); - } -#endif - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - indexforchannel = odm_get_right_chnl_place_for_iqk(*p_dm_odm->p_channel); -#else - indexforchannel = 0; -#endif - - /* To Fix BSOD when final_candidate is 0xff - * by sherry 20120321 */ - if (final_candidate < 4) { - for (i = 0; i < iqk_matrix_reg_num; i++) - p_dm_odm->rf_calibrate_info.iqk_matrix_reg_setting[indexforchannel].value[0][i] = result[final_candidate][i]; - p_dm_odm->rf_calibrate_info.iqk_matrix_reg_setting[indexforchannel].is_iqk_done = true; - } - /* RTPRINT(FINIT, INIT_IQK, ("\nIQK OK indexforchannel %d.\n", indexforchannel)); */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("\nIQK OK indexforchannel %d.\n", indexforchannel)); -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - - _phy_save_adda_registers(p_adapter, IQK_BB_REG_92C, p_dm_odm->rf_calibrate_info.IQK_BB_backup_recover, 9); -#else - _phy_save_adda_registers(p_dm_odm, IQK_BB_REG_92C, p_dm_odm->rf_calibrate_info.IQK_BB_backup_recover, IQK_BB_REG_NUM); -#endif - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK finished\n")); -#if 0 /* Suggested by Edlu,120413 */ - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - p_adapter->hal_func.sw_chnl_by_timer_handler(p_adapter, origin_channel); -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - p_adapter->hal_func.set_channel_handler(p_adapter, origin_channel); -#endif - -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) - RESTORE_INT(x); -#endif - -} - - -void -phy_lc_calibrate_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm -#else - struct _ADAPTER *p_adapter -#endif -) -{ - bool /*is_start_cont_tx = false,*/ is_single_tone = false, is_carrier_suppression = false; - u32 timeout = 2000, timecount = 0; - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#else /* (DM_ODM_SUPPORT_TYPE == ODM_CE) */ - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->odmpriv; -#endif - -#if (MP_DRIVER == 1) -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PMPT_CONTEXT p_mpt_ctx = &(p_adapter->mpt_ctx); -#else/* (DM_ODM_SUPPORT_TYPE == ODM_CE) */ - PMPT_CONTEXT p_mpt_ctx = &(p_adapter->mppriv.mpt_ctx); -#endif -#endif/* (MP_DRIVER == 1) */ -#endif - - - - -#if MP_DRIVER == 1 - /* is_start_cont_tx = p_mpt_ctx->is_start_cont_tx; */ - is_single_tone = p_mpt_ctx->is_single_tone; - is_carrier_suppression = p_mpt_ctx->is_carrier_suppression; -#endif - - -#ifdef DISABLE_BB_RF - return; -#endif - -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_AP)) - if (!(p_dm_odm->support_ability & ODM_RF_CALIBRATION)) - return; -#endif - /* 20120213 Turn on when continuous Tx to pass lab testing. (required by Edlu) */ - if (is_single_tone || is_carrier_suppression) - return; - - while (*(p_dm_odm->p_is_scan_in_process) && timecount < timeout) { - ODM_delay_ms(50); - timecount += 50; - } - - p_dm_odm->rf_calibrate_info.is_lck_in_progress = true; - - /* ODM_RT_TRACE(p_dm_odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LCK:Start!!!interface %d currentband %x delay %d ms\n", p_dm_odm->interface_index, p_hal_data->CurrentBandType92D, timecount)); */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - - if (IS_2T2R(p_hal_data->version_id)) - _phy_lc_calibrate_8188e(p_adapter, true); - else -#endif - { - /* For 88C 1T1R */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_lc_calibrate_8188e(p_adapter, false); -#else - _phy_lc_calibrate_8188e(p_dm_odm, false); -#endif - } - - p_dm_odm->rf_calibrate_info.is_lck_in_progress = false; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LCK:Finish!!!interface %d\n", p_dm_odm->interface_index)); - -} - -void -phy_ap_calibrate_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - s8 delta -) -{ -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif -#ifdef DISABLE_BB_RF - return; -#endif - -#if 0 -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_AP)) - if (!(p_dm_odm->support_ability & ODM_RF_CALIBRATION)) - return; -#endif - -#if FOR_BRAZIL_PRETEST != 1 - if (p_dm_odm->rf_calibrate_info.is_ap_kdone) -#endif - return; - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - if (IS_92C_SERIAL(p_hal_data->version_id)) - _phy_ap_calibrate_8188e(p_adapter, delta, true); - else -#endif - { - /* For 88C 1T1R */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_ap_calibrate_8188e(p_adapter, delta, false); -#else - _phy_ap_calibrate_8188e(p_dm_odm, delta, false); -#endif - } -#endif -} -void _phy_set_rf_path_switch_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - bool is_main, - bool 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_odm = &p_hal_data->odmpriv; -#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - if (!p_adapter->bHWInitReady) -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - if (p_adapter->hw_init_completed == _FALSE) -#endif - { - u8 u1b_tmp; - u1b_tmp = odm_read_1byte(p_dm_odm, REG_LEDCFG2) | BIT(7); - odm_write_1byte(p_dm_odm, REG_LEDCFG2, u1b_tmp); - /* odm_set_bb_reg(p_dm_odm, REG_LEDCFG0, BIT23, 0x01); */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XAB_RF_PARAMETER, BIT(13), 0x01); - } - -#endif - - if (is2T) { /* 92C */ - if (is_main) - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(5) | BIT6, 0x1); /* 92C_Path_A */ - else - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(5) | BIT6, 0x2); /* BT */ - } else { /* 88C */ - - /* <20120504, Kordan> [8188E] We should make AntDiversity controlled by HW (0x870[9:8] = 0), */ - /* otherwise the following action has no effect. (0x860[9:8] has the effect only if AntDiversity controlled by SW) */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XAB_RF_INTERFACE_SW, BIT(8) | BIT(9), 0x0); - odm_set_bb_reg(p_dm_odm, 0x914, MASKLWORD, 0x0201); /* Set up the ant mapping table */ - - if (is_main) { - /* odm_set_bb_reg(p_dm_odm, REG_FPGA0_XA_RF_INTERFACE_OE, BIT(8)|BIT9, 0x2); */ /* Tx Main (SW control)(The right antenna) */ - /* 4 [ Tx ] */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XA_RF_INTERFACE_OE, BIT(14) | BIT13 | BIT12, 0x1); /* Tx Main (HW control)(The right antenna) */ - - /* 4 [ Rx ] */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(5) | BIT4 | BIT3, 0x1); /* ant_div_type = TRDiv, right antenna */ - if (p_dm_odm->ant_div_type == CGCS_RX_HW_ANTDIV) - odm_set_bb_reg(p_dm_odm, REG_CONFIG_RAM64X16, BIT(31), 0x1); /* RxCG, Default is RxCG. ant_div_type = 2RDiv, left antenna */ - - } else { - /* odm_set_bb_reg(p_dm_odm, REG_FPGA0_XA_RF_INTERFACE_OE, BIT(8)|BIT9, 0x1); */ /* Tx Aux (SW control)(The left antenna) */ - /* 4 [ Tx ] */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XA_RF_INTERFACE_OE, BIT(14) | BIT13 | BIT12, 0x0); /* Tx Aux (HW control)(The left antenna) */ - - /* 4 [ Rx ] */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(5) | BIT4 | BIT3, 0x0); /* ant_div_type = TRDiv, left antenna */ - if (p_dm_odm->ant_div_type == CGCS_RX_HW_ANTDIV) - odm_set_bb_reg(p_dm_odm, REG_CONFIG_RAM64X16, BIT(31), 0x0); /* RxCS, ant_div_type = 2RDiv, right antenna */ - } - - } -} -void phy_set_rf_path_switch_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - bool is_main -) -{ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); -#endif - -#ifdef DISABLE_BB_RF - return; -#endif - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - if (IS_92C_SERIAL(p_hal_data->version_id)) - _phy_set_rf_path_switch_8188e(p_adapter, is_main, true); - else -#endif - { - /* For 88C 1T1R */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_set_rf_path_switch_8188e(p_adapter, is_main, false); -#else - _phy_set_rf_path_switch_8188e(p_dm_odm, is_main, false); -#endif - } -} - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -/* digital predistortion */ -void -phy_digital_predistortion( -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - struct _ADAPTER *p_adapter, -#else - struct PHY_DM_STRUCT *p_dm_odm, -#endif - bool is2T -) -{ -#if (RT_PLATFORM == PLATFORM_WINDOWS) -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - - u32 tmp_reg, tmp_reg2, index, i; - u8 path, pathbound = PATH_NUM; - u32 AFE_backup[IQK_ADDA_REG_NUM]; - u32 AFE_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 BB_backup[DP_BB_REG_NUM]; - u32 BB_REG[DP_BB_REG_NUM] = { - REG_OFDM_0_TRX_PATH_ENABLE, REG_FPGA0_RFMOD, - REG_OFDM_0_TR_MUX_PAR, REG_FPGA0_XCD_RF_INTERFACE_SW, - REG_FPGA0_XAB_RF_INTERFACE_SW, REG_FPGA0_XA_RF_INTERFACE_OE, - REG_FPGA0_XB_RF_INTERFACE_OE - }; - u32 BB_settings[DP_BB_REG_NUM] = { - 0x00a05430, 0x02040000, 0x000800e4, 0x22208000, - 0x0, 0x0, 0x0 - }; - - u32 RF_backup[DP_PATH_NUM][DP_RF_REG_NUM]; - u32 RF_REG[DP_RF_REG_NUM] = { - RF_TXBIAS_A - }; - - u32 MAC_backup[IQK_MAC_REG_NUM]; - u32 MAC_REG[IQK_MAC_REG_NUM] = { - REG_TXPAUSE, REG_BCN_CTRL, - REG_BCN_CTRL_1, REG_GPIO_MUXCFG - }; - - u32 tx_agc[DP_DPK_NUM][DP_DPK_VALUE_NUM] = { - {0x1e1e1e1e, 0x03901e1e}, - {0x18181818, 0x03901818}, - {0x0e0e0e0e, 0x03900e0e} - }; - - u32 AFE_on_off[PATH_NUM] = { - 0x04db25a4, 0x0b1b25a4 - }; /* path A on path B off / path A off path B on */ - - u8 retry_count = 0; - - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("==>phy_digital_predistortion()\n")); - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_digital_predistortion for %s %s\n", (is2T ? "2T2R" : "1T1R"))); - - /* save BB default value */ - for (index = 0; index < DP_BB_REG_NUM; index++) - BB_backup[index] = odm_get_bb_reg(p_dm_odm, BB_REG[index], MASKDWORD); - - /* save MAC default value */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_save_mac_registers(p_adapter, BB_REG, MAC_backup); -#else - _phy_save_mac_registers(p_dm_odm, BB_REG, MAC_backup); -#endif - - /* save RF default value */ - 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_query_rf_reg(p_adapter, path, RF_REG[index], MASKDWORD); -#else - RF_backup[path][index] = odm_get_rf_reg(p_adapter, path, RF_REG[index], MASKDWORD); -#endif - } - - /* save AFE default value */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_save_adda_registers(p_adapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -#else - _phy_save_adda_registers(p_dm_odm, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -#endif - - /* path A/B AFE all on */ - for (index = 0; index < IQK_ADDA_REG_NUM ; index++) - odm_set_bb_reg(p_dm_odm, AFE_REG[index], MASKDWORD, 0x6fdb25a4); - - /* BB register setting */ - for (index = 0; index < DP_BB_REG_NUM; index++) { - if (index < 4) - odm_set_bb_reg(p_dm_odm, BB_REG[index], MASKDWORD, BB_settings[index]); - else if (index == 4) - odm_set_bb_reg(p_dm_odm, BB_REG[index], MASKDWORD, BB_backup[index] | BIT(10) | BIT(26)); - else - odm_set_bb_reg(p_dm_odm, BB_REG[index], BIT(10), 0x00); - } - - /* MAC register setting */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_mac_setting_calibration(p_adapter, MAC_REG, MAC_backup); -#else - _phy_mac_setting_calibration(p_dm_odm, MAC_REG, MAC_backup); -#endif - - /* PAGE-E IQC setting */ - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_TONE_A, MASKDWORD, 0x01008c00); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_TONE_A, MASKDWORD, 0x01008c00); - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_TONE_B, MASKDWORD, 0x01008c00); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_TONE_B, MASKDWORD, 0x01008c00); - - /* path_A DPK */ - /* path B to standby mode */ - odm_set_rf_reg(p_dm_odm, RF_PATH_B, RF_AC, MASKDWORD, 0x10000); - - /* PA gain = 11 & PAD1 => tx_agc 1f ~11 */ - /* PA gain = 11 & PAD2 => tx_agc 10~0e */ - /* PA gain = 01 => tx_agc 0b~0d */ - /* PA gain = 00 => tx_agc 0a~00 */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x400000); - odm_set_bb_reg(p_dm_odm, 0xbc0, MASKDWORD, 0x0005361f); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0); - - /* do inner loopback DPK 3 times */ - for (i = 0; i < 3; i++) { - /* PA gain = 11 & PAD2 => tx_agc = 0x0f/0x0c/0x07 */ - for (index = 0; index < 3; index++) - odm_set_bb_reg(p_dm_odm, 0xe00 + index * 4, MASKDWORD, tx_agc[i][0]); - odm_set_bb_reg(p_dm_odm, 0xe00 + index * 4, MASKDWORD, tx_agc[i][1]); - for (index = 0; index < 4; index++) - odm_set_bb_reg(p_dm_odm, 0xe10 + index * 4, MASKDWORD, tx_agc[i][0]); - - /* PAGE_B for path-A inner loopback DPK setting */ - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_A, MASKDWORD, 0x02097098); - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_A_4, MASKDWORD, 0xf76d9f84); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_A, MASKDWORD, 0x0004ab87); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_ANT_A, MASKDWORD, 0x00880000); - - /* ----send one shot signal---- */ - /* path A */ - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_A, MASKDWORD, 0x80047788); - ODM_delay_ms(1); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_A, MASKDWORD, 0x00047788); - ODM_delay_ms(50); - } - - /* PA gain = 11 => tx_agc = 1a */ - for (index = 0; index < 3; index++) - odm_set_bb_reg(p_dm_odm, 0xe00 + index * 4, MASKDWORD, 0x34343434); - odm_set_bb_reg(p_dm_odm, 0xe08 + index * 4, MASKDWORD, 0x03903434); - for (index = 0; index < 4; index++) - odm_set_bb_reg(p_dm_odm, 0xe10 + index * 4, MASKDWORD, 0x34343434); - - /* ==================================== */ - /* PAGE_B for path-A DPK setting */ - /* ==================================== */ - /* open inner loopback @ b00[19]:10 od 0xb00 0x01097018 */ - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_A, MASKDWORD, 0x02017098); - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_A_4, MASKDWORD, 0xf76d9f84); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_A, MASKDWORD, 0x0004ab87); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_ANT_A, MASKDWORD, 0x00880000); - - /* rf_lpbk_setup */ - /* 1.rf 00:5205a, rf 0d:0e52c */ - odm_set_rf_reg(p_dm_odm, RF_PATH_A, 0x0c, MASKDWORD, 0x8992b); - odm_set_rf_reg(p_dm_odm, RF_PATH_A, 0x0d, MASKDWORD, 0x0e52c); - odm_set_rf_reg(p_dm_odm, RF_PATH_A, 0x00, MASKDWORD, 0x5205a); - - /* ----send one shot signal---- */ - /* path A */ - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_A, MASKDWORD, 0x800477c0); - ODM_delay_ms(1); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_A, MASKDWORD, 0x000477c0); - ODM_delay_ms(50); - - while (retry_count < DP_RETRY_LIMIT && !p_dm_odm->rf_calibrate_info.is_dp_path_aok) { - /* ----read back measurement results---- */ - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_A, MASKDWORD, 0x0c297018); - tmp_reg = odm_get_bb_reg(p_dm_odm, 0xbe0, MASKDWORD); - ODM_delay_ms(10); - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_A, MASKDWORD, 0x0c29701f); - tmp_reg2 = odm_get_bb_reg(p_dm_odm, 0xbe8, MASKDWORD); - ODM_delay_ms(10); - - tmp_reg = (tmp_reg & MASKHWORD) >> 16; - tmp_reg2 = (tmp_reg2 & MASKHWORD) >> 16; - if (tmp_reg < 0xf0 || tmp_reg > 0x105 || tmp_reg2 > 0xff) { - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_A, MASKDWORD, 0x02017098); - - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x800000); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0); - ODM_delay_ms(1); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_A, MASKDWORD, 0x800477c0); - ODM_delay_ms(1); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_A, MASKDWORD, 0x000477c0); - ODM_delay_ms(50); - retry_count++; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A DPK retry_count %d 0xbe0[31:16] %x 0xbe8[31:16] %x\n", retry_count, tmp_reg, tmp_reg2)); - } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A DPK Sucess\n")); - p_dm_odm->rf_calibrate_info.is_dp_path_aok = true; - break; - } - } - retry_count = 0; - - /* DPP path A */ - if (p_dm_odm->rf_calibrate_info.is_dp_path_aok) { - /* DP settings */ - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_A, MASKDWORD, 0x01017098); - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_A_4, MASKDWORD, 0x776d9f84); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_A, MASKDWORD, 0x0004ab87); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_ANT_A, MASKDWORD, 0x00880000); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x400000); - - for (i = REG_PDP_ANT_A; i <= 0xb3c; i += 4) { - odm_set_bb_reg(p_dm_odm, i, MASKDWORD, 0x40004000); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A ofsset = 0x%x\n", i)); - } - - /* pwsf */ - odm_set_bb_reg(p_dm_odm, 0xb40, MASKDWORD, 0x40404040); - odm_set_bb_reg(p_dm_odm, 0xb44, MASKDWORD, 0x28324040); - odm_set_bb_reg(p_dm_odm, 0xb48, MASKDWORD, 0x10141920); - - for (i = 0xb4c; i <= 0xb5c; i += 4) - odm_set_bb_reg(p_dm_odm, i, MASKDWORD, 0x0c0c0c0c); - - /* TX_AGC boundary */ - odm_set_bb_reg(p_dm_odm, 0xbc0, MASKDWORD, 0x0005361f); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0); - } else { - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_A, MASKDWORD, 0x00000000); - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_A_4, MASKDWORD, 0x00000000); - } - - /* DPK path B */ - if (is2T) { - /* path A to standby mode */ - odm_set_rf_reg(p_dm_odm, RF_PATH_A, RF_AC, MASKDWORD, 0x10000); - - /* LUTs => tx_agc */ - /* PA gain = 11 & PAD1, => tx_agc 1f ~11 */ - /* PA gain = 11 & PAD2, => tx_agc 10 ~0e */ - /* PA gain = 01 => tx_agc 0b ~0d */ - /* PA gain = 00 => tx_agc 0a ~00 */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x400000); - odm_set_bb_reg(p_dm_odm, 0xbc4, MASKDWORD, 0x0005361f); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0); - - /* do inner loopback DPK 3 times */ - for (i = 0; i < 3; i++) { - /* PA gain = 11 & PAD2 => tx_agc = 0x0f/0x0c/0x07 */ - for (index = 0; index < 4; index++) - odm_set_bb_reg(p_dm_odm, 0x830 + index * 4, MASKDWORD, tx_agc[i][0]); - for (index = 0; index < 2; index++) - odm_set_bb_reg(p_dm_odm, 0x848 + index * 4, MASKDWORD, tx_agc[i][0]); - for (index = 0; index < 2; index++) - odm_set_bb_reg(p_dm_odm, 0x868 + index * 4, MASKDWORD, tx_agc[i][0]); - - /* PAGE_B for path-A inner loopback DPK setting */ - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_B, MASKDWORD, 0x02097098); - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_B_4, MASKDWORD, 0xf76d9f84); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x0004ab87); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_ANT_B, MASKDWORD, 0x00880000); - - /* ----send one shot signal---- */ - /* path B */ - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x80047788); - ODM_delay_ms(1); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x00047788); - ODM_delay_ms(50); - } - - /* PA gain = 11 => tx_agc = 1a */ - for (index = 0; index < 4; index++) - odm_set_bb_reg(p_dm_odm, 0x830 + index * 4, MASKDWORD, 0x34343434); - for (index = 0; index < 2; index++) - odm_set_bb_reg(p_dm_odm, 0x848 + index * 4, MASKDWORD, 0x34343434); - for (index = 0; index < 2; index++) - odm_set_bb_reg(p_dm_odm, 0x868 + index * 4, MASKDWORD, 0x34343434); - - /* PAGE_B for path-B DPK setting */ - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_B, MASKDWORD, 0x02017098); - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_B_4, MASKDWORD, 0xf76d9f84); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x0004ab87); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_ANT_B, MASKDWORD, 0x00880000); - - /* RF lpbk switches on */ - odm_set_bb_reg(p_dm_odm, 0x840, MASKDWORD, 0x0101000f); - odm_set_bb_reg(p_dm_odm, 0x840, MASKDWORD, 0x01120103); - - /* path-B RF lpbk */ - odm_set_rf_reg(p_dm_odm, RF_PATH_B, 0x0c, MASKDWORD, 0x8992b); - odm_set_rf_reg(p_dm_odm, RF_PATH_B, 0x0d, MASKDWORD, 0x0e52c); - odm_set_rf_reg(p_dm_odm, RF_PATH_B, RF_AC, MASKDWORD, 0x5205a); - - /* ----send one shot signal---- */ - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x800477c0); - ODM_delay_ms(1); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x000477c0); - ODM_delay_ms(50); - - while (retry_count < DP_RETRY_LIMIT && !p_dm_odm->rf_calibrate_info.is_dp_path_bok) { - /* ----read back measurement results---- */ - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_B, MASKDWORD, 0x0c297018); - tmp_reg = odm_get_bb_reg(p_dm_odm, 0xbf0, MASKDWORD); - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_B, MASKDWORD, 0x0c29701f); - tmp_reg2 = odm_get_bb_reg(p_dm_odm, 0xbf8, MASKDWORD); - - tmp_reg = (tmp_reg & MASKHWORD) >> 16; - tmp_reg2 = (tmp_reg2 & MASKHWORD) >> 16; - - if (tmp_reg < 0xf0 || tmp_reg > 0x105 || tmp_reg2 > 0xff) { - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_B, MASKDWORD, 0x02017098); - - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x800000); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0); - ODM_delay_ms(1); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x800477c0); - ODM_delay_ms(1); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x000477c0); - ODM_delay_ms(50); - retry_count++; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B DPK retry_count %d 0xbf0[31:16] %x, 0xbf8[31:16] %x\n", retry_count, tmp_reg, tmp_reg2)); - } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B DPK Success\n")); - p_dm_odm->rf_calibrate_info.is_dp_path_bok = true; - break; - } - } - - /* DPP path B */ - if (p_dm_odm->rf_calibrate_info.is_dp_path_bok) { - /* DP setting */ - /* LUT by SRAM */ - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_B, MASKDWORD, 0x01017098); - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_B_4, MASKDWORD, 0x776d9f84); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x0004ab87); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_ANT_B, MASKDWORD, 0x00880000); - - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x400000); - for (i = 0xb60; i <= 0xb9c; i += 4) { - odm_set_bb_reg(p_dm_odm, i, MASKDWORD, 0x40004000); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B ofsset = 0x%x\n", i)); - } - - /* PWSF */ - odm_set_bb_reg(p_dm_odm, 0xba0, MASKDWORD, 0x40404040); - odm_set_bb_reg(p_dm_odm, 0xba4, MASKDWORD, 0x28324050); - odm_set_bb_reg(p_dm_odm, 0xba8, MASKDWORD, 0x0c141920); - - for (i = 0xbac; i <= 0xbbc; i += 4) - odm_set_bb_reg(p_dm_odm, i, MASKDWORD, 0x0c0c0c0c); - - /* tx_agc boundary */ - odm_set_bb_reg(p_dm_odm, 0xbc4, MASKDWORD, 0x0005361f); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0); - - } else { - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_B, MASKDWORD, 0x00000000); - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_B_4, MASKDWORD, 0x00000000); - } - } - - /* reload BB default value */ - for (index = 0; index < DP_BB_REG_NUM; index++) - odm_set_bb_reg(p_dm_odm, BB_REG[index], MASKDWORD, BB_backup[index]); - - /* reload RF default value */ - for (path = 0; path < DP_PATH_NUM; path++) { - for (i = 0 ; i < DP_RF_REG_NUM ; i++) - odm_set_rf_reg(p_dm_odm, path, RF_REG[i], MASKDWORD, RF_backup[path][i]); - } - odm_set_rf_reg(p_dm_odm, RF_PATH_A, RF_MODE1, MASKDWORD, 0x1000f); /* standby mode */ - odm_set_rf_reg(p_dm_odm, RF_PATH_A, RF_MODE2, MASKDWORD, 0x20101); /* RF lpbk switches off */ - - /* reload AFE default value */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_reload_adda_registers(p_adapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); - - /* reload MAC default value */ - _phy_reload_mac_registers(p_adapter, MAC_REG, MAC_backup); -#else - _phy_reload_adda_registers(p_dm_odm, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); - - /* reload MAC default value */ - _phy_reload_mac_registers(p_dm_odm, MAC_REG, MAC_backup); -#endif - - p_dm_odm->rf_calibrate_info.is_dp_done = true; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<==phy_digital_predistortion()\n")); -#endif -} - -void -phy_digital_predistortion_8188e( -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - struct _ADAPTER *p_adapter -#else - struct PHY_DM_STRUCT *p_dm_odm -#endif -) -{ -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif -#ifdef DISABLE_BB_RF - return; -#endif - - return; - - if (p_dm_odm->rf_calibrate_info.is_dp_done) - return; -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - - if (IS_92C_SERIAL(p_hal_data->version_id)) - phy_digital_predistortion(p_adapter, true); - else -#endif - { - /* For 88C 1T1R */ - phy_digital_predistortion(p_adapter, false); - } -} - - - -/* return value true => Main; false => Aux */ - -bool _phy_query_rf_path_switch_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - bool 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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - if (!p_adapter->is_hw_init_ready) { - u8 u1b_tmp; - u1b_tmp = odm_read_1byte(p_dm_odm, REG_LEDCFG2) | BIT(7); - odm_write_1byte(p_dm_odm, REG_LEDCFG2, u1b_tmp); - /* odm_set_bb_reg(p_dm_odm, REG_LEDCFG0, BIT23, 0x01); */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XAB_RF_PARAMETER, BIT(13), 0x01); - } - - if (is2T) { - if (odm_get_bb_reg(p_dm_odm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(5) | BIT(6)) == 0x01) - return true; - else - return false; - } else { - if ((odm_get_bb_reg(p_dm_odm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(5) | BIT(4) | BIT(3)) == 0x1)) - return true; - else - return false; - } -} - - - -/* return value true => Main; false => Aux */ -bool phy_query_rf_path_switch_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm -#else - struct _ADAPTER *p_adapter -#endif -) -{ - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); - -#ifdef DISABLE_BB_RF - return true; -#endif -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - - /* if(IS_92C_SERIAL( p_hal_data->version_id)) { */ - if (IS_2T2R(p_hal_data->version_id)) - return _phy_query_rf_path_switch_8188e(p_adapter, true); - else -#endif - { - /* For 88C 1T1R */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - return _phy_query_rf_path_switch_8188e(p_adapter, false); -#else - return _phy_query_rf_path_switch_8188e(p_dm_odm, false); -#endif - } -} -#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halphyrf_8188e_ce.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halphyrf_8188e_ce.c deleted file mode 100644 index faae80a67998..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halphyrf_8188e_ce.c +++ /dev/null @@ -1,3150 +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 Local Constant---------------------------*/ -/* 2010/04/25 MH Define the max tx power tracking tx agc power. */ -#define ODM_TXPWRTRACK_MAX_IDX_88E 6 - -/*---------------------------Define Local Constant---------------------------*/ - - -/* 3============================================================ - * 3 Tx Power Tracking - * 3============================================================ */ - - -void set_iqk_matrix_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u8 OFDM_index, - u8 rf_path, - s32 iqk_result_x, - s32 iqk_result_y -) -{ - s32 ele_A = 0, ele_D, ele_C = 0, value32; - - ele_D = (ofdm_swing_table_new[OFDM_index] & 0xFFC00000) >> 22; - - /* new element A = element D x X */ - if ((iqk_result_x != 0) && (*(p_dm_odm->p_band_type) == ODM_BAND_2_4G)) { - if ((iqk_result_x & 0x00000200) != 0) /* consider minus */ - iqk_result_x = iqk_result_x | 0xFFFFFC00; - ele_A = ((iqk_result_x * ele_D) >> 8) & 0x000003FF; - - /* new element C = element D x Y */ - if ((iqk_result_y & 0x00000200) != 0) - iqk_result_y = iqk_result_y | 0xFFFFFC00; - ele_C = ((iqk_result_y * ele_D) >> 8) & 0x000003FF; - - /* if (rf_path == ODM_RF_PATH_A) */ - switch (rf_path) { - case ODM_RF_PATH_A: - /* 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; - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKDWORD, value32); - - value32 = (ele_C & 0x000003C0) >> 6; - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XC_TX_AFE, MASKH4BITS, value32); - - value32 = ((iqk_result_x * ele_D) >> 7) & 0x01; - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_ECCA_THRESHOLD, BIT(24), value32); - break; - case ODM_RF_PATH_B: - /* 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; - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XB_TX_IQ_IMBALANCE, MASKDWORD, value32); - - value32 = (ele_C & 0x000003C0) >> 6; - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XD_TX_AFE, MASKH4BITS, value32); - - value32 = ((iqk_result_x * ele_D) >> 7) & 0x01; - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_ECCA_THRESHOLD, BIT(28), value32); - - break; - default: - break; - } - } else { - switch (rf_path) { - case ODM_RF_PATH_A: - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKDWORD, ofdm_swing_table_new[OFDM_index]); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XC_TX_AFE, MASKH4BITS, 0x00); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_ECCA_THRESHOLD, BIT(24), 0x00); - break; - - case ODM_RF_PATH_B: - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XB_TX_IQ_IMBALANCE, MASKDWORD, ofdm_swing_table_new[OFDM_index]); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XD_TX_AFE, MASKH4BITS, 0x00); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_ECCA_THRESHOLD, BIT(28), 0x00); - break; - - default: - break; - } - } - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("TxPwrTracking path B: X = 0x%x, Y = 0x%x ele_A = 0x%x ele_C = 0x%x ele_D = 0x%x 0xeb4 = 0x%x 0xebc = 0x%x\n", - (u32)iqk_result_x, (u32)iqk_result_y, (u32)ele_A, (u32)ele_C, (u32)ele_D, (u32)iqk_result_x, (u32)iqk_result_y)); -} - -void do_iqk_8188e( - void *p_dm_void, - u8 delta_thermal_index, - u8 thermal_value, - u8 threshold -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - struct _ADAPTER *adapter = p_dm_odm->adapter; - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); -#endif - - odm_reset_iqk_result(p_dm_odm); - -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) -#if USE_WORKITEM - platform_acquire_mutex(&p_hal_data->mx_chnl_bw_control); -#else - platform_acquire_spin_lock(adapter, RT_CHANNEL_AND_BANDWIDTH_SPINLOCK); -#endif -#elif ((DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE)) - platform_acquire_mutex(&p_hal_data->mx_chnl_bw_control); -#endif -#endif - - - p_dm_odm->rf_calibrate_info.thermal_value_iqk = thermal_value; -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - phy_iq_calibrate_8188e(p_dm_odm, false); -#else - phy_iq_calibrate_8188e(adapter, false); -#endif - -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) -#if USE_WORKITEM - platform_release_mutex(&p_hal_data->mx_chnl_bw_control); -#else - platform_release_spin_lock(adapter, RT_CHANNEL_AND_BANDWIDTH_SPINLOCK); -#endif -#elif ((DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE)) - platform_release_mutex(&p_hal_data->mx_chnl_bw_control); -#endif -#endif -} - -/*----------------------------------------------------------------------------- - * Function: odm_TxPwrTrackSetPwr88E() - * - * Overview: 88E 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_pwr88_e( - void *p_dm_void, - enum pwrtrack_method method, - u8 rf_path, - u8 channel_mapped_index -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTER *adapter = p_dm_odm->adapter; - PHAL_DATA_TYPE p_hal_data = GET_HAL_DATA(adapter); - u8 pwr_tracking_limit_ofdm = 30; /* +0dB */ - u8 pwr_tracking_limit_cck = 28; /* -2dB */ - u8 tx_rate = 0xFF; - u8 final_ofdm_swing_index = 0; - u8 final_cck_swing_index = 0; - u8 i = 0; - struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm_odm->rf_calibrate_info); - - if (p_dm_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 p_mpt_ctx = &(adapter->mpt_ctx); - - tx_rate = mpt_to_mgnt_rate(p_mpt_ctx->mpt_rate_index); -#endif -#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - PMPT_CONTEXT p_mpt_ctx = &(adapter->mppriv.mpt_ctx); - - tx_rate = mpt_to_mgnt_rate(p_mpt_ctx->mpt_rate_index); -#endif -#endif - } else { - u16 rate = *(p_dm_odm->p_forced_data_rate); - - if (!rate) { /*auto rate*/ - if (rate != 0xFF) { -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - tx_rate = adapter->HalFunc.GetHwRateFromMRateHandler(p_dm_odm->tx_rate); -#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - if (p_dm_odm->number_linked_client != 0) - tx_rate = hw_rate_to_m_rate(p_dm_odm->tx_rate); -#endif - } - } else /*force rate*/ - tx_rate = (u8)rate; - } - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("Power Tracking tx_rate=0x%X\n", tx_rate)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("===>ODM_TxPwrTrackSetPwr8188E\n")); - - if (tx_rate != 0xFF) { - /* 2 CCK */ - if (((tx_rate >= MGN_1M) && (tx_rate <= MGN_5_5M)) || (tx_rate == MGN_11M)) - pwr_tracking_limit_cck = 28; /* -2dB */ - /* 2 OFDM */ - else if ((tx_rate >= MGN_6M) && (tx_rate <= MGN_48M)) - pwr_tracking_limit_ofdm = 36; /* +3dB */ - else if (tx_rate == MGN_54M) - pwr_tracking_limit_ofdm = 34; /* +2dB */ - - /* 2 HT */ - else if ((tx_rate >= MGN_MCS0) && (tx_rate <= MGN_MCS2)) /* QPSK/BPSK */ - pwr_tracking_limit_ofdm = 38; /* +4dB */ - else if ((tx_rate >= MGN_MCS3) && (tx_rate <= MGN_MCS4)) /* 16QAM */ - pwr_tracking_limit_ofdm = 36; /* +3dB */ - else if ((tx_rate >= MGN_MCS5) && (tx_rate <= MGN_MCS7)) /* 64QAM */ - pwr_tracking_limit_ofdm = 34; /* +2dB */ - - else - pwr_tracking_limit_ofdm = p_rf_calibrate_info->default_ofdm_index; /*Default OFDM index = 30*/ - } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("tx_rate=0x%x, pwr_tracking_limit=%d\n", tx_rate, pwr_tracking_limit_ofdm)); - - if (method == TXAGC) { - u32 pwr = 0, tx_agc = 0; - struct _ADAPTER *adapter = p_dm_odm->adapter; - - 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.*/ - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("odm_TxPwrTrackSetPwr88E CH=%d\n", *(p_dm_odm->p_channel))); - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - - if (p_dm_odm->mp_mode == true) { - pwr = phy_query_bb_reg(adapter, REG_TX_AGC_A_RATE18_06, 0xFF); - pwr += p_dm_odm->rf_calibrate_info.power_index_offset[ODM_RF_PATH_A]; - phy_set_bb_reg(adapter, REG_TX_AGC_A_CCK_1_MCS32, MASKBYTE1, pwr); - tx_agc = (pwr << 16) | (pwr << 8) | (pwr); - phy_set_bb_reg(adapter, REG_TX_AGC_B_CCK_11_A_CCK_2_11, MASKH3BYTES, tx_agc); - /* RT_DISP(FPHY, PHY_TXPWR, ("odm_tx_pwr_track_set_pwr88_e: CCK Tx-rf(A) Power = 0x%x\n", tx_agc)); */ - - pwr = phy_query_bb_reg(adapter, REG_TX_AGC_A_RATE18_06, 0xFF); - pwr += (p_rf_calibrate_info->bb_swing_idx_ofdm[ODM_RF_PATH_A] - p_rf_calibrate_info->bb_swing_idx_ofdm_base[RF_PATH_A]); - tx_agc |= ((pwr << 24) | (pwr << 16) | (pwr << 8) | pwr); - phy_set_bb_reg(adapter, REG_TX_AGC_A_RATE18_06, MASKDWORD, tx_agc); - phy_set_bb_reg(adapter, REG_TX_AGC_A_RATE54_24, MASKDWORD, tx_agc); - phy_set_bb_reg(adapter, REG_TX_AGC_A_MCS03_MCS00, MASKDWORD, tx_agc); - phy_set_bb_reg(adapter, REG_TX_AGC_A_MCS07_MCS04, MASKDWORD, tx_agc); - phy_set_bb_reg(adapter, REG_TX_AGC_A_MCS11_MCS08, MASKDWORD, tx_agc); - phy_set_bb_reg(adapter, REG_TX_AGC_A_MCS15_MCS12, MASKDWORD, tx_agc); - /* RT_DISP(FPHY, PHY_TXPWR, ("odm_tx_pwr_track_set_pwr88_e: OFDM Tx-rf(A) Power = 0x%x\n", tx_agc)); */ - } else { - /* phy_set_tx_power_level8188e(p_dm_odm->adapter, *p_dm_odm->p_channel); */ - p_rf_calibrate_info->modify_tx_agc_flag_path_a = true; - p_rf_calibrate_info->modify_tx_agc_flag_path_a_cck = true; - - if (rf_path == ODM_RF_PATH_A) { - phy_set_tx_power_index_by_rate_section(adapter, ODM_RF_PATH_A, *p_dm_odm->p_channel, CCK); - phy_set_tx_power_index_by_rate_section(adapter, ODM_RF_PATH_A, *p_dm_odm->p_channel, OFDM); - phy_set_tx_power_index_by_rate_section(adapter, ODM_RF_PATH_A, *p_dm_odm->p_channel, HT_MCS0_MCS7); - } - } - - -#endif -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - /* phy_rf6052_set_cck_tx_power(p_dm_odm->priv, *(p_dm_odm->p_channel)); */ - /* phy_rf6052_set_ofdm_tx_power(p_dm_odm->priv, *(p_dm_odm->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]; - - 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) - final_cck_swing_index = CCK_TABLE_SIZE - 1; - else if (p_rf_calibrate_info->bb_swing_idx_cck <= 0) - final_cck_swing_index = 0; - - /* Adjust BB swing by OFDM IQ matrix */ - if (rf_path == ODM_RF_PATH_A) { - set_iqk_matrix_8188e(p_dm_odm, final_ofdm_swing_index, ODM_RF_PATH_A, - p_dm_odm->rf_calibrate_info.iqk_matrix_reg_setting[channel_mapped_index].value[0][0], - p_dm_odm->rf_calibrate_info.iqk_matrix_reg_setting[channel_mapped_index].value[0][1]); - /* Adjust BB swing by CCK filter coefficient */ - if (!p_dm_odm->rf_calibrate_info.is_cck_in_ch14) { - odm_write_1byte(p_dm_odm, 0xa22, cck_swing_table_ch1_ch13_new[final_cck_swing_index][0]); - odm_write_1byte(p_dm_odm, 0xa23, cck_swing_table_ch1_ch13_new[final_cck_swing_index][1]); - odm_write_1byte(p_dm_odm, 0xa24, cck_swing_table_ch1_ch13_new[final_cck_swing_index][2]); - odm_write_1byte(p_dm_odm, 0xa25, cck_swing_table_ch1_ch13_new[final_cck_swing_index][3]); - odm_write_1byte(p_dm_odm, 0xa26, cck_swing_table_ch1_ch13_new[final_cck_swing_index][4]); - odm_write_1byte(p_dm_odm, 0xa27, cck_swing_table_ch1_ch13_new[final_cck_swing_index][5]); - odm_write_1byte(p_dm_odm, 0xa28, cck_swing_table_ch1_ch13_new[final_cck_swing_index][6]); - odm_write_1byte(p_dm_odm, 0xa29, cck_swing_table_ch1_ch13_new[final_cck_swing_index][7]); - } else { - odm_write_1byte(p_dm_odm, 0xa22, cck_swing_table_ch14_new[final_cck_swing_index][0]); - odm_write_1byte(p_dm_odm, 0xa23, cck_swing_table_ch14_new[final_cck_swing_index][1]); - odm_write_1byte(p_dm_odm, 0xa24, cck_swing_table_ch14_new[final_cck_swing_index][2]); - odm_write_1byte(p_dm_odm, 0xa25, cck_swing_table_ch14_new[final_cck_swing_index][3]); - odm_write_1byte(p_dm_odm, 0xa26, cck_swing_table_ch14_new[final_cck_swing_index][4]); - odm_write_1byte(p_dm_odm, 0xa27, cck_swing_table_ch14_new[final_cck_swing_index][5]); - odm_write_1byte(p_dm_odm, 0xa28, cck_swing_table_ch14_new[final_cck_swing_index][6]); - odm_write_1byte(p_dm_odm, 0xa29, cck_swing_table_ch14_new[final_cck_swing_index][7]); - } - } - } else if (method == MIX_MODE) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("p_rf_calibrate_info->default_ofdm_index=%d, p_dm_odm->DefaultCCKIndex=%d, p_rf_calibrate_info->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_cck_swing_index = p_rf_calibrate_info->default_cck_index + p_rf_calibrate_info->absolute_ofdm_swing_idx[rf_path]; - final_ofdm_swing_index = p_rf_calibrate_info->default_ofdm_index + p_rf_calibrate_info->absolute_ofdm_swing_idx[rf_path]; - - if (final_ofdm_swing_index > pwr_tracking_limit_ofdm) { /* BBSwing higher then Limit */ - p_rf_calibrate_info->remnant_ofdm_swing_idx[rf_path] = final_ofdm_swing_index - pwr_tracking_limit_ofdm; - - set_iqk_matrix_8188e(p_dm_odm, pwr_tracking_limit_ofdm, ODM_RF_PATH_A, - p_dm_odm->rf_calibrate_info.iqk_matrix_reg_setting[channel_mapped_index].value[0][0], - p_dm_odm->rf_calibrate_info.iqk_matrix_reg_setting[channel_mapped_index].value[0][1]); - - p_rf_calibrate_info->modify_tx_agc_flag_path_a = true; - - phy_set_tx_power_index_by_rate_section(adapter, ODM_RF_PATH_A, *p_dm_odm->p_channel, OFDM); - phy_set_tx_power_index_by_rate_section(adapter, ODM_RF_PATH_A, *p_dm_odm->p_channel, HT_MCS0_MCS7); - - ODM_RT_TRACE(p_dm_odm, 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_8188e(p_dm_odm, 0, ODM_RF_PATH_A, - p_dm_odm->rf_calibrate_info.iqk_matrix_reg_setting[channel_mapped_index].value[0][0], - p_dm_odm->rf_calibrate_info.iqk_matrix_reg_setting[channel_mapped_index].value[0][1]); - - p_rf_calibrate_info->modify_tx_agc_flag_path_a = true; - - phy_set_tx_power_index_by_rate_section(adapter, ODM_RF_PATH_A, *p_dm_odm->p_channel, OFDM); - phy_set_tx_power_index_by_rate_section(adapter, ODM_RF_PATH_A, *p_dm_odm->p_channel, HT_MCS0_MCS7); - - ODM_RT_TRACE(p_dm_odm, 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_8188e(p_dm_odm, final_ofdm_swing_index, ODM_RF_PATH_A, - p_dm_odm->rf_calibrate_info.iqk_matrix_reg_setting[channel_mapped_index].value[0][0], - p_dm_odm->rf_calibrate_info.iqk_matrix_reg_setting[channel_mapped_index].value[0][1]); - - ODM_RT_TRACE(p_dm_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 (p_rf_calibrate_info->modify_tx_agc_flag_path_a) { /*If tx_agc has changed, reset tx_agc again*/ - p_rf_calibrate_info->remnant_ofdm_swing_idx[rf_path] = 0; - - phy_set_tx_power_index_by_rate_section(adapter, ODM_RF_PATH_A, *p_dm_odm->p_channel, OFDM); - phy_set_tx_power_index_by_rate_section(adapter, ODM_RF_PATH_A, *p_dm_odm->p_channel, HT_MCS0_MCS7); - - p_rf_calibrate_info->modify_tx_agc_flag_path_a = false; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A p_dm_odm->Modify_TxAGC_Flag = false\n")); - } - } - - 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A CCK Over Limit, pwr_tracking_limit_cck = %d, p_rf_calibrate_info->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 */ - - if (!p_dm_odm->rf_calibrate_info.is_cck_in_ch14) { - odm_write_1byte(p_dm_odm, 0xa22, cck_swing_table_ch1_ch13_new[pwr_tracking_limit_cck][0]); - odm_write_1byte(p_dm_odm, 0xa23, cck_swing_table_ch1_ch13_new[pwr_tracking_limit_cck][1]); - odm_write_1byte(p_dm_odm, 0xa24, cck_swing_table_ch1_ch13_new[pwr_tracking_limit_cck][2]); - odm_write_1byte(p_dm_odm, 0xa25, cck_swing_table_ch1_ch13_new[pwr_tracking_limit_cck][3]); - odm_write_1byte(p_dm_odm, 0xa26, cck_swing_table_ch1_ch13_new[pwr_tracking_limit_cck][4]); - odm_write_1byte(p_dm_odm, 0xa27, cck_swing_table_ch1_ch13_new[pwr_tracking_limit_cck][5]); - odm_write_1byte(p_dm_odm, 0xa28, cck_swing_table_ch1_ch13_new[pwr_tracking_limit_cck][6]); - odm_write_1byte(p_dm_odm, 0xa29, cck_swing_table_ch1_ch13_new[pwr_tracking_limit_cck][7]); - } else { - odm_write_1byte(p_dm_odm, 0xa22, cck_swing_table_ch14_new[pwr_tracking_limit_cck][0]); - odm_write_1byte(p_dm_odm, 0xa23, cck_swing_table_ch14_new[pwr_tracking_limit_cck][1]); - odm_write_1byte(p_dm_odm, 0xa24, cck_swing_table_ch14_new[pwr_tracking_limit_cck][2]); - odm_write_1byte(p_dm_odm, 0xa25, cck_swing_table_ch14_new[pwr_tracking_limit_cck][3]); - odm_write_1byte(p_dm_odm, 0xa26, cck_swing_table_ch14_new[pwr_tracking_limit_cck][4]); - odm_write_1byte(p_dm_odm, 0xa27, cck_swing_table_ch14_new[pwr_tracking_limit_cck][5]); - odm_write_1byte(p_dm_odm, 0xa28, cck_swing_table_ch14_new[pwr_tracking_limit_cck][6]); - odm_write_1byte(p_dm_odm, 0xa29, cck_swing_table_ch14_new[pwr_tracking_limit_cck][7]); - } - - p_rf_calibrate_info->modify_tx_agc_flag_path_a_cck = true; - - phy_set_tx_power_index_by_rate_section(adapter, ODM_RF_PATH_A, *p_dm_odm->p_channel, CCK); - - } else if (final_cck_swing_index <= 0) { /* Lowest CCK index = 0 */ - p_rf_calibrate_info->remnant_cck_swing_idx = final_cck_swing_index; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A CCK Under Limit, pwr_tracking_limit_cck = %d, p_rf_calibrate_info->remnant_cck_swing_idx = %d\n", 0, p_rf_calibrate_info->remnant_cck_swing_idx)); - - if (!p_dm_odm->rf_calibrate_info.is_cck_in_ch14) { - odm_write_1byte(p_dm_odm, 0xa22, cck_swing_table_ch1_ch13_new[0][0]); - odm_write_1byte(p_dm_odm, 0xa23, cck_swing_table_ch1_ch13_new[0][1]); - odm_write_1byte(p_dm_odm, 0xa24, cck_swing_table_ch1_ch13_new[0][2]); - odm_write_1byte(p_dm_odm, 0xa25, cck_swing_table_ch1_ch13_new[0][3]); - odm_write_1byte(p_dm_odm, 0xa26, cck_swing_table_ch1_ch13_new[0][4]); - odm_write_1byte(p_dm_odm, 0xa27, cck_swing_table_ch1_ch13_new[0][5]); - odm_write_1byte(p_dm_odm, 0xa28, cck_swing_table_ch1_ch13_new[0][6]); - odm_write_1byte(p_dm_odm, 0xa29, cck_swing_table_ch1_ch13_new[0][7]); - } else { - odm_write_1byte(p_dm_odm, 0xa22, cck_swing_table_ch14_new[0][0]); - odm_write_1byte(p_dm_odm, 0xa23, cck_swing_table_ch14_new[0][1]); - odm_write_1byte(p_dm_odm, 0xa24, cck_swing_table_ch14_new[0][2]); - odm_write_1byte(p_dm_odm, 0xa25, cck_swing_table_ch14_new[0][3]); - odm_write_1byte(p_dm_odm, 0xa26, cck_swing_table_ch14_new[0][4]); - odm_write_1byte(p_dm_odm, 0xa27, cck_swing_table_ch14_new[0][5]); - odm_write_1byte(p_dm_odm, 0xa28, cck_swing_table_ch14_new[0][6]); - odm_write_1byte(p_dm_odm, 0xa29, cck_swing_table_ch14_new[0][7]); - } - - p_rf_calibrate_info->modify_tx_agc_flag_path_a_cck = true; - - phy_set_tx_power_index_by_rate_section(adapter, ODM_RF_PATH_A, *p_dm_odm->p_channel, CCK); - - } else { - ODM_RT_TRACE(p_dm_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)); - - if (!p_dm_odm->rf_calibrate_info.is_cck_in_ch14) { - odm_write_1byte(p_dm_odm, 0xa22, cck_swing_table_ch1_ch13_new[final_cck_swing_index][0]); - odm_write_1byte(p_dm_odm, 0xa23, cck_swing_table_ch1_ch13_new[final_cck_swing_index][1]); - odm_write_1byte(p_dm_odm, 0xa24, cck_swing_table_ch1_ch13_new[final_cck_swing_index][2]); - odm_write_1byte(p_dm_odm, 0xa25, cck_swing_table_ch1_ch13_new[final_cck_swing_index][3]); - odm_write_1byte(p_dm_odm, 0xa26, cck_swing_table_ch1_ch13_new[final_cck_swing_index][4]); - odm_write_1byte(p_dm_odm, 0xa27, cck_swing_table_ch1_ch13_new[final_cck_swing_index][5]); - odm_write_1byte(p_dm_odm, 0xa28, cck_swing_table_ch1_ch13_new[final_cck_swing_index][6]); - odm_write_1byte(p_dm_odm, 0xa29, cck_swing_table_ch1_ch13_new[final_cck_swing_index][7]); - } else { - odm_write_1byte(p_dm_odm, 0xa22, cck_swing_table_ch14_new[final_cck_swing_index][0]); - odm_write_1byte(p_dm_odm, 0xa23, cck_swing_table_ch14_new[final_cck_swing_index][1]); - odm_write_1byte(p_dm_odm, 0xa24, cck_swing_table_ch14_new[final_cck_swing_index][2]); - odm_write_1byte(p_dm_odm, 0xa25, cck_swing_table_ch14_new[final_cck_swing_index][3]); - odm_write_1byte(p_dm_odm, 0xa26, cck_swing_table_ch14_new[final_cck_swing_index][4]); - odm_write_1byte(p_dm_odm, 0xa27, cck_swing_table_ch14_new[final_cck_swing_index][5]); - odm_write_1byte(p_dm_odm, 0xa28, cck_swing_table_ch14_new[final_cck_swing_index][6]); - odm_write_1byte(p_dm_odm, 0xa29, cck_swing_table_ch14_new[final_cck_swing_index][7]); - } - - if (p_rf_calibrate_info->modify_tx_agc_flag_path_a_cck) { /*If tx_agc has changed, reset tx_agc again*/ - p_rf_calibrate_info->remnant_cck_swing_idx = 0; - phy_set_tx_power_index_by_rate_section(adapter, ODM_RF_PATH_A, *p_dm_odm->p_channel, CCK); - p_rf_calibrate_info->modify_tx_agc_flag_path_a_cck = false; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A p_dm_odm->Modify_TxAGC_Flag_CCK = false\n")); - } - } - } else - return; -} /* odm_TxPwrTrackSetPwr88E */ - -void -get_delta_swing_table_8188e( - 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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTER *adapter = p_dm_odm->adapter; - PHAL_DATA_TYPE p_hal_data = GET_HAL_DATA(adapter); - struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm_odm->rf_calibrate_info); - - u8 tx_rate = 0xFF; - u8 channel = *p_dm_odm->p_channel; - - if (p_dm_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 p_mpt_ctx = &(adapter->mpt_ctx); - - tx_rate = mpt_to_mgnt_rate(p_mpt_ctx->mpt_rate_index); -#endif -#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - PMPT_CONTEXT p_mpt_ctx = &(adapter->mppriv.mpt_ctx); - - tx_rate = mpt_to_mgnt_rate(p_mpt_ctx->mpt_rate_index); -#endif -#endif - } else { - u16 rate = *(p_dm_odm->p_forced_data_rate); - - if (!rate) { /*auto rate*/ - if (rate != 0xFF) { -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - tx_rate = adapter->HalFunc.GetHwRateFromMRateHandler(p_dm_odm->tx_rate); -#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - if (p_dm_odm->number_linked_client != 0) - tx_rate = hw_rate_to_m_rate(p_dm_odm->tx_rate); -#endif - } - } else /*force rate*/ - tx_rate = (u8)rate; - } - - ODM_RT_TRACE(p_dm_odm, 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; - } 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; - } - } else { - *temperature_up_a = (u8 *)delta_swing_table_idx_2ga_p_8188e; - *temperature_down_a = (u8 *)delta_swing_table_idx_2ga_n_8188e; - } - -} - -void configure_txpower_track_8188e( - struct _TXPWRTRACK_CFG *p_config -) -{ - p_config->swing_table_size_cck = CCK_TABLE_SIZE; - p_config->swing_table_size_ofdm = OFDM_TABLE_SIZE; - p_config->threshold_iqk = IQK_THRESHOLD; - p_config->average_thermal_num = AVG_THERMAL_NUM_88E; - p_config->rf_path_count = MAX_PATH_NUM_8188E; - p_config->thermal_reg_addr = RF_T_METER_88E; - - p_config->odm_tx_pwr_track_set_pwr = odm_tx_pwr_track_set_pwr88_e; - p_config->do_iqk = do_iqk_8188e; - p_config->phy_lc_calibrate = phy_lc_calibrate_8188e; - p_config->get_delta_swing_table = get_delta_swing_table_8188e; -} - -/* 1 7. IQK */ -#define MAX_TOLERANCE 5 -#define IQK_DELAY_TIME 1 /* ms */ - -u8 /* bit0 = 1 => Tx OK, bit1 = 1 => Rx OK */ -phy_path_a_iqk_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - bool config_path_b -) -{ - u32 reg_eac, reg_e94, reg_e9c, reg_ea4; - u8 result = 0x00; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A IQK!\n")); - - /* 1 Tx IQK */ - /* path-A IQK setting */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path-A IQK setting!\n")); - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_TONE_A, MASKDWORD, 0x10008c1c); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_TONE_A, MASKDWORD, 0x30008c1c); - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_PI_A, MASKDWORD, 0x8214032a); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_PI_A, MASKDWORD, 0x28160000); - - /* LO calibration setting */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LO calibration setting!\n")); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_RSP, MASKDWORD, 0x00462911); - - /* One shot, path A LOK & IQK */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("One shot, path A LOK & IQK!\n")); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_PTS, MASKDWORD, 0xf9000000); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_PTS, MASKDWORD, 0xf8000000); - - /* delay x ms */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("delay %d ms for One shot, path A LOK & IQK.\n", IQK_DELAY_TIME_88E)); - /* platform_stall_execution(IQK_DELAY_TIME_88E*1000); */ - ODM_delay_ms(IQK_DELAY_TIME_88E); - - /* Check failed */ - reg_eac = odm_get_bb_reg(p_dm_odm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xeac = 0x%x\n", reg_eac)); - reg_e94 = odm_get_bb_reg(p_dm_odm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe94 = 0x%x\n", reg_e94)); - reg_e9c = odm_get_bb_reg(p_dm_odm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe9c = 0x%x\n", reg_e9c)); - reg_ea4 = odm_get_bb_reg(p_dm_odm, REG_RX_POWER_BEFORE_IQK_A_2, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xea4 = 0x%x\n", reg_ea4)); - - if (!(reg_eac & BIT(28)) && - (((reg_e94 & 0x03FF0000) >> 16) != 0x142) && - (((reg_e9c & 0x03FF0000) >> 16) != 0x42)) - result |= 0x01; - else /* if Tx not OK, ignore Rx */ - return result; - -#if 0 - if (!(reg_eac & BIT(27)) && /* if Tx is OK, check whether Rx is OK */ - (((reg_ea4 & 0x03FF0000) >> 16) != 0x132) && - (((reg_eac & 0x03FF0000) >> 16) != 0x36)) - result |= 0x02; - else - RT_DISP(FINIT, INIT_IQK, ("path A Rx IQK fail!!\n")); -#endif - - return result; - - -} - -u8 /* bit0 = 1 => Tx OK, bit1 = 1 => Rx OK */ -phy_path_a_rx_iqk( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - bool config_path_b -) -{ - u32 reg_eac, reg_e94, reg_e9c, reg_ea4, u4tmp; - u8 result = 0x00; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A Rx IQK!\n")); - - /* 1 Get TXIMR setting */ - /* modify RXIQK mode table */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path-A Rx IQK modify RXIQK mode table!\n")); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, MASKH3BYTES, 0x000000); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_WE_LUT, RFREGOFFSETMASK, 0x800a0); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_RCK_OS, RFREGOFFSETMASK, 0x30000); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_TXPA_G1, RFREGOFFSETMASK, 0x0000f); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_TXPA_G2, RFREGOFFSETMASK, 0xf117B); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, MASKH3BYTES, 0x808000); - - /* IQK setting */ - odm_set_bb_reg(p_dm_odm, REG_TX_IQK, MASKDWORD, 0x01007c00); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK, MASKDWORD, 0x81004800); - - /* path-A IQK setting */ - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_TONE_A, MASKDWORD, 0x10008c1c); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_TONE_A, MASKDWORD, 0x30008c1c); - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_PI_A, MASKDWORD, 0x82160804); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_PI_A, MASKDWORD, 0x28160000); - - /* LO calibration setting */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LO calibration setting!\n")); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_RSP, MASKDWORD, 0x0046a911); - - /* One shot, path A LOK & IQK */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("One shot, path A LOK & IQK!\n")); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_PTS, MASKDWORD, 0xf9000000); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_PTS, MASKDWORD, 0xf8000000); - - /* delay x ms */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("delay %d ms for One shot, path A LOK & IQK.\n", IQK_DELAY_TIME_88E)); - /* platform_stall_execution(IQK_DELAY_TIME_88E*1000); */ - ODM_delay_ms(IQK_DELAY_TIME_88E); - - - /* Check failed */ - reg_eac = odm_get_bb_reg(p_dm_odm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xeac = 0x%x\n", reg_eac)); - reg_e94 = odm_get_bb_reg(p_dm_odm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe94 = 0x%x\n", reg_e94)); - reg_e9c = odm_get_bb_reg(p_dm_odm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe9c = 0x%x\n", reg_e9c)); - - if (!(reg_eac & BIT(28)) && - (((reg_e94 & 0x03FF0000) >> 16) != 0x142) && - (((reg_e9c & 0x03FF0000) >> 16) != 0x42)) - result |= 0x01; - else /* if Tx not OK, ignore Rx */ - return result; - - u4tmp = 0x80007C00 | (reg_e94 & 0x3FF0000) | ((reg_e9c & 0x3FF0000) >> 16); - odm_set_bb_reg(p_dm_odm, REG_TX_IQK, MASKDWORD, u4tmp); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe40 = 0x%x u4tmp = 0x%x\n", odm_get_bb_reg(p_dm_odm, REG_TX_IQK, MASKDWORD), u4tmp)); - - - /* 1 RX IQK */ - /* modify RXIQK mode table */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path-A Rx IQK modify RXIQK mode table 2!\n")); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, MASKH3BYTES, 0x000000); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_WE_LUT, RFREGOFFSETMASK, 0x800a0); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_RCK_OS, RFREGOFFSETMASK, 0x30000); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_TXPA_G1, RFREGOFFSETMASK, 0x0000f); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_TXPA_G2, RFREGOFFSETMASK, 0xf7ffa); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, MASKH3BYTES, 0x808000); - - /* IQK setting */ - odm_set_bb_reg(p_dm_odm, REG_RX_IQK, MASKDWORD, 0x01004800); - - /* path-A IQK setting */ - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_TONE_A, MASKDWORD, 0x30008c1c); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_TONE_A, MASKDWORD, 0x10008c1c); - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_PI_A, MASKDWORD, 0x82160c05); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_PI_A, MASKDWORD, 0x28160c05); - - /* LO calibration setting */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LO calibration setting!\n")); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_RSP, MASKDWORD, 0x0046a911); - - /* One shot, path A LOK & IQK */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("One shot, path A LOK & IQK!\n")); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_PTS, MASKDWORD, 0xf9000000); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_PTS, MASKDWORD, 0xf8000000); - - /* delay x ms */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("delay %d ms for One shot, path A LOK & IQK.\n", IQK_DELAY_TIME_88E)); - /* platform_stall_execution(IQK_DELAY_TIME_88E*1000); */ - ODM_delay_ms(IQK_DELAY_TIME_88E); - - /* Check failed */ - reg_eac = odm_get_bb_reg(p_dm_odm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xeac = 0x%x\n", reg_eac)); - reg_e94 = odm_get_bb_reg(p_dm_odm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe94 = 0x%x\n", reg_e94)); - reg_e9c = odm_get_bb_reg(p_dm_odm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe9c = 0x%x\n", reg_e9c)); - reg_ea4 = odm_get_bb_reg(p_dm_odm, REG_RX_POWER_BEFORE_IQK_A_2, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xea4 = 0x%x\n", reg_ea4)); - -#if 0 - if (!(reg_eac & BIT(28)) && - (((reg_e94 & 0x03FF0000) >> 16) != 0x142) && - (((reg_e9c & 0x03FF0000) >> 16) != 0x42)) - result |= 0x01; - else /* if Tx not OK, ignore Rx */ - return result; -#endif - - if (!(reg_eac & BIT(27)) && /* if Tx is OK, check whether Rx is OK */ - (((reg_ea4 & 0x03FF0000) >> 16) != 0x132) && - (((reg_eac & 0x03FF0000) >> 16) != 0x36)) - result |= 0x02; - else - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A Rx IQK fail!!\n")); - - return result; - - -} - -u8 /* bit0 = 1 => Tx OK, bit1 = 1 => Rx OK */ -phy_path_b_iqk_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm -#else - struct _ADAPTER *p_adapter -#endif -) -{ - u32 reg_eac, reg_eb4, reg_ebc, reg_ec4, reg_ecc; - u8 result = 0x00; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B IQK!\n")); - - /* One shot, path B LOK & IQK */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("One shot, path A LOK & IQK!\n")); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_CONT, MASKDWORD, 0x00000002); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_CONT, MASKDWORD, 0x00000000); - - /* delay x ms */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("delay %d ms for One shot, path B LOK & IQK.\n", IQK_DELAY_TIME_88E)); - /* platform_stall_execution(IQK_DELAY_TIME_88E*1000); */ - ODM_delay_ms(IQK_DELAY_TIME_88E); - - /* Check failed */ - reg_eac = odm_get_bb_reg(p_dm_odm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xeac = 0x%x\n", reg_eac)); - reg_eb4 = odm_get_bb_reg(p_dm_odm, REG_TX_POWER_BEFORE_IQK_B, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xeb4 = 0x%x\n", reg_eb4)); - reg_ebc = odm_get_bb_reg(p_dm_odm, REG_TX_POWER_AFTER_IQK_B, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xebc = 0x%x\n", reg_ebc)); - reg_ec4 = odm_get_bb_reg(p_dm_odm, REG_RX_POWER_BEFORE_IQK_B_2, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xec4 = 0x%x\n", reg_ec4)); - reg_ecc = odm_get_bb_reg(p_dm_odm, REG_RX_POWER_AFTER_IQK_B_2, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xecc = 0x%x\n", reg_ecc)); - - if (!(reg_eac & BIT(31)) && - (((reg_eb4 & 0x03FF0000) >> 16) != 0x142) && - (((reg_ebc & 0x03FF0000) >> 16) != 0x42)) - result |= 0x01; - else - return result; - - if (!(reg_eac & BIT(30)) && - (((reg_ec4 & 0x03FF0000) >> 16) != 0x132) && - (((reg_ecc & 0x03FF0000) >> 16) != 0x36)) - result |= 0x02; - else - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B Rx IQK fail!!\n")); - - - return result; - -} - -void -_phy_path_a_fill_iqk_matrix( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - bool is_iqk_ok, - s32 result[][8], - u8 final_candidate, - bool is_tx_only -) -{ - u32 oldval_0, X, TX0_A, reg; - s32 Y, TX0_C; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A 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_odm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKDWORD) >> 22) & 0x3FF; - - X = result[final_candidate][0]; - if ((X & 0x00000200) != 0) - X = X | 0xFFFFFC00; - TX0_A = (X * oldval_0) >> 8; - ODM_RT_TRACE(p_dm_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_set_bb_reg(p_dm_odm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, 0x3FF, TX0_A); - - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_ECCA_THRESHOLD, BIT(31), ((X * oldval_0 >> 7) & 0x1)); - - Y = result[final_candidate][1]; - if ((Y & 0x00000200) != 0) - Y = Y | 0xFFFFFC00; - - - TX0_C = (Y * oldval_0) >> 8; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Y = 0x%x, TX = 0x%x\n", Y, TX0_C)); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XC_TX_AFE, 0xF0000000, ((TX0_C & 0x3C0) >> 6)); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, 0x003F0000, (TX0_C & 0x3F)); - - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_ECCA_THRESHOLD, BIT(29), ((Y * oldval_0 >> 7) & 0x1)); - - if (is_tx_only) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_path_a_fill_iqk_matrix 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_odm, REG_OFDM_0_XA_RX_IQ_IMBALANCE, 0x3FF, reg); - - reg = result[final_candidate][3] & 0x3F; - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XA_RX_IQ_IMBALANCE, 0xFC00, reg); - - reg = (result[final_candidate][3] >> 6) & 0xF; - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_RX_IQ_EXT_ANTA, 0xF0000000, reg); - } -} - -void -_phy_path_b_fill_iqk_matrix( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - bool is_iqk_ok, - s32 result[][8], - u8 final_candidate, - bool is_tx_only /* do Tx only */ -) -{ - u32 oldval_1, X, TX1_A, reg; - s32 Y, TX1_C; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B 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_odm, REG_OFDM_0_XB_TX_IQ_IMBALANCE, MASKDWORD) >> 22) & 0x3FF; - - X = result[final_candidate][4]; - if ((X & 0x00000200) != 0) - X = X | 0xFFFFFC00; - TX1_A = (X * oldval_1) >> 8; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("X = 0x%x, TX1_A = 0x%x\n", X, TX1_A)); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XB_TX_IQ_IMBALANCE, 0x3FF, TX1_A); - - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_ECCA_THRESHOLD, BIT(27), ((X * oldval_1 >> 7) & 0x1)); - - Y = result[final_candidate][5]; - if ((Y & 0x00000200) != 0) - Y = Y | 0xFFFFFC00; - - TX1_C = (Y * oldval_1) >> 8; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Y = 0x%x, TX1_C = 0x%x\n", Y, TX1_C)); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XD_TX_AFE, 0xF0000000, ((TX1_C & 0x3C0) >> 6)); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XB_TX_IQ_IMBALANCE, 0x003F0000, (TX1_C & 0x3F)); - - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_ECCA_THRESHOLD, BIT(25), ((Y * oldval_1 >> 7) & 0x1)); - - if (is_tx_only) - return; - - reg = result[final_candidate][6]; - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XB_RX_IQ_IMBALANCE, 0x3FF, reg); - - reg = result[final_candidate][7] & 0x3F; - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XB_RX_IQ_IMBALANCE, 0xFC00, reg); - - reg = (result[final_candidate][7] >> 6) & 0xF; - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_AGC_RSSI_TABLE, 0x0000F000, reg); - } -} - -/* - * 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) -bool -odm_check_power_status( - struct _ADAPTER *adapter) -{ -#if 0 - /* HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); */ - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; - RT_RF_POWER_STATE rt_state; - PMGNT_INFO p_mgnt_info = &(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) { - ODM_RT_TRACE(p_dm_odm, COMP_INIT, DBG_LOUD, ("odm_check_power_status Return true, due to initadapter")); - return true; - } - - /* */ - /* 2011/07/19 MH We can not execute tx pwoer tracking/ LLC calibrate or IQK. */ - /* */ - rtw_hal_get_hwreg(adapter, HW_VAR_RF_STATE, (u8 *)(&rt_state)); - if (rtw_is_drv_stopped(padapter) || adapter->is_driver_is_going_to_pnp_set_power_sleep || rt_state == eRfOff) { - ODM_RT_TRACE(p_dm_odm, COMP_INIT, DBG_LOUD, ("odm_check_power_status Return false, due to drv_stop: %s /%d/%d\n", - rtw_is_drv_stopped(padapter) ? "True" : "False", adapter->is_driver_is_going_to_pnp_set_power_sleep, rt_state)); - return false; - } -#endif - return true; -} -#endif - -void -_phy_save_adda_registers( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - u32 *adda_reg, - u32 *adda_backup, - u32 register_num -) -{ - u32 i; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif - - if (odm_check_power_status(p_adapter) == false) - return; -#endif - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Save ADDA parameters.\n")); - for (i = 0 ; i < register_num ; i++) - adda_backup[i] = odm_get_bb_reg(p_dm_odm, adda_reg[i], MASKDWORD); -} - - -void -_phy_save_mac_registers( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - u32 *mac_reg, - u32 *mac_backup -) -{ - u32 i; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Save MAC parameters.\n")); - for (i = 0 ; i < (IQK_MAC_REG_NUM - 1); i++) - mac_backup[i] = odm_read_1byte(p_dm_odm, mac_reg[i]); - mac_backup[i] = odm_read_4byte(p_dm_odm, mac_reg[i]); - -} - - -void -_phy_reload_adda_registers( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - u32 *adda_reg, - u32 *adda_backup, - u32 regiester_num -) -{ - u32 i; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - - ODM_RT_TRACE(p_dm_odm, 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_odm, adda_reg[i], MASKDWORD, adda_backup[i]); -} - -void -_phy_reload_mac_registers( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - u32 *mac_reg, - u32 *mac_backup -) -{ - u32 i; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - ODM_RT_TRACE(p_dm_odm, 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_odm, mac_reg[i], (u8)mac_backup[i]); - odm_write_4byte(p_dm_odm, mac_reg[i], mac_backup[i]); -} - - -void -_phy_path_adda_on( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - u32 *adda_reg, - bool is_path_a_on, - bool is2T -) -{ - u32 path_on; - u32 i; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("ADDA ON.\n")); - - path_on = is_path_a_on ? 0x04db25a4 : 0x0b1b25a4; - if (false == is2T) { - path_on = 0x0bdb25a0; - odm_set_bb_reg(p_dm_odm, adda_reg[0], MASKDWORD, 0x0b1b25a0); - } else - odm_set_bb_reg(p_dm_odm, adda_reg[0], MASKDWORD, path_on); - - for (i = 1 ; i < IQK_ADDA_REG_NUM ; i++) - odm_set_bb_reg(p_dm_odm, adda_reg[i], MASKDWORD, path_on); - -} - -void -_phy_mac_setting_calibration( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - u32 *mac_reg, - u32 *mac_backup -) -{ - u32 i = 0; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("MAC settings for Calibration.\n")); - - odm_write_1byte(p_dm_odm, mac_reg[i], 0x3F); - - for (i = 1 ; i < (IQK_MAC_REG_NUM - 1); i++) - odm_write_1byte(p_dm_odm, mac_reg[i], (u8)(mac_backup[i] & (~BIT(3)))); - odm_write_1byte(p_dm_odm, mac_reg[i], (u8)(mac_backup[i] & (~BIT(5)))); - -} - -void -_phy_path_a_stand_by( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm -#else - struct _ADAPTER *p_adapter -#endif -) -{ -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path-A standby mode!\n")); - - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, MASKH3BYTES, 0x0); - odm_set_bb_reg(p_dm_odm, 0x840, MASKDWORD, 0x00010000); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, MASKH3BYTES, 0x808000); -} - -void -_phy_pi_mode_switch( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - bool pi_mode -) -{ - u32 mode; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BB Switch to %s mode!\n", (pi_mode ? "PI" : "SI"))); - - mode = pi_mode ? 0x01000100 : 0x01000000; - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XA_HSSI_PARAMETER1, MASKDWORD, mode); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XB_HSSI_PARAMETER1, MASKDWORD, mode); -} - -bool -phy_simularity_compare_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - s32 result[][8], - u8 c1, - u8 c2 -) -{ - u32 i, j, diff, simularity_bit_map, bound = 0; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - u8 final_candidate[2] = {0xFF, 0xFF}; /* for path A and path B */ - bool is_result = true; -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - bool is2T = IS_2T2R(p_hal_data->version_id); -#else - bool is2T = 0; -#endif - - if (is2T) - bound = 8; - else - bound = 4; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("===> IQK:phy_simularity_compare_8188e c1 %d c2 %d!!!\n", c1, c2)); - - - simularity_bit_map = 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) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK:phy_simularity_compare_8188e differnece overflow index %d compare1 0x%x compare2 0x%x!!!\n", 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, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK:phy_simularity_compare_8188e simularity_bit_map %d !!!\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 & 0x0F)) { /* path A OK */ - for (i = 0; i < 4; i++) - result[3][i] = result[c1][i]; - return false; - } else if (!(simularity_bit_map & 0xF0) && is2T) { /* path B OK */ - for (i = 4; i < 8; i++) - result[3][i] = result[c1][i]; - return false; - } else - return false; - -} - - - -void -_phy_iq_calibrate_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - s32 result[][8], - u8 t, - bool 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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - u32 i; - u8 path_aok = 0, path_bok = 0; - 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 - }; - - /* since 92C & 92D have the different define in IQK_BB_REG */ - 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 retry_count = 2; - - if (p_dm_odm->mp_mode == true) - retry_count = 9; - - /* Note: IQ calibration must be performed after loading */ - /* PHY_REG.txt , and radio_a, radio_b.txt */ - - /* u32 bbvalue; */ - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -#ifdef MP_TEST - if (p_dm_odm->priv->pshare->rf_ft_var.mp_specific) - retry_count = 9; -#endif -#endif - - - if (t == 0) { - /* bbvalue = odm_get_bb_reg(p_dm_odm, REG_FPGA0_RFMOD, MASKDWORD); - * RT_DISP(FINIT, INIT_IQK, ("_phy_iq_calibrate_8188e()==>0x%08x\n",bbvalue)); */ - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQ Calibration for %s for %d times\n", (is2T ? "2T2R" : "1T1R"), t)); - - /* Save ADDA parameters, turn path A ADDA on */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_save_adda_registers(p_adapter, ADDA_REG, p_dm_odm->rf_calibrate_info.ADDA_backup, IQK_ADDA_REG_NUM); - _phy_save_mac_registers(p_adapter, IQK_MAC_REG, p_dm_odm->rf_calibrate_info.IQK_MAC_backup); - _phy_save_adda_registers(p_adapter, IQK_BB_REG_92C, p_dm_odm->rf_calibrate_info.IQK_BB_backup, IQK_BB_REG_NUM); -#else - _phy_save_adda_registers(p_dm_odm, ADDA_REG, p_dm_odm->rf_calibrate_info.ADDA_backup, IQK_ADDA_REG_NUM); - _phy_save_mac_registers(p_dm_odm, IQK_MAC_REG, p_dm_odm->rf_calibrate_info.IQK_MAC_backup); - _phy_save_adda_registers(p_dm_odm, IQK_BB_REG_92C, p_dm_odm->rf_calibrate_info.IQK_BB_backup, IQK_BB_REG_NUM); -#endif - } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQ Calibration for %s for %d times\n", (is2T ? "2T2R" : "1T1R"), t)); - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - - _phy_path_adda_on(p_adapter, ADDA_REG, true, is2T); -#else - _phy_path_adda_on(p_dm_odm, ADDA_REG, true, is2T); -#endif - - - if (t == 0) - p_dm_odm->rf_calibrate_info.is_rf_pi_enable = (u8)odm_get_bb_reg(p_dm_odm, REG_FPGA0_XA_HSSI_PARAMETER1, BIT(8)); - - if (!p_dm_odm->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(p_adapter, true); -#else - _phy_pi_mode_switch(p_dm_odm, true); -#endif - } - - - /* MAC settings */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_mac_setting_calibration(p_adapter, IQK_MAC_REG, p_dm_odm->rf_calibrate_info.IQK_MAC_backup); -#else - _phy_mac_setting_calibration(p_dm_odm, IQK_MAC_REG, p_dm_odm->rf_calibrate_info.IQK_MAC_backup); -#endif - - /* BB setting */ - /* odm_set_bb_reg(p_dm_odm, REG_FPGA0_RFMOD, BIT24, 0x00); */ - odm_set_bb_reg(p_dm_odm, REG_CCK_0_AFE_SETTING, 0x0f000000, 0xf); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_TRX_PATH_ENABLE, MASKDWORD, 0x03a05600); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_TR_MUX_PAR, MASKDWORD, 0x000800e4); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XCD_RF_INTERFACE_SW, MASKDWORD, 0x22204000); - - - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XAB_RF_INTERFACE_SW, BIT(10), 0x01); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XAB_RF_INTERFACE_SW, BIT(26), 0x01); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XA_RF_INTERFACE_OE, BIT(10), 0x00); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(10), 0x00); - - - if (is2T) { - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XA_LSSI_PARAMETER, MASKDWORD, 0x00010000); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XB_LSSI_PARAMETER, MASKDWORD, 0x00010000); - } - - /* Page B init */ - /* AP or IQK */ - odm_set_bb_reg(p_dm_odm, REG_CONFIG_ANT_A, MASKDWORD, 0x0f600000); - - if (is2T) - odm_set_bb_reg(p_dm_odm, REG_CONFIG_ANT_B, MASKDWORD, 0x0f600000); - - /* IQ calibration setting */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK setting!\n")); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, MASKH3BYTES, 0x808000); - odm_set_bb_reg(p_dm_odm, REG_TX_IQK, MASKDWORD, 0x01007c00); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK, MASKDWORD, 0x81004800); - - for (i = 0 ; i < retry_count ; i++) { -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - path_aok = phy_path_a_iqk_8188e(p_adapter, is2T); -#else - path_aok = phy_path_a_iqk_8188e(p_dm_odm, is2T); -#endif - /* if(path_aok == 0x03){ */ - if (path_aok == 0x01) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A Tx IQK Success!!\n")); - result[t][0] = (odm_get_bb_reg(p_dm_odm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD) & 0x3FF0000) >> 16; - result[t][1] = (odm_get_bb_reg(p_dm_odm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD) & 0x3FF0000) >> 16; - break; - } -#if 0 - else if (i == (retry_count - 1) && path_aok == 0x01) { /* Tx IQK OK */ - RT_DISP(FINIT, INIT_IQK, ("path A IQK Only Tx Success!!\n")); - - result[t][0] = (odm_get_bb_reg(p_dm_odm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD) & 0x3FF0000) >> 16; - result[t][1] = (odm_get_bb_reg(p_dm_odm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD) & 0x3FF0000) >> 16; - } -#endif - } - - for (i = 0 ; i < retry_count ; i++) { -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - path_aok = phy_path_a_rx_iqk(p_adapter, is2T); -#else - path_aok = phy_path_a_rx_iqk(p_dm_odm, is2T); -#endif - if (path_aok == 0x03) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A Rx IQK Success!!\n")); - /* result[t][0] = (odm_get_bb_reg(p_dm_odm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD)&0x3FF0000)>>16; - * result[t][1] = (odm_get_bb_reg(p_dm_odm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD)&0x3FF0000)>>16; */ - result[t][2] = (odm_get_bb_reg(p_dm_odm, REG_RX_POWER_BEFORE_IQK_A_2, MASKDWORD) & 0x3FF0000) >> 16; - result[t][3] = (odm_get_bb_reg(p_dm_odm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD) & 0x3FF0000) >> 16; - break; - } else - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A Rx IQK Fail!!\n")); - } - - if (0x00 == path_aok) - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A IQK failed!!\n")); - - if (is2T) { -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_path_a_stand_by(p_adapter); - - /* Turn path B ADDA on */ - _phy_path_adda_on(p_adapter, ADDA_REG, false, is2T); -#else - _phy_path_a_stand_by(p_dm_odm); - - /* Turn path B ADDA on */ - _phy_path_adda_on(p_dm_odm, ADDA_REG, false, is2T); -#endif - - for (i = 0 ; i < retry_count ; i++) { -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - path_bok = phy_path_b_iqk_8188e(p_adapter); -#else - path_bok = phy_path_b_iqk_8188e(p_dm_odm); -#endif - if (path_bok == 0x03) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B IQK Success!!\n")); - result[t][4] = (odm_get_bb_reg(p_dm_odm, REG_TX_POWER_BEFORE_IQK_B, MASKDWORD) & 0x3FF0000) >> 16; - result[t][5] = (odm_get_bb_reg(p_dm_odm, REG_TX_POWER_AFTER_IQK_B, MASKDWORD) & 0x3FF0000) >> 16; - result[t][6] = (odm_get_bb_reg(p_dm_odm, REG_RX_POWER_BEFORE_IQK_B_2, MASKDWORD) & 0x3FF0000) >> 16; - result[t][7] = (odm_get_bb_reg(p_dm_odm, REG_RX_POWER_AFTER_IQK_B_2, MASKDWORD) & 0x3FF0000) >> 16; - break; - } else if (i == (retry_count - 1) && path_bok == 0x01) { /* Tx IQK OK */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B Only Tx IQK Success!!\n")); - result[t][4] = (odm_get_bb_reg(p_dm_odm, REG_TX_POWER_BEFORE_IQK_B, MASKDWORD) & 0x3FF0000) >> 16; - result[t][5] = (odm_get_bb_reg(p_dm_odm, REG_TX_POWER_AFTER_IQK_B, MASKDWORD) & 0x3FF0000) >> 16; - } - } - - if (0x00 == path_bok) - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B IQK failed!!\n")); - } - - /* Back to BB mode, load original value */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK:Back to BB mode, load original value!\n")); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, MASKH3BYTES, 0); - - if (t != 0) { - if (!p_dm_odm->rf_calibrate_info.is_rf_pi_enable) { - /* Switch back BB to SI mode after finish IQ Calibration. */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_pi_mode_switch(p_adapter, false); -#else - _phy_pi_mode_switch(p_dm_odm, false); -#endif - } -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - - /* Reload ADDA power saving parameters */ - _phy_reload_adda_registers(p_adapter, ADDA_REG, p_dm_odm->rf_calibrate_info.ADDA_backup, IQK_ADDA_REG_NUM); - - /* Reload MAC parameters */ - _phy_reload_mac_registers(p_adapter, IQK_MAC_REG, p_dm_odm->rf_calibrate_info.IQK_MAC_backup); - - _phy_reload_adda_registers(p_adapter, IQK_BB_REG_92C, p_dm_odm->rf_calibrate_info.IQK_BB_backup, IQK_BB_REG_NUM); -#else - /* Reload ADDA power saving parameters */ - _phy_reload_adda_registers(p_dm_odm, ADDA_REG, p_dm_odm->rf_calibrate_info.ADDA_backup, IQK_ADDA_REG_NUM); - - /* Reload MAC parameters */ - _phy_reload_mac_registers(p_dm_odm, IQK_MAC_REG, p_dm_odm->rf_calibrate_info.IQK_MAC_backup); - - _phy_reload_adda_registers(p_dm_odm, IQK_BB_REG_92C, p_dm_odm->rf_calibrate_info.IQK_BB_backup, IQK_BB_REG_NUM); -#endif - - - /* Restore RX initial gain */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XA_LSSI_PARAMETER, MASKDWORD, 0x00032ed3); - if (is2T) - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XB_LSSI_PARAMETER, MASKDWORD, 0x00032ed3); - - /* load 0xe30 IQC default value */ - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_TONE_A, MASKDWORD, 0x01008c00); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_TONE_A, MASKDWORD, 0x01008c00); - - } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_iq_calibrate_8188e() <==\n")); - -} - - -void -_phy_lc_calibrate_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - bool is2T -) -{ - u8 tmp_reg; - u32 rf_amode = 0, rf_bmode = 0, lc_cal; -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - struct _ADAPTER *p_adapter = p_dm_odm->adapter; -#endif - /* Check continuous TX and Packet TX */ - tmp_reg = odm_read_1byte(p_dm_odm, 0xd03); - - if ((tmp_reg & 0x70) != 0) /* Deal with contisuous TX case */ - odm_write_1byte(p_dm_odm, 0xd03, tmp_reg & 0x8F); /* disable all continuous TX */ - else /* Deal with Packet TX case */ - odm_write_1byte(p_dm_odm, REG_TXPAUSE, 0xFF); /* block all queues */ - - if ((tmp_reg & 0x70) != 0) { - /* 1. Read original RF mode */ - /* path-A */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - rf_amode = phy_query_rf_reg(p_adapter, ODM_RF_PATH_A, RF_AC, MASK12BITS); - - /* path-B */ - if (is2T) - rf_bmode = phy_query_rf_reg(p_adapter, ODM_RF_PATH_B, RF_AC, MASK12BITS); -#else - rf_amode = odm_get_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_AC, MASK12BITS); - - /* path-B */ - if (is2T) - rf_bmode = odm_get_rf_reg(p_dm_odm, ODM_RF_PATH_B, RF_AC, MASK12BITS); -#endif - - /* 2. Set RF mode = standby mode */ - /* path-A */ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_AC, MASK12BITS, (rf_amode & 0x8FFFF) | 0x10000); - - /* path-B */ - if (is2T) - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, RF_AC, MASK12BITS, (rf_bmode & 0x8FFFF) | 0x10000); - } - - /* 3. Read RF reg18 */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - lc_cal = phy_query_rf_reg(p_adapter, ODM_RF_PATH_A, RF_CHNLBW, MASK12BITS); -#else - lc_cal = odm_get_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_CHNLBW, MASK12BITS); -#endif - - /* 4. Set LC calibration begin bit15 */ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_CHNLBW, MASK12BITS, lc_cal | 0x08000); - - ODM_delay_ms(100); - - - /* Restore original situation */ - if ((tmp_reg & 0x70) != 0) { /* Deal with contisuous TX case */ - /* path-A */ - odm_write_1byte(p_dm_odm, 0xd03, tmp_reg); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_AC, MASK12BITS, rf_amode); - - /* path-B */ - if (is2T) - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, RF_AC, MASK12BITS, rf_bmode); - } else /* Deal with Packet TX case */ - odm_write_1byte(p_dm_odm, REG_TXPAUSE, 0x00); -} - -/* Analog Pre-distortion calibration */ -#define APK_BB_REG_NUM 8 -#define APK_CURVE_REG_NUM 4 -#define PATH_NUM 2 - -void -_phy_ap_calibrate_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - s8 delta, - bool 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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - u32 reg_d[PATH_NUM]; - u32 tmp_reg, index, offset, apkbound; - u8 path, i, pathbound = PATH_NUM; - u32 BB_backup[APK_BB_REG_NUM]; - u32 BB_REG[APK_BB_REG_NUM] = { - REG_FPGA1_TX_BLOCK, REG_OFDM_0_TRX_PATH_ENABLE, - REG_FPGA0_RFMOD, REG_OFDM_0_TR_MUX_PAR, - REG_FPGA0_XCD_RF_INTERFACE_SW, REG_FPGA0_XAB_RF_INTERFACE_SW, - REG_FPGA0_XA_RF_INTERFACE_OE, REG_FPGA0_XB_RF_INTERFACE_OE - }; - u32 BB_AP_MODE[APK_BB_REG_NUM] = { - 0x00000020, 0x00a05430, 0x02040000, - 0x000800e4, 0x00204000 - }; - u32 BB_normal_AP_MODE[APK_BB_REG_NUM] = { - 0x00000020, 0x00a05430, 0x02040000, - 0x000800e4, 0x22204000 - }; - - u32 AFE_backup[IQK_ADDA_REG_NUM]; - u32 AFE_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 MAC_backup[IQK_MAC_REG_NUM]; - u32 MAC_REG[IQK_MAC_REG_NUM] = { - REG_TXPAUSE, REG_BCN_CTRL, - REG_BCN_CTRL_1, REG_GPIO_MUXCFG - }; - - u32 APK_RF_init_value[PATH_NUM][APK_BB_REG_NUM] = { - {0x0852c, 0x1852c, 0x5852c, 0x1852c, 0x5852c}, - {0x2852e, 0x0852e, 0x3852e, 0x0852e, 0x0852e} - }; - - u32 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} - }; - - u32 APK_RF_value_0[PATH_NUM][APK_BB_REG_NUM] = { - {0x52019, 0x52014, 0x52013, 0x5200f, 0x5208d}, - {0x5201a, 0x52019, 0x52016, 0x52033, 0x52050} - }; - - u32 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} - }; - - u32 AFE_on_off[PATH_NUM] = { - 0x04db25a4, 0x0b1b25a4 - }; /* path A on path B off / path A off path B on */ - - u32 APK_offset[PATH_NUM] = { - REG_CONFIG_ANT_A, REG_CONFIG_ANT_B - }; - - u32 APK_normal_offset[PATH_NUM] = { - REG_CONFIG_PMPD_ANT_A, REG_CONFIG_PMPD_ANT_B - }; - - u32 APK_value[PATH_NUM] = { - 0x92fc0000, 0x12fc0000 - }; - - u32 APK_normal_value[PATH_NUM] = { - 0x92680000, 0x12680000 - }; - - s8 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} - }; - - u32 APK_normal_setting_value_1[13] = { - 0x01017018, 0xf7ed8f84, 0x1b1a1816, 0x2522201e, 0x322e2b28, - 0x433f3a36, 0x5b544e49, 0x7b726a62, 0xa69a8f84, 0xdfcfc0b3, - 0x12680000, 0x00880000, 0x00880000 - }; - - u32 APK_normal_setting_value_2[16] = { - 0x01c7021d, 0x01670183, 0x01000123, 0x00bf00e2, 0x008d00a3, - 0x0068007b, 0x004d0059, 0x003a0042, 0x002b0031, 0x001f0025, - 0x0017001b, 0x00110014, 0x000c000f, 0x0009000b, 0x00070008, - 0x00050006 - }; - - u32 APK_result[PATH_NUM][APK_BB_REG_NUM]; /* val_1_1a, val_1_2a, val_2a, val_3a, val_4a - * u32 AP_curve[PATH_NUM][APK_CURVE_REG_NUM]; */ - - s32 BB_offset, delta_V, delta_offset; - -#if MP_DRIVER == 1 -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - PMPT_CONTEXT p_mpt_ctx = &(p_adapter->mppriv.mpt_ctx); -#else - PMPT_CONTEXT p_mpt_ctx = &(p_adapter->mpt_ctx); -#endif - - if (p_dm_odm->mp_mode == true) { - p_mpt_ctx->APK_bound[0] = 45; - p_mpt_ctx->APK_bound[1] = 52; - } -#endif - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("==>_phy_ap_calibrate_8188e() delta %d\n", delta)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("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 */ - if (p_dm_odm->mp_mode == false) - 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] = odm_get_bb_reg(p_dm_odm, BB_REG[index], MASKDWORD); - } - - /* save MAC default value */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_save_mac_registers(p_adapter, MAC_REG, MAC_backup); - - /* save AFE default value */ - _phy_save_adda_registers(p_adapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -#else - _phy_save_mac_registers(p_dm_odm, MAC_REG, MAC_backup); - - /* save AFE default value */ - _phy_save_adda_registers(p_dm_odm, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -#endif - - for (path = 0; path < pathbound; path++) { - - - if (path == ODM_RF_PATH_A) { - /* path A APK */ - /* load APK setting */ - /* path-A */ - offset = REG_PDP_ANT_A; - for (index = 0; index < 11; index++) { - odm_set_bb_reg(p_dm_odm, offset, MASKDWORD, APK_normal_setting_value_1[index]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0x%x value 0x%x\n", offset, odm_get_bb_reg(p_dm_odm, offset, MASKDWORD))); - - offset += 0x04; - } - - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x12680000); - - offset = REG_CONFIG_ANT_A; - for (; index < 13; index++) { - odm_set_bb_reg(p_dm_odm, offset, MASKDWORD, APK_normal_setting_value_1[index]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0x%x value 0x%x\n", offset, odm_get_bb_reg(p_dm_odm, offset, MASKDWORD))); - - offset += 0x04; - } - - /* page-B1 */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, MASKH3BYTES, 0x400000); - - /* path A */ - offset = REG_PDP_ANT_A; - for (index = 0; index < 16; index++) { - odm_set_bb_reg(p_dm_odm, offset, MASKDWORD, APK_normal_setting_value_2[index]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0x%x value 0x%x\n", offset, odm_get_bb_reg(p_dm_odm, offset, MASKDWORD))); - - offset += 0x04; - } - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, MASKH3BYTES, 0x000000); - } else if (path == ODM_RF_PATH_B) { - /* path B APK */ - /* load APK setting */ - /* path-B */ - offset = REG_PDP_ANT_B; - for (index = 0; index < 10; index++) { - odm_set_bb_reg(p_dm_odm, offset, MASKDWORD, APK_normal_setting_value_1[index]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0x%x value 0x%x\n", offset, odm_get_bb_reg(p_dm_odm, offset, MASKDWORD))); - - offset += 0x04; - } - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_A, MASKDWORD, 0x12680000); -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - phy_set_bb_reg(p_adapter, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x12680000); -#else - phy_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x12680000); -#endif - - offset = REG_CONFIG_ANT_A; - index = 11; - for (; index < 13; index++) { /* offset 0xb68, 0xb6c */ - odm_set_bb_reg(p_dm_odm, offset, MASKDWORD, APK_normal_setting_value_1[index]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0x%x value 0x%x\n", offset, odm_get_bb_reg(p_dm_odm, offset, MASKDWORD))); - - offset += 0x04; - } - - /* page-B1 */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, MASKH3BYTES, 0x400000); - - /* path B */ - offset = 0xb60; - for (index = 0; index < 16; index++) { - odm_set_bb_reg(p_dm_odm, offset, MASKDWORD, APK_normal_setting_value_2[index]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0x%x value 0x%x\n", offset, odm_get_bb_reg(p_dm_odm, offset, MASKDWORD))); - - offset += 0x04; - } - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, MASKH3BYTES, 0); - } - - /* save RF default value */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - reg_d[path] = phy_query_rf_reg(p_adapter, path, RF_TXBIAS_A, MASKDWORD); -#else - reg_d[path] = odm_get_rf_reg(p_dm_odm, (enum odm_rf_radio_path_e)path, RF_TXBIAS_A, MASKDWORD); -#endif - - /* path A AFE all on, path B AFE All off or vise versa */ - for (index = 0; index < IQK_ADDA_REG_NUM ; index++) - odm_set_bb_reg(p_dm_odm, AFE_REG[index], MASKDWORD, AFE_on_off[path]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0xe70 %x\n", odm_get_bb_reg(p_dm_odm, REG_RX_WAIT_CCA, MASKDWORD))); - - /* 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) - odm_set_bb_reg(p_dm_odm, BB_REG[index], MASKDWORD, BB_AP_MODE[index]); - else if (BB_REG[index] == 0x870) - odm_set_bb_reg(p_dm_odm, BB_REG[index], MASKDWORD, BB_backup[index] | BIT(10) | BIT(26)); - else - odm_set_bb_reg(p_dm_odm, BB_REG[index], BIT(10), 0x0); - } - - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_TONE_A, MASKDWORD, 0x01008c00); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_TONE_A, MASKDWORD, 0x01008c00); - } else { /* path B */ - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_TONE_B, MASKDWORD, 0x01008c00); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_TONE_B, MASKDWORD, 0x01008c00); - - } - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0x800 %x\n", odm_get_bb_reg(p_dm_odm, 0x800, MASKDWORD))); - - /* MAC settings */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_mac_setting_calibration(p_adapter, MAC_REG, MAC_backup); -#else - _phy_mac_setting_calibration(p_dm_odm, MAC_REG, MAC_backup); -#endif - - if (path == ODM_RF_PATH_A) /* path B to standby mode */ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, RF_AC, MASKDWORD, 0x10000); - else { /* path A to standby mode */ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_AC, MASKDWORD, 0x10000); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_MODE1, MASKDWORD, 0x1000f); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_MODE2, MASKDWORD, 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; - - tmp_reg = APK_RF_init_value[path][index]; -#if 1 - if (!p_dm_odm->rf_calibrate_info.is_apk_thermal_meter_ignore) { - BB_offset = (tmp_reg & 0xF0000) >> 16; - - if (!(tmp_reg & BIT(15))) /* sign bit 0 */ - BB_offset = -BB_offset; - - delta_V = APK_delta_mapping[index][delta_offset]; - - BB_offset += delta_V; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() APK index %d tmp_reg 0x%x delta_V %d delta_offset %d\n", index, tmp_reg, delta_V, delta_offset)); - - if (BB_offset < 0) { - tmp_reg = tmp_reg & (~BIT(15)); - BB_offset = -BB_offset; - } else - tmp_reg = tmp_reg | BIT(15); - tmp_reg = (tmp_reg & 0xFFF0FFFF) | (BB_offset << 16); - } -#endif - - odm_set_rf_reg(p_dm_odm, (enum odm_rf_radio_path_e)path, RF_IPA_A, MASKDWORD, 0x8992e); -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0xc %x\n", phy_query_rf_reg(p_adapter, path, RF_IPA_A, MASKDWORD))); - odm_set_rf_reg(p_dm_odm, (enum odm_rf_radio_path_e)path, RF_AC, MASKDWORD, APK_RF_value_0[path][index]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0x0 %x\n", phy_query_rf_reg(p_adapter, path, RF_AC, MASKDWORD))); - odm_set_rf_reg(p_dm_odm, (enum odm_rf_radio_path_e)path, RF_TXBIAS_A, MASKDWORD, tmp_reg); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0xd %x\n", phy_query_rf_reg(p_adapter, path, RF_TXBIAS_A, MASKDWORD))); -#else - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0xc %x\n", odm_get_rf_reg(p_dm_odm, path, RF_IPA_A, MASKDWORD))); - odm_set_rf_reg(p_dm_odm, path, RF_AC, MASKDWORD, APK_RF_value_0[path][index]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0x0 %x\n", odm_get_rf_reg(p_dm_odm, path, RF_AC, MASKDWORD))); - odm_set_rf_reg(p_dm_odm, path, RF_TXBIAS_A, MASKDWORD, tmp_reg); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0xd %x\n", odm_get_rf_reg(p_dm_odm, path, RF_TXBIAS_A, MASKDWORD))); -#endif - - /* PA11+PAD01111, one shot */ - i = 0; - do { - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, MASKH3BYTES, 0x800000); - { - odm_set_bb_reg(p_dm_odm, APK_offset[path], MASKDWORD, APK_value[0]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0x%x value 0x%x\n", APK_offset[path], odm_get_bb_reg(p_dm_odm, APK_offset[path], MASKDWORD))); - ODM_delay_ms(3); - odm_set_bb_reg(p_dm_odm, APK_offset[path], MASKDWORD, APK_value[1]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0x%x value 0x%x\n", APK_offset[path], odm_get_bb_reg(p_dm_odm, APK_offset[path], MASKDWORD))); - - ODM_delay_ms(20); - } - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, MASKH3BYTES, 0x000000); - - if (path == ODM_RF_PATH_A) - tmp_reg = odm_get_bb_reg(p_dm_odm, REG_APK, 0x03E00000); - else - tmp_reg = odm_get_bb_reg(p_dm_odm, REG_APK, 0xF8000000); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0xbd8[25:21] %x\n", tmp_reg)); - - - i++; - } while (tmp_reg > apkbound && i < 4); - - APK_result[path][index] = tmp_reg; - } - } - - /* reload MAC default value */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_reload_mac_registers(p_adapter, MAC_REG, MAC_backup); -#else - _phy_reload_mac_registers(p_dm_odm, MAC_REG, MAC_backup); -#endif - - /* reload BB default value */ - for (index = 0; index < APK_BB_REG_NUM ; index++) { - - if (index == 0) /* skip */ - continue; - odm_set_bb_reg(p_dm_odm, BB_REG[index], MASKDWORD, BB_backup[index]); - } - - /* reload AFE default value */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_reload_adda_registers(p_adapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -#else - _phy_reload_adda_registers(p_dm_odm, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -#endif - - /* reload RF path default value */ - for (path = 0; path < pathbound; path++) { - odm_set_rf_reg(p_dm_odm, (enum odm_rf_radio_path_e)path, 0xd, MASKDWORD, reg_d[path]); - if (path == ODM_RF_PATH_B) { - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_MODE1, MASKDWORD, 0x1000f); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_MODE2, MASKDWORD, 0x20101); - } - - /* note no index == 0 */ - if (APK_result[path][1] > 6) - APK_result[path][1] = 6; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("apk path %d result %d 0x%x \t", path, 1, APK_result[path][1])); - } - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("\n")); - - - for (path = 0; path < pathbound; path++) { - odm_set_rf_reg(p_dm_odm, (enum odm_rf_radio_path_e)path, 0x3, MASKDWORD, - ((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_set_rf_reg(p_dm_odm, (enum odm_rf_radio_path_e)path, 0x4, MASKDWORD, - ((APK_result[path][1] << 15) | (APK_result[path][1] << 10) | (0x00 << 5) | 0x05)); - else - odm_set_rf_reg(p_dm_odm, (enum odm_rf_radio_path_e)path, 0x4, MASKDWORD, - ((APK_result[path][1] << 15) | (APK_result[path][1] << 10) | (0x02 << 5) | 0x05)); -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - odm_set_rf_reg(p_dm_odm, (enum odm_rf_radio_path_e)path, RF_BS_PA_APSET_G9_G11, MASKDWORD, - ((0x08 << 15) | (0x08 << 10) | (0x08 << 5) | 0x08)); -#endif - } - - p_dm_odm->rf_calibrate_info.is_ap_kdone = true; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<==_phy_ap_calibrate_8188e()\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_iq_calibrate_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - bool is_recovery -) -{ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#else /* (DM_ODM_SUPPORT_TYPE == ODM_CE) */ - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->odmpriv; -#endif - -#if (MP_DRIVER == 1) -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PMPT_CONTEXT p_mpt_ctx = &(p_adapter->mpt_ctx); -#else/* (DM_ODM_SUPPORT_TYPE == ODM_CE) */ - PMPT_CONTEXT p_mpt_ctx = &(p_adapter->mppriv.mpt_ctx); -#endif -#endif/* (MP_DRIVER == 1) */ -#endif - - s32 result[4][8]; /* last is final result */ - u8 i, final_candidate, indexforchannel; - u8 channel_to_iqk = 7; - bool is_patha_ok, is_pathb_ok; - s32 rege94, rege9c, regea4, regeac, regeb4, regebc, regec4, regecc, reg_tmp = 0; - bool is12simular, is13simular, is23simular; - bool is_start_cont_tx = false, is_single_tone = false, is_carrier_suppression = false; - 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 start_time; - s32 progressing_time; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - if (odm_check_power_status(p_adapter) == false) - return; -#else - struct rtl8192cd_priv *priv = p_dm_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) - is_recovery = 1; - priv->pshare->IQK_88E_done = 1; - -#endif - -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - if (!(p_dm_odm->support_ability & ODM_RF_CALIBRATION)) - return; -#endif - -#if MP_DRIVER == 1 - if (p_dm_odm->mp_mode == true) { - is_start_cont_tx = p_mpt_ctx->is_start_cont_tx; - is_single_tone = p_mpt_ctx->is_single_tone; - is_carrier_suppression = p_mpt_ctx->is_carrier_suppression; - } -#endif - - /* 20120213 Turn on when continuous Tx to pass lab testing. (required by Edlu) */ - if (is_single_tone || is_carrier_suppression) - return; - -#if DISABLE_BB_RF - return; -#endif - - if (p_dm_odm->rf_calibrate_info.is_iqk_in_progress) - return; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_AP)) - if (is_recovery) -#else/* for ODM_WIN */ - if (is_recovery && (!p_adapter->is_in_hct_test)) /* YJ,add for PowerTest,120405 */ -#endif - { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("phy_iq_calibrate_8188e: Return due to is_recovery!\n")); -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_reload_adda_registers(p_adapter, IQK_BB_REG_92C, p_dm_odm->rf_calibrate_info.IQK_BB_backup_recover, 9); -#else - _phy_reload_adda_registers(p_dm_odm, IQK_BB_REG_92C, p_dm_odm->rf_calibrate_info.IQK_BB_backup_recover, 9); -#endif - return; - } - - - odm_acquire_spin_lock(p_dm_odm, RT_IQK_SPINLOCK); - p_dm_odm->rf_calibrate_info.is_iqk_in_progress = true; - odm_release_spin_lock(p_dm_odm, RT_IQK_SPINLOCK); - - - - start_time = odm_get_current_time(p_dm_odm); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("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; - is_patha_ok = false; - is_pathb_ok = false; - is12simular = false; - is23simular = false; - is13simular = false; - - - for (i = 0; i < 3; i++) { - { - /* For 88C 1T1R */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_iq_calibrate_8188e(p_adapter, result, i, false); -#else - _phy_iq_calibrate_8188e(p_dm_odm, result, i, false); -#endif - } - - if (i == 1) { -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - is12simular = phy_simularity_compare_8188e(p_adapter, result, 0, 1); -#else - is12simular = phy_simularity_compare_8188e(p_dm_odm, result, 0, 1); -#endif - if (is12simular) { - final_candidate = 0; - ODM_RT_TRACE(p_dm_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_simularity_compare_8188e(p_adapter, result, 0, 2); -#else - is13simular = phy_simularity_compare_8188e(p_dm_odm, result, 0, 2); -#endif - if (is13simular) { - final_candidate = 0; - ODM_RT_TRACE(p_dm_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_simularity_compare_8188e(p_adapter, result, 1, 2); -#else - is23simular = phy_simularity_compare_8188e(p_dm_odm, result, 1, 2); -#endif - if (is23simular) { - final_candidate = 1; - ODM_RT_TRACE(p_dm_odm, 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; - } - } - } - /* RT_TRACE(COMP_INIT,DBG_LOUD,("Release Mutex in IQCalibrate\n")); */ - - 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]; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("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) { - p_dm_odm->rf_calibrate_info.rege94 = rege94 = result[final_candidate][0]; - p_dm_odm->rf_calibrate_info.rege9c = rege9c = result[final_candidate][1]; - regea4 = result[final_candidate][2]; - regeac = result[final_candidate][3]; - p_dm_odm->rf_calibrate_info.regeb4 = regeb4 = result[final_candidate][4]; - p_dm_odm->rf_calibrate_info.regebc = regebc = result[final_candidate][5]; - regec4 = result[final_candidate][6]; - regecc = result[final_candidate][7]; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK: final_candidate is %x\n", final_candidate)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("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)); - is_patha_ok = is_pathb_ok = true; - } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK: FAIL use default value\n")); - - p_dm_odm->rf_calibrate_info.rege94 = p_dm_odm->rf_calibrate_info.regeb4 = 0x100; /* X default value */ - p_dm_odm->rf_calibrate_info.rege9c = p_dm_odm->rf_calibrate_info.regebc = 0x0; /* Y default value */ - } - - if ((rege94 != 0)/*&&(regea4 != 0)*/) { -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_path_a_fill_iqk_matrix(p_adapter, is_patha_ok, result, final_candidate, (regea4 == 0)); -#else - _phy_path_a_fill_iqk_matrix(p_dm_odm, is_patha_ok, result, final_candidate, (regea4 == 0)); -#endif - } - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - indexforchannel = odm_get_right_chnl_place_for_iqk(*p_dm_odm->p_channel); -#else - indexforchannel = 0; -#endif - - /* To Fix BSOD when final_candidate is 0xff - * by sherry 20120321 */ - if (final_candidate < 4) { - for (i = 0; i < iqk_matrix_reg_num; i++) - p_dm_odm->rf_calibrate_info.iqk_matrix_reg_setting[indexforchannel].value[0][i] = result[final_candidate][i]; - p_dm_odm->rf_calibrate_info.iqk_matrix_reg_setting[indexforchannel].is_iqk_done = true; - } - /* RT_DISP(FINIT, INIT_IQK, ("\nIQK OK indexforchannel %d.\n", indexforchannel)); */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("\nIQK OK indexforchannel %d.\n", indexforchannel)); -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - - _phy_save_adda_registers(p_adapter, IQK_BB_REG_92C, p_dm_odm->rf_calibrate_info.IQK_BB_backup_recover, 9); -#else - _phy_save_adda_registers(p_dm_odm, IQK_BB_REG_92C, p_dm_odm->rf_calibrate_info.IQK_BB_backup_recover, IQK_BB_REG_NUM); -#endif - - odm_acquire_spin_lock(p_dm_odm, RT_IQK_SPINLOCK); - p_dm_odm->rf_calibrate_info.is_iqk_in_progress = false; - odm_release_spin_lock(p_dm_odm, RT_IQK_SPINLOCK); - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK finished\n")); - progressing_time = odm_get_progressing_time(p_dm_odm, start_time); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK progressing_time = %d\n", progressing_time)); - -} - - -void -phy_lc_calibrate_8188e( - void *p_dm_void -) -{ - bool is_start_cont_tx = false, is_single_tone = false, is_carrier_suppression = false; - u32 timeout = 2000, timecount = 0; - u32 start_time; - s32 progressing_time; - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - struct _ADAPTER *p_adapter = p_dm_odm->adapter; - /* HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); */ - -#if (MP_DRIVER == 1) -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PMPT_CONTEXT p_mpt_ctx = &(p_adapter->mpt_ctx); -#else/* (DM_ODM_SUPPORT_TYPE == ODM_CE) */ - PMPT_CONTEXT p_mpt_ctx = &(p_adapter->mppriv.mpt_ctx); -#endif -#endif/* (MP_DRIVER == 1) */ -#endif - -#if MP_DRIVER == 1 - if (p_dm_odm->mp_mode == true) { - is_start_cont_tx = p_mpt_ctx->is_start_cont_tx; - is_single_tone = p_mpt_ctx->is_single_tone; - is_carrier_suppression = p_mpt_ctx->is_carrier_suppression; - } -#endif - - -#if DISABLE_BB_RF - return; -#endif - -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - if (!(p_dm_odm->support_ability & ODM_RF_CALIBRATION)) - return; -#endif - /* 20120213 Turn on when continuous Tx to pass lab testing. (required by Edlu) */ - if (is_single_tone || is_carrier_suppression) - return; - - start_time = odm_get_current_time(p_dm_odm); - while (*(p_dm_odm->p_is_scan_in_process) && timecount < timeout) { - ODM_delay_ms(50); - timecount += 50; - } - - p_dm_odm->rf_calibrate_info.is_lck_in_progress = true; - - /* ODM_RT_TRACE(p_dm_odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LCK:Start!!!interface %d currentband %x delay %d ms\n", p_dm_odm->interface_index, p_hal_data->CurrentBandType92D, timecount)); */ - _phy_lc_calibrate_8188e(p_dm_odm, false); - - p_dm_odm->rf_calibrate_info.is_lck_in_progress = false; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LCK:Finish!!!interface %d\n", p_dm_odm->interface_index)); - progressing_time = odm_get_progressing_time(p_dm_odm, start_time); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LCK progressing_time = %d\n", progressing_time)); -} - -#if 0 -void -phy_ap_calibrate_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - s8 delta -) -{ -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif -#if DISABLE_BB_RF - return; -#endif - -#if 0 -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - if (!(p_dm_odm->support_ability & ODM_RF_CALIBRATION)) - return; -#endif - -#if FOR_BRAZIL_PRETEST != 1 - if (p_dm_odm->rf_calibrate_info.is_ap_kdone) -#endif - return; - - { - /* For 88C 1T1R */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_ap_calibrate_8188e(p_adapter, delta, false); -#else - _phy_ap_calibrate_8188e(p_dm_odm, delta, false); -#endif - } -#endif -} -#endif - -void _phy_set_rf_path_switch_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - bool is_main, - bool 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_odm = &p_hal_data->odmpriv; -#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - if (!p_adapter->bHWInitReady) -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - if (!rtw_is_hw_init_completed(p_adapter)) -#endif - { - u8 u1b_tmp; - u1b_tmp = odm_read_1byte(p_dm_odm, REG_LEDCFG2) | BIT(7); - odm_write_1byte(p_dm_odm, REG_LEDCFG2, u1b_tmp); - /* odm_set_bb_reg(p_dm_odm, REG_LEDCFG0, BIT23, 0x01); */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XAB_RF_PARAMETER, BIT(13), 0x01); - } - -#endif - - if (is2T) { /* 92C */ - if (is_main) - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(5) | BIT6, 0x1); /* 92C_Path_A */ - else - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(5) | BIT6, 0x2); /* BT */ - } else { /* 88C */ - - /* <20120504, Kordan> [8188E] We should make AntDiversity controlled by HW (0x870[9:8] = 0), */ - /* otherwise the following action has no effect. (0x860[9:8] has the effect only if AntDiversity controlled by SW) */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XAB_RF_INTERFACE_SW, BIT(8) | BIT(9), 0x0); - odm_set_bb_reg(p_dm_odm, 0x914, MASKLWORD, 0x0201); /* Set up the ant mapping table */ - - if (is_main) { - /* odm_set_bb_reg(p_dm_odm, REG_FPGA0_XA_RF_INTERFACE_OE, BIT(8)|BIT9, 0x2); */ /* Tx Main (SW control)(The right antenna) */ - /* 4 [ Tx ] */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XA_RF_INTERFACE_OE, BIT(14) | BIT13 | BIT12, 0x1); /* Tx Main (HW control)(The right antenna) */ - - /* 4 [ Rx ] */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(5) | BIT4 | BIT3, 0x1); /* ant_div_type = TRDiv, right antenna */ - if (p_dm_odm->ant_div_type == CGCS_RX_HW_ANTDIV) - odm_set_bb_reg(p_dm_odm, REG_CONFIG_RAM64X16, BIT(31), 0x1); /* RxCG, Default is RxCG. ant_div_type = 2RDiv, left antenna */ - - } else { - /* odm_set_bb_reg(p_dm_odm, REG_FPGA0_XA_RF_INTERFACE_OE, BIT(8)|BIT9, 0x1); */ /* Tx Aux (SW control)(The left antenna) */ - /* 4 [ Tx ] */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XA_RF_INTERFACE_OE, BIT(14) | BIT13 | BIT12, 0x0); /* Tx Aux (HW control)(The left antenna) */ - - /* 4 [ Rx ] */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(5) | BIT4 | BIT3, 0x0); /* ant_div_type = TRDiv, left antenna */ - if (p_dm_odm->ant_div_type == CGCS_RX_HW_ANTDIV) - odm_set_bb_reg(p_dm_odm, REG_CONFIG_RAM64X16, BIT(31), 0x0); /* RxCS, ant_div_type = 2RDiv, right antenna */ - } - - } -} -void phy_set_rf_path_switch_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - bool is_main -) -{ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); -#endif - -#if DISABLE_BB_RF - return; -#endif - - { - /* For 88C 1T1R */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_set_rf_path_switch_8188e(p_adapter, is_main, false); -#else - _phy_set_rf_path_switch_8188e(p_dm_odm, is_main, false); -#endif - } -} - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -/* digital predistortion */ -void -phy_digital_predistortion( -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - struct _ADAPTER *p_adapter, -#else - struct PHY_DM_STRUCT *p_dm_odm, -#endif - bool is2T -) -{ -#if (RT_PLATFORM == PLATFORM_WINDOWS) -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - - u32 tmp_reg, tmp_reg2, index, i; - u8 path, pathbound = PATH_NUM; - u32 AFE_backup[IQK_ADDA_REG_NUM]; - u32 AFE_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 BB_backup[DP_BB_REG_NUM]; - u32 BB_REG[DP_BB_REG_NUM] = { - REG_OFDM_0_TRX_PATH_ENABLE, REG_FPGA0_RFMOD, - REG_OFDM_0_TR_MUX_PAR, REG_FPGA0_XCD_RF_INTERFACE_SW, - REG_FPGA0_XAB_RF_INTERFACE_SW, REG_FPGA0_XA_RF_INTERFACE_OE, - REG_FPGA0_XB_RF_INTERFACE_OE - }; - u32 BB_settings[DP_BB_REG_NUM] = { - 0x00a05430, 0x02040000, 0x000800e4, 0x22208000, - 0x0, 0x0, 0x0 - }; - - u32 RF_backup[DP_PATH_NUM][DP_RF_REG_NUM]; - u32 RF_REG[DP_RF_REG_NUM] = { - RF_TXBIAS_A - }; - - u32 MAC_backup[IQK_MAC_REG_NUM]; - u32 MAC_REG[IQK_MAC_REG_NUM] = { - REG_TXPAUSE, REG_BCN_CTRL, - REG_BCN_CTRL_1, REG_GPIO_MUXCFG - }; - - u32 tx_agc[DP_DPK_NUM][DP_DPK_VALUE_NUM] = { - {0x1e1e1e1e, 0x03901e1e}, - {0x18181818, 0x03901818}, - {0x0e0e0e0e, 0x03900e0e} - }; - - u32 AFE_on_off[PATH_NUM] = { - 0x04db25a4, 0x0b1b25a4 - }; /* path A on path B off / path A off path B on */ - - u8 retry_count = 0; - - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("==>phy_digital_predistortion()\n")); - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_digital_predistortion for %s\n", (is2T ? "2T2R" : "1T1R"))); - - /* save BB default value */ - for (index = 0; index < DP_BB_REG_NUM; index++) - BB_backup[index] = odm_get_bb_reg(p_dm_odm, BB_REG[index], MASKDWORD); - - /* save MAC default value */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_save_mac_registers(p_adapter, BB_REG, MAC_backup); -#else - _phy_save_mac_registers(p_dm_odm, BB_REG, MAC_backup); -#endif - - /* save RF default value */ - 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_query_rf_reg(p_adapter, path, RF_REG[index], MASKDWORD); -#else - RF_backup[path][index] = odm_get_rf_reg(p_adapter, path, RF_REG[index], MASKDWORD); -#endif - } - - /* save AFE default value */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_save_adda_registers(p_adapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -#else - _phy_save_adda_registers(p_dm_odm, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -#endif - - /* path A/B AFE all on */ - for (index = 0; index < IQK_ADDA_REG_NUM ; index++) - odm_set_bb_reg(p_dm_odm, AFE_REG[index], MASKDWORD, 0x6fdb25a4); - - /* BB register setting */ - for (index = 0; index < DP_BB_REG_NUM; index++) { - if (index < 4) - odm_set_bb_reg(p_dm_odm, BB_REG[index], MASKDWORD, BB_settings[index]); - else if (index == 4) - odm_set_bb_reg(p_dm_odm, BB_REG[index], MASKDWORD, BB_backup[index] | BIT(10) | BIT(26)); - else - odm_set_bb_reg(p_dm_odm, BB_REG[index], BIT(10), 0x00); - } - - /* MAC register setting */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_mac_setting_calibration(p_adapter, MAC_REG, MAC_backup); -#else - _phy_mac_setting_calibration(p_dm_odm, MAC_REG, MAC_backup); -#endif - - /* PAGE-E IQC setting */ - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_TONE_A, MASKDWORD, 0x01008c00); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_TONE_A, MASKDWORD, 0x01008c00); - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_TONE_B, MASKDWORD, 0x01008c00); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_TONE_B, MASKDWORD, 0x01008c00); - - /* path_A DPK */ - /* path B to standby mode */ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, RF_AC, MASKDWORD, 0x10000); - - /* PA gain = 11 & PAD1 => tx_agc 1f ~11 */ - /* PA gain = 11 & PAD2 => tx_agc 10~0e */ - /* PA gain = 01 => tx_agc 0b~0d */ - /* PA gain = 00 => tx_agc 0a~00 */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, MASKH3BYTES, 0x400000); - odm_set_bb_reg(p_dm_odm, 0xbc0, MASKDWORD, 0x0005361f); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, MASKH3BYTES, 0x000000); - - /* do inner loopback DPK 3 times */ - for (i = 0; i < 3; i++) { - /* PA gain = 11 & PAD2 => tx_agc = 0x0f/0x0c/0x07 */ - for (index = 0; index < 3; index++) - odm_set_bb_reg(p_dm_odm, 0xe00 + index * 4, MASKDWORD, tx_agc[i][0]); - odm_set_bb_reg(p_dm_odm, 0xe00 + index * 4, MASKDWORD, tx_agc[i][1]); - for (index = 0; index < 4; index++) - odm_set_bb_reg(p_dm_odm, 0xe10 + index * 4, MASKDWORD, tx_agc[i][0]); - - /* PAGE_B for path-A inner loopback DPK setting */ - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_A, MASKDWORD, 0x02097098); - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_A_4, MASKDWORD, 0xf76d9f84); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_A, MASKDWORD, 0x0004ab87); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_ANT_A, MASKDWORD, 0x00880000); - - /* ----send one shot signal---- */ - /* path A */ - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_A, MASKDWORD, 0x80047788); - ODM_delay_ms(1); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_A, MASKDWORD, 0x00047788); - ODM_delay_ms(50); - } - - /* PA gain = 11 => tx_agc = 1a */ - for (index = 0; index < 3; index++) - odm_set_bb_reg(p_dm_odm, 0xe00 + index * 4, MASKDWORD, 0x34343434); - odm_set_bb_reg(p_dm_odm, 0xe08 + index * 4, MASKDWORD, 0x03903434); - for (index = 0; index < 4; index++) - odm_set_bb_reg(p_dm_odm, 0xe10 + index * 4, MASKDWORD, 0x34343434); - - /* ==================================== */ - /* PAGE_B for path-A DPK setting */ - /* ==================================== */ - /* open inner loopback @ b00[19]:10 od 0xb00 0x01097018 */ - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_A, MASKDWORD, 0x02017098); - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_A_4, MASKDWORD, 0xf76d9f84); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_A, MASKDWORD, 0x0004ab87); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_ANT_A, MASKDWORD, 0x00880000); - - /* rf_lpbk_setup */ - /* 1.rf 00:5205a, rf 0d:0e52c */ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x0c, MASKDWORD, 0x8992b); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x0d, MASKDWORD, 0x0e52c); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x00, MASKDWORD, 0x5205a); - - /* ----send one shot signal---- */ - /* path A */ - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_A, MASKDWORD, 0x800477c0); - ODM_delay_ms(1); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_A, MASKDWORD, 0x000477c0); - ODM_delay_ms(50); - - while (retry_count < DP_RETRY_LIMIT && !p_dm_odm->rf_calibrate_info.is_dp_path_aok) { - /* ----read back measurement results---- */ - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_A, MASKDWORD, 0x0c297018); - tmp_reg = odm_get_bb_reg(p_dm_odm, 0xbe0, MASKDWORD); - ODM_delay_ms(10); - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_A, MASKDWORD, 0x0c29701f); - tmp_reg2 = odm_get_bb_reg(p_dm_odm, 0xbe8, MASKDWORD); - ODM_delay_ms(10); - - tmp_reg = (tmp_reg & MASKHWORD) >> 16; - tmp_reg2 = (tmp_reg2 & MASKHWORD) >> 16; - if (tmp_reg < 0xf0 || tmp_reg > 0x105 || tmp_reg2 > 0xff) { - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_A, MASKDWORD, 0x02017098); - - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, MASKH3BYTES, 0x800000); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, MASKH3BYTES, 0x000000); - ODM_delay_ms(1); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_A, MASKDWORD, 0x800477c0); - ODM_delay_ms(1); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_A, MASKDWORD, 0x000477c0); - ODM_delay_ms(50); - retry_count++; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A DPK retry_count %d 0xbe0[31:16] %x 0xbe8[31:16] %x\n", retry_count, tmp_reg, tmp_reg2)); - } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A DPK Sucess\n")); - p_dm_odm->rf_calibrate_info.is_dp_path_aok = true; - break; - } - } - retry_count = 0; - - /* DPP path A */ - if (p_dm_odm->rf_calibrate_info.is_dp_path_aok) { - /* DP settings */ - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_A, MASKDWORD, 0x01017098); - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_A_4, MASKDWORD, 0x776d9f84); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_A, MASKDWORD, 0x0004ab87); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_ANT_A, MASKDWORD, 0x00880000); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, MASKH3BYTES, 0x400000); - - for (i = REG_PDP_ANT_A; i <= 0xb3c; i += 4) { - odm_set_bb_reg(p_dm_odm, i, MASKDWORD, 0x40004000); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A ofsset = 0x%x\n", i)); - } - - /* pwsf */ - odm_set_bb_reg(p_dm_odm, 0xb40, MASKDWORD, 0x40404040); - odm_set_bb_reg(p_dm_odm, 0xb44, MASKDWORD, 0x28324040); - odm_set_bb_reg(p_dm_odm, 0xb48, MASKDWORD, 0x10141920); - - for (i = 0xb4c; i <= 0xb5c; i += 4) - odm_set_bb_reg(p_dm_odm, i, MASKDWORD, 0x0c0c0c0c); - - /* TX_AGC boundary */ - odm_set_bb_reg(p_dm_odm, 0xbc0, MASKDWORD, 0x0005361f); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, MASKH3BYTES, 0x000000); - } else { - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_A, MASKDWORD, 0x00000000); - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_A_4, MASKDWORD, 0x00000000); - } - - /* DPK path B */ - if (is2T) { - /* path A to standby mode */ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_AC, MASKDWORD, 0x10000); - - /* LUTs => tx_agc */ - /* PA gain = 11 & PAD1, => tx_agc 1f ~11 */ - /* PA gain = 11 & PAD2, => tx_agc 10 ~0e */ - /* PA gain = 01 => tx_agc 0b ~0d */ - /* PA gain = 00 => tx_agc 0a ~00 */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, MASKH3BYTES, 0x400000); - odm_set_bb_reg(p_dm_odm, 0xbc4, MASKDWORD, 0x0005361f); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, MASKH3BYTES, 0x000000); - - /* do inner loopback DPK 3 times */ - for (i = 0; i < 3; i++) { - /* PA gain = 11 & PAD2 => tx_agc = 0x0f/0x0c/0x07 */ - for (index = 0; index < 4; index++) - odm_set_bb_reg(p_dm_odm, 0x830 + index * 4, MASKDWORD, tx_agc[i][0]); - for (index = 0; index < 2; index++) - odm_set_bb_reg(p_dm_odm, 0x848 + index * 4, MASKDWORD, tx_agc[i][0]); - for (index = 0; index < 2; index++) - odm_set_bb_reg(p_dm_odm, 0x868 + index * 4, MASKDWORD, tx_agc[i][0]); - - /* PAGE_B for path-A inner loopback DPK setting */ - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_B, MASKDWORD, 0x02097098); - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_B_4, MASKDWORD, 0xf76d9f84); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x0004ab87); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_ANT_B, MASKDWORD, 0x00880000); - - /* ----send one shot signal---- */ - /* path B */ - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x80047788); - ODM_delay_ms(1); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x00047788); - ODM_delay_ms(50); - } - - /* PA gain = 11 => tx_agc = 1a */ - for (index = 0; index < 4; index++) - odm_set_bb_reg(p_dm_odm, 0x830 + index * 4, MASKDWORD, 0x34343434); - for (index = 0; index < 2; index++) - odm_set_bb_reg(p_dm_odm, 0x848 + index * 4, MASKDWORD, 0x34343434); - for (index = 0; index < 2; index++) - odm_set_bb_reg(p_dm_odm, 0x868 + index * 4, MASKDWORD, 0x34343434); - - /* PAGE_B for path-B DPK setting */ - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_B, MASKDWORD, 0x02017098); - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_B_4, MASKDWORD, 0xf76d9f84); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x0004ab87); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_ANT_B, MASKDWORD, 0x00880000); - - /* RF lpbk switches on */ - odm_set_bb_reg(p_dm_odm, 0x840, MASKDWORD, 0x0101000f); - odm_set_bb_reg(p_dm_odm, 0x840, MASKDWORD, 0x01120103); - - /* path-B RF lpbk */ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0x0c, MASKDWORD, 0x8992b); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0x0d, MASKDWORD, 0x0e52c); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, RF_AC, MASKDWORD, 0x5205a); - - /* ----send one shot signal---- */ - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x800477c0); - ODM_delay_ms(1); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x000477c0); - ODM_delay_ms(50); - - while (retry_count < DP_RETRY_LIMIT && !p_dm_odm->rf_calibrate_info.is_dp_path_bok) { - /* ----read back measurement results---- */ - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_B, MASKDWORD, 0x0c297018); - tmp_reg = odm_get_bb_reg(p_dm_odm, 0xbf0, MASKDWORD); - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_B, MASKDWORD, 0x0c29701f); - tmp_reg2 = odm_get_bb_reg(p_dm_odm, 0xbf8, MASKDWORD); - - tmp_reg = (tmp_reg & MASKHWORD) >> 16; - tmp_reg2 = (tmp_reg2 & MASKHWORD) >> 16; - - if (tmp_reg < 0xf0 || tmp_reg > 0x105 || tmp_reg2 > 0xff) { - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_B, MASKDWORD, 0x02017098); - - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, MASKH3BYTES, 0x800000); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, MASKH3BYTES, 0x000000); - ODM_delay_ms(1); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x800477c0); - ODM_delay_ms(1); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x000477c0); - ODM_delay_ms(50); - retry_count++; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B DPK retry_count %d 0xbf0[31:16] %x, 0xbf8[31:16] %x\n", retry_count, tmp_reg, tmp_reg2)); - } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B DPK Success\n")); - p_dm_odm->rf_calibrate_info.is_dp_path_bok = true; - break; - } - } - - /* DPP path B */ - if (p_dm_odm->rf_calibrate_info.is_dp_path_bok) { - /* DP setting */ - /* LUT by SRAM */ - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_B, MASKDWORD, 0x01017098); - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_B_4, MASKDWORD, 0x776d9f84); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x0004ab87); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_ANT_B, MASKDWORD, 0x00880000); - - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, MASKH3BYTES, 0x400000); - for (i = 0xb60; i <= 0xb9c; i += 4) { - odm_set_bb_reg(p_dm_odm, i, MASKDWORD, 0x40004000); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B ofsset = 0x%x\n", i)); - } - - /* PWSF */ - odm_set_bb_reg(p_dm_odm, 0xba0, MASKDWORD, 0x40404040); - odm_set_bb_reg(p_dm_odm, 0xba4, MASKDWORD, 0x28324050); - odm_set_bb_reg(p_dm_odm, 0xba8, MASKDWORD, 0x0c141920); - - for (i = 0xbac; i <= 0xbbc; i += 4) - odm_set_bb_reg(p_dm_odm, i, MASKDWORD, 0x0c0c0c0c); - - /* tx_agc boundary */ - odm_set_bb_reg(p_dm_odm, 0xbc4, MASKDWORD, 0x0005361f); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, MASKH3BYTES, 0x000000); - - } else { - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_B, MASKDWORD, 0x00000000); - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_B_4, MASKDWORD, 0x00000000); - } - } - - /* reload BB default value */ - for (index = 0; index < DP_BB_REG_NUM; index++) - odm_set_bb_reg(p_dm_odm, BB_REG[index], MASKDWORD, BB_backup[index]); - - /* reload RF default value */ - for (path = 0; path < DP_PATH_NUM; path++) { - for (i = 0 ; i < DP_RF_REG_NUM ; i++) - odm_set_rf_reg(p_dm_odm, path, RF_REG[i], MASKDWORD, RF_backup[path][i]); - } - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_MODE1, MASKDWORD, 0x1000f); /* standby mode */ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_MODE2, MASKDWORD, 0x20101); /* RF lpbk switches off */ - - /* reload AFE default value */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_reload_adda_registers(p_adapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); - - /* reload MAC default value */ - _phy_reload_mac_registers(p_adapter, MAC_REG, MAC_backup); -#else - _phy_reload_adda_registers(p_dm_odm, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); - - /* reload MAC default value */ - _phy_reload_mac_registers(p_dm_odm, MAC_REG, MAC_backup); -#endif - - p_dm_odm->rf_calibrate_info.is_dp_done = true; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<==phy_digital_predistortion()\n")); -#endif -} - -void -phy_digital_predistortion_8188e( -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - struct _ADAPTER *p_adapter -#else - struct PHY_DM_STRUCT *p_dm_odm -#endif -) -{ -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif -#if DISABLE_BB_RF - return; -#endif - - return; - - if (p_dm_odm->rf_calibrate_info.is_dp_done) - return; -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - - if (p_dm_odm->rf_type == ODM_2T2R) - phy_digital_predistortion(p_adapter, true); - else -#endif - { - /* For 88C 1T1R */ - phy_digital_predistortion(p_adapter, false); - } -} - - - -/* return value true => Main; false => Aux */ - -bool _phy_query_rf_path_switch_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - bool 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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - if (!p_adapter->is_hw_init_ready) { - u8 u1b_tmp; - u1b_tmp = odm_read_1byte(p_dm_odm, REG_LEDCFG2) | BIT(7); - odm_write_1byte(p_dm_odm, REG_LEDCFG2, u1b_tmp); - /* odm_set_bb_reg(p_dm_odm, REG_LEDCFG0, BIT23, 0x01); */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XAB_RF_PARAMETER, BIT(13), 0x01); - } - - if (is2T) { - if (odm_get_bb_reg(p_dm_odm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(5) | BIT(6)) == 0x01) - return true; - else - return false; - } else { - if ((odm_get_bb_reg(p_dm_odm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(5) | BIT(4) | BIT(3)) == 0x1)) - return true; - else - return false; - } -} - - - -/* return value true => Main; false => Aux */ -bool phy_query_rf_path_switch_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm -#else - struct _ADAPTER *p_adapter -#endif -) -{ - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); - -#if DISABLE_BB_RF - return true; -#endif -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - if (IS_2T2R(p_hal_data->version_id)) - return _phy_query_rf_path_switch_8188e(p_adapter, true); - else -#endif - { - /* For 88C 1T1R */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - return _phy_query_rf_path_switch_8188e(p_adapter, false); -#else - return _phy_query_rf_path_switch_8188e(p_dm_odm, false); -#endif - } -} -#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halphyrf_8188e_ce.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halphyrf_8188e_ce.h deleted file mode 100644 index e546d28e02ac..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halphyrf_8188e_ce.h +++ /dev/null @@ -1,142 +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_8188E_H__ -#define __HAL_PHY_RF_8188E_H__ - -/*--------------------------Define Parameters-------------------------------*/ -#define IQK_DELAY_TIME_88E 10 /* ms */ -#define index_mapping_NUM_88E 15 -#define AVG_THERMAL_NUM_88E 4 - -#include "../halphyrf_ce.h" - -void configure_txpower_track_8188e( - struct _TXPWRTRACK_CFG *p_config -); - -void -get_delta_swing_table_8188e( - void *p_dm_void, - u8 **temperature_up_a, - u8 **temperature_down_a, - u8 **temperature_up_b, - u8 **temperature_down_b -); - -void do_iqk_8188e( - void *p_dm_void, - u8 delta_thermal_index, - u8 thermal_value, - u8 threshold -); - -void -odm_tx_pwr_track_set_pwr88_e( - void *p_dm_void, - enum pwrtrack_method method, - u8 rf_path, - u8 channel_mapped_index -); - -/* 1 7. IQK */ - -void -phy_iq_calibrate_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *adapter, -#endif - bool is_recovery); - - -/* - * LC calibrate - * */ -void -phy_lc_calibrate_8188e( - void *p_dm_void -); -#if 0 -/* - * AP calibrate - * */ -void -phy_ap_calibrate_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - s8 delta); -#endif - -void -phy_digital_predistortion_8188e(struct _ADAPTER *p_adapter); - - -void -_phy_save_adda_registers( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - u32 *adda_reg, - u32 *adda_backup, - u32 register_num -); - -void -_phy_path_adda_on( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - u32 *adda_reg, - bool is_path_a_on, - bool is2T -); - -void -_phy_mac_setting_calibration( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - u32 *mac_reg, - u32 *mac_backup -); - - -void -_phy_path_a_stand_by( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm -#else - struct _ADAPTER *p_adapter -#endif -); - - -#endif /* #ifndef __HAL_PHY_RF_8188E_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halphyrf_8188e_win.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halphyrf_8188e_win.c deleted file mode 100644 index feb6d2a88765..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/halphyrf_8188e_win.c +++ /dev/null @@ -1,3189 +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 Local Constant---------------------------*/ -/* 2010/04/25 MH Define the max tx power tracking tx agc power. */ -#define ODM_TXPWRTRACK_MAX_IDX_88E 6 - -/*---------------------------Define Local Constant---------------------------*/ - - -/* 3============================================================ - * 3 Tx Power Tracking - * 3============================================================ */ - - -void set_iqk_matrix_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u8 OFDM_index, - u8 rf_path, - s32 iqk_result_x, - s32 iqk_result_y -) -{ - s32 ele_A = 0, ele_D, ele_C = 0, value32; - - ele_D = (ofdm_swing_table_new[OFDM_index] & 0xFFC00000) >> 22; - - /* new element A = element D x X */ - if ((iqk_result_x != 0) && (*(p_dm_odm->p_band_type) == ODM_BAND_2_4G)) { - if ((iqk_result_x & 0x00000200) != 0) /* consider minus */ - iqk_result_x = iqk_result_x | 0xFFFFFC00; - ele_A = ((iqk_result_x * ele_D) >> 8) & 0x000003FF; - - /* new element C = element D x Y */ - if ((iqk_result_y & 0x00000200) != 0) - iqk_result_y = iqk_result_y | 0xFFFFFC00; - ele_C = ((iqk_result_y * ele_D) >> 8) & 0x000003FF; - - if (rf_path == ODM_RF_PATH_A) - switch (rf_path) { - case ODM_RF_PATH_A: - /* 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; - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKDWORD, value32); - - value32 = (ele_C & 0x000003C0) >> 6; - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XC_TX_AFE, MASKH4BITS, value32); - - value32 = ((iqk_result_x * ele_D) >> 7) & 0x01; - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_ECCA_THRESHOLD, BIT(24), value32); - break; - case ODM_RF_PATH_B: - /* 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; - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XB_TX_IQ_IMBALANCE, MASKDWORD, value32); - - value32 = (ele_C & 0x000003C0) >> 6; - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XD_TX_AFE, MASKH4BITS, value32); - - value32 = ((iqk_result_x * ele_D) >> 7) & 0x01; - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_ECCA_THRESHOLD, BIT(28), value32); - - break; - default: - break; - } - } else { - switch (rf_path) { - case ODM_RF_PATH_A: - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKDWORD, ofdm_swing_table_new[OFDM_index]); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XC_TX_AFE, MASKH4BITS, 0x00); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_ECCA_THRESHOLD, BIT(24), 0x00); - break; - - case ODM_RF_PATH_B: - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XB_TX_IQ_IMBALANCE, MASKDWORD, ofdm_swing_table_new[OFDM_index]); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XD_TX_AFE, MASKH4BITS, 0x00); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_ECCA_THRESHOLD, BIT(28), 0x00); - break; - - default: - break; - } - } - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("TxPwrTracking path B: X = 0x%x, Y = 0x%x ele_A = 0x%x ele_C = 0x%x ele_D = 0x%x 0xeb4 = 0x%x 0xebc = 0x%x\n", - (u32)iqk_result_x, (u32)iqk_result_y, (u32)ele_A, (u32)ele_C, (u32)ele_D, (u32)iqk_result_x, (u32)iqk_result_y)); -} - -void do_iqk_8188e( - void *p_dm_void, - u8 delta_thermal_index, - u8 thermal_value, - u8 threshold -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - struct _ADAPTER *adapter = p_dm_odm->adapter; -#endif - - odm_reset_iqk_result(p_dm_odm); - - p_dm_odm->rf_calibrate_info.thermal_value_iqk = thermal_value; -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - phy_iq_calibrate_8188e(p_dm_odm, false); -#else - phy_iq_calibrate_8188e(adapter, false); -#endif - -} - -/*----------------------------------------------------------------------------- - * Function: odm_TxPwrTrackSetPwr88E() - * - * Overview: 88E 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_pwr88_e( - void *p_dm_void, - enum pwrtrack_method method, - u8 rf_path, - u8 channel_mapped_index -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTER *adapter = p_dm_odm->adapter; - PHAL_DATA_TYPE p_hal_data = GET_HAL_DATA(adapter); - u8 pwr_tracking_limit_ofdm = 30; /* +0dB */ - u8 pwr_tracking_limit_cck = 28; /* -2dB */ - u8 tx_rate = 0xFF; - u8 final_ofdm_swing_index = 0; - u8 final_cck_swing_index = 0; - u8 i = 0; - struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm_odm->rf_calibrate_info); - - - if (p_dm_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 p_mpt_ctx = &(adapter->mpt_ctx); - - tx_rate = mpt_to_mgnt_rate(p_mpt_ctx->mpt_rate_index); -#endif -#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - PMPT_CONTEXT p_mpt_ctx = &(adapter->mppriv.mpt_ctx); - - tx_rate = mpt_to_mgnt_rate(p_mpt_ctx->mpt_rate_index); -#endif -#endif - } else { - u16 rate = *(p_dm_odm->p_forced_data_rate); - - if (!rate) { /*auto rate*/ - if (rate != 0xFF) { -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - tx_rate = adapter->HalFunc.GetHwRateFromMRateHandler(p_dm_odm->tx_rate); -#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - tx_rate = hw_rate_to_m_rate(p_dm_odm->tx_rate); -#endif - } - } else /*force rate*/ - tx_rate = (u8)rate; - } - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("Power Tracking tx_rate=0x%X\n", tx_rate)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("===>ODM_TxPwrTrackSetPwr8188E\n")); - - if (tx_rate != 0xFF) { - /* 2 CCK */ - if (((tx_rate >= MGN_1M) && (tx_rate <= MGN_5_5M)) || (tx_rate == MGN_11M)) - pwr_tracking_limit_cck = 28; /* -2dB */ - /* 2 OFDM */ - else if ((tx_rate >= MGN_6M) && (tx_rate <= MGN_48M)) - pwr_tracking_limit_ofdm = 36; /* +3dB */ - else if (tx_rate == MGN_54M) - pwr_tracking_limit_ofdm = 34; /* +2dB */ - - /* 2 HT */ - else if ((tx_rate >= MGN_MCS0) && (tx_rate <= MGN_MCS2)) /* QPSK/BPSK */ - pwr_tracking_limit_ofdm = 38; /* +4dB */ - else if ((tx_rate >= MGN_MCS3) && (tx_rate <= MGN_MCS4)) /* 16QAM */ - pwr_tracking_limit_ofdm = 36; /* +3dB */ - else if ((tx_rate >= MGN_MCS5) && (tx_rate <= MGN_MCS7)) /* 64QAM */ - pwr_tracking_limit_ofdm = 34; /* +2dB */ - - else - pwr_tracking_limit_ofdm = p_rf_calibrate_info->default_ofdm_index; /* Default OFDM index = 30 */ - } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("tx_rate=0x%x, pwr_tracking_limit=%d\n", tx_rate, pwr_tracking_limit_ofdm)); - - if (method == TXAGC) { - u32 pwr = 0, tx_agc = 0; - struct _ADAPTER *adapter = p_dm_odm->adapter; - - 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. */ - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("odm_TxPwrTrackSetPwr88E CH=%d\n", *(p_dm_odm->p_channel))); - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - -#if (MP_DRIVER != 1) - /* phy_set_tx_power_level8188e(p_dm_odm->adapter, *p_dm_odm->p_channel); */ - - p_rf_calibrate_info->modify_tx_agc_flag_path_a = true; - p_rf_calibrate_info->modify_tx_agc_flag_path_a_cck = true; - - if (rf_path == ODM_RF_PATH_A) { - PHY_SetTxPowerIndexByRateSection(adapter, ODM_RF_PATH_A, *p_dm_odm->p_channel, CCK); - PHY_SetTxPowerIndexByRateSection(adapter, ODM_RF_PATH_A, *p_dm_odm->p_channel, OFDM); - PHY_SetTxPowerIndexByRateSection(adapter, ODM_RF_PATH_A, *p_dm_odm->p_channel, HT_MCS0_MCS7); - } - -#else - pwr = PHY_QueryBBReg(adapter, REG_TX_AGC_A_RATE18_06, 0xFF); - pwr += p_rf_calibrate_info->power_index_offset[ODM_RF_PATH_A]; - PHY_SetBBReg(adapter, REG_TX_AGC_A_CCK_1_MCS32, MASKBYTE1, pwr); - tx_agc = (pwr << 16) | (pwr << 8) | (pwr); - PHY_SetBBReg(adapter, REG_TX_AGC_B_CCK_11_A_CCK_2_11, 0xffffff00, tx_agc); - RT_DISP(FPHY, PHY_TXPWR, ("odm_tx_pwr_track_set_pwr88_e: CCK Tx-rf(A) Power = 0x%x\n", tx_agc)); - - pwr = PHY_QueryBBReg(adapter, REG_TX_AGC_A_RATE18_06, 0xFF); - pwr += (p_rf_calibrate_info->bb_swing_idx_ofdm[ODM_RF_PATH_A] - p_rf_calibrate_info->bb_swing_idx_ofdm_base[ODM_RF_PATH_A]); - tx_agc |= ((pwr << 24) | (pwr << 16) | (pwr << 8) | pwr); - PHY_SetBBReg(adapter, REG_TX_AGC_A_RATE18_06, MASKDWORD, tx_agc); - PHY_SetBBReg(adapter, REG_TX_AGC_A_RATE54_24, MASKDWORD, tx_agc); - PHY_SetBBReg(adapter, REG_TX_AGC_A_MCS03_MCS00, MASKDWORD, tx_agc); - PHY_SetBBReg(adapter, REG_TX_AGC_A_MCS07_MCS04, MASKDWORD, tx_agc); - PHY_SetBBReg(adapter, REG_TX_AGC_A_MCS11_MCS08, MASKDWORD, tx_agc); - PHY_SetBBReg(adapter, REG_TX_AGC_A_MCS15_MCS12, MASKDWORD, tx_agc); - RT_DISP(FPHY, PHY_TXPWR, ("odm_tx_pwr_track_set_pwr88_e: OFDM Tx-rf(A) Power = 0x%x\n", tx_agc)); -#endif - -#endif -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - /* phy_rf6052_set_cck_tx_power(p_dm_odm->priv, *(p_dm_odm->p_channel)); */ - /* phy_rf6052_set_ofdm_tx_power(p_dm_odm->priv, *(p_dm_odm->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]; - - 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) - final_cck_swing_index = CCK_TABLE_SIZE - 1; - else if (p_rf_calibrate_info->bb_swing_idx_cck < 0) - final_cck_swing_index = 0; - - /* Adjust BB swing by OFDM IQ matrix */ - if (rf_path == ODM_RF_PATH_A) { - set_iqk_matrix_8188e(p_dm_odm, final_ofdm_swing_index, ODM_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]); - /* Adjust BB swing by CCK filter coefficient */ - if (!p_rf_calibrate_info->is_cck_in_ch14) { - odm_write_1byte(p_dm_odm, 0xa22, cck_swing_table_ch1_ch13_new[final_cck_swing_index][0]); - odm_write_1byte(p_dm_odm, 0xa23, cck_swing_table_ch1_ch13_new[final_cck_swing_index][1]); - odm_write_1byte(p_dm_odm, 0xa24, cck_swing_table_ch1_ch13_new[final_cck_swing_index][2]); - odm_write_1byte(p_dm_odm, 0xa25, cck_swing_table_ch1_ch13_new[final_cck_swing_index][3]); - odm_write_1byte(p_dm_odm, 0xa26, cck_swing_table_ch1_ch13_new[final_cck_swing_index][4]); - odm_write_1byte(p_dm_odm, 0xa27, cck_swing_table_ch1_ch13_new[final_cck_swing_index][5]); - odm_write_1byte(p_dm_odm, 0xa28, cck_swing_table_ch1_ch13_new[final_cck_swing_index][6]); - odm_write_1byte(p_dm_odm, 0xa29, cck_swing_table_ch1_ch13_new[final_cck_swing_index][7]); - } else { - odm_write_1byte(p_dm_odm, 0xa22, cck_swing_table_ch14_new[final_cck_swing_index][0]); - odm_write_1byte(p_dm_odm, 0xa23, cck_swing_table_ch14_new[final_cck_swing_index][1]); - odm_write_1byte(p_dm_odm, 0xa24, cck_swing_table_ch14_new[final_cck_swing_index][2]); - odm_write_1byte(p_dm_odm, 0xa25, cck_swing_table_ch14_new[final_cck_swing_index][3]); - odm_write_1byte(p_dm_odm, 0xa26, cck_swing_table_ch14_new[final_cck_swing_index][4]); - odm_write_1byte(p_dm_odm, 0xa27, cck_swing_table_ch14_new[final_cck_swing_index][5]); - odm_write_1byte(p_dm_odm, 0xa28, cck_swing_table_ch14_new[final_cck_swing_index][6]); - odm_write_1byte(p_dm_odm, 0xa29, cck_swing_table_ch14_new[final_cck_swing_index][7]); - } - } - } else if (method == MIX_MODE) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("p_rf_calibrate_info->default_ofdm_index=%d, p_dm_odm->DefaultCCKIndex=%d, p_rf_calibrate_info->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_cck_swing_index = p_rf_calibrate_info->default_cck_index + p_rf_calibrate_info->absolute_ofdm_swing_idx[rf_path]; - final_ofdm_swing_index = p_rf_calibrate_info->default_ofdm_index + p_rf_calibrate_info->absolute_ofdm_swing_idx[rf_path]; - - if (final_ofdm_swing_index > pwr_tracking_limit_ofdm) { /* BBSwing higher then Limit */ - p_rf_calibrate_info->remnant_ofdm_swing_idx[rf_path] = final_ofdm_swing_index - pwr_tracking_limit_ofdm; - - set_iqk_matrix_8188e(p_dm_odm, pwr_tracking_limit_ofdm, ODM_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]); - - p_rf_calibrate_info->modify_tx_agc_flag_path_a = true; - - PHY_SetTxPowerIndexByRateSection(adapter, ODM_RF_PATH_A, *p_dm_odm->p_channel, OFDM); - PHY_SetTxPowerIndexByRateSection(adapter, ODM_RF_PATH_A, *p_dm_odm->p_channel, HT_MCS0_MCS7); - - ODM_RT_TRACE(p_dm_odm, 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_8188e(p_dm_odm, 0, ODM_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]); - - p_rf_calibrate_info->modify_tx_agc_flag_path_a = true; - - PHY_SetTxPowerIndexByRateSection(adapter, ODM_RF_PATH_A, *p_dm_odm->p_channel, OFDM); - PHY_SetTxPowerIndexByRateSection(adapter, ODM_RF_PATH_A, *p_dm_odm->p_channel, HT_MCS0_MCS7); - - ODM_RT_TRACE(p_dm_odm, 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_8188e(p_dm_odm, final_ofdm_swing_index, ODM_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]); - - ODM_RT_TRACE(p_dm_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 (p_rf_calibrate_info->modify_tx_agc_flag_path_a) { /* If tx_agc has changed, reset tx_agc again */ - p_rf_calibrate_info->remnant_ofdm_swing_idx[rf_path] = 0; - - PHY_SetTxPowerIndexByRateSection(adapter, ODM_RF_PATH_A, *p_dm_odm->p_channel, OFDM); - PHY_SetTxPowerIndexByRateSection(adapter, ODM_RF_PATH_A, *p_dm_odm->p_channel, HT_MCS0_MCS7); - - p_rf_calibrate_info->modify_tx_agc_flag_path_a = false; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A p_dm_odm->Modify_TxAGC_Flag = false\n")); - } - } - - 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, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A CCK Over Limit, pwr_tracking_limit_cck = %d, p_rf_calibrate_info->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 */ - - if (!p_rf_calibrate_info->is_cck_in_ch14) { - odm_write_1byte(p_dm_odm, 0xa22, cck_swing_table_ch1_ch13_new[pwr_tracking_limit_cck][0]); - odm_write_1byte(p_dm_odm, 0xa23, cck_swing_table_ch1_ch13_new[pwr_tracking_limit_cck][1]); - odm_write_1byte(p_dm_odm, 0xa24, cck_swing_table_ch1_ch13_new[pwr_tracking_limit_cck][2]); - odm_write_1byte(p_dm_odm, 0xa25, cck_swing_table_ch1_ch13_new[pwr_tracking_limit_cck][3]); - odm_write_1byte(p_dm_odm, 0xa26, cck_swing_table_ch1_ch13_new[pwr_tracking_limit_cck][4]); - odm_write_1byte(p_dm_odm, 0xa27, cck_swing_table_ch1_ch13_new[pwr_tracking_limit_cck][5]); - odm_write_1byte(p_dm_odm, 0xa28, cck_swing_table_ch1_ch13_new[pwr_tracking_limit_cck][6]); - odm_write_1byte(p_dm_odm, 0xa29, cck_swing_table_ch1_ch13_new[pwr_tracking_limit_cck][7]); - } else { - odm_write_1byte(p_dm_odm, 0xa22, cck_swing_table_ch14_new[pwr_tracking_limit_cck][0]); - odm_write_1byte(p_dm_odm, 0xa23, cck_swing_table_ch14_new[pwr_tracking_limit_cck][1]); - odm_write_1byte(p_dm_odm, 0xa24, cck_swing_table_ch14_new[pwr_tracking_limit_cck][2]); - odm_write_1byte(p_dm_odm, 0xa25, cck_swing_table_ch14_new[pwr_tracking_limit_cck][3]); - odm_write_1byte(p_dm_odm, 0xa26, cck_swing_table_ch14_new[pwr_tracking_limit_cck][4]); - odm_write_1byte(p_dm_odm, 0xa27, cck_swing_table_ch14_new[pwr_tracking_limit_cck][5]); - odm_write_1byte(p_dm_odm, 0xa28, cck_swing_table_ch14_new[pwr_tracking_limit_cck][6]); - odm_write_1byte(p_dm_odm, 0xa29, cck_swing_table_ch14_new[pwr_tracking_limit_cck][7]); - } - - p_rf_calibrate_info->modify_tx_agc_flag_path_a_cck = true; - - PHY_SetTxPowerIndexByRateSection(adapter, ODM_RF_PATH_A, *p_dm_odm->p_channel, CCK); - - } else if (final_cck_swing_index < 0) { /* Lowest CCK index = 0 */ - p_rf_calibrate_info->remnant_cck_swing_idx = final_cck_swing_index; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A CCK Under Limit, pwr_tracking_limit_cck = %d, p_rf_calibrate_info->remnant_cck_swing_idx = %d\n", 0, p_rf_calibrate_info->remnant_cck_swing_idx)); - - if (!p_rf_calibrate_info->is_cck_in_ch14) { - odm_write_1byte(p_dm_odm, 0xa22, cck_swing_table_ch1_ch13_new[0][0]); - odm_write_1byte(p_dm_odm, 0xa23, cck_swing_table_ch1_ch13_new[0][1]); - odm_write_1byte(p_dm_odm, 0xa24, cck_swing_table_ch1_ch13_new[0][2]); - odm_write_1byte(p_dm_odm, 0xa25, cck_swing_table_ch1_ch13_new[0][3]); - odm_write_1byte(p_dm_odm, 0xa26, cck_swing_table_ch1_ch13_new[0][4]); - odm_write_1byte(p_dm_odm, 0xa27, cck_swing_table_ch1_ch13_new[0][5]); - odm_write_1byte(p_dm_odm, 0xa28, cck_swing_table_ch1_ch13_new[0][6]); - odm_write_1byte(p_dm_odm, 0xa29, cck_swing_table_ch1_ch13_new[0][7]); - } else { - odm_write_1byte(p_dm_odm, 0xa22, cck_swing_table_ch14_new[0][0]); - odm_write_1byte(p_dm_odm, 0xa23, cck_swing_table_ch14_new[0][1]); - odm_write_1byte(p_dm_odm, 0xa24, cck_swing_table_ch14_new[0][2]); - odm_write_1byte(p_dm_odm, 0xa25, cck_swing_table_ch14_new[0][3]); - odm_write_1byte(p_dm_odm, 0xa26, cck_swing_table_ch14_new[0][4]); - odm_write_1byte(p_dm_odm, 0xa27, cck_swing_table_ch14_new[0][5]); - odm_write_1byte(p_dm_odm, 0xa28, cck_swing_table_ch14_new[0][6]); - odm_write_1byte(p_dm_odm, 0xa29, cck_swing_table_ch14_new[0][7]); - } - - p_rf_calibrate_info->modify_tx_agc_flag_path_a_cck = true; - - PHY_SetTxPowerIndexByRateSection(adapter, ODM_RF_PATH_A, *p_dm_odm->p_channel, CCK); - - } else { - ODM_RT_TRACE(p_dm_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)); - - if (!p_rf_calibrate_info->is_cck_in_ch14) { - odm_write_1byte(p_dm_odm, 0xa22, cck_swing_table_ch1_ch13_new[final_cck_swing_index][0]); - odm_write_1byte(p_dm_odm, 0xa23, cck_swing_table_ch1_ch13_new[final_cck_swing_index][1]); - odm_write_1byte(p_dm_odm, 0xa24, cck_swing_table_ch1_ch13_new[final_cck_swing_index][2]); - odm_write_1byte(p_dm_odm, 0xa25, cck_swing_table_ch1_ch13_new[final_cck_swing_index][3]); - odm_write_1byte(p_dm_odm, 0xa26, cck_swing_table_ch1_ch13_new[final_cck_swing_index][4]); - odm_write_1byte(p_dm_odm, 0xa27, cck_swing_table_ch1_ch13_new[final_cck_swing_index][5]); - odm_write_1byte(p_dm_odm, 0xa28, cck_swing_table_ch1_ch13_new[final_cck_swing_index][6]); - odm_write_1byte(p_dm_odm, 0xa29, cck_swing_table_ch1_ch13_new[final_cck_swing_index][7]); - } else { - odm_write_1byte(p_dm_odm, 0xa22, cck_swing_table_ch14_new[final_cck_swing_index][0]); - odm_write_1byte(p_dm_odm, 0xa23, cck_swing_table_ch14_new[final_cck_swing_index][1]); - odm_write_1byte(p_dm_odm, 0xa24, cck_swing_table_ch14_new[final_cck_swing_index][2]); - odm_write_1byte(p_dm_odm, 0xa25, cck_swing_table_ch14_new[final_cck_swing_index][3]); - odm_write_1byte(p_dm_odm, 0xa26, cck_swing_table_ch14_new[final_cck_swing_index][4]); - odm_write_1byte(p_dm_odm, 0xa27, cck_swing_table_ch14_new[final_cck_swing_index][5]); - odm_write_1byte(p_dm_odm, 0xa28, cck_swing_table_ch14_new[final_cck_swing_index][6]); - odm_write_1byte(p_dm_odm, 0xa29, cck_swing_table_ch14_new[final_cck_swing_index][7]); - } - - if (p_rf_calibrate_info->modify_tx_agc_flag_path_a_cck) { /* If tx_agc has changed, reset tx_agc again */ - p_rf_calibrate_info->remnant_cck_swing_idx = 0; - PHY_SetTxPowerIndexByRateSection(adapter, ODM_RF_PATH_A, *p_dm_odm->p_channel, CCK); - p_rf_calibrate_info->modify_tx_agc_flag_path_a_cck = false; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A p_dm_odm->Modify_TxAGC_Flag_CCK = false\n")); - } - - } - } else - return; -} /* odm_TxPwrTrackSetPwr88E */ - -void -get_delta_swing_table_8188e( - 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_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTER *adapter = p_dm_odm->adapter; - struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm_odm->rf_calibrate_info); - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); - u8 tx_rate = 0xFF; - u8 channel = *p_dm_odm->p_channel; - - if (p_dm_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 p_mpt_ctx = &(adapter->mpt_ctx); - - tx_rate = mpt_to_mgnt_rate(p_mpt_ctx->mpt_rate_index); -#endif -#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - PMPT_CONTEXT p_mpt_ctx = &(adapter->mppriv.mpt_ctx); - - tx_rate = mpt_to_mgnt_rate(p_mpt_ctx->mpt_rate_index); -#endif -#endif - } else { - u16 rate = *(p_dm_odm->p_forced_data_rate); - - if (!rate) { /*auto rate*/ - if (rate != 0xFF) { -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - tx_rate = adapter->HalFunc.GetHwRateFromMRateHandler(p_dm_odm->tx_rate); -#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - tx_rate = hw_rate_to_m_rate(p_dm_odm->tx_rate); -#endif - } - } else /*force rate*/ - tx_rate = (u8)rate; - } - - ODM_RT_TRACE(p_dm_odm, 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; - } 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; - } - } else { - *temperature_up_a = (u8 *)delta_swing_table_idx_2ga_p_8188e; - *temperature_down_a = (u8 *)delta_swing_table_idx_2ga_n_8188e; - } -} - -void configure_txpower_track_8188e( - struct _TXPWRTRACK_CFG *p_config -) -{ - p_config->swing_table_size_cck = CCK_TABLE_SIZE; - p_config->swing_table_size_ofdm = OFDM_TABLE_SIZE; - p_config->threshold_iqk = IQK_THRESHOLD; - p_config->average_thermal_num = AVG_THERMAL_NUM_88E; - p_config->rf_path_count = MAX_PATH_NUM_8188E; - p_config->thermal_reg_addr = RF_T_METER_88E; - - p_config->odm_tx_pwr_track_set_pwr = odm_tx_pwr_track_set_pwr88_e; - p_config->do_iqk = do_iqk_8188e; - p_config->phy_lc_calibrate = phy_lc_calibrate_8188e; - p_config->get_delta_swing_table = get_delta_swing_table_8188e; -} - -/* 1 7. IQK */ -#define MAX_TOLERANCE 5 -#define IQK_DELAY_TIME 1 /* ms */ - -u8 /* bit0 = 1 => Tx OK, bit1 = 1 => Rx OK */ -phy_path_a_iqk_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - bool config_path_b, - u32 ktimes -) -{ - u32 reg_eac, reg_e94, reg_e9c, reg_ea4; - u8 result = 0x00; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A IQK!\n")); - - /* 1 Tx IQK */ - /* path-A IQK setting */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path-A IQK setting!\n")); - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_TONE_A, MASKDWORD, 0x18008c1c); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_TONE_A, MASKDWORD, 0x38008c1c); - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_PI_A, MASKDWORD, 0x821403ff); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_PI_A, MASKDWORD, 0x28160000); - - if (ktimes == 0x0) { - /* LO calibration on */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LO calibration setting!\n")); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_RSP, MASKDWORD, 0x00462911); - } else { - /* LO calibration off */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LO calibration setting!\n")); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_RSP, MASKDWORD, 0x0046a911); - } - - /* TX IQK mode setting */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x000000); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_WE_LUT, RFREGOFFSETMASK, 0x800a0); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_RCK_OS, RFREGOFFSETMASK, 0x20000); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_TXPA_G1, RFREGOFFSETMASK, 0x0000f); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_TXPA_G2, RFREGOFFSETMASK, 0x07f7f); - - /* PA,PAD gain adjust */ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0xdf, RFREGOFFSETMASK, 0x980); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x56, RFREGOFFSETMASK, 0x510f0); - - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x808000); - - /* One shot, path A LOK & IQK */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("One shot, path A LOK & IQK!\n")); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_PTS, MASKDWORD, 0xf9000000); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_PTS, MASKDWORD, 0xf8000000); - - if (ktimes == 0) { - /* delay x ms */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("delay %d ms for One shot, path A LOK & IQK.\n", IQK_DELAY_TIME_88E)); - /* platform_stall_execution(IQK_DELAY_TIME_88E*1000); */ - ODM_delay_ms(IQK_DELAY_TIME_88E * 2); - - } else { - /* delay x ms */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("delay %d ms for One shot, path A LOK & IQK.\n", IQK_DELAY_TIME_88E)); - /* platform_stall_execution(IQK_DELAY_TIME_88E*1000); */ - ODM_delay_ms(IQK_DELAY_TIME_88E); - - } - - /* reload RF 0xdf */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x000000); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0xdf, RFREGOFFSETMASK, 0x180); - - - - /* Check failed */ - reg_eac = odm_get_bb_reg(p_dm_odm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xeac = 0x%x\n", reg_eac)); - reg_e94 = odm_get_bb_reg(p_dm_odm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe94 = 0x%x\n", reg_e94)); - reg_e9c = odm_get_bb_reg(p_dm_odm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe9c = 0x%x\n", reg_e9c)); - reg_ea4 = odm_get_bb_reg(p_dm_odm, REG_RX_POWER_BEFORE_IQK_A_2, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xea4 = 0x%x\n", reg_ea4)); - - if (!(reg_eac & BIT(28)) && - (((reg_e94 & 0x03FF0000) >> 16) != 0x142) && - (((reg_e9c & 0x03FF0000) >> 16) != 0x42)) - result |= 0x01; - else /* if Tx not OK, ignore Rx */ - return result; - -#if 0 - if (!(reg_eac & BIT(27)) && /* if Tx is OK, check whether Rx is OK */ - (((reg_ea4 & 0x03FF0000) >> 16) != 0x132) && - (((reg_eac & 0x03FF0000) >> 16) != 0x36)) - result |= 0x02; - else - RT_DISP(FINIT, INIT_IQK, ("path A Rx IQK fail!!\n")); -#endif - - return result; - - -} - -u8 /* bit0 = 1 => Tx OK, bit1 = 1 => Rx OK */ -phy_path_a_rx_iqk( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - bool config_path_b -) -{ - u32 reg_eac, reg_e94, reg_e9c, reg_ea4, u4tmp; - u8 result = 0x00; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A Rx IQK!\n")); - - /* 1 Get TXIMR setting */ - /* modify RXIQK mode table */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path-A Rx IQK modify RXIQK mode table!\n")); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x000000); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_WE_LUT, RFREGOFFSETMASK, 0x800a0); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_RCK_OS, RFREGOFFSETMASK, 0x30000); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_TXPA_G1, RFREGOFFSETMASK, 0x0000f); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_TXPA_G2, RFREGOFFSETMASK, 0xf117b); - - /* PA,PAD gain adjust */ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0xdf, RFREGOFFSETMASK, 0x980); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x56, RFREGOFFSETMASK, 0x510f0); - - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x808000); - - /* IQK setting */ - odm_set_bb_reg(p_dm_odm, REG_TX_IQK, MASKDWORD, 0x01007c00); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK, MASKDWORD, 0x81004800); - - /* path-A IQK setting */ - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_TONE_A, MASKDWORD, 0x18008c1c); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_TONE_A, MASKDWORD, 0x38008c1c); - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_PI_A, MASKDWORD, 0x82160fff); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_PI_A, MASKDWORD, 0x28160000); - - /* LO calibration setting */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LO calibration setting!\n")); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_RSP, MASKDWORD, 0x0046a911); - - /* One shot, path A LOK & IQK */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("One shot, path A LOK & IQK!\n")); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_PTS, MASKDWORD, 0xf9000000); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_PTS, MASKDWORD, 0xf8000000); - - /* delay x ms */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("delay %d ms for One shot, path A LOK & IQK.\n", IQK_DELAY_TIME_88E)); - /* platform_stall_execution(IQK_DELAY_TIME_88E*1000); */ - ODM_delay_ms(IQK_DELAY_TIME_88E); - - /* reload RF 0xdf */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x000000); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0xdf, RFREGOFFSETMASK, 0x180); - - /* Check failed */ - reg_eac = odm_get_bb_reg(p_dm_odm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xeac = 0x%x\n", reg_eac)); - reg_e94 = odm_get_bb_reg(p_dm_odm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe94 = 0x%x\n", reg_e94)); - reg_e9c = odm_get_bb_reg(p_dm_odm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe9c = 0x%x\n", reg_e9c)); - - if (!(reg_eac & BIT(28)) && - (((reg_e94 & 0x03FF0000) >> 16) != 0x142) && - (((reg_e9c & 0x03FF0000) >> 16) != 0x42)) - result |= 0x01; - else /* if Tx not OK, ignore Rx */ - return result; - - u4tmp = 0x80007C00 | (reg_e94 & 0x3FF0000) | ((reg_e9c & 0x3FF0000) >> 16); - odm_set_bb_reg(p_dm_odm, REG_TX_IQK, MASKDWORD, u4tmp); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe40 = 0x%x u4tmp = 0x%x\n", odm_get_bb_reg(p_dm_odm, REG_TX_IQK, MASKDWORD), u4tmp)); - - - /* 1 RX IQK */ - /* modify RXIQK mode table */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path-A Rx IQK modify RXIQK mode table 2!\n")); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x000000); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_WE_LUT, RFREGOFFSETMASK, 0x800a0); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_RCK_OS, RFREGOFFSETMASK, 0x30000); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_TXPA_G1, RFREGOFFSETMASK, 0x0000f); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_TXPA_G2, RFREGOFFSETMASK, 0xf7ffa); - - /* PA,PAD gain adjust */ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0xdf, RFREGOFFSETMASK, 0x980); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x56, RFREGOFFSETMASK, 0x51000); - - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x808000); - - /* IQK setting */ - odm_set_bb_reg(p_dm_odm, REG_RX_IQK, MASKDWORD, 0x01004800); - - /* path-A IQK setting */ - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_TONE_A, MASKDWORD, 0x38008c1c); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_TONE_A, MASKDWORD, 0x18008c1c); - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_PI_A, MASKDWORD, 0x82160000); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_PI_A, MASKDWORD, 0x28160fff); - - /* LO calibration setting */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LO calibration setting!\n")); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_RSP, MASKDWORD, 0x0046a911); - - /* One shot, path A LOK & IQK */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("One shot, path A LOK & IQK!\n")); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_PTS, MASKDWORD, 0xf9000000); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_PTS, MASKDWORD, 0xf8000000); - - /* delay x ms */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("delay %d ms for One shot, path A LOK & IQK.\n", IQK_DELAY_TIME_88E)); - /* platform_stall_execution(IQK_DELAY_TIME_88E*1000); */ - ODM_delay_ms(IQK_DELAY_TIME_88E); - - /* reload RF 0xdf */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x000000); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0xdf, RFREGOFFSETMASK, 0x180); - - /* Check failed */ - reg_eac = odm_get_bb_reg(p_dm_odm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xeac = 0x%x\n", reg_eac)); - reg_e94 = odm_get_bb_reg(p_dm_odm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe94 = 0x%x\n", reg_e94)); - reg_e9c = odm_get_bb_reg(p_dm_odm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xe9c = 0x%x\n", reg_e9c)); - reg_ea4 = odm_get_bb_reg(p_dm_odm, REG_RX_POWER_BEFORE_IQK_A_2, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xea4 = 0x%x\n", reg_ea4)); - -#if 0 - if (!(reg_eac & BIT(28)) && - (((reg_e94 & 0x03FF0000) >> 16) != 0x142) && - (((reg_e9c & 0x03FF0000) >> 16) != 0x42)) - result |= 0x01; - else /* if Tx not OK, ignore Rx */ - return result; -#endif - - if (!(reg_eac & BIT(27)) && /* if Tx is OK, check whether Rx is OK */ - (((reg_ea4 & 0x03FF0000) >> 16) != 0x132) && - (((reg_eac & 0x03FF0000) >> 16) != 0x36)) - result |= 0x02; - else - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A Rx IQK fail!!\n")); - - return result; - - -} - -u8 /* bit0 = 1 => Tx OK, bit1 = 1 => Rx OK */ -phy_path_b_iqk_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm -#else - struct _ADAPTER *p_adapter -#endif -) -{ - u32 reg_eac, reg_eb4, reg_ebc, reg_ec4, reg_ecc; - u8 result = 0x00; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B IQK!\n")); - - /* One shot, path B LOK & IQK */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("One shot, path A LOK & IQK!\n")); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_CONT, MASKDWORD, 0x00000002); - odm_set_bb_reg(p_dm_odm, REG_IQK_AGC_CONT, MASKDWORD, 0x00000000); - - /* delay x ms */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("delay %d ms for One shot, path B LOK & IQK.\n", IQK_DELAY_TIME_88E)); - /* platform_stall_execution(IQK_DELAY_TIME_88E*1000); */ - ODM_delay_ms(IQK_DELAY_TIME_88E); - - /* Check failed */ - reg_eac = odm_get_bb_reg(p_dm_odm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xeac = 0x%x\n", reg_eac)); - reg_eb4 = odm_get_bb_reg(p_dm_odm, REG_TX_POWER_BEFORE_IQK_B, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xeb4 = 0x%x\n", reg_eb4)); - reg_ebc = odm_get_bb_reg(p_dm_odm, REG_TX_POWER_AFTER_IQK_B, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xebc = 0x%x\n", reg_ebc)); - reg_ec4 = odm_get_bb_reg(p_dm_odm, REG_RX_POWER_BEFORE_IQK_B_2, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xec4 = 0x%x\n", reg_ec4)); - reg_ecc = odm_get_bb_reg(p_dm_odm, REG_RX_POWER_AFTER_IQK_B_2, MASKDWORD); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xecc = 0x%x\n", reg_ecc)); - - if (!(reg_eac & BIT(31)) && - (((reg_eb4 & 0x03FF0000) >> 16) != 0x142) && - (((reg_ebc & 0x03FF0000) >> 16) != 0x42)) - result |= 0x01; - else - return result; - - if (!(reg_eac & BIT(30)) && - (((reg_ec4 & 0x03FF0000) >> 16) != 0x132) && - (((reg_ecc & 0x03FF0000) >> 16) != 0x36)) - result |= 0x02; - else - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B Rx IQK fail!!\n")); - - - return result; - -} - -void -_phy_path_a_fill_iqk_matrix( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - bool is_iqk_ok, - s32 result[][8], - u8 final_candidate, - bool is_tx_only -) -{ - u32 oldval_0, X, TX0_A, reg; - s32 Y, TX0_C; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A 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_odm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKDWORD) >> 22) & 0x3FF; - - X = result[final_candidate][0]; - if ((X & 0x00000200) != 0) - X = X | 0xFFFFFC00; - TX0_A = (X * oldval_0) >> 8; - ODM_RT_TRACE(p_dm_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_set_bb_reg(p_dm_odm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, 0x3FF, TX0_A); - - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_ECCA_THRESHOLD, BIT(31), ((X * oldval_0 >> 7) & 0x1)); - - Y = result[final_candidate][1]; - if ((Y & 0x00000200) != 0) - Y = Y | 0xFFFFFC00; - - - TX0_C = (Y * oldval_0) >> 8; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Y = 0x%x, TX = 0x%x\n", Y, TX0_C)); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XC_TX_AFE, 0xF0000000, ((TX0_C & 0x3C0) >> 6)); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, 0x003F0000, (TX0_C & 0x3F)); - - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_ECCA_THRESHOLD, BIT(29), ((Y * oldval_0 >> 7) & 0x1)); - - if (is_tx_only) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_path_a_fill_iqk_matrix 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_odm, REG_OFDM_0_XA_RX_IQ_IMBALANCE, 0x3FF, reg); - - reg = result[final_candidate][3] & 0x3F; - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XA_RX_IQ_IMBALANCE, 0xFC00, reg); - - reg = (result[final_candidate][3] >> 6) & 0xF; - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_RX_IQ_EXT_ANTA, 0xF0000000, reg); - } -} - -void -_phy_path_b_fill_iqk_matrix( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - bool is_iqk_ok, - s32 result[][8], - u8 final_candidate, - bool is_tx_only /* do Tx only */ -) -{ - u32 oldval_1, X, TX1_A, reg; - s32 Y, TX1_C; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B 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_odm, REG_OFDM_0_XB_TX_IQ_IMBALANCE, MASKDWORD) >> 22) & 0x3FF; - - X = result[final_candidate][4]; - if ((X & 0x00000200) != 0) - X = X | 0xFFFFFC00; - TX1_A = (X * oldval_1) >> 8; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("X = 0x%x, TX1_A = 0x%x\n", X, TX1_A)); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XB_TX_IQ_IMBALANCE, 0x3FF, TX1_A); - - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_ECCA_THRESHOLD, BIT(27), ((X * oldval_1 >> 7) & 0x1)); - - Y = result[final_candidate][5]; - if ((Y & 0x00000200) != 0) - Y = Y | 0xFFFFFC00; - - TX1_C = (Y * oldval_1) >> 8; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Y = 0x%x, TX1_C = 0x%x\n", Y, TX1_C)); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XD_TX_AFE, 0xF0000000, ((TX1_C & 0x3C0) >> 6)); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XB_TX_IQ_IMBALANCE, 0x003F0000, (TX1_C & 0x3F)); - - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_ECCA_THRESHOLD, BIT(25), ((Y * oldval_1 >> 7) & 0x1)); - - if (is_tx_only) - return; - - reg = result[final_candidate][6]; - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XB_RX_IQ_IMBALANCE, 0x3FF, reg); - - reg = result[final_candidate][7] & 0x3F; - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_XB_RX_IQ_IMBALANCE, 0xFC00, reg); - - reg = (result[final_candidate][7] >> 6) & 0xF; - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_AGC_RSSI_TABLE, 0x0000F000, reg); - } -} - -/* - * 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) -bool -odm_check_power_status( - struct _ADAPTER *adapter) -{ -#if 0 - /* HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); */ - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; - RT_RF_POWER_STATE rt_state; - PMGNT_INFO p_mgnt_info = &(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) { - ODM_RT_TRACE(p_dm_odm, COMP_INIT, DBG_LOUD, ("odm_check_power_status Return true, due to initadapter")); - return true; - } - - /* */ - /* 2011/07/19 MH We can not execute tx pwoer tracking/ LLC calibrate or IQK. */ - /* */ - phydm_get_hw_reg_interface(p_dm_odm, HW_VAR_RF_STATE, (u8 *)(&rt_state)); - if (adapter->is_driver_stopped || adapter->is_driver_is_going_to_pnp_set_power_sleep || rt_state == eRfOff) { - ODM_RT_TRACE(p_dm_odm, COMP_INIT, DBG_LOUD, ("odm_check_power_status Return false, due to %d/%d/%d\n", - adapter->is_driver_stopped, adapter->is_driver_is_going_to_pnp_set_power_sleep, rt_state)); - return false; - } -#endif - return true; -} -#endif - -void -_phy_save_adda_registers( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - u32 *adda_reg, - u32 *adda_backup, - u32 register_num -) -{ - u32 i; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif - - if (odm_check_power_status(p_adapter) == false) - return; -#endif - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Save ADDA parameters.\n")); - for (i = 0 ; i < register_num ; i++) - adda_backup[i] = odm_get_bb_reg(p_dm_odm, adda_reg[i], MASKDWORD); -} - - -void -_phy_save_mac_registers( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - u32 *mac_reg, - u32 *mac_backup -) -{ - u32 i; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Save MAC parameters.\n")); - for (i = 0 ; i < (IQK_MAC_REG_NUM - 1); i++) - mac_backup[i] = odm_read_1byte(p_dm_odm, mac_reg[i]); - mac_backup[i] = odm_read_4byte(p_dm_odm, mac_reg[i]); - -} - - -void -_phy_reload_adda_registers( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - u32 *adda_reg, - u32 *adda_backup, - u32 regiester_num -) -{ - u32 i; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - - ODM_RT_TRACE(p_dm_odm, 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_odm, adda_reg[i], MASKDWORD, adda_backup[i]); -} - -void -_phy_reload_mac_registers( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - u32 *mac_reg, - u32 *mac_backup -) -{ - u32 i; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - ODM_RT_TRACE(p_dm_odm, 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_odm, mac_reg[i], (u8)mac_backup[i]); - odm_write_4byte(p_dm_odm, mac_reg[i], mac_backup[i]); -} - - -void -_phy_path_adda_on( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - u32 *adda_reg, - bool is_path_a_on, - bool is2T -) -{ - u32 path_on; - u32 i; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("ADDA ON.\n")); - - path_on = is_path_a_on ? 0x04db25a4 : 0x0b1b25a4; - if (false == is2T) { - path_on = 0x0bdb25a0; - odm_set_bb_reg(p_dm_odm, adda_reg[0], MASKDWORD, 0x0b1b25a0); - } else - odm_set_bb_reg(p_dm_odm, adda_reg[0], MASKDWORD, path_on); - - for (i = 1 ; i < IQK_ADDA_REG_NUM ; i++) - odm_set_bb_reg(p_dm_odm, adda_reg[i], MASKDWORD, path_on); - -} - -void -_phy_mac_setting_calibration( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - u32 *mac_reg, - u32 *mac_backup -) -{ - u32 i = 0; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("MAC settings for Calibration.\n")); - - odm_write_1byte(p_dm_odm, mac_reg[i], 0x3F); - - for (i = 1 ; i < (IQK_MAC_REG_NUM - 1); i++) - odm_write_1byte(p_dm_odm, mac_reg[i], (u8)(mac_backup[i] & (~BIT(3)))); - odm_write_1byte(p_dm_odm, mac_reg[i], (u8)(mac_backup[i] & (~BIT(5)))); - -} - -void -_phy_path_a_stand_by( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm -#else - struct _ADAPTER *p_adapter -#endif -) -{ -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path-A standby mode!\n")); - - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x000000); - odm_set_bb_reg(p_dm_odm, 0x840, MASKDWORD, 0x00010000); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x808000); -} - -void -_phy_pi_mode_switch( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - bool pi_mode -) -{ - u32 mode; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("BB Switch to %s mode!\n", (pi_mode ? "PI" : "SI"))); - - mode = pi_mode ? 0x01000100 : 0x01000000; - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XA_HSSI_PARAMETER1, MASKDWORD, mode); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XB_HSSI_PARAMETER1, MASKDWORD, mode); -} - -bool -phy_simularity_compare_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - s32 result[][8], - u8 c1, - u8 c2 -) -{ - u32 i, j, diff, simularity_bit_map, bound = 0; -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - u8 final_candidate[2] = {0xFF, 0xFF}; /* for path A and path B */ - bool is_result = true; -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - bool is2T = IS_92C_SERIAL(p_hal_data->VersionID); -#else - bool is2T = 0; -#endif - - if (is2T) - bound = 8; - else - bound = 4; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("===> IQK:phy_simularity_compare_8188e c1 %d c2 %d!!!\n", c1, c2)); - - - simularity_bit_map = 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) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK:phy_simularity_compare_8188e differnece overflow index %d compare1 0x%x compare2 0x%x!!!\n", 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, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK:phy_simularity_compare_8188e simularity_bit_map %d !!!\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 & 0x0F)) { /* path A OK */ - for (i = 0; i < 4; i++) - result[3][i] = result[c1][i]; - return false; - } else if (!(simularity_bit_map & 0xF0) && is2T) { /* path B OK */ - for (i = 4; i < 8; i++) - result[3][i] = result[c1][i]; - return false; - } else - return false; - -} - - - -void -_phy_iq_calibrate_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - s32 result[][8], - u8 t, - bool 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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm_odm->rf_calibrate_info); - u32 i; - u8 path_aok, path_bok; - 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 - }; - - /* since 92C & 92D have the different define in IQK_BB_REG */ - 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 - }; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - u32 retry_count = 2; -#else -#if MP_DRIVER - const u32 retry_count = 2; -#else - const u32 retry_count = 2; -#endif -#endif - - /* Note: IQ calibration must be performed after loading */ - /* PHY_REG.txt , and radio_a, radio_b.txt */ - - /* u32 bbvalue; */ - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -#ifdef MP_TEST - if (p_dm_odm->priv->pshare->rf_ft_var.mp_specific) - retry_count = 9; -#endif -#endif - - - if (t == 0) { - /* bbvalue = odm_get_bb_reg(p_dm_odm, REG_FPGA0_RFMOD, MASKDWORD); - * RT_DISP(FINIT, INIT_IQK, ("_phy_iq_calibrate_8188e()==>0x%08x\n",bbvalue)); */ - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQ Calibration for %s for %d times\n", (is2T ? "2T2R" : "1T1R"), t)); - - /* Save ADDA parameters, turn path A ADDA on */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_save_adda_registers(p_adapter, ADDA_REG, p_rf_calibrate_info->ADDA_backup, IQK_ADDA_REG_NUM); - _phy_save_mac_registers(p_adapter, IQK_MAC_REG, p_rf_calibrate_info->IQK_MAC_backup); - _phy_save_adda_registers(p_adapter, IQK_BB_REG_92C, p_rf_calibrate_info->IQK_BB_backup, IQK_BB_REG_NUM); -#else - _phy_save_adda_registers(p_dm_odm, ADDA_REG, p_rf_calibrate_info->ADDA_backup, IQK_ADDA_REG_NUM); - _phy_save_mac_registers(p_dm_odm, IQK_MAC_REG, p_rf_calibrate_info->IQK_MAC_backup); - _phy_save_adda_registers(p_dm_odm, IQK_BB_REG_92C, p_rf_calibrate_info->IQK_BB_backup, IQK_BB_REG_NUM); -#endif - } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQ Calibration for %s for %d times\n", (is2T ? "2T2R" : "1T1R"), t)); - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - - _phy_path_adda_on(p_adapter, ADDA_REG, true, is2T); -#else - _phy_path_adda_on(p_dm_odm, ADDA_REG, true, is2T); -#endif - - - if (t == 0) - p_rf_calibrate_info->is_rf_pi_enable = (u8)odm_get_bb_reg(p_dm_odm, REG_FPGA0_XA_HSSI_PARAMETER1, BIT(8)); - - if (!p_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(p_adapter, true); -#else - _phy_pi_mode_switch(p_dm_odm, true); -#endif - } - - /* MAC settings */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_mac_setting_calibration(p_adapter, IQK_MAC_REG, p_rf_calibrate_info->IQK_MAC_backup); -#else - _phy_mac_setting_calibration(p_dm_odm, IQK_MAC_REG, p_rf_calibrate_info->IQK_MAC_backup); -#endif - - /* BB setting */ - /* odm_set_bb_reg(p_dm_odm, REG_FPGA0_RFMOD, BIT24, 0x00); */ - odm_set_bb_reg(p_dm_odm, REG_CCK_0_AFE_SETTING, 0x0f000000, 0xf); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_TRX_PATH_ENABLE, MASKDWORD, 0x03a05600); - odm_set_bb_reg(p_dm_odm, REG_OFDM_0_TR_MUX_PAR, MASKDWORD, 0x000800e4); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XCD_RF_INTERFACE_SW, MASKDWORD, 0x22204000); - - - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XAB_RF_INTERFACE_SW, BIT(10), 0x01); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XAB_RF_INTERFACE_SW, BIT(26), 0x01); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XA_RF_INTERFACE_OE, BIT(10), 0x00); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(10), 0x00); - - - if (is2T) { - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XA_LSSI_PARAMETER, MASKDWORD, 0x00010000); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XB_LSSI_PARAMETER, MASKDWORD, 0x00010000); - } - - - - - /* Page B init */ - /* AP or IQK */ - odm_set_bb_reg(p_dm_odm, REG_CONFIG_ANT_A, MASKDWORD, 0x0f600000); - - if (is2T) - odm_set_bb_reg(p_dm_odm, REG_CONFIG_ANT_B, MASKDWORD, 0x0f600000); - - /* IQ calibration setting */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK setting!\n")); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x808000); - odm_set_bb_reg(p_dm_odm, REG_TX_IQK, MASKDWORD, 0x01007c00); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK, MASKDWORD, 0x81004800); - - - for (i = 0 ; i < retry_count ; i++) { -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - path_aok = phy_path_a_iqk_8188e(p_adapter, is2T, t + i); -#else - path_aok = phy_path_a_iqk_8188e(p_dm_odm, is2T, t + i); -#endif - /* if(path_aok == 0x03){ */ - if (path_aok == 0x01) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A Tx IQK Success!!\n")); - result[t][0] = (odm_get_bb_reg(p_dm_odm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD) & 0x3FF0000) >> 16; - result[t][1] = (odm_get_bb_reg(p_dm_odm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD) & 0x3FF0000) >> 16; - break; - } -#if 0 - else if (i == (retry_count - 1) && path_aok == 0x01) { /* Tx IQK OK */ - RT_DISP(FINIT, INIT_IQK, ("path A IQK Only Tx Success!!\n")); - - result[t][0] = (odm_get_bb_reg(p_dm_odm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD) & 0x3FF0000) >> 16; - result[t][1] = (odm_get_bb_reg(p_dm_odm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD) & 0x3FF0000) >> 16; - } -#endif - } - - for (i = 0 ; i < retry_count ; i++) { -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - path_aok = phy_path_a_rx_iqk(p_adapter, is2T); -#else - path_aok = phy_path_a_rx_iqk(p_dm_odm, is2T); -#endif - if (path_aok == 0x03) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A Rx IQK Success!!\n")); - /* result[t][0] = (odm_get_bb_reg(p_dm_odm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD)&0x3FF0000)>>16; - * result[t][1] = (odm_get_bb_reg(p_dm_odm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD)&0x3FF0000)>>16; */ - result[t][2] = (odm_get_bb_reg(p_dm_odm, REG_RX_POWER_BEFORE_IQK_A_2, MASKDWORD) & 0x3FF0000) >> 16; - result[t][3] = (odm_get_bb_reg(p_dm_odm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD) & 0x3FF0000) >> 16; - break; - } else - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A Rx IQK Fail!!\n")); - } - - if (0x00 == path_aok) - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A IQK failed!!\n")); - - if (is2T) { -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_path_a_stand_by(p_adapter); - - /* Turn path B ADDA on */ - _phy_path_adda_on(p_adapter, ADDA_REG, false, is2T); -#else - _phy_path_a_stand_by(p_dm_odm); - - /* Turn path B ADDA on */ - _phy_path_adda_on(p_dm_odm, ADDA_REG, false, is2T); -#endif - - for (i = 0 ; i < retry_count ; i++) { -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - path_bok = phy_path_b_iqk_8188e(p_adapter); -#else - path_bok = phy_path_b_iqk_8188e(p_dm_odm); -#endif - if (path_bok == 0x03) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B IQK Success!!\n")); - result[t][4] = (odm_get_bb_reg(p_dm_odm, REG_TX_POWER_BEFORE_IQK_B, MASKDWORD) & 0x3FF0000) >> 16; - result[t][5] = (odm_get_bb_reg(p_dm_odm, REG_TX_POWER_AFTER_IQK_B, MASKDWORD) & 0x3FF0000) >> 16; - result[t][6] = (odm_get_bb_reg(p_dm_odm, REG_RX_POWER_BEFORE_IQK_B_2, MASKDWORD) & 0x3FF0000) >> 16; - result[t][7] = (odm_get_bb_reg(p_dm_odm, REG_RX_POWER_AFTER_IQK_B_2, MASKDWORD) & 0x3FF0000) >> 16; - break; - } else if (i == (retry_count - 1) && path_bok == 0x01) { /* Tx IQK OK */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B Only Tx IQK Success!!\n")); - result[t][4] = (odm_get_bb_reg(p_dm_odm, REG_TX_POWER_BEFORE_IQK_B, MASKDWORD) & 0x3FF0000) >> 16; - result[t][5] = (odm_get_bb_reg(p_dm_odm, REG_TX_POWER_AFTER_IQK_B, MASKDWORD) & 0x3FF0000) >> 16; - } - } - - if (0x00 == path_bok) - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B IQK failed!!\n")); - } - - /* Back to BB mode, load original value */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK:Back to BB mode, load original value!\n")); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x000000); - - if (t != 0) { - if (!p_rf_calibrate_info->is_rf_pi_enable) { - /* Switch back BB to SI mode after finish IQ Calibration. */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_pi_mode_switch(p_adapter, false); -#else - _phy_pi_mode_switch(p_dm_odm, false); -#endif - } -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - - /* Reload ADDA power saving parameters */ - _phy_reload_adda_registers(p_adapter, ADDA_REG, p_rf_calibrate_info->ADDA_backup, IQK_ADDA_REG_NUM); - - /* Reload MAC parameters */ - _phy_reload_mac_registers(p_adapter, IQK_MAC_REG, p_rf_calibrate_info->IQK_MAC_backup); - - _phy_reload_adda_registers(p_adapter, IQK_BB_REG_92C, p_rf_calibrate_info->IQK_BB_backup, IQK_BB_REG_NUM); -#else - /* Reload ADDA power saving parameters */ - _phy_reload_adda_registers(p_dm_odm, ADDA_REG, p_rf_calibrate_info->ADDA_backup, IQK_ADDA_REG_NUM); - - /* Reload MAC parameters */ - _phy_reload_mac_registers(p_dm_odm, IQK_MAC_REG, p_rf_calibrate_info->IQK_MAC_backup); - - _phy_reload_adda_registers(p_dm_odm, IQK_BB_REG_92C, p_rf_calibrate_info->IQK_BB_backup, IQK_BB_REG_NUM); -#endif - - - /* Restore RX initial gain */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XA_LSSI_PARAMETER, MASKDWORD, 0x00032ed3); - if (is2T) - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XB_LSSI_PARAMETER, MASKDWORD, 0x00032ed3); - - /* load 0xe30 IQC default value */ - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_TONE_A, MASKDWORD, 0x01008c00); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_TONE_A, MASKDWORD, 0x01008c00); - - } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_iq_calibrate_8188e() <==\n")); - -} - - -void -_phy_lc_calibrate_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - bool is2T -) -{ - u8 tmp_reg; - u32 rf_amode = 0, rf_bmode = 0, lc_cal; -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - struct _ADAPTER *p_adapter = p_dm_odm->adapter; -#endif - /* Check continuous TX and Packet TX */ - tmp_reg = odm_read_1byte(p_dm_odm, 0xd03); - - if ((tmp_reg & 0x70) != 0) /* Deal with contisuous TX case */ - odm_write_1byte(p_dm_odm, 0xd03, tmp_reg & 0x8F); /* disable all continuous TX */ - else /* Deal with Packet TX case */ - odm_write_1byte(p_dm_odm, REG_TXPAUSE, 0xFF); /* block all queues */ - - if ((tmp_reg & 0x70) != 0) { - /* 1. Read original RF mode */ - /* path-A */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - rf_amode = odm_get_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_AC, MASK12BITS); - - /* path-B */ - if (is2T) - rf_bmode = odm_get_rf_reg(p_dm_odm, ODM_RF_PATH_B, RF_AC, MASK12BITS); -#else - rf_amode = odm_get_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_AC, MASK12BITS); - - /* path-B */ - if (is2T) - rf_bmode = odm_get_rf_reg(p_dm_odm, ODM_RF_PATH_B, RF_AC, MASK12BITS); -#endif - - /* 2. Set RF mode = standby mode */ - /* path-A */ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_AC, MASK12BITS, (rf_amode & 0x8FFFF) | 0x10000); - - /* path-B */ - if (is2T) - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, RF_AC, MASK12BITS, (rf_bmode & 0x8FFFF) | 0x10000); - } - - /* 3. Read RF reg18 */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - lc_cal = odm_get_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_CHNLBW, MASK12BITS); -#else - lc_cal = odm_get_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_CHNLBW, MASK12BITS); -#endif - - /* 4. Set LC calibration begin bit15 */ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_CHNLBW, MASK12BITS, lc_cal | 0x08000); - - ODM_delay_ms(100); - - - /* Restore original situation */ - if ((tmp_reg & 0x70) != 0) { /* Deal with contisuous TX case */ - /* path-A */ - odm_write_1byte(p_dm_odm, 0xd03, tmp_reg); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_AC, MASK12BITS, rf_amode); - - /* path-B */ - if (is2T) - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, RF_AC, MASK12BITS, rf_bmode); - } else /* Deal with Packet TX case */ - odm_write_1byte(p_dm_odm, REG_TXPAUSE, 0x00); -} - -/* Analog Pre-distortion calibration */ -#define APK_BB_REG_NUM 8 -#define APK_CURVE_REG_NUM 4 -#define PATH_NUM 2 - -void -_phy_ap_calibrate_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - s8 delta, - bool 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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm_odm->rf_calibrate_info); - u32 reg_d[PATH_NUM]; - u32 tmp_reg, index, offset, apkbound; - u8 path, i, pathbound = PATH_NUM; - u32 BB_backup[APK_BB_REG_NUM]; - u32 BB_REG[APK_BB_REG_NUM] = { - REG_FPGA1_TX_BLOCK, REG_OFDM_0_TRX_PATH_ENABLE, - REG_FPGA0_RFMOD, REG_OFDM_0_TR_MUX_PAR, - REG_FPGA0_XCD_RF_INTERFACE_SW, REG_FPGA0_XAB_RF_INTERFACE_SW, - REG_FPGA0_XA_RF_INTERFACE_OE, REG_FPGA0_XB_RF_INTERFACE_OE - }; - u32 BB_AP_MODE[APK_BB_REG_NUM] = { - 0x00000020, 0x00a05430, 0x02040000, - 0x000800e4, 0x00204000 - }; - u32 BB_normal_AP_MODE[APK_BB_REG_NUM] = { - 0x00000020, 0x00a05430, 0x02040000, - 0x000800e4, 0x22204000 - }; - - u32 AFE_backup[IQK_ADDA_REG_NUM]; - u32 AFE_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 MAC_backup[IQK_MAC_REG_NUM]; - u32 MAC_REG[IQK_MAC_REG_NUM] = { - REG_TXPAUSE, REG_BCN_CTRL, - REG_BCN_CTRL_1, REG_GPIO_MUXCFG - }; - - u32 APK_RF_init_value[PATH_NUM][APK_BB_REG_NUM] = { - {0x0852c, 0x1852c, 0x5852c, 0x1852c, 0x5852c}, - {0x2852e, 0x0852e, 0x3852e, 0x0852e, 0x0852e} - }; - - u32 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} - }; - - u32 APK_RF_value_0[PATH_NUM][APK_BB_REG_NUM] = { - {0x52019, 0x52014, 0x52013, 0x5200f, 0x5208d}, - {0x5201a, 0x52019, 0x52016, 0x52033, 0x52050} - }; - - u32 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} - }; - - u32 AFE_on_off[PATH_NUM] = { - 0x04db25a4, 0x0b1b25a4 - }; /* path A on path B off / path A off path B on */ - - u32 APK_offset[PATH_NUM] = { - REG_CONFIG_ANT_A, REG_CONFIG_ANT_B - }; - - u32 APK_normal_offset[PATH_NUM] = { - REG_CONFIG_PMPD_ANT_A, REG_CONFIG_PMPD_ANT_B - }; - - u32 APK_value[PATH_NUM] = { - 0x92fc0000, 0x12fc0000 - }; - - u32 APK_normal_value[PATH_NUM] = { - 0x92680000, 0x12680000 - }; - - s8 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} - }; - - u32 APK_normal_setting_value_1[13] = { - 0x01017018, 0xf7ed8f84, 0x1b1a1816, 0x2522201e, 0x322e2b28, - 0x433f3a36, 0x5b544e49, 0x7b726a62, 0xa69a8f84, 0xdfcfc0b3, - 0x12680000, 0x00880000, 0x00880000 - }; - - u32 APK_normal_setting_value_2[16] = { - 0x01c7021d, 0x01670183, 0x01000123, 0x00bf00e2, 0x008d00a3, - 0x0068007b, 0x004d0059, 0x003a0042, 0x002b0031, 0x001f0025, - 0x0017001b, 0x00110014, 0x000c000f, 0x0009000b, 0x00070008, - 0x00050006 - }; - - u32 APK_result[PATH_NUM][APK_BB_REG_NUM]; /* val_1_1a, val_1_2a, val_2a, val_3a, val_4a - * u32 AP_curve[PATH_NUM][APK_CURVE_REG_NUM]; */ - - s32 BB_offset, delta_V, delta_offset; - -#if MP_DRIVER == 1 -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - PMPT_CONTEXT p_mpt_ctx = &(p_adapter->mppriv.mpt_ctx); -#else - PMPT_CONTEXT p_mpt_ctx = &(p_adapter->mpt_ctx); -#endif - p_mpt_ctx->APK_bound[0] = 45; - p_mpt_ctx->APK_bound[1] = 52; - -#endif - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("==>_phy_ap_calibrate_8188e() delta %d\n", delta)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("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] = odm_get_bb_reg(p_dm_odm, BB_REG[index], MASKDWORD); - } - - /* save MAC default value */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_save_mac_registers(p_adapter, MAC_REG, MAC_backup); - - /* save AFE default value */ - _phy_save_adda_registers(p_adapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -#else - _phy_save_mac_registers(p_dm_odm, MAC_REG, MAC_backup); - - /* save AFE default value */ - _phy_save_adda_registers(p_dm_odm, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -#endif - - for (path = 0; path < pathbound; path++) { - - - if (path == ODM_RF_PATH_A) { - /* path A APK */ - /* load APK setting */ - /* path-A */ - offset = REG_PDP_ANT_A; - for (index = 0; index < 11; index++) { - odm_set_bb_reg(p_dm_odm, offset, MASKDWORD, APK_normal_setting_value_1[index]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0x%x value 0x%x\n", offset, odm_get_bb_reg(p_dm_odm, offset, MASKDWORD))); - - offset += 0x04; - } - - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x12680000); - - offset = REG_CONFIG_ANT_A; - for (; index < 13; index++) { - odm_set_bb_reg(p_dm_odm, offset, MASKDWORD, APK_normal_setting_value_1[index]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0x%x value 0x%x\n", offset, odm_get_bb_reg(p_dm_odm, offset, MASKDWORD))); - - offset += 0x04; - } - - /* page-B1 */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x400000); - - /* path A */ - offset = REG_PDP_ANT_A; - for (index = 0; index < 16; index++) { - odm_set_bb_reg(p_dm_odm, offset, MASKDWORD, APK_normal_setting_value_2[index]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0x%x value 0x%x\n", offset, odm_get_bb_reg(p_dm_odm, offset, MASKDWORD))); - - offset += 0x04; - } - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x000000); - } else if (path == ODM_RF_PATH_B) { - /* path B APK */ - /* load APK setting */ - /* path-B */ - offset = REG_PDP_ANT_B; - for (index = 0; index < 10; index++) { - odm_set_bb_reg(p_dm_odm, offset, MASKDWORD, APK_normal_setting_value_1[index]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0x%x value 0x%x\n", offset, odm_get_bb_reg(p_dm_odm, offset, MASKDWORD))); - - offset += 0x04; - } - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_A, MASKDWORD, 0x12680000); -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x12680000); -#else - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x12680000); -#endif - - offset = REG_CONFIG_ANT_A; - index = 11; - for (; index < 13; index++) { /* offset 0xb68, 0xb6c */ - odm_set_bb_reg(p_dm_odm, offset, MASKDWORD, APK_normal_setting_value_1[index]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0x%x value 0x%x\n", offset, odm_get_bb_reg(p_dm_odm, offset, MASKDWORD))); - - offset += 0x04; - } - - /* page-B1 */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x400000); - - /* path B */ - offset = 0xb60; - for (index = 0; index < 16; index++) { - odm_set_bb_reg(p_dm_odm, offset, MASKDWORD, APK_normal_setting_value_2[index]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0x%x value 0x%x\n", offset, odm_get_bb_reg(p_dm_odm, offset, MASKDWORD))); - - offset += 0x04; - } - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x000000); - } - - /* save RF default value */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - reg_d[path] = odm_get_rf_reg(p_dm_odm, path, RF_TXBIAS_A, MASKDWORD); -#else - reg_d[path] = odm_get_rf_reg(p_dm_odm, (enum odm_rf_radio_path_e)path, RF_TXBIAS_A, MASKDWORD); -#endif - - /* path A AFE all on, path B AFE All off or vise versa */ - for (index = 0; index < IQK_ADDA_REG_NUM ; index++) - odm_set_bb_reg(p_dm_odm, AFE_REG[index], MASKDWORD, AFE_on_off[path]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0xe70 %x\n", odm_get_bb_reg(p_dm_odm, REG_RX_WAIT_CCA, MASKDWORD))); - - /* 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) - odm_set_bb_reg(p_dm_odm, BB_REG[index], MASKDWORD, BB_AP_MODE[index]); - else if (BB_REG[index] == 0x870) - odm_set_bb_reg(p_dm_odm, BB_REG[index], MASKDWORD, BB_backup[index] | BIT(10) | BIT(26)); - else - odm_set_bb_reg(p_dm_odm, BB_REG[index], BIT(10), 0x0); - } - - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_TONE_A, MASKDWORD, 0x01008c00); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_TONE_A, MASKDWORD, 0x01008c00); - } else { /* path B */ - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_TONE_B, MASKDWORD, 0x01008c00); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_TONE_B, MASKDWORD, 0x01008c00); - - } - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0x800 %x\n", odm_get_bb_reg(p_dm_odm, 0x800, MASKDWORD))); - - /* MAC settings */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_mac_setting_calibration(p_adapter, MAC_REG, MAC_backup); -#else - _phy_mac_setting_calibration(p_dm_odm, MAC_REG, MAC_backup); -#endif - - if (path == ODM_RF_PATH_A) /* path B to standby mode */ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, RF_AC, MASKDWORD, 0x10000); - else { /* path A to standby mode */ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_AC, MASKDWORD, 0x10000); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_MODE1, MASKDWORD, 0x1000f); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_MODE2, MASKDWORD, 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; - - tmp_reg = APK_RF_init_value[path][index]; -#if 1 - if (!p_rf_calibrate_info->is_apk_thermal_meter_ignore) { - BB_offset = (tmp_reg & 0xF0000) >> 16; - - if (!(tmp_reg & BIT(15))) /* sign bit 0 */ - BB_offset = -BB_offset; - - delta_V = APK_delta_mapping[index][delta_offset]; - - BB_offset += delta_V; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() APK index %d tmp_reg 0x%x delta_V %d delta_offset %d\n", index, tmp_reg, delta_V, delta_offset)); - - if (BB_offset < 0) { - tmp_reg = tmp_reg & (~BIT(15)); - BB_offset = -BB_offset; - } else - tmp_reg = tmp_reg | BIT(15); - tmp_reg = (tmp_reg & 0xFFF0FFFF) | (BB_offset << 16); - } -#endif - - odm_set_rf_reg(p_dm_odm, (enum odm_rf_radio_path_e)path, RF_IPA_A, MASKDWORD, 0x8992e); -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0xc %x\n", odm_get_rf_reg(p_dm_odm, path, RF_IPA_A, MASKDWORD))); - odm_set_rf_reg(p_dm_odm, (enum odm_rf_radio_path_e)path, RF_AC, MASKDWORD, APK_RF_value_0[path][index]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0x0 %x\n", odm_get_rf_reg(p_dm_odm, path, RF_AC, MASKDWORD))); - odm_set_rf_reg(p_dm_odm, (enum odm_rf_radio_path_e)path, RF_TXBIAS_A, MASKDWORD, tmp_reg); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0xd %x\n", odm_get_rf_reg(p_dm_odm, path, RF_TXBIAS_A, MASKDWORD))); -#else - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0xc %x\n", odm_get_rf_reg(p_dm_odm, path, RF_IPA_A, MASKDWORD))); - odm_set_rf_reg(p_dm_odm, path, RF_AC, MASKDWORD, APK_RF_value_0[path][index]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0x0 %x\n", odm_get_rf_reg(p_dm_odm, path, RF_AC, MASKDWORD))); - odm_set_rf_reg(p_dm_odm, path, RF_TXBIAS_A, MASKDWORD, tmp_reg); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0xd %x\n", odm_get_rf_reg(p_dm_odm, path, RF_TXBIAS_A, MASKDWORD))); -#endif - - /* PA11+PAD01111, one shot */ - i = 0; - do { - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x800000); - { - odm_set_bb_reg(p_dm_odm, APK_offset[path], MASKDWORD, APK_value[0]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0x%x value 0x%x\n", APK_offset[path], odm_get_bb_reg(p_dm_odm, APK_offset[path], MASKDWORD))); - ODM_delay_ms(3); - odm_set_bb_reg(p_dm_odm, APK_offset[path], MASKDWORD, APK_value[1]); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0x%x value 0x%x\n", APK_offset[path], odm_get_bb_reg(p_dm_odm, APK_offset[path], MASKDWORD))); - - ODM_delay_ms(20); - } - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x000000); - - if (path == ODM_RF_PATH_A) - tmp_reg = odm_get_bb_reg(p_dm_odm, REG_APK, 0x03E00000); - else - tmp_reg = odm_get_bb_reg(p_dm_odm, REG_APK, 0xF8000000); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_ap_calibrate_8188e() offset 0xbd8[25:21] %x\n", tmp_reg)); - - - i++; - } while (tmp_reg > apkbound && i < 4); - - APK_result[path][index] = tmp_reg; - } - } - - /* reload MAC default value */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_reload_mac_registers(p_adapter, MAC_REG, MAC_backup); -#else - _phy_reload_mac_registers(p_dm_odm, MAC_REG, MAC_backup); -#endif - - /* reload BB default value */ - for (index = 0; index < APK_BB_REG_NUM ; index++) { - - if (index == 0) /* skip */ - continue; - odm_set_bb_reg(p_dm_odm, BB_REG[index], MASKDWORD, BB_backup[index]); - } - - /* reload AFE default value */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_reload_adda_registers(p_adapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -#else - _phy_reload_adda_registers(p_dm_odm, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -#endif - - /* reload RF path default value */ - for (path = 0; path < pathbound; path++) { - odm_set_rf_reg(p_dm_odm, (enum odm_rf_radio_path_e)path, 0xd, MASKDWORD, reg_d[path]); - if (path == ODM_RF_PATH_B) { - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_MODE1, MASKDWORD, 0x1000f); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_MODE2, MASKDWORD, 0x20101); - } - - /* note no index == 0 */ - if (APK_result[path][1] > 6) - APK_result[path][1] = 6; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("apk path %d result %d 0x%x \t", path, 1, APK_result[path][1])); - } - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("\n")); - - - for (path = 0; path < pathbound; path++) { - odm_set_rf_reg(p_dm_odm, (enum odm_rf_radio_path_e)path, 0x3, MASKDWORD, - ((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_set_rf_reg(p_dm_odm, (enum odm_rf_radio_path_e)path, 0x4, MASKDWORD, - ((APK_result[path][1] << 15) | (APK_result[path][1] << 10) | (0x00 << 5) | 0x05)); - else - odm_set_rf_reg(p_dm_odm, (enum odm_rf_radio_path_e)path, 0x4, MASKDWORD, - ((APK_result[path][1] << 15) | (APK_result[path][1] << 10) | (0x02 << 5) | 0x05)); -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - odm_set_rf_reg(p_dm_odm, (enum odm_rf_radio_path_e)path, RF_BS_PA_APSET_G9_G11, MASKDWORD, - ((0x08 << 15) | (0x08 << 10) | (0x08 << 5) | 0x08)); -#endif - } - - p_rf_calibrate_info->is_ap_kdone = true; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<==_phy_ap_calibrate_8188e()\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_iq_calibrate_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - bool is_recovery -) -{ - - /* 20131031 - * V2.0 - * fine tune TXIQK/RXIQK loop gain for SMIC. - * LOK only perform 1 time. - * IQK retry count 10-->2 */ - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#else /* (DM_ODM_SUPPORT_TYPE == ODM_CE) */ - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->odmpriv; -#endif - -#if (MP_DRIVER == 1) -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PMPT_CONTEXT p_mpt_ctx = &(p_adapter->mpt_ctx); -#else/* (DM_ODM_SUPPORT_TYPE == ODM_CE) */ - PMPT_CONTEXT p_mpt_ctx = &(p_adapter->mppriv.mpt_ctx); -#endif -#endif/* (MP_DRIVER == 1) */ -#endif - struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm_odm->rf_calibrate_info); - s32 result[4][8]; /* last is final result */ - u8 i, final_candidate, indexforchannel; - bool is_patha_ok, is_pathb_ok; - s32 rege94, rege9c, regea4, regeac, regeb4, regebc, regec4, regecc, reg_tmp = 0; - bool is12simular, is13simular, is23simular; - bool is_single_tone = false, is_carrier_suppression = false; - 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 - }; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - if (odm_check_power_status(p_adapter) == false) - return; -#else - struct rtl8192cd_priv *priv = p_dm_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) - is_recovery = 1; - priv->pshare->IQK_88E_done = 1; - -#endif - -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - if (!(p_dm_odm->support_ability & ODM_RF_CALIBRATION)) - return; -#endif - -#if MP_DRIVER == 1 - is_single_tone = p_mpt_ctx->is_single_tone; - is_carrier_suppression = p_mpt_ctx->is_carrier_suppression; -#endif - - /* 20120213 Turn on when continuous Tx to pass lab testing. (required by Edlu) */ - if (is_single_tone || is_carrier_suppression) - return; - -#if DISABLE_BB_RF - return; -#endif - - if (p_rf_calibrate_info->is_iqk_in_progress) - return; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_AP)) - if (is_recovery) -#else/* for ODM_WIN */ - if (is_recovery && (!p_adapter->bInHctTest)) /* YJ,add for PowerTest,120405 */ -#endif - { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("phy_iq_calibrate_8188e: Return due to is_recovery!\n")); -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_reload_adda_registers(p_adapter, IQK_BB_REG_92C, p_rf_calibrate_info->IQK_BB_backup_recover, 9); -#else - _phy_reload_adda_registers(p_dm_odm, IQK_BB_REG_92C, p_rf_calibrate_info->IQK_BB_backup_recover, 9); -#endif - return; - } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK:Start!!!\n")); - odm_acquire_spin_lock(p_dm_odm, RT_IQK_SPINLOCK); - p_rf_calibrate_info->is_iqk_in_progress = true; - odm_release_spin_lock(p_dm_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; - is_patha_ok = false; - is_pathb_ok = false; - is12simular = false; - is23simular = false; - is13simular = false; - - - for (i = 0; i < 3; i++) { -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - - if (IS_92C_SERIAL(p_hal_data->VersionID)) - _phy_iq_calibrate_8188e(p_adapter, result, i, true); - else -#endif - { - /* For 88C 1T1R */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_iq_calibrate_8188e(p_adapter, result, i, false); -#else - _phy_iq_calibrate_8188e(p_dm_odm, result, i, false); -#endif - } - - if (i == 1) { -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - is12simular = phy_simularity_compare_8188e(p_adapter, result, 0, 1); -#else - is12simular = phy_simularity_compare_8188e(p_dm_odm, result, 0, 1); -#endif - if (is12simular) { - final_candidate = 0; - ODM_RT_TRACE(p_dm_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_simularity_compare_8188e(p_adapter, result, 0, 2); -#else - is13simular = phy_simularity_compare_8188e(p_dm_odm, result, 0, 2); -#endif - if (is13simular) { - final_candidate = 0; - ODM_RT_TRACE(p_dm_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_simularity_compare_8188e(p_adapter, result, 1, 2); -#else - is23simular = phy_simularity_compare_8188e(p_dm_odm, result, 1, 2); -#endif - if (is23simular) { - final_candidate = 1; - ODM_RT_TRACE(p_dm_odm, 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; - } - } - } - /* RT_TRACE(COMP_INIT,DBG_LOUD,("Release Mutex in IQCalibrate\n")); */ - - 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]; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("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) { - p_rf_calibrate_info->rege94 = rege94 = result[final_candidate][0]; - p_rf_calibrate_info->rege9c = rege9c = result[final_candidate][1]; - regea4 = result[final_candidate][2]; - regeac = result[final_candidate][3]; - p_rf_calibrate_info->regeb4 = regeb4 = result[final_candidate][4]; - p_rf_calibrate_info->regebc = regebc = result[final_candidate][5]; - regec4 = result[final_candidate][6]; - regecc = result[final_candidate][7]; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK: final_candidate is %x\n", final_candidate)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("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)); - is_patha_ok = is_pathb_ok = true; - } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK: FAIL use default value\n")); - - p_rf_calibrate_info->rege94 = p_rf_calibrate_info->regeb4 = 0x100; /* X default value */ - p_rf_calibrate_info->rege9c = p_rf_calibrate_info->regebc = 0x0; /* Y default value */ - } - - if ((rege94 != 0)/*&&(regea4 != 0)*/) { -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_path_a_fill_iqk_matrix(p_adapter, is_patha_ok, result, final_candidate, (regea4 == 0)); -#else - _phy_path_a_fill_iqk_matrix(p_dm_odm, is_patha_ok, result, final_candidate, (regea4 == 0)); -#endif - } - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - if (IS_92C_SERIAL(p_hal_data->VersionID)) { - if ((regeb4 != 0)/*&&(regec4 != 0)*/) - _phy_path_b_fill_iqk_matrix(p_adapter, is_pathb_ok, result, final_candidate, (regec4 == 0)); - } -#endif - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - indexforchannel = odm_get_right_chnl_place_for_iqk(*p_dm_odm->p_channel); -#else - indexforchannel = 0; -#endif - - /* To Fix BSOD when final_candidate is 0xff - * by sherry 20120321 */ - if (final_candidate < 4) { - for (i = 0; i < iqk_matrix_reg_num; i++) - p_rf_calibrate_info->iqk_matrix_reg_setting[indexforchannel].value[0][i] = result[final_candidate][i]; - p_rf_calibrate_info->iqk_matrix_reg_setting[indexforchannel].is_iqk_done = true; - } - /* RT_DISP(FINIT, INIT_IQK, ("\nIQK OK indexforchannel %d.\n", indexforchannel)); */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("\nIQK OK indexforchannel %d.\n", indexforchannel)); -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - - _phy_save_adda_registers(p_adapter, IQK_BB_REG_92C, p_rf_calibrate_info->IQK_BB_backup_recover, 9); -#else - _phy_save_adda_registers(p_dm_odm, IQK_BB_REG_92C, p_rf_calibrate_info->IQK_BB_backup_recover, IQK_BB_REG_NUM); -#endif - - odm_acquire_spin_lock(p_dm_odm, RT_IQK_SPINLOCK); - p_rf_calibrate_info->is_iqk_in_progress = false; - odm_release_spin_lock(p_dm_odm, RT_IQK_SPINLOCK); - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK finished\n")); - -} - - -void -phy_lc_calibrate_8188e( - void *p_dm_void -) -{ - bool is_single_tone = false, is_carrier_suppression = false; - u32 timeout = 2000, timecount = 0; - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - struct _ADAPTER *p_adapter = p_dm_odm->adapter; - /* HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); */ - -#if (MP_DRIVER == 1) -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PMPT_CONTEXT p_mpt_ctx = &(p_adapter->mpt_ctx); -#else/* (DM_ODM_SUPPORT_TYPE == ODM_CE) */ - PMPT_CONTEXT p_mpt_ctx = &(p_adapter->mppriv.mpt_ctx); -#endif -#endif/* (MP_DRIVER == 1) */ -#endif - struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm_odm->rf_calibrate_info); -#if MP_DRIVER == 1 - is_single_tone = p_mpt_ctx->is_single_tone; - is_carrier_suppression = p_mpt_ctx->is_carrier_suppression; -#endif - - -#if DISABLE_BB_RF - return; -#endif - -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - if (!(p_dm_odm->support_ability & ODM_RF_CALIBRATION)) - return; -#endif - /* 20120213 Turn on when continuous Tx to pass lab testing. (required by Edlu) */ - if (is_single_tone || is_carrier_suppression) - return; - - while (*(p_dm_odm->p_is_scan_in_process) && timecount < timeout) { - ODM_delay_ms(50); - timecount += 50; - } - - p_rf_calibrate_info->is_lck_in_progress = true; - - /* ODM_RT_TRACE(p_dm_odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LCK:Start!!!interface %d currentband %x delay %d ms\n", p_dm_odm->interface_index, p_hal_data->CurrentBandType92D, timecount)); */ - _phy_lc_calibrate_8188e(p_dm_odm, false); - - p_rf_calibrate_info->is_lck_in_progress = false; - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LCK:Finish!!!interface %d\n", p_dm_odm->interface_index)); - -} - -void -phy_ap_calibrate_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - s8 delta -) -{ -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm_odm->rf_calibrate_info); -#if DISABLE_BB_RF - return; -#endif - - return; -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - if (!(p_dm_odm->support_ability & ODM_RF_CALIBRATION)) - return; -#endif - -#if FOR_BRAZIL_PRETEST != 1 - if (p_rf_calibrate_info->is_ap_kdone) -#endif - return; - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - if (IS_92C_SERIAL(p_hal_data->VersionID)) - _phy_ap_calibrate_8188e(p_adapter, delta, true); - else -#endif - { - /* For 88C 1T1R */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_ap_calibrate_8188e(p_adapter, delta, false); -#else - _phy_ap_calibrate_8188e(p_dm_odm, delta, false); -#endif - } -} -void _phy_set_rf_path_switch_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - bool is_main, - bool 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_odm = &p_hal_data->odmpriv; -#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - if (!p_adapter->bHWInitReady) -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - if (p_adapter->hw_init_completed == _FALSE) -#endif - { - u8 u1b_tmp; - u1b_tmp = odm_read_1byte(p_dm_odm, REG_LEDCFG2) | BIT(7); - odm_write_1byte(p_dm_odm, REG_LEDCFG2, u1b_tmp); - /* odm_set_bb_reg(p_dm_odm, REG_LEDCFG0, BIT23, 0x01); */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XAB_RF_PARAMETER, BIT(13), 0x01); - } - -#endif - - if (is2T) { /* 92C */ - if (is_main) - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(5) | BIT6, 0x1); /* 92C_Path_A */ - else - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(5) | BIT6, 0x2); /* BT */ - } else { /* 88C */ - - /* <20120504, Kordan> [8188E] We should make AntDiversity controlled by HW (0x870[9:8] = 0), */ - /* otherwise the following action has no effect. (0x860[9:8] has the effect only if AntDiversity controlled by SW) */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XAB_RF_INTERFACE_SW, BIT(8) | BIT(9), 0x0); - odm_set_bb_reg(p_dm_odm, 0x914, MASKLWORD, 0x0201); /* Set up the ant mapping table */ - - if (is_main) { - /* odm_set_bb_reg(p_dm_odm, REG_FPGA0_XA_RF_INTERFACE_OE, BIT(8)|BIT9, 0x2); */ /* Tx Main (SW control)(The right antenna) */ - /* 4 [ Tx ] */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XA_RF_INTERFACE_OE, BIT(14) | BIT13 | BIT12, 0x1); /* Tx Main (HW control)(The right antenna) */ - - /* 4 [ Rx ] */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(5) | BIT4 | BIT3, 0x1); /* ant_div_type = TRDiv, right antenna */ - if (p_dm_odm->ant_div_type == CGCS_RX_HW_ANTDIV) - odm_set_bb_reg(p_dm_odm, REG_CONFIG_RAM64X16, BIT(31), 0x1); /* RxCG, Default is RxCG. ant_div_type = 2RDiv, left antenna */ - - } else { - /* odm_set_bb_reg(p_dm_odm, REG_FPGA0_XA_RF_INTERFACE_OE, BIT(8)|BIT9, 0x1); */ /* Tx Aux (SW control)(The left antenna) */ - /* 4 [ Tx ] */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XA_RF_INTERFACE_OE, BIT(14) | BIT13 | BIT12, 0x0); /* Tx Aux (HW control)(The left antenna) */ - - /* 4 [ Rx ] */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(5) | BIT4 | BIT3, 0x0); /* ant_div_type = TRDiv, left antenna */ - if (p_dm_odm->ant_div_type == CGCS_RX_HW_ANTDIV) - odm_set_bb_reg(p_dm_odm, REG_CONFIG_RAM64X16, BIT(31), 0x0); /* RxCS, ant_div_type = 2RDiv, right antenna */ - } - - } -} -void phy_set_rf_path_switch_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - bool is_main -) -{ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); -#endif - -#if DISABLE_BB_RF - return; -#endif - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - if (IS_92C_SERIAL(p_hal_data->VersionID)) - _phy_set_rf_path_switch_8188e(p_adapter, is_main, true); - else -#endif - { - /* For 88C 1T1R */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_set_rf_path_switch_8188e(p_adapter, is_main, false); -#else - _phy_set_rf_path_switch_8188e(p_dm_odm, is_main, false); -#endif - } -} - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -/* digital predistortion */ -void -phy_digital_predistortion( -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - struct _ADAPTER *p_adapter, -#else - struct PHY_DM_STRUCT *p_dm_odm, -#endif - bool is2T -) -{ -#if (RT_PLATFORM == PLATFORM_WINDOWS) -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm_odm->rf_calibrate_info); - u32 tmp_reg, tmp_reg2, index, i; - u8 path, pathbound = PATH_NUM; - u32 AFE_backup[IQK_ADDA_REG_NUM]; - u32 AFE_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 BB_backup[DP_BB_REG_NUM]; - u32 BB_REG[DP_BB_REG_NUM] = { - REG_OFDM_0_TRX_PATH_ENABLE, REG_FPGA0_RFMOD, - REG_OFDM_0_TR_MUX_PAR, REG_FPGA0_XCD_RF_INTERFACE_SW, - REG_FPGA0_XAB_RF_INTERFACE_SW, REG_FPGA0_XA_RF_INTERFACE_OE, - REG_FPGA0_XB_RF_INTERFACE_OE - }; - u32 BB_settings[DP_BB_REG_NUM] = { - 0x00a05430, 0x02040000, 0x000800e4, 0x22208000, - 0x0, 0x0, 0x0 - }; - - u32 RF_backup[DP_PATH_NUM][DP_RF_REG_NUM]; - u32 RF_REG[DP_RF_REG_NUM] = { - RF_TXBIAS_A - }; - - u32 MAC_backup[IQK_MAC_REG_NUM]; - u32 MAC_REG[IQK_MAC_REG_NUM] = { - REG_TXPAUSE, REG_BCN_CTRL, - REG_BCN_CTRL_1, REG_GPIO_MUXCFG - }; - - u32 tx_agc[DP_DPK_NUM][DP_DPK_VALUE_NUM] = { - {0x1e1e1e1e, 0x03901e1e}, - {0x18181818, 0x03901818}, - {0x0e0e0e0e, 0x03900e0e} - }; - - u32 AFE_on_off[PATH_NUM] = { - 0x04db25a4, 0x0b1b25a4 - }; /* path A on path B off / path A off path B on */ - - u8 retry_count = 0; - - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("==>phy_digital_predistortion()\n")); - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_digital_predistortion for %s\n", (is2T ? "2T2R" : "1T1R"))); - - /* save BB default value */ - for (index = 0; index < DP_BB_REG_NUM; index++) - BB_backup[index] = odm_get_bb_reg(p_dm_odm, BB_REG[index], MASKDWORD); - - /* save MAC default value */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_save_mac_registers(p_adapter, BB_REG, MAC_backup); -#else - _phy_save_mac_registers(p_dm_odm, BB_REG, MAC_backup); -#endif - - /* save RF default value */ - 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] = odm_get_rf_reg(p_dm_odm, path, RF_REG[index], MASKDWORD); -#else - RF_backup[path][index] = odm_get_rf_reg(p_dm_odm, path, RF_REG[index], MASKDWORD); -#endif - } - - /* save AFE default value */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_save_adda_registers(p_adapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -#else - _phy_save_adda_registers(p_dm_odm, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -#endif - - /* path A/B AFE all on */ - for (index = 0; index < IQK_ADDA_REG_NUM ; index++) - odm_set_bb_reg(p_dm_odm, AFE_REG[index], MASKDWORD, 0x6fdb25a4); - - /* BB register setting */ - for (index = 0; index < DP_BB_REG_NUM; index++) { - if (index < 4) - odm_set_bb_reg(p_dm_odm, BB_REG[index], MASKDWORD, BB_settings[index]); - else if (index == 4) - odm_set_bb_reg(p_dm_odm, BB_REG[index], MASKDWORD, BB_backup[index] | BIT(10) | BIT(26)); - else - odm_set_bb_reg(p_dm_odm, BB_REG[index], BIT(10), 0x00); - } - - /* MAC register setting */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_mac_setting_calibration(p_adapter, MAC_REG, MAC_backup); -#else - _phy_mac_setting_calibration(p_dm_odm, MAC_REG, MAC_backup); -#endif - - /* PAGE-E IQC setting */ - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_TONE_A, MASKDWORD, 0x01008c00); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_TONE_A, MASKDWORD, 0x01008c00); - odm_set_bb_reg(p_dm_odm, REG_TX_IQK_TONE_B, MASKDWORD, 0x01008c00); - odm_set_bb_reg(p_dm_odm, REG_RX_IQK_TONE_B, MASKDWORD, 0x01008c00); - - /* path_A DPK */ - /* path B to standby mode */ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, RF_AC, MASKDWORD, 0x10000); - - /* PA gain = 11 & PAD1 => tx_agc 1f ~11 */ - /* PA gain = 11 & PAD2 => tx_agc 10~0e */ - /* PA gain = 01 => tx_agc 0b~0d */ - /* PA gain = 00 => tx_agc 0a~00 */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x400000); - odm_set_bb_reg(p_dm_odm, 0xbc0, MASKDWORD, 0x0005361f); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x000000); - - /* do inner loopback DPK 3 times */ - for (i = 0; i < 3; i++) { - /* PA gain = 11 & PAD2 => tx_agc = 0x0f/0x0c/0x07 */ - for (index = 0; index < 3; index++) - odm_set_bb_reg(p_dm_odm, 0xe00 + index * 4, MASKDWORD, tx_agc[i][0]); - odm_set_bb_reg(p_dm_odm, 0xe00 + index * 4, MASKDWORD, tx_agc[i][1]); - for (index = 0; index < 4; index++) - odm_set_bb_reg(p_dm_odm, 0xe10 + index * 4, MASKDWORD, tx_agc[i][0]); - - /* PAGE_B for path-A inner loopback DPK setting */ - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_A, MASKDWORD, 0x02097098); - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_A_4, MASKDWORD, 0xf76d9f84); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_A, MASKDWORD, 0x0004ab87); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_ANT_A, MASKDWORD, 0x00880000); - - /* ----send one shot signal---- */ - /* path A */ - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_A, MASKDWORD, 0x80047788); - ODM_delay_ms(1); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_A, MASKDWORD, 0x00047788); - ODM_delay_ms(50); - } - - /* PA gain = 11 => tx_agc = 1a */ - for (index = 0; index < 3; index++) - odm_set_bb_reg(p_dm_odm, 0xe00 + index * 4, MASKDWORD, 0x34343434); - odm_set_bb_reg(p_dm_odm, 0xe08 + index * 4, MASKDWORD, 0x03903434); - for (index = 0; index < 4; index++) - odm_set_bb_reg(p_dm_odm, 0xe10 + index * 4, MASKDWORD, 0x34343434); - - /* ==================================== */ - /* PAGE_B for path-A DPK setting */ - /* ==================================== */ - /* open inner loopback @ b00[19]:10 od 0xb00 0x01097018 */ - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_A, MASKDWORD, 0x02017098); - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_A_4, MASKDWORD, 0xf76d9f84); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_A, MASKDWORD, 0x0004ab87); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_ANT_A, MASKDWORD, 0x00880000); - - /* rf_lpbk_setup */ - /* 1.rf 00:5205a, rf 0d:0e52c */ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x0c, MASKDWORD, 0x8992b); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x0d, MASKDWORD, 0x0e52c); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x00, MASKDWORD, 0x5205a); - - /* ----send one shot signal---- */ - /* path A */ - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_A, MASKDWORD, 0x800477c0); - ODM_delay_ms(1); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_A, MASKDWORD, 0x000477c0); - ODM_delay_ms(50); - - while (retry_count < DP_RETRY_LIMIT && !p_rf_calibrate_info->is_dp_path_aok) { - /* ----read back measurement results---- */ - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_A, MASKDWORD, 0x0c297018); - tmp_reg = odm_get_bb_reg(p_dm_odm, 0xbe0, MASKDWORD); - ODM_delay_ms(10); - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_A, MASKDWORD, 0x0c29701f); - tmp_reg2 = odm_get_bb_reg(p_dm_odm, 0xbe8, MASKDWORD); - ODM_delay_ms(10); - - tmp_reg = (tmp_reg & MASKHWORD) >> 16; - tmp_reg2 = (tmp_reg2 & MASKHWORD) >> 16; - if (tmp_reg < 0xf0 || tmp_reg > 0x105 || tmp_reg2 > 0xff) { - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_A, MASKDWORD, 0x02017098); - - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x800000); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x000000); - ODM_delay_ms(1); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_A, MASKDWORD, 0x800477c0); - ODM_delay_ms(1); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_A, MASKDWORD, 0x000477c0); - ODM_delay_ms(50); - retry_count++; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A DPK retry_count %d 0xbe0[31:16] %x 0xbe8[31:16] %x\n", retry_count, tmp_reg, tmp_reg2)); - } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A DPK Sucess\n")); - p_rf_calibrate_info->is_dp_path_aok = true; - break; - } - } - retry_count = 0; - - /* DPP path A */ - if (p_rf_calibrate_info->is_dp_path_aok) { - /* DP settings */ - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_A, MASKDWORD, 0x01017098); - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_A_4, MASKDWORD, 0x776d9f84); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_A, MASKDWORD, 0x0004ab87); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_ANT_A, MASKDWORD, 0x00880000); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x400000); - - for (i = REG_PDP_ANT_A; i <= 0xb3c; i += 4) { - odm_set_bb_reg(p_dm_odm, i, MASKDWORD, 0x40004000); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path A ofsset = 0x%x\n", i)); - } - - /* pwsf */ - odm_set_bb_reg(p_dm_odm, 0xb40, MASKDWORD, 0x40404040); - odm_set_bb_reg(p_dm_odm, 0xb44, MASKDWORD, 0x28324040); - odm_set_bb_reg(p_dm_odm, 0xb48, MASKDWORD, 0x10141920); - - for (i = 0xb4c; i <= 0xb5c; i += 4) - odm_set_bb_reg(p_dm_odm, i, MASKDWORD, 0x0c0c0c0c); - - /* TX_AGC boundary */ - odm_set_bb_reg(p_dm_odm, 0xbc0, MASKDWORD, 0x0005361f); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x000000); - } else { - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_A, MASKDWORD, 0x00000000); - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_A_4, MASKDWORD, 0x00000000); - } - - /* DPK path B */ - if (is2T) { - /* path A to standby mode */ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_AC, MASKDWORD, 0x10000); - - /* LUTs => tx_agc */ - /* PA gain = 11 & PAD1, => tx_agc 1f ~11 */ - /* PA gain = 11 & PAD2, => tx_agc 10 ~0e */ - /* PA gain = 01 => tx_agc 0b ~0d */ - /* PA gain = 00 => tx_agc 0a ~00 */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x400000); - odm_set_bb_reg(p_dm_odm, 0xbc4, MASKDWORD, 0x0005361f); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x000000); - - /* do inner loopback DPK 3 times */ - for (i = 0; i < 3; i++) { - /* PA gain = 11 & PAD2 => tx_agc = 0x0f/0x0c/0x07 */ - for (index = 0; index < 4; index++) - odm_set_bb_reg(p_dm_odm, 0x830 + index * 4, MASKDWORD, tx_agc[i][0]); - for (index = 0; index < 2; index++) - odm_set_bb_reg(p_dm_odm, 0x848 + index * 4, MASKDWORD, tx_agc[i][0]); - for (index = 0; index < 2; index++) - odm_set_bb_reg(p_dm_odm, 0x868 + index * 4, MASKDWORD, tx_agc[i][0]); - - /* PAGE_B for path-A inner loopback DPK setting */ - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_B, MASKDWORD, 0x02097098); - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_B_4, MASKDWORD, 0xf76d9f84); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x0004ab87); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_ANT_B, MASKDWORD, 0x00880000); - - /* ----send one shot signal---- */ - /* path B */ - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x80047788); - ODM_delay_ms(1); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x00047788); - ODM_delay_ms(50); - } - - /* PA gain = 11 => tx_agc = 1a */ - for (index = 0; index < 4; index++) - odm_set_bb_reg(p_dm_odm, 0x830 + index * 4, MASKDWORD, 0x34343434); - for (index = 0; index < 2; index++) - odm_set_bb_reg(p_dm_odm, 0x848 + index * 4, MASKDWORD, 0x34343434); - for (index = 0; index < 2; index++) - odm_set_bb_reg(p_dm_odm, 0x868 + index * 4, MASKDWORD, 0x34343434); - - /* PAGE_B for path-B DPK setting */ - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_B, MASKDWORD, 0x02017098); - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_B_4, MASKDWORD, 0xf76d9f84); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x0004ab87); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_ANT_B, MASKDWORD, 0x00880000); - - /* RF lpbk switches on */ - odm_set_bb_reg(p_dm_odm, 0x840, MASKDWORD, 0x0101000f); - odm_set_bb_reg(p_dm_odm, 0x840, MASKDWORD, 0x01120103); - - /* path-B RF lpbk */ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0x0c, MASKDWORD, 0x8992b); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0x0d, MASKDWORD, 0x0e52c); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, RF_AC, MASKDWORD, 0x5205a); - - /* ----send one shot signal---- */ - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x800477c0); - ODM_delay_ms(1); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x000477c0); - ODM_delay_ms(50); - - while (retry_count < DP_RETRY_LIMIT && !p_rf_calibrate_info->is_dp_path_bok) { - /* ----read back measurement results---- */ - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_B, MASKDWORD, 0x0c297018); - tmp_reg = odm_get_bb_reg(p_dm_odm, 0xbf0, MASKDWORD); - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_B, MASKDWORD, 0x0c29701f); - tmp_reg2 = odm_get_bb_reg(p_dm_odm, 0xbf8, MASKDWORD); - - tmp_reg = (tmp_reg & MASKHWORD) >> 16; - tmp_reg2 = (tmp_reg2 & MASKHWORD) >> 16; - - if (tmp_reg < 0xf0 || tmp_reg > 0x105 || tmp_reg2 > 0xff) { - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_B, MASKDWORD, 0x02017098); - - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x800000); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x000000); - ODM_delay_ms(1); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x800477c0); - ODM_delay_ms(1); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x000477c0); - ODM_delay_ms(50); - retry_count++; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B DPK retry_count %d 0xbf0[31:16] %x, 0xbf8[31:16] %x\n", retry_count, tmp_reg, tmp_reg2)); - } else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B DPK Success\n")); - p_rf_calibrate_info->is_dp_path_bok = true; - break; - } - } - - /* DPP path B */ - if (p_rf_calibrate_info->is_dp_path_bok) { - /* DP setting */ - /* LUT by SRAM */ - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_B, MASKDWORD, 0x01017098); - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_B_4, MASKDWORD, 0x776d9f84); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_PMPD_ANT_B, MASKDWORD, 0x0004ab87); - odm_set_bb_reg(p_dm_odm, REG_CONFIG_ANT_B, MASKDWORD, 0x00880000); - - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x400000); - for (i = 0xb60; i <= 0xb9c; i += 4) { - odm_set_bb_reg(p_dm_odm, i, MASKDWORD, 0x40004000); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B ofsset = 0x%x\n", i)); - } - - /* PWSF */ - odm_set_bb_reg(p_dm_odm, 0xba0, MASKDWORD, 0x40404040); - odm_set_bb_reg(p_dm_odm, 0xba4, MASKDWORD, 0x28324050); - odm_set_bb_reg(p_dm_odm, 0xba8, MASKDWORD, 0x0c141920); - - for (i = 0xbac; i <= 0xbbc; i += 4) - odm_set_bb_reg(p_dm_odm, i, MASKDWORD, 0x0c0c0c0c); - - /* tx_agc boundary */ - odm_set_bb_reg(p_dm_odm, 0xbc4, MASKDWORD, 0x0005361f); - odm_set_bb_reg(p_dm_odm, REG_FPGA0_IQK, 0xffffff00, 0x000000); - - } else { - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_B, MASKDWORD, 0x00000000); - odm_set_bb_reg(p_dm_odm, REG_PDP_ANT_B_4, MASKDWORD, 0x00000000); - } - } - - /* reload BB default value */ - for (index = 0; index < DP_BB_REG_NUM; index++) - odm_set_bb_reg(p_dm_odm, BB_REG[index], MASKDWORD, BB_backup[index]); - - /* reload RF default value */ - for (path = 0; path < DP_PATH_NUM; path++) { - for (i = 0 ; i < DP_RF_REG_NUM ; i++) - odm_set_rf_reg(p_dm_odm, path, RF_REG[i], MASKDWORD, RF_backup[path][i]); - } - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_MODE1, MASKDWORD, 0x1000f); /* standby mode */ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_MODE2, MASKDWORD, 0x20101); /* RF lpbk switches off */ - - /* reload AFE default value */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _phy_reload_adda_registers(p_adapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); - - /* reload MAC default value */ - _phy_reload_mac_registers(p_adapter, MAC_REG, MAC_backup); -#else - _phy_reload_adda_registers(p_dm_odm, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); - - /* reload MAC default value */ - _phy_reload_mac_registers(p_dm_odm, MAC_REG, MAC_backup); -#endif - - p_rf_calibrate_info->is_dp_done = true; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<==phy_digital_predistortion()\n")); -#endif -} - -void -phy_digital_predistortion_8188e( -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - struct _ADAPTER *p_adapter -#else - struct PHY_DM_STRUCT *p_dm_odm -#endif -) -{ -#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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm_odm->rf_calibrate_info); -#if DISABLE_BB_RF - return; -#endif - - return; - - if (p_rf_calibrate_info->is_dp_done) - return; -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - - if (IS_92C_SERIAL(p_hal_data->VersionID)) - phy_digital_predistortion(p_adapter, true); - else -#endif - { - /* For 88C 1T1R */ - phy_digital_predistortion(p_adapter, false); - } -} - - - -/* return value true => Main; false => Aux */ - -bool _phy_query_rf_path_switch_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm, -#else - struct _ADAPTER *p_adapter, -#endif - bool 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_odm = &p_hal_data->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; -#endif -#endif - if (!p_adapter->bHWInitReady) { - u8 u1b_tmp; - u1b_tmp = odm_read_1byte(p_dm_odm, REG_LEDCFG2) | BIT(7); - odm_write_1byte(p_dm_odm, REG_LEDCFG2, u1b_tmp); - /* odm_set_bb_reg(p_dm_odm, REG_LEDCFG0, BIT23, 0x01); */ - odm_set_bb_reg(p_dm_odm, REG_FPGA0_XAB_RF_PARAMETER, BIT(13), 0x01); - } - - if (is2T) { - if (odm_get_bb_reg(p_dm_odm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(5) | BIT(6)) == 0x01) - return true; - else - return false; - } else { - if ((odm_get_bb_reg(p_dm_odm, REG_FPGA0_XB_RF_INTERFACE_OE, BIT(5) | BIT(4) | BIT(3)) == 0x1)) - return true; - else - return false; - } -} - - - -/* return value true => Main; false => Aux */ -bool phy_query_rf_path_switch_8188e( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - struct PHY_DM_STRUCT *p_dm_odm -#else - struct _ADAPTER *p_adapter -#endif -) -{ - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); - -#if DISABLE_BB_RF - return true; -#endif -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - - /* if(IS_92C_SERIAL( p_hal_data->version_id)) { */ - if (IS_2T2R(p_hal_data->VersionID)) - return _phy_query_rf_path_switch_8188e(p_adapter, true); - else -#endif - { - /* For 88C 1T1R */ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - return _phy_query_rf_path_switch_8188e(p_adapter, false); -#else - return _phy_query_rf_path_switch_8188e(p_dm_odm, false); -#endif - } -} -#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/phydm_regconfig8188e.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/phydm_regconfig8188e.c index 569af50f662f..da6d495293e0 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/phydm_regconfig8188e.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/phydm_regconfig8188e.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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" @@ -24,20 +20,14 @@ #if (RTL8188E_SUPPORT == 1) -void -odm_config_rf_reg_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u32 addr, - u32 data, - enum odm_rf_radio_path_e RF_PATH, - u32 reg_addr -) +void odm_config_rf_reg_8188e(struct dm_struct *dm, u32 addr, u32 data, + enum rf_path RF_PATH, u32 reg_addr) { #if (DM_ODM_SUPPORT_TYPE == ODM_AP) #ifndef SMP_SYNC unsigned long x; #endif - struct rtl8192cd_priv *priv = p_dm_odm->priv; + struct rtl8192cd_priv *priv = dm->priv; #endif if (addr == 0xffe) { @@ -57,87 +47,64 @@ odm_config_rf_reg_8188e( else if (addr == 0xf9) ODM_delay_us(1); else { - #if (DM_ODM_SUPPORT_TYPE == ODM_AP) SAVE_INT_AND_CLI(x); - odm_set_rf_reg(p_dm_odm, RF_PATH, reg_addr, RFREGOFFSETMASK, data); + odm_set_rf_reg(dm, RF_PATH, reg_addr, RFREGOFFSETMASK, data); RESTORE_INT(x); #else - odm_set_rf_reg(p_dm_odm, RF_PATH, reg_addr, RFREGOFFSETMASK, data); + odm_set_rf_reg(dm, RF_PATH, reg_addr, RFREGOFFSETMASK, data); #endif /* Add 1us delay between BB/RF register setting. */ ODM_delay_us(1); } } - -void -odm_config_rf_radio_a_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u32 addr, - u32 data -) +void odm_config_rf_radio_a_8188e(struct dm_struct *dm, u32 addr, u32 data) { - u32 content = 0x1000; /* RF_Content: radioa_txt */ - u32 maskfor_phy_set = (u32)(content & 0xE000); + u32 content = 0x1000; /* RF_Content: radioa_txt */ + u32 maskfor_phy_set = (u32)(content & 0xE000); - odm_config_rf_reg_8188e(p_dm_odm, addr, data, ODM_RF_PATH_A, addr | maskfor_phy_set); + odm_config_rf_reg_8188e(dm, addr, data, RF_PATH_A, addr | maskfor_phy_set); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> odm_config_rf_with_header_file: [RadioA] %08X %08X\n", addr, data)); + PHYDM_DBG(dm, ODM_COMP_INIT, + "===> odm_config_rf_with_header_file: [RadioA] %08X %08X\n", + addr, data); } -void -odm_config_rf_radio_b_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u32 addr, - u32 data -) +void odm_config_rf_radio_b_8188e(struct dm_struct *dm, u32 addr, u32 data) { - u32 content = 0x1001; /* RF_Content: radiob_txt */ - u32 maskfor_phy_set = (u32)(content & 0xE000); + u32 content = 0x1001; /* RF_Content: radiob_txt */ + u32 maskfor_phy_set = (u32)(content & 0xE000); - odm_config_rf_reg_8188e(p_dm_odm, addr, data, ODM_RF_PATH_B, addr | maskfor_phy_set); - - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> odm_config_rf_with_header_file: [RadioB] %08X %08X\n", addr, data)); + odm_config_rf_reg_8188e(dm, addr, data, RF_PATH_B, addr | maskfor_phy_set); + PHYDM_DBG(dm, ODM_COMP_INIT, + "===> odm_config_rf_with_header_file: [RadioB] %08X %08X\n", + addr, data); } -void -odm_config_mac_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u32 addr, - u8 data -) +void odm_config_mac_8188e(struct dm_struct *dm, u32 addr, u8 data) { - odm_write_1byte(p_dm_odm, addr, data); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> odm_config_mac_with_header_file: [MAC_REG] %08X %08X\n", addr, data)); + odm_write_1byte(dm, addr, data); + PHYDM_DBG(dm, ODM_COMP_INIT, + "===> odm_config_mac_with_header_file: [MAC_REG] %08X %08X\n", + addr, data); } -void -odm_config_bb_agc_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u32 addr, - u32 bitmask, - u32 data -) +void odm_config_bb_agc_8188e(struct dm_struct *dm, u32 addr, u32 bitmask, + u32 data) { - odm_set_bb_reg(p_dm_odm, addr, bitmask, data); + odm_set_bb_reg(dm, addr, bitmask, data); /* Add 1us delay between BB/RF register setting. */ ODM_delay_us(1); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> odm_config_bb_with_header_file: [AGC_TAB] %08X %08X\n", addr, data)); + PHYDM_DBG(dm, ODM_COMP_INIT, + "===> odm_config_bb_with_header_file: [AGC_TAB] %08X %08X\n", + addr, data); } -void -odm_config_bb_phy_reg_pg_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u32 band, - u32 rf_path, - u32 tx_num, - u32 addr, - u32 bitmask, - u32 data -) +void odm_config_bb_phy_reg_pg_8188e(struct dm_struct *dm, u32 band, u32 rf_path, + u32 tx_num, u32 addr, u32 bitmask, u32 data) { if (addr == 0xfe) { #ifdef CONFIG_LONG_DELAY_ISSUE @@ -156,39 +123,33 @@ odm_config_bb_phy_reg_pg_8188e( else if (addr == 0xf9) ODM_delay_us(1); else { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> odm_config_bb_with_header_file: [PHY_REG] %08X %08X %08X\n", addr, bitmask, data)); + PHYDM_DBG(dm, ODM_COMP_INIT, + "===> odm_config_bb_with_header_file: [PHY_REG] %08X %08X %08X\n", + addr, bitmask, data); -#if !(DM_ODM_SUPPORT_TYPE&ODM_AP) - phy_store_tx_power_by_rate(p_dm_odm->adapter, band, rf_path, tx_num, addr, bitmask, data); +#if (DM_ODM_SUPPORT_TYPE & ODM_CE) + phy_store_tx_power_by_rate(dm->adapter, band, rf_path, tx_num, addr, bitmask, data); +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + PHY_StoreTxPowerByRate(dm->adapter, band, rf_path, tx_num, addr, bitmask, data); #endif } } -void -odm_config_bb_txpwr_lmt_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u8 *regulation, - u8 *band, - u8 *bandwidth, - u8 *rate_section, - u8 *rf_path, - u8 *channel, - u8 *power_limit -) +void odm_config_bb_txpwr_lmt_8188e(struct dm_struct *dm, u8 *regulation, + u8 *band, u8 *bandwidth, u8 *rate_section, + u8 *rf_path, u8 *channel, u8 *power_limit) { -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - phy_set_tx_power_limit(p_dm_odm, regulation, band, - bandwidth, rate_section, rf_path, channel, power_limit); +#if (DM_ODM_SUPPORT_TYPE & ODM_CE) + phy_set_tx_power_limit(dm, regulation, band, + bandwidth, rate_section, rf_path, channel, power_limit); +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + PHY_SetTxPowerLimit(dm, regulation, band, + bandwidth, rate_section, rf_path, channel, power_limit); #endif } -void -odm_config_bb_phy_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u32 addr, - u32 bitmask, - u32 data -) +void odm_config_bb_phy_8188e(struct dm_struct *dm, u32 addr, u32 bitmask, + u32 data) { if (addr == 0xfe) { #ifdef CONFIG_LONG_DELAY_ISSUE @@ -208,12 +169,14 @@ odm_config_bb_phy_8188e( ODM_delay_us(1); else { if (addr == 0xa24) - p_dm_odm->rf_calibrate_info.rega24 = data; - odm_set_bb_reg(p_dm_odm, addr, bitmask, data); + dm->rf_calibrate_info.rega24 = data; + odm_set_bb_reg(dm, addr, bitmask, data); /* Add 1us delay between BB/RF register setting. */ ODM_delay_us(1); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_INIT, ODM_DBG_TRACE, ("===> odm_config_bb_with_header_file: [PHY_REG] %08X %08X\n", addr, data)); + PHYDM_DBG(dm, ODM_COMP_INIT, + "===> odm_config_bb_with_header_file: [PHY_REG] %08X %08X\n", + addr, data); } } #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/phydm_regconfig8188e.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/phydm_regconfig8188e.h index c26b26c4a2ef..250adbf953e7 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/phydm_regconfig8188e.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/phydm_regconfig8188e.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,85 +12,34 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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_8188E #define __INC_ODM_REGCONFIG_H_8188E #if (RTL8188E_SUPPORT == 1) -void -odm_config_rf_reg_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u32 addr, - u32 data, - enum odm_rf_radio_path_e RF_PATH, - u32 reg_addr -); +void odm_config_rf_reg_8188e(struct dm_struct *dm, u32 addr, u32 data, + enum rf_path RF_PATH, u32 reg_addr); -void -odm_config_rf_radio_a_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u32 addr, - u32 data -); +void odm_config_rf_radio_a_8188e(struct dm_struct *dm, u32 addr, u32 data); -void -odm_config_rf_radio_b_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u32 addr, - u32 data -); +void odm_config_rf_radio_b_8188e(struct dm_struct *dm, u32 addr, u32 data); -void -odm_config_mac_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u32 addr, - u8 data -); +void odm_config_mac_8188e(struct dm_struct *dm, u32 addr, u8 data); -void -odm_config_bb_agc_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u32 addr, - u32 bitmask, - u32 data -); +void odm_config_bb_agc_8188e(struct dm_struct *dm, u32 addr, u32 bitmask, + u32 data); -void -odm_config_bb_phy_reg_pg_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u32 band, - u32 rf_path, - u32 tx_num, - u32 addr, - u32 bitmask, - u32 data -); +void odm_config_bb_phy_reg_pg_8188e(struct dm_struct *dm, u32 band, u32 rf_path, + u32 tx_num, u32 addr, u32 bitmask, + u32 data); -void -odm_config_bb_phy_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u32 addr, - u32 bitmask, - u32 data -); +void odm_config_bb_phy_8188e(struct dm_struct *dm, u32 addr, u32 bitmask, + u32 data); -void -odm_config_bb_txpwr_lmt_8188e( - struct PHY_DM_STRUCT *p_dm_odm, - u8 *regulation, - u8 *band, - u8 *bandwidth, - u8 *rate_section, - u8 *rf_path, - u8 *channel, - u8 *power_limit -); +void odm_config_bb_txpwr_lmt_8188e(struct dm_struct *dm, u8 *regulation, + u8 *band, u8 *bandwidth, u8 *rate_section, + u8 *rf_path, u8 *channel, u8 *power_limit); #endif #endif /* end of SUPPORT */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/phydm_rtl8188e.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/phydm_rtl8188e.c index f9d4c12a4481..6142e6dc45d7 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/phydm_rtl8188e.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/phydm_rtl8188e.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 @@ -28,361 +24,36 @@ #if (RTL8188E_SUPPORT == 1) -void -odm_dig_lower_bound_88e( - struct PHY_DM_STRUCT *p_dm_odm -) +s8 phydm_cck_rssi_8188e(struct dm_struct *dm, u16 lna_idx, u8 vga_idx) { - struct _dynamic_initial_gain_threshold_ *p_dm_dig_table = &p_dm_odm->dm_dig_table; - - if (p_dm_odm->ant_div_type == CG_TRX_HW_ANTDIV) { - p_dm_dig_table->rx_gain_range_min = (u8) p_dm_dig_table->ant_div_rssi_max; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_dig_lower_bound_88e(): p_dm_dig_table->ant_div_rssi_max=%d\n", p_dm_dig_table->ant_div_rssi_max)); - } - /* If only one Entry connected */ -} - -/*============================================================= -* AntDiv Before Link -===============================================================*/ -void -odm_sw_ant_div_reset_before_link( - struct PHY_DM_STRUCT *p_dm_odm -) -{ - - struct _sw_antenna_switch_ *p_dm_swat_table = &p_dm_odm->dm_swat_table; - - p_dm_swat_table->swas_no_link_state = 0; - -} - - -/* 3============================================================ - * 3 Dynamic Primary CCA - * 3============================================================ */ - -void -odm_primary_cca_init( - struct PHY_DM_STRUCT *p_dm_odm) -{ - struct _dynamic_primary_cca *primary_cca = &(p_dm_odm->dm_pri_cca); - 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; -} - -bool -odm_dynamic_primary_cca_dup_rts( - struct PHY_DM_STRUCT *p_dm_odm -) -{ - struct _dynamic_primary_cca *primary_cca = &(p_dm_odm->dm_pri_cca); - - return primary_cca->dup_rts_flag; -} - -void -odm_dynamic_primary_cca( - struct PHY_DM_STRUCT *p_dm_odm -) -{ - -#if (DM_ODM_SUPPORT_TYPE != ODM_CE) - - struct _ADAPTER *adapter = p_dm_odm->adapter; /* for NIC */ - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) - struct sta_info *p_entry; -#endif - - struct _FALSE_ALARM_STATISTICS *false_alm_cnt = (struct _FALSE_ALARM_STATISTICS *)phydm_get_structure(p_dm_odm, PHYDM_FALSEALMCNT); - struct _dynamic_primary_cca *primary_cca = &(p_dm_odm->dm_pri_cca); - - bool is_40mhz; - bool client_40mhz = false, client_tmp = false; /* connected client BW */ - bool is_connected = false; /* connected or not */ - static u8 client_40mhz_pre = 0; - static u64 last_tx_ok_cnt = 0; - static u64 last_rx_ok_cnt = 0; - static u32 counter = 0; - static u8 delay = 1; - u64 cur_tx_ok_cnt; - u64 cur_rx_ok_cnt; - u8 sec_ch_offset; - u8 i; - - if (!(p_dm_odm->support_ability & ODM_BB_PRIMARY_CCA)) - return; - - if (p_dm_odm->support_ic_type != ODM_RTL8188E) - return; - - is_40mhz = *(p_dm_odm->p_band_width); - sec_ch_offset = *(p_dm_odm->p_sec_ch_offset); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_PRICCA, ODM_DBG_LOUD, ("Second CH Offset = %d\n", sec_ch_offset)); - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - if (is_40mhz == 1) - sec_ch_offset = sec_ch_offset % 2 + 1; /* NIC's definition is reverse to AP 1:secondary below, 2: secondary above */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_PRICCA, ODM_DBG_LOUD, ("Second CH Offset = %d\n", sec_ch_offset)); - /* 3 Check Current WLAN Traffic */ - cur_tx_ok_cnt = adapter->TxStats.NumTxBytesUnicast - last_tx_ok_cnt; - cur_rx_ok_cnt = adapter->RxStats.NumRxBytesUnicast - last_rx_ok_cnt; - last_tx_ok_cnt = adapter->TxStats.NumTxBytesUnicast; - last_rx_ok_cnt = adapter->RxStats.NumRxBytesUnicast; -#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) - /* 3 Check Current WLAN Traffic */ - cur_tx_ok_cnt = *(p_dm_odm->p_num_tx_bytes_unicast) - last_tx_ok_cnt; - cur_rx_ok_cnt = *(p_dm_odm->p_num_rx_bytes_unicast) - last_rx_ok_cnt; - last_tx_ok_cnt = *(p_dm_odm->p_num_tx_bytes_unicast); - last_rx_ok_cnt = *(p_dm_odm->p_num_rx_bytes_unicast); -#endif - - /* ==================Debug Message==================== */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_PRICCA, ODM_DBG_LOUD, ("TP = %llu\n", cur_tx_ok_cnt + cur_rx_ok_cnt)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_PRICCA, ODM_DBG_LOUD, ("is_40mhz = %d\n", is_40mhz)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_PRICCA, ODM_DBG_LOUD, ("BW_LSC = %d\n", false_alm_cnt->cnt_bw_lsc)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_PRICCA, ODM_DBG_LOUD, ("BW_USC = %d\n", false_alm_cnt->cnt_bw_usc)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_PRICCA, ODM_DBG_LOUD, ("CCA OFDM = %d\n", false_alm_cnt->cnt_ofdm_cca)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_PRICCA, ODM_DBG_LOUD, ("CCA CCK = %d\n", false_alm_cnt->cnt_cck_cca)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_PRICCA, ODM_DBG_LOUD, ("OFDM FA = %d\n", false_alm_cnt->cnt_ofdm_fail)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_PRICCA, ODM_DBG_LOUD, ("CCK FA = %d\n", false_alm_cnt->cnt_cck_fail)); - /* ================================================ */ - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - if (ACTING_AS_AP(adapter)) /* primary cca process only do at AP mode */ -#endif - { - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_PRICCA, ODM_DBG_LOUD, ("ACTING as AP mode=%d\n", ACTING_AS_AP(adapter))); - /* 3 To get entry's connection and BW infomation status. */ - for (i = 0; i < ASSOCIATE_ENTRY_NUM; i++) { - if (IsAPModeExist(adapter) && GetFirstExtAdapter(adapter) != NULL) - p_entry = AsocEntry_EnumStation(GetFirstExtAdapter(adapter), i); - else - p_entry = AsocEntry_EnumStation(GetDefaultAdapter(adapter), i); - if (p_entry != NULL) { - client_tmp = p_entry->BandWidth; /* client BW */ - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_PRICCA, ODM_DBG_LOUD, ("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 */ + s8 rx_pwr_all = 0; + s8 lna_gain = 0; + /*only use lna0/1/2/3/7*/ + s8 lna_gain_table_0[8] = {17, -1, -13, -29, -32, -35, -38, -41}; + /*only use lna3 /7*/ + s8 lna_gain_table_1[8] = {29, 20, 12, 3, -6, -15, -24, -33}; + /*only use lna1/3/5/7*/ + s8 lna_gain_table_2[8] = {17, -1, -13, -17, -32, -43, -38, -47}; + + if (dm->cut_version >= ODM_CUT_I) { /*SMIC*/ + if (dm->ext_lna == 0x1) { + switch (dm->type_glna) { + case 0x2: /*eLNA 14dB*/ + lna_gain = lna_gain_table_2[lna_idx]; + break; + default: + lna_gain = lna_gain_table_0[lna_idx]; break; - } - } else - break; - } -#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) - /* 3 To get entry's connection and BW infomation status. */ - - struct sta_info *pstat; - - for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { - pstat = p_dm_odm->p_odm_sta_info[i]; - if (IS_STA_VALID(pstat)) { - client_tmp = pstat->tx_bw; - if (client_tmp > client_40mhz) - client_40mhz = client_tmp; /* 40M/20M coexist => 40M priority is High */ - - is_connected = true; } - } -#endif - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_PRICCA, ODM_DBG_LOUD, ("is_connected=%d\n", is_connected)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_PRICCA, ODM_DBG_LOUD, ("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_odm, 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_odm, 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 (is_40mhz) { /* if RFBW==40M mode which require to process primary cca */ - /* 2 STA is NOT Connected */ - if (!is_connected) { - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_PRICCA, ODM_DBG_LOUD, ("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_odm, 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; - } - } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_PRICCA, ODM_DBG_LOUD, ("primary_cca=%d\n", primary_cca->pri_cca_flag)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_PRICCA, ODM_DBG_LOUD, ("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_odm, 0xc6c, BIT(8) | BIT(7), 2); - else if (sec_ch_offset == 2) - odm_set_bb_reg(p_dm_odm, 0xc6c, BIT(8) | BIT(7), 1); - } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_PRICCA, ODM_DBG_LOUD, ("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_odm, 0xc6c, BIT(8) | BIT(7), 2); - else if (sec_ch_offset == 2) - odm_set_bb_reg(p_dm_odm, 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) < 10000) { /* 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; - } - } - } - } - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_PRICCA, ODM_DBG_LOUD, ("Primary CCA=%d\n", primary_cca->pri_cca_flag)); - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_PRICCA, ODM_DBG_LOUD, ("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++; - ODM_RT_TRACE(p_dm_odm, ODM_COMP_DYNAMIC_PRICCA, ODM_DBG_LOUD, ("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_odm, 0xc6c, BIT(8) | BIT(7), 0); - } - counter = 0; - } - } + } else { + 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); - client_40mhz_pre = client_40mhz; -#endif + return rx_pwr_all; } - -#endif /* #if (RTL8188E_SUPPORT == 1) */ +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/phydm_rtl8188e.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/phydm_rtl8188e.h index 5466455b38c9..14ee37a93896 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/phydm_rtl8188e.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/phydm_rtl8188e.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,68 +12,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 __ODM_RTL8188E_H__ + *****************************************************************************/ +#ifndef __ODM_RTL8188E_H__ #define __ODM_RTL8188E_H__ #if (RTL8188E_SUPPORT == 1) - - - -#define MAIN_ANT_CG_TRX 1 -#define AUX_ANT_CG_TRX 0 -#define MAIN_ANT_CGCS_RX 0 -#define AUX_ANT_CGCS_RX 1 - -void -odm_dig_lower_bound_88e( - struct PHY_DM_STRUCT *p_dm_odm -); - - - - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - -#define sw_ant_div_reset_before_link odm_sw_ant_div_reset_before_link - -void odm_sw_ant_div_reset_before_link(struct PHY_DM_STRUCT *p_dm_odm); - -void -odm_set_tx_ant_by_tx_info_88e( - struct PHY_DM_STRUCT *p_dm_odm, - u8 *p_desc, - u8 mac_id -); -#else/* (DM_ODM_SUPPORT_TYPE == ODM_AP) */ -void -odm_set_tx_ant_by_tx_info_88e( - struct PHY_DM_STRUCT *p_dm_odm -); -#endif - -void -odm_primary_cca_init( - struct PHY_DM_STRUCT *p_dm_odm); - -bool -odm_dynamic_primary_cca_dup_rts( - struct PHY_DM_STRUCT *p_dm_odm); - -void -odm_dynamic_primary_cca( - struct PHY_DM_STRUCT *p_dm_odm); - -#else /* (RTL8188E_SUPPORT == 0)*/ - -#define odm_primary_cca_init(_pdm_odm) -#define odm_dynamic_primary_cca(_pdm_odm) - -#endif /* RTL8188E_SUPPORT */ - +s8 phydm_cck_rssi_8188e(struct dm_struct *dm, u16 lna_idx, u8 vga_idx); #endif +#endif \ No newline at end of file diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/version_rtl8188e.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/version_rtl8188e.h index 87cde3a9d295..cf122a33eac6 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/version_rtl8188e.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/rtl8188e/version_rtl8188e.h @@ -1,4 +1,28 @@ /* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ /*RTL8188E PHY Parameters*/ /* [Caution] @@ -6,6 +30,6 @@ You do not need to fill up the version.h anymore, only the maintenance supervisor fills it before formal release. */ -#define RELEASE_DATE_8188E 20160517 +#define RELEASE_DATE_8188E 20171218 #define COMMIT_BY_8188E "RF_Eason" -#define RELEASE_VERSION_8188E 70 +#define RELEASE_VERSION_8188E 71 diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/sd4_phydm_2_kernel.mk b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/sd4_phydm_2_kernel.mk new file mode 100644 index 000000000000..324d0ee12cad --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/sd4_phydm_2_kernel.mk @@ -0,0 +1,189 @@ +# SPDX-License-Identifier: GPL-2.0 +EXTRA_CFLAGS += -I$(src)/hal/phydm + +_PHYDM_FILES := hal/phydm/phydm_debug.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_rainfo.o\ + hal/phydm/phydm_adaptivity.o\ + hal/phydm/phydm_cfotracking.o\ + hal/phydm/phydm_noisemonitor.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_ccx.o\ + hal/phydm/phydm_cck_pd.o\ + hal/phydm/phydm_rssi_monitor.o\ + hal/phydm/phydm_math_lib.o\ + hal/phydm/phydm_api.o\ + hal/phydm/halrf/halrf.o\ + hal/phydm/halrf/halrf_debug.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/$(RTL871X)/phydm_rtl8703b.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_RTL8710B), y) +RTL871X = rtl8710b +_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8710b_bb.o\ + hal/phydm/$(RTL871X)/halhwimg8710b_mac.o\ + hal/phydm/$(RTL871X)/halhwimg8710b_rf.o\ + hal/phydm/$(RTL871X)/phydm_regconfig8710b.o\ + hal/phydm/$(RTL871X)/phydm_rtl8710b.o\ + hal/phydm/halrf/$(RTL871X)/halrf_8710b.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/halrf/$(RTL871X)/halrf_rfk_init_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 +ifeq ($(CONFIG_RTL8192F), y) +RTL871X = rtl8192f +_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8192f_bb.o\ + hal/phydm/$(RTL871X)/halhwimg8192f_mac.o\ + hal/phydm/$(RTL871X)/halhwimg8192f_rf.o\ + hal/phydm/$(RTL871X)/phydm_hal_api8192f.o\ + hal/phydm/$(RTL871X)/phydm_regconfig8192f.o\ + hal/phydm/$(RTL871X)/phydm_rtl8192f.o\ + hal/phydm/halrf/$(RTL871X)/halrf_8192f.o +endif + +ifeq ($(CONFIG_RTL8198F), y) +RTL871X = rtl8198f +_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8198f_bb.o\ + hal/phydm/$(RTL871X)/halhwimg8198f_mac.o\ + hal/phydm/$(RTL871X)/halhwimg8198f_rf.o\ + hal/phydm/$(RTL871X)/phydm_hal_api8198f.o\ + hal/phydm/$(RTL871X)/phydm_regconfig8198f.o +endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/halcomtxbf.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/halcomtxbf.c index dcc9571e5a8b..41c6b9fb9fdc 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/halcomtxbf.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/halcomtxbf.c @@ -1,530 +1,513 @@ /* SPDX-License-Identifier: GPL-2.0 */ -/* ************************************************************ +/****************************************************************************** + * + * 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*/ +#ifdef PHYDM_BEAMFORMING_SUPPORT +/*@Beamforming halcomtxbf API create by YuChen 2015/05*/ -void -hal_com_txbf_beamform_init( - void *p_dm_void -) +void hal_com_txbf_beamform_init( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - bool is_iqgen_setting_ok = false; + struct dm_struct *dm = (struct dm_struct *)dm_void; + boolean is_iqgen_setting_ok = false; - if (p_dm_odm->support_ic_type & ODM_RTL8814A) { - is_iqgen_setting_ok = phydm_beamforming_set_iqgen_8814A(p_dm_odm); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] is_iqgen_setting_ok = %d\n", __func__, is_iqgen_setting_ok)); + if (dm->support_ic_type & ODM_RTL8814A) { + is_iqgen_setting_ok = phydm_beamforming_set_iqgen_8814A(dm); + PHYDM_DBG(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 -) +/*Only used for MU BFer Entry when get GID management frame (self as MU STA)*/ +void hal_com_txbf_config_gtab( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; - if (p_dm_odm->support_ic_type & ODM_RTL8822B) - hal_txbf_8822b_config_gtab(p_dm_odm); + if (dm->support_ic_type & ODM_RTL8822B) + hal_txbf_8822b_config_gtab(dm); } -void -phydm_beamform_set_sounding_enter( - void *p_dm_void -) +void phydm_beamform_set_sounding_enter( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _HAL_TXBF_INFO *p_txbf_info = &p_dm_odm->beamforming_info.txbf_info; + struct _HAL_TXBF_INFO *p_txbf_info = &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)); + if (!odm_is_work_item_scheduled(&p_txbf_info->txbf_enter_work_item)) + odm_schedule_work_item(&p_txbf_info->txbf_enter_work_item); #else - hal_com_txbf_enter_work_item_callback(p_dm_odm); + hal_com_txbf_enter_work_item_callback(dm); #endif } -void -phydm_beamform_set_sounding_leave( - void *p_dm_void -) +void phydm_beamform_set_sounding_leave( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _HAL_TXBF_INFO *p_txbf_info = &p_dm_odm->beamforming_info.txbf_info; + struct _HAL_TXBF_INFO *p_txbf_info = &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)); + if (!odm_is_work_item_scheduled(&p_txbf_info->txbf_leave_work_item)) + odm_schedule_work_item(&p_txbf_info->txbf_leave_work_item); #else - hal_com_txbf_leave_work_item_callback(p_dm_odm); + hal_com_txbf_leave_work_item_callback(dm); #endif } -void -phydm_beamform_set_sounding_rate( - void *p_dm_void -) +void phydm_beamform_set_sounding_rate( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _HAL_TXBF_INFO *p_txbf_info = &p_dm_odm->beamforming_info.txbf_info; + struct _HAL_TXBF_INFO *p_txbf_info = &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)); + if (!odm_is_work_item_scheduled(&p_txbf_info->txbf_rate_work_item)) + odm_schedule_work_item(&p_txbf_info->txbf_rate_work_item); #else - hal_com_txbf_rate_work_item_callback(p_dm_odm); + hal_com_txbf_rate_work_item_callback(dm); #endif } -void -phydm_beamform_set_sounding_status( - void *p_dm_void -) +void phydm_beamform_set_sounding_status( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _HAL_TXBF_INFO *p_txbf_info = &p_dm_odm->beamforming_info.txbf_info; + struct _HAL_TXBF_INFO *p_txbf_info = &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)); + if (!odm_is_work_item_scheduled(&p_txbf_info->txbf_status_work_item)) + odm_schedule_work_item(&p_txbf_info->txbf_status_work_item); #else - hal_com_txbf_status_work_item_callback(p_dm_odm); + hal_com_txbf_status_work_item_callback(dm); #endif } -void -phydm_beamform_set_sounding_fw_ndpa( - void *p_dm_void -) +void phydm_beamform_set_sounding_fw_ndpa( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _HAL_TXBF_INFO *p_txbf_info = &p_dm_odm->beamforming_info.txbf_info; + struct _HAL_TXBF_INFO *p_txbf_info = &dm->beamforming_info.txbf_info; - if (*p_dm_odm->p_is_fw_dw_rsvd_page_in_progress) - odm_set_timer(p_dm_odm, &(p_txbf_info->txbf_fw_ndpa_timer), 5); + if (*dm->is_fw_dw_rsvd_page_in_progress) + odm_set_timer(dm, &p_txbf_info->txbf_fw_ndpa_timer, 5); else - odm_schedule_work_item(&(p_txbf_info->txbf_fw_ndpa_work_item)); + odm_schedule_work_item(&p_txbf_info->txbf_fw_ndpa_work_item); #else - hal_com_txbf_fw_ndpa_work_item_callback(p_dm_odm); + hal_com_txbf_fw_ndpa_work_item_callback(dm); #endif } -void -phydm_beamform_set_sounding_clk( - void *p_dm_void -) +void phydm_beamform_set_sounding_clk( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _HAL_TXBF_INFO *p_txbf_info = &p_dm_odm->beamforming_info.txbf_info; + struct _HAL_TXBF_INFO *p_txbf_info = &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)); + if (!odm_is_work_item_scheduled(&p_txbf_info->txbf_clk_work_item)) + odm_schedule_work_item(&p_txbf_info->txbf_clk_work_item); #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - struct _ADAPTER *padapter = p_dm_odm->adapter; - - rtw_run_in_thread_cmd(padapter, hal_com_txbf_clk_work_item_callback, padapter); + phydm_run_in_thread_cmd(dm, hal_com_txbf_clk_work_item_callback, dm); #else - hal_com_txbf_clk_work_item_callback(p_dm_odm); + hal_com_txbf_clk_work_item_callback(dm); #endif } -void -phydm_beamform_set_reset_tx_path( - void *p_dm_void -) +void phydm_beamform_set_reset_tx_path( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _HAL_TXBF_INFO *p_txbf_info = &p_dm_odm->beamforming_info.txbf_info; + struct _HAL_TXBF_INFO *p_txbf_info = &dm->beamforming_info.txbf_info; + struct _RT_WORK_ITEM *pwi = &p_txbf_info->txbf_reset_tx_path_work_item; - 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)); + if (!odm_is_work_item_scheduled(pwi)) + odm_schedule_work_item(pwi); #else - hal_com_txbf_reset_tx_path_work_item_callback(p_dm_odm); + hal_com_txbf_reset_tx_path_work_item_callback(dm); #endif } -void -phydm_beamform_set_get_tx_rate( - void *p_dm_void -) +void phydm_beamform_set_get_tx_rate( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _HAL_TXBF_INFO *p_txbf_info = &p_dm_odm->beamforming_info.txbf_info; + struct _HAL_TXBF_INFO *p_txbf_info = &dm->beamforming_info.txbf_info; + struct _RT_WORK_ITEM *pwi = &p_txbf_info->txbf_get_tx_rate_work_item; - 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)); + if (!odm_is_work_item_scheduled(pwi)) + odm_schedule_work_item(pwi); #else - hal_com_txbf_get_tx_rate_work_item_callback(p_dm_odm); + hal_com_txbf_get_tx_rate_work_item_callback(dm); #endif } -void -hal_com_txbf_enter_work_item_callback( +void hal_com_txbf_enter_work_item_callback( #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _ADAPTER *adapter + void *adapter #else - void *p_dm_void + void *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_odm = &p_hal_data->DM_OutSrc; + PHAL_DATA_TYPE hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + struct dm_struct *dm = &hal_data->DM_OutSrc; #else - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; #endif - struct _HAL_TXBF_INFO *p_txbf_info = &p_dm_odm->beamforming_info.txbf_info; - u8 idx = p_txbf_info->txbf_idx; + struct _HAL_TXBF_INFO *p_txbf_info = &dm->beamforming_info.txbf_info; + u8 idx = p_txbf_info->txbf_idx; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); - if (p_dm_odm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821)) - hal_txbf_jaguar_enter(p_dm_odm, idx); - else if (p_dm_odm->support_ic_type & ODM_RTL8192E) - hal_txbf_8192e_enter(p_dm_odm, idx); - else if (p_dm_odm->support_ic_type & ODM_RTL8814A) - hal_txbf_8814a_enter(p_dm_odm, idx); - else if (p_dm_odm->support_ic_type & ODM_RTL8822B) - hal_txbf_8822b_enter(p_dm_odm, idx); + if (dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821)) + hal_txbf_jaguar_enter(dm, idx); + else if (dm->support_ic_type & ODM_RTL8192E) + hal_txbf_8192e_enter(dm, idx); + else if (dm->support_ic_type & ODM_RTL8814A) + hal_txbf_8814a_enter(dm, idx); + else if (dm->support_ic_type & ODM_RTL8822B) + hal_txbf_8822b_enter(dm, idx); } -void -hal_com_txbf_leave_work_item_callback( +void hal_com_txbf_leave_work_item_callback( #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _ADAPTER *adapter + void *adapter #else - void *p_dm_void + void *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_odm = &p_hal_data->DM_OutSrc; + PHAL_DATA_TYPE hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + struct dm_struct *dm = &hal_data->DM_OutSrc; #else - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; #endif - struct _HAL_TXBF_INFO *p_txbf_info = &p_dm_odm->beamforming_info.txbf_info; + struct _HAL_TXBF_INFO *p_txbf_info = &dm->beamforming_info.txbf_info; - u8 idx = p_txbf_info->txbf_idx; + u8 idx = p_txbf_info->txbf_idx; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); - if (p_dm_odm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821)) - hal_txbf_jaguar_leave(p_dm_odm, idx); - else if (p_dm_odm->support_ic_type & ODM_RTL8192E) - hal_txbf_8192e_leave(p_dm_odm, idx); - else if (p_dm_odm->support_ic_type & ODM_RTL8814A) - hal_txbf_8814a_leave(p_dm_odm, idx); - else if (p_dm_odm->support_ic_type & ODM_RTL8822B) - hal_txbf_8822b_leave(p_dm_odm, idx); + if (dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821)) + hal_txbf_jaguar_leave(dm, idx); + else if (dm->support_ic_type & ODM_RTL8192E) + hal_txbf_8192e_leave(dm, idx); + else if (dm->support_ic_type & ODM_RTL8814A) + hal_txbf_8814a_leave(dm, idx); + else if (dm->support_ic_type & ODM_RTL8822B) + hal_txbf_8822b_leave(dm, idx); } - -void -hal_com_txbf_fw_ndpa_work_item_callback( +void hal_com_txbf_fw_ndpa_work_item_callback( #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _ADAPTER *adapter + void *adapter #else - void *p_dm_void + void *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_odm = &p_hal_data->DM_OutSrc; + PHAL_DATA_TYPE hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + struct dm_struct *dm = &hal_data->DM_OutSrc; #else - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; #endif - struct _HAL_TXBF_INFO *p_txbf_info = &p_dm_odm->beamforming_info.txbf_info; - u8 idx = p_txbf_info->ndpa_idx; + struct _HAL_TXBF_INFO *p_txbf_info = &dm->beamforming_info.txbf_info; + u8 idx = p_txbf_info->ndpa_idx; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); - if (p_dm_odm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821)) - hal_txbf_jaguar_fw_txbf(p_dm_odm, idx); - else if (p_dm_odm->support_ic_type & ODM_RTL8192E) - hal_txbf_8192e_fw_tx_bf(p_dm_odm, idx); - else if (p_dm_odm->support_ic_type & ODM_RTL8814A) - hal_txbf_8814a_fw_txbf(p_dm_odm, idx); - else if (p_dm_odm->support_ic_type & ODM_RTL8822B) - hal_txbf_8822b_fw_txbf(p_dm_odm, idx); + if (dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821)) + hal_txbf_jaguar_fw_txbf(dm, idx); + else if (dm->support_ic_type & ODM_RTL8192E) + hal_txbf_8192e_fw_tx_bf(dm, idx); + else if (dm->support_ic_type & ODM_RTL8814A) + hal_txbf_8814a_fw_txbf(dm, idx); + else if (dm->support_ic_type & ODM_RTL8822B) + hal_txbf_8822b_fw_txbf(dm, idx); } -void -hal_com_txbf_clk_work_item_callback( +void hal_com_txbf_clk_work_item_callback( #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _ADAPTER *adapter + void *adapter #else - void *p_dm_void + void *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_odm = &p_hal_data->DM_OutSrc; + PHAL_DATA_TYPE hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + struct dm_struct *dm = &hal_data->DM_OutSrc; #else - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; #endif - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); - if (p_dm_odm->support_ic_type & ODM_RTL8812) - hal_txbf_jaguar_clk_8812a(p_dm_odm); + if (dm->support_ic_type & ODM_RTL8812) + hal_txbf_jaguar_clk_8812a(dm); } - - -void -hal_com_txbf_rate_work_item_callback( +void hal_com_txbf_rate_work_item_callback( #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _ADAPTER *adapter + void *adapter #else - void *p_dm_void + void *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_odm = &p_hal_data->DM_OutSrc; + PHAL_DATA_TYPE hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + struct dm_struct *dm = &hal_data->DM_OutSrc; #else - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; #endif - struct _HAL_TXBF_INFO *p_txbf_info = &p_dm_odm->beamforming_info.txbf_info; - u8 BW = p_txbf_info->BW; - u8 rate = p_txbf_info->rate; + struct _HAL_TXBF_INFO *p_txbf_info = &dm->beamforming_info.txbf_info; + u8 BW = p_txbf_info->BW; + u8 rate = p_txbf_info->rate; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); - - if (p_dm_odm->support_ic_type & ODM_RTL8812) - hal_txbf_8812a_set_ndpa_rate(p_dm_odm, BW, rate); - else if (p_dm_odm->support_ic_type & ODM_RTL8192E) - hal_txbf_8192e_set_ndpa_rate(p_dm_odm, BW, rate); - else if (p_dm_odm->support_ic_type & ODM_RTL8814A) - hal_txbf_8814a_set_ndpa_rate(p_dm_odm, BW, rate); + PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); + if (dm->support_ic_type & ODM_RTL8812) + hal_txbf_8812a_set_ndpa_rate(dm, BW, rate); + else if (dm->support_ic_type & ODM_RTL8192E) + hal_txbf_8192e_set_ndpa_rate(dm, BW, rate); + else if (dm->support_ic_type & ODM_RTL8814A) + hal_txbf_8814a_set_ndpa_rate(dm, BW, rate); } - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -void -hal_com_txbf_fw_ndpa_timer_callback( - struct timer_list *p_timer -) +void hal_com_txbf_fw_ndpa_timer_callback( + struct phydm_timer_list *timer) { + void *adapter = (void *)timer->Adapter; + PHAL_DATA_TYPE hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + struct dm_struct *dm = &hal_data->DM_OutSrc; - struct _ADAPTER *adapter = (struct _ADAPTER *)p_timer->Adapter; - PHAL_DATA_TYPE p_hal_data = GET_HAL_DATA(adapter); - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; + struct _HAL_TXBF_INFO *p_txbf_info = &dm->beamforming_info.txbf_info; - struct _HAL_TXBF_INFO *p_txbf_info = &p_dm_odm->beamforming_info.txbf_info; + PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); - - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); - - if (*p_dm_odm->p_is_fw_dw_rsvd_page_in_progress) - odm_set_timer(p_dm_odm, &(p_txbf_info->txbf_fw_ndpa_timer), 5); + if (*dm->is_fw_dw_rsvd_page_in_progress) + odm_set_timer(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( +void hal_com_txbf_status_work_item_callback( #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _ADAPTER *adapter + void *adapter #else - void *p_dm_void + void *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_odm = &p_hal_data->DM_OutSrc; + PHAL_DATA_TYPE hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + struct dm_struct *dm = &hal_data->DM_OutSrc; #else - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; #endif - struct _HAL_TXBF_INFO *p_txbf_info = &p_dm_odm->beamforming_info.txbf_info; + struct _HAL_TXBF_INFO *p_txbf_info = &dm->beamforming_info.txbf_info; - u8 idx = p_txbf_info->txbf_idx; + u8 idx = p_txbf_info->txbf_idx; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); - if (p_dm_odm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821)) - hal_txbf_jaguar_status(p_dm_odm, idx); - else if (p_dm_odm->support_ic_type & ODM_RTL8192E) - hal_txbf_8192e_status(p_dm_odm, idx); - else if (p_dm_odm->support_ic_type & ODM_RTL8814A) - hal_txbf_8814a_status(p_dm_odm, idx); - else if (p_dm_odm->support_ic_type & ODM_RTL8822B) - hal_txbf_8822b_status(p_dm_odm, idx); + if (dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821)) + hal_txbf_jaguar_status(dm, idx); + else if (dm->support_ic_type & ODM_RTL8192E) + hal_txbf_8192e_status(dm, idx); + else if (dm->support_ic_type & ODM_RTL8814A) + hal_txbf_8814a_status(dm, idx); + else if (dm->support_ic_type & ODM_RTL8822B) + hal_txbf_8822b_status(dm, idx); } -void -hal_com_txbf_reset_tx_path_work_item_callback( +void hal_com_txbf_reset_tx_path_work_item_callback( #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _ADAPTER *adapter + void *adapter #else - void *p_dm_void + void *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_odm = &p_hal_data->DM_OutSrc; + PHAL_DATA_TYPE hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + struct dm_struct *dm = &hal_data->DM_OutSrc; #else - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; #endif - struct _HAL_TXBF_INFO *p_txbf_info = &p_dm_odm->beamforming_info.txbf_info; + struct _HAL_TXBF_INFO *p_txbf_info = &dm->beamforming_info.txbf_info; - u8 idx = p_txbf_info->txbf_idx; - - if (p_dm_odm->support_ic_type & ODM_RTL8814A) - hal_txbf_8814a_reset_tx_path(p_dm_odm, idx); + u8 idx = p_txbf_info->txbf_idx; + if (dm->support_ic_type & ODM_RTL8814A) + hal_txbf_8814a_reset_tx_path(dm, idx); } -void -hal_com_txbf_get_tx_rate_work_item_callback( +void hal_com_txbf_get_tx_rate_work_item_callback( #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _ADAPTER *adapter + void *adapter #else - void *p_dm_void + void *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_odm = &p_hal_data->DM_OutSrc; + PHAL_DATA_TYPE hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + struct dm_struct *dm = &hal_data->DM_OutSrc; #else - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; #endif - if (p_dm_odm->support_ic_type & ODM_RTL8814A) - hal_txbf_8814a_get_tx_rate(p_dm_odm); + if (dm->support_ic_type & ODM_RTL8814A) + hal_txbf_8814a_get_tx_rate(dm); } - -bool +boolean hal_com_txbf_set( - void *p_dm_void, - u8 set_type, - void *p_in_buf -) + void *dm_void, + u8 set_type, + void *p_in_buf) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 *p_u1_tmp = (u8 *)p_in_buf; - struct _HAL_TXBF_INFO *p_txbf_info = &p_dm_odm->beamforming_info.txbf_info; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 *p_u1_tmp = (u8 *)p_in_buf; + struct _HAL_TXBF_INFO *p_txbf_info = &dm->beamforming_info.txbf_info; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] set_type = 0x%X\n", __func__, set_type)); + PHYDM_DBG(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_odm); + phydm_beamform_set_sounding_enter(dm); break; case TXBF_SET_SOUNDING_LEAVE: p_txbf_info->txbf_idx = *p_u1_tmp; - phydm_beamform_set_sounding_leave(p_dm_odm); + phydm_beamform_set_sounding_leave(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_odm); + phydm_beamform_set_sounding_rate(dm); break; case TXBF_SET_SOUNDING_STATUS: p_txbf_info->txbf_idx = *p_u1_tmp; - phydm_beamform_set_sounding_status(p_dm_odm); + phydm_beamform_set_sounding_status(dm); break; case TXBF_SET_SOUNDING_FW_NDPA: p_txbf_info->ndpa_idx = *p_u1_tmp; - phydm_beamform_set_sounding_fw_ndpa(p_dm_odm); + phydm_beamform_set_sounding_fw_ndpa(dm); break; case TXBF_SET_SOUNDING_CLK: - phydm_beamform_set_sounding_clk(p_dm_odm); + phydm_beamform_set_sounding_clk(dm); break; case TXBF_SET_TX_PATH_RESET: p_txbf_info->txbf_idx = *p_u1_tmp; - phydm_beamform_set_reset_tx_path(p_dm_odm); + phydm_beamform_set_reset_tx_path(dm); break; case TXBF_SET_GET_TX_RATE: - phydm_beamform_set_get_tx_rate(p_dm_odm); + phydm_beamform_set_get_tx_rate(dm); break; - } return true; } #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -bool +boolean hal_com_txbf_get( - struct _ADAPTER *adapter, - u8 get_type, - void *p_out_buf -) + void *adapter, + u8 get_type, + void *p_out_buf) { - PHAL_DATA_TYPE p_hal_data = GET_HAL_DATA(adapter); - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; - bool *p_boolean = (bool *)p_out_buf; + PHAL_DATA_TYPE hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + struct dm_struct *dm = &hal_data->DM_OutSrc; + boolean *p_boolean = (boolean *)p_out_buf; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); + PHYDM_DBG(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)) + else if (/*@IS_HARDWARE_TYPE_8822B(adapter) ||*/ + IS_HARDWARE_TYPE_8821B(adapter) || + IS_HARDWARE_TYPE_8192E(adapter) || + IS_HARDWARE_TYPE_8192F(adapter) || + IS_HARDWARE_TYPE_JAGUAR(adapter) || + IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter) || + IS_HARDWARE_TYPE_JAGUAR3(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) + else if (/*@IS_HARDWARE_TYPE_8822B(adapter) ||*/ + IS_HARDWARE_TYPE_8821B(adapter) || + IS_HARDWARE_TYPE_8192E(adapter) || + IS_HARDWARE_TYPE_8192F(adapter) || + IS_HARDWARE_TYPE_JAGUAR(adapter) || + IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter) || + IS_HARDWARE_TYPE_JAGUAR3(adapter)) { + if (hal_data->RF_Type == RF_2T2R || + hal_data->RF_Type == RF_3T3R || + hal_data->RF_Type == RF_4T4R) *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)) +#if ((RTL8822B_SUPPORT == 1) || (RTL8821C_SUPPORT == 1) ||\ + (RTL8822C_SUPPORT == 1)) + if (IS_HARDWARE_TYPE_8822B(adapter) || + IS_HARDWARE_TYPE_8821C(adapter) || + IS_HARDWARE_TYPE_JAGUAR3(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)) +#if ((RTL8822B_SUPPORT == 1) || (RTL8822C_SUPPORT == 1)) + if (IS_HARDWARE_TYPE_8822B(adapter) || + IS_HARDWARE_TYPE_JAGUAR3(adapter)) *p_boolean = true; else #endif @@ -535,5 +518,4 @@ hal_com_txbf_get( } #endif - #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/halcomtxbf.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/halcomtxbf.h index 6e889d9f58d0..8018f7b20bdc 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/halcomtxbf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/halcomtxbf.h @@ -1,22 +1,46 @@ /* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ #ifndef __HAL_COM_TXBF_H__ #define __HAL_COM_TXBF_H__ -/* +#if 0 typedef bool (*TXBF_GET)( - void* p_adapter, + void* adapter, u8 get_type, void* p_out_buf ); typedef bool (*TXBF_SET)( - void* p_adapter, + void* adapter, u8 set_type, void* p_in_buf ); -*/ +#endif enum txbf_set_type { TXBF_SET_SOUNDING_ENTER, @@ -29,7 +53,6 @@ enum txbf_set_type { TXBF_SET_GET_TX_RATE }; - enum txbf_get_type { TXBF_GET_EXPLICIT_BEAMFORMEE, TXBF_GET_EXPLICIT_BEAMFORMER, @@ -37,144 +60,125 @@ enum txbf_get_type { TXBF_GET_MU_MIMO_AP }; - - -/* 2 HAL TXBF related */ +/* @2 HAL TXBF related */ struct _HAL_TXBF_INFO { - u8 txbf_idx; - u8 ndpa_idx; - u8 BW; - u8 rate; + u8 txbf_idx; + u8 ndpa_idx; + u8 BW; + u8 rate; - struct timer_list txbf_fw_ndpa_timer; + struct phydm_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; + 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) +#ifdef PHYDM_BEAMFORMING_SUPPORT -void -hal_com_txbf_beamform_init( - void *p_dm_void -); +void hal_com_txbf_beamform_init( + void *dm_void); -void -hal_com_txbf_config_gtab( - void *p_dm_void -); +void hal_com_txbf_config_gtab( + void *dm_void); -void -hal_com_txbf_enter_work_item_callback( +void hal_com_txbf_enter_work_item_callback( #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _ADAPTER *adapter + void *adapter #else - void *p_dm_void + void *dm_void #endif -); + ); -void -hal_com_txbf_leave_work_item_callback( +void hal_com_txbf_leave_work_item_callback( #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _ADAPTER *adapter + void *adapter #else - void *p_dm_void + void *dm_void #endif -); + ); -void -hal_com_txbf_fw_ndpa_work_item_callback( +void hal_com_txbf_fw_ndpa_work_item_callback( #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _ADAPTER *adapter + void *adapter #else - void *p_dm_void + void *dm_void #endif -); + ); -void -hal_com_txbf_clk_work_item_callback( +void hal_com_txbf_clk_work_item_callback( #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _ADAPTER *adapter + void *adapter #else - void *p_dm_void + void *dm_void #endif -); + ); -void -hal_com_txbf_reset_tx_path_work_item_callback( +void hal_com_txbf_reset_tx_path_work_item_callback( #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _ADAPTER *adapter + void *adapter #else - void *p_dm_void + void *dm_void #endif -); + ); -void -hal_com_txbf_get_tx_rate_work_item_callback( +void hal_com_txbf_get_tx_rate_work_item_callback( #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _ADAPTER *adapter + void *adapter #else - void *p_dm_void + void *dm_void #endif -); + ); -void -hal_com_txbf_rate_work_item_callback( +void hal_com_txbf_rate_work_item_callback( #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _ADAPTER *adapter + void *adapter #else - void *p_dm_void + void *dm_void #endif -); + ); -void -hal_com_txbf_fw_ndpa_timer_callback( - struct timer_list *p_timer -); +void hal_com_txbf_fw_ndpa_timer_callback( + struct phydm_timer_list *timer); -void -hal_com_txbf_status_work_item_callback( +void hal_com_txbf_status_work_item_callback( #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - struct _ADAPTER *adapter + void *adapter #else - void *p_dm_void + void *dm_void #endif -); + ); -bool +boolean hal_com_txbf_set( - void *p_dm_void, - u8 set_type, - void *p_in_buf -); + void *dm_void, + u8 set_type, + void *p_in_buf); -bool +boolean hal_com_txbf_get( - struct _ADAPTER *adapter, - u8 get_type, - void *p_out_buf -); + void *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_beamform_init(dm_void) NULL +#define hal_com_txbf_config_gtab(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__ */ +#endif /* @#ifndef __HAL_COM_TXBF_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbf8192e.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbf8192e.c index 65b738efae99..b6a63930bfa0 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbf8192e.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbf8192e.c @@ -1,105 +1,107 @@ /* SPDX-License-Identifier: GPL-2.0 */ -/* ************************************************************ +/****************************************************************************** + * + * 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) +#ifdef PHYDM_BEAMFORMING_SUPPORT #if (RTL8192E_SUPPORT == 1) -void -hal_txbf_8192e_set_ndpa_rate( - void *p_dm_void, - u8 BW, - u8 rate -) +void hal_txbf_8192e_set_ndpa_rate( + void *dm_void, + u8 BW, + u8 rate) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - - odm_write_1byte(p_dm_odm, REG_NDPA_OPT_CTRL_8192E, (rate << 2 | BW)); + struct dm_struct *dm = (struct dm_struct *)dm_void; + odm_write_1byte(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 -) +void hal_txbf_8192e_rf_mode( + void *dm_void, + struct _RT_BEAMFORMING_INFO *beam_info) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - bool is_self_beamformer = false; - bool is_self_beamformee = false; - enum beamforming_cap beamform_cap = BEAMFORMING_CAP_NONE; + struct dm_struct *dm = (struct dm_struct *)dm_void; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); - if (p_dm_odm->rf_type == ODM_1T1R) + if (dm->rf_type == RF_1T1R) return; - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_WE_LUT, 0x80000, 0x1); /*RF mode table write enable*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, RF_WE_LUT, 0x80000, 0x1); /*RF mode table write enable*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_WE_LUT, 0x80000, 0x1); /*RF mode table write enable*/ + odm_set_rf_reg(dm, RF_PATH_B, RF_WE_LUT, 0x80000, 0x1); /*RF mode table write enable*/ - if (p_beam_info->beamformee_su_cnt > 0) { + if (beam_info->beamformee_su_cnt > 0) { /*Path_A*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*Select RX mode 0x30=0x18000*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x0000f); /*Set Table data*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0x77fc2); /*Enable TXIQGEN in RX mode*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0x30, 0xfffff, 0x18000); /*Select RX mode 0x30=0x18000*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0x31, 0xfffff, 0x0000f); /*Set Table data*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0x32, 0xfffff, 0x77fc2); /*@Enable TXIQGEN in RX mode*/ /*Path_B*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0x30, 0xfffff, 0x18000); /*Select RX mode*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0x31, 0xfffff, 0x0000f); /*Set Table data*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0x32, 0xfffff, 0x77fc2); /*Enable TXIQGEN in RX mode*/ + odm_set_rf_reg(dm, RF_PATH_B, RF_0x30, 0xfffff, 0x18000); /*Select RX mode*/ + odm_set_rf_reg(dm, RF_PATH_B, RF_0x31, 0xfffff, 0x0000f); /*Set Table data*/ + odm_set_rf_reg(dm, RF_PATH_B, RF_0x32, 0xfffff, 0x77fc2); /*@Enable TXIQGEN in RX mode*/ } else { /*Path_A*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*Select RX mode*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x0000f); /*Set Table data*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0x77f82); /*Disable TXIQGEN in RX mode*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0x30, 0xfffff, 0x18000); /*Select RX mode*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0x31, 0xfffff, 0x0000f); /*Set Table data*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0x32, 0xfffff, 0x77f82); /*@Disable TXIQGEN in RX mode*/ /*Path_B*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0x30, 0xfffff, 0x18000); /*Select RX mode*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0x31, 0xfffff, 0x0000f); /*Set Table data*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0x32, 0xfffff, 0x77f82); /*Disable TXIQGEN in RX mode*/ + odm_set_rf_reg(dm, RF_PATH_B, RF_0x30, 0xfffff, 0x18000); /*Select RX mode*/ + odm_set_rf_reg(dm, RF_PATH_B, RF_0x31, 0xfffff, 0x0000f); /*Set Table data*/ + odm_set_rf_reg(dm, RF_PATH_B, RF_0x32, 0xfffff, 0x77f82); /*@Disable TXIQGEN in RX mode*/ } - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_WE_LUT, 0x80000, 0x0); /*RF mode table write disable*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, RF_WE_LUT, 0x80000, 0x0); /*RF mode table write disable*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_WE_LUT, 0x80000, 0x0); /*RF mode table write disable*/ + odm_set_rf_reg(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_odm, 0x90c, MASKDWORD, 0x83321333); - odm_set_bb_reg(p_dm_odm, 0xa04, MASKBYTE3, 0xc1); + if (beam_info->beamformee_su_cnt > 0) { + odm_set_bb_reg(dm, R_0x90c, MASKDWORD, 0x83321333); + odm_set_bb_reg(dm, R_0xa04, MASKBYTE3, 0xc1); } else - odm_set_bb_reg(p_dm_odm, 0x90c, MASKDWORD, 0x81121313); + odm_set_bb_reg(dm, R_0x90c, MASKDWORD, 0x81121313); } - - -void -hal_txbf_8192e_fw_txbf_cmd( - void *p_dm_void -) +void hal_txbf_8192e_fw_txbf_cmd( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (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_odm->beamforming_info; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 idx, period0 = 0, period1 = 0; + u8 PageNum0 = 0xFF, PageNum1 = 0xFF; + u8 u1_tx_bf_parm[3] = {0}; + struct _RT_BEAMFORMING_INFO *beam_info = &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 (beam_info->beamformee_entry[idx].beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED) { if (idx == 0) { - if (p_beam_info->beamformee_entry[idx].is_sound) + if (beam_info->beamformee_entry[idx].is_sound) PageNum0 = 0xFE; else PageNum0 = 0xFF; /* stop sounding */ - period0 = (u8)(p_beam_info->beamformee_entry[idx].sound_period); + period0 = (u8)(beam_info->beamformee_entry[idx].sound_period); } else if (idx == 1) { - if (p_beam_info->beamformee_entry[idx].is_sound) + if (beam_info->beamformee_entry[idx].is_sound) PageNum1 = 0xFE; else PageNum1 = 0xFF; /* stop sounding */ - period1 = (u8)(p_beam_info->beamformee_entry[idx].sound_period); + period1 = (u8)(beam_info->beamformee_entry[idx].sound_period); } } } @@ -107,243 +109,235 @@ hal_txbf_8192e_fw_txbf_cmd( 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_odm, PHYDM_H2C_TXBF, 3, u1_tx_bf_parm); + odm_fill_h2c_cmd(dm, PHYDM_H2C_TXBF, 3, u1_tx_bf_parm); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, - ("[%s] PageNum0 = %d period0 = %d, PageNum1 = %d period1 %d\n", __func__, PageNum0, period0, PageNum1, period1)); + PHYDM_DBG(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 -) +void hal_txbf_8192e_download_ndpa( + void *dm_void, + u8 idx) { - struct PHY_DM_STRUCT *p_dm_odm = (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; - bool is_send_beacon = false; - struct _ADAPTER *adapter = p_dm_odm->adapter; - 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_odm->beamforming_info; - struct _RT_BEAMFORMEE_ENTRY *p_beam_entry = p_beam_info->beamformee_entry + idx; + struct dm_struct *dm = (struct dm_struct *)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 *beam_info = &dm->beamforming_info; + struct _RT_BEAMFORMEE_ENTRY *p_beam_entry = beam_info->beamformee_entry + idx; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - *p_dm_odm->p_is_fw_dw_rsvd_page_in_progress = true; + *dm->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_odm, HAL_DEF_TX_PAGE_BOUNDARY, (u8 *)&tx_page_bndy); + phydm_get_hal_def_var_handler_interface(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_odm, REG_CR_8192E+1); - odm_write_1byte(p_dm_odm, REG_CR_8192E+1, (u1b_tmp | BIT(0))); + u1b_tmp = odm_read_1byte(dm, REG_CR_8192E + 1); + odm_write_1byte(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_odm, REG_FWHW_TXQ_CTRL_8192E+2); - odm_write_1byte(p_dm_odm, REG_FWHW_TXQ_CTRL_8192E+2, tmp_reg422 & (~BIT(6))); + tmp_reg422 = odm_read_1byte(dm, REG_FWHW_TXQ_CTRL_8192E + 2); + odm_write_1byte(dm, REG_FWHW_TXQ_CTRL_8192E + 2, tmp_reg422 & (~BIT(6))); if (tmp_reg422 & BIT(6)) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_WARNING, ("%s There is an adapter is sending beacon.\n", __func__)); + PHYDM_DBG(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_odm, REG_DWBCN0_CTRL_8192E+1, head_page); + odm_write_1byte(dm, REG_DWBCN0_CTRL_8192E + 1, head_page); do { - /*Clear beacon valid check bit.*/ - bcn_valid_reg = odm_read_1byte(p_dm_odm, REG_DWBCN0_CTRL_8192E+2); - odm_write_1byte(p_dm_odm, REG_DWBCN0_CTRL_8192E+2, (bcn_valid_reg | BIT(0))); + /*@Clear beacon valid check bit.*/ + bcn_valid_reg = odm_read_1byte(dm, REG_DWBCN0_CTRL_8192E + 2); + odm_write_1byte(dm, REG_DWBCN0_CTRL_8192E + 2, (bcn_valid_reg | BIT(0))); - /* download NDPA rsvd page. */ - beamforming_send_ht_ndpa_packet(p_dm_odm, p_beam_entry->mac_addr, p_beam_entry->sound_bw, BEACON_QUEUE); + /* @download NDPA rsvd page. */ + beamforming_send_ht_ndpa_packet(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_odm, 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_odm, REG_MGQ_TXBD_NUM_8192E+3); + if (dm->support_interface == ODM_ITRF_PCIE) { + u1b_tmp = odm_read_1byte(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(dm, REG_MGQ_TXBD_NUM_8192E + 3); + } + odm_write_1byte(dm, REG_MGQ_TXBD_NUM_8192E + 3, u1b_tmp | BIT(4)); } - odm_write_1byte(p_dm_odm, REG_MGQ_TXBD_NUM_8192E+3, u1b_tmp | BIT(4)); #endif - /*check rsvd page download OK.*/ - bcn_valid_reg = odm_read_1byte(p_dm_odm, REG_DWBCN0_CTRL_8192E+2); + /*@check rsvd page download OK.*/ + bcn_valid_reg = odm_read_1byte(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_odm, REG_DWBCN0_CTRL_8192E+2); + bcn_valid_reg = odm_read_1byte(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))) - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_WARNING, ("%s Download RSVD page failed!\n", __func__)); + PHYDM_DBG(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_odm, REG_DWBCN0_CTRL_8192E+1, tx_page_bndy); + odm_write_1byte(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*/ + /*@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.*/ + /*@2010.06.23. Added by tynli.*/ if (is_send_beacon) - odm_write_1byte(p_dm_odm, REG_FWHW_TXQ_CTRL_8192E+2, tmp_reg422); + odm_write_1byte(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_odm, REG_CR_8192E+1); - odm_write_1byte(p_dm_odm, REG_CR_8192E+1, (u1b_tmp & (~BIT(0)))); + /*@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(dm, REG_CR_8192E + 1); + odm_write_1byte(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_odm->p_is_fw_dw_rsvd_page_in_progress = false; + *dm->is_fw_dw_rsvd_page_in_progress = false; #endif } - -void -hal_txbf_8192e_enter( - void *p_dm_void, - u8 bfer_bfee_idx -) +void hal_txbf_8192e_enter( + void *dm_void, + u8 bfer_bfee_idx) { - struct PHY_DM_STRUCT *p_dm_odm = (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_odm->beamforming_info; - struct _RT_BEAMFORMEE_ENTRY beamformee_entry; - struct _RT_BEAMFORMER_ENTRY beamformer_entry; - u16 sta_id = 0; + struct dm_struct *dm = (struct dm_struct *)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 *beamforming_info = &dm->beamforming_info; + struct _RT_BEAMFORMEE_ENTRY beamformee_entry; + struct _RT_BEAMFORMER_ENTRY beamformer_entry; + u16 sta_id = 0; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); - hal_txbf_8192e_rf_mode(p_dm_odm, p_beamforming_info); + hal_txbf_8192e_rf_mode(dm, beamforming_info); - if (p_dm_odm->rf_type == ODM_2T2R) - odm_write_4byte(p_dm_odm, 0xd80, 0x00000000); /*nc =2*/ + if (dm->rf_type == RF_2T2R) + odm_write_4byte(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]; + if (beamforming_info->beamformer_su_cnt > 0 && bfer_idx < BEAMFORMER_ENTRY_NUM) { + beamformer_entry = beamforming_info->beamformer_entry[bfer_idx]; /*Sounding protocol control*/ - odm_write_1byte(p_dm_odm, REG_SND_PTCL_CTRL_8192E, 0xCB); + odm_write_1byte(dm, REG_SND_PTCL_CTRL_8192E, 0xCB); - /*MAC address/Partial AID of Beamformer*/ + /*@MAC address/Partial AID of Beamformer*/ if (bfer_idx == 0) { - for (i = 0; i < 6 ; i++) - odm_write_1byte(p_dm_odm, (REG_ASSOCIATED_BFMER0_INFO_8192E+i), beamformer_entry.mac_addr[i]); + for (i = 0; i < 6; i++) + odm_write_1byte(dm, (REG_ASSOCIATED_BFMER0_INFO_8192E + i), beamformer_entry.mac_addr[i]); } else { - for (i = 0; i < 6 ; i++) - odm_write_1byte(p_dm_odm, (REG_ASSOCIATED_BFMER1_INFO_8192E+i), beamformer_entry.mac_addr[i]); + for (i = 0; i < 6; i++) + odm_write_1byte(dm, (REG_ASSOCIATED_BFMER1_INFO_8192E + i), beamformer_entry.mac_addr[i]); } - /*CSI report parameters of Beamformer Default use nc = 2*/ + /*@CSI report parameters of Beamformer Default use nc = 2*/ csi_param = 0x03090309; - odm_write_4byte(p_dm_odm, REG_CSI_RPT_PARAM_BW20_8192E, csi_param); - odm_write_4byte(p_dm_odm, REG_CSI_RPT_PARAM_BW40_8192E, csi_param); - odm_write_4byte(p_dm_odm, REG_CSI_RPT_PARAM_BW80_8192E, csi_param); + odm_write_4byte(dm, REG_CSI_RPT_PARAM_BW20_8192E, csi_param); + odm_write_4byte(dm, REG_CSI_RPT_PARAM_BW40_8192E, csi_param); + odm_write_4byte(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_odm, REG_SND_PTCL_CTRL_8192E+3, 0x50); - + odm_write_1byte(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 (beamforming_info->beamformee_su_cnt > 0 && bfee_idx < BEAMFORMEE_ENTRY_NUM) { + beamformee_entry = beamforming_info->beamformee_entry[bfee_idx]; - if (phydm_acting_determine(p_dm_odm, phydm_acting_as_ibss)) + if (phydm_acting_determine(dm, phydm_acting_as_ibss)) sta_id = beamformee_entry.mac_id; else sta_id = beamformee_entry.p_aid; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s], sta_id=0x%X\n", __func__, sta_id)); + PHYDM_DBG(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_odm, REG_TXBF_CTRL_8192E, sta_id); - odm_write_1byte(p_dm_odm, REG_TXBF_CTRL_8192E+3, odm_read_1byte(p_dm_odm, REG_TXBF_CTRL_8192E+3) | BIT(4) | BIT(6) | BIT(7)); + odm_write_2byte(dm, REG_TXBF_CTRL_8192E, sta_id); + odm_write_1byte(dm, REG_TXBF_CTRL_8192E + 3, odm_read_1byte(dm, REG_TXBF_CTRL_8192E + 3) | BIT(4) | BIT(6) | BIT(7)); } else - odm_write_2byte(p_dm_odm, REG_TXBF_CTRL_8192E+2, sta_id | BIT(12) | BIT(14) | BIT(15)); + odm_write_2byte(dm, REG_TXBF_CTRL_8192E + 2, sta_id | BIT(12) | BIT(14) | BIT(15)); - /*CSI report parameters of Beamformee*/ + /*@CSI report parameters of Beamformee*/ if (bfee_idx == 0) { - /*Get BIT24 & BIT25*/ - u8 tmp = odm_read_1byte(p_dm_odm, REG_ASSOCIATED_BFMEE_SEL_8192E+3) & 0x3; + /*@Get BIT24 & BIT25*/ + u8 tmp = odm_read_1byte(dm, REG_ASSOCIATED_BFMEE_SEL_8192E + 3) & 0x3; - odm_write_1byte(p_dm_odm, REG_ASSOCIATED_BFMEE_SEL_8192E+3, tmp | 0x60); - odm_write_2byte(p_dm_odm, REG_ASSOCIATED_BFMEE_SEL_8192E, sta_id | BIT(9)); + odm_write_1byte(dm, REG_ASSOCIATED_BFMEE_SEL_8192E + 3, tmp | 0x60); + odm_write_2byte(dm, REG_ASSOCIATED_BFMEE_SEL_8192E, sta_id | BIT(9)); } else { /*Set BIT25*/ - odm_write_2byte(p_dm_odm, REG_ASSOCIATED_BFMEE_SEL_8192E+2, sta_id | 0xE200); + odm_write_2byte(dm, REG_ASSOCIATED_BFMEE_SEL_8192E + 2, sta_id | 0xE200); } - phydm_beamforming_notify(p_dm_odm); - + phydm_beamforming_notify(dm); } } - -void -hal_txbf_8192e_leave( - void *p_dm_void, - u8 idx -) +void hal_txbf_8192e_leave( + void *dm_void, + u8 idx) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm_odm->beamforming_info; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; - hal_txbf_8192e_rf_mode(p_dm_odm, p_beam_info); + hal_txbf_8192e_rf_mode(dm, beam_info); - /* Clear P_AID of Beamformee + /* @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_odm, REG_SND_PTCL_CTRL_8192E, 0xC8); + if (beam_info->beamform_cap == BEAMFORMING_CAP_NONE) + odm_write_1byte(dm, REG_SND_PTCL_CTRL_8192E, 0xC8); if (idx == 0) { - odm_write_2byte(p_dm_odm, REG_TXBF_CTRL_8192E, 0); - odm_write_4byte(p_dm_odm, REG_ASSOCIATED_BFMER0_INFO_8192E, 0); - odm_write_2byte(p_dm_odm, REG_ASSOCIATED_BFMER0_INFO_8192E+4, 0); - odm_write_2byte(p_dm_odm, REG_ASSOCIATED_BFMEE_SEL_8192E, 0); + odm_write_2byte(dm, REG_TXBF_CTRL_8192E, 0); + odm_write_4byte(dm, REG_ASSOCIATED_BFMER0_INFO_8192E, 0); + odm_write_2byte(dm, REG_ASSOCIATED_BFMER0_INFO_8192E + 4, 0); + odm_write_2byte(dm, REG_ASSOCIATED_BFMEE_SEL_8192E, 0); } else { - odm_write_2byte(p_dm_odm, REG_TXBF_CTRL_8192E+2, odm_read_1byte(p_dm_odm, REG_TXBF_CTRL_8192E+2) & 0xF000); - odm_write_4byte(p_dm_odm, REG_ASSOCIATED_BFMER1_INFO_8192E, 0); - odm_write_2byte(p_dm_odm, REG_ASSOCIATED_BFMER1_INFO_8192E+4, 0); - odm_write_2byte(p_dm_odm, REG_ASSOCIATED_BFMEE_SEL_8192E+2, odm_read_2byte(p_dm_odm, REG_ASSOCIATED_BFMEE_SEL_8192E+2) & 0x60); + odm_write_2byte(dm, REG_TXBF_CTRL_8192E + 2, odm_read_1byte(dm, REG_TXBF_CTRL_8192E + 2) & 0xF000); + odm_write_4byte(dm, REG_ASSOCIATED_BFMER1_INFO_8192E, 0); + odm_write_2byte(dm, REG_ASSOCIATED_BFMER1_INFO_8192E + 4, 0); + odm_write_2byte(dm, REG_ASSOCIATED_BFMEE_SEL_8192E + 2, odm_read_2byte(dm, REG_ASSOCIATED_BFMEE_SEL_8192E + 2) & 0x60); } - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] idx %d\n", __func__, idx)); + PHYDM_DBG(dm, DBG_TXBF, "[%s] idx %d\n", __func__, idx); } - -void -hal_txbf_8192e_status( - void *p_dm_void, - u8 idx -) +void hal_txbf_8192e_status( + void *dm_void, + u8 idx) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u16 beam_ctrl_val; - u32 beam_ctrl_reg; - struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm_odm->beamforming_info; - struct _RT_BEAMFORMEE_ENTRY beamform_entry = p_beam_info->beamformee_entry[idx]; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u16 beam_ctrl_val; + u32 beam_ctrl_reg; + struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; + struct _RT_BEAMFORMEE_ENTRY beamform_entry = beam_info->beamformee_entry[idx]; - if (phydm_acting_determine(p_dm_odm, phydm_acting_as_ibss)) + if (phydm_acting_determine(dm, phydm_acting_as_ibss)) beam_ctrl_val = beamform_entry.mac_id; else beam_ctrl_val = beamform_entry.p_aid; @@ -351,11 +345,11 @@ hal_txbf_8192e_status( if (idx == 0) beam_ctrl_reg = REG_TXBF_CTRL_8192E; else { - beam_ctrl_reg = REG_TXBF_CTRL_8192E+2; + 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.beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED && 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) @@ -363,30 +357,29 @@ hal_txbf_8192e_status( } else beam_ctrl_val &= ~(BIT(9) | BIT(10) | BIT(11)); - odm_write_2byte(p_dm_odm, beam_ctrl_reg, beam_ctrl_val); + odm_write_2byte(dm, beam_ctrl_reg, beam_ctrl_val); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] idx %d beam_ctrl_reg %x beam_ctrl_val %x\n", __func__, idx, beam_ctrl_reg, beam_ctrl_val)); + PHYDM_DBG(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 -) +void hal_txbf_8192e_fw_tx_bf( + void *dm_void, + u8 idx) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm_odm->beamforming_info; - struct _RT_BEAMFORMEE_ENTRY *p_beam_entry = p_beam_info->beamformee_entry + idx; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; + struct _RT_BEAMFORMEE_ENTRY *p_beam_entry = beam_info->beamformee_entry + idx; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); + PHYDM_DBG(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_odm, idx); + hal_txbf_8192e_download_ndpa(dm, idx); - hal_txbf_8192e_fw_txbf_cmd(p_dm_odm); + hal_txbf_8192e_fw_txbf_cmd(dm); } -#endif /* #if (RTL8192E_SUPPORT == 1)*/ +#endif /* @#if (RTL8192E_SUPPORT == 1)*/ #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbf8192e.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbf8192e.h index 87740119313b..dc7a8c0e5398 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbf8192e.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbf8192e.h @@ -1,60 +1,71 @@ /* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ #ifndef __HAL_TXBF_8192E_H__ #define __HAL_TXBF_8192E_H__ #if (RTL8192E_SUPPORT == 1) -#if (BEAMFORMING_SUPPORT == 1) +#ifdef PHYDM_BEAMFORMING_SUPPORT -void -hal_txbf_8192e_set_ndpa_rate( - void *p_dm_void, - u8 BW, - u8 rate -); +void hal_txbf_8192e_set_ndpa_rate( + void *dm_void, + u8 BW, + u8 rate); -void -hal_txbf_8192e_enter( - void *p_dm_void, - u8 idx -); +void hal_txbf_8192e_enter( + void *dm_void, + u8 idx); +void hal_txbf_8192e_leave( + void *dm_void, + u8 idx); -void -hal_txbf_8192e_leave( - void *p_dm_void, - u8 idx -); +void hal_txbf_8192e_status( + void *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 -); +void hal_txbf_8192e_fw_tx_bf( + void *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) +#define hal_txbf_8192e_set_ndpa_rate(dm_void, BW, rate) +#define hal_txbf_8192e_enter(dm_void, idx) +#define hal_txbf_8192e_leave(dm_void, idx) +#define hal_txbf_8192e_status(dm_void, idx) +#define hal_txbf_8192e_fw_tx_bf(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) +#define hal_txbf_8192e_set_ndpa_rate(dm_void, BW, rate) +#define hal_txbf_8192e_enter(dm_void, idx) +#define hal_txbf_8192e_leave(dm_void, idx) +#define hal_txbf_8192e_status(dm_void, idx) +#define hal_txbf_8192e_fw_tx_bf(dm_void, idx) #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbf8814a.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbf8814a.c index 4b490a2a0e1f..79cc536fc971 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbf8814a.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbf8814a.c @@ -1,4 +1,18 @@ /* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * 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: * @@ -9,75 +23,64 @@ #include "mp_precomp.h" #include "../phydm_precomp.h" -#if (BEAMFORMING_SUPPORT == 1) +#ifdef PHYDM_BEAMFORMING_SUPPORT #if (RTL8814A_SUPPORT == 1) -bool -phydm_beamforming_set_iqgen_8814A( - void *p_dm_void -) +boolean +phydm_beamforming_set_iqgen_8814A(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; u8 i = 0; u16 counter = 0; u32 rf_mode[4]; - for (i = ODM_RF_PATH_A ; i < MAX_RF_PATH ; i++) - odm_set_rf_reg(p_dm_odm, i, RF_WE_LUT, 0x80000, 0x1); /*RF mode table write enable*/ + for (i = RF_PATH_A; i < MAX_RF_PATH; i++) + odm_set_rf_reg(dm, i, RF_WE_LUT, 0x80000, 0x1); /*RF mode table write enable*/ while (1) { counter++; - for (i = ODM_RF_PATH_A; i < MAX_RF_PATH; i++) - odm_set_rf_reg(p_dm_odm, i, RF_RCK_OS, 0xfffff, 0x18000); /*Select Rx mode*/ + for (i = RF_PATH_A; i < MAX_RF_PATH; i++) + odm_set_rf_reg(dm, i, RF_RCK_OS, 0xfffff, 0x18000); /*Select Rx mode*/ ODM_delay_us(2); - for (i = ODM_RF_PATH_A; i < MAX_RF_PATH; i++) - rf_mode[i] = odm_get_rf_reg(p_dm_odm, i, RF_RCK_OS, 0xfffff); + for (i = RF_PATH_A; i < MAX_RF_PATH; i++) + rf_mode[i] = odm_get_rf_reg(dm, i, RF_RCK_OS, 0xfffff); - if ((rf_mode[0] == 0x18000) && (rf_mode[1] == 0x18000) && (rf_mode[2] == 0x18000) && (rf_mode[3] == 0x18000)) + if (rf_mode[0] == 0x18000 && rf_mode[1] == 0x18000 && rf_mode[2] == 0x18000 && rf_mode[3] == 0x18000) break; else if (counter == 100) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_TRACE, ("iqgen setting fail:8814A\n")); + PHYDM_DBG(dm, DBG_TXBF, "iqgen setting fail:8814A\n"); return false; } } - for (i = ODM_RF_PATH_A ; i < MAX_RF_PATH ; i++) { - odm_set_rf_reg(p_dm_odm, i, RF_TXPA_G1, 0xfffff, 0xBE77F); /*Set Table data*/ - odm_set_rf_reg(p_dm_odm, i, RF_TXPA_G2, 0xfffff, 0x226BF); /*Enable TXIQGEN in Rx mode*/ + for (i = RF_PATH_A; i < MAX_RF_PATH; i++) { + odm_set_rf_reg(dm, i, RF_TXPA_G1, 0xfffff, 0xBE77F); /*Set Table data*/ + odm_set_rf_reg(dm, i, RF_TXPA_G2, 0xfffff, 0x226BF); /*@Enable TXIQGEN in Rx mode*/ } - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, RF_TXPA_G2, 0xfffff, 0xE26BF); /*Enable TXIQGEN in Rx mode*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_TXPA_G2, 0xfffff, 0xE26BF); /*@Enable TXIQGEN in Rx mode*/ - for (i = ODM_RF_PATH_A; i < MAX_RF_PATH; i++) - odm_set_rf_reg(p_dm_odm, i, RF_WE_LUT, 0x80000, 0x0); /*RF mode table write disable*/ + for (i = RF_PATH_A; i < MAX_RF_PATH; i++) + odm_set_rf_reg(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 -) +void hal_txbf_8814a_set_ndpa_rate(void *dm_void, u8 BW, u8 rate) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - - odm_write_1byte(p_dm_odm, REG_NDPA_OPT_CTRL_8814A, BW); - odm_write_1byte(p_dm_odm, REG_NDPA_RATE_8814A, (u8) rate); + struct dm_struct *dm = (struct dm_struct *)dm_void; + odm_write_1byte(dm, REG_NDPA_OPT_CTRL_8814A, BW); + odm_write_1byte(dm, REG_NDPA_RATE_8814A, (u8)rate); } - -#define PHYDM_MEMORY_MAP_BUF_READ 0x8000 -#define PHYDM_CTRL_INFO_PAGE 0x660 +#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_odm, + struct dm_struct *dm, u8 mac_id, u32 *data, u8 data_len @@ -86,83 +89,83 @@ phydm_data_rate_8814a( u8 i = 0; u16 x_read_data_addr = 0; - odm_write_2byte(p_dm_odm, 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)*/ + odm_write_2byte(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)) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("x_read_data_addr(0x%x) is not correct!\n", x_read_data_addr)); + if (x_read_data_addr < PHYDM_MEMORY_MAP_BUF_READ || x_read_data_addr > 0x8FFF) { + PHYDM_DBG(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_odm, x_read_data_addr + i); + *(data + i) = odm_read_2byte(dm, x_read_data_addr + i); +} +#endif +void hal_txbf_8814a_get_tx_rate(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; + struct _RT_BEAMFORMEE_ENTRY *entry; + struct ra_table *ra_tab = &dm->dm_ra_table; + struct cmn_sta_info *sta = NULL; + u8 data_rate = 0xFF; + u8 macid = 0; + + entry = &(beam_info->beamformee_entry[beam_info->beamformee_cur_idx]); + macid = (u8)entry->mac_id; + + sta = dm->phydm_sta_info[macid]; + + if (is_sta_active(sta)) { + data_rate = (sta->ra_info.curr_tx_rate) & 0x7f; /*@Bit7 indicates SGI*/ + beam_info->tx_bf_data_rate = data_rate; + } + + PHYDM_DBG(dm, DBG_TXBF, "[%s] dm->tx_bf_data_rate = 0x%x\n", __func__, + beam_info->tx_bf_data_rate); } -void -hal_txbf_8814a_get_tx_rate( - void *p_dm_void -) +void hal_txbf_8814a_reset_tx_path(void *dm_void, u8 idx) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm_odm->beamforming_info; - struct _RT_BEAMFORMEE_ENTRY *p_entry; - u32 tx_rpt_data = 0; - u8 data_rate = 0xFF; - - p_entry = &(p_beam_info->beamformee_entry[p_beam_info->beamformee_cur_idx]); - - phydm_data_rate_8814a(p_dm_odm, (u8)p_entry->mac_id, &tx_rpt_data, 1); - data_rate = (u8)tx_rpt_data; - data_rate &= 0x7f; /*Bit7 indicates SGI*/ - - p_dm_odm->tx_bf_data_rate = data_rate; - - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] p_dm_odm->tx_bf_data_rate = 0x%x\n", __func__, p_dm_odm->tx_bf_data_rate)); -} - -void -hal_txbf_8814a_reset_tx_path( - void *p_dm_void, - u8 idx -) -{ - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; #if DEV_BUS_TYPE == RT_USB_INTERFACE - struct _RT_BEAMFORMING_INFO *p_beamforming_info = &p_dm_odm->beamforming_info; - struct _RT_BEAMFORMEE_ENTRY beamformee_entry; - u8 nr_index = 0, tx_ss = 0; + struct _RT_BEAMFORMING_INFO *beamforming_info = &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]; + beamformee_entry = beamforming_info->beamformee_entry[idx]; else return; - if ((p_dm_odm->last_usb_hub) != (*p_dm_odm->hub_usb_mode)) { - nr_index = tx_bf_nr(hal_txbf_8814a_get_ntx(p_dm_odm), beamformee_entry.comp_steering_num_of_bfer); + if (beamforming_info->last_usb_hub != (*dm->hub_usb_mode)) { + nr_index = tx_bf_nr(hal_txbf_8814a_get_ntx(dm), beamformee_entry.comp_steering_num_of_bfer); - if (*p_dm_odm->hub_usb_mode == 2) { - if (p_dm_odm->rf_type == ODM_4T4R) + if (*dm->hub_usb_mode == 2) { + if (dm->rf_type == RF_4T4R) tx_ss = 0xf; - else if (p_dm_odm->rf_type == ODM_3T3R) + else if (dm->rf_type == RF_3T3R) tx_ss = 0xe; else tx_ss = 0x6; - } else if (*p_dm_odm->hub_usb_mode == 1) /*USB 2.0 always 2Tx*/ + } else if (*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_odm, REG_BB_TX_PATH_SEL_1_8814A, MASKBYTE3 | MASKBYTE2HIGHNIBBLE, 0x93f); - odm_set_bb_reg(p_dm_odm, REG_BB_TX_PATH_SEL_1_8814A, MASKDWORD, 0x93f93f0); + odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_1_8814A, MASKBYTE3 | MASKBYTE2HIGHNIBBLE, 0x93f); + odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_1_8814A, MASKDWORD, 0x93f93f0); } else if (tx_ss == 0xe) { - odm_set_bb_reg(p_dm_odm, REG_BB_TX_PATH_SEL_1_8814A, MASKBYTE3 | MASKBYTE2HIGHNIBBLE, 0x93e); - odm_set_bb_reg(p_dm_odm, REG_BB_TX_PATH_SEL_2_8814A, MASKDWORD, 0x93e93e0); + odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_1_8814A, MASKBYTE3 | MASKBYTE2HIGHNIBBLE, 0x93e); + odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_2_8814A, MASKDWORD, 0x93e93e0); } else if (tx_ss == 0x6) { - odm_set_bb_reg(p_dm_odm, REG_BB_TX_PATH_SEL_1_8814A, MASKBYTE3 | MASKBYTE2HIGHNIBBLE, 0x936); - odm_set_bb_reg(p_dm_odm, REG_BB_TX_PATH_SEL_2_8814A, MASKLWORD, 0x9360); + odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_1_8814A, MASKBYTE3 | MASKBYTE2HIGHNIBBLE, 0x936); + odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_2_8814A, MASKLWORD, 0x9360); } if (idx == 0) { @@ -170,169 +173,159 @@ hal_txbf_8814a_reset_tx_path( case 0: break; - case 1: /*Nsts = 2 BC*/ - odm_set_bb_reg(p_dm_odm, REG_BB_TXBF_ANT_SET_BF0_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x9366); /*tx2path, BC*/ + case 1: /*Nsts = 2 BC*/ + odm_set_bb_reg(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_odm, REG_BB_TXBF_ANT_SET_BF0_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x93e93ee); /*tx3path, BCD*/ + case 2: /*Nsts = 3 BCD*/ + odm_set_bb_reg(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_odm, REG_BB_TXBF_ANT_SET_BF0_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x93f93ff); /*tx4path, ABCD*/ + default: /*nr>3, same as Case 3*/ + odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF0_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x93f93ff); /*tx4path, ABCD*/ break; } - } else { + } else { switch (nr_index) { case 0: break; - case 1: /*Nsts = 2 BC*/ - odm_set_bb_reg(p_dm_odm, REG_BB_TXBF_ANT_SET_BF1_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x9366); /*tx2path, BC*/ + case 1: /*Nsts = 2 BC*/ + odm_set_bb_reg(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_odm, REG_BB_TXBF_ANT_SET_BF1_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x93e93ee); /*tx3path, BCD*/ + case 2: /*Nsts = 3 BCD*/ + odm_set_bb_reg(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_odm, REG_BB_TXBF_ANT_SET_BF1_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x93f93ff); /*tx4path, ABCD*/ + default: /*nr>3, same as Case 3*/ + odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF1_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x93f93ff); /*tx4path, ABCD*/ break; } } - p_dm_odm->last_usb_hub = *p_dm_odm->hub_usb_mode; + beamforming_info->last_usb_hub = *dm->hub_usb_mode; } else return; #endif } - -u8 -hal_txbf_8814a_get_ntx( - void *p_dm_void -) +u8 hal_txbf_8814a_get_ntx(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 ntx = 0, tx_ss = 3; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 ntx = 0, tx_ss = 3; #if DEV_BUS_TYPE == RT_USB_INTERFACE - tx_ss = *p_dm_odm->hub_usb_mode; + tx_ss = *dm->hub_usb_mode; #endif if (tx_ss == 3 || tx_ss == 2) { - if (p_dm_odm->rf_type == ODM_4T4R) + if (dm->rf_type == RF_4T4R) ntx = 3; - else if (p_dm_odm->rf_type == ODM_3T3R) + else if (dm->rf_type == RF_3T3R) ntx = 2; else ntx = 1; - } else if (tx_ss == 1) /*USB 2.0 always 2Tx*/ + } else if (tx_ss == 1) /*USB 2.0 always 2Tx*/ ntx = 1; else ntx = 1; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] ntx = %d\n", __func__, ntx)); + PHYDM_DBG(dm, DBG_TXBF, "[%s] ntx = %d\n", __func__, ntx); return ntx; } -u8 -hal_txbf_8814a_get_nrx( - void *p_dm_void -) +u8 hal_txbf_8814a_get_nrx(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 nrx = 0; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 nrx = 0; - if (p_dm_odm->rf_type == ODM_4T4R) + if (dm->rf_type == RF_4T4R) nrx = 3; - else if (p_dm_odm->rf_type == ODM_3T3R) + else if (dm->rf_type == RF_3T3R) nrx = 2; - else if (p_dm_odm->rf_type == ODM_2T2R) + else if (dm->rf_type == RF_2T2R) nrx = 1; - else if (p_dm_odm->rf_type == ODM_2T3R) + else if (dm->rf_type == RF_2T3R) nrx = 2; - else if (p_dm_odm->rf_type == ODM_2T4R) + else if (dm->rf_type == RF_2T4R) nrx = 3; - else if (p_dm_odm->rf_type == ODM_1T1R) + else if (dm->rf_type == RF_1T1R) nrx = 0; - else if (p_dm_odm->rf_type == ODM_1T2R) + else if (dm->rf_type == RF_1T2R) nrx = 1; else nrx = 0; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] nrx = %d\n", __func__, nrx)); + PHYDM_DBG(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 -) +void hal_txbf_8814a_rf_mode(void *dm_void, + struct _RT_BEAMFORMING_INFO *beamforming_info, + u8 idx) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 i, nr_index = 0; - u8 tx_ss = 3; /*default use 3 Tx*/ - struct _RT_BEAMFORMEE_ENTRY beamformee_entry; + struct dm_struct *dm = (struct dm_struct *)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]; + beamformee_entry = beamforming_info->beamformee_entry[idx]; else return; - nr_index = tx_bf_nr(hal_txbf_8814a_get_ntx(p_dm_odm), beamformee_entry.comp_steering_num_of_bfer); + nr_index = tx_bf_nr(hal_txbf_8814a_get_ntx(dm), beamformee_entry.comp_steering_num_of_bfer); - if (p_dm_odm->rf_type == ODM_1T1R) + if (dm->rf_type == RF_1T1R) return; - if (p_beamforming_info->beamformee_su_cnt > 0) { + if (beamforming_info->beamformee_su_cnt > 0) { #if DEV_BUS_TYPE == RT_USB_INTERFACE - p_dm_odm->last_usb_hub = *p_dm_odm->hub_usb_mode; - tx_ss = *p_dm_odm->hub_usb_mode; + beamforming_info->last_usb_hub = *dm->hub_usb_mode; + tx_ss = *dm->hub_usb_mode; #endif if (tx_ss == 3 || tx_ss == 2) { - if (p_dm_odm->rf_type == ODM_4T4R) + if (dm->rf_type == RF_4T4R) tx_ss = 0xf; - else if (p_dm_odm->rf_type == ODM_3T3R) + else if (dm->rf_type == RF_3T3R) tx_ss = 0xe; else tx_ss = 0x6; - } else if (tx_ss == 1) /*USB 2.0 always 2Tx*/ + } 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_odm, REG_BB_TX_PATH_SEL_1_8814A, MASKBYTE3 | MASKBYTE2HIGHNIBBLE, 0x93f); - odm_set_bb_reg(p_dm_odm, REG_BB_TX_PATH_SEL_1_8814A, MASKDWORD, 0x93f93f0); + odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_1_8814A, MASKBYTE3 | MASKBYTE2HIGHNIBBLE, 0x93f); + odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_1_8814A, MASKDWORD, 0x93f93f0); } else if (tx_ss == 0xe) { - odm_set_bb_reg(p_dm_odm, REG_BB_TX_PATH_SEL_1_8814A, MASKBYTE3 | MASKBYTE2HIGHNIBBLE, 0x93e); - odm_set_bb_reg(p_dm_odm, REG_BB_TX_PATH_SEL_2_8814A, MASKDWORD, 0x93e93e0); + odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_1_8814A, MASKBYTE3 | MASKBYTE2HIGHNIBBLE, 0x93e); + odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_2_8814A, MASKDWORD, 0x93e93e0); } else if (tx_ss == 0x6) { - odm_set_bb_reg(p_dm_odm, REG_BB_TX_PATH_SEL_1_8814A, MASKBYTE3 | MASKBYTE2HIGHNIBBLE, 0x936); - odm_set_bb_reg(p_dm_odm, REG_BB_TX_PATH_SEL_2_8814A, MASKLWORD, 0x9360); + odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_1_8814A, MASKBYTE3 | MASKBYTE2HIGHNIBBLE, 0x936); + odm_set_bb_reg(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_odm, REG_BB_TXBF_ANT_SET_BF1_8814A, BIT(28) | BIT29, 0x2); /*enable BB TxBF ant mapping register*/ - odm_set_bb_reg(p_dm_odm, REG_BB_TXBF_ANT_SET_BF1_8814A, BIT30, 0x1); /*if Nsts > Nc don't apply V matrix*/ + /*@for 8814 19ac(idx 1), 19b4(idx 0), different Tx ant setting*/ + odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF1_8814A, BIT(28) | BIT29, 0x2); /*@enable BB TxBF ant mapping register*/ + odm_set_bb_reg(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_odm, REG_BB_TXBF_ANT_SET_BF0_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x9366); /*tx2path, BC*/ + case 1: /*Nsts = 2 BC*/ + odm_set_bb_reg(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_odm, REG_BB_TXBF_ANT_SET_BF0_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x93e93ee); /*tx3path, BCD*/ + case 2: /*Nsts = 3 BCD*/ + odm_set_bb_reg(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_odm, REG_BB_TXBF_ANT_SET_BF0_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x93f93ff); /*tx4path, ABCD*/ + default: /*nr>3, same as Case 3*/ + odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF0_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x93f93ff); /*tx4path, ABCD*/ break; } @@ -341,132 +334,135 @@ hal_txbf_8814a_rf_mode( case 0: break; - case 1: /*Nsts = 2 BC*/ - odm_set_bb_reg(p_dm_odm, REG_BB_TXBF_ANT_SET_BF1_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x9366); /*tx2path, BC*/ + case 1: /*Nsts = 2 BC*/ + odm_set_bb_reg(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_odm, REG_BB_TXBF_ANT_SET_BF1_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x93e93ee); /*tx3path, BCD*/ + case 2: /*Nsts = 3 BCD*/ + odm_set_bb_reg(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_odm, REG_BB_TXBF_ANT_SET_BF1_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x93f93ff); /*tx4path, ABCD*/ + default: /*nr>3, same as Case 3*/ + odm_set_bb_reg(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_odm, 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_odm, REG_BB_TX_PATH_SEL_2_8814A, MASKDWORD, 0x93e9360); + if (beamforming_info->beamformee_su_cnt == 0 && beamforming_info->beamformer_su_cnt == 0) { + odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_1_8814A, MASKBYTE3 | MASKBYTE2HIGHNIBBLE, 0x932); /*set tx_path selection for 8814a BFer bug refine*/ + odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_2_8814A, MASKDWORD, 0x93e9360); } } #if 0 void hal_txbf_8814a_download_ndpa( - void *p_dm_void, + void *dm_void, u8 idx ) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; u8 u1b_tmp = 0, tmp_reg422 = 0; u8 bcn_valid_reg = 0, count = 0, dl_bcn_count = 0; u16 head_page = 0x7FE; - bool 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_odm->beamforming_info; - struct _RT_BEAMFORMEE_ENTRY *p_beam_entry = p_beam_info->beamformee_entry + idx; - struct _ADAPTER *adapter = p_dm_odm->adapter; + 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 *beam_info = &dm->beamforming_info; + struct _RT_BEAMFORMEE_ENTRY *p_beam_entry = beam_info->beamformee_entry + idx; + void *adapter = dm->adapter; #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - *p_dm_odm->p_is_fw_dw_rsvd_page_in_progress = true; + *dm->is_fw_dw_rsvd_page_in_progress = true; #endif - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); - phydm_get_hal_def_var_handler_interface(p_dm_odm, HAL_DEF_TX_PAGE_BOUNDARY, (u16 *)&tx_page_bndy); + phydm_get_hal_def_var_handler_interface(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_odm, REG_CR_8814A + 1); - odm_write_1byte(p_dm_odm, REG_CR_8814A + 1, (u1b_tmp | BIT(0))); + u1b_tmp = odm_read_1byte(dm, REG_CR_8814A + 1); + odm_write_1byte(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_odm, REG_FWHW_TXQ_CTRL_8814A + 2); - odm_write_1byte(p_dm_odm, REG_FWHW_TXQ_CTRL_8814A + 2, tmp_reg422 & (~BIT(6))); + tmp_reg422 = odm_read_1byte(dm, REG_FWHW_TXQ_CTRL_8814A + 2); + odm_write_1byte(dm, REG_FWHW_TXQ_CTRL_8814A + 2, tmp_reg422 & (~BIT(6))); if (tmp_reg422 & BIT(6)) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: There is an adapter is sending beacon.\n", __func__)); + PHYDM_DBG(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_odm, REG_FIFOPAGE_CTRL_2_8814A, head_page); + /*@0x204[11:0] Beacon Head for TXDMA*/ + odm_write_2byte(dm, REG_FIFOPAGE_CTRL_2_8814A, head_page); do { - /*Clear beacon valid check bit.*/ - bcn_valid_reg = odm_read_1byte(p_dm_odm, REG_FIFOPAGE_CTRL_2_8814A + 1); - odm_write_1byte(p_dm_odm, REG_FIFOPAGE_CTRL_2_8814A + 1, (bcn_valid_reg | BIT(7))); + /*@Clear beacon valid check bit.*/ + bcn_valid_reg = odm_read_1byte(dm, REG_FIFOPAGE_CTRL_2_8814A + 1); + odm_write_1byte(dm, REG_FIFOPAGE_CTRL_2_8814A + 1, (bcn_valid_reg | BIT(7))); - /*download NDPA rsvd page.*/ + /*@download NDPA rsvd page.*/ if (p_beam_entry->beamform_entry_cap & BEAMFORMER_CAP_VHT_SU) - beamforming_send_vht_ndpa_packet(p_dm_odm, p_beam_entry->mac_addr, p_beam_entry->AID, p_beam_entry->sound_bw, BEACON_QUEUE); + beamforming_send_vht_ndpa_packet(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_odm, p_beam_entry->mac_addr, p_beam_entry->sound_bw, BEACON_QUEUE); + beamforming_send_ht_ndpa_packet(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_odm, REG_FIFOPAGE_CTRL_2_8814A + 1); + /*@check rsvd page download OK.*/ + bcn_valid_reg = odm_read_1byte(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_odm, REG_FIFOPAGE_CTRL_2_8814A + 2); + bcn_valid_reg = odm_read_1byte(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))) - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Download RSVD page failed!\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "%s Download RSVD page failed!\n", + __func__); - /*0x204[11:0] Beacon Head for TXDMA*/ - odm_write_2byte(p_dm_odm, REG_FIFOPAGE_CTRL_2_8814A, tx_page_bndy); + /*@0x204[11:0] Beacon Head for TXDMA*/ + odm_write_2byte(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*/ + /*@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.*/ + /*@2010.06.23. Added by tynli.*/ if (is_send_beacon) - odm_write_1byte(p_dm_odm, REG_FWHW_TXQ_CTRL_8814A + 2, tmp_reg422); + odm_write_1byte(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_odm, REG_CR_8814A + 1); - odm_write_1byte(p_dm_odm, REG_CR_8814A + 1, (u1b_tmp & (~BIT(0)))); + /*@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(dm, REG_CR_8814A + 1); + odm_write_1byte(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_odm->p_is_fw_dw_rsvd_page_in_progress = false; + *dm->is_fw_dw_rsvd_page_in_progress = false; #endif } void hal_txbf_8814a_fw_txbf_cmd( - void *p_dm_void + void *dm_void ) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)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_odm->beamforming_info; + struct _RT_BEAMFORMING_INFO *beam_info = &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) { + if (beam_info->beamformee_entry[idx].is_used && beam_info->beamformee_entry[idx].beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED) { + if (beam_info->beamformee_entry[idx].is_sound) { PageNum0 = 0xFE; PageNum1 = 0x07; - period = (u8)(p_beam_info->beamformee_entry[idx].sound_period); + period = (u8)(beam_info->beamformee_entry[idx].sound_period); } else if (PageNum0 == 0xFF) { PageNum0 = 0xFF; /*stop sounding*/ PageNum1 = 0x0F; @@ -477,52 +473,50 @@ hal_txbf_8814a_fw_txbf_cmd( u1_tx_bf_parm[0] = PageNum0; u1_tx_bf_parm[1] = PageNum1; u1_tx_bf_parm[2] = period; - odm_fill_h2c_cmd(p_dm_odm, PHYDM_H2C_TXBF, 3, u1_tx_bf_parm); + odm_fill_h2c_cmd(dm, PHYDM_H2C_TXBF, 3, u1_tx_bf_parm); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, - ("[%s] PageNum0 = %d, PageNum1 = %d period = %d\n", __func__, PageNum0, PageNum1, period)); + PHYDM_DBG(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 -) +void hal_txbf_8814a_enter(void *dm_void, u8 bfer_bfee_idx) { - struct PHY_DM_STRUCT *p_dm_odm = (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_odm->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; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 i = 0; + u8 bfer_idx = (bfer_bfee_idx & 0xF0) >> 4; + u8 bfee_idx = (bfer_bfee_idx & 0xF); + struct _RT_BEAMFORMING_INFO *beamforming_info = &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; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] bfer_idx=%d, bfee_idx=%d\n", __func__, bfer_idx, bfee_idx)); - odm_set_mac_reg(p_dm_odm, REG_SND_PTCL_CTRL_8814A, MASKBYTE1 | MASKBYTE2, 0x0202); + PHYDM_DBG(dm, DBG_TXBF, "[%s] bfer_idx=%d, bfee_idx=%d\n", __func__, + bfer_idx, bfee_idx); + odm_set_mac_reg(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]; + if (beamforming_info->beamformer_su_cnt > 0 && bfer_idx < BEAMFORMER_ENTRY_NUM) { + beamformer_entry = beamforming_info->beamformer_entry[bfer_idx]; /*Sounding protocol control*/ - odm_write_1byte(p_dm_odm, REG_SND_PTCL_CTRL_8814A, 0xDB); + odm_write_1byte(dm, REG_SND_PTCL_CTRL_8814A, 0xDB); - /*MAC address/Partial AID of Beamformer*/ + /*@MAC address/Partial AID of Beamformer*/ if (bfer_idx == 0) { - for (i = 0; i < 6 ; i++) - odm_write_1byte(p_dm_odm, (REG_ASSOCIATED_BFMER0_INFO_8814A + i), beamformer_entry.mac_addr[i]); + for (i = 0; i < 6; i++) + odm_write_1byte(dm, (REG_ASSOCIATED_BFMER0_INFO_8814A + i), beamformer_entry.mac_addr[i]); } else { - for (i = 0; i < 6 ; i++) - odm_write_1byte(p_dm_odm, (REG_ASSOCIATED_BFMER1_INFO_8814A + i), beamformer_entry.mac_addr[i]); + for (i = 0; i < 6; i++) + odm_write_1byte(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_odm); /*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*/ + /*@CSI report parameters of Beamformer*/ + nc_index = hal_txbf_8814a_get_nrx(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*/ + /*@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) @@ -533,118 +527,108 @@ hal_txbf_8814a_enter( csi_param = (u16)((coefficientsize << 10) | (codebookinfo << 8) | (grouping << 6) | (nr_index << 3) | (nc_index)); if (bfer_idx == 0) - odm_write_2byte(p_dm_odm, REG_CSI_RPT_PARAM_BW20_8814A, csi_param); + odm_write_2byte(dm, REG_CSI_RPT_PARAM_BW20_8814A, csi_param); else - odm_write_2byte(p_dm_odm, REG_CSI_RPT_PARAM_BW20_8814A + 2, csi_param); + odm_write_2byte(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_odm, REG_SND_PTCL_CTRL_8814A + 3, 0x40); - + odm_write_1byte(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]; + if (beamforming_info->beamformee_su_cnt > 0 && bfee_idx < BEAMFORMEE_ENTRY_NUM) { + beamformee_entry = beamforming_info->beamformee_entry[bfee_idx]; - hal_txbf_8814a_rf_mode(p_dm_odm, p_beamforming_info, bfee_idx); + hal_txbf_8814a_rf_mode(dm, beamforming_info, bfee_idx); - if (phydm_acting_determine(p_dm_odm, phydm_acting_as_ibss)) + if (phydm_acting_determine(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_odm, REG_TXBF_CTRL_8814A, sta_id); - odm_write_1byte(p_dm_odm, REG_TXBF_CTRL_8814A + 3, odm_read_1byte(p_dm_odm, REG_TXBF_CTRL_8814A + 3) | BIT(4) | BIT(6) | BIT(7)); + odm_write_2byte(dm, REG_TXBF_CTRL_8814A, sta_id); + odm_write_1byte(dm, REG_TXBF_CTRL_8814A + 3, odm_read_1byte(dm, REG_TXBF_CTRL_8814A + 3) | BIT(4) | BIT(6) | BIT(7)); } else - odm_write_2byte(p_dm_odm, REG_TXBF_CTRL_8814A + 2, sta_id | BIT(14) | BIT(15) | BIT(12)); + odm_write_2byte(dm, REG_TXBF_CTRL_8814A + 2, sta_id | BIT(14) | BIT(15) | BIT(12)); - /*CSI report parameters of Beamformee*/ + /*@CSI report parameters of Beamformee*/ if (bfee_idx == 0) { - /*Get BIT24 & BIT25*/ - u8 tmp = odm_read_1byte(p_dm_odm, REG_ASSOCIATED_BFMEE_SEL_8814A + 3) & 0x3; + /*@Get BIT24 & BIT25*/ + u8 tmp = odm_read_1byte(dm, REG_ASSOCIATED_BFMEE_SEL_8814A + 3) & 0x3; - odm_write_1byte(p_dm_odm, REG_ASSOCIATED_BFMEE_SEL_8814A + 3, tmp | 0x60); - odm_write_2byte(p_dm_odm, REG_ASSOCIATED_BFMEE_SEL_8814A, sta_id | BIT(9)); + odm_write_1byte(dm, REG_ASSOCIATED_BFMEE_SEL_8814A + 3, tmp | 0x60); + odm_write_2byte(dm, REG_ASSOCIATED_BFMEE_SEL_8814A, sta_id | BIT(9)); } else - odm_write_2byte(p_dm_odm, REG_ASSOCIATED_BFMEE_SEL_8814A + 2, sta_id | 0xE200); /*Set BIT25*/ + odm_write_2byte(dm, REG_ASSOCIATED_BFMEE_SEL_8814A + 2, sta_id | 0xE200); /*Set BIT25*/ - phydm_beamforming_notify(p_dm_odm); + phydm_beamforming_notify(dm); } - } - -void -hal_txbf_8814a_leave( - void *p_dm_void, - u8 idx -) +void hal_txbf_8814a_leave(void *dm_void, u8 idx) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_BEAMFORMING_INFO *p_beamforming_info = &p_dm_odm->beamforming_info; - struct _RT_BEAMFORMER_ENTRY beamformer_entry; - struct _RT_BEAMFORMEE_ENTRY beamformee_entry; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _RT_BEAMFORMING_INFO *beamforming_info = &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]; + beamformer_entry = beamforming_info->beamformer_entry[idx]; + beamformee_entry = beamforming_info->beamformee_entry[idx]; } else return; - /*Clear P_AID of Beamformee*/ - /*Clear MAC address of Beamformer*/ - /*Clear Associated Bfmee Sel*/ + /*@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_odm, REG_SND_PTCL_CTRL_8814A, 0xD8); + odm_write_1byte(dm, REG_SND_PTCL_CTRL_8814A, 0xD8); if (idx == 0) { - odm_write_4byte(p_dm_odm, REG_ASSOCIATED_BFMER0_INFO_8814A, 0); - odm_write_2byte(p_dm_odm, REG_ASSOCIATED_BFMER0_INFO_8814A + 4, 0); - odm_write_2byte(p_dm_odm, REG_CSI_RPT_PARAM_BW20_8814A, 0); + odm_write_4byte(dm, REG_ASSOCIATED_BFMER0_INFO_8814A, 0); + odm_write_2byte(dm, REG_ASSOCIATED_BFMER0_INFO_8814A + 4, 0); + odm_write_2byte(dm, REG_CSI_RPT_PARAM_BW20_8814A, 0); } else { - odm_write_4byte(p_dm_odm, REG_ASSOCIATED_BFMER1_INFO_8814A, 0); - odm_write_2byte(p_dm_odm, REG_ASSOCIATED_BFMER1_INFO_8814A + 4, 0); - odm_write_2byte(p_dm_odm, REG_CSI_RPT_PARAM_BW20_8814A + 2, 0); + odm_write_4byte(dm, REG_ASSOCIATED_BFMER1_INFO_8814A, 0); + odm_write_2byte(dm, REG_ASSOCIATED_BFMER1_INFO_8814A + 4, 0); + odm_write_2byte(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_odm, p_beamforming_info, idx); + hal_txbf_8814a_rf_mode(dm, beamforming_info, idx); if (idx == 0) { - odm_write_2byte(p_dm_odm, REG_TXBF_CTRL_8814A, 0x0); - odm_write_1byte(p_dm_odm, REG_TXBF_CTRL_8814A + 3, odm_read_1byte(p_dm_odm, REG_TXBF_CTRL_8814A + 3) | BIT(4) | BIT(6) | BIT(7)); - odm_write_2byte(p_dm_odm, REG_ASSOCIATED_BFMEE_SEL_8814A, 0); + odm_write_2byte(dm, REG_TXBF_CTRL_8814A, 0x0); + odm_write_1byte(dm, REG_TXBF_CTRL_8814A + 3, odm_read_1byte(dm, REG_TXBF_CTRL_8814A + 3) | BIT(4) | BIT(6) | BIT(7)); + odm_write_2byte(dm, REG_ASSOCIATED_BFMEE_SEL_8814A, 0); } else { - odm_write_2byte(p_dm_odm, REG_TXBF_CTRL_8814A + 2, 0x0 | BIT(14) | BIT(15) | BIT(12)); + odm_write_2byte(dm, REG_TXBF_CTRL_8814A + 2, 0x0 | BIT(14) | BIT(15) | BIT(12)); - odm_write_2byte(p_dm_odm, REG_ASSOCIATED_BFMEE_SEL_8814A + 2, odm_read_2byte(p_dm_odm, REG_ASSOCIATED_BFMEE_SEL_8814A + 2) & 0x60); + odm_write_2byte(dm, REG_ASSOCIATED_BFMEE_SEL_8814A + 2, odm_read_2byte(dm, REG_ASSOCIATED_BFMEE_SEL_8814A + 2) & 0x60); } } } -void -hal_txbf_8814a_status( - void *p_dm_void, - u8 idx -) +void hal_txbf_8814a_status(void *dm_void, u8 idx) { - struct PHY_DM_STRUCT *p_dm_odm = (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_odm->beamforming_info; - struct _RT_BEAMFORMEE_ENTRY beamform_entry; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u16 beam_ctrl_val, tmp_val; + u32 beam_ctrl_reg; + struct _RT_BEAMFORMING_INFO *beamforming_info = &dm->beamforming_info; + struct _RT_BEAMFORMEE_ENTRY beamform_entry; if (idx < BEAMFORMEE_ENTRY_NUM) - beamform_entry = p_beamforming_info->beamformee_entry[idx]; + beamform_entry = beamforming_info->beamformee_entry[idx]; else return; - if (phydm_acting_determine(p_dm_odm, phydm_acting_as_ibss)) + if (phydm_acting_determine(dm, phydm_acting_as_ibss)) beam_ctrl_val = beamform_entry.mac_id; else beam_ctrl_val = beamform_entry.p_aid; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, beamform_entry.beamform_entry_state = %d", __func__, beamform_entry.beamform_entry_state)); + PHYDM_DBG(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; @@ -653,7 +637,7 @@ hal_txbf_8814a_status( 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.beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED && 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) @@ -661,41 +645,32 @@ hal_txbf_8814a_status( else if (beamform_entry.sound_bw == CHANNEL_WIDTH_80) beam_ctrl_val |= (BIT(9) | BIT(10) | BIT(11)); } else { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, Don't apply Vmatrix", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "@%s, Don't apply Vmatrix", __func__); beam_ctrl_val &= ~(BIT(9) | BIT(10) | BIT(11)); } - odm_write_2byte(p_dm_odm, beam_ctrl_reg, beam_ctrl_val); - /*disable NDP packet use beamforming */ - tmp_val = odm_read_2byte(p_dm_odm, REG_TXBF_CTRL_8814A); - odm_write_2byte(p_dm_odm, REG_TXBF_CTRL_8814A, tmp_val | BIT(15)); - + odm_write_2byte(dm, beam_ctrl_reg, beam_ctrl_val); + /*@disable NDP packet use beamforming */ + tmp_val = odm_read_2byte(dm, REG_TXBF_CTRL_8814A); + odm_write_2byte(dm, REG_TXBF_CTRL_8814A, tmp_val | BIT(15)); } - - - - -void -hal_txbf_8814a_fw_txbf( - void *p_dm_void, - u8 idx -) +void hal_txbf_8814a_fw_txbf(void *dm_void, u8 idx) { #if 0 - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm_odm->beamforming_info; - struct _RT_BEAMFORMEE_ENTRY *p_beam_entry = p_beam_info->beamformee_entry + idx; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; + struct _RT_BEAMFORMEE_ENTRY *p_beam_entry = beam_info->beamformee_entry + idx; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); + PHYDM_DBG(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_odm, idx); + hal_txbf_8814a_download_ndpa(dm, idx); - hal_txbf_8814a_fw_txbf_cmd(p_dm_odm); + hal_txbf_8814a_fw_txbf_cmd(dm); #endif } -#endif /* (RTL8814A_SUPPORT == 1)*/ +#endif /* @(RTL8814A_SUPPORT == 1)*/ #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbf8814a.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbf8814a.h index fe0d66463b13..9863d770db4f 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbf8814a.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbf8814a.h @@ -1,90 +1,78 @@ /* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ #ifndef __HAL_TXBF_8814A_H__ #define __HAL_TXBF_8814A_H__ #if (RTL8814A_SUPPORT == 1) -#if (BEAMFORMING_SUPPORT == 1) +#ifdef PHYDM_BEAMFORMING_SUPPORT -bool -phydm_beamforming_set_iqgen_8814A( - void *p_dm_void -); +boolean +phydm_beamforming_set_iqgen_8814A(void *dm_void); -void -hal_txbf_8814a_set_ndpa_rate( - void *p_dm_void, - u8 BW, - u8 rate -); +void hal_txbf_8814a_set_ndpa_rate(void *dm_void, u8 BW, u8 rate); -u8 -hal_txbf_8814a_get_ntx( - void *p_dm_void -); +u8 hal_txbf_8814a_get_ntx(void *dm_void); -void -hal_txbf_8814a_enter( - void *p_dm_void, - u8 idx -); +void hal_txbf_8814a_enter(void *dm_void, u8 idx); +void hal_txbf_8814a_leave(void *dm_void, u8 idx); -void -hal_txbf_8814a_leave( - void *p_dm_void, - u8 idx -); +void hal_txbf_8814a_status(void *dm_void, u8 idx); +void hal_txbf_8814a_reset_tx_path(void *dm_void, u8 idx); -void -hal_txbf_8814a_status( - void *p_dm_void, - u8 idx -); +void hal_txbf_8814a_get_tx_rate(void *dm_void); -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 -); +void hal_txbf_8814a_fw_txbf(void *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 +#define hal_txbf_8814a_set_ndpa_rate(dm_void, BW, rate) +#define hal_txbf_8814a_get_ntx(dm_void) 0 +#define hal_txbf_8814a_enter(dm_void, idx) +#define hal_txbf_8814a_leave(dm_void, idx) +#define hal_txbf_8814a_status(dm_void, idx) +#define hal_txbf_8814a_reset_tx_path(dm_void, idx) +#define hal_txbf_8814a_get_tx_rate(dm_void) +#define hal_txbf_8814a_fw_txbf(dm_void, idx) +#define phydm_beamforming_set_iqgen_8814A(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 +#define hal_txbf_8814a_set_ndpa_rate(dm_void, BW, rate) +#define hal_txbf_8814a_get_ntx(dm_void) 0 +#define hal_txbf_8814a_enter(dm_void, idx) +#define hal_txbf_8814a_leave(dm_void, idx) +#define hal_txbf_8814a_status(dm_void, idx) +#define hal_txbf_8814a_reset_tx_path(dm_void, idx) +#define hal_txbf_8814a_get_tx_rate(dm_void) +#define hal_txbf_8814a_fw_txbf(dm_void, idx) +#define phydm_beamforming_set_iqgen_8814A(dm_void) 0 #endif #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbf8822b.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbf8822b.c index 40f999018a91..1924e0f15a6c 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbf8822b.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbf8822b.c @@ -1,175 +1,180 @@ /* SPDX-License-Identifier: GPL-2.0 */ -/*============================================================*/ -/* Description: */ -/* */ +/****************************************************************************** + * + * 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 (RTL8822B_SUPPORT == 1) -#if (BEAMFORMING_SUPPORT == 1) +#ifdef PHYDM_BEAMFORMING_SUPPORT -u8 -hal_txbf_8822b_get_ntx( - void *p_dm_void -) +u8 hal_txbf_8822b_get_ntx( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 ntx = 0; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 ntx = 0; #if DEV_BUS_TYPE == RT_USB_INTERFACE - if (p_dm_odm->support_interface == ODM_ITRF_USB) { - if (*p_dm_odm->hub_usb_mode == 2) {/*USB3.0*/ - if (p_dm_odm->rf_type == ODM_4T4R) + if (dm->support_interface == ODM_ITRF_USB) { + if (*dm->hub_usb_mode == 2) { /*USB3.0*/ + if (dm->rf_type == RF_4T4R) ntx = 3; - else if (p_dm_odm->rf_type == ODM_3T3R) + else if (dm->rf_type == RF_3T3R) ntx = 2; else ntx = 1; - } else if (*p_dm_odm->hub_usb_mode == 1) /*USB 2.0 always 2Tx*/ + } else if (*dm->hub_usb_mode == 1) /*USB 2.0 always 2Tx*/ ntx = 1; else ntx = 1; } else #endif { - if (p_dm_odm->rf_type == ODM_4T4R) + if (dm->rf_type == RF_4T4R) ntx = 3; - else if (p_dm_odm->rf_type == ODM_3T3R) + else if (dm->rf_type == RF_3T3R) ntx = 2; else ntx = 1; } return ntx; - } -u8 -hal_txbf_8822b_get_nrx( - void *p_dm_void -) +u8 hal_txbf_8822b_get_nrx( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 nrx = 0; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 nrx = 0; - if (p_dm_odm->rf_type == ODM_4T4R) + if (dm->rf_type == RF_4T4R) nrx = 3; - else if (p_dm_odm->rf_type == ODM_3T3R) + else if (dm->rf_type == RF_3T3R) nrx = 2; - else if (p_dm_odm->rf_type == ODM_2T2R) + else if (dm->rf_type == RF_2T2R) nrx = 1; - else if (p_dm_odm->rf_type == ODM_2T3R) + else if (dm->rf_type == RF_2T3R) nrx = 2; - else if (p_dm_odm->rf_type == ODM_2T4R) + else if (dm->rf_type == RF_2T4R) nrx = 3; - else if (p_dm_odm->rf_type == ODM_1T1R) + else if (dm->rf_type == RF_1T1R) nrx = 0; - else if (p_dm_odm->rf_type == ODM_1T2R) + else if (dm->rf_type == RF_1T2R) nrx = 1; else nrx = 0; return nrx; - } /***************SU & MU BFee Entry********************/ -void -hal_txbf_8822b_rf_mode( - void *p_dm_void, - struct _RT_BEAMFORMING_INFO *p_beamforming_info, - u8 idx -) +void hal_txbf_8822b_rf_mode( + void *dm_void, + struct _RT_BEAMFORMING_INFO *beamforming_info, + u8 idx) { #if 0 - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; u8 i, nr_index = 0; - bool is_self_beamformer = false; - bool is_self_beamformee = false; + boolean is_self_beamformer = false; + boolean is_self_beamformee = false; struct _RT_BEAMFORMEE_ENTRY beamformee_entry; if (idx < BEAMFORMEE_ENTRY_NUM) - beamformee_entry = p_beamforming_info->beamformee_entry[idx]; + beamformee_entry = beamforming_info->beamformee_entry[idx]; else return; - if (p_dm_odm->rf_type == ODM_1T1R) + if (dm->rf_type == RF_1T1R) return; - for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_B; i++) { - odm_set_rf_reg(p_dm_odm, (enum odm_rf_radio_path_e)i, rf_welut_jaguar, 0x80000, 0x1); + for (i = RF_PATH_A; i < RF_PATH_B; i++) { + odm_set_rf_reg(dm, (enum rf_path)i, rf_welut_jaguar, 0x80000, 0x1); /*RF mode table write enable*/ } - if ((p_beamforming_info->beamformee_su_cnt > 0) || (p_beamforming_info->beamformee_mu_cnt > 0)) { - for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_B; i++) { - odm_set_rf_reg(p_dm_odm, (enum odm_rf_radio_path_e)i, rf_mode_table_addr, 0xfffff, 0x18000); + if (beamforming_info->beamformee_su_cnt > 0 || beamforming_info->beamformee_mu_cnt > 0) { + for (i = RF_PATH_A; i < RF_PATH_B; i++) { + odm_set_rf_reg(dm, (enum rf_path)i, rf_mode_table_addr, 0xfffff, 0x18000); /*Select RX mode*/ - odm_set_rf_reg(p_dm_odm, (enum odm_rf_radio_path_e)i, rf_mode_table_data0, 0xfffff, 0xBE77F); + odm_set_rf_reg(dm, (enum rf_path)i, rf_mode_table_data0, 0xfffff, 0xBE77F); /*Set Table data*/ - odm_set_rf_reg(p_dm_odm, (enum odm_rf_radio_path_e)i, rf_mode_table_data1, 0xfffff, 0x226BF); - /*Enable TXIQGEN in RX mode*/ + odm_set_rf_reg(dm, (enum rf_path)i, rf_mode_table_data1, 0xfffff, 0x226BF); + /*@Enable TXIQGEN in RX mode*/ } - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, rf_mode_table_data1, 0xfffff, 0xE26BF); - /*Enable TXIQGEN in RX mode*/ + odm_set_rf_reg(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_set_rf_reg(p_dm_odm, (enum odm_rf_radio_path_e)i, rf_welut_jaguar, 0x80000, 0x0); + for (i = RF_PATH_A; i < RF_PATH_B; i++) { + odm_set_rf_reg(dm, (enum rf_path)i, rf_welut_jaguar, 0x80000, 0x0); /*RF mode table write disable*/ } - if (p_beamforming_info->beamformee_su_cnt > 0) { - - /*for 8814 19ac(idx 1), 19b4(idx 0), different Tx ant setting*/ - odm_set_bb_reg(p_dm_odm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT(28) | BIT29, 0x2); /*enable BB TxBF ant mapping register*/ + if (beamforming_info->beamformee_su_cnt > 0) { + /*@for 8814 19ac(idx 1), 19b4(idx 0), different Tx ant setting*/ + odm_set_bb_reg(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_set_bb_reg(p_dm_odm, REG_BB_TXBF_ANT_SET_BF0_8822B, 0xffff, 0x0433); - odm_set_bb_reg(p_dm_odm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x043); - /*odm_set_bb_reg(p_dm_odm, REG_BB_TX_PATH_SEL_2, MASKLWORD, 0x430);*/ + odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF0_8822B, 0xffff, 0x0433); + odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x043); + /*odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_2, MASKLWORD, 0x430);*/ - } else {/*IDX =1*/ - odm_set_bb_reg(p_dm_odm, REG_BB_TXBF_ANT_SET_BF1_8822B, 0xffff, 0x0433); - odm_set_bb_reg(p_dm_odm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x043); - /*odm_set_bb_reg(p_dm_odm, REG_BB_TX_PATH_SEL_2, MASKLWORD, 0x430;*/ + } else {/*@IDX =1*/ + odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF1_8822B, 0xffff, 0x0433); + odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x043); + /*odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_2, MASKLWORD, 0x430;*/ } } else { - odm_set_bb_reg(p_dm_odm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x1); /*1SS by path-A*/ - odm_set_bb_reg(p_dm_odm, REG_BB_TX_PATH_SEL_2_8822B, MASKLWORD, 0x430); /*2SS by path-A,B*/ + odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x1); /*@1SS by path-A*/ + odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_2_8822B, MASKLWORD, 0x430); /*@2SS by path-A,B*/ } - if (p_beamforming_info->beamformee_mu_cnt > 0) { - /*MU STAs share the common setting*/ - odm_set_bb_reg(p_dm_odm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT(31), 1); - odm_set_bb_reg(p_dm_odm, REG_BB_TXBF_ANT_SET_BF1_8822B, 0xffff, 0x0433); - odm_set_bb_reg(p_dm_odm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x043); + if (beamforming_info->beamformee_mu_cnt > 0) { + /*@MU STAs share the common setting*/ + odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT(31), 1); + odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF1_8822B, 0xffff, 0x0433); + odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x043); } #endif } #if 0 void hal_txbf_8822b_download_ndpa( - struct _ADAPTER *adapter, + void *adapter, u8 idx ) { u8 u1b_tmp = 0, tmp_reg422 = 0; u8 bcn_valid_reg = 0, count = 0, dl_bcn_count = 0; u16 head_page = 0x7FE; - bool 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; + boolean is_send_beacon = false; + HAL_DATA_TYPE *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 *beam_info = GET_BEAMFORM_INFO(adapter); + struct _RT_BEAMFORMEE_ENTRY *p_beam_entry = 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_odm, HAL_DEF_TX_PAGE_BOUNDARY, (u16 *)&tx_page_bndy); + hal_data->is_fw_dw_rsvd_page_in_progress = true; + phydm_get_hal_def_var_handler_interface(dm, HAL_DEF_TX_PAGE_BOUNDARY, (u16 *)&tx_page_bndy); /*Set REG_CR bit 8. DMA beacon by SW.*/ u1b_tmp = platform_efio_read_1byte(adapter, REG_CR_8814A + 1); @@ -185,21 +190,21 @@ hal_txbf_8822b_download_ndpa( is_send_beacon = true; } - /*0x204[11:0] Beacon Head for TXDMA*/ + /*@0x204[11:0] Beacon Head for TXDMA*/ platform_efio_write_2byte(adapter, REG_FIFOPAGE_CTRL_2_8814A, head_page); do { - /*Clear beacon valid check bit.*/ + /*@Clear beacon valid check bit.*/ 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.*/ + /*@download NDPA rsvd page.*/ if (p_beam_entry->beamform_entry_cap & BEAMFORMER_CAP_VHT_SU) - beamforming_send_vht_ndpa_packet(p_dm_odm, p_beam_entry->mac_addr, p_beam_entry->AID, p_beam_entry->sound_bw, BEACON_QUEUE); + beamforming_send_vht_ndpa_packet(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_odm, p_beam_entry->mac_addr, p_beam_entry->sound_bw, BEACON_QUEUE); + beamforming_send_ht_ndpa_packet(dm, p_beam_entry->mac_addr, p_beam_entry->sound_bw, BEACON_QUEUE); - /*check rsvd page download OK.*/ + /*@check rsvd page download OK.*/ bcn_valid_reg = platform_efio_read_1byte(adapter, REG_FIFOPAGE_CTRL_2_8814A + 1); count = 0; while (!(bcn_valid_reg & BIT(7)) && count < 20) { @@ -213,45 +218,45 @@ hal_txbf_8822b_download_ndpa( 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*/ + /*@0x204[11:0] Beacon Head for TXDMA*/ 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*/ + /*@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.*/ + /*@2010.06.23. Added by tynli.*/ 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.*/ + /*@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 = platform_efio_read_1byte(adapter, REG_CR_8814A + 1); platform_efio_write_1byte(adapter, REG_CR_8814A + 1, (u1b_tmp & (~BIT(0)))); p_beam_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_PROGRESSED; - p_hal_data->is_fw_dw_rsvd_page_in_progress = false; + hal_data->is_fw_dw_rsvd_page_in_progress = false; } void hal_txbf_8822b_fw_txbf_cmd( - struct _ADAPTER *adapter + void *adapter ) { u8 idx, period = 0; u8 PageNum0 = 0xFF, PageNum1 = 0xFF; u8 u1_tx_bf_parm[3] = {0}; - PMGNT_INFO p_mgnt_info = &(adapter->MgntInfo); - struct _RT_BEAMFORMING_INFO *p_beam_info = GET_BEAMFORM_INFO(adapter); + PMGNT_INFO mgnt_info = &(adapter->MgntInfo); + struct _RT_BEAMFORMING_INFO *beam_info = GET_BEAMFORM_INFO(adapter); 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) { + if (beam_info->beamformee_entry[idx].is_used && beam_info->beamformee_entry[idx].beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED) { + if (beam_info->beamformee_entry[idx].is_sound) { PageNum0 = 0xFE; PageNum1 = 0x07; - period = (u8)(p_beam_info->beamformee_entry[idx].sound_period); + period = (u8)(beam_info->beamformee_entry[idx].sound_period); } else if (PageNum0 == 0xFF) { PageNum0 = 0xFF; /*stop sounding*/ PageNum1 = 0x0F; @@ -271,108 +276,107 @@ hal_txbf_8822b_fw_txbf_cmd( #if 0 void hal_txbf_8822b_init( - void *p_dm_void + void *dm_void ) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; u8 u1b_tmp; - struct _RT_BEAMFORMING_INFO *p_beamforming_info = &p_dm_odm->beamforming_info; - struct _ADAPTER *adapter = p_dm_odm->adapter; + struct _RT_BEAMFORMING_INFO *beamforming_info = &dm->beamforming_info; + void *adapter = dm->adapter; - odm_set_bb_reg(p_dm_odm, 0x14c0, BIT(16), 1); /*Enable P1 aggr new packet according to P0 transfer time*/ - odm_set_bb_reg(p_dm_odm, 0x14c0, BIT(15) | BIT14 | BIT13 | BIT12, 10); /*MU Retry Limit*/ - odm_set_bb_reg(p_dm_odm, 0x14c0, BIT(7), 0); /*Disable Tx MU-MIMO until sounding done*/ - odm_set_bb_reg(p_dm_odm, 0x14c0, 0x3F, 0); /* Clear validity of MU STAs */ - odm_write_1byte(p_dm_odm, 0x167c, 0x70); /*MU-MIMO Option as default value*/ - odm_write_2byte(p_dm_odm, 0x1680, 0); /*MU-MIMO Control as default value*/ + odm_set_bb_reg(dm, R_0x14c0, BIT(16), 1); /*@Enable P1 aggr new packet according to P0 transfer time*/ + odm_set_bb_reg(dm, R_0x14c0, BIT(15) | BIT14 | BIT13 | BIT12, 10); /*@MU Retry Limit*/ + odm_set_bb_reg(dm, R_0x14c0, BIT(7), 0); /*@Disable Tx MU-MIMO until sounding done*/ + odm_set_bb_reg(dm, R_0x14c0, 0x3F, 0); /* @Clear validity of MU STAs */ + odm_write_1byte(dm, 0x167c, 0x70); /*@MU-MIMO Option as default value*/ + odm_write_2byte(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) */ - u1b_tmp = odm_read_1byte(p_dm_odm, 0x42C); - odm_write_1byte(p_dm_odm, REG_TXBF_CTRL_8822B, (u1b_tmp | BIT(6))); - /* 0x45F[7:0] = 0x10 (rate=OFDM_6M, BW20) */ - odm_write_1byte(p_dm_odm, REG_NDPA_OPT_CTRL_8822B, 0x10); + /* @0x42C[30] = 1 (0: from Tx desc, 1: from 0x45F) */ + u1b_tmp = odm_read_1byte(dm, 0x42C); + odm_write_1byte(dm, REG_TXBF_CTRL_8822B, (u1b_tmp | BIT(6))); + /* @0x45F[7:0] = 0x10 (rate=OFDM_6M, BW20) */ + odm_write_1byte(dm, REG_NDPA_OPT_CTRL_8822B, 0x10); /*Temp Settings*/ - odm_set_bb_reg(p_dm_odm, 0x6DC, 0x3F000000, 4); /*STA2's CSI rate is fixed at 6M*/ - odm_set_bb_reg(p_dm_odm, 0x1C94, MASKDWORD, 0xAFFFAFFF); /*Grouping bitmap parameters*/ + odm_set_bb_reg(dm, R_0x6dc, 0x3F000000, 4); /*STA2's CSI rate is fixed at 6M*/ + odm_set_bb_reg(dm, R_0x1c94, MASKDWORD, 0xAFFFAFFF); /*@Grouping bitmap parameters*/ - /* Init HW variable */ - p_beamforming_info->reg_mu_tx_ctrl = odm_read_4byte(p_dm_odm, 0x14c0); + /* @Init HW variable */ + beamforming_info->reg_mu_tx_ctrl = odm_read_4byte(dm, 0x14c0); - if (p_dm_odm->rf_type == ODM_2T2R) { /*2T2R*/ - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: rf_type is 2T2R\n", __func__)); - config_phydm_trx_mode_8822b(p_dm_odm, (enum odm_rf_path_e)3, (enum odm_rf_path_e)3, true);/*Tx2path*/ + if (dm->rf_type == RF_2T2R) { /*@2T2R*/ + PHYDM_DBG(dm, DBG_TXBF, "%s: rf_type is 2T2R\n", __func__); + config_phydm_trx_mode_8822b(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_set_bb_reg(p_dm_odm, 0xB00, BIT(9), 1);*/ /* For A-cut only. RegB00[9] = 1 (enable PMAC Rx) */ - odm_set_bb_reg(p_dm_odm, 0xB54, BIT(30), 1); /* RegB54[30] = 1 (force user position) */ - odm_set_bb_reg(p_dm_odm, 0xB54, (BIT(29) | BIT28), adapter->MgntInfo.sniff_user_position); /* RegB54[29:28] = user position (0~3) */ - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Set adapter->MgntInfo.sniff_user_position=%#X\n", adapter->MgntInfo.sniff_user_position)); + /* @Config HW to receive packet on the user position from registry for sniffer mode. */ + /* odm_set_bb_reg(dm, R_0xb00, BIT(9), 1);*/ /* For A-cut only. RegB00[9] = 1 (enable PMAC Rx) */ + odm_set_bb_reg(dm, R_0xb54, BIT(30), 1); /* RegB54[30] = 1 (force user position) */ + odm_set_bb_reg(dm, R_0xb54, (BIT(29) | BIT28), adapter->MgntInfo.sniff_user_position); /* RegB54[29:28] = user position (0~3) */ + PHYDM_DBG(dm, DBG_TXBF, + "Set adapter->MgntInfo.sniff_user_position=%#X\n", + adapter->MgntInfo.sniff_user_position); #endif } #endif -void -hal_txbf_8822b_enter( - void *p_dm_void, - u8 bfer_bfee_idx -) +void hal_txbf_8822b_enter( + void *dm_void, + u8 bfer_bfee_idx) { - struct PHY_DM_STRUCT *p_dm_odm = (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_odm->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; + struct dm_struct *dm = (struct dm_struct *)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 *beamforming_info = &dm->beamforming_info; + struct _RT_BEAMFORMEE_ENTRY *p_beamformee_entry; + struct _RT_BEAMFORMER_ENTRY *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 ((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; + if (beamforming_info->beamformer_su_cnt > 0 && bfer_idx < BEAMFORMER_ENTRY_NUM) { + beamformer_entry = &beamforming_info->beamformer_entry[bfer_idx]; + beamformer_entry->is_mu_ap = false; /*Sounding protocol control*/ - odm_write_1byte(p_dm_odm, REG_SND_PTCL_CTRL_8822B, 0xDB); - + odm_write_1byte(dm, REG_SND_PTCL_CTRL_8822B, 0xDB); for (i = 0; i < MAX_BEAMFORMER_SU; 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; + if ((beamforming_info->beamformer_su_reg_maping & BIT(i)) == 0) { + beamforming_info->beamformer_su_reg_maping |= BIT(i); + beamformer_entry->su_reg_index = i; break; } } - /*MAC address/Partial AID of Beamformer*/ - if (p_beamformer_entry->su_reg_index == 0) { - for (i = 0; i < 6 ; i++) - odm_write_1byte(p_dm_odm, (REG_ASSOCIATED_BFMER0_INFO_8822B + i), p_beamformer_entry->mac_addr[i]); + /*@MAC address/Partial AID of Beamformer*/ + if (beamformer_entry->su_reg_index == 0) { + for (i = 0; i < 6; i++) + odm_write_1byte(dm, (REG_ASSOCIATED_BFMER0_INFO_8822B + i), beamformer_entry->mac_addr[i]); } else { - for (i = 0; i < 6 ; i++) - odm_write_1byte(p_dm_odm, (REG_ASSOCIATED_BFMER1_INFO_8822B + i), p_beamformer_entry->mac_addr[i]); + for (i = 0; i < 6; i++) + odm_write_1byte(dm, (REG_ASSOCIATED_BFMER1_INFO_8822B + i), beamformer_entry->mac_addr[i]); } - /*CSI report parameters of Beamformer*/ - nc_index = hal_txbf_8822b_get_nrx(p_dm_odm); /*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*/ + /*@CSI report parameters of Beamformer*/ + nc_index = hal_txbf_8822b_get_nrx(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 (p_beamformer_entry->beamform_entry_cap & BEAMFORMEE_CAP_VHT_SU) + /*@for ac = 1, for n = 3*/ + if (beamformer_entry->beamform_entry_cap & BEAMFORMEE_CAP_VHT_SU) codebookinfo = 1; - else if (p_beamformer_entry->beamform_entry_cap & BEAMFORMEE_CAP_HT_EXPLICIT) + else if (beamformer_entry->beamform_entry_cap & BEAMFORMEE_CAP_HT_EXPLICIT) codebookinfo = 3; coefficientsize = 3; @@ -380,28 +384,27 @@ hal_txbf_8822b_enter( csi_param = (u16)((coefficientsize << 10) | (codebookinfo << 8) | (grouping << 6) | (nr_index << 3) | (nc_index)); if (bfer_idx == 0) - odm_write_2byte(p_dm_odm, REG_TX_CSI_RPT_PARAM_BW20_8822B, csi_param); + odm_write_2byte(dm, REG_TX_CSI_RPT_PARAM_BW20_8822B, csi_param); else - odm_write_2byte(p_dm_odm, REG_TX_CSI_RPT_PARAM_BW20_8822B + 2, csi_param); + odm_write_2byte(dm, REG_TX_CSI_RPT_PARAM_BW20_8822B + 2, csi_param); /*ndp_rx_standby_timer, 8814 need > 0x56, suggest from Dvaid*/ - odm_write_1byte(p_dm_odm, REG_SND_PTCL_CTRL_8822B + 3, 0x70); - + odm_write_1byte(dm, REG_SND_PTCL_CTRL_8822B + 3, 0x70); } /*************SU BFee Entry Init*************/ - if ((p_beamforming_info->beamformee_su_cnt > 0) && (bfee_idx < BEAMFORMEE_ENTRY_NUM)) { - p_beamformee_entry = &p_beamforming_info->beamformee_entry[bfee_idx]; + if (beamforming_info->beamformee_su_cnt > 0 && bfee_idx < BEAMFORMEE_ENTRY_NUM) { + p_beamformee_entry = &beamforming_info->beamformee_entry[bfee_idx]; p_beamformee_entry->is_mu_sta = false; - hal_txbf_8822b_rf_mode(p_dm_odm, p_beamforming_info, bfee_idx); + hal_txbf_8822b_rf_mode(dm, beamforming_info, bfee_idx); - if (phydm_acting_determine(p_dm_odm, phydm_acting_as_ibss)) + if (phydm_acting_determine(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 ((p_beamforming_info->beamformee_su_reg_maping & BIT(i)) == 0) { - p_beamforming_info->beamformee_su_reg_maping |= BIT(i); + if ((beamforming_info->beamformee_su_reg_maping & BIT(i)) == 0) { + beamforming_info->beamformee_su_reg_maping |= BIT(i); p_beamformee_entry->su_reg_index = i; break; } @@ -409,83 +412,82 @@ hal_txbf_8822b_enter( /*P_AID of Beamformee & enable NDPA transmission & enable NDPA interrupt*/ if (p_beamformee_entry->su_reg_index == 0) { - odm_write_2byte(p_dm_odm, REG_TXBF_CTRL_8822B, sta_id); - odm_write_1byte(p_dm_odm, REG_TXBF_CTRL_8822B + 3, odm_read_1byte(p_dm_odm, REG_TXBF_CTRL_8822B + 3) | BIT(4) | BIT(6) | BIT(7)); + odm_write_2byte(dm, REG_TXBF_CTRL_8822B, sta_id); + odm_write_1byte(dm, REG_TXBF_CTRL_8822B + 3, odm_read_1byte(dm, REG_TXBF_CTRL_8822B + 3) | BIT(4) | BIT(6) | BIT(7)); } else - odm_write_2byte(p_dm_odm, REG_TXBF_CTRL_8822B + 2, sta_id | BIT(14) | BIT(15) | BIT(12)); + odm_write_2byte(dm, REG_TXBF_CTRL_8822B + 2, sta_id | BIT(14) | BIT(15) | BIT(12)); - /*CSI report parameters of Beamformee*/ + /*@CSI report parameters of Beamformee*/ if (p_beamformee_entry->su_reg_index == 0) { - /*Get BIT24 & BIT25*/ - u8 tmp = odm_read_1byte(p_dm_odm, REG_ASSOCIATED_BFMEE_SEL_8822B + 3) & 0x3; + /*@Get BIT24 & BIT25*/ + u8 tmp = odm_read_1byte(dm, REG_ASSOCIATED_BFMEE_SEL_8822B + 3) & 0x3; - odm_write_1byte(p_dm_odm, REG_ASSOCIATED_BFMEE_SEL_8822B + 3, tmp | 0x60); - odm_write_2byte(p_dm_odm, REG_ASSOCIATED_BFMEE_SEL_8822B, sta_id | BIT(9)); + odm_write_1byte(dm, REG_ASSOCIATED_BFMEE_SEL_8822B + 3, tmp | 0x60); + odm_write_2byte(dm, REG_ASSOCIATED_BFMEE_SEL_8822B, sta_id | BIT(9)); } else - odm_write_2byte(p_dm_odm, REG_ASSOCIATED_BFMEE_SEL_8822B + 2, sta_id | 0xE200); /*Set BIT25*/ + odm_write_2byte(dm, REG_ASSOCIATED_BFMEE_SEL_8822B + 2, sta_id | 0xE200); /*Set BIT25*/ - phydm_beamforming_notify(p_dm_odm); + phydm_beamforming_notify(dm); } /*************MU BFer Entry Init*************/ - 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; + if (beamforming_info->beamformer_mu_cnt > 0 && bfer_idx < BEAMFORMER_ENTRY_NUM) { + beamformer_entry = &beamforming_info->beamformer_entry[bfer_idx]; + beamforming_info->mu_ap_index = bfer_idx; + beamformer_entry->is_mu_ap = true; for (i = 0; i < 8; i++) - p_beamformer_entry->gid_valid[i] = 0; + beamformer_entry->gid_valid[i] = 0; for (i = 0; i < 16; i++) - p_beamformer_entry->user_position[i] = 0; + beamformer_entry->user_position[i] = 0; /*Sounding protocol control*/ - odm_write_1byte(p_dm_odm, REG_SND_PTCL_CTRL_8822B, 0xDB); + odm_write_1byte(dm, REG_SND_PTCL_CTRL_8822B, 0xDB); - /* MAC address */ - for (i = 0; i < 6 ; i++) - odm_write_1byte(p_dm_odm, (REG_ASSOCIATED_BFMER0_INFO_8822B + i), p_beamformer_entry->mac_addr[i]); + /* @MAC address */ + for (i = 0; i < 6; i++) + odm_write_1byte(dm, (REG_ASSOCIATED_BFMER0_INFO_8822B + i), beamformer_entry->mac_addr[i]); /* Set partial AID */ - odm_write_2byte(p_dm_odm, (REG_ASSOCIATED_BFMER0_INFO_8822B + 6), p_beamformer_entry->p_aid); + odm_write_2byte(dm, (REG_ASSOCIATED_BFMER0_INFO_8822B + 6), beamformer_entry->p_aid); - /* Fill our AID to 0x1680[11:0] and [13:12] = 2b'00, BF report segment select to 3895 bytes*/ - u1b_tmp = odm_read_1byte(p_dm_odm, 0x1680); - u1b_tmp = (p_beamformer_entry->p_aid) & 0xFFF; - odm_write_1byte(p_dm_odm, 0x1680, u1b_tmp); + /* @Fill our AID to 0x1680[11:0] and [13:12] = 2b'00, BF report segment select to 3895 bytes*/ + u1b_tmp = odm_read_1byte(dm, 0x1680); + u1b_tmp = (beamformer_entry->p_aid) & 0xFFF; + odm_write_1byte(dm, 0x1680, u1b_tmp); /* Set 80us for leaving ndp_rx_standby_state */ - odm_write_1byte(p_dm_odm, 0x71B, 0x50); + odm_write_1byte(dm, 0x71B, 0x50); /* Set 0x6A0[14] = 1 to accept action_no_ack */ - u1b_tmp = odm_read_1byte(p_dm_odm, REG_RXFLTMAP0_8822B + 1); + u1b_tmp = odm_read_1byte(dm, REG_RXFLTMAP0_8822B + 1); u1b_tmp |= 0x40; - odm_write_1byte(p_dm_odm, REG_RXFLTMAP0_8822B + 1, u1b_tmp); + odm_write_1byte(dm, REG_RXFLTMAP0_8822B + 1, u1b_tmp); /* Set 0x6A2[5:4] = 1 to NDPA and BF report poll */ - u1b_tmp = odm_read_1byte(p_dm_odm, REG_RXFLTMAP1_8822B); + u1b_tmp = odm_read_1byte(dm, REG_RXFLTMAP1_8822B); u1b_tmp |= 0x30; - odm_write_1byte(p_dm_odm, REG_RXFLTMAP1_8822B, u1b_tmp); + odm_write_1byte(dm, REG_RXFLTMAP1_8822B, u1b_tmp); - /*CSI report parameters of Beamformer*/ - nc_index = hal_txbf_8822b_get_nrx(p_dm_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*/ + /*@CSI report parameters of Beamformer*/ + nc_index = hal_txbf_8822b_get_nrx(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*/ + codebookinfo = 1; /*@7 bit for psi, 9 bit for phi*/ 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_odm, 0x6F4, csi_param); - - /*for B-cut*/ - odm_set_bb_reg(p_dm_odm, 0x6A0, BIT(20), 0); - odm_set_bb_reg(p_dm_odm, 0x688, BIT(20), 0); + odm_write_2byte(dm, 0x6F4, csi_param); + /*@for B-cut*/ + odm_set_bb_reg(dm, R_0x6a0, BIT(20), 0); + odm_set_bb_reg(dm, R_0x688, BIT(20), 0); } /*************MU BFee Entry Init*************/ - if ((p_beamforming_info->beamformee_mu_cnt > 0) && (bfee_idx < BEAMFORMEE_ENTRY_NUM)) { - p_beamformee_entry = &p_beamforming_info->beamformee_entry[bfee_idx]; + if (beamforming_info->beamformee_mu_cnt > 0 && bfee_idx < BEAMFORMEE_ENTRY_NUM) { + p_beamformee_entry = &beamforming_info->beamformee_entry[bfee_idx]; p_beamformee_entry->is_mu_sta = true; for (i = 0; i < MAX_BEAMFORMEE_MU; i++) { - if ((p_beamforming_info->beamformee_mu_reg_maping & BIT(i)) == 0) { - p_beamforming_info->beamformee_mu_reg_maping |= BIT(i); + if ((beamforming_info->beamformee_mu_reg_maping & BIT(i)) == 0) { + beamforming_info->beamformee_mu_reg_maping |= BIT(i); p_beamformee_entry->mu_reg_index = i; break; } @@ -548,259 +550,264 @@ hal_txbf_8822b_enter( } /*Sounding protocol control*/ - odm_write_1byte(p_dm_odm, REG_SND_PTCL_CTRL_8822B, 0xDB); + odm_write_1byte(dm, REG_SND_PTCL_CTRL_8822B, 0xDB); /*select MU STA table*/ - 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_odm, 0x14c0, p_beamforming_info->reg_mu_tx_ctrl); + beamforming_info->reg_mu_tx_ctrl &= ~(BIT(8) | BIT(9) | BIT(10)); + beamforming_info->reg_mu_tx_ctrl |= (p_beamformee_entry->mu_reg_index << 8) & (BIT(8) | BIT(9) | BIT(10)); + odm_write_4byte(dm, 0x14c0, beamforming_info->reg_mu_tx_ctrl); - odm_set_bb_reg(p_dm_odm, 0x14c4, MASKDWORD, 0); /*Reset gid_valid table*/ - odm_set_bb_reg(p_dm_odm, 0x14c8, MASKDWORD, user_position_l); - odm_set_bb_reg(p_dm_odm, 0x14cc, MASKDWORD, user_position_h); + odm_set_bb_reg(dm, R_0x14c4, MASKDWORD, 0); /*Reset gid_valid table*/ + odm_set_bb_reg(dm, R_0x14c8, MASKDWORD, user_position_l); + odm_set_bb_reg(dm, R_0x14cc, MASKDWORD, 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_odm, 0x14c0, p_beamforming_info->reg_mu_tx_ctrl); + beamforming_info->reg_mu_tx_ctrl &= 0xFFFFFFC0; + beamforming_info->reg_mu_tx_ctrl |= beamforming_info->beamformee_mu_reg_maping & 0x3F; + odm_write_4byte(dm, 0x14c0, beamforming_info->reg_mu_tx_ctrl); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%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)); + PHYDM_DBG(dm, DBG_TXBF, + "@%s, reg_mu_tx_ctrl = 0x%x, user_position_l = 0x%x, user_position_h = 0x%x\n", + __func__, beamforming_info->reg_mu_tx_ctrl, + user_position_l, user_position_h); - value16 = odm_read_2byte(p_dm_odm, mu_reg[p_beamformee_entry->mu_reg_index]); - value16 &= 0xFE00; /*Clear PAID*/ - value16 |= BIT(9); /*Enable MU BFee*/ + value16 = odm_read_2byte(dm, mu_reg[p_beamformee_entry->mu_reg_index]); + value16 &= 0xFE00; /*@Clear PAID*/ + value16 |= BIT(9); /*@Enable MU BFee*/ value16 |= p_beamformee_entry->p_aid; - odm_write_2byte(p_dm_odm, mu_reg[p_beamformee_entry->mu_reg_index], value16); + odm_write_2byte(dm, mu_reg[p_beamformee_entry->mu_reg_index], value16); - /* 0x42C[30] = 1 (0: from Tx desc, 1: from 0x45F) */ - u1b_tmp = odm_read_1byte(p_dm_odm, REG_TXBF_CTRL_8822B + 3); + /* @0x42C[30] = 1 (0: from Tx desc, 1: from 0x45F) */ + u1b_tmp = odm_read_1byte(dm, REG_TXBF_CTRL_8822B + 3); u1b_tmp |= 0xD0; /* Set bit 28, 30, 31 to 3b'111*/ - odm_write_1byte(p_dm_odm, REG_TXBF_CTRL_8822B + 3, u1b_tmp); + odm_write_1byte(dm, REG_TXBF_CTRL_8822B + 3, u1b_tmp); /* Set NDPA to 6M*/ - odm_write_1byte(p_dm_odm, REG_NDPA_RATE_8822B, 0x4); + odm_write_1byte(dm, REG_NDPA_RATE_8822B, 0x4); - u1b_tmp = odm_read_1byte(p_dm_odm, REG_NDPA_OPT_CTRL_8822B); - u1b_tmp &= 0xFC; /* Clear bit 0, 1*/ - odm_write_1byte(p_dm_odm, REG_NDPA_OPT_CTRL_8822B, u1b_tmp); + u1b_tmp = odm_read_1byte(dm, REG_NDPA_OPT_CTRL_8822B); + u1b_tmp &= 0xFC; /* @Clear bit 0, 1*/ + odm_write_1byte(dm, REG_NDPA_OPT_CTRL_8822B, u1b_tmp); - u4b_tmp = odm_read_4byte(p_dm_odm, REG_SND_PTCL_CTRL_8822B); + u4b_tmp = odm_read_4byte(dm, REG_SND_PTCL_CTRL_8822B); u4b_tmp = ((u4b_tmp & 0xFF0000FF) | 0x020200); /* Set [23:8] to 0x0202*/ - odm_write_4byte(p_dm_odm, REG_SND_PTCL_CTRL_8822B, u4b_tmp); + odm_write_4byte(dm, REG_SND_PTCL_CTRL_8822B, u4b_tmp); /* Set 0x6A0[14] = 1 to accept action_no_ack */ - u1b_tmp = odm_read_1byte(p_dm_odm, REG_RXFLTMAP0_8822B + 1); + u1b_tmp = odm_read_1byte(dm, REG_RXFLTMAP0_8822B + 1); u1b_tmp |= 0x40; - odm_write_1byte(p_dm_odm, REG_RXFLTMAP0_8822B + 1, u1b_tmp); - /* End of MAC registers setting */ + odm_write_1byte(dm, REG_RXFLTMAP0_8822B + 1, u1b_tmp); + /* @End of MAC registers setting */ - hal_txbf_8822b_rf_mode(p_dm_odm, p_beamforming_info, bfee_idx); + hal_txbf_8822b_rf_mode(dm, beamforming_info, bfee_idx); #if (SUPPORT_MU_BF == 1) /*Special for plugfest*/ delay_ms(50); /* wait for 4-way handshake ending*/ - send_sw_vht_gid_mgnt_frame(p_dm_odm, p_beamformee_entry->mac_addr, bfee_idx); + send_sw_vht_gid_mgnt_frame(dm, p_beamformee_entry->mac_addr, bfee_idx); #endif - phydm_beamforming_notify(p_dm_odm); + phydm_beamforming_notify(dm); #if 1 { u32 ctrl_info_offset, index; /*Set Ctrl Info*/ - odm_write_2byte(p_dm_odm, 0x140, 0x660); + odm_write_2byte(dm, 0x140, 0x660); ctrl_info_offset = 0x8000 + 32 * p_beamformee_entry->mac_id; /*Reset Ctrl Info*/ for (index = 0; index < 8; index++) - odm_write_4byte(p_dm_odm, ctrl_info_offset + index * 4, 0); + odm_write_4byte(dm, ctrl_info_offset + index * 4, 0); - odm_write_4byte(p_dm_odm, ctrl_info_offset, (p_beamformee_entry->mu_reg_index + 1) << 16); - odm_write_1byte(p_dm_odm, 0x81, 0x80); /*RPTBUF ready*/ + odm_write_4byte(dm, ctrl_info_offset, (p_beamformee_entry->mu_reg_index + 1) << 16); + odm_write_1byte(dm, 0x81, 0x80); /*RPTBUF ready*/ - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%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)); + PHYDM_DBG(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 } - } - -void -hal_txbf_8822b_leave( - void *p_dm_void, - u8 idx -) +void hal_txbf_8822b_leave( + void *dm_void, + u8 idx) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_BEAMFORMING_INFO *p_beamforming_info = &p_dm_odm->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}; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _RT_BEAMFORMING_INFO *beamforming_info = &dm->beamforming_info; + struct _RT_BEAMFORMER_ENTRY *beamformer_entry; + struct _RT_BEAMFORMEE_ENTRY *p_beamformee_entry; + u32 mu_reg[6] = {0x1684, 0x1686, 0x1688, 0x168a, 0x168c, 0x168e}; if (idx < BEAMFORMER_ENTRY_NUM) { - p_beamformer_entry = &p_beamforming_info->beamformer_entry[idx]; - p_beamformee_entry = &p_beamforming_info->beamformee_entry[idx]; + beamformer_entry = &beamforming_info->beamformer_entry[idx]; + p_beamformee_entry = &beamforming_info->beamformee_entry[idx]; } else return; - /*Clear P_AID of Beamformee*/ - /*Clear MAC address of Beamformer*/ - /*Clear Associated Bfmee Sel*/ + /*@Clear P_AID of Beamformee*/ + /*@Clear MAC address of Beamformer*/ + /*@Clear Associated Bfmee Sel*/ - if (p_beamformer_entry->beamform_entry_cap == BEAMFORMING_CAP_NONE) { - odm_write_1byte(p_dm_odm, 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_odm, REG_ASSOCIATED_BFMER0_INFO_8822B, 0); - odm_write_2byte(p_dm_odm, REG_ASSOCIATED_BFMER0_INFO_8822B + 4, 0); - odm_write_2byte(p_dm_odm, REG_TX_CSI_RPT_PARAM_BW20_8822B, 0); + if (beamformer_entry->beamform_entry_cap == BEAMFORMING_CAP_NONE) { + odm_write_1byte(dm, REG_SND_PTCL_CTRL_8822B, 0xD8); + if (beamformer_entry->is_mu_ap == 0) { /*SU BFer */ + if (beamformer_entry->su_reg_index == 0) { + odm_write_4byte(dm, REG_ASSOCIATED_BFMER0_INFO_8822B, 0); + odm_write_2byte(dm, REG_ASSOCIATED_BFMER0_INFO_8822B + 4, 0); + odm_write_2byte(dm, REG_TX_CSI_RPT_PARAM_BW20_8822B, 0); } else { - odm_write_4byte(p_dm_odm, REG_ASSOCIATED_BFMER1_INFO_8822B, 0); - odm_write_2byte(p_dm_odm, REG_ASSOCIATED_BFMER1_INFO_8822B + 4, 0); - odm_write_2byte(p_dm_odm, REG_TX_CSI_RPT_PARAM_BW20_8822B + 2, 0); + odm_write_4byte(dm, REG_ASSOCIATED_BFMER1_INFO_8822B, 0); + odm_write_2byte(dm, REG_ASSOCIATED_BFMER1_INFO_8822B + 4, 0); + odm_write_2byte(dm, REG_TX_CSI_RPT_PARAM_BW20_8822B + 2, 0); } - p_beamforming_info->beamformer_su_reg_maping &= ~(BIT(p_beamformer_entry->su_reg_index)); - p_beamformer_entry->su_reg_index = 0xFF; - } else { /*MU BFer */ + beamforming_info->beamformer_su_reg_maping &= ~(BIT(beamformer_entry->su_reg_index)); + beamformer_entry->su_reg_index = 0xFF; + } else { /*@MU BFer */ /*set validity of MU STA0 and MU STA1*/ - p_beamforming_info->reg_mu_tx_ctrl &= 0xFFFFFFC0; - odm_write_4byte(p_dm_odm, 0x14c0, p_beamforming_info->reg_mu_tx_ctrl); + beamforming_info->reg_mu_tx_ctrl &= 0xFFFFFFC0; + odm_write_4byte(dm, 0x14c0, beamforming_info->reg_mu_tx_ctrl); - odm_memory_set(p_dm_odm, p_beamformer_entry->gid_valid, 0, 8); - odm_memory_set(p_dm_odm, p_beamformer_entry->user_position, 0, 16); - p_beamformer_entry->is_mu_ap = false; + odm_memory_set(dm, beamformer_entry->gid_valid, 0, 8); + odm_memory_set(dm, beamformer_entry->user_position, 0, 16); + beamformer_entry->is_mu_ap = false; } } if (p_beamformee_entry->beamform_entry_cap == BEAMFORMING_CAP_NONE) { - hal_txbf_8822b_rf_mode(p_dm_odm, p_beamforming_info, idx); + hal_txbf_8822b_rf_mode(dm, 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_odm, REG_TXBF_CTRL_8822B, 0x0); - odm_write_1byte(p_dm_odm, REG_TXBF_CTRL_8822B + 3, odm_read_1byte(p_dm_odm, REG_TXBF_CTRL_8822B + 3) | BIT(4) | BIT(6) | BIT(7)); - odm_write_2byte(p_dm_odm, REG_ASSOCIATED_BFMEE_SEL_8822B, 0); + odm_write_2byte(dm, REG_TXBF_CTRL_8822B, 0x0); + odm_write_1byte(dm, REG_TXBF_CTRL_8822B + 3, odm_read_1byte(dm, REG_TXBF_CTRL_8822B + 3) | BIT(4) | BIT(6) | BIT(7)); + odm_write_2byte(dm, REG_ASSOCIATED_BFMEE_SEL_8822B, 0); } else { - odm_write_2byte(p_dm_odm, REG_TXBF_CTRL_8822B + 2, 0x0 | BIT(14) | BIT(15) | BIT(12)); + odm_write_2byte(dm, REG_TXBF_CTRL_8822B + 2, 0x0 | BIT(14) | BIT(15) | BIT(12)); - odm_write_2byte(p_dm_odm, REG_ASSOCIATED_BFMEE_SEL_8822B + 2, - odm_read_2byte(p_dm_odm, REG_ASSOCIATED_BFMEE_SEL_8822B + 2) & 0x60); + odm_write_2byte(dm, REG_ASSOCIATED_BFMEE_SEL_8822B + 2, + odm_read_2byte(dm, REG_ASSOCIATED_BFMEE_SEL_8822B + 2) & 0x60); } - p_beamforming_info->beamformee_su_reg_maping &= ~(BIT(p_beamformee_entry->su_reg_index)); + 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_write_2byte(p_dm_odm, mu_reg[p_beamformee_entry->mu_reg_index], 0); + } else { /*@MU BFee */ + /*@Disable sending NDPA & BF-rpt-poll to this BFee*/ + odm_write_2byte(dm, mu_reg[p_beamformee_entry->mu_reg_index], 0); /*set validity of MU STA*/ - p_beamforming_info->reg_mu_tx_ctrl &= ~(BIT(p_beamformee_entry->mu_reg_index)); - odm_write_4byte(p_dm_odm, 0x14c0, p_beamforming_info->reg_mu_tx_ctrl); - + beamforming_info->reg_mu_tx_ctrl &= ~(BIT(p_beamformee_entry->mu_reg_index)); + odm_write_4byte(dm, 0x14c0, beamforming_info->reg_mu_tx_ctrl); p_beamformee_entry->is_mu_sta = false; - p_beamforming_info->beamformee_mu_reg_maping &= ~(BIT(p_beamformee_entry->mu_reg_index)); + 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 -hal_txbf_8822b_status( - void *p_dm_void, - u8 beamform_idx -) +void hal_txbf_8822b_status( + void *dm_void, + u8 beamform_idx) { - struct PHY_DM_STRUCT *p_dm_odm = (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_odm->beamforming_info; - struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry; - bool is_mu_sounding = p_beamforming_info->is_mu_sounding, is_bitmap_ready = false; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u16 beam_ctrl_val, tmp_val; + u32 beam_ctrl_reg; + struct _RT_BEAMFORMING_INFO *beamforming_info = &dm->beamforming_info; + struct _RT_BEAMFORMEE_ENTRY *beamform_entry; + boolean is_mu_sounding = 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; - bool is_sounding_success[6] = {false}; + boolean is_sounding_success[6] = {false}; if (beamform_idx < BEAMFORMEE_ENTRY_NUM) - p_beamform_entry = &p_beamforming_info->beamformee_entry[beamform_idx]; + beamform_entry = &beamforming_info->beamformee_entry[beamform_idx]; else return; /*SU sounding done */ if (is_mu_sounding == false) { - - if (phydm_acting_determine(p_dm_odm, phydm_acting_as_ibss)) - beam_ctrl_val = p_beamform_entry->mac_id; + if (phydm_acting_determine(dm, phydm_acting_as_ibss)) + beam_ctrl_val = beamform_entry->mac_id; else - beam_ctrl_val = p_beamform_entry->p_aid; + beam_ctrl_val = beamform_entry->p_aid; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, beamform_entry.beamform_entry_state = %d", __func__, p_beamform_entry->beamform_entry_state)); + PHYDM_DBG(dm, DBG_TXBF, + "@%s, beamform_entry.beamform_entry_state = %d", + __func__, beamform_entry->beamform_entry_state); - if (p_beamform_entry->su_reg_index == 0) + if (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 (p_beamform_entry->beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED) { - if (p_beamform_entry->sound_bw == CHANNEL_WIDTH_20) + if (beamform_entry->beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED) { + if (beamform_entry->sound_bw == CHANNEL_WIDTH_20) beam_ctrl_val |= BIT(9); - else if (p_beamform_entry->sound_bw == CHANNEL_WIDTH_40) + else if (beamform_entry->sound_bw == CHANNEL_WIDTH_40) beam_ctrl_val |= (BIT(9) | BIT(10)); - else if (p_beamform_entry->sound_bw == CHANNEL_WIDTH_80) + else if (beamform_entry->sound_bw == CHANNEL_WIDTH_80) beam_ctrl_val |= (BIT(9) | BIT(10) | BIT(11)); } else { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, Don't apply Vmatrix", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "@%s, Don't apply Vmatrix", + __func__); beam_ctrl_val &= ~(BIT(9) | BIT(10) | BIT(11)); } - odm_write_2byte(p_dm_odm, beam_ctrl_reg, beam_ctrl_val); - /*disable NDP packet use beamforming */ - tmp_val = odm_read_2byte(p_dm_odm, REG_TXBF_CTRL_8822B); - odm_write_2byte(p_dm_odm, REG_TXBF_CTRL_8822B, tmp_val | BIT(15)); + odm_write_2byte(dm, beam_ctrl_reg, beam_ctrl_val); + /*@disable NDP packet use beamforming */ + tmp_val = odm_read_2byte(dm, REG_TXBF_CTRL_8822B); + odm_write_2byte(dm, REG_TXBF_CTRL_8822B, tmp_val | BIT(15)); } else { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, MU Sounding Done\n", __func__)); - /*MU sounding done */ - if (1) { /* (p_beamform_entry->beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED) { */ - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, BEAMFORMING_ENTRY_STATE_PROGRESSED\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "@%s, MU Sounding Done\n", __func__); + /*@MU sounding done */ + if (1) { /* @(beamform_entry->beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED) { */ + PHYDM_DBG(dm, DBG_TXBF, + "@%s, BEAMFORMING_ENTRY_STATE_PROGRESSED\n", + __func__); - value32 = odm_get_bb_reg(p_dm_odm, 0x1684, MASKDWORD); + value32 = odm_get_bb_reg(dm, R_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_odm, 0x1688, MASKDWORD); + value32 = odm_get_bb_reg(dm, R_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_odm, 0x168C, MASKDWORD); + value32 = odm_get_bb_reg(dm, R_0x168c, MASKDWORD); is_sounding_success[4] = (value32 & BIT(10)) ? 1 : 0; is_sounding_success[5] = (value32 & BIT(26)) ? 1 : 0; - ODM_RT_TRACE(p_dm_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])); + PHYDM_DBG(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_odm, 0xF4C, 0xFFFF0000); - /* odm_set_bb_reg(p_dm_odm, 0x19E0, MASKHWORD, 0xFFFF);Let MAC ignore bitmap */ + value32 = odm_get_bb_reg(dm, R_0xf4c, 0xFFFF0000); + /* odm_set_bb_reg(dm, R_0x19e0, MASKHWORD, 0xFFFF);Let MAC ignore bitmap */ - is_bitmap_ready = (bool)((value32 & BIT(15)) >> 15); + is_bitmap_ready = (boolean)((value32 & BIT(15)) >> 15); bitmap = (u16)(value32 & 0x3FFF); for (idx = 0; idx < 15; idx++) { - if (idx < 5) {/*bit0~4*/ + if (idx < 5) { /*@bit0~4*/ id0 = 0; id1 = (u8)(idx + 1); - } else if (idx < 9) { /*bit5~8*/ + } else if (idx < 9) { /*@bit5~8*/ id0 = 1; id1 = (u8)(idx - 3); - } else if (idx < 12) { /*bit9~11*/ + } 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*/ + } else { /*@bit14*/ id0 = 4; id1 = (u8)(idx - 9); } @@ -826,108 +833,105 @@ hal_txbf_8822b_status( } for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { - 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]; + beamform_entry = &beamforming_info->beamformee_entry[i]; + if (beamform_entry->is_mu_sta && beamform_entry->mu_reg_index < 6) { + value32 = gid_valid[beamform_entry->mu_reg_index]; for (idx = 0; idx < 4; idx++) { - p_beamform_entry->gid_valid[idx] = (u8)(value32 & 0xFF); + beamform_entry->gid_valid[idx] = (u8)(value32 & 0xFF); value32 = (value32 >> 8); } } } for (idx = 0; idx < 6; idx++) { - 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_odm, 0x14c0, p_beamforming_info->reg_mu_tx_ctrl); - odm_set_mac_reg(p_dm_odm, 0x14C4, MASKDWORD, gid_valid[idx]); /*set MU STA gid valid table*/ + beamforming_info->reg_mu_tx_ctrl &= ~(BIT(8) | BIT(9) | BIT(10)); + beamforming_info->reg_mu_tx_ctrl |= ((idx << 8) & (BIT(8) | BIT(9) | BIT(10))); + odm_write_4byte(dm, 0x14c0, beamforming_info->reg_mu_tx_ctrl); + odm_set_mac_reg(dm, R_0x14c4, MASKDWORD, gid_valid[idx]); /*set MU STA gid valid table*/ } - /*Enable TxMU PPDU*/ - if (p_beamforming_info->dbg_disable_mu_tx == false) - p_beamforming_info->reg_mu_tx_ctrl |= BIT(7); + /*@Enable TxMU PPDU*/ + if (beamforming_info->dbg_disable_mu_tx == false) + beamforming_info->reg_mu_tx_ctrl |= BIT(7); else - p_beamforming_info->reg_mu_tx_ctrl &= ~BIT(7); - odm_write_4byte(p_dm_odm, 0x14c0, p_beamforming_info->reg_mu_tx_ctrl); + beamforming_info->reg_mu_tx_ctrl &= ~BIT(7); + odm_write_4byte(dm, 0x14c0, beamforming_info->reg_mu_tx_ctrl); } } } /*Only used for MU BFer Entry when get GID management frame (self is as MU STA)*/ -void -hal_txbf_8822b_config_gtab( - void *p_dm_void -) +void hal_txbf_8822b_config_gtab( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_BEAMFORMING_INFO *p_beamforming_info = &p_dm_odm->beamforming_info; - struct _RT_BEAMFORMER_ENTRY *p_beamformer_entry = NULL; - u32 gid_valid = 0, user_position_l = 0, user_position_h = 0, i; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _RT_BEAMFORMING_INFO *beamforming_info = &dm->beamforming_info; + struct _RT_BEAMFORMER_ENTRY *beamformer_entry = NULL; + u32 gid_valid = 0, user_position_l = 0, user_position_h = 0, i; - if (p_beamforming_info->mu_ap_index < BEAMFORMER_ENTRY_NUM) - p_beamformer_entry = &p_beamforming_info->beamformer_entry[p_beamforming_info->mu_ap_index]; + if (beamforming_info->mu_ap_index < BEAMFORMER_ENTRY_NUM) + beamformer_entry = &beamforming_info->beamformer_entry[beamforming_info->mu_ap_index]; else return; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s==>\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "%s==>\n", __func__); - /*For GID 0~31*/ + /*@For GID 0~31*/ for (i = 0; i < 4; i++) - gid_valid |= (p_beamformer_entry->gid_valid[i] << (i << 3)); + gid_valid |= (beamformer_entry->gid_valid[i] << (i << 3)); for (i = 0; i < 8; i++) { if (i < 4) - user_position_l |= (p_beamformer_entry->user_position[i] << (i << 3)); + user_position_l |= (beamformer_entry->user_position[i] << (i << 3)); else - user_position_h |= (p_beamformer_entry->user_position[i] << ((i - 4) << 3)); + user_position_h |= (beamformer_entry->user_position[i] << ((i - 4) << 3)); } /*select MU STA0 table*/ - p_beamforming_info->reg_mu_tx_ctrl &= ~(BIT(8) | BIT(9) | BIT(10)); - odm_write_4byte(p_dm_odm, 0x14c0, p_beamforming_info->reg_mu_tx_ctrl); - odm_set_bb_reg(p_dm_odm, 0x14c4, MASKDWORD, gid_valid); - odm_set_bb_reg(p_dm_odm, 0x14c8, MASKDWORD, user_position_l); - odm_set_bb_reg(p_dm_odm, 0x14cc, MASKDWORD, user_position_h); + beamforming_info->reg_mu_tx_ctrl &= ~(BIT(8) | BIT(9) | BIT(10)); + odm_write_4byte(dm, 0x14c0, beamforming_info->reg_mu_tx_ctrl); + odm_set_bb_reg(dm, R_0x14c4, MASKDWORD, gid_valid); + odm_set_bb_reg(dm, R_0x14c8, MASKDWORD, user_position_l); + odm_set_bb_reg(dm, R_0x14cc, MASKDWORD, user_position_h); - ODM_RT_TRACE(p_dm_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(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; user_position_h = 0; - /*For GID 32~64*/ + /*@For GID 32~64*/ for (i = 4; i < 8; i++) - gid_valid |= (p_beamformer_entry->gid_valid[i] << ((i - 4) << 3)); + gid_valid |= (beamformer_entry->gid_valid[i] << ((i - 4) << 3)); for (i = 8; i < 16; i++) { if (i < 4) - user_position_l |= (p_beamformer_entry->user_position[i] << ((i - 8) << 3)); + user_position_l |= (beamformer_entry->user_position[i] << ((i - 8) << 3)); else - user_position_h |= (p_beamformer_entry->user_position[i] << ((i - 12) << 3)); + user_position_h |= (beamformer_entry->user_position[i] << ((i - 12) << 3)); } /*select MU STA1 table*/ - 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_odm, 0x14c0, p_beamforming_info->reg_mu_tx_ctrl); - odm_set_bb_reg(p_dm_odm, 0x14c4, MASKDWORD, gid_valid); - odm_set_bb_reg(p_dm_odm, 0x14c8, MASKDWORD, user_position_l); - odm_set_bb_reg(p_dm_odm, 0x14cc, MASKDWORD, user_position_h); + beamforming_info->reg_mu_tx_ctrl &= ~(BIT(8) | BIT(9) | BIT(10)); + beamforming_info->reg_mu_tx_ctrl |= BIT(8); + odm_write_4byte(dm, 0x14c0, beamforming_info->reg_mu_tx_ctrl); + odm_set_bb_reg(dm, R_0x14c4, MASKDWORD, gid_valid); + odm_set_bb_reg(dm, R_0x14c8, MASKDWORD, user_position_l); + odm_set_bb_reg(dm, R_0x14cc, MASKDWORD, user_position_h); - ODM_RT_TRACE(p_dm_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(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*/ - p_beamforming_info->reg_mu_tx_ctrl &= 0xFFFFFFC0; - p_beamforming_info->reg_mu_tx_ctrl |= 0x3; /* STA0, STA1*/ - odm_write_4byte(p_dm_odm, 0x14c0, p_beamforming_info->reg_mu_tx_ctrl); - + beamforming_info->reg_mu_tx_ctrl &= 0xFFFFFFC0; + beamforming_info->reg_mu_tx_ctrl |= 0x3; /* STA0, STA1*/ + odm_write_4byte(dm, 0x14c0, beamforming_info->reg_mu_tx_ctrl); } - - #if 0 /*This function translate the bitmap to GTAB*/ void haltxbf8822b_gtab_translation( - struct PHY_DM_STRUCT *p_dm_odm + struct dm_struct *dm ) { u8 idx, gid; @@ -937,19 +941,19 @@ haltxbf8822b_gtab_translation( u32 user_position_msb[6] = {0}; for (idx = 0; idx < 15; idx++) { - if (idx < 5) {/*bit0~4*/ + if (idx < 5) {/*@bit0~4*/ id0 = 0; id1 = (u8)(idx + 1); - } else if (idx < 9) { /*bit5~8*/ + } else if (idx < 9) { /*@bit5~8*/ id0 = 1; id1 = (u8)(idx - 3); - } else if (idx < 12) { /*bit9~11*/ + } 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*/ + } else { /*@bit14*/ id0 = 4; id1 = (u8)(idx - 9); } @@ -977,26 +981,23 @@ haltxbf8822b_gtab_translation( user_position_msb[id0] |= (1 << ((gid - 16) << 1)); /*user_position_msb[id1] |= (0 << ((gid - 16) << 1));*/ } - } for (idx = 0; idx < 6; idx++) { - /*dbg_print("gid_valid[%d] = 0x%x\n", idx, gid_valid[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 -hal_txbf_8822b_fw_txbf( - void *p_dm_void, - u8 idx -) +void hal_txbf_8822b_fw_txbf( + void *dm_void, + u8 idx) { #if 0 - struct _RT_BEAMFORMING_INFO *p_beam_info = GET_BEAMFORM_INFO(adapter); - struct _RT_BEAMFORMEE_ENTRY *p_beam_entry = p_beam_info->beamformee_entry + idx; + struct _RT_BEAMFORMING_INFO *beam_info = GET_BEAMFORM_INFO(adapter); + struct _RT_BEAMFORMEE_ENTRY *p_beam_entry = beam_info->beamformee_entry + idx; if (p_beam_entry->beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSING) hal_txbf_8822b_download_ndpa(adapter, idx); @@ -1009,92 +1010,79 @@ hal_txbf_8822b_fw_txbf( #if (defined(CONFIG_BB_TXBF_API)) /*this function is only used for BFer*/ -void -phydm_8822btxbf_rfmode( - void *p_dm_void, - u8 su_bfee_cnt, - u8 mu_bfee_cnt -) +void phydm_8822btxbf_rfmode(void *dm_void, u8 su_bfee_cnt, u8 mu_bfee_cnt) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 i, nr_index = 0; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 i; - if (p_dm_odm->rf_type == ODM_1T1R) + if (dm->rf_type == RF_1T1R) return; - if ((su_bfee_cnt > 0) || (mu_bfee_cnt > 0)) { - for (i = ODM_RF_PATH_A; i <= ODM_RF_PATH_B; i++) { - odm_set_rf_reg(p_dm_odm, (enum odm_rf_radio_path_e)i, 0xEF, BIT(19), 0x1); /*RF mode table write enable*/ - odm_set_rf_reg(p_dm_odm, (enum odm_rf_radio_path_e)i, 0x33, 0xF, 3); /*Select RX mode*/ - odm_set_rf_reg(p_dm_odm, (enum odm_rf_radio_path_e)i, 0x3E, 0xfffff, 0x00036); /*Set Table data*/ - odm_set_rf_reg(p_dm_odm, (enum odm_rf_radio_path_e)i, 0x3F, 0xfffff, 0x5AFCE); /*Set Table data*/ - odm_set_rf_reg(p_dm_odm, (enum odm_rf_radio_path_e)i, 0xEF, BIT(19), 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(dm, (enum rf_path)i, RF_0xef, BIT(19), 0x1); /*RF mode table write enable*/ + odm_set_rf_reg(dm, (enum rf_path)i, RF_0x33, 0xF, 3); /*Select RX mode*/ + odm_set_rf_reg(dm, (enum rf_path)i, RF_0x3e, 0xfffff, 0x00036); /*Set Table data*/ + odm_set_rf_reg(dm, (enum rf_path)i, RF_0x3f, 0xfffff, 0x5AFCE); /*Set Table data*/ + odm_set_rf_reg(dm, (enum rf_path)i, RF_0xef, BIT(19), 0x0); /*RF mode table write disable*/ } } - odm_set_bb_reg(p_dm_odm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT(30), 1); /*if Nsts > Nc, don't apply V matrix*/ + odm_set_bb_reg(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_set_bb_reg(p_dm_odm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT(28) | BIT29, 0x2); /*enable BB TxBF ant mapping register*/ - odm_set_bb_reg(p_dm_odm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT(31), 1); /*ignore user since 8822B only 2Tx*/ + /*@for 8814 19ac(idx 1), 19b4(idx 0), different Tx ant setting*/ + odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT(28) | BIT29, 0x2); /*@enable BB TxBF ant mapping register*/ + odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT(31), 1); /*@ignore user since 8822B only 2Tx*/ /*Nsts = 2 AB*/ - odm_set_bb_reg(p_dm_odm, REG_BB_TXBF_ANT_SET_BF1_8822B, 0xffff, 0x0433); - odm_set_bb_reg(p_dm_odm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x043); + odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF1_8822B, 0xffff, 0x0433); + odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x043); } else { - odm_set_bb_reg(p_dm_odm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT(28) | BIT29, 0x0); /*enable BB TxBF ant mapping register*/ - odm_set_bb_reg(p_dm_odm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT(31), 0); /*ignore user since 8822B only 2Tx*/ + odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT(28) | BIT29, 0x0); /*@enable BB TxBF ant mapping register*/ + odm_set_bb_reg(dm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT(31), 0); /*@ignore user since 8822B only 2Tx*/ - odm_set_bb_reg(p_dm_odm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x1); /*1SS by path-A*/ - odm_set_bb_reg(p_dm_odm, REG_BB_TX_PATH_SEL_2_8822B, MASKLWORD, 0x430); /*2SS by path-A,B*/ + odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x1); /*@1SS by path-A*/ + odm_set_bb_reg(dm, REG_BB_TX_PATH_SEL_2_8822B, MASKLWORD, 0x430); /*@2SS by path-A,B*/ } - } - /*this function is for BFer bug workaround*/ -void -phydm_8822b_sutxbfer_workaroud( - void *p_dm_void, - bool enable_su_bfer, - u8 nc, - u8 nr, - u8 ng, - u8 CB, - u8 BW, - bool is_vht -) +void phydm_8822b_sutxbfer_workaroud(void *dm_void, boolean enable_su_bfer, + u8 nc, u8 nr, u8 ng, u8 CB, u8 BW, + boolean is_vht) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; if (enable_su_bfer) { - odm_set_bb_reg(p_dm_odm, 0x19f8, BIT(22) | BIT(21) | BIT(20), 0x1); - odm_set_bb_reg(p_dm_odm, 0x19f8, BIT(25) | BIT(24) | BIT(23), 0x0); - odm_set_bb_reg(p_dm_odm, 0x19f8, BIT(16), 0x1); + odm_set_bb_reg(dm, R_0x19f8, BIT(22) | BIT(21) | BIT(20), 0x1); + odm_set_bb_reg(dm, R_0x19f8, BIT(25) | BIT(24) | BIT(23), 0x0); + odm_set_bb_reg(dm, R_0x19f8, BIT(16), 0x1); if (is_vht) - odm_set_bb_reg(p_dm_odm, 0x19f0, BIT(5) | BIT(4) | BIT(3) | BIT(2) | BIT(1) | BIT(0), 0x1f); + odm_set_bb_reg(dm, R_0x19f0, BIT(5) | BIT(4) | BIT(3) | BIT(2) | BIT(1) | BIT(0), 0x1f); else - odm_set_bb_reg(p_dm_odm, 0x19f0, BIT(5) | BIT(4) | BIT(3) | BIT(2) | BIT(1) | BIT(0), 0x22); + odm_set_bb_reg(dm, R_0x19f0, BIT(5) | BIT(4) | BIT(3) | BIT(2) | BIT(1) | BIT(0), 0x22); - odm_set_bb_reg(p_dm_odm, 0x19f0, BIT(7) | BIT(6), nc); - odm_set_bb_reg(p_dm_odm, 0x19f0, BIT(9) | BIT(8), nr); - odm_set_bb_reg(p_dm_odm, 0x19f0, BIT(11) | BIT(10), ng); - odm_set_bb_reg(p_dm_odm, 0x19f0, BIT(13) | BIT(12), CB); - - odm_set_bb_reg(p_dm_odm, 0xb58, BIT(3) | BIT(2), BW); - odm_set_bb_reg(p_dm_odm, 0xb58, BIT(7) | BIT(6) | BIT(5) | BIT(4), 0x0); - odm_set_bb_reg(p_dm_odm, 0xb58, BIT(9) | BIT(8), BW); - odm_set_bb_reg(p_dm_odm, 0xb58, BIT(13) | BIT(12) | BIT(11) | BIT(10), 0x0); - } else - odm_set_bb_reg(p_dm_odm, 0x19f8, BIT(16), 0x0); - - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_TRACE, ("[%s] enable_su_bfer = %d, is_vht = %d\n", __func__, enable_su_bfer, is_vht)); - ODM_RT_TRACE(p_dm_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)); + odm_set_bb_reg(dm, R_0x19f0, BIT(7) | BIT(6), nc); + odm_set_bb_reg(dm, R_0x19f0, BIT(9) | BIT(8), nr); + odm_set_bb_reg(dm, R_0x19f0, BIT(11) | BIT(10), ng); + odm_set_bb_reg(dm, R_0x19f0, BIT(13) | BIT(12), CB); + odm_set_bb_reg(dm, R_0xb58, BIT(3) | BIT(2), BW); + odm_set_bb_reg(dm, R_0xb58, BIT(7) | BIT(6) | BIT(5) | BIT(4), 0x0); + odm_set_bb_reg(dm, R_0xb58, BIT(9) | BIT(8), BW); + odm_set_bb_reg(dm, R_0xb58, BIT(13) | BIT(12) | BIT(11) | BIT(10), 0x0); + } else { + odm_set_bb_reg(dm, R_0x19f8, BIT(16), 0x0); + } + PHYDM_DBG(dm, DBG_TXBF, "[%s] enable_su_bfer = %d, is_vht = %d\n", + __func__, enable_su_bfer, is_vht); + PHYDM_DBG(dm, DBG_TXBF, + "[%s] nc = %d, nr = %d, ng = %d, CB = %d, BW = %d\n", + __func__, nc, nr, ng, CB, BW); } #endif -#endif /* (RTL8822B_SUPPORT == 1)*/ +#endif /* @(RTL8822B_SUPPORT == 1)*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbf8822b.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbf8822b.h index df7881f4cc0f..e331ed8f7388 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbf8822b.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbf8822b.h @@ -1,80 +1,79 @@ /* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ #ifndef __HAL_TXBF_8822B_H__ #define __HAL_TXBF_8822B_H__ #if (RTL8822B_SUPPORT == 1) -#if (BEAMFORMING_SUPPORT == 1) +#ifdef PHYDM_BEAMFORMING_SUPPORT -void -hal_txbf_8822b_enter( - void *p_dm_void, - u8 idx -); +void hal_txbf_8822b_enter( + void *dm_void, + u8 idx); +void hal_txbf_8822b_leave( + void *dm_void, + u8 idx); -void -hal_txbf_8822b_leave( - void *p_dm_void, - u8 idx -); +void hal_txbf_8822b_status( + void *dm_void, + u8 beamform_idx); +void hal_txbf_8822b_config_gtab( + void *dm_void); -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 -); +void hal_txbf_8822b_fw_txbf( + void *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) +#define hal_txbf_8822b_enter(dm_void, idx) +#define hal_txbf_8822b_leave(dm_void, idx) +#define hal_txbf_8822b_status(dm_void, idx) +#define hal_txbf_8822b_fw_txbf(dm_void, idx) +#define hal_txbf_8822b_config_gtab(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_8822btxbf_rfmode(void *dm_void, u8 su_bfee_cnt, u8 mu_bfee_cnt); -void -phydm_8822b_sutxbfer_workaroud( - void *p_dm_void, - bool enable_su_bfer, - u8 nc, - u8 nr, - u8 ng, - u8 CB, - u8 BW, - bool is_vht -); +void phydm_8822b_sutxbfer_workaroud(void *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) +#define phydm_8822btxbf_rfmode(dm_void, su_bfee_cnt, mu_bfee_cnt) +#define phydm_8822b_sutxbfer_workaroud(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) +#define hal_txbf_8822b_enter(dm_void, idx) +#define hal_txbf_8822b_leave(dm_void, idx) +#define hal_txbf_8822b_status(dm_void, idx) +#define hal_txbf_8822b_fw_txbf(dm_void, idx) +#define hal_txbf_8822b_config_gtab(dm_void) #endif #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbfinterface.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbfinterface.c index 32f04fc221ec..482265408746 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbfinterface.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbfinterface.c @@ -1,147 +1,161 @@ /* SPDX-License-Identifier: GPL-2.0 */ -/* ************************************************************ +/****************************************************************************** + * + * 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) +#ifdef PHYDM_BEAMFORMING_SUPPORT #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -void -beamforming_gid_paid( - struct _ADAPTER *adapter, - PRT_TCB p_tcb -) +void beamforming_gid_paid( + void *adapter, + PRT_TCB tcb) { - u8 idx = 0; - 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_odm = &p_hal_data->DM_OutSrc; - struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm_odm->beamforming_info); + u8 RA[6] = {0}; + u8 *p_header = GET_FRAME_OF_FIRST_FRAG(adapter, tcb); + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + struct dm_struct *dm = &hal_data->DM_OutSrc; + struct _RT_BEAMFORMING_INFO *beam_info = &(dm->beamforming_info); - if (adapter->HardwareType < HARDWARE_TYPE_RTL8192EE) + if (((PADAPTER)adapter)->HardwareType < HARDWARE_TYPE_RTL8192EE) return; - else if (IS_WIRELESS_MODE_N(adapter) == false) + else if (IS_WIRELESS_MODE_N((PADAPTER)adapter) == false) return; #if (SUPPORT_MU_BF == 1) - if (p_tcb->tx_bf_pkt_type == RT_BF_PKT_TYPE_BROADCAST_NDPA) { /* MU NDPA */ + if (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)); + /* @Fill G_ID and P_AID */ + tcb->G_ID = 63; + if (beam_info->first_mu_bfee_index < BEAMFORMEE_ENTRY_NUM) { + tcb->P_AID = beam_info->beamformee_entry[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__, tcb->G_ID, 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; + if (MacAddr_isBcst(RA) || MacAddr_isMulticast(RA) || tcb->macId == MAC_ID_STATIC_FOR_BROADCAST_MULTICAST) { + tcb->G_ID = 63; + tcb->P_AID = 0; } else if (ACTING_AS_AP(adapter)) { - u16 AID = (u16)(MacIdGetOwnerAssociatedClientAID(adapter, p_tcb->macId) & 0x1ff); /*AID[0:8]*/ + u16 AID = (u16)(MacIdGetOwnerAssociatedClientAID(adapter, 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; + /*RT_DISP(FBEAM, FBEAM_FUN, ("@%s tcb->mac_id=0x%X, AID=0x%X\n", __func__, tcb->mac_id, AID));*/ + 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; + if (AID == 0) /*@A PPDU sent by an AP to a non associated STA*/ + 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*/ + BSSID = ((RA[5] & 0xf0) >> 4) ^ (RA[5] & 0xf); /*@BSSID[44:47] xor BSSID[40:43]*/ + 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; + } else if (ACTING_AS_IBSS(((PADAPTER)adapter))) { + 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; + tcb->P_AID = tcb->macId; + } else if (MgntLinkStatusQuery(adapter)) { /*@Addressed to AP*/ + 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); + tcb->P_AID = RA[5]; /*RA[39:47]*/ + tcb->P_AID = (tcb->P_AID << 1) | (RA[4] >> 7); } else { - p_tcb->G_ID = 63; - p_tcb->P_AID = 0; + tcb->G_ID = 63; + 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));*/ + /*RT_DISP(FBEAM, FBEAM_FUN, ("[David]@%s End, G_ID=0x%X, P_AID=0x%X\n", __func__, tcb->G_ID, tcb->P_AID));*/ } } - enum rt_status beamforming_get_report_frame( - struct _ADAPTER *adapter, - PRT_RFD p_rfd, - POCTET_STRING p_pdu_os -) + void *adapter, + PRT_RFD rfd, + POCTET_STRING p_pdu_os) { - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); - struct PHY_DM_STRUCT *p_dm_odm = &p_hal_data->DM_OutSrc; - struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = NULL; - u8 *p_mimo_ctrl_field, p_csi_report, p_csi_matrix; - u8 idx, nc, nr, CH_W; - u16 csi_matrix_len = 0; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA((PADAPTER)adapter); + struct dm_struct *dm = &hal_data->DM_OutSrc; + struct _RT_BEAMFORMEE_ENTRY *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; + 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_odm, Frame_Addr2(*p_pdu_os), &idx); + /* @Memory comparison to see if CSI report is the same with previous one */ + beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(dm, Frame_Addr2(*p_pdu_os), &idx); - if (p_beamform_entry == NULL) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("beamforming_get_report_frame: Cannot find entry by addr\n")); + if (beamform_entry == NULL) { + PHYDM_DBG(dm, DBG_TXBF, "%s: Cannot find entry by addr\n", + __func__); return RT_STATUS_FAILURE; } pkt_type = PacketGetActionFrameType(p_pdu_os); - /* -@ Modified by David */ + /* @-@ 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; + 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; + /*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; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] idx=%d, pkt type=%d, nc=%d, nr=%d, CH_W=%d\n", __func__, idx, pkt_type, nc, nr, CH_W)); + PHYDM_DBG(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, - CHANNEL_WIDTH BW -) +void construct_ht_ndpa_packet( + // 2017/11 MH PHYDM compile. But why need to use windows maco? + // For all linux code, it should be useless? + //void *adapter = dm->adapter; + ADAPTER * adapter, + //void *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}; + u16 duration = 0; + PMGNT_INFO mgnt_info = &(((PADAPTER)adapter)->MgntInfo); + //PMGNT_INFO mgnt_info = &((MGNT_INFO)(((PADAPTER)adapter)->MgntInfo)); + OCTET_STRING p_ndpa_frame, action_content; + u8 action_hdr[4] = {ACT_CAT_VENDOR, 0x00, 0xe0, 0x4c}; PlatformZeroMemory(buffer, 32); @@ -151,8 +165,8 @@ construct_ht_ndpa_packet( 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); + SET_80211_HDR_ADDRESS2(buffer, ((PADAPTER)adapter)->CurrentAddress); + SET_80211_HDR_ADDRESS3(buffer, ((PMGNT_INFO)mgnt_info)->Bssid); duration = 2 * a_SifsTime + 40; @@ -163,7 +177,7 @@ construct_ht_ndpa_packet( SET_80211_HDR_DURATION(buffer, duration); - /* HT control field */ + /* @HT control field */ SET_HT_CTRL_CSI_STEERING(buffer + sMacHdrLng, 3); SET_HT_CTRL_NDP_ANNOUNCEMENT(buffer + sMacHdrLng, 1); @@ -175,41 +189,37 @@ construct_ht_ndpa_packet( *p_length = 32; } - - - -bool +boolean send_fw_ht_ndpa_packet( - void *p_dm_void, - u8 *RA, - CHANNEL_WIDTH BW -) + void *dm_void, + u8 *RA, + enum channel_width BW) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTER *adapter = p_dm_odm->adapter; - PRT_TCB p_tcb; - PRT_TX_LOCAL_BUFFER p_buf; - bool ret = true; - u32 buf_len; - u8 *buf_addr; - u8 desc_len = 0, idx = 0, ndp_tx_rate; - struct _ADAPTER *p_def_adapter = GetDefaultAdapter(adapter); - struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm_odm->beamforming_info; - 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_odm, RA, &idx); + struct dm_struct *dm = (struct dm_struct *)dm_void; + void *adapter = dm->adapter; + PRT_TCB 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; + void *p_def_adapter = GetDefaultAdapter(((PADAPTER)adapter)); + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + struct _RT_BEAMFORMEE_ENTRY *beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(dm, RA, &idx); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); - if (p_beamform_entry == NULL) + if (beamform_entry == NULL) return false; - ndp_tx_rate = beamforming_get_htndp_tx_rate(p_dm_odm, p_beamform_entry->comp_steering_num_of_bfer); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] ndp_tx_rate =%d\n", __func__, ndp_tx_rate)); + ndp_tx_rate = beamforming_get_htndp_tx_rate(dm, beamform_entry->comp_steering_num_of_bfer); + PHYDM_DBG(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 (MgntGetFWBuffer(p_def_adapter, &tcb, &p_buf)) { #if (DEV_BUS_TYPE != RT_PCI_INTERFACE) - desc_len = adapter->HWDescHeadLength - p_hal_data->USBALLDummyLength; + desc_len = ((PADAPTER)adapter)->HWDescHeadLength - hal_data->USBALLDummyLength; #endif buf_addr = p_buf->Buffer.VirtualAddress + desc_len; @@ -218,108 +228,105 @@ send_fw_ht_ndpa_packet( RA, buf_addr, &buf_len, - BW - ); + BW); - p_tcb->PacketLength = buf_len + desc_len; + tcb->PacketLength = buf_len + desc_len; - p_tcb->bTxEnableSwCalcDur = true; + tcb->bTxEnableSwCalcDur = true; - p_tcb->BWOfPacket = BW; + tcb->BWOfPacket = BW; - if (ACTING_AS_IBSS(adapter) || ACTING_AS_AP(adapter)) - p_tcb->G_ID = 63; + if (ACTING_AS_IBSS(((PADAPTER)adapter)) || ACTING_AS_AP(((PADAPTER)adapter))) + 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*/ + tcb->P_AID = beamform_entry->p_aid; + 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); + ((PADAPTER)adapter)->HalFunc.CmdSendPacketHandler(((PADAPTER)adapter), tcb, p_buf, 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); + RT_DISP_DATA(FBEAM, FBEAM_DATA, "", p_buf->Buffer.VirtualAddress, tcb->PacketLength); return ret; } - -bool +boolean send_sw_ht_ndpa_packet( - void *p_dm_void, - u8 *RA, - CHANNEL_WIDTH BW -) + void *dm_void, + u8 *RA, + enum channel_width BW) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTER *adapter = p_dm_odm->adapter; - PRT_TCB p_tcb; - PRT_TX_LOCAL_BUFFER p_buf; - bool ret = true; - u8 idx = 0, ndp_tx_rate = 0; - struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm_odm->beamforming_info; - struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm_odm, RA, &idx); + struct dm_struct *dm = (struct dm_struct *)dm_void; + void *adapter = dm->adapter; + PRT_TCB tcb; + PRT_TX_LOCAL_BUFFER p_buf; + boolean ret = true; + u8 idx = 0, ndp_tx_rate = 0; + struct _RT_BEAMFORMEE_ENTRY *beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(dm, RA, &idx); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); - ndp_tx_rate = beamforming_get_htndp_tx_rate(p_dm_odm, p_beamform_entry->comp_steering_num_of_bfer); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] ndp_tx_rate =%d\n", __func__, ndp_tx_rate)); + ndp_tx_rate = beamforming_get_htndp_tx_rate(dm, beamform_entry->comp_steering_num_of_bfer); + PHYDM_DBG(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)) { + if (MgntGetBuffer(adapter, &tcb, &p_buf)) { construct_ht_ndpa_packet( adapter, RA, p_buf->Buffer.VirtualAddress, - &p_tcb->PacketLength, - BW - ); + &tcb->PacketLength, + BW); - p_tcb->bTxEnableSwCalcDur = true; + tcb->bTxEnableSwCalcDur = true; - p_tcb->BWOfPacket = BW; + tcb->BWOfPacket = BW; - MgntSendPacket(adapter, p_tcb, p_buf, p_tcb->PacketLength, NORMAL_QUEUE, ndp_tx_rate); + MgntSendPacket(adapter, tcb, p_buf, 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); + RT_DISP_DATA(FBEAM, FBEAM_DATA, "", p_buf->Buffer.VirtualAddress, tcb->PacketLength); return ret; } - - -void -construct_vht_ndpa_packet( - struct PHY_DM_STRUCT *p_dm_odm, - u8 *RA, - u16 AID, - u8 *buffer, - u32 *p_length, - CHANNEL_WIDTH BW -) +void construct_vht_ndpa_packet( + struct dm_struct *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_odm->adapter; - u8 idx = 0; - struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm_odm, RA, &idx); - /* Frame control. */ + u16 duration = 0; + u8 sequence = 0; + u8 *p_ndpa_frame = buffer; + struct _RT_NDPA_STA_INFO sta_info; + // 2017/11 MH PHYDM compile. But why need to use windows maco? + // For all linux code, it should be useless? + //void *adapter = dm->adapter; + ADAPTER * adapter = (PADAPTER)(dm->adapter); + u8 idx = 0; + struct _RT_BEAMFORMEE_ENTRY *beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(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); + SET_80211_HDR_ADDRESS2(p_ndpa_frame, beamform_entry->my_mac_addr); + // 2017/11 MH PHYDM compile. But why need to use windows maco? + // For all linux code, it should be useless? duration = 2 * a_SifsTime + 44; if (BW == CHANNEL_WIDTH_80) @@ -331,180 +338,174 @@ construct_vht_ndpa_packet( SET_80211_HDR_DURATION(p_ndpa_frame, duration); - sequence = *(p_dm_odm->p_sounding_seq) << 2; - odm_move_memory(p_dm_odm, p_ndpa_frame + 16, &sequence, 1); + sequence = *(dm->sounding_seq) << 2; + odm_move_memory(dm, p_ndpa_frame + 16, &sequence, 1); - if (phydm_acting_determine(p_dm_odm, phydm_acting_as_ibss) || phydm_acting_determine(p_dm_odm, phydm_acting_as_ap) == false) + if (phydm_acting_determine(dm, phydm_acting_as_ibss) || phydm_acting_determine(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_odm, p_ndpa_frame + 17, (u8 *)&sta_info, 2); + odm_move_memory(dm, p_ndpa_frame + 17, (u8 *)&sta_info, 2); *p_length = 19; } - -bool +boolean send_fw_vht_ndpa_packet( - void *p_dm_void, - u8 *RA, - u16 AID, - CHANNEL_WIDTH BW -) + void *dm_void, + u8 *RA, + u16 AID, + enum channel_width BW) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTER *adapter = p_dm_odm->adapter; - PRT_TCB p_tcb; - PRT_TX_LOCAL_BUFFER p_buf; - bool 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); - struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm_odm->beamforming_info; - 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_odm, RA, &idx); + struct dm_struct *dm = (struct dm_struct *)dm_void; + void *adapter = dm->adapter; + PRT_TCB 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; + void *p_def_adapter = GetDefaultAdapter(((PADAPTER)adapter)); + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + struct _RT_BEAMFORMEE_ENTRY *beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(dm, RA, &idx); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); - if (p_beamform_entry == NULL) + if (beamform_entry == NULL) return false; - ndp_tx_rate = beamforming_get_vht_ndp_tx_rate(p_dm_odm, p_beamform_entry->comp_steering_num_of_bfer); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] ndp_tx_rate =%d\n", __func__, ndp_tx_rate)); + ndp_tx_rate = beamforming_get_vht_ndp_tx_rate(dm, beamform_entry->comp_steering_num_of_bfer); + PHYDM_DBG(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 (MgntGetFWBuffer(p_def_adapter, &tcb, &p_buf)) { #if (DEV_BUS_TYPE != RT_PCI_INTERFACE) - desc_len = adapter->HWDescHeadLength - p_hal_data->USBALLDummyLength; + desc_len = ((PADAPTER)adapter)->HWDescHeadLength - hal_data->USBALLDummyLength; #endif buf_addr = p_buf->Buffer.VirtualAddress + desc_len; construct_vht_ndpa_packet( - p_dm_odm, + dm, RA, AID, buf_addr, &buf_len, - BW - ); + BW); - p_tcb->PacketLength = buf_len + desc_len; + tcb->PacketLength = buf_len + desc_len; - p_tcb->bTxEnableSwCalcDur = true; + tcb->bTxEnableSwCalcDur = true; - p_tcb->BWOfPacket = BW; + tcb->BWOfPacket = BW; - if (phydm_acting_determine(p_dm_odm, phydm_acting_as_ibss) || phydm_acting_determine(p_dm_odm, phydm_acting_as_ap)) - p_tcb->G_ID = 63; + if (phydm_acting_determine(dm, phydm_acting_as_ibss) || phydm_acting_determine(dm, phydm_acting_as_ap)) + tcb->G_ID = 63; - p_tcb->P_AID = p_beamform_entry->p_aid; - p_tcb->DataRate = ndp_tx_rate; /*decide by nr*/ + tcb->P_AID = beamform_entry->p_aid; + tcb->DataRate = ndp_tx_rate; /*@decide by nr*/ - adapter->HalFunc.CmdSendPacketHandler(adapter, p_tcb, p_buf, p_tcb->PacketLength, DESC_PACKET_TYPE_NORMAL, false); + ((PADAPTER)adapter)->HalFunc.CmdSendPacketHandler(adapter, tcb, p_buf, tcb->PacketLength, DESC_PACKET_TYPE_NORMAL, false); } else ret = false; PlatformReleaseSpinLock(adapter, RT_TX_SPINLOCK); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] End, ret=%d\n", __func__, ret)); + PHYDM_DBG(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); + RT_DISP_DATA(FBEAM, FBEAM_DATA, "", p_buf->Buffer.VirtualAddress, tcb->PacketLength); return ret; } - - -bool +boolean send_sw_vht_ndpa_packet( - void *p_dm_void, - u8 *RA, - u16 AID, - CHANNEL_WIDTH BW -) + void *dm_void, + u8 *RA, + u16 AID, + enum channel_width BW) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTER *adapter = p_dm_odm->adapter; - PRT_TCB p_tcb; - PRT_TX_LOCAL_BUFFER p_buf; - bool ret = true; - u8 idx = 0, ndp_tx_rate = 0; - struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm_odm->beamforming_info); - struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm_odm, RA, &idx); + struct dm_struct *dm = (struct dm_struct *)dm_void; + void *adapter = dm->adapter; + PRT_TCB tcb; + PRT_TX_LOCAL_BUFFER p_buf; + boolean ret = true; + u8 idx = 0, ndp_tx_rate = 0; + struct _RT_BEAMFORMEE_ENTRY *beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(dm, RA, &idx); - ndp_tx_rate = beamforming_get_vht_ndp_tx_rate(p_dm_odm, p_beamform_entry->comp_steering_num_of_bfer); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] ndp_tx_rate =%d\n", __func__, ndp_tx_rate)); + ndp_tx_rate = beamforming_get_vht_ndp_tx_rate(dm, beamform_entry->comp_steering_num_of_bfer); + PHYDM_DBG(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)) { + if (MgntGetBuffer(adapter, &tcb, &p_buf)) { construct_vht_ndpa_packet( - p_dm_odm, + dm, RA, AID, p_buf->Buffer.VirtualAddress, - &p_tcb->PacketLength, - BW - ); + &tcb->PacketLength, + BW); - p_tcb->bTxEnableSwCalcDur = true; - p_tcb->BWOfPacket = BW; + tcb->bTxEnableSwCalcDur = true; + tcb->BWOfPacket = BW; /*rate of NDP decide by nr*/ - MgntSendPacket(adapter, p_tcb, p_buf, p_tcb->PacketLength, NORMAL_QUEUE, ndp_tx_rate); + MgntSendPacket(adapter, tcb, p_buf, 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); + RT_DISP_DATA(FBEAM, FBEAM_DATA, "", p_buf->Buffer.VirtualAddress, 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 -) + void *adapter, + PRT_RFD rfd, + POCTET_STRING p_pdu_os) { - HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); - struct PHY_DM_STRUCT *p_dm_odm = &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_odm->beamforming_info); - struct _RT_BEAMFORMER_ENTRY *p_beamform_entry = &p_beam_info->beamformer_entry[p_beam_info->mu_ap_index]; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(((PADAPTER)adapter)); + struct dm_struct *dm = &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 *beam_info = &(dm->beamforming_info); + struct _RT_BEAMFORMER_ENTRY *beamform_entry = &beam_info->beamformer_entry[beam_info->mu_ap_index]; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] On VHT GID mgnt frame!\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "[%s] On VHT GID mgnt frame!\n", __func__); - /* Check length*/ + /* @Check length*/ if (p_pdu_os->length < (FRAME_OFFSET_VHT_GID_MGNT_USER_POSITION_ARRAY + 16)) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("beamforming_get_vht_gid_mgnt_frame(): Invalid length (%d)\n", p_pdu_os->length)); + PHYDM_DBG(dm, DBG_TXBF, "%s: Invalid length (%d)\n", __func__, + p_pdu_os->length); return RT_STATUS_INVALID_LENGTH; } - /* Check RA*/ + /* @Check RA*/ p_raddr = (u8 *)(p_pdu_os->Octet) + 4; if (!eq_mac_addr(p_raddr, adapter->CurrentAddress)) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("beamforming_get_vht_gid_mgnt_frame(): Drop because of RA error.\n")); + PHYDM_DBG(dm, DBG_TXBF, "%s: Drop because of RA error.\n", + __func__); return RT_STATUS_PKT_DROP; } @@ -514,7 +515,7 @@ beamforming_get_vht_gid_mgnt_frame( 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); + 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); @@ -523,37 +524,37 @@ beamforming_get_vht_gid_mgnt_frame( 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); + 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*/ + /* @Group ID detail printed*/ { - u8 i, j; - u8 tmp_val; - u16 tmp_val2; + 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)) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Use Group ID (%d), User Position (%d)\n", - (i * 8 + j), (tmp_val2 >> 2 * j) & 0x3)); + PHYDM_DBG(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. */ + /* @Indicate GID frame to IHV service. */ { - u8 indibuffer[24] = {0}; - u8 indioffset = 0; + u8 indibuffer[24] = {0}; + u8 indioffset = 0; - PlatformMoveMemory(indibuffer + indioffset, p_beamform_entry->gid_valid, 8); + PlatformMoveMemory(indibuffer + indioffset, beamform_entry->gid_valid, 8); indioffset += 8; - PlatformMoveMemory(indibuffer + indioffset, p_beamform_entry->user_position, 16); + PlatformMoveMemory(indibuffer + indioffset, beamform_entry->user_position, 16); indioffset += 16; PlatformIndicateCustomStatus( @@ -564,30 +565,29 @@ beamforming_get_vht_gid_mgnt_frame( indioffset); } - /* Config HW GID table */ - hal_com_txbf_config_gtab(p_dm_odm); + /* @Config HW GID table */ + hal_com_txbf_config_gtab(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_odm, - u8 *RA, - struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry, - u8 *buffer, - u32 *p_length +void construct_vht_gid_mgnt_frame( + struct dm_struct *dm, + u8 *RA, + struct _RT_BEAMFORMEE_ENTRY *beamform_entry, + u8 *buffer, + u32 *p_length -) + ) { - struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm_odm->beamforming_info); - struct _ADAPTER *adapter = p_beam_info->source_adapter; - OCTET_STRING os_ftm_frame, tmp; + struct _RT_BEAMFORMING_INFO *beam_info = &(dm->beamforming_info); + void *adapter = beam_info->source_adapter; + OCTET_STRING os_ftm_frame, tmp; FillOctetString(os_ftm_frame, buffer, 0); *p_length = 0; @@ -599,12 +599,12 @@ construct_vht_gid_mgnt_frame( ACT_VHT_GROUPID_MANAGEMENT, &os_ftm_frame); - /* Membership status array*/ - FillOctetString(tmp, p_beamform_entry->gid_valid, 8); + /* @Membership status array*/ + FillOctetString(tmp, beamform_entry->gid_valid, 8); PacketAppendData(&os_ftm_frame, tmp); /* User Position array*/ - FillOctetString(tmp, p_beamform_entry->user_position, 16); + FillOctetString(tmp, beamform_entry->user_position, 16); PacketAppendData(&os_ftm_frame, tmp); *p_length = os_ftm_frame.length; @@ -612,72 +612,67 @@ construct_vht_gid_mgnt_frame( RT_DISP_DATA(FBEAM, FBEAM_DATA, "construct_vht_gid_mgnt_frame():\n", buffer, *p_length); } -bool +boolean send_sw_vht_gid_mgnt_frame( - void *p_dm_void, - u8 *RA, - u8 idx -) + void *dm_void, + u8 *RA, + u8 idx) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - PRT_TCB p_tcb; - PRT_TX_LOCAL_BUFFER p_buf; - bool ret = true; - u8 data_rate = 0; - struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm_odm->beamforming_info); - struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = &p_beam_info->beamformee_entry[idx]; - struct _ADAPTER *adapter = p_beam_info->source_adapter; + struct dm_struct *dm = (struct dm_struct *)dm_void; + PRT_TCB tcb; + PRT_TX_LOCAL_BUFFER p_buf; + boolean ret = true; + u8 data_rate = 0; + struct _RT_BEAMFORMING_INFO *beam_info = &(dm->beamforming_info); + struct _RT_BEAMFORMEE_ENTRY *beamform_entry = &beam_info->beamformee_entry[idx]; + void *adapter = beam_info->source_adapter; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); PlatformAcquireSpinLock(adapter, RT_TX_SPINLOCK); - if (MgntGetBuffer(adapter, &p_tcb, &p_buf)) { + if (MgntGetBuffer(adapter, &tcb, &p_buf)) { construct_vht_gid_mgnt_frame( - p_dm_odm, + dm, RA, - p_beamform_entry, + beamform_entry, p_buf->Buffer.VirtualAddress, - &p_tcb->PacketLength - ); + &tcb->PacketLength); - p_tcb->bw_of_packet = CHANNEL_WIDTH_20; + tcb->bw_of_packet = CHANNEL_WIDTH_20; data_rate = MGN_6M; - MgntSendPacket(adapter, p_tcb, p_buf, p_tcb->PacketLength, NORMAL_QUEUE, data_rate); + MgntSendPacket(adapter, tcb, p_buf, 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); + RT_DISP_DATA(FBEAM, FBEAM_DATA, "", p_buf->Buffer.VirtualAddress, 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_odm, - u8 *RA, - u8 *buffer, - u32 *p_length -) +void construct_vht_bf_report_poll( + struct dm_struct *dm, + u8 *RA, + u8 *buffer, + u32 *p_length) { - struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm_odm->beamforming_info); - struct _ADAPTER *adapter = p_beam_info->source_adapter; - u8 *p_bf_rpt_poll = buffer; + struct _RT_BEAMFORMING_INFO *beam_info = &(dm->beamforming_info); + void *adapter = beam_info->source_adapter; + u8 *p_bf_rpt_poll = buffer; - /* Frame control*/ + /* @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*/ + /* @duration*/ SET_80211_HDR_DURATION(p_bf_rpt_poll, 100); /* RA*/ @@ -686,111 +681,105 @@ construct_vht_bf_report_poll( /* TA*/ SET_VHT_BF_REPORT_POLL_TA(p_bf_rpt_poll, adapter->CurrentAddress); - /* Feedback Segment Retransmission Bitmap*/ + /* @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); - } -bool +boolean send_sw_vht_bf_report_poll( - void *p_dm_void, - u8 *RA, - bool is_final_poll -) + void *dm_void, + u8 *RA, + boolean is_final_poll) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - PRT_TCB p_tcb; - PRT_TX_LOCAL_BUFFER p_buf; - bool ret = true; - u8 idx = 0, data_rate = 0; - struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm_odm->beamforming_info); - struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm_odm, RA, &idx); - struct _ADAPTER *adapter = p_beam_info->source_adapter; + struct dm_struct *dm = (struct dm_struct *)dm_void; + PRT_TCB tcb; + PRT_TX_LOCAL_BUFFER p_buf; + boolean ret = true; + u8 idx = 0, data_rate = 0; + struct _RT_BEAMFORMING_INFO *beam_info = &(dm->beamforming_info); + struct _RT_BEAMFORMEE_ENTRY *beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(dm, RA, &idx); + void *adapter = beam_info->source_adapter; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); PlatformAcquireSpinLock(adapter, RT_TX_SPINLOCK); - if (MgntGetBuffer(adapter, &p_tcb, &p_buf)) { + if (MgntGetBuffer(adapter, &tcb, &p_buf)) { construct_vht_bf_report_poll( - p_dm_odm, + dm, RA, p_buf->Buffer.VirtualAddress, - &p_tcb->PacketLength - ); + &tcb->PacketLength); - p_tcb->bTxEnableSwCalcDur = true; /* need?*/ - p_tcb->BWOfPacket = CHANNEL_WIDTH_20; + tcb->bTxEnableSwCalcDur = true; /* @ need?*/ + tcb->BWOfPacket = CHANNEL_WIDTH_20; if (is_final_poll) - p_tcb->TxBFPktType = RT_BF_PKT_TYPE_FINAL_BF_REPORT_POLL; + tcb->TxBFPktType = RT_BF_PKT_TYPE_FINAL_BF_REPORT_POLL; else - p_tcb->TxBFPktType = RT_BF_PKT_TYPE_BF_REPORT_POLL; + 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); + data_rate = MGN_6M; /* @Legacy OFDM rate*/ + MgntSendPacket(adapter, tcb, p_buf, 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); + RT_DISP_DATA(FBEAM, FBEAM_DATA, "send_sw_vht_bf_report_poll:\n", + p_buf->Buffer.VirtualAddress, 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_odm, - CHANNEL_WIDTH BW, - u8 *buffer, - u32 *p_length -) +void construct_vht_mu_ndpa_packet( + struct dm_struct *dm, + enum channel_width BW, + u8 *buffer, + u32 *p_length) { - struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm_odm->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; + struct _RT_BEAMFORMING_INFO *beam_info = &(dm->beamforming_info); + void *adapter = 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 *entry = NULL; - /* Fill the first MU BFee entry (STA1) MAC addr to destination address then + /* @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); + entry = &(beam_info->beamformee_entry[idx]); + if (entry->is_mu_sta) { + cp_mac_addr(dest_addr, entry->mac_addr); break; } } - if (p_entry == NULL) + if (entry == NULL) return; - /* Frame control.*/ + /* @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); + SET_80211_HDR_ADDRESS2(p_ndpa_frame, entry->my_mac_addr); - /*--------------------------------------------*/ - /* Need to modify "duration" to MU consideration. */ + /*@--------------------------------------------*/ + /* @ Need to modify "duration" to MU consideration. */ duration = 2 * a_SifsTime + 44; if (BW == CHANNEL_WIDTH_80) @@ -799,122 +788,118 @@ construct_vht_mu_ndpa_packet( duration += 87; else duration += 180; - /*--------------------------------------------*/ + /*@--------------------------------------------*/ SET_80211_HDR_DURATION(p_ndpa_frame, duration); - sequence = *(p_dm_odm->p_sounding_seq) << 2; - odm_move_memory(p_dm_odm, p_ndpa_frame + 16, &sequence, 1); + sequence = *(dm->sounding_seq) << 2; + odm_move_memory(dm, p_ndpa_frame + 16, &sequence, 1); *p_length = 17; - /* Construct STA info. for multiple STAs*/ + /* @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*/ + entry = &(beam_info->beamformee_entry[idx]); + if (entry->is_mu_sta) { + sta_info.aid = entry->AID; + sta_info.feedback_type = 1; /* @1'b1: MU*/ sta_info.nc_index = 0; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Get beamformee_entry idx(%d), AID =%d\n", __func__, idx, p_entry->AID)); + PHYDM_DBG(dm, DBG_TXBF, + "[%s] Get beamformee_entry idx(%d), AID =%d\n", + __func__, idx, entry->AID); - odm_move_memory(p_dm_odm, p_ndpa_frame + (*p_length), (u8 *)&sta_info, 2); + odm_move_memory(dm, p_ndpa_frame + (*p_length), (u8 *)&sta_info, 2); *p_length += 2; } } - } -bool +boolean send_sw_vht_mu_ndpa_packet( - void *p_dm_void, - CHANNEL_WIDTH BW -) + void *dm_void, + enum channel_width BW) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - PRT_TCB p_tcb; - PRT_TX_LOCAL_BUFFER p_buf; - bool ret = true; - u8 ndp_tx_rate = 0; - struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm_odm->beamforming_info); - struct _ADAPTER *adapter = p_beam_info->source_adapter; + struct dm_struct *dm = (struct dm_struct *)dm_void; + PRT_TCB tcb; + PRT_TX_LOCAL_BUFFER p_buf; + boolean ret = true; + u8 ndp_tx_rate = 0; + struct _RT_BEAMFORMING_INFO *beam_info = &(dm->beamforming_info); + void *adapter = beam_info->source_adapter; ndp_tx_rate = MGN_VHT2SS_MCS0; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] ndp_tx_rate =%d\n", __func__, ndp_tx_rate)); + PHYDM_DBG(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)) { + if (MgntGetBuffer(adapter, &tcb, &p_buf)) { construct_vht_mu_ndpa_packet( - p_dm_odm, + dm, BW, p_buf->Buffer.VirtualAddress, - &p_tcb->PacketLength - ); + &tcb->PacketLength); - p_tcb->bTxEnableSwCalcDur = true; - p_tcb->BWOfPacket = BW; - p_tcb->TxBFPktType = RT_BF_PKT_TYPE_BROADCAST_NDPA; + tcb->bTxEnableSwCalcDur = true; + tcb->BWOfPacket = BW; + 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); + MgntSendPacket(adapter, tcb, p_buf, 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); + RT_DISP_DATA(FBEAM, FBEAM_DATA, "", p_buf->Buffer.VirtualAddress, tcb->PacketLength); return ret; } - -void -dbg_construct_vht_mundpa_packet( - struct PHY_DM_STRUCT *p_dm_odm, - CHANNEL_WIDTH BW, - u8 *buffer, - u32 *p_length -) +void dbg_construct_vht_mundpa_packet( + struct dm_struct *dm, + enum channel_width BW, + u8 *buffer, + u32 *p_length) { - struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm_odm->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; + struct _RT_BEAMFORMING_INFO *beam_info = &(dm->beamforming_info); + void *adapter = 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 *entry = NULL; - bool is_STA1 = false; + boolean is_STA1 = false; - - /* Fill the first MU BFee entry (STA1) MAC addr to destination address then + /* @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) { + entry = &(beam_info->beamformee_entry[idx]); + if (entry->is_mu_sta) { if (is_STA1 == false) { is_STA1 = true; continue; } else { - cp_mac_addr(dest_addr, p_entry->mac_addr); + cp_mac_addr(dest_addr, entry->mac_addr); break; } } } - /* Frame control.*/ + /* @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_odm->CurrentAddress); + SET_80211_HDR_ADDRESS2(p_ndpa_frame, dm->CurrentAddress); - /*--------------------------------------------*/ - /* Need to modify "duration" to MU consideration. */ + /*@--------------------------------------------*/ + /* @ Need to modify "duration" to MU consideration. */ duration = 2 * a_SifsTime + 44; if (BW == CHANNEL_WIDTH_80) @@ -923,136 +908,128 @@ dbg_construct_vht_mundpa_packet( duration += 87; else duration += 180; - /*--------------------------------------------*/ + /*@--------------------------------------------*/ SET_80211_HDR_DURATION(p_ndpa_frame, duration); - sequence = *(p_dm_odm->p_sounding_seq) << 2; - odm_move_memory(p_dm_odm, p_ndpa_frame + 16, &sequence, 1); + sequence = *(dm->sounding_seq) << 2; + odm_move_memory(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.aid = entry->aid; + sta_info.feedback_type = 1; /* @1'b1: MU */ sta_info.nc_index = 0; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Get beamformee_entry idx(%d), AID =%d\n", __func__, idx, p_entry->aid)); + PHYDM_DBG(dm, DBG_TXBF, "[%s] Get beamformee_entry idx(%d), AID =%d\n", + __func__, idx, entry->aid); - odm_move_memory(p_dm_odm, p_ndpa_frame + (*p_length), (u8 *)&sta_info, 2); + odm_move_memory(dm, p_ndpa_frame + (*p_length), (u8 *)&sta_info, 2); *p_length += 2; - } -bool +boolean dbg_send_sw_vht_mundpa_packet( - void *p_dm_void, - CHANNEL_WIDTH BW -) + void *dm_void, + enum channel_width BW) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - PRT_TCB p_tcb; - PRT_TX_LOCAL_BUFFER p_buf; - bool ret = true; - u8 ndp_tx_rate = 0; - struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm_odm->beamforming_info); - struct _ADAPTER *adapter = p_beam_info->source_adapter; + struct dm_struct *dm = (struct dm_struct *)dm_void; + PRT_TCB tcb; + PRT_TX_LOCAL_BUFFER p_buf; + boolean ret = true; + u8 ndp_tx_rate = 0; + struct _RT_BEAMFORMING_INFO *beam_info = &(dm->beamforming_info); + void *adapter = beam_info->source_adapter; ndp_tx_rate = MGN_VHT2SS_MCS0; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] ndp_tx_rate =%d\n", __func__, ndp_tx_rate)); + PHYDM_DBG(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)) { + if (MgntGetBuffer(adapter, &tcb, &p_buf)) { dbg_construct_vht_mundpa_packet( - p_dm_odm, + dm, BW, p_buf->Buffer.VirtualAddress, - &p_tcb->PacketLength - ); + &tcb->PacketLength); - p_tcb->bTxEnableSwCalcDur = true; - p_tcb->BWOfPacket = BW; - p_tcb->TxBFPktType = RT_BF_PKT_TYPE_UNICAST_NDPA; + tcb->bTxEnableSwCalcDur = true; + tcb->BWOfPacket = BW; + 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); + MgntSendPacket(adapter, tcb, p_buf, 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); + RT_DISP_DATA(FBEAM, FBEAM_DATA, "", p_buf->Buffer.VirtualAddress, tcb->PacketLength); return ret; } - -#endif /*#if (SUPPORT_MU_BF == 1)*/ -#endif /*#ifdef SUPPORT_MU_BF*/ - +#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 -) +u32 beamforming_get_report_frame( + void *dm_void, + union recv_frame *precv_frame) { - struct PHY_DM_STRUCT *p_dm_odm = (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; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u32 ret = _SUCCESS; + struct _RT_BEAMFORMEE_ENTRY *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*/ + /*@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_odm, 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)*/ + beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(dm, TA, &idx); + if (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 (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; } - -bool +boolean send_fw_ht_ndpa_packet( - void *p_dm_void, - u8 *RA, - CHANNEL_WIDTH BW -) + void *dm_void, + u8 *RA, + enum channel_width BW) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTER *adapter = p_dm_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); - 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_odm->beamforming_info); - struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm_odm, RA, &idx); + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _ADAPTER *adapter = 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 *beam_info = &(dm->beamforming_info); + struct _RT_BEAMFORMEE_ENTRY *beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(dm, RA, &idx); pmgntframe = alloc_mgtxmitframe(pxmitpriv); if (pmgntframe == NULL) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, alloc mgnt frame fail\n", __func__)); - return _FALSE; + PHYDM_DBG(dm, DBG_TXBF, "%s, alloc mgnt frame fail\n", + __func__); + return false; } /* update attribute */ @@ -1060,8 +1037,9 @@ send_fw_ht_ndpa_packet( update_mgntframe_attrib(adapter, pattrib); pattrib->qsel = QSLT_BEACON; - ndp_tx_rate = beamforming_get_htndp_tx_rate(p_dm_odm, p_beamform_entry->comp_steering_num_of_bfer); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] ndp_tx_rate =%d\n", __func__, ndp_tx_rate)); + ndp_tx_rate = beamforming_get_htndp_tx_rate(dm, beamform_entry->comp_steering_num_of_bfer); + PHYDM_DBG(dm, DBG_TXBF, "[%s] ndp_tx_rate =%d\n", __func__, + ndp_tx_rate); pattrib->rate = ndp_tx_rate; pattrib->bwmode = BW; pattrib->order = 1; @@ -1080,7 +1058,7 @@ send_fw_ht_ndpa_packet( 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->addr2, 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) @@ -1097,7 +1075,7 @@ send_fw_ht_ndpa_packet( set_duration(pframe, duration); - /* HT control field */ + /* @HT control field */ SET_HT_CTRL_CSI_STEERING(pframe + 24, 3); SET_HT_CTRL_NDP_ANNOUNCEMENT(pframe + 24, 1); @@ -1109,40 +1087,39 @@ send_fw_ht_ndpa_packet( dump_mgntframe(adapter, pmgntframe); - return _TRUE; + return true; } - -bool +boolean send_sw_ht_ndpa_packet( - void *p_dm_void, - u8 *RA, - CHANNEL_WIDTH BW -) + void *dm_void, + u8 *RA, + enum channel_width BW) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTER *adapter = p_dm_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); - 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_odm->beamforming_info); - struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm_odm, RA, &idx); + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _ADAPTER *adapter = 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 *beam_info = &(dm->beamforming_info); + struct _RT_BEAMFORMEE_ENTRY *beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(dm, RA, &idx); - ndp_tx_rate = beamforming_get_htndp_tx_rate(p_dm_odm, p_beamform_entry->comp_steering_num_of_bfer); + ndp_tx_rate = beamforming_get_htndp_tx_rate(dm, beamform_entry->comp_steering_num_of_bfer); pmgntframe = alloc_mgtxmitframe(pxmitpriv); if (pmgntframe == NULL) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, alloc mgnt frame fail\n", __func__)); - return _FALSE; + PHYDM_DBG(dm, DBG_TXBF, "%s, alloc mgnt frame fail\n", + __func__); + return false; } /*update attribute*/ @@ -1167,7 +1144,7 @@ send_sw_ht_ndpa_packet( 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->addr2, 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) @@ -1184,7 +1161,7 @@ send_sw_ht_ndpa_packet( set_duration(pframe, duration); - /*HT control field*/ + /*@HT control field*/ SET_HT_CTRL_CSI_STEERING(pframe + 24, 3); SET_HT_CTRL_NDP_ANNOUNCEMENT(pframe + 24, 1); @@ -1196,40 +1173,39 @@ send_sw_ht_ndpa_packet( dump_mgntframe(adapter, pmgntframe); - return _TRUE; + return true; } - -bool +boolean send_fw_vht_ndpa_packet( - void *p_dm_void, - u8 *RA, - u16 AID, - CHANNEL_WIDTH BW -) + void *dm_void, + u8 *RA, + u16 AID, + enum channel_width BW) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTER *adapter = p_dm_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); - 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_odm->beamforming_info); - struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm_odm, RA, &idx); - struct _RT_NDPA_STA_INFO sta_info; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _ADAPTER *adapter = 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 *beam_info = &(dm->beamforming_info); + struct _RT_BEAMFORMEE_ENTRY *beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(dm, RA, &idx); + struct _RT_NDPA_STA_INFO sta_info; pmgntframe = alloc_mgtxmitframe(pxmitpriv); if (pmgntframe == NULL) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, alloc mgnt frame fail\n", __func__)); - return _FALSE; + PHYDM_DBG(dm, DBG_TXBF, "%s, alloc mgnt frame fail\n", + __func__); + return false; } /* update attribute */ @@ -1238,8 +1214,9 @@ send_fw_vht_ndpa_packet( update_mgntframe_attrib(adapter, pattrib); pattrib->qsel = QSLT_BEACON; - ndp_tx_rate = beamforming_get_vht_ndp_tx_rate(p_dm_odm, p_beamform_entry->comp_steering_num_of_bfer); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] ndp_tx_rate =%d\n", __func__, ndp_tx_rate)); + ndp_tx_rate = beamforming_get_vht_ndp_tx_rate(dm, beamform_entry->comp_steering_num_of_bfer); + PHYDM_DBG(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; @@ -1256,7 +1233,7 @@ send_fw_vht_ndpa_packet( 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); + _rtw_memcpy(pwlanhdr->addr2, 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; @@ -1274,11 +1251,11 @@ send_fw_vht_ndpa_packet( set_duration(pframe, duration); - sequence = p_beam_info->sounding_sequence << 2; - if (p_beam_info->sounding_sequence >= 0x3f) - p_beam_info->sounding_sequence = 0; + sequence = beam_info->sounding_sequence << 2; + if (beam_info->sounding_sequence >= 0x3f) + beam_info->sounding_sequence = 0; else - p_beam_info->sounding_sequence++; + beam_info->sounding_sequence++; _rtw_memcpy(pframe + 16, &sequence, 1); @@ -1297,44 +1274,43 @@ send_fw_vht_ndpa_packet( dump_mgntframe(adapter, pmgntframe); - return _TRUE; + return true; } - - -bool +boolean send_sw_vht_ndpa_packet( - void *p_dm_void, - u8 *RA, - u16 AID, - CHANNEL_WIDTH BW -) + void *dm_void, + u8 *RA, + u16 AID, + enum channel_width BW) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTER *adapter = p_dm_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); - 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_odm->beamforming_info); - struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm_odm, RA, &idx); + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _ADAPTER *adapter = 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 *beam_info = &(dm->beamforming_info); + struct _RT_BEAMFORMEE_ENTRY *beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(dm, RA, &idx); - ndp_tx_rate = beamforming_get_vht_ndp_tx_rate(p_dm_odm, p_beamform_entry->comp_steering_num_of_bfer); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] ndp_tx_rate =%d\n", __func__, ndp_tx_rate)); + ndp_tx_rate = beamforming_get_vht_ndp_tx_rate(dm, beamform_entry->comp_steering_num_of_bfer); + PHYDM_DBG(dm, DBG_TXBF, "[%s] ndp_tx_rate =%d\n", __func__, + ndp_tx_rate); pmgntframe = alloc_mgtxmitframe(pxmitpriv); if (pmgntframe == NULL) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, alloc mgnt frame fail\n", __func__)); - return _FALSE; + PHYDM_DBG(dm, DBG_TXBF, "%s, alloc mgnt frame fail\n", + __func__); + return false; } /*update attribute*/ @@ -1358,7 +1334,7 @@ send_sw_vht_ndpa_packet( 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); + _rtw_memcpy(pwlanhdr->addr2, 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; @@ -1376,11 +1352,11 @@ send_sw_vht_ndpa_packet( set_duration(pframe, duration); - sequence = p_beam_info->sounding_sequence << 2; - if (p_beam_info->sounding_sequence >= 0x3f) - p_beam_info->sounding_sequence = 0; + sequence = beam_info->sounding_sequence << 2; + if (beam_info->sounding_sequence >= 0x3f) + beam_info->sounding_sequence = 0; else - p_beam_info->sounding_sequence++; + 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)) @@ -1397,46 +1373,43 @@ send_sw_vht_ndpa_packet( pattrib->last_txcmdsz = pattrib->pktlen; dump_mgntframe(adapter, pmgntframe); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] [%d]\n", __func__, __LINE__)); + PHYDM_DBG(dm, DBG_TXBF, "[%s] [%d]\n", __func__, __LINE__); - return _TRUE; + return true; } - #endif - -void -beamforming_get_ndpa_frame( - void *p_dm_void, +void beamforming_get_ndpa_frame( + void *dm_void, #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - OCTET_STRING pdu_os + OCTET_STRING pdu_os #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) union recv_frame *precv_frame #endif -) + ) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _ADAPTER *adapter = p_dm_odm->adapter; - u8 *TA ; - u8 idx, sequence; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 *TA; + u8 idx, sequence; #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - u8 *p_ndpa_frame = pdu_os.Octet; + u8 *p_ndpa_frame = pdu_os.Octet; #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - u8 *p_ndpa_frame = precv_frame->u.hdr.rx_data; + 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*/ - + struct _RT_BEAMFORMER_ENTRY *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); + 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_odm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821))) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] not 8812 or 8821A, return\n", __func__)); + else if (!(dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821))) { + PHYDM_DBG(dm, DBG_TXBF, "[%s] not 8812 or 8821A, return\n", + __func__); return; } #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) @@ -1447,57 +1420,66 @@ beamforming_get_ndpa_frame( /*Remove signaling TA. */ TA[0] = TA[0] & 0xFE; - p_beamformer_entry = phydm_beamforming_get_bfer_entry_by_addr(p_dm_odm, TA, &idx); /* Modified By Jeffery @2014-10-29 */ + beamformer_entry = phydm_beamforming_get_bfer_entry_by_addr(dm, TA, &idx); /* @Modified By Jeffery @2014-10-29 */ - /*Break options for Clock Reset*/ - if (p_beamformer_entry == NULL) + /*@Break options for Clock Reset*/ + if (beamformer_entry == NULL) return; - else if (!(p_beamformer_entry->beamform_entry_cap & BEAMFORMEE_CAP_VHT_SU)) + else if (!(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)) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%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)); + /*@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 ((beamformer_entry->log_success == 1) || (beamformer_entry->clock_reset_times == 5)) { + PHYDM_DBG(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__, beamformer_entry->log_seq, + beamformer_entry->pre_log_seq, + beamformer_entry->log_retry_cnt, + beamformer_entry->log_success, + beamformer_entry->clock_reset_times); return; } sequence = (p_ndpa_frame[16]) >> 2; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%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)); + PHYDM_DBG(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, beamformer_entry->log_seq, + beamformer_entry->pre_log_seq, + beamformer_entry->log_retry_cnt, + beamformer_entry->clock_reset_times, + beamformer_entry->log_success); - if ((p_beamformer_entry->log_seq != 0) && (p_beamformer_entry->pre_log_seq != 0)) { + if (beamformer_entry->log_seq != 0 && 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.*/ + if (beamformer_entry->log_seq != sequence && beamformer_entry->pre_log_seq != beamformer_entry->log_seq) { + /* @break option for clcok reset, 2015-03-30, Jeffery */ + 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; + beamformer_entry->log_success = 1; - } else {/*Fail condition*/ + } else { /*@Fail condition*/ - if (p_beamformer_entry->log_retry_cnt == 5) { - p_beamformer_entry->clock_reset_times++; - p_beamformer_entry->log_retry_cnt = 0; + if (beamformer_entry->log_retry_cnt == 5) { + beamformer_entry->clock_reset_times++; + beamformer_entry->log_retry_cnt = 0; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Clock Reset!!! clock_reset_times=%d\n", - __func__, p_beamformer_entry->clock_reset_times)); - hal_com_txbf_set(p_dm_odm, TXBF_SET_SOUNDING_CLK, NULL); + PHYDM_DBG(dm, DBG_TXBF, + "[%s] Clock Reset!!! clock_reset_times=%d\n", + __func__, + beamformer_entry->clock_reset_times); + hal_com_txbf_set(dm, TXBF_SET_SOUNDING_CLK, NULL); } else - p_beamformer_entry->log_retry_cnt++; + 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; - + beamformer_entry->pre_log_seq = beamformer_entry->log_seq; + beamformer_entry->log_seq = sequence; } - - #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbfinterface.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbfinterface.h index ff0313defc20..28ba104746fe 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbfinterface.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbfinterface.h @@ -1,166 +1,168 @@ /* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ #ifndef __HAL_TXBF_INTERFACE_H__ #define __HAL_TXBF_INTERFACE_H__ -#if (BEAMFORMING_SUPPORT == 1) +#ifdef PHYDM_BEAMFORMING_SUPPORT #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -#define a_SifsTime ((IS_WIRELESS_MODE_5G(adapter)|| IS_WIRELESS_MODE_N_24G(adapter))? 16 : 10) +#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 -); +void beamforming_gid_paid( + void *adapter, + PRT_TCB tcb); enum rt_status beamforming_get_report_frame( - struct _ADAPTER *adapter, - PRT_RFD p_rfd, - POCTET_STRING p_pdu_os -); + void *adapter, + PRT_RFD rfd, + POCTET_STRING p_pdu_os); -void -beamforming_get_ndpa_frame( - void *p_dm_void, - OCTET_STRING pdu_os -); +void beamforming_get_ndpa_frame( + void *dm_void, + OCTET_STRING pdu_os); -bool +boolean send_fw_ht_ndpa_packet( - void *p_dm_void, - u8 *RA, - CHANNEL_WIDTH BW -); + void *dm_void, + u8 *RA, + enum channel_width BW); -bool +boolean send_fw_vht_ndpa_packet( - void *p_dm_void, - u8 *RA, - u16 AID, - CHANNEL_WIDTH BW -); + void *dm_void, + u8 *RA, + u16 AID, + enum channel_width BW); -bool +boolean send_sw_vht_ndpa_packet( - void *p_dm_void, - u8 *RA, - u16 AID, - CHANNEL_WIDTH BW -); + void *dm_void, + u8 *RA, + u16 AID, + enum channel_width BW); -bool +boolean send_sw_ht_ndpa_packet( - void *p_dm_void, - u8 *RA, - CHANNEL_WIDTH BW -); + void *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 -); + void *adapter, + PRT_RFD rfd, + POCTET_STRING p_pdu_os); -bool +boolean send_sw_vht_gid_mgnt_frame( - void *p_dm_void, - u8 *RA, - u8 idx -); + void *dm_void, + u8 *RA, + u8 idx); -bool +boolean send_sw_vht_bf_report_poll( - void *p_dm_void, - u8 *RA, - bool is_final_poll -); + void *dm_void, + u8 *RA, + boolean is_final_poll); -bool +boolean send_sw_vht_mu_ndpa_packet( - void *p_dm_void, - CHANNEL_WIDTH BW -); + void *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) +#define beamforming_get_vht_gid_mgnt_frame(adapter, rfd, p_pdu_os) RT_STATUS_FAILURE +#define send_sw_vht_gid_mgnt_frame(dm_void, RA) +#define send_sw_vht_bf_report_poll(dm_void, RA, is_final_poll) +#define send_sw_vht_mu_ndpa_packet(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 -); +u32 beamforming_get_report_frame( + void *dm_void, + union recv_frame *precv_frame); -bool +boolean send_fw_ht_ndpa_packet( - void *p_dm_void, - u8 *RA, - CHANNEL_WIDTH BW -); + void *dm_void, + u8 *RA, + enum channel_width BW); -bool +boolean send_sw_ht_ndpa_packet( - void *p_dm_void, - u8 *RA, - CHANNEL_WIDTH BW -); + void *dm_void, + u8 *RA, + enum channel_width BW); -bool +boolean send_fw_vht_ndpa_packet( - void *p_dm_void, - u8 *RA, - u16 AID, - CHANNEL_WIDTH BW -); + void *dm_void, + u8 *RA, + u16 AID, + enum channel_width BW); -bool +boolean send_sw_vht_ndpa_packet( - void *p_dm_void, - u8 *RA, - u16 AID, - CHANNEL_WIDTH BW -); + void *dm_void, + u8 *RA, + u16 AID, + enum channel_width BW); #endif -void -beamforming_get_ndpa_frame( - void *p_dm_void, +void beamforming_get_ndpa_frame( + void *dm_void, #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - OCTET_STRING pdu_os + OCTET_STRING pdu_os #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) union recv_frame *precv_frame #endif -); + ); -bool +boolean dbg_send_sw_vht_mundpa_packet( - void *p_dm_void, - CHANNEL_WIDTH BW -); + void *dm_void, + enum channel_width BW); #else -#define beamforming_get_ndpa_frame(p_dm_odm, _pdu_os) +#define beamforming_get_ndpa_frame(dm, _pdu_os) #if (DM_ODM_SUPPORT_TYPE == ODM_CE) - #define beamforming_get_report_frame(adapter, precv_frame) RT_STATUS_FAILURE +#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 +#define beamforming_get_report_frame(adapter, rfd, p_pdu_os) RT_STATUS_FAILURE +#define beamforming_get_vht_gid_mgnt_frame(adapter, 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) +#define send_fw_ht_ndpa_packet(dm_void, RA, BW) +#define send_sw_ht_ndpa_packet(dm_void, RA, BW) +#define send_fw_vht_ndpa_packet(dm_void, RA, AID, BW) +#define send_sw_vht_ndpa_packet(dm_void, RA, AID, BW) +#define send_sw_vht_gid_mgnt_frame(dm_void, RA, idx) +#define send_sw_vht_bf_report_poll(dm_void, RA, is_final_poll) +#define send_sw_vht_mu_ndpa_packet(dm_void, BW) #endif #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbfjaguar.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbfjaguar.c index bebdb8762e13..79a821564ba0 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbfjaguar.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbfjaguar.c @@ -1,191 +1,195 @@ /* SPDX-License-Identifier: GPL-2.0 */ -/* ************************************************************ +/****************************************************************************** + * + * 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) +#ifdef PHYDM_BEAMFORMING_SUPPORT #if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) -void -hal_txbf_8812a_set_ndpa_rate( - void *p_dm_void, - u8 BW, - u8 rate -) +void hal_txbf_8812a_set_ndpa_rate( + void *dm_void, + u8 BW, + u8 rate) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - - odm_write_1byte(p_dm_odm, REG_NDPA_OPT_CTRL_8812A, (rate << 2 | BW)); + struct dm_struct *dm = (struct dm_struct *)dm_void; + odm_write_1byte(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 -) +void hal_txbf_jaguar_rf_mode( + void *dm_void, + struct _RT_BEAMFORMING_INFO *beam_info) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; - if (p_dm_odm->rf_type == ODM_1T1R) + if (dm->rf_type == RF_1T1R) return; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] set TxIQGen\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "[%s] set TxIQGen\n", __func__); - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); /*RF mode table write enable*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x1); /*RF mode table write enable*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, 0x80000, 0x1); /*RF mode table write enable*/ + odm_set_rf_reg(dm, RF_PATH_B, RF_0xef, 0x80000, 0x1); /*RF mode table write enable*/ - if (p_beam_info->beamformee_su_cnt > 0) { + if (beam_info->beamformee_su_cnt > 0) { /* Paath_A */ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x30, 0x78000, 0x3); /*Select RX mode*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x3F7FF); /*Set Table data*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0xE26BF); /*Enable TXIQGEN in RX mode*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0x30, 0x78000, 0x3); /*Select RX mode*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0x31, 0xfffff, 0x3F7FF); /*Set Table data*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0x32, 0xfffff, 0xE26BF); /*@Enable TXIQGEN in RX mode*/ /* Path_B */ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0x30, 0x78000, 0x3); /*Select RX mode*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0x31, 0xfffff, 0x3F7FF); /*Set Table data*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0x32, 0xfffff, 0xE26BF); /*Enable TXIQGEN in RX mode*/ + odm_set_rf_reg(dm, RF_PATH_B, RF_0x30, 0x78000, 0x3); /*Select RX mode*/ + odm_set_rf_reg(dm, RF_PATH_B, RF_0x31, 0xfffff, 0x3F7FF); /*Set Table data*/ + odm_set_rf_reg(dm, RF_PATH_B, RF_0x32, 0xfffff, 0xE26BF); /*@Enable TXIQGEN in RX mode*/ } else { /* Paath_A */ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x30, 0x78000, 0x3); /*Select RX mode*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x3F7FF); /*Set Table data*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0xC26BF); /*Disable TXIQGEN in RX mode*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0x30, 0x78000, 0x3); /*Select RX mode*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0x31, 0xfffff, 0x3F7FF); /*Set Table data*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0x32, 0xfffff, 0xC26BF); /*@Disable TXIQGEN in RX mode*/ /* Path_B */ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0x30, 0x78000, 0x3); /*Select RX mode*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0x31, 0xfffff, 0x3F7FF); /*Set Table data*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0x32, 0xfffff, 0xC26BF); /*Disable TXIQGEN in RX mode*/ + odm_set_rf_reg(dm, RF_PATH_B, RF_0x30, 0x78000, 0x3); /*Select RX mode*/ + odm_set_rf_reg(dm, RF_PATH_B, RF_0x31, 0xfffff, 0x3F7FF); /*Set Table data*/ + odm_set_rf_reg(dm, RF_PATH_B, RF_0x32, 0xfffff, 0xC26BF); /*@Disable TXIQGEN in RX mode*/ } - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); /*RF mode table write disable*/ - odm_set_rf_reg(p_dm_odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x0); /*RF mode table write disable*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, 0x80000, 0x0); /*RF mode table write disable*/ + odm_set_rf_reg(dm, RF_PATH_B, RF_0xef, 0x80000, 0x0); /*RF mode table write disable*/ - if (p_beam_info->beamformee_su_cnt > 0) - odm_set_bb_reg(p_dm_odm, 0x80c, MASKBYTE1, 0x33); + if (beam_info->beamformee_su_cnt > 0) + odm_set_bb_reg(dm, R_0x80c, MASKBYTE1, 0x33); else - odm_set_bb_reg(p_dm_odm, 0x80c, MASKBYTE1, 0x11); + odm_set_bb_reg(dm, R_0x80c, MASKBYTE1, 0x11); } - -void -hal_txbf_jaguar_download_ndpa( - void *p_dm_void, - u8 idx -) +void hal_txbf_jaguar_download_ndpa( + void *dm_void, + u8 idx) { - struct PHY_DM_STRUCT *p_dm_odm = (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; - bool 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_odm->beamforming_info; - struct _RT_BEAMFORMEE_ENTRY *p_beam_entry = p_beam_info->beamformee_entry + idx; - struct _ADAPTER *adapter = p_dm_odm->adapter; + struct dm_struct *dm = (struct dm_struct *)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 *beam_info = &dm->beamforming_info; + struct _RT_BEAMFORMEE_ENTRY *p_beam_entry = beam_info->beamformee_entry + idx; + void *adapter = dm->adapter; #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - *p_dm_odm->p_is_fw_dw_rsvd_page_in_progress = true; + *dm->is_fw_dw_rsvd_page_in_progress = true; #endif - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); + PHYDM_DBG(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_odm, HAL_DEF_TX_PAGE_BOUNDARY, (u8 *)&tx_page_bndy); + phydm_get_hal_def_var_handler_interface(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_odm, REG_CR_8812A + 1); - odm_write_1byte(p_dm_odm, REG_CR_8812A + 1, (u1b_tmp | BIT(0))); - + u1b_tmp = odm_read_1byte(dm, REG_CR_8812A + 1); + odm_write_1byte(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_odm, REG_FWHW_TXQ_CTRL_8812A + 2); - odm_write_1byte(p_dm_odm, REG_FWHW_TXQ_CTRL_8812A + 2, tmp_reg422 & (~BIT(6))); + tmp_reg422 = odm_read_1byte(dm, REG_FWHW_TXQ_CTRL_8812A + 2); + odm_write_1byte(dm, REG_FWHW_TXQ_CTRL_8812A + 2, tmp_reg422 & (~BIT(6))); if (tmp_reg422 & BIT(6)) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("SetBeamformDownloadNDPA_8812(): There is an adapter is sending beacon.\n")); + PHYDM_DBG(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_odm, REG_TDECTRL_8812A + 1, head_page); + odm_write_1byte(dm, REG_TDECTRL_8812A + 1, head_page); do { - /*Clear beacon valid check bit.*/ - bcn_valid_reg = odm_read_1byte(p_dm_odm, REG_TDECTRL_8812A + 2); - odm_write_1byte(p_dm_odm, REG_TDECTRL_8812A + 2, (bcn_valid_reg | BIT(0))); + /*@Clear beacon valid check bit.*/ + bcn_valid_reg = odm_read_1byte(dm, REG_TDECTRL_8812A + 2); + odm_write_1byte(dm, REG_TDECTRL_8812A + 2, (bcn_valid_reg | BIT(0))); - /*download NDPA rsvd page.*/ + /*@download NDPA rsvd page.*/ if (p_beam_entry->beamform_entry_cap & BEAMFORMER_CAP_VHT_SU) - beamforming_send_vht_ndpa_packet(p_dm_odm, p_beam_entry->mac_addr, p_beam_entry->aid, p_beam_entry->sound_bw, BEACON_QUEUE); + beamforming_send_vht_ndpa_packet(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_odm, p_beam_entry->mac_addr, p_beam_entry->sound_bw, BEACON_QUEUE); + beamforming_send_ht_ndpa_packet(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_odm, REG_TDECTRL_8812A + 2); + /*@check rsvd page download OK.*/ + bcn_valid_reg = odm_read_1byte(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_odm, REG_TDECTRL_8812A + 2); + bcn_valid_reg = odm_read_1byte(dm, REG_TDECTRL_8812A + 2); } dl_bcn_count++; } while (!(bcn_valid_reg & BIT(0)) && dl_bcn_count < 5); if (!(bcn_valid_reg & BIT(0))) - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Download RSVD page failed!\n", __func__)); + PHYDM_DBG(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_odm, REG_TDECTRL_8812A + 1, tx_page_bndy); + odm_write_1byte(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*/ + /*@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.*/ + /*@2010.06.23. Added by tynli.*/ if (is_send_beacon) - odm_write_1byte(p_dm_odm, REG_FWHW_TXQ_CTRL_8812A + 2, tmp_reg422); + odm_write_1byte(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_odm, REG_CR_8812A + 1); - odm_write_1byte(p_dm_odm, REG_CR_8812A + 1, (u1b_tmp & (~BIT(0)))); + /*@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(dm, REG_CR_8812A + 1); + odm_write_1byte(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_odm->p_is_fw_dw_rsvd_page_in_progress = false; + *dm->is_fw_dw_rsvd_page_in_progress = false; #endif } - -void -hal_txbf_jaguar_fw_txbf_cmd( - void *p_dm_void -) +void hal_txbf_jaguar_fw_txbf_cmd( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (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_odm->beamforming_info; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 idx, period0 = 0, period1 = 0; + u8 PageNum0 = 0xFF, PageNum1 = 0xFF; + u8 u1_tx_bf_parm[3] = {0}; + struct _RT_BEAMFORMING_INFO *beam_info = &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) { + /*@Modified by David*/ + if (beam_info->beamformee_entry[idx].is_used && beam_info->beamformee_entry[idx].beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED) { if (idx == 0) { - if (p_beam_info->beamformee_entry[idx].is_sound) + if (beam_info->beamformee_entry[idx].is_sound) PageNum0 = 0xFE; else PageNum0 = 0xFF; /*stop sounding*/ - period0 = (u8)(p_beam_info->beamformee_entry[idx].sound_period); + period0 = (u8)(beam_info->beamformee_entry[idx].sound_period); } else if (idx == 1) { - if (p_beam_info->beamformee_entry[idx].is_sound) + if (beam_info->beamformee_entry[idx].is_sound) PageNum1 = 0xFE; else PageNum1 = 0xFF; /*stop sounding*/ - period1 = (u8)(p_beam_info->beamformee_entry[idx].sound_period); + period1 = (u8)(beam_info->beamformee_entry[idx].sound_period); } } } @@ -193,177 +197,167 @@ hal_txbf_jaguar_fw_txbf_cmd( 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_odm, PHYDM_H2C_TXBF, 3, u1_tx_bf_parm); + odm_fill_h2c_cmd(dm, PHYDM_H2C_TXBF, 3, u1_tx_bf_parm); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, - ("[%s] PageNum0 = %d period0 = %d, PageNum1 = %d period1 %d\n", __func__, PageNum0, period0, PageNum1, period1)); + PHYDM_DBG(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 -) +void hal_txbf_jaguar_enter( + void *dm_void, + u8 bfer_bfee_idx) { - struct PHY_DM_STRUCT *p_dm_odm = (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_odm->beamforming_info; - struct _RT_BEAMFORMEE_ENTRY beamformee_entry; - struct _RT_BEAMFORMER_ENTRY beamformer_entry; - u16 sta_id = 0; + struct dm_struct *dm = (struct dm_struct *)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 *beamforming_info = &dm->beamforming_info; + struct _RT_BEAMFORMEE_ENTRY beamformee_entry; + struct _RT_BEAMFORMER_ENTRY beamformer_entry; + u16 sta_id = 0; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]Start!\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "[%s]Start!\n", __func__); - hal_txbf_jaguar_rf_mode(p_dm_odm, p_beamforming_info); + hal_txbf_jaguar_rf_mode(dm, beamforming_info); - if (p_dm_odm->rf_type == ODM_2T2R) - odm_set_bb_reg(p_dm_odm, ODM_REG_CSI_CONTENT_VALUE, MASKDWORD, 0x00000000); /*nc =2*/ + if (dm->rf_type == RF_2T2R) + odm_set_bb_reg(dm, ODM_REG_CSI_CONTENT_VALUE, MASKDWORD, 0x00000000); /*nc =2*/ else - odm_set_bb_reg(p_dm_odm, ODM_REG_CSI_CONTENT_VALUE, MASKDWORD, 0x01081008); /*nc =1*/ + odm_set_bb_reg(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]; + if (beamforming_info->beamformer_su_cnt > 0 && bfer_idx < BEAMFORMER_ENTRY_NUM) { + beamformer_entry = beamforming_info->beamformer_entry[bfer_idx]; /*Sounding protocol control*/ - odm_write_1byte(p_dm_odm, REG_SND_PTCL_CTRL_8812A, 0xCB); + odm_write_1byte(dm, REG_SND_PTCL_CTRL_8812A, 0xCB); - /*MAC address/Partial AID of Beamformer*/ + /*@MAC address/Partial AID of Beamformer*/ if (bfer_idx == 0) { - for (i = 0; i < 6 ; i++) - odm_write_1byte(p_dm_odm, (REG_BFMER0_INFO_8812A + i), beamformer_entry.mac_addr[i]); - /*CSI report use legacy ofdm so don't need to fill P_AID. */ + for (i = 0; i < 6; i++) + odm_write_1byte(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_odm, (REG_BFMER1_INFO_8812A + i), beamformer_entry.mac_addr[i]); - /*CSI report use legacy ofdm so don't need to fill P_AID.*/ + for (i = 0; i < 6; i++) + odm_write_1byte(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*/ + /*@CSI report parameters of Beamformee*/ if (beamformer_entry.beamform_entry_cap & BEAMFORMEE_CAP_VHT_SU) { - if (p_dm_odm->rf_type == ODM_2T2R) + if (dm->rf_type == RF_2T2R) csi_param = 0x01090109; else csi_param = 0x01080108; } else { - if (p_dm_odm->rf_type == ODM_2T2R) + if (dm->rf_type == RF_2T2R) csi_param = 0x03090309; else csi_param = 0x03080308; } - odm_write_4byte(p_dm_odm, REG_CSI_RPT_PARAM_BW20_8812A, csi_param); - odm_write_4byte(p_dm_odm, REG_CSI_RPT_PARAM_BW40_8812A, csi_param); - odm_write_4byte(p_dm_odm, REG_CSI_RPT_PARAM_BW80_8812A, csi_param); + odm_write_4byte(dm, REG_CSI_RPT_PARAM_BW20_8812A, csi_param); + odm_write_4byte(dm, REG_CSI_RPT_PARAM_BW40_8812A, csi_param); + odm_write_4byte(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_odm, REG_SND_PTCL_CTRL_8812A + 3, 0x50); + odm_write_1byte(dm, REG_SND_PTCL_CTRL_8812A + 3, 0x50); } + if (beamforming_info->beamformee_su_cnt > 0 && bfee_idx < BEAMFORMEE_ENTRY_NUM) { + beamformee_entry = beamforming_info->beamformee_entry[bfee_idx]; - 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_odm, phydm_acting_as_ibss)) + if (phydm_acting_determine(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_odm, REG_TXBF_CTRL_8812A, sta_id); - odm_write_1byte(p_dm_odm, REG_TXBF_CTRL_8812A + 3, odm_read_1byte(p_dm_odm, REG_TXBF_CTRL_8812A + 3) | BIT(4) | BIT(6) | BIT(7)); + odm_write_2byte(dm, REG_TXBF_CTRL_8812A, sta_id); + odm_write_1byte(dm, REG_TXBF_CTRL_8812A + 3, odm_read_1byte(dm, REG_TXBF_CTRL_8812A + 3) | BIT(4) | BIT(6) | BIT(7)); } else - odm_write_2byte(p_dm_odm, REG_TXBF_CTRL_8812A + 2, sta_id | BIT(12) | BIT(14) | BIT(15)); + odm_write_2byte(dm, REG_TXBF_CTRL_8812A + 2, sta_id | BIT(12) | BIT(14) | BIT(15)); - /*CSI report parameters of Beamformee*/ + /*@CSI report parameters of Beamformee*/ if (bfee_idx == 0) { - /*Get BIT24 & BIT25*/ - u8 tmp = odm_read_1byte(p_dm_odm, REG_BFMEE_SEL_8812A + 3) & 0x3; + /*@Get BIT24 & BIT25*/ + u8 tmp = odm_read_1byte(dm, REG_BFMEE_SEL_8812A + 3) & 0x3; - odm_write_1byte(p_dm_odm, REG_BFMEE_SEL_8812A + 3, tmp | 0x60); - odm_write_2byte(p_dm_odm, REG_BFMEE_SEL_8812A, sta_id | BIT(9)); + odm_write_1byte(dm, REG_BFMEE_SEL_8812A + 3, tmp | 0x60); + odm_write_2byte(dm, REG_BFMEE_SEL_8812A, sta_id | BIT(9)); } else { /*Set BIT25*/ - odm_write_2byte(p_dm_odm, REG_BFMEE_SEL_8812A + 2, sta_id | 0xE200); + odm_write_2byte(dm, REG_BFMEE_SEL_8812A + 2, sta_id | 0xE200); } - phydm_beamforming_notify(p_dm_odm); + phydm_beamforming_notify(dm); } } - -void -hal_txbf_jaguar_leave( - void *p_dm_void, - u8 idx -) +void hal_txbf_jaguar_leave( + void *dm_void, + u8 idx) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_BEAMFORMING_INFO *p_beamforming_info = &p_dm_odm->beamforming_info; - struct _RT_BEAMFORMER_ENTRY beamformer_entry; - struct _RT_BEAMFORMEE_ENTRY beamformee_entry; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _RT_BEAMFORMING_INFO *beamforming_info = &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]; + beamformer_entry = beamforming_info->beamformer_entry[idx]; + beamformee_entry = beamforming_info->beamformee_entry[idx]; } else return; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]Start!, IDx = %d\n", __func__, idx)); + PHYDM_DBG(dm, DBG_TXBF, "[%s]Start!, IDx = %d\n", __func__, idx); - /*Clear P_AID of Beamformee*/ - /*Clear MAC address of Beamformer*/ - /*Clear Associated Bfmee Sel*/ + /*@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_odm, REG_SND_PTCL_CTRL_8812A, 0xC8); + odm_write_1byte(dm, REG_SND_PTCL_CTRL_8812A, 0xC8); if (idx == 0) { - odm_write_4byte(p_dm_odm, REG_BFMER0_INFO_8812A, 0); - odm_write_2byte(p_dm_odm, REG_BFMER0_INFO_8812A + 4, 0); - odm_write_2byte(p_dm_odm, REG_CSI_RPT_PARAM_BW20_8812A, 0); - odm_write_2byte(p_dm_odm, REG_CSI_RPT_PARAM_BW40_8812A, 0); - odm_write_2byte(p_dm_odm, REG_CSI_RPT_PARAM_BW80_8812A, 0); + odm_write_4byte(dm, REG_BFMER0_INFO_8812A, 0); + odm_write_2byte(dm, REG_BFMER0_INFO_8812A + 4, 0); + odm_write_2byte(dm, REG_CSI_RPT_PARAM_BW20_8812A, 0); + odm_write_2byte(dm, REG_CSI_RPT_PARAM_BW40_8812A, 0); + odm_write_2byte(dm, REG_CSI_RPT_PARAM_BW80_8812A, 0); } else { - odm_write_4byte(p_dm_odm, REG_BFMER1_INFO_8812A, 0); - odm_write_2byte(p_dm_odm, REG_BFMER1_INFO_8812A + 4, 0); - odm_write_2byte(p_dm_odm, REG_CSI_RPT_PARAM_BW20_8812A, 0); - odm_write_2byte(p_dm_odm, REG_CSI_RPT_PARAM_BW40_8812A, 0); - odm_write_2byte(p_dm_odm, REG_CSI_RPT_PARAM_BW80_8812A, 0); + odm_write_4byte(dm, REG_BFMER1_INFO_8812A, 0); + odm_write_2byte(dm, REG_BFMER1_INFO_8812A + 4, 0); + odm_write_2byte(dm, REG_CSI_RPT_PARAM_BW20_8812A, 0); + odm_write_2byte(dm, REG_CSI_RPT_PARAM_BW40_8812A, 0); + odm_write_2byte(dm, REG_CSI_RPT_PARAM_BW80_8812A, 0); } } if (beamformee_entry.beamform_entry_cap == BEAMFORMING_CAP_NONE) { - hal_txbf_jaguar_rf_mode(p_dm_odm, p_beamforming_info); + hal_txbf_jaguar_rf_mode(dm, beamforming_info); if (idx == 0) { - odm_write_2byte(p_dm_odm, REG_TXBF_CTRL_8812A, 0x0); - odm_write_2byte(p_dm_odm, REG_BFMEE_SEL_8812A, 0); + odm_write_2byte(dm, REG_TXBF_CTRL_8812A, 0x0); + odm_write_2byte(dm, REG_BFMEE_SEL_8812A, 0); } else { - odm_write_2byte(p_dm_odm, REG_TXBF_CTRL_8812A + 2, odm_read_2byte(p_dm_odm, REG_TXBF_CTRL_8812A + 2) & 0xF000); - odm_write_2byte(p_dm_odm, REG_BFMEE_SEL_8812A + 2, odm_read_2byte(p_dm_odm, REG_BFMEE_SEL_8812A + 2) & 0x60); + odm_write_2byte(dm, REG_TXBF_CTRL_8812A + 2, odm_read_2byte(dm, REG_TXBF_CTRL_8812A + 2) & 0xF000); + odm_write_2byte(dm, REG_BFMEE_SEL_8812A + 2, odm_read_2byte(dm, REG_BFMEE_SEL_8812A + 2) & 0x60); } } - } - -void -hal_txbf_jaguar_status( - void *p_dm_void, - u8 idx -) +void hal_txbf_jaguar_status( + void *dm_void, + u8 idx) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u16 beam_ctrl_val; - u32 beam_ctrl_reg; - struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm_odm->beamforming_info; - struct _RT_BEAMFORMEE_ENTRY beamform_entry = p_beam_info->beamformee_entry[idx]; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u16 beam_ctrl_val; + u32 beam_ctrl_reg; + struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; + struct _RT_BEAMFORMEE_ENTRY beamform_entry = beam_info->beamformee_entry[idx]; - if (phydm_acting_determine(p_dm_odm, phydm_acting_as_ibss)) + if (phydm_acting_determine(dm, phydm_acting_as_ibss)) beam_ctrl_val = beamform_entry.mac_id; else beam_ctrl_val = beamform_entry.p_aid; @@ -375,7 +369,7 @@ hal_txbf_jaguar_status( 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.beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED && 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) @@ -385,77 +379,70 @@ hal_txbf_jaguar_status( } else beam_ctrl_val &= ~(BIT(9) | BIT(10) | BIT(11)); - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] beam_ctrl_val = 0x%x!\n", __func__, beam_ctrl_val)); + PHYDM_DBG(dm, DBG_TXBF, "[%s] beam_ctrl_val = 0x%x!\n", __func__, + beam_ctrl_val); - odm_write_2byte(p_dm_odm, beam_ctrl_reg, beam_ctrl_val); + odm_write_2byte(dm, beam_ctrl_reg, beam_ctrl_val); } - - -void -hal_txbf_jaguar_fw_txbf( - void *p_dm_void, - u8 idx -) +void hal_txbf_jaguar_fw_txbf( + void *dm_void, + u8 idx) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm_odm->beamforming_info; - struct _RT_BEAMFORMEE_ENTRY *p_beam_entry = p_beam_info->beamformee_entry + idx; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; + struct _RT_BEAMFORMEE_ENTRY *p_beam_entry = beam_info->beamformee_entry + idx; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); + PHYDM_DBG(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_odm, idx); + hal_txbf_jaguar_download_ndpa(dm, idx); - hal_txbf_jaguar_fw_txbf_cmd(p_dm_odm); + hal_txbf_jaguar_fw_txbf_cmd(dm); } - -void -hal_txbf_jaguar_patch( - void *p_dm_void, - u8 operation -) +void hal_txbf_jaguar_patch( + void *dm_void, + u8 operation) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm_odm->beamforming_info; + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct _RT_BEAMFORMING_INFO *beam_info = &dm->beamforming_info; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); - if (p_beam_info->beamform_cap == BEAMFORMING_CAP_NONE) + if (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_odm, REG_SND_PTCL_CTRL_8812A, 0xC8); + odm_write_1byte(dm, REG_SND_PTCL_CTRL_8812A, 0xC8); else if (operation == SCAN_OPT_RESTORE) - odm_write_1byte(p_dm_odm, REG_SND_PTCL_CTRL_8812A, 0xCB); + odm_write_1byte(dm, REG_SND_PTCL_CTRL_8812A, 0xCB); #endif } -void -hal_txbf_jaguar_clk_8812a( - void *p_dm_void -) +void hal_txbf_jaguar_clk_8812a( + void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u16 u2btmp; - u8 count = 0, u1btmp; - struct _ADAPTER *adapter = p_dm_odm->adapter; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u16 u2btmp; + u8 count = 0, u1btmp; + void *adapter = dm->adapter; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); + PHYDM_DBG(dm, DBG_TXBF, "[%s] Start!\n", __func__); - if (*(p_dm_odm->p_is_scan_in_process)) { - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] return by Scan\n", __func__)); + if (*dm->is_scan_in_process) { + PHYDM_DBG(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_odm, REG_PCIE_CTRL_REG_8812A + 1, 0xFE); + if (dm->support_interface == ODM_ITRF_PCIE) + odm_write_1byte(dm, REG_PCIE_CTRL_REG_8812A + 1, 0xFE); #endif - /*Stop Usb TxDMA*/ +/*Stop Usb TxDMA*/ #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - RT_DISABLE_FUNC(adapter, DF_TX_BIT); + RT_DISABLE_FUNC((PADAPTER)adapter, DF_TX_BIT); PlatformReturnAllPendingTxPackets(adapter); #else rtw_write_port_cancel(adapter); @@ -463,7 +450,7 @@ hal_txbf_jaguar_clk_8812a( /*Wait TXFF empty*/ for (count = 0; count < 100; count++) { - u2btmp = odm_read_2byte(p_dm_odm, REG_TXPKT_EMPTY_8812A); + u2btmp = odm_read_2byte(dm, REG_TXPKT_EMPTY_8812A); u2btmp = u2btmp & 0xfff; if (u2btmp != 0xfff) { ODM_delay_ms(10); @@ -473,55 +460,52 @@ hal_txbf_jaguar_clk_8812a( } /*TX pause*/ - odm_write_1byte(p_dm_odm, REG_TXPAUSE_8812A, 0xFF); + odm_write_1byte(dm, REG_TXPAUSE_8812A, 0xFF); /*Wait TX state Machine OK*/ for (count = 0; count < 100; count++) { - if (odm_read_4byte(p_dm_odm, REG_SCH_TXCMD_8812A) != 0) + if (odm_read_4byte(dm, REG_SCH_TXCMD_8812A) != 0) continue; else break; } - /*Stop RX DMA path*/ - u1btmp = odm_read_1byte(p_dm_odm, REG_RXDMA_CONTROL_8812A); - odm_write_1byte(p_dm_odm, REG_RXDMA_CONTROL_8812A, u1btmp | BIT(2)); + u1btmp = odm_read_1byte(dm, REG_RXDMA_CONTROL_8812A); + odm_write_1byte(dm, REG_RXDMA_CONTROL_8812A, u1btmp | BIT(2)); for (count = 0; count < 100; count++) { - u1btmp = odm_read_1byte(p_dm_odm, REG_RXDMA_CONTROL_8812A); + u1btmp = odm_read_1byte(dm, REG_RXDMA_CONTROL_8812A); if (u1btmp & BIT(1)) break; else ODM_delay_ms(10); } - /*Disable clock*/ - odm_write_1byte(p_dm_odm, REG_SYS_CLKR_8812A + 1, 0xf0); - /*Disable 320M*/ - odm_write_1byte(p_dm_odm, REG_AFE_PLL_CTRL_8812A + 3, 0x8); - /*Enable 320M*/ - odm_write_1byte(p_dm_odm, REG_AFE_PLL_CTRL_8812A + 3, 0xa); - /*Enable clock*/ - odm_write_1byte(p_dm_odm, REG_SYS_CLKR_8812A + 1, 0xfc); - + /*@Disable clock*/ + odm_write_1byte(dm, REG_SYS_CLKR_8812A + 1, 0xf0); + /*@Disable 320M*/ + odm_write_1byte(dm, REG_AFE_PLL_CTRL_8812A + 3, 0x8); + /*@Enable 320M*/ + odm_write_1byte(dm, REG_AFE_PLL_CTRL_8812A + 3, 0xa); + /*@Enable clock*/ + odm_write_1byte(dm, REG_SYS_CLKR_8812A + 1, 0xfc); /*Release Tx pause*/ - odm_write_1byte(p_dm_odm, REG_TXPAUSE_8812A, 0); + odm_write_1byte(dm, REG_TXPAUSE_8812A, 0); - /*Enable RX DMA path*/ - u1btmp = odm_read_1byte(p_dm_odm, REG_RXDMA_CONTROL_8812A); - odm_write_1byte(p_dm_odm, REG_RXDMA_CONTROL_8812A, u1btmp & (~BIT(2))); + /*@Enable RX DMA path*/ + u1btmp = odm_read_1byte(dm, REG_RXDMA_CONTROL_8812A); + odm_write_1byte(dm, REG_RXDMA_CONTROL_8812A, u1btmp & (~BIT(2))); #if DEV_BUS_TYPE == RT_PCI_INTERFACE - /*Enable PCIe TxDMA*/ - odm_write_1byte(p_dm_odm, REG_PCIE_CTRL_REG_8812A + 1, 0); + /*@Enable PCIe TxDMA*/ + if (dm->support_interface == ODM_ITRF_PCIE) + odm_write_1byte(dm, REG_PCIE_CTRL_REG_8812A + 1, 0); #endif /*Start Usb TxDMA*/ - RT_ENABLE_FUNC(adapter, DF_TX_BIT); + RT_ENABLE_FUNC((PADAPTER)adapter, DF_TX_BIT); } #endif - - #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbfjaguar.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbfjaguar.h index 045dd6647806..9e5e09e1f345 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbfjaguar.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/haltxbfjaguar.h @@ -1,75 +1,79 @@ /* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ #ifndef __HAL_TXBF_JAGUAR_H__ #define __HAL_TXBF_JAGUAR_H__ #if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) -#if (BEAMFORMING_SUPPORT == 1) +#ifdef PHYDM_BEAMFORMING_SUPPORT -void -hal_txbf_8812a_set_ndpa_rate( - void *p_dm_void, - u8 BW, - u8 rate -); +void hal_txbf_8812a_set_ndpa_rate( + void *dm_void, + u8 BW, + u8 rate); +void hal_txbf_jaguar_enter( + void *dm_void, + u8 idx); -void -hal_txbf_jaguar_enter( - void *p_dm_void, - u8 idx -); +void hal_txbf_jaguar_leave( + void *dm_void, + u8 idx); +void hal_txbf_jaguar_status( + void *dm_void, + u8 idx); -void -hal_txbf_jaguar_leave( - void *p_dm_void, - u8 idx -); +void hal_txbf_jaguar_fw_txbf( + void *dm_void, + u8 idx); +void hal_txbf_jaguar_patch( + void *dm_void, + u8 operation); -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 -); +void hal_txbf_jaguar_clk_8812a( + void *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) +#define hal_txbf_8812a_set_ndpa_rate(dm_void, BW, rate) +#define hal_txbf_jaguar_enter(dm_void, idx) +#define hal_txbf_jaguar_leave(dm_void, idx) +#define hal_txbf_jaguar_status(dm_void, idx) +#define hal_txbf_jaguar_fw_txbf(dm_void, idx) +#define hal_txbf_jaguar_patch(dm_void, operation) +#define hal_txbf_jaguar_clk_8812a(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) +#define hal_txbf_8812a_set_ndpa_rate(dm_void, BW, rate) +#define hal_txbf_jaguar_enter(dm_void, idx) +#define hal_txbf_jaguar_leave(dm_void, idx) +#define hal_txbf_jaguar_status(dm_void, idx) +#define hal_txbf_jaguar_fw_txbf(dm_void, idx) +#define hal_txbf_jaguar_patch(dm_void, operation) +#define hal_txbf_jaguar_clk_8812a(dm_void) #endif -#endif /* #ifndef __HAL_TXBF_JAGUAR_H__ */ +#endif /* @#ifndef __HAL_TXBF_JAGUAR_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/phydm_hal_txbf_api.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/phydm_hal_txbf_api.c index 6f1f74b9cce6..479ede5f3ebf 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/phydm_hal_txbf_api.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/phydm_hal_txbf_api.c @@ -1,69 +1,84 @@ /* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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*/ +#if (RTL8822B_SUPPORT == 1 || RTL8192F_SUPPORT == 1 ||\ + RTL8822C_SUPPORT == 1 || RTL8198F_SUPPORT == 1 || RTL8814B_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 -) +u8 phydm_get_ndpa_rate(void *dm_void) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; - u8 ndpa_rate = ODM_RATE6M; + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 ndpa_rate = ODM_RATE6M; - if (p_dm_odm->rssi_min >= 30) /*link RSSI > 30%*/ + if (dm->rssi_min >= 30) /*@link RSSI > 30%*/ ndpa_rate = ODM_RATE24M; - else if (p_dm_odm->rssi_min <= 25) + else if (dm->rssi_min <= 25) ndpa_rate = ODM_RATE6M; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_TRACE, ("[%s] ndpa_rate = 0x%x\n", __func__, ndpa_rate)); + PHYDM_DBG(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 phydm_get_beamforming_sounding_info(void *dm_void, u16 *throughput, + u8 total_bfee_num, u8 *tx_rate) { - u8 idx = 0; - u8 soundingdecision = 0xff; - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 idx = 0; + u8 snddecision = 0xff; + struct dm_struct *dm = (struct dm_struct *)dm_void; for (idx = 0; idx < total_bfee_num; idx++) { - if (((tx_rate[idx] >= ODM_RATEVHTSS3MCS7) && (tx_rate[idx] <= ODM_RATEVHTSS3MCS9))) - soundingdecision = soundingdecision & ~(1 << idx); + if (dm->support_ic_type & (ODM_RTL8814A)) { + if ((tx_rate[idx] >= ODM_RATEVHTSS3MCS7 && + tx_rate[idx] <= ODM_RATEVHTSS3MCS9)) + snddecision = snddecision & ~(1 << idx); + } else if (dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8822C | + ODM_RTL8812 | ODM_RTL8192F)) { + if ((tx_rate[idx] >= ODM_RATEVHTSS2MCS7 && + tx_rate[idx] <= ODM_RATEVHTSS2MCS9)) + snddecision = snddecision & ~(1 << idx); + } else if (dm->support_ic_type & (ODM_RTL8814B)) { + if ((tx_rate[idx] >= ODM_RATEVHTSS4MCS7 && + tx_rate[idx] <= ODM_RATEVHTSS4MCS9)) + snddecision = snddecision & ~(1 << idx); + } } for (idx = 0; idx < total_bfee_num; idx++) { - if (troughput[idx] <= 10) - soundingdecision = soundingdecision & ~(1 << idx); + if (throughput[idx] <= 10) + snddecision = snddecision & ~(1 << idx); } - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_TRACE, ("[%s] soundingdecision = 0x%x\n", __func__, soundingdecision)); - - return soundingdecision; + PHYDM_DBG(dm, DBG_TXBF, "[%s] soundingdecision = 0x%x\n", __func__, + snddecision); + return snddecision; } /*this function is only used for BFer*/ -u8 -phydm_get_mu_bfee_snding_decision( - void *p_dm_void, - u16 throughput -) +u8 phydm_get_mu_bfee_snding_decision(void *dm_void, u16 throughput) { - u8 snding_score = 0; - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 snding_score = 0; + struct dm_struct *dm = (struct dm_struct *)dm_void; /*throughput unit is Mbps*/ if (throughput >= 500) @@ -89,31 +104,26 @@ phydm_get_mu_bfee_snding_decision( else snding_score = 0; - ODM_RT_TRACE(p_dm_odm, PHYDM_COMP_TXBF, ODM_DBG_TRACE, ("[%s] snding_score = 0x%x\n", __func__, snding_score)); + PHYDM_DBG(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 -) +u8 beamforming_get_htndp_tx_rate(void *dm_void, u8 bfer_str_num) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; u8 nr_index = 0; u8 ndp_tx_rate; - /*Find nr*/ +/*@Find nr*/ #if (RTL8814A_SUPPORT == 1) - if (p_dm_odm->support_ic_type & ODM_RTL8814A) - nr_index = tx_bf_nr(hal_txbf_8814a_get_ntx(p_dm_odm), comp_steering_num_of_bfer); + if (dm->support_ic_type & ODM_RTL8814A) + nr_index = tx_bf_nr(hal_txbf_8814a_get_ntx(dm), bfer_str_num); else #endif - nr_index = tx_bf_nr(1, comp_steering_num_of_bfer); + nr_index = tx_bf_nr(1, bfer_str_num); switch (nr_index) { case 1: @@ -134,25 +144,20 @@ beamforming_get_htndp_tx_rate( } return ndp_tx_rate; - } -u8 -beamforming_get_vht_ndp_tx_rate( - void *p_dm_void, - u8 comp_steering_num_of_bfer -) +u8 beamforming_get_vht_ndp_tx_rate(void *dm_void, u8 bfer_str_num) { - struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct dm_struct *dm = (struct dm_struct *)dm_void; u8 nr_index = 0; u8 ndp_tx_rate; - /*Find nr*/ +/*@Find nr*/ #if (RTL8814A_SUPPORT == 1) - if (p_dm_odm->support_ic_type & ODM_RTL8814A) - nr_index = tx_bf_nr(hal_txbf_8814a_get_ntx(p_dm_odm), comp_steering_num_of_bfer); + if (dm->support_ic_type & ODM_RTL8814A) + nr_index = tx_bf_nr(hal_txbf_8814a_get_ntx(dm), bfer_str_num); else #endif - nr_index = tx_bf_nr(1, comp_steering_num_of_bfer); + nr_index = tx_bf_nr(1, bfer_str_num); switch (nr_index) { case 1: @@ -173,8 +178,452 @@ beamforming_get_vht_ndp_tx_rate( } return ndp_tx_rate; - } #endif +#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT +/*this function is only used for BFer*/ +void phydm_txbf_rfmode(void *dm_void, u8 su_bfee_cnt, u8 mu_bfee_cnt) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 i; + + if (dm->rf_type == RF_1T1R) + return; +#if (RTL8822C_SUPPORT) + if (dm->support_ic_type == ODM_RTL8822C) { + if (su_bfee_cnt > 0 || mu_bfee_cnt > 0) { + /*Path A ==================*/ + /*RF mode table write enable*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, BIT(19), 0x1); + /*Select RX mode*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, 0xF, 3); + /*Set Table data*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0x3e, 0x3, 0x2); + /*Set Table data*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, 0xfffff, + 0x65AFF); + /*RF mode table write disable*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, BIT(19), 0x0); + + /*Path B ==================*/ + /*RF mode table write enable*/ + odm_set_rf_reg(dm, RF_PATH_B, RF_0xef, BIT(19), 0x1); + /*Select RX mode*/ + odm_set_rf_reg(dm, RF_PATH_B, RF_0x33, 0xF, 3); + /*Set Table data*/ + odm_set_rf_reg(dm, RF_PATH_B, RF_0x3f, 0xfffff, + 0x996BF); + /*Select Standby mode*/ + odm_set_rf_reg(dm, RF_PATH_B, RF_0x33, 0xF, 1); + /*Set Table data*/ + odm_set_rf_reg(dm, RF_PATH_B, RF_0x3f, 0xfffff, + 0x99230); + /*RF mode table write disable*/ + odm_set_rf_reg(dm, RF_PATH_B, RF_0xef, BIT(19), 0x0); + } + + /*@if Nsts > Nc, don't apply V matrix*/ + odm_set_bb_reg(dm, R_0x1e24, BIT(11), 1); + + if (su_bfee_cnt > 0 || mu_bfee_cnt > 0) { + /*@enable BB TxBF ant mapping register*/ + odm_set_bb_reg(dm, R_0x1e24, BIT(28) | BIT29, 0x2); + odm_set_bb_reg(dm, R_0x1e24, BIT(30), 1); + + /* logic mapping */ + /* TX BF logic map and TX path en for Nsts = 1~2 */ + odm_set_bb_reg(dm, R_0x820, 0xff, 0x33); + odm_set_bb_reg(dm, R_0x1e2c, 0xffff, 0x404); + odm_set_bb_reg(dm, R_0x820, 0xffff0000, 0x33); + odm_set_bb_reg(dm, R_0x1e30, 0xffff, 0x404); + } else { + /*@Disable BB TxBF ant mapping register*/ + odm_set_bb_reg(dm, R_0x1e24, BIT(28) | BIT29, 0x0); + odm_set_bb_reg(dm, R_0x1e24, BIT(31), 0); + /*@1SS~2ss A, AB*/ + odm_set_bb_reg(dm, R_0x820, 0xff, 0x31); + odm_set_bb_reg(dm, R_0x1e2c, 0xffff, 0x400); + } + } #endif +#if (RTL8812F_SUPPORT) + if (dm->support_ic_type == ODM_RTL8812F) { + if (su_bfee_cnt > 0 || mu_bfee_cnt > 0) { + /*Path A ==================*/ + /*RF mode table write enable*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, BIT(19), 0x1); + /*Select RX mode*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, 0xF, 3); + /*Set Table data*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0x3e, 0x3, 0x3); + /*Set Table data*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, 0xfffff, + 0x61AFE); + /*RF mode table write disable*/ + odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, BIT(19), 0x0); + + /*Path B ==================*/ + /*RF mode table write enable*/ + odm_set_rf_reg(dm, RF_PATH_B, RF_0xef, BIT(19), 0x1); + /*Select RX mode*/ + odm_set_rf_reg(dm, RF_PATH_B, RF_0x33, 0xF, 3); + /*Set Table data*/ + odm_set_rf_reg(dm, RF_PATH_B, RF_0x3f, 0xfffff, + 0xD86BF); + /*RF mode table write disable*/ + odm_set_rf_reg(dm, RF_PATH_B, RF_0xef, BIT(19), 0x0); + } + + /*@if Nsts > Nc, don't apply V matrix*/ + odm_set_bb_reg(dm, R_0x1e24, BIT(11), 1); + + if (su_bfee_cnt > 0 || mu_bfee_cnt > 0) { + /*@enable BB TxBF ant mapping register*/ + odm_set_bb_reg(dm, R_0x1e24, BIT(28) | BIT29, 0x2); + odm_set_bb_reg(dm, R_0x1e24, BIT(30), 1); + + /* logic mapping */ + /* TX BF logic map and TX path en for Nsts = 1~2 */ + odm_set_bb_reg(dm, R_0x820, 0xff, 0x33); + odm_set_bb_reg(dm, R_0x1e2c, 0xffff, 0x404); + odm_set_bb_reg(dm, R_0x820, 0xffff0000, 0x33); + odm_set_bb_reg(dm, R_0x1e30, 0xffff, 0x404); + } else { + /*@Disable BB TxBF ant mapping register*/ + odm_set_bb_reg(dm, R_0x1e24, BIT(28) | BIT29, 0x0); + odm_set_bb_reg(dm, R_0x1e24, BIT(31), 0); + /*@1SS~2ss A, AB*/ + odm_set_bb_reg(dm, R_0x820, 0xff, 0x31); + odm_set_bb_reg(dm, R_0x1e2c, 0xffff, 0x400); + } + } +#endif +#if (RTL8814B_SUPPORT) + if (dm->support_ic_type == ODM_RTL8814B) { + if (su_bfee_cnt > 0 || mu_bfee_cnt > 0) { + for (i = RF_PATH_A; i <= RF_PATH_D; i++) { + /*RF mode table write enable*/ + odm_set_rf_reg(dm, (enum rf_path)i, RF_0xef, + BIT(19), 0x1); + /*Select RX mode*/ + odm_set_rf_reg(dm, (enum rf_path)i, RF_0x33, + 0xF, 2); + /*Set Table data*/ + odm_set_rf_reg(dm, (enum rf_path)i, RF_0x3e, + 0xfffff, 0x3fc); + /*Set Table data*/ + odm_set_rf_reg(dm, (enum rf_path)i, RF_0x3f, + 0xfffff, 0x280f7); + /*Select RX mode*/ + odm_set_rf_reg(dm, (enum rf_path)i, RF_0x33, + 0xF, 3); + /*Set Table data*/ + odm_set_rf_reg(dm, (enum rf_path)i, RF_0x3e, + 0xfffff, 0x365); + /*Set Table data*/ + odm_set_rf_reg(dm, (enum rf_path)i, RF_0x3f, + 0xfffff, 0xafcf7); + /*RF mode table write disable*/ + odm_set_rf_reg(dm, (enum rf_path)i, RF_0xef, + BIT(19), 0x0); + } + } + /*@if Nsts > Nc, don't apply V matrix*/ + odm_set_bb_reg(dm, R_0x1e24, BIT(11), 1); + + if (su_bfee_cnt > 0 || mu_bfee_cnt > 0) { + /*@enable BB TxBF ant mapping register*/ + odm_set_bb_reg(dm, R_0x1e24, BIT(28) | BIT29, 0x2); + odm_set_bb_reg(dm, R_0x1e24, BIT(30), 1); + + /* logic mapping */ + /* TX BF logic map and TX path en for Nsts = 1~4 */ + odm_set_bb_reg(dm, R_0x820, 0xffff0000, 0xffff); + /*verification path-AC*/ + odm_set_bb_reg(dm, R_0x1e30, 0xffffffff, 0xe4e4e4e4); + } else { + /*@Disable BB TxBF ant mapping register*/ + odm_set_bb_reg(dm, R_0x1e24, BIT(28) | BIT29, 0x0); + odm_set_bb_reg(dm, R_0x1e24, BIT(31), 0); + /*@1SS~4ss A, AB, ABC, ABCD*/ + odm_set_bb_reg(dm, R_0x820, 0xffff, 0xf731); + odm_set_bb_reg(dm, R_0x1e2c, 0xffffffff, 0xe4240400); + } + } +#endif +#if (RTL8198F_SUPPORT) + if (dm->support_ic_type == ODM_RTL8198F) { + if (su_bfee_cnt > 0 || mu_bfee_cnt > 0) { + for (i = RF_PATH_A; i <= RF_PATH_D; i++) { + /*RF mode table write enable*/ + odm_set_rf_reg(dm, (enum rf_path)i, RF_0xef, + BIT(19), 0x1); + /*Select RX mode*/ + odm_set_rf_reg(dm, (enum rf_path)i, RF_0x30, + 0xfffff, 0x18000); + /*Set Table data*/ + odm_set_rf_reg(dm, (enum rf_path)i, RF_0x31, + 0xfffff, 0x4f); + /*Select RX mode*/ + odm_set_rf_reg(dm, (enum rf_path)i, RF_0x32, + 0xfffff, 0x71fc0); + /*RF mode table write disable*/ + odm_set_rf_reg(dm, (enum rf_path)i, RF_0xef, + BIT(19), 0x0); + } + } + /*@if Nsts > Nc, don't apply V matrix*/ + odm_set_bb_reg(dm, R_0x1e24, BIT(11), 1); + + if (su_bfee_cnt > 0 || mu_bfee_cnt > 0) { + /*@enable BB TxBF ant mapping register*/ + odm_set_bb_reg(dm, R_0x1e24, BIT(28) | BIT29, 0x2); + odm_set_bb_reg(dm, R_0x1e24, BIT(30), 1); + + /* logic mapping */ + /* TX BF logic map and TX path en for Nsts = 1~4 */ + odm_set_bb_reg(dm, R_0x820, 0xffff0000, 0xffff); + odm_set_bb_reg(dm, R_0x1e30, 0xffffffff, 0xe4e4e4e4); + } else { + /*@Disable BB TxBF ant mapping register*/ + odm_set_bb_reg(dm, R_0x1e24, BIT(28) | BIT29, 0x0); + odm_set_bb_reg(dm, R_0x1e24, BIT(31), 0); + /*@1SS~4ss A, AB, ABC, ABCD*/ + odm_set_bb_reg(dm, R_0x820, 0xffff, 0xf731); + odm_set_bb_reg(dm, R_0x1e2c, 0xffffffff, 0xe4240400); + } + } +#endif +} + +void phydm_mu_rsoml_reset(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_bf_rate_info_jgr3 *rateinfo = &dm->bf_rate_info_jgr3; + + PHYDM_DBG(dm, DBG_TXBF, "[MU RSOML] %s cnt reset\n", __func__); + + odm_memory_set(dm, &rateinfo->num_mu_vht_pkt[0], 0, VHT_RATE_NUM * 2); + odm_memory_set(dm, &rateinfo->num_qry_vht_pkt[0], 0, VHT_RATE_NUM * 2); +} + +void phydm_mu_rsoml_init(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_bf_rate_info_jgr3 *rateinfo = &dm->bf_rate_info_jgr3; + + PHYDM_DBG(dm, DBG_TXBF, "[MU RSOML] %s - cnt init\n", __func__); + + rateinfo->enable = 1; + rateinfo->mu_ratio_th = 30; + rateinfo->pre_mu_ratio = 0; + phydm_mu_rsoml_reset(dm); +} + +void phydm_mu_rsoml_decision(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_bf_rate_info_jgr3 *rateinfo = &dm->bf_rate_info_jgr3; + u8 offset = 0; + u32 mu_ratio = 0; + u32 su_pkt = 0; + u32 mu_pkt = 0; + u32 total_pkt = 0; + + PHYDM_DBG(dm, DBG_TXBF, "[MU RSOML] RSOML Decision eanble: %d\n", + rateinfo->enable); + + if (!rateinfo->enable) + return; + + for (offset = 0; offset < VHT_RATE_NUM; offset++) { + mu_pkt += rateinfo->num_mu_vht_pkt[offset]; + su_pkt += rateinfo->num_qry_vht_pkt[offset]; + } + total_pkt = su_pkt + mu_pkt; + + if (total_pkt == 0) + mu_ratio = 0; + else + mu_ratio = (mu_pkt * 100) / total_pkt; // unit:% + + PHYDM_DBG(dm, DBG_TXBF, "[MU RSOML] MU rx ratio: %d, total pkt: %d\n", + mu_ratio, total_pkt); + + if (mu_ratio > rateinfo->mu_ratio_th && + rateinfo->pre_mu_ratio > rateinfo->mu_ratio_th) + PHYDM_DBG(dm, DBG_TXBF, "[MU RSOML] RSOML status remain\n"); + else if (mu_ratio <= rateinfo->mu_ratio_th && + rateinfo->pre_mu_ratio <= rateinfo->mu_ratio_th) + PHYDM_DBG(dm, DBG_TXBF, "[MU RSOML] RSOML status remain\n"); + else if (mu_ratio > rateinfo->mu_ratio_th) + odm_set_bb_reg(dm, R_0xc00, BIT(26), 0); + else + odm_set_bb_reg(dm, R_0xc00, BIT(26), 1); + + rateinfo->pre_mu_ratio = mu_ratio; + + phydm_mu_rsoml_reset(dm); +} + +void phydm_txbf_avoid_hang(void *dm_void) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + + /* avoid CCK CCA hang when the BF mode */ + odm_set_bb_reg(dm, R_0x1e6c, 0x100000, 0x1); +} + +#if (RTL8814B_SUPPORT == 1) +void phydm_txbf_80p80_rfmode(void *dm_void, u8 su_bfee_cnt, u8 mu_bfee_cnt) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + u8 i; + + if (dm->rf_type == RF_1T1R) + return; + + if (su_bfee_cnt > 0 || mu_bfee_cnt > 0) { + for (i = RF_PATH_A; i <= RF_PATH_D; i += 3) { + /*RF mode table write enable*/ + odm_set_rf_reg(dm, (enum rf_path)i, RF_0xef, BIT(19), + 0x1); + /*Select RX mode*/ + odm_set_rf_reg(dm, (enum rf_path)i, RF_0x33, 0xF, 2); + /*Set Table data*/ + odm_set_rf_reg(dm, (enum rf_path)i, RF_0x3e, 0xfffff, + 0x3fc); + /*Set Table data*/ + odm_set_rf_reg(dm, (enum rf_path)i, RF_0x3f, 0xfffff, + 0x280f7); + /*Select RX mode*/ + odm_set_rf_reg(dm, (enum rf_path)i, RF_0x33, 0xF, 3); + /*Set Table data*/ + odm_set_rf_reg(dm, (enum rf_path)i, RF_0x3e, 0xfffff, + 0x365); + /*Set Table data*/ + odm_set_rf_reg(dm, (enum rf_path)i, RF_0x3f, 0xfffff, + 0xafcf7); + /*RF mode table write disable*/ + odm_set_rf_reg(dm, (enum rf_path)i, RF_0xef, BIT(19), + 0x0); + } + for (i = RF_PATH_B; i <= RF_PATH_C; i++) { + /*RF mode table write enable*/ + odm_set_rf_reg(dm, (enum rf_path)i, RF_0xef, BIT(19), + 0x1); + /*Select RX mode*/ + odm_set_rf_reg(dm, (enum rf_path)i, RF_0x33, 0xF, 2); + /*Set Table data*/ + odm_set_rf_reg(dm, (enum rf_path)i, RF_0x3f, 0xfffff, + 0x280c7); + /*Set Table data*/ + odm_set_rf_reg(dm, (enum rf_path)i, RF_0x3f, 0xfffff, + 0x280c7); + /*Select RX mode*/ + odm_set_rf_reg(dm, (enum rf_path)i, RF_0x33, 0xF, 3); + /*Set Table data*/ + odm_set_rf_reg(dm, (enum rf_path)i, RF_0x3e, 0xfffff, + 0x365); + /*Set Table data*/ + odm_set_rf_reg(dm, (enum rf_path)i, RF_0x3f, 0xfffff, + 0xafcc7); + /*RF mode table write disable*/ + odm_set_rf_reg(dm, (enum rf_path)i, RF_0xef, BIT(19), + 0x0); + } + } + /*@if Nsts > Nc, don't apply V matrix*/ + odm_set_bb_reg(dm, R_0x1e24, BIT(11), 1); + + if (su_bfee_cnt > 0 || mu_bfee_cnt > 0) { + /*@enable BB TxBF ant mapping register*/ + odm_set_bb_reg(dm, R_0x1e24, BIT(28) | BIT29, 0x2); + odm_set_bb_reg(dm, R_0x1e24, BIT(30), 1); + + /* logic mapping */ + /* TX BF logic map and TX path en for Nsts = 1~2 */ + odm_set_bb_reg(dm, R_0x820, 0xff0000, 0x33); /*seg0*/ + odm_set_bb_reg(dm, R_0x824, 0xff00, 0xcc); /*seg1*/ + odm_set_bb_reg(dm, R_0x1e30, 0xffff, 0xe4e4); + + } else { + /*@Disable BB TxBF ant mapping register*/ + odm_set_bb_reg(dm, R_0x1e24, BIT(28) | BIT29, 0x0); + odm_set_bb_reg(dm, R_0x1e24, BIT(31), 0); + /*@1SS~2ss A, AB*/ + odm_set_bb_reg(dm, R_0x820, 0xff, 0x31); /*seg0*/ + odm_set_bb_reg(dm, R_0x824, 0xff, 0xc8); /*seg1*/ + odm_set_bb_reg(dm, R_0x1e2c, 0xffff, 0xe420); + } +} +#endif +#endif /*PHYSTS_3RD_TYPE_IC*/ + +void phydm_bf_debug(void *dm_void, char input[][16], u32 *_used, char *output, + u32 *_out_len) +{ + struct dm_struct *dm = (struct dm_struct *)dm_void; + char help[] = "-h"; + u32 var1[3] = {0}; + u32 i; + + if ((strcmp(input[1], help) == 0)) { + PDM_SNPF(*_out_len, *_used, output + *_used, *_out_len - *_used, + "{BF ver1 :0}, {NO applyV:0; applyV:1; default:2}\n"); + PDM_SNPF(*_out_len, *_used, output + *_used, *_out_len - *_used, + "{MU RSOML:1}, {MU enable:1/0}, {MU Ratio:40}\n"); + return; + } + for (i = 0; i < 3; i++) { + if (input[i + 1]) + PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); + } + if (var1[0] == 0) { + #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + #ifdef PHYDM_BEAMFORMING_SUPPORT + struct _RT_BEAMFORMING_INFO *beamforming_info = NULL; + + beamforming_info = &dm->beamforming_info; + + if (var1[1] == 0) { + beamforming_info->apply_v_matrix = false; + beamforming_info->snding3ss = true; + PDM_SNPF(*_out_len, *_used, output + *_used, + *_out_len - *_used, + "\r\n dont apply V matrix and 3SS 789 snding\n"); + } else if (var1[1] == 1) { + beamforming_info->apply_v_matrix = true; + beamforming_info->snding3ss = true; + PDM_SNPF(*_out_len, *_used, output + *_used, + *_out_len - *_used, + "\r\n apply V matrix and 3SS 789 snding\n"); + } else if (var1[1] == 2) { + beamforming_info->apply_v_matrix = true; + beamforming_info->snding3ss = false; + PDM_SNPF(*_out_len, *_used, output + *_used, + *_out_len - *_used, + "\r\n default txbf setting\n"); + } else { + PDM_SNPF(*_out_len, *_used, output + *_used, + *_out_len - *_used, + "\r\n unknown cmd!!\n"); + } + #endif + #endif + } else if (var1[0] == 1) { + #ifdef PHYDM_IC_JGR3_SERIES_SUPPORT + struct dm_struct *dm = (struct dm_struct *)dm_void; + struct phydm_bf_rate_info_jgr3 *bfinfo = &dm->bf_rate_info_jgr3; + + bfinfo->enable = (u8)var1[1]; + bfinfo->mu_ratio_th = (u8)var1[2]; + PDM_SNPF(*_out_len, *_used, output + *_used, *_out_len - *_used, + "[MU RSOML] enable= %d, MU ratio TH= %d\n", + bfinfo->enable, bfinfo->mu_ratio_th); + #endif + } +} + +#endif /*CONFIG_BB_TXBF_API*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/phydm_hal_txbf_api.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/phydm_hal_txbf_api.h index 93fb784d8b95..97d1c7de4154 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/phydm_hal_txbf_api.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/txbf/phydm_hal_txbf_api.h @@ -1,69 +1,86 @@ -/********************************************************************************/ -/**/ -/*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__ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + * The full GNU General Public License is included in this distribution in the + * file called LICENSE. + * + * Contact Information: + * wlanfae + * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park, + * Hsinchu 300, Taiwan. + * + * Larry Finger + * + *****************************************************************************/ +#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) +#if defined(DM_ODM_CE_MAC80211) +#define tx_bf_nr(a, b) ({ \ + u8 __tx_bf_nr_a = (a); \ + u8 __tx_bf_nr_b = (b); \ + ((__tx_bf_nr_a > __tx_bf_nr_b) ? (__tx_bf_nr_b) : (__tx_bf_nr_a)); }) +#else #define tx_bf_nr(a, b) ((a > b) ? (b) : (a)) +#endif -u8 -beamforming_get_htndp_tx_rate( - void *p_dm_void, - u8 comp_steering_num_of_bfer -); +u8 beamforming_get_htndp_tx_rate(void *dm_void, u8 bfer_str_num); -u8 -beamforming_get_vht_ndp_tx_rate( - void *p_dm_void, - u8 comp_steering_num_of_bfer -); +u8 beamforming_get_vht_ndp_tx_rate(void *dm_void, u8 bfer_str_num); #endif -#if (RTL8822B_SUPPORT == 1) -u8 -phydm_get_beamforming_sounding_info( - void *p_dm_void, - u16 *troughput, - u8 total_bfee_num, - u8 *tx_rate -); +#if (RTL8822B_SUPPORT == 1 || RTL8822C_SUPPORT == 1 || RTL8192F_SUPPORT == 1 ||\ + RTL8814B_SUPPORT == 1 || RTL8198F_SUPPORT == 1) -u8 -phydm_get_ndpa_rate( - void *p_dm_void -); +u8 phydm_get_beamforming_sounding_info(void *dm_void, u16 *throughput, + u8 total_bfee_num, u8 *tx_rate); +u8 phydm_get_ndpa_rate(void *dm_void); -u8 -phydm_get_mu_bfee_snding_decision( - void *p_dm_void, - u16 throughput -); +u8 phydm_get_mu_bfee_snding_decision(void *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) +#define phydm_get_beamforming_sounding_info(dm, tp, bfee_num, rate) 0 +#define phydm_get_ndpa_rate(dm) +#define phydm_get_mu_bfee_snding_decision(dm, tp) #endif +#ifdef PHYDM_IC_JGR3_SERIES_SUPPORT +struct phydm_bf_rate_info_jgr3 { + u8 enable; + u8 mu_ratio_th; + u32 pre_mu_ratio; + u16 num_mu_vht_pkt[VHT_RATE_NUM]; + u16 num_qry_vht_pkt[VHT_RATE_NUM]; +}; + +/*this function is only used for BFer*/ +void phydm_txbf_rfmode(void *dm_void, u8 su_bfee_cnt, u8 mu_bfee_cnt); +void phydm_txbf_avoid_hang(void *dm_void); +void phydm_mu_rsoml_init(void *dm_void); +void phydm_mu_rsoml_decision(void *dm_void); + +#if (RTL8814B_SUPPORT == 1) +void phydm_txbf_80p80_rfmode(void *dm_void, u8 su_bfee_cnt, u8 mu_bfee_cnt); +#endif + +#endif /*#PHYDM_IC_JGR3_SERIES_SUPPORT*/ +void phydm_bf_debug(void *dm_void, char input[][16], u32 *_used, char *output, + u32 *_out_len); #endif #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/Hal8188EPwrSeq.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/Hal8188EPwrSeq.c index 55cdefa88b92..cd9b815950bb 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/Hal8188EPwrSeq.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/Hal8188EPwrSeq.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 "Hal8188EPwrSeq.h" #include diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/hal8188e_s_fw.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/hal8188e_s_fw.c index ae10bf9d9617..8674a5a2b1e7 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/hal8188e_s_fw.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/hal8188e_s_fw.c @@ -1,22 +1,18 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** -* -* Copyright(c) 2007 - 2016 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 "drv_types.h" diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/hal8188e_s_fw.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/hal8188e_s_fw.h index 194615eadb3e..253e65da0585 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/hal8188e_s_fw.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/hal8188e_s_fw.h @@ -1,22 +1,18 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** -* -* Copyright(c) 2007 - 2016 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 _FW_HEADER_8188E_S_H #define _FW_HEADER_8188E_S_H diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/hal8188e_t_fw.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/hal8188e_t_fw.c index 16a4e935fd32..b31f38cd0fe2 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/hal8188e_t_fw.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/hal8188e_t_fw.c @@ -1,22 +1,18 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** -* -* Copyright(c) 2007 - 2016 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 "drv_types.h" diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/hal8188e_t_fw.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/hal8188e_t_fw.h index c396e82e128d..d5ce02b963e8 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/hal8188e_t_fw.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/hal8188e_t_fw.h @@ -1,22 +1,18 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** -* -* Copyright(c) 2007 - 2016 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 _FW_HEADER_8188E_T_H #define _FW_HEADER_8188E_T_H diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/rtl8188e_cmd.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/rtl8188e_cmd.c index 847525be5fbe..8244f4bf1d84 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/rtl8188e_cmd.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/rtl8188e_cmd.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 _RTL8188E_CMD_C_ #include @@ -69,7 +65,7 @@ s32 FillH2CCmd_88E(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer) u8 h2c_box_num; u32 msgbox_addr; u32 msgbox_ex_addr = 0; - u8 cmd_idx, ext_cmd_len; + u8 cmd_idx; u32 h2c_cmd = 0; u32 h2c_cmd_ex = 0; s32 ret = _FAIL; @@ -78,7 +74,7 @@ s32 FillH2CCmd_88E(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer) padapter = GET_PRIMARY_ADAPTER(padapter); pHalData = GET_HAL_DATA(padapter); - if (padapter->bFWReady == _FALSE) { + if (pHalData->bFWReady == _FALSE) { RTW_INFO("FillH2CCmd_88E(): return H2C cmd because fw is not ready\n"); return ret; } @@ -107,19 +103,18 @@ s32 FillH2CCmd_88E(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer) _rtw_memcpy((u8 *)(&h2c_cmd) + 1, pCmdBuffer, CmdLen); else { _rtw_memcpy((u8 *)(&h2c_cmd) + 1, pCmdBuffer, 3); - ext_cmd_len = CmdLen - 3; - _rtw_memcpy((u8 *)(&h2c_cmd_ex), pCmdBuffer + 3, ext_cmd_len); - - /* Write Ext command */ - msgbox_ex_addr = REG_HMEBOX_EXT_0 + (h2c_box_num * RTL88E_EX_MESSAGE_BOX_SIZE); -#ifdef CONFIG_H2C_EF - for (cmd_idx = 0; cmd_idx < ext_cmd_len; cmd_idx++) - rtw_write8(padapter, msgbox_ex_addr + cmd_idx, *((u8 *)(&h2c_cmd_ex) + cmd_idx)); -#else - h2c_cmd_ex = le32_to_cpu(h2c_cmd_ex); - rtw_write32(padapter, msgbox_ex_addr, h2c_cmd_ex); -#endif + _rtw_memcpy((u8 *)(&h2c_cmd_ex), pCmdBuffer + 3, CmdLen - 3); } + /* Write Ext command */ + msgbox_ex_addr = REG_HMEBOX_EXT_0 + (h2c_box_num * RTL88E_EX_MESSAGE_BOX_SIZE); +#ifdef CONFIG_H2C_EF + for (cmd_idx = 0; cmd_idx < RTL88E_EX_MESSAGE_BOX_SIZE; cmd_idx++) + rtw_write8(padapter, msgbox_ex_addr + cmd_idx, *((u8 *)(&h2c_cmd_ex) + cmd_idx)); +#else + h2c_cmd_ex = le32_to_cpu(h2c_cmd_ex); + rtw_write32(padapter, msgbox_ex_addr, h2c_cmd_ex); +#endif + /* Write command */ msgbox_addr = REG_HMEBOX_0 + (h2c_box_num * RTL88E_MESSAGE_BOX_SIZE); #ifdef CONFIG_H2C_EF @@ -180,100 +175,15 @@ u8 rtl8192c_set_FwSelectSuspend_cmd(_adapter *padapter , u8 bfwpoll, u16 period) } #endif /* CONFIG_AUTOSUSPEND && SUPPORT_HW_RFOFF_DETECTED */ #endif -u8 rtl8188e_set_rssi_cmd(_adapter *padapter, u8 *param) -{ - u8 res = _SUCCESS; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); - - if (pHalData->fw_ractrl == _FALSE) { - RTW_INFO("==>%s fw dont support RA\n", __FUNCTION__); - return _FAIL; - } - - *((u32 *) param) = cpu_to_le32(*((u32 *) param)); - FillH2CCmd_88E(padapter, H2C_RSSI_REPORT, 3, param); - - - return res; -} - -u8 rtl8188e_set_raid_cmd(_adapter *padapter, u32 bitmap, u8 *arg, u8 bw) -{ - u8 res = _SUCCESS; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); - struct sta_info *psta = NULL; - struct macid_ctl_t *macid_ctl = &padapter->dvobj->macid_ctl; - u8 macid, init_rate, raid, shortGIrate = _FALSE; - u8 H2CCommand[7] = {0}; - u8 ignore_bw = _FALSE; - - if (pHalData->fw_ractrl == _FALSE) { - RTW_INFO("==>%s fw dont support RA\n", __FUNCTION__); - return _FAIL; - } - - macid = arg[0]; - raid = arg[1]; - shortGIrate = arg[2] & 0x0F; - ignore_bw = arg[2] >> 4; - init_rate = arg[3]; - - if (macid < macid_ctl->num) - psta = macid_ctl->sta[macid]; - if (psta == NULL) { - RTW_PRINT(FUNC_ADPT_FMT" macid:%u, sta is NULL\n" - , FUNC_ADPT_ARG(padapter), macid); - return _FAIL; - } - - H2CCommand[0] = macid; - H2CCommand[1] = raid | (shortGIrate ? 0x80 : 0x00) ; - H2CCommand[2] = bw & 0x03; /* BW; */ - if (ignore_bw) - H2CCommand[2] |= BIT(3); - -#ifdef CONFIG_INTEL_PROXIM - if (padapter->proximity.proxim_on == _TRUE) - pHalData->bDisableTXPowerTraining = _FALSE; -#endif - - /* DisableTXPowerTraining */ - if (pHalData->bDisableTXPowerTraining) { - H2CCommand[2] |= BIT6; - RTW_INFO("%s,Disable PWT by driver\n", __FUNCTION__); - } else { - struct PHY_DM_STRUCT *pDM_OutSrc = &pHalData->odmpriv; - - if (pDM_OutSrc->is_disable_power_training) { - H2CCommand[2] |= BIT6; - RTW_INFO("%s,Disable PWT by DM\n", __FUNCTION__); - } - } - - H2CCommand[3] = (u1Byte)(bitmap & 0x000000ff); - H2CCommand[4] = (u1Byte)((bitmap & 0x0000ff00) >> 8); - H2CCommand[5] = (u1Byte)((bitmap & 0x00ff0000) >> 16); - H2CCommand[6] = (u1Byte)((bitmap & 0xff000000) >> 24); - - FillH2CCmd_88E(padapter, H2C_DM_MACID_CFG, 7, H2CCommand); - - /* The firmware Rate Adaption function is triggered by TBTT INT, so to */ - /* enable the rate adaption, we need to enable the hardware Beacon function Reg 0x550[3] */ - /* SetBcnCtrlReg(padapter, BIT3, 0); */ - rtw_write8(padapter, REG_BCN_CTRL, rtw_read8(padapter, REG_BCN_CTRL) | BIT3); - - return res; - -} void rtl8188e_set_FwPwrMode_cmd(PADAPTER padapter, u8 Mode) { SETPWRMODE_PARM H2CSetPwrMode; struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); u8 RLBM = 0; /* 0:Min, 1:Max , 2:User define */ + u8 allQueueUAPSD = 0; - RTW_INFO("%s: Mode=%d SmartPS=%d UAPSD=%d\n", __FUNCTION__, - Mode, pwrpriv->smart_ps, padapter->registrypriv.uapsd_enable); + RTW_INFO("%s: Mode=%d SmartPS=%d \n", __FUNCTION__, Mode, pwrpriv->smart_ps); H2CSetPwrMode.AwakeInterval = 2; /* DTIM = 1 */ @@ -305,7 +215,7 @@ void rtl8188e_set_FwPwrMode_cmd(PADAPTER padapter, u8 Mode) H2CSetPwrMode.SmartPS_RLBM = (((pwrpriv->smart_ps << 4) & 0xf0) | (RLBM & 0x0f)); - H2CSetPwrMode.bAllQueueUAPSD = padapter->registrypriv.uapsd_enable; + H2CSetPwrMode.bAllQueueUAPSD = allQueueUAPSD; if (Mode > 0) { H2CSetPwrMode.PwrState = 0x00;/* AllON(0x0C), RFON(0x04), RFOFF(0x00) */ @@ -320,245 +230,6 @@ void rtl8188e_set_FwPwrMode_cmd(PADAPTER padapter, u8 Mode) } -void ConstructBeacon(_adapter *padapter, u8 *pframe, u32 *pLength) -{ - struct rtw_ieee80211_hdr *pwlanhdr; - u16 *fctrl; - u32 rate_len, pktlen; - struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); - WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); - u8 bc_addr[] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; - - - /* RTW_INFO("%s\n", __FUNCTION__); */ - - pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; - - fctrl = &(pwlanhdr->frame_ctl); - *(fctrl) = 0; - - _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); - _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); - _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(cur_network), ETH_ALEN); - - SetSeqNum(pwlanhdr, 0/*pmlmeext->mgnt_seq*/); - /* pmlmeext->mgnt_seq++; */ - set_frame_sub_type(pframe, WIFI_BEACON); - - pframe += sizeof(struct rtw_ieee80211_hdr_3addr); - pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); - - /* timestamp will be inserted by hardware */ - pframe += 8; - pktlen += 8; - - /* beacon interval: 2 bytes */ - _rtw_memcpy(pframe, (unsigned char *)(rtw_get_beacon_interval_from_ie(cur_network->IEs)), 2); - - pframe += 2; - pktlen += 2; - - /* capability info: 2 bytes */ - _rtw_memcpy(pframe, (unsigned char *)(rtw_get_capability_from_ie(cur_network->IEs)), 2); - - pframe += 2; - pktlen += 2; - - if ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) { - /* RTW_INFO("ie len=%d\n", cur_network->IELength); */ - pktlen += cur_network->IELength - sizeof(NDIS_802_11_FIXED_IEs); - _rtw_memcpy(pframe, cur_network->IEs + sizeof(NDIS_802_11_FIXED_IEs), pktlen); - - goto _ConstructBeacon; - } - - /* below for ad-hoc mode */ - - /* SSID */ - pframe = rtw_set_ie(pframe, _SSID_IE_, cur_network->Ssid.SsidLength, cur_network->Ssid.Ssid, &pktlen); - - /* supported rates... */ - rate_len = rtw_get_rateset_len(cur_network->SupportedRates); - pframe = rtw_set_ie(pframe, _SUPPORTEDRATES_IE_, ((rate_len > 8) ? 8 : rate_len), cur_network->SupportedRates, &pktlen); - - /* DS parameter set */ - pframe = rtw_set_ie(pframe, _DSSET_IE_, 1, (unsigned char *)&(cur_network->Configuration.DSConfig), &pktlen); - - if ((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE) { - u32 ATIMWindow; - /* IBSS Parameter Set... */ - /* ATIMWindow = cur->Configuration.ATIMWindow; */ - ATIMWindow = 0; - pframe = rtw_set_ie(pframe, _IBSS_PARA_IE_, 2, (unsigned char *)(&ATIMWindow), &pktlen); - } - - - /* todo: ERP IE */ - - - /* EXTERNDED SUPPORTED RATE */ - if (rate_len > 8) - pframe = rtw_set_ie(pframe, _EXT_SUPPORTEDRATES_IE_, (rate_len - 8), (cur_network->SupportedRates + 8), &pktlen); - - - /* todo:HT for adhoc */ - -_ConstructBeacon: - - if ((pktlen + TXDESC_SIZE) > 512) { - RTW_INFO("beacon frame too large\n"); - return; - } - - *pLength = pktlen; - - /* RTW_INFO("%s bcn_sz=%d\n", __FUNCTION__, pktlen); */ - -} - -void ConstructPSPoll(_adapter *padapter, u8 *pframe, u32 *pLength) -{ - struct rtw_ieee80211_hdr *pwlanhdr; - u16 *fctrl; - u32 pktlen; - struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); - - /* RTW_INFO("%s\n", __FUNCTION__); */ - - pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; - - /* Frame control. */ - fctrl = &(pwlanhdr->frame_ctl); - *(fctrl) = 0; - SetPwrMgt(fctrl); - set_frame_sub_type(pframe, WIFI_PSPOLL); - - /* AID. */ - set_duration(pframe, (pmlmeinfo->aid | 0xc000)); - - /* BSSID. */ - _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); - - /* TA. */ - _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); - - *pLength = 16; -} - -void ConstructNullFunctionData( - PADAPTER padapter, - u8 *pframe, - u32 *pLength, - u8 *StaAddr, - u8 bQoS, - u8 AC, - u8 bEosp, - u8 bForcePowerSave) -{ - struct rtw_ieee80211_hdr *pwlanhdr; - u16 *fctrl; - u32 pktlen; - 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); - - - /* RTW_INFO("%s:%d\n", __FUNCTION__, bForcePowerSave); */ - - pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; - - fctrl = &pwlanhdr->frame_ctl; - *(fctrl) = 0; - if (bForcePowerSave) - SetPwrMgt(fctrl); - - switch (cur_network->network.InfrastructureMode) { - case Ndis802_11Infrastructure: - 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, StaAddr, ETH_ALEN); - break; - case Ndis802_11APMode: - SetFrDs(fctrl); - _rtw_memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN); - _rtw_memcpy(pwlanhdr->addr2, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); - _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); - break; - case Ndis802_11IBSS: - default: - _rtw_memcpy(pwlanhdr->addr1, StaAddr, ETH_ALEN); - _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); - _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); - break; - } - - SetSeqNum(pwlanhdr, 0); - - if (bQoS == _TRUE) { - struct rtw_ieee80211_hdr_3addr_qos *pwlanqoshdr; - - set_frame_sub_type(pframe, WIFI_QOS_DATA_NULL); - - pwlanqoshdr = (struct rtw_ieee80211_hdr_3addr_qos *)pframe; - SetPriority(&pwlanqoshdr->qc, AC); - SetEOSP(&pwlanqoshdr->qc, bEosp); - - pktlen = sizeof(struct rtw_ieee80211_hdr_3addr_qos); - } else { - set_frame_sub_type(pframe, WIFI_DATA_NULL); - - pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); - } - - *pLength = pktlen; -} - -void rtl8188e_set_FwRsvdPage_cmd(PADAPTER padapter, PRSVDPAGE_LOC rsvdpageloc) -{ - u8 u1H2CRsvdPageParm[H2C_RSVDPAGE_LOC_LEN] = {0}; - u8 u1H2CAoacRsvdPageParm[H2C_AOAC_RSVDPAGE_LOC_LEN] = {0}; - - /* RTW_INFO("8188RsvdPageLoc: PsPoll=%d Null=%d QoSNull=%d\n", */ - /* rsvdpageloc->LocPsPoll, rsvdpageloc->LocNullData, rsvdpageloc->LocQosNull); */ - - 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); - - FillH2CCmd_88E(padapter, H2C_COM_RSVD_PAGE, H2C_RSVDPAGE_LOC_LEN, u1H2CRsvdPageParm); - -#ifdef CONFIG_WOWLAN - /* RTW_INFO("8188E_AOACRsvdPageLoc: RWC=%d ArpRsp=%d\n", rsvdpageloc->LocRemoteCtrlInfo, rsvdpageloc->LocArpRsp); */ - SET_H2CCMD_AOAC_RSVDPAGE_LOC_REMOTE_WAKE_CTRL_INFO(u1H2CAoacRsvdPageParm, rsvdpageloc->LocRemoteCtrlInfo); - SET_H2CCMD_AOAC_RSVDPAGE_LOC_ARP_RSP(u1H2CAoacRsvdPageParm, rsvdpageloc->LocArpRsp); - - FillH2CCmd_88E(padapter, H2C_COM_AOAC_RSVD_PAGE, H2C_AOAC_RSVDPAGE_LOC_LEN, u1H2CAoacRsvdPageParm); -#endif -} - -/* To check if reserved page content is destroyed by beacon beacuse 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. @@ -593,40 +264,38 @@ void rtl8188e_set_FwJoinBssReport_cmd(PADAPTER padapter, u8 mstatus) BOOLEAN bcn_valid = _FALSE; u8 DLBcnCount = 0; u32 poll = 0; - + u8 RegFwHwTxQCtrl = 0; RTW_INFO("%s mstatus(%x)\n", __FUNCTION__, mstatus); if (mstatus == 1) { + u8 bcn_ctrl = rtw_read8(padapter, REG_BCN_CTRL); + /* We should set AID, correct TSF, HW seq enable before set JoinBssReport to Fw in 88/92C. */ /* Suggested by filen. Added by tynli. */ rtw_write16(padapter, REG_BCN_PSR_RPT, (0xC000 | pmlmeinfo->aid)); - /* Do not set TSF again here or vWiFi beacon DMA INT will not work. */ - /* correct_TSF(padapter, pmlmeext); */ /* Hw sequende enable by dedault. 2010.06.23. by tynli. */ /* rtw_write16(padapter, REG_NQOS_SEQ, ((pmlmeext->mgnt_seq+100)&0xFFF)); */ /* rtw_write8(padapter, REG_HWSEQ_CTRL, 0xFF); */ /* Set REG_CR bit 8. DMA beacon by SW. */ - pHalData->RegCR_1 |= BIT0; - rtw_write8(padapter, REG_CR + 1, pHalData->RegCR_1); + rtw_write8(padapter, REG_CR + 1, + rtw_read8(padapter, REG_CR + 1) | BIT0); /* Disable Hw protection for a time which revserd for Hw sending beacon. */ /* Fix download reserved page packet fail that access collision with the protection time. */ /* 2010.05.11. Added by tynli. */ - /* SetBcnCtrlReg(padapter, 0, BIT3); */ - /* SetBcnCtrlReg(padapter, BIT4, 0); */ - rtw_write8(padapter, REG_BCN_CTRL, rtw_read8(padapter, REG_BCN_CTRL) & (~BIT(3))); - rtw_write8(padapter, REG_BCN_CTRL, rtw_read8(padapter, REG_BCN_CTRL) | BIT(4)); + rtw_write8(padapter, REG_BCN_CTRL, (bcn_ctrl & (~EN_BCN_FUNCTION)) | DIS_TSF_UDT); - if (pHalData->RegFwHwTxQCtrl & BIT6) { + RegFwHwTxQCtrl = rtw_read8(padapter, REG_FWHW_TXQ_CTRL + 2); + if (RegFwHwTxQCtrl & BIT6) { RTW_INFO("HalDownloadRSVDPage(): There is an Adapter is sending beacon.\n"); bSendBeacon = _TRUE; } /* Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame. */ - rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, (pHalData->RegFwHwTxQCtrl & (~BIT6))); - pHalData->RegFwHwTxQCtrl &= (~BIT6); + RegFwHwTxQCtrl &= (~BIT6); + rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, RegFwHwTxQCtrl); /* Clear beacon valid check bit. */ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_VALID, NULL); @@ -650,20 +319,19 @@ void rtl8188e_set_FwJoinBssReport_cmd(PADAPTER padapter, u8 mstatus) if (RTW_CANNOT_RUN(padapter)) ; else if (!bcn_valid) - RTW_INFO(ADPT_FMT": 1 DL RSVD page failed! DLBcnCount:%u, poll:%u\n", + RTW_ERR(ADPT_FMT": 1 DL RSVD page failed! DLBcnCount:%u, poll:%u\n", ADPT_ARG(padapter) , DLBcnCount, poll); else { struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); + pwrctl->fw_psmode_iface_id = padapter->iface_id; + rtw_hal_set_fw_rsvd_page(padapter, _TRUE); RTW_INFO(ADPT_FMT": 1 DL RSVD page success! DLBcnCount:%u, poll:%u\n", ADPT_ARG(padapter), DLBcnCount, poll); } - /* Enable Bcn */ - /* SetBcnCtrlReg(padapter, BIT3, 0); */ - /* SetBcnCtrlReg(padapter, 0, BIT4); */ - rtw_write8(padapter, REG_BCN_CTRL, rtw_read8(padapter, REG_BCN_CTRL) | BIT(3)); - rtw_write8(padapter, REG_BCN_CTRL, rtw_read8(padapter, REG_BCN_CTRL) & (~BIT(4))); + /* restore bcn_ctrl */ + rtw_write8(padapter, REG_BCN_CTRL, bcn_ctrl); /* 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 */ @@ -671,8 +339,8 @@ void rtl8188e_set_FwJoinBssReport_cmd(PADAPTER padapter, u8 mstatus) /* the beacon cannot be sent by HW. */ /* 2010.06.23. Added by tynli. */ if (bSendBeacon) { - rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, (pHalData->RegFwHwTxQCtrl | BIT6)); - pHalData->RegFwHwTxQCtrl |= BIT6; + RegFwHwTxQCtrl |= BIT6; + rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, RegFwHwTxQCtrl); } /* */ @@ -686,11 +354,13 @@ void rtl8188e_set_FwJoinBssReport_cmd(PADAPTER padapter, u8 mstatus) /* Do not enable HW DMA BCN or it will cause Pcie interface hang by timing issue. 2011.11.24. by tynli. */ /* if(!padapter->bEnterPnpSleep) */ +#ifndef CONFIG_PCI_HCI { /* Clear CR[8] or beacon packet will not be send to TxBuf anymore. */ - pHalData->RegCR_1 &= (~BIT0); - rtw_write8(padapter, REG_CR + 1, pHalData->RegCR_1); + rtw_write8(padapter, REG_CR + 1, + rtw_read8(padapter, REG_CR + 1) & (~BIT0)); } +#endif /* !CONFIG_PCI_HCI */ } } @@ -776,50 +446,3 @@ void rtl8188e_set_p2p_ps_offload_cmd(_adapter *padapter, u8 p2p_ps_state) } #endif /* CONFIG_P2P_PS */ -#ifdef CONFIG_TSF_RESET_OFFLOAD -/* - ask FW to Reset sync register at Beacon early interrupt -*/ -u8 rtl8188e_reset_tsf(_adapter *padapter, u8 reset_port) -{ - u8 buf[2]; - u8 res = _SUCCESS; - - s32 ret; - if (HW_PORT0 == reset_port) { - buf[0] = 0x1; - buf[1] = 0; - } else { - buf[0] = 0x0; - buf[1] = 0x1; - } - - ret = FillH2CCmd_88E(padapter, H2C_RESET_TSF, 2, buf); - - - return res; -} - -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; - u32 reg_bcncrtl = (HW_PORT0 == reset_port) ? - REG_BCN_CTRL_1 : REG_BCN_CTRL; - - 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); - rtl8188e_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 */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/rtl8188e_dm.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/rtl8188e_dm.c index 229be40affb8..2e7f19c4e7fe 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/rtl8188e_dm.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/rtl8188e_dm.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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: * @@ -35,53 +31,6 @@ /* ************************************************************ * Global var * ************************************************************ */ - - -static VOID -dm_CheckProtection( - IN PADAPTER Adapter -) -{ -#if 0 - PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); - u1Byte CurRate, RateThreshold; - - if (pMgntInfo->pHTInfo->bCurBW40MHz) - RateThreshold = MGN_MCS1; - else - RateThreshold = MGN_MCS3; - - if (Adapter->TxStats.CurrentInitTxRate <= RateThreshold) { - pMgntInfo->bDmDisableProtect = TRUE; - dbg_print("Forced disable protect: %x\n", Adapter->TxStats.CurrentInitTxRate); - } else { - pMgntInfo->bDmDisableProtect = FALSE; - dbg_print("Enable protect: %x\n", Adapter->TxStats.CurrentInitTxRate); - } -#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) { @@ -139,9 +88,9 @@ static void dm_CheckPbcGPIO(_adapter *padapter) * * Created by Roger, 2010.03.05. * */ -VOID +void dm_InterruptMigration( - IN PADAPTER Adapter + PADAPTER Adapter ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -212,9 +161,10 @@ dm_InterruptMigration( /* * Initialize GPIO setting registers * */ +#ifdef CONFIG_USB_HCI static void dm_InitGPIOSetting( - IN PADAPTER Adapter + PADAPTER Adapter ) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); @@ -227,15 +177,14 @@ dm_InitGPIOSetting( rtw_write8(Adapter, REG_GPIO_MUXCFG, tmp1byte); } - +#endif /* ************************************************************ * functions * ************************************************************ */ static void Init_ODM_ComInfo_88E(PADAPTER Adapter) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - struct PHY_DM_STRUCT *pDM_Odm = &(pHalData->odmpriv); - u32 SupportAbility = 0; + struct dm_struct *pDM_Odm = &(pHalData->odmpriv); u8 cut_ver, fab_ver; Init_ODM_ComInfo(Adapter); @@ -248,107 +197,41 @@ static void Init_ODM_ComInfo_88E(PADAPTER Adapter) odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_FAB_VER, fab_ver); odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_CUT_VER, cut_ver); - -#ifdef CONFIG_DISABLE_ODM - SupportAbility = 0; -#else - SupportAbility = ODM_RF_CALIBRATION | - ODM_RF_TX_PWR_TRACK - ; -#endif - - odm_cmn_info_update(pDM_Odm, ODM_CMNINFO_ABILITY, SupportAbility); - -} -static void Update_ODM_ComInfo_88E(PADAPTER Adapter) -{ - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - struct PHY_DM_STRUCT *pDM_Odm = &(pHalData->odmpriv); - u32 SupportAbility = 0; - int i; - - SupportAbility = 0 - | 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_SAVE */ - | ODM_BB_CFO_TRACKING - | ODM_RF_CALIBRATION - | ODM_RF_TX_PWR_TRACK - | ODM_BB_NHM_CNT - | ODM_BB_PRIMARY_CCA - /* | ODM_BB_PWR_TRAIN */ - ; - - if (rtw_odm_adaptivity_needed(Adapter) == _TRUE) { - rtw_odm_adaptivity_config_msg(RTW_DBGDUMP, Adapter); - SupportAbility |= ODM_BB_ADAPTIVITY; - } - - if (!Adapter->registrypriv.qos_opt_enable) - SupportAbility |= ODM_MAC_EDCA_TURBO; - -#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_cmn_info_update(pDM_Odm, ODM_CMNINFO_ABILITY, SupportAbility); } void rtl8188e_InitHalDm( - IN PADAPTER Adapter + PADAPTER Adapter ) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - struct PHY_DM_STRUCT *pDM_Odm = &(pHalData->odmpriv); - u8 i; + struct dm_struct *pDM_Odm = &(pHalData->odmpriv); #ifdef CONFIG_USB_HCI dm_InitGPIOSetting(Adapter); #endif - - pHalData->DM_Type = dm_type_by_driver; - - Update_ODM_ComInfo_88E(Adapter); - odm_dm_init(pDM_Odm); + rtw_phydm_init(Adapter); } -VOID +void rtl8188e_HalDmWatchDog( - IN PADAPTER Adapter + PADAPTER Adapter ) { BOOLEAN bFwCurrentInPSMode = _FALSE; - BOOLEAN bFwPSAwake = _TRUE; + u8 bFwPSAwake = _TRUE; PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - struct PHY_DM_STRUCT *pDM_Odm = &(pHalData->odmpriv); - + struct dm_struct *pDM_Odm = &(pHalData->odmpriv); + struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(Adapter); + u8 in_lps = _FALSE; if (!rtw_is_hw_init_completed(Adapter)) goto skip_dm; #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_PS @@ -360,16 +243,10 @@ rtl8188e_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. */ /* */ - /* dm_CheckProtection(Adapter); */ #ifdef CONFIG_PCI_HCI /* 20100630 Joseph: Disable Interrupt Migration mechanism temporarily because it degrades Rx throughput. */ @@ -382,28 +259,15 @@ rtl8188e_HalDmWatchDog( } - - /* ODM */ - if (rtw_is_hw_init_completed(Adapter)) { - u8 bLinked = _FALSE; - u8 bsta_state = _FALSE; #ifdef CONFIG_DISABLE_ODM - pHalData->odmpriv.support_ability = 0; + goto skip_dm; +#endif +#ifdef CONFIG_LPS + if (pwrpriv->bLeisurePs && bFwCurrentInPSMode && pwrpriv->pwr_mode != PS_MODE_ACTIVE) + in_lps = _TRUE; #endif - 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); - - - odm_dm_watchdog(&pHalData->odmpriv); - - } + rtw_phydm_watchdog(Adapter, in_lps); skip_dm: @@ -414,10 +278,10 @@ rtl8188e_HalDmWatchDog( return; } -void rtl8188e_init_dm_priv(IN PADAPTER Adapter) +void rtl8188e_init_dm_priv(PADAPTER Adapter) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - struct PHY_DM_STRUCT *podmpriv = &pHalData->odmpriv; + struct dm_struct *podmpriv = &pHalData->odmpriv; /* _rtw_spinlock_init(&(pHalData->odm_stainfo_lock)); */ Init_ODM_ComInfo_88E(Adapter); @@ -425,10 +289,10 @@ void rtl8188e_init_dm_priv(IN PADAPTER Adapter) } -void rtl8188e_deinit_dm_priv(IN PADAPTER Adapter) +void rtl8188e_deinit_dm_priv(PADAPTER Adapter) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - struct PHY_DM_STRUCT *podmpriv = &pHalData->odmpriv; + struct dm_struct *podmpriv = &pHalData->odmpriv; /* _rtw_spinlock_free(&pHalData->odm_stainfo_lock); */ odm_cancel_all_timers(podmpriv); } diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/rtl8188e_hal_init.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/rtl8188e_hal_init.c index 9188ad930e44..a8eaac4f18cf 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/rtl8188e_hal_init.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/rtl8188e_hal_init.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 @@ -38,7 +34,7 @@ static void iol_mode_enable(PADAPTER padapter, u8 enable) /* RTW_INFO("%s reg_0xf0:0x%02x, write 0x%02x\n", __FUNCTION__, reg_0xf0, reg_0xf0|SW_OFFLOAD_EN); */ rtw_write8(padapter, REG_SYS_CFG, reg_0xf0 | SW_OFFLOAD_EN); - if (padapter->bFWReady == _FALSE) { + if (GET_HAL_DATA(padapter)->bFWReady == _FALSE) { printk("bFWReady == _FALSE call reset 8051...\n"); _8051Reset88E(padapter); } @@ -55,9 +51,10 @@ static s32 iol_execute(PADAPTER padapter, u8 control) { s32 status = _FAIL; u8 reg_0x88 = 0, reg_1c7 = 0; - u32 start = 0, passing_time = 0; + systime start = 0; + u32 passing_time = 0; - u32 t1, t2; + systime t1, t2; control = control & 0x0f; reg_0x88 = rtw_read8(padapter, REG_HMEBOX_E0); /* RTW_INFO("%s reg_0x88:0x%02x, write 0x%02x\n", __FUNCTION__, reg_0x88, reg_0x88|control); */ @@ -84,6 +81,7 @@ static s32 iol_execute(PADAPTER padapter, u8 control) return status; } +#ifdef CONFIG_IOL_LLT static s32 iol_InitLLTTable( PADAPTER padapter, u8 txpktbuf_bndy @@ -97,8 +95,9 @@ static s32 iol_InitLLTTable( iol_mode_enable(padapter, 0); return rst; } +#endif /*CONFIG_IOL_LLT*/ -static VOID +static void efuse_phymap_to_logical(u8 *phymap, u16 _offset, u16 _size_byte, u8 *pbuf) { u8 *efuseTbl = NULL; @@ -202,7 +201,7 @@ efuse_phymap_to_logical(u8 *phymap, u16 _offset, u16 _size_byte, u8 *pbuf) /* RTPRINT(FEEPROM, EFUSE_READ_ALL, ("Data=0x%x\n", *rtemp8)); */ efuse_utilized++; - eFuseWord[offset][i] |= (((u2Byte)rtemp8 << 8) & 0xff00); + eFuseWord[offset][i] |= (((u16)rtemp8 << 8) & 0xff00); if (eFuse_Addr >= EFUSE_REAL_CONTENT_LEN_88E) break; @@ -243,7 +242,7 @@ efuse_phymap_to_logical(u8 *phymap, u16 _offset, u16 _size_byte, u8 *pbuf) /* */ /* 5. Calculate Efuse utilization. */ /* */ - efuse_usage = (u1Byte)((efuse_utilized * 100) / EFUSE_REAL_CONTENT_LEN_88E); + efuse_usage = (u8)((efuse_utilized * 100) / EFUSE_REAL_CONTENT_LEN_88E); /* rtw_hal_set_hwreg(Adapter, HW_VAR_EFUSE_BYTES, (u8 *)&efuse_utilized); */ exit: @@ -262,7 +261,8 @@ void efuse_read_phymap_from_txpktbuf( ) { u16 dbg_addr = 0; - u32 start = 0, passing_time = 0; + systime start = 0; + u32 passing_time = 0; u8 reg_0x143 = 0; u8 reg_0x106 = 0; u32 lo32 = 0, hi32 = 0; @@ -452,11 +452,11 @@ static s32 iol_ioconfig( int rtl8188e_IOL_exec_cmds_sync(ADAPTER *adapter, struct xmit_frame *xmit_frame, u32 max_wating_ms, u32 bndy_cnt) { - u32 start_time = rtw_get_current_time(); + systime start_time = rtw_get_current_time(); u32 passing_time_ms; u8 polling_ret, i; int ret = _FAIL; - u32 t1, t2; + systime t1, t2; /* printk("===> %s ,bndy_cnt = %d\n",__FUNCTION__,bndy_cnt); */ if (rtw_IOL_append_END_cmd(xmit_frame) != _SUCCESS) @@ -538,10 +538,10 @@ void rtw_IOL_cmd_tx_pkt_buf_dump(ADAPTER *Adapter, int data_len) #endif /* defined(CONFIG_IOL) */ -static VOID +static void _FWDownloadEnable_8188E( - IN PADAPTER padapter, - IN BOOLEAN enable + PADAPTER padapter, + BOOLEAN enable ) { u8 tmp; @@ -567,9 +567,9 @@ _FWDownloadEnable_8188E( #define MAX_REG_BOLCK_SIZE 196 static int _BlockWrite( - IN PADAPTER padapter, - IN PVOID buffer, - IN u32 buffSize + PADAPTER padapter, + void *buffer, + u32 buffSize ) { int ret = _SUCCESS; @@ -666,10 +666,10 @@ _BlockWrite( static int _PageWrite( - IN PADAPTER padapter, - IN u32 page, - IN PVOID buffer, - IN u32 size + PADAPTER padapter, + u32 page, + void *buffer, + u32 size ) { u8 value8; @@ -680,8 +680,9 @@ _PageWrite( return _BlockWrite(padapter, buffer, size); } - -static VOID +/* +#ifdef CONFIG_PCI_HCI +static void _FillDummy( u8 *pFwBuf, u32 *pFwLen @@ -699,12 +700,13 @@ _FillDummy( *pFwLen = FwLen; } - +#endif +*/ static int _WriteFW( - IN PADAPTER padapter, - IN PVOID buffer, - IN u32 size + PADAPTER padapter, + void *buffer, + u32 size ) { /* Since we need dynamic decide method of dwonload fw, so we call this function to get chip version. */ @@ -781,7 +783,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 */ @@ -812,7 +814,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; value32 = rtw_read32(adapter, REG_MCUFWDL); @@ -863,7 +865,7 @@ s32 rtl8188e_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); PRT_FIRMWARE_8188E pFirmware = NULL; @@ -962,7 +964,7 @@ s32 rtl8188e_FirmwareDownload(PADAPTER padapter, BOOLEAN bUsedWoWLANFw) tmp_fw_len = IS_VENDOR_8188E_I_CUT_SERIES(padapter) ? FW_8188E_SIZE_2 : FW_8188E_SIZE; - if (pFirmware->ulFwLength > tmp_fw_len) { + if ((pFirmware->ulFwLength - 32) > tmp_fw_len) { rtStatus = _FAIL; RTW_ERR("Firmware size:%u exceed %u\n", pFirmware->ulFwLength, tmp_fw_len); goto exit; @@ -1059,31 +1061,31 @@ enum { static BOOLEAN hal_EfusePgPacketWrite2ByteHeader( - IN PADAPTER pAdapter, - IN u8 efuseType, - IN u16 *pAddr, - IN PPGPKT_STRUCT pTargetPkt, - IN BOOLEAN bPseudoTest); + PADAPTER pAdapter, + u8 efuseType, + u16 *pAddr, + PPGPKT_STRUCT pTargetPkt, + BOOLEAN bPseudoTest); static BOOLEAN hal_EfusePgPacketWrite1ByteHeader( - IN PADAPTER pAdapter, - IN u8 efuseType, - IN u16 *pAddr, - IN PPGPKT_STRUCT pTargetPkt, - IN BOOLEAN bPseudoTest); + PADAPTER pAdapter, + u8 efuseType, + u16 *pAddr, + PPGPKT_STRUCT pTargetPkt, + BOOLEAN bPseudoTest); static BOOLEAN hal_EfusePgPacketWriteData( - IN PADAPTER pAdapter, - IN u8 efuseType, - IN u16 *pAddr, - IN PPGPKT_STRUCT pTargetPkt, - IN BOOLEAN bPseudoTest); + PADAPTER pAdapter, + u8 efuseType, + u16 *pAddr, + PPGPKT_STRUCT pTargetPkt, + BOOLEAN bPseudoTest); -static VOID +static void hal_EfusePowerSwitch_RTL8188E( - IN PADAPTER pAdapter, - IN u8 bWrite, - IN u8 PwrState) + PADAPTER pAdapter, + u8 bWrite, + u8 PwrState) { u8 tempval; u16 tmpV16; @@ -1135,61 +1137,22 @@ hal_EfusePowerSwitch_RTL8188E( } } -static VOID +static void rtl8188e_EfusePowerSwitch( - IN PADAPTER pAdapter, - IN u8 bWrite, - IN u8 PwrState) + PADAPTER pAdapter, + u8 bWrite, + u8 PwrState) { hal_EfusePowerSwitch_RTL8188E(pAdapter, bWrite, PwrState); } - - -static bool efuse_read_phymap( - PADAPTER Adapter, - u8 *pbuf, /* buffer to store efuse physical map */ - u16 *size /* the max byte to read. will update to byte read */ -) -{ - u8 *pos = pbuf; - u16 limit = *size; - u16 addr = 0; - bool reach_end = _FALSE; - - /* */ - /* Refresh efuse init map as all 0xFF. */ - /* */ - _rtw_memset(pbuf, 0xFF, limit); - - - /* */ - /* Read physical efuse content. */ - /* */ - while (addr < limit) { - ReadEFuseByte(Adapter, addr, pos, _FALSE); - if (*pos != 0xFF) { - pos++; - addr++; - } else { - reach_end = _TRUE; - break; - } - } - - *size = addr; - - return reach_end; - -} - -static VOID +static void Hal_EfuseReadEFuse88E( PADAPTER Adapter, u16 _offset, u16 _size_byte, u8 *pbuf, - IN BOOLEAN bPseudoTest + BOOLEAN bPseudoTest ) { /* u8 efuseTbl[EFUSE_MAP_LEN_88E]; */ @@ -1303,7 +1266,7 @@ Hal_EfuseReadEFuse88E( /* RTPRINT(FEEPROM, EFUSE_READ_ALL, ("Data=0x%x\n", *rtemp8)); */ efuse_utilized++; - eFuseWord[offset][i] |= (((u2Byte)*rtemp8 << 8) & 0xff00); + eFuseWord[offset][i] |= (((u16)*rtemp8 << 8) & 0xff00); if (eFuse_Addr >= EFUSE_REAL_CONTENT_LEN_88E) break; @@ -1358,7 +1321,7 @@ Hal_EfuseReadEFuse88E( /* */ /* 5. Calculate Efuse utilization. */ /* */ - efuse_usage = (u1Byte)((eFuse_Addr * 100) / EFUSE_REAL_CONTENT_LEN_88E); + efuse_usage = (u8)((eFuse_Addr * 100) / EFUSE_REAL_CONTENT_LEN_88E); rtw_hal_set_hwreg(Adapter, HW_VAR_EFUSE_BYTES, (u8 *)&eFuse_Addr); exit: @@ -1369,36 +1332,14 @@ Hal_EfuseReadEFuse88E( rtw_mfree2d((void *)eFuseWord, EFUSE_MAX_SECTION_88E, EFUSE_MAX_WORD_UNIT, sizeof(u16)); } - -static BOOLEAN -Hal_EfuseSwitchToBank( - IN PADAPTER pAdapter, - IN u8 bank, - IN BOOLEAN bPseudoTest -) -{ - BOOLEAN bRet = _FALSE; - u32 value32 = 0; - - /* RTPRINT(FEEPROM, EFUSE_PG, ("Efuse switch bank to %d\n", bank)); */ - if (bPseudoTest) { - fakeEfuseBank = bank; - bRet = _TRUE; - } else - bRet = _TRUE; - return bRet; -} - - - -static VOID +static void ReadEFuseByIC( PADAPTER Adapter, u8 efuseType, u16 _offset, u16 _size_byte, u8 *pbuf, - IN BOOLEAN bPseudoTest + BOOLEAN bPseudoTest ) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); @@ -1407,7 +1348,7 @@ ReadEFuseByIC( #endif #ifdef CONFIG_IOL_READ_EFUSE_MAP - if (!bPseudoTest) { /* && rtw_IOL_applied(Adapter)) */ + if (!bPseudoTest && Adapter->registrypriv.mp_mode == 0) { /* && rtw_IOL_applied(Adapter)) */ int ret = _FAIL; if (rtw_IOL_applied(Adapter)) { rtw_hal_power_on(Adapter); @@ -1447,27 +1388,27 @@ ReadEFuseByIC( return; } -static VOID +static void ReadEFuse_Pseudo( PADAPTER Adapter, u8 efuseType, u16 _offset, u16 _size_byte, u8 *pbuf, - IN BOOLEAN bPseudoTest + BOOLEAN bPseudoTest ) { Hal_EfuseReadEFuse88E(Adapter, _offset, _size_byte, pbuf, bPseudoTest); } -static VOID +static void rtl8188e_ReadEFuse( PADAPTER Adapter, u8 efuseType, u16 _offset, u16 _size_byte, u8 *pbuf, - IN BOOLEAN bPseudoTest + BOOLEAN bPseudoTest ) { if (bPseudoTest) @@ -1477,12 +1418,12 @@ rtl8188e_ReadEFuse( } /* Do not support BT */ -VOID +void Hal_EFUSEGetEfuseDefinition88E( - IN PADAPTER pAdapter, - IN u1Byte efuseType, - IN u1Byte type, - OUT PVOID pOut + PADAPTER pAdapter, + u8 efuseType, + u8 type, + void *pOut ) { switch (type) { @@ -1536,49 +1477,49 @@ Hal_EFUSEGetEfuseDefinition88E( break; } } -VOID +void Hal_EFUSEGetEfuseDefinition_Pseudo88E( - IN PADAPTER pAdapter, - IN u8 efuseType, - IN u8 type, - OUT PVOID pOut + PADAPTER pAdapter, + u8 efuseType, + u8 type, + void *pOut ) { switch (type) { case TYPE_EFUSE_MAX_SECTION: { u8 *pMax_section; - pMax_section = (pu1Byte)pOut; + pMax_section = (u8 *)pOut; *pMax_section = EFUSE_MAX_SECTION_88E; } break; case TYPE_EFUSE_REAL_CONTENT_LEN: { u16 *pu2Tmp; - pu2Tmp = (pu2Byte)pOut; + pu2Tmp = (u16 *)pOut; *pu2Tmp = EFUSE_REAL_CONTENT_LEN_88E; } break; case TYPE_EFUSE_CONTENT_LEN_BANK: { u16 *pu2Tmp; - pu2Tmp = (pu2Byte)pOut; + pu2Tmp = (u16 *)pOut; *pu2Tmp = EFUSE_REAL_CONTENT_LEN_88E; } break; case TYPE_AVAILABLE_EFUSE_BYTES_BANK: { u16 *pu2Tmp; - pu2Tmp = (pu2Byte)pOut; - *pu2Tmp = (u2Byte)(EFUSE_REAL_CONTENT_LEN_88E-EFUSE_OOB_PROTECT_BYTES_88E); + pu2Tmp = (u16 *)pOut; + *pu2Tmp = (u16)(EFUSE_REAL_CONTENT_LEN_88E-EFUSE_OOB_PROTECT_BYTES_88E); } break; case TYPE_AVAILABLE_EFUSE_BYTES_TOTAL: { u16 *pu2Tmp; - pu2Tmp = (pu2Byte)pOut; - *pu2Tmp = (u2Byte)(EFUSE_REAL_CONTENT_LEN_88E-EFUSE_OOB_PROTECT_BYTES_88E); + pu2Tmp = (u16 *)pOut; + *pu2Tmp = (u16)(EFUSE_REAL_CONTENT_LEN_88E-EFUSE_OOB_PROTECT_BYTES_88E); } break; case TYPE_EFUSE_MAP_LEN: { u16 *pu2Tmp; - pu2Tmp = (pu2Byte)pOut; - *pu2Tmp = (u2Byte)EFUSE_MAP_LEN_88E; + pu2Tmp = (u16 *)pOut; + *pu2Tmp = (u16)EFUSE_MAP_LEN_88E; } break; case TYPE_EFUSE_PROTECT_BYTES_BANK: { @@ -1597,13 +1538,13 @@ Hal_EFUSEGetEfuseDefinition_Pseudo88E( } -static VOID +static void rtl8188e_EFUSE_GetEfuseDefinition( - IN PADAPTER pAdapter, - IN u8 efuseType, - IN u8 type, - OUT void *pOut, - IN BOOLEAN bPseudoTest + PADAPTER pAdapter, + u8 efuseType, + u8 type, + void *pOut, + BOOLEAN bPseudoTest ) { if (bPseudoTest) @@ -1613,18 +1554,18 @@ rtl8188e_EFUSE_GetEfuseDefinition( } static u8 -Hal_EfuseWordEnableDataWrite(IN PADAPTER pAdapter, - IN u16 efuse_addr, - IN u8 word_en, - IN u8 *data, - IN BOOLEAN bPseudoTest) +Hal_EfuseWordEnableDataWrite(PADAPTER pAdapter, + u16 efuse_addr, + u8 word_en, + u8 *data, + BOOLEAN bPseudoTest) { u16 tmpaddr = 0; u16 start_addr = efuse_addr; u8 badworden = 0x0F; u8 tmpdata[8]; - _rtw_memset((PVOID)tmpdata, 0xff, PGPKT_DATA_SIZE); + _rtw_memset((void *)tmpdata, 0xff, PGPKT_DATA_SIZE); if (!(word_en & BIT0)) { tmpaddr = start_addr; @@ -1682,11 +1623,11 @@ Hal_EfuseWordEnableDataWrite(IN PADAPTER pAdapter, } static u8 -Hal_EfuseWordEnableDataWrite_Pseudo(IN PADAPTER pAdapter, - IN u16 efuse_addr, - IN u8 word_en, - IN u8 *data, - IN BOOLEAN bPseudoTest) +Hal_EfuseWordEnableDataWrite_Pseudo(PADAPTER pAdapter, + u16 efuse_addr, + u8 word_en, + u8 *data, + BOOLEAN bPseudoTest) { u8 ret = 0; @@ -1696,11 +1637,11 @@ Hal_EfuseWordEnableDataWrite_Pseudo(IN PADAPTER pAdapter, } static u8 -rtl8188e_Efuse_WordEnableDataWrite(IN PADAPTER pAdapter, - IN u16 efuse_addr, - IN u8 word_en, - IN u8 *data, - IN BOOLEAN bPseudoTest) +rtl8188e_Efuse_WordEnableDataWrite(PADAPTER pAdapter, + u16 efuse_addr, + u8 word_en, + u8 *data, + BOOLEAN bPseudoTest) { u8 ret = 0; @@ -1714,8 +1655,8 @@ rtl8188e_Efuse_WordEnableDataWrite(IN PADAPTER pAdapter, static u16 -hal_EfuseGetCurrentSize_8188e(IN PADAPTER pAdapter, - IN BOOLEAN bPseudoTest) +hal_EfuseGetCurrentSize_8188e(PADAPTER pAdapter, + BOOLEAN bPseudoTest) { int bContinual = _TRUE; @@ -1767,8 +1708,8 @@ hal_EfuseGetCurrentSize_8188e(IN PADAPTER pAdapter, } static u16 -Hal_EfuseGetCurrentSize_Pseudo(IN PADAPTER pAdapter, - IN BOOLEAN bPseudoTest) +Hal_EfuseGetCurrentSize_Pseudo(PADAPTER pAdapter, + BOOLEAN bPseudoTest) { u16 ret = 0; @@ -1780,9 +1721,9 @@ Hal_EfuseGetCurrentSize_Pseudo(IN PADAPTER pAdapter, static u16 rtl8188e_EfuseGetCurrentSize( - IN PADAPTER pAdapter, - IN u8 efuseType, - IN BOOLEAN bPseudoTest) + PADAPTER pAdapter, + u8 efuseType, + BOOLEAN bPseudoTest) { u16 ret = 0; @@ -1798,10 +1739,10 @@ rtl8188e_EfuseGetCurrentSize( static int hal_EfusePgPacketRead_8188e( - IN PADAPTER pAdapter, - IN u8 offset, - IN u8 *data, - IN BOOLEAN bPseudoTest) + PADAPTER pAdapter, + u8 offset, + u8 *data, + BOOLEAN bPseudoTest) { u8 ReadState = PG_STATE_HEADER; @@ -1816,15 +1757,15 @@ hal_EfusePgPacketRead_8188e( u8 max_section = 0; u8 tmp_header = 0; - EFUSE_GetEfuseDefinition(pAdapter, EFUSE_WIFI, TYPE_EFUSE_MAX_SECTION, (PVOID)&max_section, bPseudoTest); + EFUSE_GetEfuseDefinition(pAdapter, EFUSE_WIFI, TYPE_EFUSE_MAX_SECTION, (void *)&max_section, bPseudoTest); if (data == NULL) return _FALSE; if (offset > max_section) return _FALSE; - _rtw_memset((PVOID)data, 0xff, sizeof(u8) * PGPKT_DATA_SIZE); - _rtw_memset((PVOID)tmpdata, 0xff, sizeof(u8) * PGPKT_DATA_SIZE); + _rtw_memset((void *)data, 0xff, sizeof(u8) * PGPKT_DATA_SIZE); + _rtw_memset((void *)tmpdata, 0xff, sizeof(u8) * PGPKT_DATA_SIZE); /* */ @@ -1895,10 +1836,10 @@ hal_EfusePgPacketRead_8188e( } static int -Hal_EfusePgPacketRead(IN PADAPTER pAdapter, - IN u8 offset, - IN u8 *data, - IN BOOLEAN bPseudoTest) +Hal_EfusePgPacketRead(PADAPTER pAdapter, + u8 offset, + u8 *data, + BOOLEAN bPseudoTest) { int ret = 0; @@ -1909,10 +1850,10 @@ Hal_EfusePgPacketRead(IN PADAPTER pAdapter, } static int -Hal_EfusePgPacketRead_Pseudo(IN PADAPTER pAdapter, - IN u8 offset, - IN u8 *data, - IN BOOLEAN bPseudoTest) +Hal_EfusePgPacketRead_Pseudo(PADAPTER pAdapter, + u8 offset, + u8 *data, + BOOLEAN bPseudoTest) { int ret = 0; @@ -1922,10 +1863,10 @@ Hal_EfusePgPacketRead_Pseudo(IN PADAPTER pAdapter, } static int -rtl8188e_Efuse_PgPacketRead(IN PADAPTER pAdapter, - IN u8 offset, - IN u8 *data, - IN BOOLEAN bPseudoTest) +rtl8188e_Efuse_PgPacketRead(PADAPTER pAdapter, + u8 offset, + u8 *data, + BOOLEAN bPseudoTest) { int ret = 0; @@ -1939,18 +1880,18 @@ rtl8188e_Efuse_PgPacketRead(IN PADAPTER pAdapter, static BOOLEAN hal_EfuseFixHeaderProcess( - IN PADAPTER pAdapter, - IN u8 efuseType, - IN PPGPKT_STRUCT pFixPkt, - IN u16 *pAddr, - IN BOOLEAN bPseudoTest + PADAPTER pAdapter, + u8 efuseType, + PPGPKT_STRUCT pFixPkt, + u16 *pAddr, + BOOLEAN bPseudoTest ) { u8 originaldata[8], badworden = 0; u16 efuse_addr = *pAddr; u32 PgWriteSuccess = 0; - _rtw_memset((PVOID)originaldata, 0xff, 8); + _rtw_memset((void *)originaldata, 0xff, 8); if (Efuse_PgPacketRead(pAdapter, pFixPkt->offset, originaldata, bPseudoTest)) { /* check if data exist */ @@ -1973,11 +1914,11 @@ hal_EfuseFixHeaderProcess( static BOOLEAN hal_EfusePgPacketWrite2ByteHeader( - IN PADAPTER pAdapter, - IN u8 efuseType, - IN u16 *pAddr, - IN PPGPKT_STRUCT pTargetPkt, - IN BOOLEAN bPseudoTest) + PADAPTER pAdapter, + u8 efuseType, + u16 *pAddr, + PPGPKT_STRUCT pTargetPkt, + BOOLEAN bPseudoTest) { BOOLEAN bRet = _FALSE, bContinual = _TRUE; u16 efuse_addr = *pAddr, efuse_max_available_len = 0; @@ -1985,7 +1926,7 @@ hal_EfusePgPacketWrite2ByteHeader( u8 repeatcnt = 0; /* RTPRINT(FEEPROM, EFUSE_PG, ("Wirte 2byte header\n")); */ - EFUSE_GetEfuseDefinition(pAdapter, efuseType, TYPE_AVAILABLE_EFUSE_BYTES_BANK, (PVOID)&efuse_max_available_len, bPseudoTest); + EFUSE_GetEfuseDefinition(pAdapter, efuseType, TYPE_AVAILABLE_EFUSE_BYTES_BANK, (void *)&efuse_max_available_len, bPseudoTest); while (efuse_addr < efuse_max_available_len) { pg_header = ((pTargetPkt->offset & 0x07) << 5) | 0x0F; @@ -2056,11 +1997,11 @@ hal_EfusePgPacketWrite2ByteHeader( static BOOLEAN hal_EfusePgPacketWrite1ByteHeader( - IN PADAPTER pAdapter, - IN u8 efuseType, - IN u16 *pAddr, - IN PPGPKT_STRUCT pTargetPkt, - IN BOOLEAN bPseudoTest) + PADAPTER pAdapter, + u8 efuseType, + u16 *pAddr, + PPGPKT_STRUCT pTargetPkt, + BOOLEAN bPseudoTest) { BOOLEAN bRet = _FALSE; u8 pg_header = 0, tmp_header = 0; @@ -2102,11 +2043,11 @@ hal_EfusePgPacketWrite1ByteHeader( static BOOLEAN hal_EfusePgPacketWriteData( - IN PADAPTER pAdapter, - IN u8 efuseType, - IN u16 *pAddr, - IN PPGPKT_STRUCT pTargetPkt, - IN BOOLEAN bPseudoTest) + PADAPTER pAdapter, + u8 efuseType, + u16 *pAddr, + PPGPKT_STRUCT pTargetPkt, + BOOLEAN bPseudoTest) { BOOLEAN bRet = _FALSE; u16 efuse_addr = *pAddr; @@ -2136,11 +2077,11 @@ hal_EfusePgPacketWriteData( static BOOLEAN hal_EfusePgPacketWriteHeader( - IN PADAPTER pAdapter, - IN u8 efuseType, - IN u16 *pAddr, - IN PPGPKT_STRUCT pTargetPkt, - IN BOOLEAN bPseudoTest) + PADAPTER pAdapter, + u8 efuseType, + u16 *pAddr, + PPGPKT_STRUCT pTargetPkt, + BOOLEAN bPseudoTest) { BOOLEAN bRet = _FALSE; @@ -2154,9 +2095,9 @@ hal_EfusePgPacketWriteHeader( static BOOLEAN wordEnMatched( - IN PPGPKT_STRUCT pTargetPkt, - IN PPGPKT_STRUCT pCurPkt, - IN u8 *pWden + PPGPKT_STRUCT pTargetPkt, + PPGPKT_STRUCT pCurPkt, + u8 *pWden ) { u8 match_word_en = 0x0F; /* default all words are disabled */ @@ -2190,10 +2131,10 @@ wordEnMatched( static BOOLEAN hal_EfuseCheckIfDatafollowed( - IN PADAPTER pAdapter, - IN u8 word_cnts, - IN u16 startAddr, - IN BOOLEAN bPseudoTest + PADAPTER pAdapter, + u8 word_cnts, + u16 startAddr, + BOOLEAN bPseudoTest ) { BOOLEAN bRet = _FALSE; @@ -2209,11 +2150,11 @@ hal_EfuseCheckIfDatafollowed( static BOOLEAN hal_EfusePartialWriteCheck( - IN PADAPTER pAdapter, - IN u8 efuseType, - IN u16 *pAddr, - IN PPGPKT_STRUCT pTargetPkt, - IN BOOLEAN bPseudoTest + PADAPTER pAdapter, + u8 efuseType, + u16 *pAddr, + PPGPKT_STRUCT pTargetPkt, + BOOLEAN bPseudoTest ) { BOOLEAN bRet = _FALSE; @@ -2222,8 +2163,8 @@ hal_EfusePartialWriteCheck( u16 startAddr = 0, efuse_max_available_len = 0, efuse_max = 0; PGPKT_STRUCT curPkt; - EFUSE_GetEfuseDefinition(pAdapter, efuseType, TYPE_AVAILABLE_EFUSE_BYTES_BANK, (PVOID)&efuse_max_available_len, bPseudoTest); - EFUSE_GetEfuseDefinition(pAdapter, efuseType, TYPE_EFUSE_REAL_CONTENT_LEN, (PVOID)&efuse_max, bPseudoTest); + EFUSE_GetEfuseDefinition(pAdapter, efuseType, TYPE_AVAILABLE_EFUSE_BYTES_BANK, (void *)&efuse_max_available_len, bPseudoTest); + EFUSE_GetEfuseDefinition(pAdapter, efuseType, TYPE_EFUSE_REAL_CONTENT_LEN, (void *)&efuse_max, bPseudoTest); if (efuseType == EFUSE_WIFI) { if (bPseudoTest) @@ -2308,17 +2249,17 @@ hal_EfusePartialWriteCheck( static BOOLEAN hal_EfusePgCheckAvailableAddr( - IN PADAPTER pAdapter, - IN u8 efuseType, - IN BOOLEAN bPseudoTest + PADAPTER pAdapter, + u8 efuseType, + BOOLEAN bPseudoTest ) { u16 efuse_max_available_len = 0; /* Change to check TYPE_EFUSE_MAP_LEN ,beacuse 8188E raw 256,logic map over 256. */ - EFUSE_GetEfuseDefinition(pAdapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&efuse_max_available_len, _FALSE); + EFUSE_GetEfuseDefinition(pAdapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (void *)&efuse_max_available_len, _FALSE); - /* EFUSE_GetEfuseDefinition(pAdapter, efuseType, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&efuse_max_available_len, bPseudoTest); */ + /* EFUSE_GetEfuseDefinition(pAdapter, efuseType, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (void *)&efuse_max_available_len, bPseudoTest); */ /* RTPRINT(FEEPROM, EFUSE_PG, ("efuse_max_available_len = %d\n", efuse_max_available_len)); */ if (Efuse_GetCurrentSize(pAdapter, efuseType, bPseudoTest) >= efuse_max_available_len) { @@ -2328,16 +2269,16 @@ hal_EfusePgCheckAvailableAddr( return _TRUE; } -static VOID +static void hal_EfuseConstructPGPkt( - IN u8 offset, - IN u8 word_en, - IN u8 *pData, - IN PPGPKT_STRUCT pTargetPkt + u8 offset, + u8 word_en, + u8 *pData, + PPGPKT_STRUCT pTargetPkt ) { - _rtw_memset((PVOID)pTargetPkt->data, 0xFF, sizeof(u8) * 8); + _rtw_memset((void *)pTargetPkt->data, 0xFF, sizeof(u8) * 8); pTargetPkt->offset = offset; pTargetPkt->word_en = word_en; efuse_WordEnableDataRead(word_en, pData, pTargetPkt->data); @@ -2346,43 +2287,15 @@ hal_EfuseConstructPGPkt( /* RTPRINT(FEEPROM, EFUSE_PG, ("hal_EfuseConstructPGPkt(), targetPkt, offset=%d, word_en=0x%x, word_cnts=%d\n", pTargetPkt->offset, pTargetPkt->word_en, pTargetPkt->word_cnts)); */ } -static BOOLEAN -hal_EfusePgPacketWrite_BT( - IN PADAPTER pAdapter, - IN u8 offset, - IN u8 word_en, - IN u8 *pData, - IN BOOLEAN bPseudoTest -) -{ - PGPKT_STRUCT targetPkt; - u16 startAddr = 0; - u8 efuseType = EFUSE_BT; - if (!hal_EfusePgCheckAvailableAddr(pAdapter, efuseType, bPseudoTest)) - return _FALSE; - - hal_EfuseConstructPGPkt(offset, word_en, pData, &targetPkt); - - if (!hal_EfusePartialWriteCheck(pAdapter, efuseType, &startAddr, &targetPkt, bPseudoTest)) - return _FALSE; - - if (!hal_EfusePgPacketWriteHeader(pAdapter, efuseType, &startAddr, &targetPkt, bPseudoTest)) - return _FALSE; - - if (!hal_EfusePgPacketWriteData(pAdapter, efuseType, &startAddr, &targetPkt, bPseudoTest)) - return _FALSE; - - return _TRUE; -} static BOOLEAN hal_EfusePgPacketWrite_8188e( - IN PADAPTER pAdapter, - IN u8 offset, - IN u8 word_en, - IN u8 *pData, - IN BOOLEAN bPseudoTest + PADAPTER pAdapter, + u8 offset, + u8 word_en, + u8 *pData, + BOOLEAN bPseudoTest ) { PGPKT_STRUCT targetPkt; @@ -2408,11 +2321,11 @@ hal_EfusePgPacketWrite_8188e( static int -Hal_EfusePgPacketWrite_Pseudo(IN PADAPTER pAdapter, - IN u8 offset, - IN u8 word_en, - IN u8 *data, - IN BOOLEAN bPseudoTest) +Hal_EfusePgPacketWrite_Pseudo(PADAPTER pAdapter, + u8 offset, + u8 word_en, + u8 *data, + BOOLEAN bPseudoTest) { int ret; @@ -2422,11 +2335,11 @@ Hal_EfusePgPacketWrite_Pseudo(IN PADAPTER pAdapter, } static int -Hal_EfusePgPacketWrite(IN PADAPTER pAdapter, - IN u8 offset, - IN u8 word_en, - IN u8 *data, - IN BOOLEAN bPseudoTest) +Hal_EfusePgPacketWrite(PADAPTER pAdapter, + u8 offset, + u8 word_en, + u8 *data, + BOOLEAN bPseudoTest) { int ret = 0; ret = hal_EfusePgPacketWrite_8188e(pAdapter, offset, word_en, data, bPseudoTest); @@ -2436,11 +2349,11 @@ Hal_EfusePgPacketWrite(IN PADAPTER pAdapter, } static int -rtl8188e_Efuse_PgPacketWrite(IN PADAPTER pAdapter, - IN u8 offset, - IN u8 word_en, - IN u8 *data, - IN BOOLEAN bPseudoTest) +rtl8188e_Efuse_PgPacketWrite(PADAPTER pAdapter, + u8 offset, + u8 word_en, + u8 *data, + BOOLEAN bPseudoTest) { int ret; @@ -2486,9 +2399,14 @@ void rtl8188e_start_thread(_adapter *padapter) #ifndef CONFIG_SDIO_TX_TASKLET struct xmit_priv *xmitpriv = &padapter->xmitpriv; - xmitpriv->SdioXmitThread = kthread_run(rtl8188es_xmit_thread, padapter, "RTWHALXT"); - if (IS_ERR(xmitpriv->SdioXmitThread)) - RTW_ERR("%s: start rtl8188es_xmit_thread FAIL!!\n", __func__); + if (xmitpriv->SdioXmitThread == NULL) { + RTW_INFO(FUNC_ADPT_FMT " start RTWHALXT\n", FUNC_ADPT_ARG(padapter)); + xmitpriv->SdioXmitThread = kthread_run(rtl8188es_xmit_thread, padapter, "RTWHALXT"); + if (IS_ERR(xmitpriv->SdioXmitThread)) { + RTW_ERR("%s: start rtl8188es_xmit_thread FAIL!!\n", __func__); + xmitpriv->SdioXmitThread = NULL; + } + } #endif #endif } @@ -2502,8 +2420,8 @@ void rtl8188e_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 @@ -2519,35 +2437,6 @@ void hal_notch_filter_8188e(_adapter *adapter, bool enable) } } -void update_ra_mask_8188e(_adapter *padapter, struct sta_info *psta, struct macid_cfg *h2c_macid_cfg) -{ - HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); - - if (hal_data->fw_ractrl == _TRUE) { - u8 arg[4] = {0}; - - arg[0] = h2c_macid_cfg->mac_id;/* MACID */ - arg[1] = h2c_macid_cfg->rate_id; - arg[2] = (h2c_macid_cfg->ignore_bw << 4) | h2c_macid_cfg->short_gi; - arg[3] = psta->init_rate; - rtl8188e_set_raid_cmd(padapter, h2c_macid_cfg->ra_mask, arg, h2c_macid_cfg->bandwidth); - } else { - -#if (RATE_ADAPTIVE_SUPPORT == 1) - - odm_ra_update_rate_info_8188e( - &(hal_data->odmpriv), - h2c_macid_cfg->mac_id, - h2c_macid_cfg->rate_id, - h2c_macid_cfg->ra_mask, - h2c_macid_cfg->short_gi - ); - -#endif - } - -} - void init_hal_spec_8188e(_adapter *adapter) { struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); @@ -2556,8 +2445,12 @@ void init_hal_spec_8188e(_adapter *adapter) hal_spec->macid_num = 64; hal_spec->sec_cam_ent_num = 32; hal_spec->sec_cap = 0; + hal_spec->macid_cap = MACID_DROP; + hal_spec->rfpath_num_2g = 1; hal_spec->rfpath_num_5g = 0; + hal_spec->txgi_max = 63; + hal_spec->txgi_pdbm = 2; hal_spec->max_tx_cnt = 1; hal_spec->tx_nss_num = 1; hal_spec->rx_nss_num = 1; @@ -2570,6 +2463,22 @@ void init_hal_spec_8188e(_adapter *adapter) | WL_FUNC_MIRACAST | WL_FUNC_TDLS ; + +#if CONFIG_TX_AC_LIFETIME + hal_spec->tx_aclt_unit_factor = 1; +#endif + + hal_spec->pg_txpwr_saddr = 0x10; + hal_spec->pg_txgi_diff_factor = 1; + + rtw_macid_ctl_init_sleep_reg(adapter_to_macidctl(adapter) + , REG_MACID_PAUSE_0 + , REG_MACID_PAUSE_1, 0, 0); + rtw_macid_ctl_init_drop_reg(adapter_to_macidctl(adapter) + , REG_MACID_NO_LINK_0 + , REG_MACID_NO_LINK_1 + , 0, 0); + } #ifdef CONFIG_RFKILL_POLL @@ -2596,11 +2505,148 @@ bool rtl8188e_gpio_radio_on_off_check(_adapter *adapter, u8 *valid) } #endif -void rtl8188e_init_default_value(_adapter *adapter) -{ - HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); - adapter->registrypriv.wireless_mode = WIRELESS_11BG_24N; +void InitBeaconParameters_8188e(_adapter *adapter) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); + + rtw_write16(adapter, REG_BCN_CTRL, (DIS_TSF_UDT << 8) | DIS_TSF_UDT); + + /* TBTT setup time */ + rtw_write8(adapter, REG_TBTT_PROHIBIT, TBTT_PROHIBIT_SETUP_TIME); + + /* TBTT hold time: 0x540[19:8] */ + rtw_write8(adapter, REG_TBTT_PROHIBIT + 1, TBTT_PROHIBIT_HOLD_TIME_STOP_BCN & 0xFF); + rtw_write8(adapter, REG_TBTT_PROHIBIT + 2, + (rtw_read8(adapter, REG_TBTT_PROHIBIT + 2) & 0xF0) | (TBTT_PROHIBIT_HOLD_TIME_STOP_BCN >> 8)); + + rtw_write8(adapter, REG_DRVERLYINT, DRIVER_EARLY_INT_TIME_8188E); /* 5ms */ + rtw_write8(adapter, REG_BCNDMATIM, BCN_DMA_ATIME_INT_TIME_8188E); /* 2ms */ + + /* Suggested by designer timchen. Change beacon AIFS to the largest number */ + /* beacause test chip does not contension before sending beacon. by tynli. 2009.11.03 */ + rtw_write16(adapter, REG_BCNTCFG, 0x4413); + +} + +static void +_BeaconFunctionEnable( + PADAPTER padapter, + BOOLEAN Enable, + BOOLEAN Linked +) +{ + rtw_write8(padapter, REG_BCN_CTRL, (DIS_TSF_UDT | EN_BCN_FUNCTION | DIS_BCNQ_SUB)); + + rtw_write8(padapter, REG_RD_CTRL + 1, 0x6F); +} + +void SetBeaconRelatedRegisters8188E(PADAPTER padapter) +{ + u32 value32; + /* HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); */ + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + u32 bcn_ctrl_reg = REG_BCN_CTRL; + /* reset TSF, enable update TSF, correcting TSF On Beacon */ + + /* REG_MBSSID_BCN_SPACE */ + /* REG_BCNDMATIM */ + /* REG_ATIMWND */ + /* REG_TBTT_PROHIBIT */ + /* REG_DRVERLYINT */ + /* REG_BCN_MAX_ERR */ + /* REG_BCNTCFG */ /* (0x510) */ + /* REG_DUAL_TSF_RST */ + /* REG_BCN_CTRL */ /* (0x550) */ + + +#ifdef CONFIG_CONCURRENT_MODE + if (padapter->hw_port == HW_PORT1) + bcn_ctrl_reg = REG_BCN_CTRL_1; +#endif + /* */ + /* ATIM window */ + /* */ + rtw_write16(padapter, REG_ATIMWND, 2); + + /* */ + /* Beacon interval (in unit of TU). */ + /* */ + rtw_hal_set_hwreg(padapter, HW_VAR_BEACON_INTERVAL, (u8 *)&pmlmeinfo->bcn_interval); + + InitBeaconParameters_8188e(padapter); + + rtw_write8(padapter, REG_SLOT, 0x09); + + /* */ + /* Force beacon frame transmission even after receiving beacon frame from other ad hoc STA */ + /* */ + /* PlatformEFIOWrite1Byte(Adapter, BCN_ERR_THRESH, 0x0a); */ /* We force beacon sent to prevent unexpect disconnect status in Ad hoc mode */ + + /* */ + /* Reset TSF Timer to zero, added by Roger. 2008.06.24 */ + /* */ + value32 = rtw_read32(padapter, REG_TCR); + value32 &= ~TSFRST; + rtw_write32(padapter, REG_TCR, value32); + + value32 |= TSFRST; + rtw_write32(padapter, REG_TCR, value32); + + /* TODO: Modify later (Find the right parameters) */ + /* NOTE: Fix test chip's bug (about contention windows's randomness) */ + if (check_fwstate(&padapter->mlmepriv, WIFI_ADHOC_STATE | WIFI_AP_STATE | WIFI_MESH_STATE) == _TRUE) { + rtw_write8(padapter, REG_RXTSF_OFFSET_CCK, 0x50); + rtw_write8(padapter, REG_RXTSF_OFFSET_OFDM, 0x50); + } + + _BeaconFunctionEnable(padapter, _TRUE, _TRUE); + + ResumeTxBeacon(padapter); + rtw_write8(padapter, bcn_ctrl_reg, rtw_read8(padapter, bcn_ctrl_reg) | DIS_BCNQ_SUB); +} + +void rtl8188e_read_wmmedca_reg(PADAPTER adapter, u16 *vo_params, u16 *vi_params, u16 *be_params, u16 *bk_params) +{ + u8 vo_reg_params[4]; + u8 vi_reg_params[4]; + u8 be_reg_params[4]; + u8 bk_reg_params[4]; + + GetHwReg8188E(adapter, HW_VAR_AC_PARAM_VO, vo_reg_params); + GetHwReg8188E(adapter, HW_VAR_AC_PARAM_VI, vi_reg_params); + GetHwReg8188E(adapter, HW_VAR_AC_PARAM_BE, be_reg_params); + GetHwReg8188E(adapter, HW_VAR_AC_PARAM_BK, bk_reg_params); + + vo_params[0] = vo_reg_params[0]; + vo_params[1] = vo_reg_params[1] & 0x0F; + vo_params[2] = (vo_reg_params[1] & 0xF0) >> 4; + vo_params[3] = ((vo_reg_params[3] << 8) | (vo_reg_params[2])) * 32; + + vi_params[0] = vi_reg_params[0]; + vi_params[1] = vi_reg_params[1] & 0x0F; + vi_params[2] = (vi_reg_params[1] & 0xF0) >> 4; + vi_params[3] = ((vi_reg_params[3] << 8) | (vi_reg_params[2])) * 32; + + be_params[0] = be_reg_params[0]; + be_params[1] = be_reg_params[1] & 0x0F; + be_params[2] = (be_reg_params[1] & 0xF0) >> 4; + be_params[3] = ((be_reg_params[3] << 8) | (be_reg_params[2])) * 32; + + bk_params[0] = bk_reg_params[0]; + bk_params[1] = bk_reg_params[1] & 0x0F; + bk_params[2] = (bk_reg_params[1] & 0xF0) >> 4; + bk_params[3] = ((bk_reg_params[3] << 8) | (bk_reg_params[2])) * 32; + + vo_params[1] = (1 << vo_params[1]) - 1; + vo_params[2] = (1 << vo_params[2]) - 1; + vi_params[1] = (1 << vi_params[1]) - 1; + vi_params[2] = (1 << vi_params[2]) - 1; + be_params[1] = (1 << be_params[1]) - 1; + be_params[2] = (1 << be_params[2]) - 1; + bk_params[1] = (1 << bk_params[1]) - 1; + bk_params[2] = (1 << bk_params[2]) - 1; } void rtl8188e_set_hal_ops(struct hal_ops *pHalFunc) @@ -2610,13 +2656,10 @@ void rtl8188e_set_hal_ops(struct hal_ops *pHalFunc) pHalFunc->read_chip_version = read_chip_version_8188e; - pHalFunc->update_ra_mask_handler = update_ra_mask_8188e; - pHalFunc->set_chnl_bw_handler = &PHY_SetSwChnlBWMode8188E; pHalFunc->set_tx_power_level_handler = &PHY_SetTxPowerLevel8188E; - pHalFunc->get_tx_power_level_handler = &PHY_GetTxPowerLevel8188E; - + pHalFunc->set_tx_power_index_handler = PHY_SetTxPowerIndex_8188E; pHalFunc->get_tx_power_index_handler = &PHY_GetTxPowerIndex_8188E; pHalFunc->hal_dm_watchdog = &rtl8188e_HalDmWatchDog; @@ -2629,7 +2672,8 @@ void rtl8188e_set_hal_ops(struct hal_ops *pHalFunc) pHalFunc->read_rfreg = &PHY_QueryRFReg8188E; pHalFunc->write_rfreg = &PHY_SetRFReg8188E; - + pHalFunc->read_wmmedca_reg = &rtl8188e_read_wmmedca_reg; + /* Efuse related function */ pHalFunc->EfusePowerSwitch = &rtl8188e_EfusePowerSwitch; pHalFunc->ReadEFuse = &rtl8188e_ReadEFuse; @@ -2792,7 +2836,7 @@ Hal_InitPGData88E(PADAPTER padapter) if (is_boot_from_eeprom(padapter)) { /* Read all Content from EEPROM or EFUSE. */ for (i = 0; i < HWSET_MAX_SIZE; i += 2) { - /* value16 = EF2Byte(ReadEEprom(pAdapter, (u2Byte) (i>>1))); + /* value16 = EF2Byte(ReadEEprom(pAdapter, (u16) (i>>1))); * *((u16*)(&PROMContent[i])) = value16; */ } } else { @@ -2817,8 +2861,8 @@ Hal_InitPGData88E(PADAPTER padapter) void Hal_EfuseParseIDCode88E( - IN PADAPTER padapter, - IN u8 *hwinfo + PADAPTER padapter, + u8 *hwinfo ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); @@ -2838,8 +2882,8 @@ Hal_EfuseParseIDCode88E( void Hal_ReadPowerSavingMode88E( PADAPTER padapter, - IN u8 *hwinfo, - IN BOOLEAN AutoLoadFail + u8 *hwinfo, + BOOLEAN AutoLoadFail ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); @@ -2875,9 +2919,9 @@ void Hal_ReadPowerSavingMode88E( void Hal_ReadTxPowerInfo88E( - IN PADAPTER padapter, - IN u8 *PROMContent, - IN BOOLEAN AutoLoadFail + PADAPTER padapter, + u8 *PROMContent, + BOOLEAN AutoLoadFail ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); @@ -2901,11 +2945,11 @@ Hal_ReadTxPowerInfo88E( } -VOID +void Hal_EfuseParseXtal_8188E( - IN PADAPTER pAdapter, - IN u8 *hwinfo, - IN BOOLEAN AutoLoadFail + PADAPTER pAdapter, + u8 *hwinfo, + BOOLEAN AutoLoadFail ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); @@ -2919,11 +2963,11 @@ Hal_EfuseParseXtal_8188E( RTW_INFO("crystal_cap: 0x%2x\n", pHalData->crystal_cap); } -VOID +void Hal_ReadPAType_8188E( - IN PADAPTER Adapter, - IN u8 *PROMContent, - IN BOOLEAN AutoloadFail + PADAPTER Adapter, + u8 *PROMContent, + BOOLEAN AutoloadFail ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -2997,11 +3041,11 @@ Hal_ReadPAType_8188E( RTW_INFO("pHalData->ExternalPA_2G = %d , pHalData->ExternalLNA_2G = %d\n", pHalData->ExternalPA_2G, pHalData->ExternalLNA_2G); } -VOID +void Hal_ReadAmplifierType_8188E( - IN PADAPTER Adapter, - IN pu1Byte PROMContent, - IN BOOLEAN AutoloadFail + PADAPTER Adapter, + u8 *PROMContent, + BOOLEAN AutoloadFail ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -3035,11 +3079,11 @@ Hal_ReadAmplifierType_8188E( RTW_INFO("pHalData->TypeGLNA is 0x%x\n", pHalData->TypeGLNA); } -VOID +void Hal_ReadRFEType_8188E( - IN PADAPTER Adapter, - IN pu1Byte PROMContent, - IN BOOLEAN AutoloadFail + PADAPTER Adapter, + u8 *PROMContent, + BOOLEAN AutoloadFail ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -3083,9 +3127,9 @@ Hal_ReadRFEType_8188E( void Hal_EfuseParseBoardType88E( - IN PADAPTER pAdapter, - IN u8 *hwinfo, - IN BOOLEAN AutoLoadFail + PADAPTER pAdapter, + u8 *hwinfo, + BOOLEAN AutoLoadFail ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); @@ -3101,9 +3145,9 @@ Hal_EfuseParseBoardType88E( void Hal_EfuseParseEEPROMVer88E( - IN PADAPTER padapter, - IN u8 *hwinfo, - IN BOOLEAN AutoLoadFail + PADAPTER padapter, + u8 *hwinfo, + BOOLEAN AutoLoadFail ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); @@ -3118,27 +3162,27 @@ Hal_EfuseParseEEPROMVer88E( void rtl8188e_EfuseParseChnlPlan( - IN PADAPTER padapter, - IN u8 *hwinfo, - IN BOOLEAN AutoLoadFail + PADAPTER padapter, + u8 *hwinfo, + BOOLEAN AutoLoadFail ) { - padapter->mlmepriv.ChannelPlan = hal_com_config_channel_plan( - padapter - , hwinfo ? &hwinfo[EEPROM_COUNTRY_CODE_88E] : NULL - , hwinfo ? hwinfo[EEPROM_ChannelPlan_88E] : 0xFF - , padapter->registrypriv.alpha2 - , padapter->registrypriv.channel_plan - , RTW_CHPLAN_WORLD_NULL - , AutoLoadFail - ); + hal_com_config_channel_plan( + padapter + , hwinfo ? &hwinfo[EEPROM_COUNTRY_CODE_88E] : NULL + , hwinfo ? hwinfo[EEPROM_ChannelPlan_88E] : 0xFF + , padapter->registrypriv.alpha2 + , padapter->registrypriv.channel_plan + , RTW_CHPLAN_WORLD_NULL + , AutoLoadFail + ); } void Hal_EfuseParseCustomerID88E( - IN PADAPTER padapter, - IN u8 *hwinfo, - IN BOOLEAN AutoLoadFail + PADAPTER padapter, + u8 *hwinfo, + BOOLEAN AutoLoadFail ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); @@ -3157,11 +3201,12 @@ Hal_EfuseParseCustomerID88E( void Hal_ReadAntennaDiversity88E( - IN PADAPTER pAdapter, - IN u8 *PROMContent, - IN BOOLEAN AutoLoadFail + PADAPTER pAdapter, + u8 *PROMContent, + BOOLEAN AutoLoadFail ) { +#ifdef CONFIG_ANTENNA_DIVERSITY HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); struct registry_priv *registry_par = &pAdapter->registrypriv; @@ -3188,19 +3233,18 @@ Hal_ReadAntennaDiversity88E( pHalData->AntDivCfg = 0; RTW_INFO("EEPROM : AntDivCfg = %x, TRxAntDivType = %x\n", pHalData->AntDivCfg, pHalData->TRxAntDivType); - - +#endif } void Hal_ReadThermalMeter_88E( - IN PADAPTER Adapter, - IN u8 *PROMContent, - IN BOOLEAN AutoloadFail + PADAPTER Adapter, + u8 *PROMContent, + BOOLEAN AutoloadFail ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - u1Byte tempval; + u8 tempval; /* */ /* ThermalMeter from EEPROM */ @@ -3223,9 +3267,9 @@ Hal_ReadThermalMeter_88E( #ifdef CONFIG_RF_POWER_TRIM void Hal_ReadRFGainOffset( - IN PADAPTER Adapter, - IN u8 *PROMContent, - IN BOOLEAN AutoloadFail) + PADAPTER Adapter, + u8 *PROMContent, + BOOLEAN AutoloadFail) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); u8 thermal_offset = 0; @@ -3309,37 +3353,6 @@ void Hal_DetectWoWMode(PADAPTER pAdapter) } #endif -/* ************************************************************************************ - * - * 20100209 Joseph: - * This function is used only for 92C to set REG_BCN_CTRL(0x550) register. - * We just reserve the value of the register in variable pHalData->RegBcnCtrlVal and then operate - * the value of the register via atomic operation. - * This prevents from race condition when setting this register. - * The value of pHalData->RegBcnCtrlVal is initialized in HwConfigureRTL8192CE() function. - * */ -void SetBcnCtrlReg( - PADAPTER padapter, - u8 SetBits, - u8 ClearBits) -{ - PHAL_DATA_TYPE pHalData; - - - pHalData = GET_HAL_DATA(padapter); - - pHalData->RegBcnCtrlVal |= SetBits; - pHalData->RegBcnCtrlVal &= ~ClearBits; - -#if 0 - /* #ifdef CONFIG_SDIO_HCI */ - if (pHalData->sdio_himr & (SDIO_HIMR_TXBCNOK_MSK | SDIO_HIMR_TXBCNERR_MSK)) - pHalData->RegBcnCtrlVal |= EN_TXBCN_RPT; -#endif - - rtw_write8(padapter, REG_BCN_CTRL, (u8)pHalData->RegBcnCtrlVal); -} - void _InitTransferPageSize(PADAPTER padapter) { /* Tx page size is always 128. */ @@ -3352,19 +3365,21 @@ void _InitTransferPageSize(PADAPTER padapter) 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_) { - +#ifdef CONFIG_CUSTOMER_ALIBABA_GENERAL + rcr_bits = RCR_AAP | RCR_APM | RCR_AM | RCR_AB | RCR_APWRMGT | RCR_ADF | RCR_AMF | RCR_APP_PHYST_RXFF; +#else /* 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; /* Append FCS */ rcr_bits |= RCR_APPFCS; - +#endif #if 0 /* CRC and ICV packet will drop in recvbuf2recvframe() @@ -3373,12 +3388,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 @@ -3400,8 +3414,9 @@ static void hw_var_set_opmode(PADAPTER Adapter, u8 variable, u8 *val) HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); if (isMonitor == _TRUE) { - /* reset RCR */ - rtw_write32(Adapter, REG_RCR, pHalData->ReceiveConfig); + /* reset RCR from backup */ + rtw_hal_set_hwreg(Adapter, HW_VAR_RCR, (u8 *)&pHalData->rcr_backup); + rtw_hal_rcr_set_chk_bssid(Adapter, MLME_ACTION_NONE); isMonitor = _FALSE; } @@ -3422,13 +3437,13 @@ static void hw_var_set_opmode(PADAPTER Adapter, u8 variable, u8 *val) #ifdef CONFIG_CONCURRENT_MODE if (Adapter->hw_port == HW_PORT1) { /* disable Port1 TSF update */ - rtw_write8(Adapter, REG_BCN_CTRL_1, rtw_read8(Adapter, REG_BCN_CTRL_1) | BIT(4)); + rtw_iface_disable_tsf_update(Adapter); /* set net_type */ 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)) { #ifdef CONFIG_INTERRUPT_BASED_TXBCN #ifdef CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT rtw_write8(Adapter, REG_DRVERLYINT, 0x05);/* restore early int time to 5ms */ @@ -3457,14 +3472,14 @@ static void hw_var_set_opmode(PADAPTER Adapter, u8 variable, u8 *val) #endif } - rtw_write8(Adapter, REG_BCN_CTRL_1, 0x11); /* disable atim wnd and disable beacon function */ - /* rtw_write8(Adapter,REG_BCN_CTRL_1, 0x18); */ - } else if ((mode == _HW_STATE_ADHOC_) /*|| (mode == _HW_STATE_AP_)*/) { + rtw_write8(Adapter, REG_BCN_CTRL_1, DIS_TSF_UDT | DIS_ATIM); /* disable atim wnd and disable beacon function */ + /* rtw_write8(Adapter,REG_BCN_CTRL_1, DIS_TSF_UDT | EN_BCN_FUNCTION); */ + } else if (mode == _HW_STATE_ADHOC_) { /* Beacon is polled to TXBUF */ rtw_write32(Adapter, REG_CR, rtw_read32(Adapter, REG_CR) | BIT(8)); ResumeTxBeacon(Adapter); - rtw_write8(Adapter, REG_BCN_CTRL_1, 0x1a); + rtw_write8(Adapter, REG_BCN_CTRL_1, DIS_TSF_UDT | EN_BCN_FUNCTION | DIS_BCNQ_SUB); /* BIT4 - If set 0, hw will clr bcnq when tx becon ok/fail or port 1 */ rtw_write8(Adapter, REG_MBID_NUM, rtw_read8(Adapter, REG_MBID_NUM) | BIT(3) | BIT(4)); } else if (mode == _HW_STATE_AP_) { @@ -3487,21 +3502,11 @@ static void hw_var_set_opmode(PADAPTER Adapter, u8 variable, u8 *val) #endif /* CONFIG_INTERRUPT_BASED_TXBCN */ - ResumeTxBeacon(Adapter); - - rtw_write8(Adapter, REG_BCN_CTRL_1, 0x12); + rtw_write8(Adapter, REG_BCN_CTRL_1, DIS_TSF_UDT | DIS_BCNQ_SUB); /* Beacon is polled to TXBUF */ rtw_write32(Adapter, REG_CR, rtw_read32(Adapter, REG_CR) | BIT(8)); - /* Set RCR */ - /* rtw_write32(padapter, REG_RCR, 0x70002a8e); */ /* CBSSID_DATA must set to 0 */ - if (Adapter->registrypriv.wifi_spec) - /* for 11n Logo 4.2.31/4.2.32, disable BSSID BCN check for AP mode */ - rtw_write32(Adapter, REG_RCR, (0x7000208e & ~(RCR_CBSSID_BCN))); - else - rtw_write32(Adapter, REG_RCR, 0x7000208e);/* CBSSID_DATA must set to 0,Reject ICV_ERROR packets */ - /* enable to rx data frame */ rtw_write16(Adapter, REG_RXFLTMAP2, 0xFFFF); /* enable to rx ps-poll */ @@ -3512,16 +3517,6 @@ static void hw_var_set_opmode(PADAPTER Adapter, u8 variable, u8 *val) rtw_write8(Adapter, REG_DRVERLYINT, 0x05);/* 5ms */ /* rtw_write8(Adapter, REG_BCN_MAX_ERR, 0xFF); */ rtw_write8(Adapter, REG_ATIMWND_1, 0x0c); /* 13ms for port1 */ - rtw_write16(Adapter, REG_BCNTCFG, 0x00); - - /* TBTT setup time:128 us */ - rtw_write8(Adapter, REG_TBTT_PROHIBIT, 0x04); - - /*TBTT hold time :4ms 0x540[19:8]*/ - rtw_write8(Adapter, REG_TBTT_PROHIBIT + 1, - TBTT_PROBIHIT_HOLD_TIME & 0xFF); - rtw_write8(Adapter, REG_TBTT_PROHIBIT + 2, - (rtw_read8(Adapter, REG_TBTT_PROHIBIT + 2) & 0xF0) | (TBTT_PROBIHIT_HOLD_TIME >> 8)); rtw_write16(Adapter, REG_TSFTR_SYN_OFFSET, 0x7fff);/* +32767 (~32ms) */ @@ -3533,9 +3528,9 @@ static void hw_var_set_opmode(PADAPTER Adapter, u8 variable, u8 *val) rtw_write8(Adapter, REG_MBID_NUM, rtw_read8(Adapter, REG_MBID_NUM) | BIT(3) | BIT(4)); /* enable BCN1 Function for if2 */ /* don't enable update TSF1 for if2 (due to TSF update when beacon/probe rsp are received) */ - rtw_write8(Adapter, REG_BCN_CTRL_1, (DIS_TSF_UDT0_NORMAL_CHIP | EN_BCN_FUNCTION | EN_TXBCN_RPT | BIT(1))); + rtw_write8(Adapter, REG_BCN_CTRL_1, (DIS_TSF_UDT| EN_BCN_FUNCTION | EN_TXBCN_RPT | DIS_BCNQ_SUB)); - if (!rtw_mi_buddy_check_fwstate(Adapter, WIFI_FW_ASSOC_SUCCESS)) + if (!rtw_mi_buddy_check_mlmeinfo_state(Adapter, WIFI_FW_ASSOC_SUCCESS)) rtw_write8(Adapter, REG_BCN_CTRL, rtw_read8(Adapter, REG_BCN_CTRL) & ~EN_BCN_FUNCTION); @@ -3544,12 +3539,12 @@ static void hw_var_set_opmode(PADAPTER Adapter, u8 variable, u8 *val) /* rtw_write8(Adapter, REG_DUAL_TSF_RST, BIT(3)); */ /* dis BCN0 ATIM WND if if1 is station */ - rtw_write8(Adapter, REG_BCN_CTRL, rtw_read8(Adapter, REG_BCN_CTRL) | BIT(0)); + rtw_write8(Adapter, REG_BCN_CTRL, rtw_read8(Adapter, REG_BCN_CTRL) | DIS_ATIM); #ifdef CONFIG_TSF_RESET_OFFLOAD /* Reset TSF for STA+AP concurrent mode */ - if (rtw_mi_buddy_check_fwstate(Adapter, (WIFI_STATION_STATE | WIFI_ASOC_STATE))) { - if (reset_tsf(Adapter, HW_PORT1) == _FALSE) + if (DEV_STA_LD_NUM(adapter_to_dvobj(Adapter))) { + if (rtw_hal_reset_tsf(Adapter, HW_PORT1) == _FAIL) RTW_INFO("ERROR! %s()-%d: Reset port1 TSF fail\n", __FUNCTION__, __LINE__); } @@ -3565,14 +3560,14 @@ static void hw_var_set_opmode(PADAPTER Adapter, u8 variable, u8 *val) hw_var_set_opmode_mbid(Adapter, mode); #else /* disable Port0 TSF update */ - rtw_write8(Adapter, REG_BCN_CTRL, rtw_read8(Adapter, REG_BCN_CTRL) | BIT(4)); + rtw_iface_disable_tsf_update(Adapter); /* set net_type */ Set_MSR(Adapter, mode); if ((mode == _HW_STATE_STATION_) || (mode == _HW_STATE_NOLINK_)) { #ifdef CONFIG_CONCURRENT_MODE - if (!rtw_mi_check_status(Adapter, MI_AP_MODE)) + if (!rtw_mi_get_ap_num(Adapter) && !rtw_mi_get_mesh_num(Adapter)) #endif /*CONFIG_CONCURRENT_MODE*/ { #ifdef CONFIG_INTERRUPT_BASED_TXBCN @@ -3600,14 +3595,14 @@ static void hw_var_set_opmode(PADAPTER Adapter, u8 variable, u8 *val) #endif } - rtw_write8(Adapter, REG_BCN_CTRL, 0x19); /* disable atim wnd */ - /* rtw_write8(Adapter,REG_BCN_CTRL, 0x18); */ - } else if ((mode == _HW_STATE_ADHOC_) /*|| (mode == _HW_STATE_AP_)*/) { + rtw_write8(Adapter, REG_BCN_CTRL, DIS_TSF_UDT | EN_BCN_FUNCTION | DIS_ATIM); /* disable atim wnd */ + /* rtw_write8(Adapter,REG_BCN_CTRL, DIS_TSF_UDT | EN_BCN_FUNCTION); */ + } else if (mode == _HW_STATE_ADHOC_) { /* Beacon is polled to TXBUF */ rtw_write16(Adapter, REG_CR, rtw_read16(Adapter, REG_CR) | BIT(8)); ResumeTxBeacon(Adapter); - rtw_write8(Adapter, REG_BCN_CTRL, 0x1a); + rtw_write8(Adapter, REG_BCN_CTRL, DIS_TSF_UDT | EN_BCN_FUNCTION | DIS_BCNQ_SUB); /* BIT3 - If set 0, hw will clr bcnq when tx becon ok/fail or port 0 */ rtw_write8(Adapter, REG_MBID_NUM, rtw_read8(Adapter, REG_MBID_NUM) | BIT(3) | BIT(4)); } else if (mode == _HW_STATE_AP_) { @@ -3630,20 +3625,11 @@ static void hw_var_set_opmode(PADAPTER Adapter, u8 variable, u8 *val) #endif /* CONFIG_INTERRUPT_BASED_TXBCN */ - ResumeTxBeacon(Adapter); - - rtw_write8(Adapter, REG_BCN_CTRL, 0x12); + rtw_write8(Adapter, REG_BCN_CTRL, DIS_TSF_UDT | DIS_BCNQ_SUB); /* Beacon is polled to TXBUF */ rtw_write32(Adapter, REG_CR, rtw_read32(Adapter, REG_CR) | BIT(8)); - /* Set RCR */ - /* rtw_write32(padapter, REG_RCR, 0x70002a8e); */ /* CBSSID_DATA must set to 0 */ - if (Adapter->registrypriv.wifi_spec) - /* for 11n Logo 4.2.31/4.2.32, disable BSSID BCN check for AP mode */ - rtw_write32(Adapter, REG_RCR, (0x7000208e & ~(RCR_CBSSID_BCN))); - else - rtw_write32(Adapter, REG_RCR, 0x7000208e);/* CBSSID_DATA must set to 0,reject ICV_ERR packet */ /* enable to rx data frame */ rtw_write16(Adapter, REG_RXFLTMAP2, 0xFFFF); /* enable to rx ps-poll */ @@ -3654,16 +3640,6 @@ static void hw_var_set_opmode(PADAPTER Adapter, u8 variable, u8 *val) rtw_write8(Adapter, REG_DRVERLYINT, 0x05);/* 5ms */ /* rtw_write8(Adapter, REG_BCN_MAX_ERR, 0xFF); */ rtw_write8(Adapter, REG_ATIMWND, 0x0c); /* 13ms */ - rtw_write16(Adapter, REG_BCNTCFG, 0x00); - - /* TBTT setup time:128 us */ - rtw_write8(Adapter, REG_TBTT_PROHIBIT, 0x04); - - /*TBTT hold time :4ms 0x540[19:8]*/ - rtw_write8(Adapter, REG_TBTT_PROHIBIT + 1, - TBTT_PROBIHIT_HOLD_TIME & 0xFF); - rtw_write8(Adapter, REG_TBTT_PROHIBIT + 2, - (rtw_read8(Adapter, REG_TBTT_PROHIBIT + 2) & 0xF0) | (TBTT_PROBIHIT_HOLD_TIME >> 8)); rtw_write16(Adapter, REG_TSFTR_SYN_OFFSET, 0x7fff);/* +32767 (~32ms) */ @@ -3676,23 +3652,23 @@ static void hw_var_set_opmode(PADAPTER Adapter, u8 variable, u8 *val) /* enable BCN0 Function for if1 */ /* don't enable update TSF0 for if1 (due to TSF update when beacon/probe rsp are received) */ #if defined(CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR) - rtw_write8(Adapter, REG_BCN_CTRL, (DIS_TSF_UDT0_NORMAL_CHIP | EN_BCN_FUNCTION | EN_TXBCN_RPT | BIT(1))); + rtw_write8(Adapter, REG_BCN_CTRL, (DIS_TSF_UDT| EN_BCN_FUNCTION | EN_TXBCN_RPT | DIS_BCNQ_SUB)); #else - rtw_write8(Adapter, REG_BCN_CTRL, (DIS_TSF_UDT0_NORMAL_CHIP | EN_BCN_FUNCTION | BIT(1))); + rtw_write8(Adapter, REG_BCN_CTRL, (DIS_TSF_UDT | EN_BCN_FUNCTION | DIS_BCNQ_SUB)); #endif #ifdef CONFIG_CONCURRENT_MODE - if (!rtw_mi_buddy_check_fwstate(Adapter, WIFI_FW_ASSOC_SUCCESS)) + if (!rtw_mi_buddy_check_mlmeinfo_state(Adapter, WIFI_FW_ASSOC_SUCCESS)) rtw_write8(Adapter, REG_BCN_CTRL_1, rtw_read8(Adapter, REG_BCN_CTRL_1) & ~EN_BCN_FUNCTION); #endif /* dis BCN1 ATIM WND if if2 is station */ - rtw_write8(Adapter, REG_BCN_CTRL_1, rtw_read8(Adapter, REG_BCN_CTRL_1) | BIT(0)); + rtw_write8(Adapter, REG_BCN_CTRL_1, rtw_read8(Adapter, REG_BCN_CTRL_1) | DIS_ATIM); #ifdef CONFIG_TSF_RESET_OFFLOAD /* Reset TSF for STA+AP concurrent mode */ - if (rtw_mi_buddy_check_fwstate(Adapter, (WIFI_STATION_STATE | WIFI_ASOC_STATE))) { - if (reset_tsf(Adapter, HW_PORT0) == _FALSE) + if (DEV_STA_LD_NUM(adapter_to_dvobj(Adapter))) { + if (rtw_hal_reset_tsf(Adapter, HW_PORT0) == _FAIL) RTW_INFO("ERROR! %s()-%d: Reset port0 TSF fail\n", __FUNCTION__, __LINE__); } @@ -3705,468 +3681,24 @@ static void hw_var_set_opmode(PADAPTER Adapter, u8 variable, u8 *val) } } -static void hw_var_set_bcn_func(PADAPTER Adapter, u8 variable, u8 *val) -{ - u32 bcn_ctrl_reg; - -#ifdef CONFIG_CONCURRENT_MODE - if (Adapter->hw_port == HW_PORT1) - bcn_ctrl_reg = REG_BCN_CTRL_1; - else -#endif - bcn_ctrl_reg = REG_BCN_CTRL; - - - if (*((u8 *)val)) - rtw_write8(Adapter, bcn_ctrl_reg, (EN_BCN_FUNCTION | EN_TXBCN_RPT)); - else - rtw_write8(Adapter, bcn_ctrl_reg, rtw_read8(Adapter, bcn_ctrl_reg) & (~(EN_BCN_FUNCTION | EN_TXBCN_RPT))); - - -} - -static void hw_var_set_correct_tsf(PADAPTER Adapter, u8 variable, u8 *val) -{ -#ifdef CONFIG_MI_WITH_MBSSID_CAM - /*do nothing*/ -#else - u64 tsf; - struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); - - if (((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE)) { - /* pHalData->RegTxPause |= STOP_BCNQ;BIT(6) */ - /* rtw_write8(Adapter, REG_TXPAUSE, (rtw_read8(Adapter, REG_TXPAUSE)|BIT(6))); */ - StopTxBeacon(Adapter); - } - - /*tsf = pmlmeext->TSFValue - ((u32)pmlmeext->TSFValue % (pmlmeinfo->bcn_interval*1024)) -1024; //us */ - tsf = pmlmeext->TSFValue - rtw_modular64(pmlmeext->TSFValue, (pmlmeinfo->bcn_interval * 1024)) - 1024; /*us*/ - - rtw_hal_correct_tsf(Adapter, Adapter->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(Adapter, MI_AP_MODE)) { - - 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 (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)) { - /* pHalData->RegTxPause &= (~STOP_BCNQ); */ - /* rtw_write8(Adapter, REG_TXPAUSE, (rtw_read8(Adapter, REG_TXPAUSE)&(~BIT(6)))); */ - ResumeTxBeacon(Adapter); - } -#endif /*CONFIG_MI_WITH_MBSSID_CAM*/ -} - -static void hw_var_set_mlme_disconnect(PADAPTER Adapter, u8 variable, u8 *val) -{ - /*Set RCR to not to receive data frame when NO LINK state - rtw_write32(Adapter, REG_RCR, rtw_read32(padapter, REG_RCR) & ~RCR_ADF); - reject all data frames */ -#ifdef CONFIG_CONCURRENT_MODE - if (rtw_mi_check_status(Adapter, MI_LINKED) == _FALSE) -#endif - rtw_write16(Adapter, REG_RXFLTMAP2, 0x00); - -#ifdef CONFIG_CONCURRENT_MODE - if (Adapter->hw_port == HW_PORT1) { - /*reset TSF1*/ - rtw_write8(Adapter, REG_DUAL_TSF_RST, BIT(1)); - - /*disable update TSF1*/ - rtw_write8(Adapter, REG_BCN_CTRL_1, rtw_read8(Adapter, REG_BCN_CTRL_1) | DIS_TSF_UDT); - - /* disable Port1's beacon function*/ - rtw_write8(Adapter, REG_BCN_CTRL_1, rtw_read8(Adapter, REG_BCN_CTRL_1) & (~BIT(3))); - } else -#endif - { - /*reset TSF*/ - rtw_write8(Adapter, REG_DUAL_TSF_RST, BIT(0)); - - /*disable update TSF*/ - rtw_write8(Adapter, REG_BCN_CTRL, rtw_read8(Adapter, REG_BCN_CTRL) | DIS_TSF_UDT); - } - -} - - -static void hw_var_set_mlme_sitesurvey(PADAPTER Adapter, u8 variable, u8 *val) -{ - struct dvobj_priv *dvobj = adapter_to_dvobj(Adapter); - u32 value_rcr, rcr_clear_bit; - u16 value_rxfltmap2; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - int i; - _adapter *iface; - -#ifdef DBG_IFACE_STATUS - DBG_IFACE_STATUS_DUMP(Adapter); -#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(Adapter, WIFI_AP_STATE)) - rcr_clear_bit = RCR_CBSSID_BCN; - -#ifdef CONFIG_TDLS - /* TDLS will clear RCR_CBSSID_DATA bit for connection.*/ - else if (Adapter->tdlsinfo.link_established == _TRUE) - rcr_clear_bit = RCR_CBSSID_BCN; -#endif /*CONFIG_TDLS*/ - - value_rcr = rtw_read32(Adapter, 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(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) && - 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/*CONFIG_MI_WITH_MBSSID_CAM*/ - - value_rcr &= ~(rcr_clear_bit); - rtw_write32(Adapter, REG_RCR, value_rcr); - - /* Save orignal RRSR setting.*/ - pHalData->RegRRSR = rtw_read16(Adapter, REG_RRSR); - - if (rtw_mi_check_status(Adapter, MI_AP_MODE)) - 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)) - rtw_write16(Adapter, REG_RXFLTMAP2, 0xFFFF);/*enable to rx data frame*/ - -#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 (Adapter->registrypriv.wifi_spec && MLME_IS_AP(Adapter)) - value_rcr &= ~(RCR_CBSSID_BCN); - - rtw_write32(Adapter, 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(Adapter, REG_RRSR, pHalData->RegRRSR); - - if (rtw_mi_get_ap_num(Adapter)) { - ResumeTxBeacon(Adapter); - rtw_mi_tx_beacon_hdl(Adapter); - } - } -} - -static void hw_var_set_mlme_join(PADAPTER Adapter, u8 variable, u8 *val) -{ -#ifdef CONFIG_CONCURRENT_MODE - u8 RetryLimit = 0x30; - u8 type = *((u8 *)val); - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; - - if (type == 0) { /* prepare to join */ - if (rtw_mi_check_status(Adapter, MI_AP_MODE)) - StopTxBeacon(Adapter); - - /*enable to rx data frame.Accept all data frame*/ - /*rtw_write32(padapter, REG_RCR, rtw_read32(padapter, REG_RCR)|RCR_ADF);*/ - rtw_write16(Adapter, REG_RXFLTMAP2, 0xFFFF); -#ifdef CONFIG_MI_WITH_MBSSID_CAM - /* - if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) && (rtw_mi_get_assoced_sta_num(Adapter) == 1)) - rtw_write32(Adapter, REG_RCR, rtw_read32(Adapter, 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(Adapter, REG_RCR, rtw_read32(Adapter, REG_RCR)|RCR_CBSSID_BCN); - else*/ - rtw_write32(Adapter, REG_RCR, rtw_read32(Adapter, REG_RCR) & (~(RCR_CBSSID_DATA | RCR_CBSSID_BCN))); -#else - if (rtw_mi_check_status(Adapter, MI_AP_MODE)) - rtw_write32(Adapter, REG_RCR, rtw_read32(Adapter, REG_RCR) | RCR_CBSSID_BCN); - else - rtw_write32(Adapter, REG_RCR, rtw_read32(Adapter, REG_RCR) | RCR_CBSSID_DATA | RCR_CBSSID_BCN); -#endif - if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) - RetryLimit = (pHalData->CustomerID == RT_CID_CCX) ? 7 : 48; - else /* Ad-hoc Mode */ - RetryLimit = 0x7; - } else if (type == 1) { /* joinbss_event call back when join res < 0 */ - if (rtw_mi_check_status(Adapter, MI_LINKED) == _FALSE) - rtw_write16(Adapter, REG_RXFLTMAP2, 0x00); - - if (rtw_mi_check_status(Adapter, MI_AP_MODE)) { - ResumeTxBeacon(Adapter); - - /* reset TSF 1/2 after ResumeTxBeacon */ - rtw_write8(Adapter, REG_DUAL_TSF_RST, BIT(1) | BIT(0)); - - } - } else if (type == 2) { /* sta add event call back */ -#ifdef CONFIG_MI_WITH_MBSSID_CAM - /*if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) && (rtw_mi_get_assoced_sta_num(Adapter) == 1)) - rtw_write8(Adapter, REG_BCN_CTRL, rtw_read8(Adapter, REG_BCN_CTRL)&(~DIS_TSF_UDT));*/ -#else - /* enable update TSF */ - if (Adapter->hw_port == HW_PORT1) - rtw_write8(Adapter, REG_BCN_CTRL_1, rtw_read8(Adapter, REG_BCN_CTRL_1) & (~DIS_TSF_UDT)); - else - rtw_write8(Adapter, REG_BCN_CTRL, rtw_read8(Adapter, REG_BCN_CTRL) & (~DIS_TSF_UDT)); - -#endif - if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE)) { - /* fixed beacon issue for 8191su........... */ - rtw_write8(Adapter, 0x542 , 0x02); - RetryLimit = 0x7; - } - - - if (rtw_mi_check_status(Adapter, MI_AP_MODE)) { - ResumeTxBeacon(Adapter); - - /* reset TSF 1/2 after ResumeTxBeacon */ - rtw_write8(Adapter, REG_DUAL_TSF_RST, BIT(1) | BIT(0)); - } - - } - - rtw_write16(Adapter, REG_RL, RetryLimit << RETRY_LIMIT_SHORT_SHIFT | RetryLimit << RETRY_LIMIT_LONG_SHIFT); - -#endif -} - - - -void SetHwReg8188E(_adapter *adapter, u8 variable, u8 *val) +u8 SetHwReg8188E(_adapter *adapter, u8 variable, u8 *val) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); - struct PHY_DM_STRUCT *podmpriv = &pHalData->odmpriv; + struct dm_struct *podmpriv = &pHalData->odmpriv; + u8 ret = _SUCCESS; switch (variable) { case HW_VAR_SET_OPMODE: hw_var_set_opmode(adapter, variable, val); break; - case HW_VAR_BASIC_RATE: { - struct mlme_ext_info *mlmext_info = &adapter->mlmeextpriv.mlmext_info; - u16 input_b = 0, masked = 0, ioted = 0, BrateCfg = 0; - u16 rrsr_2g_force_mask = RRSR_CCK_RATES; - u16 rrsr_2g_allow_mask = (RRSR_24M | RRSR_12M | RRSR_6M | RRSR_CCK_RATES); - - HalSetBrateCfg(adapter, val, &BrateCfg); - input_b = BrateCfg; - - /* apply force and allow mask */ - BrateCfg |= rrsr_2g_force_mask; - BrateCfg &= rrsr_2g_allow_mask; - masked = BrateCfg; - - /* IOT consideration */ - if (mlmext_info->assoc_AP_vendor == HT_IOT_PEER_CISCO) { - /* if peer is cisco and didn't use ofdm rate, we enable 6M ack */ - if ((BrateCfg & (RRSR_24M | RRSR_12M | RRSR_6M)) == 0) - BrateCfg |= RRSR_6M; - } - ioted = BrateCfg; - - pHalData->BasicRateSet = BrateCfg; - - RTW_INFO("HW_VAR_BASIC_RATE: %#x->%#x->%#x\n", input_b, masked, ioted); - - /* Set RRSR rate table. */ - rtw_write16(adapter, REG_RRSR, BrateCfg); - rtw_write8(adapter, REG_RRSR + 2, rtw_read8(adapter, REG_RRSR + 2) & 0xf0); - - rtw_hal_set_hwreg(adapter, HW_VAR_INIT_RTS_RATE, (u8 *)&BrateCfg); - } + case HW_VAR_BASIC_RATE: + rtw_var_set_basic_rate(adapter, val); break; case HW_VAR_TXPAUSE: rtw_write8(adapter, REG_TXPAUSE, *((u8 *)val)); break; - case HW_VAR_BCN_FUNC: - hw_var_set_bcn_func(adapter, variable, val); - break; - case HW_VAR_CORRECT_TSF: - hw_var_set_correct_tsf(adapter, variable, val); - break; - - case HW_VAR_CHECK_BSSID: - if (*((u8 *)val)) - rtw_write32(adapter, REG_RCR, rtw_read32(adapter, REG_RCR) | RCR_CBSSID_DATA | RCR_CBSSID_BCN); - else { - u32 val32; - - val32 = rtw_read32(adapter, REG_RCR); - - val32 &= ~(RCR_CBSSID_DATA | RCR_CBSSID_BCN); - - rtw_write32(adapter, REG_RCR, val32); - } - break; - - case HW_VAR_MLME_DISCONNECT: - hw_var_set_mlme_disconnect(adapter, variable, val); - break; - - case HW_VAR_MLME_SITESURVEY: - hw_var_set_mlme_sitesurvey(adapter, variable, val); - break; - - case HW_VAR_MLME_JOIN: -#ifdef CONFIG_CONCURRENT_MODE - hw_var_set_mlme_join(adapter, variable, val); -#else - { - u8 RetryLimit = 0x30; - u8 type = *((u8 *)val); - struct mlme_priv *pmlmepriv = &adapter->mlmepriv; - - 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(adapter, REG_RXFLTMAP2, 0xFFFF); - - if (adapter->in_cta_test) { - u32 v = rtw_read32(adapter, REG_RCR); - v &= ~(RCR_CBSSID_DATA | RCR_CBSSID_BCN); /* | RCR_ADF */ - rtw_write32(adapter, REG_RCR, v); - } else - rtw_write32(adapter, REG_RCR, rtw_read32(adapter, REG_RCR) | RCR_CBSSID_DATA | RCR_CBSSID_BCN); - - if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) - RetryLimit = (pHalData->CustomerID == RT_CID_CCX) ? 7 : 48; - else /* Ad-hoc Mode */ - RetryLimit = 0x7; - } else if (type == 1) /* joinbss_event call back when join res < 0 */ - rtw_write16(adapter, REG_RXFLTMAP2, 0x00); - else if (type == 2) { /* sta add event call back */ - /* enable update TSF */ - rtw_write8(adapter, REG_BCN_CTRL, rtw_read8(adapter, REG_BCN_CTRL) & (~BIT(4))); - - if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE)) - RetryLimit = 0x7; - } - - rtw_write16(adapter, REG_RL, RetryLimit << RETRY_LIMIT_SHORT_SHIFT | RetryLimit << RETRY_LIMIT_LONG_SHIFT); - } -#endif - break; - - case HW_VAR_ON_RCR_AM: - rtw_write32(adapter, REG_RCR, rtw_read32(adapter, REG_RCR) | RCR_AM); - RTW_INFO("%s, %d, RCR= %x\n", __FUNCTION__, __LINE__, rtw_read32(adapter, REG_RCR)); - break; - case HW_VAR_OFF_RCR_AM: - rtw_write32(adapter, REG_RCR, rtw_read32(adapter, REG_RCR) & (~RCR_AM)); - RTW_INFO("%s, %d, RCR= %x\n", __FUNCTION__, __LINE__, rtw_read32(adapter, REG_RCR)); - break; - case HW_VAR_BEACON_INTERVAL: - rtw_write16(adapter, REG_BCN_INTERVAL, *((u16 *)val)); -#ifdef CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT - { - struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); - u16 bcn_interval = *((u16 *)val); - if ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) { - RTW_INFO("%s==> bcn_interval:%d, eraly_int:%d\n", __FUNCTION__, bcn_interval, bcn_interval >> 1); - rtw_write8(adapter, REG_DRVERLYINT, bcn_interval >> 1); /* 50ms for sdio */ - } - } -#endif/* CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT */ - - break; case HW_VAR_SLOT_TIME: { rtw_write8(adapter, REG_SLOT, val[0]); } @@ -4186,31 +3718,8 @@ void SetHwReg8188E(_adapter *adapter, u8 variable, u8 *val) rtw_write8(adapter, REG_WMAC_TRXPTCL_CTL + 2, regTmp); } break; - case HW_VAR_CAM_EMPTY_ENTRY: { - u8 ucIndex = *((u8 *)val); - u8 i; - u32 ulCommand = 0; - u32 ulContent = 0; - u32 ulEncAlgo = CAM_AES; - - for (i = 0; i < CAM_CONTENT_COUNT; i++) { - /* filled id in CAM config 2 byte */ - if (i == 0) { - ulContent |= (ucIndex & 0x03) | ((u16)(ulEncAlgo) << 2); - /* ulContent |= CAM_VALID; */ - } else - ulContent = 0; - /* polling bit, and No Write enable, and address */ - ulCommand = CAM_CONTENT_COUNT * ucIndex + i; - ulCommand = ulCommand | CAM_POLLINIG | CAM_WRITE; - /* write content 0 is equall to mark invalid */ - rtw_write32(adapter, WCAMI, ulContent); /* delay_ms(40); */ - rtw_write32(adapter, RWCAM, ulCommand); /* delay_ms(40); */ - } - } - break; case HW_VAR_CAM_INVALID_ALL: - rtw_write32(adapter, RWCAM, BIT(31) | BIT(30)); + rtw_write32(adapter, REG_CAMCMD, BIT(31) | BIT(30)); break; case HW_VAR_AC_PARAM_VO: rtw_write32(adapter, REG_EDCA_VO_PARAM, ((u32 *)(val))[0]); @@ -4232,7 +3741,7 @@ void SetHwReg8188E(_adapter *adapter, u8 variable, u8 *val) if (acm_ctrl > 1) AcmCtrl = AcmCtrl | 0x1; - if (acm_ctrl & BIT(3)) + if (acm_ctrl & BIT(1)) AcmCtrl |= AcmHw_VoqEn; else AcmCtrl &= (~AcmHw_VoqEn); @@ -4242,7 +3751,7 @@ void SetHwReg8188E(_adapter *adapter, u8 variable, u8 *val) else AcmCtrl &= (~AcmHw_ViqEn); - if (acm_ctrl & BIT(1)) + if (acm_ctrl & BIT(3)) AcmCtrl |= AcmHw_BeqEn; else AcmCtrl &= (~AcmHw_BeqEn); @@ -4251,6 +3760,7 @@ void SetHwReg8188E(_adapter *adapter, u8 variable, u8 *val) rtw_write8(adapter, REG_ACMHWCTRL, AcmCtrl); } break; +#ifdef CONFIG_80211N_HT case HW_VAR_AMPDU_FACTOR: { u8 RegToSet_Normal[4] = {0x41, 0xa8, 0x72, 0xb9}; u8 RegToSet_BT[4] = {0x31, 0x74, 0x42, 0x97}; @@ -4285,13 +3795,10 @@ void SetHwReg8188E(_adapter *adapter, u8 variable, u8 *val) } } break; +#endif /* CONFIG_80211N_HT */ case HW_VAR_H2C_FW_PWRMODE: { u8 psmode = (*(u8 *)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(podmpriv, _TRUE); rtl8188e_set_FwPwrMode_cmd(adapter, psmode); } break; @@ -4307,14 +3814,6 @@ void SetHwReg8188E(_adapter *adapter, u8 variable, u8 *val) } break; #endif /* CONFIG_P2P_PS */ -#ifdef CONFIG_TDLS - case HW_VAR_TDLS_WRCR: - rtw_write32(adapter, REG_RCR, rtw_read32(adapter, REG_RCR) & (~RCR_CBSSID_DATA)); - break; - case HW_VAR_TDLS_RS_RCR: - rtw_write32(adapter, REG_RCR, rtw_read32(adapter, REG_RCR) | (RCR_CBSSID_DATA)); - break; -#endif /* CONFIG_TDLS */ #ifdef CONFIG_BT_COEXIST case HW_VAR_BT_SET_COEXIST: { u8 bStart = (*(u8 *)val); @@ -4393,14 +3892,14 @@ void SetHwReg8188E(_adapter *adapter, u8 variable, u8 *val) u16 val16; u32 reg_200 = 0, reg_204 = 0; u32 init_reg_200 = 0, init_reg_204 = 0; - u32 start = rtw_get_current_time(); + systime start = rtw_get_current_time(); u32 pass_ms; int i = 0; retry_limit = 0x01; - val16 = retry_limit << RETRY_LIMIT_SHORT_SHIFT | retry_limit << RETRY_LIMIT_LONG_SHIFT; - rtw_write16(adapter, REG_RL, val16); + val16 = BIT_SRL(retry_limit) | BIT_LRL(retry_limit); + rtw_write16(adapter, REG_RETRY_LIMIT, val16); while (rtw_get_passing_time_ms(start) < 2000 && !RTW_CANNOT_RUN(adapter) @@ -4433,9 +3932,9 @@ void SetHwReg8188E(_adapter *adapter, u8 variable, u8 *val) } else RTW_INFO("%s:(HW_VAR_CHECK_TXBUF)TXBUF Empty(%d) in %d ms\n", __FUNCTION__, i, pass_ms); - retry_limit = 0x30; - val16 = retry_limit << RETRY_LIMIT_SHORT_SHIFT | retry_limit << RETRY_LIMIT_LONG_SHIFT; - rtw_write16(adapter, REG_RL, val16); + retry_limit = RL_VAL_STA; + val16 = BIT_SRL(retry_limit) | BIT_LRL(retry_limit); + rtw_write16(adapter, REG_RETRY_LIMIT, val16); } break; case HW_VAR_RESP_SIFS: { @@ -4516,69 +4015,12 @@ void SetHwReg8188E(_adapter *adapter, u8 variable, u8 *val) } break; - case HW_VAR_MACID_SLEEP: { - u32 reg_macid_sleep; - u8 bit_shift; - u8 id = *(u8 *)val; - u32 val32; - - if (id < 32) { - reg_macid_sleep = REG_MACID_PAUSE_0; - bit_shift = id; - } else if (id < 64) { - reg_macid_sleep = REG_MACID_PAUSE_1; - bit_shift = id - 32; - } else { - rtw_warn_on(1); - break; - } - - val32 = rtw_read32(adapter, reg_macid_sleep); - RTW_INFO(FUNC_ADPT_FMT ": [HW_VAR_MACID_SLEEP] macid=%d, org reg_0x%03x=0x%08X\n", - FUNC_ADPT_ARG(adapter), id, reg_macid_sleep, val32); - - if (val32 & BIT(bit_shift)) - break; - - val32 |= BIT(bit_shift); - rtw_write32(adapter, reg_macid_sleep, val32); - } - break; - - case HW_VAR_MACID_WAKEUP: { - u32 reg_macid_sleep; - u8 bit_shift; - u8 id = *(u8 *)val; - u32 val32; - - if (id < 32) { - reg_macid_sleep = REG_MACID_PAUSE_0; - bit_shift = id; - } else if (id < 64) { - reg_macid_sleep = REG_MACID_PAUSE_1; - bit_shift = id - 32; - } else { - rtw_warn_on(1); - break; - } - - val32 = rtw_read32(adapter, reg_macid_sleep); - RTW_INFO(FUNC_ADPT_FMT ": [HW_VAR_MACID_WAKEUP] macid=%d, org reg_0x%03x=0x%08X\n", - FUNC_ADPT_ARG(adapter), id, reg_macid_sleep, val32); - - if (!(val32 & BIT(bit_shift))) - break; - - val32 &= ~BIT(bit_shift); - rtw_write32(adapter, reg_macid_sleep, val32); - } - break; - default: - SetHwReg(adapter, variable, val); + ret = SetHwReg(adapter, variable, val); break; } + return ret; } struct qinfo_88e { @@ -4655,10 +4097,31 @@ void dump_mac_qinfo_88e(void *sel, _adapter *adapter) dump_bcn_qinfo_88e(sel, (struct bcn_qinfo_88e *)&bcn_q_info, "BCN "); } +static void dump_mac_txfifo_88e(void *sel, _adapter *adapter) +{ + u32 rqpn, rqpn_npq; + u32 hpq, lpq, npq, 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); + + 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, PUBQ: %d\n" + , hpq, lpq, npq, pubq); +} + void GetHwReg8188E(_adapter *adapter, u8 variable, u8 *val) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); - + u32 val32; switch (variable) { case HW_VAR_SYS_CLKR: @@ -4668,36 +4131,59 @@ void GetHwReg8188E(_adapter *adapter, u8 variable, u8 *val) case HW_VAR_TXPAUSE: val[0] = rtw_read8(adapter, REG_TXPAUSE); break; + case HW_VAR_BCN_VALID: /* BCN_VALID, BIT16 of REG_TDECTRL = BIT0 of REG_TDECTRL+2 */ val[0] = (BIT0 & rtw_read8(adapter, REG_TDECTRL + 2)) ? _TRUE : _FALSE; break; - case HW_VAR_FWLPS_RF_ON: { - /* When we halt NIC, we should check if FW LPS is leave. */ - if (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[0] = _TRUE; - } else { - u32 valRCR; - valRCR = rtw_read32(adapter, REG_RCR); - valRCR &= 0x00070000; - if (valRCR) - val[0] = _FALSE; - else - val[0] = _TRUE; - } - } - break; + + case HW_VAR_AC_PARAM_VO: + val32 = rtw_read32(adapter, REG_EDCA_VO_PARAM); + val[0] = val32 & 0xFF; + val[1] = (val32 >> 8) & 0xFF; + val[2] = (val32 >> 16) & 0xFF; + val[3] = (val32 >> 24) & 0x07; + break; + + case HW_VAR_AC_PARAM_VI: + val32 = rtw_read32(adapter, REG_EDCA_VI_PARAM); + val[0] = val32 & 0xFF; + val[1] = (val32 >> 8) & 0xFF; + val[2] = (val32 >> 16) & 0xFF; + val[3] = (val32 >> 24) & 0x07; + break; + + case HW_VAR_AC_PARAM_BE: + val32 = rtw_read32(adapter, REG_EDCA_BE_PARAM); + val[0] = val32 & 0xFF; + val[1] = (val32 >> 8) & 0xFF; + val[2] = (val32 >> 16) & 0xFF; + val[3] = (val32 >> 24) & 0x07; + break; + + case HW_VAR_AC_PARAM_BK: + val32 = rtw_read32(adapter, REG_EDCA_BK_PARAM); + val[0] = val32 & 0xFF; + val[1] = (val32 >> 8) & 0xFF; + val[2] = (val32 >> 16) & 0xFF; + val[3] = (val32 >> 24) & 0x07; + break; + case HW_VAR_EFUSE_BYTES: /* To get EFUE total used bytes, added by Roger, 2008.12.22. */ *((u16 *)(val)) = pHalData->EfuseUsedBytes; break; case HW_VAR_CHK_HI_QUEUE_EMPTY: *val = ((rtw_read32(adapter, REG_HGQ_INFO) & 0x0000ff00) == 0) ? _TRUE : _FALSE; break; + case HW_VAR_CHK_MGQ_CPU_EMPTY: + *val = (rtw_read16(adapter, REG_TXPKT_EMPTY) & BIT8) ? _TRUE : _FALSE; + break; case HW_VAR_DUMP_MAC_QUEUE_INFO: dump_mac_qinfo_88e(val, adapter); break; + case HW_VAR_DUMP_MAC_TXFIFO: + dump_mac_txfifo_88e(val, adapter); + break; default: GetHwReg(adapter, variable, val); break; @@ -4731,26 +4217,32 @@ void hal_ra_info_dump(_adapter *padapter , void *sel) mac_id = (u8) i; if (bLinked) { - _RTW_PRINT_SEL(sel , "============ RA status - Mac_id:%d ===================\n", mac_id); + RTW_PRINT_SEL(sel , "============ RA status - Mac_id:%d ===================\n", mac_id); if (pHalData->fw_ractrl == _FALSE) { #if (RATE_ADAPTIVE_SUPPORT == 1) - _RTW_PRINT_SEL(sel , "Mac_id:%d ,RSSI:%d(%%)\n", mac_id, pHalData->odmpriv.ra_info[mac_id].rssi_sta_ra); + RTW_PRINT_SEL(sel , "Mac_id:%d ,RSSI:%d(%%)\n", mac_id, pHalData->odmpriv.ra_info[mac_id].rssi_sta_ra); - _RTW_PRINT_SEL(sel , "rate_sgi = %d, decision_rate = %s\n", pHalData->odmpriv.ra_info[mac_id].rate_sgi, - HDATA_RATE(pHalData->odmpriv.ra_info[mac_id].decision_rate)); + RTW_PRINT_SEL(sel , "rate_sgi = %d, decision_rate = %s\n", rtw_get_current_tx_sgi(padapter, macid_ctl->sta[mac_id]), + HDATA_RATE(rtw_get_current_tx_rate(padapter, macid_ctl->sta[mac_id]))); - _RTW_PRINT_SEL(sel , "pt_stage = %d\n", pHalData->odmpriv.ra_info[mac_id].pt_stage); + RTW_PRINT_SEL(sel , "pt_stage = %d\n", pHalData->odmpriv.ra_info[mac_id].pt_stage); - _RTW_PRINT_SEL(sel , "rate_id = %d,ra_use_rate = 0x%08x\n", pHalData->odmpriv.ra_info[mac_id].rate_id, pHalData->odmpriv.ra_info[mac_id].ra_use_rate); + RTW_PRINT_SEL(sel , "rate_id = %d,ra_use_rate = 0x%08x\n", pHalData->odmpriv.ra_info[mac_id].rate_id, pHalData->odmpriv.ra_info[mac_id].ra_use_rate); #endif /* (RATE_ADAPTIVE_SUPPORT == 1)*/ } else { - u8 cur_rate = rtw_read8(padapter, REG_ADAPTIVE_DATA_RATE_0 + mac_id); - u8 sgi = (cur_rate & BIT7) ? _TRUE : _FALSE; - - cur_rate &= 0x7f; - - _RTW_PRINT_SEL(sel , "Mac_id:%d ,SGI:%d ,Rate:%s\n", mac_id, sgi, HDATA_RATE(cur_rate)); + u8 cur_rate = 0; + u8 sgi = 0; + + if (padapter->fix_rate == 0xff) { + cur_rate = rtw_read8(padapter, REG_ADAPTIVE_DATA_RATE_0 + mac_id) & 0x7f; + sgi = (cur_rate & BIT7) ? _TRUE : _FALSE; + } else { + cur_rate = padapter->fix_rate & 0x7f; + sgi = ((padapter->fix_rate) & 0x80) >> 7; + } + + RTW_PRINT_SEL(sel , "Mac_id:%d ,SGI:%d ,Rate:%s\n", mac_id, sgi, HDATA_RATE(cur_rate)); } } } @@ -4759,9 +4251,9 @@ void hal_ra_info_dump(_adapter *padapter , void *sel) u8 GetHalDefVar8188E( - IN PADAPTER Adapter, - IN HAL_DEF_VARIABLE eVariable, - IN PVOID pValue + PADAPTER Adapter, + HAL_DEF_VARIABLE eVariable, + void *pValue ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -4827,9 +4319,6 @@ GetHalDefVar8188E( else *(u8 *)pValue = WMM_NORMAL_TX_PAGE_BOUNDARY_88E(Adapter); break; - case HAL_DEF_MACID_SLEEP: - *(u8 *)pValue = _TRUE; /* support macid sleep */ - break; case HAL_DEF_RX_DMA_SZ_WOW: *(u32 *)pValue = RX_DMA_SIZE_88E(Adapter) - RESV_FMWF; break; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/rtl8188e_phycfg.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/rtl8188e_phycfg.c index efd730a06f94..6114baa33e47 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/rtl8188e_phycfg.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/rtl8188e_phycfg.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 _RTL8188E_PHYCFG_C_ #include @@ -51,7 +47,7 @@ #if (SIC_ENABLE == 1) static BOOLEAN sic_IsSICReady( - IN PADAPTER Adapter + PADAPTER Adapter ) { BOOLEAN bRet = _FALSE; @@ -104,7 +100,7 @@ sic_CalculateBitShift( static u32 sic_Read4Byte( - PVOID Adapter, + void *Adapter, u32 offset ) { @@ -122,11 +118,11 @@ sic_Read4Byte( /* RTPRINT(FPHY, PHY_SICR, ("write cmdreg 0x%x = 0x%x\n", SIC_CMD_REG, SIC_CMD_PREREAD)); */ #endif rtw_write8(Adapter, SIC_ADDR_REG, (u8)(offset & 0xff)); - /* PlatformEFIOWrite1Byte(Adapter, SIC_ADDR_REG, (u1Byte)(offset&0xff)); */ - /* RTPRINT(FPHY, PHY_SICR, ("write 0x%x = 0x%x\n", SIC_ADDR_REG, (u1Byte)(offset&0xff))); */ + /* PlatformEFIOWrite1Byte(Adapter, SIC_ADDR_REG, (u8)(offset&0xff)); */ + /* RTPRINT(FPHY, PHY_SICR, ("write 0x%x = 0x%x\n", SIC_ADDR_REG, (u8)(offset&0xff))); */ rtw_write8(Adapter, SIC_ADDR_REG + 1, (u8)((offset & 0xff00) >> 8)); - /* PlatformEFIOWrite1Byte(Adapter, SIC_ADDR_REG+1, (u1Byte)((offset&0xff00)>>8)); */ - /* RTPRINT(FPHY, PHY_SICR, ("write 0x%x = 0x%x\n", SIC_ADDR_REG+1, (u1Byte)((offset&0xff00)>>8))); */ + /* PlatformEFIOWrite1Byte(Adapter, SIC_ADDR_REG+1, (u8)((offset&0xff00)>>8)); */ + /* RTPRINT(FPHY, PHY_SICR, ("write 0x%x = 0x%x\n", SIC_ADDR_REG+1, (u8)((offset&0xff00)>>8))); */ rtw_write8(Adapter, SIC_CMD_REG, SIC_CMD_READ); /* PlatformEFIOWrite1Byte(Adapter, SIC_CMD_REG, SIC_CMD_READ); */ /* RTPRINT(FPHY, PHY_SICR, ("write cmdreg 0x%x = 0x%x\n", SIC_CMD_REG, SIC_CMD_READ)); */ @@ -153,9 +149,9 @@ sic_Read4Byte( return u4ret; } -static VOID +static void sic_Write4Byte( - PVOID Adapter, + void *Adapter, u32 offset, u32 data ) @@ -172,13 +168,13 @@ sic_Write4Byte( /* RTPRINT(FPHY, PHY_SICW, ("write data 0x%x = 0x%x\n", SIC_CMD_REG, SIC_CMD_PREWRITE)); */ #endif rtw_write8(Adapter, SIC_ADDR_REG, (u8)(offset & 0xff)); - /* PlatformEFIOWrite1Byte(Adapter, SIC_ADDR_REG, (u1Byte)(offset&0xff)); */ - /* RTPRINT(FPHY, PHY_SICW, ("write 0x%x=0x%x\n", SIC_ADDR_REG, (u1Byte)(offset&0xff))); */ + /* PlatformEFIOWrite1Byte(Adapter, SIC_ADDR_REG, (u8)(offset&0xff)); */ + /* RTPRINT(FPHY, PHY_SICW, ("write 0x%x=0x%x\n", SIC_ADDR_REG, (u8)(offset&0xff))); */ rtw_write8(Adapter, SIC_ADDR_REG + 1, (u8)((offset & 0xff00) >> 8)); - /* PlatformEFIOWrite1Byte(Adapter, SIC_ADDR_REG+1, (u1Byte)((offset&0xff00)>>8)); */ - /* RTPRINT(FPHY, PHY_SICW, ("write 0x%x=0x%x\n", (SIC_ADDR_REG+1), (u1Byte)((offset&0xff00)>>8))); */ + /* PlatformEFIOWrite1Byte(Adapter, SIC_ADDR_REG+1, (u8)((offset&0xff00)>>8)); */ + /* RTPRINT(FPHY, PHY_SICW, ("write 0x%x=0x%x\n", (SIC_ADDR_REG+1), (u8)((offset&0xff00)>>8))); */ rtw_write32(Adapter, SIC_DATA_REG, (u32)data); - /* PlatformEFIOWrite4Byte(Adapter, SIC_DATA_REG, (u4Byte)data); */ + /* PlatformEFIOWrite4Byte(Adapter, SIC_DATA_REG, (u32)data); */ /* RTPRINT(FPHY, PHY_SICW, ("write data 0x%x = 0x%x\n", SIC_DATA_REG, data)); */ rtw_write8(Adapter, SIC_CMD_REG, SIC_CMD_WRITE); /* PlatformEFIOWrite1Byte(Adapter, SIC_CMD_REG, SIC_CMD_WRITE); */ @@ -198,12 +194,12 @@ sic_Write4Byte( /* ************************************************************ * extern function * ************************************************************ */ -static VOID +static void SIC_SetBBReg( - IN PADAPTER Adapter, - IN u32 RegAddr, - IN u32 BitMask, - IN u32 Data + PADAPTER Adapter, + u32 RegAddr, + u32 BitMask, + u32 Data ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -244,9 +240,9 @@ SIC_SetBBReg( static u32 SIC_QueryBBReg( - IN PADAPTER Adapter, - IN u32 RegAddr, - IN u32 BitMask + PADAPTER Adapter, + u32 RegAddr, + u32 BitMask ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -279,9 +275,9 @@ SIC_QueryBBReg( return ReturnValue; } -VOID +void SIC_Init( - IN PADAPTER Adapter + PADAPTER Adapter ) { /* Here we need to write 0x1b8~0x1bf = 0 after fw is downloaded */ @@ -307,7 +303,7 @@ SIC_Init( static BOOLEAN SIC_LedOff( - IN PADAPTER Adapter + PADAPTER Adapter ) { /* When SIC is enabled, led pin will be used as debug pin, */ @@ -323,18 +319,18 @@ SIC_LedOff( * * Input: * PADAPTER Adapter, -* u4Byte RegAddr, //The target address to be readback -* u4Byte BitMask //The target bit position in the target address +* u32 RegAddr, //The target address to be readback +* u32 BitMask //The target bit position in the target address * //to be readback * Output: None -* Return: u4Byte Data //The readback register value +* Return: u32 Data //The readback register value * Note: This function is equal to "GetRegSetting" in PHY programming guide */ u32 PHY_QueryBBReg8188E( - IN PADAPTER Adapter, - IN u32 RegAddr, - IN u32 BitMask + PADAPTER Adapter, + u32 RegAddr, + u32 BitMask ) { u32 ReturnValue = 0, OriginalValue, BitShift; @@ -367,10 +363,10 @@ PHY_QueryBBReg8188E( * * Input: * PADAPTER Adapter, -* u4Byte RegAddr, //The target address to be modified -* u4Byte BitMask //The target bit position in the target address +* u32 RegAddr, //The target address to be modified +* u32 BitMask //The target bit position in the target address * //to be modified -* u4Byte Data //The new register value in the target bit position +* u32 Data //The new register value in the target bit position * //of the target address * * Output: None @@ -378,12 +374,12 @@ PHY_QueryBBReg8188E( * Note: This function is equal to "PutRegSetting" in PHY programming guide */ -VOID +void PHY_SetBBReg8188E( - IN PADAPTER Adapter, - IN u32 RegAddr, - IN u32 BitMask, - IN u32 Data + PADAPTER Adapter, + u32 RegAddr, + u32 BitMask, + u32 Data ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -423,11 +419,11 @@ PHY_SetBBReg8188E( * * Input: * PADAPTER Adapter, -* u8 eRFPath, //Radio path of A/B/C/D -* u4Byte Offset, //The target address to be read + enum rf_path eRFPath, //Radio path of A/B/C/D +* u32 Offset, //The target address to be read * * Output: None -* Return: u4Byte reback value +* Return: u32 reback value * Note: Threre are three types of serial operations: * 1. Software serial write * 2. Hardware LSSI-Low Speed Serial Interface @@ -437,9 +433,9 @@ PHY_SetBBReg8188E( */ static u32 phy_RFSerialRead( - IN PADAPTER Adapter, - IN u8 eRFPath, - IN u32 Offset + PADAPTER Adapter, + enum rf_path eRFPath, + u32 Offset ) { u32 retValue = 0; @@ -522,9 +518,9 @@ phy_RFSerialRead( * * Input: * PADAPTER Adapter, -* u8 eRFPath, //Radio path of A/B/C/D -* u4Byte Offset, //The target address to be read -* u4Byte Data //The new register Data in the target bit position + enum rf_path eRFPath, //Radio path of A/B/C/D +* u32 Offset, //The target address to be read +* u32 Data //The new register Data in the target bit position * //of the target to be read * * Output: None @@ -558,12 +554,12 @@ phy_RFSerialRead( * * */ -static VOID +static void phy_RFSerialWrite( - IN PADAPTER Adapter, - IN u8 eRFPath, - IN u32 Offset, - IN u32 Data + PADAPTER Adapter, + enum rf_path eRFPath, + u32 Offset, + u32 Data ) { u32 DataAndAddr = 0; @@ -620,21 +616,21 @@ phy_RFSerialWrite( * * Input: * PADAPTER Adapter, -* u8 eRFPath, //Radio path of A/B/C/D -* u4Byte RegAddr, //The target address to be read -* u4Byte BitMask //The target bit position in the target address + enum rf_path eRFPath, //Radio path of A/B/C/D +* u32 RegAddr, //The target address to be read +* u32 BitMask //The target bit position in the target address * //to be read * * Output: None -* Return: u4Byte Readback value +* Return: u32 Readback value * Note: This function is equal to "GetRFRegSetting" in PHY programming guide */ u32 PHY_QueryRFReg8188E( - IN PADAPTER Adapter, - IN u8 eRFPath, - IN u32 RegAddr, - IN u32 BitMask + PADAPTER Adapter, + enum rf_path eRFPath, + u32 RegAddr, + u32 BitMask ) { u32 Original_Value, Readback_Value, BitShift; @@ -642,8 +638,8 @@ PHY_QueryRFReg8188E( /* u8 RFWaitCounter = 0; */ /* _irqL irqL; */ - if (eRFPath >= MAX_RF_PATH) - return 0; + if (eRFPath >= MAX_RF_PATH) + return 0; #if (DISABLE_BB_RF == 1) return 0; @@ -681,34 +677,34 @@ PHY_QueryRFReg8188E( * * Input: * PADAPTER Adapter, -* u8 eRFPath, //Radio path of A/B/C/D -* u4Byte RegAddr, //The target address to be modified -* u4Byte BitMask //The target bit position in the target address + enum rf_path eRFPath, //Radio path of A/B/C/D +* u32 RegAddr, //The target address to be modified +* u32 BitMask //The target bit position in the target address * //to be modified -* u4Byte Data //The new register Data in the target bit position +* u32 Data //The new register Data in the target bit position * //of the target address * * Output: None * Return: None * Note: This function is equal to "PutRFRegSetting" in PHY programming guide */ -VOID +void PHY_SetRFReg8188E( - IN PADAPTER Adapter, - IN u8 eRFPath, - IN u32 RegAddr, - IN u32 BitMask, - IN u32 Data + PADAPTER Adapter, + enum rf_path eRFPath, + u32 RegAddr, + u32 BitMask, + u32 Data ) { /* HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); */ - /* u1Byte RFWaitCounter = 0; */ + /* u8 RFWaitCounter = 0; */ u32 Original_Value, BitShift; /* _irqL irqL; */ - if (eRFPath >= MAX_RF_PATH) - return; + if (eRFPath >= MAX_RF_PATH) + return; #if (DISABLE_BB_RF == 1) return; @@ -811,9 +807,9 @@ s32 PHY_MACConfig8188E(PADAPTER Adapter) * Return: None * Note: The initialization value is constant and it should never be changes -----------------------------------------------------------------------------*/ -static VOID +static void phy_InitBBRFRegisterDefinition( - IN PADAPTER Adapter + PADAPTER Adapter ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -854,54 +850,9 @@ phy_InitBBRFRegisterDefinition( } -static VOID -phy_BB8192C_Config_1T( - IN PADAPTER Adapter -) -{ -#if 0 - /* for path - A */ - phy_set_bb_reg(Adapter, rFPGA0_TxInfo, 0x3, 0x1); - phy_set_bb_reg(Adapter, rFPGA1_TxInfo, 0x0303, 0x0101); - phy_set_bb_reg(Adapter, 0xe74, 0x0c000000, 0x1); - phy_set_bb_reg(Adapter, 0xe78, 0x0c000000, 0x1); - phy_set_bb_reg(Adapter, 0xe7c, 0x0c000000, 0x1); - phy_set_bb_reg(Adapter, 0xe80, 0x0c000000, 0x1); - phy_set_bb_reg(Adapter, 0xe88, 0x0c000000, 0x1); -#endif - /* for path - B */ - phy_set_bb_reg(Adapter, rFPGA0_TxInfo, 0x3, 0x2); - phy_set_bb_reg(Adapter, rFPGA1_TxInfo, 0x300033, 0x200022); - - /* 20100519 Joseph: Add for 1T2R config. Suggested by Kevin, Jenyu and Yunan. */ - phy_set_bb_reg(Adapter, rCCK0_AFESetting, bMaskByte3, 0x45); - phy_set_bb_reg(Adapter, rOFDM0_TRxPathEnable, bMaskByte0, 0x23); - phy_set_bb_reg(Adapter, rOFDM0_AGCParameter1, 0x30, 0x1); /* B path first AGC */ - - phy_set_bb_reg(Adapter, 0xe74, 0x0c000000, 0x2); - phy_set_bb_reg(Adapter, 0xe78, 0x0c000000, 0x2); - phy_set_bb_reg(Adapter, 0xe7c, 0x0c000000, 0x2); - phy_set_bb_reg(Adapter, 0xe80, 0x0c000000, 0x2); - phy_set_bb_reg(Adapter, 0xe88, 0x0c000000, 0x2); - - -} - -/* Joseph test: new initialize order!! - * Test only!! This part need to be re-organized. - * Now it is just for 8256. */ -static int -phy_BB8190_Config_HardCode( - IN PADAPTER Adapter -) -{ - /* RT_ASSERT(FALSE, ("This function is not implement yet!!\n")); */ - return _SUCCESS; -} - static int phy_BB8188E_Config_ParaFile( - IN PADAPTER Adapter + PADAPTER Adapter ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -973,7 +924,7 @@ phy_BB8188E_Config_ParaFile( int PHY_BBConfig8188E( - IN PADAPTER Adapter + PADAPTER Adapter ) { int rtStatus = _SUCCESS; @@ -997,7 +948,7 @@ PHY_BBConfig8188E( #ifdef CONFIG_USB_HCI rtw_write8(Adapter, REG_SYS_FUNC_EN, FEN_USBA | FEN_USBD | FEN_BB_GLB_RSTn | FEN_BBRSTB); -#else +#elif defined CONFIG_PCI_HCI rtw_write8(Adapter, REG_SYS_FUNC_EN, FEN_PPLL | FEN_PCIEA | FEN_DIO_PCIE | FEN_BB_GLB_RSTn | FEN_BBRSTB); #endif @@ -1017,11 +968,13 @@ PHY_BBConfig8188E( #ifdef CONFIG_PCI_HCI +#ifdef CONFIG_RTW_LED /* Force use left antenna by default for 88C. */ - if (Adapter->ledpriv.LedStrategy != SW_LED_MODE10) { + if (adapter_to_led(Adapter)->LedStrategy != SW_LED_MODE10) { RegVal = rtw_read32(Adapter, REG_LEDCFG0); rtw_write32(Adapter, REG_LEDCFG0, RegVal | BIT23); } +#endif #endif /* */ @@ -1029,7 +982,11 @@ PHY_BBConfig8188E( /* */ rtStatus = phy_BB8188E_Config_ParaFile(Adapter); - hal_set_crystal_cap(Adapter, pHalData->crystal_cap); + if (rtw_phydm_set_crystal_cap(Adapter, pHalData->crystal_cap) == _FALSE) { + RTW_ERR("Init crystal_cap failed\n"); + rtw_warn_on(1); + rtStatus = _FAIL; + } return rtStatus; @@ -1038,7 +995,7 @@ PHY_BBConfig8188E( int PHY_RFConfig8188E( - IN PADAPTER Adapter + PADAPTER Adapter ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -1089,9 +1046,9 @@ PHY_RFConfig8188E( *---------------------------------------------------------------------------*/ int rtl8188e_PHY_ConfigRFWithParaFile( - IN PADAPTER Adapter, - IN u8 *pFileName, - IN u8 eRFPath + PADAPTER Adapter, + u8 *pFileName, + enum rf_path eRFPath ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -1122,38 +1079,6 @@ u32 Rtl8192S_HighPower_RadioA_Array[HighPowerRadioAArrayLen] = { 0x013, 0x00000240, }; -/* **************************************** - *----------------------------------------------------------------------------- - * Function: GetTxPowerLevel8190() - * - * Overview: This function is export to "common" moudule - * - * Input: PADAPTER Adapter - * psByte Power Level - * - * Output: NONE - * - * Return: NONE - * - *---------------------------------------------------------------------------*/ -VOID -PHY_GetTxPowerLevel8188E( - IN PADAPTER Adapter, - OUT s32 *powerlevel -) -{ -#if 0 - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); - s4Byte TxPwrDbm = 13; - - if (pMgntInfo->ClientConfigPwrInDbm != UNSPECIFIED_PWR_DBM) - *powerlevel = pMgntInfo->ClientConfigPwrInDbm; - else - *powerlevel = TxPwrDbm; -#endif -} - /*----------------------------------------------------------------------------- * Function: SetTxPowerLevel8190() * @@ -1161,7 +1086,7 @@ PHY_GetTxPowerLevel8188E( * We must consider RF path later!!!!!!! * * Input: PADAPTER Adapter - * u1Byte channel + * u8 channel * * Output: NONE * @@ -1171,28 +1096,24 @@ PHY_GetTxPowerLevel8188E( * 2009/01/21 MHC Support new EEPROM format from SD3 requirement. * *---------------------------------------------------------------------------*/ -VOID +void PHY_SetTxPowerLevel8188E( - IN PADAPTER Adapter, - IN u8 Channel + PADAPTER Adapter, + u8 Channel ) { - /* RTW_INFO("==>PHY_SetTxPowerLevel8188E()\n"); */ - - phy_set_tx_power_level_by_path(Adapter, Channel, ODM_RF_PATH_A); - - /* RTW_INFO("<==PHY_SetTxPowerLevel8188E()\n"); */ + phy_set_tx_power_level_by_path(Adapter, Channel, RF_PATH_A); } -VOID +void PHY_SetTxPowerIndex_8188E( - IN PADAPTER Adapter, - IN u32 PowerIndex, - IN u8 RFPath, - IN u8 Rate + PADAPTER Adapter, + u32 PowerIndex, + enum rf_path RFPath, + u8 Rate ) { - if (RFPath == ODM_RF_PATH_A) { + if (RFPath == RF_PATH_A) { switch (Rate) { case MGN_1M: phy_set_bb_reg(Adapter, rTxAGC_A_CCK1_Mcs32, bMaskByte1, PowerIndex); @@ -1289,7 +1210,7 @@ PHY_SetTxPowerIndex_8188E( RTW_INFO("Invalid Rate!!\n"); break; } - } else if (RFPath == ODM_RF_PATH_B) { + } else if (RFPath == RF_PATH_B) { switch (Rate) { case MGN_1M: phy_set_bb_reg(Adapter, rTxAGC_B_CCK1_55_Mcs32, bMaskByte1, PowerIndex); @@ -1390,29 +1311,11 @@ PHY_SetTxPowerIndex_8188E( RTW_INFO("Invalid RFPath!!\n"); } -u8 -phy_GetCurrentTxNum_8188E( - IN PADAPTER pAdapter, - IN u8 Rate -) -{ - u8 tmpByte = 0; - u32 tmpDWord = 0; - u8 TxNum = RF_TX_NUM_NONIMPLEMENT; - - if ((Rate >= MGN_MCS8 && Rate <= MGN_MCS15)) - TxNum = RF_2TX; - else - TxNum = RF_1TX; - - return TxNum; -} - s8 tx_power_extra_bias( - IN u8 RFPath, - IN u8 Rate, - IN CHANNEL_WIDTH BandWidth, - IN u8 Channel + enum rf_path RFPath, + u8 Rate, + enum channel_width BandWidth, + u8 Channel ) { s8 bias = 0; @@ -1425,68 +1328,49 @@ s8 tx_power_extra_bias( u8 PHY_GetTxPowerIndex_8188E( - IN PADAPTER pAdapter, - IN u8 RFPath, - IN u8 Rate, - IN u8 BandWidth, - IN u8 Channel, + PADAPTER pAdapter, + enum rf_path RFPath, + u8 Rate, + u8 BandWidth, + u8 Channel, struct txpwr_idx_comp *tic ) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); - u8 base_idx = 0, power_idx = 0; + struct hal_spec_t *hal_spec = GET_HAL_SPEC(pAdapter); + s16 power_idx; + u8 pg = 0; s8 by_rate_diff = 0, limit = 0, tpt_offset = 0, extra_bias = 0; - u8 txNum = phy_GetCurrentTxNum_8188E(pAdapter, Rate); BOOLEAN bIn24G = _FALSE; - base_idx = PHY_GetTxPowerIndexBase(pAdapter, RFPath, Rate, BandWidth, Channel, &bIn24G); + pg = phy_get_pg_txpwr_idx(pAdapter, RFPath, Rate, RF_1TX, BandWidth, Channel, &bIn24G); - by_rate_diff = PHY_GetTxPowerByRate(pAdapter, BAND_ON_2_4G, RFPath, txNum, Rate); - limit = PHY_GetTxPowerLimit(pAdapter, pAdapter->registrypriv.RegPwrTblSel, (u8)(!bIn24G), pHalData->current_channel_bw, RFPath, Rate, pHalData->current_channel); + by_rate_diff = PHY_GetTxPowerByRate(pAdapter, BAND_ON_2_4G, RFPath, 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 (pAdapter->registrypriv.mp_mode != 1) extra_bias = tx_power_extra_bias(RFPath, Rate, BandWidth, Channel); - if (tic) { - tic->base = base_idx; - tic->by_rate = by_rate_diff; - tic->limit = limit; - tic->tpt = tpt_offset; - tic->ebias = extra_bias; - } + if (tic) + txpwr_idx_comp_set(tic, RF_1TX, pg, by_rate_diff, limit, tpt_offset, extra_bias, 0, 0); by_rate_diff = by_rate_diff > limit ? limit : by_rate_diff; - power_idx = base_idx + by_rate_diff + tpt_offset + extra_bias; + power_idx = pg + by_rate_diff + tpt_offset + extra_bias; - if (power_idx > MAX_POWER_INDEX) - power_idx = MAX_POWER_INDEX; + if (power_idx < 0) + power_idx = 0; + else if (power_idx > hal_spec->txgi_max) + power_idx = hal_spec->txgi_max; return power_idx; } -/* - * Description: - * Update transmit power level of all channel supported. - * - * TODO: - * A mode. - * By Bruce, 2008-02-04. - * */ -BOOLEAN -PHY_UpdateTxPowerDbm8188E( - IN PADAPTER Adapter, - IN int powerInDbm -) -{ - return _TRUE; -} - -VOID +void PHY_ScanOperationBackup8188E( - IN PADAPTER Adapter, - IN u8 Operation + PADAPTER Adapter, + u8 Operation ) { #if 0 @@ -1496,13 +1380,13 @@ PHY_ScanOperationBackup8188E( switch (Operation) { case SCAN_OPT_BACKUP: IoType = IO_CMD_PAUSE_DM_BY_SCAN; - rtw_hal_set_hwreg(Adapter, HW_VAR_IO_CMD, (pu1Byte)&IoType); + rtw_hal_set_hwreg(Adapter, HW_VAR_IO_CMD, (u8 *)&IoType); break; case SCAN_OPT_RESTORE: IoType = IO_CMD_RESUME_DM_BY_SCAN; - rtw_hal_set_hwreg(Adapter, HW_VAR_IO_CMD, (pu1Byte)&IoType); + rtw_hal_set_hwreg(Adapter, HW_VAR_IO_CMD, (u8 *)&IoType); break; default: @@ -1513,23 +1397,23 @@ PHY_ScanOperationBackup8188E( } void phy_SpurCalibration_8188E( - IN PADAPTER Adapter + PADAPTER Adapter ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - struct PHY_DM_STRUCT *p_dm_odm = &(pHalData->odmpriv); + struct dm_struct *p_dm_odm = &(pHalData->odmpriv); /* DbgPrint("===> phy_SpurCalibration_8188E current_channel_bw = %d, current_channel = %d\n", pHalData->current_channel_bw, pHalData->current_channel);*/ if (pHalData->current_channel_bw == CHANNEL_WIDTH_20 && (pHalData->current_channel == 13 || pHalData->current_channel == 14)) { phy_set_bb_reg(Adapter, rOFDM0_RxDSP, BIT(9), 0x1);/* enable notch filter */ phy_set_bb_reg(Adapter, rOFDM1_IntfDet, BIT(8) | BIT(7) | BIT(6), 0x2); /* intf_TH */ phy_set_bb_reg(Adapter, rOFDM0_RxDSP, BIT(28) | BIT(27) | BIT(26) | BIT(25) | BIT(24), 0x1f); - p_dm_odm->is_receiver_blocking_en = false; + p_dm_odm->is_rx_blocking_en = false; } else if (pHalData->current_channel_bw == CHANNEL_WIDTH_40 && pHalData->current_channel == 11) { phy_set_bb_reg(Adapter, rOFDM0_RxDSP, BIT(9), 0x1);/* enable notch filter */ phy_set_bb_reg(Adapter, rOFDM1_IntfDet, BIT(8) | BIT(7) | BIT(6), 0x2); /* intf_TH */ phy_set_bb_reg(Adapter, rOFDM0_RxDSP, BIT(28) | BIT(27) | BIT(26) | BIT(25) | BIT(24), 0x1f); - p_dm_odm->is_receiver_blocking_en = false; + p_dm_odm->is_rx_blocking_en = false; } else { if (Adapter->registrypriv.notch_filter == 0) phy_set_bb_reg(Adapter, rOFDM0_RxDSP, BIT(9), 0x0);/* disable notch filter */ @@ -1551,9 +1435,9 @@ phy_SpurCalibration_8188E( * (2) Will two workitem of "switch channel" and "switch channel bandwidth" run * concurrently? *---------------------------------------------------------------------------*/ -static VOID +static void _PHY_SetBWMode88E( - IN PADAPTER Adapter + PADAPTER Adapter ) { /* PADAPTER Adapter = (PADAPTER)pTimer->Adapter; */ @@ -1564,8 +1448,8 @@ _PHY_SetBWMode88E( /* return; */ /* Added it for 20/40 mhz switch time evaluation by guangan 070531 */ - /* u4Byte NowL, NowH; */ - /* u8Byte BeginTime, EndTime; */ + /* u32 NowL, NowH; */ + /* u64 BeginTime, EndTime; */ if (pHalData->rf_chip == RF_PSEUDO_11N) { /* pHalData->SetBWModeInProgress= _FALSE; */ @@ -1582,7 +1466,7 @@ _PHY_SetBWMode88E( /* Added it for 20/40 mhz switch time evaluation by guangan 070531 */ /* NowL = PlatformEFIORead4Byte(Adapter, TSFR); */ /* NowH = PlatformEFIORead4Byte(Adapter, TSFR+4); */ - /* BeginTime = ((u8Byte)NowH << 32) + NowL; */ + /* BeginTime = ((u64)NowH << 32) + NowL; */ /* 3 */ /* 3 */ /* <1>Set MAC register */ @@ -1591,7 +1475,7 @@ _PHY_SetBWMode88E( regBwOpMode = rtw_read8(Adapter, REG_BWOPMODE); regRRSR_RSC = rtw_read8(Adapter, REG_RRSR + 2); - /* regBwOpMode = rtw_hal_get_hwreg(Adapter,HW_VAR_BWMODE,(pu1Byte)®BwOpMode); */ + /* regBwOpMode = rtw_hal_get_hwreg(Adapter,HW_VAR_BWMODE,(u8 *)®BwOpMode); */ switch (pHalData->current_channel_bw) { case CHANNEL_WIDTH_20: @@ -1651,7 +1535,7 @@ _PHY_SetBWMode88E( /* Added it for 20/40 mhz switch time evaluation by guangan 070531 */ /* NowL = PlatformEFIORead4Byte(Adapter, TSFR); */ /* NowH = PlatformEFIORead4Byte(Adapter, TSFR+4); */ - /* EndTime = ((u8Byte)NowH << 32) + NowL; */ + /* EndTime = ((u64)NowH << 32) + NowL; */ /* 3<3>Set RF related register */ switch (pHalData->rf_chip) { @@ -1703,15 +1587,15 @@ _PHY_SetBWMode88E( * * Note: We do not take j mode into consideration now * *--------------------------------------------------------------------------- */ #endif -VOID +void PHY_SetBWMode8188E( - IN PADAPTER Adapter, - IN CHANNEL_WIDTH Bandwidth, /* 20M or 40M */ - IN unsigned char Offset /* Upper, Lower, or Don't care */ + PADAPTER Adapter, + enum channel_width Bandwidth, /* 20M or 40M */ + unsigned char Offset /* Upper, Lower, or Don't care */ ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - CHANNEL_WIDTH tmpBW = pHalData->current_channel_bw; + enum channel_width tmpBW = pHalData->current_channel_bw; /* Modified it for 20/40 mhz switch by guangan 070531 */ /* PMGNT_INFO pMgntInfo=&Adapter->MgntInfo; */ @@ -1768,7 +1652,7 @@ PHY_SetBWMode8188E( static void _PHY_SwChnl8188E(PADAPTER Adapter, u8 channel) { - u8 eRFPath; + enum rf_path eRFPath; u32 param1, param2; HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -1776,12 +1660,12 @@ static void _PHY_SwChnl8188E(PADAPTER Adapter, u8 channel) RTW_INFO("[%s] ch = %d\n", __FUNCTION__, channel); /* s1. pre common command - CmdID_SetTxPowerLevel */ - PHY_SetTxPowerLevel8188E(Adapter, channel); + rtw_hal_set_tx_power_level(Adapter, channel); /* s2. RF dependent command - CmdID_RF_WriteReg, param1=RF_CHNLBW, param2=channel */ param1 = RF_CHNLBW; param2 = channel; - for (eRFPath = 0; eRFPath < pHalData->NumTotalRFPath; eRFPath++) { + for (eRFPath = RF_PATH_A; eRFPath < pHalData->NumTotalRFPath; eRFPath++) { pHalData->RfRegChnlVal[eRFPath] = ((pHalData->RfRegChnlVal[eRFPath] & 0xfffffc00) | param2); phy_set_rf_reg(Adapter, eRFPath, param1, bRFRegOffsetMask, pHalData->RfRegChnlVal[eRFPath]); } @@ -1790,10 +1674,10 @@ static void _PHY_SwChnl8188E(PADAPTER Adapter, u8 channel) /* s3. post common command - CmdID_End, None */ } -VOID +void PHY_SwChnl8188E(/* Call after initialization */ - IN PADAPTER Adapter, - IN u8 channel + PADAPTER Adapter, + u8 channel ) { /* PADAPTER Adapter = ADJUST_TO_ADAPTIVE_ADAPTER(pAdapter, _TRUE); */ @@ -1877,136 +1761,36 @@ PHY_SwChnl8188E(/* Call after initialization */ } } -VOID +void PHY_SetSwChnlBWMode8188E( - IN PADAPTER Adapter, - IN u8 channel, - IN CHANNEL_WIDTH Bandwidth, - IN u8 Offset40, - IN u8 Offset80 + PADAPTER Adapter, + u8 channel, + enum channel_width Bandwidth, + u8 Offset40, + u8 Offset80 ) { + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); /* RTW_INFO("%s()===>\n",__FUNCTION__); */ PHY_SwChnl8188E(Adapter, channel); PHY_SetBWMode8188E(Adapter, Bandwidth, Offset40); + if (pHalData->bNeedIQK == _TRUE) { + if (pHalData->neediqk_24g == _TRUE) { + halrf_iqk_trigger(&pHalData->odmpriv, _FALSE); + pHalData->bIQKInitialized = _TRUE; + pHalData->neediqk_24g = _FALSE; + } + pHalData->bNeedIQK = _FALSE; + } /* RTW_INFO("<==%s()\n",__FUNCTION__); */ } -static VOID _PHY_SetRFPathSwitch( - IN PADAPTER pAdapter, - IN BOOLEAN bMain, - IN BOOLEAN is2T -) -{ - u8 u1bTmp; - if (!rtw_is_hw_init_completed(pAdapter)) { - u1bTmp = rtw_read8(pAdapter, REG_LEDCFG2) | BIT7; - rtw_write8(pAdapter, REG_LEDCFG2, u1bTmp); - /* phy_set_bb_reg(pAdapter, REG_LEDCFG0, BIT23, 0x01); */ - phy_set_bb_reg(pAdapter, rFPGA0_XAB_RFParameter, BIT13, 0x01); - } - - if (is2T) { - if (bMain) - phy_set_bb_reg(pAdapter, rFPGA0_XB_RFInterfaceOE, BIT5 | BIT6, 0x1); /* 92C_Path_A */ - else - phy_set_bb_reg(pAdapter, rFPGA0_XB_RFInterfaceOE, BIT5 | BIT6, 0x2); /* BT */ - } else { - - if (bMain) - phy_set_bb_reg(pAdapter, rFPGA0_XA_RFInterfaceOE, 0x300, 0x2); /* Main */ - else - phy_set_bb_reg(pAdapter, rFPGA0_XA_RFInterfaceOE, 0x300, 0x1); /* Aux */ - } - -} - -/* return value TRUE => Main; FALSE => Aux */ - -static BOOLEAN _PHY_QueryRFPathSwitch( - IN PADAPTER pAdapter, - IN BOOLEAN is2T -) -{ - /* if(is2T) - * return _TRUE; */ - - if (!rtw_is_hw_init_completed(pAdapter)) { - phy_set_bb_reg(pAdapter, REG_LEDCFG0, BIT23, 0x01); - phy_set_bb_reg(pAdapter, rFPGA0_XAB_RFParameter, BIT13, 0x01); - } - - if (is2T) { - if (phy_query_bb_reg(pAdapter, rFPGA0_XB_RFInterfaceOE, BIT5 | BIT6) == 0x01) - return _TRUE; - else - return _FALSE; - } else { - if (phy_query_bb_reg(pAdapter, rFPGA0_XA_RFInterfaceOE, 0x300) == 0x02) - return _TRUE; - else - return _FALSE; - } -} - - -static VOID -_PHY_DumpRFReg(IN PADAPTER pAdapter) -{ - u32 rfRegValue, rfRegOffset; - - /* RTPRINT(FINIT, INIT_RF, ("PHY_DumpRFReg()====>\n")); */ - - for (rfRegOffset = 0x00; rfRegOffset <= 0x30; rfRegOffset++) { - rfRegValue = phy_query_rf_reg(pAdapter, RF_PATH_A, rfRegOffset, bMaskDWord); - /* RTPRINT(FINIT, INIT_RF, (" 0x%02x = 0x%08x\n",rfRegOffset,rfRegValue)); */ - } - /* RTPRINT(FINIT, INIT_RF, ("<===== PHY_DumpRFReg()\n")); */ -} - - -/* - * Move from phycfg.c to gen.c to be code independent later - * - * -------------------------Move to other DIR later---------------------------- */ -#ifdef CONFIG_USB_HCI - -/* - * Description: - * To dump all Tx FIFO LLT related link-list table. - * Added by Roger, 2009.03.10. - * */ -VOID -DumpBBDbgPort_92CU( - IN PADAPTER Adapter -) -{ - - - phy_set_bb_reg(Adapter, 0x0908, 0xffff, 0x0000); - - phy_set_bb_reg(Adapter, 0x0908, 0xffff, 0x0803); - - phy_set_bb_reg(Adapter, 0x0908, 0xffff, 0x0a06); - - phy_set_bb_reg(Adapter, 0x0908, 0xffff, 0x0007); - - phy_set_bb_reg(Adapter, 0x0908, 0xffff, 0x0100); - phy_set_bb_reg(Adapter, 0x0a28, 0x00ff0000, 0x000f0000); - - phy_set_bb_reg(Adapter, 0x0908, 0xffff, 0x0100); - phy_set_bb_reg(Adapter, 0x0a28, 0x00ff0000, 0x00150000); - - -} -#endif - -VOID +void PHY_SetRFEReg_8188E( - IN PADAPTER Adapter + PADAPTER Adapter ) { u8 u1tmp = 0; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/rtl8188e_rf6052.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/rtl8188e_rf6052.c index f60eda6f7a23..bed08320e64e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/rtl8188e_rf6052.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/rtl8188e_rf6052.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General Public License along with - * this program; if not, write to the Free Software Foundation, Inc., - * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA - * - * - ******************************************************************************/ + *****************************************************************************/ /****************************************************************************** * * @@ -63,7 +59,7 @@ * * Overview: For RL6052, we must change some RF settign for 1T or 2T. * - * Input: u2Byte DataRate // 0x80-8f, 0x90-9f + * Input: u16 DataRate // 0x80-8f, 0x90-9f * * Output: NONE * @@ -75,17 +71,17 @@ * Firmwaer support the utility later. * *---------------------------------------------------------------------------*/ -void rtl8188e_RF_ChangeTxPath(IN PADAPTER Adapter, - IN u16 DataRate) +void rtl8188e_RF_ChangeTxPath(PADAPTER Adapter, + u16 DataRate) { /* We do not support gain table change inACUT now !!!! Delete later !!! */ #if 0/* (RTL92SE_FPGA_VERIFY == 0) */ - static u1Byte RF_Path_Type = 2; /* 1 = 1T 2= 2T */ - static u4Byte tx_gain_tbl1[6] + static u8 RF_Path_Type = 2; /* 1 = 1T 2= 2T */ + static u32 tx_gain_tbl1[6] = {0x17f50, 0x11f40, 0x0cf30, 0x08720, 0x04310, 0x00100}; - static u4Byte tx_gain_tbl2[6] + static u32 tx_gain_tbl2[6] = {0x15ea0, 0x10e90, 0x0c680, 0x08250, 0x04040, 0x00030}; - u1Byte i; + u8 i; if (RF_Path_Type == 2 && (DataRate & 0xF) <= 0x7) { /* Set TX SYNC power G2G3 loop filter */ @@ -137,10 +133,10 @@ void rtl8188e_RF_ChangeTxPath(IN PADAPTER Adapter, * * Note: For RF type 0222D *---------------------------------------------------------------------------*/ -VOID +void rtl8188e_PHY_RF6052SetBandwidth( - IN PADAPTER Adapter, - IN CHANNEL_WIDTH Bandwidth) /* 20M or 40M */ + PADAPTER Adapter, + enum channel_width Bandwidth) /* 20M or 40M */ { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -163,11 +159,11 @@ rtl8188e_PHY_RF6052SetBandwidth( static int phy_RF6052_Config_ParaFile( - IN PADAPTER Adapter + PADAPTER Adapter ) { u32 u4RegValue = 0; - u8 eRFPath; + enum rf_path eRFPath; BB_REGISTER_DEFINITION_T *pPhyReg; int rtStatus = _SUCCESS; @@ -177,7 +173,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]; @@ -191,6 +187,9 @@ phy_RF6052_Config_ParaFile( case RF_PATH_D: 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----*/ @@ -216,7 +215,7 @@ phy_RF6052_Config_ParaFile( #endif { #ifdef CONFIG_EMBEDDED_FWIMG - if (HAL_STATUS_FAILURE == odm_config_rf_with_header_file(&pHalData->odmpriv, CONFIG_RF_RADIO, (enum 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 } @@ -227,7 +226,7 @@ phy_RF6052_Config_ParaFile( #endif { #ifdef CONFIG_EMBEDDED_FWIMG - if (HAL_STATUS_FAILURE == odm_config_rf_with_header_file(&pHalData->odmpriv, CONFIG_RF_RADIO, (enum 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 } @@ -236,6 +235,9 @@ phy_RF6052_Config_ParaFile( break; case RF_PATH_D: break; + default: + RTW_ERR("Invalid rf_path:%d\n", eRFPath); + break; } /*----Restore RFENV control type----*/; @@ -248,6 +250,9 @@ phy_RF6052_Config_ParaFile( case RF_PATH_D: phy_set_bb_reg(Adapter, pPhyReg->rfintfs, bRFSI_RFENV << 16, u4RegValue); break; + default: + RTW_ERR("Invalid rf_path:%d\n", eRFPath); + break; } if (rtStatus != _SUCCESS) { @@ -279,7 +284,7 @@ phy_RF6052_Config_ParaFile( int PHY_RF6052_Config8188E( - IN PADAPTER Adapter) + PADAPTER Adapter) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); int rtStatus = _SUCCESS; @@ -297,27 +302,6 @@ PHY_RF6052_Config8188E( /* Config BB and RF */ /* */ rtStatus = phy_RF6052_Config_ParaFile(Adapter); -#if 0 - switch (Adapter->MgntInfo.bRegHwParaFile) { - case 0: - phy_RF6052_Config_HardCode(Adapter); - break; - - case 1: - rtStatus = phy_RF6052_Config_ParaFile(Adapter); - break; - - case 2: - /* Partial Modify. */ - phy_RF6052_Config_HardCode(Adapter); - phy_RF6052_Config_ParaFile(Adapter); - break; - - default: - phy_RF6052_Config_HardCode(Adapter); - break; - } -#endif return rtStatus; } diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/rtl8188e_rxdesc.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/rtl8188e_rxdesc.c index cd1ea5e9b23b..8ce7169d2021 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/rtl8188e_rxdesc.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/rtl8188e_rxdesc.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 _RTL8188E_REDESC_C_ #include diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/rtl8188e_sreset.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/rtl8188e_sreset.c index a102d86633b3..399e0cbdaae9 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/rtl8188e_sreset.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/rtl8188e_sreset.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 _RTL8188E_SRESET_C_ /* #include */ @@ -29,7 +25,7 @@ void rtl8188e_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/rtl8188eu/hal/rtl8188e/rtl8188e_xmit.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/rtl8188e_xmit.c index cf345be2eff8..1cada731d732 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/rtl8188e_xmit.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/rtl8188e_xmit.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 _RTL8188E_XMIT_C_ #include @@ -124,12 +120,12 @@ struct EMInfo { void InsertEMContent_8188E( struct EMInfo *pEMInfo, - IN pu1Byte VirtualAddress) + u8 *VirtualAddress) { #if RTL8188E_EARLY_MODE_PKT_NUM_10 == 1 - u1Byte index = 0; - u4Byte dwtmp = 0; + u8 index = 0; + u32 dwtmp = 0; #endif _rtw_memset(VirtualAddress, 0, EARLY_MODE_INFO_SIZE); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/usb/rtl8188eu_led.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/usb/rtl8188eu_led.c index ad77a2ea1c5d..99ad176e4a62 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/usb/rtl8188eu_led.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/usb/rtl8188eu_led.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,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 /* ******************************************************************************** * LED object. @@ -131,7 +128,7 @@ rtl8188eu_InitSwLeds( _adapter *padapter ) { - struct led_priv *pledpriv = &(padapter->ledpriv); + struct led_priv *pledpriv = adapter_to_led(padapter); pledpriv->LedControlHandler = LedControlUSB; @@ -153,8 +150,9 @@ rtl8188eu_DeInitSwLeds( _adapter *padapter ) { - struct led_priv *ledpriv = &(padapter->ledpriv); + struct led_priv *ledpriv = adapter_to_led(padapter); DeInitLed(&(ledpriv->SwLed0)); DeInitLed(&(ledpriv->SwLed1)); } +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/usb/rtl8188eu_recv.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/usb/rtl8188eu_recv.c index 3107358345d4..9edab8a399a1 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/usb/rtl8188eu_recv.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/usb/rtl8188eu_recv.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 _RTL8188EU_RECV_C_ #include diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/usb/rtl8188eu_xmit.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/usb/rtl8188eu_xmit.c index 686baa746157..d50e45eb1a8c 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/usb/rtl8188eu_xmit.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/usb/rtl8188eu_xmit.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 _RTL8188E_XMIT_C_ #include @@ -310,8 +306,6 @@ static s32 update_txdesc(struct xmit_frame *pxmitframe, u8 *pmem, s32 sz , u8 ba qsel = (uint)(pattrib->qsel & 0x0000001f); /* RTW_INFO("==> macid(%d) qsel:0x%02x\n",pattrib->mac_id,qsel); */ - if (pattrib->ether_type == 0x888e) - RTW_INFO("==> macid(%d) qsel:0x%02x, pattrib->qsel = %x\n", pattrib->mac_id, qsel, pattrib->qsel); ptxdesc->txdw1 |= cpu_to_le32((qsel << QSEL_SHT) & 0x00001f00); ptxdesc->txdw1 |= cpu_to_le32((pattrib->raid << RATE_ID_SHT) & 0x000F0000); @@ -389,7 +383,12 @@ static s32 update_txdesc(struct xmit_frame *pxmitframe, u8 *pmem, s32 sz , u8 ba if (pattrib->ht_en) sgi = 1; - data_rate = 0x13; /* default rate: MCS7 */ + data_rate = DESC_RATEMCS7; /* default rate: MCS7 */ + } + if (bmcst) { + data_rate = MRateToHwRate(pattrib->rate); + ptxdesc->txdw4 |= cpu_to_le32(USERATE); + ptxdesc->txdw4 |= cpu_to_le32(DISDATAFB); } if (padapter->fix_rate != 0xFF) { @@ -415,20 +414,19 @@ static s32 update_txdesc(struct xmit_frame *pxmitframe, u8 *pmem, s32 sz , u8 ba if (pmlmeinfo->preamble_mode == PREAMBLE_SHORT) ptxdesc->txdw4 |= cpu_to_le32(BIT(24));/* DATA_SHORT */ - - ptxdesc->txdw5 |= cpu_to_le32(MRateToHwRate(pmlmeext->tx_rate)); +#ifdef CONFIG_IP_R_MONITOR + if((pattrib->ether_type == ETH_P_ARP) && + (IsSupportedTxOFDM(padapter->registrypriv.wireless_mode))) { + ptxdesc->txdw5 |= cpu_to_le32(MRateToHwRate(IEEE80211_OFDM_RATE_6MB)); + #ifdef DBG_IP_R_MONITOR + RTW_INFO(FUNC_ADPT_FMT ": SP Packet(0x%04X) rate=0x%x SeqNum = %d\n", + FUNC_ADPT_ARG(padapter), pattrib->ether_type, MRateToHwRate(pmlmeext->tx_rate), pattrib->seqnum); + #endif/*DBG_IP_R_MONITOR*/ + } else +#endif/*CONFIG_IP_R_MONITOR*/ + ptxdesc->txdw5 |= cpu_to_le32(MRateToHwRate(pmlmeext->tx_rate)); } -#ifdef CONFIG_TCP_CSUM_OFFLOAD_TX - /* offset 24 */ - if (pattrib->hw_tcp_csum == 1) { - /* ptxdesc->txdw6 = 0; */ /* clear TCP_CHECKSUM and IP_CHECKSUM. It's zero already!! */ - u8 ip_hdr_offset = 32 + pattrib->hdrlen + pattrib->iv_len + 8; - ptxdesc->txdw7 = (1 << 31) | (ip_hdr_offset << 16); - RTW_INFO("ptxdesc->txdw7 = %08x\n", ptxdesc->txdw7); - } -#endif - #ifdef CONFIG_TDLS #ifdef CONFIG_XMIT_ACK /* CCX-TXRPT ack for xmit mgmt frames. */ @@ -527,7 +525,8 @@ static s32 update_txdesc(struct xmit_frame *pxmitframe, u8 *pmem, s32 sz , u8 ba } #ifdef CONFIG_ANTENNA_DIVERSITY - odm_set_tx_ant_by_tx_info(&pHalData->odmpriv, pmem, pattrib->mac_id); + if (!bmcst && pattrib->psta) + odm_set_tx_ant_by_tx_info(adapter_to_phydm(padapter), pmem, pattrib->psta->cmn.mac_id); #endif rtl8188eu_cal_txdesc_chksum(ptxdesc); @@ -551,6 +550,7 @@ s32 rtl8188eu_xmit_buf_handler(PADAPTER padapter) /* PHAL_DATA_TYPE phal; */ struct xmit_priv *pxmitpriv; struct xmit_buf *pxmitbuf; + struct xmit_frame *pxmitframe; s32 ret; @@ -562,6 +562,10 @@ s32 rtl8188eu_xmit_buf_handler(PADAPTER padapter) return _FAIL; } 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; } @@ -579,8 +583,9 @@ s32 rtl8188eu_xmit_buf_handler(PADAPTER padapter) pxmitbuf = dequeue_pending_xmitbuf(pxmitpriv); if (pxmitbuf == NULL) break; - + pxmitframe = (struct xmit_frame *) pxmitbuf->priv_data; rtw_write_port(padapter, pxmitbuf->ff_hwaddr, pxmitbuf->len, (unsigned char *)pxmitbuf); + rtw_free_xmitframe(pxmitpriv, pxmitframe); } while (1); @@ -648,7 +653,12 @@ static s32 rtw_dump_xframe(_adapter *padapter, struct xmit_frame *pxmitframe) #ifdef CONFIG_XMIT_THREAD_MODE pxmitbuf->len = w_sz; pxmitbuf->ff_hwaddr = ff_hwaddr; - enqueue_pending_xmitbuf(pxmitpriv, pxmitbuf); + + if (pxmitframe->attrib.qsel == QSLT_BEACON) + /* download rsvd page*/ + rtw_write_port(padapter, ff_hwaddr, w_sz, (u8 *)pxmitbuf); + else + enqueue_pending_xmitbuf(pxmitpriv, pxmitbuf); #else /* RTW_INFO("%s: rtw_write_port size =%d\n", __func__,w_sz); */ inner_ret = rtw_write_port(padapter, ff_hwaddr, w_sz, (unsigned char *)pxmitbuf); @@ -664,6 +674,9 @@ static s32 rtw_dump_xframe(_adapter *padapter, struct xmit_frame *pxmitframe) } +#ifdef CONFIG_XMIT_THREAD_MODE + if (pxmitframe->attrib.qsel == QSLT_BEACON) +#endif rtw_free_xmitframe(pxmitpriv, pxmitframe); if (ret != _SUCCESS) @@ -673,24 +686,6 @@ static s32 rtw_dump_xframe(_adapter *padapter, struct xmit_frame *pxmitframe) } #ifdef CONFIG_USB_TX_AGGREGATION -static u32 xmitframe_need_length(struct xmit_frame *pxmitframe) -{ - struct pkt_attrib *pattrib = &pxmitframe->attrib; - - u32 len = 0; - - /* no consider fragement */ - len = pattrib->hdrlen + pattrib->iv_len + - SNAP_SIZE + sizeof(u16) + - pattrib->pktlen + - ((pattrib->bswenc) ? pattrib->icv_len : 0); - - if (pattrib->encrypt == _TKIP_) - len += 8; - - return len; -} - #define IDEA_CONDITION 1 /* check all packets before enqueue */ s32 rtl8188eu_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf) { @@ -786,7 +781,7 @@ s32 rtl8188eu_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv /* 3 2. aggregate same priority and same DA(AP or STA) frames */ pfirstframe = pxmitframe; - len = xmitframe_need_length(pfirstframe) + TXDESC_SIZE + (pfirstframe->pkt_offset * PACKET_OFFSET_SZ); + len = rtw_wlan_pkt_size(pfirstframe) + TXDESC_SIZE + (pfirstframe->pkt_offset * PACKET_OFFSET_SZ); pbuf_tail = len; pbuf = _RND8(pbuf_tail); @@ -864,11 +859,9 @@ s32 rtl8188eu_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv pxmitframe->pkt_offset = 0; /* not first frame of aggregation, no need to reserve offset */ #endif - len = xmitframe_need_length(pxmitframe) + TXDESC_SIZE + (pxmitframe->pkt_offset * PACKET_OFFSET_SZ); + len = rtw_wlan_pkt_size(pxmitframe) + TXDESC_SIZE + (pxmitframe->pkt_offset * PACKET_OFFSET_SZ); - if (_RND8(pbuf + len) > MAX_XMITBUF_SZ) - /* if (_RND8(pbuf + len) > (MAX_XMITBUF_SZ/2))//to do : for TX TP finial tune , Georgia 2012-0323 */ - { + if (_RND8(pbuf + len) > MAX_XMITBUF_SZ) { /* RTW_INFO("%s....len> MAX_XMITBUF_SZ\n",__FUNCTION__); */ pxmitframe->agg_num = 1; pxmitframe->pkt_offset = 1; @@ -978,7 +971,19 @@ s32 rtl8188eu_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv ff_hwaddr = rtw_get_ff_hwaddr(pfirstframe); /* RTW_INFO("%s ===================================== write port,buf_size(%d)\n",__FUNCTION__,pbuf_tail); */ /* xmit address == ((xmit_frame*)pxmitbuf->priv_data)->buf_addr */ + +#ifdef CONFIG_XMIT_THREAD_MODE + pxmitbuf->len = pbuf_tail; + pxmitbuf->ff_hwaddr = ff_hwaddr; + + if (pfirstframe->attrib.qsel == QSLT_BEACON) + /* download rsvd page*/ + rtw_write_port(padapter, ff_hwaddr, pbuf_tail, (u8 *)pxmitbuf); + else + enqueue_pending_xmitbuf(pxmitpriv, pxmitbuf); +#else rtw_write_port(padapter, ff_hwaddr, pbuf_tail, (u8 *)pxmitbuf); +#endif /* 3 5. update statisitc */ @@ -988,6 +993,9 @@ s32 rtl8188eu_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv rtw_count_tx_stats(padapter, pfirstframe, pbuf_tail); +#ifdef CONFIG_XMIT_THREAD_MODE + if (pfirstframe->attrib.qsel == QSLT_BEACON) +#endif rtw_free_xmitframe(pxmitpriv, pfirstframe); return _TRUE; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/usb/usb_halinit.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/usb/usb_halinit.c index 69a5872cf884..4de82bf037ec 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/usb/usb_halinit.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/usb/usb_halinit.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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_HAL_INIT_C_ #include @@ -30,10 +26,10 @@ #endif -static VOID +static void _ConfigNormalChipOutEP_8188E( - IN PADAPTER pAdapter, - IN u8 NumOutPipe + PADAPTER pAdapter, + u8 NumOutPipe ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); @@ -60,9 +56,9 @@ _ConfigNormalChipOutEP_8188E( } static BOOLEAN HalUsbSetQueuePipeMapping8188EUsb( - IN PADAPTER pAdapter, - IN u8 NumInPipe, - IN u8 NumOutPipe + PADAPTER pAdapter, + u8 NumInPipe, + u8 NumOutPipe ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); @@ -162,44 +158,6 @@ static u32 _InitPowerOn_8188EU(_adapter *padapter) } - -static void _dbg_dump_macreg(_adapter *padapter) -{ - u32 offset = 0; - u32 val32 = 0; - u32 index = 0 ; - for (index = 0; index < 64; index++) { - offset = index * 4; - val32 = rtw_read32(padapter, offset); - RTW_INFO("offset : 0x%02x ,val:0x%08x\n", offset, val32); - } -} - - -static void _InitPABias(_adapter *padapter) -{ - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); - u8 pa_setting; - - /* FIXED PA current issue */ - /* efuse_one_byte_read(padapter, 0x1FA, &pa_setting); */ - efuse_OneByteRead(padapter, 0x1FA, &pa_setting, _FALSE); - - - if (!(pa_setting & BIT0)) { - 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 & BIT4)) { - pa_setting = rtw_read8(padapter, 0x16); - pa_setting &= 0x0F; - rtw_write8(padapter, 0x16, pa_setting | 0x80); - rtw_write8(padapter, 0x16, pa_setting | 0x90); - } -} #ifdef CONFIG_BT_COEXIST static void _InitBTCoexist(_adapter *padapter) { @@ -259,9 +217,9 @@ static void _InitBTCoexist(_adapter *padapter) * --------------------------------------------------------------- */ /* Shall USB interface init this? */ -static VOID +static void _InitInterrupt( - IN PADAPTER Adapter + PADAPTER Adapter ) { u32 imr, imr_ex; @@ -305,9 +263,9 @@ _InitInterrupt( } -static VOID +static void _InitQueueReservedPage( - IN PADAPTER Adapter + PADAPTER Adapter ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -353,10 +311,10 @@ _InitQueueReservedPage( rtw_write32(Adapter, REG_RQPN, value32); } -static VOID +static void _InitTxBufferBoundary( - IN PADAPTER Adapter, - IN u8 txpktbuf_bndy + PADAPTER Adapter, + u8 txpktbuf_bndy ) { struct registry_priv *pregistrypriv = &Adapter->registrypriv; @@ -372,9 +330,9 @@ _InitTxBufferBoundary( } -static VOID +static void _InitPageBoundary( - IN PADAPTER Adapter + PADAPTER Adapter ) { /* RX Page Boundary */ @@ -397,15 +355,15 @@ _InitPageBoundary( } -static VOID +static void _InitNormalChipRegPriority( - IN PADAPTER Adapter, - IN u16 beQ, - IN u16 bkQ, - IN u16 viQ, - IN u16 voQ, - IN u16 mgtQ, - IN u16 hiQ + PADAPTER Adapter, + u16 beQ, + u16 bkQ, + u16 viQ, + u16 voQ, + u16 mgtQ, + u16 hiQ ) { u16 value16 = (rtw_read16(Adapter, REG_TRXDMA_CTRL) & 0x7); @@ -417,9 +375,9 @@ _InitNormalChipRegPriority( rtw_write16(Adapter, REG_TRXDMA_CTRL, value16); } -static VOID +static void _InitNormalChipOneOutEpPriority( - IN PADAPTER Adapter + PADAPTER Adapter ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -451,9 +409,9 @@ _InitNormalChipOneOutEpPriority( } -static VOID +static void _InitNormalChipTwoOutEpPriority( - IN PADAPTER Adapter + PADAPTER Adapter ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -502,9 +460,9 @@ _InitNormalChipTwoOutEpPriority( } -static VOID +static void _InitNormalChipThreeOutEpPriority( - IN PADAPTER Adapter + PADAPTER Adapter ) { struct registry_priv *pregistrypriv = &Adapter->registrypriv; @@ -528,9 +486,9 @@ _InitNormalChipThreeOutEpPriority( _InitNormalChipRegPriority(Adapter, beQ, bkQ, viQ, voQ, mgtQ, hiQ); } -static VOID +static void _InitQueuePriority( - IN PADAPTER Adapter + PADAPTER Adapter ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -555,9 +513,9 @@ _InitQueuePriority( -static VOID +static void _InitHardwareDropIncorrectBulkOut( - IN PADAPTER Adapter + PADAPTER Adapter ) { #ifdef ENABLE_USB_DROP_INCORRECT_OUT @@ -567,9 +525,9 @@ _InitHardwareDropIncorrectBulkOut( #endif } -static VOID +static void _InitNetworkType( - IN PADAPTER Adapter + PADAPTER Adapter ) { u32 value32; @@ -583,36 +541,35 @@ _InitNetworkType( } -static VOID +static void _InitDriverInfoSize( - IN PADAPTER Adapter, - IN u8 drvInfoSize + PADAPTER Adapter, + u8 drvInfoSize ) { rtw_write8(Adapter, REG_RX_DRVINFO_SZ, drvInfoSize); } -static VOID +static void _InitWMACSetting( - IN PADAPTER Adapter + PADAPTER Adapter ) { - /* u4Byte value32; */ + /* u32 value32; */ /* u16 value16; */ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); + u32 rcr; - /* pHalData->ReceiveConfig = AAP | APM | AM | AB | APP_ICV | ADF | AMF | APP_FCS | HTC_LOC_CTRL | APP_MIC | APP_PHYSTS; */ - /* pHalData->ReceiveConfig = */ + /* rcr = AAP | APM | AM | AB | APP_ICV | ADF | AMF | APP_FCS | HTC_LOC_CTRL | APP_MIC | APP_PHYSTS; */ + /* rcr = */ /* RCR_AAP | RCR_APM | RCR_AM | RCR_AB |RCR_CBSSID_DATA| RCR_CBSSID_BCN| RCR_APP_ICV | RCR_AMF | RCR_HTC_LOC_CTRL | RCR_APP_MIC | RCR_APP_PHYSTS; */ /* don't turn on AAP, it will allow all packets to driver */ - pHalData->ReceiveConfig = RCR_APM | RCR_AM | RCR_AB | RCR_CBSSID_DATA | RCR_CBSSID_BCN | RCR_APP_ICV | RCR_AMF | RCR_HTC_LOC_CTRL | RCR_APP_MIC | RCR_APP_PHYST_RXFF; + rcr = RCR_APM | RCR_AM | RCR_AB | RCR_CBSSID_DATA | RCR_CBSSID_BCN | RCR_APP_ICV | RCR_AMF | RCR_HTC_LOC_CTRL | RCR_APP_MIC | RCR_APP_PHYST_RXFF; #if (1 == RTL8188E_RX_PACKET_INCLUDE_CRC) - pHalData->ReceiveConfig |= ACRC32; + rcr |= ACRC32; #endif - - /* some REG_RCR will be modified later by phy_ConfigMACWithHeaderFile() */ - rtw_write32(Adapter, REG_RCR, pHalData->ReceiveConfig); + rtw_hal_set_hwreg(Adapter, HW_VAR_RCR, (u8 *)&rcr); /* Accept all multicast address */ rtw_write32(Adapter, REG_MAR, 0xFFFFFFFF); @@ -638,9 +595,9 @@ _InitWMACSetting( } -static VOID +static void _InitAdaptiveCtrl( - IN PADAPTER Adapter + PADAPTER Adapter ) { u16 value16; @@ -650,7 +607,12 @@ _InitAdaptiveCtrl( value32 = rtw_read32(Adapter, REG_RRSR); value32 &= ~RATE_BITMAP_ALL; value32 |= RATE_RRSR_CCK_ONLY_1M; - rtw_write32(Adapter, REG_RRSR, value32); + + #ifdef RTW_DYNAMIC_RRSR + rtw_phydm_set_rrsr(Adapter, value32, TRUE); + #else + rtw_write32(Adapter, REG_RRSR, value32); + #endif /* CF-END Threshold */ /* m_spIoBase->rtw_write8(REG_CFEND_TH, 0x1); */ @@ -660,28 +622,14 @@ _InitAdaptiveCtrl( rtw_write16(Adapter, REG_SPEC_SIFS, value16); /* Retry Limit */ - value16 = _LRL(0x30) | _SRL(0x30); - rtw_write16(Adapter, REG_RL, value16); + value16 = BIT_LRL(RL_VAL_STA) | BIT_SRL(RL_VAL_STA); + rtw_write16(Adapter, REG_RETRY_LIMIT, value16); } -static VOID -_InitRateFallback( - IN PADAPTER Adapter -) -{ - /* Set Data Auto Rate Fallback Retry Count register. */ - rtw_write32(Adapter, REG_DARFRC, 0x00000000); - rtw_write32(Adapter, REG_DARFRC + 4, 0x10080404); - rtw_write32(Adapter, REG_RARFRC, 0x04030201); - rtw_write32(Adapter, REG_RARFRC + 4, 0x08070605); - -} - - -static VOID +static void _InitEDCA( - IN PADAPTER Adapter + PADAPTER Adapter ) { /* Set Spec SIFS (used in NAV) */ @@ -702,20 +650,20 @@ _InitEDCA( } -static VOID +static void _InitBeaconMaxError( - IN PADAPTER Adapter, - IN BOOLEAN InfraMode + PADAPTER Adapter, + BOOLEAN InfraMode ) { } -#ifdef CONFIG_LED +#ifdef CONFIG_RTW_LED static void _InitHWLed(PADAPTER Adapter) { - struct led_priv *pledpriv = &(Adapter->ledpriv); + struct led_priv *pledpriv = adapter_to_led(Adapter); if (pledpriv->LedStrategy != HW_LED) return; @@ -725,11 +673,11 @@ static void _InitHWLed(PADAPTER Adapter) * must consider cases of antenna diversity/ commbo card/solo card/mini card */ } -#endif /* CONFIG_LED */ +#endif /* CONFIG_RTW_LED */ -static VOID +static void _InitRDGSetting( - IN PADAPTER Adapter + PADAPTER Adapter ) { rtw_write8(Adapter, REG_RD_CTRL, 0xFF); @@ -737,9 +685,9 @@ _InitRDGSetting( rtw_write8(Adapter, REG_RD_RESP_PKT_TH, 0x05); } -static VOID +static void _InitRetryFunction( - IN PADAPTER Adapter + PADAPTER Adapter ) { u8 value8; @@ -767,9 +715,9 @@ _InitRetryFunction( * 12/10/2010 MHC Seperate to smaller function. * *---------------------------------------------------------------------------*/ -static VOID +static void usb_AggSettingTxUpdate( - IN PADAPTER Adapter + PADAPTER Adapter ) { #ifdef CONFIG_USB_TX_AGGREGATION @@ -807,9 +755,9 @@ usb_AggSettingTxUpdate( * 12/10/2010 MHC Seperate to smaller function. * *---------------------------------------------------------------------------*/ -static VOID +static void usb_AggSettingRxUpdate( - IN PADAPTER Adapter + PADAPTER Adapter ) { #ifdef CONFIG_USB_RX_AGGREGATION @@ -890,9 +838,9 @@ usb_AggSettingRxUpdate( #endif } /* usb_AggSettingRxUpdate */ -static VOID +static void InitUsbAggregationSetting( - IN PADAPTER Adapter + PADAPTER Adapter ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -906,19 +854,19 @@ InitUsbAggregationSetting( /* 201/12/10 MH Add for USB agg mode dynamic switch. */ pHalData->UsbRxHighSpeedMode = _FALSE; } -VOID +void HalRxAggr8188EUsb( - IN PADAPTER Adapter, - IN BOOLEAN Value + PADAPTER Adapter, + BOOLEAN Value ) { #if 0/* USB_RX_AGGREGATION_92C */ PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; - u1Byte valueDMATimeout; - u1Byte valueDMAPageCount; - u1Byte valueUSBTimeout; - u1Byte valueUSBBlockCount; + u8 valueDMATimeout; + u8 valueDMAPageCount; + u8 valueUSBTimeout; + u8 valueUSBBlockCount; /* selection to prevent bad TP. */ if (IS_WIRELESS_MODE_B(Adapter) || IS_WIRELESS_MODE_G(Adapter) || IS_WIRELESS_MODE_A(Adapter) || pMgntInfo->bWiFiConfg) { @@ -929,13 +877,13 @@ HalRxAggr8188EUsb( valueDMAPageCount = 0x01; valueUSBTimeout = 0x0f; valueUSBBlockCount = 0x01; - rtw_hal_set_hwreg(Adapter, HW_VAR_RX_AGGR_PGTO, (pu1Byte)&valueDMATimeout); - rtw_hal_set_hwreg(Adapter, HW_VAR_RX_AGGR_PGTH, (pu1Byte)&valueDMAPageCount); - rtw_hal_set_hwreg(Adapter, HW_VAR_RX_AGGR_USBTO, (pu1Byte)&valueUSBTimeout); - rtw_hal_set_hwreg(Adapter, HW_VAR_RX_AGGR_USBTH, (pu1Byte)&valueUSBBlockCount); + rtw_hal_set_hwreg(Adapter, HW_VAR_RX_AGGR_PGTO, (u8 *)&valueDMATimeout); + rtw_hal_set_hwreg(Adapter, HW_VAR_RX_AGGR_PGTH, (u8 *)&valueDMAPageCount); + rtw_hal_set_hwreg(Adapter, HW_VAR_RX_AGGR_USBTO, (u8 *)&valueUSBTimeout); + rtw_hal_set_hwreg(Adapter, HW_VAR_RX_AGGR_USBTH, (u8 *)&valueUSBBlockCount); } else { - rtw_hal_set_hwreg(Adapter, HW_VAR_RX_AGGR_USBTO, (pu1Byte)&pMgntInfo->RegRxAggBlockTimeout); - rtw_hal_set_hwreg(Adapter, HW_VAR_RX_AGGR_USBTH, (pu1Byte)&pMgntInfo->RegRxAggBlockCount); + rtw_hal_set_hwreg(Adapter, HW_VAR_RX_AGGR_USBTO, (u8 *)&pMgntInfo->RegRxAggBlockTimeout); + rtw_hal_set_hwreg(Adapter, HW_VAR_RX_AGGR_USBTH, (u8 *)&pMgntInfo->RegRxAggBlockCount); } #endif @@ -960,9 +908,9 @@ HalRxAggr8188EUsb( * 12/10/2010 MHC Create Version 0. * *---------------------------------------------------------------------------*/ -VOID +void USB_AggModeSwitch( - IN PADAPTER Adapter + PADAPTER Adapter ) { #if 0 @@ -1034,107 +982,9 @@ USB_AggModeSwitch( #endif } /* USB_AggModeSwitch */ -static VOID -_InitOperationMode( - IN PADAPTER Adapter -) -{ -#if 0/* gtest */ - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - u1Byte regBwOpMode = 0; - u4Byte regRATR = 0, regRRSR = 0; - - - /* 1 This part need to modified according to the rate set we filtered!! */ - /* */ - /* Set RRSR, RATR, and REG_BWOPMODE registers */ - /* */ - switch (Adapter->RegWirelessMode) { - case WIRELESS_MODE_B: - regBwOpMode = BW_OPMODE_20MHZ; - regRATR = RATE_ALL_CCK; - regRRSR = RATE_ALL_CCK; - break; - case WIRELESS_MODE_A: - regBwOpMode = BW_OPMODE_5G | BW_OPMODE_20MHZ; - regRATR = RATE_ALL_OFDM_AG; - regRRSR = RATE_ALL_OFDM_AG; - 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 (Adapter->bInHctTest) { - regBwOpMode = BW_OPMODE_20MHZ; - regRATR = RATE_ALL_CCK | RATE_ALL_OFDM_AG; - regRRSR = RATE_ALL_CCK | RATE_ALL_OFDM_AG; - } else { - 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: - regBwOpMode = BW_OPMODE_5G; - regRATR = RATE_ALL_OFDM_AG | RATE_ALL_OFDM_1SS | RATE_ALL_OFDM_2SS; - regRRSR = RATE_ALL_OFDM_AG; - break; - - default: /* for MacOSX compiler warning. */ - break; - } - - /* Ziv ???????? */ - /* PlatformEFIOWrite4Byte(Adapter, REG_INIRTS_RATE_SEL, regRRSR); */ - PlatformEFIOWrite1Byte(Adapter, REG_BWOPMODE, regBwOpMode); -#endif -} - - -static VOID -_InitBeaconParameters( - IN PADAPTER Adapter -) -{ - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - - rtw_write16(Adapter, REG_BCN_CTRL, 0x1010); - - /* TODO: Remove these magic number */ - /* TBTT setup time:128 us */ - rtw_write8(Adapter, REG_TBTT_PROHIBIT, 0x04); - - /*TBTT hold time :4ms 0x540[19:8]*/ - rtw_write8(Adapter, REG_TBTT_PROHIBIT + 1, - TBTT_PROBIHIT_HOLD_TIME & 0xFF); - rtw_write8(Adapter, REG_TBTT_PROHIBIT + 2, - (rtw_read8(Adapter, REG_TBTT_PROHIBIT + 2) & 0xF0) | (TBTT_PROBIHIT_HOLD_TIME >> 8)); - rtw_write8(Adapter, REG_DRVERLYINT, DRIVER_EARLY_INT_TIME_8188E);/* 5ms */ - rtw_write8(Adapter, REG_BCNDMATIM, BCN_DMA_ATIME_INT_TIME_8188E); /* 2ms */ - - /* Suggested by designer timchen. Change beacon AIFS to the largest number */ - /* beacause test chip does not contension before sending beacon. by tynli. 2009.11.03 */ - rtw_write16(Adapter, REG_BCNTCFG, 0x660F); - - pHalData->RegBcnCtrlVal = rtw_read8(Adapter, REG_BCN_CTRL); - pHalData->RegTxPause = rtw_read8(Adapter, REG_TXPAUSE); - pHalData->RegFwHwTxQCtrl = rtw_read8(Adapter, REG_FWHW_TXQ_CTRL + 2); - pHalData->RegReg542 = rtw_read8(Adapter, REG_TBTT_PROHIBIT + 2); - pHalData->RegCR_1 = rtw_read8(Adapter, REG_CR + 1); -} - -static VOID +static void _InitRFType( - IN PADAPTER Adapter + PADAPTER Adapter ) { struct registry_priv *pregpriv = &Adapter->registrypriv; @@ -1153,24 +1003,9 @@ _InitRFType( } - -static VOID -_BeaconFunctionEnable( - IN PADAPTER Adapter, - IN BOOLEAN Enable, - IN BOOLEAN Linked -) -{ - rtw_write8(Adapter, REG_BCN_CTRL, (BIT4 | BIT3 | BIT1)); - /* SetBcnCtrlReg(Adapter, (BIT4 | BIT3 | BIT1), 0x00); */ - - rtw_write8(Adapter, REG_RD_CTRL + 1, 0x6F); -} - - /* Set CCK and OFDM Block "ON" */ -static VOID _BBTurnOnBlock( - IN PADAPTER Adapter +static void _BBTurnOnBlock( + PADAPTER Adapter ) { #if (DISABLE_BB_RF) @@ -1181,42 +1016,8 @@ static VOID _BBTurnOnBlock( phy_set_bb_reg(Adapter, rFPGA0_RFMOD, bOFDMEn, 0x1); } -static VOID _RfPowerSave( - IN PADAPTER Adapter -) -{ -#if 0 - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); - u1Byte eRFPath; - -#if (DISABLE_BB_RF) - return; -#endif - - if (pMgntInfo->RegRfOff == TRUE) { /* User disable RF via registry. */ - MgntActSet_RF_State(Adapter, eRfOff, RF_CHANGE_BY_SW); - /* Those action will be discard in MgntActSet_RF_State because off the same state */ - for (eRFPath = 0; eRFPath < pHalData->NumTotalRFPath; eRFPath++) - phy_set_rf_reg(Adapter, eRFPath, 0x4, 0xC00, 0x0); - } else if (pMgntInfo->RfOffReason > RF_CHANGE_BY_PS) { /* H/W or S/W RF OFF before sleep. */ - MgntActSet_RF_State(Adapter, eRfOff, pMgntInfo->RfOffReason); - } else { - pHalData->eRFPowerState = eRfOn; - pMgntInfo->RfOffReason = 0; - if (Adapter->bInSetPower || Adapter->bResetInProgress) - PlatformUsbEnableInPipes(Adapter); - } -#endif -} - -enum { - Antenna_Lfet = 1, - Antenna_Right = 2, -}; - -static VOID -_InitAntenna_Selection(IN PADAPTER Adapter) +static void +_InitAntenna_Selection(PADAPTER Adapter) { #ifdef CONFIG_ANTENNA_DIVERSITY HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -1235,12 +1036,12 @@ _InitAntenna_Selection(IN PADAPTER Adapter) * If Efuse 0x0e bit1 is not enabled, we can not support selective suspend for Minicard and * slim card. * */ -static VOID +#if 0 +static void HalDetectSelectiveSuspendMode( - IN PADAPTER Adapter + PADAPTER Adapter ) { -#if 0 u8 tmpvalue; HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(Adapter); @@ -1267,63 +1068,10 @@ HalDetectSelectiveSuspendMode( pdvobjpriv->RegUsbSS = _FALSE; /* } */ } -#endif } /* HalDetectSelectiveSuspendMode */ -#if 0 -/*----------------------------------------------------------------------------- - * Function: HwSuspendModeEnable92Cu() - * - * Overview: HW suspend mode switch. - * - * Input: NONE - * - * Output: NONE - * - * Return: NONE - * - * Revised History: - * When Who Remark - * 08/23/2010 MHC HW suspend mode switch test.. - *---------------------------------------------------------------------------*/ -static VOID -HwSuspendModeEnable_88eu( - IN PADAPTER pAdapter, - IN u8 Type -) -{ - /* PRT_USB_DEVICE pDevice = GET_RT_USB_DEVICE(pAdapter); */ - u16 reg = rtw_read16(pAdapter, REG_GPIO_MUXCFG); - - /* if (!pDevice->RegUsbSS) */ - { - return; - } - - /* */ - /* 2010/08/23 MH According to Alfred's suggestion, we need to to prevent HW */ - /* to enter suspend mode automatically. Otherwise, it will shut down major power */ - /* domain and 8051 will stop. When we try to enter selective suspend mode, we */ - /* need to prevent HW to enter D2 mode aumotmatically. Another way, Host will */ - /* issue a S10 signal to power domain. Then it will cleat SIC setting(from Yngli). */ - /* We need to enable HW suspend mode when enter S3/S4 or disable. We need */ - /* to disable HW suspend mode for IPS/radio_off. */ - /* */ - if (Type == _FALSE) { - reg |= BIT14; - rtw_write16(pAdapter, REG_GPIO_MUXCFG, reg); - reg |= BIT12; - rtw_write16(pAdapter, REG_GPIO_MUXCFG, reg); - } else { - reg &= (~BIT12); - rtw_write16(pAdapter, REG_GPIO_MUXCFG, reg); - reg &= (~BIT14); - rtw_write16(pAdapter, REG_GPIO_MUXCFG, reg); - } - -} /* HwSuspendModeEnable92Cu */ #endif -rt_rf_power_state RfOnOffDetect(IN PADAPTER pAdapter) +rt_rf_power_state RfOnOffDetect(PADAPTER pAdapter) { struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(pAdapter); HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); @@ -1360,7 +1108,7 @@ u32 rtl8188eu_hal_init(PADAPTER Adapter) struct btcoexist_priv *pbtpriv = &(pHalData->bt_coexist); #endif - u32 init_start_time = rtw_get_current_time(); + systime init_start_time = rtw_get_current_time(); #ifdef DBG_HAL_INIT_PROFILING @@ -1425,7 +1173,7 @@ u32 rtl8188eu_hal_init(PADAPTER Adapter) }; int hal_init_profiling_i; - u32 hal_init_stages_timestamp[HAL_INIT_STAGES_NUM]; /* used to record the time of each stage's starting point */ + systime hal_init_stages_timestamp[HAL_INIT_STAGES_NUM]; /* used to record the time of each stage's starting point */ for (hal_init_profiling_i = 0; hal_init_profiling_i < HAL_INIT_STAGES_NUM; hal_init_profiling_i++) hal_init_stages_timestamp[hal_init_profiling_i] = 0; @@ -1445,18 +1193,20 @@ u32 rtl8188eu_hal_init(PADAPTER Adapter) if (pHalData->bIQKInitialized) { /* PHY_IQCalibrate(padapter, _TRUE); */ - phy_iq_calibrate_8188e(Adapter, _TRUE); + /*phy_iq_calibrate_8188e(Adapter, _TRUE);*/ + halrf_iqk_trigger(&pHalData->odmpriv, _TRUE); } else { /* PHY_IQCalibrate(padapter, _FALSE); */ - phy_iq_calibrate_8188e(Adapter, _FALSE); + /*phy_iq_calibrate_8188e(Adapter, _FALSE);*/ + halrf_iqk_trigger(&pHalData->odmpriv, _FALSE); pHalData->bIQKInitialized = _TRUE; } /* dm_check_txpowertracking(padapter); * phy_lc_calibrate(padapter); */ odm_txpowertracking_check(&pHalData->odmpriv); - phy_lc_calibrate_8188e(&pHalData->odmpriv); - + /*phy_lc_calibrate_8188e(&pHalData->odmpriv);*/ + halrf_lck_trigger(&pHalData->odmpriv); goto exit; } @@ -1506,11 +1256,11 @@ u32 rtl8188eu_hal_init(PADAPTER Adapter) status = rtl8188e_FirmwareDownload(Adapter, _FALSE); if (status != _SUCCESS) { RTW_INFO("%s: Download Firmware failed!!\n", __FUNCTION__); - Adapter->bFWReady = _FALSE; + pHalData->bFWReady = _FALSE; pHalData->fw_ractrl = _FALSE; return status; } else { - Adapter->bFWReady = _TRUE; + pHalData->bFWReady = _TRUE; #ifdef CONFIG_SFW_SUPPORTED pHalData->fw_ractrl = IS_VENDOR_8188E_I_CUT_SERIES(Adapter) ? _TRUE : _FALSE; #else @@ -1576,11 +1326,9 @@ u32 rtl8188eu_hal_init(PADAPTER Adapter) _InitWMACSetting(Adapter); _InitAdaptiveCtrl(Adapter); _InitEDCA(Adapter); - /* _InitRateFallback(Adapter); */ /* just follow MP Team ???Georgia */ _InitRetryFunction(Adapter); InitUsbAggregationSetting(Adapter); - _InitOperationMode(Adapter);/* todo */ - _InitBeaconParameters(Adapter); + InitBeaconParameters_8188e(Adapter); _InitBeaconMaxError(Adapter, _TRUE); /* */ @@ -1644,26 +1392,10 @@ u32 rtl8188eu_hal_init(PADAPTER Adapter) rtw_write32(Adapter, REG_MACID_NO_LINK_0, 0xFFFFFFFF); rtw_write32(Adapter, REG_MACID_NO_LINK_1, 0xFFFFFFFF); -#if defined(CONFIG_CONCURRENT_MODE) || defined(CONFIG_TX_MCAST2UNI) -#ifdef CONFIG_CHECK_AC_LIFETIME - /* Enable lifetime check for the four ACs */ - rtw_write8(Adapter, REG_LIFETIME_CTRL, rtw_read8(Adapter, REG_LIFETIME_CTRL) | 0x0f); -#endif /* CONFIG_CHECK_AC_LIFETIME */ - -#ifdef CONFIG_TX_MCAST2UNI - rtw_write16(Adapter, REG_PKT_VO_VI_LIFE_TIME, 0x0400); /* unit: 256us. 256ms */ - rtw_write16(Adapter, REG_PKT_BE_BK_LIFE_TIME, 0x0400); /* unit: 256us. 256ms */ -#else /* CONFIG_TX_MCAST2UNI */ - rtw_write16(Adapter, REG_PKT_VO_VI_LIFE_TIME, 0x3000); /* unit: 256us. 3s */ - rtw_write16(Adapter, REG_PKT_BE_BK_LIFE_TIME, 0x3000); /* unit: 256us. 3s */ -#endif /* CONFIG_TX_MCAST2UNI */ -#endif /* CONFIG_CONCURRENT_MODE || CONFIG_TX_MCAST2UNI */ - - -#ifdef CONFIG_LED +#ifdef CONFIG_RTW_LED _InitHWLed(Adapter); -#endif /* CONFIG_LED */ +#endif /* CONFIG_RTW_LED */ /* */ @@ -1681,10 +1413,7 @@ u32 rtl8188eu_hal_init(PADAPTER Adapter) HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_MISC11); /* 2010/12/17 MH We need to set TX power according to EFUSE content at first. */ - PHY_SetTxPowerLevel8188E(Adapter, pHalData->current_channel); - - /* Move by Neo for USB SS to below setp - * _RfPowerSave(Adapter); */ + rtw_hal_set_tx_power_level(Adapter, pHalData->current_channel); _InitAntenna_Selection(Adapter); @@ -1744,25 +1473,19 @@ u32 rtl8188eu_hal_init(PADAPTER Adapter) HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_IQK); /* 2010/08/26 MH Merge from 8192CE. */ if (pwrctrlpriv->rf_pwrstate == rf_on) { - if (pHalData->bIQKInitialized) - phy_iq_calibrate_8188e(Adapter, _TRUE); - else { - phy_iq_calibrate_8188e(Adapter, _FALSE); - pHalData->bIQKInitialized = _TRUE; - } - + + pHalData->neediqk_24g = _TRUE; HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_PW_TRACK); odm_txpowertracking_check(&pHalData->odmpriv); HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_LCK); - phy_lc_calibrate_8188e(&pHalData->odmpriv); + /*phy_lc_calibrate_8188e(&pHalData->odmpriv);*/ + halrf_lck_trigger(&pHalData->odmpriv); } } - /* HAL_INIT_PROFILE_TAG(HAL_INIT_STAGES_INIT_PABIAS); - * _InitPABias(Adapter); */ rtw_write8(Adapter, REG_USB_HRPWM, 0); #ifdef CONFIG_XMIT_ACK @@ -1779,7 +1502,7 @@ u32 rtl8188eu_hal_init(PADAPTER Adapter) hal_init_stages_timestamp[HAL_INIT_STAGES_END] = rtw_get_current_time(); for (hal_init_profiling_i = 0; hal_init_profiling_i < HAL_INIT_STAGES_NUM - 1; hal_init_profiling_i++) { - RTW_INFO("DBG_HAL_INIT_PROFILING: %35s, %u, %5u, %5u\n" + RTW_INFO("DBG_HAL_INIT_PROFILING: %35s, %lu, %5lu, %5u\n" , hal_init_stages_str[hal_init_profiling_i] , hal_init_stages_timestamp[hal_init_profiling_i] , (hal_init_stages_timestamp[hal_init_profiling_i + 1] - hal_init_stages_timestamp[hal_init_profiling_i]) @@ -1806,9 +1529,9 @@ void _ps_close_RF(_adapter *padapter) } -VOID +void hal_poweroff_8188eu( - IN PADAPTER Adapter + PADAPTER Adapter ) { @@ -1837,7 +1560,7 @@ hal_poweroff_8188eu( /* rtw_write8(Adapter, REG_RF_CTRL, 0x00); */ val8 = rtw_read8(Adapter, REG_MCUFWDL); - if ((val8 & RAM_DL_SEL) && Adapter->bFWReady) { /* 8051 RAM code */ + if ((val8 & RAM_DL_SEL) && GET_HAL_DATA(Adapter)->bFWReady) { /* 8051 RAM code */ /* _8051Reset88E(padapter); */ /* Reset MCU 0x2[10]=0. */ @@ -1886,7 +1609,7 @@ hal_poweroff_8188eu( rtw_write32(Adapter, REG_BB_PAD_CTRL, 0x00080808);/* set LNA ,TRSW,EX_PA Pin to output mode */ #endif - Adapter->bFWReady = _FALSE; + GET_HAL_DATA(Adapter)->bFWReady = _FALSE; bMacPwrCtrlOn = _FALSE; rtw_hal_set_hwreg(Adapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); @@ -2011,16 +1734,17 @@ unsigned int rtl8188eu_inirp_deinit(PADAPTER Adapter) * * ------------------------------------------------------------------- */ -static VOID +static void _ReadLEDSetting( - IN PADAPTER Adapter, - IN u8 *PROMContent, - IN BOOLEAN AutoloadFail + PADAPTER Adapter, + u8 *PROMContent, + BOOLEAN AutoloadFail ) { - struct led_priv *pledpriv = &(Adapter->ledpriv); +#ifdef CONFIG_RTW_LED + struct led_priv *pledpriv = adapter_to_led(Adapter); HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -#ifdef CONFIG_SW_LED +#ifdef CONFIG_RTW_SW_LED pledpriv->bRegUseLed = _TRUE; switch (pHalData->CustomerID) { @@ -2031,57 +1755,15 @@ _ReadLEDSetting( pHalData->bLedOpenDrain = _TRUE;/* Support Open-drain arrangement for controlling the LED. Added by Roger, 2009.10.16. */ #else /* HW LED */ pledpriv->LedStrategy = HW_LED; -#endif /* CONFIG_SW_LED */ -} - -static VOID -_ReadRFSetting( - IN PADAPTER Adapter, - IN u8 *PROMContent, - IN BOOLEAN AutoloadFail -) -{ -} - -static VOID -hal_InitPGData( - IN PADAPTER pAdapter, - IN OUT u8 *PROMContent -) -{ -#if 0 - - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - u32 i; - u16 value16; - - if (_FALSE == pHalData->bautoload_fail_flag) { - /* autoload OK. */ - if (_TRUE == pHalData->EepromOrEfuse) { - /* Read all Content from EEPROM or EFUSE. */ - for (i = 0; i < HWSET_MAX_SIZE_88E; i += 2) { - /* value16 = EF2Byte(ReadEEprom(pAdapter, (u2Byte) (i>>1))); */ - /* *((u16 *)(&PROMContent[i])) = value16; */ - } - } else { - /* Read EFUSE real map to shadow. */ - EFUSE_ShadowMapUpdate(pAdapter, EFUSE_WIFI, _FALSE); - _rtw_memcpy((void *)PROMContent, (void *)pHalData->efuse_eeprom_data, HWSET_MAX_SIZE_88E); - } - } else { - /* autoload fail */ - pHalData->bautoload_fail_flag = _TRUE; - /* update to default value 0xFF */ - if (_FALSE == pHalData->EepromOrEfuse) - EFUSE_ShadowMapUpdate(pAdapter, EFUSE_WIFI, _FALSE); - } +#endif /* CONFIG_RTW_SW_LED */ #endif } + static void Hal_EfuseParsePIDVID_8188EU( - IN PADAPTER pAdapter, - IN u8 *hwinfo, - IN BOOLEAN AutoLoadFail + PADAPTER pAdapter, + u8 *hwinfo, + BOOLEAN AutoLoadFail ) { @@ -2112,7 +1794,7 @@ Hal_EfuseParsePIDVID_8188EU( static void Hal_CustomizeByCustomerID_8188EU( - IN PADAPTER padapter + PADAPTER padapter ) { #if 0 @@ -2157,12 +1839,11 @@ Hal_CustomizeByCustomerID_8188EU( #endif } -static VOID +static void readAdapterInfo_8188EU( - IN PADAPTER padapter + PADAPTER padapter ) { -#if 1 PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); /* parse the eeprom/efuse content */ @@ -2196,25 +1877,10 @@ readAdapterInfo_8188EU( Hal_CustomizeByCustomerID_8188EU(padapter); _ReadLEDSetting(padapter, pHalData->efuse_eeprom_data, pHalData->bautoload_fail_flag); - -#else - -#ifdef CONFIG_INTEL_PROXIM - /* for intel proximity */ - if (pHalData->rf_type == RF_1T1R) - Adapter->proximity.proxim_support = _TRUE; - else if (pHalData->rf_type == RF_2T2R) { - if ((pHalData->EEPROMPID == 0x8186) && - (pHalData->EEPROMVID == 0x0bda)) - Adapter->proximity.proxim_support = _TRUE; - } else - Adapter->proximity.proxim_support = _FALSE; -#endif /* CONFIG_INTEL_PROXIM */ -#endif } static void _ReadPROMContent( - IN PADAPTER Adapter + PADAPTER Adapter ) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); @@ -2237,9 +1903,9 @@ static void _ReadPROMContent( -static VOID +static void _ReadRFType( - IN PADAPTER Adapter + PADAPTER Adapter ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -2256,8 +1922,6 @@ static u8 ReadAdapterInfo8188EU(PADAPTER Adapter) /* Read EEPROM size before call any EEPROM function */ Adapter->EepromAddressSize = GetEEPROMSize8188E(Adapter); - /* Efuse_InitSomeVar(Adapter); */ - _ReadRFType(Adapter);/* rf_chip->_InitRFType() */ _ReadPROMContent(Adapter); @@ -2289,9 +1953,10 @@ void UpdateInterruptMask8188EU(PADAPTER padapter, u8 bHIMR0 , u32 AddMSR, u32 Re } -void SetHwReg8188EU(PADAPTER Adapter, u8 variable, u8 *val) +u8 SetHwReg8188EU(PADAPTER Adapter, u8 variable, u8 *val) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); + u8 ret = _SUCCESS; switch (variable) { @@ -2299,12 +1964,46 @@ void SetHwReg8188EU(PADAPTER Adapter, u8 variable, u8 *val) case HW_VAR_RXDMA_AGG_PG_TH: #ifdef CONFIG_USB_RX_AGGREGATION { + /* threshold == 1 , Disable Rx-agg when AP is B/G mode or wifi_spec=1 to prevent bad TP. */ + u8 threshold = *((u8 *)val); - if (threshold == 0) - threshold = pHalData->rxagg_dma_size; + + if (threshold == 0) { + switch (pHalData->rxagg_mode) { + case RX_AGG_DMA: + threshold = (pHalData->rxagg_dma_size & 0x0F); + break; + case RX_AGG_USB: + case RX_AGG_MIX: + threshold = (pHalData->rxagg_usb_size & 0x0F); + break; + case RX_AGG_DISABLE: + default: + break; + } + } + rtw_write8(Adapter, REG_RXDMA_AGG_PG_TH, threshold); + +#ifdef CONFIG_80211N_HT + { + /* 2014-07-24 Fix WIFI Logo -5.2.4/5.2.9 - DT3 low TP issue */ + /* Adjust RxAggrTimeout to close to zero disable RxAggr for RxAgg-USB mode, suggested by designer */ + /* Timeout value is calculated by 34 / (2^n) */ + struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; + struct ht_priv *phtpriv = &pmlmepriv->htpriv; + + if (pHalData->rxagg_mode == RX_AGG_USB) { + /* BG mode || (wifi_spec=1 && BG mode Testbed) */ + if ((threshold == 1) && (phtpriv->ht_option == _FALSE)) + rtw_write8(Adapter, REG_RXDMA_AGG_PG_TH + 1, 0); + else + rtw_write8(Adapter, REG_RXDMA_AGG_PG_TH + 1, pHalData->rxagg_usb_timeout); + } + } +#endif/* CONFIG_80211N_HT */ } -#endif +#endif/* CONFIG_USB_RX_AGGREGATION */ break; case HW_VAR_SET_RPWM: #ifdef CONFIG_LPS_LCLK @@ -2322,10 +2021,11 @@ void SetHwReg8188EU(PADAPTER Adapter, u8 variable, u8 *val) #endif break; default: - SetHwReg8188E(Adapter, variable, val); + ret = SetHwReg8188E(Adapter, variable, val); break; } + return ret; } void GetHwReg8188EU(PADAPTER Adapter, u8 variable, u8 *val) @@ -2346,9 +2046,9 @@ void GetHwReg8188EU(PADAPTER Adapter, u8 variable, u8 *val) * */ u8 GetHalDefVar8188EUsb( - IN PADAPTER Adapter, - IN HAL_DEF_VARIABLE eVariable, - IN PVOID pValue + PADAPTER Adapter, + HAL_DEF_VARIABLE eVariable, + void *pValue ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -2386,9 +2086,9 @@ GetHalDefVar8188EUsb( * */ u8 SetHalDefVar8188EUsb( - IN PADAPTER Adapter, - IN HAL_DEF_VARIABLE eVariable, - IN PVOID pValue + PADAPTER Adapter, + HAL_DEF_VARIABLE eVariable, + void *pValue ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -2429,76 +2129,6 @@ u32 _update_92cu_basic_rate(_adapter *padapter, unsigned int mask) return BrateCfg; } #endif -void _update_response_rate(_adapter *padapter, unsigned int mask) -{ - u8 RateIndex = 0; - /* Set RRSR rate table. */ - rtw_write8(padapter, REG_RRSR, mask & 0xff); - rtw_write8(padapter, REG_RRSR + 1, (mask >> 8) & 0xff); - - /* Set RTS initial rate */ - while (mask > 0x1) { - mask = (mask >> 1); - RateIndex++; - } - rtw_write8(padapter, REG_INIRTS_RATE_SEL, RateIndex); -} - -void SetBeaconRelatedRegisters8188EUsb(PADAPTER padapter) -{ - u32 value32; - /* HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); */ - struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); - u32 bcn_ctrl_reg = REG_BCN_CTRL; - /* reset TSF, enable update TSF, correcting TSF On Beacon */ - - /* REG_BCN_INTERVAL */ - /* REG_BCNDMATIM */ - /* REG_ATIMWND */ - /* REG_TBTT_PROHIBIT */ - /* REG_DRVERLYINT */ - /* REG_BCN_MAX_ERR */ - /* REG_BCNTCFG */ /* (0x510) */ - /* REG_DUAL_TSF_RST */ - /* REG_BCN_CTRL */ /* (0x550) */ - - /* BCN interval */ -#ifdef CONFIG_CONCURRENT_MODE - if (padapter->hw_port == HW_PORT1) - bcn_ctrl_reg = REG_BCN_CTRL_1; -#endif - rtw_write16(padapter, REG_BCN_INTERVAL, pmlmeinfo->bcn_interval); - rtw_write8(padapter, REG_ATIMWND, 0x02);/* 2ms */ - - _InitBeaconParameters(padapter); - - rtw_write8(padapter, REG_SLOT, 0x09); - - value32 = rtw_read32(padapter, REG_TCR); - value32 &= ~TSFRST; - rtw_write32(padapter, REG_TCR, value32); - - value32 |= TSFRST; - rtw_write32(padapter, REG_TCR, value32); - - /* NOTE: Fix test chip's bug (about contention windows's randomness) */ - rtw_write8(padapter, REG_RXTSF_OFFSET_CCK, 0x50); - rtw_write8(padapter, REG_RXTSF_OFFSET_OFDM, 0x50); - - _BeaconFunctionEnable(padapter, _TRUE, _TRUE); - - ResumeTxBeacon(padapter); - - /* rtw_write8(padapter, 0x422, rtw_read8(padapter, 0x422)|BIT(6)); */ - - /* rtw_write8(padapter, 0x541, 0xff); */ - - /* rtw_write8(padapter, 0x542, rtw_read8(padapter, 0x541)|BIT(0)); */ - - rtw_write8(padapter, bcn_ctrl_reg, rtw_read8(padapter, bcn_ctrl_reg) | BIT(1)); - -} static void rtl8188eu_init_default_value(_adapter *padapter) { @@ -2509,7 +2139,6 @@ static void rtl8188eu_init_default_value(_adapter *padapter) pHalData = GET_HAL_DATA(padapter); pwrctrlpriv = adapter_to_pwrctl(padapter); - rtl8188e_init_default_value(padapter); /* init default value */ pHalData->fw_ractrl = _FALSE; @@ -2518,13 +2147,6 @@ static void rtl8188eu_init_default_value(_adapter *padapter) /* init dm default value */ pHalData->bIQKInitialized = _FALSE; - pHalData->odmpriv.rf_calibrate_info.tm_trigger = 0;/* for IQK */ - /* pdmpriv->binitialized = _FALSE; - * pdmpriv->prv_traffic_idx = 3; - * pdmpriv->initialize = 0; */ - pHalData->odmpriv.rf_calibrate_info.thermal_value_hp_index = 0; - for (i = 0; i < HP_THERMAL_NUM; i++) - pHalData->odmpriv.rf_calibrate_info.thermal_value_hp[i] = 0; pHalData->EfuseHal.fakeEfuseBank = 0; pHalData->EfuseHal.fakeEfuseUsedBytes = 0; @@ -2571,13 +2193,10 @@ void rtl8188eu_set_hal_ops(_adapter *padapter) pHalFunc->init_recv_priv = &rtl8188eu_init_recv_priv; pHalFunc->free_recv_priv = &rtl8188eu_free_recv_priv; -#ifdef CONFIG_SW_LED +#ifdef CONFIG_RTW_SW_LED pHalFunc->InitSwLeds = &rtl8188eu_InitSwLeds; pHalFunc->DeInitSwLeds = &rtl8188eu_DeInitSwLeds; -#else /* case of hw led or no led */ - pHalFunc->InitSwLeds = NULL; - pHalFunc->DeInitSwLeds = NULL; -#endif/* CONFIG_SW_LED */ +#endif/* CONFIG_RTW_SW_LED */ pHalFunc->init_default_value = &rtl8188eu_init_default_value; pHalFunc->intf_chip_configure = &rtl8188eu_interface_configure; @@ -2587,7 +2206,7 @@ void rtl8188eu_set_hal_ops(_adapter *padapter) pHalFunc->get_hal_def_var_handler = &GetHalDefVar8188EUsb; pHalFunc->SetHalDefVarHandler = &SetHalDefVar8188EUsb; - pHalFunc->SetBeaconRelatedRegistersHandler = &SetBeaconRelatedRegisters8188EUsb; + pHalFunc->SetBeaconRelatedRegistersHandler = &SetBeaconRelatedRegisters8188E; pHalFunc->hal_xmit = &rtl8188eu_hal_xmit; pHalFunc->mgnt_xmit = &rtl8188eu_mgnt_xmit; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/usb/usb_ops_linux.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/usb/usb_ops_linux.c index 57246849254e..95e1e86dfe74 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/usb/usb_ops_linux.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/rtl8188e/usb/usb_ops_linux.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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_OPS_OS_C_ #include @@ -117,7 +113,6 @@ int recvbuf2recvframe(PADAPTER padapter, void *ptr) u32 pkt_offset; s32 transfer_len; struct recv_stat *prxstat; - u8 *pphy_status = NULL; union recv_frame *precvframe = NULL; struct rx_pkt_attrib *pattrib = NULL; HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); @@ -177,7 +172,7 @@ int recvbuf2recvframe(PADAPTER padapter, void *ptr) #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 @@ -191,21 +186,9 @@ int recvbuf2recvframe(PADAPTER padapter, void *ptr) recvframe_put(precvframe, pattrib->pkt_len); /* recvframe_pull(precvframe, drvinfo_sz + RXDESC_SIZE); */ - if (pattrib->pkt_rpt_type == NORMAL_RX) { /* Normal rx packet */ - if (pattrib->physt) - pphy_status = pbuf + RXDESC_OFFSET; - -#ifdef CONFIG_CONCURRENT_MODE - pre_recv_entry(precvframe, pphy_status); -#endif /*CONFIG_CONCURRENT_MODE*/ - - - if (pattrib->physt && pphy_status) - rx_query_phy_status(precvframe, pphy_status); - - rtw_recv_entry(precvframe); - - } else { /* pkt_rpt_type == TX_REPORT1-CCX, TX_REPORT2-TX RTP,HIS_REPORT-USB HISR RTP */ + if (pattrib->pkt_rpt_type == NORMAL_RX) /* Normal rx packet */ + pre_recv_entry(precvframe, pattrib->physt ? (pbuf + RXDESC_OFFSET) : NULL); + else { /* pkt_rpt_type == TX_REPORT1-CCX, TX_REPORT2-TX RTP,HIS_REPORT-USB HISR RTP */ /* enqueue recvframe to txrtp queue */ if (pattrib->pkt_rpt_type == TX_REPORT1) { diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/ifcfg-wlan0 b/drivers/net/wireless/rockchip_wlan/rtl8188eu/ifcfg-wlan0 index 7ecb7ae62c7f..20dcbec2b1ae 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/ifcfg-wlan0 +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/ifcfg-wlan0 @@ -1,4 +1,4 @@ -#DHCP client -DEVICE=wlan0 -BOOTPROTO=dhcp +#DHCP client +DEVICE=wlan0 +BOOTPROTO=dhcp ONBOOT=yes \ No newline at end of file diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8188EPhyCfg.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8188EPhyCfg.h index c0558bcf4f31..405382aa8791 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8188EPhyCfg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8188EPhyCfg.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -60,129 +56,125 @@ /* * BB and RF register read/write * */ -u32 PHY_QueryBBReg8188E(IN PADAPTER Adapter, - IN u32 RegAddr, - IN u32 BitMask); -void PHY_SetBBReg8188E(IN PADAPTER Adapter, - IN u32 RegAddr, - IN u32 BitMask, - IN u32 Data); -u32 PHY_QueryRFReg8188E(IN PADAPTER Adapter, - IN u8 eRFPath, - IN u32 RegAddr, - IN u32 BitMask); -void PHY_SetRFReg8188E(IN PADAPTER Adapter, - IN u8 eRFPath, - IN u32 RegAddr, - IN u32 BitMask, - IN u32 Data); +u32 PHY_QueryBBReg8188E(PADAPTER Adapter, + u32 RegAddr, + u32 BitMask); +void PHY_SetBBReg8188E(PADAPTER Adapter, + u32 RegAddr, + u32 BitMask, + u32 Data); +u32 PHY_QueryRFReg8188E(PADAPTER Adapter, + enum rf_path eRFPath, + u32 RegAddr, + u32 BitMask); +void PHY_SetRFReg8188E(PADAPTER Adapter, + enum rf_path eRFPath, + u32 RegAddr, + u32 BitMask, + u32 Data); /* * Initialization related function */ /* MAC/BB/RF HAL config */ -int PHY_MACConfig8188E(IN PADAPTER Adapter); -int PHY_BBConfig8188E(IN PADAPTER Adapter); -int PHY_RFConfig8188E(IN PADAPTER Adapter); +int PHY_MACConfig8188E(PADAPTER Adapter); +int PHY_BBConfig8188E(PADAPTER Adapter); +int PHY_RFConfig8188E(PADAPTER Adapter); /* RF config */ -int rtl8188e_PHY_ConfigRFWithParaFile(IN PADAPTER Adapter, IN u8 *pFileName, u8 eRFPath); +int rtl8188e_PHY_ConfigRFWithParaFile( PADAPTER Adapter, u8 *pFileName, enum rf_path eRFPath); /* * RF Power setting */ -/* extern BOOLEAN PHY_SetRFPowerState(IN PADAPTER Adapter, - * IN RT_RF_POWER_STATE eRFPowerState); */ +/* extern BOOLEAN PHY_SetRFPowerState(PADAPTER Adapter, + * RT_RF_POWER_STATE eRFPowerState); */ /* * BB TX Power R/W * */ -void PHY_GetTxPowerLevel8188E(IN PADAPTER Adapter, - OUT s32 *powerlevel); -void PHY_SetTxPowerLevel8188E(IN PADAPTER Adapter, - IN u8 channel); -BOOLEAN PHY_UpdateTxPowerDbm8188E(IN PADAPTER Adapter, - IN int powerInDbm); +void PHY_SetTxPowerLevel8188E(PADAPTER Adapter, + u8 channel); -VOID +void PHY_SetTxPowerIndex_8188E( - IN PADAPTER Adapter, - IN u32 PowerIndex, - IN u8 RFPath, - IN u8 Rate + PADAPTER Adapter, + u32 PowerIndex, + enum rf_path RFPath, + u8 Rate ); u8 PHY_GetTxPowerIndex_8188E( - IN PADAPTER pAdapter, - IN u8 RFPath, - IN u8 Rate, - IN u8 BandWidth, - IN u8 Channel, + PADAPTER pAdapter, + enum rf_path RFPath, + u8 Rate, + u8 BandWidth, + u8 Channel, struct txpwr_idx_comp *tic ); /* * Switch bandwidth for 8192S */ -/* extern void PHY_SetBWModeCallback8192C( IN PRT_TIMER pTimer ); */ -void PHY_SetBWMode8188E(IN PADAPTER pAdapter, - IN CHANNEL_WIDTH ChnlWidth, - IN unsigned char Offset); +/* extern void PHY_SetBWModeCallback8192C(PRT_TIMER pTimer ); */ +void PHY_SetBWMode8188E(PADAPTER pAdapter, + enum channel_width ChnlWidth, + unsigned char Offset); /* * Set FW CMD IO for 8192S. */ -/* extern BOOLEAN HalSetIO8192C( IN PADAPTER Adapter, - * IN IO_TYPE IOType); */ +/* extern BOOLEAN HalSetIO8192C(PADAPTER Adapter, + * IO_TYPE IOType); */ /* * Set A2 entry to fw for 8192S * */ -extern void FillA2Entry8192C(IN PADAPTER Adapter, - IN u8 index, - IN u8 *val); +extern void FillA2Entry8192C(PADAPTER Adapter, + u8 index, + u8 *val); /* * channel switch related funciton */ -/* extern void PHY_SwChnlCallback8192C( IN PRT_TIMER pTimer ); */ -void PHY_SwChnl8188E(IN PADAPTER pAdapter, - IN u8 channel); +/* extern void PHY_SwChnlCallback8192C(PRT_TIMER pTimer ); */ +void PHY_SwChnl8188E(PADAPTER pAdapter, + u8 channel); -VOID +void PHY_SetSwChnlBWMode8188E( - IN PADAPTER Adapter, - IN u8 channel, - IN CHANNEL_WIDTH Bandwidth, - IN u8 Offset40, - IN u8 Offset80 + PADAPTER Adapter, + u8 channel, + enum channel_width Bandwidth, + u8 Offset40, + u8 Offset80 ); -VOID +void PHY_SetRFEReg_8188E( - IN PADAPTER Adapter + PADAPTER Adapter ); /* * BB/MAC/RF other monitor API * */ -VOID phy_set_rf_path_switch_8188e(IN PADAPTER pAdapter, IN bool bMain); +void phy_set_rf_path_switch_8188e(struct dm_struct *phydm, bool bMain); -extern VOID +extern void PHY_SwitchEphyParameter( - IN PADAPTER Adapter + PADAPTER Adapter ); -extern VOID +extern void PHY_EnableHostClkReq( - IN PADAPTER Adapter + PADAPTER Adapter ); BOOLEAN SetAntennaConfig92C( - IN PADAPTER Adapter, - IN u8 DefaultAnt + PADAPTER Adapter, + u8 DefaultAnt ); /*--------------------------Exported Function prototype---------------------*/ @@ -258,7 +250,7 @@ SetAntennaConfig92C( #endif #if (SIC_ENABLE == 1) - VOID SIC_Init(IN PADAPTER Adapter); + void SIC_Init( PADAPTER Adapter); #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8188EPhyReg.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8188EPhyReg.h index 783ea64123d6..94972bf7200f 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8188EPhyReg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8188EPhyReg.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/Hal8188EPwrSeq.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8188EPwrSeq.h index 385722a551b6..4eab945a7a17 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8188EPwrSeq.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8188EPwrSeq.h @@ -1,7 +1,7 @@ - +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,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/rtl8188eu/include/Hal8188FPhyCfg.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8188FPhyCfg.h index 410d9c3382ce..6e989582933a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8188FPhyCfg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8188FPhyCfg.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -44,34 +40,34 @@ /*--------------------------Exported Function prototype---------------------*/ u32 PHY_QueryBBReg_8188F( - IN PADAPTER Adapter, - IN u32 RegAddr, - IN u32 BitMask + PADAPTER Adapter, + u32 RegAddr, + u32 BitMask ); -VOID +void PHY_SetBBReg_8188F( - IN PADAPTER Adapter, - IN u32 RegAddr, - IN u32 BitMask, - IN u32 Data + PADAPTER Adapter, + u32 RegAddr, + u32 BitMask, + u32 Data ); u32 PHY_QueryRFReg_8188F( - IN PADAPTER Adapter, - IN u8 eRFPath, - IN u32 RegAddr, - IN u32 BitMask + PADAPTER Adapter, + enum rf_path eRFPath, + u32 RegAddr, + u32 BitMask ); -VOID +void PHY_SetRFReg_8188F( - IN PADAPTER Adapter, - IN u8 eRFPath, - IN u32 RegAddr, - IN u32 BitMask, - IN u32 Data + PADAPTER Adapter, + enum rf_path eRFPath, + u32 RegAddr, + u32 BitMask, + u32 Data ); /* MAC/BB/RF HAL config */ @@ -83,53 +79,47 @@ s32 PHY_MACConfig8188F(PADAPTER padapter); int PHY_ConfigRFWithParaFile_8188F( - IN PADAPTER Adapter, - IN u8 *pFileName, - RF_PATH eRFPath + PADAPTER Adapter, + u8 *pFileName, + enum rf_path eRFPath ); -VOID +void PHY_SetTxPowerIndex_8188F( - IN PADAPTER Adapter, - IN u32 PowerIndex, - IN u8 RFPath, - IN u8 Rate + PADAPTER Adapter, + u32 PowerIndex, + enum rf_path RFPath, + u8 Rate ); u8 PHY_GetTxPowerIndex_8188F( - IN PADAPTER pAdapter, - IN u8 RFPath, - IN u8 Rate, - IN u8 BandWidth, - IN u8 Channel, + PADAPTER pAdapter, + enum rf_path RFPath, + u8 Rate, + u8 BandWidth, + u8 Channel, struct txpwr_idx_comp *tic ); -VOID -PHY_GetTxPowerLevel8188F( - IN PADAPTER Adapter, - OUT s32 *powerlevel -); - -VOID +void PHY_SetTxPowerLevel8188F( - IN PADAPTER Adapter, - IN u8 channel + PADAPTER Adapter, + u8 channel ); -VOID +void PHY_SetSwChnlBWMode8188F( - IN PADAPTER Adapter, - IN u8 channel, - IN CHANNEL_WIDTH Bandwidth, - IN u8 Offset40, - IN u8 Offset80 + PADAPTER Adapter, + u8 channel, + enum channel_width Bandwidth, + u8 Offset40, + u8 Offset80 ); -VOID phy_set_rf_path_switch_8188f( - IN PADAPTER pAdapter, - IN bool bMain +void phy_set_rf_path_switch_8188f( + struct dm_struct *phydm, + bool bMain ); void BBTurnOnBlock_8188F(_adapter *adapter); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8188FPhyReg.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8188FPhyReg.h index 8d38c0fbbdbc..f87c348bc333 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8188FPhyReg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8188FPhyReg.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/Hal8188FPwrSeq.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8188FPwrSeq.h index 59aba21de9a5..56088ab60aac 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8188FPwrSeq.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8188FPwrSeq.h @@ -1,4 +1,18 @@ /* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * 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/rtl8188eu/include/Hal8192EPhyCfg.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8192EPhyCfg.h index 17dd98208842..76b7d57e3dd7 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8192EPhyCfg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8192EPhyCfg.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -56,30 +52,30 @@ /* * BB and RF register read/write * */ -u32 PHY_QueryBBReg8192E(IN PADAPTER Adapter, - IN u32 RegAddr, - IN u32 BitMask); -void PHY_SetBBReg8192E(IN PADAPTER Adapter, - IN u32 RegAddr, - IN u32 BitMask, - IN u32 Data); -u32 PHY_QueryRFReg8192E(IN PADAPTER Adapter, - IN u8 eRFPath, - IN u32 RegAddr, - IN u32 BitMask); -void PHY_SetRFReg8192E(IN PADAPTER Adapter, - IN u8 eRFPath, - IN u32 RegAddr, - IN u32 BitMask, - IN u32 Data); +u32 PHY_QueryBBReg8192E(PADAPTER Adapter, + u32 RegAddr, + u32 BitMask); +void PHY_SetBBReg8192E(PADAPTER Adapter, + u32 RegAddr, + u32 BitMask, + u32 Data); +u32 PHY_QueryRFReg8192E(PADAPTER Adapter, + enum rf_path eRFPath, + u32 RegAddr, + u32 BitMask); +void PHY_SetRFReg8192E(PADAPTER Adapter, + enum rf_path eRFPath, + u32 RegAddr, + u32 BitMask, + u32 Data); /* * Initialization related function * * MAC/BB/RF HAL config */ -int PHY_MACConfig8192E(IN PADAPTER Adapter); -int PHY_BBConfig8192E(IN PADAPTER Adapter); -int PHY_RFConfig8192E(IN PADAPTER Adapter); +int PHY_MACConfig8192E(PADAPTER Adapter); +int PHY_BBConfig8192E(PADAPTER Adapter); +int PHY_RFConfig8192E(PADAPTER Adapter); /* RF config */ @@ -87,66 +83,64 @@ int PHY_RFConfig8192E(IN PADAPTER Adapter); /* * BB TX Power R/W * */ -void PHY_GetTxPowerLevel8192E(IN PADAPTER Adapter, OUT s32 *powerlevel); -void PHY_SetTxPowerLevel8192E(IN PADAPTER Adapter, IN u8 channel); -BOOLEAN PHY_UpdateTxPowerDbm8192E(IN PADAPTER Adapter, IN int powerInDbm); +void PHY_SetTxPowerLevel8192E(PADAPTER Adapter, u8 channel); -VOID +void PHY_SetTxPowerIndex_8192E( - IN PADAPTER Adapter, - IN u32 PowerIndex, - IN u8 RFPath, - IN u8 Rate + PADAPTER Adapter, + u32 PowerIndex, + enum rf_path RFPath, + u8 Rate ); u8 PHY_GetTxPowerIndex_8192E( - IN PADAPTER pAdapter, - IN u8 RFPath, - IN u8 Rate, - IN u8 BandWidth, - IN u8 Channel, + PADAPTER pAdapter, + enum rf_path RFPath, + u8 Rate, + u8 BandWidth, + u8 Channel, struct txpwr_idx_comp *tic ); /* * channel switch related funciton * */ -VOID +void PHY_SetSwChnlBWMode8192E( - IN PADAPTER Adapter, - IN u8 channel, - IN CHANNEL_WIDTH Bandwidth, - IN u8 Offset40, - IN u8 Offset80 + PADAPTER Adapter, + u8 channel, + enum channel_width Bandwidth, + u8 Offset40, + u8 Offset80 ); -VOID +void PHY_SetRFEReg_8192E( - IN PADAPTER Adapter + PADAPTER Adapter ); void phy_SpurCalibration_8192E( - IN PADAPTER Adapter, - IN enum spur_cal_method method + PADAPTER Adapter, + enum spur_cal_method method ); -void PHY_SpurCalibration_8192E(IN PADAPTER Adapter); +void PHY_SpurCalibration_8192E( PADAPTER Adapter); #ifdef CONFIG_SPUR_CAL_NBI void phy_SpurCalibration_8192E_NBI( - IN PADAPTER Adapter + PADAPTER Adapter ); #endif /* * BB/MAC/RF other monitor API * */ -VOID +void phy_set_rf_path_switch_8192e( - IN PADAPTER pAdapter, - IN bool bMain + struct dm_struct *phydm, + bool bMain ); /*--------------------------Exported Function prototype---------------------*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8192EPhyReg.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8192EPhyReg.h index b69ccd01c901..4cd2c35540ae 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8192EPhyReg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8192EPhyReg.h @@ -1,4 +1,18 @@ /* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * 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/rtl8188eu/include/Hal8192EPwrSeq.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8192EPwrSeq.h index 9332505c84c0..c56e0ec00b12 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8192EPwrSeq.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8192EPwrSeq.h @@ -1,4 +1,18 @@ /* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * 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/rtl8188eu/include/Hal8192FPhyCfg.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8192FPhyCfg.h new file mode 100644 index 000000000000..954c582b9dc0 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8192FPhyCfg.h @@ -0,0 +1,126 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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_HAL8192FPHYCFG_H__ +#define __INC_HAL8192FPHYCFG_H__ + +/*--------------------------Define Parameters-------------------------------*/ +#define LOOP_LIMIT 5 +#define MAX_STALL_TIME 50 /* us */ +#define AntennaDiversityValue 0x80 /* (Adapter->bSoftwareAntennaDiversity ? 0x00 : 0x80) */ +#define MAX_TXPWR_IDX_NMODE_92S 63 +#define Reset_Cnt_Limit 3 + +#ifdef CONFIG_PCI_HCI + #define MAX_AGGR_NUM 0x0B +#else + #define MAX_AGGR_NUM 0x07 +#endif /* CONFIG_PCI_HCI */ + + +/*--------------------------Define Parameters End-------------------------------*/ + + +/*------------------------------Define structure----------------------------*/ + +/*------------------------------Define structure End----------------------------*/ + +/*--------------------------Exported Function prototype---------------------*/ +u32 +PHY_QueryBBReg_8192F( + PADAPTER Adapter, + u32 RegAddr, + u32 BitMask +); + +void +PHY_SetBBReg_8192F( + PADAPTER Adapter, + u32 RegAddr, + u32 BitMask, + u32 Data +); + +u32 +PHY_QueryRFReg_8192F( + PADAPTER Adapter, + enum rf_path eRFPath, + u32 RegAddr, + u32 BitMask +); + +void +PHY_SetRFReg_8192F( + PADAPTER Adapter, + enum rf_path eRFPath, + u32 RegAddr, + u32 BitMask, + u32 Data +); + +/* MAC/BB/RF HAL config */ +int PHY_BBConfig8192F(PADAPTER Adapter ); + +int PHY_RFConfig8192F(PADAPTER Adapter); + +s32 PHY_MACConfig8192F(PADAPTER padapter); + +int +PHY_ConfigRFWithParaFile_8192F( + PADAPTER Adapter, + u8 *pFileName, + enum rf_path eRFPath +); + +void +PHY_SetTxPowerIndex_8192F( + PADAPTER Adapter, + u32 PowerIndex, + enum rf_path RFPath, + u8 Rate +); + +u8 +PHY_GetTxPowerIndex_8192F( + PADAPTER pAdapter, + enum rf_path RFPath, + u8 Rate, + u8 BandWidth, + u8 Channel, + struct txpwr_idx_comp *tic +); + +void +PHY_SetTxPowerLevel8192F( + PADAPTER Adapter, + u8 channel +); + +void +PHY_SetSwChnlBWMode8192F( + PADAPTER Adapter, + u8 channel, + enum channel_width Bandwidth, + u8 Offset40, + u8 Offset80 +); + +void phy_set_rf_path_switch_8192f( + PADAPTER pAdapter, + bool bMain +); +/*--------------------------Exported Function prototype End---------------------*/ + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8192FPhyReg.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8192FPhyReg.h new file mode 100644 index 000000000000..952358a4b0e3 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8192FPhyReg.h @@ -0,0 +1,1135 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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_HAL8192FPHYREG_H__ +#define __INC_HAL8192FPHYREG_H__ + +#define rSYM_WLBT_PAPE_SEL 0x64 +/* + * BB-PHY register PMAC 0x100 PHY 0x800 - 0xEFF + * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF + * 2. 0x800/0x900/0xA00/0xC00/0xD00/0xE00 + * 3. RF register 0x00-2E + * 4. Bit Mask for BB/RF register + * 5. Other definition for BB/RF R/W + * */ + + +/* + * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF + * 1. Page1(0x100) + * */ +#define rPMAC_Reset 0x100 +#define rPMAC_TxStart 0x104 +#define rPMAC_TxLegacySIG 0x108 +#define rPMAC_TxHTSIG1 0x10c +#define rPMAC_TxHTSIG2 0x110 +#define rPMAC_PHYDebug 0x114 +#define rPMAC_TxPacketNum 0x118 +#define rPMAC_TxIdle 0x11c +#define rPMAC_TxMACHeader0 0x120 +#define rPMAC_TxMACHeader1 0x124 +#define rPMAC_TxMACHeader2 0x128 +#define rPMAC_TxMACHeader3 0x12c +#define rPMAC_TxMACHeader4 0x130 +#define rPMAC_TxMACHeader5 0x134 +#define rPMAC_TxDataType 0x138 +#define rPMAC_TxRandomSeed 0x13c +#define rPMAC_CCKPLCPPreamble 0x140 +#define rPMAC_CCKPLCPHeader 0x144 +#define rPMAC_CCKCRC16 0x148 +#define rPMAC_OFDMRxCRC32OK 0x170 +#define rPMAC_OFDMRxCRC32Er 0x174 +#define rPMAC_OFDMRxParityEr 0x178 +#define rPMAC_OFDMRxCRC8Er 0x17c +#define rPMAC_CCKCRxRC16Er 0x180 +#define rPMAC_CCKCRxRC32Er 0x184 +#define rPMAC_CCKCRxRC32OK 0x188 +#define rPMAC_TxStatus 0x18c + +/* + * 2. Page2(0x200) + * + * The following two definition are only used for USB interface. */ +#define RF_BB_CMD_ADDR 0x02c0 /* RF/BB read/write command address. */ +#define RF_BB_CMD_DATA 0x02c4 /* RF/BB read/write command data. */ + +/* + * 3. Page8(0x800) + * */ +#define rFPGA0_RFMOD 0x800 /* RF mode & CCK TxSC // RF BW Setting?? */ + +#define rFPGA0_TxInfo 0x804 /* Status report?? */ +#define rFPGA0_PSDFunction 0x808 + +#define rFPGA0_TxGainStage 0x80c /* Set TX PWR init gain? */ + +#define rFPGA0_RFTiming1 0x810 /* Useless now */ +#define rFPGA0_RFTiming2 0x814 + +#define rFPGA0_XA_HSSIParameter1 0x820 /* RF 3 wire register */ +#define rFPGA0_XA_HSSIParameter2 0x824 +#define rFPGA0_XB_HSSIParameter1 0x828 +#define rFPGA0_XB_HSSIParameter2 0x82c +#define rTxAGC_B_Rate18_06 0x830 +#define rTxAGC_B_Rate54_24 0x834 +#define rTxAGC_B_CCK1_55_Mcs32 0x838 +#define rTxAGC_B_Mcs03_Mcs00 0x83c + +#define rTxAGC_B_Mcs07_Mcs04 0x848 +#define rTxAGC_B_Mcs11_Mcs08 0x84c + +#define rFPGA0_XA_LSSIParameter 0x840 +#define rFPGA0_XB_LSSIParameter 0x844 + +#define rFPGA0_RFWakeUpParameter 0x850 /* Useless now */ +#define rFPGA0_RFSleepUpParameter 0x854 + +#define rFPGA0_XAB_SwitchControl 0x858 /* RF Channel switch */ +#define rFPGA0_XCD_SwitchControl 0x85c + +#define rFPGA0_XA_RFInterfaceOE 0x860 /* RF Channel switch */ +#define rFPGA0_XB_RFInterfaceOE 0x864 + +#define rTxAGC_B_Mcs15_Mcs12 0x868 +#define rTxAGC_B_CCK11_A_CCK2_11 0x86c + +#define rFPGA0_XAB_RFInterfaceSW 0x870 /* RF Interface Software Control */ +#define rFPGA0_XCD_RFInterfaceSW 0x874 + +#define rFPGA0_XAB_RFParameter 0x878 /* RF Parameter */ +#define rFPGA0_XCD_RFParameter 0x87c + +#define rFPGA0_AnalogParameter1 0x880 /* Crystal cap setting RF-R/W protection for parameter4?? */ +#define rFPGA0_AnalogParameter2 0x884 +#define rFPGA0_AnalogParameter3 0x888 /* Useless now */ +#define rFPGA0_AnalogParameter4 0x88c + +#define rFPGA0_XA_LSSIReadBack 0x8a0 /* Tranceiver LSSI Readback */ +#define rFPGA0_XB_LSSIReadBack 0x8a4 +#define rFPGA0_XC_LSSIReadBack 0x8a8 +#define rFPGA0_XD_LSSIReadBack 0x8ac + +#define rFPGA0_PSDReport 0x8b4 /* Useless now */ +#define TransceiverA_HSPI_Readback 0x8b8 /* Transceiver A HSPI Readback */ +#define TransceiverB_HSPI_Readback 0x8bc /* Transceiver B HSPI Readback */ +#define rFPGA0_XAB_RFInterfaceRB 0x8e0 /* Useless now // RF Interface Readback Value */ +#define rFPGA0_XCD_RFInterfaceRB 0x8e4 /* Useless now */ + +/* + * 4. Page9(0x900) + * */ +#define rFPGA1_RFMOD 0x900 /* RF mode & OFDM TxSC // RF BW Setting?? */ +#define rFPGA1_TxBlock 0x904 /* Useless now */ +#define rFPGA1_DebugSelect 0x908 /* Useless now */ +#define rFPGA1_TxInfo 0x90c /* Useless now // Status report?? */ +#define rDPDT_control 0x92c +#define rfe_ctrl_anta_src 0x930 +#define rS0S1_PathSwitch 0x948 +#define rBBrx_DFIR 0x954 + +/* + * 5. PageA(0xA00) + * + * Set Control channel to upper or lower. These settings are required only for 40MHz */ +#define rCCK0_System 0xa00 + +#define rCCK0_AFESetting 0xa04 /* Disable init gain now // Select RX path by RSSI */ +#define rCCK0_CCA 0xa08 /* Disable init gain now // Init gain */ + +#define rCCK0_RxAGC1 0xa0c /* AGC default value, saturation level // Antenna Diversity, RX AGC, LNA Threshold, RX LNA Threshold useless now. Not the same as 90 series */ +#define rCCK0_RxAGC2 0xa10 /* AGC & DAGC */ + +#define rCCK0_RxHP 0xa14 + +#define rCCK0_DSPParameter1 0xa18 /* Timing recovery & Channel estimation threshold */ +#define rCCK0_DSPParameter2 0xa1c /* SQ threshold */ + +#define rCCK0_TxFilter1 0xa20 +#define rCCK0_TxFilter2 0xa24 +#define rCCK0_DebugPort 0xa28 /* debug port and Tx filter3 */ +#define rCCK0_FalseAlarmReport 0xa2c /* 0xa2d useless now 0xa30-a4f channel report */ +#define rCCK0_TRSSIReport 0xa50 +#define rCCK0_RxReport 0xa54 /* 0xa57 */ +#define rCCK0_FACounterLower 0xa5c /* 0xa5b */ +#define rCCK0_FACounterUpper 0xa58 /* 0xa5c */ + +/* + * PageB(0xB00) + * */ +#define rPdp_AntA 0xb00 +#define rPdp_AntA_4 0xb04 +#define rPdp_AntA_8 0xb08 +#define rPdp_AntA_C 0xb0c +#define rPdp_AntA_10 0xb10 +#define rPdp_AntA_14 0xb14 +#define rPdp_AntA_18 0xb18 +#define rPdp_AntA_1C 0xb1c +#define rPdp_AntA_20 0xb20 +#define rPdp_AntA_24 0xb24 + +#define rConfig_Pmpd_AntA 0xb28 +#define rConfig_ram64x16 0xb2c + +#define rBndA 0xb30 +#define rHssiPar 0xb34 + +#define rConfig_AntA 0xb68 +#define rConfig_AntB 0xb6c + +#define rPdp_AntB 0xb70 +#define rPdp_AntB_4 0xb74 +#define rPdp_AntB_8 0xb78 +#define rPdp_AntB_C 0xb7c +#define rPdp_AntB_10 0xb80 +#define rPdp_AntB_14 0xb84 +#define rPdp_AntB_18 0xb88 +#define rPdp_AntB_1C 0xb8c +#define rPdp_AntB_20 0xb90 +#define rPdp_AntB_24 0xb94 + +#define rConfig_Pmpd_AntB 0xb98 + +#define rBndB 0xba0 + +#define rAPK 0xbd8 +#define rPm_Rx0_AntA 0xbdc +#define rPm_Rx1_AntA 0xbe0 +#define rPm_Rx2_AntA 0xbe4 +#define rPm_Rx3_AntA 0xbe8 +#define rPm_Rx0_AntB 0xbec +#define rPm_Rx1_AntB 0xbf0 +#define rPm_Rx2_AntB 0xbf4 +#define rPm_Rx3_AntB 0xbf8 +/* + * 6. PageC(0xC00) + * */ +#define rOFDM0_LSTF 0xc00 + +#define rOFDM0_TRxPathEnable 0xc04 +#define rOFDM0_TRMuxPar 0xc08 +#define rOFDM0_TRSWIsolation 0xc0c + +#define rOFDM0_XARxAFE 0xc10 /* RxIQ DC offset, Rx digital filter, DC notch filter */ +#define rOFDM0_XARxIQImbalance 0xc14 /* RxIQ imbalance matrix */ +#define rOFDM0_XBRxAFE 0xc18 +#define rOFDM0_XBRxIQImbalance 0xc1c +#define rOFDM0_XCRxAFE 0xc20 +#define rOFDM0_XCRxIQImbalance 0xc24 +#define rOFDM0_XDRxAFE 0xc28 +#define rOFDM0_XDRxIQImbalance 0xc2c + +#define rOFDM0_RxDetector1 0xc30 /* PD, BW & SBD // DM tune init gain */ +#define rOFDM0_RxDetector2 0xc34 /* SBD & Fame Sync. */ +#define rOFDM0_RxDetector3 0xc38 /* Frame Sync. */ +#define rOFDM0_RxDetector4 0xc3c /* PD, SBD, Frame Sync & Short-GI */ + +#define rOFDM0_RxDSP 0xc40 /* Rx Sync Path */ +#define rOFDM0_CFOandDAGC 0xc44 /* CFO & DAGC */ +#define rOFDM0_CCADropThreshold 0xc48 /* CCA Drop threshold */ +#define rOFDM0_ECCAThreshold 0xc4c /* energy CCA */ + +#define rOFDM0_XAAGCCore1 0xc50 /* DIG */ +#define rOFDM0_XAAGCCore2 0xc54 +#define rOFDM0_XBAGCCore1 0xc58 +#define rOFDM0_XBAGCCore2 0xc5c +#define rOFDM0_XCAGCCore1 0xc60 +#define rOFDM0_XCAGCCore2 0xc64 +#define rOFDM0_XDAGCCore1 0xc68 +#define rOFDM0_XDAGCCore2 0xc6c + +#define rOFDM0_AGCParameter1 0xc70 +#define rOFDM0_AGCParameter2 0xc74 +#define rOFDM0_AGCRSSITable 0xc78 +#define rOFDM0_HTSTFAGC 0xc7c + +#define rOFDM0_XATxIQImbalance 0xc80 /* TX PWR TRACK and DIG */ +#define rOFDM0_XATxAFE 0xc84 +#define rOFDM0_XBTxIQImbalance 0xc88 +#define rOFDM0_XBTxAFE 0xc8c +#define rOFDM0_XCTxIQImbalance 0xc90 +#define rOFDM0_XCTxAFE 0xc94 +#define rOFDM0_XDTxIQImbalance 0xc98 +#define rOFDM0_XDTxAFE 0xc9c + +#define rOFDM0_RxIQExtAnta 0xca0 +#define rOFDM0_TxCoeff1 0xca4 +#define rOFDM0_TxCoeff2 0xca8 +#define rOFDM0_TxCoeff3 0xcac +#define rOFDM0_TxCoeff4 0xcb0 +#define rOFDM0_TxCoeff5 0xcb4 +#define rOFDM0_TxCoeff6 0xcb8 +#define rOFDM0_RxHPParameter 0xce0 +#define rOFDM0_TxPseudoNoiseWgt 0xce4 +#define rOFDM0_FrameSync 0xcf0 +#define rOFDM0_DFSReport 0xcf4 + +/* + * 7. PageD(0xD00) + * */ +#define rOFDM1_LSTF 0xd00 +#define rOFDM1_TRxPathEnable 0xd04 + +#define rOFDM1_CFO 0xd08 /* No setting now */ +#define rOFDM1_CSI1 0xd10 +#define rOFDM1_SBD 0xd14 +#define rOFDM1_CSI2 0xd18 +#define rOFDM1_CFOTracking 0xd2c +#define rOFDM1_TRxMesaure1 0xd34 +#define rOFDM1_IntfDet 0xd3c +#define rOFDM1_PseudoNoiseStateAB 0xd50 +#define rOFDM1_PseudoNoiseStateCD 0xd54 +#define rOFDM1_RxPseudoNoiseWgt 0xd58 + +#define rOFDM_PHYCounter1 0xda0 /* cca, parity fail */ +#define rOFDM_PHYCounter2 0xda4 /* rate illegal, crc8 fail */ +#define rOFDM_PHYCounter3 0xda8 /* MCS not support */ + +#define rOFDM_ShortCFOAB 0xdac /* No setting now */ +#define rOFDM_ShortCFOCD 0xdb0 +#define rOFDM_LongCFOAB 0xdb4 +#define rOFDM_LongCFOCD 0xdb8 +#define rOFDM_TailCFOAB 0xdbc +#define rOFDM_TailCFOCD 0xdc0 +#define rOFDM_PWMeasure1 0xdc4 +#define rOFDM_PWMeasure2 0xdc8 +#define rOFDM_BWReport 0xdcc +#define rOFDM_AGCReport 0xdd0 +#define rOFDM_RxSNR 0xdd4 +#define rOFDM_RxEVMCSI 0xdd8 +#define rOFDM_SIGReport 0xddc + + +/* + * 8. PageE(0xE00) + * */ +#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 rFPGA0_IQK 0xe28 +#define rTx_IQK_Tone_A 0xe30 +#define rRx_IQK_Tone_A 0xe34 +#define rTx_IQK_PI_A 0xe38 +#define rRx_IQK_PI_A 0xe3c + +#define rTx_IQK 0xe40 +#define rRx_IQK 0xe44 +#define rIQK_AGC_Pts 0xe48 +#define rIQK_AGC_Rsp 0xe4c +#define rTx_IQK_Tone_B 0xe50 +#define rRx_IQK_Tone_B 0xe54 +#define rTx_IQK_PI_B 0xe58 +#define rRx_IQK_PI_B 0xe5c +#define rIQK_AGC_Cont 0xe60 + +#define rBlue_Tooth 0xe6c +#define rRx_Wait_CCA 0xe70 +#define rTx_CCK_RFON 0xe74 +#define rTx_CCK_BBON 0xe78 +#define rTx_OFDM_RFON 0xe7c +#define rTx_OFDM_BBON 0xe80 +#define rTx_To_Rx 0xe84 +#define rTx_To_Tx 0xe88 +#define rRx_CCK 0xe8c + +#define rTx_Power_Before_IQK_A 0xe94 +#define rTx_Power_After_IQK_A 0xe9c + +#define rRx_Power_Before_IQK_A 0xea0 +#define rRx_Power_Before_IQK_A_2 0xea4 +#define rRx_Power_After_IQK_A 0xea8 +#define rRx_Power_After_IQK_A_2 0xeac + +#define rTx_Power_Before_IQK_B 0xeb4 +#define rTx_Power_After_IQK_B 0xebc + +#define rRx_Power_Before_IQK_B 0xec0 +#define rRx_Power_Before_IQK_B_2 0xec4 +#define rRx_Power_After_IQK_B 0xec8 +#define rRx_Power_After_IQK_B_2 0xecc + +#define rRx_OFDM 0xed0 +#define rRx_Wait_RIFS 0xed4 +#define rRx_TO_Rx 0xed8 +#define rStandby 0xedc +#define rSleep 0xee0 +#define rPMPD_ANAEN 0xeec + +/* + * 7. RF Register 0x00-0x2E (RF 8256) + * RF-0222D 0x00-3F + * + * Zebra1 */ +#define rZebra1_HSSIEnable 0x0 /* Useless now */ +#define rZebra1_TRxEnable1 0x1 +#define rZebra1_TRxEnable2 0x2 +#define rZebra1_AGC 0x4 +#define rZebra1_ChargePump 0x5 +#define rZebra1_Channel 0x7 /* RF channel switch */ + +/* #endif */ +#define rZebra1_TxGain 0x8 /* Useless now */ +#define rZebra1_TxLPF 0x9 +#define rZebra1_RxLPF 0xb +#define rZebra1_RxHPFCorner 0xc + +/* Zebra4 */ +#define rGlobalCtrl 0 /* Useless now */ +#define rRTL8256_TxLPF 19 +#define rRTL8256_RxLPF 11 + +/* RTL8258 */ +#define rRTL8258_TxLPF 0x11 /* Useless now */ +#define rRTL8258_RxLPF 0x13 +#define rRTL8258_RSSILPF 0xa + +/* + * RL6052 Register definition + * */ +#define RF_AC 0x00 /* */ + +#define RF_IQADJ_G1 0x01 /* */ +#define RF_IQADJ_G2 0x02 /* */ +#define RF_BS_PA_APSET_G1_G4 0x03 +#define RF_BS_PA_APSET_G5_G8 0x04 +#define RF_POW_TRSW 0x05 /* */ + +#define RF_GAIN_RX 0x06 /* */ +#define RF_GAIN_TX 0x07 /* */ + +#define RF_TXM_IDAC 0x08 /* */ +#define RF_IPA_G 0x09 /* */ +#define RF_TXBIAS_G 0x0A +#define RF_TXPA_AG 0x0B +#define RF_IPA_A 0x0C /* */ +#define RF_TXBIAS_A 0x0D +#define RF_BS_PA_APSET_G9_G11 0x0E +#define RF_BS_IQGEN 0x0F /* */ + +#define RF_MODE1 0x10 /* */ +#define RF_MODE2 0x11 /* */ + +#define RF_RX_AGC_HP 0x12 /* */ +#define RF_TX_AGC 0x13 /* */ +#define RF_BIAS 0x14 /* */ +#define RF_IPA 0x15 /* */ +#define RF_TXBIAS 0x16 +#define RF_POW_ABILITY 0x17 /* */ +#define RF_MODE_AG 0x18 /* */ +#define rRfChannel 0x18 /* RF channel and BW switch */ +#define RF_CHNLBW 0x18 /* RF channel and BW switch */ +#define RF_TOP 0x19 /* */ + +#define RF_RX_G1 0x1A /* */ +#define RF_RX_G2 0x1B /* */ + +#define RF_RX_BB2 0x1C /* */ +#define RF_RX_BB1 0x1D /* */ + +#define RF_RCK1 0x1E /* */ +#define RF_RCK2 0x1F /* */ + +#define RF_TX_G1 0x20 /* */ +#define RF_TX_G2 0x21 /* */ +#define RF_TX_G3 0x22 /* */ + +#define RF_TX_BB1 0x23 /* */ + +#define RF_T_METER 0x24 /* */ + +#define RF_SYN_G1 0x25 /* RF TX Power control */ +#define RF_SYN_G2 0x26 /* RF TX Power control */ +#define RF_SYN_G3 0x27 /* RF TX Power control */ +#define RF_SYN_G4 0x28 /* RF TX Power control */ +#define RF_SYN_G5 0x29 /* RF TX Power control */ +#define RF_SYN_G6 0x2A /* RF TX Power control */ +#define RF_SYN_G7 0x2B /* RF TX Power control */ +#define RF_SYN_G8 0x2C /* RF TX Power control */ + +#define RF_RCK_OS 0x30 /* RF TX PA control */ + +#define RF_TXPA_G1 0x31 /* RF TX PA control */ +#define RF_TXPA_G2 0x32 /* RF TX PA control */ +#define RF_TXPA_G3 0x33 /* RF TX PA control */ +#define RF_TX_BIAS_A 0x35 +#define RF_TX_BIAS_D 0x36 +#define RF_LOBF_9 0x38 +#define RF_RXRF_A3 0x3C /* */ +#define RF_TRSW 0x3F + +#define RF_TXRF_A2 0x41 +#define RF_T_METER_88E 0x42 +#define RF_TXPA_G4 0x46 +#define RF_TXPA_A4 0x4B +#define RF_0x52 0x52 +#define RF_WE_LUT 0xEF +#define RF_S0S1 0xB0 + +/* + * Bit Mask + * + * 1. Page1(0x100) */ +#define bBBResetB 0x100 /* Useless now? */ +#define bGlobalResetB 0x200 +#define bOFDMTxStart 0x4 +#define bCCKTxStart 0x8 +#define bCRC32Debug 0x100 +#define bPMACLoopback 0x10 +#define bTxLSIG 0xffffff +#define bOFDMTxRate 0xf +#define bOFDMTxReserved 0x10 +#define bOFDMTxLength 0x1ffe0 +#define bOFDMTxParity 0x20000 +#define bTxHTSIG1 0xffffff +#define bTxHTMCSRate 0x7f +#define bTxHTBW 0x80 +#define bTxHTLength 0xffff00 +#define bTxHTSIG2 0xffffff +#define bTxHTSmoothing 0x1 +#define bTxHTSounding 0x2 +#define bTxHTReserved 0x4 +#define bTxHTAggreation 0x8 +#define bTxHTSTBC 0x30 +#define bTxHTAdvanceCoding 0x40 +#define bTxHTShortGI 0x80 +#define bTxHTNumberHT_LTF 0x300 +#define bTxHTCRC8 0x3fc00 +#define bCounterReset 0x10000 +#define bNumOfOFDMTx 0xffff +#define bNumOfCCKTx 0xffff0000 +#define bTxIdleInterval 0xffff +#define bOFDMService 0xffff0000 +#define bTxMACHeader 0xffffffff +#define bTxDataInit 0xff +#define bTxHTMode 0x100 +#define bTxDataType 0x30000 +#define bTxRandomSeed 0xffffffff +#define bCCKTxPreamble 0x1 +#define bCCKTxSFD 0xffff0000 +#define bCCKTxSIG 0xff +#define bCCKTxService 0xff00 +#define bCCKLengthExt 0x8000 +#define bCCKTxLength 0xffff0000 +#define bCCKTxCRC16 0xffff +#define bCCKTxStatus 0x1 +#define bOFDMTxStatus 0x2 + +#define IS_BB_REG_OFFSET_92S(_Offset) ((_Offset >= 0x800) && (_Offset <= 0xfff)) +#define RF_TX_GAIN_OFFSET_8192F(_val) (abs((_val)) | (((_val) > 0) ? BIT(4) : 0)) + +/* 2. Page8(0x800) */ +#define bRFMOD 0x1 /* Reg 0x800 rFPGA0_RFMOD */ +#define bJapanMode 0x2 +#define bCCKTxSC 0x30 +#define bCCKEn 0x1000000 +#define bOFDMEn 0x2000000 + +#define bOFDMRxADCPhase 0x10000 /* Useless now */ +#define bOFDMTxDACPhase 0x40000 +#define bXATxAGC 0x3f + +#define bAntennaSelect 0x0300 + +#define bXBTxAGC 0xf00 /* Reg 80c rFPGA0_TxGainStage */ +#define bXCTxAGC 0xf000 +#define bXDTxAGC 0xf0000 + +#define bPAStart 0xf0000000 /* Useless now */ +#define bTRStart 0x00f00000 +#define bRFStart 0x0000f000 +#define bBBStart 0x000000f0 +#define bBBCCKStart 0x0000000f +#define bPAEnd 0xf /* Reg0x814 */ +#define bTREnd 0x0f000000 +#define bRFEnd 0x000f0000 +#define bCCAMask 0x000000f0 /* T2R */ +#define bR2RCCAMask 0x00000f00 +#define bHSSI_R2TDelay 0xf8000000 +#define bHSSI_T2RDelay 0xf80000 +#define bContTxHSSI 0x400 /* chane gain at continue Tx */ +#define bIGFromCCK 0x200 +#define bAGCAddress 0x3f +#define bRxHPTx 0x7000 +#define bRxHPT2R 0x38000 +#define bRxHPCCKIni 0xc0000 +#define bAGCTxCode 0xc00000 +#define bAGCRxCode 0x300000 + +#define b3WireDataLength 0x800 /* Reg 0x820~84f rFPGA0_XA_HSSIParameter1 */ +#define b3WireAddressLength 0x400 + +#define b3WireRFPowerDown 0x1 /* Useless now + * #define bHWSISelect 0x8 */ +#define b5GPAPEPolarity 0x40000000 +#define b2GPAPEPolarity 0x80000000 +#define bRFSW_TxDefaultAnt 0x3 +#define bRFSW_TxOptionAnt 0x30 +#define bRFSW_RxDefaultAnt 0x300 +#define bRFSW_RxOptionAnt 0x3000 +#define bRFSI_3WireData 0x1 +#define bRFSI_3WireClock 0x2 +#define bRFSI_3WireLoad 0x4 +#define bRFSI_3WireRW 0x8 +#define bRFSI_3Wire 0xf + +#define bRFSI_RFENV 0x10 /* Reg 0x870 rFPGA0_XAB_RFInterfaceSW */ + +#define bRFSI_TRSW 0x20 /* Useless now */ +#define bRFSI_TRSWB 0x40 +#define bRFSI_ANTSW 0x100 +#define bRFSI_ANTSWB 0x200 +#define bRFSI_PAPE 0x400 +#define bRFSI_PAPE5G 0x800 +#define bBandSelect 0x1 +#define bHTSIG2_GI 0x80 +#define bHTSIG2_Smoothing 0x01 +#define bHTSIG2_Sounding 0x02 +#define bHTSIG2_Aggreaton 0x08 +#define bHTSIG2_STBC 0x30 +#define bHTSIG2_AdvCoding 0x40 +#define bHTSIG2_NumOfHTLTF 0x300 +#define bHTSIG2_CRC8 0x3fc +#define bHTSIG1_MCS 0x7f +#define bHTSIG1_BandWidth 0x80 +#define bHTSIG1_HTLength 0xffff +#define bLSIG_Rate 0xf +#define bLSIG_Reserved 0x10 +#define bLSIG_Length 0x1fffe +#define bLSIG_Parity 0x20 +#define bCCKRxPhase 0x4 + +#define bLSSIReadAddress 0x7f800000 /* T65 RF */ + +#define bLSSIReadEdge 0x80000000 /* LSSI "Read" edge signal */ + +#define bLSSIReadBackData 0xfffff /* T65 RF */ + +#define bLSSIReadOKFlag 0x1000 /* Useless now */ +#define bCCKSampleRate 0x8 /* 0: 44MHz, 1:88MHz */ +#define bRegulator0Standby 0x1 +#define bRegulatorPLLStandby 0x2 +#define bRegulator1Standby 0x4 +#define bPLLPowerUp 0x8 +#define bDPLLPowerUp 0x10 +#define bDA10PowerUp 0x20 +#define bAD7PowerUp 0x200 +#define bDA6PowerUp 0x2000 +#define bXtalPowerUp 0x4000 +#define b40MDClkPowerUP 0x8000 +#define bDA6DebugMode 0x20000 +#define bDA6Swing 0x380000 + +#define bADClkPhase 0x4000000 /* Reg 0x880 rFPGA0_AnalogParameter1 20/40 CCK support switch 40/80 BB MHZ */ + +#define b80MClkDelay 0x18000000 /* Useless */ +#define bAFEWatchDogEnable 0x20000000 + +#define bXtalCap01 0xc0000000 /* Reg 0x884 rFPGA0_AnalogParameter2 Crystal cap */ +#define bXtalCap23 0x3 +#define bXtalCap92x 0x0f000000 +#define bXtalCap 0x0f000000 + +#define bIntDifClkEnable 0x400 /* Useless */ +#define bExtSigClkEnable 0x800 +#define bBandgapMbiasPowerUp 0x10000 +#define bAD11SHGain 0xc0000 +#define bAD11InputRange 0x700000 +#define bAD11OPCurrent 0x3800000 +#define bIPathLoopback 0x4000000 +#define bQPathLoopback 0x8000000 +#define bAFELoopback 0x10000000 +#define bDA10Swing 0x7e0 +#define bDA10Reverse 0x800 +#define bDAClkSource 0x1000 +#define bAD7InputRange 0x6000 +#define bAD7Gain 0x38000 +#define bAD7OutputCMMode 0x40000 +#define bAD7InputCMMode 0x380000 +#define bAD7Current 0xc00000 +#define bRegulatorAdjust 0x7000000 +#define bAD11PowerUpAtTx 0x1 +#define bDA10PSAtTx 0x10 +#define bAD11PowerUpAtRx 0x100 +#define bDA10PSAtRx 0x1000 +#define bCCKRxAGCFormat 0x200 +#define bPSDFFTSamplepPoint 0xc000 +#define bPSDAverageNum 0x3000 +#define bIQPathControl 0xc00 +#define bPSDFreq 0x3ff +#define bPSDAntennaPath 0x30 +#define bPSDIQSwitch 0x40 +#define bPSDRxTrigger 0x400000 +#define bPSDTxTrigger 0x80000000 +#define bPSDSineToneScale 0x7f000000 +#define bPSDReport 0xffff + +/* 3. Page9(0x900) */ +#define bOFDMTxSC 0x30000000 /* Useless */ +#define bCCKTxOn 0x1 +#define bOFDMTxOn 0x2 +#define bDebugPage 0xfff /* reset debug page and also HWord, LWord */ +#define bDebugItem 0xff /* reset debug page and LWord */ +#define bAntL 0x10 +#define bAntNonHT 0x100 +#define bAntHT1 0x1000 +#define bAntHT2 0x10000 +#define bAntHT1S1 0x100000 +#define bAntNonHTS1 0x1000000 + +/* 4. PageA(0xA00) */ +#define bCCKBBMode 0x3 /* Useless */ +#define bCCKTxPowerSaving 0x80 +#define bCCKRxPowerSaving 0x40 + +#define bCCKSideBand 0x10 /* Reg 0xa00 rCCK0_System 20/40 switch */ + +#define bCCKScramble 0x8 /* Useless */ +#define bCCKAntDiversity 0x8000 +#define bCCKCarrierRecovery 0x4000 +#define bCCKTxRate 0x3000 +#define bCCKDCCancel 0x0800 +#define bCCKISICancel 0x0400 +#define bCCKMatchFilter 0x0200 +#define bCCKEqualizer 0x0100 +#define bCCKPreambleDetect 0x800000 +#define bCCKFastFalseCCA 0x400000 +#define bCCKChEstStart 0x300000 +#define bCCKCCACount 0x080000 +#define bCCKcs_lim 0x070000 +#define bCCKBistMode 0x80000000 +#define bCCKCCAMask 0x40000000 +#define bCCKTxDACPhase 0x4 +#define bCCKRxADCPhase 0x20000000 /* r_rx_clk */ +#define bCCKr_cp_mode0 0x0100 +#define bCCKTxDCOffset 0xf0 +#define bCCKRxDCOffset 0xf +#define bCCKCCAMode 0xc000 +#define bCCKFalseCS_lim 0x3f00 +#define bCCKCS_ratio 0xc00000 +#define bCCKCorgBit_sel 0x300000 +#define bCCKPD_lim 0x0f0000 +#define bCCKNewCCA 0x80000000 +#define bCCKRxHPofIG 0x8000 +#define bCCKRxIG 0x7f00 +#define bCCKLNAPolarity 0x800000 +#define bCCKRx1stGain 0x7f0000 +#define bCCKRFExtend 0x20000000 /* CCK Rx Iinital gain polarity */ +#define bCCKRxAGCSatLevel 0x1f000000 +#define bCCKRxAGCSatCount 0xe0 +#define bCCKRxRFSettle 0x1f /* AGCsamp_dly */ +#define bCCKFixedRxAGC 0x8000 +/* #define bCCKRxAGCFormat 0x4000 */ /* remove to HSSI register 0x824 */ +#define bCCKAntennaPolarity 0x2000 +#define bCCKTxFilterType 0x0c00 +#define bCCKRxAGCReportType 0x0300 +#define bCCKRxDAGCEn 0x80000000 +#define bCCKRxDAGCPeriod 0x20000000 +#define bCCKRxDAGCSatLevel 0x1f000000 +#define bCCKTimingRecovery 0x800000 +#define bCCKTxC0 0x3f0000 +#define bCCKTxC1 0x3f000000 +#define bCCKTxC2 0x3f +#define bCCKTxC3 0x3f00 +#define bCCKTxC4 0x3f0000 +#define bCCKTxC5 0x3f000000 +#define bCCKTxC6 0x3f +#define bCCKTxC7 0x3f00 +#define bCCKDebugPort 0xff0000 +#define bCCKDACDebug 0x0f000000 +#define bCCKFalseAlarmEnable 0x8000 +#define bCCKFalseAlarmRead 0x4000 +#define bCCKTRSSI 0x7f +#define bCCKRxAGCReport 0xfe +#define bCCKRxReport_AntSel 0x80000000 +#define bCCKRxReport_MFOff 0x40000000 +#define bCCKRxRxReport_SQLoss 0x20000000 +#define bCCKRxReport_Pktloss 0x10000000 +#define bCCKRxReport_Lockedbit 0x08000000 +#define bCCKRxReport_RateError 0x04000000 +#define bCCKRxReport_RxRate 0x03000000 +#define bCCKRxFACounterLower 0xff +#define bCCKRxFACounterUpper 0xff000000 +#define bCCKRxHPAGCStart 0xe000 +#define bCCKRxHPAGCFinal 0x1c00 +#define bCCKRxFalseAlarmEnable 0x8000 +#define bCCKFACounterFreeze 0x4000 +#define bCCKTxPathSel 0x10000000 +#define bCCKDefaultRxPath 0xc000000 +#define bCCKOptionRxPath 0x3000000 + +/* 5. PageC(0xC00) */ +#define bNumOfSTF 0x3 /* Useless */ +#define bShift_L 0xc0 +#define bGI_TH 0xc +#define bRxPathA 0x1 +#define bRxPathB 0x2 +#define bRxPathC 0x4 +#define bRxPathD 0x8 +#define bTxPathA 0x1 +#define bTxPathB 0x2 +#define bTxPathC 0x4 +#define bTxPathD 0x8 +#define bTRSSIFreq 0x200 +#define bADCBackoff 0x3000 +#define bDFIRBackoff 0xc000 +#define bTRSSILatchPhase 0x10000 +#define bRxIDCOffset 0xff +#define bRxQDCOffset 0xff00 +#define bRxDFIRMode 0x1800000 +#define bRxDCNFType 0xe000000 +#define bRXIQImb_A 0x3ff +#define bRXIQImb_B 0xfc00 +#define bRXIQImb_C 0x3f0000 +#define bRXIQImb_D 0xffc00000 +#define bDC_dc_Notch 0x60000 +#define bRxNBINotch 0x1f000000 +#define bPD_TH 0xf +#define bPD_TH_Opt2 0xc000 +#define bPWED_TH 0x700 +#define bIfMF_Win_L 0x800 +#define bPD_Option 0x1000 +#define bMF_Win_L 0xe000 +#define bBW_Search_L 0x30000 +#define bwin_enh_L 0xc0000 +#define bBW_TH 0x700000 +#define bED_TH2 0x3800000 +#define bBW_option 0x4000000 +#define bRatio_TH 0x18000000 +#define bWindow_L 0xe0000000 +#define bSBD_Option 0x1 +#define bFrame_TH 0x1c +#define bFS_Option 0x60 +#define bDC_Slope_check 0x80 +#define bFGuard_Counter_DC_L 0xe00 +#define bFrame_Weight_Short 0x7000 +#define bSub_Tune 0xe00000 +#define bFrame_DC_Length 0xe000000 +#define bSBD_start_offset 0x30000000 +#define bFrame_TH_2 0x7 +#define bFrame_GI2_TH 0x38 +#define bGI2_Sync_en 0x40 +#define bSarch_Short_Early 0x300 +#define bSarch_Short_Late 0xc00 +#define bSarch_GI2_Late 0x70000 +#define bCFOAntSum 0x1 +#define bCFOAcc 0x2 +#define bCFOStartOffset 0xc +#define bCFOLookBack 0x70 +#define bCFOSumWeight 0x80 +#define bDAGCEnable 0x10000 +#define bTXIQImb_A 0x3ff +#define bTXIQImb_B 0xfc00 +#define bTXIQImb_C 0x3f0000 +#define bTXIQImb_D 0xffc00000 +#define bTxIDCOffset 0xff +#define bTxQDCOffset 0xff00 +#define bTxDFIRMode 0x10000 +#define bTxPesudoNoiseOn 0x4000000 +#define bTxPesudoNoise_A 0xff +#define bTxPesudoNoise_B 0xff00 +#define bTxPesudoNoise_C 0xff0000 +#define bTxPesudoNoise_D 0xff000000 +#define bCCADropOption 0x20000 +#define bCCADropThres 0xfff00000 +#define bEDCCA_H 0xf +#define bEDCCA_L 0xf0 +#define bLambda_ED 0x300 +#define bRxInitialGain 0x7f +#define bRxAntDivEn 0x80 +#define bRxAGCAddressForLNA 0x7f00 +#define bRxHighPowerFlow 0x8000 +#define bRxAGCFreezeThres 0xc0000 +#define bRxFreezeStep_AGC1 0x300000 +#define bRxFreezeStep_AGC2 0xc00000 +#define bRxFreezeStep_AGC3 0x3000000 +#define bRxFreezeStep_AGC0 0xc000000 +#define bRxRssi_Cmp_En 0x10000000 +#define bRxQuickAGCEn 0x20000000 +#define bRxAGCFreezeThresMode 0x40000000 +#define bRxOverFlowCheckType 0x80000000 +#define bRxAGCShift 0x7f +#define bTRSW_Tri_Only 0x80 +#define bPowerThres 0x300 +#define bRxAGCEn 0x1 +#define bRxAGCTogetherEn 0x2 +#define bRxAGCMin 0x4 +#define bRxHP_Ini 0x7 +#define bRxHP_TRLNA 0x70 +#define bRxHP_RSSI 0x700 +#define bRxHP_BBP1 0x7000 +#define bRxHP_BBP2 0x70000 +#define bRxHP_BBP3 0x700000 +#define bRSSI_H 0x7f0000 /* the threshold for high power */ +#define bRSSI_Gen 0x7f000000 /* the threshold for ant diversity */ +#define bRxSettle_TRSW 0x7 +#define bRxSettle_LNA 0x38 +#define bRxSettle_RSSI 0x1c0 +#define bRxSettle_BBP 0xe00 +#define bRxSettle_RxHP 0x7000 +#define bRxSettle_AntSW_RSSI 0x38000 +#define bRxSettle_AntSW 0xc0000 +#define bRxProcessTime_DAGC 0x300000 +#define bRxSettle_HSSI 0x400000 +#define bRxProcessTime_BBPPW 0x800000 +#define bRxAntennaPowerShift 0x3000000 +#define bRSSITableSelect 0xc000000 +#define bRxHP_Final 0x7000000 +#define bRxHTSettle_BBP 0x7 +#define bRxHTSettle_HSSI 0x8 +#define bRxHTSettle_RxHP 0x70 +#define bRxHTSettle_BBPPW 0x80 +#define bRxHTSettle_Idle 0x300 +#define bRxHTSettle_Reserved 0x1c00 +#define bRxHTRxHPEn 0x8000 +#define bRxHTAGCFreezeThres 0x30000 +#define bRxHTAGCTogetherEn 0x40000 +#define bRxHTAGCMin 0x80000 +#define bRxHTAGCEn 0x100000 +#define bRxHTDAGCEn 0x200000 +#define bRxHTRxHP_BBP 0x1c00000 +#define bRxHTRxHP_Final 0xe0000000 +#define bRxPWRatioTH 0x3 +#define bRxPWRatioEn 0x4 +#define bRxMFHold 0x3800 +#define bRxPD_Delay_TH1 0x38 +#define bRxPD_Delay_TH2 0x1c0 +#define bRxPD_DC_COUNT_MAX 0x600 +/* #define bRxMF_Hold 0x3800 */ +#define bRxPD_Delay_TH 0x8000 +#define bRxProcess_Delay 0xf0000 +#define bRxSearchrange_GI2_Early 0x700000 +#define bRxFrame_Guard_Counter_L 0x3800000 +#define bRxSGI_Guard_L 0xc000000 +#define bRxSGI_Search_L 0x30000000 +#define bRxSGI_TH 0xc0000000 +#define bDFSCnt0 0xff +#define bDFSCnt1 0xff00 +#define bDFSFlag 0xf0000 +#define bMFWeightSum 0x300000 +#define bMinIdxTH 0x7f000000 +#define bDAFormat 0x40000 +#define bTxChEmuEnable 0x01000000 +#define bTRSWIsolation_A 0x7f +#define bTRSWIsolation_B 0x7f00 +#define bTRSWIsolation_C 0x7f0000 +#define bTRSWIsolation_D 0x7f000000 +#define bExtLNAGain 0x7c00 + +/* 6. PageE(0xE00) */ +#define bSTBCEn 0x4 /* Useless */ +#define bAntennaMapping 0x10 +#define bNss 0x20 +#define bCFOAntSumD 0x200 +#define bPHYCounterReset 0x8000000 +#define bCFOReportGet 0x4000000 +#define bOFDMContinueTx 0x10000000 +#define bOFDMSingleCarrier 0x20000000 +#define bOFDMSingleTone 0x40000000 +/* #define bRxPath1 0x01 */ +/* #define bRxPath2 0x02 */ +/* #define bRxPath3 0x04 */ +/* #define bRxPath4 0x08 */ +/* #define bTxPath1 0x10 */ +/* #define bTxPath2 0x20 */ +#define bHTDetect 0x100 +#define bCFOEn 0x10000 +#define bCFOValue 0xfff00000 +#define bSigTone_Re 0x3f +#define bSigTone_Im 0x7f00 +#define bCounter_CCA 0xffff +#define bCounter_ParityFail 0xffff0000 +#define bCounter_RateIllegal 0xffff +#define bCounter_CRC8Fail 0xffff0000 +#define bCounter_MCSNoSupport 0xffff +#define bCounter_FastSync 0xffff +#define bShortCFO 0xfff +#define bShortCFOTLength 12 /* total */ +#define bShortCFOFLength 11 /* fraction */ +#define bLongCFO 0x7ff +#define bLongCFOTLength 11 +#define bLongCFOFLength 11 +#define bTailCFO 0x1fff +#define bTailCFOTLength 13 +#define bTailCFOFLength 12 +#define bmax_en_pwdB 0xffff +#define bCC_power_dB 0xffff0000 +#define bnoise_pwdB 0xffff +#define bPowerMeasTLength 10 +#define bPowerMeasFLength 3 +#define bRx_HT_BW 0x1 +#define bRxSC 0x6 +#define bRx_HT 0x8 +#define bNB_intf_det_on 0x1 +#define bIntf_win_len_cfg 0x30 +#define bNB_Intf_TH_cfg 0x1c0 +#define bRFGain 0x3f +#define bTableSel 0x40 +#define bTRSW 0x80 +#define bRxSNR_A 0xff +#define bRxSNR_B 0xff00 +#define bRxSNR_C 0xff0000 +#define bRxSNR_D 0xff000000 +#define bSNREVMTLength 8 +#define bSNREVMFLength 1 +#define bCSI1st 0xff +#define bCSI2nd 0xff00 +#define bRxEVM1st 0xff0000 +#define bRxEVM2nd 0xff000000 +#define bSIGEVM 0xff +#define bPWDB 0xff00 +#define bSGIEN 0x10000 + +#define bSFactorQAM1 0xf /* Useless */ +#define bSFactorQAM2 0xf0 +#define bSFactorQAM3 0xf00 +#define bSFactorQAM4 0xf000 +#define bSFactorQAM5 0xf0000 +#define bSFactorQAM6 0xf0000 +#define bSFactorQAM7 0xf00000 +#define bSFactorQAM8 0xf000000 +#define bSFactorQAM9 0xf0000000 +#define bCSIScheme 0x100000 + +#define bNoiseLvlTopSet 0x3 /* Useless */ +#define bChSmooth 0x4 +#define bChSmoothCfg1 0x38 +#define bChSmoothCfg2 0x1c0 +#define bChSmoothCfg3 0xe00 +#define bChSmoothCfg4 0x7000 +#define bMRCMode 0x800000 +#define bTHEVMCfg 0x7000000 + +#define bLoopFitType 0x1 /* Useless */ +#define bUpdCFO 0x40 +#define bUpdCFOOffData 0x80 +#define bAdvUpdCFO 0x100 +#define bAdvTimeCtrl 0x800 +#define bUpdClko 0x1000 +#define bFC 0x6000 +#define bTrackingMode 0x8000 +#define bPhCmpEnable 0x10000 +#define bUpdClkoLTF 0x20000 +#define bComChCFO 0x40000 +#define bCSIEstiMode 0x80000 +#define bAdvUpdEqz 0x100000 +#define bUChCfg 0x7000000 +#define bUpdEqz 0x8000000 + +/* Rx Pseduo noise */ +#define bRxPesudoNoiseOn 0x20000000 /* Useless */ +#define bRxPesudoNoise_A 0xff +#define bRxPesudoNoise_B 0xff00 +#define bRxPesudoNoise_C 0xff0000 +#define bRxPesudoNoise_D 0xff000000 +#define bPesudoNoiseState_A 0xffff +#define bPesudoNoiseState_B 0xffff0000 +#define bPesudoNoiseState_C 0xffff +#define bPesudoNoiseState_D 0xffff0000 + +/* 7. RF Register + * Zebra1 */ +#define bZebra1_HSSIEnable 0x8 /* Useless */ +#define bZebra1_TRxControl 0xc00 +#define bZebra1_TRxGainSetting 0x07f +#define bZebra1_RxCorner 0xc00 +#define bZebra1_TxChargePump 0x38 +#define bZebra1_RxChargePump 0x7 +#define bZebra1_ChannelNum 0xf80 +#define bZebra1_TxLPFBW 0x400 +#define bZebra1_RxLPFBW 0x600 + +/* Zebra4 */ +#define bRTL8256RegModeCtrl1 0x100 /* Useless */ +#define bRTL8256RegModeCtrl0 0x40 +#define bRTL8256_TxLPFBW 0x18 +#define bRTL8256_RxLPFBW 0x600 + +/* RTL8258 */ +#define bRTL8258_TxLPFBW 0xc /* Useless */ +#define bRTL8258_RxLPFBW 0xc00 +#define bRTL8258_RSSILPFBW 0xc0 + + +/* + * Other Definition + * */ + +/* byte endable for sb_write */ +#define bByte0 0x1 /* Useless */ +#define bByte1 0x2 +#define bByte2 0x4 +#define bByte3 0x8 +#define bWord0 0x3 +#define bWord1 0xc +#define bDWord 0xf + +/* for PutRegsetting & GetRegSetting BitMask */ +#define bMaskByte0 0xff /* Reg 0xc50 rOFDM0_XAAGCCore~0xC6f */ +#define bMaskByte1 0xff00 +#define bMaskByte2 0xff0000 +#define bMaskByte3 0xff000000 +#define bMaskHWord 0xffff0000 +#define bMaskLWord 0x0000ffff +#define bMaskDWord 0xffffffff +#define bMaskH3Bytes 0xffffff00 +#define bMask12Bits 0xfff +#define bMaskH4Bits 0xf0000000 +#define bMaskOFDM_D 0xffc00000 +#define bMaskCCK 0x3f3f3f3f + + +#define bEnable 0x1 /* Useless */ +#define bDisable 0x0 + +#define LeftAntenna 0x0 /* Useless */ +#define RightAntenna 0x1 + +#define tCheckTxStatus 500 /* 500ms // Useless */ +#define tUpdateRxCounter 100 /* 100ms */ + +#define rateCCK 0 /* Useless */ +#define rateOFDM 1 +#define rateHT 2 + +/* define Register-End */ +#define bPMAC_End 0x1ff /* Useless */ +#define bFPGAPHY0_End 0x8ff +#define bFPGAPHY1_End 0x9ff +#define bCCKPHY0_End 0xaff +#define bOFDMPHY0_End 0xcff +#define bOFDMPHY1_End 0xdff + +/* define max debug item in each debug page + * #define bMaxItem_FPGA_PHY0 0x9 + * #define bMaxItem_FPGA_PHY1 0x3 + * #define bMaxItem_PHY_11B 0x16 + * #define bMaxItem_OFDM_PHY0 0x29 + * #define bMaxItem_OFDM_PHY1 0x0 */ + +#define bPMACControl 0x0 /* Useless */ +#define bWMACControl 0x1 +#define bWNICControl 0x2 + +#define PathA 0x0 /* Useless */ +#define PathB 0x1 +#define PathC 0x2 +#define PathD 0x3 + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8192FPwrSeq.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8192FPwrSeq.h new file mode 100644 index 000000000000..50408b558e5f --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8192FPwrSeq.h @@ -0,0 +1,221 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * 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_8192F +#define REALTEK_POWER_SEQUENCE_8192F +#define POWER_SEQUENCE_8192F_VER 04 +/* #include "PwrSeqCmd.h" */ +#include "HalPwrSeqCmd.h" + +/* + Check document WM-20110607-Paul-RTL8192e_Power_Architecture-R02.vsd + There are 6 HW Power States: + 0: POFF--Power Off + 1: PDN--Power Down + 2: CARDEMU--Card Emulation + 3: ACT--Active Mode + 4: LPS--Low Power State + 5: SUS--Suspend + + The transition from different states are defined below + TRANS_CARDEMU_TO_ACT + TRANS_ACT_TO_CARDEMU + TRANS_CARDEMU_TO_SUS + TRANS_SUS_TO_CARDEMU + TRANS_CARDEMU_TO_PDN + TRANS_ACT_TO_LPS + TRANS_LPS_TO_ACT + + TRANS_END +*/ +#define RTL8192F_TRANS_CARDEMU_TO_ACT_STEPS 38 +#define RTL8192F_TRANS_ACT_TO_CARDEMU_STEPS 8 +#define RTL8192F_TRANS_CARDEMU_TO_SUS_STEPS 7 +#define RTL8192F_TRANS_SUS_TO_CARDEMU_STEPS 5 +#define RTL8192F_TRANS_CARDEMU_TO_CARDDIS_STEPS 8 +#define RTL8192F_TRANS_CARDDIS_TO_CARDEMU_STEPS 8 +#define RTL8192F_TRANS_CARDEMU_TO_PDN_STEPS 4 +#define RTL8192F_TRANS_PDN_TO_CARDEMU_STEPS 1 +#define RTL8192F_TRANS_ACT_TO_LPS_STEPS 13 +#define RTL8192F_TRANS_LPS_TO_ACT_STEPS 11 +#define RTL8192F_TRANS_END_STEPS 1 + + +#define RTL8192F_TRANS_CARDEMU_TO_ACT \ + /* format */ \ + /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ + {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0}, /*0x20[0] = 1b'1 enable LDOA12 MACRO block for all interface*/ \ + {0x0067, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*0x67[0] = 0 to disable BT_GPS_SEL pins*/ \ + {0x0001, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 1, PWRSEQ_DELAY_MS},/*Delay 1ms*/ \ + {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, 0}, /*0x00[5] = 1b'0 release analog Ips to digital ,1:isolation*/ \ + {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, (BIT4|BIT3|BIT2), 0},/* disable SW LPS 0x04[10]=0 and WLSUS_EN 0x04[11]=0*/ \ + {0x0075, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0 , BIT0},/* Disable USB suspend */ \ + {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT1, BIT1},/* wait till 0x04[17] = 1 power ready*/ \ + {0x0075, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0 , 0},/* Enable USB suspend */ \ + {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/* release WLON reset 0x04[16]=1*/ \ + {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, (BIT1|BIT0), 0}, \ + {0x0012, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, BIT2},/* SWR OCP enable 0x10[18]=1*/ \ + {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, (BIT4|BIT3), 0},/* disable WL suspend*/ \ + {0x007f, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, BIT7},/* 0x7c[31]=1,LDO has max output capability*/ \ + {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},/**/ \ + {0x0010, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT6, BIT6},/* Enable WL control XTAL setting*/ \ + {0x0049, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1},/*Enable falling edge triggering interrupt*/\ + {0x0063, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*Enable GPIO9 data mode*/\ + {0x0062, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*Enable GPIO9 input mode*/\ + {0x0058, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/*Enable HSISR GPIO[C:0] interrupt*/\ + {0x0068, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3, 0},/*RF HW ON/OFF Enable*/\ + {0x001C, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, BIT7},/*Register Lock Disable*/\ + {0x0069, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT6, BIT6},/*For GPIO9 internal pull high setting*/\ + {0x001f, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00},/*reset RF path S1*/\ + {0x007B, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00},/*reset RF path S0*/\ + {0x001f, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x07},/*enable RF path S1*/\ + {0x007B, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x07},/*enalbe RF path S0*/\ + {0x0097, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, BIT5},/*AFE_Ctrl*/\ + {0x00DC, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xCC},/*AFE_Ctrl*/\ + {0x0024, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0x18, 0x00},/*AFE_Ctrl 0x24[4:3]=00 for xtal gmn*/\ + {0x1050, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF},/*GPIO_A[7:0] Pull down software register*/\ + {0x1051, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF},/*GPIO_A[15:8] Pull down software register*/\ + {0x1052, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF},/*GPIO_A[23:16] Pull down software register*/\ + {0x1053, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF},/*GPIO_A[31:24] Pull down software register*/\ + {0x105B, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF},/*GPIO_B[7:0] Pull down software register*/\ + {0x001C, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},/*Register Lock Enable*/\ + {0x0077, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, (BIT7|BIT6), 0x3},/*set HCI Power sequence state delay time:0*/ + + +#define RTL8192F_TRANS_ACT_TO_CARDEMU \ + /* format */ \ + /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ + /*{0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0}, */ /*0x1F[7:0] = 0 turn off RF*/ \ + {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0}, /*0x2[0]=0 Reset BB,RF enter Power Down mode*/ \ + {0x0049, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*Enable rising edge triggering interrupt*/ \ + {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, BIT0},/* release WLON reset 0x04[16]=1*/ \ + {0x0012, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, 0}, /*0x10[18] = 0 to disable ocp*/ \ + {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1}, /*0x04[9] = 1 turn off MAC by HW state machine*/ \ + {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT1, 0}, /*wait till 0x04[9] = 0 polling until return 0 to disable*/ \ + {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, BIT5}, /*0x00[5] = 1b'1 analog Ips to digital ,1:isolation*/ \ + {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0}, /*0x20[0] = 1b'0 disable LDOA12 MACRO block*/\ + + +#define RTL8192F_TRANS_CARDEMU_TO_SUS \ + /* format */ \ + /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ + {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4|BIT3, (BIT4|BIT3)}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ + {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ + {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ + {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 USB|SDIO SOP option to disable BG/MB/ACK/SWR*/ \ + {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, BIT3|BIT4}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ + {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ + {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ + +#define RTL8192F_TRANS_SUS_TO_CARDEMU \ + /* format */ \ + /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ + {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3 | BIT7, 0}, /*clear suspend enable and power down enable*/ \ + {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ + {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ + {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ + {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/ + + +#define RTL8192F_TRANS_CARDEMU_TO_CARDDIS \ + /* format */ \ + /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ + {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07=0x20 , SOP option to disable BG/MB*/ \ + {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ + {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT2, BIT2}, /*0x04[10] = 1, enable SW LPS*/ \ + {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, BIT3|BIT4}, /*0x04[12:11] = 2b'11 enable WL suspend*/ \ + {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 1}, /*0x48[16] = 1 to enable GPIO9 as EXT WAKEUP*/ \ + {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ + {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ + {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ + +#define RTL8192F_TRANS_CARDDIS_TO_CARDEMU \ + /* format */ \ + /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ + {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3 | BIT7, 0}, /*clear suspend enable and power down enable*/ \ + {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ + {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ + {0x004A, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0}, /*0x48[16] = 0 to disable GPIO9 as EXT WAKEUP*/ \ + {0x0012, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, BIT2}, /*0x10[18] = 1 to enable ocp*/ \ + {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/\ + {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ + {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0},/*PCIe DMA start*/ + + +#define RTL8192F_TRANS_CARDEMU_TO_PDN \ + /* format */ \ + /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ + {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ + {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK|PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SOP option to disable BG/MB/ACK/SWR*/ \ + {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/* 0x04[16] = 0*/\ + {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, BIT7},/* 0x04[15] = 1*/ + +#define RTL8192F_TRANS_PDN_TO_CARDEMU \ + /* format */ \ + /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ + {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},/* 0x04[15] = 0*/ + +#define RTL8192F_TRANS_ACT_TO_LPS \ + /* format */ \ + /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ + {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF},/*PCIe DMA stop*/ \ + {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF},/*Tx Pause*/ \ + {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ + {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ + {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ + {0x05FB, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ + {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled,and clock are gated*/ \ + {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ + {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*Whole BB is reset*/ \ + {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x03},/*Reset MAC TRX*/ \ + {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ + {0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00},/*When driver enter Sus/ Disable, enable LOP for BT*/ \ + {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, BIT5},/*Respond TxOK to scheduler*/ \ + + +#define RTL8192F_TRANS_LPS_TO_ACT \ + /* format */ \ + /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ + {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM*/\ + {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/\ + {0x0361, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x84}, /*PCIe RPWM*/\ + {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/\ + {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*. 0x08[4] = 0 switch TSF to 40M*/\ + {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT7, 0}, /*Polling 0x109[7]=0 TSF in 40M*/\ + {0x0029, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT6|BIT7, 0}, /*. 0x29[7:6] = 2b'00 enable BB clock*/\ + {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1*/\ + {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/\ + {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1|BIT0, BIT1|BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ + {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ + +#define RTL8192F_TRANS_END \ + /* format */ \ + /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ + {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,0,PWR_CMD_END, 0, 0}, // + + +extern WLAN_PWR_CFG rtl8192F_power_on_flow[RTL8192F_TRANS_CARDEMU_TO_ACT_STEPS+RTL8192F_TRANS_END_STEPS]; +extern WLAN_PWR_CFG rtl8192F_radio_off_flow[RTL8192F_TRANS_ACT_TO_CARDEMU_STEPS+RTL8192F_TRANS_END_STEPS]; +extern WLAN_PWR_CFG rtl8192F_card_disable_flow[RTL8192F_TRANS_ACT_TO_CARDEMU_STEPS+RTL8192F_TRANS_CARDEMU_TO_CARDDIS_STEPS+RTL8192F_TRANS_END_STEPS]; +extern WLAN_PWR_CFG rtl8192F_card_enable_flow[RTL8192F_TRANS_CARDDIS_TO_CARDEMU_STEPS+RTL8192F_TRANS_CARDEMU_TO_ACT_STEPS+RTL8192F_TRANS_END_STEPS]; +extern WLAN_PWR_CFG rtl8192F_suspend_flow[RTL8192F_TRANS_ACT_TO_CARDEMU_STEPS+RTL8192F_TRANS_CARDEMU_TO_SUS_STEPS+RTL8192F_TRANS_END_STEPS]; +extern WLAN_PWR_CFG rtl8192F_resume_flow[RTL8192F_TRANS_SUS_TO_CARDEMU_STEPS+RTL8192F_TRANS_CARDEMU_TO_ACT_STEPS+RTL8192F_TRANS_END_STEPS]; +extern WLAN_PWR_CFG rtl8192F_hwpdn_flow[RTL8192F_TRANS_ACT_TO_CARDEMU_STEPS+RTL8192F_TRANS_CARDEMU_TO_PDN_STEPS+RTL8192F_TRANS_END_STEPS]; +extern WLAN_PWR_CFG rtl8192F_enter_lps_flow[RTL8192F_TRANS_ACT_TO_LPS_STEPS+RTL8192F_TRANS_END_STEPS]; +extern WLAN_PWR_CFG rtl8192F_leave_lps_flow[RTL8192F_TRANS_LPS_TO_ACT_STEPS+RTL8192F_TRANS_END_STEPS]; + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8703BPhyCfg.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8703BPhyCfg.h index a038bccaa545..7d967d3d554c 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8703BPhyCfg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8703BPhyCfg.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -44,34 +40,34 @@ /*--------------------------Exported Function prototype---------------------*/ u32 PHY_QueryBBReg_8703B( - IN PADAPTER Adapter, - IN u32 RegAddr, - IN u32 BitMask + PADAPTER Adapter, + u32 RegAddr, + u32 BitMask ); -VOID +void PHY_SetBBReg_8703B( - IN PADAPTER Adapter, - IN u32 RegAddr, - IN u32 BitMask, - IN u32 Data + PADAPTER Adapter, + u32 RegAddr, + u32 BitMask, + u32 Data ); u32 PHY_QueryRFReg_8703B( - IN PADAPTER Adapter, - IN u8 eRFPath, - IN u32 RegAddr, - IN u32 BitMask + PADAPTER Adapter, + enum rf_path eRFPath, + u32 RegAddr, + u32 BitMask ); -VOID +void PHY_SetRFReg_8703B( - IN PADAPTER Adapter, - IN u8 eRFPath, - IN u32 RegAddr, - IN u32 BitMask, - IN u32 Data + PADAPTER Adapter, + enum rf_path eRFPath, + u32 RegAddr, + u32 BitMask, + u32 Data ); /* MAC/BB/RF HAL config */ @@ -83,53 +79,47 @@ s32 PHY_MACConfig8703B(PADAPTER padapter); int PHY_ConfigRFWithParaFile_8703B( - IN PADAPTER Adapter, - IN u8 *pFileName, - RF_PATH eRFPath + PADAPTER Adapter, + u8 *pFileName, + enum rf_path eRFPath ); -VOID +void PHY_SetTxPowerIndex_8703B( - IN PADAPTER Adapter, - IN u32 PowerIndex, - IN u8 RFPath, - IN u8 Rate + PADAPTER Adapter, + u32 PowerIndex, + enum rf_path RFPath, + u8 Rate ); u8 PHY_GetTxPowerIndex_8703B( - IN PADAPTER pAdapter, - IN u8 RFPath, - IN u8 Rate, - IN u8 BandWidth, - IN u8 Channel, + PADAPTER pAdapter, + enum rf_path RFPath, + u8 Rate, + u8 BandWidth, + u8 Channel, struct txpwr_idx_comp *tic ); -VOID -PHY_GetTxPowerLevel8703B( - IN PADAPTER Adapter, - OUT s32 *powerlevel -); - -VOID +void PHY_SetTxPowerLevel8703B( - IN PADAPTER Adapter, - IN u8 channel + PADAPTER Adapter, + u8 channel ); -VOID +void PHY_SetSwChnlBWMode8703B( - IN PADAPTER Adapter, - IN u8 channel, - IN CHANNEL_WIDTH Bandwidth, - IN u8 Offset40, - IN u8 Offset80 + PADAPTER Adapter, + u8 channel, + enum channel_width Bandwidth, + u8 Offset40, + u8 Offset80 ); -VOID phy_set_rf_path_switch_8703b( - IN PADAPTER pAdapter, - IN bool bMain +void phy_set_rf_path_switch_8703b( + struct dm_struct *phydm, + bool bMain ); /*--------------------------Exported Function prototype End---------------------*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8703BPhyReg.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8703BPhyReg.h index e8eb66497037..75e154a48a03 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8703BPhyReg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8703BPhyReg.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/Hal8703BPwrSeq.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8703BPwrSeq.h index fb36455f3279..a94e9e67c4a8 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8703BPwrSeq.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8703BPwrSeq.h @@ -1,4 +1,18 @@ /* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * 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/rtl8188eu/include/Hal8710BPhyCfg.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8710BPhyCfg.h new file mode 100644 index 000000000000..f9404618ddb9 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8710BPhyCfg.h @@ -0,0 +1,122 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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_HAL8710BPHYCFG_H__ +#define __INC_HAL8710BPHYCFG_H__ + +/*--------------------------Define Parameters-------------------------------*/ +#define LOOP_LIMIT 5 +#define MAX_STALL_TIME 50 /* us */ +#define AntennaDiversityValue 0x80 /* (Adapter->bSoftwareAntennaDiversity ? 0x00 : 0x80) */ +#define MAX_TXPWR_IDX_NMODE_92S 63 +#define Reset_Cnt_Limit 3 + +#ifdef CONFIG_PCI_HCI + #define MAX_AGGR_NUM 0x0B +#else + #define MAX_AGGR_NUM 0x07 +#endif /* CONFIG_PCI_HCI */ + + +/*--------------------------Define Parameters End-------------------------------*/ + + +/*------------------------------Define structure----------------------------*/ + +/*------------------------------Define structure End----------------------------*/ + +/*--------------------------Exported Function prototype---------------------*/ +u32 +PHY_QueryBBReg_8710B( + PADAPTER Adapter, + u32 RegAddr, + u32 BitMask +); + +void +PHY_SetBBReg_8710B( + PADAPTER Adapter, + u32 RegAddr, + u32 BitMask, + u32 Data +); + +u32 +PHY_QueryRFReg_8710B( + PADAPTER Adapter, + enum rf_path eRFPath, + u32 RegAddr, + u32 BitMask +); + +void +PHY_SetRFReg_8710B( + PADAPTER Adapter, + enum rf_path eRFPath, + u32 RegAddr, + u32 BitMask, + u32 Data +); + +/* MAC/BB/RF HAL config */ +int PHY_BBConfig8710B(PADAPTER Adapter); + +int PHY_RFConfig8710B(PADAPTER Adapter); + +s32 PHY_MACConfig8710B(PADAPTER padapter); + +int +PHY_ConfigRFWithParaFile_8710B( + PADAPTER Adapter, + u8 *pFileName, + enum rf_path eRFPath +); + +void +PHY_SetTxPowerIndex_8710B( + PADAPTER Adapter, + u32 PowerIndex, + enum rf_path RFPath, + u8 Rate +); + +u8 +PHY_GetTxPowerIndex_8710B( + PADAPTER pAdapter, + enum rf_path RFPath, + u8 Rate, + u8 BandWidth, + u8 Channel, + struct txpwr_idx_comp *tic +); + +void +PHY_SetTxPowerLevel8710B( + PADAPTER Adapter, + u8 channel +); + +void +PHY_SetSwChnlBWMode8710B( + PADAPTER Adapter, + u8 channel, + enum channel_width Bandwidth, + u8 Offset40, + u8 Offset80 +); + +/*--------------------------Exported Function prototype End---------------------*/ + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8710BPhyReg.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8710BPhyReg.h new file mode 100644 index 000000000000..310c97ed8660 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8710BPhyReg.h @@ -0,0 +1,1135 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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_HAL8710BPHYREG_H__ +#define __INC_HAL8710BPHYREG_H__ + +#define rSYM_WLBT_PAPE_SEL 0x64 +/* + * BB-PHY register PMAC 0x100 PHY 0x800 - 0xEFF + * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF + * 2. 0x800/0x900/0xA00/0xC00/0xD00/0xE00 + * 3. RF register 0x00-2E + * 4. Bit Mask for BB/RF register + * 5. Other definition for BB/RF R/W + * */ + + +/* + * 1. PMAC duplicate register due to connection: RF_Mode, TRxRN, NumOf L-STF + * 1. Page1(0x100) + * */ +#define rPMAC_Reset 0x100 +#define rPMAC_TxStart 0x104 +#define rPMAC_TxLegacySIG 0x108 +#define rPMAC_TxHTSIG1 0x10c +#define rPMAC_TxHTSIG2 0x110 +#define rPMAC_PHYDebug 0x114 +#define rPMAC_TxPacketNum 0x118 +#define rPMAC_TxIdle 0x11c +#define rPMAC_TxMACHeader0 0x120 +#define rPMAC_TxMACHeader1 0x124 +#define rPMAC_TxMACHeader2 0x128 +#define rPMAC_TxMACHeader3 0x12c +#define rPMAC_TxMACHeader4 0x130 +#define rPMAC_TxMACHeader5 0x134 +#define rPMAC_TxDataType 0x138 +#define rPMAC_TxRandomSeed 0x13c +#define rPMAC_CCKPLCPPreamble 0x140 +#define rPMAC_CCKPLCPHeader 0x144 +#define rPMAC_CCKCRC16 0x148 +#define rPMAC_OFDMRxCRC32OK 0x170 +#define rPMAC_OFDMRxCRC32Er 0x174 +#define rPMAC_OFDMRxParityEr 0x178 +#define rPMAC_OFDMRxCRC8Er 0x17c +#define rPMAC_CCKCRxRC16Er 0x180 +#define rPMAC_CCKCRxRC32Er 0x184 +#define rPMAC_CCKCRxRC32OK 0x188 +#define rPMAC_TxStatus 0x18c + +/* + * 2. Page2(0x200) + * + * The following two definition are only used for USB interface. */ +#define RF_BB_CMD_ADDR 0x02c0 /* RF/BB read/write command address. */ +#define RF_BB_CMD_DATA 0x02c4 /* RF/BB read/write command data. */ + +/* + * 3. Page8(0x800) + * */ +#define rFPGA0_RFMOD 0x800 /* RF mode & CCK TxSC // RF BW Setting?? */ + +#define rFPGA0_TxInfo 0x804 /* Status report?? */ +#define rFPGA0_PSDFunction 0x808 + +#define rFPGA0_TxGainStage 0x80c /* Set TX PWR init gain? */ + +#define rFPGA0_RFTiming1 0x810 /* Useless now */ +#define rFPGA0_RFTiming2 0x814 + +#define rFPGA0_XA_HSSIParameter1 0x820 /* RF 3 wire register */ +#define rFPGA0_XA_HSSIParameter2 0x824 +#define rFPGA0_XB_HSSIParameter1 0x828 +#define rFPGA0_XB_HSSIParameter2 0x82c +#define rTxAGC_B_Rate18_06 0x830 +#define rTxAGC_B_Rate54_24 0x834 +#define rTxAGC_B_CCK1_55_Mcs32 0x838 +#define rTxAGC_B_Mcs03_Mcs00 0x83c + +#define rTxAGC_B_Mcs07_Mcs04 0x848 +#define rTxAGC_B_Mcs11_Mcs08 0x84c + +#define rFPGA0_XA_LSSIParameter 0x840 +#define rFPGA0_XB_LSSIParameter 0x844 + +#define rFPGA0_RFWakeUpParameter 0x850 /* Useless now */ +#define rFPGA0_RFSleepUpParameter 0x854 + +#define rFPGA0_XAB_SwitchControl 0x858 /* RF Channel switch */ +#define rFPGA0_XCD_SwitchControl 0x85c + +#define rFPGA0_XA_RFInterfaceOE 0x860 /* RF Channel switch */ +#define rFPGA0_XB_RFInterfaceOE 0x864 + +#define rTxAGC_B_Mcs15_Mcs12 0x868 +#define rTxAGC_B_CCK11_A_CCK2_11 0x86c + +#define rFPGA0_XAB_RFInterfaceSW 0x870 /* RF Interface Software Control */ +#define rFPGA0_XCD_RFInterfaceSW 0x874 + +#define rFPGA0_XAB_RFParameter 0x878 /* RF Parameter */ +#define rFPGA0_XCD_RFParameter 0x87c + +#define rFPGA0_AnalogParameter1 0x880 /* Crystal cap setting RF-R/W protection for parameter4?? */ +#define rFPGA0_AnalogParameter2 0x884 +#define rFPGA0_AnalogParameter3 0x888 /* Useless now */ +#define rFPGA0_AnalogParameter4 0x88c + +#define rFPGA0_XA_LSSIReadBack 0x8a0 /* Tranceiver LSSI Readback */ +#define rFPGA0_XB_LSSIReadBack 0x8a4 +#define rFPGA0_XC_LSSIReadBack 0x8a8 +#define rFPGA0_XD_LSSIReadBack 0x8ac + +#define rFPGA0_PSDReport 0x8b4 /* Useless now */ +#define TransceiverA_HSPI_Readback 0x8b8 /* Transceiver A HSPI Readback */ +#define TransceiverB_HSPI_Readback 0x8bc /* Transceiver B HSPI Readback */ +#define rFPGA0_XAB_RFInterfaceRB 0x8e0 /* Useless now // RF Interface Readback Value */ +#define rFPGA0_XCD_RFInterfaceRB 0x8e4 /* Useless now */ + +/* + * 4. Page9(0x900) + * */ +#define rFPGA1_RFMOD 0x900 /* RF mode & OFDM TxSC // RF BW Setting?? */ +#define rFPGA1_TxBlock 0x904 /* Useless now */ +#define rFPGA1_DebugSelect 0x908 /* Useless now */ +#define rFPGA1_TxInfo 0x90c /* Useless now // Status report?? */ +#define rDPDT_control 0x92c +#define rfe_ctrl_anta_src 0x930 +#define rS0S1_PathSwitch 0x948 +#define rBBrx_DFIR 0x954 + +/* + * 5. PageA(0xA00) + * + * Set Control channel to upper or lower. These settings are required only for 40MHz */ +#define rCCK0_System 0xa00 + +#define rCCK0_AFESetting 0xa04 /* Disable init gain now // Select RX path by RSSI */ +#define rCCK0_CCA 0xa08 /* Disable init gain now // Init gain */ + +#define rCCK0_RxAGC1 0xa0c /* AGC default value, saturation level // Antenna Diversity, RX AGC, LNA Threshold, RX LNA Threshold useless now. Not the same as 90 series */ +#define rCCK0_RxAGC2 0xa10 /* AGC & DAGC */ + +#define rCCK0_RxHP 0xa14 + +#define rCCK0_DSPParameter1 0xa18 /* Timing recovery & Channel estimation threshold */ +#define rCCK0_DSPParameter2 0xa1c /* SQ threshold */ + +#define rCCK0_TxFilter1 0xa20 +#define rCCK0_TxFilter2 0xa24 +#define rCCK0_DebugPort 0xa28 /* debug port and Tx filter3 */ +#define rCCK0_FalseAlarmReport 0xa2c /* 0xa2d useless now 0xa30-a4f channel report */ +#define rCCK0_TRSSIReport 0xa50 +#define rCCK0_RxReport 0xa54 /* 0xa57 */ +#define rCCK0_FACounterLower 0xa5c /* 0xa5b */ +#define rCCK0_FACounterUpper 0xa58 /* 0xa5c */ + +/* + * PageB(0xB00) + * */ +#define rPdp_AntA 0xb00 +#define rPdp_AntA_4 0xb04 +#define rPdp_AntA_8 0xb08 +#define rPdp_AntA_C 0xb0c +#define rPdp_AntA_10 0xb10 +#define rPdp_AntA_14 0xb14 +#define rPdp_AntA_18 0xb18 +#define rPdp_AntA_1C 0xb1c +#define rPdp_AntA_20 0xb20 +#define rPdp_AntA_24 0xb24 + +#define rConfig_Pmpd_AntA 0xb28 +#define rConfig_ram64x16 0xb2c + +#define rBndA 0xb30 +#define rHssiPar 0xb34 + +#define rConfig_AntA 0xb68 +#define rConfig_AntB 0xb6c + +#define rPdp_AntB 0xb70 +#define rPdp_AntB_4 0xb74 +#define rPdp_AntB_8 0xb78 +#define rPdp_AntB_C 0xb7c +#define rPdp_AntB_10 0xb80 +#define rPdp_AntB_14 0xb84 +#define rPdp_AntB_18 0xb88 +#define rPdp_AntB_1C 0xb8c +#define rPdp_AntB_20 0xb90 +#define rPdp_AntB_24 0xb94 + +#define rConfig_Pmpd_AntB 0xb98 + +#define rBndB 0xba0 + +#define rAPK 0xbd8 +#define rPm_Rx0_AntA 0xbdc +#define rPm_Rx1_AntA 0xbe0 +#define rPm_Rx2_AntA 0xbe4 +#define rPm_Rx3_AntA 0xbe8 +#define rPm_Rx0_AntB 0xbec +#define rPm_Rx1_AntB 0xbf0 +#define rPm_Rx2_AntB 0xbf4 +#define rPm_Rx3_AntB 0xbf8 +/* + * 6. PageC(0xC00) + * */ +#define rOFDM0_LSTF 0xc00 + +#define rOFDM0_TRxPathEnable 0xc04 +#define rOFDM0_TRMuxPar 0xc08 +#define rOFDM0_TRSWIsolation 0xc0c + +#define rOFDM0_XARxAFE 0xc10 /* RxIQ DC offset, Rx digital filter, DC notch filter */ +#define rOFDM0_XARxIQImbalance 0xc14 /* RxIQ imbalance matrix */ +#define rOFDM0_XBRxAFE 0xc18 +#define rOFDM0_XBRxIQImbalance 0xc1c +#define rOFDM0_XCRxAFE 0xc20 +#define rOFDM0_XCRxIQImbalance 0xc24 +#define rOFDM0_XDRxAFE 0xc28 +#define rOFDM0_XDRxIQImbalance 0xc2c + +#define rOFDM0_RxDetector1 0xc30 /* PD, BW & SBD // DM tune init gain */ +#define rOFDM0_RxDetector2 0xc34 /* SBD & Fame Sync. */ +#define rOFDM0_RxDetector3 0xc38 /* Frame Sync. */ +#define rOFDM0_RxDetector4 0xc3c /* PD, SBD, Frame Sync & Short-GI */ + +#define rOFDM0_RxDSP 0xc40 /* Rx Sync Path */ +#define rOFDM0_CFOandDAGC 0xc44 /* CFO & DAGC */ +#define rOFDM0_CCADropThreshold 0xc48 /* CCA Drop threshold */ +#define rOFDM0_ECCAThreshold 0xc4c /* energy CCA */ + +#define rOFDM0_XAAGCCore1 0xc50 /* DIG */ +#define rOFDM0_XAAGCCore2 0xc54 +#define rOFDM0_XBAGCCore1 0xc58 +#define rOFDM0_XBAGCCore2 0xc5c +#define rOFDM0_XCAGCCore1 0xc60 +#define rOFDM0_XCAGCCore2 0xc64 +#define rOFDM0_XDAGCCore1 0xc68 +#define rOFDM0_XDAGCCore2 0xc6c + +#define rOFDM0_AGCParameter1 0xc70 +#define rOFDM0_AGCParameter2 0xc74 +#define rOFDM0_AGCRSSITable 0xc78 +#define rOFDM0_HTSTFAGC 0xc7c + +#define rOFDM0_XATxIQImbalance 0xc80 /* TX PWR TRACK and DIG */ +#define rOFDM0_XATxAFE 0xc84 +#define rOFDM0_XBTxIQImbalance 0xc88 +#define rOFDM0_XBTxAFE 0xc8c +#define rOFDM0_XCTxIQImbalance 0xc90 +#define rOFDM0_XCTxAFE 0xc94 +#define rOFDM0_XDTxIQImbalance 0xc98 +#define rOFDM0_XDTxAFE 0xc9c + +#define rOFDM0_RxIQExtAnta 0xca0 +#define rOFDM0_TxCoeff1 0xca4 +#define rOFDM0_TxCoeff2 0xca8 +#define rOFDM0_TxCoeff3 0xcac +#define rOFDM0_TxCoeff4 0xcb0 +#define rOFDM0_TxCoeff5 0xcb4 +#define rOFDM0_TxCoeff6 0xcb8 +#define rOFDM0_RxHPParameter 0xce0 +#define rOFDM0_TxPseudoNoiseWgt 0xce4 +#define rOFDM0_FrameSync 0xcf0 +#define rOFDM0_DFSReport 0xcf4 + +/* + * 7. PageD(0xD00) + * */ +#define rOFDM1_LSTF 0xd00 +#define rOFDM1_TRxPathEnable 0xd04 + +#define rOFDM1_CFO 0xd08 /* No setting now */ +#define rOFDM1_CSI1 0xd10 +#define rOFDM1_SBD 0xd14 +#define rOFDM1_CSI2 0xd18 +#define rOFDM1_CFOTracking 0xd2c +#define rOFDM1_TRxMesaure1 0xd34 +#define rOFDM1_IntfDet 0xd3c +#define rOFDM1_PseudoNoiseStateAB 0xd50 +#define rOFDM1_PseudoNoiseStateCD 0xd54 +#define rOFDM1_RxPseudoNoiseWgt 0xd58 + +#define rOFDM_PHYCounter1 0xda0 /* cca, parity fail */ +#define rOFDM_PHYCounter2 0xda4 /* rate illegal, crc8 fail */ +#define rOFDM_PHYCounter3 0xda8 /* MCS not support */ + +#define rOFDM_ShortCFOAB 0xdac /* No setting now */ +#define rOFDM_ShortCFOCD 0xdb0 +#define rOFDM_LongCFOAB 0xdb4 +#define rOFDM_LongCFOCD 0xdb8 +#define rOFDM_TailCFOAB 0xdbc +#define rOFDM_TailCFOCD 0xdc0 +#define rOFDM_PWMeasure1 0xdc4 +#define rOFDM_PWMeasure2 0xdc8 +#define rOFDM_BWReport 0xdcc +#define rOFDM_AGCReport 0xdd0 +#define rOFDM_RxSNR 0xdd4 +#define rOFDM_RxEVMCSI 0xdd8 +#define rOFDM_SIGReport 0xddc + + +/* + * 8. PageE(0xE00) + * */ +#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 rFPGA0_IQK 0xe28 +#define rTx_IQK_Tone_A 0xe30 +#define rRx_IQK_Tone_A 0xe34 +#define rTx_IQK_PI_A 0xe38 +#define rRx_IQK_PI_A 0xe3c + +#define rTx_IQK 0xe40 +#define rRx_IQK 0xe44 +#define rIQK_AGC_Pts 0xe48 +#define rIQK_AGC_Rsp 0xe4c +#define rTx_IQK_Tone_B 0xe50 +#define rRx_IQK_Tone_B 0xe54 +#define rTx_IQK_PI_B 0xe58 +#define rRx_IQK_PI_B 0xe5c +#define rIQK_AGC_Cont 0xe60 + +#define rBlue_Tooth 0xe6c +#define rRx_Wait_CCA 0xe70 +#define rTx_CCK_RFON 0xe74 +#define rTx_CCK_BBON 0xe78 +#define rTx_OFDM_RFON 0xe7c +#define rTx_OFDM_BBON 0xe80 +#define rTx_To_Rx 0xe84 +#define rTx_To_Tx 0xe88 +#define rRx_CCK 0xe8c + +#define rTx_Power_Before_IQK_A 0xe94 +#define rTx_Power_After_IQK_A 0xe9c + +#define rRx_Power_Before_IQK_A 0xea0 +#define rRx_Power_Before_IQK_A_2 0xea4 +#define rRx_Power_After_IQK_A 0xea8 +#define rRx_Power_After_IQK_A_2 0xeac + +#define rTx_Power_Before_IQK_B 0xeb4 +#define rTx_Power_After_IQK_B 0xebc + +#define rRx_Power_Before_IQK_B 0xec0 +#define rRx_Power_Before_IQK_B_2 0xec4 +#define rRx_Power_After_IQK_B 0xec8 +#define rRx_Power_After_IQK_B_2 0xecc + +#define rRx_OFDM 0xed0 +#define rRx_Wait_RIFS 0xed4 +#define rRx_TO_Rx 0xed8 +#define rStandby 0xedc +#define rSleep 0xee0 +#define rPMPD_ANAEN 0xeec + +/* + * 7. RF Register 0x00-0x2E (RF 8256) + * RF-0222D 0x00-3F + * + * Zebra1 */ +#define rZebra1_HSSIEnable 0x0 /* Useless now */ +#define rZebra1_TRxEnable1 0x1 +#define rZebra1_TRxEnable2 0x2 +#define rZebra1_AGC 0x4 +#define rZebra1_ChargePump 0x5 +#define rZebra1_Channel 0x7 /* RF channel switch */ + +/* #endif */ +#define rZebra1_TxGain 0x8 /* Useless now */ +#define rZebra1_TxLPF 0x9 +#define rZebra1_RxLPF 0xb +#define rZebra1_RxHPFCorner 0xc + +/* Zebra4 */ +#define rGlobalCtrl 0 /* Useless now */ +#define rRTL8256_TxLPF 19 +#define rRTL8256_RxLPF 11 + +/* RTL8258 */ +#define rRTL8258_TxLPF 0x11 /* Useless now */ +#define rRTL8258_RxLPF 0x13 +#define rRTL8258_RSSILPF 0xa + +/* + * RL6052 Register definition + * */ +#define RF_AC 0x00 /* */ + +#define RF_IQADJ_G1 0x01 /* */ +#define RF_IQADJ_G2 0x02 /* */ +#define RF_BS_PA_APSET_G1_G4 0x03 +#define RF_BS_PA_APSET_G5_G8 0x04 +#define RF_POW_TRSW 0x05 /* */ + +#define RF_GAIN_RX 0x06 /* */ +#define RF_GAIN_TX 0x07 /* */ + +#define RF_TXM_IDAC 0x08 /* */ +#define RF_IPA_G 0x09 /* */ +#define RF_TXBIAS_G 0x0A +#define RF_TXPA_AG 0x0B +#define RF_IPA_A 0x0C /* */ +#define RF_TXBIAS_A 0x0D +#define RF_BS_PA_APSET_G9_G11 0x0E +#define RF_BS_IQGEN 0x0F /* */ + +#define RF_MODE1 0x10 /* */ +#define RF_MODE2 0x11 /* */ + +#define RF_RX_AGC_HP 0x12 /* */ +#define RF_TX_AGC 0x13 /* */ +#define RF_BIAS 0x14 /* */ +#define RF_IPA 0x15 /* */ +#define RF_TXBIAS 0x16 +#define RF_POW_ABILITY 0x17 /* */ +#define RF_MODE_AG 0x18 /* */ +#define rRfChannel 0x18 /* RF channel and BW switch */ +#define RF_CHNLBW 0x18 /* RF channel and BW switch */ +#define RF_TOP 0x19 /* */ + +#define RF_RX_G1 0x1A /* */ +#define RF_RX_G2 0x1B /* */ + +#define RF_RX_BB2 0x1C /* */ +#define RF_RX_BB1 0x1D /* */ + +#define RF_RCK1 0x1E /* */ +#define RF_RCK2 0x1F /* */ + +#define RF_TX_G1 0x20 /* */ +#define RF_TX_G2 0x21 /* */ +#define RF_TX_G3 0x22 /* */ + +#define RF_TX_BB1 0x23 /* */ + +#define RF_T_METER 0x24 /* */ + +#define RF_SYN_G1 0x25 /* RF TX Power control */ +#define RF_SYN_G2 0x26 /* RF TX Power control */ +#define RF_SYN_G3 0x27 /* RF TX Power control */ +#define RF_SYN_G4 0x28 /* RF TX Power control */ +#define RF_SYN_G5 0x29 /* RF TX Power control */ +#define RF_SYN_G6 0x2A /* RF TX Power control */ +#define RF_SYN_G7 0x2B /* RF TX Power control */ +#define RF_SYN_G8 0x2C /* RF TX Power control */ + +#define RF_RCK_OS 0x30 /* RF TX PA control */ + +#define RF_TXPA_G1 0x31 /* RF TX PA control */ +#define RF_TXPA_G2 0x32 /* RF TX PA control */ +#define RF_TXPA_G3 0x33 /* RF TX PA control */ +#define RF_TX_BIAS_A 0x35 +#define RF_TX_BIAS_D 0x36 +#define RF_LOBF_9 0x38 +#define RF_RXRF_A3 0x3C /* */ +#define RF_TRSW 0x3F + +#define RF_TXRF_A2 0x41 +#define RF_T_METER_88E 0x42 +#define RF_TXPA_G4 0x46 +#define RF_TXPA_A4 0x4B +#define RF_0x52 0x52 +#define RF_WE_LUT 0xEF +#define RF_S0S1 0xB0 + +/* + * Bit Mask + * + * 1. Page1(0x100) */ +#define bBBResetB 0x100 /* Useless now? */ +#define bGlobalResetB 0x200 +#define bOFDMTxStart 0x4 +#define bCCKTxStart 0x8 +#define bCRC32Debug 0x100 +#define bPMACLoopback 0x10 +#define bTxLSIG 0xffffff +#define bOFDMTxRate 0xf +#define bOFDMTxReserved 0x10 +#define bOFDMTxLength 0x1ffe0 +#define bOFDMTxParity 0x20000 +#define bTxHTSIG1 0xffffff +#define bTxHTMCSRate 0x7f +#define bTxHTBW 0x80 +#define bTxHTLength 0xffff00 +#define bTxHTSIG2 0xffffff +#define bTxHTSmoothing 0x1 +#define bTxHTSounding 0x2 +#define bTxHTReserved 0x4 +#define bTxHTAggreation 0x8 +#define bTxHTSTBC 0x30 +#define bTxHTAdvanceCoding 0x40 +#define bTxHTShortGI 0x80 +#define bTxHTNumberHT_LTF 0x300 +#define bTxHTCRC8 0x3fc00 +#define bCounterReset 0x10000 +#define bNumOfOFDMTx 0xffff +#define bNumOfCCKTx 0xffff0000 +#define bTxIdleInterval 0xffff +#define bOFDMService 0xffff0000 +#define bTxMACHeader 0xffffffff +#define bTxDataInit 0xff +#define bTxHTMode 0x100 +#define bTxDataType 0x30000 +#define bTxRandomSeed 0xffffffff +#define bCCKTxPreamble 0x1 +#define bCCKTxSFD 0xffff0000 +#define bCCKTxSIG 0xff +#define bCCKTxService 0xff00 +#define bCCKLengthExt 0x8000 +#define bCCKTxLength 0xffff0000 +#define bCCKTxCRC16 0xffff +#define bCCKTxStatus 0x1 +#define bOFDMTxStatus 0x2 + +#define IS_BB_REG_OFFSET_92S(_Offset) ((_Offset >= 0x800) && (_Offset <= 0xfff)) +#define RF_TX_GAIN_OFFSET_8710B(_val) (abs((_val)) | (((_val) > 0) ? BIT(4) : 0)) + +/* 2. Page8(0x800) */ +#define bRFMOD 0x1 /* Reg 0x800 rFPGA0_RFMOD */ +#define bJapanMode 0x2 +#define bCCKTxSC 0x30 +#define bCCKEn 0x1000000 +#define bOFDMEn 0x2000000 + +#define bOFDMRxADCPhase 0x10000 /* Useless now */ +#define bOFDMTxDACPhase 0x40000 +#define bXATxAGC 0x3f + +#define bAntennaSelect 0x0300 + +#define bXBTxAGC 0xf00 /* Reg 80c rFPGA0_TxGainStage */ +#define bXCTxAGC 0xf000 +#define bXDTxAGC 0xf0000 + +#define bPAStart 0xf0000000 /* Useless now */ +#define bTRStart 0x00f00000 +#define bRFStart 0x0000f000 +#define bBBStart 0x000000f0 +#define bBBCCKStart 0x0000000f +#define bPAEnd 0xf /* Reg0x814 */ +#define bTREnd 0x0f000000 +#define bRFEnd 0x000f0000 +#define bCCAMask 0x000000f0 /* T2R */ +#define bR2RCCAMask 0x00000f00 +#define bHSSI_R2TDelay 0xf8000000 +#define bHSSI_T2RDelay 0xf80000 +#define bContTxHSSI 0x400 /* chane gain at continue Tx */ +#define bIGFromCCK 0x200 +#define bAGCAddress 0x3f +#define bRxHPTx 0x7000 +#define bRxHPT2R 0x38000 +#define bRxHPCCKIni 0xc0000 +#define bAGCTxCode 0xc00000 +#define bAGCRxCode 0x300000 + +#define b3WireDataLength 0x800 /* Reg 0x820~84f rFPGA0_XA_HSSIParameter1 */ +#define b3WireAddressLength 0x400 + +#define b3WireRFPowerDown 0x1 /* Useless now + * #define bHWSISelect 0x8 */ +#define b5GPAPEPolarity 0x40000000 +#define b2GPAPEPolarity 0x80000000 +#define bRFSW_TxDefaultAnt 0x3 +#define bRFSW_TxOptionAnt 0x30 +#define bRFSW_RxDefaultAnt 0x300 +#define bRFSW_RxOptionAnt 0x3000 +#define bRFSI_3WireData 0x1 +#define bRFSI_3WireClock 0x2 +#define bRFSI_3WireLoad 0x4 +#define bRFSI_3WireRW 0x8 +#define bRFSI_3Wire 0xf + +#define bRFSI_RFENV 0x10 /* Reg 0x870 rFPGA0_XAB_RFInterfaceSW */ + +#define bRFSI_TRSW 0x20 /* Useless now */ +#define bRFSI_TRSWB 0x40 +#define bRFSI_ANTSW 0x100 +#define bRFSI_ANTSWB 0x200 +#define bRFSI_PAPE 0x400 +#define bRFSI_PAPE5G 0x800 +#define bBandSelect 0x1 +#define bHTSIG2_GI 0x80 +#define bHTSIG2_Smoothing 0x01 +#define bHTSIG2_Sounding 0x02 +#define bHTSIG2_Aggreaton 0x08 +#define bHTSIG2_STBC 0x30 +#define bHTSIG2_AdvCoding 0x40 +#define bHTSIG2_NumOfHTLTF 0x300 +#define bHTSIG2_CRC8 0x3fc +#define bHTSIG1_MCS 0x7f +#define bHTSIG1_BandWidth 0x80 +#define bHTSIG1_HTLength 0xffff +#define bLSIG_Rate 0xf +#define bLSIG_Reserved 0x10 +#define bLSIG_Length 0x1fffe +#define bLSIG_Parity 0x20 +#define bCCKRxPhase 0x4 + +#define bLSSIReadAddress 0x7f800000 /* T65 RF */ + +#define bLSSIReadEdge 0x80000000 /* LSSI "Read" edge signal */ + +#define bLSSIReadBackData 0xfffff /* T65 RF */ + +#define bLSSIReadOKFlag 0x1000 /* Useless now */ +#define bCCKSampleRate 0x8 /* 0: 44MHz, 1:88MHz */ +#define bRegulator0Standby 0x1 +#define bRegulatorPLLStandby 0x2 +#define bRegulator1Standby 0x4 +#define bPLLPowerUp 0x8 +#define bDPLLPowerUp 0x10 +#define bDA10PowerUp 0x20 +#define bAD7PowerUp 0x200 +#define bDA6PowerUp 0x2000 +#define bXtalPowerUp 0x4000 +#define b40MDClkPowerUP 0x8000 +#define bDA6DebugMode 0x20000 +#define bDA6Swing 0x380000 + +#define bADClkPhase 0x4000000 /* Reg 0x880 rFPGA0_AnalogParameter1 20/40 CCK support switch 40/80 BB MHZ */ + +#define b80MClkDelay 0x18000000 /* Useless */ +#define bAFEWatchDogEnable 0x20000000 + +#define bXtalCap01 0xc0000000 /* Reg 0x884 rFPGA0_AnalogParameter2 Crystal cap */ +#define bXtalCap23 0x3 +#define bXtalCap92x 0x0f000000 +#define bXtalCap 0x0f000000 + +#define bIntDifClkEnable 0x400 /* Useless */ +#define bExtSigClkEnable 0x800 +#define bBandgapMbiasPowerUp 0x10000 +#define bAD11SHGain 0xc0000 +#define bAD11InputRange 0x700000 +#define bAD11OPCurrent 0x3800000 +#define bIPathLoopback 0x4000000 +#define bQPathLoopback 0x8000000 +#define bAFELoopback 0x10000000 +#define bDA10Swing 0x7e0 +#define bDA10Reverse 0x800 +#define bDAClkSource 0x1000 +#define bAD7InputRange 0x6000 +#define bAD7Gain 0x38000 +#define bAD7OutputCMMode 0x40000 +#define bAD7InputCMMode 0x380000 +#define bAD7Current 0xc00000 +#define bRegulatorAdjust 0x7000000 +#define bAD11PowerUpAtTx 0x1 +#define bDA10PSAtTx 0x10 +#define bAD11PowerUpAtRx 0x100 +#define bDA10PSAtRx 0x1000 +#define bCCKRxAGCFormat 0x200 +#define bPSDFFTSamplepPoint 0xc000 +#define bPSDAverageNum 0x3000 +#define bIQPathControl 0xc00 +#define bPSDFreq 0x3ff +#define bPSDAntennaPath 0x30 +#define bPSDIQSwitch 0x40 +#define bPSDRxTrigger 0x400000 +#define bPSDTxTrigger 0x80000000 +#define bPSDSineToneScale 0x7f000000 +#define bPSDReport 0xffff + +/* 3. Page9(0x900) */ +#define bOFDMTxSC 0x30000000 /* Useless */ +#define bCCKTxOn 0x1 +#define bOFDMTxOn 0x2 +#define bDebugPage 0xfff /* reset debug page and also HWord, LWord */ +#define bDebugItem 0xff /* reset debug page and LWord */ +#define bAntL 0x10 +#define bAntNonHT 0x100 +#define bAntHT1 0x1000 +#define bAntHT2 0x10000 +#define bAntHT1S1 0x100000 +#define bAntNonHTS1 0x1000000 + +/* 4. PageA(0xA00) */ +#define bCCKBBMode 0x3 /* Useless */ +#define bCCKTxPowerSaving 0x80 +#define bCCKRxPowerSaving 0x40 + +#define bCCKSideBand 0x10 /* Reg 0xa00 rCCK0_System 20/40 switch */ + +#define bCCKScramble 0x8 /* Useless */ +#define bCCKAntDiversity 0x8000 +#define bCCKCarrierRecovery 0x4000 +#define bCCKTxRate 0x3000 +#define bCCKDCCancel 0x0800 +#define bCCKISICancel 0x0400 +#define bCCKMatchFilter 0x0200 +#define bCCKEqualizer 0x0100 +#define bCCKPreambleDetect 0x800000 +#define bCCKFastFalseCCA 0x400000 +#define bCCKChEstStart 0x300000 +#define bCCKCCACount 0x080000 +#define bCCKcs_lim 0x070000 +#define bCCKBistMode 0x80000000 +#define bCCKCCAMask 0x40000000 +#define bCCKTxDACPhase 0x4 +#define bCCKRxADCPhase 0x20000000 /* r_rx_clk */ +#define bCCKr_cp_mode0 0x0100 +#define bCCKTxDCOffset 0xf0 +#define bCCKRxDCOffset 0xf +#define bCCKCCAMode 0xc000 +#define bCCKFalseCS_lim 0x3f00 +#define bCCKCS_ratio 0xc00000 +#define bCCKCorgBit_sel 0x300000 +#define bCCKPD_lim 0x0f0000 +#define bCCKNewCCA 0x80000000 +#define bCCKRxHPofIG 0x8000 +#define bCCKRxIG 0x7f00 +#define bCCKLNAPolarity 0x800000 +#define bCCKRx1stGain 0x7f0000 +#define bCCKRFExtend 0x20000000 /* CCK Rx Iinital gain polarity */ +#define bCCKRxAGCSatLevel 0x1f000000 +#define bCCKRxAGCSatCount 0xe0 +#define bCCKRxRFSettle 0x1f /* AGCsamp_dly */ +#define bCCKFixedRxAGC 0x8000 +/* #define bCCKRxAGCFormat 0x4000 */ /* remove to HSSI register 0x824 */ +#define bCCKAntennaPolarity 0x2000 +#define bCCKTxFilterType 0x0c00 +#define bCCKRxAGCReportType 0x0300 +#define bCCKRxDAGCEn 0x80000000 +#define bCCKRxDAGCPeriod 0x20000000 +#define bCCKRxDAGCSatLevel 0x1f000000 +#define bCCKTimingRecovery 0x800000 +#define bCCKTxC0 0x3f0000 +#define bCCKTxC1 0x3f000000 +#define bCCKTxC2 0x3f +#define bCCKTxC3 0x3f00 +#define bCCKTxC4 0x3f0000 +#define bCCKTxC5 0x3f000000 +#define bCCKTxC6 0x3f +#define bCCKTxC7 0x3f00 +#define bCCKDebugPort 0xff0000 +#define bCCKDACDebug 0x0f000000 +#define bCCKFalseAlarmEnable 0x8000 +#define bCCKFalseAlarmRead 0x4000 +#define bCCKTRSSI 0x7f +#define bCCKRxAGCReport 0xfe +#define bCCKRxReport_AntSel 0x80000000 +#define bCCKRxReport_MFOff 0x40000000 +#define bCCKRxRxReport_SQLoss 0x20000000 +#define bCCKRxReport_Pktloss 0x10000000 +#define bCCKRxReport_Lockedbit 0x08000000 +#define bCCKRxReport_RateError 0x04000000 +#define bCCKRxReport_RxRate 0x03000000 +#define bCCKRxFACounterLower 0xff +#define bCCKRxFACounterUpper 0xff000000 +#define bCCKRxHPAGCStart 0xe000 +#define bCCKRxHPAGCFinal 0x1c00 +#define bCCKRxFalseAlarmEnable 0x8000 +#define bCCKFACounterFreeze 0x4000 +#define bCCKTxPathSel 0x10000000 +#define bCCKDefaultRxPath 0xc000000 +#define bCCKOptionRxPath 0x3000000 + +/* 5. PageC(0xC00) */ +#define bNumOfSTF 0x3 /* Useless */ +#define bShift_L 0xc0 +#define bGI_TH 0xc +#define bRxPathA 0x1 +#define bRxPathB 0x2 +#define bRxPathC 0x4 +#define bRxPathD 0x8 +#define bTxPathA 0x1 +#define bTxPathB 0x2 +#define bTxPathC 0x4 +#define bTxPathD 0x8 +#define bTRSSIFreq 0x200 +#define bADCBackoff 0x3000 +#define bDFIRBackoff 0xc000 +#define bTRSSILatchPhase 0x10000 +#define bRxIDCOffset 0xff +#define bRxQDCOffset 0xff00 +#define bRxDFIRMode 0x1800000 +#define bRxDCNFType 0xe000000 +#define bRXIQImb_A 0x3ff +#define bRXIQImb_B 0xfc00 +#define bRXIQImb_C 0x3f0000 +#define bRXIQImb_D 0xffc00000 +#define bDC_dc_Notch 0x60000 +#define bRxNBINotch 0x1f000000 +#define bPD_TH 0xf +#define bPD_TH_Opt2 0xc000 +#define bPWED_TH 0x700 +#define bIfMF_Win_L 0x800 +#define bPD_Option 0x1000 +#define bMF_Win_L 0xe000 +#define bBW_Search_L 0x30000 +#define bwin_enh_L 0xc0000 +#define bBW_TH 0x700000 +#define bED_TH2 0x3800000 +#define bBW_option 0x4000000 +#define bRatio_TH 0x18000000 +#define bWindow_L 0xe0000000 +#define bSBD_Option 0x1 +#define bFrame_TH 0x1c +#define bFS_Option 0x60 +#define bDC_Slope_check 0x80 +#define bFGuard_Counter_DC_L 0xe00 +#define bFrame_Weight_Short 0x7000 +#define bSub_Tune 0xe00000 +#define bFrame_DC_Length 0xe000000 +#define bSBD_start_offset 0x30000000 +#define bFrame_TH_2 0x7 +#define bFrame_GI2_TH 0x38 +#define bGI2_Sync_en 0x40 +#define bSarch_Short_Early 0x300 +#define bSarch_Short_Late 0xc00 +#define bSarch_GI2_Late 0x70000 +#define bCFOAntSum 0x1 +#define bCFOAcc 0x2 +#define bCFOStartOffset 0xc +#define bCFOLookBack 0x70 +#define bCFOSumWeight 0x80 +#define bDAGCEnable 0x10000 +#define bTXIQImb_A 0x3ff +#define bTXIQImb_B 0xfc00 +#define bTXIQImb_C 0x3f0000 +#define bTXIQImb_D 0xffc00000 +#define bTxIDCOffset 0xff +#define bTxQDCOffset 0xff00 +#define bTxDFIRMode 0x10000 +#define bTxPesudoNoiseOn 0x4000000 +#define bTxPesudoNoise_A 0xff +#define bTxPesudoNoise_B 0xff00 +#define bTxPesudoNoise_C 0xff0000 +#define bTxPesudoNoise_D 0xff000000 +#define bCCADropOption 0x20000 +#define bCCADropThres 0xfff00000 +#define bEDCCA_H 0xf +#define bEDCCA_L 0xf0 +#define bLambda_ED 0x300 +#define bRxInitialGain 0x7f +#define bRxAntDivEn 0x80 +#define bRxAGCAddressForLNA 0x7f00 +#define bRxHighPowerFlow 0x8000 +#define bRxAGCFreezeThres 0xc0000 +#define bRxFreezeStep_AGC1 0x300000 +#define bRxFreezeStep_AGC2 0xc00000 +#define bRxFreezeStep_AGC3 0x3000000 +#define bRxFreezeStep_AGC0 0xc000000 +#define bRxRssi_Cmp_En 0x10000000 +#define bRxQuickAGCEn 0x20000000 +#define bRxAGCFreezeThresMode 0x40000000 +#define bRxOverFlowCheckType 0x80000000 +#define bRxAGCShift 0x7f +#define bTRSW_Tri_Only 0x80 +#define bPowerThres 0x300 +#define bRxAGCEn 0x1 +#define bRxAGCTogetherEn 0x2 +#define bRxAGCMin 0x4 +#define bRxHP_Ini 0x7 +#define bRxHP_TRLNA 0x70 +#define bRxHP_RSSI 0x700 +#define bRxHP_BBP1 0x7000 +#define bRxHP_BBP2 0x70000 +#define bRxHP_BBP3 0x700000 +#define bRSSI_H 0x7f0000 /* the threshold for high power */ +#define bRSSI_Gen 0x7f000000 /* the threshold for ant diversity */ +#define bRxSettle_TRSW 0x7 +#define bRxSettle_LNA 0x38 +#define bRxSettle_RSSI 0x1c0 +#define bRxSettle_BBP 0xe00 +#define bRxSettle_RxHP 0x7000 +#define bRxSettle_AntSW_RSSI 0x38000 +#define bRxSettle_AntSW 0xc0000 +#define bRxProcessTime_DAGC 0x300000 +#define bRxSettle_HSSI 0x400000 +#define bRxProcessTime_BBPPW 0x800000 +#define bRxAntennaPowerShift 0x3000000 +#define bRSSITableSelect 0xc000000 +#define bRxHP_Final 0x7000000 +#define bRxHTSettle_BBP 0x7 +#define bRxHTSettle_HSSI 0x8 +#define bRxHTSettle_RxHP 0x70 +#define bRxHTSettle_BBPPW 0x80 +#define bRxHTSettle_Idle 0x300 +#define bRxHTSettle_Reserved 0x1c00 +#define bRxHTRxHPEn 0x8000 +#define bRxHTAGCFreezeThres 0x30000 +#define bRxHTAGCTogetherEn 0x40000 +#define bRxHTAGCMin 0x80000 +#define bRxHTAGCEn 0x100000 +#define bRxHTDAGCEn 0x200000 +#define bRxHTRxHP_BBP 0x1c00000 +#define bRxHTRxHP_Final 0xe0000000 +#define bRxPWRatioTH 0x3 +#define bRxPWRatioEn 0x4 +#define bRxMFHold 0x3800 +#define bRxPD_Delay_TH1 0x38 +#define bRxPD_Delay_TH2 0x1c0 +#define bRxPD_DC_COUNT_MAX 0x600 +/* #define bRxMF_Hold 0x3800 */ +#define bRxPD_Delay_TH 0x8000 +#define bRxProcess_Delay 0xf0000 +#define bRxSearchrange_GI2_Early 0x700000 +#define bRxFrame_Guard_Counter_L 0x3800000 +#define bRxSGI_Guard_L 0xc000000 +#define bRxSGI_Search_L 0x30000000 +#define bRxSGI_TH 0xc0000000 +#define bDFSCnt0 0xff +#define bDFSCnt1 0xff00 +#define bDFSFlag 0xf0000 +#define bMFWeightSum 0x300000 +#define bMinIdxTH 0x7f000000 +#define bDAFormat 0x40000 +#define bTxChEmuEnable 0x01000000 +#define bTRSWIsolation_A 0x7f +#define bTRSWIsolation_B 0x7f00 +#define bTRSWIsolation_C 0x7f0000 +#define bTRSWIsolation_D 0x7f000000 +#define bExtLNAGain 0x7c00 + +/* 6. PageE(0xE00) */ +#define bSTBCEn 0x4 /* Useless */ +#define bAntennaMapping 0x10 +#define bNss 0x20 +#define bCFOAntSumD 0x200 +#define bPHYCounterReset 0x8000000 +#define bCFOReportGet 0x4000000 +#define bOFDMContinueTx 0x10000000 +#define bOFDMSingleCarrier 0x20000000 +#define bOFDMSingleTone 0x40000000 +/* #define bRxPath1 0x01 */ +/* #define bRxPath2 0x02 */ +/* #define bRxPath3 0x04 */ +/* #define bRxPath4 0x08 */ +/* #define bTxPath1 0x10 */ +/* #define bTxPath2 0x20 */ +#define bHTDetect 0x100 +#define bCFOEn 0x10000 +#define bCFOValue 0xfff00000 +#define bSigTone_Re 0x3f +#define bSigTone_Im 0x7f00 +#define bCounter_CCA 0xffff +#define bCounter_ParityFail 0xffff0000 +#define bCounter_RateIllegal 0xffff +#define bCounter_CRC8Fail 0xffff0000 +#define bCounter_MCSNoSupport 0xffff +#define bCounter_FastSync 0xffff +#define bShortCFO 0xfff +#define bShortCFOTLength 12 /* total */ +#define bShortCFOFLength 11 /* fraction */ +#define bLongCFO 0x7ff +#define bLongCFOTLength 11 +#define bLongCFOFLength 11 +#define bTailCFO 0x1fff +#define bTailCFOTLength 13 +#define bTailCFOFLength 12 +#define bmax_en_pwdB 0xffff +#define bCC_power_dB 0xffff0000 +#define bnoise_pwdB 0xffff +#define bPowerMeasTLength 10 +#define bPowerMeasFLength 3 +#define bRx_HT_BW 0x1 +#define bRxSC 0x6 +#define bRx_HT 0x8 +#define bNB_intf_det_on 0x1 +#define bIntf_win_len_cfg 0x30 +#define bNB_Intf_TH_cfg 0x1c0 +#define bRFGain 0x3f +#define bTableSel 0x40 +#define bTRSW 0x80 +#define bRxSNR_A 0xff +#define bRxSNR_B 0xff00 +#define bRxSNR_C 0xff0000 +#define bRxSNR_D 0xff000000 +#define bSNREVMTLength 8 +#define bSNREVMFLength 1 +#define bCSI1st 0xff +#define bCSI2nd 0xff00 +#define bRxEVM1st 0xff0000 +#define bRxEVM2nd 0xff000000 +#define bSIGEVM 0xff +#define bPWDB 0xff00 +#define bSGIEN 0x10000 + +#define bSFactorQAM1 0xf /* Useless */ +#define bSFactorQAM2 0xf0 +#define bSFactorQAM3 0xf00 +#define bSFactorQAM4 0xf000 +#define bSFactorQAM5 0xf0000 +#define bSFactorQAM6 0xf0000 +#define bSFactorQAM7 0xf00000 +#define bSFactorQAM8 0xf000000 +#define bSFactorQAM9 0xf0000000 +#define bCSIScheme 0x100000 + +#define bNoiseLvlTopSet 0x3 /* Useless */ +#define bChSmooth 0x4 +#define bChSmoothCfg1 0x38 +#define bChSmoothCfg2 0x1c0 +#define bChSmoothCfg3 0xe00 +#define bChSmoothCfg4 0x7000 +#define bMRCMode 0x800000 +#define bTHEVMCfg 0x7000000 + +#define bLoopFitType 0x1 /* Useless */ +#define bUpdCFO 0x40 +#define bUpdCFOOffData 0x80 +#define bAdvUpdCFO 0x100 +#define bAdvTimeCtrl 0x800 +#define bUpdClko 0x1000 +#define bFC 0x6000 +#define bTrackingMode 0x8000 +#define bPhCmpEnable 0x10000 +#define bUpdClkoLTF 0x20000 +#define bComChCFO 0x40000 +#define bCSIEstiMode 0x80000 +#define bAdvUpdEqz 0x100000 +#define bUChCfg 0x7000000 +#define bUpdEqz 0x8000000 + +/* Rx Pseduo noise */ +#define bRxPesudoNoiseOn 0x20000000 /* Useless */ +#define bRxPesudoNoise_A 0xff +#define bRxPesudoNoise_B 0xff00 +#define bRxPesudoNoise_C 0xff0000 +#define bRxPesudoNoise_D 0xff000000 +#define bPesudoNoiseState_A 0xffff +#define bPesudoNoiseState_B 0xffff0000 +#define bPesudoNoiseState_C 0xffff +#define bPesudoNoiseState_D 0xffff0000 + +/* 7. RF Register + * Zebra1 */ +#define bZebra1_HSSIEnable 0x8 /* Useless */ +#define bZebra1_TRxControl 0xc00 +#define bZebra1_TRxGainSetting 0x07f +#define bZebra1_RxCorner 0xc00 +#define bZebra1_TxChargePump 0x38 +#define bZebra1_RxChargePump 0x7 +#define bZebra1_ChannelNum 0xf80 +#define bZebra1_TxLPFBW 0x400 +#define bZebra1_RxLPFBW 0x600 + +/* Zebra4 */ +#define bRTL8256RegModeCtrl1 0x100 /* Useless */ +#define bRTL8256RegModeCtrl0 0x40 +#define bRTL8256_TxLPFBW 0x18 +#define bRTL8256_RxLPFBW 0x600 + +/* RTL8258 */ +#define bRTL8258_TxLPFBW 0xc /* Useless */ +#define bRTL8258_RxLPFBW 0xc00 +#define bRTL8258_RSSILPFBW 0xc0 + + +/* + * Other Definition + * */ + +/* byte endable for sb_write */ +#define bByte0 0x1 /* Useless */ +#define bByte1 0x2 +#define bByte2 0x4 +#define bByte3 0x8 +#define bWord0 0x3 +#define bWord1 0xc +#define bDWord 0xf + +/* for PutRegsetting & GetRegSetting BitMask */ +#define bMaskByte0 0xff /* Reg 0xc50 rOFDM0_XAAGCCore~0xC6f */ +#define bMaskByte1 0xff00 +#define bMaskByte2 0xff0000 +#define bMaskByte3 0xff000000 +#define bMaskHWord 0xffff0000 +#define bMaskLWord 0x0000ffff +#define bMaskDWord 0xffffffff +#define bMaskH3Bytes 0xffffff00 +#define bMask12Bits 0xfff +#define bMaskH4Bits 0xf0000000 +#define bMaskOFDM_D 0xffc00000 +#define bMaskCCK 0x3f3f3f3f + + +#define bEnable 0x1 /* Useless */ +#define bDisable 0x0 + +#define LeftAntenna 0x0 /* Useless */ +#define RightAntenna 0x1 + +#define tCheckTxStatus 500 /* 500ms // Useless */ +#define tUpdateRxCounter 100 /* 100ms */ + +#define rateCCK 0 /* Useless */ +#define rateOFDM 1 +#define rateHT 2 + +/* define Register-End */ +#define bPMAC_End 0x1ff /* Useless */ +#define bFPGAPHY0_End 0x8ff +#define bFPGAPHY1_End 0x9ff +#define bCCKPHY0_End 0xaff +#define bOFDMPHY0_End 0xcff +#define bOFDMPHY1_End 0xdff + +/* define max debug item in each debug page + * #define bMaxItem_FPGA_PHY0 0x9 + * #define bMaxItem_FPGA_PHY1 0x3 + * #define bMaxItem_PHY_11B 0x16 + * #define bMaxItem_OFDM_PHY0 0x29 + * #define bMaxItem_OFDM_PHY1 0x0 */ + +#define bPMACControl 0x0 /* Useless */ +#define bWMACControl 0x1 +#define bWNICControl 0x2 + +#define PathA 0x0 /* Useless */ +#define PathB 0x1 +#define PathC 0x2 +#define PathD 0x3 + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8710BPwrSeq.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8710BPwrSeq.h new file mode 100644 index 000000000000..8a88d07eafc1 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8710BPwrSeq.h @@ -0,0 +1,168 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * 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_8710B +#define REALTEK_POWER_SEQUENCE_8710B + +/* #include "PwrSeqCmd.h" */ +#include "HalPwrSeqCmd.h" + +/* + Check document WM-20110607-Paul-RTL8192e_Power_Architecture-R02.vsd + There are 6 HW Power States: + 0: POFF--Power Off + 1: PDN--Power Down + 2: CARDEMU--Card Emulation + 3: ACT--Active Mode + 4: LPS--Low Power State + 5: SUS--Suspend + + The transition from different states are defined below + TRANS_CARDEMU_TO_ACT + TRANS_ACT_TO_CARDEMU + TRANS_CARDEMU_TO_SUS + TRANS_SUS_TO_CARDEMU + TRANS_CARDEMU_TO_PDN + TRANS_ACT_TO_LPS + TRANS_LPS_TO_ACT + + TRANS_END +*/ +#define RTL8710B_TRANS_CARDEMU_TO_ACT_STEPS 5 +#define RTL8710B_TRANS_ACT_TO_CARDEMU_STEPS 4 +#define RTL8710B_TRANS_CARDEMU_TO_SUS_STEPS 7 +#define RTL8710B_TRANS_SUS_TO_CARDEMU_STEPS 15 +#define RTL8710B_TRANS_CARDEMU_TO_PDN_STEPS 15 +#define RTL8710B_TRANS_PDN_TO_CARDEMU_STEPS 15 +#define RTL8710B_TRANS_ACT_TO_LPS_STEPS 15 +#define RTL8710B_TRANS_LPS_TO_ACT_STEPS 15 +#define RTL8710B_TRANS_ACT_TO_SWLPS_STEPS 22 +#define RTL8710B_TRANS_SWLPS_TO_ACT_STEPS 15 +#define RTL8710B_TRANS_END_STEPS 1 + + +#define RTL8710B_TRANS_CARDEMU_TO_ACT \ + /* format */ \ + /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ + {0x005D, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/*AFE power mode selection:1: LDO mode ,0: Power-cut mode*/\ + {0x0004, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 1},\ + {0x0056, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x0E},\ + {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 1},\ + {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT0, 0},/**/ + + +#define RTL8710B_TRANS_ACT_TO_CARDEMU \ + /* format */ \ + /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ + /*{0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0}, */ /*0x1F[7:0] = 0 turn off RF*/ \ + {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, (BIT0|BIT1|BIT2), 0},/*0x04[24:26] = 0 turn off RF*/ \ + {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, (BIT0|BIT1), 0},/*0x04[16:17] = 0 BB reset*/ \ + {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1}, /*0x20[1] = 1 turn off MAC by HW state machine*/ \ + {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT1, 0}, /*wait till 0x20[1] = 0 polling until return 0 to disable*/ \ + + +#define RTL8710B_TRANS_CARDEMU_TO_SUS \ + /* format */ \ + /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ + {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4|BIT3, (BIT4|BIT3)}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ + {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK|PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, BIT3}, /*0x04[12:11] = 2b'01 enable WL suspend*/ \ + {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ + {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SDIO SOP option to disable BG/MB/ACK/SWR*/ \ + {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, BIT3|BIT4}, /*0x04[12:11] = 2b'11 enable WL suspend for PCIe*/ \ + {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, BIT0}, /*Set SDIO suspend local register*/ \ + {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, 0}, /*wait power state to suspend*/ + +#define RTL8710B_TRANS_SUS_TO_CARDEMU \ + /* format */ \ + /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ + {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3 | BIT7, 0}, /*clear suspend enable and power down enable*/ \ + {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, BIT0, 0}, /*Set SDIO suspend local register*/ \ + {0x0086, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_POLLING, BIT1, BIT1}, /*wait power state to suspend*/\ + {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*0x23[4] = 1b'0 12H LDO enter normal mode*/ \ + {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3|BIT4, 0}, /*0x04[12:11] = 2b'01enable WL suspend*/ + + +#define RTL8710B_TRANS_CARDEMU_TO_CARDDIS \ + /* format */ \ + /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ + +#define RTL8710B_TRANS_CARDDIS_TO_CARDEMU \ + /* format */ \ + /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ + + +#define RTL8710B_TRANS_CARDEMU_TO_PDN \ + /* format */ \ + /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ + {0x0023, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, BIT4}, /*0x23[4] = 1b'1 12H LDO enter sleep mode*/ \ + {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK|PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x20}, /*0x07[7:0] = 0x20 SOP option to disable BG/MB/ACK/SWR*/ \ + {0x0006, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/* 0x04[16] = 0*/\ + {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, BIT7},/* 0x04[15] = 1*/ + +#define RTL8710B_TRANS_PDN_TO_CARDEMU \ + /* format */ \ + /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ + {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT7, 0},/* 0x04[15] = 0*/ + +#define RTL8710B_TRANS_ACT_TO_LPS \ + /* format */ \ + /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ + {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF},/*PCIe DMA stop*/ \ + {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF},/*Tx Pause*/ \ + {0x05F8, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ + {0x05F9, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ + {0x05FA, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ + {0x05FB, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, 0xFF, 0},/*Should be zero if no packet is transmitting*/ \ + {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled,and clock are gated*/ \ + {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ + {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*Whole BB is reset*/ \ + {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x03},/*Reset MAC TRX*/ \ + {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ + {0x0093, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x00},/*When driver enter Sus/ Disable, enable LOP for BT*/ \ + {0x0553, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT5, BIT5},/*Respond TxOK to scheduler*/ + + +#define RTL8710B_TRANS_LPS_TO_ACT \ + /* format */ \ + /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ + {0x0080, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_SDIO_MSK,PWR_BASEADDR_SDIO,PWR_CMD_WRITE, 0xFF, 0x84}, /*SDIO RPWM*/\ + {0xFE58, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x84}, /*USB RPWM*/\ + {0x0361, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0x84}, /*PCIe RPWM*/\ + {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_DELAY, 0, PWRSEQ_DELAY_MS}, /*Delay*/\ + {0x0008, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT4, 0}, /*. 0x08[4] = 0 switch TSF to 40M*/\ + {0x0109, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_POLLING, BIT7, 0}, /*Polling 0x109[7]=0 TSF in 40M*/\ + {0x0029, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT6|BIT7, 0}, /*. 0x29[7:6] = 2b'00 enable BB clock*/\ + {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1*/\ + {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/\ + {0x0002, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1|BIT0, BIT1|BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/\ + {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ + +#define RTL8710B_TRANS_END \ + /* format */ \ + /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, // comments here*/ \ + {0xFFFF, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,0,PWR_CMD_END, 0, 0}, // + + +extern WLAN_PWR_CFG rtl8710B_power_on_flow[RTL8710B_TRANS_CARDEMU_TO_ACT_STEPS+RTL8710B_TRANS_END_STEPS]; +extern WLAN_PWR_CFG rtl8710B_radio_off_flow[RTL8710B_TRANS_ACT_TO_CARDEMU_STEPS+RTL8710B_TRANS_END_STEPS]; +extern WLAN_PWR_CFG rtl8710B_card_disable_flow[RTL8710B_TRANS_ACT_TO_CARDEMU_STEPS+RTL8710B_TRANS_CARDEMU_TO_PDN_STEPS+RTL8710B_TRANS_END_STEPS]; +extern WLAN_PWR_CFG rtl8710B_card_enable_flow[RTL8710B_TRANS_ACT_TO_CARDEMU_STEPS+RTL8710B_TRANS_CARDEMU_TO_PDN_STEPS+RTL8710B_TRANS_END_STEPS]; +extern WLAN_PWR_CFG rtl8710B_suspend_flow[RTL8710B_TRANS_ACT_TO_CARDEMU_STEPS+RTL8710B_TRANS_CARDEMU_TO_SUS_STEPS+RTL8710B_TRANS_END_STEPS]; +extern WLAN_PWR_CFG rtl8710B_resume_flow[RTL8710B_TRANS_SUS_TO_CARDEMU_STEPS+RTL8710B_TRANS_CARDEMU_TO_ACT_STEPS+RTL8710B_TRANS_END_STEPS]; +extern WLAN_PWR_CFG rtl8710B_hwpdn_flow[RTL8710B_TRANS_ACT_TO_CARDEMU_STEPS+RTL8710B_TRANS_CARDEMU_TO_PDN_STEPS+RTL8710B_TRANS_END_STEPS]; +extern WLAN_PWR_CFG rtl8710B_enter_lps_flow[RTL8710B_TRANS_ACT_TO_LPS_STEPS+RTL8710B_TRANS_END_STEPS]; +extern WLAN_PWR_CFG rtl8710B_leave_lps_flow[RTL8710B_TRANS_LPS_TO_ACT_STEPS+RTL8710B_TRANS_END_STEPS]; + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8723BPhyCfg.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8723BPhyCfg.h index 0fa896427a01..4dad48fcde6a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8723BPhyCfg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8723BPhyCfg.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -44,34 +40,34 @@ /*--------------------------Exported Function prototype---------------------*/ u32 PHY_QueryBBReg_8723B( - IN PADAPTER Adapter, - IN u32 RegAddr, - IN u32 BitMask + PADAPTER Adapter, + u32 RegAddr, + u32 BitMask ); -VOID +void PHY_SetBBReg_8723B( - IN PADAPTER Adapter, - IN u32 RegAddr, - IN u32 BitMask, - IN u32 Data + PADAPTER Adapter, + u32 RegAddr, + u32 BitMask, + u32 Data ); u32 PHY_QueryRFReg_8723B( - IN PADAPTER Adapter, - IN u8 eRFPath, - IN u32 RegAddr, - IN u32 BitMask + PADAPTER Adapter, + enum rf_path eRFPath, + u32 RegAddr, + u32 BitMask ); -VOID +void PHY_SetRFReg_8723B( - IN PADAPTER Adapter, - IN u8 eRFPath, - IN u32 RegAddr, - IN u32 BitMask, - IN u32 Data + PADAPTER Adapter, + enum rf_path eRFPath, + u32 RegAddr, + u32 BitMask, + u32 Data ); /* MAC/BB/RF HAL config */ @@ -83,53 +79,47 @@ s32 PHY_MACConfig8723B(PADAPTER padapter); int PHY_ConfigRFWithParaFile_8723B( - IN PADAPTER Adapter, - IN u8 *pFileName, - RF_PATH eRFPath + PADAPTER Adapter, + u8 *pFileName, + enum rf_path eRFPath ); -VOID +void PHY_SetTxPowerIndex_8723B( - IN PADAPTER Adapter, - IN u32 PowerIndex, - IN u8 RFPath, - IN u8 Rate + PADAPTER Adapter, + u32 PowerIndex, + enum rf_path RFPath, + u8 Rate ); u8 PHY_GetTxPowerIndex_8723B( - IN PADAPTER pAdapter, - IN u8 RFPath, - IN u8 Rate, - IN u8 BandWidth, - IN u8 Channel, + PADAPTER pAdapter, + enum rf_path RFPath, + u8 Rate, + u8 BandWidth, + u8 Channel, struct txpwr_idx_comp *tic ); -VOID -PHY_GetTxPowerLevel8723B( - IN PADAPTER Adapter, - OUT s32 *powerlevel -); - -VOID +void PHY_SetTxPowerLevel8723B( - IN PADAPTER Adapter, - IN u8 channel + PADAPTER Adapter, + u8 channel ); -VOID +void PHY_SetSwChnlBWMode8723B( - IN PADAPTER Adapter, - IN u8 channel, - IN CHANNEL_WIDTH Bandwidth, - IN u8 Offset40, - IN u8 Offset80 + PADAPTER Adapter, + u8 channel, + enum channel_width Bandwidth, + u8 Offset40, + u8 Offset80 ); -VOID phy_set_rf_path_switch_8723b( - IN PADAPTER pAdapter, - IN bool bMain +void phy_set_rf_path_switch_8723b( + struct dm_struct *phydm, + bool bMain ); /*--------------------------Exported Function prototype End---------------------*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8723BPhyReg.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8723BPhyReg.h index 551c0a5e3b9f..a816352009e2 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8723BPhyReg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8723BPhyReg.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/Hal8723BPwrSeq.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8723BPwrSeq.h index d18d064dae0e..26a6cf8744e9 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8723BPwrSeq.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8723BPwrSeq.h @@ -1,4 +1,18 @@ /* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * 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/rtl8188eu/include/Hal8723DPhyCfg.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8723DPhyCfg.h index f3ce1706ef48..0c09143ea972 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8723DPhyCfg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8723DPhyCfg.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -44,34 +40,34 @@ /*--------------------------Exported Function prototype---------------------*/ u32 PHY_QueryBBReg_8723D( - IN PADAPTER Adapter, - IN u32 RegAddr, - IN u32 BitMask + PADAPTER Adapter, + u32 RegAddr, + u32 BitMask ); -VOID +void PHY_SetBBReg_8723D( - IN PADAPTER Adapter, - IN u32 RegAddr, - IN u32 BitMask, - IN u32 Data + PADAPTER Adapter, + u32 RegAddr, + u32 BitMask, + u32 Data ); u32 PHY_QueryRFReg_8723D( - IN PADAPTER Adapter, - IN u8 eRFPath, - IN u32 RegAddr, - IN u32 BitMask + PADAPTER Adapter, + enum rf_path eRFPath, + u32 RegAddr, + u32 BitMask ); -VOID +void PHY_SetRFReg_8723D( - IN PADAPTER Adapter, - IN u8 eRFPath, - IN u32 RegAddr, - IN u32 BitMask, - IN u32 Data + PADAPTER Adapter, + enum rf_path eRFPath, + u32 RegAddr, + u32 BitMask, + u32 Data ); /* MAC/BB/RF HAL config */ @@ -83,53 +79,47 @@ s32 PHY_MACConfig8723D(PADAPTER padapter); int PHY_ConfigRFWithParaFile_8723D( - IN PADAPTER Adapter, - IN u8 *pFileName, - RF_PATH eRFPath + PADAPTER Adapter, + u8 *pFileName, + enum rf_path eRFPath ); -VOID +void PHY_SetTxPowerIndex_8723D( - IN PADAPTER Adapter, - IN u32 PowerIndex, - IN u8 RFPath, - IN u8 Rate + PADAPTER Adapter, + u32 PowerIndex, + enum rf_path RFPath, + u8 Rate ); u8 PHY_GetTxPowerIndex_8723D( - IN PADAPTER pAdapter, - IN u8 RFPath, - IN u8 Rate, - IN u8 BandWidth, - IN u8 Channel, + PADAPTER pAdapter, + enum rf_path RFPath, + u8 Rate, + u8 BandWidth, + u8 Channel, struct txpwr_idx_comp *tic ); -VOID -PHY_GetTxPowerLevel8723D( - IN PADAPTER Adapter, - OUT s32 *powerlevel -); - -VOID +void PHY_SetTxPowerLevel8723D( - IN PADAPTER Adapter, - IN u8 channel + PADAPTER Adapter, + u8 channel ); -VOID +void PHY_SetSwChnlBWMode8723D( - IN PADAPTER Adapter, - IN u8 channel, - IN CHANNEL_WIDTH Bandwidth, - IN u8 Offset40, - IN u8 Offset80 + PADAPTER Adapter, + u8 channel, + enum channel_width Bandwidth, + u8 Offset40, + u8 Offset80 ); -VOID phy_set_rf_path_switch_8723d( - IN PADAPTER pAdapter, - IN bool bMain +void phy_set_rf_path_switch_8723d( + struct dm_struct *phydm, + bool bMain ); /*--------------------------Exported Function prototype End---------------------*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8723DPhyReg.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8723DPhyReg.h index 9fb0cc1c795b..f8b190dc790b 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8723DPhyReg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8723DPhyReg.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/Hal8723DPwrSeq.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8723DPwrSeq.h index 74debbaac9ee..021c414c5a94 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8723DPwrSeq.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8723DPwrSeq.h @@ -1,4 +1,18 @@ /* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * 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 @@ -43,7 +57,6 @@ /* format */ \ /* { offset, cut_msk, fab_msk|interface_msk, base|cmd, msk, value }, / comments here*/ \ {0x0020, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(0), BIT(0)}, /*0x20[0] = 1b'1 enable LDOA12 MACRO block for all interface*/ \ - {0x0067, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(4), 0}, /*0x67[0] = 0 to disable BT_GPS_SEL pins*/ \ {0x0001, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 1, PWRSEQ_DELAY_MS},/*Delay 1ms*/ \ {0x0000, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK | PWR_INTF_SDIO_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT(5), 0}, /*0x00[5] = 1b'0 release analog Ips to digital ,1:isolation*/ \ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, (BIT(4) | BIT(3) | BIT2), 0},/* disable SW LPS 0x04[10]=0 and WLSUS_EN 0x04[11]=0*/ \ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8723PwrSeq.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8723PwrSeq.h index e463f74b7ae3..22d600607d9b 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8723PwrSeq.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8723PwrSeq.h @@ -1,4 +1,18 @@ /* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * 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/rtl8188eu/include/Hal8812PhyCfg.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8812PhyCfg.h index 05a5fe2ebfe8..9e817563bcc0 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8812PhyCfg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8812PhyCfg.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -58,90 +54,88 @@ /* * BB and RF register read/write * */ -u32 PHY_QueryBBReg8812(IN PADAPTER Adapter, - IN u32 RegAddr, - IN u32 BitMask); -void PHY_SetBBReg8812(IN PADAPTER Adapter, - IN u32 RegAddr, - IN u32 BitMask, - IN u32 Data); -u32 PHY_QueryRFReg8812(IN PADAPTER Adapter, - IN u8 eRFPath, - IN u32 RegAddr, - IN u32 BitMask); -void PHY_SetRFReg8812(IN PADAPTER Adapter, - IN u8 eRFPath, - IN u32 RegAddr, - IN u32 BitMask, - IN u32 Data); +u32 PHY_QueryBBReg8812(PADAPTER Adapter, + u32 RegAddr, + u32 BitMask); +void PHY_SetBBReg8812(PADAPTER Adapter, + u32 RegAddr, + u32 BitMask, + u32 Data); +u32 PHY_QueryRFReg8812(PADAPTER Adapter, + enum rf_path eRFPath, + u32 RegAddr, + u32 BitMask); +void PHY_SetRFReg8812(PADAPTER Adapter, + enum rf_path eRFPath, + u32 RegAddr, + u32 BitMask, + u32 Data); /* * Initialization related function * * MAC/BB/RF HAL config */ -int PHY_MACConfig8812(IN PADAPTER Adapter); -int PHY_BBConfig8812(IN PADAPTER Adapter); -void PHY_BB8812_Config_1T(IN PADAPTER Adapter); -int PHY_RFConfig8812(IN PADAPTER Adapter); +int PHY_MACConfig8812(PADAPTER Adapter); +int PHY_BBConfig8812(PADAPTER Adapter); +void PHY_BB8812_Config_1T(PADAPTER Adapter); +int PHY_RFConfig8812(PADAPTER Adapter); /* RF config */ s32 PHY_SwitchWirelessBand8812( - IN PADAPTER Adapter, - IN u8 Band + PADAPTER Adapter, + u8 Band ); /* * BB TX Power R/W * */ -void PHY_GetTxPowerLevel8812(IN PADAPTER Adapter, OUT s32 *powerlevel); -void PHY_SetTxPowerLevel8812(IN PADAPTER Adapter, IN u8 Channel); +void PHY_SetTxPowerLevel8812(PADAPTER Adapter, u8 Channel); -BOOLEAN PHY_UpdateTxPowerDbm8812(IN PADAPTER Adapter, IN int powerInDbm); u8 PHY_GetTxPowerIndex_8812A( - IN PADAPTER pAdapter, - IN u8 RFPath, - IN u8 Rate, - IN u8 BandWidth, - IN u8 Channel, + PADAPTER pAdapter, + enum rf_path RFPath, + u8 Rate, + u8 BandWidth, + u8 Channel, struct txpwr_idx_comp *tic ); u32 phy_get_tx_bb_swing_8812a( - IN PADAPTER Adapter, - IN BAND_TYPE Band, - IN u8 RFPath + PADAPTER Adapter, + BAND_TYPE Band, + enum rf_path RFPath ); -VOID +void PHY_SetTxPowerIndex_8812A( - IN PADAPTER Adapter, - IN u4Byte PowerIndex, - IN u1Byte RFPath, - IN u1Byte Rate + PADAPTER Adapter, + u32 PowerIndex, + enum rf_path RFPath, + u8 Rate ); /* * channel switch related funciton * */ -VOID +void PHY_SetSwChnlBWMode8812( - IN PADAPTER Adapter, - IN u8 channel, - IN CHANNEL_WIDTH Bandwidth, - IN u8 Offset40, - IN u8 Offset80 + PADAPTER Adapter, + u8 channel, + enum channel_width Bandwidth, + u8 Offset40, + u8 Offset80 ); /* * BB/MAC/RF other monitor API * */ -VOID +void phy_set_rf_path_switch_8812a( - IN PADAPTER pAdapter, - IN bool bMain + struct dm_struct *phydm, + bool bMain ); /*--------------------------Exported Function prototype---------------------*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8812PhyReg.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8812PhyReg.h index 50097500b379..e53bde42c283 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8812PhyReg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8812PhyReg.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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-------------------------------*/ @@ -168,6 +164,8 @@ #define rB_RFE_Inv_Jaguar 0xeb4 /* Path_B RFE control */ #define rA_RFE_Jaguar 0xcb8 /* Path_A RFE cotrol */ #define rB_RFE_Jaguar 0xeb8 /* Path_B RFE control */ +#define rA_RFE_Inverse_Jaguar 0xCBC /* Path_A RFE control inverse */ +#define rB_RFE_Inverse_Jaguar 0xEBC /* Path_B RFE control inverse */ #define r_ANTSEL_SW_Jaguar 0x900 /* ANTSEL SW Control */ #define bMask_RFEInv_Jaguar 0x3ff00000 #define bMask_AntselPathFollow_Jaguar 0x00030000 diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8812PwrSeq.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8812PwrSeq.h index e089c1a9d4c0..28758abc8690 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8812PwrSeq.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8812PwrSeq.h @@ -1,7 +1,7 @@ - +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,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 +60,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 +141,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/rtl8188eu/include/Hal8814PhyCfg.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8814PhyCfg.h index 9aaaf38fad7a..317cd96a4ffe 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8814PhyCfg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8814PhyCfg.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -60,52 +56,52 @@ /* 1. BB register R/W API */ extern u32 -PHY_QueryBBReg8814A(IN PADAPTER Adapter, - IN u32 RegAddr, - IN u32 BitMask); - - -VOID -PHY_SetBBReg8814A(IN PADAPTER Adapter, - IN u32 RegAddr, - IN u32 BitMask, - IN u32 Data); - - -extern u32 -PHY_QueryRFReg8814A(IN PADAPTER Adapter, - IN u8 eRFPath, - IN u32 RegAddr, - IN u32 BitMask); +PHY_QueryBBReg8814A(PADAPTER Adapter, + u32 RegAddr, + u32 BitMask); void -PHY_SetRFReg8814A(IN PADAPTER Adapter, - IN u8 eRFPath, - IN u32 RegAddr, - IN u32 BitMask, - IN u32 Data); +PHY_SetBBReg8814A(PADAPTER Adapter, + u32 RegAddr, + u32 BitMask, + u32 Data); + + +extern u32 +PHY_QueryRFReg8814A(PADAPTER Adapter, + enum rf_path eRFPath, + u32 RegAddr, + u32 BitMask); + + +void +PHY_SetRFReg8814A(PADAPTER Adapter, + enum rf_path eRFPath, + u32 RegAddr, + u32 BitMask, + u32 Data); /* 1 3. Initial BB/RF config by reading MAC/BB/RF txt. */ s32 phy_BB8814A_Config_ParaFile( - IN PADAPTER Adapter + PADAPTER Adapter ); -VOID +void PHY_ConfigBB_8814A( - IN PADAPTER Adapter + PADAPTER Adapter ); -VOID +void phy_ADC_CLK_8814A( - IN PADAPTER Adapter + PADAPTER Adapter ); s32 PHY_RFConfig8814A( - IN PADAPTER Adapter + PADAPTER Adapter ); /* @@ -115,151 +111,137 @@ PHY_RFConfig8814A( /* 1 5. Tx Power setting API */ -VOID -PHY_GetTxPowerLevel8814( - IN PADAPTER Adapter, - OUT ps4Byte powerlevel -); - -VOID +void PHY_SetTxPowerLevel8814( - IN PADAPTER Adapter, - IN u8 Channel + PADAPTER Adapter, + u8 Channel ); u8 phy_get_tx_power_index_8814a( - IN PADAPTER Adapter, - IN u8 RFPath, - IN u8 Rate, - IN CHANNEL_WIDTH BandWidth, - IN u8 Channel + PADAPTER Adapter, + enum rf_path RFPath, + u8 Rate, + enum channel_width BandWidth, + u8 Channel ); u8 PHY_GetTxPowerIndex8814A( - IN PADAPTER Adapter, - IN u8 RFPath, - IN u8 Rate, - IN u8 BandWidth, - IN u8 Channel, + PADAPTER Adapter, + enum rf_path RFPath, + u8 Rate, + u8 BandWidth, + u8 Channel, struct txpwr_idx_comp *tic ); -VOID +void PHY_SetTxPowerIndex_8814A( - IN PADAPTER Adapter, - IN u32 PowerIndex, - IN u8 RFPath, - IN u8 Rate + PADAPTER Adapter, + u32 PowerIndex, + enum rf_path RFPath, + u8 Rate ); - -BOOLEAN -PHY_UpdateTxPowerDbm8814A( - IN PADAPTER Adapter, - IN s4Byte powerInDbm -); - - u32 PHY_GetTxBBSwing_8814A( - IN PADAPTER Adapter, - IN BAND_TYPE Band, - IN u8 RFPath + PADAPTER Adapter, + BAND_TYPE Band, + enum rf_path RFPath ); /* 1 6. Channel setting API */ - -VOID +#if 0 +void PHY_SwChnlTimerCallback8814A( - IN struct timer_list *p_timer + struct timer_list *p_timer ); - -VOID +#endif +void PHY_SwChnlWorkItemCallback8814A( - IN PVOID pContext + void *pContext ); -VOID +void HAL_HandleSwChnl8814A( - IN PADAPTER pAdapter, - IN u8 channel + PADAPTER pAdapter, + u8 channel ); -VOID -PHY_SwChnlSynchronously8814A(IN PADAPTER pAdapter, - IN u8 channel); +void +PHY_SwChnlSynchronously8814A(PADAPTER pAdapter, + u8 channel); -VOID -PHY_SwChnlAndSetBWModeCallback8814A(IN PVOID pContext); +void +PHY_SwChnlAndSetBWModeCallback8814A(void *pContext); -VOID +void PHY_HandleSwChnlAndSetBW8814A( - IN PADAPTER Adapter, - IN BOOLEAN bSwitchChannel, - IN BOOLEAN bSetBandWidth, - IN u8 ChannelNum, - IN CHANNEL_WIDTH ChnlWidth, - IN u8 ChnlOffsetOf40MHz, - IN u8 ChnlOffsetOf80MHz, - IN u8 CenterFrequencyIndex1 + PADAPTER Adapter, + BOOLEAN bSwitchChannel, + BOOLEAN bSetBandWidth, + u8 ChannelNum, + enum channel_width ChnlWidth, + u8 ChnlOffsetOf40MHz, + u8 ChnlOffsetOf80MHz, + u8 CenterFrequencyIndex1 ); BOOLEAN -PHY_QueryRFPathSwitch_8814A(IN PADAPTER pAdapter); +PHY_QueryRFPathSwitch_8814A(PADAPTER pAdapter); #if (USE_WORKITEM) -VOID +void RtCheckForHangWorkItemCallback8814A( - IN PVOID pContext + void *pContext ); #endif BOOLEAN SetAntennaConfig8814A( - IN PADAPTER Adapter, - IN u8 DefaultAnt + PADAPTER Adapter, + u8 DefaultAnt ); -VOID +void PHY_SetRFEReg8814A( - IN PADAPTER Adapter, - IN BOOLEAN bInit, - IN u8 Band + PADAPTER Adapter, + BOOLEAN bInit, + u8 Band ); s32 PHY_SwitchWirelessBand8814A( - IN PADAPTER Adapter, - IN u8 Band + PADAPTER Adapter, + u8 Band ); -VOID +void PHY_SetIO_8814A( PADAPTER pAdapter ); -VOID +void PHY_SetSwChnlBWMode8814( - IN PADAPTER Adapter, - IN u8 channel, - IN CHANNEL_WIDTH Bandwidth, - IN u8 Offset40, - IN u8 Offset80 + PADAPTER Adapter, + u8 channel, + enum channel_width Bandwidth, + u8 Offset40, + u8 Offset80 ); s32 PHY_MACConfig8814(PADAPTER Adapter); int PHY_BBConfig8814(PADAPTER Adapter); -VOID PHY_Set_SecCCATH_by_RXANT_8814A(PADAPTER pAdapter, u4Byte ulAntennaRx); +void PHY_Set_SecCCATH_by_RXANT_8814A(PADAPTER pAdapter, u32 ulAntennaRx); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8814PhyReg.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8814PhyReg.h index 0aec99452019..97b6d8998c20 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8814PhyReg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8814PhyReg.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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-------------------------------*/ @@ -202,6 +198,8 @@ #define rB_RFE_Inv_Jaguar 0xeb4 /* Path_B RFE control */ #define rA_RFE_Jaguar 0xcb8 /* Path_A RFE cotrol */ #define rB_RFE_Jaguar 0xeb8 /* Path_B RFE control */ +#define rA_RFE_Inverse_Jaguar 0xCBC /* Path_A RFE control inverse */ +#define rB_RFE_Inverse_Jaguar 0xEBC /* Path_B RFE control inverse */ #define r_ANTSEL_SW_Jaguar 0x900 /* ANTSEL SW Control */ #define bMask_RFEInv_Jaguar 0x3ff00000 #define bMask_AntselPathFollow_Jaguar 0x00030000 diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8814PwrSeq.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8814PwrSeq.h index 696959b6ef64..baedbab1b53f 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8814PwrSeq.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8814PwrSeq.h @@ -1,7 +1,7 @@ - +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,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__ @@ -81,9 +77,9 @@ {0x0002, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, /* 0x2[0] = 0 RESET BB, CLOSE RF */ \ {0x0002, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US}, /*Delay 1us*/ \ {0x0002, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0}, /* Whole BB is reset*/ \ - {0x1002, ~PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, /* 0x2[0] = 0 RESET BB, CLOSE RF */ \ - {0x0002, ~PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US}, /*Delay 1us*/ \ - {0x1002, ~PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0}, /* Whole BB is reset*/ \ + {0x1002, (u8)(~PWR_CUT_TESTCHIP_MSK), PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0}, /* 0x2[0] = 0 RESET BB, CLOSE RF */ \ + {0x0002, (u8)(~PWR_CUT_TESTCHIP_MSK), PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US}, /*Delay 1us*/ \ + {0x1002, (u8)(~PWR_CUT_TESTCHIP_MSK), PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0}, /* Whole BB is reset*/ \ {0x001F, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0}, /*0x1F[7:0] = 0 turn off RF*/ \ /*{0x004E, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0},*/ /*0x4C[23] = 0x4E[7] = 0, switch DPDT_SEL_P output from register 0x65[2] */ \ {0x0007, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x28}, /* 0x07[7:0] = 0x28 sps pwm mode 0x2a for BT coex*/ \ @@ -193,9 +189,9 @@ {0x0002, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated, and RF closed*/ \ {0x0002, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ {0x0002, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0}, /* Whole BB is reset*/ \ - {0x1002, ~PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated, and RF closed*/ \ - {0x0002, ~PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ - {0x1002, ~PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0}, /* Whole BB is reset*/ \ + {0x1002, (u8)(~PWR_CUT_TESTCHIP_MSK), PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, 0},/*CCK and OFDM are disabled, and clock are gated, and RF closed*/ \ + {0x0002, (u8)(~PWR_CUT_TESTCHIP_MSK), PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_DELAY, 0, PWRSEQ_DELAY_US},/*Delay 1us*/ \ + {0x1002, (u8)(~PWR_CUT_TESTCHIP_MSK), PWR_FAB_ALL_MSK, PWR_INTF_USB_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0}, /* Whole BB is reset*/ \ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0x03},/*Reset MAC TRX*/ \ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, 0},/*check if removed later*/ \ {0x05F1, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/*Respond TxOK to scheduler*/ @@ -214,7 +210,7 @@ {0x0101, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1, BIT1}, /*. 0x101[1] = 1*/ \ {0x0100, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0xFF}, /*. 0x100[7:0] = 0xFF enable WMAC TRX*/ \ {0x0002, PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1 | BIT0, BIT1 | BIT0}, /*. 0x02[1:0] = 2b'11 enable BB macro*/ \ - {0x1002, ~PWR_CUT_TESTCHIP_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1 | BIT0, BIT1 | BIT0}, /*. 0x1002[1:0] = 2b'11 enable BB macro*/ \ + {0x1002, (u8)(~PWR_CUT_TESTCHIP_MSK), PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT1 | BIT0, BIT1 | BIT0}, /*. 0x1002[1:0] = 2b'11 enable BB macro*/ \ {0x0522, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0}, /*. 0x522 = 0*/ #define RTL8814A_TRANS_END \ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8821APwrSeq.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8821APwrSeq.h index 091c2e56d967..ffbae537c2dd 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8821APwrSeq.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/Hal8821APwrSeq.h @@ -1,4 +1,18 @@ /* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * 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/rtl8188eu/include/HalPwrSeqCmd.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/HalPwrSeqCmd.h index b511436f7938..1f9a175e305e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/HalPwrSeqCmd.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/HalPwrSeqCmd.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/HalVerDef.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/HalVerDef.h index a33b4c57c84e..5750aab00c5b 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/HalVerDef.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/HalVerDef.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -40,7 +36,11 @@ typedef enum tag_HAL_IC_Type_Definition { CHIP_8188F = 12, CHIP_8822B = 13, CHIP_8723D = 14, - CHIP_8821C = 15 + CHIP_8821C = 15, + CHIP_8710B = 16, + CHIP_8192F = 17, + CHIP_8188GTV = 18, + CHIP_8822C = 19, } HAL_IC_TYPE_E; /* HAL_CHIP_TYPE_E */ @@ -117,6 +117,7 @@ typedef struct tag_HAL_VERSION { #define IS_8188E(version) ((GET_CVID_IC_TYPE(version) == CHIP_8188E) ? TRUE : FALSE) #define IS_8188F(version) ((GET_CVID_IC_TYPE(version) == CHIP_8188F) ? TRUE : FALSE) +#define IS_8188GTV(version) ((GET_CVID_IC_TYPE(version) == CHIP_8188GTV) ? TRUE : FALSE) #define IS_8192E(version) ((GET_CVID_IC_TYPE(version) == CHIP_8192E) ? TRUE : FALSE) #define IS_8812_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8812) ? TRUE : FALSE) #define IS_8821_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8821) ? TRUE : FALSE) @@ -125,8 +126,12 @@ typedef struct tag_HAL_VERSION { #define IS_8703B_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8703B) ? TRUE : FALSE) #define IS_8822B_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8822B) ? TRUE : FALSE) #define IS_8821C_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8821C) ? TRUE : FALSE) -#define IS_8723D_SERIES(version)\ - ((GET_CVID_IC_TYPE(version) == CHIP_8723D) ? TRUE : FALSE) +#define IS_8723D_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8723D) ? TRUE : FALSE) +#define IS_8710B_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8710B) ? TRUE : FALSE) +#define IS_8822C_SERIES(version) ((GET_CVID_IC_TYPE(version) == CHIP_8822C) ? TRUE : FALSE) + +#define IS_8192F_SERIES(version)\ + ((GET_CVID_IC_TYPE(version) == CHIP_8192F) ? TRUE : FALSE) /* HAL_CHIP_TYPE_E */ #define IS_TEST_CHIP(version) ((GET_CVID_CHIP_TYPE(version) == TEST_CHIP) ? TRUE : FALSE) #define IS_NORMAL_CHIP(version) ((GET_CVID_CHIP_TYPE(version) == NORMAL_CHIP) ? TRUE : FALSE) diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/autoconf.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/autoconf.h index 18223e14e5f7..53b848b70baa 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/autoconf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/autoconf.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General Public License along with - * this program; if not, write to the Free Software Foundation, Inc., - * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA - * - * - ******************************************************************************/ + *****************************************************************************/ /* ***** temporarily flag ******* */ #define CONFIG_SINGLE_IMG @@ -50,7 +46,6 @@ /* #define CONFIG_DEBUG_CFG80211 */ /* #define CONFIG_DRV_ISSUE_PROV_REQ */ /* IOT FOR S2 */ #define CONFIG_SET_SCAN_DENY_TIMER - /*#define SUPPLICANT_RTK_VERSION_LOWER_THAN_JB42*/ /* wpa_supplicant realtek version <= jb42 will be defined this */ #endif /* @@ -75,16 +70,12 @@ #define CONFIG_RECV_REORDERING_CTRL -/* #define CONFIG_TCP_CSUM_OFFLOAD_RX */ - -/* #define CONFIG_DRVEXT_MODULE */ - #define CONFIG_SUPPORT_USB_INT #ifdef CONFIG_SUPPORT_USB_INT /* #define CONFIG_USB_INTERRUPT_IN_PIPE */ #endif -/* #ifndef CONFIG_MP_INCLUDED */ +#ifdef CONFIG_POWER_SAVING #define CONFIG_IPS #ifdef CONFIG_IPS /* #define CONFIG_IPS_LEVEL_2 */ /* enable this to set default IPS mode to IPS_LEVEL_2 */ @@ -99,8 +90,9 @@ #endif #ifdef CONFIG_LPS_LCLK - #define CONFIG_XMIT_THREAD_MODE + /* #define CONFIG_XMIT_THREAD_MODE */ #endif +#endif /* CONFIG_POWER_SAVING */ /*#define CONFIG_ANTENNA_DIVERSITY*/ @@ -110,7 +102,6 @@ #ifdef CONFIG_CONCURRENT_MODE #define CONFIG_RUNTIME_PORT_SWITCH - #define CONFIG_SCAN_BACKOP #define CONFIG_TSF_RESET_OFFLOAD /* For 2 PORT TSF SYNC. */ #endif @@ -150,7 +141,7 @@ #define CONFIG_P2P_PS #define CONFIG_P2P_OP_CHK_SOCIAL_CH #define CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT /* replace CONFIG_P2P_CHK_INVITE_CH_LIST flag */ - #define CONFIG_P2P_INVITE_IOT + /*#define CONFIG_P2P_INVITE_IOT*/ #endif /* Added by Kurt 20110511 */ @@ -167,13 +158,13 @@ #define CONFIG_SKB_COPY /* for amsdu */ -/* #define CONFIG_LED */ -#ifdef CONFIG_LED - #define CONFIG_SW_LED - #ifdef CONFIG_SW_LED - /* #define CONFIG_LED_HANDLED_BY_CMD_THREAD */ +/* #define CONFIG_RTW_LED */ +#ifdef CONFIG_RTW_LED + #define CONFIG_RTW_SW_LED + #ifdef CONFIG_RTW_SW_LED + /* #define CONFIG_RTW_LED_HANDLED_BY_CMD_THREAD */ #endif -#endif /* CONFIG_LED */ +#endif /* CONFIG_RTW_LED */ #ifdef CONFIG_IOL #define CONFIG_IOL_NEW_GENERATION @@ -201,9 +192,6 @@ #endif #define RTW_NOTCH_FILTER 0 /* 0:Disable, 1:Enable, */ -#define CONFIG_TX_MCAST2UNI /* Support IP multicast->unicast */ -/* #define CONFIG_CHECK_AC_LIFETIME */ /* Check packet lifetime of 4 ACs. */ - /* * Interface Related Config */ @@ -276,17 +264,6 @@ /* * Platform Related Config */ -#ifdef CONFIG_PLATFORM_MN10300 - #define CONFIG_SPECIAL_SETTING_FOR_FUNAI_TV - #define CONFIG_USE_USB_BUFFER_ALLOC_RX - - #if defined(CONFIG_POWER_SAVING) - #undef CONFIG_POWER_SAVING - #endif - -#endif/* CONFIG_PLATFORM_MN10300 */ - - #if defined(CONFIG_PLATFORM_ACTIONS_ATM702X) #ifdef CONFIG_USB_TX_AGGREGATION #undef CONFIG_USB_TX_AGGREGATION @@ -309,7 +286,6 @@ #endif /*#define CONFIG_RF_POWER_TRIM */ -#define CONFIG_80211D #ifdef CONFIG_GPIO_WAKEUP #ifndef WAKEUP_GPIO_IDX @@ -317,8 +293,6 @@ #endif #endif -#define CONFIG_ATTEMPT_TO_FIX_AP_BEACON_ERROR - /* * Debug Related Config */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/basic_types.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/basic_types.h index 245286da1f10..2d74f018552e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/basic_types.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/basic_types.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -82,27 +78,17 @@ #include #include #include - #define IN - #define OUT - #define VOID void - #define NDIS_OID uint - #define NDIS_STATUS uint typedef signed int sint; - #ifndef PVOID - typedef void *PVOID; - /* #define PVOID (void *) */ - #endif +#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 19)) +typedef _Bool bool; - #define UCHAR u8 - #define USHORT u16 - #define UINT u32 - #define ULONG u32 - - #if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 19)) - typedef _Bool bool; - #endif +enum { + false = 0, + true = 1 +}; +#endif typedef void (*proc_t)(void *); @@ -110,7 +96,8 @@ typedef __kernel_ssize_t SSIZE_T; #define FIELD_OFFSET(s, field) ((SSIZE_T)&((s *)(0))->field) -#endif +#define NDIS_OID uint +#endif /*PLATFORM_LINUX*/ #ifdef PLATFORM_FREEBSD @@ -130,21 +117,8 @@ typedef signed long long s64; typedef unsigned long long u64; - #define IN - #define OUT - #define VOID void - #define NDIS_OID uint - #define NDIS_STATUS uint - #ifndef PVOID - typedef void *PVOID; - /* #define PVOID (void *) */ - #endif typedef u32 dma_addr_t; - #define UCHAR u8 - #define USHORT u16 - #define UINT u32 - #define ULONG u32 typedef void (*proc_t)(void *); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/byteorder/big_endian.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/byteorder/big_endian.h index 345e9d8e0e73..76542f0c4867 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/byteorder/big_endian.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/byteorder/big_endian.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/byteorder/generic.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/byteorder/generic.h index 02cf675ae366..32d424a1d7a8 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/byteorder/generic.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/byteorder/generic.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/byteorder/little_endian.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/byteorder/little_endian.h index 0b773366ca2f..1f9287f205ad 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/byteorder/little_endian.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/byteorder/little_endian.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/byteorder/swab.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/byteorder/swab.h index d6d81b5c140c..8c3eb866c0be 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/byteorder/swab.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/byteorder/swab.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/byteorder/swabb.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/byteorder/swabb.h index ce3342470c10..2e6b196051f9 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/byteorder/swabb.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/byteorder/swabb.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/circ_buf.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/circ_buf.h index 23523164cd36..cccb0602e27d 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/circ_buf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/circ_buf.h @@ -1,7 +1,8 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/cmd_osdep.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/cmd_osdep.h index 9c63a1c28227..c98ba148679e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/cmd_osdep.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/cmd_osdep.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/cmn_info/rtw_sta_info.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/cmn_info/rtw_sta_info.h new file mode 100644 index 000000000000..3bafad7613c1 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/cmn_info/rtw_sta_info.h @@ -0,0 +1,269 @@ +/* SPDX-License-Identifier: GPL-2.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 + * + * + ******************************************************************************/ + + /*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, +}; + +enum bb_path { + BB_PATH_NON = 0, + 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_C | BB_PATH_D), + BB_PATH_AUTO = 0xff /*for path diversity*/ +}; + +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_ABD, + RF_PATH_ACD, + RF_PATH_BCD, + RF_PATH_ABCD, +}; + +enum rf_syn { + RF_SYN0 = 0, + RF_SYN1 = 1, +}; + +enum rfc_mode { + rfc_4x4 = 0, + rfc_2x2 = 1, +}; + +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; + s16 rssi_acc; /*accumulate RSSI for per packet MA sum*/ +}; + +struct ra_sta_info { + u8 rate_id; /*[PHYDM] ratr_idx*/ + u8 rssi_level; /*[PHYDM]*/ + u8 is_first_connect:1; /*[PHYDM] 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; /*[PHYDM] 0: Tx, 1:Rx, 2:bi-direction*/ + u8 is_noisy:1; /*[PHYDM]*/ + u8 curr_tx_rate; /*[PHYDM] FW->Driver*/ + enum channel_width ra_bw_mode; /*[Driver] max bandwidth, for RA only*/ + enum channel_width curr_tx_bw; /*[PHYDM] FW->Driver*/ + u8 curr_retry_ratio; /*[PHYDM] FW->Driver*/ + u64 ramask; +}; + +struct dtp_info { + u8 dyn_tx_power; /*Dynamic Tx power offset*/ + u8 last_tx_power; + u8 sta_tx_high_power_lvl:4; + u8 sta_last_dtp_lvl:4; +}; + +struct cmn_sta_info { + u16 dm_ctrl; /*[Driver]*/ + enum channel_width bw_mode; /*[Driver] max support BW*/ + u8 mac_id; /*[Driver]*/ + u8 mac_addr[6]; /*[Driver]*/ + u16 aid; /*[Driver]*/ + enum rf_type mimo_type; /*[Driver] sta XTXR*/ + struct rssi_info rssi_stat; /*[PHYDM]*/ + struct ra_sta_info ra_info; /*[Driver&PHYDM]*/ + u16 tx_moving_average_tp; /*[Driver] tx average MBps*/ + u16 rx_moving_average_tp; /*[Driver] rx average MBps*/ + u8 stbc_en:2; /*[Driver] really transmitt STBC*/ + u8 ldpc_en:2; /*[Driver] really transmitt LDPC*/ + enum wireless_set support_wireless_set;/*[Driver]*/ +#ifdef CONFIG_BEAMFORMING + struct bf_cmn_info bf_info; /*[Driver]*/ +#endif + u8 sm_ps:2; /*[Driver]*/ + struct dtp_info dtp_stat; /*[PHYDM] Dynamic Tx power offset*/ + /*u8 pw2cca_over_TH_cnt;*/ + /*u8 total_pw2cca_cnt;*/ +}; + +struct phydm_phyinfo_fw_struct { + u8 rx_rssi[4]; /* RSSI in 0~100 index */ +}; + +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 */ + u8 ant_idx[4]; /*per-path's antenna index*/ +/*ODM_PHY_STATUS_NEW_TYPE_SUPPORT*/ + u8 rx_count:2; /* RX path counter---*/ + u8 band_width:3; + 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*/ + u8 cnt_pw2cca; + u8 cnt_cca2agc_rdy; +/*ODM_PHY_STATUS_NEW_TYPE_SUPPORT*/ +}; + +struct phydm_perpkt_info_struct { + u8 data_rate; + u8 station_id; + u8 is_cck_rate: 1; + u8 rate_ss:3; /*spatial stream of data rate*/ + 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/rtl8188eu/include/custom_gpio.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/custom_gpio.h index 54e491872992..3921d8597b34 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/custom_gpio.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/custom_gpio.h @@ -1,22 +1,24 @@ /* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * 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___ #include #include -#ifdef PLATFORM_OS_XP - #include -#endif - -#ifdef PLATFORM_OS_CE - #include -#endif - -#ifdef PLATFORM_LINUX - #include -#endif - typedef enum cust_gpio_modes { WLAN_PWDN_ON, WLAN_PWDN_OFF, diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/drv_conf.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/drv_conf.h index a955a2b360a9..88950dbb31cb 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/drv_conf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/drv_conf.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,31 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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" #include "hal_ic_cfg.h" -#if defined(PLATFORM_LINUX) && defined (PLATFORM_WINDOWS) - - #error "Shall be Linux or Windows, but not both!\n" - +#define CONFIG_RSSI_PRIORITY +#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)) @@ -100,21 +111,103 @@ #define CONFIG_USB_VENDOR_REQ_MUTEX #endif +#if defined(CONFIG_DFS_SLAVE_WITH_RADAR_DETECT) && !defined(CONFIG_DFS_MASTER) + #define CONFIG_DFS_MASTER +#endif + #if !defined(CONFIG_AP_MODE) && defined(CONFIG_DFS_MASTER) - #warning "undef CONFIG_DFS_MASTER because CONFIG_AP_MODE is not defined" - #undef CONFIG_DFS_MASTER + #error "enable CONFIG_DFS_MASTER without CONFIG_AP_MODE" +#endif + +#ifdef CONFIG_WIFI_MONITOR + /* #define CONFIG_MONITOR_MODE_XMIT */ +#endif + +#ifdef CONFIG_CUSTOMER_ALIBABA_GENERAL + #ifndef CONFIG_WIFI_MONITOR + #define CONFIG_WIFI_MONITOR + #endif + #ifndef CONFIG_MONITOR_MODE_XMIT + #define CONFIG_MONITOR_MODE_XMIT + #endif + #ifdef CONFIG_POWER_SAVING + #undef CONFIG_POWER_SAVING + #endif +#endif + +#ifdef CONFIG_CUSTOMER01_SMART_ANTENNA + #ifdef CONFIG_POWER_SAVING + #undef CONFIG_POWER_SAVING + #endif + #ifdef CONFIG_BEAMFORMING + #undef CONFIG_BEAMFORMING + #endif +#endif + +#ifdef CONFIG_AP_MODE + #define CONFIG_TX_MCAST2UNI /* AP mode support IP multicast->unicast */ +#endif + +#ifdef CONFIG_RTW_MESH + #ifndef CONFIG_RTW_MESH_ACNODE_PREVENT + #define CONFIG_RTW_MESH_ACNODE_PREVENT 1 + #endif + + #ifndef CONFIG_RTW_MESH_OFFCH_CAND + #define CONFIG_RTW_MESH_OFFCH_CAND 1 + #endif + + #ifndef CONFIG_RTW_MESH_PEER_BLACKLIST + #define CONFIG_RTW_MESH_PEER_BLACKLIST 1 + #endif + + #ifndef CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST + #define CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST 1 + #endif + #ifndef CONFIG_RTW_MESH_CTO_MGATE_CARRIER + #define CONFIG_RTW_MESH_CTO_MGATE_CARRIER CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST + #endif + + #ifndef CONFIG_RTW_MPM_TX_IES_SYNC_BSS + #define CONFIG_RTW_MPM_TX_IES_SYNC_BSS 1 + #endif + #if CONFIG_RTW_MPM_TX_IES_SYNC_BSS + #ifndef CONFIG_RTW_MESH_AEK + #define CONFIG_RTW_MESH_AEK + #endif + #endif + + #ifndef CONFIG_RTW_MESH_DATA_BMC_TO_UC + #define CONFIG_RTW_MESH_DATA_BMC_TO_UC 1 + #endif +#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 -#ifndef CONFIG_RTW_HIQ_FILTER - #define CONFIG_RTW_HIQ_FILTER 1 +#ifndef CONFIG_TX_AC_LIFETIME +#define CONFIG_TX_AC_LIFETIME 1 +#endif +#ifndef CONFIG_TX_ACLT_FLAGS +#define CONFIG_TX_ACLT_FLAGS 0x00 +#endif +#ifndef CONFIG_TX_ACLT_CONF_DEFAULT +#define CONFIG_TX_ACLT_CONF_DEFAULT {0x0, 1024 * 1000, 1024 * 1000} +#endif +#ifndef CONFIG_TX_ACLT_CONF_AP_M2U +#define CONFIG_TX_ACLT_CONF_AP_M2U {0xF, 256 * 1000, 256 * 1000} +#endif +#ifndef CONFIG_TX_ACLT_CONF_MESH +#define CONFIG_TX_ACLT_CONF_MESH {0xF, 256 * 1000, 256 * 1000} #endif -#ifndef CONFIG_RTW_FORCE_IGI_LB - #define CONFIG_RTW_FORCE_IGI_LB 0 +#ifndef CONFIG_RTW_HIQ_FILTER + #define CONFIG_RTW_HIQ_FILTER 1 #endif #ifndef CONFIG_RTW_ADAPTIVITY_EN @@ -125,14 +218,6 @@ #define CONFIG_RTW_ADAPTIVITY_MODE 0 #endif -#ifndef CONFIG_RTW_ADAPTIVITY_DML - #define CONFIG_RTW_ADAPTIVITY_DML 0 -#endif - -#ifndef CONFIG_RTW_ADAPTIVITY_DC_BACKOFF - #define CONFIG_RTW_ADAPTIVITY_DC_BACKOFF 2 -#endif - #ifndef CONFIG_RTW_ADAPTIVITY_TH_L2H_INI #define CONFIG_RTW_ADAPTIVITY_TH_L2H_INI 0 #endif @@ -156,6 +241,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 +270,36 @@ #define CONFIG_TXPWR_LIMIT_EN 1 #endif +#if !CONFIG_TXPWR_LIMIT && CONFIG_TXPWR_LIMIT_EN + #undef CONFIG_TXPWR_LIMIT + #define CONFIG_TXPWR_LIMIT 1 +#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 +#if defined(CONFIG_RTL8192E) || defined(CONFIG_RTL8192F) || defined(CONFIG_RTL8822B) + #define CONFIG_RTW_TX_2PATH_EN /* mutually incompatible with STBC_TX & Beamformer */ +#endif +#endif +/*#define CONFIG_EXTEND_LOWRATE_TXOP */ + +#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 @@ -248,11 +367,11 @@ #endif #if (CONFIG_IFACE_NUMBER == 0) - #error "CONFIG_IFACE_NUMBER cound not equel to 0 !!" + #error "CONFIG_IFACE_NUMBER cound not be 0 !!" #endif -#if (CONFIG_IFACE_NUMBER > 3) - #error "Not support over 3 interfaces yet !!" +#if (CONFIG_IFACE_NUMBER > 4) + #error "Not support over 4 interfaces yet !!" #endif #if (CONFIG_IFACE_NUMBER > 8) /*IFACE_ID_MAX*/ @@ -270,10 +389,29 @@ #endif #ifdef CONFIG_AP_MODE + #define CONFIG_SUPPORT_MULTI_BCN + #define CONFIG_SWTIMER_BASED_TXBCN - /*#define CONFIG_FW_BASED_BCN*/ - #endif -#endif + + #if defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) /* || defined(CONFIG_RTL8822C)*/ + #define CONFIG_FW_HANDLE_TXBCN + + #ifdef CONFIG_FW_HANDLE_TXBCN + #ifdef CONFIG_SWTIMER_BASED_TXBCN + #undef CONFIG_SWTIMER_BASED_TXBCN + #endif + + #define CONFIG_LIMITED_AP_NUM 4 + #endif + #endif /*defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) */ /*|| defined(CONFIG_RTL8822C)*/ + #endif /*CONFIG_AP_MODE*/ + + #if defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822C) + #define CONFIG_CLIENT_PORT_CFG + #define CONFIG_NEW_NETDEV_HDL + #endif/*defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822C)*/ + +#endif/*(CONFIG_IFACE_NUMBER > 2)*/ #define MACID_NUM_SW_LIMIT 32 #define SEC_CAM_ENT_NUM_SW_LIMIT 32 @@ -282,10 +420,18 @@ #define CONFIG_IEEE80211_BAND_5GHZ #endif -#if defined(CONFIG_WOWLAN) && (defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C)) +#if defined(CONFIG_WOWLAN) && (defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822C)) #define CONFIG_WOW_PATTERN_HW_CAM #endif +#ifndef CONFIG_TSF_UPDATE_PAUSE_FACTOR +#define CONFIG_TSF_UPDATE_PAUSE_FACTOR 200 +#endif + +#ifndef CONFIG_TSF_UPDATE_RESTORE_FACTOR +#define CONFIG_TSF_UPDATE_RESTORE_FACTOR 5 +#endif + /* Mark CONFIG_DEAUTH_BEFORE_CONNECT by Arvin 2015/07/20 If the failure of Wi-Fi connection is due to some irregular disconnection behavior (like unplug dongle, @@ -298,6 +444,7 @@ /*#define CONFIG_DOSCAN_IN_BUSYTRAFFIC */ +/*#define CONFIG_PHDYM_FW_FIXRATE */ /* Another way to fix tx rate */ /*Don't release SDIO irq in suspend/resume procedure*/ #define CONFIG_RTW_SDIO_KEEP_IRQ 0 @@ -310,4 +457,100 @@ #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 + +/* IPS */ +#ifndef RTW_IPS_MODE + #if defined(CONFIG_IPS) + #define RTW_IPS_MODE 1 + #else + #define RTW_IPS_MODE 0 + #endif +#endif /* !RTW_IPS_MODE */ + +#if (RTW_IPS_MODE > 1 || RTW_IPS_MODE < 0) + #error "The CONFIG_IPS_MODE value is wrong. Please follow HowTo_enable_the_power_saving_functionality.pdf.\n" +#endif + +/* LPS */ +#ifndef RTW_LPS_MODE + #if defined(CONFIG_LPS_PG) || defined(CONFIG_LPS_PG_DDMA) + #define RTW_LPS_MODE 3 + #elif defined(CONFIG_LPS_LCLK) + #define RTW_LPS_MODE 2 + #elif defined(CONFIG_LPS) + #define RTW_LPS_MODE 1 + #else + #define RTW_LPS_MODE 0 + #endif +#endif /* !RTW_LPS_MODE */ + +#if (RTW_LPS_MODE > 3 || RTW_LPS_MODE < 0) + #error "The CONFIG_LPS_MODE value is wrong. Please follow HowTo_enable_the_power_saving_functionality.pdf.\n" +#endif + +/* WOW LPS */ +#ifndef RTW_WOW_LPS_MODE + #if defined(CONFIG_LPS_PG) || defined(CONFIG_LPS_PG_DDMA) + #define RTW_WOW_LPS_MODE 3 + #elif defined(CONFIG_LPS_LCLK) + #define RTW_WOW_LPS_MODE 2 + #elif defined(CONFIG_LPS) + #define RTW_WOW_LPS_MODE 1 + #else + #define RTW_WOW_LPS_MODE 0 + #endif +#endif /* !RTW_WOW_LPS_MODE */ + +#if (RTW_WOW_LPS_MODE > 3 || RTW_WOW_LPS_MODE < 0) + #error "The RTW_WOW_LPS_MODE value is wrong. Please follow HowTo_enable_the_power_saving_functionality.pdf.\n" +#endif + +#ifdef RTW_REDUCE_SCAN_SWITCH_CH_TIME +#ifndef CONFIG_RTL8822B + #error "Only 8822B support RTW_REDUCE_SCAN_SWITCH_CH_TIME" +#endif + #ifndef RTW_CHANNEL_SWITCH_OFFLOAD + #define RTW_CHANNEL_SWITCH_OFFLOAD + #endif +#endif + +#define CONFIG_RTW_TPT_MODE + +#ifdef CONFIG_PCI_BCN_POLLING +#define CONFIG_BCN_ICF +#endif + +#ifndef CONFIG_PCI_MSI +#define CONFIG_RTW_PCI_MSI_DISABLE +#endif + #endif /* __DRV_CONF_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/drv_types.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/drv_types.h index b64f7d67c54c..ed52f107ee6e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/drv_types.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/drv_types.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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,7 +59,9 @@ enum _NIC_VERSION { typedef struct _ADAPTER _adapter, ADAPTER, *PADAPTER; #include +#include #include +#include "../core/rtw_chplan.h" #ifdef CONFIG_80211N_HT #include @@ -73,16 +71,13 @@ typedef struct _ADAPTER _adapter, ADAPTER, *PADAPTER; #include #endif -#ifdef CONFIG_INTEL_WIDI - #include -#endif - #include #include #include #include #include #include +#include #ifdef CONFIG_BEAMFORMING #include @@ -104,7 +99,6 @@ typedef struct _ADAPTER _adapter, ADAPTER, *PADAPTER; #include #include #include -#include #include #include #include @@ -112,6 +106,9 @@ typedef struct _ADAPTER _adapter, ADAPTER, *PADAPTER; #include #include #include +#ifdef CONFIG_RTW_MESH +#include "../core/mesh/rtw_mesh.h" +#endif #include #include #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 */ @@ -154,14 +147,16 @@ typedef struct _ADAPTER _adapter, ADAPTER, *PADAPTER; #include #include -#ifdef CONFIG_BT_COEXIST - #include -#endif /* CONFIG_BT_COEXIST */ +#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) @@ -198,11 +193,22 @@ struct registry_priv { u8 soft_ap; u8 power_mgnt; u8 ips_mode; + u8 lps_level; + u8 lps_chk_by_tp; +#ifdef CONFIG_WOWLAN + u8 wow_power_mgnt; + u8 wow_lps_level; +#endif /* CONFIG_WOWLAN */ 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; + u16 max_bss_cnt; u8 ack_policy; u8 mp_mode; #if defined(CONFIG_MP_INCLUDED) && defined(CONFIG_RTW_CUSTOMER_STR) @@ -215,19 +221,26 @@ 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; +#if CONFIG_TX_AC_LIFETIME + u8 tx_aclt_flags; + struct tx_aclt_conf_t tx_aclt_confs[TX_ACLT_CONF_NUM]; +#endif + 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 */ @@ -236,7 +249,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 */ @@ -284,6 +299,7 @@ struct registry_priv { u8 bt_sco; u8 bt_ampdu; u8 ant_num; + u8 single_ant_path; #endif BOOLEAN bAcceptAddbaReq; @@ -320,21 +336,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 */ +#if 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]; @@ -342,6 +351,9 @@ struct registry_priv { s8 target_tx_pwr_5g[RF_PATH_MAX][RATE_SECTION_NUM - 1]; #endif + u8 tsf_update_pause_factor; + u8 tsf_update_restore_factor; + s8 TxBBSwing_2G; s8 TxBBSwing_5G; u8 AmplifierType_2G; @@ -365,16 +377,18 @@ struct registry_priv { u8 hiq_filter; u8 adaptivity_en; u8 adaptivity_mode; - u8 adaptivity_dml; - u8 adaptivity_dc_backoff; s8 adaptivity_th_l2h_ini; s8 adaptivity_th_edcca_hl_diff; 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; @@ -396,29 +410,74 @@ struct registry_priv { 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; + u8 rtw_mcc_enable_runtime_duration; + u8 rtw_mcc_phydm_offload; #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; + u8 suspend_type; +#endif + #ifdef CONFIG_SUPPORT_TRX_SHARED u8 trx_share_mode; #endif u8 check_hw_status; + u8 wowlan_sta_mix_mode; + u32 pci_aspm_config; + + u8 iqk_fw_offload; + u8 ch_switch_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 +#ifdef CONFIG_DYNAMIC_SOML + u8 dyn_soml_en; + u8 dyn_soml_train_num; + u8 dyn_soml_interval; + u8 dyn_soml_period; + u8 dyn_soml_delay; +#endif +#ifdef CONFIG_FW_HANDLE_TXBCN + u8 fw_tbtt_rpt; +#endif + +#ifdef DBG_LA_MODE + u8 la_mode_en; +#endif + u32 phydm_ability; + u32 halrf_ability; +#ifdef CONFIG_TDMADIG + u8 tdmadig_en; + u8 tdmadig_mode; + u8 tdmadig_dynamic; +#endif/*CONFIG_TDMADIG*/ +#ifdef CONFIG_RTW_MESH + u8 peer_alive_based_preq; +#endif }; /* For registry parameters */ -#define RGTRY_OFT(field) ((ULONG)FIELD_OFFSET(struct registry_priv, field)) +#define RGTRY_OFT(field) ((u32)FIELD_OFFSET(struct registry_priv, field)) #define RGTRY_SZ(field) sizeof(((struct registry_priv *) 0)->field) #define GetRegAmplifierType2G(_Adapter) (_Adapter->registrypriv.AmplifierType_2G) @@ -432,13 +491,19 @@ struct registry_priv { #define GetRegGLNAType(_Adapter) (_Adapter->registrypriv.GLNA_Type) #define GetRegPowerTrackingType(_Adapter) (_Adapter->registrypriv.PowerTracking_Type) -#define BSSID_OFT(field) ((ULONG)FIELD_OFFSET(WLAN_BSSID_EX, field)) +#define WOWLAN_IS_STA_MIX_MODE(_Adapter) (_Adapter->registrypriv.wowlan_sta_mix_mode) +#define BSSID_OFT(field) ((u32)FIELD_OFFSET(WLAN_BSSID_EX, field)) #define BSSID_SZ(field) sizeof(((PWLAN_BSSID_EX) 0)->field) #define BW_MODE_2G(bw_mode) ((bw_mode) & 0x0F) #define BW_MODE_5G(bw_mode) ((bw_mode) >> 4) +#ifdef CONFIG_80211N_HT #define REGSTY_BW_2G(regsty) BW_MODE_2G((regsty)->bw_mode) #define REGSTY_BW_5G(regsty) BW_MODE_5G((regsty)->bw_mode) +#else +#define REGSTY_BW_2G(regsty) CHANNEL_WIDTH_20 +#define REGSTY_BW_5G(regsty) CHANNEL_WIDTH_20 +#endif #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)) @@ -446,9 +511,9 @@ struct registry_priv { #define REGSTY_IS_11AC_AUTO(regsty) ((regsty)->vht_enable == 2) 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; @@ -647,15 +712,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 { @@ -665,7 +725,7 @@ struct rtw_traffic_statistics { u64 tx_drop; u64 cur_tx_bytes; u64 last_tx_bytes; - u32 cur_tx_tp; /* Tx throughput in MBps. */ + u32 cur_tx_tp; /* Tx throughput in Mbps. */ /* rx statistics */ u64 rx_bytes; @@ -673,11 +733,14 @@ struct rtw_traffic_statistics { u64 rx_drop; u64 cur_rx_bytes; u64 last_rx_bytes; - u32 cur_rx_tp; /* Rx throughput in MBps. */ + u32 cur_rx_tp; /* Rx throughput in Mbps. */ }; #define SEC_CAP_CHK_BMC BIT0 +#define MACID_DROP BIT0 +#define MACID_DROP_INDIRECT BIT1 + #define SEC_STATUS_STA_PK_GK_CONFLICT_DIS_BMC_SEARCH BIT0 struct sec_cam_bmp { @@ -716,6 +779,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) @@ -729,20 +794,51 @@ struct macid_bmp { #endif }; +#ifdef CONFIG_CLIENT_PORT_CFG +struct clt_port_t{ + _lock lock; + u8 bmp; + s8 num; +}; +#define get_clt_num(adapter) (adapter_to_dvobj(adapter)->clt_port.num) +#endif + struct macid_ctl_t { _lock lock; u8 num; 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]; + u8 op_num[H2C_MSR_ROLE_MAX]; /* number of macid having h2c_msr's OPMODE = 1 for specific ROLE */ + + struct sta_info *sta[MACID_NUM_SW_LIMIT]; /* corresponding stainfo when macid is not shared */ + u8 macid_cap; + /* macid sleep registers */ + u16 reg_sleep_m0; + u16 reg_drop_m0; +#if (MACID_NUM_SW_LIMIT > 32) + u16 reg_sleep_m1; + u16 reg_drop_m1; +#endif +#if (MACID_NUM_SW_LIMIT > 64) + u16 reg_sleep_m2; + u16 reg_drop_m2; +#endif +#if (MACID_NUM_SW_LIMIT > 96) + u16 reg_sleep_m3; + u16 reg_drop_m3; +#endif + u16 macid_txrpt; + u8 macid_txrpt_pgsz; }; /* used for rf_ctl_t.rate_bmp_cck_ofdm */ @@ -778,7 +874,33 @@ 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 + +#define OFFCHS_NONE 0 +#define OFFCHS_LEAVING_OP 1 +#define OFFCHS_LEAVE_OP 2 +#define OFFCHS_BACKING_OP 3 + 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; + + _mutex offch_mutex; + u8 offch_state; + /* 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 */ @@ -788,30 +910,70 @@ struct rf_ctl_t { u8 highest_ht_rate_bw_bmp; u8 highest_vht_rate_bw_bmp; +#if 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 + + u8 ch_sel_same_band_prefer; + +#ifdef CONFIG_DFS + u8 csa_ch; + #ifdef CONFIG_DFS_MASTER + _timer radar_detect_timer; bool radar_detect_by_others; - u8 dfs_master_enabled; + u8 radar_detect_enabled; bool radar_detected; u8 radar_detect_ch; 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 cac_force_stop; +#ifdef CONFIG_DFS_SLAVE_WITH_RADAR_DETECT + u8 dfs_slave_with_rd; +#endif u8 dfs_ch_sel_d_flags; - u8 dbg_dfs_master_fake_radar_detect_cnt; - u8 dbg_dfs_master_radar_detect_trigger_non; - u8 dbg_dfs_master_choose_dfs_ch_first; -#endif + u8 dbg_dfs_fake_radar_detect_cnt; + u8 dbg_dfs_radar_detect_trigger_non; + u8 dbg_dfs_choose_dfs_ch_first; +#endif /* CONFIG_DFS_MASTER */ +#endif /* CONFIG_DFS */ }; #define RTW_CAC_STOPPED 0 +#ifdef CONFIG_DFS_MASTER #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) && rtw_time_after((rfctl)->cac_end_time, rtw_get_current_time())) +#define IS_UNDER_CAC(rfctl) (IS_CH_WAITING(rfctl) && rtw_time_after(rtw_get_current_time(), (rfctl)->cac_start_time)) +#define IS_RADAR_DETECTED(rfctl) ((rfctl)->radar_detected) +#else +#define IS_CAC_STOPPED(rfctl) 1 +#define IS_CH_WAITING(rfctl) 0 +#define IS_UNDER_CAC(rfctl) 0 +#define IS_RADAR_DETECTED(rfctl) 0 +#endif /* CONFIG_DFS_MASTER */ + +#ifdef CONFIG_DFS_SLAVE_WITH_RADAR_DETECT +#define IS_DFS_SLAVE_WITH_RD(rfctl) ((rfctl)->dfs_slave_with_rd) +#else +#define IS_DFS_SLAVE_WITH_RD(rfctl) 0 +#endif #ifdef CONFIG_MBSSID_CAM #define TOTAL_MBID_CAM_NUM 8 @@ -843,6 +1005,7 @@ struct halmacpriv { /* 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]; @@ -850,6 +1013,21 @@ struct halmacpriv { }; #endif /* RTW_HALMAC */ +#ifdef CONFIG_FW_MULTI_PORT_SUPPORT +/*info for H2C-0x2C*/ +struct dft_info { + u8 port_id; + u8 mac_id; +}; +#endif + +#ifdef CONFIG_HW_P0_TSF_SYNC +struct tsf_info { + u8 sync_port;/*port_x's tsf sync to port_0*/ + u8 offset; /*tsf timer offset*/ +}; +#endif + struct dvobj_priv { /*-------- below is common data --------*/ u8 chip_type; @@ -866,6 +1044,8 @@ struct dvobj_priv { _mutex hw_init_mutex; _mutex h2c_fwcmd_mutex; + _mutex ioctrl_mutex; + #ifdef CONFIG_RTW_CUSTOMER_STR _mutex customer_str_mutex; struct submit_ctx *customer_str_sctx; @@ -879,20 +1059,41 @@ struct dvobj_priv { _mutex sd_indirect_access_mutex; #endif +#ifdef CONFIG_SYSON_INDIRECT_ACCESS + _mutex syson_indirect_access_mutex; /* System On Reg R/W */ +#endif + 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 */ struct mi_state iface_state; #ifdef CONFIG_AP_MODE - u8 nr_ap_if; /* total interface s number of ap/go mode. */ - u32 inter_bcn_space; /* unit:ms */ + #ifdef CONFIG_SUPPORT_MULTI_BCN + u8 nr_ap_if; /* total interface number of ap /go /mesh / nan mode. */ + u16 inter_bcn_space; /* unit:ms */ _queue ap_if_q; + u8 vap_map; + u8 fw_bcn_offload; + u8 vap_tbtt_rpt_map; + #endif /*CONFIG_SUPPORT_MULTI_BCN*/ + #ifdef CONFIG_RTW_REPEATER_SON + struct rtw_rson_struct rson_data; + #endif #endif +#ifdef CONFIG_CLIENT_PORT_CFG + struct clt_port_t clt_port; +#endif + +#ifdef CONFIG_HW_P0_TSF_SYNC + struct tsf_info p0_tsf; +#endif + systime periodic_tsf_update_etime; + _timer periodic_tsf_update_end_timer; struct macid_ctl_t macid_ctl; @@ -906,6 +1107,12 @@ struct dvobj_priv { struct rf_ctl_t rf_ctl; +#if CONFIG_TX_AC_LIFETIME + struct tx_aclt_conf_t tx_aclt_force_val; + u8 tx_aclt_flags; + struct tx_aclt_conf_t tx_aclt_confs[TX_ACLT_CONF_NUM]; +#endif + /* For 92D, DMDP have 2 interface. */ u8 InterfaceNumber; u8 NumInterfaces; @@ -920,6 +1127,9 @@ 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; @@ -936,6 +1146,10 @@ struct dvobj_priv { _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; @@ -943,8 +1157,14 @@ struct dvobj_priv { #endif /* RTW_HALMAC */ #ifdef CONFIG_FW_MULTI_PORT_SUPPORT - u8 default_port_id; + /*info for H2C-0x2C*/ + struct dft_info dft; #endif + +#ifdef CONFIG_RTW_WIFI_HAL + u32 nodfs; +#endif + /*-------- below is for SDIO INTERFACE --------*/ #ifdef INTF_DATA @@ -977,31 +1197,6 @@ struct dvobj_priv { u8 *usb_vendor_req_buf; #endif -#ifdef PLATFORM_WINDOWS - /* related device objects */ - PDEVICE_OBJECT pphysdevobj;/* pPhysDevObj; */ - PDEVICE_OBJECT pfuncdevobj;/* pFuncDevObj; */ - PDEVICE_OBJECT pnextdevobj;/* pNextDevObj; */ - - u8 nextdevstacksz;/* unsigned char NextDeviceStackSize; */ /* = (CHAR)CEdevice->pUsbDevObj->StackSize + 1; */ - - /* urb for control diescriptor request */ - -#ifdef PLATFORM_OS_XP - struct _URB_CONTROL_DESCRIPTOR_REQUEST descriptor_urb; - PUSB_CONFIGURATION_DESCRIPTOR pconfig_descriptor;/* UsbConfigurationDescriptor; */ -#endif - -#ifdef PLATFORM_OS_CE - WCHAR active_path[MAX_ACTIVE_REG_PATH]; /* adapter regpath */ - USB_EXTENSION usb_extension; - - _nic_hdl pipehdls_r8192c[0x10]; -#endif - - u32 config_descriptor_len;/* ULONG UsbConfigurationDescriptorLength; */ -#endif/* PLATFORM_WINDOWS */ - #ifdef PLATFORM_LINUX struct usb_interface *pusbintf; struct usb_device *pusbdev; @@ -1067,15 +1262,32 @@ struct dvobj_priv { #ifdef CONFIG_MCC_MODE struct mcc_obj_priv mcc_objpriv; #endif /*CONFIG_MCC_MODE */ + +#ifdef CONFIG_RTW_TPT_MODE + u8 tpt_mode; /* RTK T/P Testing Mode, 0:default mode */ + u32 edca_be_ul; + u32 edca_be_dl; +#endif + /* also for RTK T/P Testing Mode */ + u8 scan_deny; + }; #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_STARTING_NUM(_dvobj) MSTATE_AP_STARTING_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_P2P_DV_NUM(_dvobj) MSTATE_P2P_DV_NUM(&((_dvobj)->iface_state)) +#define DEV_P2P_GC_NUM(_dvobj) MSTATE_P2P_GC_NUM(&((_dvobj)->iface_state)) +#define DEV_P2P_GO_NUM(_dvobj) MSTATE_P2P_GO_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)) @@ -1114,7 +1326,7 @@ static inline void dev_clr_drv_stopped(struct dvobj_priv *dvobj) #define dev_is_drv_stopped(dvobj) (ATOMIC_READ(&dvobj->bDriverStopped) == _TRUE) #ifdef PLATFORM_LINUX -static struct device *dvobj_to_dev(struct dvobj_priv *dvobj) +static inline struct device *dvobj_to_dev(struct dvobj_priv *dvobj) { /* todo: get interface type from dvobj and the return the dev accordingly */ #ifdef RTW_DVOBJ_CHIP_HW_TYPE @@ -1149,6 +1361,19 @@ enum _hw_port { MAX_HW_PORT, }; +#ifdef CONFIG_CLIENT_PORT_CFG +enum _client_port { + CLT_PORT0 = HW_PORT1, + CLT_PORT1 = HW_PORT2, + CLT_PORT2 = HW_PORT3, + CLT_PORT3 = HW_PORT4, + CLT_PORT_INVALID = HW_PORT0, +}; + +#define MAX_CLIENT_PORT_NUM 4 +#define get_clt_port(adapter) (adapter->client_port) +#endif + enum _ADAPTER_TYPE { PRIMARY_ADAPTER, VIRTUAL_ADAPTER, @@ -1168,18 +1393,6 @@ enum _NAPI_STATE { }; #endif -#ifdef CONFIG_INTEL_PROXIM -struct proxim { - bool proxim_support; - bool proxim_on; - - void *proximity_priv; - int (*proxim_rx)(_adapter *padapter, - union recv_frame *precv_frame); - u8(*proxim_get_var)(_adapter *padapter, u8 type); -}; -#endif /* CONFIG_INTEL_PROXIM */ - #ifdef CONFIG_MAC_LOOPBACK_DRIVER typedef struct loopbackdata { _sema sema; @@ -1196,11 +1409,6 @@ typedef struct loopbackdata { } LOOPBACKDATA, *PLOOPBACKDATA; #endif -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) @@ -1209,13 +1417,19 @@ struct _ADAPTER { int pid[3];/* process id from UI, 0:wps, 1:hostapd, 2:dhcpcd */ int bDongle;/* build-in module or external dongle */ + #if defined(CONFIG_AP_MODE) && defined(CONFIG_SUPPORT_MULTI_BCN) _list list; - + u8 vap_id; + #endif struct dvobj_priv *dvobj; struct mlme_priv mlmepriv; 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; @@ -1225,8 +1439,6 @@ struct _ADAPTER { _lock security_key_mutex; /* add for CONFIG_IEEE80211W, none 11w also can use */ struct registry_priv registrypriv; - struct led_priv ledpriv; - #ifdef CONFIG_RTW_NAPI struct napi_struct napi; u8 napi_state; @@ -1236,10 +1448,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 @@ -1265,6 +1473,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; @@ -1276,7 +1487,7 @@ struct _ADAPTER { ERROR_CODE LastError; /* <20130613, Kordan> Only the functions associated with MP records the error code by now. */ - PVOID HalData; + void *HalData; u32 hal_data_sz; struct hal_ops hal_func; @@ -1296,36 +1507,20 @@ struct _ADAPTER { } gpiointpriv; #endif _thread_hdl_ cmdThread; +#ifdef CONFIG_EVENT_THREAD_MODE _thread_hdl_ evtThread; - _thread_hdl_ xmitThread; - _thread_hdl_ recvThread; - - 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); - +#ifdef CONFIG_XMIT_THREAD_MODE + _thread_hdl_ xmitThread; +#endif +#ifdef CONFIG_RECV_THREAD_MODE + _thread_hdl_ recvThread; +#endif + u8 registered; void (*intf_start)(_adapter *adapter); void (*intf_stop)(_adapter *adapter); -#ifdef PLATFORM_WINDOWS - _nic_hdl hndis_adapter;/* hNdisAdapter(NDISMiniportAdapterHandle); */ - _nic_hdl hndis_config;/* hNdisConfiguration; */ - NDIS_STRING fw_img; - - u32 NdisPacketFilter; - u8 MCList[MAX_MCAST_LIST_NUM][6]; - u32 MCAddrCount; -#endif /* end of PLATFORM_WINDOWS */ - - #ifdef PLATFORM_LINUX _nic_hdl pnetdev; char old_ifname[IFNAMSIZ]; @@ -1371,13 +1566,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. */ @@ -1394,12 +1587,14 @@ 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; + #ifdef CONFIG_CLIENT_PORT_CFG + u8 client_id; + u8 client_port; + #endif + /*struct tsf_info tsf;*//*reserve define for 8814B*/ /*extend to support multi interface*/ - /*IFACE_ID0 is equals to PRIMARY_ADAPTER - IFACE_ID1 is equals to VIRTUAL_ADAPTER*/ u8 iface_id; #ifdef CONFIG_BR_EXT @@ -1417,16 +1612,12 @@ struct _ADAPTER { struct br_ext_info ethBrExtInfo; #endif /* CONFIG_BR_EXT */ -#ifdef CONFIG_INTEL_PROXIM - /* intel Proximity, should be alloc mem - * in intel Proximity module and can only - * be used in intel Proximity mode */ - struct proxim proximity; -#endif /* CONFIG_INTEL_PROXIM */ - #ifdef CONFIG_MAC_LOOPBACK_DRIVER PLOOPBACKDATA ploopback; #endif +#ifdef CONFIG_AP_MODE + u8 bmc_tx_rate; +#endif /* for debug purpose */ u8 fix_rate; @@ -1436,6 +1627,11 @@ struct _ADAPTER { 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. */ @@ -1448,7 +1644,7 @@ struct _ADAPTER { u8 tx_amsdu; u16 tx_amsdu_rate; #endif - unsigned char in_cta_test; + 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,6 +1661,16 @@ struct _ADAPTER { #ifdef CONFIG_MCC_MODE struct mcc_adapter_priv mcc_adapterpriv; #endif /* CONFIG_MCC_MODE */ + +#ifdef CONFIG_RTW_MESH + struct rtw_mesh_cfg mesh_cfg; + struct rtw_mesh_info mesh_info; + _timer mesh_path_timer; + _timer mesh_path_root_timer; + _timer mesh_atlm_param_req_timer; /* airtime link metrics param request timer */ + _workitem mesh_work; + unsigned long wrkq_flags; +#endif /* CONFIG_RTW_MESH */ }; #define adapter_to_dvobj(adapter) ((adapter)->dvobj) @@ -1478,8 +1684,15 @@ 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) +#ifdef CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI +#define adapter_pno_mac_addr(adapter) \ + ((adapter_wdev_data(adapter))->pno_mac_addr) +#endif + +#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/rtl8188eu/include/drv_types_ce.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/drv_types_ce.h index fc2638920131..a8e8e2a07546 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/drv_types_ce.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/drv_types_ce.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/drv_types_gspi.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/drv_types_gspi.h index f0efc8c99c60..142ff0d5884e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/drv_types_gspi.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/drv_types_gspi.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/drv_types_linux.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/drv_types_linux.h index 812b7440d4b0..66e88cfe4b31 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/drv_types_linux.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/drv_types_linux.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/drv_types_pci.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/drv_types_pci.h index c03657fdcb9b..f5bc0e2b8b53 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/drv_types_pci.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/drv_types_pci.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -124,70 +120,70 @@ typedef struct _PCI_COMMON_CONFIG { } type0; #if 0 struct _PCI_HEADER_TYPE_1 { - ULONG BaseAddresses[PCI_TYPE1_ADDRESSES]; - UCHAR PrimaryBusNumber; - UCHAR SecondaryBusNumber; - UCHAR SubordinateBusNumber; - UCHAR SecondaryLatencyTimer; - UCHAR IOBase; - UCHAR IOLimit; - USHORT SecondaryStatus; - USHORT MemoryBase; - USHORT MemoryLimit; - USHORT PrefetchableMemoryBase; - USHORT PrefetchableMemoryLimit; - ULONG PrefetchableMemoryBaseUpper32; - ULONG PrefetchableMemoryLimitUpper32; - USHORT IOBaseUpper; - USHORT IOLimitUpper; - ULONG Reserved2; - ULONG ExpansionROMBase; - UCHAR InterruptLine; - UCHAR InterruptPin; - USHORT BridgeControl; + u32 BaseAddresses[PCI_TYPE1_ADDRESSES]; + u8 PrimaryBusNumber; + u8 SecondaryBusNumber; + u8 SubordinateBusNumber; + u8 SecondaryLatencyTimer; + u8 IOBase; + u8 IOLimit; + u16 SecondaryStatus; + u16 MemoryBase; + u16 MemoryLimit; + u16 PrefetchableMemoryBase; + u16 PrefetchableMemoryLimit; + u32 PrefetchableMemoryBaseUpper32; + u32 PrefetchableMemoryLimitUpper32; + u16 IOBaseUpper; + u16 IOLimitUpper; + u32 Reserved2; + u32 ExpansionROMBase; + u8 InterruptLine; + u8 InterruptPin; + u16 BridgeControl; } type1; struct _PCI_HEADER_TYPE_2 { - ULONG BaseAddress; - UCHAR CapabilitiesPtr; - UCHAR Reserved2; - USHORT SecondaryStatus; - UCHAR PrimaryBusNumber; - UCHAR CardbusBusNumber; - UCHAR SubordinateBusNumber; - UCHAR CardbusLatencyTimer; - ULONG MemoryBase0; - ULONG MemoryLimit0; - ULONG MemoryBase1; - ULONG MemoryLimit1; - USHORT IOBase0_LO; - USHORT IOBase0_HI; - USHORT IOLimit0_LO; - USHORT IOLimit0_HI; - USHORT IOBase1_LO; - USHORT IOBase1_HI; - USHORT IOLimit1_LO; - USHORT IOLimit1_HI; - UCHAR InterruptLine; - UCHAR InterruptPin; - USHORT BridgeControl; - USHORT SubVendorID; - USHORT SubSystemID; - ULONG LegacyBaseAddress; - UCHAR Reserved3[56]; - ULONG SystemControl; - UCHAR MultiMediaControl; - UCHAR GeneralStatus; - UCHAR Reserved4[2]; - UCHAR GPIO0Control; - UCHAR GPIO1Control; - UCHAR GPIO2Control; - UCHAR GPIO3Control; - ULONG IRQMuxRouting; - UCHAR RetryStatus; - UCHAR CardControl; - UCHAR DeviceControl; - UCHAR Diagnostic; + u32 BaseAddress; + u8 CapabilitiesPtr; + u8 Reserved2; + u16 SecondaryStatus; + u8 PrimaryBusNumber; + u8 CardbusBusNumber; + u8 SubordinateBusNumber; + u8 CardbusLatencyTimer; + u32 MemoryBase0; + u32 MemoryLimit0; + u32 MemoryBase1; + u32 MemoryLimit1; + u16 IOBase0_LO; + u16 IOBase0_HI; + u16 IOLimit0_LO; + u16 IOLimit0_HI; + u16 IOBase1_LO; + u16 IOBase1_HI; + u16 IOLimit1_LO; + u16 IOLimit1_HI; + u8 InterruptLine; + u8 InterruptPin; + u16 BridgeControl; + u16 SubVendorID; + u16 SubSystemID; + u32 LegacyBaseAddress; + u8 Reserved3[56]; + u32 SystemControl; + u8 MultiMediaControl; + u8 GeneralStatus; + u8 Reserved4[2]; + u8 GPIO0Control; + u8 GPIO1Control; + u8 GPIO2Control; + u8 GPIO3Control; + u32 IRQMuxRouting; + u8 RetryStatus; + u8 CardControl; + u8 DeviceControl; + u8 Diagnostic; } type2; #endif } u; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/drv_types_sdio.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/drv_types_sdio.h index 736ae0658764..6375bbf14929 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/drv_types_sdio.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/drv_types_sdio.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -24,11 +20,8 @@ #ifdef PLATFORM_LINUX #include #include - - #if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) || defined(CONFIG_PLATFORM_SPRD) - #include - #include - #endif + #include + #include #ifdef CONFIG_PLATFORM_SPRD #include @@ -36,15 +29,10 @@ #endif /* CONFIG_PLATFORM_SPRD */ #endif -#ifdef PLATFORM_OS_XP - #include - #include -#endif - -#ifdef PLATFORM_OS_CE - #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,25 +42,12 @@ typedef struct sdio_data { u32 block_transfer_len; #ifdef PLATFORM_LINUX + struct mmc_card *card; struct sdio_func *func; _thread_hdl_ sys_sdio_irq_thd; -#endif - -#ifdef PLATFORM_OS_XP - PDEVICE_OBJECT pphysdevobj; - PDEVICE_OBJECT pfuncdevobj; - PDEVICE_OBJECT pnextdevobj; - SDBUS_INTERFACE_STANDARD sdbusinft; - u8 nextdevstacksz; -#endif - -#ifdef PLATFORM_OS_CE - SD_DEVICE_HANDLE hDevice; - SD_CARD_RCA sd_rca; - SD_CARD_INTERFACE card_intf; - BOOLEAN enableIsarWithStatus; - WCHAR active_path[MAX_ACTIVE_REG_PATH]; - SD_HOST_BLOCK_CAPABILITY sd_host_blk_cap; + unsigned int clock; + unsigned int timing; + u8 sd3_bus_mode; #endif } SDIO_DATA, *PSDIO_DATA; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/drv_types_xp.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/drv_types_xp.h index 93766bebedc3..7bbd2403ca71 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/drv_types_xp.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/drv_types_xp.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/ethernet.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/ethernet.h index e1276050abb8..88152be8a7d3 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/ethernet.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/ethernet.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 @@ -28,14 +24,14 @@ #define MINIMUM_ETHERNET_PACKET_SIZE 60 /* !< Minimum Ethernet Packet Size */ #define MAXIMUM_ETHERNET_PACKET_SIZE 1514 /* !< Maximum Ethernet Packet Size */ -#define RT_ETH_IS_MULTICAST(_pAddr) ((((UCHAR *)(_pAddr))[0]&0x01) != 0) /* !< Is Multicast Address? */ +#define RT_ETH_IS_MULTICAST(_pAddr) ((((u8 *)(_pAddr))[0]&0x01) != 0) /* !< Is Multicast Address? */ #define RT_ETH_IS_BROADCAST(_pAddr) (\ - ((UCHAR *)(_pAddr))[0] == 0xff && \ - ((UCHAR *)(_pAddr))[1] == 0xff && \ - ((UCHAR *)(_pAddr))[2] == 0xff && \ - ((UCHAR *)(_pAddr))[3] == 0xff && \ - ((UCHAR *)(_pAddr))[4] == 0xff && \ - ((UCHAR *)(_pAddr))[5] == 0xff) /* !< Is Broadcast Address? */ + ((u8 *)(_pAddr))[0] == 0xff && \ + ((u8 *)(_pAddr))[1] == 0xff && \ + ((u8 *)(_pAddr))[2] == 0xff && \ + ((u8 *)(_pAddr))[3] == 0xff && \ + ((u8 *)(_pAddr))[4] == 0xff && \ + ((u8 *)(_pAddr))[5] == 0xff) /* !< Is Broadcast Address? */ #endif /* #ifndef __INC_ETHERNET_H */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/gspi_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/gspi_hal.h index 98fec090a7f3..5aefa3ed42b4 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/gspi_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/gspi_hal.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/gspi_ops.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/gspi_ops.h index 7a8cb632a8de..676bf658e2cb 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/gspi_ops.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/gspi_ops.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/gspi_ops_linux.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/gspi_ops_linux.h index 9bd18da14662..a70f86c75e28 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/gspi_ops_linux.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/gspi_ops_linux.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/gspi_osintf.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/gspi_osintf.h index e51d2e4f4784..b2bcf57dbc74 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/gspi_osintf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/gspi_osintf.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,20 +12,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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __SDIO_OSINTF_H__ #define __SDIO_OSINTF_H__ -#ifdef PLATFORM_OS_CE - extern NDIS_STATUS ce_sd_get_dev_hdl(PADAPTER padapter); - SD_API_STATUS ce_sd_int_callback(SD_DEVICE_HANDLE hDevice, PADAPTER padapter); - extern void sd_setup_irs(PADAPTER padapter); -#endif - #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/h2clbk.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/h2clbk.h index e7f0df55e74d..fc21f084a26f 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/h2clbk.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/h2clbk.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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_ @@ -26,6 +22,6 @@ void _lbk_cmd(PADAPTER Adapter); void _lbk_rsp(PADAPTER Adapter); -void _lbk_evt(IN PADAPTER Adapter); +void _lbk_evt(PADAPTER Adapter); void h2c_event_callback(unsigned char *dev, unsigned char *pbuf); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_btcoex.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_btcoex.h index a1b49141e760..8756a046d8e8 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_btcoex.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_btcoex.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +38,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); @@ -70,6 +68,9 @@ u8 hal_btcoex_IsLpsOn(PADAPTER); u8 hal_btcoex_RpwmVal(PADAPTER); u8 hal_btcoex_LpsVal(PADAPTER); u32 hal_btcoex_GetRaMask(PADAPTER); +u8 hal_btcoex_query_reduced_wl_pwr_lvl(PADAPTER padapter); +void hal_btcoex_set_reduced_wl_pwr_lvl(PADAPTER padapter, u8 val); +void hal_btcoex_do_reduce_wl_pwr_lvl(PADAPTER padapter); void hal_btcoex_RecordPwrMode(PADAPTER padapter, u8 *pCmdBuf, u8 cmdLen); void hal_btcoex_DisplayBtCoexInfo(PADAPTER, u8 *pbuf, u32 bufsize); void hal_btcoex_SetDBG(PADAPTER, u32 *pDbgModule); @@ -83,11 +84,24 @@ void hal_btcoex_StackUpdateProfileInfo(void); 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); + int hal_btcoex_AntIsolationConfig_ParaFile(PADAPTER Adapter, char *pFileName); int hal_btcoex_ParseAntIsolationConfigFile(PADAPTER Adapter, char *buffer); #endif /* CONFIG_LOAD_PHY_PARA_FROM_FILE */ 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); +u16 hal_btcoex_btset_testode(PADAPTER padapter, u8 type); + +#ifdef CONFIG_RF4CE_COEXIST +void hal_btcoex_set_rf4ce_link_state(u8 state); +u8 hal_btcoex_get_rf4ce_link_state(void); +#endif + +#ifdef CONFIG_SDIO_HCI +#include /* sdio multi coex */ +#endif + #endif /* !__HAL_BTCOEX_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_btcoex_wifionly.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_btcoex_wifionly.h index 89b3ad5321c9..15aef52ac304 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_btcoex_wifionly.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_btcoex_wifionly.h @@ -1,10 +1,40 @@ /* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * 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 +/* Define the ICs that support wifi only cfg in coex. codes */ +#if defined(CONFIG_RTL8723B) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822C) +#define CONFIG_BTCOEX_SUPPORT_WIFI_ONLY_CFG 1 +#else +#define CONFIG_BTCOEX_SUPPORT_WIFI_ONLY_CFG 0 +#endif + +/* Define the ICs that support hal btc common file structure */ +#if defined(CONFIG_RTL8822C) +#define CONFIG_BTCOEX_SUPPORT_BTC_CMN 1 +#else +#define CONFIG_BTCOEX_SUPPORT_BTC_CMN 0 +#endif + +#if (CONFIG_BTCOEX_SUPPORT_WIFI_ONLY_CFG == 1) + typedef enum _WIFIONLY_CHIP_INTERFACE { WIFIONLY_INTF_UNKNOWN = 0, WIFIONLY_INTF_PCI = 1, @@ -27,22 +57,33 @@ struct wifi_only_haldata { }; struct wifi_only_cfg { - PVOID Adapter; - struct wifi_only_haldata haldata_info; + void *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, u8 eRFPath, u32 RegAddr, u32 BitMask, u32 Data); -void halwifionly_phy_set_bb_reg(PVOID pwifionlyContext, u32 RegAddr, u32 BitMask, u32 Data); +void halwifionly_write1byte(void *pwifionlyContext, u32 RegAddr, u8 Data); +void halwifionly_write2byte(void *pwifionlyContext, u32 RegAddr, u16 Data); +void halwifionly_write4byte(void *pwifionlyContext, u32 RegAddr, u32 Data); +u8 halwifionly_read1byte(void *pwifionlyContext, u32 RegAddr); +u16 halwifionly_read2byte(void *pwifionlyContext, u32 RegAddr); +u32 halwifionly_read4byte(void *pwifionlyContext, u32 RegAddr); +void halwifionly_bitmaskwrite1byte(void *pwifionlyContext, u32 regAddr, u8 bitMask, u8 data); +void halwifionly_phy_set_rf_reg(void *pwifionlyContext, enum rf_path eRFPath, u32 RegAddr, u32 BitMask, u32 Data); +void halwifionly_phy_set_bb_reg(void *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_connect_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); +#else +#define hal_btcoex_wifionly_switchband_notify(padapter) +#define hal_btcoex_wifionly_scan_notify(padapter) +#define hal_btcoex_wifionly_connect_notify(padapter) +#define hal_btcoex_wifionly_hw_config(padapter) +#define hal_btcoex_wifionly_initlizevariables(padapter) +#define hal_btcoex_wifionly_AntInfoSetting(padapter) +#endif + #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_com.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_com.h index a3d193a64b9b..bd7efbf2483f 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_com.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_com.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -270,6 +266,8 @@ struct dbg_rx_counter { u32 rx_ht_fa; }; +u8 rtw_hal_get_port(_adapter *adapter); + #ifdef CONFIG_MBSSID_CAM #define DBG_MBID_CAM_DUMP @@ -280,12 +278,19 @@ struct dbg_rx_counter { u8 rtw_get_mbid_cam_entry_num(_adapter *adapter); int rtw_mbid_cam_cache_dump(void *sel, const char *fun_name , _adapter *adapter); int rtw_mbid_cam_dump(void *sel, const char *fun_name, _adapter *adapter); - void rtw_mbid_cam_restore(_adapter *adapter); + void rtw_mi_set_mbid_cam(_adapter *adapter); + u8 rtw_mbid_camid_alloc(_adapter *adapter, u8 *mac_addr); + void rtw_ap_set_mbid_num(_adapter *adapter, u8 ap_num); + void rtw_mbid_cam_enable(_adapter *adapter); #endif #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 + void hw_var_set_opmode_mbid(_adapter *Adapter, u8 mode); #endif void rtw_dump_mac_rx_counters(_adapter *padapter, struct dbg_rx_counter *rx_counter); @@ -332,7 +337,9 @@ void rtw_hal_config_rftype(PADAPTER padapter); #define WL_FUNC_FTM BIT3 #define WL_FUNC_BIT_NUM 4 -#define TBTT_PROBIHIT_HOLD_TIME 0x80 +#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); @@ -343,26 +350,31 @@ bool hal_chk_proto_cap(_adapter *adapter, u8 cap); bool hal_is_band_support(_adapter *adapter, u8 band); bool hal_is_bw_support(_adapter *adapter, u8 bw); bool hal_is_wireless_mode_support(_adapter *adapter, u8 mode); +bool hal_is_mimo_support(_adapter *adapter); u8 hal_largest_bw(_adapter *adapter, u8 in_bw); bool hal_chk_wl_func(_adapter *adapter, u8 func); -u8 hal_com_config_channel_plan( - IN PADAPTER padapter, - IN char *hw_alpha2, - IN u8 hw_chplan, - IN char *sw_alpha2, - IN u8 sw_chplan, - IN u8 def_chplan, - IN BOOLEAN AutoLoadFail +void hal_com_config_channel_plan( + PADAPTER padapter, + char *hw_alpha2, + u8 hw_chplan, + char *sw_alpha2, + u8 sw_chplan, + u8 def_chplan, + BOOLEAN AutoLoadFail ); int hal_config_macaddr(_adapter *adapter, bool autoload_fail); +#ifdef RTW_HALMAC +void rtw_hal_hw_port_enable(_adapter *adapter); +void rtw_hal_hw_port_disable(_adapter *adapter); +#endif BOOLEAN HAL_IsLegalChannel( - IN PADAPTER Adapter, - IN u32 Channel + PADAPTER Adapter, + u32 Channel ); u8 MRateToHwRate(u8 rate); @@ -370,18 +382,19 @@ u8 MRateToHwRate(u8 rate); u8 hw_rate_to_m_rate(u8 rate); void HalSetBrateCfg( - IN PADAPTER Adapter, - IN u8 *mBratesOS, - OUT u16 *pBrateCfg); + PADAPTER Adapter, + u8 *mBratesOS, + u16 *pBrateCfg); BOOLEAN Hal_MappingOutPipe( - IN PADAPTER pAdapter, - IN u8 NumOutPipe + PADAPTER pAdapter, + u8 NumOutPipe ); void rtw_dump_fw_info(void *sel, _adapter *adapter); -void rtw_restore_mac_addr(_adapter *adapter);/*set mac addr when hal_init for all iface*/ +void rtw_restore_hw_port_cfg(_adapter *adapter); +void rtw_mi_set_mac_addr(_adapter *adapter);/*set mac addr when hal_init for all iface*/ void rtw_hal_dump_macaddr(void *sel, _adapter *adapter); void rtw_init_hal_com_default_value(PADAPTER Adapter); @@ -396,9 +409,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); @@ -408,15 +424,42 @@ 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 rtw_iface_enable_tsf_update(_adapter *adapter); +void rtw_iface_disable_tsf_update(_adapter *adapter); +void rtw_hal_periodic_tsf_update_chk(_adapter *adapter); +void rtw_hal_periodic_tsf_update_end_timer_hdl(void *ctx); + +#if CONFIG_TX_AC_LIFETIME +#define TX_ACLT_CONF_DEFAULT 0 +#define TX_ACLT_CONF_AP_M2U 1 +#define TX_ACLT_CONF_MESH 2 +#define TX_ACLT_CONF_NUM 3 + +extern const char *const _tx_aclt_conf_str[]; +#define tx_aclt_conf_str(conf) (((conf) >= TX_ACLT_CONF_NUM) ? _tx_aclt_conf_str[TX_ACLT_CONF_NUM] : _tx_aclt_conf_str[(conf)]) + +struct tx_aclt_conf_t { + u8 en; + u32 vo_vi; + u32 be_bk; +}; + +void dump_tx_aclt_force_val(void *sel, struct dvobj_priv *dvobj); +void rtw_hal_set_tx_aclt_force_val(_adapter *adapter, struct tx_aclt_conf_t *input, u8 arg_num); +void dump_tx_aclt_confs(void *sel, struct dvobj_priv *dvobj); +void rtw_hal_set_tx_aclt_conf(_adapter *adapter, u8 conf_idx, struct tx_aclt_conf_t *input, u8 arg_num); +void rtw_hal_update_tx_aclt(_adapter *adapter); +#endif void hw_var_port_switch(_adapter *adapter); - -void SetHwReg(PADAPTER padapter, u8 variable, u8 *val); +void rtw_var_set_basic_rate(PADAPTER padapter, 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); @@ -433,42 +476,42 @@ eqNByte( u32 MapCharToHexDigit( - IN char chTmp + char chTmp ); BOOLEAN GetHexValueFromString( - IN char *szStr, - IN OUT u32 *pu4bVal, - IN OUT u32 *pu4bMove + char *szStr, + u32 *pu4bVal, + u32 *pu4bMove ); BOOLEAN GetFractionValueFromString( - IN char *szStr, - IN OUT u8 *pInteger, - IN OUT u8 *pFraction, - IN OUT u32 *pu4bMove + char *szStr, + u8 *pInteger, + u8 *pFraction, + u32 *pu4bMove ); BOOLEAN IsCommentString( - IN char *szStr + char *szStr ); BOOLEAN ParseQualifiedString( - IN char *In, - IN OUT u32 *Start, - OUT char *Out, - IN char LeftQualifier, - IN char RightQualifier + char *In, + u32 *Start, + char *Out, + char LeftQualifier, + char RightQualifier ); BOOLEAN GetU1ByteIntegerFromStringInDecimal( - IN char *Str, - IN OUT u8 *pInt + char *Str, + u8 *pInt ); BOOLEAN @@ -488,13 +531,12 @@ void linked_info_dump(_adapter *padapter, u8 benable); #endif void rtw_store_phy_info(_adapter *padapter, union recv_frame *prframe); #define HWSET_MAX_SIZE 1024 + #ifdef CONFIG_EFUSE_CONFIG_FILE - #define EFUSE_FILE_COLUMN_NUM 16 - u32 Hal_readPGDataFromConfigFile(PADAPTER padapter); - u32 Hal_ReadMACAddrFromFile(PADAPTER padapter, u8 *mac_addr); +u32 Hal_readPGDataFromConfigFile(PADAPTER padapter); +u32 Hal_ReadMACAddrFromFile(PADAPTER padapter, u8 *mac_addr); #endif /* CONFIG_EFUSE_CONFIG_FILE */ -int check_phy_efuse_tx_power_info_valid(PADAPTER padapter); int hal_efuse_macaddr_offset(_adapter *adapter); int Hal_GetPhyEfuseMACAddr(PADAPTER padapter, u8 *mac_addr); void rtw_dump_cur_efuse(PADAPTER padapter); @@ -505,32 +547,19 @@ 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; -}; +u8 rtw_get_current_tx_rate(_adapter *padapter, struct sta_info *psta); +u8 rtw_get_current_tx_sgi(_adapter *padapter, struct sta_info *psta); +#ifdef CONFIG_CUSTOMER01_SMART_ANTENNA +void rtw_hal_set_pathb_phase(_adapter *adapter, u8 phase_idx); #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); -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 +u64 rtw_hal_get_tsftr_by_port(_adapter *adapter, u8 port); #ifdef CONFIG_TDLS #ifdef CONFIG_TDLS_CH_SW @@ -538,7 +567,7 @@ void rtw_hal_set_fw_rsvd_page(_adapter *adapter, bool finished); #endif #endif #if defined(CONFIG_BT_COEXIST) && defined(CONFIG_FW_MULTI_PORT_SUPPORT) -s32 rtw_hal_set_wifi_port_id_cmd(_adapter *adapter); +s32 rtw_hal_set_wifi_btc_port_id_cmd(_adapter *adapter); #endif #ifdef CONFIG_GPIO_API @@ -556,52 +585,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]; @@ -609,20 +595,12 @@ static inline u32 rtw_phydm_ability_get(_adapter *adapter) #endif 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); +#ifdef CONFIG_RTS_FULL_BW +void rtw_set_rts_bw(_adapter *padapter); +#endif/*CONFIG_RTS_FULL_BW*/ void ResumeTxBeacon(_adapter *padapter); void StopTxBeacon(_adapter *padapter); -#ifdef CONFIG_MI_WITH_MBSSID_CAM /*HW port0 - MBSS*/ - void hw_var_set_opmode_mbid(_adapter *Adapter, u8 mode); - u8 rtw_mbid_camid_alloc(_adapter *adapter, u8 *mac_addr); -#endif #ifdef CONFIG_ANTENNA_DIVERSITY u8 rtw_hal_antdiv_before_linked(_adapter *padapter); @@ -652,13 +630,17 @@ void StopTxBeacon(_adapter *padapter); enum lps_pg_hdl_id { LPS_PG_INFO_CFG = 0, LPS_PG_REDLEMEM, - LPS_PG_RESEND_H2C, + LPS_PG_PHYDM_DIS, + LPS_PG_PHYDM_EN, }; - u8 rtw_hal_set_lps_pg_info(_adapter *adapter); +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); +void rtw_hal_construct_beacon(_adapter *padapter, u8 *pframe, u32 *pLength); +void rtw_hal_construct_NullFunctionData(PADAPTER, u8 *pframe, u32 *pLength, + u8 bQoS, u8 AC, u8 bEosp, u8 bForcePowerSave); #ifdef CONFIG_WOWLAN struct rtl_wow_pattern { @@ -672,14 +654,89 @@ void rtw_wow_pattern_cam_dump(_adapter *adapter); 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 -#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 */ +}; +#define REMOTE_INFO_CTRL_SET_VALD_EN(target, _value) \ + SET_BITS_TO_LE_4BYTE(target + 0, 0, 8, _value) +#define REMOTE_INFO_CTRL_SET_PTK_EN(target, _value) \ + SET_BITS_TO_LE_4BYTE(target + 1, 0, 1, _value) +#define REMOTE_INFO_CTRL_SET_GTK_EN(target, _value) \ + SET_BITS_TO_LE_4BYTE(target + 1, 1, 1, _value) +#define REMOTE_INFO_CTRL_SET_GTK_IDX(target, _value) \ + SET_BITS_TO_LE_4BYTE(target + 2, 0, 8, _value) +#endif /*CONFIG_WOWLAN*/ + 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); + +#define get_dft_portid(adapter) (adapter_to_dvobj(adapter)->dft.port_id) +#define get_dft_macid(adapter) (adapter_to_dvobj(adapter)->dft.mac_id) + +/*void rtw_search_default_port(_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 + +#ifdef RTW_CHANNEL_SWITCH_OFFLOAD +void rtw_hal_switch_chnl_and_set_bw_offload(_adapter *adapter, u8 central_ch, u8 pri_ch_idx, u8 bw); +#endif + +s16 translate_dbm_to_percentage(s16 signal); + +#ifdef CONFIG_SUPPORT_MULTI_BCN +void rtw_ap_multi_bcn_cfg(_adapter *adapter); +#endif + +#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*/ + +#ifdef CONFIG_FW_HANDLE_TXBCN +void rtw_ap_mbid_bcn_en(_adapter *adapter, u8 mbcn_id); +void rtw_ap_mbid_bcn_dis(_adapter *adapter, u8 mbcn_id); +#endif + +void rtw_hal_get_rf_path(struct dvobj_priv *d, enum rf_type *type, + enum bb_path *tx, enum bb_path *rx); +#ifdef CONFIG_BEAMFORMING +#ifdef RTW_BEAMFORMING_VERSION_2 +void rtw_hal_beamforming_config_csirate(PADAPTER adapter); +#endif +#endif +#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8812A) ||\ + defined(CONFIG_RTL8192F) || defined(CONFIG_RTL8192E) ||\ + defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821A) || \ + defined(CONFIG_RTL8822C) +u8 phy_get_current_tx_num(PADAPTER pAdapter, u8 Rate); +#endif + +#ifdef CONFIG_RTL8812A +u8 * rtw_hal_set_8812a_vendor_ie(_adapter *padapter , u8 *pframe ,uint *frlen ); #endif #endif /* __HAL_COMMON_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_com_h2c.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_com_h2c.h index 2cbfa2510ec3..c35339801904 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_com_h2c.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_com_h2c.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -40,14 +36,16 @@ enum h2c_cmd { H2C_FCS_INFO = 0x11, H2C_AP_WOW_GPIO_CTRL = 0x13, #ifdef CONFIG_MCC_MODE - H2C_MCC_UPDATE_PARAM = 0x15, + H2C_MCC_RQT_TSF = 0x15, H2C_MCC_MACID_BITMAP = 0x16, H2C_MCC_LOCATION = 0x10, + H2C_MCC_CTRL_V2 = 0x17, H2C_MCC_CTRL = 0x18, - H2C_MCC_NOA_PARAM = 0x19, + H2C_MCC_TIME_SETTING = 0x19, H2C_MCC_IQK_PARAM = 0x1A, #endif /* CONFIG_MCC_MODE */ H2C_CHNL_SWITCH_OPER_OFFLOAD = 0x1C, + H2C_SINGLE_CHANNELSWITCH_V2 = 0x1D, /* PoweSave Class: 001 */ H2C_SET_PWR_MODE = 0x20, @@ -83,7 +81,9 @@ enum h2c_cmd { H2C_DYNAMIC_TX_PATH = 0x48,/* for 8814A */ H2C_FW_TRACE_EN = 0x49, - +#ifdef RTW_PER_CMD_SUPPORT_FW + H2C_REQ_PER_RPT = 0x4e, +#endif /* BT Class: 011 */ H2C_B_TYPE_TDMA = 0x60, H2C_BT_INFO = 0x61, @@ -111,16 +111,23 @@ enum h2c_cmd { H2C_AOAC_RSVDPAGE3 = 0x88, H2C_P2P_OFFLOAD_RSVD_PAGE = 0x8A, H2C_P2P_OFFLOAD = 0x8B, - +#ifdef CONFIG_FW_HANDLE_TXBCN + H2C_FW_BCN_OFFLOAD = 0xBA, +#endif H2C_RESET_TSF = 0xC0, +#ifdef CONFIG_FW_CORRECT_BCN H2C_BCNHWSEQ = 0xC5, +#endif H2C_CUSTOMER_STR_W1 = 0xC6, H2C_CUSTOMER_STR_W2 = 0xC7, H2C_CUSTOMER_STR_W3 = 0xC8, +#ifdef DBG_FW_DEBUG_MSG_PKT + H2C_FW_DBG_MSG_PKT = 0xE1, +#endif /*DBG_FW_DEBUG_MSG_PKT*/ H2C_MAXID, }; -#define H2C_INACTIVE_PS_LEN 3 +#define H2C_INACTIVE_PS_LEN 4 #define H2C_RSVDPAGE_LOC_LEN 5 #ifdef CONFIG_FW_MULTI_PORT_SUPPORT #define H2C_DEFAULT_PORT_ID_LEN 2 @@ -137,7 +144,7 @@ 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 7 #define H2C_REMOTE_WAKE_CTRL_LEN 3 #define H2C_AOAC_GLOBAL_INFO_LEN 2 #define H2C_AOAC_RSVDPAGE_LOC_LEN 7 @@ -152,14 +159,22 @@ enum h2c_cmd { #define H2C_P2P_OFFLOAD_LEN 3 #ifdef CONFIG_MCC_MODE #define H2C_MCC_CTRL_LEN 7 +#ifdef CONFIG_MCC_MODE_V2 + #define H2C_MCC_LOCATION_LEN 7 +#else #define H2C_MCC_LOCATION_LEN 3 +#endif #define H2C_MCC_MACID_BITMAP_LEN 6 - #define H2C_MCC_UPDATE_INFO_LEN 4 - #define H2C_MCC_NOA_PARAM_LEN 4 + #define H2C_MCC_RQT_TSF_LEN 1 + #define H2C_MCC_TIME_SETTING_LEN 6 #define H2C_MCC_IQK_PARAM_LEN 7 #endif /* CONFIG_MCC_MODE */ #ifdef CONFIG_LPS_PG +#ifdef CONFIG_RTL8822C + #define H2C_LPS_PG_INFO_LEN 4 +#else #define H2C_LPS_PG_INFO_LEN 2 +#endif #define H2C_LPSPG_LEN 16 #endif #ifdef CONFIG_LPS_POFF @@ -170,35 +185,19 @@ enum h2c_cmd { #if defined(CONFIG_BT_COEXIST) && defined(CONFIG_FW_MULTI_PORT_SUPPORT) #define H2C_BTC_WL_PORT_ID_LEN 1 #endif + +#ifdef DBG_FW_DEBUG_MSG_PKT + #define H2C_FW_DBG_MSG_PKT_LEN 2 +#endif /*DBG_FW_DEBUG_MSG_PKT*/ + +#define H2C_SINGLE_CHANNELSWITCH_V2_LEN 2 + #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 -* -* LLC Header */ -#define GET_ARP_PKT_LLC_TYPE(__pHeader) ReadLE2Byte(((u8 *)(__pHeader)) + 6) - -/* ARP element */ -#define GET_ARP_PKT_OPERATION(__pHeader) ReadLE2Byte(((u8 *)(__pHeader)) + 6) -#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) 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) -#define SET_ARP_PKT_PROTOCOL(__pHeader, __Value) WriteLE2Byte(((u8 *)(__pHeader)) + 2, __Value) -#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) 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) 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) #define FW_WOWLAN_PATTERN_MATCH BIT(1) #define FW_WOWLAN_MAGIC_PKT BIT(2) @@ -223,6 +222,9 @@ enum h2c_cmd { #define FW_REALWOWLAN_EN BIT(5) #define FW_WOW_FW_UNICAST_EN BIT(7) +#define FW_IPS_DISABLE_BBRF BIT(0) +#define FW_IPS_WRC BIT(1) + #endif /* CONFIG_WOWLAN */ /* _RSVDPAGE_LOC_CMD_0x00 */ @@ -254,7 +256,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)]) @@ -279,9 +282,12 @@ s32 rtw_hal_set_FwMediaStatusRpt_range_cmd(_adapter *adapter, bool opmode, bool /* _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_PARM_TRY_BCN_FAIL_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) +#define SET_H2CCMD_DISCONDECISION_PARM_DISCONNECT_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 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) +#define SET_H2CCMD_DISCONDECISION_PARM_TRY_OK_BCN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) #ifdef CONFIG_RTW_CUSTOMER_STR #define RTW_CUSTOMER_STR_LEN 16 @@ -334,6 +340,22 @@ 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_IGNORE_PS(__pH2CCmd, __Value) \ + SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) +#define SET_H2CCMD_INACTIVE_PERIOD_SCAN_EN(__pH2CCmd, __Value) \ + SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) +#define SET_H2CCMD_INACTIVE_DISBBRF(__pH2CCmd, __Value) \ + SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 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) \ @@ -362,12 +384,36 @@ s32 rtw_hal_customer_str_write(_adapter *adapter, const u8 *cs); #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) +#define SET_H2CCMD_MCC_PWRIDX_OFFLOAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd) + 3, 0, 1, __Value) +#define SET_H2CCMD_MCC_PWRIDX_OFFLOAD_RFNUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd) + 3, 4, 4, __Value) +#define SET_H2CCMD_MCC_PWRIDX_RSVDPAGE_LOC(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd) + 4, 0, 8, __Value) + +/* MCC RQT TSF 0x15 */ +#define SET_H2CCMD_MCC_RQT_TSFX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 4, __Value) +#define SET_H2CCMD_MCC_RQT_TSFY(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 4, __Value) /* MCC MAC ID CMD 0x16 */ #define SET_H2CCMD_MCC_MACID_BITMAP_L(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) #define SET_H2CCMD_MCC_MACID_BITMAP_H(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -/* MCC INFO CMD 0x18 */ +/* NEW MCC CTRL CMD 0x17 */ +#define SET_H2CCMD_MCC_CTRL_V2_ORDER(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 4, __Value) +#define SET_H2CCMD_MCC_CTRL_V2_TOTALNUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 4, __Value) +#define SET_H2CCMD_MCC_CTRL_V2_CENTRAL_CH(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) +#define SET_H2CCMD_MCC_CTRL_V2_PRIMARY_CH(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 4, __Value) +#define SET_H2CCMD_MCC_CTRL_V2_BW(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 4, 4, __Value) +#define SET_H2CCMD_MCC_CTRL_V2_DURATION(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) +#define SET_H2CCMD_MCC_CTRL_V2_ROLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 3, __Value) +#define SET_H2CCMD_MCC_CTRL_V2_INCURCH(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 3, 1, __Value) +#define SET_H2CCMD_MCC_CTRL_V2_DIS_SW_RETRY(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 4, 1, __Value) +#define SET_H2CCMD_MCC_CTRL_V2_DISTXNULL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 5, 1, __Value) +#define SET_H2CCMD_MCC_CTRL_V2_C2HRPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 6, 2, __Value) +#define SET_H2CCMD_MCC_CTRL_V2_TSFX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 4, __Value) +#define SET_H2CCMD_MCC_CTRL_V2_NULL_EARLY(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 4, 4, __Value) +#define SET_H2CCMD_MCC_CTRL_V2_UPDATE_PARM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+6, 7, 1, __Value) + + +/* MCC CTRL CMD 0x18 */ #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) @@ -384,12 +430,16 @@ s32 rtw_hal_customer_str_write(_adapter *adapter, const u8 *cs); #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) -#define SET_H2CCMD_MCC_NOA_TSF_SYNC_OFFSET(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 7, __Value) -#define SET_H2CCMD_MCC_NOA_START_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -#define SET_H2CCMD_MCC_NOA_INTERVAL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) -#define SET_H2CCMD_MCC_EARLY_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) +/* MCC Time CMD 0x19 */ +#define SET_H2CCMD_MCC_TIME_SETTING_FW_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) +#define SET_H2CCMD_MCC_TIME_SETTING_TSF_SYNC_OFFSET(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 7, __Value) +#define SET_H2CCMD_MCC_TIME_SETTING_START_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) +#define SET_H2CCMD_MCC_TIME_SETTING_INTERVAL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) +#define SET_H2CCMD_MCC_TIME_SETTING_EARLY_SWITCH_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) +#define SET_H2CCMD_MCC_TIME_SETTING_ORDER_BASE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 4, __Value) +#define SET_H2CCMD_MCC_TIME_SETTING_ORDER_SYNC(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 4, 4, __Value) +#define SET_H2CCMD_MCC_TIME_SETTING_UPDATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 1, __Value) +#define SET_H2CCMD_MCC_TIME_SETTING_ORDER0_DURATION(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 1, 7, __Value) /* MCC IQK CMD 0x1A */ #define SET_H2CCMD_MCC_IQK_READY(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) @@ -412,6 +462,12 @@ 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) +/* H2C_SINGLE_CHANNELSWITCH_V2 = 0x1D */ +#define SET_H2CCMD_SINGLE_CH_SWITCH_V2_CENTRAL_CH_NUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) +#define SET_H2CCMD_SINGLE_CH_SWITCH_V2_PRIMARY_CH_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd) + 1, 0, 4, __Value) +#define SET_H2CCMD_SINGLE_CH_SWITCH_V2_BW(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd) + 1, 4, 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 @@ -430,8 +486,17 @@ 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) +#define SET_H2CCMD_WOWLAN_DEV2HST_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 7, 1, __Value) +#define SET_H2CCMD_WOWLAN_TIME_FOR_UPHY_DISABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) +#define SET_H2CCMD_WOWLAN_RISE_HST2DEV(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+6, 2, 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) @@ -460,6 +525,8 @@ 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 */ @@ -495,7 +562,22 @@ s32 rtw_hal_customer_str_write(_adapter *adapter, const u8 *cs); #define SET_H2CCMD_LPSPG_MACID_SEARCH_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 1, __Value)/*MACIDSearch_En*/ #define SET_H2CCMD_LPSPG_TXSC_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 1, __Value)/*TXSC_En*/ #define SET_H2CCMD_LPSPG_MU_RATE_TB_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 5, 1, __Value)/*MURateTable_En*/ -#define SET_H2CCMD_LPSPG_LOC(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value)/*Loc_LPS_PG*/ +#define SET_H2CCMD_LPSPG_LOC(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value)/*Loc_LPS_PG*/ +#define SET_H2CCMD_LPSPG_DPK_INFO_LOC(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value)/*Loc_LPS_PG_DPK_info*/ +#define SET_H2CCMD_LPSPG_IQK_INFO_LOC(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd) + 3, 0, 8, __Value)/*Loc_IQK_result*/ +#endif + +#ifdef DBG_FW_DEBUG_MSG_PKT +#define SET_H2CCMD_FW_DBG_MSG_PKT_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value)/*sniffer_dbg_en*/ +#define SET_H2CCMD_RSVDPAGE_LOC_FW_DBG_MSG_PKT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) /*loc_debug_packet*/ +#endif /*DBG_FW_DEBUG_MSG_PKT*/ + +#ifdef DBG_RSVD_PAGE_CFG +#define RSVD_PAGE_CFG(ops, v1, v2, v3) \ + RTW_INFO("=== [RSVD][%s]-NeedPage:%d, TotalPageNum:%d TotalPacketLen:%d ===\n", \ + ops, v1, v2, v3) +#else +#define RSVD_PAGE_CFG(ops, v1, v2, v3) do {} while (0) #endif /* --------------------------------------------------------------------------------------------------------- @@ -518,6 +600,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; @@ -534,8 +617,26 @@ typedef struct _RSVDPAGE_LOC { u8 LocInviteRsp; u8 LocPDRsp; #endif /* CONFIG_P2P_WOWLAN */ +#ifdef DBG_FW_DEBUG_MSG_PKT + u8 loc_fw_dbg_msg_pkt; +#endif /*DBG_FW_DEBUG_MSG_PKT*/ } RSVDPAGE_LOC, *PRSVDPAGE_LOC; +struct rsvd_page_cache_t { + char *name; + u8 loc; + u8 page_num; + u8 *data; + u32 size; +}; + +bool rsvd_page_cache_update_all(struct rsvd_page_cache_t *cache, u8 loc + , u8 txdesc_len, u32 page_size, u8 *info, u32 info_len); +bool rsvd_page_cache_update_data(struct rsvd_page_cache_t *cache, u8 *info + , u32 info_len); +void rsvd_page_cache_free_data(struct rsvd_page_cache_t *cache); +void rsvd_page_cache_free(struct rsvd_page_cache_t *cache); + #endif void dump_TX_FIFO(PADAPTER padapter, u8 page_num, u16 page_size); u8 rtw_hal_set_fw_media_status_cmd(_adapter *adapter, u8 mstatus, u8 macid); @@ -549,3 +650,8 @@ u8 rtw_hal_set_fw_media_status_cmd(_adapter *adapter, u8 mstatus, u8 macid); u8 rtw_hal_set_p2p_wowlan_offload_cmd(_adapter *adapter); #endif /* CONFIG_P2P_WOWLAN */ #endif + +#ifdef RTW_PER_CMD_SUPPORT_FW +u8 rtw_hal_set_req_per_rpt_cmd(_adapter *adapter, u8 group_macid, + u8 rpt_type, u32 macid_bitmap); +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_com_led.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_com_led.h index 01dbb9c54138..283479fcb1bc 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_com_led.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_com_led.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,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) /* ******************************************************************************** @@ -103,17 +102,21 @@ typedef enum _LED_CTL_MODE { LED_CTL_POWER_ON = 1, LED_CTL_LINK = 2, LED_CTL_NO_LINK = 3, - LED_CTL_TX = 4, - LED_CTL_RX = 5, - LED_CTL_SITE_SURVEY = 6, - LED_CTL_POWER_OFF = 7, - LED_CTL_START_TO_LINK = 8, - LED_CTL_START_WPS = 9, - LED_CTL_STOP_WPS = 10, - LED_CTL_START_WPS_BOTTON = 11, /* added for runtop */ - LED_CTL_STOP_WPS_FAIL = 12, /* added for ALPHA */ - LED_CTL_STOP_WPS_FAIL_OVERLAP = 13, /* added for BELKIN */ - LED_CTL_CONNECTION_NO_TRANSFER = 14, + LED_CTL_TX = 4, /* unspecific data TX, including single & group addressed */ + LED_CTL_RX = 5, /* unspecific data RX, including single & group addressed */ + LED_CTL_UC_TX = 6, /* single addressed data TX */ + LED_CTL_UC_RX = 7, /* single addressed data RX */ + LED_CTL_BMC_TX = 8, /* group addressed data TX */ + LED_CTL_BMC_RX = 9, /* group addressed data RX */ + LED_CTL_SITE_SURVEY = 10, + LED_CTL_POWER_OFF = 11, + LED_CTL_START_TO_LINK = 12, + LED_CTL_START_WPS = 13, + LED_CTL_STOP_WPS = 14, + LED_CTL_START_WPS_BOTTON = 15, /* added for runtop */ + LED_CTL_STOP_WPS_FAIL = 16, /* added for ALPHA */ + LED_CTL_STOP_WPS_FAIL_OVERLAP = 17, /* added for BELKIN */ + LED_CTL_CONNECTION_NO_TRANSFER = 18, } LED_CTL_MODE; typedef enum _LED_STATE { @@ -159,6 +162,8 @@ typedef enum _LED_PIN { * ******************************************************************************** */ #ifdef CONFIG_PCI_HCI typedef enum _LED_STRATEGY_PCIE { + /* start from 2 */ + SW_LED_MODE_UC_TRX_ONLY = 2, SW_LED_MODE0, /* 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. */ @@ -172,7 +177,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 { @@ -196,15 +200,15 @@ typedef struct _LED_PCIE { typedef struct _LED_PCIE LED_DATA, *PLED_DATA; typedef enum _LED_STRATEGY_PCIE LED_STRATEGY, *PLED_STRATEGY; -VOID +void LedControlPCIE( - IN PADAPTER Adapter, - IN LED_CTL_MODE LedAction + PADAPTER Adapter, + LED_CTL_MODE LedAction ); -VOID +void gen_RefreshLedState( - IN PADAPTER Adapter); + PADAPTER Adapter); /* ******************************************************************************** * USB LED Definition. @@ -220,6 +224,8 @@ gen_RefreshLedState( typedef enum _LED_STRATEGY_USB { + /* start from 2 */ + SW_LED_MODE_UC_TRX_ONLY = 2, SW_LED_MODE0, /* 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. */ @@ -236,7 +242,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 +274,13 @@ typedef struct _LED_USB { typedef struct _LED_USB LED_DATA, *PLED_DATA; typedef enum _LED_STRATEGY_USB LED_STRATEGY, *PLED_STRATEGY; - -VOID +#ifdef CONFIG_RTW_SW_LED +void LedControlUSB( - IN PADAPTER Adapter, - IN LED_CTL_MODE LedAction + PADAPTER Adapter, + LED_CTL_MODE LedAction ); +#endif /* ******************************************************************************** @@ -291,6 +297,8 @@ LedControlUSB( typedef enum _LED_STRATEGY_SDIO { + /* start from 2 */ + SW_LED_MODE_UC_TRX_ONLY = 2, SW_LED_MODE0, /* 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. */ @@ -298,7 +306,6 @@ typedef enum _LED_STRATEGY_SDIO { 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 { @@ -330,47 +337,39 @@ typedef struct _LED_SDIO { typedef struct _LED_SDIO LED_DATA, *PLED_DATA; typedef enum _LED_STRATEGY_SDIO LED_STRATEGY, *PLED_STRATEGY; -VOID +void LedControlSDIO( - IN PADAPTER Adapter, - IN LED_CTL_MODE LedAction + PADAPTER Adapter, + LED_CTL_MODE LedAction ); #endif struct led_priv { - /* add for led controll */ + LED_STRATEGY LedStrategy; +#ifdef CONFIG_RTW_SW_LED LED_DATA SwLed0; LED_DATA SwLed1; LED_DATA SwLed2; - LED_STRATEGY LedStrategy; u8 bRegUseLed; + u8 iface_en_mask; + u32 ctl_en_mask[CONFIG_IFACE_NUMBER]; 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) \ - (adapter)->ledpriv.SwLedOn((adapter), (pLed)); \ + if (adapter_to_led(adapter)->SwLedOn) \ + adapter_to_led(adapter)->SwLedOn((adapter), (pLed)); \ } while (0) #define SwLedOff(adapter, pLed) \ do { \ - if ((adapter)->ledpriv.SwLedOff) \ - (adapter)->ledpriv.SwLedOff((adapter), (pLed)); \ + if (adapter_to_led(adapter)->SwLedOff) \ + adapter_to_led(adapter)->SwLedOff((adapter), (pLed)); \ } while (0) void BlinkTimerCallback(void *data); @@ -392,5 +391,48 @@ DeInitLed( /* hal... */ extern void BlinkHandler(PLED_DATA pLed); +void dump_led_config(void *sel, _adapter *adapter); +void rtw_led_set_strategy(_adapter *adapter, u8 strategy); +#endif /* CONFIG_RTW_LED */ + +#if defined(CONFIG_RTW_LED) +#define rtw_led_get_strategy(adapter) (adapter_to_led(adapter)->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) + +#if defined(CONFIG_RTW_LED) && defined(CONFIG_RTW_SW_LED) + +#ifndef CONFIG_RTW_SW_LED_TRX_DA_CLASSIFY +#define CONFIG_RTW_SW_LED_TRX_DA_CLASSIFY 0 +#endif + +#if CONFIG_RTW_SW_LED_TRX_DA_CLASSIFY +void rtw_sw_led_blink_uc_trx_only(LED_DATA *led); +void rtw_sw_led_ctl_mode_uc_trx_only(_adapter *adapter, LED_CTL_MODE ctl); +#endif +void rtw_led_control(_adapter *adapter, LED_CTL_MODE ctl); +void rtw_led_tx_control(_adapter *adapter, const u8 *da); +void rtw_led_rx_control(_adapter *adapter, const u8 *da); +void rtw_led_set_iface_en(_adapter *adapter, u8 en); +void rtw_led_set_iface_en_mask(_adapter *adapter, u8 mask); +void rtw_led_set_ctl_en_mask(_adapter *adapter, u32 ctl_mask); +void rtw_led_set_ctl_en_mask_primary(_adapter *adapter); +void rtw_led_set_ctl_en_mask_virtual(_adapter *adapter); +#else +#define rtw_led_control(adapter, ctl) do {} while (0) +#define rtw_led_tx_control(adapter, da) do {} while (0) +#define rtw_led_rx_control(adapter, da) do {} while (0) +#define rtw_led_set_iface_en(adapter, en) do {} while (0) +#define rtw_led_set_iface_en_mask(adapter, mask) do {} while (0) +#define rtw_led_set_ctl_en_mask(adapter, ctl_mask) do {} while (0) +#define rtw_led_set_ctl_en_mask_primary(adapter) do {} while (0) +#define rtw_led_set_ctl_en_mask_virtual(adapter) do {} while (0) +#endif /* defined(CONFIG_RTW_LED) && defined(CONFIG_RTW_SW_LED) */ + +#endif /*__HAL_COMMON_LED_H_*/ -#endif /* __RTW_LED_H_ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_com_phycfg.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_com_phycfg.h index fb86c2b06087..1756d4462ace 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_com_phycfg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_com_phycfg.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -34,20 +30,6 @@ typedef enum _RF_TX_NUM { RF_TX_NUM_NONIMPLEMENT, } 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: */ @@ -76,199 +58,178 @@ typedef struct _BB_REGISTER_DEFINITION { /* ---------------------------------------------------------------------- */ u8 PHY_GetTxPowerByRateBase( - IN PADAPTER Adapter, - IN u8 Band, - IN u8 RfPath, - IN u8 TxNum, - IN RATE_SECTION RateSection + PADAPTER Adapter, + u8 Band, + u8 RfPath, + RATE_SECTION RateSection ); -VOID +void PHY_GetRateValuesOfTxPowerByRate( - IN PADAPTER pAdapter, - IN u32 RegAddr, - IN u32 BitMask, - IN u32 Value, - OUT u8 *Rate, - OUT s8 *PwrByRateVal, - OUT u8 *RateNum + PADAPTER pAdapter, + u32 RegAddr, + u32 BitMask, + u32 Value, + u8 *Rate, + s8 *PwrByRateVal, + u8 *RateNum ); u8 PHY_GetRateIndexOfTxPowerByRate( - IN u8 Rate + u8 Rate ); -VOID +void phy_set_tx_power_index_by_rate_section( - IN PADAPTER pAdapter, - IN u8 RFPath, - IN u8 Channel, - IN u8 RateSection + PADAPTER pAdapter, + enum rf_path RFPath, + u8 Channel, + u8 RateSection ); s8 _PHY_GetTxPowerByRate( - IN PADAPTER pAdapter, - IN u8 Band, - IN u8 RFPath, - IN u8 TxNum, - IN u8 RateIndex + PADAPTER pAdapter, + u8 Band, + enum rf_path RFPath, + u8 RateIndex ); s8 PHY_GetTxPowerByRate( - IN PADAPTER pAdapter, - IN u8 Band, - IN u8 RFPath, - IN u8 TxNum, - IN u8 RateIndex + PADAPTER pAdapter, + u8 Band, + enum rf_path RFPath, + 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 +void PHY_SetTxPowerByRate( - IN PADAPTER pAdapter, - IN u8 Band, - IN u8 RFPath, - IN u8 TxNum, - IN u8 Rate, - IN s8 Value + PADAPTER pAdapter, + u8 Band, + enum rf_path RFPath, + u8 Rate, + s8 Value ); -VOID +void phy_set_tx_power_level_by_path( - IN PADAPTER Adapter, - IN u8 channel, - IN u8 path + PADAPTER Adapter, + u8 channel, + u8 path ); -VOID +void PHY_SetTxPowerIndexByRateArray( - IN PADAPTER pAdapter, - IN u8 RFPath, - IN CHANNEL_WIDTH BandWidth, - IN u8 Channel, - IN u8 *Rates, - IN u8 RateArraySize + PADAPTER pAdapter, + enum rf_path RFPath, + enum channel_width BandWidth, + u8 Channel, + u8 *Rates, + u8 RateArraySize ); -VOID +void PHY_InitTxPowerByRate( - IN PADAPTER pAdapter + PADAPTER pAdapter ); -VOID +void phy_store_tx_power_by_rate( - IN PADAPTER pAdapter, - IN u32 Band, - IN u32 RfPath, - IN u32 TxNum, - IN u32 RegAddr, - IN u32 BitMask, - IN u32 Data + PADAPTER pAdapter, + u32 Band, + u32 RfPath, + u32 TxNum, + u32 RegAddr, + u32 BitMask, + u32 Data ); -VOID +void PHY_TxPowerByRateConfiguration( - IN PADAPTER pAdapter + PADAPTER pAdapter ); -u8 -PHY_GetTxPowerIndexBase( - IN PADAPTER pAdapter, - IN u8 RFPath, - IN u8 Rate, - IN CHANNEL_WIDTH BandWidth, - IN u8 Channel, - OUT PBOOLEAN bIn24G +u8 phy_get_pg_txpwr_idx( + PADAPTER pAdapter, + enum rf_path RFPath, + u8 Rate, + u8 ntx_idx, + enum channel_width BandWidth, + u8 Channel, + 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 +#if 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) (GET_HAL_SPEC(adapter)->txgi_max) +#define phy_get_txpwr_lmt(adapter, regd_name, band, bw, rfpath, rs, ntx_idx, cch, lock) (GET_HAL_SPEC(adapter)->txgi_max) +#define PHY_GetTxPowerLimit(adapter, regd_name, band, bw, rfpath, rate, ntx_idx, cch) (GET_HAL_SPEC(adapter)->txgi_max) +#endif /* CONFIG_TXPWR_LIMIT */ s8 PHY_GetTxPowerTrackingOffset( PADAPTER pAdapter, - u8 Rate, - u8 RFPath + enum rf_path RFPath, + u8 Rate ); struct txpwr_idx_comp { - u8 base; + u8 ntx_idx; + u8 pg; s8 by_rate; s8 limit; s8 tpt; s8 ebias; + s8 btc; + s8 dpd; }; +#define txpwr_idx_comp_set(_tic, _ntx_idx, _pg, _by_rate, _limit, _tpt, _ebias, _btc, _dpd) \ + do { \ + (_tic)->ntx_idx = _ntx_idx; \ + (_tic)->pg = _pg; \ + (_tic)->by_rate = _by_rate; \ + (_tic)->limit = _limit; \ + (_tic)->tpt = _tpt; \ + (_tic)->ebias = _ebias; \ + (_tic)->btc = _btc; \ + (_tic)->dpd = _dpd; \ + } while (0) + u8 phy_get_tx_power_index( - IN PADAPTER pAdapter, - IN u8 RFPath, - IN u8 Rate, - IN CHANNEL_WIDTH BandWidth, - IN u8 Channel + PADAPTER pAdapter, + enum rf_path RFPath, + u8 Rate, + enum channel_width BandWidth, + u8 Channel ); -VOID +void PHY_SetTxPowerIndex( - IN PADAPTER pAdapter, - IN u32 PowerIndex, - IN u8 RFPath, - IN u8 Rate + PADAPTER pAdapter, + u32 PowerIndex, + enum rf_path RFPath, + u8 Rate ); void dump_tx_power_idx_title(void *sel, _adapter *adapter); @@ -278,15 +239,18 @@ 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); +#if 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); +#ifdef CONFIG_EFUSE_CONFIG_FILE +int check_phy_efuse_tx_power_info_valid(_adapter *adapter); +#endif 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 +265,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); @@ -324,7 +287,7 @@ int rtw_get_phy_file_path(_adapter *adapter, const char *file_name); #define PHY_FILE_WIFI_ANT_ISOLATION "wifi_ant_isolation.txt" -#define MAX_PARA_FILE_BUF_LEN 25600 +#define MAX_PARA_FILE_BUF_LEN 32768 /* 32k */ #define LOAD_MAC_PARA_FILE BIT0 #define LOAD_BB_PARA_FILE BIT1 @@ -334,15 +297,17 @@ int rtw_get_phy_file_path(_adapter *adapter, const char *file_name); #define LOAD_RF_TXPWR_TRACK_PARA_FILE BIT5 #define LOAD_RF_TXPWR_LMT_PARA_FILE BIT6 -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_ConfigRFWithTxPwrTrackParaFile(IN PADAPTER Adapter, IN char *pFileName); -int PHY_ConfigRFWithPowerLimitTableParaFile(IN PADAPTER Adapter, IN const char *pFileName); +int phy_ConfigMACWithParaFile(PADAPTER Adapter, char *pFileName); +int phy_ConfigBBWithParaFile(PADAPTER Adapter, char *pFileName, u32 ConfigType); +int phy_ConfigBBWithPgParaFile(PADAPTER Adapter, const char *pFileName); +int phy_ConfigBBWithMpParaFile(PADAPTER Adapter, char *pFileName); +int PHY_ConfigRFWithParaFile(PADAPTER Adapter, char *pFileName, enum rf_path eRFPath); +int PHY_ConfigRFWithTxPwrTrackParaFile(PADAPTER Adapter, char *pFileName); +#if CONFIG_TXPWR_LIMIT +int PHY_ConfigRFWithPowerLimitTableParaFile(PADAPTER Adapter, 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 */ - +u8 phy_check_under_survey_ch(_adapter *adapter); #endif /* __HAL_COMMON_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_com_reg.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_com_reg.h index 14693315d0c9..9b28ed3c3577 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_com_reg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_com_reg.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -28,6 +24,7 @@ /* 8188E PKT_BUFF_ACCESS_CTRL value */ #define TXPKT_BUF_SELECT 0x69 #define RXPKT_BUF_SELECT 0xA5 +#define TXREPORT_BUF_SELECT 0x7F #define DISABLE_TRXPKT_BUF_ACCESS 0x0 #ifndef RTW_HALMAC @@ -126,7 +123,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 +211,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 @@ -260,10 +256,10 @@ #define REG_HWSEQ_CTRL 0x0423 #define REG_BCNQ_BDNY 0x0424 #define REG_MGQ_BDNY 0x0425 -#define REG_LIFETIME_CTRL 0x0426 +#define REG_LIFETIME_EN 0x0426 #define REG_MULTI_BCNQ_OFFSET 0x0427 #define REG_SPEC_SIFS 0x0428 -#define REG_RL 0x042A +#define REG_RETRY_LIMIT 0x042A #define REG_DARFRC 0x0430 #define REG_RARFRC 0x0438 #define REG_RRSR 0x0440 @@ -295,8 +291,9 @@ #define REG_POWER_STAGE1 0x04B4 #define REG_POWER_STAGE2 0x04B8 -#define REG_PKT_VO_VI_LIFE_TIME 0x04C0 -#define REG_PKT_BE_BK_LIFE_TIME 0x04C2 +#define REG_PKT_LIFE_TIME 0x04C0 +#define REG_PKT_LIFE_TIME_VO_VI 0x04C0 +#define REG_PKT_LIFE_TIME_BE_BK 0x04C2 #define REG_STBC_SETTING 0x04C4 #define REG_QUEUE_CTRL 0x04C6 #define REG_SINGLE_AMPDU_CTRL 0x04c7 @@ -319,6 +316,11 @@ #define REG_MACID_SLEEP 0x04D4 #define REG_NQOS_SEQ 0x04DC +#define REG_HW_SEQ0 0x04D8 +#define REG_HW_SEQ1 0x04DA +#define REG_HW_SEQ2 0x04DC +#define REG_HW_SEQ3 0x04DE + #define REG_QOS_SEQ 0x04DE #define REG_NEED_CPU_HANDLE 0x04E0 #define REG_PKT_LOSE_RPT 0x04E1 @@ -370,7 +372,7 @@ #define REG_BCN_CTRL_1 0x0551 #define REG_MBID_NUM 0x0552 #define REG_DUAL_TSF_RST 0x0553 -#define REG_BCN_INTERVAL 0x0554 /* The same as REG_MBSSID_BCN_SPACE */ +#define REG_MBSSID_BCN_SPACE 0x0554 #define REG_DRVERLYINT 0x0558 #define REG_BCNDMATIM 0x0559 #define REG_ATIMWND 0x055A @@ -385,6 +387,7 @@ #define REG_PSTIMER 0x0580 #define REG_TIMER0 0x0584 #define REG_TIMER1 0x0588 +#define REG_HIQ_NO_LMT_EN 0x05A7 #define REG_ACMHWCTRL 0x05C0 #define REG_NOA_DESC_SEL 0x05CF #define REG_NOA_DESC_DURATION 0x05E0 @@ -429,6 +432,8 @@ #define REG_CTS2TO 0x0641 #define REG_EIFS 0x0642 +/*REG_TCR*/ +#define BIT_PWRBIT_OW_EN BIT(7) /* RXERR_RPT */ #define RXERR_TYPE_OFDM_PPDU 0 @@ -490,9 +495,25 @@ #define REG_BCN_PSR_RPT 0x06A8 #define REG_BT_COEX_TABLE 0x06C0 +#define BIT_WKFCAM_WE BIT(16) +#define BIT_WKFCAM_POLLING_V1 BIT(31) +#define BIT_WKFCAM_CLR_V1 BIT(30) +#define BIT_SHIFT_WKFCAM_ADDR_V2 8 +#define BIT_MASK_WKFCAM_ADDR_V2 0xff +#define BIT_WKFCAM_ADDR_V2(x) (((x) & BIT_MASK_WKFCAM_ADDR_V2) << BIT_SHIFT_WKFCAM_ADDR_V2) + /* Hardware Port 1 */ #define REG_MACID1 0x0700 #define REG_BSSID1 0x0708 + +/* Enable/Disable Port 0 and Port 1 for Specific ICs (ex. 8192F)*/ +#define REG_WLAN_ACT_MASK_CTRL_1 0x076C + +/* GPIO Control */ +#define REG_SW_GPIO_SHARE_CTRL 0x1038 +#define REG_SW_GPIO_A_OUT 0x1040 +#define REG_SW_GPIO_A_OEN 0x1044 + /* Hardware Port 2 */ #define REG_MACID2 0x1620 #define REG_BSSID2 0x1628 @@ -573,16 +594,6 @@ #define IDR0 REG_MACID /* MAC ID Register, Offset 0x0050-0x0053 */ #define IDR4 (REG_MACID + 4) /* MAC ID Register, Offset 0x0054-0x0055 */ - -/* -* 9. Security Control Registers (Offset: ) -* */ -#define RWCAM REG_CAMCMD /* IN 8190 Data Sheet is called CAMcmd */ -#define WCAMI REG_CAMWRITE /* Software write CAM input content */ -#define RCAMO REG_CAMREAD /* Software read/write CAM config */ -#define CAMDBG REG_CAMDBG -#define SECR REG_SECCFG /* Security Configuration Register */ - /* Unused register */ #define UnusedRegister 0x1BF #define DCAM UnusedRegister @@ -671,6 +682,22 @@ Default: 00b. #define USB_INTR_CONTENT_HISRE_OFFSET 52 #define USB_INTR_CONTENT_LENGTH 56 +/* WOL bit information */ +#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 BIT(5) +#define BIT_EN_BCN_PKT_REL BIT(6) + +#endif /* RTW_HALMAC */ + /* ---------------------------------------------------------------------------- * Response Rate Set Register (offset 0x440, 24bits) * ---------------------------------------------------------------------------- */ @@ -698,20 +725,6 @@ Default: 00b. #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 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 BIT(5) - -#endif /* RTW_HALMAC */ /* ---------------------------------------------------------------------------- * Rate Definition @@ -1233,6 +1246,15 @@ Current IOREG MAP #define EFUSE_BT_SEL_1 0x2 #define EFUSE_BT_SEL_2 0x3 +/* 2 REG_GPIO_INTM (Offset 0x0048) */ +#define BIT_EXTWOL_EN BIT(16) + +/* 2 REG_LED_CFG (Offset 0x004C) */ +#define BIT_SW_SPDT_SEL BIT(22) + +/* 2 REG_SW_GPIO_SHARE_CTRL (Offset 0x1038) */ +#define BIT_BTGP_WAKE_LOC (BIT(10) | BIT(11)) +#define BIT_SW_GPIO_FUNC BIT(0) /* 2 8051FWDL * 2 MCUFWDL */ @@ -1378,7 +1400,8 @@ Current IOREG MAP #define QUEUE_LOW 1 #define QUEUE_NORMAL 2 #define QUEUE_HIGH 3 - +#define QUEUE_EXTRA_1 4 +#define QUEUE_EXTRA_2 5 /* 2 TRXFF_BNDY */ @@ -1433,6 +1456,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 @@ -1469,9 +1503,20 @@ Current IOREG MAP #define _SPEC_SIFS_OFDM(x) (((x) & 0xFF) << 8) /* 2 RL */ -#define RETRY_LIMIT_SHORT_SHIFT 8 -#define RETRY_LIMIT_LONG_SHIFT 0 +#define BIT_SHIFT_SRL 8 +#define BIT_MASK_SRL 0x3f +#define BIT_SRL(x) (((x) & BIT_MASK_SRL) << BIT_SHIFT_SRL) +#define BIT_SHIFT_LRL 0 +#define BIT_MASK_LRL 0x3f +#define BIT_LRL(x) (((x) & BIT_MASK_LRL) << BIT_SHIFT_LRL) + +#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 @@ -1484,11 +1529,6 @@ Current IOREG MAP #define AC_PARAM_ECW_MIN_OFFSET 8 #define AC_PARAM_AIFS_OFFSET 0 - -#define _LRL(x) ((x) & 0x3F) -#define _SRL(x) (((x) & 0x3F) << 8) - - /* 2 BCN_CTRL */ #define EN_TXBCN_RPT BIT(2) #define EN_BCN_FUNCTION BIT(3) @@ -1499,19 +1539,14 @@ Current IOREG MAP #define DIS_BCNQ_SUB BIT(1) #define DIS_TSF_UDT BIT(4) -/* The same function but different bit field. */ -#define DIS_TSF_UDT0_NORMAL_CHIP BIT(4) -#define DIS_TSF_UDT0_TEST_CHIP BIT(5) - - /* 2 ACMHWCTRL */ #define AcmHw_HwEn BIT(0) -#define AcmHw_BeqEn BIT(1) +#define AcmHw_VoqEn BIT(1) #define AcmHw_ViqEn BIT(2) -#define AcmHw_VoqEn BIT(3) -#define AcmHw_BeqStatus BIT(4) -#define AcmHw_ViqStatus BIT(5) -#define AcmHw_VoqStatus BIT(6) +#define AcmHw_BeqEn BIT(3) +#define AcmHw_VoqStatus BIT(5) +#define AcmHw_ViqStatus BIT(6) +#define AcmHw_BeqStatus BIT(7) /* 2 */ /* REG_DUAL_TSF_RST (0x553) */ #define DUAL_TSF_RST_P2P BIT(4) @@ -1592,6 +1627,13 @@ Current IOREG MAP #define BIT_LSIC_TXOP_EN BIT(17) #define BIT_CTS_EN BIT(16) +/*REG_RXFLTMAP1 (Offset 0x6A2)*/ +#define BIT_CTRLFLT10EN BIT(10) /*PS-POLL*/ + +/*REG_WLAN_ACT_MASK_CTRL_1 (Offset 0x76C)*/ +#define EN_PORT_0_FUNCTION BIT(12) +#define EN_PORT_1_FUNCTION BIT(13) + /* ----------------------------------------------------- * * SDIO Bus Specification @@ -1633,6 +1675,7 @@ Current IOREG MAP #define SDIO_MAX_RX_QUEUE 1 #define SDIO_REG_TX_CTRL 0x0000 /* SDIO Tx Control */ +#define SDIO_REG_TIMEOUT 0x0002/*SDIO status timeout*/ #define SDIO_REG_HIMR 0x0014 /* SDIO Host Interrupt Mask */ #define SDIO_REG_HISR 0x0018 /* SDIO Host Interrupt Service Routine */ #define SDIO_REG_HCPWM 0x0019 /* HCI Current Power Mode */ @@ -1727,6 +1770,19 @@ Current IOREG MAP #define SDIO_TX_FREE_PG_QUEUE 4 /* The number of Tx FIFO free page */ #define SDIO_TX_FIFO_PAGE_SZ 128 +/* indirect access */ +#ifdef CONFIG_SDIO_INDIRECT_ACCESS +#define SDIO_REG_INDIRECT_REG_CFG 0x40 +#define SDIO_REG_INDIRECT_REG_DATA 0x44 +#define SET_INDIRECT_REG_ADDR(_cmd, _addr) SET_BITS_TO_LE_2BYTE(((u8 *)(_cmd)) + 0, 0, 16, (_addr)) +#define SET_INDIRECT_REG_SIZE_1BYTE(_cmd) SET_BITS_TO_LE_1BYTE(((u8 *)(_cmd)) + 2, 0, 2, 0) +#define SET_INDIRECT_REG_SIZE_2BYTE(_cmd) SET_BITS_TO_LE_1BYTE(((u8 *)(_cmd)) + 2, 0, 2, 1) +#define SET_INDIRECT_REG_SIZE_4BYTE(_cmd) SET_BITS_TO_LE_1BYTE(((u8 *)(_cmd)) + 2, 0, 2, 2) +#define SET_INDIRECT_REG_WRITE(_cmd) SET_BITS_TO_LE_1BYTE(((u8 *)(_cmd)) + 2, 2, 1, 1) +#define SET_INDIRECT_REG_READ(_cmd) SET_BITS_TO_LE_1BYTE(((u8 *)(_cmd)) + 2, 3, 1, 1) +#define GET_INDIRECT_REG_RDY(_cmd) LE_BITS_TO_1BYTE(((u8 *)(_cmd)) + 2, 4, 1) +#endif/*CONFIG_SDIO_INDIRECT_ACCESS*/ + #ifdef CONFIG_SDIO_HCI #define MAX_TX_AGG_PACKET_NUMBER 0x8 #else @@ -1804,8 +1860,10 @@ Current IOREG MAP #define LAST_ENTRY_OF_TX_PKT_BUFFER_8703B 255 #define LAST_ENTRY_OF_TX_PKT_BUFFER_DUAL_MAC 127 #define LAST_ENTRY_OF_TX_PKT_BUFFER_8188F 255 +#define LAST_ENTRY_OF_TX_PKT_BUFFER_8188GTV 255 #define LAST_ENTRY_OF_TX_PKT_BUFFER_8723D 255 - +#define LAST_ENTRY_OF_TX_PKT_BUFFER_8710B 255 +#define LAST_ENTRY_OF_TX_PKT_BUFFER_8192F 255 #define POLLING_LLT_THRESHOLD 20 #if defined(CONFIG_RTL8723B) && defined(CONFIG_PCI_HCI) #define POLLING_READY_TIMEOUT_COUNT 6000 diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_data.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_data.h index faff26360f02..a9a0c5ddb3e7 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_data.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_data.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -26,6 +22,7 @@ #ifdef CONFIG_BT_COEXIST #include #endif + #include #ifdef CONFIG_SDIO_HCI #include @@ -33,6 +30,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. * */ @@ -96,21 +98,6 @@ typedef enum _RT_AMPDU_BRUST_MODE { #define MAX_BASE_NUM_IN_PHY_REG_PG_2_4G 10 /* CCK:1, OFDM:1, HT:4, VHT:4 */ #define MAX_BASE_NUM_IN_PHY_REG_PG_5G 9 /* OFDM:1, HT:4, VHT:4 */ - -/* ###### duplicate code,will move to ODM ######### */ -/* #define IQK_MAC_REG_NUM 4 */ -/* #define IQK_ADDA_REG_NUM 16 */ - -/* #define IQK_BB_REG_NUM 10 */ -#define IQK_BB_REG_NUM_92C 9 -#define IQK_BB_REG_NUM_92D 10 -#define IQK_BB_REG_NUM_test 6 - -#define IQK_Matrix_Settings_NUM_92D (1+24+21) - -/* #define HP_THERMAL_NUM 8 */ -/* ###### duplicate code,will move to ODM ######### */ - #ifdef RTW_RX_AGGREGATION typedef enum _RX_AGG_MODE { RX_AGG_DISABLE, @@ -148,10 +135,19 @@ typedef enum _RX_AGG_MODE { #ifdef CONFIG_RTL8188F #define EFUSE_MAP_SIZE 512 #endif +#ifdef CONFIG_RTL8188GTV + #define EFUSE_MAP_SIZE 512 +#endif +#ifdef CONFIG_RTL8710B + #define EFUSE_MAP_SIZE 512 +#endif +#ifdef CONFIG_RTL8192F + #define EFUSE_MAP_SIZE 512 +#endif #if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) #define EFUSE_MAX_SIZE 1024 -#elif defined(CONFIG_RTL8188E) || defined(CONFIG_RTL8188F) || defined(CONFIG_RTL8703B) +#elif defined(CONFIG_RTL8188E) || defined(CONFIG_RTL8188F) || defined(CONFIG_RTL8188GTV) || defined(CONFIG_RTL8703B) || defined(CONFIG_RTL8710B) #define EFUSE_MAX_SIZE 256 #else #define EFUSE_MAX_SIZE 512 @@ -199,24 +195,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,9 +203,6 @@ struct auto_chan_sel { #define MACADDR_FILE_FAILED 1 #define MACADDR_FILE_LOADED 2 -#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 @@ -250,9 +225,14 @@ struct hal_spec_t { u8 sec_cam_ent_num; u8 sec_cap; + u8 macid_cap; + u16 macid_txrpt; + u8 macid_txrpt_pgsz; u8 rfpath_num_2g:4; /* used for tx power index path */ u8 rfpath_num_5g:4; /* used for tx power index path */ + u8 txgi_max; /* maximum tx power gain index */ + u8 txgi_pdbm; /* tx power gain index per dBm */ u8 max_tx_cnt; u8 tx_nss_num:4; @@ -262,6 +242,16 @@ struct hal_spec_t { u8 port_num; u8 proto_cap; /* value of PROTO_CAP_XXX */ u8 wl_func; /* value of WL_FUNC_XXX */ + +#if CONFIG_TX_AC_LIFETIME + u8 tx_aclt_unit_factor; /* how many 32us */ +#endif + + u8 rx_tsf_filter:1; + + u8 pg_txpwr_saddr; /* starting address of PG tx power info */ + u8 pg_txgi_diff_factor; /* PG tx power gain index diff to tx power gain index */ + u8 hci_type; /* value of HCI Type */ }; @@ -288,6 +278,72 @@ struct hal_iqk_reg_backup { 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 disable_close_rf: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 */ + +#if 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 version_id; RT_MULTI_FUNC MultiFunc; /* For multi-function consideration. */ @@ -295,18 +351,20 @@ typedef struct hal_com_data { RT_REGULATOR_MODE RegulatorMode; /* switching regulator or LDO */ u8 hw_init_completed; /****** FW related ******/ + u32 firmware_size; u16 firmware_version; u16 FirmwareVersionRev; 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 current_channel_bw; + enum channel_width current_channel_bw; BAND_TYPE current_band_type; /* 0:2.4G, 1:5G */ BAND_TYPE BandSet; u8 current_channel; @@ -320,6 +378,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; @@ -327,23 +386,28 @@ 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; /* 1: disable turboedca, + 2: disable turboedca and setting EDCA parameter based on the input parameter*/ + u32 edca_param_mode; /****** EEPROM setting.******/ u8 bautoload_fail_flag; @@ -379,6 +443,8 @@ typedef struct hal_com_data { 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; @@ -387,7 +453,9 @@ typedef struct hal_com_data { #endif /*CONFIG_RF_POWER_TRIM*/ #if defined(CONFIG_RTL8723B) || defined(CONFIG_RTL8703B) || \ - defined(CONFIG_RTL8723D) + defined(CONFIG_RTL8723D) || \ + defined(CONFIG_RTL8192F) + u8 adjuseVoltageVal; u8 need_restore; #endif @@ -415,76 +483,23 @@ 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]; +#if defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8822C) + u32 txagc_set_buf; +#endif + u8 txpwr_by_rate_loaded:1; u8 txpwr_by_rate_from_file:1; u8 txpwr_limit_loaded:1; @@ -510,7 +525,8 @@ typedef struct hal_com_data { u8 bLedOpenDrain; /* Support Open-drain arrangement for controlling the LED. Added by Roger, 2009.10.16. */ 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]; @@ -518,14 +534,9 @@ 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; + #if defined (CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) + u32 RegRRSR; + #endif /****** antenna diversity ******/ u8 AntDivCfg; @@ -539,17 +550,16 @@ typedef struct hal_com_data { 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 entry_min_undecorated_smoothed_pwdb; - int entry_max_undecorated_smoothed_pwdb; - int min_undecorated_pwdb_for_dm; - struct PHY_DM_STRUCT odmpriv; + + struct dm_struct odmpriv; + u64 bk_rf_ability; u8 bIQKInitialized; u8 bNeedIQK; - u8 IQK_MP_Switch; + u8 neediqk_24g; + u8 IQK_MP_Switch; + u8 bScanInProcess; /******** PHY DM & DM Section **********/ @@ -561,7 +571,11 @@ typedef struct hal_com_data { u32 interfaceIndex; #ifdef CONFIG_P2P +#ifdef CONFIG_P2P_PS_NOA_USE_MACID_SLEEP + u16 p2p_ps_offload; +#else u8 p2p_ps_offload; +#endif #endif /* Auto FSM to Turn On, include clock, isolation, power control for MAC only */ u8 bMacPwrCtrlOn; @@ -569,6 +583,8 @@ typedef struct hal_com_data { u8 RegIQKFWOffload; struct submit_ctx iqk_sctx; + u8 ch_switch_offload; + struct submit_ctx chsw_sctx; RT_AMPDU_BRUST AMPDUBurstMode; /* 92C maybe not use, but for compile successfully */ @@ -601,7 +617,11 @@ typedef struct hal_com_data { /* SDIO Tx FIFO related. */ /* */ /* HIQ, MID, LOW, PUB free pages; padapter->xmitpriv.free_txpg */ +#ifdef CONFIG_RTL8192F + u16 SdioTxFIFOFreePage[SDIO_TX_FREE_PG_QUEUE]; +#else u8 SdioTxFIFOFreePage[SDIO_TX_FREE_PG_QUEUE]; +#endif/*CONFIG_RTL8192F*/ _lock SdioTxFIFOFreePageLock; u8 SdioTxOQTMaxFreeSpace; u8 SdioTxOQTFreeSpace; @@ -613,7 +633,11 @@ typedef struct hal_com_data { /* SDIO Rx FIFO related. */ /* */ u8 SdioRxFIFOCnt; +#ifdef CONFIG_RTL8822C + u32 SdioRxFIFOSize; +#else u16 SdioRxFIFOSize; +#endif #ifndef RTW_HALMAC u32 sdio_tx_max_len[SDIO_MAX_TX_QUEUE];/* H, N, L, used for sdio tx aggregation max length per queue */ @@ -624,10 +648,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 */ @@ -673,6 +705,7 @@ typedef struct hal_com_data { BOOLEAN bL1OffSupport; BOOLEAN bSupportBackDoor; + u32 pci_backdoor_ctrl; u8 bDefaultAntenna; @@ -680,6 +713,9 @@ typedef struct hal_com_data { u8 bDisableTxInt; u16 RxTag; +#ifdef CONFIG_PCI_DYNAMIC_ASPM + BOOLEAN bAspmL1LastIdle; +#endif #endif /* CONFIG_PCI_HCI */ @@ -693,7 +729,7 @@ typedef struct hal_com_data { #endif /* CONFIG_BT_COEXIST */ #if defined(CONFIG_RTL8723B) || defined(CONFIG_RTL8703B) \ - || defined(CONFIG_RTL8188F) || defined(CONFIG_RTL8723D) + || defined(CONFIG_RTL8188F) || defined(CONFIG_RTL8188GTV) || defined(CONFIG_RTL8723D)|| defined(CONFIG_RTL8192F) #ifndef CONFIG_PCI_HCI /* mutual exclusive with PCI -- so they're SDIO and GSPI */ /* Interrupt relatd register information. */ u32 SysIntrStatus; @@ -724,7 +760,7 @@ 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; @@ -745,7 +781,7 @@ 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; + u16 drv_rsvd_page_number; #endif #ifdef CONFIG_BEAMFORMING @@ -756,14 +792,22 @@ typedef struct hal_com_data { #endif /* CONFIG_BEAMFORMING */ u8 not_xmitframe_fw_dl; /*not use xmitframe to download fw*/ + u8 phydm_op_mode; + + u8 in_cta_test; + +#ifdef CONFIG_RTW_LED + struct led_priv led; +#endif + /* for multi channel case (ex: MCC/TDLS) */ + u8 multi_ch_switch_mode; + } HAL_DATA_COMMON, *PHAL_DATA_COMMON; - - typedef struct hal_com_data HAL_DATA_TYPE, *PHAL_DATA_TYPE; -#define GET_HAL_DATA(__pAdapter) ((HAL_DATA_TYPE *)((__pAdapter)->HalData)) +#define GET_HAL_DATA(__pAdapter) ((HAL_DATA_TYPE *)(((struct _ADAPTER*)__pAdapter)->HalData)) #define GET_HAL_SPEC(__pAdapter) (&(GET_HAL_DATA((__pAdapter))->hal_spec)) -#define GET_ODM(__pAdapter) (&(GET_HAL_DATA((__pAdapter))->odmpriv)) +#define adapter_to_led(adapter) (&(GET_HAL_DATA(adapter)->led)) #define GET_HAL_RFPATH_NUM(__pAdapter) (((HAL_DATA_TYPE *)((__pAdapter)->HalData))->NumTotalRFPath) #define RT_GetInterfaceSelection(_Adapter) (GET_HAL_DATA(_Adapter)->InterfaceSel) @@ -777,274 +821,12 @@ typedef struct hal_com_data HAL_DATA_TYPE, *PHAL_DATA_TYPE; #define get_hal_mac_addr(adapter) (GET_HAL_DATA(adapter)->EEPROMMACAddr) #define is_boot_from_eeprom(adapter) (GET_HAL_DATA(adapter)->EepromOrEfuse) #define rtw_get_hw_init_completed(adapter) (GET_HAL_DATA(adapter)->hw_init_completed) +#define rtw_set_hw_init_completed(adapter, cmp) (GET_HAL_DATA(adapter)->hw_init_completed = cmp) #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/rtl8188eu/include/hal_gspi.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_gspi.h index 68119c51255e..f9a6d2ca916c 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_gspi.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_gspi.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/hal_ic_cfg.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_ic_cfg.h index 1e1cfcd08c86..0f908b421332 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_ic_cfg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_ic_cfg.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -26,6 +22,7 @@ #define RTL8723B_SUPPORT 0 #define RTL8723D_SUPPORT 0 #define RTL8192E_SUPPORT 0 +#define RTL8192F_SUPPORT 0 #define RTL8814A_SUPPORT 0 #define RTL8195A_SUPPORT 0 #define RTL8197F_SUPPORT 0 @@ -34,6 +31,16 @@ #define RTL8822B_SUPPORT 0 #define RTL8821B_SUPPORT 0 #define RTL8821C_SUPPORT 0 +#define RTL8710B_SUPPORT 0 +#define RTL8814B_SUPPORT 0 +#define RTL8824B_SUPPORT 0 +#define RTL8198F_SUPPORT 0 +#define RTL8195B_SUPPORT 0 +#define RTL8822C_SUPPORT 0 +#define RTL8721D_SUPPORT 0 +#define RTL8812F_SUPPORT 0 +#define RTL8197G_SUPPORT 0 +#define RTL8721D_SUPPORT 0 /*#if (RTL8188E_SUPPORT==1)*/ #define RATE_ADAPTIVE_SUPPORT 0 @@ -42,6 +49,9 @@ #ifdef CONFIG_MULTIDRV #endif +/*feature for all IC*/ +#define RTW_DYNAMIC_RRSR + #ifdef CONFIG_RTL8188E #undef RTL8188E_SUPPORT #undef RATE_ADAPTIVE_SUPPORT @@ -50,7 +60,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 @@ -59,6 +68,12 @@ #ifndef CONFIG_FW_C2H_PKT #define CONFIG_FW_C2H_PKT #endif + #ifdef CONFIG_BEAMFORMING + #define CONFIG_BEAMFORMER_FW_NDPA + #define BEAMFORMING_SUPPORT 1 /*for phydm beamforming*/ + #define SUPPORT_MU_BF 0 + #endif /*CONFIG_BEAMFORMING*/ + #define CONFIG_RTS_FULL_BW #endif #ifdef CONFIG_RTL8821A @@ -67,6 +82,12 @@ #ifndef CONFIG_FW_C2H_PKT #define CONFIG_FW_C2H_PKT #endif + #ifdef CONFIG_BEAMFORMING + #define CONFIG_BEAMFORMER_FW_NDPA + #define BEAMFORMING_SUPPORT 1 /*for phydm beamforming*/ + #define SUPPORT_MU_BF 0 + #endif + #define CONFIG_RTS_FULL_BW #endif #ifdef CONFIG_RTL8192E @@ -75,6 +96,24 @@ #ifndef CONFIG_FW_C2H_PKT #define CONFIG_FW_C2H_PKT #endif + #define CONFIG_RTS_FULL_BW +#endif + +#ifdef CONFIG_RTL8192F + #undef RTL8192F_SUPPORT + #define RTL8192F_SUPPORT 1 + #ifndef CONFIG_FW_C2H_PKT + #define CONFIG_FW_C2H_PKT + #endif + #ifndef CONFIG_RTW_MAC_HIDDEN_RPT + #define CONFIG_RTW_MAC_HIDDEN_RPT + #endif + /*#define CONFIG_AMPDU_PRETX_CD*/ + /*#define DBG_LA_MODE*/ + #ifdef CONFIG_P2P_PS + #define CONFIG_P2P_PS_NOA_USE_MACID_SLEEP + #endif + #define CONFIG_RTS_FULL_BW #endif #ifdef CONFIG_RTL8723B @@ -83,6 +122,7 @@ #ifndef CONFIG_FW_C2H_PKT #define CONFIG_FW_C2H_PKT #endif + #define CONFIG_RTS_FULL_BW #endif #ifdef CONFIG_RTL8723D @@ -97,6 +137,7 @@ #ifndef CONFIG_RTW_CUSTOMER_STR #define CONFIG_RTW_CUSTOMER_STR #endif + #define CONFIG_RTS_FULL_BW #endif #ifdef CONFIG_RTL8814A @@ -105,6 +146,12 @@ #ifndef CONFIG_FW_C2H_PKT #define CONFIG_FW_C2H_PKT #endif + #define CONFIG_FW_CORRECT_BCN + #ifdef CONFIG_BEAMFORMING + #define BEAMFORMING_SUPPORT 1 /*for phydm beamforming*/ + #define SUPPORT_MU_BF 0 + #endif + #define CONFIG_RTS_FULL_BW #endif #ifdef CONFIG_RTL8703B @@ -116,6 +163,7 @@ #ifndef CONFIG_RTW_MAC_HIDDEN_RPT #define CONFIG_RTW_MAC_HIDDEN_RPT #endif + #define CONFIG_RTS_FULL_BW #endif #ifdef CONFIG_RTL8188F @@ -130,6 +178,22 @@ #ifndef CONFIG_RTW_CUSTOMER_STR #define CONFIG_RTW_CUSTOMER_STR #endif + #define CONFIG_RTS_FULL_BW +#endif + +#ifdef CONFIG_RTL8188GTV + #undef RTL8188F_SUPPORT + #define RTL8188F_SUPPORT 1 + #ifndef CONFIG_FW_C2H_PKT + #define CONFIG_FW_C2H_PKT + #endif + #ifndef CONFIG_RTW_MAC_HIDDEN_RPT + #define CONFIG_RTW_MAC_HIDDEN_RPT + #endif + #ifndef CONFIG_RTW_CUSTOMER_STR + #define CONFIG_RTW_CUSTOMER_STR + #endif + #define CONFIG_RTS_FULL_BW #endif #ifdef CONFIG_RTL8822B @@ -138,35 +202,29 @@ #ifndef CONFIG_FW_C2H_PKT #define CONFIG_FW_C2H_PKT #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 */ + #define RTW_AMPDU_AGG_RETRY_AND_NEW #ifdef CONFIG_WOWLAN #define CONFIG_GTK_OL - #define CONFIG_ARP_KEEP_ALIVE - #ifndef CONFIG_DEFAULT_PATTERNS_EN - #warning "Force to enable CONFIG_DEFAULT_PATTERNS_EN under WOW" - #define CONFIG_DEFAULT_PATTERNS_EN - #endif /* !CONFIG_DEFAULT_PATTERNS_EN */ + /*#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 @@ -174,10 +232,133 @@ #ifndef CONFIG_RTW_MAC_HIDDEN_RPT #define CONFIG_RTW_MAC_HIDDEN_RPT -#endif /* 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 */ + + /* Checksum offload feature */ + /*#define CONFIG_TCP_CSUM_OFFLOAD_TX*/ /* not ready */ + #define CONFIG_TCP_CSUM_OFFLOAD_RX + + #define CONFIG_ADVANCE_OTA + + #ifdef CONFIG_MCC_MODE + #define CONFIG_MCC_MODE_V2 + #define CONFIG_MCC_PHYDM_OFFLOAD + #endif /* CONFIG_MCC_MODE */ + + #if defined(CONFIG_TDLS) && defined(CONFIG_TDLS_CH_SW) + #define CONFIG_TDLS_CH_SW_V2 + #endif + + #ifndef RTW_CHANNEL_SWITCH_OFFLOAD + #ifdef CONFIG_TDLS_CH_SW_V2 + #define RTW_CHANNEL_SWITCH_OFFLOAD + #endif + #endif /* RTW_CHANNEL_SWITCH_OFFLOAD */ + + #if defined(CONFIG_RTW_MESH) && !defined(RTW_PER_CMD_SUPPORT_FW) + /* Supported since fw v22.1 */ + #define RTW_PER_CMD_SUPPORT_FW + #endif /* RTW_PER_CMD_SUPPORT_FW */ + #define CONFIG_SUPPORT_FIFO_DUMP + #define CONFIG_HW_P0_TSF_SYNC + #define CONFIG_BCN_RECV_TIME + #ifdef CONFIG_P2P_PS + #define CONFIG_P2P_PS_NOA_USE_MACID_SLEEP + #endif + #define CONFIG_RTS_FULL_BW #endif /* CONFIG_RTL8822B */ +#ifdef CONFIG_RTL8822C + #undef RTL8822C_SUPPORT + #define RTL8822C_SUPPORT 1 + #define DBG_LA_MODE + #ifndef CONFIG_FW_C2H_PKT + #define CONFIG_FW_C2H_PKT + #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 + */ + /* 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 */ + + /* Checksum offload feature */ + /* #define CONFIG_TX_CSUM_OFFLOAD */ + #if defined(CONFIG_TX_CSUM_OFFLOAD) && !defined(CONFIG_RTW_NETIF_SG) + #define CONFIG_RTW_NETIF_SG + #endif + #define CONFIG_TCP_CSUM_OFFLOAD_RX + + #define CONFIG_ADVANCE_OTA + + #ifdef CONFIG_MCC_MODE + #define CONFIG_MCC_MODE_V2 + #endif /* CONFIG_MCC_MODE */ + + #if defined(CONFIG_TDLS) && defined(CONFIG_TDLS_CH_SW) + #define CONFIG_TDLS_CH_SW_V2 + #endif + + #ifndef RTW_CHANNEL_SWITCH_OFFLOAD + #ifdef CONFIG_TDLS_CH_SW_V2 + #define RTW_CHANNEL_SWITCH_OFFLOAD + #endif + #endif /* RTW_CHANNEL_SWITCH_OFFLOAD */ + + #if defined(CONFIG_RTW_MESH) && !defined(RTW_PER_CMD_SUPPORT_FW) + /* Supported since fw v22.1 */ + #define RTW_PER_CMD_SUPPORT_FW + #endif /* RTW_PER_CMD_SUPPORT_FW */ + #define CONFIG_SUPPORT_FIFO_DUMP + #define CONFIG_HW_P0_TSF_SYNC + #define CONFIG_BCN_RECV_TIME + + #ifdef CONFIG_P2P_PS + #define CONFIG_P2P_PS_NOA_USE_MACID_SLEEP + #endif + #define CONFIG_RTS_FULL_BW +#endif /* CONFIG_RTL8822C */ + #ifdef CONFIG_RTL8821C #undef RTL8821C_SUPPORT #define RTL8821C_SUPPORT 1 @@ -197,9 +378,35 @@ #define CONFIG_PHY_CAPABILITY_QUERY #ifdef CONFIG_CONCURRENT_MODE #define CONFIG_AP_PORT_SWAP - /*#define CONFIG_FW_MULTI_PORT_SUPPORT*/ + #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 */ + /*#define CONFIG_AMPDU_PRETX_CD*/ + /*#define DBG_PRE_TX_HANG*/ + + /* Beamforming related definition */ + /* Only support new beamforming mechanism */ + #ifdef CONFIG_BEAMFORMING + #define RTW_BEAMFORMING_VERSION_2 + #endif /* CONFIG_BEAMFORMING */ + #define CONFIG_HW_P0_TSF_SYNC + #define CONFIG_BCN_RECV_TIME + #ifdef CONFIG_P2P_PS + #define CONFIG_P2P_PS_NOA_USE_MACID_SLEEP + #endif + #define CONFIG_RTS_FULL_BW +#endif /*CONFIG_RTL8821C*/ + +#ifdef CONFIG_RTL8710B + #undef RTL8710B_SUPPORT + #define RTL8710B_SUPPORT 1 + #ifndef CONFIG_FW_C2H_PKT + #define CONFIG_FW_C2H_PKT + #endif + #define CONFIG_RTS_FULL_BW #endif #endif /*__HAL_IC_CFG_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_intf.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_intf.h index b1b81435832d..aa0c7f163629 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_intf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_intf.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -39,12 +35,24 @@ enum _CHIP_TYPE { RTL8814A, RTL8703B, RTL8188F, + RTL8188GTV, RTL8822B, RTL8723D, RTL8821C, + RTL8710B, + RTL8192F, + RTL8822C, 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)]) @@ -64,8 +72,9 @@ typedef enum _HW_VARIABLES { HW_VAR_BASIC_RATE, HW_VAR_TXPAUSE, HW_VAR_BCN_FUNC, + HW_VAR_BCN_CTRL_ADDR, 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 +88,8 @@ typedef enum _HW_VARIABLES { HW_VAR_SEC_DK_CFG, HW_VAR_BCN_VALID, HW_VAR_RF_TYPE, + HW_VAR_FREECNT, + /* PHYDM odm->SupportAbility */ HW_VAR_CAM_EMPTY_ENTRY, HW_VAR_CAM_INVALID_ALL, @@ -87,15 +98,18 @@ typedef enum _HW_VARIABLES { HW_VAR_AC_PARAM_BE, HW_VAR_AC_PARAM_BK, HW_VAR_ACM_CTRL, -#ifdef CONFIG_WMMPS +#ifdef CONFIG_WMMPS_STA HW_VAR_UAPSD_TID, -#endif +#endif /* CONFIG_WMMPS_STA */ HW_VAR_AMPDU_MIN_SPACE, +#ifdef CONFIG_80211N_HT HW_VAR_AMPDU_FACTOR, +#endif /* CONFIG_80211N_HT */ HW_VAR_RXDMA_AGG_PG_TH, HW_VAR_SET_RPWM, HW_VAR_CPWM, HW_VAR_H2C_FW_PWRMODE, + HW_VAR_H2C_INACTIVE_IPS, HW_VAR_H2C_PS_TUNE_PARAM, HW_VAR_H2C_FW_JOINBSSRPT, HW_VAR_FWLPS_RF_ON, @@ -131,6 +145,8 @@ typedef enum _HW_VARIABLES { #endif HW_VAR_RPWM_TOG, #ifdef CONFIG_GPIO_WAKEUP + HW_VAR_WOW_OUTPUT_GPIO, + HW_VAR_WOW_INPUT_GPIO, HW_SET_GPIO_WL_CTRL, #endif HW_VAR_SYS_CLKR, @@ -138,13 +154,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, @@ -164,8 +182,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 @@ -177,12 +193,30 @@ 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, +#ifdef CONFIG_FW_HANDLE_TXBCN + HW_VAR_BCN_HEAD_SEL, +#endif + HW_VAR_SET_SOML_PARAM, + HW_VAR_ENABLE_RX_BAR, + HW_VAR_TSF_AUTO_SYNC, + HW_VAR_LPS_STATE_CHK, + #ifdef CONFIG_RTS_FULL_BW + HW_VAR_SET_RTS_BW, + #endif +#if defined(CONFIG_PCI_HCI) + HW_VAR_ENSWBCN, #endif } HW_VARIABLES; @@ -220,8 +254,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, HW_VAR_BEST_AMPDU_DENSITY, @@ -231,17 +263,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 @@ -256,17 +281,6 @@ typedef s32(*c2h_id_filter)(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *paylo struct txpwr_idx_comp; -struct macid_cfg { - u8 mac_id; - u8 rate_id; - u8 bandwidth; - u8 short_gi; - u8 ignore_bw; - u8 rsvd; - u16 rsvd1; - u64 ra_mask; -}; - struct hal_ops { /*** initialize section ***/ void (*read_chip_version)(_adapter *padapter); @@ -311,6 +325,7 @@ struct hal_ops { u8(*check_ips_status)(_adapter *padapter); #if defined(CONFIG_PCI_HCI) s32(*interrupt_handler)(_adapter *padapter); + void (*unmap_beacon_icf)(_adapter *padapter); #endif #if defined(CONFIG_USB_HCI) && defined(CONFIG_SUPPORT_USB_INT) @@ -322,47 +337,46 @@ struct hal_ops { #endif /*** DM section ***/ - +#ifdef CONFIG_RTW_SW_LED void (*InitSwLeds)(_adapter *padapter); void (*DeInitSwLeds)(_adapter *padapter); +#endif + void (*set_chnl_bw_handler)(_adapter *padapter, u8 channel, enum channel_width Bandwidth, u8 Offset40, u8 Offset80); - void (*set_chnl_bw_handler)(_adapter *padapter, u8 channel, 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_level_handler)(_adapter *adapter, u8 channel); + void (*set_txpwr_done)(_adapter *adapter); + void (*set_tx_power_index_handler)(_adapter *adapter, u32 powerindex, enum rf_path rfpath, u8 rate); + u8 (*get_tx_power_index_handler)(_adapter *adapter, 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 (*set_hw_reg_handler)(_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 (*get_hal_def_var_handler)(_adapter *padapter, HAL_DEF_VARIABLE eVariable, PVOID pValue); + u8 (*get_hal_def_var_handler)(_adapter *padapter, HAL_DEF_VARIABLE eVariable, void *pValue); - u8(*SetHalDefVarHandler)(_adapter *padapter, HAL_DEF_VARIABLE eVariable, PVOID pValue); + u8(*SetHalDefVarHandler)(_adapter *padapter, HAL_DEF_VARIABLE eVariable, void *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 (*GetHalODMVarHandler)(_adapter *padapter, HAL_ODM_VARIABLE eVariable, void *pValue1, void *pValue2); + void (*SetHalODMVarHandler)(_adapter *padapter, HAL_ODM_VARIABLE eVariable, void *pValue1, BOOLEAN bSet); - void (*update_ra_mask_handler)(_adapter *padapter, struct sta_info *psta, struct macid_cfg *h2c_macid_cfg); 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_SYSON_INDIRECT_ACCESS + u32 (*read_syson_reg)(_adapter *padapter, u32 RegAddr, u32 BitMask); + void (*write_syson_reg)(_adapter *padapter, u32 RegAddr, u32 BitMask, u32 Data); +#endif + void (*read_wmmedca_reg)(_adapter *padapter, u16 *vo_params, u16 *vi_params, u16 *be_params, u16 *bk_params); + #ifdef CONFIG_HOSTAPD_MLME s32(*hostap_mgnt_xmit_entry)(_adapter *padapter, _pkt *pkt); #endif @@ -376,6 +390,9 @@ struct hal_ops { int (*Efuse_PgPacketWrite)(_adapter *padapter, u8 offset, u8 word_en, u8 *data, BOOLEAN bPseudoTest); u8(*Efuse_WordEnableDataWrite)(_adapter *padapter, u16 efuse_addr, u8 word_en, u8 *data, BOOLEAN bPseudoTest); BOOLEAN(*Efuse_PgPacketWrite_BT)(_adapter *padapter, u8 offset, u8 word_en, u8 *data, BOOLEAN bPseudoTest); +#if defined(CONFIG_RTL8710B) + BOOLEAN(*efuse_indirect_read4)(_adapter *padapter, u16 regaddr, u8 *value); +#endif #ifdef DBG_CONFIG_ERROR_DETECT void (*sreset_init_value)(_adapter *padapter); @@ -402,6 +419,9 @@ struct hal_ops { 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); @@ -412,16 +432,25 @@ struct hal_ops { int (*hal_gpio_func_check)(_adapter *padapter, u8 gpio_num); void (*hal_gpio_multi_func_reset)(_adapter *padapter, u8 gpio_num); #endif +#ifdef CONFIG_FW_CORRECT_BCN void (*fw_correct_bcn)(PADAPTER padapter); +#endif #ifdef RTW_HALMAC 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 - +#ifdef CONFIG_PCI_TX_POLLING + void (*tx_poll_handler)(_adapter *adapter); +#endif }; typedef enum _RT_EEPROM_TYPE { @@ -470,12 +499,24 @@ typedef enum _HARDWARE_TYPE { HARDWARE_TYPE_RTL8188FE, HARDWARE_TYPE_RTL8188FU, HARDWARE_TYPE_RTL8188FS, + HARDWARE_TYPE_RTL8188GTVU, + HARDWARE_TYPE_RTL8188GTVS, HARDWARE_TYPE_RTL8723DE, HARDWARE_TYPE_RTL8723DU, HARDWARE_TYPE_RTL8723DS, HARDWARE_TYPE_RTL8821CE, HARDWARE_TYPE_RTL8821CU, HARDWARE_TYPE_RTL8821CS, + HARDWARE_TYPE_RTL8710BU, + HARDWARE_TYPE_RTL8192FS, + HARDWARE_TYPE_RTL8192FU, + HARDWARE_TYPE_RTL8192FE, + HARDWARE_TYPE_RTL8822CE, + HARDWARE_TYPE_RTL8822CU, + HARDWARE_TYPE_RTL8822CS, + HARDWARE_TYPE_RTL8814BE, + HARDWARE_TYPE_RTL8814BU, + HARDWARE_TYPE_RTL8814BS, HARDWARE_TYPE_MAX, } HARDWARE_TYPE; @@ -549,6 +590,18 @@ typedef enum _HARDWARE_TYPE { IS_HARDWARE_TYPE_8723DU(_Adapter) || \ IS_HARDWARE_TYPE_8723DS(_Adapter)) +/* RTL8192F Series */ +#define IS_HARDWARE_TYPE_8192FS(_Adapter)\ + (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8192FS) +#define IS_HARDWARE_TYPE_8192FU(_Adapter)\ + (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8192FU) +#define IS_HARDWARE_TYPE_8192FE(_Adapter)\ + (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8192FE) +#define IS_HARDWARE_TYPE_8192F(_Adapter)\ + (IS_HARDWARE_TYPE_8192FS(_Adapter) ||\ + IS_HARDWARE_TYPE_8192FU(_Adapter) ||\ + IS_HARDWARE_TYPE_8192FE(_Adapter)) + /* RTL8188F Series */ #define IS_HARDWARE_TYPE_8188FE(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8188FE) #define IS_HARDWARE_TYPE_8188FS(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8188FS) @@ -556,6 +609,15 @@ typedef enum _HARDWARE_TYPE { #define IS_HARDWARE_TYPE_8188F(_Adapter) \ (IS_HARDWARE_TYPE_8188FE(_Adapter) || IS_HARDWARE_TYPE_8188FU(_Adapter) || IS_HARDWARE_TYPE_8188FS(_Adapter)) +#define IS_HARDWARE_TYPE_8188GTVU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8188GTVU) +#define IS_HARDWARE_TYPE_8188GTVS(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8188GTVS) +#define IS_HARDWARE_TYPE_8188GTV(_Adapter) \ + (IS_HARDWARE_TYPE_8188GTVU(_Adapter) || IS_HARDWARE_TYPE_8188GTVS(_Adapter)) + +/* RTL8710B Series */ +#define IS_HARDWARE_TYPE_8710BU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8710BU) +#define IS_HARDWARE_TYPE_8710B(_Adapter) (IS_HARDWARE_TYPE_8710BU(_Adapter)) + #define IS_HARDWARE_TYPE_8821BE(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8821BE) #define IS_HARDWARE_TYPE_8821BU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8821BU) #define IS_HARDWARE_TYPE_8821BS(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8821BS) @@ -575,12 +637,29 @@ typedef enum _HARDWARE_TYPE { #define IS_HARDWARE_TYPE_8821C(_Adapter) \ (IS_HARDWARE_TYPE_8821CE(_Adapter) || IS_HARDWARE_TYPE_8821CU(_Adapter) || IS_HARDWARE_TYPE_8821CS(_Adapter)) +#define IS_HARDWARE_TYPE_8822CE(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8822CE) +#define IS_HARDWARE_TYPE_8822CU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8822CU) +#define IS_HARDWARE_TYPE_8822CS(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8822CS) +#define IS_HARDWARE_TYPE_8822C(_Adapter) \ + (IS_HARDWARE_TYPE_8822CE(_Adapter) || IS_HARDWARE_TYPE_8822CU(_Adapter) || IS_HARDWARE_TYPE_8822CS(_Adapter)) + +#define IS_HARDWARE_TYPE_8814BE(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8814BE) +#define IS_HARDWARE_TYPE_8814BU(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8814BU) +#define IS_HARDWARE_TYPE_8814BS(_Adapter) (rtw_get_hw_type(_Adapter) == HARDWARE_TYPE_RTL8814BS) +#define IS_HARDWARE_TYPE_8814B(_Adapter) \ + (IS_HARDWARE_TYPE_8814BE(_Adapter) || IS_HARDWARE_TYPE_8814BU(_Adapter) || IS_HARDWARE_TYPE_8814BS(_Adapter)) + #define IS_HARDWARE_TYPE_JAGUAR2(_Adapter) \ (IS_HARDWARE_TYPE_8814A(_Adapter) || IS_HARDWARE_TYPE_8821B(_Adapter) || IS_HARDWARE_TYPE_8822B(_Adapter) || IS_HARDWARE_TYPE_8821C(_Adapter)) #define IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(_Adapter) \ (IS_HARDWARE_TYPE_JAGUAR(_Adapter) || IS_HARDWARE_TYPE_JAGUAR2(_Adapter)) +#define IS_HARDWARE_TYPE_JAGUAR3(_Adapter) \ + (IS_HARDWARE_TYPE_8814B(_Adapter) || IS_HARDWARE_TYPE_8822C(_Adapter)) + +#define IS_HARDWARE_TYPE_JAGUAR_ALL(_Adapter) \ + (IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(_Adapter) || IS_HARDWARE_TYPE_JAGUAR3(_Adapter)) typedef enum _wowlan_subcode { @@ -606,27 +685,31 @@ 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); +#ifdef CONFIG_NEW_NETDEV_HDL +uint rtw_hal_iface_init(_adapter *adapter); +#endif 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); 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); -u8 rtw_hal_get_def_var(_adapter *padapter, HAL_DEF_VARIABLE eVariable, PVOID pValue); +u8 rtw_hal_set_def_var(_adapter *padapter, HAL_DEF_VARIABLE eVariable, void *pValue); +u8 rtw_hal_get_def_var(_adapter *padapter, HAL_DEF_VARIABLE eVariable, void *pValue); -void rtw_hal_set_odm_var(_adapter *padapter, HAL_ODM_VARIABLE eVariable, PVOID pValue1, BOOLEAN bSet); -void rtw_hal_get_odm_var(_adapter *padapter, HAL_ODM_VARIABLE eVariable, PVOID pValue1, PVOID pValue2); +void rtw_hal_set_odm_var(_adapter *padapter, HAL_ODM_VARIABLE eVariable, void *pValue1, BOOLEAN bSet); +void rtw_hal_get_odm_var(_adapter *padapter, HAL_ODM_VARIABLE eVariable, void *pValue1, void *pValue2); void rtw_hal_enable_interrupt(_adapter *padapter); void rtw_hal_disable_interrupt(_adapter *padapter); @@ -640,6 +723,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); @@ -654,8 +743,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, u8 is_update_bw); -void rtw_update_ramask(_adapter *padapter, struct sta_info *psta, u32 mac_id, u8 rssi_level, u8 is_update_bw); +void rtw_hal_update_ra_mask(struct sta_info *psta); void rtw_hal_start_thread(_adapter *padapter); void rtw_hal_stop_thread(_adapter *padapter); @@ -664,8 +752,8 @@ 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_query_bb_reg(Adapter, RegAddr, BitMask) rtw_hal_read_bbreg((Adapter), (RegAddr), (BitMask)) @@ -673,24 +761,28 @@ void rtw_hal_write_rfreg(_adapter *padapter, u32 eRFPath, u32 RegAddr, u32 BitMa #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)) +#ifdef CONFIG_SYSON_INDIRECT_ACCESS +u32 rtw_hal_read_syson_reg(PADAPTER padapter, u32 RegAddr, u32 BitMask); +void rtw_hal_write_syson_reg(_adapter *padapter, u32 RegAddr, u32 BitMask, u32 Data); +#define hal_query_syson_reg(Adapter, RegAddr, BitMask) rtw_hal_read_syson_reg((Adapter), (RegAddr), (BitMask)) +#define hal_set_syson_reg(Adapter, RegAddr, BitMask, Data) rtw_hal_write_syson_reg((Adapter), (RegAddr), (BitMask), (Data)) +#endif + #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); + void rtw_hal_unmap_beacon_icf(_adapter *padapter); #endif #if defined(CONFIG_USB_HCI) && defined(CONFIG_SUPPORT_USB_INT) 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); -void rtw_hal_set_tx_power_level(_adapter *padapter, u8 channel); -void rtw_hal_get_tx_power_level(_adapter *padapter, s32 *powerlevel); - #ifdef CONFIG_HOSTAPD_MLME s32 rtw_hal_hostap_mgnt_xmit_entry(_adapter *padapter, _pkt *pkt); #endif @@ -737,8 +829,13 @@ 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_macid_drop(_adapter *adapter, u8 macid); +s32 rtw_hal_macid_undrop(_adapter *adapter, u8 macid); 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, @@ -750,22 +847,28 @@ void rtw_hal_update_hisr_hsisr_ind(_adapter *padapter, u32 flag); int rtw_hal_gpio_func_check(_adapter *padapter, u8 gpio_num); void rtw_hal_gpio_multi_func_reset(_adapter *padapter, u8 gpio_num); #endif - +#ifdef CONFIG_FW_CORRECT_BCN void rtw_hal_fw_correct_bcn(_adapter *padapter); +#endif s32 rtw_hal_fw_dl(_adapter *padapter, u8 wowlan); #if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_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_level(_adapter *adapter, u8 channel); +void rtw_hal_set_txpwr_done(_adapter *adapter); +void rtw_hal_set_tx_power_index(_adapter *adapter, u32 powerindex + , enum rf_path rfpath, u8 rate); +u8 rtw_hal_get_tx_power_index(_adapter *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 diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_pg.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_pg.h index 5aaa1f3bbb07..983b469f92e2 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_pg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_pg.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -34,8 +30,6 @@ /* **************************************************** * EEPROM/Efuse PG Offset for 88EE/88EU/88ES * **************************************************** */ -#define EEPROM_TX_PWR_INX_88E 0x10 - #define EEPROM_ChannelPlan_88E 0xB8 #define EEPROM_XTAL_88E 0xB9 #define EEPROM_THERMAL_METER_88E 0xBA @@ -74,9 +68,6 @@ #define PPG_BB_GAIN_2G_TXA_OFFSET_8192E 0x1F6 #define PPG_THERMAL_OFFSET_8192E 0x1F5 -/* 0x10 ~ 0x63 = TX power area. */ -#define EEPROM_TX_PWR_INX_8192E 0x10 - #define EEPROM_ChannelPlan_8192E 0xB8 #define EEPROM_XTAL_8192E 0xB9 #define EEPROM_THERMAL_METER_8192E 0xBA @@ -117,10 +108,8 @@ #define EEPROM_MAC_ADDR_8192ES 0x11A /* **************************************************** * EEPROM/Efuse PG Offset for 8812AE/8812AU/8812AS - * **************************************************** - * 0x10 ~ 0x63 = TX power area. */ + * *****************************************************/ #define EEPROM_USB_MODE_8812 0x08 -#define EEPROM_TX_PWR_INX_8812 0x10 #define EEPROM_ChannelPlan_8812 0xB8 #define EEPROM_XTAL_8812 0xB9 @@ -185,7 +174,6 @@ #define PPG_THERMAL_OFFSET_8814A 0x3EF -#define EEPROM_TX_PWR_INX_8814 0x10 #define EEPROM_USB_MODE_8814A 0x0E #define EEPROM_ChannelPlan_8814 0xB8 #define EEPROM_XTAL_8814 0xB9 @@ -233,8 +221,6 @@ #define PPG_BB_GAIN_5GMB2_TXA_OFFSET_8821A 0x1F1 #define PPG_BB_GAIN_5GHB_TXA_OFFSET_8821A 0x1F0 -#define EEPROM_TX_PWR_INX_8821 0x10 - #define EEPROM_ChannelPlan_8821 0xB8 #define EEPROM_XTAL_8821 0xB9 #define EEPROM_THERMAL_METER_8821 0xBA @@ -302,9 +288,6 @@ #define PPG_BB_GAIN_2G_TXA_OFFSET_8188F 0xEE #define PPG_THERMAL_OFFSET_8188F 0xEF -/* 0x10 ~ 0x63 = TX power area. */ -#define EEPROM_TX_PWR_INX_8188F 0x10 - #define EEPROM_ChannelPlan_8188F 0xB8 #define EEPROM_XTAL_8188F 0xB9 #define EEPROM_THERMAL_METER_8188F 0xBA @@ -338,12 +321,53 @@ #define EEPROM_MAC_ADDR_8188FS 0x11A #define EEPROM_Voltage_ADDR_8188F 0x8 +/* ==================================================== + EEPROM/Efuse PG Offset for 8188GTV/8188GTVS + ==================================================== + */ + +#define GET_PG_KFREE_ON_8188GTV(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC1, 4, 1) +#define GET_PG_KFREE_THERMAL_K_ON_8188GTV(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC8, 5, 1) + +#define PPG_BB_GAIN_2G_TXA_OFFSET_8188GTV 0xEE +#define PPG_THERMAL_OFFSET_8188GTV 0xEF + +#define EEPROM_ChannelPlan_8188GTV 0xB8 +#define EEPROM_XTAL_8188GTV 0xB9 +#define EEPROM_THERMAL_METER_8188GTV 0xBA +#define EEPROM_IQK_LCK_8188GTV 0xBB +#define EEPROM_2G_5G_PA_TYPE_8188GTV 0xBC +#define EEPROM_2G_LNA_TYPE_GAIN_SEL_8188GTV 0xBD +#define EEPROM_5G_LNA_TYPE_GAIN_SEL_8188GTV 0xBF + +#define EEPROM_RF_BOARD_OPTION_8188GTV 0xC1 +#define EEPROM_FEATURE_OPTION_8188GTV 0xC2 +#define EEPROM_RF_BT_SETTING_8188GTV 0xC3 +#define EEPROM_VERSION_8188GTV 0xC4 +#define EEPROM_CustomID_8188GTV 0xC5 +#define EEPROM_TX_BBSWING_2G_8188GTV 0xC6 +#define EEPROM_TX_PWR_CALIBRATE_RATE_8188GTV 0xC8 +#define EEPROM_RF_ANTENNA_OPT_8188GTV 0xC9 +#define EEPROM_RFE_OPTION_8188GTV 0xCA +#define EEPROM_COUNTRY_CODE_8188GTV 0xCB +#define EEPROM_CUSTOMER_ID_8188GTV 0x7F +#define EEPROM_SUBCUSTOMER_ID_8188GTV 0x59 + +/* RTL8188GTVU */ +#define EEPROM_MAC_ADDR_8188GTVU 0xD7 +#define EEPROM_VID_8188GTVU 0xD0 +#define EEPROM_PID_8188GTVU 0xD2 +#define EEPROM_PA_TYPE_8188GTVU 0xBC +#define EEPROM_LNA_TYPE_2G_8188GTVU 0xBD +#define EEPROM_USB_OPTIONAL_FUNCTION0_8188GTVU 0xD4 + +/* RTL8188GTVS */ +#define EEPROM_MAC_ADDR_8188GTVS 0x11A +#define EEPROM_Voltage_ADDR_8188GTV 0x8 + /* **************************************************** * EEPROM/Efuse PG Offset for 8723BE/8723BU/8723BS - * **************************************************** - * 0x10 ~ 0x63 = TX power area. */ -#define EEPROM_TX_PWR_INX_8723B 0x10 - + * *****************************************************/ #define EEPROM_ChannelPlan_8723B 0xB8 #define EEPROM_XTAL_8723B 0xB9 #define EEPROM_THERMAL_METER_8723B 0xBA @@ -391,8 +415,6 @@ #define PPG_BB_GAIN_2G_TXA_OFFSET_8703B 0xEE #define PPG_THERMAL_OFFSET_8703B 0xEF -#define EEPROM_TX_PWR_INX_8703B 0x10 - #define EEPROM_ChannelPlan_8703B 0xB8 #define EEPROM_XTAL_8703B 0xB9 #define EEPROM_THERMAL_METER_8703B 0xBA @@ -429,14 +451,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 #define EEPROM_XTAL_8822B 0xB9 #define EEPROM_THERMAL_METER_8822B 0xBA @@ -479,14 +493,6 @@ * 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_CHANNEL_PLAN_8821C 0xB8 #define EEPROM_XTAL_8821C 0xB9 #define EEPROM_THERMAL_METER_8821C 0xBA @@ -540,8 +546,6 @@ #define PPG_BB_GAIN_2G_TX_OFFSET_8723D 0x1EE #define PPG_THERMAL_OFFSET_8723D 0xEF -#define EEPROM_TX_PWR_INX_8723D 0x10 - #define EEPROM_ChannelPlan_8723D 0xB8 #define EEPROM_XTAL_8723D 0xB9 #define EEPROM_THERMAL_METER_8723D 0xBA @@ -578,10 +582,126 @@ #define EEPROM_MAC_ADDR_8723DS 0x11A #define EEPROM_Voltage_ADDR_8723D 0x8 +/* + * ==================================================== + * EEPROM/Efuse PG Offset for 8822C + * ==================================================== + */ +#define EEPROM_TX_PWR_INX_8822C 0x10 +#define EEPROM_ChannelPlan_8822C 0xB8 +#define EEPROM_XTAL_8822C 0xB9 +#define EEPROM_IQK_LCK_8822C 0xBB +#define EEPROM_2G_5G_PA_TYPE_8822C 0xBC +/* PATH A & PATH B */ +#define EEPROM_2G_LNA_TYPE_GAIN_SEL_AB_8822C 0xBD +/* PATH C & PATH D */ +#define EEPROM_2G_LNA_TYPE_GAIN_SEL_CD_8822C 0xBE +/* PATH A & PATH B */ +#define EEPROM_5G_LNA_TYPE_GAIN_SEL_AB_8822C 0xBF +/* PATH C & PATH D */ +#define EEPROM_5G_LNA_TYPE_GAIN_SEL_CD_8822C 0xC0 + +#define EEPROM_RF_BOARD_OPTION_8822C 0xC1 +#define EEPROM_FEATURE_OPTION_8822C 0xC2 +#define EEPROM_RF_BT_SETTING_8822C 0xC3 +#define EEPROM_VERSION_8822C 0xC4 +#define EEPROM_CustomID_8822C 0xC5 +#define EEPROM_TX_BBSWING_2G_8822C 0xC6 +#define EEPROM_TX_PWR_CALIBRATE_RATE_8822C 0xC8 +#define EEPROM_RF_ANTENNA_OPT_8822C 0xC9 +#define EEPROM_RFE_OPTION_8822C 0xCA +#define EEPROM_COUNTRY_CODE_8822C 0xCB +#define EEPROM_THERMAL_METER_A_8822C 0xD0 +#define EEPROM_THERMAL_METER_B_8822C 0xD1 +/* RTL8822CU */ +#define EEPROM_MAC_ADDR_8822CU 0x157 +#define EEPROM_VID_8822CU 0x100 +#define EEPROM_PID_8822CU 0x102 +#define EEPROM_USB_OPTIONAL_FUNCTION0_8822CU 0x104 +#define EEPROM_USB_MODE_8822CU 0x06 + +/* RTL8822CS */ +#define EEPROM_MAC_ADDR_8822CS 0x16A + +/* RTL8822CE */ +#define EEPROM_MAC_ADDR_8822CE 0x120 + +/* **************************************************** + * EEPROM/Efuse PG Offset for 8192F + * **************************************************** */ +#define EEPROM_ChannelPlan_8192F 0xB8 +#define EEPROM_XTAL_8192F 0xB9 +#define EEPROM_THERMAL_METER_8192F 0xBA +#define EEPROM_IQK_LCK_8192F 0xBB +#define EEPROM_2G_5G_PA_TYPE_8192F 0xBC +#define EEPROM_2G_LNA_TYPE_GAIN_SEL_8192F 0xBD +#define EEPROM_5G_LNA_TYPE_GAIN_SEL_8192F 0xBF + +#define EEPROM_RF_BOARD_OPTION_8192F 0xC1 +#define EEPROM_FEATURE_OPTION_8192F 0xC2 +#define EEPROM_RF_BT_SETTING_8192F 0xC3 +#define EEPROM_VERSION_8192F 0xC4 +#define EEPROM_CustomID_8192F 0xC5 +#define EEPROM_TX_BBSWING_2G_8192F 0xC6 +#define EEPROM_TX_BBSWING_5G_8192F 0xC7 +#define EEPROM_TX_PWR_CALIBRATE_RATE_8192F 0xC8 +#define EEPROM_RF_ANTENNA_OPT_8192F 0xC9 +#define EEPROM_RFE_OPTION_8192F 0xCA +#define EEPROM_COUNTRY_CODE_8192F 0xCB +/*RTL8192FS*/ +#define EEPROM_MAC_ADDR_8192FS 0x11A +#define EEPROM_Voltage_ADDR_8192F 0x8 +/* RTL8192FU */ +#define EEPROM_MAC_ADDR_8192FU 0x107 +#define EEPROM_VID_8192FU 0x100 +#define EEPROM_PID_8192FU 0x102 +#define EEPROM_USB_OPTIONAL_FUNCTION0_8192FU 0x104 +/* RTL8192FE */ +#define EEPROM_MAC_ADDR_8192FE 0xD0 +#define EEPROM_VID_8192FE 0xD6 +#define EEPROM_DID_8192FE 0xD8 +#define EEPROM_SVID_8192FE 0xDA +#define EEPROM_SMID_8192FE 0xDC + +/* **************************************************** + * EEPROM/Efuse PG Offset for 8710B + * **************************************************** */ +#define RTL_EEPROM_ID_8710B 0x8195 +#define EEPROM_Default_ThermalMeter_8710B 0x1A + +#define EEPROM_CHANNEL_PLAN_8710B 0xC8 +#define EEPROM_XTAL_8710B 0xC9 +#define EEPROM_THERMAL_METER_8710B 0xCA +#define EEPROM_IQK_LCK_8710B 0xCB +#define EEPROM_2G_5G_PA_TYPE_8710B 0xCC +#define EEPROM_2G_LNA_TYPE_GAIN_SEL_8710B 0xCD +#define EEPROM_5G_LNA_TYPE_GAIN_SEL_8710B 0xCF +#define EEPROM_TX_KFREE_8710B 0xEE //Physical Efuse Address +#define EEPROM_THERMAL_8710B 0xEF //Physical Efuse Address +#define EEPROM_PACKAGE_TYPE_8710B 0xF8 //Physical Efuse Address + +#define EEPROM_RF_BOARD_OPTION_8710B 0x131 +#define EEPROM_RF_FEATURE_OPTION_8710B 0x132 +#define EEPROM_RF_BT_SETTING_8710B 0x133 +#define EEPROM_VERSION_8710B 0x134 +#define EEPROM_CUSTOM_ID_8710B 0x135 +#define EEPROM_TX_BBSWING_2G_8710B 0x136 +#define EEPROM_TX_BBSWING_5G_8710B 0x137 +#define EEPROM_TX_PWR_CALIBRATE_RATE_8710B 0x138 +#define EEPROM_RF_ANTENNA_OPT_8710B 0x139 +#define EEPROM_RFE_OPTION_8710B 0x13A +#define EEPROM_COUNTRY_CODE_8710B 0x13B +#define EEPROM_COUNTRY_CODE_2_8710B 0x13C + +#define EEPROM_MAC_ADDR_8710B 0x11A +#define EEPROM_VID_8710BU 0x1C0 +#define EEPROM_PID_8710BU 0x1C2 + /* **************************************************** * EEPROM/Efuse Value Type * **************************************************** */ #define EETYPE_TX_PWR 0x0 +#define EETYPE_MAX_RFE_8192F 0x31 /* **************************************************** * EEPROM/Efuse Default Value * **************************************************** */ @@ -629,8 +749,9 @@ #define EEPROM_Default_ThermalMeter_8703B 0x18 #define EEPROM_Default_ThermalMeter_8723D 0x18 #define EEPROM_Default_ThermalMeter_8188F 0x18 +#define EEPROM_Default_ThermalMeter_8188GTV 0x18 #define EEPROM_Default_ThermalMeter_8814A 0x18 - +#define EEPROM_Default_ThermalMeter_8192F 0x1A #define EEPROM_Default_CrystalCap 0x0 #define EEPROM_Default_CrystalCap_8723A 0x20 @@ -642,6 +763,9 @@ #define EEPROM_Default_CrystalCap_8703B 0x20 #define EEPROM_Default_CrystalCap_8723D 0x20 #define EEPROM_Default_CrystalCap_8188F 0x20 +#define EEPROM_Default_CrystalCap_8188GTV 0x20 +#define EEPROM_Default_CrystalCap_8192F 0x20 +#define EEPROM_Default_CrystalCap_8822C 0x3F #define EEPROM_Default_CrystalFreq 0x0 #define EEPROM_Default_TxPowerLevel_92C 0x22 #define EEPROM_Default_TxPowerLevel_2G 0x2C @@ -789,7 +913,9 @@ typedef enum _BT_CoType { BT_RTL8703B = 12, BT_RTL8822B = 13, BT_RTL8723D = 14, - BT_RTL8821C = 15 + BT_RTL8821C = 15, + BT_RTL8192F = 16, + BT_RTL8822C = 17 } BT_CoType, *PBT_CoType; typedef enum _BT_RadioShared { diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_phy.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_phy.h index af1dcad79942..f96fed55d949 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_phy.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_phy.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +52,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, @@ -161,6 +152,14 @@ typedef struct _R_ANTENNA_SELECT_CCK { u8 r_ccktx_enable:4; } R_ANTENNA_SELECT_CCK; + +/*--------------------------Exported Function prototype---------------------*/ +u32 +PHY_CalculateBitShift( + u32 BitMask +); + +#ifdef CONFIG_RF_SHADOW_RW typedef struct RF_Shadow_Compare_Map { /* Shadow register value */ u32 Value; @@ -174,70 +173,63 @@ typedef struct RF_Shadow_Compare_Map { u8 Driver_Write; } RF_SHADOW_T; -/*--------------------------Exported Function prototype---------------------*/ - -u32 -PHY_CalculateBitShift( - u32 BitMask -); - u32 PHY_RFShadowRead( - IN PADAPTER Adapter, - IN u8 eRFPath, - IN u32 Offset); + PADAPTER Adapter, + enum rf_path eRFPath, + u32 Offset); -VOID +void PHY_RFShadowWrite( - IN PADAPTER Adapter, - IN u8 eRFPath, - IN u32 Offset, - IN u32 Data); + PADAPTER Adapter, + enum rf_path eRFPath, + u32 Offset, + u32 Data); BOOLEAN PHY_RFShadowCompare( - IN PADAPTER Adapter, - IN u8 eRFPath, - IN u32 Offset); + PADAPTER Adapter, + enum rf_path eRFPath, + u32 Offset); -VOID +void PHY_RFShadowRecorver( - IN PADAPTER Adapter, - IN u8 eRFPath, - IN u32 Offset); + PADAPTER Adapter, + enum rf_path eRFPath, + u32 Offset); -VOID +void PHY_RFShadowCompareAll( - IN PADAPTER Adapter); + PADAPTER Adapter); -VOID +void PHY_RFShadowRecorverAll( - IN PADAPTER Adapter); + PADAPTER Adapter); -VOID +void PHY_RFShadowCompareFlagSet( - IN PADAPTER Adapter, - IN u8 eRFPath, - IN u32 Offset, - IN u8 Type); + PADAPTER Adapter, + enum rf_path eRFPath, + u32 Offset, + u8 Type); -VOID +void PHY_RFShadowRecorverFlagSet( - IN PADAPTER Adapter, - IN u8 eRFPath, - IN u32 Offset, - IN u8 Type); + PADAPTER Adapter, + enum rf_path eRFPath, + u32 Offset, + u8 Type); -VOID +void PHY_RFShadowCompareFlagSetAll( - IN PADAPTER Adapter); + PADAPTER Adapter); -VOID +void PHY_RFShadowRecorverFlagSetAll( - IN PADAPTER Adapter); + PADAPTER Adapter); -VOID +void PHY_RFShadowRefresh( - IN PADAPTER Adapter); - + PADAPTER Adapter); +#endif /*#CONFIG_RF_SHADOW_RW*/ #endif /* __HAL_COMMON_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_phy_reg.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_phy_reg.h index 9a92e405f445..71bf022d6f8d 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_phy_reg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_phy_reg.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,20 +12,260 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ -/* for PutRFRegsetting & GetRFRegSetting BitMask - * #if (RTL92SE_FPGA_VERIFY == 1) - * #define bRFRegOffsetMask 0xfff - * #else */ +/* for PutRFRegsetting & GetRFRegSetting BitMask*/ #define bRFRegOffsetMask 0xfffff -/* #endif */ + +/* 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_PHY_REG_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_sdio.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_sdio.h index 0a83372dc547..c798b97315c2 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_sdio.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_sdio.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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_ @@ -25,7 +21,7 @@ u8 rtw_hal_sdio_max_txoqt_free_space(_adapter *padapter); u8 rtw_hal_sdio_query_tx_freepage(_adapter *padapter, u8 PageIdx, u8 RequiredPageNum); void rtw_hal_sdio_update_tx_freepage(_adapter *padapter, u8 PageIdx, u8 RequiredPageNum); -void rtw_hal_set_sdio_tx_max_length(PADAPTER padapter, u8 numHQ, u8 numNQ, u8 numLQ, u8 numPubQ); +void rtw_hal_set_sdio_tx_max_length(PADAPTER padapter, u8 numHQ, u8 numNQ, u8 numLQ, u8 numPubQ, u8 div_num); u32 rtw_hal_get_sdio_tx_max_length(PADAPTER padapter, u8 queue_idx); bool sdio_power_on_check(PADAPTER padapter); @@ -33,4 +29,29 @@ bool sdio_power_on_check(PADAPTER padapter); void sd_c2h_hisr_hdl(_adapter *adapter); #endif +#if defined(CONFIG_RTL8188F) || defined (CONFIG_RTL8188GTV) || defined (CONFIG_RTL8192F) +#define SDIO_LOCAL_CMD_ADDR(addr) ((SDIO_LOCAL_DEVICE_ID << 13) | ((addr) & SDIO_LOCAL_MSK)) +#endif + +#ifdef CONFIG_SDIO_CHK_HCI_RESUME +bool sdio_chk_hci_resume(struct intf_hdl *pintfhdl); +void sdio_chk_hci_suspend(struct intf_hdl *pintfhdl); +#else +#define sdio_chk_hci_resume(pintfhdl) _FALSE +#define sdio_chk_hci_suspend(pintfhdl) do {} while (0) +#endif /* CONFIG_SDIO_CHK_HCI_RESUME */ + +#ifdef CONFIG_SDIO_INDIRECT_ACCESS +/* program indirect access register in sdio local to read/write page0 registers */ +s32 sdio_iread(PADAPTER padapter, u32 addr, u8 size, u8 *v); +s32 sdio_iwrite(PADAPTER padapter, u32 addr, u8 size, u8 *v); +u8 sdio_iread8(struct intf_hdl *pintfhdl, u32 addr); +u16 sdio_iread16(struct intf_hdl *pintfhdl, u32 addr); +u32 sdio_iread32(struct intf_hdl *pintfhdl, u32 addr); +s32 sdio_iwrite8(struct intf_hdl *pintfhdl, u32 addr, u8 val); +s32 sdio_iwrite16(struct intf_hdl *pintfhdl, u32 addr, u16 val); +s32 sdio_iwrite32(struct intf_hdl *pintfhdl, u32 addr, u32 val); +#endif /* CONFIG_SDIO_INDIRECT_ACCESS */ +u32 cmd53_4byte_alignment(struct intf_hdl *pintfhdl, u32 addr); + #endif /* __HAL_SDIO_H_ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_kfree.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_sdio_coex.h similarity index 59% rename from drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_kfree.h rename to drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_sdio_coex.h index 30235df42a03..f14d99818ea2 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/hal/phydm/phydm_kfree.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/hal_sdio_coex.h @@ -1,45 +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 __PHYDMKFREE_H__ -#define __PHYDKFREE_H__ - -#define KFREE_VERSION "1.0" - -enum phydm_kfree_channeltosw { - PHYDM_2G = 0, - PHYDM_5GLB1 = 1, - PHYDM_5GLB2 = 2, - PHYDM_5GMB1 = 3, - PHYDM_5GMB2 = 4, - PHYDM_5GHB = 5, -}; - - -void -phydm_config_kfree( - void *p_dm_void, - u8 channel_to_sw, - u8 *kfree_table -); - - -#endif +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 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 + * + * + ******************************************************************************/ +#ifndef __HAL_SDIO_COEX_H__ +#define __HAL_SDIO_COEX_H__ + +#include + +#ifdef CONFIG_SDIO_MULTI_FUNCTION_COEX + +enum { /* for sdio multi-func. coex */ + SDIO_MULTI_WIFI = 0, + SDIO_MULTI_BT, + SDIO_MULTI_NUM +}; + +bool ex_hal_sdio_multi_if_bus_available(PADAPTER adapter); + +#else + +#define ex_hal_sdio_multi_if_bus_available(adapter) TRUE + +#endif /* CONFIG_SDIO_MULTI_FUNCTION_COEX */ +#endif /* !__HAL_SDIO_COEX_H__ */ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/ieee80211.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/ieee80211.h index 3fad87971afd..0eb3bd69b328 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/ieee80211.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/ieee80211.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,25 +12,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 __IEEE80211_H #define __IEEE80211_H - -#ifndef CONFIG_RTL8711FW - - #if defined PLATFORM_OS_XP - #include - #endif -#else - -#endif - #define MGMT_QUEUE_NUM 5 #define ETH_ALEN 6 @@ -147,8 +133,6 @@ extern u8 WPA_CIPHER_SUITE_WEP104[]; #define RSN_SELECTOR_LEN 4 extern u16 RSN_VERSION_BSD; -extern u8 RSN_AUTH_KEY_MGMT_UNSPEC_802_1X[]; -extern u8 RSN_AUTH_KEY_MGMT_PSK_OVER_802_1X[]; extern u8 RSN_CIPHER_SUITE_NONE[]; extern u8 RSN_CIPHER_SUITE_WEP40[]; extern u8 RSN_CIPHER_SUITE_TKIP[]; @@ -156,6 +140,91 @@ extern u8 RSN_CIPHER_SUITE_WRAP[]; extern u8 RSN_CIPHER_SUITE_CCMP[]; extern u8 RSN_CIPHER_SUITE_WEP104[]; +/* AKM suite type */ +extern u8 WLAN_AKM_8021X[]; +extern u8 WLAN_AKM_PSK[]; +extern u8 WLAN_AKM_FT_8021X[]; +extern u8 WLAN_AKM_FT_PSK[]; +extern u8 WLAN_AKM_8021X_SHA256[]; +extern u8 WLAN_AKM_PSK_SHA256[]; +extern u8 WLAN_AKM_TDLS[]; +extern u8 WLAN_AKM_SAE[]; +extern u8 WLAN_AKM_FT_OVER_SAE[]; +extern u8 WLAN_AKM_8021X_SUITE_B[]; +extern u8 WLAN_AKM_8021X_SUITE_B_192[]; +extern u8 WLAN_AKM_FILS_SHA256[]; +extern u8 WLAN_AKM_FILS_SHA384[]; +extern u8 WLAN_AKM_FT_FILS_SHA256[]; +extern u8 WLAN_AKM_FT_FILS_SHA384[]; + +#define WLAN_AKM_TYPE_8021X BIT(0) +#define WLAN_AKM_TYPE_PSK BIT(1) +#define WLAN_AKM_TYPE_FT_8021X BIT(2) +#define WLAN_AKM_TYPE_FT_PSK BIT(3) +#define WLAN_AKM_TYPE_8021X_SHA256 BIT(4) +#define WLAN_AKM_TYPE_PSK_SHA256 BIT(5) +#define WLAN_AKM_TYPE_TDLS BIT(6) +#define WLAN_AKM_TYPE_SAE BIT(7) +#define WLAN_AKM_TYPE_FT_OVER_SAE BIT(8) +#define WLAN_AKM_TYPE_8021X_SUITE_B BIT(9) +#define WLAN_AKM_TYPE_8021X_SUITE_B_192 BIT(10) +#define WLAN_AKM_TYPE_FILS_SHA256 BIT(11) +#define WLAN_AKM_TYPE_FILS_SHA384 BIT(12) +#define WLAN_AKM_TYPE_FT_FILS_SHA256 BIT(13) +#define WLAN_AKM_TYPE_FT_FILS_SHA384 BIT(14) + +/* IEEE 802.11i */ +#define PMKID_LEN 16 +#define PMK_LEN 32 +#define PMK_LEN_SUITE_B_192 48 +#define PMK_LEN_MAX 48 +#define WPA_REPLAY_COUNTER_LEN 8 +#define WPA_NONCE_LEN 32 +#define WPA_KEY_RSC_LEN 8 +#define WPA_GMK_LEN 32 +#define WPA_GTK_MAX_LEN 32 + +/* IEEE 802.11, 8.5.2 EAPOL-Key frames */ +#define WPA_KEY_INFO_TYPE_MASK ((u16) (BIT(0) | BIT(1) | BIT(2))) +#define WPA_KEY_INFO_TYPE_AKM_DEFINED 0 +#define WPA_KEY_INFO_TYPE_HMAC_MD5_RC4 BIT(0) +#define WPA_KEY_INFO_TYPE_HMAC_SHA1_AES BIT(1) +#define WPA_KEY_INFO_TYPE_AES_128_CMAC 3 +#define WPA_KEY_INFO_KEY_TYPE BIT(3) /* 1 = Pairwise, 0 = Group key */ +/* bit4..5 is used in WPA, but is reserved in IEEE 802.11i/RSN */ +#define WPA_KEY_INFO_KEY_INDEX_MASK (BIT(4) | BIT(5)) +#define WPA_KEY_INFO_KEY_INDEX_SHIFT 4 +#define WPA_KEY_INFO_INSTALL BIT(6) /* pairwise */ +#define WPA_KEY_INFO_TXRX BIT(6) /* group */ +#define WPA_KEY_INFO_ACK BIT(7) +#define WPA_KEY_INFO_MIC BIT(8) +#define WPA_KEY_INFO_SECURE BIT(9) +#define WPA_KEY_INFO_ERROR BIT(10) +#define WPA_KEY_INFO_REQUEST BIT(11) +#define WPA_KEY_INFO_ENCR_KEY_DATA BIT(12) /* IEEE 802.11i/RSN only */ +#define WPA_KEY_INFO_SMK_MESSAGE BIT(13) + +struct ieee802_1x_hdr { + u8 version; + u8 type; + u16 length; + /* followed by length octets of data */ +}; + +struct wpa_eapol_key { + u8 type; + /* Note: key_info, key_length, and key_data_length are unaligned */ + u8 key_info[2]; /* big endian */ + u8 key_length[2]; /* big endian */ + u8 replay_counter[WPA_REPLAY_COUNTER_LEN]; + u8 key_nonce[WPA_NONCE_LEN]; + u8 key_iv[16]; + u8 key_rsc[WPA_KEY_RSC_LEN]; + u8 key_id[8]; /* Reserved in IEEE 802.11i/RSN */ + u8 key_mic[16]; + u8 key_data_length[2]; /* big endian */ + /* followed by key_data_length bytes of key_data */ +}; typedef enum _RATEID_IDX_ { RATEID_IDX_BGN_40M_2SS = 0, @@ -206,7 +275,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), @@ -345,7 +414,7 @@ struct ieee_ibss_seq { _list list; }; -#if defined(PLATFORM_LINUX) || defined(CONFIG_RTL8711FW) || defined(PLATFORM_FREEBSD) +#if defined(PLATFORM_LINUX) || defined(PLATFORM_FREEBSD) struct rtw_ieee80211_hdr { u16 frame_ctl; @@ -396,56 +465,30 @@ struct eapol { u16 length; } __attribute__((packed)); +struct rtw_ieee80211s_hdr { + u8 flags; + u8 ttl; + u32 seqnum; + u8 eaddr1[ETH_ALEN]; + u8 eaddr2[ETH_ALEN]; +} __attribute__((packed)); + +/** + * struct rtw_ieee80211_rann_ie + * + * This structure refers to "Root Announcement information element" + */ + struct rtw_ieee80211_rann_ie { + u8 rann_flags; + u8 rann_hopcount; + u8 rann_ttl; + u8 rann_addr[ETH_ALEN]; + u32 rann_seq; + u32 rann_interval; + u32 rann_metric; +} __attribute__((packed)); #endif - - -#ifdef PLATFORM_WINDOWS - -#pragma pack(1) -struct rtw_ieee80211_hdr { - u16 frame_ctl; - u16 duration_id; - u8 addr1[ETH_ALEN]; - u8 addr2[ETH_ALEN]; - u8 addr3[ETH_ALEN]; - u16 seq_ctl; - u8 addr4[ETH_ALEN]; -}; - -struct rtw_ieee80211_hdr_3addr { - u16 frame_ctl; - u16 duration_id; - u8 addr1[ETH_ALEN]; - u8 addr2[ETH_ALEN]; - u8 addr3[ETH_ALEN]; - u16 seq_ctl; -}; - - -struct rtw_ieee80211_hdr_qos { - struct rtw_ieee80211_hdr wlan_hdr; - u16 qc; -}; - -struct rtw_ieee80211_hdr_3addr_qos { - struct rtw_ieee80211_hdr_3addr wlan_hdr; - u16 qc; -}; - -struct eapol { - u8 snap[6]; - u16 ethertype; - u8 version; - u8 type; - u16 length; -}; -#pragma pack() - -#endif - - - enum eap_type { EAP_PACKET = 0, EAPOL_START, @@ -554,7 +597,7 @@ enum eap_type { #define P80211_OUI_LEN 3 -#if defined(PLATFORM_LINUX) || defined(CONFIG_RTL8711FW) || defined(PLATFORM_FREEBSD) +#if defined(PLATFORM_LINUX) || defined(PLATFORM_FREEBSD) struct ieee80211_snap_hdr { @@ -567,22 +610,6 @@ struct ieee80211_snap_hdr { #endif -#ifdef PLATFORM_WINDOWS - -#pragma pack(1) -struct ieee80211_snap_hdr { - - u8 dsap; /* always 0xAA */ - u8 ssap; /* always 0xAA */ - u8 ctrl; /* always 0x03 */ - u8 oui[P80211_OUI_LEN]; /* organizational universal id */ - -}; -#pragma pack() - -#endif - - #define SNAP_SIZE sizeof(struct ieee80211_snap_hdr) #define WLAN_FC_GET_TYPE(fc) ((fc) & RTW_IEEE80211_FCTL_FTYPE) @@ -596,6 +623,7 @@ struct ieee80211_snap_hdr { /* Authentication algorithms */ #define WLAN_AUTH_OPEN 0 #define WLAN_AUTH_SHARED_KEY 1 +#define WLAN_AUTH_SAE 3 #define WLAN_AUTH_CHALLENGE_LEN 128 @@ -636,10 +664,33 @@ struct ieee80211_snap_hdr { #define WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA 7 #define WLAN_REASON_DISASSOC_STA_HAS_LEFT 8 #define WLAN_REASON_STA_REQ_ASSOC_WITHOUT_AUTH 9 +#define WLAN_REASON_MESH_PEER_CANCELED 52 +#define WLAN_REASON_MESH_MAX_PEERS 53 +#define WLAN_REASON_MESH_CONFIG 54 +#define WLAN_REASON_MESH_CLOSE 55 +#define WLAN_REASON_MESH_MAX_RETRIES 56 +#define WLAN_REASON_MESH_CONFIRM_TIMEOUT 57 +#define WLAN_REASON_MESH_INVALID_GTK 58 +#define WLAN_REASON_MESH_INCONSISTENT_PARAM 59 +#define WLAN_REASON_MESH_INVALID_SECURITY 60 +#define WLAN_REASON_MESH_PATH_NOPROXY 61 +#define WLAN_REASON_MESH_PATH_NOFORWARD 62 +#define WLAN_REASON_MESH_PATH_DEST_UNREACHABLE 63 +#define WLAN_REASON_MAC_EXISTS_IN_MBSS 64 +#define WLAN_REASON_MESH_CHAN_REGULATORY 65 +#define WLAN_REASON_MESH_CHAN 66 +#define WLAN_REASON_SA_QUERY_TIMEOUT 65532 #define WLAN_REASON_ACTIVE_ROAM 65533 #define WLAN_REASON_JOIN_WRONG_CHANNEL 65534 #define WLAN_REASON_EXPIRATION_CHK 65535 +#define WLAN_REASON_IS_PRIVATE(reason) ( \ + reason == WLAN_REASON_EXPIRATION_CHK \ + || reason == WLAN_REASON_JOIN_WRONG_CHANNEL \ + || reason == WLAN_REASON_ACTIVE_ROAM \ + || reason == WLAN_REASON_SA_QUERY_TIMEOUT \ + ) + /* Information Element IDs */ #define WLAN_EID_SSID 0 #define WLAN_EID_SUPP_RATES 1 @@ -675,6 +726,15 @@ struct ieee80211_snap_hdr { #define WLAN_EID_20_40_BSS_INTOLERANT 73 #define WLAN_EID_OVERLAPPING_BSS_SCAN_PARAMS 74 #define WLAN_EID_MMIE 76 +#define WLAN_EID_MESH_CONFIG 113 +#define WLAN_EID_MESH_ID 114 +#define WLAN_EID_MPM 117 +#define WLAN_EID_RANN 126 +#define WLAN_EID_PREQ 130 +#define WLAN_EID_PREP 131 +#define WLAN_EID_PERR 132 +#define WLAN_EID_AMPE 139 +#define WLAN_EID_MIC 140 #define WLAN_EID_VENDOR_SPECIFIC 221 #define WLAN_EID_GENERIC (WLAN_EID_VENDOR_SPECIFIC) #define WLAN_EID_VHT_CAPABILITY 191 @@ -1104,14 +1164,10 @@ struct ieee80211_softmac_stats { #define WEP_KEYS 4 #define WEP_KEY_LEN 13 +#define BIP_MAX_KEYID 5 +#define BIP_AAD_SIZE 20 -#ifdef CONFIG_IEEE80211W - #define BIP_MAX_KEYID 5 - #define BIP_AAD_SIZE 20 -#endif /* CONFIG_IEEE80211W */ - -#if defined(PLATFORM_LINUX) || defined(CONFIG_RTL8711FW) - +#if defined(PLATFORM_LINUX) struct ieee80211_security { u16 active_key:2, enabled:1, @@ -1126,24 +1182,6 @@ struct ieee80211_security { #endif -#ifdef PLATFORM_WINDOWS - -#pragma pack(1) -struct ieee80211_security { - u16 active_key:2, - enabled:1, - auth_mode:2, - auth_algo:4, - unicast_uses_group:1; - u8 key_sizes[WEP_KEYS]; - u8 keys[WEP_KEYS][WEP_KEY_LEN]; - u8 level; - u16 flags; -} ; -#pragma pack() - -#endif - /* 802.11 data frame from AP @@ -1184,8 +1222,7 @@ struct ieee80211_header_data { #define MFIE_TYPE_RATES_EX 50 #define MFIE_TYPE_GENERIC 221 -#if defined(PLATFORM_LINUX) || defined(CONFIG_RTL8711FW) - +#if defined(PLATFORM_LINUX) struct ieee80211_info_element_hdr { u8 id; u8 len; @@ -1198,23 +1235,6 @@ struct ieee80211_info_element { } __attribute__((packed)); #endif -#ifdef PLATFORM_WINDOWS - -#pragma pack(1) -struct ieee80211_info_element_hdr { - u8 id; - u8 len; -} ; - -struct ieee80211_info_element { - u8 id; - u8 len; - u8 data[0]; -} ; -#pragma pack() - -#endif - /* * These are the data types that can make up management packets @@ -1237,9 +1257,7 @@ struct ieee80211_info_element { #define IEEE80211_DEFAULT_BASIC_RATE 10 -#if defined(PLATFORM_LINUX) || defined(CONFIG_RTL8711FW) - - +#if defined(PLATFORM_LINUX) struct ieee80211_authentication { struct ieee80211_header_data header; u16 algorithm; @@ -1279,57 +1297,6 @@ struct ieee80211_assoc_response_frame { } __attribute__((packed)); #endif - - -#ifdef PLATFORM_WINDOWS - -#pragma pack(1) - -struct ieee80211_authentication { - struct ieee80211_header_data header; - u16 algorithm; - u16 transaction; - u16 status; - /* struct ieee80211_info_element_hdr info_element; */ -} ; - - -struct ieee80211_probe_response { - struct ieee80211_header_data header; - u32 time_stamp[2]; - u16 beacon_interval; - u16 capability; - struct ieee80211_info_element info_element; -} ; - -struct ieee80211_probe_request { - struct ieee80211_header_data header; - /*struct ieee80211_info_element info_element;*/ -} ; - -struct ieee80211_assoc_request_frame { - struct rtw_ieee80211_hdr_3addr header; - u16 capability; - u16 listen_interval; - /* u8 current_ap[ETH_ALEN]; */ - struct ieee80211_info_element_hdr info_element; -} ; - -struct ieee80211_assoc_response_frame { - struct rtw_ieee80211_hdr_3addr header; - u16 capability; - u16 status; - u16 aid; - /* struct ieee80211_info_element info_element; supported rates */ -}; - -#pragma pack() - -#endif - - - - struct ieee80211_txb { u8 nr_frags; u8 encrypted; @@ -1350,7 +1317,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) @@ -1543,19 +1509,34 @@ 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, RTW_WLAN_CATEGORY_WNM = 10, RTW_WLAN_CATEGORY_UNPROTECTED_WNM = 11, /* add for CONFIG_IEEE80211W, none 11w also can use */ RTW_WLAN_CATEGORY_TDLS = 12, - RTW_WLAN_CATEGORY_SELF_PROTECTED = 15, /* add for CONFIG_IEEE80211W, none 11w also can use */ + RTW_WLAN_CATEGORY_MESH = 13, + RTW_WLAN_CATEGORY_MULTIHOP = 14, + RTW_WLAN_CATEGORY_SELF_PROTECTED = 15, RTW_WLAN_CATEGORY_WMM = 17, RTW_WLAN_CATEGORY_VHT = 21, RTW_WLAN_CATEGORY_P2P = 0x7f,/* P2P action frames */ }; +#define CATEGORY_IS_GROUP_PRIVACY(cat) \ + (cat == RTW_WLAN_CATEGORY_MESH || cat == RTW_WLAN_CATEGORY_MULTIHOP) + +#define CATEGORY_IS_NON_ROBUST(cat) \ + (cat == RTW_WLAN_CATEGORY_PUBLIC \ + || cat == RTW_WLAN_CATEGORY_HT \ + || cat == RTW_WLAN_CATEGORY_UNPROTECTED_WNM \ + || cat == RTW_WLAN_CATEGORY_SELF_PROTECTED \ + || cat == RTW_WLAN_CATEGORY_VHT \ + || cat == RTW_WLAN_CATEGORY_P2P) + +#define CATEGORY_IS_ROBUST(cat) !CATEGORY_IS_NON_ROBUST(cat) + /* SPECTRUM_MGMT action code */ enum rtw_ieee80211_spectrum_mgmt_actioncode { RTW_WLAN_ACTION_SPCT_MSR_REQ = 0, @@ -1566,6 +1547,32 @@ enum rtw_ieee80211_spectrum_mgmt_actioncode { RTW_WLAN_ACTION_SPCT_EXT_CHL_SWITCH = 5, }; +/* SELF_PROTECTED action code */ +enum rtw_ieee80211_self_protected_actioncode { + RTW_ACT_SELF_PROTECTED_RSVD = 0, + RTW_ACT_SELF_PROTECTED_MESH_OPEN = 1, + RTW_ACT_SELF_PROTECTED_MESH_CONF = 2, + RTW_ACT_SELF_PROTECTED_MESH_CLOSE = 3, + RTW_ACT_SELF_PROTECTED_MESH_GK_INFORM = 4, + RTW_ACT_SELF_PROTECTED_MESH_GK_ACK = 5, + RTW_ACT_SELF_PROTECTED_NUM, +}; + +/* MESH action code */ +enum rtw_ieee80211_mesh_actioncode { + RTW_ACT_MESH_LINK_METRIC_REPORT, + RTW_ACT_MESH_HWMP_PATH_SELECTION, + RTW_ACT_MESH_GATE_ANNOUNCEMENT, + RTW_ACT_MESH_CONGESTION_CONTROL_NOTIFICATION, + RTW_ACT_MESH_MCCA_SETUP_REQUEST, + RTW_ACT_MESH_MCCA_SETUP_REPLY, + RTW_ACT_MESH_MCCA_ADVERTISEMENT_REQUEST, + RTW_ACT_MESH_MCCA_ADVERTISEMENT, + RTW_ACT_MESH_MCCA_TEARDOWN, + RTW_ACT_MESH_TBTT_ADJUSTMENT_REQUEST, + RTW_ACT_MESH_TBTT_ADJUSTMENT_RESPONSE, +}; + enum _PUBLIC_ACTION { ACT_PUBLIC_BSSCOEXIST = 0, /* 20/40 BSS Coexistence */ ACT_PUBLIC_DSE_ENABLE = 1, @@ -1650,14 +1657,22 @@ enum rtw_ieee80211_vht_actioncode { #ifdef CONFIG_RTW_80211R enum rtw_ieee80211_ft_actioncode { RTW_WLAN_ACTION_FT_RESV, - RTW_WLAN_ACTION_FT_REQUEST, - RTW_WLAN_ACTION_FT_RESPONSE, - RTW_WLAN_ACTION_FT_CONFIRM, + RTW_WLAN_ACTION_FT_REQ, + RTW_WLAN_ACTION_FT_RSP, + RTW_WLAN_ACTION_FT_CONF, RTW_WLAN_ACTION_FT_ACK, RTW_WLAN_ACTION_FT_MAX, }; #endif +#ifdef CONFIG_RTW_WNM +enum rtw_ieee80211_wnm_actioncode { + RTW_WLAN_ACTION_WNM_BTM_QUERY = 6, + RTW_WLAN_ACTION_WNM_BTM_REQ = 7, + RTW_WLAN_ACTION_WNM_BTM_RSP = 8, +}; +#endif + #define OUI_MICROSOFT 0x0050f2 /* Microsoft (also used in Wi-Fi specs) * 00:50:F2 */ #ifndef PLATFORM_FREEBSD /* Baron BSD has defined */ @@ -1685,6 +1700,55 @@ enum rtw_ieee80211_ft_actioncode { #define VENDOR_HT_CAPAB_OUI_TYPE 0x33 /* 00-90-4c:0x33 */ +enum rtw_ieee80211_rann_flags { + RTW_RANN_FLAG_IS_GATE = 1 << 0, +}; + +/** + * enum rtw_ieee80211_preq_flags - mesh PREQ element flags + * + * @RTW_IEEE80211_PREQ_IS_GATE_FLAG: Gate Announcement subfield + * @RTW_IEEE80211_PREQ_PROACTIVE_PREP_FLAG: proactive PREP subfield + */ +enum rtw_ieee80211_preq_flags { + RTW_IEEE80211_PREQ_IS_GATE_FLAG = 1 << 0, + RTW_IEEE80211_PREQ_PROACTIVE_PREP_FLAG = 1 << 2, +}; + +/** + * enum rtw_ieee80211_preq_target_flags - mesh PREQ element per target flags + * + * @RTW_IEEE80211_PREQ_TO_FLAG: target only subfield + * @RTW_IEEE80211_PREQ_USN_FLAG: unknown target HWMP sequence number subfield + */ +enum rtw_ieee80211_preq_target_flags { + RTW_IEEE80211_PREQ_TO_FLAG = 1<<0, + RTW_IEEE80211_PREQ_USN_FLAG = 1<<2, +}; + +/** + * enum rtw_ieee80211_root_mode_identifier - root mesh STA mode identifier + * + * These attribute are used by dot11MeshHWMPRootMode to set root mesh STA mode + * + * @RTW_IEEE80211_ROOTMODE_NO_ROOT: the mesh STA is not a root mesh STA (default) + * @RTW_IEEE80211_ROOTMODE_ROOT: the mesh STA is a root mesh STA if greater than + * this value + * @RTW_IEEE80211_PROACTIVE_PREQ_NO_PREP: the mesh STA is a root mesh STA supports + * the proactive PREQ with proactive PREP subfield set to 0 + * @RTW_IEEE80211_PROACTIVE_PREQ_WITH_PREP: the mesh STA is a root mesh STA + * supports the proactive PREQ with proactive PREP subfield set to 1 + * @RTW_IEEE80211_PROACTIVE_RANN: the mesh STA is a root mesh STA supports + * the proactive RANN + */ +enum rtw_ieee80211_root_mode_identifier { + RTW_IEEE80211_ROOTMODE_NO_ROOT = 0, + RTW_IEEE80211_ROOTMODE_ROOT = 1, + RTW_IEEE80211_PROACTIVE_PREQ_NO_PREP = 2, + RTW_IEEE80211_PROACTIVE_PREQ_WITH_PREP = 3, + RTW_IEEE80211_PROACTIVE_RANN = 4, +}; + /** * enum rtw_ieee80211_channel_flags - channel flags * @@ -1807,6 +1871,18 @@ 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; +#ifdef CONFIG_RTW_MESH + u8 *preq; + u8 preq_len; + u8 *prep; + u8 prep_len; + u8 *perr; + u8 perr_len; + u8 *rann; + u8 rann_len; +#endif }; typedef enum { ParseOK = 0, ParseUnknown = 1, ParseFailed = -1 } ParseRes; @@ -1816,7 +1892,7 @@ ParseRes rtw_ieee802_11_parse_elems(u8 *start, uint len, int show_errors); u8 *rtw_set_fixed_ie(unsigned char *pbuf, unsigned int len, unsigned char *source, unsigned int *frlen); -u8 *rtw_set_ie(u8 *pbuf, sint index, uint len, u8 *source, uint *frlen); +u8 *rtw_set_ie(u8 *pbuf, sint index, uint len, const u8 *source, uint *frlen); enum secondary_ch_offset { SCN = 0, /* no secondary channel */ @@ -1829,25 +1905,49 @@ u8 *rtw_set_ie_ch_switch(u8 *buf, u32 *buf_len, u8 ch_switch_mode, u8 new_ch, u8 u8 *rtw_set_ie_secondary_ch_offset(u8 *buf, u32 *buf_len, u8 secondary_ch_offset); u8 *rtw_set_ie_mesh_ch_switch_parm(u8 *buf, u32 *buf_len, u8 ttl, u8 flags, u16 reason, u16 precedence); -u8 *rtw_get_ie(u8 *pbuf, sint index, sint *len, sint limit); -u8 *rtw_get_ie_ex(u8 *in_ie, uint in_len, u8 eid, u8 *oui, u8 oui_len, u8 *ie, uint *ielen); +u8 *rtw_get_ie(const u8 *pbuf, sint index, sint *len, sint limit); +u8 rtw_update_rate_bymode(WLAN_BSSID_EX *pbss_network, u32 mode); + +u8 *rtw_get_ie_ex(const u8 *in_ie, uint in_len, u8 eid, const u8 *oui, u8 oui_len, u8 *ie, uint *ielen); int rtw_ies_remove_ie(u8 *ies, uint *ies_len, uint offset, u8 eid, u8 *oui, u8 oui_len); void rtw_set_supported_rate(u8 *SupportedRates, uint mode) ; +#define GET_RSN_CAP_MFP_OPTION(cap) LE_BITS_TO_2BYTE(((u8 *)(cap)), 6, 2) + +#define MFP_NO 0 +#define MFP_INVALID 1 +#define MFP_OPTIONAL 2 +#define MFP_REQUIRED 3 + +struct rsne_info { + u8 *gcs; + u16 pcs_cnt; + u8 *pcs_list; + u16 akm_cnt; + u8 *akm_list; + u8 *cap; + u16 pmkid_cnt; + u8 *pmkid_list; + u8 *gmcs; + + u8 err; +}; +int rtw_rsne_info_parse(const u8 *ie, uint ie_len, struct rsne_info *info); + unsigned char *rtw_get_wpa_ie(unsigned char *pie, int *wpa_ie_len, int limit); unsigned char *rtw_get_wpa2_ie(unsigned char *pie, int *rsn_ie_len, int limit); int rtw_get_wpa_cipher_suite(u8 *s); int rtw_get_wpa2_cipher_suite(u8 *s); int rtw_get_wapi_ie(u8 *in_ie, uint in_len, u8 *wapi_ie, u16 *wapi_len); -int rtw_parse_wpa_ie(u8 *wpa_ie, int wpa_ie_len, int *group_cipher, int *pairwise_cipher, int *is_8021x); -int rtw_parse_wpa2_ie(u8 *wpa_ie, int wpa_ie_len, int *group_cipher, int *pairwise_cipher, int *is_8021x); +int rtw_parse_wpa_ie(u8 *wpa_ie, int wpa_ie_len, int *group_cipher, int *pairwise_cipher, u32 *akm); +int rtw_parse_wpa2_ie(u8 *wpa_ie, int wpa_ie_len, int *group_cipher, int *pairwise_cipher, u32 *akm, u8 *mfp_opt); 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(u8 *in_ie, uint in_len, u8 *wps_ie, uint *wps_ielen); +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(const 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); @@ -1860,17 +1960,21 @@ u8 *rtw_get_wps_attr_content(u8 *wps_ie, uint wps_ielen, u16 target_attr_id , u8 #define for_each_ie(ie, buf, buf_len) \ for (ie = (void *)buf; (((u8 *)ie) - ((u8 *)buf) + 1) < buf_len; ie = (void *)(((u8 *)ie) + *(((u8 *)ie)+1) + 2)) -void dump_ies(void *sel, u8 *buf, u32 buf_len); +void dump_ies(void *sel, const u8 *buf, u32 buf_len); #ifdef CONFIG_80211N_HT -void dump_ht_cap_ie_content(void *sel, u8 *buf, u32 buf_len); +#define HT_SC_OFFSET_MAX 4 +extern const char *const _ht_sc_offset_str[]; +#define ht_sc_offset_str(sc) (((sc) >= HT_SC_OFFSET_MAX) ? _ht_sc_offset_str[2] : _ht_sc_offset_str[(sc)]) + +void dump_ht_cap_ie_content(void *sel, const u8 *buf, u32 buf_len); #endif -void dump_wps_ie(void *sel, u8 *ie, u32 ie_len); +void dump_wps_ie(void *sel, const u8 *ie, u32 ie_len); -void rtw_ies_get_chbw(u8 *ies, int ies_len, u8 *ch, u8 *bw, u8 *offset); +void rtw_ies_get_chbw(u8 *ies, int ies_len, u8 *ch, u8 *bw, u8 *offset, u8 ht, u8 vht); -void rtw_bss_get_chbw(WLAN_BSSID_EX *bss, u8 *ch, u8 *bw, u8 *offset); +void rtw_bss_get_chbw(WLAN_BSSID_EX *bss, u8 *ch, u8 *bw, u8 *offset, u8 ht, u8 vht); bool rtw_is_chbw_grouped(u8 ch_a, u8 bw_a, u8 offset_a , u8 ch_b, u8 bw_b, u8 offset_b); @@ -1879,8 +1983,8 @@ void rtw_sync_chbw(u8 *req_ch, u8 *req_bw, u8 *req_offset u32 rtw_get_p2p_merged_ies_len(u8 *in_ie, u32 in_len); int rtw_p2p_merge_ies(u8 *in_ie, u32 in_len, u8 *merge_ie); -void dump_p2p_ie(void *sel, u8 *ie, u32 ie_len); -u8 *rtw_get_p2p_ie(u8 *in_ie, int in_len, u8 *p2p_ie, uint *p2p_ielen); +void dump_p2p_ie(void *sel, const u8 *ie, u32 ie_len); +u8 *rtw_get_p2p_ie(const u8 *in_ie, int in_len, u8 *p2p_ie, uint *p2p_ielen); u8 *rtw_get_p2p_attr(u8 *p2p_ie, uint p2p_ielen, u8 target_attr_id, u8 *buf_attr, u32 *len_attr); u8 *rtw_get_p2p_attr_content(u8 *p2p_ie, uint p2p_ielen, u8 target_attr_id, u8 *buf_content, uint *len_content); u32 rtw_set_p2p_attr_content(u8 *pbuf, u8 attr_id, u16 attr_len, u8 *pdata_attr); @@ -1890,8 +1994,8 @@ u8 *rtw_bss_ex_get_p2p_ie(WLAN_BSSID_EX *bss_ex, u8 *p2p_ie, uint *p2p_ielen); void rtw_bss_ex_del_p2p_ie(WLAN_BSSID_EX *bss_ex); void rtw_bss_ex_del_p2p_attr(WLAN_BSSID_EX *bss_ex, u8 attr_id); -void dump_wfd_ie(void *sel, u8 *ie, u32 ie_len); -u8 *rtw_get_wfd_ie(u8 *in_ie, int in_len, u8 *wfd_ie, uint *wfd_ielen); +void dump_wfd_ie(void *sel, const u8 *ie, u32 ie_len); +u8 *rtw_get_wfd_ie(const u8 *in_ie, int in_len, u8 *wfd_ie, uint *wfd_ielen); u8 *rtw_get_wfd_attr(u8 *wfd_ie, uint wfd_ielen, u8 target_attr_id, u8 *buf_attr, u32 *len_attr); u8 *rtw_get_wfd_attr_content(u8 *wfd_ie, uint wfd_ielen, u8 target_attr_id, u8 *buf_content, uint *len_content); uint rtw_del_wfd_ie(u8 *ies, uint ies_len_ori, const char *msg); @@ -1910,7 +2014,7 @@ int rtw_get_bit_value_from_ieee_value(u8 val); uint rtw_is_cckrates_included(u8 *rate); uint rtw_is_cckratesonly_included(u8 *rate); - +uint rtw_get_cckrate_size(u8 *rate,u32 rate_length); int rtw_check_network_type(unsigned char *rate, int ratelen, int channel); void rtw_get_bcn_info(struct wlan_network *pnetwork); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/ieee80211_ext.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/ieee80211_ext.h index 03cc33058e8a..c17a2ee66504 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/ieee80211_ext.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/ieee80211_ext.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 @@ -105,27 +101,6 @@ struct wme_parameter_element { #endif -#ifdef PLATFORM_WINDOWS - -#pragma pack(1) - -struct wpa_ie_hdr { - u8 elem_id; - u8 len; - u8 oui[4]; /* 24-bit OUI followed by 8-bit OUI type */ - u8 version[2]; /* little endian */ -}; - -struct rsn_ie_hdr { - u8 elem_id; /* WLAN_EID_RSN */ - u8 len; - u8 version[2]; /* little endian */ -}; - -#pragma pack() - -#endif - #define WPA_PUT_LE16(a, val) \ do { \ (a)[1] = ((u16) (val)) >> 8; \ @@ -330,144 +305,6 @@ struct ieee80211_mgmt { #endif - -#ifdef PLATFORM_WINDOWS - -#pragma pack(1) - -struct ieee80211_mgmt { - u16 frame_control; - u16 duration; - u8 da[6]; - u8 sa[6]; - u8 bssid[6]; - u16 seq_ctrl; - union { - struct { - u16 auth_alg; - u16 auth_transaction; - u16 status_code; - /* possibly followed by Challenge text */ - u8 variable[0]; - } auth; - struct { - u16 reason_code; - } deauth; - struct { - u16 capab_info; - u16 listen_interval; - /* followed by SSID and Supported rates */ - u8 variable[0]; - } assoc_req; - struct { - u16 capab_info; - u16 status_code; - u16 aid; - /* followed by Supported rates */ - u8 variable[0]; - } assoc_resp, reassoc_resp; - struct { - u16 capab_info; - u16 listen_interval; - u8 current_ap[6]; - /* followed by SSID and Supported rates */ - u8 variable[0]; - } reassoc_req; - struct { - u16 reason_code; - } disassoc; -#if 0 - struct { - __le64 timestamp; - u16 beacon_int; - u16 capab_info; - /* followed by some of SSID, Supported rates, - * FH Params, DS Params, CF Params, IBSS Params, TIM */ - u8 variable[0]; - } beacon; - struct { - /* only variable items: SSID, Supported rates */ - u8 variable[0]; - } probe_req; - - struct { - __le64 timestamp; - u16 beacon_int; - u16 capab_info; - /* followed by some of SSID, Supported rates, - * FH Params, DS Params, CF Params, IBSS Params */ - u8 variable[0]; - } probe_resp; -#endif - struct { - u8 category; - union { - struct { - u8 action_code; - u8 dialog_token; - u8 status_code; - u8 variable[0]; - } wme_action; - #if 0 - struct{ - u8 action_code; - u8 element_id; - u8 length; - struct ieee80211_channel_sw_ie sw_elem; - } chan_switch; - struct{ - u8 action_code; - u8 dialog_token; - u8 element_id; - u8 length; - struct ieee80211_msrment_ie msr_elem; - } measurement; - #endif - struct { - u8 action_code; - u8 dialog_token; - u16 capab; - u16 timeout; - u16 start_seq_num; - } addba_req; - struct { - u8 action_code; - u8 dialog_token; - u16 status; - u16 capab; - u16 timeout; - } addba_resp; - struct { - u8 action_code; - u16 params; - u16 reason_code; - } delba; - struct { - u8 action_code; - /* capab_info for open and confirm, - * reason for close - */ - u16 aux; - /* Followed in plink_confirm by status - * code, AID and supported rates, - * and directly by supported rates in - * plink_open and plink_close - */ - u8 variable[0]; - } plink_action; - struct { - u8 action_code; - u8 variable[0]; - } mesh_action; - } u; - } action; - } u; -} ; - -#pragma pack() - -#endif - /* mgmt header + 1 byte category code */ #define IEEE80211_MIN_ACTION_SIZE FIELD_OFFSET(struct ieee80211_mgmt, u.action.u) diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/if_ether.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/if_ether.h index 9d08f560d98b..335233b55272 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/if_ether.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/if_ether.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/ip.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/ip.h index c78034df92ad..339e23d50d1d 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/ip.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/ip.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/linux/wireless.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/linux/wireless.h index b4bb716115ab..acaa37384089 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/linux/wireless.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/linux/wireless.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/mlme_osdep.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/mlme_osdep.h index 8dcc589101eb..29b8426c59ac 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/mlme_osdep.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/mlme_osdep.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,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 __MLME_OSDEP_H_ #define __MLME_OSDEP_H_ - -#if defined(PLATFORM_WINDOWS) || defined(PLATFORM_MPIXEL) - extern int time_after(u32 now, u32 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/rtl8188eu/include/mp_custom_oid.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/mp_custom_oid.h deleted file mode 100644 index 7ca76ad2e65f..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/mp_custom_oid.h +++ /dev/null @@ -1,353 +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 __CUSTOM_OID_H -#define __CUSTOM_OID_H - -/* by Owen - * 0xFF818000 - 0xFF81802F RTL8180 Mass Production Kit - * 0xFF818500 - 0xFF81850F RTL8185 Setup Utility - * 0xFF818580 - 0xFF81858F RTL8185 Phy Status Utility */ - -/* */ - -/* by Owen for Production Kit - * For Production Kit with Agilent Equipments - * in order to make our custom oids hopefully somewhat unique - * we will use 0xFF (indicating implementation specific OID) - * 81(first byte of non zero Realtek unique identifier) - * 80 (second byte of non zero Realtek unique identifier) - * XX (the custom OID number - providing 255 possible custom oids) */ - -#define OID_RT_PRO_RESET_DUT 0xFF818000 -#define OID_RT_PRO_SET_DATA_RATE 0xFF818001 -#define OID_RT_PRO_START_TEST 0xFF818002 -#define OID_RT_PRO_STOP_TEST 0xFF818003 -#define OID_RT_PRO_SET_PREAMBLE 0xFF818004 -#define OID_RT_PRO_SET_SCRAMBLER 0xFF818005 -#define OID_RT_PRO_SET_FILTER_BB 0xFF818006 -#define OID_RT_PRO_SET_MANUAL_DIVERSITY_BB 0xFF818007 -#define OID_RT_PRO_SET_CHANNEL_DIRECT_CALL 0xFF818008 -#define OID_RT_PRO_SET_SLEEP_MODE_DIRECT_CALL 0xFF818009 -#define OID_RT_PRO_SET_WAKE_MODE_DIRECT_CALL 0xFF81800A - -#define OID_RT_PRO_SET_TX_ANTENNA_BB 0xFF81800D -#define OID_RT_PRO_SET_ANTENNA_BB 0xFF81800E -#define OID_RT_PRO_SET_CR_SCRAMBLER 0xFF81800F -#define OID_RT_PRO_SET_CR_NEW_FILTER 0xFF818010 -#define OID_RT_PRO_SET_TX_POWER_CONTROL 0xFF818011 -#define OID_RT_PRO_SET_CR_TX_CONFIG 0xFF818012 -#define OID_RT_PRO_GET_TX_POWER_CONTROL 0xFF818013 -#define OID_RT_PRO_GET_CR_SIGNAL_QUALITY 0xFF818014 -#define OID_RT_PRO_SET_CR_SETPOINT 0xFF818015 -#define OID_RT_PRO_SET_INTEGRATOR 0xFF818016 -#define OID_RT_PRO_SET_SIGNAL_QUALITY 0xFF818017 -#define OID_RT_PRO_GET_INTEGRATOR 0xFF818018 -#define OID_RT_PRO_GET_SIGNAL_QUALITY 0xFF818019 -#define OID_RT_PRO_QUERY_EEPROM_TYPE 0xFF81801A -#define OID_RT_PRO_WRITE_MAC_ADDRESS 0xFF81801B -#define OID_RT_PRO_READ_MAC_ADDRESS 0xFF81801C -#define OID_RT_PRO_WRITE_CIS_DATA 0xFF81801D -#define OID_RT_PRO_READ_CIS_DATA 0xFF81801E -#define OID_RT_PRO_WRITE_POWER_CONTROL 0xFF81801F -#define OID_RT_PRO_READ_POWER_CONTROL 0xFF818020 -#define OID_RT_PRO_WRITE_EEPROM 0xFF818021 -#define OID_RT_PRO_READ_EEPROM 0xFF818022 -#define OID_RT_PRO_RESET_TX_PACKET_SENT 0xFF818023 -#define OID_RT_PRO_QUERY_TX_PACKET_SENT 0xFF818024 -#define OID_RT_PRO_RESET_RX_PACKET_RECEIVED 0xFF818025 -#define OID_RT_PRO_QUERY_RX_PACKET_RECEIVED 0xFF818026 -#define OID_RT_PRO_QUERY_RX_PACKET_CRC32_ERROR 0xFF818027 -#define OID_RT_PRO_QUERY_CURRENT_ADDRESS 0xFF818028 -#define OID_RT_PRO_QUERY_PERMANENT_ADDRESS 0xFF818029 -#define OID_RT_PRO_SET_PHILIPS_RF_PARAMETERS 0xFF81802A -#define OID_RT_PRO_RECEIVE_PACKET 0xFF81802C -/* added by Owen on 04/08/03 for Cameo's request */ -#define OID_RT_PRO_WRITE_EEPROM_BYTE 0xFF81802D -#define OID_RT_PRO_READ_EEPROM_BYTE 0xFF81802E -#define OID_RT_PRO_SET_MODULATION 0xFF81802F -/* */ - -/* Sean */ -#define OID_RT_DRIVER_OPTION 0xFF818080 -#define OID_RT_RF_OFF 0xFF818081 -#define OID_RT_AUTH_STATUS 0xFF818082 - -/* ************************************************************************ */ -#define OID_RT_PRO_SET_CONTINUOUS_TX 0xFF81800B -#define OID_RT_PRO_SET_SINGLE_CARRIER_TX 0xFF81800C -#define OID_RT_PRO_SET_CARRIER_SUPPRESSION_TX 0xFF81802B -#define OID_RT_PRO_SET_SINGLE_TONE_TX 0xFF818043 -/* ************************************************************************ */ - - -/* by Owen for RTL8185 Phy Status Report Utility */ -#define OID_RT_UTILITY_FALSE_ALARM_COUNTERS 0xFF818580 -#define OID_RT_UTILITY_SELECT_DEBUG_MODE 0xFF818581 -#define OID_RT_UTILITY_SELECT_SUBCARRIER_NUMBER 0xFF818582 -#define OID_RT_UTILITY_GET_RSSI_STATUS 0xFF818583 -#define OID_RT_UTILITY_GET_FRAME_DETECTION_STATUS 0xFF818584 -#define OID_RT_UTILITY_GET_AGC_AND_FREQUENCY_OFFSET_ESTIMATION_STATUS 0xFF818585 -#define OID_RT_UTILITY_GET_CHANNEL_ESTIMATION_STATUS 0xFF818586 -/* */ - -/* by Owen on 03/09/19-03/09/22 for RTL8185 */ -#define OID_RT_WIRELESS_MODE 0xFF818500 -#define OID_RT_SUPPORTED_RATES 0xFF818501 -#define OID_RT_DESIRED_RATES 0xFF818502 -#define OID_RT_WIRELESS_MODE_STARTING_ADHOC 0xFF818503 -/* */ - -#define OID_RT_GET_CONNECT_STATE 0xFF030001 -#define OID_RT_RESCAN 0xFF030002 -#define OID_RT_SET_KEY_LENGTH 0xFF030003 -#define OID_RT_SET_DEFAULT_KEY_ID 0xFF030004 - -#define OID_RT_SET_CHANNEL 0xFF010182 -#define OID_RT_SET_SNIFFER_MODE 0xFF010183 -#define OID_RT_GET_SIGNAL_QUALITY 0xFF010184 -#define OID_RT_GET_SMALL_PACKET_CRC 0xFF010185 -#define OID_RT_GET_MIDDLE_PACKET_CRC 0xFF010186 -#define OID_RT_GET_LARGE_PACKET_CRC 0xFF010187 -#define OID_RT_GET_TX_RETRY 0xFF010188 -#define OID_RT_GET_RX_RETRY 0xFF010189 -#define OID_RT_PRO_SET_FW_DIG_STATE 0xFF01018A/* S */ -#define OID_RT_PRO_SET_FW_RA_STATE 0xFF01018B/* S */ - -#define OID_RT_GET_RX_TOTAL_PACKET 0xFF010190 -#define OID_RT_GET_TX_BEACON_OK 0xFF010191 -#define OID_RT_GET_TX_BEACON_ERR 0xFF010192 -#define OID_RT_GET_RX_ICV_ERR 0xFF010193 -#define OID_RT_SET_ENCRYPTION_ALGORITHM 0xFF010194 -#define OID_RT_SET_NO_AUTO_RESCAN 0xFF010195 -#define OID_RT_GET_PREAMBLE_MODE 0xFF010196 -#define OID_RT_GET_DRIVER_UP_DELTA_TIME 0xFF010197 -#define OID_RT_GET_AP_IP 0xFF010198 -#define OID_RT_GET_CHANNELPLAN 0xFF010199 -#define OID_RT_SET_PREAMBLE_MODE 0xFF01019A -#define OID_RT_SET_BCN_INTVL 0xFF01019B -#define OID_RT_GET_RF_VENDER 0xFF01019C -#define OID_RT_DEDICATE_PROBE 0xFF01019D -#define OID_RT_PRO_RX_FILTER_PATTERN 0xFF01019E - -#define OID_RT_GET_DCST_CURRENT_THRESHOLD 0xFF01019F - -#define OID_RT_GET_CCA_ERR 0xFF0101A0 -#define OID_RT_GET_CCA_UPGRADE_THRESHOLD 0xFF0101A1 -#define OID_RT_GET_CCA_FALLBACK_THRESHOLD 0xFF0101A2 - -#define OID_RT_GET_CCA_UPGRADE_EVALUATE_TIMES 0xFF0101A3 -#define OID_RT_GET_CCA_FALLBACK_EVALUATE_TIMES 0xFF0101A4 - -/* by Owen on 03/31/03 for Cameo's request */ -#define OID_RT_SET_RATE_ADAPTIVE 0xFF0101A5 -/* */ -#define OID_RT_GET_DCST_EVALUATE_PERIOD 0xFF0101A5 -#define OID_RT_GET_DCST_TIME_UNIT_INDEX 0xFF0101A6 -#define OID_RT_GET_TOTAL_TX_BYTES 0xFF0101A7 -#define OID_RT_GET_TOTAL_RX_BYTES 0xFF0101A8 -#define OID_RT_CURRENT_TX_POWER_LEVEL 0xFF0101A9 -#define OID_RT_GET_ENC_KEY_MISMATCH_COUNT 0xFF0101AA -#define OID_RT_GET_ENC_KEY_MATCH_COUNT 0xFF0101AB -#define OID_RT_GET_CHANNEL 0xFF0101AC - -#define OID_RT_SET_CHANNELPLAN 0xFF0101AD -#define OID_RT_GET_HARDWARE_RADIO_OFF 0xFF0101AE -#define OID_RT_CHANNELPLAN_BY_COUNTRY 0xFF0101AF -#define OID_RT_SCAN_AVAILABLE_BSSID 0xFF0101B0 -#define OID_RT_GET_HARDWARE_VERSION 0xFF0101B1 -#define OID_RT_GET_IS_ROAMING 0xFF0101B2 -#define OID_RT_GET_IS_PRIVACY 0xFF0101B3 -#define OID_RT_GET_KEY_MISMATCH 0xFF0101B4 -#define OID_RT_SET_RSSI_ROAM_TRAFFIC_TH 0xFF0101B5 -#define OID_RT_SET_RSSI_ROAM_SIGNAL_TH 0xFF0101B6 -#define OID_RT_RESET_LOG 0xFF0101B7 -#define OID_RT_GET_LOG 0xFF0101B8 -#define OID_RT_SET_INDICATE_HIDDEN_AP 0xFF0101B9 -#define OID_RT_GET_HEADER_FAIL 0xFF0101BA -#define OID_RT_SUPPORTED_WIRELESS_MODE 0xFF0101BB -#define OID_RT_GET_CHANNEL_LIST 0xFF0101BC -#define OID_RT_GET_SCAN_IN_PROGRESS 0xFF0101BD -#define OID_RT_GET_TX_INFO 0xFF0101BE -#define OID_RT_RF_READ_WRITE_OFFSET 0xFF0101BF -#define OID_RT_RF_READ_WRITE 0xFF0101C0 - -/* For Netgear request. 2005.01.13, by rcnjko. */ -#define OID_RT_FORCED_DATA_RATE 0xFF0101C1 -#define OID_RT_WIRELESS_MODE_FOR_SCAN_LIST 0xFF0101C2 -/* For Netgear request. 2005.02.17, by rcnjko. */ -#define OID_RT_GET_BSS_WIRELESS_MODE 0xFF0101C3 -/* For AZ project. 2005.06.27, by rcnjko. */ -#define OID_RT_SCAN_WITH_MAGIC_PACKET 0xFF0101C4 - -/* Vincent 8185MP */ -#define OID_RT_PRO_RX_FILTER 0xFF0111C0 - -/* Andy TEST - * #define OID_RT_PRO_WRITE_REGISTRY 0xFF0111C1 - * #define OID_RT_PRO_READ_REGISTRY 0xFF0111C2 */ -#define OID_CE_USB_WRITE_REGISTRY 0xFF0111C1 -#define OID_CE_USB_READ_REGISTRY 0xFF0111C2 - - -#define OID_RT_PRO_SET_INITIAL_GAIN 0xFF0111C3 -#define OID_RT_PRO_SET_BB_RF_STANDBY_MODE 0xFF0111C4 -#define OID_RT_PRO_SET_BB_RF_SHUTDOWN_MODE 0xFF0111C5 -#define OID_RT_PRO_SET_TX_CHARGE_PUMP 0xFF0111C6 -#define OID_RT_PRO_SET_RX_CHARGE_PUMP 0xFF0111C7 -#define OID_RT_PRO_RF_WRITE_REGISTRY 0xFF0111C8 -#define OID_RT_PRO_RF_READ_REGISTRY 0xFF0111C9 -#define OID_RT_PRO_QUERY_RF_TYPE 0xFF0111CA - -/* AP OID */ -#define OID_RT_AP_GET_ASSOCIATED_STATION_LIST 0xFF010300 -#define OID_RT_AP_GET_CURRENT_TIME_STAMP 0xFF010301 -#define OID_RT_AP_SWITCH_INTO_AP_MODE 0xFF010302 -#define OID_RT_AP_SET_DTIM_PERIOD 0xFF010303 -#define OID_RT_AP_SUPPORTED 0xFF010304 /* Determine if driver supports AP mode. 2004.08.27, by rcnjko. */ -#define OID_RT_AP_SET_PASSPHRASE 0xFF010305 /* Set WPA-PSK passphrase into authenticator. 2005.07.08, byrcnjko. */ - -/* 8187MP. 2004.09.06, by rcnjko. */ -#define OID_RT_PRO8187_WI_POLL 0xFF818780 -#define OID_RT_PRO_WRITE_BB_REG 0xFF818781 -#define OID_RT_PRO_READ_BB_REG 0xFF818782 -#define OID_RT_PRO_WRITE_RF_REG 0xFF818783 -#define OID_RT_PRO_READ_RF_REG 0xFF818784 - -/* Meeting House. added by Annie, 2005-07-20. */ -#define OID_RT_MH_VENDER_ID 0xFFEDC100 - -/* 8711 MP OID added 20051230. */ -#define OID_RT_PRO8711_JOIN_BSS 0xFF871100/* S */ - -#define OID_RT_PRO_READ_REGISTER 0xFF871101 /* Q */ -#define OID_RT_PRO_WRITE_REGISTER 0xFF871102 /* S */ - -#define OID_RT_PRO_BURST_READ_REGISTER 0xFF871103 /* Q */ -#define OID_RT_PRO_BURST_WRITE_REGISTER 0xFF871104 /* S */ - -#define OID_RT_PRO_WRITE_TXCMD 0xFF871105 /* S */ - -#define OID_RT_PRO_READ16_EEPROM 0xFF871106 /* Q */ -#define OID_RT_PRO_WRITE16_EEPROM 0xFF871107 /* S */ - -#define OID_RT_PRO_H2C_SET_COMMAND 0xFF871108 /* S */ -#define OID_RT_PRO_H2C_QUERY_RESULT 0xFF871109 /* Q */ - -#define OID_RT_PRO8711_WI_POLL 0xFF87110A /* Q */ -#define OID_RT_PRO8711_PKT_LOSS 0xFF87110B /* Q */ -#define OID_RT_RD_ATTRIB_MEM 0xFF87110C/* Q */ -#define OID_RT_WR_ATTRIB_MEM 0xFF87110D/* S */ - - -/* Method 2 for H2C/C2H */ -#define OID_RT_PRO_H2C_CMD_MODE 0xFF871110 /* S */ -#define OID_RT_PRO_H2C_CMD_RSP_MODE 0xFF871111 /* Q */ -#define OID_RT_PRO_H2C_CMD_EVENT_MODE 0xFF871112 /* S */ -#define OID_RT_PRO_WAIT_C2H_EVENT 0xFF871113 /* Q */ -#define OID_RT_PRO_RW_ACCESS_PROTOCOL_TEST 0xFF871114/* Q */ - -#define OID_RT_PRO_SCSI_ACCESS_TEST 0xFF871115 /* Q, S */ - -#define OID_RT_PRO_SCSI_TCPIPOFFLOAD_OUT 0xFF871116 /* S */ -#define OID_RT_PRO_SCSI_TCPIPOFFLOAD_IN 0xFF871117 /* Q, S */ -#define OID_RT_RRO_RX_PKT_VIA_IOCTRL 0xFF871118 /* Q */ -#define OID_RT_RRO_RX_PKTARRAY_VIA_IOCTRL 0xFF871119 /* Q */ - -#define OID_RT_RPO_SET_PWRMGT_TEST 0xFF87111A /* S */ -#define OID_RT_PRO_QRY_PWRMGT_TEST 0XFF87111B /* Q */ -#define OID_RT_RPO_ASYNC_RWIO_TEST 0xFF87111C /* S */ -#define OID_RT_RPO_ASYNC_RWIO_POLL 0xFF87111D /* Q */ -#define OID_RT_PRO_SET_RF_INTFS 0xFF87111E /* S */ -#define OID_RT_POLL_RX_STATUS 0xFF87111F /* Q */ - -#define OID_RT_PRO_CFG_DEBUG_MESSAGE 0xFF871120 /* Q, S */ -#define OID_RT_PRO_SET_DATA_RATE_EX 0xFF871121/* S */ -#define OID_RT_PRO_SET_BASIC_RATE 0xFF871122/* S */ -#define OID_RT_PRO_READ_TSSI 0xFF871123/* S */ -#define OID_RT_PRO_SET_POWER_TRACKING 0xFF871124/* S */ - - -#define OID_RT_PRO_QRY_PWRSTATE 0xFF871150 /* Q */ -#define OID_RT_PRO_SET_PWRSTATE 0xFF871151 /* S */ - -/* Method 2 , using workitem */ -#define OID_RT_SET_READ_REG 0xFF871181 /* S */ -#define OID_RT_SET_WRITE_REG 0xFF871182 /* S */ -#define OID_RT_SET_BURST_READ_REG 0xFF871183 /* S */ -#define OID_RT_SET_BURST_WRITE_REG 0xFF871184 /* S */ -#define OID_RT_SET_WRITE_TXCMD 0xFF871185 /* S */ -#define OID_RT_SET_READ16_EEPROM 0xFF871186 /* S */ -#define OID_RT_SET_WRITE16_EEPROM 0xFF871187 /* S */ -#define OID_RT_QRY_POLL_WKITEM 0xFF871188 /* Q */ - -/* For SDIO INTERFACE only */ -#define OID_RT_PRO_SYNCPAGERW_SRAM 0xFF8711A0 /* Q, S */ -#define OID_RT_PRO_871X_DRV_EXT 0xFF8711A1 - -/* For USB INTERFACE only */ -#define OID_RT_PRO_USB_VENDOR_REQ 0xFF8711B0 /* Q, S */ -#define OID_RT_PRO_SCSI_AUTO_TEST 0xFF8711B1 /* S */ -#define OID_RT_PRO_USB_MAC_AC_FIFO_WRITE 0xFF8711B2 /* S */ -#define OID_RT_PRO_USB_MAC_RX_FIFO_READ 0xFF8711B3 /* Q */ -#define OID_RT_PRO_USB_MAC_RX_FIFO_POLLING 0xFF8711B4 /* Q */ - -#define OID_RT_PRO_H2C_SET_RATE_TABLE 0xFF8711FB /* S */ -#define OID_RT_PRO_H2C_GET_RATE_TABLE 0xFF8711FC /* S */ -#define OID_RT_PRO_H2C_C2H_LBK_TEST 0xFF8711FE - -#define OID_RT_PRO_ENCRYPTION_CTRL 0xFF871200 /* Q, S */ -#define OID_RT_PRO_ADD_STA_INFO 0xFF871201 /* S */ -#define OID_RT_PRO_DELE_STA_INFO 0xFF871202 /* S */ -#define OID_RT_PRO_QUERY_DR_VARIABLE 0xFF871203 /* Q */ - -#define OID_RT_PRO_RX_PACKET_TYPE 0xFF871204 /* Q, S */ - -#define OID_RT_PRO_READ_EFUSE 0xFF871205 /* Q */ -#define OID_RT_PRO_WRITE_EFUSE 0xFF871206 /* S */ -#define OID_RT_PRO_RW_EFUSE_PGPKT 0xFF871207 /* Q, S */ -#define OID_RT_GET_EFUSE_CURRENT_SIZE 0xFF871208 /* Q */ - -#define OID_RT_SET_BANDWIDTH 0xFF871209 /* S */ -#define OID_RT_SET_CRYSTAL_CAP 0xFF87120A /* S */ - -#define OID_RT_SET_RX_PACKET_TYPE 0xFF87120B /* S */ - -#define OID_RT_GET_EFUSE_MAX_SIZE 0xFF87120C /* Q */ - -#define OID_RT_PRO_SET_TX_AGC_OFFSET 0xFF87120D /* S */ - -#define OID_RT_PRO_SET_PKT_TEST_MODE 0xFF87120E /* S */ - -#define OID_RT_PRO_FOR_EVM_TEST_SETTING 0xFF87120F /* S */ - -#define OID_RT_PRO_GET_THERMAL_METER 0xFF871210 /* Q */ - -#define OID_RT_RESET_PHY_RX_PACKET_COUNT 0xFF871211 /* S */ -#define OID_RT_GET_PHY_RX_PACKET_RECEIVED 0xFF871212 /* Q */ -#define OID_RT_GET_PHY_RX_PACKET_CRC32_ERROR 0xFF871213 /* Q */ - -#define OID_RT_SET_POWER_DOWN 0xFF871214 /* S */ - -#define OID_RT_GET_POWER_MODE 0xFF871215 /* Q */ - -#define OID_RT_PRO_EFUSE 0xFF871216 /* Q, S */ -#define OID_RT_PRO_EFUSE_MAP 0xFF871217 /* Q, S */ - -#endif /* #ifndef __CUSTOM_OID_H */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/nic_spec.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/nic_spec.h index c0a952fd5065..5e66f6c82b3b 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/nic_spec.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/nic_spec.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/osdep_intf.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/osdep_intf.h index 6d5e9f3557d9..293977cb7d39 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/osdep_intf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/osdep_intf.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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_ @@ -62,34 +58,8 @@ struct intf_priv { #endif #endif -#ifdef PLATFORM_OS_XP -#ifdef CONFIG_SDIO_HCI - /* below is for io_rwmem... */ - PMDL pmdl; - PSDBUS_REQUEST_PACKET sdrp; - PSDBUS_REQUEST_PACKET recv_sdrp; - PSDBUS_REQUEST_PACKET xmit_sdrp; - - PIRP piorw_irp; - -#endif -#ifdef CONFIG_USB_HCI - PURB piorw_urb; - PIRP piorw_irp; - u8 io_irp_cnt; - u8 bio_irp_pending; - _sema io_retevt; -#endif -#endif - }; - -#ifdef CONFIG_R871X_TEST - int rtw_start_pseudo_adhoc(_adapter *padapter); - int rtw_stop_pseudo_adhoc(_adapter *padapter); -#endif - struct dvobj_priv *devobj_init(void); void devobj_deinit(struct dvobj_priv *pdvobj); @@ -127,6 +97,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" @@ -160,9 +132,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/rtl8188eu/include/osdep_service.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/osdep_service.h index bc329f992aa1..dc3dc64f94f6 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/osdep_service.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/osdep_service.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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_ @@ -28,6 +24,10 @@ #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_ALREADY 8 +#define RTW_RA_RESOLVING 9 +#define RTW_BMC_NO_NEED 10 /* #define RTW_STATUS_TIMEDOUT -110 */ @@ -43,26 +43,33 @@ #endif #ifdef PLATFORM_LINUX + #include +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 11, 0)) + #include + #include +#endif #include + #include #endif #ifdef PLATFORM_OS_XP #include + #include #endif #ifdef PLATFORM_OS_CE #include + #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 #define BIT(x) (1 << (x)) #endif +#define CHECK_BIT(a, b) (!!((a) & (b))) + #define BIT0 0x00000001 #define BIT1 0x00000002 #define BIT2 0x00000004 @@ -139,12 +146,13 @@ typedef enum mstat_status { #ifdef DBG_MEM_ALLOC void rtw_mstat_update(const enum mstat_f flags, const MSTAT_STATUS status, u32 sz); void rtw_mstat_dump(void *sel); -u8 *dbg_rtw_vmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line); -u8 *dbg_rtw_zvmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line); -void dbg_rtw_vmfree(u8 *pbuf, const enum mstat_f flags, u32 sz, const char *func, const int line); -u8 *dbg_rtw_malloc(u32 sz, const enum mstat_f flags, const char *func, const int line); -u8 *dbg_rtw_zmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line); -void dbg_rtw_mfree(u8 *pbuf, const enum mstat_f flags, u32 sz, const char *func, const int line); +bool match_mstat_sniff_rules(const enum mstat_f flags, const size_t size); +void *dbg_rtw_vmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line); +void *dbg_rtw_zvmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line); +void dbg_rtw_vmfree(void *pbuf, const enum mstat_f flags, u32 sz, const char *func, const int line); +void *dbg_rtw_malloc(u32 sz, const enum mstat_f flags, const char *func, const int line); +void *dbg_rtw_zmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line); +void dbg_rtw_mfree(void *pbuf, const enum mstat_f flags, u32 sz, const char *func, const int line); struct sk_buff *dbg_rtw_skb_alloc(unsigned int size, const enum mstat_f flags, const char *func, const int line); void dbg_rtw_skb_free(struct sk_buff *skb, const enum mstat_f flags, const char *func, const int line); @@ -211,12 +219,13 @@ void dbg_rtw_usb_buffer_free(struct usb_device *dev, size_t size, void *addr, dm #else /* DBG_MEM_ALLOC */ #define rtw_mstat_update(flag, status, sz) do {} while (0) #define rtw_mstat_dump(sel) do {} while (0) -u8 *_rtw_vmalloc(u32 sz); -u8 *_rtw_zvmalloc(u32 sz); -void _rtw_vmfree(u8 *pbuf, u32 sz); -u8 *_rtw_zmalloc(u32 sz); -u8 *_rtw_malloc(u32 sz); -void _rtw_mfree(u8 *pbuf, u32 sz); +#define match_mstat_sniff_rules(flags, size) _FALSE +void *_rtw_vmalloc(u32 sz); +void *_rtw_zvmalloc(u32 sz); +void _rtw_vmfree(void *pbuf, u32 sz); +void *_rtw_zmalloc(u32 sz); +void *_rtw_malloc(u32 sz); +void _rtw_mfree(void *pbuf, u32 sz); struct sk_buff *_rtw_skb_alloc(u32 sz); void _rtw_skb_free(struct sk_buff *skb); @@ -285,6 +294,11 @@ 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); +_pkt *rtw_os_pkt_copy(_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); @@ -294,10 +308,20 @@ extern void _rtw_init_listhead(_list *list); extern u32 rtw_is_list_empty(_list *phead); extern void rtw_list_insert_head(_list *plist, _list *phead); extern void rtw_list_insert_tail(_list *plist, _list *phead); +void rtw_list_splice(_list *list, _list *head); +void rtw_list_splice_init(_list *list, _list *head); +void rtw_list_splice_tail(_list *list, _list *head); + #ifndef PLATFORM_FREEBSD extern void rtw_list_delete(_list *plist); #endif /* PLATFORM_FREEBSD */ +void rtw_hlist_head_init(rtw_hlist_head *h); +void rtw_hlist_add_head(rtw_hlist_node *n, rtw_hlist_head *h); +void rtw_hlist_del(rtw_hlist_node *n); +void rtw_hlist_add_head_rcu(rtw_hlist_node *n, rtw_hlist_head *h); +void rtw_hlist_del_rcu(rtw_hlist_node *n); + extern void _rtw_init_sema(_sema *sema, int init_val); extern void _rtw_free_sema(_sema *sema); extern void _rtw_up_sema(_sema *sema); @@ -318,11 +342,36 @@ 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 systime _rtw_us_to_systime(u32 us); +extern s32 _rtw_get_passing_time_ms(systime start); +extern s32 _rtw_get_remaining_time_ms(systime end); +extern s32 _rtw_get_time_interval_ms(systime start, systime end); +extern bool _rtw_time_after(systime a, systime b); + +#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_us_to_systime(us) ({systime __stime = _rtw_us_to_systime(us); __stime;}) +#define rtw_get_passing_time_ms(start) ({u32 __ms = _rtw_get_passing_time_ms(start); typecheck(systime, start); __ms;}) +#define rtw_get_remaining_time_ms(end) ({u32 __ms = _rtw_get_remaining_time_ms(end); typecheck(systime, end); __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;}) +#define rtw_time_after(a,b) ({bool __r = _rtw_time_after(a,b); typecheck(systime, a); typecheck(systime, b); __r;}) +#define rtw_time_before(a,b) ({bool __r = _rtw_time_after(b, a); typecheck(systime, a); typecheck(systime, b); __r;}) +#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_us_to_systime(us) _rtw_us_to_systime(us) +#define rtw_get_passing_time_ms(start) _rtw_get_passing_time_ms(start) +#define rtw_get_remaining_time_ms(end) _rtw_get_remaining_time_ms(end) +#define rtw_get_time_interval_ms(start, end) _rtw_get_time_interval_ms(start, end) +#define rtw_time_after(a,b) _rtw_time_after(a,b) +#define rtw_time_before(a,b) _rtw_time_after(b,a) +#endif extern void rtw_sleep_schedulable(int ms); @@ -344,39 +393,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) { @@ -434,6 +498,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) @@ -515,6 +584,7 @@ static inline int largest_bit(u32 bitmask) return i; } +#define rtw_abs(a) (a < 0 ? -a : a) #define rtw_min(a, b) ((a > b) ? b : a) #define rtw_is_range_a_in_b(hi_a, lo_a, hi_b, lo_b) (((hi_a) <= (hi_b)) && ((lo_a) >= (lo_b))) #define rtw_is_range_overlap(hi_a, lo_a, hi_b, lo_b) (((hi_a) > (lo_b)) && ((lo_a) < (hi_b))) @@ -526,16 +596,14 @@ static inline int largest_bit(u32 bitmask) #define MAC_ARG(x) ((u8 *)(x))[0], ((u8 *)(x))[1], ((u8 *)(x))[2], ((u8 *)(x))[3], ((u8 *)(x))[4], ((u8 *)(x))[5] #endif +bool rtw_macaddr_is_larger(const u8 *a, const u8 *b); extern void rtw_suspend_lock_init(void); extern void rtw_suspend_lock_uninit(void); extern void rtw_lock_suspend(void); extern void rtw_unlock_suspend(void); extern void rtw_lock_suspend_timeout(u32 timeout_ms); -extern void rtw_lock_ext_suspend_timeout(u32 timeout_ms); -extern void rtw_lock_rx_suspend_timeout(u32 timeout_ms); extern void rtw_lock_traffic_suspend_timeout(u32 timeout_ms); -extern void rtw_lock_resume_scan_timeout(u32 timeout_ms); extern void rtw_resume_lock_suspend(void); extern void rtw_resume_unlock_suspend(void); #ifdef CONFIG_AP_WOWLAN @@ -543,6 +611,10 @@ extern void rtw_softap_lock_suspend(void); extern void rtw_softap_unlock_suspend(void); #endif +extern void rtw_set_bit(int nr, unsigned long *addr); +extern void rtw_clear_bit(int nr, unsigned long *addr); +extern int rtw_test_and_clear_bit(int nr, unsigned long *addr); + extern void ATOMIC_SET(ATOMIC_T *v, int i); extern int ATOMIC_READ(ATOMIC_T *v); extern void ATOMIC_ADD(ATOMIC_T *v, int i); @@ -553,10 +625,12 @@ extern int ATOMIC_ADD_RETURN(ATOMIC_T *v, int i); extern int ATOMIC_SUB_RETURN(ATOMIC_T *v, int i); extern int ATOMIC_INC_RETURN(ATOMIC_T *v); extern int ATOMIC_DEC_RETURN(ATOMIC_T *v); +extern bool ATOMIC_INC_UNLESS(ATOMIC_T *v, int u); /* File operation APIs, just for linux now */ extern int rtw_is_file_readable(const char *path); extern int rtw_is_file_readable_with_size(const char *path, u32 *sz); +extern int rtw_readable_file_sz_chk(const char *path, u32 sz); extern int rtw_retrieve_from_file(const char *path, u8 *buf, u32 sz); extern int rtw_store_to_file(const char *path, u8 *buf, u32 sz); @@ -635,6 +709,17 @@ extern u32 rtw_random32(void); (((u64) (a)[5]) << 40) | (((u64) (a)[4]) << 32) | \ (((u64) (a)[3]) << 24) | (((u64) (a)[2]) << 16) | \ (((u64) (a)[1]) << 8) | ((u64) (a)[0])) +#define RTW_PUT_LE64(a, val) \ + do { \ + (a)[7] = (u8) ((((u64) (val)) >> 56) & 0xff); \ + (a)[6] = (u8) ((((u64) (val)) >> 48) & 0xff); \ + (a)[5] = (u8) ((((u64) (val)) >> 40) & 0xff); \ + (a)[4] = (u8) ((((u64) (val)) >> 32) & 0xff); \ + (a)[3] = (u8) ((((u64) (val)) >> 24) & 0xff); \ + (a)[2] = (u8) ((((u64) (val)) >> 16) & 0xff); \ + (a)[1] = (u8) ((((u64) (val)) >> 8) & 0xff); \ + (a)[0] = (u8) (((u64) (val)) & 0xff); \ + } while (0) void rtw_buf_free(u8 **buf, u32 *buf_len); void rtw_buf_update(u8 **buf, u32 *buf_len, u8 *src, u32 src_len); @@ -678,15 +763,32 @@ struct map_t { int map_readN(const struct map_t *map, u16 offset, u16 len, u8 *buf); u8 map_read8(const struct map_t *map, u16 offset); +struct blacklist_ent { + _list list; + u8 addr[ETH_ALEN]; + systime exp_time; +}; + +int rtw_blacklist_add(_queue *blist, const u8 *addr, u32 timeout_ms); +int rtw_blacklist_del(_queue *blist, const u8 *addr); +int rtw_blacklist_search(_queue *blist, const u8 *addr); +void rtw_blacklist_flush(_queue *blist); +void dump_blacklist(void *sel, _queue *blist, const char *title); + /* 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); BOOLEAN is_alpha(char chTmp); char alpha_to_upper(char c); +int hex2num_i(char c); +int hex2byte_i(const char *hex); +int hexstr2bin(const char *hex, u8 *buf, size_t len); + /* * Write formatted output to sized buffer */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/osdep_service_bsd.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/osdep_service_bsd.h index b56ccbb2b0f1..79eef3e731bb 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/osdep_service_bsd.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/osdep_service_bsd.h @@ -1,749 +1,758 @@ -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ -#ifndef __OSDEP_BSD_SERVICE_H_ -#define __OSDEP_BSD_SERVICE_H_ - - -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include - -#include -#include -#include -#include -#include -#include -#include -#include - - -#include -#include -#include -#include -#include - -#include -#include -#include -#include - -#include -#include -#include "usbdevs.h" - -#define USB_DEBUG_VAR rum_debug -#include - -#if 1 //Baron porting from linux, it's all temp solution, needs to check again -#include -#include /* XXX for PCPU_GET */ -// typedef struct semaphore _sema; - typedef struct sema _sema; -// typedef spinlock_t _lock; - typedef struct mtx _lock; - typedef struct mtx _mutex; - typedef struct timer_list _timer; - struct list_head { - struct list_head *next, *prev; - }; - struct __queue { - struct list_head queue; - _lock lock; - }; - - //typedef struct sk_buff _pkt; - typedef struct mbuf _pkt; - typedef struct mbuf _buffer; - - typedef struct __queue _queue; - typedef struct list_head _list; - typedef int _OS_STATUS; - //typedef u32 _irqL; - typedef unsigned long _irqL; - typedef struct ifnet * _nic_hdl; - - typedef pid_t _thread_hdl_; -// typedef struct thread _thread_hdl_; - 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; - -#define KERNEL_VERSION(a,b,c) (((a) << 16) + ((b) << 8) + (c)) -/* emulate a modern version */ -#define LINUX_VERSION_CODE KERNEL_VERSION(2, 6, 35) - -#define WIRELESS_EXT -1 -#define HZ hz -#define spin_lock_irqsave mtx_lock_irqsave -#define spin_lock_bh mtx_lock_irqsave -#define mtx_lock_irqsave(lock, x) mtx_lock(lock)//{local_irq_save((x)); mtx_lock_spin((lock));} -//#define IFT_RTW 0xf9 //ifnet allocate type for RTW -#define free_netdev if_free -#define LIST_CONTAINOR(ptr, type, member) \ - ((type *)((char *)(ptr)-(SIZE_T)(&((type *)0)->member))) -#define container_of(p,t,n) (t*)((p)-&(((t*)0)->n)) -/* - * Linux timers are emulated using FreeBSD callout functions - * (and taskqueue functionality). - * - * Currently no timer stats functionality. - * - * See (linux_compat) processes.c - * - */ -struct timer_list { - - /* 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); -/* Values for the state of an item of work (work_struct) */ -typedef enum work_state { - WORK_STATE_UNSET = 0, - WORK_STATE_CALLOUT_PENDING = 1, - WORK_STATE_TASK_PENDING = 2, - WORK_STATE_WORK_CANCELLED = 3 -} work_state_t; - -struct work_struct { - struct task task; /* FreeBSD task */ - work_state_t state; /* the pending or otherwise state of work. */ - work_func_t func; -}; -#define spin_unlock_irqrestore mtx_unlock_irqrestore -#define spin_unlock_bh mtx_unlock_irqrestore -#define mtx_unlock_irqrestore(lock,x) mtx_unlock(lock); -extern void _rtw_spinlock_init(_lock *plock); - -//modify private structure to match freebsd -#define BITS_PER_LONG 32 -union ktime { - s64 tv64; -#if BITS_PER_LONG != 64 && !defined(CONFIG_KTIME_SCALAR) - struct { -#ifdef __BIG_ENDIAN - s32 sec, nsec; -#else - s32 nsec, sec; -#endif - } tv; -#endif -}; -#define kmemcheck_bitfield_begin(name) -#define kmemcheck_bitfield_end(name) -#define CHECKSUM_NONE 0 -typedef unsigned char *sk_buff_data_t; -typedef union ktime ktime_t; /* Kill this */ - -void rtw_mtx_lock(_lock *plock); - -void rtw_mtx_unlock(_lock *plock); - -/** - * struct sk_buff - socket buffer - * @next: Next buffer in list - * @prev: Previous buffer in list - * @sk: Socket we are owned by - * @tstamp: Time we arrived - * @dev: Device we arrived on/are leaving by - * @transport_header: Transport layer header - * @network_header: Network layer header - * @mac_header: Link layer header - * @_skb_refdst: destination entry (with norefcount bit) - * @sp: the security path, used for xfrm - * @cb: Control buffer. Free for use by every layer. Put private vars here - * @len: Length of actual data - * @data_len: Data length - * @mac_len: Length of link layer header - * @hdr_len: writable header length of cloned skb - * @csum: Checksum (must include start/offset pair) - * @csum_start: Offset from skb->head where checksumming should start - * @csum_offset: Offset from csum_start where checksum should be stored - * @local_df: allow local fragmentation - * @cloned: Head may be cloned (check refcnt to be sure) - * @nohdr: Payload reference only, must not modify header - * @pkt_type: Packet class - * @fclone: skbuff clone status - * @ip_summed: Driver fed us an IP checksum - * @priority: Packet queueing priority - * @users: User count - see {datagram,tcp}.c - * @protocol: Packet protocol from driver - * @truesize: Buffer size - * @head: Head of buffer - * @data: Data head pointer - * @tail: Tail pointer - * @end: End pointer - * @destructor: Destruct function - * @mark: Generic packet mark - * @nfct: Associated connection, if any - * @ipvs_property: skbuff is owned by ipvs - * @peeked: this packet has been seen already, so stats have been - * done for it, don't do them again - * @nf_trace: netfilter packet trace flag - * @nfctinfo: Relationship of this skb to the connection - * @nfct_reasm: netfilter conntrack re-assembly pointer - * @nf_bridge: Saved data about a bridged frame - see br_netfilter.c - * @skb_iif: ifindex of device we arrived on - * @rxhash: the packet hash computed on receive - * @queue_mapping: Queue mapping for multiqueue devices - * @tc_index: Traffic control index - * @tc_verd: traffic control verdict - * @ndisc_nodetype: router type (from link layer) - * @dma_cookie: a cookie to one of several possible DMA operations - * done by skb DMA functions - * @secmark: security marking - * @vlan_tci: vlan tag control information - */ - -struct sk_buff { - /* These two members must be first. */ - struct sk_buff *next; - struct sk_buff *prev; - - ktime_t tstamp; - - struct sock *sk; - //struct net_device *dev; - struct ifnet *dev; - - /* - * This is the control buffer. It is free to use for every - * layer. Please put your private variables there. If you - * want to keep them across layers you have to do a skb_clone() - * first. This is owned by whoever has the skb queued ATM. - */ - char cb[48] __aligned(8); - - unsigned long _skb_refdst; -#ifdef CONFIG_XFRM - struct sec_path *sp; -#endif - unsigned int len, - data_len; - u16 mac_len, - hdr_len; - union { - u32 csum; - struct { - u16 csum_start; - u16 csum_offset; - }smbol2; - }smbol1; - u32 priority; - kmemcheck_bitfield_begin(flags1); - u8 local_df:1, - cloned:1, - ip_summed:2, - nohdr:1, - nfctinfo:3; - u8 pkt_type:3, - fclone:2, - ipvs_property:1, - peeked:1, - nf_trace:1; - kmemcheck_bitfield_end(flags1); - u16 protocol; - - void (*destructor)(struct sk_buff *skb); -#if defined(CONFIG_NF_CONNTRACK) || defined(CONFIG_NF_CONNTRACK_MODULE) - struct nf_conntrack *nfct; - struct sk_buff *nfct_reasm; -#endif -#ifdef CONFIG_BRIDGE_NETFILTER - struct nf_bridge_info *nf_bridge; -#endif - - int skb_iif; -#ifdef CONFIG_NET_SCHED - u16 tc_index; /* traffic control index */ -#ifdef CONFIG_NET_CLS_ACT - u16 tc_verd; /* traffic control verdict */ -#endif -#endif - - u32 rxhash; - - kmemcheck_bitfield_begin(flags2); - u16 queue_mapping:16; -#ifdef CONFIG_IPV6_NDISC_NODETYPE - u8 ndisc_nodetype:2, - deliver_no_wcard:1; -#else - u8 deliver_no_wcard:1; -#endif - kmemcheck_bitfield_end(flags2); - - /* 0/14 bit hole */ - -#ifdef CONFIG_NET_DMA - dma_cookie_t dma_cookie; -#endif -#ifdef CONFIG_NETWORK_SECMARK - u32 secmark; -#endif - union { - u32 mark; - u32 dropcount; - }symbol3; - - u16 vlan_tci; - - sk_buff_data_t transport_header; - sk_buff_data_t network_header; - sk_buff_data_t mac_header; - /* These elements must be at the end, see alloc_skb() for details. */ - sk_buff_data_t tail; - sk_buff_data_t end; - unsigned char *head, - *data; - unsigned int truesize; - atomic_t users; -}; -struct sk_buff_head { - /* These two members must be first. */ - struct sk_buff *next; - struct sk_buff *prev; - - u32 qlen; - _lock lock; -}; -#define skb_tail_pointer(skb) skb->tail -static inline unsigned char *skb_put(struct sk_buff *skb, unsigned int len) -{ - unsigned char *tmp = skb_tail_pointer(skb); - //SKB_LINEAR_ASSERT(skb); - skb->tail += len; - skb->len += len; - return tmp; -} - -static inline unsigned char *__skb_pull(struct sk_buff *skb, unsigned int len) -{ - skb->len -= len; - if(skb->len < skb->data_len) - printf("%s(),%d,error!\n",__FUNCTION__,__LINE__); - return skb->data += len; -} -static inline unsigned char *skb_pull(struct sk_buff *skb, unsigned int len) -{ - #ifdef PLATFORM_FREEBSD - return __skb_pull(skb, len); - #else - return unlikely(len > skb->len) ? NULL : __skb_pull(skb, len); - #endif //PLATFORM_FREEBSD -} -static inline u32 skb_queue_len(const struct sk_buff_head *list_) -{ - return list_->qlen; -} -static inline void __skb_insert(struct sk_buff *newsk, - struct sk_buff *prev, struct sk_buff *next, - struct sk_buff_head *list) -{ - newsk->next = next; - newsk->prev = prev; - next->prev = prev->next = newsk; - list->qlen++; -} -static inline void __skb_queue_before(struct sk_buff_head *list, - struct sk_buff *next, - struct sk_buff *newsk) -{ - __skb_insert(newsk, next->prev, next, list); -} -static inline void skb_queue_tail(struct sk_buff_head *list, - struct sk_buff *newsk) -{ - mtx_lock(&list->lock); - __skb_queue_before(list, (struct sk_buff *)list, newsk); - mtx_unlock(&list->lock); -} -static inline struct sk_buff *skb_peek(struct sk_buff_head *list_) -{ - struct sk_buff *list = ((struct sk_buff *)list_)->next; - if (list == (struct sk_buff *)list_) - list = NULL; - return list; -} -static inline void __skb_unlink(struct sk_buff *skb, struct sk_buff_head *list) -{ - struct sk_buff *next, *prev; - - list->qlen--; - next = skb->next; - prev = skb->prev; - skb->next = skb->prev = NULL; - next->prev = prev; - prev->next = next; -} - -static inline struct sk_buff *skb_dequeue(struct sk_buff_head *list) -{ - mtx_lock(&list->lock); - - struct sk_buff *skb = skb_peek(list); - if (skb) - __skb_unlink(skb, list); - - mtx_unlock(&list->lock); - - return skb; -} -static inline void skb_reserve(struct sk_buff *skb, int len) -{ - skb->data += len; - skb->tail += len; -} -static inline void __skb_queue_head_init(struct sk_buff_head *list) -{ - list->prev = list->next = (struct sk_buff *)list; - list->qlen = 0; -} -/* - * This function creates a split out lock class for each invocation; - * this is needed for now since a whole lot of users of the skb-queue - * infrastructure in drivers have different locking usage (in hardirq) - * than the networking core (in softirq only). In the long run either the - * network layer or drivers should need annotation to consolidate the - * main types of usage into 3 classes. - */ -static inline void skb_queue_head_init(struct sk_buff_head *list) -{ - _rtw_spinlock_init(&list->lock); - __skb_queue_head_init(list); -} -unsigned long copy_from_user(void *to, const void *from, unsigned long n); -unsigned long copy_to_user(void *to, const void *from, unsigned long n); -struct sk_buff * dev_alloc_skb(unsigned int size); -struct sk_buff *skb_clone(const struct sk_buff *skb); -void dev_kfree_skb_any(struct sk_buff *skb); -#endif //Baron porting from linux, it's all temp solution, needs to check again - - -#if 1 // kenny add Linux compatibility code for Linux USB driver -#include - -#define __init // __attribute ((constructor)) -#define __exit // __attribute ((destructor)) - -/* - * Definitions for module_init and module_exit macros. - * - * These macros will use the SYSINIT framework to call a specified - * function (with no arguments) on module loading or unloading. - * - */ - -void module_init_exit_wrapper(void *arg); - -#define module_init(initfn) \ - SYSINIT(mod_init_ ## initfn, \ - SI_SUB_KLD, SI_ORDER_FIRST, \ - module_init_exit_wrapper, initfn) - -#define module_exit(exitfn) \ - SYSUNINIT(mod_exit_ ## exitfn, \ - SI_SUB_KLD, SI_ORDER_ANY, \ - module_init_exit_wrapper, exitfn) - -/* - * The usb_register and usb_deregister functions are used to register - * usb drivers with the usb subsystem. - */ -int usb_register(struct usb_driver *driver); -int usb_deregister(struct usb_driver *driver); - -/* - * usb_get_dev and usb_put_dev - increment/decrement the reference count - * of the usb device structure. - * - * Original body of usb_get_dev: - * - * if (dev) - * get_device(&dev->dev); - * return dev; - * - * Reference counts are not currently used in this compatibility - * layer. So these functions will do nothing. - */ -static inline struct usb_device * -usb_get_dev(struct usb_device *dev) -{ - return dev; -} - -static inline void -usb_put_dev(struct usb_device *dev) -{ - return; -} - - -// rtw_usb_compat_linux -int rtw_usb_submit_urb(struct urb *urb, uint16_t mem_flags); -int rtw_usb_unlink_urb(struct urb *urb); -int rtw_usb_clear_halt(struct usb_device *dev, struct usb_host_endpoint *uhe); -int rtw_usb_control_msg(struct usb_device *dev, struct usb_host_endpoint *uhe, - uint8_t request, uint8_t requesttype, - uint16_t value, uint16_t index, void *data, - uint16_t size, usb_timeout_t timeout); -int rtw_usb_set_interface(struct usb_device *dev, uint8_t iface_no, uint8_t alt_index); -int rtw_usb_setup_endpoint(struct usb_device *dev, - struct usb_host_endpoint *uhe, usb_size_t bufsize); -struct urb *rtw_usb_alloc_urb(uint16_t iso_packets, uint16_t mem_flags); -struct usb_host_endpoint *rtw_usb_find_host_endpoint(struct usb_device *dev, uint8_t type, uint8_t ep); -struct usb_host_interface *rtw_usb_altnum_to_altsetting(const struct usb_interface *intf, uint8_t alt_index); -struct usb_interface *rtw_usb_ifnum_to_if(struct usb_device *dev, uint8_t iface_no); -void *rtw_usbd_get_intfdata(struct usb_interface *intf); -void rtw_usb_linux_register(void *arg); -void rtw_usb_linux_deregister(void *arg); -void rtw_usb_linux_free_device(struct usb_device *dev); -void rtw_usb_free_urb(struct urb *urb); -void rtw_usb_init_urb(struct urb *urb); -void rtw_usb_kill_urb(struct urb *urb); -void rtw_usb_set_intfdata(struct usb_interface *intf, void *data); -void rtw_usb_fill_bulk_urb(struct urb *urb, struct usb_device *udev, - struct usb_host_endpoint *uhe, void *buf, - int length, usb_complete_t callback, void *arg); -int rtw_usb_bulk_msg(struct usb_device *udev, struct usb_host_endpoint *uhe, - void *data, int len, uint16_t *pactlen, usb_timeout_t timeout); -void *usb_get_intfdata(struct usb_interface *intf); -int usb_linux_init_endpoints(struct usb_device *udev); - - - -typedef struct urb * PURB; - -typedef unsigned gfp_t; -#define __GFP_WAIT ((gfp_t)0x10u) /* Can wait and reschedule? */ -#define __GFP_HIGH ((gfp_t)0x20u) /* Should access emergency pools? */ -#define __GFP_IO ((gfp_t)0x40u) /* Can start physical IO? */ -#define __GFP_FS ((gfp_t)0x80u) /* Can call down to low-level FS? */ -#define __GFP_COLD ((gfp_t)0x100u) /* Cache-cold page required */ -#define __GFP_NOWARN ((gfp_t)0x200u) /* Suppress page allocation failure warning */ -#define __GFP_REPEAT ((gfp_t)0x400u) /* Retry the allocation. Might fail */ -#define __GFP_NOFAIL ((gfp_t)0x800u) /* Retry for ever. Cannot fail */ -#define __GFP_NORETRY ((gfp_t)0x1000u)/* Do not retry. Might fail */ -#define __GFP_NO_GROW ((gfp_t)0x2000u)/* Slab internal usage */ -#define __GFP_COMP ((gfp_t)0x4000u)/* Add compound page metadata */ -#define __GFP_ZERO ((gfp_t)0x8000u)/* Return zeroed page on success */ -#define __GFP_NOMEMALLOC ((gfp_t)0x10000u) /* Don't use emergency reserves */ -#define __GFP_HARDWALL ((gfp_t)0x20000u) /* Enforce hardwall cpuset memory allocs */ - -/* This equals 0, but use constants in case they ever change */ -#define GFP_NOWAIT (GFP_ATOMIC & ~__GFP_HIGH) -/* GFP_ATOMIC means both !wait (__GFP_WAIT not set) and use emergency pool */ -#define GFP_ATOMIC (__GFP_HIGH) -#define GFP_NOIO (__GFP_WAIT) -#define GFP_NOFS (__GFP_WAIT | __GFP_IO) -#define GFP_KERNEL (__GFP_WAIT | __GFP_IO | __GFP_FS) -#define GFP_USER (__GFP_WAIT | __GFP_IO | __GFP_FS | __GFP_HARDWALL) -#define GFP_HIGHUSER (__GFP_WAIT | __GFP_IO | __GFP_FS | __GFP_HARDWALL | \ - __GFP_HIGHMEM) - - -#endif // kenny add Linux compatibility code for Linux USB - -__inline static _list *get_next(_list *list) -{ - return list->next; -} - -__inline static _list *get_list_head(_queue *queue) -{ - return (&(queue->queue)); -} - - -#define LIST_CONTAINOR(ptr, type, member) \ - ((type *)((char *)(ptr)-(SIZE_T)(&((type *)0)->member))) - - -__inline static void _enter_critical(_lock *plock, _irqL *pirqL) -{ - spin_lock_irqsave(plock, *pirqL); -} - -__inline static void _exit_critical(_lock *plock, _irqL *pirqL) -{ - spin_unlock_irqrestore(plock, *pirqL); -} - -__inline static void _enter_critical_ex(_lock *plock, _irqL *pirqL) -{ - spin_lock_irqsave(plock, *pirqL); -} - -__inline static void _exit_critical_ex(_lock *plock, _irqL *pirqL) -{ - spin_unlock_irqrestore(plock, *pirqL); -} - -__inline static void _enter_critical_bh(_lock *plock, _irqL *pirqL) -{ - spin_lock_bh(plock, *pirqL); -} - -__inline static void _exit_critical_bh(_lock *plock, _irqL *pirqL) -{ - spin_unlock_bh(plock, *pirqL); -} - -__inline static void _enter_critical_mutex(_mutex *pmutex, _irqL *pirqL) -{ - - mtx_lock(pmutex); - -} - - -__inline static void _exit_critical_mutex(_mutex *pmutex, _irqL *pirqL) -{ - - mtx_unlock(pmutex); - -} -static inline void __list_del(struct list_head * prev, struct list_head * next) -{ - next->prev = prev; - prev->next = next; -} -static inline void INIT_LIST_HEAD(struct list_head *list) -{ - list->next = list; - list->prev = list; -} -__inline static void rtw_list_delete(_list *plist) -{ - __list_del(plist->prev, plist->next); - 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); -} - -__inline static void _set_timer(_timer *ptimer,u32 delay_time) -{ - // mod_timer(ptimer , (jiffies+(delay_time*HZ/1000))); - if(ptimer->function && ptimer->arg){ - rtw_mtx_lock(NULL); - callout_reset(&ptimer->callout, delay_time,ptimer->function, ptimer->arg); - 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); -} - -__inline static void _init_workitem(_workitem *pwork, void *pfunc, PVOID cntx) -{ - printf("%s Not implement yet! \n",__FUNCTION__); -} - -__inline static void _set_workitem(_workitem *pwork) -{ - printf("%s Not implement yet! \n",__FUNCTION__); -// schedule_work(pwork); -} - -// -// Global Mutex: can only be used at PASSIVE level. -// - -#define ACQUIRE_GLOBAL_MUTEX(_MutexCounter) \ -{ \ -} - -#define RELEASE_GLOBAL_MUTEX(_MutexCounter) \ -{ \ -} - -#define ATOMIC_INIT(i) { (i) } - -static __inline void thread_enter(char *name); - -//Atomic integer operations -typedef uint32_t ATOMIC_T ; - -#define rtw_netdev_priv(netdev) (((struct ifnet *)netdev)->if_softc) - -#define rtw_free_netdev(netdev) if_free((netdev)) - -#define NDEV_FMT "%s" -#define NDEV_ARG(ndev) "" -#define ADPT_FMT "%s" -#define ADPT_ARG(adapter) "" -#define FUNC_NDEV_FMT "%s" -#define FUNC_NDEV_ARG(ndev) __func__ -#define FUNC_ADPT_FMT "%s" -#define FUNC_ADPT_ARG(adapter) __func__ - -#define STRUCT_PACKED - -#endif - +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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_ + + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include +#include +#include +#include +#include +#include +#include +#include + + +#include +#include +#include +#include +#include + +#include +#include +#include +#include + +#include +#include +#include "usbdevs.h" + +#define USB_DEBUG_VAR rum_debug +#include + +#if 1 //Baron porting from linux, it's all temp solution, needs to check again +#include +#include /* XXX for PCPU_GET */ +// typedef struct semaphore _sema; + typedef struct sema _sema; +// typedef spinlock_t _lock; + typedef struct mtx _lock; + typedef struct mtx _mutex; + typedef struct rtw_timer_list _timer; + struct list_head { + struct list_head *next, *prev; + }; + struct __queue { + struct list_head queue; + _lock lock; + }; + + typedef struct mbuf _pkt; + typedef struct mbuf _buffer; + + typedef struct __queue _queue; + typedef struct list_head _list; + typedef int _OS_STATUS; + //typedef u32 _irqL; + typedef unsigned long _irqL; + typedef struct ifnet * _nic_hdl; + + typedef pid_t _thread_hdl_; +// typedef struct thread _thread_hdl_; + typedef void thread_return; + typedef void* thread_context; + + typedef void timer_hdl_return; + typedef void* timer_hdl_context; + typedef struct work_struct _workitem; + typedef struct task _tasklet; + +#define KERNEL_VERSION(a,b,c) (((a) << 16) + ((b) << 8) + (c)) +/* emulate a modern version */ +#define LINUX_VERSION_CODE KERNEL_VERSION(2, 6, 35) + +#define WIRELESS_EXT -1 +#define HZ hz +#define spin_lock_irqsave mtx_lock_irqsave +#define spin_lock_bh mtx_lock_irqsave +#define mtx_lock_irqsave(lock, x) mtx_lock(lock)//{local_irq_save((x)); mtx_lock_spin((lock));} +//#define IFT_RTW 0xf9 //ifnet allocate type for RTW +#define free_netdev if_free +#define LIST_CONTAINOR(ptr, type, member) \ + ((type *)((char *)(ptr)-(SIZE_T)(&((type *)0)->member))) +#define container_of(p,t,n) (t*)((p)-&(((t*)0)->n)) +/* + * Linux timers are emulated using FreeBSD callout functions + * (and taskqueue functionality). + * + * Currently no timer stats functionality. + * + * See (linux_compat) processes.c + * + */ +struct rtw_timer_list { + struct callout callout; + void (*function)(void *); + void *arg; +}; + +struct workqueue_struct; +struct work_struct; +typedef void (*work_func_t)(struct work_struct *work); +/* Values for the state of an item of work (work_struct) */ +typedef enum work_state { + WORK_STATE_UNSET = 0, + WORK_STATE_CALLOUT_PENDING = 1, + WORK_STATE_TASK_PENDING = 2, + WORK_STATE_WORK_CANCELLED = 3 +} work_state_t; + +struct work_struct { + struct task task; /* FreeBSD task */ + work_state_t state; /* the pending or otherwise state of work. */ + work_func_t func; +}; +#define spin_unlock_irqrestore mtx_unlock_irqrestore +#define spin_unlock_bh mtx_unlock_irqrestore +#define mtx_unlock_irqrestore(lock,x) mtx_unlock(lock); +extern void _rtw_spinlock_init(_lock *plock); + +//modify private structure to match freebsd +#define BITS_PER_LONG 32 +union ktime { + s64 tv64; +#if BITS_PER_LONG != 64 && !defined(CONFIG_KTIME_SCALAR) + struct { +#ifdef __BIG_ENDIAN + s32 sec, nsec; +#else + s32 nsec, sec; +#endif + } tv; +#endif +}; +#define kmemcheck_bitfield_begin(name) +#define kmemcheck_bitfield_end(name) +#define CHECKSUM_NONE 0 +typedef unsigned char *sk_buff_data_t; +typedef union ktime ktime_t; /* Kill this */ + +void rtw_mtx_lock(_lock *plock); + +void rtw_mtx_unlock(_lock *plock); + +/** + * struct sk_buff - socket buffer + * @next: Next buffer in list + * @prev: Previous buffer in list + * @sk: Socket we are owned by + * @tstamp: Time we arrived + * @dev: Device we arrived on/are leaving by + * @transport_header: Transport layer header + * @network_header: Network layer header + * @mac_header: Link layer header + * @_skb_refdst: destination entry (with norefcount bit) + * @sp: the security path, used for xfrm + * @cb: Control buffer. Free for use by every layer. Put private vars here + * @len: Length of actual data + * @data_len: Data length + * @mac_len: Length of link layer header + * @hdr_len: writable header length of cloned skb + * @csum: Checksum (must include start/offset pair) + * @csum_start: Offset from skb->head where checksumming should start + * @csum_offset: Offset from csum_start where checksum should be stored + * @local_df: allow local fragmentation + * @cloned: Head may be cloned (check refcnt to be sure) + * @nohdr: Payload reference only, must not modify header + * @pkt_type: Packet class + * @fclone: skbuff clone status + * @ip_summed: Driver fed us an IP checksum + * @priority: Packet queueing priority + * @users: User count - see {datagram,tcp}.c + * @protocol: Packet protocol from driver + * @truesize: Buffer size + * @head: Head of buffer + * @data: Data head pointer + * @tail: Tail pointer + * @end: End pointer + * @destructor: Destruct function + * @mark: Generic packet mark + * @nfct: Associated connection, if any + * @ipvs_property: skbuff is owned by ipvs + * @peeked: this packet has been seen already, so stats have been + * done for it, don't do them again + * @nf_trace: netfilter packet trace flag + * @nfctinfo: Relationship of this skb to the connection + * @nfct_reasm: netfilter conntrack re-assembly pointer + * @nf_bridge: Saved data about a bridged frame - see br_netfilter.c + * @skb_iif: ifindex of device we arrived on + * @rxhash: the packet hash computed on receive + * @queue_mapping: Queue mapping for multiqueue devices + * @tc_index: Traffic control index + * @tc_verd: traffic control verdict + * @ndisc_nodetype: router type (from link layer) + * @dma_cookie: a cookie to one of several possible DMA operations + * done by skb DMA functions + * @secmark: security marking + * @vlan_tci: vlan tag control information + */ + +struct sk_buff { + /* These two members must be first. */ + struct sk_buff *next; + struct sk_buff *prev; + + ktime_t tstamp; + + struct sock *sk; + //struct net_device *dev; + struct ifnet *dev; + + /* + * This is the control buffer. It is free to use for every + * layer. Please put your private variables there. If you + * want to keep them across layers you have to do a skb_clone() + * first. This is owned by whoever has the skb queued ATM. + */ + char cb[48] __aligned(8); + + unsigned long _skb_refdst; +#ifdef CONFIG_XFRM + struct sec_path *sp; +#endif + unsigned int len, + data_len; + u16 mac_len, + hdr_len; + union { + u32 csum; + struct { + u16 csum_start; + u16 csum_offset; + }smbol2; + }smbol1; + u32 priority; + kmemcheck_bitfield_begin(flags1); + u8 local_df:1, + cloned:1, + ip_summed:2, + nohdr:1, + nfctinfo:3; + u8 pkt_type:3, + fclone:2, + ipvs_property:1, + peeked:1, + nf_trace:1; + kmemcheck_bitfield_end(flags1); + u16 protocol; + + void (*destructor)(struct sk_buff *skb); +#if defined(CONFIG_NF_CONNTRACK) || defined(CONFIG_NF_CONNTRACK_MODULE) + struct nf_conntrack *nfct; + struct sk_buff *nfct_reasm; +#endif +#ifdef CONFIG_BRIDGE_NETFILTER + struct nf_bridge_info *nf_bridge; +#endif + + int skb_iif; +#ifdef CONFIG_NET_SCHED + u16 tc_index; /* traffic control index */ +#ifdef CONFIG_NET_CLS_ACT + u16 tc_verd; /* traffic control verdict */ +#endif +#endif + + u32 rxhash; + + kmemcheck_bitfield_begin(flags2); + u16 queue_mapping:16; +#ifdef CONFIG_IPV6_NDISC_NODETYPE + u8 ndisc_nodetype:2, + deliver_no_wcard:1; +#else + u8 deliver_no_wcard:1; +#endif + kmemcheck_bitfield_end(flags2); + + /* 0/14 bit hole */ + +#ifdef CONFIG_NET_DMA + dma_cookie_t dma_cookie; +#endif +#ifdef CONFIG_NETWORK_SECMARK + u32 secmark; +#endif + union { + u32 mark; + u32 dropcount; + }symbol3; + + u16 vlan_tci; + + sk_buff_data_t transport_header; + sk_buff_data_t network_header; + sk_buff_data_t mac_header; + /* These elements must be at the end, see alloc_skb() for details. */ + sk_buff_data_t tail; + sk_buff_data_t end; + unsigned char *head, + *data; + unsigned int truesize; + atomic_t users; +}; +struct sk_buff_head { + /* These two members must be first. */ + struct sk_buff *next; + struct sk_buff *prev; + + u32 qlen; + _lock lock; +}; +#define skb_tail_pointer(skb) skb->tail +static inline unsigned char *skb_put(struct sk_buff *skb, unsigned int len) +{ + unsigned char *tmp = skb_tail_pointer(skb); + //SKB_LINEAR_ASSERT(skb); + skb->tail += len; + skb->len += len; + return tmp; +} + +static inline unsigned char *__skb_pull(struct sk_buff *skb, unsigned int len) +{ + skb->len -= len; + if(skb->len < skb->data_len) + printf("%s(),%d,error!\n",__FUNCTION__,__LINE__); + return skb->data += len; +} +static inline unsigned char *skb_pull(struct sk_buff *skb, unsigned int len) +{ + #ifdef PLATFORM_FREEBSD + return __skb_pull(skb, len); + #else + return unlikely(len > skb->len) ? NULL : __skb_pull(skb, len); + #endif //PLATFORM_FREEBSD +} +static inline u32 skb_queue_len(const struct sk_buff_head *list_) +{ + return list_->qlen; +} +static inline void __skb_insert(struct sk_buff *newsk, + struct sk_buff *prev, struct sk_buff *next, + struct sk_buff_head *list) +{ + newsk->next = next; + newsk->prev = prev; + next->prev = prev->next = newsk; + list->qlen++; +} +static inline void __skb_queue_before(struct sk_buff_head *list, + struct sk_buff *next, + struct sk_buff *newsk) +{ + __skb_insert(newsk, next->prev, next, list); +} +static inline void skb_queue_tail(struct sk_buff_head *list, + struct sk_buff *newsk) +{ + mtx_lock(&list->lock); + __skb_queue_before(list, (struct sk_buff *)list, newsk); + mtx_unlock(&list->lock); +} +static inline struct sk_buff *skb_peek(struct sk_buff_head *list_) +{ + struct sk_buff *list = ((struct sk_buff *)list_)->next; + if (list == (struct sk_buff *)list_) + list = NULL; + return list; +} +static inline void __skb_unlink(struct sk_buff *skb, struct sk_buff_head *list) +{ + struct sk_buff *next, *prev; + + list->qlen--; + next = skb->next; + prev = skb->prev; + skb->next = skb->prev = NULL; + next->prev = prev; + prev->next = next; +} + +static inline struct sk_buff *skb_dequeue(struct sk_buff_head *list) +{ + mtx_lock(&list->lock); + + struct sk_buff *skb = skb_peek(list); + if (skb) + __skb_unlink(skb, list); + + mtx_unlock(&list->lock); + + return skb; +} +static inline void skb_reserve(struct sk_buff *skb, int len) +{ + skb->data += len; + skb->tail += len; +} +static inline void __skb_queue_head_init(struct sk_buff_head *list) +{ + list->prev = list->next = (struct sk_buff *)list; + list->qlen = 0; +} +/* + * This function creates a split out lock class for each invocation; + * this is needed for now since a whole lot of users of the skb-queue + * infrastructure in drivers have different locking usage (in hardirq) + * than the networking core (in softirq only). In the long run either the + * network layer or drivers should need annotation to consolidate the + * main types of usage into 3 classes. + */ +static inline void skb_queue_head_init(struct sk_buff_head *list) +{ + _rtw_spinlock_init(&list->lock); + __skb_queue_head_init(list); +} +unsigned long copy_from_user(void *to, const void *from, unsigned long n); +unsigned long copy_to_user(void *to, const void *from, unsigned long n); +struct sk_buff * dev_alloc_skb(unsigned int size); +struct sk_buff *skb_clone(const struct sk_buff *skb); +void dev_kfree_skb_any(struct sk_buff *skb); +#endif //Baron porting from linux, it's all temp solution, needs to check again + + +#if 1 // kenny add Linux compatibility code for Linux USB driver +#include + +#define __init // __attribute ((constructor)) +#define __exit // __attribute ((destructor)) + +/* + * Definitions for module_init and module_exit macros. + * + * These macros will use the SYSINIT framework to call a specified + * function (with no arguments) on module loading or unloading. + * + */ + +void module_init_exit_wrapper(void *arg); + +#define module_init(initfn) \ + SYSINIT(mod_init_ ## initfn, \ + SI_SUB_KLD, SI_ORDER_FIRST, \ + module_init_exit_wrapper, initfn) + +#define module_exit(exitfn) \ + SYSUNINIT(mod_exit_ ## exitfn, \ + SI_SUB_KLD, SI_ORDER_ANY, \ + module_init_exit_wrapper, exitfn) + +/* + * The usb_register and usb_deregister functions are used to register + * usb drivers with the usb subsystem. + */ +int usb_register(struct usb_driver *driver); +int usb_deregister(struct usb_driver *driver); + +/* + * usb_get_dev and usb_put_dev - increment/decrement the reference count + * of the usb device structure. + * + * Original body of usb_get_dev: + * + * if (dev) + * get_device(&dev->dev); + * return dev; + * + * Reference counts are not currently used in this compatibility + * layer. So these functions will do nothing. + */ +static inline struct usb_device * +usb_get_dev(struct usb_device *dev) +{ + return dev; +} + +static inline void +usb_put_dev(struct usb_device *dev) +{ + return; +} + + +// rtw_usb_compat_linux +int rtw_usb_submit_urb(struct urb *urb, uint16_t mem_flags); +int rtw_usb_unlink_urb(struct urb *urb); +int rtw_usb_clear_halt(struct usb_device *dev, struct usb_host_endpoint *uhe); +int rtw_usb_control_msg(struct usb_device *dev, struct usb_host_endpoint *uhe, + uint8_t request, uint8_t requesttype, + uint16_t value, uint16_t index, void *data, + uint16_t size, usb_timeout_t timeout); +int rtw_usb_set_interface(struct usb_device *dev, uint8_t iface_no, uint8_t alt_index); +int rtw_usb_setup_endpoint(struct usb_device *dev, + struct usb_host_endpoint *uhe, usb_size_t bufsize); +struct urb *rtw_usb_alloc_urb(uint16_t iso_packets, uint16_t mem_flags); +struct usb_host_endpoint *rtw_usb_find_host_endpoint(struct usb_device *dev, uint8_t type, uint8_t ep); +struct usb_host_interface *rtw_usb_altnum_to_altsetting(const struct usb_interface *intf, uint8_t alt_index); +struct usb_interface *rtw_usb_ifnum_to_if(struct usb_device *dev, uint8_t iface_no); +void *rtw_usbd_get_intfdata(struct usb_interface *intf); +void rtw_usb_linux_register(void *arg); +void rtw_usb_linux_deregister(void *arg); +void rtw_usb_linux_free_device(struct usb_device *dev); +void rtw_usb_free_urb(struct urb *urb); +void rtw_usb_init_urb(struct urb *urb); +void rtw_usb_kill_urb(struct urb *urb); +void rtw_usb_set_intfdata(struct usb_interface *intf, void *data); +void rtw_usb_fill_bulk_urb(struct urb *urb, struct usb_device *udev, + struct usb_host_endpoint *uhe, void *buf, + int length, usb_complete_t callback, void *arg); +int rtw_usb_bulk_msg(struct usb_device *udev, struct usb_host_endpoint *uhe, + void *data, int len, uint16_t *pactlen, usb_timeout_t timeout); +void *usb_get_intfdata(struct usb_interface *intf); +int usb_linux_init_endpoints(struct usb_device *udev); + + + +typedef struct urb * PURB; + +typedef unsigned gfp_t; +#define __GFP_WAIT ((gfp_t)0x10u) /* Can wait and reschedule? */ +#define __GFP_HIGH ((gfp_t)0x20u) /* Should access emergency pools? */ +#define __GFP_IO ((gfp_t)0x40u) /* Can start physical IO? */ +#define __GFP_FS ((gfp_t)0x80u) /* Can call down to low-level FS? */ +#define __GFP_COLD ((gfp_t)0x100u) /* Cache-cold page required */ +#define __GFP_NOWARN ((gfp_t)0x200u) /* Suppress page allocation failure warning */ +#define __GFP_REPEAT ((gfp_t)0x400u) /* Retry the allocation. Might fail */ +#define __GFP_NOFAIL ((gfp_t)0x800u) /* Retry for ever. Cannot fail */ +#define __GFP_NORETRY ((gfp_t)0x1000u)/* Do not retry. Might fail */ +#define __GFP_NO_GROW ((gfp_t)0x2000u)/* Slab internal usage */ +#define __GFP_COMP ((gfp_t)0x4000u)/* Add compound page metadata */ +#define __GFP_ZERO ((gfp_t)0x8000u)/* Return zeroed page on success */ +#define __GFP_NOMEMALLOC ((gfp_t)0x10000u) /* Don't use emergency reserves */ +#define __GFP_HARDWALL ((gfp_t)0x20000u) /* Enforce hardwall cpuset memory allocs */ + +/* This equals 0, but use constants in case they ever change */ +#define GFP_NOWAIT (GFP_ATOMIC & ~__GFP_HIGH) +/* GFP_ATOMIC means both !wait (__GFP_WAIT not set) and use emergency pool */ +#define GFP_ATOMIC (__GFP_HIGH) +#define GFP_NOIO (__GFP_WAIT) +#define GFP_NOFS (__GFP_WAIT | __GFP_IO) +#define GFP_KERNEL (__GFP_WAIT | __GFP_IO | __GFP_FS) +#define GFP_USER (__GFP_WAIT | __GFP_IO | __GFP_FS | __GFP_HARDWALL) +#define GFP_HIGHUSER (__GFP_WAIT | __GFP_IO | __GFP_FS | __GFP_HARDWALL | \ + __GFP_HIGHMEM) + + +#endif // kenny add Linux compatibility code for Linux USB + +__inline static _list *get_next(_list *list) +{ + return list->next; +} + +__inline static _list *get_list_head(_queue *queue) +{ + return (&(queue->queue)); +} + + +#define LIST_CONTAINOR(ptr, type, member) \ + ((type *)((char *)(ptr)-(SIZE_T)(&((type *)0)->member))) + + +__inline static void _enter_critical(_lock *plock, _irqL *pirqL) +{ + spin_lock_irqsave(plock, *pirqL); +} + +__inline static void _exit_critical(_lock *plock, _irqL *pirqL) +{ + spin_unlock_irqrestore(plock, *pirqL); +} + +__inline static void _enter_critical_ex(_lock *plock, _irqL *pirqL) +{ + spin_lock_irqsave(plock, *pirqL); +} + +__inline static void _exit_critical_ex(_lock *plock, _irqL *pirqL) +{ + spin_unlock_irqrestore(plock, *pirqL); +} + +__inline static void _enter_critical_bh(_lock *plock, _irqL *pirqL) +{ + spin_lock_bh(plock, *pirqL); +} + +__inline static void _exit_critical_bh(_lock *plock, _irqL *pirqL) +{ + spin_unlock_bh(plock, *pirqL); +} + +__inline static void _enter_critical_mutex(_mutex *pmutex, _irqL *pirqL) +{ + + mtx_lock(pmutex); + +} + + +__inline static void _exit_critical_mutex(_mutex *pmutex, _irqL *pirqL) +{ + + mtx_unlock(pmutex); + +} +static inline void __list_del(struct list_head * prev, struct list_head * next) +{ + next->prev = prev; + prev->next = next; +} +static inline void INIT_LIST_HEAD(struct list_head *list) +{ + list->next = list; + list->prev = list; +} +__inline static void rtw_list_delete(_list *plist) +{ + __list_del(plist->prev, plist->next); + INIT_LIST_HEAD(plist); +} + +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) +{ + if (ptimer->function && ptimer->arg) { + rtw_mtx_lock(NULL); + callout_reset(&ptimer->callout, delay_time, timer_hdl, ptimer); + rtw_mtx_unlock(NULL); + } +} + +__inline static void _cancel_timer(_timer *ptimer,u8 *bcancelled) +{ + 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) +{ + printf("%s Not implement yet! \n",__FUNCTION__); +} + +__inline static void _set_workitem(_workitem *pwork) +{ + printf("%s Not implement yet! \n",__FUNCTION__); +// schedule_work(pwork); +} + +// +// Global Mutex: can only be used at PASSIVE level. +// + +#define ACQUIRE_GLOBAL_MUTEX(_MutexCounter) \ +{ \ +} + +#define RELEASE_GLOBAL_MUTEX(_MutexCounter) \ +{ \ +} + +#define ATOMIC_INIT(i) { (i) } + +static __inline void thread_enter(char *name); + +//Atomic integer operations +typedef uint32_t ATOMIC_T ; + +#define rtw_netdev_priv(netdev) (((struct ifnet *)netdev)->if_softc) + +#define rtw_free_netdev(netdev) if_free((netdev)) + +#define NDEV_FMT "%s" +#define NDEV_ARG(ndev) "" +#define ADPT_FMT "%s" +#define ADPT_ARG(adapter) "" +#define FUNC_NDEV_FMT "%s" +#define FUNC_NDEV_ARG(ndev) __func__ +#define FUNC_ADPT_FMT "%s" +#define FUNC_ADPT_ARG(adapter) __func__ + +#define STRUCT_PACKED + +#endif + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/osdep_service_ce.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/osdep_service_ce.h index 04c5b188e647..3d6d75aa6db9 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/osdep_service_ce.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/osdep_service_ce.h @@ -1,7 +1,8 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,182 +12,190 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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_ - - -#include -#include - -#ifdef CONFIG_SDIO_HCI -#include "SDCardDDK.h" -#endif - -#ifdef CONFIG_USB_HCI -#include -#endif - -typedef HANDLE _sema; -typedef LIST_ENTRY _list; -typedef NDIS_STATUS _OS_STATUS; - -typedef NDIS_SPIN_LOCK _lock; - -typedef HANDLE _rwlock; //Mutex - -typedef u32 _irqL; - -typedef NDIS_HANDLE _nic_hdl; - - -typedef NDIS_MINIPORT_TIMER _timer; - -struct __queue { - LIST_ENTRY queue; - _lock lock; -}; - -typedef NDIS_PACKET _pkt; -typedef NDIS_BUFFER _buffer; -typedef struct __queue _queue; - -typedef HANDLE _thread_hdl_; -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 - -__inline static _list *get_prev(_list *list) -{ - return list->Blink; -} - -__inline static _list *get_next(_list *list) -{ - return list->Flink; -} - -__inline static _list *get_list_head(_queue *queue) -{ - return (&(queue->queue)); -} - -#define LIST_CONTAINOR(ptr, type, member) CONTAINING_RECORD(ptr, type, member) - -__inline static void _enter_critical(_lock *plock, _irqL *pirqL) -{ - NdisAcquireSpinLock(plock); -} - -__inline static void _exit_critical(_lock *plock, _irqL *pirqL) -{ - NdisReleaseSpinLock(plock); -} - -__inline static _enter_critical_ex(_lock *plock, _irqL *pirqL) -{ - NdisDprAcquireSpinLock(plock); -} - -__inline static _exit_critical_ex(_lock *plock, _irqL *pirqL) -{ - NdisDprReleaseSpinLock(plock); -} - - -__inline static void _enter_hwio_critical(_rwlock *prwlock, _irqL *pirqL) -{ - WaitForSingleObject(*prwlock, INFINITE ); - -} - -__inline static void _exit_hwio_critical(_rwlock *prwlock, _irqL *pirqL) -{ - ReleaseMutex(*prwlock); -} - -__inline static void rtw_list_delete(_list *plist) -{ - RemoveEntryList(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); -} - -__inline static void _init_workitem(_workitem *pwork, void *pfunc, PVOID cntx) -{ - - NdisInitializeWorkItem(pwork, pfunc, cntx); -} - -__inline static void _set_workitem(_workitem *pwork) -{ - NdisScheduleWorkItem(pwork); -} - -#define ATOMIC_INIT(i) { (i) } - -// -// Global Mutex: can only be used at PASSIVE level. -// - -#define ACQUIRE_GLOBAL_MUTEX(_MutexCounter) \ -{ \ - while (NdisInterlockedIncrement((PULONG)&(_MutexCounter)) != 1)\ - { \ - NdisInterlockedDecrement((PULONG)&(_MutexCounter)); \ - NdisMSleep(10000); \ - } \ -} - -#define RELEASE_GLOBAL_MUTEX(_MutexCounter) \ -{ \ - NdisInterlockedDecrement((PULONG)&(_MutexCounter)); \ -} - -// limitation of path length -#define PATH_LENGTH_MAX MAX_PATH - -//Atomic integer operations -#define ATOMIC_T LONG - -#define NDEV_FMT "%s" -#define NDEV_ARG(ndev) "" -#define ADPT_FMT "%s" -#define ADPT_ARG(adapter) "" -#define FUNC_NDEV_FMT "%s" -#define FUNC_NDEV_ARG(ndev) __func__ -#define FUNC_ADPT_FMT "%s" -#define FUNC_ADPT_ARG(adapter) __func__ - -#define STRUCT_PACKED - - -#endif - + *****************************************************************************/ + +#ifndef __OSDEP_CE_SERVICE_H_ +#define __OSDEP_CE_SERVICE_H_ + + +#include +#include + +#ifdef CONFIG_SDIO_HCI +#include "SDCardDDK.h" +#endif + +#ifdef CONFIG_USB_HCI +#include +#endif + +typedef HANDLE _sema; +typedef LIST_ENTRY _list; +typedef NDIS_STATUS _OS_STATUS; + +typedef NDIS_SPIN_LOCK _lock; + +typedef HANDLE _rwlock; //Mutex + +typedef u32 _irqL; + +typedef NDIS_HANDLE _nic_hdl; + +struct rtw_timer_list { + NDIS_MINIPORT_TIMER ndis_timer; + void (*function)(void *); + void *arg; +}; + +struct __queue { + LIST_ENTRY queue; + _lock lock; +}; + +typedef NDIS_PACKET _pkt; +typedef NDIS_BUFFER _buffer; +typedef struct __queue _queue; + +typedef HANDLE _thread_hdl_; +typedef DWORD thread_return; +typedef void* thread_context; +typedef NDIS_WORK_ITEM _workitem; + + + +#define SEMA_UPBND (0x7FFFFFFF) //8192 + +__inline static _list *get_prev(_list *list) +{ + return list->Blink; +} + +__inline static _list *get_next(_list *list) +{ + return list->Flink; +} + +__inline static _list *get_list_head(_queue *queue) +{ + return (&(queue->queue)); +} + +#define LIST_CONTAINOR(ptr, type, member) CONTAINING_RECORD(ptr, type, member) + +__inline static void _enter_critical(_lock *plock, _irqL *pirqL) +{ + NdisAcquireSpinLock(plock); +} + +__inline static void _exit_critical(_lock *plock, _irqL *pirqL) +{ + NdisReleaseSpinLock(plock); +} + +__inline static _enter_critical_ex(_lock *plock, _irqL *pirqL) +{ + NdisDprAcquireSpinLock(plock); +} + +__inline static _exit_critical_ex(_lock *plock, _irqL *pirqL) +{ + NdisDprReleaseSpinLock(plock); +} + + +__inline static void _enter_hwio_critical(_rwlock *prwlock, _irqL *pirqL) +{ + WaitForSingleObject(*prwlock, INFINITE ); + +} + +__inline static void _exit_hwio_critical(_rwlock *prwlock, _irqL *pirqL) +{ + ReleaseMutex(*prwlock); +} + +__inline static void rtw_list_delete(_list *plist) +{ + RemoveEntryList(plist); + InitializeListHead(plist); +} + +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) +{ + + NdisInitializeWorkItem(pwork, pfunc, cntx); +} + +__inline static void _set_workitem(_workitem *pwork) +{ + NdisScheduleWorkItem(pwork); +} + +#define ATOMIC_INIT(i) { (i) } + +// +// Global Mutex: can only be used at PASSIVE level. +// + +#define ACQUIRE_GLOBAL_MUTEX(_MutexCounter) \ +{ \ + while (NdisInterlockedIncrement((PULONG)&(_MutexCounter)) != 1)\ + { \ + NdisInterlockedDecrement((PULONG)&(_MutexCounter)); \ + NdisMSleep(10000); \ + } \ +} + +#define RELEASE_GLOBAL_MUTEX(_MutexCounter) \ +{ \ + NdisInterlockedDecrement((PULONG)&(_MutexCounter)); \ +} + +// limitation of path length +#define PATH_LENGTH_MAX MAX_PATH + +//Atomic integer operations +#define ATOMIC_T LONG + +#define NDEV_FMT "%s" +#define NDEV_ARG(ndev) "" +#define ADPT_FMT "%s" +#define ADPT_ARG(adapter) "" +#define FUNC_NDEV_FMT "%s" +#define FUNC_NDEV_ARG(ndev) __func__ +#define FUNC_ADPT_FMT "%s" +#define FUNC_ADPT_ARG(adapter) __func__ + +#define STRUCT_PACKED + + +#endif + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/osdep_service_linux.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/osdep_service_linux.h index 43fa41f54c2e..76789a54aaeb 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/osdep_service_linux.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/osdep_service_linux.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +29,7 @@ #endif /* #include */ #include +#include #include #include #include @@ -49,6 +46,7 @@ #include #include #include +#include #include #include #include @@ -86,15 +84,16 @@ #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 #endif /* CONFIG_IOCTL_CFG80211 */ -#ifdef CONFIG_TCP_CSUM_OFFLOAD_TX - #include - #include -#endif #ifdef CONFIG_HAS_EARLYSUSPEND #include @@ -134,12 +133,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; @@ -148,7 +157,14 @@ typedef spinlock_t _lock; #else typedef struct semaphore _mutex; #endif -typedef struct timer_list _timer; +struct rtw_timer_list { + struct timer_list timer; + void (*function)(void *); + void *arg; +}; + +typedef struct rtw_timer_list _timer; +typedef struct completion _completion; struct __queue { struct list_head queue; @@ -160,6 +176,25 @@ typedef unsigned char _buffer; typedef struct __queue _queue; typedef struct list_head _list; + +/* hlist */ +typedef struct hlist_head rtw_hlist_head; +typedef struct hlist_node rtw_hlist_node; + +/* RCU */ +typedef struct rcu_head rtw_rcu_head; +#define rtw_rcu_dereference(p) rcu_dereference((p)) +#define rtw_rcu_dereference_protected(p, c) rcu_dereference_protected(p, c) +#define rtw_rcu_assign_pointer(p, v) rcu_assign_pointer((p), (v)) +#define rtw_rcu_read_lock() rcu_read_lock() +#define rtw_rcu_read_unlock() rcu_read_unlock() +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 34)) +#define rtw_rcu_access_pointer(p) rcu_access_pointer(p) +#endif + +/* rhashtable */ +#include "../os_dep/linux/rtw_rhashtable.h" + typedef int _OS_STATUS; /* typedef u32 _irqL; */ typedef unsigned long _irqL; @@ -169,8 +204,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 +217,9 @@ typedef void *timer_hdl_context; #define DMA_BIT_MASK(n) (((n) == 64) ? ~0ULL : ((1ULL<<(n))-1)) #endif +typedef unsigned long systime; +typedef struct tasklet_struct _tasklet; + #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) @@ -207,20 +243,31 @@ static inline unsigned char *skb_end_pointer(const struct sk_buff *skb) } #endif +__inline static void rtw_list_delete(_list *plist) +{ + list_del_init(plist); +} + __inline static _list *get_next(_list *list) { return list->next; } -__inline static _list *get_list_head(_queue *queue) -{ - return &(queue->queue); -} - - #define LIST_CONTAINOR(ptr, type, member) \ ((type *)((char *)(ptr)-(SIZE_T)(&((type *)0)->member))) +#define rtw_list_first_entry(ptr, type, member) list_first_entry(ptr, type, member) + +#define rtw_hlist_for_each_entry(pos, head, member) hlist_for_each_entry(pos, head, member) +#define rtw_hlist_for_each_safe(pos, n, head) hlist_for_each_safe(pos, n, head) +#define rtw_hlist_entry(ptr, type, member) hlist_entry(ptr, type, member) +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0)) +#define rtw_hlist_for_each_entry_safe(pos, np, n, head, member) hlist_for_each_entry_safe(pos, n, head, member) +#define rtw_hlist_for_each_entry_rcu(pos, node, head, member) hlist_for_each_entry_rcu(pos, head, member) +#else +#define rtw_hlist_for_each_entry_safe(pos, np, n, head, member) hlist_for_each_entry_safe(pos, np, n, head, member) +#define rtw_hlist_for_each_entry_rcu(pos, node, head, member) hlist_for_each_entry_rcu(pos, node, head, member) +#endif __inline static void _enter_critical(_lock *plock, _irqL *pirqL) { @@ -252,6 +299,16 @@ __inline static void _exit_critical_bh(_lock *plock, _irqL *pirqL) spin_unlock_bh(plock); } +__inline static void enter_critical_bh(_lock *plock) +{ + spin_lock_bh(plock); +} + +__inline static void exit_critical_bh(_lock *plock) +{ + spin_unlock_bh(plock); +} + __inline static int _enter_critical_mutex(_mutex *pmutex, _irqL *pirqL) { int ret = 0; @@ -265,6 +322,17 @@ __inline static int _enter_critical_mutex(_mutex *pmutex, _irqL *pirqL) } +__inline static int _enter_critical_mutex_lock(_mutex *pmutex, _irqL *pirqL) +{ + int ret = 0; +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) + mutex_lock(pmutex); +#else + down(pmutex); +#endif + return ret; +} + __inline static void _exit_critical_mutex(_mutex *pmutex, _irqL *pirqL) { #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) @@ -274,33 +342,50 @@ __inline static void _exit_critical_mutex(_mutex *pmutex, _irqL *pirqL) #endif } -__inline static void rtw_list_delete(_list *plist) +__inline static _list *get_list_head(_queue *queue) { - list_del_init(plist); + return &(queue->queue); } -#define RTW_TIMER_HDL_ARGS void *FunctionContext +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 14, 0)) +static inline void timer_hdl(struct timer_list *in_timer) +#else +static inline void timer_hdl(unsigned long cntx) +#endif +{ +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 14, 0)) + _timer *ptimer = from_timer(ptimer, in_timer, timer); +#else + _timer *ptimer = (_timer *)cntx; +#endif + ptimer->function(ptimer->arg); +} __inline static void _init_timer(_timer *ptimer, _nic_hdl nic_hdl, void *pfunc, void *cntx) { - /* setup_timer(ptimer, pfunc,(u32)cntx); */ ptimer->function = pfunc; - ptimer->data = (unsigned long)cntx; - init_timer(ptimer); + ptimer->arg = cntx; + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 14, 0)) + timer_setup(&ptimer->timer, timer_hdl, 0); +#else + /* setup_timer(ptimer, pfunc,(u32)cntx); */ + ptimer->timer.function = timer_hdl; + ptimer->timer.data = (unsigned long)ptimer; + init_timer(&ptimer->timer); +#endif } __inline static void _set_timer(_timer *ptimer, u32 delay_time) { - mod_timer(ptimer , (jiffies + (delay_time * HZ / 1000))); + mod_timer(&ptimer->timer , (jiffies + (delay_time * HZ / 1000))); } __inline static void _cancel_timer(_timer *ptimer, u8 *bcancelled) { - del_timer_sync(ptimer); - *bcancelled = 1; + *bcancelled = del_timer_sync(&ptimer->timer) == 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 +471,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; @@ -438,7 +535,21 @@ struct rtw_netdev_priv_indicator { struct net_device *rtw_alloc_etherdev_with_old_priv(int sizeof_priv, void *old_priv); extern struct net_device *rtw_alloc_etherdev(int sizeof_priv); +#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 24)) +#define rtw_get_same_net_ndev_by_name(ndev, name) dev_get_by_name(name) +#elif (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 26)) +#define rtw_get_same_net_ndev_by_name(ndev, name) dev_get_by_name(ndev->nd_net, name) +#else +#define rtw_get_same_net_ndev_by_name(ndev, name) dev_get_by_name(dev_net(ndev), name) +#endif + +#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 24)) +#define rtw_get_bridge_ndev_by_name(name) dev_get_by_name(name) +#else +#define rtw_get_bridge_ndev_by_name(name) dev_get_by_name(&init_net, name) +#endif + #define STRUCT_PACKED __attribute__ ((packed)) -#endif +#endif /* __OSDEP_LINUX_SERVICE_H_ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/osdep_service_xp.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/osdep_service_xp.h index 45d54af1f3be..46cc0638665b 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/osdep_service_xp.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/osdep_service_xp.h @@ -1,202 +1,211 @@ -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ -#ifndef __OSDEP_LINUX_SERVICE_H_ -#define __OSDEP_LINUX_SERVICE_H_ - - #include - #include - #include - #include - -#ifdef CONFIG_USB_HCI - #include - #include - #include -#endif - - typedef KSEMAPHORE _sema; - typedef LIST_ENTRY _list; - typedef NDIS_STATUS _OS_STATUS; - - - typedef NDIS_SPIN_LOCK _lock; - - typedef KMUTEX _mutex; - - typedef KIRQL _irqL; - - // USB_PIPE for WINCE , but handle can be use just integer under windows - typedef NDIS_HANDLE _nic_hdl; - - - typedef NDIS_MINIPORT_TIMER _timer; - - struct __queue { - LIST_ENTRY queue; - _lock lock; - }; - - typedef NDIS_PACKET _pkt; - typedef NDIS_BUFFER _buffer; - typedef struct __queue _queue; - - typedef PKTHREAD _thread_hdl_; - typedef void thread_return; - typedef void* thread_context; - - typedef NDIS_WORK_ITEM _workitem; - - #define thread_exit() PsTerminateSystemThread(STATUS_SUCCESS); - - #define HZ 10000000 - #define SEMA_UPBND (0x7FFFFFFF) //8192 - -__inline static _list *get_next(_list *list) -{ - return list->Flink; -} - -__inline static _list *get_list_head(_queue *queue) -{ - return (&(queue->queue)); -} - - -#define LIST_CONTAINOR(ptr, type, member) CONTAINING_RECORD(ptr, type, member) - - -__inline static _enter_critical(_lock *plock, _irqL *pirqL) -{ - NdisAcquireSpinLock(plock); -} - -__inline static _exit_critical(_lock *plock, _irqL *pirqL) -{ - NdisReleaseSpinLock(plock); -} - - -__inline static _enter_critical_ex(_lock *plock, _irqL *pirqL) -{ - NdisDprAcquireSpinLock(plock); -} - -__inline static _exit_critical_ex(_lock *plock, _irqL *pirqL) -{ - NdisDprReleaseSpinLock(plock); -} - -__inline static void _enter_critical_bh(_lock *plock, _irqL *pirqL) -{ - NdisDprAcquireSpinLock(plock); -} - -__inline static void _exit_critical_bh(_lock *plock, _irqL *pirqL) -{ - NdisDprReleaseSpinLock(plock); -} - -__inline static _enter_critical_mutex(_mutex *pmutex, _irqL *pirqL) -{ - KeWaitForSingleObject(pmutex, Executive, KernelMode, FALSE, NULL); -} - - -__inline static _exit_critical_mutex(_mutex *pmutex, _irqL *pirqL) -{ - KeReleaseMutex(pmutex, FALSE); -} - - -__inline static void rtw_list_delete(_list *plist) -{ - RemoveEntryList(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); -} - -__inline static void _init_workitem(_workitem *pwork, void *pfunc, PVOID cntx) -{ - - NdisInitializeWorkItem(pwork, pfunc, cntx); -} - -__inline static void _set_workitem(_workitem *pwork) -{ - NdisScheduleWorkItem(pwork); -} - - -#define ATOMIC_INIT(i) { (i) } - -// -// Global Mutex: can only be used at PASSIVE level. -// - -#define ACQUIRE_GLOBAL_MUTEX(_MutexCounter) \ -{ \ - while (NdisInterlockedIncrement((PULONG)&(_MutexCounter)) != 1)\ - { \ - NdisInterlockedDecrement((PULONG)&(_MutexCounter)); \ - NdisMSleep(10000); \ - } \ -} - -#define RELEASE_GLOBAL_MUTEX(_MutexCounter) \ -{ \ - NdisInterlockedDecrement((PULONG)&(_MutexCounter)); \ -} - -// limitation of path length -#define PATH_LENGTH_MAX MAX_PATH - -//Atomic integer operations -#define ATOMIC_T LONG - - -#define NDEV_FMT "%s" -#define NDEV_ARG(ndev) "" -#define ADPT_FMT "%s" -#define ADPT_ARG(adapter) "" -#define FUNC_NDEV_FMT "%s" -#define FUNC_NDEV_ARG(ndev) __func__ -#define FUNC_ADPT_FMT "%s" -#define FUNC_ADPT_ARG(adapter) __func__ - -#define STRUCT_PACKED - -#endif - +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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_ + + #include + #include + #include + #include + +#ifdef CONFIG_USB_HCI + #include + #include + #include +#endif + + typedef KSEMAPHORE _sema; + typedef LIST_ENTRY _list; + typedef NDIS_STATUS _OS_STATUS; + + + typedef NDIS_SPIN_LOCK _lock; + + typedef KMUTEX _mutex; + + typedef KIRQL _irqL; + + // USB_PIPE for WINCE , but handle can be use just integer under windows + typedef NDIS_HANDLE _nic_hdl; + + struct rtw_timer_list { + NDIS_MINIPORT_TIMER ndis_timer; + void (*function)(void *); + void *arg; + }; + + struct __queue { + LIST_ENTRY queue; + _lock lock; + }; + + typedef NDIS_PACKET _pkt; + typedef NDIS_BUFFER _buffer; + typedef struct __queue _queue; + + typedef PKTHREAD _thread_hdl_; + typedef void thread_return; + typedef void* thread_context; + + typedef NDIS_WORK_ITEM _workitem; + + + #define HZ 10000000 + #define SEMA_UPBND (0x7FFFFFFF) //8192 + +__inline static _list *get_next(_list *list) +{ + return list->Flink; +} + +__inline static _list *get_list_head(_queue *queue) +{ + return (&(queue->queue)); +} + + +#define LIST_CONTAINOR(ptr, type, member) CONTAINING_RECORD(ptr, type, member) + + +__inline static _enter_critical(_lock *plock, _irqL *pirqL) +{ + NdisAcquireSpinLock(plock); +} + +__inline static _exit_critical(_lock *plock, _irqL *pirqL) +{ + NdisReleaseSpinLock(plock); +} + + +__inline static _enter_critical_ex(_lock *plock, _irqL *pirqL) +{ + NdisDprAcquireSpinLock(plock); +} + +__inline static _exit_critical_ex(_lock *plock, _irqL *pirqL) +{ + NdisDprReleaseSpinLock(plock); +} + +__inline static void _enter_critical_bh(_lock *plock, _irqL *pirqL) +{ + NdisDprAcquireSpinLock(plock); +} + +__inline static void _exit_critical_bh(_lock *plock, _irqL *pirqL) +{ + NdisDprReleaseSpinLock(plock); +} + +__inline static _enter_critical_mutex(_mutex *pmutex, _irqL *pirqL) +{ + KeWaitForSingleObject(pmutex, Executive, KernelMode, FALSE, NULL); +} + + +__inline static _exit_critical_mutex(_mutex *pmutex, _irqL *pirqL) +{ + KeReleaseMutex(pmutex, FALSE); +} + + +__inline static void rtw_list_delete(_list *plist) +{ + RemoveEntryList(plist); + InitializeListHead(plist); +} + +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) +{ + + NdisInitializeWorkItem(pwork, pfunc, cntx); +} + +__inline static void _set_workitem(_workitem *pwork) +{ + NdisScheduleWorkItem(pwork); +} + + +#define ATOMIC_INIT(i) { (i) } + +// +// Global Mutex: can only be used at PASSIVE level. +// + +#define ACQUIRE_GLOBAL_MUTEX(_MutexCounter) \ +{ \ + while (NdisInterlockedIncrement((PULONG)&(_MutexCounter)) != 1)\ + { \ + NdisInterlockedDecrement((PULONG)&(_MutexCounter)); \ + NdisMSleep(10000); \ + } \ +} + +#define RELEASE_GLOBAL_MUTEX(_MutexCounter) \ +{ \ + NdisInterlockedDecrement((PULONG)&(_MutexCounter)); \ +} + +// limitation of path length +#define PATH_LENGTH_MAX MAX_PATH + +//Atomic integer operations +#define ATOMIC_T LONG + + +#define NDEV_FMT "%s" +#define NDEV_ARG(ndev) "" +#define ADPT_FMT "%s" +#define ADPT_ARG(adapter) "" +#define FUNC_NDEV_FMT "%s" +#define FUNC_NDEV_ARG(ndev) __func__ +#define FUNC_ADPT_FMT "%s" +#define FUNC_ADPT_ARG(adapter) __func__ + +#define STRUCT_PACKED + +#endif + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/pci_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/pci_hal.h index 8aa1a569f16e..833babc1b904 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/pci_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/pci_hal.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -32,6 +28,10 @@ void rtl8192ee_set_hal_ops(_adapter *padapter); #endif +#if defined(CONFIG_RTL8192F) + void rtl8192fe_set_hal_ops(_adapter *padapter); +#endif + #ifdef CONFIG_RTL8723B void rtl8723be_set_hal_ops(_adapter *padapter); #endif @@ -48,6 +48,10 @@ void rtl8822be_set_hal_ops(PADAPTER padapter); #endif +#ifdef CONFIG_RTL8822C + void rtl8822ce_set_hal_ops(PADAPTER padapter); +#endif + u8 rtw_set_hal_ops(_adapter *padapter); #endif /* __PCIE_HAL_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/pci_ops.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/pci_ops.h index dda0f363330c..473f84b613ba 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/pci_ops.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/pci_ops.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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_ @@ -30,6 +26,7 @@ void rtl8188ee_recv_tasklet(void *priv); void rtl8188ee_prepare_bcn_tasklet(void *priv); void rtl8188ee_set_intf_ops(struct _io_ops *pops); + void rtw8188ee_unmap_beacon_icf(_adapter *padapter); #endif #if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) @@ -41,6 +38,7 @@ void rtl8812ae_recv_tasklet(void *priv); void rtl8812ae_prepare_bcn_tasklet(void *priv); void rtl8812ae_set_intf_ops(struct _io_ops *pops); + void rtw8812ae_unmap_beacon_icf(_adapter *padapter); #endif #ifdef CONFIG_RTL8192E @@ -51,6 +49,19 @@ void rtl8192ee_prepare_bcn_tasklet(void *priv); int rtl8192ee_interrupt(PADAPTER Adapter); void rtl8192ee_set_intf_ops(struct _io_ops *pops); + void rtw8192ee_unmap_beacon_icf(_adapter *padapter); +#endif + +#ifdef CONFIG_RTL8192F + u32 rtl8192fe_init_desc_ring(_adapter *padapter); + u32 rtl8192fe_free_desc_ring(_adapter *padapter); + void rtl8192fe_reset_desc_ring(_adapter *padapter); + int rtl8192fe_interrupt(PADAPTER Adapter); + void rtl8192fe_recv_tasklet(void *priv); + void rtl8192fe_prepare_bcn_tasklet(void *priv); + void rtl8192fe_set_intf_ops(struct _io_ops *pops); + u8 check_tx_desc_resource(_adapter *padapter, int prio); + void rtl8192fe_unmap_beacon_icf(PADAPTER Adapter); #endif #ifdef CONFIG_RTL8723B @@ -61,6 +72,7 @@ void rtl8723be_recv_tasklet(void *priv); void rtl8723be_prepare_bcn_tasklet(void *priv); void rtl8723be_set_intf_ops(struct _io_ops *pops); + void rtl8723be_unmap_beacon_icf(PADAPTER Adapter); #endif #ifdef CONFIG_RTL8723D @@ -72,6 +84,7 @@ void rtl8723de_prepare_bcn_tasklet(void *priv); void rtl8723de_set_intf_ops(struct _io_ops *pops); u8 check_tx_desc_resource(_adapter *padapter, int prio); + void rtl8723de_unmap_beacon_icf(PADAPTER Adapter); #endif #ifdef CONFIG_RTL8814A @@ -83,6 +96,7 @@ void rtl8814ae_recv_tasklet(void *priv); void rtl8814ae_prepare_bcn_tasklet(void *priv); void rtl8814ae_set_intf_ops(struct _io_ops *pops); + void rtl8814ae_unmap_beacon_icf(PADAPTER Adapter); #endif #ifdef CONFIG_RTL8822B @@ -93,4 +107,8 @@ void rtl8821ce_set_intf_ops(struct _io_ops *pops); #endif +#ifdef CONFIG_RTL8822C + void rtl8822ce_set_intf_ops(struct _io_ops *pops); +#endif + #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/pci_osintf.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/pci_osintf.h index 33393529b8ab..56d6942277f9 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/pci_osintf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/pci_osintf.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 @@ -33,9 +29,21 @@ #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/rtl8188eu/include/recv_osdep.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/recv_osdep.h index 6cb918404c18..0c1626735608 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/recv_osdep.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/recv_osdep.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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_ @@ -26,12 +22,15 @@ extern void _rtw_free_recv_priv(struct recv_priv *precvpriv); extern s32 rtw_recv_entry(union recv_frame *precv_frame); +void rtw_rframe_set_os_pkt(union recv_frame *rframe); extern int rtw_recv_indicatepkt(_adapter *adapter, union recv_frame *precv_frame); -extern void rtw_recv_returnpacket(IN _nic_hdl cnxt, IN _pkt *preturnedpkt); +extern void rtw_recv_returnpacket(_nic_hdl cnxt, _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); @@ -50,18 +49,19 @@ void rtw_os_free_recvframe(union recv_frame *precvframe); 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); +_pkt *rtw_os_alloc_msdu_pkt(union recv_frame *prframe, const u8 *da, const u8 *sa, u8 *msdu ,u16 msdu_len); +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 */ int rtw_recv_napi_poll(struct napi_struct *, int budget); +#ifdef CONFIG_RTW_NAPI_DYNAMIC +void dynamic_napi_th_chk (_adapter *adapter); +#endif /* CONFIG_RTW_NAPI_DYNAMIC */ #endif /* CONFIG_RTW_NAPI */ #endif /* PLATFORM_LINUX */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188e_cmd.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188e_cmd.h index a3d6e01742ff..2f26184b79a8 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188e_cmd.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188e_cmd.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -140,8 +136,6 @@ typedef struct _RSVDPAGE_LOC_88E { /* host message to firmware cmd */ 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/rtl8188eu/include/rtl8188e_dm.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188e_dm.h index a4c2527587aa..c6ec32087b1a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188e_dm.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188e_dm.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,22 +12,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 __RTL8188E_DM_H__ #define __RTL8188E_DM_H__ -void rtl8188e_init_dm_priv(IN PADAPTER Adapter); -void rtl8188e_deinit_dm_priv(IN PADAPTER Adapter); -void rtl8188e_InitHalDm(IN PADAPTER Adapter); -void rtl8188e_HalDmWatchDog(IN PADAPTER Adapter); +void rtl8188e_init_dm_priv(PADAPTER Adapter); +void rtl8188e_deinit_dm_priv(PADAPTER Adapter); +void rtl8188e_InitHalDm(PADAPTER Adapter); +void rtl8188e_HalDmWatchDog(PADAPTER Adapter); -/* VOID rtl8192c_dm_CheckTXPowerTracking(IN PADAPTER Adapter); */ +/* void rtl8192c_dm_CheckTXPowerTracking(PADAPTER Adapter); */ -/* void rtl8192c_dm_RF_Saving(IN PADAPTER pAdapter, IN u8 bForceInNormal); */ +/* void rtl8192c_dm_RF_Saving(PADAPTER pAdapter, u8 bForceInNormal); */ #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188e_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188e_hal.h index ebc402bfec8a..63d1e3f8a910 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188e_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188e_hal.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -133,16 +129,18 @@ typedef struct _RT_8188E_FIRMWARE_HDR { #define MAX_TX_REPORT_BUFFER_SIZE 0x0400 /* 1k */ +#define PAGE_SIZE_TX_88E PAGE_SIZE_128 /* Note: We will divide number of page equally for each queue other than public queue! * 22k = 22528 bytes = 176 pages (@page = 128 bytes) - * 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 */ + * BCN rsvd_page_num = MAX_BEACON_LEN / PAGE_SIZE_TX_88E + * 1 ps-poll / 1 null-data /1 prob_rsp /1 QOS null-data = 4 pages */ -#define BCNQ_PAGE_NUM_88E 0x09 +#define BCNQ_PAGE_NUM_88E (MAX_BEACON_LEN / PAGE_SIZE_TX_88E + 4) /*0x09*/ /* For WoWLan , more reserved page */ #ifdef CONFIG_WOWLAN - #define WOWLAN_PAGE_NUM_88E 0x00 + /* 1 ArpRsp + 2 NbrAdv + 2 NDPInfo + 1 RCI + 1 AOAC = 7 pages */ + #define WOWLAN_PAGE_NUM_88E 0x07 #else #define WOWLAN_PAGE_NUM_88E 0x00 #endif @@ -288,14 +286,13 @@ BOOLEAN HalDetectPwrDownMode88E(PADAPTER Adapter); void Hal_ReadRFGainOffset(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); #endif /*CONFIG_RF_POWER_TRIM*/ -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); -/* register */ -void SetBcnCtrlReg(PADAPTER padapter, u8 SetBits, u8 ClearBits); - void rtl8188e_start_thread(_adapter *padapter); void rtl8188e_stop_thread(_adapter *padapter); @@ -305,14 +302,14 @@ 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 GetHalDefVar8188E( - IN PADAPTER Adapter, - IN HAL_DEF_VARIABLE eVariable, - IN PVOID pValue + PADAPTER Adapter, + HAL_DEF_VARIABLE eVariable, + void *pValue ); #ifdef CONFIG_GPIO_API int rtl8188e_GpioFuncCheck(PADAPTER adapter, u8 gpio_num); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188e_led.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188e_led.h index 8d0feee21d6f..5d42f8013d01 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188e_led.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188e_led.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,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 +35,4 @@ #endif #endif +#endif /*CONFIG_RTW_SW_LED*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188e_recv.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188e_recv.h index 342e65bd2617..c1eeb5e5247a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188e_recv.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188e_recv.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -25,20 +21,15 @@ #define RECV_BLK_TH RECV_BLK_CNT #if defined(CONFIG_USB_HCI) - #ifndef MAX_RECVBUF_SZ - #ifdef PLATFORM_OS_CE - #define MAX_RECVBUF_SZ (8192+1024) /* 8K+1k */ + #ifndef CONFIG_MINIMAL_MEMORY_USAGE + /* #define MAX_RECVBUF_SZ (32768) */ /* 32k */ + /* #define MAX_RECVBUF_SZ (16384) */ /* 16K */ + /* #define MAX_RECVBUF_SZ (10240) */ /* 10K */ + #define MAX_RECVBUF_SZ (15360) /* 15k < 16k */ + /* #define MAX_RECVBUF_SZ (8192+1024) */ /* 8K+1k */ #else - #ifndef CONFIG_MINIMAL_MEMORY_USAGE - /* #define MAX_RECVBUF_SZ (32768) */ /* 32k */ - /* #define MAX_RECVBUF_SZ (16384) */ /* 16K */ - /* #define MAX_RECVBUF_SZ (10240) */ /* 10K */ - #define MAX_RECVBUF_SZ (15360) /* 15k < 16k */ - /* #define MAX_RECVBUF_SZ (8192+1024) */ /* 8K+1k */ - #else - #define MAX_RECVBUF_SZ (4000) /* about 4K */ - #endif + #define MAX_RECVBUF_SZ (4000) /* about 4K */ #endif #endif /* !MAX_RECVBUF_SZ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188e_rf.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188e_rf.h index 658812641787..ccb04cc17f94 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188e_rf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188e_rf.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,22 +12,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 __RTL8188E_RF_H__ #define __RTL8188E_RF_H__ -int PHY_RF6052_Config8188E(IN PADAPTER Adapter); -void rtl8188e_RF_ChangeTxPath(IN PADAPTER Adapter, - IN u16 DataRate); +int PHY_RF6052_Config8188E(PADAPTER Adapter); +void rtl8188e_RF_ChangeTxPath(PADAPTER Adapter, + u16 DataRate); void rtl8188e_PHY_RF6052SetBandwidth( - IN PADAPTER Adapter, - IN CHANNEL_WIDTH Bandwidth); + PADAPTER Adapter, + enum channel_width Bandwidth); #endif/* __RTL8188E_RF_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188e_spec.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188e_spec.h index 984316a58d40..e87126e41ed6 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188e_spec.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188e_spec.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +44,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 +85,8 @@ * 0x0300h ~ 0x03FFh PCIe * * ----------------------------------------------------- */ +#define REG_PCIE_HRPWM_8188E 0x0361 /* PCIe RPWM */ +#define REG_PCIE_HCPWM_8188E 0x0363 /* PCIe CPWM */ /* ----------------------------------------------------- * diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188e_sreset.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188e_sreset.h index d0214ac0d036..7fa89af73715 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188e_sreset.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188e_sreset.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/rtl8188e_xmit.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188e_xmit.h index c04a66cdf96c..790d334b9e09 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188e_xmit.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188e_xmit.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/rtl8188f_cmd.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188f_cmd.h index 953d8c44b1d3..eb9ca3d525b5 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188f_cmd.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188f_cmd.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -118,7 +114,6 @@ enum h2c_cmd_8188F { #define SET_8188F_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) #define SET_8188F_H2CCMD_PWRMODE_PARM_BCN_EARLY_C2H_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 2, 1, __Value) #define SET_8188F_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -#define SET_8188F_H2CCMD_PWRMODE_PARM_BYTE5(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) #define GET_8188F_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) @@ -164,7 +159,7 @@ enum h2c_cmd_8188F { #define SET_8188F_H2CCMD_BT_MPOPER_PARAM3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) /* _BT_FW_PATCH_0x6A */ -#define SET_8188F_H2CCMD_BT_FW_PATCH_SIZE(__pH2CCmd, __Value) SET_BITS_TO_LE_2BYTE((pu1Byte)(__pH2CCmd), 0, 16, __Value) +#define SET_8188F_H2CCMD_BT_FW_PATCH_SIZE(__pH2CCmd, __Value) SET_BITS_TO_LE_2BYTE((u8 *)(__pH2CCmd), 0, 16, __Value) #define SET_8188F_H2CCMD_BT_FW_PATCH_ADDR0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) #define SET_8188F_H2CCMD_BT_FW_PATCH_ADDR1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) #define SET_8188F_H2CCMD_BT_FW_PATCH_ADDR2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) @@ -183,11 +178,9 @@ enum h2c_cmd_8188F { /* host message to firmware cmd */ void rtl8188f_set_FwPwrMode_cmd(PADAPTER padapter, u8 Mode); void rtl8188f_set_FwJoinBssRpt_cmd(PADAPTER padapter, u8 mstatus); -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, u8 ignore_bw); 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 +190,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 +202,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/rtl8188eu/include/rtl8188f_dm.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188f_dm.h index 78aeab0eb57d..146490e88a04 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188f_dm.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188f_dm.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +36,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/rtl8188eu/include/rtl8188f_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188f_hal.h index 874a3b20fef8..259f52119e68 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188f_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188f_hal.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -109,23 +105,17 @@ typedef struct _RT_8188F_FIRMWARE_HDR { /* Note: We will divide number of page equally for each queue other than public queue! */ /* For General Reserved Page Number(Beacon Queue is reserved page) - * Beacon:2, PS-Poll:1, Null Data:1,Qos Null Data:1,BT Qos Null Data:1 */ -#define BCNQ_PAGE_NUM_8188F 0x08 -#ifdef CONFIG_CONCURRENT_MODE - #define BCNQ1_PAGE_NUM_8188F 0x08 /* 0x04 */ -#else - #define BCNQ1_PAGE_NUM_8188F 0x00 -#endif + * BCN rsvd_page_num = MAX_BEACON_LEN / PAGE_SIZE_TX_8188F, + * PS-Poll:1, Null Data:1,Qos Null Data:1,BT Qos Null Data:1, CTS-2-SELF / LTE QoS Null */ -#ifdef CONFIG_PNO_SUPPORT -#undef BCNQ1_PAGE_NUM_8188F -#define BCNQ1_PAGE_NUM_8188F 0x00 /* 0x04 */ -#endif +#define BCNQ_PAGE_NUM_8188F (MAX_BEACON_LEN / PAGE_SIZE_TX_8188F + 6) /*0x08*/ /* For WoWLan , more reserved page - * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, AOAC rpt:1 ,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 0x08 + #define WOWLAN_PAGE_NUM_8188F 0x0b #else #define WOWLAN_PAGE_NUM_8188F 0x00 #endif @@ -139,7 +129,7 @@ typedef struct _RT_8188F_FIRMWARE_HDR { #define AP_WOWLAN_PAGE_NUM_8188F 0x02 #endif -#define TX_TOTAL_PAGE_NUMBER_8188F (0xFF - BCNQ_PAGE_NUM_8188F - BCNQ1_PAGE_NUM_8188F - WOWLAN_PAGE_NUM_8188F) +#define TX_TOTAL_PAGE_NUMBER_8188F (0xFF - BCNQ_PAGE_NUM_8188F - WOWLAN_PAGE_NUM_8188F) #define TX_PAGE_BOUNDARY_8188F (TX_TOTAL_PAGE_NUMBER_8188F + 1) #define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8188F TX_TOTAL_PAGE_NUMBER_8188F @@ -219,14 +209,14 @@ void Hal_EfuseParseThermalMeter_8188F(PADAPTER padapter, u8 *hwinfo, u8 AutoLoad void Hal_EfuseParseKFreeData_8188F(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); #if 0 /* Do not need for rtl8188f */ -VOID Hal_EfuseParseVoltage_8188F(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); +void Hal_EfuseParseVoltage_8188F(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); #endif 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); @@ -255,7 +245,7 @@ void HalSetOutPutGPIO(PADAPTER padapter, u8 index, u8 OutPutValue); #endif #ifdef CONFIG_MP_INCLUDED -int FirmwareDownloadBT(IN PADAPTER Adapter, PRT_MP_FIRMWARE pFirmware); +int FirmwareDownloadBT(PADAPTER Adapter, PRT_MP_FIRMWARE pFirmware); #endif void CCX_FwC2HTxRpt_8188f(PADAPTER padapter, u8 *pdata, u8 len); @@ -265,7 +255,7 @@ u8 HwRateToMRate8188F(u8 rate); #ifdef CONFIG_PCI_HCI BOOLEAN InterruptRecognized8188FE(PADAPTER Adapter); -VOID UpdateInterruptMask8188FE(PADAPTER Adapter, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); +void UpdateInterruptMask8188FE(PADAPTER Adapter, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); #endif #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188f_led.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188f_led.h index 232ede5a9ada..67258fde0842 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188f_led.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188f_led.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,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 +43,4 @@ void rtl8188fe_DeInitSwLeds(PADAPTER padapter); #endif #endif +#endif/*CONFIG_RTW_SW_LED*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188f_recv.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188f_recv.h index 8652fd620316..f95cfada8b59 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188f_recv.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188f_recv.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,35 +12,27 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ #if defined(CONFIG_USB_HCI) #ifndef MAX_RECVBUF_SZ - #ifdef PLATFORM_OS_CE - #define MAX_RECVBUF_SZ (8192+1024) /* 8K+1k */ + + #ifdef CONFIG_MINIMAL_MEMORY_USAGE + #define MAX_RECVBUF_SZ (4000) /* about 4K */ #else - #ifdef CONFIG_MINIMAL_MEMORY_USAGE - #define MAX_RECVBUF_SZ (4000) /* about 4K */ + #ifdef CONFIG_PLATFORM_MSTAR + #define MAX_RECVBUF_SZ (8192) /* 8K */ + #elif defined(CONFIG_PLATFORM_HISILICON) + #define MAX_RECVBUF_SZ (16384) /* 16k */ #else - #ifdef CONFIG_PLATFORM_MSTAR - #define MAX_RECVBUF_SZ (8192) /* 8K */ - #elif defined(CONFIG_PLATFORM_HISILICON) - #define MAX_RECVBUF_SZ (16384) /* 16k */ - #else - #define MAX_RECVBUF_SZ (32768) /* 32k */ - #endif - /* #define MAX_RECVBUF_SZ (20480) */ /* 20K */ - /* #define MAX_RECVBUF_SZ (10240) */ /* 10K */ - /* #define MAX_RECVBUF_SZ (16384) */ /* 16k - 92E RX BUF :16K */ - /* #define MAX_RECVBUF_SZ (8192+1024) */ /* 8K+1k */ + #define MAX_RECVBUF_SZ (32768) /* 32k */ #endif + /* #define MAX_RECVBUF_SZ (20480) */ /* 20K */ + /* #define MAX_RECVBUF_SZ (10240) */ /* 10K */ + /* #define MAX_RECVBUF_SZ (16384) */ /* 16k - 92E RX BUF :16K */ + /* #define MAX_RECVBUF_SZ (8192+1024) */ /* 8K+1k */ #endif #endif /* !MAX_RECVBUF_SZ */ #elif defined(CONFIG_PCI_HCI) diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188f_rf.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188f_rf.h index 185d2d0322fc..6d785796f95f 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188f_rf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188f_rf.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,20 +12,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 __RTL8188F_RF_H__ #define __RTL8188F_RF_H__ -int PHY_RF6052_Config8188F(IN PADAPTER Adapter); +int PHY_RF6052_Config8188F(PADAPTER Adapter); -VOID +void PHY_RF6052SetBandwidth8188F( - IN PADAPTER Adapter, - IN CHANNEL_WIDTH Bandwidth); + PADAPTER Adapter, + enum channel_width Bandwidth); #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188f_spec.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188f_spec.h index 7282cc19f839..deb97ab4b152 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188f_spec.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188f_spec.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -154,18 +151,6 @@ #define SDIO_REG_HCPWM1_8188F 0x0038 -/* indirect access */ -#define SDIO_REG_INDIRECT_REG_CFG_8188F 0x40 -#define SET_INDIRECT_REG_ADDR(_cmd, _addr) SET_BITS_TO_LE_2BYTE(((u8 *)(_cmd)) + 0, 0, 16, (_addr)) -#define SET_INDIRECT_REG_SIZE_1BYTE(_cmd) SET_BITS_TO_LE_1BYTE(((u8 *)(_cmd)) + 2, 0, 2, 0) -#define SET_INDIRECT_REG_SIZE_2BYTE(_cmd) SET_BITS_TO_LE_1BYTE(((u8 *)(_cmd)) + 2, 0, 2, 1) -#define SET_INDIRECT_REG_SIZE_4BYTE(_cmd) SET_BITS_TO_LE_1BYTE(((u8 *)(_cmd)) + 2, 0, 2, 2) -#define SET_INDIRECT_REG_WRITE(_cmd) SET_BITS_TO_LE_1BYTE(((u8 *)(_cmd)) + 2, 2, 1, 1) -#define SET_INDIRECT_REG_READ(_cmd) SET_BITS_TO_LE_1BYTE(((u8 *)(_cmd)) + 2, 3, 1, 1) -#define GET_INDIRECT_REG_RDY(_cmd) LE_BITS_TO_1BYTE(((u8 *)(_cmd)) + 2, 4, 1) - -#define SDIO_REG_INDIRECT_REG_DATA_8188F 0x44 - /* **************************************************************************** * 8188 Regsiter Bit and Content definition * **************************************************************************** */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188f_sreset.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188f_sreset.h index ef5b0ff7c5b5..bd0193b3ab4d 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188f_sreset.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188f_sreset.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/rtl8188f_xmit.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188f_xmit.h index be88ca43aa22..de05b4ccfb29 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188f_xmit.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8188f_xmit.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -189,13 +185,15 @@ #define SET_TX_DESC_ANTSEL_D_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 25, 3, __Value) /* Dword 7 */ -#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) +#ifdef CONFIG_PCI_HCI #define SET_TX_DESC_TX_BUFFER_SIZE_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -#else +#endif + +#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_USB_HCI) #define SET_TX_DESC_TX_DESC_CHECKSUM_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) #endif #define SET_TX_DESC_USB_TXAGG_NUM_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 24, 8, __Value) -#if (DEV_BUS_TYPE == RT_SDIO_INTERFACE) +#ifdef CONFIG_SDIO_HCI #define SET_TX_DESC_SDIO_TXSEQ_8188F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 16, 8, __Value) #endif @@ -306,9 +304,10 @@ thread_return rtl8188fs_xmit_thread(thread_context context); #endif #ifdef CONFIG_USB_HCI +#ifdef CONFIG_XMIT_THREAD_MODE s32 rtl8188fu_xmit_buf_handler(PADAPTER padapter); #define hal_xmit_handler rtl8188fu_xmit_buf_handler - +#endif s32 rtl8188fu_init_xmit_priv(PADAPTER padapter); void rtl8188fu_free_xmit_priv(PADAPTER padapter); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192e_cmd.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192e_cmd.h index 78d476bb137d..e9ff31c3ef11 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192e_cmd.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192e_cmd.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -106,7 +102,6 @@ typedef struct _RSVDPAGE_LOC_92E { #define SET_8192E_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) #define SET_8192E_H2CCMD_PWRMODE_PARM_BCN_EARLY_C2H_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 2, 1, __Value) #define SET_8192E_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -#define SET_8192E_H2CCMD_PWRMODE_PARM_BYTE5(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) #define GET_8192E_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) /* _P2P_PS_OFFLOAD */ @@ -121,8 +116,6 @@ typedef struct _RSVDPAGE_LOC_92E { /* host message to firmware cmd */ 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 +127,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/rtl8188eu/include/rtl8192e_dm.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192e_dm.h index ff1b341bb811..e2439e9de05a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192e_dm.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192e_dm.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,23 +12,18 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ -void rtl8192e_init_dm_priv(IN PADAPTER Adapter); -void rtl8192e_deinit_dm_priv(IN PADAPTER Adapter); -void rtl8192e_InitHalDm(IN PADAPTER Adapter); -void rtl8192e_HalDmWatchDog(IN PADAPTER Adapter); +void rtl8192e_init_dm_priv(PADAPTER Adapter); +void rtl8192e_deinit_dm_priv(PADAPTER Adapter); +void rtl8192e_InitHalDm(PADAPTER Adapter); +void rtl8192e_HalDmWatchDog(PADAPTER Adapter); -/* VOID rtl8192c_dm_CheckTXPowerTracking(IN PADAPTER Adapter); */ +/* void rtl8192c_dm_CheckTXPowerTracking(PADAPTER Adapter); */ -/* void rtl8192c_dm_RF_Saving(IN PADAPTER pAdapter, IN u8 bForceInNormal); */ +/* void rtl8192c_dm_RF_Saving(PADAPTER pAdapter, u8 bForceInNormal); */ #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192e_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192e_hal.h index dc64a2b99376..2c11d91f56ab 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192e_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192e_hal.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -126,14 +122,21 @@ typedef struct _RT_FIRMWARE_8192E { #endif #define MAX_RX_DMA_BUFFER_SIZE_8192E (RX_DMA_SIZE_8192E-RX_DMA_RESERVED_SIZE_8192E) /*RX 16K*/ + +#define PAGE_SIZE_TX_92E PAGE_SIZE_256 + /* For General Reserved Page Number(Beacon Queue is reserved page) * if (CONFIG_2BCN_EN) Beacon:4, PS-Poll:1, Null Data:1,Prob Rsp:1,Qos Null Data:1 - * Beacon:2, PS-Poll:1, Null Data:1,Prob Rsp:1,Qos Null Data:1 */ -#define RSVD_PAGE_NUM_8192E 0x08 + * Beacon: MAX_BEACON_LEN / PAGE_SIZE_TX_92E + * PS-Poll:1, Null Data:1,Prob Rsp:1,Qos Null Data:1,CTS-2-SELF / LTE QoS Null*/ + +#define RSVD_PAGE_NUM_8192E (MAX_BEACON_LEN / PAGE_SIZE_TX_92E + 6) /*0x08*/ /* For WoWLan , more reserved page - * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, AOAC rpt: 1,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 0x08 + #define WOWLAN_PAGE_NUM_8192E 0x0b #else #define WOWLAN_PAGE_NUM_8192E 0x00 #endif @@ -157,7 +160,6 @@ Total page numbers : 256(0x100) #define TX_PAGE_BOUNDARY_8192E (TX_TOTAL_PAGE_NUMBER_8192E) /* beacon header start address */ -#define PAGE_SIZE_TX_92E PAGE_SIZE_256 #define RSVD_PKT_LEN_92E (TOTAL_RSVD_PAGE_NUMBER_8192E * PAGE_SIZE_TX_92E) #define TX_PAGE_LOAD_FW_BOUNDARY_8192E 0x47 /* 0xA5 */ @@ -265,58 +267,55 @@ BOOLEAN HalDetectPwrDownMode8192E(PADAPTER Adapter); /***********************************************************/ /* RTL8192E-MAC Setting */ -VOID _InitQueueReservedPage_8192E(IN PADAPTER Adapter); -VOID _InitQueuePriority_8192E(IN PADAPTER Adapter); -VOID _InitTxBufferBoundary_8192E(IN PADAPTER Adapter, IN u8 txpktbuf_bndy); -VOID _InitPageBoundary_8192E(IN PADAPTER Adapter); -/* VOID _InitTransferPageSize_8192E(IN PADAPTER Adapter); */ -VOID _InitDriverInfoSize_8192E(IN PADAPTER Adapter, IN u8 drvInfoSize); -VOID _InitRDGSetting_8192E(PADAPTER Adapter); -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); -VOID _InitBeaconParameters_8192E(IN PADAPTER Adapter); -VOID _InitBeaconMaxError_8192E( - IN PADAPTER Adapter, - IN BOOLEAN InfraMode +void _InitQueueReservedPage_8192E(PADAPTER Adapter); +void _InitQueuePriority_8192E(PADAPTER Adapter); +void _InitTxBufferBoundary_8192E(PADAPTER Adapter, u8 txpktbuf_bndy); +void _InitPageBoundary_8192E(PADAPTER Adapter); +/* void _InitTransferPageSize_8192E(PADAPTER Adapter); */ +void _InitDriverInfoSize_8192E(PADAPTER Adapter, u8 drvInfoSize); +void _InitRDGSetting_8192E(PADAPTER Adapter); +void _InitID_8192E(PADAPTER Adapter); +void _InitNetworkType_8192E(PADAPTER Adapter); +void _InitWMACSetting_8192E(PADAPTER Adapter); +void _InitAdaptiveCtrl_8192E(PADAPTER Adapter); +void _InitEDCA_8192E(PADAPTER Adapter); +void _InitRetryFunction_8192E(PADAPTER Adapter); +void _BBTurnOnBlock_8192E(PADAPTER Adapter); +void _InitBeaconParameters_8192E(PADAPTER Adapter); +void _InitBeaconMaxError_8192E( + PADAPTER Adapter, + BOOLEAN InfraMode ); void SetBeaconRelatedRegisters8192E(PADAPTER padapter); -VOID hal_ReadRFType_8192E(PADAPTER Adapter); +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( - IN PADAPTER Adapter, - IN HAL_DEF_VARIABLE eVariable, - IN PVOID pValue + PADAPTER Adapter, + HAL_DEF_VARIABLE eVariable, + void *pValue ); u8 GetHalDefVar8192E( - IN PADAPTER Adapter, - IN HAL_DEF_VARIABLE eVariable, - IN PVOID pValue + PADAPTER Adapter, + HAL_DEF_VARIABLE eVariable, + void *pValue ); void rtl8192e_set_hal_ops(struct hal_ops *pHalFunc); void init_hal_spec_8192e(_adapter *adapter); void rtl8192e_init_default_value(_adapter *padapter); -/* register */ -void SetBcnCtrlReg(PADAPTER padapter, u8 SetBits, u8 ClearBits); void rtl8192e_start_thread(_adapter *padapter); 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/rtl8188eu/include/rtl8192e_led.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192e_led.h index d79bd910e3b1..b276d62b61c9 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192e_led.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192e_led.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,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 +34,4 @@ #endif #endif +#endif/*CONFIG_RTW_SW_LED*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192e_recv.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192e_recv.h index 34f081cc415b..4da33890ea2e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192e_recv.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192e_recv.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,36 +12,31 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ #if defined(CONFIG_USB_HCI) #ifndef MAX_RECVBUF_SZ - #ifdef PLATFORM_OS_CE - #define MAX_RECVBUF_SZ (8192+1024) /* 8K+1k */ + #ifdef CONFIG_MINIMAL_MEMORY_USAGE + #define MAX_RECVBUF_SZ (4000) /* about 4K */ #else - #ifdef CONFIG_MINIMAL_MEMORY_USAGE - #define MAX_RECVBUF_SZ (4000) /* about 4K */ + #ifdef CONFIG_PREALLOC_RX_SKB_BUFFER + #define MAX_RECVBUF_SZ (rtw_rtkm_get_buff_size()) /*depend rtkm*/ + #elif defined(CONFIG_PLATFORM_HISILICON) + #define MAX_RECVBUF_SZ (16384) /* 16k */ #else - #ifdef CONFIG_PREALLOC_RX_SKB_BUFFER - #define MAX_RECVBUF_SZ (rtw_rtkm_get_buff_size()) /*depend rtkm*/ - #elif defined(CONFIG_PLATFORM_HISILICON) - #define MAX_RECVBUF_SZ (16384) /* 16k */ - #else - #define MAX_RECVBUF_SZ (32768) /* 32k */ - #endif - /* #define MAX_RECVBUF_SZ (20480) */ /* 20K */ - /* #define MAX_RECVBUF_SZ (10240) */ /* 10K */ - /* #define MAX_RECVBUF_SZ (16384) */ /* 16k - 92E RX BUF :16K */ - /* #define MAX_RECVBUF_SZ (8192+1024) */ /* 8K+1k */ + #define MAX_RECVBUF_SZ (32768) /* 32k */ #endif + /* #define MAX_RECVBUF_SZ (20480) */ /* 20K */ + /* #define MAX_RECVBUF_SZ (10240) */ /* 10K */ + /* #define MAX_RECVBUF_SZ (16384) */ /* 16k - 92E RX BUF :16K */ + /* #define MAX_RECVBUF_SZ (8192+1024) */ /* 8K+1k */ + #ifdef CONFIG_PLATFORM_NOVATEK_NT72668 + #undef MAX_RECVBUF_SZ + #define MAX_RECVBUF_SZ (15360) /* 15k < 16k */ + #endif /* CONFIG_PLATFORM_NOVATEK_NT72668 */ #endif #endif /* !MAX_RECVBUF_SZ */ @@ -144,6 +140,12 @@ #define GET_RX_STATUS_DESC_UNICAST_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 30, 1) #define GET_RX_STATUS_DESC_MAGIC_WAKE_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+12, 31, 1) +/* DWORD 6 */ +#define GET_RX_STATUS_DESC_SPLCP_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 0, 1) +#define GET_RX_STATUS_DESC_LDPC_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 1, 1) +#define GET_RX_STATUS_DESC_STBC_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 2, 1) +#define GET_RX_STATUS_DESC_BW_92E(__pRxDesc) LE_BITS_TO_4BYTE(__pRxDesc+16, 4, 2) + /* DWORD 5 */ #define GET_RX_STATUS_DESC_TSFL_92E(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc+20, 0, 32) @@ -155,6 +157,7 @@ #ifdef CONFIG_SDIO_HCI s32 rtl8192es_init_recv_priv(PADAPTER padapter); void rtl8192es_free_recv_priv(PADAPTER padapter); + s32 rtl8192es_recv_hdl(_adapter *padapter); #endif #ifdef CONFIG_USB_HCI diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192e_rf.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192e_rf.h index cd344a4ea8e2..523ace9ee990 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192e_rf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192e_rf.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,23 +12,18 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +void PHY_RF6052SetBandwidth8192E( - IN PADAPTER Adapter, - IN CHANNEL_WIDTH Bandwidth); + PADAPTER Adapter, + enum channel_width Bandwidth); int PHY_RF6052_Config_8192E( - IN PADAPTER Adapter); + PADAPTER Adapter); #endif/* __RTL8192E_RF_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192e_spec.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192e_spec.h index 8a5c5f8e52c6..2ff0768f5946 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192e_spec.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192e_spec.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192e_sreset.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192e_sreset.h index 7430d9abf6a4..60e6afae36ea 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192e_sreset.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192e_sreset.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/rtl8192e_xmit.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192e_xmit.h index 23deb8dc4752..40e1e956d9fe 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192e_xmit.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192e_xmit.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -322,9 +318,11 @@ typedef struct txdescriptor_8192e { #define SET_TX_DESC_ANTSEL_D_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 25, 3, __Value) /* Dword 7 */ -#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) +#ifdef CONFIG_PCI_HCI #define SET_TX_DESC_TX_BUFFER_SIZE_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -#else +#endif + +#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_USB_HCI) #define SET_TX_DESC_TX_DESC_CHECKSUM_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) #endif #define SET_TX_DESC_USB_TXAGG_NUM_92E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 24, 8, __Value) @@ -445,6 +443,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/rtl8188eu/include/rtl8192f_cmd.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192f_cmd.h new file mode 100644 index 000000000000..d6e7d12c7c16 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192f_cmd.h @@ -0,0 +1,195 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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 __RTL8192F_CMD_H__ +#define __RTL8192F_CMD_H__ + +/* --------------------------------------------------------------------------------------------------------- + * ---------------------------------- H2C CMD DEFINITION ------------------------------------------------ + * --------------------------------------------------------------------------------------------------------- */ + +enum h2c_cmd_8192F { + /* Common Class: 000 */ + H2C_8192F_RSVD_PAGE = 0x00, + H2C_8192F_MEDIA_STATUS_RPT = 0x01, + H2C_8192F_SCAN_ENABLE = 0x02, + H2C_8192F_KEEP_ALIVE = 0x03, + H2C_8192F_DISCON_DECISION = 0x04, + H2C_8192F_PSD_OFFLOAD = 0x05, + H2C_8192F_AP_OFFLOAD = 0x08, + H2C_8192F_BCN_RSVDPAGE = 0x09, + H2C_8192F_PROBERSP_RSVDPAGE = 0x0A, + H2C_8192F_FCS_RSVDPAGE = 0x10, + H2C_8192F_FCS_INFO = 0x11, + H2C_8192F_AP_WOW_GPIO_CTRL = 0x13, + + /* PoweSave Class: 001 */ + H2C_8192F_SET_PWR_MODE = 0x20, + H2C_8192F_PS_TUNING_PARA = 0x21, + H2C_8192F_PS_TUNING_PARA2 = 0x22, + H2C_8192F_P2P_LPS_PARAM = 0x23, + H2C_8192F_P2P_PS_OFFLOAD = 0x24, + H2C_8192F_PS_SCAN_ENABLE = 0x25, + H2C_8192F_SAP_PS_ = 0x26, + H2C_8192F_INACTIVE_PS_ = 0x27,/* Inactive_PS */ + H2C_8192F_FWLPS_IN_IPS_ = 0x28, + + /* Dynamic Mechanism Class: 010 */ + H2C_8192F_MACID_CFG = 0x40, + H2C_8192F_TXBF = 0x41, + H2C_8192F_RSSI_SETTING = 0x42, + H2C_8192F_AP_REQ_TXRPT = 0x43, + H2C_8192F_INIT_RATE_COLLECT = 0x44, + H2C_8192F_RA_PARA_ADJUST = 0x46, + + /* BT Class: 011 */ + H2C_8192F_B_TYPE_TDMA = 0x60, + H2C_8192F_BT_INFO = 0x61, + H2C_8192F_FORCE_BT_TXPWR = 0x62, + H2C_8192F_BT_IGNORE_WLANACT = 0x63, + H2C_8192F_DAC_SWING_VALUE = 0x64, + H2C_8192F_ANT_SEL_RSV = 0x65, + H2C_8192F_WL_OPMODE = 0x66, + H2C_8192F_BT_MP_OPER = 0x67, + H2C_8192F_BT_CONTROL = 0x68, + H2C_8192F_BT_WIFI_CTRL = 0x69, + H2C_8192F_BT_FW_PATCH = 0x6A, + H2C_8192F_BT_WLAN_CALIBRATION = 0x6D, + + /* WOWLAN Class: 100 */ + H2C_8192F_WOWLAN = 0x80, + H2C_8192F_REMOTE_WAKE_CTRL = 0x81, + H2C_8192F_AOAC_GLOBAL_INFO = 0x82, + H2C_8192F_AOAC_RSVD_PAGE = 0x83, + H2C_8192F_AOAC_RSVD_PAGE2 = 0x84, + H2C_8192F_D0_SCAN_OFFLOAD_CTRL = 0x85, + H2C_8192F_D0_SCAN_OFFLOAD_INFO = 0x86, + H2C_8192F_CHNL_SWITCH_OFFLOAD = 0x87, + H2C_8192F_P2P_OFFLOAD_RSVD_PAGE = 0x8A, + H2C_8192F_P2P_OFFLOAD = 0x8B, + + H2C_8192F_RESET_TSF = 0xC0, + H2C_8192F_MAXID, +}; + +/* --------------------------------------------------------------------------------------------------------- + * ---------------------------------- H2C CMD CONTENT -------------------------------------------------- + * --------------------------------------------------------------------------------------------------------- + * _RSVDPAGE_LOC_CMD_0x00 */ +#define SET_8192F_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) +#define SET_8192F_H2CCMD_RSVDPAGE_LOC_PSPOLL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) +#define SET_8192F_H2CCMD_RSVDPAGE_LOC_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) +#define SET_8192F_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) +#define SET_8192F_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) + +/*_MEDIA_STATUS_RPT_PARM_CMD_0x01*/ +#define SET_8192F_H2CCMD_MSRRPT_PARM_OPMODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) +#define SET_8192F_H2CCMD_MSRRPT_PARM_MACID_IND(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) +#define SET_8192F_H2CCMD_MSRRPT_PARM_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) +#define SET_8192F_H2CCMD_MSRRPT_PARM_MACID_END(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) +/* _PWR_MOD_CMD_0x20 */ +#define SET_8192F_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) +#define SET_8192F_H2CCMD_PWRMODE_PARM_RLBM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 4, __Value) +#define SET_8192F_H2CCMD_PWRMODE_PARM_SMART_PS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 4, 4, __Value) +#define SET_8192F_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) +#define SET_8192F_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) +#define SET_8192F_H2CCMD_PWRMODE_PARM_BCN_EARLY_C2H_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 2, 1, __Value) +#define SET_8192F_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) + +#define GET_8192F_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) + +/* _PS_TUNE_PARAM_CMD_0x21 */ +#define SET_8192F_H2CCMD_PSTUNE_PARM_BCN_TO_LIMIT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) +#define SET_8192F_H2CCMD_PSTUNE_PARM_DTIM_TIMEOUT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) +#define SET_8192F_H2CCMD_PSTUNE_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 1, __Value) +#define SET_8192F_H2CCMD_PSTUNE_PARM_PS_TIMEOUT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 1, 7, __Value) +#define SET_8192F_H2CCMD_PSTUNE_PARM_DTIM_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) + +/* _MACID_CFG_CMD_0x40 */ +#define SET_8192F_H2CCMD_MACID_CFG_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) +#define SET_8192F_H2CCMD_MACID_CFG_RAID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 5, __Value) +#define SET_8192F_H2CCMD_MACID_CFG_SGI_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 7, 1, __Value) +#define SET_8192F_H2CCMD_MACID_CFG_BW(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 2, __Value) +#define SET_8192F_H2CCMD_MACID_CFG_NO_UPDATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 3, 1, __Value) +#define SET_8192F_H2CCMD_MACID_CFG_VHT_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 4, 2, __Value) +#define SET_8192F_H2CCMD_MACID_CFG_DISPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 6, 1, __Value) +#define SET_8192F_H2CCMD_MACID_CFG_DISRA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 7, 1, __Value) +#define SET_8192F_H2CCMD_MACID_CFG_RATE_MASK0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) +#define SET_8192F_H2CCMD_MACID_CFG_RATE_MASK1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) +#define SET_8192F_H2CCMD_MACID_CFG_RATE_MASK2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+5, 0, 8, __Value) +#define SET_8192F_H2CCMD_MACID_CFG_RATE_MASK3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+6, 0, 8, __Value) + +/* _RSSI_SETTING_CMD_0x42 */ +#define SET_8192F_H2CCMD_RSSI_SETTING_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) +#define SET_8192F_H2CCMD_RSSI_SETTING_RSSI(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 7, __Value) +#define SET_8192F_H2CCMD_RSSI_SETTING_ULDL_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) + +/* _AP_REQ_TXRPT_CMD_0x43 */ +#define SET_8192F_H2CCMD_APREQRPT_PARM_MACID1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) +#define SET_8192F_H2CCMD_APREQRPT_PARM_MACID2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) + +/* _FORCE_BT_TXPWR_CMD_0x62 */ +#define SET_8192F_H2CCMD_BT_PWR_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) + +/* _FORCE_BT_MP_OPER_CMD_0x67 */ +#define SET_8192F_H2CCMD_BT_MPOPER_VER(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 4, __Value) +#define SET_8192F_H2CCMD_BT_MPOPER_REQNUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 4, __Value) +#define SET_8192F_H2CCMD_BT_MPOPER_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) +#define SET_8192F_H2CCMD_BT_MPOPER_PARAM1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) +#define SET_8192F_H2CCMD_BT_MPOPER_PARAM2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) +#define SET_8192F_H2CCMD_BT_MPOPER_PARAM3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) + +/* _BT_FW_PATCH_0x6A */ +#define SET_8192F_H2CCMD_BT_FW_PATCH_SIZE(__pH2CCmd, __Value) SET_BITS_TO_LE_2BYTE((u8 *)(__pH2CCmd), 0, 16, __Value) +#define SET_8192F_H2CCMD_BT_FW_PATCH_ADDR0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) +#define SET_8192F_H2CCMD_BT_FW_PATCH_ADDR1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) +#define SET_8192F_H2CCMD_BT_FW_PATCH_ADDR2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) +#define SET_8192F_H2CCMD_BT_FW_PATCH_ADDR3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) + +/* --------------------------------------------------------------------------------------------------------- + * ------------------------------------------- Structure -------------------------------------------------- + * --------------------------------------------------------------------------------------------------------- */ + + +/* --------------------------------------------------------------------------------------------------------- + * ---------------------------------- Function Statement -------------------------------------------------- + * --------------------------------------------------------------------------------------------------------- */ + +/* host message to firmware cmd */ +void rtl8192f_set_FwPwrMode_cmd(PADAPTER padapter, u8 Mode); +void rtl8192f_set_FwJoinBssRpt_cmd(PADAPTER padapter, u8 mstatus); +/* s32 rtl8192f__set_lowpwr_lps_cmd(PADAPTER padapter, u8 enable); */ +void rtl8192f_set_FwPsTuneParam_cmd(PADAPTER padapter); +void rtl8192f_download_rsvd_page(PADAPTER padapter, u8 mstatus); +#ifdef CONFIG_BT_COEXIST + void rtl8192f__download_BTCoex_AP_mode_rsvd_page(PADAPTER padapter); +#endif /* CONFIG_BT_COEXIST */ +#ifdef CONFIG_P2P + void rtl8192f_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); +#endif /* CONFIG_P2P */ + +#ifdef CONFIG_TDLS +#ifdef CONFIG_TDLS_CH_SW +void rtl8192f_set_BcnEarly_C2H_Rpt_cmd(PADAPTER padapter, u8 enable); +#endif +#endif + +#ifdef CONFIG_P2P_WOWLAN + void rtl8192f_set_p2p_wowlan_offload_cmd(PADAPTER padapter); +#endif + +s32 FillH2CCmd8192F(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); +u8 GetTxBufferRsvdPageNum8192F(_adapter *padapter, bool wowlan); +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192f_dm.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192f_dm.h new file mode 100644 index 000000000000..5185d5c359fa --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192f_dm.h @@ -0,0 +1,28 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * 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 __RTL8192F_DM_H__ +#define __RTL8192F_DM_H__ + +void rtl8192f_init_dm_priv(PADAPTER Adapter); +void rtl8192f_deinit_dm_priv(PADAPTER Adapter); +void rtl8192f_InitHalDm(PADAPTER Adapter); +void rtl8192f_HalDmWatchDog(PADAPTER Adapter); + +/* void rtl8192c_dm_CheckTXPowerTracking(PADAPTER Adapter); */ + +/* void rtl8192c_dm_RF_Saving(PADAPTER pAdapter, u8 bForceInNormal); */ + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192f_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192f_hal.h new file mode 100644 index 000000000000..6e4d0d8c1d2e --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192f_hal.h @@ -0,0 +1,316 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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 __RTL8192F_HAL_H__ +#define __RTL8192F_HAL_H__ + +#include "hal_data.h" + +#include "rtl8192f_spec.h" +#include "rtl8192f_rf.h" +#include "rtl8192f_dm.h" +#include "rtl8192f_recv.h" +#include "rtl8192f_xmit.h" +#include "rtl8192f_cmd.h" +#include "rtl8192f_led.h" +#include "Hal8192FPwrSeq.h" +#include "Hal8192FPhyReg.h" +#include "Hal8192FPhyCfg.h" +#ifdef DBG_CONFIG_ERROR_DETECT +#include "rtl8192f_sreset.h" +#endif +#ifdef CONFIG_LPS_POFF + #include "rtl8192f_lps_poff.h" +#endif + +#define FW_8192F_SIZE 0x8000 +#define FW_8192F_START_ADDRESS 0x4000 +#define FW_8192F_END_ADDRESS 0x5000 /* brian_zhang@realsil.com.cn */ + +#define IS_FW_HEADER_EXIST_8192F(_pFwHdr)\ + ((le16_to_cpu(_pFwHdr->Signature) & 0xFFF0) == 0x92F0) + +typedef struct _RT_FIRMWARE { + FIRMWARE_SOURCE eFWSource; +#ifdef CONFIG_EMBEDDED_FWIMG + u8 *szFwBuffer; +#else + u8 szFwBuffer[FW_8192F_SIZE]; +#endif + u32 ulFwLength; +} RT_FIRMWARE_8192F, *PRT_FIRMWARE_8192F; + +/* + * This structure must be cared byte-ordering + * + * Added by tynli. 2009.12.04. */ +typedef struct _RT_8192F_FIRMWARE_HDR { + /* 8-byte alinment required */ + + /* --- LONG WORD 0 ---- */ + u16 Signature; /* 92C0: test chip; 92C, 88C0: test chip; 88C1: MP A-cut; 92C1: MP A-cut */ + u8 Category; /* AP/NIC and USB/PCI */ + u8 Function; /* Reserved for different FW function indcation, for further use when driver needs to download different FW in different conditions */ + u16 Version; /* FW Version */ + u16 Subversion; /* FW Subversion, default 0x00 */ + + /* --- LONG WORD 1 ---- */ + u8 Month; /* Release time Month field */ + u8 Date; /* Release time Date field */ + u8 Hour; /* Release time Hour field */ + u8 Minute; /* Release time Minute field */ + u16 RamCodeSize; /* The size of RAM code */ + u16 Rsvd2; + + /* --- LONG WORD 2 ---- */ + u32 SvnIdx; /* The SVN entry index */ + u32 Rsvd3; + + /* --- LONG WORD 3 ---- */ + u32 Rsvd4; + u32 Rsvd5; +} RT_8192F_FIRMWARE_HDR, *PRT_8192F_FIRMWARE_HDR; +#define DRIVER_EARLY_INT_TIME_8192F 0x05 +#define BCN_DMA_ATIME_INT_TIME_8192F 0x02 +/* for 8192F + * TX 64K, RX 16K, Page size 256B for TX*/ +#define PAGE_SIZE_TX_8192F 256 +#define PAGE_SIZE_RX_8192F 8 +#define TX_DMA_SIZE_8192F 0x10000/* 64K(TX) */ +#define RX_DMA_SIZE_8192F 0x4000/* 16K(RX) */ +#ifdef CONFIG_WOWLAN + #define RESV_FMWF (WKFMCAM_SIZE * MAX_WKFM_CAM_NUM) /* 16 entries, for each is 24 bytes*/ +#else + #define RESV_FMWF 0 +#endif + +#ifdef CONFIG_FW_C2H_DEBUG + #define RX_DMA_RESERVED_SIZE_8192F 0x100 /* 256B, reserved for c2h debug message */ +#else + #define RX_DMA_RESERVED_SIZE_8192F 0xc0 /* 192B, reserved for tx report 24*8=192*/ +#endif +#define RX_DMA_BOUNDARY_8192F\ + (RX_DMA_SIZE_8192F - RX_DMA_RESERVED_SIZE_8192F - 1) + + +/* Note: We will divide number of page equally for each queue other than public queue! */ + +/* For General Reserved Page Number(Beacon Queue is reserved page) + * Beacon:MAX_BEACON_LEN/PAGE_SIZE_TX_8192F + * PS-Poll:1, Null Data:1,Qos Null Data:1,BT Qos Null Data:1,CTS-2-SELF,LTE QoS Null*/ +#define BCNQ_PAGE_NUM_8192F (MAX_BEACON_LEN/PAGE_SIZE_TX_8192F + 6) /*0x08*/ + + +/* For WoWLan , more reserved page + * 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_8192F 0x07 +#else + #define WOWLAN_PAGE_NUM_8192F 0x00 +#endif + +#ifdef CONFIG_PNO_SUPPORT + #undef WOWLAN_PAGE_NUM_8192F + #define WOWLAN_PAGE_NUM_8192F 0x15 +#endif + +#ifdef CONFIG_AP_WOWLAN + #define AP_WOWLAN_PAGE_NUM_8192F 0x02 +#endif + +#ifdef DBG_LA_MODE + #define LA_MODE_PAGE_NUM 0xE0 +#endif + +#define MAX_RX_DMA_BUFFER_SIZE_8192F (RX_DMA_SIZE_8192F - RX_DMA_RESERVED_SIZE_8192F) + +#ifdef DBG_LA_MODE + #define TX_TOTAL_PAGE_NUMBER_8192F (0xFF - LA_MODE_PAGE_NUM) +#else + #define TX_TOTAL_PAGE_NUMBER_8192F (0xFF - BCNQ_PAGE_NUM_8192F - WOWLAN_PAGE_NUM_8192F) +#endif + +#define TX_PAGE_BOUNDARY_8192F (TX_TOTAL_PAGE_NUMBER_8192F + 1) + +#define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8192F \ + TX_TOTAL_PAGE_NUMBER_8192F +#define WMM_NORMAL_TX_PAGE_BOUNDARY_8192F \ + (WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8192F + 1) + +/* For Normal Chip Setting + * (HPQ + LPQ + NPQ + PUBQ) shall be TX_TOTAL_PAGE_NUMBER_8192F */ +#define NORMAL_PAGE_NUM_HPQ_8192F 0x8 +#define NORMAL_PAGE_NUM_LPQ_8192F 0x8 +#define NORMAL_PAGE_NUM_NPQ_8192F 0x8 +#define NORMAL_PAGE_NUM_EPQ_8192F 0x00 + +/* Note: For Normal Chip Setting, modify later */ +#define WMM_NORMAL_PAGE_NUM_HPQ_8192F 0x30 +#define WMM_NORMAL_PAGE_NUM_LPQ_8192F 0x20 +#define WMM_NORMAL_PAGE_NUM_NPQ_8192F 0x20 +#define WMM_NORMAL_PAGE_NUM_EPQ_8192F 0x00 + + +#include "HalVerDef.h" +#include "hal_com.h" + +#define EFUSE_OOB_PROTECT_BYTES 56 /*0x1C8~0x1FF*/ + +#define HAL_EFUSE_MEMORY +#define HWSET_MAX_SIZE_8192F 512 +#define EFUSE_REAL_CONTENT_LEN_8192F 512 +#define EFUSE_MAP_LEN_8192F 512 +#define EFUSE_MAX_SECTION_8192F 64 + +/* For some inferiority IC purpose. added by Roger, 2009.09.02.*/ +#define EFUSE_IC_ID_OFFSET 506 +#define AVAILABLE_EFUSE_ADDR(addr) (addr < EFUSE_REAL_CONTENT_LEN_8192F) + +#define EFUSE_ACCESS_ON 0x69 +#define EFUSE_ACCESS_OFF 0x00 + +/* ******************************************************** + * EFUSE for BT definition + * ******************************************************** */ +#define BANK_NUM 1 +#define EFUSE_BT_REAL_BANK_CONTENT_LEN 512 +#define EFUSE_BT_REAL_CONTENT_LEN 1536/*512 * 3 */ +/* (EFUSE_BT_REAL_BANK_CONTENT_LEN * BANK_NUM)*/ +#define EFUSE_BT_MAP_LEN 1024 /* 1k bytes */ +#define EFUSE_BT_MAX_SECTION 128 /* 1024/8 */ +#define EFUSE_PROTECT_BYTES_BANK 16 + +typedef enum tag_Package_Definition { + PACKAGE_DEFAULT, + PACKAGE_QFN32, + PACKAGE_QFN40, + PACKAGE_QFN46 +} PACKAGE_TYPE_E; + +#define INCLUDE_MULTI_FUNC_BT(_Adapter) \ + (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_BT) +#define INCLUDE_MULTI_FUNC_GPS(_Adapter) \ + (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_GPS) + +#ifdef CONFIG_FILE_FWIMG + extern char *rtw_fw_file_path; + extern char *rtw_fw_wow_file_path; + #ifdef CONFIG_MP_INCLUDED + extern char *rtw_fw_mp_bt_file_path; + #endif /* CONFIG_MP_INCLUDED */ +#endif /* CONFIG_FILE_FWIMG */ + +/* rtl8192f_hal_init.c */ +s32 rtl8192f_FirmwareDownload(PADAPTER padapter, BOOLEAN bUsedWoWLANFw); +void rtl8192f_FirmwareSelfReset(PADAPTER padapter); +void rtl8192f_InitializeFirmwareVars(PADAPTER padapter); + +void rtl8192f_InitAntenna_Selection(PADAPTER padapter); +void rtl8192f_DeinitAntenna_Selection(PADAPTER padapter); +void rtl8192f_CheckAntenna_Selection(PADAPTER padapter); +void rtl8192f_init_default_value(PADAPTER padapter); + +s32 rtl8192f_InitLLTTable(PADAPTER padapter); + +s32 CardDisableHWSM(PADAPTER padapter, u8 resetMCU); +s32 CardDisableWithoutHWSM(PADAPTER padapter); + +/* EFuse */ +u8 GetEEPROMSize8192F(PADAPTER padapter); +void Hal_InitPGData(PADAPTER padapter, u8 *PROMContent); +void Hal_EfuseParseIDCode(PADAPTER padapter, u8 *hwinfo); +void Hal_EfuseParseTxPowerInfo_8192F(PADAPTER padapter, + u8 *PROMContent, BOOLEAN AutoLoadFail); +/* +void Hal_EfuseParseBTCoexistInfo_8192F(PADAPTER padapter, + u8 *hwinfo, BOOLEAN AutoLoadFail); +*/ +void Hal_EfuseParseEEPROMVer_8192F(PADAPTER padapter, + u8 *hwinfo, BOOLEAN AutoLoadFail); +void Hal_EfuseParseChnlPlan_8192F(PADAPTER padapter, + u8 *hwinfo, BOOLEAN AutoLoadFail); +void Hal_EfuseParseCustomerID_8192F(PADAPTER padapter, + u8 *hwinfo, BOOLEAN AutoLoadFail); +void Hal_EfuseParseAntennaDiversity_8192F(PADAPTER padapter, + u8 *hwinfo, BOOLEAN AutoLoadFail); +void Hal_EfuseParseXtal_8192F(PADAPTER pAdapter, + u8 *hwinfo, u8 AutoLoadFail); +void Hal_EfuseParseThermalMeter_8192F(PADAPTER padapter, + u8 *hwinfo, u8 AutoLoadFail); +void Hal_EfuseParseVoltage_8192F(PADAPTER pAdapter, + u8 *hwinfo, BOOLEAN AutoLoadFail); +void Hal_EfuseParseBoardType_8192F(PADAPTER Adapter, + u8 *PROMContent, BOOLEAN AutoloadFail); +u8 Hal_ReadRFEType_8192F(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); +void rtl8192f_set_hal_ops(struct hal_ops *pHalFunc); +void init_hal_spec_8192f(_adapter *adapter); +u8 SetHwReg8192F(PADAPTER padapter, u8 variable, u8 *val); +void GetHwReg8192F(PADAPTER padapter, u8 variable, u8 *val); +u8 SetHalDefVar8192F(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); +u8 GetHalDefVar8192F(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); + +/* register */ +void rtl8192f_InitBeaconParameters(PADAPTER padapter); +void rtl8192f_InitBeaconMaxError(PADAPTER padapter, u8 InfraMode); + +void _InitMacAPLLSetting_8192F(PADAPTER Adapter); +void _8051Reset8192F(PADAPTER padapter); +#ifdef CONFIG_WOWLAN + void Hal_DetectWoWMode(PADAPTER pAdapter); +#endif /* CONFIG_WOWLAN */ + +void rtl8192f_start_thread(_adapter *padapter); +void rtl8192f_stop_thread(_adapter *padapter); + +#if defined(CONFIG_CHECK_BT_HANG) && defined(CONFIG_BT_COEXIST) + void rtl8192fs_init_checkbthang_workqueue(_adapter *adapter); + void rtl8192fs_free_checkbthang_workqueue(_adapter *adapter); + void rtl8192fs_cancle_checkbthang_workqueue(_adapter *adapter); + void rtl8192fs_hal_check_bt_hang(_adapter *adapter); +#endif + +#ifdef CONFIG_GPIO_WAKEUP + void HalSetOutPutGPIO(PADAPTER padapter, u8 index, u8 OutPutValue); +#endif +#ifdef CONFIG_MP_INCLUDED +int FirmwareDownloadBT(PADAPTER Adapter, PRT_MP_FIRMWARE pFirmware); +#endif +void CCX_FwC2HTxRpt_8192f(PADAPTER padapter, u8 *pdata, u8 len); + +u8 MRateToHwRate8192F(u8 rate); +u8 HwRateToMRate8192F(u8 rate); + +#if defined(CONFIG_CHECK_BT_HANG) && defined(CONFIG_BT_COEXIST) + void check_bt_status_work(void *data); +#endif + + +void rtl8192f_cal_txdesc_chksum(struct tx_desc *ptxdesc); + +#ifdef CONFIG_AMPDU_PRETX_CD +void rtl8192f_pretx_cd_config(_adapter *adapter); +#endif + +#ifdef CONFIG_PCI_HCI + BOOLEAN InterruptRecognized8192FE(PADAPTER Adapter); + void UpdateInterruptMask8192FE(PADAPTER Adapter, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); + void InitMAC_TRXBD_8192FE(PADAPTER Adapter); + + u16 get_txbd_rw_reg(u16 ff_hwaddr); +#endif + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192f_led.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192f_led.h new file mode 100644 index 000000000000..f86442f1ce8a --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192f_led.h @@ -0,0 +1,43 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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 __RTL8192F_LED_H__ +#define __RTL8192F_LED_H__ + +#include +#include +#include + +#ifdef CONFIG_RTW_SW_LED +/* ******************************************************************************** + * Interface to manipulate LED objects. + * ******************************************************************************** */ +#ifdef CONFIG_USB_HCI +void rtl8192fu_InitSwLeds(PADAPTER padapter); +void rtl8192fu_DeInitSwLeds(PADAPTER padapter); +#endif + +#ifdef CONFIG_SDIO_HCI +void rtl8192fs_InitSwLeds(PADAPTER padapter); +void rtl8192fs_DeInitSwLeds(PADAPTER padapter); +#endif + +#ifdef CONFIG_PCI_HCI +void rtl8192fe_InitSwLeds(PADAPTER padapter); +void rtl8192fe_DeInitSwLeds(PADAPTER padapter); +#endif +#endif /*#ifdef CONFIG_RTW_SW_LED*/ + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192f_recv.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192f_recv.h new file mode 100644 index 000000000000..064d13b9c463 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192f_recv.h @@ -0,0 +1,108 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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 __RTL8192F_RECV_H__ +#define __RTL8192F_RECV_H__ + +#define RECV_BLK_SZ 512 +#define RECV_BLK_CNT 16 +#define RECV_BLK_TH RECV_BLK_CNT + +#if defined(CONFIG_USB_HCI) + + #ifndef MAX_RECVBUF_SZ + #ifndef CONFIG_MINIMAL_MEMORY_USAGE + /* #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 (32768) /* 32k */ + #endif + /* #define MAX_RECVBUF_SZ (8192+1024) */ /* 8K+1k */ + #else + #define MAX_RECVBUF_SZ (4000) /* about 4K */ + #endif + #endif /* !MAX_RECVBUF_SZ */ + +#elif defined(CONFIG_PCI_HCI) + #define MAX_RECVBUF_SZ (4000) /* about 4K */ + +#elif defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) + + #define MAX_RECVBUF_SZ (RX_DMA_BOUNDARY_8192F + 1) + +#endif + +/* Rx smooth factor */ +#define Rx_Smooth_Factor (20) + +#ifdef CONFIG_SDIO_HCI + #ifndef CONFIG_SDIO_RX_COPY + #undef MAX_RECVBUF_SZ + #define MAX_RECVBUF_SZ (RX_DMA_SIZE_8192F - RX_DMA_RESERVED_SIZE_8192F) + #endif /* !CONFIG_SDIO_RX_COPY */ +#endif /* CONFIG_SDIO_HCI */ + +/*-----------------------------------------------------------------*/ +/* RTL8192F RX BUFFER DESC */ +/*-----------------------------------------------------------------*/ +/*DWORD 0*/ +#define SET_RX_BUFFER_DESC_DATA_LENGTH_8192F(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 0, 14, __Value) +#define SET_RX_BUFFER_DESC_LS_8192F(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 15, 1, __Value) +#define SET_RX_BUFFER_DESC_FS_8192F(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 16, 1, __Value) +#define SET_RX_BUFFER_DESC_TOTAL_LENGTH_8192F(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 16, 15, __Value) + +#define GET_RX_BUFFER_DESC_OWN_8192F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 31, 1) +#define GET_RX_BUFFER_DESC_LS_8192F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 15, 1) +#define GET_RX_BUFFER_DESC_FS_8192F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 1) +#ifdef USING_RX_TAG + #define GET_RX_BUFFER_DESC_RX_TAG_8192F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 13) +#else + #define GET_RX_BUFFER_DESC_TOTAL_LENGTH_8192F(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 15) +#endif + +/*DWORD 1*/ +#define SET_RX_BUFFER_PHYSICAL_LOW_8192F(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc+4, 0, 32, __Value) + +/*DWORD 2*/ +#ifdef CONFIG_64BIT_DMA + #define SET_RX_BUFFER_PHYSICAL_HIGH_8192F(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc+8, 0, 32, __Value) +#else + #define SET_RX_BUFFER_PHYSICAL_HIGH_8192F(__pRxStatusDesc, __Value) +#endif + + +#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) + s32 rtl8192fs_init_recv_priv(PADAPTER padapter); + void rtl8192fs_free_recv_priv(PADAPTER padapter); + s32 rtl8192fs_recv_hdl(_adapter *padapter); +#endif + +#ifdef CONFIG_USB_HCI + int rtl8192fu_init_recv_priv(_adapter *padapter); + void rtl8192fu_free_recv_priv(_adapter *padapter); + void rtl8192fu_init_recvbuf(_adapter *padapter, struct recv_buf *precvbuf); +#endif + +#ifdef CONFIG_PCI_HCI + s32 rtl8192fe_init_recv_priv(_adapter *padapter); + void rtl8192fe_free_recv_priv(_adapter *padapter); +#endif + +void rtl8192f_query_rx_desc_status(union recv_frame *precvframe, u8 *pdesc); + +#endif /* __RTL8192F_RECV_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192f_rf.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192f_rf.h new file mode 100644 index 000000000000..903e2c9b063e --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192f_rf.h @@ -0,0 +1,23 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * 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 __RTL8192F_RF_H__ +#define __RTL8192F_RF_H__ + +int PHY_RF6052_Config8192F(PADAPTER pdapter); + +void PHY_RF6052SetBandwidth8192F(PADAPTER Adapter, enum channel_width Bandwidth); + +#endif/* __RTL8192F_RF_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192f_spec.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192f_spec.h new file mode 100644 index 000000000000..6b3b77beec67 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192f_spec.h @@ -0,0 +1,539 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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 __RTL8192F_SPEC_H__ +#define __RTL8192F_SPEC_H__ + +#include + + +#define HAL_NAV_UPPER_UNIT_8192F 128 /* micro-second */ + +/* ----------------------------------------------------- + * + * 0x0000h ~ 0x00FFh System Configuration + * + * ----------------------------------------------------- */ +#define REG_SYS_ISO_CTRL_8192F 0x0000 /* 2 Byte */ +#define REG_SYS_FUNC_EN_8192F 0x0002 /* 2 Byte */ +#define REG_APS_FSMCO_8192F 0x0004 /* 4 Byte */ +#define REG_SYS_CLKR_8192F 0x0008 /* 2 Byte */ +#define REG_9346CR_8192F 0x000A /* 2 Byte */ +#define REG_EE_VPD_8192F 0x000C /* 2 Byte */ +#define REG_AFE_MISC_8192F 0x0010 /* 1 Byte */ +#define REG_SPS0_CTRL_8192F 0x0011 /* 7 Byte */ +#define REG_SPS_OCP_CFG_8192F 0x0018 /* 4 Byte */ +#define REG_RSV_CTRL_8192F 0x001C /* 3 Byte */ +#define REG_RF_CTRL_8192F 0x001F /* 1 Byte */ +#define REG_LPLDO_CTRL_8192F 0x0023 /* 1 Byte */ +#define REG_AFE_XTAL_CTRL_8192F 0x0024 /* 4 Byte */ +#define REG_AFE_PLL_CTRL_8192F 0x0028 /* 4 Byte */ +#define REG_MAC_PLL_CTRL_EXT_8192F 0x002c /* 4 Byte */ +#define REG_EFUSE_CTRL_8192F 0x0030 +#define REG_EFUSE_TEST_8192F 0x0034 +#define REG_PWR_DATA_8192F 0x0038 +#define REG_CAL_TIMER_8192F 0x003C +#define REG_ACLK_MON_8192F 0x003E +#define REG_GPIO_MUXCFG_8192F 0x0040 +#define REG_GPIO_IO_SEL_8192F 0x0042 +#define REG_MAC_PINMUX_CFG_8192F 0x0043 +#define REG_GPIO_PIN_CTRL_8192F 0x0044 +#define REG_GPIO_INTM_8192F 0x0048 +#define REG_LEDCFG0_8192F 0x004C +#define REG_LEDCFG1_8192F 0x004D +#define REG_LEDCFG2_8192F 0x004E +#define REG_LEDCFG3_8192F 0x004F +#define REG_FSIMR_8192F 0x0050 +#define REG_FSISR_8192F 0x0054 +#define REG_HSIMR_8192F 0x0058 +#define REG_HSISR_8192F 0x005c +#define REG_GPIO_EXT_CTRL 0x0060 +#define REG_PAD_CTRL1_8192F 0x0064 +#define REG_MULTI_FUNC_CTRL_8192F 0x0068 +#define REG_GPIO_STATUS_8192F 0x006C +#define REG_SDIO_CTRL_8192F 0x0070 +#define REG_OPT_CTRL_8192F 0x0074 +#define REG_AFE_CTRL_4_8192F 0x0078 +#define REG_MCUFWDL_8192F 0x0080 +#define REG_8051FW_CTRL_8192F 0x0080 +#define REG_HMEBOX_DBG_0_8192F 0x0088 +#define REG_HMEBOX_DBG_1_8192F 0x008A +#define REG_HMEBOX_DBG_2_8192F 0x008C +#define REG_HMEBOX_DBG_3_8192F 0x008E +#define REG_WLLPS_CTRL 0x0090 +#define REG_HIMR0_8192F 0x00B0 +#define REG_HISR0_8192F 0x00B4 +#define REG_HIMR1_8192F 0x00B8 +#define REG_HISR1_8192F 0x00BC +#define REG_PMC_DBG_CTRL2_8192F 0x00CC +#define REG_EFUSE_BURN_GNT_8192F 0x00CF +#define REG_HPON_FSM_8192F 0x00EC +#define REG_SYS_CFG1_8192F 0x00F0 +#define REG_SYS_CFG2_8192F 0x00FC +#define REG_ROM_VERSION 0x00FD + +/* ----------------------------------------------------- + * + * 0x0100h ~ 0x01FFh MACTOP General Configuration + * + * ----------------------------------------------------- */ +#define REG_CR_8192F 0x0100 +#define REG_PBP_8192F 0x0104 +#define REG_PKT_BUFF_ACCESS_CTRL_8192F 0x0106 +#define REG_TRXDMA_CTRL_8192F 0x010C +#define REG_TRXFF_BNDY_8192F 0x0114 +#define REG_TRXFF_STATUS_8192F 0x0118 +#define REG_RXFF_PTR_8192F 0x011C +#define REG_CPWM_8192F 0x012C +#define REG_FWIMR_8192F 0x0130 +#define REG_FWISR_8192F 0x0134 +#define REG_FTIMR_8192F 0x0138 +#define REG_PKTBUF_DBG_CTRL_8192F 0x0140 +#define REG_RXPKTBUF_CTRL_8192F 0x0142 +#define REG_PKTBUF_DBG_DATA_L_8192F 0x0144 +#define REG_PKTBUF_DBG_DATA_H_8192F 0x0148 + +#define REG_TC0_CTRL_8192F 0x0150 +#define REG_TC1_CTRL_8192F 0x0154 +#define REG_TC2_CTRL_8192F 0x0158 +#define REG_TC3_CTRL_8192F 0x015C +#define REG_TC4_CTRL_8192F 0x0160 +#define REG_TCUNIT_BASE_8192F 0x0164 +#define REG_RSVD3_8192F 0x0168 +#define REG_C2HEVT_CMD_ID_8192F 0x01A0 +#define REG_C2HEVT_CMD_SEQ_88XX 0x01A1 +#define REG_C2hEVT_CMD_CONTENT_88XX 0x01A2 +#define REG_C2HEVT_CMD_LEN_8192F 0x01AE +#define REG_C2HEVT_CLEAR_8192F 0x01AF +#define REG_MCUTST_1_8192F 0x01C0 +#define REG_WOWLAN_WAKE_REASON 0x01C7 +#define REG_FMETHR_8192F 0x01C8 +#define REG_HMETFR_8192F 0x01CC +#define REG_HMEBOX_0_8192F 0x01D0 +#define REG_HMEBOX_1_8192F 0x01D4 +#define REG_HMEBOX_2_8192F 0x01D8 +#define REG_HMEBOX_3_8192F 0x01DC +#define REG_LLT_INIT_8192F 0x01E0 +#define REG_HMEBOX_EXT0_8192F 0x01F0 +#define REG_HMEBOX_EXT1_8192F 0x01F4 +#define REG_HMEBOX_EXT2_8192F 0x01F8 +#define REG_HMEBOX_EXT3_8192F 0x01FC + +/* ----------------------------------------------------- + * + * 0x0200h ~ 0x027Fh TXDMA Configuration + * + * ----------------------------------------------------- */ +#define REG_RQPN_8192F 0x0200 +#define REG_FIFOPAGE_8192F 0x0204 +#define REG_DWBCN0_CTRL_8192F REG_TDECTRL +#define REG_TXDMA_OFFSET_CHK_8192F 0x020C +#define REG_TXDMA_STATUS_8192F 0x0210 +#define REG_RQPN_NPQ_8192F 0x0214 +#define REG_DWBCN1_CTRL_8192F 0x0228 +#define REG_RQPN_EXQ1_EXQ2 0x0230 + +/* ----------------------------------------------------- + * + * 0x0280h ~ 0x02FFh RXDMA Configuration + * + * ----------------------------------------------------- */ +#define REG_RXDMA_AGG_PG_TH_8192F 0x0280 +#define REG_FW_UPD_RDPTR_8192F 0x0284 /* FW shall update this register before FW write RXPKT_RELEASE_POLL to 1 */ +#define REG_RXDMA_CONTROL_8192F 0x0286 /* Control the RX DMA. */ +#define REG_RXDMA_STATUS_8192F 0x0288 +#define REG_RXDMA_MODE_CTRL_8192F 0x0290 +#define REG_EARLY_MODE_CONTROL_8192F 0x02BC +#define REG_RSVD5_8192F 0x02F0 +#define REG_RSVD6_8192F 0x02F4 + +/* ----------------------------------------------------- + * + * 0x0300h ~ 0x03FFh PCIe + * + * ----------------------------------------------------- */ +#define REG_PCIE_CTRL_REG_8192F 0x0300 +#define REG_INT_MIG_8192F 0x0304 /* Interrupt Migration */ +#define REG_BCNQ_TXBD_DESA_8192F 0x0308 /* TX Beacon Descriptor Address */ +#define REG_MGQ_TXBD_DESA_8192F 0x0310 /* TX Manage Queue Descriptor Address */ +#define REG_VOQ_TXBD_DESA_8192F 0x0318 /* TX VO Queue Descriptor Address */ +#define REG_VIQ_TXBD_DESA_8192F 0x0320 /* TX VI Queue Descriptor Address */ +#define REG_BEQ_TXBD_DESA_8192F 0x0328 /* TX BE Queue Descriptor Address */ +#define REG_BKQ_TXBD_DESA_8192F 0x0330 /* TX BK Queue Descriptor Address */ +#define REG_RXQ_RXBD_DESA_8192F 0x0338 /* RX Queue Descriptor Address */ +#define REG_HI0Q_TXBD_DESA_8192F 0x0340 +#define REG_HI1Q_TXBD_DESA_8192F 0x0348 +#define REG_HI2Q_TXBD_DESA_8192F 0x0350 +#define REG_HI3Q_TXBD_DESA_8192F 0x0358 +#define REG_HI4Q_TXBD_DESA_8192F 0x0360 +#define REG_HI5Q_TXBD_DESA_8192F 0x0368 +#define REG_HI6Q_TXBD_DESA_8192F 0x0370 +#define REG_HI7Q_TXBD_DESA_8192F 0x0378 +#define REG_MGQ_TXBD_NUM_8192F 0x0380 +#define REG_RX_RXBD_NUM_8192F 0x0382 +#define REG_VOQ_TXBD_NUM_8192F 0x0384 +#define REG_VIQ_TXBD_NUM_8192F 0x0386 +#define REG_BEQ_TXBD_NUM_8192F 0x0388 +#define REG_BKQ_TXBD_NUM_8192F 0x038A +#define REG_HI0Q_TXBD_NUM_8192F 0x038C +#define REG_HI1Q_TXBD_NUM_8192F 0x038E +#define REG_HI2Q_TXBD_NUM_8192F 0x0390 +#define REG_HI3Q_TXBD_NUM_8192F 0x0392 +#define REG_HI4Q_TXBD_NUM_8192F 0x0394 +#define REG_HI5Q_TXBD_NUM_8192F 0x0396 +#define REG_HI6Q_TXBD_NUM_8192F 0x0398 +#define REG_HI7Q_TXBD_NUM_8192F 0x039A +#define REG_TSFTIMER_HCI_8192F 0x039C +#define REG_BD_RW_PTR_CLR_8192F 0x039C + +/* Read Write Point */ +#define REG_VOQ_TXBD_IDX_8192F 0x03A0 +#define REG_VIQ_TXBD_IDX_8192F 0x03A4 +#define REG_BEQ_TXBD_IDX_8192F 0x03A8 +#define REG_BKQ_TXBD_IDX_8192F 0x03AC +#define REG_MGQ_TXBD_IDX_8192F 0x03B0 +#define REG_RXQ_TXBD_IDX_8192F 0x03B4 +#define REG_HI0Q_TXBD_IDX_8192F 0x03B8 +#define REG_HI1Q_TXBD_IDX_8192F 0x03BC +#define REG_HI2Q_TXBD_IDX_8192F 0x03C0 +#define REG_HI3Q_TXBD_IDX_8192F 0x03C4 +#define REG_HI4Q_TXBD_IDX_8192F 0x03C8 +#define REG_HI5Q_TXBD_IDX_8192F 0x03CC +#define REG_HI6Q_TXBD_IDX_8192F 0x03D0 +#define REG_HI7Q_TXBD_IDX_8192F 0x03D4 +#define REG_DBI_WDATA_V1_8192F 0x03E8 +#define REG_DBI_RDATA_V1_8192F 0x03EC +#define REG_DBI_FLAG_V1_8192F 0x03F0 +#define REG_MDIO_V1_8192F 0x03F4 +#define REG_HCI_MIX_CFG_8192F 0x03FC +#define REG_PCIE_HCPWM_8192FE 0x03D8 +#define REG_PCIE_HRPWM_8192FE 0x03DC +#define REG_PCIE_MIX_CFG_8192F 0x03F8 + +/* ----------------------------------------------------- + * + * 0x0400h ~ 0x047Fh Protocol Configuration + * + * ----------------------------------------------------- */ +#define REG_QUEUELIST_INFO0_8192F 0x0400 +#define REG_QUEUELIST_INFO1_8192F 0x0404 +#define REG_QUEUELIST_INFO2_8192F 0x0414 +#define REG_TXPKT_EMPTY_8192F 0x0418 + +#define REG_FWHW_TXQ_CTRL_8192F 0x0420 +#define REG_HWSEQ_CTRL_8192F 0x0423 +#define REG_TXPKTBUF_BCNQ_BDNY_8192F 0x0424 +#define REG_TXPKTBUF_MGQ_BDNY_8192F 0x0425 +#define REG_LIFECTRL_CTRL_8192F 0x0426 +#define REG_MULTI_BCNQ_OFFSET_8192F 0x0427 +#define REG_SPEC_SIFS_8192F 0x0428 +#define REG_RL_8192F 0x042A +#define REG_TXBF_CTRL_8192F 0x042C +#define REG_DARFRC_8192F 0x0430 +#define REG_RARFRC_8192F 0x0438 +#define REG_RRSR_8192F 0x0440 +#define REG_ARFR0_8192F 0x0444 +#define REG_ARFR1_8192F 0x044C +#define REG_CCK_CHECK_8192F 0x0454 +#define REG_AMPDU_MAX_TIME_8192F 0x0456 +#define REG_TXPKTBUF_BCNQ_BDNY1_8192F 0x0457 + +#define REG_AMPDU_MAX_LENGTH_8192F 0x0458 +#define REG_TXPKTBUF_WMAC_LBK_BF_HD_8192F 0x045D +#define REG_NDPA_OPT_CTRL_8192F 0x045F +#define REG_FAST_EDCA_CTRL_8192F 0x0460 +#define REG_RD_RESP_PKT_TH_8192F 0x0463 +#define REG_DATA_SC_8192F 0x0483 +#define REG_TXRPT_START_OFFSET 0x04AC +#define REG_POWER_STAGE1_8192F 0x04B4 +#define REG_POWER_STAGE2_8192F 0x04B8 +#define REG_AMPDU_BURST_MODE_8192F 0x04BC +#define REG_PKT_VO_VI_LIFE_TIME_8192F 0x04C0 +#define REG_PKT_BE_BK_LIFE_TIME_8192F 0x04C2 +#define REG_STBC_SETTING_8192F 0x04C4 +#define REG_HT_SINGLE_AMPDU_8192F 0x04C7 +#define REG_PROT_MODE_CTRL_8192F 0x04C8 +#define REG_MAX_AGGR_NUM_8192F 0x04CA +#define REG_RTS_MAX_AGGR_NUM_8192F 0x04CB +#define REG_BAR_MODE_CTRL_8192F 0x04CC +#define REG_RA_TRY_RATE_AGG_LMT_8192F 0x04CF +#define REG_MACID_PKT_DROP0_8192F 0x04D0 +#define REG_MACID_PKT_SLEEP_8192F 0x04D4 +#define REG_PRECNT_CTRL_8192F 0x04E5 +/* ----------------------------------------------------- + * + * 0x0500h ~ 0x05FFh EDCA Configuration + * + * ----------------------------------------------------- */ +#define REG_EDCA_VO_PARAM_8192F 0x0500 +#define REG_EDCA_VI_PARAM_8192F 0x0504 +#define REG_EDCA_BE_PARAM_8192F 0x0508 +#define REG_EDCA_BK_PARAM_8192F 0x050C +#define REG_BCNTCFG_8192F 0x0510 +#define REG_PIFS_8192F 0x0512 +#define REG_RDG_PIFS_8192F 0x0513 +#define REG_SIFS_CTX_8192F 0x0514 +#define REG_SIFS_TRX_8192F 0x0516 +#define REG_AGGR_BREAK_TIME_8192F 0x051A +#define REG_SLOT_8192F 0x051B +#define REG_TX_PTCL_CTRL_8192F 0x0520 +#define REG_TXPAUSE_8192F 0x0522 +#define REG_DIS_TXREQ_CLR_8192F 0x0523 +#define REG_RD_CTRL_8192F 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_8192F 0x0540 +#define REG_RD_NAV_NXT_8192F 0x0544 +#define REG_NAV_PROT_LEN_8192F 0x0546 +#define REG_BCN_CTRL_8192F 0x0550 +#define REG_BCN_CTRL_1_8192F 0x0551 +#define REG_MBID_NUM_8192F 0x0552 +#define REG_DUAL_TSF_RST_8192F 0x0553 +#define REG_BCN_INTERVAL_8192F 0x0554 +#define REG_DRVERLYINT_8192F 0x0558 +#define REG_BCNDMATIM_8192F 0x0559 +#define REG_ATIMWND_8192F 0x055A +#define REG_USTIME_TSF_8192F 0x055C +#define REG_BCN_MAX_ERR_8192F 0x055D +#define REG_RXTSF_OFFSET_CCK_8192F 0x055E +#define REG_RXTSF_OFFSET_OFDM_8192F 0x055F +#define REG_TSFTR_8192F 0x0560 +#define REG_CTWND_8192F 0x0572 +#define REG_SECONDARY_CCA_CTRL_8192F 0x0577 +#define REG_PSTIMER_8192F 0x0580 +#define REG_TIMER0_8192F 0x0584 +#define REG_TIMER1_8192F 0x0588 +#define REG_ACMHWCTRL_8192F 0x05C0 +#define REG_SCH_TXCMD_8192F 0x05F8 + +/* ----------------------------------------------------- + * + * 0x0600h ~ 0x07FFh WMAC Configuration + * + * ----------------------------------------------------- */ +#define REG_MAC_CR_8192F 0x0600 +#define REG_TCR_8192F 0x0604 +#define REG_RCR_8192F 0x0608 +#define REG_RX_PKT_LIMIT_8192F 0x060C +#define REG_RX_DLK_TIME_8192F 0x060D +#define REG_RX_DRVINFO_SZ_8192F 0x060F + +#define REG_MACID_8192F 0x0610 +#define REG_BSSID_8192F 0x0618 +#define REG_MAR_8192F 0x0620 +#define REG_MBIDCAMCFG_8192F 0x0628 + + +#define REG_USTIME_EDCA_8192F 0x0638 +#define REG_MAC_SPEC_SIFS_8192F 0x063A +#define REG_RESP_SIFP_CCK_8192F 0x063C +#define REG_RESP_SIFS_OFDM_8192F 0x063E +#define REG_ACKTO_8192F 0x0640 +#define REG_CTS2TO_8192F 0x0641 +#define REG_EIFS_8192F 0x0642 + +#define REG_NAV_UPPER_8192F 0x0652 /* unit of 128*/ +#define REG_TRXPTCL_CTL_8192F 0x0668 + +/* Security*/ +#define REG_CAMCMD_8192F 0x0670 +#define REG_CAMWRITE_8192F 0x0674 +#define REG_CAMREAD_8192F 0x0678 +#define REG_CAMDBG_8192F 0x067C +#define REG_SECCFG_8192F 0x0680 + +/* Power */ +#define REG_WOW_CTRL_8192F 0x0690 +#define REG_PS_RX_INFO_8192F 0x0692 +#define REG_UAPSD_TID_8192F 0x0693 +#define REG_WKFMCAM_CMD_8192F 0x0698 +#define REG_WKFMCAM_NUM_8192F 0x0698 +#define REG_WKFMCAM_RWD_8192F 0x069C +#define REG_RXFLTMAP0_8192F 0x06A0 +#define REG_RXFLTMAP1_8192F 0x06A2 +#define REG_RXFLTMAP2_8192F 0x06A4 +#define REG_BCN_PSR_RPT_8192F 0x06A8 +#define REG_BT_COEX_TABLE_8192F 0x06C0 +#define REG_BFMER0_INFO_8192F 0x06E4 +#define REG_BFMER1_INFO_8192F 0x06EC +#define REG_CSI_RPT_PARAM_BW20_8192F 0x06F4 +#define REG_CSI_RPT_PARAM_BW40_8192F 0x06F8 +#define REG_CSI_RPT_PARAM_BW80_8192F 0x06FC + +/* Hardware Port 2 */ +#define REG_MACID1_8192F 0x0700 +#define REG_BSSID1_8192F 0x0708 +#define REG_BFMEE_SEL_8192F 0x0714 +#define REG_SND_PTCL_CTRL_8192F 0x0718 + +/* LTR */ +#define REG_LTR_CTRL_BASIC_8192F 0x07A4 +#define REG_LTR_IDLE_LATENCY_V1_8192F 0x0798 +#define REG_LTR_ACTIVE_LATENCY_V1_8192F 0x079C + +/* GPIO Control */ +#define REG_SW_GPIO_SHARE_CTRL_8192F 0x1038 +#define REG_SW_GPIO_A_OUT_8192F 0x1040 +#define REG_SW_GPIO_A_OEN_8192F 0x1044 + +/* ************************************************************ + * SDIO Bus Specification + * ************************************************************ */ + +/* ----------------------------------------------------- + * SDIO CMD Address Mapping + * ----------------------------------------------------- */ + +/* ----------------------------------------------------- + * I/O bus domain (Host) + * ----------------------------------------------------- */ +/*SDIO Host Interrupt Mask Register */ +#define SDIO_HIMR_CRCERR_MSK BIT(31) +/* SDIO Host Interrupt Service Routine */ +#define SDIO_HISR_HEISR_IND_INT BIT(28) +#define SDIO_HISR_HSISR2_IND_INT BIT(29) +#define SDIO_HISR_HSISR3_IND_INT BIT(30) +#define SDIO_HISR_SDIO_CRCERR BIT(31) +/* ----------------------------------------------------- + * SDIO register + * ----------------------------------------------------- */ +#define SDIO_REG_HCPWM1_8192F 0x038/* HCI Current Power Mode 1 */ +#define SDIO_REG_FREE_TXPG1_8192F 0x0020 /* Free Tx Buffer Page1*/ +#define SDIO_REG_FREE_TXPG2_8192F 0x0024 /* Free Tx Buffer Page1*/ +#define SDIO_REG_FREE_TXPG3_8192F 0x0028 +#define SDIO_REG_AC_OQT_FREEPG_8192F 0x002A +#define SDIO_REG_NOAC_OQT_FREEPG_8192F 0x002B +/* **************************************************************************** + * 8192F Regsiter Bit and Content definition + * **************************************************************************** */ + +#define BIT_USB_RXDMA_AGG_EN BIT(31) +#define RXDMA_AGG_MODE_EN BIT(1) + +#ifdef CONFIG_WOWLAN + #define RXPKT_RELEASE_POLL BIT(16) + #define RXDMA_IDLE BIT(17) + #define RW_RELEASE_EN BIT(18) +#endif + +#ifdef CONFIG_AMPDU_PRETX_CD +/*#define BIT_ERRORHDL_INT BIT(2)*/ +/*#define BIT_MACTX_ERR_3 BIT(4)*/ +#define BIT_PRE_TX_CMD_8192F BIT(6) +#define BIT_EN_PRECNT_8192F BIT(11) +#endif +/* SDIO Host Interrupt Service Routine */ +#define SDIO_HISR_HEISR_IND_INT BIT(28) +#define SDIO_HISR_HSISR2_IND_INT BIT(29) +#define SDIO_HISR_HSISR3_IND_INT BIT(30) +#define SDIO_HISR_SDIO_CRCERR BIT(31) + +/* PCIE Host Interrupt Mask Register (HIMR) */ +#ifdef CONFIG_PCI_HCI +/* ---------------------------------------------------------------------------- + * * 8192F IMR/ISR bits (offset 0xB0, 8bits) + * * ---------------------------------------------------------------------------- */ + +#define IMR_DISABLED_8192F 0 +/* IMR DW0(0x00B0-00B3) Bit 0-31 */ +#define IMR_TIMER2_8192F BIT(31) /* Timeout interrupt 2 */ +#define IMR_TIMER1_8192F BIT(30) /* Timeout interrupt 1 */ +#define IMR_PSTIMEOUT_8192F BIT(29) /* Power Save Time Out Interrupt */ +#define IMR_GTINT4_8192F BIT(28) /* When GTIMER4 expires, this bit is set to 1 */ +#define IMR_GTINT3_8192F BIT(27) /* When GTIMER3 expires, this bit is set to 1 */ +#define IMR_TXBCN0ERR_8192F BIT(26) /* Transmit Beacon0 Error */ +#define IMR_TXBCN0OK_8192F BIT(25) /* Transmit Beacon0 OK */ +#define IMR_TSF_BIT32_TOGGLE_8192F BIT(24) /* TSF Timer BIT32 toggle indication interrupt */ +#define IMR_BCNDMAINT0_8192F BIT(20) /* Beacon DMA Interrupt 0 */ +#define IMR_BCNDERR0_8192F BIT(16) /* Beacon Queue DMA OK0 */ +#define IMR_HSISR_IND_ON_INT_8192F BIT(15) /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ +#define IMR_BCNDMAINT_E_8192F BIT(14) /* Beacon DMA Interrupt Extension for Win7 */ +#define IMR_ATIMEND_8192F BIT(12) /* CTWidnow End or ATIM Window End */ +#define IMR_C2HCMD_8192F BIT(10) /* CPU to Host Command INT status, Write 1 clear */ +#define IMR_CPWM2_8192F BIT(9) /* CPU power mode exchange INT status, Write 1 clear */ +#define IMR_CPWM_8192F BIT(8) /* CPU power mode exchange INT status, Write 1 clear */ +#define IMR_HIGHDOK_8192F BIT(7) /* High Queue DMA OK */ +#define IMR_MGNTDOK_8192F BIT(6) /* Management Queue DMA OK */ +#define IMR_BKDOK_8192F BIT(5) /* AC_BK DMA OK */ +#define IMR_BEDOK_8192F BIT(4) /* AC_BE DMA OK */ +#define IMR_VIDOK_8192F BIT(3) /* AC_VI DMA OK */ +#define IMR_VODOK_8192F BIT(2) /* AC_VO DMA OK */ +#define IMR_RDU_8192F BIT(1) /* Rx Descriptor Unavailable */ +#define IMR_ROK_8192F BIT(0) /* Receive DMA OK */ + +/* IMR DW1(0x00B4-00B7) Bit 0-31 */ +#define IMR_MCUERR_8192F BIT(28) +#define IMR_BCNDMAINT7_8192F BIT(27) /* Beacon DMA Interrupt 7 */ +#define IMR_BCNDMAINT6_8192F BIT(26) /* Beacon DMA Interrupt 6 */ +#define IMR_BCNDMAINT5_8192F BIT(25) /* Beacon DMA Interrupt 5 */ +#define IMR_BCNDMAINT4_8192F BIT(24) /* Beacon DMA Interrupt 4 */ +#define IMR_BCNDMAINT3_8192F BIT(23) /* Beacon DMA Interrupt 3 */ +#define IMR_BCNDMAINT2_8192F BIT(22) /* Beacon DMA Interrupt 2 */ +#define IMR_BCNDMAINT1_8192F BIT(21) /* Beacon DMA Interrupt 1 */ +#define IMR_BCNDOK7_8192F BIT(20) /* Beacon Queue DMA OK Interrup 7 */ +#define IMR_BCNDOK6_8192F BIT(19) /* Beacon Queue DMA OK Interrup 6 */ +#define IMR_BCNDOK5_8192F BIT(18) /* Beacon Queue DMA OK Interrup 5 */ +#define IMR_BCNDOK4_8192F BIT(17) /* Beacon Queue DMA OK Interrup 4 */ +#define IMR_BCNDOK3_8192F BIT(16) /* Beacon Queue DMA OK Interrup 3 */ +#define IMR_BCNDOK2_8192F BIT(15) /* Beacon Queue DMA OK Interrup 2 */ +#define IMR_BCNDOK1_8192F BIT(14) /* Beacon Queue DMA OK Interrup 1 */ +#define IMR_ATIMEND_E_8192F BIT(13) /* ATIM Window End Extension for Win7 */ +#define IMR_TXERR_8192F BIT(11) /* Tx Error Flag Interrupt status, write 1 clear. */ +#define IMR_RXERR_8192F BIT(10) /* Rx Error Flag INT status, Write 1 clear */ +#define IMR_TXFOVW_8192F BIT(9) /* Transmit FIFO Overflow */ +#define IMR_RXFOVW_8192F BIT(8) /* Receive FIFO Overflow */ + +/* #define IMR_RX_MASK (IMR_ROK_8192F|IMR_RDU_8192F|IMR_RXFOVW_8192F) */ +#define IMR_TX_MASK (IMR_VODOK_8192F | IMR_VIDOK_8192F | IMR_BEDOK_8192F | IMR_BKDOK_8192F | IMR_MGNTDOK_8192F | IMR_HIGHDOK_8192F) +#define RT_BCN_INT_MASKS (IMR_BCNDMAINT0_8192F | IMR_TXBCN0OK_8192F | IMR_TXBCN0ERR_8192F | IMR_BCNDERR0_8192F) +#define RT_AC_INT_MASKS (IMR_VIDOK_8192F | IMR_VODOK_8192F | IMR_BEDOK_8192F | IMR_BKDOK_8192F) +#endif /* CONFIG_PCI_HCI */ + +/* 2 HSISR + * interrupt mask which needs to clear */ +#define MASK_HSISR_CLEAR (HSISR_GPIO12_0_INT |\ + HSISR_SPS_OCP_INT |\ + HSISR_RON_INT |\ + HSISR_PDNINT |\ + HSISR_GPIO9_INT) + +#define _TXDMA_HIQ_MAP_8192F(x) (((x) & 0x7) << 19) +#define _TXDMA_MGQ_MAP_8192F(x) (((x) & 0x7) << 16) +#define _TXDMA_BKQ_MAP_8192F(x) (((x) & 0x7) << 13) +#define _TXDMA_BEQ_MAP_8192F(x) (((x) & 0x7) << 10) +#define _TXDMA_VIQ_MAP_8192F(x) (((x) & 0x7) << 7) +#define _TXDMA_VOQ_MAP_8192F(x) (((x) & 0x7) << 4) + +/*mac queue info*/ +#define QUEUE_TOTAL_NUM 20/*reg414h : 0~f ac queue 0x10~0x13MGQ HIQ BCNQ CMDQ*/ +#define QUEUE_ACQ_NUM 16 +#define QUEUE_INDEX_MGQ 0x10 +#define QUEUE_INDEX_HIQ 0x11 +#define QUEUE_INDEX_BCNQ 0x12 +#define QUEUE_INDEX_CMDQ 0x13 +#endif /* __RTL8192F_SPEC_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192f_sreset.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192f_sreset.h new file mode 100644 index 000000000000..a8fca762f4b8 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192f_sreset.h @@ -0,0 +1,25 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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 _RTL8192F_SRESET_H_ +#define _RTL8192F_SRESET_H_ + +#include + +#ifdef DBG_CONFIG_ERROR_DETECT + extern void rtl8192f_sreset_xmit_status_check(_adapter *padapter); + extern void rtl8192f_sreset_linked_status_check(_adapter *padapter); +#endif /* DBG_CONFIG_ERROR_DETECT */ +#endif /* _RTL8192F_SRESET_H_ */ \ No newline at end of file diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192f_xmit.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192f_xmit.h new file mode 100644 index 000000000000..86408d6585d9 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8192f_xmit.h @@ -0,0 +1,532 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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 __RTL8192F_XMIT_H__ +#define __RTL8192F_XMIT_H__ + + +#define MAX_TID (15) + + +#ifndef __INC_HAL8192FDESC_H +#define __INC_HAL8192FDESC_H + +#define RX_STATUS_DESC_SIZE_8192F 24 +#define RX_DRV_INFO_SIZE_UNIT_8192F 8 + + +/* DWORD 0 */ +#define SET_RX_STATUS_DESC_PKT_LEN_8192F(__pRxStatusDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 0, 14, __Value) +#define SET_RX_STATUS_DESC_EOR_8192F(__pRxStatusDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 30, 1, __Value) +#define SET_RX_STATUS_DESC_OWN_8192F(__pRxStatusDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 31, 1, __Value) + +#define GET_RX_STATUS_DESC_PKT_LEN_8192F(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc, 0, 14) +#define GET_RX_STATUS_DESC_CRC32_8192F(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc, 14, 1) +#define GET_RX_STATUS_DESC_ICV_8192F(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc, 15, 1) +#define GET_RX_STATUS_DESC_DRVINFO_SIZE_8192F(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 4) +#define GET_RX_STATUS_DESC_SECURITY_8192F(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc, 20, 3) +#define GET_RX_STATUS_DESC_QOS_8192F(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc, 23, 1) +#define GET_RX_STATUS_DESC_SHIFT_8192F(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc, 24, 2) +#define GET_RX_STATUS_DESC_PHY_STATUS_8192F(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc, 26, 1) +#define GET_RX_STATUS_DESC_SWDEC_8192F(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc, 27, 1) +#define GET_RX_STATUS_DESC_EOR_8192F(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc, 30, 1) +#define GET_RX_STATUS_DESC_OWN_8192F(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc, 31, 1) + +/* DWORD 1 */ +#define GET_RX_STATUS_DESC_MACID_8192F(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+4, 0, 7) +#define GET_RX_STATUS_DESC_TID_8192F(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+4, 8, 4) +#define GET_RX_STATUS_DESC_AMSDU_8192F(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+4, 13, 1) +#define GET_RX_STATUS_DESC_RXID_MATCH_8192F(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+4, 14, 1) +#define GET_RX_STATUS_DESC_PAGGR_8192F(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+4, 15, 1) +#define GET_RX_STATUS_DESC_A1_FIT_8192F(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+4, 16, 4) +#define GET_RX_STATUS_DESC_CHKERR_8192F(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+4, 20, 1) +#define GET_RX_STATUS_DESC_IPVER_8192F(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+4, 21, 1) +#define GET_RX_STATUS_DESC_IS_TCPUDP__8192F(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+4, 22, 1) +#define GET_RX_STATUS_DESC_CHK_VLD_8192F(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+4, 23, 1) +#define GET_RX_STATUS_DESC_PAM_8192F(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+4, 24, 1) +#define GET_RX_STATUS_DESC_PWR_8192F(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+4, 25, 1) +#define GET_RX_STATUS_DESC_MORE_DATA_8192F(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+4, 26, 1) +#define GET_RX_STATUS_DESC_MORE_FRAG_8192F(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+4, 27, 1) +#define GET_RX_STATUS_DESC_TYPE_8192F(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+4, 28, 2) +#define GET_RX_STATUS_DESC_MC_8192F(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+4, 30, 1) +#define GET_RX_STATUS_DESC_BC_8192F(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+4, 31, 1) + +/* DWORD 2 */ +#define GET_RX_STATUS_DESC_SEQ_8192F(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 0, 12) +#define GET_RX_STATUS_DESC_FRAG_8192F(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 12, 4) +#define GET_RX_STATUS_DESC_RX_IS_QOS_8192F(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 16, 1) +#define GET_RX_STATUS_DESC_WLANHD_IV_LEN_8192F(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 18, 6) +#define GET_RX_STATUS_DESC_RPT_SEL_8192F(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 28, 1) +#define GET_RX_STATUS_DESC_FCS_OK_8192F(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 31, 1) + +/* DWORD 3 */ +#define GET_RX_STATUS_DESC_RX_RATE_8192F(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 0, 7) +#define GET_RX_STATUS_DESC_HTC_8192F(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 10, 1) +#define GET_RX_STATUS_DESC_EOSP_8192F(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 11, 1) +#define GET_RX_STATUS_DESC_BSSID_FIT_8192F(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 12, 2) +#ifdef CONFIG_USB_RX_AGGREGATION +#define GET_RX_STATUS_DESC_USB_AGG_PKTNUM_8192F(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 16, 8) +#endif +#define GET_RX_STATUS_DESC_PATTERN_MATCH_8192F(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+12, 29, 1) +#define GET_RX_STATUS_DESC_UNICAST_MATCH_8192F(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+12, 30, 1) +#define GET_RX_STATUS_DESC_MAGIC_MATCH_8192F(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+12, 31, 1) + +/* DWORD 6 */ +#define GET_RX_STATUS_DESC_MATCH_ID_8192F(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+16, 0, 7) + +/* DWORD 5 */ +#define GET_RX_STATUS_DESC_TSFL_8192F(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc+20, 0, 32) + +#define GET_RX_STATUS_DESC_BUFF_ADDR64_8192F(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+28, 0, 32) + + + +/* Dword 0, rsvd: bit26, bit28 */ +#define GET_TX_DESC_OWN_8192F(__pTxDesc)\ + LE_BITS_TO_4BYTE(__pTxDesc, 31, 1) + +#define SET_TX_DESC_PKT_SIZE_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 16, __Value) +#define SET_TX_DESC_OFFSET_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 8, __Value) +#define SET_TX_DESC_BMC_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc, 24, 1, __Value) +#define SET_TX_DESC_HTC_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc, 25, 1, __Value) +#define SET_TX_DESC_AMSDU_PAD_EN_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc, 27, 1, __Value) +#define SET_TX_DESC_NO_ACM_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc, 29, 1, __Value) +#define SET_TX_DESC_GF_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc, 30, 1, __Value) + +/* Dword 1 */ +#define SET_TX_DESC_MACID_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 7, __Value) +#define SET_TX_DESC_QUEUE_SEL_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 8, 5, __Value) +#define SET_TX_DESC_RDG_NAV_EXT_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 13, 1, __Value) +#define SET_TX_DESC_LSIG_TXOP_EN_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 14, 1, __Value) +#define SET_TX_DESC_PIFS_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 15, 1, __Value) +#define SET_TX_DESC_RATE_ID_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 16, 5, __Value) +#define SET_TX_DESC_EN_DESC_ID_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 21, 1, __Value) +#define SET_TX_DESC_SEC_TYPE_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 22, 2, __Value) +#define SET_TX_DESC_PKT_OFFSET_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 24, 5, __Value) +#define SET_TX_DESC_MORE_DATA_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 29, 1, __Value) + +/* Dword 2 ADD HW_DIG*/ +#define SET_TX_DESC_PAID_92F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 0, 9, __Value) +#define SET_TX_DESC_CCA_RTS_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 10, 2, __Value) +#define SET_TX_DESC_AGG_ENABLE_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 12, 1, __Value) +#define SET_TX_DESC_RDG_ENABLE_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 13, 1, __Value) +#define SET_TX_DESC_NULL0_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 14, 1, __Value) +#define SET_TX_DESC_NULL1_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 15, 1, __Value) +#define SET_TX_DESC_BK_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 16, 1, __Value) +#define SET_TX_DESC_MORE_FRAG_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 17, 1, __Value) +#define SET_TX_DESC_RAW_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 18, 1, __Value) +#define SET_TX_DESC_CCX_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 19, 1, __Value) +#define SET_TX_DESC_AMPDU_DENSITY_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 20, 3, __Value) +#define SET_TX_DESC_BT_INT_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 23, 1, __Value) +#define SET_TX_DESC_HW_DIG_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 24, 7, __Value) + +/* Dword 3 */ +#define SET_TX_DESC_HWSEQ_SEL_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 6, 2, __Value) +#define SET_TX_DESC_USE_RATE_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 8, 1, __Value) +#define SET_TX_DESC_DISABLE_RTS_FB_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 9, 1, __Value) +#define SET_TX_DESC_DISABLE_FB_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 10, 1, __Value) +#define SET_TX_DESC_CTS2SELF_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 11, 1, __Value) +#define SET_TX_DESC_RTS_ENABLE_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 12, 1, __Value) +#define SET_TX_DESC_HW_RTS_ENABLE_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 13, 1, __Value) +#define SET_TX_DESC_CHK_EN_92F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 14, 1, __Value) +#define SET_TX_DESC_NAV_USE_HDR_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 15, 1, __Value) +#define SET_TX_DESC_USE_MAX_LEN_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 16, 1, __Value) +#define SET_TX_DESC_MAX_AGG_NUM_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 17, 5, __Value) +#define SET_TX_DESC_NDPA_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 22, 2, __Value) +#define SET_TX_DESC_AMPDU_MAX_TIME_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 24, 8, __Value) + +/* Dword 4 */ +#define SET_TX_DESC_TX_RATE_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 0, 7, __Value) +#define SET_TX_DESC_TX_TRY_RATE_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 7, 1, __Value) +#define SET_TX_DESC_DATA_RATE_FB_LIMIT_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 8, 5, __Value) +#define SET_TX_DESC_RTS_RATE_FB_LIMIT_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 13, 4, __Value) +#define SET_TX_DESC_RETRY_LIMIT_ENABLE_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 17, 1, __Value) +#define SET_TX_DESC_DATA_RETRY_LIMIT_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 18, 6, __Value) +#define SET_TX_DESC_RTS_RATE_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 24, 5, __Value) +#define SET_TX_DESC_PCTS_EN_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 29, 1, __Value) +#define SET_TX_DESC_PCTS_MASK_IDX_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 30, 2, __Value) + +/* Dword 5 */ +#define SET_TX_DESC_DATA_SC_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 0, 4, __Value) +#define SET_TX_DESC_DATA_SHORT_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 4, 1, __Value) +#define SET_TX_DESC_DATA_BW_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 5, 2, __Value) +#define SET_TX_DESC_DATA_LDPC_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 7, 1, __Value) +#define SET_TX_DESC_DATA_STBC_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 8, 2, __Value) +#define SET_TX_DESC_RTS_STBC_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 10, 2, __Value) +#define SET_TX_DESC_RTS_SHORT_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 12, 1, __Value) +#define SET_TX_DESC_RTS_SC_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 13, 4, __Value) +#define SET_TX_DESC_PORT_ID_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 21, 1, __Value) +#define SET_TX_DESC_DROP_ID_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 22, 2, __Value) +#define SET_TX_DESC_PATH_A_EN_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 24, 1, __Value) +#define SET_TX_DESC_PATH_B_EN_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 25, 1, __Value) +#define SET_TX_DESC_TXPWR_OF_SET_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 28, 3, __Value) + +/* Dword 6 */ +#define SET_TX_DESC_SW_DEFINE_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 0, 12, __Value) +#define SET_TX_DESC_MBSSID_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 12, 4, __Value) +#define SET_TX_DESC_RF_SEL_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 16, 3, __Value) + +/* Dword 7 */ +#ifdef CONFIG_PCI_HCI +#define SET_TX_DESC_TX_BUFFER_SIZE_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) +#endif + +#ifdef CONFIG_USB_HCI +#define SET_TX_DESC_TX_DESC_CHECKSUM_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) +#endif + +#ifdef CONFIG_SDIO_HCI +#define SET_TX_DESC_TX_TIMESTAMP_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 6, 18, __Value) +#endif + +#define SET_TX_DESC_USB_TXAGG_NUM_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 24, 8, __Value) + +/* Dword 8 */ +#define SET_TX_DESC_RTS_RC_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 0, 6, __Value) +#define SET_TX_DESC_BAR_RC_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 6, 2, __Value) +#define SET_TX_DESC_DATA_RC_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 8, 6, __Value) +#define SET_TX_DESC_HWSEQ_EN_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 15, 1, __Value) +#define SET_TX_DESC_NEXTHEADPAGE_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 16, 8, __Value) +#define SET_TX_DESC_TAILPAGE_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 24, 8, __Value) + +/* Dword 9 */ +#define SET_TX_DESC_PADDING_LEN_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 0, 11, __Value) +#define SET_TX_DESC_SEQ_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 12, 12, __Value) +#define SET_TX_DESC_FINAL_DATA_RATE_8192F(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 24, 8, __Value) + + +#define SET_EARLYMODE_PKTNUM_8192F(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 4, __Value) +#define SET_EARLYMODE_LEN0_8192F(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 15, __Value) +#define SET_EARLYMODE_LEN1_1_8192F(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 19, 13, __Value) +#define SET_EARLYMODE_LEN1_2_8192F(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 2, __Value) +#define SET_EARLYMODE_LEN2_8192F(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 2, 15, __Value) +#define SET_EARLYMODE_LEN3_8192F(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 17, 15, __Value) + + +/*-----------------------------------------------------------------*/ +/* RTL8192F TX BUFFER DESC */ +/*-----------------------------------------------------------------*/ +#ifdef CONFIG_64BIT_DMA + #define SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*16), 0, 16, __Valeu) + #define SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*16), 31, 1, __Valeu) + #define SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*16)+4, 0, 32, __Valeu) + #define SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*16)+8, 0, 32, __Valeu) +#else + #define SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*8), 0, 16, __Valeu) + #define SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*8), 31, 1, __Valeu) + #define SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*8)+4, 0, 32, __Valeu) + #define SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) /* 64 BIT mode only */ +#endif +/* ********************************************************* */ + +/* 64 bits -- 32 bits */ +/* ======= ======= */ +/* Dword 0 0 */ +#define SET_TX_BUFF_DESC_LEN_0_8192F(__pTxDesc, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 14, __Valeu) +#define SET_TX_BUFF_DESC_PSB_8192F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 15, __Value) +#define SET_TX_BUFF_DESC_OWN_8192F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 31, 1, __Value) + +/* Dword 1 1 */ +#define SET_TX_BUFF_DESC_ADDR_LOW_0_8192F(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 32, __Value) +#define GET_TX_BUFF_DESC_ADDR_LOW_0_8192F(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+4, 0, 32) +/* Dword 2 NA */ +#define SET_TX_BUFF_DESC_ADDR_HIGH_0_8192F(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, 0, __Value) +#ifdef CONFIG_64BIT_DMA + #define GET_TX_BUFF_DESC_ADDR_HIGH_0_8192F(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+8, 0, 32) +#else + #define GET_TX_BUFF_DESC_ADDR_HIGH_0_8192F(__pTxDesc) 0 +#endif +/* Dword 3 NA */ +/* RESERVED 0 */ +/* Dword 4 2 */ +#define SET_TX_BUFF_DESC_LEN_1_8192F(__pTxDesc, __Value) SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, 1, __Value) +#define SET_TX_BUFF_DESC_AMSDU_1_8192F(__pTxDesc, __Value) SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, 1, __Value) +/* Dword 5 3 */ +#define SET_TX_BUFF_DESC_ADDR_LOW_1_8192F(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, 1, __Value) +/* Dword 6 NA */ +#define SET_TX_BUFF_DESC_ADDR_HIGH_1_8192F(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, 1, __Value) +/* Dword 7 NA */ +/*RESERVED 0 */ +/* Dword 8 4 */ +#define SET_TX_BUFF_DESC_LEN_2_8192F(__pTxDesc, __Value) SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, 2, __Value) +#define SET_TX_BUFF_DESC_AMSDU_2_8192F(__pTxDesc, __Value) SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, 2, __Value) +/* Dword 9 5 */ +#define SET_TX_BUFF_DESC_ADDR_LOW_2_8192F(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, 2, __Value) +/* Dword 10 NA */ +#define SET_TX_BUFF_DESC_ADDR_HIGH_2_8192F(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, 2, __Value) +/* Dword 11 NA */ +/*RESERVED 0 */ +/* Dword 12 6 */ +#define SET_TX_BUFF_DESC_LEN_3_8192F(__pTxDesc, __Value) SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, 3, __Value) +#define SET_TX_BUFF_DESC_AMSDU_3_8192F(__pTxDesc, __Value) SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, 3, __Value) +/* Dword 13 7 */ +#define SET_TX_BUFF_DESC_ADDR_LOW_3_8192F(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, 3, __Value) +/* Dword 14 NA */ +#define SET_TX_BUFF_DESC_ADDR_HIGH_3_8192F(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, 3, __Value) +/* Dword 15 NA */ +/*RESERVED 0 */ + + +#endif +/* ----------------------------------------------------------- + * + * Rate + * + * ----------------------------------------------------------- + * CCK Rates, TxHT = 0 */ +#define DESC8192F_RATE1M 0x00 +#define DESC8192F_RATE2M 0x01 +#define DESC8192F_RATE5_5M 0x02 +#define DESC8192F_RATE11M 0x03 + +/* OFDM Rates, TxHT = 0 */ +#define DESC8192F_RATE6M 0x04 +#define DESC8192F_RATE9M 0x05 +#define DESC8192F_RATE12M 0x06 +#define DESC8192F_RATE18M 0x07 +#define DESC8192F_RATE24M 0x08 +#define DESC8192F_RATE36M 0x09 +#define DESC8192F_RATE48M 0x0a +#define DESC8192F_RATE54M 0x0b + +/* MCS Rates, TxHT = 1 */ +#define DESC8192F_RATEMCS0 0x0c +#define DESC8192F_RATEMCS1 0x0d +#define DESC8192F_RATEMCS2 0x0e +#define DESC8192F_RATEMCS3 0x0f +#define DESC8192F_RATEMCS4 0x10 +#define DESC8192F_RATEMCS5 0x11 +#define DESC8192F_RATEMCS6 0x12 +#define DESC8192F_RATEMCS7 0x13 +#define DESC8192F_RATEMCS8 0x14 +#define DESC8192F_RATEMCS9 0x15 +#define DESC8192F_RATEMCS10 0x16 +#define DESC8192F_RATEMCS11 0x17 +#define DESC8192F_RATEMCS12 0x18 +#define DESC8192F_RATEMCS13 0x19 +#define DESC8192F_RATEMCS14 0x1a +#define DESC8192F_RATEMCS15 0x1b +#define DESC8192F_RATEVHTSS1MCS0 0x2c +#define DESC8192F_RATEVHTSS1MCS1 0x2d +#define DESC8192F_RATEVHTSS1MCS2 0x2e +#define DESC8192F_RATEVHTSS1MCS3 0x2f +#define DESC8192F_RATEVHTSS1MCS4 0x30 +#define DESC8192F_RATEVHTSS1MCS5 0x31 +#define DESC8192F_RATEVHTSS1MCS6 0x32 +#define DESC8192F_RATEVHTSS1MCS7 0x33 +#define DESC8192F_RATEVHTSS1MCS8 0x34 +#define DESC8192F_RATEVHTSS1MCS9 0x35 +#define DESC8192F_RATEVHTSS2MCS0 0x36 +#define DESC8192F_RATEVHTSS2MCS1 0x37 +#define DESC8192F_RATEVHTSS2MCS2 0x38 +#define DESC8192F_RATEVHTSS2MCS3 0x39 +#define DESC8192F_RATEVHTSS2MCS4 0x3a +#define DESC8192F_RATEVHTSS2MCS5 0x3b +#define DESC8192F_RATEVHTSS2MCS6 0x3c +#define DESC8192F_RATEVHTSS2MCS7 0x3d +#define DESC8192F_RATEVHTSS2MCS8 0x3e +#define DESC8192F_RATEVHTSS2MCS9 0x3f + + +#define RX_HAL_IS_CCK_RATE_8192F(pDesc)\ + (GET_RX_STATUS_DESC_RX_RATE_8192F(pDesc) == DESC8192F_RATE1M || \ + GET_RX_STATUS_DESC_RX_RATE_8192F(pDesc) == DESC8192F_RATE2M || \ + GET_RX_STATUS_DESC_RX_RATE_8192F(pDesc) == DESC8192F_RATE5_5M || \ + GET_RX_STATUS_DESC_RX_RATE_8192F(pDesc) == DESC8192F_RATE11M) + +#ifdef CONFIG_TRX_BD_ARCH + struct tx_desc; +#endif + +void rtl8192f_cal_txdesc_chksum(struct tx_desc *ptxdesc); +void rtl8192f_update_txdesc(struct xmit_frame *pxmitframe, u8 *pmem); +void rtl8192f_fill_txdesc_sectype(struct pkt_attrib *pattrib, struct tx_desc *ptxdesc); +void rtl8192f_fill_txdesc_vcs(PADAPTER padapter, struct pkt_attrib *pattrib, struct tx_desc *ptxdesc); +void rtl8192f_fill_txdesc_phy(PADAPTER padapter, struct pkt_attrib *pattrib, struct tx_desc *ptxdesc); +void rtl8192f_fill_fake_txdesc(PADAPTER padapter, u8 *pDesc, u32 BufferLen, u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame); + +#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 rtl8192fs_init_xmit_priv(PADAPTER padapter); + void rtl8192fs_free_xmit_priv(PADAPTER padapter); + s32 rtl8192fs_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); + s32 rtl8192fs_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); + s32 rtl8192fs_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); + s32 rtl8192fs_xmit_buf_handler(PADAPTER padapter); + thread_return rtl8192fs_xmit_thread(thread_context context); + #define hal_xmit_handler rtl8192fs_xmit_buf_handler +#endif + +#ifdef CONFIG_USB_HCI + s32 rtl8192fu_init_xmit_priv(PADAPTER padapter); + void rtl8192fu_free_xmit_priv(PADAPTER padapter); + s32 rtl8192fu_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); + s32 rtl8192fu_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); + s32 rtl8192fu_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); + s32 rtl8192fu_xmit_buf_handler(PADAPTER padapter); + #define hal_xmit_handler rtl8192fu_xmit_buf_handler + void rtl8192fu_xmit_tasklet(void *priv); + s32 rtl8192fu_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); + void _dbg_dump_tx_info(_adapter *padapter,int frame_tag,struct tx_desc *ptxdesc); +#endif + +#ifdef CONFIG_PCI_HCI + s32 rtl8192fe_init_xmit_priv(PADAPTER padapter); + void rtl8192fe_free_xmit_priv(PADAPTER padapter); + struct xmit_buf *rtl8192fe_dequeue_xmitbuf(struct rtw_tx_ring *ring); + void rtl8192fe_xmitframe_resume(_adapter *padapter); + s32 rtl8192fe_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); + s32 rtl8192fe_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); + s32 rtl8192fe_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); + void rtl8192fe_xmit_tasklet(void *priv); +#endif + +u8 BWMapping_8192F(PADAPTER Adapter, struct pkt_attrib *pattrib); +u8 SCMapping_8192F(PADAPTER Adapter, struct pkt_attrib *pattrib); + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8703b_cmd.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8703b_cmd.h index 0e798f0311ef..12ff9a1491b1 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8703b_cmd.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8703b_cmd.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -118,7 +114,6 @@ enum h2c_cmd_8703B { #define SET_8703B_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) #define SET_8703B_H2CCMD_PWRMODE_PARM_BCN_EARLY_C2H_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 2, 1, __Value) #define SET_8703B_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -#define SET_8703B_H2CCMD_PWRMODE_PARM_BYTE5(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) #define GET_8703B_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) @@ -164,7 +159,7 @@ enum h2c_cmd_8703B { #define SET_8703B_H2CCMD_BT_MPOPER_PARAM3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) /* _BT_FW_PATCH_0x6A */ -#define SET_8703B_H2CCMD_BT_FW_PATCH_SIZE(__pH2CCmd, __Value) SET_BITS_TO_LE_2BYTE((pu1Byte)(__pH2CCmd), 0, 16, __Value) +#define SET_8703B_H2CCMD_BT_FW_PATCH_SIZE(__pH2CCmd, __Value) SET_BITS_TO_LE_2BYTE((u8 *)(__pH2CCmd), 0, 16, __Value) #define SET_8703B_H2CCMD_BT_FW_PATCH_ADDR0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) #define SET_8703B_H2CCMD_BT_FW_PATCH_ADDR1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) #define SET_8703B_H2CCMD_BT_FW_PATCH_ADDR2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) @@ -182,11 +177,9 @@ enum h2c_cmd_8703B { /* host message to firmware cmd */ void rtl8703b_set_FwPwrMode_cmd(PADAPTER padapter, u8 Mode); void rtl8703b_set_FwJoinBssRpt_cmd(PADAPTER padapter, u8 mstatus); -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, u8 ignore_bw); 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 +189,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 +201,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/rtl8188eu/include/rtl8703b_dm.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8703b_dm.h index 4ee834d70713..1fe6a521d16b 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8703b_dm.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8703b_dm.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +36,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/rtl8188eu/include/rtl8703b_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8703b_hal.h index 432ba272177d..cbd8b0ad781f 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8703b_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8703b_hal.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -111,23 +107,17 @@ typedef struct _RT_8703B_FIRMWARE_HDR { /* Note: We will divide number of page equally for each queue other than public queue! */ /* For General Reserved Page Number(Beacon Queue is reserved page) - * Beacon:2, PS-Poll:1, Null Data:1,Qos Null Data:1,BT Qos Null Data:1 */ -#define BCNQ_PAGE_NUM_8703B 0x08 -#ifdef CONFIG_CONCURRENT_MODE - #define BCNQ1_PAGE_NUM_8703B 0x08 /* 0x04 */ -#else - #define BCNQ1_PAGE_NUM_8703B 0x00 -#endif + * Beacon:MAX_BEACON_LEN/PAGE_SIZE_TX_8703B + * PS-Poll:1, Null Data:1,Qos Null Data:1,BT Qos Null Data:1,CTS-2-SELF,LTE QoS Null*/ -#ifdef CONFIG_PNO_SUPPORT - #undef BCNQ1_PAGE_NUM_8703B - #define BCNQ1_PAGE_NUM_8703B 0x00 /* 0x04 */ -#endif +#define BCNQ_PAGE_NUM_8703B (MAX_BEACON_LEN/PAGE_SIZE_TX_8703B + 6) /*0x08*/ /* For WoWLan , more reserved page - * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, AOAC rpt: 1 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 0x08 + #define WOWLAN_PAGE_NUM_8703B 0x0b #else #define WOWLAN_PAGE_NUM_8703B 0x00 #endif @@ -141,7 +131,7 @@ typedef struct _RT_8703B_FIRMWARE_HDR { #define AP_WOWLAN_PAGE_NUM_8703B 0x02 #endif -#define TX_TOTAL_PAGE_NUMBER_8703B (0xFF - BCNQ_PAGE_NUM_8703B - BCNQ1_PAGE_NUM_8703B - WOWLAN_PAGE_NUM_8703B) +#define TX_TOTAL_PAGE_NUMBER_8703B (0xFF - BCNQ_PAGE_NUM_8703B - WOWLAN_PAGE_NUM_8703B) #define TX_PAGE_BOUNDARY_8703B (TX_TOTAL_PAGE_NUMBER_8703B + 1) #define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8703B TX_TOTAL_PAGE_NUMBER_8703B @@ -225,12 +215,12 @@ void Hal_EfuseParseCustomerID_8703B(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoL void Hal_EfuseParseAntennaDiversity_8703B(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); void Hal_EfuseParseXtal_8703B(PADAPTER pAdapter, u8 *hwinfo, u8 AutoLoadFail); void Hal_EfuseParseThermalMeter_8703B(PADAPTER padapter, u8 *hwinfo, u8 AutoLoadFail); -VOID Hal_EfuseParseVoltage_8703B(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -VOID Hal_EfuseParseBoardType_8703B(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); +void Hal_EfuseParseVoltage_8703B(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); +void Hal_EfuseParseBoardType_8703B(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); 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); @@ -260,7 +250,7 @@ void rtl8703b_stop_thread(_adapter *padapter); void HalSetOutPutGPIO(PADAPTER padapter, u8 index, u8 OutPutValue); #endif #ifdef CONFIG_MP_INCLUDED -int FirmwareDownloadBT(IN PADAPTER Adapter, PRT_MP_FIRMWARE pFirmware); +int FirmwareDownloadBT(PADAPTER Adapter, PRT_MP_FIRMWARE pFirmware); #endif void CCX_FwC2HTxRpt_8703b(PADAPTER padapter, u8 *pdata, u8 len); @@ -271,7 +261,7 @@ void Hal_ReadRFGainOffset(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); #ifdef CONFIG_PCI_HCI BOOLEAN InterruptRecognized8703BE(PADAPTER Adapter); - VOID UpdateInterruptMask8703BE(PADAPTER Adapter, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); + void UpdateInterruptMask8703BE(PADAPTER Adapter, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); #endif #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8703b_led.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8703b_led.h index fb11fdd8ca16..4a79ce03f984 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8703b_led.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8703b_led.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +20,7 @@ #include #include - +#ifdef CONFIG_RTW_SW_LED /* ******************************************************************************** * Interface to manipulate LED objects. * ******************************************************************************** */ @@ -45,4 +41,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/rtl8188eu/include/rtl8703b_recv.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8703b_recv.h index 4c826527e98e..04b1f7b50c80 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8703b_recv.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8703b_recv.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -27,22 +23,18 @@ #if defined(CONFIG_USB_HCI) #ifndef MAX_RECVBUF_SZ - #ifdef PLATFORM_OS_CE - #define MAX_RECVBUF_SZ (8192+1024) /* 8K+1k */ - #else - #ifndef CONFIG_MINIMAL_MEMORY_USAGE - /* #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 (8192+1024) */ /* 8K+1k */ + #ifndef CONFIG_MINIMAL_MEMORY_USAGE + /* #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 (4000) /* about 4K */ + #define MAX_RECVBUF_SZ (15360) /* 15k < 16k */ #endif + /* #define MAX_RECVBUF_SZ (8192+1024) */ /* 8K+1k */ + #else + #define MAX_RECVBUF_SZ (4000) /* about 4K */ #endif #endif /* !MAX_RECVBUF_SZ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8703b_rf.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8703b_rf.h index 0d3d0aa54a3c..bc84a1aeed63 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8703b_rf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8703b_rf.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,20 +12,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 __RTL8703B_RF_H__ #define __RTL8703B_RF_H__ -int PHY_RF6052_Config8703B(IN PADAPTER Adapter); +int PHY_RF6052_Config8703B(PADAPTER Adapter); -VOID +void PHY_RF6052SetBandwidth8703B( - IN PADAPTER Adapter, - IN CHANNEL_WIDTH Bandwidth); + PADAPTER Adapter, + enum channel_width Bandwidth); #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8703b_spec.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8703b_spec.h index e9a13d2fbeda..a71151090dad 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8703b_spec.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8703b_spec.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8703b_sreset.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8703b_sreset.h index fbed1fb263ce..5433c19e1383 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8703b_sreset.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8703b_sreset.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/rtl8703b_xmit.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8703b_xmit.h index c44609cbcb69..0bfb318987f8 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8703b_xmit.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8703b_xmit.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -189,13 +185,14 @@ #define SET_TX_DESC_ANTSEL_D_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 25, 3, __Value) /* Dword 7 */ - #if (DEV_BUS_TYPE == RT_PCI_INTERFACE) + #ifdef CONFIG_PCI_HCI #define SET_TX_DESC_TX_BUFFER_SIZE_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) - #else + #endif /*CONFIG_PCI_HCI*/ + #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_USB_HCI) #define SET_TX_DESC_TX_DESC_CHECKSUM_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) #endif #define SET_TX_DESC_USB_TXAGG_NUM_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 24, 8, __Value) - #if (DEV_BUS_TYPE == RT_SDIO_INTERFACE) + #ifdef CONFIG_SDIO_HCI #define SET_TX_DESC_SDIO_TXSEQ_8703B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 16, 8, __Value) #endif @@ -293,6 +290,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/rtl8188eu/include/rtl8710b_cmd.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8710b_cmd.h new file mode 100644 index 000000000000..e6f96c717be6 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8710b_cmd.h @@ -0,0 +1,176 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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 __RTL8710B_CMD_H__ +#define __RTL8710B_CMD_H__ + +/* --------------------------------------------------------------------------------------------------------- + * ---------------------------------- H2C CMD DEFINITION ------------------------------------------------ + * --------------------------------------------------------------------------------------------------------- */ + +enum h2c_cmd_8710B { + /* Common Class: 000 */ + H2C_8710B_RSVD_PAGE = 0x00, + H2C_8710B_MEDIA_STATUS_RPT = 0x01, + H2C_8710B_SCAN_ENABLE = 0x02, + H2C_8710B_KEEP_ALIVE = 0x03, + H2C_8710B_DISCON_DECISION = 0x04, + H2C_8710B_PSD_OFFLOAD = 0x05, + H2C_8710B_AP_OFFLOAD = 0x08, + H2C_8710B_BCN_RSVDPAGE = 0x09, + H2C_8710B_PROBERSP_RSVDPAGE = 0x0A, + H2C_8710B_FCS_RSVDPAGE = 0x10, + H2C_8710B_FCS_INFO = 0x11, + H2C_8710B_AP_WOW_GPIO_CTRL = 0x13, + + /* PoweSave Class: 001 */ + H2C_8710B_SET_PWR_MODE = 0x20, + H2C_8710B_PS_TUNING_PARA = 0x21, + H2C_8710B_PS_TUNING_PARA2 = 0x22, + H2C_8710B_P2P_LPS_PARAM = 0x23, + H2C_8710B_P2P_PS_OFFLOAD = 0x24, + H2C_8710B_PS_SCAN_ENABLE = 0x25, + H2C_8710B_SAP_PS_ = 0x26, + H2C_8710B_INACTIVE_PS_ = 0x27, /* Inactive_PS */ + H2C_8710B_FWLPS_IN_IPS_ = 0x28, + + /* Dynamic Mechanism Class: 010 */ + H2C_8710B_MACID_CFG = 0x40, + H2C_8710B_TXBF = 0x41, + H2C_8710B_RSSI_SETTING = 0x42, + H2C_8710B_AP_REQ_TXRPT = 0x43, + H2C_8710B_INIT_RATE_COLLECT = 0x44, + H2C_8710B_RA_PARA_ADJUST = 0x46, + + /* WOWLAN Class: 100 */ + H2C_8710B_WOWLAN = 0x80, + H2C_8710B_REMOTE_WAKE_CTRL = 0x81, + H2C_8710B_AOAC_GLOBAL_INFO = 0x82, + H2C_8710B_AOAC_RSVD_PAGE = 0x83, + H2C_8710B_AOAC_RSVD_PAGE2 = 0x84, + H2C_8710B_D0_SCAN_OFFLOAD_CTRL = 0x85, + H2C_8710B_D0_SCAN_OFFLOAD_INFO = 0x86, + H2C_8710B_CHNL_SWITCH_OFFLOAD = 0x87, + H2C_8710B_P2P_OFFLOAD_RSVD_PAGE = 0x8A, + H2C_8710B_P2P_OFFLOAD = 0x8B, + + H2C_8710B_RESET_TSF = 0xC0, + H2C_8710B_MAXID, +}; + +/* --------------------------------------------------------------------------------------------------------- + * ---------------------------------- H2C CMD CONTENT -------------------------------------------------- + * --------------------------------------------------------------------------------------------------------- + * _RSVDPAGE_LOC_CMD_0x00 */ +#define SET_8710B_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) +#define SET_8710B_H2CCMD_RSVDPAGE_LOC_PSPOLL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) +#define SET_8710B_H2CCMD_RSVDPAGE_LOC_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) +#define SET_8710B_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) +#define SET_8710B_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) + +/* _PWR_MOD_CMD_0x20 */ +#define SET_8710B_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) +#define SET_8710B_H2CCMD_PWRMODE_PARM_RLBM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 4, __Value) +#define SET_8710B_H2CCMD_PWRMODE_PARM_SMART_PS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 4, 4, __Value) +#define SET_8710B_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) +#define SET_8710B_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) +#define SET_8710B_H2CCMD_PWRMODE_PARM_BCN_EARLY_C2H_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 2, 1, __Value) +#define SET_8710B_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) + +#define GET_8710B_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) + +/* _PS_TUNE_PARAM_CMD_0x21 */ +#define SET_8710B_H2CCMD_PSTUNE_PARM_BCN_TO_LIMIT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) +#define SET_8710B_H2CCMD_PSTUNE_PARM_DTIM_TIMEOUT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) +#define SET_8710B_H2CCMD_PSTUNE_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 1, __Value) +#define SET_8710B_H2CCMD_PSTUNE_PARM_PS_TIMEOUT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 1, 7, __Value) +#define SET_8710B_H2CCMD_PSTUNE_PARM_DTIM_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) + +/* _MACID_CFG_CMD_0x40 */ +#define SET_8710B_H2CCMD_MACID_CFG_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) +#define SET_8710B_H2CCMD_MACID_CFG_RAID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 5, __Value) +#define SET_8710B_H2CCMD_MACID_CFG_SGI_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 7, 1, __Value) +#define SET_8710B_H2CCMD_MACID_CFG_BW(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 2, __Value) +#define SET_8710B_H2CCMD_MACID_CFG_NO_UPDATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 3, 1, __Value) +#define SET_8710B_H2CCMD_MACID_CFG_VHT_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 4, 2, __Value) +#define SET_8710B_H2CCMD_MACID_CFG_DISPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 6, 1, __Value) +#define SET_8710B_H2CCMD_MACID_CFG_DISRA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 7, 1, __Value) +#define SET_8710B_H2CCMD_MACID_CFG_RATE_MASK0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) +#define SET_8710B_H2CCMD_MACID_CFG_RATE_MASK1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) +#define SET_8710B_H2CCMD_MACID_CFG_RATE_MASK2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+5, 0, 8, __Value) +#define SET_8710B_H2CCMD_MACID_CFG_RATE_MASK3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+6, 0, 8, __Value) + +/* _RSSI_SETTING_CMD_0x42 */ +#define SET_8710B_H2CCMD_RSSI_SETTING_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) +#define SET_8710B_H2CCMD_RSSI_SETTING_RSSI(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 7, __Value) +#define SET_8710B_H2CCMD_RSSI_SETTING_ULDL_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) + +/* _AP_REQ_TXRPT_CMD_0x43 */ +#define SET_8710B_H2CCMD_APREQRPT_PARM_MACID1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) +#define SET_8710B_H2CCMD_APREQRPT_PARM_MACID2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) + +/* _FORCE_BT_TXPWR_CMD_0x62 */ +#define SET_8710B_H2CCMD_BT_PWR_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) + +/* _FORCE_BT_MP_OPER_CMD_0x67 */ +#define SET_8710B_H2CCMD_BT_MPOPER_VER(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 4, __Value) +#define SET_8710B_H2CCMD_BT_MPOPER_REQNUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 4, __Value) +#define SET_8710B_H2CCMD_BT_MPOPER_IDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) +#define SET_8710B_H2CCMD_BT_MPOPER_PARAM1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) +#define SET_8710B_H2CCMD_BT_MPOPER_PARAM2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+3, 0, 8, __Value) +#define SET_8710B_H2CCMD_BT_MPOPER_PARAM3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) + +/* _BT_FW_PATCH_0x6A */ +#define SET_8710B_H2CCMD_BT_FW_PATCH_SIZE(__pH2CCmd, __Value) SET_BITS_TO_LE_2BYTE((u8 *)(__pH2CCmd), 0, 16, __Value) +#define SET_8710B_H2CCMD_BT_FW_PATCH_ADDR0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) +#define SET_8710B_H2CCMD_BT_FW_PATCH_ADDR1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) +#define SET_8710B_H2CCMD_BT_FW_PATCH_ADDR2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) +#define SET_8710B_H2CCMD_BT_FW_PATCH_ADDR3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) + +/* --------------------------------------------------------------------------------------------------------- + * ------------------------------------------- Structure -------------------------------------------------- + * --------------------------------------------------------------------------------------------------------- */ + + +/* --------------------------------------------------------------------------------------------------------- + * ---------------------------------- Function Statement -------------------------------------------------- + * --------------------------------------------------------------------------------------------------------- */ + +/* host message to firmware cmd */ +void rtl8710b_set_FwPwrMode_cmd(PADAPTER padapter, u8 Mode); +void rtl8710b_set_FwJoinBssRpt_cmd(PADAPTER padapter, u8 mstatus); +/* s32 rtl8710b_set_lowpwr_lps_cmd(PADAPTER padapter, u8 enable); */ +void rtl8710b_set_FwPsTuneParam_cmd(PADAPTER padapter); +void rtl8710b_download_rsvd_page(PADAPTER padapter, u8 mstatus); +#ifdef CONFIG_BT_COEXIST + void rtl8710b_download_BTCoex_AP_mode_rsvd_page(PADAPTER padapter); +#endif /* CONFIG_BT_COEXIST */ +#ifdef CONFIG_P2P + void rtl8710b_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); +#endif /* CONFIG_P2P */ + +#ifdef CONFIG_TDLS +#ifdef CONFIG_TDLS_CH_SW +void rtl8710b_set_BcnEarly_C2H_Rpt_cmd(PADAPTER padapter, u8 enable); +#endif +#endif + +#ifdef CONFIG_P2P_WOWLAN + void rtl8710b_set_p2p_wowlan_offload_cmd(PADAPTER padapter); +#endif + +s32 FillH2CCmd8710B(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); +u8 GetTxBufferRsvdPageNum8710B(_adapter *padapter, bool wowlan); +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8710b_dm.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8710b_dm.h new file mode 100644 index 000000000000..56412d62efe7 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8710b_dm.h @@ -0,0 +1,40 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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 __RTL8710B_DM_H__ +#define __RTL8710B_DM_H__ +/* ************************************************************ + * Description: + * + * This file is for 8710B dynamic mechanism only + * + * + * ************************************************************ */ + +/* ************************************************************ + * structure and define + * ************************************************************ */ + +/* ************************************************************ + * function prototype + * ************************************************************ */ + +void rtl8710b_init_dm_priv(PADAPTER padapter); +void rtl8710b_deinit_dm_priv(PADAPTER padapter); + +void rtl8710b_InitHalDm(PADAPTER padapter); +void rtl8710b_HalDmWatchDog(PADAPTER padapter); + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8710b_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8710b_hal.h new file mode 100644 index 000000000000..23c087c76000 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8710b_hal.h @@ -0,0 +1,278 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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 __RTL8710B_HAL_H__ +#define __RTL8710B_HAL_H__ + +#include "hal_data.h" + +#include "rtl8710b_spec.h" +#include "rtl8710b_rf.h" +#include "rtl8710b_dm.h" +#include "rtl8710b_recv.h" +#include "rtl8710b_xmit.h" +#include "rtl8710b_cmd.h" +#include "rtl8710b_led.h" +#include "Hal8710BPwrSeq.h" +#include "Hal8710BPhyReg.h" +#include "Hal8710BPhyCfg.h" +#ifdef DBG_CONFIG_ERROR_DETECT + #include "rtl8710b_sreset.h" +#endif +#ifdef CONFIG_LPS_POFF + #include "rtl8710b_lps_poff.h" +#endif + +#define FW_8710B_SIZE 0x8000 +#define FW_8710B_START_ADDRESS 0x1000 +#define FW_8710B_END_ADDRESS 0x1FFF /* 0x5FFF */ + +typedef struct _RT_FIRMWARE { + FIRMWARE_SOURCE eFWSource; +#ifdef CONFIG_EMBEDDED_FWIMG + u8 *szFwBuffer; +#else + u8 szFwBuffer[FW_8710B_SIZE]; +#endif + u32 ulFwLength; +} RT_FIRMWARE_8710B, *PRT_FIRMWARE_8710B; + +/* + * This structure must be cared byte-ordering + * + * Added by tynli. 2009.12.04. */ +typedef struct _RT_8710B_FIRMWARE_HDR { + /* 8-byte alinment required */ + + /* --- LONG WORD 0 ---- */ + u16 Signature; /* 92C0: test chip; 92C, 88C0: test chip; 88C1: MP A-cut; 92C1: MP A-cut */ + u8 Category; /* AP/NIC and USB/PCI */ + u8 Function; /* Reserved for different FW function indcation, for further use when driver needs to download different FW in different conditions */ + u16 Version; /* FW Version */ + u16 Subversion; /* FW Subversion, default 0x00 */ + + /* --- LONG WORD 1 ---- */ + u8 Month; /* Release time Month field */ + u8 Date; /* Release time Date field */ + u8 Hour; /* Release time Hour field */ + u8 Minute; /* Release time Minute field */ + u16 RamCodeSize; /* The size of RAM code */ + u16 Rsvd2; + + /* --- LONG WORD 2 ---- */ + u32 SvnIdx; /* The SVN entry index */ + u32 Rsvd3; + + /* --- LONG WORD 3 ---- */ + u32 Rsvd4; + u32 Rsvd5; +} RT_8710B_FIRMWARE_HDR, *PRT_8710B_FIRMWARE_HDR; + +#define DRIVER_EARLY_INT_TIME_8710B 0x05 +#define BCN_DMA_ATIME_INT_TIME_8710B 0x02 + +/* for 8710B + * TX 32K, RX 16K, Page size 128B for TX, 8B for RX */ +#define PAGE_SIZE_TX_8710B 128 +#define PAGE_SIZE_RX_8710B 8 + +#define TX_DMA_SIZE_8710B 0x8000 /* 32K(TX) */ +#define RX_DMA_SIZE_8710B 0x4000 /* 16K(RX) */ + +#ifdef CONFIG_WOWLAN + #define RESV_FMWF (WKFMCAM_SIZE * MAX_WKFM_CAM_NUM) /* 16 entries, for each is 24 bytes*/ +#else + #define RESV_FMWF 0 +#endif + +#ifdef CONFIG_FW_C2H_DEBUG + #define RX_DMA_RESERVED_SIZE_8710B 0x100 /* 256B, reserved for c2h debug message */ +#else + #define RX_DMA_RESERVED_SIZE_8710B 0x80 /* 128B, reserved for tx report */ +#endif +#define RX_DMA_BOUNDARY_8710B\ + (RX_DMA_SIZE_8710B - RX_DMA_RESERVED_SIZE_8710B - 1) + + +/* Note: We will divide number of page equally for each queue other than public queue! */ + +/* For General Reserved Page Number(Beacon Queue is reserved page) + * Beacon:MAX_BEACON_LEN/PAGE_SIZE_TX_8710B + * PS-Poll:1, Null Data:1,Qos Null Data:1,BT Qos Null Data:1,CTS-2-SELF,LTE QoS Null*/ +#define BCNQ_PAGE_NUM_8710B (MAX_BEACON_LEN/PAGE_SIZE_TX_8710B + 6) /*0x08*/ + + +/* For WoWLan , more reserved page + * 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_8710B 0x0b +#else + #define WOWLAN_PAGE_NUM_8710B 0x00 +#endif + +#ifdef CONFIG_PNO_SUPPORT + #undef WOWLAN_PAGE_NUM_8710B + #define WOWLAN_PAGE_NUM_8710B 0x15 +#endif + +#ifdef CONFIG_AP_WOWLAN + #define AP_WOWLAN_PAGE_NUM_8710B 0x02 +#endif + +#define TX_TOTAL_PAGE_NUMBER_8710B\ + (0xFF - BCNQ_PAGE_NUM_8710B -WOWLAN_PAGE_NUM_8710B) +#define TX_PAGE_BOUNDARY_8710B (TX_TOTAL_PAGE_NUMBER_8710B + 1) + +#define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8710B TX_TOTAL_PAGE_NUMBER_8710B +#define WMM_NORMAL_TX_PAGE_BOUNDARY_8710B\ + (WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8710B + 1) + +/* For Normal Chip Setting + * (HPQ + LPQ + NPQ + PUBQ) shall be TX_TOTAL_PAGE_NUMBER_8710B */ +#define NORMAL_PAGE_NUM_HPQ_8710B 0x0C +#define NORMAL_PAGE_NUM_LPQ_8710B 0x02 +#define NORMAL_PAGE_NUM_NPQ_8710B 0x02 +#define NORMAL_PAGE_NUM_EPQ_8710B 0x04 + +/* Note: For Normal Chip Setting, modify later */ +#define WMM_NORMAL_PAGE_NUM_HPQ_8710B 0x30 +#define WMM_NORMAL_PAGE_NUM_LPQ_8710B 0x20 +#define WMM_NORMAL_PAGE_NUM_NPQ_8710B 0x20 +#define WMM_NORMAL_PAGE_NUM_EPQ_8710B 0x00 + + +#include "HalVerDef.h" +#include "hal_com.h" + +#define EFUSE_OOB_PROTECT_BYTES (96 + 1) + +#define HAL_EFUSE_MEMORY +#define HWSET_MAX_SIZE_8710B 512 +#define EFUSE_REAL_CONTENT_LEN_8710B 512 +#define EFUSE_MAP_LEN_8710B 512 +#define EFUSE_MAX_SECTION_8710B 64 + +/* For some inferiority IC purpose. added by Roger, 2009.09.02.*/ +#define EFUSE_IC_ID_OFFSET 506 +#define AVAILABLE_EFUSE_ADDR(addr) (addr < EFUSE_REAL_CONTENT_LEN_8710B) + +#define EFUSE_ACCESS_ON 0x69 +#define EFUSE_ACCESS_OFF 0x00 + +#define PACKAGE_QFN32_S 0 +#define PACKAGE_QFN48M_S 1 //definiton 8188GU Dongle Package, Efuse Physical Address 0xF8 = 0xFE +#define PACKAGE_QFN48_S 2 +#define PACKAGE_QFN64_S 3 +#define PACKAGE_QFN32_U 4 +#define PACKAGE_QFN48M_U 5 //definiton 8188GU Dongle Package, Efuse Physical Address 0xF8 = 0xEE +#define PACKAGE_QFN48_U 6 +#define PACKAGE_QFN68_U 7 + +typedef enum _PACKAGE_TYPE_E +{ + PACKAGE_DEFAULT, + PACKAGE_QFN68, + PACKAGE_TFBGA90, + PACKAGE_TFBGA80, + PACKAGE_TFBGA79 +}PACKAGE_TYPE_E; + +#define INCLUDE_MULTI_FUNC_GPS(_Adapter) \ + (GET_HAL_DATA(_Adapter)->MultiFunc & RT_MULTI_FUNC_GPS) + +#ifdef CONFIG_FILE_FWIMG + extern char *rtw_fw_file_path; + extern char *rtw_fw_wow_file_path; + #ifdef CONFIG_MP_INCLUDED + extern char *rtw_fw_mp_bt_file_path; + #endif /* CONFIG_MP_INCLUDED */ +#endif /* CONFIG_FILE_FWIMG */ + +/* rtl8710b_hal_init.c */ +s32 rtl8710b_FirmwareDownload(PADAPTER padapter, BOOLEAN bUsedWoWLANFw); +void rtl8710b_FirmwareSelfReset(PADAPTER padapter); +void rtl8710b_InitializeFirmwareVars(PADAPTER padapter); + +void rtl8710b_InitAntenna_Selection(PADAPTER padapter); +void rtl8710b_DeinitAntenna_Selection(PADAPTER padapter); +void rtl8710b_CheckAntenna_Selection(PADAPTER padapter); +void rtl8710b_init_default_value(PADAPTER padapter); + + +u32 indirect_read32_8710b(PADAPTER padapter, u32 regaddr); +void indirect_write32_8710b(PADAPTER padapter, u32 regaddr, u32 data); +u32 hal_query_syson_reg_8710b(PADAPTER padapter, u32 regaddr, u32 bitmask); +void hal_set_syson_reg_8710b(PADAPTER padapter, u32 regaddr, u32 bitmask, u32 data); +#define HAL_SetSYSOnReg hal_set_syson_reg_8710b + + +/* EFuse */ +u8 GetEEPROMSize8710B(PADAPTER padapter); + +#if 0 +void Hal_InitPGData(PADAPTER padapter, u8 *PROMContent); +void Hal_EfuseParseIDCode(PADAPTER padapter, u8 *hwinfo); +void Hal_EfuseParseTxPowerInfo_8710B(PADAPTER padapter, + u8 *PROMContent, BOOLEAN AutoLoadFail); +void Hal_EfuseParseEEPROMVer_8710B(PADAPTER padapter, + u8 *hwinfo, BOOLEAN AutoLoadFail); +void Hal_EfuseParsePackageType_8710B(PADAPTER pAdapter, + u8 *hwinfo, BOOLEAN AutoLoadFail); +void Hal_EfuseParseChnlPlan_8710B(PADAPTER padapter, + u8 *hwinfo, BOOLEAN AutoLoadFail); +void Hal_EfuseParseCustomerID_8710B(PADAPTER padapter, + u8 *hwinfo, BOOLEAN AutoLoadFail); +void Hal_EfuseParseAntennaDiversity_8710B(PADAPTER padapter, + u8 *hwinfo, BOOLEAN AutoLoadFail); +void Hal_EfuseParseXtal_8710B(PADAPTER pAdapter, + u8 *hwinfo, u8 AutoLoadFail); +void Hal_EfuseParseThermalMeter_8710B(PADAPTER padapter, + u8 *hwinfo, u8 AutoLoadFail); +void Hal_EfuseParseBoardType_8710B(PADAPTER Adapter, + u8 *PROMContent, BOOLEAN AutoloadFail); +#endif + +void rtl8710b_set_hal_ops(struct hal_ops *pHalFunc); +void init_hal_spec_8710b(_adapter *adapter); +u8 SetHwReg8710B(PADAPTER padapter, u8 variable, u8 *val); +void GetHwReg8710B(PADAPTER padapter, u8 variable, u8 *val); +u8 SetHalDefVar8710B(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); +u8 GetHalDefVar8710B(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); + +/* register */ +void rtl8710b_InitBeaconParameters(PADAPTER padapter); +void rtl8710b_InitBeaconMaxError(PADAPTER padapter, u8 InfraMode); +void _8051Reset8710(PADAPTER padapter); + +void rtl8710b_start_thread(_adapter *padapter); +void rtl8710b_stop_thread(_adapter *padapter); + +#ifdef CONFIG_GPIO_WAKEUP + void HalSetOutPutGPIO(PADAPTER padapter, u8 index, u8 OutPutValue); +#endif + +void CCX_FwC2HTxRpt_8710b(PADAPTER padapter, u8 *pdata, u8 len); + +u8 MRateToHwRate8710B(u8 rate); +u8 HwRateToMRate8710B(u8 rate); + +#ifdef CONFIG_USB_HCI + void rtl8710b_cal_txdesc_chksum(struct tx_desc *ptxdesc); +#endif + + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8710b_led.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8710b_led.h new file mode 100644 index 000000000000..1077b595f4ce --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8710b_led.h @@ -0,0 +1,45 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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 __RTL8710B_LED_H__ +#define __RTL8710B_LED_H__ + +#include +#include +#include + +#ifdef CONFIG_RTW_SW_LED +/* ******************************************************************************** + * Interface to manipulate LED objects. + * ******************************************************************************** */ +#ifdef CONFIG_USB_HCI + void rtl8710bu_InitSwLeds(PADAPTER padapter); + void rtl8710bu_DeInitSwLeds(PADAPTER padapter); +#endif +#ifdef CONFIG_SDIO_HCI + void rtl8710bs_InitSwLeds(PADAPTER padapter); + void rtl8710bs_DeInitSwLeds(PADAPTER padapter); +#endif +#ifdef CONFIG_GSPI_HCI + void rtl8710bs_InitSwLeds(PADAPTER padapter); + void rtl8710bs_DeInitSwLeds(PADAPTER padapter); +#endif +#ifdef CONFIG_PCI_HCI + void rtl8710be_InitSwLeds(PADAPTER padapter); + void rtl8710be_DeInitSwLeds(PADAPTER padapter); +#endif + +#endif /*#ifdef CONFIG_RTW_SW_LED*/ +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8710b_lps_poff.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8710b_lps_poff.h new file mode 100644 index 000000000000..0528d3774a67 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8710b_lps_poff.h @@ -0,0 +1,57 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or + * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for + * more details. + * + *****************************************************************************/ + +/******************************************** CONST ************************/ +#define NUM_OF_REGISTER_BANK 13 +#define NUM_OF_TOTAL_DWORD (NUM_OF_REGISTER_BANK * 64) +#define TOTAL_LEN_FOR_HIOE ((NUM_OF_TOTAL_DWORD + 1) * 8) +#define LPS_POFF_STATIC_FILE_LEN (TOTAL_LEN_FOR_HIOE + TXDESC_SIZE) +#define LPS_POFF_DYNAMIC_FILE_LEN (512 + TXDESC_SIZE) +/******************************************** CONST ************************/ + +/******************************************** MACRO ************************/ +/* HOIE Entry Definition */ +#define SET_HOIE_ENTRY_LOW_DATA(__pHOIE, __Value) \ + SET_BITS_TO_LE_4BYTE((__pHOIE), 0, 16, __Value) +#define SET_HOIE_ENTRY_HIGH_DATA(__pHOIE, __Value) \ + SET_BITS_TO_LE_4BYTE((__pHOIE), 16, 16, __Value) +#define SET_HOIE_ENTRY_MODE_SELECT(__pHOIE, __Value) \ + SET_BITS_TO_LE_4BYTE((__pHOIE)+4, 0, 1, __Value) +#define SET_HOIE_ENTRY_ADDRESS(__pHOIE, __Value) \ + SET_BITS_TO_LE_4BYTE((__pHOIE)+4, 1, 14, __Value) +#define SET_HOIE_ENTRY_BYTE_MASK(__pHOIE, __Value) \ + SET_BITS_TO_LE_4BYTE((__pHOIE)+4, 15, 4, __Value) +#define SET_HOIE_ENTRY_IO_LOCK(__pHOIE, __Value) \ + SET_BITS_TO_LE_4BYTE((__pHOIE)+4, 19, 1, __Value) +#define SET_HOIE_ENTRY_RD_EN(__pHOIE, __Value) \ + SET_BITS_TO_LE_4BYTE((__pHOIE)+4, 20, 1, __Value) +#define SET_HOIE_ENTRY_WR_EN(__pHOIE, __Value) \ + SET_BITS_TO_LE_4BYTE((__pHOIE)+4, 21, 1, __Value) +#define SET_HOIE_ENTRY_RAW_RW(__pHOIE, __Value) \ + SET_BITS_TO_LE_4BYTE((__pHOIE)+4, 22, 1, __Value) +#define SET_HOIE_ENTRY_RAW(__pHOIE, __Value) \ + SET_BITS_TO_LE_4BYTE((__pHOIE)+4, 23, 1, __Value) +#define SET_HOIE_ENTRY_IO_DELAY(__pHOIE, __Value) \ + SET_BITS_TO_LE_4BYTE((__pHOIE)+4, 24, 8, __Value) + +/*********************Function Definition*******************************************/ +void rtl8710b_lps_poff_init(PADAPTER padapter); +void rtl8710b_lps_poff_deinit(PADAPTER padapter); +bool rtl8710b_lps_poff_get_txbndy_status(PADAPTER padapter); +void rtl8710b_lps_poff_h2c_ctrl(PADAPTER padapter, u8 enable); +void rtl8710b_lps_poff_set_ps_mode(PADAPTER padapter, bool bEnterLPS); +bool rtl8710b_lps_poff_get_status(PADAPTER padapter); +void rtl8710b_lps_poff_wow(PADAPTER padapter); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8710b_recv.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8710b_recv.h new file mode 100644 index 000000000000..58a31afe51ba --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8710b_recv.h @@ -0,0 +1,82 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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 __RTL8710B_RECV_H__ +#define __RTL8710B_RECV_H__ + +#define RECV_BLK_SZ 512 +#define RECV_BLK_CNT 16 +#define RECV_BLK_TH RECV_BLK_CNT + +#if defined(CONFIG_USB_HCI) + #ifndef MAX_RECVBUF_SZ + #ifdef CONFIG_MINIMAL_MEMORY_USAGE + #define MAX_RECVBUF_SZ (4000) /* about 4K */ + #else + #ifdef CONFIG_PLATFORM_MSTAR + #define MAX_RECVBUF_SZ (8192) /* 8K */ + #elif defined(CONFIG_PLATFORM_HISILICON) + #define MAX_RECVBUF_SZ (16384) /* 16k */ + #else + #define MAX_RECVBUF_SZ (15360) /* 15k < 16k */ + /* #define MAX_RECVBUF_SZ (32768) */ /* 32k */ + /* #define MAX_RECVBUF_SZ (20480) */ /* 20K */ + /* #define MAX_RECVBUF_SZ (10240) */ /* 10K */ + /* #define MAX_RECVBUF_SZ (16384) */ /* 16k - 92E RX BUF :16K */ + #endif + #endif + #endif /* !MAX_RECVBUF_SZ */ +#endif + +/* Rx smooth factor */ +#define Rx_Smooth_Factor (20) + +/*-----------------------------------------------------------------*/ +/* RTL8710B RX BUFFER DESC */ +/*-----------------------------------------------------------------*/ +/*DWORD 0*/ +#define SET_RX_BUFFER_DESC_DATA_LENGTH_8710B(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 0, 14, __Value) +#define SET_RX_BUFFER_DESC_LS_8710B(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 15, 1, __Value) +#define SET_RX_BUFFER_DESC_FS_8710B(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 16, 1, __Value) +#define SET_RX_BUFFER_DESC_TOTAL_LENGTH_8710B(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 16, 15, __Value) + +#define GET_RX_BUFFER_DESC_OWN_8710B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 31, 1) +#define GET_RX_BUFFER_DESC_LS_8710B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 15, 1) +#define GET_RX_BUFFER_DESC_FS_8710B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 1) +#ifdef USING_RX_TAG + #define GET_RX_BUFFER_DESC_RX_TAG_8710B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 13) +#else + #define GET_RX_BUFFER_DESC_TOTAL_LENGTH_8710B(__pRxStatusDesc) LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 15) +#endif + +/*DWORD 1*/ +#define SET_RX_BUFFER_PHYSICAL_LOW_8710B(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc+4, 0, 32, __Value) + +/*DWORD 2*/ +#ifdef CONFIG_64BIT_DMA + #define SET_RX_BUFFER_PHYSICAL_HIGH_8710B(__pRxStatusDesc, __Value) SET_BITS_TO_LE_4BYTE(__pRxStatusDesc+8, 0, 32, __Value) +#else + #define SET_RX_BUFFER_PHYSICAL_HIGH_8710B(__pRxStatusDesc, __Value) +#endif + +#ifdef CONFIG_USB_HCI + int rtl8710bu_init_recv_priv(_adapter *padapter); + void rtl8710bu_free_recv_priv(_adapter *padapter); + void rtl8710bu_init_recvbuf(_adapter *padapter, struct recv_buf *precvbuf); +#endif + +void rtl8710b_query_rx_desc_status(union recv_frame *precvframe, u8 *pdesc); + +#endif /* __RTL8710B_RECV_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8710b_rf.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8710b_rf.h new file mode 100644 index 000000000000..e76a7828e628 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8710b_rf.h @@ -0,0 +1,21 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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 __RTL8710B_RF_H__ +#define __RTL8710B_RF_H__ + +int PHY_RF6052_Config8710B(PADAPTER pdapter); + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8710b_spec.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8710b_spec.h new file mode 100644 index 000000000000..171144208dd1 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8710b_spec.h @@ -0,0 +1,482 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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 __RTL8710B_SPEC_H__ +#define __RTL8710B_SPEC_H__ + +#include + + +#define HAL_NAV_UPPER_UNIT_8710B 128 /* micro-second */ + +/* ----------------------------------------------------- + * + * 0x0000h ~ 0x00FFh System Configuration + * + * ----------------------------------------------------- */ +#define REG_SYS_ISO_CTRL_8710B 0x0000 /* 2 Byte */ +#define REG_APS_FSMCO_8710B 0x0004 /* 4 Byte */ +#define REG_SYS_CLKR_8710B 0x0008 /* 2 Byte */ +#define REG_9346CR_8710B 0x000A /* 2 Byte */ +#define REG_EE_VPD_8710B 0x000C /* 2 Byte */ +#define REG_AFE_MISC_8710B 0x0010 /* 1 Byte */ +#define REG_SPS0_CTRL_8710B 0x0011 /* 7 Byte */ +#define REG_SPS_OCP_CFG_8710B 0x0018 /* 4 Byte */ +#define REG_RSV_CTRL_8710B 0x001C /* 3 Byte */ +#define REG_RF_CTRL_8710B 0x001F /* 1 Byte */ +#define REG_LPLDO_CTRL_8710B 0x0023 /* 1 Byte */ +#define REG_AFE_XTAL_CTRL_8710B 0x0024 /* 4 Byte */ +#define REG_AFE_PLL_CTRL_8710B 0x0028 /* 4 Byte */ +#define REG_MAC_PLL_CTRL_EXT_8710B 0x002c /* 4 Byte */ +#define REG_EFUSE_CTRL_8710B 0x0030 +#define REG_EFUSE_TEST_8710B 0x0034 +#define REG_PWR_DATA_8710B 0x0038 +#define REG_CAL_TIMER_8710B 0x003C +#define REG_ACLK_MON_8710B 0x003E +#define REG_GPIO_MUXCFG_8710B 0x0040 +#define REG_GPIO_IO_SEL_8710B 0x0042 +#define REG_MAC_PINMUX_CFG_8710B 0x0043 +#define REG_GPIO_PIN_CTRL_8710B 0x0044 +#define REG_GPIO_INTM_8710B 0x0048 +#define REG_LEDCFG0_8710B 0x004C +#define REG_LEDCFG1_8710B 0x004D +#define REG_LEDCFG2_8710B 0x004E +#define REG_LEDCFG3_8710B 0x004F +#define REG_FSIMR_8710B 0x0050 +#define REG_FSISR_8710B 0x0054 +#define REG_HSIMR_8710B 0x0058 +#define REG_HSISR_8710B 0x005c +#define REG_GPIO_EXT_CTRL 0x0060 +#define REG_PAD_CTRL1_8710B 0x0064 +#define REG_MULTI_FUNC_CTRL_8710B 0x0068 +#define REG_GPIO_STATUS_8710B 0x006C +#define REG_SDIO_CTRL_8710B 0x0070 +#define REG_OPT_CTRL_8710B 0x0074 +#define REG_AFE_CTRL_4_8710B 0x0078 +#define REG_MCUFWDL_8710B 0x0080 +#define REG_8051FW_CTRL_8710B 0x0080 +#define REG_HMEBOX_DBG_0_8710B 0x0088 +#define REG_HMEBOX_DBG_1_8710B 0x008A +#define REG_HMEBOX_DBG_2_8710B 0x008C +#define REG_HMEBOX_DBG_3_8710B 0x008E +#define REG_WLLPS_CTRL 0x0090 + +#define REG_PMC_DBG_CTRL2_8710B 0x00CC +#define REG_EFUSE_BURN_GNT_8710B 0x00CF +#define REG_HPON_FSM_8710B 0x00EC +#define REG_SYS_CFG1_8710B 0x00F0 +#define REG_SYS_CFG_8710B 0x00FC +#define REG_ROM_VERSION 0x00FD + +/* ----------------------------------------------------- + * + * 0x0100h ~ 0x01FFh MACTOP General Configuration + * + * ----------------------------------------------------- */ +#define REG_C2HEVT_CMD_ID_8710B 0x01A0 +#define REG_C2HEVT_CMD_SEQ_88XX 0x01A1 +#define REG_C2hEVT_CMD_CONTENT_88XX 0x01A2 +#define REG_C2HEVT_CMD_LEN_8710B 0x01AE +#define REG_C2HEVT_CLEAR_8710B 0x01AF +#define REG_MCUTST_1_8710B 0x01C0 +#define REG_WOWLAN_WAKE_REASON 0x01C7 +#define REG_FMETHR_8710B 0x01C8 +#define REG_HMETFR_8710B 0x01CC +#define REG_HMEBOX_0_8710B 0x01D0 +#define REG_HMEBOX_1_8710B 0x01D4 +#define REG_HMEBOX_2_8710B 0x01D8 +#define REG_HMEBOX_3_8710B 0x01DC +#define REG_LLT_INIT_8710B 0x01E0 +#define REG_HMEBOX_EXT0_8710B 0x01F0 +#define REG_HMEBOX_EXT1_8710B 0x01F4 +#define REG_HMEBOX_EXT2_8710B 0x01F8 +#define REG_HMEBOX_EXT3_8710B 0x01FC + +/* ----------------------------------------------------- + * + * 0x0200h ~ 0x027Fh TXDMA Configuration + * + * ----------------------------------------------------- */ +#define REG_RQPN_8710B 0x0200 +#define REG_FIFOPAGE_8710B 0x0204 +#define REG_DWBCN0_CTRL_8710B REG_TDECTRL +#define REG_TXDMA_OFFSET_CHK_8710B 0x020C +#define REG_TXDMA_STATUS_8710B 0x0210 +#define REG_RQPN_NPQ_8710B 0x0214 +#define REG_DWBCN1_CTRL_8710B 0x0228 + + +/* ----------------------------------------------------- + * + * 0x0280h ~ 0x02FFh RXDMA Configuration + * + * ----------------------------------------------------- */ +#define REG_RXDMA_AGG_PG_TH_8710B 0x0280 +#define REG_FW_UPD_RDPTR_8710B 0x0284 /* FW shall update this register before FW write RXPKT_RELEASE_POLL to 1 */ +#define REG_RXDMA_CONTROL_8710B 0x0286 /* Control the RX DMA. */ +#define REG_RXDMA_STATUS_8710B 0x0288 +#define REG_RXDMA_MODE_CTRL_8710B 0x0290 +#define REG_EARLY_MODE_CONTROL_8710B 0x02BC +#define REG_RSVD5_8710B 0x02F0 +#define REG_RSVD6_8710B 0x02F4 + +/* ----------------------------------------------------- + * + * 0x0300h ~ 0x03FFh PCIe + * + * ----------------------------------------------------- */ +#define REG_PCIE_CTRL_REG_8710B 0x0300 +#define REG_INT_MIG_8710B 0x0304 /* Interrupt Migration */ +#define REG_BCNQ_TXBD_DESA_8710B 0x0308 /* TX Beacon Descriptor Address */ +#define REG_MGQ_TXBD_DESA_8710B 0x0310 /* TX Manage Queue Descriptor Address */ +#define REG_VOQ_TXBD_DESA_8710B 0x0318 /* TX VO Queue Descriptor Address */ +#define REG_VIQ_TXBD_DESA_8710B 0x0320 /* TX VI Queue Descriptor Address */ +#define REG_BEQ_TXBD_DESA_8710B 0x0328 /* TX BE Queue Descriptor Address */ +#define REG_BKQ_TXBD_DESA_8710B 0x0330 /* TX BK Queue Descriptor Address */ +#define REG_RXQ_RXBD_DESA_8710B 0x0338 /* RX Queue Descriptor Address */ +#define REG_HI0Q_TXBD_DESA_8710B 0x0340 +#define REG_HI1Q_TXBD_DESA_8710B 0x0348 +#define REG_HI2Q_TXBD_DESA_8710B 0x0350 +#define REG_HI3Q_TXBD_DESA_8710B 0x0358 +#define REG_HI4Q_TXBD_DESA_8710B 0x0360 +#define REG_HI5Q_TXBD_DESA_8710B 0x0368 +#define REG_HI6Q_TXBD_DESA_8710B 0x0370 +#define REG_HI7Q_TXBD_DESA_8710B 0x0378 +#define REG_MGQ_TXBD_NUM_8710B 0x0380 +#define REG_RX_RXBD_NUM_8710B 0x0382 +#define REG_VOQ_TXBD_NUM_8710B 0x0384 +#define REG_VIQ_TXBD_NUM_8710B 0x0386 +#define REG_BEQ_TXBD_NUM_8710B 0x0388 +#define REG_BKQ_TXBD_NUM_8710B 0x038A +#define REG_HI0Q_TXBD_NUM_8710B 0x038C +#define REG_HI1Q_TXBD_NUM_8710B 0x038E +#define REG_HI2Q_TXBD_NUM_8710B 0x0390 +#define REG_HI3Q_TXBD_NUM_8710B 0x0392 +#define REG_HI4Q_TXBD_NUM_8710B 0x0394 +#define REG_HI5Q_TXBD_NUM_8710B 0x0396 +#define REG_HI6Q_TXBD_NUM_8710B 0x0398 +#define REG_HI7Q_TXBD_NUM_8710B 0x039A +#define REG_TSFTIMER_HCI_8710B 0x039C +#define REG_BD_RW_PTR_CLR_8710B 0x039C + +/* Read Write Point */ +#define REG_VOQ_TXBD_IDX_8710B 0x03A0 +#define REG_VIQ_TXBD_IDX_8710B 0x03A4 +#define REG_BEQ_TXBD_IDX_8710B 0x03A8 +#define REG_BKQ_TXBD_IDX_8710B 0x03AC +#define REG_MGQ_TXBD_IDX_8710B 0x03B0 +#define REG_RXQ_TXBD_IDX_8710B 0x03B4 +#define REG_HI0Q_TXBD_IDX_8710B 0x03B8 +#define REG_HI1Q_TXBD_IDX_8710B 0x03BC +#define REG_HI2Q_TXBD_IDX_8710B 0x03C0 +#define REG_HI3Q_TXBD_IDX_8710B 0x03C4 +#define REG_HI4Q_TXBD_IDX_8710B 0x03C8 +#define REG_HI5Q_TXBD_IDX_8710B 0x03CC +#define REG_HI6Q_TXBD_IDX_8710B 0x03D0 +#define REG_HI7Q_TXBD_IDX_8710B 0x03D4 + +#define REG_PCIE_HCPWM_8710BE 0x03D8 /* ?????? */ +#define REG_PCIE_HRPWM_8710BE 0x03DC /* PCIe RPWM ?????? */ +#define REG_DBI_WDATA_V1_8710B 0x03E8 +#define REG_DBI_RDATA_V1_8710B 0x03EC +#define REG_DBI_FLAG_V1_8710B 0x03F0 +#define REG_MDIO_V1_8710B 0x03F4 +#define REG_PCIE_MIX_CFG_8710B 0x03F8 +#define REG_HCI_MIX_CFG_8710B 0x03FC + +/* ----------------------------------------------------- + * + * 0x0400h ~ 0x047Fh Protocol Configuration + * + * ----------------------------------------------------- */ +#define REG_VOQ_INFORMATION_8710B 0x0400 +#define REG_VIQ_INFORMATION_8710B 0x0404 +#define REG_BEQ_INFORMATION_8710B 0x0408 +#define REG_BKQ_INFORMATION_8710B 0x040C +#define REG_MGQ_INFORMATION_8710B 0x0410 +#define REG_HGQ_INFORMATION_8710B 0x0414 +#define REG_BCNQ_INFORMATION_8710B 0x0418 +#define REG_TXPKT_EMPTY_8710B 0x041A + +#define REG_FWHW_TXQ_CTRL_8710B 0x0420 +#define REG_HWSEQ_CTRL_8710B 0x0423 +#define REG_TXPKTBUF_BCNQ_BDNY_8710B 0x0424 +#define REG_TXPKTBUF_MGQ_BDNY_8710B 0x0425 +#define REG_LIFECTRL_CTRL_8710B 0x0426 +#define REG_MULTI_BCNQ_OFFSET_8710B 0x0427 +#define REG_SPEC_SIFS_8710B 0x0428 +#define REG_RL_8710B 0x042A +#define REG_TXBF_CTRL_8710B 0x042C +#define REG_DARFRC_8710B 0x0430 +#define REG_RARFRC_8710B 0x0438 +#define REG_RRSR_8710B 0x0440 +#define REG_ARFR0_8710B 0x0444 +#define REG_ARFR1_8710B 0x044C +#define REG_CCK_CHECK_8710B 0x0454 +#define REG_AMPDU_MAX_TIME_8710B 0x0456 +#define REG_TXPKTBUF_BCNQ_BDNY1_8710B 0x0457 + +#define REG_AMPDU_MAX_LENGTH_8710B 0x0458 +#define REG_TXPKTBUF_WMAC_LBK_BF_HD_8710B 0x045D +#define REG_NDPA_OPT_CTRL_8710B 0x045F +#define REG_FAST_EDCA_CTRL_8710B 0x0460 +#define REG_RD_RESP_PKT_TH_8710B 0x0463 +#define REG_DATA_SC_8710B 0x0483 +#ifdef CONFIG_WOWLAN + #define REG_TXPKTBUF_IV_LOW 0x0484 + #define REG_TXPKTBUF_IV_HIGH 0x0488 +#endif +#define REG_TXRPT_START_OFFSET 0x04AC +#define REG_POWER_STAGE1_8710B 0x04B4 +#define REG_POWER_STAGE2_8710B 0x04B8 +#define REG_AMPDU_BURST_MODE_8710B 0x04BC +#define REG_PKT_VO_VI_LIFE_TIME_8710B 0x04C0 +#define REG_PKT_BE_BK_LIFE_TIME_8710B 0x04C2 +#define REG_STBC_SETTING_8710B 0x04C4 +#define REG_HT_SINGLE_AMPDU_8710B 0x04C7 +#define REG_PROT_MODE_CTRL_8710B 0x04C8 +#define REG_MAX_AGGR_NUM_8710B 0x04CA +#define REG_RTS_MAX_AGGR_NUM_8710B 0x04CB +#define REG_BAR_MODE_CTRL_8710B 0x04CC +#define REG_RA_TRY_RATE_AGG_LMT_8710B 0x04CF +#define REG_MACID_PKT_DROP0_8710B 0x04D0 +#define REG_MACID_PKT_SLEEP_8710B 0x04D4 + +/* ----------------------------------------------------- + * + * 0x0500h ~ 0x05FFh EDCA Configuration + * + * ----------------------------------------------------- */ +#define REG_EDCA_VO_PARAM_8710B 0x0500 +#define REG_EDCA_VI_PARAM_8710B 0x0504 +#define REG_EDCA_BE_PARAM_8710B 0x0508 +#define REG_EDCA_BK_PARAM_8710B 0x050C +#define REG_BCNTCFG_8710B 0x0510 +#define REG_PIFS_8710B 0x0512 +#define REG_RDG_PIFS_8710B 0x0513 +#define REG_SIFS_CTX_8710B 0x0514 +#define REG_SIFS_TRX_8710B 0x0516 +#define REG_AGGR_BREAK_TIME_8710B 0x051A +#define REG_SLOT_8710B 0x051B +#define REG_TX_PTCL_CTRL_8710B 0x0520 +#define REG_TXPAUSE_8710B 0x0522 +#define REG_DIS_TXREQ_CLR_8710B 0x0523 +#define REG_RD_CTRL_8710B 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_8710B 0x0540 +#define REG_RD_NAV_NXT_8710B 0x0544 +#define REG_NAV_PROT_LEN_8710B 0x0546 +#define REG_BCN_CTRL_8710B 0x0550 +#define REG_BCN_CTRL_1_8710B 0x0551 +#define REG_MBID_NUM_8710B 0x0552 +#define REG_DUAL_TSF_RST_8710B 0x0553 +#define REG_BCN_INTERVAL_8710B 0x0554 +#define REG_DRVERLYINT_8710B 0x0558 +#define REG_BCNDMATIM_8710B 0x0559 +#define REG_ATIMWND_8710B 0x055A +#define REG_USTIME_TSF_8710B 0x055C +#define REG_BCN_MAX_ERR_8710B 0x055D +#define REG_RXTSF_OFFSET_CCK_8710B 0x055E +#define REG_RXTSF_OFFSET_OFDM_8710B 0x055F +#define REG_TSFTR_8710B 0x0560 +#define REG_CTWND_8710B 0x0572 +#define REG_SECONDARY_CCA_CTRL_8710B 0x0577 +#define REG_PSTIMER_8710B 0x0580 +#define REG_TIMER0_8710B 0x0584 +#define REG_TIMER1_8710B 0x0588 +#define REG_ACMHWCTRL_8710B 0x05C0 +#define REG_SCH_TXCMD_8710B 0x05F8 + +/* ----------------------------------------------------- + * + * 0x0600h ~ 0x07FFh WMAC Configuration + * + * ----------------------------------------------------- */ +#define REG_MAC_CR_8710B 0x0600 +#define REG_TCR_8710B 0x0604 +#define REG_RCR_8710B 0x0608 +#define REG_RX_PKT_LIMIT_8710B 0x060C +#define REG_RX_DLK_TIME_8710B 0x060D +#define REG_RX_DRVINFO_SZ_8710B 0x060F + +#define REG_MACID_8710B 0x0610 +#define REG_BSSID_8710B 0x0618 +#define REG_MAR_8710B 0x0620 +#define REG_MBIDCAMCFG_8710B 0x0628 +#define REG_WOWLAN_GTK_DBG1 0x630 +#define REG_WOWLAN_GTK_DBG2 0x634 + +#define REG_USTIME_EDCA_8710B 0x0638 +#define REG_MAC_SPEC_SIFS_8710B 0x063A +#define REG_RESP_SIFP_CCK_8710B 0x063C +#define REG_RESP_SIFS_OFDM_8710B 0x063E +#define REG_ACKTO_8710B 0x0640 +#define REG_CTS2TO_8710B 0x0641 +#define REG_EIFS_8710B 0x0642 + +#define REG_NAV_UPPER_8710B 0x0652 /* unit of 128 */ +#define REG_TRXPTCL_CTL_8710B 0x0668 + +/* Security */ +#define REG_CAMCMD_8710B 0x0670 +#define REG_CAMWRITE_8710B 0x0674 +#define REG_CAMREAD_8710B 0x0678 +#define REG_CAMDBG_8710B 0x067C +#define REG_SECCFG_8710B 0x0680 + +/* Power */ +#define REG_WOW_CTRL_8710B 0x0690 +#define REG_PS_RX_INFO_8710B 0x0692 +#define REG_UAPSD_TID_8710B 0x0693 +#define REG_WKFMCAM_CMD_8710B 0x0698 +#define REG_WKFMCAM_NUM_8710B 0x0698 +#define REG_WKFMCAM_RWD_8710B 0x069C +#define REG_RXFLTMAP0_8710B 0x06A0 +#define REG_RXFLTMAP1_8710B 0x06A2 +#define REG_RXFLTMAP2_8710B 0x06A4 +#define REG_BCN_PSR_RPT_8710B 0x06A8 +#define REG_BT_COEX_TABLE_8710B 0x06C0 +#define REG_BFMER0_INFO_8710B 0x06E4 +#define REG_BFMER1_INFO_8710B 0x06EC +#define REG_CSI_RPT_PARAM_BW20_8710B 0x06F4 +#define REG_CSI_RPT_PARAM_BW40_8710B 0x06F8 +#define REG_CSI_RPT_PARAM_BW80_8710B 0x06FC + +/* Hardware Port 2 */ +#define REG_MACID1_8710B 0x0700 +#define REG_BSSID1_8710B 0x0708 +#define REG_BFMEE_SEL_8710B 0x0714 +#define REG_SND_PTCL_CTRL_8710B 0x0718 + +/* LTR */ +#define REG_LTR_CTRL_BASIC_8710B 0x07A4 +#define REG_LTR_IDLE_LATENCY_V1_8710B 0x0798 +#define REG_LTR_ACTIVE_LATENCY_V1_8710B 0x079C + +/* 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 + +/* Other */ +#define REG_USB_ACCESS_TIMEOUT 0xFE4C + +/* ----------------------------------------------------- + * SYSON_REG_SPEC + * ----------------------------------------------------- */ +#define SYSON_REG_BASE_ADDR_8710B 0x40000000 +#define REG_SYS_XTAL_CTRL0 0x0060 +#define REG_SYS_SYSTEM_CFG0 0x1F0 +#define REG_SYS_SYSTEM_CFG1 0x1F4 +#define REG_SYS_SYSTEM_CFG2 0x1F8 +#define REG_SYS_EEPROM_CTRL0 0x0E0 + + +/* ----------------------------------------------------- + * Indirect_R/W_SPEC + * ----------------------------------------------------- */ +#define NORMAL_REG_READ_OFFSET 0x83000000 +#define NORMAL_REG_WRITE_OFFSET 0x84000000 +#define EFUSE_READ_OFFSET 0x85000000 +#define EFUSE_WRITE_OFFSET 0x86000000 + + +/* ----------------------------------------------------- + * PAGE0_WLANON_REG_SPEC + * ----------------------------------------------------- */ +#define PAGE0_OFFSET 0x0 // WLANON_PAGE0_REG needs to add an offset. + + + +/* **************************************************************************** + * 8723 Regsiter Bit and Content definition + * **************************************************************************** */ + + /* ----------------------------------------------------- + * REG_SYS_SYSTEM_CFG0 + * ----------------------------------------------------- */ +#define BIT_RTL_ID_8710B BIT(16) + +#define BIT_MASK_CHIP_VER_8710B 0xf +#define BIT_GET_CHIP_VER_8710B(x) ((x) & BIT_MASK_CHIP_VER_8710B) + +#define BIT_SHIFT_VENDOR_ID_8710B 4 +#define BIT_MASK_VENDOR_ID_8710B 0xf +#define BIT_GET_VENDOR_ID_8710B(x) (((x) >> BIT_SHIFT_VENDOR_ID_8710B) & BIT_MASK_VENDOR_ID_8710B) + + /* ----------------------------------------------------- + * REG_SYS_SYSTEM_CFG1 + * ----------------------------------------------------- */ +#define BIT_SPSLDO_SEL_8710B BIT(25) + + /* ----------------------------------------------------- + * REG_SYS_SYSTEM_CFG2 + * ----------------------------------------------------- */ +#define BIT_MASK_RF_RL_ID_8710B 0xf +#define BIT_GET_RF_RL_ID_8710B(x) ((x) & BIT_MASK_RF_RL_ID_8710B) + + /* ----------------------------------------------------- + * REG_SYS_SYSTEM_CFG2 + * ----------------------------------------------------- */ +#define BIT_EERPOMSEL_8710B BIT(4) +#define BIT_AUTOLOAD_SUS_8710B BIT(5) + + + /* ----------------------------------------------------- + * Other + * ----------------------------------------------------- */ + + +#define BIT_USB_RXDMA_AGG_EN BIT(31) +#define RXDMA_AGG_MODE_EN BIT(1) + +#ifdef CONFIG_WOWLAN + #define RXPKT_RELEASE_POLL BIT(16) + #define RXDMA_IDLE BIT(17) + #define RW_RELEASE_EN BIT(18) +#endif + +/* 2 HSISR + * interrupt mask which needs to clear */ +#define MASK_HSISR_CLEAR (HSISR_GPIO12_0_INT |\ + HSISR_SPS_OCP_INT |\ + HSISR_RON_INT |\ + HSISR_PDNINT |\ + HSISR_GPIO9_INT) + +#ifdef CONFIG_RF_POWER_TRIM + #ifdef CONFIG_RTL8710B + #define EEPROM_RF_GAIN_OFFSET 0xC1 + #endif + + #define EEPROM_RF_GAIN_VAL 0x1F6 +#endif /*CONFIG_RF_POWER_TRIM*/ + +#endif /* __RTL8710B_SPEC_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8710b_sreset.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8710b_sreset.h new file mode 100644 index 000000000000..cac8aacf7d76 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8710b_sreset.h @@ -0,0 +1,25 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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 _RTL8710B_SRESET_H_ +#define _RTL8710B_SRESET_H_ + +#include + +#ifdef DBG_CONFIG_ERROR_DETECT + extern void rtl8710b_sreset_xmit_status_check(_adapter *padapter); + extern void rtl8710b_sreset_linked_status_check(_adapter *padapter); +#endif +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8710b_xmit.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8710b_xmit.h new file mode 100644 index 000000000000..a249df07eca6 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8710b_xmit.h @@ -0,0 +1,523 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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 __RTL8710B_XMIT_H__ +#define __RTL8710B_XMIT_H__ + + +#define MAX_TID (15) + + +#ifndef __INC_HAL8710BDESC_H +#define __INC_HAL8710BDESC_H + +#define RX_STATUS_DESC_SIZE_8710B 24 +#define RX_DRV_INFO_SIZE_UNIT_8710B 8 + + +/* DWORD 0 */ +#define SET_RX_STATUS_DESC_PKT_LEN_8710B(__pRxStatusDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 0, 14, __Value) +#define SET_RX_STATUS_DESC_EOR_8710B(__pRxStatusDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 30, 1, __Value) +#define SET_RX_STATUS_DESC_OWN_8710B(__pRxStatusDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pRxStatusDesc, 31, 1, __Value) + +#define GET_RX_STATUS_DESC_PKT_LEN_8710B(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc, 0, 14) +#define GET_RX_STATUS_DESC_CRC32_8710B(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc, 14, 1) +#define GET_RX_STATUS_DESC_ICV_8710B(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc, 15, 1) +#define GET_RX_STATUS_DESC_DRVINFO_SIZE_8710B(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc, 16, 4) +#define GET_RX_STATUS_DESC_SECURITY_8710B(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc, 20, 3) +#define GET_RX_STATUS_DESC_QOS_8710B(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc, 23, 1) +#define GET_RX_STATUS_DESC_SHIFT_8710B(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc, 24, 2) +#define GET_RX_STATUS_DESC_PHY_STATUS_8710B(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc, 26, 1) +#define GET_RX_STATUS_DESC_SWDEC_8710B(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc, 27, 1) +#define GET_RX_STATUS_DESC_EOR_8710B(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc, 30, 1) +#define GET_RX_STATUS_DESC_OWN_8710B(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc, 31, 1) + +/* DWORD 1 */ +#define GET_RX_STATUS_DESC_MACID_8710B(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+4, 0, 7) +#define GET_RX_STATUS_DESC_TID_8710B(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+4, 8, 4) +#define GET_RX_STATUS_DESC_AMSDU_8710B(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+4, 13, 1) +#define GET_RX_STATUS_DESC_RXID_MATCH_8710B(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+4, 14, 1) +#define GET_RX_STATUS_DESC_PAGGR_8710B(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+4, 15, 1) +#define GET_RX_STATUS_DESC_A1_FIT_8710B(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+4, 16, 4) +#define GET_RX_STATUS_DESC_CHKERR_8710B(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+4, 20, 1) +#define GET_RX_STATUS_DESC_IPVER_8710B(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+4, 21, 1) +#define GET_RX_STATUS_DESC_IS_TCPUDP__8710B(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+4, 22, 1) +#define GET_RX_STATUS_DESC_CHK_VLD_8710B(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+4, 23, 1) +#define GET_RX_STATUS_DESC_PAM_8710B(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+4, 24, 1) +#define GET_RX_STATUS_DESC_PWR_8710B(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+4, 25, 1) +#define GET_RX_STATUS_DESC_MORE_DATA_8710B(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+4, 26, 1) +#define GET_RX_STATUS_DESC_MORE_FRAG_8710B(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+4, 27, 1) +#define GET_RX_STATUS_DESC_TYPE_8710B(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+4, 28, 2) +#define GET_RX_STATUS_DESC_MC_8710B(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+4, 30, 1) +#define GET_RX_STATUS_DESC_BC_8710B(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+4, 31, 1) + +/* DWORD 2 */ +#define GET_RX_STATUS_DESC_SEQ_8710B(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 0, 12) +#define GET_RX_STATUS_DESC_FRAG_8710B(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 12, 4) +#define GET_RX_STATUS_DESC_RX_IS_QOS_8710B(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 16, 1) +#define GET_RX_STATUS_DESC_WLANHD_IV_LEN_8710B(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 18, 6) +#define GET_RX_STATUS_DESC_RPT_SEL_8710B(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 28, 1) +#define GET_RX_STATUS_DESC_FCS_OK_8710B(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc+8, 31, 1) + +/* DWORD 3 */ +#define GET_RX_STATUS_DESC_RX_RATE_8710B(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 0, 7) +#define GET_RX_STATUS_DESC_HTC_8710B(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 10, 1) +#define GET_RX_STATUS_DESC_EOSP_8710B(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 11, 1) +#define GET_RX_STATUS_DESC_BSSID_FIT_8710B(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 12, 2) +#ifdef CONFIG_USB_RX_AGGREGATION +#define GET_RX_STATUS_DESC_USB_AGG_PKTNUM_8710B(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc+12, 16, 8) +#endif +#define GET_RX_STATUS_DESC_PATTERN_MATCH_8710B(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+12, 29, 1) +#define GET_RX_STATUS_DESC_UNICAST_MATCH_8710B(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+12, 30, 1) +#define GET_RX_STATUS_DESC_MAGIC_MATCH_8710B(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+12, 31, 1) + +/* DWORD 6 */ +#define GET_RX_STATUS_DESC_MATCH_ID_8710B(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+16, 0, 7) + +/* DWORD 5 */ +#define GET_RX_STATUS_DESC_TSFL_8710B(__pRxStatusDesc) \ + LE_BITS_TO_4BYTE(__pRxStatusDesc+20, 0, 32) + +#define GET_RX_STATUS_DESC_BUFF_ADDR_8710B(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+24, 0, 32) +#define GET_RX_STATUS_DESC_BUFF_ADDR64_8710B(__pRxDesc) \ + LE_BITS_TO_4BYTE(__pRxDesc+28, 0, 32) + +#define SET_RX_STATUS_DESC_BUFF_ADDR_8710B(__pRxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pRxDesc+24, 0, 32, __Value) + + +/* Dword 0, rsvd: bit26, bit28 */ +#define GET_TX_DESC_OWN_8710B(__pTxDesc)\ + LE_BITS_TO_4BYTE(__pTxDesc, 31, 1) + +#define SET_TX_DESC_PKT_SIZE_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 16, __Value) +#define SET_TX_DESC_OFFSET_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 8, __Value) +#define SET_TX_DESC_BMC_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc, 24, 1, __Value) +#define SET_TX_DESC_HTC_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc, 25, 1, __Value) +#define SET_TX_DESC_AMSDU_PAD_EN_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc, 27, 1, __Value) +#define SET_TX_DESC_NO_ACM_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc, 29, 1, __Value) +#define SET_TX_DESC_GF_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc, 30, 1, __Value) + +/* Dword 1 */ +#define SET_TX_DESC_MACID_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 7, __Value) +#define SET_TX_DESC_QUEUE_SEL_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 8, 5, __Value) +#define SET_TX_DESC_RDG_NAV_EXT_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 13, 1, __Value) +#define SET_TX_DESC_LSIG_TXOP_EN_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 14, 1, __Value) +#define SET_TX_DESC_PIFS_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 15, 1, __Value) +#define SET_TX_DESC_RATE_ID_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 16, 5, __Value) +#define SET_TX_DESC_EN_DESC_ID_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 21, 1, __Value) +#define SET_TX_DESC_SEC_TYPE_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 22, 2, __Value) +#define SET_TX_DESC_PKT_OFFSET_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 24, 5, __Value) +#define SET_TX_DESC_MORE_DATA_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 29, 1, __Value) + +/* Dword 2 remove P_AID, G_ID field*/ +#define SET_TX_DESC_CCA_RTS_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 10, 2, __Value) +#define SET_TX_DESC_AGG_ENABLE_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 12, 1, __Value) +#define SET_TX_DESC_RDG_ENABLE_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 13, 1, __Value) +#define SET_TX_DESC_NULL0_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 14, 1, __Value) +#define SET_TX_DESC_NULL1_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 15, 1, __Value) +#define SET_TX_DESC_BK_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 16, 1, __Value) +#define SET_TX_DESC_MORE_FRAG_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 17, 1, __Value) +#define SET_TX_DESC_RAW_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 18, 1, __Value) +#define SET_TX_DESC_CCX_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 19, 1, __Value) +#define SET_TX_DESC_AMPDU_DENSITY_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 20, 3, __Value) +#define SET_TX_DESC_BT_INT_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 23, 1, __Value) +#define SET_TX_DESC_FTM_EN_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 30, 1, __Value) + +/* Dword 3 */ +#define SET_TX_DESC_NAV_USE_HDR_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 5, 1, __Value) +#define SET_TX_DESC_HWSEQ_SEL_8710B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 6, 2, __Value) +#define SET_TX_DESC_USE_RATE_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 8, 1, __Value) +#define SET_TX_DESC_DISABLE_RTS_FB_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 9, 1, __Value) +#define SET_TX_DESC_DISABLE_FB_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 10, 1, __Value) +#define SET_TX_DESC_CTS2SELF_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 11, 1, __Value) +#define SET_TX_DESC_RTS_ENABLE_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 12, 1, __Value) +#define SET_TX_DESC_HW_RTS_ENABLE_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 13, 1, __Value) +#define SET_TX_DESC_PORT_ID_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 14, 2, __Value) +#define SET_TX_DESC_USE_MAX_LEN_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 16, 1, __Value) +#define SET_TX_DESC_MAX_AGG_NUM_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 17, 5, __Value) +#define SET_TX_DESC_AMPDU_MAX_TIME_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 24, 8, __Value) + +/* Dword 4 */ +#define SET_TX_DESC_TX_RATE_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 0, 7, __Value) +#define SET_TX_DESC_TX_TRY_RATE_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 7, 1, __Value) +#define SET_TX_DESC_DATA_RATE_FB_LIMIT_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 8, 5, __Value) +#define SET_TX_DESC_RTS_RATE_FB_LIMIT_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 13, 4, __Value) +#define SET_TX_DESC_RETRY_LIMIT_ENABLE_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 17, 1, __Value) +#define SET_TX_DESC_DATA_RETRY_LIMIT_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 18, 6, __Value) +#define SET_TX_DESC_RTS_RATE_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 24, 5, __Value) +#define SET_TX_DESC_PCTS_EN_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 29, 1, __Value) +#define SET_TX_DESC_PCTS_MASK_IDX_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+16, 30, 2, __Value) + +/* Dword 5 */ +#define SET_TX_DESC_DATA_SC_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 0, 4, __Value) +#define SET_TX_DESC_DATA_SHORT_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 4, 1, __Value) +#define SET_TX_DESC_DATA_BW_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 5, 2, __Value) +#define SET_TX_DESC_DATA_STBC_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 8, 2, __Value) +#define SET_TX_DESC_RTS_STBC_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 10, 2, __Value) +#define SET_TX_DESC_RTS_SHORT_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 12, 1, __Value) +#define SET_TX_DESC_RTS_SC_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 13, 4, __Value) +#define SET_TX_DESC_PATH_A_EN_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 24, 1, __Value) +#define SET_TX_DESC_TXPWR_OF_SET_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+20, 28, 3, __Value) + +/* Dword 6 */ +#define SET_TX_DESC_SW_DEFINE_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 0, 12, __Value) +#define SET_TX_DESC_MBSSID_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 12, 4, __Value) +#define SET_TX_DESC_RF_SEL_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 16, 3, __Value) + +/* Dword 7 */ +#ifdef CONFIG_PCI_HCI +#define SET_TX_DESC_TX_BUFFER_SIZE_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) +#endif + +#ifdef CONFIG_USB_HCI +#define SET_TX_DESC_TX_DESC_CHECKSUM_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) +#endif + +#ifdef CONFIG_SDIO_HCI +#define SET_TX_DESC_TX_TIMESTAMP_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 6, 18, __Value) +#endif + +#define SET_TX_DESC_USB_TXAGG_NUM_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 24, 8, __Value) + +/* Dword 8 */ +#define SET_TX_DESC_RTS_RC_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 0, 6, __Value) +#define SET_TX_DESC_BAR_RC_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 6, 2, __Value) +#define SET_TX_DESC_DATA_RC_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 8, 6, __Value) +#define SET_TX_DESC_HWSEQ_EN_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 15, 1, __Value) +#define SET_TX_DESC_NEXTHEADPAGE_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 16, 8, __Value) +#define SET_TX_DESC_TAILPAGE_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 24, 8, __Value) + +/* Dword 9 */ +#define SET_TX_DESC_PADDING_LEN_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 0, 11, __Value) +#define SET_TX_DESC_SEQ_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 12, 12, __Value) +#define SET_TX_DESC_FINAL_DATA_RATE_8710B(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+36, 24, 8, __Value) + + +#define SET_EARLYMODE_PKTNUM_8710B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 0, 4, __Value) +#define SET_EARLYMODE_LEN0_8710B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 4, 15, __Value) +#define SET_EARLYMODE_LEN1_1_8710B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr, 19, 13, __Value) +#define SET_EARLYMODE_LEN1_2_8710B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 0, 2, __Value) +#define SET_EARLYMODE_LEN2_8710B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 2, 15, __Value) +#define SET_EARLYMODE_LEN3_8710B(__pAddr, __Value) SET_BITS_TO_LE_4BYTE(__pAddr+4, 17, 15, __Value) + + +/*-----------------------------------------------------------------*/ +/* RTL8710B TX BUFFER DESC */ +/*-----------------------------------------------------------------*/ +#ifdef CONFIG_64BIT_DMA + #define SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*16), 0, 16, __Valeu) + #define SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*16), 31, 1, __Valeu) + #define SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*16)+4, 0, 32, __Valeu) + #define SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+((__Offset)*16)+8, 0, 32, __Valeu) +#else + #define SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*8), 0, 16, __Valeu) + #define SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*8), 31, 1, __Valeu) + #define SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc+(__Offset*8)+4, 0, 32, __Valeu) + #define SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, __Offset, __Valeu) /* 64 BIT mode only */ +#endif +/* ********************************************************* */ + +/* 64 bits -- 32 bits */ +/* ======= ======= */ +/* Dword 0 0 */ +#define SET_TX_BUFF_DESC_LEN_0_8710B(__pTxDesc, __Valeu) SET_BITS_TO_LE_4BYTE(__pTxDesc, 0, 14, __Valeu) +#define SET_TX_BUFF_DESC_PSB_8710B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 16, 15, __Value) +#define SET_TX_BUFF_DESC_OWN_8710B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc, 31, 1, __Value) + +/* Dword 1 1 */ +#define SET_TX_BUFF_DESC_ADDR_LOW_0_8710B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+4, 0, 32, __Value) +#define GET_TX_BUFF_DESC_ADDR_LOW_0_8710B(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+4, 0, 32) +/* Dword 2 NA */ +#define SET_TX_BUFF_DESC_ADDR_HIGH_0_8710B(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, 0, __Value) +#ifdef CONFIG_64BIT_DMA + #define GET_TX_BUFF_DESC_ADDR_HIGH_0_8710B(__pTxDesc) LE_BITS_TO_4BYTE(__pTxDesc+8, 0, 32) +#else + #define GET_TX_BUFF_DESC_ADDR_HIGH_0_8710B(__pTxDesc) 0 +#endif +/* Dword 3 NA */ +/* RESERVED 0 */ +/* Dword 4 2 */ +#define SET_TX_BUFF_DESC_LEN_1_8710B(__pTxDesc, __Value) SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, 1, __Value) +#define SET_TX_BUFF_DESC_AMSDU_1_8710B(__pTxDesc, __Value) SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, 1, __Value) +/* Dword 5 3 */ +#define SET_TX_BUFF_DESC_ADDR_LOW_1_8710B(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, 1, __Value) +/* Dword 6 NA */ +#define SET_TX_BUFF_DESC_ADDR_HIGH_1_8710B(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, 1, __Value) +/* Dword 7 NA */ +/*RESERVED 0 */ +/* Dword 8 4 */ +#define SET_TX_BUFF_DESC_LEN_2_8710B(__pTxDesc, __Value) SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, 2, __Value) +#define SET_TX_BUFF_DESC_AMSDU_2_8710B(__pTxDesc, __Value) SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, 2, __Value) +/* Dword 9 5 */ +#define SET_TX_BUFF_DESC_ADDR_LOW_2_8710B(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, 2, __Value) +/* Dword 10 NA */ +#define SET_TX_BUFF_DESC_ADDR_HIGH_2_8710B(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, 2, __Value) +/* Dword 11 NA */ +/*RESERVED 0 */ +/* Dword 12 6 */ +#define SET_TX_BUFF_DESC_LEN_3_8710B(__pTxDesc, __Value) SET_TXBUFFER_DESC_LEN_WITH_OFFSET(__pTxDesc, 3, __Value) +#define SET_TX_BUFF_DESC_AMSDU_3_8710B(__pTxDesc, __Value) SET_TXBUFFER_DESC_AMSDU_WITH_OFFSET(__pTxDesc, 3, __Value) +/* Dword 13 7 */ +#define SET_TX_BUFF_DESC_ADDR_LOW_3_8710B(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_LOW_WITH_OFFSET(__pTxDesc, 3, __Value) +/* Dword 14 NA */ +#define SET_TX_BUFF_DESC_ADDR_HIGH_3_8710B(__pTxDesc, __Value) SET_TXBUFFER_DESC_ADD_HIGT_WITH_OFFSET(__pTxDesc, 3, __Value) +/* Dword 15 NA */ +/*RESERVED 0 */ + + +#endif +/* ----------------------------------------------------------- + * + * Rate + * + * ----------------------------------------------------------- + * CCK Rates, TxHT = 0 */ +#define DESC8710B_RATE1M 0x00 +#define DESC8710B_RATE2M 0x01 +#define DESC8710B_RATE5_5M 0x02 +#define DESC8710B_RATE11M 0x03 + +/* OFDM Rates, TxHT = 0 */ +#define DESC8710B_RATE6M 0x04 +#define DESC8710B_RATE9M 0x05 +#define DESC8710B_RATE12M 0x06 +#define DESC8710B_RATE18M 0x07 +#define DESC8710B_RATE24M 0x08 +#define DESC8710B_RATE36M 0x09 +#define DESC8710B_RATE48M 0x0a +#define DESC8710B_RATE54M 0x0b + +/* MCS Rates, TxHT = 1 */ +#define DESC8710B_RATEMCS0 0x0c +#define DESC8710B_RATEMCS1 0x0d +#define DESC8710B_RATEMCS2 0x0e +#define DESC8710B_RATEMCS3 0x0f +#define DESC8710B_RATEMCS4 0x10 +#define DESC8710B_RATEMCS5 0x11 +#define DESC8710B_RATEMCS6 0x12 +#define DESC8710B_RATEMCS7 0x13 +#define DESC8710B_RATEMCS8 0x14 +#define DESC8710B_RATEMCS9 0x15 +#define DESC8710B_RATEMCS10 0x16 +#define DESC8710B_RATEMCS11 0x17 +#define DESC8710B_RATEMCS12 0x18 +#define DESC8710B_RATEMCS13 0x19 +#define DESC8710B_RATEMCS14 0x1a +#define DESC8710B_RATEMCS15 0x1b +#define DESC8710B_RATEVHTSS1MCS0 0x2c +#define DESC8710B_RATEVHTSS1MCS1 0x2d +#define DESC8710B_RATEVHTSS1MCS2 0x2e +#define DESC8710B_RATEVHTSS1MCS3 0x2f +#define DESC8710B_RATEVHTSS1MCS4 0x30 +#define DESC8710B_RATEVHTSS1MCS5 0x31 +#define DESC8710B_RATEVHTSS1MCS6 0x32 +#define DESC8710B_RATEVHTSS1MCS7 0x33 +#define DESC8710B_RATEVHTSS1MCS8 0x34 +#define DESC8710B_RATEVHTSS1MCS9 0x35 +#define DESC8710B_RATEVHTSS2MCS0 0x36 +#define DESC8710B_RATEVHTSS2MCS1 0x37 +#define DESC8710B_RATEVHTSS2MCS2 0x38 +#define DESC8710B_RATEVHTSS2MCS3 0x39 +#define DESC8710B_RATEVHTSS2MCS4 0x3a +#define DESC8710B_RATEVHTSS2MCS5 0x3b +#define DESC8710B_RATEVHTSS2MCS6 0x3c +#define DESC8710B_RATEVHTSS2MCS7 0x3d +#define DESC8710B_RATEVHTSS2MCS8 0x3e +#define DESC8710B_RATEVHTSS2MCS9 0x3f + + +#define RX_HAL_IS_CCK_RATE_8710B(pDesc)\ + (GET_RX_STATUS_DESC_RX_RATE_8710B(pDesc) == DESC8710B_RATE1M || \ + GET_RX_STATUS_DESC_RX_RATE_8710B(pDesc) == DESC8710B_RATE2M || \ + GET_RX_STATUS_DESC_RX_RATE_8710B(pDesc) == DESC8710B_RATE5_5M || \ + GET_RX_STATUS_DESC_RX_RATE_8710B(pDesc) == DESC8710B_RATE11M) + +#ifdef CONFIG_TRX_BD_ARCH + struct tx_desc; +#endif + +void rtl8710b_cal_txdesc_chksum(struct tx_desc *ptxdesc); +void rtl8710b_update_txdesc(struct xmit_frame *pxmitframe, u8 *pmem); +void rtl8710b_fill_txdesc_sectype(struct pkt_attrib *pattrib, struct tx_desc *ptxdesc); +void rtl8710b_fill_txdesc_vcs(PADAPTER padapter, struct pkt_attrib *pattrib, struct tx_desc *ptxdesc); +void rtl8710b_fill_txdesc_phy(PADAPTER padapter, struct pkt_attrib *pattrib, struct tx_desc *ptxdesc); +void rtl8710b_fill_fake_txdesc(PADAPTER padapter, u8 *pDesc, u32 BufferLen, u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame); + +#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 rtl8710bs_init_xmit_priv(PADAPTER padapter); + void rtl8710bs_free_xmit_priv(PADAPTER padapter); + s32 rtl8710bs_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); + s32 rtl8710bs_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); + s32 rtl8710bs_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); + s32 rtl8710bs_xmit_buf_handler(PADAPTER padapter); + thread_return rtl8710bs_xmit_thread(thread_context context); + #define hal_xmit_handler rtl8710bs_xmit_buf_handler +#endif + +#ifdef CONFIG_USB_HCI + s32 rtl8710bu_xmit_buf_handler(PADAPTER padapter); + #define hal_xmit_handler rtl8710bu_xmit_buf_handler + s32 rtl8710bu_init_xmit_priv(PADAPTER padapter); + void rtl8710bu_free_xmit_priv(PADAPTER padapter); + s32 rtl8710bu_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); + s32 rtl8710bu_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); + s32 rtl8710bu_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); + void rtl8710bu_xmit_tasklet(void *priv); + s32 rtl8710bu_xmitframe_complete(_adapter *padapter, struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitbuf); + void _dbg_dump_tx_info(_adapter *padapter, int frame_tag, struct tx_desc *ptxdesc); +#endif + +#ifdef CONFIG_PCI_HCI + s32 rtl8710be_init_xmit_priv(PADAPTER padapter); + void rtl8710be_free_xmit_priv(PADAPTER padapter); + struct xmit_buf *rtl8710be_dequeue_xmitbuf(struct rtw_tx_ring *ring); + void rtl8710be_xmitframe_resume(_adapter *padapter); + s32 rtl8710be_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); + s32 rtl8710be_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); + s32 rtl8710be_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); + void rtl8710be_xmit_tasklet(void *priv); +#endif + +u8 BWMapping_8710B(PADAPTER Adapter, struct pkt_attrib *pattrib); +u8 SCMapping_8710B(PADAPTER Adapter, struct pkt_attrib *pattrib); + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723b_cmd.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723b_cmd.h index 1000d204793d..758e5124ab0d 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723b_cmd.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723b_cmd.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -118,7 +114,6 @@ enum h2c_cmd_8723B { #define SET_8723B_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) #define SET_8723B_H2CCMD_PWRMODE_PARM_BCN_EARLY_C2H_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 2, 1, __Value) #define SET_8723B_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -#define SET_8723B_H2CCMD_PWRMODE_PARM_BYTE5(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) #define GET_8723B_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) @@ -164,7 +159,7 @@ enum h2c_cmd_8723B { #define SET_8723B_H2CCMD_BT_MPOPER_PARAM3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) /* _BT_FW_PATCH_0x6A */ -#define SET_8723B_H2CCMD_BT_FW_PATCH_SIZE(__pH2CCmd, __Value) SET_BITS_TO_LE_2BYTE((pu1Byte)(__pH2CCmd), 0, 16, __Value) +#define SET_8723B_H2CCMD_BT_FW_PATCH_SIZE(__pH2CCmd, __Value) SET_BITS_TO_LE_2BYTE((u8 *)(__pH2CCmd), 0, 16, __Value) #define SET_8723B_H2CCMD_BT_FW_PATCH_ADDR0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) #define SET_8723B_H2CCMD_BT_FW_PATCH_ADDR1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) #define SET_8723B_H2CCMD_BT_FW_PATCH_ADDR2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) @@ -182,11 +177,9 @@ enum h2c_cmd_8723B { /* host message to firmware cmd */ void rtl8723b_set_FwPwrMode_cmd(PADAPTER padapter, u8 Mode); void rtl8723b_set_FwJoinBssRpt_cmd(PADAPTER padapter, u8 mstatus); -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, u8 ignore_bw); 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 +189,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 +201,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/rtl8188eu/include/rtl8723b_dm.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723b_dm.h index a3bb7df89c09..0a18c1654b42 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723b_dm.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723b_dm.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +36,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/rtl8188eu/include/rtl8723b_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723b_hal.h index b7c8bc5e679f..658db3129375 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723b_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723b_hal.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -111,23 +107,17 @@ typedef struct _RT_8723B_FIRMWARE_HDR { /* Note: We will divide number of page equally for each queue other than public queue! */ /* For General Reserved Page Number(Beacon Queue is reserved page) - * Beacon:2, PS-Poll:1, Null Data:1,Qos Null Data:1,BT Qos Null Data:1 */ -#define BCNQ_PAGE_NUM_8723B 0x08 -#ifdef CONFIG_CONCURRENT_MODE - #define BCNQ1_PAGE_NUM_8723B 0x08 /* 0x04 */ -#else - #define BCNQ1_PAGE_NUM_8723B 0x00 -#endif + * Beacon:MAX_BEACON_LEN/PAGE_SIZE_TX_8723B + * PS-Poll:1, Null Data:1,Qos Null Data:1,BT Qos Null Data:1,CTS-2-SELF,LTE QoS Null*/ +#define BCNQ_PAGE_NUM_8723B (MAX_BEACON_LEN / PAGE_SIZE_TX_8723B + 6) /*0x08*/ -#ifdef CONFIG_PNO_SUPPORT - #undef BCNQ1_PAGE_NUM_8723B - #define BCNQ1_PAGE_NUM_8723B 0x00 /* 0x04 */ -#endif /* For WoWLan , more reserved page - * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, AOAC rpt: 1,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 0x08 + #define WOWLAN_PAGE_NUM_8723B 0x0b #else #define WOWLAN_PAGE_NUM_8723B 0x00 #endif @@ -141,7 +131,7 @@ typedef struct _RT_8723B_FIRMWARE_HDR { #define AP_WOWLAN_PAGE_NUM_8723B 0x02 #endif -#define TX_TOTAL_PAGE_NUMBER_8723B (0xFF - BCNQ_PAGE_NUM_8723B - BCNQ1_PAGE_NUM_8723B - WOWLAN_PAGE_NUM_8723B) +#define TX_TOTAL_PAGE_NUMBER_8723B (0xFF - BCNQ_PAGE_NUM_8723B - WOWLAN_PAGE_NUM_8723B) #define TX_PAGE_BOUNDARY_8723B (TX_TOTAL_PAGE_NUMBER_8723B + 1) #define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8723B TX_TOTAL_PAGE_NUMBER_8723B @@ -152,11 +142,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" @@ -225,13 +217,13 @@ void Hal_EfuseParseCustomerID_8723B(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoL void Hal_EfuseParseAntennaDiversity_8723B(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); void Hal_EfuseParseXtal_8723B(PADAPTER pAdapter, u8 *hwinfo, u8 AutoLoadFail); void Hal_EfuseParseThermalMeter_8723B(PADAPTER padapter, u8 *hwinfo, u8 AutoLoadFail); -VOID Hal_EfuseParsePackageType_8723B(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -VOID Hal_EfuseParseVoltage_8723B(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -VOID Hal_EfuseParseBoardType_8723B(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); +void Hal_EfuseParsePackageType_8723B(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); +void Hal_EfuseParseVoltage_8723B(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); +void Hal_EfuseParseBoardType_8723B(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); 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); @@ -259,7 +251,7 @@ void rtl8723b_stop_thread(_adapter *padapter); void HalSetOutPutGPIO(PADAPTER padapter, u8 index, u8 OutPutValue); #endif #ifdef CONFIG_MP_INCLUDED -int FirmwareDownloadBT(IN PADAPTER Adapter, PRT_MP_FIRMWARE pFirmware); +int FirmwareDownloadBT(PADAPTER Adapter, PRT_MP_FIRMWARE pFirmware); #endif void CCX_FwC2HTxRpt_8723b(PADAPTER padapter, u8 *pdata, u8 len); @@ -272,12 +264,12 @@ u8 HwRateToMRate8723B(u8 rate); #ifdef CONFIG_PCI_HCI BOOLEAN InterruptRecognized8723BE(PADAPTER Adapter); - VOID UpdateInterruptMask8723BE(PADAPTER Adapter, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); + void UpdateInterruptMask8723BE(PADAPTER Adapter, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); #endif #ifdef CONFIG_GPIO_API int rtl8723b_GpioFuncCheck(PADAPTER adapter, u8 gpio_num); -VOID rtl8723b_GpioMultiFuncReset(PADAPTER adapter, u8 gpio_num); +void rtl8723b_GpioMultiFuncReset(PADAPTER adapter, u8 gpio_num); #endif #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723b_led.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723b_led.h index 0a7b2c9ea188..1261c5e9a4d3 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723b_led.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723b_led.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +20,7 @@ #include #include - +#ifdef CONFIG_RTW_SW_LED /* ******************************************************************************** * Interface to manipulate LED objects. * ******************************************************************************** */ @@ -46,3 +42,4 @@ #endif #endif +#endif/*CONFIG_RTW_SW_LED*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723b_recv.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723b_recv.h index fd9faef9d6b5..e1fb2897a972 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723b_recv.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723b_recv.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -27,22 +23,18 @@ #if defined(CONFIG_USB_HCI) #ifndef MAX_RECVBUF_SZ - #ifdef PLATFORM_OS_CE - #define MAX_RECVBUF_SZ (8192+1024) /* 8K+1k */ - #else - #ifndef CONFIG_MINIMAL_MEMORY_USAGE - /* #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 (8192+1024) */ /* 8K+1k */ + #ifndef CONFIG_MINIMAL_MEMORY_USAGE + /* #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 (4000) /* about 4K */ + #define MAX_RECVBUF_SZ (15360) /* 15k < 16k */ #endif + /* #define MAX_RECVBUF_SZ (8192+1024) */ /* 8K+1k */ + #else + #define MAX_RECVBUF_SZ (4000) /* about 4K */ #endif #endif /* !MAX_RECVBUF_SZ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723b_rf.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723b_rf.h index bf56dde01684..d76486b7ca27 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723b_rf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723b_rf.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,20 +12,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 __RTL8723B_RF_H__ #define __RTL8723B_RF_H__ -int PHY_RF6052_Config8723B(IN PADAPTER Adapter); +int PHY_RF6052_Config8723B(PADAPTER Adapter); -VOID +void PHY_RF6052SetBandwidth8723B( - IN PADAPTER Adapter, - IN CHANNEL_WIDTH Bandwidth); + PADAPTER Adapter, + enum channel_width Bandwidth); #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723b_spec.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723b_spec.h index f8e8a651737c..d8643cc4afdc 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723b_spec.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723b_spec.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723b_sreset.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723b_sreset.h index 8067359da761..5bae23bc608c 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723b_sreset.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723b_sreset.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/rtl8723b_xmit.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723b_xmit.h index 7cc33e179162..cc838526b8e4 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723b_xmit.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723b_xmit.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -189,13 +185,14 @@ #define SET_TX_DESC_ANTSEL_D_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 25, 3, __Value) /* Dword 7 */ - #if (DEV_BUS_TYPE == RT_PCI_INTERFACE) + #ifdef CONFIG_PCI_HCI #define SET_TX_DESC_TX_BUFFER_SIZE_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) - #else + #endif + #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_USB_HCI) #define SET_TX_DESC_TX_DESC_CHECKSUM_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) #endif #define SET_TX_DESC_USB_TXAGG_NUM_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 24, 8, __Value) - #if (DEV_BUS_TYPE == RT_SDIO_INTERFACE) + #ifdef CONFIG_SDIO_HCI #define SET_TX_DESC_SDIO_TXSEQ_8723B(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 16, 8, __Value) #endif @@ -293,6 +290,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/rtl8188eu/include/rtl8723d_cmd.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723d_cmd.h index e00b7ed956dd..d1e1a714113f 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723d_cmd.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723d_cmd.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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,26 +94,14 @@ 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) #define GET_8723D_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) @@ -163,7 +147,7 @@ enum h2c_cmd_8723D { #define SET_8723D_H2CCMD_BT_MPOPER_PARAM3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) /* _BT_FW_PATCH_0x6A */ -#define SET_8723D_H2CCMD_BT_FW_PATCH_SIZE(__pH2CCmd, __Value) SET_BITS_TO_LE_2BYTE((pu1Byte)(__pH2CCmd), 0, 16, __Value) +#define SET_8723D_H2CCMD_BT_FW_PATCH_SIZE(__pH2CCmd, __Value) SET_BITS_TO_LE_2BYTE((u8 *)(__pH2CCmd), 0, 16, __Value) #define SET_8723D_H2CCMD_BT_FW_PATCH_ADDR0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) #define SET_8723D_H2CCMD_BT_FW_PATCH_ADDR1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) #define SET_8723D_H2CCMD_BT_FW_PATCH_ADDR2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 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, u8 ignore_bw); -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 cmd_param); - -#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/rtl8188eu/include/rtl8723d_dm.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723d_dm.h index bae086d0f010..f0d3a2e7de9f 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723d_dm.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723d_dm.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +36,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/rtl8188eu/include/rtl8723d_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723d_hal.h index 494dad3ea355..7400c2f39047 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723d_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723d_hal.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -116,23 +112,17 @@ typedef struct _RT_8723D_FIRMWARE_HDR { /* Note: We will divide number of page equally for each queue other than public queue! */ /* For General Reserved Page Number(Beacon Queue is reserved page) - * Beacon:2, PS-Poll:1, Null Data:1,Qos Null Data:1,BT Qos Null Data:1 */ -#define BCNQ_PAGE_NUM_8723D 0x08 -#ifdef CONFIG_CONCURRENT_MODE - #define BCNQ1_PAGE_NUM_8723D 0x08 /* 0x04 */ -#else - #define BCNQ1_PAGE_NUM_8723D 0x00 -#endif + * Beacon:MAX_BEACON_LEN/PAGE_SIZE_TX_8723D + * PS-Poll:1, Null Data:1,Qos Null Data:1,BT Qos Null Data:1,CTS-2-SELF,LTE QoS Null*/ -#ifdef CONFIG_PNO_SUPPORT - #undef BCNQ1_PAGE_NUM_8723D - #define BCNQ1_PAGE_NUM_8723D 0x00 /* 0x04 */ -#endif +#define BCNQ_PAGE_NUM_8723D (MAX_BEACON_LEN/PAGE_SIZE_TX_8723D + 6) /*0x08*/ /* For WoWLan , more reserved page - * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, AOAC rpt 1, 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 0x08 + #define WOWLAN_PAGE_NUM_8723D 0x0b #else #define WOWLAN_PAGE_NUM_8723D 0x00 #endif @@ -147,7 +137,7 @@ typedef struct _RT_8723D_FIRMWARE_HDR { #endif #define TX_TOTAL_PAGE_NUMBER_8723D\ - (0xFF - BCNQ_PAGE_NUM_8723D - BCNQ1_PAGE_NUM_8723D - WOWLAN_PAGE_NUM_8723D) + (0xFF - BCNQ_PAGE_NUM_8723D - WOWLAN_PAGE_NUM_8723D) #define TX_PAGE_BOUNDARY_8723D (TX_TOTAL_PAGE_NUMBER_8723D + 1) #define WMM_NORMAL_TX_TOTAL_PAGE_NUMBER_8723D TX_TOTAL_PAGE_NUMBER_8723D @@ -159,11 +149,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" @@ -241,8 +233,6 @@ void Hal_EfuseParseBTCoexistInfo_8723D(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); void Hal_EfuseParseEEPROMVer_8723D(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -void Hal_EfuseParsePackageType_8723D(PADAPTER pAdapter, - u8 *hwinfo, BOOLEAN AutoLoadFail); void Hal_EfuseParseChnlPlan_8723D(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); void Hal_EfuseParseCustomerID_8723D(PADAPTER padapter, @@ -253,14 +243,14 @@ void Hal_EfuseParseXtal_8723D(PADAPTER pAdapter, u8 *hwinfo, u8 AutoLoadFail); void Hal_EfuseParseThermalMeter_8723D(PADAPTER padapter, u8 *hwinfo, u8 AutoLoadFail); -VOID Hal_EfuseParseVoltage_8723D(PADAPTER pAdapter, +void Hal_EfuseParseVoltage_8723D(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); -VOID Hal_EfuseParseBoardType_8723D(PADAPTER Adapter, +void Hal_EfuseParseBoardType_8723D(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); 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); @@ -268,8 +258,6 @@ u8 GetHalDefVar8723D(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); /* register */ void rtl8723d_InitBeaconParameters(PADAPTER padapter); void rtl8723d_InitBeaconMaxError(PADAPTER padapter, u8 InfraMode); -void _InitBurstPktLen_8723DS(PADAPTER Adapter); -void _InitLTECoex_8723DS(PADAPTER Adapter); void _InitMacAPLLSetting_8723D(PADAPTER Adapter); void _8051Reset8723(PADAPTER padapter); #ifdef CONFIG_WOWLAN @@ -290,7 +278,7 @@ void rtl8723d_stop_thread(_adapter *padapter); void HalSetOutPutGPIO(PADAPTER padapter, u8 index, u8 OutPutValue); #endif #ifdef CONFIG_MP_INCLUDED -int FirmwareDownloadBT(IN PADAPTER Adapter, PRT_MP_FIRMWARE pFirmware); +int FirmwareDownloadBT(PADAPTER Adapter, PRT_MP_FIRMWARE pFirmware); #endif void CCX_FwC2HTxRpt_8723d(PADAPTER padapter, u8 *pdata, u8 len); @@ -309,8 +297,8 @@ 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); + void UpdateInterruptMask8723DE(PADAPTER Adapter, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); + u16 get_txbd_rw_reg(u16 ff_hwaddr); #endif #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723d_led.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723d_led.h index 439ee82d7a94..80d5001b88d5 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723d_led.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723d_led.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +20,7 @@ #include #include - +#ifdef CONFIG_RTW_SW_LED /* ******************************************************************************** * Interface to manipulate LED objects. * ******************************************************************************** */ @@ -45,4 +41,5 @@ void rtl8723de_DeInitSwLeds(PADAPTER padapter); #endif +#endif /*#ifdef CONFIG_RTW_SW_LED*/ #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723d_lps_poff.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723d_lps_poff.h index c466d40f8771..0193d46fc4d7 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723d_lps_poff.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723d_lps_poff.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/rtl8723d_recv.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723d_recv.h index 6343ec8d5a05..d3f9adfa9915 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723d_recv.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723d_recv.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -27,22 +23,18 @@ #if defined(CONFIG_USB_HCI) #ifndef MAX_RECVBUF_SZ - #ifdef PLATFORM_OS_CE - #define MAX_RECVBUF_SZ (8192+1024) /* 8K+1k */ - #else - #ifndef CONFIG_MINIMAL_MEMORY_USAGE - /* #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 (8192+1024) */ /* 8K+1k */ + #ifndef CONFIG_MINIMAL_MEMORY_USAGE + /* #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 (4000) /* about 4K */ + #define MAX_RECVBUF_SZ (15360) /* 15k < 16k */ #endif + /* #define MAX_RECVBUF_SZ (8192+1024) */ /* 8K+1k */ + #else + #define MAX_RECVBUF_SZ (4000) /* about 4K */ #endif #endif /* !MAX_RECVBUF_SZ */ @@ -102,6 +94,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/rtl8188eu/include/rtl8723d_rf.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723d_rf.h index 0aa5813a6451..e4625b5bb6a6 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723d_rf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723d_rf.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,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); +int PHY_RF6052_Config8723D(PADAPTER pdapter); -void PHY_RF6052SetBandwidth8723D(IN PADAPTER Adapter, IN CHANNEL_WIDTH Bandwidth); +void PHY_RF6052SetBandwidth8723D(PADAPTER Adapter, enum channel_width Bandwidth); #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723d_spec.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723d_spec.h index 21653f2fb1e9..72f0b8ca0845 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723d_spec.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723d_spec.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +80,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 +378,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 diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723d_sreset.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723d_sreset.h index aafe7c86aede..6310e8208e77 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723d_sreset.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723d_sreset.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/rtl8723d_xmit.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723d_xmit.h index 20f98b0c7c8c..6b078141bf4b 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723d_xmit.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8723d_xmit.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -217,9 +213,8 @@ SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 30, 1, __Value) /* Dword 3 */ -#define SET_TX_DESC_NAV_USE_HDR_8723D(__pTxDesc, __Value) \ - SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 5, 1, __Value) -#define SET_TX_DESC_HWSEQ_SEL_8723D(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 6, 2, __Value) +#define SET_TX_DESC_HWSEQ_SEL_8723D(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 6, 2, __Value) #define SET_TX_DESC_USE_RATE_8723D(__pTxDesc, __Value) \ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 8, 1, __Value) #define SET_TX_DESC_DISABLE_RTS_FB_8723D(__pTxDesc, __Value) \ @@ -234,6 +229,8 @@ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 13, 1, __Value) #define SET_TX_DESC_PORT_ID_8723D(__pTxDesc, __Value) \ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 14, 2, __Value) +#define SET_TX_DESC_NAV_USE_HDR_8723D(__pTxDesc, __Value) \ + SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 15, 1, __Value) #define SET_TX_DESC_USE_MAX_LEN_8723D(__pTxDesc, __Value) \ SET_BITS_TO_LE_4BYTE(__pTxDesc+12, 16, 1, __Value) #define SET_TX_DESC_MAX_AGG_NUM_8723D(__pTxDesc, __Value) \ @@ -290,13 +287,17 @@ SET_BITS_TO_LE_4BYTE(__pTxDesc+24, 16, 3, __Value) /* Dword 7 */ -#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) +#ifdef CONFIG_PCI_HCI #define SET_TX_DESC_TX_BUFFER_SIZE_8723D(__pTxDesc, __Value) \ SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -#elif(DEV_BUS_TYPE == RT_USB_INTERFACE) +#endif + +#ifdef CONFIG_USB_HCI #define SET_TX_DESC_TX_DESC_CHECKSUM_8723D(__pTxDesc, __Value) \ SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -#else +#endif + +#ifdef CONFIG_SDIO_HCI #define SET_TX_DESC_TX_TIMESTAMP_8723D(__pTxDesc, __Value) \ SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 6, 18, __Value) #endif @@ -480,6 +481,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/rtl8188eu/include/rtl8812a_cmd.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8812a_cmd.h index 3891bd0189b0..6c540a613a0e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8812a_cmd.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8812a_cmd.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -89,7 +85,6 @@ struct H2C_SS_RFOFF_PARAM { #define SET_8812_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) #define SET_8812_H2CCMD_PWRMODE_PARM_BCN_EARLY_C2H_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 2, 1, __Value) #define SET_8812_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -#define SET_8812_H2CCMD_PWRMODE_PARM_BYTE5(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) #define GET_8812_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) @@ -103,14 +98,13 @@ 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 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); u8 GetTxBufferRsvdPageNum8812(_adapter *padapter, bool wowlan); @@ -125,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 * ------------------------------------ */ @@ -160,11 +148,11 @@ int reset_tsf(PADAPTER Adapter, u8 reset_port); #define GET_8812_C2H_TX_RPT_FINAL_DATA_RATE(_Header) LE_BITS_TO_1BYTE((_Header + 5), 0, 8) /* BT_FW_PATCH */ -#define SET_8812_H2CCMD_BT_FW_PATCH_SIZE(__pH2CCmd, __Value) SET_BITS_TO_LE_2BYTE((pu1Byte)(__pH2CCmd), 0, 16, __Value) -#define SET_8812_H2CCMD_BT_FW_PATCH_ADDR0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((pu1Byte)(__pH2CCmd)+2, 0, 8, __Value) -#define SET_8812_H2CCMD_BT_FW_PATCH_ADDR1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((pu1Byte)(__pH2CCmd)+3, 0, 8, __Value) -#define SET_8812_H2CCMD_BT_FW_PATCH_ADDR2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((pu1Byte)(__pH2CCmd)+4, 0, 8, __Value) -#define SET_8812_H2CCMD_BT_FW_PATCH_ADDR3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((pu1Byte)(__pH2CCmd)+5, 0, 8, __Value) +#define SET_8812_H2CCMD_BT_FW_PATCH_SIZE(__pH2CCmd, __Value) SET_BITS_TO_LE_2BYTE((u8 *)(__pH2CCmd), 0, 16, __Value) +#define SET_8812_H2CCMD_BT_FW_PATCH_ADDR0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((u8 *)(__pH2CCmd)+2, 0, 8, __Value) +#define SET_8812_H2CCMD_BT_FW_PATCH_ADDR1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((u8 *)(__pH2CCmd)+3, 0, 8, __Value) +#define SET_8812_H2CCMD_BT_FW_PATCH_ADDR2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((u8 *)(__pH2CCmd)+4, 0, 8, __Value) +#define SET_8812_H2CCMD_BT_FW_PATCH_ADDR3(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((u8 *)(__pH2CCmd)+5, 0, 8, __Value) s32 c2h_handler_8812a(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8812a_dm.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8812a_dm.h index fef58248ef1e..a8a04afae271 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8812a_dm.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8812a_dm.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,22 +12,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 __RTL8812A_DM_H__ #define __RTL8812A_DM_H__ -void rtl8812_init_dm_priv(IN PADAPTER Adapter); -void rtl8812_deinit_dm_priv(IN PADAPTER Adapter); -void rtl8812_InitHalDm(IN PADAPTER Adapter); -void rtl8812_HalDmWatchDog(IN PADAPTER Adapter); +void rtl8812_init_dm_priv(PADAPTER Adapter); +void rtl8812_deinit_dm_priv(PADAPTER Adapter); +void rtl8812_InitHalDm(PADAPTER Adapter); +void rtl8812_HalDmWatchDog(PADAPTER Adapter); -/* VOID rtl8192c_dm_CheckTXPowerTracking(IN PADAPTER Adapter); */ +/* void rtl8192c_dm_CheckTXPowerTracking(PADAPTER Adapter); */ -/* void rtl8192c_dm_RF_Saving(IN PADAPTER pAdapter, IN u8 bForceInNormal); */ +/* void rtl8192c_dm_RF_Saving(PADAPTER pAdapter, u8 bForceInNormal); */ #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8812a_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8812a_hal.h index 2ea4c83d8bcf..9113bfff1743 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8812a_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8812a_hal.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -140,12 +136,18 @@ typedef struct _RT_FIRMWARE_8812 { #endif #define RX_DMA_BOUNDARY_8812 (MAX_RX_DMA_BUFFER_SIZE_8812 - RX_DMA_RESERVED_SIZE_8812 - 1) -#define BCNQ_PAGE_NUM_8812 0x07 +#define PAGE_SIZE_TX_8812A PAGE_SIZE_512 + +/* Beacon:MAX_BEACON_LEN/PAGE_SIZE_TX_8812A + * PS-Poll:1, Null Data:1,Qos Null Data:1,BT Qos Null Data:1,CTS-2-SELF,LTE QoS Null*/ +#define BCNQ_PAGE_NUM_8812 (MAX_BEACON_LEN / PAGE_SIZE_TX_8812A + 6) /*0x07*/ /* For WoWLan , more reserved page - * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:1,GTK EXT MEM:1, AOAC rpt: 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 0x06 + #define WOWLAN_PAGE_NUM_8812 0x08 #else #define WOWLAN_PAGE_NUM_8812 0x00 #endif @@ -157,7 +159,13 @@ typedef struct _RT_FIRMWARE_8812 { #define FW_NDPA_PAGE_NUM 0x00 #endif -#define TX_TOTAL_PAGE_NUMBER_8812 (0xFF - BCNQ_PAGE_NUM_8812 - WOWLAN_PAGE_NUM_8812-FW_NDPA_PAGE_NUM) +#ifdef DBG_FW_DEBUG_MSG_PKT + #define FW_DBG_MSG_PKT_PAGE_NUM_8812 0x01 +#else + #define FW_DBG_MSG_PKT_PAGE_NUM_8812 0x00 +#endif /*DBG_FW_DEBUG_MSG_PKT*/ + +#define TX_TOTAL_PAGE_NUMBER_8812 (0xFF - BCNQ_PAGE_NUM_8812 - WOWLAN_PAGE_NUM_8812 - FW_NDPA_PAGE_NUM - FW_DBG_MSG_PKT_PAGE_NUM_8812) #define TX_PAGE_BOUNDARY_8812 (TX_TOTAL_PAGE_NUMBER_8812 + 1) #define TX_PAGE_BOUNDARY_WOWLAN_8812 (0xFF - BCNQ_PAGE_NUM_8812 - WOWLAN_PAGE_NUM_8812 + 1) @@ -190,12 +198,11 @@ typedef struct _RT_FIRMWARE_8812 { #endif #define RX_DMA_BOUNDARY_8821 (MAX_RX_DMA_BUFFER_SIZE_8821 - RX_DMA_RESERVED_SIZE_8821 - 1) -#define BCNQ_PAGE_NUM_8821 0x08 -#ifdef CONFIG_CONCURRENT_MODE - #define BCNQ1_PAGE_NUM_8821 0x04 -#else - #define BCNQ1_PAGE_NUM_8821 0x00 -#endif +/* Beacon:MAX_BEACON_LEN/PAGE_SIZE_TX_8821A + * PS-Poll:1, Null Data:1,Qos Null Data:1,BT Qos Null Data:1,CTS-2-SELF,LTE QoS Null*/ + +#define BCNQ_PAGE_NUM_8821 (MAX_BEACON_LEN / PAGE_SIZE_TX_8821A + 6) /*0x08*/ + /* For WoWLan , more reserved page * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:1,GTK EXT MEM:1, PNO: 6 */ @@ -205,7 +212,7 @@ typedef struct _RT_FIRMWARE_8812 { #define WOWLAN_PAGE_NUM_8821 0x00 #endif -#define TX_TOTAL_PAGE_NUMBER_8821 (0xFF - BCNQ_PAGE_NUM_8821 - BCNQ1_PAGE_NUM_8821 - WOWLAN_PAGE_NUM_8821) +#define TX_TOTAL_PAGE_NUMBER_8821 (0xFF - BCNQ_PAGE_NUM_8821 - WOWLAN_PAGE_NUM_8821) #define TX_PAGE_BOUNDARY_8821 (TX_TOTAL_PAGE_NUMBER_8821 + 1) /* #define TX_PAGE_BOUNDARY_WOWLAN_8821 0xE0 */ @@ -217,10 +224,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 @@ -329,7 +338,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); @@ -337,25 +346,25 @@ void rtl8812_set_hal_ops(struct hal_ops *pHalFunc); void init_hal_spec_8812a(_adapter *adapter); void init_hal_spec_8821a(_adapter *adapter); -/* register */ -void SetBcnCtrlReg(PADAPTER padapter, u8 SetBits, u8 ClearBits); +u32 upload_txpktbuf_8812au(_adapter *adapter, u8 *buf, u32 buflen); void rtl8812_start_thread(PADAPTER padapter); 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 UpdateInterruptMask8812AE(PADAPTER Adapter, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); +void InitTRXDescHwAddress8812AE(PADAPTER Adapter); #endif #ifdef CONFIG_BT_COEXIST void rtl8812a_combo_card_WifiOnlyHwInit(PADAPTER Adapter); #endif -VOID +void Hal_PatchwithJaguar_8812( - IN PADAPTER Adapter, - IN RT_MEDIA_STATUS MediaStatus + PADAPTER Adapter, + RT_MEDIA_STATUS MediaStatus ); #endif /* __RTL8188E_HAL_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8812a_led.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8812a_led.h index 28840be0bb9d..7396fed0d56d 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8812a_led.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8812a_led.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,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 +29,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/rtl8188eu/include/rtl8812a_recv.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8812a_recv.h index 4e7b4eddc571..77f06c0bf5c8 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8812a_recv.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8812a_recv.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,39 +12,30 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ #if defined(CONFIG_USB_HCI) #ifndef MAX_RECVBUF_SZ - #ifdef PLATFORM_OS_CE - #define MAX_RECVBUF_SZ (8192+1024) /* 8K+1k */ - #else - #ifndef CONFIG_MINIMAL_MEMORY_USAGE - #ifdef CONFIG_PREALLOC_RX_SKB_BUFFER - #define MAX_RECVBUF_SZ (rtw_rtkm_get_buff_size()) /*depend rtkm*/ - #else - #define MAX_RECVBUF_SZ (32768) /*32k*/ - #endif - /* #define MAX_RECVBUF_SZ (24576) */ /* 24k */ - /* #define MAX_RECVBUF_SZ (20480) */ /* 20K */ - /* #define MAX_RECVBUF_SZ (10240) */ /* 10K */ - /* #define MAX_RECVBUF_SZ (15360) */ /* 15k < 16k */ - /* #define MAX_RECVBUF_SZ (8192+1024) */ /* 8K+1k */ - #ifdef CONFIG_PLATFORM_NOVATEK_NT72668 - #undef MAX_RECVBUF_SZ - #define MAX_RECVBUF_SZ (15360) /* 15k < 16k */ - #endif /* CONFIG_PLATFORM_NOVATEK_NT72668 */ + #ifndef CONFIG_MINIMAL_MEMORY_USAGE + #ifdef CONFIG_PREALLOC_RX_SKB_BUFFER + #define MAX_RECVBUF_SZ (rtw_rtkm_get_buff_size()) /*depend rtkm*/ #else - #define MAX_RECVBUF_SZ (4000) /* about 4K */ + #define MAX_RECVBUF_SZ (32768) /*32k*/ #endif + /* #define MAX_RECVBUF_SZ (24576) */ /* 24k */ + /* #define MAX_RECVBUF_SZ (20480) */ /* 20K */ + /* #define MAX_RECVBUF_SZ (10240) */ /* 10K */ + /* #define MAX_RECVBUF_SZ (15360) */ /* 15k < 16k */ + /* #define MAX_RECVBUF_SZ (8192+1024) */ /* 8K+1k */ + #ifdef CONFIG_PLATFORM_NOVATEK_NT72668 + #undef MAX_RECVBUF_SZ + #define MAX_RECVBUF_SZ (15360) /* 15k < 16k */ + #endif /* CONFIG_PLATFORM_NOVATEK_NT72668 */ + #else + #define MAX_RECVBUF_SZ (4000) /* about 4K */ #endif #endif /* !MAX_RECVBUF_SZ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8812a_rf.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8812a_rf.h index 9a7175d2dd97..63f3745ca97c 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8812a_rf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8812a_rf.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,23 +12,18 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +void PHY_RF6052SetBandwidth8812( - IN PADAPTER Adapter, - IN CHANNEL_WIDTH Bandwidth); + PADAPTER Adapter, + enum channel_width Bandwidth); int PHY_RF6052_Config_8812( - IN PADAPTER Adapter); + PADAPTER Adapter); #endif/* __RTL8188E_RF_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8812a_spec.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8812a_spec.h index d92e8037c91f..8d038ca9d09e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8812a_spec.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8812a_spec.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +99,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 */ /* ----------------------------------------------------- diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8812a_sreset.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8812a_sreset.h index 1d166dcb95ad..309ada941815 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8812a_sreset.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8812a_sreset.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/rtl8812a_xmit.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8812a_xmit.h index 9fe4dfb3e099..790317bd975d 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8812a_xmit.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8812a_xmit.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +322,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); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_cmd.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_cmd.h index ddd7fa600235..1f0ffe69afe4 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_cmd.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_cmd.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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" @@ -36,7 +32,6 @@ #define SET_8814A_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) #define SET_8814A_H2CCMD_PWRMODE_PARM_BCN_EARLY_C2H_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 2, 1, __Value) #define SET_8814A_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -#define SET_8814A_H2CCMD_PWRMODE_PARM_BYTE5(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) #define GET_8814A_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd) LE_BITS_TO_1BYTE(__pH2CCmd, 0, 8) @@ -141,12 +136,10 @@ 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 @@ -163,6 +156,9 @@ Set_RA_LDPC_8814( s32 c2h_handler_8814a(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload); +#ifdef CONFIG_BT_COEXIST +void rtl8814a_download_BTCoex_AP_mode_rsvd_page(PADAPTER padapter); +#endif /* CONFIG_BT_COEXIST */ #ifdef CONFIG_P2P_PS void rtl8814_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); #endif /* CONFIG_P2P */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_dm.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_dm.h index bb925e4e398d..002f09219bd8 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_dm.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_dm.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,18 +12,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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8814A_DM_H__ #define __RTL8814A_DM_H__ -void rtl8814_init_dm_priv(IN PADAPTER Adapter); -void rtl8814_deinit_dm_priv(IN PADAPTER Adapter); -void rtl8814_InitHalDm(IN PADAPTER Adapter); -void rtl8814_HalDmWatchDog(IN PADAPTER Adapter); +void rtl8814_init_dm_priv(PADAPTER Adapter); +void rtl8814_deinit_dm_priv(PADAPTER Adapter); +void rtl8814_InitHalDm(PADAPTER Adapter); +void rtl8814_HalDmWatchDog(PADAPTER Adapter); #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_hal.h index c5a3f882bd99..6de98e575e98 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_hal.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -56,7 +52,10 @@ typedef struct _RT_FIRMWARE_8814 { } RT_FIRMWARE_8814, *PRT_FIRMWARE_8814; #define PAGE_SIZE_TX_8814 PAGE_SIZE_128 -#define BCNQ_PAGE_NUM_8814 0x08 +/* BCN rsvd_page_num = MAX_BEACON_LEN / PAGE_SIZE_TX_8814 + * PS-Poll:1, Null Data:1,Qos Null Data:1,BT Qos Null Data:1,CTS-2-SELF,LTE QoS Null*/ + +#define BCNQ_PAGE_NUM_8814 (MAX_BEACON_LEN / PAGE_SIZE_TX_8814 + 6) /*0x08*/ #define Rtl8814A_NIC_PWR_ON_FLOW rtl8814A_power_on_flow #define Rtl8814A_NIC_RF_OFF_FLOW rtl8814A_radio_off_flow @@ -148,7 +147,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 @@ -201,12 +200,12 @@ Chip specific /* pic buffer descriptor */ #if 1 /* according to the define in the rtw_xmit.h, rtw_recv.h */ #define RTL8814AE_SEG_NUM TX_BUFFER_SEG_NUM /* 0:2 seg, 1: 4 seg, 2: 8 seg */ - #define TX_DESC_NUM_8814A TXDESC_NUM /* 128 */ + #define TX_DESC_NUM_8814A TX_BD_NUM /* 128 */ #define RX_DESC_NUM_8814A PCI_MAX_RX_COUNT /* 128 */ #ifdef CONFIG_CONCURRENT_MODE - #define BE_QUEUE_TX_DESC_NUM_8814A (TXDESC_NUM<<1) /* 256 */ + #define BE_QUEUE_TX_DESC_NUM_8814A (TX_BD_NUM<<1) /* 256 */ #else - #define BE_QUEUE_TX_DESC_NUM_8814A (TXDESC_NUM+(TXDESC_NUM>>1)) /* 192 */ + #define BE_QUEUE_TX_DESC_NUM_8814A (TX_BD_NUM+(TX_BD_NUM>>1)) /* 192 */ #endif #else #define RTL8814AE_SEG_NUM TX_BUFFER_SEG_NUM /* 0:2 seg, 1: 4 seg, 2: 8 seg */ @@ -222,17 +221,27 @@ 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); -VOID +void Hal_InitEfuseVars_8814A( - IN PADAPTER Adapter + PADAPTER Adapter ); s32 InitLLTTable8814A( - IN PADAPTER Adapter + PADAPTER Adapter ); @@ -242,9 +251,9 @@ void InitRDGSetting8814A(PADAPTER padapter); /* EFuse */ u8 GetEEPROMSize8814A(PADAPTER padapter); -VOID hal_InitPGData_8814A( - IN PADAPTER padapter, - IN OUT u8 *PROMContent +void hal_InitPGData_8814A( + PADAPTER padapter, + u8 *PROMContent ); void hal_ReadPROMVersion8814A(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFail); @@ -255,28 +264,28 @@ void hal_ReadChannelPlan8814A(PADAPTER padapter, u8 *hwinfo, BOOLEAN AutoLoadFai void hal_EfuseParseXtal_8814A(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); void hal_ReadAntennaDiversity8814A(PADAPTER pAdapter, u8 *PROMContent, BOOLEAN AutoLoadFail); void hal_Read_TRX_antenna_8814A(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); -VOID hal_ReadAmplifierType_8814A( - IN PADAPTER Adapter +void hal_ReadAmplifierType_8814A( + PADAPTER Adapter ); -VOID hal_ReadPAType_8814A( - IN PADAPTER Adapter, - IN u8 *PROMContent, - IN BOOLEAN AutoloadFail, - OUT u8 *pPAType, - OUT u8 *pLNAType +void hal_ReadPAType_8814A( + PADAPTER Adapter, + u8 *PROMContent, + BOOLEAN AutoloadFail, + u8 *pPAType, + u8 *pLNAType ); void hal_ReadPowerTrackingType_8814A(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); void hal_GetRxGainOffset_8814A( PADAPTER Adapter, - pu1Byte PROMContent, + u8 *PROMContent, BOOLEAN AutoloadFail ); void Hal_EfuseParseKFreeData_8814A( - IN PADAPTER Adapter, - IN u8 *PROMContent, - IN BOOLEAN AutoloadFail); + PADAPTER Adapter, + u8 *PROMContent, + BOOLEAN AutoloadFail); void hal_ReadRFEType_8814A(PADAPTER Adapter, u8 *PROMContent, BOOLEAN AutoloadFail); void hal_EfuseParseBTCoexistInfo8814A(PADAPTER Adapter, u8 *hwinfo, BOOLEAN AutoLoadFail); @@ -297,28 +306,26 @@ 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); void rtl8814_set_hal_ops(struct hal_ops *pHalFunc); void init_hal_spec_8814a(_adapter *adapter); -/* register */ -void SetBcnCtrlReg(PADAPTER padapter, u8 SetBits, u8 ClearBits); -void SetBcnCtrlReg(PADAPTER Adapter, u8 SetBits, u8 ClearBits); void rtl8814_start_thread(PADAPTER padapter); 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 UpdateInterruptMask8814AE(PADAPTER Adapter, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); + void InitMAC_TRXBD_8814AE(PADAPTER Adapter); + u16 get_txbd_rw_reg(u16 ff_hwaddr); #endif #ifdef CONFIG_BT_COEXIST - void rtl8812a_combo_card_WifiOnlyHwInit(PADAPTER Adapter); + void rtl8814a_combo_card_WifiOnlyHwInit(PADAPTER Adapter); #endif #endif /* __RTL8188E_HAL_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_led.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_led.h index 1137a9b46046..755b1b6662fb 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_led.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_led.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,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 +34,4 @@ #endif /* CONFIG_SDIO_HCI */ #endif /* __RTL8814A_LED_H__ */ +#endif /*CONFIG_RTW_SW_LED*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_recv.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_recv.h index e9626f3742f8..cbe2ab717384 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_recv.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_recv.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,35 +12,26 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ #if defined(CONFIG_USB_HCI) #ifndef MAX_RECVBUF_SZ - #ifdef PLATFORM_OS_CE - #define MAX_RECVBUF_SZ (8192+1024) /* 8K+1k */ - #else - #ifndef CONFIG_MINIMAL_MEMORY_USAGE - #ifdef CONFIG_PLATFORM_MSTAR - #define MAX_RECVBUF_SZ (8192) /* 8K */ - #else - #define MAX_RECVBUF_SZ (32768) /* 32k */ - #endif - /* #define MAX_RECVBUF_SZ (24576) */ /* 24k */ - /* #define MAX_RECVBUF_SZ (20480) */ /* 20K */ - /* #define MAX_RECVBUF_SZ (10240) */ /* 10K */ - /* #define MAX_RECVBUF_SZ (15360) */ /* 15k < 16k */ - /* #define MAX_RECVBUF_SZ (8192+1024) */ /* 8K+1k */ + #ifndef CONFIG_MINIMAL_MEMORY_USAGE + #ifdef CONFIG_PLATFORM_MSTAR + #define MAX_RECVBUF_SZ (8192) /* 8K */ #else - #define MAX_RECVBUF_SZ (4000) /* about 4K */ + #define MAX_RECVBUF_SZ (32768) /* 32k */ #endif + /* #define MAX_RECVBUF_SZ (24576) */ /* 24k */ + /* #define MAX_RECVBUF_SZ (20480) */ /* 20K */ + /* #define MAX_RECVBUF_SZ (10240) */ /* 10K */ + /* #define MAX_RECVBUF_SZ (15360) */ /* 15k < 16k */ + /* #define MAX_RECVBUF_SZ (8192+1024) */ /* 8K+1k */ + #else + #define MAX_RECVBUF_SZ (4000) /* about 4K */ #endif #endif /* !MAX_RECVBUF_SZ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_rf.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_rf.h index 7b11d99f5c32..2128eb53b484 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_rf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_rf.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,23 +12,18 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +void PHY_RF6052SetBandwidth8814A( - IN PADAPTER Adapter, - IN CHANNEL_WIDTH Bandwidth); + PADAPTER Adapter, + enum channel_width Bandwidth); int PHY_RF6052_Config_8814A( - IN PADAPTER Adapter); + PADAPTER Adapter); #endif/* __RTL8188E_RF_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_spec.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_spec.h index a3c7e644d427..3c8781d6c8f5 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_spec.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_spec.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +447,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 +480,18 @@ #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 REG_MACID_DROP0_8814A 0x1450 +#define REG_MACID_DROP1_8814A 0x1454 +#define REG_MACID_DROP2_8814A 0x1458 +#define REG_MACID_DROP3_8814A 0x145C + #define DDMA_LEN_MASK 0x0001FFFF #define FW_CHKSUM_DUMMY_SZ 8 #define DDMA_CH_CHKSUM_CNT BIT(24) @@ -550,7 +561,7 @@ /* * 9. Security Control Registers (Offset: ) * */ -#define RWCAM_8814A REG_CAMCMD_8814A /* IN 8190 Data Sheet is called CAMcmd */ +#define RWCAM_8814A REG_CAMCMD_8814A /* 8190 Data Sheet is called CAMcmd */ #define WCAMI_8814A REG_CAMWRITE_8814A /* Software write CAM input content */ #define RCAMO_8814A REG_CAMREAD_8814A /* Software read/write CAM config */ #define CAMDBG_8814A REG_CAMDBG_8814A diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_sreset.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_sreset.h index 5d95e1fac009..23649b882787 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_sreset.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_sreset.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/rtl8814a_xmit.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_xmit.h index 099760d9cbc0..eabf02e37483 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_xmit.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8814a_xmit.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -223,9 +219,10 @@ typedef struct txdescriptor_8814 { /* Dword 7 */ -#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) +#ifdef CONFIG_PCI_HCI #define SET_TX_DESC_TX_BUFFER_SIZE_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) -#else +#endif +#if defined(CONFIG_SDIO_HCI)|| defined(CONFIG_USB_HCI) #define SET_TX_DESC_TX_DESC_CHECKSUM_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 0, 16, __Value) #endif #define SET_TX_DESC_NTX_MAP_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 20, 4, __Value) @@ -238,9 +235,10 @@ typedef struct txdescriptor_8814 { #define SET_TX_DESC_DATA_RC_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 8, 6, __Value) #define SET_TX_DESC_EN_HWEXSEQ_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 14, 1, __Value) #define SET_TX_DESC_HWSEQ_EN_8814A(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 15, 1, __Value) -#if (DEV_BUS_TYPE != RT_SDIO_INTERFACE) +#if defined(CONFIG_PCI_HCI)|| defined(CONFIG_USB_HCI) #define SET_TX_DESC_NEXT_HEAD_PAGE_L_8814A(__pTxDesc, __Value)(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 16, 8, __Value) -#else +#endif +#ifdef CONFIG_SDIO_HCI #define SET_TX_DESC_SDIO_SEQ_8814A(__pTxDesc, __Value)(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 16, 8, __Value) /* 20130415 KaiYuan add for 8814AS */ #endif #define SET_TX_DESC_TAIL_PAGE_L_8814A(__pTxDesc, __Value)(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+32, 24, 8, __Value) @@ -270,6 +268,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,19 +290,22 @@ 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); u8 SCMapping_8814( - IN PADAPTER Adapter, - IN struct pkt_attrib *pattrib + PADAPTER Adapter, + struct pkt_attrib *pattrib ); u8 BWMapping_8814( - IN PADAPTER Adapter, - IN struct pkt_attrib *pattrib + PADAPTER Adapter, + struct pkt_attrib *pattrib ); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8821a_spec.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8821a_spec.h index fc4c7ed88a9e..ead9de2db0cb 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8821a_spec.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8821a_spec.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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,10 +81,8 @@ /* ----------------------------------------------------- * 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 diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8821a_xmit.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8821a_xmit.h index d7a97e3f1de4..b457d15adb41 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8821a_xmit.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8821a_xmit.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/rtl8821c_dm.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8821c_dm.h index 6cdcb0a953c8..32cf516206f9 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8821c_dm.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8821c_dm.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * Copyright(c) 2007 - 2011 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 __RTL8812C_DM_H__ #define __RTL8812C_DM_H__ @@ -24,7 +20,5 @@ 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); -void rtl8821c_phy_haldm_in_lps(PADAPTER); -void rtl8821c_phy_haldm_watchdog_in_lps(PADAPTER); #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8821c_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8821c_hal.h index fd6586ea2915..a4a93ec1fe75 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8821c_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8821c_hal.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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_ @@ -48,12 +44,11 @@ #ifndef MAX_RECVBUF_SZ #ifndef CONFIG_MINIMAL_MEMORY_USAGE - #ifdef CONFIG_PLATFORM_MSTAR - #define MAX_RECVBUF_SZ (8192 + RX_FIFO_EXPANDING) /* 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 + RX_FIFO_EXPANDING) - #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*/ @@ -72,15 +67,19 @@ /*#endif*/ #elif defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) - #define MAX_RECVBUF_SZ (HALMAC_RX_FIFO_SIZE_8821C + RX_FIFO_EXPANDING) + #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 +void rtl8821c_dl_rsvd_page(PADAPTER adapter, u8 mstatus); + +#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/rtl8188eu/include/rtl8821c_spec.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8821c_spec.h index 005b033e6b75..9e0dbb033bfa 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8821c_spec.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8821c_spec.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * Copyright(c) 2007 - 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,11 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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_SPEC_H__ #define __RTL8821C_SPEC_H__ @@ -33,9 +30,9 @@ #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_RXFLTMAP2 REG_RXFLTMAP_8821C /* rtw_mp.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 @@ -116,7 +113,18 @@ #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 */ +/* RFE */ +#define rA_RFE_Pinmux_Jaguar 0xCB0 /* hal_mp.c */ +#define rB_RFE_Pinmux_Jaguar 0xEB0 /* Path_B RFE control pinmux */ +#define rA_RFE_Inv_Jaguar 0xCB4 /* Path_A RFE cotrol */ +#define rB_RFE_Inv_Jaguar 0xEB4 /* Path_B RFE control */ +#define rA_RFE_Jaguar 0xCB8 /* Path_A RFE cotrol */ +#define rB_RFE_Jaguar 0xEB8 /* Path_B RFE control */ +#define rA_RFE_Inverse_Jaguar 0xCBC /* Path_A RFE control inverse */ +#define rB_RFE_Inverse_Jaguar 0xEBC /* Path_B RFE control inverse */ +#define r_ANTSEL_SW_Jaguar 0x900 /* ANTSEL SW Control */ +#define bMask_RFEInv_Jaguar 0x3FF00000 +#define bMask_AntselPathFollow_Jaguar 0x00030000 #define rOFDM1_LSTF 0xD00 #define rOFDM1_TRxPathEnable 0xD04 /* hal_mp.c */ @@ -135,7 +143,6 @@ #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 @@ -181,8 +188,8 @@ struct hw_port_reg { u32 net_type; /*reg_offset*/ u8 net_type_shift; - u32 macaddr; /*reg_offset*/ - u32 bssid; /*reg_offset*/ + u32 macaddr; /*reg_offset*/ + u32 bssid; /*reg_offset*/ u32 bcn_ctl; /*reg_offset*/ u32 tsf_rst; /*reg_offset*/ u8 tsf_rst_bit; @@ -190,6 +197,7 @@ struct hw_port_reg { u8 bcn_space_shift; u16 bcn_space_mask; u32 ps_aid; /*reg_offset*/ + u32 ta; /*reg_offset*/ }; #endif /* __RTL8192E_SPEC_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8821ce_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8821ce_hal.h index c6334bd3702b..b1683ad0648b 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8821ce_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8821ce_hal.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 _RTL8821CE_HAL_H_ #define _RTL8821CE_HAL_H_ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8821cs_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8821cs_hal.h index 97df6e966154..bec0e21f9761 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8821cs_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8821cs_hal.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/rtl8821cu_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8821cu_hal.h index 63c25a821578..d21d5f5cef7e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8821cu_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8821cu_hal.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/rtl8822b_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8822b_hal.h index 191dd6f7f935..71f2a62130f5 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8822b_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8822b_hal.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +21,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 @@ -39,8 +39,7 @@ #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_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 */ @@ -130,7 +129,6 @@ #define rOFDM0_XBAGCCore1 0xC58 /* phydm only */ #define rOFDM0_XATxIQImbalance 0xC80 /* phydm only */ #define rA_LSSIWrite_Jaguar 0xC90 /* RF write addr, LSSI Parameter (rtl8822b_phy.c) */ -#define rA_RFE_Pinmux_Jaguar 0xCB0 /* hal_mp.c */ #define rOFDM1_LSTF 0xD00 #define rOFDM1_TRxPathEnable 0xD04 /* hal_mp.c */ @@ -149,7 +147,22 @@ #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 (rtl8822b_phy.c) */ -#define rB_RFE_Pinmux_Jaguar 0xEB0 /* hal_mp.c */ +/* RFE */ +#define rA_RFE_Pinmux_Jaguar 0xCB0 /* hal_mp.c */ +#define rB_RFE_Pinmux_Jaguar 0xEB0 /* Path_B RFE control pinmux */ +#define rA_RFE_Inv_Jaguar 0xCB4 /* Path_A RFE cotrol */ +#define rB_RFE_Inv_Jaguar 0xEB4 /* Path_B RFE control */ +#define rA_RFE_Jaguar 0xCB8 /* Path_A RFE cotrol */ +#define rB_RFE_Jaguar 0xEB8 /* Path_B RFE control */ +#define rA_RFE_Inverse_Jaguar 0xCBC /* Path_A RFE control inverse */ +#define rB_RFE_Inverse_Jaguar 0xEBC /* Path_B RFE control inverse */ +#define r_ANTSEL_SW_Jaguar 0x900 /* ANTSEL SW Control */ +#define bMask_RFEInv_Jaguar 0x3FF00000 +#define bMask_AntselPathFollow_Jaguar 0x00030000 + +#define rC_RFE_Pinmux_Jaguar 0x18B4 /* Path_C RFE cotrol pinmux*/ +#define rD_RFE_Pinmux_Jaguar 0x1AB4 /* Path_D RFE cotrol pinmux*/ +#define rA_RFE_Sel_Jaguar2 0x1990 /* Page1(0x100) */ #define bBBResetB 0x100 @@ -202,10 +215,10 @@ 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 +void hw_var_set_dl_rsvd_page(PADAPTER adapter, u8 mstatus); #ifdef CONFIG_USB_HCI #include diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8822be_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8822be_hal.h index 8379fabc8a45..38e5d6fa1536 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8822be_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8822be_hal.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +22,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/rtl8188eu/include/rtl8822bs_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8822bs_hal.h index 313036df3a24..bb92cbc6113e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8822bs_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8822bs_hal.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +21,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/rtl8188eu/include/rtl8822bu_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8822bu_hal.h index df16056f67d8..a46fa92caf55 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8822bu_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8822bu_hal.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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_ @@ -39,15 +35,18 @@ /* 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 - #define MAX_RECVBUF_SZ (32768) + #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 (4000) + #define MAX_RECVBUF_SZ (32768) #endif - #endif /* PLATFORM_OS_CE */ + #else + #define MAX_RECVBUF_SZ (4000) + #endif #endif /* !MAX_RECVBUF_SZ */ /* rtl8822bu_ops.c */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8822c_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8822c_hal.h new file mode 100644 index 000000000000..3a296403d287 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8822c_hal.h @@ -0,0 +1,243 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * 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 + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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 _RTL8822C_HAL_H_ +#define _RTL8822C_HAL_H_ + +#include /* BIT(x) */ +#include /* PADAPTER */ +#include "../hal/halmac/halmac_api.h" /* MAC REG definition */ + +#ifdef CONFIG_SUPPORT_TRX_SHARED +#define DEF_RECVBUF_SZ 24576 /* RX 24K */ +#if (DFT_TRX_SHARE_MODE == 1) +#define RX_FIFO_EXPANDING 40960 /* RX= 24K+40K=64K , TX=256K-40K=216K */ +#elif (DFT_TRX_SHARE_MODE == 2) +#define RX_FIFO_EXPANDING 65536 /* RX= 24K+40K+24=88K , TX=256K-40K-24K=192K */ +#elif (DFT_TRX_SHARE_MODE ==3) +#define RX_FIFO_EXPANDING 106496 /* RX= 24K+40K+24+40K=128K , TX=256K-40K-24K-40K=152K */ +#elif (DFT_TRX_SHARE_MODE ==4) +#define RX_FIFO_EXPANDING 131072 /* RX= 24K+40K+24+40K+24K=128K , TX=256K-40K-24K-40K-24K=128K */ +#else +#define RX_FIFO_EXPANDING 0 +#endif +#define MAX_RECVBUF_SZ (DEF_RECVBUF_SZ + RX_FIFO_EXPANDING) +#else /* !CONFIG_SUPPORT_TRX_SHARED */ +#define MAX_RECVBUF_SZ 24576 /* 24KB, TX: 256KB */ +#endif /* !CONFIG_SUPPORT_TRX_SHARED */ + +/* + * MAC Register definition + */ +#define REG_AFE_XTAL_CTRL REG_AFE_CTRL1_8822C /* hal_com.c & phydm */ +#define REG_LEDCFG0 REG_LED_CFG_8822C /* rtw_mp.c */ +#define MSR (REG_CR_8822C + 2) /* rtw_mp.c & hal_com.c */ +#define MSR1 REG_CR_EXT_8822C /* 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_8822C /* hal_com.c */ + +#define REG_WOWLAN_WAKE_REASON 0x01C7 /* hal_com.c */ +#define REG_GPIO_PIN_CTRL_2 REG_GPIO_EXT_CTRL_8822C /* hal_com.c */ + +/* 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_8822C +#define RXERR_RPT_RST BIT_RXERR_RPT_RST_8822C +#define _RXERR_RPT_SEL(type) (BIT_RXERR_RPT_SEL_V1_3_0_8822C(type) \ + | ((type & 0x10) ? BIT_RXERR_RPT_SEL_V1_4_8822C : 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 (rtl8822c_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 */ +/* TX BeamForming */ +#define REG_BB_TX_PATH_SEL_1_8822C 0x93C /* rtl8822c_phy.c */ +#define REG_BB_TX_PATH_SEL_2_8822C 0x940 /* rtl8822c_phy.c */ + +/* TX BeamForming */ +#define REG_BB_TXBF_ANT_SET_BF1_8822C 0x19AC /* rtl8822c_phy.c */ +#define REG_BB_TXBF_ANT_SET_BF0_8822C 0x19B4 /* rtl8822c_phy.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 (rtl8822b_phy.c) */ + +#define rOFDM1_LSTF 0xD00 +#define rOFDM1_TRxPathEnable 0xD04 /* hal_mp.c */ +#define rA_PIRead_Jaguar 0xD04 /* RF readback with PI (rtl8822c_phy.c) */ +#define rA_SIRead_Jaguar 0xD08 /* RF readback with SI (rtl8822c_phy.c) */ +#define rB_PIRead_Jaguar 0xD44 /* RF readback with PI (rtl8822c_phy.c) */ +#define rB_SIRead_Jaguar 0xD48 /* RF readback with SI (rtl8822c_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 (rtl8822b_phy.c) */ +/* RFE */ +#define rA_RFE_Pinmux_Jaguar 0xCB0 /* hal_mp.c */ +#define rB_RFE_Pinmux_Jaguar 0xEB0 /* Path_B RFE control pinmux */ +#define rA_RFE_Inv_Jaguar 0xCB4 /* Path_A RFE cotrol */ +#define rB_RFE_Inv_Jaguar 0xEB4 /* Path_B RFE control */ +#define rA_RFE_Jaguar 0xCB8 /* Path_A RFE cotrol */ +#define rB_RFE_Jaguar 0xEB8 /* Path_B RFE control */ +#define rA_RFE_Inverse_Jaguar 0xCBC /* Path_A RFE control inverse */ +#define rB_RFE_Inverse_Jaguar 0xEBC /* Path_B RFE control inverse */ +#define r_ANTSEL_SW_Jaguar 0x900 /* ANTSEL SW Control */ +#define bMask_RFEInv_Jaguar 0x3FF00000 +#define bMask_AntselPathFollow_Jaguar 0x00030000 + +#define rC_RFE_Pinmux_Jaguar 0x18B4 /* Path_C RFE cotrol pinmux*/ +#define rD_RFE_Pinmux_Jaguar 0x1AB4 /* Path_D RFE cotrol pinmux*/ +#define rA_RFE_Sel_Jaguar2 0x1990 + +/* 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 /* rtl8822c_phy.c */ +#define RF_ModeTableAddr 0x30 /* rtl8822c_phy.c */ +#define RF_ModeTableData0 0x31 /* rtl8822c_phy.c */ +#define RF_ModeTableData1 0x32 /* rtl8822c_phy.c */ +#define RF_0x52 0x52 +#define RF_WeLut_Jaguar 0xEF /* rtl8822c_phy.c */ + +/* rtw_lps_state_chk()@hal_com.c */ +#define BIT_PWRBIT_OW_EN BIT_WMAC_TCRPWRMGT_HWDATA_EN_8822C + +/* General Functions */ +void rtl8822c_init_hal_spec(PADAPTER); /* hal/hal_com.c */ + +#ifdef CONFIG_MP_INCLUDED +/* MP Functions */ +#include /* struct mp_priv */ +void rtl8822c_prepare_mp_txdesc(PADAPTER, struct mp_priv *); /* rtw_mp.c */ +void rtl8822c_mp_config_rfpath(PADAPTER); /* hal_mp.c */ +#endif +void hw_var_set_dl_rsvd_page(PADAPTER adapter, u8 mstatus); + +#ifdef CONFIG_USB_HCI +#include +#elif defined(CONFIG_SDIO_HCI) +#include +#elif defined(CONFIG_PCI_HCI) +#include +#endif + +#endif /* _RTL8822C_HAL_H_ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8822ce_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8822ce_hal.h new file mode 100644 index 000000000000..9487fde35097 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8822ce_hal.h @@ -0,0 +1,28 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * 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 + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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 _RTL8822CE_HAL_H_ +#define _RTL8822CE_HAL_H_ + +#include /* PADAPTER */ + +#define RT_BCN_INT_MASKS (BIT20 | BIT25 | BIT26 | BIT16) + +/* rtl8822ce_ops.c */ +void UpdateInterruptMask8822CE(PADAPTER, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); +u16 get_txbd_rw_reg(u16 q_idx); + + +#endif /* _RTL8822CE_HAL_H_ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8822cs_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8822cs_hal.h new file mode 100644 index 000000000000..24fa72b1367c --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8822cs_hal.h @@ -0,0 +1,32 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * 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 + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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 _RTL8822CS_HAL_H_ +#define _RTL8822CS_HAL_H_ + +#include /* PADAPTER */ + +/* rtl8822cs_ops.c */ +void rtl8822cs_set_hal_ops(PADAPTER); + +#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) +void rtl8822cs_disable_interrupt_but_cpwm2(PADAPTER adapter); +#endif + +/* rtl8822cs_xmit.c */ +s32 rtl8822cs_dequeue_writeport(PADAPTER); +#define _dequeue_writeport(a) rtl8822cs_dequeue_writeport(a) + +#endif /* _RTL8822CS_HAL_H_ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8822cu_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8822cu_hal.h new file mode 100644 index 000000000000..2a354d71df9f --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtl8822cu_hal.h @@ -0,0 +1,62 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * 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 + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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 _RTL8822CU_HAL_H_ +#define _RTL8822CU_HAL_H_ + +#ifdef CONFIG_USB_HCI + #include /* PADAPTER */ + + #ifdef CONFIG_USB_HCI + #ifdef USB_PACKET_OFFSET_SZ + #define PACKET_OFFSET_SZ (USB_PACKET_OFFSET_SZ) + #else + #define PACKET_OFFSET_SZ (8) + #endif + #define TXDESC_OFFSET (TXDESC_SIZE + PACKET_OFFSET_SZ) + #endif + + /* undefine MAX_RECVBUF_SZ from rtl8822c_hal.h */ + #ifdef MAX_RECVBUF_SZ + #undef MAX_RECVBUF_SZ + #endif + + /* recv_buffer must be large than usb agg size */ + #ifndef MAX_RECVBUF_SZ + #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 + #endif /* !MAX_RECVBUF_SZ */ + + /* rtl8822cu_ops.c */ + void rtl8822cu_set_hal_ops(PADAPTER padapter); + void rtl8822cu_set_hw_type(struct dvobj_priv *pdvobj); + + /* rtl8822cu_io.c */ + void rtl8822cu_set_intf_ops(struct _io_ops *pops); + +#endif /* CONFIG_USB_HCI */ + + +#endif /* _RTL8822CU_HAL_H_ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_android.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_android.h index 2015afea06a5..4805677c5756 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_android.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_android.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -35,6 +31,7 @@ enum ANDROID_WIFI_CMD { ANDROID_WIFI_CMD_BTCOEXSCAN_START, ANDROID_WIFI_CMD_BTCOEXSCAN_STOP, ANDROID_WIFI_CMD_BTCOEXMODE, + ANDROID_WIFI_CMD_SETSUSPENDMODE, ANDROID_WIFI_CMD_SETSUSPENDOPT, ANDROID_WIFI_CMD_P2P_DEV_ADDR, ANDROID_WIFI_CMD_SETFWPATH, @@ -74,6 +71,8 @@ enum ANDROID_WIFI_CMD { ANDROID_WIFI_CMD_GTK_REKEY_OFFLOAD, #endif /* CONFIG_GTK_OL */ ANDROID_WIFI_CMD_P2P_DISABLE, + ANDROID_WIFI_CMD_SET_AEK, + ANDROID_WIFI_CMD_EXT_AUTH_STATUS, ANDROID_WIFI_CMD_DRIVERVERSION, ANDROID_WIFI_CMD_MAX }; @@ -97,11 +96,11 @@ int wifi_set_power(int on, unsigned long msec); int wifi_get_mac_addr(unsigned char *buf); void *wifi_get_country_code(char *ccode); #else -static int rtw_android_wifictrl_func_add(void) +static inline int rtw_android_wifictrl_func_add(void) { return 0; } -static void rtw_android_wifictrl_func_del(void) {} +static inline void rtw_android_wifictrl_func_del(void) {} #endif /* defined(RTW_ENABLE_WIFI_CONTROL_FUNC) */ #ifdef CONFIG_GPIO_WAKEUP diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_ap.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_ap.h index 4332ccecf64a..446d8191cec0 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_ap.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_ap.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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_ @@ -30,12 +26,16 @@ extern void rtw_indicate_sta_disassoc_event(_adapter *padapter, struct sta_info void init_mlme_ap_info(_adapter *padapter); void free_mlme_ap_info(_adapter *padapter); +u8 rtw_set_tim_ie(u8 dtim_cnt, u8 dtim_period + , const u8 *tim_bmp, u8 tim_bmp_len, u8 *tim_ie); /* void update_BCNTIM(_adapter *padapter); */ void rtw_add_bcn_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork, u8 index, u8 *data, u8 len); 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, u8 is_update_bw); + +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); @@ -44,11 +44,15 @@ int rtw_check_beacon_data(_adapter *padapter, u8 *pbuf, int len); void rtw_ap_restore_network(_adapter *padapter); #if CONFIG_RTW_MACADDR_ACL -void rtw_set_macaddr_acl(_adapter *adapter, int mode); -int rtw_acl_add_sta(_adapter *adapter, const u8 *addr); -int rtw_acl_remove_sta(_adapter *adapter, const u8 *addr); +void rtw_macaddr_acl_init(_adapter *adapter, u8 period); +void rtw_macaddr_acl_deinit(_adapter *adapter, u8 period); +void rtw_macaddr_acl_clear(_adapter *adapter, u8 period); +void rtw_set_macaddr_acl(_adapter *adapter, u8 period, int mode); +int rtw_acl_add_sta(_adapter *adapter, u8 period, const u8 *addr); +int rtw_acl_remove_sta(_adapter *adapter, u8 period, const u8 *addr); #endif /* CONFIG_RTW_MACADDR_ACL */ +u8 rtw_ap_set_sta_key(_adapter *adapter, const u8 *addr, u8 alg, const u8 *key, u8 keyid, u8 gk); u8 rtw_ap_set_pairwise_key(_adapter *padapter, struct sta_info *psta); int rtw_ap_set_group_key(_adapter *padapter, u8 *key, u8 alg, int keyid); int rtw_ap_set_wep_key(_adapter *padapter, u8 *key, u8 keylen, int keyid, u8 set_tx); @@ -67,22 +71,43 @@ void stop_ap_mode(_adapter *padapter); #endif void rtw_ap_update_bss_chbw(_adapter *adapter, WLAN_BSSID_EX *bss, u8 ch, u8 bw, u8 offset); -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); +u8 rtw_ap_chbw_decision(_adapter *adapter, u8 ifbmp, u8 excl_ifbmp + , 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); +#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); +#ifdef CONFIG_80211N_HT int rtw_ht_operation_update(_adapter *padapter); +#endif /* CONFIG_80211N_HT */ +u8 rtw_ap_sta_states_check(_adapter *adapter); + +#ifdef CONFIG_FW_HANDLE_TXBCN +#define rtw_ap_get_nums(adapter) (adapter_to_dvobj(adapter)->nr_ap_if) +bool rtw_ap_nums_check(_adapter *adapter); +#endif #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/rtl8188eu/include/rtw_beamforming.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_beamforming.h index 919388b9b583..76be5b92eba3 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_beamforming.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_beamforming.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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_ @@ -106,7 +102,7 @@ struct beamformee_entry { /* Used to fill Reg6E4 to fill Mac address of CSI report frame */ u8 mac_addr[ETH_ALEN]; /* Sounding BandWidth */ - CHANNEL_WIDTH sound_bw; + enum channel_width sound_bw; u16 sound_period; enum beamforming_cap cap; @@ -121,7 +117,7 @@ struct beamformee_entry { u8 bApplySounding; /* information for sounding judgement */ - u32 tx_timestamp; + systime tx_timestamp; u64 tx_bytes; u16 LogStatusFailCnt:5; /* 0~21 */ @@ -213,6 +209,7 @@ struct beamforming_info { u32 beamformee_mu_reg_maping; u8 first_mu_bfee_index; u8 mu_bfer_curidx; + u8 cur_csi_rpt_rate; struct sounding_info sounding_info; /* schedule regular timer for sounding */ @@ -262,112 +259,23 @@ void rtw_bf_update_traffic(PADAPTER); #define beamforming_wk_cmd rtw_bf_cmd #define update_attrib_txbf_info rtw_bf_update_attrib +#define HT_BF_CAP(adapter) ((adapter)->mlmepriv.htpriv.beamform_cap) +#define VHT_BF_CAP(adapter) ((adapter)->mlmepriv.vhtpriv.beamform_cap) + +#define IS_HT_BEAMFORMEE(adapter) \ + (HT_BF_CAP(adapter) & \ + (BEAMFORMING_HT_BEAMFORMEE_ENABLE)) + +#define IS_VHT_BEAMFORMEE(adapter) \ + (VHT_BF_CAP(adapter) & \ + (BEAMFORMING_VHT_BEAMFORMEE_ENABLE | \ + BEAMFORMING_VHT_MU_MIMO_STA_ENABLE)) + +#define IS_BEAMFORMEE(adapter) (IS_HT_BEAMFORMEE(adapter) | \ + IS_VHT_BEAMFORMEE(adapter)) + #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)) - - -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_STATE { - BEAMFORMING_STATE_IDLE, - BEAMFORMING_STATE_START, - BEAMFORMING_STATE_END, -} BEAMFORMING_STATE, *PBEAMFORMING_STATE; - - -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 = 0x10, - BEAMFORMEE_CAP = 0x20, -} 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; - -struct beamforming_entry { - BOOLEAN bUsed; - BOOLEAN bSound; - 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. */ - 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 */ - u16 sound_period; - BEAMFORMING_CAP beamforming_entry_cap; - BEAMFORMING_ENTRY_STATE beamforming_entry_state; - u8 ClockResetTimes; /*Modified by Jeffery @2015-04-10*/ - u8 PreLogSeq; /*Modified by Jeffery @2015-03-30*/ - u8 LogSeq; /*Modified by Jeffery @2014-10-29*/ - u16 LogRetryCnt:3; /*Modified by Jeffery @2014-10-29*/ - u16 LogSuccess:2; /*Modified by Jeffery @2014-10-29*/ - - u8 LogStatusFailCnt; - u8 PreCsiReport[327]; - u8 DefaultCsiCnt; - BOOLEAN bDefaultCSI; -}; - -struct sounding_info { - u8 sound_idx; - CHANNEL_WIDTH sound_bw; - SOUNDING_MODE sound_mode; - u16 sound_period; -}; - -struct beamforming_info { - BEAMFORMING_CAP beamforming_cap; - BEAMFORMING_STATE beamforming_state; - struct beamforming_entry beamforming_entry[BEAMFORMING_ENTRY_NUM]; - u8 beamforming_cur_idx; - u8 beamforming_in_progress; - u8 sounding_sequence; - struct sounding_info sounding_info; -}; - -struct rtw_ndpa_sta_info { - u16 aid:12; - u16 feedback_type:1; - 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); - -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); - -void beamforming_check_sounding_success(PADAPTER Adapter, BOOLEAN status); - -void beamforming_watchdog(PADAPTER Adapter); -#endif /*#if (BEAMFORMING_SUPPORT ==0)- for diver defined beamforming*/ - +/*PHYDM_BF - (BEAMFORMING_SUPPORT == 1)*/ enum BEAMFORMING_CTRL_TYPE { BEAMFORMING_CTRL_ENTER = 0, BEAMFORMING_CTRL_LEAVE = 1, diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_br_ext.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_br_ext.h index 1df8dc66f6f3..40e72a49d030 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_br_ext.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_br_ext.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/rtw_bt_mp.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_bt_mp.h index cd6ed0aa14e6..fc52e9e05e11 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_bt_mp.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_bt_mp.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 @@ -42,16 +38,16 @@ typedef enum _MP_BT_MODE { /* definition for BT_UP_OP_BT_SET_TX_RX_PARAMETER */ typedef struct _BT_TXRX_PARAMETERS { - u1Byte txrxChannel; - u4Byte txrxTxPktCnt; - u1Byte txrxTxPktInterval; - u1Byte txrxPayloadType; - u1Byte txrxPktType; - u2Byte txrxPayloadLen; - u4Byte txrxPktHeader; - u1Byte txrxWhitenCoeff; - u1Byte txrxBdaddr[6]; - u1Byte txrxTxGainIndex; + u8 txrxChannel; + u32 txrxTxPktCnt; + u8 txrxTxPktInterval; + u8 txrxPayloadType; + u8 txrxPktType; + u16 txrxPayloadLen; + u32 txrxPktHeader; + u8 txrxWhitenCoeff; + u8 txrxBdaddr[6]; + u8 txrxTxGainIndex; } BT_TXRX_PARAMETERS, *PBT_TXRX_PARAMETERS; /* txrxPktType */ @@ -165,71 +161,71 @@ typedef enum _BT_REPORT_TYPE { BT_REPORT_MAX } BT_REPORT_TYPE, *PBT_REPORT_TYPE; -VOID +void MPTBT_Test( - IN PADAPTER Adapter, - IN u1Byte opCode, - IN u1Byte byte1, - IN u1Byte byte2, - IN u1Byte byte3 + PADAPTER Adapter, + u8 opCode, + u8 byte1, + u8 byte2, + u8 byte3 ); -NDIS_STATUS +uint MPTBT_SendOidBT( - IN PADAPTER pAdapter, - IN PVOID InformationBuffer, - IN ULONG InformationBufferLength, - OUT PULONG BytesRead, - OUT PULONG BytesNeeded + PADAPTER pAdapter, + void *InformationBuffer, + u32 InformationBufferLength, + u32 *BytesRead, + u32 *BytesNeeded ); -VOID +void MPTBT_FwC2hBtMpCtrl( PADAPTER Adapter, - pu1Byte tmpBuf, - u1Byte length + u8 *tmpBuf, + u8 length ); void MPh2c_timeout_handle(void *FunctionContext); -VOID mptbt_BtControlProcess( +void mptbt_BtControlProcess( PADAPTER Adapter, - PVOID pInBuf + void *pInBuf ); #define BT_H2C_MAX_RETRY 1 #define BT_MAX_C2H_LEN 20 typedef struct _BT_REQ_CMD { - UCHAR opCodeVer; - UCHAR OpCode; - USHORT paraLength; - UCHAR pParamStart[100]; + u8 opCodeVer; + u8 OpCode; + u16 paraLength; + u8 pParamStart[100]; } BT_REQ_CMD, *PBT_REQ_CMD; typedef struct _BT_RSP_CMD { - USHORT status; - USHORT paraLength; - UCHAR pParamStart[100]; + u16 status; + u16 paraLength; + u8 pParamStart[100]; } BT_RSP_CMD, *PBT_RSP_CMD; typedef struct _BT_H2C { - u1Byte opCodeVer:4; - u1Byte reqNum:4; - u1Byte opCode; - u1Byte buf[100]; + u8 opCodeVer:4; + u8 reqNum:4; + u8 opCode; + u8 buf[100]; } BT_H2C, *PBT_H2C; typedef struct _BT_EXT_C2H { - u1Byte extendId; - u1Byte statusCode:4; - u1Byte retLen:4; - u1Byte opCodeVer:4; - u1Byte reqNum:4; - u1Byte buf[100]; + u8 extendId; + u8 statusCode:4; + u8 retLen:4; + u8 opCodeVer:4; + u8 reqNum:4; + u8 buf[100]; } BT_EXT_C2H, *PBT_EXT_C2H; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_btcoex.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_btcoex.h index e2d6ec5b64e7..8f323005cb61 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_btcoex.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_btcoex.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,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__ @@ -93,35 +91,35 @@ typedef enum _BTCOEX_SUSPEND_STATE { #define BT_INFO_LEN 8 typedef struct _HCI_LINK_INFO { - u2Byte ConnectHandle; - u1Byte IncomingTrafficMode; - u1Byte OutgoingTrafficMode; - u1Byte BTProfile; - u1Byte BTCoreSpec; - s1Byte BT_RSSI; - u1Byte TrafficProfile; - u1Byte linkRole; + u16 ConnectHandle; + u8 IncomingTrafficMode; + u8 OutgoingTrafficMode; + u8 BTProfile; + u8 BTCoreSpec; + s8 BT_RSSI; + u8 TrafficProfile; + u8 linkRole; } HCI_LINK_INFO, *PHCI_LINK_INFO; #define MAX_BT_ACL_LINK_NUM 8 typedef struct _HCI_EXT_CONFIG { HCI_LINK_INFO aclLink[MAX_BT_ACL_LINK_NUM]; - u1Byte btOperationCode; - u2Byte CurrentConnectHandle; - u1Byte CurrentIncomingTrafficMode; - u1Byte CurrentOutgoingTrafficMode; + u8 btOperationCode; + u16 CurrentConnectHandle; + u8 CurrentIncomingTrafficMode; + u8 CurrentOutgoingTrafficMode; - u1Byte NumberOfACL; - u1Byte NumberOfSCO; - u1Byte CurrentBTStatus; - u2Byte HCIExtensionVer; + u8 NumberOfACL; + u8 NumberOfSCO; + u8 CurrentBTStatus; + u16 HCIExtensionVer; BOOLEAN bEnableWifiScanNotify; } HCI_EXT_CONFIG, *PHCI_EXT_CONFIG; typedef struct _HCI_PHY_LINK_BSS_INFO { - u2Byte bdCap; /* capability information */ + u16 bdCap; /* capability information */ /* Qos related. Added by Annie, 2005-11-01. */ /* BSS_QOS BssQos; */ @@ -318,15 +316,15 @@ typedef struct _BT_MGNT { BOOLEAN bLogLinkInProgress; BOOLEAN bPhyLinkInProgress; BOOLEAN bPhyLinkInProgressStartLL; - u1Byte BtCurrentPhyLinkhandle; - u2Byte BtCurrentLogLinkhandle; - u1Byte CurrentConnectEntryNum; - u1Byte DisconnectEntryNum; - u1Byte CurrentBTConnectionCnt; + u8 BtCurrentPhyLinkhandle; + u16 BtCurrentLogLinkhandle; + u8 CurrentConnectEntryNum; + u8 DisconnectEntryNum; + u8 CurrentBTConnectionCnt; BT_CONNECT_TYPE BTCurrentConnectType; BT_CONNECT_TYPE BTReceiveConnectPkt; - u1Byte BTAuthCount; - u1Byte BTAsocCount; + u8 BTAuthCount; + u8 BTAsocCount; BOOLEAN bStartSendSupervisionPkt; BOOLEAN BtOperationOn; BOOLEAN BTNeedAMPStatusChg; @@ -336,7 +334,7 @@ typedef struct _BT_MGNT { BOOLEAN bNeedNotifyAMPNoCap; BOOLEAN bCreateSpportQos; BOOLEAN bSupportProfile; - u1Byte BTChannel; + u8 BTChannel; BOOLEAN CheckChnlIsSuit; BOOLEAN bBtScan; BOOLEAN btLogoTest; @@ -369,6 +367,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 +383,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); @@ -397,6 +399,9 @@ u8 rtw_btcoex_IsLpsOn(PADAPTER); u8 rtw_btcoex_RpwmVal(PADAPTER); u8 rtw_btcoex_LpsVal(PADAPTER); u32 rtw_btcoex_GetRaMask(PADAPTER); +u8 rtw_btcoex_query_reduced_wl_pwr_lvl(PADAPTER padapter); +void rtw_btcoex_set_reduced_wl_pwr_lvl(PADAPTER padapter, u8 val); +void rtw_btcoex_do_reduce_wl_pwr_lvl(PADAPTER padapter); void rtw_btcoex_RecordPwrMode(PADAPTER, u8 *pCmdBuf, u8 cmdLen); void rtw_btcoex_DisplayBtCoexInfo(PADAPTER, u8 *pbuf, u32 bufsize); void rtw_btcoex_SetDBG(PADAPTER, u32 *pDbgModule); @@ -404,6 +409,12 @@ u32 rtw_btcoex_GetDBG(PADAPTER, u8 *pStrBuf, u32 bufSize); u8 rtw_btcoex_IncreaseScanDeviceNum(PADAPTER); u8 rtw_btcoex_IsBtLinkExist(PADAPTER); 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,6 +437,7 @@ 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_reduce_wl_txpwr(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); @@ -433,12 +445,17 @@ u8 rtw_btcoex_get_pg_single_ant_path(PADAPTER padapter); u8 rtw_btcoex_get_pg_rfe_type(PADAPTER padapter); u8 rtw_btcoex_is_tfbga_package_type(PADAPTER padapter); u8 rtw_btcoex_get_ant_div_cfg(PADAPTER padapter); +u16 rtw_btcoex_btset_testmode(PADAPTER padapter, u8 type); /* ================================================== * 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/rtl8188eu/include/rtw_btcoex_wifionly.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_btcoex_wifionly.h index 11d36f7d03ab..ffaf36723fcc 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_btcoex_wifionly.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_btcoex_wifionly.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,17 +12,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 __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_connect_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/rtl8188eu/include/rtw_byteorder.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_byteorder.h index 70482d26bd23..f117fe317d4e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_byteorder.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_byteorder.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/rtw_cmd.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_cmd.h index 4b02eed78cca..b085908a406d 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_cmd.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_cmd.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,31 +12,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 __RTW_CMD_H_ #define __RTW_CMD_H_ #define C2H_MEM_SZ (16*1024) -#ifndef CONFIG_RTL8711FW - #define FREE_CMDOBJ_SZ 128 #define MAX_CMDSZ 1024 #define MAX_RSPSZ 512 #define MAX_EVTSZ 1024 -#ifdef PLATFORM_OS_CE - #define CMDBUFF_ALIGN_SZ 4 -#else - #define CMDBUFF_ALIGN_SZ 512 -#endif +#define CMDBUFF_ALIGN_SZ 512 struct cmd_obj { _adapter *padapter; @@ -60,7 +50,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 +63,7 @@ struct cmd_priv { u32 rsp_cnt; ATOMIC_T cmdthd_running; /* u8 cmdthd_running; */ - u8 stop_req; + _adapter *padapter; _mutex sctx_mutex; }; @@ -90,7 +81,7 @@ struct evt_obj { struct evt_priv { #ifdef CONFIG_EVENT_THREAD_MODE _sema evt_notify; - _sema terminate_evtthread_sema; + _queue evt_queue; #endif @@ -118,9 +109,6 @@ struct evt_priv { #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) u8 *c2h_mem; u8 *allocated_c2h_mem; -#ifdef PLATFORM_OS_XP - PMDL pc2h_mdl; -#endif #endif }; @@ -154,6 +142,10 @@ struct P2P_PS_Offload_t { u8 AllStaSleep:1; /* Only valid in Owner */ u8 discovery:1; u8 rsvd:1; +#ifdef CONFIG_P2P_PS_NOA_USE_MACID_SLEEP + u8 p2p_macid:7; + u8 disable_close_rf:1; /*1: not close RF but just pause p2p_macid when NoA duration*/ +#endif /* CONFIG_P2P_PS_NOA_USE_MACID_SLEEP */ }; struct P2P_PS_CTWPeriod_t { @@ -209,12 +201,20 @@ u8 p2p_roch_cmd(_adapter *adapter , u8 flags ); u8 p2p_cancel_roch_cmd(_adapter *adapter, u64 cookie, struct wireless_dev *wdev, u8 flags); + #endif /* CONFIG_IOCTL_CFG80211 */ #endif /* CONFIG_P2P */ -#else -/* #include */ -#endif /* CONFIG_RTL8711FW */ +#ifdef CONFIG_IOCTL_CFG80211 +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 mgnt_tx_parm { + u8 tx_ch; + u8 no_cck; + const u8 *buf; + size_t len; + int wait_ack; +}; +#endif enum rtw_drvextra_cmd_id { NONE_WK_CID, @@ -228,7 +228,6 @@ enum rtw_drvextra_cmd_id { P2P_PS_WK_CID, P2P_PROTO_WK_CID, CHECK_HIQ_WK_CID,/* for softap mode, check hi queue if empty */ - INTEl_WIDI_WK_CID, C2H_WK_CID, RTP_TIMER_CFG_WK_CID, RESET_SECURITYPRIV, /* add for CONFIG_IEEE80211W, none 11w also can use */ @@ -238,12 +237,24 @@ enum rtw_drvextra_cmd_id { BEAMFORMING_WK_CID, LPS_CHANGE_DTIM_CID, BTINFO_WK_CID, - DFS_MASTER_WK_CID, + BTC_REDUCE_WL_TXPWR_CID, + DFS_RADAR_DETECT_WK_CID, + DFS_RADAR_DETECT_EN_DEC_WK_CID, SESSION_TRACKER_WK_CID, EN_HW_UPDATE_TSF_WK_CID, + PERIOD_TSF_UPDATE_END_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, + REQ_PER_CMD_WK_CID, + SSMPS_WK_CID, +#ifdef CONFIG_CTRL_TXSS_BY_TP + TXSS_WK_CID, +#endif MAX_WK_CID }; @@ -259,6 +270,7 @@ enum LPS_CTRL_TYPE { LPS_CTRL_RX_TRAFFIC_LEAVE = 8, LPS_CTRL_ENTER = 9, LPS_CTRL_LEAVE_CFG80211_PWRMGMT = 10, + LPS_CTRL_LEAVE_SET_LEVEL = 11, }; enum STAKEY_TYPE { @@ -328,7 +340,9 @@ Command Mode struct createbss_parm { bool adhoc; - /* used by AP mode now */ + /* used by AP/Mesh mode now */ + u8 ifbmp; + u8 excl_ifbmp; s16 req_ch; s8 req_bw; s8 req_offset; @@ -372,6 +386,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 */ }; /* @@ -403,7 +422,6 @@ when 802.1x ==> keyid > 2 ==> unicast key struct setkey_parm { u8 algorithm; /* encryption algorithm, could be none, wep40, TKIP, CCMP, wep104 */ u8 keyid; - u8 grpkey; /* 1: this is the grpkey for 802.1x. 0: this is the unicast key for 802.1x */ u8 set_tx; /* 1: main tx key for wep. 0: other key. */ u8 key[16]; /* this could be 40 or 104 */ }; @@ -418,10 +436,11 @@ when shared key ==> algorithm/keyid */ struct set_stakey_parm { - u8 addr[ETH_ALEN]; - u8 algorithm; - u8 keyid; - u8 key[16]; + u8 addr[ETH_ALEN]; + u8 algorithm; + u8 keyid; + u8 key[16]; + u8 gk; }; struct set_stakey_rsp { @@ -534,35 +553,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 @@ -966,12 +956,7 @@ struct SetChannelPlan_param { /*H2C Handler index: 60 */ struct LedBlink_param { - PVOID pLed; -}; - -/*H2C Handler index: 61 */ -struct SetChannelSwitch_param { - u8 new_ch_no; + void *pLed; }; /*H2C Handler index: 62 */ @@ -1013,14 +998,22 @@ 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); + +#define REQ_CH_NONE -1 +#define REQ_BW_NONE -1 +#define REQ_BW_ORI -2 +#define REQ_OFFSET_NONE -1 + +u8 rtw_change_bss_chbw_cmd(_adapter *adapter, int flags + , u8 ifbmp, u8 excl_ifbmp, s16 req_ch, s8 req_bw, s8 req_offset); extern u8 rtw_setphy_cmd(_adapter *padapter, u8 modem, u8 ch); @@ -1029,8 +1022,8 @@ 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); -extern u8 rtw_setopmode_cmd(_adapter *padapter, NDIS_802_11_NETWORK_INFRASTRUCTURE networktype, 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, u8 flags); extern u8 rtw_setdatarate_cmd(_adapter *padapter, u8 *rateset); extern u8 rtw_setbasicrate_cmd(_adapter *padapter, u8 *rateset); extern u8 rtw_getmacreg_cmd(_adapter *padapter, u8 len, u32 addr); @@ -1051,10 +1044,11 @@ extern u8 rtw_addbareq_cmd(_adapter *padapter, u8 tid, u8 *addr); extern u8 rtw_addbarsp_cmd(_adapter *padapter, u8 *addr, u16 tid, u8 status, u8 size, u16 start_seq); /* add for CONFIG_IEEE80211W, none 11w also can use */ extern u8 rtw_reset_securitypriv_cmd(_adapter *padapter); -extern u8 rtw_free_assoc_resources_cmd(_adapter *padapter); +extern u8 rtw_free_assoc_resources_cmd(_adapter *padapter, u8 lock_scanned_queue, int flags); extern u8 rtw_dynamic_chk_wk_cmd(_adapter *adapter); -u8 rtw_lps_ctrl_wk_cmd(_adapter *padapter, u8 lps_ctrl_type, u8 enqueue); +u8 rtw_lps_ctrl_wk_cmd(_adapter *padapter, u8 lps_ctrl_type, u8 flags); +u8 rtw_lps_ctrl_leave_set_level_cmd(_adapter *adapter, u8 lps_level, u8 flags); u8 rtw_dm_in_lps_wk_cmd(_adapter *padapter); u8 rtw_lps_change_dtim_cmd(_adapter *padapter, u8 dtim); @@ -1070,39 +1064,37 @@ u8 rtw_dm_ra_mask_wk_cmd(_adapter *padapter, u8 *psta); extern u8 rtw_ps_cmd(_adapter *padapter); +#ifdef CONFIG_DFS +void rtw_dfs_ch_switch_hdl(struct dvobj_priv *dvobj); +#endif + #ifdef CONFIG_AP_MODE 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_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); +u8 rtw_dfs_rd_cmd(_adapter *adapter, bool enqueue); +void rtw_dfs_rd_timer_hdl(void *ctx); +void rtw_dfs_rd_en_decision(_adapter *adapter, u8 mlme_act, u8 excl_ifbmp); +u8 rtw_dfs_rd_en_decision_cmd(_adapter *adapter); #endif /* CONFIG_DFS_MASTER */ #endif /* CONFIG_AP_MODE */ #ifdef CONFIG_BT_COEXIST u8 rtw_btinfo_cmd(PADAPTER padapter, u8 *pbuf, u16 length); +u8 rtw_btc_reduce_wl_txpwr_cmd(_adapter *adapter, u32 val); #endif u8 rtw_test_h2c_cmd(_adapter *adapter, u8 *buf, u8 len); u8 rtw_enable_hw_update_tsf_cmd(_adapter *padapter); +u8 rtw_periodic_tsf_update_end_cmd(_adapter *adapter); -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); -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_led_blink_cmd(_adapter *padapter, void *pLed); +extern u8 rtw_set_csa_cmd(_adapter *adapter); extern u8 rtw_tdls_cmd(_adapter *padapter, u8 *addr, u8 option); u8 rtw_mp_cmd(_adapter *adapter, u8 mp_cmd_id, u8 flags); @@ -1119,12 +1111,43 @@ 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); +struct ssmps_cmd_parm { + struct sta_info *sta; + u8 smps; +}; +u8 rtw_ssmps_wk_cmd(_adapter *adapter, struct sta_info *sta, u8 smps, u8 enqueue); + u8 session_tracker_chk_cmd(_adapter *adapter, struct sta_info *sta); u8 session_tracker_add_cmd(_adapter *adapter, struct sta_info *sta, u8 *local_naddr, u8 *local_port, u8 *remote_naddr, u8 *remote_port); u8 session_tracker_del_cmd(_adapter *adapter, struct sta_info *sta, u8 *local_naddr, u8 *local_port, u8 *remote_naddr, u8 *remote_port); +#if defined(CONFIG_RTW_MESH) && defined(RTW_PER_CMD_SUPPORT_FW) +u8 rtw_req_per_cmd(_adapter * adapter); +#endif + +#ifdef CONFIG_CTRL_TXSS_BY_TP +struct txss_cmd_parm { + struct sta_info *sta; + bool tx_1ss; +}; + +void rtw_ctrl_txss_update_mimo_type(_adapter *adapter, struct sta_info *sta); +u8 rtw_ctrl_txss(_adapter *adapter, struct sta_info *sta, bool tx_1ss); +void rtw_ctrl_tx_ss_by_tp(_adapter *adapter, u8 from_timer); + +#ifdef DBG_CTRL_TXSS +void dbg_ctrl_txss(_adapter *adapter, bool tx_1ss); +#endif +#endif + u8 rtw_drvextra_cmd_hdl(_adapter *padapter, unsigned char *pbuf); extern void rtw_survey_cmd_callback(_adapter *padapter, struct cmd_obj *pcmd); @@ -1221,6 +1244,7 @@ enum rtw_h2c_cmd { GEN_CMD_CODE(_RunInThreadCMD), /*64*/ GEN_CMD_CODE(_AddBARsp) , /*65*/ + GEN_CMD_CODE(_RM_POST_EVENT), /*66*/ MAX_H2CCMD }; @@ -1308,6 +1332,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/rtl8188eu/include/rtw_debug.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_debug.h index ce798d560e75..605c08d10d50 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_debug.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_debug.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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,15 +64,11 @@ 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) #define RTW_DBGDUMP 0 /* 'stream' for _dbgdump */ -/* don't use these 3 APIs anymore, will be removed later */ -#define RT_TRACE(_Comp, _Level, Fmt) do {} while (0) #undef _dbgdump @@ -84,18 +76,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 +150,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 +176,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 +185,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 +193,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 +201,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) @@ -303,31 +238,12 @@ extern uint rtw_drv_log_level; } while (0) /* dump message to selected 'stream' */ -#undef _RTW_DUMP_SEL -#define _RTW_DUMP_SEL(sel, _HexData, _HexDataLen) \ - do {\ - if (sel == RTW_DBGDUMP) {\ - int __i; \ - u8 *ptr = (u8 *)_HexData; \ - 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"); \ - } \ - else {\ - int __i; \ - u8 *ptr = (u8 *)_HexData; \ - for (__i = 0; __i < (int)_HexDataLen; __i++) { \ - _seqdump(sel, "%02X%s", ptr[__i], (((__i + 1) % 4) == 0) ? " " : " "); \ - if (((__i + 1) % 16) == 0) \ - _seqdump(sel, "\n"); \ - } \ - _seqdump(sel, "\n"); \ - } \ - } while (0) +#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) */ @@ -351,12 +267,7 @@ 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); @@ -396,15 +307,16 @@ int proc_get_rf_info(struct seq_file *m, void *v); int proc_get_scan_param(struct seq_file *m, void *v); ssize_t proc_set_scan_param(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); int proc_get_scan_abort(struct seq_file *m, void *v); -#ifdef CONFIG_SCAN_BACKOP -int proc_get_backop_flags_sta(struct seq_file *m, void *v); -ssize_t proc_set_backop_flags_sta(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -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); +#ifdef ROKU_PRIVATE +int proc_get_infra_ap(struct seq_file *m, void *v); +#endif /* ROKU_PRIVATE */ 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); @@ -418,19 +330,31 @@ 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 -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); +#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_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); +#ifdef CONFIG_AP_MODE +u16 rtw_ap_linking_test_force_auth_fail(void); +u16 rtw_ap_linking_test_force_asoc_fail(void); +ssize_t proc_set_ap_linking_test(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +#endif int proc_get_rx_stat(struct seq_file *m, void *v); int proc_get_tx_stat(struct seq_file *m, void *v); @@ -449,10 +373,15 @@ ssize_t proc_set_best_channel(struct file *file, const char __user *buffer, size int proc_get_trx_info_debug(struct seq_file *m, void *v); +#ifdef CONFIG_HUAWEI_PROC +int proc_get_huawei_trx_info(struct seq_file *m, void *v); +#endif + int proc_get_rx_signal(struct seq_file *m, void *v); ssize_t proc_set_rx_signal(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); int proc_get_hw_status(struct seq_file *m, void *v); ssize_t proc_set_hw_status(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); #ifdef CONFIG_80211N_HT int proc_get_ht_enable(struct seq_file *m, void *v); @@ -464,8 +393,7 @@ 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); @@ -486,6 +414,9 @@ ssize_t proc_set_txbf_cap(struct file *file, const char __user *buffer, size_t c 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); @@ -513,6 +444,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) @@ -532,12 +467,27 @@ 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); +int proc_get_pci_conf_space(struct seq_file *m, void *v); +ssize_t proc_set_pci_conf_space(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); + +int proc_get_pci_bridge_conf_space(struct seq_file *m, void *v); +ssize_t proc_set_pci_bridge_conf_space(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); + + +#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 @@ -556,15 +506,26 @@ 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); +ssize_t proc_set_ps_info(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +#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); @@ -584,9 +545,18 @@ int proc_get_tx_auth(struct seq_file *m, void *v); int proc_get_efuse_map(struct seq_file *m, void *v); ssize_t proc_set_efuse_map(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +#ifdef CONFIG_CUSTOMER01_SMART_ANTENNA +int proc_get_pathb_phase(struct seq_file *m, void *v); +ssize_t proc_set_pathb_phase(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +#endif + #ifdef CONFIG_MCC_MODE int proc_get_mcc_info(struct seq_file *m, void *v); ssize_t proc_set_mcc_enable(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +ssize_t proc_set_mcc_duration(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +#ifdef CONFIG_MCC_PHYDM_OFFLOAD +ssize_t proc_set_mcc_phydm_offload_enable(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +#endif ssize_t proc_set_mcc_single_tx_criteria(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ssize_t proc_set_mcc_ap_bw20_target_tp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ssize_t proc_set_mcc_ap_bw40_target_tp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); @@ -595,12 +565,44 @@ ssize_t proc_set_mcc_sta_bw20_target_tp(struct file *file, const char __user *bu 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_fw_offload(struct seq_file *m, void *v); +ssize_t proc_set_fw_offload(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); + +#ifdef CONFIG_FW_HANDLE_TXBCN +ssize_t proc_set_fw_tbtt_rpt(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +int proc_get_fw_tbtt_rpt(struct seq_file *m, void *v); +#endif + +#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*/ + +#ifdef CONFIG_CTRL_TXSS_BY_TP +ssize_t proc_set_txss_tp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +int proc_get_txss_tp(struct seq_file *m, void *v); +#ifdef DBG_CTRL_TXSS +ssize_t proc_set_txss_ctrl(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +int proc_get_txss_ctrl(struct seq_file *m, void *v); +#endif +#endif + +#ifdef CONFIG_LPS_CHK_BY_TP +ssize_t proc_set_lps_chk_tp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +int proc_get_lps_chk_tp(struct seq_file *m, void *v); +#endif + +#ifdef CONFIG_SUPPORT_STATIC_SMPS +ssize_t proc_set_smps(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +int proc_get_smps(struct seq_file *m, void *v); +#endif #define _drv_always_ 1 #define _drv_emerg_ 2 diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_eeprom.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_eeprom.h index 1d10c20e6a72..02c160dc114d 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_eeprom.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_eeprom.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_efuse.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_efuse.h index 3b1457358f35..27928c0c6633 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_efuse.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_efuse.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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,8 +48,10 @@ 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*/ +/*RTL8822B 8821C BT EFUSE Define 1 BANK 128 size logical map 1024*/ #ifdef RTW_HALMAC #define BANK_NUM 1 #define EFUSE_BT_REAL_BANK_CONTENT_LEN 128 @@ -178,6 +176,12 @@ 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 +#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); @@ -198,6 +202,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); @@ -208,8 +214,12 @@ 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( +BOOLEAN rtw_file_efuse_IsMasked(PADAPTER pAdapter, u16 Offset); +BOOLEAN efuse_IsMasked(PADAPTER pAdapter, u16 Offset); + +void hal_ReadEFuse_BT_logic_map( PADAPTER padapter, u16 _offset, u16 _size_byte, @@ -223,6 +233,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/rtl8188eu/include/rtw_event.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_event.h index 4516e5c81579..4d2220323f11 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_event.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_event.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/rtw_ht.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_ht.h index 8ae15edc59fa..8b1536b5430c 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_ht.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_ht.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,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_HT_H_ #define _RTW_HT_H_ +#define HT_CAP_IE_LEN 26 +#define HT_OP_IE_LEN 22 struct ht_priv { u8 ht_option; @@ -47,10 +45,28 @@ struct ht_priv { u8 beamform_cap; u8 smps_cap; /*spatial multiplexing power save mode. 0:static SMPS, 1:dynamic SMPS, 3:SMPS disabled, 2:reserved*/ + u8 op_present:1; /* ht_op is present */ + struct rtw_ieee80211_ht_cap ht_cap; + u8 ht_op[HT_OP_IE_LEN]; }; +#ifdef ROKU_PRIVATE +struct ht_priv_infra_ap { + + /*Infra mode, only store AP's info , not intersection of STA and AP*/ + u8 channel_width_infra_ap; + u8 sgi_20m_infra_ap; + u8 sgi_40m_infra_ap; + u8 ldpc_cap_infra_ap; + u8 stbc_cap_infra_ap; + u8 MCS_set_infra_ap[16]; + u8 Rx_ss_infra_ap; + u16 rx_highest_data_rate_infra_ap; +}; +#endif /* ROKU_PRIVATE */ + typedef enum AGGRE_SIZE { HT_AGG_SIZE_8K = 0, HT_AGG_SIZE_16K = 1, @@ -62,23 +78,6 @@ typedef enum AGGRE_SIZE { VHT_AGG_SIZE_1024K = 7, } AGGRE_SIZE_E, *PAGGRE_SIZE_E; -typedef enum _RT_HT_INF0_CAP { - RT_HT_CAP_USE_TURBO_AGGR = 0x01, - RT_HT_CAP_USE_LONG_PREAMBLE = 0x02, - RT_HT_CAP_USE_AMPDU = 0x04, - RT_HT_CAP_USE_WOW = 0x8, - RT_HT_CAP_USE_SOFTAP = 0x10, - RT_HT_CAP_USE_92SE = 0x20, - RT_HT_CAP_USE_88C_92C = 0x40, - RT_HT_CAP_USE_AP_CLIENT_MODE = 0x80, /* AP team request to reserve this bit, by Emily */ -} RT_HT_INF0_CAPBILITY, *PRT_HT_INF0_CAPBILITY; - -typedef enum _RT_HT_INF1_CAP { - RT_HT_CAP_USE_VIDEO_CLIENT = 0x01, - RT_HT_CAP_USE_JAGUAR_BCUT = 0x02, - RT_HT_CAP_USE_JAGUAR_CCUT = 0x04, -} RT_HT_INF1_CAPBILITY, *PRT_HT_INF1_CAPBILITY; - #define LDPC_HT_ENABLE_RX BIT0 #define LDPC_HT_ENABLE_TX BIT1 #define LDPC_HT_TEST_TX_ENABLE BIT2 @@ -89,12 +88,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 * ------------------------------------------------------------ */ @@ -149,6 +142,9 @@ typedef enum _RT_HT_INF1_CAP { , (1 << (13+GET_HT_CAP_ELE_MAX_AMPDU_LEN_EXP(((u8 *)x)-2)))-1 \ , GET_HT_CAP_ELE_MIN_MPDU_S_SPACE(((u8 *)x)-2) +#define SET_HT_CAP_ELE_MAX_AMPDU_LEN_EXP(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 2, 0, 2, _val) +#define SET_HT_CAP_ELE_MIN_MPDU_S_SPACE(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart)) + 2, 2, 3, _val) + /* Supported MCS Set field */ #define HT_CAP_ELE_SUP_MCS_SET(_pEleStart) (((u8 *)(_pEleStart))+3) #define HT_CAP_ELE_RX_MCS_MAP(_pEleStart) HT_CAP_ELE_SUP_MCS_SET(_pEleStart) @@ -158,11 +154,14 @@ typedef enum _RT_HT_INF1_CAP { #define GET_HT_CAP_ELE_TX_MAX_SS(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+15, 2, 2) #define GET_HT_CAP_ELE_TX_UEQM(_pEleStart) LE_BITS_TO_1BYTE(((u8 *)(_pEleStart))+15, 4, 1) -#define HT_SUP_MCS_SET_FMT "%02x %02x %02x %02x %02x%02x%02x%02x%02x%02x" \ +#define HT_RX_MCS_BMP_FMT "%02x %02x %02x %02x %02x%02x%02x%02x%02x%02x" +#define HT_RX_MCS_BMP_ARG(x) ((u8 *)(x))[0], ((u8 *)(x))[1], ((u8 *)(x))[2], ((u8 *)(x))[3], ((u8 *)(x))[4], ((u8 *)(x))[5], \ + ((u8 *)(x))[6], ((u8 *)(x))[7], ((u8 *)(x))[8], ((u8 *)(x))[9] + +#define HT_SUP_MCS_SET_FMT HT_RX_MCS_BMP_FMT \ /* "\n%02x%02x%02x%02x%02x%02x" */\ " %uMbps %s%s%s" -#define HT_SUP_MCS_SET_ARG(x) ((u8 *)(x))[0], ((u8 *)(x))[1], ((u8 *)(x))[2], ((u8 *)(x))[3], ((u8 *)(x))[4], ((u8 *)(x))[5], \ - ((u8 *)(x))[6], ((u8 *)(x))[7], ((u8 *)(x))[8], ((u8 *)(x))[9] \ +#define HT_SUP_MCS_SET_ARG(x) HT_RX_MCS_BMP_ARG(x) \ /*,((u8 *)(x))[10], ((u8 *)(x))[11], ((u8 *)(x))[12], ((u8 *)(x))[13], ((u8 *)(x))[14], ((u8 *)(x))[15] */\ , GET_HT_CAP_ELE_RX_HIGHEST_DATA_RATE(((u8 *)x)-3) \ , GET_HT_CAP_ELE_TX_MCS_DEF(((u8 *)x)-3) ? "TX_MCS_DEF " : "" \ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_io.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_io.h index 44a17491af5d..bdd8277816a2 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_io.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_io.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTW_IO_H_ #define _RTW_IO_H_ #define NUM_IOREQ 8 -#ifdef PLATFORM_WINDOWS - #define MAX_PROT_SZ 64 -#endif #ifdef PLATFORM_LINUX #define MAX_PROT_SZ (64-16) #endif @@ -145,54 +138,14 @@ struct io_req { u32 status; u8 *pbuf; _sema sema; - -#ifdef PLATFORM_OS_CE -#ifdef CONFIG_USB_HCI - /* URB handler for rtw_write_mem */ - USB_TRANSFER usb_transfer_write_mem; -#endif -#endif - void (*_async_io_callback)(_adapter *padater, struct io_req *pio_req, u8 *cnxt); u8 *cnxt; - -#ifdef PLATFORM_OS_XP - PMDL pmdl; - PIRP pirp; - -#ifdef CONFIG_SDIO_HCI - PSDBUS_REQUEST_PACKET sdrp; -#endif - -#endif - - }; struct intf_hdl { - -#if 0 - u32 intf_option; - u32 bus_status; - u32 do_flush; - u8 *adapter; - u8 *intf_dev; - struct intf_priv *pintfpriv; - u8 cnt; - void (*intf_hdl_init)(u8 *priv); - void (*intf_hdl_unload)(u8 *priv); - void (*intf_hdl_open)(u8 *priv); - void (*intf_hdl_close)(u8 *priv); - struct _io_ops io_ops; - /* u8 intf_status;//moved to struct intf_priv */ - u16 len; - u16 done_len; -#endif _adapter *padapter; struct dvobj_priv *pintf_dev;/* pointer to &(padapter->dvobjpriv); */ - struct _io_ops io_ops; - }; struct reg_protocol_rd { @@ -400,10 +353,10 @@ u32 _rtw_write_port_and_wait(_adapter *adapter, u32 addr, u32 cnt, u8 *pmem, int extern void _rtw_write_port_cancel(_adapter *adapter); #ifdef DBG_IO -bool match_read_sniff_ranges(u32 addr, u16 len); -bool match_write_sniff_ranges(u32 addr, u16 len); -bool match_rf_read_sniff_ranges(u8 path, u32 addr, u32 mask); -bool match_rf_write_sniff_ranges(u8 path, u32 addr, u32 mask); +u32 match_read_sniff(_adapter *adapter, u32 addr, u16 len, u32 val); +u32 match_write_sniff(_adapter *adapter, u32 addr, u16 len, u32 val); +bool match_rf_read_sniff_ranges(_adapter *adapter, u8 path, u32 addr, u32 mask); +bool match_rf_write_sniff_ranges(_adapter *adapter, u8 path, u32 addr, u32 mask); extern u8 dbg_rtw_read8(_adapter *adapter, u32 addr, const char *caller, const int line); extern u16 dbg_rtw_read16(_adapter *adapter, u32 addr, const char *caller, const int line); @@ -460,10 +413,6 @@ int dbg_rtw_sd_iwrite32(_adapter *adapter, u32 addr, u32 val, const char *caller #endif /* CONFIG_SDIO_HCI */ #else /* DBG_IO */ -#define match_read_sniff_ranges(addr, len) _FALSE -#define match_write_sniff_ranges(addr, len) _FALSE -#define match_rf_read_sniff_ranges(path, addr, mask) _FALSE -#define match_rf_write_sniff_ranges(path, addr, mask) _FALSE #define rtw_read8(adapter, addr) _rtw_read8((adapter), (addr)) #define rtw_read16(adapter, addr) _rtw_read16((adapter), (addr)) #define rtw_read32(adapter, addr) _rtw_read32((adapter), (addr)) @@ -539,7 +488,6 @@ extern void free_io_queue(_adapter *adapter); extern void async_bus_io(struct io_queue *pio_q); extern void bus_sync_io(struct io_queue *pio_q); extern u32 _ioreq2rwmem(struct io_queue *pio_q); -extern void dev_power_down(_adapter *Adapter, u8 bpwrup); /* #define RTL_R8(reg) rtw_read8(padapter, reg) diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_ioctl.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_ioctl.h index ddef85438d73..c184da8532b4 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_ioctl.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_ioctl.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,131 +12,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 _RTW_IOCTL_H_ #define _RTW_IOCTL_H_ -#ifndef PLATFORM_WINDOWS -/* 00 - Success -* 11 - Error */ -#define STATUS_SUCCESS (0x00000000L) -#define STATUS_PENDING (0x00000103L) - -#define STATUS_UNSUCCESSFUL (0xC0000001L) -#define STATUS_INSUFFICIENT_RESOURCES (0xC000009AL) -#define STATUS_NOT_SUPPORTED (0xC00000BBL) - -#define NDIS_STATUS_SUCCESS ((NDIS_STATUS)STATUS_SUCCESS) -#define NDIS_STATUS_PENDING ((NDIS_STATUS)STATUS_PENDING) -#define NDIS_STATUS_NOT_RECOGNIZED ((NDIS_STATUS)0x00010001L) -#define NDIS_STATUS_NOT_COPIED ((NDIS_STATUS)0x00010002L) -#define NDIS_STATUS_NOT_ACCEPTED ((NDIS_STATUS)0x00010003L) -#define NDIS_STATUS_CALL_ACTIVE ((NDIS_STATUS)0x00010007L) - -#define NDIS_STATUS_FAILURE ((NDIS_STATUS)STATUS_UNSUCCESSFUL) -#define NDIS_STATUS_RESOURCES ((NDIS_STATUS)STATUS_INSUFFICIENT_RESOURCES) -#define NDIS_STATUS_CLOSING ((NDIS_STATUS)0xC0010002L) -#define NDIS_STATUS_BAD_VERSION ((NDIS_STATUS)0xC0010004L) -#define NDIS_STATUS_BAD_CHARACTERISTICS ((NDIS_STATUS)0xC0010005L) -#define NDIS_STATUS_ADAPTER_NOT_FOUND ((NDIS_STATUS)0xC0010006L) -#define NDIS_STATUS_OPEN_FAILED ((NDIS_STATUS)0xC0010007L) -#define NDIS_STATUS_DEVICE_FAILED ((NDIS_STATUS)0xC0010008L) -#define NDIS_STATUS_MULTICAST_FULL ((NDIS_STATUS)0xC0010009L) -#define NDIS_STATUS_MULTICAST_EXISTS ((NDIS_STATUS)0xC001000AL) -#define NDIS_STATUS_MULTICAST_NOT_FOUND ((NDIS_STATUS)0xC001000BL) -#define NDIS_STATUS_REQUEST_ABORTED ((NDIS_STATUS)0xC001000CL) -#define NDIS_STATUS_RESET_IN_PROGRESS ((NDIS_STATUS)0xC001000DL) -#define NDIS_STATUS_CLOSING_INDICATING ((NDIS_STATUS)0xC001000EL) -#define NDIS_STATUS_NOT_SUPPORTED ((NDIS_STATUS)STATUS_NOT_SUPPORTED) -#define NDIS_STATUS_INVALID_PACKET ((NDIS_STATUS)0xC001000FL) -#define NDIS_STATUS_OPEN_LIST_FULL ((NDIS_STATUS)0xC0010010L) -#define NDIS_STATUS_ADAPTER_NOT_READY ((NDIS_STATUS)0xC0010011L) -#define NDIS_STATUS_ADAPTER_NOT_OPEN ((NDIS_STATUS)0xC0010012L) -#define NDIS_STATUS_NOT_INDICATING ((NDIS_STATUS)0xC0010013L) -#define NDIS_STATUS_INVALID_LENGTH ((NDIS_STATUS)0xC0010014L) -#define NDIS_STATUS_INVALID_DATA ((NDIS_STATUS)0xC0010015L) -#define NDIS_STATUS_BUFFER_TOO_SHORT ((NDIS_STATUS)0xC0010016L) -#define NDIS_STATUS_INVALID_OID ((NDIS_STATUS)0xC0010017L) -#define NDIS_STATUS_ADAPTER_REMOVED ((NDIS_STATUS)0xC0010018L) -#define NDIS_STATUS_UNSUPPORTED_MEDIA ((NDIS_STATUS)0xC0010019L) -#define NDIS_STATUS_GROUP_ADDRESS_IN_USE ((NDIS_STATUS)0xC001001AL) -#define NDIS_STATUS_FILE_NOT_FOUND ((NDIS_STATUS)0xC001001BL) -#define NDIS_STATUS_ERROR_READING_FILE ((NDIS_STATUS)0xC001001CL) -#define NDIS_STATUS_ALREADY_MAPPED ((NDIS_STATUS)0xC001001DL) -#define NDIS_STATUS_RESOURCE_CONFLICT ((NDIS_STATUS)0xC001001EL) -#define NDIS_STATUS_NO_CABLE ((NDIS_STATUS)0xC001001FL) - -#define NDIS_STATUS_INVALID_SAP ((NDIS_STATUS)0xC0010020L) -#define NDIS_STATUS_SAP_IN_USE ((NDIS_STATUS)0xC0010021L) -#define NDIS_STATUS_INVALID_ADDRESS ((NDIS_STATUS)0xC0010022L) -#define NDIS_STATUS_VC_NOT_ACTIVATED ((NDIS_STATUS)0xC0010023L) -#define NDIS_STATUS_DEST_OUT_OF_ORDER ((NDIS_STATUS)0xC0010024L) /* cause 27 */ -#define NDIS_STATUS_VC_NOT_AVAILABLE ((NDIS_STATUS)0xC0010025L) /* cause 35, 45 */ -#define NDIS_STATUS_CELLRATE_NOT_AVAILABLE ((NDIS_STATUS)0xC0010026L) /* cause 37 */ -#define NDIS_STATUS_INCOMPATABLE_QOS ((NDIS_STATUS)0xC0010027L) /* cause 49 */ -#define NDIS_STATUS_AAL_PARAMS_UNSUPPORTED ((NDIS_STATUS)0xC0010028L) /* cause 93 */ -#define NDIS_STATUS_NO_ROUTE_TO_DESTINATION ((NDIS_STATUS)0xC0010029L) /* cause 3 */ -#endif /* #ifndef PLATFORM_WINDOWS */ - - -#ifndef OID_802_11_CAPABILITY - #define OID_802_11_CAPABILITY 0x0d010122 -#endif - -#ifndef OID_802_11_PMKID - #define OID_802_11_PMKID 0x0d010123 -#endif - - -/* For DDK-defined OIDs */ -#define OID_NDIS_SEG1 0x00010100 -#define OID_NDIS_SEG2 0x00010200 -#define OID_NDIS_SEG3 0x00020100 -#define OID_NDIS_SEG4 0x01010100 -#define OID_NDIS_SEG5 0x01020100 -#define OID_NDIS_SEG6 0x01020200 -#define OID_NDIS_SEG7 0xFD010100 -#define OID_NDIS_SEG8 0x0D010100 -#define OID_NDIS_SEG9 0x0D010200 -#define OID_NDIS_SEG10 0x0D020200 - -#define SZ_OID_NDIS_SEG1 23 -#define SZ_OID_NDIS_SEG2 3 -#define SZ_OID_NDIS_SEG3 6 -#define SZ_OID_NDIS_SEG4 6 -#define SZ_OID_NDIS_SEG5 4 -#define SZ_OID_NDIS_SEG6 8 -#define SZ_OID_NDIS_SEG7 7 -#define SZ_OID_NDIS_SEG8 36 -#define SZ_OID_NDIS_SEG9 24 -#define SZ_OID_NDIS_SEG10 19 - -/* For Realtek-defined OIDs */ -#define OID_MP_SEG1 0xFF871100 -#define OID_MP_SEG2 0xFF818000 - -#define OID_MP_SEG3 0xFF818700 -#define OID_MP_SEG4 0xFF011100 - enum oid_type { QUERY_OID, SET_OID }; -struct oid_funs_node { - unsigned int oid_start; /* the starting number for OID */ - unsigned int oid_end; /* the ending number for OID */ - struct oid_obj_priv *node_array; - unsigned int array_sz; /* the size of node_array */ - int query_counter; /* count the number of query hits for this segment */ - int set_counter; /* count the number of set hits for this segment */ -}; - struct oid_par_priv { void *adapter_context; NDIS_OID oid; @@ -147,174 +32,14 @@ struct oid_par_priv { u32 dbg; }; -struct oid_obj_priv { - unsigned char dbg; /* 0: without OID debug message 1: with OID debug message */ - NDIS_STATUS(*oidfuns)(struct oid_par_priv *poid_par_priv); -}; - -#if (defined(CONFIG_MP_INCLUDED) && defined(_RTW_MP_IOCTL_C_)) || \ - (defined(PLATFORM_WINDOWS) && defined(_RTW_IOCTL_RTL_C_)) -static NDIS_STATUS oid_null_function(struct oid_par_priv *poid_par_priv) -{ - return NDIS_STATUS_SUCCESS; -} -#endif - -#ifdef PLATFORM_WINDOWS - -int TranslateNdisPsToRtPs(IN NDIS_802_11_POWER_MODE ndisPsMode); - -/* OID Handler for Segment 1 */ -NDIS_STATUS oid_gen_supported_list_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_gen_hardware_status_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_gen_media_supported_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_gen_media_in_use_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_gen_maximum_lookahead_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_gen_maximum_frame_size_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_gen_link_speed_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_gen_transmit_buffer_space_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_gen_receive_buffer_space_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_gen_transmit_block_size_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_gen_receive_block_size_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_gen_vendor_id_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_gen_vendor_description_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_gen_current_packet_filter_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_gen_current_lookahead_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_gen_driver_version_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_gen_maximum_total_size_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_gen_protocol_options_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_gen_mac_options_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_gen_media_connect_status_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_gen_maximum_send_packets_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_gen_vendor_driver_version_hdl(struct oid_par_priv *poid_par_priv); - - -/* OID Handler for Segment 2 */ -NDIS_STATUS oid_gen_physical_medium_hdl(struct oid_par_priv *poid_par_priv); - -/* OID Handler for Segment 3 */ -NDIS_STATUS oid_gen_xmit_ok_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_gen_rcv_ok_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_gen_xmit_error_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_gen_rcv_error_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_gen_rcv_no_buffer_hdl(struct oid_par_priv *poid_par_priv); - - -/* OID Handler for Segment 4 */ -NDIS_STATUS oid_802_3_permanent_address_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_3_current_address_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_3_multicast_list_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_3_maximum_list_size_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_3_mac_options_hdl(struct oid_par_priv *poid_par_priv); - - - -/* OID Handler for Segment 5 */ -NDIS_STATUS oid_802_3_rcv_error_alignment_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_3_xmit_one_collision_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_3_xmit_more_collisions_hdl(struct oid_par_priv *poid_par_priv); - - -/* OID Handler for Segment 6 */ -NDIS_STATUS oid_802_3_xmit_deferred_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_3_xmit_max_collisions_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_3_rcv_overrun_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_3_xmit_underrun_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_3_xmit_heartbeat_failure_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_3_xmit_times_crs_lost_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_3_xmit_late_collisions_hdl(struct oid_par_priv *poid_par_priv); - - - -/* OID Handler for Segment 7 */ -NDIS_STATUS oid_pnp_capabilities_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_pnp_set_power_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_pnp_query_power_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_pnp_add_wake_up_pattern_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_pnp_remove_wake_up_pattern_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_pnp_wake_up_pattern_list_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_pnp_enable_wake_up_hdl(struct oid_par_priv *poid_par_priv); - - - -/* OID Handler for Segment 8 */ -NDIS_STATUS oid_802_11_bssid_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_11_ssid_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_11_infrastructure_mode_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_11_add_wep_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_11_remove_wep_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_11_disassociate_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_11_authentication_mode_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_11_privacy_filter_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_11_bssid_list_scan_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_11_encryption_status_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_11_reload_defaults_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_11_add_key_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_11_remove_key_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_11_association_information_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_11_test_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_11_media_stream_mode_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_11_capability_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_11_pmkid_hdl(struct oid_par_priv *poid_par_priv); - - - - - -/* OID Handler for Segment 9 */ -NDIS_STATUS oid_802_11_network_types_supported_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_11_network_type_in_use_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_11_tx_power_level_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_11_rssi_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_11_rssi_trigger_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_11_fragmentation_threshold_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_11_rts_threshold_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_11_number_of_antennas_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_11_rx_antenna_selected_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_11_tx_antenna_selected_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_11_supported_rates_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_11_desired_rates_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_11_configuration_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_11_power_mode_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_802_11_bssid_list_hdl(struct oid_par_priv *poid_par_priv); - - -/* OID Handler for Segment 10 */ -NDIS_STATUS oid_802_11_statistics_hdl(struct oid_par_priv *poid_par_priv); - - -/* OID Handler for Segment ED */ -NDIS_STATUS oid_rt_mh_vender_id_hdl(struct oid_par_priv *poid_par_priv); - -void Set_802_3_MULTICAST_LIST(ADAPTER *pAdapter, UCHAR *MCListbuf, ULONG MCListlen, BOOLEAN bAcceptAllMulticast); - -#endif/* end of PLATFORM_WINDOWS */ - #if defined(PLATFORM_LINUX) && defined(CONFIG_WIRELESS_EXT) extern struct iw_handler_def rtw_handlers_def; #endif extern void rtw_request_wps_pbc_event(_adapter *padapter); -extern NDIS_STATUS drv_query_info( - IN _nic_hdl MiniportAdapterContext, - IN NDIS_OID Oid, - IN void *InformationBuffer, - IN u32 InformationBufferLength, - OUT u32 *BytesWritten, - OUT u32 *BytesNeeded -); - -extern NDIS_STATUS drv_set_info( - IN _nic_hdl MiniportAdapterContext, - IN NDIS_OID Oid, - IN void *InformationBuffer, - IN u32 InformationBufferLength, - OUT u32 *BytesRead, - 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*); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_ioctl_query.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_ioctl_query.h index a74d13de2547..c5e4787d39cd 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_ioctl_query.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_ioctl_query.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,20 +12,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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTW_IOCTL_QUERY_H_ #define _RTW_IOCTL_QUERY_H_ -#ifdef PLATFORM_WINDOWS -u8 query_802_11_capability(_adapter *padapter, u8 *pucBuf, u32 *pulOutLen); -u8 query_802_11_association_information(_adapter *padapter, PNDIS_802_11_ASSOCIATION_INFORMATION pAssocInfo); -#endif - - #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_ioctl_rtl.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_ioctl_rtl.h deleted file mode 100644 index ddf798f18574..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_ioctl_rtl.h +++ /dev/null @@ -1,80 +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 _RTW_IOCTL_RTL_H_ -#define _RTW_IOCTL_RTL_H_ - - -/* ************** oid_rtl_seg_01_01 ************** */ -NDIS_STATUS oid_rt_get_signal_quality_hdl(struct oid_par_priv *poid_par_priv);/* 84 */ -NDIS_STATUS oid_rt_get_small_packet_crc_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_get_middle_packet_crc_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_get_large_packet_crc_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_get_tx_retry_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_get_rx_retry_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_get_rx_total_packet_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_get_tx_beacon_ok_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_get_tx_beacon_err_hdl(struct oid_par_priv *poid_par_priv); - -NDIS_STATUS oid_rt_pro_set_fw_dig_state_hdl(struct oid_par_priv *poid_par_priv); /* 8a */ -NDIS_STATUS oid_rt_pro_set_fw_ra_state_hdl(struct oid_par_priv *poid_par_priv); /* 8b */ - -NDIS_STATUS oid_rt_get_rx_icv_err_hdl(struct oid_par_priv *poid_par_priv);/* 93 */ -NDIS_STATUS oid_rt_set_encryption_algorithm_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_get_preamble_mode_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_get_ap_ip_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_get_channelplan_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_set_channelplan_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_set_preamble_mode_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_set_bcn_intvl_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_dedicate_probe_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_get_total_tx_bytes_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_get_total_rx_bytes_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_current_tx_power_level_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_get_enc_key_mismatch_count_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_get_enc_key_match_count_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_get_channel_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_get_hardware_radio_off_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_get_key_mismatch_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_supported_wireless_mode_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_get_channel_list_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_get_scan_in_progress_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_forced_data_rate_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_wireless_mode_for_scan_list_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_get_bss_wireless_mode_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_scan_with_magic_packet_hdl(struct oid_par_priv *poid_par_priv); - -/* ************** oid_rtl_seg_01_03 section start ************** */ -NDIS_STATUS oid_rt_ap_get_associated_station_list_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_ap_switch_into_ap_mode_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_ap_supported_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_ap_set_passphrase_hdl(struct oid_par_priv *poid_par_priv); - -/* oid_rtl_seg_01_11 */ -NDIS_STATUS oid_rt_pro_rf_write_registry_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_rf_read_registry_hdl(struct oid_par_priv *poid_par_priv); - -/* ************** oid_rtl_seg_03_00 section start ************** */ -NDIS_STATUS oid_rt_get_connect_state_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_set_default_key_id_hdl(struct oid_par_priv *poid_par_priv); - - - - -#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_ioctl_set.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_ioctl_set.h index 1f87214ca738..8a85df153e5f 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_ioctl_set.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_ioctl_set.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,57 +12,18 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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_ - -typedef u8 NDIS_802_11_PMKID_VALUE[16]; - -typedef struct _BSSIDInfo { - NDIS_802_11_MAC_ADDRESS BSSID; - NDIS_802_11_PMKID_VALUE PMKID; -} BSSIDInfo, *PBSSIDInfo; - - -#ifdef PLATFORM_OS_XP -typedef struct _NDIS_802_11_PMKID { - u32 Length; - u32 BSSIDInfoCount; - BSSIDInfo BSSIDInfo[1]; -} NDIS_802_11_PMKID, *PNDIS_802_11_PMKID; -#endif - - -#ifdef PLATFORM_WINDOWS -u8 rtw_set_802_11_reload_defaults(_adapter *padapter, NDIS_802_11_RELOAD_DEFAULTS reloadDefaults); -u8 rtw_set_802_11_test(_adapter *padapter, NDIS_802_11_TEST *test); -u8 rtw_set_802_11_pmkid(_adapter *pdapter, NDIS_802_11_PMKID *pmkid); - -u8 rtw_pnp_set_power_sleep(_adapter *padapter); -u8 rtw_pnp_set_power_wakeup(_adapter *padapter); - -void rtw_pnp_resume_wk(void *context); -void rtw_pnp_sleep_wk(void *context); - -#endif - -u8 rtw_set_802_11_add_key(_adapter *padapter, NDIS_802_11_KEY *key); u8 rtw_set_802_11_authentication_mode(_adapter *pdapter, NDIS_802_11_AUTHENTICATION_MODE authmode); 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); u8 rtw_set_802_11_connect(_adapter *padapter, u8 *bssid, NDIS_802_11_SSID *ssid); -u8 rtw_set_802_11_remove_key(_adapter *padapter, NDIS_802_11_REMOVE_KEY *key); u8 rtw_validate_bssid(u8 *bssid); u8 rtw_validate_ssid(NDIS_802_11_SSID *ssid); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_iol.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_iol.h index b68a525329b4..21e1af8a61ed 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_iol.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_iol.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/rtw_mcc.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_mcc.h index 8a85fb04ac5e..769c14468072 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_mcc.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_mcc.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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_ @@ -32,6 +29,7 @@ #define MCC_SWCH_FW_EARLY_TIME 10 /* ms */ #define MCC_EXPIRE_TIME 50 /* ms */ #define MCC_TOLERANCE_TIME 2 /* 2*2 = 4s */ +#define MCC_UPDATE_PARAMETER_THRESHOLD 5 /* ms */ #define MCC_ROLE_STA_GC_MGMT_QUEUE_MACID 0 #define MCC_ROLE_SOFTAP_GO_MGMT_QUEUE_MACID 1 @@ -57,9 +55,51 @@ #define MCC_SINGLE_TX_CRITERIA 5 /* Mbps */ #define MAX_MCC_NUM 2 +#define DBG_MCC_REG_NUM 4 +#define DBG_MCC_RF_REG_NUM 1 #define MCC_STOP(adapter) (adapter->mcc_adapterpriv.mcc_tx_stop) -#define MCC_EN(adapter) (adapter->registrypriv.en_mcc) +#define MCC_EN(adapter) (adapter_to_dvobj(adapter)->mcc_objpriv.en_mcc) +#define adapter_to_mccobjpriv(adapter) (&(adapter_to_dvobj(adapter)->mcc_objpriv)) +#define SET_MCC_EN_FLAG(adapter, flag)\ + do { \ + adapter_to_dvobj(adapter)->mcc_objpriv.en_mcc = (flag); \ + } while (0) +#define SET_MCC_DURATION(adapter, val)\ + do { \ + adapter_to_dvobj(adapter)->mcc_objpriv.duration = (val); \ + } while (0) +#define SET_MCC_RUNTIME_DURATION(adapter, flag)\ + do { \ + adapter_to_dvobj(adapter)->mcc_objpriv.enable_runtime_duration = (flag); \ + } while (0) + +#define SET_MCC_PHYDM_OFFLOAD(adapter, flag)\ + do { \ + adapter_to_dvobj(adapter)->mcc_objpriv.mcc_phydm_offload = (flag); \ + } while (0) + +#ifdef CONFIG_MCC_PHYDM_OFFLOAD +enum mcc_cfg_phydm_ops { + MCC_CFG_PHYDM_OFFLOAD = 0, + MCC_CFG_PHYDM_RF_CH, + MCC_CFG_PHYDM_ADD_CLIENT, + MCC_CFG_PHYDM_REMOVE_CLIENT, + MCC_CFG_PHYDM_START, + MCC_CFG_PHYDM_STOP, + MCC_CFG_PHYDM_DUMP, + MCC_CFG_PHYDM_MAX, +}; +#endif + +enum rtw_mcc_cmd_id { + MCC_CMD_WK_CID = 0, + MCC_SET_DURATION_WK_CID, + MCC_GET_DBG_REG_WK_CID, + #ifdef CONFIG_MCC_PHYDM_OFFLOAD + MCC_SET_PHYDM_OFFLOAD_WK_CID, + #endif +}; /* Represent Channel Tx Null setting */ enum mcc_channel_tx_null { @@ -88,10 +128,11 @@ enum mcc_status_rpt { MCC_RPT_READY = 3, MCC_RPT_SWICH_CHANNEL_NOTIFY = 7, MCC_RPT_UPDATE_NOA_START_TIME = 8, + MCC_RPT_TSF = 9, MCC_RPT_MAX, }; -enum MCC_ROLE { +enum mcc_role { MCC_ROLE_STA = 0, MCC_ROLE_AP = 1, MCC_ROLE_GC = 2, @@ -106,10 +147,21 @@ struct mcc_iqk_backup { u16 RX_Y; }; +enum mcc_duration_setting { + MCC_DURATION_MAPPING = 0, + MCC_DURATION_DIRECET = 1, +}; + +enum mcc_sched_mode { + MCC_FAIR_SCHEDULE = 0, + MCC_FAVOR_STA = 1, + MCC_FAVOR_P2P = 2, +}; + /* mcc data for adapter */ struct mcc_adapter_priv { u8 order; /* FW document, softap/AP must be 0 */ - u8 role; /* MCC role(AP,STA,GO,GC) */ + enum mcc_role role; /* MCC role(AP,STA,GO,GC) */ u8 mcc_duration; /* channel stay period, UNIT:1TU */ /* flow control */ @@ -138,10 +190,20 @@ struct mcc_adapter_priv { u8 p2p_go_noa_ie[MAX_P2P_IE_LEN]; u32 p2p_go_noa_ie_len; + u64 tsf; +#ifdef CONFIG_TDLS + u8 backup_tdls_en; +#endif /* CONFIG_TDLS */ + + u8 null_early; + u8 null_rty_num; }; struct mcc_obj_priv { - u8 duration; /* channel stay period, UNIT:1TU */ + u8 en_mcc; /* enable MCC or not */ + u8 duration; /* store duration(%) from registry, for primary adapter */ + u8 interval; + u8 start_time; u8 mcc_c2h_status; u8 cur_mcc_success_cnt; /* used for check mcc switch channel success */ u8 prev_mcc_success_cnt; /* used for check mcc switch channel success */ @@ -149,11 +211,31 @@ struct mcc_obj_priv { u8 mcc_loc_rsvd_paga[MAX_MCC_NUM]; /* mcc rsvd page */ u8 mcc_status; /* mcc status stop or start .... */ u8 policy_index; - u32 mcc_launch_time; /* mcc launch time, used for starting detect mcc switch channel success */ + u8 mcc_stop_threshold; + u8 current_order; + u8 last_tsfdiff; + 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 */ struct submit_ctx mcc_sctx; + struct submit_ctx mcc_tsf_req_sctx; + _mutex mcc_tsf_req_mutex; + u8 mcc_tsf_req_sctx_order; /* record current order for mcc_tsf_req_sctx */ +#ifdef CONFIG_MCC_MODE_V2 + u8 mcc_iqk_value_rsvd_page[3]; +#endif /* CONFIG_MCC_MODE_V2 */ + u8 mcc_pwr_idx_rsvd_page[MAX_MCC_NUM]; + u8 enable_runtime_duration; + /* for LG */ + u8 mchan_sched_mode; + + _mutex mcc_dbg_reg_mutex; + u32 dbg_reg[DBG_MCC_REG_NUM]; + u32 dbg_reg_val[DBG_MCC_REG_NUM]; + u32 dbg_rf_reg[DBG_MCC_RF_REG_NUM]; + u32 dbg_rf_reg_val[DBG_MCC_RF_REG_NUM][MAX_RF_PATH]; + u8 mcc_phydm_offload; }; /* backup IQK val */ @@ -170,7 +252,7 @@ void rtw_hal_clear_mcc_status(PADAPTER padapter, u8 mcc_status); /* dl mcc rsvd page */ 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 *total_page_num, RSVDPAGE_LOC *rsvd_page_loc, u8 *page_num); /* handle C2H */ void rtw_hal_mcc_c2h_handler(PADAPTER padapter, u8 buflen, u8 *tmpBuf); @@ -212,9 +294,19 @@ 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); +void rtw_hal_mcc_update_macid_bitmap(PADAPTER padapter, int mac_id, u8 add); + +void rtw_hal_mcc_process_noa(PADAPTER padapter); + +void rtw_hal_mcc_parameter_init(PADAPTER padapter); + +u8 rtw_mcc_cmd_hdl(PADAPTER adapter, u8 type, const u8 *val); + +u8 rtw_set_mcc_duration_cmd(_adapter *adapter, u8 type, u8 val); +#ifdef CONFIG_MCC_PHYDM_OFFLOAD +u8 rtw_set_mcc_phydm_offload_enable_cmd(PADAPTER adapter, u8 enable, u8 enqueue); +#endif /* CONFIG_MCC_PHYDM_OFFLOAD */ #endif /* _RTW_MCC_H_ */ #endif /* CONFIG_MCC_MODE */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_mem.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_mem.h index ae6049f1025e..2dcef922a038 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_mem.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_mem.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/rtw_mi.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_mi.h index 84bcc8c929bc..4864d1782e72 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_mi.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_mi.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,36 +12,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 __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_by_ifbmp(struct dvobj_priv *dvobj, u8 ifbmp, u8 *ch, u8 *bw, u8 *offset); 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 starting_ap_num; /*WIFI_FW_AP_STATE*/ + 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; #endif u8 mgmt_tx_num; #endif - +#ifdef CONFIG_P2P + u8 p2p_device_num; + u8 p2p_gc; + u8 p2p_go; +#endif u8 union_ch; u8 union_bw; u8 union_offset; @@ -49,10 +64,36 @@ 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_STARTING_NUM(_mstate) ((_mstate)->starting_ap_num) #define MSTATE_AP_LD_NUM(_mstate) ((_mstate)->ld_ap_num) +#else +#define MSTATE_AP_NUM(_mstate) 0 +#define MSTATE_AP_STARTING_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) @@ -61,6 +102,16 @@ struct mi_state { #define MSTATE_ROCH_NUM(_mstate) 0 #endif +#ifdef CONFIG_P2P +#define MSTATE_P2P_DV_NUM(_mstate) ((_mstate)->p2p_device_num) +#define MSTATE_P2P_GC_NUM(_mstate) ((_mstate)->p2p_gc) +#define MSTATE_P2P_GO_NUM(_mstate) ((_mstate)->p2p_go) +#else +#define MSTATE_P2P_DV_NUM(_mstate) 0 +#define MSTATE_P2P_GC_NUM(_mstate) 0 +#define MSTATE_P2P_GO_NUM(_mstate) 0 +#endif + #if defined(CONFIG_IOCTL_CFG80211) #define MSTATE_MGMT_TX_NUM(_mstate) ((_mstate)->mgmt_tx_num) #else @@ -77,28 +128,40 @@ 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)) +u8 rtw_mi_get_assoc_if_num(_adapter *adapter); /* For now, not return union_ch/bw/offset */ +void rtw_mi_status_by_ifbmp(struct dvobj_priv *dvobj, u8 ifbmp, struct mi_state *mstate); 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); -void rtw_mi_start_drv_threads(_adapter *adapter); -void rtw_mi_buddy_start_drv_threads(_adapter *adapter); +u32 rtw_mi_start_drv_threads(_adapter *adapter); +u32 rtw_mi_buddy_start_drv_threads(_adapter *adapter); void rtw_mi_stop_drv_threads(_adapter *adapter); void rtw_mi_buddy_stop_drv_threads(_adapter *adapter); void rtw_mi_cancel_all_timer(_adapter *adapter); @@ -113,6 +176,9 @@ void rtw_mi_buddy_intf_start(_adapter *adapter); void rtw_mi_intf_stop(_adapter *adapter); void rtw_mi_buddy_intf_stop(_adapter *adapter); +#ifdef CONFIG_NEW_NETDEV_HDL +u8 rtw_mi_hal_iface_init(_adapter *padapter); +#endif void rtw_mi_suspend_free_assoc_resource(_adapter *adapter); void rtw_mi_buddy_suspend_free_assoc_resource(_adapter *adapter); @@ -127,9 +193,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 +220,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, @@ -180,6 +245,8 @@ u8 rtw_mi_buddy_check_pending_xmitbuf(_adapter *padapter); #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) #ifdef CONFIG_RTL8822B #include +#elif defined(CONFIG_RTL8822C) + #include #else extern s32 _dequeue_writeport(PADAPTER padapter); #endif @@ -193,9 +260,6 @@ void rtw_mi_buddy_adapter_reset(_adapter *padapter); u8 rtw_mi_dynamic_check_timer_handlder(_adapter *padapter); u8 rtw_mi_buddy_dynamic_check_timer_handlder(_adapter *padapter); -u8 rtw_mi_dev_unload(_adapter *padapter); -u8 rtw_mi_buddy_dev_unload(_adapter *padapter); - extern void rtw_iface_dynamic_chk_wk_hdl(_adapter *padapter); u8 rtw_mi_dynamic_chk_wk_hdl(_adapter *padapter); u8 rtw_mi_buddy_dynamic_chk_wk_hdl(_adapter *padapter); @@ -225,7 +289,7 @@ u8 rtw_mi_buddy_stay_in_p2p_mode(_adapter *padapter); #endif _adapter *rtw_get_iface_by_id(_adapter *padapter, u8 iface_id); -_adapter *rtw_get_iface_by_macddr(_adapter *padapter, u8 *mac_addr); +_adapter *rtw_get_iface_by_macddr(_adapter *padapter, const u8 *mac_addr); _adapter *rtw_get_iface_by_hwport(_adapter *padapter, u8 hw_port); void rtw_mi_buddy_clone_bcmc_packet(_adapter *padapter, union recv_frame *precvframe, u8 *pphy_status); @@ -235,6 +299,8 @@ void rtw_mi_buddy_clone_bcmc_packet(_adapter *padapter, union recv_frame *precvf _adapter *rtw_mi_get_ap_adapter(_adapter *padapter); #endif +u8 rtw_mi_get_ld_sta_ifbmp(_adapter *adapter); +u8 rtw_mi_get_ap_mesh_ifbmp(_adapter *adapter); void rtw_mi_update_ap_bmc_camid(_adapter *padapter, u8 camid_a, u8 camid_b); #endif /*__RTW_MI_H_*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_mlme.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_mlme.h index 9290c14e576e..e9e053e599ee 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_mlme.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_mlme.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +25,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 +42,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 @@ -66,7 +57,7 @@ #define WIFI_MP_CTX_CCK_CS 0x00200000 /* in continuous tx with carrier suppression */ #define WIFI_MP_LPBK_STATE 0x00400000 #define WIFI_OP_CH_SWITCHING 0x00800000 -/*#define WIFI_UNDEFINED_STATE 0x01000000*/ +#define WIFI_UNDER_KEY_HANDSHAKE 0x01000000 /*#define WIFI_UNDEFINED_STATE 0x02000000*/ /*#define WIFI_UNDEFINED_STATE 0x04000000*/ /*#define WIFI_UNDEFINED_STATE 0x08000000*/ @@ -88,13 +79,16 @@ const char *get_miracast_mode_str(int mode); void rtw_wfd_st_switch(struct sta_info *sta, bool on); #define MLME_STATE(adapter) get_fwstate(&((adapter)->mlmepriv)) +#define CHK_MLME_STATE(adapter, state) check_fwstate(&((adapter)->mlmepriv), (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_MONITOR(adapter) (MLME_STATE((adapter)) & WIFI_MONITOR_STATE) -#define MLME_IS_MP(adapter) (MLME_STATE((adapter)) & WIFI_MP_STATE) +#define MLME_IS_NULL(adapter) CHK_MLME_STATE(adapter, WIFI_NULL_STATE) +#define MLME_IS_STA(adapter) CHK_MLME_STATE(adapter, WIFI_STATION_STATE) +#define MLME_IS_AP(adapter) CHK_MLME_STATE(adapter, WIFI_AP_STATE) +#define MLME_IS_ADHOC(adapter) CHK_MLME_STATE(adapter, WIFI_ADHOC_STATE) +#define MLME_IS_ADHOC_MASTER(adapter) CHK_MLME_STATE(adapter, WIFI_ADHOC_MASTER_STATE) +#define MLME_IS_MESH(adapter) CHK_MLME_STATE(adapter, WIFI_MESH_STATE) +#define MLME_IS_MONITOR(adapter) CHK_MLME_STATE(adapter, WIFI_MONITOR_STATE) +#define MLME_IS_MP(adapter) CHK_MLME_STATE(adapter, WIFI_MP_STATE) #ifdef CONFIG_P2P #define MLME_IS_PD(adapter) rtw_p2p_chk_role(&(adapter)->wdinfo, P2P_ROLE_DEVICE) #define MLME_IS_GC(adapter) rtw_p2p_chk_role(&(adapter)->wdinfo, P2P_ROLE_CLIENT) @@ -105,15 +99,21 @@ void rtw_wfd_st_switch(struct sta_info *sta, bool on); #define MLME_IS_GO(adapter) 0 #endif /* !CONFIG_P2P */ +#define MLME_IS_MSRC(adapter) rtw_chk_miracast_mode((adapter), MIRACAST_SOURCE) +#define MLME_IS_MSINK(adapter) rtw_chk_miracast_mode((adapter), MIRACAST_SINK) + +#define MLME_IS_SCAN(adapter) CHK_MLME_STATE(adapter, WIFI_SITE_MONITOR) +#define MLME_IS_LINKING(adapter) CHK_MLME_STATE(adapter, WIFI_UNDER_LINKING) +#define MLME_IS_ASOC(adapter) CHK_MLME_STATE(adapter, WIFI_ASOC_STATE) +#define MLME_IS_OPCH_SW(adapter) CHK_MLME_STATE(adapter, WIFI_OP_CH_SWITCHING) +#define MLME_IS_WPS(adapter) CHK_MLME_STATE(adapter, WIFI_UNDER_WPS) + #if defined(CONFIG_IOCTL_CFG80211) && defined(CONFIG_P2P) #define MLME_IS_ROCH(adapter) (rtw_cfg80211_get_is_roch(adapter) == _TRUE) #else #define MLME_IS_ROCH(adapter) 0 #endif -#define MLME_IS_MSRC(adapter) rtw_chk_miracast_mode((adapter), MIRACAST_SOURCE) -#define MLME_IS_MSINK(adapter) rtw_chk_miracast_mode((adapter), MIRACAST_SINK) - #ifdef CONFIG_IOCTL_CFG80211 #define MLME_IS_MGMT_TX(adapter) rtw_cfg80211_get_is_mgmt_tx(adapter) #else @@ -126,20 +126,42 @@ 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" : "", \ MLME_IS_MSRC((adapter)) ? " MSRC" : "", \ MLME_IS_MSINK((adapter)) ? " MSINK" : "", \ - (MLME_STATE((adapter)) & WIFI_SITE_MONITOR) ? " SCAN" : "", \ - (MLME_STATE((adapter)) & WIFI_UNDER_LINKING) ? " LINKING" : "", \ - (MLME_STATE((adapter)) & WIFI_ASOC_STATE) ? " ASOC" : "", \ - (MLME_STATE((adapter)) & WIFI_OP_CH_SWITCHING) ? " OP_CH_SW" : "", \ - (MLME_STATE((adapter)) & WIFI_UNDER_WPS) ? " WPS" : "", \ + MLME_IS_SCAN((adapter)) ? " SCAN" : "", \ + MLME_IS_LINKING((adapter)) ? " LINKING" : "", \ + MLME_IS_ASOC((adapter)) ? " ASOC" : "", \ + MLME_IS_OPCH_SW((adapter)) ? " OPCH_SW" : "", \ + MLME_IS_WPS((adapter)) ? " WPS" : "", \ MLME_IS_ROCH((adapter)) ? " ROCH" : "", \ 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, + MLME_OPCH_SWITCH, +}; + #define _FW_UNDER_LINKING WIFI_UNDER_LINKING #define _FW_LINKED WIFI_ASOC_STATE #define _FW_UNDER_SURVEY WIFI_SITE_MONITOR @@ -198,13 +220,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 +331,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 +401,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 +501,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 { @@ -520,12 +536,13 @@ struct beacon_keys { int encryp_protocol; int pairwise_cipher; int group_cipher; - int is_8021x; + u32 akm; }; #ifdef CONFIG_RTW_80211R -#define FT_ACTION_REQ_LIMIT 4 +#define RTW_FT_ACTION_REQ_LMT 4 +#define RTW_FT_MAX_IE_SZ 256 -typedef enum _RTW_WIFI_FT_STA_STATUS { +enum _rtw_ft_sta_status { RTW_FT_UNASSOCIATED_STA = 0, RTW_FT_AUTHENTICATING_STA, RTW_FT_AUTHENTICATED_STA, @@ -535,76 +552,221 @@ typedef enum _RTW_WIFI_FT_STA_STATUS { RTW_FT_REQUESTED_STA, RTW_FT_CONFIRMED_STA, RTW_FT_UNSPECIFIED_STA -} RTW_WIFI_FT_STA_STATUS; +}; -#define rtw_chk_ft_status(adapter, status) ((adapter)->mlmepriv.ftpriv.ft_status == status) -#define rtw_set_ft_status(adapter, status) \ +#define rtw_ft_chk_status(a, s) \ + ((a)->mlmepriv.ft_roam.ft_status == (s)) + +#define rtw_ft_roam_status(a, s) \ + ((rtw_to_roam(a) > 0) && rtw_ft_chk_status(a, s)) + +#define rtw_ft_authed_sta(a) \ + ((rtw_ft_chk_status(a, RTW_FT_AUTHENTICATED_STA)) || \ + (rtw_ft_chk_status(a, RTW_FT_ASSOCIATING_STA)) || \ + (rtw_ft_chk_status(a, RTW_FT_ASSOCIATED_STA))) + +#define rtw_ft_set_status(a, s) \ do { \ - ((adapter)->mlmepriv.ftpriv.ft_status = status); \ + ((a)->mlmepriv.ft_roam.ft_status = (s)); \ } while (0) -#define rtw_reset_ft_status(adapter) \ +#define rtw_ft_lock_set_status(a, s, irq) \ do { \ - ((adapter)->mlmepriv.ftpriv.ft_status = RTW_FT_UNASSOCIATED_STA); \ + _enter_critical_bh(&(a)->mlmepriv.lock, ((_irqL *)(irq))); \ + ((a)->mlmepriv.ft_roam.ft_status = (s)); \ + _exit_critical_bh(&(a)->mlmepriv.lock, ((_irqL *)(irq))); \ } while (0) -typedef enum _RTW_WIFI_FT_CAPABILITY { - RTW_FT_STA_SUPPORTED = BIT0, - RTW_FT_STA_OVER_DS_SUPPORTED = BIT1, - RTW_FT_SUPPORTED = BIT2, - RTW_FT_OVER_DS_SUPPORTED = BIT3, -} RTW_WIFI_FT_CAPABILITY; - -#define rtw_chk_ft_flags(adapter, flags) ((adapter)->mlmepriv.ftpriv.ft_flags & (flags)) -#define rtw_set_ft_flags(adapter, flags) \ +#define rtw_ft_reset_status(a) \ do { \ - ((adapter)->mlmepriv.ftpriv.ft_flags |= (flags)); \ + ((a)->mlmepriv.ft_roam.ft_status = RTW_FT_UNASSOCIATED_STA); \ } while (0) -#define rtw_clr_ft_flags(adapter, flags) \ +enum rtw_ft_capability { + RTW_FT_EN = BIT0, + RTW_FT_OTD_EN = BIT1, + RTW_FT_PEER_EN = BIT2, + RTW_FT_PEER_OTD_EN = BIT3, + RTW_FT_BTM_ROAM = BIT4, +}; + +#define rtw_ft_chk_flags(a, f) \ + ((a)->mlmepriv.ft_roam.ft_flags & (f)) + +#define rtw_ft_set_flags(a, f) \ do { \ - ((adapter)->mlmepriv.ftpriv.ft_flags &= ~(flags)); \ + ((a)->mlmepriv.ft_roam.ft_flags |= (f)); \ } while (0) -#define RTW_MAX_FTIE_SZ 256 -typedef struct _ft_priv { +#define rtw_ft_clr_flags(a, f) \ + do { \ + ((a)->mlmepriv.ft_roam.ft_flags &= ~(f)); \ + } while (0) + +#define rtw_ft_roam(a) \ + ((rtw_to_roam(a) > 0) && rtw_ft_chk_flags(a, RTW_FT_PEER_EN)) + +#define rtw_ft_valid_akm(a, t) \ + ((rtw_ft_chk_flags(a, RTW_FT_EN)) && \ + (((t) == 3) || ((t) == 4))) + +#define rtw_ft_roam_expired(a, r) \ + ((rtw_chk_roam_flags(a, RTW_ROAM_ON_EXPIRED)) \ + && (r == WLAN_REASON_ACTIVE_ROAM)) + +#define rtw_ft_otd_roam_en(a) \ + ((rtw_ft_chk_flags(a, RTW_FT_OTD_EN)) \ + && ((a)->mlmepriv.ft_roam.ft_roam_on_expired == _FALSE) \ + && ((a)->mlmepriv.ft_roam.ft_cap & 0x01)) + +#define rtw_ft_otd_roam(a) \ + rtw_ft_chk_flags(a, RTW_FT_PEER_OTD_EN) + +#define rtw_ft_valid_otd_candidate(a, p) \ + ((rtw_ft_chk_flags(a, RTW_FT_OTD_EN)) \ + && ((rtw_ft_chk_flags(a, RTW_FT_PEER_OTD_EN) \ + && ((*((p)+4) & 0x01) == 0)) \ + || ((rtw_ft_chk_flags(a, RTW_FT_PEER_OTD_EN) == 0) \ + && (*((p)+4) & 0x01)))) + +struct ft_roam_info { u16 mdid; - u8 ft_cap; /*b0: FT over DS, b1: Resource Req Protocol Cap, b2~b7: Reserved*/ - u8 updated_ft_ies[RTW_MAX_FTIE_SZ]; + u8 ft_cap; + /*b0: FT over DS, b1: Resource Req Protocol Cap, b2~b7: Reserved*/ + u8 updated_ft_ies[RTW_FT_MAX_IE_SZ]; u16 updated_ft_ies_len; - u8 ft_action[RTW_MAX_FTIE_SZ]; + u8 ft_action[RTW_FT_MAX_IE_SZ]; u16 ft_action_len; struct cfg80211_ft_event_params ft_event; u8 ft_roam_on_expired; u8 ft_flags; u32 ft_status; u32 ft_req_retry_cnt; -} ft_priv; + bool ft_updated_bcn; +}; +#endif + +#ifdef CONFIG_LAYER2_ROAMING +#if defined(CONFIG_RTW_WNM) || defined(CONFIG_RTW_80211K) +#define RTW_RRM_NB_RPT_EN BIT(1) +#define RTW_MAX_NB_RPT_NUM 8 + +#define rtw_roam_busy_scan(a, nb) \ + (((a)->mlmepriv.LinkDetectInfo.bBusyTraffic == _TRUE) && \ + (((a)->mlmepriv.ch_cnt) < ((nb)->nb_rpt_ch_list_num))) + +#define rtw_wnm_btm_preference_cap(a) \ + ((a)->mlmepriv.nb_info.preference_en == _TRUE) + +#define rtw_wnm_btm_diff_bss(a) \ + ((rtw_wnm_btm_preference_cap(a)) && \ + (is_zero_mac_addr((a)->mlmepriv.nb_info.roam_target_addr) == _FALSE) && \ + (_rtw_memcmp((a)->mlmepriv.nb_info.roam_target_addr,\ + (a)->mlmepriv.cur_network.network.MacAddress, ETH_ALEN) == _FALSE)) + +#define rtw_wnm_btm_roam_candidate(a, c) \ + ((rtw_wnm_btm_preference_cap(a)) && \ + (is_zero_mac_addr((a)->mlmepriv.nb_info.roam_target_addr) == _FALSE) && \ + (_rtw_memcmp((a)->mlmepriv.nb_info.roam_target_addr,\ + (c)->network.MacAddress, ETH_ALEN))) + +#define rtw_wnm_set_ext_cap_btm(_pEleStart, _val) \ + SET_BITS_TO_LE_1BYTE(((u8 *)(_pEleStart))+2, 3, 1, _val) + +#define wnm_btm_bss_term_inc(p) (*((u8 *)((p)+3)) & BSS_TERMINATION_INCLUDED) + +#define wnm_btm_ess_disassoc_im(p) (*((u8 *)((p)+3)) & ESS_DISASSOC_IMMINENT) + +#define wnm_btm_req_mode(p) (*((u8 *)((p)+3))) + +#define wnm_btm_disassoc_timer(p) (*((u16 *)((p)+4))) + +#define wnm_btm_valid_interval(p) (*((u8 *)((p)+6))) + +#define wnm_btm_term_duration_offset(p) ((p)+7) + +/*IEEE Std 80211k Figure 7-95b Neighbor Report element format*/ +struct nb_rpt_hdr { + u8 id; /*0x34: Neighbor Report Element ID*/ + u8 len; + u8 bssid[ETH_ALEN]; + u32 bss_info; + u8 reg_class; + u8 ch_num; + u8 phy_type; +}; + +/*IEEE Std 80211v, Figure 7-95e2¡XBSS Termination Duration subelement field format */ +struct btm_term_duration { + u8 id; + u8 len; + u64 tsf; + u16 duration; +}; + +/*IEEE Std 80211v, Figure 7-101n8¡XBSS Transition Management Request frame body format */ +struct btm_req_hdr { + u8 req_mode; + u16 disassoc_timer; + u8 validity_interval; + struct btm_term_duration term_duration; +}; + +/*IEEE Std 80211v, Table 7-43b Optional Subelement IDs for Neighbor Report*/ +/* BSS Transition Candidate Preference */ +#define WNM_BTM_CAND_PREF_SUBEID 0x03 + +/* BSS Termination Duration */ +#define WNM_BTM_TERM_DUR_SUBEID 0x04 + +struct wnm_btm_cant { + struct nb_rpt_hdr nb_rpt; + u8 preference; /* BSS Transition Candidate Preference */ +}; + +enum rtw_btm_req_mod { + PREFERRED_CANDIDATE_LIST_INCLUDED = BIT0, + ABRIDGED = BIT1, + DISASSOC_IMMINENT = BIT2, + BSS_TERMINATION_INCLUDED = BIT3, + ESS_DISASSOC_IMMINENT = BIT4, +}; + +struct roam_nb_info { + struct nb_rpt_hdr nb_rpt[RTW_MAX_NB_RPT_NUM]; + struct rtw_ieee80211_channel nb_rpt_ch_list[RTW_MAX_NB_RPT_NUM]; + bool nb_rpt_valid; + u8 nb_rpt_ch_list_num; + u8 preference_en; + u8 roam_target_addr[ETH_ALEN]; + u32 last_nb_rpt_entries; + bool nb_rpt_is_same; + _timer roam_scan_timer; +}; +#endif /* defined(CONFIG_RTW_WNM) || defined(CONFIG_RTW_80211K) */ #endif struct mlme_priv { _lock lock; sint fw_state; /* shall we protect this variable? maybe not necessarily... */ - u8 bScanInProcess; u8 to_join; /* flag */ + u16 join_status; #ifdef CONFIG_LAYER2_ROAMING u8 to_roam; /* roaming trying times */ struct wlan_network *roam_network; /* the target of active roam */ u8 roam_flags; u8 roam_rssi_diff_th; /* rssi difference threshold for active scan candidate selection */ - u32 roam_scan_int_ms; /* scan interval for active roam */ + u32 roam_scan_int; /* scan interval for active roam (Unit:2 second)*/ u32 roam_scanr_exp_ms; /* scan result expire time in ms for roam */ u8 roam_tgt_addr[ETH_ALEN]; /* request to roam to speicific target without other consideration */ u8 roam_rssi_threshold; + systime last_roaming; bool need_to_roam; #endif u8 *nic_hdl; - -#ifdef SUPPLICANT_RTK_VERSION_LOWER_THAN_JB42 - u8 not_indic_disco; -#endif + u32 max_bss_cnt; /* The size of scan queue */ _list *pscanned; _queue free_bss_pool; _queue scanned_queue; @@ -619,14 +781,16 @@ struct mlme_priv { /* bcn check info */ struct beacon_keys cur_beacon_keys; /* save current beacon keys */ +#ifdef CONFIG_BCN_CNT_CONFIRM_HDL struct beacon_keys new_beacon_keys; /* save new beacon keys */ u8 new_beacon_cnts; /* if new_beacon_cnts >= threshold, ap beacon is changed */ +#endif #ifdef CONFIG_ARP_KEEP_ALIVE /* for arp offload keep alive */ u8 bGetGateway; u8 GetGatewayTryCnt; - u8 gw_mac_addr[6]; + u8 gw_mac_addr[ETH_ALEN]; u8 gw_ip[4]; #endif @@ -640,12 +804,13 @@ 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; ATOMIC_T set_scan_deny; /* 0: allowed, 1: deny */ #endif + u8 wpa_phase;/*wpa_phase after wps finished*/ struct qos_priv qospriv; @@ -666,31 +831,27 @@ struct mlme_priv { #ifdef CONFIG_80211AC_VHT struct vht_priv vhtpriv; -#endif -#ifdef CONFIG_BEAMFORMING -#ifndef RTW_BEAMFORMING_VERSION_2 -#if (BEAMFORMING_SUPPORT == 0)/*for driver beamforming*/ - struct beamforming_info beamforming_info; -#endif -#endif /* !RTW_BEAMFORMING_VERSION_2 */ +#ifdef ROKU_PRIVATE + /*infra mode, used to store AP's info*/ + struct vht_priv_infra_ap vhtpriv_infra_ap; +#endif /* ROKU_PRIVATE */ #endif -#ifdef CONFIG_DFS - u8 handle_dfs; -#endif -#ifdef CONFIG_DFS_MASTER - /* TODO: move to rfctl */ - _timer dfs_master_timer; -#endif +#ifdef ROKU_PRIVATE + struct ht_priv_infra_ap htpriv_infra_ap; +#endif /* ROKU_PRIVATE */ + #ifdef CONFIG_RTW_80211R - ft_priv ftpriv; + struct ft_roam_info ft_roam; +#endif +#if defined(CONFIG_RTW_WNM) || defined(CONFIG_RTW_80211K) + struct roam_nb_info nb_info; + u8 ch_cnt; #endif 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; @@ -780,6 +941,9 @@ struct mlme_priv { u8 ori_ch; u8 ori_bw; u8 ori_offset; + #ifdef CONFIG_80211AC_VHT + u8 ori_vht_en; + #endif #endif /* #if defined (CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) */ #if defined(CONFIG_WFD) && defined(CONFIG_IOCTL_CFG80211) @@ -807,43 +971,11 @@ struct mlme_priv { _workitem Linkup_workitem; _workitem Linkdown_workitem; #endif - -#ifdef CONFIG_INTEL_WIDI - int widi_state; - int listen_state; - _timer listen_timer; - ATOMIC_T rx_probe_rsp; /* 1:receive probe respone from RDS source. */ - u8 *l2sdTaBuffer; - u8 channel_idx; - u8 group_cnt; /* In WiDi 3.5, they specified another scan algo. for WFD/RDS co-existed */ - u8 sa_ext[L2SDTA_SERVICE_VE_LEN]; - - u8 widi_enable; - /** - * For WiDi 4; upper layer would set - * p2p_primary_device_type_category_id - * p2p_primary_device_type_sub_category_id - * p2p_secondary_device_type_category_id - * p2p_secondary_device_type_sub_category_id - */ - u16 p2p_pdt_cid; - u16 p2p_pdt_scid; - u8 num_p2p_sdt; - u16 p2p_sdt_cid[MAX_NUM_P2P_SDT]; - u16 p2p_sdt_scid[MAX_NUM_P2P_SDT]; - 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 -#if 0 - u8 NumOfBcnInfoChkFail; - u32 timeBcnInfoChkStart; -#endif - #ifdef CONFIG_APPEND_VENDOR_IE_ENABLE u32 vendor_ie_mask[WLAN_MAX_VENDOR_IE_NUM]; u8 vendor_ie[WLAN_MAX_VENDOR_IE_NUM][WLAN_MAX_VENDOR_IE_LEN]; @@ -862,10 +994,11 @@ struct mlme_priv { adapter->mlmepriv.auto_scan_int_ms = ms; \ } while (0) -#define RTW_AUTO_SCAN_REASON_UNSPECIFIED 0 -#define RTW_AUTO_SCAN_REASON_2040_BSS BIT0 -#define RTW_AUTO_SCAN_REASON_ACS BIT1 -#define RTW_AUTO_SCAN_REASON_ROAM BIT2 +#define RTW_AUTO_SCAN_REASON_UNSPECIFIED 0 +#define RTW_AUTO_SCAN_REASON_2040_BSS BIT0 +#define RTW_AUTO_SCAN_REASON_ACS BIT1 +#define RTW_AUTO_SCAN_REASON_ROAM BIT2 +#define RTW_AUTO_SCAN_REASON_MESH_OFFCH_CAND BIT3 void rtw_mlme_reset_auto_scan_int(_adapter *adapter, u8 *reason); @@ -886,12 +1019,13 @@ extern void hostapd_mode_unload(_adapter *padapter); #endif -extern void rtw_joinbss_event_prehandle(_adapter *adapter, u8 *pbuf); +extern void rtw_joinbss_event_prehandle(_adapter *adapter, u8 *pbuf, u16 status); extern void rtw_survey_event_callback(_adapter *adapter, u8 *pbuf); 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); @@ -900,11 +1034,15 @@ extern void rtw_wmm_event_callback(PADAPTER padapter, u8 *pbuf); void rtw_sta_timeout_event_callback(_adapter *adapter, u8 *pbuf); #endif /* CONFIG_IEEE80211W */ #ifdef CONFIG_RTW_80211R -void rtw_update_ft_stainfo(_adapter *padapter, WLAN_BSSID_EX *pnetwork); +void rtw_ft_info_init(struct ft_roam_info *pft); +u8 rtw_ft_chk_roaming_candidate(_adapter *padapter, + struct wlan_network *competitor); +void rtw_ft_update_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); +#if defined(CONFIG_RTW_WNM) || defined(CONFIG_RTW_80211K) +void rtw_roam_nb_info_init(_adapter *padapter); +#endif thread_return event_thread(thread_context context); @@ -954,32 +1092,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); } @@ -1025,15 +1148,16 @@ __inline static void set_scanned_network_val(struct mlme_priv *pmlmepriv, sint v } extern u16 rtw_get_capability(WLAN_BSSID_EX *bss); -extern void rtw_update_scanned_network(_adapter *adapter, WLAN_BSSID_EX *target); +extern bool rtw_update_scanned_network(_adapter *adapter, WLAN_BSSID_EX *target); extern void rtw_disconnect_hdl_under_linked(_adapter *adapter, struct sta_info *psta, u8 free_assoc); extern void rtw_generate_random_ibss(u8 *pibss); -extern struct wlan_network *rtw_find_network(_queue *scanned_queue, u8 *addr); +struct wlan_network *_rtw_find_network(_queue *scanned_queue, const u8 *addr); +struct wlan_network *rtw_find_network(_queue *scanned_queue, const u8 *addr); extern struct wlan_network *rtw_get_oldest_wlan_network(_queue *scanned_queue); struct wlan_network *_rtw_find_same_network(_queue *scanned_queue, struct wlan_network *network); struct wlan_network *rtw_find_same_network(_queue *scanned_queue, struct wlan_network *network); -extern void rtw_free_assoc_resources(_adapter *adapter, int lock_scanned_queue); +extern void rtw_free_assoc_resources(_adapter *adapter, u8 lock_scanned_queue); extern void rtw_indicate_disconnect(_adapter *adapter, u16 reason, u8 locally_generated); extern void rtw_indicate_connect(_adapter *adapter); void rtw_indicate_scan_done(_adapter *padapter, bool aborted); @@ -1043,8 +1167,16 @@ void rtw_scan_wait_completed(_adapter *adapter); u32 rtw_scan_abort_timeout(_adapter *adapter, u32 timeout_ms); void rtw_scan_abort_no_wait(_adapter *adapter); void rtw_scan_abort(_adapter *adapter); +u32 rtw_join_abort_timeout(_adapter *adapter, u32 timeout_ms); -extern int rtw_restruct_sec_ie(_adapter *adapter, u8 *in_ie, u8 *out_ie, uint in_len); +int rtw_cached_pmkid(_adapter *Adapter, u8 *bssid); +int rtw_rsn_sync_pmkid(_adapter *adapter, u8 *ie, uint ie_len, int i_ent); + +extern int rtw_restruct_sec_ie(_adapter *adapter, u8 *out_ie); +#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 +1184,43 @@ 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); +enum { + SS_DENY_MP_MODE, + SS_DENY_RSON_SCANING, + SS_DENY_BLOCK_SCAN, + SS_DENY_BY_DRV, + SS_DENY_SELF_AP_UNDER_WPS, + SS_DENY_SELF_AP_UNDER_LINKING, + SS_DENY_SELF_AP_UNDER_SURVEY, + /*SS_DENY_SELF_STA_UNDER_WPS,*/ + SS_DENY_SELF_STA_UNDER_LINKING, + SS_DENY_SELF_STA_UNDER_SURVEY, + SS_DENY_BUDDY_UNDER_LINK_WPS, + SS_DENY_BUDDY_UNDER_SURVEY, + SS_DENY_BUSY_TRAFFIC, + SS_ALLOW, +#ifdef DBG_LA_MODE + SS_DENY_LA_MODE, +#endif +}; + +u8 _rtw_sitesurvey_condition_check(const char *caller, _adapter *adapter, bool check_sc_interval); +#define rtw_sitesurvey_condition_check(adapter, check_sc_interval) _rtw_sitesurvey_condition_check(__func__, adapter, check_sc_interval) + #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 @@ -1093,9 +1246,6 @@ extern struct wlan_network *_rtw_alloc_network(struct mlme_priv *pmlmepriv); extern void _rtw_free_network(struct mlme_priv *pmlmepriv, struct wlan_network *pnetwork, u8 isfreeall); extern void _rtw_free_network_nolock(struct mlme_priv *pmlmepriv, struct wlan_network *pnetwork); - -extern struct wlan_network *_rtw_find_network(_queue *scanned_queue, u8 *addr); - extern void _rtw_free_network_queue(_adapter *padapter, u8 isfreeall); extern sint rtw_if_up(_adapter *padapter); @@ -1169,12 +1319,41 @@ 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); -void rtw_proxim_disable(_adapter *padapter); -void rtw_proxim_send_packet(_adapter *padapter, u8 *pbuf, u16 len, u8 m_rate); -#endif /* CONFIG_INTEL_PROXIM */ +#define GET_ARP_HTYPE(_arp) BE_BITS_TO_2BYTE(((u8 *)(_arp)) + 0, 0, 16) +#define GET_ARP_PTYPE(_arp) BE_BITS_TO_2BYTE(((u8 *)(_arp)) + 2, 0, 16) +#define GET_ARP_HLEN(_arp) BE_BITS_TO_1BYTE(((u8 *)(_arp)) + 4, 0, 8) +#define GET_ARP_PLEN(_arp) BE_BITS_TO_1BYTE(((u8 *)(_arp)) + 5, 0, 8) +#define GET_ARP_OPER(_arp) BE_BITS_TO_2BYTE(((u8 *)(_arp)) + 6, 0, 16) + +#define SET_ARP_HTYPE(_arp, _val) SET_BITS_TO_BE_2BYTE(((u8 *)(_arp)) + 0, 0, 16, _val) +#define SET_ARP_PTYPE(_arp, _val) SET_BITS_TO_BE_2BYTE(((u8 *)(_arp)) + 2, 0, 16, _val) +#define SET_ARP_HLEN(_arp, _val) SET_BITS_TO_BE_1BYTE(((u8 *)(_arp)) + 4, 0, 8, _val) +#define SET_ARP_PLEN(_arp, _val) SET_BITS_TO_BE_1BYTE(((u8 *)(_arp)) + 5, 0, 8, _val) +#define SET_ARP_OPER(_arp, _val) SET_BITS_TO_BE_2BYTE(((u8 *)(_arp)) + 6, 0, 16, _val) + +#define ARP_SHA(_arp, _hlen, _plen) (((u8 *)(_arp)) + 8) +#define ARP_SPA(_arp, _hlen, _plen) (((u8 *)(_arp)) + 8 + (_hlen)) +#define ARP_THA(_arp, _hlen, _plen) (((u8 *)(_arp)) + 8 + (_hlen) + (_plen)) +#define ARP_TPA(_arp, _hlen, _plen) (((u8 *)(_arp)) + 8 + 2 * (_hlen) + (_plen)) + +#define ARP_SENDER_MAC_ADDR(_arp) ARP_SHA(_arp, ETH_ALEN, RTW_IP_ADDR_LEN) +#define ARP_SENDER_IP_ADDR(_arp) ARP_SPA(_arp, ETH_ALEN, RTW_IP_ADDR_LEN) +#define ARP_TARGET_MAC_ADDR(_arp) ARP_THA(_arp, ETH_ALEN, RTW_IP_ADDR_LEN) +#define ARP_TARGET_IP_ADDR(_arp) ARP_TPA(_arp, ETH_ALEN, RTW_IP_ADDR_LEN) + +#define GET_ARP_SENDER_MAC_ADDR(_arp, _val) _rtw_memcpy(_val, ARP_SENDER_MAC_ADDR(_arp), ETH_ALEN) +#define GET_ARP_SENDER_IP_ADDR(_arp, _val) _rtw_memcpy(_val, ARP_SENDER_IP_ADDR(_arp), RTW_IP_ADDR_LEN) +#define GET_ARP_TARGET_MAC_ADDR(_arp, _val) _rtw_memcpy(_val, ARP_TARGET_MAC_ADDR(_arp), ETH_ALEN) +#define GET_ARP_TARGET_IP_ADDR(_arp, _val) _rtw_memcpy(_val, ARP_TARGET_IP_ADDR(_arp), RTW_IP_ADDR_LEN) + +#define SET_ARP_SENDER_MAC_ADDR(_arp, _val) _rtw_memcpy(ARP_SENDER_MAC_ADDR(_arp), _val, ETH_ALEN) +#define SET_ARP_SENDER_IP_ADDR(_arp, _val) _rtw_memcpy(ARP_SENDER_IP_ADDR(_arp), _val, RTW_IP_ADDR_LEN) +#define SET_ARP_TARGET_MAC_ADDR(_arp, _val) _rtw_memcpy(ARP_TARGET_MAC_ADDR(_arp), _val, ETH_ALEN) +#define SET_ARP_TARGET_IP_ADDR(_arp, _val) _rtw_memcpy(ARP_TARGET_IP_ADDR(_arp), _val, RTW_IP_ADDR_LEN) + +void dump_arp_pkt(void *sel, u8 *da, u8 *sa, u8 *arp, bool tx); #define IPV4_SRC(_iphdr) (((u8 *)(_iphdr)) + 12) #define IPV4_DST(_iphdr) (((u8 *)(_iphdr)) + 16) diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_mlme_ext.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_mlme_ext.h index 8ccbeed73e8c..85f1f1834c5b 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_mlme_ext.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_mlme_ext.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +22,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) */ @@ -93,172 +89,11 @@ extern unsigned char P2P_OUI[]; extern unsigned char WMM_INFO_OUI[]; extern unsigned char WMM_PARA_OUI[]; -typedef enum _RT_CHANNEL_DOMAIN { - /* ===== 0x00 ~ 0x1F, legacy channel plan ===== */ - RTW_CHPLAN_FCC = 0x00, - RTW_CHPLAN_IC = 0x01, - RTW_CHPLAN_ETSI = 0x02, - RTW_CHPLAN_SPAIN = 0x03, - RTW_CHPLAN_FRANCE = 0x04, - RTW_CHPLAN_MKK = 0x05, - RTW_CHPLAN_MKK1 = 0x06, - RTW_CHPLAN_ISRAEL = 0x07, - RTW_CHPLAN_TELEC = 0x08, - RTW_CHPLAN_GLOBAL_DOAMIN = 0x09, - RTW_CHPLAN_WORLD_WIDE_13 = 0x0A, - RTW_CHPLAN_TAIWAN = 0x0B, - RTW_CHPLAN_CHINA = 0x0C, - RTW_CHPLAN_SINGAPORE_INDIA_MEXICO = 0x0D, - RTW_CHPLAN_KOREA = 0x0E, - RTW_CHPLAN_TURKEY = 0x0F, - RTW_CHPLAN_JAPAN = 0x10, - RTW_CHPLAN_FCC_NO_DFS = 0x11, - RTW_CHPLAN_JAPAN_NO_DFS = 0x12, - RTW_CHPLAN_WORLD_WIDE_5G = 0x13, - RTW_CHPLAN_TAIWAN_NO_DFS = 0x14, - - /* ===== 0x20 ~ 0x7F, new channel plan ===== */ - RTW_CHPLAN_WORLD_NULL = 0x20, - RTW_CHPLAN_ETSI1_NULL = 0x21, - RTW_CHPLAN_FCC1_NULL = 0x22, - RTW_CHPLAN_MKK1_NULL = 0x23, - RTW_CHPLAN_ETSI2_NULL = 0x24, - RTW_CHPLAN_FCC1_FCC1 = 0x25, - RTW_CHPLAN_WORLD_ETSI1 = 0x26, - RTW_CHPLAN_MKK1_MKK1 = 0x27, - RTW_CHPLAN_WORLD_KCC1 = 0x28, - RTW_CHPLAN_WORLD_FCC2 = 0x29, - RTW_CHPLAN_FCC2_NULL = 0x2A, - RTW_CHPLAN_WORLD_FCC3 = 0x30, - RTW_CHPLAN_WORLD_FCC4 = 0x31, - RTW_CHPLAN_WORLD_FCC5 = 0x32, - RTW_CHPLAN_WORLD_FCC6 = 0x33, - RTW_CHPLAN_FCC1_FCC7 = 0x34, - RTW_CHPLAN_WORLD_ETSI2 = 0x35, - RTW_CHPLAN_WORLD_ETSI3 = 0x36, - RTW_CHPLAN_MKK1_MKK2 = 0x37, - RTW_CHPLAN_MKK1_MKK3 = 0x38, - RTW_CHPLAN_FCC1_NCC1 = 0x39, - RTW_CHPLAN_FCC1_NCC2 = 0x40, - RTW_CHPLAN_GLOBAL_NULL = 0x41, - RTW_CHPLAN_ETSI1_ETSI4 = 0x42, - RTW_CHPLAN_FCC1_FCC2 = 0x43, - RTW_CHPLAN_FCC1_NCC3 = 0x44, - RTW_CHPLAN_WORLD_ETSI5 = 0x45, - RTW_CHPLAN_FCC1_FCC8 = 0x46, - RTW_CHPLAN_WORLD_ETSI6 = 0x47, - RTW_CHPLAN_WORLD_ETSI7 = 0x48, - RTW_CHPLAN_WORLD_ETSI8 = 0x49, - RTW_CHPLAN_WORLD_ETSI9 = 0x50, - RTW_CHPLAN_WORLD_ETSI10 = 0x51, - RTW_CHPLAN_WORLD_ETSI11 = 0x52, - RTW_CHPLAN_FCC1_NCC4 = 0x53, - RTW_CHPLAN_WORLD_ETSI12 = 0x54, - RTW_CHPLAN_FCC1_FCC9 = 0x55, - RTW_CHPLAN_WORLD_ETSI13 = 0x56, - RTW_CHPLAN_FCC1_FCC10 = 0x57, - RTW_CHPLAN_MKK2_MKK4 = 0x58, - RTW_CHPLAN_WORLD_ETSI14 = 0x59, - RTW_CHPLAN_FCC1_FCC5 = 0x60, - RTW_CHPLAN_FCC2_FCC7 = 0x61, - RTW_CHPLAN_FCC2_FCC1 = 0x62, - - RTW_CHPLAN_MAX, - RTW_CHPLAN_REALTEK_DEFINE = 0x7F, -} RT_CHANNEL_DOMAIN, *PRT_CHANNEL_DOMAIN; - -typedef enum _RT_CHANNEL_DOMAIN_2G { - RTW_RD_2G_NULL = 0, - RTW_RD_2G_WORLD = 1, /* Worldwird 13 */ - RTW_RD_2G_ETSI1 = 2, /* Europe */ - RTW_RD_2G_FCC1 = 3, /* US */ - RTW_RD_2G_MKK1 = 4, /* Japan */ - RTW_RD_2G_ETSI2 = 5, /* France */ - RTW_RD_2G_GLOBAL = 6, /* Global domain */ - RTW_RD_2G_MKK2 = 7, /* Japan */ - RTW_RD_2G_FCC2 = 8, /* US */ - - RTW_RD_2G_MAX, -} RT_CHANNEL_DOMAIN_2G, *PRT_CHANNEL_DOMAIN_2G; - -typedef enum _RT_CHANNEL_DOMAIN_5G { - RTW_RD_5G_NULL = 0, /* */ - RTW_RD_5G_ETSI1 = 1, /* Europe */ - RTW_RD_5G_ETSI2 = 2, /* Australia, New Zealand */ - RTW_RD_5G_ETSI3 = 3, /* Russia */ - RTW_RD_5G_FCC1 = 4, /* US */ - RTW_RD_5G_FCC2 = 5, /* FCC w/o DFS Channels */ - RTW_RD_5G_FCC3 = 6, /* Bolivia, Chile, El Salvador, Venezuela */ - 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) */ - - /* === Below are driver defined for legacy channel plan compatible, DON'T assign index ==== */ - RTW_RD_5G_OLD_FCC1, - RTW_RD_5G_OLD_NCC1, - RTW_RD_5G_OLD_KCC1, - - RTW_RD_5G_MAX, -} RT_CHANNEL_DOMAIN_5G, *PRT_CHANNEL_DOMAIN_5G; - -bool rtw_chplan_is_empty(u8 id); -#define rtw_is_channel_plan_valid(chplan) (((chplan) < RTW_CHPLAN_MAX || (chplan) == RTW_CHPLAN_REALTEK_DEFINE) && !rtw_chplan_is_empty(chplan)) -#define rtw_is_legacy_channel_plan(chplan) ((chplan) < 0x20) - typedef struct _RT_CHANNEL_PLAN { unsigned char Channel[MAX_CHANNEL_NUM]; unsigned char Len; } RT_CHANNEL_PLAN, *PRT_CHANNEL_PLAN; -struct ch_list_t { - u8 *len_ch; -}; - -#define CH_LIST_ENT(_len, arg...) \ - {.len_ch = (u8[_len + 1]) {_len, ##arg}, } - -#define CH_LIST_LEN(_ch_list) (_ch_list.len_ch[0]) -#define CH_LIST_CH(_ch_list, _i) (_ch_list.len_ch[_i + 1]) - -typedef struct _RT_CHANNEL_PLAN_MAP { - u8 Index2G; -#ifdef CONFIG_IEEE80211_BAND_5GHZ - u8 Index5G; -#endif - u8 regd; /* value of REGULATION_TXPWR_LMT */ -} RT_CHANNEL_PLAN_MAP, *PRT_CHANNEL_PLAN_MAP; - -#ifdef CONFIG_IEEE80211_BAND_5GHZ -#define CHPLAN_ENT(i2g, i5g, regd) {i2g, i5g, regd} -#else -#define CHPLAN_ENT(i2g, i5g, regd) {i2g, regd} -#endif - enum Associated_AP { atherosAP = 0, broadcomAP = 1, @@ -293,6 +128,24 @@ typedef enum _HT_IOT_PEER { HT_IOT_PEER_MAX = 18 } HT_IOT_PEER_E, *PHTIOT_PEER_E; + +typedef enum _RT_HT_INF0_CAP { + RT_HT_CAP_USE_TURBO_AGGR = 0x01, + RT_HT_CAP_USE_LONG_PREAMBLE = 0x02, + RT_HT_CAP_USE_AMPDU = 0x04, + RT_HT_CAP_USE_WOW = 0x8, + RT_HT_CAP_USE_SOFTAP = 0x10, + RT_HT_CAP_USE_92SE = 0x20, + RT_HT_CAP_USE_88C_92C = 0x40, + RT_HT_CAP_USE_AP_CLIENT_MODE = 0x80, /* AP team request to reserve this bit, by Emily */ +} RT_HT_INF0_CAPBILITY, *PRT_HT_INF0_CAPBILITY; + +typedef enum _RT_HT_INF1_CAP { + RT_HT_CAP_USE_VIDEO_CLIENT = 0x01, + RT_HT_CAP_USE_JAGUAR_BCUT = 0x02, + RT_HT_CAP_USE_JAGUAR_CCUT = 0x04, +} RT_HT_INF1_CAPBILITY, *PRT_HT_INF1_CAPBILITY; + struct mlme_handler { unsigned int num; char *str; @@ -344,19 +197,28 @@ 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; u8 igi_before_scan; /* used for restoring IGI value without enable DIG & FA_CNT */ #ifdef CONFIG_SCAN_BACKOP u8 backop_flags_sta; /* policy for station mode*/ + #ifdef CONFIG_AP_MODE u8 backop_flags_ap; /* policy for ap mode */ + #endif + #ifdef CONFIG_RTW_MESH + u8 backop_flags_mesh; /* policy for mesh mode */ + #endif 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 +228,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 */ @@ -402,12 +269,18 @@ enum TDLS_option { TDLS_CH_SW_END, TDLS_RS_RCR, TDLS_TEARDOWN_STA, + TDLS_TEARDOWN_STA_NO_WAIT, TDLS_TEARDOWN_STA_LOCALLY, + TDLS_TEARDOWN_STA_LOCALLY_POST, maxTDLS, }; #endif /* CONFIG_TDLS */ +#if (KERNEL_VERSION(3, 8, 0) > LINUX_VERSION_CODE) +#define NL80211_AUTHTYPE_SAE (__NL80211_AUTHTYPE_NUM + 1) +#endif + /* * Usage: * When one iface acted as AP mode and the other iface is STA mode and scanning, @@ -434,6 +307,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 @@ -444,6 +320,7 @@ struct mlme_ext_info { u32 link_count; u32 auth_seq; u32 auth_algo; /* 802.11 auth, could be open, shared, auto */ + u16 auth_status; u32 authModeToggle; u32 enc_algo;/* encrypt algorithm; */ u32 key_index; /* this is only valid for legendary wep, 0~3 for key id. */ @@ -475,11 +352,19 @@ 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; struct HT_info_element HT_info; WLAN_BSSID_EX network;/* join network or bss_network, if in ap mode, it is the same to cur_network.network */ +#ifdef ROKU_PRIVATE + /*infra mode, store supported rates from AssocRsp*/ + NDIS_802_11_RATES_EX SupportedRates_infra_ap; + u8 ht_vht_received;/*ht_vht_received used to show debug msg BIT(0):HT BIT(1):VHT */ +#endif /* ROKU_PRIVATE */ }; /* The channel information about this channel including joining, scanning, and power constraints. */ @@ -492,33 +377,42 @@ 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; -#define DFS_MASTER_TIMER_MS 100 #define CAC_TIME_MS (60*1000) #define CAC_TIME_CE_MS (10*60*1000) #define NON_OCP_TIME_MS (30*60*1000) +#if 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())) -bool rtw_is_cac_reset_needed(_adapter *adapter, u8 ch, u8 bw, u8 offset); +#define CH_IS_NON_OCP(rt_ch_info) (rtw_time_after((rt_ch_info)->non_ocp_end_time, rtw_get_current_time())) +bool rtw_is_cac_reset_needed(struct rf_ctl_t *rfctl, 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); bool rtw_rfctl_is_tx_blocked_by_ch_waiting(struct rf_ctl_t *rfctl); -bool rtw_chset_is_ch_non_ocp(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset); +bool rtw_chset_is_chbw_non_ocp(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset); +bool rtw_chset_is_ch_non_ocp(RT_CHANNEL_INFO *ch_set, u8 ch); 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); +u32 rtw_get_ch_waiting_ms(struct rf_ctl_t *rfctl, u8 ch, u8 bw, u8 offset, u32 *r_non_ocp_ms, u32 *r_cac_ms); +void rtw_reset_cac(struct rf_ctl_t *rfctl, u8 ch, u8 bw, u8 offset); +u32 rtw_force_stop_cac(struct rf_ctl_t *rfctl, u32 timeout_ms); #else #define CH_IS_NON_OCP(rt_ch_info) 0 -#define rtw_chset_is_ch_non_ocp(ch_set, ch, bw, offset) _FALSE +#define rtw_chset_is_chbw_non_ocp(ch_set, ch, bw, offset) _FALSE +#define rtw_chset_is_ch_non_ocp(ch_set, ch) _FALSE #define rtw_rfctl_is_tx_blocked_by_ch_waiting(rfctl) _FALSE #endif @@ -532,17 +426,17 @@ enum { 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); +bool rtw_choose_shortest_waiting_ch(struct rf_ctl_t *rfctl, u8 sel_ch, u8 max_bw + , u8 *dec_ch, u8 *dec_bw, u8 *dec_offset + , u8 d_flags, u8 cur_ch, u8 same_band_prefer, u8 mesh_only); -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); -void dump_chplan_test(void *sel); void dump_chset(void *sel, RT_CHANNEL_INFO *ch_set); -void dump_cur_chset(void *sel, _adapter *adapter); +void dump_cur_chset(void *sel, struct rf_ctl_t *rfctl); -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); +void rtw_chset_sync_chbw(RT_CHANNEL_INFO *ch_set, u8 *req_ch, u8 *req_bw, u8 *req_offset + , u8 *g_ch, u8 *g_bw, u8 *g_offset); bool rtw_mlme_band_check(_adapter *adapter, const u32 ch); @@ -597,9 +491,7 @@ struct mlme_ext_priv { u16 mgnt_seq; #ifdef CONFIG_IEEE80211W u16 sa_query_seq; - u64 mgnt_80211w_IPN; - u64 mgnt_80211w_IPN_rx; -#endif /* CONFIG_IEEE80211W */ +#endif /* struct fw_priv fwpriv; */ unsigned char cur_channel; @@ -607,9 +499,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 @@ -621,28 +510,33 @@ 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 join_abort; u8 tx_rate; /* TXRATE when USERATE is set. */ u32 retry; /* retry for issue probereq */ u64 TSFValue; - - /* for LPS-32K to adaptive bcn early and timeout */ - u8 adaptive_tsf_done; - u32 bcn_delay_cnt[9]; - u32 bcn_delay_ratio[9]; u32 bcn_cnt; - u8 DrvBcnEarly; - u8 DrvBcnTimeOut; - + u32 last_bcn_cnt; + u8 cur_bcn_cnt;/*2s*/ + u8 dtim;/*DTIM Period*/ +#ifdef DBG_RX_BCN + u8 tim[4]; +#endif +#ifdef CONFIG_BCN_RECV_TIME + u16 bcn_rx_time; +#endif #ifdef CONFIG_AP_MODE unsigned char bstart_bss; #endif @@ -660,8 +554,34 @@ struct mlme_ext_priv { #ifdef DBG_FIXED_CHAN u8 fixed_chan; #endif - /* set hw sync bcn tsf register or not */ - u8 en_hw_update_tsf; + + u8 tsf_update_required:1; + u8 en_hw_update_tsf:1; /* set hw sync bcn tsf register or not */ + systime tsf_update_pause_stime; + u8 tsf_update_pause_factor; /* num of bcn intervals to stay TSF update pause status */ + u8 tsf_update_restore_factor; /* num of bcn interval to stay TSF update restore status */ +#ifdef CONFIG_SUPPORT_STATIC_SMPS + u8 ssmps_en; + u16 ssmps_tx_tp_th;/*Mbps*/ + u16 ssmps_rx_tp_th;/*Mbps*/ + #ifdef DBG_STATIC_SMPS + u8 ssmps_test; + u8 ssmps_test_en; + #endif +#endif +#ifdef CONFIG_CTRL_TXSS_BY_TP + u8 txss_ctrl_en; + u16 txss_tp_th;/*Mbps*/ + u8 txss_tp_chk_cnt;/*unit 2s*/ + bool txss_1ss; + u8 txss_momi_type_bk; +#endif +}; + +struct support_rate_handler { + u8 rate; + bool basic; + bool existence; }; static inline u8 check_mlmeinfo_state(struct mlme_ext_priv *plmeext, sint state) @@ -672,6 +592,8 @@ static inline u8 check_mlmeinfo_state(struct mlme_ext_priv *plmeext, sint state) return _FALSE; } +void sitesurvey_set_offch_state(_adapter *adapter, u8 scan_state); + #define mlmeext_msr(mlmeext) ((mlmeext)->mlmext_info.state & 0x03) #define mlmeext_scan_state(mlmeext) ((mlmeext)->sitesurvey_res.state) #define mlmeext_scan_state_str(mlmeext) scan_state_str((mlmeext)->sitesurvey_res.state) @@ -680,7 +602,9 @@ 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)); */ \ + sitesurvey_set_offch_state(container_of(mlmeext, _adapter, mlmeextpriv), _state); \ } while (0) #define mlmeext_scan_next_state(mlmeext) ((mlmeext)->sitesurvey_res.next_state) @@ -705,13 +629,6 @@ static inline u8 check_mlmeinfo_state(struct mlme_ext_priv *plmeext, sint state) do { \ ((mlmeext)->sitesurvey_res.backop_flags_sta = (flags)); \ } while (0) - -#define mlmeext_scan_backop_flags_ap(mlmeext) ((mlmeext)->sitesurvey_res.backop_flags_ap) -#define mlmeext_chk_scan_backop_flags_ap(mlmeext, flags) ((mlmeext)->sitesurvey_res.backop_flags_ap & (flags)) -#define mlmeext_assign_scan_backop_flags_ap(mlmeext, flags) \ - do { \ - ((mlmeext)->sitesurvey_res.backop_flags_ap = (flags)); \ - } while (0) #else #define mlmeext_scan_backop_flags(mlmeext) (0) #define mlmeext_chk_scan_backop_flags(mlmeext, flags) (0) @@ -720,26 +637,44 @@ static inline u8 check_mlmeinfo_state(struct mlme_ext_priv *plmeext, sint state) #define mlmeext_scan_backop_flags_sta(mlmeext) (0) #define mlmeext_chk_scan_backop_flags_sta(mlmeext, flags) (0) #define mlmeext_assign_scan_backop_flags_sta(mlmeext, flags) do {} while (0) +#endif /* CONFIG_SCAN_BACKOP */ +#if defined(CONFIG_SCAN_BACKOP) && defined(CONFIG_AP_MODE) +#define mlmeext_scan_backop_flags_ap(mlmeext) ((mlmeext)->sitesurvey_res.backop_flags_ap) +#define mlmeext_chk_scan_backop_flags_ap(mlmeext, flags) ((mlmeext)->sitesurvey_res.backop_flags_ap & (flags)) +#define mlmeext_assign_scan_backop_flags_ap(mlmeext, flags) \ + do { \ + ((mlmeext)->sitesurvey_res.backop_flags_ap = (flags)); \ + } while (0) +#else #define mlmeext_scan_backop_flags_ap(mlmeext) (0) #define mlmeext_chk_scan_backop_flags_ap(mlmeext, flags) (0) #define mlmeext_assign_scan_backop_flags_ap(mlmeext, flags) do {} while (0) -#endif +#endif /* defined(CONFIG_SCAN_BACKOP) && defined(CONFIG_AP_MODE) */ + +#if defined(CONFIG_SCAN_BACKOP) && defined(CONFIG_RTW_MESH) +#define mlmeext_scan_backop_flags_mesh(mlmeext) ((mlmeext)->sitesurvey_res.backop_flags_mesh) +#define mlmeext_chk_scan_backop_flags_mesh(mlmeext, flags) ((mlmeext)->sitesurvey_res.backop_flags_mesh & (flags)) +#define mlmeext_assign_scan_backop_flags_mesh(mlmeext, flags) \ + do { \ + ((mlmeext)->sitesurvey_res.backop_flags_mesh = (flags)); \ + } while (0) +#else +#define mlmeext_scan_backop_flags_mesh(mlmeext) (0) +#define mlmeext_chk_scan_backop_flags_mesh(mlmeext, flags) (0) +#define mlmeext_assign_scan_backop_flags_mesh(mlmeext, flags) do {} while (0) +#endif /* defined(CONFIG_SCAN_BACKOP) && defined(CONFIG_RTW_MESH) */ + +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); @@ -749,6 +684,8 @@ void change_band_update_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork, u8 ch); void Set_MSR(_adapter *padapter, u8 type); +void rtw_set_external_auth_status(_adapter *padapter, const void *data, int len); + u8 rtw_get_oper_ch(_adapter *adapter); void rtw_set_oper_ch(_adapter *adapter, u8 ch); u8 rtw_get_oper_bw(_adapter *adapter); @@ -756,11 +693,10 @@ 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); void set_channel_bwmode(_adapter *padapter, unsigned char channel, unsigned char channel_offset, unsigned short bwmode); @@ -781,7 +717,6 @@ void write_cam_cache(_adapter *adapter, u8 id, u16 ctrl, u8 *mac, u8 *key); void clear_cam_cache(_adapter *adapter, u8 id); void invalidate_cam_all(_adapter *padapter); -void CAM_empty_entry(PADAPTER Adapter, u8 ucIndex); void flush_all_cam_entry(_adapter *padapter); @@ -791,7 +726,6 @@ void site_survey(_adapter *padapter, u8 survey_channel, RT_SCAN_TYPE ScanType); u8 collect_bss_info(_adapter *padapter, union recv_frame *precv_frame, WLAN_BSSID_EX *bssid); void update_network(WLAN_BSSID_EX *dst, WLAN_BSSID_EX *src, _adapter *padapter, bool update_ie); -int get_bsstype(unsigned short capability); u8 *get_my_bssid(WLAN_BSSID_EX *pnetwork); u16 get_beacon_interval(WLAN_BSSID_EX *bss); @@ -800,6 +734,13 @@ int is_client_associated_to_ibss(_adapter *padapter); int is_IBSS_empty(_adapter *padapter); unsigned char check_assoc_AP(u8 *pframe, uint len); +void get_assoc_AP_Vendor(char *vendor, u8 assoc_AP_vendor); +#ifdef CONFIG_RTS_FULL_BW +void rtw_parse_sta_vendor_ie_8812(_adapter *adapter, struct sta_info *sta, u8 *tlv_ies, u16 tlv_ies_len); +#endif/*CONFIG_RTS_FULL_BW*/ +#ifdef CONFIG_80211AC_VHT +unsigned char get_vht_mu_bfer_cap(u8 *pframe, uint len); +#endif int WMM_param_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); #ifdef CONFIG_WFD @@ -809,13 +750,24 @@ void rtw_process_wfd_ies(_adapter *adapter, u8 *ies, u8 ies_len, const char *tag void WMMOnAssocRsp(_adapter *padapter); void HT_caps_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); +#ifdef ROKU_PRIVATE +void HT_caps_handler_infra_ap(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); +#endif void HT_info_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); void HTOnAssocRsp(_adapter *padapter); +#ifdef ROKU_PRIVATE +void Supported_rate_infra_ap(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); +void Extended_Supported_rate_infra_ap(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); +#endif + void ERP_IE_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); void VCS_update(_adapter *padapter, struct sta_info *psta); void update_ldpc_stbc_cap(struct sta_info *psta); +bool rtw_validate_value(u16 EID, u8 *p, u16 len); +bool hidden_ssid_ap(WLAN_BSSID_EX *snetwork); +void rtw_absorb_ssid_ifneed(_adapter *padapter, WLAN_BSSID_EX *bssid, u8 *pframe); 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); @@ -823,7 +775,7 @@ 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); #ifdef CONFIG_DFS -void process_csa_ie(_adapter *padapter, u8 *pframe, uint len); +void process_csa_ie(_adapter *padapter, u8 *ies, uint ies_len); #endif /* CONFIG_DFS */ void update_capinfo(PADAPTER Adapter, u16 updateCap); void update_wireless_mode(_adapter *padapter); @@ -840,12 +792,17 @@ 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); unsigned int should_forbid_n_rate(_adapter *padapter); +void parsing_eapol_packet(_adapter *padapter, u8 *key_payload, struct sta_info *psta, u8 trx_type); + bool _rtw_camctl_chk_cap(_adapter *adapter, u8 cap); void _rtw_camctl_set_flags(_adapter *adapter, u32 flags); void rtw_camctl_set_flags(_adapter *adapter, u32 flags); @@ -860,31 +817,52 @@ void rtw_sec_cam_map_clr_all(struct sec_cam_bmp *map); bool _rtw_camid_is_gk(_adapter *adapter, u8 cam_id); bool rtw_camid_is_gk(_adapter *adapter, u8 cam_id); s16 rtw_camid_search(_adapter *adapter, u8 *addr, s16 kid, s8 gk); -s16 rtw_camid_alloc(_adapter *adapter, struct sta_info *sta, u8 kid, bool *used); +s16 rtw_camid_alloc(_adapter *adapter, struct sta_info *sta, u8 kid, u8 gk, bool *used); void rtw_camid_free(_adapter *adapter, u8 cam_id); u8 rtw_get_sec_camid(_adapter *adapter, u8 max_bk_key_num, u8 *sec_key_id); struct macid_bmp; struct macid_ctl_t; +bool _rtw_macid_ctl_chk_cap(_adapter *adapter, u8 cap); void dump_macid_map(void *sel, struct macid_bmp *map, u8 max_num); bool rtw_macid_is_set(struct macid_bmp *map, u8 id); +void rtw_macid_map_clr(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); u8 rtw_search_max_mac_id(_adapter *padapter); -void rtw_macid_ctl_set_h2c_msr(struct macid_ctl_t *macid_ctl, u8 id, u8 h2c_msr); +u8 rtw_macid_ctl_set_h2c_msr(struct macid_ctl_t *macid_ctl, u8 id, u8 h2c_msr); 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_drop_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); +bool rtw_bmp_is_set(const u8 *bmp, u8 bmp_len, u8 id); +void rtw_bmp_set(u8 *bmp, u8 bmp_len, u8 id); +void rtw_bmp_clear(u8 *bmp, u8 bmp_len, u8 id); +bool rtw_bmp_not_empty(const u8 *bmp, u8 bmp_len); +bool rtw_bmp_not_empty_exclude_bit0(const u8 *bmp, u8 bmp_len); + +#ifdef CONFIG_AP_MODE +bool rtw_tim_map_is_set(_adapter *padapter, const u8 *map, u8 id); +void rtw_tim_map_set(_adapter *padapter, u8 *map, u8 id); +void rtw_tim_map_clear(_adapter *padapter, u8 *map, u8 id); +bool rtw_tim_map_anyone_be_set(_adapter *padapter, const u8 *map); +bool rtw_tim_map_anyone_be_set_exclude_aid0(_adapter *padapter, const u8 *map); +#endif /* CONFIG_AP_MODE */ + +u32 report_join_res(_adapter *padapter, int aid_res, u16 status); void report_survey_event(_adapter *padapter, union recv_frame *precv_frame); void report_surveydone_event(_adapter *padapter); u32 report_del_sta_event(_adapter *padapter, unsigned char *MacAddr, unsigned short reason, bool enqueue, u8 locally_generated); @@ -906,6 +884,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,11 +900,10 @@ void issue_assocreq(_adapter *padapter); void issue_reassocreq(_adapter *padapter); void issue_asocrsp(_adapter *padapter, unsigned short status, struct sta_info *pstat, int pkt_type); 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); +void issue_probereq(_adapter *padapter, const NDIS_802_11_SSID *pssid, const u8 *da); +s32 issue_probereq_ex(_adapter *padapter, const NDIS_802_11_SSID *pssid, const 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_qos_nulldata(_adapter *padapter, unsigned char *da, u16 tid, u8 ps, 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); void issue_action_spct_ch_switch(_adapter *padapter, u8 *ra, u8 new_ch, u8 ch_offset); @@ -934,11 +912,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); @@ -987,6 +965,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); @@ -997,31 +976,61 @@ 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); #ifdef CONFIG_RTW_80211R -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 rtw_ft_update_bcn(_adapter *padapter, union recv_frame *precv_frame); +void rtw_ft_start_clnt_join(_adapter *padapter); +u8 rtw_ft_update_rsnie(_adapter *padapter, u8 bwrite, + struct pkt_attrib *pattrib, u8 **pframe); +void rtw_ft_build_auth_req_ies(_adapter *padapter, + struct pkt_attrib *pattrib, u8 **pframe); +void rtw_ft_build_assoc_req_ies(_adapter *padapter, + u8 is_reassoc, struct pkt_attrib *pattrib, u8 **pframe); +u8 rtw_ft_update_auth_rsp_ies(_adapter *padapter, u8 *pframe, u32 len); +void rtw_ft_start_roam(_adapter *padapter, u8 *pTargetAddr); +void rtw_ft_issue_action_req(_adapter *padapter, u8 *pTargetAddr); +void rtw_ft_report_evt(_adapter *padapter); +void rtw_ft_report_reassoc_evt(_adapter *padapter, u8 *pMacAddr); +void rtw_ft_link_timer_hdl(void *ctx); +void rtw_ft_roam_timer_hdl(void *ctx); +void rtw_ft_roam_status_reset(_adapter *padapter); +#endif +#ifdef CONFIG_RTW_WNM +void rtw_wnm_roam_scan_hdl(void *ctx); +void rtw_wnm_process_btm_req(_adapter *padapter, u8* pframe, u32 frame_len); +void rtw_wnm_reset_btm_candidate(struct roam_nb_info *pnb); +void rtw_wnm_reset_btm_state(_adapter *padapter); +void rtw_wnm_issue_action(_adapter *padapter, u8 action, u8 reason); +#endif +#if defined(CONFIG_RTW_WNM) || defined(CONFIG_RTW_80211K) +u32 rtw_wnm_btm_candidates_survey(_adapter *padapter, u8* pframe, u32 elem_len, u8 is_preference); #endif void mlmeext_joinbss_event_callback(_adapter *padapter, int join_res); void mlmeext_sta_del_event_callback(_adapter *padapter); void mlmeext_sta_add_event_callback(_adapter *padapter, struct sta_info *psta); +int rtw_get_rx_chk_limit(_adapter *adapter); +void rtw_set_rx_chk_limit(_adapter *adapter, int limit); void linked_status_chk(_adapter *padapter, u8 from_timer); +#define rtw_get_bcn_cnt(adapter) (adapter->mlmeextpriv.cur_bcn_cnt) +#define rtw_get_bcn_dtim_period(adapter) (adapter->mlmeextpriv.dtim) +void rtw_collect_bcn_info(_adapter *adapter); + 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); @@ -1040,17 +1049,25 @@ void reassoc_timer_hdl(_adapter *padapter); _set_timer(&(mlmeext)->link_timer, (ms)); \ } while (0) +bool rtw_is_cck_rate(u8 rate); +bool rtw_is_ofdm_rate(u8 rate); +bool rtw_is_basic_rate_cck(u8 rate); +bool rtw_is_basic_rate_ofdm(u8 rate); +bool rtw_is_basic_rate_mix(u8 rate); + extern int cckrates_included(unsigned char *rate, int ratelen); extern int cckratesonly_included(unsigned char *rate, int ratelen); extern void process_addba_req(_adapter *padapter, u8 *paddba_req, u8 *addr); extern void update_TSF(struct mlme_ext_priv *pmlmeext, u8 *pframe, uint len); -extern void correct_TSF(_adapter *padapter, struct mlme_ext_priv *pmlmeext); -extern void adaptive_early_32k(struct mlme_ext_priv *pmlmeext, u8 *pframe, uint len); +extern void correct_TSF(_adapter *padapter, u8 mlme_state); +#ifdef CONFIG_BCN_RECV_TIME +void rtw_rx_bcn_time_update(_adapter *adapter, uint bcn_len, u8 data_rate); +#endif extern u8 traffic_status_watchdog(_adapter *padapter, u8 from_timer); - +void rtw_process_bar_frame(_adapter *padapter, union recv_frame *precv_frame); void rtw_join_done_chk_ch(_adapter *padapter, int join_res); int rtw_chk_start_clnt_join(_adapter *padapter, u8 *ch, u8 *bw, u8 *offset); @@ -1066,6 +1083,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); @@ -1095,7 +1114,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. */ @@ -1103,6 +1122,8 @@ u8 tdls_hdl(_adapter *padapter, unsigned char *pbuf); u8 run_in_thread_hdl(_adapter *padapter, u8 *pbuf); u8 rtw_getmacreg_hdl(_adapter *padapter, u8 *pbuf); +int rtw_sae_preprocess(_adapter *adapter, const u8 *buf, u32 len, u8 tx); + #define GEN_DRV_CMD_HANDLER(size, cmd) {size, &cmd ## _hdl}, #define GEN_MLME_EXT_HANDLER(size, cmd) {size, cmd}, @@ -1138,8 +1159,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) @@ -1155,7 +1176,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) @@ -1173,11 +1194,12 @@ struct cmd_hdl wlancmds[] = { GEN_MLME_EXT_HANDLER(sizeof(struct SetChannelPlan_param), set_chplan_hdl) /*59*/ GEN_MLME_EXT_HANDLER(sizeof(struct LedBlink_param), led_blink_hdl) /*60*/ - GEN_MLME_EXT_HANDLER(sizeof(struct SetChannelSwitch_param), set_csa_hdl) /*61*/ + GEN_MLME_EXT_HANDLER(0, set_csa_hdl) /*61*/ GEN_MLME_EXT_HANDLER(sizeof(struct TDLSoption_param), tdls_hdl) /*62*/ 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/rtl8188eu/include/rtw_mp.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_mp.h index 4cd7f32c842e..f48f4340a197 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_mp.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_mp.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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_ @@ -24,6 +20,7 @@ #define MAX_MP_XMITBUF_SZ 2048 #define NR_MP_XMITFRAME 8 +#define MP_READ_REG_MAX_OFFSET 0x4FFF struct mp_xmit_frame { _list list; @@ -40,18 +37,8 @@ struct mp_xmit_frame { /* insert urb, irp, and irpcnt info below... */ /* max frag_cnt = 8 */ - u8 *mem_addr; u32 sz[8]; - -#if defined(PLATFORM_OS_XP) || defined(PLATFORM_LINUX) - PURB pxmit_urb[8]; -#endif - -#ifdef PLATFORM_OS_XP - PIRP pxmit_irp[8]; -#endif - u8 bpending[8]; sint ac_tag[8]; sint last[8]; @@ -71,21 +58,6 @@ struct mp_wiparam { typedef void(*wi_act_func)(void *padapter); -#ifdef PLATFORM_WINDOWS -struct mp_wi_cntx { - u8 bmpdrv_unload; - - /* Work Item */ - NDIS_WORK_ITEM mp_wi; - NDIS_EVENT mp_wi_evt; - _lock mp_wi_lock; - u8 bmp_wi_progress; - wi_act_func curractfunc; - /* Variable needed in each implementation of CurrActFunc. */ - struct mp_wiparam param; -}; -#endif - struct mp_tx { u8 stop; u32 count, sended; @@ -102,46 +74,14 @@ 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; - UCHAR Nss; - UCHAR Nsts; - UINT N_sym; - UCHAR SIGA2B3; + u8 MCS; + u8 Nss; + u8 Nsts; + u32 N_sym; + u8 SIGA2B3; } RT_PMAC_PKT_INFO, *PRT_PMAC_PKT_INFO; typedef struct _RT_PMAC_TX_INFO { @@ -158,14 +98,14 @@ typedef struct _RT_PMAC_TX_INFO { u8 NDP_sound:1; u8 BandWidth:3; /* 0: 20 1:40 2:80Mhz */ u8 m_STBC; /* bSTBC + 1 */ - USHORT PacketPeriod; - UINT PacketCount; - UINT PacketLength; + u16 PacketPeriod; + u32 PacketCount; + u32 PacketLength; u8 PacketPattern; - USHORT SFD; + u16 SFD; u8 SignalField; u8 ServiceField; - USHORT LENGTH; + u16 LENGTH; u8 CRC16[2]; u8 LSIG[3]; u8 HT_SIG[6]; @@ -177,7 +117,7 @@ typedef struct _RT_PMAC_TX_INFO { } RT_PMAC_TX_INFO, *PRT_PMAC_TX_INFO; -typedef VOID (*MPT_WORK_ITEM_HANDLER)(IN PVOID Adapter); +typedef void (*MPT_WORK_ITEM_HANDLER)(void *Adapter); typedef struct _MPT_CONTEXT { /* Indicate if we have started Mass Production Test. */ BOOLEAN bMassProdTest; @@ -207,27 +147,27 @@ typedef struct _MPT_CONTEXT { MPT_WORK_ITEM_HANDLER CurrMptAct; /* 1=Start, 0=Stop from UI. */ - ULONG MptTestStart; + u32 MptTestStart; /* _TEST_MODE, defined in MPT_Req2.h */ - ULONG MptTestItem; + u32 MptTestItem; /* Variable needed in each implementation of CurrMptAct. */ - ULONG MptActType; /* Type of action performed in CurrMptAct. */ + u32 MptActType; /* Type of action performed in CurrMptAct. */ /* The Offset of IO operation is depend of MptActType. */ - ULONG MptIoOffset; + u32 MptIoOffset; /* The Value of IO operation is depend of MptActType. */ - ULONG MptIoValue; + u32 MptIoValue; /* The RfPath of IO operation is depend of MptActType. */ - ULONG mpt_rf_path; + u32 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. */ + /* u32 bMptAntennaA; */ /* TRUE if we want to use antenna A. */ + u32 MptBandWidth; /* bandwidth to switch. */ - ULONG mpt_rate_index;/* rate index. */ + u32 mpt_rate_index;/* rate index. */ /* Register value kept for Single Carrier Tx test. */ u8 btMpCckTxPower; @@ -237,13 +177,13 @@ typedef struct _MPT_CONTEXT { u8 TxPwrLevel[4]; /* rf-A, rf-B*/ u32 RegTxPwrLimit; /* Content of RCR Regsiter for Mass Production Test. */ - ULONG MptRCR; + u32 MptRCR; /* TRUE if we only receive packets with specific pattern. */ BOOLEAN bMptFilterPattern; /* Rx OK count, statistics used in Mass Production Test. */ - ULONG MptRxOkCnt; + u32 MptRxOkCnt; /* Rx CRC32 error count, statistics used in Mass Production Test. */ - ULONG MptRxCrcErrCnt; + u32 MptRxCrcErrCnt; BOOLEAN bCckContTx; /* TRUE if we are in CCK Continuous Tx test. */ BOOLEAN bOfdmContTx; /* TRUE if we are in OFDM Continuous Tx test. */ @@ -263,12 +203,12 @@ typedef struct _MPT_CONTEXT { /* ACK counter asked by K.Y.. */ BOOLEAN bMptEnableAckCounter; - ULONG MptAckCounter; + u32 MptAckCounter; /* SD3 Willis For 8192S to save 1T/2T RF table for ACUT Only fro ACUT delete later ~~~! */ - /* s1Byte BufOfLines[2][MAX_LINES_HWCONFIG_TXT][MAX_BYTES_LINE_HWCONFIG_TXT]; */ - /* s1Byte BufOfLines[2][MP_MAX_LINES][MP_MAX_LINES_BYTES]; */ - /* s4Byte RfReadLine[2]; */ + /* s8 BufOfLines[2][MAX_LINES_HWCONFIG_TXT][MAX_BYTES_LINE_HWCONFIG_TXT]; */ + /* s8 BufOfLines[2][MP_MAX_LINES][MP_MAX_LINES_BYTES]; */ + /* s32 RfReadLine[2]; */ u8 APK_bound[2]; /* for APK path A/path B */ BOOLEAN bMptIndexEven; @@ -279,15 +219,15 @@ typedef struct _MPT_CONTEXT { u8 backup0x52_RF_A; u8 backup0x52_RF_B; - u4Byte backup0x58_RF_A; - u4Byte backup0x58_RF_B; + u32 backup0x58_RF_A; + u32 backup0x58_RF_B; - u1Byte h2cReqNum; - u1Byte c2hBuf[32]; + u8 h2cReqNum; + u8 c2hBuf[32]; - u1Byte btInBuf[100]; - ULONG mptOutLen; - u1Byte mptOutBuf[100]; + u8 btInBuf[100]; + u32 mptOutLen; + u8 mptOutBuf[100]; RT_PMAC_TX_INFO PMacTxInfo; RT_PMAC_PKT_INFO PMacPktInfo; u8 HWTxmode; @@ -308,6 +248,7 @@ enum { MP_STOP, MP_RATE, MP_CHANNEL, + MP_CHL_OFFSET, MP_BANDWIDTH, MP_TXPOWER, MP_ANT_TX, @@ -340,8 +281,15 @@ enum { MP_HW_TX_MODE, MP_GET_TXPOWER_INX, MP_CUSTOMER_STR, - MP_NULL, + MP_PWRLMT, + MP_PWRBYRATE, + BT_EFUSE_FILE, MP_SetBT, + MP_SWRFPath, + MP_LINK, + MP_DPK_TRK, + MP_DPK, + MP_NULL, #ifdef CONFIG_APPEND_VENDOR_IE_ENABLE VENDOR_IE_SET , VENDOR_IE_GET , @@ -384,6 +332,7 @@ struct mp_priv { u32 rx_pktloss; BOOLEAN rx_bindicatePkt; struct recv_stat rxstat; + BOOLEAN brx_filter_beacon; /* RF/BB relative */ u8 channel; @@ -408,34 +357,12 @@ struct mp_priv { u8 mac_filter[ETH_ALEN]; u8 bmac_filter; + /* RF PATH Setting for WLG WLA BTG BT */ + u8 rf_path_cfg; + struct wlan_network mp_network; NDIS_802_11_MAC_ADDRESS network_macaddr; -#ifdef PLATFORM_WINDOWS - u32 rx_testcnt; - u32 rx_testcnt1; - u32 rx_testcnt2; - u32 tx_testcnt; - u32 tx_testcnt1; - - struct mp_wi_cntx wi_cntx; - - u8 h2c_result; - u8 h2c_seqnum; - u16 h2c_cmdcode; - u8 h2c_resp_parambuf[512]; - _lock h2c_lock; - _lock wkitm_lock; - u32 h2c_cmdcnt; - NDIS_EVENT h2c_cmd_evt; - NDIS_EVENT c2h_set; - NDIS_EVENT h2c_clr; - NDIS_EVENT cpwm_int; - - NDIS_EVENT scsir_full_evt; - NDIS_EVENT scsiw_empty_evt; -#endif - u8 *pallocated_mp_xmitframe_buf; u8 *pmp_xmtframe_buf; _queue free_mp_xmitqueue; @@ -445,11 +372,18 @@ struct mp_priv { BOOLEAN bRTWSmbCfg; BOOLEAN bloopback; BOOLEAN bloadefusemap; + BOOLEAN bloadBTefusemap; + BOOLEAN bprocess_mp_mode; MPT_CONTEXT mpt_ctx; - u8 *TXradomBuffer; + u8 CureFuseBTCoex; + u8 mplink_buf[2048]; + u32 mplink_rx_len; + BOOLEAN mplink_brx; + BOOLEAN mplink_btx; + }; typedef struct _IOCMD_STRUCT_ { @@ -732,7 +666,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); @@ -740,7 +676,7 @@ void SetAntenna(PADAPTER pAdapter); void SetDataRate(PADAPTER pAdapter); void SetAntenna(PADAPTER pAdapter); s32 SetThermalMeter(PADAPTER pAdapter, u8 target_ther); -void GetThermalMeter(PADAPTER pAdapter, u8 *value); +void GetThermalMeter(PADAPTER pAdapter, u8 rfpath ,u8 *value); void SetContinuousTx(PADAPTER pAdapter, u8 bStart); void SetSingleCarrierTx(PADAPTER pAdapter, u8 bStart); void SetSingleToneTx(PADAPTER pAdapter, u8 bStart); @@ -757,7 +693,8 @@ 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); - +void rtw_mp_trigger_dpk(PADAPTER padapter); +u8 rtw_mp_mode_check(PADAPTER padapter); void hal_mpt_SwitchRfSetting(PADAPTER pAdapter); @@ -771,16 +708,17 @@ void hal_mpt_SetDataRate(PADAPTER pAdapter); void hal_mpt_SetAntenna(PADAPTER pAdapter); s32 hal_mpt_SetThermalMeter(PADAPTER pAdapter, u8 target_ther); void hal_mpt_TriggerRFThermalMeter(PADAPTER pAdapter); -u8 hal_mpt_ReadRFThermalMeter(PADAPTER pAdapter); -void hal_mpt_GetThermalMeter(PADAPTER pAdapter, u8 *value); +u8 hal_mpt_ReadRFThermalMeter(PADAPTER pAdapter, u8 rf_path); +void hal_mpt_GetThermalMeter(PADAPTER pAdapter, u8 rfpath, u8 *value); 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 mpt_ProSetPMacTx(PADAPTER Adapter); void MP_PHY_SetRFPathSwitch(PADAPTER pAdapter , BOOLEAN bMain); +void mp_phy_switch_rf_path_set(PADAPTER pAdapter , u8 *pstate); u8 MP_PHY_QueryRFPathSwitch(PADAPTER pAdapter); -ULONG mpt_ProQueryCalTxPower(PADAPTER pAdapter, u8 RfPath); +u32 mpt_ProQueryCalTxPower(PADAPTER pAdapter, u8 RfPath); void MPT_PwrCtlDM(PADAPTER padapter, u32 bstart); u8 mpt_to_mgnt_rate(u32 MptRateIdx); u8 rtw_mpRateParseFunc(PADAPTER pAdapter, u8 *targetStr); @@ -804,7 +742,7 @@ PMAC_Nsym_generator( ); void L_SIG_generator( - UINT N_SYM, /* Max: 750*/ + u32 N_SYM, /* Max: 750*/ PRT_PMAC_TX_INFO pPMacTxInfo, PRT_PMAC_PKT_INFO pPMacPktInfo ); @@ -848,6 +786,9 @@ int rtw_mp_rate(struct net_device *dev, int rtw_mp_channel(struct net_device *dev, struct iw_request_info *info, struct iw_point *wrqu, char *extra); +int rtw_mp_ch_offset(struct net_device *dev, + struct iw_request_info *info, + struct iw_point *wrqu, char *extra); int rtw_mp_bandwidth(struct net_device *dev, struct iw_request_info *info, struct iw_point *wrqu, char *extra); @@ -905,6 +846,12 @@ int rtw_mp_phypara(struct net_device *dev, int rtw_mp_SetRFPath(struct net_device *dev, struct iw_request_info *info, struct iw_point *wrqu, char *extra); +int rtw_mp_switch_rf_path(struct net_device *dev, + struct iw_request_info *info, + struct iw_point *wrqu, char *extra); +int rtw_mp_link(struct net_device *dev, + struct iw_request_info *info, + struct iw_point *wrqu, char *extra); int rtw_mp_QueryDrv(struct net_device *dev, struct iw_request_info *info, union iwreq_data *wrqu, char *extra); @@ -917,12 +864,27 @@ 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_mp_dpk_track(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra); +int rtw_mp_dpk(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); @@ -940,7 +902,7 @@ u8 HwRateToMPTRate(u8 rate); int rtw_mp_iqk(struct net_device *dev, struct iw_request_info *info, struct iw_point *wrqu, char *extra); -int rtw_mp_lck(struct net_device *dev, - struct iw_request_info *info, +int rtw_mp_lck(struct net_device *dev, + struct iw_request_info *info, struct iw_point *wrqu, char *extra); #endif /* _RTW_MP_H_ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_mp_ioctl.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_mp_ioctl.h deleted file mode 100644 index e6a9a2360ead..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_mp_ioctl.h +++ /dev/null @@ -1,575 +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 _RTW_MP_IOCTL_H_ -#define _RTW_MP_IOCTL_H_ - -#include -#include - -#if 0 -#define TESTFWCMDNUMBER 1000000 -#define TEST_H2CINT_WAIT_TIME 500 -#define TEST_C2HINT_WAIT_TIME 500 -#define HCI_TEST_SYSCFG_HWMASK 1 -#define _BUSCLK_40M (4 << 2) -#endif -/* ------------------------------------------------------------------------------ */ -typedef struct CFG_DBG_MSG_STRUCT { - u32 DebugLevel; - u32 DebugComponent_H32; - u32 DebugComponent_L32; -} CFG_DBG_MSG_STRUCT, *PCFG_DBG_MSG_STRUCT; - -typedef struct _RW_REG { - u32 offset; - u32 width; - u32 value; -} mp_rw_reg, RW_Reg, *pRW_Reg; - -/* for OID_RT_PRO_READ16_EEPROM & OID_RT_PRO_WRITE16_EEPROM */ -typedef struct _EEPROM_RW_PARAM { - u32 offset; - u16 value; -} eeprom_rw_param, EEPROM_RWParam, *pEEPROM_RWParam; - -typedef struct _EFUSE_ACCESS_STRUCT_ { - u16 start_addr; - u16 cnts; - u8 data[0]; -} EFUSE_ACCESS_STRUCT, *PEFUSE_ACCESS_STRUCT; - -typedef struct _BURST_RW_REG { - u32 offset; - u32 len; - u8 Data[256]; -} burst_rw_reg, Burst_RW_Reg, *pBurst_RW_Reg; - -typedef struct _USB_VendorReq { - u8 bRequest; - u16 wValue; - u16 wIndex; - u16 wLength; - u8 u8Dir;/* 0:OUT, 1:IN */ - u8 u8InData; -} usb_vendor_req, USB_VendorReq, *pUSB_VendorReq; - -typedef struct _DR_VARIABLE_STRUCT_ { - u8 offset; - u32 variable; -} DR_VARIABLE_STRUCT; - -/* int mp_start_joinbss(_adapter *padapter, NDIS_802_11_SSID *pssid); */ - -/* void _irqlevel_changed_(_irqL *irqlevel, BOOLEANunsigned char bLower); */ -#ifdef PLATFORM_OS_XP -static void _irqlevel_changed_(_irqL *irqlevel, u8 bLower) -{ - - if (bLower == LOWER) { - *irqlevel = KeGetCurrentIrql(); - - if (*irqlevel > PASSIVE_LEVEL) - KeLowerIrql(PASSIVE_LEVEL); - } else { - if (KeGetCurrentIrql() == PASSIVE_LEVEL) - KeRaiseIrql(DISPATCH_LEVEL, irqlevel); - } - -} -#else -#define _irqlevel_changed_(a, b) -#endif - -/* oid_rtl_seg_81_80_00 */ -NDIS_STATUS oid_rt_pro_set_data_rate_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_start_test_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_stop_test_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_set_channel_direct_call_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_set_antenna_bb_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_set_tx_power_control_hdl(struct oid_par_priv *poid_par_priv); -/* oid_rtl_seg_81_80_20 */ -NDIS_STATUS oid_rt_pro_query_tx_packet_sent_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_query_rx_packet_received_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_query_rx_packet_crc32_error_hdl(struct oid_par_priv *poid_par_priv); - -NDIS_STATUS oid_rt_pro_reset_tx_packet_sent_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_reset_rx_packet_received_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_set_modulation_hdl(struct oid_par_priv *poid_par_priv); - -NDIS_STATUS oid_rt_pro_set_continuous_tx_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_set_single_carrier_tx_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_set_carrier_suppression_tx_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_set_single_tone_tx_hdl(struct oid_par_priv *poid_par_priv); - - -/* oid_rtl_seg_81_87 */ -NDIS_STATUS oid_rt_pro_write_bb_reg_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_read_bb_reg_hdl(struct oid_par_priv *poid_par_priv); - -NDIS_STATUS oid_rt_pro_write_rf_reg_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_read_rf_reg_hdl(struct oid_par_priv *poid_par_priv); - - -/* oid_rtl_seg_81_85 */ -NDIS_STATUS oid_rt_wireless_mode_hdl(struct oid_par_priv *poid_par_priv); - - -/* oid_rtl_seg_87_11_00 */ -NDIS_STATUS oid_rt_pro8711_join_bss_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_read_register_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_write_register_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_burst_read_register_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_burst_write_register_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_write_txcmd_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_read16_eeprom_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_write16_eeprom_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro8711_wi_poll_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro8711_pkt_loss_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_rd_attrib_mem_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_wr_attrib_mem_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_set_rf_intfs_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_poll_rx_status_hdl(struct oid_par_priv *poid_par_priv); -/* oid_rtl_seg_87_11_20 */ -NDIS_STATUS oid_rt_pro_cfg_debug_message_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_set_data_rate_ex_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_set_basic_rate_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_read_tssi_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_set_power_tracking_hdl(struct oid_par_priv *poid_par_priv); -/* oid_rtl_seg_87_11_50 */ -NDIS_STATUS oid_rt_pro_qry_pwrstate_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_set_pwrstate_hdl(struct oid_par_priv *poid_par_priv); -/* oid_rtl_seg_87_11_F0 */ -NDIS_STATUS oid_rt_pro_h2c_set_rate_table_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_h2c_get_rate_table_hdl(struct oid_par_priv *poid_par_priv); - - -/* oid_rtl_seg_87_12_00 */ -NDIS_STATUS oid_rt_pro_encryption_ctrl_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_add_sta_info_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_dele_sta_info_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_query_dr_variable_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_rx_packet_type_hdl(struct oid_par_priv *poid_par_priv); - -NDIS_STATUS oid_rt_pro_read_efuse_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_write_efuse_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_rw_efuse_pgpkt_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_get_efuse_current_size_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_efuse_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_efuse_map_hdl(struct oid_par_priv *poid_par_priv); - -NDIS_STATUS oid_rt_set_bandwidth_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_set_crystal_cap_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_set_rx_packet_type_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_get_efuse_max_size_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_pro_set_tx_agc_offset_hdl(struct oid_par_priv *poid_par_priv); - -NDIS_STATUS oid_rt_pro_set_pkt_test_mode_hdl(struct oid_par_priv *poid_par_priv); - -NDIS_STATUS oid_rt_get_thermal_meter_hdl(struct oid_par_priv *poid_par_priv); - -NDIS_STATUS oid_rt_reset_phy_rx_packet_count_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_get_phy_rx_packet_received_hdl(struct oid_par_priv *poid_par_priv); -NDIS_STATUS oid_rt_get_phy_rx_packet_crc32_error_hdl(struct oid_par_priv *poid_par_priv); - -NDIS_STATUS oid_rt_set_power_down_hdl(struct oid_par_priv *poid_par_priv); - -NDIS_STATUS oid_rt_get_power_mode_hdl(struct oid_par_priv *poid_par_priv); - -NDIS_STATUS oid_rt_pro_trigger_gpio_hdl(struct oid_par_priv *poid_par_priv); - -#ifdef _RTW_MP_IOCTL_C_ - -const struct oid_obj_priv oid_rtl_seg_81_80_00[] = { - {1, &oid_null_function}, /* 0x00 OID_RT_PRO_RESET_DUT */ - {1, &oid_rt_pro_set_data_rate_hdl}, /* 0x01 */ - {1, &oid_rt_pro_start_test_hdl}, /* 0x02 */ - {1, &oid_rt_pro_stop_test_hdl}, /* 0x03 */ - {1, &oid_null_function}, /* 0x04 OID_RT_PRO_SET_PREAMBLE */ - {1, &oid_null_function}, /* 0x05 OID_RT_PRO_SET_SCRAMBLER */ - {1, &oid_null_function}, /* 0x06 OID_RT_PRO_SET_FILTER_BB */ - {1, &oid_null_function}, /* 0x07 OID_RT_PRO_SET_MANUAL_DIVERSITY_BB */ - {1, &oid_rt_pro_set_channel_direct_call_hdl}, /* 0x08 */ - {1, &oid_null_function}, /* 0x09 OID_RT_PRO_SET_SLEEP_MODE_DIRECT_CALL */ - {1, &oid_null_function}, /* 0x0A OID_RT_PRO_SET_WAKE_MODE_DIRECT_CALL */ - {1, &oid_rt_pro_set_continuous_tx_hdl}, /* 0x0B OID_RT_PRO_SET_TX_CONTINUOUS_DIRECT_CALL */ - {1, &oid_rt_pro_set_single_carrier_tx_hdl}, /* 0x0C OID_RT_PRO_SET_SINGLE_CARRIER_TX_CONTINUOUS */ - {1, &oid_null_function}, /* 0x0D OID_RT_PRO_SET_TX_ANTENNA_BB */ - {1, &oid_rt_pro_set_antenna_bb_hdl}, /* 0x0E */ - {1, &oid_null_function}, /* 0x0F OID_RT_PRO_SET_CR_SCRAMBLER */ - {1, &oid_null_function}, /* 0x10 OID_RT_PRO_SET_CR_NEW_FILTER */ - {1, &oid_rt_pro_set_tx_power_control_hdl}, /* 0x11 OID_RT_PRO_SET_TX_POWER_CONTROL */ - {1, &oid_null_function}, /* 0x12 OID_RT_PRO_SET_CR_TX_CONFIG */ - {1, &oid_null_function}, /* 0x13 OID_RT_PRO_GET_TX_POWER_CONTROL */ - {1, &oid_null_function}, /* 0x14 OID_RT_PRO_GET_CR_SIGNAL_QUALITY */ - {1, &oid_null_function}, /* 0x15 OID_RT_PRO_SET_CR_SETPOINT */ - {1, &oid_null_function}, /* 0x16 OID_RT_PRO_SET_INTEGRATOR */ - {1, &oid_null_function}, /* 0x17 OID_RT_PRO_SET_SIGNAL_QUALITY */ - {1, &oid_null_function}, /* 0x18 OID_RT_PRO_GET_INTEGRATOR */ - {1, &oid_null_function}, /* 0x19 OID_RT_PRO_GET_SIGNAL_QUALITY */ - {1, &oid_null_function}, /* 0x1A OID_RT_PRO_QUERY_EEPROM_TYPE */ - {1, &oid_null_function}, /* 0x1B OID_RT_PRO_WRITE_MAC_ADDRESS */ - {1, &oid_null_function}, /* 0x1C OID_RT_PRO_READ_MAC_ADDRESS */ - {1, &oid_null_function}, /* 0x1D OID_RT_PRO_WRITE_CIS_DATA */ - {1, &oid_null_function}, /* 0x1E OID_RT_PRO_READ_CIS_DATA */ - {1, &oid_null_function} /* 0x1F OID_RT_PRO_WRITE_POWER_CONTROL */ - -}; - -const struct oid_obj_priv oid_rtl_seg_81_80_20[] = { - {1, &oid_null_function}, /* 0x20 OID_RT_PRO_READ_POWER_CONTROL */ - {1, &oid_null_function}, /* 0x21 OID_RT_PRO_WRITE_EEPROM */ - {1, &oid_null_function}, /* 0x22 OID_RT_PRO_READ_EEPROM */ - {1, &oid_rt_pro_reset_tx_packet_sent_hdl}, /* 0x23 */ - {1, &oid_rt_pro_query_tx_packet_sent_hdl}, /* 0x24 */ - {1, &oid_rt_pro_reset_rx_packet_received_hdl}, /* 0x25 */ - {1, &oid_rt_pro_query_rx_packet_received_hdl}, /* 0x26 */ - {1, &oid_rt_pro_query_rx_packet_crc32_error_hdl}, /* 0x27 */ - {1, &oid_null_function}, /* 0x28 OID_RT_PRO_QUERY_CURRENT_ADDRESS */ - {1, &oid_null_function}, /* 0x29 OID_RT_PRO_QUERY_PERMANENT_ADDRESS */ - {1, &oid_null_function}, /* 0x2A OID_RT_PRO_SET_PHILIPS_RF_PARAMETERS */ - {1, &oid_rt_pro_set_carrier_suppression_tx_hdl},/* 0x2B OID_RT_PRO_SET_CARRIER_SUPPRESSION_TX */ - {1, &oid_null_function}, /* 0x2C OID_RT_PRO_RECEIVE_PACKET */ - {1, &oid_null_function}, /* 0x2D OID_RT_PRO_WRITE_EEPROM_BYTE */ - {1, &oid_null_function}, /* 0x2E OID_RT_PRO_READ_EEPROM_BYTE */ - {1, &oid_rt_pro_set_modulation_hdl} /* 0x2F */ - -}; - -const struct oid_obj_priv oid_rtl_seg_81_80_40[] = { - {1, &oid_null_function}, /* 0x40 */ - {1, &oid_null_function}, /* 0x41 */ - {1, &oid_null_function}, /* 0x42 */ - {1, &oid_rt_pro_set_single_tone_tx_hdl}, /* 0x43 */ - {1, &oid_null_function}, /* 0x44 */ - {1, &oid_null_function} /* 0x45 */ -}; - -const struct oid_obj_priv oid_rtl_seg_81_80_80[] = { - {1, &oid_null_function}, /* 0x80 OID_RT_DRIVER_OPTION */ - {1, &oid_null_function}, /* 0x81 OID_RT_RF_OFF */ - {1, &oid_null_function} /* 0x82 OID_RT_AUTH_STATUS */ - -}; - -const struct oid_obj_priv oid_rtl_seg_81_85[] = { - {1, &oid_rt_wireless_mode_hdl} /* 0x00 OID_RT_WIRELESS_MODE */ -}; - -struct oid_obj_priv oid_rtl_seg_81_87[] = { - {1, &oid_null_function}, /* 0x80 OID_RT_PRO8187_WI_POLL */ - {1, &oid_rt_pro_write_bb_reg_hdl}, /* 0x81 */ - {1, &oid_rt_pro_read_bb_reg_hdl}, /* 0x82 */ - {1, &oid_rt_pro_write_rf_reg_hdl}, /* 0x82 */ - {1, &oid_rt_pro_read_rf_reg_hdl} /* 0x83 */ -}; - -struct oid_obj_priv oid_rtl_seg_87_11_00[] = { - {1, &oid_rt_pro8711_join_bss_hdl}, /* 0x00 */ /* S */ - {1, &oid_rt_pro_read_register_hdl}, /* 0x01 */ - {1, &oid_rt_pro_write_register_hdl}, /* 0x02 */ - {1, &oid_rt_pro_burst_read_register_hdl}, /* 0x03 */ - {1, &oid_rt_pro_burst_write_register_hdl}, /* 0x04 */ - {1, &oid_rt_pro_write_txcmd_hdl}, /* 0x05 */ - {1, &oid_rt_pro_read16_eeprom_hdl}, /* 0x06 */ - {1, &oid_rt_pro_write16_eeprom_hdl}, /* 0x07 */ - {1, &oid_null_function}, /* 0x08 OID_RT_PRO_H2C_SET_COMMAND */ - {1, &oid_null_function}, /* 0x09 OID_RT_PRO_H2C_QUERY_RESULT */ - {1, &oid_rt_pro8711_wi_poll_hdl}, /* 0x0A */ - {1, &oid_rt_pro8711_pkt_loss_hdl}, /* 0x0B */ - {1, &oid_rt_rd_attrib_mem_hdl}, /* 0x0C */ - {1, &oid_rt_wr_attrib_mem_hdl}, /* 0x0D */ - {1, &oid_null_function}, /* 0x0E */ - {1, &oid_null_function}, /* 0x0F */ - {1, &oid_null_function}, /* 0x10 OID_RT_PRO_H2C_CMD_MODE */ - {1, &oid_null_function}, /* 0x11 OID_RT_PRO_H2C_CMD_RSP_MODE */ - {1, &oid_null_function}, /* 0X12 OID_RT_PRO_WAIT_C2H_EVENT */ - {1, &oid_null_function}, /* 0X13 OID_RT_PRO_RW_ACCESS_PROTOCOL_TEST */ - {1, &oid_null_function}, /* 0X14 OID_RT_PRO_SCSI_ACCESS_TEST */ - {1, &oid_null_function}, /* 0X15 OID_RT_PRO_SCSI_TCPIPOFFLOAD_OUT */ - {1, &oid_null_function}, /* 0X16 OID_RT_PRO_SCSI_TCPIPOFFLOAD_IN */ - {1, &oid_null_function}, /* 0X17 OID_RT_RRO_RX_PKT_VIA_IOCTRL */ - {1, &oid_null_function}, /* 0X18 OID_RT_RRO_RX_PKTARRAY_VIA_IOCTRL */ - {1, &oid_null_function}, /* 0X19 OID_RT_RPO_SET_PWRMGT_TEST */ - {1, &oid_null_function}, /* 0X1A */ - {1, &oid_null_function}, /* 0X1B OID_RT_PRO_QRY_PWRMGT_TEST */ - {1, &oid_null_function}, /* 0X1C OID_RT_RPO_ASYNC_RWIO_TEST */ - {1, &oid_null_function}, /* 0X1D OID_RT_RPO_ASYNC_RWIO_POLL */ - {1, &oid_rt_pro_set_rf_intfs_hdl}, /* 0X1E */ - {1, &oid_rt_poll_rx_status_hdl} /* 0X1F */ -}; - -struct oid_obj_priv oid_rtl_seg_87_11_20[] = { - {1, &oid_rt_pro_cfg_debug_message_hdl}, /* 0x20 */ - {1, &oid_rt_pro_set_data_rate_ex_hdl}, /* 0x21 */ - {1, &oid_rt_pro_set_basic_rate_hdl}, /* 0x22 */ - {1, &oid_rt_pro_read_tssi_hdl}, /* 0x23 */ - {1, &oid_rt_pro_set_power_tracking_hdl} /* 0x24 */ -}; - - -struct oid_obj_priv oid_rtl_seg_87_11_50[] = { - {1, &oid_rt_pro_qry_pwrstate_hdl}, /* 0x50 */ - {1, &oid_rt_pro_set_pwrstate_hdl} /* 0x51 */ -}; - -struct oid_obj_priv oid_rtl_seg_87_11_80[] = { - {1, &oid_null_function} /* 0x80 */ -}; - -struct oid_obj_priv oid_rtl_seg_87_11_B0[] = { - {1, &oid_null_function} /* 0xB0 */ -}; - -struct oid_obj_priv oid_rtl_seg_87_11_F0[] = { - {1, &oid_null_function}, /* 0xF0 */ - {1, &oid_null_function}, /* 0xF1 */ - {1, &oid_null_function}, /* 0xF2 */ - {1, &oid_null_function}, /* 0xF3 */ - {1, &oid_null_function}, /* 0xF4 */ - {1, &oid_null_function}, /* 0xF5 */ - {1, &oid_null_function}, /* 0xF6 */ - {1, &oid_null_function}, /* 0xF7 */ - {1, &oid_null_function}, /* 0xF8 */ - {1, &oid_null_function}, /* 0xF9 */ - {1, &oid_null_function}, /* 0xFA */ - {1, &oid_rt_pro_h2c_set_rate_table_hdl}, /* 0xFB */ - {1, &oid_rt_pro_h2c_get_rate_table_hdl}, /* 0xFC */ - {1, &oid_null_function}, /* 0xFD */ - {1, &oid_null_function}, /* 0xFE OID_RT_PRO_H2C_C2H_LBK_TEST */ - {1, &oid_null_function} /* 0xFF */ - -}; - -struct oid_obj_priv oid_rtl_seg_87_12_00[] = { - {1, &oid_rt_pro_encryption_ctrl_hdl}, /* 0x00 Q&S */ - {1, &oid_rt_pro_add_sta_info_hdl}, /* 0x01 S */ - {1, &oid_rt_pro_dele_sta_info_hdl}, /* 0x02 S */ - {1, &oid_rt_pro_query_dr_variable_hdl}, /* 0x03 Q */ - {1, &oid_rt_pro_rx_packet_type_hdl}, /* 0x04 Q,S */ - {1, &oid_rt_pro_read_efuse_hdl}, /* 0x05 Q OID_RT_PRO_READ_EFUSE */ - {1, &oid_rt_pro_write_efuse_hdl}, /* 0x06 S OID_RT_PRO_WRITE_EFUSE */ - {1, &oid_rt_pro_rw_efuse_pgpkt_hdl}, /* 0x07 Q,S */ - {1, &oid_rt_get_efuse_current_size_hdl}, /* 0x08 Q */ - {1, &oid_rt_set_bandwidth_hdl}, /* 0x09 */ - {1, &oid_rt_set_crystal_cap_hdl}, /* 0x0a */ - {1, &oid_rt_set_rx_packet_type_hdl}, /* 0x0b S */ - {1, &oid_rt_get_efuse_max_size_hdl}, /* 0x0c */ - {1, &oid_rt_pro_set_tx_agc_offset_hdl}, /* 0x0d */ - {1, &oid_rt_pro_set_pkt_test_mode_hdl}, /* 0x0e */ - {1, &oid_null_function}, /* 0x0f OID_RT_PRO_FOR_EVM_TEST_SETTING */ - {1, &oid_rt_get_thermal_meter_hdl}, /* 0x10 Q OID_RT_PRO_GET_THERMAL_METER */ - {1, &oid_rt_reset_phy_rx_packet_count_hdl}, /* 0x11 S OID_RT_RESET_PHY_RX_PACKET_COUNT */ - {1, &oid_rt_get_phy_rx_packet_received_hdl}, /* 0x12 Q OID_RT_GET_PHY_RX_PACKET_RECEIVED */ - {1, &oid_rt_get_phy_rx_packet_crc32_error_hdl}, /* 0x13 Q OID_RT_GET_PHY_RX_PACKET_CRC32_ERROR */ - {1, &oid_rt_set_power_down_hdl}, /* 0x14 Q OID_RT_SET_POWER_DOWN */ - {1, &oid_rt_get_power_mode_hdl} /* 0x15 Q OID_RT_GET_POWER_MODE */ -}; - -#else /* _RTL871X_MP_IOCTL_C_ */ - -extern struct oid_obj_priv oid_rtl_seg_81_80_00[32]; -extern struct oid_obj_priv oid_rtl_seg_81_80_20[16]; -extern struct oid_obj_priv oid_rtl_seg_81_80_40[6]; -extern struct oid_obj_priv oid_rtl_seg_81_80_80[3]; - -extern struct oid_obj_priv oid_rtl_seg_81_85[1]; -extern struct oid_obj_priv oid_rtl_seg_81_87[5]; - -extern struct oid_obj_priv oid_rtl_seg_87_11_00[32]; -extern struct oid_obj_priv oid_rtl_seg_87_11_20[5]; -extern struct oid_obj_priv oid_rtl_seg_87_11_50[2]; -extern struct oid_obj_priv oid_rtl_seg_87_11_80[1]; -extern struct oid_obj_priv oid_rtl_seg_87_11_B0[1]; -extern struct oid_obj_priv oid_rtl_seg_87_11_F0[16]; - -extern struct oid_obj_priv oid_rtl_seg_87_12_00[32]; - -#endif /* _RTL871X_MP_IOCTL_C_ */ - -struct rwreg_param { - u32 offset; - u32 width; - u32 value; -}; - -struct bbreg_param { - u32 offset; - u32 phymask; - u32 value; -}; -/* -struct rfchannel_param{ - u32 ch; - u32 modem; -}; -*/ -struct txpower_param { - u32 pwr_index; -}; - - -struct datarate_param { - u32 rate_index; -}; - - -struct rfintfs_parm { - u32 rfintfs; -}; - -typedef struct _mp_xmit_parm_ { - u8 enable; - u32 count; - u16 length; - u8 payload_type; - u8 da[ETH_ALEN]; -} MP_XMIT_PARM, *PMP_XMIT_PARM; - -struct mp_xmit_packet { - u32 len; - u32 mem[MAX_MP_XMITBUF_SZ >> 2]; -}; - -struct psmode_param { - u32 ps_mode; - u32 smart_ps; -}; - -/* for OID_RT_PRO_READ16_EEPROM & OID_RT_PRO_WRITE16_EEPROM */ -struct eeprom_rw_param { - u32 offset; - u16 value; -}; - -struct mp_ioctl_handler { - u32 paramsize; - u32(*handler)(struct oid_par_priv *poid_par_priv); - u32 oid; -}; - -struct mp_ioctl_param { - u32 subcode; - u32 len; - u8 data[0]; -}; - -#define GEN_MP_IOCTL_SUBCODE(code) _MP_IOCTL_ ## code ## _CMD_ - -enum RTL871X_MP_IOCTL_SUBCODE { - GEN_MP_IOCTL_SUBCODE(MP_START), /*0*/ - GEN_MP_IOCTL_SUBCODE(MP_STOP), - GEN_MP_IOCTL_SUBCODE(READ_REG), - GEN_MP_IOCTL_SUBCODE(WRITE_REG), - GEN_MP_IOCTL_SUBCODE(READ_BB_REG), - GEN_MP_IOCTL_SUBCODE(WRITE_BB_REG), /*5*/ - GEN_MP_IOCTL_SUBCODE(READ_RF_REG), - GEN_MP_IOCTL_SUBCODE(WRITE_RF_REG), - GEN_MP_IOCTL_SUBCODE(SET_CHANNEL), - GEN_MP_IOCTL_SUBCODE(SET_TXPOWER), - GEN_MP_IOCTL_SUBCODE(SET_DATARATE), /*10*/ - GEN_MP_IOCTL_SUBCODE(SET_BANDWIDTH), - GEN_MP_IOCTL_SUBCODE(SET_ANTENNA), - GEN_MP_IOCTL_SUBCODE(CNTU_TX), - GEN_MP_IOCTL_SUBCODE(SC_TX), - GEN_MP_IOCTL_SUBCODE(CS_TX), /*15*/ - GEN_MP_IOCTL_SUBCODE(ST_TX), - GEN_MP_IOCTL_SUBCODE(IOCTL_XMIT_PACKET), - GEN_MP_IOCTL_SUBCODE(SET_RX_PKT_TYPE), - GEN_MP_IOCTL_SUBCODE(RESET_PHY_RX_PKT_CNT), - GEN_MP_IOCTL_SUBCODE(GET_PHY_RX_PKT_RECV), /*20*/ - GEN_MP_IOCTL_SUBCODE(GET_PHY_RX_PKT_ERROR), - GEN_MP_IOCTL_SUBCODE(READ16_EEPROM), - GEN_MP_IOCTL_SUBCODE(WRITE16_EEPROM), - GEN_MP_IOCTL_SUBCODE(EFUSE), - GEN_MP_IOCTL_SUBCODE(EFUSE_MAP), /*25*/ - GEN_MP_IOCTL_SUBCODE(GET_EFUSE_MAX_SIZE), - GEN_MP_IOCTL_SUBCODE(GET_EFUSE_CURRENT_SIZE), - GEN_MP_IOCTL_SUBCODE(GET_THERMAL_METER), - GEN_MP_IOCTL_SUBCODE(SET_PTM), - GEN_MP_IOCTL_SUBCODE(SET_POWER_DOWN), /*30*/ - GEN_MP_IOCTL_SUBCODE(TRIGGER_GPIO), - GEN_MP_IOCTL_SUBCODE(SET_DM_BT), /*32*/ - GEN_MP_IOCTL_SUBCODE(DEL_BA), /*33*/ - GEN_MP_IOCTL_SUBCODE(GET_WIFI_STATUS), /*34*/ - MAX_MP_IOCTL_SUBCODE, -}; - -u32 mp_ioctl_xmit_packet_hdl(struct oid_par_priv *poid_par_priv); - -#ifdef _RTW_MP_IOCTL_C_ - -#define GEN_MP_IOCTL_HANDLER(sz, hdl, oid) {sz, hdl, oid}, - -#define EXT_MP_IOCTL_HANDLER(sz, subcode, oid) {sz, mp_ioctl_ ## subcode ## _hdl, oid}, - - -struct mp_ioctl_handler mp_ioctl_hdl[] = { - - /*0*/ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_start_test_hdl, OID_RT_PRO_START_TEST) - GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_stop_test_hdl, OID_RT_PRO_STOP_TEST) - - GEN_MP_IOCTL_HANDLER(sizeof(struct rwreg_param), oid_rt_pro_read_register_hdl, OID_RT_PRO_READ_REGISTER) - GEN_MP_IOCTL_HANDLER(sizeof(struct rwreg_param), oid_rt_pro_write_register_hdl, OID_RT_PRO_WRITE_REGISTER) - GEN_MP_IOCTL_HANDLER(sizeof(struct bb_reg_param), oid_rt_pro_read_bb_reg_hdl, OID_RT_PRO_READ_BB_REG) - /*5*/ GEN_MP_IOCTL_HANDLER(sizeof(struct bb_reg_param), oid_rt_pro_write_bb_reg_hdl, OID_RT_PRO_WRITE_BB_REG) - GEN_MP_IOCTL_HANDLER(sizeof(struct rf_reg_param), oid_rt_pro_read_rf_reg_hdl, OID_RT_PRO_RF_READ_REGISTRY) - GEN_MP_IOCTL_HANDLER(sizeof(struct rf_reg_param), oid_rt_pro_write_rf_reg_hdl, OID_RT_PRO_RF_WRITE_REGISTRY) - - GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_set_channel_direct_call_hdl, OID_RT_PRO_SET_CHANNEL_DIRECT_CALL) - GEN_MP_IOCTL_HANDLER(sizeof(struct txpower_param), oid_rt_pro_set_tx_power_control_hdl, OID_RT_PRO_SET_TX_POWER_CONTROL) - /*10*/ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_set_data_rate_hdl, OID_RT_PRO_SET_DATA_RATE) - GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_set_bandwidth_hdl, OID_RT_SET_BANDWIDTH) - GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_set_antenna_bb_hdl, OID_RT_PRO_SET_ANTENNA_BB) - - GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_set_continuous_tx_hdl, OID_RT_PRO_SET_CONTINUOUS_TX) - GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_set_single_carrier_tx_hdl, OID_RT_PRO_SET_SINGLE_CARRIER_TX) - /*15*/ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_set_carrier_suppression_tx_hdl, OID_RT_PRO_SET_CARRIER_SUPPRESSION_TX) - GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_pro_set_single_tone_tx_hdl, OID_RT_PRO_SET_SINGLE_TONE_TX) - - EXT_MP_IOCTL_HANDLER(0, xmit_packet, 0) - - GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_set_rx_packet_type_hdl, OID_RT_SET_RX_PACKET_TYPE) - GEN_MP_IOCTL_HANDLER(0, oid_rt_reset_phy_rx_packet_count_hdl, OID_RT_RESET_PHY_RX_PACKET_COUNT) - /*20*/ GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_get_phy_rx_packet_received_hdl, OID_RT_GET_PHY_RX_PACKET_RECEIVED) - GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_get_phy_rx_packet_crc32_error_hdl, OID_RT_GET_PHY_RX_PACKET_CRC32_ERROR) - - GEN_MP_IOCTL_HANDLER(sizeof(struct eeprom_rw_param), NULL, 0) - GEN_MP_IOCTL_HANDLER(sizeof(struct eeprom_rw_param), NULL, 0) - GEN_MP_IOCTL_HANDLER(sizeof(EFUSE_ACCESS_STRUCT), oid_rt_pro_efuse_hdl, OID_RT_PRO_EFUSE) - /*25*/ GEN_MP_IOCTL_HANDLER(0, oid_rt_pro_efuse_map_hdl, OID_RT_PRO_EFUSE_MAP) - GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_get_efuse_max_size_hdl, OID_RT_GET_EFUSE_MAX_SIZE) - GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_get_efuse_current_size_hdl, OID_RT_GET_EFUSE_CURRENT_SIZE) - - GEN_MP_IOCTL_HANDLER(sizeof(u32), oid_rt_get_thermal_meter_hdl, OID_RT_PRO_GET_THERMAL_METER) - GEN_MP_IOCTL_HANDLER(sizeof(u8), oid_rt_pro_set_power_tracking_hdl, OID_RT_PRO_SET_POWER_TRACKING) - /*30*/ GEN_MP_IOCTL_HANDLER(sizeof(u8), oid_rt_set_power_down_hdl, OID_RT_SET_POWER_DOWN) - /*31*/ GEN_MP_IOCTL_HANDLER(0, oid_rt_pro_trigger_gpio_hdl, 0) - GEN_MP_IOCTL_HANDLER(0, NULL, 0) - GEN_MP_IOCTL_HANDLER(0, NULL, 0) - GEN_MP_IOCTL_HANDLER(0, NULL, 0) -}; - -#else /* _RTW_MP_IOCTL_C_ */ - -extern struct mp_ioctl_handler mp_ioctl_hdl[]; - -#endif /* _RTW_MP_IOCTL_C_ */ - -#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_mp_phy_regdef.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_mp_phy_regdef.h index 5f79e46432c1..330ecbfdd957 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_mp_phy_regdef.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_mp_phy_regdef.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/rtw_odm.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_odm.h index e14119a5c287..913435e8b2b5 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_odm.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_odm.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +21,83 @@ /* * 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; + + +#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); void rtw_odm_get_perpkt_rssi(void *sel, _adapter *adapter); void rtw_odm_acquirespinlock(_adapter *adapter, enum rt_spinlock_type type); void rtw_odm_releasespinlock(_adapter *adapter, enum rt_spinlock_type type); -u8 rtw_odm_get_dfs_domain(_adapter *adapter); -u8 rtw_odm_dfs_domain_unknown(_adapter *adapter); +u8 rtw_odm_get_dfs_domain(struct dvobj_priv *dvobj); +u8 rtw_odm_dfs_domain_unknown(struct dvobj_priv *dvobj); #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); +void rtw_odm_radar_detect_reset(_adapter *adapter); +void rtw_odm_radar_detect_disable(_adapter *adapter); +void rtw_odm_radar_detect_enable(_adapter *adapter); BOOLEAN rtw_odm_radar_detect(_adapter *adapter); +u8 rtw_odm_radar_detect_polling_int_ms(struct dvobj_priv *dvobj); #endif /* CONFIG_DFS_MASTER */ void rtw_odm_parse_rx_phy_status_chinfo(union recv_frame *rframe, u8 *phys); +#if defined(CONFIG_RTL8822C) && defined(CONFIG_LPS_PG) +void odm_iqk_get_cfir2fw_8822c(void *dm_void, u8 *buf, u32 *buf_size); +void odm_lps_pg_debug_8822c(void *dm_void); +#endif + #endif /* __RTW_ODM_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_p2p.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_p2p.h index 844f7ec8a021..697b2fcaae31 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_p2p.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_p2p.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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_ @@ -75,6 +71,7 @@ u8 p2p_ps_wk_cmd(_adapter *padapter, u8 p2p_ps_state, u8 enqueue); #endif /* CONFIG_P2P_PS */ #ifdef CONFIG_IOCTL_CFG80211 +u8 roch_stay_in_cur_chan(_adapter *padapter); void rtw_init_cfg80211_wifidirect_info(_adapter *padapter); int rtw_p2p_check_frames(_adapter *padapter, const u8 *buf, u32 len, u8 tx); #endif /* CONFIG_IOCTL_CFG80211 */ @@ -106,11 +103,8 @@ static inline void _rtw_p2p_restore_state(struct wifidirect_info *wdinfo) } } #endif -static inline void _rtw_p2p_set_role(struct wifidirect_info *wdinfo, enum P2P_ROLE role) -{ - if (wdinfo->role != role) - wdinfo->role = role; -} +void _rtw_p2p_set_role(struct wifidirect_info *wdinfo, enum P2P_ROLE role); + static inline int _rtw_p2p_state(struct wifidirect_info *wdinfo) { return wdinfo->p2p_state; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_pwrctrl.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_pwrctrl.h index 1f170a9facad..437322764580 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_pwrctrl.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_pwrctrl.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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,17 +41,13 @@ #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*/ #ifdef CONFIG_WOW_PATTERN_HW_CAM /* Frame Mask Cam number for pattern match */ #define MAX_WKFM_CAM_NUM 12 @@ -98,6 +90,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 */ @@ -173,7 +172,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 @@ -305,8 +304,17 @@ struct aoac_report { u8 group_key[32]; u8 key_index; u8 security_type; + u8 wow_pattern_idx; + u8 version_info; + u8 rekey_ok:1; + u8 dummy:7; + u8 reserved[3]; + u8 rxptk_iv[8]; + u8 rxgtk_iv[4][8]; }; +struct rsvd_page_cache_t; + struct pwrctrl_priv { _pwrlock lock; _pwrlock check_32k_lock; @@ -314,11 +322,27 @@ struct pwrctrl_priv { volatile u8 cpwm; /* fw current power state. updated when 1. read from HCPWM 2. driver lowers power level */ volatile u8 tog; /* toggling */ volatile u8 cpwm_tog; /* toggling */ + u8 rpwm_retry; u8 pwr_mode; u8 smart_ps; u8 bcn_ant_mode; u8 dtim; +#ifdef CONFIG_LPS_CHK_BY_TP + u8 lps_chk_by_tp; + u16 lps_tx_tp_th;/*Mbps*/ + u16 lps_rx_tp_th;/*Mbps*/ + u16 lps_bi_tp_th;/*Mbps*//*TRX TP*/ + int lps_chk_cnt_th; + int lps_chk_cnt; + u32 lps_tx_pkts; + u32 lps_rx_pkts; + +#endif + +#ifdef CONFIG_WMMPS_STA + u8 wmm_smart_ps; +#endif /* CONFIG_WMMPS_STA */ u32 alives; _workitem cpwm_event; @@ -348,7 +372,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. */ @@ -365,12 +389,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; @@ -383,13 +409,19 @@ 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 */ + u8 hst2dev_high_active; #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_CAM_NUM]; #ifdef CONFIG_PNO_SUPPORT @@ -403,12 +435,13 @@ struct pwrctrl_priv { #endif u8 wowlan_aoac_rpt_loc; struct aoac_report wowlan_aoac_rpt; + u8 wowlan_power_mgmt; + u8 wowlan_lps_level; #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; */ @@ -435,19 +468,29 @@ struct pwrctrl_priv { u8 do_late_resume; #endif -#ifdef CONFIG_INTEL_PROXIM - u8 stored_power_mgnt; -#endif - #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; + struct rsvd_page_cache_t lpspg_info; +#ifdef CONFIG_RTL8822C + struct rsvd_page_cache_t lpspg_dpk_info; + struct rsvd_page_cache_t lpspg_iqk_info; +#endif #endif u8 current_lps_hw_port_id; + +#ifdef CONFIG_RTW_CFGVEDNOR_LLSTATS + systime radio_on_start_time; + systime pwr_saving_start_time; + u32 pwr_saving_time; + u32 on_time; + u32 tx_time; + u32 rx_time; +#endif /* CONFIG_RTW_CFGVEDNOR_LLSTATS */ + }; #define rtw_get_ips_mode_req(pwrctl) \ @@ -500,20 +543,27 @@ void rtw_ps_processor(_adapter *padapter); int autoresume_enter(_adapter *padapter); #endif #ifdef SUPPORT_HW_RFOFF_DETECTED -rt_rf_power_state RfOnOffDetect(IN PADAPTER pAdapter); +rt_rf_power_state RfOnOffDetect(PADAPTER pAdapter); #endif +#ifdef DBG_CHECK_FW_PS_STATE int rtw_fw_ps_state(PADAPTER padapter); +#endif #ifdef CONFIG_LPS -s32 LPS_RF_ON_check(PADAPTER padapter, u32 delay_ms); void LPS_Enter(PADAPTER padapter, const char *msg); void LPS_Leave(PADAPTER padapter, const char *msg); +#ifdef CONFIG_CHECK_LEAVE_LPS +#ifdef CONFIG_LPS_CHK_BY_TP +void traffic_check_for_leave_lps_by_tp(PADAPTER padapter, u8 tx, struct sta_info *sta); +#endif void traffic_check_for_leave_lps(PADAPTER padapter, u8 tx, u32 tx_packets); +#endif /*CONFIG_CHECK_LEAVE_LPS*/ 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); +u8 rtw_set_rpwm(_adapter *padapter, u8 val8); +void rtw_wow_lps_level_decide(_adapter *adapter, u8 wow_en); #endif #ifdef CONFIG_RESUME_IN_WORKQUEUE @@ -541,6 +591,11 @@ 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); +#ifdef CONFIG_WOWLAN +int rtw_pm_set_wow_lps(_adapter *padapter, u8 mode); +int rtw_pm_set_wow_lps_level(_adapter *padapter, u8 level); +#endif /* CONFIG_WOWLAN */ void rtw_ps_deny(PADAPTER padapter, PS_DENY_REASON reason); void rtw_ps_deny_cancel(PADAPTER padapter, PS_DENY_REASON reason); @@ -556,4 +611,6 @@ void rtw_wow_pattern_sw_reset(_adapter *adapter); u8 rtw_set_default_pattern(_adapter *adapter); void rtw_wow_pattern_sw_dump(_adapter *adapter); #endif /* CONFIG_WOWLAN */ +void rtw_ssmps_enter(_adapter *adapter, struct sta_info *sta); +void rtw_ssmps_leave(_adapter *adapter, struct sta_info *sta); #endif /* __RTL871X_PWRCTRL_H_ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_qos.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_qos.h index 57555e12d73d..c3011b4148d3 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_qos.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_qos.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,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/rtl8188eu/include/rtw_recv.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_recv.h index 349ca3f25fc4..34e5b53e902e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_recv.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_recv.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,48 +12,40 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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_ -#ifdef PLATFORM_OS_XP - #ifdef CONFIG_SDIO_HCI - #define NR_RECVBUFF 1024/* 512 */ /* 128 */ - #else - #define NR_RECVBUFF (16) - #endif -#elif defined(PLATFORM_OS_CE) - #ifdef CONFIG_SDIO_HCI - #define NR_RECVBUFF (128) - #else - #define NR_RECVBUFF (4) - #endif -#else /* PLATFORM_LINUX /PLATFORM_BSD */ +#define RTW_RX_MSDU_ACT_NONE 0 +#define RTW_RX_MSDU_ACT_INDICATE BIT0 +#define RTW_RX_MSDU_ACT_FORWARD BIT1 - #ifdef CONFIG_SINGLE_RECV_BUF - #define NR_RECVBUFF (1) +#ifdef CONFIG_SINGLE_RECV_BUF + #define NR_RECVBUFF (1) +#else + #if defined(CONFIG_GSPI_HCI) + #define NR_RECVBUFF (32) + #elif defined(CONFIG_SDIO_HCI) + #define NR_RECVBUFF (8) #else - #if defined(CONFIG_GSPI_HCI) - #define NR_RECVBUFF (32) - #elif defined(CONFIG_SDIO_HCI) - #define NR_RECVBUFF (8) - #else - #define NR_RECVBUFF (8) - #endif - #endif /* CONFIG_SINGLE_RECV_BUF */ - #ifdef CONFIG_PREALLOC_RX_SKB_BUFFER - #define NR_PREALLOC_RECV_SKB (rtw_rtkm_get_nr_recv_skb()>>1) - #else /*!CONFIG_PREALLOC_RX_SKB_BUFFER */ - #define NR_PREALLOC_RECV_SKB 8 - #endif /* CONFIG_PREALLOC_RX_SKB_BUFFER */ + #define NR_RECVBUFF (8) + #endif +#endif /* CONFIG_SINGLE_RECV_BUF */ +#ifdef CONFIG_PREALLOC_RX_SKB_BUFFER + #define NR_PREALLOC_RECV_SKB (rtw_rtkm_get_nr_recv_skb()>>1) +#else /*!CONFIG_PREALLOC_RX_SKB_BUFFER */ + #define NR_PREALLOC_RECV_SKB 8 +#endif /* CONFIG_PREALLOC_RX_SKB_BUFFER */ - #ifdef CONFIG_RTW_NAPI - #define RTL_NAPI_WEIGHT (32) +#ifdef CONFIG_RTW_NAPI + #define RTL_NAPI_WEIGHT (32) +#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 @@ -78,24 +71,15 @@ #define RX_CMD_QUEUE 1 #define RX_MAX_QUEUE 2 -static u8 SNAP_ETH_TYPE_IPX[2] = {0x81, 0x37}; - -static u8 SNAP_ETH_TYPE_APPLETALK_AARP[2] = {0x80, 0xf3}; -static u8 SNAP_ETH_TYPE_APPLETALK_DDP[2] = {0x80, 0x9b}; -static u8 SNAP_ETH_TYPE_TDLS[2] = {0x89, 0x0d}; -static u8 SNAP_HDR_APPLETALK_DDP[3] = {0x08, 0x00, 0x07}; /* Datagram Delivery Protocol */ - -static u8 oui_8021h[] = {0x00, 0x00, 0xf8}; -static u8 oui_rfc1042[] = {0x00, 0x00, 0x00}; - #define MAX_SUBFRAME_COUNT 64 -static u8 rtw_rfc1042_header[] = { 0xaa, 0xaa, 0x03, 0x00, 0x00, 0x00 }; /* Bridge-Tunnel header (for EtherTypes ETH_P_AARP and ETH_P_IPX) */ -static u8 rtw_bridge_tunnel_header[] = { 0xaa, 0xaa, 0x03, 0x00, 0x00, 0xf8 }; +extern u8 rtw_bridge_tunnel_header[]; +extern u8 rtw_rfc1042_header[]; /* 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; @@ -109,6 +93,7 @@ struct recv_reorder_ctrl { struct stainfo_rxcache { u16 tid_rxseq[16]; u8 iv[16][8]; + u8 last_tid; #if 0 unsigned short tid0_rxseq; unsigned short tid1_rxseq; @@ -143,69 +128,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; @@ -220,6 +142,8 @@ struct rx_raw_rssi { }; +#include "cmn_info/rtw_sta_info.h" + struct rx_pkt_attrib { u16 pkt_len; u8 physt; @@ -251,14 +175,15 @@ struct rx_pkt_attrib { u8 ta[ETH_ALEN]; u8 ra[ETH_ALEN]; u8 bssid[ETH_ALEN]; +#ifdef CONFIG_RTW_MESH + u8 msa[ETH_ALEN]; /* mesh sa */ + u8 mda[ETH_ALEN]; /* mesh da */ + u8 mesh_ctrl_present; + u8 mesh_ctrl_len; /* length of mesh control field */ +#endif 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; @@ -270,17 +195,22 @@ struct rx_pkt_attrib { u8 pkt_rpt_type; u32 tsfl; u32 MacIDValidEntry[2]; /* 64 bits present 64 entry. */ + u8 ppdu_cnt; + u32 free_cnt; /* free run counter */ + struct phydm_phyinfo_struct phy_info; -#if 0 - u8 signal_qual; - s8 rx_mimo_signal_qual[2]; - u8 signal_strength; - u32 RxPWDBAll; - s32 RecvSignalPower; -#endif - struct phy_info phy_info; +#ifdef CONFIG_TCP_CSUM_OFFLOAD_RX + /* checksum offload realted varaiables */ + u8 csum_valid; /* Checksum valid, 0: not check, 1: checked */ + u8 csum_err; /* Checksum Error occurs */ +#endif /* CONFIG_TCP_CSUM_OFFLOAD_RX */ }; +#ifdef CONFIG_RTW_MESH +#define RATTRIB_GET_MCTRL_LEN(rattrib) ((rattrib)->mesh_ctrl_len) +#else +#define RATTRIB_GET_MCTRL_LEN(rattrib) 0 +#endif /* These definition is used for Rx packet reordering. */ #define SN_LESS(a, b) (((a-b) & 0x800) != 0) @@ -289,7 +219,11 @@ struct rx_pkt_attrib { /* #define REORDER_ENTRY_NUM 128 */ #define REORDER_WAIT_TIME (50) /* (ms) */ -#define RECVBUFF_ALIGN_SZ 8 +#if defined(CONFIG_PLATFORM_RTK390X) && defined(CONFIG_USB_HCI) + #define RECVBUFF_ALIGN_SZ 32 +#else + #define RECVBUFF_ALIGN_SZ 8 +#endif #ifdef CONFIG_TRX_BD_ARCH #define RX_WIFI_INFO_SIZE 24 @@ -319,7 +253,7 @@ struct recv_stat { unsigned int rxdw1; -#if !((defined(CONFIG_RTL8192E) || defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C)) && defined(CONFIG_PCI_HCI)) /* exclude 8192ee, 8814ae, 8822be, 8821ce */ +#if !((defined(CONFIG_RTL8192E) || defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822C)) && defined(CONFIG_PCI_HCI)) /* exclude 8192ee, 8814ae, 8822be, 8821ce */ unsigned int rxdw2; unsigned int rxdw3; @@ -368,12 +302,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 */ @@ -387,26 +326,33 @@ 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 - _nic_hdl RxPktPoolHdl; - _nic_hdl RxBufPoolHdl; - -#ifdef PLATFORM_OS_XP - PMDL pbytecnt_mdl; -#endif - uint counter; /* record the number that up-layer will return to drv; only when counter==0 can we release recv_priv */ - NDIS_EVENT recv_resource_evt ; -#endif - - 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; @@ -428,20 +374,16 @@ struct recv_priv { #endif #if defined(PLATFORM_LINUX) || defined(PLATFORM_FREEBSD) -#ifdef PLATFORM_FREEBSD - struct task irq_prepare_beacon_tasklet; - struct task recv_tasklet; -#else /* PLATFORM_FREEBSD */ - struct tasklet_struct irq_prepare_beacon_tasklet; - struct tasklet_struct recv_tasklet; -#endif /* PLATFORM_FREEBSD */ + _tasklet irq_prepare_beacon_tasklet; + _tasklet recv_tasklet; + 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; #endif #ifdef CONFIG_RX_INDICATE_QUEUE - struct task rx_indicate_tasklet; + _tasklet rx_indicate_tasklet; struct ifqueue rx_indicate_queue; #endif /* CONFIG_RX_INDICATE_QUEUE */ @@ -460,7 +402,7 @@ struct recv_priv { /* Rx */ struct rtw_rx_ring rx_ring[PCI_MAX_RX_QUEUE]; int rxringcount; /* size should be PCI_MAX_RX_QUEUE */ - u16 rxbuffersize; + u32 rxbuffersize; #endif /* For display the phy informatiom */ @@ -472,7 +414,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; */ @@ -493,6 +434,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 */ @@ -506,6 +471,9 @@ struct sta_recv_priv { _queue defrag_q; /* keeping the fragment frame until defrag */ struct stainfo_rxcache rxcache; + u16 bmc_tid_rxseq[16]; + u16 nonqos_rxseq; + u16 nonqos_bmc_rxseq; /* uint sta_rx_bytes; */ /* uint sta_rx_pkts; */ @@ -533,32 +501,19 @@ struct recv_buf { u8 *pend; #ifdef CONFIG_USB_HCI - -#if defined(PLATFORM_OS_XP) || defined(PLATFORM_LINUX) || defined(PLATFORM_FREEBSD) PURB purb; dma_addr_t dma_transfer_addr; /* (in) dma addr for transfer_buffer */ u32 alloc_sz; -#endif - -#ifdef PLATFORM_OS_XP - PIRP pirp; -#endif - -#ifdef PLATFORM_OS_CE - USB_TRANSFER usb_transfer_read_port; -#endif u8 irp_pending; int transfer_len; - #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 }; @@ -579,13 +534,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; @@ -659,7 +608,9 @@ 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); @@ -800,22 +751,6 @@ __inline static u8 *recvframe_pull_tail(union recv_frame *precvframe, sint sz) } - - -__inline static _buffer *get_rxbuf_desc(union recv_frame *precvframe) -{ - _buffer *buf_desc; - - if (precvframe == NULL) - return NULL; -#ifdef PLATFORM_WINDOWS - NdisQueryPacket(precvframe->u.hdr.pkt, NULL, NULL, &buf_desc, NULL); -#endif - - return buf_desc; -} - - __inline static union recv_frame *rxmem_to_recvframe(u8 *rxmem) { /* due to the design of 2048 bytes alignment of recv_frame, we can reference the union recv_frame */ @@ -831,13 +766,6 @@ __inline static union recv_frame *pkt_to_recvframe(_pkt *pkt) u8 *buf_star; union recv_frame *precv_frame; -#ifdef PLATFORM_WINDOWS - _buffer *buf_desc; - uint len; - - NdisQueryPacket(pkt, NULL, NULL, &buf_desc, &len); - NdisQueryBufferSafe(buf_desc, &buf_star, &len, HighPagePriority); -#endif precv_frame = rxmem_to_recvframe((unsigned char *)buf_star); return precv_frame; @@ -874,25 +802,19 @@ __inline static s32 translate_percentage_to_dbm(u32 SignalStrengthIndex) { s32 SignalPower; /* in dBm. */ -#ifdef CONFIG_SIGNAL_SCALE_MAPPING - /* Translate to dBm (x=0.5y-95). */ - SignalPower = (s32)((SignalStrengthIndex + 1) >> 1); - SignalPower -= 95; -#else /* Translate to dBm (x=y-100) */ SignalPower = SignalStrengthIndex - 100; -#endif - 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); +void count_rx_stats(_adapter *padapter, union recv_frame *prframe, struct sta_info *sta); #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_rf.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_rf.h index 6e5b0cc8870a..b0d8a266822a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_rf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_rf.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,40 +12,18 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 NumRates (13) - +#define B_MODE_RATE_NUM (4) +#define G_MODE_RATE_NUM (8) +#define G_MODE_BASIC_RATE_NUM (3) /* 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 */ @@ -53,6 +32,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]; @@ -74,24 +57,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, @@ -117,25 +82,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 */ @@ -156,22 +102,12 @@ 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)]) +#define ch_width_str(bw) (((bw) < CHANNEL_WIDTH_MAX) ? _ch_width_str[(bw)] : "CHANNEL_WIDTH_MAX") extern const u8 _ch_width_to_bw_cap[]; -#define ch_width_to_bw_cap(bw) (((bw) >= CHANNEL_WIDTH_MAX) ? _ch_width_to_bw_cap[CHANNEL_WIDTH_MAX] : _ch_width_to_bw_cap[(bw)]) +#define ch_width_to_bw_cap(bw) (((bw) < CHANNEL_WIDTH_MAX) ? _ch_width_to_bw_cap[(bw)] : 0) /* * Represent Extention Channel Offset in HT Capabilities @@ -204,21 +140,7 @@ 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, - - RF_TYPE_AUTO, -} RT_RF_TYPE_DEF_E; - -#define RF_TYPE_VALID(rf_type) (rf_type < RF_TYPE_AUTO) +#define RF_TYPE_VALID(rf_type) (rf_type < RF_TYPE_MAX) 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) @@ -230,41 +152,47 @@ int rtw_ch2freq(int chan); int rtw_freq2ch(int freq); bool rtw_chbw_to_freq_range(u8 ch, u8 bw, u8 offset, u32 *hi, u32 *lo); -#define RTW_MODULE_RTL8821AE_HMC_M2 BIT0 /* RTL8821AE(HMC + M.2) */ -#define RTW_MODULE_RTL8821AU BIT1 /* RTL8821AU */ -#define RTW_MODULE_RTL8812AENF_NGFF BIT2 /* RTL8812AENF(8812AE+8761)_NGFF */ -#define RTW_MODULE_RTL8812AEBT_HMC BIT3 /* RTL8812AEBT(8812AE+8761)_HMC */ -#define RTW_MODULE_RTL8188EE_HMC_M2 BIT4 /* RTL8188EE(HMC + M.2) */ -#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) */ +struct rf_ctl_t; -#define IS_ALPHA2_NO_SPECIFIED(_alpha2) ((*((u16 *)(_alpha2))) == 0xFFFF) +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_ACMA = 6, + TXPWR_LMT_CHILE = 7, + TXPWR_LMT_WW = 8, /* smallest of all available limit, keep last */ +} REGULATION_TXPWR_LMT; -struct country_chplan { - char alpha2[2]; - u8 chplan; -#ifdef CONFIG_80211AC_VHT - u8 en_11ac; -#endif -#if RTW_DEF_MODULE_REGULATORY_CERT - u8 def_module_flags; /* RTW_MODULE_RTLXXX */ -#endif +extern const char *const _regd_str[]; +#define regd_str(regd) (((regd) > TXPWR_LMT_WW) ? _regd_str[TXPWR_LMT_WW] : _regd_str[(regd)]) + +#if CONFIG_TXPWR_LIMIT +struct regd_exc_ent { + _list list; + char country[2]; + u8 domain; + char regd_name[0]; }; -#ifdef CONFIG_80211AC_VHT -#define COUNTRY_CHPLAN_EN_11AC(_ent) ((_ent)->en_11ac) -#else -#define COUNTRY_CHPLAN_EN_11AC(_ent) 0 -#endif +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); -#if RTW_DEF_MODULE_REGULATORY_CERT -#define COUNTRY_CHPLAN_DEF_MODULE_FALGS(_ent) ((_ent)->def_module_flags) -#else -#define COUNTRY_CHPLAN_DEF_MODULE_FALGS(_ent) 0 -#endif - -const struct country_chplan *rtw_get_chplan_from_country(const char *country_code); +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 @@ -285,8 +213,26 @@ 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); +/* only check channel ranges */ +#define rtw_is_2g_ch(ch) (ch >= 1 && ch <= 14) +#define rtw_is_5g_ch(ch) ((ch) >= 36 && (ch) <= 177) +#define rtw_is_same_band(a, b) \ + ((rtw_is_2g_ch(a) && rtw_is_2g_ch(b)) \ + || (rtw_is_5g_ch(a) && rtw_is_5g_ch(b))) + +#define rtw_is_5g_band1(ch) ((ch) >= 36 && (ch) <= 48) +#define rtw_is_5g_band2(ch) ((ch) >= 52 && (ch) <= 64) +#define rtw_is_5g_band3(ch) ((ch) >= 100 && (ch) <= 144) +#define rtw_is_5g_band4(ch) ((ch) >= 149 && (ch) <= 177) +#define rtw_is_same_5g_band(a, b) \ + ((rtw_is_5g_band1(a) && rtw_is_5g_band1(b)) \ + || (rtw_is_5g_band2(a) && rtw_is_5g_band2(b)) \ + || (rtw_is_5g_band3(a) && rtw_is_5g_band3(b)) \ + || (rtw_is_5g_band4(a) && rtw_is_5g_band4(b))) + +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/rtl8188eu/include/rtw_rm.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_rm.h new file mode 100644 index 000000000000..840015d6b44a --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_rm.h @@ -0,0 +1,89 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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); + +u8 rm_add_nb_req(_adapter *padapter, struct sta_info *psta); + +#endif /*CONFIG_RTW_80211K */ +#endif /* __RTW_RM_H_ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_rm_fsm.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_rm_fsm.h new file mode 100644 index 000000000000..8b319666c0b9 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_rm_fsm.h @@ -0,0 +1,390 @@ +/* SPDX-License-Identifier: GPL-2.0 */ + +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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/rtl8188eu/include/rtw_rson.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_rson.h new file mode 100644 index 000000000000..e9e27efe76f1 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_rson.h @@ -0,0 +1,62 @@ +/* SPDX-License-Identifier: GPL-2.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 __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/rtl8188eu/include/rtw_sdio.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_sdio.h index da86a3a408d5..b4d28e97e298 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_sdio.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_sdio.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/rtw_security.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_security.h index b27fabc35987..7641488cc2b2 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_security.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_security.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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_ @@ -27,16 +23,18 @@ #define _TKIP_WTMIC_ 0x3 #define _AES_ 0x4 #define _WEP104_ 0x5 -#define _WEP_WPA_MIXED_ 0x07 /* WEP + WPA */ #define _SMS4_ 0x06 -#ifdef CONFIG_IEEE80211W +#define _WEP_WPA_MIXED_ 0x07 /* WEP + WPA */ #define _BIP_ 0x8 -#endif /* CONFIG_IEEE80211W */ + /* 802.11W use wrong key */ #define IEEE80211W_RIGHT_KEY 0x0 #define IEEE80211W_WRONG_KEY 0x1 #define IEEE80211W_NO_KEY 0x2 +#define CCMPH_2_PN(ch) ((ch) & 0x000000000000ffff) \ + | (((ch) & 0xffffffff00000000) >> 16) + #define is_wep_enc(alg) (((alg) == _WEP40_) || ((alg) == _WEP104_)) const char *security_type_str(u8 value); @@ -129,24 +127,24 @@ struct security_priv { /* WEP */ u32 dot11PrivacyKeyIndex; /* this is only valid for legendary wep, 0~3 for key id. (tx key index) */ - union Keytype dot11DefKey[4]; /* this is only valid for def. key */ - u32 dot11DefKeylen[4]; - u8 dot11Def_camid[4]; + union Keytype dot11DefKey[6]; /* this is only valid for def. key */ + u32 dot11DefKeylen[6]; + u8 dot11Def_camid[6]; u8 key_mask; /* use to restore wep key after hal_init */ u32 dot118021XGrpPrivacy; /* This specify the privacy algthm. used for Grp key */ u32 dot118021XGrpKeyid; /* key id used for Grp Key ( tx key index) */ - union Keytype dot118021XGrpKey[4]; /* 802.1x Group Key, for inx0 and inx1 */ - union Keytype dot118021XGrptxmickey[4]; - union Keytype dot118021XGrprxmickey[4]; + union Keytype dot118021XGrpKey[6]; /* 802.1x Group Key, for inx0 and inx1 */ + union Keytype dot118021XGrptxmickey[6]; + union Keytype dot118021XGrprxmickey[6]; 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 */ - union pn48 dot11wBIPtxpn; /* PN48 used for Grp Key xmit. */ - union pn48 dot11wBIPrxpn; /* PN48 used for Grp Key recv. */ + union pn48 dot11wBIPtxpn; /* PN48 used for BIP xmit. */ + union pn48 dot11wBIPrxpn; /* PN48 used for BIP recv. */ #endif /* CONFIG_IEEE80211W */ #ifdef CONFIG_AP_MODE /* extend security capabilities for AP_MODE */ @@ -156,6 +154,7 @@ struct security_priv { unsigned int wpa2_group_cipher; unsigned int wpa_pairwise_cipher; unsigned int wpa2_pairwise_cipher; + u8 mfp_opt; #endif #ifdef CONFIG_CONCURRENT_MODE u8 dot118021x_bmc_cam_id; @@ -175,10 +174,12 @@ struct security_priv { u8 binstallBIPkey; #endif /* CONFIG_IEEE80211W */ u8 busetkipkey; - /* _timer tkip_timer; */ u8 bcheck_grpkey; u8 bgrpkey_handshake; + u8 auth_alg; + u8 auth_type; + u8 extauth_status; /* u8 packet_cnt; */ /* unused, removed */ s32 sw_encrypt;/* from registry_priv */ @@ -192,9 +193,6 @@ struct security_priv { u32 ndisencryptstatus; /* NDIS_802_11_ENCRYPTION_STATUS */ NDIS_802_11_WEP ndiswep; -#ifdef PLATFORM_WINDOWS - u8 KeyMaterial[16];/* variable length depending on above field. */ -#endif u8 assoc_info[600]; u8 szofcapability[256]; /* for wpa2 usage */ @@ -204,10 +202,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. */ @@ -246,6 +244,12 @@ struct security_priv { #endif /* DBG_SW_SEC_CNT */ }; +#ifdef CONFIG_IEEE80211W +#define SEC_IS_BIP_KEY_INSTALLED(sec) ((sec)->binstallBIPkey) +#else +#define SEC_IS_BIP_KEY_INSTALLED(sec) _FALSE +#endif + struct sha256_state { u64 length; u32 state[8], curlen; @@ -407,11 +411,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, @@ -446,8 +445,14 @@ static const unsigned long K[64] = { #define MIN(x, y) (((x) < (y)) ? (x) : (y)) #endif #ifdef CONFIG_IEEE80211W -int omac1_aes_128(u8 *key, u8 *data, size_t data_len, u8 *mac); +int omac1_aes_128(const u8 *key, const u8 *data, size_t data_len, u8 *mac); #endif /* CONFIG_IEEE80211W */ +#ifdef CONFIG_RTW_MESH_AEK +int aes_siv_encrypt(const u8 *key, const u8 *pw, size_t pwlen + , size_t num_elem, const u8 *addr[], const size_t *len, u8 *out); +int aes_siv_decrypt(const u8 *key, const u8 *iv_crypt, size_t iv_c_len + , size_t num_elem, const u8 *addr[], const size_t *len, u8 *out); +#endif void rtw_secmicsetkey(struct mic_data *pmicdata, u8 *key); void rtw_secmicappendbyte(struct mic_data *pmicdata, u8 b); void rtw_secmicappend(struct mic_data *pmicdata, u8 *src, u32 nBytes); @@ -469,10 +474,11 @@ u32 rtw_aes_decrypt(_adapter *padapter, u8 *precvframe); u32 rtw_tkip_decrypt(_adapter *padapter, u8 *precvframe); void rtw_wep_decrypt(_adapter *padapter, u8 *precvframe); #ifdef CONFIG_IEEE80211W -u32 rtw_BIP_verify(_adapter *padapter, u8 *precvframe); -#endif /* CONFIG_IEEE80211W */ +u32 rtw_BIP_verify(_adapter *padapter, u8 *whdr_pos, sint flen + , const u8 *key, u16 id, u64* ipn); +#endif #ifdef CONFIG_TDLS -void wpa_tdls_generate_tpk(_adapter *padapter, PVOID sta); +void wpa_tdls_generate_tpk(_adapter *padapter, void *sta); int wpa_tdls_ftie_mic(u8 *kck, u8 trans_seq, u8 *lnkid, u8 *rsnie, u8 *timeoutie, u8 *ftie, u8 *mic); @@ -482,8 +488,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); @@ -491,4 +495,10 @@ u8 rtw_handle_tkip_countermeasure(_adapter *adapter, const char *caller); u16 rtw_calc_crc(u8 *pdata, int length); #endif /*CONFIG_WOWLAN*/ +#define rtw_sec_chk_auth_alg(a, s) \ + ((a)->securitypriv.auth_alg == (s)) + +#define rtw_sec_chk_auth_type(a, s) \ + ((a)->securitypriv.auth_type == (s)) + #endif /* __RTL871X_SECURITY_H_ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_sreset.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_sreset.h index 0ecdfc7eb64f..c3dda35a90a3 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_sreset.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_sreset.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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_ @@ -26,16 +22,27 @@ enum { SRESET_TGP_NULL = 0, SRESET_TGP_XMIT_STATUS = 1, SRESET_TGP_LINK_STATUS = 2, + SRESET_TGP_INFO = 99, }; 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 tx_dma_status_cnt; + u64 rx_dma_status_cnt; + u8 rx_cnt; + u8 self_dect_fw; + u8 self_dect_case; + u16 last_mac_rxff_ptr; + u8 dbg_sreset_ctrl; }; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_tdls.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_tdls.h index ad16d6660a80..a18dd823c768 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_tdls.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_tdls.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +59,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,18 +109,26 @@ 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 enqueue_cmd); +void rtw_enable_tdls_func(_adapter *padapter); +void rtw_disable_tdls_func(_adapter *padapter, u8 enqueue_cmd); 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); -void free_tdls_sta(_adapter *padapter, struct sta_info *ptdls_sta); +void rtw_cancel_tdls_timer(struct sta_info *psta); +void rtw_tdls_teardown_pre_hdl(_adapter *padapter, struct sta_info *psta); +void rtw_tdls_teardown_post_hdl(_adapter *padapter, struct sta_info *psta, u8 enqueue_cmd); #ifdef CONFIG_TDLS_CH_SW void rtw_tdls_set_ch_sw_oper_control(_adapter *padapter, u8 enable); @@ -140,31 +154,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/rtl8188eu/include/rtw_version.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_version.h index 39b6b2a15a0a..d34e9a74c272 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_version.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_version.h @@ -1,2 +1,2 @@ /* SPDX-License-Identifier: GPL-2.0 */ -#define DRIVERVERSION "v5.2.2.3_24783.20171030" +#define DRIVERVERSION "v5.7.6.1_36803.20200508" diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_vht.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_vht.h index dda83f9109cb..1730f7d74bc3 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_vht.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_vht.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTW_VHT_H_ #define _RTW_VHT_H_ +#define VHT_CAP_IE_LEN 12 +#define VHT_OP_IE_LEN 5 + #define LDPC_VHT_ENABLE_RX BIT0 #define LDPC_VHT_ENABLE_TX BIT1 #define LDPC_VHT_TEST_TX_ENABLE BIT2 @@ -30,15 +29,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) @@ -107,23 +97,61 @@ #define SET_EXT_CAPABILITY_ELE_OP_MODE_NOTIF(_pEleStart, _val) SET_BITS_TO_LE_1BYTE((_pEleStart)+7, 6, 1, _val) #define GET_EXT_CAPABILITY_ELE_OP_MODE_NOTIF(_pEleStart) LE_BITS_TO_1BYTE((_pEleStart)+7, 6, 1) +#define VHT_MAX_MPDU_LEN_MAX 3 +extern const u16 _vht_max_mpdu_len[]; +#define vht_max_mpdu_len(val) (((val) >= VHT_MAX_MPDU_LEN_MAX) ? _vht_max_mpdu_len[VHT_MAX_MPDU_LEN_MAX] : _vht_max_mpdu_len[(val)]) + +#define VHT_SUP_CH_WIDTH_SET_MAX 3 +extern const u8 _vht_sup_ch_width_set_to_bw_cap[]; +#define vht_sup_ch_width_set_to_bw_cap(set) (((set) >= VHT_SUP_CH_WIDTH_SET_MAX) ? _vht_sup_ch_width_set_to_bw_cap[VHT_SUP_CH_WIDTH_SET_MAX] : _vht_sup_ch_width_set_to_bw_cap[(set)]) +extern const char *const _vht_sup_ch_width_set_str[]; +#define vht_sup_ch_width_set_str(set) (((set) >= VHT_SUP_CH_WIDTH_SET_MAX) ? _vht_sup_ch_width_set_str[VHT_SUP_CH_WIDTH_SET_MAX] : _vht_sup_ch_width_set_str[(set)]) + +#define VHT_MAX_AMPDU_LEN(f) ((1 << (13 + f)) - 1) +void dump_vht_cap_ie(void *sel, const u8 *ie, u32 ie_len); + +#define VHT_OP_CH_WIDTH_MAX 4 +extern const char *const _vht_op_ch_width_str[]; +#define vht_op_ch_width_str(ch_width) (((ch_width) >= VHT_OP_CH_WIDTH_MAX) ? _vht_op_ch_width_str[VHT_OP_CH_WIDTH_MAX] : _vht_op_ch_width_str[(ch_width)]) + +void dump_vht_op_ie(void *sel, const u8 *ie, u32 ie_len); + struct vht_priv { u8 vht_option; u8 ldpc_cap; u8 stbc_cap; u16 beamform_cap; + u8 ap_is_mu_bfer; u8 sgi_80m;/* short GI */ u8 ampdu_len; - u8 vht_op_mode_notify; u8 vht_highest_rate; u8 vht_mcs_map[2]; - u8 vht_cap[32]; + u8 op_present:1; /* vht_op is present */ + u8 notify_present:1; /* vht_op_mode_notify is present */ + + u8 vht_cap[32]; + u8 vht_op[VHT_OP_IE_LEN]; + u8 vht_op_mode_notify; }; +#ifdef ROKU_PRIVATE +struct vht_priv_infra_ap { + + /* Infra mode, only store for AP's info, not intersection of STA and AP*/ + u8 ldpc_cap_infra_ap; + u8 stbc_cap_infra_ap; + u16 beamform_cap_infra_ap; + u8 vht_mcs_map_infra_ap[2]; + u8 vht_mcs_map_tx_infra_ap[2]; + u8 channel_width_infra_ap; + u8 number_of_streams_infra_ap; +}; +#endif /* ROKU_PRIVATE */ + 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_mcs_map_to_bitmap(u8 *mcs_map, u8 nss); @@ -131,14 +159,19 @@ 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); u32 rtw_build_vht_cap_ie(_adapter *padapter, u8 *pbuf); -void update_sta_vht_info_apmode(_adapter *padapter, PVOID psta); +void update_sta_vht_info_apmode(_adapter *padapter, void *psta); void update_hw_vht_param(_adapter *padapter); void VHT_caps_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); +#ifdef ROKU_PRIVATE +void VHT_caps_handler_infra_ap(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); +#endif /* ROKU_PRIVATE */ void VHT_operation_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); -void rtw_process_vht_op_mode_notify(_adapter *padapter, u8 *pframe, PVOID sta); +void rtw_process_vht_op_mode_notify(_adapter *padapter, u8 *pframe, void *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); +void rtw_check_for_vht20(_adapter *adapter, u8 *ies, int ies_len); #endif /* _RTW_VHT_H_ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_wapi.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_wapi.h index 216ab6997c04..8e2479a46ba3 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_wapi.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_wapi.h @@ -1,4 +1,18 @@ /* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * 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 @@ -180,7 +194,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); @@ -212,4 +226,6 @@ u8 WapiIncreasePN(u8 *PN, u8 AddCount); bool rtw_wapi_drop_for_key_absent(_adapter *padapter, u8 *pRA); +void rtw_wapi_set_set_encryption(_adapter *padapter, struct ieee_param *param); + #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_wifi_regd.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_wifi_regd.h index 541a211f9511..b5c5d62ff76e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_wifi_regd.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_wifi_regd.h @@ -1,7 +1,16 @@ /* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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. * *****************************************************************************/ @@ -20,7 +29,7 @@ enum country_code_type_t { COUNTRY_CODE_MAX }; -int rtw_regd_init(_adapter *padapter); -void rtw_reg_notify_by_driver(_adapter *adapter); +void rtw_regd_apply_flags(struct wiphy *wiphy); +int rtw_regd_init(struct wiphy *wiphy); #endif /* __RTW_WIFI_REGD_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_xmit.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_xmit.h index 46bda68269f4..051eed49565e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_xmit.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/rtw_xmit.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2019 Realtek Corporation. * * This program is 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 +12,22 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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_ #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) #ifdef CONFIG_TX_AGGREGATION - #define MAX_XMITBUF_SZ (20480) /* 20k */ + #ifdef CONFIG_RTL8822C + #ifdef CONFIG_SDIO_TX_FORMAT_DUMMY_AUTO + #define MAX_XMITBUF_SZ (51200) + #else + #define MAX_XMITBUF_SZ (32764) + #endif + #else + #define MAX_XMITBUF_SZ (20480) /* 20k */ + #endif /* #define SDIO_TX_AGG_MAX 5 */ #else #define MAX_XMITBUF_SZ (1664) @@ -32,6 +36,7 @@ #if defined CONFIG_SDIO_HCI #define NR_XMITBUFF (16) + #define SDIO_TX_DIV_NUM (2) #endif #if defined(CONFIG_GSPI_HCI) #define NR_XMITBUFF (128) @@ -62,23 +67,25 @@ #else #define MAX_XMITBUF_SZ (1664) #endif +#ifdef CONFIG_PCI_TX_POLLING + #define NR_XMITBUFF (256) +#else #define NR_XMITBUFF (128) #endif +#endif -#ifdef PLATFORM_OS_CE + +#ifdef CONFIG_PCI_HCI #define XMITBUF_ALIGN_SZ 4 #else - #ifdef CONFIG_PCI_HCI - #define XMITBUF_ALIGN_SZ 4 + #ifdef USB_XMITBUF_ALIGN_SZ + #define XMITBUF_ALIGN_SZ (USB_XMITBUF_ALIGN_SZ) #else - #ifdef USB_XMITBUF_ALIGN_SZ - #define XMITBUF_ALIGN_SZ (USB_XMITBUF_ALIGN_SZ) - #else - #define XMITBUF_ALIGN_SZ 512 - #endif + #define XMITBUF_ALIGN_SZ 512 #endif #endif + /* xmit extension buff defination */ #define MAX_XMIT_EXTBUF_SZ (1536) @@ -89,13 +96,15 @@ #endif #ifdef CONFIG_RTL8812A - #define MAX_CMDBUF_SZ (512*14) + #define MAX_CMDBUF_SZ (512 * 18) #elif defined(CONFIG_RTL8723D) && defined(CONFIG_LPS_POFF) #define MAX_CMDBUF_SZ (128*70) /*(8960)*/ #else #define MAX_CMDBUF_SZ (5120) /* (4096) */ #endif +#define MAX_BEACON_LEN 512 + #define MAX_NUMBLKS (1) #define XMIT_VO_QUEUE (0) @@ -124,16 +133,17 @@ #define WEP_IV(pattrib_iv, dot11txpn, keyidx)\ do {\ + dot11txpn.val = (dot11txpn.val == 0xffffff) ? 0 : (dot11txpn.val + 1);\ pattrib_iv[0] = dot11txpn._byte_.TSC0;\ pattrib_iv[1] = dot11txpn._byte_.TSC1;\ pattrib_iv[2] = dot11txpn._byte_.TSC2;\ pattrib_iv[3] = ((keyidx & 0x3)<<6);\ - dot11txpn.val = (dot11txpn.val == 0xffffff) ? 0 : (dot11txpn.val+1);\ } while (0) #define TKIP_IV(pattrib_iv, dot11txpn, keyidx)\ do {\ + dot11txpn.val = dot11txpn.val == 0xffffffffffffULL ? 0 : (dot11txpn.val + 1);\ pattrib_iv[0] = dot11txpn._byte_.TSC1;\ pattrib_iv[1] = (dot11txpn._byte_.TSC1 | 0x20) & 0x7f;\ pattrib_iv[2] = dot11txpn._byte_.TSC0;\ @@ -142,11 +152,11 @@ pattrib_iv[5] = dot11txpn._byte_.TSC3;\ pattrib_iv[6] = dot11txpn._byte_.TSC4;\ pattrib_iv[7] = dot11txpn._byte_.TSC5;\ - dot11txpn.val = dot11txpn.val == 0xffffffffffffULL ? 0 : (dot11txpn.val+1);\ } while (0) #define AES_IV(pattrib_iv, dot11txpn, keyidx)\ do {\ + dot11txpn.val = dot11txpn.val == 0xffffffffffffULL ? 0 : (dot11txpn.val + 1);\ pattrib_iv[0] = dot11txpn._byte_.TSC0;\ pattrib_iv[1] = dot11txpn._byte_.TSC1;\ pattrib_iv[2] = 0;\ @@ -155,7 +165,6 @@ pattrib_iv[5] = dot11txpn._byte_.TSC3;\ pattrib_iv[6] = dot11txpn._byte_.TSC4;\ pattrib_iv[7] = dot11txpn._byte_.TSC5;\ - dot11txpn.val = dot11txpn.val == 0xffffffffffffULL ? 0 : (dot11txpn.val+1);\ } while (0) /* Check if AMPDU Tx is supported or not. If it is supported, @@ -187,9 +196,10 @@ #if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) ||\ defined(CONFIG_RTL8723B) || defined(CONFIG_RTL8192E) ||\ defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8703B) ||\ - defined(CONFIG_RTL8188F) || defined(CONFIG_RTL8723D) + defined(CONFIG_RTL8188F) || defined(CONFIG_RTL8188GTV) || defined(CONFIG_RTL8723D) ||\ + defined(CONFIG_RTL8710B) || defined(CONFIG_RTL8192F) #define TXDESC_SIZE 40 -#elif defined(CONFIG_RTL8822B) +#elif defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8822C) #define TXDESC_SIZE 48 /* HALMAC_TX_DESC_SIZE_8822B */ #elif defined(CONFIG_RTL8821C) #define TXDESC_SIZE 48 /* HALMAC_TX_DESC_SIZE_8821C */ @@ -216,7 +226,7 @@ #endif #ifdef CONFIG_PCI_HCI - #if defined(CONFIG_RTL8192E) || defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_TRX_BD_ARCH) + #if defined(CONFIG_RTL8192E) || defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822C) || defined(CONFIG_TRX_BD_ARCH) /* this section is defined for buffer descriptor ring architecture */ #define TX_WIFI_INFO_SIZE (TXDESC_SIZE) /* it may add 802.11 hdr or others... */ /* tx desc and payload are in the same buf */ @@ -241,7 +251,8 @@ enum TXDESC_SC { #define TXDESC_64_BYTES #endif #elif defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8723B) \ - || defined(CONFIG_RTL8188F) || defined(CONFIG_RTL8723D) + || defined(CONFIG_RTL8188F) || defined(CONFIG_RTL8188GTV) || defined(CONFIG_RTL8723D) \ + || defined(CONFIG_RTL8192F) #define TXDESC_40_BYTES #endif @@ -254,7 +265,7 @@ struct tx_buf_desc { #endif unsigned int dword[TX_BUFFER_SEG_SIZE * (2 << TX_BUFFER_SEG_NUM)]; } __packed; -#elif (defined(CONFIG_RTL8192E) || defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B)) && defined(CONFIG_PCI_HCI) /* 8192ee or 8814ae */ +#elif (defined(CONFIG_RTL8192E) || defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8822C)) && defined(CONFIG_PCI_HCI) /* 8192ee or 8814ae */ /* 8192EE_TODO */ struct tx_desc { unsigned int txdw0; @@ -324,6 +335,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 { @@ -380,9 +406,6 @@ struct pkt_attrib { u16 seqnum; struct sta_info *psta; -#ifdef CONFIG_TCP_CSUM_OFFLOAD_TX - u8 hw_tcp_csum; -#endif }; #else /* reduce size */ @@ -415,6 +438,20 @@ struct pkt_attrib { u8 src[ETH_ALEN]; u8 ta[ETH_ALEN]; u8 ra[ETH_ALEN]; +#ifdef CONFIG_RTW_MESH + u8 mda[ETH_ALEN]; /* mesh da */ + u8 msa[ETH_ALEN]; /* mesh sa */ + u8 meshctrl_len; /* Length of Mesh Control field */ + u8 mesh_frame_mode; + #if CONFIG_RTW_MESH_DATA_BMC_TO_UC + u8 mb2u; + #endif + u8 mfwd_ttl; + u32 mseq; +#endif +#ifdef CONFIG_TX_CSUM_OFFLOAD + u8 hw_csum; +#endif u8 key_idx; u8 qos_en; u8 ht_en; @@ -438,10 +475,11 @@ 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; -#endif u8 rtsen; u8 cts2self; @@ -473,6 +511,12 @@ struct pkt_attrib { }; #endif +#ifdef CONFIG_RTW_MESH +#define XATTRIB_GET_MCTRL_LEN(xattrib) ((xattrib)->meshctrl_len) +#else +#define XATTRIB_GET_MCTRL_LEN(xattrib) 0 +#endif + #ifdef CONFIG_TX_AMSDU enum { RTW_AMSDU_TIMER_UNSET = 0, @@ -505,7 +549,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 @@ -527,6 +571,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, }; @@ -563,18 +608,8 @@ struct xmit_buf { u8 bulkout_id; /* for halmac */ #endif /* RTW_HALMAC */ -#if defined(PLATFORM_OS_XP) || defined(PLATFORM_LINUX) || defined(PLATFORM_FREEBSD) PURB pxmit_urb[8]; dma_addr_t dma_transfer_addr; /* (in) dma addr for transfer_buffer */ -#endif - -#ifdef PLATFORM_OS_XP - PIRP pxmit_irp[8]; -#endif - -#ifdef PLATFORM_OS_CE - USB_TRANSFER usb_transfer_write_port; -#endif u8 bpending[8]; @@ -590,11 +625,6 @@ struct xmit_buf { u32 ff_hwaddr; u8 pg_num; u8 agg_num; -#ifdef PLATFORM_OS_XP - PMDL pxmitbuf_mdl; - PIRP pxmitbuf_irp; - PSDBUS_REQUEST_PACKET pxmitbuf_sdrp; -#endif #endif #ifdef CONFIG_PCI_HCI @@ -708,7 +738,6 @@ struct xmit_priv { _lock lock; _sema xmit_sema; - _sema terminate_xmitthread_sema; /* _queue blk_strms[MAX_NUMBLKS]; */ _queue be_pending; @@ -762,16 +791,8 @@ struct xmit_priv { _sema tx_retevt;/* all tx return event; */ u8 txirp_cnt; -#ifdef PLATFORM_OS_CE - USB_TRANSFER usb_transfer_write_port; - /* USB_TRANSFER usb_transfer_write_mem; */ -#endif -#ifdef PLATFORM_LINUX - struct tasklet_struct xmit_tasklet; -#endif -#ifdef PLATFORM_FREEBSD - struct task xmit_tasklet; -#endif + _tasklet xmit_tasklet; + /* per AC pending irp */ int beq_cnt; int bkq_cnt; @@ -785,20 +806,15 @@ struct xmit_priv { struct rtw_tx_ring tx_ring[PCI_MAX_TX_QUEUE_COUNT]; int txringcount[PCI_MAX_TX_QUEUE_COUNT]; u8 beaconDMAing; /* flag of indicating beacon is transmiting to HW by DMA */ -#ifdef PLATFORM_LINUX - struct tasklet_struct xmit_tasklet; -#endif + _tasklet xmit_tasklet; #endif #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) #ifdef CONFIG_SDIO_TX_TASKLET -#ifdef PLATFORM_LINUX - struct tasklet_struct xmit_tasklet; -#endif /* PLATFORM_LINUX */ + _tasklet xmit_tasklet; #else _thread_hdl_ SdioXmitThread; _sema SdioXmitSema; - _sema SdioXmitTerminateSema; #endif /* CONFIG_SDIO_TX_TASKLET */ #endif /* CONFIG_SDIO_HCI */ @@ -852,8 +868,15 @@ struct xmit_priv { u32 amsdu_debug_coalesce_one; u32 amsdu_debug_coalesce_two; +#endif +#ifdef DBG_TXBD_DESC_DUMP + BOOLEAN dump_txbd_desc; +#endif +#ifdef CONFIG_PCI_TX_POLLING + _timer tx_poll_timer; #endif _lock lock_sctx; + }; extern struct xmit_frame *__rtw_alloc_cmdxmitframe(struct xmit_priv *pxmitpriv, @@ -867,10 +890,34 @@ extern struct xmit_frame *__rtw_alloc_cmdxmitframe_8192ee(struct xmit_priv *pxmi extern struct xmit_frame *__rtw_alloc_cmdxmitframe_8822be(struct xmit_priv *pxmitpriv, enum cmdbuf_type buf_type); #define rtw_alloc_bcnxmitframe(p) __rtw_alloc_cmdxmitframe_8822be(p, CMDBUF_BEACON) +#elif defined(CONFIG_RTL8822C) && defined(CONFIG_PCI_HCI) +extern struct xmit_frame *__rtw_alloc_cmdxmitframe_8822ce(struct xmit_priv *pxmitpriv, + enum cmdbuf_type buf_type); +#define rtw_alloc_bcnxmitframe(p) __rtw_alloc_cmdxmitframe_8822ce(p, CMDBUF_BEACON) #elif defined(CONFIG_RTL8821C) && defined(CONFIG_PCI_HCI) extern struct xmit_frame *__rtw_alloc_cmdxmitframe_8821ce(struct xmit_priv *pxmitpriv, enum cmdbuf_type buf_type); #define rtw_alloc_bcnxmitframe(p) __rtw_alloc_cmdxmitframe_8821ce(p, CMDBUF_BEACON) +#elif defined(CONFIG_RTL8192F) && defined(CONFIG_PCI_HCI) +extern struct xmit_frame *__rtw_alloc_cmdxmitframe_8192fe(struct xmit_priv *pxmitpriv, + enum cmdbuf_type buf_type); +#define rtw_alloc_bcnxmitframe(p) __rtw_alloc_cmdxmitframe_8192fe(p, CMDBUF_BEACON) +#elif defined(CONFIG_RTL8812A) && defined(CONFIG_PCI_HCI) +extern struct xmit_frame *__rtw_alloc_cmdxmitframe_8812ae(struct xmit_priv *pxmitpriv, + enum cmdbuf_type buf_type); +#define rtw_alloc_bcnxmitframe(p) __rtw_alloc_cmdxmitframe_8812ae(p, CMDBUF_BEACON) +#elif defined(CONFIG_RTL8723D) && defined(CONFIG_PCI_HCI) +extern struct xmit_frame *__rtw_alloc_cmdxmitframe_8723de(struct xmit_priv *pxmitpriv, + enum cmdbuf_type buf_type); +#define rtw_alloc_bcnxmitframe(p) __rtw_alloc_cmdxmitframe_8723de(p, CMDBUF_BEACON) +#elif defined(CONFIG_RTL8723B) && defined(CONFIG_PCI_HCI) +extern struct xmit_frame *__rtw_alloc_cmdxmitframe_8723be(struct xmit_priv *pxmitpriv, + enum cmdbuf_type buf_type); +#define rtw_alloc_bcnxmitframe(p) __rtw_alloc_cmdxmitframe_8723be(p, CMDBUF_BEACON) +#elif defined(CONFIG_RTL8814A) && defined(CONFIG_PCI_HCI) +extern struct xmit_frame *__rtw_alloc_cmdxmitframe_8814ae(struct xmit_priv *pxmitpriv, + enum cmdbuf_type buf_type); +#define rtw_alloc_bcnxmitframe(p) __rtw_alloc_cmdxmitframe_8814ae(p, CMDBUF_BEACON) #else #define rtw_alloc_bcnxmitframe(p) __rtw_alloc_cmdxmitframe(p, CMDBUF_BEACON) #endif @@ -883,8 +930,7 @@ extern s32 rtw_free_xmitbuf(struct xmit_priv *pxmitpriv, struct xmit_buf *pxmitb void rtw_count_tx_stats(_adapter *padapter, struct xmit_frame *pxmitframe, int sz); 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); + extern s32 rtw_make_wlanhdr(_adapter *padapter, u8 *hdr, struct pkt_attrib *pattrib); extern s32 rtw_put_snap(u8 *data, u16 h_proto); @@ -901,9 +947,9 @@ extern s32 rtw_xmit_classifier(_adapter *padapter, struct xmit_frame *pxmitframe extern u32 rtw_calculate_wlan_pkt_size_by_attribue(struct pkt_attrib *pattrib); #define rtw_wlan_pkt_size(f) rtw_calculate_wlan_pkt_size_by_attribue(&f->attrib) extern s32 rtw_xmitframe_coalesce(_adapter *padapter, _pkt *pkt, struct xmit_frame *pxmitframe); -#ifdef CONFIG_IEEE80211W +#if defined(CONFIG_IEEE80211W) || defined(CONFIG_RTW_MESH) extern s32 rtw_mgmt_xmitframe_coalesce(_adapter *padapter, _pkt *pkt, struct xmit_frame *pxmitframe); -#endif /* CONFIG_IEEE80211W */ +#endif #ifdef CONFIG_TDLS extern struct tdls_txmgmt *ptxmgmt; s32 rtw_xmit_tdls_coalesce(_adapter *padapter, struct xmit_frame *pxmitframe, struct tdls_txmgmt *ptxmgmt); @@ -927,6 +973,10 @@ void rtw_free_hwxmits(_adapter *padapter); #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 24)) s32 rtw_monitor_xmit_entry(struct sk_buff *skb, struct net_device *ndev); #endif +void rtw_xmit_dequeue_callback(_workitem *work); +void rtw_xmit_queue_set(struct sta_info *sta); +void rtw_xmit_queue_clear(struct sta_info *sta); +s32 rtw_xmit_posthandle(_adapter *padapter, struct xmit_frame *pxmitframe, _pkt *pkt); s32 rtw_xmit(_adapter *padapter, _pkt **pkt); bool xmitframe_hiq_filter(struct xmit_frame *xmitframe); #if defined(CONFIG_AP_MODE) || defined(CONFIG_TDLS) @@ -976,7 +1026,19 @@ extern s32 check_amsdu_tx_support(_adapter *padapter); extern struct xmit_frame *rtw_get_xframe(struct xmit_priv *pxmitpriv, int *num_frame); #endif -static void do_queue_select(_adapter *padapter, struct pkt_attrib *pattrib); +#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 + +#ifdef CONFIG_PCI_TX_POLLING +void rtw_tx_poll_init(_adapter *padapter); +void rtw_tx_poll_timeout_handler(void *FunctionContext); +void rtw_tx_poll_timer_set(_adapter *padapter, u32 delay); +void rtw_tx_poll_timer_cancel(_adapter *padapter); +#endif + u32 rtw_get_ff_hwaddr(struct xmit_frame *pxmitframe); #ifdef CONFIG_XMIT_ACK @@ -984,6 +1046,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/rtl8188eu/include/sdio_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/sdio_hal.h index c8f554d676d6..39ae2c9ad745 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/sdio_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/sdio_hal.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -51,4 +47,12 @@ void rtl8723ds_set_hal_ops(PADAPTER padapter); void rtl8188fs_set_hal_ops(PADAPTER padapter); #endif +#ifdef CONFIG_RTL8188GTV +void rtl8188gtvs_set_hal_ops(PADAPTER padapter); +#endif + +#ifdef CONFIG_RTL8192F +void rtl8192fs_set_hal_ops(PADAPTER padapter); +#endif + #endif /* __SDIO_HAL_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/sdio_ops.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/sdio_ops.h index abf36f8c3f7b..57e6ec0680b8 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/sdio_ops.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/sdio_ops.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -30,26 +26,14 @@ #include #endif -#ifdef PLATFORM_WINDOWS - -#ifdef PLATFORM_OS_XP -#include -struct async_context { - PMDL pmdl; - PSDBUS_REQUEST_PACKET sdrp; - unsigned char *r_buf; - unsigned char *padapter; -}; -#endif - -#ifdef PLATFORM_OS_CE -#include -#endif - -#endif /* PLATFORM_WINDOWS */ - - 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); +u8 sdio_get_num_of_func(struct dvobj_priv *dvobj); #if 0 extern void sdio_func1cmd52_read(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *rmem); @@ -90,7 +74,7 @@ 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) || defined(CONFIG_RTL8822C) u8 rtw_hal_enable_cpwm2(_adapter *adapter); #endif extern u8 RecvOnePkt(PADAPTER padapter); @@ -145,6 +129,20 @@ extern void ClearInterrupt8723DSdio(PADAPTER padapter); #endif /* CONFIG_WOWLAN */ #endif +#ifdef CONFIG_RTL8192F +extern void InitInterrupt8192FSdio(PADAPTER padapter); +extern void InitSysInterrupt8192FSdio(PADAPTER padapter); +extern void EnableInterrupt8192FSdio(PADAPTER padapter); +extern void DisableInterrupt8192FSdio(PADAPTER padapter); +extern void UpdateInterruptMask8192FSdio(PADAPTER padapter, u32 AddMSR, u32 RemoveMSR); +extern u8 HalQueryTxBufferStatus8192FSdio(PADAPTER padapter); +extern u8 HalQueryTxOQTBufferStatus8192FSdio(PADAPTER padapter); +#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) +extern void DisableInterruptButCpwm2192fSdio(PADAPTER padapter); +extern void ClearInterrupt8192FSdio(PADAPTER padapter); +#endif /* CONFIG_WOWLAN */ +#endif + #ifdef CONFIG_RTL8188F extern void InitInterrupt8188FSdio(PADAPTER padapter); extern void InitSysInterrupt8188FSdio(PADAPTER padapter); @@ -158,4 +156,52 @@ extern void ClearInterrupt8188FSdio(PADAPTER padapter); #endif /* defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) */ #endif +#ifdef CONFIG_RTL8188GTV +extern void InitInterrupt8188GTVSdio(PADAPTER padapter); +extern void InitSysInterrupt8188GTVSdio(PADAPTER padapter); +extern void EnableInterrupt8188GTVSdio(PADAPTER padapter); +extern void DisableInterrupt8188GTVSdio(PADAPTER padapter); +extern u8 HalQueryTxBufferStatus8188GTVSdio(PADAPTER padapter); +extern u8 HalQueryTxOQTBufferStatus8188GTVSdio(PADAPTER padapter); +#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) +extern void DisableInterruptButCpwm28188GTVSdio(PADAPTER padapter); +extern void ClearInterrupt8188GTVSdio(PADAPTER padapter); +#endif /* defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) */ +#endif + +/** + * rtw_sdio_get_block_size() - Get block size of SDIO transfer + * @d struct dvobj_priv* + * + * The unit of return value is byte. + */ +static inline u32 rtw_sdio_get_block_size(struct dvobj_priv *d) +{ + return d->intf_data.block_transfer_len; +} + +/** + * rtw_sdio_cmd53_align_size() - Align size to one CMD53 could complete + * @d struct dvobj_priv* + * @len length to align + * + * Adjust len to align block size, and the new size could be transfered by one + * CMD53. + * If len < block size, it would keep original value, otherwise the value + * would be rounded up by block size. + * + * Return adjusted length. + */ +static inline size_t rtw_sdio_cmd53_align_size(struct dvobj_priv *d, size_t len) +{ + u32 blk_sz; + + + blk_sz = rtw_sdio_get_block_size(d); + if (len <= blk_sz) + return len; + + return _RND(len, blk_sz); +} + #endif /* !__SDIO_OPS_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/sdio_ops_ce.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/sdio_ops_ce.h index 59ca38127cb3..b4e994bddd99 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/sdio_ops_ce.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/sdio_ops_ce.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/sdio_ops_linux.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/sdio_ops_linux.h index 46c3ddceee2d..bc0862fbc4a3 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/sdio_ops_linux.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/sdio_ops_linux.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +36,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/rtl8188eu/include/sdio_ops_xp.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/sdio_ops_xp.h index 5020365c3589..a00a25c38fbc 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/sdio_ops_xp.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/sdio_ops_xp.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/sdio_osintf.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/sdio_osintf.h index d2906bd1d8a6..b2bcf57dbc74 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/sdio_osintf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/sdio_osintf.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,20 +12,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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __SDIO_OSINTF_H__ #define __SDIO_OSINTF_H__ -#ifdef PLATFORM_OS_CE -extern NDIS_STATUS ce_sd_get_dev_hdl(PADAPTER padapter); -SD_API_STATUS ce_sd_int_callback(SD_DEVICE_HANDLE hDevice, PADAPTER padapter); -extern void sd_setup_irs(PADAPTER padapter); -#endif - #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/sta_info.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/sta_info.h index 22ccb0a61977..a88bb951b12b 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/sta_info.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/sta_info.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2019 Realtek Corporation. * * This program is 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 +12,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 @@ -33,14 +30,21 @@ #endif #define NUM_ACL 16 + +#define RTW_ACL_PERIOD_DEV 0 +#define RTW_ACL_PERIOD_BSS 1 +#define RTW_ACL_PERIOD_NUM 2 + #define RTW_ACL_MODE_DISABLED 0 #define RTW_ACL_MODE_ACCEPT_UNLESS_LISTED 1 #define RTW_ACL_MODE_DENY_UNLESS_LISTED 2 #define RTW_ACL_MODE_MAX 3 #if CONFIG_RTW_MACADDR_ACL -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)]) +extern const char *const _acl_period_str[RTW_ACL_PERIOD_NUM]; +#define acl_period_str(mode) (((mode) >= RTW_ACL_PERIOD_NUM) ? "INVALID" : _acl_period_str[(mode)]) +extern const char *const _acl_mode_str[RTW_ACL_MODE_MAX]; +#define acl_mode_str(mode) (((mode) >= RTW_ACL_MODE_MAX) ? "INVALID" : _acl_mode_str[(mode)]) #endif #ifndef RTW_PRE_LINK_STA_NUM @@ -92,56 +96,73 @@ struct wlan_acl_pool { _queue acl_node_q; }; -typedef struct _RSSI_STA { - - s32 undecorated_smoothed_pwdb; - s32 undecorated_smoothed_cck; - s32 undecorated_smoothed_ofdm; - u8 ofdm_pkt; - u8 cck_pkt; - u16 cck_sum_power; - u8 is_send_rssi; - u64 packet_map; - u8 valid_bit; -} RSSI_STA, *PRSSI_STA; - struct stainfo_stats { + systime last_rx_time; u64 rx_mgnt_pkts; - u64 rx_beacon_pkts; - u64 rx_probereq_pkts; - u64 rx_probersp_pkts; - u64 rx_probersp_bm_pkts; - u64 rx_probersp_uo_pkts; + u64 rx_beacon_pkts; + u64 rx_probereq_pkts; + u64 rx_probersp_pkts; /* unicast to self */ + u64 rx_probersp_bm_pkts; + u64 rx_probersp_uo_pkts; /* unicast to others */ u64 rx_ctrl_pkts; u64 rx_data_pkts; - u64 rx_data_last_pkts; /* For Read & Clear requirement in proc_get_rx_stat() */ - 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_bm_pkts; - u64 last_rx_probersp_uo_pkts; + u64 last_rx_beacon_pkts; + u64 last_rx_probereq_pkts; + u64 last_rx_probersp_pkts; /* unicast to self */ + u64 last_rx_probersp_bm_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 */ + u32 rx_tp_kbits; + u32 smooth_rx_tp_kbits; u64 tx_pkts; - u64 tx_bytes; - u64 tx_drops; + u64 last_tx_pkts; + u64 tx_bytes; + u64 last_tx_bytes; + u64 tx_drops; /* TBD */ + u32 tx_tp_kbits; + u32 smooth_tx_tp_kbits; + +#ifdef CONFIG_LPS_CHK_BY_TP + u64 acc_tx_bytes; + u64 acc_rx_bytes; +#endif + + /* 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() */ +#ifdef CONFIG_RTW_MESH + u32 rx_hwmp_pkts; + u32 last_rx_hwmp_pkts; +#endif }; #ifndef DBG_SESSION_TRACKER @@ -162,7 +183,7 @@ struct session_tracker { u16 local_port; u32 remote_naddr; u16 remote_port; - u32 set_time; + systime set_time; u8 status; }; @@ -201,6 +222,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 @@ -222,6 +244,21 @@ struct sta_recv_dframe_info { }; #endif +#ifdef CONFIG_RTW_MESH +struct mesh_plink_ent; +struct rtw_ewma_err_rate { + unsigned long internal; +}; + +/* Mesh airtime link metrics parameters */ +struct rtw_atlm_param { + struct rtw_ewma_err_rate err_rate; /* Now is PACKET error rate */ + u16 data_rate; /* The unit is 100Kbps */ + u16 total_pkt; + u16 overhead; /* Channel access overhead */ +}; +#endif + struct sta_info { _lock lock; @@ -231,23 +268,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... */ @@ -255,39 +295,38 @@ struct sta_info { union Keytype dot11tkiprxmickey; union Keytype dot118021x_UncstKey; union pn48 dot11txpn; /* PN48 used for Unicast xmit */ + union pn48 dot11rxpn; /* PN48 used for Unicast recv. */ +#ifdef CONFIG_RTW_MESH + /* peer's GTK, RX only */ + u8 group_privacy; + u8 gtk_bmp; + union Keytype gtk; + union pn48 gtk_pn; + #ifdef CONFIG_IEEE80211W + /* peer's IGTK, RX only */ + u8 igtk_bmp; + u8 igtk_id; + union Keytype igtk; + union pn48 igtk_pn; + #endif /* CONFIG_IEEE80211W */ +#endif /* CONFIG_RTW_MESH */ #ifdef CONFIG_GTK_OL u8 kek[RTW_KEK_LEN]; u8 kck[RTW_KCK_LEN]; u8 replay_ctr[RTW_REPLAY_CTR_LEN]; #endif /* CONFIG_GTK_OL */ #ifdef CONFIG_IEEE80211W - union pn48 dot11wtxpn; /* PN48 used for Unicast mgmt xmit. */ _timer dot11w_expire_timer; #endif /* CONFIG_IEEE80211W */ - union pn48 dot11rxpn; /* PN48 used for Unicast recv. */ - 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; @@ -363,6 +402,8 @@ struct sta_info { int wpa_pairwise_cipher; int wpa2_pairwise_cipher; + u32 akm_suite_type; + u8 bpairwise_key_installed; #ifdef CONFIG_RTW_80211R u8 ft_pairwise_key_installed; @@ -429,46 +470,62 @@ struct sta_info { #endif /* CONFIG_AP_MODE */ +#ifdef CONFIG_RTW_MESH + struct mesh_plink_ent *plink; + + u8 local_mps; + u8 peer_mps; + u8 nonpeer_mps; + + struct rtw_atlm_param metrics; + /* The reference for nexthop_lookup */ + BOOLEAN alive; +#endif + #ifdef CONFIG_IOCTL_CFG80211 + u8 *pauth_frame; + u32 auth_len; u8 *passoc_req; 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; +#ifdef CONFIG_RTS_FULL_BW + bool vendor_8812; +#endif + + /* + * Vaiables for queuing TX pkt a short period of time + * to wait something ready. + */ + u8 tx_q_enable; + struct __queue tx_queue; + _workitem tx_q_work; }; +#ifdef CONFIG_RTW_MESH +#define STA_SET_MESH_PLINK(sta, link) (sta)->plink = link +#else +#define STA_SET_MESH_PLINK(sta, link) do {} while (0) +#endif + +#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 \ @@ -479,15 +536,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]) @@ -527,8 +584,19 @@ struct sta_info { #define sta_last_rx_probersp_uo_pkts(sta) \ (sta->sta_stats.last_rx_probersp_uo_pkts) +#ifdef CONFIG_RTW_MESH +#define update_last_rx_hwmp_pkts(sta) \ + do { \ + sta->sta_stats.last_rx_hwmp_pkts = sta->sta_stats.rx_hwmp_pkts; \ + } while(0) +#else +#define update_last_rx_hwmp_pkts(sta) do {} while(0) +#endif + #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; \ @@ -536,7 +604,13 @@ 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; \ + update_last_rx_hwmp_pkts(sta); \ + \ 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) \ @@ -556,6 +630,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) @@ -564,6 +641,8 @@ struct sta_info { #define STA_SET_OP_WFD_MODE(sta, mode) do {} while (0) #endif +#define AID_BMP_LEN(max_aid) ((max_aid + 1) / 8 + (((max_aid + 1) % 8) ? 1 : 0)) + struct sta_priv { u8 *pallocated_stainfo_buf; @@ -580,6 +659,8 @@ struct sta_priv { u32 adhoc_expire_to; + int rx_chk_limit; + #ifdef CONFIG_AP_MODE _list asoc_list; _list auth_list; @@ -592,19 +673,22 @@ struct sta_priv { unsigned int assoc_to; /* sec, time to expire before associating. */ unsigned int expire_to; /* sec , time to expire after associated. */ - /* pointers to STA info; based on allocated AID or NULL if AID free - * AID is in the range 1-2007, so sta_aid[0] corresponders to AID 1 - * and so on - */ - struct sta_info *sta_aid[NUM_STA]; - - u16 sta_dz_bitmap;/* only support 15 stations, staion aid bitmap for sleeping sta. */ - u16 tim_bitmap;/* only support 15 stations, aid=0~15 mapping bit0~bit15 */ + /* + * pointers to STA info; based on allocated AID or NULL if AID free + * AID is in the range 1-2007, so sta_aid[0] corresponders to AID 1 + */ + struct sta_info **sta_aid; + u16 max_aid; + u16 started_aid; /* started AID for allocation search */ + bool rr_aid; /* round robin AID allocation, will modify started_aid */ + u8 aid_bmp_len; /* in byte */ + u8 *sta_dz_bitmap; + u8 *tim_bitmap; u16 max_num_sta; #if CONFIG_RTW_MACADDR_ACL - struct wlan_acl_pool acl_list; + struct wlan_acl_pool acl_list[RTW_ACL_PERIOD_NUM]; #endif #if CONFIG_RTW_PRE_LINK_STA @@ -616,12 +700,13 @@ struct sta_priv { #ifdef CONFIG_ATMEL_RC_PATCH u8 atmel_rc_pattern[6]; #endif - struct sta_info *c2h_sta; + u8 c2h_sta_mac[ETH_ALEN]; + u8 c2h_adapter_id; struct submit_ctx *gotc2h; }; -__inline static u32 wifi_mac_hash(u8 *mac) +__inline static u32 wifi_mac_hash(const u8 *mac) { u32 x; @@ -646,15 +731,20 @@ extern u32 _rtw_free_sta_priv(struct sta_priv *pstapriv); int rtw_stainfo_offset(struct sta_priv *stapriv, struct sta_info *sta); struct sta_info *rtw_get_stainfo_by_offset(struct sta_priv *stapriv, int offset); -extern struct sta_info *rtw_alloc_stainfo(struct sta_priv *pstapriv, u8 *hwaddr); +extern struct sta_info *rtw_alloc_stainfo(struct sta_priv *pstapriv, const u8 *hwaddr); extern u32 rtw_free_stainfo(_adapter *padapter , struct sta_info *psta); extern void rtw_free_all_stainfo(_adapter *padapter); -extern struct sta_info *rtw_get_stainfo(struct sta_priv *pstapriv, u8 *hwaddr); +extern struct sta_info *rtw_get_stainfo(struct sta_priv *pstapriv, const u8 *hwaddr); extern u32 rtw_init_bcmc_stainfo(_adapter *padapter); extern struct sta_info *rtw_get_bcmc_stainfo(_adapter *padapter); +#ifdef CONFIG_AP_MODE +u16 rtw_aid_alloc(_adapter *adapter, struct sta_info *sta); +void dump_aid_status(void *sel, _adapter *adapter); +#endif + #if CONFIG_RTW_MACADDR_ACL -extern u8 rtw_access_ctrl(_adapter *adapter, u8 *mac_addr); +extern u8 rtw_access_ctrl(_adapter *adapter, const u8 *mac_addr); void dump_macaddr_acl(void *sel, _adapter *adapter); #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/usb_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/usb_hal.h index 7e556e4421d5..155ee5b858ab 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/usb_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/usb_hal.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -53,6 +49,10 @@ void rtl8814au_set_hal_ops(_adapter *padapter); void rtl8188fu_set_hal_ops(_adapter *padapter); #endif +#ifdef CONFIG_RTL8188GTV +void rtl8188gtvu_set_hal_ops(_adapter *padapter); +#endif + #ifdef CONFIG_RTL8703B void rtl8703bu_set_hal_ops(_adapter *padapter); #endif @@ -61,7 +61,12 @@ void rtl8703bu_set_hal_ops(_adapter *padapter); void rtl8723du_set_hal_ops(_adapter *padapter); #endif -#ifdef CONFIG_INTEL_PROXIM -extern _adapter *rtw_usb_get_sw_pointer(void); -#endif /* CONFIG_INTEL_PROXIM */ +#ifdef CONFIG_RTL8710B +void rtl8710bu_set_hal_ops(_adapter *padapter); +#endif + +#ifdef CONFIG_RTL8192F +void rtl8192fu_set_hal_ops(_adapter *padapter); +#endif /* CONFIG_RTL8192F */ + #endif /* __USB_HAL_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/usb_ops.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/usb_ops.h index 350a675b421f..fa7d81958584 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/usb_ops.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/usb_ops.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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_ @@ -75,6 +71,13 @@ void interrupt_handler_8188fu(_adapter *padapter, u16 pkt_len, u8 *pbuf); #endif #endif +#ifdef CONFIG_RTL8188GTV +void rtl8188gtvu_set_hw_type(struct dvobj_priv *pdvobj); +#ifdef CONFIG_SUPPORT_USB_INT +void interrupt_handler_8188gtvu(_adapter *padapter, u16 pkt_len, u8 *pbuf); +#endif +#endif + #ifdef CONFIG_RTL8723B void rtl8723bu_set_hw_type(struct dvobj_priv *pdvobj); #ifdef CONFIG_SUPPORT_USB_INT @@ -101,6 +104,24 @@ void interrupt_handler_8723du(_adapter *padapter, u16 pkt_len, u8 *pbuf); #endif /* CONFIG_SUPPORT_USB_INT */ #endif /* CONFIG_RTL8723D */ +#ifdef CONFIG_RTL8710B +void rtl8710bu_set_hw_type(struct dvobj_priv *pdvobj); +void rtl8710bu_set_intf_ops(struct _io_ops *pops); +void rtl8710bu_recv_tasklet(void *priv); +void rtl8710bu_xmit_tasklet(void *priv); +#ifdef CONFIG_SUPPORT_USB_INT +void interrupt_handler_8710bu(_adapter *padapter, u16 pkt_len, u8 *pbuf); +#endif /* CONFIG_SUPPORT_USB_INT */ +#endif /* CONFIG_RTL8710B */ + +#ifdef CONFIG_RTL8192F +void rtl8192fu_set_hw_type(struct dvobj_priv *pdvobj); +void rtl8192fu_xmit_tasklet(void *priv); +#ifdef CONFIG_SUPPORT_USB_INT +void rtl8192fu_interrupt_handler(_adapter *padapter, u16 pkt_len, u8 *pbuf); +#endif /* CONFIG_SUPPORT_USB_INT */ +#endif /* CONFIG_RTL8192F */ + enum RTW_USB_SPEED { RTW_USB_SPEED_UNKNOWN = 0, RTW_USB_SPEED_1_1 = 1, @@ -122,7 +143,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/rtl8188eu/include/usb_ops_linux.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/usb_ops_linux.h index adf075021c5b..6ed3b29b9de2 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/usb_ops_linux.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/usb_ops_linux.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/include/usb_osintf.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/usb_osintf.h index 9c395204978a..76c4443c0443 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/usb_osintf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/usb_osintf.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,18 +12,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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __USB_OSINTF_H #define __USB_OSINTF_H #include -#define USBD_HALTED(Status) ((ULONG)(Status) >> 30 == 3) +#define USBD_HALTED(Status) ((u32)(Status) >> 30 == 3) u8 usbvendorrequest(struct dvobj_priv *pdvobjpriv, RT_USB_BREQUEST brequest, RT_USB_WVALUE wvalue, u8 windex, void *data, u8 datalen, u8 isdirectionin); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/usb_vendor_req.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/usb_vendor_req.h index 2281d36112a8..0ed06373e217 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/usb_vendor_req.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/usb_vendor_req.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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_ @@ -52,10 +48,10 @@ typedef enum _RT_USB_WVALUE { #if 0 -BOOLEAN usbvendorrequest(PCE_USB_DEVICE CEdevice, RT_USB_BREQUEST bRequest, RT_USB_WVALUE wValue, UCHAR wIndex, PVOID Data, UCHAR DataLength, BOOLEAN isDirectionIn); -BOOLEAN CEusbGetStatusRequest(PCE_USB_DEVICE CEdevice, IN USHORT Op, IN USHORT Index, PVOID Data); -BOOLEAN CEusbFeatureRequest(PCE_USB_DEVICE CEdevice, IN USHORT Op, IN USHORT FeatureSelector, IN USHORT Index); -BOOLEAN CEusbGetDescriptorRequest(PCE_USB_DEVICE CEdevice, IN short urbLength, IN UCHAR DescriptorType, IN UCHAR Index, IN USHORT LanguageId, IN PVOID TransferBuffer, IN ULONG TransferBufferLength); +BOOLEAN usbvendorrequest(PCE_USB_DEVICE CEdevice, RT_USB_BREQUEST bRequest, RT_USB_WVALUE wValue, u8 wIndex, void *Data, u8 DataLength, BOOLEAN isDirectionIn); +BOOLEAN CEusbGetStatusRequest(PCE_USB_DEVICE CEdevice, u16 Op, u16 Index, void *Data); +BOOLEAN CEusbFeatureRequest(PCE_USB_DEVICE CEdevice, u16 Op, u16 FeatureSelector, u16 Index); +BOOLEAN CEusbGetDescriptorRequest(PCE_USB_DEVICE CEdevice, short urbLength, u8 DescriptorType, u8 Index, u16 LanguageId, void *TransferBuffer, u32 TransferBufferLength); #endif #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/wifi.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/wifi.h index efd5dc6f3d26..123b821f2498 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/wifi.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/wifi.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,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 _WIFI_H_ #define _WIFI_H_ -#ifdef BIT -/* #error "BIT define occurred earlier elsewhere!\n" */ -#undef BIT -#endif +#ifndef BIT #define BIT(x) (1 << (x)) +#endif #define WLAN_ETHHDR_LEN 14 @@ -49,6 +43,7 @@ #define WLAN_MAX_ETHFRM_LEN 1514 #define WLAN_ETHHDR_LEN 14 #define WLAN_WMM_LEN 24 +#define VENDOR_NAME_LEN 20 #ifdef CONFIG_APPEND_VENDOR_IE_ENABLE #define WLAN_MAX_VENDOR_IE_LEN 255 @@ -58,6 +53,13 @@ #define WIFI_PROBERESP_VENDOR_IE_BIT BIT(2) #define WIFI_ASSOCREQ_VENDOR_IE_BIT BIT(3) #define WIFI_ASSOCRESP_VENDOR_IE_BIT BIT(4) +#ifdef CONFIG_P2P +#define WIFI_P2P_PROBEREQ_VENDOR_IE_BIT BIT(5) +#define WIFI_P2P_PROBERESP_VENDOR_IE_BIT BIT(6) +#define WLAN_MAX_VENDOR_IE_MASK_MAX 7 +#else +#define WLAN_MAX_VENDOR_IE_MASK_MAX 5 +#endif #endif #define P80211CAPTURE_VERSION 0x80211001 @@ -97,6 +99,7 @@ enum WIFI_FRAME_SUBTYPE { /* below is for control frame */ WIFI_BF_REPORT_POLL = (BIT(6) | WIFI_CTRL_TYPE), WIFI_NDPA = (BIT(6) | BIT(4) | WIFI_CTRL_TYPE), + WIFI_BAR = (BIT(7) | WIFI_CTRL_TYPE), WIFI_PSPOLL = (BIT(7) | BIT(5) | WIFI_CTRL_TYPE), WIFI_RTS = (BIT(7) | BIT(5) | BIT(4) | WIFI_CTRL_TYPE), WIFI_CTS = (BIT(7) | BIT(6) | WIFI_CTRL_TYPE), @@ -405,31 +408,26 @@ enum WIFI_REG_DOMAIN { } while (0) -#define SetPriority(pbuf, tid) \ - do { \ - *(unsigned short *)(pbuf) |= cpu_to_le16(tid & 0xf); \ - } while (0) +/* QoS control field */ +#define SetPriority(qc, tid) SET_BITS_TO_LE_2BYTE(((u8 *)(qc)), 0, 4, tid) +#define SetEOSP(qc, eosp) SET_BITS_TO_LE_2BYTE(((u8 *)(qc)), 4, 1, eosp) +#define SetAckpolicy(qc, ack) SET_BITS_TO_LE_2BYTE(((u8 *)(qc)), 5, 2, ack) +#define SetAMsdu(qc, amsdu) SET_BITS_TO_LE_2BYTE(((u8 *)(qc)), 7, 1, amsdu) -#define GetPriority(pbuf) ((le16_to_cpu(*(unsigned short *)(pbuf))) & 0xf) +#define GetPriority(qc) LE_BITS_TO_2BYTE(((u8 *)(qc)), 0, 4) +#define GetEOSP(qc) LE_BITS_TO_2BYTE(((u8 *)(qc)), 4, 1) +#define GetAckpolicy(qc) LE_BITS_TO_2BYTE(((u8 *)(qc)), 5, 2) +#define GetAMsdu(qc) LE_BITS_TO_2BYTE(((u8 *)(qc)), 7, 1) -#define SetEOSP(pbuf, eosp) \ - do { \ - *(unsigned short *)(pbuf) |= cpu_to_le16((eosp & 1) << 4); \ - } while (0) +/* QoS control field (MSTA only) */ +#define set_mctrl_present(qc, p) SET_BITS_TO_LE_2BYTE(((u8 *)(qc)), 8, 1, p) +#define set_mps_lv(qc, lv) SET_BITS_TO_LE_2BYTE(((u8 *)(qc)), 9, 1, lv) +#define set_rspi(qc, rspi) SET_BITS_TO_LE_2BYTE(((u8 *)(qc)), 10, 1, rspi) -#define SetAckpolicy(pbuf, ack) \ - do { \ - *(unsigned short *)(pbuf) |= cpu_to_le16((ack & 3) << 5); \ - } while (0) +#define get_mctrl_present(qc) LE_BITS_TO_2BYTE(((u8 *)(qc)), 8, 1) +#define get_mps_lv(qc) LE_BITS_TO_2BYTE(((u8 *)(qc)), 9, 1) +#define get_rspi(qc) LE_BITS_TO_2BYTE(((u8 *)(qc)), 10, 1) -#define GetAckpolicy(pbuf) (((le16_to_cpu(*(unsigned short *)pbuf)) >> 5) & 0x3) - -#define GetAMsdu(pbuf) (((le16_to_cpu(*(unsigned short *)pbuf)) >> 7) & 0x1) - -#define SetAMsdu(pbuf, amsdu) \ - do { \ - *(unsigned short *)(pbuf) |= cpu_to_le16((amsdu & 1) << 7); \ - } while (0) #define GetAid(pbuf) (cpu_to_le16(*(unsigned short *)((SIZE_PTR)(pbuf) + 2)) & 0x3fff) @@ -451,7 +449,7 @@ enum WIFI_REG_DOMAIN { (addr[4] == 0xff) && (addr[5] == 0xff)) ? _TRUE : _FALSE \ ) -__inline static int IS_MCAST(unsigned char *da) +__inline static int IS_MCAST(const u8 *da) { if ((*da) & 0x01) return _TRUE; @@ -472,6 +470,7 @@ __inline static unsigned char *get_ta(unsigned char *pframe) return ta; } +/* can't apply to mesh mode */ __inline static unsigned char *get_da(unsigned char *pframe) { unsigned char *da; @@ -495,7 +494,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; @@ -519,6 +518,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; @@ -550,6 +550,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 ------------------------------------------------------------------------------*/ @@ -587,19 +603,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 @@ -742,14 +761,12 @@ typedef enum _ELEMENT_ID { #define _WEP_WPA_MIXED_PRIVACY_ 6 /* WEP + WPA */ #endif -#ifdef CONFIG_IEEE80211W #define _MME_IE_LENGTH_ 18 -#endif /* CONFIG_IEEE80211W */ + /*----------------------------------------------------------------------------- Below is the definition for WMM ------------------------------------------------------------------------------*/ #define _WMM_IE_Length_ 7 /* for WMM STA */ -#define _WMM_Para_Element_Length_ 24 /*----------------------------------------------------------------------------- @@ -775,7 +792,7 @@ typedef enum _ELEMENT_ID { * This structure refers to "HT BlockAckReq" as * described in 802.11n draft section 7.2.1.7.1 */ -#if defined(PLATFORM_LINUX) || defined(CONFIG_RTL8712FW) +#if defined(PLATFORM_LINUX) struct rtw_ieee80211_bar { unsigned short frame_control; unsigned short duration; @@ -791,7 +808,7 @@ struct rtw_ieee80211_bar { #define IEEE80211_BAR_CTRL_CBMTID_COMPRESSED_BA 0x0004 -#if defined(PLATFORM_LINUX) || defined(CONFIG_RTL8712FW) || defined(PLATFORM_FREEBSD) +#if defined(PLATFORM_LINUX) || defined(PLATFORM_FREEBSD) @@ -817,6 +834,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; @@ -824,7 +842,7 @@ struct ieee80211_ht_addt_info { unsigned short stbc_param; unsigned char basic_set[16]; } __attribute__((packed)); - +#endif struct HT_caps_element { union { @@ -870,72 +888,6 @@ struct ADDBA_request { #endif -#ifdef PLATFORM_WINDOWS - -#pragma pack(1) - -struct rtw_ieee80211_ht_cap { - unsigned short cap_info; - unsigned char ampdu_params_info; - unsigned char supp_mcs_set[16]; - unsigned short extended_ht_cap_info; - unsigned int tx_BF_cap_info; - unsigned char antenna_selection_info; -}; - - -struct ieee80211_ht_addt_info { - unsigned char control_chan; - unsigned char ht_param; - unsigned short operation_mode; - unsigned short stbc_param; - unsigned char basic_set[16]; -}; - -struct HT_caps_element { - union { - struct { - unsigned short HT_caps_info; - unsigned char AMPDU_para; - unsigned char MCS_rate[16]; - unsigned short HT_ext_caps; - unsigned int Beamforming_caps; - unsigned char ASEL_caps; - } HT_cap_element; - unsigned char HT_cap[26]; - }; -}; - -struct HT_info_element { - unsigned char primary_channel; - unsigned char infos[5]; - unsigned char MCS_rate[16]; -}; - -struct AC_param { - unsigned char ACI_AIFSN; - unsigned char CW; - unsigned short TXOP_limit; -}; - -struct WMM_para_element { - unsigned char QoS_info; - unsigned char reserved; - struct AC_param ac_param[4]; -}; - -struct ADDBA_request { - unsigned char dialog_token; - unsigned short BA_para_set; - unsigned short BA_timeout_value; - unsigned short BA_starting_seqctrl; -}; - - -#pragma pack() - -#endif - typedef enum _HT_CAP_AMPDU_FACTOR { MAX_AMPDU_FACTOR_8K = 0, MAX_AMPDU_FACTOR_16K = 1, @@ -943,6 +895,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 */ @@ -1009,7 +968,7 @@ typedef enum _HT_CAP_AMPDU_DENSITY { * According to IEEE802.11n spec size varies from 8K to 64K (in powers of 2) */ #define IEEE80211_MIN_AMPDU_BUF 0x8 -#define IEEE80211_MAX_AMPDU_BUF 0x40 +#define IEEE80211_MAX_AMPDU_BUF_HT 0x40 /* Spatial Multiplexing Power Save Modes */ @@ -1354,10 +1313,8 @@ enum P2P_PS_MODE { #define WFD_DEVINFO_PC_TDLS 0x0080 #define WFD_DEVINFO_HDCP_SUPPORT 0x0100 -#ifdef CONFIG_TX_MCAST2UNI #define IP_MCAST_MAC(mac) ((mac[0] == 0x01) && (mac[1] == 0x00) && (mac[2] == 0x5e)) #define ICMPV6_MCAST_MAC(mac) ((mac[0] == 0x33) && (mac[1] == 0x33) && (mac[2] != 0xff)) -#endif /* CONFIG_TX_MCAST2UNI */ #ifdef CONFIG_IOCTL_CFG80211 /* Regulatroy Domain */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/wlan_bssdef.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/wlan_bssdef.h index dd39e0c0a959..6f9db1b58317 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/wlan_bssdef.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/wlan_bssdef.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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__ @@ -30,51 +26,27 @@ #define NDIS_802_11_LENGTH_RATES 8 #define NDIS_802_11_LENGTH_RATES_EX 16 -typedef unsigned char NDIS_802_11_MAC_ADDRESS[6]; +typedef unsigned char NDIS_802_11_MAC_ADDRESS[ETH_ALEN]; typedef long NDIS_802_11_RSSI; /* in dBm */ typedef unsigned char NDIS_802_11_RATES[NDIS_802_11_LENGTH_RATES]; /* Set of 8 data rates */ typedef unsigned char NDIS_802_11_RATES_EX[NDIS_802_11_LENGTH_RATES_EX]; /* Set of 16 data rates */ - -typedef ULONG NDIS_802_11_KEY_INDEX; -typedef unsigned long long NDIS_802_11_KEY_RSC; - - typedef struct _NDIS_802_11_SSID { - ULONG SsidLength; - UCHAR Ssid[32]; + u32 SsidLength; + u8 Ssid[32]; } NDIS_802_11_SSID, *PNDIS_802_11_SSID; -typedef enum _NDIS_802_11_NETWORK_TYPE { - Ndis802_11FH, - Ndis802_11DS, - Ndis802_11OFDM5, - Ndis802_11OFDM24, - Ndis802_11NetworkTypeMax /* not a real type, defined as an upper bound */ -} NDIS_802_11_NETWORK_TYPE, *PNDIS_802_11_NETWORK_TYPE; - -typedef struct _NDIS_802_11_CONFIGURATION_FH { - ULONG Length; /* Length of structure */ - ULONG HopPattern; /* As defined by 802.11, MSB set */ - ULONG HopSet; /* to one if non-802.11 */ - ULONG DwellTime; /* units are Kusec */ -} NDIS_802_11_CONFIGURATION_FH, *PNDIS_802_11_CONFIGURATION_FH; - - /* FW will only save the channel number in DSConfig. ODI Handler will convert the channel number to freq. number. */ typedef struct _NDIS_802_11_CONFIGURATION { - ULONG Length; /* Length of structure */ - ULONG BeaconPeriod; /* units are Kusec */ - ULONG ATIMWindow; /* units are Kusec */ - ULONG DSConfig; /* channel number */ - NDIS_802_11_CONFIGURATION_FH FHConfig; + u32 Length; /* Length of structure */ + u32 BeaconPeriod; /* units are Kusec */ + u32 ATIMWindow; /* units are Kusec */ + u32 DSConfig; /* channel number */ } NDIS_802_11_CONFIGURATION, *PNDIS_802_11_CONFIGURATION; - - typedef enum _NDIS_802_11_NETWORK_INFRASTRUCTURE { Ndis802_11IBSS, Ndis802_11Infrastructure, @@ -82,64 +54,21 @@ typedef enum _NDIS_802_11_NETWORK_INFRASTRUCTURE { Ndis802_11InfrastructureMax, /* Not a real value, defined as upper bound */ Ndis802_11APMode, Ndis802_11Monitor, + Ndis802_11_mesh, } NDIS_802_11_NETWORK_INFRASTRUCTURE, *PNDIS_802_11_NETWORK_INFRASTRUCTURE; - - - - typedef struct _NDIS_802_11_FIXED_IEs { - UCHAR Timestamp[8]; - USHORT BeaconInterval; - USHORT Capabilities; + u8 Timestamp[8]; + u16 BeaconInterval; + u16 Capabilities; } NDIS_802_11_FIXED_IEs, *PNDIS_802_11_FIXED_IEs; - - typedef struct _NDIS_802_11_VARIABLE_IEs { - UCHAR ElementID; - UCHAR Length; - UCHAR data[1]; + u8 ElementID; + u8 Length; + u8 data[1]; } NDIS_802_11_VARIABLE_IEs, *PNDIS_802_11_VARIABLE_IEs; - - -/* - - - -Length is the 4 bytes multiples of the sume of - sizeof (NDIS_802_11_MAC_ADDRESS) + 2 + sizeof (NDIS_802_11_SSID) + sizeof (ULONG) -+ sizeof (NDIS_802_11_RSSI) + sizeof (NDIS_802_11_NETWORK_TYPE) + sizeof (NDIS_802_11_CONFIGURATION) -+ sizeof (NDIS_802_11_RATES_EX) + IELength - -Except the IELength, all other fields are fixed length. Therefore, we can define a marco to present the -partial sum. - -*/ -#if 0 -typedef struct _NDIS_WLAN_BSSID_EX { - ULONG Length; - NDIS_802_11_MAC_ADDRESS MacAddress; - UCHAR Reserved[2];/* [0]: IS beacon frame, [1]:optimum_antenna=>For antenna diversity; */ - NDIS_802_11_SSID Ssid; - ULONG Privacy; - NDIS_802_11_RSSI Rssi; - NDIS_802_11_NETWORK_TYPE NetworkTypeInUse; - NDIS_802_11_CONFIGURATION Configuration; - NDIS_802_11_NETWORK_INFRASTRUCTURE InfrastructureMode; - NDIS_802_11_RATES_EX SupportedRates; - ULONG IELength; - UCHAR IEs[MAX_IE_SZ]; /* (timestamp, beacon interval, and capability information) */ -} NDIS_WLAN_BSSID_EX, *PNDIS_WLAN_BSSID_EX; - - -typedef struct _NDIS_802_11_BSSID_LIST_EX { - ULONG NumberOfItems; - NDIS_WLAN_BSSID_EX Bssid[1]; -} NDIS_802_11_BSSID_LIST_EX, *PNDIS_802_11_BSSID_LIST_EX; -#endif - typedef enum _NDIS_802_11_AUTHENTICATION_MODE { Ndis802_11AuthModeOpen, Ndis802_11AuthModeShared, @@ -168,109 +97,13 @@ typedef enum _NDIS_802_11_WEP_STATUS { } NDIS_802_11_WEP_STATUS, *PNDIS_802_11_WEP_STATUS, NDIS_802_11_ENCRYPTION_STATUS, *PNDIS_802_11_ENCRYPTION_STATUS; - -#define NDIS_802_11_AI_REQFI_CAPABILITIES 1 -#define NDIS_802_11_AI_REQFI_LISTENINTERVAL 2 -#define NDIS_802_11_AI_REQFI_CURRENTAPADDRESS 4 - -#define NDIS_802_11_AI_RESFI_CAPABILITIES 1 -#define NDIS_802_11_AI_RESFI_STATUSCODE 2 -#define NDIS_802_11_AI_RESFI_ASSOCIATIONID 4 - -typedef struct _NDIS_802_11_AI_REQFI { - USHORT Capabilities; - USHORT ListenInterval; - NDIS_802_11_MAC_ADDRESS CurrentAPAddress; -} NDIS_802_11_AI_REQFI, *PNDIS_802_11_AI_REQFI; - -typedef struct _NDIS_802_11_AI_RESFI { - USHORT Capabilities; - USHORT StatusCode; - USHORT AssociationId; -} NDIS_802_11_AI_RESFI, *PNDIS_802_11_AI_RESFI; - -typedef struct _NDIS_802_11_ASSOCIATION_INFORMATION { - ULONG Length; - USHORT AvailableRequestFixedIEs; - NDIS_802_11_AI_REQFI RequestFixedIEs; - ULONG RequestIELength; - ULONG OffsetRequestIEs; - USHORT AvailableResponseFixedIEs; - NDIS_802_11_AI_RESFI ResponseFixedIEs; - ULONG ResponseIELength; - ULONG OffsetResponseIEs; -} NDIS_802_11_ASSOCIATION_INFORMATION, *PNDIS_802_11_ASSOCIATION_INFORMATION; - -typedef enum _NDIS_802_11_RELOAD_DEFAULTS { - Ndis802_11ReloadWEPKeys -} NDIS_802_11_RELOAD_DEFAULTS, *PNDIS_802_11_RELOAD_DEFAULTS; - - -/* Key mapping keys require a BSSID */ -typedef struct _NDIS_802_11_KEY { - ULONG Length; /* Length of this structure */ - ULONG KeyIndex; - ULONG KeyLength; /* length of key in bytes */ - NDIS_802_11_MAC_ADDRESS BSSID; - NDIS_802_11_KEY_RSC KeyRSC; - UCHAR KeyMaterial[32]; /* variable length depending on above field */ -} NDIS_802_11_KEY, *PNDIS_802_11_KEY; - -typedef struct _NDIS_802_11_REMOVE_KEY { - ULONG Length; /* Length of this structure */ - ULONG KeyIndex; - NDIS_802_11_MAC_ADDRESS BSSID; -} NDIS_802_11_REMOVE_KEY, *PNDIS_802_11_REMOVE_KEY; - typedef struct _NDIS_802_11_WEP { - ULONG Length; /* Length of this structure */ - ULONG KeyIndex; /* 0 is the per-client key, 1-N are the global keys */ - ULONG KeyLength; /* length of key in bytes */ - UCHAR KeyMaterial[16];/* variable length depending on above field */ + u32 Length; /* Length of this structure */ + u32 KeyIndex; /* 0 is the per-client key, 1-N are the global keys */ + u32 KeyLength; /* length of key in bytes */ + u8 KeyMaterial[16];/* variable length depending on above field */ } NDIS_802_11_WEP, *PNDIS_802_11_WEP; -typedef struct _NDIS_802_11_AUTHENTICATION_REQUEST { - ULONG Length; /* Length of structure */ - NDIS_802_11_MAC_ADDRESS Bssid; - ULONG Flags; -} NDIS_802_11_AUTHENTICATION_REQUEST, *PNDIS_802_11_AUTHENTICATION_REQUEST; - -typedef enum _NDIS_802_11_STATUS_TYPE { - Ndis802_11StatusType_Authentication, - Ndis802_11StatusType_MediaStreamMode, - Ndis802_11StatusType_PMKID_CandidateList, - Ndis802_11StatusTypeMax /* not a real type, defined as an upper bound */ -} NDIS_802_11_STATUS_TYPE, *PNDIS_802_11_STATUS_TYPE; - -typedef struct _NDIS_802_11_STATUS_INDICATION { - NDIS_802_11_STATUS_TYPE StatusType; -} NDIS_802_11_STATUS_INDICATION, *PNDIS_802_11_STATUS_INDICATION; - -/* mask for authentication/integrity fields */ -#define NDIS_802_11_AUTH_REQUEST_AUTH_FIELDS 0x0f -#define NDIS_802_11_AUTH_REQUEST_REAUTH 0x01 -#define NDIS_802_11_AUTH_REQUEST_KEYUPDATE 0x02 -#define NDIS_802_11_AUTH_REQUEST_PAIRWISE_ERROR 0x06 -#define NDIS_802_11_AUTH_REQUEST_GROUP_ERROR 0x0E - -/* MIC check time, 60 seconds. */ -#define MIC_CHECK_TIME 60000000 - -typedef struct _NDIS_802_11_AUTHENTICATION_EVENT { - NDIS_802_11_STATUS_INDICATION Status; - NDIS_802_11_AUTHENTICATION_REQUEST Request[1]; -} NDIS_802_11_AUTHENTICATION_EVENT, *PNDIS_802_11_AUTHENTICATION_EVENT; - -typedef struct _NDIS_802_11_TEST { - ULONG Length; - ULONG Type; - union { - NDIS_802_11_AUTHENTICATION_EVENT AuthenticationEvent; - NDIS_802_11_RSSI RssiTrigger; - } tt; -} NDIS_802_11_TEST, *PNDIS_802_11_TEST; - - #endif /* end of #ifdef PLATFORM_LINUX */ #ifdef PLATFORM_FREEBSD @@ -279,51 +112,28 @@ typedef struct _NDIS_802_11_TEST { #define NDIS_802_11_LENGTH_RATES 8 #define NDIS_802_11_LENGTH_RATES_EX 16 -typedef unsigned char NDIS_802_11_MAC_ADDRESS[6]; +typedef unsigned char NDIS_802_11_MAC_ADDRESS[ETH_ALEN]; typedef long NDIS_802_11_RSSI; /* in dBm */ typedef unsigned char NDIS_802_11_RATES[NDIS_802_11_LENGTH_RATES]; /* Set of 8 data rates */ typedef unsigned char NDIS_802_11_RATES_EX[NDIS_802_11_LENGTH_RATES_EX]; /* Set of 16 data rates */ -typedef ULONG NDIS_802_11_KEY_INDEX; -typedef unsigned long long NDIS_802_11_KEY_RSC; - - typedef struct _NDIS_802_11_SSID { - ULONG SsidLength; - UCHAR Ssid[32]; + u32 SsidLength; + u8 Ssid[32]; } NDIS_802_11_SSID, *PNDIS_802_11_SSID; -typedef enum _NDIS_802_11_NETWORK_TYPE { - Ndis802_11FH, - Ndis802_11DS, - Ndis802_11OFDM5, - Ndis802_11OFDM24, - Ndis802_11NetworkTypeMax /* not a real type, defined as an upper bound */ -} NDIS_802_11_NETWORK_TYPE, *PNDIS_802_11_NETWORK_TYPE; - -typedef struct _NDIS_802_11_CONFIGURATION_FH { - ULONG Length; /* Length of structure */ - ULONG HopPattern; /* As defined by 802.11, MSB set */ - ULONG HopSet; /* to one if non-802.11 */ - ULONG DwellTime; /* units are Kusec */ -} NDIS_802_11_CONFIGURATION_FH, *PNDIS_802_11_CONFIGURATION_FH; - - /* FW will only save the channel number in DSConfig. ODI Handler will convert the channel number to freq. number. */ typedef struct _NDIS_802_11_CONFIGURATION { - ULONG Length; /* Length of structure */ - ULONG BeaconPeriod; /* units are Kusec */ - ULONG ATIMWindow; /* units are Kusec */ - ULONG DSConfig; /* channel number */ - NDIS_802_11_CONFIGURATION_FH FHConfig; + u32 Length; /* Length of structure */ + u32 BeaconPeriod; /* units are Kusec */ + u32 ATIMWindow; /* units are Kusec */ + u32 DSConfig; /* channel number */ } NDIS_802_11_CONFIGURATION, *PNDIS_802_11_CONFIGURATION; - - typedef enum _NDIS_802_11_NETWORK_INFRASTRUCTURE { Ndis802_11IBSS, Ndis802_11Infrastructure, @@ -332,62 +142,18 @@ typedef enum _NDIS_802_11_NETWORK_INFRASTRUCTURE { Ndis802_11APMode } NDIS_802_11_NETWORK_INFRASTRUCTURE, *PNDIS_802_11_NETWORK_INFRASTRUCTURE; - - - - typedef struct _NDIS_802_11_FIXED_IEs { - UCHAR Timestamp[8]; - USHORT BeaconInterval; - USHORT Capabilities; + u8 Timestamp[8]; + u16 BeaconInterval; + u16 Capabilities; } NDIS_802_11_FIXED_IEs, *PNDIS_802_11_FIXED_IEs; - - typedef struct _NDIS_802_11_VARIABLE_IEs { - UCHAR ElementID; - UCHAR Length; - UCHAR data[1]; + u8 ElementID; + u8 Length; + u8 data[1]; } NDIS_802_11_VARIABLE_IEs, *PNDIS_802_11_VARIABLE_IEs; - - -/* - - - -Length is the 4 bytes multiples of the sume of - sizeof (NDIS_802_11_MAC_ADDRESS) + 2 + sizeof (NDIS_802_11_SSID) + sizeof (ULONG) -+ sizeof (NDIS_802_11_RSSI) + sizeof (NDIS_802_11_NETWORK_TYPE) + sizeof (NDIS_802_11_CONFIGURATION) -+ sizeof (NDIS_802_11_RATES_EX) + IELength - -Except the IELength, all other fields are fixed length. Therefore, we can define a marco to present the -partial sum. - -*/ -#if 0 -typedef struct _NDIS_WLAN_BSSID_EX { - ULONG Length; - NDIS_802_11_MAC_ADDRESS MacAddress; - UCHAR Reserved[2];/* [0]: IS beacon frame, [1]:optimum_antenna=>For antenna diversity; */ - NDIS_802_11_SSID Ssid; - ULONG Privacy; - NDIS_802_11_RSSI Rssi; - NDIS_802_11_NETWORK_TYPE NetworkTypeInUse; - NDIS_802_11_CONFIGURATION Configuration; - NDIS_802_11_NETWORK_INFRASTRUCTURE InfrastructureMode; - NDIS_802_11_RATES_EX SupportedRates; - ULONG IELength; - UCHAR IEs[MAX_IE_SZ]; /* (timestamp, beacon interval, and capability information) */ -} NDIS_WLAN_BSSID_EX, *PNDIS_WLAN_BSSID_EX; - - -typedef struct _NDIS_802_11_BSSID_LIST_EX { - ULONG NumberOfItems; - NDIS_WLAN_BSSID_EX Bssid[1]; -} NDIS_802_11_BSSID_LIST_EX, *PNDIS_802_11_BSSID_LIST_EX; -#endif - typedef enum _NDIS_802_11_AUTHENTICATION_MODE { Ndis802_11AuthModeOpen, Ndis802_11AuthModeShared, @@ -415,109 +181,15 @@ typedef enum _NDIS_802_11_WEP_STATUS { NDIS_802_11_ENCRYPTION_STATUS, *PNDIS_802_11_ENCRYPTION_STATUS; -#define NDIS_802_11_AI_REQFI_CAPABILITIES 1 -#define NDIS_802_11_AI_REQFI_LISTENINTERVAL 2 -#define NDIS_802_11_AI_REQFI_CURRENTAPADDRESS 4 - -#define NDIS_802_11_AI_RESFI_CAPABILITIES 1 -#define NDIS_802_11_AI_RESFI_STATUSCODE 2 -#define NDIS_802_11_AI_RESFI_ASSOCIATIONID 4 - -typedef struct _NDIS_802_11_AI_REQFI { - USHORT Capabilities; - USHORT ListenInterval; - NDIS_802_11_MAC_ADDRESS CurrentAPAddress; -} NDIS_802_11_AI_REQFI, *PNDIS_802_11_AI_REQFI; - -typedef struct _NDIS_802_11_AI_RESFI { - USHORT Capabilities; - USHORT StatusCode; - USHORT AssociationId; -} NDIS_802_11_AI_RESFI, *PNDIS_802_11_AI_RESFI; - -typedef struct _NDIS_802_11_ASSOCIATION_INFORMATION { - ULONG Length; - USHORT AvailableRequestFixedIEs; - NDIS_802_11_AI_REQFI RequestFixedIEs; - ULONG RequestIELength; - ULONG OffsetRequestIEs; - USHORT AvailableResponseFixedIEs; - NDIS_802_11_AI_RESFI ResponseFixedIEs; - ULONG ResponseIELength; - ULONG OffsetResponseIEs; -} NDIS_802_11_ASSOCIATION_INFORMATION, *PNDIS_802_11_ASSOCIATION_INFORMATION; - -typedef enum _NDIS_802_11_RELOAD_DEFAULTS { - Ndis802_11ReloadWEPKeys -} NDIS_802_11_RELOAD_DEFAULTS, *PNDIS_802_11_RELOAD_DEFAULTS; - - -/* Key mapping keys require a BSSID */ -typedef struct _NDIS_802_11_KEY { - ULONG Length; /* Length of this structure */ - ULONG KeyIndex; - ULONG KeyLength; /* length of key in bytes */ - NDIS_802_11_MAC_ADDRESS BSSID; - NDIS_802_11_KEY_RSC KeyRSC; - UCHAR KeyMaterial[32]; /* variable length depending on above field */ -} NDIS_802_11_KEY, *PNDIS_802_11_KEY; - -typedef struct _NDIS_802_11_REMOVE_KEY { - ULONG Length; /* Length of this structure */ - ULONG KeyIndex; - NDIS_802_11_MAC_ADDRESS BSSID; -} NDIS_802_11_REMOVE_KEY, *PNDIS_802_11_REMOVE_KEY; - typedef struct _NDIS_802_11_WEP { - ULONG Length; /* Length of this structure */ - ULONG KeyIndex; /* 0 is the per-client key, 1-N are the global keys */ - ULONG KeyLength; /* length of key in bytes */ - UCHAR KeyMaterial[16];/* variable length depending on above field */ + u32 Length; /* Length of this structure */ + u32 KeyIndex; /* 0 is the per-client key, 1-N are the global keys */ + u32 KeyLength; /* length of key in bytes */ + u8 KeyMaterial[16];/* variable length depending on above field */ } NDIS_802_11_WEP, *PNDIS_802_11_WEP; -typedef struct _NDIS_802_11_AUTHENTICATION_REQUEST { - ULONG Length; /* Length of structure */ - NDIS_802_11_MAC_ADDRESS Bssid; - ULONG Flags; -} NDIS_802_11_AUTHENTICATION_REQUEST, *PNDIS_802_11_AUTHENTICATION_REQUEST; - -typedef enum _NDIS_802_11_STATUS_TYPE { - Ndis802_11StatusType_Authentication, - Ndis802_11StatusType_MediaStreamMode, - Ndis802_11StatusType_PMKID_CandidateList, - Ndis802_11StatusTypeMax /* not a real type, defined as an upper bound */ -} NDIS_802_11_STATUS_TYPE, *PNDIS_802_11_STATUS_TYPE; - -typedef struct _NDIS_802_11_STATUS_INDICATION { - NDIS_802_11_STATUS_TYPE StatusType; -} NDIS_802_11_STATUS_INDICATION, *PNDIS_802_11_STATUS_INDICATION; - -/* mask for authentication/integrity fields */ -#define NDIS_802_11_AUTH_REQUEST_AUTH_FIELDS 0x0f -#define NDIS_802_11_AUTH_REQUEST_REAUTH 0x01 -#define NDIS_802_11_AUTH_REQUEST_KEYUPDATE 0x02 -#define NDIS_802_11_AUTH_REQUEST_PAIRWISE_ERROR 0x06 -#define NDIS_802_11_AUTH_REQUEST_GROUP_ERROR 0x0E - -/* MIC check time, 60 seconds. */ -#define MIC_CHECK_TIME 60000000 - -typedef struct _NDIS_802_11_AUTHENTICATION_EVENT { - NDIS_802_11_STATUS_INDICATION Status; - NDIS_802_11_AUTHENTICATION_REQUEST Request[1]; -} NDIS_802_11_AUTHENTICATION_EVENT, *PNDIS_802_11_AUTHENTICATION_EVENT; - -typedef struct _NDIS_802_11_TEST { - ULONG Length; - ULONG Type; - union { - NDIS_802_11_AUTHENTICATION_EVENT AuthenticationEvent; - NDIS_802_11_RSSI RssiTrigger; - } tt; -} NDIS_802_11_TEST, *PNDIS_802_11_TEST; - - #endif /* PLATFORM_FREEBSD */ + #ifndef Ndis802_11APMode #define Ndis802_11APMode (Ndis802_11InfrastructureMax+1) #endif @@ -526,7 +198,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,81 +219,59 @@ 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() */ -#ifdef PLATFORM_WINDOWS -#pragma pack(push) -#pragma pack(1) -#endif typedef struct _WLAN_BSSID_EX { - ULONG Length; + u32 Length; NDIS_802_11_MAC_ADDRESS MacAddress; - UCHAR Reserved[2];/* [0]: IS beacon frame */ + u8 Reserved[2];/* [0]: IS beacon frame , bss_type*/ NDIS_802_11_SSID Ssid; - ULONG Privacy; + NDIS_802_11_SSID mesh_id; + u32 Privacy; NDIS_802_11_RSSI Rssi;/* (in dBM,raw data ,get from PHY) */ - NDIS_802_11_NETWORK_TYPE NetworkTypeInUse; NDIS_802_11_CONFIGURATION Configuration; NDIS_802_11_NETWORK_INFRASTRUCTURE InfrastructureMode; NDIS_802_11_RATES_EX SupportedRates; WLAN_PHY_INFO PhyInfo; - ULONG IELength; - UCHAR IEs[MAX_IE_SZ]; /* (timestamp, beacon interval, and capability information) */ + u32 IELength; + u8 IEs[MAX_IE_SZ]; /* (timestamp, beacon interval, and capability information) */ } -#ifndef PLATFORM_WINDOWS -__attribute__((packed)) -#endif -WLAN_BSSID_EX, *PWLAN_BSSID_EX; -#ifdef PLATFORM_WINDOWS -#pragma pack(pop) -#endif +__attribute__((packed)) 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))) __inline static uint get_WLAN_BSSID_EX_sz(WLAN_BSSID_EX *bss) { -#if 0 - uint t_len; - - t_len = sizeof(ULONG) - + sizeof(NDIS_802_11_MAC_ADDRESS) - + 2 - + sizeof(NDIS_802_11_SSID) - + sizeof(ULONG) - + sizeof(NDIS_802_11_RSSI) - + sizeof(NDIS_802_11_NETWORK_TYPE) - + sizeof(NDIS_802_11_CONFIGURATION) - + sizeof(NDIS_802_11_NETWORK_INFRASTRUCTURE) - + sizeof(NDIS_802_11_RATES_EX) - /* all new member add here */ - + sizeof(WLAN_PHY_INFO) - /* all new member add here */ - + sizeof(ULONG) - + bss->IELength; - return t_len; -#else return sizeof(WLAN_BSSID_EX) - MAX_IE_SZ + bss->IELength; -#endif } 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 */ +#ifdef CONFIG_RTW_MESH +#if CONFIG_RTW_MESH_ACNODE_PREVENT + systime acnode_stime; + systime acnode_notify_etime; +#endif +#endif int aid; /* will only be valid when a BSS is joinned. */ int join_res; WLAN_BSSID_EX network; /* must be the last item */ WLAN_BCN_INFO BcnInfo; -#ifdef PLATFORM_WINDOWS - unsigned char iebuf[MAX_IE_SZ]; -#endif - }; enum VRTL_CARRIER_SENSE { @@ -653,38 +308,4 @@ enum UAPSD_MAX_SP { #define NUM_PRE_AUTH_KEY 16 #define NUM_PMKID_CACHE NUM_PRE_AUTH_KEY -/* -* WPA2 -*/ - -#ifndef PLATFORM_OS_CE -typedef struct _PMKID_CANDIDATE { - NDIS_802_11_MAC_ADDRESS BSSID; - ULONG Flags; -} PMKID_CANDIDATE, *PPMKID_CANDIDATE; - -typedef struct _NDIS_802_11_PMKID_CANDIDATE_LIST { - ULONG Version; /* Version of the structure */ - ULONG NumCandidates; /* No. of pmkid candidates */ - PMKID_CANDIDATE CandidateList[1]; -} NDIS_802_11_PMKID_CANDIDATE_LIST, *PNDIS_802_11_PMKID_CANDIDATE_LIST; - - -typedef struct _NDIS_802_11_AUTHENTICATION_ENCRYPTION { - NDIS_802_11_AUTHENTICATION_MODE AuthModeSupported; - NDIS_802_11_ENCRYPTION_STATUS EncryptStatusSupported; - -} NDIS_802_11_AUTHENTICATION_ENCRYPTION, *PNDIS_802_11_AUTHENTICATION_ENCRYPTION; - -typedef struct _NDIS_802_11_CAPABILITY { - ULONG Length; - ULONG Version; - ULONG NoOfPMKIDs; - ULONG NoOfAuthEncryptPairsSupported; - NDIS_802_11_AUTHENTICATION_ENCRYPTION AuthenticationEncryptionSupported[1]; - -} NDIS_802_11_CAPABILITY, *PNDIS_802_11_CAPABILITY; -#endif - - #endif /* #ifndef WLAN_BSSDEF_H_ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/xmit_osdep.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/xmit_osdep.h index ea5725d8244f..1a400c961e73 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/xmit_osdep.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/include/xmit_osdep.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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_ @@ -49,9 +45,9 @@ struct pkt_file { #define ETH_ALEN 6 extern NDIS_STATUS rtw_xmit_entry( - IN _nic_hdl cnxt, - IN NDIS_PACKET *pkt, - IN UINT flags + _nic_hdl cnxt, + NDIS_PACKET *pkt, + u32 flags ); #endif /* PLATFORM_WINDOWS */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/custom_gpio_linux.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/custom_gpio_linux.c index 4f10bbed436b..e46c4be2fde8 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/custom_gpio_linux.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/custom_gpio_linux.c @@ -1,7 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/os_dep/linux/ioctl_cfg80211.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/ioctl_cfg80211.c index 5d192112df2d..40ddd54d1d23 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/ioctl_cfg80211.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/ioctl_cfg80211.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 @@ -24,12 +20,27 @@ #ifdef CONFIG_IOCTL_CFG80211 +#ifndef DBG_RTW_CFG80211_STA_PARAM +#define DBG_RTW_CFG80211_STA_PARAM 0 +#endif + +#ifndef DBG_RTW_CFG80211_MESH_CONF +#define DBG_RTW_CFG80211_MESH_CONF 0 +#endif + #if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 0, 0)) -#define STATION_INFO_SIGNAL BIT(NL80211_STA_INFO_SIGNAL) +#define STATION_INFO_INACTIVE_TIME BIT(NL80211_STA_INFO_INACTIVE_TIME) +#define STATION_INFO_LLID BIT(NL80211_STA_INFO_LLID) +#define STATION_INFO_PLID BIT(NL80211_STA_INFO_PLID) +#define STATION_INFO_PLINK_STATE BIT(NL80211_STA_INFO_PLINK_STATE) +#define STATION_INFO_SIGNAL BIT(NL80211_STA_INFO_SIGNAL) #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_LOCAL_PM BIT(NL80211_STA_INFO_LOCAL_PM) +#define STATION_INFO_PEER_PM BIT(NL80211_STA_INFO_PEER_PM) +#define STATION_INFO_NONPEER_PM BIT(NL80211_STA_INFO_NONPEER_PM) #define STATION_INFO_ASSOC_REQ_IES 0 #endif /* Linux kernel >= 4.0.0 */ @@ -64,10 +75,21 @@ #endif /* CONFIG_WAPI_SUPPORT */ +#if (LINUX_VERSION_CODE <= KERNEL_VERSION(4, 11, 12)) #ifdef CONFIG_RTW_80211R #define WLAN_AKM_SUITE_FT_8021X 0x000FAC03 #define WLAN_AKM_SUITE_FT_PSK 0x000FAC04 #endif +#endif + +/* + * In the current design of Wi-Fi driver, it will return success to the system (e.g. supplicant) + * when Wi-Fi driver decides to abort the scan request in the scan flow by default. + * Defining this flag makes Wi-Fi driver to return -EBUSY to the system if Wi-Fi driver is too busy to do the scan. + */ +#ifndef CONFIG_NOTIFY_SCAN_ABORT_WITH_BUSY + #define CONFIG_NOTIFY_SCAN_ABORT_WITH_BUSY 0 +#endif static const u32 rtw_cipher_suites[] = { WLAN_CIPHER_SUITE_WEP40, @@ -144,10 +166,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), @@ -164,41 +184,293 @@ 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(3, 8, 0)) +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; +} + +#ifdef CONFIG_RTW_MESH +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 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 /* CONFIG_RTW_MESH */ +#elif (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, 5, 0)) +bool rtw_cfg80211_allow_ch_switch_notify(_adapter *adapter) +{ +#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 19, 0)) + if ((!MLME_IS_AP(adapter)) +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 13, 0)) + && (!MLME_IS_ADHOC(adapter)) + && (!MLME_IS_ADHOC_MASTER(adapter)) + && (!MLME_IS_MESH(adapter)) +#elif defined(CONFIG_RTW_MESH) + && (!MLME_IS_MESH(adapter)) +#endif + ) + return 0; +#endif + return 1; +} + +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; + + if (!rtw_cfg80211_allow_ch_switch_notify(adapter)) + goto exit; + + 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 (!rtw_cfg80211_allow_ch_switch_notify(adapter)) + goto exit; + + 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) @@ -215,18 +487,16 @@ void rtw_5g_rates_init(struct ieee80211_rate *rates) ); } -struct ieee80211_supported_band *rtw_spt_band_alloc( - enum nl80211_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 == NL80211_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 == NL80211_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; @@ -241,14 +511,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 == NL80211_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 == NL80211_BAND_5GHZ) { + } else if (band == BAND_ON_5G) { rtw_5g_channels_init(spt_band->channels); rtw_5g_rates_init(spt_band->bitrates); } @@ -267,21 +537,13 @@ void rtw_spt_band_free(struct ieee80211_supported_band *spt_band) if (!spt_band) return; -#if (KERNEL_VERSION(4, 7, 0) <= LINUX_VERSION_CODE) if (spt_band->band == NL80211_BAND_2GHZ) { -#else - if (spt_band->band == IEEE80211_BAND_2GHZ) { -#endif 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; -#if (KERNEL_VERSION(4, 7, 0) <= LINUX_VERSION_CODE) } else if (spt_band->band == NL80211_BAND_5GHZ) { -#else - } else if (spt_band->band == IEEE80211_BAND_5GHZ) { -#endif 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 { @@ -299,6 +561,7 @@ static const struct ieee80211_txrx_stypes [NL80211_IFTYPE_STATION] = { .tx = 0xffff, .rx = BIT(IEEE80211_STYPE_ACTION >> 4) | + BIT(IEEE80211_STYPE_AUTH >> 4) | BIT(IEEE80211_STYPE_PROBE_REQ >> 4) }, [NL80211_IFTYPE_AP] = { @@ -344,12 +607,115 @@ static const struct ieee80211_txrx_stypes BIT(IEEE80211_STYPE_PROBE_REQ >> 4) }, #endif +#if defined(CONFIG_RTW_MESH) + [NL80211_IFTYPE_MESH_POINT] = { + .tx = 0xffff, + .rx = BIT(IEEE80211_STYPE_ACTION >> 4) + | BIT(IEEE80211_STYPE_AUTH >> 4) + }, +#endif + }; #endif +NDIS_802_11_NETWORK_INFRASTRUCTURE nl80211_iftype_to_rtw_network_type(enum nl80211_iftype type) +{ + switch (type) { + case NL80211_IFTYPE_ADHOC: + return Ndis802_11IBSS; + + #if defined(CONFIG_P2P) && ((LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE)) + case NL80211_IFTYPE_P2P_CLIENT: + #endif + case NL80211_IFTYPE_STATION: + return Ndis802_11Infrastructure; + +#ifdef CONFIG_AP_MODE + #if defined(CONFIG_P2P) && ((LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE)) + case NL80211_IFTYPE_P2P_GO: + #endif + case NL80211_IFTYPE_AP: + return Ndis802_11APMode; +#endif + +#ifdef CONFIG_RTW_MESH + case NL80211_IFTYPE_MESH_POINT: + return Ndis802_11_mesh; +#endif + + case NL80211_IFTYPE_MONITOR: + return Ndis802_11Monitor; + + default: + return Ndis802_11InfrastructureMax; + } +} + +u32 nl80211_iftype_to_rtw_mlme_state(enum nl80211_iftype type) +{ + switch (type) { + case NL80211_IFTYPE_ADHOC: + return WIFI_ADHOC_STATE; + + #if defined(CONFIG_P2P) && ((LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE)) + case NL80211_IFTYPE_P2P_CLIENT: + #endif + case NL80211_IFTYPE_STATION: + return WIFI_STATION_STATE; + +#ifdef CONFIG_AP_MODE + #if defined(CONFIG_P2P) && ((LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE)) + case NL80211_IFTYPE_P2P_GO: + #endif + case NL80211_IFTYPE_AP: + return WIFI_AP_STATE; +#endif + +#ifdef CONFIG_RTW_MESH + case NL80211_IFTYPE_MESH_POINT: + return WIFI_MESH_STATE; +#endif + + case NL80211_IFTYPE_MONITOR: + return WIFI_MONITOR_STATE; + + default: + return WIFI_NULL_STATE; + } +} + +static int rtw_cfg80211_sync_iftype(_adapter *adapter) +{ + struct wireless_dev *rtw_wdev = adapter->rtw_wdev; + + if (!(nl80211_iftype_to_rtw_mlme_state(rtw_wdev->iftype) & MLME_STATE(adapter))) { + /* iftype and mlme state is not syc */ + NDIS_802_11_NETWORK_INFRASTRUCTURE network_type; + + network_type = nl80211_iftype_to_rtw_network_type(rtw_wdev->iftype); + if (network_type != Ndis802_11InfrastructureMax) { + if (rtw_pwr_wakeup(adapter) == _FAIL) { + RTW_WARN(FUNC_ADPT_FMT" call rtw_pwr_wakeup fail\n", FUNC_ADPT_ARG(adapter)); + return _FAIL; + } + + rtw_set_802_11_infrastructure_mode(adapter, network_type); + rtw_setopmode_cmd(adapter, network_type, RTW_CMDF_WAIT_ACK); + } else { + rtw_warn_on(1); + RTW_WARN(FUNC_ADPT_FMT" iftype:%u is not support\n", FUNC_ADPT_ARG(adapter), rtw_wdev->iftype); + return _FAIL; + } + } + + return _SUCCESS; +} + static u64 rtw_get_systime_us(void) { -#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 39)) +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 20, 0)) + return ktime_to_us(ktime_get_boottime()); +#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 39)) struct timespec ts; get_monotonic_boottime(&ts); return ((u64)ts.tv_sec * 1000000) + ts.tv_nsec / 1000; @@ -363,7 +729,6 @@ static u64 rtw_get_systime_us(void) /* Try to remove non target BSS's SR to reduce PBC overlap rate */ static int rtw_cfg80211_clear_wps_sr_of_non_target_bss(_adapter *padapter, struct wlan_network *pnetwork, struct cfg80211_ssid *req_ssid) { - struct rtw_wdev_priv *wdev_data = adapter_wdev_data(padapter); int ret = 0; u8 *psr = NULL, sr = 0; NDIS_802_11_SSID *pssid = &pnetwork->network.Ssid; @@ -486,7 +851,7 @@ 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); set_frame_sub_type(pbuf, WIFI_BEACON); } else { @@ -528,7 +893,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; @@ -604,7 +969,6 @@ void rtw_cfg80211_ibss_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 cfg80211_bss *bss = NULL; #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 15, 0)) struct wiphy *wiphy = pwdev->wiphy; int freq = 2412; @@ -613,13 +977,6 @@ void rtw_cfg80211_ibss_indicate_connect(_adapter *padapter) RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); -#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 15, 0)) - freq = rtw_ch2freq(cur_network->network.Configuration.DSConfig); - - if (0) - RTW_INFO("chan: %d, freq: %d\n", cur_network->network.Configuration.DSConfig, freq); -#endif - if (pwdev->iftype != NL80211_IFTYPE_ADHOC) return; @@ -662,6 +1019,9 @@ void rtw_cfg80211_ibss_indicate_connect(_adapter *padapter) } /* notify cfg80211 that device joined an IBSS */ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 15, 0)) + freq = rtw_ch2freq(cur_network->network.Configuration.DSConfig); + if (1) + RTW_INFO("chan: %d, freq: %d\n", cur_network->network.Configuration.DSConfig, freq); notify_channel = ieee80211_get_channel(wiphy, freq); cfg80211_ibss_joined(padapter->pnetdev, cur_network->network.MacAddress, notify_channel, GFP_ATOMIC); #else @@ -674,10 +1034,14 @@ 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 @@ -687,7 +1051,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 @@ -735,6 +1099,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; @@ -746,7 +1112,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 @@ -757,30 +1131,41 @@ 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); + if (rtw_ft_roam(padapter)) + rtw_ft_set_status(padapter, RTW_FT_ASSOCIATED_STA); #endif } else { #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 +1173,7 @@ void rtw_cfg80211_indicate_disconnect(_adapter *padapter, u16 reason, u8 locally RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); /*always replace privated definitions with wifi reserved value 0*/ - if ((reason == WLAN_REASON_ACTIVE_ROAM) || (reason == WLAN_REASON_JOIN_WRONG_CHANNEL) || (reason == WLAN_REASON_EXPIRATION_CHK)) + if (WLAN_REASON_IS_PRIVATE(reason)) reason = 0; if (pwdev->iftype != NL80211_IFTYPE_STATION @@ -798,7 +1183,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 @@ -806,8 +1191,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); @@ -816,58 +1203,48 @@ 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, + reason, 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, - WLAN_STATUS_UNSPECIFIED_FAILURE, GFP_ATOMIC); + rtw_cfg80211_connect_result(pwdev, NULL, NULL, 0, NULL, 0, + reason, 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); } #ifdef CONFIG_AP_MODE -static int rtw_cfg80211_ap_set_encryption(struct net_device *dev, struct ieee_param *param, u32 param_len) +static int rtw_cfg80211_ap_set_encryption(struct net_device *dev, struct ieee_param *param) { int ret = 0; - u32 wep_key_idx, wep_key_len, wep_total_len; + u32 wep_key_idx, wep_key_len; struct sta_info *psta = NULL, *pbcmc_sta = NULL; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct security_priv *psecuritypriv = &(padapter->securitypriv); struct sta_priv *pstapriv = &padapter->stapriv; @@ -876,20 +1253,11 @@ static int rtw_cfg80211_ap_set_encryption(struct net_device *dev, struct ieee_pa param->u.crypt.err = 0; param->u.crypt.alg[IEEE_CRYPT_ALG_NAME_LEN - 1] = '\0'; - /* sizeof(struct ieee_param) = 64 bytes; */ - /* if (param_len != (u32) ((u8 *) param->u.crypt.key - (u8 *) param) + param->u.crypt.key_len) */ - if (param_len != sizeof(struct ieee_param) + param->u.crypt.key_len) { - ret = -EINVAL; - goto exit; - } - - if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && - param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && - param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) { + if (is_broadcast_mac_addr(param->sta_addr)) { if (param->u.crypt.idx >= WEP_KEYS -#ifdef CONFIG_IEEE80211W + #ifdef CONFIG_IEEE80211W && param->u.crypt.idx > BIP_MAX_KEYID -#endif /* CONFIG_IEEE80211W */ + #endif ) { ret = -EINVAL; goto exit; @@ -897,8 +1265,9 @@ static int rtw_cfg80211_ap_set_encryption(struct net_device *dev, struct ieee_pa } else { psta = rtw_get_stainfo(pstapriv, param->sta_addr); if (!psta) { - /* ret = -EINVAL; */ - RTW_INFO("rtw_set_encryption(), sta has already been removed or never been added\n"); + ret = -EINVAL; + RTW_INFO(FUNC_ADPT_FMT", sta "MAC_FMT" not found\n" + , FUNC_ADPT_ARG(padapter), MAC_ARG(param->sta_addr)); goto exit; } } @@ -954,76 +1323,64 @@ static int rtw_cfg80211_ap_set_encryption(struct net_device *dev, struct ieee_pa } - - if (!psta && check_fwstate(pmlmepriv, WIFI_AP_STATE)) { /* group key */ - if (param->u.crypt.set_tx == 0) { /* group key */ + if (!psta) { /* group key */ + if (param->u.crypt.set_tx == 0) { /* group key, TX only */ if (strcmp(param->u.crypt.alg, "WEP") == 0) { - RTW_INFO("%s, set group_key, WEP\n", __FUNCTION__); - + RTW_INFO(FUNC_ADPT_FMT" set WEP TX GTK idx:%u, len:%u\n" + , FUNC_ADPT_ARG(padapter), param->u.crypt.idx, param->u.crypt.key_len); _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); - psecuritypriv->dot118021XGrpPrivacy = _WEP40_; if (param->u.crypt.key_len == 13) psecuritypriv->dot118021XGrpPrivacy = _WEP104_; } else if (strcmp(param->u.crypt.alg, "TKIP") == 0) { - RTW_INFO("%s, set group_key, TKIP\n", __FUNCTION__); - + RTW_INFO(FUNC_ADPT_FMT" set TKIP TX GTK idx:%u, len:%u\n" + , FUNC_ADPT_ARG(padapter), param->u.crypt.idx, param->u.crypt.key_len); psecuritypriv->dot118021XGrpPrivacy = _TKIP_; - _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); - - /* DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len); */ /* set mic key */ _rtw_memcpy(psecuritypriv->dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8); _rtw_memcpy(psecuritypriv->dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8); - psecuritypriv->busetkipkey = _TRUE; } else if (strcmp(param->u.crypt.alg, "CCMP") == 0) { - RTW_INFO("%s, set group_key, CCMP\n", __FUNCTION__); - + RTW_INFO(FUNC_ADPT_FMT" set CCMP TX GTK idx:%u, len:%u\n" + , FUNC_ADPT_ARG(padapter), param->u.crypt.idx, param->u.crypt.key_len); psecuritypriv->dot118021XGrpPrivacy = _AES_; - _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); - } -#ifdef CONFIG_IEEE80211W - else if (strcmp(param->u.crypt.alg, "BIP") == 0) { - int no; - RTW_INFO("BIP key_len=%d , index=%d\n", param->u.crypt.key_len, param->u.crypt.idx); - /* save the IGTK key, length 16 bytes */ + #ifdef CONFIG_IEEE80211W + } else if (strcmp(param->u.crypt.alg, "BIP") == 0) { + RTW_INFO(FUNC_ADPT_FMT" set TX IGTK idx:%u, len:%u\n" + , FUNC_ADPT_ARG(padapter), param->u.crypt.idx, param->u.crypt.key_len); _rtw_memcpy(padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); - /* RTW_INFO("IGTK key below:\n"); - for(no=0;no<16;no++) - printk(" %02x ", padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey[no]); - RTW_INFO("\n"); */ padapter->securitypriv.dot11wBIPKeyid = param->u.crypt.idx; + psecuritypriv->dot11wBIPtxpn.val = RTW_GET_LE64(param->u.crypt.seq); padapter->securitypriv.binstallBIPkey = _TRUE; - RTW_INFO(" ~~~~set sta key:IGKT\n"); goto exit; - } -#endif /* CONFIG_IEEE80211W */ - else { - RTW_INFO("%s, set group_key, none\n", __FUNCTION__); + #endif /* CONFIG_IEEE80211W */ + } else if (strcmp(param->u.crypt.alg, "none") == 0) { + RTW_INFO(FUNC_ADPT_FMT" clear group key, idx:%u\n" + , FUNC_ADPT_ARG(padapter), param->u.crypt.idx); psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; + } else { + RTW_WARN(FUNC_ADPT_FMT" set group key, not support\n" + , FUNC_ADPT_ARG(padapter)); + goto exit; } psecuritypriv->dot118021XGrpKeyid = param->u.crypt.idx; - - psecuritypriv->binstallGrpkey = _TRUE; - - psecuritypriv->dot11PrivacyAlgrthm = psecuritypriv->dot118021XGrpPrivacy;/* !!! */ - - rtw_ap_set_group_key(padapter, param->u.crypt.key, psecuritypriv->dot118021XGrpPrivacy, param->u.crypt.idx); - pbcmc_sta = rtw_get_bcmc_stainfo(padapter); if (pbcmc_sta) { + pbcmc_sta->dot11txpn.val = RTW_GET_LE64(param->u.crypt.seq); pbcmc_sta->ieee8021x_blocked = _FALSE; pbcmc_sta->dot118021XPrivacy = psecuritypriv->dot118021XGrpPrivacy; /* rx will use bmc_sta's dot118021XPrivacy */ } + psecuritypriv->binstallGrpkey = _TRUE; + psecuritypriv->dot11PrivacyAlgrthm = psecuritypriv->dot118021XGrpPrivacy;/* !!! */ + rtw_ap_set_group_key(padapter, param->u.crypt.key, psecuritypriv->dot118021XGrpPrivacy, param->u.crypt.idx); } goto exit; @@ -1031,102 +1388,113 @@ static int rtw_cfg80211_ap_set_encryption(struct net_device *dev, struct ieee_pa } if (psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X && psta) { /* psk/802_1x */ - if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { - if (param->u.crypt.set_tx == 1) { /* pairwise key */ - _rtw_memcpy(psta->dot118021x_UncstKey.skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); + if (param->u.crypt.set_tx == 1) { + /* pairwise key */ + _rtw_memcpy(psta->dot118021x_UncstKey.skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); - if (strcmp(param->u.crypt.alg, "WEP") == 0) { - RTW_INFO("%s, set pairwise key, WEP\n", __FUNCTION__); + if (strcmp(param->u.crypt.alg, "WEP") == 0) { + RTW_INFO(FUNC_ADPT_FMT" set WEP PTK of "MAC_FMT" idx:%u, len:%u\n" + , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr) + , param->u.crypt.idx, param->u.crypt.key_len); + psta->dot118021XPrivacy = _WEP40_; + if (param->u.crypt.key_len == 13) + psta->dot118021XPrivacy = _WEP104_; - psta->dot118021XPrivacy = _WEP40_; - if (param->u.crypt.key_len == 13) - psta->dot118021XPrivacy = _WEP104_; - } else if (strcmp(param->u.crypt.alg, "TKIP") == 0) { - RTW_INFO("%s, set pairwise key, TKIP\n", __FUNCTION__); + } else if (strcmp(param->u.crypt.alg, "TKIP") == 0) { + RTW_INFO(FUNC_ADPT_FMT" set TKIP PTK of "MAC_FMT" idx:%u, len:%u\n" + , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr) + , param->u.crypt.idx, param->u.crypt.key_len); + psta->dot118021XPrivacy = _TKIP_; + /* set mic key */ + _rtw_memcpy(psta->dot11tkiptxmickey.skey, &(param->u.crypt.key[16]), 8); + _rtw_memcpy(psta->dot11tkiprxmickey.skey, &(param->u.crypt.key[24]), 8); + psecuritypriv->busetkipkey = _TRUE; - psta->dot118021XPrivacy = _TKIP_; - - /* DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len); */ - /* set mic key */ - _rtw_memcpy(psta->dot11tkiptxmickey.skey, &(param->u.crypt.key[16]), 8); - _rtw_memcpy(psta->dot11tkiprxmickey.skey, &(param->u.crypt.key[24]), 8); - - psecuritypriv->busetkipkey = _TRUE; - - } else if (strcmp(param->u.crypt.alg, "CCMP") == 0) { - - RTW_INFO("%s, set pairwise key, CCMP\n", __FUNCTION__); - - psta->dot118021XPrivacy = _AES_; - } else { - RTW_INFO("%s, set pairwise key, none\n", __FUNCTION__); - - psta->dot118021XPrivacy = _NO_PRIVACY_; - } - - rtw_ap_set_pairwise_key(padapter, psta); - - psta->ieee8021x_blocked = _FALSE; - - psta->bpairwise_key_installed = _TRUE; - - } else { /* group key??? */ - if (strcmp(param->u.crypt.alg, "WEP") == 0) { - _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); - - psecuritypriv->dot118021XGrpPrivacy = _WEP40_; - if (param->u.crypt.key_len == 13) - psecuritypriv->dot118021XGrpPrivacy = _WEP104_; - } else if (strcmp(param->u.crypt.alg, "TKIP") == 0) { - psecuritypriv->dot118021XGrpPrivacy = _TKIP_; - - _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); - - /* DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len); */ - /* set mic key */ - _rtw_memcpy(psecuritypriv->dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8); - _rtw_memcpy(psecuritypriv->dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8); - - psecuritypriv->busetkipkey = _TRUE; - - } else if (strcmp(param->u.crypt.alg, "CCMP") == 0) { - psecuritypriv->dot118021XGrpPrivacy = _AES_; - - _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); - } else - psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; - - psecuritypriv->dot118021XGrpKeyid = param->u.crypt.idx; - - psecuritypriv->binstallGrpkey = _TRUE; - - psecuritypriv->dot11PrivacyAlgrthm = psecuritypriv->dot118021XGrpPrivacy;/* !!! */ - - rtw_ap_set_group_key(padapter, param->u.crypt.key, psecuritypriv->dot118021XGrpPrivacy, param->u.crypt.idx); - - pbcmc_sta = rtw_get_bcmc_stainfo(padapter); - if (pbcmc_sta) { - pbcmc_sta->ieee8021x_blocked = _FALSE; - pbcmc_sta->dot118021XPrivacy = psecuritypriv->dot118021XGrpPrivacy; /* rx will use bmc_sta's dot118021XPrivacy */ - } + } else if (strcmp(param->u.crypt.alg, "CCMP") == 0) { + RTW_INFO(FUNC_ADPT_FMT" set CCMP PTK of "MAC_FMT" idx:%u, len:%u\n" + , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr) + , param->u.crypt.idx, param->u.crypt.key_len); + psta->dot118021XPrivacy = _AES_; + } else if (strcmp(param->u.crypt.alg, "none") == 0) { + RTW_INFO(FUNC_ADPT_FMT" clear pairwise key of "MAC_FMT" idx:%u\n" + , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr) + , param->u.crypt.idx); + psta->dot118021XPrivacy = _NO_PRIVACY_; + } else { + RTW_WARN(FUNC_ADPT_FMT" set pairwise key of "MAC_FMT", not support\n" + , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr)); + goto exit; } + psta->dot11txpn.val = RTW_GET_LE64(param->u.crypt.seq); + psta->dot11rxpn.val = RTW_GET_LE64(param->u.crypt.seq); + psta->ieee8021x_blocked = _FALSE; + + if (psta->dot118021XPrivacy != _NO_PRIVACY_) { + psta->bpairwise_key_installed = _TRUE; + + /* WPA2 key-handshake has completed */ + if (psecuritypriv->ndisauthtype == Ndis802_11AuthModeWPA2PSK) + psta->state &= (~WIFI_UNDER_KEY_HANDSHAKE); + } + + rtw_ap_set_pairwise_key(padapter, psta); + } else { + /* peer's group key, RX only */ + #ifdef CONFIG_RTW_MESH + if (strcmp(param->u.crypt.alg, "CCMP") == 0) { + RTW_INFO(FUNC_ADPT_FMT" set CCMP GTK of "MAC_FMT", idx:%u, len:%u\n" + , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr) + , param->u.crypt.idx, param->u.crypt.key_len); + psta->group_privacy = _AES_; + _rtw_memcpy(psta->gtk.skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); + psta->gtk_bmp |= BIT(param->u.crypt.idx); + psta->gtk_pn.val = RTW_GET_LE64(param->u.crypt.seq); + + #ifdef CONFIG_IEEE80211W + } else if (strcmp(param->u.crypt.alg, "BIP") == 0) { + RTW_INFO(FUNC_ADPT_FMT" set IGTK of "MAC_FMT", idx:%u, len:%u\n" + , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr) + , param->u.crypt.idx, param->u.crypt.key_len); + _rtw_memcpy(psta->igtk.skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); + psta->igtk_bmp |= BIT(param->u.crypt.idx); + psta->igtk_id = param->u.crypt.idx; + psta->igtk_pn.val = RTW_GET_LE64(param->u.crypt.seq); + goto exit; + #endif /* CONFIG_IEEE80211W */ + + } else if (strcmp(param->u.crypt.alg, "none") == 0) { + RTW_INFO(FUNC_ADPT_FMT" clear group key of "MAC_FMT", idx:%u\n" + , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr) + , param->u.crypt.idx); + psta->group_privacy = _NO_PRIVACY_; + psta->gtk_bmp &= ~BIT(param->u.crypt.idx); + } else + #endif /* CONFIG_RTW_MESH */ + { + RTW_WARN(FUNC_ADPT_FMT" set group key of "MAC_FMT", not support\n" + , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr)); + goto exit; + } + + #ifdef CONFIG_RTW_MESH + rtw_ap_set_sta_key(padapter, psta->cmn.mac_addr, psta->group_privacy + , param->u.crypt.key, param->u.crypt.idx, 1); + #endif } } exit: - return ret; - } -#endif +#endif /* CONFIG_AP_MODE */ -static int rtw_cfg80211_set_encryption(struct net_device *dev, struct ieee_param *param, u32 param_len) +static int rtw_cfg80211_set_encryption(struct net_device *dev, struct ieee_param *param) { int ret = 0; - u32 wep_key_idx, wep_key_len, wep_total_len; + u32 wep_key_idx, wep_key_len; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct security_priv *psecuritypriv = &padapter->securitypriv; @@ -1134,24 +1502,16 @@ static int rtw_cfg80211_set_encryption(struct net_device *dev, struct ieee_param struct wifidirect_info *pwdinfo = &padapter->wdinfo; #endif /* CONFIG_P2P */ - RTW_INFO("%s\n", __func__); param->u.crypt.err = 0; param->u.crypt.alg[IEEE_CRYPT_ALG_NAME_LEN - 1] = '\0'; - if (param_len < (u32)((u8 *) param->u.crypt.key - (u8 *) param) + param->u.crypt.key_len) { - ret = -EINVAL; - goto exit; - } - - if (param->sta_addr[0] == 0xff && param->sta_addr[1] == 0xff && - param->sta_addr[2] == 0xff && param->sta_addr[3] == 0xff && - param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) { + if (is_broadcast_mac_addr(param->sta_addr)) { if (param->u.crypt.idx >= WEP_KEYS -#ifdef CONFIG_IEEE80211W + #ifdef CONFIG_IEEE80211W && param->u.crypt.idx > BIP_MAX_KEYID -#endif /* CONFIG_IEEE80211W */ + #endif ) { ret = -EINVAL; goto exit; @@ -1172,7 +1532,7 @@ static int rtw_cfg80211_set_encryption(struct net_device *dev, struct ieee_param wep_key_idx = param->u.crypt.idx; wep_key_len = param->u.crypt.key_len; - if ((wep_key_idx > WEP_KEYS) || (wep_key_len <= 0)) { + if ((wep_key_idx >= WEP_KEYS) || (wep_key_len <= 0)) { ret = -EINVAL; goto exit; } @@ -1211,7 +1571,7 @@ static int rtw_cfg80211_set_encryption(struct net_device *dev, struct ieee_param if (check_fwstate(pmlmepriv, WIFI_STATION_STATE | WIFI_MP_STATE) == _TRUE) { /* sta mode */ #ifdef CONFIG_RTW_80211R - if ((rtw_to_roam(padapter) > 0) && rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) + if (rtw_ft_roam(padapter)) psta = rtw_get_stainfo(pstapriv, pmlmepriv->assoc_bssid); else #endif @@ -1224,65 +1584,53 @@ static int rtw_cfg80211_set_encryption(struct net_device *dev, struct ieee_param if (strcmp(param->u.crypt.alg, "none") != 0) psta->ieee8021x_blocked = _FALSE; - if ((padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption2Enabled) || (padapter->securitypriv.ndisencryptstatus == Ndis802_11Encryption3Enabled)) psta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm; if (param->u.crypt.set_tx == 1) { /* pairwise key */ - - RTW_INFO("%s, : param->u.crypt.set_tx ==1\n", __func__); - + RTW_INFO(FUNC_ADPT_FMT" set %s PTK idx:%u, len:%u\n" + , FUNC_ADPT_ARG(padapter), param->u.crypt.alg, param->u.crypt.idx, param->u.crypt.key_len); _rtw_memcpy(psta->dot118021x_UncstKey.skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); - if (strcmp(param->u.crypt.alg, "TKIP") == 0) { /* set mic key */ - /* DEBUG_ERR(("\nset key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len)); */ _rtw_memcpy(psta->dot11tkiptxmickey.skey, &(param->u.crypt.key[16]), 8); _rtw_memcpy(psta->dot11tkiprxmickey.skey, &(param->u.crypt.key[24]), 8); - padapter->securitypriv.busetkipkey = _FALSE; - /* _set_timer(&padapter->securitypriv.tkip_timer, 50); */ } + psta->dot11txpn.val = RTW_GET_LE64(param->u.crypt.seq); + psta->dot11rxpn.val = RTW_GET_LE64(param->u.crypt.seq); psta->bpairwise_key_installed = _TRUE; -#ifdef CONFIG_RTW_80211R + #ifdef CONFIG_RTW_80211R psta->ft_pairwise_key_installed = _TRUE; -#endif - /* DEBUG_ERR((" param->u.crypt.key_len=%d\n",param->u.crypt.key_len)); */ - RTW_INFO(" ~~~~set sta key:unicastkey\n"); - + #endif rtw_setstakey_cmd(padapter, psta, UNICAST_KEY, _TRUE); + } else { /* group key */ if (strcmp(param->u.crypt.alg, "TKIP") == 0 || strcmp(param->u.crypt.alg, "CCMP") == 0) { + RTW_INFO(FUNC_ADPT_FMT" set %s GTK idx:%u, len:%u\n" + , FUNC_ADPT_ARG(padapter), param->u.crypt.alg, param->u.crypt.idx, param->u.crypt.key_len); _rtw_memcpy(padapter->securitypriv.dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); _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"); - + if (param->u.crypt.idx < 4) + _rtw_memcpy(padapter->securitypriv.iv_seq[param->u.crypt.idx], param->u.crypt.seq, 8); padapter->securitypriv.dot118021XGrpKeyid = param->u.crypt.idx; rtw_set_key(padapter, &padapter->securitypriv, param->u.crypt.idx, 1, _TRUE); - } -#ifdef CONFIG_IEEE80211W - else if (strcmp(param->u.crypt.alg, "BIP") == 0) { - int no; - /* RTW_INFO("BIP key_len=%d , index=%d @@@@@@@@@@@@@@@@@@\n", param->u.crypt.key_len, param->u.crypt.idx); */ - /* save the IGTK key, length 16 bytes */ + + #ifdef CONFIG_IEEE80211W + } else if (strcmp(param->u.crypt.alg, "BIP") == 0) { + RTW_INFO(FUNC_ADPT_FMT" set IGTK idx:%u, len:%u\n" + , FUNC_ADPT_ARG(padapter), param->u.crypt.idx, param->u.crypt.key_len); _rtw_memcpy(padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); - /*RTW_INFO("IGTK key below:\n"); - for(no=0;no<16;no++) - printk(" %02x ", padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey[no]); - RTW_INFO("\n");*/ - padapter->securitypriv.dot11wBIPKeyid = param->u.crypt.idx; - padapter->securitypriv.binstallBIPkey = _TRUE; - RTW_INFO(" ~~~~set sta key:IGKT\n"); + psecuritypriv->dot11wBIPKeyid = param->u.crypt.idx; + psecuritypriv->dot11wBIPrxpn.val = RTW_GET_LE64(param->u.crypt.seq); + psecuritypriv->binstallBIPkey = _TRUE; + #endif /* CONFIG_IEEE80211W */ + } -#endif /* CONFIG_IEEE80211W */ #ifdef CONFIG_P2P if (pwdinfo->driver_interface == DRIVER_CFG80211) { @@ -1291,6 +1639,9 @@ static int rtw_cfg80211_set_encryption(struct net_device *dev, struct ieee_param } #endif /* CONFIG_P2P */ + /* WPA/WPA2 key-handshake has completed */ + clr_fwstate(pmlmepriv, WIFI_UNDER_KEY_HANDSHAKE); + } } @@ -1310,64 +1661,10 @@ static int rtw_cfg80211_set_encryption(struct net_device *dev, struct ieee_param } } -#ifdef CONFIG_WAPI_SUPPORT - if (strcmp(param->u.crypt.alg, "SMS4") == 0) { - PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; - PRT_WAPI_STA_INFO pWapiSta; - u8 WapiASUEPNInitialValueSrc[16] = {0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C} ; - 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} ; - - if (param->u.crypt.set_tx == 1) { - list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { - if (_rtw_memcmp(pWapiSta->PeerMacAddr, param->sta_addr, 6)) { - _rtw_memcpy(pWapiSta->lastTxUnicastPN, WapiASUEPNInitialValueSrc, 16); - - pWapiSta->wapiUsk.bSet = true; - _rtw_memcpy(pWapiSta->wapiUsk.dataKey, param->u.crypt.key, 16); - _rtw_memcpy(pWapiSta->wapiUsk.micKey, param->u.crypt.key + 16, 16); - pWapiSta->wapiUsk.keyId = param->u.crypt.idx ; - pWapiSta->wapiUsk.bTxEnable = true; - - _rtw_memcpy(pWapiSta->lastRxUnicastPNBEQueue, WapiAEPNInitialValueSrc, 16); - _rtw_memcpy(pWapiSta->lastRxUnicastPNBKQueue, WapiAEPNInitialValueSrc, 16); - _rtw_memcpy(pWapiSta->lastRxUnicastPNVIQueue, WapiAEPNInitialValueSrc, 16); - _rtw_memcpy(pWapiSta->lastRxUnicastPNVOQueue, WapiAEPNInitialValueSrc, 16); - _rtw_memcpy(pWapiSta->lastRxUnicastPN, WapiAEPNInitialValueSrc, 16); - pWapiSta->wapiUskUpdate.bTxEnable = false; - pWapiSta->wapiUskUpdate.bSet = false; - - if (psecuritypriv->sw_encrypt == false || psecuritypriv->sw_decrypt == false) { - /* set unicast key for ASUE */ - rtw_wapi_set_key(padapter, &pWapiSta->wapiUsk, pWapiSta, false, false); - } - } - } - } else { - list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { - if (_rtw_memcmp(pWapiSta->PeerMacAddr, get_bssid(pmlmepriv), 6)) { - pWapiSta->wapiMsk.bSet = true; - _rtw_memcpy(pWapiSta->wapiMsk.dataKey, param->u.crypt.key, 16); - _rtw_memcpy(pWapiSta->wapiMsk.micKey, param->u.crypt.key + 16, 16); - pWapiSta->wapiMsk.keyId = param->u.crypt.idx ; - pWapiSta->wapiMsk.bTxEnable = false; - if (!pWapiSta->bSetkeyOk) - pWapiSta->bSetkeyOk = true; - pWapiSta->bAuthenticateInProgress = false; - - _rtw_memcpy(pWapiSta->lastRxMulticastPN, WapiAEMultiCastPNInitialValueSrc, 16); - - if (psecuritypriv->sw_decrypt == false) { - /* set rx broadcast key for ASUE */ - rtw_wapi_set_key(padapter, &pWapiSta->wapiMsk, pWapiSta, true, false); - } - } - - } - } - } -#endif - + #ifdef CONFIG_WAPI_SUPPORT + if (strcmp(param->u.crypt.alg, "SMS4") == 0) + rtw_wapi_set_set_encryption(padapter, param); + #endif exit: @@ -1377,13 +1674,12 @@ static int rtw_cfg80211_set_encryption(struct net_device *dev, struct ieee_param return ret; } -static int cfg80211_rtw_add_key(struct wiphy *wiphy, struct net_device *ndev, +static int cfg80211_rtw_add_key(struct wiphy *wiphy, struct net_device *ndev + , u8 key_index #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) - u8 key_index, bool pairwise, const u8 *mac_addr, -#else /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) */ - u8 key_index, const u8 *mac_addr, -#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) */ - struct key_params *params) + , bool pairwise +#endif + , const u8 *mac_addr, struct key_params *params) { char *alg_name; u32 param_len; @@ -1396,17 +1692,21 @@ static int cfg80211_rtw_add_key(struct wiphy *wiphy, struct net_device *ndev, struct sta_info *ptdls_sta; #endif /* CONFIG_TDLS */ - RTW_INFO(FUNC_NDEV_FMT" adding key for %pM\n", FUNC_NDEV_ARG(ndev), mac_addr); - RTW_INFO("cipher=0x%x\n", params->cipher); - RTW_INFO("key_len=0x%x\n", params->key_len); - RTW_INFO("seq_len=0x%x\n", params->seq_len); - RTW_INFO("key_index=%d\n", key_index); + if (mac_addr) + RTW_INFO(FUNC_NDEV_FMT" adding key for %pM\n", FUNC_NDEV_ARG(ndev), mac_addr); + RTW_INFO(FUNC_NDEV_FMT" cipher=0x%x\n", FUNC_NDEV_ARG(ndev), params->cipher); + RTW_INFO(FUNC_NDEV_FMT" key_len=%d, key_index=%d\n", FUNC_NDEV_ARG(ndev), params->key_len, key_index); #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) - RTW_INFO("pairwise=%d\n", pairwise); -#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) */ + RTW_INFO(FUNC_NDEV_FMT" pairwise=%d\n", FUNC_NDEV_ARG(ndev), pairwise); +#endif + + if (rtw_cfg80211_sync_iftype(padapter) != _SUCCESS) { + ret = -ENOTSUPP; + goto addkey_end; + } param_len = sizeof(struct ieee_param) + params->key_len; - param = (struct ieee_param *)rtw_malloc(param_len); + param = rtw_malloc(param_len); if (param == NULL) return -1; @@ -1459,18 +1759,23 @@ static int cfg80211_rtw_add_key(struct wiphy *wiphy, struct net_device *ndev, strncpy((char *)param->u.crypt.alg, alg_name, IEEE_CRYPT_ALG_NAME_LEN); - if (!mac_addr || is_broadcast_ether_addr(mac_addr)) { + if (!mac_addr || is_broadcast_ether_addr(mac_addr) + #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) + || !pairwise + #endif + ) { param->u.crypt.set_tx = 0; /* for wpa/wpa2 group key */ } else { param->u.crypt.set_tx = 1; /* for wpa/wpa2 pairwise key */ } - - /* param->u.crypt.idx = key_index - 1; */ param->u.crypt.idx = key_index; - if (params->seq_len && params->seq) + if (params->seq_len && params->seq) { _rtw_memcpy(param->u.crypt.seq, (u8 *)params->seq, params->seq_len); + RTW_INFO(FUNC_NDEV_FMT" seq_len:%u, seq:0x%llx\n", FUNC_NDEV_ARG(ndev) + , params->seq_len, RTW_GET_LE64(param->u.crypt.seq)); + } if (params->key_len && params->key) { param->u.crypt.key_len = params->key_len; @@ -1488,62 +1793,194 @@ static int cfg80211_rtw_add_key(struct wiphy *wiphy, struct net_device *ndev, } } #endif /* CONFIG_TDLS */ - - ret = rtw_cfg80211_set_encryption(ndev, param, param_len); - } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { + ret = rtw_cfg80211_set_encryption(ndev, param); + } else if (MLME_IS_AP(padapter) || MLME_IS_MESH(padapter)) { #ifdef CONFIG_AP_MODE if (mac_addr) _rtw_memcpy(param->sta_addr, (void *)mac_addr, ETH_ALEN); - ret = rtw_cfg80211_ap_set_encryption(ndev, param, param_len); + ret = rtw_cfg80211_ap_set_encryption(ndev, param); #endif } else if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) == _TRUE || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE ) { /* RTW_INFO("@@@@@@@@@@ fw_state=0x%x, iftype=%d\n", pmlmepriv->fw_state, rtw_wdev->iftype); */ - ret = rtw_cfg80211_set_encryption(ndev, param, param_len); + ret = rtw_cfg80211_set_encryption(ndev, param); } else RTW_INFO("error! fw_state=0x%x, iftype=%d\n", pmlmepriv->fw_state, rtw_wdev->iftype); addkey_end: if (param) - rtw_mfree((u8 *)param, param_len); + rtw_mfree(param, param_len); return ret; } -static int cfg80211_rtw_get_key(struct wiphy *wiphy, struct net_device *ndev, +static int cfg80211_rtw_get_key(struct wiphy *wiphy, struct net_device *ndev + , u8 keyid #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) - u8 key_index, bool pairwise, const u8 *mac_addr, -#else /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) */ - u8 key_index, const u8 *mac_addr, -#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) */ - void *cookie, - void (*callback)(void *cookie, struct key_params *)) -{ -#if 0 - struct iwm_priv *iwm = ndev_to_iwm(ndev); - struct iwm_key *key = &iwm->keys[key_index]; - struct key_params params; - - IWM_DBG_WEXT(iwm, DBG, "Getting key %d\n", key_index); - - memset(¶ms, 0, sizeof(params)); - - params.cipher = key->cipher; - params.key_len = key->key_len; - params.seq_len = key->seq_len; - params.seq = key->seq; - params.key = key->key; - - callback(cookie, ¶ms); - - return key->key_len ? 0 : -ENOENT; + , bool pairwise #endif - RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); - return 0; + , const u8 *mac_addr, void *cookie + , void (*callback)(void *cookie, struct key_params *)) +{ +#define GET_KEY_PARAM_FMT_S " keyid=%d" +#define GET_KEY_PARAM_ARG_S , keyid +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) + #define GET_KEY_PARAM_FMT_2_6_37 ", pairwise=%d" + #define GET_KEY_PARAM_ARG_2_6_37 , pairwise +#else + #define GET_KEY_PARAM_FMT_2_6_37 "" + #define GET_KEY_PARAM_ARG_2_6_37 +#endif +#define GET_KEY_PARAM_FMT_E ", addr=%pM" +#define GET_KEY_PARAM_ARG_E , mac_addr + + _adapter *adapter = (_adapter *)rtw_netdev_priv(ndev); + struct security_priv *sec = &adapter->securitypriv; + struct sta_priv *stapriv = &adapter->stapriv; + struct sta_info *sta = NULL; + u32 cipher = _NO_PRIVACY_; + union Keytype *key = NULL; + u8 key_len = 0; + u64 *pn = NULL; + u8 pn_len = 0; + u8 pn_val[8] = {0}; + + struct key_params params; + int ret = -ENOENT; + + if (keyid >= WEP_KEYS + #ifdef CONFIG_IEEE80211W + && keyid > BIP_MAX_KEYID + #endif + ) + goto exit; + + if (!mac_addr || is_broadcast_ether_addr(mac_addr) + #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) + || (MLME_IS_STA(adapter) && !pairwise) + #endif + ) { + /* WEP key, TX GTK/IGTK, RX GTK/IGTK(for STA mode) */ + if (is_wep_enc(sec->dot118021XGrpPrivacy)) { + if (keyid >= WEP_KEYS) + goto exit; + if (!(sec->key_mask & BIT(keyid))) + goto exit; + cipher = sec->dot118021XGrpPrivacy; + key = &sec->dot11DefKey[keyid]; + } else { + if (keyid < WEP_KEYS) { + if (sec->binstallGrpkey != _TRUE) + goto exit; + cipher = sec->dot118021XGrpPrivacy; + key = &sec->dot118021XGrpKey[keyid]; + sta = rtw_get_bcmc_stainfo(adapter); + if (sta) + pn = &sta->dot11txpn.val; + #ifdef CONFIG_IEEE80211W + } else if (keyid < BIP_MAX_KEYID) { + if (SEC_IS_BIP_KEY_INSTALLED(sec) != _TRUE) + goto exit; + cipher = _BIP_; + key = &sec->dot11wBIPKey[keyid]; + pn = &sec->dot11wBIPtxpn.val; + #endif + } + } + } else { + /* Pairwise key, RX GTK/IGTK for specific peer */ + sta = rtw_get_stainfo(stapriv, mac_addr); + if (!sta) + goto exit; + + if (keyid < WEP_KEYS && pairwise) { + if (sta->bpairwise_key_installed != _TRUE) + goto exit; + cipher = sta->dot118021XPrivacy; + key = &sta->dot118021x_UncstKey; + #ifdef CONFIG_RTW_MESH + } else if (keyid < WEP_KEYS && !pairwise) { + if (!(sta->gtk_bmp & BIT(keyid))) + goto exit; + cipher = sta->group_privacy; + key = &sta->gtk; + #ifdef CONFIG_IEEE80211W + } else if (keyid < BIP_MAX_KEYID && !pairwise) { + if (!(sta->igtk_bmp & BIT(keyid))) + goto exit; + cipher = _BIP_; + key = &sta->igtk; + pn = &sta->igtk_pn.val; + #endif + #endif /* CONFIG_RTW_MESH */ + } + } + + if (!key) + goto exit; + + if (cipher == _WEP40_) { + cipher = WLAN_CIPHER_SUITE_WEP40; + key_len = sec->dot11DefKeylen[keyid]; + } else if (cipher == _WEP104_) { + cipher = WLAN_CIPHER_SUITE_WEP104; + key_len = sec->dot11DefKeylen[keyid]; + } else if (cipher == _TKIP_) { + cipher = WLAN_CIPHER_SUITE_TKIP; + key_len = 16; + } else if (cipher == _AES_) { + cipher = WLAN_CIPHER_SUITE_CCMP; + key_len = 16; + #ifdef CONFIG_IEEE80211W + } else if (cipher == _BIP_) { + cipher = WLAN_CIPHER_SUITE_AES_CMAC; + key_len = 16; + #endif + } else { + RTW_WARN(FUNC_NDEV_FMT" unknown cipher:%u\n", FUNC_NDEV_ARG(ndev), cipher); + rtw_warn_on(1); + goto exit; + } + + if (pn) { + *((u64 *)pn_val) = cpu_to_le64(*pn); + pn_len = 6; + } + + ret = 0; + +exit: + RTW_INFO(FUNC_NDEV_FMT + GET_KEY_PARAM_FMT_S + GET_KEY_PARAM_FMT_2_6_37 + GET_KEY_PARAM_FMT_E + " ret %d\n", FUNC_NDEV_ARG(ndev) + GET_KEY_PARAM_ARG_S + GET_KEY_PARAM_ARG_2_6_37 + GET_KEY_PARAM_ARG_E + , ret); + if (pn) + RTW_INFO(FUNC_NDEV_FMT " seq:0x%llx\n", FUNC_NDEV_ARG(ndev), *pn); + + if (ret == 0) { + _rtw_memset(¶ms, 0, sizeof(params)); + + params.cipher = cipher; + params.key = key->skey; + params.key_len = key_len; + if (pn) { + params.seq = pn_val; + params.seq_len = pn_len; + } + + callback(cookie, ¶ms); + } + + return ret; } static int cfg80211_rtw_del_key(struct wiphy *wiphy, struct net_device *ndev, @@ -1556,7 +1993,7 @@ static int cfg80211_rtw_del_key(struct wiphy *wiphy, struct net_device *ndev, _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); struct security_priv *psecuritypriv = &padapter->securitypriv; - RTW_INFO(FUNC_NDEV_FMT" key_index=%d\n", FUNC_NDEV_ARG(ndev), key_index); + RTW_INFO(FUNC_NDEV_FMT" key_index=%d, addr=%pM\n", FUNC_NDEV_ARG(ndev), key_index, mac_addr); if (key_index == psecuritypriv->dot11PrivacyKeyIndex) { /* clear the flag of wep default key set. */ @@ -1612,6 +2049,24 @@ static int cfg80211_rtw_set_default_key(struct wiphy *wiphy, return 0; } + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 30)) +int cfg80211_rtw_set_default_mgmt_key(struct wiphy *wiphy, + struct net_device *ndev, u8 key_index) +{ +#define SET_DEF_KEY_PARAM_FMT " key_index=%d" +#define SET_DEF_KEY_PARAM_ARG , key_index + + RTW_INFO(FUNC_NDEV_FMT + SET_DEF_KEY_PARAM_FMT + "\n", FUNC_NDEV_ARG(ndev) + SET_DEF_KEY_PARAM_ARG + ); + + return 0; +} +#endif + #if defined(CONFIG_GTK_OL) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 1, 0)) static int cfg80211_rtw_set_rekey_data(struct wiphy *wiphy, struct net_device *ndev, @@ -1647,6 +2102,101 @@ static int cfg80211_rtw_set_rekey_data(struct wiphy *wiphy, return 0; } #endif /*CONFIG_GTK_OL*/ + +#ifdef CONFIG_RTW_MESH +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0)) +static enum nl80211_mesh_power_mode rtw_mesh_ps_to_nl80211_mesh_power_mode(u8 ps) +{ + if (ps == RTW_MESH_PS_UNKNOWN) + return NL80211_MESH_POWER_UNKNOWN; + if (ps == RTW_MESH_PS_ACTIVE) + return NL80211_MESH_POWER_ACTIVE; + if (ps == RTW_MESH_PS_LSLEEP) + return NL80211_MESH_POWER_LIGHT_SLEEP; + if (ps == RTW_MESH_PS_DSLEEP) + return NL80211_MESH_POWER_DEEP_SLEEP; + + rtw_warn_on(1); + return NL80211_MESH_POWER_UNKNOWN; +} +#endif + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) +enum nl80211_plink_state rtw_plink_state_to_nl80211_plink_state(u8 plink_state) +{ + if (plink_state == RTW_MESH_PLINK_UNKNOWN) + return NUM_NL80211_PLINK_STATES; + if (plink_state == RTW_MESH_PLINK_LISTEN) + return NL80211_PLINK_LISTEN; + if (plink_state == RTW_MESH_PLINK_OPN_SNT) + return NL80211_PLINK_OPN_SNT; + if (plink_state == RTW_MESH_PLINK_OPN_RCVD) + return NL80211_PLINK_OPN_RCVD; + if (plink_state == RTW_MESH_PLINK_CNF_RCVD) + return NL80211_PLINK_CNF_RCVD; + if (plink_state == RTW_MESH_PLINK_ESTAB) + return NL80211_PLINK_ESTAB; + if (plink_state == RTW_MESH_PLINK_HOLDING) + return NL80211_PLINK_HOLDING; + if (plink_state == RTW_MESH_PLINK_BLOCKED) + return NL80211_PLINK_BLOCKED; + + rtw_warn_on(1); + return NUM_NL80211_PLINK_STATES; +} + +u8 nl80211_plink_state_to_rtw_plink_state(enum nl80211_plink_state plink_state) +{ + if (plink_state == NL80211_PLINK_LISTEN) + return RTW_MESH_PLINK_LISTEN; + if (plink_state == NL80211_PLINK_OPN_SNT) + return RTW_MESH_PLINK_OPN_SNT; + if (plink_state == NL80211_PLINK_OPN_RCVD) + return RTW_MESH_PLINK_OPN_RCVD; + if (plink_state == NL80211_PLINK_CNF_RCVD) + return RTW_MESH_PLINK_CNF_RCVD; + if (plink_state == NL80211_PLINK_ESTAB) + return RTW_MESH_PLINK_ESTAB; + if (plink_state == NL80211_PLINK_HOLDING) + return RTW_MESH_PLINK_HOLDING; + if (plink_state == NL80211_PLINK_BLOCKED) + return RTW_MESH_PLINK_BLOCKED; + + rtw_warn_on(1); + return RTW_MESH_PLINK_UNKNOWN; +} +#endif + +static void rtw_cfg80211_fill_mesh_only_sta_info(struct mesh_plink_ent *plink, struct sta_info *sta, struct station_info *sinfo) +{ + sinfo->filled |= STATION_INFO_LLID; + sinfo->llid = plink->llid; + sinfo->filled |= STATION_INFO_PLID; + sinfo->plid = plink->plid; + sinfo->filled |= STATION_INFO_PLINK_STATE; + sinfo->plink_state = rtw_plink_state_to_nl80211_plink_state(plink->plink_state); + if (!sta && plink->scanned) { + sinfo->filled |= STATION_INFO_SIGNAL; + sinfo->signal = translate_percentage_to_dbm(plink->scanned->network.PhyInfo.SignalStrength); + sinfo->filled |= STATION_INFO_INACTIVE_TIME; + if (plink->plink_state == RTW_MESH_PLINK_UNKNOWN) + sinfo->inactive_time = 0 - 1; + else + sinfo->inactive_time = rtw_get_passing_time_ms(plink->scanned->last_scanned); + } +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0)) + if (sta) { + sinfo->filled |= STATION_INFO_LOCAL_PM; + sinfo->local_pm = rtw_mesh_ps_to_nl80211_mesh_power_mode(sta->local_mps); + sinfo->filled |= STATION_INFO_PEER_PM; + sinfo->peer_pm = rtw_mesh_ps_to_nl80211_mesh_power_mode(sta->peer_mps); + sinfo->filled |= STATION_INFO_NONPEER_PM; + sinfo->nonpeer_pm = rtw_mesh_ps_to_nl80211_mesh_power_mode(sta->nonpeer_mps); + } +#endif +} +#endif /* CONFIG_RTW_MESH */ + static int cfg80211_rtw_get_station(struct wiphy *wiphy, struct net_device *ndev, #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 16, 0)) @@ -1661,6 +2211,9 @@ static int cfg80211_rtw_get_station(struct wiphy *wiphy, struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct sta_info *psta = NULL; struct sta_priv *pstapriv = &padapter->stapriv; +#ifdef CONFIG_RTW_MESH + struct mesh_plink_ent *plink = NULL; +#endif sinfo->filled = 0; @@ -1670,9 +2223,23 @@ static int cfg80211_rtw_get_station(struct wiphy *wiphy, goto exit; } - psta = rtw_get_stainfo(pstapriv, (u8 *)mac); - if (psta == NULL) { - RTW_INFO("%s, sta_info is null\n", __func__); + psta = rtw_get_stainfo(pstapriv, mac); +#ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(padapter)) { + if (psta) + plink = psta->plink; + if (!plink) + plink = rtw_mesh_plink_get(padapter, mac); + } +#endif /* CONFIG_RTW_MESH */ + + if ((!MLME_IS_MESH(padapter) && !psta) + #ifdef CONFIG_RTW_MESH + || (MLME_IS_MESH(padapter) && !plink) + #endif + ) { + RTW_INFO(FUNC_NDEV_FMT" no sta info for mac="MAC_FMT"\n" + , FUNC_NDEV_ARG(ndev), MAC_ARG(mac)); ret = -ENOENT; goto exit; } @@ -1698,26 +2265,29 @@ static int cfg80211_rtw_get_station(struct wiphy *wiphy, sinfo->filled |= STATION_INFO_TX_BITRATE; sinfo->txrate.legacy = rtw_get_cur_max_rate(padapter); + } + if (psta) { + if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _FALSE + || check_fwstate(pmlmepriv, _FW_LINKED) == _FALSE + ) { + sinfo->filled |= STATION_INFO_SIGNAL; + sinfo->signal = translate_percentage_to_dbm(psta->cmn.rssi_stat.rssi); + } + sinfo->filled |= STATION_INFO_INACTIVE_TIME; + sinfo->inactive_time = rtw_get_passing_time_ms(psta->sta_stats.last_rx_time); sinfo->filled |= STATION_INFO_RX_PACKETS; sinfo->rx_packets = sta_rx_data_pkts(psta); - 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 */ - if ((check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) - || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) - || check_fwstate(pmlmepriv, WIFI_AP_STATE)) - && check_fwstate(pmlmepriv, _FW_LINKED) - ) { - /* TODO: should acquire station info... */ - } +#ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(padapter)) + rtw_cfg80211_fill_mesh_only_sta_info(plink, psta, sinfo); +#endif exit: return ret; @@ -1744,7 +2314,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; @@ -1755,6 +2328,9 @@ static int cfg80211_rtw_change_iface(struct wiphy *wiphy, #ifdef CONFIG_P2P struct wifidirect_info *pwdinfo = &(padapter->wdinfo); u8 is_p2p = _FALSE; +#endif +#ifdef CONFIG_MONITOR_MODE_XMIT + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); #endif int ret = 0; u8 change = _FALSE; @@ -1857,6 +2433,12 @@ static int cfg80211_rtw_change_iface(struct wiphy *wiphy, break; +#ifdef CONFIG_RTW_MESH + case NL80211_IFTYPE_MESH_POINT: + networkType = Ndis802_11_mesh; + break; +#endif + case NL80211_IFTYPE_MONITOR: networkType = Ndis802_11Monitor; #if 0 @@ -1877,8 +2459,11 @@ static int cfg80211_rtw_change_iface(struct wiphy *wiphy, goto exit; } - rtw_setopmode_cmd(padapter, networkType, _TRUE); - + rtw_setopmode_cmd(padapter, networkType, RTW_CMDF_WAIT_ACK); +#ifdef CONFIG_MONITOR_MODE_XMIT + if (check_fwstate(pmlmepriv, WIFI_MONITOR_STATE) == _TRUE) + rtw_indicate_connect(padapter); +#endif exit: RTW_INFO(FUNC_NDEV_FMT" ret:%d\n", FUNC_NDEV_ARG(ndev), ret); @@ -1926,7 +2511,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(); @@ -1973,7 +2558,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 @@ -2004,17 +2589,17 @@ int rtw_cfg80211_is_target_wps_scan(struct cfg80211_scan_request *scan_req, stru static void _rtw_cfg80211_surveydone_event_callback(_adapter *padapter, struct cfg80211_scan_request *scan_req) { + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); + RT_CHANNEL_INFO *chset = rfctl->channel_set; _irqL irqL; _list *plist, *phead; struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); _queue *queue = &(pmlmepriv->scanned_queue); struct wlan_network *pnetwork = NULL; - u32 cnt = 0; - u32 wait_for_surveydone; - sint wait_status; struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); struct cfg80211_ssid target_ssid; u8 target_wps_scan = 0; + u8 ch; #ifdef CONFIG_DEBUG_CFG80211 RTW_INFO("%s\n", __func__); @@ -2039,11 +2624,15 @@ static void _rtw_cfg80211_surveydone_event_callback(_adapter *padapter, struct c break; pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); + ch = pnetwork->network.Configuration.DSConfig; /* 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 - && rtw_mlme_band_check(padapter, pnetwork->network.Configuration.DSConfig) == _TRUE + if (rtw_chset_search_ch(chset, ch) >= 0 + && rtw_mlme_band_check(padapter, ch) == _TRUE && _TRUE == rtw_validate_ssid(&(pnetwork->network.Ssid)) + && (!IS_DFS_SLAVE_WITH_RD(rfctl) + || rtw_odm_dfs_domain_unknown(rfctl_to_dvobj(rfctl)) + || !rtw_chset_is_ch_non_ocp(chset, ch)) ) { if (target_wps_scan) rtw_cfg80211_clear_wps_sr_of_non_target_bss(padapter, pnetwork, &target_ssid); @@ -2244,10 +2833,11 @@ void rtw_cfg80211_indicate_scan_done_for_buddy(_adapter *padapter, bool bscan_ab indicate_buddy_scan = _FALSE; _enter_critical_bh(&wdev_priv->scan_req_lock, &irqL); - if (wdev_priv->scan_request && mlmepriv->scanning_via_buddy_intf == _TRUE) { + if (mlmepriv->scanning_via_buddy_intf == _TRUE) { mlmepriv->scanning_via_buddy_intf = _FALSE; clr_fwstate(mlmepriv, _FW_UNDER_SURVEY); - indicate_buddy_scan = _TRUE; + if (wdev_priv->scan_request) + indicate_buddy_scan = _TRUE; } _exit_critical_bh(&wdev_priv->scan_req_lock, &irqL); @@ -2267,28 +2857,22 @@ static int cfg80211_rtw_scan(struct wiphy *wiphy #endif , struct cfg80211_scan_request *request) { - int i, chan_num = 0; + int i; 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; - u8 *p2p_ie = NULL; - uint p2p_ielen = 0; u8 survey_times = 3; u8 survey_times_for_one_ch = 6; struct cfg80211_ssid *ssids = request->ssids; int social_channel = 0, j = 0; bool need_indicate_scan_done = _FALSE; bool ps_denied = _FALSE; - + u8 ssc_chk; _adapter *padapter; struct wireless_dev *wdev; struct rtw_wdev_priv *pwdev_priv; - struct mlme_priv *pmlmepriv; + struct mlme_priv *pmlmepriv = NULL; #ifdef CONFIG_P2P struct wifidirect_info *pwdinfo; #endif /* CONFIG_P2P */ @@ -2324,18 +2908,103 @@ static int cfg80211_rtw_scan(struct wiphy *wiphy RTW_INFO(FUNC_ADPT_FMT"%s\n", FUNC_ADPT_ARG(padapter) , wdev == wiphy_to_pd_wdev(wiphy) ? " PD" : ""); -#ifdef CONFIG_MP_INCLUDED - if (rtw_mi_mp_mode_check(padapter)) { - RTW_INFO("MP mode block Scan request\n"); - ret = -EPERM; - goto exit; - } -#endif +#if 1 + ssc_chk = rtw_sitesurvey_condition_check(padapter, _TRUE); - 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; - goto check_need_indicate_scan_done; + if (ssc_chk == SS_DENY_MP_MODE) + goto bypass_p2p_chk; +#ifdef DBG_LA_MODE + if (ssc_chk == SS_DENY_LA_MODE) + goto bypass_p2p_chk; +#endif +#ifdef CONFIG_P2P + if (pwdinfo->driver_interface == DRIVER_CFG80211) { + if (ssids->ssid != NULL + && _rtw_memcmp(ssids->ssid, "DIRECT-", 7) + && rtw_get_p2p_ie((u8 *)request->ie, request->ie_len, NULL, NULL) + ) { + if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) + rtw_p2p_enable(padapter, P2P_ROLE_DEVICE); + else { + rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); + #ifdef CONFIG_DEBUG_CFG80211 + RTW_INFO("%s, role=%d, p2p_state=%d\n", __func__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo)); + #endif + } + rtw_p2p_set_state(pwdinfo, P2P_STATE_LISTEN); + + if (request->n_channels == 3 && + request->channels[0]->hw_value == 1 && + request->channels[1]->hw_value == 6 && + request->channels[2]->hw_value == 11 + ) + social_channel = 1; + } + } +#endif /*CONFIG_P2P*/ + + if (request->ie && request->ie_len > 0) + rtw_cfg80211_set_probe_req_wpsp2pie(padapter, (u8 *)request->ie, request->ie_len); + +bypass_p2p_chk: + + switch (ssc_chk) { + case SS_ALLOW : + break; + + case SS_DENY_MP_MODE: + ret = -EPERM; + goto exit; + #ifdef DBG_LA_MODE + case SS_DENY_LA_MODE: + ret = -EPERM; + goto exit; + #endif + #ifdef CONFIG_RTW_REPEATER_SON + case SS_DENY_RSON_SCANING : + #endif + case SS_DENY_BLOCK_SCAN : + case SS_DENY_SELF_AP_UNDER_WPS : + case SS_DENY_SELF_AP_UNDER_LINKING : + case SS_DENY_SELF_AP_UNDER_SURVEY : + case SS_DENY_SELF_STA_UNDER_SURVEY : + #ifdef CONFIG_CONCURRENT_MODE + case SS_DENY_BUDDY_UNDER_LINK_WPS : + #endif + case SS_DENY_BUSY_TRAFFIC : + need_indicate_scan_done = _TRUE; + goto check_need_indicate_scan_done; + + case SS_DENY_BY_DRV : + #if CONFIG_NOTIFY_SCAN_ABORT_WITH_BUSY + ret = -EBUSY; + goto exit; + #else + need_indicate_scan_done = _TRUE; + goto check_need_indicate_scan_done; + #endif + break; + + case SS_DENY_SELF_STA_UNDER_LINKING : + ret = -EBUSY; + goto check_need_indicate_scan_done; + + #ifdef CONFIG_CONCURRENT_MODE + case SS_DENY_BUDDY_UNDER_SURVEY : + { + bool scan_via_buddy = rtw_cfg80211_scan_via_buddy(padapter, request); + + if (scan_via_buddy == _FALSE) + need_indicate_scan_done = _TRUE; + + goto check_need_indicate_scan_done; + } + #endif + + default : + RTW_ERR("site survey check code (%d) unknown\n", ssc_chk); + need_indicate_scan_done = _TRUE; + goto check_need_indicate_scan_done; } rtw_ps_deny(padapter, PS_DENY_SCAN); @@ -2345,6 +3014,17 @@ static int cfg80211_rtw_scan(struct wiphy *wiphy goto check_need_indicate_scan_done; } +#else + + +#ifdef CONFIG_MP_INCLUDED + if (rtw_mp_mode_check(padapter)) { + RTW_INFO("MP mode block Scan request\n"); + ret = -EPERM; + goto exit; + } +#endif + #ifdef CONFIG_P2P if (pwdinfo->driver_interface == DRIVER_CFG80211) { if (ssids->ssid != NULL @@ -2374,11 +3054,37 @@ static int cfg80211_rtw_scan(struct wiphy *wiphy if (request->ie && request->ie_len > 0) rtw_cfg80211_set_probe_req_wpsp2pie(padapter, (u8 *)request->ie, request->ie_len); - if (rtw_is_scan_deny(padapter)) { - RTW_INFO(FUNC_ADPT_FMT ": scan deny\n", FUNC_ADPT_ARG(padapter)); +#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; + goto check_need_indicate_scan_done; + } + + rtw_ps_deny(padapter, PS_DENY_SCAN); + ps_denied = _TRUE; + if (_FAIL == rtw_pwr_wakeup(padapter)) { + need_indicate_scan_done = _TRUE; + goto check_need_indicate_scan_done; + } + + if (rtw_is_scan_deny(padapter)) { + RTW_INFO(FUNC_ADPT_FMT ": scan deny\n", FUNC_ADPT_ARG(padapter)); +#if CONFIG_NOTIFY_SCAN_ABORT_WITH_BUSY + ret = -EBUSY; + goto exit; +#else + need_indicate_scan_done = _TRUE; + goto check_need_indicate_scan_done; +#endif + } /* check fw state*/ if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { @@ -2429,11 +3135,11 @@ static int cfg80211_rtw_scan(struct wiphy *wiphy need_indicate_scan_done = _TRUE; goto check_need_indicate_scan_done; } +#endif #ifdef CONFIG_P2P if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) && !rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE)) { rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH); - rtw_free_network_queue(padapter, _TRUE); if (social_channel == 0) rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_NONE); @@ -2442,46 +3148,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 @@ -2497,6 +3199,7 @@ static int cfg80211_rtw_scan(struct wiphy *wiphy 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); @@ -2505,13 +3208,14 @@ static int cfg80211_rtw_scan(struct wiphy *wiphy #endif } -cancel_ps_deny: if (ps_denied == _TRUE) rtw_ps_deny_cancel(padapter, PS_DENY_SCAN); exit: - return ret; + if (pmlmepriv) + pmlmepriv->lastscantime = rtw_get_current_time(); + return ret; } static int cfg80211_rtw_set_wiphy_params(struct wiphy *wiphy, u32 changed) @@ -2583,6 +3287,12 @@ static int rtw_cfg80211_set_auth_type(struct security_priv *psecuritypriv, { RTW_INFO("%s, nl80211_auth_type=%d\n", __func__, sme_auth_type); + psecuritypriv->auth_type = sme_auth_type; + + if (sme_auth_type == NL80211_AUTHTYPE_SAE) { + psecuritypriv->auth_alg = WLAN_AUTH_SAE; + return 0; + } switch (sme_auth_type) { case NL80211_AUTHTYPE_AUTOMATIC: @@ -2720,8 +3430,8 @@ static int rtw_cfg80211_set_key_mgt(struct security_priv *psecuritypriv, u32 key static int rtw_cfg80211_set_wpa_ie(_adapter *padapter, u8 *pie, size_t ielen) { u8 *buf = NULL, *pos = NULL; - u32 left; int group_cipher = 0, pairwise_cipher = 0; + u8 mfp_opt = MFP_NO; int ret = 0; int wpa_ielen = 0; int wpa2_ielen = 0; @@ -2747,13 +3457,8 @@ static int rtw_cfg80211_set_wpa_ie(_adapter *padapter, u8 *pie, size_t ielen) _rtw_memcpy(buf, pie , ielen); - /* dump */ - { - int i; - RTW_INFO("set wpa_ie(length:%zu):\n", ielen); - for (i = 0; i < ielen; i = i + 8) - RTW_INFO("0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x 0x%.2x\n", buf[i], buf[i + 1], buf[i + 2], buf[i + 3], buf[i + 4], buf[i + 5], buf[i + 6], buf[i + 7]); - } + RTW_INFO("set wpa_ie(length:%zu):\n", ielen); + RTW_INFO_DUMP(NULL, buf, ielen); pos = buf; if (ielen < RSN_HEADER_LEN) { @@ -2774,7 +3479,7 @@ static int rtw_cfg80211_set_wpa_ie(_adapter *padapter, u8 *pie, size_t ielen) pwpa2 = rtw_get_wpa2_ie(buf, &wpa2_ielen, ielen); if (pwpa2 && wpa2_ielen > 0) { - if (rtw_parse_wpa2_ie(pwpa2, wpa2_ielen + 2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) { + if (rtw_parse_wpa2_ie(pwpa2, wpa2_ielen + 2, &group_cipher, &pairwise_cipher, NULL, &mfp_opt) == _SUCCESS) { padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeWPA2PSK; _rtw_memcpy(padapter->securitypriv.supplicant_ie, &pwpa2[0], wpa2_ielen + 2); @@ -2834,6 +3539,13 @@ static int rtw_cfg80211_set_wpa_ie(_adapter *padapter, u8 *pie, size_t ielen) break; } + if (mfp_opt == MFP_INVALID) { + RTW_INFO(FUNC_ADPT_FMT" invalid MFP setting\n", FUNC_ADPT_ARG(padapter)); + ret = -EINVAL; + goto exit; + } + padapter->securitypriv.mfp_opt = mfp_opt; + {/* handle wps_ie */ uint wps_ielen; u8 *wps_ie; @@ -2920,10 +3632,7 @@ static int cfg80211_rtw_join_ibss(struct wiphy *wiphy, struct net_device *ndev, _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); NDIS_802_11_SSID ndis_ssid; struct security_priv *psecuritypriv = &padapter->securitypriv; - struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); - WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)(&(pmlmeinfo->network)); #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) struct cfg80211_chan_def *pch_def; #endif @@ -2947,11 +3656,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; @@ -3006,9 +3710,9 @@ static int cfg80211_rtw_leave_ibss(struct wiphy *wiphy, struct net_device *ndev) RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); - #ifdef SUPPLICANT_RTK_VERSION_LOWER_THAN_JB42 - padapter->mlmepriv.not_indic_disco = _TRUE; - #endif +#if (RTW_CFG80211_BLOCK_STA_DISCON_EVENT & RTW_CFG80211_BLOCK_DISCON_WHEN_DISCONNECT) + rtw_wdev_set_not_indic_disco(adapter_wdev_data(padapter), 1); +#endif old_type = rtw_wdev->iftype; @@ -3025,54 +3729,141 @@ static int cfg80211_rtw_leave_ibss(struct wiphy *wiphy, struct net_device *ndev) ret = -EPERM; goto leave_ibss; } - rtw_setopmode_cmd(padapter, Ndis802_11Infrastructure, _TRUE); + rtw_setopmode_cmd(padapter, Ndis802_11Infrastructure, RTW_CMDF_WAIT_ACK); } leave_ibss: - #ifdef SUPPLICANT_RTK_VERSION_LOWER_THAN_JB42 - padapter->mlmepriv.not_indic_disco = _FALSE; - #endif +#if (RTW_CFG80211_BLOCK_STA_DISCON_EVENT & RTW_CFG80211_BLOCK_DISCON_WHEN_DISCONNECT) + rtw_wdev_set_not_indic_disco(adapter_wdev_data(padapter), 0); +#endif return 0; } +bool rtw_cfg80211_is_connect_requested(_adapter *adapter) +{ + struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(adapter); + _irqL irqL; + bool requested; + + _enter_critical_bh(&pwdev_priv->connect_req_lock, &irqL); + requested = pwdev_priv->connect_req ? 1 : 0; + _exit_critical_bh(&pwdev_priv->connect_req_lock, &irqL); + + return requested; +} + +static int _rtw_disconnect(struct wiphy *wiphy, struct net_device *ndev) +{ + _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); + + + /* if(check_fwstate(&padapter->mlmepriv, _FW_LINKED)) */ + { + rtw_scan_abort(padapter); + rtw_join_abort_timeout(padapter, 300); + LeaveAllPowerSaveMode(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_cmd(padapter, _TRUE, RTW_CMDF_WAIT_ACK); + + /* indicate locally_generated = 0 when suspend */ + #if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 2, 0)) + rtw_indicate_disconnect(padapter, 0, wiphy->dev.power.is_prepared ? _FALSE : _TRUE); + #else + /* + * for kernel < 4.2, DISCONNECT event is hardcoded with + * NL80211_ATTR_DISCONNECTED_BY_AP=1 in NL80211 layer + * no need to judge if under suspend + */ + rtw_indicate_disconnect(padapter, 0, _TRUE); + #endif + + rtw_pwr_wakeup(padapter); + } + return 0; +} + +#if (KERNEL_VERSION(4, 17, 0) > LINUX_VERSION_CODE) +static bool rtw_check_connect_sae_compat(struct cfg80211_connect_params *sme) +{ + struct rtw_ieee802_11_elems elems; + struct rsne_info info; + u8 AKM_SUITE_SAE[] = { 0x00, 0x0f, 0xac, 8 }; + int i; + + if (sme->auth_type != 1) + return false; + + if (rtw_ieee802_11_parse_elems((u8 *)sme->ie, sme->ie_len, &elems, 0) + == ParseFailed) + return false; + + if (!elems.rsn_ie) + return false; + + if (rtw_rsne_info_parse(elems.rsn_ie - 2, elems.rsn_ie_len + 2, &info) == _FAIL) + return false; + + for (i = 0; i < info.akm_cnt; i++) + if (memcmp(info.akm_list + i * RSN_SELECTOR_LEN, + AKM_SUITE_SAE, RSN_SELECTOR_LEN) == 0) + return true; + + return false; +} +#else +#define rtw_check_connect_sae_compat(sme) false +#endif + 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; - u8 *dst_ssid, *src_ssid; - u8 *dst_bssid, *src_bssid; /* u8 matched_by_bssid=_FALSE; */ /* u8 matched_by_ssid=_FALSE; */ - u8 matched = _FALSE; _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); - struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct security_priv *psecuritypriv = &padapter->securitypriv; - _queue *queue = &pmlmepriv->scanned_queue; + struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + _irqL irqL; -#ifdef SUPPLICANT_RTK_VERSION_LOWER_THAN_JB42 - padapter->mlmepriv.not_indic_disco = _TRUE; +#if (RTW_CFG80211_BLOCK_STA_DISCON_EVENT & RTW_CFG80211_BLOCK_DISCON_WHEN_CONNECT) + rtw_wdev_set_not_indic_disco(pwdev_priv, 1); #endif 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 (rtw_check_connect_sae_compat(sme)) { + sme->auth_type = NL80211_AUTHTYPE_SAE; + RTW_INFO("%s set sme->auth_type=%d for SAE compat\n", __FUNCTION__, + NL80211_AUTHTYPE_SAE); + } - 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; } + if (check_fwstate(pmlmepriv, _FW_LINKED | _FW_UNDER_LINKING) == _TRUE) { + + _rtw_disconnect(wiphy, ndev); + RTW_INFO("%s disconnect before connecting! fw_state=0x%x\n", + __FUNCTION__, pmlmepriv->fw_state); + } + #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)) @@ -3101,17 +3892,9 @@ 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); - goto cancel_ps_deny; - } + rtw_mi_scan_abort(padapter, _TRUE); + rtw_join_abort_timeout(padapter, 300); #ifdef CONFIG_CONCURRENT_MODE if (rtw_mi_buddy_check_fwstate(padapter, _FW_UNDER_LINKING)) { ret = -EINVAL; @@ -3119,8 +3902,6 @@ static int cfg80211_rtw_connect(struct wiphy *wiphy, struct net_device *ndev, } #endif - rtw_mi_scan_abort(padapter, _TRUE); - _rtw_memset(&ndis_ssid, 0, sizeof(NDIS_802_11_SSID)); ndis_ssid.SsidLength = sme->ssid_len; _rtw_memcpy(ndis_ssid.Ssid, (u8 *)sme->ssid, sme->ssid_len); @@ -3137,6 +3918,8 @@ static int cfg80211_rtw_connect(struct wiphy *wiphy, struct net_device *ndev, psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; psecuritypriv->dot11AuthAlgrthm = dot11AuthAlgrthm_Open; /* open system */ psecuritypriv->ndisauthtype = Ndis802_11AuthModeOpen; + psecuritypriv->auth_alg = WLAN_AUTH_OPEN; + psecuritypriv->extauth_status = WLAN_STATUS_UNSPECIFIED_FAILURE; #ifdef CONFIG_WAPI_SUPPORT padapter->wapiInfo.bWapiEnable = false; @@ -3263,6 +4046,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); @@ -3272,8 +4071,8 @@ 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; +#if (RTW_CFG80211_BLOCK_STA_DISCON_EVENT & RTW_CFG80211_BLOCK_DISCON_WHEN_CONNECT) + rtw_wdev_set_not_indic_disco(pwdev_priv, 0); #endif return ret; @@ -3286,29 +4085,22 @@ static int cfg80211_rtw_disconnect(struct wiphy *wiphy, struct net_device *ndev, 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 (RTW_CFG80211_BLOCK_STA_DISCON_EVENT & RTW_CFG80211_BLOCK_DISCON_WHEN_DISCONNECT) + #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) + if (!wiphy->dev.power.is_prepared) + #endif + rtw_wdev_set_not_indic_disco(adapter_wdev_data(padapter), 1); #endif rtw_set_to_roam(padapter, 0); /* if(check_fwstate(&padapter->mlmepriv, _FW_LINKED)) */ { - rtw_scan_abort(padapter); - LeaveAllPowerSaveMode(padapter); - rtw_disassoc_cmd(padapter, 500, _FALSE); - rtw_sta_mstatus_report(padapter); - - RTW_INFO("%s...call rtw_indicate_disconnect\n", __func__); - - rtw_free_assoc_resources(padapter, 1); - rtw_indicate_disconnect(padapter, 0, _TRUE); - - rtw_pwr_wakeup(padapter); + _rtw_disconnect(wiphy, ndev); } -#ifdef SUPPLICANT_RTK_VERSION_LOWER_THAN_JB42 - padapter->mlmepriv.not_indic_disco = _FALSE; +#if (RTW_CFG80211_BLOCK_STA_DISCON_EVENT & RTW_CFG80211_BLOCK_DISCON_WHEN_DISCONNECT) + rtw_wdev_set_not_indic_disco(adapter_wdev_data(padapter), 0); #endif RTW_INFO(FUNC_NDEV_FMT" return 0\n", FUNC_NDEV_ARG(ndev)); @@ -3388,12 +4180,48 @@ static int cfg80211_rtw_set_power_mgmt(struct wiphy *wiphy, #ifdef CONFIG_LPS if (!enabled) - rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE_CFG80211_PWRMGMT, 1); + rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE_CFG80211_PWRMGMT, 0); #endif return 0; } +static void _rtw_set_pmksa(struct net_device *ndev, + u8 *bssid, u8 *pmkid) +{ + _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); + struct security_priv *psecuritypriv = &padapter->securitypriv; + u8 index, blInserted = _FALSE; + + /* overwrite PMKID */ + for (index = 0 ; index < NUM_PMKID_CACHE; index++) { + if (_rtw_memcmp(psecuritypriv->PMKIDList[index].Bssid, bssid, ETH_ALEN) == _TRUE) { + /* BSSID is matched, the same AP => rewrite with new PMKID. */ + RTW_INFO("BSSID("MAC_FMT") exists in the PMKList.\n", MAC_ARG(bssid)); + + _rtw_memcpy(psecuritypriv->PMKIDList[index].PMKID, pmkid, WLAN_PMKID_LEN); + psecuritypriv->PMKIDList[index].bUsed = _TRUE; + psecuritypriv->PMKIDIndex = index + 1; + blInserted = _TRUE; + break; + } + } + + if (!blInserted) { + /* Find a new entry */ + RTW_INFO("Use the new entry index = %d for this PMKID.\n", + psecuritypriv->PMKIDIndex); + + _rtw_memcpy(psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].Bssid, bssid, ETH_ALEN); + _rtw_memcpy(psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].PMKID, pmkid, WLAN_PMKID_LEN); + + psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].bUsed = _TRUE; + psecuritypriv->PMKIDIndex++ ; + if (psecuritypriv->PMKIDIndex == 16) + psecuritypriv->PMKIDIndex = 0; + } +} + static int cfg80211_rtw_set_pmksa(struct wiphy *wiphy, struct net_device *ndev, struct cfg80211_pmksa *pmksa) @@ -3403,6 +4231,7 @@ static int cfg80211_rtw_set_pmksa(struct wiphy *wiphy, struct mlme_priv *mlme = &padapter->mlmepriv; struct security_priv *psecuritypriv = &padapter->securitypriv; u8 strZeroMacAddress[ETH_ALEN] = { 0x00 }; + bool sae_auth = rtw_sec_chk_auth_type(padapter, NL80211_AUTHTYPE_SAE); RTW_INFO(FUNC_NDEV_FMT" "MAC_FMT" "KEY_FMT"\n", FUNC_NDEV_ARG(ndev) , MAC_ARG(pmksa->bssid), KEY_ARG(pmksa->pmkid)); @@ -3410,39 +4239,17 @@ static int cfg80211_rtw_set_pmksa(struct wiphy *wiphy, if (_rtw_memcmp((u8 *)pmksa->bssid, strZeroMacAddress, ETH_ALEN) == _TRUE) return -EINVAL; - if (check_fwstate(mlme, _FW_LINKED) == _FALSE) { + if (check_fwstate(mlme, _FW_LINKED) == _FALSE && !sae_auth) { RTW_INFO(FUNC_NDEV_FMT" not set pmksa cause not in linked state\n", FUNC_NDEV_ARG(ndev)); return -EINVAL; } - blInserted = _FALSE; + _rtw_set_pmksa(ndev, (u8 *)pmksa->bssid, (u8 *)pmksa->pmkid); - /* overwrite PMKID */ - for (index = 0 ; index < NUM_PMKID_CACHE; index++) { - if (_rtw_memcmp(psecuritypriv->PMKIDList[index].Bssid, (u8 *)pmksa->bssid, ETH_ALEN) == _TRUE) { - /* BSSID is matched, the same AP => rewrite with new PMKID. */ - RTW_INFO(FUNC_NDEV_FMT" BSSID exists in the PMKList.\n", FUNC_NDEV_ARG(ndev)); - - _rtw_memcpy(psecuritypriv->PMKIDList[index].PMKID, (u8 *)pmksa->pmkid, WLAN_PMKID_LEN); - psecuritypriv->PMKIDList[index].bUsed = _TRUE; - psecuritypriv->PMKIDIndex = index + 1; - blInserted = _TRUE; - break; - } - } - - if (!blInserted) { - /* Find a new entry */ - RTW_INFO(FUNC_NDEV_FMT" Use the new entry index = %d for this PMKID.\n", - FUNC_NDEV_ARG(ndev), psecuritypriv->PMKIDIndex); - - _rtw_memcpy(psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].Bssid, (u8 *)pmksa->bssid, ETH_ALEN); - _rtw_memcpy(psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].PMKID, (u8 *)pmksa->pmkid, WLAN_PMKID_LEN); - - psecuritypriv->PMKIDList[psecuritypriv->PMKIDIndex].bUsed = _TRUE; - psecuritypriv->PMKIDIndex++ ; - if (psecuritypriv->PMKIDIndex == 16) - psecuritypriv->PMKIDIndex = 0; + if (sae_auth && + (psecuritypriv->extauth_status == WLAN_STATUS_SUCCESS)) { + RTW_PRINT("SAE: auth success, start assoc\n"); + start_clnt_assoc(padapter); } return 0; @@ -3497,10 +4304,12 @@ static int cfg80211_rtw_flush_pmksa(struct wiphy *wiphy, #ifdef CONFIG_AP_MODE void rtw_cfg80211_indicate_sta_assoc(_adapter *padapter, u8 *pmgmt_frame, uint frame_len) { +#if !defined(RTW_USE_CFG80211_STA_EVENT) && !defined(COMPAT_KERNEL_RELEASE) s32 freq; int channel; struct wireless_dev *pwdev = padapter->rtw_wdev; struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); +#endif struct net_device *ndev = padapter->pnetdev; RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); @@ -3545,8 +4354,9 @@ void rtw_cfg80211_indicate_sta_assoc(_adapter *padapter, u8 *pmgmt_frame, uint f } -void rtw_cfg80211_indicate_sta_disassoc(_adapter *padapter, unsigned char *da, unsigned short reason) +void rtw_cfg80211_indicate_sta_disassoc(_adapter *padapter, const u8 *da, unsigned short reason) { +#if !defined(RTW_USE_CFG80211_STA_EVENT) && !defined(COMPAT_KERNEL_RELEASE) s32 freq; int channel; u8 *pmgmt_frame; @@ -3557,6 +4367,7 @@ void rtw_cfg80211_indicate_sta_disassoc(_adapter *padapter, unsigned char *da, u struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); struct wireless_dev *wdev = padapter->rtw_wdev; +#endif struct net_device *ndev = padapter->pnetdev; RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); @@ -3625,17 +4436,27 @@ static int rtw_cfg80211_monitor_if_xmit_entry(struct sk_buff *skb, struct net_de int snap_len = 6; unsigned char *pdata; u16 frame_ctl; - unsigned char src_mac_addr[6]; - unsigned char dst_mac_addr[6]; + unsigned char src_mac_addr[ETH_ALEN]; + unsigned char dst_mac_addr[ETH_ALEN]; struct rtw_ieee80211_hdr *dot11_hdr; struct ieee80211_radiotap_header *rtap_hdr; _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); +#ifdef CONFIG_DFS_MASTER + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); +#endif RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); if (skb) rtw_mstat_update(MSTAT_TYPE_SKB, MSTAT_ALLOC_SUCCESS, skb->truesize); + if (IS_CH_WAITING(rfctl)) { + #ifdef CONFIG_DFS_MASTER + if (rtw_rfctl_overlap_radar_detect_ch(rfctl)) + goto fail; + #endif + } + if (unlikely(skb->len < sizeof(struct ieee80211_radiotap_header))) goto fail; @@ -3766,11 +4587,12 @@ static int rtw_cfg80211_monitor_if_xmit_entry(struct sk_buff *skb, struct net_de } +#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 2, 0)) static void rtw_cfg80211_monitor_if_set_multicast_list(struct net_device *ndev) { RTW_INFO("%s\n", __func__); } - +#endif static int rtw_cfg80211_monitor_if_set_mac_address(struct net_device *ndev, void *addr) { int ret = 0; @@ -3823,7 +4645,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; @@ -3889,7 +4715,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; @@ -3915,6 +4745,9 @@ static int #endif case NL80211_IFTYPE_STATION: case NL80211_IFTYPE_AP: +#ifdef CONFIG_RTW_MESH + case NL80211_IFTYPE_MESH_POINT: +#endif padapter = dvobj_get_unregisterd_adapter(dvobj); if (!padapter) { RTW_WARN("adapter pool empty!\n"); @@ -3943,7 +4776,6 @@ static int case NL80211_IFTYPE_ADHOC: case NL80211_IFTYPE_AP_VLAN: case NL80211_IFTYPE_WDS: - case NL80211_IFTYPE_MESH_POINT: default: ret = -ENODEV; RTW_INFO("Unsupported interface type\n"); @@ -4024,7 +4856,6 @@ static int rtw_add_beacon(_adapter *adapter, const u8 *head, size_t head_len, co u8 *pbuf = NULL; uint len, wps_ielen = 0; uint p2p_ielen = 0; - u8 *p2p_ie; u8 got_p2p_ie = _FALSE; struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); /* struct sta_priv *pstapriv = &padapter->stapriv; */ @@ -4039,6 +4870,12 @@ static int rtw_add_beacon(_adapter *adapter, const u8 *head, size_t head_len, co if (head_len < 24) return -EINVAL; + #ifdef CONFIG_FW_HANDLE_TXBCN + if (!rtw_ap_nums_check(adapter)) { + RTW_ERR(FUNC_ADPT_FMT"failed, con't support over %d BCN\n", FUNC_ADPT_ARG(adapter), CONFIG_LIMITED_AP_NUM); + return -EINVAL; + } + #endif /*CONFIG_FW_HANDLE_TXBCN*/ pbuf = rtw_zmalloc(head_len + tail_len); if (!pbuf) @@ -4064,7 +4901,6 @@ static int rtw_add_beacon(_adapter *adapter, const u8 *head, size_t head_len, co if (adapter->wdinfo.driver_interface == DRIVER_CFG80211) { /* check p2p if enable */ if (rtw_get_p2p_ie(pbuf + _FIXED_IE_LENGTH_, len - _FIXED_IE_LENGTH_, NULL, &p2p_ielen)) { - struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; struct wifidirect_info *pwdinfo = &(adapter->wdinfo); RTW_INFO("got p2p_ie, len=%d\n", p2p_ielen); @@ -4118,8 +4954,16 @@ static int cfg80211_rtw_add_beacon(struct wiphy *wiphy, struct net_device *ndev, _adapter *adapter = (_adapter *)rtw_netdev_priv(ndev); RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); + + if (rtw_cfg80211_sync_iftype(adapter) != _SUCCESS) { + ret = -ENOTSUPP; + goto exit; + } + rtw_mi_scan_abort(adapter, _TRUE); + rtw_mi_buddy_set_scan_deny(adapter, 300); ret = rtw_add_beacon(adapter, info->head, info->head_len, info->tail, info->tail_len); +exit: return ret; } @@ -4140,8 +4984,13 @@ static int cfg80211_rtw_set_beacon(struct wiphy *wiphy, struct net_device *ndev, static int cfg80211_rtw_del_beacon(struct wiphy *wiphy, struct net_device *ndev) { + _adapter *adapter = (_adapter *)rtw_netdev_priv(ndev); + RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); + rtw_set_802_11_infrastructure_mode(adapter, Ndis802_11Infrastructure); + rtw_setopmode_cmd(adapter, Ndis802_11Infrastructure, RTW_CMDF_WAIT_ACK); + return 0; } #else @@ -4154,6 +5003,20 @@ static int cfg80211_rtw_start_ap(struct wiphy *wiphy, struct net_device *ndev, RTW_INFO(FUNC_NDEV_FMT" hidden_ssid:%d, auth_type:%d\n", FUNC_NDEV_ARG(ndev), settings->hidden_ssid, settings->auth_type); + if (rtw_cfg80211_sync_iftype(adapter) != _SUCCESS) { + ret = -ENOTSUPP; + goto exit; + } + + /* + Kernel < v5.1, the auth_type set as NL80211_AUTHTYPE_AUTOMATIC. + if the AKM SAE in the RSN IE, we have to update the auth_type for SAE + in rtw_check_beacon_data(). + */ + rtw_cfg80211_set_auth_type(&adapter->securitypriv, settings->auth_type); + + rtw_mi_scan_abort(adapter, _TRUE); + rtw_mi_buddy_set_scan_deny(adapter, 300); ret = rtw_add_beacon(adapter, settings->beacon.head, settings->beacon.head_len, settings->beacon.tail, settings->beacon.tail_len); @@ -4179,6 +5042,7 @@ static int cfg80211_rtw_start_ap(struct wiphy *wiphy, struct net_device *ndev, pbss_network_ext->Ssid.Ssid, pbss_network_ext->Ssid.SsidLength); } +exit: return ret; } @@ -4197,10 +5061,15 @@ static int cfg80211_rtw_change_beacon(struct wiphy *wiphy, struct net_device *nd static int cfg80211_rtw_stop_ap(struct wiphy *wiphy, struct net_device *ndev) { + _adapter *adapter = (_adapter *)rtw_netdev_priv(ndev); + RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); + + rtw_set_802_11_infrastructure_mode(adapter, Ndis802_11Infrastructure); + rtw_setopmode_cmd(adapter, Ndis802_11Infrastructure, RTW_CMDF_WAIT_ACK); + return 0; } - #endif /* (LINUX_VERSION_CODE < KERNEL_VERSION(3, 4, 0)) */ #if CONFIG_RTW_MACADDR_ACL && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0)) @@ -4214,6 +5083,7 @@ static int cfg80211_rtw_set_mac_acl(struct wiphy *wiphy, struct net_device *ndev if (!params) { RTW_WARN(FUNC_ADPT_FMT" params NULL\n", FUNC_ADPT_ARG(adapter)); + rtw_macaddr_acl_clear(adapter, RTW_ACL_PERIOD_BSS); goto exit; } @@ -4225,25 +5095,197 @@ static int cfg80211_rtw_set_mac_acl(struct wiphy *wiphy, struct net_device *ndev else if (params->acl_policy == NL80211_ACL_POLICY_DENY_UNLESS_LISTED) acl_mode = RTW_ACL_MODE_DENY_UNLESS_LISTED; - if (!params->n_acl_entries) { - if (acl_mode != RTW_ACL_MODE_DISABLED) - RTW_WARN(FUNC_ADPT_FMT" acl_policy:%d with no entry\n" - , FUNC_ADPT_ARG(adapter), params->acl_policy); - acl_mode = RTW_ACL_MODE_DISABLED; - goto exit; - } + rtw_macaddr_acl_clear(adapter, RTW_ACL_PERIOD_BSS); + + rtw_set_macaddr_acl(adapter, RTW_ACL_PERIOD_BSS, acl_mode); for (i = 0; i < params->n_acl_entries; i++) - rtw_acl_add_sta(adapter, params->mac_addrs[i].addr); + rtw_acl_add_sta(adapter, RTW_ACL_PERIOD_BSS, params->mac_addrs[i].addr); ret = 0; exit: - rtw_set_macaddr_acl(adapter, acl_mode); return ret; } #endif /* CONFIG_RTW_MACADDR_ACL && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0)) */ +const char *_nl80211_sta_flags_str[] = { + "INVALID", + "AUTHORIZED", + "SHORT_PREAMBLE", + "WME", + "MFP", + "AUTHENTICATED", + "TDLS_PEER", + "ASSOCIATED", +}; + +#define nl80211_sta_flags_str(_f) ((_f <= NL80211_STA_FLAG_MAX) ? _nl80211_sta_flags_str[_f] : _nl80211_sta_flags_str[0]) + +const char *_nl80211_plink_state_str[] = { + "LISTEN", + "OPN_SNT", + "OPN_RCVD", + "CNF_RCVD", + "ESTAB", + "HOLDING", + "BLOCKED", + "UNKNOWN", +}; + +#define nl80211_plink_state_str(_s) ((_s < NUM_NL80211_PLINK_STATES) ? _nl80211_plink_state_str[_s] : _nl80211_plink_state_str[NUM_NL80211_PLINK_STATES]) + +#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 10, 0)) +#define NL80211_PLINK_ACTION_NO_ACTION PLINK_ACTION_INVALID +#define NL80211_PLINK_ACTION_OPEN PLINK_ACTION_OPEN +#define NL80211_PLINK_ACTION_BLOCK PLINK_ACTION_BLOCK +#define NUM_NL80211_PLINK_ACTIONS 3 +#endif + +const char *_nl80211_plink_actions_str[] = { + "NO_ACTION", + "OPEN", + "BLOCK", + "UNKNOWN", +}; + +#define nl80211_plink_actions_str(_a) ((_a < NUM_NL80211_PLINK_ACTIONS) ? _nl80211_plink_actions_str[_a] : _nl80211_plink_actions_str[NUM_NL80211_PLINK_ACTIONS]) + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0)) +const char *_nl80211_mesh_power_mode_str[] = { + "UNKNOWN", + "ACTIVE", + "LIGHT_SLEEP", + "DEEP_SLEEP", +}; + +#define nl80211_mesh_power_mode_str(_p) ((_p <= NL80211_MESH_POWER_MAX) ? _nl80211_mesh_power_mode_str[_p] : _nl80211_mesh_power_mode_str[0]) +#endif + +void dump_station_parameters(void *sel, struct wiphy *wiphy, const struct station_parameters *params) +{ +#if DBG_RTW_CFG80211_STA_PARAM + if (params->supported_rates_len) { + #define SUPP_RATES_BUF_LEN (3 * RTW_G_RATES_NUM + 1) + int i; + char supp_rates_buf[SUPP_RATES_BUF_LEN] = {0}; + u8 cnt = 0; + + rtw_warn_on(params->supported_rates_len > RTW_G_RATES_NUM); + + for (i = 0; i < params->supported_rates_len; i++) { + if (i >= RTW_G_RATES_NUM) + break; + cnt += snprintf(supp_rates_buf + cnt, SUPP_RATES_BUF_LEN - cnt -1 + , "%02X ", params->supported_rates[i]); + if (cnt >= SUPP_RATES_BUF_LEN - 1) + break; + } + + RTW_PRINT_SEL(sel, "supported_rates:%s\n", supp_rates_buf); + } + + if (params->vlan) + RTW_PRINT_SEL(sel, "vlan:"NDEV_FMT"\n", NDEV_ARG(params->vlan)); + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 31)) + if (params->sta_flags_mask) { + #define STA_FLAGS_BUF_LEN 128 + int i = 0; + char sta_flags_buf[STA_FLAGS_BUF_LEN] = {0}; + u8 cnt = 0; + + for (i = 1; i <= NL80211_STA_FLAG_MAX; i++) { + if (params->sta_flags_mask & BIT(i)) { + cnt += snprintf(sta_flags_buf + cnt, STA_FLAGS_BUF_LEN - cnt -1, "%s=%u " + , nl80211_sta_flags_str(i), (params->sta_flags_set & BIT(i)) ? 1 : 0); + if (cnt >= STA_FLAGS_BUF_LEN - 1) + break; + } + } + + RTW_PRINT_SEL(sel, "sta_flags:%s\n", sta_flags_buf); + } +#else + u32 station_flags; + #error "TBD\n" +#endif + + if (params->listen_interval != -1) + RTW_PRINT_SEL(sel, "listen_interval:%d\n", params->listen_interval); + + if (params->aid) + RTW_PRINT_SEL(sel, "aid:%u\n", params->aid); + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 8, 0)) + if (params->peer_aid) + RTW_PRINT_SEL(sel, "peer_aid:%u\n", params->peer_aid); +#endif + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 26)) + if (params->plink_action != NL80211_PLINK_ACTION_NO_ACTION) + RTW_PRINT_SEL(sel, "plink_action:%s\n", nl80211_plink_actions_str(params->plink_action)); +#endif + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) + #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 10, 0)) + if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE) + #endif + RTW_PRINT_SEL(sel, "plink_state:%s\n" + , nl80211_plink_state_str(params->plink_state)); +#endif + +#if 0 /* TODO */ +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 28)) + const struct ieee80211_ht_cap *ht_capa; +#endif +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) + const struct ieee80211_vht_cap *vht_capa; +#endif +#endif + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 2, 0)) + if (params->sta_modify_mask & STATION_PARAM_APPLY_UAPSD) + RTW_PRINT_SEL(sel, "uapsd_queues:0x%02x\n", params->uapsd_queues); + if (params->max_sp) + RTW_PRINT_SEL(sel, "max_sp:%u\n", params->max_sp); +#endif + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0)) + if (params->local_pm != NL80211_MESH_POWER_UNKNOWN) { + RTW_PRINT_SEL(sel, "local_pm:%s\n" + , nl80211_mesh_power_mode_str(params->local_pm)); + } + + if (params->sta_modify_mask & STATION_PARAM_APPLY_CAPABILITY) + RTW_PRINT_SEL(sel, "capability:0x%04x\n", params->capability); + +#if 0 /* TODO */ + const u8 *ext_capab; + u8 ext_capab_len; +#endif +#endif + +#if 0 /* TODO */ +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 13, 0)) + const u8 *supported_channels; + u8 supported_channels_len; + const u8 *supported_oper_classes; + u8 supported_oper_classes_len; +#endif + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0)) + u8 opmode_notif; + bool opmode_notif_used; +#endif + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 7, 0)) + int support_p2p_ps; +#endif +#endif +#endif /* DBG_RTW_CFG80211_STA_PARAM */ +} + static int cfg80211_rtw_add_station(struct wiphy *wiphy, struct net_device *ndev, #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 16, 0)) u8 *mac, @@ -4253,12 +5295,148 @@ static int cfg80211_rtw_add_station(struct wiphy *wiphy, struct net_device *ndev struct station_parameters *params) { int ret = 0; -#ifdef CONFIG_TDLS _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); +#if defined(CONFIG_TDLS) || defined(CONFIG_RTW_MESH) struct sta_priv *pstapriv = &padapter->stapriv; +#endif +#ifdef CONFIG_TDLS struct sta_info *psta; #endif /* CONFIG_TDLS */ - RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); + + RTW_INFO(FUNC_NDEV_FMT" mac:"MAC_FMT"\n", FUNC_NDEV_ARG(ndev), MAC_ARG(mac)); + +#if CONFIG_RTW_MACADDR_ACL + if (rtw_access_ctrl(padapter, mac) == _FALSE) { + RTW_INFO(FUNC_NDEV_FMT" deny by macaddr ACL\n", FUNC_NDEV_ARG(ndev)); + ret = -EINVAL; + goto exit; + } +#endif + + dump_station_parameters(RTW_DBGDUMP, wiphy, params); + +#ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(padapter)) { + struct rtw_mesh_cfg *mcfg = &padapter->mesh_cfg; + struct rtw_mesh_info *minfo = &padapter->mesh_info; + struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; + struct mesh_plink_ent *plink = NULL; + struct wlan_network *scanned = NULL; + bool acnode = 0; + u8 add_new_sta = 0, probe_req = 0; + _irqL irqL; + + if (params->plink_state != NL80211_PLINK_LISTEN) { + RTW_WARN(FUNC_NDEV_FMT" %s\n", FUNC_NDEV_ARG(ndev), nl80211_plink_state_str(params->plink_state)); + rtw_warn_on(1); + } + if (!params->aid || params->aid > pstapriv->max_aid) { + RTW_WARN(FUNC_NDEV_FMT" invalid aid:%u\n", FUNC_NDEV_ARG(ndev), params->aid); + rtw_warn_on(1); + ret = -EINVAL; + goto exit; + } + + _enter_critical_bh(&(plink_ctl->lock), &irqL); + + plink = _rtw_mesh_plink_get(padapter, mac); + if (plink) + goto release_plink_ctl; + + #if CONFIG_RTW_MESH_PEER_BLACKLIST + if (rtw_mesh_peer_blacklist_search(padapter, mac)) { + RTW_INFO(FUNC_NDEV_FMT" deny by peer blacklist\n" + , FUNC_NDEV_ARG(ndev)); + ret = -EINVAL; + goto release_plink_ctl; + } + #endif + + scanned = rtw_find_network(&padapter->mlmepriv.scanned_queue, mac); + if (!scanned + || rtw_get_passing_time_ms(scanned->last_scanned) >= mcfg->peer_sel_policy.scanr_exp_ms + ) { + if (!scanned) + RTW_INFO(FUNC_NDEV_FMT" corresponding network not found\n", FUNC_NDEV_ARG(ndev)); + else + RTW_INFO(FUNC_NDEV_FMT" corresponding network too old\n", FUNC_NDEV_ARG(ndev)); + + if (adapter_to_rfctl(padapter)->offch_state == OFFCHS_NONE) + probe_req = 1; + + ret = -EINVAL; + goto release_plink_ctl; + } + + #if CONFIG_RTW_MESH_ACNODE_PREVENT + if (plink_ctl->acnode_rsvd) + acnode = rtw_mesh_scanned_is_acnode_confirmed(padapter, scanned); + #endif + + /* wpa_supplicant's auto peer will initiate peering when candidate peer is reported without max_peer_links consideration */ + if (plink_ctl->num >= mcfg->max_peer_links + acnode ? 1 : 0) { + RTW_INFO(FUNC_NDEV_FMT" exceed max_peer_links:%u%s\n" + , FUNC_NDEV_ARG(ndev), mcfg->max_peer_links, acnode ? " acn" : ""); + ret = -EINVAL; + goto release_plink_ctl; + } + + if (!rtw_bss_is_candidate_mesh_peer(&padapter->mlmepriv.cur_network.network, &scanned->network, 1, 1)) { + RTW_WARN(FUNC_NDEV_FMT" corresponding network is not candidate with same ch\n" + , FUNC_NDEV_ARG(ndev)); + ret = -EINVAL; + goto release_plink_ctl; + } + + #if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST + if (!rtw_mesh_cto_mgate_network_filter(padapter, scanned)) { + RTW_INFO(FUNC_NDEV_FMT" peer filtered out by cto_mgate check\n" + , FUNC_NDEV_ARG(ndev)); + ret = -EINVAL; + goto release_plink_ctl; + } + #endif + + if (_rtw_mesh_plink_add(padapter, mac) == _SUCCESS) { + /* hook corresponding network in scan queue */ + plink = _rtw_mesh_plink_get(padapter, mac); + plink->aid = params->aid; + plink->scanned = scanned; + + #if CONFIG_RTW_MESH_ACNODE_PREVENT + if (acnode) { + RTW_INFO(FUNC_ADPT_FMT" acnode "MAC_FMT"\n" + , FUNC_ADPT_ARG(padapter), MAC_ARG(scanned->network.MacAddress)); + } + #endif + + add_new_sta = 1; + } else { + RTW_WARN(FUNC_NDEV_FMT" rtw_mesh_plink_add not success\n" + , FUNC_NDEV_ARG(ndev)); + ret = -EINVAL; + } +release_plink_ctl: + _exit_critical_bh(&(plink_ctl->lock), &irqL); + + if (probe_req) + issue_probereq(padapter, &padapter->mlmepriv.cur_network.network.mesh_id, mac); + + if (add_new_sta) { + struct station_info sinfo; + + #ifdef CONFIG_DFS_MASTER + if (IS_UNDER_CAC(adapter_to_rfctl(padapter))) + rtw_force_stop_cac(adapter_to_rfctl(padapter), 300); + #endif + + /* indicate new sta */ + _rtw_memset(&sinfo, 0, sizeof(sinfo)); + cfg80211_new_sta(ndev, mac, &sinfo, GFP_ATOMIC); + } + goto exit; + } +#endif /* CONFIG_RTW_MESH */ #ifdef CONFIG_TDLS psta = rtw_get_stainfo(pstapriv, (u8 *)mac); @@ -4296,17 +5474,16 @@ static int cfg80211_rtw_del_station(struct wiphy *wiphy, struct net_device *ndev struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); struct sta_priv *pstapriv = &padapter->stapriv; - RTW_INFO("+"FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); - - #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 19, 0)) target_mac = mac; #else 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__); + RTW_INFO("+"FUNC_NDEV_FMT" mac=%pM\n", FUNC_NDEV_ARG(ndev), target_mac); + + 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; } @@ -4316,8 +5493,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; } @@ -4341,17 +5519,18 @@ 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--; + STA_SET_MESH_PLINK(psta, NULL); /* _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); @@ -4370,6 +5549,11 @@ static int cfg80211_rtw_del_station(struct wiphy *wiphy, struct net_device *ndev associated_clients_update(padapter, updated, STA_INFO_UPDATE_ALL); +#ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(padapter)) + rtw_mesh_plink_del(padapter, target_mac); +#endif + RTW_INFO("-"FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); return ret; @@ -4384,15 +5568,132 @@ static int cfg80211_rtw_change_station(struct wiphy *wiphy, struct net_device *n #endif struct station_parameters *params) { - RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); +#ifdef CONFIG_RTW_MESH + _adapter *adapter = (_adapter *)rtw_netdev_priv(ndev); + struct sta_priv *stapriv = &adapter->stapriv; + struct sta_info *sta = NULL; + _irqL irqL; +#endif + int ret = 0; - return 0; + RTW_INFO(FUNC_NDEV_FMT" mac:"MAC_FMT"\n", FUNC_NDEV_ARG(ndev), MAC_ARG(mac)); + + dump_station_parameters(RTW_DBGDUMP, wiphy, params); + +#ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(adapter)) { + enum cfg80211_station_type sta_type = CFG80211_STA_MESH_PEER_USER; + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct mesh_plink_pool *plink_ctl = &minfo->plink_ctl; + struct mesh_plink_ent *plink = NULL; + _irqL irqL2; + struct sta_info *del_sta = NULL; + + ret = cfg80211_check_station_change(wiphy, params, sta_type); + if (ret) { + RTW_INFO("cfg80211_check_station_change return %d\n", ret); + goto exit; + } + + _enter_critical_bh(&(plink_ctl->lock), &irqL2); + + plink = _rtw_mesh_plink_get(adapter, mac); + if (!plink) { + ret = -ENOENT; + goto release_plink_ctl; + } + + plink->plink_state = nl80211_plink_state_to_rtw_plink_state(params->plink_state); + + #if CONFIG_RTW_MESH_ACNODE_PREVENT + if (params->plink_state == NL80211_PLINK_OPN_SNT + #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 10, 0)) + && (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE) + #endif + ) { + if (rtw_mesh_scanned_is_acnode_confirmed(adapter, plink->scanned) + && rtw_mesh_acnode_prevent_allow_sacrifice(adapter) + ) { + struct sta_info *sac = rtw_mesh_acnode_prevent_pick_sacrifice(adapter); + + if (sac) { + del_sta = sac; + _enter_critical_bh(&stapriv->asoc_list_lock, &irqL); + if (!rtw_is_list_empty(&del_sta->asoc_list)) { + rtw_list_delete(&del_sta->asoc_list); + stapriv->asoc_list_cnt--; + STA_SET_MESH_PLINK(del_sta, NULL); + } + _exit_critical_bh(&stapriv->asoc_list_lock, &irqL); + RTW_INFO(FUNC_ADPT_FMT" sacrifice "MAC_FMT" for acnode\n" + , FUNC_ADPT_ARG(adapter), MAC_ARG(del_sta->cmn.mac_addr)); + } + } + } else + #endif + if ((params->plink_state == NL80211_PLINK_OPN_RCVD + || params->plink_state == NL80211_PLINK_CNF_RCVD + || params->plink_state == NL80211_PLINK_ESTAB) + #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 10, 0)) + && (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE) + #endif + ) { + sta = rtw_get_stainfo(stapriv, mac); + if (!sta) { + sta = rtw_alloc_stainfo(stapriv, mac); + if (!sta) + goto release_plink_ctl; + } + + if (params->plink_state == NL80211_PLINK_ESTAB) { + if (rtw_mesh_peer_establish(adapter, plink, sta) != _SUCCESS) { + rtw_free_stainfo(adapter, sta); + ret = -ENOENT; + goto release_plink_ctl; + } + } + } + else if (params->plink_state == NL80211_PLINK_HOLDING + #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 10, 0)) + && (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE) + #endif + ) { + del_sta = rtw_get_stainfo(stapriv, mac); + if (!del_sta) + goto release_plink_ctl; + + _enter_critical_bh(&stapriv->asoc_list_lock, &irqL); + if (!rtw_is_list_empty(&del_sta->asoc_list)) { + rtw_list_delete(&del_sta->asoc_list); + stapriv->asoc_list_cnt--; + STA_SET_MESH_PLINK(del_sta, NULL); + } + _exit_critical_bh(&stapriv->asoc_list_lock, &irqL); + } + +release_plink_ctl: + _exit_critical_bh(&(plink_ctl->lock), &irqL2); + + if (del_sta) { + u8 sta_addr[ETH_ALEN]; + u8 updated = _FALSE; + + _rtw_memcpy(sta_addr, del_sta->cmn.mac_addr, ETH_ALEN); + updated = ap_free_sta(adapter, del_sta, 0, 0, 1); + rtw_mesh_expire_peer(stapriv->padapter, sta_addr); + + associated_clients_update(adapter, updated, STA_INFO_UPDATE_ALL); + } + } + +exit: +#endif /* CONFIG_RTW_MESH */ + + return ret; } -struct sta_info *rtw_sta_info_get_by_idx(const int idx, struct sta_priv *pstapriv) - +struct sta_info *rtw_sta_info_get_by_idx(struct sta_priv *pstapriv, const int idx, u8 *asoc_list_num) { - _list *phead, *plist; struct sta_info *psta = NULL; int i = 0; @@ -4407,32 +5708,75 @@ struct sta_info *rtw_sta_info_get_by_idx(const int idx, struct sta_priv *pstapri plist = get_next(plist); i++; } + + if (asoc_list_num) + *asoc_list_num = i; + return psta; } static int cfg80211_rtw_dump_station(struct wiphy *wiphy, struct net_device *ndev, int idx, u8 *mac, struct station_info *sinfo) { +#define DBG_DUMP_STATION 0 int ret = 0; _irqL irqL; _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); - struct sta_info *psta = NULL; struct sta_priv *pstapriv = &padapter->stapriv; - RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); + struct sta_info *psta = NULL; +#ifdef CONFIG_RTW_MESH + struct mesh_plink_ent *plink = NULL; +#endif + u8 asoc_list_num; + + if (DBG_DUMP_STATION) + RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); - psta = rtw_sta_info_get_by_idx(idx, pstapriv); + psta = rtw_sta_info_get_by_idx(pstapriv, idx, &asoc_list_num); _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); - if (NULL == psta) { - RTW_INFO("Station is not found\n"); + +#ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(padapter)) { + if (psta) + plink = psta->plink; + if (!plink) + plink = rtw_mesh_plink_get_no_estab_by_idx(padapter, idx - asoc_list_num); + } +#endif /* CONFIG_RTW_MESH */ + + if ((!MLME_IS_MESH(padapter) && !psta) + #ifdef CONFIG_RTW_MESH + || (MLME_IS_MESH(padapter) && !plink) + #endif + ) { + if (DBG_DUMP_STATION) + RTW_INFO(FUNC_NDEV_FMT" end with idx:%d\n", FUNC_NDEV_ARG(ndev), idx); ret = -ENOENT; goto exit; } - _rtw_memcpy(mac, psta->hwaddr, ETH_ALEN); + + if (psta) + _rtw_memcpy(mac, psta->cmn.mac_addr, ETH_ALEN); + #ifdef CONFIG_RTW_MESH + else + _rtw_memcpy(mac, plink->addr, ETH_ALEN); + #endif + sinfo->filled = 0; - sinfo->filled |= STATION_INFO_SIGNAL; - sinfo->signal = psta->rssi; + + if (psta) { + sinfo->filled |= STATION_INFO_SIGNAL; + sinfo->signal = translate_percentage_to_dbm(psta->cmn.rssi_stat.rssi); + sinfo->filled |= STATION_INFO_INACTIVE_TIME; + sinfo->inactive_time = rtw_get_passing_time_ms(psta->sta_stats.last_rx_time); + } + +#ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(padapter)) + rtw_cfg80211_fill_mesh_only_sta_info(plink, psta, sinfo); +#endif exit: return ret; @@ -4441,8 +5785,6 @@ static int cfg80211_rtw_dump_station(struct wiphy *wiphy, struct net_device *nde static int cfg80211_rtw_change_bss(struct wiphy *wiphy, struct net_device *ndev, struct bss_parameters *params) { - u8 i; - RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); /* RTW_INFO("use_cts_prot=%d\n", params->use_cts_prot); @@ -4458,6 +5800,98 @@ static int cfg80211_rtw_change_bss(struct wiphy *wiphy, struct net_device *ndev, } +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) +static int cfg80211_rtw_set_txq_params(struct wiphy *wiphy +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 2, 0)) + , struct net_device *ndev +#endif + , struct ieee80211_txq_params *params) +{ +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 2, 0)) + _adapter *padapter = rtw_netdev_priv(ndev); +#else + _adapter *padapter = wiphy_to_adapter(wiphy); +#endif + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + u8 ac, AIFS, ECWMin, ECWMax, aSifsTime; + u16 TXOP; + u8 shift_count = 0; + u32 acParm; + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 5, 0)) + ac = params->ac; +#else + ac = params->queue; +#endif + +#if 0 + RTW_INFO("ac=%d\n", ac); + RTW_INFO("txop=%u\n", params->txop); + RTW_INFO("cwmin=%u\n", params->cwmin); + RTW_INFO("cwmax=%u\n", params->cwmax); + RTW_INFO("aifs=%u\n", params->aifs); +#endif + + if (is_supported_5g(pmlmeext->cur_wireless_mode) || + (pmlmeext->cur_wireless_mode & WIRELESS_11_24N)) + aSifsTime = 16; + else + aSifsTime = 10; + + AIFS = params->aifs * pmlmeinfo->slotTime + aSifsTime; + + while ((params->cwmin + 1) >> shift_count != 1) { + shift_count++; + if (shift_count == 15) + break; + } + + ECWMin = shift_count; + + shift_count = 0; + while ((params->cwmax + 1) >> shift_count != 1) { + shift_count++; + if (shift_count == 15) + break; + } + + ECWMax = shift_count; + + TXOP = le16_to_cpu(params->txop); + + acParm = AIFS | (ECWMin << 8) | (ECWMax << 12) | (TXOP << 16); + + switch (ac) { + case NL80211_TXQ_Q_VO: + RTW_INFO(FUNC_NDEV_FMT" AC_VO = 0x%08x\n", FUNC_ADPT_ARG(padapter), acParm); + rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VO, (u8 *)(&acParm)); + break; + + case NL80211_TXQ_Q_VI: + RTW_INFO(FUNC_NDEV_FMT" AC_VI = 0x%08x\n", FUNC_ADPT_ARG(padapter), acParm); + rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_VI, (u8 *)(&acParm)); + break; + + case NL80211_TXQ_Q_BE: + RTW_INFO(FUNC_NDEV_FMT" AC_BE = 0x%08x\n", FUNC_ADPT_ARG(padapter), acParm); + rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&acParm)); + break; + + case NL80211_TXQ_Q_BK: + RTW_INFO(FUNC_NDEV_FMT" AC_BK = 0x%08x\n", FUNC_ADPT_ARG(padapter), acParm); + rtw_hal_set_hwreg(padapter, HW_VAR_AC_PARAM_BK, (u8 *)(&acParm)); + break; + + default: + break; + } + + return 0; +} +#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) */ + +#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 6, 0)) static int cfg80211_rtw_set_channel(struct wiphy *wiphy #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) , struct net_device *ndev @@ -4497,10 +5931,14 @@ 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; } +#endif /*#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 6, 0))*/ static int cfg80211_rtw_set_monitor_channel(struct wiphy *wiphy #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) @@ -4593,12 +6031,14 @@ 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; } - +/* static int cfg80211_rtw_auth(struct wiphy *wiphy, struct net_device *ndev, struct cfg80211_auth_request *req) { @@ -4614,12 +6054,12 @@ static int cfg80211_rtw_assoc(struct wiphy *wiphy, struct net_device *ndev, return 0; } +*/ #endif /* CONFIG_AP_MODE */ void rtw_cfg80211_rx_probe_request(_adapter *adapter, union recv_frame *rframe) { struct wireless_dev *wdev = adapter->rtw_wdev; - struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(adapter); u8 *frame = get_recvframe_data(rframe); uint frame_len = rframe->u.hdr.len; s32 freq; @@ -4629,7 +6069,8 @@ 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) @@ -4652,7 +6093,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) @@ -4685,7 +6127,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) { @@ -4713,6 +6156,7 @@ void rtw_cfg80211_rx_p2p_action_public(_adapter *adapter, union recv_frame *rfra break; case P2P_PROVISION_DISC_RESP: case P2P_INVIT_RESP: + rtw_clear_scan_deny(adapter); #if !RTW_P2P_GROUP_INTERFACE rtw_mi_buddy_set_scan_deny(adapter, 2000); #endif @@ -4741,22 +6185,36 @@ void rtw_cfg80211_rx_p2p_action_public(_adapter *adapter, union recv_frame *rfra void rtw_cfg80211_rx_action(_adapter *adapter, union recv_frame *rframe, const char *msg) { struct wireless_dev *wdev = adapter->rtw_wdev; - struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(adapter); u8 *frame = get_recvframe_data(rframe); uint frame_len = rframe->u.hdr.len; s32 freq; u8 ch, sch = rtw_get_oper_ch(adapter); u8 category, action; + int type = -1; 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*/ +#ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(adapter)) { + type = rtw_mesh_check_frames_rx(adapter, frame, frame_len); + if (type >= 0) + goto indicate; } +#endif + 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*/ + } + } +#ifdef CONFIG_RTW_MESH +indicate: +#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); @@ -4764,11 +6222,60 @@ 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); + if (type == -1) { + 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 freq; + u8 ch, sch = rtw_get_oper_ch(adapter); + + ch = rframe->u.hdr.attrib.ch ? rframe->u.hdr.attrib.ch : sch; + 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(%d), ta="MAC_FMT"\n" + , ch, sch, MAC_ARG(get_addr2_ptr(frame))); +} +#endif /* CONFIG_RTW_80211K */ + +void rtw_cfg80211_rx_mframe(_adapter *adapter, union recv_frame *rframe, const char *msg) +{ + struct wireless_dev *wdev = adapter->rtw_wdev; + u8 *frame = get_recvframe_data(rframe); + uint frame_len = rframe->u.hdr.len; + s32 freq; + u8 ch, sch = rtw_get_oper_ch(adapter); + + ch = rframe->u.hdr.attrib.ch ? rframe->u.hdr.attrib.ch : sch; + 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(%d), ta="MAC_FMT"\n", ch, sch, MAC_ARG(get_addr2_ptr(frame))); + if (!rtw_sae_preprocess(adapter, frame, frame_len, _FALSE)) { + if (msg) + RTW_INFO("RTW_Rx:%s\n", msg); + else + RTW_INFO("RTW_Rx:frame_control:0x%02x\n", le16_to_cpu(((struct rtw_ieee80211_hdr_3addr *)rframe)->frame_ctl)); + } } #ifdef CONFIG_P2P @@ -4801,7 +6308,6 @@ void rtw_cfg80211_issue_p2p_provision_request(_adapter *padapter, const u8 *buf, unsigned short *fctrl; struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); struct wifidirect_info *pwdinfo = &(padapter->wdinfo); u8 *frame_body = (unsigned char *)(buf + sizeof(struct rtw_ieee80211_hdr_3addr)); @@ -5002,7 +6508,7 @@ static s32 cfg80211_rtw_update_ft_ies(struct wiphy *wiphy, { _adapter *padapter = NULL; struct mlme_priv *pmlmepriv = NULL; - ft_priv *pftpriv = NULL; + struct ft_roam_info *pft_roam = NULL; _irqL irqL; u8 *p; u8 *pie = NULL; @@ -5013,24 +6519,22 @@ static s32 cfg80211_rtw_update_ft_ies(struct wiphy *wiphy, padapter = (_adapter *)rtw_netdev_priv(ndev); pmlmepriv = &(padapter->mlmepriv); - pftpriv = &pmlmepriv->ftpriv; + pft_roam = &(pmlmepriv->ft_roam); p = (u8 *)ftie->ie; - if (ftie->ie_len <= sizeof(pftpriv->updated_ft_ies)) { + if (ftie->ie_len <= sizeof(pft_roam->updated_ft_ies)) { _enter_critical_bh(&pmlmepriv->lock, &irqL); - _rtw_memcpy(pftpriv->updated_ft_ies, ftie->ie, ftie->ie_len); - pftpriv->updated_ft_ies_len = ftie->ie_len; + _rtw_memcpy(pft_roam->updated_ft_ies, ftie->ie, ftie->ie_len); + pft_roam->updated_ft_ies_len = ftie->ie_len; _exit_critical_bh(&pmlmepriv->lock, &irqL); } else { RTW_ERR("FTIEs parsing fail!\n"); return -EINVAL; } - if ((rtw_to_roam(padapter) > 0) && rtw_chk_ft_status(padapter, RTW_FT_AUTHENTICATED_STA)) { + if (rtw_ft_roam_status(padapter, RTW_FT_AUTHENTICATED_STA)) { RTW_PRINT("auth success, start reassoc\n"); - _enter_critical_bh(&pmlmepriv->lock, &irqL); - rtw_set_ft_status(padapter, RTW_FT_ASSOCIATING_STA); - _exit_critical_bh(&pmlmepriv->lock, &irqL); + rtw_ft_lock_set_status(padapter, RTW_FT_ASSOCIATING_STA, &irqL); start_clnt_assoc(padapter); } @@ -5038,6 +6542,54 @@ static s32 cfg80211_rtw_update_ft_ies(struct wiphy *wiphy, } #endif +void rtw_cfg80211_external_auth_request(_adapter *padapter, union recv_frame *rframe) +{ + struct rtw_external_auth_params params; + struct wireless_dev *wdev = padapter->rtw_wdev; + struct net_device *netdev = wdev_to_ndev(wdev); + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + + u8 frame[256] = { 0 }; + uint frame_len = 24; + s32 freq = 0; + + /* rframe, in this case is null point */ + + freq = rtw_ch2freq(pmlmeext->cur_channel); + +#ifdef CONFIG_DEBUG_CFG80211 + RTW_INFO(FUNC_ADPT_FMT": freq(%d, %d)\n", FUNC_ADPT_ARG(padapter), freq); +#endif + +#if (KERNEL_VERSION(4, 17, 0) <= LINUX_VERSION_CODE) + params.action = EXTERNAL_AUTH_START; + _rtw_memcpy(params.bssid, get_my_bssid(&pmlmeinfo->network), ETH_ALEN); + params.ssid.ssid_len = pmlmeinfo->network.Ssid.SsidLength; + _rtw_memcpy(params.ssid.ssid, pmlmeinfo->network.Ssid.Ssid, + pmlmeinfo->network.Ssid.SsidLength); + params.key_mgmt_suite = 0x8ac0f00; + + cfg80211_external_auth_request(netdev, + (struct cfg80211_external_auth_params *)¶ms, GFP_ATOMIC); +#elif (KERNEL_VERSION(2, 6, 37) <= LINUX_VERSION_CODE) + set_frame_sub_type(frame, WIFI_AUTH); + + _rtw_memcpy(frame + 4, get_my_bssid(&pmlmeinfo->network), ETH_ALEN); + _rtw_memcpy(frame + 10, adapter_mac_addr(padapter), ETH_ALEN); + _rtw_memcpy(frame + 16, get_my_bssid(&pmlmeinfo->network), ETH_ALEN); + RTW_PUT_LE32((frame + 18), 0x8ac0f00); + + if (pmlmeinfo->network.Ssid.SsidLength) { + *(frame + 23) = pmlmeinfo->network.Ssid.SsidLength; + _rtw_memcpy(frame + 24, pmlmeinfo->network.Ssid.Ssid, + pmlmeinfo->network.Ssid.SsidLength); + frame_len = 24 + pmlmeinfo->network.Ssid.SsidLength; + } + rtw_cfg80211_rx_mgmt(wdev, freq, 0, frame, frame_len, GFP_ATOMIC); +#endif +} + inline void rtw_cfg80211_set_is_roch(_adapter *adapter, bool val) { adapter->cfg80211_wdinfo.is_ro_ch = val; @@ -5049,6 +6601,24 @@ inline bool rtw_cfg80211_get_is_roch(_adapter *adapter) return adapter->cfg80211_wdinfo.is_ro_ch; } +inline bool rtw_cfg80211_is_ro_ch_once(_adapter *adapter) +{ + return adapter->cfg80211_wdinfo.last_ro_ch_time ? 1 : 0; +} + +inline void rtw_cfg80211_set_last_ro_ch_time(_adapter *adapter) +{ + adapter->cfg80211_wdinfo.last_ro_ch_time = rtw_get_current_time(); + + if (!adapter->cfg80211_wdinfo.last_ro_ch_time) + adapter->cfg80211_wdinfo.last_ro_ch_time++; +} + +inline s32 rtw_cfg80211_get_last_ro_ch_passing_ms(_adapter *adapter) +{ + return rtw_get_passing_time_ms(adapter->cfg80211_wdinfo.last_ro_ch_time); +} + static s32 cfg80211_rtw_remain_on_channel(struct wiphy *wiphy, #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) struct wireless_dev *wdev, @@ -5063,21 +6633,12 @@ static s32 cfg80211_rtw_remain_on_channel(struct wiphy *wiphy, { s32 err = 0; 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; +#ifdef CONFIG_CONCURRENT_MODE 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)) @@ -5103,9 +6664,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 @@ -5118,14 +6677,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; @@ -5150,13 +6709,18 @@ static s32 cfg80211_rtw_remain_on_channel(struct wiphy *wiphy, } /* if(!rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT) && !rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) */ - if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) { + if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) + #if defined(CONFIG_ANDROID) && !defined(RTW_SINGLE_WIPHY) + && (!is_primary_adapter(padapter)) + /*wlan0 can't be p2p device in CONFIG_ANDROID */ + #endif + ){ rtw_p2p_enable(padapter, P2P_ROLE_DEVICE); padapter->wdinfo.listen_channel = remain_ch; 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) { @@ -5166,17 +6730,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); @@ -5198,60 +6754,17 @@ static s32 cfg80211_rtw_remain_on_channel(struct wiphy *wiphy, rtw_cfg80211_set_is_roch(padapter, _TRUE); pcfg80211_wdinfo->ro_ch_wdev = wdev; pcfg80211_wdinfo->remain_on_ch_cookie = *cookie; - pcfg80211_wdinfo->last_ro_ch_time = rtw_get_current_time(); + rtw_cfg80211_set_last_ro_ch_time(padapter); _rtw_memcpy(&pcfg80211_wdinfo->remain_on_ch_channel, channel, sizeof(struct ieee80211_channel)); #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 8, 0)) pcfg80211_wdinfo->remain_on_ch_type = channel_type; #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; } @@ -5312,9 +6825,6 @@ static s32 cfg80211_rtw_cancel_remain_on_channel(struct wiphy *wiphy, inline int rtw_cfg80211_iface_has_p2p_group_cap(_adapter *adapter) { - struct wiphy *wiphy = adapter_to_wiphy(adapter); - struct rtw_wdev_priv *wdev_data = adapter_wdev_data(adapter); - #if RTW_P2P_GROUP_INTERFACE if (is_primary_adapter(adapter)) return 0; @@ -5511,18 +7021,19 @@ static int _cfg80211_rtw_mgmt_tx(_adapter *padapter, u8 tx_ch, u8 no_cck, const int ret = _FAIL; bool ack = _TRUE; struct rtw_ieee80211_hdr *pwlanhdr; +#if defined(RTW_ROCH_BACK_OP) && defined(CONFIG_P2P) && defined(CONFIG_CONCURRENT_MODE) struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); +#endif struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); - struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); - + u8 u_ch = rtw_mi_get_union_chan(padapter); + u8 leave_op = 0; #ifdef CONFIG_P2P + struct cfg80211_wifidirect_info *pcfg80211_wdinfo = &padapter->cfg80211_wdinfo; + #ifdef CONFIG_CONCURRENT_MODE struct wifidirect_info *pwdinfo = &padapter->wdinfo; -#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); + #endif +#endif rtw_cfg80211_set_is_mgmt_tx(padapter, 1); @@ -5549,48 +7060,34 @@ static int _cfg80211_rtw_mgmt_tx(_adapter *padapter, u8 tx_ch, u8 no_cck, const } #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); - u8 co_channel = 0xff; - co_channel = rtw_get_oper_ch(padapter); + if (rtw_mi_check_status(padapter, MI_LINKED) + && tx_ch != u_ch + ) { + rtw_leave_opch(padapter); + leave_op = 1; - if (tx_ch != union_ch) { + #if defined(RTW_ROCH_BACK_OP) && defined(CONFIG_P2P) && defined(CONFIG_CONCURRENT_MODE) + if (rtw_cfg80211_get_is_roch(padapter) + && ATOMIC_READ(&pwdev_priv->switch_ch_to) == 1 + ) { u16 ext_listen_period; - if (ATOMIC_READ(&pwdev_priv->switch_ch_to) == 1) { - rtw_mi_buddy_issue_nulldata(padapter, NULL, 1, 3, 500); - 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); */ - } - if (check_fwstate(&padapter->mlmepriv, _FW_LINKED)) - ext_listen_period = 500;/*500ms*/ -#ifdef CONFIG_P2P + ext_listen_period = 500; else ext_listen_period = pwdinfo->ext_listen_period; - + ATOMIC_SET(&pwdev_priv->switch_ch_to, 0); _set_timer(&pwdinfo->ap_p2p_switch_timer, ext_listen_period); -#endif RTW_INFO("%s, set switch ch timer, period=%d\n", __func__, ext_listen_period); } - - if (!check_fwstate(&padapter->mlmepriv, _FW_LINKED)) - pmlmeext->cur_channel = tx_ch; - - if (tx_ch != co_channel) - set_channel_bwmode(padapter, tx_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); - } else -#endif /* CONFIG_CONCURRENT_MODE */ - /* if (tx_ch != pmlmeext->cur_channel) { */ - if (tx_ch != rtw_get_oper_ch(padapter)) { - if (!check_fwstate(&padapter->mlmepriv, _FW_LINKED)) - pmlmeext->cur_channel = tx_ch; - set_channel_bwmode(padapter, tx_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); + #endif /* RTW_ROCH_BACK_OP && CONFIG_P2P && CONFIG_CONCURRENT_MODE */ } + if (tx_ch != rtw_get_oper_ch(padapter)) + set_channel_bwmode(padapter, tx_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); +#ifdef CONFIG_MCC_MODE issue_mgmt_frame: +#endif /* starting alloc mgmt frame to dump it */ pmgntframe = alloc_mgtxmitframe(pxmitpriv); if (pmgntframe == NULL) { @@ -5641,7 +7138,8 @@ static int _cfg80211_rtw_mgmt_tx(_adapter *padapter, u8 tx_ch, u8 no_cck, const } else { #ifdef CONFIG_XMIT_ACK - rtw_msleep_os(50); + if (!MLME_IS_MESH(padapter)) /* TODO: remove this sleep for all mode */ + rtw_msleep_os(50); #endif #ifdef CONFIG_DEBUG_CFG80211 RTW_INFO("%s, ack=%d, ok!\n", __func__, ack); @@ -5652,7 +7150,29 @@ static int _cfg80211_rtw_mgmt_tx(_adapter *padapter, u8 tx_ch, u8 no_cck, const dump_mgntframe(padapter, pmgntframe); ret = _SUCCESS; } + exit: + #ifdef CONFIG_P2P + if (rtw_cfg80211_get_is_roch(padapter) + && !roch_stay_in_cur_chan(padapter) + && pcfg80211_wdinfo->remain_on_ch_channel.hw_value != u_ch + ) { + /* roch is ongoing, switch back to rch */ + if (pcfg80211_wdinfo->remain_on_ch_channel.hw_value != tx_ch) + set_channel_bwmode(padapter, pcfg80211_wdinfo->remain_on_ch_channel.hw_value + , HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); + } else + #endif + if (leave_op) { + if (rtw_mi_check_status(padapter, MI_LINKED)) { + u8 u_bw = rtw_mi_get_union_bw(padapter); + u8 u_offset = rtw_mi_get_union_offset(padapter); + + set_channel_bwmode(padapter, u_ch, u_offset, u_bw); + } + rtw_back_opch(padapter); + } + rtw_cfg80211_set_is_mgmt_tx(padapter, 0); #ifdef CONFIG_BT_COEXIST @@ -5667,6 +7187,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, @@ -5701,30 +7233,35 @@ static int cfg80211_rtw_mgmt_tx(struct wiphy *wiphy, { #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0)) || defined(COMPAT_KERNEL_RELEASE) struct ieee80211_channel *chan = params->chan; - bool offchan = params->offchan; - unsigned int wait = params->wait; const u8 *buf = params->buf; size_t len = params->len; bool no_cck = params->no_cck; - bool dont_wait_for_ack = params->dont_wait_for_ack; #endif #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 2, 0)) bool no_cck = 0; #endif int ret = 0; - int tx_ret; + u8 tx_ret; int wait_ack = 1; + const u8 *dump_buf = buf; + size_t dump_len = len; 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; + struct rf_ctl_t *rfctl; #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) #if defined(RTW_DEDICATED_P2P_DEVICE) @@ -5754,13 +7291,22 @@ static int cfg80211_rtw_mgmt_tx(struct wiphy *wiphy, goto exit; } + rfctl = adapter_to_rfctl(padapter); tx_ch = (u8)ieee80211_frequency_to_channel(chan->center_freq); + if (IS_CH_WAITING(rfctl)) { + #ifdef CONFIG_DFS_MASTER + if (_rtw_rfctl_overlap_radar_detect_ch(rfctl, tx_ch, CHANNEL_WIDTH_20, HAL_PRIME_CHNL_OFFSET_DONT_CARE)) { + ret = -EINVAL; + goto exit; + } + #endif + } dvobj = adapter_to_dvobj(padapter); pwdev_priv = adapter_wdev_data(padapter); /* cookie generation */ - *cookie = (unsigned long) buf; + *cookie = pwdev_priv->mgmt_tx_cookie++; #ifdef CONFIG_DEBUG_CFG80211 RTW_INFO(FUNC_ADPT_FMT"%s len=%zu, ch=%d" @@ -5796,9 +7342,22 @@ static int cfg80211_rtw_mgmt_tx(struct wiphy *wiphy, wait_ack = 0; goto dump; } + else if (frame_styp == RTW_IEEE80211_STYPE_AUTH) { + int retval = 0; + + RTW_INFO("RTW_Tx:tx_ch=%d, no_cck=%u, da="MAC_FMT"\n", tx_ch, no_cck, MAC_ARG(GetAddr1Ptr(buf))); + + retval = rtw_sae_preprocess(padapter, buf, len, _TRUE); + if (retval == 2) + goto exit; + if (retval == 0) + RTW_INFO("RTW_Tx:AUTH\n"); + dump_limit = 1; + goto dump; + } 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; } @@ -5807,12 +7366,34 @@ 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) +#ifdef CONFIG_RTW_MESH + if (MLME_IS_MESH(padapter)) { + type = rtw_mesh_check_frames_tx(padapter, &dump_buf, &dump_len); + if (type >= 0) { + dump_limit = 1; + goto dump; + } + } +#endif + 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); @@ -5825,19 +7406,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, dump_buf, dump_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; @@ -5851,44 +7424,52 @@ 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_clear_scan_deny(padapter); + 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); + + if (dump_buf != buf) + rtw_mfree((u8 *)dump_buf, dump_len); exit: return ret; } @@ -5919,16 +7500,27 @@ static void cfg80211_rtw_mgmt_frame_register(struct wiphy *wiphy, frame_type, reg); #endif - /* Wait QC Verify */ - return; - switch (frame_type) { + case IEEE80211_STYPE_AUTH: /* 0x00B0 */ + if (reg > 0) + SET_CFG80211_REPORT_MGMT(pwdev_priv, IEEE80211_STYPE_AUTH, reg); + else + CLR_CFG80211_REPORT_MGMT(pwdev_priv, IEEE80211_STYPE_AUTH, reg); + break; +#ifdef not_yet case IEEE80211_STYPE_PROBE_REQ: /* 0x0040 */ - SET_CFG80211_REPORT_MGMT(pwdev_priv, IEEE80211_STYPE_PROBE_REQ, reg); + if (reg > 0) + SET_CFG80211_REPORT_MGMT(pwdev_priv, IEEE80211_STYPE_PROBE_REQ, reg); + else + CLR_CFG80211_REPORT_MGMT(pwdev_priv, IEEE80211_STYPE_PROBE_REQ, reg); break; case IEEE80211_STYPE_ACTION: /* 0x00D0 */ - SET_CFG80211_REPORT_MGMT(pwdev_priv, IEEE80211_STYPE_ACTION, reg); + if (reg > 0) + SET_CFG80211_REPORT_MGMT(pwdev_priv, IEEE80211_STYPE_ACTION, reg); + else + CLR_CFG80211_REPORT_MGMT(pwdev_priv, IEEE80211_STYPE_ACTION, reg); break; +#endif default: break; } @@ -5968,6 +7560,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; @@ -6050,8 +7647,13 @@ 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); + rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE, 0); #endif /* CONFIG_LPS */ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); @@ -6093,7 +7695,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); @@ -6102,14 +7704,997 @@ static int cfg80211_rtw_tdls_oper(struct wiphy *wiphy, case NL80211_TDLS_DISABLE_LINK: RTW_INFO(FUNC_NDEV_FMT", NL80211_TDLS_DISABLE_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) - rtw_tdls_cmd(padapter, (u8 *)peer, TDLS_TEARDOWN_STA_LOCALLY); + if (ptdls_sta != NULL) { + rtw_tdls_teardown_pre_hdl(padapter, ptdls_sta); + rtw_tdls_cmd(padapter, (u8 *)peer, TDLS_TEARDOWN_STA_LOCALLY_POST); + } break; } return 0; } #endif /* CONFIG_TDLS */ +#if defined(CONFIG_RTW_MESH) && (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 38)) + +#if DBG_RTW_CFG80211_MESH_CONF +#define LEGACY_RATES_STR_LEN (RTW_G_RATES_NUM * 5 + 1) +int get_legacy_rates_str(struct wiphy *wiphy, enum nl80211_band band, u32 mask, char *buf) +{ + int i; + int cnt = 0; + + for (i = 0; i < wiphy->bands[band]->n_bitrates; i++) { + if (mask & BIT(i)) { + cnt += snprintf(buf + cnt, LEGACY_RATES_STR_LEN - cnt -1, "%d.%d " + , wiphy->bands[band]->bitrates[i].bitrate / 10 + , wiphy->bands[band]->bitrates[i].bitrate % 10); + if (cnt >= LEGACY_RATES_STR_LEN - 1) + break; + } + } + + return cnt; +} + +void dump_mesh_setup(void *sel, struct wiphy *wiphy, const struct mesh_setup *setup) +{ +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) + struct cfg80211_chan_def *chdef = (struct cfg80211_chan_def *)(&setup->chandef); +#endif + struct ieee80211_channel *chan; +#endif + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) + chan = (struct ieee80211_channel *)chdef->chan; +#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) + chan = (struct ieee80211_channel *)setup->channel; +#endif + + RTW_PRINT_SEL(sel, "mesh_id:\"%s\", len:%u\n", setup->mesh_id, setup->mesh_id_len); +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 5, 0)) + RTW_PRINT_SEL(sel, "sync_method:%u\n", setup->sync_method); +#endif + RTW_PRINT_SEL(sel, "path_sel_proto:%u, path_metric:%u\n", setup->path_sel_proto, setup->path_metric); +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) + RTW_PRINT_SEL(sel, "auth_id:%u\n", setup->auth_id); +#endif +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) + if (setup->ie && setup->ie_len) { + RTW_PRINT_SEL(sel, "ie:%p, len:%u\n", setup->ie, setup->ie_len); + dump_ies(RTW_DBGDUMP, setup->ie, setup->ie_len); + } +#else + if (setup->vendor_ie && setup->vendor_ie_len) { + RTW_PRINT_SEL(sel, "ie:%p, len:%u\n", setup->vendor_ie, setup->vendor_ie_len); + dump_ies(RTW_DBGDUMP, setup->vendor_ie, setup->vendor_ie_len); + } +#endif +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) + RTW_PRINT_SEL(sel, "is_authenticated:%d, is_secure:%d\n", setup->is_authenticated, setup->is_secure); +#endif +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 10, 0)) + RTW_PRINT_SEL(sel, "user_mpm:%d\n", setup->user_mpm); +#endif +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0)) + RTW_PRINT_SEL(sel, "dtim_period:%u, beacon_interval:%u\n", setup->dtim_period, setup->beacon_interval); +#endif + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) + RTW_PRINT_SEL(sel, "center_freq:%u, ch:%u, width:%s, cfreq1:%u, cfreq2:%u\n" + , chan->center_freq, chan->hw_value, nl80211_chan_width_str(chdef->width), chdef->center_freq1, chdef->center_freq2); +#else + RTW_PRINT_SEL(sel, "center_freq:%u, ch:%u, channel_type:%s\n" + , chan->center_freq, chan->hw_value, nl80211_channel_type_str(setup->channel_type)); +#endif +#endif + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 3, 0)) + if (setup->mcast_rate[chan->band]) { + RTW_PRINT_SEL(sel, "mcast_rate:%d.%d\n" + , wiphy->bands[chan->band]->bitrates[setup->mcast_rate[chan->band] - 1].bitrate / 10 + , wiphy->bands[chan->band]->bitrates[setup->mcast_rate[chan->band] - 1].bitrate % 10 + ); + } +#endif + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) + if (setup->basic_rates) { + char buf[LEGACY_RATES_STR_LEN] = {0}; + + get_legacy_rates_str(wiphy, chan->band, setup->basic_rates, buf); + RTW_PRINT_SEL(sel, "basic_rates:%s\n", buf); + } +#endif + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 9, 0)) + if (setup->beacon_rate.control[chan->band].legacy) { + char buf[LEGACY_RATES_STR_LEN] = {0}; + + get_legacy_rates_str(wiphy, chan->band, setup->beacon_rate.control[chan->band].legacy, buf); + RTW_PRINT_SEL(sel, "beacon_rate.legacy:%s\n", buf); + } + if (*((u32 *)&(setup->beacon_rate.control[chan->band].ht_mcs[0])) + || *((u32 *)&(setup->beacon_rate.control[chan->band].ht_mcs[4])) + || *((u16 *)&(setup->beacon_rate.control[chan->band].ht_mcs[8])) + ) { + RTW_PRINT_SEL(sel, "beacon_rate.ht_mcs:"HT_RX_MCS_BMP_FMT"\n" + , HT_RX_MCS_BMP_ARG(setup->beacon_rate.control[chan->band].ht_mcs)); + } + + if (setup->beacon_rate.control[chan->band].vht_mcs[0] + || setup->beacon_rate.control[chan->band].vht_mcs[1] + || setup->beacon_rate.control[chan->band].vht_mcs[2] + || setup->beacon_rate.control[chan->band].vht_mcs[3] + ) { + int i; + + for (i = 0; i < 4; i++) {/* parsing up to 4SS */ + u16 mcs_mask = setup->beacon_rate.control[chan->band].vht_mcs[i]; + + RTW_PRINT_SEL(sel, "beacon_rate.vht_mcs[%d]:%s\n", i + , mcs_mask == 0x00FF ? "0~7" : mcs_mask == 0x01FF ? "0~8" : mcs_mask == 0x03FF ? "0~9" : "invalid"); + } + } + + if (setup->beacon_rate.control[chan->band].gi) { + RTW_PRINT_SEL(sel, "beacon_rate.gi:%s\n" + , setup->beacon_rate.control[chan->band].gi == NL80211_TXRATE_FORCE_SGI ? "SGI" : + setup->beacon_rate.control[chan->band].gi == NL80211_TXRATE_FORCE_LGI ? "LGI" : "invalid" + ); + } +#endif +} + +void dump_mesh_config(void *sel, const struct mesh_config *conf) +{ + RTW_PRINT_SEL(sel, "dot11MeshRetryTimeout:%u\n", conf->dot11MeshRetryTimeout); + RTW_PRINT_SEL(sel, "dot11MeshConfirmTimeout:%u\n", conf->dot11MeshConfirmTimeout); + RTW_PRINT_SEL(sel, "dot11MeshHoldingTimeout:%u\n", conf->dot11MeshHoldingTimeout); + RTW_PRINT_SEL(sel, "dot11MeshMaxPeerLinks:%u\n", conf->dot11MeshMaxPeerLinks); + RTW_PRINT_SEL(sel, "dot11MeshMaxRetries:%u\n", conf->dot11MeshMaxRetries); + RTW_PRINT_SEL(sel, "dot11MeshTTL:%u\n", conf->dot11MeshTTL); + RTW_PRINT_SEL(sel, "element_ttl:%u\n", conf->element_ttl); + RTW_PRINT_SEL(sel, "auto_open_plinks:%d\n", conf->auto_open_plinks); + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 5, 0)) + RTW_PRINT_SEL(sel, "dot11MeshNbrOffsetMaxNeighbor:%u\n", conf->dot11MeshNbrOffsetMaxNeighbor); +#endif + + RTW_PRINT_SEL(sel, "dot11MeshHWMPmaxPREQretries:%u\n", conf->dot11MeshHWMPmaxPREQretries); + RTW_PRINT_SEL(sel, "path_refresh_time:%u\n", conf->path_refresh_time); + RTW_PRINT_SEL(sel, "min_discovery_timeout:%u\n", conf->min_discovery_timeout); + RTW_PRINT_SEL(sel, "dot11MeshHWMPactivePathTimeout:%u\n", conf->dot11MeshHWMPactivePathTimeout); + RTW_PRINT_SEL(sel, "dot11MeshHWMPpreqMinInterval:%u\n", conf->dot11MeshHWMPpreqMinInterval); +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 3, 0)) + RTW_PRINT_SEL(sel, "dot11MeshHWMPperrMinInterval:%u\n", conf->dot11MeshHWMPperrMinInterval); +#endif + RTW_PRINT_SEL(sel, "dot11MeshHWMPnetDiameterTraversalTime:%u\n", conf->dot11MeshHWMPnetDiameterTraversalTime); + RTW_PRINT_SEL(sel, "dot11MeshHWMPRootMode:%u\n", conf->dot11MeshHWMPRootMode); +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 2, 0)) + RTW_PRINT_SEL(sel, "dot11MeshHWMPRannInterval:%u\n", conf->dot11MeshHWMPRannInterval); + RTW_PRINT_SEL(sel, "dot11MeshGateAnnouncementProtocol:%d\n", conf->dot11MeshGateAnnouncementProtocol); +#endif + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 4, 0)) + RTW_PRINT_SEL(sel, "dot11MeshForwarding:%d\n", conf->dot11MeshForwarding); + RTW_PRINT_SEL(sel, "rssi_threshold:%d\n", conf->rssi_threshold); +#endif + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 5, 0)) + RTW_PRINT_SEL(sel, "ht_opmode:0x%04x\n", conf->ht_opmode); +#endif + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) + RTW_PRINT_SEL(sel, "dot11MeshHWMPactivePathToRootTimeout:%u\n", conf->dot11MeshHWMPactivePathToRootTimeout); + RTW_PRINT_SEL(sel, "dot11MeshHWMProotInterval:%u\n", conf->dot11MeshHWMProotInterval); + RTW_PRINT_SEL(sel, "dot11MeshHWMPconfirmationInterval:%u\n", conf->dot11MeshHWMPconfirmationInterval); +#endif + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0)) + RTW_PRINT_SEL(sel, "power_mode:%s\n", nl80211_mesh_power_mode_str(conf->power_mode)); + RTW_PRINT_SEL(sel, "dot11MeshAwakeWindowDuration:%u\n", conf->dot11MeshAwakeWindowDuration); +#endif + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) + RTW_PRINT_SEL(sel, "plink_timeout:%u\n", conf->plink_timeout); +#endif +} +#endif /* DBG_RTW_CFG80211_MESH_CONF */ + +static void rtw_cfg80211_mesh_info_set_profile(struct rtw_mesh_info *minfo, const struct mesh_setup *setup) +{ + _rtw_memcpy(minfo->mesh_id, setup->mesh_id, setup->mesh_id_len); + minfo->mesh_id_len = setup->mesh_id_len; + minfo->mesh_pp_id = setup->path_sel_proto; + minfo->mesh_pm_id = setup->path_metric; + minfo->mesh_cc_id = 0; +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 5, 0)) + minfo->mesh_sp_id = setup->sync_method; +#endif +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) + minfo->mesh_auth_id = setup->auth_id; +#else + if (setup->is_authenticated) { + u8 *rsn_ie; + sint rsn_ie_len; + struct rsne_info info; + u8 *akm; + u8 AKM_SUITE_SAE[4] = {0x00, 0x0F, 0xAC, 0x08}; + + rsn_ie = rtw_get_ie(setup->ie, WLAN_EID_RSN, &rsn_ie_len, setup->ie_len); + if (!rsn_ie || !rsn_ie_len) { + rtw_warn_on(1); + return; + } + + if (rtw_rsne_info_parse(rsn_ie, rsn_ie_len + 2, &info) != _SUCCESS) { + rtw_warn_on(1); + return; + } + + if (!info.akm_list || !info.akm_cnt) { + rtw_warn_on(1); + return; + } + + akm = info.akm_list; + while (akm < info.akm_list + info.akm_cnt * 4) { + if (_rtw_memcmp(akm, AKM_SUITE_SAE, 4) == _TRUE) { + minfo->mesh_auth_id = 0x01; + break; + } + } + + if (!minfo->mesh_auth_id) { + rtw_warn_on(1); + return; + } + } +#endif +} + +static inline bool chk_mesh_attr(enum nl80211_meshconf_params parm, u32 mask) +{ + return (mask >> (parm - 1)) & 0x1; +} + +static void rtw_cfg80211_mesh_cfg_set(_adapter *adapter, const struct mesh_config *conf, u32 mask) +{ + struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; + +#if 0 /* driver MPM */ + if (chk_mesh_attr(NL80211_MESHCONF_RETRY_TIMEOUT, mask)); + if (chk_mesh_attr(NL80211_MESHCONF_CONFIRM_TIMEOUT, mask)); + if (chk_mesh_attr(NL80211_MESHCONF_HOLDING_TIMEOUT, mask)); + if (chk_mesh_attr(NL80211_MESHCONF_MAX_PEER_LINKS, mask)); + if (chk_mesh_attr(NL80211_MESHCONF_MAX_RETRIES, mask)); +#endif + + if (chk_mesh_attr(NL80211_MESHCONF_TTL, mask)) + mcfg->dot11MeshTTL = conf->dot11MeshTTL; + if (chk_mesh_attr(NL80211_MESHCONF_ELEMENT_TTL, mask)) + mcfg->element_ttl = conf->element_ttl; + +#if 0 /* driver MPM */ + if (chk_mesh_attr(NL80211_MESHCONF_AUTO_OPEN_PLINKS, mask)); +#endif + +#if 0 /* TBD: synchronization */ +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 5, 0)) + if (chk_mesh_attr(NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR, mask)); +#endif +#endif + + if (chk_mesh_attr(NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES, mask)) + mcfg->dot11MeshHWMPmaxPREQretries = conf->dot11MeshHWMPmaxPREQretries; + if (chk_mesh_attr(NL80211_MESHCONF_PATH_REFRESH_TIME, mask)) + mcfg->path_refresh_time = conf->path_refresh_time; + if (chk_mesh_attr(NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT, mask)) + mcfg->min_discovery_timeout = conf->min_discovery_timeout; + if (chk_mesh_attr(NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT, mask)) + mcfg->dot11MeshHWMPactivePathTimeout = conf->dot11MeshHWMPactivePathTimeout; + if (chk_mesh_attr(NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL, mask)) + mcfg->dot11MeshHWMPpreqMinInterval = conf->dot11MeshHWMPpreqMinInterval; +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 3, 0)) + if (chk_mesh_attr(NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL, mask)) + mcfg->dot11MeshHWMPperrMinInterval = conf->dot11MeshHWMPperrMinInterval; +#endif + if (chk_mesh_attr(NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME, mask)) + mcfg->dot11MeshHWMPnetDiameterTraversalTime = conf->dot11MeshHWMPnetDiameterTraversalTime; + + if (chk_mesh_attr(NL80211_MESHCONF_HWMP_ROOTMODE, mask)) + mcfg->dot11MeshHWMPRootMode = conf->dot11MeshHWMPRootMode; +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 2, 0)) + if (chk_mesh_attr(NL80211_MESHCONF_GATE_ANNOUNCEMENTS, mask)) + mcfg->dot11MeshGateAnnouncementProtocol = conf->dot11MeshGateAnnouncementProtocol; + /* our current gate annc implementation rides on root annc with gate annc bit in PREQ flags */ + if (mcfg->dot11MeshGateAnnouncementProtocol + && mcfg->dot11MeshHWMPRootMode <= RTW_IEEE80211_ROOTMODE_ROOT + ) { + mcfg->dot11MeshHWMPRootMode = RTW_IEEE80211_PROACTIVE_RANN; + RTW_INFO(ADPT_FMT" enable PROACTIVE_RANN becaue gate annc is needed\n", ADPT_ARG(adapter)); + } + if (chk_mesh_attr(NL80211_MESHCONF_HWMP_RANN_INTERVAL, mask)) + mcfg->dot11MeshHWMPRannInterval = conf->dot11MeshHWMPRannInterval; +#endif +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 4, 0)) + if (chk_mesh_attr(NL80211_MESHCONF_FORWARDING, mask)) + mcfg->dot11MeshForwarding = conf->dot11MeshForwarding; + + if (chk_mesh_attr(NL80211_MESHCONF_RSSI_THRESHOLD, mask)) + mcfg->rssi_threshold = conf->rssi_threshold; +#endif + +#if 0 /* controlled by driver */ +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 5, 0)) + if (chk_mesh_attr(NL80211_MESHCONF_HT_OPMODE, mask)); +#endif +#endif + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) + if (chk_mesh_attr(NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT, mask)) + mcfg->dot11MeshHWMPactivePathToRootTimeout = conf->dot11MeshHWMPactivePathToRootTimeout; + if (chk_mesh_attr(NL80211_MESHCONF_HWMP_ROOT_INTERVAL, mask)) + mcfg->dot11MeshHWMProotInterval = conf->dot11MeshHWMProotInterval; + if (chk_mesh_attr(NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL, mask)) + mcfg->dot11MeshHWMPconfirmationInterval = conf->dot11MeshHWMPconfirmationInterval; +#endif + +#if 0 /* TBD */ +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0)) + if (chk_mesh_attr(NL80211_MESHCONF_POWER_MODE, mask)); + if (chk_mesh_attr(NL80211_MESHCONF_AWAKE_WINDOW, mask)); +#endif +#endif + +#if 0 /* driver MPM */ +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) + if (chk_mesh_attr(NL80211_MESHCONF_PLINK_TIMEOUT, mask)); +#endif +#endif +} + +u8 *rtw_cfg80211_construct_mesh_beacon_ies(struct wiphy *wiphy, _adapter *adapter + , const struct mesh_config *conf, const struct mesh_setup *setup + , uint *ies_len) +{ + struct rtw_mesh_info *minfo = &adapter->mesh_info; + struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) + struct cfg80211_chan_def *chdef = (struct cfg80211_chan_def *)(&setup->chandef); +#endif + struct ieee80211_channel *chan; + u8 ch, bw, offset; +#endif + uint len; + u8 n_bitrates; + u8 ht = 0; + u8 vht = 0; + u8 *rsn_ie = NULL; + sint rsn_ie_len = 0; + u8 *ies = NULL, *c; + u8 supported_rates[RTW_G_RATES_NUM] = {0}; + int i; + + *ies_len = 0; + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) + chan = (struct ieee80211_channel *)chdef->chan; +#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) + chan = (struct ieee80211_channel *)setup->channel; +#endif + + n_bitrates = wiphy->bands[chan->band]->n_bitrates; + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) + rtw_get_chbw_from_cfg80211_chan_def(chdef, &ht, &ch, &bw, &offset); +#else + rtw_get_chbw_from_nl80211_channel_type(chan, setup->channel_type, &ht, &ch, &bw, &offset); +#endif + if (!ch) + goto exit; + +#if defined(CONFIG_80211AC_VHT) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) + vht = ht && ch > 14 && bw >= CHANNEL_WIDTH_80; /* VHT40/VHT20? */ +#endif + + RTW_INFO(FUNC_ADPT_FMT" => ch:%u,%u,%u, ht:%u, vht:%u\n" + , FUNC_ADPT_ARG(adapter), ch, bw, offset, ht, vht); +#endif + + rsn_ie = rtw_get_ie(setup->ie, WLAN_EID_RSN, &rsn_ie_len, setup->ie_len); + if (rsn_ie && !rsn_ie_len) { + rtw_warn_on(1); + rsn_ie = NULL; + } + + len = _BEACON_IE_OFFSET_ + + 2 /* 0-length SSID */ + + (n_bitrates >= 8 ? 8 : n_bitrates) + 2 /* Supported Rates */ + + 3 /* DS parameter set */ + + 6 /* TIM */ + + (n_bitrates > 8 ? n_bitrates - 8 + 2 : 0) /* Extended Supported Rates */ + + (rsn_ie ? rsn_ie_len + 2 : 0) /* RSN */ + #if defined(CONFIG_80211N_HT) + + (ht ? HT_CAP_IE_LEN + 2 + HT_OP_IE_LEN + 2 : 0) /* HT */ + #endif + #if defined(CONFIG_80211AC_VHT) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) + + (vht ? VHT_CAP_IE_LEN + 2 + VHT_OP_IE_LEN + 2 : 0) /* VHT */ + #endif + + minfo->mesh_id_len + 2 /* Mesh ID */ + + 9 /* Mesh configuration */ + ; + + ies = rtw_zmalloc(len); + if (!ies) + goto exit; + + /* timestamp */ + c = ies + 8; + + /* beacon interval */ + RTW_PUT_LE16(c , setup->beacon_interval); + c += 2; + + /* capability */ + if (rsn_ie) + *((u16 *)c) |= cpu_to_le16(cap_Privacy); + c += 2; + + /* SSID */ + c = rtw_set_ie(c, WLAN_EID_SSID, 0, NULL, NULL); + + /* Supported Rates */ + for (i = 0; i < n_bitrates; i++) { + supported_rates[i] = wiphy->bands[chan->band]->bitrates[i].bitrate / 5; + #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) + if (setup->basic_rates & BIT(i)) + #else + if (rtw_is_basic_rate_mix(supported_rates[i])) + #endif + supported_rates[i] |= IEEE80211_BASIC_RATE_MASK; + } + c = rtw_set_ie(c, WLAN_EID_SUPP_RATES, (n_bitrates >= 8 ? 8 : n_bitrates), supported_rates, NULL); + + /* DS parameter set */ + c = rtw_set_ie(c, WLAN_EID_DS_PARAMS, 1, &ch, NULL); + + /* TIM */ + *c = WLAN_EID_TIM; + *(c + 1) = 4; + c += 6; + //c = rtw_set_ie(c, _TIM_IE_, 4, NULL, NULL); + + /* Extended Supported Rates */ + if (n_bitrates > 8) + c = rtw_set_ie(c, WLAN_EID_EXT_SUPP_RATES, n_bitrates - 8, supported_rates + 8, NULL); + + /* RSN */ + if (rsn_ie) + c = rtw_set_ie(c, WLAN_EID_RSN, rsn_ie_len, rsn_ie + 2, NULL); + +#if defined(CONFIG_80211N_HT) + if (ht) { + struct ieee80211_sta_ht_cap *sta_ht_cap = &wiphy->bands[chan->band]->ht_cap; + u8 ht_cap[HT_CAP_IE_LEN]; + u8 ht_op[HT_OP_IE_LEN]; + + _rtw_memset(ht_cap, 0, HT_CAP_IE_LEN); + _rtw_memset(ht_op, 0, HT_OP_IE_LEN); + + /* WLAN_EID_HT_CAP */ + RTW_PUT_LE16(HT_CAP_ELE_CAP_INFO(ht_cap), sta_ht_cap->cap); + SET_HT_CAP_ELE_MAX_AMPDU_LEN_EXP(ht_cap, sta_ht_cap->ampdu_factor); + SET_HT_CAP_ELE_MIN_MPDU_S_SPACE(ht_cap, sta_ht_cap->ampdu_density); + _rtw_memcpy(HT_CAP_ELE_SUP_MCS_SET(ht_cap), &sta_ht_cap->mcs, 16); + c = rtw_set_ie(c, WLAN_EID_HT_CAP, HT_CAP_IE_LEN, ht_cap, NULL); + + /* WLAN_EID_HT_OPERATION */ + SET_HT_OP_ELE_PRI_CHL(ht_op, ch); + switch (offset) { + case HAL_PRIME_CHNL_OFFSET_LOWER: + SET_HT_OP_ELE_2ND_CHL_OFFSET(ht_op, SCA); + break; + case HAL_PRIME_CHNL_OFFSET_UPPER: + SET_HT_OP_ELE_2ND_CHL_OFFSET(ht_op, SCB); + break; + case HAL_PRIME_CHNL_OFFSET_DONT_CARE: + default: + SET_HT_OP_ELE_2ND_CHL_OFFSET(ht_op, SCN); + break; + } + if (bw >= CHANNEL_WIDTH_40) + SET_HT_OP_ELE_STA_CHL_WIDTH(ht_op, 1); + else + SET_HT_OP_ELE_STA_CHL_WIDTH(ht_op, 0); + c = rtw_set_ie(c, WLAN_EID_HT_OPERATION, HT_OP_IE_LEN, ht_op, NULL); + } +#endif /* defined(CONFIG_80211N_HT) */ + +#if defined(CONFIG_80211AC_VHT) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) + if (vht) { + struct ieee80211_sta_vht_cap *sta_vht_cap = &wiphy->bands[chan->band]->vht_cap; + u8 vht_cap[VHT_CAP_IE_LEN]; + u8 vht_op[VHT_OP_IE_LEN]; + u8 cch = rtw_get_center_ch(ch, bw, offset); + + _rtw_memset(vht_op, 0, VHT_OP_IE_LEN); + + /* WLAN_EID_VHT_CAPABILITY */ + _rtw_memcpy(vht_cap, &sta_vht_cap->cap, 4); + _rtw_memcpy(vht_cap + 4, &sta_vht_cap->vht_mcs, 8); + c = rtw_set_ie(c, WLAN_EID_VHT_CAPABILITY, VHT_CAP_IE_LEN, vht_cap, NULL); + + /* WLAN_EID_VHT_OPERATION */ + if (bw < CHANNEL_WIDTH_80) { + SET_VHT_OPERATION_ELE_CHL_WIDTH(vht_op, 0); + SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ1(vht_op, 0); + SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ2(vht_op, 0); + } else if (bw == CHANNEL_WIDTH_80) { + SET_VHT_OPERATION_ELE_CHL_WIDTH(vht_op, 1); + SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ1(vht_op, cch); + SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ2(vht_op, 0); + } else { + RTW_ERR(FUNC_ADPT_FMT" unsupported BW:%u\n", FUNC_ADPT_ARG(adapter), bw); + rtw_warn_on(1); + rtw_mfree(ies, len); + goto exit; + } + + /* Hard code 1 stream, MCS0-7 is a min Basic VHT MCS rates */ + vht_op[3] = 0xfc; + vht_op[4] = 0xff; + c = rtw_set_ie(c, WLAN_EID_VHT_OPERATION, VHT_OP_IE_LEN, vht_op, NULL); + } +#endif /* defined(CONFIG_80211AC_VHT) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) */ + + /* Mesh ID */ + c = rtw_set_ie_mesh_id(c, NULL, minfo->mesh_id, minfo->mesh_id_len); + + /* Mesh configuration */ + c = rtw_set_ie_mesh_config(c, NULL + , minfo->mesh_pp_id + , minfo->mesh_pm_id + , minfo->mesh_cc_id + , minfo->mesh_sp_id + , minfo->mesh_auth_id + , 0, 0, 0 + , 1 + , 0, 0 + , mcfg->dot11MeshForwarding + , 0, 0, 0 + ); + +#if DBG_RTW_CFG80211_MESH_CONF + RTW_INFO(FUNC_ADPT_FMT" ies_len:%u\n", FUNC_ADPT_ARG(adapter), len); + dump_ies(RTW_DBGDUMP, ies + _BEACON_IE_OFFSET_, len - _BEACON_IE_OFFSET_); +#endif + +exit: + if (ies) + *ies_len = len; + return ies; +} + +static int cfg80211_rtw_get_mesh_config(struct wiphy *wiphy, struct net_device *dev + , struct mesh_config *conf) +{ + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + struct rtw_mesh_cfg *mesh_cfg = &adapter->mesh_cfg; + int ret = 0; + + RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(adapter)); + + /* driver MPM */ + conf->dot11MeshRetryTimeout = 0; + conf->dot11MeshConfirmTimeout = 0; + conf->dot11MeshHoldingTimeout = 0; + conf->dot11MeshMaxPeerLinks = mesh_cfg->max_peer_links; + conf->dot11MeshMaxRetries = 0; + + conf->dot11MeshTTL = mesh_cfg->dot11MeshTTL; + conf->element_ttl = mesh_cfg->element_ttl; + + /* driver MPM */ + conf->auto_open_plinks = 0; + + /* TBD: synchronization */ +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 5, 0)) + conf->dot11MeshNbrOffsetMaxNeighbor = 0; +#endif + + conf->dot11MeshHWMPmaxPREQretries = mesh_cfg->dot11MeshHWMPmaxPREQretries; + conf->path_refresh_time = mesh_cfg->path_refresh_time; + conf->min_discovery_timeout = mesh_cfg->min_discovery_timeout; + conf->dot11MeshHWMPactivePathTimeout = mesh_cfg->dot11MeshHWMPactivePathTimeout; + conf->dot11MeshHWMPpreqMinInterval = mesh_cfg->dot11MeshHWMPpreqMinInterval; +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 3, 0)) + conf->dot11MeshHWMPperrMinInterval = mesh_cfg->dot11MeshHWMPperrMinInterval; +#endif + conf->dot11MeshHWMPnetDiameterTraversalTime = mesh_cfg->dot11MeshHWMPnetDiameterTraversalTime; + conf->dot11MeshHWMPRootMode = mesh_cfg->dot11MeshHWMPRootMode; +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 2, 0)) + conf->dot11MeshHWMPRannInterval = mesh_cfg->dot11MeshHWMPRannInterval; +#endif + conf->dot11MeshGateAnnouncementProtocol = mesh_cfg->dot11MeshGateAnnouncementProtocol; +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 4, 0)) + conf->dot11MeshForwarding = mesh_cfg->dot11MeshForwarding; + conf->rssi_threshold = mesh_cfg->rssi_threshold; +#endif + + /* TBD */ +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 5, 0)) + conf->ht_opmode = 0xffff; +#endif + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) + conf->dot11MeshHWMPactivePathToRootTimeout = mesh_cfg->dot11MeshHWMPactivePathToRootTimeout; + conf->dot11MeshHWMProotInterval = mesh_cfg->dot11MeshHWMProotInterval; + conf->dot11MeshHWMPconfirmationInterval = mesh_cfg->dot11MeshHWMPconfirmationInterval; +#endif + + /* TBD: power save */ +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0)) + conf->power_mode = NL80211_MESH_POWER_ACTIVE; + conf->dot11MeshAwakeWindowDuration = 0; +#endif + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) + conf->plink_timeout = mesh_cfg->plink_timeout; +#endif + + return ret; +} + +static void rtw_mbss_info_change_notify(_adapter *adapter, bool minfo_changed, bool need_work) +{ + if (need_work) + rtw_mesh_work(&adapter->mesh_work); +} + +static int cfg80211_rtw_update_mesh_config(struct wiphy *wiphy, struct net_device *dev + , u32 mask, const struct mesh_config *nconf) +{ + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + int ret = 0; + bool minfo_changed = _FALSE, need_work = _FALSE; + + RTW_INFO(FUNC_ADPT_FMT" mask:0x%08x\n", FUNC_ADPT_ARG(adapter), mask); + + rtw_cfg80211_mesh_cfg_set(adapter, nconf, mask); + update_beacon(adapter, WLAN_EID_MESH_CONFIG, NULL, _TRUE); +#if CONFIG_RTW_MESH_CTO_MGATE_CARRIER + if (rtw_mesh_cto_mgate_required(adapter)) + rtw_netif_carrier_off(adapter->pnetdev); + else + rtw_netif_carrier_on(adapter->pnetdev); +#endif + need_work = rtw_ieee80211_mesh_root_setup(adapter); + + rtw_mbss_info_change_notify(adapter, minfo_changed, need_work); + + return ret; +} + +static int cfg80211_rtw_join_mesh(struct wiphy *wiphy, struct net_device *dev, + const struct mesh_config *conf, const struct mesh_setup *setup) +{ + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + u8 *ies = NULL; + uint ies_len; + int ret = 0; + + RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(adapter)); + +#if DBG_RTW_CFG80211_MESH_CONF + RTW_INFO(FUNC_ADPT_FMT" mesh_setup:\n", FUNC_ADPT_ARG(adapter)); + dump_mesh_setup(RTW_DBGDUMP, wiphy, setup); + RTW_INFO(FUNC_ADPT_FMT" mesh_config:\n", FUNC_ADPT_ARG(adapter)); + dump_mesh_config(RTW_DBGDUMP, conf); +#endif + + if (rtw_cfg80211_sync_iftype(adapter) != _SUCCESS) { + ret = -ENOTSUPP; + goto exit; + } + + /* initialization */ + rtw_mesh_init_mesh_info(adapter); + + /* apply cfg80211 settings*/ + rtw_cfg80211_mesh_info_set_profile(&adapter->mesh_info, setup); + rtw_cfg80211_mesh_cfg_set(adapter, conf, 0xFFFFFFFF); + + /* apply cfg80211 settings (join only) */ + rtw_mesh_cfg_init_max_peer_links(adapter, conf->dot11MeshMaxPeerLinks); + #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) + rtw_mesh_cfg_init_plink_timeout(adapter, conf->plink_timeout); + #endif + + rtw_ieee80211_mesh_root_setup(adapter); + + ies = rtw_cfg80211_construct_mesh_beacon_ies(wiphy, adapter, conf, setup, &ies_len); + if (!ies) { + ret = -EINVAL; + goto exit; + } + + /* start mbss */ + if (rtw_check_beacon_data(adapter, ies, ies_len) != _SUCCESS) { + ret = -EINVAL; + goto exit; + } + + rtw_mesh_work(&adapter->mesh_work); + +exit: + if (ies) + rtw_mfree(ies, ies_len); + if (ret) + rtw_mesh_deinit_mesh_info(adapter); + + return ret; +} + +static int cfg80211_rtw_leave_mesh(struct wiphy *wiphy, struct net_device *dev) +{ + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + int ret = 0; + + RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(adapter)); + + rtw_mesh_deinit_mesh_info(adapter); + + rtw_set_802_11_infrastructure_mode(adapter, Ndis802_11Infrastructure); + rtw_setopmode_cmd(adapter, Ndis802_11Infrastructure, RTW_CMDF_WAIT_ACK); + + return ret; +} + +static int cfg80211_rtw_add_mpath(struct wiphy *wiphy, struct net_device *dev + #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 16, 0)) + , const u8 *dst, const u8 *next_hop + #else + , u8 *dst, u8 *next_hop + #endif +) +{ + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + struct sta_priv *stapriv = &adapter->stapriv; + struct sta_info *sta; + struct rtw_mesh_path *mpath; + int ret = 0; + + rtw_rcu_read_lock(); + + sta = rtw_get_stainfo(stapriv, next_hop); + if (!sta) { + ret = -ENOENT; + goto exit; + } + + mpath = rtw_mesh_path_add(adapter, dst); + if (!mpath) { + ret = -ENOENT; + goto exit; + } + + rtw_mesh_path_fix_nexthop(mpath, sta); + +exit: + rtw_rcu_read_unlock(); + + return ret; +} + +static int cfg80211_rtw_del_mpath(struct wiphy *wiphy, struct net_device *dev + #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 16, 0)) + , const u8 *dst + #else + , u8 *dst + #endif +) +{ + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + int ret = 0; + + if (dst) { + if (rtw_mesh_path_del(adapter, dst)) { + ret = -ENOENT; + goto exit; + } + } else { + rtw_mesh_path_flush_by_iface(adapter); + } + +exit: + return ret; +} + +static int cfg80211_rtw_change_mpath(struct wiphy *wiphy, struct net_device *dev + #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 16, 0)) + , const u8 *dst, const u8 *next_hop + #else + , u8 *dst, u8 *next_hop + #endif +) +{ + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + struct sta_priv *stapriv = &adapter->stapriv; + struct sta_info *sta; + struct rtw_mesh_path *mpath; + int ret = 0; + + rtw_rcu_read_lock(); + + sta = rtw_get_stainfo(stapriv, next_hop); + if (!sta) { + ret = -ENOENT; + goto exit; + } + + mpath = rtw_mesh_path_lookup(adapter, dst); + if (!mpath) { + ret = -ENOENT; + goto exit; + } + + rtw_mesh_path_fix_nexthop(mpath, sta); + +exit: + rtw_rcu_read_unlock(); + + return ret; +} + +static void rtw_cfg80211_mpath_set_pinfo(struct rtw_mesh_path *mpath, u8 *next_hop, struct mpath_info *pinfo) +{ + struct sta_info *next_hop_sta = rtw_rcu_dereference(mpath->next_hop); + + if (next_hop_sta) + _rtw_memcpy(next_hop, next_hop_sta->cmn.mac_addr, ETH_ALEN); + else + _rtw_memset(next_hop, 0, ETH_ALEN); + + _rtw_memset(pinfo, 0, sizeof(*pinfo)); + + pinfo->generation = mpath->adapter->mesh_info.mesh_paths_generation; + + pinfo->filled = 0 + | MPATH_INFO_FRAME_QLEN + | MPATH_INFO_SN + | MPATH_INFO_METRIC + | MPATH_INFO_EXPTIME + | MPATH_INFO_DISCOVERY_TIMEOUT + | MPATH_INFO_DISCOVERY_RETRIES + | MPATH_INFO_FLAGS + ; + + pinfo->frame_qlen = mpath->frame_queue_len; + pinfo->sn = mpath->sn; + pinfo->metric = mpath->metric; + if (rtw_time_after(mpath->exp_time, rtw_get_current_time())) + pinfo->exptime = rtw_get_remaining_time_ms(mpath->exp_time); + pinfo->discovery_timeout = rtw_systime_to_ms(mpath->discovery_timeout); + pinfo->discovery_retries = mpath->discovery_retries; + if (mpath->flags & RTW_MESH_PATH_ACTIVE) + pinfo->flags |= NL80211_MPATH_FLAG_ACTIVE; + if (mpath->flags & RTW_MESH_PATH_RESOLVING) + pinfo->flags |= NL80211_MPATH_FLAG_RESOLVING; + if (mpath->flags & RTW_MESH_PATH_SN_VALID) + pinfo->flags |= NL80211_MPATH_FLAG_SN_VALID; + if (mpath->flags & RTW_MESH_PATH_FIXED) + pinfo->flags |= NL80211_MPATH_FLAG_FIXED; + if (mpath->flags & RTW_MESH_PATH_RESOLVED) + pinfo->flags |= NL80211_MPATH_FLAG_RESOLVED; +} + +static int cfg80211_rtw_get_mpath(struct wiphy *wiphy, struct net_device *dev, u8 *dst, u8 *next_hop, struct mpath_info *pinfo) +{ + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + struct rtw_mesh_path *mpath; + int ret = 0; + + rtw_rcu_read_lock(); + + mpath = rtw_mesh_path_lookup(adapter, dst); + if (!mpath) { + ret = -ENOENT; + goto exit; + } + + rtw_cfg80211_mpath_set_pinfo(mpath, next_hop, pinfo); + +exit: + rtw_rcu_read_unlock(); + + return ret; +} + +static int cfg80211_rtw_dump_mpath(struct wiphy *wiphy, struct net_device *dev, int idx, u8 *dst, u8 *next_hop, struct mpath_info *pinfo) +{ + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + struct rtw_mesh_path *mpath; + int ret = 0; + + rtw_rcu_read_lock(); + + mpath = rtw_mesh_path_lookup_by_idx(adapter, idx); + if (!mpath) { + ret = -ENOENT; + goto exit; + } + + _rtw_memcpy(dst, mpath->dst, ETH_ALEN); + rtw_cfg80211_mpath_set_pinfo(mpath, next_hop, pinfo); + +exit: + rtw_rcu_read_unlock(); + + return ret; +} + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 19, 0)) +static void rtw_cfg80211_mpp_set_pinfo(struct rtw_mesh_path *mpath, u8 *mpp, struct mpath_info *pinfo) +{ + _rtw_memcpy(mpp, mpath->mpp, ETH_ALEN); + + _rtw_memset(pinfo, 0, sizeof(*pinfo)); + pinfo->generation = mpath->adapter->mesh_info.mpp_paths_generation; +} + +static int cfg80211_rtw_get_mpp(struct wiphy *wiphy, struct net_device *dev, u8 *dst, u8 *mpp, struct mpath_info *pinfo) +{ + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + struct rtw_mesh_path *mpath; + int ret = 0; + + rtw_rcu_read_lock(); + + mpath = rtw_mpp_path_lookup(adapter, dst); + if (!mpath) { + ret = -ENOENT; + goto exit; + } + + rtw_cfg80211_mpp_set_pinfo(mpath, mpp, pinfo); + +exit: + rtw_rcu_read_unlock(); + + return ret; +} + +static int cfg80211_rtw_dump_mpp(struct wiphy *wiphy, struct net_device *dev, int idx, u8 *dst, u8 *mpp, struct mpath_info *pinfo) +{ + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + struct rtw_mesh_path *mpath; + int ret = 0; + + rtw_rcu_read_lock(); + + mpath = rtw_mpp_path_lookup_by_idx(adapter, idx); + if (!mpath) { + ret = -ENOENT; + goto exit; + } + + _rtw_memcpy(dst, mpath->dst, ETH_ALEN); + rtw_cfg80211_mpp_set_pinfo(mpath, mpp, pinfo); + +exit: + rtw_rcu_read_unlock(); + + return ret; +} +#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 19, 0)) */ + +#endif /* defined(CONFIG_RTW_MESH) */ + #if defined(CONFIG_PNO_SUPPORT) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) static int cfg80211_rtw_sched_scan_start(struct wiphy *wiphy, struct net_device *dev, @@ -6118,6 +8703,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) { @@ -6136,10 +8725,31 @@ static int cfg80211_rtw_sched_scan_start(struct wiphy *wiphy, RTW_INFO("%s: invalid cfg80211_requests parameters.\n", __func__); return -EINVAL; } +#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 2, 0) - ret = rtw_android_cfg80211_pno_setup(dev, request->ssids, - request->n_ssids, request->interval); - +#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 4, 0) + interval = request->scan_plans->interval; +#else + interval = request->interval; +#endif + 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; @@ -6159,6 +8769,63 @@ 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; + } + parm.ssid_num = pwrpriv->pnlo_info->ssid_num; + + _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) @@ -6518,7 +9185,9 @@ int rtw_cfg80211_set_mgnt_wpsp2pie(struct net_device *net, char *buf, int len, } -static void rtw_cfg80211_init_ht_capab_ex(_adapter *padapter, struct ieee80211_sta_ht_cap *ht_cap, enum nl80211_band band, u8 rf_type) +#ifdef CONFIG_80211N_HT +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; @@ -6538,9 +9207,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 (band == NL80211_BAND_2GHZ) + if (band == BAND_ON_2_4G) stbc_rx_enable = (pregistrypriv->rx_stbc & BIT(0)) ? _TRUE : _FALSE; - if (band == NL80211_BAND_5GHZ) + if (band == BAND_ON_5G) stbc_rx_enable = (pregistrypriv->rx_stbc & BIT(1)) ? _TRUE : _FALSE; if (stbc_rx_enable) { @@ -6566,12 +9235,17 @@ 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 nl80211_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) { + struct registry_priv *regsty = &padapter->registrypriv; struct hal_spec_t *hal_spec = GET_HAL_SPEC(padapter); u8 rx_nss = 0; - ht_cap->ht_supported = _TRUE; + if (!regsty->ht_enable || !is_supported_ht(regsty->wireless_mode)) + return; + + ht_cap->ht_supported = 1; ht_cap->cap = IEEE80211_HT_CAP_SUP_WIDTH_20_40 | IEEE80211_HT_CAP_SGI_40 | IEEE80211_HT_CAP_SGI_20 | @@ -6614,12 +9288,34 @@ static void rtw_cfg80211_init_ht_capab(_adapter *padapter, struct ieee80211_sta_ RTW_INFO("%s, error rf_type=%d\n", __func__, rf_type); }; - ht_cap->mcs.rx_highest = 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 - ); + 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 */ + +#if defined(CONFIG_80211AC_VHT) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) +static void rtw_cfg80211_init_vht_capab(_adapter *padapter + , struct ieee80211_sta_vht_cap *sta_vht_cap, BAND_TYPE band, u8 rf_type) +{ + struct registry_priv *regsty = &padapter->registrypriv; + u8 vht_cap_ie[2 + 12] = {0}; + + if (!REGSTY_IS_11AC_ENABLE(regsty) || !is_supported_vht(regsty->wireless_mode)) + return; + + rtw_vht_use_default_setting(padapter); + rtw_build_vht_cap_ie(padapter, vht_cap_ie); + + sta_vht_cap->vht_supported = 1; + + _rtw_memcpy(&sta_vht_cap->cap, vht_cap_ie + 2, 4); + _rtw_memcpy(&sta_vht_cap->vht_mcs, vht_cap_ie + 2 + 4, 8); +} +#endif /* defined(CONFIG_80211AC_VHT) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) */ + void rtw_cfg80211_init_wdev_data(_adapter *padapter) { #ifdef CONFIG_CONCURRENT_MODE @@ -6632,7 +9328,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; @@ -6641,19 +9337,26 @@ void rtw_cfg80211_init_wiphy(_adapter *padapter) RTW_INFO("%s:rf_type=%d\n", __func__, rf_type); if (IsSupported24G(padapter->registrypriv.wireless_mode)) { - bands = wiphy->bands[NL80211_BAND_2GHZ]; - if (bands) - rtw_cfg80211_init_ht_capab(padapter, &bands->ht_cap, NL80211_BAND_2GHZ, rf_type); + band = wiphy->bands[NL80211_BAND_2GHZ]; + if (band) { + #if defined(CONFIG_80211N_HT) + rtw_cfg80211_init_ht_capab(padapter, &band->ht_cap, BAND_ON_2_4G, rf_type); + #endif + } } #ifdef CONFIG_IEEE80211_BAND_5GHZ if (is_supported_5g(padapter->registrypriv.wireless_mode)) { - bands = wiphy->bands[NL80211_BAND_5GHZ]; - if (bands) - rtw_cfg80211_init_ht_capab(padapter, &bands->ht_cap, NL80211_BAND_5GHZ, rf_type); + band = wiphy->bands[NL80211_BAND_5GHZ]; + if (band) { + #if defined(CONFIG_80211N_HT) + rtw_cfg80211_init_ht_capab(padapter, &band->ht_cap, BAND_ON_5G, rf_type); + #endif + #if defined(CONFIG_80211AC_VHT) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) + rtw_cfg80211_init_vht_capab(padapter, &band->vht_cap, BAND_ON_5G, rf_type); + #endif + } } #endif - /* init regulary domain */ - rtw_regd_init(padapter); /* copy mac_addr to wiphy */ _rtw_memcpy(wiphy->perm_addr, adapter_mac_addr(padapter), ETH_ALEN); @@ -6682,7 +9385,13 @@ struct ieee80211_iface_limit rtw_limits[] = { { .max = 1, .types = BIT(NL80211_IFTYPE_P2P_DEVICE) - } + }, + #endif + #if defined(CONFIG_RTW_MESH) + { + .max = 1, + .types = BIT(NL80211_IFTYPE_MESH_POINT) + }, #endif }; @@ -6733,9 +9442,19 @@ static void rtw_cfg80211_preinit_wiphy(_adapter *adapter, struct wiphy *wiphy) #if defined(RTW_DEDICATED_P2P_DEVICE) | BIT(NL80211_IFTYPE_P2P_DEVICE) #endif +#endif +#ifdef CONFIG_RTW_MESH + | BIT(NL80211_IFTYPE_MESH_POINT) /* 2.6.26 */ #endif ; +#if defined(CONFIG_ANDROID) && !defined(RTW_SINGLE_WIPHY) + if (is_primary_adapter(adapter)) { + wiphy->interface_modes &= ~(BIT(NL80211_IFTYPE_P2P_GO) | BIT(NL80211_IFTYPE_P2P_CLIENT)); + RTW_INFO("%s primary- don't set p2p capability\n", __func__); + } +#endif + #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) #ifdef CONFIG_AP_MODE wiphy->mgmt_stypes = rtw_cfg80211_default_mgmt_stypes; @@ -6757,11 +9476,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[NL80211_BAND_2GHZ] = rtw_spt_band_alloc(NL80211_BAND_2GHZ); + wiphy->bands[NL80211_BAND_2GHZ] = rtw_spt_band_alloc(BAND_ON_2_4G); #ifdef CONFIG_IEEE80211_BAND_5GHZ if (is_supported_5g(adapter->registrypriv.wireless_mode)) - wiphy->bands[NL80211_BAND_5GHZ] = rtw_spt_band_alloc(NL80211_BAND_5GHZ); + 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)) @@ -6775,10 +9494,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 @@ -6806,6 +9529,29 @@ static void rtw_cfg80211_preinit_wiphy(_adapter *adapter, struct wiphy *wiphy) #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 2, 0)) /* wiphy->flags |= WIPHY_FLAG_SUPPORTS_FW_ROAM; */ #endif + +#ifdef CONFIG_RTW_MESH + wiphy->flags |= 0 + #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) + | WIPHY_FLAG_IBSS_RSN + #endif + #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) + | WIPHY_FLAG_MESH_AUTH + #endif + ; + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 3, 0)) + wiphy->features |= 0 + #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 10, 0)) + | NL80211_FEATURE_USERSPACE_MPM + #endif + ; +#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 3, 0)) */ +#endif /* CONFIG_RTW_MESH */ + +#if (KERNEL_VERSION(3, 8, 0) <= LINUX_VERSION_CODE) + wiphy->features |= NL80211_FEATURE_SAE; +#endif } #ifdef CONFIG_RFKILL_POLL @@ -6842,12 +9588,240 @@ static void cfg80211_rtw_rfkill_poll(struct wiphy *wiphy) } #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)) */ + +#if (KERNEL_VERSION(4, 17, 0) <= LINUX_VERSION_CODE) +int cfg80211_rtw_external_auth(struct wiphy *wiphy, struct net_device *dev, + struct cfg80211_external_auth_params *params) +{ + PADAPTER padapter = (_adapter *)rtw_netdev_priv(dev); + + RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(dev)); + + rtw_cfg80211_external_auth_status(wiphy, dev, + (struct rtw_external_auth_params *)params); + + return 0; +} +#endif + +void rtw_cfg80211_external_auth_status(struct wiphy *wiphy, struct net_device *dev, + struct rtw_external_auth_params *params) +{ + PADAPTER padapter = (_adapter *)rtw_netdev_priv(dev); + struct security_priv *psecuritypriv = &padapter->securitypriv; + struct sta_priv *pstapriv = &padapter->stapriv; + struct sta_info *psta = NULL; + u8 *buf = NULL; + u32 len = 0; + _irqL irqL; + + RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(dev)); + + RTW_INFO("SAE: action: %u, status: %u\n", params->action, params->status); + if (params->status == WLAN_STATUS_SUCCESS) { + RTW_INFO("bssid: "MAC_FMT"\n", MAC_ARG(params->bssid)); + RTW_INFO("SSID: [%s]\n", + ((params->ssid.ssid_len == 0) ? "" : (char *)params->ssid.ssid)); + RTW_INFO("suite: 0x%08x\n", params->key_mgmt_suite); + } + + psta = rtw_get_stainfo(pstapriv, params->bssid); + if (psta && (params->status == WLAN_STATUS_SUCCESS)) { + /* AP mode */ + RTW_INFO("station match\n"); + + psta->state &= ~WIFI_FW_AUTH_NULL; + psta->state |= WIFI_FW_AUTH_SUCCESS; + psta->expire_to = padapter->stapriv.assoc_to; + + if (params->pmkid != NULL) { + /* RTW_INFO_DUMP("PMKID:", params->pmkid, PMKID_LEN); */ + _rtw_set_pmksa(dev, params->bssid, params->pmkid); + } + + _enter_critical_bh(&psta->lock, &irqL); + if ((psta->auth_len != 0) && (psta->pauth_frame != NULL)) { + buf = rtw_zmalloc(psta->auth_len); + if (buf) { + _rtw_memcpy(buf, psta->pauth_frame, psta->auth_len); + len = psta->auth_len; + } + + rtw_mfree(psta->pauth_frame, psta->auth_len); + psta->pauth_frame = NULL; + psta->auth_len = 0; + } + _exit_critical_bh(&psta->lock, &irqL); + + if (buf) { + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + /* send the SAE auth Confirm */ + + rtw_ps_deny(padapter, PS_DENY_MGNT_TX); + if (_SUCCESS == rtw_pwr_wakeup(padapter)) { + rtw_mi_set_scan_deny(padapter, 1000); + rtw_mi_scan_abort(padapter, _TRUE); + + RTW_INFO("SAE: Tx auth Confirm\n"); + rtw_mgnt_tx_cmd(padapter, pmlmeext->cur_channel, 1, buf, len, 0, RTW_CMDF_DIRECTLY); + + rtw_mfree(buf, len); + buf = NULL; + len = 0; + } + rtw_ps_deny_cancel(padapter, PS_DENY_MGNT_TX); + } + } else { + /* STA mode */ + psecuritypriv->extauth_status = params->status; + } +} + static struct cfg80211_ops rtw_cfg80211_ops = { .change_virtual_intf = cfg80211_rtw_change_iface, .add_key = cfg80211_rtw_add_key, .get_key = cfg80211_rtw_get_key, .del_key = cfg80211_rtw_del_key, .set_default_key = cfg80211_rtw_set_default_key, +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 30)) + .set_default_mgmt_key = cfg80211_rtw_set_default_mgmt_key, +#endif #if defined(CONFIG_GTK_OL) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 1, 0)) .set_rekey_data = cfg80211_rtw_set_rekey_data, #endif /*CONFIG_GTK_OL*/ @@ -6888,6 +9862,9 @@ static struct cfg80211_ops rtw_cfg80211_ops = { .change_station = cfg80211_rtw_change_station, .dump_station = cfg80211_rtw_dump_station, .change_bss = cfg80211_rtw_change_bss, +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) + .set_txq_params = cfg80211_rtw_set_txq_params, +#endif #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 6, 0)) .set_channel = cfg80211_rtw_set_channel, #endif @@ -6895,6 +9872,22 @@ static struct cfg80211_ops rtw_cfg80211_ops = { /* .assoc = cfg80211_rtw_assoc, */ #endif /* CONFIG_AP_MODE */ +#if defined(CONFIG_RTW_MESH) && (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 38)) + .get_mesh_config = cfg80211_rtw_get_mesh_config, + .update_mesh_config = cfg80211_rtw_update_mesh_config, + .join_mesh = cfg80211_rtw_join_mesh, + .leave_mesh = cfg80211_rtw_leave_mesh, + .add_mpath = cfg80211_rtw_add_mpath, + .del_mpath = cfg80211_rtw_del_mpath, + .change_mpath = cfg80211_rtw_change_mpath, + .get_mpath = cfg80211_rtw_get_mpath, + .dump_mpath = cfg80211_rtw_dump_mpath, + #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 19, 0)) + .get_mpp = cfg80211_rtw_get_mpp, + .dump_mpp = cfg80211_rtw_dump_mpp, + #endif +#endif + #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) .set_monitor_channel = cfg80211_rtw_set_monitor_channel, #endif @@ -6927,10 +9920,18 @@ 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 +#if (KERNEL_VERSION(4, 17, 0) <= LINUX_VERSION_CODE) + .external_auth = cfg80211_rtw_external_auth, +#endif }; struct wiphy *rtw_wiphy_alloc(_adapter *padapter, struct device *dev) @@ -6988,6 +9989,8 @@ int rtw_wiphy_register(struct wiphy *wiphy) rtw_cfgvendor_attach(wiphy); #endif + rtw_regd_init(wiphy); + return wiphy_register(wiphy); } @@ -7024,11 +10027,7 @@ int rtw_wdev_alloc(_adapter *padapter, struct wiphy *wiphy) } wdev->wiphy = wiphy; wdev->netdev = pnetdev; - - wdev->iftype = NL80211_IFTYPE_STATION; /* will be init in rtw_hal_init() */ - /* Must sync with _rtw_init_mlme_priv() */ - /* pmlmepriv->fw_state = WIFI_STATION_STATE */ - /* wdev->iftype = NL80211_IFTYPE_MONITOR; */ /* for rtw_setopmode_cmd() in cfg80211_rtw_change_iface() */ + wdev->iftype = NL80211_IFTYPE_STATION; padapter->rtw_wdev = wdev; pnetdev->ieee80211_ptr = wdev; @@ -7040,6 +10039,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(); @@ -7060,6 +10061,13 @@ int rtw_wdev_alloc(_adapter *padapter, struct wiphy *wiphy) ATOMIC_SET(&pwdev_priv->switch_ch_to, 1); #endif +#ifdef CONFIG_RTW_CFGVEDNOR_RSSIMONITOR + pwdev_priv->rssi_monitor_enable = 0; + pwdev_priv->rssi_monitor_max = 0; + pwdev_priv->rssi_monitor_min = 0; +#endif + + exit: return ret; } @@ -7074,8 +10082,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); } @@ -7102,18 +10117,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__); @@ -7153,6 +10162,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; @@ -7195,14 +10205,12 @@ int rtw_cfg80211_dev_res_alloc(struct dvobj_priv *dvobj) wiphy = rtw_wiphy_alloc(dvobj_get_primary_adapter(dvobj), dev); if (wiphy == NULL) - goto exit; + return ret; dvobj->wiphy = wiphy; #endif ret = _SUCCESS; - -exit: return ret; } @@ -7220,7 +10228,7 @@ 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; + return ret; #ifdef CONFIG_RFKILL_POLL rtw_cfg80211_init_rfkill(dvobj_to_wiphy(dvobj)); @@ -7229,7 +10237,6 @@ int rtw_cfg80211_dev_res_register(struct dvobj_priv *dvobj) ret = _SUCCESS; -exit: return ret; } diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/ioctl_cfg80211.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/ioctl_cfg80211.h index aa4750ae6cc9..4428cced4353 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/ioctl_cfg80211.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/ioctl_cfg80211.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,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 __IOCTL_CFG80211_H__ #define __IOCTL_CFG80211_H__ +#define RTW_CFG80211_BLOCK_DISCON_WHEN_CONNECT BIT0 +#define RTW_CFG80211_BLOCK_DISCON_WHEN_DISCONNECT BIT1 + +#ifndef RTW_CFG80211_BLOCK_STA_DISCON_EVENT +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 2, 0)) +#define RTW_CFG80211_BLOCK_STA_DISCON_EVENT (RTW_CFG80211_BLOCK_DISCON_WHEN_CONNECT) +#else +#define RTW_CFG80211_BLOCK_STA_DISCON_EVENT (RTW_CFG80211_BLOCK_DISCON_WHEN_CONNECT | RTW_CFG80211_BLOCK_DISCON_WHEN_DISCONNECT) +#endif +#endif #if defined(RTW_USE_CFG80211_STA_EVENT) #undef CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER @@ -51,6 +57,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 @@ -63,6 +74,12 @@ #error "RTW_DEDICATED_P2P_DEVICE can't be enabled when kernel < 3.7.0\n" #endif +#ifdef CONFIG_RTW_MESH + #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 10, 0)) + #error "CONFIG_RTW_MESH can't be enabled when kernel < 3.10.0\n" + #endif +#endif + struct rtw_wdev_invit_info { u8 state; /* 0: req, 1:rep */ u8 peer_mac[ETH_ALEN]; @@ -126,14 +143,21 @@ struct rtw_wdev_priv { _adapter *padapter; + #if RTW_CFG80211_BLOCK_STA_DISCON_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; @@ -149,6 +173,7 @@ struct rtw_wdev_priv { u16 report_mgmt; u8 is_mgmt_tx; + u16 mgmt_tx_cookie; _mutex roch_mutex; @@ -156,8 +181,51 @@ struct rtw_wdev_priv { ATOMIC_T switch_ch_to; #endif +#ifdef CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI + u8 pno_mac_addr[ETH_ALEN]; + u16 pno_scan_seq_num; +#endif + +#ifdef CONFIG_RTW_CFGVEDNOR_RSSIMONITOR + s8 rssi_monitor_max; + s8 rssi_monitor_min; + u8 rssi_monitor_enable; +#endif + }; +enum external_auth_action { + EXTERNAL_AUTH_START, + EXTERNAL_AUTH_ABORT, +}; + +struct rtw_external_auth_params { + enum external_auth_action action; + u8 bssid[ETH_ALEN]__aligned(2); + struct cfg80211_ssid ssid; + unsigned int key_mgmt_suite; + u16 status; + u8 pmkid[PMKID_LEN]; +}; + +bool rtw_cfg80211_is_connect_requested(_adapter *adapter); + +#if RTW_CFG80211_BLOCK_STA_DISCON_EVENT +#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) +#else +#define rtw_wdev_not_indic_disco(rtw_wdev_data) 0 +#define rtw_wdev_set_not_indic_disco(rtw_wdev_data, val) do {} 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) @@ -193,7 +261,8 @@ struct rtw_wiphy_data { #define FUNC_WIPHY_FMT "%s("WIPHY_FMT")" #define FUNC_WIPHY_ARG(wiphy) __func__, WIPHY_ARG(wiphy) -#define SET_CFG80211_REPORT_MGMT(w, t, v) (w->report_mgmt |= (v ? BIT(t >> 4) : 0)) +#define SET_CFG80211_REPORT_MGMT(w, t, v) (w->report_mgmt |= BIT(t >> 4)) +#define CLR_CFG80211_REPORT_MGMT(w, t, v) (w->report_mgmt &= (~BIT(t >> 4))) #define GET_CFG80211_REPORT_MGMT(w, t) ((w->report_mgmt & BIT(t >> 4)) > 0) struct wiphy *rtw_wiphy_alloc(_adapter *padapter, struct device *dev); @@ -235,12 +304,15 @@ void rtw_cfg80211_indicate_scan_done_for_buddy(_adapter *padapter, bool bscan_ab #ifdef CONFIG_AP_MODE void rtw_cfg80211_indicate_sta_assoc(_adapter *padapter, u8 *pmgmt_frame, uint frame_len); -void rtw_cfg80211_indicate_sta_disassoc(_adapter *padapter, unsigned char *da, unsigned short reason); +void rtw_cfg80211_indicate_sta_disassoc(_adapter *padapter, const u8 *da, unsigned short reason); #endif /* CONFIG_AP_MODE */ #ifdef CONFIG_P2P void rtw_cfg80211_set_is_roch(_adapter *adapter, bool val); bool rtw_cfg80211_get_is_roch(_adapter *adapter); +bool rtw_cfg80211_is_ro_ch_once(_adapter *adapter); +void rtw_cfg80211_set_last_ro_ch_time(_adapter *adapter); +s32 rtw_cfg80211_get_last_ro_ch_passing_ms(_adapter *adapter); int rtw_cfg80211_iface_has_p2p_group_cap(_adapter *adapter); int rtw_cfg80211_is_p2p_scan(_adapter *adapter); @@ -254,17 +326,26 @@ 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); void rtw_cfg80211_rx_p2p_action_public(_adapter *padapter, union recv_frame *rframe); void rtw_cfg80211_rx_action_p2p(_adapter *padapter, union recv_frame *rframe); void rtw_cfg80211_rx_action(_adapter *adapter, union recv_frame *rframe, const char *msg); +void rtw_cfg80211_rx_mframe(_adapter *adapter, union recv_frame *rframe, const char *msg); void rtw_cfg80211_rx_probe_request(_adapter *padapter, union recv_frame *rframe); +void rtw_cfg80211_external_auth_request(_adapter *padapter, union recv_frame *rframe); +void rtw_cfg80211_external_auth_status(struct wiphy *wiphy, struct net_device *dev, + struct rtw_external_auth_params *params); + 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); @@ -306,6 +387,14 @@ void rtw_cfg80211_deinit_rfkill(struct wiphy *wiphy); #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)) +#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) @@ -314,10 +403,29 @@ void rtw_cfg80211_deinit_rfkill(struct wiphy *wiphy); #endif #endif -#if (KERNEL_VERSION(4, 7, 0) >= LINUX_VERSION_CODE) +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 0, 0)) +#define rtw_cfg80211_notify_new_peer_candidate(wdev, addr, ie, ie_len, sig_dbm, gfp) cfg80211_notify_new_peer_candidate(wdev_to_ndev(wdev), addr, ie, ie_len, sig_dbm, gfp) +#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) +#define rtw_cfg80211_notify_new_peer_candidate(wdev, addr, ie, ie_len, sig_dbm, gfp) cfg80211_notify_new_peer_candidate(wdev_to_ndev(wdev), addr, ie, ie_len, gfp) +#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/rtl8188eu/os_dep/linux/ioctl_linux.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/ioctl_linux.c index c7faa24fbd85..f918902e2bbd 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/ioctl_linux.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/ioctl_linux.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,17 +12,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_LINUX_C_ #include #include -#include #include "../../hal/phydm/phydm_precomp.h" #ifdef RTW_HALMAC #include "../../hal/hal_halmac.h" @@ -42,6 +37,7 @@ extern int rtw_ht_enable; #define SCAN_ITEM_SIZE 768 #define MAX_CUSTOM_LEN 64 #define RATE_COUNT 4 +#define MAX_SCAN_BUFFER_LEN 65535 #ifdef CONFIG_GLOBAL_UI_PID extern int ui_pid[3]; @@ -73,29 +69,6 @@ static const char *const iw_operation_mode[] = { "Auto", "Ad-Hoc", "Managed", "Master", "Repeater", "Secondary", "Monitor" }; -static int hex2num_i(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; -} - -static int hex2byte_i(const char *hex) -{ - int a, b; - a = hex2num_i(*hex++); - if (a < 0) - return -1; - b = hex2num_i(*hex++); - if (b < 0) - return -1; - return (a << 4) | b; -} - /** * hwaddr_aton - Convert ASCII string to MAC address * @txt: MAC address as a string (e.g., "00:11:22:33:44:55") @@ -122,10 +95,10 @@ static int hwaddr_aton_i(const char *txt, u8 *addr) return 0; } - +#ifdef CONFIG_ANDROID static void indicate_wx_custom_event(_adapter *padapter, char *msg) { - u8 *buff, *p; + u8 *buff; union iwreq_data wrqu; if (strlen(msg) > IW_CUSTOM_MAX) { @@ -150,8 +123,9 @@ static void indicate_wx_custom_event(_adapter *padapter, char *msg) rtw_mfree(buff, IW_CUSTOM_MAX + 1); } +#endif - +#if 0 static void request_wps_pbc_event(_adapter *padapter) { u8 *buff, *p; @@ -184,6 +158,7 @@ static void request_wps_pbc_event(_adapter *padapter) rtw_mfree(buff, IW_CUSTOM_MAX); } +#endif #ifdef CONFIG_SUPPORT_HW_WPS_PBC void rtw_request_wps_pbc_event(_adapter *padapter) @@ -212,7 +187,6 @@ void rtw_request_wps_pbc_event(_adapter *padapter) void indicate_wx_scan_complete_event(_adapter *padapter) { union iwreq_data wrqu; - struct mlme_priv *pmlmepriv = &padapter->mlmepriv; _rtw_memset(&wrqu, 0, sizeof(union iwreq_data)); @@ -446,18 +420,24 @@ 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 */ +#ifdef CONFIG_80211N_HT /* parsing HT_CAP_IE */ - p = rtw_get_ie(&pnetwork->network.IEs[ie_offset], _HT_CAPABILITY_IE_, &ht_ielen, pnetwork->network.IELength - ie_offset); - if (p && ht_ielen > 0) - ht_cap = _TRUE; + if(padapter->registrypriv.ht_enable && is_supported_ht(padapter->registrypriv.wireless_mode)) { + p = rtw_get_ie(&pnetwork->network.IEs[ie_offset], _HT_CAPABILITY_IE_, &ht_ielen, pnetwork->network.IELength - ie_offset); + if (p && ht_ielen > 0) + ht_cap = _TRUE; + } +#endif #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) - vht_cap = _TRUE; + if(padapter->registrypriv.wireless_mode & WIRELESS_11AC) { + p = rtw_get_ie(&pnetwork->network.IEs[ie_offset], EID_VHTCapability, &vht_ielen, pnetwork->network.IELength - ie_offset); + if (p && vht_ielen > 0) + vht_cap = _TRUE; + } #endif /* Add the protocol name */ iwe->cmd = SIOCGIWNAME; @@ -506,36 +486,39 @@ 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); - 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; + if(is_supported_ht(padapter->registrypriv.wireless_mode)) { + p = rtw_get_ie(&pnetwork->network.IEs[ie_offset], _HT_CAPABILITY_IE_, &ht_ielen, pnetwork->network.IELength - ie_offset); + 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]; + if(padapter->registrypriv.wireless_mode & WIRELESS_11AC){ + 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); + 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); + _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); + 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 @@ -594,7 +577,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) { @@ -653,12 +636,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 */ @@ -684,7 +667,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}; @@ -726,11 +709,14 @@ static inline char *iwe_stream_rssi_process(_adapter *padapter, { u8 ss, sq; struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); +#ifdef CONFIG_BACKGROUND_NOISE_MONITOR + s16 noise = 0; +#endif /* 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 @@ -753,17 +739,7 @@ static inline char *iwe_stream_rssi_process(_adapter *padapter, #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_signal_scale_mapping(&pHal->odmpriv, ss); - } -#endif #endif iwe->u.qual.qual = (u8)sq; /* signal quality */ @@ -771,11 +747,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 */ @@ -794,7 +772,6 @@ static inline char *iwe_stream_net_rsv_process(_adapter *padapter, { u8 buf[32] = {0}; u8 *p, *pos; - int len; p = buf; pos = pnetwork->network.Reserved; @@ -806,7 +783,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) @@ -821,7 +797,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); @@ -840,374 +816,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_signal_scale_mapping(&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) { @@ -1257,7 +865,7 @@ static int wpa_set_auth_algs(struct net_device *dev, u32 value) static int wpa_set_encryption(struct net_device *dev, struct ieee_param *param, u32 param_len) { int ret = 0; - u32 wep_key_idx, wep_key_len, wep_total_len; + u32 wep_key_idx, wep_key_len; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct security_priv *psecuritypriv = &padapter->securitypriv; @@ -1302,7 +910,7 @@ static int wpa_set_encryption(struct net_device *dev, struct ieee_param *param, wep_key_idx = param->u.crypt.idx; wep_key_len = param->u.crypt.key_len; - if ((wep_key_idx > WEP_KEYS) || (wep_key_len <= 0)) { + if ((wep_key_idx >= WEP_KEYS) || (wep_key_len <= 0)) { ret = -EINVAL; goto exit; } @@ -1330,6 +938,7 @@ static int wpa_set_encryption(struct net_device *dev, struct ieee_param *param, psecuritypriv->key_mask |= BIT(wep_key_idx); + padapter->mlmeextpriv.mlmext_info.key_index = wep_key_idx; goto exit; } @@ -1351,26 +960,23 @@ static int wpa_set_encryption(struct net_device *dev, struct ieee_param *param, psta->dot118021XPrivacy = padapter->securitypriv.dot11PrivacyAlgrthm; if (param->u.crypt.set_tx == 1) { /* pairwise key */ + RTW_INFO(FUNC_ADPT_FMT" set %s PTK idx:%u, len:%u\n" + , FUNC_ADPT_ARG(padapter), param->u.crypt.alg, param->u.crypt.idx, param->u.crypt.key_len); _rtw_memcpy(psta->dot118021x_UncstKey.skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); - if (strcmp(param->u.crypt.alg, "TKIP") == 0) { /* set mic key */ - /* DEBUG_ERR(("\nset key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len)); */ _rtw_memcpy(psta->dot11tkiptxmickey.skey, &(param->u.crypt.key[16]), 8); _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)); */ - RTW_INFO(" ~~~~set sta key:unicastkey\n"); - - rtw_setstakey_cmd(padapter, psta, UNICAST_KEY, _TRUE); - + psta->dot11txpn.val = RTW_GET_LE64(param->u.crypt.seq); + psta->dot11rxpn.val = RTW_GET_LE64(param->u.crypt.seq); psta->bpairwise_key_installed = _TRUE; + rtw_setstakey_cmd(padapter, psta, UNICAST_KEY, _TRUE); } else { /* group key */ if (strcmp(param->u.crypt.alg, "TKIP") == 0 || strcmp(param->u.crypt.alg, "CCMP") == 0) { + RTW_INFO(FUNC_ADPT_FMT" set %s GTK idx:%u, len:%u\n" + , FUNC_ADPT_ARG(padapter), param->u.crypt.alg, param->u.crypt.idx, param->u.crypt.key_len); _rtw_memcpy(padapter->securitypriv.dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); /* only TKIP group key need to install this */ @@ -1379,39 +985,31 @@ static int wpa_set_encryption(struct net_device *dev, struct ieee_param *param, _rtw_memcpy(padapter->securitypriv.dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8); } padapter->securitypriv.binstallGrpkey = _TRUE; - /* DEBUG_ERR((" param->u.crypt.key_len=%d\n", param->u.crypt.key_len)); */ - if (param->u.crypt.idx < 4) { - _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - _rtw_memcpy(padapter->securitypriv.iv_seq[param->u.crypt.idx], param->u.crypt.seq, 8); - } - RTW_INFO(" ~~~~set sta key:groupkey\n"); - + if (param->u.crypt.idx < 4) + _rtw_memcpy(padapter->securitypriv.iv_seq[param->u.crypt.idx], param->u.crypt.seq, 8); padapter->securitypriv.dot118021XGrpKeyid = param->u.crypt.idx; - rtw_set_key(padapter, &padapter->securitypriv, param->u.crypt.idx, 1, _TRUE); - } -#ifdef CONFIG_IEEE80211W - else if (strcmp(param->u.crypt.alg, "BIP") == 0) { - int no; - /* printk("BIP key_len=%d , index=%d @@@@@@@@@@@@@@@@@@\n", param->u.crypt.key_len, param->u.crypt.idx); */ - /* save the IGTK key, length 16 bytes */ + + #ifdef CONFIG_IEEE80211W + } else if (strcmp(param->u.crypt.alg, "BIP") == 0) { + RTW_INFO(FUNC_ADPT_FMT" set IGTK idx:%u, len:%u\n" + , FUNC_ADPT_ARG(padapter), param->u.crypt.idx, param->u.crypt.key_len); _rtw_memcpy(padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); - /*printk("IGTK key below:\n"); - for(no=0;no<16;no++) - printk(" %02x ", padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey[no]); - printk("\n");*/ - padapter->securitypriv.dot11wBIPKeyid = param->u.crypt.idx; - padapter->securitypriv.binstallBIPkey = _TRUE; - RTW_INFO(" ~~~~set sta key:IGKT\n"); + psecuritypriv->dot11wBIPKeyid = param->u.crypt.idx; + psecuritypriv->dot11wBIPrxpn.val = RTW_GET_LE64(param->u.crypt.seq); + psecuritypriv->binstallBIPkey = _TRUE; + #endif /* CONFIG_IEEE80211W */ + } -#endif /* CONFIG_IEEE80211W */ #ifdef CONFIG_P2P if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_PROVISIONING_ING)) rtw_p2p_set_state(pwdinfo, P2P_STATE_PROVISIONING_DONE); #endif /* CONFIG_P2P */ + /* WPA/WPA2 key-handshake has completed */ + clr_fwstate(pmlmepriv, WIFI_UNDER_KEY_HANDSHAKE); } } @@ -1432,61 +1030,8 @@ static int wpa_set_encryption(struct net_device *dev, struct ieee_param *param, } #ifdef CONFIG_WAPI_SUPPORT - if (strcmp(param->u.crypt.alg, "SMS4") == 0) { - PRT_WAPI_T pWapiInfo = &padapter->wapiInfo; - PRT_WAPI_STA_INFO pWapiSta; - u8 WapiASUEPNInitialValueSrc[16] = {0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C} ; - 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} ; - - if (param->u.crypt.set_tx == 1) { - list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { - if (_rtw_memcmp(pWapiSta->PeerMacAddr, param->sta_addr, 6)) { - _rtw_memcpy(pWapiSta->lastTxUnicastPN, WapiASUEPNInitialValueSrc, 16); - - pWapiSta->wapiUsk.bSet = true; - _rtw_memcpy(pWapiSta->wapiUsk.dataKey, param->u.crypt.key, 16); - _rtw_memcpy(pWapiSta->wapiUsk.micKey, param->u.crypt.key + 16, 16); - pWapiSta->wapiUsk.keyId = param->u.crypt.idx ; - pWapiSta->wapiUsk.bTxEnable = true; - - _rtw_memcpy(pWapiSta->lastRxUnicastPNBEQueue, WapiAEPNInitialValueSrc, 16); - _rtw_memcpy(pWapiSta->lastRxUnicastPNBKQueue, WapiAEPNInitialValueSrc, 16); - _rtw_memcpy(pWapiSta->lastRxUnicastPNVIQueue, WapiAEPNInitialValueSrc, 16); - _rtw_memcpy(pWapiSta->lastRxUnicastPNVOQueue, WapiAEPNInitialValueSrc, 16); - _rtw_memcpy(pWapiSta->lastRxUnicastPN, WapiAEPNInitialValueSrc, 16); - pWapiSta->wapiUskUpdate.bTxEnable = false; - pWapiSta->wapiUskUpdate.bSet = false; - - if (psecuritypriv->sw_encrypt == false || psecuritypriv->sw_decrypt == false) { - /* set unicast key for ASUE */ - rtw_wapi_set_key(padapter, &pWapiSta->wapiUsk, pWapiSta, false, false); - } - } - } - } else { - list_for_each_entry(pWapiSta, &pWapiInfo->wapiSTAUsedList, list) { - if (_rtw_memcmp(pWapiSta->PeerMacAddr, get_bssid(pmlmepriv), 6)) { - pWapiSta->wapiMsk.bSet = true; - _rtw_memcpy(pWapiSta->wapiMsk.dataKey, param->u.crypt.key, 16); - _rtw_memcpy(pWapiSta->wapiMsk.micKey, param->u.crypt.key + 16, 16); - pWapiSta->wapiMsk.keyId = param->u.crypt.idx ; - pWapiSta->wapiMsk.bTxEnable = false; - if (!pWapiSta->bSetkeyOk) - pWapiSta->bSetkeyOk = true; - pWapiSta->bAuthenticateInProgress = false; - - _rtw_memcpy(pWapiSta->lastRxMulticastPN, WapiAEMultiCastPNInitialValueSrc, 16); - - if (psecuritypriv->sw_decrypt == false) { - /* set rx broadcast key for ASUE */ - rtw_wapi_set_key(padapter, &pWapiSta->wapiMsk, pWapiSta, true, false); - } - } - - } - } - } + if (strcmp(param->u.crypt.alg, "SMS4") == 0) + rtw_wapi_set_set_encryption(padapter, param); #endif exit: @@ -1498,8 +1043,8 @@ static int wpa_set_encryption(struct net_device *dev, struct ieee_param *param, static int rtw_set_wpa_ie(_adapter *padapter, char *pie, unsigned short ielen) { u8 *buf = NULL, *pos = NULL; - u32 left; int group_cipher = 0, pairwise_cipher = 0; + u8 mfp_opt = MFP_NO; int ret = 0; u8 null_addr[] = {0, 0, 0, 0, 0, 0}; #ifdef CONFIG_P2P @@ -1537,26 +1082,13 @@ static int rtw_set_wpa_ie(_adapter *padapter, char *pie, unsigned short ielen) goto exit; } -#if 0 - pos += RSN_HEADER_LEN; - left = ielen - RSN_HEADER_LEN; - - if (left >= RSN_SELECTOR_LEN) { - pos += RSN_SELECTOR_LEN; - left -= RSN_SELECTOR_LEN; - } else if (left > 0) { - ret = -1; - goto exit; - } -#endif - if (rtw_parse_wpa_ie(buf, ielen, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) { padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeWPAPSK; _rtw_memcpy(padapter->securitypriv.supplicant_ie, &buf[0], ielen); } - if (rtw_parse_wpa2_ie(buf, ielen, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) { + if (rtw_parse_wpa2_ie(buf, ielen, &group_cipher, &pairwise_cipher, NULL, &mfp_opt) == _SUCCESS) { padapter->securitypriv.dot11AuthAlgrthm = dot11AuthAlgrthm_8021X; padapter->securitypriv.ndisauthtype = Ndis802_11AuthModeWPA2PSK; _rtw_memcpy(padapter->securitypriv.supplicant_ie, &buf[0], ielen); @@ -1613,6 +1145,13 @@ static int rtw_set_wpa_ie(_adapter *padapter, char *pie, unsigned short ielen) break; } + if (mfp_opt == MFP_INVALID) { + RTW_INFO(FUNC_ADPT_FMT" invalid MFP setting\n", FUNC_ADPT_ARG(padapter)); + ret = -EINVAL; + goto exit; + } + padapter->securitypriv.mfp_opt = mfp_opt; + _clr_fwstate_(&padapter->mlmepriv, WIFI_UNDER_WPS); {/* set wps_ie */ u16 cnt = 0; @@ -1666,7 +1205,6 @@ static int rtw_wx_get_name(struct net_device *dev, union iwreq_data *wrqu, char *extra) { _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - u16 cap; u32 ht_ielen = 0; char *p; u8 ht_cap = _FALSE, vht_cap = _FALSE; @@ -1678,17 +1216,18 @@ static int rtw_wx_get_name(struct net_device *dev, if (check_fwstate(pmlmepriv, _FW_LINKED | WIFI_ADHOC_MASTER_STATE) == _TRUE) { /* parsing HT_CAP_IE */ - p = rtw_get_ie(&pcur_bss->IEs[12], _HT_CAPABILITY_IE_, &ht_ielen, pcur_bss->IELength - 12); - if (p && ht_ielen > 0) - ht_cap = _TRUE; - + if( is_supported_ht(padapter->registrypriv.wireless_mode)&&(padapter->registrypriv.ht_enable)) { + p = rtw_get_ie(&pcur_bss->IEs[12], _HT_CAPABILITY_IE_, &ht_ielen, pcur_bss->IELength - 12); + if (p && ht_ielen > 0 ) + ht_cap = _TRUE; + } #ifdef CONFIG_80211AC_VHT - if (pmlmepriv->vhtpriv.vht_option == _TRUE) + if ((padapter->registrypriv.wireless_mode & WIRELESS_11AC) && + (pmlmepriv->vhtpriv.vht_option == _TRUE)) vht_cap = _TRUE; #endif prates = &pcur_bss->SupportedRates; - if (rtw_is_cckratesonly_included((u8 *)prates) == _TRUE) { if (ht_cap == _TRUE) snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11bn"); @@ -1697,8 +1236,12 @@ static int rtw_wx_get_name(struct net_device *dev, } else if ((rtw_is_cckrates_included((u8 *)prates)) == _TRUE) { if (ht_cap == _TRUE) snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11bgn"); - else - snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11bg"); + else { + if(padapter->registrypriv.wireless_mode & WIRELESS_11G) + snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11bg"); + else + snprintf(wrqu->name, IFNAMSIZ, "IEEE 802.11b"); + } } else { if (pcur_bss->Configuration.DSConfig > 14) { #ifdef CONFIG_80211AC_VHT @@ -1735,16 +1278,14 @@ static int rtw_wx_set_freq(struct net_device *dev, { _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); - struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); - struct wlan_network *cur_network = &(pmlmepriv->cur_network); 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 { @@ -1782,9 +1323,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; } @@ -1867,7 +1408,6 @@ static int rtw_wx_set_mode(struct net_device *dev, struct iw_request_info *a, case IW_MODE_MASTER: networkType = Ndis802_11APMode; RTW_INFO("set_mode = IW_MODE_MASTER\n"); - /* rtw_setopmode_cmd(padapter, networkType,_TRUE); */ break; case IW_MODE_INFRA: networkType = Ndis802_11Infrastructure; @@ -1879,17 +1419,6 @@ static int rtw_wx_set_mode(struct net_device *dev, struct iw_request_info *a, goto exit; } - /* - if(Ndis802_11APMode == networkType) - { - rtw_setopmode_cmd(padapter, networkType,_TRUE); - } - else - { - rtw_setopmode_cmd(padapter, Ndis802_11AutoUnknown,_TRUE); - } - */ - if (rtw_set_802_11_infrastructure_mode(padapter, networkType) == _FALSE) { ret = -EPERM; @@ -1897,7 +1426,7 @@ static int rtw_wx_set_mode(struct net_device *dev, struct iw_request_info *a, } - rtw_setopmode_cmd(padapter, networkType, _TRUE); + rtw_setopmode_cmd(padapter, networkType, RTW_CMDF_WAIT_ACK); if (check_fwstate(pmlmepriv, WIFI_MONITOR_STATE) == _TRUE) rtw_indicate_connect(padapter); @@ -1943,7 +1472,6 @@ static int rtw_wx_set_pmkid(struct net_device *dev, _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); u8 j, blInserted = _FALSE; int intReturn = _FALSE; - struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct security_priv *psecuritypriv = &padapter->securitypriv; struct iw_pmksa *pPMK = (struct iw_pmksa *) extra; u8 strZeroMacAddress[ETH_ALEN] = { 0x00 }; @@ -2051,8 +1579,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 mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); u16 val; int i; @@ -2093,7 +1620,6 @@ static int rtw_wx_get_range(struct net_device *dev, * If percentage range is 0~100 * Signal strength dbm range logical is -100 ~ 0 * but usually value is -90 ~ -20 - * When CONFIG_SIGNAL_SCALE_MAPPING is defined, dbm range is -95 ~ -45 */ range->max_qual.qual = 100; #ifdef CONFIG_SIGNAL_DISPLAY_DBM @@ -2152,12 +1678,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++; } @@ -2314,7 +1840,9 @@ static int rtw_wx_set_wap(struct net_device *dev, cancel_ps_deny: rtw_ps_deny_cancel(padapter, PS_DENY_JOIN); +#ifdef CONFIG_CONCURRENT_MODE exit: +#endif return ret; } @@ -2391,7 +1919,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; } @@ -2401,20 +1931,55 @@ static int rtw_wx_set_scan(struct net_device *dev, struct iw_request_info *a, u8 _status = _FALSE; 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 mlme_priv *pmlmepriv = &padapter->mlmepriv;*/ + struct sitesurvey_parm parm; + u8 ssc_chk; #ifdef CONFIG_P2P struct wifidirect_info *pwdinfo = &(padapter->wdinfo); #endif /* CONFIG_P2P */ - #ifdef DBG_IOCTL RTW_INFO("DBG_IOCTL %s:%d\n", __FUNCTION__, __LINE__); #endif +#if 1 + ssc_chk = rtw_sitesurvey_condition_check(padapter, _FALSE); + + #ifdef CONFIG_DOSCAN_IN_BUSYTRAFFIC + if ((ssc_chk != SS_ALLOW) && (ssc_chk != SS_DENY_BUSY_TRAFFIC)) + #else + /* When Busy Traffic, driver do not site survey. So driver return success. */ + /* wpa_supplicant will not issue SIOCSIWSCAN cmd again after scan timeout. */ + /* modify by thomas 2011-02-22. */ + if (ssc_chk != SS_ALLOW) + #endif + { + if (ssc_chk == SS_DENY_MP_MODE) + ret = -EPERM; + #ifdef DBG_LA_MODE + else if (ssc_chk == SS_DENY_LA_MODE) + ret = -EPERM; + #endif + else + indicate_wx_scan_complete_event(padapter); + + goto exit; + } else + RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); + + rtw_ps_deny(padapter, PS_DENY_SCAN); + if (_FAIL == rtw_pwr_wakeup(padapter)) { + ret = -1; + goto cancel_ps_deny; + } + if (!rtw_is_adapter_up(padapter)) { + ret = -1; + goto cancel_ps_deny; + } +#else + #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; @@ -2445,7 +2010,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); @@ -2465,6 +2036,7 @@ static int rtw_wx_set_scan(struct net_device *dev, struct iw_request_info *a, goto cancel_ps_deny; } #endif +#endif #ifdef CONFIG_P2P if (pwdinfo->p2p_state != P2P_STATE_NONE) { @@ -2475,8 +2047,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; @@ -2484,12 +2054,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"); @@ -2507,6 +2079,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++); @@ -2524,10 +2097,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++; } @@ -2574,13 +2149,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; @@ -2602,15 +2178,17 @@ static int rtw_wx_get_scan(struct net_device *dev, struct iw_request_info *a, _irqL irqL; _list *plist, *phead; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); + RT_CHANNEL_INFO *chset = rfctl->channel_set; struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); _queue *queue = &(pmlmepriv->scanned_queue); struct wlan_network *pnetwork = NULL; char *ev = extra; char *stop = ev + wrqu->data.length; u32 ret = 0; - u32 cnt = 0; u32 wait_for_surveydone; sint wait_status; + u8 ch; #ifdef CONFIG_P2P struct wifidirect_info *pwdinfo = &padapter->wdinfo; @@ -2672,17 +2250,26 @@ static int rtw_wx_get_scan(struct net_device *dev, struct iw_request_info *a, break; if ((stop - ev) < SCAN_ITEM_SIZE) { + if(wrqu->data.length == MAX_SCAN_BUFFER_LEN){ /*max buffer len defined by iwlist*/ + ret = 0; + RTW_INFO("%s: Scan results incomplete\n", __FUNCTION__); + break; + } ret = -E2BIG; break; } pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); + ch = pnetwork->network.Configuration.DSConfig; /* 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 - && rtw_mlme_band_check(padapter, pnetwork->network.Configuration.DSConfig) == _TRUE - && _TRUE == rtw_validate_ssid(&(pnetwork->network.Ssid)) - ) + if (rtw_chset_search_ch(chset, ch) >= 0 + && rtw_mlme_band_check(padapter, ch) == _TRUE + && _TRUE == rtw_validate_ssid(&(pnetwork->network.Ssid)) + && (!IS_DFS_SLAVE_WITH_RD(rfctl) + || rtw_odm_dfs_domain_unknown(rfctl_to_dvobj(rfctl)) + || !rtw_chset_is_ch_non_ocp(chset, ch)) + ) ev = translate_scan(padapter, a, pnetwork, ev, stop); plist = get_next(plist); @@ -2719,7 +2306,6 @@ static int rtw_wx_set_essid(struct net_device *dev, struct mlme_priv *pmlmepriv = &padapter->mlmepriv; _queue *queue = &pmlmepriv->scanned_queue; _list *phead; - s8 status = _TRUE; struct wlan_network *pnetwork = NULL; NDIS_802_11_AUTHENTICATION_MODE authmode; NDIS_802_11_SSID ndis_ssid; @@ -3360,11 +2946,14 @@ static int rtw_wx_set_auth(struct net_device *dev, { _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); struct iw_param *param = (struct iw_param *)&(wrqu->param); - struct mlme_priv *pmlmepriv = &padapter->mlmepriv; - struct security_priv *psecuritypriv = &padapter->securitypriv; +#ifdef CONFIG_WAPI_SUPPORT +#ifndef CONFIG_IOCTL_CFG80211 struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + struct security_priv *psecuritypriv = &padapter->securitypriv; u32 value = param->value; +#endif +#endif int ret = 0; switch (param->flags & IW_AUTH_INDEX) { @@ -3454,10 +3043,10 @@ 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_WAIT_ACK); RTW_INFO("%s...call rtw_indicate_disconnect\n ", __FUNCTION__); rtw_indicate_disconnect(padapter, 0, _FALSE); - rtw_free_assoc_resources(padapter, 1); + rtw_free_assoc_resources_cmd(padapter, _TRUE, RTW_CMDF_WAIT_ACK); } #endif @@ -3829,6 +3418,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) { @@ -3846,7 +3451,6 @@ static int rtw_wx_set_channel_plan(struct net_device *dev, union iwreq_data *wrqu, char *extra) { _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - struct mlme_priv *pmlmepriv = &padapter->mlmepriv; u8 channel_plan_req = (u8)(*((int *)wrqu)); if (_SUCCESS != rtw_set_channel_plan(padapter, channel_plan_req)) @@ -3895,111 +3499,7 @@ 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; - -} - +#ifdef MP_IOCTL_HDL static void rtw_dbg_mode_hdl(_adapter *padapter, u32 id, u8 *pdata, u32 len) { pRW_Reg RegRWStruct; @@ -4096,7 +3596,6 @@ static void rtw_dbg_mode_hdl(_adapter *padapter, u32 id, u8 *pdata, u32 len) } } -#ifdef MP_IOCTL_HDL static int rtw_mp_ioctl_hdl(struct net_device *dev, struct iw_request_info *info, union iwreq_data *wrqu, char *extra) { @@ -4205,12 +3704,12 @@ static int rtw_mp_ioctl_hdl(struct net_device *dev, struct iw_request_info *info return ret; } -#endif +#endif /*MP_IOCTL_HDL*/ static int rtw_get_ap_info(struct net_device *dev, struct iw_request_info *info, union iwreq_data *wrqu, char *extra) { - int bssid_match, ret = 0; + int ret = 0; u32 cnt = 0, wpa_ielen; _irqL irqL; _list *plist, *phead; @@ -4366,10 +3865,6 @@ static int rtw_wps_start(struct net_device *dev, else if (u32wps_start == 3) /* WPS Stop because of wps fail */ rtw_led_control(padapter, LED_CTL_STOP_WPS_FAIL); -#ifdef CONFIG_INTEL_WIDI - process_intel_widi_wps_status(padapter, u32wps_start); -#endif /* CONFIG_INTEL_WIDI */ - exit: return ret; @@ -4384,8 +3879,6 @@ static int rtw_wext_p2p_enable(struct net_device *dev, int ret = 0; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); - struct iw_point *pdata = &wrqu->data; struct wifidirect_info *pwdinfo = &(padapter->wdinfo); struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; enum P2P_ROLE init_role = P2P_ROLE_DISABLE; @@ -4451,8 +3944,6 @@ static int rtw_p2p_set_go_nego_ssid(struct net_device *dev, int ret = 0; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); - struct iw_point *pdata = &wrqu->data; struct wifidirect_info *pwdinfo = &(padapter->wdinfo); RTW_INFO("[%s] ssid = %s, len = %zu\n", __FUNCTION__, extra, strlen(extra)); @@ -4617,7 +4108,6 @@ static int rtw_p2p_get_status(struct net_device *dev, int ret = 0; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - struct iw_point *pdata = &wrqu->data; struct wifidirect_info *pwdinfo = &(padapter->wdinfo); if (padapter->bShowGetP2PState) { @@ -4648,7 +4138,6 @@ static int rtw_p2p_get_req_cm(struct net_device *dev, int ret = 0; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - struct iw_point *pdata = &wrqu->data; struct wifidirect_info *pwdinfo = &(padapter->wdinfo); sprintf(extra, "\n\nCM=%s\n", pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req); @@ -4665,10 +4154,8 @@ static int rtw_p2p_get_role(struct net_device *dev, int ret = 0; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - struct iw_point *pdata = &wrqu->data; struct wifidirect_info *pwdinfo = &(padapter->wdinfo); - RTW_INFO("[%s] Role = %d, Status = %d, peer addr = %.2X:%.2X:%.2X:%.2X:%.2X:%.2X\n", __FUNCTION__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), pwdinfo->p2p_peer_interface_addr[0], pwdinfo->p2p_peer_interface_addr[1], pwdinfo->p2p_peer_interface_addr[2], pwdinfo->p2p_peer_interface_addr[3], pwdinfo->p2p_peer_interface_addr[4], pwdinfo->p2p_peer_interface_addr[5]); @@ -4687,7 +4174,6 @@ static int rtw_p2p_get_peer_ifaddr(struct net_device *dev, int ret = 0; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - struct iw_point *pdata = &wrqu->data; struct wifidirect_info *pwdinfo = &(padapter->wdinfo); @@ -4711,7 +4197,6 @@ static int rtw_p2p_get_peer_devaddr(struct net_device *dev, int ret = 0; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - struct iw_point *pdata = &wrqu->data; struct wifidirect_info *pwdinfo = &(padapter->wdinfo); RTW_INFO("[%s] Role = %d, Status = %d, peer addr = %.2X:%.2X:%.2X:%.2X:%.2X:%.2X\n", __FUNCTION__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), @@ -4735,7 +4220,6 @@ static int rtw_p2p_get_peer_devaddr_by_invitation(struct net_device *dev, int ret = 0; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - struct iw_point *pdata = &wrqu->data; struct wifidirect_info *pwdinfo = &(padapter->wdinfo); RTW_INFO("[%s] Role = %d, Status = %d, peer addr = %.2X:%.2X:%.2X:%.2X:%.2X:%.2X\n", __FUNCTION__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo), @@ -4759,7 +4243,6 @@ static int rtw_p2p_get_groupid(struct net_device *dev, int ret = 0; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - struct iw_point *pdata = &wrqu->data; struct wifidirect_info *pwdinfo = &(padapter->wdinfo); sprintf(extra, "\n%.2X:%.2X:%.2X:%.2X:%.2X:%.2X %s", @@ -4780,7 +4263,6 @@ static int rtw_p2p_get_op_ch(struct net_device *dev, int ret = 0; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - struct iw_point *pdata = &wrqu->data; struct wifidirect_info *pwdinfo = &(padapter->wdinfo); @@ -4872,7 +4354,6 @@ static int rtw_p2p_get_peer_wfd_port(struct net_device *dev, int ret = 0; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - struct iw_point *pdata = &wrqu->data; struct wifidirect_info *pwdinfo = &(padapter->wdinfo); RTW_INFO("[%s] p2p_state = %d\n", __FUNCTION__, rtw_p2p_state(pwdinfo)); @@ -4892,7 +4373,6 @@ static int rtw_p2p_get_peer_wfd_preferred_connection(struct net_device *dev, int ret = 0; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - struct iw_point *pdata = &wrqu->data; struct wifidirect_info *pwdinfo = &(padapter->wdinfo); sprintf(extra, "\n\nwfd_pc=%d\n", pwdinfo->wfd_info->wfd_pc); @@ -4911,7 +4391,6 @@ static int rtw_p2p_get_peer_wfd_session_available(struct net_device *dev, int ret = 0; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - struct iw_point *pdata = &wrqu->data; struct wifidirect_info *pwdinfo = &(padapter->wdinfo); sprintf(extra, "\n\nwfd_sa=%d\n", pwdinfo->wfd_info->peer_session_avail); @@ -5245,7 +4724,6 @@ static int rtw_p2p_connect(struct net_device *dev, struct wifidirect_info *pwdinfo = &(padapter->wdinfo); u8 peerMAC[ETH_ALEN] = { 0x00 }; int jj, kk; - u8 peerMACStr[ETH_ALEN * 2] = { 0x00 }; struct mlme_priv *pmlmepriv = &padapter->mlmepriv; _irqL irqL; _list *plist, *phead; @@ -5267,13 +4745,6 @@ static int rtw_p2p_connect(struct net_device *dev, return ret; } -#ifdef CONFIG_INTEL_WIDI - if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) { - RTW_INFO("[%s] WiFi is under survey!\n", __FUNCTION__); - return ret; - } -#endif /* CONFIG_INTEL_WIDI */ - if (pwdinfo->ui_got_wps_info == P2P_NO_WPSINFO) return -1; @@ -5336,10 +4807,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 */ @@ -5356,22 +4826,9 @@ static int rtw_p2p_connect(struct net_device *dev, } else { RTW_INFO("[%s] Not Found in Scanning Queue~\n", __FUNCTION__); -#ifdef CONFIG_INTEL_WIDI - _cancel_timer_ex(&pwdinfo->restore_p2p_state_timer); - rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH); - rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_NONE); - rtw_free_network_queue(padapter, _TRUE); - /** - * For WiDi, if we can't find candidate device in scanning queue, - * driver will do scanning itself - */ - _enter_critical_bh(&pmlmepriv->lock, &irqL); - rtw_sitesurvey_cmd(padapter, NULL, 0, NULL, 0); - _exit_critical_bh(&pmlmepriv->lock, &irqL); -#endif /* CONFIG_INTEL_WIDI */ ret = -1; } -exit: + return ret; } @@ -5382,16 +4839,14 @@ static int rtw_p2p_invite_req(struct net_device *dev, int ret = 0; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - struct iw_point *pdata = &wrqu->data; struct wifidirect_info *pwdinfo = &(padapter->wdinfo); int jj, kk; - u8 peerMACStr[ETH_ALEN * 2] = { 0x00 }; struct mlme_priv *pmlmepriv = &padapter->mlmepriv; _list *plist, *phead; _queue *queue = &(pmlmepriv->scanned_queue); struct wlan_network *pnetwork = NULL; uint uintPeerChannel = 0; - u8 attr_content[50] = { 0x00 }, _status = 0; + u8 attr_content[50] = { 0x00 }; u8 *p2pie; uint p2pielen = 0, attr_contentlen = 0; _irqL irqL; @@ -5528,15 +4983,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); @@ -5565,20 +5020,7 @@ static int rtw_p2p_set_persistent(struct net_device *dev, int ret = 0; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - struct iw_point *pdata = &wrqu->data; struct wifidirect_info *pwdinfo = &(padapter->wdinfo); - int jj, kk; - u8 peerMACStr[ETH_ALEN * 2] = { 0x00 }; - struct mlme_priv *pmlmepriv = &padapter->mlmepriv; - _list *plist, *phead; - _queue *queue = &(pmlmepriv->scanned_queue); - struct wlan_network *pnetwork = NULL; - uint uintPeerChannel = 0; - u8 attr_content[50] = { 0x00 }, _status = 0; - u8 *p2pie; - uint p2pielen = 0, attr_contentlen = 0; - _irqL irqL; - struct tx_invite_req_info *pinvite_req_info = &pwdinfo->invitereq_info; /* Commented by Albert 20120328 */ /* The input data is 0 or 1 */ @@ -5600,29 +5042,10 @@ static int rtw_p2p_set_persistent(struct net_device *dev, } printk("[%s] persistent_supported = %d\n", __FUNCTION__, pwdinfo->persistent_supported); -exit: - return ret; } -static int hexstr2bin(const char *hex, u8 *buf, size_t len) -{ - size_t i; - int a; - const char *ipos = hex; - u8 *opos = buf; - - for (i = 0; i < len; i++) { - a = hex2byte_i(ipos); - if (a < 0) - return -1; - *opos++ = a; - ipos += 2; - } - return 0; -} - static int uuid_str2bin(const char *str, u8 *bin) { const char *pos; @@ -5686,16 +5109,14 @@ static int rtw_p2p_set_pc(struct net_device *dev, int ret = 0; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - struct iw_point *pdata = &wrqu->data; struct wifidirect_info *pwdinfo = &(padapter->wdinfo); u8 peerMAC[ETH_ALEN] = { 0x00 }; int jj, kk; - u8 peerMACStr[ETH_ALEN * 2] = { 0x00 }; struct mlme_priv *pmlmepriv = &padapter->mlmepriv; _list *plist, *phead; _queue *queue = &(pmlmepriv->scanned_queue); struct wlan_network *pnetwork = NULL; - u8 attr_content[50] = { 0x00 }, _status = 0; + u8 attr_content[50] = { 0x00 }; u8 *p2pie; uint p2pielen = 0, attr_contentlen = 0; _irqL irqL; @@ -5789,8 +5210,6 @@ static int rtw_p2p_set_pc(struct net_device *dev, } else RTW_INFO("[%s] NOT Found in the Scanning Queue!\n", __FUNCTION__); -exit: - return ret; } @@ -5802,7 +5221,6 @@ static int rtw_p2p_set_wfd_device_type(struct net_device *dev, int ret = 0; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - struct iw_point *pdata = &wrqu->data; struct wifidirect_info *pwdinfo = &(padapter->wdinfo); struct wifi_display_info *pwfd_info = pwdinfo->wfd_info; @@ -5818,8 +5236,6 @@ static int rtw_p2p_set_wfd_device_type(struct net_device *dev, else /* Set to Miracast sink device. */ pwfd_info->wfd_device_type = WFD_DEVINFO_PSINK; -exit: - return ret; } @@ -5876,9 +5292,7 @@ static int rtw_p2p_set_sa(struct net_device *dev, int ret = 0; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - struct iw_point *pdata = &wrqu->data; struct wifidirect_info *pwdinfo = &(padapter->wdinfo); - struct wifi_display_info *pwfd_info = pwdinfo->wfd_info; RTW_INFO("[%s] data = %s\n", __FUNCTION__, extra); @@ -5895,8 +5309,6 @@ static int rtw_p2p_set_sa(struct net_device *dev, } printk("[%s] session available = %d\n", __FUNCTION__, pwdinfo->session_available); -exit: - return ret; } @@ -5911,13 +5323,12 @@ static int rtw_p2p_prov_disc(struct net_device *dev, struct wifidirect_info *pwdinfo = &(padapter->wdinfo); u8 peerMAC[ETH_ALEN] = { 0x00 }; int jj, kk; - u8 peerMACStr[ETH_ALEN * 2] = { 0x00 }; struct mlme_priv *pmlmepriv = &padapter->mlmepriv; _list *plist, *phead; _queue *queue = &(pmlmepriv->scanned_queue); struct wlan_network *pnetwork = NULL; uint uintPeerChannel = 0; - u8 attr_content[100] = { 0x00 }, _status = 0; + u8 attr_content[100] = { 0x00 }; u8 *p2pie; uint p2pielen = 0, attr_contentlen = 0; _irqL irqL; @@ -5937,13 +5348,6 @@ static int rtw_p2p_prov_disc(struct net_device *dev, RTW_INFO("[%s] WiFi Direct is disable!\n", __FUNCTION__); return ret; } else { -#ifdef CONFIG_INTEL_WIDI - if (check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _TRUE) { - RTW_INFO("[%s] WiFi is under survey!\n", __FUNCTION__); - return ret; - } -#endif /* CONFIG_INTEL_WIDI */ - /* Reset the content of struct tx_provdisc_req_info excluded the wps_config_method_request. */ _rtw_memset(pwdinfo->tx_prov_disc_info.peerDevAddr, 0x00, ETH_ALEN); _rtw_memset(pwdinfo->tx_prov_disc_info.peerIFAddr, 0x00, ETH_ALEN); @@ -6013,18 +5417,6 @@ static int rtw_p2p_prov_disc(struct net_device *dev, } -#ifdef CONFIG_INTEL_WIDI - /* Some Intel WiDi source may not provide P2P IE, */ - /* so we could only compare mac addr by 802.11 Source Address */ - if (pmlmepriv->widi_state == INTEL_WIDI_STATE_WFD_CONNECTION - && uintPeerChannel == 0) { - if (_rtw_memcmp(pnetwork->network.MacAddress, peerMAC, ETH_ALEN)) { - uintPeerChannel = pnetwork->network.Configuration.DSConfig; - break; - } - } -#endif /* CONFIG_INTEL_WIDI */ - plist = get_next(plist); } @@ -6091,10 +5483,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 @@ -6114,15 +5505,6 @@ static int rtw_p2p_prov_disc(struct net_device *dev, } else { RTW_INFO("[%s] NOT Found in the Scanning Queue!\n", __FUNCTION__); -#ifdef CONFIG_INTEL_WIDI - _cancel_timer_ex(&pwdinfo->restore_p2p_state_timer); - rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH); - 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); - _exit_critical_bh(&pmlmepriv->lock, &irqL); -#endif /* CONFIG_INTEL_WIDI */ } exit: @@ -6172,15 +5554,9 @@ static int rtw_p2p_set(struct net_device *dev, struct iw_request_info *info, union iwreq_data *wrqu, char *extra) { - int ret = 0; #ifdef CONFIG_P2P - _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); - struct iw_point *pdata = &wrqu->data; - struct wifidirect_info *pwdinfo = &(padapter->wdinfo); - struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; RTW_INFO("[%s] extra = %s\n", __FUNCTION__, extra); @@ -6266,16 +5642,9 @@ static int rtw_p2p_get(struct net_device *dev, struct iw_request_info *info, union iwreq_data *wrqu, char *extra) { - int ret = 0; - #ifdef CONFIG_P2P - _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); - struct iw_point *pdata = &wrqu->data; - struct wifidirect_info *pwdinfo = &(padapter->wdinfo); - struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; if (padapter->bShowGetP2PState) RTW_INFO("[%s] extra = %s\n", __FUNCTION__, (char *) wrqu->data.pointer); @@ -6371,27 +5740,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, @@ -6434,8 +5795,6 @@ static int rtw_rereg_nd_name(struct net_device *dev, goto exit; if (_rtw_memcmp(rereg_priv->old_ifname, "disable%d", 9) == _TRUE) { - padapter->ledpriv.bRegUseLed = rereg_priv->old_bRegUseLed; - rtw_hal_sw_led_init(padapter); /* rtw_ips_mode_req(&padapter->pwrctrlpriv, rereg_priv->old_ips_mode); */ } @@ -6448,12 +5807,6 @@ static int rtw_rereg_nd_name(struct net_device *dev, /* free network queue for Android's timming issue */ rtw_free_network_queue(padapter, _TRUE); - /* close led */ - rtw_led_control(padapter, LED_CTL_POWER_OFF); - rereg_priv->old_bRegUseLed = padapter->ledpriv.bRegUseLed; - padapter->ledpriv.bRegUseLed = _FALSE; - rtw_hal_sw_led_deinit(padapter); - /* 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); */ @@ -6466,10 +5819,13 @@ 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 + static int rtw_dbg_port(struct net_device *dev, struct iw_request_info *info, union iwreq_data *wrqu, char *extra) @@ -6753,11 +6109,6 @@ static int rtw_dbg_port(struct net_device *dev, psecuritypriv->dot11AuthAlgrthm, psecuritypriv->dot11PrivacyAlgrthm, psecuritypriv->ndisauthtype, psecuritypriv->ndisencryptstatus); break; - case 0x02: - RTW_INFO("pmlmeinfo->state=0x%x\n", pmlmeinfo->state); - RTW_INFO("DrvBcnEarly=%d\n", pmlmeext->DrvBcnEarly); - RTW_INFO("DrvBcnTimeOut=%d\n", pmlmeext->DrvBcnTimeOut); - break; case 0x03: RTW_INFO("qos_option=%d\n", pmlmepriv->qospriv.qos_option); #ifdef CONFIG_80211N_HT @@ -6778,13 +6129,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 */ @@ -6794,6 +6147,10 @@ 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: { + u64 tsf = 0; + + tsf = rtw_hal_get_tsftr_by_port(padapter, extra_arg); + RTW_INFO(" PORT-%d TSF :%21lld\n", extra_arg, tsf); } break; case 0x07: @@ -6821,7 +6178,8 @@ static int rtw_dbg_port(struct net_device *dev, _list *plist, *phead; #ifdef CONFIG_AP_MODE - RTW_INFO("sta_dz_bitmap=0x%x, tim_bitmap=0x%x\n", pstapriv->sta_dz_bitmap, pstapriv->tim_bitmap); + RTW_INFO_DUMP("sta_dz_bitmap:", pstapriv->sta_dz_bitmap, pstapriv->aid_bmp_len); + RTW_INFO_DUMP("tim_bitmap:", pstapriv->tim_bitmap, pstapriv->aid_bmp_len); #endif _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); @@ -6834,13 +6192,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); @@ -7080,17 +6440,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); - struct PHY_DM_STRUCT *pDM_Odm = &pHalData->odmpriv; - u8 chan = rtw_get_oper_ch(padapter); RTW_INFO("===========================================\n"); - odm_inband_noise_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 @@ -7155,9 +6507,6 @@ static int rtw_dbg_port(struct net_device *dev, { 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); @@ -7167,22 +6516,11 @@ static int rtw_dbg_port(struct net_device *dev, else { u8 fifo_sel; u32 addr, size; - u8 *buffer = NULL; fifo_sel = (u8)(arg & 0x0F); addr = (extra_arg >> 16) & 0xFFFF; size = extra_arg & 0xFFFF; - - RTW_INFO("fifo_sel:%d, start_addr:0x%04x, size:%d\n", fifo_sel, addr, size); - if (size) { - size = RND4(size); - buffer = rtw_zvmalloc(size); - if (NULL == buffer) - size = 0; - } - rtw_halmac_dump_fifo(adapter_to_dvobj(padapter), fifo_sel, addr, size, buffer); - if (buffer) - rtw_vmfree(buffer, size); + rtw_dump_fifo(RTW_DBGDUMP, padapter, fifo_sel, addr, size); } #endif } @@ -7321,7 +6659,6 @@ static int rtw_dbg_port(struct net_device *dev, static int wpa_set_param(struct net_device *dev, u8 name, u32 value) { uint ret = 0; - u32 flags; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); switch (name) { @@ -7454,7 +6791,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; } @@ -7656,72 +6995,61 @@ static int rtw_set_encryption(struct net_device *dev, struct ieee_param *param, if (!psta && check_fwstate(pmlmepriv, WIFI_AP_STATE)) /* */ { /* group key */ if (param->u.crypt.set_tx == 1) { if (strcmp(param->u.crypt.alg, "WEP") == 0) { - RTW_INFO("%s, set group_key, WEP\n", __FUNCTION__); - + RTW_INFO(FUNC_ADPT_FMT" set WEP TX GTK idx:%u, len:%u\n" + , FUNC_ADPT_ARG(padapter), param->u.crypt.idx, param->u.crypt.key_len); _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); - psecuritypriv->dot118021XGrpPrivacy = _WEP40_; if (param->u.crypt.key_len == 13) psecuritypriv->dot118021XGrpPrivacy = _WEP104_; } else if (strcmp(param->u.crypt.alg, "TKIP") == 0) { - RTW_INFO("%s, set group_key, TKIP\n", __FUNCTION__); - + RTW_INFO(FUNC_ADPT_FMT" set TKIP TX GTK idx:%u, len:%u\n" + , FUNC_ADPT_ARG(padapter), param->u.crypt.idx, param->u.crypt.key_len); psecuritypriv->dot118021XGrpPrivacy = _TKIP_; - _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); - - /* DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len); */ /* set mic key */ _rtw_memcpy(psecuritypriv->dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8); _rtw_memcpy(psecuritypriv->dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8); - psecuritypriv->busetkipkey = _TRUE; } else if (strcmp(param->u.crypt.alg, "CCMP") == 0) { - RTW_INFO("%s, set group_key, CCMP\n", __FUNCTION__); - + RTW_INFO(FUNC_ADPT_FMT" set CCMP TX GTK idx:%u, len:%u\n" + , FUNC_ADPT_ARG(padapter), param->u.crypt.idx, param->u.crypt.key_len); psecuritypriv->dot118021XGrpPrivacy = _AES_; - _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); - } -#ifdef CONFIG_IEEE80211W - else if (strcmp(param->u.crypt.alg, "BIP") == 0) { - int no; - RTW_INFO("BIP key_len=%d , index=%d\n", param->u.crypt.key_len, param->u.crypt.idx); - /* save the IGTK key, length 16 bytes */ + #ifdef CONFIG_IEEE80211W + } else if (strcmp(param->u.crypt.alg, "BIP") == 0) { + RTW_INFO(FUNC_ADPT_FMT" set TX IGTK idx:%u, len:%u\n" + , FUNC_ADPT_ARG(padapter), param->u.crypt.idx, param->u.crypt.key_len); _rtw_memcpy(padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); - /* RTW_INFO("IGTK key below:\n"); - for(no=0;no<16;no++) - printk(" %02x ", padapter->securitypriv.dot11wBIPKey[param->u.crypt.idx].skey[no]); - RTW_INFO("\n"); */ - padapter->securitypriv.dot11wBIPKeyid = param->u.crypt.idx; - padapter->securitypriv.binstallBIPkey = _TRUE; - RTW_INFO(" ~~~~set sta key:IGKT\n"); + psecuritypriv->dot11wBIPKeyid = param->u.crypt.idx; + psecuritypriv->dot11wBIPtxpn.val = RTW_GET_LE64(param->u.crypt.seq); + psecuritypriv->binstallBIPkey = _TRUE; goto exit; - } -#endif /* CONFIG_IEEE80211W */ - else { - RTW_INFO("%s, set group_key, none\n", __FUNCTION__); + #endif /* CONFIG_IEEE80211W */ + } else if (strcmp(param->u.crypt.alg, "none") == 0) { + RTW_INFO(FUNC_ADPT_FMT" clear group key, idx:%u\n" + , FUNC_ADPT_ARG(padapter), param->u.crypt.idx); psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; + } else { + RTW_WARN(FUNC_ADPT_FMT" set group key, not support\n" + , FUNC_ADPT_ARG(padapter)); + goto exit; } psecuritypriv->dot118021XGrpKeyid = param->u.crypt.idx; - - psecuritypriv->binstallGrpkey = _TRUE; - - psecuritypriv->dot11PrivacyAlgrthm = psecuritypriv->dot118021XGrpPrivacy;/* !!! */ - - rtw_ap_set_group_key(padapter, param->u.crypt.key, psecuritypriv->dot118021XGrpPrivacy, param->u.crypt.idx); - pbcmc_sta = rtw_get_bcmc_stainfo(padapter); if (pbcmc_sta) { + pbcmc_sta->dot11txpn.val = RTW_GET_LE64(param->u.crypt.seq); pbcmc_sta->ieee8021x_blocked = _FALSE; pbcmc_sta->dot118021XPrivacy = psecuritypriv->dot118021XGrpPrivacy; /* rx will use bmc_sta's dot118021XPrivacy */ } + psecuritypriv->binstallGrpkey = _TRUE; + psecuritypriv->dot11PrivacyAlgrthm = psecuritypriv->dot118021XGrpPrivacy;/* !!! */ + rtw_ap_set_group_key(padapter, param->u.crypt.key, psecuritypriv->dot118021XGrpPrivacy, param->u.crypt.idx); } goto exit; @@ -7734,80 +7062,58 @@ static int rtw_set_encryption(struct net_device *dev, struct ieee_param *param, _rtw_memcpy(psta->dot118021x_UncstKey.skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); if (strcmp(param->u.crypt.alg, "WEP") == 0) { - RTW_INFO("%s, set pairwise key, WEP\n", __FUNCTION__); - + RTW_INFO(FUNC_ADPT_FMT" set WEP PTK of "MAC_FMT" idx:%u, len:%u\n" + , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr) + , param->u.crypt.idx, param->u.crypt.key_len); psta->dot118021XPrivacy = _WEP40_; if (param->u.crypt.key_len == 13) psta->dot118021XPrivacy = _WEP104_; + } else if (strcmp(param->u.crypt.alg, "TKIP") == 0) { - RTW_INFO("%s, set pairwise key, TKIP\n", __FUNCTION__); - + RTW_INFO(FUNC_ADPT_FMT" set TKIP PTK of "MAC_FMT" idx:%u, len:%u\n" + , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr) + , param->u.crypt.idx, param->u.crypt.key_len); psta->dot118021XPrivacy = _TKIP_; - - /* DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len); */ /* set mic key */ _rtw_memcpy(psta->dot11tkiptxmickey.skey, &(param->u.crypt.key[16]), 8); _rtw_memcpy(psta->dot11tkiprxmickey.skey, &(param->u.crypt.key[24]), 8); - psecuritypriv->busetkipkey = _TRUE; } else if (strcmp(param->u.crypt.alg, "CCMP") == 0) { - - RTW_INFO("%s, set pairwise key, CCMP\n", __FUNCTION__); - + RTW_INFO(FUNC_ADPT_FMT" set CCMP PTK of "MAC_FMT" idx:%u, len:%u\n" + , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr) + , param->u.crypt.idx, param->u.crypt.key_len); psta->dot118021XPrivacy = _AES_; - } else { - RTW_INFO("%s, set pairwise key, none\n", __FUNCTION__); + } else if (strcmp(param->u.crypt.alg, "none") == 0) { + RTW_INFO(FUNC_ADPT_FMT" clear pairwise key of "MAC_FMT" idx:%u\n" + , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr) + , param->u.crypt.idx); psta->dot118021XPrivacy = _NO_PRIVACY_; + + } else { + RTW_WARN(FUNC_ADPT_FMT" set pairwise key of "MAC_FMT", not support\n" + , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr)); + goto exit; + } + + psta->dot11txpn.val = RTW_GET_LE64(param->u.crypt.seq); + psta->dot11rxpn.val = RTW_GET_LE64(param->u.crypt.seq); + psta->ieee8021x_blocked = _FALSE; + + if (psta->dot118021XPrivacy != _NO_PRIVACY_) { + psta->bpairwise_key_installed = _TRUE; + + /* WPA2 key-handshake has completed */ + if (psecuritypriv->ndisauthtype == Ndis802_11AuthModeWPA2PSK) + psta->state &= (~WIFI_UNDER_KEY_HANDSHAKE); } rtw_ap_set_pairwise_key(padapter, psta); - - psta->ieee8021x_blocked = _FALSE; - - psta->bpairwise_key_installed = _TRUE; - - } else { /* group key??? */ - if (strcmp(param->u.crypt.alg, "WEP") == 0) { - _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); - - psecuritypriv->dot118021XGrpPrivacy = _WEP40_; - if (param->u.crypt.key_len == 13) - psecuritypriv->dot118021XGrpPrivacy = _WEP104_; - } else if (strcmp(param->u.crypt.alg, "TKIP") == 0) { - psecuritypriv->dot118021XGrpPrivacy = _TKIP_; - - _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); - - /* DEBUG_ERR("set key length :param->u.crypt.key_len=%d\n", param->u.crypt.key_len); */ - /* set mic key */ - _rtw_memcpy(psecuritypriv->dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8); - _rtw_memcpy(psecuritypriv->dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8); - - psecuritypriv->busetkipkey = _TRUE; - - } else if (strcmp(param->u.crypt.alg, "CCMP") == 0) { - psecuritypriv->dot118021XGrpPrivacy = _AES_; - - _rtw_memcpy(psecuritypriv->dot118021XGrpKey[param->u.crypt.idx].skey, param->u.crypt.key, (param->u.crypt.key_len > 16 ? 16 : param->u.crypt.key_len)); - } else - psecuritypriv->dot118021XGrpPrivacy = _NO_PRIVACY_; - - psecuritypriv->dot118021XGrpKeyid = param->u.crypt.idx; - - psecuritypriv->binstallGrpkey = _TRUE; - - psecuritypriv->dot11PrivacyAlgrthm = psecuritypriv->dot118021XGrpPrivacy;/* !!! */ - - rtw_ap_set_group_key(padapter, param->u.crypt.key, psecuritypriv->dot118021XGrpPrivacy, param->u.crypt.idx); - - pbcmc_sta = rtw_get_bcmc_stainfo(padapter); - if (pbcmc_sta) { - pbcmc_sta->ieee8021x_blocked = _FALSE; - pbcmc_sta->dot118021XPrivacy = psecuritypriv->dot118021XGrpPrivacy; /* rx will use bmc_sta's dot118021XPrivacy */ - } - + } else { + RTW_WARN(FUNC_ADPT_FMT" set group key of "MAC_FMT", not support\n" + , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr)); + goto exit; } } @@ -7865,16 +7171,15 @@ 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; } static int rtw_add_sta(struct net_device *dev, struct ieee_param *param) { - _irqL irqL; int ret = 0; struct sta_info *psta = NULL; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); @@ -7909,7 +7214,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); @@ -7926,7 +7231,9 @@ static int rtw_add_sta(struct net_device *dev, struct ieee_param *param) #ifdef CONFIG_80211N_HT /* chec 802.11n ht cap. */ - if (WLAN_STA_HT & flags) { + if (padapter->registrypriv.ht_enable && + is_supported_ht(padapter->registrypriv.wireless_mode) && + (WLAN_STA_HT & flags)) { psta->htpriv.ht_option = _TRUE; psta->qos_option = 1; _rtw_memcpy((void *)&psta->htpriv.ht_cap, (void *)¶m->u.add_sta.ht_cap, sizeof(struct rtw_ieee80211_ht_cap)); @@ -7935,6 +7242,7 @@ static int rtw_add_sta(struct net_device *dev, struct ieee_param *param) if (pmlmepriv->htpriv.ht_option == _FALSE) psta->htpriv.ht_option = _FALSE; + #endif @@ -7971,7 +7279,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) { @@ -8036,7 +7344,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; @@ -8059,7 +7367,8 @@ static int rtw_ioctl_get_sta_data(struct net_device *dev, struct ieee_param *par psta_data->tx_supp_rates_len = psta->bssratelen; _rtw_memcpy(psta_data->tx_supp_rates, psta->bssrateset, psta->bssratelen); #ifdef CONFIG_80211N_HT - _rtw_memcpy(&psta_data->ht_cap, &psta->htpriv.ht_cap, sizeof(struct rtw_ieee80211_ht_cap)); + if(padapter->registrypriv.ht_enable && is_supported_ht(padapter->registrypriv.wireless_mode)) + _rtw_memcpy(&psta_data->ht_cap, &psta->htpriv.ht_cap, sizeof(struct rtw_ieee80211_ht_cap)); #endif /* CONFIG_80211N_HT */ psta_data->rx_pkts = psta->sta_stats.rx_data_pkts; psta_data->rx_bytes = psta->sta_stats.rx_bytes; @@ -8126,7 +7435,6 @@ static int rtw_set_wps_beacon(struct net_device *dev, struct ieee_param *param, _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); int ie_len; RTW_INFO("%s, len=%d\n", __FUNCTION__, len); @@ -8303,7 +7611,7 @@ static int rtw_ioctl_acl_remove_sta(struct net_device *dev, struct ieee_param *p param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) return -EINVAL; - ret = rtw_acl_remove_sta(padapter, param->sta_addr); + ret = rtw_acl_remove_sta(padapter, RTW_ACL_PERIOD_BSS, param->sta_addr); return ret; @@ -8323,7 +7631,7 @@ static int rtw_ioctl_acl_add_sta(struct net_device *dev, struct ieee_param *para param->sta_addr[4] == 0xff && param->sta_addr[5] == 0xff) return -EINVAL; - ret = rtw_acl_add_sta(padapter, param->sta_addr); + ret = rtw_acl_add_sta(padapter, RTW_ACL_PERIOD_BSS, param->sta_addr); return ret; @@ -8338,7 +7646,7 @@ static int rtw_ioctl_set_macaddr_acl(struct net_device *dev, struct ieee_param * if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) return -EINVAL; - rtw_set_macaddr_acl(padapter, param->u.mlme.command); + rtw_set_macaddr_acl(padapter, RTW_ACL_PERIOD_BSS, param->u.mlme.command); return ret; } @@ -8495,7 +7803,9 @@ static int rtw_wx_set_priv(struct net_device *dev, int ret = 0; int len = 0; char *ext; +#ifdef CONFIG_ANDROID int i; +#endif _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); struct iw_point *dwrq = (struct iw_point *)awrq; @@ -8660,13 +7970,14 @@ 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); if (!check_fwstate(pmlmepriv, _FW_LINKED) && - check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { + check_fwstate(pmlmepriv, WIFI_STATION_STATE) && + !WOWLAN_IS_STA_MIX_MODE(padapter)) { #ifdef CONFIG_PNO_SUPPORT pwrctrlpriv->wowlan_pno_enable = _TRUE; #else @@ -8703,7 +8014,6 @@ static int rtw_wowlan_ctrl(struct net_device *dev, RTW_INFO("-rtw_wowlan_ctrl( subcode = %d)\n", poidparam.subcode); RTW_PRINT("%s in %d ms\n", __func__, rtw_get_passing_time_ms(start_time)); -_rtw_wowlan_ctrl_exit: return ret; } @@ -8731,7 +8041,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; @@ -8802,7 +8112,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); @@ -8853,13 +8163,65 @@ 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 + } else if (_rtw_memcmp(extra, "lps_level=", 10)) { + if (sscanf(extra + 10, "%u", &mode) > 0) + ret = rtw_pm_set_lps_level(padapter, mode); + } +#ifdef CONFIG_WOWLAN + else if (_rtw_memcmp(extra, "wow_lps=", 8)) { + sscanf(extra + 8, "%u", &mode); + ret = rtw_pm_set_wow_lps(padapter, mode); + } else if (_rtw_memcmp(extra, "wow_lps_level=", 14)) { + if (sscanf(extra + 14, "%u", &mode) > 0) + ret = rtw_pm_set_wow_lps_level(padapter, mode); + } +#endif /* CONFIG_WOWLAN */ + else ret = -EINVAL; return ret; } #ifdef CONFIG_APPEND_VENDOR_IE_ENABLE +int rtw_vendor_ie_get_raw_data(struct net_device *dev, u32 vendor_ie_num, + char *extra, u32 length) +{ + 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; @@ -8883,6 +8245,12 @@ int rtw_vendor_ie_get_data(struct net_device *dev, int vendor_ie_num, char *extr pstring += sprintf(pstring , "[Assoc Req]"); if (vendor_ie_mask & WIFI_ASSOCRESP_VENDOR_IE_BIT) pstring += sprintf(pstring , "[Assoc Resp]"); +#ifdef CONFIG_P2P + if (vendor_ie_mask & WIFI_P2P_PROBEREQ_VENDOR_IE_BIT) + pstring += sprintf(pstring , "[P2P_Probe Req]"); + if (vendor_ie_mask & WIFI_P2P_PROBERESP_VENDOR_IE_BIT) + pstring += sprintf(pstring , "[P2P_Probe Resp]"); +#endif pstring += sprintf(pstring , "\nVendor IE:\n"); for (j = 0 ; j < pmlmepriv->vendor_ielen[vendor_ie_num] ; j++) @@ -8933,6 +8301,7 @@ int rtw_vendor_ie_set(struct net_device *dev, struct iw_request_info *info, unio struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); u32 vendor_ie_mask = 0; u32 vendor_ie_num = 0; + u32 vendor_ie_mask_max = BIT(WLAN_MAX_VENDOR_IE_MASK_MAX) - 1; u32 id, elen; ret = sscanf(extra, "%d,%x,%*s", &vendor_ie_num , &vendor_ie_mask); @@ -8941,10 +8310,10 @@ int rtw_vendor_ie_set(struct net_device *dev, struct iw_request_info *info, unio else return -EINVAL; totoal_ie_len = strlen(extra); - RTW_INFO("[%s] vendor_ie_num = %d , vendor_ie_mask = %x , vendor_ie = %s , len = %d\n", __func__ , vendor_ie_num , vendor_ie_mask , extra , totoal_ie_len); + RTW_INFO("[%s] vendor_ie_num = %d , vendor_ie_mask = 0x%x , vendor_ie = %s , len = %d\n", __func__ , vendor_ie_num , vendor_ie_mask , extra , totoal_ie_len); if (vendor_ie_num > WLAN_MAX_VENDOR_IE_NUM - 1) { - RTW_INFO("[%s] only support %d vendor ie\n", __func__ , WLAN_MAX_VENDOR_IE_NUM); + RTW_INFO("[%s] Fail, only support %d vendor ie\n", __func__ , WLAN_MAX_VENDOR_IE_NUM); return -EFAULT; } @@ -8953,6 +8322,11 @@ int rtw_vendor_ie_set(struct net_device *dev, struct iw_request_info *info, unio return -EFAULT; } + if (vendor_ie_mask > vendor_ie_mask_max) { + RTW_INFO("[%s] Fail, not support vendor_ie_mask more than 0x%x\n", __func__ , vendor_ie_mask_max); + return -EFAULT; + } + if (vendor_ie_mask == 0) { RTW_INFO("[%s] Clear vendor_ie_num %d group\n", __func__ , vendor_ie_num); goto _clear_path; @@ -8994,11 +8368,17 @@ int rtw_vendor_ie_set(struct net_device *dev, struct iw_request_info *info, unio if (vendor_ie_mask & WIFI_PROBEREQ_VENDOR_IE_BIT) RTW_INFO("[%s] Probe Req append vendor ie\n", __func__); if (vendor_ie_mask & WIFI_PROBERESP_VENDOR_IE_BIT) - RTW_INFO("[%s] Probe Resp append vendor ie\n", __func__); + RTW_INFO("[%s] Probe Resp append vendor ie\n", __func__); if (vendor_ie_mask & WIFI_ASSOCREQ_VENDOR_IE_BIT) RTW_INFO("[%s] Assoc Req append vendor ie\n", __func__); if (vendor_ie_mask & WIFI_ASSOCRESP_VENDOR_IE_BIT) RTW_INFO("[%s] Assoc Resp append vendor ie\n", __func__); +#ifdef CONFIG_P2P + if (vendor_ie_mask & WIFI_P2P_PROBEREQ_VENDOR_IE_BIT) + RTW_INFO("[%s] P2P Probe Req append vendor ie\n", __func__); + if (vendor_ie_mask & WIFI_P2P_PROBERESP_VENDOR_IE_BIT) + RTW_INFO("[%s] P2P Probe Resp append vendor ie\n", __func__); +#endif pmlmepriv->vendor_ie_mask[vendor_ie_num] = vendor_ie_mask; @@ -9022,7 +8402,6 @@ static int rtw_mp_efuse_get(struct net_device *dev, PEFUSE_HAL pEfuseHal; struct iw_point *wrqu; - u8 *PROMContent = pHalData->efuse_eeprom_data; u8 ips_mode = IPS_NUM; /* init invalid value */ u8 lps_mode = PS_MODE_NUM; /* init invalid value */ struct pwrctrl_priv *pwrctrlpriv ; @@ -9034,6 +8413,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 @@ -9058,6 +8438,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); @@ -9110,16 +8493,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; @@ -9160,16 +8544,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], "rmap") == 0) { if ((tmp[1] == NULL) || (tmp[2] == NULL)) { RTW_INFO("%s: rmap Fail!! Parameters error!\n", __FUNCTION__); @@ -9189,7 +8574,7 @@ static int rtw_mp_efuse_get(struct net_device *dev, } RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts); - EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN , (PVOID)&max_available_len, _FALSE); + EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN , (void *)&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 = -EINVAL; @@ -9204,9 +8589,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("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) { @@ -9215,7 +8601,7 @@ static int rtw_mp_efuse_get(struct net_device *dev, 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); + EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_REAL_CONTENT_LEN , (void *)&mapLen, _FALSE); RTW_INFO("Real content len = %d\n",mapLen ); if (rtw_efuse_access(padapter, _FALSE, addr, mapLen, rawdata) == _FAIL) { @@ -9237,16 +8623,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, rawdata[i + j]); - sprintf(extra, "%s\t", extra); + pextra += sprintf(pextra, "%02X ", rawdata[i + j]); + pextra += sprintf(pextra, "\t"); for (; j < 16; j++) - sprintf(extra, "%s%02X ", extra, rawdata[i + j]); - sprintf(extra, "%s\n", extra); + pextra += sprintf(pextra, "%02X ", rawdata[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], "btrealraw") == 0) { static u8 bt_raw_order = 0; @@ -9254,7 +8641,7 @@ static int rtw_mp_efuse_get(struct net_device *dev, u32 blksz = 0x200; /* The size of one time show, default 512 */ addr = 0; - EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_EFUSE_REAL_CONTENT_LEN, (PVOID)&mapLen, _FALSE); + EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_EFUSE_REAL_CONTENT_LEN, (void *)&mapLen, _FALSE); RTW_INFO("Real content len = %d\n", mapLen); #ifdef RTW_HALMAC if (rtw_efuse_bt_access(padapter, _FALSE, 0, mapLen, rawdata) == _FAIL) { @@ -9284,16 +8671,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, rawdata[i + j]); - sprintf(extra, "%s\t", extra); + pextra += sprintf(pextra, "%02X ", rawdata[i + j]); + pextra += sprintf(pextra, "\t"); for (; j < 16; j++) - sprintf(extra, "%s%02X ", extra, rawdata[i + j]); - sprintf(extra, "%s\n", extra); + pextra += sprintf(pextra, "%02X ", rawdata[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], "mac") == 0) { if (hal_efuse_macaddr_offset(padapter) == -1) { @@ -9304,7 +8692,7 @@ static int rtw_mp_efuse_get(struct net_device *dev, addr = hal_efuse_macaddr_offset(padapter); cnts = 6; - EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&max_available_len, _FALSE); + EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (void *)&max_available_len, _FALSE); if ((addr + cnts) > max_available_len) { RTW_INFO("%s: addr(0x%02x)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); err = -EFAULT; @@ -9319,12 +8707,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"); */ @@ -9354,6 +8743,10 @@ static int rtw_mp_efuse_get(struct net_device *dev, addr = EEPROM_VID_8188FU; #endif /* CONFIG_RTL8188F */ +#ifdef CONFIG_RTL8188GTV + addr = EEPROM_VID_8188GTVU; +#endif + #ifdef CONFIG_RTL8703B #ifdef CONFIG_USB_HCI addr = EEPROM_VID_8703BU; @@ -9368,7 +8761,7 @@ static int rtw_mp_efuse_get(struct net_device *dev, cnts = 4; - EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&max_available_len, _FALSE); + EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (void *)&max_available_len, _FALSE); if ((addr + cnts) > max_available_len) { RTW_INFO("%s: addr(0x%02x)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); err = -EFAULT; @@ -9382,12 +8775,13 @@ 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"); */ @@ -9418,19 +8812,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) { @@ -9447,19 +8842,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 ", 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) { @@ -9493,7 +8889,7 @@ static int rtw_mp_efuse_get(struct net_device *dev, } 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); + EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_EFUSE_MAP_LEN, (void *)&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; @@ -9507,10 +8903,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); @@ -9519,19 +8916,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) { @@ -9539,19 +8937,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) { @@ -9574,16 +8973,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)) { @@ -9605,9 +9005,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)) { @@ -9629,9 +9030,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; @@ -9642,8 +9044,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!"); @@ -9672,6 +9075,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) @@ -9695,6 +9100,8 @@ static int rtw_mp_efuse_set(struct net_device *dev, u16 addr = 0xFF, cnts = 0, BTStatus = 0 , max_available_len = 0; u16 wifimaplen; int err; + boolean bcmpchk = _TRUE; + wrqu = (struct iw_point *)wdata; padapter = rtw_netdev_priv(dev); @@ -9709,6 +9116,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); @@ -9794,7 +9203,7 @@ 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]); - EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&max_available_len, _FALSE); + EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (void *)&max_available_len, _FALSE); if ((addr + cnts) > max_available_len) { RTW_INFO("%s: addr(0x%X)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); @@ -9933,7 +9342,7 @@ 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[1][kk], tmp[1][kk + 1]); - EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&max_available_len, _FALSE); + EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (void *)&max_available_len, _FALSE); if ((addr + cnts) > max_available_len) { RTW_INFO("%s: addr(0x%X)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); @@ -9979,6 +9388,10 @@ static int rtw_mp_efuse_set(struct net_device *dev, addr = EEPROM_VID_8188FU; #endif +#ifdef CONFIG_RTL8188GTV + addr = EEPROM_VID_8188GTVU; +#endif + #ifdef CONFIG_RTL8703B #ifdef CONFIG_USB_HCI addr = EEPROM_VID_8703BU; @@ -10009,7 +9422,7 @@ 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[1][kk], tmp[1][kk + 1]); - EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&max_available_len, _FALSE); + EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (void *)&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; @@ -10079,23 +9492,8 @@ 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); + EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_EFUSE_MAP_LEN, (void *)&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; @@ -10127,7 +9525,12 @@ static int rtw_mp_efuse_set(struct net_device *dev, err = -EINVAL; goto exit; } - + if (pmp_priv->bprocess_mp_mode != _TRUE) { + RTW_INFO("%s: btwfake not to be exec, please first to mp_start\n", __FUNCTION__); + sprintf(extra, "Error, btwfake cant to be exec, please first to mp_start !!!!\n"); + err = 0; + goto exit; + } addr = simple_strtoul(tmp[1], &ptmp, 16); addr &= 0xFFF; @@ -10163,6 +9566,12 @@ static int rtw_mp_efuse_set(struct net_device *dev, sprintf(extra, "BT Status not Active Write FAIL\n"); goto exit; } + if (pmp_priv->bprocess_mp_mode != _TRUE) { + RTW_INFO("%s: btfk2map not to be exec, please first to mp_start\n", __FUNCTION__); + sprintf(extra, "Error, btfk2map cant to be exec, please first to mp_start !!!!\n"); + err = 0; + goto exit; + } #ifndef RTW_HALMAC BTEfuse_PowerSwitch(padapter, 1, _TRUE); addr = 0x1ff; @@ -10234,11 +9643,18 @@ static int rtw_mp_efuse_set(struct net_device *dev, if (padapter->registrypriv.bFileMaskEfuse != _TRUE && pmp_priv->bloadefusemap == _TRUE) { RTW_INFO("%s: File eFuse mask file not to be loaded\n", __FUNCTION__); - sprintf(extra, "Not load eFuse mask file yet, Please use the efuse_mask CMD.\n"); + sprintf(extra, "Not load eFuse mask file yet, Please use the efuse_mask CMD, now remove the interface !!!!\n"); + rtw_set_surprise_removed(padapter); err = 0; goto exit; } + if (pmp_priv->bprocess_mp_mode != _TRUE) { + RTW_INFO("%s: wlfk2map not to be exec, please first to mp_start\n", __FUNCTION__); + sprintf(extra, "Error, wlfk2map cant to be exec, please first to mp_start !!!!\n"); + err = 0; + goto exit; + } if (wifimaplen > EFUSE_MAX_MAP_LEN) cnts = EFUSE_MAX_MAP_LEN; else @@ -10250,24 +9666,53 @@ static int rtw_mp_efuse_set(struct net_device *dev, } if (rtw_efuse_mask_map_read(padapter, 0x00, wifimaplen, ShadowMapWiFi) == _SUCCESS) { - if (_rtw_memcmp((void *)ShadowMapWiFi , (void *)pEfuseHal->fakeEfuseModifiedMap, cnts)) { - RTW_INFO("%s: WiFi write map afterf compare OK\n", __FUNCTION__); - sprintf(extra, "WiFi write map compare OK\n"); - err = 0; - goto exit; - } else { - sprintf(extra, "WiFi write map compare FAIL\n"); - RTW_INFO("%s: WiFi write map compare Fail\n", __FUNCTION__); - err = 0; - goto exit; + addr = 0x00; + err = _TRUE; + + for (i = 0; i < cnts; i++) { + if (padapter->registrypriv.boffefusemask == 0) { + if (padapter->registrypriv.bFileMaskEfuse == _TRUE) { + if (rtw_file_efuse_IsMasked(padapter, addr + i) == _TRUE) /*use file efuse mask. */ + bcmpchk = _FALSE; + } else { + if (efuse_IsMasked(padapter, addr + i) == _TRUE) + bcmpchk = _FALSE; + } + } + + if (bcmpchk == _TRUE) { + RTW_INFO("compare readMapWiFi[0x%02x] = %x, ModifiedMap = %x\n", addr + i, ShadowMapWiFi[ addr + i], pEfuseHal->fakeEfuseModifiedMap[addr + i]); + if (_rtw_memcmp((void *) &ShadowMapWiFi[addr + i], (void *)&pEfuseHal->fakeEfuseModifiedMap[addr + i], 1) == _FALSE){ + err = _FALSE; + break; + } + } + bcmpchk = _TRUE; } } + + if (err) { + RTW_INFO("%s: WiFi write map afterf compare OK\n", __FUNCTION__); + sprintf(extra, "WiFi write map compare OK\n"); + err = 0; + goto exit; + } else { + sprintf(extra, "WiFi write map compare FAIL\n"); + RTW_INFO("%s: WiFi write map compare Fail\n", __FUNCTION__); + err = 0; + goto exit; + } } else if (strcmp(tmp[0], "wlwfake") == 0) { if ((tmp[1] == NULL) || (tmp[2] == NULL)) { err = -EINVAL; goto exit; } - + if (pmp_priv->bprocess_mp_mode != _TRUE) { + RTW_INFO("%s: wlwfake not to be exec, please first to mp_start\n", __FUNCTION__); + sprintf(extra, "Error, wlwfake cant to be exec, please first to mp_start !!!!\n"); + err = 0; + goto exit; + } addr = simple_strtoul(tmp[1], &ptmp, 16); addr &= 0xFFF; @@ -10297,6 +9742,12 @@ static int rtw_mp_efuse_set(struct net_device *dev, err = -EINVAL; goto exit; } + if (pmp_priv->bprocess_mp_mode != _TRUE) { + RTW_INFO("%s: wfakemac not to be exec, please first to mp_start\n", __FUNCTION__); + sprintf(extra, "Error, wfakemac cant to be exec, please first to mp_start !!!!\n"); + err = 0; + goto exit; + } /* wfakemac,00e04c871200 */ if (hal_efuse_macaddr_offset(padapter) == -1) { err = -EFAULT; @@ -10352,8 +9803,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); @@ -10379,8 +9834,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, @@ -10403,7 +9856,7 @@ static int rtw_mp_customer_str( || !adapter->registrypriv.mp_customer_str) return -EFAULT; - len = wrqu->data.length; + len = wrqu->data.length + 1; pbuf = (u8 *)rtw_zmalloc(len); if (pbuf == NULL) { @@ -10411,7 +9864,7 @@ static int rtw_mp_customer_str( return -ENOMEM; } - if (copy_from_user(pbuf, wrqu->data.pointer, len)) { + if (copy_from_user(pbuf, wrqu->data.pointer, wrqu->data.length)) { rtw_mfree(pbuf, len); RTW_WARN("%s: copy from user fail!\n", __func__); return -EFAULT; @@ -10474,7 +9927,6 @@ static int rtw_mp_customer_str( wrqu->data.length = strlen(extra) + 1; -free_buf: rtw_mfree(pbuf, len); return 0; } @@ -10487,30 +9939,43 @@ 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); + int status = 0; +#ifdef CONFIG_CONCURRENT_MODE + if (!is_primary_adapter(padapter)) { + RTW_INFO("MP mode only primary Adapter support\n"); + return -EIO; + } +#endif + + RTW_INFO("%s mutx in %d\n", __func__, subcmd); + _enter_critical_mutex(&(adapter_to_dvobj(padapter)->ioctrl_mutex), NULL); switch (subcmd) { case CTA_TEST: RTW_INFO("set CTA_TEST\n"); - rtw_cta_test_start(dev, info, wdata, extra); + status = rtw_cta_test_start(dev, info, wdata, extra); break; case MP_DISABLE_BT_COEXIST: RTW_INFO("set case MP_DISABLE_BT_COEXIST\n"); - rtw_mp_disable_bt_coexist(dev, info, wdata, extra); + status = rtw_mp_disable_bt_coexist(dev, info, wdata, extra); break; case MP_IQK: RTW_INFO("set MP_IQK\n"); - rtw_mp_iqk(dev, info, wrqu, extra); + status = rtw_mp_iqk(dev, info, wrqu, extra); break; case MP_LCK: RTW_INFO("set MP_LCK\n"); - rtw_mp_lck(dev, info, wrqu, extra); + status = rtw_mp_lck(dev, info, wrqu, extra); break; default: - return -EIO; + status = -EIO; } + _exit_critical_mutex(&(adapter_to_dvobj(padapter)->ioctrl_mutex), NULL); + RTW_INFO("%s mutx done %d\n", __func__, subcmd); - return 0; + return status; } static int rtw_priv_mp_get(struct net_device *dev, @@ -10520,152 +9985,200 @@ 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); + int status = 0; + +#ifdef CONFIG_CONCURRENT_MODE + if (!is_primary_adapter(padapter)) { + RTW_INFO("MP mode only primary Adapter support\n"); + return -EIO; + } +#endif + + RTW_INFO("%s mutx in %d\n", __func__, subcmd); + _enter_critical_mutex(&(adapter_to_dvobj(padapter)->ioctrl_mutex), NULL); switch (subcmd) { case MP_START: RTW_INFO("set case mp_start\n"); - rtw_mp_start(dev, info, wrqu, extra); + status = rtw_mp_start(dev, info, wrqu, extra); break; case MP_STOP: RTW_INFO("set case mp_stop\n"); - rtw_mp_stop(dev, info, wrqu, extra); + status = rtw_mp_stop(dev, info, wrqu, extra); break; case MP_BANDWIDTH: RTW_INFO("set case mp_bandwidth\n"); - rtw_mp_bandwidth(dev, info, wrqu, extra); + status = rtw_mp_bandwidth(dev, info, wrqu, extra); break; case MP_RESET_STATS: RTW_INFO("set case MP_RESET_STATS\n"); - rtw_mp_reset_stats(dev, info, wrqu, extra); + status = rtw_mp_reset_stats(dev, info, wrqu, extra); break; case MP_SetRFPathSwh: RTW_INFO("set MP_SetRFPathSwitch\n"); - rtw_mp_SetRFPath(dev, info, wrqu, extra); + status = rtw_mp_SetRFPath(dev, info, wrqu, extra); break; case WRITE_REG: - rtw_mp_write_reg(dev, info, wrqu, extra); + status = rtw_mp_write_reg(dev, info, wrqu, extra); break; case WRITE_RF: - rtw_mp_write_rf(dev, info, wrqu, extra); + status = rtw_mp_write_rf(dev, info, wrqu, extra); break; case MP_PHYPARA: RTW_INFO("mp_get MP_PHYPARA\n"); - rtw_mp_phypara(dev, info, wrqu, extra); + status = rtw_mp_phypara(dev, info, wrqu, extra); break; case MP_CHANNEL: RTW_INFO("set case mp_channel\n"); - rtw_mp_channel(dev , info, wrqu, extra); + status = rtw_mp_channel(dev , info, wrqu, extra); + break; + case MP_CHL_OFFSET: + RTW_INFO("set case mp_ch_offset\n"); + status = rtw_mp_ch_offset(dev , info, wrqu, extra); break; case READ_REG: RTW_INFO("mp_get READ_REG\n"); - rtw_mp_read_reg(dev, info, wrqu, extra); + status = rtw_mp_read_reg(dev, info, wrqu, extra); break; case READ_RF: RTW_INFO("mp_get READ_RF\n"); - rtw_mp_read_rf(dev, info, wrqu, extra); + status = rtw_mp_read_rf(dev, info, wrqu, extra); break; case MP_RATE: RTW_INFO("set case mp_rate\n"); - rtw_mp_rate(dev, info, wrqu, extra); + status = rtw_mp_rate(dev, info, wrqu, extra); break; case MP_TXPOWER: RTW_INFO("set case MP_TXPOWER\n"); - rtw_mp_txpower(dev, info, wrqu, extra); + status = rtw_mp_txpower(dev, info, wrqu, extra); break; case MP_ANT_TX: RTW_INFO("set case MP_ANT_TX\n"); - rtw_mp_ant_tx(dev, info, wrqu, extra); + status = rtw_mp_ant_tx(dev, info, wrqu, extra); break; case MP_ANT_RX: RTW_INFO("set case MP_ANT_RX\n"); - rtw_mp_ant_rx(dev, info, wrqu, extra); + status = rtw_mp_ant_rx(dev, info, wrqu, extra); break; case MP_QUERY: - rtw_mp_trx_query(dev, info, wrqu, extra); + status = rtw_mp_trx_query(dev, info, wrqu, extra); break; case MP_CTX: RTW_INFO("set case MP_CTX\n"); - rtw_mp_ctx(dev, info, wrqu, extra); + status = rtw_mp_ctx(dev, info, wrqu, extra); break; case MP_ARX: RTW_INFO("set case MP_ARX\n"); - rtw_mp_arx(dev, info, wrqu, extra); + status = rtw_mp_arx(dev, info, wrqu, extra); break; case MP_DUMP: RTW_INFO("set case MP_DUMP\n"); - rtw_mp_dump(dev, info, wrqu, extra); + status = rtw_mp_dump(dev, info, wrqu, extra); break; case MP_PSD: RTW_INFO("set case MP_PSD\n"); - rtw_mp_psd(dev, info, wrqu, extra); + status = rtw_mp_psd(dev, info, wrqu, extra); break; case MP_THER: RTW_INFO("set case MP_THER\n"); - rtw_mp_thermal(dev, info, wrqu, extra); + status = rtw_mp_thermal(dev, info, wrqu, extra); break; case MP_PwrCtlDM: RTW_INFO("set MP_PwrCtlDM\n"); - rtw_mp_PwrCtlDM(dev, info, wrqu, extra); + status = rtw_mp_PwrCtlDM(dev, info, wrqu, extra); break; case MP_QueryDrvStats: RTW_INFO("mp_get MP_QueryDrvStats\n"); - rtw_mp_QueryDrv(dev, info, wdata, extra); + status = rtw_mp_QueryDrv(dev, info, wdata, extra); break; case MP_PWRTRK: RTW_INFO("set case MP_PWRTRK\n"); - rtw_mp_pwrtrk(dev, info, wrqu, extra); + status = 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); + status = 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); + status = rtw_mp_efuse_get(dev, info, wdata, extra); break; case MP_GET_TXPOWER_INX: RTW_INFO("mp_get MP_GET_TXPOWER_INX\n"); - rtw_mp_txpower_index(dev, info, wrqu, extra); + status = rtw_mp_txpower_index(dev, info, wrqu, extra); break; case MP_GETVER: RTW_INFO("mp_get MP_GETVER\n"); - rtw_mp_getver(dev, info, wdata, extra); + status = rtw_mp_getver(dev, info, wdata, extra); break; case MP_MON: RTW_INFO("mp_get MP_MON\n"); - rtw_mp_mon(dev, info, wdata, extra); + status = rtw_mp_mon(dev, info, wdata, extra); break; case EFUSE_MASK: RTW_INFO("mp_get EFUSE_MASK\n"); - rtw_efuse_mask_file(dev, info, wdata, extra); + status = rtw_efuse_mask_file(dev, info, wdata, extra); break; case EFUSE_FILE: RTW_INFO("mp_get EFUSE_FILE\n"); - rtw_efuse_file_map(dev, info, wdata, extra); + status = rtw_efuse_file_map(dev, info, wdata, extra); break; case MP_TX: RTW_INFO("mp_get MP_TX\n"); - rtw_mp_tx(dev, info, wdata, extra); + status = rtw_mp_tx(dev, info, wdata, extra); break; case MP_RX: RTW_INFO("mp_get MP_RX\n"); - rtw_mp_rx(dev, info, wdata, extra); + status = rtw_mp_rx(dev, info, wdata, extra); break; case MP_HW_TX_MODE: RTW_INFO("mp_get MP_HW_TX_MODE\n"); - rtw_mp_hwtx(dev, info, wdata, extra); + status = rtw_mp_hwtx(dev, info, wdata, extra); break; #ifdef CONFIG_RTW_CUSTOMER_STR case MP_CUSTOMER_STR: RTW_INFO("customer str\n"); - rtw_mp_customer_str(dev, info, wdata, extra); + status = rtw_mp_customer_str(dev, info, wdata, extra); break; #endif + case MP_PWRLMT: + RTW_INFO("mp_get MP_SETPWRLMT\n"); + status = rtw_mp_pwrlmt(dev, info, wdata, extra); + break; + case MP_PWRBYRATE: + RTW_INFO("mp_get MP_SETPWRBYRATE\n"); + status = rtw_mp_pwrbyrate(dev, info, wdata, extra); + break; + case BT_EFUSE_FILE: + RTW_INFO("mp_get BT EFUSE_FILE\n"); + status = rtw_bt_efuse_file_map(dev, info, wdata, extra); + break; + case MP_SWRFPath: + RTW_INFO("mp_get MP_SWRFPath\n"); + status = rtw_mp_switch_rf_path(dev, info, wrqu, extra); + break; + case MP_LINK: + RTW_INFO("mp_get MP_LINK\n"); + status = rtw_mp_link(dev, info, wrqu, extra); + break; + case MP_DPK_TRK: + RTW_INFO("mp_get MP_DPK_TRK\n"); + status = rtw_mp_dpk_track(dev, info, wdata, extra); + break; + case MP_DPK: + RTW_INFO("set MP_DPK\n"); + status = rtw_mp_dpk(dev, info, wdata, extra); default: - return -EIO; + status = -EIO; } - return 0; + _exit_critical_mutex(&(adapter_to_dvobj(padapter)->ioctrl_mutex), NULL); + RTW_INFO("%s mutx done_%d\n", __func__, subcmd); + + return status; } #endif /*#if defined(CONFIG_MP_INCLUDED)*/ @@ -10899,7 +10412,7 @@ static int rtw_priv_get(struct net_device *dev, if (subcmd < MP_NULL) { #ifdef CONFIG_MP_INCLUDED rtw_priv_mp_get(dev, info, wdata, extra); -#endif +#endif return 0; } @@ -10933,14 +10446,13 @@ static int rtw_priv_get(struct net_device *dev, } - +#ifdef CONFIG_TDLS static int rtw_wx_tdls_wfd_enable(struct net_device *dev, struct iw_request_info *info, union iwreq_data *wrqu, char *extra) { int ret = 0; -#ifdef CONFIG_TDLS #ifdef CONFIG_WFD _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); @@ -10953,7 +10465,6 @@ static int rtw_wx_tdls_wfd_enable(struct net_device *dev, rtw_tdls_wfd_enable(padapter, 1); #endif /* CONFIG_WFD */ -#endif /* CONFIG_TDLS */ return ret; } @@ -10989,57 +10500,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, _TRUE); + else if (extra[0] == '1') + rtw_enable_tdls_func(padapter); #endif /* CONFIG_TDLS */ return ret; @@ -11199,11 +10667,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"); */ @@ -11247,7 +10715,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 | @@ -11371,7 +10839,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 */ @@ -11398,7 +10866,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 */ @@ -11571,7 +11039,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, @@ -11628,8 +11096,8 @@ static int rtw_tdls_getsta(struct net_device *dev, } wrqu->data.length = strlen(extra); -#endif /* CONFIG_TDLS */ exit: +#endif /* CONFIG_TDLS */ return ret; } @@ -11640,49 +11108,49 @@ static int rtw_tdls_get_best_ch(struct net_device *dev, { #ifdef CONFIG_FIND_BEST_CHANNEL _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); 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 } @@ -11701,7 +11169,7 @@ static int rtw_tdls_get_best_ch(struct net_device *dev, return 0; } - +#endif /*#ifdef CONFIG_TDLS*/ static int rtw_tdls(struct net_device *dev, struct iw_request_info *info, union iwreq_data *wrqu, char *extra) @@ -11719,8 +11187,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; } @@ -11820,46 +11288,6 @@ static int rtw_tdls_get(struct net_device *dev, return ret; } - - - - -#ifdef CONFIG_INTEL_WIDI -static int rtw_widi_set(struct net_device *dev, - struct iw_request_info *info, - union iwreq_data *wrqu, char *extra) -{ - int ret = 0; - _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - - process_intel_widi_cmd(padapter, extra); - - return ret; -} - -static int rtw_widi_set_probe_request(struct net_device *dev, - struct iw_request_info *info, - union iwreq_data *wrqu, char *extra) -{ - int ret = 0; - u8 *pbuf = NULL; - _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - - pbuf = rtw_malloc(sizeof(l2_msg_t)); - if (pbuf) { - if (copy_from_user(pbuf, wrqu->data.pointer, wrqu->data.length)) - ret = -EFAULT; - /* _rtw_memcpy(pbuf, wrqu->data.pointer, wrqu->data.length); */ - - if (wrqu->data.flags == 0) - intel_widi_wk_cmd(padapter, INTEL_WIDI_ISSUE_PROB_WK, pbuf, sizeof(l2_msg_t)); - else if (wrqu->data.flags == 1) - rtw_set_wfd_rds_sink_info(padapter, (l2_msg_t *)pbuf); - } - return ret; -} -#endif /* CONFIG_INTEL_WIDI */ - #ifdef CONFIG_MAC_LOOPBACK_DRIVER #if defined(CONFIG_RTL8188E) @@ -11892,6 +11320,11 @@ extern void rtl8723b_fill_default_txdesc(struct xmit_frame *pxmitframe, u8 *pbuf #define fill_default_txdesc rtl8723d_fill_default_txdesc #endif /* CONFIG_RTL8723D */ +#if defined(CONFIG_RTL8710B) +#define cal_txdesc_chksum rtl8710b_cal_txdesc_chksum +#define fill_default_txdesc rtl8710b_fill_default_txdesc +#endif /* CONFIG_RTL8710B */ + #if defined(CONFIG_RTL8192E) extern void rtl8192e_cal_txdesc_chksum(struct tx_desc *ptxdesc); #define cal_txdesc_chksum rtl8192e_cal_txdesc_chksum @@ -11901,6 +11334,13 @@ extern void rtl8192es_fill_default_txdesc(struct xmit_frame *pxmitframe, u8 *pbu #endif /* CONFIG_SDIO_HCI */ #endif /* CONFIG_RTL8192E */ +#if defined(CONFIG_RTL8192F) +/* extern void rtl8192f_cal_txdesc_chksum(struct tx_desc *ptxdesc); */ +#define cal_txdesc_chksum rtl8192f_cal_txdesc_chksum +/* extern void rtl8192f_fill_default_txdesc(struct xmit_frame *pxmitframe, u8 *pbuf); */ +#define fill_default_txdesc rtl8192f_fill_default_txdesc +#endif /* CONFIG_RTL8192F */ + static s32 initLoopback(PADAPTER padapter) { PLOOPBACKDATA ploopback; @@ -11945,7 +11385,7 @@ static s32 initpseudoadhoc(PADAPTER padapter) if (err == _FALSE) return _FAIL; - err = rtw_setopmode_cmd(padapter, networkType, _TRUE); + err = rtw_setopmode_cmd(padapter, networkType, RTW_CMDF_WAIT_ACK); if (err == _FAIL) return _FAIL; @@ -12012,7 +11452,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 */ @@ -12090,14 +11530,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; @@ -12230,7 +11668,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; @@ -12333,8 +11771,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))) { @@ -12351,7 +11788,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) @@ -12412,6 +11850,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; } @@ -12435,17 +11874,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; @@ -12693,13 +12135,20 @@ 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" + }, +#else + {SIOCIWFIRSTPRIV + 0x17, IW_PRIV_TYPE_CHAR | 1024 , 0 , "NULL"}, +#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 { @@ -12707,17 +12156,6 @@ static const struct iw_priv_args rtw_private_args[] = { IW_PRIV_TYPE_CHAR | 40, IW_PRIV_TYPE_CHAR | 0x7FF, "test" }, -#ifdef CONFIG_INTEL_WIDI - { - SIOCIWFIRSTPRIV + 0x1E, - IW_PRIV_TYPE_CHAR | 1024, 0, "widi_set" - }, - { - SIOCIWFIRSTPRIV + 0x1F, - IW_PRIV_TYPE_CHAR | 128, 0, "widi_prob_req" - }, -#endif /* CONFIG_INTEL_WIDI */ - { SIOCIWFIRSTPRIV + 0x0E, IW_PRIV_TYPE_CHAR | 1024, 0 , ""}, /* set */ { SIOCIWFIRSTPRIV + 0x0F, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK , ""},/* get * --- sub-ioctls definitions --- */ @@ -12751,6 +12189,7 @@ static const struct iw_priv_args rtw_mp_private_args[] = { { MP_PHYPARA, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_phypara" }, { MP_STOP , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_stop" }, { MP_CHANNEL , IW_PRIV_TYPE_CHAR | 1024 , IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_channel" }, + { MP_CHL_OFFSET , IW_PRIV_TYPE_CHAR | 1024 , IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_ch_offset" }, { MP_BANDWIDTH , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_bandwidth"}, { MP_RATE , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_rate" }, { MP_RESET_STATS , IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_reset_stats"}, @@ -12783,9 +12222,16 @@ 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" }, + { MP_SWRFPath, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_swrfpath" }, + { MP_LINK, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_link" }, + { MP_DPK, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_dpk"}, + { MP_DPK_TRK, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_dpk_trk" }, #ifdef CONFIG_RTW_CUSTOMER_STR { MP_CUSTOMER_STR, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "customer_str" }, #endif @@ -12796,7 +12242,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 @@ -12833,22 +12279,22 @@ 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 */ #else - rtw_mp_efuse_set, /* 0x1A */ + rtw_wx_priv_null, /* 0x1A */ rtw_mp_efuse_get, /* 0x1B */ #endif NULL, /* 0x1C is reserved for hostapd */ rtw_test, /* 0x1D */ -#ifdef CONFIG_INTEL_WIDI - rtw_widi_set, /* 0x1E */ - rtw_widi_set_probe_request, /* 0x1F */ -#endif /* CONFIG_INTEL_WIDI */ }; #if WIRELESS_EXT >= 17 @@ -12869,22 +12315,18 @@ static struct iw_statistics *rtw_get_wireless_stats(struct net_device *dev) #ifdef CONFIG_SIGNAL_DISPLAY_DBM tmp_level = translate_percentage_to_dbm(padapter->recvpriv.signal_strength); #else -#ifdef CONFIG_SIGNAL_SCALE_MAPPING tmp_level = padapter->recvpriv.signal_strength; -#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); - - tmp_level = (u8)odm_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; @@ -13010,14 +12452,14 @@ static int _rtw_ioctl_wext_private(struct net_device *dev, union iwreq_data *wrq sscanf(ptr, "%16s", cmdname); cmdlen = strlen(cmdname); - RTW_INFO("%s: cmd=%s\n", __func__, cmdname); + RTW_DBG("%s: cmd=%s\n", __func__, cmdname); /* skip command string */ if (cmdlen > 0) cmdlen += 1; /* skip one space */ ptr += cmdlen; len -= cmdlen; - RTW_INFO("%s: parameters=%s\n", __func__, ptr); + RTW_DBG("%s: parameters=%s\n", __func__, ptr); priv = rtw_private_handler; priv_args = rtw_private_args; @@ -13084,6 +12526,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)) { @@ -13305,7 +12752,7 @@ static int rtw_ioctl_compat_wext_private(struct net_device *dev, struct ifreq *r struct compat_iw_point iwp_compat; union iwreq_data wrq_data; int err = 0; - RTW_INFO("%s:...\n", __func__); + RTW_DBG("%s:...\n", __func__); if (copy_from_user(&iwp_compat, rq->ifr_ifru.ifru_data, sizeof(struct compat_iw_point))) return -EFAULT; @@ -13328,11 +12775,10 @@ static int rtw_ioctl_compat_wext_private(struct net_device *dev, struct ifreq *r static int rtw_ioctl_standard_wext_private(struct net_device *dev, struct ifreq *rq) { struct iw_point *iwp; - struct ifreq ifrq; union iwreq_data wrq_data; int err = 0; iwp = &wrq_data.data; - RTW_INFO("%s:...\n", __func__); + RTW_DBG("%s:...\n", __func__); if (copy_from_user(iwp, rq->ifr_ifru.ifru_data, sizeof(struct iw_point))) return -EFAULT; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/ioctl_mp.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/ioctl_mp.c index b7109f9a81d1..3c5c228b31ad 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/ioctl_mp.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/ioctl_mp.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,17 +12,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 - * - * - ******************************************************************************/ + *****************************************************************************/ #if defined(CONFIG_MP_INCLUDED) #include #include -#include #include "../../hal/phydm/phydm_precomp.h" @@ -42,17 +37,21 @@ int rtw_mp_write_reg(struct net_device *dev, struct iw_request_info *info, struct iw_point *wrqu, char *extra) { - char *pch, *pnext, *ptmp; + char *pch, *pnext; char *width_str; - char width, buf[5]; + char width; 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; @@ -73,7 +72,7 @@ int rtw_mp_write_reg(struct net_device *dev, _rtw_memcpy(buf, pch, pnext-pch); ret = kstrtoul(buf, 16, &addr);*/ ret = sscanf(pch, "%x", &addr); - if (addr > 0x3FFF) + if (addr > MP_READ_REG_MAX_OFFSET) return -EINVAL; pch = pnext + 1; @@ -130,22 +129,24 @@ 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 *pch, *pnext, *ptmp; + char input[wrqu->length + 1]; + char *pch, *pnext; char *width_str; char width; - char data[20], tmp[20], buf[3]; + char data[20], tmp[20]; 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)); @@ -159,7 +160,7 @@ int rtw_mp_read_reg(struct net_device *dev, pch = pnext + 1; ret = sscanf(pch, "%x", &addr); - if (addr > 0x3FFF) + if (addr > MP_READ_REG_MAX_OFFSET) return -EINVAL; ret = 0; @@ -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; @@ -305,11 +306,12 @@ int rtw_mp_read_rf(struct net_device *dev, struct iw_point *wrqu, char *extra) { char input[wrqu->length]; - char *pch, *pnext, *ptmp; - char data[20], tmp[20], buf[3]; + char *pch, *pnext; + char data[20], tmp[20]; 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; @@ -365,16 +367,18 @@ int rtw_mp_start(struct net_device *dev, 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->hal_func; + struct mp_priv *pmppriv = &padapter->mppriv; rtw_pm_set_ips(padapter, IPS_NONE); LeaveAllPowerSaveMode(padapter); - if (rtw_mi_check_fwstate(padapter, _FW_UNDER_SURVEY)) - rtw_mi_scan_abort(padapter, _FALSE); + pmppriv->bprocess_mp_mode = _TRUE; + + if (rtw_mi_check_fwstate(padapter, _FW_UNDER_SURVEY)) { + rtw_mi_buddy_set_scan_deny(padapter, 5000); + rtw_mi_scan_abort(padapter, _TRUE); + } if (rtw_mp_cmd(padapter, MP_START, RTW_CMDF_WAIT_ACK) != _SUCCESS) ret = -EPERM; @@ -394,11 +398,15 @@ int rtw_mp_stop(struct net_device *dev, { int ret = 0; PADAPTER padapter = rtw_netdev_priv(dev); - struct hal_ops *pHalFunc = &padapter->hal_func; + struct mp_priv *pmppriv = &padapter->mppriv; if (rtw_mp_cmd(padapter, MP_STOP, RTW_CMDF_WAIT_ACK) != _SUCCESS) ret = -EPERM; + if (pmppriv->mode != MP_ON) + return -EPERM; + + pmppriv->bprocess_mp_mode = _FALSE; _rtw_memset(extra, 0, wrqu->length); sprintf(extra, "mp_stop %s\n", ret == 0 ? "ok" : "fail"); wrqu->length = strlen(extra); @@ -412,13 +420,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.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; @@ -460,13 +470,14 @@ 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); @@ -480,12 +491,37 @@ int rtw_mp_channel(struct net_device *dev, } +int rtw_mp_ch_offset(struct net_device *dev, + struct iw_request_info *info, + struct iw_point *wrqu, char *extra) +{ + + PADAPTER padapter = rtw_netdev_priv(dev); + u8 input[wrqu->length + 1]; + u32 ch_offset = 0; + + _rtw_memset(input, 0, sizeof(input)); + if (copy_from_user(input, wrqu->pointer, wrqu->length)) + return -EFAULT; + + input[wrqu->length] = '\0'; + ch_offset = rtw_atoi(input); + /*RTW_INFO("%s: channel=%d\n", __func__, channel);*/ + _rtw_memset(extra, 0, wrqu->length); + sprintf(extra, "Change prime channel offset %d to %d", padapter->mppriv.prime_channel_offset , ch_offset); + padapter->mppriv.prime_channel_offset = ch_offset; + SetChannel(padapter); + + wrqu->length = strlen(extra); + return 0; +} + + int rtw_mp_bandwidth(struct net_device *dev, struct iw_request_info *info, struct iw_point *wrqu, char *extra) { u32 bandwidth = 0, sg = 0; - int cur_ch_offset; PADAPTER padapter = rtw_netdev_priv(dev); HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); u8 input[wrqu->length]; @@ -508,8 +544,7 @@ int rtw_mp_bandwidth(struct net_device *dev, SetBandwidth(padapter); 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); return 0; @@ -521,19 +556,41 @@ 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]; + HAL_DATA_TYPE *phal_data = GET_HAL_DATA(padapter); + 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; - rfpath = rtw_atoi(input); - txpower_inx = mpt_ProQueryCalTxPower(padapter, rfpath); - sprintf(extra, " %d", txpower_inx); + input[wrqu->length] = '\0'; + + if (wrqu->length == 2) { + rfpath = rtw_atoi(input); + txpower_inx = mpt_ProQueryCalTxPower(padapter, rfpath); + sprintf(extra, " %d", txpower_inx); + } else { + txpower_inx = mpt_ProQueryCalTxPower(padapter, 0); + sprintf(extra, "patha=%d", txpower_inx); + if (phal_data->rf_type > RF_1T2R) { + txpower_inx = mpt_ProQueryCalTxPower(padapter, 1); + sprintf(extra, "%s,pathb=%d", extra, txpower_inx); + } + if (phal_data->rf_type > RF_2T4R) { + txpower_inx = mpt_ProQueryCalTxPower(padapter, 2); + sprintf(extra, "%s,pathc=%d", extra, txpower_inx); + } + if (phal_data->rf_type > RF_3T4R) { + txpower_inx = mpt_ProQueryCalTxPower(padapter, 3); + sprintf(extra, "%s,pathd=%d", extra, txpower_inx); + } + } wrqu->length = strlen(extra); return 0; @@ -544,7 +601,7 @@ int rtw_mp_txpower(struct net_device *dev, struct iw_request_info *info, struct iw_point *wrqu, char *extra) { - u32 idx_a = 0, idx_b = 0, idx_c = 0, idx_d = 0, status = 0; + u32 idx_a = 0, idx_b = 0, idx_c = 0, idx_d = 0; int MsetPower = 1; u8 input[wrqu->length]; @@ -565,10 +622,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); @@ -584,14 +641,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++) { @@ -613,10 +672,16 @@ int rtw_mp_ant_tx(struct net_device *dev, /*antenna |= BIT(extra[i]-'a');*/ RTW_INFO("%s: antenna=0x%x\n", __func__, antenna); padapter->mppriv.antenna_tx = antenna; - padapter->mppriv.antenna_rx = antenna; + /*RTW_INFO("%s:mppriv.antenna_rx=%d\n", __func__, padapter->mppriv.antenna_tx);*/ pHalData->antenna_tx_path = antenna; - + if (IS_HARDWARE_TYPE_8822C(padapter) && padapter->mppriv.antenna_tx == ANTENNA_B) { + if (padapter->mppriv.antenna_rx == ANTENNA_A || padapter->mppriv.antenna_rx == ANTENNA_B) { + padapter->mppriv.antenna_rx = ANTENNA_AB; + pHalData->AntennaRxPath = ANTENNA_AB; + RTW_INFO("%s:8822C Tx-B Rx Ant to AB\n", __func__); + } + } SetAntenna(padapter); wrqu->length = strlen(extra); @@ -630,12 +695,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); @@ -659,7 +727,7 @@ int rtw_mp_ant_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->AntennaRxPath = antenna; /*RTW_INFO("%s:mppriv.antenna_rx=%d\n", __func__, padapter->mppriv.antenna_rx);*/ @@ -712,10 +780,17 @@ int rtw_mp_ctx(struct net_device *dev, pmp_priv = &padapter->mppriv; pattrib = &pmp_priv->tx.attrib; + + if (padapter->registrypriv.mp_mode != 1 ) { + sprintf(extra, "Error: can't tx ,not in MP mode. \n"); + wrqu->length = strlen(extra); + return 0; + } 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)) { @@ -769,9 +844,17 @@ int rtw_mp_ctx(struct net_device *dev, } else { bStartTest = 1; odm_write_dig(&pHalData->odmpriv, 0x7f); + if (IS_HARDWARE_TYPE_8822C(padapter) && pmp_priv->antenna_tx == ANTENNA_B) { + if (pmp_priv->antenna_rx == ANTENNA_A || pmp_priv->antenna_rx == ANTENNA_B) { + pmp_priv->antenna_rx = ANTENNA_AB; + pHalData->AntennaRxPath = ANTENNA_AB; + RTW_INFO("%s:8822C Tx-B Rx Ant to AB\n", __func__); + SetAntenna(padapter); + } + } if (pmp_priv->mode != MP_ON) { if (pmp_priv->tx.stop != 1) { - RTW_INFO("%s: MP_MODE != ON %d\n", __func__, pmp_priv->mode); + RTW_INFO("%s:Error MP_MODE %d != ON\n", __func__, pmp_priv->mode); return -EFAULT; } } @@ -792,6 +875,9 @@ int rtw_mp_ctx(struct net_device *dev, status = rtw_mp_pretx_proc(padapter, bStartTest, extra); + if (stop == 0) + pmp_priv->mode = MP_ON; + wrqu->length = strlen(extra); return status; } @@ -802,16 +888,20 @@ int rtw_mp_disable_bt_coexist(struct net_device *dev, struct iw_request_info *info, union iwreq_data *wrqu, char *extra) { +#ifdef CONFIG_BT_COEXIST PADAPTER padapter = (PADAPTER)rtw_netdev_priv(dev); - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); - struct hal_ops *pHalFunc = &padapter->hal_func; - u8 input[wrqu->data.length]; +#endif + 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) { @@ -838,11 +928,11 @@ int rtw_mp_arx(struct net_device *dev, struct iw_request_info *info, struct iw_point *wrqu, char *extra) { - int bStartRx = 0, bStopRx = 0, bQueryPhy = 0, bQueryMac = 0, bSetBssid = 0; - int bmac_filter = 0, bfilter_init = 0, bmon = 0, bSmpCfg = 0, bloopbk = 0; + int bStartRx = 0, bStopRx = 0, bQueryPhy = 0, bQueryMac = 0, bSetBssid = 0, bSetRxframe = 0; + int bmac_filter = 0, bmon = 0, bSmpCfg = 0; u8 input[wrqu->length]; - char *pch, *ptmp, *token, *tmp[2] = {0x00, 0x00}; - u32 i = 0, ii = 0, jj = 0, kk = 0, cnts = 0, ret; + char *pch, *token, *tmp[2] = {0x00, 0x00}; + u32 i = 0, jj = 0, kk = 0, cnts = 0, ret; PADAPTER padapter = rtw_netdev_priv(dev); struct mp_priv *pmppriv = &padapter->mppriv; struct dbg_rx_counter rx_counter; @@ -863,6 +953,7 @@ int rtw_mp_arx(struct net_device *dev, bQueryPhy = (strncmp(input, "phy", 3) == 0) ? 1 : 0; /* strncmp TRUE is 0*/ bQueryMac = (strncmp(input, "mac", 3) == 0) ? 1 : 0; /* strncmp TRUE is 0*/ bSetBssid = (strncmp(input, "setbssid=", 8) == 0) ? 1 : 0; /* strncmp TRUE is 0*/ + bSetRxframe = (strncmp(input, "frametype", 9) == 0) ? 1 : 0; /*bfilter_init = (strncmp(input, "filter_init",11)==0)?1:0;*/ bmac_filter = (strncmp(input, "accept_mac", 10) == 0) ? 1 : 0; bmon = (strncmp(input, "mon=", 4) == 0) ? 1 : 0; @@ -892,6 +983,12 @@ int rtw_mp_arx(struct net_device *dev, pmppriv->bSetRxBssid = _TRUE; } + if (bSetRxframe) { + if (strncmp(input, "frametype beacon", 16) == 0) + pmppriv->brx_filter_beacon = _TRUE; + else + pmppriv->brx_filter_beacon = _FALSE; + } if (bmac_filter) { pmppriv->bmac_filter = bmac_filter; @@ -1018,7 +1115,6 @@ int rtw_mp_pwrtrk(struct net_device *dev, u32 thermal; s32 ret; PADAPTER padapter = rtw_netdev_priv(dev); - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); u8 input[wrqu->length]; if (copy_from_user(input, wrqu->pointer, wrqu->length)) @@ -1057,11 +1153,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); @@ -1074,61 +1172,102 @@ int rtw_mp_thermal(struct net_device *dev, struct iw_request_info *info, struct iw_point *wrqu, char *extra) { - u8 val; - int bwrite = 1; - -#ifdef CONFIG_RTL8188E - u16 addr = EEPROM_THERMAL_METER_88E; -#endif -#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8814A) - u16 addr = EEPROM_THERMAL_METER_8812; -#endif -#ifdef CONFIG_RTL8192E - u16 addr = EEPROM_THERMAL_METER_8192E; -#endif -#ifdef CONFIG_RTL8723B - u16 addr = EEPROM_THERMAL_METER_8723B; -#endif -#ifdef CONFIG_RTL8703B - u16 addr = EEPROM_THERMAL_METER_8703B; -#endif -#ifdef CONFIG_RTL8723D - u16 addr = EEPROM_THERMAL_METER_8723D; -#endif -#ifdef CONFIG_RTL8188F - u16 addr = EEPROM_THERMAL_METER_8188F; -#endif -#ifdef CONFIG_RTL8822B - u16 addr = EEPROM_THERMAL_METER_8822B; -#endif -#ifdef CONFIG_RTL8821C - u16 addr = EEPROM_THERMAL_METER_8821C; -#endif + u8 val[4] = {0}; + u8 ret = 0; + u16 ther_path_addr[4] = {0}; u16 cnt = 1; u16 max_available_size = 0; PADAPTER padapter = rtw_netdev_priv(dev); + int rfpath = RF_PATH_A; + +#ifdef CONFIG_RTL8188E + ther_path_addr[0] = EEPROM_THERMAL_METER_88E; +#endif +#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8814A) + ther_path_addr[0] = EEPROM_THERMAL_METER_8812; +#endif +#ifdef CONFIG_RTL8192E + ther_path_addr[0] = EEPROM_THERMAL_METER_8192E; +#endif +#ifdef CONFIG_RTL8192F + ther_path_addr[0] = EEPROM_THERMAL_METER_8192F; +#endif +#ifdef CONFIG_RTL8723B + ther_path_addr[0] = EEPROM_THERMAL_METER_8723B; +#endif +#ifdef CONFIG_RTL8703B + ther_path_addr[0] = EEPROM_THERMAL_METER_8703B; +#endif +#ifdef CONFIG_RTL8723D + ther_path_addr[0] = EEPROM_THERMAL_METER_8723D; +#endif +#ifdef CONFIG_RTL8188F + ther_path_addr[0] = EEPROM_THERMAL_METER_8188F; +#endif +#ifdef CONFIG_RTL8188GTV + ther_path_addr[0] = EEPROM_THERMAL_METER_8188GTV; +#endif +#ifdef CONFIG_RTL8822B + ther_path_addr[0] = EEPROM_THERMAL_METER_8822B; +#endif +#ifdef CONFIG_RTL8821C + ther_path_addr[0] = EEPROM_THERMAL_METER_8821C; +#endif +#ifdef CONFIG_RTL8710B + ther_path_addr[0] = EEPROM_THERMAL_METER_8710B; +#endif +#ifdef CONFIG_RTL8822C + ther_path_addr[0] = EEPROM_THERMAL_METER_A_8822C; + ther_path_addr[1] = EEPROM_THERMAL_METER_B_8822C; +#endif if (copy_from_user(extra, wrqu->pointer, wrqu->length)) return -EFAULT; - bwrite = strncmp(extra, "write", 6);/* strncmp TRUE is 0*/ - - GetThermalMeter(padapter, &val); - - if (bwrite == 0) { - /*RTW_INFO("to write val:%d",val);*/ - EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_available_size, _FALSE); - if (2 > max_available_size) { + if ((strncmp(extra, "write", 6) == 0)) { + int i; + u16 raw_cursize = 0, raw_maxsize = 0; +#ifdef RTW_HALMAC + raw_maxsize = efuse_GetavailableSize(padapter); +#else + efuse_GetCurrentSize(padapter, &raw_cursize); + raw_maxsize = efuse_GetMaxSize(padapter); +#endif + RTW_INFO("[eFuse available raw size]= %d bytes\n", raw_maxsize - raw_cursize); + if (2 > raw_maxsize - raw_cursize) { RTW_INFO("no available efuse!\n"); return -EFAULT; } - if (rtw_efuse_map_write(padapter, addr, cnt, &val) == _FAIL) { - RTW_INFO("rtw_efuse_map_write error\n"); - return -EFAULT; + + for (i = 0; i < GET_HAL_RFPATH_NUM(padapter); i++) { + GetThermalMeter(padapter, i , &val[i]); + if (ther_path_addr[i] != 0 && val[i] != 0) { + if (rtw_efuse_map_write(padapter, ther_path_addr[i], cnt, &val[i]) == _FAIL) { + RTW_INFO("Error efuse write thermal addr 0x%x ,val = 0x%x\n", ther_path_addr[i], val[i]); + return -EFAULT; + } + } else { + RTW_INFO("Error efuse write thermal Null addr,val \n"); + return -EFAULT; + } } - sprintf(extra, " efuse write ok :%d", val); - } else - sprintf(extra, "%d", val); + _rtw_memset(extra, 0, wrqu->length); + sprintf(extra, " efuse write ok :%d", val[0]); + } else { + ret = sscanf(extra, "%d", &rfpath); + if (ret < 1) { + rfpath = RF_PATH_A; + RTW_INFO("default thermal of path(%d)\n", rfpath); + } + if (rfpath >= GET_HAL_RFPATH_NUM(padapter)) + return -EINVAL; + + RTW_INFO("read thermal of path(%d)\n", rfpath); + GetThermalMeter(padapter, rfpath, &val[0]); + + _rtw_memset(extra, 0, wrqu->length); + sprintf(extra, "%d", val[0]); + } wrqu->length = strlen(extra); return 0; @@ -1141,7 +1280,6 @@ int rtw_mp_reset_stats(struct net_device *dev, struct iw_point *wrqu, char *extra) { struct mp_priv *pmp_priv; - struct pkt_attrib *pattrib; PADAPTER padapter = rtw_netdev_priv(dev); pmp_priv = &padapter->mppriv; @@ -1168,11 +1306,7 @@ int rtw_mp_dump(struct net_device *dev, struct iw_point *wrqu, char *extra) { struct mp_priv *pmp_priv; - struct pkt_attrib *pattrib; - u32 value; u8 input[wrqu->length]; - u8 rf_type, path_nums = 0; - u32 i, j = 1, path; PADAPTER padapter = rtw_netdev_priv(dev); pmp_priv = &padapter->mppriv; @@ -1197,23 +1331,52 @@ int rtw_mp_phypara(struct net_device *dev, PADAPTER padapter = rtw_netdev_priv(dev); HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); char input[wrqu->length]; - u32 valxcap, ret; + u32 invalxcap = 0, ret = 0, bwrite_xcap = 0, hwxtaladdr = 0; + u16 pgval; + if (copy_from_user(input, wrqu->pointer, wrqu->length)) return -EFAULT; - RTW_INFO("%s:iwpriv in=%s\n", __func__, input); + RTW_INFO("%s:priv in=%s\n", __func__, input); + bwrite_xcap = (strncmp(input, "write_xcap=", 11) == 0) ? 1 : 0; - ret = sscanf(input, "xcap=%d", &valxcap); + if (bwrite_xcap == 1) { + ret = sscanf(input, "write_xcap=%d", &invalxcap); + invalxcap = invalxcap & 0x7f; /* xtal bit 0 ~6 */ + RTW_INFO("get crystal_cap %d\n", invalxcap); - pHalData->crystal_cap = (u8)valxcap; - hal_set_crystal_cap(padapter , valxcap); + if (IS_HARDWARE_TYPE_8822C(padapter) && ret == 1) { + hwxtaladdr = 0x110; + pgval = invalxcap | 0x80; /* reserved default bit7 on */ + pgval = pgval | pgval << 8; /* xtal xi/xo efuse 0x110 0x111 */ + + RTW_INFO("Get crystal_cap 0x%x\n", pgval); + if (rtw_efuse_map_write(padapter, hwxtaladdr, 2, (u8*)&pgval) == _FAIL) { + RTW_INFO("%s: rtw_efuse_map_write xcap error!!\n", __func__); + sprintf(extra, "write xcap pgdata fail"); + ret = -EFAULT; + } else + sprintf(extra, "write xcap pgdata ok"); + + } + } else { + ret = sscanf(input, "xcap=%d", &invalxcap); + + if (ret == 1) { + pHalData->crystal_cap = (u8)invalxcap; + RTW_INFO("%s:crystal_cap=%d\n", __func__, pHalData->crystal_cap); + + if (rtw_phydm_set_crystal_cap(padapter, pHalData->crystal_cap) == _FALSE) { + RTW_ERR("set crystal_cap failed\n"); + rtw_warn_on(1); + } + sprintf(extra, "Set xcap=%d", invalxcap); + } + } - sprintf(extra, "Set xcap=%d", valxcap); wrqu->length = strlen(extra) + 1; - - return 0; - + return ret; } @@ -1224,6 +1387,9 @@ int rtw_mp_SetRFPath(struct net_device *dev, PADAPTER padapter = rtw_netdev_priv(dev); char input[wrqu->length]; int bMain = 1, bTurnoff = 1; +#ifdef CONFIG_ANTENNA_DIVERSITY + u8 ret = _TRUE; +#endif RTW_INFO("%s:iwpriv in=%s\n", __func__, input); @@ -1234,6 +1400,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); @@ -1256,6 +1430,56 @@ int rtw_mp_SetRFPath(struct net_device *dev, } +int rtw_mp_switch_rf_path(struct net_device *dev, + struct iw_request_info *info, + struct iw_point *wrqu, char *extra) +{ + PADAPTER padapter = rtw_netdev_priv(dev); + struct mp_priv *pmp_priv; + char input[wrqu->length]; + int bwlg = 1, bwla = 1, btg = 1, bbt=1; + u8 ret = 0; + + + if (copy_from_user(input, wrqu->pointer, wrqu->length)) + return -EFAULT; + + pmp_priv = &padapter->mppriv; + + RTW_INFO("%s: in=%s\n", __func__, input); + + bwlg = strncmp(input, "WLG", 3); /* strncmp TRUE is 0*/ + bwla = strncmp(input, "WLA", 3); /* strncmp TRUE is 0*/ + btg = strncmp(input, "BTG", 3); /* strncmp TRUE is 0*/ + bbt = strncmp(input, "BT", 3); /* strncmp TRUE is 0*/ + + _rtw_memset(extra, 0, wrqu->length); +#ifdef CONFIG_RTL8821C /* only support for 8821c wlg/wla/btg/bt RF switch path */ + if (bwlg == 0) { + pmp_priv->rf_path_cfg = SWITCH_TO_WLG; + sprintf(extra, "switch rf path WLG\n"); + } else if (bwla == 0) { + pmp_priv->rf_path_cfg = SWITCH_TO_WLA; + sprintf(extra, "switch rf path WLA\n"); + } else if (btg == 0) { + pmp_priv->rf_path_cfg = SWITCH_TO_BTG; + sprintf(extra, "switch rf path BTG\n"); + } else if (bbt == 0) { + pmp_priv->rf_path_cfg = SWITCH_TO_BT; + sprintf(extra, "switch rf path BG\n"); + } else { + sprintf(extra, "Error set %s\n", __func__); + return -EFAULT; + } + + mp_phy_switch_rf_path_set(padapter, &pmp_priv->rf_path_cfg); +#endif + + wrqu->length = strlen(extra); + + return ret; + +} int rtw_mp_QueryDrv(struct net_device *dev, struct iw_request_info *info, union iwreq_data *wrqu, char *extra) @@ -1331,6 +1555,60 @@ int rtw_mp_lck(struct net_device *dev, return 0; } +int rtw_mp_dpk(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ + PADAPTER padapter = rtw_netdev_priv(dev); + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); + struct dm_struct *pDM_Odm = &pHalData->odmpriv; + struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); + + u8 bdpk = 0; + u8 ips_mode = IPS_NUM; /* init invalid value */ + u8 lps_mode = PS_MODE_NUM; /* init invalid value */ + + 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) { + pDM_Odm->dpk_info.is_dpk_enable = 0; + halrf_dpk_enable_disable(pDM_Odm); + sprintf(extra, "set dpk off\n"); + + } else if (strncmp(extra, "on", 2) == 0 && strlen(extra) < 3) { + pDM_Odm->dpk_info.is_dpk_enable = 1; + halrf_dpk_enable_disable(pDM_Odm); + sprintf(extra, "set dpk on\n"); + } else { +#ifdef CONFIG_LPS + lps_mode = pwrctrlpriv->power_mgnt;/* keep org value */ + rtw_pm_set_lps(padapter, PS_MODE_ACTIVE); +#endif +#ifdef CONFIG_IPS + ips_mode = pwrctrlpriv->ips_mode;/* keep org value */ + rtw_pm_set_ips(padapter, IPS_NONE); +#endif + rtw_mp_trigger_dpk(padapter); + if (padapter->registrypriv.mp_mode == 0) { +#ifdef CONFIG_IPS + rtw_pm_set_ips(padapter, ips_mode); +#endif /* CONFIG_IPS */ + +#ifdef CONFIG_LPS + rtw_pm_set_lps(padapter, lps_mode); +#endif /* CONFIG_LPS */ + } + sprintf(extra, "set dpk trigger\n"); + } + + wrqu->data.length = strlen(extra); + + return 0; +} + int rtw_mp_getver(struct net_device *dev, struct iw_request_info *info, union iwreq_data *wrqu, char *extra) @@ -1364,6 +1642,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); @@ -1389,11 +1668,11 @@ 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);*/ + /*rtw_free_assoc_resources_cmd(padapter, _TRUE, 0);*/ } rtw_pm_set_ips(padapter, IPS_NORMAL); sprintf(extra, "monitor mode Stop\n"); @@ -1405,9 +1684,8 @@ int rtw_mp_mon(struct net_device *dev, 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.mpt_ctx); + char *pextra = extra; switch (pmp_priv->mode) { @@ -1417,7 +1695,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 @@ -1425,26 +1704,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; @@ -1461,7 +1740,9 @@ int rtw_mp_pretx_proc(PADAPTER padapter, u8 bStartTest, char *extra) rtw_msleep_os(5); } #ifdef CONFIG_80211N_HT - pmp_priv->tx.attrib.ht_en = 1; + if(padapter->registrypriv.ht_enable && + is_supported_ht(padapter->registrypriv.wireless_mode)) + pmp_priv->tx.attrib.ht_en = 1; #endif pmp_priv->tx.stop = 0; pmp_priv->tx.count = 1; @@ -1491,10 +1772,12 @@ int rtw_mp_tx(struct net_device *dev, HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); struct mp_priv *pmp_priv = &padapter->mppriv; 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; + u8 bStartTest = 1, status = 0; +#ifdef CONFIG_MP_VHT_HW_TX_MODE + u8 Idx = 0, tmpU1B; +#endif u16 antenna = 0; if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) @@ -1522,13 +1805,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 @@ -1666,22 +1949,23 @@ 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); @@ -1693,18 +1977,20 @@ int rtw_mp_tx(struct net_device *dev, 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->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); @@ -1722,13 +2008,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->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; @@ -1808,8 +2094,7 @@ 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.mpt_ctx); - + char *pextra = extra; u32 bandwidth = 0, sg = 0, channel = 6, ant = 0; u16 antenna = 0; u8 bStartRx = 0; @@ -1836,15 +2121,16 @@ 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); @@ -1857,13 +2143,14 @@ int rtw_mp_rx(struct net_device *dev, 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->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; @@ -1914,7 +2201,7 @@ int rtw_mp_rx(struct net_device *dev, 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); @@ -1927,28 +2214,118 @@ int rtw_mp_hwtx(struct net_device *dev, union iwreq_data *wrqu, char *extra) { 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.mpt_ctx); -#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8821B) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) - u8 input[wrqu->data.length]; - - if (copy_from_user(input, wrqu->data.pointer, wrqu->data.length)) +#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8821B) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822C) + if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) return -EFAULT; + *(extra + wrqu->data.length) = '\0'; _rtw_memset(&pMptCtx->PMacTxInfo, 0, sizeof(RT_PMAC_TX_INFO)); - _rtw_memcpy((void *)&pMptCtx->PMacTxInfo, (void *)input, sizeof(RT_PMAC_TX_INFO)); - - mpt_ProSetPMacTx(padapter); - sprintf(extra, "Set PMac Tx Mode start\n"); + _rtw_memcpy((void *)&pMptCtx->PMacTxInfo, (void *)extra, sizeof(RT_PMAC_TX_INFO)); + _rtw_memset(extra, 0, wrqu->data.length); + if (pMptCtx->PMacTxInfo.bEnPMacTx == 1 && pmp_priv->mode != MP_ON) { + sprintf(extra, "MP Tx Running, Please Set PMac Tx Mode Stop\n"); + RTW_INFO("Error !!! MP Tx Running, Please Set PMac Tx Mode Stop\n"); + } else { + RTW_INFO("To set MAC Tx mode\n"); + mpt_ProSetPMacTx(padapter); + sprintf(extra, "Set PMac Tx Mode OK\n"); + } wrqu->data.length = strlen(extra); #endif return 0; } +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; + + *(extra + wrqu->data.length) = '\0'; +#if 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; + + *(extra + wrqu->data.length) = '\0'; + 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_mp_dpk_track(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ + PADAPTER padapter = rtw_netdev_priv(dev); + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); + struct dm_struct *pDM_Odm = &pHalData->odmpriv; + + u8 dpk_track_state = 0; + + 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) { + halrf_set_dpk_track(pDM_Odm, FALSE); + sprintf(extra, "set dpk track off\n"); + + } else if (strncmp(extra, "on", 2) == 0 && strlen(extra) < 3) { + halrf_set_dpk_track(pDM_Odm, TRUE); + sprintf(extra, "set dpk track on\n"); + } + + 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) @@ -1962,6 +2339,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"); @@ -1975,11 +2353,10 @@ int rtw_efuse_mask_file(struct net_device *dev, return 0; } if (strncmp(extra, "data,", 5) == 0) { - u8 *pch, *pdata; + u8 *pch; char *ptmp, tmp; u8 count = 0; u8 i = 0; - u32 datalen = 0; ptmp = extra; pch = strsep(&ptmp, ","); @@ -2019,9 +2396,14 @@ int rtw_efuse_mask_file(struct net_device *dev, if (rtw_is_file_readable(rtw_efuse_mask_file_path) == _TRUE) { RTW_INFO("%s do rtw_efuse_mask_file_read = %s! ,sizeof maskfileBuffer %zu\n", __func__, rtw_efuse_mask_file_path, sizeof(maskfileBuffer)); Status = rtw_efuse_file_read(padapter, rtw_efuse_mask_file_path, maskfileBuffer, sizeof(maskfileBuffer)); - if (Status == _TRUE) + if (Status == _TRUE) { padapter->registrypriv.bFileMaskEfuse = _TRUE; - sprintf(extra, "efuse mask file read OK\n"); + sprintf(extra, "efuse mask file read OK\n"); + } else { + padapter->registrypriv.bFileMaskEfuse = _FALSE; + sprintf(extra, "read efuse mask file FAIL\n"); + RTW_INFO("%s rtw_efuse_file_read mask fail!\n", __func__); + } } else { padapter->registrypriv.bFileMaskEfuse = _FALSE; sprintf(extra, "efuse mask file readable FAIL\n"); @@ -2069,6 +2451,237 @@ 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; +} + + +static inline void dump_buf(u8 *buf, u32 len) +{ + u32 i; + + RTW_INFO("-----------------Len %d----------------\n", len); + for (i = 0; i < len; i++) + RTW_INFO("%2.2x-", *(buf + i)); + RTW_INFO("\n"); +} + +int rtw_mp_link(struct net_device *dev, + struct iw_request_info *info, + struct iw_point *wrqu, char *extra) +{ + PADAPTER padapter = rtw_netdev_priv(dev); + struct mp_priv *pmp_priv; + char input[wrqu->length]; + int bgetrxdata = 0, btxdata = 0, bsetbt = 0; + u8 err = 0 , num; + u32 i = 0, datalen = 0, j = 0, jj, kk, waittime = 0, n = 0, btdata; + u16 addr = 0xff, cnts = 0, bttypen = 0, val = 0x00, ret = 0; + char *pextra = NULL; + u8 *setdata = NULL; + char *pch, *ptmp, *token, *tmp[4] = {0x00, 0x00, 0x00}; + + pmp_priv = &padapter->mppriv; + + if (copy_from_user(input, wrqu->pointer, wrqu->length)) + return -EFAULT; + + _rtw_memset(extra, 0, wrqu->length); + + RTW_INFO("%s: in=%s\n", __func__, input); + + bgetrxdata = (strncmp(input, "rxdata", 6) == 0) ? 1 : 0; /* strncmp TRUE is 0*/ + btxdata = (strncmp(input, "txdata", 6) == 0) ? 1 : 0; /* strncmp TRUE is 0*/ + bsetbt = (strncmp(input, "setbt", 5) == 0) ? 1 : 0; /* strncmp TRUE is 0*/ + + if (bgetrxdata) { + RTW_INFO("%s: in= 1 \n", __func__); + if (pmp_priv->mplink_brx == _TRUE) { + + while (waittime < 100 && pmp_priv->mplink_brx == _FALSE) { + if (pmp_priv->mplink_brx == _FALSE) + rtw_msleep_os(10); + else + break; + waittime++; + } + if (pmp_priv->mplink_brx == _TRUE) { + sprintf(extra, "\n"); + pextra = extra + strlen(extra); + for (i = 0; i < pmp_priv->mplink_rx_len; i ++) { + pextra += sprintf(pextra, "%02x:", pmp_priv->mplink_buf[i]); + } + _rtw_memset(pmp_priv->mplink_buf, '\0' , sizeof(pmp_priv->mplink_buf)); + pmp_priv->mplink_brx = _FALSE; + } + } + } else if (btxdata) { + struct pkt_attrib *pattrib; + + pch = input; + setdata = rtw_zmalloc(1024); + if (setdata == NULL) { + err = -ENOMEM; + goto exit; + } + + i = 0; + while ((token = strsep(&pch, ",")) != NULL) { + if (i > 2) + break; + tmp[i] = token; + i++; + } + + /* tmp[0],[1],[2] */ + /* txdata,00e04c871200........... */ + if (strcmp(tmp[0], "txdata") == 0) { + if ((tmp[1] == NULL)) { + err = -EINVAL; + goto exit; + } + } + + datalen = strlen(tmp[1]); + if (datalen % 2) { + err = -EINVAL; + goto exit; + } + datalen /= 2; + if (datalen == 0) { + err = -EINVAL; + goto exit; + } + + RTW_INFO("%s: data len=%d\n", __FUNCTION__, datalen); + RTW_INFO("%s: tx data=%s\n", __FUNCTION__, tmp[1]); + + for (jj = 0, kk = 0; jj < datalen; jj++, kk += 2) + setdata[jj] = key_2char2num(tmp[1][kk], tmp[1][kk + 1]); + + dump_buf(setdata, datalen); + _rtw_memset(pmp_priv->mplink_buf, '\0' , sizeof(pmp_priv->mplink_buf)); + _rtw_memcpy(pmp_priv->mplink_buf, setdata, datalen); + + pattrib = &pmp_priv->tx.attrib; + pattrib->pktlen = datalen; + pmp_priv->tx.count = 1; + pmp_priv->tx.stop = 0; + pmp_priv->mplink_btx = _TRUE; + SetPacketTx(padapter); + pmp_priv->mode = MP_PACKET_TX; + + } else if (bsetbt) { + +#ifdef CONFIG_BT_COEXIST + pch = input; + i = 0; + + while ((token = strsep(&pch, ",")) != NULL) { + if (i > 3) + break; + tmp[i] = token; + i++; + } + + if (tmp[1] == NULL) { + err = -EINVAL; + goto exit; + } + + if (strcmp(tmp[1], "scbd") == 0) { + u16 org_val = 0x8002, pre_val, read_score_board_val; + u8 state; + + pre_val = (rtw_read16(padapter,(0xaa))) & 0x7fff; + + if (tmp[2] != NULL) { + state = simple_strtoul(tmp[2], &ptmp, 10); + + if (state) + org_val = org_val | BIT6; + else + org_val = org_val & (~BIT6); + + if (org_val != pre_val) { + pre_val = org_val; + rtw_write16(padapter, 0xaa, org_val); + RTW_INFO("%s,setbt scbd write org_val = 0x%x , pre_val = 0x%x\n", __func__, org_val, pre_val); + } else { + RTW_INFO("%s,setbt scbd org_val = 0x%x ,pre_val = 0x%x\n", __func__, org_val, pre_val); + } + } else { + read_score_board_val = (rtw_read16(padapter,(0xaa))) & 0x7fff; + RTW_INFO("%s,read_score_board_val = 0x%x\n", __func__, read_score_board_val); + } + goto exit; + + } else if (strcmp(tmp[1], "testmode") == 0) { + + if (tmp[2] == NULL) { + err = -EINVAL; + goto exit; + } + + val = simple_strtoul(tmp[2], &ptmp, 16); + RTW_INFO("get tmp, type %s, val =0x%x!\n", tmp[1], val); + + if (tmp[2] != NULL) { + _rtw_memset(extra, 0, wrqu->length); + ret = rtw_btcoex_btset_testmode(padapter, val); + if (!CHECK_STATUS_CODE_FROM_BT_MP_OPER_RET(ret, BT_STATUS_BT_OP_SUCCESS)) { + RTW_INFO("%s: BT_OP fail = 0x%x!\n", __FUNCTION__, val); + sprintf(extra, "BT_OP fail 0x%x!\n", val); + } else + sprintf(extra, "Set BT_OP 0x%x done!\n", val); + } + + } +#endif /* CONFIG_BT_COEXIST */ + } + +exit: + if (setdata) + rtw_mfree(setdata, 1024); + + wrqu->length = strlen(extra); + return err; + +} + #if defined(CONFIG_RTL8723B) int rtw_mp_SetBT(struct net_device *dev, struct iw_request_info *info, @@ -2094,6 +2707,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; @@ -2110,7 +2726,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); @@ -2142,7 +2758,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)); @@ -2171,7 +2787,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); @@ -2279,7 +2895,7 @@ 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; } @@ -2380,7 +2996,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/rtl8188eu/os_dep/linux/mlme_linux.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/mlme_linux.c index eef8f5f241f0..a6413f6a7592 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/mlme_linux.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/mlme_linux.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 +52,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 +68,13 @@ void rtw_os_indicate_connect(_adapter *adapter) #endif /* CONFIG_IOCTL_CFG80211 */ rtw_indicate_wx_assoc_event(adapter); - netif_carrier_on(adapter->pnetdev); + +#ifdef CONFIG_RTW_MESH +#if CONFIG_RTW_MESH_CTO_MGATE_CARRIER + if (!rtw_mesh_cto_mgate_required(adapter)) +#endif +#endif + rtw_netif_carrier_on(adapter->pnetdev); if (adapter->pid[2] != 0) rtw_signal_process(adapter->pid[2], SIGALRM); @@ -177,7 +103,6 @@ void rtw_reset_securitypriv(_adapter *adapter) u32 backupTKIPcountermeasure_time = 0; /* add for CONFIG_IEEE80211W, none 11w also can use */ _irqL irqL; - struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; _enter_critical_bh(&adapter->security_key_mutex, &irqL); @@ -194,12 +119,7 @@ void rtw_reset_securitypriv(_adapter *adapter) backupPMKIDIndex = adapter->securitypriv.PMKIDIndex; backupTKIPCountermeasure = adapter->securitypriv.btkip_countermeasure; backupTKIPcountermeasure_time = adapter->securitypriv.btkip_countermeasure_time; -#ifdef CONFIG_IEEE80211W - /* reset RX BIP packet number */ - 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. */ @@ -211,6 +131,8 @@ void rtw_reset_securitypriv(_adapter *adapter) adapter->securitypriv.ndisauthtype = Ndis802_11AuthModeOpen; adapter->securitypriv.ndisencryptstatus = Ndis802_11WEPDisabled; + adapter->securitypriv.extauth_status = WLAN_STATUS_UNSPECIFIED_FAILURE; + } else { /* reset values in securitypriv */ /* if(adapter->mlmepriv.fw_state & WIFI_STATION_STATE) */ /* { */ @@ -226,6 +148,8 @@ void rtw_reset_securitypriv(_adapter *adapter) psec_priv->ndisauthtype = Ndis802_11AuthModeOpen; psec_priv->ndisencryptstatus = Ndis802_11WEPDisabled; /* } */ + + psec_priv->extauth_status = WLAN_STATUS_UNSPECIFIED_FAILURE; } /* add for CONFIG_IEEE80211W, none 11w also can use */ _exit_critical_bh(&adapter->security_key_mutex, &irqL); @@ -238,7 +162,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 +224,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 +234,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 > pstapriv->max_aid) 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 +261,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 > pstapriv->max_aid) 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 +304,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 +318,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); @@ -552,9 +388,6 @@ int hostapd_mode_init(_adapter *padapter) /* pnetdev->wireless_handlers = NULL; */ -#ifdef CONFIG_TCP_CSUM_OFFLOAD_TX - pnetdev->features |= NETIF_F_IP_CSUM; -#endif @@ -575,7 +408,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/rtl8188eu/os_dep/linux/os_intfs.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/os_intfs.c index 1d17ad351658..a35db1deda37 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/os_intfs.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/os_intfs.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,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 _OS_INTFS_C_ #include #include -#if defined(PLATFORM_LINUX) && defined (PLATFORM_WINDOWS) - - #error "Shall be Linux or Windows, but not both!\n" - -#endif - - MODULE_LICENSE("GPL"); MODULE_DESCRIPTION("Realtek Wireless Lan Driver"); MODULE_AUTHOR("Realtek Semiconductor Corp."); @@ -38,37 +27,100 @@ MODULE_VERSION(DRIVERVERSION); int rtw_chip_version = 0x00; int rtw_rfintfs = HWPI; int rtw_lbkmode = 0;/* RTL8712_AIR_TRX; */ - - +#ifdef DBG_LA_MODE +int rtw_la_mode_en=0; +module_param(rtw_la_mode_en, int, 0644); +#endif 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 */ int rtw_wireless_mode = WIRELESS_MODE_MAX; +module_param(rtw_wireless_mode, int, 0644); int rtw_vrtl_carrier_sense = AUTO_VCS; int rtw_vcs_type = RTS_CTS; int rtw_rts_thresh = 2347; int rtw_frag_thresh = 2346; int rtw_preamble = PREAMBLE_LONG;/* long, short, auto */ int rtw_scan_mode = 1;/* active, passive */ -int rtw_adhoc_tx_pwr = 1; -int rtw_soft_ap = 0; /* int smart_ps = 1; */ #ifdef CONFIG_POWER_SAVING + /* IPS configuration */ + int rtw_ips_mode = RTW_IPS_MODE; + + /* LPS configuration */ +/* RTW_LPS_MODE=0:disable, 1:LPS , 2:LPS with clock gating, 3: power gating */ +#if (RTW_LPS_MODE > 0) int rtw_power_mgnt = PS_MODE_MAX; - #ifdef CONFIG_IPS_LEVEL_2 - int rtw_ips_mode = IPS_LEVEL_2; - #else - int rtw_ips_mode = IPS_NORMAL; - #endif + + #ifdef CONFIG_USB_HCI + int rtw_lps_level = LPS_NORMAL; /*USB default LPS level*/ + #else /*SDIO,PCIE*/ + int rtw_lps_level = (RTW_LPS_MODE - 1); + #endif/*CONFIG_USB_HCI*/ #else int rtw_power_mgnt = PS_MODE_ACTIVE; - int rtw_ips_mode = IPS_NONE; + int rtw_lps_level = LPS_NORMAL; #endif + + int rtw_lps_chk_by_tp = 1; + + /* WOW LPS configuration */ +#ifdef CONFIG_WOWLAN +/* RTW_WOW_LPS_MODE=0:disable, 1:LPS , 2:LPS with clock gating, 3: power gating */ +#if (RTW_WOW_LPS_MODE > 0) + int rtw_wow_power_mgnt = PS_MODE_MAX; + int rtw_wow_lps_level = (RTW_WOW_LPS_MODE - 1); +#else + int rtw_wow_power_mgnt = PS_MODE_ACTIVE; + int rtw_wow_lps_level = LPS_NORMAL; +#endif +#endif /* CONFIG_WOWLAN */ + +#else /* !CONFIG_POWER_SAVING */ + int rtw_ips_mode = IPS_NONE; + int rtw_power_mgnt = PS_MODE_ACTIVE; + int rtw_lps_level = LPS_NORMAL; + int rtw_lps_chk_by_tp = 0; +#ifdef CONFIG_WOWLAN + int rtw_wow_power_mgnt = PS_MODE_ACTIVE; + int rtw_wow_lps_level = LPS_NORMAL; +#endif /* CONFIG_WOWLAN */ +#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"); + +module_param(rtw_lps_chk_by_tp, int, 0644); + +#ifdef CONFIG_WOWLAN +module_param(rtw_wow_power_mgnt, int, 0644); +MODULE_PARM_DESC(rtw_wow_power_mgnt, "The default WOW LPS mode"); +module_param(rtw_wow_lps_level, int, 0644); +MODULE_PARM_DESC(rtw_wow_lps_level, "The default WOW LPS level"); +#endif /* CONFIG_WOWLAN */ + +/* 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; +int rtw_max_bss_cnt = 0; +module_param(rtw_max_bss_cnt, int, 0644); +#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 @@ -78,9 +130,13 @@ 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. */ +#ifdef CONFIG_RTW_DEBUG #ifdef RTW_LOG_LEVEL uint rtw_drv_log_level = (uint)RTW_LOG_LEVEL; /* from Makefile */ #else @@ -88,7 +144,7 @@ module_param(rtw_usb_rxagg_mode, int, 0644); #endif module_param(rtw_drv_log_level, uint, 0644); MODULE_PARM_DESC(rtw_drv_log_level, "set log level when insert driver module, default log level is _DRV_INFO_ = 4"); - +#endif int rtw_radio_enable = 1; int rtw_long_retry_lmt = 7; int rtw_short_retry_lmt = 7; @@ -110,35 +166,104 @@ 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) || defined(CONFIG_RTL8822C) + /*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 +#if CONFIG_TX_AC_LIFETIME +uint rtw_tx_aclt_flags = CONFIG_TX_ACLT_FLAGS; +module_param(rtw_tx_aclt_flags, uint, 0644); +MODULE_PARM_DESC(rtw_tx_aclt_flags, "device TX AC queue packet lifetime control flags"); + +static uint rtw_tx_aclt_conf_default[3] = CONFIG_TX_ACLT_CONF_DEFAULT; +static uint rtw_tx_aclt_conf_default_num = 0; +module_param_array(rtw_tx_aclt_conf_default, uint, &rtw_tx_aclt_conf_default_num, 0644); +MODULE_PARM_DESC(rtw_tx_aclt_conf_default, "device TX AC queue lifetime config for default status"); + +#ifdef CONFIG_TX_MCAST2UNI +static uint rtw_tx_aclt_conf_ap_m2u[3] = CONFIG_TX_ACLT_CONF_AP_M2U; +static uint rtw_tx_aclt_conf_ap_m2u_num = 0; +module_param_array(rtw_tx_aclt_conf_ap_m2u, uint, &rtw_tx_aclt_conf_ap_m2u_num, 0644); +MODULE_PARM_DESC(rtw_tx_aclt_conf_ap_m2u, "device TX AC queue lifetime config for AP mode M2U status"); +#endif + +#ifdef CONFIG_RTW_MESH +static uint rtw_tx_aclt_conf_mesh[3] = CONFIG_TX_ACLT_CONF_MESH; +static uint rtw_tx_aclt_conf_mesh_num = 0; +module_param_array(rtw_tx_aclt_conf_mesh, uint, &rtw_tx_aclt_conf_mesh_num, 0644); +MODULE_PARM_DESC(rtw_tx_aclt_conf_mesh, "device TX AC queue lifetime config for MESH status"); +#endif +#endif /* CONFIG_TX_AC_LIFETIME */ + uint rtw_tx_bw_mode = 0x21; module_param(rtw_tx_bw_mode, uint, 0644); MODULE_PARM_DESC(rtw_tx_bw_mode, "The max tx bw for 2.4G and 5G. format is the same as rtw_bw_mode"); +#ifdef CONFIG_FW_HANDLE_TXBCN +uint rtw_tbtt_rpt = 0; /*ROOT AP - BIT0, VAP1 - BIT1, VAP2 - BIT2, VAP3 - VAP3, FW report TBTT INT by C2H*/ +module_param(rtw_tbtt_rpt, uint, 0644); +#endif + #ifdef CONFIG_80211N_HT 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 */ -#if (defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B)) && defined(CONFIG_PCI_HCI) -int rtw_ampdu_amsdu = 2;/* 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_RTL8822C)) && 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 */ +#elif ((defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8822C)) && defined(CONFIG_SDIO_HCI)) +int rtw_rx_ampdu_amsdu = 1; #else -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 */ +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 @@ -149,6 +274,7 @@ int rtw_short_gi = 0xf; int rtw_ldpc_cap = 0x33; /* BIT0: Enable VHT STBC Rx, BIT1: Enable VHT STBC Tx, BIT4: Enable HT STBC Rx, BIT5: Enable HT STBC Tx */ int rtw_stbc_cap = 0x13; + /* * BIT0: Enable VHT SU Beamformer * BIT1: Enable VHT SU Beamformee @@ -176,24 +302,14 @@ MODULE_PARM_DESC(rtw_vht_rx_mcs_map, "VHT RX MCS map"); int rtw_lowrate_two_xmit = 1;/* Use 2 path Tx to transmit MCS0~7 and legacy mode */ -int rtw_rf_config = RF_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; int rtw_low_power = 0; -#ifdef CONFIG_WIFI_TEST - int rtw_wifi_spec = 1;/* for wifi test */ -#else - 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_wifi_spec = 0; int rtw_special_rf_path = 0; /* 0: 2T2R ,1: only turn on path A 1T1R */ @@ -202,7 +318,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"); @@ -241,6 +357,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; @@ -272,17 +390,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 @@ -290,13 +404,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"; @@ -323,7 +441,15 @@ 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 +#ifdef RTW_WOW_STA_MIX +int rtw_wowlan_sta_mix_mode = 1; +#else +int rtw_wowlan_sta_mix_mode = 0; +#endif +module_param(rtw_wowlan_sta_mix_mode, int, 0644); module_param(rtw_pwrtrim_enable, int, 0644); module_param(rtw_initmac, charp, 0644); module_param(rtw_special_rf_path, int, 0644); @@ -334,6 +460,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); @@ -343,7 +474,8 @@ 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_BEAMFORMING @@ -361,6 +493,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); @@ -371,6 +504,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 @@ -417,6 +554,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"); @@ -433,14 +578,6 @@ uint rtw_adaptivity_mode = CONFIG_RTW_ADAPTIVITY_MODE; module_param(rtw_adaptivity_mode, uint, 0644); MODULE_PARM_DESC(rtw_adaptivity_mode, "0:normal, 1:carrier sense"); -uint rtw_adaptivity_dml = CONFIG_RTW_ADAPTIVITY_DML; -module_param(rtw_adaptivity_dml, uint, 0644); -MODULE_PARM_DESC(rtw_adaptivity_dml, "0:disable, 1:enable"); - -uint rtw_adaptivity_dc_backoff = CONFIG_RTW_ADAPTIVITY_DC_BACKOFF; -module_param(rtw_adaptivity_dc_backoff, uint, 0644); -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"); @@ -507,7 +644,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"); @@ -516,9 +652,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"); +#if 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; @@ -562,6 +700,14 @@ module_param_array(rtw_target_tx_pwr_5g_d, int, &rtw_target_tx_pwr_5g_d_num, 064 MODULE_PARM_DESC(rtw_target_tx_pwr_5g_d, "5G target tx power (unit:dBm) of RF path D for each rate section, should match the real calibrate power, -1: undefined"); #endif /* CONFIG_IEEE80211_BAND_5GHZ */ +int rtw_tsf_update_pause_factor = CONFIG_TSF_UPDATE_PAUSE_FACTOR; +module_param(rtw_tsf_update_pause_factor, int, 0644); +MODULE_PARM_DESC(rtw_tsf_update_pause_factor, "num of bcn intervals to stay TSF update pause status"); + +int rtw_tsf_update_restore_factor = CONFIG_TSF_UPDATE_RESTORE_FACTOR; +module_param(rtw_tsf_update_restore_factor, int, 0644); +MODULE_PARM_DESC(rtw_tsf_update_restore_factor, "num of bcn intervals to stay TSF update restore status"); + #ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE char *rtw_phy_file_path = REALTEK_CONFIG_PATH; module_param(rtw_phy_file_path, charp, 0644); @@ -592,6 +738,41 @@ module_param(rtw_trx_share_mode, int, 0644); MODULE_PARM_DESC(rtw_trx_share_mode, "TRx FIFO Shared"); #endif +#ifdef CONFIG_DYNAMIC_SOML +uint rtw_dynamic_soml_en = 1; +module_param(rtw_dynamic_soml_en, int, 0644); +MODULE_PARM_DESC(rtw_dynamic_soml_en, "0: disable, 1: enable with default param, 2: enable with specified param."); + +uint rtw_dynamic_soml_train_num = 0; +module_param(rtw_dynamic_soml_train_num, int, 0644); +MODULE_PARM_DESC(rtw_dynamic_soml_train_num, "SOML training number"); + +uint rtw_dynamic_soml_interval = 0; +module_param(rtw_dynamic_soml_interval, int, 0644); +MODULE_PARM_DESC(rtw_dynamic_soml_interval, "SOML training interval"); + +uint rtw_dynamic_soml_period = 0; +module_param(rtw_dynamic_soml_period, int, 0644); +MODULE_PARM_DESC(rtw_dynamic_soml_period, "SOML training period"); + +uint rtw_dynamic_soml_delay = 0; +module_param(rtw_dynamic_soml_delay, int, 0644); +MODULE_PARM_DESC(rtw_dynamic_soml_delay, "SOML training delay"); +#endif + +uint rtw_phydm_ability = 0xffffffff; +module_param(rtw_phydm_ability, uint, 0644); + +uint rtw_halrf_ability = 0xffffffff; +module_param(rtw_halrf_ability, uint, 0644); + +#ifdef CONFIG_RTW_MESH +uint rtw_peer_alive_based_preq = 1; +module_param(rtw_peer_alive_based_preq, uint, 0644); +MODULE_PARM_DESC(rtw_peer_alive_based_preq, + "On demand PREQ will reference peer alive status. 0: Off, 1: On"); +#endif + int _netdev_open(struct net_device *pnetdev); int netdev_open(struct net_device *pnetdev); static int netdev_close(struct net_device *pnetdev); @@ -612,11 +793,12 @@ 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; +int rtw_mcc_enable_runtime_duration = 1; +#ifdef CONFIG_MCC_PHYDM_OFFLOAD +int rtw_mcc_phydm_offload = 1; +#else +int rtw_mcc_phydm_offload = 0; +#endif 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); @@ -627,11 +809,7 @@ 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); +module_param(rtw_mcc_phydm_offload, int, 0644); #endif /*CONFIG_MCC_MODE */ #ifdef CONFIG_RTW_NAPI @@ -639,6 +817,10 @@ module_param(rtw_mcc_guard_offset1, 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*/ @@ -647,6 +829,93 @@ 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 RTW_CHANNEL_SWITCH_OFFLOAD +int rtw_ch_switch_offload = 0; +#else +int rtw_ch_switch_offload; +#endif /* RTW_CHANNEL_SWITCH_OFFLOAD */ +module_param(rtw_ch_switch_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_TDMADIG +int rtw_tdmadig_en = 1; +/* +1:MODE_PERFORMANCE +2:MODE_COVERAGE +*/ +int rtw_tdmadig_mode = 1; +int rtw_dynamic_tdmadig = 0; +module_param(rtw_tdmadig_en, int, 0644); +module_param(rtw_tdmadig_mode, int, 0644); +module_param(rtw_dynamic_tdmadig, int, 0644); +#endif/*CONFIG_TDMADIG*/ + +#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); +/* + * 0: common WOWLAN + * bit[0]: disable BB RF + * bit[1]: For wireless remote controller with or without connection + */ +uint rtw_suspend_type = RTW_SUSPEND_TYPE; +module_param(rtw_suspend_type, uint, 0644); +#endif + +#if CONFIG_TX_AC_LIFETIME +static void rtw_regsty_load_tx_ac_lifetime(struct registry_priv *regsty) +{ + int i, j; + struct tx_aclt_conf_t *conf; + uint *parm; + + regsty->tx_aclt_flags = (u8)rtw_tx_aclt_flags; + + for (i = 0; i < TX_ACLT_CONF_NUM; i++) { + conf = ®sty->tx_aclt_confs[i]; + if (i == TX_ACLT_CONF_DEFAULT) + parm = rtw_tx_aclt_conf_default; + #ifdef CONFIG_TX_MCAST2UNI + else if (i == TX_ACLT_CONF_AP_M2U) + parm = rtw_tx_aclt_conf_ap_m2u; + #endif + #ifdef CONFIG_RTW_MESH + else if (i == TX_ACLT_CONF_MESH) + parm = rtw_tx_aclt_conf_mesh; + #endif + else + parm = NULL; + + if (parm) { + conf->en = parm[0] & 0xF; + conf->vo_vi = parm[1]; + conf->be_bk = parm[2]; + } + } +} +#endif + void rtw_regsty_load_target_tx_power(struct registry_priv *regsty) { int path, rs; @@ -696,6 +965,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; @@ -732,16 +1023,29 @@ uint loadparam(_adapter *padapter) registry_par->frag_thresh = (u16)rtw_frag_thresh; registry_par->preamble = (u8)rtw_preamble; registry_par->scan_mode = (u8)rtw_scan_mode; - registry_par->adhoc_tx_pwr = (u8)rtw_adhoc_tx_pwr; - registry_par->soft_ap = (u8)rtw_soft_ap; registry_par->smart_ps = (u8)rtw_smart_ps; 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; + #ifdef CONFIG_TDMADIG + registry_par->tdmadig_en = (u8)rtw_tdmadig_en; + registry_par->tdmadig_mode = (u8)rtw_tdmadig_mode; + registry_par->tdmadig_dynamic = (u8) rtw_dynamic_tdmadig; + registry_par->power_mgnt = PS_MODE_ACTIVE; + registry_par->ips_mode = IPS_NONE; + #else + registry_par->power_mgnt = (u8)rtw_power_mgnt; + registry_par->ips_mode = (u8)rtw_ips_mode; + #endif/*CONFIG_TDMADIG*/ + registry_par->lps_level = (u8)rtw_lps_level; + registry_par->lps_chk_by_tp = (u8)rtw_lps_chk_by_tp; +#ifdef CONFIG_WOWLAN + registry_par->wow_power_mgnt = (u8)rtw_wow_power_mgnt; + registry_par->wow_lps_level = (u8)rtw_wow_lps_level; +#endif /* CONFIG_WOWLAN */ 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; registry_par->busy_thresh = (u16)rtw_busy_thresh; + registry_par->max_bss_cnt = (u16)rtw_max_bss_cnt; /* registry_par->qos_enable = (u8)rtw_qos_enable; */ registry_par->ack_policy = (u8)rtw_ack_policy; registry_par->mp_mode = (u8)rtw_mp_mode; @@ -753,34 +1057,54 @@ 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; +#if CONFIG_TX_AC_LIFETIME + rtw_regsty_load_tx_ac_lifetime(registry_par); +#endif + registry_par->tx_bw_mode = (u8)rtw_tx_bw_mode; #ifdef CONFIG_80211N_HT registry_par->ht_enable = (u8)rtw_ht_enable; - 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->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; + if (registry_par->ht_enable && is_supported_ht(registry_par->wireless_mode)) { + 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->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; +#if defined(CONFIG_CUSTOMER01_SMART_ANTENNA) + rtw_stbc_cap = 0x0; +#elif defined(CONFIG_RTW_TX_2PATH_EN) + rtw_stbc_cap &= ~(BIT1|BIT5); +#endif + registry_par->stbc_cap = (u8)rtw_stbc_cap; +#if defined(CONFIG_RTW_TX_2PATH_EN) + rtw_beamform_cap &= ~(BIT0|BIT2|BIT4); +#endif + 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 DBG_LA_MODE + registry_par->la_mode_en = (u8)rtw_la_mode_en; #endif - #ifdef CONFIG_80211AC_VHT registry_par->vht_enable = (u8)rtw_vht_enable; registry_par->ampdu_factor = (u8)rtw_ampdu_factor; @@ -821,6 +1145,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; @@ -849,9 +1174,6 @@ uint loadparam(_adapter *padapter) #ifdef CONFIG_LAYER2_ROAMING registry_par->max_roaming_times = (u8)rtw_max_roaming_times; -#ifdef CONFIG_INTEL_WIDI - registry_par->max_roaming_times = (u8)rtw_max_roaming_times + 2; -#endif /* CONFIG_INTEL_WIDI */ #endif #ifdef CONFIG_IOL @@ -867,25 +1189,21 @@ 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; +#if 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->tsf_update_pause_factor = (u8)rtw_tsf_update_pause_factor; + registry_par->tsf_update_restore_factor = (u8)rtw_tsf_update_restore_factor; + registry_par->TxBBSwing_2G = (s8)rtw_TxBBSwing_2G; registry_par->TxBBSwing_5G = (s8)rtw_TxBBSwing_5G; registry_par->bEn_RFE = 1; @@ -904,16 +1222,26 @@ uint loadparam(_adapter *padapter) registry_par->adaptivity_en = (u8)rtw_adaptivity_en; registry_par->adaptivity_mode = (u8)rtw_adaptivity_mode; - registry_par->adaptivity_dml = (u8)rtw_adaptivity_dml; - registry_par->adaptivity_dc_backoff = (u8)rtw_adaptivity_dc_backoff; registry_par->adaptivity_th_l2h_ini = (s8)rtw_adaptivity_th_l2h_ini; registry_par->adaptivity_th_edcca_hl_diff = (s8)rtw_adaptivity_th_edcca_hl_diff; +#ifdef CONFIG_DYNAMIC_SOML + registry_par->dyn_soml_en = (u8)rtw_dynamic_soml_en; + registry_par->dyn_soml_train_num = (u8)rtw_dynamic_soml_train_num; + registry_par->dyn_soml_interval = (u8)rtw_dynamic_soml_interval; + registry_par->dyn_soml_period = (u8)rtw_dynamic_soml_period; + registry_par->dyn_soml_delay = (u8)rtw_dynamic_soml_delay; +#endif + 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; @@ -935,22 +1263,29 @@ uint loadparam(_adapter *padapter) 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; + registry_par->rtw_mcc_enable_runtime_duration = rtw_mcc_enable_runtime_duration; + registry_par->rtw_mcc_phydm_offload = rtw_mcc_phydm_offload; #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; + registry_par->suspend_type = rtw_suspend_type; #endif #ifdef CONFIG_SUPPORT_TRX_SHARED registry_par->trx_share_mode = rtw_trx_share_mode; #endif + registry_par->wowlan_sta_mix_mode = rtw_wowlan_sta_mix_mode; + +#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) { @@ -960,6 +1295,30 @@ uint loadparam(_adapter *padapter) #endif /* CONFIG_RTW_GRO */ #endif /* CONFIG_RTW_NAPI */ + registry_par->iqk_fw_offload = (u8)rtw_iqk_fw_offload; + registry_par->ch_switch_offload = (u8)rtw_ch_switch_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 +#ifdef CONFIG_FW_HANDLE_TXBCN + registry_par->fw_tbtt_rpt = rtw_tbtt_rpt; +#endif + registry_par->phydm_ability = rtw_phydm_ability; + registry_par->halrf_ability = rtw_halrf_ability; +#ifdef CONFIG_RTW_MESH + registry_par->peer_alive_based_preq = rtw_peer_alive_based_preq; +#endif return status; } @@ -1101,7 +1460,11 @@ unsigned int rtw_classify8021d(struct sk_buff *skb) static u16 rtw_select_queue(struct net_device *dev, struct sk_buff *skb #if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 13, 0) + #if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 19, 0) + , struct net_device *sb_dev + #else , void *accel_priv + #endif #if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0) , select_queue_fallback_t fallback #endif @@ -1148,39 +1511,53 @@ 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; + #ifdef CONFIG_NEW_NETDEV_HDL + case NETDEV_PRE_UP : + { + _adapter *adapter = rtw_netdev_priv(ndev); + + rtw_pwr_wakeup(adapter); + } + break; + #endif } return NOTIFY_DONE; @@ -1200,7 +1577,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); @@ -1241,24 +1617,13 @@ static const struct net_device_ops rtw_netdev_ops = { int rtw_init_netdev_name(struct net_device *pnetdev, const char *ifname) { - _adapter *padapter = rtw_netdev_priv(pnetdev); - #ifdef CONFIG_EASY_REPLACEMENT + _adapter *padapter = rtw_netdev_priv(pnetdev); struct net_device *TargetNetdev = NULL; _adapter *TargetAdapter = NULL; - struct net *devnet = NULL; if (padapter->bDongle == 1) { -#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 24)) - TargetNetdev = dev_get_by_name("wlan0"); -#else -#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 26)) - devnet = pnetdev->nd_net; -#else - devnet = dev_net(pnetdev); -#endif - TargetNetdev = dev_get_by_name(devnet, "wlan0"); -#endif + TargetNetdev = rtw_get_same_net_ndev_by_name(pnetdev, "wlan0"); if (TargetNetdev) { RTW_INFO("Force onboard module driver disappear !!!\n"); TargetAdapter = rtw_netdev_priv(TargetNetdev); @@ -1279,7 +1644,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; @@ -1331,10 +1696,27 @@ struct net_device *rtw_init_netdev(_adapter *old_padapter) rtw_hook_vir_if_ops(pnetdev); #endif /* CONFIG_CONCURRENT_MODE */ -#ifdef CONFIG_TCP_CSUM_OFFLOAD_TX - pnetdev->features |= NETIF_F_IP_CSUM; + +#ifdef CONFIG_TX_CSUM_OFFLOAD + pnetdev->features |= (NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM); +#if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 39) + pnetdev->hw_features |= (NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM); +#endif #endif +#ifdef CONFIG_RTW_NETIF_SG + pnetdev->features |= NETIF_F_SG; +#if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 39) + pnetdev->hw_features |= NETIF_F_SG; +#endif +#endif + + if ((pnetdev->features & NETIF_F_SG) && (pnetdev->features & NETIF_F_IP_CSUM)) { + pnetdev->features |= (NETIF_F_TSO | NETIF_F_GSO); +#if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 39) + pnetdev->hw_features |= (NETIF_F_TSO | NETIF_F_GSO); +#endif + } /* pnetdev->tx_timeout = NULL; */ pnetdev->watchdog_timeo = HZ * 3; /* 3 second timeout */ @@ -1392,6 +1774,12 @@ void rtw_os_ndev_free(_adapter *adapter) rtw_cfg80211_ndev_res_free(adapter); #endif + /* free the old_pnetdev */ + if (adapter->rereg_nd_name_priv.old_pnetdev) { + rtw_free_netdev(adapter->rereg_nd_name_priv.old_pnetdev); + adapter->rereg_nd_name_priv.old_pnetdev = NULL; + } + if (adapter->pnetdev) { rtw_free_netdev(adapter->pnetdev); adapter->pnetdev = NULL; @@ -1416,7 +1804,9 @@ int rtw_os_ndev_register(_adapter *adapter, const char *name) goto exit; } #endif - +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 19, 0)) && defined(CONFIG_PCI_HCI) + ndev->gro_flush_timeout = 100000; +#endif /* alloc netdev name */ rtw_init_netdev_name(ndev, name); @@ -1616,39 +2006,60 @@ u32 rtw_start_drv_threads(_adapter *padapter) { u32 _status = _SUCCESS; + RTW_INFO(FUNC_ADPT_FMT" enter\n", FUNC_ADPT_ARG(padapter)); #ifdef CONFIG_XMIT_THREAD_MODE #if defined(CONFIG_SDIO_HCI) if (is_primary_adapter(padapter)) #endif { - padapter->xmitThread = kthread_run(rtw_xmit_thread, padapter, "RTW_XMIT_THREAD"); - if (IS_ERR(padapter->xmitThread)) - _status = _FAIL; + if (padapter->xmitThread == NULL) { + RTW_INFO(FUNC_ADPT_FMT " start RTW_XMIT_THREAD\n", FUNC_ADPT_ARG(padapter)); + padapter->xmitThread = kthread_run(rtw_xmit_thread, padapter, "RTW_XMIT_THREAD"); + if (IS_ERR(padapter->xmitThread)) { + padapter->xmitThread = NULL; + _status = _FAIL; + } + } } #endif /* #ifdef CONFIG_XMIT_THREAD_MODE */ #ifdef CONFIG_RECV_THREAD_MODE if (is_primary_adapter(padapter)) { - padapter->recvThread = kthread_run(rtw_recv_thread, padapter, "RTW_RECV_THREAD"); - if (IS_ERR(padapter->recvThread)) - _status = _FAIL; + if (padapter->recvThread == NULL) { + RTW_INFO(FUNC_ADPT_FMT " start RTW_RECV_THREAD\n", FUNC_ADPT_ARG(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)) - _status = _FAIL; - else - _rtw_down_sema(&padapter->cmdpriv.terminate_cmdthread_sema); /* wait for cmd_thread to run */ + if (padapter->cmdThread == NULL) { + RTW_INFO(FUNC_ADPT_FMT " start RTW_CMD_THREAD\n", FUNC_ADPT_ARG(padapter)); + padapter->cmdThread = kthread_run(rtw_cmd_thread, padapter, "RTW_CMD_THREAD"); + if (IS_ERR(padapter->cmdThread)) { + padapter->cmdThread = NULL; + _status = _FAIL; + } + else + _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)) - _status = _FAIL; + if (padapter->evtThread == NULL) { + RTW_INFO(FUNC_ADPT_FMT " start RTW_EVENT_THREAD\n", FUNC_ADPT_ARG(padapter)); + padapter->evtThread = kthread_run(event_thread, padapter, "RTW_EVENT_THREAD"); + if (IS_ERR(padapter->evtThread)) { + padapter->evtThread = NULL; + _status = _FAIL; + } + } #endif rtw_hal_start_thread(padapter); @@ -1658,14 +2069,16 @@ u32 rtw_start_drv_threads(_adapter *padapter) void rtw_stop_drv_threads(_adapter *padapter) { - + RTW_INFO(FUNC_ADPT_FMT" enter\n", FUNC_ADPT_ARG(padapter)); if (is_primary_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 @@ -1675,29 +2088,31 @@ 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 - if (is_primary_adapter(padapter)) { + if (is_primary_adapter(padapter) && padapter->recvThread) { /* Below is to termindate rx_thread... */ _rtw_up_sema(&padapter->recvpriv.recv_sema); - _rtw_down_sema(&padapter->recvpriv.terminate_recvthread_sema); + rtw_thread_stop(padapter->recvThread); + padapter->recvThread = NULL; } #endif rtw_hal_stop_thread(padapter); } -u8 rtw_init_default_value(_adapter *padapter); u8 rtw_init_default_value(_adapter *padapter) { u8 ret = _SUCCESS; struct registry_priv *pregistrypriv = &padapter->registrypriv; struct xmit_priv *pxmitpriv = &padapter->xmitpriv; - struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct security_priv *psecuritypriv = &padapter->securitypriv; /* xmit_priv */ @@ -1742,6 +2157,11 @@ u8 rtw_init_default_value(_adapter *padapter) /* hal_priv */ rtw_hal_def_value_init(padapter); +#ifdef CONFIG_MCC_MODE + /* MCC parameter */ + rtw_hal_mcc_parameter_init(padapter); +#endif /* CONFIG_MCC_MODE */ + /* misc. */ RTW_ENABLE_FUNC(padapter, DF_RX_BIT); RTW_ENABLE_FUNC(padapter, DF_TX_BIT); @@ -1758,7 +2178,9 @@ u8 rtw_init_default_value(_adapter *padapter) 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; @@ -1770,6 +2192,7 @@ u8 rtw_init_default_value(_adapter *padapter) 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; @@ -1779,19 +2202,24 @@ u8 rtw_init_default_value(_adapter *padapter) #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); -} +#ifdef CONFIG_CLIENT_PORT_CFG +extern void rtw_clt_port_init(struct clt_port_t *cltp); +extern void rtw_clt_port_deinit(struct clt_port_t *cltp); #endif struct dvobj_priv *devobj_init(void) @@ -1807,10 +2235,13 @@ struct dvobj_priv *devobj_init(void) _rtw_mutex_init(&pdvobj->setch_mutex); _rtw_mutex_init(&pdvobj->setbw_mutex); _rtw_mutex_init(&pdvobj->rf_read_reg_mutex); + _rtw_mutex_init(&pdvobj->ioctrl_mutex); #ifdef CONFIG_SDIO_INDIRECT_ACCESS _rtw_mutex_init(&pdvobj->sd_indirect_access_mutex); #endif - +#ifdef CONFIG_SYSON_INDIRECT_ACCESS + _rtw_mutex_init(&pdvobj->syson_indirect_access_mutex); +#endif #ifdef CONFIG_RTW_CUSTOMER_STR _rtw_mutex_init(&pdvobj->customer_str_mutex); _rtw_memset(pdvobj->customer_str, 0xFF, RTW_CUSTOMER_STR_LEN); @@ -1821,6 +2252,9 @@ struct dvobj_priv *devobj_init(void) ATOMIC_SET(&pdvobj->disable_func, 0); rtw_macid_ctl_init(&pdvobj->macid_ctl); +#ifdef CONFIG_CLIENT_PORT_CFG + rtw_clt_port_init(&pdvobj->clt_port); +#endif _rtw_spinlock_init(&pdvobj->cam_ctl.lock); _rtw_mutex_init(&pdvobj->cam_ctl.sec_cam_access_mutex); #if defined(RTK_129X_PLATFORM) && defined(CONFIG_PCI_HCI) @@ -1831,21 +2265,39 @@ struct dvobj_priv *devobj_init(void) #endif #ifdef CONFIG_AP_MODE + #ifdef CONFIG_SUPPORT_MULTI_BCN pdvobj->nr_ap_if = 0; 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); -#endif + pdvobj->vap_map = 0; + #endif /*CONFIG_SUPPORT_MULTI_BCN*/ + #ifdef CONFIG_SWTIMER_BASED_TXBCN + 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); + rtw_init_timer(&(pdvobj->periodic_tsf_update_end_timer), NULL, rtw_hal_periodic_tsf_update_end_timer_hdl, pdvobj); #ifdef CONFIG_MCC_MODE _rtw_mutex_init(&(pdvobj->mcc_objpriv.mcc_mutex)); + _rtw_mutex_init(&(pdvobj->mcc_objpriv.mcc_tsf_req_mutex)); + _rtw_mutex_init(&(pdvobj->mcc_objpriv.mcc_dbg_reg_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 */ + + +#ifdef CONFIG_RTW_TPT_MODE + pdvobj->tpt_mode = 0; + pdvobj->edca_be_ul = 0x5ea42b; + pdvobj->edca_be_dl = 0x00a42b; +#endif + pdvobj->scan_deny = _FALSE; + return pdvobj; } @@ -1862,6 +2314,8 @@ void devobj_deinit(struct dvobj_priv *pdvobj) #ifdef CONFIG_MCC_MODE _rtw_mutex_free(&(pdvobj->mcc_objpriv.mcc_mutex)); + _rtw_mutex_free(&(pdvobj->mcc_objpriv.mcc_tsf_req_mutex)); + _rtw_mutex_free(&(pdvobj->mcc_objpriv.mcc_dbg_reg_mutex)); _rtw_spinlock_free(&pdvobj->mcc_objpriv.mcc_lock); #endif /* CONFIG_MCC_MODE */ @@ -1875,11 +2329,19 @@ void devobj_deinit(struct dvobj_priv *pdvobj) _rtw_mutex_free(&pdvobj->setch_mutex); _rtw_mutex_free(&pdvobj->setbw_mutex); _rtw_mutex_free(&pdvobj->rf_read_reg_mutex); + _rtw_mutex_free(&pdvobj->ioctrl_mutex); #ifdef CONFIG_SDIO_INDIRECT_ACCESS _rtw_mutex_free(&pdvobj->sd_indirect_access_mutex); #endif +#ifdef CONFIG_SYSON_INDIRECT_ACCESS + _rtw_mutex_free(&pdvobj->syson_indirect_access_mutex); +#endif rtw_macid_ctl_deinit(&pdvobj->macid_ctl); +#ifdef CONFIG_CLIENT_PORT_CFG + rtw_clt_port_deinit(&pdvobj->clt_port); +#endif + _rtw_spinlock_free(&pdvobj->cam_ctl.lock); _rtw_mutex_free(&pdvobj->cam_ctl.sec_cam_access_mutex); @@ -1889,9 +2351,9 @@ void devobj_deinit(struct dvobj_priv *pdvobj) #ifdef CONFIG_MBSSID_CAM rtw_mbid_cam_deinit(pdvobj); #endif - +#ifdef CONFIG_SUPPORT_MULTI_BCN _rtw_spinlock_free(&(pdvobj->ap_if_q.lock)); - +#endif rtw_mfree((u8 *)pdvobj, sizeof(*pdvobj)); } @@ -1936,15 +2398,11 @@ u8 rtw_reset_drv_sw(_adapter *padapter) struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); /* hal_priv */ - if (is_primary_adapter(padapter)) - rtw_hal_def_value_init(padapter); + rtw_hal_def_value_init(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; @@ -1983,12 +2441,59 @@ u8 rtw_reset_drv_sw(_adapter *padapter) u8 rtw_init_drv_sw(_adapter *padapter) { - u8 ret8 = _SUCCESS; +#ifdef CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI + struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); +#endif - + #if defined(CONFIG_AP_MODE) && defined(CONFIG_SUPPORT_MULTI_BCN) _rtw_init_listhead(&padapter->list); + #ifdef CONFIG_FW_HANDLE_TXBCN + padapter->vap_id = CONFIG_LIMITED_AP_NUM; + if (is_primary_adapter(padapter)) + adapter_to_dvobj(padapter)->vap_tbtt_rpt_map = adapter_to_regsty(padapter)->fw_tbtt_rpt; + #endif + #endif + + #ifdef CONFIG_CLIENT_PORT_CFG + padapter->client_id = MAX_CLIENT_PORT_NUM; + padapter->client_port = CLT_PORT_INVALID; + #endif + + if (is_primary_adapter(padapter)) { + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + struct hal_spec_t *hal_spec = GET_HAL_SPEC(padapter); + + dvobj->macid_ctl.num = rtw_min(hal_spec->macid_num, MACID_NUM_SW_LIMIT); + dvobj->macid_ctl.macid_cap = hal_spec->macid_cap; + dvobj->macid_ctl.macid_txrpt = hal_spec->macid_txrpt; + dvobj->macid_ctl.macid_txrpt_pgsz = hal_spec->macid_txrpt_pgsz; + dvobj->cam_ctl.sec_cap = hal_spec->sec_cap; + dvobj->cam_ctl.num = rtw_min(hal_spec->sec_cam_ent_num, SEC_CAM_ENT_NUM_SW_LIMIT); + + #if CONFIG_TX_AC_LIFETIME + { + struct registry_priv *regsty = adapter_to_regsty(padapter); + int i; + + dvobj->tx_aclt_flags = regsty->tx_aclt_flags; + for (i = 0; i < TX_ACLT_CONF_NUM; i++) { + dvobj->tx_aclt_confs[i].en = regsty->tx_aclt_confs[i].en; + dvobj->tx_aclt_confs[i].vo_vi + = regsty->tx_aclt_confs[i].vo_vi / (hal_spec->tx_aclt_unit_factor * 32); + if (dvobj->tx_aclt_confs[i].vo_vi > 0xFFFF) + dvobj->tx_aclt_confs[i].vo_vi = 0xFFFF; + dvobj->tx_aclt_confs[i].be_bk + = regsty->tx_aclt_confs[i].be_bk / (hal_spec->tx_aclt_unit_factor * 32); + if (dvobj->tx_aclt_confs[i].be_bk > 0xFFFF) + dvobj->tx_aclt_confs[i].be_bk = 0xFFFF; + } + + dvobj->tx_aclt_force_val.en = 0xFF; + } + #endif + } ret8 = rtw_init_default_value(padapter); @@ -2004,7 +2509,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; @@ -2037,6 +2543,10 @@ u8 rtw_init_drv_sw(_adapter *padapter) } #endif /* CONFIG_TDLS */ +#ifdef CONFIG_RTW_MESH + rtw_mesh_cfg_init(padapter); +#endif + if (_rtw_init_xmit_priv(&padapter->xmitpriv, padapter) == _FAIL) { RTW_INFO("Can't _rtw_init_xmit_priv\n"); ret8 = _FAIL; @@ -2054,15 +2564,12 @@ 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; goto exit; } - padapter->stapriv.padapter = padapter; padapter->setband = WIFI_FREQUENCY_BAND_AUTO; padapter->fix_rate = 0xFF; padapter->power_offset = 0; @@ -2090,21 +2597,13 @@ 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 rtw_hal_sreset_init(padapter); #endif -#ifdef CONFIG_INTEL_WIDI - if (rtw_init_intel_widi(padapter) == _FAIL) { - RTW_INFO("Can't rtw_init_intel_widi\n"); - ret8 = _FAIL; - goto exit; - } -#endif /* CONFIG_INTEL_WIDI */ - #ifdef CONFIG_WAPI_SUPPORT padapter->WapiSupport = true; /* set true temp, will revise according to Efuse or Registry value later. */ rtw_wapi_init(padapter); @@ -2120,6 +2619,18 @@ u8 rtw_init_drv_sw(_adapter *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 + +#ifdef CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI + memset(pwdev_priv->pno_mac_addr, 0xFF, ETH_ALEN); +#endif + exit: @@ -2140,21 +2651,18 @@ 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 - _cancel_timer_ex(&padapter->mlmepriv.dfs_master_timer); + _cancel_timer_ex(&adapter_to_rfctl(padapter)->radar_detect_timer); #endif _cancel_timer_ex(&adapter_to_dvobj(padapter)->dynamic_chk_timer); - + _cancel_timer_ex(&adapter_to_dvobj(padapter)->periodic_tsf_update_end_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 @@ -2222,22 +2730,25 @@ u8 rtw_free_drv_sw(_adapter *padapter) _rtw_spinlock_free(&padapter->br_ext_lock); #endif /* CONFIG_BR_EXT */ -#ifdef CONFIG_INTEL_WIDI - rtw_free_intel_widi(padapter); -#endif /* CONFIG_INTEL_WIDI */ - free_mlme_ext_priv(&padapter->mlmeextpriv); #ifdef CONFIG_TDLS /* 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); @@ -2250,19 +2761,8 @@ 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); - - /* free the old_pnetdev */ - if (padapter->rereg_nd_name_priv.old_pnetdev) { - free_netdev(padapter->rereg_nd_name_priv.old_pnetdev); - padapter->rereg_nd_name_priv.old_pnetdev = NULL; - } - return _SUCCESS; } @@ -2278,6 +2778,7 @@ void rtw_intf_stop(_adapter *adapter) } #ifdef CONFIG_CONCURRENT_MODE +#ifndef CONFIG_NEW_NETDEV_HDL int _netdev_vir_if_open(struct net_device *pnetdev) { _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); @@ -2319,7 +2820,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 @@ -2364,7 +2864,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; @@ -2413,13 +2913,19 @@ static int netdev_vir_if_close(struct net_device *pnetdev) return 0; } +#endif /*#ifndef CONFIG_NEW_NETDEV_HDL*/ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) static const struct net_device_ops rtw_netdev_vir_if_ops = { .ndo_init = rtw_ndev_init, .ndo_uninit = rtw_ndev_uninit, + #ifdef CONFIG_NEW_NETDEV_HDL + .ndo_open = netdev_open, + .ndo_stop = netdev_close, + #else .ndo_open = netdev_vir_if_open, .ndo_stop = netdev_vir_if_close, + #endif .ndo_start_xmit = rtw_xmit_entry, .ndo_set_mac_address = rtw_net_set_mac_address, .ndo_get_stats = rtw_net_get_stats, @@ -2437,8 +2943,14 @@ static void rtw_hook_vir_if_ops(struct net_device *ndev) #else ndev->init = rtw_ndev_init; ndev->uninit = rtw_ndev_uninit; + #ifdef CONFIG_NEW_NETDEV_HDL + ndev->open = netdev_open; + ndev->stop = netdev_close; + #else ndev->open = netdev_vir_if_open; ndev->stop = netdev_vir_if_close; + #endif + ndev->set_mac_address = rtw_net_set_mac_address; #endif } @@ -2515,6 +3027,10 @@ _adapter *rtw_drv_add_vir_if(_adapter *primary_padapter, #ifdef CONFIG_P2P rtw_init_wifidirect_addrs(padapter, adapter_mac_addr(padapter), adapter_mac_addr(padapter)); #endif + + rtw_led_set_ctl_en_mask_virtual(padapter); + rtw_led_set_iface_en(padapter, 1); + res = _SUCCESS; free_drv_sw: @@ -2536,14 +3052,15 @@ void rtw_drv_stop_vir_if(_adapter *padapter) if (padapter == NULL) return; + RTW_INFO(FUNC_ADPT_FMT" enter\n", FUNC_ADPT_ARG(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); @@ -2558,11 +3075,14 @@ void rtw_drv_stop_vir_if(_adapter *padapter) #endif rtw_intf_stop(padapter); - + #ifndef CONFIG_NEW_NETDEV_HDL rtw_stop_drv_threads(padapter); - + #endif padapter->bup = _FALSE; } + #ifdef CONFIG_NEW_NETDEV_HDL + rtw_stop_drv_threads(padapter); + #endif /* cancel timer after thread stop */ rtw_cancel_all_timer(padapter); } @@ -2598,24 +3118,139 @@ void rtw_drv_free_vir_ifaces(struct dvobj_priv *dvobj) rtw_drv_free_vir_if(dvobj->padapters[i]); } -void rtw_drv_del_vir_if(_adapter *padapter) -{ - rtw_drv_stop_vir_if(padapter); - rtw_drv_free_vir_if(padapter); -} - -void rtw_drv_del_vir_ifaces(_adapter *primary_padapter) -{ - int i; - struct dvobj_priv *dvobj = primary_padapter->dvobj; - - for (i = VIF_START_ID; i < dvobj->iface_nums; i++) - rtw_drv_del_vir_if(dvobj->padapters[i]); - -} #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 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; @@ -2741,37 +3376,29 @@ void netdev_br_init(struct net_device *netdev) #if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35)) rcu_read_lock(); -#endif /* (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35)) */ +#endif /* if(check_fwstate(pmlmepriv, WIFI_STATION_STATE|WIFI_ADHOC_STATE) == _TRUE) */ { /* struct net_bridge *br = netdev->br_port->br; */ /* ->dev->dev_addr; */ -#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) + #if (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) if (netdev->br_port) -#else /* (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) */ + #else if (rcu_dereference(adapter->pnetdev->rx_handler_data)) -#endif /* (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) */ + #endif { struct net_device *br_netdev; -#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 24)) - br_netdev = dev_get_by_name(CONFIG_BR_EXT_BRNAME); -#else /* (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 24)) */ - struct net *devnet = NULL; - -#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 26)) - devnet = netdev->nd_net; -#else /* (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 26)) */ - devnet = dev_net(netdev); -#endif /* (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 26)) */ - - br_netdev = dev_get_by_name(devnet, CONFIG_BR_EXT_BRNAME); -#endif /* (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 24)) */ + br_netdev = rtw_get_bridge_ndev_by_name(CONFIG_BR_EXT_BRNAME); if (br_netdev) { memcpy(adapter->br_mac, br_netdev->dev_addr, ETH_ALEN); dev_put(br_netdev); - } else - printk("%s()-%d: dev_get_by_name(%s) failed!", __FUNCTION__, __LINE__, CONFIG_BR_EXT_BRNAME); + RTW_INFO(FUNC_NDEV_FMT" bind bridge dev "NDEV_FMT"("MAC_FMT")\n" + , FUNC_NDEV_ARG(netdev), NDEV_ARG(br_netdev), MAC_ARG(br_netdev->dev_addr)); + } else { + RTW_INFO(FUNC_NDEV_FMT" can't get bridge dev by name \"%s\"\n" + , FUNC_NDEV_ARG(netdev), CONFIG_BR_EXT_BRNAME); + } } adapter->ethBrExtInfo.addPPPoETag = 1; @@ -2779,10 +3406,121 @@ void netdev_br_init(struct net_device *netdev) #if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35)) rcu_read_unlock(); -#endif /* (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 35)) */ +#endif } #endif /* CONFIG_BR_EXT */ +#ifdef CONFIG_NEW_NETDEV_HDL +int _netdev_open(struct net_device *pnetdev) +{ + uint status; + _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); + struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); + + RTW_INFO(FUNC_NDEV_FMT" start\n", FUNC_NDEV_ARG(pnetdev)); + + #ifdef CONFIG_AUTOSUSPEND + if (pwrctrlpriv->ps_flag == _TRUE) { + padapter->net_closed = _FALSE; + goto netdev_open_normal_process; + } + #endif /*CONFIG_AUTOSUSPEND*/ + + if (!rtw_is_hw_init_completed(padapter)) { // ips + rtw_clr_surprise_removed(padapter); + rtw_clr_drv_stopped(padapter); + RTW_ENABLE_FUNC(padapter, DF_RX_BIT); + RTW_ENABLE_FUNC(padapter, DF_TX_BIT); + status = rtw_hal_init(padapter); + if (status == _FAIL) + goto netdev_open_error; + rtw_led_control(padapter, LED_CTL_NO_LINK); + #ifndef RTW_HALMAC + status = rtw_mi_start_drv_threads(padapter); + if (status == _FAIL) { + RTW_ERR(FUNC_NDEV_FMT "Initialize driver thread failed!\n", FUNC_NDEV_ARG(pnetdev)); + goto netdev_open_error; + } + + rtw_intf_start(GET_PRIMARY_ADAPTER(padapter)); + #endif /* !RTW_HALMAC */ + + { + #ifdef CONFIG_BT_COEXIST_SOCKET_TRX + _adapter *prim_adpt = GET_PRIMARY_ADAPTER(padapter); + + if (prim_adpt && (_TRUE == prim_adpt->EEPROMBluetoothCoexist)) { + rtw_btcoex_init_socket(prim_adpt); + prim_adpt->coex_info.BtMgnt.ExtConfig.HCIExtensionVer = 0x04; + rtw_btcoex_SetHciVersion(prim_adpt, 0x04); + } + #endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ + + _set_timer(&adapter_to_dvobj(padapter)->dynamic_chk_timer, 2000); + + #ifndef CONFIG_IPS_CHECK_IN_WD + rtw_set_pwr_state_check_timer(pwrctrlpriv); + #endif /*CONFIG_IPS_CHECK_IN_WD*/ + } + + } + + /*if (padapter->bup == _FALSE) */ + { + rtw_hal_iface_init(padapter); + + #ifdef CONFIG_RTW_NAPI + if(padapter->napi_state == NAPI_DISABLE) { + napi_enable(&padapter->napi); + padapter->napi_state = NAPI_ENABLE; + } + #endif + + #ifdef CONFIG_IOCTL_CFG80211 + rtw_cfg80211_init_wiphy(padapter); + rtw_cfg80211_init_wdev_data(padapter); + #endif + /* rtw_netif_carrier_on(pnetdev); */ /* call this func when rtw_joinbss_event_callback return success */ + rtw_netif_wake_queue(pnetdev); + + #ifdef CONFIG_BR_EXT + if (is_primary_adapter(padapter)) + netdev_br_init(pnetdev); + #endif /* CONFIG_BR_EXT */ + + + padapter->bup = _TRUE; + padapter->net_closed = _FALSE; + padapter->netif_up = _TRUE; + pwrctrlpriv->bips_processing = _FALSE; + } + +#ifdef CONFIG_AUTOSUSPEND +netdev_open_normal_process: +#endif + RTW_INFO(FUNC_NDEV_FMT" Success (bup=%d)\n", FUNC_NDEV_ARG(pnetdev), padapter->bup); + return 0; + +netdev_open_error: + padapter->bup = _FALSE; + + #ifdef CONFIG_RTW_NAPI + if(padapter->napi_state == NAPI_ENABLE) { + napi_disable(&padapter->napi); + padapter->napi_state = NAPI_DISABLE; + } + #endif + + rtw_netif_carrier_off(pnetdev); + rtw_netif_stop_queue(pnetdev); + + RTW_ERR(FUNC_NDEV_FMT" Failed!! (bup=%d)\n", FUNC_NDEV_ARG(pnetdev), padapter->bup); + + return -1; + +} + +#else int _netdev_open(struct net_device *pnetdev) { uint status; @@ -2801,10 +3539,12 @@ int _netdev_open(struct net_device *pnetdev) 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 @@ -2829,11 +3569,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) { @@ -2842,10 +3584,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); @@ -2871,7 +3612,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 @@ -2887,8 +3628,9 @@ int _netdev_open(struct net_device *pnetdev) RTW_INFO("CONFIG_BT_COEXIST: VIRTUAL_ADAPTER\n"); #endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ - +#ifdef CONFIG_AUTOSUSPEND netdev_open_normal_process: +#endif #ifdef CONFIG_CONCURRENT_MODE { @@ -2901,6 +3643,15 @@ int _netdev_open(struct net_device *pnetdev) } #endif +#ifdef CONFIG_RTW_CFGVEDNOR_LLSTATS + pwrctrlpriv->radio_on_start_time = rtw_get_current_time(); + pwrctrlpriv->pwr_saving_start_time = rtw_get_current_time(); + pwrctrlpriv->pwr_saving_time = 0; + pwrctrlpriv->on_time = 0; + pwrctrlpriv->tx_time = 0; + pwrctrlpriv->rx_time = 0; +#endif /* CONFIG_RTW_CFGVEDNOR_LLSTATS */ + RTW_INFO("-871x_drv - drv_open, bup=%d\n", padapter->bup); return 0; @@ -2916,7 +3667,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); @@ -2924,7 +3675,7 @@ int _netdev_open(struct net_device *pnetdev) return -1; } - +#endif int netdev_open(struct net_device *pnetdev) { int ret = _FALSE; @@ -2937,11 +3688,15 @@ int netdev_open(struct net_device *pnetdev) } _enter_critical_mutex(&(adapter_to_dvobj(padapter)->hw_init_mutex), NULL); +#ifdef CONFIG_NEW_NETDEV_HDL + ret = _netdev_open(pnetdev); +#else if (is_primary_adapter(padapter)) ret = _netdev_open(pnetdev); #ifdef CONFIG_CONCURRENT_MODE else ret = _netdev_vir_if_open(pnetdev); +#endif #endif _exit_critical_mutex(&(adapter_to_dvobj(padapter)->hw_init_mutex), NULL); @@ -2967,15 +3722,26 @@ int ips_netdrv_open(_adapter *padapter) rtw_clr_drv_stopped(padapter); /* padapter->bup = _TRUE; */ - +#ifdef CONFIG_NEW_NETDEV_HDL + if (!rtw_is_hw_init_completed(padapter)) { + status = rtw_hal_init(padapter); + if (status == _FAIL) { + goto netdev_open_error; + } + rtw_mi_hal_iface_init(padapter); + } +#else status = rtw_hal_init(padapter); if (status == _FAIL) { goto netdev_open_error; } -#if 0 - rtw_restore_mac_addr(padapter); #endif +#if 0 + rtw_mi_set_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)); @@ -2991,15 +3757,16 @@ int ips_netdrv_open(_adapter *padapter) return _FAIL; } - int rtw_ips_pwr_up(_adapter *padapter) { int result; - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); +#if defined(CONFIG_SWLPS_IN_IPS) || defined(CONFIG_FWLPS_IN_IPS) #ifdef DBG_CONFIG_ERROR_DETECT + PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); struct sreset_priv *psrtpriv = &pHalData->srestpriv; #endif/* #ifdef DBG_CONFIG_ERROR_DETECT */ - u32 start_time = rtw_get_current_time(); +#endif /* defined(CONFIG_SWLPS_IN_IPS) || defined(CONFIG_FWLPS_IN_IPS) */ + 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) @@ -3020,7 +3787,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; @@ -3031,12 +3798,12 @@ void rtw_ips_pwr_down(_adapter *padapter) #endif void rtw_ips_dev_unload(_adapter *padapter) { - struct net_device *pnetdev = (struct net_device *)padapter->pnetdev; - struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); +#if defined(CONFIG_SWLPS_IN_IPS) || defined(CONFIG_FWLPS_IN_IPS) #ifdef DBG_CONFIG_ERROR_DETECT + PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); struct sreset_priv *psrtpriv = &pHalData->srestpriv; #endif/* #ifdef DBG_CONFIG_ERROR_DETECT */ +#endif /* defined(CONFIG_SWLPS_IN_IPS) || defined(CONFIG_FWLPS_IN_IPS) */ RTW_INFO("====> %s...\n", __FUNCTION__); @@ -3054,8 +3821,98 @@ void rtw_ips_dev_unload(_adapter *padapter) rtw_hal_deinit(padapter); } +#ifdef CONFIG_NEW_NETDEV_HDL +int _pm_netdev_open(_adapter *padapter) +{ + uint status; + struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); + struct net_device *pnetdev = padapter->pnetdev; + RTW_INFO(FUNC_NDEV_FMT" start\n", FUNC_NDEV_ARG(pnetdev)); + #ifdef CONFIG_AUTOSUSPEND + if (pwrctrlpriv->ps_flag == _TRUE) { + padapter->net_closed = _FALSE; + goto netdev_open_normal_process; + } + #endif /*CONFIG_AUTOSUSPEND*/ + + if (!rtw_is_hw_init_completed(padapter)) { // ips + rtw_clr_surprise_removed(padapter); + rtw_clr_drv_stopped(padapter); + status = rtw_hal_init(padapter); + if (status == _FAIL) + goto netdev_open_error; + rtw_led_control(padapter, LED_CTL_NO_LINK); + #ifndef RTW_HALMAC + status = rtw_mi_start_drv_threads(padapter); + if (status == _FAIL) { + RTW_ERR(FUNC_NDEV_FMT "Initialize driver thread failed!\n", FUNC_NDEV_ARG(pnetdev)); + goto netdev_open_error; + } + + rtw_intf_start(GET_PRIMARY_ADAPTER(padapter)); + #endif /* !RTW_HALMAC */ + + { + _set_timer(&adapter_to_dvobj(padapter)->dynamic_chk_timer, 2000); + + #ifndef CONFIG_IPS_CHECK_IN_WD + rtw_set_pwr_state_check_timer(pwrctrlpriv); + #endif /*CONFIG_IPS_CHECK_IN_WD*/ + } + + } + + /*if (padapter->bup == _FALSE) */ + { + rtw_hal_iface_init(padapter); + + padapter->bup = _TRUE; + padapter->net_closed = _FALSE; + padapter->netif_up = _TRUE; + pwrctrlpriv->bips_processing = _FALSE; + } + +#ifdef CONFIG_AUTOSUSPEND +netdev_open_normal_process: +#endif + RTW_INFO(FUNC_NDEV_FMT" Success (bup=%d)\n", FUNC_NDEV_ARG(pnetdev), padapter->bup); + return 0; + +netdev_open_error: + padapter->bup = _FALSE; + + rtw_netif_carrier_off(pnetdev); + rtw_netif_stop_queue(pnetdev); + + RTW_ERR(FUNC_NDEV_FMT" Failed!! (bup=%d)\n", FUNC_NDEV_ARG(pnetdev), padapter->bup); + + return -1; + +} +int _mi_pm_netdev_open(struct net_device *pnetdev) +{ + int i; + int status = 0; + _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); + _adapter *iface; + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + if (iface->netif_up) { + status = _pm_netdev_open(iface); + if (status == -1) { + RTW_ERR("%s failled\n", __func__); + break; + } + } + } + + return status; +} +#endif /*CONFIG_NEW_NETDEV_HDL*/ int pm_netdev_open(struct net_device *pnetdev, u8 bnormal) { int status = 0; @@ -3064,10 +3921,11 @@ int pm_netdev_open(struct net_device *pnetdev, u8 bnormal) if (_TRUE == bnormal) { _enter_critical_mutex(&(adapter_to_dvobj(padapter)->hw_init_mutex), NULL); + #ifdef CONFIG_NEW_NETDEV_HDL + status = _mi_pm_netdev_open(pnetdev); + #else status = _netdev_open(pnetdev); -#if 0 - rtw_restore_mac_addr(padapter); -#endif + #endif _exit_critical_mutex(&(adapter_to_dvobj(padapter)->hw_init_mutex), NULL); } #ifdef CONFIG_IPS @@ -3077,7 +3935,9 @@ int pm_netdev_open(struct net_device *pnetdev, u8 bnormal) return status; } - +#ifdef CONFIG_CLIENT_PORT_CFG +extern void rtw_hw_client_port_release(_adapter *adapter); +#endif static int netdev_close(struct net_device *pnetdev) { _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); @@ -3089,15 +3949,21 @@ static int netdev_close(struct net_device *pnetdev) 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; +#ifdef CONFIG_CLIENT_PORT_CFG + if (MLME_IS_STA(padapter)) + rtw_hw_client_port_release(padapter); +#endif /* if (!rtw_is_hw_init_completed(padapter)) { RTW_INFO("(1)871x_drv - drv_close, bup=%d, hw_init_completed=%s\n", padapter->bup, rtw_is_hw_init_completed(padapter)?"_TRUE":"_FALSE"); @@ -3116,16 +3982,14 @@ 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_WAIT_ACK); /* s2-2. indicate disconnect to os */ rtw_indicate_disconnect(padapter, 0, _FALSE); /* s2-3. */ - rtw_free_assoc_resources(padapter, 1); + rtw_free_assoc_resources_cmd(padapter, _TRUE, RTW_CMDF_WAIT_ACK); /* s2-4. */ rtw_free_network_queue(padapter, _TRUE); #endif - /* Close LED */ - rtw_led_control(padapter, LED_CTL_POWER_OFF); } #ifdef CONFIG_BR_EXT @@ -3141,8 +4005,8 @@ static int netdev_close(struct net_device *pnetdev) rtw_p2p_enable(padapter, P2P_ROLE_DISABLE); #endif /* CONFIG_P2P */ + rtw_scan_abort(padapter); /* stop scanning process before wifi is going to down */ #ifdef CONFIG_IOCTL_CFG80211 - rtw_scan_abort(padapter); rtw_cfg80211_wait_scan_req_empty(padapter, 200); adapter_wdev_data(padapter)->bandroid_scan = _FALSE; /* padapter->rtw_wdev->iftype = NL80211_IFTYPE_MONITOR; */ /* set this at the end */ @@ -3327,7 +4191,11 @@ static int route_dump(u32 *gw_addr , int *gw_index) oldfs = get_fs(); set_fs(KERNEL_DS); +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 7, 0)) + err = sock_recvmsg(sock, &msg, MSG_DONTWAIT); +#else err = sock_recvmsg(sock, &msg, PAGE_SIZE, MSG_DONTWAIT); +#endif set_fs(oldfs); if (err < 0) @@ -3485,7 +4353,7 @@ int rtw_gw_addr_query(_adapter *padapter) pmlmepriv->gw_ip[1] = (gw_addr & 0xff00) >> 8; pmlmepriv->gw_ip[2] = (gw_addr & 0xff0000) >> 16; pmlmepriv->gw_ip[3] = (gw_addr & 0xff000000) >> 24; - _rtw_memcpy(pmlmepriv->gw_mac_addr, gw_mac, 6); + _rtw_memcpy(pmlmepriv->gw_mac_addr, gw_mac, ETH_ALEN); RTW_INFO("%s Gateway Mac:\t" MAC_FMT "\n", __FUNCTION__, MAC_ARG(pmlmepriv->gw_mac_addr)); RTW_INFO("%s Gateway IP:\t" IP_FMT "\n", __FUNCTION__, IP_ARG(pmlmepriv->gw_ip)); } else @@ -3497,17 +4365,22 @@ int rtw_gw_addr_query(_adapter *padapter) void rtw_dev_unload(PADAPTER padapter) { - struct net_device *pnetdev = (struct net_device *)padapter->pnetdev; struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); struct dvobj_priv *pobjpriv = padapter->dvobj; struct debug_priv *pdbgpriv = &pobjpriv->drv_dbg; struct cmd_priv *pcmdpriv = &padapter->cmdpriv; - u8 cnt = 0; - if (padapter->bup == _TRUE) { 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 if (padapter->xmitpriv.ack_tx) @@ -3516,22 +4389,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__); @@ -3568,7 +4436,6 @@ void rtw_dev_unload(PADAPTER padapter) int rtw_suspend_free_assoc_resource(_adapter *padapter) { struct mlme_priv *pmlmepriv = &padapter->mlmepriv; - struct net_device *pnetdev = padapter->pnetdev; #ifdef CONFIG_P2P struct wifidirect_info *pwdinfo = &padapter->wdinfo; #endif /* CONFIG_P2P */ @@ -3596,17 +4463,17 @@ int rtw_suspend_free_assoc_resource(_adapter *padapter) } 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 /* s2-3. */ - rtw_free_assoc_resources(padapter, 1); + rtw_free_assoc_resources(padapter, _TRUE); /* s2-4. */ #ifdef CONFIG_AUTOSUSPEND @@ -3634,14 +4501,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; @@ -3655,43 +4516,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)); */ -#if !(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)) { @@ -3700,6 +4556,7 @@ int rtw_suspend_wow(_adapter *padapter) } #endif + rtw_wow_lps_level_decide(padapter, _TRUE); poidparam.subcode = WOWLAN_ENABLE; rtw_hal_set_hwreg(padapter, HW_VAR_WOWLAN, (u8 *)&poidparam); if (rtw_chk_roam_flags(padapter, RTW_ROAM_ON_RESUME)) { @@ -3740,11 +4597,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); @@ -3753,8 +4613,11 @@ 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_power_mgmt != PS_MODE_ACTIVE) { + rtw_set_ps_mode(padapter, pwrpriv->wowlan_power_mgmt, 0, 0, "WOWLAN"); + } + } #endif /* #ifdef CONFIG_LPS */ } else @@ -3769,13 +4632,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; @@ -3785,34 +4643,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)) { @@ -3821,6 +4674,7 @@ int rtw_suspend_ap_wow(_adapter *padapter) } #endif + rtw_wow_lps_level_decide(padapter, _TRUE); poidparam.subcode = WOWLAN_AP_ENABLE; rtw_hal_set_hwreg(padapter, HW_VAR_WOWLAN, (u8 *)&poidparam); @@ -3850,15 +4704,21 @@ 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_power_mgmt != PS_MODE_ACTIVE) { + rtw_set_ps_mode(padapter, pwrpriv->wowlan_power_mgmt, 0, 0, "AP-WOWLAN"); + } #endif RTW_INFO("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter)); @@ -3869,8 +4729,6 @@ int rtw_suspend_ap_wow(_adapter *padapter) int rtw_suspend_normal(_adapter *padapter) { - struct mlme_priv *pmlmepriv = &padapter->mlmepriv; - struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); int ret = _SUCCESS; RTW_INFO("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter)); @@ -3878,8 +4736,7 @@ int rtw_suspend_normal(_adapter *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); @@ -3891,18 +4748,19 @@ int rtw_suspend_normal(_adapter *padapter) #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)); */ - if (padapter->intf_deinit) - padapter->intf_deinit(adapter_to_dvobj(padapter)); + #ifdef CONFIG_SDIO_HCI + sdio_deinit(adapter_to_dvobj(padapter)); -#if !(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*/ RTW_INFO("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter)); return ret; @@ -3910,13 +4768,15 @@ 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); +#ifdef CONFIG_WOWLAN struct mlme_priv *pmlmepriv = &padapter->mlmepriv; +#endif 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); @@ -3949,13 +4809,12 @@ 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); if (rtw_mi_check_status(padapter, MI_AP_MODE) == _FALSE) { #ifdef CONFIG_WOWLAN - if (check_fwstate(pmlmepriv, _FW_LINKED)) + if (check_fwstate(pmlmepriv, _FW_LINKED) || WOWLAN_IS_STA_MIX_MODE(padapter)) pwrpriv->wowlan_mode = _TRUE; else if (pwrpriv->wowlan_pno_enable == _TRUE) pwrpriv->wowlan_mode |= pwrpriv->wowlan_pno_enable; @@ -3997,18 +4856,17 @@ 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; struct wowlan_ioctl_param poidparam; struct sta_info *psta = NULL; + struct registry_priv *registry_par = &padapter->registrypriv; int ret = _SUCCESS; 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++; @@ -4034,23 +4892,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_power_mgmt != PS_MODE_ACTIVE) { + 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 -#if !(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; @@ -4071,14 +4933,22 @@ int rtw_resume_process_wow(_adapter *padapter) rtw_mi_start_drv_threads(padapter); rtw_mi_intf_start(padapter); + + if(registry_par->suspend_type == FW_IPS_DISABLE_BBRF && !check_fwstate(pmlmepriv, _FW_LINKED)) { + if (!rtw_is_surprise_removed(padapter)) { + rtw_hal_deinit(padapter); + rtw_hal_init(padapter); + } + RTW_INFO("FW_IPS_DISABLE_BBRF hal deinit, hal init \n"); + } #ifdef CONFIG_CONCURRENT_MODE rtw_mi_buddy_netif_carrier_on(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); @@ -4101,7 +4971,7 @@ int rtw_resume_process_wow(_adapter *padapter) rtw_get_stainfo(&padapter->stapriv, get_bssid(&padapter->mlmepriv)), 0); - rtw_free_assoc_resources(padapter, 1); + rtw_free_assoc_resources(padapter, _TRUE); pmlmeinfo->state = WIFI_FW_NULL_STATE; } else { @@ -4110,27 +4980,6 @@ int rtw_resume_process_wow(_adapter *padapter) } } - if (pwrpriv->wowlan_wake_reason == FW_DECISION_DISCONNECT) - rtw_lock_ext_suspend_timeout(2000); - - if (pwrpriv->wowlan_wake_reason == RX_GTK || - pwrpriv->wowlan_wake_reason == RX_DISASSOC|| - 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); @@ -4143,7 +4992,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|| @@ -4170,7 +5019,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; @@ -4182,7 +5030,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++; @@ -4192,7 +5039,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_power_mgmt != PS_MODE_ACTIVE) { + 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; @@ -4201,12 +5051,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); @@ -4242,13 +5094,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) { @@ -4260,9 +5114,6 @@ int rtw_resume_process_ap_wow(_adapter *padapter) /* rtw_unlock_suspend(); */ #endif /* CONFIG_RESUME_IN_WORKQUEUE */ - if (pwrpriv->wowlan_wake_reason == AP_OFFLOAD_WAKEUP) - rtw_lock_ext_suspend_timeout(8000); - pwrpriv->bips_processing = _FALSE; _set_timer(&adapter_to_dvobj(padapter)->dynamic_chk_timer, 2000); #ifndef CONFIG_IPS_CHECK_IN_WD @@ -4276,7 +5127,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 @@ -4299,18 +5150,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)); } } } @@ -4335,20 +5186,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); -#if !(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); @@ -4361,7 +5218,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]); @@ -4386,10 +5243,8 @@ 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; - if (pwrpriv->bInSuspend == _FALSE) return 0; @@ -4397,7 +5252,7 @@ int rtw_resume_common(_adapter *padapter) RTW_PRINT("resume start\n"); RTW_INFO("==> %s (%s:%d)\n", __FUNCTION__, current->comm, current->pid); - if (rtw_mi_check_status(padapter, WIFI_AP_STATE) == _FALSE) { + if (rtw_mi_check_status(padapter, MI_AP_MODE) == _FALSE) { #ifdef CONFIG_WOWLAN if (pwrpriv->wowlan_mode == _TRUE) rtw_resume_process_wow(padapter); @@ -4405,7 +5260,7 @@ int rtw_resume_common(_adapter *padapter) #endif rtw_resume_process_normal(padapter); - } else if (rtw_mi_check_status(padapter, WIFI_AP_STATE)) { + } else if (rtw_mi_check_status(padapter, MI_AP_MODE)) { #ifdef CONFIG_AP_WOWLAN rtw_resume_process_ap_wow(padapter); #else @@ -4415,9 +5270,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)); @@ -4467,10 +5320,13 @@ EXPORT_SYMBOL(rtw_disable_gpio_interrupt); #ifdef CONFIG_APPEND_VENDOR_IE_ENABLE -int rtw_vendor_ie_get_api(struct net_device *dev, int ie_num, char *extra, __u16 *length) +int rtw_vendor_ie_get_api(struct net_device *dev, int ie_num, char *extra, + u16 extra_len) { - *length = rtw_vendor_ie_get_data(dev, ie_num, extra); - return 0; + 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); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/recv_linux.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/recv_linux.c index 3f2c0703511d..fc6f398c000a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/recv_linux.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/recv_linux.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 @@ -25,7 +21,6 @@ int rtw_os_recvframe_duplicate_skb(_adapter *padapter, union recv_frame *pclonef { int res = _SUCCESS; _pkt *pkt_copy = NULL; - struct rx_pkt_attrib *pattrib = &pcloneframe->u.hdr.attrib; if (pskb == NULL) { RTW_INFO("%s [WARN] skb == NULL, drop frag frame\n", __func__); @@ -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++; } } @@ -224,8 +215,10 @@ int rtw_os_recvbuf_resource_alloc(_adapter *padapter, struct recv_buf *precvbuf) int res = _SUCCESS; #ifdef CONFIG_USB_HCI +#ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); struct usb_device *pusbd = pdvobjpriv->pusbdev; +#endif precvbuf->irp_pending = _FALSE; precvbuf->purb = usb_alloc_urb(0, GFP_KERNEL); @@ -290,7 +283,7 @@ 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) +_pkt *rtw_os_alloc_msdu_pkt(union recv_frame *prframe, const u8 *da, const u8 *sa, u8 *msdu ,u16 msdu_len) { u16 eth_type; u8 *data_ptr; @@ -300,19 +293,19 @@ _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(msdu_len + 14); if (sub_skb) { - skb_reserve(sub_skb, 12); - data_ptr = (u8 *)skb_put(sub_skb, nSubframe_Length); - _rtw_memcpy(data_ptr, (pdata + ETH_HLEN), nSubframe_Length); + skb_reserve(sub_skb, 14); + data_ptr = (u8 *)skb_put(sub_skb, msdu_len); + _rtw_memcpy(data_ptr, msdu, msdu_len); } else #endif /* CONFIG_SKB_COPY */ { sub_skb = rtw_skb_clone(prframe->u.hdr.pkt); if (sub_skb) { - sub_skb->data = pdata + ETH_HLEN; - sub_skb->len = nSubframe_Length; - skb_set_tail_pointer(sub_skb, nSubframe_Length); + sub_skb->data = msdu; + sub_skb->len = msdu_len; + skb_set_tail_pointer(sub_skb, msdu_len); } else { RTW_INFO("%s(): rtw_skb_clone() Fail!!!\n", __FUNCTION__); return NULL; @@ -321,21 +314,23 @@ _pkt *rtw_os_alloc_msdu_pkt(union recv_frame *prframe, u16 nSubframe_Length, u8 eth_type = RTW_GET_BE16(&sub_skb->data[6]); - if (sub_skb->len >= 8 && - ((_rtw_memcmp(sub_skb->data, rtw_rfc1042_header, SNAP_SIZE) && - eth_type != ETH_P_AARP && eth_type != ETH_P_IPX) || - _rtw_memcmp(sub_skb->data, rtw_bridge_tunnel_header, SNAP_SIZE))) { + if (sub_skb->len >= 8 + && ((_rtw_memcmp(sub_skb->data, rtw_rfc1042_header, SNAP_SIZE) + && eth_type != ETH_P_AARP && eth_type != ETH_P_IPX) + || _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), sa, ETH_ALEN); + _rtw_memcpy(skb_push(sub_skb, ETH_ALEN), da, ETH_ALEN); } else { - u16 len; /* Leave Ethernet header part of hdr and full payload */ + u16 len; + 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), sa, ETH_ALEN); + _rtw_memcpy(skb_push(sub_skb, ETH_ALEN), da, ETH_ALEN); } return sub_skb; @@ -391,20 +386,39 @@ int rtw_recv_napi_poll(struct napi_struct *napi, int budget) work_done = napi_recv(padapter, budget); if (work_done < budget) { +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 19, 0)) && defined(CONFIG_PCI_HCI) + napi_complete_done(napi, work_done); +#else napi_complete(napi); +#endif if (!skb_queue_empty(&precvpriv->rx_napi_skb_queue)) napi_schedule(napi); } return work_done; } + +#ifdef CONFIG_RTW_NAPI_DYNAMIC +void dynamic_napi_th_chk (_adapter *adapter) +{ + + if (adapter->registrypriv.en_napi) { + struct dvobj_priv *dvobj; + struct registry_priv *registry; + + dvobj = adapter_to_dvobj(adapter); + registry = &adapter->registrypriv; + if (dvobj->traffic_stat.cur_rx_tp > registry->napi_threshold) + dvobj->en_napi_dynamic = 1; + else + dvobj->en_napi_dynamic = 0; + } + +} +#endif /* CONFIG_RTW_NAPI_DYNAMIC */ #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 +430,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 +458,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 +479,62 @@ 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; - + pkt->ip_summed = CHECKSUM_NONE; /* CONFIG_TCP_CSUM_OFFLOAD_RX */ #ifdef CONFIG_TCP_CSUM_OFFLOAD_RX - if ((pattrib->tcpchk_valid == 1) && (pattrib->tcp_chkrpt == 1)) + if ((rframe->u.hdr.attrib.csum_valid == 1) + && (rframe->u.hdr.attrib.csum_err == 0)) 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 */ #ifdef CONFIG_RTW_NAPI - if (pregistrypriv->en_napi) { +#ifdef CONFIG_RTW_NAPI_DYNAMIC + if (!skb_queue_empty(&precvpriv->rx_napi_skb_queue) + && !adapter_to_dvobj(padapter)->en_napi_dynamic + ) + napi_recv(padapter, RTL_NAPI_WEIGHT); +#endif + + 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 */ @@ -541,9 +554,8 @@ void rtw_handle_tkip_mic_err(_adapter *padapter, struct sta_info *sta, u8 bgroup #endif union iwreq_data wrqu; 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 +576,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 +586,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 +596,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 +633,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) { @@ -674,7 +642,6 @@ int rtw_recv_monitor(_adapter *padapter, union recv_frame *precv_frame) struct recv_priv *precvpriv; _queue *pfree_recv_queue; _pkt *skb; - struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct rx_pkt_attrib *pattrib; if (NULL == precv_frame) @@ -714,136 +681,36 @@ int rtw_recv_monitor(_adapter *padapter, union recv_frame *precv_frame) } +inline void rtw_rframe_set_os_pkt(union recv_frame *rframe) +{ + _pkt *skb = rframe->u.hdr.pkt; + + skb->data = rframe->u.hdr.rx_data; + skb_set_tail_pointer(skb, rframe->u.hdr.len); + skb->len = rframe->u.hdr.len; +} + int rtw_recv_indicatepkt(_adapter *padapter, union recv_frame *precv_frame) { struct recv_priv *precvpriv; _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) + if (precv_frame->u.hdr.pkt == NULL) 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) { - 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); - -_recv_indicatepkt_end: - - precv_frame->u.hdr.pkt = NULL; /* pointers to NULL before rtw_free_recvframe() */ + rtw_os_recv_indicate_pkt(padapter, precv_frame->u.hdr.pkt, precv_frame); + 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 +736,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/rtl8188eu/os_dep/linux/rhashtable.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/rhashtable.c new file mode 100644 index 000000000000..e910d6fbcfe6 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/rhashtable.c @@ -0,0 +1,845 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Resizable, Scalable, Concurrent Hash Table + * + * Copyright (c) 2015 Herbert Xu + * Copyright (c) 2014-2015 Thomas Graf + * Copyright (c) 2008-2014 Patrick McHardy + * + * Code partially derived from nft_hash + * Rewritten with rehash code from br_multicast plus single list + * pointer as suggested by Josh Triplett + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 as + * published by the Free Software Foundation. + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#define HASH_DEFAULT_SIZE 64UL +#define HASH_MIN_SIZE 4U +#define BUCKET_LOCKS_PER_CPU 128UL + +static u32 head_hashfn(struct rhashtable *ht, + const struct bucket_table *tbl, + const struct rhash_head *he) +{ + return rht_head_hashfn(ht, tbl, he, ht->p); +} + +#ifdef CONFIG_PROVE_LOCKING +#define ASSERT_RHT_MUTEX(HT) BUG_ON(!lockdep_rht_mutex_is_held(HT)) + +int lockdep_rht_mutex_is_held(struct rhashtable *ht) +{ + return (debug_locks) ? lockdep_is_held(&ht->mutex) : 1; +} + +int lockdep_rht_bucket_is_held(const struct bucket_table *tbl, u32 hash) +{ + spinlock_t *lock = rht_bucket_lock(tbl, hash); + + return (debug_locks) ? lockdep_is_held(lock) : 1; +} +#else +#define ASSERT_RHT_MUTEX(HT) +#endif + + +static int alloc_bucket_locks(struct rhashtable *ht, struct bucket_table *tbl, + gfp_t gfp) +{ + unsigned int i, size; +#if defined(CONFIG_PROVE_LOCKING) + unsigned int nr_pcpus = 2; +#else + unsigned int nr_pcpus = num_possible_cpus(); +#endif + + nr_pcpus = min_t(unsigned int, nr_pcpus, 32UL); + size = roundup_pow_of_two(nr_pcpus * ht->p.locks_mul); + + /* Never allocate more than 0.5 locks per bucket */ + size = min_t(unsigned int, size, tbl->size >> 1); + + if (sizeof(spinlock_t) != 0) { +#ifdef CONFIG_NUMA + if (size * sizeof(spinlock_t) > PAGE_SIZE && + gfp == GFP_KERNEL) + tbl->locks = vmalloc(size * sizeof(spinlock_t)); + else +#endif + tbl->locks = kmalloc_array(size, sizeof(spinlock_t), + gfp); + if (!tbl->locks) + return -ENOMEM; + for (i = 0; i < size; i++) + spin_lock_init(&tbl->locks[i]); + } + tbl->locks_mask = size - 1; + + return 0; +} + +static void bucket_table_free(const struct bucket_table *tbl) +{ + if (tbl) + kvfree(tbl->locks); + + kvfree(tbl); +} + +static void bucket_table_free_rcu(struct rcu_head *head) +{ + bucket_table_free(container_of(head, struct bucket_table, rcu)); +} + +static struct bucket_table *bucket_table_alloc(struct rhashtable *ht, + size_t nbuckets, + gfp_t gfp) +{ + struct bucket_table *tbl = NULL; + size_t size; + int i; + + size = sizeof(*tbl) + nbuckets * sizeof(tbl->buckets[0]); + if (size <= (PAGE_SIZE << PAGE_ALLOC_COSTLY_ORDER) || + gfp != GFP_KERNEL) + tbl = kzalloc(size, gfp | __GFP_NOWARN | __GFP_NORETRY); + if (tbl == NULL && gfp == GFP_KERNEL) + tbl = vzalloc(size); + if (tbl == NULL) + return NULL; + + tbl->size = nbuckets; + + if (alloc_bucket_locks(ht, tbl, gfp) < 0) { + bucket_table_free(tbl); + return NULL; + } + + INIT_LIST_HEAD(&tbl->walkers); + + get_random_bytes(&tbl->hash_rnd, sizeof(tbl->hash_rnd)); + + for (i = 0; i < nbuckets; i++) + INIT_RHT_NULLS_HEAD(tbl->buckets[i], ht, i); + + return tbl; +} + +static struct bucket_table *rhashtable_last_table(struct rhashtable *ht, + struct bucket_table *tbl) +{ + struct bucket_table *new_tbl; + + do { + new_tbl = tbl; + tbl = rht_dereference_rcu(tbl->future_tbl, ht); + } while (tbl); + + return new_tbl; +} + +static int rhashtable_rehash_one(struct rhashtable *ht, unsigned int old_hash) +{ + struct bucket_table *old_tbl = rht_dereference(ht->tbl, ht); + struct bucket_table *new_tbl = rhashtable_last_table(ht, + rht_dereference_rcu(old_tbl->future_tbl, ht)); + struct rhash_head __rcu **pprev = &old_tbl->buckets[old_hash]; + int err = -ENOENT; + struct rhash_head *head, *next, *entry; + spinlock_t *new_bucket_lock; + unsigned int new_hash; + + rht_for_each(entry, old_tbl, old_hash) { + err = 0; + next = rht_dereference_bucket(entry->next, old_tbl, old_hash); + + if (rht_is_a_nulls(next)) + break; + + pprev = &entry->next; + } + + if (err) + goto out; + + new_hash = head_hashfn(ht, new_tbl, entry); + + new_bucket_lock = rht_bucket_lock(new_tbl, new_hash); + + spin_lock_nested(new_bucket_lock, SINGLE_DEPTH_NESTING); + head = rht_dereference_bucket(new_tbl->buckets[new_hash], + new_tbl, new_hash); + + RCU_INIT_POINTER(entry->next, head); + + rcu_assign_pointer(new_tbl->buckets[new_hash], entry); + spin_unlock(new_bucket_lock); + + rcu_assign_pointer(*pprev, next); + +out: + return err; +} + +static void rhashtable_rehash_chain(struct rhashtable *ht, + unsigned int old_hash) +{ + struct bucket_table *old_tbl = rht_dereference(ht->tbl, ht); + spinlock_t *old_bucket_lock; + + old_bucket_lock = rht_bucket_lock(old_tbl, old_hash); + + spin_lock_bh(old_bucket_lock); + while (!rhashtable_rehash_one(ht, old_hash)) + ; + old_tbl->rehash++; + spin_unlock_bh(old_bucket_lock); +} + +static int rhashtable_rehash_attach(struct rhashtable *ht, + struct bucket_table *old_tbl, + struct bucket_table *new_tbl) +{ + /* Protect future_tbl using the first bucket lock. */ + spin_lock_bh(old_tbl->locks); + + /* Did somebody beat us to it? */ + if (rcu_access_pointer(old_tbl->future_tbl)) { + spin_unlock_bh(old_tbl->locks); + return -EEXIST; + } + + /* Make insertions go into the new, empty table right away. Deletions + * and lookups will be attempted in both tables until we synchronize. + */ + rcu_assign_pointer(old_tbl->future_tbl, new_tbl); + + /* Ensure the new table is visible to readers. */ + smp_wmb(); + + spin_unlock_bh(old_tbl->locks); + + return 0; +} + +static int rhashtable_rehash_table(struct rhashtable *ht) +{ + struct bucket_table *old_tbl = rht_dereference(ht->tbl, ht); + struct bucket_table *new_tbl; + struct rhashtable_walker *walker; + unsigned int old_hash; + + new_tbl = rht_dereference(old_tbl->future_tbl, ht); + if (!new_tbl) + return 0; + + for (old_hash = 0; old_hash < old_tbl->size; old_hash++) + rhashtable_rehash_chain(ht, old_hash); + + /* Publish the new table pointer. */ + rcu_assign_pointer(ht->tbl, new_tbl); + + spin_lock(&ht->lock); + list_for_each_entry(walker, &old_tbl->walkers, list) + walker->tbl = NULL; + spin_unlock(&ht->lock); + + /* Wait for readers. All new readers will see the new + * table, and thus no references to the old table will + * remain. + */ + call_rcu(&old_tbl->rcu, bucket_table_free_rcu); + + return rht_dereference(new_tbl->future_tbl, ht) ? -EAGAIN : 0; +} + +/** + * rhashtable_expand - Expand hash table while allowing concurrent lookups + * @ht: the hash table to expand + * + * A secondary bucket array is allocated and the hash entries are migrated. + * + * This function may only be called in a context where it is safe to call + * synchronize_rcu(), e.g. not within a rcu_read_lock() section. + * + * The caller must ensure that no concurrent resizing occurs by holding + * ht->mutex. + * + * It is valid to have concurrent insertions and deletions protected by per + * bucket locks or concurrent RCU protected lookups and traversals. + */ +static int rhashtable_expand(struct rhashtable *ht) +{ + struct bucket_table *new_tbl, *old_tbl = rht_dereference(ht->tbl, ht); + int err; + + ASSERT_RHT_MUTEX(ht); + + old_tbl = rhashtable_last_table(ht, old_tbl); + + new_tbl = bucket_table_alloc(ht, old_tbl->size * 2, GFP_KERNEL); + if (new_tbl == NULL) + return -ENOMEM; + + err = rhashtable_rehash_attach(ht, old_tbl, new_tbl); + if (err) + bucket_table_free(new_tbl); + + return err; +} + +/** + * rhashtable_shrink - Shrink hash table while allowing concurrent lookups + * @ht: the hash table to shrink + * + * This function shrinks the hash table to fit, i.e., the smallest + * size would not cause it to expand right away automatically. + * + * The caller must ensure that no concurrent resizing occurs by holding + * ht->mutex. + * + * The caller must ensure that no concurrent table mutations take place. + * It is however valid to have concurrent lookups if they are RCU protected. + * + * It is valid to have concurrent insertions and deletions protected by per + * bucket locks or concurrent RCU protected lookups and traversals. + */ +static int rhashtable_shrink(struct rhashtable *ht) +{ + struct bucket_table *new_tbl, *old_tbl = rht_dereference(ht->tbl, ht); + unsigned int size; + int err; + + ASSERT_RHT_MUTEX(ht); + + size = roundup_pow_of_two(atomic_read(&ht->nelems) * 3 / 2); + if (size < ht->p.min_size) + size = ht->p.min_size; + + if (old_tbl->size <= size) + return 0; + + if (rht_dereference(old_tbl->future_tbl, ht)) + return -EEXIST; + + new_tbl = bucket_table_alloc(ht, size, GFP_KERNEL); + if (new_tbl == NULL) + return -ENOMEM; + + err = rhashtable_rehash_attach(ht, old_tbl, new_tbl); + if (err) + bucket_table_free(new_tbl); + + return err; +} + +static void rht_deferred_worker(struct work_struct *work) +{ + struct rhashtable *ht; + struct bucket_table *tbl; + int err = 0; + + ht = container_of(work, struct rhashtable, run_work); + mutex_lock(&ht->mutex); + + tbl = rht_dereference(ht->tbl, ht); + tbl = rhashtable_last_table(ht, tbl); + + if (rht_grow_above_75(ht, tbl)) + rhashtable_expand(ht); + else if (ht->p.automatic_shrinking && rht_shrink_below_30(ht, tbl)) + rhashtable_shrink(ht); + + err = rhashtable_rehash_table(ht); + + mutex_unlock(&ht->mutex); + + if (err) + schedule_work(&ht->run_work); +} + +static bool rhashtable_check_elasticity(struct rhashtable *ht, + struct bucket_table *tbl, + unsigned int hash) +{ + unsigned int elasticity = ht->elasticity; + struct rhash_head *head; + + rht_for_each(head, tbl, hash) + if (!--elasticity) + return true; + + return false; +} + +int rhashtable_insert_rehash(struct rhashtable *ht, + struct bucket_table *tbl) +{ + struct bucket_table *old_tbl; + struct bucket_table *new_tbl; + unsigned int size; + int err; + + old_tbl = rht_dereference_rcu(ht->tbl, ht); + + size = tbl->size; + + err = -EBUSY; + + if (rht_grow_above_75(ht, tbl)) + size *= 2; + /* Do not schedule more than one rehash */ + else if (old_tbl != tbl) + goto fail; + + err = -ENOMEM; + + new_tbl = bucket_table_alloc(ht, size, GFP_ATOMIC); + if (new_tbl == NULL) + goto fail; + + err = rhashtable_rehash_attach(ht, tbl, new_tbl); + if (err) { + bucket_table_free(new_tbl); + if (err == -EEXIST) + err = 0; + } else + schedule_work(&ht->run_work); + + return err; + +fail: + /* Do not fail the insert if someone else did a rehash. */ + if (likely(rcu_dereference_raw(tbl->future_tbl))) + return 0; + + /* Schedule async rehash to retry allocation in process context. */ + if (err == -ENOMEM) + schedule_work(&ht->run_work); + + return err; +} + +struct bucket_table *rhashtable_insert_slow(struct rhashtable *ht, + const void *key, + struct rhash_head *obj, + struct bucket_table *tbl) +{ + struct rhash_head *head; + unsigned int hash; + int err; + + tbl = rhashtable_last_table(ht, tbl); + hash = head_hashfn(ht, tbl, obj); + spin_lock_nested(rht_bucket_lock(tbl, hash), SINGLE_DEPTH_NESTING); + + err = -EEXIST; + if (key && rhashtable_lookup_fast(ht, key, ht->p)) + goto exit; + + err = -E2BIG; + if (unlikely(rht_grow_above_max(ht, tbl))) + goto exit; + + err = -EAGAIN; + if (rhashtable_check_elasticity(ht, tbl, hash) || + rht_grow_above_100(ht, tbl)) + goto exit; + + err = 0; + + head = rht_dereference_bucket(tbl->buckets[hash], tbl, hash); + + RCU_INIT_POINTER(obj->next, head); + + rcu_assign_pointer(tbl->buckets[hash], obj); + + atomic_inc(&ht->nelems); + +exit: + spin_unlock(rht_bucket_lock(tbl, hash)); + + if (err == 0) + return NULL; + else if (err == -EAGAIN) + return tbl; + else + return ERR_PTR(err); +} + +/** + * rhashtable_walk_init - Initialise an iterator + * @ht: Table to walk over + * @iter: Hash table Iterator + * + * This function prepares a hash table walk. + * + * Note that if you restart a walk after rhashtable_walk_stop you + * may see the same object twice. Also, you may miss objects if + * there are removals in between rhashtable_walk_stop and the next + * call to rhashtable_walk_start. + * + * For a completely stable walk you should construct your own data + * structure outside the hash table. + * + * This function may sleep so you must not call it from interrupt + * context or with spin locks held. + * + * You must call rhashtable_walk_exit if this function returns + * successfully. + */ +int rhashtable_walk_init(struct rhashtable *ht, struct rhashtable_iter *iter) +{ + iter->ht = ht; + iter->p = NULL; + iter->slot = 0; + iter->skip = 0; + + iter->walker = kmalloc(sizeof(*iter->walker), GFP_KERNEL); + if (!iter->walker) + return -ENOMEM; + + spin_lock(&ht->lock); + iter->walker->tbl = + rcu_dereference_protected(ht->tbl, lockdep_is_held(&ht->lock)); + list_add(&iter->walker->list, &iter->walker->tbl->walkers); + spin_unlock(&ht->lock); + + return 0; +} + +/** + * rhashtable_walk_exit - Free an iterator + * @iter: Hash table Iterator + * + * This function frees resources allocated by rhashtable_walk_init. + */ +void rhashtable_walk_exit(struct rhashtable_iter *iter) +{ + spin_lock(&iter->ht->lock); + if (iter->walker->tbl) + list_del(&iter->walker->list); + spin_unlock(&iter->ht->lock); + kfree(iter->walker); +} + +/** + * rhashtable_walk_start - Start a hash table walk + * @iter: Hash table iterator + * + * Start a hash table walk. Note that we take the RCU lock in all + * cases including when we return an error. So you must always call + * rhashtable_walk_stop to clean up. + * + * Returns zero if successful. + * + * Returns -EAGAIN if resize event occured. Note that the iterator + * will rewind back to the beginning and you may use it immediately + * by calling rhashtable_walk_next. + */ +int rhashtable_walk_start(struct rhashtable_iter *iter) + __acquires(RCU) +{ + struct rhashtable *ht = iter->ht; + + rcu_read_lock(); + + spin_lock(&ht->lock); + if (iter->walker->tbl) + list_del(&iter->walker->list); + spin_unlock(&ht->lock); + + if (!iter->walker->tbl) { + iter->walker->tbl = rht_dereference_rcu(ht->tbl, ht); + return -EAGAIN; + } + + return 0; +} + +/** + * rhashtable_walk_next - Return the next object and advance the iterator + * @iter: Hash table iterator + * + * Note that you must call rhashtable_walk_stop when you are finished + * with the walk. + * + * Returns the next object or NULL when the end of the table is reached. + * + * Returns -EAGAIN if resize event occured. Note that the iterator + * will rewind back to the beginning and you may continue to use it. + */ +void *rhashtable_walk_next(struct rhashtable_iter *iter) +{ + struct bucket_table *tbl = iter->walker->tbl; + struct rhashtable *ht = iter->ht; + struct rhash_head *p = iter->p; + + if (p) { + p = rht_dereference_bucket_rcu(p->next, tbl, iter->slot); + goto next; + } + + for (; iter->slot < tbl->size; iter->slot++) { + int skip = iter->skip; + + rht_for_each_rcu(p, tbl, iter->slot) { + if (!skip) + break; + skip--; + } + +next: + if (!rht_is_a_nulls(p)) { + iter->skip++; + iter->p = p; + return rht_obj(ht, p); + } + + iter->skip = 0; + } + + iter->p = NULL; + + /* Ensure we see any new tables. */ + smp_rmb(); + + iter->walker->tbl = rht_dereference_rcu(tbl->future_tbl, ht); + if (iter->walker->tbl) { + iter->slot = 0; + iter->skip = 0; + return ERR_PTR(-EAGAIN); + } + + return NULL; +} + +/** + * rhashtable_walk_stop - Finish a hash table walk + * @iter: Hash table iterator + * + * Finish a hash table walk. + */ +void rhashtable_walk_stop(struct rhashtable_iter *iter) + __releases(RCU) +{ + struct rhashtable *ht; + struct bucket_table *tbl = iter->walker->tbl; + + if (!tbl) + goto out; + + ht = iter->ht; + + spin_lock(&ht->lock); + if (tbl->rehash < tbl->size) + list_add(&iter->walker->list, &tbl->walkers); + else + iter->walker->tbl = NULL; + spin_unlock(&ht->lock); + + iter->p = NULL; + +out: + rcu_read_unlock(); +} + +static size_t rounded_hashtable_size(const struct rhashtable_params *params) +{ + return max(roundup_pow_of_two(params->nelem_hint * 4 / 3), + (unsigned long)params->min_size); +} + +static u32 rhashtable_jhash2(const void *key, u32 length, u32 seed) +{ + return jhash2(key, length, seed); +} + +/** + * rhashtable_init - initialize a new hash table + * @ht: hash table to be initialized + * @params: configuration parameters + * + * Initializes a new hash table based on the provided configuration + * parameters. A table can be configured either with a variable or + * fixed length key: + * + * Configuration Example 1: Fixed length keys + * struct test_obj { + * int key; + * void * my_member; + * struct rhash_head node; + * }; + * + * struct rhashtable_params params = { + * .head_offset = offsetof(struct test_obj, node), + * .key_offset = offsetof(struct test_obj, key), + * .key_len = sizeof(int), + * .hashfn = jhash, + * .nulls_base = (1U << RHT_BASE_SHIFT), + * }; + * + * Configuration Example 2: Variable length keys + * struct test_obj { + * [...] + * struct rhash_head node; + * }; + * + * u32 my_hash_fn(const void *data, u32 len, u32 seed) + * { + * struct test_obj *obj = data; + * + * return [... hash ...]; + * } + * + * struct rhashtable_params params = { + * .head_offset = offsetof(struct test_obj, node), + * .hashfn = jhash, + * .obj_hashfn = my_hash_fn, + * }; + */ +int rhashtable_init(struct rhashtable *ht, + const struct rhashtable_params *params) +{ + struct bucket_table *tbl; + size_t size; + + size = HASH_DEFAULT_SIZE; + + if ((!params->key_len && !params->obj_hashfn) || + (params->obj_hashfn && !params->obj_cmpfn)) + return -EINVAL; + + if (params->nulls_base && params->nulls_base < (1U << RHT_BASE_SHIFT)) + return -EINVAL; + + memset(ht, 0, sizeof(*ht)); + mutex_init(&ht->mutex); + spin_lock_init(&ht->lock); + memcpy(&ht->p, params, sizeof(*params)); + + if (params->min_size) + ht->p.min_size = roundup_pow_of_two(params->min_size); + + if (params->max_size) + ht->p.max_size = rounddown_pow_of_two(params->max_size); + + if (params->insecure_max_entries) + ht->p.insecure_max_entries = + rounddown_pow_of_two(params->insecure_max_entries); + else + ht->p.insecure_max_entries = ht->p.max_size * 2; + + ht->p.min_size = max(ht->p.min_size, HASH_MIN_SIZE); + + if (params->nelem_hint) + size = rounded_hashtable_size(&ht->p); + + /* The maximum (not average) chain length grows with the + * size of the hash table, at a rate of (log N)/(log log N). + * The value of 16 is selected so that even if the hash + * table grew to 2^32 you would not expect the maximum + * chain length to exceed it unless we are under attack + * (or extremely unlucky). + * + * As this limit is only to detect attacks, we don't need + * to set it to a lower value as you'd need the chain + * length to vastly exceed 16 to have any real effect + * on the system. + */ + if (!params->insecure_elasticity) + ht->elasticity = 16; + + if (params->locks_mul) + ht->p.locks_mul = roundup_pow_of_two(params->locks_mul); + else + ht->p.locks_mul = BUCKET_LOCKS_PER_CPU; + + ht->key_len = ht->p.key_len; + if (!params->hashfn) { + ht->p.hashfn = jhash; + + if (!(ht->key_len & (sizeof(u32) - 1))) { + ht->key_len /= sizeof(u32); + ht->p.hashfn = rhashtable_jhash2; + } + } + + tbl = bucket_table_alloc(ht, size, GFP_KERNEL); + if (tbl == NULL) + return -ENOMEM; + + atomic_set(&ht->nelems, 0); + + RCU_INIT_POINTER(ht->tbl, tbl); + + INIT_WORK(&ht->run_work, rht_deferred_worker); + + return 0; +} + +/** + * rhashtable_free_and_destroy - free elements and destroy hash table + * @ht: the hash table to destroy + * @free_fn: callback to release resources of element + * @arg: pointer passed to free_fn + * + * Stops an eventual async resize. If defined, invokes free_fn for each + * element to releasal resources. Please note that RCU protected + * readers may still be accessing the elements. Releasing of resources + * must occur in a compatible manner. Then frees the bucket array. + * + * This function will eventually sleep to wait for an async resize + * to complete. The caller is responsible that no further write operations + * occurs in parallel. + */ +void rhashtable_free_and_destroy(struct rhashtable *ht, + void (*free_fn)(void *ptr, void *arg), + void *arg) +{ + const struct bucket_table *tbl; + unsigned int i; + + cancel_work_sync(&ht->run_work); + + mutex_lock(&ht->mutex); + tbl = rht_dereference(ht->tbl, ht); + if (free_fn) { + for (i = 0; i < tbl->size; i++) { + struct rhash_head *pos, *next; + + for (pos = rht_dereference(tbl->buckets[i], ht), + next = !rht_is_a_nulls(pos) ? + rht_dereference(pos->next, ht) : NULL; + !rht_is_a_nulls(pos); + pos = next, + next = !rht_is_a_nulls(pos) ? + rht_dereference(pos->next, ht) : NULL) + free_fn(rht_obj(ht, pos), arg); + } + } + + bucket_table_free(tbl); + mutex_unlock(&ht->mutex); +} + +void rhashtable_destroy(struct rhashtable *ht) +{ + return rhashtable_free_and_destroy(ht, NULL, NULL); +} + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/rhashtable.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/rhashtable.h new file mode 100644 index 000000000000..d6e7a55037ee --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/rhashtable.h @@ -0,0 +1,828 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/* + * Resizable, Scalable, Concurrent Hash Table + * + * Copyright (c) 2015 Herbert Xu + * Copyright (c) 2014-2015 Thomas Graf + * Copyright (c) 2008-2014 Patrick McHardy + * + * Code partially derived from nft_hash + * Rewritten with rehash code from br_multicast plus single list + * pointer as suggested by Josh Triplett + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 as + * published by the Free Software Foundation. + */ + +#ifndef _LINUX_RHASHTABLE_H +#define _LINUX_RHASHTABLE_H + +#include +#include +#include +#include +#include +#include +#include +#include +#include + +/* + * The end of the chain is marked with a special nulls marks which has + * the following format: + * + * +-------+-----------------------------------------------------+-+ + * | Base | Hash |1| + * +-------+-----------------------------------------------------+-+ + * + * Base (4 bits) : Reserved to distinguish between multiple tables. + * Specified via &struct rhashtable_params.nulls_base. + * Hash (27 bits): Full hash (unmasked) of first element added to bucket + * 1 (1 bit) : Nulls marker (always set) + * + * The remaining bits of the next pointer remain unused for now. + */ +#define RHT_BASE_BITS 4 +#define RHT_HASH_BITS 27 +#define RHT_BASE_SHIFT RHT_HASH_BITS + +/* Base bits plus 1 bit for nulls marker */ +#define RHT_HASH_RESERVED_SPACE (RHT_BASE_BITS + 1) + +struct rhash_head { + struct rhash_head __rcu *next; +}; + +/** + * struct bucket_table - Table of hash buckets + * @size: Number of hash buckets + * @rehash: Current bucket being rehashed + * @hash_rnd: Random seed to fold into hash + * @locks_mask: Mask to apply before accessing locks[] + * @locks: Array of spinlocks protecting individual buckets + * @walkers: List of active walkers + * @rcu: RCU structure for freeing the table + * @future_tbl: Table under construction during rehashing + * @buckets: size * hash buckets + */ +struct bucket_table { + unsigned int size; + unsigned int rehash; + u32 hash_rnd; + unsigned int locks_mask; + spinlock_t *locks; + struct list_head walkers; + struct rcu_head rcu; + + struct bucket_table __rcu *future_tbl; + + struct rhash_head __rcu *buckets[] ____cacheline_aligned_in_smp; +}; + +/** + * struct rhashtable_compare_arg - Key for the function rhashtable_compare + * @ht: Hash table + * @key: Key to compare against + */ +struct rhashtable_compare_arg { + struct rhashtable *ht; + const void *key; +}; + +typedef u32 (*rht_hashfn_t)(const void *data, u32 len, u32 seed); +typedef u32 (*rht_obj_hashfn_t)(const void *data, u32 len, u32 seed); +typedef int (*rht_obj_cmpfn_t)(struct rhashtable_compare_arg *arg, + const void *obj); + +struct rhashtable; + +/** + * struct rhashtable_params - Hash table construction parameters + * @nelem_hint: Hint on number of elements, should be 75% of desired size + * @key_len: Length of key + * @key_offset: Offset of key in struct to be hashed + * @head_offset: Offset of rhash_head in struct to be hashed + * @insecure_max_entries: Maximum number of entries (may be exceeded) + * @max_size: Maximum size while expanding + * @min_size: Minimum size while shrinking + * @nulls_base: Base value to generate nulls marker + * @insecure_elasticity: Set to true to disable chain length checks + * @automatic_shrinking: Enable automatic shrinking of tables + * @locks_mul: Number of bucket locks to allocate per cpu (default: 128) + * @hashfn: Hash function (default: jhash2 if !(key_len % 4), or jhash) + * @obj_hashfn: Function to hash object + * @obj_cmpfn: Function to compare key with object + */ +struct rhashtable_params { + size_t nelem_hint; + size_t key_len; + size_t key_offset; + size_t head_offset; + unsigned int insecure_max_entries; + unsigned int max_size; + unsigned int min_size; + u32 nulls_base; + bool insecure_elasticity; + bool automatic_shrinking; + size_t locks_mul; + rht_hashfn_t hashfn; + rht_obj_hashfn_t obj_hashfn; + rht_obj_cmpfn_t obj_cmpfn; +}; + +/** + * struct rhashtable - Hash table handle + * @tbl: Bucket table + * @nelems: Number of elements in table + * @key_len: Key length for hashfn + * @elasticity: Maximum chain length before rehash + * @p: Configuration parameters + * @run_work: Deferred worker to expand/shrink asynchronously + * @mutex: Mutex to protect current/future table swapping + * @lock: Spin lock to protect walker list + */ +struct rhashtable { + struct bucket_table __rcu *tbl; + atomic_t nelems; + unsigned int key_len; + unsigned int elasticity; + struct rhashtable_params p; + struct work_struct run_work; + struct mutex mutex; + spinlock_t lock; +}; + +/** + * struct rhashtable_walker - Hash table walker + * @list: List entry on list of walkers + * @tbl: The table that we were walking over + */ +struct rhashtable_walker { + struct list_head list; + struct bucket_table *tbl; +}; + +/** + * struct rhashtable_iter - Hash table iterator, fits into netlink cb + * @ht: Table to iterate through + * @p: Current pointer + * @walker: Associated rhashtable walker + * @slot: Current slot + * @skip: Number of entries to skip in slot + */ +struct rhashtable_iter { + struct rhashtable *ht; + struct rhash_head *p; + struct rhashtable_walker *walker; + unsigned int slot; + unsigned int skip; +}; + +static inline unsigned long rht_marker(const struct rhashtable *ht, u32 hash) +{ + return NULLS_MARKER(ht->p.nulls_base + hash); +} + +#define INIT_RHT_NULLS_HEAD(ptr, ht, hash) \ + ((ptr) = (typeof(ptr)) rht_marker(ht, hash)) + +static inline bool rht_is_a_nulls(const struct rhash_head *ptr) +{ + return ((unsigned long) ptr & 1); +} + +static inline unsigned long rht_get_nulls_value(const struct rhash_head *ptr) +{ + return ((unsigned long) ptr) >> 1; +} + +static inline void *rht_obj(const struct rhashtable *ht, + const struct rhash_head *he) +{ + return (char *)he - ht->p.head_offset; +} + +static inline unsigned int rht_bucket_index(const struct bucket_table *tbl, + unsigned int hash) +{ + return (hash >> RHT_HASH_RESERVED_SPACE) & (tbl->size - 1); +} + +static inline unsigned int rht_key_hashfn( + struct rhashtable *ht, const struct bucket_table *tbl, + const void *key, const struct rhashtable_params params) +{ + unsigned int hash; + + /* params must be equal to ht->p if it isn't constant. */ + if (!__builtin_constant_p(params.key_len)) + hash = ht->p.hashfn(key, ht->key_len, tbl->hash_rnd); + else if (params.key_len) { + unsigned int key_len = params.key_len; + + if (params.hashfn) + hash = params.hashfn(key, key_len, tbl->hash_rnd); + else if (key_len & (sizeof(u32) - 1)) + hash = jhash(key, key_len, tbl->hash_rnd); + else + hash = jhash2(key, key_len / sizeof(u32), + tbl->hash_rnd); + } else { + unsigned int key_len = ht->p.key_len; + + if (params.hashfn) + hash = params.hashfn(key, key_len, tbl->hash_rnd); + else + hash = jhash(key, key_len, tbl->hash_rnd); + } + + return rht_bucket_index(tbl, hash); +} + +static inline unsigned int rht_head_hashfn( + struct rhashtable *ht, const struct bucket_table *tbl, + const struct rhash_head *he, const struct rhashtable_params params) +{ + const char *ptr = rht_obj(ht, he); + + return likely(params.obj_hashfn) ? + rht_bucket_index(tbl, params.obj_hashfn(ptr, params.key_len ?: + ht->p.key_len, + tbl->hash_rnd)) : + rht_key_hashfn(ht, tbl, ptr + params.key_offset, params); +} + +/** + * rht_grow_above_75 - returns true if nelems > 0.75 * table-size + * @ht: hash table + * @tbl: current table + */ +static inline bool rht_grow_above_75(const struct rhashtable *ht, + const struct bucket_table *tbl) +{ + /* Expand table when exceeding 75% load */ + return atomic_read(&ht->nelems) > (tbl->size / 4 * 3) && + (!ht->p.max_size || tbl->size < ht->p.max_size); +} + +/** + * rht_shrink_below_30 - returns true if nelems < 0.3 * table-size + * @ht: hash table + * @tbl: current table + */ +static inline bool rht_shrink_below_30(const struct rhashtable *ht, + const struct bucket_table *tbl) +{ + /* Shrink table beneath 30% load */ + return atomic_read(&ht->nelems) < (tbl->size * 3 / 10) && + tbl->size > ht->p.min_size; +} + +/** + * rht_grow_above_100 - returns true if nelems > table-size + * @ht: hash table + * @tbl: current table + */ +static inline bool rht_grow_above_100(const struct rhashtable *ht, + const struct bucket_table *tbl) +{ + return atomic_read(&ht->nelems) > tbl->size && + (!ht->p.max_size || tbl->size < ht->p.max_size); +} + +/** + * rht_grow_above_max - returns true if table is above maximum + * @ht: hash table + * @tbl: current table + */ +static inline bool rht_grow_above_max(const struct rhashtable *ht, + const struct bucket_table *tbl) +{ + return ht->p.insecure_max_entries && + atomic_read(&ht->nelems) >= ht->p.insecure_max_entries; +} + +/* The bucket lock is selected based on the hash and protects mutations + * on a group of hash buckets. + * + * A maximum of tbl->size/2 bucket locks is allocated. This ensures that + * a single lock always covers both buckets which may both contains + * entries which link to the same bucket of the old table during resizing. + * This allows to simplify the locking as locking the bucket in both + * tables during resize always guarantee protection. + * + * IMPORTANT: When holding the bucket lock of both the old and new table + * during expansions and shrinking, the old bucket lock must always be + * acquired first. + */ +static inline spinlock_t *rht_bucket_lock(const struct bucket_table *tbl, + unsigned int hash) +{ + return &tbl->locks[hash & tbl->locks_mask]; +} + +#ifdef CONFIG_PROVE_LOCKING +int lockdep_rht_mutex_is_held(struct rhashtable *ht); +int lockdep_rht_bucket_is_held(const struct bucket_table *tbl, u32 hash); +#else +static inline int lockdep_rht_mutex_is_held(struct rhashtable *ht) +{ + return 1; +} + +static inline int lockdep_rht_bucket_is_held(const struct bucket_table *tbl, + u32 hash) +{ + return 1; +} +#endif /* CONFIG_PROVE_LOCKING */ + +int rhashtable_init(struct rhashtable *ht, + const struct rhashtable_params *params); + +struct bucket_table *rhashtable_insert_slow(struct rhashtable *ht, + const void *key, + struct rhash_head *obj, + struct bucket_table *old_tbl); +int rhashtable_insert_rehash(struct rhashtable *ht, struct bucket_table *tbl); + +int rhashtable_walk_init(struct rhashtable *ht, struct rhashtable_iter *iter); +void rhashtable_walk_exit(struct rhashtable_iter *iter); +int rhashtable_walk_start(struct rhashtable_iter *iter) __acquires(RCU); +void *rhashtable_walk_next(struct rhashtable_iter *iter); +void rhashtable_walk_stop(struct rhashtable_iter *iter) __releases(RCU); + +void rhashtable_free_and_destroy(struct rhashtable *ht, + void (*free_fn)(void *ptr, void *arg), + void *arg); +void rhashtable_destroy(struct rhashtable *ht); + +#define rht_dereference(p, ht) \ + rcu_dereference_protected(p, lockdep_rht_mutex_is_held(ht)) + +#define rht_dereference_rcu(p, ht) \ + rcu_dereference_check(p, lockdep_rht_mutex_is_held(ht)) + +#define rht_dereference_bucket(p, tbl, hash) \ + rcu_dereference_protected(p, lockdep_rht_bucket_is_held(tbl, hash)) + +#define rht_dereference_bucket_rcu(p, tbl, hash) \ + rcu_dereference_check(p, lockdep_rht_bucket_is_held(tbl, hash)) + +#define rht_entry(tpos, pos, member) \ + ({ tpos = container_of(pos, typeof(*tpos), member); 1; }) + +/** + * rht_for_each_continue - continue iterating over hash chain + * @pos: the &struct rhash_head to use as a loop cursor. + * @head: the previous &struct rhash_head to continue from + * @tbl: the &struct bucket_table + * @hash: the hash value / bucket index + */ +#define rht_for_each_continue(pos, head, tbl, hash) \ + for (pos = rht_dereference_bucket(head, tbl, hash); \ + !rht_is_a_nulls(pos); \ + pos = rht_dereference_bucket((pos)->next, tbl, hash)) + +/** + * rht_for_each - iterate over hash chain + * @pos: the &struct rhash_head to use as a loop cursor. + * @tbl: the &struct bucket_table + * @hash: the hash value / bucket index + */ +#define rht_for_each(pos, tbl, hash) \ + rht_for_each_continue(pos, (tbl)->buckets[hash], tbl, hash) + +/** + * rht_for_each_entry_continue - continue iterating over hash chain + * @tpos: the type * to use as a loop cursor. + * @pos: the &struct rhash_head to use as a loop cursor. + * @head: the previous &struct rhash_head to continue from + * @tbl: the &struct bucket_table + * @hash: the hash value / bucket index + * @member: name of the &struct rhash_head within the hashable struct. + */ +#define rht_for_each_entry_continue(tpos, pos, head, tbl, hash, member) \ + for (pos = rht_dereference_bucket(head, tbl, hash); \ + (!rht_is_a_nulls(pos)) && rht_entry(tpos, pos, member); \ + pos = rht_dereference_bucket((pos)->next, tbl, hash)) + +/** + * rht_for_each_entry - iterate over hash chain of given type + * @tpos: the type * to use as a loop cursor. + * @pos: the &struct rhash_head to use as a loop cursor. + * @tbl: the &struct bucket_table + * @hash: the hash value / bucket index + * @member: name of the &struct rhash_head within the hashable struct. + */ +#define rht_for_each_entry(tpos, pos, tbl, hash, member) \ + rht_for_each_entry_continue(tpos, pos, (tbl)->buckets[hash], \ + tbl, hash, member) + +/** + * rht_for_each_entry_safe - safely iterate over hash chain of given type + * @tpos: the type * to use as a loop cursor. + * @pos: the &struct rhash_head to use as a loop cursor. + * @next: the &struct rhash_head to use as next in loop cursor. + * @tbl: the &struct bucket_table + * @hash: the hash value / bucket index + * @member: name of the &struct rhash_head within the hashable struct. + * + * This hash chain list-traversal primitive allows for the looped code to + * remove the loop cursor from the list. + */ +#define rht_for_each_entry_safe(tpos, pos, next, tbl, hash, member) \ + for (pos = rht_dereference_bucket((tbl)->buckets[hash], tbl, hash), \ + next = !rht_is_a_nulls(pos) ? \ + rht_dereference_bucket(pos->next, tbl, hash) : NULL; \ + (!rht_is_a_nulls(pos)) && rht_entry(tpos, pos, member); \ + pos = next, \ + next = !rht_is_a_nulls(pos) ? \ + rht_dereference_bucket(pos->next, tbl, hash) : NULL) + +/** + * rht_for_each_rcu_continue - continue iterating over rcu hash chain + * @pos: the &struct rhash_head to use as a loop cursor. + * @head: the previous &struct rhash_head to continue from + * @tbl: the &struct bucket_table + * @hash: the hash value / bucket index + * + * This hash chain list-traversal primitive may safely run concurrently with + * the _rcu mutation primitives such as rhashtable_insert() as long as the + * traversal is guarded by rcu_read_lock(). + */ +#define rht_for_each_rcu_continue(pos, head, tbl, hash) \ + for (({barrier(); }), \ + pos = rht_dereference_bucket_rcu(head, tbl, hash); \ + !rht_is_a_nulls(pos); \ + pos = rcu_dereference_raw(pos->next)) + +/** + * rht_for_each_rcu - iterate over rcu hash chain + * @pos: the &struct rhash_head to use as a loop cursor. + * @tbl: the &struct bucket_table + * @hash: the hash value / bucket index + * + * This hash chain list-traversal primitive may safely run concurrently with + * the _rcu mutation primitives such as rhashtable_insert() as long as the + * traversal is guarded by rcu_read_lock(). + */ +#define rht_for_each_rcu(pos, tbl, hash) \ + rht_for_each_rcu_continue(pos, (tbl)->buckets[hash], tbl, hash) + +/** + * rht_for_each_entry_rcu_continue - continue iterating over rcu hash chain + * @tpos: the type * to use as a loop cursor. + * @pos: the &struct rhash_head to use as a loop cursor. + * @head: the previous &struct rhash_head to continue from + * @tbl: the &struct bucket_table + * @hash: the hash value / bucket index + * @member: name of the &struct rhash_head within the hashable struct. + * + * This hash chain list-traversal primitive may safely run concurrently with + * the _rcu mutation primitives such as rhashtable_insert() as long as the + * traversal is guarded by rcu_read_lock(). + */ +#define rht_for_each_entry_rcu_continue(tpos, pos, head, tbl, hash, member) \ + for (({barrier(); }), \ + pos = rht_dereference_bucket_rcu(head, tbl, hash); \ + (!rht_is_a_nulls(pos)) && rht_entry(tpos, pos, member); \ + pos = rht_dereference_bucket_rcu(pos->next, tbl, hash)) + +/** + * rht_for_each_entry_rcu - iterate over rcu hash chain of given type + * @tpos: the type * to use as a loop cursor. + * @pos: the &struct rhash_head to use as a loop cursor. + * @tbl: the &struct bucket_table + * @hash: the hash value / bucket index + * @member: name of the &struct rhash_head within the hashable struct. + * + * This hash chain list-traversal primitive may safely run concurrently with + * the _rcu mutation primitives such as rhashtable_insert() as long as the + * traversal is guarded by rcu_read_lock(). + */ +#define rht_for_each_entry_rcu(tpos, pos, tbl, hash, member) \ + rht_for_each_entry_rcu_continue(tpos, pos, (tbl)->buckets[hash],\ + tbl, hash, member) + +static inline int rhashtable_compare(struct rhashtable_compare_arg *arg, + const void *obj) +{ + struct rhashtable *ht = arg->ht; + const char *ptr = obj; + + return memcmp(ptr + ht->p.key_offset, arg->key, ht->p.key_len); +} + +/** + * rhashtable_lookup_fast - search hash table, inlined version + * @ht: hash table + * @key: the pointer to the key + * @params: hash table parameters + * + * Computes the hash value for the key and traverses the bucket chain looking + * for a entry with an identical key. The first matching entry is returned. + * + * Returns the first entry on which the compare function returned true. + */ +static inline void *rhashtable_lookup_fast( + struct rhashtable *ht, const void *key, + const struct rhashtable_params params) +{ + struct rhashtable_compare_arg arg = { + .ht = ht, + .key = key, + }; + const struct bucket_table *tbl; + struct rhash_head *he; + unsigned int hash; + + rcu_read_lock(); + + tbl = rht_dereference_rcu(ht->tbl, ht); +restart: + hash = rht_key_hashfn(ht, tbl, key, params); + rht_for_each_rcu(he, tbl, hash) { + if (params.obj_cmpfn ? + params.obj_cmpfn(&arg, rht_obj(ht, he)) : + rhashtable_compare(&arg, rht_obj(ht, he))) + continue; + rcu_read_unlock(); + return rht_obj(ht, he); + } + + /* Ensure we see any new tables. */ + smp_rmb(); + + tbl = rht_dereference_rcu(tbl->future_tbl, ht); + if (unlikely(tbl)) + goto restart; + rcu_read_unlock(); + + return NULL; +} + +/* Internal function, please use rhashtable_insert_fast() instead */ +static inline int __rhashtable_insert_fast( + struct rhashtable *ht, const void *key, struct rhash_head *obj, + const struct rhashtable_params params) +{ + struct rhashtable_compare_arg arg = { + .ht = ht, + .key = key, + }; + struct bucket_table *tbl, *new_tbl; + struct rhash_head *head; + spinlock_t *lock; + unsigned int elasticity; + unsigned int hash; + int err; + +restart: + rcu_read_lock(); + + tbl = rht_dereference_rcu(ht->tbl, ht); + + /* All insertions must grab the oldest table containing + * the hashed bucket that is yet to be rehashed. + */ + for (;;) { + hash = rht_head_hashfn(ht, tbl, obj, params); + lock = rht_bucket_lock(tbl, hash); + spin_lock_bh(lock); + + if (tbl->rehash <= hash) + break; + + spin_unlock_bh(lock); + tbl = rht_dereference_rcu(tbl->future_tbl, ht); + } + + new_tbl = rht_dereference_rcu(tbl->future_tbl, ht); + if (unlikely(new_tbl)) { + tbl = rhashtable_insert_slow(ht, key, obj, new_tbl); + if (!IS_ERR_OR_NULL(tbl)) + goto slow_path; + + err = PTR_ERR(tbl); + goto out; + } + + err = -E2BIG; + if (unlikely(rht_grow_above_max(ht, tbl))) + goto out; + + if (unlikely(rht_grow_above_100(ht, tbl))) { +slow_path: + spin_unlock_bh(lock); + err = rhashtable_insert_rehash(ht, tbl); + rcu_read_unlock(); + if (err) + return err; + + goto restart; + } + + err = -EEXIST; + elasticity = ht->elasticity; + rht_for_each(head, tbl, hash) { + if (key && + unlikely(!(params.obj_cmpfn ? + params.obj_cmpfn(&arg, rht_obj(ht, head)) : + rhashtable_compare(&arg, rht_obj(ht, head))))) + goto out; + if (!--elasticity) + goto slow_path; + } + + err = 0; + + head = rht_dereference_bucket(tbl->buckets[hash], tbl, hash); + + RCU_INIT_POINTER(obj->next, head); + + rcu_assign_pointer(tbl->buckets[hash], obj); + + atomic_inc(&ht->nelems); + if (rht_grow_above_75(ht, tbl)) + schedule_work(&ht->run_work); + +out: + spin_unlock_bh(lock); + rcu_read_unlock(); + + return err; +} + +/** + * rhashtable_insert_fast - insert object into hash table + * @ht: hash table + * @obj: pointer to hash head inside object + * @params: hash table parameters + * + * Will take a per bucket spinlock to protect against mutual mutations + * on the same bucket. Multiple insertions may occur in parallel unless + * they map to the same bucket lock. + * + * It is safe to call this function from atomic context. + * + * Will trigger an automatic deferred table resizing if the size grows + * beyond the watermark indicated by grow_decision() which can be passed + * to rhashtable_init(). + */ +static inline int rhashtable_insert_fast( + struct rhashtable *ht, struct rhash_head *obj, + const struct rhashtable_params params) +{ + return __rhashtable_insert_fast(ht, NULL, obj, params); +} + +/** + * rhashtable_lookup_insert_fast - lookup and insert object into hash table + * @ht: hash table + * @obj: pointer to hash head inside object + * @params: hash table parameters + * + * Locks down the bucket chain in both the old and new table if a resize + * is in progress to ensure that writers can't remove from the old table + * and can't insert to the new table during the atomic operation of search + * and insertion. Searches for duplicates in both the old and new table if + * a resize is in progress. + * + * This lookup function may only be used for fixed key hash table (key_len + * parameter set). It will BUG() if used inappropriately. + * + * It is safe to call this function from atomic context. + * + * Will trigger an automatic deferred table resizing if the size grows + * beyond the watermark indicated by grow_decision() which can be passed + * to rhashtable_init(). + */ +static inline int rhashtable_lookup_insert_fast( + struct rhashtable *ht, struct rhash_head *obj, + const struct rhashtable_params params) +{ + const char *key = rht_obj(ht, obj); + + BUG_ON(ht->p.obj_hashfn); + + return __rhashtable_insert_fast(ht, key + ht->p.key_offset, obj, + params); +} + +/** + * rhashtable_lookup_insert_key - search and insert object to hash table + * with explicit key + * @ht: hash table + * @key: key + * @obj: pointer to hash head inside object + * @params: hash table parameters + * + * Locks down the bucket chain in both the old and new table if a resize + * is in progress to ensure that writers can't remove from the old table + * and can't insert to the new table during the atomic operation of search + * and insertion. Searches for duplicates in both the old and new table if + * a resize is in progress. + * + * Lookups may occur in parallel with hashtable mutations and resizing. + * + * Will trigger an automatic deferred table resizing if the size grows + * beyond the watermark indicated by grow_decision() which can be passed + * to rhashtable_init(). + * + * Returns zero on success. + */ +static inline int rhashtable_lookup_insert_key( + struct rhashtable *ht, const void *key, struct rhash_head *obj, + const struct rhashtable_params params) +{ + BUG_ON(!ht->p.obj_hashfn || !key); + + return __rhashtable_insert_fast(ht, key, obj, params); +} + +/* Internal function, please use rhashtable_remove_fast() instead */ +static inline int __rhashtable_remove_fast( + struct rhashtable *ht, struct bucket_table *tbl, + struct rhash_head *obj, const struct rhashtable_params params) +{ + struct rhash_head __rcu **pprev; + struct rhash_head *he; + spinlock_t * lock; + unsigned int hash; + int err = -ENOENT; + + hash = rht_head_hashfn(ht, tbl, obj, params); + lock = rht_bucket_lock(tbl, hash); + + spin_lock_bh(lock); + + pprev = &tbl->buckets[hash]; + rht_for_each(he, tbl, hash) { + if (he != obj) { + pprev = &he->next; + continue; + } + + rcu_assign_pointer(*pprev, obj->next); + err = 0; + break; + } + + spin_unlock_bh(lock); + + return err; +} + +/** + * rhashtable_remove_fast - remove object from hash table + * @ht: hash table + * @obj: pointer to hash head inside object + * @params: hash table parameters + * + * Since the hash chain is single linked, the removal operation needs to + * walk the bucket chain upon removal. The removal operation is thus + * considerable slow if the hash table is not correctly sized. + * + * Will automatically shrink the table via rhashtable_expand() if the + * shrink_decision function specified at rhashtable_init() returns true. + * + * Returns zero on success, -ENOENT if the entry could not be found. + */ +static inline int rhashtable_remove_fast( + struct rhashtable *ht, struct rhash_head *obj, + const struct rhashtable_params params) +{ + struct bucket_table *tbl; + int err; + + rcu_read_lock(); + + tbl = rht_dereference_rcu(ht->tbl, ht); + + /* Because we have already taken (and released) the bucket + * lock in old_tbl, if we find that future_tbl is not yet + * visible then that guarantees the entry to still be in + * the old tbl if it exists. + */ + while ((err = __rhashtable_remove_fast(ht, tbl, obj, params)) && + (tbl = rht_dereference_rcu(tbl->future_tbl, ht))) + ; + + if (err) + goto out; + + atomic_dec(&ht->nelems); + if (unlikely(ht->p.automatic_shrinking && + rht_shrink_below_30(ht, tbl))) + schedule_work(&ht->run_work); + +out: + rcu_read_unlock(); + + return err; +} + +#endif /* _LINUX_RHASHTABLE_H */ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/rtw_android.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/rtw_android.c index 5ab4e61ccbc5..b857890c3643 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/rtw_android.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/rtw_android.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 @@ -60,6 +56,7 @@ const char *android_wifi_cmd_str[ANDROID_WIFI_CMD_MAX] = { "BTCOEXSCAN-START", "BTCOEXSCAN-STOP", "BTCOEXMODE", + "SETSUSPENDMODE", "SETSUSPENDOPT", "P2P_DEV_ADDR", "SETFWPATH", @@ -98,6 +95,8 @@ const char *android_wifi_cmd_str[ANDROID_WIFI_CMD_MAX] = { #endif /* CONFIG_GTK_OL */ /* Private command for P2P disable*/ "P2P_DISABLE", + "SET_AEK", + "EXT_AUTH_STATUS", "DRIVER_VERSION" }; @@ -310,7 +309,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); @@ -381,8 +383,6 @@ int rtw_android_get_rssi(struct net_device *net, char *command, int total_len) int rtw_android_get_link_speed(struct net_device *net, char *command, int total_len) { _adapter *padapter = (_adapter *)rtw_netdev_priv(net); - struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); - struct wlan_network *pcur_network = &pmlmepriv->cur_network; int bytes_written = 0; u16 link_speed = 0; @@ -394,7 +394,6 @@ int rtw_android_get_link_speed(struct net_device *net, char *command, int total_ int rtw_android_get_macaddr(struct net_device *net, char *command, int total_len) { - _adapter *adapter = (_adapter *)rtw_netdev_priv(net); int bytes_written = 0; bytes_written = snprintf(command, total_len, "Macaddr = "MAC_FMT, MAC_ARG(net->dev_addr)); @@ -566,8 +565,41 @@ int rtw_gtk_offload(struct net_device *net, u8 *cmd_ptr) } #endif /* CONFIG_GTK_OL */ +#ifdef CONFIG_RTW_MESH_AEK +static int rtw_android_set_aek(struct net_device *ndev, char *command, int total_len) +{ +#define SET_AEK_DATA_LEN (ETH_ALEN + 32) + + _adapter *adapter = (_adapter *)rtw_netdev_priv(ndev); + u8 *addr; + u8 *aek; + int err = 0; + + if (total_len - strlen(android_wifi_cmd_str[ANDROID_WIFI_CMD_SET_AEK]) - 1 != SET_AEK_DATA_LEN) { + err = -EINVAL; + goto exit; + } + + addr = command + strlen(android_wifi_cmd_str[ANDROID_WIFI_CMD_SET_AEK]) + 1; + aek = addr + ETH_ALEN; + + RTW_PRINT(FUNC_NDEV_FMT" addr="MAC_FMT"\n" + , FUNC_NDEV_ARG(ndev), MAC_ARG(addr)); + if (0) + RTW_PRINT(FUNC_NDEV_FMT" aek="KEY_FMT KEY_FMT"\n" + , FUNC_NDEV_ARG(ndev), KEY_ARG(aek), KEY_ARG(aek + 16)); + + if (rtw_mesh_plink_set_aek(adapter, addr, aek) != _SUCCESS) + err = -ENOENT; + +exit: + return err; +} +#endif /* CONFIG_RTW_MESH_AEK */ + int rtw_android_priv_cmd(struct net_device *net, struct ifreq *ifr, int cmd) { + #define PRIVATE_COMMAND_MAX_LEN 8192 int ret = 0; char *command = NULL; int cmd_num; @@ -619,14 +651,24 @@ int rtw_android_priv_cmd(struct net_device *net, struct ifreq *ifr, int cmd) goto exit; } /*RTW_INFO("%s priv_cmd.buf=%p priv_cmd.total_len=%d priv_cmd.used_len=%d\n",__func__,priv_cmd.buf,priv_cmd.total_len,priv_cmd.used_len);*/ - command = rtw_zmalloc(priv_cmd.total_len); + if (priv_cmd.total_len > PRIVATE_COMMAND_MAX_LEN || priv_cmd.total_len < 0) { + RTW_WARN("%s: invalid private command (%d)\n", __FUNCTION__, + priv_cmd.total_len); + ret = -EFAULT; + goto exit; + } + + command = rtw_zmalloc(priv_cmd.total_len+1); if (!command) { RTW_INFO("%s: failed to allocate memory\n", __FUNCTION__); ret = -ENOMEM; goto exit; } - + #if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 0, 0)) + if (!access_ok(priv_cmd.buf, priv_cmd.total_len)) { + #else if (!access_ok(VERIFY_READ, priv_cmd.buf, priv_cmd.total_len)) { + #endif RTW_INFO("%s: failed to access memory\n", __FUNCTION__); ret = -EFAULT; goto exit; @@ -635,7 +677,7 @@ int rtw_android_priv_cmd(struct net_device *net, struct ifreq *ifr, int cmd) ret = -EFAULT; goto exit; } - + command[priv_cmd.total_len] = '\0'; RTW_INFO("%s: Android private cmd \"%s\" on %s\n" , __FUNCTION__, command, ifr->ifr_name); @@ -738,6 +780,9 @@ int rtw_android_priv_cmd(struct net_device *net, struct ifreq *ifr, int cmd) #endif break; + case ANDROID_WIFI_CMD_SETSUSPENDMODE: + break; + case ANDROID_WIFI_CMD_SETSUSPENDOPT: /* bytes_written = wl_android_set_suspendopt(net, command, priv_cmd.total_len); */ break; @@ -822,7 +867,7 @@ int rtw_android_priv_cmd(struct net_device *net, struct ifreq *ifr, int cmd) /* wpa_cli driver wfd-set-tcpport = 554 */ if (padapter->wdinfo.driver_interface == DRIVER_CFG80211) - rtw_wfd_set_ctrl_port(padapter, (u16)get_int_from_command(priv_cmd.buf)); + rtw_wfd_set_ctrl_port(padapter, (u16)get_int_from_command(command)); break; } case ANDROID_WIFI_CMD_WFD_SET_MAX_TPUT: { @@ -834,7 +879,7 @@ int rtw_android_priv_cmd(struct net_device *net, struct ifreq *ifr, int cmd) pwfd_info = &padapter->wfd_info; if (padapter->wdinfo.driver_interface == DRIVER_CFG80211) { - pwfd_info->wfd_device_type = (u8) get_int_from_command(priv_cmd.buf); + pwfd_info->wfd_device_type = (u8) get_int_from_command(command); pwfd_info->wfd_device_type &= WFD_DEVINFO_DUAL; } break; @@ -843,7 +888,7 @@ int rtw_android_priv_cmd(struct net_device *net, struct ifreq *ifr, int cmd) case ANDROID_WIFI_CMD_CHANGE_DTIM: { #ifdef CONFIG_LPS u8 dtim; - u8 *ptr = (u8 *) &priv_cmd.buf; + u8 *ptr = (u8 *) command; ptr += 9;/* string command length of "SET_DTIM"; */ @@ -858,19 +903,19 @@ int rtw_android_priv_cmd(struct net_device *net, struct ifreq *ifr, int cmd) #if CONFIG_RTW_MACADDR_ACL case ANDROID_WIFI_CMD_HOSTAPD_SET_MACADDR_ACL: { - rtw_set_macaddr_acl(padapter, get_int_from_command(command)); + rtw_set_macaddr_acl(padapter, RTW_ACL_PERIOD_BSS, get_int_from_command(command)); break; } case ANDROID_WIFI_CMD_HOSTAPD_ACL_ADD_STA: { u8 addr[ETH_ALEN] = {0x00}; macstr2num(addr, command + strlen("HOSTAPD_ACL_ADD_STA") + 3); /* 3 is space bar + "=" + space bar these 3 chars */ - rtw_acl_add_sta(padapter, addr); + rtw_acl_add_sta(padapter, RTW_ACL_PERIOD_BSS, addr); break; } case ANDROID_WIFI_CMD_HOSTAPD_ACL_REMOVE_STA: { u8 addr[ETH_ALEN] = {0x00}; macstr2num(addr, command + strlen("HOSTAPD_ACL_REMOVE_STA") + 3); /* 3 is space bar + "=" + space bar these 3 chars */ - rtw_acl_remove_sta(padapter, addr); + rtw_acl_remove_sta(padapter, RTW_ACL_PERIOD_BSS, addr); break; } #endif /* CONFIG_RTW_MACADDR_ACL */ @@ -881,14 +926,23 @@ int rtw_android_priv_cmd(struct net_device *net, struct ifreq *ifr, int cmd) #endif /* CONFIG_GTK_OL */ case ANDROID_WIFI_CMD_P2P_DISABLE: { #ifdef CONFIG_P2P - struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - u8 channel, ch_offset; - u16 bwmode; - rtw_p2p_enable(padapter, P2P_ROLE_DISABLE); #endif /* CONFIG_P2P */ break; } + +#ifdef CONFIG_RTW_MESH_AEK + case ANDROID_WIFI_CMD_SET_AEK: + bytes_written = rtw_android_set_aek(net, command, priv_cmd.total_len); + break; +#endif + + case ANDROID_WIFI_CMD_EXT_AUTH_STATUS: { + rtw_set_external_auth_status(padapter, + command + strlen("EXT_AUTH_STATUS "), + priv_cmd.total_len - strlen("EXT_AUTH_STATUS ")); + break; + } case ANDROID_WIFI_CMD_DRIVERVERSION: { bytes_written = strlen(DRIVERVERSION); snprintf(command, bytes_written + 1, DRIVERVERSION); @@ -920,7 +974,7 @@ int rtw_android_priv_cmd(struct net_device *net, struct ifreq *ifr, int cmd) exit: rtw_unlock_suspend(); if (command) - rtw_mfree(command, priv_cmd.total_len); + rtw_mfree(command, priv_cmd.total_len + 1); return ret; } @@ -1056,7 +1110,7 @@ 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__, + RTW_INFO("%s: gpio:%d wifi_wake_gpio:%d\n", __func__, (int)wifi_irqres->start, wifi_wake_gpio); if (wifi_wake_gpio > 0) { @@ -1067,10 +1121,10 @@ 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; @@ -1099,6 +1153,14 @@ static void shutdown_card(void) LeaveAllPowerSaveMode(g_test_adapter); #endif /* CONFIG_FWLPS_IN_IPS */ +#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(g_test_adapter, WAKEUP_GPIO_IDX, _FALSE); +#endif /* CONFIG_GPIO_WAKEUP */ +#endif /* CONFIG_WOWLAN */ + /* Leave SDIO HCI Suspend */ addr = 0x10250086; rtw_write8(g_test_adapter, addr, 0); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/rtw_cfgvendor.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/rtw_cfgvendor.c index b8497d9ed7ef..1eb8f666033b 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/rtw_cfgvendor.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/rtw_cfgvendor.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 @@ -214,22 +210,34 @@ static int rtw_cfgvendor_send_cmd_reply(struct wiphy *wiphy, return rtw_cfg80211_vendor_cmd_reply(skb); } -#define WIFI_FEATURE_INFRA 0x0001 /* Basic infrastructure mode */ -#define WIFI_FEATURE_INFRA_5G 0x0002 /* Support for 5 GHz Band */ -#define WIFI_FEATURE_HOTSPOT 0x0004 /* Support for GAS/ANQP */ -#define WIFI_FEATURE_P2P 0x0008 /* Wifi-Direct */ -#define WIFI_FEATURE_SOFT_AP 0x0010 /* Soft AP */ -#define WIFI_FEATURE_GSCAN 0x0020 /* Google-Scan APIs */ -#define WIFI_FEATURE_NAN 0x0040 /* Neighbor Awareness Networking */ -#define WIFI_FEATURE_D2D_RTT 0x0080 /* Device-to-device RTT */ -#define WIFI_FEATURE_D2AP_RTT 0x0100 /* Device-to-AP RTT */ -#define WIFI_FEATURE_BATCH_SCAN 0x0200 /* Batched Scan (legacy) */ -#define WIFI_FEATURE_PNO 0x0400 /* Preferred network offload */ -#define WIFI_FEATURE_ADDITIONAL_STA 0x0800 /* Support for two STAs */ -#define WIFI_FEATURE_TDLS 0x1000 /* Tunnel directed link setup */ -#define WIFI_FEATURE_TDLS_OFFCHANNEL 0x2000 /* Support for TDLS off channel */ -#define WIFI_FEATURE_EPR 0x4000 /* Enhanced power reporting */ -#define WIFI_FEATURE_AP_STA 0x8000 /* Support for AP STA Concurrency */ +/* Feature enums */ +#define WIFI_FEATURE_INFRA 0x0001 // Basic infrastructure mode +#define WIFI_FEATURE_INFRA_5G 0x0002 // Support for 5 GHz Band +#define WIFI_FEATURE_HOTSPOT 0x0004 // Support for GAS/ANQP +#define WIFI_FEATURE_P2P 0x0008 // Wifi-Direct +#define WIFI_FEATURE_SOFT_AP 0x0010 // Soft AP +#define WIFI_FEATURE_GSCAN 0x0020 // Google-Scan APIs +#define WIFI_FEATURE_NAN 0x0040 // Neighbor Awareness Networking +#define WIFI_FEATURE_D2D_RTT 0x0080 // Device-to-device RTT +#define WIFI_FEATURE_D2AP_RTT 0x0100 // Device-to-AP RTT +#define WIFI_FEATURE_BATCH_SCAN 0x0200 // Batched Scan (legacy) +#define WIFI_FEATURE_PNO 0x0400 // Preferred network offload +#define WIFI_FEATURE_ADDITIONAL_STA 0x0800 // Support for two STAs +#define WIFI_FEATURE_TDLS 0x1000 // Tunnel directed link setup +#define WIFI_FEATURE_TDLS_OFFCHANNEL 0x2000 // Support for TDLS off channel +#define WIFI_FEATURE_EPR 0x4000 // Enhanced power reporting +#define WIFI_FEATURE_AP_STA 0x8000 // Support for AP STA Concurrency +#define WIFI_FEATURE_LINK_LAYER_STATS 0x10000 // Link layer stats collection +#define WIFI_FEATURE_LOGGER 0x20000 // WiFi Logger +#define WIFI_FEATURE_HAL_EPNO 0x40000 // WiFi PNO enhanced +#define WIFI_FEATURE_RSSI_MONITOR 0x80000 // RSSI Monitor +#define WIFI_FEATURE_MKEEP_ALIVE 0x100000 // WiFi mkeep_alive +#define WIFI_FEATURE_CONFIG_NDO 0x200000 // ND offload configure +#define WIFI_FEATURE_TX_TRANSMIT_POWER 0x400000 // Capture Tx transmit power levels +#define WIFI_FEATURE_CONTROL_ROAMING 0x800000 // Enable/Disable firmware roaming +#define WIFI_FEATURE_IE_WHITELIST 0x1000000 // Support Probe IE white listing +#define WIFI_FEATURE_SCAN_RAND 0x2000000 // Support MAC & Probe Sequence Number randomization +// Add more features here #define MAX_FEATURE_SET_CONCURRRENT_GROUPS 3 @@ -244,14 +252,31 @@ int rtw_dev_get_feature_set(struct net_device *dev) feature_set |= WIFI_FEATURE_INFRA; - if (IS_8814A_SERIES(*hal_ver) || IS_8812_SERIES(*hal_ver) || - IS_8821_SERIES(*hal_ver)) +#ifdef CONFIG_IEEE80211_BAND_5GHZ + if (is_supported_5g(adapter_to_regsty(adapter)->wireless_mode)) feature_set |= WIFI_FEATURE_INFRA_5G; +#endif feature_set |= WIFI_FEATURE_P2P; feature_set |= WIFI_FEATURE_SOFT_AP; feature_set |= WIFI_FEATURE_ADDITIONAL_STA; +#ifdef CONFIG_RTW_CFGVEDNOR_LLSTATS + feature_set |= WIFI_FEATURE_LINK_LAYER_STATS; +#endif /* CONFIG_RTW_CFGVEDNOR_LLSTATS */ + +#ifdef CONFIG_RTW_CFGVEDNOR_RSSIMONITOR + feature_set |= WIFI_FEATURE_RSSI_MONITOR; +#endif + +#ifdef CONFIG_RTW_CFGVENDOR_WIFI_LOGGER + feature_set |= WIFI_FEATURE_LOGGER; +#endif + +#ifdef CONFIG_RTW_WIFI_HAL + feature_set |= WIFI_FEATURE_CONFIG_NDO; + feature_set |= WIFI_FEATURE_SCAN_RAND; +#endif return feature_set; } @@ -367,8 +392,8 @@ static int rtw_cfgvendor_get_feature_set_matrix(struct wiphy *wiphy, } #if defined(GSCAN_SUPPORT) && 0 -int wl_cfgvendor_send_hotlist_event(struct wiphy *wiphy, - struct net_device *dev, void *data, int len, wl_vendor_event_t event) +int rtw_cfgvendor_send_hotlist_event(struct wiphy *wiphy, + struct net_device *dev, void *data, int len, rtw_vendor_event_t event) { u16 kflags; const void *ptr; @@ -418,7 +443,7 @@ int wl_cfgvendor_send_hotlist_event(struct wiphy *wiphy, } -static int wl_cfgvendor_gscan_get_capabilities(struct wiphy *wiphy, +static int rtw_cfgvendor_gscan_get_capabilities(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int len) { int err = 0; @@ -445,7 +470,7 @@ static int wl_cfgvendor_gscan_get_capabilities(struct wiphy *wiphy, return err; } -static int wl_cfgvendor_gscan_get_channel_list(struct wiphy *wiphy, +static int rtw_cfgvendor_gscan_get_channel_list(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int len) { int err = 0, type, band; @@ -492,7 +517,7 @@ static int wl_cfgvendor_gscan_get_channel_list(struct wiphy *wiphy, return err; } -static int wl_cfgvendor_gscan_get_batch_results(struct wiphy *wiphy, +static int rtw_cfgvendor_gscan_get_batch_results(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int len) { int err = 0; @@ -576,7 +601,7 @@ static int wl_cfgvendor_gscan_get_batch_results(struct wiphy *wiphy, return rtw_cfg80211_vendor_cmd_reply(skb); } -static int wl_cfgvendor_initiate_gscan(struct wiphy *wiphy, +static int rtw_cfgvendor_initiate_gscan(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int len) { int err = 0; @@ -606,7 +631,7 @@ static int wl_cfgvendor_initiate_gscan(struct wiphy *wiphy, } -static int wl_cfgvendor_enable_full_scan_result(struct wiphy *wiphy, +static int rtw_cfgvendor_enable_full_scan_result(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int len) { int err = 0; @@ -630,7 +655,7 @@ static int wl_cfgvendor_enable_full_scan_result(struct wiphy *wiphy, return err; } -static int wl_cfgvendor_set_scan_cfg(struct wiphy *wiphy, +static int rtw_cfgvendor_set_scan_cfg(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int len) { int err = 0; @@ -722,7 +747,7 @@ static int wl_cfgvendor_set_scan_cfg(struct wiphy *wiphy, } -static int wl_cfgvendor_hotlist_cfg(struct wiphy *wiphy, +static int rtw_cfgvendor_hotlist_cfg(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int len) { int err = 0; @@ -788,7 +813,7 @@ static int wl_cfgvendor_hotlist_cfg(struct wiphy *wiphy, kfree(hotlist_params); return err; } -static int wl_cfgvendor_set_batch_scan_cfg(struct wiphy *wiphy, +static int rtw_cfgvendor_set_batch_scan_cfg(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int len) { int err = 0, tmp, type; @@ -825,7 +850,7 @@ static int wl_cfgvendor_set_batch_scan_cfg(struct wiphy *wiphy, return err; } -static int wl_cfgvendor_significant_change_cfg(struct wiphy *wiphy, +static int rtw_cfgvendor_significant_change_cfg(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int len) { int err = 0; @@ -899,7 +924,7 @@ static int wl_cfgvendor_significant_change_cfg(struct wiphy *wiphy, #endif /* GSCAN_SUPPORT */ #if defined(RTT_SUPPORT) && 0 -void wl_cfgvendor_rtt_evt(void *ctx, void *rtt_data) +void rtw_cfgvendor_rtt_evt(void *ctx, void *rtt_data) { struct wireless_dev *wdev = (struct wireless_dev *)ctx; struct wiphy *wiphy; @@ -963,7 +988,7 @@ void wl_cfgvendor_rtt_evt(void *ctx, void *rtt_data) return; } -static int wl_cfgvendor_rtt_set_config(struct wiphy *wiphy, struct wireless_dev *wdev, +static int rtw_cfgvendor_rtt_set_config(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int len) { int err = 0, rem, rem1, rem2, type; @@ -1050,7 +1075,7 @@ static int wl_cfgvendor_rtt_set_config(struct wiphy *wiphy, struct wireless_dev return err; } -static int wl_cfgvendor_rtt_cancel_config(struct wiphy *wiphy, struct wireless_dev *wdev, +static int rtw_cfgvendor_rtt_cancel_config(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int len) { int err = 0, rem, type, target_cnt = 0; @@ -1090,7 +1115,7 @@ static int wl_cfgvendor_rtt_cancel_config(struct wiphy *wiphy, struct wireless_d kfree(mac_list); return err; } -static int wl_cfgvendor_rtt_get_capability(struct wiphy *wiphy, struct wireless_dev *wdev, +static int rtw_cfgvendor_rtt_get_capability(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int len) { int err = 0; @@ -1112,57 +1137,611 @@ static int wl_cfgvendor_rtt_get_capability(struct wiphy *wiphy, struct wireless_ } #endif /* RTT_SUPPORT */ -static int wl_cfgvendor_priv_string_handler(struct wiphy *wiphy, - struct wireless_dev *wdev, const void *data, int len) + +#ifdef CONFIG_RTW_CFGVEDNOR_LLSTATS +enum { + LSTATS_SUBCMD_GET_INFO = ANDROID_NL80211_SUBCMD_LSTATS_RANGE_START, + LSTATS_SUBCMD_SET_INFO, + LSTATS_SUBCMD_CLEAR_INFO, +}; +static void LinkLayerStats(_adapter *padapter) +{ + struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); + struct recv_priv *precvpriv = &(padapter->recvpriv); + struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); + struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); + u32 ps_time, trx_total_time; + u64 tx_bytes, rx_bytes, trx_total_bytes = 0; + u64 tmp = 0; + + RTW_DBG("%s adapter type : %u\n", __func__, padapter->adapter_type); + + tx_bytes = 0; + rx_bytes = 0; + ps_time = 0; + trx_total_time = 0; + + if ( padapter->netif_up == _TRUE ) { + + pwrpriv->on_time = rtw_get_passing_time_ms(pwrpriv->radio_on_start_time); + + if (rtw_mi_check_fwstate(padapter, _FW_LINKED)) { + if ( pwrpriv->bpower_saving == _TRUE ) { + pwrpriv->pwr_saving_time += rtw_get_passing_time_ms(pwrpriv->pwr_saving_start_time); + pwrpriv->pwr_saving_start_time = rtw_get_current_time(); + } + } else { +#ifdef CONFIG_IPS + if ( pwrpriv->bpower_saving == _TRUE ) { + pwrpriv->pwr_saving_time += rtw_get_passing_time_ms(pwrpriv->pwr_saving_start_time); + pwrpriv->pwr_saving_start_time = rtw_get_current_time(); + } +#else + pwrpriv->pwr_saving_time = pwrpriv->on_time; +#endif + } + + ps_time = pwrpriv->pwr_saving_time; + + /* Deviation caused by caculation start time */ + if ( ps_time > pwrpriv->on_time ) + ps_time = pwrpriv->on_time; + + tx_bytes = pdvobjpriv->traffic_stat.last_tx_bytes; + rx_bytes = pdvobjpriv->traffic_stat.last_rx_bytes; + trx_total_bytes = tx_bytes + rx_bytes; + + trx_total_time = pwrpriv->on_time - ps_time; + + if ( trx_total_bytes == 0) { + pwrpriv->tx_time = 0; + pwrpriv->rx_time = 0; + } else { + + /* tx_time = (trx_total_time * tx_total_bytes) / trx_total_bytes; */ + /* rx_time = (trx_total_time * rx_total_bytes) / trx_total_bytes; */ + + tmp = (tx_bytes * trx_total_time); + tmp = rtw_division64(tmp, trx_total_bytes); + pwrpriv->tx_time = tmp; + + tmp = (rx_bytes * trx_total_time); + tmp = rtw_division64(tmp, trx_total_bytes); + pwrpriv->rx_time = tmp; + + } + + } + else { + pwrpriv->on_time = 0; + pwrpriv->tx_time = 0; + pwrpriv->rx_time = 0; + } + +#ifdef CONFIG_RTW_WIFI_HAL_DEBUG + RTW_INFO("- tx_bytes : %llu rx_bytes : %llu total bytes : %llu\n", tx_bytes, rx_bytes, trx_total_bytes); + RTW_INFO("- netif_up = %s, on_time : %u ms\n", padapter->netif_up ? "1":"0", pwrpriv->on_time); + RTW_INFO("- pwr_saving_time : %u (%u) ms\n", pwrpriv->pwr_saving_time, ps_time); + RTW_INFO("- trx_total_time : %u ms\n", trx_total_time); + RTW_INFO("- tx_time : %u ms\n", pwrpriv->tx_time); + RTW_INFO("- rx_time : %u ms\n", pwrpriv->rx_time); +#endif /* CONFIG_RTW_WIFI_HAL_DEBUG */ + +} + +#define DUMMY_TIME_STATICS 99 +static int rtw_cfgvendor_lstats_get_info(struct wiphy *wiphy, + struct wireless_dev *wdev, const void *data, int len) { int err = 0; - u8 resp[1] = {'\0'}; + _adapter *padapter = GET_PRIMARY_ADAPTER(wiphy_to_adapter(wiphy)); + struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); + wifi_radio_stat_internal *radio; + wifi_iface_stat *iface; + char *output; - RTW_PRINT(FUNC_NDEV_FMT" %s\n", FUNC_NDEV_ARG(wdev_to_ndev(wdev)), (char *)data); - err = rtw_cfgvendor_send_cmd_reply(wiphy, wdev_to_ndev(wdev), resp, 1); + output = rtw_malloc(sizeof(wifi_radio_stat_internal) + sizeof(wifi_iface_stat)); + if (output == NULL) { + RTW_DBG("Allocate lstats info buffer fail!\n"); + } + + radio = (wifi_radio_stat_internal *)output; + + radio->num_channels = 0; + radio->radio = 1; + + /* to get on_time, tx_time, rx_time */ + LinkLayerStats(padapter); + + radio->on_time = pwrpriv->on_time; + radio->tx_time = pwrpriv->tx_time; + radio->rx_time = pwrpriv->rx_time; + radio->on_time_scan = 0; + radio->on_time_nbd = 0; + radio->on_time_gscan = 0; + radio->on_time_pno_scan = 0; + radio->on_time_hs20 = 0; + #ifdef CONFIG_RTW_WIFI_HAL_DEBUG + RTW_INFO("==== %s ====\n", __func__); + RTW_INFO("radio->radio : %d\n", (radio->radio)); + RTW_INFO("pwrpriv->on_time : %u ms\n", (pwrpriv->on_time)); + RTW_INFO("pwrpriv->tx_time : %u ms\n", (pwrpriv->tx_time)); + RTW_INFO("pwrpriv->rx_time : %u ms\n", (pwrpriv->rx_time)); + RTW_INFO("radio->on_time : %u ms\n", (radio->on_time)); + RTW_INFO("radio->tx_time : %u ms\n", (radio->tx_time)); + RTW_INFO("radio->rx_time : %u ms\n", (radio->rx_time)); + #endif /* CONFIG_RTW_WIFI_HAL_DEBUG */ + + RTW_DBG(FUNC_NDEV_FMT" %s\n", FUNC_NDEV_ARG(wdev_to_ndev(wdev)), (char*)data); + err = rtw_cfgvendor_send_cmd_reply(wiphy, wdev_to_ndev(wdev), + output, sizeof(wifi_iface_stat) + sizeof(wifi_radio_stat_internal)); if (unlikely(err)) - RTW_ERR(FUNC_NDEV_FMT"Vendor Command reply failed ret:%d\n" + RTW_ERR(FUNC_NDEV_FMT"Vendor Command reply failed ret:%d \n" + , FUNC_NDEV_ARG(wdev_to_ndev(wdev)), err); + rtw_mfree(output, sizeof(wifi_iface_stat) + sizeof(wifi_radio_stat_internal)); + return err; +} +static int rtw_cfgvendor_lstats_set_info(struct wiphy *wiphy, + struct wireless_dev *wdev, const void *data, int len) +{ + int err = 0; + RTW_INFO("%s\n", __func__); + return err; +} +static int rtw_cfgvendor_lstats_clear_info(struct wiphy *wiphy, + struct wireless_dev *wdev, const void *data, int len) +{ + int err = 0; + RTW_INFO("%s\n", __func__); + return err; +} +#endif /* CONFIG_RTW_CFGVEDNOR_LLSTATS */ +#ifdef CONFIG_RTW_CFGVEDNOR_RSSIMONITOR +static int rtw_cfgvendor_set_rssi_monitor(struct wiphy *wiphy, + struct wireless_dev *wdev, const void *data, int len) +{ + _adapter *padapter = GET_PRIMARY_ADAPTER(wiphy_to_adapter(wiphy)); + struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); + + struct recv_priv *precvpriv = &padapter->recvpriv; + int err = 0, rem, type; + const struct nlattr *iter; + + RTW_DBG(FUNC_NDEV_FMT" %s\n", FUNC_NDEV_ARG(wdev_to_ndev(wdev)), (char*)data); + + nla_for_each_attr(iter, data, len, rem) { + type = nla_type(iter); + + switch (type) { + case RSSI_MONITOR_ATTRIBUTE_MAX_RSSI: + pwdev_priv->rssi_monitor_max = (s8)nla_get_u32(iter);; + break; + case RSSI_MONITOR_ATTRIBUTE_MIN_RSSI: + pwdev_priv->rssi_monitor_min = (s8)nla_get_u32(iter); + break; + case RSSI_MONITOR_ATTRIBUTE_START: + pwdev_priv->rssi_monitor_enable = (u8)nla_get_u32(iter); + break; + } + } + + return err; +} + +void rtw_cfgvendor_rssi_monitor_evt(_adapter *padapter) { + struct wireless_dev *wdev = padapter->rtw_wdev; + struct wiphy *wiphy= wdev->wiphy; + struct recv_priv *precvpriv = &padapter->recvpriv; + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct wlan_network *pcur_network = &pmlmepriv->cur_network; + struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); + struct sk_buff *skb; + u32 tot_len = NLMSG_DEFAULT_SIZE; + gfp_t kflags; + rssi_monitor_evt data ; + s8 rssi = precvpriv->rssi; + + if (pwdev_priv->rssi_monitor_enable == 0 || check_fwstate(pmlmepriv, _FW_LINKED) != _TRUE) + return; + + if (rssi < pwdev_priv->rssi_monitor_max || rssi > pwdev_priv->rssi_monitor_min) + return; + + kflags = in_atomic() ? GFP_ATOMIC : GFP_KERNEL; + + /* Alloc the SKB for vendor_event */ + skb = rtw_cfg80211_vendor_event_alloc(wiphy, wdev, tot_len, GOOGLE_RSSI_MONITOR_EVENT, kflags); + if (!skb) { + goto exit; + } + + _rtw_memset(&data, 0, sizeof(data)); + + data.version = RSSI_MONITOR_EVT_VERSION; + data.cur_rssi = rssi; + _rtw_memcpy(data.BSSID, pcur_network->network.MacAddress, sizeof(mac_addr)); + + nla_append(skb, sizeof(data), &data); + + rtw_cfg80211_vendor_event(skb, kflags); +exit: + return; +} +#endif /* CONFIG_RTW_CFGVEDNOR_RSSIMONITR */ + +#ifdef CONFIG_RTW_CFGVENDOR_WIFI_LOGGER +static int rtw_cfgvendor_logger_start_logging(struct wiphy *wiphy, + struct wireless_dev *wdev, const void *data, int len) +{ + int ret = 0, rem, type; + char ring_name[32] = {0}; + int log_level = 0, flags = 0, time_intval = 0, threshold = 0; + const struct nlattr *iter; + + nla_for_each_attr(iter, data, len, rem) { + type = nla_type(iter); + switch (type) { + case LOGGER_ATTRIBUTE_RING_NAME: + strncpy(ring_name, nla_data(iter), + MIN(sizeof(ring_name) -1, nla_len(iter))); + break; + case LOGGER_ATTRIBUTE_LOG_LEVEL: + log_level = nla_get_u32(iter); + break; + case LOGGER_ATTRIBUTE_RING_FLAGS: + flags = nla_get_u32(iter); + break; + case LOGGER_ATTRIBUTE_LOG_TIME_INTVAL: + time_intval = nla_get_u32(iter); + break; + case LOGGER_ATTRIBUTE_LOG_MIN_DATA_SIZE: + threshold = nla_get_u32(iter); + break; + default: + RTW_ERR("Unknown type: %d\n", type); + ret = WIFI_ERROR_INVALID_ARGS; + goto exit; + } + } + +exit: + return ret; +} +static int rtw_cfgvendor_logger_get_feature(struct wiphy *wiphy, + struct wireless_dev *wdev, const void *data, int len) +{ + int err = 0; + u32 supported_features = 0; + + err = rtw_cfgvendor_send_cmd_reply(wiphy, wdev_to_ndev(wdev), &supported_features, sizeof(supported_features)); + + if (unlikely(err)) + RTW_ERR(FUNC_NDEV_FMT" Vendor Command reply failed ret:%d\n" , FUNC_NDEV_ARG(wdev_to_ndev(wdev)), err); return err; -#if 0 - struct bcm_cfg80211 *cfg = wiphy_priv(wiphy); - int err = 0; - int data_len = 0; +} +static int rtw_cfgvendor_logger_get_version(struct wiphy *wiphy, + struct wireless_dev *wdev, const void *data, int len) +{ + _adapter *padapter = GET_PRIMARY_ADAPTER(wiphy_to_adapter(wiphy)); + HAL_DATA_TYPE *hal = GET_HAL_DATA(padapter); + int ret = 0, rem, type; + int buf_len = 1024; + char *buf_ptr; + const struct nlattr *iter; + gfp_t kflags; - bzero(cfg->ioctl_buf, WLC_IOCTL_MAXLEN); - - if (strncmp((char *)data, BRCM_VENDOR_SCMD_CAPA, strlen(BRCM_VENDOR_SCMD_CAPA)) == 0) { - err = wldev_iovar_getbuf(bcmcfg_to_prmry_ndev(cfg), "cap", NULL, 0, - cfg->ioctl_buf, WLC_IOCTL_MAXLEN, &cfg->ioctl_buf_sync); - if (unlikely(err)) { - WL_ERR(("error (%d)\n", err)); - return err; + kflags = in_atomic() ? GFP_ATOMIC : GFP_KERNEL; + buf_ptr = kzalloc(buf_len, kflags); + if (!buf_ptr) { + RTW_ERR("failed to allocate the buffer for version n"); + ret = -ENOMEM; + goto exit; + } + nla_for_each_attr(iter, data, len, rem) { + type = nla_type(iter); + switch (type) { + case LOGGER_ATTRIBUTE_GET_DRIVER: + memcpy(buf_ptr, DRIVERVERSION, strlen(DRIVERVERSION)+1); + break; + case LOGGER_ATTRIBUTE_GET_FW: + sprintf(buf_ptr, "v%d.%d", hal->firmware_version, hal->firmware_sub_version); + break; + default: + RTW_ERR("Unknown type: %d\n", type); + ret = -EINVAL; + goto exit; } - data_len = strlen(cfg->ioctl_buf); - cfg->ioctl_buf[data_len] = '\0'; + } + if (ret < 0) { + RTW_ERR("failed to get the version %d\n", ret); + goto exit; } - err = rtw_cfgvendor_send_cmd_reply(wiphy, bcmcfg_to_prmry_ndev(cfg), - cfg->ioctl_buf, data_len + 1); - if (unlikely(err)) - WL_ERR(("Vendor Command reply failed ret:%d\n", err)); - else - WL_INFORM(("Vendor Command reply sent successfully!\n")); - return err; + ret = rtw_cfgvendor_send_cmd_reply(wiphy, wdev_to_ndev(wdev), buf_ptr, strlen(buf_ptr)); +exit: + kfree(buf_ptr); + return ret; +} + +static int rtw_cfgvendor_logger_get_ring_status(struct wiphy *wiphy, + struct wireless_dev *wdev, const void *data, int len) +{ + int ret = 0; + int ring_id; + char ring_buf_name[] = "RTW_RING_BUFFER"; + + struct sk_buff *skb; + wifi_ring_buffer_status ring_status; + + + _rtw_memcpy(ring_status.name, ring_buf_name, strlen(ring_buf_name)+1); + ring_status.ring_id = 1; + /* Alloc the SKB for vendor_event */ + skb = cfg80211_vendor_cmd_alloc_reply_skb(wiphy, + sizeof(wifi_ring_buffer_status)); + if (!skb) { + RTW_ERR("skb allocation is failed\n"); + ret = FAIL; + goto exit; + } + + nla_put_u32(skb, LOGGER_ATTRIBUTE_RING_NUM, 1); + nla_put(skb, LOGGER_ATTRIBUTE_RING_STATUS, sizeof(wifi_ring_buffer_status), + &ring_status); + ret = cfg80211_vendor_cmd_reply(skb); + + if (ret) { + RTW_ERR("Vendor Command reply failed ret:%d \n", ret); + } +exit: + return ret; +} + +static int rtw_cfgvendor_logger_get_ring_data(struct wiphy *wiphy, + struct wireless_dev *wdev, const void *data, int len) +{ + int ret = 0, rem, type; + char ring_name[32] = {0}; + const struct nlattr *iter; + + nla_for_each_attr(iter, data, len, rem) { + type = nla_type(iter); + switch (type) { + case LOGGER_ATTRIBUTE_RING_NAME: + strncpy(ring_name, nla_data(iter), + MIN(sizeof(ring_name) -1, nla_len(iter))); + RTW_INFO(" %s LOGGER_ATTRIBUTE_RING_NAME : %s\n", __func__, ring_name); + break; + default: + RTW_ERR("Unknown type: %d\n", type); + return ret; + } + } + + + return ret; +} + +static int rtw_cfgvendor_logger_get_firmware_memory_dump(struct wiphy *wiphy, + struct wireless_dev *wdev, const void *data, int len) +{ + int ret = WIFI_ERROR_NOT_SUPPORTED; + + return ret; +} + +static int rtw_cfgvendor_logger_start_pkt_fate_monitoring(struct wiphy *wiphy, + struct wireless_dev *wdev, const void *data, int len) +{ + int ret = WIFI_SUCCESS; + + return ret; +} + +static int rtw_cfgvendor_logger_get_tx_pkt_fates(struct wiphy *wiphy, + struct wireless_dev *wdev, const void *data, int len) +{ + int ret = WIFI_SUCCESS; + + return ret; +} + +static int rtw_cfgvendor_logger_get_rx_pkt_fates(struct wiphy *wiphy, + struct wireless_dev *wdev, const void *data, int len) +{ + int ret = WIFI_SUCCESS; + + return ret; +} + +#endif /* CONFIG_RTW_CFGVENDOR_WIFI_LOGGER */ +#ifdef CONFIG_RTW_WIFI_HAL +#ifdef CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI + +#ifndef ETHER_ISMULTI +#define ETHER_ISMULTI(ea) (((const u8 *)(ea))[0] & 1) +#endif + + +static u8 null_addr[ETH_ALEN] = {0}; +static void rtw_hal_random_gen_mac_addr(u8 *mac_addr) +{ + do { + get_random_bytes(&mac_addr[3], ETH_ALEN-3); + if (memcmp(mac_addr, null_addr, ETH_ALEN) != 0) + break; + } while(1); +} + +void rtw_hal_pno_random_gen_mac_addr(PADAPTER adapter) +{ + u8 mac_addr[ETH_ALEN]; + struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(adapter); + + memcpy(mac_addr, pwdev_priv->pno_mac_addr, ETH_ALEN); + if (mac_addr[0] == 0xFF) return; + rtw_hal_random_gen_mac_addr(mac_addr); + memcpy(pwdev_priv->pno_mac_addr, mac_addr, ETH_ALEN); +#ifdef CONFIG_RTW_DEBUG + print_hex_dump(KERN_DEBUG, "pno_mac_addr: ", + DUMP_PREFIX_OFFSET, 16, 1, pwdev_priv->pno_mac_addr, + ETH_ALEN, 1); #endif } +void rtw_hal_set_hw_mac_addr(PADAPTER adapter, u8 *mac_addr) +{ + rtw_ps_deny(adapter, PS_DENY_IOCTL); + LeaveAllPowerSaveModeDirect(adapter); + + rtw_hal_set_hwreg(adapter, HW_VAR_MAC_ADDR, mac_addr); +#ifdef CONFIG_RTW_DEBUG + rtw_hal_dump_macaddr(RTW_DBGDUMP, adapter); +#endif + rtw_ps_deny_cancel(adapter, PS_DENY_IOCTL); +} + +static int rtw_cfgvendor_set_rand_mac_oui(struct wiphy *wiphy, + struct wireless_dev *wdev, const void *data, int len) +{ + int err = 0; + PADAPTER adapter; + void *devaddr; + struct net_device *netdev; + int type, mac_len; + u8 pno_random_mac_oui[3]; + u8 mac_addr[ETH_ALEN] = {0}; + struct pwrctrl_priv *pwrctl; + struct rtw_wdev_priv *pwdev_priv; + + type = nla_type(data); + mac_len = nla_len(data); + if (mac_len != 3) { + RTW_ERR("%s oui len error %d != 3\n", __func__, mac_len); + return -1; + } + + if (type == ANDR_WIFI_ATTRIBUTE_RANDOM_MAC_OUI) { + memcpy(pno_random_mac_oui, nla_data(data), 3); + print_hex_dump(KERN_DEBUG, "pno_random_mac_oui: ", + DUMP_PREFIX_OFFSET, 16, 1, pno_random_mac_oui, + 3, 1); + + if (ETHER_ISMULTI(pno_random_mac_oui)) { + pr_err("%s: oui is multicast address\n", __func__); + return -1; + } + + adapter = wiphy_to_adapter(wiphy); + if (adapter == NULL) { + pr_err("%s: wiphy_to_adapter == NULL\n", __func__); + return -1; + } + + pwdev_priv = adapter_wdev_data(adapter); + + memcpy(mac_addr, pno_random_mac_oui, 3); + rtw_hal_random_gen_mac_addr(mac_addr); + memcpy(pwdev_priv->pno_mac_addr, mac_addr, ETH_ALEN); +#ifdef CONFIG_RTW_DEBUG + print_hex_dump(KERN_DEBUG, "pno_mac_addr: ", + DUMP_PREFIX_OFFSET, 16, 1, pwdev_priv->pno_mac_addr, + ETH_ALEN, 1); +#endif + } else { + RTW_ERR("%s oui type error %x != 0x2\n", __func__, type); + err = -1; + } + + + return err; +} + +#endif + + +static int rtw_cfgvendor_set_nodfs_flag(struct wiphy *wiphy, + struct wireless_dev *wdev, const void *data, int len) +{ + int err = 0; + int type; + u32 nodfs = 0; + _adapter *padapter = GET_PRIMARY_ADAPTER(wiphy_to_adapter(wiphy)); + + RTW_DBG(FUNC_NDEV_FMT" %s\n", FUNC_NDEV_ARG(wdev_to_ndev(wdev)), (char*)data); + + type = nla_type(data); + if (type == ANDR_WIFI_ATTRIBUTE_NODFS_SET) { + nodfs = nla_get_u32(data); + adapter_to_dvobj(padapter)->nodfs = nodfs; + } else { + err = -EINVAL; + } + + RTW_INFO("%s nodfs=%d, err=%d\n", __func__, nodfs, err); + + return err; +} + +static int rtw_cfgvendor_set_country(struct wiphy *wiphy, + struct wireless_dev *wdev, const void *data, int len) +{ +#define CNTRY_BUF_SZ 4 /* Country string is 3 bytes + NUL */ + int err = 0, rem, type; + char country_code[CNTRY_BUF_SZ] = {0}; + const struct nlattr *iter; + _adapter *padapter = GET_PRIMARY_ADAPTER(wiphy_to_adapter(wiphy)); + + RTW_DBG(FUNC_NDEV_FMT" %s\n", FUNC_NDEV_ARG(wdev_to_ndev(wdev)), (char*)data); + + nla_for_each_attr(iter, data, len, rem) { + type = nla_type(iter); + switch (type) { + case ANDR_WIFI_ATTRIBUTE_COUNTRY: + _rtw_memcpy(country_code, nla_data(iter), + MIN(nla_len(iter), CNTRY_BUF_SZ)); + break; + default: + RTW_ERR("Unknown type: %d\n", type); + return -EINVAL; + } + } + + RTW_INFO("%s country_code:\"%c%c\" \n", __func__, country_code[0], country_code[1]); + + rtw_set_country(padapter, country_code); + + return err; +} + +static int rtw_cfgvendor_set_nd_offload(struct wiphy *wiphy, + struct wireless_dev *wdev, const void *data, int len) +{ + int err = 0; + int type; + u8 nd_en = 0; + _adapter *padapter = GET_PRIMARY_ADAPTER(wiphy_to_adapter(wiphy)); + + RTW_DBG(FUNC_NDEV_FMT" %s\n", FUNC_NDEV_ARG(wdev_to_ndev(wdev)), (char*)data); + + type = nla_type(data); + if (type == ANDR_WIFI_ATTRIBUTE_ND_OFFLOAD_VALUE) { + nd_en = nla_get_u8(data); + /* ND has been enabled when wow is enabled */ + } else { + err = -EINVAL; + } + + RTW_INFO("%s nd_en=%d, err=%d\n", __func__, nd_en, err); + + return err; +} +#endif /* CONFIG_RTW_WIFI_HAL */ + static const struct wiphy_vendor_command rtw_vendor_cmds[] = { - { - { - .vendor_id = OUI_BRCM, - .subcmd = BRCM_VENDOR_SCMD_PRIV_STR - }, - .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, - .doit = wl_cfgvendor_priv_string_handler - }, #if defined(GSCAN_SUPPORT) && 0 { { @@ -1170,7 +1749,7 @@ static const struct wiphy_vendor_command rtw_vendor_cmds[] = { .subcmd = GSCAN_SUBCMD_GET_CAPABILITIES }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, - .doit = wl_cfgvendor_gscan_get_capabilities + .doit = rtw_cfgvendor_gscan_get_capabilities }, { { @@ -1178,7 +1757,7 @@ static const struct wiphy_vendor_command rtw_vendor_cmds[] = { .subcmd = GSCAN_SUBCMD_SET_CONFIG }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, - .doit = wl_cfgvendor_set_scan_cfg + .doit = rtw_cfgvendor_set_scan_cfg }, { { @@ -1186,7 +1765,7 @@ static const struct wiphy_vendor_command rtw_vendor_cmds[] = { .subcmd = GSCAN_SUBCMD_SET_SCAN_CONFIG }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, - .doit = wl_cfgvendor_set_batch_scan_cfg + .doit = rtw_cfgvendor_set_batch_scan_cfg }, { { @@ -1194,7 +1773,7 @@ static const struct wiphy_vendor_command rtw_vendor_cmds[] = { .subcmd = GSCAN_SUBCMD_ENABLE_GSCAN }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, - .doit = wl_cfgvendor_initiate_gscan + .doit = rtw_cfgvendor_initiate_gscan }, { { @@ -1202,7 +1781,7 @@ static const struct wiphy_vendor_command rtw_vendor_cmds[] = { .subcmd = GSCAN_SUBCMD_ENABLE_FULL_SCAN_RESULTS }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, - .doit = wl_cfgvendor_enable_full_scan_result + .doit = rtw_cfgvendor_enable_full_scan_result }, { { @@ -1210,7 +1789,7 @@ static const struct wiphy_vendor_command rtw_vendor_cmds[] = { .subcmd = GSCAN_SUBCMD_SET_HOTLIST }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, - .doit = wl_cfgvendor_hotlist_cfg + .doit = rtw_cfgvendor_hotlist_cfg }, { { @@ -1218,7 +1797,7 @@ static const struct wiphy_vendor_command rtw_vendor_cmds[] = { .subcmd = GSCAN_SUBCMD_SET_SIGNIFICANT_CHANGE_CONFIG }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, - .doit = wl_cfgvendor_significant_change_cfg + .doit = rtw_cfgvendor_significant_change_cfg }, { { @@ -1226,7 +1805,7 @@ static const struct wiphy_vendor_command rtw_vendor_cmds[] = { .subcmd = GSCAN_SUBCMD_GET_SCAN_RESULTS }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, - .doit = wl_cfgvendor_gscan_get_batch_results + .doit = rtw_cfgvendor_gscan_get_batch_results }, { { @@ -1234,7 +1813,7 @@ static const struct wiphy_vendor_command rtw_vendor_cmds[] = { .subcmd = GSCAN_SUBCMD_GET_CHANNEL_LIST }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, - .doit = wl_cfgvendor_gscan_get_channel_list + .doit = rtw_cfgvendor_gscan_get_channel_list }, #endif /* GSCAN_SUPPORT */ #if defined(RTT_SUPPORT) && 0 @@ -1244,7 +1823,7 @@ static const struct wiphy_vendor_command rtw_vendor_cmds[] = { .subcmd = RTT_SUBCMD_SET_CONFIG }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, - .doit = wl_cfgvendor_rtt_set_config + .doit = rtw_cfgvendor_rtt_set_config }, { { @@ -1252,7 +1831,7 @@ static const struct wiphy_vendor_command rtw_vendor_cmds[] = { .subcmd = RTT_SUBCMD_CANCEL_CONFIG }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, - .doit = wl_cfgvendor_rtt_cancel_config + .doit = rtw_cfgvendor_rtt_cancel_config }, { { @@ -1260,13 +1839,160 @@ static const struct wiphy_vendor_command rtw_vendor_cmds[] = { .subcmd = RTT_SUBCMD_GETCAPABILITY }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, - .doit = wl_cfgvendor_rtt_get_capability + .doit = rtw_cfgvendor_rtt_get_capability }, #endif /* RTT_SUPPORT */ +#ifdef CONFIG_RTW_CFGVEDNOR_LLSTATS { { .vendor_id = OUI_GOOGLE, - .subcmd = ANDR_WIFI_SUBCMD_GET_FEATURE_SET + .subcmd = LSTATS_SUBCMD_GET_INFO + }, + .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, + .doit = rtw_cfgvendor_lstats_get_info + }, + { + { + .vendor_id = OUI_GOOGLE, + .subcmd = LSTATS_SUBCMD_SET_INFO + }, + .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, + .doit = rtw_cfgvendor_lstats_set_info + }, + { + { + .vendor_id = OUI_GOOGLE, + .subcmd = LSTATS_SUBCMD_CLEAR_INFO + }, + .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, + .doit = rtw_cfgvendor_lstats_clear_info + }, +#endif /* CONFIG_RTW_CFGVEDNOR_LLSTATS */ +#ifdef CONFIG_RTW_CFGVEDNOR_RSSIMONITOR + { + { + .vendor_id = OUI_GOOGLE, + .subcmd = WIFI_SUBCMD_SET_RSSI_MONITOR + }, + .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, + .doit = rtw_cfgvendor_set_rssi_monitor + }, +#endif /* CONFIG_RTW_CFGVEDNOR_RSSIMONITOR */ +#ifdef CONFIG_RTW_CFGVENDOR_WIFI_LOGGER + { + { + .vendor_id = OUI_GOOGLE, + .subcmd = LOGGER_START_LOGGING + }, + .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, + .doit = rtw_cfgvendor_logger_start_logging + }, + { + { + .vendor_id = OUI_GOOGLE, + .subcmd = LOGGER_GET_FEATURE + }, + .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, + .doit = rtw_cfgvendor_logger_get_feature + }, + { + { + .vendor_id = OUI_GOOGLE, + .subcmd = LOGGER_GET_VER + }, + .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, + .doit = rtw_cfgvendor_logger_get_version + }, + { + { + .vendor_id = OUI_GOOGLE, + .subcmd = LOGGER_GET_RING_STATUS + }, + .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, + .doit = rtw_cfgvendor_logger_get_ring_status + }, + { + { + .vendor_id = OUI_GOOGLE, + .subcmd = LOGGER_GET_RING_DATA + }, + .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, + .doit = rtw_cfgvendor_logger_get_ring_data + }, + { + { + .vendor_id = OUI_GOOGLE, + .subcmd = LOGGER_TRIGGER_MEM_DUMP + }, + .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, + .doit = rtw_cfgvendor_logger_get_firmware_memory_dump + }, + { + { + .vendor_id = OUI_GOOGLE, + .subcmd = LOGGER_START_PKT_FATE_MONITORING + }, + .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, + .doit = rtw_cfgvendor_logger_start_pkt_fate_monitoring + }, + { + { + .vendor_id = OUI_GOOGLE, + .subcmd = LOGGER_GET_TX_PKT_FATES + }, + .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, + .doit = rtw_cfgvendor_logger_get_tx_pkt_fates + }, + { + { + .vendor_id = OUI_GOOGLE, + .subcmd = LOGGER_GET_RX_PKT_FATES + }, + .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, + .doit = rtw_cfgvendor_logger_get_rx_pkt_fates + }, +#endif /* CONFIG_RTW_CFGVENDOR_WIFI_LOGGER */ +#ifdef CONFIG_RTW_WIFI_HAL +#ifdef CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI + { + { + .vendor_id = OUI_GOOGLE, + .subcmd = WIFI_SUBCMD_SET_PNO_RANDOM_MAC_OUI + }, + .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, + .doit = rtw_cfgvendor_set_rand_mac_oui + }, +#endif + { + { + .vendor_id = OUI_GOOGLE, + .subcmd = WIFI_SUBCMD_NODFS_SET + }, + .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, + .doit = rtw_cfgvendor_set_nodfs_flag + + }, + { + { + .vendor_id = OUI_GOOGLE, + .subcmd = WIFI_SUBCMD_SET_COUNTRY_CODE + }, + .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, + .doit = rtw_cfgvendor_set_country + }, + { + { + .vendor_id = OUI_GOOGLE, + .subcmd = WIFI_SUBCMD_CONFIG_ND_OFFLOAD + }, + .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, + .doit = rtw_cfgvendor_set_nd_offload + }, +#endif /* CONFIG_RTW_WIFI_HAL */ + { + { + .vendor_id = OUI_GOOGLE, + .subcmd = WIFI_SUBCMD_GET_FEATURE_SET }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, .doit = rtw_cfgvendor_get_feature_set @@ -1274,7 +2000,7 @@ static const struct wiphy_vendor_command rtw_vendor_cmds[] = { { { .vendor_id = OUI_GOOGLE, - .subcmd = ANDR_WIFI_SUBCMD_GET_FEATURE_SET_MATRIX + .subcmd = WIFI_SUBCMD_GET_FEATURE_SET_MATRIX }, .flags = WIPHY_VENDOR_CMD_NEED_WDEV | WIPHY_VENDOR_CMD_NEED_NETDEV, .doit = rtw_cfgvendor_get_feature_set_matrix @@ -1282,20 +2008,23 @@ static const struct wiphy_vendor_command rtw_vendor_cmds[] = { }; static const struct nl80211_vendor_cmd_info rtw_vendor_events[] = { - { OUI_BRCM, BRCM_VENDOR_EVENT_UNSPEC }, - { OUI_BRCM, BRCM_VENDOR_EVENT_PRIV_STR }, #if defined(GSCAN_SUPPORT) && 0 - { OUI_GOOGLE, GOOGLE_GSCAN_SIGNIFICANT_EVENT }, - { OUI_GOOGLE, GOOGLE_GSCAN_GEOFENCE_FOUND_EVENT }, - { OUI_GOOGLE, GOOGLE_GSCAN_BATCH_SCAN_EVENT }, - { OUI_GOOGLE, GOOGLE_SCAN_FULL_RESULTS_EVENT }, + { OUI_GOOGLE, GSCAN_EVENT_SIGNIFICANT_CHANGE_RESULTS }, + { OUI_GOOGLE, GSCAN_EVENT_HOTLIST_RESULTS_FOUND }, + { OUI_GOOGLE, GSCAN_EVENT_SCAN_RESULTS_AVAILABLE }, + { OUI_GOOGLE, GSCAN_EVENT_FULL_SCAN_RESULTS }, #endif /* GSCAN_SUPPORT */ #if defined(RTT_SUPPORT) && 0 - { OUI_GOOGLE, GOOGLE_RTT_COMPLETE_EVENT }, + { OUI_GOOGLE, RTT_EVENT_COMPLETE }, #endif /* RTT_SUPPORT */ + +#ifdef CONFIG_RTW_CFGVEDNOR_RSSIMONITOR + { OUI_GOOGLE, GOOGLE_RSSI_MONITOR_EVENT }, +#endif /* RTW_CFGVEDNOR_RSSIMONITR */ + #if defined(GSCAN_SUPPORT) && 0 - { OUI_GOOGLE, GOOGLE_SCAN_COMPLETE_EVENT }, - { OUI_GOOGLE, GOOGLE_GSCAN_GEOFENCE_LOST_EVENT } + { OUI_GOOGLE, GSCAN_EVENT_COMPLETE_SCAN }, + { OUI_GOOGLE, GSCAN_EVENT_HOTLIST_RESULTS_LOST } #endif /* GSCAN_SUPPORT */ }; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/rtw_cfgvendor.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/rtw_cfgvendor.h index 2ed3a9e623f9..2f33a5b63e02 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/rtw_cfgvendor.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/rtw_cfgvendor.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,19 +12,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_CFGVENDOR_H_ #define _RTW_CFGVENDOR_H_ -#define OUI_BRCM 0x001018 #define OUI_GOOGLE 0x001A11 -#define BRCM_VENDOR_SUBCMD_PRIV_STR 1 #define ATTRIBUTE_U32_LEN (NLA_HDRLEN + 4) #define VENDOR_ID_OVERHEAD ATTRIBUTE_U32_LEN #define VENDOR_SUBCMD_OVERHEAD ATTRIBUTE_U32_LEN @@ -44,53 +38,106 @@ VENDOR_SUBCMD_OVERHEAD + \ VENDOR_DATA_OVERHEAD) typedef enum { - /* don't use 0 as a valid subcommand */ - VENDOR_NL80211_SUBCMD_UNSPECIFIED, + /* don't use 0 as a valid subcommand */ + VENDOR_NL80211_SUBCMD_UNSPECIFIED, - /* define all vendor startup commands between 0x0 and 0x0FFF */ - VENDOR_NL80211_SUBCMD_RANGE_START = 0x0001, - VENDOR_NL80211_SUBCMD_RANGE_END = 0x0FFF, + /* define all vendor startup commands between 0x0 and 0x0FFF */ + VENDOR_NL80211_SUBCMD_RANGE_START = 0x0001, + VENDOR_NL80211_SUBCMD_RANGE_END = 0x0FFF, - /* define all GScan related commands between 0x1000 and 0x10FF */ - ANDROID_NL80211_SUBCMD_GSCAN_RANGE_START = 0x1000, - ANDROID_NL80211_SUBCMD_GSCAN_RANGE_END = 0x10FF, + /* define all GScan related commands between 0x1000 and 0x10FF */ + ANDROID_NL80211_SUBCMD_GSCAN_RANGE_START = 0x1000, + ANDROID_NL80211_SUBCMD_GSCAN_RANGE_END = 0x10FF, - /* define all NearbyDiscovery related commands between 0x1100 and 0x11FF */ - ANDROID_NL80211_SUBCMD_NBD_RANGE_START = 0x1100, - ANDROID_NL80211_SUBCMD_NBD_RANGE_END = 0x11FF, + /* define all NearbyDiscovery related commands between 0x1100 and 0x11FF */ + ANDROID_NL80211_SUBCMD_NBD_RANGE_START = 0x1100, + ANDROID_NL80211_SUBCMD_NBD_RANGE_END = 0x11FF, - /* define all RTT related commands between 0x1100 and 0x11FF */ - ANDROID_NL80211_SUBCMD_RTT_RANGE_START = 0x1100, - ANDROID_NL80211_SUBCMD_RTT_RANGE_END = 0x11FF, + /* define all RTT related commands between 0x1100 and 0x11FF */ + ANDROID_NL80211_SUBCMD_RTT_RANGE_START = 0x1100, + ANDROID_NL80211_SUBCMD_RTT_RANGE_END = 0x11FF, - ANDROID_NL80211_SUBCMD_LSTATS_RANGE_START = 0x1200, - ANDROID_NL80211_SUBCMD_LSTATS_RANGE_END = 0x12FF, + ANDROID_NL80211_SUBCMD_LSTATS_RANGE_START = 0x1200, + ANDROID_NL80211_SUBCMD_LSTATS_RANGE_END = 0x12FF, - ANDROID_NL80211_SUBCMD_TDLS_RANGE_START = 0x1300, - ANDROID_NL80211_SUBCMD_TDLS_RANGE_END = 0x13FF, - /* This is reserved for future usage */ + /* define all Logger related commands between 0x1400 and 0x14FF */ + ANDROID_NL80211_SUBCMD_DEBUG_RANGE_START = 0x1400, + ANDROID_NL80211_SUBCMD_DEBUG_RANGE_END = 0x14FF, + + /* define all wifi offload related commands between 0x1600 and 0x16FF */ + ANDROID_NL80211_SUBCMD_WIFI_OFFLOAD_RANGE_START = 0x1600, + ANDROID_NL80211_SUBCMD_WIFI_OFFLOAD_RANGE_END = 0x16FF, + + /* define all NAN related commands between 0x1700 and 0x17FF */ + ANDROID_NL80211_SUBCMD_NAN_RANGE_START = 0x1700, + ANDROID_NL80211_SUBCMD_NAN_RANGE_END = 0x17FF, + + /* define all Android Packet Filter related commands between 0x1800 and 0x18FF */ + ANDROID_NL80211_SUBCMD_PKT_FILTER_RANGE_START = 0x1800, + ANDROID_NL80211_SUBCMD_PKT_FILTER_RANGE_END = 0x18FF, + + /* This is reserved for future usage */ } ANDROID_VENDOR_SUB_COMMAND; -enum wl_vendor_subcmd { - BRCM_VENDOR_SCMD_UNSPEC, - BRCM_VENDOR_SCMD_PRIV_STR, - GSCAN_SUBCMD_GET_CAPABILITIES = ANDROID_NL80211_SUBCMD_GSCAN_RANGE_START, - GSCAN_SUBCMD_SET_CONFIG, - GSCAN_SUBCMD_SET_SCAN_CONFIG, - GSCAN_SUBCMD_ENABLE_GSCAN, - GSCAN_SUBCMD_GET_SCAN_RESULTS, - GSCAN_SUBCMD_SCAN_RESULTS, - GSCAN_SUBCMD_SET_HOTLIST, - GSCAN_SUBCMD_SET_SIGNIFICANT_CHANGE_CONFIG, - GSCAN_SUBCMD_ENABLE_FULL_SCAN_RESULTS, - GSCAN_SUBCMD_GET_CHANNEL_LIST, - ANDR_WIFI_SUBCMD_GET_FEATURE_SET, - ANDR_WIFI_SUBCMD_GET_FEATURE_SET_MATRIX, +enum rtw_vendor_subcmd { + GSCAN_SUBCMD_GET_CAPABILITIES = ANDROID_NL80211_SUBCMD_GSCAN_RANGE_START, + + GSCAN_SUBCMD_SET_CONFIG, /* 0x1001 */ + + GSCAN_SUBCMD_SET_SCAN_CONFIG, /* 0x1002 */ + GSCAN_SUBCMD_ENABLE_GSCAN, /* 0x1003 */ + GSCAN_SUBCMD_GET_SCAN_RESULTS, /* 0x1004 */ + GSCAN_SUBCMD_SCAN_RESULTS, /* 0x1005 */ + + GSCAN_SUBCMD_SET_HOTLIST, /* 0x1006 */ + + GSCAN_SUBCMD_SET_SIGNIFICANT_CHANGE_CONFIG, /* 0x1007 */ + GSCAN_SUBCMD_ENABLE_FULL_SCAN_RESULTS, /* 0x1008 */ + GSCAN_SUBCMD_GET_CHANNEL_LIST, /* 0x1009 */ + + WIFI_SUBCMD_GET_FEATURE_SET, /* 0x100A */ + WIFI_SUBCMD_GET_FEATURE_SET_MATRIX, /* 0x100B */ + WIFI_SUBCMD_SET_PNO_RANDOM_MAC_OUI, /* 0x100C */ + WIFI_SUBCMD_NODFS_SET, /* 0x100D */ + WIFI_SUBCMD_SET_COUNTRY_CODE, /* 0x100E */ + /* Add more sub commands here */ + GSCAN_SUBCMD_SET_EPNO_SSID, /* 0x100F */ + + WIFI_SUBCMD_SET_SSID_WHITE_LIST, /* 0x1010 */ + WIFI_SUBCMD_SET_ROAM_PARAMS, /* 0x1011 */ + WIFI_SUBCMD_ENABLE_LAZY_ROAM, /* 0x1012 */ + WIFI_SUBCMD_SET_BSSID_PREF, /* 0x1013 */ + WIFI_SUBCMD_SET_BSSID_BLACKLIST, /* 0x1014 */ + + GSCAN_SUBCMD_ANQPO_CONFIG, /* 0x1015 */ + WIFI_SUBCMD_SET_RSSI_MONITOR, /* 0x1016 */ + WIFI_SUBCMD_CONFIG_ND_OFFLOAD, /* 0x1017 */ + /* Add more sub commands here */ + + GSCAN_SUBCMD_MAX, + RTT_SUBCMD_SET_CONFIG = ANDROID_NL80211_SUBCMD_RTT_RANGE_START, RTT_SUBCMD_CANCEL_CONFIG, RTT_SUBCMD_GETCAPABILITY, - /* Add more sub commands here */ + + APF_SUBCMD_GET_CAPABILITIES = ANDROID_NL80211_SUBCMD_PKT_FILTER_RANGE_START, + APF_SUBCMD_SET_FILTER, + + LOGGER_START_LOGGING = ANDROID_NL80211_SUBCMD_DEBUG_RANGE_START, + LOGGER_TRIGGER_MEM_DUMP, + LOGGER_GET_MEM_DUMP, + LOGGER_GET_VER, + LOGGER_GET_RING_STATUS, + LOGGER_GET_RING_DATA, + LOGGER_GET_FEATURE, + LOGGER_RESET_LOGGING, + LOGGER_TRIGGER_DRIVER_MEM_DUMP, + LOGGER_GET_DRIVER_MEM_DUMP, + LOGGER_START_PKT_FATE_MONITORING, + LOGGER_GET_TX_PKT_FATES, + LOGGER_GET_RX_PKT_FATES, + VENDOR_SUBCMD_MAX }; @@ -169,6 +216,13 @@ enum gscan_ch_attributes { GSCAN_ATTRIBUTE_CH_ID_7 }; +enum wifi_rssi_monitor_attr { + RSSI_MONITOR_ATTRIBUTE_MAX_RSSI, + RSSI_MONITOR_ATTRIBUTE_MIN_RSSI, + RSSI_MONITOR_ATTRIBUTE_START, +}; + + enum rtt_attributes { RTT_ATTRIBUTE_TARGET_CNT, RTT_ATTRIBUTE_TARGET_INFO, @@ -183,24 +237,49 @@ enum rtt_attributes { RTT_ATTRIBUTE_TARGET_NUM_RETRY }; -typedef enum wl_vendor_event { - BRCM_VENDOR_EVENT_UNSPEC, - BRCM_VENDOR_EVENT_PRIV_STR, - GOOGLE_GSCAN_SIGNIFICANT_EVENT, - GOOGLE_GSCAN_GEOFENCE_FOUND_EVENT, - GOOGLE_GSCAN_BATCH_SCAN_EVENT, - GOOGLE_SCAN_FULL_RESULTS_EVENT, - GOOGLE_RTT_COMPLETE_EVENT, - GOOGLE_SCAN_COMPLETE_EVENT, - GOOGLE_GSCAN_GEOFENCE_LOST_EVENT -} wl_vendor_event_t; +enum logger_attributes { + LOGGER_ATTRIBUTE_GET_DRIVER, + LOGGER_ATTRIBUTE_GET_FW, + LOGGER_ATTRIBUTE_RING_ID, + LOGGER_ATTRIBUTE_RING_NAME, + LOGGER_ATTRIBUTE_RING_FLAGS, + LOGGER_ATTRIBUTE_LOG_LEVEL, + LOGGER_ATTRIBUTE_LOG_TIME_INTVAL, + LOGGER_ATTRIBUTE_LOG_MIN_DATA_SIZE, + LOGGER_ATTRIBUTE_FW_DUMP_LEN, + LOGGER_ATTRIBUTE_FW_DUMP_DATA, + LOGGERG_ATTRIBUTE_RING_DATA, + LOGGER_ATTRIBUTE_RING_STATUS, + LOGGER_ATTRIBUTE_RING_NUM +}; +typedef enum rtw_vendor_event { + RTK_RESERVED1, + RTK_RESERVED2, + GSCAN_EVENT_SIGNIFICANT_CHANGE_RESULTS , + GSCAN_EVENT_HOTLIST_RESULTS_FOUND, + GSCAN_EVENT_SCAN_RESULTS_AVAILABLE, + GSCAN_EVENT_FULL_SCAN_RESULTS, + RTT_EVENT_COMPLETE, + GSCAN_EVENT_COMPLETE_SCAN, + GSCAN_EVENT_HOTLIST_RESULTS_LOST, + GSCAN_EVENT_EPNO_EVENT, + GOOGLE_DEBUG_RING_EVENT, + GOOGLE_DEBUG_MEM_DUMP_EVENT, + GSCAN_EVENT_ANQPO_HOTSPOT_MATCH, + GOOGLE_RSSI_MONITOR_EVENT +} rtw_vendor_event_t; enum andr_wifi_feature_set_attr { ANDR_WIFI_ATTRIBUTE_NUM_FEATURE_SET, - ANDR_WIFI_ATTRIBUTE_FEATURE_SET + ANDR_WIFI_ATTRIBUTE_FEATURE_SET, + ANDR_WIFI_ATTRIBUTE_RANDOM_MAC_OUI, + ANDR_WIFI_ATTRIBUTE_NODFS_SET, + ANDR_WIFI_ATTRIBUTE_COUNTRY, + ANDR_WIFI_ATTRIBUTE_ND_OFFLOAD_VALUE + // Add more attribute here }; -typedef enum wl_vendor_gscan_attribute { +typedef enum rtw_vendor_gscan_attribute { ATTR_START_GSCAN, ATTR_STOP_GSCAN, ATTR_SET_SCAN_BATCH_CFG_ID, /* set batch scan params */ @@ -210,7 +289,7 @@ typedef enum wl_vendor_gscan_attribute { ATTR_GET_GSCAN_CAPABILITIES_ID, /* Add more sub commands here */ ATTR_GSCAN_MAX -} wl_vendor_gscan_attribute_t; +} rtw_vendor_gscan_attribute_t; typedef enum gscan_batch_attribute { ATTR_GSCAN_BATCH_BESTN, @@ -227,9 +306,309 @@ typedef enum gscan_complete_event { WIFI_SCAN_BUFFER_FULL, WIFI_SCAN_COMPLETE } gscan_complete_event_t; +/* wifi_hal.h */ +/* WiFi Common definitions */ +typedef unsigned char byte; +typedef int wifi_request_id; +typedef int wifi_channel; // indicates channel frequency in MHz +typedef int wifi_rssi; +typedef byte mac_addr[6]; +typedef byte oui[3]; +typedef int64_t wifi_timestamp; // In microseconds (us) +typedef int64_t wifi_timespan; // In picoseconds (ps) + +struct wifi_info; +struct wifi_interface_info; +typedef struct wifi_info *wifi_handle; +typedef struct wifi_interface_info *wifi_interface_handle; + +/* channel operating width */ +typedef enum { + WIFI_CHAN_WIDTH_20 = 0, + WIFI_CHAN_WIDTH_40 = 1, + WIFI_CHAN_WIDTH_80 = 2, + WIFI_CHAN_WIDTH_160 = 3, + WIFI_CHAN_WIDTH_80P80 = 4, + WIFI_CHAN_WIDTH_5 = 5, + WIFI_CHAN_WIDTH_10 = 6, + WIFI_CHAN_WIDTH_INVALID = -1 +} wifi_channel_width; + +typedef int wifi_radio; + +typedef struct { + wifi_channel_width width; + int center_frequency0; + int center_frequency1; + int primary_frequency; +} wifi_channel_spec; + +typedef enum { + WIFI_SUCCESS = 0, + WIFI_ERROR_NONE = 0, + WIFI_ERROR_UNKNOWN = -1, + WIFI_ERROR_UNINITIALIZED = -2, + WIFI_ERROR_NOT_SUPPORTED = -3, + WIFI_ERROR_NOT_AVAILABLE = -4, // Not available right now, but try later + WIFI_ERROR_INVALID_ARGS = -5, + WIFI_ERROR_INVALID_REQUEST_ID = -6, + WIFI_ERROR_TIMED_OUT = -7, + WIFI_ERROR_TOO_MANY_REQUESTS = -8, // Too many instances of this request + WIFI_ERROR_OUT_OF_MEMORY = -9, + WIFI_ERROR_BUSY = -10, +} wifi_error; + +typedef int wifi_ring_buffer_id; +/* ring buffer params */ +/** + * written_bytes and read_bytes implement a producer consumer API + * hence written_bytes >= read_bytes + * a modulo arithmetic of the buffer size has to be applied to those counters: + * actual offset into ring buffer = written_bytes % ring_buffer_byte_size + * + */ +typedef struct { + u8 name[32]; + u32 flags; + wifi_ring_buffer_id ring_id; // unique integer representing the ring + u32 ring_buffer_byte_size; // total memory size allocated for the buffer + u32 verbose_level; // verbose level for ring buffer + u32 written_bytes; // number of bytes that was written to the buffer by driver, + // monotonously increasing integer + u32 read_bytes; // number of bytes that was read from the buffer by user land, + // monotonously increasing integer + u32 written_records; // number of records that was written to the buffer by driver, + // monotonously increasing integer +} wifi_ring_buffer_status; + +#ifdef CONFIG_RTW_CFGVEDNOR_LLSTATS +#define STATS_MAJOR_VERSION 1 +#define STATS_MINOR_VERSION 0 +#define STATS_MICRO_VERSION 0 + +typedef enum { + WIFI_DISCONNECTED = 0, + WIFI_AUTHENTICATING = 1, + WIFI_ASSOCIATING = 2, + WIFI_ASSOCIATED = 3, + WIFI_EAPOL_STARTED = 4, // if done by firmware/driver + WIFI_EAPOL_COMPLETED = 5, // if done by firmware/driver +} wifi_connection_state; + +typedef enum { + WIFI_ROAMING_IDLE = 0, + WIFI_ROAMING_ACTIVE = 1, +} wifi_roam_state; + +typedef enum { + WIFI_INTERFACE_STA = 0, + WIFI_INTERFACE_SOFTAP = 1, + WIFI_INTERFACE_IBSS = 2, + WIFI_INTERFACE_P2P_CLIENT = 3, + WIFI_INTERFACE_P2P_GO = 4, + WIFI_INTERFACE_NAN = 5, + WIFI_INTERFACE_MESH = 6, + WIFI_INTERFACE_UNKNOWN = -1 + } wifi_interface_mode; + +#define WIFI_CAPABILITY_QOS 0x00000001 // set for QOS association +#define WIFI_CAPABILITY_PROTECTED 0x00000002 // set for protected association (802.11 beacon frame control protected bit set) +#define WIFI_CAPABILITY_INTERWORKING 0x00000004 // set if 802.11 Extended Capabilities element interworking bit is set +#define WIFI_CAPABILITY_HS20 0x00000008 // set for HS20 association +#define WIFI_CAPABILITY_SSID_UTF8 0x00000010 // set is 802.11 Extended Capabilities element UTF-8 SSID bit is set +#define WIFI_CAPABILITY_COUNTRY 0x00000020 // set is 802.11 Country Element is present + +typedef struct { + wifi_interface_mode mode; // interface mode + u8 mac_addr[6]; // interface mac address (self) + wifi_connection_state state; // connection state (valid for STA, CLI only) + wifi_roam_state roaming; // roaming state + u32 capabilities; // WIFI_CAPABILITY_XXX (self) + u8 ssid[33]; // null terminated SSID + u8 bssid[6]; // bssid + u8 ap_country_str[3]; // country string advertised by AP + u8 country_str[3]; // country string for this association +} wifi_interface_link_layer_info; + +/* channel information */ +typedef struct { + wifi_channel_width width; // channel width (20, 40, 80, 80+80, 160) + wifi_channel center_freq; // primary 20 MHz channel + wifi_channel center_freq0; // center frequency (MHz) first segment + wifi_channel center_freq1; // center frequency (MHz) second segment +} wifi_channel_info; + +/* wifi rate */ +typedef struct { + u32 preamble :3; // 0: OFDM, 1:CCK, 2:HT 3:VHT 4..7 reserved + u32 nss :2; // 0:1x1, 1:2x2, 3:3x3, 4:4x4 + u32 bw :3; // 0:20MHz, 1:40Mhz, 2:80Mhz, 3:160Mhz + u32 rateMcsIdx :8; // OFDM/CCK rate code would be as per ieee std in the units of 0.5mbps + // HT/VHT it would be mcs index + u32 reserved :16; // reserved + u32 bitrate; // units of 100 Kbps +} wifi_rate; + +/* channel statistics */ +typedef struct { + wifi_channel_info channel; // channel + u32 on_time; // msecs the radio is awake (32 bits number accruing over time) + u32 cca_busy_time; // msecs the CCA register is busy (32 bits number accruing over time) +} wifi_channel_stat; + +// Max number of tx power levels. The actual number vary per device and is specified by |num_tx_levels| +#define RADIO_STAT_MAX_TX_LEVELS 256 + +/* Internal radio statistics structure in the driver */ +typedef struct { + wifi_radio radio; // wifi radio (if multiple radio supported) + u32 on_time; // msecs the radio is awake (32 bits number accruing over time) + u32 tx_time; // msecs the radio is transmitting (32 bits number accruing over time) + u32 rx_time; // msecs the radio is in active receive (32 bits number accruing over time) + u32 on_time_scan; // msecs the radio is awake due to all scan (32 bits number accruing over time) + u32 on_time_nbd; // msecs the radio is awake due to NAN (32 bits number accruing over time) + u32 on_time_gscan; // msecs the radio is awake due to G?scan (32 bits number accruing over time) + u32 on_time_roam_scan; // msecs the radio is awake due to roam?scan (32 bits number accruing over time) + u32 on_time_pno_scan; // msecs the radio is awake due to PNO scan (32 bits number accruing over time) + u32 on_time_hs20; // msecs the radio is awake due to HS2.0 scans and GAS exchange (32 bits number accruing over time) + u32 num_channels; // number of channels + wifi_channel_stat channels[]; // channel statistics +} wifi_radio_stat_internal; + +/** + * Packet statistics reporting by firmware is performed on MPDU basi (i.e. counters increase by 1 for each MPDU) + * As well, "data packet" in associated comments, shall be interpreted as 802.11 data packet, + * that is, 802.11 frame control subtype == 2 and excluding management and control frames. + * + * As an example, in the case of transmission of an MSDU fragmented in 16 MPDUs which are transmitted + * OTA in a 16 units long a-mpdu, for which a block ack is received with 5 bits set: + * tx_mpdu : shall increase by 5 + * retries : shall increase by 16 + * tx_ampdu : shall increase by 1 + * data packet counters shall not increase regardless of the number of BAR potentially sent by device for this a-mpdu + * data packet counters shall not increase regardless of the number of BA received by device for this a-mpdu + * + * For each subsequent retransmission of the 11 remaining non ACK'ed mpdus + * (regardless of the fact that they are transmitted in a-mpdu or not) + * retries : shall increase by 1 + * + * If no subsequent BA or ACK are received from AP, until packet lifetime expires for those 11 packet that were not ACK'ed + * mpdu_lost : shall increase by 11 + */ + +/* per rate statistics */ +typedef struct { + wifi_rate rate; // rate information + u32 tx_mpdu; // number of successfully transmitted data pkts (ACK rcvd) + u32 rx_mpdu; // number of received data pkts + u32 mpdu_lost; // number of data packet losses (no ACK) + u32 retries; // total number of data pkt retries + u32 retries_short; // number of short data pkt retries + u32 retries_long; // number of long data pkt retries +} wifi_rate_stat; + +/* access categories */ +typedef enum { + WIFI_AC_VO = 0, + WIFI_AC_VI = 1, + WIFI_AC_BE = 2, + WIFI_AC_BK = 3, + WIFI_AC_MAX = 4, +} wifi_traffic_ac; + +/* wifi peer type */ +typedef enum +{ + WIFI_PEER_STA, + WIFI_PEER_AP, + WIFI_PEER_P2P_GO, + WIFI_PEER_P2P_CLIENT, + WIFI_PEER_NAN, + WIFI_PEER_TDLS, + WIFI_PEER_INVALID, +} wifi_peer_type; + +/* per peer statistics */ +typedef struct { + wifi_peer_type type; // peer type (AP, TDLS, GO etc.) + u8 peer_mac_address[6]; // mac address + u32 capabilities; // peer WIFI_CAPABILITY_XXX + u32 num_rate; // number of rates + wifi_rate_stat rate_stats[]; // per rate statistics, number of entries = num_rate +} wifi_peer_info; + +/* Per access category statistics */ +typedef struct { + wifi_traffic_ac ac; // access category (VI, VO, BE, BK) + u32 tx_mpdu; // number of successfully transmitted unicast data pkts (ACK rcvd) + u32 rx_mpdu; // number of received unicast data packets + u32 tx_mcast; // number of succesfully transmitted multicast data packets + // STA case: implies ACK received from AP for the unicast packet in which mcast pkt was sent + u32 rx_mcast; // number of received multicast data packets + u32 rx_ampdu; // number of received unicast a-mpdus; support of this counter is optional + u32 tx_ampdu; // number of transmitted unicast a-mpdus; support of this counter is optional + u32 mpdu_lost; // number of data pkt losses (no ACK) + u32 retries; // total number of data pkt retries + u32 retries_short; // number of short data pkt retries + u32 retries_long; // number of long data pkt retries + u32 contention_time_min; // data pkt min contention time (usecs) + u32 contention_time_max; // data pkt max contention time (usecs) + u32 contention_time_avg; // data pkt avg contention time (usecs) + u32 contention_num_samples; // num of data pkts used for contention statistics +} wifi_wmm_ac_stat; + +/* interface statistics */ +typedef struct { + wifi_interface_handle iface; // wifi interface + wifi_interface_link_layer_info info; // current state of the interface + u32 beacon_rx; // access point beacon received count from connected AP + u64 average_tsf_offset; // average beacon offset encountered (beacon_TSF - TBTT) + // The average_tsf_offset field is used so as to calculate the + // typical beacon contention time on the channel as well may be + // used to debug beacon synchronization and related power consumption issue + u32 leaky_ap_detected; // indicate that this AP typically leaks packets beyond the driver guard time. + u32 leaky_ap_avg_num_frames_leaked; // average number of frame leaked by AP after frame with PM bit set was ACK'ed by AP + u32 leaky_ap_guard_time; // guard time currently in force (when implementing IEEE power management based on + // frame control PM bit), How long driver waits before shutting down the radio and + // after receiving an ACK for a data frame with PM bit set) + u32 mgmt_rx; // access point mgmt frames received count from connected AP (including Beacon) + u32 mgmt_action_rx; // action frames received count + u32 mgmt_action_tx; // action frames transmit count + wifi_rssi rssi_mgmt; // access Point Beacon and Management frames RSSI (averaged) + wifi_rssi rssi_data; // access Point Data Frames RSSI (averaged) from connected AP + wifi_rssi rssi_ack; // access Point ACK RSSI (averaged) from connected AP + wifi_wmm_ac_stat ac[WIFI_AC_MAX]; // per ac data packet statistics + u32 num_peers; // number of peers + wifi_peer_info peer_info[]; // per peer statistics +} wifi_iface_stat; + +/* configuration params */ +typedef struct { + u32 mpdu_size_threshold; // threshold to classify the pkts as short or long + // packet size < mpdu_size_threshold => short + u32 aggressive_statistics_gathering; // set for field debug mode. Driver should collect all statistics regardless of performance impact. +} wifi_link_layer_params; + +#define RSSI_MONITOR_EVT_VERSION 1 +typedef struct { + u8 version; + s8 cur_rssi; + mac_addr BSSID; +} rssi_monitor_evt; + + +/* wifi statistics bitmap */ +#define WIFI_STATS_RADIO 0x00000001 // all radio statistics +#define WIFI_STATS_RADIO_CCA 0x00000002 // cca_busy_time (within radio statistics) +#define WIFI_STATS_RADIO_CHANNELS 0x00000004 // all channel statistics (within radio statistics) +#define WIFI_STATS_RADIO_SCAN 0x00000008 // all scan statistics (within radio statistics) +#define WIFI_STATS_IFACE 0x00000010 // all interface statistics +#define WIFI_STATS_IFACE_TXRATE 0x00000020 // all tx rate statistics (within interface statistics) +#define WIFI_STATS_IFACE_AC 0x00000040 // all ac statistics (within interface statistics) +#define WIFI_STATS_IFACE_CONTENTION 0x00000080 // all contention (min, max, avg) statistics (within ac statisctics) + +#endif /* CONFIG_RTW_CFGVEDNOR_LLSTATS */ -/* Capture the BRCM_VENDOR_SUBCMD_PRIV_STRINGS* here */ -#define BRCM_VENDOR_SCMD_CAPA "cap" #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0)) || defined(RTW_VENDOR_EXT_SUPPORT) extern int rtw_cfgvendor_attach(struct wiphy *wiphy); @@ -237,9 +616,19 @@ extern int rtw_cfgvendor_detach(struct wiphy *wiphy); extern int rtw_cfgvendor_send_async_event(struct wiphy *wiphy, struct net_device *dev, int event_id, const void *data, int len); #if defined(GSCAN_SUPPORT) && 0 -extern int wl_cfgvendor_send_hotlist_event(struct wiphy *wiphy, - struct net_device *dev, void *data, int len, wl_vendor_event_t event); +extern int rtw_cfgvendor_send_hotlist_event(struct wiphy *wiphy, + struct net_device *dev, void *data, int len, rtw_vendor_event_t event); #endif #endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0)) || defined(RTW_VENDOR_EXT_SUPPORT) */ +#ifdef CONFIG_RTW_CFGVEDNOR_RSSIMONITOR +void rtw_cfgvendor_rssi_monitor_evt(_adapter *padapter); +#endif + +#ifdef CONFIG_RTW_CFGVENDOR_RANDOM_MAC_OUI +void rtw_hal_pno_random_gen_mac_addr(PADAPTER adapter); +void rtw_hal_set_hw_mac_addr(PADAPTER adapter, u8 *mac_addr); +#endif + + #endif /* _RTW_CFGVENDOR_H_ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/rtw_proc.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/rtw_proc.c index 6052c2ff45ef..933ed0232695 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/rtw_proc.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/rtw_proc.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,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 @@ -127,7 +121,8 @@ static ssize_t proc_set_log_level(struct file *file, const char __user *buffer, int num = sscanf(tmp, "%d ", &log_level); - if (log_level >= _DRV_NONE_ && log_level <= _DRV_MAX_) { + if (num == 1 && + log_level >= _DRV_NONE_ && log_level <= _DRV_MAX_) { rtw_drv_log_level = log_level; printk("rtw_drv_log_level:%d\n", rtw_drv_log_level); } @@ -166,6 +161,27 @@ static int proc_get_chplan_test(struct seq_file *m, void *v) return 0; } +static int proc_get_chplan_ver(struct seq_file *m, void *v) +{ + dump_chplan_ver(m); + 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 +196,10 @@ 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), + RTW_PROC_HDL_SSEQ("chplan_ver", proc_get_chplan_ver, 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,19 +391,17 @@ static int proc_get_sdio_local_reg_dump(struct seq_file *m, void *v) return 0; } -#endif /* CONFIG_SDIO_HCI */ - -#ifdef RTW_HALMAC -#include "../../hal/hal_halmac.h" -static int proc_get_halmac_info(struct seq_file *m, void *v) +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); - rtw_dump_halmac_info(m); + dump_sdio_card_info(m, adapter_to_dvobj(adapter)); + return 0; } -#endif +#endif /* CONFIG_SDIO_HCI */ + static int proc_get_fw_info(struct seq_file *m, void *v) { struct net_device *dev = m->private; @@ -432,6 +450,93 @@ static int proc_get_rf_reg_dump(struct seq_file *m, void *v) return 0; } +#ifdef CONFIG_RTW_LED +int proc_get_led_config(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + + dump_led_config(m, adapter); + + return 0; +} + +ssize_t proc_set_led_config(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 strategy; + u8 iface_en_mask; + + 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", &strategy, &iface_en_mask); + + if (num >= 1) + rtw_led_set_strategy(adapter, strategy); + if (num >= 2) + rtw_led_set_iface_en_mask(adapter, iface_en_mask); + } + + return count; +} +#endif /* CONFIG_RTW_LED */ + +#ifdef CONFIG_AP_MODE +int proc_get_aid_status(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + + dump_aid_status(m, adapter); + + return 0; +} + +ssize_t proc_set_aid_status(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 sta_priv *stapriv = &adapter->stapriv; + + char tmp[32]; + u8 rr; + u16 started_aid; + + 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 %hu", &rr, &started_aid); + + if (num >= 1) + stapriv->rr_aid = rr ? 1 : 0; + if (num >= 2) { + started_aid = started_aid % (stapriv->max_aid + 1); + stapriv->started_aid = started_aid ? started_aid : 1; + } + } + + return count; +} +#endif /* CONFIG_AP_MODE */ + static int proc_get_dump_tx_rate_bmp(struct seq_file *m, void *v) { struct net_device *dev = m->private; @@ -459,16 +564,158 @@ 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 */ +#ifdef CONFIG_SCAN_BACKOP +static int proc_get_backop_flags_sta(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; + + RTW_PRINT_SEL(m, "0x%02x\n", mlmeext_scan_backop_flags_sta(mlmeext)); + + return 0; +} + +static ssize_t proc_set_backop_flags_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_ext_priv *mlmeext = &adapter->mlmeextpriv; + + char tmp[32]; + u8 flags; + + 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", &flags); + + if (num == 1) + mlmeext_assign_scan_backop_flags_sta(mlmeext, flags); + } + + return count; +} + +#ifdef CONFIG_AP_MODE +static int proc_get_backop_flags_ap(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; + + RTW_PRINT_SEL(m, "0x%02x\n", mlmeext_scan_backop_flags_ap(mlmeext)); + + return 0; +} + +static ssize_t proc_set_backop_flags_ap(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_ext_priv *mlmeext = &adapter->mlmeextpriv; + + char tmp[32]; + u8 flags; + + 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", &flags); + + if (num == 1) + mlmeext_assign_scan_backop_flags_ap(mlmeext, flags); + } + + return count; +} +#endif /* CONFIG_AP_MODE */ + +#ifdef CONFIG_RTW_MESH +static int proc_get_backop_flags_mesh(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; + + RTW_PRINT_SEL(m, "0x%02x\n", mlmeext_scan_backop_flags_mesh(mlmeext)); + + return 0; +} + +static ssize_t proc_set_backop_flags_mesh(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_ext_priv *mlmeext = &adapter->mlmeextpriv; + + char tmp[32]; + u8 flags; + + 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", &flags); + + if (num == 1) + mlmeext_assign_scan_backop_flags_mesh(mlmeext, flags); + } + + return count; +} +#endif /* CONFIG_RTW_MESH */ + +#endif /* CONFIG_SCAN_BACKOP */ + +#if defined(CONFIG_LPS_PG) && defined(CONFIG_RTL8822C) +static int proc_get_lps_pg_debug(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = rtw_netdev_priv(dev); + struct dm_struct *dm = adapter_to_phydm(adapter); + + rtw_run_in_thread_cmd(adapter, ((void *)(odm_lps_pg_debug_8822c)), dm); + + return 0; +} +#endif + /* gpio setting */ #ifdef CONFIG_GPIO_API static ssize_t proc_set_config_gpio(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) @@ -560,6 +807,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) { @@ -585,7 +833,8 @@ static ssize_t proc_set_rx_info_msg(struct file *file, const char __user *buffer if (buffer && !copy_from_user(tmp, buffer, count)) { int num = sscanf(tmp, "%d", &phy_info_flag); - precvpriv->store_law_data_flag = (BOOLEAN) phy_info_flag; + if (num == 1) + precvpriv->store_law_data_flag = (BOOLEAN) phy_info_flag; /*RTW_INFO("precvpriv->store_law_data_flag = %d\n",( BOOLEAN )(precvpriv->store_law_data_flag));*/ } @@ -604,11 +853,9 @@ static int proc_get_tx_info_msg(struct seq_file *m, void *v) _irqL irqL; struct net_device *dev = m->private; _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); struct sta_info *psta; - u8 bc_addr[6] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; - u8 null_addr[6] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; + u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; + u8 null_addr[ETH_ALEN] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); struct sta_priv *pstapriv = &padapter->stapriv; int i; @@ -619,10 +866,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); @@ -636,11 +885,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, ETH_ALEN) != _TRUE) + && (_rtw_memcmp(psta->cmn.mac_addr, null_addr, ETH_ALEN) != _TRUE) + && (_rtw_memcmp(psta->cmn.mac_addr, adapter_mac_addr(padapter), ETH_ALEN) != _TRUE)) { - switch (psta->bw_mode) { + switch (psta->cmn.bw_mode) { case CHANNEL_WIDTH_20: BW = "20M"; @@ -662,11 +911,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); @@ -733,6 +982,136 @@ 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) { + + u32 edca_param; + + if (hal_data->dis_turboedca == 0) + RTW_PRINT_SEL(m, "Turbo-EDCA : %s\n", "Enable"); + else + RTW_PRINT_SEL(m, "Turbo-EDCA : %s, mode=%d, edca_param_mode=0x%x\n", "Disable", hal_data->dis_turboedca, hal_data->edca_param_mode); + + + rtw_hal_get_hwreg(padapter, HW_VAR_AC_PARAM_BE, (u8 *)(&edca_param)); + + _RTW_PRINT_SEL(m, "PARAM_BE:0x%x\n", edca_param); + + } + + 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; + u32 param_mode = 0; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) + return -EFAULT; + + if (buffer && !copy_from_user(tmp, buffer, count)) { + + num = sscanf(tmp, "%d %x", &mode, ¶m_mode); + + if (num < 1 || num > 2) { + RTW_INFO("argument number is wrong\n"); + return -EFAULT; + } + + /* 0: enable turboedca, + 1: disable turboedca, + 2: disable turboedca and setting EDCA parameter based on the input parameter + > 2 : currently reset to 0 */ + + if (mode > 2) + mode = 0; + + hal_data->dis_turboedca = mode; + + hal_data->edca_param_mode = 0; /* init. value */ + + RTW_INFO("dis_turboedca mode = 0x%x\n", hal_data->dis_turboedca); + + if (num == 2) { + + hal_data->edca_param_mode = param_mode; + + RTW_INFO("param_mode = 0x%x\n", param_mode); + } + + } + + return count; + +} + static int proc_get_mac_qinfo(struct seq_file *m, void *v) { struct net_device *dev = m->private; @@ -758,7 +1137,7 @@ static int proc_get_chan_plan(struct seq_file *m, void *v) struct net_device *dev = m->private; _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); - dump_cur_chset(m, adapter); + dump_cur_chset(m, adapter_to_rfctl(adapter)); return 0; } @@ -768,7 +1147,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; @@ -798,9 +1177,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"); @@ -850,12 +1230,26 @@ ssize_t proc_set_macaddr_acl(struct file *file, const char __user *buffer, size_ { 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 * NUM_ACL + 32] = {0}; + u8 period; + char cmd[32]; u8 mode; u8 addr[ETH_ALEN]; +#define MAC_ACL_CMD_MODE 0 +#define MAC_ACL_CMD_ADD 1 +#define MAC_ACL_CMD_DEL 2 +#define MAC_ACL_CMD_CLR 3 +#define MAC_ACL_CMD_NUM 4 + + static const char * const mac_acl_cmd_str[] = { + "mode", + "add", + "del", + "clr", + }; + u8 cmd_id = MAC_ACL_CMD_NUM; + if (count < 1) return -EFAULT; @@ -865,36 +1259,93 @@ ssize_t proc_set_macaddr_acl(struct file *file, const char __user *buffer, size_ } if (buffer && !copy_from_user(tmp, buffer, count)) { - /* mode [] */ + /* + * mode [] + * mode + * add [] + * del [] + * clr + */ char *c, *next; + int i; + u8 is_bcast; next = tmp; c = strsep(&next, " \t"); + if (!c || sscanf(c, "%hhu", &period) != 1) + goto exit; - if (sscanf(c, "%hhu", &mode) != 1) - return count; + if (period >= RTW_ACL_PERIOD_NUM) { + RTW_WARN(FUNC_ADPT_FMT" invalid period:%u", FUNC_ADPT_ARG(adapter), period); + goto exit; + } - if (mode >= RTW_ACL_MODE_MAX) - mode = RTW_ACL_MODE_DISABLED; - - rtw_set_macaddr_acl(adapter, RTW_ACL_MODE_DISABLED); /* deinit first */ - if (mode == RTW_ACL_MODE_DISABLED) - return count; - - rtw_set_macaddr_acl(adapter, mode); - - /* macaddr list */ c = strsep(&next, " \t"); + if (!c || sscanf(c, "%s", cmd) != 1) + goto exit; + + for (i = 0; i < MAC_ACL_CMD_NUM; i++) + if (strcmp(mac_acl_cmd_str[i], cmd) == 0) + cmd_id = i; + + switch (cmd_id) { + case MAC_ACL_CMD_MODE: + c = strsep(&next, " \t"); + if (!c || sscanf(c, "%hhu", &mode) != 1) + goto exit; + + if (mode >= RTW_ACL_MODE_MAX) { + RTW_WARN(FUNC_ADPT_FMT" invalid mode:%u", FUNC_ADPT_ARG(adapter), mode); + goto exit; + } + break; + + case MAC_ACL_CMD_ADD: + case MAC_ACL_CMD_DEL: + break; + + case MAC_ACL_CMD_CLR: + /* clear settings */ + rtw_macaddr_acl_clear(adapter, period); + goto exit; + + default: + RTW_WARN(FUNC_ADPT_FMT" invalid cmd:\"%s\"", FUNC_ADPT_ARG(adapter), cmd); + goto exit; + } + + /* check for macaddr list */ + c = strsep(&next, " \t"); + if (!c && cmd_id == MAC_ACL_CMD_MODE) { + /* set mode only */ + rtw_set_macaddr_acl(adapter, period, mode); + goto exit; + } + + if (cmd_id == MAC_ACL_CMD_MODE) { + /* set mode and entire macaddr list */ + rtw_macaddr_acl_clear(adapter, period); + rtw_set_macaddr_acl(adapter, period, mode); + } + while (c != NULL) { if (sscanf(c, MAC_SFMT, MAC_SARG(addr)) != 6) break; - if (rtw_check_invalid_mac_address(addr, 0) == _FALSE) - rtw_acl_add_sta(adapter, addr); - + is_bcast = is_broadcast_mac_addr(addr); + if (is_bcast + || rtw_check_invalid_mac_address(addr, 0) == _FALSE + ) { + if (cmd_id == MAC_ACL_CMD_DEL) { + rtw_acl_remove_sta(adapter, period, addr); + if (is_bcast) + break; + } else if (!is_bcast) + rtw_acl_add_sta(adapter, period, addr); + } + c = strsep(&next, " \t"); } - } exit: @@ -990,13 +1441,97 @@ ssize_t proc_set_pre_link_sta(struct file *file, const char __user *buffer, size } #endif /* CONFIG_RTW_PRE_LINK_STA */ +static int proc_get_ch_sel_policy(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); + + RTW_PRINT_SEL(m, "%-16s\n", "same_band_prefer"); + + RTW_PRINT_SEL(m, "%16u\n", rfctl->ch_sel_same_band_prefer); + + return 0; +} + +static ssize_t proc_set_ch_sel_policy(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 sb_prefer; + int num; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (!buffer || copy_from_user(tmp, buffer, count)) + goto exit; + + num = sscanf(tmp, "%hhu", &sb_prefer); + if (num >= 1) + rfctl->ch_sel_same_band_prefer = sb_prefer; + +exit: + return count; +} + #ifdef CONFIG_DFS_MASTER +static int proc_get_dfs_test_case(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); + + RTW_PRINT_SEL(m, "%-24s %-19s\n", "radar_detect_trigger_non", "choose_dfs_ch_first"); + RTW_PRINT_SEL(m, "%24hhu %19hhu\n" + , rfctl->dbg_dfs_radar_detect_trigger_non + , rfctl->dbg_dfs_choose_dfs_ch_first + ); + + return 0; +} + +static ssize_t proc_set_dfs_test_case(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 radar_detect_trigger_non; + u8 choose_dfs_ch_first; + + 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 %hhu", &radar_detect_trigger_non, &choose_dfs_ch_first); + + if (num >= 1) + rfctl->dbg_dfs_radar_detect_trigger_non = radar_detect_trigger_non; + if (num >= 2) + rfctl->dbg_dfs_choose_dfs_ch_first = choose_dfs_ch_first; + } + + return count; +} + 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 mlme_priv *mlme = &adapter->mlmepriv; - struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; + 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; @@ -1017,10 +1552,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); } @@ -1051,7 +1586,7 @@ ssize_t proc_set_radar_detect(struct file *file, const char __user *buffer, size if (num < 1) goto exit; - rfctl->dbg_dfs_master_fake_radar_detect_cnt = fake_radar_detect_cnt; + rfctl->dbg_dfs_fake_radar_detect_cnt = fake_radar_detect_cnt; } exit: @@ -1090,7 +1625,7 @@ static ssize_t proc_set_dfs_ch_sel_d_flags(struct file *file, const char __user goto exit; num = sscanf(tmp, "%hhx", &d_flags); - if (num != 1) + if (num != 1) goto exit; rfctl->dfs_ch_sel_d_flags = d_flags; @@ -1098,8 +1633,141 @@ static ssize_t proc_set_dfs_ch_sel_d_flags(struct file *file, const char __user exit: return count; } + +#ifdef CONFIG_DFS_SLAVE_WITH_RADAR_DETECT +static int proc_get_dfs_slave_with_rd(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); + + RTW_PRINT_SEL(m, "%u\n", rfctl->dfs_slave_with_rd); + + return 0; +} + +static ssize_t proc_set_dfs_slave_with_rd(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 rd; + int num; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (!buffer || copy_from_user(tmp, buffer, count)) + goto exit; + + num = sscanf(tmp, "%hhu", &rd); + if (num != 1) + goto exit; + + rd = rd ? 1 : 0; + + if (rfctl->dfs_slave_with_rd != rd) { + rfctl->dfs_slave_with_rd = rd; + rtw_dfs_rd_en_decision_cmd(adapter); + } + +exit: + return count; +} +#endif /* CONFIG_DFS_SLAVE_WITH_RADAR_DETECT */ #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_rx_chk_limit(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + + RTW_PRINT_SEL(m, "Rx chk limit : %d\n", rtw_get_rx_chk_limit(padapter)); + + return 0; +} + +static ssize_t proc_set_rx_chk_limit(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + char tmp[32]; + struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + int rx_chk_limit; + + if (count < 1) { + RTW_INFO("argument size is less than 1\n"); + 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", &rx_chk_limit); + + rtw_set_rx_chk_limit(padapter, rx_chk_limit); + } + + return count; +} + static int proc_get_udpport(struct seq_file *m, void *v) { struct net_device *dev = m->private; @@ -1166,7 +1834,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; @@ -1178,10 +1846,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"); @@ -1191,21 +1859,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" @@ -1215,6 +1883,14 @@ static int proc_get_macid_info(struct seq_file *m, void *v) ); } } + RTW_PRINT_SEL(m, "\n"); + + for (i = 0; i < H2C_MSR_ROLE_MAX; i++) { + if (macid_ctl->op_num[i]) { + RTW_PRINT_SEL(m, "%-5s op_num:%u\n" + , h2c_msr_role_str(i), macid_ctl->op_num[i]); + } + } return 0; } @@ -1307,11 +1983,12 @@ static ssize_t proc_set_change_bss_chbw(struct file *file, const char __user *bu { 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); + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + int i; char tmp[32]; s16 ch; - s8 bw = -1, offset = -1; + s8 bw = REQ_BW_NONE, offset = REQ_OFFSET_NONE; + u8 ifbmp = 0; if (count < 1) return -EFAULT; @@ -1323,19 +2000,152 @@ static ssize_t proc_set_change_bss_chbw(struct file *file, const char __user *bu if (buffer && !copy_from_user(tmp, buffer, count)) { - int num = sscanf(tmp, "%hd %hhd %hhd", &ch, &bw, &offset); + int num = sscanf(tmp, "%hd %hhd %hhd %hhx", &ch, &bw, &offset, &ifbmp); if (num < 1 || (bw != CHANNEL_WIDTH_20 && num < 3)) goto exit; - if (check_fwstate(mlme, WIFI_AP_STATE) && check_fwstate(mlme, WIFI_ASOC_STATE)) - rtw_change_bss_chbw_cmd(adapter, RTW_CMDF_WAIT_ACK, ch, bw, offset); + if (num < 4) + ifbmp = BIT(adapter->iface_id); + else + ifbmp &= (1 << dvobj->iface_nums) - 1; + + for (i = 0; i < dvobj->iface_nums; i++) { + if (!(ifbmp & BIT(i)) || !dvobj->padapters[i]) + continue; + + if (!CHK_MLME_STATE(dvobj->padapters[i], WIFI_AP_STATE | WIFI_MESH_STATE) + || !MLME_IS_ASOC(dvobj->padapters[i])) + ifbmp &= ~BIT(i); + } + + if (ifbmp) + rtw_change_bss_chbw_cmd(adapter, RTW_CMDF_WAIT_ACK, ifbmp, 0, ch, bw, offset); } exit: return count; } +#if CONFIG_TX_AC_LIFETIME +static int proc_get_tx_aclt_force_val(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = rtw_netdev_priv(dev); + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + + dump_tx_aclt_force_val(m, dvobj); + + return 0; +} + +static ssize_t proc_set_tx_aclt_force_val(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + _adapter *adapter = rtw_netdev_priv(dev); + char tmp[32] = {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(adapter); + struct tx_aclt_conf_t input; + int num = sscanf(tmp, "%hhx %u %u", &input.en, &input.vo_vi, &input.be_bk); + + if (num < 1) + return count; + + rtw_hal_set_tx_aclt_force_val(adapter, &input, num); + rtw_run_in_thread_cmd(adapter, ((void *)(rtw_hal_update_tx_aclt)), adapter); + } + + return count; +} + +static int proc_get_tx_aclt_flags(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = rtw_netdev_priv(dev); + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + + RTW_PRINT_SEL(m, "0x%02x\n", dvobj->tx_aclt_flags); + + return 0; +} + +static ssize_t proc_set_tx_aclt_flags(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + _adapter *adapter = rtw_netdev_priv(dev); + char tmp[32] = {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(adapter); + u8 flags; + int num = sscanf(tmp, "%hhx", &flags); + + if (num < 1) + return count; + + if (dvobj->tx_aclt_flags == flags) + return count; + + dvobj->tx_aclt_flags = flags; + + rtw_run_in_thread_cmd(adapter, ((void *)(rtw_hal_update_tx_aclt)), adapter); + } + + return count; +} + +static int proc_get_tx_aclt_confs(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = rtw_netdev_priv(dev); + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + + RTW_PRINT_SEL(m, "flags:0x%02x\n", dvobj->tx_aclt_flags); + dump_tx_aclt_confs(m, dvobj); + + return 0; +} + +static ssize_t proc_set_tx_aclt_confs(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + _adapter *adapter = rtw_netdev_priv(dev); + char tmp[32] = {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(adapter); + u8 id; + struct tx_aclt_conf_t input; + int num = sscanf(tmp, "%hhu %hhx %u %u", &id, &input.en, &input.vo_vi, &input.be_bk); + + if (num < 2) + return count; + + rtw_hal_set_tx_aclt_conf(adapter, id, &input, num - 1); + rtw_run_in_thread_cmd(adapter, ((void *)(rtw_hal_update_tx_aclt)), adapter); + } + + return count; +} +#endif /* CONFIG_TX_AC_LIFETIME */ + static int proc_get_tx_bw_mode(struct seq_file *m, void *v) { struct net_device *dev = m->private; @@ -1348,13 +2158,38 @@ static int proc_get_tx_bw_mode(struct seq_file *m, void *v) return 0; } +static void rtw_set_tx_bw_mode(struct _ADAPTER *adapter, u8 bw_mode) +{ + struct mlme_priv *mlme = &(adapter->mlmepriv); + struct mlme_ext_priv *mlmeext = &(adapter->mlmeextpriv); + struct macid_ctl_t *macid_ctl = &adapter->dvobj->macid_ctl; + u8 update = _FALSE; + + if ((MLME_STATE(adapter) & WIFI_ASOC_STATE) + && ((mlmeext->cur_channel <= 14 && BW_MODE_2G(bw_mode) != ADAPTER_TX_BW_2G(adapter)) + || (mlmeext->cur_channel >= 36 && BW_MODE_5G(bw_mode) != ADAPTER_TX_BW_5G(adapter))) + ) { + /* RA mask update needed */ + update = _TRUE; + } + adapter->driver_tx_bw_mode = bw_mode; + + if (update == _TRUE) { + 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_dm_ra_mask_wk_cmd(adapter, (u8 *)sta); + } + } +} + static ssize_t proc_set_tx_bw_mode(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 macid_ctl_t *macid_ctl = &adapter->dvobj->macid_ctl; - struct mlme_priv *mlme = &(adapter->mlmepriv); - struct mlme_ext_priv *mlmeext = &(adapter->mlmeextpriv); char tmp[32]; u8 bw_mode; @@ -1368,31 +2203,12 @@ static ssize_t proc_set_tx_bw_mode(struct file *file, const char __user *buffer, if (buffer && !copy_from_user(tmp, buffer, count)) { - u8 update = _FALSE; int num = sscanf(tmp, "%hhx", &bw_mode); if (num < 1 || bw_mode == adapter->driver_tx_bw_mode) goto exit; - if ((MLME_STATE(adapter) & WIFI_ASOC_STATE) - && ((mlmeext->cur_channel <= 14 && BW_MODE_2G(bw_mode) != ADAPTER_TX_BW_2G(adapter)) - || (mlmeext->cur_channel >= 36 && BW_MODE_5G(bw_mode) != ADAPTER_TX_BW_5G(adapter))) - ) { - /* RA mask update needed */ - update = _TRUE; - } - adapter->driver_tx_bw_mode = bw_mode; - - if (update == _TRUE) { - 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->hwaddr)) - rtw_dm_ra_mask_wk_cmd(adapter, (u8 *)sta); - } - } + rtw_set_tx_bw_mode(adapter, bw_mode); } exit: @@ -1436,15 +2252,17 @@ static int proc_get_tx_power_by_rate(struct seq_file *m, void *v) return 0; } +#if 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) { @@ -1481,13 +2299,15 @@ static ssize_t proc_set_tx_power_ext_info(struct file *file, const char __user * #endif rtw_ps_deny(adapter, PS_DENY_IOCTL); - LeaveAllPowerSaveModeDirect(adapter); + if (rtw_pwr_wakeup(adapter) == _FALSE) + goto clear_ps_deny; if (strcmp("default", cmd) == 0) rtw_run_in_thread_cmd(adapter, ((void *)(phy_reload_default_tx_power_ext_info)), adapter); else rtw_run_in_thread_cmd(adapter, ((void *)(phy_reload_tx_power_ext_info)), adapter); +clear_ps_deny: rtw_ps_deny_cancel(adapter, PS_DENY_IOCTL); } @@ -1496,10 +2316,7 @@ static ssize_t proc_set_tx_power_ext_info(struct file *file, const char __user * static void *proc_start_tx_power_idx(struct seq_file *m, loff_t *pos) { - struct net_device *dev = m->private; - _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); u8 path = ((*pos) & 0xFF00) >> 8; - u8 rs = *pos & 0xFF; if (path >= RF_PATH_MAX) return NULL; @@ -1508,14 +2325,10 @@ static void *proc_start_tx_power_idx(struct seq_file *m, loff_t *pos) } static void proc_stop_tx_power_idx(struct seq_file *m, void *v) { - struct net_device *dev = m->private; - _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); } static void *proc_next_tx_power_idx(struct seq_file *m, void *v, loff_t *pos) { - struct net_device *dev = m->private; - _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); u8 path = ((*pos) & 0xFF00) >> 8; u8 rs = *pos & 0xFF; @@ -1630,10 +2443,9 @@ static ssize_t proc_set_kfree_bb_gain(struct file *file, const char __user *buff { struct net_device *dev = data; _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); - HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); struct kfree_data_t *kfree_data = GET_KFREE_DATA(adapter); char tmp[BB_GAIN_NUM * RF_PATH_MAX] = {0}; - u8 path, chidx; + u8 chidx; s8 bb_gain[BB_GAIN_NUM]; char ch_band_Group[6]; @@ -1745,7 +2557,6 @@ static ssize_t proc_set_tx_gain_offset(struct file *file, const char __user *buf } if (buffer && !copy_from_user(tmp, buffer, count)) { - u8 write_value; int num = sscanf(tmp, "%hhu %hhd", &rf_path, &offset); if (num < 2) @@ -2042,6 +2853,69 @@ ssize_t proc_set_btreg_write(struct file *file, const char __user *buffer, size_ return count; } + +int proc_get_btc_reduce_wl_txpwr(struct seq_file *m, void *v) +{ + struct net_device *dev; + PADAPTER padapter; + u8 data; + + dev = m->private; + padapter = (PADAPTER)rtw_netdev_priv(dev); + + data = rtw_btcoex_get_reduce_wl_txpwr(padapter); + RTW_PRINT_SEL(m, "BTC reduce WL TxPwr = %d dB\n", data); + + return 0; +} + +ssize_t proc_set_btc_reduce_wl_txpwr(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + PADAPTER padapter; + HAL_DATA_TYPE *hal_data; + u8 tmp[80] = {0}; + u32 val = 0; + u32 num; + + padapter = (PADAPTER)rtw_netdev_priv(dev); + hal_data = GET_HAL_DATA(padapter); + + /* RTW_INFO("+" FUNC_ADPT_FMT "\n", FUNC_ADPT_ARG(padapter)); */ + + 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; + } + + num = count; + if (num > (sizeof(tmp) - 1)) + num = (sizeof(tmp) - 1); + + if (copy_from_user(tmp, buffer, num)) { + RTW_INFO(FUNC_ADPT_FMT ": copy buffer from user space FAIL!\n", + FUNC_ADPT_ARG(padapter)); + + return -EFAULT; + } + + num = sscanf(tmp, "%d", &val); + + if ((IS_HARDWARE_TYPE_8822C(padapter)) && (hal_data->EEPROMBluetoothCoexist == _TRUE)) + rtw_btc_reduce_wl_txpwr_cmd(padapter, val); + + return count; +} + #endif /* CONFIG_BT_COEXIST */ #ifdef CONFIG_MBSSID_CAM @@ -2110,26 +2984,38 @@ 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); + if (IS_ACS_ENABLE(adapter)) + rtw_acs_info_dump(m, adapter); + else + _RTW_PRINT_SEL(m,"ACS disabled\n"); return 0; } static ssize_t proc_set_acs(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) { +#ifdef CONFIG_RTW_ACS_DBG struct net_device *dev = data; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); char tmp[32]; - u8 acs_satae = 0; + u8 acs_state = 0; + u16 scan_ch_ms= 0, acs_scan_ch_ms = 0; + u8 scan_type = SCAN_ACTIVE, igi= 0, bw = 0; + u8 acs_scan_type = SCAN_ACTIVE, acs_igi= 0, acs_bw = 0; if (count < 1) return -EFAULT; @@ -2140,20 +3026,75 @@ static ssize_t proc_set_acs(struct file *file, const char __user *buffer, size_t } if (buffer && !copy_from_user(tmp, buffer, count)) { - int num = sscanf(tmp, "%hhu", &acs_satae); + int num = sscanf(tmp, "%hhu %hhu %hu %hhx %hhu", + &acs_state, &scan_type, &scan_ch_ms, &igi, &bw); 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); + num = num -1; + + if(num) { + if (num-- > 0) + acs_scan_type = scan_type; + if (num-- > 0) + acs_scan_ch_ms = scan_ch_ms; + if (num-- > 0) + acs_igi = igi; + if (num-- > 0) + acs_bw = bw; + rtw_acs_adv_setting(padapter, acs_scan_type, acs_scan_ch_ms, acs_igi, acs_bw); + } + } +#endif /*CONFIG_RTW_ACS_DBG*/ + return count; +} +#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 +#endif /*CONFIG_RTW_ACS*/ static int proc_get_hal_spec(struct seq_file *m, void *v) { @@ -2170,8 +3111,10 @@ static int proc_get_phy_cap(struct seq_file *m, void *v) _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); rtw_dump_phy_cap(m, adapter); +#ifdef CONFIG_80211N_HT rtw_dump_drv_phy_cap(m, adapter); rtw_get_dft_phy_cap(m, adapter); +#endif /* CONFIG_80211N_HT */ return 0; } @@ -2221,13 +3164,13 @@ static ssize_t proc_set_rsvd_page_info(struct file *file, const char __user *buf return count; } -#if 0 /*#ifdef CONFIG_SUPPORT_FIFO_DUMP*/ +#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); - /*dump fifo*/ + 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) @@ -2235,7 +3178,9 @@ static ssize_t proc_set_fifo_info(struct file *file, const char __user *buffer, struct net_device *dev = data; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); char tmp[32]; - u8 acs_satae = 0; + u8 fifo_sel = 0; + u32 fifo_addr = 0; + u32 fifo_size = 0; if (count < 3) return -EFAULT; @@ -2245,18 +3190,15 @@ static ssize_t proc_set_fifo_info(struct file *file, const char __user *buffer, return -EFAULT; } if (buffer && !copy_from_user(tmp, buffer, count)) { - /* get fifo_sel, start addr, size - int num = sscanf(tmp, "%hhu", &acs_satae); - if (num < 1) + int num = sscanf(tmp, "%hhu %x %d", &fifo_sel, &fifo_addr, &fifo_size); + + if (num < 3) return -EINVAL; - if (1 == acs_satae) - rtw_acs_start(padapter, _TRUE); - else - rtw_acs_start(padapter, _FALSE); - */ - + padapter->fifo_sel = fifo_sel; + padapter->fifo_addr = fifo_addr; + padapter->fifo_size = fifo_size; } return count; } @@ -2287,6 +3229,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 @@ -2301,15 +3245,741 @@ 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; + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + PADAPTER iface = NULL; + char tmp[32] = {0}; + int thrshld = 0; + int num = 0, i = 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); + + + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + if (iface) { + if (buffer && !copy_from_user(tmp, buffer, count)) { + registry = &iface->registrypriv; + 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; +} + +#ifdef CONFIG_RTW_MESH +static int proc_get_mesh_peer_sel_policy(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + + dump_mesh_peer_sel_policy(m, adapter); + + return 0; +} + +#if CONFIG_RTW_MESH_ACNODE_PREVENT +static int proc_get_mesh_acnode_prevent(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + + if (MLME_IS_MESH(adapter)) + dump_mesh_acnode_prevent_settings(m, adapter); + + return 0; +} + +static ssize_t proc_set_mesh_acnode_prevent(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]; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (buffer && !copy_from_user(tmp, buffer, count)) { + struct mesh_peer_sel_policy *peer_sel_policy = &adapter->mesh_cfg.peer_sel_policy; + u8 enable; + u32 conf_timeout_ms; + u32 notify_timeout_ms; + int num = sscanf(tmp, "%hhu %u %u", &enable, &conf_timeout_ms, ¬ify_timeout_ms); + + if (num >= 1) + peer_sel_policy->acnode_prevent = enable; + if (num >= 2) + peer_sel_policy->acnode_conf_timeout_ms = conf_timeout_ms; + if (num >= 3) + peer_sel_policy->acnode_notify_timeout_ms = notify_timeout_ms; + } + + return count; +} +#endif /* CONFIG_RTW_MESH_ACNODE_PREVENT */ + +#if CONFIG_RTW_MESH_OFFCH_CAND +static int proc_get_mesh_offch_cand(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + + if (MLME_IS_MESH(adapter)) + dump_mesh_offch_cand_settings(m, adapter); + + return 0; +} + +static ssize_t proc_set_mesh_offch_cand(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]; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (buffer && !copy_from_user(tmp, buffer, count)) { + struct mesh_peer_sel_policy *peer_sel_policy = &adapter->mesh_cfg.peer_sel_policy; + u8 enable; + u32 find_int_ms; + int num = sscanf(tmp, "%hhu %u", &enable, &find_int_ms); + + if (num >= 1) + peer_sel_policy->offch_cand = enable; + if (num >= 2) + peer_sel_policy->offch_find_int_ms = find_int_ms; + } + + return count; +} +#endif /* CONFIG_RTW_MESH_OFFCH_CAND */ + +#if CONFIG_RTW_MESH_PEER_BLACKLIST +static int proc_get_mesh_peer_blacklist(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + + if (MLME_IS_MESH(adapter)) { + dump_mesh_peer_blacklist_settings(m, adapter); + if (MLME_IS_ASOC(adapter)) + dump_mesh_peer_blacklist(m, adapter); + } + + return 0; +} + +static ssize_t proc_set_mesh_peer_blacklist(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]; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (buffer && !copy_from_user(tmp, buffer, count)) { + struct mesh_peer_sel_policy *peer_sel_policy = &adapter->mesh_cfg.peer_sel_policy; + u32 conf_timeout_ms; + u32 blacklist_timeout_ms; + int num = sscanf(tmp, "%u %u", &conf_timeout_ms, &blacklist_timeout_ms); + + if (num >= 1) + peer_sel_policy->peer_conf_timeout_ms = conf_timeout_ms; + if (num >= 2) + peer_sel_policy->peer_blacklist_timeout_ms = blacklist_timeout_ms; + } + + return count; +} +#endif /* CONFIG_RTW_MESH_PEER_BLACKLIST */ + +#if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST +static int proc_get_mesh_cto_mgate_require(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + + if (MLME_IS_MESH(adapter)) + RTW_PRINT_SEL(m, "%u\n", adapter->mesh_cfg.peer_sel_policy.cto_mgate_require); + + return 0; +} + +static ssize_t proc_set_mesh_cto_mgate_require(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]; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (buffer && !copy_from_user(tmp, buffer, count)) { + struct mesh_peer_sel_policy *peer_sel_policy = &adapter->mesh_cfg.peer_sel_policy; + u8 require; + int num = sscanf(tmp, "%hhu", &require); + + if (num >= 1) { + peer_sel_policy->cto_mgate_require = require; + #if CONFIG_RTW_MESH_CTO_MGATE_CARRIER + if (rtw_mesh_cto_mgate_required(adapter)) + rtw_netif_carrier_off(adapter->pnetdev); + else + rtw_netif_carrier_on(adapter->pnetdev); + #endif + } + } + + return count; +} + +static int proc_get_mesh_cto_mgate_blacklist(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + + if (MLME_IS_MESH(adapter)) { + dump_mesh_cto_mgate_blacklist_settings(m, adapter); + if (MLME_IS_ASOC(adapter)) + dump_mesh_cto_mgate_blacklist(m, adapter); + } + + return 0; +} + +static ssize_t proc_set_mesh_cto_mgate_blacklist(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]; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (buffer && !copy_from_user(tmp, buffer, count)) { + struct mesh_peer_sel_policy *peer_sel_policy = &adapter->mesh_cfg.peer_sel_policy; + u32 conf_timeout_ms; + u32 blacklist_timeout_ms; + int num = sscanf(tmp, "%u %u", &conf_timeout_ms, &blacklist_timeout_ms); + + if (num >= 1) + peer_sel_policy->cto_mgate_conf_timeout_ms = conf_timeout_ms; + if (num >= 2) + peer_sel_policy->cto_mgate_blacklist_timeout_ms = blacklist_timeout_ms; + } + + return count; +} +#endif /* CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST */ + +static int proc_get_mesh_networks(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + + dump_mesh_networks(m, adapter); + + return 0; +} + +static int proc_get_mesh_plink_ctl(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + + if (MLME_IS_MESH(adapter)) + dump_mesh_plink_ctl(m, adapter); + + return 0; +} + +static int proc_get_mesh_mpath(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + + if (MLME_IS_MESH(adapter) && MLME_IS_ASOC(adapter)) + dump_mpath(m, adapter); + + return 0; +} + +static int proc_get_mesh_mpp(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + + if (MLME_IS_MESH(adapter) && MLME_IS_ASOC(adapter)) + dump_mpp(m, adapter); + + return 0; +} + +static int proc_get_mesh_known_gates(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + + if (MLME_IS_MESH(adapter)) + dump_known_gates(m, adapter); + + return 0; +} + +#if CONFIG_RTW_MESH_DATA_BMC_TO_UC +static int proc_get_mesh_b2u_flags(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + + if (MLME_IS_MESH(adapter)) + dump_mesh_b2u_flags(m, adapter); + + return 0; +} + +static ssize_t proc_set_mesh_b2u_flags(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]; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (buffer && !copy_from_user(tmp, buffer, count)) { + struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; + u8 msrc, mfwd; + int num = sscanf(tmp, "%hhx %hhx", &msrc, &mfwd); + + if (num >= 1) + mcfg->b2u_flags_msrc = msrc; + if (num >= 2) + mcfg->b2u_flags_mfwd = mfwd; + } + + return count; +} +#endif /* CONFIG_RTW_MESH_DATA_BMC_TO_UC */ + +static int proc_get_mesh_stats(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + + if (MLME_IS_MESH(adapter)) + dump_mesh_stats(m, adapter); + + return 0; +} + +static int proc_get_mesh_gate_timeout(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + + if (MLME_IS_MESH(adapter)) + RTW_PRINT_SEL(m, "%u factor\n", + adapter->mesh_cfg.path_gate_timeout_factor); + + return 0; +} + +static ssize_t proc_set_mesh_gate_timeout(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]; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (buffer && !copy_from_user(tmp, buffer, count)) { + struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; + u32 timeout; + int num = sscanf(tmp, "%u", &timeout); + + if (num < 1) + goto exit; + + mcfg->path_gate_timeout_factor = timeout; + } + +exit: + return count; +} + +static int proc_get_mesh_gate_state(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + struct rtw_mesh_cfg *mcfg = &adapter->mesh_cfg; + u8 cto_mgate = 0; + + if (MLME_IS_MESH(adapter)) { + if (rtw_mesh_is_primary_gate(adapter)) + RTW_PRINT_SEL(m, "PG\n"); + else if (mcfg->dot11MeshGateAnnouncementProtocol) + RTW_PRINT_SEL(m, "G\n"); + else if (rtw_mesh_gate_num(adapter)) + RTW_PRINT_SEL(m, "C\n"); + else + RTW_PRINT_SEL(m, "N\n"); + } + + return 0; +} + +static int proc_get_peer_alive_based_preq(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + struct _ADAPTER *adapter= (_adapter *)rtw_netdev_priv(dev); + struct registry_priv *rp = &adapter->registrypriv; + + RTW_PRINT_SEL(m, "peer_alive_based_preq = %u\n", + rp->peer_alive_based_preq); + + return 0; +} + +static ssize_t +proc_set_peer_alive_based_preq(struct file *file, const char __user *buffer, + size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + struct _ADAPTER *adapter = (_adapter *)rtw_netdev_priv(dev); + struct registry_priv *rp = &adapter->registrypriv; + char tmp[8]; + int num = 0; + u8 enable = 0; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (!buffer || copy_from_user(tmp, buffer, count)) + goto exit; + + num = sscanf(tmp, "%hhu", &enable); + if (num != 1) { + RTW_ERR("%s: invalid parameter!\n", __FUNCTION__); + goto exit; + } + + if (enable > 1) { + RTW_ERR("%s: invalid value!\n", __FUNCTION__); + goto exit; + } + rp->peer_alive_based_preq = enable; + +exit: + return count; +} +#endif /* CONFIG_RTW_MESH */ + +static int proc_get_scan_deny(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + struct _ADAPTER *adapter= (_adapter *)rtw_netdev_priv(dev); + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + + RTW_PRINT_SEL(m, "scan_deny is %s\n", (dvobj->scan_deny == _TRUE) ? "enable":"disable"); + + return 0; +} + +static ssize_t proc_set_scan_deny(struct file *file, const char __user *buffer, + size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + struct _ADAPTER *adapter = (_adapter *)rtw_netdev_priv(dev); + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + char tmp[8]; + int num = 0; + int enable = 0; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (!buffer || copy_from_user(tmp, buffer, count)) + goto exit; + + num = sscanf(tmp, "%d", &enable); + if (num != 1) { + RTW_ERR("%s: invalid parameter!\n", __FUNCTION__); + goto exit; + } + + dvobj->scan_deny = enable ? _TRUE : _FALSE; + + RTW_PRINT("%s: scan_deny is %s\n", + __FUNCTION__, (dvobj->scan_deny == _TRUE) ? "enable":"disable"); + +exit: + return count; +} + +#ifdef CONFIG_RTW_TPT_MODE +static int proc_get_tpt_mode(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + struct _ADAPTER *adapter= (_adapter *)rtw_netdev_priv(dev); + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + + RTW_PRINT_SEL(m, "current tpt_mode = %d\n", dvobj->tpt_mode); + + return 0; +} + +static void tpt_mode_default(struct _ADAPTER *adapter) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + + /* 1. disable scan deny */ + dvobj->scan_deny = _FALSE; + + /* 2. back to original LPS mode */ +#ifdef CONFIG_LPS + rtw_pm_set_lps(adapter, adapter->registrypriv.power_mgnt); +#endif + + /* 3. back to original 2.4 tx bw mode */ + rtw_set_tx_bw_mode(adapter, adapter->registrypriv.tx_bw_mode); +} + +static void rtw_tpt_mode(struct _ADAPTER *adapter) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(adapter); + + if (dvobj->tpt_mode > 0) { + + /* when enable each tpt mode + 1. scan deny + 2. disable LPS */ + + dvobj->scan_deny = _TRUE; + +#ifdef CONFIG_LPS + rtw_pm_set_lps(adapter, PS_MODE_ACTIVE); +#endif + + } + + switch (dvobj->tpt_mode) { + case 0: /* default mode */ + tpt_mode_default(adapter); + break; + case 1: /* High TP*/ + /*tpt_mode1(adapter);*/ + dvobj->edca_be_ul = 0x5e431c; + dvobj->edca_be_dl = 0x00431c; + break; + case 2: /* noise */ + /* tpt_mode2(adapter); */ + dvobj->edca_be_ul = 0x00431c; + dvobj->edca_be_dl = 0x00431c; + + rtw_set_tx_bw_mode(adapter, 0x20); /* for 2.4g, fixed tx_bw_mode to 20Mhz */ + break; + case 3: /* long distance */ + /* tpt_mode3(adapter); */ + dvobj->edca_be_ul = 0x00431c; + dvobj->edca_be_dl = 0x00431c; + + rtw_set_tx_bw_mode(adapter, 0x20); /* for 2.4g, fixed tx_bw_mode to 20Mhz */ + break; + case 4: /* noise + long distance */ + /* tpt_mode4(adapter); */ + dvobj->edca_be_ul = 0x00431c; + dvobj->edca_be_dl = 0x00431c; + + rtw_set_tx_bw_mode(adapter, 0x20); /* for 2.4g, fixed tx_bw_mode to 20Mhz */ + break; + default: /* default mode */ + tpt_mode_default(adapter); + break; + } + +} + +static ssize_t proc_set_tpt_mode(struct file *file, const char __user *buffer, + size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + struct _ADAPTER *adapter = (_adapter *)rtw_netdev_priv(dev); + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + char tmp[32]; + int num = 0; + int mode = 0; + +#define MAX_TPT_MODE_NUM 4 + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (!buffer || copy_from_user(tmp, buffer, count)) + goto exit; + + num = sscanf(tmp, "%d", &mode); + if (num != 1) { + RTW_ERR("%s: invalid parameter!\n", __FUNCTION__); + goto exit; + } + + if (mode > MAX_TPT_MODE_NUM ) + mode = 0; + + RTW_PRINT("%s: previous mode = %d\n", + __FUNCTION__, dvobj->tpt_mode); + + RTW_PRINT("%s: enabled mode = %d\n", + __FUNCTION__, mode); + + dvobj->tpt_mode = mode; + + rtw_tpt_mode(adapter); + +exit: + return count; + +} +#endif /* CONFIG_RTW_TPT_MODE */ + /* * rtw_adapter_proc: * init/deinit when register/unregister net_device @@ -2335,21 +4005,31 @@ const struct rtw_proc_hdl adapter_proc_hdls[] = { RTW_PROC_HDL_SSEQ("scan_abort", proc_get_scan_abort, NULL), #ifdef CONFIG_SCAN_BACKOP RTW_PROC_HDL_SSEQ("backop_flags_sta", proc_get_backop_flags_sta, proc_set_backop_flags_sta), + #ifdef CONFIG_AP_MODE RTW_PROC_HDL_SSEQ("backop_flags_ap", proc_get_backop_flags_ap, proc_set_backop_flags_ap), + #endif + #ifdef CONFIG_RTW_MESH + RTW_PROC_HDL_SSEQ("backop_flags_mesh", proc_get_backop_flags_mesh, proc_set_backop_flags_mesh), + #endif +#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), +#ifdef ROKU_PRIVATE + RTW_PROC_HDL_SSEQ("infra_ap", proc_get_infra_ap, NULL), +#endif /* ROKU_PRIVATE */ 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), RTW_PROC_HDL_SSEQ("mac_qinfo", proc_get_mac_qinfo, NULL), RTW_PROC_HDL_SSEQ("macid_info", proc_get_macid_info, NULL), 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), @@ -2364,19 +4044,30 @@ 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), +#ifdef CONFIG_AP_MODE + RTW_PROC_HDL_SSEQ("ap_linking_test", NULL, proc_set_ap_linking_test), +#endif 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_RTW_LED + RTW_PROC_HDL_SSEQ("led_config", proc_get_led_config, proc_set_led_config), +#endif + #ifdef CONFIG_AP_MODE + RTW_PROC_HDL_SSEQ("aid_status", proc_get_aid_status, proc_set_aid_status), 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 @@ -2388,16 +4079,19 @@ const struct rtw_proc_hdl adapter_proc_hdls[] = { #endif RTW_PROC_HDL_SSEQ("rx_signal", proc_get_rx_signal, proc_set_rx_signal), + RTW_PROC_HDL_SSEQ("rx_chk_limit", proc_get_rx_chk_limit, proc_set_rx_chk_limit), RTW_PROC_HDL_SSEQ("hw_info", proc_get_hw_status, proc_set_hw_status), - + RTW_PROC_HDL_SSEQ("mac_rptbuf", proc_get_mac_rptbuf, NULL), #ifdef CONFIG_80211N_HT 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_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), + RTW_PROC_HDL_SSEQ("tx_max_agg_num", proc_get_tx_max_agg_num, proc_set_tx_max_agg_num), #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), @@ -2405,7 +4099,6 @@ const struct rtw_proc_hdl adapter_proc_hdls[] = { #endif /* CONFIG_80211N_HT */ 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), /* RTW_PROC_HDL_SSEQ("path_rssi", proc_get_two_path_rssi, NULL), * RTW_PROC_HDL_SSEQ("rssi_disp",proc_get_rssi_disp, proc_set_rssi_disp), */ @@ -2416,15 +4109,31 @@ 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), + RTW_PROC_HDL_SSEQ("btc_reduce_wl_txpwr", proc_get_btc_reduce_wl_txpwr, proc_set_btc_reduce_wl_txpwr), +#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) RTW_PROC_HDL_SSEQ("sreset", proc_get_sreset, proc_set_sreset), #endif /* DBG_CONFIG_ERROR_DETECT */ RTW_PROC_HDL_SSEQ("trx_info_debug", proc_get_trx_info_debug, NULL), + +#ifdef CONFIG_HUAWEI_PROC + RTW_PROC_HDL_SSEQ("huawei_trx_info", proc_get_huawei_trx_info, NULL), +#endif 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), + +#if defined(CONFIG_LPS_PG) && defined(CONFIG_RTL8822C) + RTW_PROC_HDL_SSEQ("lps_pg_debug", proc_get_lps_pg_debug, NULL), +#endif + #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), @@ -2437,13 +4146,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), + + RTW_PROC_HDL_SSEQ("pci_conf_space", proc_get_pci_conf_space, proc_set_pci_conf_space), + + RTW_PROC_HDL_SSEQ("pci_bridge_conf_space", proc_get_pci_bridge_conf_space, proc_set_pci_bridge_conf_space), + #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), @@ -2464,23 +4189,36 @@ const struct rtw_proc_hdl adapter_proc_hdls[] = { #if CONFIG_RTW_PRE_LINK_STA RTW_PROC_HDL_SSEQ("pre_link_sta", proc_get_pre_link_sta, proc_set_pre_link_sta), #endif + RTW_PROC_HDL_SSEQ("ch_sel_policy", proc_get_ch_sel_policy, proc_set_ch_sel_policy), #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("dfs_test_case", proc_get_dfs_test_case, proc_set_dfs_test_case), RTW_PROC_HDL_SSEQ("update_non_ocp", NULL, proc_set_update_non_ocp), RTW_PROC_HDL_SSEQ("radar_detect", NULL, proc_set_radar_detect), RTW_PROC_HDL_SSEQ("dfs_ch_sel_d_flags", proc_get_dfs_ch_sel_d_flags, proc_set_dfs_ch_sel_d_flags), + #ifdef CONFIG_DFS_SLAVE_WITH_RADAR_DETECT + RTW_PROC_HDL_SSEQ("dfs_slave_with_rd", proc_get_dfs_slave_with_rd, proc_set_dfs_slave_with_rd), + #endif #endif +#ifdef CONFIG_BCN_CNT_CONFIRM_HDL RTW_PROC_HDL_SSEQ("new_bcn_max", proc_get_new_bcn_max, proc_set_new_bcn_max), +#endif RTW_PROC_HDL_SSEQ("sink_udpport", proc_get_udpport, proc_set_udpport), #ifdef DBG_RX_COUNTER_DUMP 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), +#if CONFIG_TX_AC_LIFETIME + RTW_PROC_HDL_SSEQ("tx_aclt_force_val", proc_get_tx_aclt_force_val, proc_set_tx_aclt_force_val), + RTW_PROC_HDL_SSEQ("tx_aclt_flags", proc_get_tx_aclt_flags, proc_set_tx_aclt_flags), + RTW_PROC_HDL_SSEQ("tx_aclt_confs", proc_get_tx_aclt_confs, proc_set_tx_aclt_confs), +#endif RTW_PROC_HDL_SSEQ("tx_bw_mode", proc_get_tx_bw_mode, proc_set_tx_bw_mode), 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), +#if 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 @@ -2490,16 +4228,26 @@ const struct rtw_proc_hdl adapter_proc_hdls[] = { RTW_PROC_HDL_SSEQ("kfree_thermal", proc_get_kfree_thermal, proc_set_kfree_thermal), #endif #ifdef CONFIG_POWER_SAVING - RTW_PROC_HDL_SSEQ("ps_info", proc_get_ps_info, NULL), + RTW_PROC_HDL_SSEQ("ps_info", proc_get_ps_info, proc_set_ps_info), +#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 @@ -2510,6 +4258,10 @@ const struct rtw_proc_hdl adapter_proc_hdls[] = { RTW_PROC_HDL_SSEQ("11w_tx_auth", proc_get_tx_auth, proc_set_tx_auth), #endif /* CONFIG_IEEE80211W */ +#ifdef CONFIG_CUSTOMER01_SMART_ANTENNA + RTW_PROC_HDL_SSEQ("pathb_phase", proc_get_pathb_phase, proc_set_pathb_phase), +#endif + #ifdef CONFIG_MBSSID_CAM RTW_PROC_HDL_SSEQ("mbid_cam", proc_get_mbid_cam_cache, NULL), #endif @@ -2522,10 +4274,11 @@ const struct rtw_proc_hdl adapter_proc_hdls[] = { RTW_PROC_HDL_SSEQ("tx_stat", proc_get_tx_stat, NULL), /**** PHY Capability ****/ RTW_PROC_HDL_SSEQ("phy_cap", proc_get_phy_cap, NULL), - +#ifdef CONFIG_80211N_HT 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), +#endif /* CONFIG_80211N_HT */ #ifdef CONFIG_BEAMFORMING RTW_PROC_HDL_SSEQ("txbf_cap", proc_get_txbf_cap, proc_set_txbf_cap), #endif @@ -2534,16 +4287,76 @@ const struct rtw_proc_hdl adapter_proc_hdls[] = { 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), -#if 0 /*def CONFIG_SUPPORT_FIFO_DUMP*/ - /*RTW_PROC_HDL_SSEQ("fifo_dump", proc_dump_fifo, proc_set_fifo_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 RTW_HALMAC - RTW_PROC_HDL_SSEQ("halmac_info", proc_get_halmac_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("fw_offload", proc_get_fw_offload, proc_set_fw_offload), + +#ifdef CONFIG_RTW_MESH + #if CONFIG_RTW_MESH_ACNODE_PREVENT + RTW_PROC_HDL_SSEQ("mesh_acnode_prevent", proc_get_mesh_acnode_prevent, proc_set_mesh_acnode_prevent), + #endif + #if CONFIG_RTW_MESH_OFFCH_CAND + RTW_PROC_HDL_SSEQ("mesh_offch_cand", proc_get_mesh_offch_cand, proc_set_mesh_offch_cand), + #endif + #if CONFIG_RTW_MESH_PEER_BLACKLIST + RTW_PROC_HDL_SSEQ("mesh_peer_blacklist", proc_get_mesh_peer_blacklist, proc_set_mesh_peer_blacklist), + #endif + #if CONFIG_RTW_MESH_CTO_MGATE_BLACKLIST + RTW_PROC_HDL_SSEQ("mesh_cto_mgate_require", proc_get_mesh_cto_mgate_require, proc_set_mesh_cto_mgate_require), + RTW_PROC_HDL_SSEQ("mesh_cto_mgate_blacklist", proc_get_mesh_cto_mgate_blacklist, proc_set_mesh_cto_mgate_blacklist), + #endif + RTW_PROC_HDL_SSEQ("mesh_peer_sel_policy", proc_get_mesh_peer_sel_policy, NULL), + RTW_PROC_HDL_SSEQ("mesh_networks", proc_get_mesh_networks, NULL), + RTW_PROC_HDL_SSEQ("mesh_plink_ctl", proc_get_mesh_plink_ctl, NULL), + RTW_PROC_HDL_SSEQ("mesh_mpath", proc_get_mesh_mpath, NULL), + RTW_PROC_HDL_SSEQ("mesh_mpp", proc_get_mesh_mpp, NULL), + RTW_PROC_HDL_SSEQ("mesh_known_gates", proc_get_mesh_known_gates, NULL), + #if CONFIG_RTW_MESH_DATA_BMC_TO_UC + RTW_PROC_HDL_SSEQ("mesh_b2u_flags", proc_get_mesh_b2u_flags, proc_set_mesh_b2u_flags), + #endif + RTW_PROC_HDL_SSEQ("mesh_stats", proc_get_mesh_stats, NULL), + RTW_PROC_HDL_SSEQ("mesh_gate_timeout_factor", proc_get_mesh_gate_timeout, proc_set_mesh_gate_timeout), + RTW_PROC_HDL_SSEQ("mesh_gate_state", proc_get_mesh_gate_state, NULL), + RTW_PROC_HDL_SSEQ("mesh_peer_alive_based_preq", proc_get_peer_alive_based_preq, proc_set_peer_alive_based_preq), +#endif +#ifdef CONFIG_FW_HANDLE_TXBCN + RTW_PROC_HDL_SSEQ("fw_tbtt_rpt", proc_get_fw_tbtt_rpt, proc_set_fw_tbtt_rpt), +#endif +#ifdef CONFIG_LPS_CHK_BY_TP + RTW_PROC_HDL_SSEQ("lps_chk_tp", proc_get_lps_chk_tp, proc_set_lps_chk_tp), +#endif +#ifdef CONFIG_SUPPORT_STATIC_SMPS + RTW_PROC_HDL_SSEQ("smps", proc_get_smps, proc_set_smps), +#endif + + RTW_PROC_HDL_SSEQ("scan_deny", proc_get_scan_deny, proc_set_scan_deny), +#ifdef CONFIG_RTW_TPT_MODE + RTW_PROC_HDL_SSEQ("tpt_mode", proc_get_tpt_mode, proc_set_tpt_mode), +#endif + +#ifdef CONFIG_CTRL_TXSS_BY_TP + RTW_PROC_HDL_SSEQ("txss_tp", proc_get_txss_tp, proc_set_txss_tp), + #ifdef DBG_CTRL_TXSS + RTW_PROC_HDL_SSEQ("txss_ctrl", proc_get_txss_ctrl, proc_set_txss_ctrl), + #endif +#endif + }; const int adapter_proc_hdls_num = sizeof(adapter_proc_hdls) / sizeof(struct rtw_proc_hdl); @@ -2600,45 +4413,6 @@ static const struct file_operations rtw_adapter_proc_sseq_fops = { .write = rtw_adapter_proc_write, }; - -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; @@ -2655,10 +4429,7 @@ ssize_t proc_set_odm_adaptivity(struct file *file, const char __user *buffer, si _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; if (count < 1) return -EFAULT; @@ -2670,12 +4441,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", &th_l2h_ini, &th_edcca_hl_diff); - if (num != 5) + if (num != 2) 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); } return count; @@ -2688,14 +4459,12 @@ int proc_get_phydm_cmd(struct seq_file *m, void *v) { struct net_device *netdev; PADAPTER padapter; - PHAL_DATA_TYPE pHalData; - struct PHY_DM_STRUCT *phydm; + struct 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); @@ -2717,15 +4486,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; - struct PHY_DM_STRUCT *phydm; + struct 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; @@ -2752,97 +4519,13 @@ ssize_t proc_set_phydm_cmd(struct file *file, const char __user *buffer, size_t return count; } -#ifdef CONFIG_LAMODE -static void *proc_start_lamode_dump(struct seq_file *m, loff_t *pos) -{ - _adapter *adapter = (_adapter *)rtw_netdev_priv(m->private); - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(adapter); - struct PHY_DM_STRUCT *pDM_Odm = &pHalData->odmpriv; - PRT_ADCSMP AdcSmp = &(pDM_Odm->adcsmp); - static unsigned long index; - static unsigned long max; - - - if (*pos == 0) { - rtw_pm_set_ips(adapter, IPS_NONE); - rtw_pm_set_lps(adapter, PS_MODE_ACTIVE); - ADCSmp_Start(pDM_Odm, AdcSmp); - index = 0; - *pos = max = ADCSmp_Get_SampleCounts(pDM_Odm); - if (max == 0) - return NULL; - } else if (index >= max) { - return NULL; - } - - return &index; -} - -static void proc_stop_lamode_dump(struct seq_file *m, void *v) -{ - /* v is a NULL in kernel 3.19.0-25 */ -} - -static void *proc_next_lamode_dump(struct seq_file *m, void *v, loff_t *pos) -{ - _adapter *adapter = (_adapter *)rtw_netdev_priv(m->private); - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(adapter); - struct PHY_DM_STRUCT *pDM_Odm = &pHalData->odmpriv; - unsigned long *index = v; - - - *index += 2; - if (*index >= *pos) { - ADCSmp_DeInit(pDM_Odm); - if (phydm_msg) { - _RTW_PRINT_SEL(m, "%s", phydm_msg); - rtw_mfree(phydm_msg, PHYDM_MSG_LEN); - phydm_msg = NULL; - } - return NULL; - } - return index; -} - -static int proc_show_lamode_data(struct seq_file *m, void *v) -{ - _adapter *adapter = (_adapter *)rtw_netdev_priv(m->private); - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(adapter); - struct PHY_DM_STRUCT *pDM_Odm = &pHalData->odmpriv; - unsigned long *index = v; - char line[32]; - int rtn; - - - memset(line, 0, sizeof(line)); - rtn = ADCSmp_Query_SingleData(pDM_Odm, line, sizeof(line), *index); - _RTW_PRINT_SEL(m, "%s", line); - - if (rtn<0) - return -1; - - return 0; -} - -static struct seq_operations seq_ops_lamode = { - .start = proc_start_lamode_dump, - .stop = proc_stop_lamode_dump, - .next = proc_next_lamode_dump, - .show = proc_show_lamode_data, -}; -#endif /* CONFIG_LAMODE */ - /* * rtw_odm_proc: * init/deinit when register/unregister net_device, along with rtw_adapter_proc */ const struct rtw_proc_hdl odm_proc_hdls[] = { 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), -#ifdef CONFIG_LAMODE - RTW_PROC_HDL_SEQ("lamode", &seq_ops_lamode, proc_set_phydm_cmd) -#endif /* CONFIG_LAMODE */ }; const int odm_proc_hdls_num = sizeof(odm_proc_hdls) / sizeof(struct rtw_proc_hdl); @@ -2975,6 +4658,10 @@ void rtw_odm_proc_deinit(_adapter *adapter) const struct rtw_proc_hdl mcc_proc_hdls[] = { RTW_PROC_HDL_SSEQ("mcc_info", proc_get_mcc_info, NULL), RTW_PROC_HDL_SSEQ("mcc_enable", proc_get_mcc_info, proc_set_mcc_enable), + RTW_PROC_HDL_SSEQ("mcc_duration", proc_get_mcc_info, proc_set_mcc_duration), + #ifdef CONFIG_MCC_PHYDM_OFFLOAD + RTW_PROC_HDL_SSEQ("mcc_phydm_offload", proc_get_mcc_info, proc_set_mcc_phydm_offload_enable), + #endif RTW_PROC_HDL_SSEQ("mcc_single_tx_criteria", proc_get_mcc_info, proc_set_mcc_single_tx_criteria), RTW_PROC_HDL_SSEQ("mcc_ap_bw20_target_tp", proc_get_mcc_info, proc_set_mcc_ap_bw20_target_tp), RTW_PROC_HDL_SSEQ("mcc_ap_bw40_target_tp", proc_get_mcc_info, proc_set_mcc_ap_bw40_target_tp), @@ -2982,7 +4669,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), + RTW_PROC_HDL_SSEQ("mcc_policy_table", proc_get_mcc_policy_table, NULL), }; const int mcc_proc_hdls_num = sizeof(mcc_proc_hdls) / sizeof(struct rtw_proc_hdl); @@ -3109,7 +4796,6 @@ struct proc_dir_entry *rtw_adapter_proc_init(struct net_device *dev) struct proc_dir_entry *dir_dev = NULL; struct proc_dir_entry *entry = NULL; _adapter *adapter = rtw_netdev_priv(dev); - u8 rf_type; ssize_t i; if (drv_proc == NULL) { diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/rtw_proc.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/rtw_proc.h index 0ab929c51f25..bdeace1928ee 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/rtw_proc.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/rtw_proc.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/os_dep/linux/rtw_rhashtable.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/rtw_rhashtable.c new file mode 100644 index 000000000000..2fd62d33aaa7 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/rtw_rhashtable.c @@ -0,0 +1,78 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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_RTW_MESH /* for now, only promised for kernel versions we support mesh */ + +#include + +int rtw_rhashtable_walk_enter(rtw_rhashtable *ht, rtw_rhashtable_iter *iter) +{ +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 9, 0)) + rhashtable_walk_enter((ht), (iter)); + return 0; +#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 7, 0)) + return rhashtable_walk_init((ht), (iter), GFP_ATOMIC); +#else + /* kernel >= 4.4.0 rhashtable_walk_init use GFP_KERNEL to alloc, spin_lock for assignment */ + iter->ht = ht; + iter->p = NULL; + iter->slot = 0; + iter->skip = 0; + + iter->walker = kmalloc(sizeof(*iter->walker), GFP_ATOMIC); + if (!iter->walker) + return -ENOMEM; + + spin_lock(&ht->lock); + iter->walker->tbl = + rcu_dereference_protected(ht->tbl, lockdep_is_held(&ht->lock)); + list_add(&iter->walker->list, &iter->walker->tbl->walkers); + spin_unlock(&ht->lock); + + return 0; +#endif +} + +#if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 4, 0)) +#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 15, 0)) +#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 25)) +static inline int is_vmalloc_addr(const void *x) +{ +#ifdef CONFIG_MMU + unsigned long addr = (unsigned long)x; + + return addr >= VMALLOC_START && addr < VMALLOC_END; +#else + return 0; +#endif +} +#endif /* (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 25)) */ + +void kvfree(const void *addr) +{ + if (is_vmalloc_addr(addr)) + vfree(addr); + else + kfree(addr); +} +#endif /* (LINUX_VERSION_CODE < KERNEL_VERSION(3, 15, 0)) */ + +#include "rhashtable.c" + +#endif /* (LINUX_VERSION_CODE < KERNEL_VERSION(4, 4, 0)) */ + +#endif /* CONFIG_RTW_MESH */ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/rtw_rhashtable.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/rtw_rhashtable.h new file mode 100644 index 000000000000..8d6ec4e3730b --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/rtw_rhashtable.h @@ -0,0 +1,60 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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_RHASHTABLE_H__ +#define __RTW_RHASHTABLE_H__ + +#ifdef CONFIG_RTW_MESH /* for now, only promised for kernel versions we support mesh */ + +/* directly reference rhashtable in kernel */ +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 4, 0)) +#include +#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 4, 0)) */ + +/* Use rhashtable from kernel 4.4 */ +#if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 4, 0)) +#if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 0, 0)) +#define NULLS_MARKER(value) (1UL | (((long)value) << 1)) +#endif +#include "rhashtable.h" +#endif /* (LINUX_VERSION_CODE < KERNEL_VERSION(4, 4, 0)) */ + +typedef struct rhashtable rtw_rhashtable; +typedef struct rhash_head rtw_rhash_head; +typedef struct rhashtable_params rtw_rhashtable_params; + +#define rtw_rhashtable_init(ht, params) rhashtable_init(ht, params) + +typedef struct rhashtable_iter rtw_rhashtable_iter; + +int rtw_rhashtable_walk_enter(rtw_rhashtable *ht, rtw_rhashtable_iter *iter); +#define rtw_rhashtable_walk_exit(iter) rhashtable_walk_exit(iter) +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 16, 0)) +#define rtw_rhashtable_walk_start(iter) rhashtable_walk_start_check(iter) +#else +#define rtw_rhashtable_walk_start(iter) rhashtable_walk_start(iter) +#endif +#define rtw_rhashtable_walk_next(iter) rhashtable_walk_next(iter) +#define rtw_rhashtable_walk_stop(iter) rhashtable_walk_stop(iter) + +#define rtw_rhashtable_free_and_destroy(ht, free_fn, arg) rhashtable_free_and_destroy((ht), (free_fn), (arg)) +#define rtw_rhashtable_lookup_fast(ht, key, params) rhashtable_lookup_fast((ht), (key), (params)) +#define rtw_rhashtable_lookup_insert_fast(ht, obj, params) rhashtable_lookup_insert_fast((ht), (obj), (params)) +#define rtw_rhashtable_remove_fast(ht, obj, params) rhashtable_remove_fast((ht), (obj), (params)) + +#endif /* CONFIG_RTW_MESH */ + +#endif /* __RTW_RHASHTABLE_H__ */ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/usb_intf.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/usb_intf.c index f1b4d4bb8b92..f83df799b0cc 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/usb_intf.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/usb_intf.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 @@ -28,10 +24,6 @@ #error "CONFIG_USB_HCI shall be on!\n" #endif -#if defined(PLATFORM_LINUX) && defined (PLATFORM_WINDOWS) -#error "Shall be Linux or Windows, but not both!\n" -#endif - #ifdef CONFIG_80211N_HT extern int rtw_ht_enable; extern int rtw_bw_mode; @@ -56,7 +48,6 @@ static void rtw_dev_shutdown(struct device *dev) struct usb_interface *usb_intf = container_of(dev, struct usb_interface, dev); struct dvobj_priv *dvobj = NULL; _adapter *adapter = NULL; - int i; RTW_INFO("%s\n", __func__); @@ -66,8 +57,15 @@ static void rtw_dev_shutdown(struct device *dev) adapter = dvobj_get_primary_adapter(dvobj); if (adapter) { if (!rtw_is_surprise_removed(adapter)) { - struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); #ifdef CONFIG_WOWLAN + struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); + + #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(adapter, WAKEUP_GPIO_IDX, _FALSE); + #endif /* CONFIG_GPIO_WAKEUP */ + if (pwrctl->wowlan_mode == _TRUE) RTW_PRINT("%s wowlan_mode ==_TRUE do not run rtw_hal_deinit()\n", __FUNCTION__); else @@ -194,6 +192,7 @@ static struct usb_device_id rtw_usb_id_tbl[] = { {USB_DEVICE(0x0E66, 0x0023), .driver_info = RTL8821}, /* HAWKING - Edimax */ {USB_DEVICE(0x056E, 0x400E) , .driver_info = RTL8821}, /* ELECOM - ELECOM */ {USB_DEVICE(0x056E, 0x400F) , .driver_info = RTL8821}, /* ELECOM - ELECOM */ + {USB_DEVICE(0x20f4, 0x804b), .driver_info = RTL8821}, /* TRENDnet */ #endif #ifdef CONFIG_RTL8192E @@ -229,10 +228,17 @@ static struct usb_device_id rtw_usb_id_tbl[] = { {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDER_ID_REALTEK, 0xF179, 0xff, 0xff, 0xff), .driver_info = RTL8188F}, /* 8188FU 1*1 */ #endif +#ifdef CONFIG_RTL8188GTV + /*=== Realtek demoboard ===*/ + {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDER_ID_REALTEK, 0x018C, 0xff, 0xff, 0xff), .driver_info = RTL8188GTV}, /* 8188GTV 1*1 */ +#endif + #ifdef CONFIG_RTL8822B /*=== Realtek demoboard ===*/ {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDER_ID_REALTEK, 0xB82C, 0xff, 0xff, 0xff), .driver_info = RTL8822B}, /* Default ID for USB multi-function */ {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDER_ID_REALTEK, 0xB812, 0xff, 0xff, 0xff), .driver_info = RTL8822B}, /* Default ID for USB Single-function, WiFi only */ + /*=== Customer ID ===*/ + {USB_DEVICE_AND_INTERFACE_INFO(0x13b1, 0x0043, 0xff, 0xff, 0xff), .driver_info = RTL8822B}, /* Alpha - Alpha*/ #endif /* CONFIG_RTL8822B */ #ifdef CONFIG_RTL8723D @@ -240,6 +246,11 @@ static struct usb_device_id rtw_usb_id_tbl[] = { {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDER_ID_REALTEK, 0xD723, 0xff, 0xff, 0xff), .driver_info = RTL8723D}, /* 8723DU 1*1 */ #endif +#ifdef CONFIG_RTL8192F + /*=== Realtek demoboard ===*/ + {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDER_ID_REALTEK, 0xF192, 0xff, 0xff, 0xff), .driver_info = RTL8192F}, /* 8192FU 2*2 */ +#endif + #ifdef CONFIG_RTL8821C /*=== Realtek demoboard ===*/ {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDER_ID_REALTEK, 0xb82b, 0xff, 0xff, 0xff), .driver_info = RTL8821C}, /* 8821CU */ @@ -248,9 +259,24 @@ static struct usb_device_id rtw_usb_id_tbl[] = { {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDER_ID_REALTEK, 0xC820, 0xff, 0xff, 0xff), .driver_info = RTL8821C}, /* 8821CU */ {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDER_ID_REALTEK, 0xC82A, 0xff, 0xff, 0xff), .driver_info = RTL8821C}, /* 8821CU */ {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDER_ID_REALTEK, 0xC82B, 0xff, 0xff, 0xff), .driver_info = RTL8821C}, /* 8821CU */ + {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDER_ID_REALTEK, 0xC811, 0xff, 0xff, 0xff), .driver_info = RTL8821C}, /* 8811CU */ + {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDER_ID_REALTEK, 0x8811, 0xff, 0xff, 0xff), .driver_info = RTL8821C}, /* 8811CU */ /*=== Customer ID ===*/ #endif +#ifdef CONFIG_RTL8710B + /*=== Realtek dongle ===*/ + {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDER_ID_REALTEK, 0xB711, 0xff, 0xff, 0xff), .driver_info = RTL8710B}, /* 8710B = 8188GU 1*1 */ +#endif + +#ifdef CONFIG_RTL8822C + /*=== Realtek demoboard ===*/ + {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDER_ID_REALTEK, 0xC82C, 0xff, 0xff, 0xff), .driver_info = RTL8822C}, /* Default ID for USB multi-function */ + {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDER_ID_REALTEK, 0xC812, 0xff, 0xff, 0xff), .driver_info = RTL8822C}, /* Default ID for USB Single-function, WiFi only */ + /*=== Customer ID ===*/ + {USB_DEVICE_AND_INTERFACE_INFO(0x13b1, 0x0043, 0xff, 0xff, 0xff), .driver_info = RTL8822C}, /* Alpha - Alpha*/ +#endif /* CONFIG_RTL8822C */ + {} /* Terminating entry */ }; @@ -412,6 +438,11 @@ static void rtw_decide_chip_type_by_usb_info(struct dvobj_priv *pdvobjpriv, cons rtl8188fu_set_hw_type(pdvobjpriv); #endif +#ifdef CONFIG_RTL8188GTV + if (pdvobjpriv->chip_type == RTL8188GTV) + rtl8188gtvu_set_hw_type(pdvobjpriv); +#endif + #ifdef CONFIG_RTL8703B if (pdvobjpriv->chip_type == RTL8703B) rtl8703bu_set_hw_type(pdvobjpriv); @@ -431,12 +462,26 @@ static void rtw_decide_chip_type_by_usb_info(struct dvobj_priv *pdvobjpriv, cons if (pdvobjpriv->chip_type == RTL8821C) rtl8821cu_set_hw_type(pdvobjpriv); #endif /* CONFIG_RTL8821C */ + +#ifdef CONFIG_RTL8710B + if (pdvobjpriv->chip_type == RTL8710B) + rtl8710bu_set_hw_type(pdvobjpriv); +#endif /* CONFIG_RTL8710B */ + +#ifdef CONFIG_RTL8192F + if (pdvobjpriv->chip_type == RTL8192F) + rtl8192fu_set_hw_type(pdvobjpriv); +#endif /* CONFIG_RTL8192F */ + +#ifdef CONFIG_RTL8822C + if (pdvobjpriv->chip_type == RTL8822C) + rtl8822cu_set_hw_type(pdvobjpriv); +#endif /* CONFIG_RTL8822C */ } static struct dvobj_priv *usb_dvobj_init(struct usb_interface *usb_intf, const struct usb_device_id *pdid) { int i; - u8 val8; int status = _FAIL; struct dvobj_priv *pdvobjpriv; struct usb_device_descriptor *pdev_desc; @@ -698,6 +743,11 @@ u8 rtw_set_hal_ops(_adapter *padapter) rtl8188fu_set_hal_ops(padapter); #endif +#ifdef CONFIG_RTL8188GTV + if (rtw_get_chip_type(padapter) == RTL8188GTV) + rtl8188gtvu_set_hal_ops(padapter); +#endif + #ifdef CONFIG_RTL8703B if (rtw_get_chip_type(padapter) == RTL8703B) rtl8703bu_set_hal_ops(padapter); @@ -721,6 +771,22 @@ u8 rtw_set_hal_ops(_adapter *padapter) } #endif +#ifdef CONFIG_RTL8710B + if (rtw_get_chip_type(padapter) == RTL8710B) + rtl8710bu_set_hal_ops(padapter); +#endif /* CONFIG_RTL8710B */ + + +#ifdef CONFIG_RTL8192F + if (rtw_get_chip_type(padapter) == RTL8192F) + rtl8192fu_set_hal_ops(padapter); +#endif + +#ifdef CONFIG_RTL8822C + if (rtw_get_chip_type(padapter) == RTL8822C) + rtl8822cu_set_hal_ops(padapter); +#endif /* CONFIG_RTL8822C */ + if (_FAIL == rtw_hal_ops_check(padapter)) return _FAIL; @@ -825,12 +891,12 @@ int rtw_hw_suspend(_adapter *padapter) /* padapter->net_closed = _TRUE; */ /* s1. */ if (pnetdev) { - netif_carrier_off(pnetdev); + rtw_netif_carrier_off(pnetdev); rtw_netif_stop_queue(pnetdev); } /* s2. */ - rtw_disassoc_cmd(padapter, 500, _FALSE); + rtw_disassoc_cmd(padapter, 500, RTW_CMDF_DIRECTLY); /* s2-2. indicate disconnect to os */ /* rtw_indicate_disconnect(padapter); */ @@ -844,12 +910,12 @@ int rtw_hw_suspend(_adapter *padapter) #ifdef CONFIG_LPS /* donnot enqueue cmd */ - rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_DISCONNECT, 0); + rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_DISCONNECT, RTW_CMDF_DIRECTLY); #endif } } /* s2-3. */ - rtw_free_assoc_resources(padapter, 1); + rtw_free_assoc_resources(padapter, _TRUE); /* s2-4. */ rtw_free_network_queue(padapter, _TRUE); @@ -883,7 +949,7 @@ int rtw_hw_resume(_adapter *padapter) _exit_pwrlock(&pwrpriv->lock); goto error_exit; } - + rtw_netif_device_attach(pnetdev); rtw_netif_carrier_on(pnetdev); rtw_netif_wake_queue(pnetdev); @@ -929,7 +995,7 @@ static int rtw_suspend(struct usb_interface *pusb_intf, pm_message_t message) #ifdef SUPPORT_HW_RFOFF_DETECTED /* The FW command register update must after MAC and FW init ready. */ - if ((padapter->bFWReady) && (pwrpriv->bHWPwrPindetect) && (padapter->registrypriv.usbss_enable)) { + if ((GET_HAL_DATA(padapter)->bFWReady) && (pwrpriv->bHWPwrPindetect) && (padapter->registrypriv.usbss_enable)) { u8 bOpen = _TRUE; rtw_interface_ps_func(padapter, HAL_USB_SELECT_SUSPEND, &bOpen); } @@ -946,7 +1012,10 @@ static int rtw_suspend(struct usb_interface *pusb_intf, pm_message_t message) int rtw_resume_process(_adapter *padapter) { - int ret, pm_cnt = 0; + int ret; +#if defined(CONFIG_BT_COEXIST) && defined(CONFIG_AUTOSUSPEND) + int pm_cnt = 0; +#endif struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); struct dvobj_priv *pdvobj = padapter->dvobj; struct debug_priv *pdbgpriv = &pdvobj->drv_dbg; @@ -991,7 +1060,7 @@ int rtw_resume_process(_adapter *padapter) if (pwrpriv->bInternalAutoSuspend) { #ifdef SUPPORT_HW_RFOFF_DETECTED /* The FW command register update must after MAC and FW init ready. */ - if ((padapter->bFWReady) && (pwrpriv->bHWPwrPindetect) && (padapter->registrypriv.usbss_enable)) { + if ((GET_HAL_DATA(padapter)->bFWReady) && (pwrpriv->bHWPwrPindetect) && (padapter->registrypriv.usbss_enable)) { u8 bOpen = _FALSE; rtw_interface_ps_func(padapter, HAL_USB_SELECT_SUSPEND, &bOpen); } @@ -1034,9 +1103,12 @@ static int rtw_resume(struct usb_interface *pusb_intf) RTW_INFO("==> %s (%s:%d)\n", __FUNCTION__, current->comm, current->pid); pdbgpriv->dbg_resume_cnt++; + #ifdef CONFIG_AUTOSUSPEND if (pwrpriv->bInternalAutoSuspend) ret = rtw_resume_process(padapter); - else { + else + #endif + { if (pwrpriv->wowlan_mode || pwrpriv->wowlan_ap_mode) { rtw_resume_lock_suspend(); ret = rtw_resume_process(padapter); @@ -1192,9 +1264,6 @@ extern void rtd2885_wlan_netlink_sendMsg(char *action_string, char *name); * notes: drv_init() is called when the bus driver has located a card for us to support. * We accept the new device by returning 0. */ - -_adapter *rtw_sw_export = NULL; - _adapter *rtw_usb_primary_adapter_init(struct dvobj_priv *dvobj, struct usb_interface *pusb_intf) { @@ -1243,6 +1312,11 @@ _adapter *rtw_usb_primary_adapter_init(struct dvobj_priv *dvobj, /* step usb endpoint mapping */ rtw_hal_chip_configure(padapter); +#ifdef CONFIG_BT_COEXIST + rtw_btcoex_Initialize(padapter); +#endif + rtw_btcoex_wifionly_initialize(padapter); + /* step read efuse/eeprom data and get mac_addr */ if (rtw_hal_read_chip_info(padapter) == _FAIL) goto free_hal_data; @@ -1252,15 +1326,6 @@ _adapter *rtw_usb_primary_adapter_init(struct dvobj_priv *dvobj, goto free_hal_data; } -#ifdef CONFIG_BT_COEXIST - if (GET_HAL_DATA(padapter)->EEPROMBluetoothCoexist) - rtw_btcoex_Initialize(padapter); - else - rtw_btcoex_wifionly_initialize(padapter); -#else /* !CONFIG_BT_COEXIST */ - rtw_btcoex_wifionly_initialize(padapter); -#endif /* CONFIG_BT_COEXIST */ - #ifdef CONFIG_PM #if (LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 18)) if (dvobj_to_pwrctl(dvobj)->bSupportRemoteWakeup) { @@ -1331,6 +1396,9 @@ _adapter *rtw_usb_primary_adapter_init(struct dvobj_priv *dvobj, rtw_hal_free_data(padapter); free_adapter: if (status != _SUCCESS && padapter) { + #ifdef RTW_HALMAC + rtw_halmac_deinit_adapter(dvobj); + #endif rtw_vmfree((u8 *)padapter, sizeof(*padapter)); padapter = NULL; } @@ -1340,16 +1408,18 @@ _adapter *rtw_usb_primary_adapter_init(struct dvobj_priv *dvobj, static void rtw_usb_primary_adapter_deinit(_adapter *padapter) { +#if defined(CONFIG_WOWLAN) || defined(CONFIG_BT_COEXIST) struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); +#endif struct mlme_priv *pmlmepriv = &padapter->mlmepriv; RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); 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); @@ -1439,10 +1509,6 @@ static int rtw_drv_init(struct usb_interface *pusb_intf, const struct usb_device } #endif -#ifdef CONFIG_INTEL_PROXIM - rtw_sw_export = padapter; -#endif - #ifdef CONFIG_GLOBAL_UI_PID if (ui_pid[1] != 0) { RTW_INFO("ui_pid[1]:%d\n", ui_pid[1]); @@ -1497,11 +1563,10 @@ static int rtw_drv_init(struct usb_interface *pusb_intf, const struct usb_device static void rtw_dev_remove(struct usb_interface *pusb_intf) { struct dvobj_priv *dvobj = usb_get_intfdata(pusb_intf); +#if defined(CONFIG_HAS_EARLYSUSPEND) || defined(CONFIG_ANDROID_POWER) struct pwrctrl_priv *pwrctl = dvobj_to_pwrctl(dvobj); +#endif _adapter *padapter = dvobj_get_primary_adapter(dvobj); - struct net_device *pnetdev = padapter->pnetdev; - struct mlme_priv *pmlmepriv = &padapter->mlmepriv; - RTW_INFO("+rtw_dev_remove\n"); @@ -1517,7 +1582,7 @@ static void rtw_dev_remove(struct usb_interface *pusb_intf) /*else { - padapter->HalData->hw_init_completed = _FALSE; + rtw_set_hw_init_completed(padapter, _FALSE); }*/ @@ -1525,7 +1590,7 @@ static void rtw_dev_remove(struct usb_interface *pusb_intf) rtw_unregister_early_suspend(pwrctl); #endif - if (padapter->bFWReady == _TRUE) { + if (GET_HAL_DATA(padapter)->bFWReady == _TRUE) { rtw_pm_set_ips(padapter, IPS_NONE); rtw_pm_set_lps(padapter, PS_MODE_ACTIVE); @@ -1555,12 +1620,6 @@ static void rtw_dev_remove(struct usb_interface *pusb_intf) RTW_INFO("-r871xu_dev_remove, done\n"); - -#ifdef CONFIG_INTEL_PROXIM - rtw_sw_export = NULL; -#endif - - return; } @@ -1568,7 +1627,7 @@ static void rtw_dev_remove(struct usb_interface *pusb_intf) extern int console_suspend_enabled; #endif -static int rtw_drv_entry(void) +static int __init rtw_drv_entry(void) { int ret = 0; @@ -1592,6 +1651,7 @@ static int rtw_drv_entry(void) rtw_suspend_lock_init(); rtw_drv_proc_init(); rtw_ndev_notifier_register(); + rtw_inetaddr_notifier_register(); ret = usb_register(&usb_drv.usbdrv); @@ -1600,6 +1660,7 @@ static int rtw_drv_entry(void) rtw_suspend_lock_uninit(); rtw_drv_proc_deinit(); rtw_ndev_notifier_unregister(); + rtw_inetaddr_notifier_unregister(); goto exit; } @@ -1608,7 +1669,7 @@ static int rtw_drv_entry(void) return ret; } -static void rtw_drv_halt(void) +static void __exit rtw_drv_halt(void) { RTW_PRINT("module exit start\n"); @@ -1621,65 +1682,12 @@ 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); } - -#include -extern int get_wifi_chip_type(void); - -int rockchip_wifi_init_module_rtkwifi(void) -{ -//#ifdef CONFIG_WIFI_LOAD_DRIVER_WHEN_KERNEL_BOOTUP -// int type = get_wifi_chip_type(); -// if (type < WIFI_AP6XXX_SERIES || type == WIFI_ESP8089) return 0; -//#endif - printk("\n"); - printk("=======================================================\n"); - printk("==== Launching Wi-Fi driver! (Powered by Rockchip) ====\n"); - printk("=======================================================\n"); - printk("Realtek 8188EU USB WiFi driver (Powered by Rockchip,Ver %s) init.\n", DRIVERVERSION); - rockchip_wifi_power(1); - - return rtw_drv_entry(); -} - -void rockchip_wifi_exit_module_rtkwifi(void) -{ -#ifdef CONFIG_WIFI_LOAD_DRIVER_WHEN_KERNEL_BOOTUP - int type = get_wifi_chip_type(); - if (type < WIFI_AP6XXX_SERIES || type == WIFI_ESP8089) return; -#endif - printk("\n"); - printk("=======================================================\n"); - printk("==== Dislaunching Wi-Fi driver! (Powered by Rockchip) ====\n"); - printk("=======================================================\n"); - printk("Realtek 8188EU USB WiFi driver (Powered by Rockchip,Ver %s) init.\n", DRIVERVERSION); - rtw_drv_halt(); - rockchip_wifi_power(0); -} -#ifdef CONFIG_WIFI_BUILD_MODULE -module_init(rockchip_wifi_init_module_rtkwifi); -module_exit(rockchip_wifi_exit_module_rtkwifi); -#else -#ifdef CONFIG_WIFI_LOAD_DRIVER_WHEN_KERNEL_BOOTUP -late_initcall(rockchip_wifi_init_module_rtkwifi); -module_exit(rockchip_wifi_exit_module_rtkwifi); -#else -module_init(rockchip_wifi_init_module_rtkwifi); -module_exit(rockchip_wifi_exit_module_rtkwifi); -#endif -#endif -//module_init(rtw_drv_entry); -//module_exit(rtw_drv_halt); - -#ifdef CONFIG_INTEL_PROXIM -_adapter *rtw_usb_get_sw_pointer(void) -{ - return rtw_sw_export; -} -EXPORT_SYMBOL(rtw_usb_get_sw_pointer); -#endif /* CONFIG_INTEL_PROXIM */ +module_init(rtw_drv_entry); +module_exit(rtw_drv_halt); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/usb_ops_linux.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/usb_ops_linux.c index e2127bb8ced5..d47b6f9f93f5 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/usb_ops_linux.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/usb_ops_linux.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 _USB_OPS_LINUX_C_ #include @@ -31,20 +28,30 @@ int usbctrl_vendorreq(struct intf_hdl *pintfhdl, u8 request, u16 value, u16 inde { _adapter *padapter = pintfhdl->padapter; struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); - struct pwrctrl_priv *pwrctl = dvobj_to_pwrctl(pdvobjpriv); struct usb_device *udev = pdvobjpriv->pusbdev; unsigned int pipe; int status = 0; +#ifdef CONFIG_USB_VENDOR_REQ_BUFFER_DYNAMIC_ALLOCATE u32 tmp_buflen = 0; +#endif u8 reqtype; u8 *pIo_buf; int vendorreq_times = 0; +#if (defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C)) || defined(CONFIG_RTL8822C) +#define REG_ON_SEC 0x00 +#define REG_OFF_SEC 0x01 +#define REG_LOCAL_SEC 0x02 + u8 current_reg_sec = REG_LOCAL_SEC; +#endif + #ifdef CONFIG_USB_VENDOR_REQ_BUFFER_DYNAMIC_ALLOCATE u8 *tmp_buf; #else /* use stack memory */ + #ifndef CONFIG_USB_VENDOR_REQ_BUFFER_PREALLOC u8 tmp_buf[MAX_USB_IO_CTL_SIZE]; + #endif #endif /* RTW_INFO("%s %s:%d\n",__FUNCTION__, current->comm, current->pid); */ @@ -61,7 +68,7 @@ int usbctrl_vendorreq(struct intf_hdl *pintfhdl, u8 request, u16 value, u16 inde } #ifdef CONFIG_USB_VENDOR_REQ_MUTEX - _enter_critical_mutex(&pdvobjpriv->usb_vendor_req_mutex, NULL); + _enter_critical_mutex_lock(&pdvobjpriv->usb_vendor_req_mutex, NULL); #endif @@ -145,6 +152,38 @@ int usbctrl_vendorreq(struct intf_hdl *pintfhdl, u8 request, u16 value, u16 inde } +#if (defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C)) || defined(CONFIG_RTL8822C) + if (value < 0xFE00) { + if (0x00 <= value && value <= 0xff) + current_reg_sec = REG_ON_SEC; + else if (0x1000 <= value && value <= 0x10ff) + current_reg_sec = REG_ON_SEC; + else + current_reg_sec = REG_OFF_SEC; + } else { + current_reg_sec = REG_LOCAL_SEC; + } + + if (current_reg_sec == REG_ON_SEC) { + unsigned int t_pipe = usb_sndctrlpipe(udev, 0);/* write_out */ + u8 t_reqtype = REALTEK_USB_VENQT_WRITE; + u8 t_len = 1; + u8 t_req = 0x05; + u16 t_reg = 0; + u16 t_index = 0; + + t_reg = 0x4e0; + + status = rtw_usb_control_msg(udev, t_pipe, t_req, t_reqtype, t_reg, t_index, pIo_buf, t_len, RTW_USB_CONTROL_MSG_TIMEOUT); + + if (status == t_len) + rtw_reset_continual_io_error(pdvobjpriv); + else + RTW_INFO("reg 0x%x, usb %s %u fail, status:%d\n", t_reg, "write" , t_len, status); + + } +#endif + /* release IO memory used by vendorreq */ #ifdef CONFIG_USB_VENDOR_REQ_BUFFER_DYNAMIC_ALLOCATE rtw_mfree(tmp_buf, tmp_buflen); @@ -238,15 +277,19 @@ unsigned int ffaddr2pipehdl(struct dvobj_priv *pdvobj, u32 addr) else if (addr == RECV_INT_IN_ADDR) pipe = usb_rcvintpipe(pusbd, pdvobj->RtInPipe[1]); - else if (addr < HW_QUEUE_ENTRY) { #ifdef RTW_HALMAC - /* halmac already translate queue id to bulk out id */ - ep_num = pdvobj->RtOutPipe[addr]; + /* halmac already translate queue id to bulk out id (addr 0~3) */ + else if (addr < 4) { + ep_num = pdvobj->RtOutPipe[addr]; + pipe = usb_sndbulkpipe(pusbd, ep_num); + } #else - ep_num = pdvobj->Queue2Pipe[addr]; + else if (addr < HW_QUEUE_ENTRY) { + ep_num = pdvobj->Queue2Pipe[addr]; + pipe = usb_sndbulkpipe(pusbd, ep_num); + } #endif - pipe = usb_sndbulkpipe(pusbd, ep_num); - } + return pipe; } @@ -257,7 +300,7 @@ struct zero_bulkout_context { void *pirp; void *padapter; }; - +#if 0 static void usb_bulkout_zero_complete(struct urb *purb, struct pt_regs *regs) { struct zero_bulkout_context *pcontext = (struct zero_bulkout_context *)purb->context; @@ -287,7 +330,6 @@ static u32 usb_bulkout_zero(struct intf_hdl *pintfhdl, u32 addr) PURB purb = NULL; _adapter *padapter = (_adapter *)pintfhdl->padapter; struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); - struct pwrctrl_priv *pwrctl = dvobj_to_pwrctl(pdvobj); struct usb_device *pusbd = pdvobj->pusbdev; /* RTW_INFO("%s\n", __func__); */ @@ -334,7 +376,7 @@ static u32 usb_bulkout_zero(struct intf_hdl *pintfhdl, u32 addr) return _SUCCESS; } - +#endif void usb_read_mem(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *rmem) { @@ -372,7 +414,6 @@ void usb_read_port_cancel(struct intf_hdl *pintfhdl) static void usb_write_port_complete(struct urb *purb, struct pt_regs *regs) { _irqL irqL; - int i; struct xmit_buf *pxmitbuf = (struct xmit_buf *)purb->context; /* struct xmit_frame *pxmitframe = (struct xmit_frame *)pxmitbuf->priv_data; */ /* _adapter *padapter = pxmitframe->padapter; */ @@ -510,18 +551,14 @@ u32 usb_write_port(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *wmem) _irqL irqL; unsigned int pipe; int status; - u32 ret = _FAIL, bwritezero = _FALSE; + u32 ret = _FAIL; PURB purb = NULL; _adapter *padapter = (_adapter *)pintfhdl->padapter; struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); - struct pwrctrl_priv *pwrctl = dvobj_to_pwrctl(pdvobj); struct xmit_priv *pxmitpriv = &padapter->xmitpriv; struct xmit_buf *pxmitbuf = (struct xmit_buf *)wmem; struct xmit_frame *pxmitframe = (struct xmit_frame *)pxmitbuf->priv_data; struct usb_device *pusbd = pdvobj->pusbdev; - struct pkt_attrib *pattrib = &pxmitframe->attrib; - - if (RTW_CANNOT_TX(padapter)) { #ifdef DBG_TX @@ -724,7 +761,7 @@ void usb_read_port_complete(struct urb *purb, struct pt_regs *regs) , __func__ , rtw_is_drv_stopped(padapter) ? "True" : "False" , rtw_is_surprise_removed(padapter) ? "True" : "False"); - goto exit; + return; } if (purb->status == 0) { @@ -778,8 +815,6 @@ void usb_read_port_complete(struct urb *purb, struct pt_regs *regs) } } -exit: - } u32 usb_read_port(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *rmem) @@ -952,7 +987,6 @@ u32 usb_read_port(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *rmem) struct recv_buf *precvbuf = (struct recv_buf *)rmem; _adapter *adapter = pintfhdl->padapter; struct dvobj_priv *pdvobj = adapter_to_dvobj(adapter); - struct pwrctrl_priv *pwrctl = dvobj_to_pwrctl(pdvobj); struct recv_priv *precvpriv = &adapter->recvpriv; struct usb_device *pusbd = pdvobj->pusbdev; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/wifi_regd.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/wifi_regd.c index d79e3a30e7d4..1be3df11b630 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/wifi_regd.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/wifi_regd.c @@ -1,7 +1,16 @@ /* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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. * *****************************************************************************/ @@ -135,11 +144,6 @@ 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) @@ -152,7 +156,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; @@ -161,7 +165,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) { @@ -249,68 +253,12 @@ static void _rtw_reg_apply_active_scan_flags(struct wiphy *wiphy, } #endif -/* - * Always apply Radar/DFS rules on - * freq range 5260 MHz - 5700 MHz - */ -static void _rtw_reg_apply_radar_flags(struct wiphy *wiphy) +void rtw_regd_apply_flags(struct wiphy *wiphy) { - struct ieee80211_supported_band *sband; - struct ieee80211_channel *ch; - unsigned int i; - - if (!wiphy->bands[NL80211_BAND_5GHZ]) - return; - - 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)) - continue; -#ifdef CONFIG_DFS - 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); - #else - ch->flags |= IEEE80211_CHAN_NO_IR; - #endif - } -#endif /* CONFIG_DFS */ - -#if 0 - /* - * We always enable radar detection/DFS on this - * frequency range. Additionally we also apply on - * this frequency range: - * - If STA mode does not yet have DFS supports disable - * active scanning - * - If adhoc mode does not support DFS yet then disable - * adhoc in the frequency. - * - If AP mode does not yet support radar detection/DFS - * do not allow AP mode - */ - if (!(ch->flags & IEEE80211_CHAN_DISABLED)) - ch->flags |= IEEE80211_CHAN_RADAR | - IEEE80211_CHAN_NO_IBSS | - IEEE80211_CHAN_PASSIVE_SCAN; -#endif - } -} - -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 dvobj_priv *dvobj = wiphy_to_dvobj(wiphy); + struct rf_ctl_t *rfctl = dvobj_to_rfctl(dvobj); + 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; @@ -338,109 +286,37 @@ static void _rtw_reg_apply_flags(struct wiphy *wiphy) freq = rtw_ch2freq(channel); ch = ieee80211_get_channel(wiphy, freq); - if (ch) { - if (channel_set[i].ScanType == SCAN_PASSIVE - #if defined(CONFIG_DFS_MASTER) - && 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; - #endif - } else - ch->flags = 0; + if (!ch) + continue; + + if (channel_set[i].ScanType == SCAN_PASSIVE + #if defined(CONFIG_DFS_MASTER) + && rtw_odm_dfs_domain_unknown(dvobj) + #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; + #endif + } else + ch->flags = 0; + + #ifdef CONFIG_DFS + if (rtw_is_dfs_ch(ch->hw_value) + #if defined(CONFIG_DFS_MASTER) + && rtw_odm_dfs_domain_unknown(dvobj) + #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); + #else + ch->flags |= IEEE80211_CHAN_NO_IR; + #endif } + #endif /* CONFIG_DFS */ } - -#else - struct ieee80211_supported_band *sband; - struct ieee80211_channel *ch; - unsigned int i, j; - u16 channels[37] = { - 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48, 52, 56, - 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, - 149, 153, - 157, 161, 165 - }; - u16 channel; - u32 freq; - - for (i = 0; i < NUM_NL80211_BANDS; i++) { - sband = wiphy->bands[i]; - - if (sband) - for (j = 0; j < sband->n_channels; j++) { - ch = &sband->channels[j]; - - if (ch) - ch->flags = IEEE80211_CHAN_DISABLED; - } - } - - for (i = 0; i < 37; i++) { - channel = channels[i]; - freq = rtw_ch2freq(channel); - - ch = ieee80211_get_channel(wiphy, freq); - if (ch) { - if (channel <= 11) - ch->flags = 0; - else - ch->flags = 0; /* IEEE80211_CHAN_PASSIVE_SCAN; */ - } - /* printk("%s: freq %d(%d) flag 0x%02X\n", __func__, freq, channel, ch->flags); */ - } -#endif -} - -static void _rtw_reg_apply_world_flags(struct wiphy *wiphy, - enum nl80211_reg_initiator initiator, - struct rtw_regulatory *reg) -{ - /* _rtw_reg_apply_beaconing_flags(wiphy, initiator); */ - /* _rtw_reg_apply_active_scan_flags(wiphy, initiator); */ - return; -} - -static int _rtw_reg_notifier_apply(struct wiphy *wiphy, - struct regulatory_request *request, - struct rtw_regulatory *reg) -{ - - /* Hard code flags */ - _rtw_reg_apply_flags(wiphy); - - /* We always apply this */ - _rtw_reg_apply_radar_flags(wiphy); - - switch (request->initiator) { - case NL80211_REGDOM_SET_BY_DRIVER: - RTW_INFO("%s: %s\n", __func__, "NL80211_REGDOM_SET_BY_DRIVER"); - _rtw_reg_apply_world_flags(wiphy, NL80211_REGDOM_SET_BY_DRIVER, - reg); - break; - case NL80211_REGDOM_SET_BY_CORE: - RTW_INFO("%s: %s\n", __func__, - "NL80211_REGDOM_SET_BY_CORE to DRV"); - _rtw_reg_apply_world_flags(wiphy, NL80211_REGDOM_SET_BY_DRIVER, - reg); - break; - case NL80211_REGDOM_SET_BY_USER: - RTW_INFO("%s: %s\n", __func__, - "NL80211_REGDOM_SET_BY_USER to DRV"); - _rtw_reg_apply_world_flags(wiphy, NL80211_REGDOM_SET_BY_DRIVER, - reg); - break; - case NL80211_REGDOM_SET_BY_COUNTRY_IE: - RTW_INFO("%s: %s\n", __func__, - "NL80211_REGDOM_SET_BY_COUNTRY_IE"); - _rtw_reg_apply_world_flags(wiphy, request->initiator, reg); - break; - } - - return 0; } static const struct ieee80211_regdomain *_rtw_regdomain_select(struct @@ -458,41 +334,45 @@ static const struct ieee80211_regdomain *_rtw_regdomain_select(struct #endif } -void _rtw_reg_notifier(struct wiphy *wiphy, struct regulatory_request *request) +static void rtw_reg_notifier(struct wiphy *wiphy, struct regulatory_request *request) { - struct rtw_regulatory *reg = NULL; - - RTW_INFO("%s\n", __func__); - - _rtw_reg_notifier_apply(wiphy, request, reg); -} - -#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 9, 0)) -int rtw_reg_notifier(struct wiphy *wiphy, struct regulatory_request *request) -#else -void rtw_reg_notifier(struct wiphy *wiphy, struct regulatory_request *request) -#endif -{ - _rtw_reg_notifier(wiphy, request); -#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 9, 0)) - return 0; -#endif -} - -void rtw_reg_notify_by_driver(_adapter *adapter) -{ - if ((adapter->rtw_wdev != NULL) && (adapter->rtw_wdev->wiphy)) { - struct regulatory_request request; - request.initiator = NL80211_REGDOM_SET_BY_DRIVER; - rtw_reg_notifier(adapter->rtw_wdev->wiphy, &request); + switch (request->initiator) { + case NL80211_REGDOM_SET_BY_DRIVER: + RTW_INFO("%s: %s\n", __func__, "NL80211_REGDOM_SET_BY_DRIVER"); + break; + case NL80211_REGDOM_SET_BY_CORE: + RTW_INFO("%s: %s\n", __func__, "NL80211_REGDOM_SET_BY_CORE"); + break; + case NL80211_REGDOM_SET_BY_USER: + RTW_INFO("%s: %s alpha2:%c%c\n", __func__, "NL80211_REGDOM_SET_BY_USER" + , request->alpha2[0], request->alpha2[1]); + rtw_set_country(wiphy_to_adapter(wiphy), request->alpha2); + break; + case NL80211_REGDOM_SET_BY_COUNTRY_IE: + RTW_INFO("%s: %s\n", __func__, "NL80211_REGDOM_SET_BY_COUNTRY_IE"); + break; } + + rtw_regd_apply_flags(wiphy); } +#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 9, 0)) +static int rtw_reg_notifier_return(struct wiphy *wiphy, struct regulatory_request *request) +{ + rtw_reg_notifier(wiphy, request); + return 0; +} +#endif + static void _rtw_regd_init_wiphy(struct rtw_regulatory *reg, struct wiphy *wiphy) { const struct ieee80211_regdomain *regd; +#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 9, 0)) + wiphy->reg_notifier = rtw_reg_notifier_return; +#else wiphy->reg_notifier = rtw_reg_notifier; +#endif #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 0)) wiphy->flags |= WIPHY_FLAG_CUSTOM_REGULATORY; @@ -507,27 +387,11 @@ static void _rtw_regd_init_wiphy(struct rtw_regulatory *reg, struct wiphy *wiphy regd = _rtw_regdomain_select(reg); wiphy_apply_custom_regulatory(wiphy, regd); - /* Hard code flags */ - _rtw_reg_apply_flags(wiphy); - _rtw_reg_apply_radar_flags(wiphy); - _rtw_reg_apply_world_flags(wiphy, NL80211_REGDOM_SET_BY_DRIVER, reg); + rtw_regd_apply_flags(wiphy); } -static struct country_code_to_enum_rd *_rtw_regd_find_country(u16 countrycode) +int rtw_regd_init(struct wiphy *wiphy) { - int i; - - for (i = 0; i < ARRAY_SIZE(allCountries); i++) { - if (allCountries[i].countrycode == countrycode) - return &allCountries[i]; - } - return NULL; -} - -int rtw_regd_init(_adapter *padapter) -{ - struct wiphy *wiphy = padapter->rtw_wdev->wiphy; - #if 0 if (rtw_regd == NULL) { rtw_regd = (struct rtw_regulatory *) diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/xmit_linux.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/xmit_linux.c index 7721b7d0db82..2ab285b3db44 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/xmit_linux.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/linux/xmit_linux.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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 @@ -70,36 +66,48 @@ sint rtw_endofpktfile(struct pkt_file *pfile) void rtw_set_tx_chksum_offload(_pkt *pkt, struct pkt_attrib *pattrib) { - -#ifdef CONFIG_TCP_CSUM_OFFLOAD_TX +#ifdef CONFIG_TX_CSUM_OFFLOAD struct sk_buff *skb = (struct sk_buff *)pkt; - pattrib->hw_tcp_csum = 0; + struct iphdr *iph = NULL; + struct ipv6hdr *i6ph = NULL; + struct udphdr *uh = NULL; + struct tcphdr *th = NULL; + u8 protocol = 0xFF; - if (skb->ip_summed == CHECKSUM_PARTIAL) { - if (skb_shinfo(skb)->nr_frags == 0) { - const struct iphdr *ip = ip_hdr(skb); - if (ip->protocol == IPPROTO_TCP) { - /* TCP checksum offload by HW */ - RTW_INFO("CHECKSUM_PARTIAL TCP\n"); - pattrib->hw_tcp_csum = 1; - /* skb_checksum_help(skb); */ - } else if (ip->protocol == IPPROTO_UDP) { - /* RTW_INFO("CHECKSUM_PARTIAL UDP\n"); */ -#if 1 - skb_checksum_help(skb); -#else - /* Set UDP checksum = 0 to skip checksum check */ - struct udphdr *udp = skb_transport_header(skb); - udp->check = 0; -#endif - } else { - RTW_INFO("%s-%d TCP CSUM offload Error!!\n", __FUNCTION__, __LINE__); - WARN_ON(1); /* we need a WARN() */ - } - } else { /* IP fragmentation case */ - RTW_INFO("%s-%d nr_frags != 0, using skb_checksum_help(skb);!!\n", __FUNCTION__, __LINE__); + if (skb->protocol == htons(ETH_P_IP)) { + iph = (struct iphdr *)skb_network_header(skb); + protocol = iph->protocol; + } else if (skb->protocol == htons(ETH_P_IPV6)) { + i6ph = (struct ipv6hdr *)skb_network_header(skb); + protocol = i6ph->nexthdr; + } else + {} + + /* HW unable to compute CSUM if header & payload was be encrypted by SW(cause TXDMA error) */ + if (pattrib->bswenc == _TRUE) { + if (skb->ip_summed == CHECKSUM_PARTIAL) skb_checksum_help(skb); - } + return; + } + + /* For HW rule, clear ipv4_csum & UDP/TCP_csum if it is UDP/TCP packet */ + switch (protocol) { + case IPPROTO_UDP: + uh = (struct udphdr *)skb_transport_header(skb); + uh->check = 0; + if (iph) + iph->check = 0; + pattrib->hw_csum = _TRUE; + break; + case IPPROTO_TCP: + th = (struct tcphdr *)skb_transport_header(skb); + th->check = 0; + if (iph) + iph->check = 0; + pattrib->hw_csum = _TRUE; + break; + default: + break; } #endif @@ -200,6 +208,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)) { @@ -312,7 +326,6 @@ void rtw_os_xmit_schedule(_adapter *padapter) static bool rtw_check_xmit_resource(_adapter *padapter, _pkt *pkt) { bool busy = _FALSE; - struct xmit_priv *pxmitpriv = &padapter->xmitpriv; #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) u16 qidx; @@ -403,9 +416,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], ETH_ALEN) == _TRUE + || _rtw_memcmp(psta->cmn.mac_addr, null_addr, ETH_ALEN) == _TRUE + || _rtw_memcmp(psta->cmn.mac_addr, bc_addr, ETH_ALEN) == _TRUE ) { DBG_COUNTER(padapter->tx_logs.os_tx_m2u_ignore_self); continue; @@ -416,7 +429,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, ETH_ALEN); res = rtw_xmit(padapter, &newskb); if (res < 0) { DBG_COUNTER(padapter->tx_logs.os_tx_m2u_entry_err_xmit); @@ -444,14 +457,14 @@ int _rtw_xmit_entry(_pkt *pkt, _nic_hdl pnetdev) _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); struct xmit_priv *pxmitpriv = &padapter->xmitpriv; #ifdef CONFIG_TX_MCAST2UNI - struct mlme_priv *pmlmepriv = &padapter->mlmepriv; extern int rtw_mc2u_disable; #endif /* CONFIG_TX_MCAST2UNI */ - s32 res = 0; -#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) - u16 queue; +#ifdef CONFIG_TX_CSUM_OFFLOAD + struct sk_buff *skb = pkt; + struct sk_buff *segs, *nskb; + netdev_features_t features = padapter->pnetdev->features; #endif - + s32 res = 0; if (padapter->registrypriv.mp_mode) { RTW_INFO("MP_TX_DROP_OS_FRAME\n"); @@ -471,7 +484,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) && (IP_MCAST_MAC(pkt->data) || ICMPV6_MCAST_MAC(pkt->data) #ifdef CONFIG_TX_BCAST2UNI @@ -492,6 +505,33 @@ int _rtw_xmit_entry(_pkt *pkt, _nic_hdl pnetdev) } #endif /* CONFIG_TX_MCAST2UNI */ +#ifdef CONFIG_TX_CSUM_OFFLOAD + if (skb_shinfo(skb)->gso_size) { + /* split a big(65k) skb into several small(1.5k) skbs */ + features &= ~(NETIF_F_TSO | NETIF_F_TSO6); + segs = skb_gso_segment(skb, features); + if (IS_ERR(segs) || !segs) + goto drop_packet; + + do { + nskb = segs; + segs = segs->next; + nskb->next = NULL; + rtw_mstat_update( MSTAT_TYPE_SKB, MSTAT_ALLOC_SUCCESS, nskb->truesize); + res = rtw_xmit(padapter, &nskb); + if (res < 0) { + #ifdef DBG_TX_DROP_FRAME + RTW_INFO("DBG_TX_DROP_FRAME %s rtw_xmit fail\n", __FUNCTION__); + #endif + pxmitpriv->tx_drop++; + rtw_os_pkt_complete(padapter, nskb); + } + } while (segs); + rtw_os_pkt_complete(padapter, skb); + goto exit; + } +#endif + res = rtw_xmit(padapter, &pkt); if (res < 0) { #ifdef DBG_TX_DROP_FRAME diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/osdep_service.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/osdep_service.c index 33c72007a3c6..adf6ff681ebe 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/osdep_service.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/os_dep/osdep_service.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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_ @@ -78,9 +74,9 @@ u32 rtw_atoi(u8 *s) } -inline u8 *_rtw_vmalloc(u32 sz) +inline void *_rtw_vmalloc(u32 sz) { - u8 *pbuf; + void *pbuf; #ifdef PLATFORM_LINUX pbuf = vmalloc(sz); #endif @@ -104,9 +100,9 @@ inline u8 *_rtw_vmalloc(u32 sz) return pbuf; } -inline u8 *_rtw_zvmalloc(u32 sz) +inline void *_rtw_zvmalloc(u32 sz) { - u8 *pbuf; + void *pbuf; #ifdef PLATFORM_LINUX pbuf = _rtw_vmalloc(sz); if (pbuf != NULL) @@ -124,7 +120,7 @@ inline u8 *_rtw_zvmalloc(u32 sz) return pbuf; } -inline void _rtw_vmfree(u8 *pbuf, u32 sz) +inline void _rtw_vmfree(void *pbuf, u32 sz) { #ifdef PLATFORM_LINUX vfree(pbuf); @@ -144,15 +140,14 @@ inline void _rtw_vmfree(u8 *pbuf, u32 sz) #endif /* DBG_MEMORY_LEAK */ } -u8 *_rtw_malloc(u32 sz) +void *_rtw_malloc(u32 sz) { - - u8 *pbuf = NULL; + void *pbuf = NULL; #ifdef PLATFORM_LINUX #ifdef RTK_DMP_PLATFORM if (sz > 0x4000) - pbuf = (u8 *)dvr_malloc(sz); + pbuf = dvr_malloc(sz); else #endif pbuf = kmalloc(sz, in_interrupt() ? GFP_ATOMIC : GFP_KERNEL); @@ -181,12 +176,12 @@ u8 *_rtw_malloc(u32 sz) } -u8 *_rtw_zmalloc(u32 sz) +void *_rtw_zmalloc(u32 sz) { #ifdef PLATFORM_FREEBSD return malloc(sz, M_DEVBUF, M_ZERO | M_NOWAIT); #else /* PLATFORM_FREEBSD */ - u8 *pbuf = _rtw_malloc(sz); + void *pbuf = _rtw_malloc(sz); if (pbuf != NULL) { @@ -204,7 +199,7 @@ u8 *_rtw_zmalloc(u32 sz) #endif /* PLATFORM_FREEBSD */ } -void _rtw_mfree(u8 *pbuf, u32 sz) +void _rtw_mfree(void *pbuf, u32 sz) { #ifdef PLATFORM_LINUX @@ -241,8 +236,8 @@ struct sk_buff *dev_alloc_skb(unsigned int size) struct sk_buff *skb = NULL; u8 *data = NULL; - /* skb = (struct sk_buff *)_rtw_zmalloc(sizeof(struct sk_buff)); */ /* for skb->len, etc. */ - skb = (struct sk_buff *)_rtw_malloc(sizeof(struct sk_buff)); + /* skb = _rtw_zmalloc(sizeof(struct sk_buff)); */ /* for skb->len, etc. */ + skb = _rtw_malloc(sizeof(struct sk_buff)); if (!skb) goto out; data = _rtw_malloc(size); @@ -259,7 +254,7 @@ struct sk_buff *dev_alloc_skb(unsigned int size) out: return skb; nodata: - _rtw_mfree((u8 *)skb, sizeof(struct sk_buff)); + _rtw_mfree(skb, sizeof(struct sk_buff)); skb = NULL; goto out; @@ -272,7 +267,7 @@ void dev_kfree_skb_any(struct sk_buff *skb) _rtw_mfree(skb->head, 0); /* printf("%s()-%d: skb = %p\n", __FUNCTION__, __LINE__, skb); */ if (skb) - _rtw_mfree((u8 *)skb, 0); + _rtw_mfree(skb, 0); } struct sk_buff *skb_clone(const struct sk_buff *skb) { @@ -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; @@ -574,9 +569,9 @@ bool match_mstat_sniff_rules(const enum mstat_f flags, const size_t size) return _FALSE; } -inline u8 *dbg_rtw_vmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line) +inline void *dbg_rtw_vmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line) { - u8 *p; + void *p; if (match_mstat_sniff_rules(flags, sz)) RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%d)\n", func, line, __FUNCTION__, (sz)); @@ -592,9 +587,9 @@ inline u8 *dbg_rtw_vmalloc(u32 sz, const enum mstat_f flags, const char *func, c return p; } -inline u8 *dbg_rtw_zvmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line) +inline void *dbg_rtw_zvmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line) { - u8 *p; + void *p; if (match_mstat_sniff_rules(flags, sz)) RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%d)\n", func, line, __FUNCTION__, (sz)); @@ -610,7 +605,7 @@ inline u8 *dbg_rtw_zvmalloc(u32 sz, const enum mstat_f flags, const char *func, return p; } -inline void dbg_rtw_vmfree(u8 *pbuf, u32 sz, const enum mstat_f flags, const char *func, const int line) +inline void dbg_rtw_vmfree(void *pbuf, u32 sz, const enum mstat_f flags, const char *func, const int line) { if (match_mstat_sniff_rules(flags, sz)) @@ -625,9 +620,9 @@ inline void dbg_rtw_vmfree(u8 *pbuf, u32 sz, const enum mstat_f flags, const cha ); } -inline u8 *dbg_rtw_malloc(u32 sz, const enum mstat_f flags, const char *func, const int line) +inline void *dbg_rtw_malloc(u32 sz, const enum mstat_f flags, const char *func, const int line) { - u8 *p; + void *p; if (match_mstat_sniff_rules(flags, sz)) RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%d)\n", func, line, __FUNCTION__, (sz)); @@ -643,9 +638,9 @@ inline u8 *dbg_rtw_malloc(u32 sz, const enum mstat_f flags, const char *func, co return p; } -inline u8 *dbg_rtw_zmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line) +inline void *dbg_rtw_zmalloc(u32 sz, const enum mstat_f flags, const char *func, const int line) { - u8 *p; + void *p; if (match_mstat_sniff_rules(flags, sz)) RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%d)\n", func, line, __FUNCTION__, (sz)); @@ -661,7 +656,7 @@ inline u8 *dbg_rtw_zmalloc(u32 sz, const enum mstat_f flags, const char *func, c return p; } -inline void dbg_rtw_mfree(u8 *pbuf, u32 sz, const enum mstat_f flags, const char *func, const int line) +inline void dbg_rtw_mfree(void *pbuf, u32 sz, const enum mstat_f flags, const char *func, const int line) { if (match_mstat_sniff_rules(flags, sz)) RTW_INFO("DBG_MEM_ALLOC %s:%d %s(%d)\n", func, line, __FUNCTION__, (sz)); @@ -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,50 @@ 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 _pkt *rtw_os_pkt_copy(_pkt *pkt) +{ +#if defined(PLATFORM_LINUX) + return rtw_skb_copy(pkt); +#elif defined(PLATFORM_FREEBSD) + return m_dup(pkt, M_NOWAIT); +#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) { @@ -906,7 +945,7 @@ inline void _rtw_memmove(void *dst, const void *src, u32 sz) #if defined(PLATFORM_LINUX) memmove(dst, src, sz); #else - #warning "no implementation\n" + #error "TBD\n" #endif } @@ -1066,18 +1105,95 @@ void rtw_list_insert_tail(_list *plist, _list *phead) } -void rtw_init_timer(_timer *ptimer, void *padapter, void *pfunc) +inline void rtw_list_splice(_list *list, _list *head) +{ +#ifdef PLATFORM_LINUX + list_splice(list, head); +#else + #error "TBD\n" +#endif +} + +inline void rtw_list_splice_init(_list *list, _list *head) +{ +#ifdef PLATFORM_LINUX + list_splice_init(list, head); +#else + #error "TBD\n" +#endif +} + +inline void rtw_list_splice_tail(_list *list, _list *head) +{ +#ifdef PLATFORM_LINUX + #if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 27)) + if (!list_empty(list)) + __list_splice(list, head); + #else + list_splice_tail(list, head); + #endif +#else + #error "TBD\n" +#endif +} + +inline void rtw_hlist_head_init(rtw_hlist_head *h) +{ +#ifdef PLATFORM_LINUX + INIT_HLIST_HEAD(h); +#else + #error "TBD\n" +#endif +} + +inline void rtw_hlist_add_head(rtw_hlist_node *n, rtw_hlist_head *h) +{ +#ifdef PLATFORM_LINUX + hlist_add_head(n, h); +#else + #error "TBD\n" +#endif +} + +inline void rtw_hlist_del(rtw_hlist_node *n) +{ +#ifdef PLATFORM_LINUX + hlist_del(n); +#else + #error "TBD\n" +#endif +} + +inline void rtw_hlist_add_head_rcu(rtw_hlist_node *n, rtw_hlist_head *h) +{ +#ifdef PLATFORM_LINUX + hlist_add_head_rcu(n, h); +#else + #error "TBD\n" +#endif +} + +inline void rtw_hlist_del_rcu(rtw_hlist_node *n) +{ +#ifdef PLATFORM_LINUX + hlist_del_rcu(n); +#else + #error "TBD\n" +#endif +} + +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 +1292,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 +1536,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 +1550,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; @@ -1428,35 +1580,39 @@ inline u32 rtw_ms_to_systime(u32 ms) #endif } +inline systime _rtw_us_to_systime(u32 us) +{ +#ifdef PLATFORM_LINUX + return usecs_to_jiffies(us); +#else + #error "TBD\n" +#endif +} + /* 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_remaining_time_ms(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 - _rtw_get_current_time()); } +inline s32 _rtw_get_time_interval_ms(systime start, systime end) +{ + return _rtw_systime_to_ms(end - start); +} + +inline bool _rtw_time_after(systime a, systime b) +{ +#ifdef PLATFORM_LINUX + return time_after(a, b); +#else + #error "TBD\n" +#endif +} void rtw_sleep_schedulable(int ms) { @@ -1653,56 +1809,49 @@ void rtw_yield_os(void) #endif } +bool rtw_macaddr_is_larger(const u8 *a, const u8 *b) +{ + u32 va, vb; + + va = be32_to_cpu(*((u32 *)a)); + vb = be32_to_cpu(*((u32 *)b)); + if (va > vb) + return 1; + else if (va < vb) + return 0; + + return be16_to_cpu(*((u16 *)(a + 4))) > be16_to_cpu(*((u16 *)(b + 4))); +} + #define RTW_SUSPEND_LOCK_NAME "rtw_wifi" -#define RTW_SUSPEND_EXT_LOCK_NAME "rtw_wifi_ext" -#define RTW_SUSPEND_RX_LOCK_NAME "rtw_wifi_rx" #define RTW_SUSPEND_TRAFFIC_LOCK_NAME "rtw_wifi_traffic" #define RTW_SUSPEND_RESUME_LOCK_NAME "rtw_wifi_resume" -#define RTW_RESUME_SCAN_LOCK_NAME "rtw_wifi_scan" #ifdef CONFIG_WAKELOCK static struct wake_lock rtw_suspend_lock; -static struct wake_lock rtw_suspend_ext_lock; -static struct wake_lock rtw_suspend_rx_lock; static struct wake_lock rtw_suspend_traffic_lock; static struct wake_lock rtw_suspend_resume_lock; -static struct wake_lock rtw_resume_scan_lock; #elif defined(CONFIG_ANDROID_POWER) static android_suspend_lock_t rtw_suspend_lock = { .name = RTW_SUSPEND_LOCK_NAME }; -static android_suspend_lock_t rtw_suspend_ext_lock = { - .name = RTW_SUSPEND_EXT_LOCK_NAME -}; -static android_suspend_lock_t rtw_suspend_rx_lock = { - .name = RTW_SUSPEND_RX_LOCK_NAME -}; static android_suspend_lock_t rtw_suspend_traffic_lock = { .name = RTW_SUSPEND_TRAFFIC_LOCK_NAME }; static android_suspend_lock_t rtw_suspend_resume_lock = { .name = RTW_SUSPEND_RESUME_LOCK_NAME }; -static android_suspend_lock_t rtw_resume_scan_lock = { - .name = RTW_RESUME_SCAN_LOCK_NAME -}; #endif inline void rtw_suspend_lock_init(void) { #ifdef CONFIG_WAKELOCK wake_lock_init(&rtw_suspend_lock, WAKE_LOCK_SUSPEND, RTW_SUSPEND_LOCK_NAME); - wake_lock_init(&rtw_suspend_ext_lock, WAKE_LOCK_SUSPEND, RTW_SUSPEND_EXT_LOCK_NAME); - wake_lock_init(&rtw_suspend_rx_lock, WAKE_LOCK_SUSPEND, RTW_SUSPEND_RX_LOCK_NAME); wake_lock_init(&rtw_suspend_traffic_lock, WAKE_LOCK_SUSPEND, RTW_SUSPEND_TRAFFIC_LOCK_NAME); wake_lock_init(&rtw_suspend_resume_lock, WAKE_LOCK_SUSPEND, RTW_SUSPEND_RESUME_LOCK_NAME); - wake_lock_init(&rtw_resume_scan_lock, WAKE_LOCK_SUSPEND, RTW_RESUME_SCAN_LOCK_NAME); #elif defined(CONFIG_ANDROID_POWER) android_init_suspend_lock(&rtw_suspend_lock); - android_init_suspend_lock(&rtw_suspend_ext_lock); - android_init_suspend_lock(&rtw_suspend_rx_lock); android_init_suspend_lock(&rtw_suspend_traffic_lock); android_init_suspend_lock(&rtw_suspend_resume_lock); - android_init_suspend_lock(&rtw_resume_scan_lock); #endif } @@ -1710,18 +1859,12 @@ inline void rtw_suspend_lock_uninit(void) { #ifdef CONFIG_WAKELOCK wake_lock_destroy(&rtw_suspend_lock); - wake_lock_destroy(&rtw_suspend_ext_lock); - wake_lock_destroy(&rtw_suspend_rx_lock); wake_lock_destroy(&rtw_suspend_traffic_lock); wake_lock_destroy(&rtw_suspend_resume_lock); - wake_lock_destroy(&rtw_resume_scan_lock); #elif defined(CONFIG_ANDROID_POWER) android_uninit_suspend_lock(&rtw_suspend_lock); - android_uninit_suspend_lock(&rtw_suspend_ext_lock); - android_uninit_suspend_lock(&rtw_suspend_rx_lock); android_uninit_suspend_lock(&rtw_suspend_traffic_lock); android_uninit_suspend_lock(&rtw_suspend_resume_lock); - android_uninit_suspend_lock(&rtw_resume_scan_lock); #endif } @@ -1786,26 +1929,6 @@ inline void rtw_lock_suspend_timeout(u32 timeout_ms) #endif } -inline void rtw_lock_ext_suspend_timeout(u32 timeout_ms) -{ -#ifdef CONFIG_WAKELOCK - wake_lock_timeout(&rtw_suspend_ext_lock, rtw_ms_to_systime(timeout_ms)); -#elif defined(CONFIG_ANDROID_POWER) - android_lock_suspend_auto_expire(&rtw_suspend_ext_lock, rtw_ms_to_systime(timeout_ms)); -#endif - /* RTW_INFO("EXT lock timeout:%d\n", timeout_ms); */ -} - -inline void rtw_lock_rx_suspend_timeout(u32 timeout_ms) -{ -#ifdef CONFIG_WAKELOCK - wake_lock_timeout(&rtw_suspend_rx_lock, rtw_ms_to_systime(timeout_ms)); -#elif defined(CONFIG_ANDROID_POWER) - android_lock_suspend_auto_expire(&rtw_suspend_rx_lock, rtw_ms_to_systime(timeout_ms)); -#endif - /* RTW_INFO("RX lock timeout:%d\n", timeout_ms); */ -} - inline void rtw_lock_traffic_suspend_timeout(u32 timeout_ms) { @@ -1817,14 +1940,31 @@ inline void rtw_lock_traffic_suspend_timeout(u32 timeout_ms) /* RTW_INFO("traffic lock timeout:%d\n", timeout_ms); */ } -inline void rtw_lock_resume_scan_timeout(u32 timeout_ms) +inline void rtw_set_bit(int nr, unsigned long *addr) { -#ifdef CONFIG_WAKELOCK - wake_lock_timeout(&rtw_resume_scan_lock, rtw_ms_to_systime(timeout_ms)); -#elif defined(CONFIG_ANDROID_POWER) - android_lock_suspend_auto_expire(&rtw_resume_scan_lock, rtw_ms_to_systime(timeout_ms)); +#ifdef PLATFORM_LINUX + set_bit(nr, addr); +#else + #error "TBD\n"; +#endif +} + +inline void rtw_clear_bit(int nr, unsigned long *addr) +{ +#ifdef PLATFORM_LINUX + clear_bit(nr, addr); +#else + #error "TBD\n"; +#endif +} + +inline int rtw_test_and_clear_bit(int nr, unsigned long *addr) +{ +#ifdef PLATFORM_LINUX + return test_and_clear_bit(nr, addr); +#else + #error "TBD\n"; #endif - /* RTW_INFO("resume scan lock:%d\n", timeout_ms); */ } inline void ATOMIC_SET(ATOMIC_T *v, int i) @@ -1940,6 +2080,23 @@ inline int ATOMIC_DEC_RETURN(ATOMIC_T *v) #endif } +inline bool ATOMIC_INC_UNLESS(ATOMIC_T *v, int u) +{ +#ifdef PLATFORM_LINUX +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 15)) + return atomic_add_unless(v, 1, u); +#else + /* only make sure not exceed after this function */ + if (ATOMIC_INC_RETURN(v) > u) { + ATOMIC_DEC(v); + return 0; + } + return 1; +#endif +#else + #error "TBD\n" +#endif +} #ifdef PLATFORM_LINUX /* @@ -1987,7 +2144,9 @@ static int readFile(struct file *fp, char *buf, int len) return -EPERM; while (sum < len) { -#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 1, 0)) +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 14, 0)) + rlen = kernel_read(fp, buf + sum, len - sum, &fp->f_pos); +#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 1, 0)) rlen = __vfs_read(fp, buf + sum, len - sum, &fp->f_pos); #else rlen = fp->f_op->read(fp, buf + sum, len - sum, &fp->f_pos); @@ -2043,7 +2202,11 @@ static int isFileReadable(const char *path, u32 *sz) ret = PTR_ERR(fp); else { oldfs = get_fs(); + #if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 1, 0)) + set_fs(KERNEL_DS); + #else set_fs(get_ds()); + #endif if (1 != readFile(fp, &buf, 1)) ret = PTR_ERR(fp); @@ -2081,7 +2244,11 @@ static int retriveFromFile(const char *path, u8 *buf, u32 sz) RTW_INFO("%s openFile path:%s fp=%p\n", __FUNCTION__, path , fp); oldfs = get_fs(); + #if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 1, 0)) + set_fs(KERNEL_DS); + #else set_fs(get_ds()); + #endif ret = readFile(fp, buf, sz); set_fs(oldfs); closeFile(fp); @@ -2116,7 +2283,11 @@ static int storeToFile(const char *path, u8 *buf, u32 sz) RTW_INFO("%s openFile path:%s fp=%p\n", __FUNCTION__, path , fp); oldfs = get_fs(); + #if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 1, 0)) + set_fs(KERNEL_DS); + #else set_fs(get_ds()); + #endif ret = writeFile(fp, buf, sz); set_fs(oldfs); closeFile(fp); @@ -2170,6 +2341,25 @@ int rtw_is_file_readable_with_size(const char *path, u32 *sz) #endif } +/* +* Test if the specifi @param path is a readable file with valid size. +* If readable, @param sz is got +* @param path the path of the file to test +* @return _TRUE or _FALSE +*/ +int rtw_readable_file_sz_chk(const char *path, u32 sz) +{ + u32 fsz; + + if (rtw_is_file_readable_with_size(path, &fsz) == _FALSE) + return _FALSE; + + if (fsz > sz) + return _FALSE; + + return _TRUE; +} + /* * Open the file with @param path and retrive the file content into memory starting from @param buf for @param sz at most * @param path the path of the file to open and read @@ -2686,6 +2876,164 @@ u8 map_read8(const struct map_t *map, u16 offset) return val; } +int rtw_blacklist_add(_queue *blist, const u8 *addr, u32 timeout_ms) +{ + struct blacklist_ent *ent; + _list *list, *head; + u8 exist = _FALSE, timeout = _FALSE; + + enter_critical_bh(&blist->lock); + + head = &blist->queue; + list = get_next(head); + while (rtw_end_of_queue_search(head, list) == _FALSE) { + ent = LIST_CONTAINOR(list, struct blacklist_ent, list); + list = get_next(list); + + if (_rtw_memcmp(ent->addr, addr, ETH_ALEN) == _TRUE) { + exist = _TRUE; + if (rtw_time_after(rtw_get_current_time(), ent->exp_time)) + timeout = _TRUE; + ent->exp_time = rtw_get_current_time() + + rtw_ms_to_systime(timeout_ms); + break; + } + + if (rtw_time_after(rtw_get_current_time(), ent->exp_time)) { + rtw_list_delete(&ent->list); + rtw_mfree(ent, sizeof(struct blacklist_ent)); + } + } + + if (exist == _FALSE) { + ent = rtw_malloc(sizeof(struct blacklist_ent)); + if (ent) { + _rtw_memcpy(ent->addr, addr, ETH_ALEN); + ent->exp_time = rtw_get_current_time() + + rtw_ms_to_systime(timeout_ms); + rtw_list_insert_tail(&ent->list, head); + } + } + + exit_critical_bh(&blist->lock); + + return (exist == _TRUE && timeout == _FALSE) ? RTW_ALREADY : (ent ? _SUCCESS : _FAIL); +} + +int rtw_blacklist_del(_queue *blist, const u8 *addr) +{ + struct blacklist_ent *ent = NULL; + _list *list, *head; + u8 exist = _FALSE; + + enter_critical_bh(&blist->lock); + head = &blist->queue; + list = get_next(head); + while (rtw_end_of_queue_search(head, list) == _FALSE) { + ent = LIST_CONTAINOR(list, struct blacklist_ent, list); + list = get_next(list); + + if (_rtw_memcmp(ent->addr, addr, ETH_ALEN) == _TRUE) { + rtw_list_delete(&ent->list); + rtw_mfree(ent, sizeof(struct blacklist_ent)); + exist = _TRUE; + break; + } + + if (rtw_time_after(rtw_get_current_time(), ent->exp_time)) { + rtw_list_delete(&ent->list); + rtw_mfree(ent, sizeof(struct blacklist_ent)); + } + } + + exit_critical_bh(&blist->lock); + + return exist == _TRUE ? _SUCCESS : RTW_ALREADY; +} + +int rtw_blacklist_search(_queue *blist, const u8 *addr) +{ + struct blacklist_ent *ent = NULL; + _list *list, *head; + u8 exist = _FALSE; + + enter_critical_bh(&blist->lock); + head = &blist->queue; + list = get_next(head); + while (rtw_end_of_queue_search(head, list) == _FALSE) { + ent = LIST_CONTAINOR(list, struct blacklist_ent, list); + list = get_next(list); + + if (_rtw_memcmp(ent->addr, addr, ETH_ALEN) == _TRUE) { + if (rtw_time_after(rtw_get_current_time(), ent->exp_time)) { + rtw_list_delete(&ent->list); + rtw_mfree(ent, sizeof(struct blacklist_ent)); + } else + exist = _TRUE; + break; + } + + if (rtw_time_after(rtw_get_current_time(), ent->exp_time)) { + rtw_list_delete(&ent->list); + rtw_mfree(ent, sizeof(struct blacklist_ent)); + } + } + + exit_critical_bh(&blist->lock); + + return exist; +} + +void rtw_blacklist_flush(_queue *blist) +{ + struct blacklist_ent *ent; + _list *list, *head; + _list tmp; + + _rtw_init_listhead(&tmp); + + enter_critical_bh(&blist->lock); + rtw_list_splice_init(&blist->queue, &tmp); + exit_critical_bh(&blist->lock); + + head = &tmp; + list = get_next(head); + while (rtw_end_of_queue_search(head, list) == _FALSE) { + ent = LIST_CONTAINOR(list, struct blacklist_ent, list); + list = get_next(list); + rtw_list_delete(&ent->list); + rtw_mfree(ent, sizeof(struct blacklist_ent)); + } +} + +void dump_blacklist(void *sel, _queue *blist, const char *title) +{ + struct blacklist_ent *ent = NULL; + _list *list, *head; + + enter_critical_bh(&blist->lock); + head = &blist->queue; + list = get_next(head); + + if (rtw_end_of_queue_search(head, list) == _FALSE) { + if (title) + RTW_PRINT_SEL(sel, "%s:\n", title); + + while (rtw_end_of_queue_search(head, list) == _FALSE) { + ent = LIST_CONTAINOR(list, struct blacklist_ent, list); + list = get_next(list); + + if (rtw_time_after(rtw_get_current_time(), ent->exp_time)) + RTW_PRINT_SEL(sel, MAC_FMT" expired\n", MAC_ARG(ent->addr)); + else + RTW_PRINT_SEL(sel, MAC_FMT" %u\n", MAC_ARG(ent->addr) + , rtw_get_remaining_time_ms(ent->exp_time)); + } + + } + exit_critical_bh(&blist->lock); +} + /** * is_null - * @@ -2700,6 +3048,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 - * @@ -2765,3 +3122,44 @@ inline char alpha_to_upper(char c) c = 'A' + (c - 'a'); return c; } + +int hex2num_i(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_i(const char *hex) +{ + int a, b; + a = hex2num_i(*hex++); + if (a < 0) + return -1; + b = hex2num_i(*hex++); + if (b < 0) + return -1; + return (a << 4) | b; +} + +int hexstr2bin(const char *hex, u8 *buf, size_t len) +{ + size_t i; + int a; + const char *ipos = hex; + u8 *opos = buf; + + for (i = 0; i < len; i++) { + a = hex2byte_i(ipos); + if (a < 0) + return -1; + *opos++ = a; + ipos += 2; + } + return 0; +} + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/custom_country_chplan.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/custom_country_chplan.h index 9d26bf41ccf1..30322fa85a6b 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/custom_country_chplan.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/custom_country_chplan.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,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/rtl8188eu/platform/platform_ARM_SUN50IW1P1_sdio.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_ARM_SUN50IW1P1_sdio.c index 44bd7de1e0e3..76df77886d70 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_ARM_SUN50IW1P1_sdio.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_ARM_SUN50IW1P1_sdio.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/platform/platform_ARM_SUNnI_sdio.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_ARM_SUNnI_sdio.c index 612dfbaa2b1e..11e0736b31c0 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_ARM_SUNnI_sdio.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_ARM_SUNnI_sdio.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/platform/platform_ARM_SUNxI_sdio.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_ARM_SUNxI_sdio.c index 6eed7b137282..c1937844918d 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_ARM_SUNxI_sdio.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_ARM_SUNxI_sdio.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/platform/platform_ARM_SUNxI_usb.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_ARM_SUNxI_usb.c index b2c8a283c158..caf6a6ecabd7 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_ARM_SUNxI_usb.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_ARM_SUNxI_usb.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/platform/platform_ARM_WMT_sdio.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_ARM_WMT_sdio.c index 159a5acfee21..b4f59209b4ee 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_ARM_WMT_sdio.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_ARM_WMT_sdio.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/platform/platform_RTK_DMP_usb.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_RTK_DMP_usb.c index af845f7bb331..cd15f96d157a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_RTK_DMP_usb.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_RTK_DMP_usb.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/platform/platform_aml_s905_sdio.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_aml_s905_sdio.c new file mode 100644 index 000000000000..1ce4e06fd2d4 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_aml_s905_sdio.c @@ -0,0 +1,55 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2016 - 2018 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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 /* pr_info(() */ +#include /* msleep() */ +#include "platform_aml_s905_sdio.h" /* sdio_reinit() and etc */ + + +/* + * Return: + * 0: power on successfully + * others: power on failed + */ +int platform_wifi_power_on(void) +{ + int ret = 0; + +#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 0)) + ret = wifi_setup_dt(); + if (ret) { + pr_err("%s: setup dt failed!!(%d)\n", __func__, ret); + return -1; + } +#endif /* kernel < 3.14.0 */ + +#if 0 /* Seems redundancy? Already done before insert driver */ + pr_info("######%s:\n", __func__); + extern_wifi_set_enable(0); + msleep(500); + extern_wifi_set_enable(1); + msleep(500); + sdio_reinit(); +#endif + + return ret; +} + +void platform_wifi_power_off(void) +{ +#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 0)) + wifi_teardown_dt(); +#endif /* kernel < 3.14.0 */ +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_aml_s905_sdio.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_aml_s905_sdio.h new file mode 100644 index 000000000000..f8cebf1073a5 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_aml_s905_sdio.h @@ -0,0 +1,29 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2016 - 2018 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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 __PLATFORM_AML_S905_SDIO_H__ +#define __PLATFORM_AML_S905_SDIO_H__ + +#include /* Linux vresion */ + +extern void sdio_reinit(void); +extern void extern_wifi_set_enable(int is_on); + +#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 0)) +extern void wifi_teardown_dt(void); +extern int wifi_setup_dt(void); +#endif /* kernel < 3.14.0 */ + +#endif /* __PLATFORM_AML_S905_SDIO_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_arm_act_sdio.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_arm_act_sdio.c index 539bb178c584..a106b36aa290 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_arm_act_sdio.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_arm_act_sdio.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/platform/platform_hisilicon_hi3798_sdio.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_hisilicon_hi3798_sdio.c new file mode 100644 index 000000000000..4ecbcf0add29 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_hisilicon_hi3798_sdio.c @@ -0,0 +1,111 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2017 - 2018 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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 /* mdelay() */ +#include /* __io_address(), readl(), writel() */ +#include "platform_hisilicon_hi3798_sdio.h" /* HI_S32() and etc. */ + +typedef enum hi_GPIO_DIR_E { + HI_DIR_OUT = 0, + HI_DIR_IN = 1, +} HI_GPIO_DIR_E; + +#define RTL_REG_ON_GPIO (4*8 + 3) + +#define REG_BASE_CTRL __io_address(0xf8a20008) + +int gpio_wlan_reg_on = RTL_REG_ON_GPIO; +#if 0 +module_param(gpio_wlan_reg_on, uint, 0644); +MODULE_PARM_DESC(gpio_wlan_reg_on, "wlan reg_on gpio num (default:gpio4_3)"); +#endif + +static int hi_gpio_set_value(u32 gpio, u32 value) +{ + HI_S32 s32Status; + + s32Status = HI_DRV_GPIO_SetDirBit(gpio, HI_DIR_OUT); + if (s32Status != HI_SUCCESS) { + pr_err("gpio(%d) HI_DRV_GPIO_SetDirBit HI_DIR_OUT failed\n", + gpio); + return -1; + } + + s32Status = HI_DRV_GPIO_WriteBit(gpio, value); + if (s32Status != HI_SUCCESS) { + pr_err("gpio(%d) HI_DRV_GPIO_WriteBit value(%d) failed\n", + gpio, value); + return -1; + } + + return 0; +} + +static int hisi_wlan_set_carddetect(bool present) +{ + u32 regval; + u32 mask; + + +#ifndef CONFIG_HISI_SDIO_ID + return; +#endif + pr_info("SDIO ID=%d\n", CONFIG_HISI_SDIO_ID); +#if (CONFIG_HISI_SDIO_ID == 1) + mask = 1; +#elif (CONFIG_HISI_SDIO_ID == 0) + mask = 2; +#endif + + regval = readl(REG_BASE_CTRL); + if (present) { + pr_info("====== Card detection to detect SDIO card! ======\n"); + /* set card_detect low to detect card */ + regval |= mask; + } else { + pr_info("====== Card detection to remove SDIO card! ======\n"); + /* set card_detect high to remove card */ + regval &= ~(mask); + } + writel(regval, REG_BASE_CTRL); + + return 0; +} + +/* + * Return: + * 0: power on successfully + * others: power on failed + */ +int platform_wifi_power_on(void) +{ + int ret = 0; + + + hi_gpio_set_value(gpio_wlan_reg_on, 1); + mdelay(100); + hisi_wlan_set_carddetect(1); + mdelay(2000); + pr_info("======== set_carddetect delay 2s! ========\n"); + + return ret; +} + +void platform_wifi_power_off(void) +{ + hisi_wlan_set_carddetect(0); + mdelay(100); + hi_gpio_set_value(gpio_wlan_reg_on, 0); +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_hisilicon_hi3798_sdio.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_hisilicon_hi3798_sdio.h new file mode 100644 index 000000000000..07a4e6a6e62b --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_hisilicon_hi3798_sdio.h @@ -0,0 +1,29 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2017 - 2018 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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 __PLATFORM_HISILICON_HI3798_SDIO_H__ +#define __PLATFORM_HISILICON_HI3798_SDIO_H__ + +typedef unsigned int HI_U32; + +typedef int HI_S32; + +#define HI_SUCCESS 0 +#define HI_FAILURE (-1) + +extern HI_S32 HI_DRV_GPIO_SetDirBit(HI_U32 u32GpioNo, HI_U32 u32DirBit); +extern HI_S32 HI_DRV_GPIO_WriteBit(HI_U32 u32GpioNo, HI_U32 u32BitValue); + +#endif /* __PLATFORM_HISILICON_HI3798_SDIO_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_ops.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_ops.c index f4c2fad88aef..e94cf626ac41 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_ops.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_ops.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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,25 +12,18 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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: * 0: power on successfully * others: power on failed */ -#include -extern unsigned int oob_irq; int platform_wifi_power_on(void) { int ret = 0; - oob_irq = rockchip_wifi_get_oob_irq(); + return ret; } diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_ops.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_ops.h index b8314bb21411..6f8588e8670b 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_ops.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_ops.h @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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/rtl8188eu/platform/platform_sprd_sdio.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_sprd_sdio.c index c5ffd149fc5c..4a0240f491a7 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_sprd_sdio.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_sprd_sdio.c @@ -1,6 +1,7 @@ +/* SPDX-License-Identifier: GPL-2.0 */ /****************************************************************************** * - * 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 +12,7 @@ * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for * more details. * - * You should have received a copy of the GNU General 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); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_zte_zx296716_sdio.c b/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_zte_zx296716_sdio.c new file mode 100644 index 000000000000..abd82a0ca28e --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_zte_zx296716_sdio.c @@ -0,0 +1,54 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2016 - 2018 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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 /* pr_info(() */ +#include /* msleep() */ +#include "platform_zte_zx296716_sdio.h" /* sdio_reinit() and etc */ + + +/* + * Return: + * 0: power on successfully + * others: power on failed + */ +int platform_wifi_power_on(void) +{ + int ret = 0; + + pr_info("######%s: disable--1--\n", __func__); + extern_wifi_set_enable(0); + /*msleep(500);*/ /* add in function:extern_wifi_set_enable */ + pr_info("######%s: enable--2---\n", __func__); + extern_wifi_set_enable(1); + /*msleep(500);*/ + sdio_reinit(); + + return ret; +} + +void platform_wifi_power_off(void) +{ + int card_val; + + pr_info("######%s:\n", __func__); +#ifdef CONFIG_A16T03_BOARD + card_val = sdio_host_is_null(); + if (card_val) + remove_card(); +#endif /* CONFIG_A16T03_BOARD */ + extern_wifi_set_enable(0); + + /*msleep(500);*/ +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_zte_zx296716_sdio.h b/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_zte_zx296716_sdio.h new file mode 100644 index 000000000000..a03647ccf664 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8188eu/platform/platform_zte_zx296716_sdio.h @@ -0,0 +1,26 @@ +/* SPDX-License-Identifier: GPL-2.0 */ +/****************************************************************************** + * + * Copyright(c) 2016 - 2018 Realtek Corporation. + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of version 2 of the GNU General Public License as + * published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, but WITHOUT + * 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 __PLATFORM_ZTE_ZX296716_SDIO_H__ +#define __PLATFORM_ZTE_ZX296716_SDIO_H__ + +extern void sdio_reinit(void); +extern void extern_wifi_set_enable(int val); +#ifdef CONFIG_A16T03_BOARD +extern int sdio_host_is_null(void); +extern void remove_card(void); +#endif /* CONFIG_A16T03_BOARD */ + +#endif /* __PLATFORM_ZTE_ZX296716_SDIO_H__ */